From c56fa46c21db9cfebc3a902cd33b44bc00e2b171 Mon Sep 17 00:00:00 2001 From: Alex Zhao Date: Mon, 13 Nov 2017 10:49:35 +0800 Subject: [PATCH] net: wireless: rockchip_wlan: update rtl8723ds update rtl8723ds wifi driver to version v5.2.15.1_25011.20171107_COEX20171025-2020 Change-Id: Ifbf94c2ebc7c7d8e529910d77f6094d0ae4f7907 Signed-off-by: Alex Zhao --- .../wireless/rockchip_wlan/rtl8723ds/Makefile | 349 +- .../rtl8723ds/core/efuse/rtw_efuse.c | 1013 +- .../rockchip_wlan/rtl8723ds/core/rtw_ap.c | 1164 +- .../rtl8723ds/core/rtw_beamforming.c | 2432 +- .../rockchip_wlan/rtl8723ds/core/rtw_br_ext.c | 9 +- .../rockchip_wlan/rtl8723ds/core/rtw_bt_mp.c | 39 +- .../rockchip_wlan/rtl8723ds/core/rtw_btcoex.c | 94 +- .../rtl8723ds/core/rtw_btcoex_wifionly.c | 42 + .../rockchip_wlan/rtl8723ds/core/rtw_cmd.c | 541 +- .../rockchip_wlan/rtl8723ds/core/rtw_debug.c | 2034 +- .../rockchip_wlan/rtl8723ds/core/rtw_eeprom.c | 9 +- .../rtl8723ds/core/rtw_ieee80211.c | 59 +- .../rockchip_wlan/rtl8723ds/core/rtw_io.c | 11 +- .../rtl8723ds/core/rtw_ioctl_query.c | 9 +- .../rtl8723ds/core/rtw_ioctl_rtl.c | 15 +- .../rtl8723ds/core/rtw_ioctl_set.c | 79 +- .../rockchip_wlan/rtl8723ds/core/rtw_iol.c | 9 +- .../rockchip_wlan/rtl8723ds/core/rtw_mem.c | 14 + .../rockchip_wlan/rtl8723ds/core/rtw_mi.c | 394 +- .../rockchip_wlan/rtl8723ds/core/rtw_mlme.c | 729 +- .../rtl8723ds/core/rtw_mlme_ext.c | 2748 +-- .../rockchip_wlan/rtl8723ds/core/rtw_mp.c | 526 +- .../rtl8723ds/core/rtw_mp_ioctl.c | 11 +- .../rockchip_wlan/rtl8723ds/core/rtw_odm.c | 287 +- .../rockchip_wlan/rtl8723ds/core/rtw_p2p.c | 312 +- .../rtl8723ds/core/rtw_pwrctrl.c | 427 +- .../rockchip_wlan/rtl8723ds/core/rtw_recv.c | 1433 +- .../rockchip_wlan/rtl8723ds/core/rtw_rf.c | 1305 +- .../rockchip_wlan/rtl8723ds/core/rtw_rm.c | 2415 ++ .../rockchip_wlan/rtl8723ds/core/rtw_rm_fsm.c | 998 + .../rockchip_wlan/rtl8723ds/core/rtw_rson.c | 592 + .../rockchip_wlan/rtl8723ds/core/rtw_sdio.c | 72 +- .../rtl8723ds/core/rtw_security.c | 46 +- .../rockchip_wlan/rtl8723ds/core/rtw_sreset.c | 18 +- .../rtl8723ds/core/rtw_sta_mgt.c | 396 +- .../rockchip_wlan/rtl8723ds/core/rtw_tdls.c | 695 +- .../rockchip_wlan/rtl8723ds/core/rtw_vht.c | 333 +- .../rockchip_wlan/rtl8723ds/core/rtw_wapi.c | 23 +- .../rtl8723ds/core/rtw_wapi_sms4.c | 14 + .../rtl8723ds/core/rtw_wlan_util.c | 1075 +- .../rockchip_wlan/rtl8723ds/core/rtw_xmit.c | 862 +- .../rtl8723ds/hal/HalPwrSeqCmd.c | 40 +- .../rtl8723ds/hal/btc/HalBtc8188c2Ant.c | 1987 -- .../rtl8723ds/hal/btc/HalBtc8188c2Ant.h | 149 - .../rtl8723ds/hal/btc/HalBtc8192d2Ant.c | 1992 -- .../rtl8723ds/hal/btc/HalBtc8192d2Ant.h | 170 - .../rtl8723ds/hal/btc/HalBtc8723a1Ant.c | 1544 -- .../rtl8723ds/hal/btc/HalBtc8723a1Ant.h | 171 - .../rtl8723ds/hal/btc/HalBtc8723a2Ant.c | 3746 --- .../rtl8723ds/hal/btc/HalBtc8723a2Ant.h | 184 - .../rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.c | 3997 ---- .../rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.h | 188 - .../rtl8723ds/hal/btc/HalBtc8822b1Ant.c | 6006 ----- .../{HalBtc8192e1Ant.c => halbtc8192e1ant.c} | 32 +- .../{HalBtc8192e1Ant.h => halbtc8192e1ant.h} | 14 + .../{HalBtc8192e2Ant.c => halbtc8192e2ant.c} | 1183 +- .../{HalBtc8192e2Ant.h => halbtc8192e2ant.h} | 33 +- .../{HalBtc8703b1Ant.c => halbtc8703b1ant.c} | 3933 ++-- .../{HalBtc8703b1Ant.h => halbtc8703b1ant.h} | 141 +- .../{HalBtc8723b1Ant.c => halbtc8723b1ant.c} | 10083 ++++---- .../{HalBtc8723b1Ant.h => halbtc8723b1ant.h} | 595 +- .../{HalBtc8723b2Ant.c => halbtc8723b2ant.c} | 9909 ++++---- .../{HalBtc8723b2Ant.h => halbtc8723b2ant.h} | 21 +- .../rtl8723ds/hal/btc/halbtc8723bwifionly.c | 82 + .../rtl8723ds/hal/btc/halbtc8723bwifionly.h | 22 + .../rtl8723ds/hal/btc/halbtc8723d1ant.c | 1983 +- .../rtl8723ds/hal/btc/halbtc8723d1ant.h | 55 +- .../rtl8723ds/hal/btc/halbtc8723d2ant.c | 2749 ++- .../rtl8723ds/hal/btc/halbtc8723d2ant.h | 57 +- .../{HalBtc8812a1Ant.c => halbtc8812a1ant.c} | 32 +- .../{HalBtc8812a1Ant.h => halbtc8812a1ant.h} | 14 + .../{HalBtc8812a2Ant.c => halbtc8812a2ant.c} | 1822 +- .../{HalBtc8812a2Ant.h => halbtc8812a2ant.h} | 39 + .../{HalBtc8821a1Ant.c => halbtc8821a1ant.c} | 907 +- .../{HalBtc8821a1Ant.h => halbtc8821a1ant.h} | 35 +- .../{HalBtc8821a2Ant.c => halbtc8821a2ant.c} | 772 +- .../{HalBtc8821a2Ant.h => halbtc8821a2ant.h} | 26 +- .../rtl8723ds/hal/btc/halbtc8821c1ant.c | 11574 +++++----- .../rtl8723ds/hal/btc/halbtc8821c1ant.h | 182 +- .../rtl8723ds/hal/btc/halbtc8821c2ant.c | 6919 +++--- .../rtl8723ds/hal/btc/halbtc8821c2ant.h | 189 +- .../rtl8723ds/hal/btc/halbtc8821cwifionly.c | 200 + .../rtl8723ds/hal/btc/halbtc8821cwifionly.h | 84 + .../rtl8723ds/hal/btc/halbtc8822b1ant.c | 7130 ++++++ .../{HalBtc8822b1Ant.h => halbtc8822b1ant.h} | 126 +- .../rtl8723ds/hal/btc/halbtc8822b2ant.c | 6112 +++++ .../rtl8723ds/hal/btc/halbtc8822b2ant.h | 526 + .../rtl8723ds/hal/btc/halbtc8822bwifionly.c | 68 + .../rtl8723ds/hal/btc/halbtc8822bwifionly.h | 36 + .../btc/{HalBtcOutSrc.h => halbtcoutsrc.h} | 161 +- .../hal/btc/{Mp_Precomp.h => mp_precomp.h} | 48 +- .../rtl8723ds/hal/efuse/efuse_mask.h | 178 +- .../efuse/rtl8723d/HalEfuseMask8723D_PCIE.c | 33 +- .../efuse/rtl8723d/HalEfuseMask8723D_PCIE.h | 31 +- .../efuse/rtl8723d/HalEfuseMask8723D_SDIO.c | 30 +- .../efuse/rtl8723d/HalEfuseMask8723D_SDIO.h | 30 +- .../efuse/rtl8723d/HalEfuseMask8723D_USB.c | 31 +- .../efuse/rtl8723d/HalEfuseMask8723D_USB.h | 31 +- .../rockchip_wlan/rtl8723ds/hal/hal_btcoex.c | 959 +- .../rtl8723ds/hal/hal_btcoex_wifionly.c | 178 + .../rockchip_wlan/rtl8723ds/hal/hal_com.c | 4317 +++- .../rockchip_wlan/rtl8723ds/hal/hal_com_c2h.h | 12 +- .../rtl8723ds/hal/hal_com_phycfg.c | 2371 +- .../rockchip_wlan/rtl8723ds/hal/hal_dm.c | 1135 +- .../rockchip_wlan/rtl8723ds/hal/hal_dm.h | 69 +- .../rockchip_wlan/rtl8723ds/hal/hal_dm_acs.c | 459 + .../rockchip_wlan/rtl8723ds/hal/hal_dm_acs.h | 91 + .../rockchip_wlan/rtl8723ds/hal/hal_halmac.c | 3102 ++- .../rockchip_wlan/rtl8723ds/hal/hal_halmac.h | 137 +- .../rtl8723ds/hal/hal_hci/hal_sdio.c | 71 +- .../rockchip_wlan/rtl8723ds/hal/hal_intf.c | 749 +- .../rockchip_wlan/rtl8723ds/hal/hal_mcc.c | 688 +- .../rockchip_wlan/rtl8723ds/hal/hal_mp.c | 1532 +- .../rockchip_wlan/rtl8723ds/hal/hal_phy.c | 31 +- .../rtl8723ds/hal/led/hal_sdio_led.c | 15 +- .../rtl8723ds/hal/phydm/ap_makefile.mk | 119 + .../rtl8723ds/hal/phydm/halhwimg.h | 260 +- .../rtl8723ds/hal/phydm/halphyrf_ap.c | 2790 --- .../rtl8723ds/hal/phydm/halphyrf_ap.h | 179 - .../rtl8723ds/hal/phydm/halphyrf_ce.c | 807 - .../rtl8723ds/hal/phydm/halphyrf_ce.h | 118 - .../rtl8723ds/hal/phydm/halphyrf_win.c | 792 - .../rtl8723ds/hal/phydm/halphyrf_win.h | 120 - .../rtl8723ds/hal/phydm/halrf/halphyrf_ap.c | 1353 ++ .../rtl8723ds/hal/phydm/halrf/halphyrf_ap.h | 122 + .../rtl8723ds/hal/phydm/halrf/halphyrf_ce.c | 898 + .../rtl8723ds/hal/phydm/halrf/halphyrf_ce.h | 114 + .../rtl8723ds/hal/phydm/halrf/halphyrf_win.c | 817 + .../rtl8723ds/hal/phydm/halrf/halphyrf_win.h | 114 + .../rtl8723ds/hal/phydm/halrf/halrf.c | 1471 ++ .../rtl8723ds/hal/phydm/halrf/halrf.h | 308 + .../hal/phydm/halrf/halrf_features.h | 33 + .../rtl8723ds/hal/phydm/halrf/halrf_iqk.h | 75 + .../rtl8723ds/hal/phydm/halrf/halrf_kfree.c | 770 + .../rtl8723ds/hal/phydm/halrf/halrf_kfree.h | 133 + .../hal/phydm/halrf/halrf_powertracking.c | 149 + .../hal/phydm/halrf/halrf_powertracking.h | 41 + .../hal/phydm/halrf/halrf_powertracking_ap.c | 1161 + .../hal/phydm/halrf/halrf_powertracking_ap.h | 351 + .../hal/phydm/halrf/halrf_powertracking_ce.c | 757 + .../hal/phydm/halrf/halrf_powertracking_ce.h | 343 + .../hal/phydm/halrf/halrf_powertracking_win.c | 806 + .../hal/phydm/halrf/halrf_powertracking_win.h | 306 + .../hal/phydm/halrf/halrf_txgapcal.c | 291 + .../hal/phydm/halrf/halrf_txgapcal.h | 5 + .../hal/phydm/halrf/rtl8723d/halrf_8723d.c | 2511 ++ .../hal/phydm/halrf/rtl8723d/halrf_8723d.h | 130 + .../rtl8723ds/hal/phydm/mp_precomp.h | 34 +- .../rockchip_wlan/rtl8723ds/hal/phydm/phydm.c | 6402 +++--- .../rockchip_wlan/rtl8723ds/hal/phydm/phydm.h | 2565 +-- .../rtl8723ds/hal/phydm/phydm.mk | 167 + .../rtl8723ds/hal/phydm/phydm_acs.c | 2377 +- .../rtl8723ds/hal/phydm/phydm_acs.h | 211 +- .../rtl8723ds/hal/phydm/phydm_adaptivity.c | 2113 +- .../rtl8723ds/hal/phydm/phydm_adaptivity.h | 429 +- .../rtl8723ds/hal/phydm/phydm_adc_sampling.c | 1141 +- .../rtl8723ds/hal/phydm/phydm_adc_sampling.h | 253 +- .../rtl8723ds/hal/phydm/phydm_antdect.c | 1797 +- .../rtl8723ds/hal/phydm/phydm_antdect.h | 188 +- .../rtl8723ds/hal/phydm/phydm_antdiv.c | 10157 ++++----- .../rtl8723ds/hal/phydm/phydm_antdiv.h | 1241 +- .../rtl8723ds/hal/phydm/phydm_api.c | 1185 + .../rtl8723ds/hal/phydm/phydm_api.h | 201 + .../rtl8723ds/hal/phydm/phydm_auto_dbg.c | 635 + .../rtl8723ds/hal/phydm/phydm_auto_dbg.h | 115 + .../rtl8723ds/hal/phydm/phydm_beamforming.c | 3867 ++-- .../rtl8723ds/hal/phydm/phydm_beamforming.h | 762 +- .../rtl8723ds/hal/phydm/phydm_cck_pd.c | 455 + .../rtl8723ds/hal/phydm/phydm_cck_pd.h | 85 + .../rtl8723ds/hal/phydm/phydm_ccx.c | 1563 +- .../rtl8723ds/hal/phydm/phydm_ccx.h | 311 +- .../rtl8723ds/hal/phydm/phydm_cfotracking.c | 762 +- .../rtl8723ds/hal/phydm/phydm_cfotracking.h | 140 +- .../rtl8723ds/hal/phydm/phydm_debug.c | 6280 ++--- .../rtl8723ds/hal/phydm/phydm_debug.h | 722 +- .../rtl8723ds/hal/phydm/phydm_dfs.c | 784 +- .../rtl8723ds/hal/phydm/phydm_dfs.h | 184 +- .../rtl8723ds/hal/phydm/phydm_dig.c | 4181 ++-- .../rtl8723ds/hal/phydm/phydm_dig.h | 720 +- .../hal/phydm/phydm_dynamic_rx_path.c | 355 + .../hal/phydm/phydm_dynamic_rx_path.h | 141 + .../hal/phydm/phydm_dynamicbbpowersaving.c | 124 - .../hal/phydm/phydm_dynamicbbpowersaving.h | 58 - .../hal/phydm/phydm_dynamictxpower.c | 998 +- .../hal/phydm/phydm_dynamictxpower.h | 210 +- .../hal/phydm/phydm_edcaturbocheck.c | 766 - .../hal/phydm/phydm_edcaturbocheck.h | 100 - .../rtl8723ds/hal/phydm/phydm_features.h | 184 +- .../rtl8723ds/hal/phydm/phydm_features_ap.h | 118 + .../rtl8723ds/hal/phydm/phydm_features_ce.h | 107 + .../rtl8723ds/hal/phydm/phydm_features_win.h | 106 + .../rtl8723ds/hal/phydm/phydm_hwconfig.c | 4672 +--- .../rtl8723ds/hal/phydm/phydm_hwconfig.h | 661 +- .../rtl8723ds/hal/phydm/phydm_interface.c | 2345 +- .../rtl8723ds/hal/phydm/phydm_interface.h | 931 +- .../rtl8723ds/hal/phydm/phydm_iqk.h | 61 - .../rtl8723ds/hal/phydm/phydm_kfree.c | 191 - .../rtl8723ds/hal/phydm/phydm_kfree.h | 45 - .../rtl8723ds/hal/phydm/phydm_math_lib.c | 171 + .../rtl8723ds/hal/phydm/phydm_math_lib.h | 77 + .../rtl8723ds/hal/phydm/phydm_noisemonitor.c | 722 +- .../rtl8723ds/hal/phydm/phydm_noisemonitor.h | 94 +- .../rtl8723ds/hal/phydm/phydm_pathdiv.c | 1502 +- .../rtl8723ds/hal/phydm/phydm_pathdiv.h | 618 +- .../rtl8723ds/hal/phydm/phydm_phystatus.c | 2581 +++ .../rtl8723ds/hal/phydm/phydm_phystatus.h | 1063 + .../rtl8723ds/hal/phydm/phydm_pow_train.c | 213 + .../rtl8723ds/hal/phydm/phydm_pow_train.h | 77 + .../hal/phydm/phydm_powertracking_ap.c | 1216 - .../hal/phydm/phydm_powertracking_ap.h | 351 - .../hal/phydm/phydm_powertracking_ce.c | 756 - .../hal/phydm/phydm_powertracking_ce.h | 334 - .../hal/phydm/phydm_powertracking_win.c | 784 - .../hal/phydm/phydm_powertracking_win.h | 299 - .../rtl8723ds/hal/phydm/phydm_pre_define.h | 1396 +- .../rtl8723ds/hal/phydm/phydm_precomp.h | 754 +- .../rtl8723ds/hal/phydm/phydm_primary_cca.c | 734 + .../rtl8723ds/hal/phydm/phydm_primary_cca.h | 117 + .../rtl8723ds/hal/phydm/phydm_psd.c | 393 + .../rtl8723ds/hal/phydm/phydm_psd.h | 93 + .../rtl8723ds/hal/phydm/phydm_rainfo.c | 5762 ++--- .../rtl8723ds/hal/phydm/phydm_rainfo.h | 1039 +- .../rtl8723ds/hal/phydm/phydm_reg.h | 439 +- .../rtl8723ds/hal/phydm/phydm_regdefine11ac.h | 182 +- .../rtl8723ds/hal/phydm/phydm_regdefine11n.h | 422 +- .../rtl8723ds/hal/phydm/phydm_rssi_monitor.c | 459 + .../rtl8723ds/hal/phydm/phydm_rssi_monitor.h | 65 + .../rtl8723ds/hal/phydm/phydm_smt_ant.c | 2154 ++ .../rtl8723ds/hal/phydm/phydm_smt_ant.h | 239 + .../rtl8723ds/hal/phydm/phydm_soml.c | 529 + .../rtl8723ds/hal/phydm/phydm_soml.h | 148 + .../rtl8723ds/hal/phydm/phydm_types.h | 521 +- .../rtl8723ds/hal/phydm/rtchnlplan.c | 481 - .../rtl8723ds/hal/phydm/rtchnlplan.h | 699 - .../hal/phydm/rtl8723d/hal8723dreg.h | 1869 +- .../hal/phydm/rtl8723d/halhwimg8723d_bb.c | 1842 +- .../hal/phydm/rtl8723d/halhwimg8723d_bb.h | 113 +- .../hal/phydm/rtl8723d/halhwimg8723d_fw.c | 4840 ---- .../hal/phydm/rtl8723d/halhwimg8723d_fw.h | 62 - .../hal/phydm/rtl8723d/halhwimg8723d_mac.c | 602 +- .../hal/phydm/rtl8723d/halhwimg8723d_mac.h | 73 +- .../hal/phydm/rtl8723d/halhwimg8723d_rf.c | 2399 +- .../hal/phydm/rtl8723d/halhwimg8723d_rf.h | 173 +- .../hal/phydm/rtl8723d/halphyrf_8723d.c | 4101 ---- .../hal/phydm/rtl8723d/halphyrf_8723d.h | 153 - .../hal/phydm/rtl8723d/phydm_regconfig8723d.c | 249 +- .../hal/phydm/rtl8723d/phydm_regconfig8723d.h | 147 +- .../hal/phydm/rtl8723d/phydm_rtl8723d.c | 53 +- .../hal/phydm/rtl8723d/phydm_rtl8723d.h | 21 +- .../hal/phydm/rtl8723d/version_rtl8723d.h | 5 +- .../rtl8723ds/hal/phydm/txbf/halcomtxbf.c | 1088 +- .../rtl8723ds/hal/phydm/txbf/halcomtxbf.h | 373 +- .../rtl8723ds/hal/phydm/txbf/haltxbf8192e.c | 793 +- .../rtl8723ds/hal/phydm/txbf/haltxbf8192e.h | 135 +- .../rtl8723ds/hal/phydm/txbf/haltxbf8814a.c | 1397 +- .../rtl8723ds/hal/phydm/txbf/haltxbf8814a.h | 186 +- .../rtl8723ds/hal/phydm/txbf/haltxbf8822b.c | 1184 +- .../rtl8723ds/hal/phydm/txbf/haltxbf8822b.h | 180 +- .../hal/phydm/txbf/haltxbfinterface.c | 3012 +-- .../hal/phydm/txbf/haltxbfinterface.h | 341 +- .../rtl8723ds/hal/phydm/txbf/haltxbfjaguar.c | 1067 +- .../rtl8723ds/hal/phydm/txbf/haltxbfjaguar.h | 163 +- .../hal/phydm/txbf/phydm_hal_txbf_api.c | 382 +- .../hal/phydm/txbf/phydm_hal_txbf_api.h | 135 +- .../rtl8723ds/hal/rtl8723d/Hal8723DPwrSeq.c | 35 +- .../rtl8723ds/hal/rtl8723d/hal8723d_fw.c | 19041 ++++++++-------- .../rtl8723ds/hal/rtl8723d/hal8723d_fw.h | 15 +- .../rtl8723ds/hal/rtl8723d/rtl8723d_cmd.c | 320 +- .../rtl8723ds/hal/rtl8723d/rtl8723d_dm.c | 248 +- .../hal/rtl8723d/rtl8723d_hal_init.c | 924 +- .../hal/rtl8723d/rtl8723d_lps_poff.c | 28 +- .../rtl8723ds/hal/rtl8723d/rtl8723d_phycfg.c | 329 +- .../rtl8723ds/hal/rtl8723d/rtl8723d_rf6052.c | 50 +- .../rtl8723ds/hal/rtl8723d/rtl8723d_rxdesc.c | 9 +- .../rtl8723ds/hal/rtl8723d/rtl8723d_sreset.c | 11 +- .../hal/rtl8723d/sdio/rtl8723ds_led.c | 11 +- .../hal/rtl8723d/sdio/rtl8723ds_recv.c | 90 +- .../hal/rtl8723d/sdio/rtl8723ds_xmit.c | 35 +- .../hal/rtl8723d/sdio/sdio_halinit.c | 280 +- .../rtl8723ds/hal/rtl8723d/sdio/sdio_ops.c | 82 +- .../rtl8723ds/include/Hal8188EPhyCfg.h | 25 +- .../rtl8723ds/include/Hal8188EPhyReg.h | 9 +- .../rtl8723ds/include/Hal8188EPwrSeq.h | 11 +- .../rtl8723ds/include/Hal8188FPhyCfg.h | 30 +- .../rtl8723ds/include/Hal8188FPhyReg.h | 9 +- .../rtl8723ds/include/Hal8188FPwrSeq.h | 14 + .../rtl8723ds/include/Hal8192EPhyCfg.h | 25 +- .../rtl8723ds/include/Hal8192EPhyReg.h | 14 + .../rtl8723ds/include/Hal8192EPwrSeq.h | 14 + .../rtl8723ds/include/Hal8703BPhyCfg.h | 31 +- .../rtl8723ds/include/Hal8703BPhyReg.h | 9 +- .../rtl8723ds/include/Hal8703BPwrSeq.h | 14 + .../rtl8723ds/include/Hal8723BPhyCfg.h | 28 +- .../rtl8723ds/include/Hal8723BPhyReg.h | 9 +- .../rtl8723ds/include/Hal8723BPwrSeq.h | 14 + .../rtl8723ds/include/Hal8723DPhyCfg.h | 29 +- .../rtl8723ds/include/Hal8723DPhyReg.h | 9 +- .../rtl8723ds/include/Hal8723DPwrSeq.h | 14 + .../rtl8723ds/include/Hal8723PwrSeq.h | 14 + .../rtl8723ds/include/Hal8812PhyCfg.h | 33 +- .../rtl8723ds/include/Hal8812PhyReg.h | 9 +- .../rtl8723ds/include/Hal8812PwrSeq.h | 19 +- .../rtl8723ds/include/Hal8814PhyCfg.h | 37 +- .../rtl8723ds/include/Hal8814PhyReg.h | 9 +- .../rtl8723ds/include/Hal8814PwrSeq.h | 11 +- .../rtl8723ds/include/Hal8821APwrSeq.h | 14 + .../rtl8723ds/include/HalPwrSeqCmd.h | 9 +- .../rtl8723ds/include/HalVerDef.h | 37 +- .../rtl8723ds/include/autoconf.h | 33 +- .../rtl8723ds/include/basic_types.h | 50 +- .../rtl8723ds/include/byteorder/big_endian.h | 9 +- .../rtl8723ds/include/byteorder/generic.h | 9 +- .../include/byteorder/little_endian.h | 9 +- .../rtl8723ds/include/byteorder/swab.h | 9 +- .../rtl8723ds/include/byteorder/swabb.h | 9 +- .../rtl8723ds/include/circ_buf.h | 11 +- .../rtl8723ds/include/cmd_osdep.h | 9 +- .../rtl8723ds/include/cmn_info/rtw_sta_info.h | 239 + .../rtl8723ds/include/custom_gpio.h | 14 + .../rtl8723ds/include/drv_conf.h | 111 +- .../rtl8723ds/include/drv_types.h | 286 +- .../rtl8723ds/include/drv_types_ce.h | 9 +- .../rtl8723ds/include/drv_types_gspi.h | 9 +- .../rtl8723ds/include/drv_types_linux.h | 9 +- .../rtl8723ds/include/drv_types_pci.h | 9 +- .../rtl8723ds/include/drv_types_sdio.h | 17 +- .../rtl8723ds/include/drv_types_xp.h | 9 +- .../rtl8723ds/include/ethernet.h | 9 +- .../rtl8723ds/include/gspi_hal.h | 9 +- .../rtl8723ds/include/gspi_ops.h | 11 +- .../rtl8723ds/include/gspi_ops_linux.h | 9 +- .../rtl8723ds/include/gspi_osintf.h | 9 +- .../rockchip_wlan/rtl8723ds/include/h2clbk.h | 9 +- .../rtl8723ds/include/hal_btcoex.h | 20 +- .../rtl8723ds/include/hal_btcoex_wifionly.h | 62 + .../rockchip_wlan/rtl8723ds/include/hal_com.h | 195 +- .../rtl8723ds/include/hal_com_h2c.h | 132 +- .../rtl8723ds/include/hal_com_led.h | 65 +- .../rtl8723ds/include/hal_com_phycfg.h | 139 +- .../rtl8723ds/include/hal_com_reg.h | 702 +- .../rtl8723ds/include/hal_data.h | 544 +- .../rtl8723ds/include/hal_gspi.h | 9 +- .../rtl8723ds/include/hal_ic_cfg.h | 83 +- .../rtl8723ds/include/hal_intf.h | 156 +- .../rockchip_wlan/rtl8723ds/include/hal_pg.h | 26 +- .../rockchip_wlan/rtl8723ds/include/hal_phy.h | 34 +- .../rtl8723ds/include/hal_phy_reg.h | 9 +- .../rtl8723ds/include/hal_sdio.h | 9 +- .../rtl8723ds/include/ieee80211.h | 28 +- .../rtl8723ds/include/ieee80211_ext.h | 9 +- .../rtl8723ds/include/if_ether.h | 9 +- .../rockchip_wlan/rtl8723ds/include/ip.h | 9 +- .../rtl8723ds/include/linux/wireless.h | 9 +- .../rtl8723ds/include/mlme_osdep.h | 12 +- .../rtl8723ds/include/mp_custom_oid.h | 9 +- .../rtl8723ds/include/nic_spec.h | 9 +- .../rtl8723ds/include/osdep_intf.h | 17 +- .../rtl8723ds/include/osdep_service.h | 104 +- .../rtl8723ds/include/osdep_service_bsd.h | 99 +- .../rtl8723ds/include/osdep_service_ce.h | 64 +- .../rtl8723ds/include/osdep_service_linux.h | 55 +- .../rtl8723ds/include/osdep_service_xp.h | 84 +- .../rockchip_wlan/rtl8723ds/include/pci_hal.h | 9 +- .../rockchip_wlan/rtl8723ds/include/pci_ops.h | 13 +- .../rtl8723ds/include/pci_osintf.h | 28 +- .../rtl8723ds/include/recv_osdep.h | 15 +- .../rtl8723ds/include/rtl8188e_cmd.h | 17 +- .../rtl8723ds/include/rtl8188e_dm.h | 9 +- .../rtl8723ds/include/rtl8188e_hal.h | 26 +- .../rtl8723ds/include/rtl8188e_led.h | 11 +- .../rtl8723ds/include/rtl8188e_recv.h | 15 +- .../rtl8723ds/include/rtl8188e_rf.h | 11 +- .../rtl8723ds/include/rtl8188e_spec.h | 32 +- .../rtl8723ds/include/rtl8188e_sreset.h | 9 +- .../rtl8723ds/include/rtl8188e_xmit.h | 9 +- .../rtl8723ds/include/rtl8188f_cmd.h | 15 +- .../rtl8723ds/include/rtl8188f_dm.h | 12 +- .../rtl8723ds/include/rtl8188f_hal.h | 25 +- .../rtl8723ds/include/rtl8188f_led.h | 11 +- .../rtl8723ds/include/rtl8188f_recv.h | 10 +- .../rtl8723ds/include/rtl8188f_rf.h | 11 +- .../rtl8723ds/include/rtl8188f_spec.h | 108 +- .../rtl8723ds/include/rtl8188f_sreset.h | 9 +- .../rtl8723ds/include/rtl8188f_xmit.h | 9 +- .../rtl8723ds/include/rtl8192e_cmd.h | 16 +- .../rtl8723ds/include/rtl8192e_dm.h | 9 +- .../rtl8723ds/include/rtl8192e_hal.h | 22 +- .../rtl8723ds/include/rtl8192e_led.h | 12 +- .../rtl8723ds/include/rtl8192e_recv.h | 9 +- .../rtl8723ds/include/rtl8192e_rf.h | 11 +- .../rtl8723ds/include/rtl8192e_spec.h | 114 +- .../rtl8723ds/include/rtl8192e_sreset.h | 9 +- .../rtl8723ds/include/rtl8192e_xmit.h | 11 +- .../rtl8723ds/include/rtl8703b_cmd.h | 15 +- .../rtl8723ds/include/rtl8703b_dm.h | 12 +- .../rtl8723ds/include/rtl8703b_hal.h | 19 +- .../rtl8723ds/include/rtl8703b_led.h | 14 +- .../rtl8723ds/include/rtl8703b_recv.h | 9 +- .../rtl8723ds/include/rtl8703b_rf.h | 11 +- .../rtl8723ds/include/rtl8703b_spec.h | 108 +- .../rtl8723ds/include/rtl8703b_sreset.h | 9 +- .../rtl8723ds/include/rtl8703b_xmit.h | 10 +- .../rtl8723ds/include/rtl8723b_cmd.h | 15 +- .../rtl8723ds/include/rtl8723b_dm.h | 13 +- .../rtl8723ds/include/rtl8723b_hal.h | 21 +- .../rtl8723ds/include/rtl8723b_led.h | 12 +- .../rtl8723ds/include/rtl8723b_recv.h | 9 +- .../rtl8723ds/include/rtl8723b_rf.h | 11 +- .../rtl8723ds/include/rtl8723b_spec.h | 108 +- .../rtl8723ds/include/rtl8723b_sreset.h | 9 +- .../rtl8723ds/include/rtl8723b_xmit.h | 10 +- .../rtl8723ds/include/rtl8723d_cmd.h | 37 +- .../rtl8723ds/include/rtl8723d_dm.h | 12 +- .../rtl8723ds/include/rtl8723d_hal.h | 23 +- .../rtl8723ds/include/rtl8723d_led.h | 12 +- .../rtl8723ds/include/rtl8723d_lps_poff.h | 9 +- .../rtl8723ds/include/rtl8723d_recv.h | 10 +- .../rtl8723ds/include/rtl8723d_rf.h | 11 +- .../rtl8723ds/include/rtl8723d_spec.h | 26 +- .../rtl8723ds/include/rtl8723d_sreset.h | 9 +- .../rtl8723ds/include/rtl8723d_xmit.h | 10 +- .../rtl8723ds/include/rtl8812a_cmd.h | 21 +- .../rtl8723ds/include/rtl8812a_dm.h | 9 +- .../rtl8723ds/include/rtl8812a_hal.h | 37 +- .../rtl8723ds/include/rtl8812a_led.h | 20 +- .../rtl8723ds/include/rtl8812a_recv.h | 9 +- .../rtl8723ds/include/rtl8812a_rf.h | 11 +- .../rtl8723ds/include/rtl8812a_spec.h | 31 +- .../rtl8723ds/include/rtl8812a_sreset.h | 9 +- .../rtl8723ds/include/rtl8812a_xmit.h | 15 +- .../rtl8723ds/include/rtl8814a_cmd.h | 35 +- .../rtl8723ds/include/rtl8814a_dm.h | 9 +- .../rtl8723ds/include/rtl8814a_hal.h | 26 +- .../rtl8723ds/include/rtl8814a_led.h | 12 +- .../rtl8723ds/include/rtl8814a_recv.h | 9 +- .../rtl8723ds/include/rtl8814a_rf.h | 11 +- .../rtl8723ds/include/rtl8814a_spec.h | 25 +- .../rtl8723ds/include/rtl8814a_sreset.h | 9 +- .../rtl8723ds/include/rtl8814a_xmit.h | 13 +- .../rtl8723ds/include/rtl8821a_spec.h | 24 +- .../rtl8723ds/include/rtl8821a_xmit.h | 9 +- .../rtl8723ds/include/rtl8821c_dm.h | 23 + .../rtl8723ds/include/rtl8821c_hal.h | 53 +- .../rtl8723ds/include/rtl8821c_spec.h | 191 + .../rtl8723ds/include/rtl8821ce_hal.h | 23 + .../rtl8723ds/include/rtl8821cs_hal.h | 9 +- .../rtl8723ds/include/rtl8821cu_hal.h | 9 +- .../rtl8723ds/include/rtl8822b_hal.h | 19 +- .../rtl8723ds/include/rtl8822be_hal.h | 11 +- .../rtl8723ds/include/rtl8822bs_hal.h | 13 +- .../rtl8723ds/include/rtl8822bu_hal.h | 21 +- .../rtl8723ds/include/rtw_android.h | 9 +- .../rockchip_wlan/rtl8723ds/include/rtw_ap.h | 40 +- .../rtl8723ds/include/rtw_beamforming.h | 404 +- .../rtl8723ds/include/rtw_br_ext.h | 9 +- .../rtl8723ds/include/rtw_bt_mp.h | 9 +- .../rtl8723ds/include/rtw_btcoex.h | 34 +- .../rtl8723ds/include/rtw_btcoex_wifionly.h | 23 + .../rtl8723ds/include/rtw_byteorder.h | 9 +- .../rockchip_wlan/rtl8723ds/include/rtw_cmd.h | 92 +- .../rtl8723ds/include/rtw_debug.h | 220 +- .../rtl8723ds/include/rtw_eeprom.h | 13 +- .../rtl8723ds/include/rtw_efuse.h | 29 +- .../rtl8723ds/include/rtw_event.h | 9 +- .../rockchip_wlan/rtl8723ds/include/rtw_ht.h | 15 +- .../rockchip_wlan/rtl8723ds/include/rtw_io.h | 9 +- .../rtl8723ds/include/rtw_ioctl.h | 16 +- .../rtl8723ds/include/rtw_ioctl_query.h | 9 +- .../rtl8723ds/include/rtw_ioctl_rtl.h | 9 +- .../rtl8723ds/include/rtw_ioctl_set.h | 11 +- .../rockchip_wlan/rtl8723ds/include/rtw_iol.h | 9 +- .../rockchip_wlan/rtl8723ds/include/rtw_mcc.h | 35 +- .../rockchip_wlan/rtl8723ds/include/rtw_mem.h | 9 +- .../rockchip_wlan/rtl8723ds/include/rtw_mi.h | 86 +- .../rtl8723ds/include/rtw_mlme.h | 102 +- .../rtl8723ds/include/rtw_mlme_ext.h | 209 +- .../rockchip_wlan/rtl8723ds/include/rtw_mp.h | 92 +- .../rtl8723ds/include/rtw_mp_ioctl.h | 9 +- .../rtl8723ds/include/rtw_mp_phy_regdef.h | 9 +- .../rockchip_wlan/rtl8723ds/include/rtw_odm.h | 75 +- .../rockchip_wlan/rtl8723ds/include/rtw_p2p.h | 9 +- .../rtl8723ds/include/rtw_pwrctrl.h | 101 +- .../rockchip_wlan/rtl8723ds/include/rtw_qos.h | 48 +- .../rtl8723ds/include/rtw_recv.h | 182 +- .../rockchip_wlan/rtl8723ds/include/rtw_rf.h | 153 +- .../rockchip_wlan/rtl8723ds/include/rtw_rm.h | 86 + .../rtl8723ds/include/rtw_rm_fsm.h | 389 + .../rtl8723ds/include/rtw_rson.h | 61 + .../rtl8723ds/include/rtw_sdio.h | 8 +- .../rtl8723ds/include/rtw_security.h | 22 +- .../rtl8723ds/include/rtw_sreset.h | 26 +- .../rtl8723ds/include/rtw_tdls.h | 67 +- .../rtl8723ds/include/rtw_version.h | 4 +- .../rockchip_wlan/rtl8723ds/include/rtw_vht.h | 24 +- .../rtl8723ds/include/rtw_wapi.h | 16 +- .../rtl8723ds/include/rtw_wifi_regd.h | 11 +- .../rtl8723ds/include/rtw_xmit.h | 149 +- .../rtl8723ds/include/sdio_hal.h | 9 +- .../rtl8723ds/include/sdio_ops.h | 19 +- .../rtl8723ds/include/sdio_ops_ce.h | 9 +- .../rtl8723ds/include/sdio_ops_linux.h | 25 +- .../rtl8723ds/include/sdio_ops_xp.h | 9 +- .../rtl8723ds/include/sdio_osintf.h | 9 +- .../rtl8723ds/include/sta_info.h | 188 +- .../rockchip_wlan/rtl8723ds/include/usb_hal.h | 9 +- .../rockchip_wlan/rtl8723ds/include/usb_ops.h | 11 +- .../rtl8723ds/include/usb_ops_linux.h | 9 +- .../rtl8723ds/include/usb_osintf.h | 9 +- .../rtl8723ds/include/usb_vendor_req.h | 9 +- .../rockchip_wlan/rtl8723ds/include/wifi.h | 76 +- .../rtl8723ds/include/wlan_bssdef.h | 29 +- .../rtl8723ds/include/xmit_osdep.h | 9 +- .../os_dep/linux/custom_gpio_linux.c | 10 +- .../rtl8723ds/os_dep/linux/ioctl_cfg80211.c | 1335 +- .../rtl8723ds/os_dep/linux/ioctl_cfg80211.h | 77 +- .../rtl8723ds/os_dep/linux/ioctl_linux.c | 1337 +- .../rtl8723ds/os_dep/linux/ioctl_mp.c | 451 +- .../rtl8723ds/os_dep/linux/mlme_linux.c | 196 +- .../rtl8723ds/os_dep/linux/os_intfs.c | 1118 +- .../rtl8723ds/os_dep/linux/recv_linux.c | 310 +- .../rtl8723ds/os_dep/linux/rtw_android.c | 119 +- .../rtl8723ds/os_dep/linux/rtw_cfgvendor.c | 11 +- .../rtl8723ds/os_dep/linux/rtw_cfgvendor.h | 9 +- .../rtl8723ds/os_dep/linux/rtw_proc.c | 951 +- .../rtl8723ds/os_dep/linux/rtw_proc.h | 9 +- .../rtl8723ds/os_dep/linux/sdio_intf.c | 370 +- .../rtl8723ds/os_dep/linux/sdio_ops_linux.c | 156 +- .../rtl8723ds/os_dep/linux/wifi_regd.c | 60 +- .../rtl8723ds/os_dep/linux/xmit_linux.c | 32 +- .../rtl8723ds/os_dep/osdep_service.c | 161 +- .../platform/custom_country_chplan.h | 12 +- .../platform/platform_ARM_SUN50IW1P1_sdio.c | 9 +- .../platform/platform_ARM_SUNnI_sdio.c | 9 +- .../platform/platform_ARM_SUNxI_sdio.c | 9 +- .../platform/platform_ARM_SUNxI_usb.c | 9 +- .../platform/platform_ARM_WMT_sdio.c | 9 +- .../rtl8723ds/platform/platform_RTK_DMP_usb.c | 9 +- .../platform/platform_arm_act_sdio.c | 9 +- .../rtl8723ds/platform/platform_ops.c | 9 +- .../rtl8723ds/platform/platform_ops.h | 9 +- .../rtl8723ds/platform/platform_sprd_sdio.c | 9 +- 541 files changed, 161135 insertions(+), 141658 deletions(-) create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex_wifionly.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm_fsm.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rson.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8822b1Ant.c rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8192e1Ant.c => halbtc8192e1ant.c} (99%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8192e1Ant.h => halbtc8192e1ant.h} (92%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8192e2Ant.c => halbtc8192e2ant.c} (84%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8192e2Ant.h => halbtc8192e2ant.h} (85%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8703b1Ant.c => halbtc8703b1ant.c} (57%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8703b1Ant.h => halbtc8703b1ant.h} (75%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8723b1Ant.c => halbtc8723b1ant.c} (84%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8723b1Ant.h => halbtc8723b1ant.h} (89%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8723b2Ant.c => halbtc8723b2ant.c} (91%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8723b2Ant.h => halbtc8723b2ant.h} (90%) create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.h rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8812a1Ant.c => halbtc8812a1ant.c} (99%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8812a1Ant.h => halbtc8812a1ant.h} (92%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8812a2Ant.c => halbtc8812a2ant.c} (73%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8812a2Ant.h => halbtc8812a2ant.h} (83%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8821a1Ant.c => halbtc8821a1ant.c} (89%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8821a1Ant.h => halbtc8821a1ant.h} (84%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8821a2Ant.c => halbtc8821a2ant.c} (94%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8821a2Ant.h => halbtc8821a2ant.h} (87%) create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b1ant.c rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtc8822b1Ant.h => halbtc8822b1ant.h} (80%) create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.h rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{HalBtcOutSrc.h => halbtcoutsrc.h} (88%) rename drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/{Mp_Precomp.h => mp_precomp.h} (63%) create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex_wifionly.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/ap_makefile.mk delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_features.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_iqk.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.mk create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ap.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ce.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_win.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_iqk.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.c create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.h delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.c delete mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmn_info/rtw_sta_info.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex_wifionly.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_dm.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_spec.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821ce_hal.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex_wifionly.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm_fsm.h create mode 100644 drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rson.h diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/Makefile b/drivers/net/wireless/rockchip_wlan/rtl8723ds/Makefile index 3d0a2939aeff..a03b59f9c350 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/Makefile +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/Makefile @@ -21,7 +21,6 @@ EXTRA_CFLAGS += -Wno-date-time # Fix compile error && warning on gcc 4.9 and lat endif EXTRA_CFLAGS += -I$(src)/include -EXTRA_CFLAGS += -I$(src)/hal/phydm EXTRA_LDFLAGS += --strip-debug @@ -56,10 +55,11 @@ CONFIG_INTEL_WIDI = n CONFIG_WAPI_SUPPORT = n CONFIG_EFUSE_CONFIG_FILE = y CONFIG_EXT_CLK = n -CONFIG_TRAFFIC_PROTECT = y +CONFIG_TRAFFIC_PROTECT = n CONFIG_LOAD_PHY_PARA_FROM_FILE = y CONFIG_TXPWR_BY_RATE_EN = y CONFIG_TXPWR_LIMIT_EN = n +CONFIG_RTW_CHPLAN = 0xFF CONFIG_RTW_ADAPTIVITY_EN = disable CONFIG_RTW_ADAPTIVITY_MODE = normal CONFIG_SIGNAL_SCALE_MAPPING = n @@ -72,15 +72,17 @@ CONFIG_MCC_MODE = n CONFIG_APPEND_VENDOR_IE_ENABLE = n CONFIG_RTW_NAPI = y CONFIG_RTW_GRO = y +CONFIG_RTW_IPCAM_APPLICATION = n +CONFIG_RTW_REPEATER_SON = n ########################## Debug ########################### -CONFIG_RTW_DEBUG = n +CONFIG_RTW_DEBUG = y # default log level is _DRV_INFO_ = 4, # please refer to "How_to_set_driver_debug_log_level.doc" to set the available level. -CONFIG_RTW_LOG_LEVEL = 4 +CONFIG_RTW_LOG_LEVEL = 2 ######################## Wake On Lan ########################## CONFIG_WOWLAN = n +CONFIG_WAKEUP_TYPE = 0x7 #bit2: deauth, bit1: unicast, bit0: magic pkt. CONFIG_GPIO_WAKEUP = n -CONFIG_DEFAULT_PATTERNS_EN = n CONFIG_WAKEUP_GPIO_IDX = default CONFIG_HIGH_ACTIVE = n CONFIG_PNO_SUPPORT = n @@ -92,7 +94,6 @@ CONFIG_RTW_SDIO_PM_KEEP_POWER = y CONFIG_MP_VHT_HW_TX_MODE = n ###################### Platform Related ####################### CONFIG_PLATFORM_I386_PC = n -CONFIG_PLATFORM_ARM_NV_TK1 = n CONFIG_PLATFORM_ANDROID_X86 = n CONFIG_PLATFORM_ANDROID_INTEL_X86 = n CONFIG_PLATFORM_JB_X86 = n @@ -144,11 +145,13 @@ CONFIG_PLATFORM_RTK119X = n CONFIG_PLATFORM_RTK129X = n CONFIG_PLATFORM_NOVATEK_NT72668 = n CONFIG_PLATFORM_HISILICON = n +CONFIG_PLATFORM_NV_TK1 = n +CONFIG_PLATFORM_RTL8197D = n ############################################################### CONFIG_DRVEXT_MODULE = n -export TopDIR ?= $(shell pwd) +export TopDIR ?= $(shell pwd)/drivers/net/wireless/rockchip_wlan/rtl8723ds ########### COMMON ################################# ifeq ($(CONFIG_GSPI_HCI), y) @@ -202,63 +205,41 @@ _HAL_INTFS_FILES := hal/hal_intf.o \ hal/hal_com_phycfg.o \ hal/hal_phy.o \ hal/hal_dm.o \ + hal/hal_dm_acs.o \ + hal/hal_btcoex_wifionly.o \ hal/hal_btcoex.o \ hal/hal_mp.o \ hal/hal_mcc.o \ hal/hal_hci/hal_$(HCI_NAME).o \ hal/led/hal_$(HCI_NAME)_led.o - -_OUTSRC_FILES := hal/phydm/phydm_debug.o \ - hal/phydm/phydm_antdiv.o\ - hal/phydm/phydm_antdect.o\ - hal/phydm/phydm_interface.o\ - hal/phydm/phydm_hwconfig.o\ - hal/phydm/phydm.o\ - hal/phydm/halphyrf_ce.o\ - hal/phydm/phydm_edcaturbocheck.o\ - hal/phydm/phydm_dig.o\ - hal/phydm/phydm_pathdiv.o\ - hal/phydm/phydm_rainfo.o\ - hal/phydm/phydm_dynamicbbpowersaving.o\ - hal/phydm/phydm_powertracking_ce.o\ - hal/phydm/phydm_dynamictxpower.o\ - hal/phydm/phydm_adaptivity.o\ - hal/phydm/phydm_cfotracking.o\ - hal/phydm/phydm_noisemonitor.o\ - hal/phydm/phydm_acs.o\ - hal/phydm/phydm_beamforming.o\ - hal/phydm/phydm_dfs.o\ - hal/phydm/txbf/halcomtxbf.o\ - hal/phydm/txbf/haltxbfinterface.o\ - hal/phydm/txbf/phydm_hal_txbf_api.o\ - hal/phydm/phydm_kfree.o\ - hal/phydm/phydm_ccx.o - EXTRA_CFLAGS += -I$(src)/platform _PLATFORM_FILES := platform/platform_ops.o -ifeq ($(CONFIG_BT_COEXIST), y) EXTRA_CFLAGS += -I$(src)/hal/btc -_OUTSRC_FILES += hal/btc/HalBtc8192e1Ant.o \ - hal/btc/HalBtc8192e2Ant.o \ - hal/btc/HalBtc8723b1Ant.o \ - hal/btc/HalBtc8723b2Ant.o \ - hal/btc/HalBtc8812a1Ant.o \ - hal/btc/HalBtc8812a2Ant.o \ - hal/btc/HalBtc8821a1Ant.o \ - hal/btc/HalBtc8821a2Ant.o \ - hal/btc/HalBtc8821aCsr2Ant.o \ - hal/btc/HalBtc8703b1Ant.o \ +_BTC_FILES += hal/btc/halbtc8723bwifionly.o \ + hal/btc/halbtc8822bwifionly.o \ + hal/btc/halbtc8821cwifionly.o +ifeq ($(CONFIG_BT_COEXIST), y) +_BTC_FILES += hal/btc/halbtc8192e1ant.o \ + hal/btc/halbtc8192e2ant.o \ + hal/btc/halbtc8723b1ant.o \ + hal/btc/halbtc8723b2ant.o \ + hal/btc/halbtc8812a1ant.o \ + hal/btc/halbtc8812a2ant.o \ + hal/btc/halbtc8821a1ant.o \ + hal/btc/halbtc8821a2ant.o \ + hal/btc/halbtc8703b1ant.o \ hal/btc/halbtc8723d1ant.o \ hal/btc/halbtc8723d2ant.o \ - hal/btc/HalBtc8822b1Ant.o \ + hal/btc/halbtc8822b1ant.o \ + hal/btc/halbtc8822b2ant.o \ hal/btc/halbtc8821c1ant.o \ hal/btc/halbtc8821c2ant.o endif - +include $(TopDIR)/hal/phydm/phydm.mk ########### HAL_RTL8188E ################################# ifeq ($(CONFIG_RTL8188E), y) @@ -318,17 +299,6 @@ ifeq ($(CONFIG_SDIO_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188E_SDIO.o endif -#hal/OUTSRC/$(RTL871X)/Hal8188EFWImg_CE.o -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188e_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8188e_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8188e_rf.o\ - hal/phydm/$(RTL871X)/halhwimg8188e_t_fw.o\ - hal/phydm/$(RTL871X)/halhwimg8188e_s_fw.o\ - hal/phydm/$(RTL871X)/halphyrf_8188e_ce.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ - hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ - hal/phydm/$(RTL871X)/phydm_rtl8188e.o - endif ########### HAL_RTL8192E ################################# @@ -380,15 +350,9 @@ endif ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_PCIE.o endif - -#hal/OUTSRC/$(RTL871X)/HalHWImg8188E_FW.o -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8192e_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8192e_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8192e_rf.o\ - hal/phydm/$(RTL871X)/halhwimg8192e_fw.o\ - hal/phydm/$(RTL871X)/halphyrf_8192e_ce.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ - hal/phydm/$(RTL871X)/phydm_rtl8192e.o +ifeq ($(CONFIG_SDIO_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8192E_SDIO.o +endif endif @@ -449,20 +413,14 @@ endif ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_PCIE.o endif +ifeq ($(CONFIG_SDIO_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8821A_SDIO.o +endif endif ifeq ($(CONFIG_RTL8812A), y) EXTRA_CFLAGS += -DCONFIG_RTL8812A _HAL_INTFS_FILES += hal/rtl8812a/hal8812a_fw.o - -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8812a_fw.o\ - hal/phydm/$(RTL871X)/halhwimg8812a_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8812a_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8812a_rf.o\ - hal/phydm/$(RTL871X)/halphyrf_8812a_ce.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8812a.o\ - hal/phydm/$(RTL871X)/phydm_rtl8812a.o\ - hal/phydm/txbf/haltxbfjaguar.o endif ifeq ($(CONFIG_RTL8821A), y) @@ -489,16 +447,6 @@ endif EXTRA_CFLAGS += -DCONFIG_RTL8821A _HAL_INTFS_FILES += hal/rtl8812a/hal8821a_fw.o -_OUTSRC_FILES += hal/phydm/rtl8821a/halhwimg8821a_fw.o\ - hal/phydm/rtl8821a/halhwimg8821a_mac.o\ - hal/phydm/rtl8821a/halhwimg8821a_bb.o\ - hal/phydm/rtl8821a/halhwimg8821a_rf.o\ - hal/phydm/rtl8812a/halphyrf_8812a_ce.o\ - hal/phydm/rtl8821a/halphyrf_8821a_ce.o\ - hal/phydm/rtl8821a/phydm_regconfig8821a.o\ - hal/phydm/rtl8821a/phydm_rtl8821a.o\ - hal/phydm/rtl8821a/phydm_iqk_8821a_ce.o\ - hal/phydm/txbf/haltxbfjaguar.o endif @@ -530,7 +478,7 @@ _HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ hal/$(RTL871X)/$(RTL871X)_dm.o \ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ hal/$(RTL871X)/$(RTL871X)_cmd.o \ - hal/$(RTL871X)/hal8723b_fw.o \ + hal/$(RTL871X)/hal8723b_fw.o _HAL_INTFS_FILES += \ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ @@ -550,23 +498,17 @@ endif ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_PCIE.o endif - -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8723b_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8723b_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8723b_rf.o\ - hal/phydm/$(RTL871X)/halhwimg8723b_fw.o\ - hal/phydm/$(RTL871X)/halhwimg8723b_mp.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ - hal/phydm/$(RTL871X)/halphyrf_8723b_ce.o\ - hal/phydm/$(RTL871X)/phydm_rtl8723b.o +ifeq ($(CONFIG_SDIO_HCI), y) +_HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723B_SDIO.o +endif endif ########### HAL_RTL8814A ################################# ifeq ($(CONFIG_RTL8814A), y) ## ADD NEW VHT MP HW TX MODE ## -EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE -CONFIG_MP_VHT_HW_TX_MODE = y +#EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE +#CONFIG_MP_VHT_HW_TX_MODE = y ########################################## RTL871X = rtl8814a ifeq ($(CONFIG_USB_HCI), y) @@ -592,7 +534,7 @@ _HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ hal/$(RTL871X)/$(RTL871X)_dm.o \ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ hal/$(RTL871X)/$(RTL871X)_cmd.o \ - hal/$(RTL871X)/hal8814a_fw.o \ + hal/$(RTL871X)/hal8814a_fw.o _HAL_INTFS_FILES += \ @@ -618,16 +560,6 @@ ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8814A_PCIE.o endif -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8814a_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8814a_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8814a_rf.o\ - hal/phydm/$(RTL871X)/halhwimg8814a_fw.o\ - hal/phydm/$(RTL871X)/phydm_iqk_8814a.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8814a.o\ - hal/phydm/$(RTL871X)/halphyrf_8814a_ce.o\ - hal/phydm/$(RTL871X)/phydm_rtl8814a.o\ - hal/phydm/txbf/haltxbf8814a.o - endif ########### HAL_RTL8723C ################################# @@ -659,7 +591,7 @@ _HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ hal/$(RTL871X)/$(RTL871X)_dm.o \ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ hal/$(RTL871X)/$(RTL871X)_cmd.o \ - hal/$(RTL871X)/hal8703b_fw.o \ + hal/$(RTL871X)/hal8703b_fw.o _HAL_INTFS_FILES += \ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ @@ -680,12 +612,6 @@ ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8703B_PCIE.o endif -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8703b_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8703b_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8703b_rf.o\ - hal/phydm/$(RTL871X)/halhwimg8703b_fw.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8703b.o\ - hal/phydm/$(RTL871X)/halphyrf_8703b.o endif ########### HAL_RTL8723D ################################# @@ -740,13 +666,6 @@ ifeq ($(CONFIG_PCI_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8723D_PCIE.o endif -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8723d_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8723d_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8723d_rf.o\ - hal/phydm/$(RTL871X)/halhwimg8723d_fw.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8723d.o\ - hal/phydm/$(RTL871X)/phydm_rtl8723d.o\ - hal/phydm/$(RTL871X)/halphyrf_8723d.o endif ########### HAL_RTL8188F ################################# @@ -775,7 +694,7 @@ _HAL_INTFS_FILES += hal/$(RTL871X)/$(RTL871X)_hal_init.o \ hal/$(RTL871X)/$(RTL871X)_dm.o \ hal/$(RTL871X)/$(RTL871X)_rxdesc.o \ hal/$(RTL871X)/$(RTL871X)_cmd.o \ - hal/$(RTL871X)/hal8188f_fw.o \ + hal/$(RTL871X)/hal8188f_fw.o _HAL_INTFS_FILES += \ hal/$(RTL871X)/$(HCI_NAME)/$(HCI_NAME)_halinit.o \ @@ -797,14 +716,6 @@ ifeq ($(CONFIG_SDIO_HCI), y) _HAL_INTFS_FILES +=hal/efuse/$(RTL871X)/HalEfuseMask8188F_SDIO.o endif -_OUTSRC_FILES += hal/phydm/$(RTL871X)/halhwimg8188f_bb.o\ - hal/phydm/$(RTL871X)/halhwimg8188f_mac.o\ - hal/phydm/$(RTL871X)/halhwimg8188f_rf.o\ - hal/phydm/$(RTL871X)/halhwimg8188f_fw.o\ - hal/phydm/$(RTL871X)/phydm_regconfig8188f.o\ - hal/phydm/$(RTL871X)/halphyrf_8188f.o \ - hal/phydm/$(RTL871X)/phydm_rtl8188f.o - endif ########### HAL_RTL8822B ################################# @@ -815,12 +726,6 @@ endif ########### HAL_RTL8821C ################################# ifeq ($(CONFIG_RTL8821C), y) include $(TopDIR)/rtl8821c.mk - -_OUTSRC_FILES += hal/phydm/rtl8821c/halhwimg8821c_testchip_bb.o \ - hal/phydm/rtl8821c/halhwimg8821c_testchip_mac.o \ - hal/phydm/rtl8821c/halhwimg8821c_testchip_rf.o \ - hal/phydm/rtl8821c/phydm_hal_api8821c.o \ - hal/phydm/rtl8821c/phydm_regconfig8821c.o endif ########### AUTO_CFG ################################# @@ -891,7 +796,7 @@ EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"$(USER_EFUSE_MAP_PATH)\" else ifeq ($(MODULE_NAME), 8189es) EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_8189e.map\" else ifeq ($(MODULE_NAME), 8723ds) -EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/firmware/wifi_efuse_8723ds.map\" +EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/vendor/etc/firmware/wifi_efuse_8723ds.map\" else EXTRA_CFLAGS += -DEFUSE_MAP_PATH=\"/system/etc/wifi/wifi_efuse_$(MODULE_NAME).map\" endif @@ -917,8 +822,7 @@ endif ifeq ($(CONFIG_LOAD_PHY_PARA_FROM_FILE), y) EXTRA_CFLAGS += -DCONFIG_LOAD_PHY_PARA_FROM_FILE #EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH_WITH_IC_NAME_FOLDER -#EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"/lib/firmware/\" -EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"\" +EXTRA_CFLAGS += -DREALTEK_CONFIG_PATH=\"/lib/firmware/\" endif ifeq ($(CONFIG_TXPWR_BY_RATE_EN), n) @@ -937,6 +841,10 @@ else ifeq ($(CONFIG_TXPWR_LIMIT_EN), auto) EXTRA_CFLAGS += -DCONFIG_TXPWR_LIMIT_EN=2 endif +ifneq ($(CONFIG_RTW_CHPLAN), 0xFF) +EXTRA_CFLAGS += -DCONFIG_RTW_CHPLAN=$(CONFIG_RTW_CHPLAN) +endif + ifeq ($(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY), y) EXTRA_CFLAGS += -DCONFIG_CALIBRATE_TX_POWER_BY_REGULATORY endif @@ -966,13 +874,10 @@ EXTRA_CFLAGS += -DCONFIG_IEEE80211W endif ifeq ($(CONFIG_WOWLAN), y) -EXTRA_CFLAGS += -DCONFIG_WOWLAN +EXTRA_CFLAGS += -DCONFIG_WOWLAN -DRTW_WAKEUP_EVENT=$(CONFIG_WAKEUP_TYPE) ifeq ($(CONFIG_SDIO_HCI), y) EXTRA_CFLAGS += -DCONFIG_RTW_SDIO_PM_KEEP_POWER endif -ifeq ($(CONFIG_DEFAULT_PATTERNS_EN), y) -EXTRA_CFLAGS += -DCONFIG_DEFAULT_PATTERNS_EN -endif endif ifeq ($(CONFIG_AP_WOWLAN), y) @@ -1018,9 +923,6 @@ EXTRA_CFLAGS += -DCONFIG_BR_EXT EXTRA_CFLAGS += '-DCONFIG_BR_EXT_BRNAME="'$(BR_NAME)'"' endif -ifeq ($(CONFIG_ANTENNA_DIVERSITY), y) -EXTRA_CFLAGS += -DCONFIG_ANTENNA_DIVERSITY -endif ifeq ($(CONFIG_TDLS), y) EXTRA_CFLAGS += -DCONFIG_TDLS @@ -1042,6 +944,17 @@ ifeq ($(CONFIG_RTW_GRO), y) EXTRA_CFLAGS += -DCONFIG_RTW_GRO endif +ifeq ($(CONFIG_RTW_REPEATER_SON), y) +EXTRA_CFLAGS += -DCONFIG_RTW_REPEATER_SON +endif + +ifeq ($(CONFIG_RTW_IPCAM_APPLICATION), y) +EXTRA_CFLAGS += -DCONFIG_RTW_IPCAM_APPLICATION +ifeq ($(CONFIG_WIFI_MONITOR), n) +EXTRA_CFLAGS += -DCONFIG_WIFI_MONITOR +endif +endif + ifeq ($(CONFIG_MP_VHT_HW_TX_MODE), y) EXTRA_CFLAGS += -DCONFIG_MP_VHT_HW_TX_MODE ifeq ($(CONFIG_PLATFORM_I386_PC), y) @@ -1074,6 +987,30 @@ KVER := $(shell uname -r) KSRC := /lib/modules/$(KVER)/build MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ INSTALL_PREFIX := +STAGINGMODDIR := /lib/modules/$(KVER)/kernel/drivers/staging +endif + +ifeq ($(CONFIG_PLATFORM_NV_TK1), y) +EXTRA_CFLAGS += -DCONFIG_PLATFORM_NV_TK1 +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +# default setting for Android 4.1, 4.2 +EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT +EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE +EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_PLATFORM_ANDROID +# Enable this for Android 5.0 +EXTRA_CFLAGS += -DCONFIG_RADIO_WORK +EXTRA_CFLAGS += -DRTW_VENDOR_EXT_SUPPORT +EXTRA_CFLAGS += -DRTW_ENABLE_WIFI_CONTROL_FUNC +ARCH ?= arm +# for ubuntu environment +#CROSS_COMPILE ?= +#KVER := $(shell uname -r) +#KSRC := /lib/modules/$(KVER)/build +#MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/ +#INSTALL_PREFIX := +CROSS_COMPILE := /mnt/newdisk/android_sdk/nvidia_tk1/android_L/prebuilts/gcc/linux-x86/arm/arm-eabi-4.8/bin/arm-eabi- +KSRC :=/mnt/newdisk/android_sdk/nvidia_tk1/android_L/out/target/product/shieldtablet/obj/KERNEL/ +MODULE_NAME = wlan endif ifeq ($(CONFIG_PLATFORM_ACTIONS_ATM702X), y) @@ -1155,8 +1092,12 @@ endif ifeq ($(CONFIG_PLATFORM_MSTAR), y) EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MSTAR -DCONFIG_USE_USB_BUFFER_ALLOC_TX -DCONFIG_FIX_NR_BULKIN_BUFFER -DCONFIG_PREALLOC_RX_SKB_BUFFER +EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN +EXTRA_CFLAGS += -DCONFIG_PLATFORM_MSTAR EXTRA_CFLAGS += -DCONFIG_PLATFORM_MSTAR_HIGH +ifeq ($(CONFIG_USB_HCI), y) +EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -DCONFIG_FIX_NR_BULKIN_BUFFER +endif ARCH:=arm CROSS_COMPILE:= /usr/src/bin/arm-none-linux-gnueabi- KVER:= 3.1.10 @@ -1174,6 +1115,7 @@ endif ifeq ($(CONFIG_PLATFORM_ANDROID_INTEL_X86), y) EXTRA_CFLAGS += -DCONFIG_PLATFORM_ANDROID_INTEL_X86 +EXTRA_CFLAGS += -DCONFIG_PLATFORM_INTEL_CHT_ANDROID60 # Kernel 3.14 but has been applied some 4.3 patch EXTRA_CFLAGS += -DCONFIG_PLATFORM_INTEL_BYT EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_ANDROID EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE @@ -1195,22 +1137,6 @@ KSRC := /home/android_sdk/android-x86_JB/out/target/product/x86/obj/kernel/ MODULE_NAME :=wlan endif -ifeq ($(CONFIG_PLATFORM_ARM_NV_TK1), y) -EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT -# default setting for Android 4.1, 4.2 -EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT -EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_PLATFORM_ANDROID -# Enable this for Android 5.0 -EXTRA_CFLAGS += -DCONFIG_RADIO_WORK -EXTRA_CFLAGS += -DRTW_VENDOR_EXT_SUPPORT -ARCH := arm -CROSS_COMPILE := /mnt/newdisk/isaac/nvidia/android_ara_5.1/prebuilts/gcc/linux-x86/arm/arm-eabi-4.8/bin/arm-eabi- -KSRC :=/mnt/newdisk/isaac/nvidia/android_ara_5.1/out/target/product/jetson/obj/kernel/ -MODULE_NAME = wlan -endif - ifeq ($(CONFIG_PLATFORM_ARM_PXA2XX), y) EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN ARCH := arm @@ -1473,17 +1399,6 @@ KVER:= 2.6.31.6 KSRC:= ../code/linux-2.6.31.6-2020/ endif -#Add setting for MN10300 -ifeq ($(CONFIG_PLATFORM_MN10300), y) -EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN -DCONFIG_PLATFORM_MN10300 -ARCH := mn10300 -CROSS_COMPILE := mn10300-linux- -KVER := 2.6.32.2 -KSRC := /home/winuser/work/Plat_sLD2T_V3010/usr/src/linux-2.6.32.2 -INSTALL_PREFIX := -endif - - ifeq ($(CONFIG_PLATFORM_ARM_SUNxI), y) EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN EXTRA_CFLAGS += -DCONFIG_PLATFORM_ARM_SUNxI @@ -1717,7 +1632,7 @@ EXTRA_CFLAGS += -DCONFIG_LITTLE_ENDIAN EXTRA_CFLAGS += -DCONFIG_TRAFFIC_PROTECT # default setting for Android 4.1, 4.2 EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE -#EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 +EXTRA_CFLAGS += -DCONFIG_IFACE_NUMBER=3 EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT #EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION @@ -1727,9 +1642,9 @@ ifeq ($(CONFIG_USB_HCI), y) EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX #_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o endif -#ifeq ($(CONFIG_SDIO_HCI), y) -#_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o -#endif +ifeq ($(CONFIG_SDIO_HCI), y) +_PLATFORM_FILES += platform/platform_ARM_SUNnI_sdio.o +endif ARCH := arm @@ -1737,8 +1652,8 @@ ARCH := arm #CROSS_COMPILE := arm-linux-gnueabihf- KVER := 3.10.24 #KSRC :=/home/android_sdk/Allwinner/a20/android-kitkat44/lichee/linux-3.4 -CROSS_COMPILE := $(CROSS) -KSRC := $(LINUX_KERNEL_PATH) +CROSS_COMPILE := /home/realtek/software_phoenix/phoenix/toolchain/usr/local/arm-2013.11/bin/arm-linux-gnueabihf- +KSRC := /home/realtek/software_phoenix/linux-kernel MODULE_NAME := 8192eu endif @@ -1752,22 +1667,31 @@ EXTRA_CFLAGS += -DCONFIG_CONCURRENT_MODE EXTRA_CFLAGS += -DCONFIG_IOCTL_CFG80211 -DRTW_USE_CFG80211_STA_EVENT #EXTRA_CFLAGS += -DCONFIG_P2P_IPS -DCONFIG_QOS_OPTIMIZATION EXTRA_CFLAGS += -DCONFIG_QOS_OPTIMIZATION +# Enable this for Android 5.0 +EXTRA_CFLAGS += -DCONFIG_RADIO_WORK +ifeq ($(CONFIG_RTL8821C)$(CONFIG_SDIO_HCI),yy) +EXTRA_CFLAGS += -DCONFIG_WAKEUP_GPIO_INPUT_MODE +EXTRA_CFLAGS += -DCONFIG_BT_WAKE_HST_OPEN_DRAIN +endif EXTRA_CFLAGS += -Wno-error=date-time - +# default setting for Android 7.0 +ifeq ($(RTK_ANDROID_VERSION), nougat) +EXTRA_CFLAGS += -DRTW_P2P_GROUP_INTERFACE=1 +endif #EXTRA_CFLAGS += -DCONFIG_#PLATFORM_OPS ifeq ($(CONFIG_USB_HCI), y) EXTRA_CFLAGS += -DCONFIG_USE_USB_BUFFER_ALLOC_TX -#_PLATFORM_FILES += platform/platform_ARM_SUNxI_usb.o endif ARCH := arm64 # ==== Cross compile setting for Android 4.4 SDK ===== #CROSS_COMPILE := arm-linux-gnueabihf- -KVER := 4.1.10 -CROSS_COMPILE := $(CROSS) -KSRC := $(LINUX_KERNEL_PATH) -MODULE_NAME := 8822be +#KVER := 4.1.10 +#CROSS_COMPILE := $(CROSS) +#KSRC := $(LINUX_KERNEL_PATH) +CROSS_COMPILE := /home/android_sdk/DHC/trunk-6.0.0_r1-QA160627/phoenix/toolchain/asdk64-4.9.4-a53-EL-3.10-g2.19-a64nt-160307/bin/asdk64-linux- +KSRC := /home/android_sdk/DHC/trunk-6.0.0_r1-QA160627/linux-kernel endif ifeq ($(CONFIG_PLATFORM_NOVATEK_NT72668), y) @@ -1795,6 +1719,14 @@ KSRC := /home/android_sdk/Telechips/v13.05_r1-tcc-android-4.2.2_tcc893x-evm_buil MODULE_NAME := wlan endif +ifeq ($(CONFIG_PLATFORM_RTL8197D), y) +EXTRA_CFLAGS += -DCONFIG_BIG_ENDIAN -DCONFIG_PLATFORM_RTL8197D +export DIR_LINUX=$(shell pwd)/../SDK/rlxlinux-sdk321-v50/linux-2.6.30 +ARCH ?= rlx +CROSS_COMPILE:= $(DIR_LINUX)/../toolchain/rsdk-1.5.5-5281-EB-2.6.30-0.9.30.3-110714/bin/rsdk-linux- +KSRC := $(DIR_LINUX) +endif + ifeq ($(CONFIG_MULTIDRV), y) ifeq ($(CONFIG_SDIO_HCI), y) @@ -1838,13 +1770,17 @@ rtk_core := core/rtw_cmd.o \ core/rtw_ap.o \ core/rtw_xmit.o \ core/rtw_p2p.o \ + core/rtw_rson.o \ core/rtw_tdls.o \ core/rtw_br_ext.o \ core/rtw_iol.o \ core/rtw_sreset.o \ + core/rtw_btcoex_wifionly.o \ core/rtw_btcoex.o \ core/rtw_beamforming.o \ core/rtw_odm.o \ + core/rtw_rm.o \ + core/rtw_rm_fsm.o \ core/efuse/rtw_efuse.o ifeq ($(CONFIG_SDIO_HCI), y) @@ -1860,7 +1796,8 @@ $(MODULE_NAME)-$(CONFIG_WAPI_SUPPORT) += core/rtw_wapi.o \ $(MODULE_NAME)-y += $(_OS_INTFS_FILES) $(MODULE_NAME)-y += $(_HAL_INTFS_FILES) -$(MODULE_NAME)-y += $(_OUTSRC_FILES) +$(MODULE_NAME)-y += $(_PHYDM_FILES) +$(MODULE_NAME)-y += $(_BTC_FILES) $(MODULE_NAME)-y += $(_PLATFORM_FILES) $(MODULE_NAME)-$(CONFIG_MP_INCLUDED) += core/rtw_mp.o @@ -1891,6 +1828,40 @@ uninstall: rm -f $(MODDESTDIR)/$(MODULE_NAME).ko /sbin/depmod -a ${KVER} +backup_rtlwifi: + @echo "Making backup rtlwifi drivers" +ifneq (,$(wildcard $(STAGINGMODDIR)/rtl*)) + @tar cPf $(wildcard $(STAGINGMODDIR))/backup_rtlwifi_driver.tar $(wildcard $(STAGINGMODDIR)/rtl*) + @rm -rf $(wildcard $(STAGINGMODDIR)/rtl*) +endif +ifneq (,$(wildcard $(MODDESTDIR)realtek)) + @tar cPf $(MODDESTDIR)backup_rtlwifi_driver.tar $(MODDESTDIR)realtek + @rm -fr $(MODDESTDIR)realtek +endif +ifneq (,$(wildcard $(MODDESTDIR)rtl*)) + @tar cPf $(MODDESTDIR)../backup_rtlwifi_driver.tar $(wildcard $(MODDESTDIR)rtl*) + @rm -fr $(wildcard $(MODDESTDIR)rtl*) +endif + @/sbin/depmod -a ${KVER} + @echo "Please reboot your system" + +restore_rtlwifi: + @echo "Restoring backups" +ifneq (,$(wildcard $(STAGINGMODDIR)/backup_rtlwifi_driver.tar)) + @tar xPf $(STAGINGMODDIR)/backup_rtlwifi_driver.tar + @rm $(STAGINGMODDIR)/backup_rtlwifi_driver.tar +endif +ifneq (,$(wildcard $(MODDESTDIR)backup_rtlwifi_driver.tar)) + @tar xPf $(MODDESTDIR)backup_rtlwifi_driver.tar + @rm $(MODDESTDIR)backup_rtlwifi_driver.tar +endif +ifneq (,$(wildcard $(MODDESTDIR)../backup_rtlwifi_driver.tar)) + @tar xPf $(MODDESTDIR)../backup_rtlwifi_driver.tar + @rm $(MODDESTDIR)../backup_rtlwifi_driver.tar +endif + @/sbin/depmod -a ${KVER} + @echo "Please reboot your system" + config_r: @echo "make config" /bin/bash script/Configure script/config.in diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/efuse/rtw_efuse.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/efuse/rtw_efuse.c index b9a17703aea0..83d6c441de5a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/efuse/rtw_efuse.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/efuse/rtw_efuse.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_EFUSE_C_ #include @@ -113,10 +108,10 @@ BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) return (IS_MASKED(8723D, _MUSB, Offset)) ? TRUE : FALSE; #endif - /*#if defined(CONFIG_RTL8821C) - if (IS_HARDWARE_TYPE_8821C(pAdapter)) - return (IS_MASKED(8821C,_MUSB,Offset)) ? TRUE : FALSE; - #endif*/ +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CU(pAdapter)) + return (IS_MASKED(8821C, _MUSB, Offset)) ? TRUE : FALSE; +#endif #elif DEV_BUS_TYPE == RT_PCI_INTERFACE #if defined(CONFIG_RTL8188E) @@ -147,16 +142,40 @@ BOOLEAN efuse_IsMasked(PADAPTER pAdapter, u16 Offset) if (IS_HARDWARE_TYPE_8822B(pAdapter)) return (IS_MASKED(8822B, _MPCIE, Offset)) ? TRUE : FALSE; #endif +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CE(pAdapter)) + return (IS_MASKED(8821C, _MPCIE, Offset)) ? TRUE : FALSE; +#endif #elif DEV_BUS_TYPE == RT_SDIO_INTERFACE #ifdef CONFIG_RTL8188E_SDIO if (IS_HARDWARE_TYPE_8188E(pAdapter)) return (IS_MASKED(8188E, _MSDIO, Offset)) ? TRUE : FALSE; #endif +#ifdef CONFIG_RTL8723B + if (IS_HARDWARE_TYPE_8723BS(pAdapter)) + return (IS_MASKED(8723B, _MSDIO, Offset)) ? TRUE : FALSE; +#endif #ifdef CONFIG_RTL8188F_SDIO if (IS_HARDWARE_TYPE_8188F(pAdapter)) return (IS_MASKED(8188F, _MSDIO, Offset)) ? TRUE : FALSE; #endif +#ifdef CONFIG_RTL8192E + if (IS_HARDWARE_TYPE_8192ES(pAdapter)) + return (IS_MASKED(8192E, _MSDIO, Offset)) ? TRUE : FALSE; +#endif +#if defined(CONFIG_RTL8821A) + if (IS_HARDWARE_TYPE_8821S(pAdapter)) + return (IS_MASKED(8821A, _MSDIO, Offset)) ? TRUE : FALSE; +#endif +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CS(pAdapter)) + return (IS_MASKED(8821C, _MSDIO, Offset)) ? TRUE : FALSE; +#endif +#if defined(CONFIG_RTL8822B) + if (IS_HARDWARE_TYPE_8822B(pAdapter)) + return (IS_MASKED(8822B, _MSDIO, Offset)) ? TRUE : FALSE; +#endif #endif return FALSE; @@ -203,10 +222,12 @@ void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) if (IS_HARDWARE_TYPE_8822B(pAdapter)) GET_MASK_ARRAY(8822B, _MUSB, pArray); #endif - /*#if defined(CONFIG_RTL8821C) - if (IS_HARDWARE_TYPE_8821C(pAdapter)) - GET_MASK_ARRAY(8821C,_MUSB,pArray); - #endif*/ +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CU(pAdapter)) + GET_MASK_ARRAY(8821C, _MUSB, pArray); +#endif + + #elif DEV_BUS_TYPE == RT_PCI_INTERFACE #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) @@ -236,15 +257,41 @@ void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray) if (IS_HARDWARE_TYPE_8822B(pAdapter)) GET_MASK_ARRAY(8822B, _MPCIE, pArray); #endif +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CE(pAdapter)) + GET_MASK_ARRAY(8821C, _MPCIE, pArray); +#endif + + #elif DEV_BUS_TYPE == RT_SDIO_INTERFACE #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) GET_MASK_ARRAY(8188E, _MSDIO, pArray); #endif +#if defined(CONFIG_RTL8723B) + if (IS_HARDWARE_TYPE_8723BS(pAdapter)) + GET_MASK_ARRAY(8723B, _MSDIO, pArray); +#endif #if defined(CONFIG_RTL8188F) if (IS_HARDWARE_TYPE_8188F(pAdapter)) GET_MASK_ARRAY(8188F, _MSDIO, pArray); #endif +#if defined(CONFIG_RTL8192E) + if (IS_HARDWARE_TYPE_8192ES(pAdapter)) + GET_MASK_ARRAY(8192E, _MSDIO, pArray); +#endif +#if defined(CONFIG_RTL8821A) + if (IS_HARDWARE_TYPE_8821S(pAdapter)) + GET_MASK_ARRAY(8821A, _MSDIO, pArray); +#endif +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CS(pAdapter)) + GET_MASK_ARRAY(8821C , _MSDIO, pArray); +#endif +#if defined(CONFIG_RTL8822B) + if (IS_HARDWARE_TYPE_8822B(pAdapter)) + GET_MASK_ARRAY(8822B , _MSDIO, pArray); +#endif #endif /*#elif DEV_BUS_TYPE == RT_SDIO_INTERFACE*/ } @@ -289,10 +336,12 @@ u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) if (IS_HARDWARE_TYPE_8822B(pAdapter)) return GET_MASK_ARRAY_LEN(8822B, _MUSB); #endif - /*#if defined(CONFIG_RTL8821C) - if (IS_HARDWARE_TYPE_8821C(pAdapter)) - return GET_MASK_ARRAY_LEN(8821C,_MUSB); - #endif*/ +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CU(pAdapter)) + return GET_MASK_ARRAY_LEN(8821C, _MUSB); +#endif + + #elif DEV_BUS_TYPE == RT_PCI_INTERFACE #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) @@ -322,20 +371,358 @@ u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter) if (IS_HARDWARE_TYPE_8822B(pAdapter)) return GET_MASK_ARRAY_LEN(8822B, _MPCIE); #endif +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CE(pAdapter)) + return GET_MASK_ARRAY_LEN(8821C, _MPCIE); +#endif + + #elif DEV_BUS_TYPE == RT_SDIO_INTERFACE #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(pAdapter)) return GET_MASK_ARRAY_LEN(8188E, _MSDIO); #endif +#if defined(CONFIG_RTL8723B) + if (IS_HARDWARE_TYPE_8723BS(pAdapter)) + return GET_MASK_ARRAY_LEN(8723B, _MSDIO); +#endif #if defined(CONFIG_RTL8188F) if (IS_HARDWARE_TYPE_8188F(pAdapter)) return GET_MASK_ARRAY_LEN(8188F, _MSDIO); #endif - +#if defined(CONFIG_RTL8192E) + if (IS_HARDWARE_TYPE_8192ES(pAdapter)) + return GET_MASK_ARRAY_LEN(8192E, _MSDIO); +#endif +#if defined(CONFIG_RTL8821A) + if (IS_HARDWARE_TYPE_8821S(pAdapter)) + return GET_MASK_ARRAY_LEN(8821A, _MSDIO); +#endif +#if defined(CONFIG_RTL8821C) + if (IS_HARDWARE_TYPE_8821CS(pAdapter)) + return GET_MASK_ARRAY_LEN(8821C, _MSDIO); +#endif +#if defined(CONFIG_RTL8822B) + if (IS_HARDWARE_TYPE_8822B(pAdapter)) + return GET_MASK_ARRAY_LEN(8822B, _MSDIO); +#endif #endif return 0; } +static void rtw_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) +{ + u16 i = 0; + + if (padapter->registrypriv.boffefusemask == 0) { + + for (i = 0; i < cnts; i++) { + if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { + if (rtw_file_efuse_IsMasked(padapter, addr + i)) /*use file efuse mask.*/ + data[i] = 0xff; + } else { + /*RTW_INFO(" %s , data[%d] = %x\n", __func__, i, data[i]);*/ + if (efuse_IsMasked(padapter, addr + i)) { + data[i] = 0xff; + /*RTW_INFO(" %s ,mask data[%d] = %x\n", __func__, i, data[i]);*/ + } + } + } + + } +} + +u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) +{ + u8 ret = _SUCCESS; + u16 mapLen = 0; + + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); + + ret = rtw_efuse_map_read(padapter, addr, cnts , data); + + rtw_mask_map_read(padapter, addr, cnts , data); + + return ret; + +} + +/* *********************************************************** + * Efuse related code + * *********************************************************** */ +static u8 hal_EfuseSwitchToBank( + PADAPTER padapter, + u8 bank, + u8 bPseudoTest) +{ + u8 bRet = _FALSE; + u32 value32 = 0; +#ifdef HAL_EFUSE_MEMORY + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; +#endif + + + RTW_INFO("%s: Efuse switch bank to %d\n", __FUNCTION__, bank); + if (bPseudoTest) { +#ifdef HAL_EFUSE_MEMORY + pEfuseHal->fakeEfuseBank = bank; +#else + fakeEfuseBank = bank; +#endif + bRet = _TRUE; + } else { + value32 = rtw_read32(padapter, 0x34); + bRet = _TRUE; + switch (bank) { + case 0: + value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); + break; + case 1: + value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_0); + break; + case 2: + value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_1); + break; + case 3: + value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_BT_SEL_2); + break; + default: + value32 = (value32 & ~EFUSE_SEL_MASK) | EFUSE_SEL(EFUSE_WIFI_SEL_0); + bRet = _FALSE; + break; + } + rtw_write32(padapter, 0x34, value32); + } + + return bRet; +} + +void rtw_efuse_analyze(PADAPTER padapter, u8 Type, u8 Fake) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + PEFUSE_HAL pEfuseHal = &(pHalData->EfuseHal); + u16 eFuse_Addr = 0; + u8 offset, wden; + u16 i, j; + u8 u1temp = 0; + u8 efuseHeader = 0, efuseExtHdr = 0, efuseData[EFUSE_MAX_WORD_UNIT*2] = {0}, dataCnt = 0; + u16 efuseHeader2Byte = 0; + u8 *eFuseWord = NULL;// [EFUSE_MAX_SECTION_NUM][EFUSE_MAX_WORD_UNIT]; + u8 offset_2_0 = 0; + u8 pgSectionCnt = 0; + u8 wd_cnt = 0; + u8 max_section = 64; + u16 mapLen = 0, maprawlen = 0; + boolean bExtHeader = _FALSE; + u8 efuseType = EFUSE_WIFI; + boolean bPseudoTest = _FALSE; + u8 bank = 0, startBank = 0, endBank = 1-1; + boolean bCheckNextBank = FALSE; + u8 protectBytesBank = 0; + u16 efuse_max = 0; + u8 ParseEfuseExtHdr, ParseEfuseHeader, ParseOffset, ParseWDEN, ParseOffset2_0; + + eFuseWord = rtw_zmalloc(EFUSE_MAX_SECTION_NUM * (EFUSE_MAX_WORD_UNIT * 2)); + + RTW_INFO("\n"); + if (Type == 0) { + if (Fake == 0) { + RTW_INFO("\n\tEFUSE_Analyze Wifi Content\n"); + efuseType = EFUSE_WIFI; + bPseudoTest = FALSE; + startBank = 0; + endBank = 0; + } else { + RTW_INFO("\n\tEFUSE_Analyze Wifi Pseudo Content\n"); + efuseType = EFUSE_WIFI; + bPseudoTest = TRUE; + startBank = 0; + endBank = 0; + } + } else { + if (Fake == 0) { + RTW_INFO("\n\tEFUSE_Analyze BT Content\n"); + efuseType = EFUSE_BT; + bPseudoTest = FALSE; + startBank = 1; + endBank = EFUSE_MAX_BANK - 1; + } else { + RTW_INFO("\n\tEFUSE_Analyze BT Pseudo Content\n"); + efuseType = EFUSE_BT; + bPseudoTest = TRUE; + startBank = 1; + endBank = EFUSE_MAX_BANK - 1; + if (IS_HARDWARE_TYPE_8821(padapter)) + endBank = 3 - 1;/*EFUSE_MAX_BANK_8821A - 1;*/ + } + } + + RTW_INFO("\n\r 1Byte header, [7:4]=offset, [3:0]=word enable\n"); + RTW_INFO("\n\r 2Byte header, header[7:5]=offset[2:0], header[4:0]=0x0F\n"); + RTW_INFO("\n\r 2Byte header, extHeader[7:4]=offset[6:3], extHeader[3:0]=word enable\n"); + + EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_MAX_SECTION, (PVOID)&max_section, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_PROTECT_BYTES_BANK, (PVOID)&protectBytesBank, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, efuseType, TYPE_EFUSE_CONTENT_LEN_BANK, (PVOID)&efuse_max, bPseudoTest); + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&maprawlen, _FALSE); + + _rtw_memset(eFuseWord, 0xff, EFUSE_MAX_SECTION_NUM * (EFUSE_MAX_WORD_UNIT * 2)); + _rtw_memset(pEfuseHal->fakeEfuseInitMap, 0xff, EFUSE_MAX_MAP_LEN); + + if (IS_HARDWARE_TYPE_8821(padapter)) + endBank = 3 - 1;/*EFUSE_MAX_BANK_8821A - 1;*/ + + for (bank = startBank; bank <= endBank; bank++) { + if (!hal_EfuseSwitchToBank(padapter, bank, bPseudoTest)) { + RTW_INFO("EFUSE_SwitchToBank() Fail!!\n"); + return; + } + + eFuse_Addr = bank * EFUSE_MAX_BANK_SIZE; + + efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); + + if (efuseHeader == 0xFF && bank == startBank && Fake != TRUE) { + RTW_INFO("Non-PGed Efuse\n"); + return; + } + RTW_INFO("EFUSE_REAL_CONTENT_LEN = %d\n", maprawlen); + + while ((efuseHeader != 0xFF) && ((efuseType == EFUSE_WIFI && (eFuse_Addr < maprawlen)) || (efuseType == EFUSE_BT && (eFuse_Addr < (endBank + 1) * EFUSE_MAX_BANK_SIZE)))) { + + RTW_INFO("Analyzing: Offset: 0x%X\n", eFuse_Addr); + + /* Check PG header for section num.*/ + if (EXT_HEADER(efuseHeader)) { + bExtHeader = TRUE; + offset_2_0 = GET_HDR_OFFSET_2_0(efuseHeader); + efuse_OneByteRead(padapter, eFuse_Addr++, &efuseExtHdr, bPseudoTest); + + if (efuseExtHdr != 0xff) { + if (ALL_WORDS_DISABLED(efuseExtHdr)) { + /* Read next pg header*/ + efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); + continue; + } else { + offset = ((efuseExtHdr & 0xF0) >> 1) | offset_2_0; + wden = (efuseExtHdr & 0x0F); + efuseHeader2Byte = (efuseExtHdr<<8)|efuseHeader; + RTW_INFO("Find efuseHeader2Byte = 0x%04X, offset=%d, wden=0x%x\n", + efuseHeader2Byte, offset, wden); + } + } else { + RTW_INFO("Error, efuse[%d]=0xff, efuseExtHdr=0xff\n", eFuse_Addr-1); + break; + } + } else { + offset = ((efuseHeader >> 4) & 0x0f); + wden = (efuseHeader & 0x0f); + } + + _rtw_memset(efuseData, '\0', EFUSE_MAX_WORD_UNIT * 2); + dataCnt = 0; + + if (offset < max_section) { + for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { + /* Check word enable condition in the section */ + if (!(wden & (0x01<> 8; + ParseEfuseHeader = (efuseHeader2Byte & 0xff); + ParseOffset2_0 = GET_HDR_OFFSET_2_0(ParseEfuseHeader); + ParseOffset = ((ParseEfuseExtHdr & 0xF0) >> 1) | ParseOffset2_0; + ParseWDEN = (ParseEfuseExtHdr & 0x0F); + RTW_INFO("Header=0x%x, ExtHeader=0x%x, ", ParseEfuseHeader, ParseEfuseExtHdr); + } else { + ParseEfuseHeader = efuseHeader; + ParseOffset = ((ParseEfuseHeader >> 4) & 0x0f); + ParseWDEN = (ParseEfuseHeader & 0x0f); + RTW_INFO("Header=0x%x, ", ParseEfuseHeader); + } + RTW_INFO("offset=0x%x(%d), word enable=0x%x\n", ParseOffset, ParseOffset, ParseWDEN); + + wd_cnt = 0; + for (i = 0; i < EFUSE_MAX_WORD_UNIT; i++) { + if (!(wden & (0x01 << i))) { + RTW_INFO("Map[ %02X ] = %02X %02X\n", ((offset * EFUSE_MAX_WORD_UNIT * 2) + (i * 2)), efuseData[wd_cnt * 2 + 0], efuseData[wd_cnt * 2 + 1]); + wd_cnt++; + } + } + + pgSectionCnt++; + bExtHeader = FALSE; + efuse_OneByteRead(padapter, eFuse_Addr++, &efuseHeader, bPseudoTest); + if (efuseHeader == 0xFF) { + if ((eFuse_Addr + protectBytesBank) >= efuse_max) + bCheckNextBank = TRUE; + else + bCheckNextBank = FALSE; + } + } + if (!bCheckNextBank) { + RTW_INFO("Not need to check next bank, eFuse_Addr=%d, protectBytesBank=%d, efuse_max=%d\n", + eFuse_Addr, protectBytesBank, efuse_max); + break; + } + } + /* switch bank back to 0 for BT/wifi later use*/ + hal_EfuseSwitchToBank(padapter, 0, bPseudoTest); + + /* 3. Collect 16 sections and 4 word unit into Efuse map.*/ + for (i = 0; i < max_section; i++) { + for (j = 0; j < EFUSE_MAX_WORD_UNIT; j++) { + pEfuseHal->fakeEfuseInitMap[(i*8)+(j*2)] = (eFuseWord[(i*8)+(j*2)]); + pEfuseHal->fakeEfuseInitMap[(i*8)+((j*2)+1)] = (eFuseWord[(i*8)+((j*2)+1)]); + } + } + + RTW_INFO("\n\tEFUSE Analyze Map\n"); + i = 0; + j = 0; + + for (i = 0; i < mapLen; i++) { + if (i % 16 == 0) + RTW_PRINT_SEL(RTW_DBGDUMP, "0x%03x: ", i); + _RTW_PRINT_SEL(RTW_DBGDUMP, "%02X%s" + , pEfuseHal->fakeEfuseInitMap[i] + , ((i + 1) % 16 == 0) ? "\n" : (((i + 1) % 8 == 0) ? " " : " ") + ); + } + _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); + if (eFuseWord) + rtw_mfree((u8 *)eFuseWord, EFUSE_MAX_SECTION_NUM * (EFUSE_MAX_WORD_UNIT * 2)); +} + #ifdef RTW_HALMAC #include "../../hal/hal_halmac.h" @@ -369,16 +756,45 @@ u16 efuse_GetMaxSize(PADAPTER adapter) return size; } -u8 efuse_bt_GetCurrentSize(PADAPTER adapter, u16 *size) +u16 efuse_GetavailableSize(PADAPTER adapter) { - *size = 0; + struct dvobj_priv *d; + u32 size = 0; + int err; - return _FAIL; + d = adapter_to_dvobj(adapter); + err = rtw_halmac_get_available_efuse_size(d, &size); + if (err) + return 0; + + return size; +} + + +u8 efuse_bt_GetCurrentSize(PADAPTER adapter, u16 *usesize) +{ + u8 *efuse_map; + + *usesize = 0; + efuse_map = rtw_malloc(EFUSE_BT_MAP_LEN); + if (efuse_map == NULL) { + RTW_DBG("%s: malloc FAIL\n", __FUNCTION__); + return _FAIL; + } + + /* for get bt phy efuse last use byte */ + hal_ReadEFuse_BT_logic_map(adapter, 0x00, EFUSE_BT_MAP_LEN, efuse_map); + *usesize = fakeBTEfuseUsedBytes; + + if (efuse_map) + rtw_mfree(efuse_map, EFUSE_BT_MAP_LEN); + + return _SUCCESS; } u16 efuse_bt_GetMaxSize(PADAPTER adapter) { - return 0; + return EFUSE_BT_REAL_CONTENT_LEN; } void EFUSE_GetEfuseDefinition(PADAPTER adapter, u8 efusetype, u8 type, void *out, BOOLEAN test) @@ -389,8 +805,8 @@ void EFUSE_GetEfuseDefinition(PADAPTER adapter, u8 efusetype, u8 type, void *out d = adapter_to_dvobj(adapter); - if (adapter->HalFunc.EFUSEGetEfuseDefinition) { - adapter->HalFunc.EFUSEGetEfuseDefinition(adapter, efusetype, type, out, test); + if (adapter->hal_func.EFUSEGetEfuseDefinition) { + adapter->hal_func.EFUSEGetEfuseDefinition(adapter, efusetype, type, out, test); return; } @@ -400,6 +816,21 @@ void EFUSE_GetEfuseDefinition(PADAPTER adapter, u8 efusetype, u8 type, void *out rtw_halmac_get_logical_efuse_size(d, &v32); *(u16 *)out = (u16)v32; return; + + case TYPE_EFUSE_REAL_CONTENT_LEN: + rtw_halmac_get_physical_efuse_size(d, &v32); + *(u16 *)out = (u16)v32; + return; + } + } else if (EFUSE_BT == efusetype) { + switch (type) { + case TYPE_EFUSE_MAP_LEN: + *(u16 *)out = EFUSE_BT_MAP_LEN; + return; + + case TYPE_EFUSE_REAL_CONTENT_LEN: + *(u16 *)out = EFUSE_BT_REAL_CONTENT_LEN; + return; } } } @@ -473,7 +904,7 @@ u8 rtw_efuse_bt_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data) d = adapter_to_dvobj(adapter); - size = EFUSE_BT_REAL_BANK_CONTENT_LEN; + size = EFUSE_BT_REAL_CONTENT_LEN; if ((addr + cnts) > size) return _FAIL; @@ -498,8 +929,9 @@ u8 rtw_efuse_bt_access(PADAPTER adapter, u8 write, u16 addr, u16 cnts, u8 *data) } dump_buf(efuse + addr, cnts); - RTW_INFO("%s: rtw_halmac_read_bt_physical_efuse_map ok!\n", __FUNCTION__); _rtw_memcpy(data, efuse + addr, cnts); + + RTW_INFO("%s: rtw_halmac_read_bt_physical_efuse_map ok! data 0x%x\n", __FUNCTION__, *data); rtw_mfree(efuse, size); } } @@ -532,7 +964,7 @@ u8 rtw_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) efuse = rtw_zmalloc(size); if (efuse) { - err = rtw_halmac_read_logical_efuse_map(d, efuse, size); + err = rtw_halmac_read_logical_efuse_map(d, efuse, size, NULL, 0); if (err) { rtw_mfree(efuse, size); return _FAIL; @@ -549,11 +981,6 @@ u8 rtw_efuse_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) return _SUCCESS; } -u8 rtw_efuse_mask_map_read(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) -{ - return rtw_efuse_map_read(adapter, addr, cnts, data); -} - u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) { struct dvobj_priv *d; @@ -575,7 +1002,7 @@ u8 rtw_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) if (!efuse) return _FAIL; - err = rtw_halmac_read_logical_efuse_map(d, efuse, size); + err = rtw_halmac_read_logical_efuse_map(d, efuse, size, NULL, 0); if (err) { rtw_mfree(efuse, size); return _FAIL; @@ -658,7 +1085,7 @@ u8 rtw_BT_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) if (ret == _FAIL) goto exit; RTW_INFO("OFFSET\tVALUE(hex)\n"); - for (i = 0; i < 1024; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ + for (i = 0; i < mapLen; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ RTW_INFO("0x%03x\t", i); for (j = 0; j < 8; j++) RTW_INFO("%02X ", map[i + j]); @@ -683,13 +1110,13 @@ u8 rtw_BT_efuse_map_write(PADAPTER adapter, u16 addr, u16 cnts, u8 *data) } if (word_en != 0xF) { + ret = EfusePgPacketWrite_BT(adapter, offset, word_en, newdata, _FALSE); RTW_INFO("offset=%x\n", offset); RTW_INFO("word_en=%x\n", word_en); RTW_INFO("%s: data=", __FUNCTION__); for (i = 0; i < PGPKT_DATA_SIZE; i++) RTW_INFO("0x%02X ", newdata[i]); RTW_INFO("\n"); - ret = EfusePgPacketWrite_BT(adapter, offset, word_en, newdata, _FALSE); if (ret == _FAIL) break; } @@ -729,7 +1156,7 @@ VOID hal_ReadEFuse_BT_logic_map( } efuseTbl = rtw_malloc(EFUSE_BT_MAP_LEN); - phyefuse = rtw_malloc(EFUSE_BT_REAL_BANK_CONTENT_LEN); + phyefuse = rtw_malloc(EFUSE_BT_REAL_CONTENT_LEN); if (efuseTbl == NULL || phyefuse == NULL) { RTW_INFO("%s: efuseTbl or phyefuse malloc fail!\n", __FUNCTION__); goto exit; @@ -737,9 +1164,9 @@ VOID hal_ReadEFuse_BT_logic_map( /* 0xff will be efuse default value instead of 0x00. */ _rtw_memset(efuseTbl, 0xFF, EFUSE_BT_MAP_LEN); - _rtw_memset(phyefuse, 0xFF, EFUSE_BT_REAL_BANK_CONTENT_LEN); + _rtw_memset(phyefuse, 0xFF, EFUSE_BT_REAL_CONTENT_LEN); - if(rtw_efuse_bt_access(padapter, _FALSE, 0, EFUSE_BT_REAL_BANK_CONTENT_LEN, phyefuse)) + if (rtw_efuse_bt_access(padapter, _FALSE, 0, EFUSE_BT_REAL_CONTENT_LEN, phyefuse)) dump_buf(phyefuse, EFUSE_BT_REAL_BANK_CONTENT_LEN); total = BANK_NUM; @@ -828,6 +1255,7 @@ VOID hal_ReadEFuse_BT_logic_map( efuse_usage = 100; fakeBTEfuseUsedBytes = used; + RTW_INFO("%s: BTEfuseUsed last Bytes = %#x\n", __FUNCTION__, fakeBTEfuseUsedBytes); exit: if (efuseTbl) @@ -1091,9 +1519,168 @@ hal_EfusePgPacketWriteData( if (badworden != 0x0F) { RTW_INFO("%s: Fail!!\n", __FUNCTION__); return _FALSE; + } else + RTW_INFO("%s: OK!!\n", __FUNCTION__); + + return _TRUE; +} + + +#define EFUSE_CTRL 0x30 /* E-Fuse Control. */ + +/* 11/16/2008 MH Read one byte from real Efuse. */ +u8 +efuse_OneByteRead( + IN PADAPTER pAdapter, + IN u16 addr, + IN u8 *data, + IN BOOLEAN bPseudoTest) +{ + u32 tmpidx = 0; + u8 bResult; + u8 readbyte; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); + + if (IS_HARDWARE_TYPE_8723B(pAdapter) || + (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->version_id))) || + (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->version_id)) + ) { + /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ + /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ + /* phy_set_mac_reg(pAdapter, 0x34, BIT11, 0); */ + rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter, 0x34) & (~BIT11)); } - /* RTW_INFO("%s: ok\n", __FUNCTION__); */ + /* -----------------e-fuse reg ctrl --------------------------------- */ + /* address */ + rtw_write8(pAdapter, EFUSE_CTRL + 1, (u8)(addr & 0xff)); + rtw_write8(pAdapter, EFUSE_CTRL + 2, ((u8)((addr >> 8) & 0x03)) | + (rtw_read8(pAdapter, EFUSE_CTRL + 2) & 0xFC)); + + /* rtw_write8(pAdapter, EFUSE_CTRL+3, 0x72); */ /* read cmd */ + /* Write bit 32 0 */ + readbyte = rtw_read8(pAdapter, EFUSE_CTRL + 3); + rtw_write8(pAdapter, EFUSE_CTRL + 3, (readbyte & 0x7f)); + + while (!(0x80 & rtw_read8(pAdapter, EFUSE_CTRL + 3)) && (tmpidx < 1000)) { + rtw_mdelay_os(1); + tmpidx++; + } + if (tmpidx < 100) { + *data = rtw_read8(pAdapter, EFUSE_CTRL); + bResult = _TRUE; + } else { + *data = 0xff; + bResult = _FALSE; + RTW_INFO("%s: [ERROR] addr=0x%x bResult=%d time out 1s !!!\n", __FUNCTION__, addr, bResult); + RTW_INFO("%s: [ERROR] EFUSE_CTRL =0x%08x !!!\n", __FUNCTION__, rtw_read32(pAdapter, EFUSE_CTRL)); + } + + return bResult; +} + + +static u16 +hal_EfuseGetCurrentSize_BT( + PADAPTER padapter, + u8 bPseudoTest) +{ +#ifdef HAL_EFUSE_MEMORY + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; +#endif + u16 btusedbytes; + u16 efuse_addr; + u8 bank, startBank; + u8 hoffset = 0, hworden = 0; + u8 efuse_data, word_cnts = 0; + u16 retU2 = 0; + u8 bContinual = _TRUE; + + + btusedbytes = fakeBTEfuseUsedBytes; + + efuse_addr = (u16)((btusedbytes % EFUSE_BT_REAL_BANK_CONTENT_LEN)); + startBank = (u8)(1 + (btusedbytes / EFUSE_BT_REAL_BANK_CONTENT_LEN)); + + RTW_INFO("%s: start from bank=%d addr=0x%X\n", __FUNCTION__, startBank, efuse_addr); + retU2 = EFUSE_BT_REAL_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK; + + for (bank = startBank; bank < 3; bank++) { + if (hal_EfuseSwitchToBank(padapter, bank, bPseudoTest) == _FALSE) { + RTW_ERR("%s: switch bank(%d) Fail!!\n", __FUNCTION__, bank); + /* bank = EFUSE_MAX_BANK; */ + break; + } + + /* only when bank is switched we have to reset the efuse_addr. */ + if (bank != startBank) + efuse_addr = 0; + + + while (AVAILABLE_EFUSE_ADDR(efuse_addr)) { + if (rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &efuse_data) == _FALSE) { + RTW_ERR("%s: efuse_OneByteRead Fail! addr=0x%X !!\n", __FUNCTION__, efuse_addr); + /* bank = EFUSE_MAX_BANK; */ + break; + } + RTW_INFO("%s: efuse_OneByteRead ! addr=0x%X !efuse_data=0x%X! bank =%d\n", __FUNCTION__, efuse_addr, efuse_data, bank); + + if (efuse_data == 0xFF) + break; + + if (EXT_HEADER(efuse_data)) { + hoffset = GET_HDR_OFFSET_2_0(efuse_data); + efuse_addr++; + rtw_efuse_bt_access(padapter, _FALSE, efuse_addr, 1, &efuse_data); + RTW_INFO("%s: efuse_OneByteRead EXT_HEADER ! addr=0x%X !efuse_data=0x%X! bank =%d\n", __FUNCTION__, efuse_addr, efuse_data, bank); + + if (ALL_WORDS_DISABLED(efuse_data)) { + efuse_addr++; + continue; + } + + /* hoffset = ((hoffset & 0xE0) >> 5) | ((efuse_data & 0xF0) >> 1); */ + hoffset |= ((efuse_data & 0xF0) >> 1); + hworden = efuse_data & 0x0F; + } else { + hoffset = (efuse_data >> 4) & 0x0F; + hworden = efuse_data & 0x0F; + } + + RTW_INFO(FUNC_ADPT_FMT": Offset=%d Worden=%#X\n", + FUNC_ADPT_ARG(padapter), hoffset, hworden); + + word_cnts = Efuse_CalculateWordCnts(hworden); + /* read next header */ + efuse_addr += (word_cnts * 2) + 1; + } + /* Check if we need to check next bank efuse */ + if (efuse_addr < retU2) + break;/* don't need to check next bank. */ + } + retU2 = ((bank - 1) * EFUSE_BT_REAL_BANK_CONTENT_LEN) + efuse_addr; + + fakeBTEfuseUsedBytes = retU2; + RTW_INFO("%s: CurrentSize=%d\n", __FUNCTION__, retU2); + return retU2; +} + + +static u8 +hal_BT_EfusePgCheckAvailableAddr( + PADAPTER pAdapter, + u8 bPseudoTest) +{ + u16 max_available = EFUSE_BT_REAL_CONTENT_LEN - EFUSE_PROTECT_BYTES_BANK; + u16 current_size = 0; + + RTW_INFO("%s: max_available=%d\n", __FUNCTION__, max_available); + current_size = hal_EfuseGetCurrentSize_BT(pAdapter, bPseudoTest); + if (current_size >= max_available) { + RTW_INFO("%s: Error!! current_size(%d)>max_available(%d)\n", __FUNCTION__, current_size, max_available); + return _FALSE; + } return _TRUE; } @@ -1108,6 +1695,9 @@ u8 EfusePgPacketWrite_BT( u16 startAddr = 0; u8 efuseType = EFUSE_BT; + if (!hal_BT_EfusePgCheckAvailableAddr(pAdapter, bPseudoTest)) + return _FALSE; + hal_EfuseConstructPGPkt(offset, word_en, pData, &targetPkt); if (!hal_EfusePartialWriteCheck(pAdapter, efuseType, &startAddr, &targetPkt, bPseudoTest)) @@ -1129,6 +1719,48 @@ u8 EfusePgPacketWrite_BT( #define EFUSE_CTRL REG_EFUSE_CTRL /* E-Fuse Control. */ /* ------------------------------------------------------------------------------ */ +VOID efuse_PreUpdateAction( + PADAPTER pAdapter, + pu4Byte BackupRegs) +{ +#if defined(CONFIG_RTL8812A) + if (IS_HARDWARE_TYPE_8812AU(pAdapter)) { + /* <20131115, Kordan> Turn off Rx to prevent from being busy when writing the EFUSE. (Asked by Chunchu.)*/ + BackupRegs[0] = phy_query_mac_reg(pAdapter, REG_RCR, bMaskDWord); + BackupRegs[1] = phy_query_mac_reg(pAdapter, REG_RXFLTMAP0, bMaskDWord); + BackupRegs[2] = phy_query_mac_reg(pAdapter, REG_RXFLTMAP0+4, bMaskDWord); + BackupRegs[3] = phy_query_mac_reg(pAdapter, REG_AFE_MISC, bMaskDWord); + + PlatformEFIOWrite4Byte(pAdapter, REG_RCR, 0x1); + PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0, 0); + PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+1, 0); + PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+2, 0); + PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+3, 0); + PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+4, 0); + PlatformEFIOWrite1Byte(pAdapter, REG_RXFLTMAP0+5, 0); + + /* <20140410, Kordan> 0x11 = 0x4E, lower down LX_SPS0 voltage. (Asked by Chunchu)*/ + phy_set_mac_reg(pAdapter, REG_AFE_MISC, bMaskByte1, 0x4E); + } +#endif +} + +VOID efuse_PostUpdateAction( + PADAPTER pAdapter, + pu4Byte BackupRegs) +{ +#if defined(CONFIG_RTL8812A) + if (IS_HARDWARE_TYPE_8812AU(pAdapter)) { + /* <20131115, Kordan> Turn on Rx and restore the registers. (Asked by Chunchu.)*/ + phy_set_mac_reg(pAdapter, REG_RCR, bMaskDWord, BackupRegs[0]); + phy_set_mac_reg(pAdapter, REG_RXFLTMAP0, bMaskDWord, BackupRegs[1]); + phy_set_mac_reg(pAdapter, REG_RXFLTMAP0+4, bMaskDWord, BackupRegs[2]); + phy_set_mac_reg(pAdapter, REG_AFE_MISC, bMaskDWord, BackupRegs[3]); + } +#endif +} + + BOOLEAN Efuse_Read1ByteFromFakeContent( IN PADAPTER pAdapter, @@ -1194,7 +1826,7 @@ Efuse_PowerSwitch( IN u8 bWrite, IN u8 PwrState) { - pAdapter->HalFunc.EfusePowerSwitch(pAdapter, bWrite, PwrState); + pAdapter->hal_func.EfusePowerSwitch(pAdapter, bWrite, PwrState); } VOID @@ -1203,8 +1835,8 @@ BTEfuse_PowerSwitch( IN u8 bWrite, IN u8 PwrState) { - if (pAdapter->HalFunc.BTEfusePowerSwitch) - pAdapter->HalFunc.BTEfusePowerSwitch(pAdapter, bWrite, PwrState); + if (pAdapter->hal_func.BTEfusePowerSwitch) + pAdapter->hal_func.BTEfusePowerSwitch(pAdapter, bWrite, PwrState); } /*----------------------------------------------------------------------------- @@ -1231,7 +1863,7 @@ Efuse_GetCurrentSize( { u16 ret = 0; - ret = pAdapter->HalFunc.EfuseGetCurrentSize(pAdapter, efuseType, bPseudoTest); + ret = pAdapter->hal_func.EfuseGetCurrentSize(pAdapter, efuseType, bPseudoTest); return ret; } @@ -1257,7 +1889,7 @@ ReadEFuseByte( u32 value32; u8 readbyte; u16 retry; - /* u32 start=rtw_get_current_time(); */ + /* systime start=rtw_get_current_time(); */ if (bPseudoTest) { Efuse_Read1ByteFromFakeContent(Adapter, _offset, pbuf); @@ -1266,7 +1898,7 @@ ReadEFuseByte( if (IS_HARDWARE_TYPE_8723B(Adapter)) { /* <20130121, Kordan> For SMIC S55 EFUSE specificatoin. */ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ - PHY_SetMacReg(Adapter, EFUSE_TEST, BIT11, 0); + phy_set_mac_reg(Adapter, EFUSE_TEST, BIT11, 0); } /* Write Address */ rtw_write8(Adapter, EFUSE_CTRL + 1, (_offset & 0xff)); @@ -1335,7 +1967,7 @@ efuse_ReadEFuse( IN BOOLEAN bPseudoTest ) { - Adapter->HalFunc.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); + Adapter->hal_func.ReadEFuse(Adapter, efuseType, _offset, _size_byte, pbuf, bPseudoTest); } VOID @@ -1347,7 +1979,7 @@ EFUSE_GetEfuseDefinition( IN BOOLEAN bPseudoTest ) { - pAdapter->HalFunc.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); + pAdapter->hal_func.EFUSEGetEfuseDefinition(pAdapter, efuseType, type, pOut, bPseudoTest); } @@ -1373,12 +2005,12 @@ efuse_OneByteRead( } if (IS_HARDWARE_TYPE_8723B(pAdapter) || - (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || - (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) + (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->version_id))) || + (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->version_id)) ) { /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ - /* PHY_SetMacReg(pAdapter, 0x34, BIT11, 0); */ + /* phy_set_mac_reg(pAdapter, 0x34, BIT11, 0); */ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter, 0x34) & (~BIT11)); } @@ -1431,6 +2063,7 @@ efuse_OneByteWrite( return bResult; } + Efuse_PowerSwitch(pAdapter, _TRUE, _TRUE); /* -----------------e-fuse reg ctrl --------------------------------- */ /* address */ @@ -1443,17 +2076,19 @@ efuse_OneByteWrite( /* <20130227, Kordan> 8192E MP chip A-cut had better not set 0x34[11] until B-Cut. */ if (IS_HARDWARE_TYPE_8723B(pAdapter) || - (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || - (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) + (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->version_id))) || + (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->version_id)) ) { /* <20130121, Kordan> For SMIC EFUSE specificatoin. */ /* 0x34[11]: SW force PGMEN input of efuse to high. (for the bank selected by 0x34[9:8]) */ - /* PHY_SetMacReg(pAdapter, 0x34, BIT11, 1); */ + /* phy_set_mac_reg(pAdapter, 0x34, BIT11, 1); */ rtw_write16(pAdapter, 0x34, rtw_read16(pAdapter, 0x34) | (BIT11)); rtw_write32(pAdapter, EFUSE_CTRL, 0x90600000 | ((addr << 8 | data))); } else rtw_write32(pAdapter, EFUSE_CTRL, efuseValue); + rtw_mdelay_os(1); + while ((0x80 & rtw_read8(pAdapter, EFUSE_CTRL + 3)) && (tmpidx < 100)) { rtw_mdelay_os(1); tmpidx++; @@ -1470,10 +2105,12 @@ efuse_OneByteWrite( /* disable Efuse program enable */ if (IS_HARDWARE_TYPE_8723B(pAdapter) || - (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->VersionID))) || - (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->VersionID)) + (IS_HARDWARE_TYPE_8192E(pAdapter) && (!IS_A_CUT(pHalData->version_id))) || + (IS_VENDOR_8188E_I_CUT_SERIES(pAdapter)) || (IS_CHIP_VENDOR_SMIC(pHalData->version_id)) ) - PHY_SetMacReg(pAdapter, EFUSE_TEST, BIT(11), 0); + phy_set_mac_reg(pAdapter, EFUSE_TEST, BIT(11), 0); + + Efuse_PowerSwitch(pAdapter, _TRUE, _FALSE); return bResult; } @@ -1486,7 +2123,7 @@ Efuse_PgPacketRead(IN PADAPTER pAdapter, { int ret = 0; - ret = pAdapter->HalFunc.Efuse_PgPacketRead(pAdapter, offset, data, bPseudoTest); + ret = pAdapter->hal_func.Efuse_PgPacketRead(pAdapter, offset, data, bPseudoTest); return ret; } @@ -1500,7 +2137,7 @@ Efuse_PgPacketWrite(IN PADAPTER pAdapter, { int ret; - ret = pAdapter->HalFunc.Efuse_PgPacketWrite(pAdapter, offset, word_en, data, bPseudoTest); + ret = pAdapter->hal_func.Efuse_PgPacketWrite(pAdapter, offset, word_en, data, bPseudoTest); return ret; } @@ -1515,7 +2152,7 @@ Efuse_PgPacketWrite_BT(IN PADAPTER pAdapter, { int ret; - ret = pAdapter->HalFunc.Efuse_PgPacketWrite_BT(pAdapter, offset, word_en, data, bPseudoTest); + ret = pAdapter->hal_func.Efuse_PgPacketWrite_BT(pAdapter, offset, word_en, data, bPseudoTest); return ret; } @@ -1530,7 +2167,7 @@ Efuse_WordEnableDataWrite(IN PADAPTER pAdapter, { u8 ret = 0; - ret = pAdapter->HalFunc.Efuse_WordEnableDataWrite(pAdapter, efuse_addr, word_en, data, bPseudoTest); + ret = pAdapter->hal_func.Efuse_WordEnableDataWrite(pAdapter, efuse_addr, word_en, data, bPseudoTest); return ret; } @@ -1554,6 +2191,8 @@ u8 rtw_efuse_access(PADAPTER padapter, u8 bWrite, u16 start_addr, u16 cnts, u8 * u16 real_content_len = 0, max_available_size = 0; u8 res = _FAIL ; u8(*rw8)(PADAPTER, u16, u8 *); + u32 backupRegs[4] = {0}; + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&real_content_len, _FALSE); EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, (PVOID)&max_available_size, _FALSE); @@ -1568,6 +2207,8 @@ u8 rtw_efuse_access(PADAPTER padapter, u8 bWrite, u16 start_addr, u16 cnts, u8 * } else rw8 = &efuse_read8; + efuse_PreUpdateAction(padapter, backupRegs); + Efuse_PowerSwitch(padapter, bWrite, _TRUE); /* e-fuse one byte read / write */ @@ -1584,6 +2225,8 @@ u8 rtw_efuse_access(PADAPTER padapter, u8 bWrite, u16 start_addr, u16 cnts, u8 * Efuse_PowerSwitch(padapter, bWrite, _FALSE); + efuse_PostUpdateAction(padapter, backupRegs); + return res; } /* ------------------------------------------------------------------------------ */ @@ -1669,15 +2312,18 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) return _FAIL; \ } + u8 *efuse = NULL; u8 offset, word_en; - u8 *map; + u8 *map = NULL; u8 newdata[PGPKT_DATA_SIZE]; s32 i, j, idx, chk_total_byte; u8 ret = _SUCCESS; u16 mapLen = 0, startAddr = 0, efuse_max_available_len = 0; + u32 backupRegs[4] = {0}; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); PEFUSE_HAL pEfuseHal = &pHalData->EfuseHal; + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_AVAILABLE_EFUSE_BYTES_TOTAL, &efuse_max_available_len, _FALSE); @@ -1687,29 +2333,38 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) RT_ASSERT_RET(PGPKT_DATA_SIZE == 8); /* have to be 8 byte alignment */ RT_ASSERT_RET((mapLen & 0x7) == 0); /* have to be PGPKT_DATA_SIZE alignment for memcpy */ - map = rtw_zmalloc(mapLen); - if (map == NULL) + efuse = rtw_zmalloc(mapLen); + if (!efuse) return _FAIL; + map = rtw_zmalloc(mapLen); + if (map == NULL) { + rtw_mfree(efuse, mapLen); + return _FAIL; + } + _rtw_memset(map, 0xFF, mapLen); ret = rtw_efuse_map_read(padapter, 0, mapLen, map); if (ret == _FAIL) goto exit; + _rtw_memcpy(efuse , map, mapLen); + _rtw_memcpy(efuse + addr, data, cnts); + if (padapter->registrypriv.boffefusemask == 0) { for (i = 0; i < cnts; i++) { if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { if (rtw_file_efuse_IsMasked(padapter, addr + i)) /*use file efuse mask. */ - data[i] = map[addr + i]; + efuse[addr + i] = map[addr + i]; } else { if (efuse_IsMasked(padapter, addr + i)) - data[i] = map[addr + i]; + efuse[addr + i] = map[addr + i]; } - RTW_INFO("%s , data[%d] = %x, map[addr+i]= %x\n", __func__, i, data[i], map[addr + i]); + RTW_INFO("%s , data[%d] = %x, map[addr+i]= %x\n", __func__, addr + i, efuse[ addr + i], map[addr + i]); } } - Efuse_PowerSwitch(padapter, _TRUE, _TRUE); + /*Efuse_PowerSwitch(padapter, _TRUE, _TRUE);*/ chk_total_byte = 0; idx = 0; @@ -1719,7 +2374,7 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) word_en = 0xF; j = (addr + idx) & 0x7; for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { - if (data[idx] != map[addr + idx]) + if (efuse[addr + idx] != map[addr + idx]) word_en &= ~BIT(i >> 1); } @@ -1751,6 +2406,7 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) goto exit; } + efuse_PreUpdateAction(padapter, backupRegs); idx = 0; offset = (addr >> 3); @@ -1759,12 +2415,12 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) j = (addr + idx) & 0x7; _rtw_memcpy(newdata, &map[offset << 3], PGPKT_DATA_SIZE); for (i = j; i < PGPKT_DATA_SIZE && idx < cnts; i++, idx++) { - if (data[idx] != map[addr + idx]) { + if (efuse[addr + idx] != map[addr + idx]) { word_en &= ~BIT(i >> 1); - newdata[i] = data[idx]; + newdata[i] = efuse[addr + idx]; #ifdef CONFIG_RTL8723B if (addr + idx == 0x8) { - if (IS_C_CUT(pHalData->VersionID) || IS_B_CUT(pHalData->VersionID)) { + if (IS_C_CUT(pHalData->version_id) || IS_B_CUT(pHalData->version_id)) { if (pHalData->adjuseVoltageVal == 6) { newdata[i] = map[addr + idx]; RTW_INFO(" %s ,\n adjuseVoltageVal = %d ,newdata[%d] = %x\n", __func__, pHalData->adjuseVoltageVal, i, newdata[i]); @@ -1789,43 +2445,18 @@ u8 rtw_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) offset++; } - Efuse_PowerSwitch(padapter, _TRUE, _FALSE); + /*Efuse_PowerSwitch(padapter, _TRUE, _FALSE);*/ + + efuse_PostUpdateAction(padapter, backupRegs); exit: rtw_mfree(map, mapLen); + rtw_mfree(efuse, mapLen); return ret; } -u8 rtw_efuse_mask_map_read(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) -{ - u8 ret = _SUCCESS; - u16 mapLen = 0, i = 0; - - EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN, (PVOID)&mapLen, _FALSE); - - ret = rtw_efuse_map_read(padapter, addr, cnts , data); - - if (padapter->registrypriv.boffefusemask == 0) { - - for (i = 0; i < cnts; i++) { - if (padapter->registrypriv.bFileMaskEfuse == _TRUE) { - if (rtw_file_efuse_IsMasked(padapter, addr + i)) /*use file efuse mask.*/ - data[i] = 0xff; - } else { - /*RTW_INFO(" %s , data[%d] = %x\n", __func__, i, data[i]);*/ - if (efuse_IsMasked(padapter, addr + i)) { - data[i] = 0xff; - /*RTW_INFO(" %s ,mask data[%d] = %x\n", __func__, i, data[i]);*/ - } - } - } - - } - return ret; - -} u8 rtw_BT_efuse_map_write(PADAPTER padapter, u16 addr, u16 cnts, u8 *data) { @@ -1948,67 +2579,6 @@ Efuse_ReadAllMap( Efuse_PowerSwitch(pAdapter, _FALSE, _FALSE); } -/*----------------------------------------------------------------------------- - * Function: efuse_ShadowRead1Byte - * efuse_ShadowRead2Byte - * efuse_ShadowRead4Byte - * - * Overview: Read from efuse init map by one/two/four bytes !!!!! - * - * Input: NONE - * - * Output: NONE - * - * Return: NONE - * - * Revised History: - * When Who Remark - * 11/12/2008 MHC Create Version 0. - * - *---------------------------------------------------------------------------*/ -static VOID -efuse_ShadowRead1Byte( - IN PADAPTER pAdapter, - IN u16 Offset, - IN OUT u8 *Value) -{ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - - *Value = pHalData->efuse_eeprom_data[Offset]; - -} /* EFUSE_ShadowRead1Byte */ - -/* ---------------Read Two Bytes */ -static VOID -efuse_ShadowRead2Byte( - IN PADAPTER pAdapter, - IN u16 Offset, - IN OUT u16 *Value) -{ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - - *Value = pHalData->efuse_eeprom_data[Offset]; - *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; - -} /* EFUSE_ShadowRead2Byte */ - -/* ---------------Read Four Bytes */ -static VOID -efuse_ShadowRead4Byte( - IN PADAPTER pAdapter, - IN u16 Offset, - IN OUT u32 *Value) -{ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - - *Value = pHalData->efuse_eeprom_data[Offset]; - *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; - *Value |= pHalData->efuse_eeprom_data[Offset + 2] << 16; - *Value |= pHalData->efuse_eeprom_data[Offset + 3] << 24; - -} /* efuse_ShadowRead4Byte */ - - /*----------------------------------------------------------------------------- * Function: efuse_ShadowWrite1Byte * efuse_ShadowWrite2Byte @@ -2079,38 +2649,6 @@ efuse_ShadowWrite4Byte( } /* efuse_ShadowWrite1Byte */ -/*----------------------------------------------------------------------------- - * Function: EFUSE_ShadowRead - * - * Overview: Read from efuse init map !!!!! - * - * Input: NONE - * - * Output: NONE - * - * Return: NONE - * - * Revised History: - * When Who Remark - * 11/12/2008 MHC Create Version 0. - * - *---------------------------------------------------------------------------*/ -void -EFUSE_ShadowRead( - IN PADAPTER pAdapter, - IN u8 Type, - IN u16 Offset, - IN OUT u32 *Value) -{ - if (Type == 1) - efuse_ShadowRead1Byte(pAdapter, Offset, (u8 *)Value); - else if (Type == 2) - efuse_ShadowRead2Byte(pAdapter, Offset, (u16 *)Value); - else if (Type == 4) - efuse_ShadowRead4Byte(pAdapter, Offset, (u32 *)Value); - -} /* EFUSE_ShadowRead */ - /*----------------------------------------------------------------------------- * Function: EFUSE_ShadowWrite * @@ -2182,6 +2720,87 @@ Efuse_InitSomeVar( _rtw_memset((PVOID)&fakeBTEfuseModifiedMap[0], 0xff, EFUSE_BT_MAX_MAP_LEN); } #endif /* !RTW_HALMAC */ +/*----------------------------------------------------------------------------- + * Function: efuse_ShadowRead1Byte + * efuse_ShadowRead2Byte + * efuse_ShadowRead4Byte + * + * Overview: Read from efuse init map by one/two/four bytes !!!!! + * + * Input: NONE + * + * Output: NONE + * + * Return: NONE + * + * Revised History: + * When Who Remark + * 11/12/2008 MHC Create Version 0. + * + *---------------------------------------------------------------------------*/ +static VOID +efuse_ShadowRead1Byte( + IN PADAPTER pAdapter, + IN u16 Offset, + IN OUT u8 *Value) +{ + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); + + *Value = pHalData->efuse_eeprom_data[Offset]; + +} /* EFUSE_ShadowRead1Byte */ + +/* ---------------Read Two Bytes */ +static VOID +efuse_ShadowRead2Byte( + IN PADAPTER pAdapter, + IN u16 Offset, + IN OUT u16 *Value) +{ + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); + + *Value = pHalData->efuse_eeprom_data[Offset]; + *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; + +} /* EFUSE_ShadowRead2Byte */ + +/* ---------------Read Four Bytes */ +static VOID +efuse_ShadowRead4Byte( + IN PADAPTER pAdapter, + IN u16 Offset, + IN OUT u32 *Value) +{ + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); + + *Value = pHalData->efuse_eeprom_data[Offset]; + *Value |= pHalData->efuse_eeprom_data[Offset + 1] << 8; + *Value |= pHalData->efuse_eeprom_data[Offset + 2] << 16; + *Value |= pHalData->efuse_eeprom_data[Offset + 3] << 24; + +} /* efuse_ShadowRead4Byte */ + +/*----------------------------------------------------------------------------- + * Function: EFUSE_ShadowRead + * + * Overview: Read from pHalData->efuse_eeprom_data + *---------------------------------------------------------------------------*/ +void +EFUSE_ShadowRead( + IN PADAPTER pAdapter, + IN u8 Type, + IN u16 Offset, + IN OUT u32 *Value) +{ + if (Type == 1) + efuse_ShadowRead1Byte(pAdapter, Offset, (u8 *)Value); + else if (Type == 2) + efuse_ShadowRead2Byte(pAdapter, Offset, (u16 *)Value); + else if (Type == 4) + efuse_ShadowRead4Byte(pAdapter, Offset, (u32 *)Value); + +} /* EFUSE_ShadowRead */ + /* 11/16/2008 MH Add description. Get current efuse area enabled word!!. */ u8 Efuse_CalculateWordCnts(IN u8 word_en) @@ -2283,7 +2902,7 @@ void EFUSE_ShadowMapUpdate( } if (pHalData->bautoload_fail_flag == _FALSE) { - err = rtw_halmac_read_logical_efuse_map(adapter_to_dvobj(pAdapter), efuse_map, mapLen); + err = rtw_halmac_read_logical_efuse_map(adapter_to_dvobj(pAdapter), efuse_map, mapLen, NULL, 0); if (err) RTW_ERR("%s: fail to get efuse map!\n", __FUNCTION__); } @@ -2309,6 +2928,8 @@ void EFUSE_ShadowMapUpdate( /* (PVOID)&pHalData->EfuseMap[EFUSE_INIT_MAP][0], mapLen); */ #endif /* !RTW_HALMAC */ + rtw_mask_map_read(pAdapter, 0x00, mapLen, pHalData->efuse_eeprom_data); + rtw_dump_cur_efuse(pAdapter); } /* EFUSE_ShadowMapUpdate */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ap.c index 4e6a341fa8c5..ff49410dc0ba 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ap.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ap.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,16 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_AP_C_ #include - +#include #ifdef CONFIG_AP_MODE @@ -274,8 +269,8 @@ u8 chk_sta_is_alive(struct sta_info *psta) u8 ret = _FALSE; #ifdef DBG_EXPIRATION_CHK RTW_INFO("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", expire_to:%u, %s%ssq_len:%u\n" - , MAC_ARG(psta->hwaddr) - , psta->rssi_stat.UndecoratedSmoothedPWDB + , MAC_ARG(psta->cmn.mac_addr) + , psta->cmn.rssi_stat.rssi /* , STA_RX_PKTS_ARG(psta) */ , STA_RX_PKTS_DIFF_ARG(psta) , psta->expire_to @@ -338,7 +333,7 @@ void expire_timeout_chk(_adapter *padapter) #ifdef CONFIG_ATMEL_RC_PATCH - if (_TRUE == _rtw_memcmp((void *)(pstapriv->atmel_rc_pattern), (void *)(psta->hwaddr), ETH_ALEN)) + if (_rtw_memcmp((void *)(pstapriv->atmel_rc_pattern), (void *)(psta->cmn.mac_addr), ETH_ALEN) == _TRUE) continue; if (psta->flag_atmel_rc) continue; @@ -350,7 +345,8 @@ void expire_timeout_chk(_adapter *padapter) pstapriv->auth_list_cnt--; RTW_INFO("auth expire %02X%02X%02X%02X%02X%02X\n", - psta->hwaddr[0], psta->hwaddr[1], psta->hwaddr[2], psta->hwaddr[3], psta->hwaddr[4], psta->hwaddr[5]); + psta->cmn.mac_addr[0], psta->cmn.mac_addr[1], psta->cmn.mac_addr[2], + psta->cmn.mac_addr[3], psta->cmn.mac_addr[4], psta->cmn.mac_addr[5]); _exit_critical_bh(&pstapriv->auth_list_lock, &irqL); @@ -385,8 +381,8 @@ void expire_timeout_chk(_adapter *padapter) plist = get_next(plist); #ifdef CONFIG_ATMEL_RC_PATCH RTW_INFO("%s:%d psta=%p, %02x,%02x||%02x,%02x \n\n", __func__, __LINE__, - psta, pstapriv->atmel_rc_pattern[0], pstapriv->atmel_rc_pattern[5], psta->hwaddr[0], psta->hwaddr[5]); - if (_TRUE == _rtw_memcmp((void *)pstapriv->atmel_rc_pattern, (void *)(psta->hwaddr), ETH_ALEN)) + psta, pstapriv->atmel_rc_pattern[0], pstapriv->atmel_rc_pattern[5], psta->cmn.mac_addr[0], psta->cmn.mac_addr[5]); + if (_rtw_memcmp((void *)pstapriv->atmel_rc_pattern, (void *)(psta->cmn.mac_addr), ETH_ALEN) == _TRUE) continue; if (psta->flag_atmel_rc) continue; @@ -421,7 +417,7 @@ void expire_timeout_chk(_adapter *padapter) RTW_INFO("asoc check by DELBA/ADDBA! (%d s)\n", (pstapriv->expire_to - psta->expire_to) * 2); psta->under_exist_checking = 1; /* tear down TX AMPDU */ - send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ + send_delba(padapter, 1, psta->cmn.mac_addr);/* */ /* originator */ psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ } @@ -473,7 +469,7 @@ void expire_timeout_chk(_adapter *padapter) RTW_INFO("issue addba_req to check if sta alive, keep_alive_trycnt=%d\n", psta->keep_alive_trycnt); - issue_addba_req(padapter, psta->hwaddr, (u8)priority); + issue_addba_req(padapter, psta->cmn.mac_addr, (u8)priority); _set_timer(&psta->addba_retry_timer, ADDBA_TO); @@ -497,10 +493,10 @@ void expire_timeout_chk(_adapter *padapter) psta->expire_to = pstapriv->expire_to; psta->state |= WIFI_STA_ALIVE_CHK_STATE; - /* RTW_INFO("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->hwaddr)); */ + /* RTW_INFO("alive chk, sta:" MAC_FMT " is at ps mode!\n", MAC_ARG(psta->cmn.mac_addr)); */ /* to update bcn with tim_bitmap for this station */ - pstapriv->tim_bitmap |= BIT(psta->aid); + pstapriv->tim_bitmap |= BIT(psta->cmn.aid); update_beacon(padapter, _TIM_IE_, NULL, _TRUE); if (!pmlmeext->active_keep_alive_check) @@ -520,7 +516,7 @@ void expire_timeout_chk(_adapter *padapter) #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ rtw_list_delete(&psta->asoc_list); pstapriv->asoc_list_cnt--; - RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); + RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->cmn.mac_addr), psta->state); updated = ap_free_sta(padapter, psta, _FALSE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); } else { /* TODO: Aging mechanism to digest frames in sleep_q to avoid running out of xmitframe */ @@ -528,7 +524,7 @@ void expire_timeout_chk(_adapter *padapter) && padapter->xmitpriv.free_xmitframe_cnt < ((NR_XMITFRAME / pstapriv->asoc_list_cnt) / 2) ) { RTW_INFO("%s sta:"MAC_FMT", sleepq_len:%u, free_xmitframe_cnt:%u, asoc_list_cnt:%u, clear sleep_q\n", __func__ - , MAC_ARG(psta->hwaddr) + , MAC_ARG(psta->cmn.mac_addr) , psta->sleepq_len, padapter->xmitpriv.free_xmitframe_cnt, pstapriv->asoc_list_cnt); wakeup_sta_to_xmit(padapter, psta); } @@ -540,7 +536,7 @@ void expire_timeout_chk(_adapter *padapter) #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK if (chk_alive_num) { - u8 backup_ch = 0, backup_bw, backup_offset; + u8 backup_ch = 0, backup_bw = 0, backup_offset = 0; u8 union_ch = 0, union_bw, union_offset; u8 switch_channel = _TRUE; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; @@ -570,7 +566,7 @@ void expire_timeout_chk(_adapter *padapter) psta = rtw_get_stainfo_by_offset(pstapriv, chk_alive_list[i]); #ifdef CONFIG_ATMEL_RC_PATCH - if (_TRUE == _rtw_memcmp(pstapriv->atmel_rc_pattern, psta->hwaddr, ETH_ALEN)) + if (_rtw_memcmp(pstapriv->atmel_rc_pattern, psta->cmn.mac_addr, ETH_ALEN) == _TRUE) continue; if (psta->flag_atmel_rc) continue; @@ -579,13 +575,13 @@ void expire_timeout_chk(_adapter *padapter) continue; if (psta->state & WIFI_SLEEP_STATE) - ret = issue_nulldata(padapter, psta->hwaddr, 0, 1, 50); + ret = issue_nulldata(padapter, psta->cmn.mac_addr, 0, 1, 50); else - ret = issue_nulldata(padapter, psta->hwaddr, 0, 3, 50); + ret = issue_nulldata(padapter, psta->cmn.mac_addr, 0, 3, 50); psta->keep_alive_trycnt++; if (ret == _SUCCESS) { - RTW_INFO("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->hwaddr)); + RTW_INFO("asoc check, sta(" MAC_FMT ") is alive\n", MAC_ARG(psta->cmn.mac_addr)); psta->expire_to = pstapriv->expire_to; psta->keep_alive_trycnt = 0; continue; @@ -596,7 +592,7 @@ void expire_timeout_chk(_adapter *padapter) } psta->keep_alive_trycnt = 0; - RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->hwaddr), psta->state); + RTW_INFO("asoc expire "MAC_FMT", state=0x%x\n", MAC_ARG(psta->cmn.mac_addr), psta->state); _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { rtw_list_delete(&psta->asoc_list); @@ -619,33 +615,28 @@ void expire_timeout_chk(_adapter *padapter) associated_clients_update(padapter, updated, STA_INFO_UPDATE_ALL); } -void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) +void rtw_ap_update_sta_ra_info(_adapter *padapter, struct sta_info *psta) { int i; u8 rf_type; unsigned char sta_band = 0; u64 tx_ra_bitmap = 0; - struct ht_priv *psta_ht = NULL; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; -#ifdef CONFIG_80211N_HT - if (psta) - psta_ht = &psta->htpriv; - else + if (!psta) return; -#endif /* CONFIG_80211N_HT */ if (!(psta->state & _FW_LINKED)) return; - rtw_hal_update_sta_rate_mask(padapter, psta); - tx_ra_bitmap = psta->ra_mask; + rtw_hal_update_sta_ra_info(padapter, psta); + tx_ra_bitmap = psta->cmn.ra_info.ramask; if (pcur_network->Configuration.DSConfig > 14) { if (tx_ra_bitmap & 0xffff000) - sta_band |= WIRELESS_11_5N ; + sta_band |= WIRELESS_11_5N; if (tx_ra_bitmap & 0xff0) sta_band |= WIRELESS_11A; @@ -655,7 +646,6 @@ void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) if (psta->vhtpriv.vht_option) sta_band = WIRELESS_11_5AC; #endif - } else { if (tx_ra_bitmap & 0xffff000) sta_band |= WIRELESS_11_24N; @@ -668,16 +658,180 @@ void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level) } psta->wireless_mode = sta_band; - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); + rtw_hal_update_sta_wset(padapter, psta); + RTW_INFO("%s=> mac_id:%d , tx_ra_bitmap:0x%016llx, networkType:0x%02x\n", + __FUNCTION__, psta->cmn.mac_id, tx_ra_bitmap, psta->wireless_mode); +} - if (psta->aid < NUM_STA) { - RTW_INFO("%s=> mac_id:%d , raid:%d, tx_ra_bitmap:0x%016llx, networkType:0x%02x\n", - __FUNCTION__, psta->mac_id, psta->raid, tx_ra_bitmap, psta->wireless_mode); +#ifdef CONFIG_BMC_TX_RATE_SELECT +u8 rtw_ap_find_mini_tx_rate(_adapter *adapter) +{ + _irqL irqL; + _list *phead, *plist; + u8 miini_tx_rate = ODM_RATEVHTSS4MCS9, sta_tx_rate; + struct sta_info *psta = NULL; + struct sta_priv *pstapriv = &adapter->stapriv; - rtw_update_ramask(padapter, psta, psta->mac_id, rssi_level); - } else - RTW_INFO("station aid %d exceed the max number\n", psta->aid); + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); + phead = &pstapriv->asoc_list; + plist = get_next(phead); + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); + plist = get_next(plist); + sta_tx_rate = psta->cmn.ra_info.curr_tx_rate & 0x7F; + if (sta_tx_rate < miini_tx_rate) + miini_tx_rate = sta_tx_rate; + } + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + + return miini_tx_rate; +} + +u8 rtw_ap_find_bmc_rate(_adapter *adapter, u8 tx_rate) +{ + PHAL_DATA_TYPE hal_data = GET_HAL_DATA(adapter); + u8 tx_ini_rate = ODM_RATE6M; + + switch (tx_rate) { + case ODM_RATEVHTSS3MCS9: + case ODM_RATEVHTSS3MCS8: + case ODM_RATEVHTSS3MCS7: + case ODM_RATEVHTSS3MCS6: + case ODM_RATEVHTSS3MCS5: + case ODM_RATEVHTSS3MCS4: + case ODM_RATEVHTSS3MCS3: + case ODM_RATEVHTSS2MCS9: + case ODM_RATEVHTSS2MCS8: + case ODM_RATEVHTSS2MCS7: + case ODM_RATEVHTSS2MCS6: + case ODM_RATEVHTSS2MCS5: + case ODM_RATEVHTSS2MCS4: + case ODM_RATEVHTSS2MCS3: + case ODM_RATEVHTSS1MCS9: + case ODM_RATEVHTSS1MCS8: + case ODM_RATEVHTSS1MCS7: + case ODM_RATEVHTSS1MCS6: + case ODM_RATEVHTSS1MCS5: + case ODM_RATEVHTSS1MCS4: + case ODM_RATEVHTSS1MCS3: + case ODM_RATEMCS15: + case ODM_RATEMCS14: + case ODM_RATEMCS13: + case ODM_RATEMCS12: + case ODM_RATEMCS11: + case ODM_RATEMCS7: + case ODM_RATEMCS6: + case ODM_RATEMCS5: + case ODM_RATEMCS4: + case ODM_RATEMCS3: + case ODM_RATE54M: + case ODM_RATE48M: + case ODM_RATE36M: + case ODM_RATE24M: + tx_ini_rate = ODM_RATE24M; + break; + case ODM_RATEVHTSS3MCS2: + case ODM_RATEVHTSS3MCS1: + case ODM_RATEVHTSS2MCS2: + case ODM_RATEVHTSS2MCS1: + case ODM_RATEVHTSS1MCS2: + case ODM_RATEVHTSS1MCS1: + case ODM_RATEMCS10: + case ODM_RATEMCS9: + case ODM_RATEMCS2: + case ODM_RATEMCS1: + case ODM_RATE18M: + case ODM_RATE12M: + tx_ini_rate = ODM_RATE12M; + break; + case ODM_RATEVHTSS3MCS0: + case ODM_RATEVHTSS2MCS0: + case ODM_RATEVHTSS1MCS0: + case ODM_RATEMCS8: + case ODM_RATEMCS0: + case ODM_RATE9M: + case ODM_RATE6M: + tx_ini_rate = ODM_RATE6M; + break; + case ODM_RATE11M: + case ODM_RATE5_5M: + case ODM_RATE2M: + case ODM_RATE1M: + tx_ini_rate = ODM_RATE1M; + break; + default: + tx_ini_rate = ODM_RATE6M; + break; + } + + if (hal_data->current_band_type == BAND_ON_5G) + if (tx_ini_rate < ODM_RATE6M) + tx_ini_rate = ODM_RATE6M; + + return tx_ini_rate; +} + +void rtw_update_bmc_sta_tx_rate(_adapter *adapter) +{ + struct sta_info *psta = NULL; + u8 tx_rate; + + psta = rtw_get_bcmc_stainfo(adapter); + if (psta == NULL) { + RTW_ERR(ADPT_FMT "could not get bmc_sta !!\n", ADPT_ARG(adapter)); + return; + } + + if (adapter->bmc_tx_rate != MGN_UNKNOWN) { + psta->init_rate = adapter->bmc_tx_rate; + goto _exit; + } + + if (adapter->stapriv.asoc_sta_count <= 2) + goto _exit; + + tx_rate = rtw_ap_find_mini_tx_rate(adapter); + #ifdef CONFIG_BMC_TX_LOW_RATE + tx_rate = rtw_ap_find_bmc_rate(adapter, tx_rate); + #endif + + psta->init_rate = hw_rate_to_m_rate(tx_rate); + +_exit: + RTW_INFO(ADPT_FMT" BMC Tx rate - %s\n", ADPT_ARG(adapter), MGN_RATE_STR(psta->init_rate)); +} +#endif + +void rtw_init_bmc_sta_tx_rate(_adapter *padapter, struct sta_info *psta) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + u8 rate_idx = 0; + u8 brate_table[] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, + MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}; + + if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) + return; + + if (padapter->bmc_tx_rate != MGN_UNKNOWN) + psta->init_rate = padapter->bmc_tx_rate; + else { + #ifdef CONFIG_BMC_TX_LOW_RATE + if (IsEnableHWOFDM(pmlmeext->cur_wireless_mode) && (psta->cmn.ra_info.ramask && 0xFF0)) + rate_idx = get_lowest_rate_idx_ex(psta->cmn.ra_info.ramask, 4); /*from basic rate*/ + else + rate_idx = get_lowest_rate_idx(psta->cmn.ra_info.ramask); /*from basic rate*/ + #else + rate_idx = get_highest_rate_idx(psta->cmn.ra_info.ramask); /*from basic rate*/ + #endif + if (rate_idx < 12) + psta->init_rate = brate_table[rate_idx]; + else + psta->init_rate = MGN_1M; + } + + RTW_INFO(ADPT_FMT" BMC Init Tx rate - %s\n", ADPT_ARG(padapter), MGN_RATE_STR(psta->init_rate)); } void update_bmc_sta(_adapter *padapter) @@ -690,7 +844,7 @@ void update_bmc_sta(_adapter *padapter) struct sta_info *psta = rtw_get_bcmc_stainfo(padapter); if (psta) { - psta->aid = 0;/* default set to 0 */ + psta->cmn.aid = 0;/* default set to 0 */ psta->qos_option = 0; #ifdef CONFIG_80211N_HT psta->htpriv.ht_option = _FALSE; @@ -702,7 +856,6 @@ void update_bmc_sta(_adapter *padapter) /* psta->dot118021XPrivacy = _NO_PRIVACY_; */ /* !!! remove it, because it has been set before this. */ - /* prepare for add_RATid */ supportRateNum = rtw_get_rateset_len((u8 *)&pcur_network->SupportedRates); network_type = rtw_check_network_type((u8 *)&pcur_network->SupportedRates, supportRateNum, pcur_network->Configuration.DSConfig); if (IsSupportedTxCCK(network_type)) @@ -716,21 +869,52 @@ void update_bmc_sta(_adapter *padapter) update_sta_basic_rate(psta, network_type); psta->wireless_mode = network_type; - rtw_hal_update_sta_rate_mask(padapter, psta); - - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); + rtw_hal_update_sta_ra_info(padapter, psta); _enter_critical_bh(&psta->lock, &irqL); psta->state = _FW_LINKED; _exit_critical_bh(&psta->lock, &irqL); rtw_sta_media_status_rpt(padapter, psta, 1); - rtw_hal_update_ra_mask(psta, 0); + rtw_init_bmc_sta_tx_rate(padapter, psta); + } else RTW_INFO("add_RATid_bmc_sta error!\n"); } +#if defined(CONFIG_80211N_HT) && defined(CONFIG_BEAMFORMING) +void update_sta_info_apmode_ht_bf_cap(_adapter *padapter, struct sta_info *psta) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; + struct ht_priv *phtpriv_sta = &psta->htpriv; + + u8 cur_beamform_cap = 0; + + /*Config Tx beamforming setting*/ + if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && + GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP((u8 *)(&phtpriv_sta->ht_cap))) { + SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); + /*Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ + SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 6); + } + + if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && + GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP((u8 *)(&phtpriv_sta->ht_cap))) { + SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); + /*Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ + SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 4); + } + if (cur_beamform_cap) + RTW_INFO("Client STA(%d) HT Beamforming Cap = 0x%02X\n", psta->cmn.aid, cur_beamform_cap); + + phtpriv_sta->beamform_cap = cur_beamform_cap; + psta->cmn.bf_info.ht_beamform_cap = cur_beamform_cap; + +} +#endif /*CONFIG_80211N_HT && CONFIG_BEAMFORMING*/ + /* notes: * AID: 1~MAX for sta and 0 for bc/mc in ap/adhoc mode */ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) @@ -743,7 +927,7 @@ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) struct ht_priv *phtpriv_ap = &pmlmepriv->htpriv; struct ht_priv *phtpriv_sta = &psta->htpriv; #endif /* CONFIG_80211N_HT */ - u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; + u8 cur_ldpc_cap = 0, cur_stbc_cap = 0; /* set intf_tag to if1 */ /* psta->intf_tag = 0; */ @@ -751,9 +935,6 @@ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) /*alloc macid when call rtw_alloc_stainfo(),release macid when call rtw_free_stainfo()*/ - /* ap mode */ - rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); - if (psecuritypriv->dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) psta->ieee8021x_blocked = _TRUE; else @@ -774,15 +955,15 @@ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) /* bwmode */ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) - psta->bw_mode = CHANNEL_WIDTH_40; + psta->cmn.bw_mode = CHANNEL_WIDTH_40; else - psta->bw_mode = CHANNEL_WIDTH_20; + psta->cmn.bw_mode = CHANNEL_WIDTH_20; if (psta->ht_40mhz_intolerant) - psta->bw_mode = CHANNEL_WIDTH_20; + psta->cmn.bw_mode = CHANNEL_WIDTH_20; - if (pmlmeext->cur_bwmode < psta->bw_mode) - psta->bw_mode = pmlmeext->cur_bwmode; + if (pmlmeext->cur_bwmode < psta->cmn.bw_mode) + psta->cmn.bw_mode = pmlmeext->cur_bwmode; phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; @@ -793,7 +974,7 @@ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) /* check if sta support s Short GI 40M */ if ((phtpriv_sta->ht_cap.cap_info & phtpriv_ap->ht_cap.cap_info) & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) { - if (psta->bw_mode == CHANNEL_WIDTH_40) /* according to psta->bw_mode */ + if (psta->cmn.bw_mode == CHANNEL_WIDTH_40) /* according to psta->bw_mode */ phtpriv_sta->sgi_40m = _TRUE; else phtpriv_sta->sgi_40m = _FALSE; @@ -805,52 +986,36 @@ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) if (TEST_FLAG(phtpriv_ap->ldpc_cap, LDPC_HT_ENABLE_TX) && GET_HT_CAP_ELE_LDPC_CAP((u8 *)(&phtpriv_sta->ht_cap))) { SET_FLAG(cur_ldpc_cap, (LDPC_HT_ENABLE_TX | LDPC_HT_CAP_TX)); - RTW_INFO("Enable HT Tx LDPC for STA(%d)\n", psta->aid); + RTW_INFO("Enable HT Tx LDPC for STA(%d)\n", psta->cmn.aid); } /* B7 B8 B9 Config STBC setting */ if (TEST_FLAG(phtpriv_ap->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC((u8 *)(&phtpriv_sta->ht_cap))) { SET_FLAG(cur_stbc_cap, (STBC_HT_ENABLE_TX | STBC_HT_CAP_TX)); - RTW_INFO("Enable HT Tx STBC for STA(%d)\n", psta->aid); + RTW_INFO("Enable HT Tx STBC for STA(%d)\n", psta->cmn.aid); } -#ifdef CONFIG_BEAMFORMING - /*Config Tx beamforming setting*/ - if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && - GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP((u8 *)(&phtpriv_sta->ht_cap))) { - SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); - /*Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ - SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 6); - } - - if (TEST_FLAG(phtpriv_ap->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && - GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP((u8 *)(&phtpriv_sta->ht_cap))) { - SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); - /*Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ - SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS((u8 *)(&phtpriv_sta->ht_cap)) << 4); - } - if (cur_beamform_cap) - RTW_INFO("Client STA(%d) HT Beamforming Cap = 0x%02X\n", psta->aid, cur_beamform_cap); -#endif /*CONFIG_BEAMFORMING*/ + #ifdef CONFIG_BEAMFORMING + update_sta_info_apmode_ht_bf_cap(padapter, psta); + #endif } else { phtpriv_sta->ampdu_enable = _FALSE; phtpriv_sta->sgi_20m = _FALSE; phtpriv_sta->sgi_40m = _FALSE; - psta->bw_mode = CHANNEL_WIDTH_20; + psta->cmn.bw_mode = CHANNEL_WIDTH_20; phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; } phtpriv_sta->ldpc_cap = cur_ldpc_cap; phtpriv_sta->stbc_cap = cur_stbc_cap; - phtpriv_sta->beamform_cap = cur_beamform_cap; /* Rx AMPDU */ - send_delba(padapter, 0, psta->hwaddr);/* recipient */ + send_delba(padapter, 0, psta->cmn.mac_addr);/* recipient */ /* TX AMPDU */ - send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ + send_delba(padapter, 1, psta->cmn.mac_addr);/* */ /* originator */ phtpriv_sta->agg_enable_bitmap = 0x0;/* reset */ phtpriv_sta->candidate_tid_bitmap = 0x0;/* reset */ #endif /* CONFIG_80211N_HT */ @@ -858,7 +1023,7 @@ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) #ifdef CONFIG_80211AC_VHT update_sta_vht_info_apmode(padapter, psta); #endif - + psta->cmn.ra_info.is_support_sgi = query_ra_short_GI(psta, rtw_get_tx_bw_mode(padapter, psta)); update_ldpc_stbc_cap(psta); /* todo: init other variables */ @@ -869,6 +1034,8 @@ void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta) /* add ratid */ /* add_RATid(padapter, psta); */ /* move to ap_sta_info_defer_update() */ + /* ap mode */ + rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); _enter_critical_bh(&psta->lock, &irqL); psta->state |= _FW_LINKED; @@ -913,7 +1080,7 @@ static void update_ap_info(_adapter *padapter, struct sta_info *psta) phtpriv_ap->sgi_40m = _FALSE; } - psta->bw_mode = pmlmeext->cur_bwmode; + psta->cmn.bw_mode = pmlmeext->cur_bwmode; phtpriv_ap->ch_offset = pmlmeext->cur_ch_offset; phtpriv_ap->agg_enable_bitmap = 0x0;/* reset */ @@ -944,7 +1111,7 @@ static void rtw_set_hw_wmm_param(_adapter *padapter) acm_mask = 0; - if (IsSupported5G(pmlmeext->cur_wireless_mode) || + if (is_supported_5g(pmlmeext->cur_wireless_mode) || (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) aSifsTime = 16; else @@ -1146,13 +1313,13 @@ static void rtw_ap_check_scan(_adapter *padapter) } _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -#ifdef CONFIG_AUTO_CHNL_SEL_NHM +#ifdef CONFIG_RTW_ACS if (padapter->registrypriv.acs_auto_scan) { do_scan = _TRUE; reason |= RTW_AUTO_SCAN_REASON_ACS; - rtw_acs_start(padapter, _TRUE); + rtw_acs_start(padapter); } -#endif +#endif/*CONFIG_RTW_ACS*/ if (_TRUE == do_scan) { RTW_INFO("%s : drv scans by itself and wait_completed\n", __func__); @@ -1160,10 +1327,11 @@ static void rtw_ap_check_scan(_adapter *padapter) rtw_scan_wait_completed(padapter); } -#ifdef CONFIG_AUTO_CHNL_SEL_NHM +#ifdef CONFIG_RTW_ACS if (padapter->registrypriv.acs_auto_scan) - rtw_acs_start(padapter, _FALSE); + rtw_acs_stop(padapter); #endif + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); phead = get_list_head(queue); @@ -1176,7 +1344,7 @@ static void rtw_ap_check_scan(_adapter *padapter) pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); - if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 + if (rtw_chset_search_ch(adapter_to_chset(padapter), pnetwork->network.Configuration.DSConfig) >= 0 && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid))) { delta_time = (u32) rtw_get_passing_time_ms(pnetwork->last_scanned); @@ -1213,9 +1381,7 @@ static void rtw_ap_check_scan(_adapter *padapter) _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); -#ifdef CONFIG_80211N_HT pmlmepriv->num_sta_no_ht = 0; /* reset to 0 after ap do scanning*/ -#endif } @@ -1251,7 +1417,7 @@ void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter) void start_bss_network(_adapter *padapter, struct createbss_parm *parm) { #define DUMP_ADAPTERS_STATUS 0 - + u8 self_action = MLME_ACTION_UNKNOWN; u8 val8; u16 bcn_interval; u32 acparm; @@ -1270,12 +1436,23 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) /* use for check ch bw offset can be allowed or not */ u8 chbw_allow = _TRUE; + if (MLME_IS_AP(padapter)) + self_action = MLME_AP_STARTED; + else if (MLME_IS_MESH(padapter)) + self_action = MLME_MESH_STARTED; + else + rtw_warn_on(1); + if (parm->req_ch != 0) { /* bypass other setting, go checking ch, bw, offset */ req_ch = parm->req_ch; req_bw = parm->req_bw; req_offset = parm->req_offset; goto chbw_decision; + } else { + /* inform this request comes from upper layer */ + req_ch = 0; + _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); } bcn_interval = (u16)pnetwork->Configuration.BeaconPeriod; @@ -1347,16 +1524,32 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) ch_setting_changed = rtw_ap_chbw_decision(padapter, req_ch, req_bw, req_offset , &ch_to_set, &bw_to_set, &offset_to_set, &chbw_allow); - /* let pnetwork_mlmeext == pnetwork_mlme. */ - _rtw_memcpy(pnetwork_mlmeext, pnetwork, pnetwork->Length); + /* let pnetwork_mlme == pnetwork_mlmeext */ + _rtw_memcpy(pnetwork, pnetwork_mlmeext, pnetwork_mlmeext->Length); rtw_start_bss_hdl_after_chbw_decided(padapter); #if defined(CONFIG_DFS_MASTER) - rtw_dfs_master_status_apply(padapter, MLME_AP_STARTED); + rtw_dfs_master_status_apply(padapter, self_action); #endif + rtw_hal_rcr_set_chk_bssid(padapter, self_action); #ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter)) { + /* + * due to check under rtw_ap_chbw_decision + * if under MCC mode, means req channel setting is the same as current channel setting + * if not under MCC mode, mean req channel setting is not the same as current channel setting + */ + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { + RTW_INFO(FUNC_ADPT_FMT": req channel setting is the same as current channel setting, go to update BCN\n" + , FUNC_ADPT_ARG(padapter)); + + goto update_beacon; + + } + } + /* issue null data to AP for all interface connecting to AP before switch channel setting for softap */ rtw_hal_mcc_issue_null_data(padapter, chbw_allow, 1); #endif /* CONFIG_MCC_MODE */ @@ -1377,26 +1570,35 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) rtw_hal_set_mcc_setting_start_bss_network(padapter, chbw_allow); #endif + if (ch_setting_changed == _TRUE + && (MLME_IS_GO(padapter) || MLME_IS_MESH(padapter)) /* pure AP is not needed*/ + && check_fwstate(pmlmepriv, WIFI_ASOC_STATE) + ) { + #if defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + rtw_cfg80211_ch_switch_notify(padapter + , pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset + , pmlmepriv->htpriv.ht_option); + #endif + } + if (DUMP_ADAPTERS_STATUS) { RTW_INFO(FUNC_ADPT_FMT" done\n", FUNC_ADPT_ARG(padapter)); dump_adapters_status(RTW_DBGDUMP , adapter_to_dvobj(padapter)); } +update_beacon: /* update beacon content only if bstart_bss is _TRUE */ if (_TRUE == pmlmeext->bstart_bss) { _irqL irqL; -#ifdef CONFIG_80211N_HT - if ((ATOMIC_READ(&pmlmepriv->olbc) == _TRUE) || - (ATOMIC_READ(&pmlmepriv->olbc_ht) == _TRUE)) { + if ((ATOMIC_READ(&pmlmepriv->olbc) == _TRUE) || (ATOMIC_READ(&pmlmepriv->olbc_ht) == _TRUE)) { /* AP is not starting a 40 MHz BSS in presence of an 802.11g BSS. */ pmlmepriv->ht_op_mode &= (~HT_INFO_OPERATION_MODE_OP_MODE_MASK); pmlmepriv->ht_op_mode |= OP_MODE_MAY_BE_LEGACY_STAS; update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE); } -#endif /* CONFIG_80211N_HT */ update_beacon(padapter, _TIM_IE_, NULL, _FALSE); @@ -1418,9 +1620,7 @@ void start_bss_network(_adapter *padapter, struct createbss_parm *parm) rtw_scan_wait_completed(padapter); /* send beacon */ - if ((0 == rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) - && (0 == rtw_mi_check_fwstate(padapter, WIFI_OP_CH_SWITCHING)) - ) { + if (!rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) { /*update_beacon(padapter, _TIM_IE_, NULL, _TRUE);*/ @@ -1470,6 +1670,7 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) u8 vht_cap = _FALSE; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); u8 rf_num = 0; /* SSID */ @@ -1485,7 +1686,7 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) RTW_INFO("%s, len=%d\n", __FUNCTION__, len); - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) + if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) return _FAIL; @@ -1499,8 +1700,10 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) _rtw_memcpy(ie, pbuf, pbss_network->IELength); - if (pbss_network->InfrastructureMode != Ndis802_11APMode) + if (pbss_network->InfrastructureMode != Ndis802_11APMode) { + rtw_warn_on(1); return _FAIL; + } rtw_ap_check_scan(padapter); @@ -1775,24 +1978,29 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) /* Update Supported MCS Set field */ { + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); + u8 rx_nss = 0; int i; rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + rx_nss = rtw_min(rf_type_to_rf_rx_cnt(rf_type), hal_spec->rx_nss_num); /* RX MCS Bitmask */ - switch (rf_type) { - case RF_1T1R: - case RF_1T2R: /* ? */ + switch (rx_nss) { + case 1: set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_1R); break; - case RF_2T2R: + case 2: set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_2R); break; - case RF_3T3R: + case 3: set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_3R); break; + case 4: + set_mcs_rate_by_mask(HT_CAP_ELE_RX_MCS_MAP(pht_cap), MCS_RATE_4R); + break; default: - RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); + RTW_WARN("rf_type:%d or rx_nss:%u is not expected\n", rf_type, hal_spec->rx_nss_num); } for (i = 0; i < 10; i++) *(HT_CAP_ELE_RX_MCS_MAP(pht_cap) + i) &= padapter->mlmeextpriv.default_supported_mcs_set[i]; @@ -1896,43 +2104,19 @@ int rtw_check_beacon_data(_adapter *padapter, u8 *pbuf, int len) && (pmlmepriv->htpriv.ht_option == _TRUE) && REGSTY_IS_11AC_ENABLE(pregistrypriv) && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) - && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent)) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) ) { if (vht_cap == _TRUE) pmlmepriv->vhtpriv.vht_option = _TRUE; - else if (REGSTY_IS_11AC_AUTO(pregistrypriv)) { - u8 cap_len, operation_len; - - rtw_vht_use_default_setting(padapter); - - { - /* VHT Operation mode notifiy bit in Extended IE (127) */ - uint len = 0; - - SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(pmlmepriv->ext_capab_ie_data, 1); - pmlmepriv->ext_capab_ie_len = 10; - rtw_set_ie(pbss_network->IEs + pbss_network->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); - pbss_network->IELength += pmlmepriv->ext_capab_ie_len; - } - - /* VHT Capabilities element */ - cap_len = rtw_build_vht_cap_ie(padapter, pbss_network->IEs + pbss_network->IELength); - pbss_network->IELength += cap_len; - - /* VHT Operation element */ - operation_len = rtw_build_vht_operation_ie(padapter, pbss_network->IEs + pbss_network->IELength, pbss_network->Configuration.DSConfig); - pbss_network->IELength += operation_len; - - pmlmepriv->vhtpriv.vht_option = _TRUE; - } + else if (REGSTY_IS_11AC_AUTO(pregistrypriv)) + rtw_vht_ies_attach(padapter, pbss_network); } #endif /* CONFIG_80211AC_VHT */ if(pbss_network->Configuration.DSConfig <= 14 && padapter->registrypriv.wifi_spec == 1) { uint len = 0; -#ifdef CONFIG_80211N_HT + SET_EXT_CAPABILITY_ELE_BSS_COEXIST(pmlmepriv->ext_capab_ie_data, 1); -#endif /* CONFIG_80211N_HT */ pmlmepriv->ext_capab_ie_len = 10; rtw_set_ie(pbss_network->IEs + pbss_network->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); pbss_network->IELength += pmlmepriv->ext_capab_ie_len; @@ -2168,7 +2352,7 @@ u8 rtw_ap_set_pairwise_key(_adapter *padapter, struct sta_info *psta) psetstakey_para->algorithm = (u8)psta->dot118021XPrivacy; - _rtw_memcpy(psetstakey_para->addr, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(psetstakey_para->addr, psta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(psetstakey_para->key, &psta->dot118021x_UncstKey, 16); @@ -2377,20 +2561,19 @@ static void associated_stainfo_update(_adapter *padapter, struct sta_info *psta, { struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - RTW_INFO("%s: "MAC_FMT", updated_type=0x%x\n", __func__, MAC_ARG(psta->hwaddr), sta_info_type); + RTW_INFO("%s: "MAC_FMT", updated_type=0x%x\n", __func__, MAC_ARG(psta->cmn.mac_addr), sta_info_type); if (sta_info_type & STA_INFO_UPDATE_BW) { -#ifdef CONFIG_80211N_HT + if ((psta->flags & WLAN_STA_HT) && !psta->ht_20mhz_set) { if (pmlmepriv->sw_to_20mhz) { - psta->bw_mode = CHANNEL_WIDTH_20; + psta->cmn.bw_mode = CHANNEL_WIDTH_20; /*psta->htpriv.ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE;*/ psta->htpriv.sgi_40m = _FALSE; } else { /*TODO: Switch back to 40MHZ?80MHZ*/ } } -#endif /* CONFIG_80211N_HT */ } /* @@ -2439,12 +2622,6 @@ static void update_bcn_ext_capab_ie(_adapter *padapter) } -static void update_bcn_fixed_ie(_adapter *padapter) -{ - RTW_INFO("%s\n", __FUNCTION__); - -} - static void update_bcn_erpinfo_ie(_adapter *padapter) { struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); @@ -2479,7 +2656,6 @@ static void update_bcn_erpinfo_ie(_adapter *padapter) } -#ifdef CONFIG_80211N_HT static void update_bcn_htcap_ie(_adapter *padapter) { RTW_INFO("%s\n", __FUNCTION__); @@ -2568,7 +2744,6 @@ static void update_bcn_htinfo_ie(_adapter *padapter) /*associated_clients_update(padapter, beacon_updated, sta_info_update_type);*/ } -#endif /* CONFIG_80211N_HT */ static void update_bcn_rsn_ie(_adapter *padapter) { @@ -2647,6 +2822,9 @@ static void update_bcn_wps_ie(_adapter *padapter) if (sr) { set_fwstate(pmlmepriv, WIFI_UNDER_WPS); RTW_INFO("%s, set WIFI_UNDER_WPS\n", __func__); + } else { + clr_fwstate(pmlmepriv, WIFI_UNDER_WPS); + RTW_INFO("%s, clr WIFI_UNDER_WPS\n", __func__); } } #endif @@ -2679,71 +2857,49 @@ void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *ta { _irqL irqL; struct mlme_priv *pmlmepriv; - struct mlme_ext_priv *pmlmeext; - /* struct mlme_ext_info *pmlmeinfo; */ - - /* RTW_INFO("%s\n", __FUNCTION__); */ + struct mlme_ext_priv *pmlmeext; if (!padapter) return; pmlmepriv = &(padapter->mlmepriv); pmlmeext = &(padapter->mlmeextpriv); - /* pmlmeinfo = &(pmlmeext->mlmext_info); */ - if (_FALSE == pmlmeext->bstart_bss) + if (pmlmeext->bstart_bss == _FALSE) return; _enter_critical_bh(&pmlmepriv->bcn_update_lock, &irqL); switch (ie_id) { - case 0xFF: - - update_bcn_fixed_ie(padapter);/* 8: TimeStamp, 2: Beacon Interval 2:Capability */ - - break; - case _TIM_IE_: - update_BCNTIM(padapter); - break; case _ERPINFO_IE_: - update_bcn_erpinfo_ie(padapter); - break; case _HT_CAPABILITY_IE_: -#ifdef CONFIG_80211N_HT update_bcn_htcap_ie(padapter); -#endif /*CONFIG_80211N_HT */ break; + case _RSN_IE_2_: - update_bcn_rsn_ie(padapter); - break; case _HT_ADD_INFO_IE_: -#ifdef CONFIG_80211N_HT update_bcn_htinfo_ie(padapter); -#endif /*CONFIG_80211N_HT */ break; case _EXT_CAP_IE_: - update_bcn_ext_capab_ie(padapter); - break; case _VENDOR_SPECIFIC_IE_: - update_bcn_vendor_spec_ie(padapter, oui); - break; + case 0xFF: default: break; } @@ -2766,7 +2922,6 @@ void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *ta } #endif #endif /* !CONFIG_INTERRUPT_BASED_TXBCN */ - } #ifdef CONFIG_80211N_HT @@ -2781,7 +2936,7 @@ void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_l uint frame_body_len = frame_len - sizeof(struct rtw_ieee80211_hdr_3addr); u8 category, action; - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta == NULL) return; @@ -3003,11 +3158,8 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) pmlmepriv->num_sta_no_short_preamble++; if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && - (pmlmepriv->num_sta_no_short_preamble == 1)) { + (pmlmepriv->num_sta_no_short_preamble == 1)) beacon_updated = _TRUE; - update_beacon(padapter, 0xFF, NULL, _TRUE); - } - } } else { if (psta->no_short_preamble_set) { @@ -3016,11 +3168,8 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) pmlmepriv->num_sta_no_short_preamble--; if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && - (pmlmepriv->num_sta_no_short_preamble == 0)) { + (pmlmepriv->num_sta_no_short_preamble == 0)) beacon_updated = _TRUE; - update_beacon(padapter, 0xFF, NULL, _TRUE); - } - } } @@ -3041,7 +3190,7 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) if (pmlmepriv->num_sta_non_erp == 1) { beacon_updated = _TRUE; - update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); + update_beacon(padapter, _ERPINFO_IE_, NULL, _FALSE); } } @@ -3053,7 +3202,7 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) if (pmlmepriv->num_sta_non_erp == 0) { beacon_updated = _TRUE; - update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); + update_beacon(padapter, _ERPINFO_IE_, NULL, _FALSE); } } @@ -3078,11 +3227,8 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) pmlmepriv->num_sta_no_short_slot_time++; if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && - (pmlmepriv->num_sta_no_short_slot_time == 1)) { + (pmlmepriv->num_sta_no_short_slot_time == 1)) beacon_updated = _TRUE; - update_beacon(padapter, 0xFF, NULL, _TRUE); - } - } } else { if (psta->no_short_slot_time_set) { @@ -3091,20 +3237,17 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) pmlmepriv->num_sta_no_short_slot_time--; if ((pmlmeext->cur_wireless_mode > WIRELESS_11B) && - (pmlmepriv->num_sta_no_short_slot_time == 0)) { + (pmlmepriv->num_sta_no_short_slot_time == 0)) beacon_updated = _TRUE; - update_beacon(padapter, 0xFF, NULL, _TRUE); - } } } #ifdef CONFIG_80211N_HT - if (psta->flags & WLAN_STA_HT) { u16 ht_capab = le16_to_cpu(psta->htpriv.ht_cap.cap_info); - RTW_INFO("HT: STA " MAC_FMT " HT Capabilities " - "Info: 0x%04x\n", MAC_ARG(psta->hwaddr), ht_capab); + RTW_INFO("HT: STA " MAC_FMT " HT Capabilities Info: 0x%04x\n", + MAC_ARG(psta->cmn.mac_addr), ht_capab); if (psta->no_ht_set) { psta->no_ht_set = 0; @@ -3118,7 +3261,7 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) } RTW_INFO("%s STA " MAC_FMT " - no " "greenfield, num of non-gf stations %d\n", - __FUNCTION__, MAC_ARG(psta->hwaddr), + __FUNCTION__, MAC_ARG(psta->cmn.mac_addr), pmlmepriv->num_sta_ht_no_gf); } @@ -3129,7 +3272,7 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) } RTW_INFO("%s STA " MAC_FMT " - 20 MHz HT, " "num of 20MHz HT STAs %d\n", - __FUNCTION__, MAC_ARG(psta->hwaddr), + __FUNCTION__, MAC_ARG(psta->cmn.mac_addr), pmlmepriv->num_sta_ht_20mhz); } @@ -3141,19 +3284,21 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) if (pmlmepriv->htpriv.ht_option == _TRUE) { RTW_INFO("%s STA " MAC_FMT " - no HT, num of non-HT stations %d\n", - __FUNCTION__, MAC_ARG(psta->hwaddr), + __FUNCTION__, MAC_ARG(psta->cmn.mac_addr), pmlmepriv->num_sta_no_ht); } } if (rtw_ht_operation_update(padapter) > 0) { update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); - update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); - /*beacon_updated = _TRUE;*/ + update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE); + beacon_updated = _TRUE; } - #endif /* CONFIG_80211N_HT */ + if (beacon_updated) + update_beacon(padapter, 0xFF, NULL, _TRUE); + /* update associcated stations cap. */ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); @@ -3164,20 +3309,25 @@ void bss_cap_update_on_sta_join(_adapter *padapter, struct sta_info *psta) u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) { u8 beacon_updated = _FALSE; + struct sta_priv *pstapriv = &padapter->stapriv; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); if (!psta) return beacon_updated; + if (pstapriv->tim_bitmap & BIT(psta->cmn.aid)) { + pstapriv->tim_bitmap &= (~ BIT(psta->cmn.aid)); + beacon_updated = _TRUE; + update_beacon(padapter, _TIM_IE_, NULL, _FALSE); + } + if (psta->no_short_preamble_set) { psta->no_short_preamble_set = 0; pmlmepriv->num_sta_no_short_preamble--; if (pmlmeext->cur_wireless_mode > WIRELESS_11B - && pmlmepriv->num_sta_no_short_preamble == 0) { + && pmlmepriv->num_sta_no_short_preamble == 0) beacon_updated = _TRUE; - update_beacon(padapter, 0xFF, NULL, _TRUE); - } } if (psta->nonerp_set) { @@ -3185,7 +3335,7 @@ u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) pmlmepriv->num_sta_non_erp--; if (pmlmepriv->num_sta_non_erp == 0) { beacon_updated = _TRUE; - update_beacon(padapter, _ERPINFO_IE_, NULL, _TRUE); + update_beacon(padapter, _ERPINFO_IE_, NULL, _FALSE); } } @@ -3193,14 +3343,11 @@ u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) psta->no_short_slot_time_set = 0; pmlmepriv->num_sta_no_short_slot_time--; if (pmlmeext->cur_wireless_mode > WIRELESS_11B - && pmlmepriv->num_sta_no_short_slot_time == 0) { + && pmlmepriv->num_sta_no_short_slot_time == 0) beacon_updated = _TRUE; - update_beacon(padapter, 0xFF, NULL, _TRUE); - } } #ifdef CONFIG_80211N_HT - if (psta->no_ht_gf_set) { psta->no_ht_gf_set = 0; pmlmepriv->num_sta_ht_no_gf--; @@ -3216,15 +3363,15 @@ u8 bss_cap_update_on_sta_leave(_adapter *padapter, struct sta_info *psta) pmlmepriv->num_sta_ht_20mhz--; } - - if (rtw_ht_operation_update(padapter) > 0) { update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); - update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); + update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _FALSE); } - #endif /* CONFIG_80211N_HT */ + if (beacon_updated == _TRUE) + update_beacon(padapter, 0xFF, NULL, _TRUE); + #if 0 /* update associated stations cap. */ associated_clients_update(padapter, beacon_updated, STA_INFO_UPDATE_ALL); /* move it to avoid deadlock */ @@ -3250,24 +3397,22 @@ u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reaso if (active == _TRUE) { #ifdef CONFIG_80211N_HT /* tear down Rx AMPDU */ - send_delba(padapter, 0, psta->hwaddr);/* recipient */ + send_delba(padapter, 0, psta->cmn.mac_addr);/* recipient */ /* tear down TX AMPDU */ - send_delba(padapter, 1, psta->hwaddr);/* */ /* originator */ + send_delba(padapter, 1, psta->cmn.mac_addr);/* */ /* originator */ #endif /* CONFIG_80211N_HT */ - issue_deauth(padapter, psta->hwaddr, reason); + issue_deauth(padapter, psta->cmn.mac_addr, reason); } #ifdef CONFIG_BEAMFORMING - beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->hwaddr, ETH_ALEN, 1); + beamforming_wk_cmd(padapter, BEAMFORMING_CTRL_LEAVE, psta->cmn.mac_addr, ETH_ALEN, 1); #endif -#ifdef CONFIG_80211N_HT psta->htpriv.agg_enable_bitmap = 0x0;/* reset */ psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ -#endif /* CONFIG_80211N_HT */ /* clear cam entry / key */ rtw_clearstakey_cmd(padapter, psta, enqueue); @@ -3277,22 +3422,21 @@ u8 ap_free_sta(_adapter *padapter, struct sta_info *psta, bool active, u16 reaso psta->state &= ~_FW_LINKED; _exit_critical_bh(&psta->lock, &irqL); -#ifdef CONFIG_IOCTL_CFG80211 - if (1) { -#ifdef COMPAT_KERNEL_RELEASE - rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -#elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) - rtw_cfg80211_indicate_sta_disassoc(padapter, psta->hwaddr, reason); -#else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ - /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */ -#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ - } else -#endif /* CONFIG_IOCTL_CFG80211 */ { +#ifdef CONFIG_IOCTL_CFG80211 + #ifdef COMPAT_KERNEL_RELEASE + rtw_cfg80211_indicate_sta_disassoc(padapter, psta->cmn.mac_addr, reason); + #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) + rtw_cfg80211_indicate_sta_disassoc(padapter, psta->cmn.mac_addr, reason); + #else /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ + /* will call rtw_cfg80211_indicate_sta_disassoc() in cmd_thread for old API context */ + #endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && !defined(CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER) */ +#else rtw_indicate_sta_disassoc_event(padapter, psta); +#endif } - report_del_sta_event(padapter, psta->hwaddr, reason, enqueue, _FALSE); + report_del_sta_event(padapter, psta->cmn.mac_addr, reason, enqueue, _FALSE); beacon_updated = bss_cap_update_on_sta_leave(padapter, psta); @@ -3331,7 +3475,7 @@ int rtw_ap_inform_ch_switch(_adapter *padapter, u8 new_ch, u8 ch_offset) psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); plist = get_next(plist); - issue_action_spct_ch_switch(padapter, psta->hwaddr, new_ch, ch_offset); + issue_action_spct_ch_switch(padapter, psta->cmn.mac_addr, new_ch, ch_offset); psta->expire_to = ((pstapriv->expire_to * 2) > 5) ? 5 : (pstapriv->expire_to * 2); } _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); @@ -3355,7 +3499,7 @@ int rtw_sta_flush(_adapter *padapter, bool enqueue) char flush_list[NUM_STA]; int i; - if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) + if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) return ret; RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); @@ -3443,7 +3587,7 @@ void sta_info_update(_adapter *padapter, struct sta_info *psta) void ap_sta_info_defer_update(_adapter *padapter, struct sta_info *psta) { if (psta->state & _FW_LINKED) - rtw_hal_update_ra_mask(psta, 0); /* DM_RATR_STA_INIT */ + rtw_hal_update_ra_mask(psta); /* DM_RATR_STA_INIT */ } /* restore hw setting from sw data structures */ void rtw_ap_restore_network(_adapter *padapter) @@ -3577,8 +3721,28 @@ void start_ap_mode(_adapter *padapter) } +void rtw_ap_bcmc_sta_flush(_adapter *padapter) +{ +#ifdef CONFIG_CONCURRENT_MODE + int cam_id = -1; + u8 *addr = adapter_mac_addr(padapter); + + cam_id = rtw_iface_bcmc_id_get(padapter); + if (cam_id != INVALID_SEC_MAC_CAM_ID) { + RTW_PRINT("clear group key for "ADPT_FMT" addr:"MAC_FMT", camid:%d\n", + ADPT_ARG(padapter), MAC_ARG(addr), cam_id); + clear_cam_entry(padapter, cam_id); + rtw_camid_free(padapter, cam_id); + rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); /*init default value*/ + } +#else + invalidate_cam_all(padapter); +#endif +} + void stop_ap_mode(_adapter *padapter) { + u8 self_action = MLME_ACTION_UNKNOWN; _irqL irqL; struct sta_info *psta = NULL; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); @@ -3587,6 +3751,13 @@ void stop_ap_mode(_adapter *padapter) RTW_INFO("%s -"ADPT_FMT"\n", __func__, ADPT_ARG(padapter)); + if (MLME_IS_AP(padapter)) + self_action = MLME_AP_STOPPED; + else if (MLME_IS_MESH(padapter)) + self_action = MLME_MESH_STOPPED; + else + rtw_warn_on(1); + pmlmepriv->update_bcn = _FALSE; /*pmlmeext->bstart_bss = _FALSE;*/ padapter->netif_up = _FALSE; @@ -3598,7 +3769,7 @@ void stop_ap_mode(_adapter *padapter) padapter->securitypriv.ndisencryptstatus = Ndis802_11WEPDisabled; #ifdef CONFIG_DFS_MASTER - rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); + rtw_dfs_master_status_apply(padapter, self_action); #endif /* free scan queue */ @@ -3609,14 +3780,18 @@ void stop_ap_mode(_adapter *padapter) #endif rtw_sta_flush(padapter, _TRUE); + rtw_ap_bcmc_sta_flush(padapter); /* free_assoc_sta_resources */ rtw_free_all_stainfo(padapter); psta = rtw_get_bcmc_stainfo(padapter); - /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ - rtw_free_stainfo(padapter, psta); - /*_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ + if (psta) { + rtw_sta_mstatus_disc_rpt(padapter, psta->cmn.mac_id); + /* _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ + rtw_free_stainfo(padapter, psta); + /*_exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL);*/ + } rtw_free_mlme_priv_ie_data(pmlmepriv); @@ -3641,6 +3816,8 @@ void stop_ap_mode(_adapter *padapter) pmlmeext->bstart_bss = _FALSE; + rtw_hal_rcr_set_chk_bssid(padapter, self_action); + #ifdef CONFIG_BT_COEXIST rtw_btcoex_MediaStatusNotify(padapter, 0); /* disconnect */ #endif @@ -3653,10 +3830,32 @@ void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, { #define UPDATE_VHT_CAP 1 #define UPDATE_HT_CAP 1 +#ifdef CONFIG_80211AC_VHT + struct vht_priv *vhtpriv = &adapter->mlmepriv.vhtpriv; +#endif + { + u8 *p; + int ie_len; + u8 old_ch = bss->Configuration.DSConfig; + bool change_band = _FALSE; + + if ((ch <= 14 && old_ch >= 36) || (ch >= 36 && old_ch <= 14)) + change_band = _TRUE; + + /* update channel in IE */ + p = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); + if (p && ie_len > 0) + *(p + 2) = ch; + + bss->Configuration.DSConfig = ch; + + /* band is changed, update ERP, support rate, ext support rate IE */ + if (change_band == _TRUE) + change_band_update_ie(adapter, bss, ch); + } #ifdef CONFIG_80211AC_VHT - { - struct vht_priv *vhtpriv = &adapter->mlmepriv.vhtpriv; + if (vhtpriv->vht_option == _TRUE) { u8 *vht_cap_ie, *vht_op_ie; int vht_cap_ielen, vht_op_ielen; u8 center_freq; @@ -3749,28 +3948,6 @@ void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, } } #endif /* CONFIG_80211N_HT */ - - { - u8 *p; - int ie_len; - u8 old_ch = bss->Configuration.DSConfig; - bool change_band = _FALSE; - - if ((ch <= 14 && old_ch >= 36) || (ch >= 36 && old_ch <= 14)) - change_band = _TRUE; - - /* update channel in IE */ - p = rtw_get_ie((bss->IEs + sizeof(NDIS_802_11_FIXED_IEs)), _DSSET_IE_, &ie_len, (bss->IELength - sizeof(NDIS_802_11_FIXED_IEs))); - if (p && ie_len > 0) - *(p + 2) = ch; - - bss->Configuration.DSConfig = ch; - - /* band is changed, update ERP, support rate, ext support rate IE */ - if (change_band == _TRUE) - change_band_update_ie(adapter, bss, ch); - } - } bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offset @@ -3781,13 +3958,38 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse u8 u_ch = 0, u_offset, u_bw; bool changed = _FALSE; struct mlme_ext_priv *mlmeext = &(adapter->mlmeextpriv); - WLAN_BSSID_EX *network = &(adapter->mlmepriv.cur_network.network); + WLAN_BSSID_EX *network = &(mlmeext->mlmext_info.network); struct mi_state mstate; bool set_u_ch = _FALSE, set_dec_ch = _FALSE; - rtw_ies_get_chbw(network->IEs + sizeof(NDIS_802_11_FIXED_IEs) - , network->IELength - sizeof(NDIS_802_11_FIXED_IEs) - , &cur_ie_ch, &cur_ie_bw, &cur_ie_offset); + rtw_ies_get_chbw(BSS_EX_TLV_IES(network), BSS_EX_TLV_IES_LEN(network) + , &cur_ie_ch, &cur_ie_bw, &cur_ie_offset); + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(adapter)) { + if (rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) { + /* check channel settings are the same */ + if (cur_ie_ch == mlmeext->cur_channel + && cur_ie_bw == mlmeext->cur_bwmode + && cur_ie_offset == mlmeext->cur_ch_offset) { + + + RTW_INFO(FUNC_ADPT_FMT"req ch settings are the same as current ch setting, go to exit\n" + , FUNC_ADPT_ARG(adapter)); + + *chbw_allow = _FALSE; + goto exit; + } else { + RTW_INFO(FUNC_ADPT_FMT"request channel settings are not the same as current channel setting(%d,%d,%d,%d,%d,%d), restart MCC\n" + , FUNC_ADPT_ARG(adapter) + , cur_ie_ch, cur_ie_bw, cur_ie_bw + , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); + + rtw_hal_set_mcc_setting_disconnect(adapter); + } + } + } +#endif /* CONFIG_MCC_MODE */ /* use chbw of cur_ie updated with specifying req as temporary decision */ dec_ch = (req_ch <= 0) ? cur_ie_ch : req_ch; @@ -3795,20 +3997,19 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse dec_offset = (req_offset < 0) ? cur_ie_offset : req_offset; rtw_mi_status_no_self(adapter, &mstate); - RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num%u, ap_num:%u\n" - , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate), MSTATE_AP_NUM(&mstate)); + RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num%u, ap_num:%u, mesh_num:%u\n" + , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate) + , MSTATE_AP_NUM(&mstate), MSTATE_MESH_NUM(&mstate)); - if (MSTATE_STA_LD_NUM(&mstate) || MSTATE_AP_NUM(&mstate)) { - /* has linked STA or AP mode, follow */ + if (MSTATE_STA_LD_NUM(&mstate) || MSTATE_AP_NUM(&mstate) || MSTATE_MESH_NUM(&mstate)) { + /* has linked STA or AP/Mesh mode, follow */ rtw_warn_on(!rtw_mi_get_ch_setting_union_no_self(adapter, &u_ch, &u_bw, &u_offset)); RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -#ifdef CONFIG_80211N_HT rtw_adjust_chbw(adapter, u_ch, &dec_bw, &dec_offset); -#endif /* CONFIG_80211N_HT */ #ifdef CONFIG_MCC_MODE if (MCC_EN(adapter)) { if (!rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch, dec_bw, dec_offset)) { @@ -3828,8 +4029,7 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset , &u_ch, &u_bw, &u_offset); - rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) - , dec_ch, dec_bw, dec_offset); + rtw_ap_update_bss_chbw(adapter, network, dec_ch, dec_bw, dec_offset); set_u_ch = _TRUE; } else if (MSTATE_STA_LG_NUM(&mstate)) { @@ -3840,16 +4040,14 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n", FUNC_ADPT_ARG(adapter), u_ch, u_bw, u_offset); RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); -#ifdef CONFIG_80211N_HT rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); -#endif + if (rtw_is_chbw_grouped(u_ch, u_bw, u_offset, dec_ch, dec_bw, dec_offset)) { rtw_sync_chbw(&dec_ch, &dec_bw, &dec_offset , &u_ch, &u_bw, &u_offset); - rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) - , dec_ch, dec_bw, dec_offset); + rtw_ap_update_bss_chbw(adapter, network, dec_ch, dec_bw, dec_offset); set_u_ch = _TRUE; @@ -3873,35 +4071,40 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse set_fwstate(&adapter->mlmepriv, WIFI_OP_CH_SWITCHING); } } else { - /* single AP mode */ + /* single AP/Mesh mode */ RTW_INFO(FUNC_ADPT_FMT" req: %d,%d,%d\n", FUNC_ADPT_ARG(adapter), req_ch, req_bw, req_offset); /* check temporary decision first */ -#ifdef CONFIG_80211N_HT rtw_adjust_chbw(adapter, dec_ch, &dec_bw, &dec_offset); -#endif if (!rtw_get_offset_by_chbw(dec_ch, dec_bw, &dec_offset)) { -#if defined(CONFIG_DFS_MASTER) if (req_ch == -1 || req_bw == -1) goto choose_chbw; -#endif RTW_WARN(FUNC_ADPT_FMT" req: %u,%u has no valid offset\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw); *chbw_allow = _FALSE; goto exit; } - if (!rtw_chset_is_chbw_valid(mlmeext->channel_set, dec_ch, dec_bw, dec_offset)) { -#if defined(CONFIG_DFS_MASTER) + if (!rtw_chset_is_chbw_valid(adapter_to_chset(adapter), dec_ch, dec_bw, dec_offset)) { if (req_ch == -1 || req_bw == -1) goto choose_chbw; -#endif RTW_WARN(FUNC_ADPT_FMT" req: %u,%u,%u doesn't fit in chplan\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); *chbw_allow = _FALSE; goto exit; } - if (rtw_chset_is_ch_non_ocp(mlmeext->channel_set, dec_ch, dec_bw, dec_offset) == _FALSE) + if (rtw_odm_dfs_domain_unknown(adapter) && rtw_is_dfs_chbw(dec_ch, dec_bw, dec_offset)) { + if (req_ch >= 0) + RTW_WARN(FUNC_ADPT_FMT" DFS channel %u,%u,%u can't be used\n", FUNC_ADPT_ARG(adapter), dec_ch, dec_bw, dec_offset); + if (req_ch > 0) { + /* specific channel and not from IE => don't change channel setting */ + *chbw_allow = _FALSE; + goto exit; + } + goto choose_chbw; + } + + if (rtw_chset_is_ch_non_ocp(adapter_to_chset(adapter), dec_ch, dec_bw, dec_offset) == _FALSE) goto update_bss_chbw; choose_chbw: @@ -3909,23 +4112,29 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse req_bw = cur_ie_bw; #if defined(CONFIG_DFS_MASTER) - /* choose 5G DFS channel for debug */ - if (adapter_to_rfctl(adapter)->dbg_dfs_master_choose_dfs_ch_first - && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G | RTW_CHF_NON_DFS) == _TRUE) - RTW_INFO(FUNC_ADPT_FMT" choose 5G DFS channel for debug\n", FUNC_ADPT_ARG(adapter)); - else if (adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags - && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags) == _TRUE) - RTW_INFO(FUNC_ADPT_FMT" choose with dfs_ch_sel_d_flags:0x%02x for debug\n", FUNC_ADPT_ARG(adapter), adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags); - else if (rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, 0) == _FALSE) { + if (!rtw_odm_dfs_domain_unknown(adapter)) { + /* choose 5G DFS channel for debug */ + if (adapter_to_rfctl(adapter)->dbg_dfs_master_choose_dfs_ch_first + && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_2G | RTW_CHF_NON_DFS) == _TRUE) + RTW_INFO(FUNC_ADPT_FMT" choose 5G DFS channel for debug\n", FUNC_ADPT_ARG(adapter)); + else if (adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags + && rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags) == _TRUE) + RTW_INFO(FUNC_ADPT_FMT" choose with dfs_ch_sel_d_flags:0x%02x for debug\n", FUNC_ADPT_ARG(adapter), adapter_to_rfctl(adapter)->dfs_ch_sel_d_flags); + else if (rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, 0) == _FALSE) { + RTW_WARN(FUNC_ADPT_FMT" no available channel\n", FUNC_ADPT_ARG(adapter)); + *chbw_allow = _FALSE; + goto exit; + } + } else +#endif /* defined(CONFIG_DFS_MASTER) */ + if (rtw_choose_shortest_waiting_ch(adapter, req_bw, &dec_ch, &dec_bw, &dec_offset, RTW_CHF_DFS) == _FALSE) { RTW_WARN(FUNC_ADPT_FMT" no available channel\n", FUNC_ADPT_ARG(adapter)); *chbw_allow = _FALSE; goto exit; } -#endif /* defined(CONFIG_DFS_MASTER) */ update_bss_chbw: - rtw_ap_update_bss_chbw(adapter, &(adapter->mlmepriv.cur_network.network) - , dec_ch, dec_bw, dec_offset); + rtw_ap_update_bss_chbw(adapter, network, dec_ch, dec_bw, dec_offset); /* channel bw offset can be allowed for single AP, not need MCC */ *chbw_allow = _TRUE; @@ -3973,8 +4182,38 @@ bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offse return changed; } -/*#define DBG_SWTIMER_BASED_TXBCN*/ +u8 rtw_ap_sta_linking_state_check(_adapter *adapter) +{ + struct sta_info *psta; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct sta_priv *pstapriv = &adapter->stapriv; + int i; + _list *plist, *phead; + _irqL irqL; + u8 rst = _FALSE; + if (!MLME_IS_AP(adapter) && !MLME_IS_MESH(adapter)) + return _FALSE; + + if (pstapriv->auth_list_cnt !=0) + return _TRUE; + + _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); + phead = &pstapriv->asoc_list; + plist = get_next(phead); + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); + plist = get_next(plist); + if (!(psta->state &_FW_LINKED)) { + rst = _TRUE; + break; + } + } + _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); + return rst; +} + +/*#define DBG_SWTIMER_BASED_TXBCN*/ #ifdef CONFIG_SWTIMER_BASED_TXBCN void tx_beacon_handlder(struct dvobj_priv *pdvobj) { @@ -3986,6 +4225,7 @@ void tx_beacon_handlder(struct dvobj_priv *pdvobj) u64 time; u32 cur_tick, time_offset; /* unit : usec */ u32 inter_bcn_space_us; /* unit : usec */ + u32 txbcn_timer_ms; /* unit : ms */ int nr_vap, idx, bcn_idx; int i; u8 val8, late = 0; @@ -4085,14 +4325,31 @@ void tx_beacon_handlder(struct dvobj_priv *pdvobj) #ifdef DBG_SWTIMER_BASED_TXBCN RTW_INFO("set sw bcn timer %d us\n", time_offset); #endif - _set_timer(&pdvobj->txbcn_timer, time_offset / NET80211_TU_TO_US); + txbcn_timer_ms = time_offset / NET80211_TU_TO_US; + _set_timer(&pdvobj->txbcn_timer, txbcn_timer_ms); if (padapter) { +#ifdef CONFIG_BCN_RECOVERY + rtw_ap_bcn_recovery(padapter); +#endif /*CONFIG_BCN_RECOVERY*/ + +#ifdef CONFIG_BCN_XMIT_PROTECT + rtw_ap_bcn_queue_empty_check(padapter, txbcn_timer_ms); +#endif /*CONFIG_BCN_XMIT_PROTECT*/ + #ifdef DBG_SWTIMER_BASED_TXBCN RTW_INFO("padapter=%p, PORT=%d\n", padapter, padapter->hw_port); #endif - /*update_beacon(padapter, _TIM_IE_, NULL, _FALSE);*/ - issue_beacon(padapter, 0); + /* bypass TX BCN queue if op ch is switching/waiting */ + if (!check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) + #ifdef CONFIG_DFS_MASTER + && !IS_CH_WAITING(adapter_to_rfctl(padapter)) + #endif + ) { + /*update_beacon(padapter, _TIM_IE_, NULL, _FALSE);*/ + /*issue_beacon(padapter, 0);*/ + send_beacon(padapter); + } } #if 0 @@ -4107,8 +4364,9 @@ void tx_beacon_handlder(struct dvobj_priv *pdvobj) } -void tx_beacon_timer_handlder(struct dvobj_priv *pdvobj) +void tx_beacon_timer_handlder(void *ctx) { + struct dvobj_priv *pdvobj = (struct dvobj_priv *)ctx; _adapter *padapter = pdvobj->padapters[0]; if (padapter) @@ -4116,4 +4374,288 @@ void tx_beacon_timer_handlder(struct dvobj_priv *pdvobj) } #endif +void rtw_ap_parse_sta_capability(_adapter *adapter, struct sta_info *sta, u8 *cap) +{ + sta->capability = RTW_GET_LE16(cap); + if (sta->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) + sta->flags |= WLAN_STA_SHORT_PREAMBLE; + else + sta->flags &= ~WLAN_STA_SHORT_PREAMBLE; +} + +u16 rtw_ap_parse_sta_supported_rates(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len) +{ + u8 rate_set[16]; + u8 rate_num; + int i; + u16 status = _STATS_SUCCESSFUL_; + + rtw_ies_get_supported_rate(tlv_ies, tlv_ies_len, rate_set, &rate_num); + if (rate_num == 0) { + RTW_INFO(FUNC_ADPT_FMT" sta "MAC_FMT" with no supported rate\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(sta->cmn.mac_addr)); + status = _STATS_FAILURE_; + goto exit; + } + + _rtw_memcpy(sta->bssrateset, rate_set, rate_num); + sta->bssratelen = rate_num; + + if (MLME_IS_AP(adapter)) { + /* this function force only CCK rates to be bassic rate... */ + UpdateBrateTblForSoftAP(sta->bssrateset, sta->bssratelen); + } + + /* if (hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G) */ /* ? */ + sta->flags |= WLAN_STA_NONERP; + for (i = 0; i < sta->bssratelen; i++) { + if ((sta->bssrateset[i] & 0x7f) > 22) { + sta->flags &= ~WLAN_STA_NONERP; + break; + } + } + +exit: + return status; +} + +u16 rtw_ap_parse_sta_security_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems) +{ + struct security_priv *sec = &adapter->securitypriv; + u8 *wpa_ie; + int wpa_ie_len; + int group_cipher = 0, pairwise_cipher = 0; + u16 status = _STATS_SUCCESSFUL_; + + sta->dot8021xalg = 0; + sta->wpa_psk = 0; + sta->wpa_group_cipher = 0; + sta->wpa2_group_cipher = 0; + sta->wpa_pairwise_cipher = 0; + sta->wpa2_pairwise_cipher = 0; + _rtw_memset(sta->wpa_ie, 0, sizeof(sta->wpa_ie)); + + if ((sec->wpa_psk & BIT(1)) && elems->rsn_ie) { + wpa_ie = elems->rsn_ie; + wpa_ie_len = elems->rsn_ie_len; + + if (rtw_parse_wpa2_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { + sta->dot8021xalg = 1;/* psk, todo:802.1x */ + sta->wpa_psk |= BIT(1); + + sta->wpa2_group_cipher = group_cipher & sec->wpa2_group_cipher; + sta->wpa2_pairwise_cipher = pairwise_cipher & sec->wpa2_pairwise_cipher; + + if (!sta->wpa2_group_cipher) + status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; + + if (!sta->wpa2_pairwise_cipher) + status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; + } else + status = WLAN_STATUS_INVALID_IE; + + } + else if ((sec->wpa_psk & BIT(0)) && elems->wpa_ie) { + wpa_ie = elems->wpa_ie; + wpa_ie_len = elems->wpa_ie_len; + + if (rtw_parse_wpa_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { + sta->dot8021xalg = 1;/* psk, todo:802.1x */ + sta->wpa_psk |= BIT(0); + + sta->wpa_group_cipher = group_cipher & sec->wpa_group_cipher; + sta->wpa_pairwise_cipher = pairwise_cipher & sec->wpa_pairwise_cipher; + + if (!sta->wpa_group_cipher) + status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; + + if (!sta->wpa_pairwise_cipher) + status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; + } else + status = WLAN_STATUS_INVALID_IE; + + } else { + wpa_ie = NULL; + wpa_ie_len = 0; + } + + if (status != _STATS_SUCCESSFUL_) + goto exit; + + if (!MLME_IS_AP(adapter)) + goto exit; + + sta->flags &= ~(WLAN_STA_WPS | WLAN_STA_MAYBE_WPS); + /* if (hapd->conf->wps_state && wpa_ie == NULL) { */ /* todo: to check ap if supporting WPS */ + if (wpa_ie == NULL) { + if (elems->wps_ie) { + RTW_INFO("STA included WPS IE in " + "(Re)Association Request - assume WPS is " + "used\n"); + sta->flags |= WLAN_STA_WPS; + /* wpabuf_free(sta->wps_ie); */ + /* sta->wps_ie = wpabuf_alloc_copy(elems.wps_ie + 4, */ + /* elems.wps_ie_len - 4); */ + } else { + RTW_INFO("STA did not include WPA/RSN IE " + "in (Re)Association Request - possible WPS " + "use\n"); + sta->flags |= WLAN_STA_MAYBE_WPS; + } + + /* AP support WPA/RSN, and sta is going to do WPS, but AP is not ready */ + /* that the selected registrar of AP is _FLASE */ + if ((sec->wpa_psk > 0) + && (sta->flags & (WLAN_STA_WPS | WLAN_STA_MAYBE_WPS)) + ) { + struct mlme_priv *mlme = &adapter->mlmepriv; + + if (mlme->wps_beacon_ie) { + u8 selected_registrar = 0; + + rtw_get_wps_attr_content(mlme->wps_beacon_ie, mlme->wps_beacon_ie_len, WPS_ATTR_SELECTED_REGISTRAR, &selected_registrar, NULL); + + if (!selected_registrar) { + RTW_INFO("selected_registrar is _FALSE , or AP is not ready to do WPS\n"); + status = _STATS_UNABLE_HANDLE_STA_; + goto exit; + } + } + } + + } else { + int copy_len; + + if (sec->wpa_psk == 0) { + RTW_INFO("STA " MAC_FMT + ": WPA/RSN IE in association request, but AP don't support WPA/RSN\n", + MAC_ARG(sta->cmn.mac_addr)); + status = WLAN_STATUS_INVALID_IE; + goto exit; + } + + if (elems->wps_ie) { + RTW_INFO("STA included WPS IE in " + "(Re)Association Request - WPS is " + "used\n"); + sta->flags |= WLAN_STA_WPS; + copy_len = 0; + } else + copy_len = ((wpa_ie_len + 2) > sizeof(sta->wpa_ie)) ? (sizeof(sta->wpa_ie)) : (wpa_ie_len + 2); + + if (copy_len > 0) + _rtw_memcpy(sta->wpa_ie, wpa_ie - 2, copy_len); + } + +exit: + return status; +} + +void rtw_ap_parse_sta_wmm_ie(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len) +{ + struct mlme_priv *mlme = &adapter->mlmepriv; + unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; + u8 *p; + + sta->flags &= ~WLAN_STA_WME; + sta->qos_option = 0; + sta->qos_info = 0; + sta->has_legacy_ac = _TRUE; + sta->uapsd_vo = 0; + sta->uapsd_vi = 0; + sta->uapsd_be = 0; + sta->uapsd_bk = 0; + + if (!mlme->qospriv.qos_option) + goto exit; + + p = rtw_get_ie_ex(tlv_ies, tlv_ies_len, WLAN_EID_VENDOR_SPECIFIC, WMM_IE, 6, NULL, NULL); + if (!p) + goto exit; + + sta->flags |= WLAN_STA_WME; + sta->qos_option = 1; + sta->qos_info = *(p + 8); + sta->max_sp_len = (sta->qos_info >> 5) & 0x3; + + if ((sta->qos_info & 0xf) != 0xf) + sta->has_legacy_ac = _TRUE; + else + sta->has_legacy_ac = _FALSE; + + if (sta->qos_info & 0xf) { + if (sta->qos_info & BIT(0)) + sta->uapsd_vo = BIT(0) | BIT(1); + else + sta->uapsd_vo = 0; + + if (sta->qos_info & BIT(1)) + sta->uapsd_vi = BIT(0) | BIT(1); + else + sta->uapsd_vi = 0; + + if (sta->qos_info & BIT(2)) + sta->uapsd_bk = BIT(0) | BIT(1); + else + sta->uapsd_bk = 0; + + if (sta->qos_info & BIT(3)) + sta->uapsd_be = BIT(0) | BIT(1); + else + sta->uapsd_be = 0; + } + +exit: + return; +} + +void rtw_ap_parse_sta_ht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems) +{ + struct mlme_priv *mlme = &adapter->mlmepriv; + + sta->flags &= ~WLAN_STA_HT; + +#ifdef CONFIG_80211N_HT + if (mlme->htpriv.ht_option == _FALSE) + goto exit; + + /* save HT capabilities in the sta object */ + _rtw_memset(&sta->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); + if (elems->ht_capabilities && elems->ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) { + sta->flags |= WLAN_STA_HT; + sta->flags |= WLAN_STA_WME; + _rtw_memcpy(&sta->htpriv.ht_cap, elems->ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); + } +exit: +#endif + + return; +} + +void rtw_ap_parse_sta_vht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems) +{ + struct mlme_priv *mlme = &adapter->mlmepriv; + + sta->flags &= ~WLAN_STA_VHT; + +#ifdef CONFIG_80211AC_VHT + if (mlme->vhtpriv.vht_option == _FALSE) + goto exit; + + _rtw_memset(&sta->vhtpriv, 0, sizeof(struct vht_priv)); + if (elems->vht_capabilities && elems->vht_capabilities_len == 12) { + sta->flags |= WLAN_STA_VHT; + _rtw_memcpy(sta->vhtpriv.vht_cap, elems->vht_capabilities, 12); + + if (elems->vht_op_mode_notify && elems->vht_op_mode_notify_len == 1) + _rtw_memcpy(&sta->vhtpriv.vht_op_mode_notify, elems->vht_op_mode_notify, 1); + else /* for Frame without Operating Mode notify ie; default: 80M */ + sta->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; + } +exit: +#endif + + return; +} #endif /* CONFIG_AP_MODE */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_beamforming.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_beamforming.c index ca04a99b1f18..95c800555592 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_beamforming.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_beamforming.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_BEAMFORMING_C_ #include @@ -24,388 +19,67 @@ #ifdef CONFIG_BEAMFORMING -#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ #ifdef RTW_BEAMFORMING_VERSION_2 -/* - * For phydm - */ -BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(void *mlme, u8 mac_id) -{ - PADAPTER adapter; - struct beamforming_info *pBeamInfo; - struct beamformee_entry *bfee; - BEAMFORMING_CAP cap = BEAMFORMING_CAP_NONE; - u8 i = 0; +struct ndpa_sta_info { + u16 aid:12; + u16 feedback_type:1; + u16 nc_index:3; +}; - adapter = mlme_to_adapter((struct mlme_priv *)mlme); - pBeamInfo = GET_BEAMFORM_INFO(adapter); - - for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { - bfee = &pBeamInfo->bfee_entry[i]; - if ((bfee->used == _TRUE) - && (bfee->mac_id == mac_id)) { - cap = bfee->cap; - break; - } - } - - return cap; -} - -struct beamformer_entry *beamforming_get_bfer_entry_by_addr(PADAPTER adapter, u8 *ra) -{ - u8 i = 0; - struct beamforming_info *bf_info; - struct beamformer_entry *entry; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { - entry = &bf_info->bfer_entry[i]; - if (entry->used == _FALSE) - continue; - if (_rtw_memcmp(ra, entry->mac_addr, ETH_ALEN) == _TRUE) { - return entry; - } - } - - return NULL; -} - -struct beamformee_entry *beamforming_get_bfee_entry_by_addr(PADAPTER adapter, u8 *ra) -{ - u8 i = 0; - struct beamforming_info *bf_info; - struct beamformee_entry *entry; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { - entry = &bf_info->bfee_entry[i]; - if (entry->used == _FALSE) - continue; - if (_rtw_memcmp(ra, entry->mac_addr, ETH_ALEN) == _TRUE) - return entry; - } - - return NULL; -} - -static struct beamformer_entry *_get_bfer_free_entry(PADAPTER adapter) -{ - u8 i = 0; - struct beamforming_info *bf_info; - struct beamformer_entry *entry; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { - entry = &bf_info->bfer_entry[i]; - if (entry->used == _FALSE) - return entry; - } - - return NULL; -} - -static struct beamformee_entry *_get_bfee_free_entry(PADAPTER adapter) -{ - u8 i = 0; - struct beamforming_info *bf_info; - struct beamformee_entry *entry; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { - entry = &bf_info->bfee_entry[i]; - if (entry->used == _FALSE) - return entry; - } - - return NULL; -} - -/* - * Description: - * Get the first entry index of MU Beamformee. - * - * Return Value: - * Index of the first MU sta. - * - * 2015.05.25. Created by tynli. - * - */ -static u8 _get_first_mu_bfee_entry_idx(PADAPTER adapter, struct beamformee_entry *ignore) -{ - struct beamforming_info *bf_info; - struct beamformee_entry *entry; - u8 idx = 0xFF; - u8 bFound = _FALSE; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - for (idx = 0; idx < MAX_BEAMFORMEE_ENTRY_NUM; idx++) { - entry = &bf_info->bfee_entry[idx]; - if (ignore && (entry == ignore)) - continue; - if ((entry->used == _TRUE) && - TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { - bFound = _TRUE; - break; - } - } - - if (bFound == _FALSE) - idx = 0xFF; - - return idx; -} - -static void _update_min_sounding_period(PADAPTER adapter, u16 period, u8 leave) -{ - struct beamforming_info *bf_info; - struct beamformee_entry *entry; - u8 i = 0; - u16 min_val = 0xFFFF; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - if (_TRUE == leave) { - /* - * When a BFee left, - * we need to find the latest min sounding period - * from the remaining BFees - */ - for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { - entry = &bf_info->bfee_entry[i]; - if ((entry->used == _TRUE) - && (entry->sound_period < min_val)) - min_val = entry->sound_period; - } - - if (min_val == 0xFFFF) - bf_info->sounding_info.min_sounding_period = 0; - else - bf_info->sounding_info.min_sounding_period = min_val; - } else { - if ((bf_info->sounding_info.min_sounding_period == 0) - || (period < bf_info->sounding_info.min_sounding_period)) - bf_info->sounding_info.min_sounding_period = period; - } -} - -static struct beamformer_entry *_add_bfer_entry(PADAPTER adapter, - struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) +static void _get_txvector_parameter(PADAPTER adapter, struct sta_info *sta, u8 *g_id, u16 *p_aid) { struct mlme_priv *mlme; - struct beamforming_info *bf_info; - struct beamformer_entry *entry; + u16 aid; u8 *bssid; u16 val16; u8 i; mlme = &adapter->mlmepriv; - bf_info = GET_BEAMFORM_INFO(adapter); - - entry = beamforming_get_bfer_entry_by_addr(adapter, sta->hwaddr); - if (!entry) { - entry = _get_bfer_free_entry(adapter); - if (!entry) - return NULL; - } - - entry->used = _TRUE; if (check_fwstate(mlme, WIFI_AP_STATE)) { + /* + * Sent by an AP and addressed to a STA associated with that AP + * or sent by a DLS or TDLS STA in a direct path to + * a DLS or TDLS peer STA + */ + + aid = sta->cmn.aid; bssid = adapter_mac_addr(adapter); + RTW_INFO("%s: AID=0x%x BSSID=" MAC_FMT "\n", + __FUNCTION__, sta->cmn.aid, MAC_ARG(bssid)); + + /* AID[0:8] */ + aid &= 0x1FF; /* BSSID[44:47] xor BSSID[40:43] */ val16 = ((bssid[5] & 0xF0) >> 4) ^ (bssid[5] & 0xF); - /* (dec(A) + dec(B)*32) mod 512 */ - entry->p_aid = (sta->aid + val16 * 32) & 0x1FF; - entry->g_id = 63; + /* (dec(AID[0:8]) + dec(BSSID)*2^5) mod 2^9 */ + *p_aid = (aid + (val16 << 5)) & 0x1FF; + *g_id = 63; } else if ((check_fwstate(mlme, WIFI_ADHOC_STATE) == _TRUE) || (check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE) == _TRUE)) { - entry->p_aid = 0; - entry->g_id = 63; + /* + * Otherwise, includes + * 1. Sent to an IBSS STA + * 2. Sent by an AP to a non associated STA + * 3. Sent to a STA for which it is not known + * which condition is applicable + */ + *p_aid = 0; + *g_id = 63; } else { - bssid = sta->hwaddr; + /* Addressed to AP */ + bssid = sta->cmn.mac_addr; + RTW_INFO("%s: BSSID=" MAC_FMT "\n", __FUNCTION__, MAC_ARG(bssid)); + /* BSSID[39:47] */ - entry->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); - entry->g_id = 0; - } - RTW_INFO("%s: p_aid=0x%04x g_id=0x%04x aid=0x%x\n", - __FUNCTION__, entry->p_aid, entry->g_id, sta->aid); - - _rtw_memcpy(entry->mac_addr, sta->hwaddr, ETH_ALEN); - entry->cap = bf_cap; - entry->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; - entry->NumofSoundingDim = sounding_dim; - - if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_MU)) { - bf_info->beamformer_mu_cnt += 1; - entry->aid = sta->aid; - } else if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { - bf_info->beamformer_su_cnt += 1; - - /* Record HW idx info */ - for (i = 0; i < MAX_NUM_BEAMFORMER_SU; i++) { - if ((bf_info->beamformer_su_reg_maping & BIT(i)) == 0) { - bf_info->beamformer_su_reg_maping |= BIT(i); - entry->su_reg_index = i; - break; - } - } - RTW_INFO("%s: Add BFer entry beamformer_su_reg_maping=%#X, su_reg_index=%d\n", - __FUNCTION__, bf_info->beamformer_su_reg_maping, entry->su_reg_index); + *p_aid = (bssid[5] << 1) | (bssid[4] >> 7); + *g_id = 0; } - return entry; -} - -static struct beamformee_entry *_add_bfee_entry(PADAPTER adapter, - struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) -{ - struct mlme_priv *mlme; - struct beamforming_info *bf_info; - struct beamformee_entry *entry; - u8 *bssid; - u16 val16; - u8 i; - - - mlme = &adapter->mlmepriv; - bf_info = GET_BEAMFORM_INFO(adapter); - - entry = beamforming_get_bfee_entry_by_addr(adapter, sta->hwaddr); - if (!entry) { - entry = _get_bfee_free_entry(adapter); - if (!entry) - return NULL; - } - - entry->used = _TRUE; - entry->aid = sta->aid; - entry->mac_id = sta->mac_id; - entry->sound_bw = sta->bw_mode; - - if (check_fwstate(mlme, WIFI_AP_STATE)) { - bssid = adapter_mac_addr(adapter); - /* BSSID[44:47] xor BSSID[40:43] */ - val16 = ((bssid[5] & 0xF0) >> 4) ^ (bssid[5] & 0xF); - /* (dec(A) + dec(B)*32) mod 512 */ - entry->p_aid = (sta->aid + val16 * 32) & 0x1FF; - entry->g_id = 63; - } else if (check_fwstate(mlme, WIFI_ADHOC_STATE) || check_fwstate(mlme, WIFI_ADHOC_MASTER_STATE)) { - entry->p_aid = 0; - entry->g_id = 63; - } else { - bssid = sta->hwaddr; - /* BSSID[39:47] */ - entry->p_aid = (bssid[5] << 1) | (bssid[4] >> 7); - entry->g_id = 0; - } - - _rtw_memcpy(entry->mac_addr, sta->hwaddr, ETH_ALEN); - entry->txbf = _FALSE; - entry->sounding = _FALSE; - entry->sound_period = 40; - entry->cap = bf_cap; - - _update_min_sounding_period(adapter, entry->sound_period, _FALSE); - entry->SoundCnt = GetInitSoundCnt(entry->sound_period, bf_info->sounding_info.min_sounding_period); - - entry->LogStatusFailCnt = 0; - - entry->NumofSoundingDim = sounding_dim; - entry->CompSteeringNumofBFer = comp_steering; - entry->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; - - if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_MU)) { - bf_info->beamformee_mu_cnt += 1; - bf_info->first_mu_bfee_index = _get_first_mu_bfee_entry_idx(adapter, NULL); - - /* Record HW idx info */ - for (i = 0; i < MAX_NUM_BEAMFORMEE_MU; i++) { - if ((bf_info->beamformee_mu_reg_maping & BIT(i)) == 0) { - bf_info->beamformee_mu_reg_maping |= BIT(i); - entry->mu_reg_index = i; - break; - } - } - RTW_INFO("%s: Add BFee entry beamformee_mu_reg_maping=%#X, mu_reg_index=%d\n", - __FUNCTION__, bf_info->beamformee_mu_reg_maping, entry->mu_reg_index); - - } else if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { - bf_info->beamformee_su_cnt += 1; - - /* Record HW idx info */ - for (i = 0; i < MAX_NUM_BEAMFORMEE_SU; i++) { - if ((bf_info->beamformee_su_reg_maping & BIT(i)) == 0) { - bf_info->beamformee_su_reg_maping |= BIT(i); - entry->su_reg_index = i; - break; - } - } - RTW_INFO("%s: Add BFee entry beamformee_su_reg_maping=%#X, su_reg_index=%d\n", - __FUNCTION__, bf_info->beamformee_su_reg_maping, entry->su_reg_index); - } - - return entry; -} - -static void _remove_bfer_entry(PADAPTER adapter, struct beamformer_entry *entry) -{ - struct beamforming_info *bf_info; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; - - if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_MU)) { - bf_info->beamformer_mu_cnt -= 1; - _rtw_memset(entry->gid_valid, 0, 8); - _rtw_memset(entry->user_position, 0, 16); - } else if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { - bf_info->beamformer_su_cnt -= 1; - } - - if (bf_info->beamformer_mu_cnt == 0) - bf_info->beamforming_cap &= ~BEAMFORMEE_CAP_VHT_MU; - if (bf_info->beamformer_su_cnt == 0) - bf_info->beamforming_cap &= ~(BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT); -} - -static void _remove_bfee_entry(PADAPTER adapter, struct beamformee_entry *entry) -{ - struct beamforming_info *bf_info; - - - bf_info = GET_BEAMFORM_INFO(adapter); - - entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; - - if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { - bf_info->beamformee_mu_cnt -= 1; - bf_info->first_mu_bfee_index = _get_first_mu_bfee_entry_idx(adapter, entry); - } else if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { - bf_info->beamformee_su_cnt -= 1; - } - - if (bf_info->beamformee_mu_cnt == 0) - bf_info->beamforming_cap &= ~BEAMFORMER_CAP_VHT_MU; - if (bf_info->beamformee_su_cnt == 0) - bf_info->beamforming_cap &= ~(BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT); - - _update_min_sounding_period(adapter, 0, _TRUE); + RTW_INFO("%s: GROUP_ID=0x%02x PARTIAL_AID=0x%04x\n", + __FUNCTION__, *g_id, *p_aid); } /* @@ -419,6 +93,7 @@ static void _remove_bfee_entry(PADAPTER adapter, struct beamformee_entry *entry) static void _get_sta_beamform_cap(PADAPTER adapter, struct sta_info *sta, u8 *sta_bf_cap, u8 *sounding_dim, u8 *comp_steering) { + struct beamforming_info *info; struct ht_priv *ht; #ifdef CONFIG_80211AC_VHT struct vht_priv *vht; @@ -430,59 +105,1257 @@ static void _get_sta_beamform_cap(PADAPTER adapter, struct sta_info *sta, *sounding_dim = 0; *comp_steering = 0; + info = GET_BEAMFORM_INFO(adapter); ht = &adapter->mlmepriv.htpriv; #ifdef CONFIG_80211AC_VHT vht = &adapter->mlmepriv.vhtpriv; #endif /* CONFIG_80211AC_VHT */ - if (IsSupportedHT(sta->wireless_mode) == _TRUE) { + if (is_supported_ht(sta->wireless_mode) == _TRUE) { /* HT */ bf_cap = ht->beamform_cap; if (TEST_FLAG(bf_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) { + info->beamforming_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; *sta_bf_cap |= BEAMFORMER_CAP_HT_EXPLICIT; *sounding_dim = (bf_cap & BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP) >> 6; } if (TEST_FLAG(bf_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) { + info->beamforming_cap |= BEAMFORMER_CAP_HT_EXPLICIT; *sta_bf_cap |= BEAMFORMEE_CAP_HT_EXPLICIT; *comp_steering = (bf_cap & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; } } #ifdef CONFIG_80211AC_VHT - if (IsSupportedVHT(sta->wireless_mode) == _TRUE) { + if (is_supported_vht(sta->wireless_mode) == _TRUE) { /* VHT */ bf_cap = vht->beamform_cap; /* We are SU Beamformee because the STA is SU Beamformer */ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { + info->beamforming_cap |= BEAMFORMEE_CAP_VHT_SU; *sta_bf_cap |= BEAMFORMER_CAP_VHT_SU; /* We are MU Beamformee because the STA is MU Beamformer */ - if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) + if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) { + info->beamforming_cap |= BEAMFORMEE_CAP_VHT_MU; *sta_bf_cap |= BEAMFORMER_CAP_VHT_MU; + } *sounding_dim = (bf_cap & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; } /* We are SU Beamformer because the STA is SU Beamformee */ if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { + info->beamforming_cap |= BEAMFORMER_CAP_VHT_SU; *sta_bf_cap |= BEAMFORMEE_CAP_VHT_SU; /* We are MU Beamformer because the STA is MU Beamformee */ - if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) + if (TEST_FLAG(bf_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { + info->beamforming_cap |= BEAMFORMER_CAP_VHT_MU; *sta_bf_cap |= BEAMFORMEE_CAP_VHT_MU; + } *comp_steering = (bf_cap & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; } } #endif /* CONFIG_80211AC_VHT */ } + +static u8 _send_ht_ndpa_packet(PADAPTER adapter, u8 *ra, enum channel_width bw) +{ + /* General */ + struct xmit_priv *pxmitpriv; + struct mlme_ext_priv *pmlmeext; + struct mlme_ext_info *pmlmeinfo; + struct xmit_frame *pmgntframe; + /* Beamforming */ + struct beamforming_info *info; + struct beamformee_entry *bfee; + struct ndpa_sta_info sta_info; + u8 ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xE0, 0x4C}; + /* MISC */ + struct pkt_attrib *attrib; + struct rtw_ieee80211_hdr *pwlanhdr; + enum MGN_RATE txrate; + u8 *pframe; + u16 duration = 0; + u8 aSifsTime = 0; + + + RTW_INFO("+%s: Send to " MAC_FMT "\n", __FUNCTION__, MAC_ARG(ra)); + + pxmitpriv = &adapter->xmitpriv; + pmlmeext = &adapter->mlmeextpriv; + pmlmeinfo = &pmlmeext->mlmext_info; + bfee = rtw_bf_bfee_get_entry_by_addr(adapter, ra); + if (!bfee) { + RTW_ERR("%s: Cann't find beamformee entry!\n", __FUNCTION__); + return _FALSE; + } + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (!pmgntframe) { + RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); + return _FALSE; + } + + txrate = beamforming_get_htndp_tx_rate(GET_PDM_ODM(adapter), bfee->comp_steering_num_of_bfer); + + /* update attribute */ + attrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, attrib); + /*attrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ + attrib->subtype = WIFI_ACTION_NOACK; + attrib->bwmode = bw; + /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ + attrib->order = 1; + attrib->rate = (u8)txrate; + attrib->bf_pkt_type = 0; + + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + /* Frame control */ + pwlanhdr->frame_ctl = 0; + set_frame_sub_type(pframe, attrib->subtype); + set_order_bit(pframe); + + /* Duration */ + if (pmlmeext->cur_wireless_mode == WIRELESS_11B) + aSifsTime = 10; + else + aSifsTime = 16; + duration = 2 * aSifsTime + 40; + if (bw == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + set_duration(pframe, duration); + + /* DA */ + _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); + /* SA */ + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); + /* BSSID */ + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); + + /* HT control field */ + SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); + SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); + + /* + * Frame Body + * Category field: vender-specific value, 0x7F + * OUI: 0x00E04C + */ + _rtw_memcpy(pframe + 28, ActionHdr, 4); + + attrib->pktlen = 32; + attrib->last_txcmdsz = attrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + + return _TRUE; +} + +static u8 _send_vht_ndpa_packet(PADAPTER adapter, u8 *ra, u16 aid, enum channel_width bw) +{ + /* General */ + struct xmit_priv *pxmitpriv; + struct mlme_ext_priv *pmlmeext; + struct xmit_frame *pmgntframe; + /* Beamforming */ + struct beamforming_info *info; + struct beamformee_entry *bfee; + struct ndpa_sta_info sta_info; + /* MISC */ + struct pkt_attrib *attrib; + struct rtw_ieee80211_hdr *pwlanhdr; + u8 *pframe; + enum MGN_RATE txrate; + u16 duration = 0; + u8 sequence = 0, aSifsTime = 0; + + + RTW_INFO("+%s: Send to " MAC_FMT "\n", __FUNCTION__, MAC_ARG(ra)); + + pxmitpriv = &adapter->xmitpriv; + pmlmeext = &adapter->mlmeextpriv; + info = GET_BEAMFORM_INFO(adapter); + bfee = rtw_bf_bfee_get_entry_by_addr(adapter, ra); + if (!bfee) { + RTW_ERR("%s: Cann't find beamformee entry!\n", __FUNCTION__); + return _FALSE; + } + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (!pmgntframe) { + RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); + return _FALSE; + } + + txrate = beamforming_get_vht_ndp_tx_rate(GET_PDM_ODM(adapter), bfee->comp_steering_num_of_bfer); + + /* update attribute */ + attrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, attrib); + /*pattrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ + attrib->subtype = WIFI_NDPA; + attrib->bwmode = bw; + /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ + attrib->rate = (u8)txrate; + attrib->bf_pkt_type = 0; + + _rtw_memset(pmgntframe->buf_addr, 0, TXDESC_OFFSET + WLANHDR_OFFSET); + pframe = pmgntframe->buf_addr + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + /* Frame control */ + pwlanhdr->frame_ctl = 0; + set_frame_sub_type(pframe, attrib->subtype); + + /* Duration */ + if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) + aSifsTime = 16; + else + aSifsTime = 10; + duration = 2 * aSifsTime + 44; + if (bw == CHANNEL_WIDTH_80) + duration += 40; + else if (bw == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + set_duration(pframe, duration); + + /* RA */ + _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); + + /* TA */ + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); + + /* Sounding Sequence, bit0~1 is reserved */ + sequence = info->sounding_sequence << 2; + if (info->sounding_sequence >= 0x3f) + info->sounding_sequence = 0; + else + info->sounding_sequence++; + _rtw_memcpy(pframe + 16, &sequence, 1); + + /* STA Info */ + /* + * "AID12" Equal to 0 if the STA is an AP, mesh STA or + * STA that is a member of an IBSS + */ + if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _FALSE) + aid = 0; + sta_info.aid = aid; + /* "Feedback Type" set to 0 for SU */ + sta_info.feedback_type = 0; + /* "Nc Index" reserved if the Feedback Type field indicates SU */ + sta_info.nc_index = 0; + _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2); + + attrib->pktlen = 19; + attrib->last_txcmdsz = attrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + + return _TRUE; +} + +static u8 _send_vht_mu_ndpa_packet(PADAPTER adapter, enum channel_width bw) +{ + /* General */ + struct xmit_priv *pxmitpriv; + struct mlme_ext_priv *pmlmeext; + struct xmit_frame *pmgntframe; + /* Beamforming */ + struct beamforming_info *info; + struct sounding_info *sounding; + struct beamformee_entry *bfee; + struct ndpa_sta_info sta_info; + /* MISC */ + struct pkt_attrib *attrib; + struct rtw_ieee80211_hdr *pwlanhdr; + enum MGN_RATE txrate; + u8 *pframe; + u8 *ra = NULL; + u16 duration = 0; + u8 sequence = 0, aSifsTime = 0; + u8 i; + + + RTW_INFO("+%s\n", __FUNCTION__); + + pxmitpriv = &adapter->xmitpriv; + pmlmeext = &adapter->mlmeextpriv; + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + txrate = MGN_VHT2SS_MCS0; + + /* + * Fill the first MU BFee entry (STA1) MAC addr to destination address then + * HW will change A1 to broadcast addr. + * 2015.05.28. Suggested by SD1 Chunchu. + */ + bfee = &info->bfee_entry[sounding->mu_sounding_list[0]]; + ra = bfee->mac_addr; + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (!pmgntframe) { + RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); + return _FALSE; + } + + /* update attribute */ + attrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, attrib); + /*attrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ + attrib->subtype = WIFI_NDPA; + attrib->bwmode = bw; + /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ + attrib->rate = (u8)txrate; + /* Set TxBFPktType of Tx desc to unicast type if there is only one MU STA for HW design */ + if (info->sounding_info.candidate_mu_bfee_cnt > 1) + attrib->bf_pkt_type = 1; + else + attrib->bf_pkt_type = 0; + + _rtw_memset(pmgntframe->buf_addr, 0, TXDESC_OFFSET + WLANHDR_OFFSET); + pframe = pmgntframe->buf_addr + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + /* Frame control */ + pwlanhdr->frame_ctl = 0; + set_frame_sub_type(pframe, attrib->subtype); + + /* Duration */ + if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) + aSifsTime = 16; + else + aSifsTime = 10; + duration = 2 * aSifsTime + 44; + if (bw == CHANNEL_WIDTH_80) + duration += 40; + else if (bw == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + set_duration(pframe, duration); + + /* RA */ + _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); + + /* TA */ + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); + + /* Sounding Sequence, bit0~1 is reserved */ + sequence = info->sounding_sequence << 2; + if (info->sounding_sequence >= 0x3f) + info->sounding_sequence = 0; + else + info->sounding_sequence++; + _rtw_memcpy(pframe + 16, &sequence, 1); + + attrib->pktlen = 17; + + /* + * Construct STA info. for multiple STAs + * STA Info1, ..., STA Info n + */ + for (i = 0; i < sounding->candidate_mu_bfee_cnt; i++) { + bfee = &info->bfee_entry[sounding->mu_sounding_list[i]]; + sta_info.aid = bfee->aid; + sta_info.feedback_type = 1; /* 1'b1: MU */ + sta_info.nc_index = 0; + _rtw_memcpy(pframe + attrib->pktlen, (u8 *)&sta_info, 2); + attrib->pktlen += 2; + } + + attrib->last_txcmdsz = attrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + + return _TRUE; +} + +static u8 _send_bf_report_poll(PADAPTER adapter, u8 *ra, u8 bFinalPoll) +{ + /* General */ + struct xmit_priv *pxmitpriv; + struct xmit_frame *pmgntframe; + /* MISC */ + struct pkt_attrib *attrib; + struct rtw_ieee80211_hdr *pwlanhdr; + u8 *pframe; + + + RTW_INFO("+%s: Send to " MAC_FMT "\n", __FUNCTION__, MAC_ARG(ra)); + + pxmitpriv = &adapter->xmitpriv; + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (!pmgntframe) { + RTW_ERR("%s: alloc mgnt frame fail!\n", __FUNCTION__); + return _FALSE; + } + + /* update attribute */ + attrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, attrib); + /*attrib->type = WIFI_MGT_TYPE;*/ /* set in update_mgntframe_attrib() */ + attrib->subtype = WIFI_BF_REPORT_POLL; + attrib->bwmode = CHANNEL_WIDTH_20; + /*attrib->qsel = QSLT_MGNT;*/ /* set in update_mgntframe_attrib() */ + attrib->rate = MGN_6M; + if (bFinalPoll) + attrib->bf_pkt_type = 3; + else + attrib->bf_pkt_type = 2; + + _rtw_memset(pmgntframe->buf_addr, 0, TXDESC_OFFSET + WLANHDR_OFFSET); + pframe = pmgntframe->buf_addr + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + /* Frame control */ + pwlanhdr->frame_ctl = 0; + set_frame_sub_type(pframe, attrib->subtype); + + /* Duration */ + set_duration(pframe, 100); + + /* RA */ + _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); + + /* TA */ + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); + + /* Feedback Segment Retransmission Bitmap */ + pframe[16] = 0xFF; + + attrib->pktlen = 17; + attrib->last_txcmdsz = attrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + + return _TRUE; +} + +static void _sounding_update_min_period(PADAPTER adapter, u16 period, u8 leave) +{ + struct beamforming_info *info; + struct beamformee_entry *bfee; + u8 i = 0; + u16 min_val = 0xFFFF; + + + info = GET_BEAMFORM_INFO(adapter); + + if (_TRUE == leave) { + /* + * When a BFee left, + * we need to find the latest min sounding period + * from the remaining BFees + */ + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if ((bfee->used == _TRUE) + && (bfee->sound_period < min_val)) + min_val = bfee->sound_period; + } + + if (min_val == 0xFFFF) + info->sounding_info.min_sounding_period = 0; + else + info->sounding_info.min_sounding_period = min_val; + } else { + if ((info->sounding_info.min_sounding_period == 0) + || (period < info->sounding_info.min_sounding_period)) + info->sounding_info.min_sounding_period = period; + } +} + +static void _sounding_init(struct sounding_info *sounding) +{ + _rtw_memset(sounding->su_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_SU); + _rtw_memset(sounding->mu_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_MU); + sounding->state = SOUNDING_STATE_NONE; + sounding->su_bfee_curidx = 0xFF; + sounding->candidate_mu_bfee_cnt = 0; + sounding->min_sounding_period = 0; + sounding->sound_remain_cnt_per_period = 0; +} + +static void _sounding_reset_vars(PADAPTER adapter) +{ + struct beamforming_info *info; + struct sounding_info *sounding; + u8 idx; + + + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + _rtw_memset(sounding->su_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_SU); + _rtw_memset(sounding->mu_sounding_list, 0xFF, MAX_NUM_BEAMFORMEE_MU); + sounding->su_bfee_curidx = 0xFF; + sounding->candidate_mu_bfee_cnt = 0; + + /* Clear bSound flag for the new period */ + for (idx = 0; idx < MAX_BEAMFORMEE_ENTRY_NUM; idx++) { + if ((info->bfee_entry[idx].used == _TRUE) + && (info->bfee_entry[idx].sounding == _TRUE)) { + info->bfee_entry[idx].sounding = _FALSE; + info->bfee_entry[idx].bCandidateSoundingPeer = _FALSE; + } + } +} + /* - * Return: - * _TRUE success - * _FALSE fail + * Return + * 0 Prepare sounding list OK + * -1 Fail to prepare sounding list, because no beamformee need to souding + * -2 Fail to prepare sounding list, because beamformee state not ready + * */ -static u8 _init_entry(PADAPTER adapter, struct sta_info *sta) +static int _sounding_get_list(PADAPTER adapter) +{ + struct beamforming_info *info; + struct sounding_info *sounding; + struct beamformee_entry *bfee; + u8 i, mu_idx = 0, su_idx = 0, not_ready = 0; + int ret = 0; + + + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + /* Add MU BFee list first because MU priority is higher than SU */ + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (bfee->used == _FALSE) + continue; + + if (bfee->state != BEAMFORM_ENTRY_HW_STATE_ADDED) { + RTW_ERR("%s: Invalid BFee idx(%d) Hw state=%d\n", __FUNCTION__, i, bfee->state); + not_ready++; + continue; + } + + /* + * Decrease BFee's SoundCnt per period + * If the remain count is 0, + * then it can be sounded at this time + */ + if (bfee->SoundCnt) { + bfee->SoundCnt--; + if (bfee->SoundCnt) + continue; + } + + /* + * + * If the STA supports MU BFee capability then we add it to MUSoundingList directly + * because we can only sound one STA by unicast NDPA with MU cap enabled to get correct channel info. + * Suggested by BB team Luke Lee. 2015.11.25. + */ + if (bfee->cap & BEAMFORMEE_CAP_VHT_MU) { + /* MU BFee */ + if (mu_idx >= MAX_NUM_BEAMFORMEE_MU) { + RTW_ERR("%s: Too much MU bfee entry(Limit:%d)\n", __FUNCTION__, MAX_NUM_BEAMFORMEE_MU); + continue; + } + + if (bfee->bApplySounding == _TRUE) { + bfee->bCandidateSoundingPeer = _TRUE; + bfee->SoundCnt = GetInitSoundCnt(bfee->sound_period, sounding->min_sounding_period); + sounding->mu_sounding_list[mu_idx] = i; + mu_idx++; + } + } else if (bfee->cap & (BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { + /* SU BFee (HT/VHT) */ + if (su_idx >= MAX_NUM_BEAMFORMEE_SU) { + RTW_ERR("%s: Too much SU bfee entry(Limit:%d)\n", __FUNCTION__, MAX_NUM_BEAMFORMEE_SU); + continue; + } + + if (bfee->bDeleteSounding == _TRUE) { + sounding->su_sounding_list[su_idx] = i; + su_idx++; + } else if ((bfee->bApplySounding == _TRUE) + && (bfee->bSuspendSUCap == _FALSE)) { + bfee->bCandidateSoundingPeer = _TRUE; + bfee->SoundCnt = GetInitSoundCnt(bfee->sound_period, sounding->min_sounding_period); + sounding->su_sounding_list[su_idx] = i; + su_idx++; + } + } + } + + sounding->candidate_mu_bfee_cnt = mu_idx; + + if (su_idx + mu_idx == 0) { + ret = -1; + if (not_ready) + ret = -2; + } + + RTW_INFO("-%s: There are %d SU and %d MU BFees in this sounding period\n", __FUNCTION__, su_idx, mu_idx); + + return ret; +} + +static void _sounding_handler(PADAPTER adapter) +{ + struct beamforming_info *info; + struct sounding_info *sounding; + struct beamformee_entry *bfee; + u8 su_idx, i; + u32 timeout_period = 0; + u8 set_timer = _FALSE; + int ret = 0; + static u16 wait_cnt = 0; + + + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + RTW_DBG("+%s: state=%d\n", __FUNCTION__, sounding->state); + if ((sounding->state != SOUNDING_STATE_INIT) + && (sounding->state != SOUNDING_STATE_SU_SOUNDDOWN) + && (sounding->state != SOUNDING_STATE_MU_SOUNDDOWN) + && (sounding->state != SOUNDING_STATE_SOUNDING_TIMEOUT)) { + RTW_WARN("%s: Invalid State(%d) and return!\n", __FUNCTION__, sounding->state); + return; + } + + if (sounding->state == SOUNDING_STATE_INIT) { + RTW_INFO("%s: Sounding start\n", __FUNCTION__); + + /* Init Var */ + _sounding_reset_vars(adapter); + + /* Get the sounding list of this sounding period */ + ret = _sounding_get_list(adapter); + if (ret == -1) { + wait_cnt = 0; + sounding->state = SOUNDING_STATE_NONE; + RTW_ERR("%s: No BFees found, set to SOUNDING_STATE_NONE\n", __FUNCTION__); + info->sounding_running--; + return; + } + if (ret == -2) { + RTW_WARN("%s: Temporarily cann't find BFee to sounding\n", __FUNCTION__); + if (wait_cnt < 5) { + wait_cnt++; + } else { + wait_cnt = 0; + sounding->state = SOUNDING_STATE_NONE; + RTW_ERR("%s: Wait changing state timeout!! Set to SOUNDING_STATE_NONE\n", __FUNCTION__); + } + info->sounding_running--; + return; + } + if (ret != 0) { + wait_cnt = 0; + RTW_ERR("%s: Unkown state(%d)!\n", __FUNCTION__, ret); + info->sounding_running--; + return; + + } + + wait_cnt = 0; + + if (check_fwstate(&adapter->mlmepriv, WIFI_SITE_MONITOR) == _TRUE) { + RTW_INFO("%s: Sounding abort! scanning APs...\n", __FUNCTION__); + info->sounding_running--; + return; + } + + rtw_ps_deny(adapter, PS_DENY_BEAMFORMING); + LeaveAllPowerSaveModeDirect(adapter); + } + + /* Get non-sound SU BFee index */ + for (i = 0; i < MAX_NUM_BEAMFORMEE_SU; i++) { + su_idx = sounding->su_sounding_list[i]; + if (su_idx >= MAX_BEAMFORMEE_ENTRY_NUM) + continue; + bfee = &info->bfee_entry[su_idx]; + if (_FALSE == bfee->sounding) + break; + } + if (i < MAX_NUM_BEAMFORMEE_SU) { + sounding->su_bfee_curidx = su_idx; + /* Set to sounding start state */ + sounding->state = SOUNDING_STATE_SU_START; + RTW_DBG("%s: Set to SOUNDING_STATE_SU_START\n", __FUNCTION__); + + bfee->sounding = _TRUE; + /* Reset sounding timeout flag for the new sounding */ + bfee->bSoundingTimeout = _FALSE; + + if (_TRUE == bfee->bDeleteSounding) { + u8 res = _FALSE; + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_END_PERIOD, &res, 1, 0); + return; + } + + /* Start SU sounding */ + if (bfee->cap & BEAMFORMEE_CAP_VHT_SU) + _send_vht_ndpa_packet(adapter, bfee->mac_addr, bfee->aid, bfee->sound_bw); + else if (bfee->cap & BEAMFORMEE_CAP_HT_EXPLICIT) + _send_ht_ndpa_packet(adapter, bfee->mac_addr, bfee->sound_bw); + + /* Set sounding timeout timer */ + _set_timer(&info->sounding_timeout_timer, SU_SOUNDING_TIMEOUT); + return; + } + + if (sounding->candidate_mu_bfee_cnt > 0) { + /* + * If there is no SU BFee then find MU BFee and perform MU sounding + * + * Need to check the MU starting condition. 2015.12.15. + */ + sounding->state = SOUNDING_STATE_MU_START; + RTW_DBG("%s: Set to SOUNDING_STATE_MU_START\n", __FUNCTION__); + + /* Update MU BFee info */ + for (i = 0; i < sounding->candidate_mu_bfee_cnt; i++) { + bfee = &info->bfee_entry[sounding->mu_sounding_list[i]]; + bfee->sounding = _TRUE; + } + + /* Send MU NDPA */ + bfee = &info->bfee_entry[sounding->mu_sounding_list[0]]; + _send_vht_mu_ndpa_packet(adapter, bfee->sound_bw); + + /* Send BF report poll if more than 1 MU STA */ + for (i = 1; i < sounding->candidate_mu_bfee_cnt; i++) { + bfee = &info->bfee_entry[sounding->mu_sounding_list[i]]; + + if (i == (sounding->candidate_mu_bfee_cnt - 1))/* The last STA*/ + _send_bf_report_poll(adapter, bfee->mac_addr, _TRUE); + else + _send_bf_report_poll(adapter, bfee->mac_addr, _FALSE); + } + + sounding->candidate_mu_bfee_cnt = 0; + + /* Set sounding timeout timer */ + _set_timer(&info->sounding_timeout_timer, MU_SOUNDING_TIMEOUT); + return; + } + + info->sounding_running--; + sounding->state = SOUNDING_STATE_INIT; + RTW_INFO("%s: Sounding finished!\n", __FUNCTION__); + rtw_ps_deny_cancel(adapter, PS_DENY_BEAMFORMING); +} + +static void _sounding_force_stop(PADAPTER adapter) +{ + struct beamforming_info *info; + struct sounding_info *sounding; + + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + if ((sounding->state == SOUNDING_STATE_SU_START) + || (sounding->state == SOUNDING_STATE_MU_START)) { + u8 res = _FALSE; + _cancel_timer_ex(&info->sounding_timeout_timer); + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_END_PERIOD, &res, 1, 1); + return; + } + + info->sounding_running--; + sounding->state = SOUNDING_STATE_INIT; + RTW_INFO("%s: Sounding finished!\n", __FUNCTION__); + rtw_ps_deny_cancel(adapter, PS_DENY_BEAMFORMING); +} + +static void _sounding_timer_handler(void *FunctionContext) +{ + PADAPTER adapter; + struct beamforming_info *info; + struct sounding_info *sounding; + static u8 delay = 0; + + + RTW_DBG("+%s\n", __FUNCTION__); + + adapter = (PADAPTER)FunctionContext; + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + if (SOUNDING_STATE_NONE == sounding->state) { + RTW_INFO("%s: Stop!\n", __FUNCTION__); + if (info->sounding_running) + RTW_WARN("%s: souding_running=%d when thread stop!\n", + __FUNCTION__, info->sounding_running); + return; + } + + _set_timer(&info->sounding_timer, sounding->min_sounding_period); + + if (!info->sounding_running) { + if (SOUNDING_STATE_INIT != sounding->state) { + RTW_WARN("%s: state(%d) != SOUNDING_STATE_INIT!!\n", __FUNCTION__, sounding->state); + sounding->state = SOUNDING_STATE_INIT; + } + delay = 0; + info->sounding_running++; + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_START_PERIOD, NULL, 0, 1); + } else { + if (delay != 0xFF) + delay++; + RTW_WARN("%s: souding is still processing...(state:%d, running:%d, delay:%d)\n", + __FUNCTION__, sounding->state, info->sounding_running, delay); + if (delay > 3) { + RTW_WARN("%s: Stop sounding!!\n", __FUNCTION__); + _sounding_force_stop(adapter); + } + } +} + +static void _sounding_timeout_timer_handler(void *FunctionContext) +{ + PADAPTER adapter; + struct beamforming_info *info; + struct sounding_info *sounding; + struct beamformee_entry *bfee; + + + RTW_WARN("+%s\n", __FUNCTION__); + + adapter = (PADAPTER)FunctionContext; + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + if (SOUNDING_STATE_SU_START == sounding->state) { + sounding->state = SOUNDING_STATE_SOUNDING_TIMEOUT; + RTW_ERR("%s: Set to SU SOUNDING_STATE_SOUNDING_TIMEOUT\n", __FUNCTION__); + /* SU BFee */ + bfee = &info->bfee_entry[sounding->su_bfee_curidx]; + bfee->bSoundingTimeout = _TRUE; + RTW_WARN("%s: The BFee entry[%d] is Sounding Timeout!\n", __FUNCTION__, sounding->su_bfee_curidx); + } else if (SOUNDING_STATE_MU_START == sounding->state) { + sounding->state = SOUNDING_STATE_SOUNDING_TIMEOUT; + RTW_ERR("%s: Set to MU SOUNDING_STATE_SOUNDING_TIMEOUT\n", __FUNCTION__); + } else { + RTW_WARN("%s: unexpected sounding state:0x%02x\n", __FUNCTION__, sounding->state); + return; + } + + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_START_PERIOD, NULL, 0, 1); +} + +static struct beamformer_entry *_bfer_get_free_entry(PADAPTER adapter) +{ + u8 i = 0; + struct beamforming_info *info; + struct beamformer_entry *bfer; + + + info = GET_BEAMFORM_INFO(adapter); + + for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { + bfer = &info->bfer_entry[i]; + if (bfer->used == _FALSE) + return bfer; + } + + return NULL; +} + +static struct beamformer_entry *_bfer_get_entry_by_addr(PADAPTER adapter, u8 *ra) +{ + u8 i = 0; + struct beamforming_info *info; + struct beamformer_entry *bfer; + + + info = GET_BEAMFORM_INFO(adapter); + + for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { + bfer = &info->bfer_entry[i]; + if (bfer->used == _FALSE) + continue; + if (_rtw_memcmp(ra, bfer->mac_addr, ETH_ALEN) == _TRUE) + return bfer; + } + + return NULL; +} + +static struct beamformer_entry *_bfer_add_entry(PADAPTER adapter, + struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) +{ + struct mlme_priv *mlme; + struct beamforming_info *info; + struct beamformer_entry *bfer; + u8 *bssid; + u16 val16; + u8 i; + + + mlme = &adapter->mlmepriv; + info = GET_BEAMFORM_INFO(adapter); + + bfer = _bfer_get_entry_by_addr(adapter, sta->cmn.mac_addr); + if (!bfer) { + bfer = _bfer_get_free_entry(adapter); + if (!bfer) + return NULL; + } + + bfer->used = _TRUE; + _get_txvector_parameter(adapter, sta, &bfer->g_id, &bfer->p_aid); + _rtw_memcpy(bfer->mac_addr, sta->cmn.mac_addr, ETH_ALEN); + bfer->cap = bf_cap; + bfer->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; + bfer->NumofSoundingDim = sounding_dim; + + if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_MU)) { + info->beamformer_mu_cnt += 1; + bfer->aid = sta->cmn.aid; + } else if (TEST_FLAG(bf_cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { + info->beamformer_su_cnt += 1; + + /* Record HW idx info */ + for (i = 0; i < MAX_NUM_BEAMFORMER_SU; i++) { + if ((info->beamformer_su_reg_maping & BIT(i)) == 0) { + info->beamformer_su_reg_maping |= BIT(i); + bfer->su_reg_index = i; + break; + } + } + RTW_INFO("%s: Add BFer entry beamformer_su_reg_maping=%#x, su_reg_index=%d\n", + __FUNCTION__, info->beamformer_su_reg_maping, bfer->su_reg_index); + } + + return bfer; +} + +static void _bfer_remove_entry(PADAPTER adapter, struct beamformer_entry *entry) +{ + struct beamforming_info *info; + + + info = GET_BEAMFORM_INFO(adapter); + + entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; + + if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_MU)) { + info->beamformer_mu_cnt -= 1; + _rtw_memset(entry->gid_valid, 0, 8); + _rtw_memset(entry->user_position, 0, 16); + } else if (TEST_FLAG(entry->cap, BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { + info->beamformer_su_cnt -= 1; + } + + if (info->beamformer_mu_cnt == 0) + info->beamforming_cap &= ~BEAMFORMEE_CAP_VHT_MU; + if (info->beamformer_su_cnt == 0) + info->beamforming_cap &= ~(BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT); +} + +static u8 _bfer_set_entry_gid(PADAPTER adapter, u8 *addr, u8 *gid, u8 *position) +{ + struct beamformer_entry *bfer = NULL; + + + bfer = _bfer_get_entry_by_addr(adapter, addr); + if (!bfer) { + RTW_INFO("%s: Cannot find BFer entry!!\n", __FUNCTION__); + return _FAIL; + } + + /* Parsing Membership Status Array */ + _rtw_memcpy(bfer->gid_valid, gid, 8); + /* Parsing User Position Array */ + _rtw_memcpy(bfer->user_position, position, 16); + + /* Config HW GID table */ + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_GID_TABLE, (u8*)&bfer, sizeof(struct beamformer_entry *), 1); + + return _SUCCESS; +} + +static struct beamformee_entry *_bfee_get_free_entry(PADAPTER adapter) +{ + u8 i = 0; + struct beamforming_info *info; + struct beamformee_entry *bfee; + + + info = GET_BEAMFORM_INFO(adapter); + + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (bfee->used == _FALSE) + return bfee; + } + + return NULL; +} + +static struct beamformee_entry *_bfee_get_entry_by_addr(PADAPTER adapter, u8 *ra) +{ + u8 i = 0; + struct beamforming_info *info; + struct beamformee_entry *bfee; + + + info = GET_BEAMFORM_INFO(adapter); + + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (bfee->used == _FALSE) + continue; + if (_rtw_memcmp(ra, bfee->mac_addr, ETH_ALEN) == _TRUE) + return bfee; + } + + return NULL; +} + +static u8 _bfee_get_first_su_entry_idx(PADAPTER adapter, struct beamformee_entry *ignore) +{ + struct beamforming_info *info; + struct beamformee_entry *bfee; + u8 i; + + + info = GET_BEAMFORM_INFO(adapter); + + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (ignore && (bfee == ignore)) + continue; + if (bfee->used == _FALSE) + continue; + if ((!TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_MU)) + && TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) + return i; + } + + return 0xFF; +} + +/* + * Description: + * Get the first entry index of MU Beamformee. + * + * Return Value: + * Index of the first MU sta, or 0xFF for invalid index. + * + * 2015.05.25. Created by tynli. + * + */ +static u8 _bfee_get_first_mu_entry_idx(PADAPTER adapter, struct beamformee_entry *ignore) +{ + struct beamforming_info *info; + struct beamformee_entry *bfee; + u8 i; + + + info = GET_BEAMFORM_INFO(adapter); + + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (ignore && (bfee == ignore)) + continue; + if (bfee->used == _FALSE) + continue; + if (TEST_FLAG(bfee->cap, BEAMFORMEE_CAP_VHT_MU)) + return i; + } + + return 0xFF; +} + +static struct beamformee_entry *_bfee_add_entry(PADAPTER adapter, + struct sta_info *sta, u8 bf_cap, u8 sounding_dim, u8 comp_steering) +{ + struct mlme_priv *mlme; + struct beamforming_info *info; + struct beamformee_entry *bfee; + u8 *bssid; + u16 val16; + u8 i; + + + mlme = &adapter->mlmepriv; + info = GET_BEAMFORM_INFO(adapter); + + bfee = _bfee_get_entry_by_addr(adapter, sta->cmn.mac_addr); + if (!bfee) { + bfee = _bfee_get_free_entry(adapter); + if (!bfee) + return NULL; + } + + bfee->used = _TRUE; + bfee->aid = sta->cmn.aid; + bfee->mac_id = sta->cmn.mac_id; + bfee->sound_bw = sta->cmn.bw_mode; + + _get_txvector_parameter(adapter, sta, &bfee->g_id, &bfee->p_aid); + sta->cmn.bf_info.g_id = bfee->g_id; + sta->cmn.bf_info.p_aid = bfee->p_aid; + + _rtw_memcpy(bfee->mac_addr, sta->cmn.mac_addr, ETH_ALEN); + bfee->txbf = _FALSE; + bfee->sounding = _FALSE; + bfee->sound_period = 40; + _sounding_update_min_period(adapter, bfee->sound_period, _FALSE); + bfee->SoundCnt = GetInitSoundCnt(bfee->sound_period, info->sounding_info.min_sounding_period); + bfee->cap = bf_cap; + bfee->state = BEAMFORM_ENTRY_HW_STATE_ADD_INIT; + + bfee->bCandidateSoundingPeer = _FALSE; + bfee->bSoundingTimeout = _FALSE; + bfee->bDeleteSounding = _FALSE; + bfee->bApplySounding = _TRUE; + + bfee->tx_timestamp = 0; + bfee->tx_bytes = 0; + + bfee->LogStatusFailCnt = 0; + bfee->NumofSoundingDim = sounding_dim; + bfee->comp_steering_num_of_bfer = comp_steering; + bfee->bSuspendSUCap = _FALSE; + + if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_MU)) { + info->beamformee_mu_cnt += 1; + info->first_mu_bfee_index = _bfee_get_first_mu_entry_idx(adapter, NULL); + + if (_TRUE == info->bEnableSUTxBFWorkAround) { + /* When the first MU BFee added, discard SU BFee bfee's capability */ + if ((info->beamformee_mu_cnt == 1) && (info->beamformee_su_cnt > 0)) { + if (info->TargetSUBFee) { + info->TargetSUBFee->bSuspendSUCap = _TRUE; + info->TargetSUBFee->bDeleteSounding = _TRUE; + } else { + RTW_ERR("%s: UNEXPECTED!! info->TargetSUBFee is NULL!", __FUNCTION__); + } + info->TargetSUBFee = NULL; + _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_CSI_REPORT, (u8*)&info->TargetCSIInfo, sizeof(struct _RT_CSI_INFO), 0); + } + } + + /* Record HW idx info */ + for (i = 0; i < MAX_NUM_BEAMFORMEE_MU; i++) { + if ((info->beamformee_mu_reg_maping & BIT(i)) == 0) { + info->beamformee_mu_reg_maping |= BIT(i); + bfee->mu_reg_index = i; + break; + } + } + RTW_INFO("%s: Add BFee entry beamformee_mu_reg_maping=%#x, mu_reg_index=%d\n", + __FUNCTION__, info->beamformee_mu_reg_maping, bfee->mu_reg_index); + + } else if (TEST_FLAG(bf_cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { + info->beamformee_su_cnt += 1; + + if (_TRUE == info->bEnableSUTxBFWorkAround) { + /* Record the first SU BFee index. We only allow the first SU BFee to be sound */ + if ((info->beamformee_su_cnt == 1) && (info->beamformee_mu_cnt == 0)) { + info->TargetSUBFee = bfee; + _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); + bfee->bSuspendSUCap = _FALSE; + } else { + bfee->bSuspendSUCap = _TRUE; + } + } + + /* Record HW idx info */ + for (i = 0; i < MAX_NUM_BEAMFORMEE_SU; i++) { + if ((info->beamformee_su_reg_maping & BIT(i)) == 0) { + info->beamformee_su_reg_maping |= BIT(i); + bfee->su_reg_index = i; + break; + } + } + RTW_INFO("%s: Add BFee entry beamformee_su_reg_maping=%#x, su_reg_index=%d\n", + __FUNCTION__, info->beamformee_su_reg_maping, bfee->su_reg_index); + } + + return bfee; +} + +static void _bfee_remove_entry(PADAPTER adapter, struct beamformee_entry *entry) +{ + struct beamforming_info *info; + u8 idx; + + + info = GET_BEAMFORM_INFO(adapter); + + entry->state = BEAMFORM_ENTRY_HW_STATE_DELETE_INIT; + + if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_MU)) { + info->beamformee_mu_cnt -= 1; + info->first_mu_bfee_index = _bfee_get_first_mu_entry_idx(adapter, entry); + + if (_TRUE == info->bEnableSUTxBFWorkAround) { + if ((info->beamformee_mu_cnt == 0) && (info->beamformee_su_cnt > 0)) { + idx = _bfee_get_first_su_entry_idx(adapter, NULL); + info->TargetSUBFee = &info->bfee_entry[idx]; + _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); + info->TargetSUBFee->bSuspendSUCap = _FALSE; + } + } + } else if (TEST_FLAG(entry->cap, BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { + info->beamformee_su_cnt -= 1; + + /* When the target SU BFee leaves, disable workaround */ + if ((_TRUE == info->bEnableSUTxBFWorkAround) + && (entry == info->TargetSUBFee)) { + entry->bSuspendSUCap = _TRUE; + info->TargetSUBFee = NULL; + _rtw_memset(&info->TargetCSIInfo, 0, sizeof(struct _RT_CSI_INFO)); + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_CSI_REPORT, (u8*)&info->TargetCSIInfo, sizeof(struct _RT_CSI_INFO), 0); + } + } + + if (info->beamformee_mu_cnt == 0) + info->beamforming_cap &= ~BEAMFORMER_CAP_VHT_MU; + if (info->beamformee_su_cnt == 0) + info->beamforming_cap &= ~(BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT); + + _sounding_update_min_period(adapter, 0, _TRUE); +} + +static enum beamforming_cap _bfee_get_entry_cap_by_macid(PADAPTER adapter, u8 macid) +{ + struct beamforming_info *info; + struct beamformee_entry *bfee; + u8 i; + + + info = GET_BEAMFORM_INFO(adapter); + + for (i = 0; i < MAX_BEAMFORMER_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (bfee->used == _FALSE) + continue; + if (bfee->mac_id == macid) + return bfee->cap; + } + + return BEAMFORMING_CAP_NONE; +} + +static void _beamforming_enter(PADAPTER adapter, void *p) { struct mlme_priv *mlme; struct ht_priv *htpriv; @@ -490,10 +1363,10 @@ static u8 _init_entry(PADAPTER adapter, struct sta_info *sta) struct vht_priv *vhtpriv; #endif struct mlme_ext_priv *mlme_ext; - struct sta_info *sta_real; + struct sta_info *sta, *sta_copy; + struct beamforming_info *info; struct beamformer_entry *bfer = NULL; struct beamformee_entry *bfee = NULL; - u8 *ra; u8 wireless_mode; u8 sta_bf_cap; u8 sounding_dim = 0; /* number of sounding dimensions */ @@ -506,14 +1379,27 @@ static u8 _init_entry(PADAPTER adapter, struct sta_info *sta) vhtpriv = &mlme->vhtpriv; #endif mlme_ext = &adapter->mlmeextpriv; - ra = sta->hwaddr; - wireless_mode = sta->wireless_mode; - sta_real = rtw_get_stainfo(&adapter->stapriv, ra); + info = GET_BEAMFORM_INFO(adapter); + + sta_copy = (struct sta_info *)p; + sta = rtw_get_stainfo(&adapter->stapriv, sta_copy->cmn.mac_addr); + if (!sta) { + RTW_ERR("%s: Cann't find STA info for " MAC_FMT "\n", + __FUNCTION__, MAC_ARG(sta_copy->cmn.mac_addr)); + return; + } + if (sta != sta_copy) { + RTW_WARN("%s: Origin sta(fake)=%p realsta=%p for " MAC_FMT "\n", + __FUNCTION__, sta_copy, sta, MAC_ARG(sta_copy->cmn.mac_addr)); + } /* The current setting does not support Beaforming */ - if ((IsSupportedHT(wireless_mode) == _FALSE) - && (IsSupportedVHT(wireless_mode) == _FALSE)) - return _FALSE; + wireless_mode = sta->wireless_mode; + if ((is_supported_ht(wireless_mode) == _FALSE) + && (is_supported_vht(wireless_mode) == _FALSE)) { + RTW_WARN("%s: Not support HT or VHT mode\n", __FUNCTION__); + return; + } if ((0 == htpriv->beamform_cap) #ifdef CONFIG_80211AC_VHT @@ -521,51 +1407,59 @@ static u8 _init_entry(PADAPTER adapter, struct sta_info *sta) #endif ) { RTW_INFO("The configuration disabled Beamforming! Skip...\n"); - return _FALSE; + return; } _get_sta_beamform_cap(adapter, sta, &sta_bf_cap, &sounding_dim, &comp_steering_num); RTW_INFO("STA Beamforming Capability=0x%02X\n", sta_bf_cap); - if (sta_bf_cap == BEAMFORMING_CAP_NONE) - return _FALSE; - + return; if ((sta_bf_cap & BEAMFORMEE_CAP_HT_EXPLICIT) || (sta_bf_cap & BEAMFORMEE_CAP_VHT_SU) || (sta_bf_cap & BEAMFORMEE_CAP_VHT_MU)) sta_bf_cap |= BEAMFORMEE_CAP; - else + if ((sta_bf_cap & BEAMFORMER_CAP_HT_EXPLICIT) + || (sta_bf_cap & BEAMFORMER_CAP_VHT_SU) + || (sta_bf_cap & BEAMFORMER_CAP_VHT_MU)) sta_bf_cap |= BEAMFORMER_CAP; if (sta_bf_cap & BEAMFORMER_CAP) { /* The other side is beamformer */ - bfer = _add_bfer_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); - if (bfer == NULL) { + bfer = _bfer_add_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); + if (!bfer) RTW_ERR("%s: Fail to allocate bfer entry!\n", __FUNCTION__); - return _FALSE; - } - - sta_real->txbf_paid = bfer->p_aid; - sta_real->txbf_gid = bfer->g_id; - } else { - /* The other side is beamformee */ - bfee = _add_bfee_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); - if (bfee == NULL) { - RTW_ERR("%s: Fail to allocate bfee entry!\n", __FUNCTION__); - return _FALSE; - } - - sta_real->txbf_paid = bfee->p_aid; - sta_real->txbf_gid = bfee->g_id; } + if (sta_bf_cap & BEAMFORMEE_CAP) { + /* The other side is beamformee */ + bfee = _bfee_add_entry(adapter, sta, sta_bf_cap, sounding_dim, comp_steering_num); + if (!bfee) + RTW_ERR("%s: Fail to allocate bfee entry!\n", __FUNCTION__); + } + if (!bfer && !bfee) + return; - return _TRUE; + rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, (u8*)sta); + + /* Perform sounding if there is BFee */ + if ((info->beamformee_su_cnt != 0) + || (info->beamformee_mu_cnt != 0)) { + if (SOUNDING_STATE_NONE == info->sounding_info.state) { + info->sounding_info.state = SOUNDING_STATE_INIT; + /* Start sounding after 2 sec */ + _set_timer(&info->sounding_timer, 2000); + } + } } -static void _deinit_entry(PADAPTER adapter, u8 *ra) +static void _beamforming_reset(PADAPTER adapter) { - struct beamforming_info *bf_info; + RTW_ERR("%s: Not ready!!\n", __FUNCTION__); +} + +static void _beamforming_leave(PADAPTER adapter, u8 *ra) +{ + struct beamforming_info *info; struct beamformer_entry *bfer = NULL; struct beamformee_entry *bfee = NULL; u8 bHwStateAddInit = _FALSE; @@ -573,9 +1467,9 @@ static void _deinit_entry(PADAPTER adapter, u8 *ra) RTW_INFO("+%s\n", __FUNCTION__); - bf_info = GET_BEAMFORM_INFO(adapter); - bfer = beamforming_get_bfer_entry_by_addr(adapter, ra); - bfee = beamforming_get_bfee_entry_by_addr(adapter, ra); + info = GET_BEAMFORM_INFO(adapter); + bfer = _bfer_get_entry_by_addr(adapter, ra); + bfee = _bfee_get_entry_by_addr(adapter, ra); if (!bfer && !bfee) { RTW_WARN("%s: " MAC_FMT " is neither beamforming ee or er!!\n", @@ -583,58 +1477,226 @@ static void _deinit_entry(PADAPTER adapter, u8 *ra) return; } - if (bfer && bfee) - RTW_ERR("%s: " MAC_FMT " is both beamforming ee & er!!\n", - __FUNCTION__, MAC_ARG(ra)); - if (bfer) - _remove_bfer_entry(adapter, bfer); + _bfer_remove_entry(adapter, bfer); if (bfee) - _remove_bfee_entry(adapter, bfee); + _bfee_remove_entry(adapter, bfee); rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_LEAVE, ra); - RTW_DBG("-%s\n", __FUNCTION__); + /* Stop sounding if there is no any BFee */ + if ((info->beamformee_su_cnt == 0) + && (info->beamformee_mu_cnt == 0)) { + _cancel_timer_ex(&info->sounding_timer); + _sounding_init(&info->sounding_info); + } + + RTW_INFO("-%s\n", __FUNCTION__); } -void _beamforming_reset(PADAPTER adapter) +static void _beamforming_sounding_down(PADAPTER adapter, u8 status) { - RTW_ERR("%s: Not ready!!\n", __FUNCTION__); -} + struct beamforming_info *info; + struct sounding_info *sounding; + struct beamformee_entry *bfee; -void beamforming_enter(PADAPTER adapter, void *sta) -{ - u8 ret; - ret = _init_entry(adapter, (struct sta_info *)sta); - if (ret == _FALSE) + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + RTW_INFO("+%s: sounding=%d, status=0x%02x\n", __FUNCTION__, sounding->state, status); + + if (sounding->state == SOUNDING_STATE_MU_START) { + RTW_INFO("%s: MU sounding done\n", __FUNCTION__); + sounding->state = SOUNDING_STATE_MU_SOUNDDOWN; + RTW_INFO("%s: Set to SOUNDING_STATE_MU_SOUNDDOWN\n", __FUNCTION__); + info->SetHalSoundownOnDemandCnt++; + rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_STATUS, &status); + } else if (sounding->state == SOUNDING_STATE_SU_START) { + RTW_INFO("%s: SU entry[%d] sounding down\n", __FUNCTION__, sounding->su_bfee_curidx); + bfee = &info->bfee_entry[sounding->su_bfee_curidx]; + sounding->state = SOUNDING_STATE_SU_SOUNDDOWN; + RTW_INFO("%s: Set to SOUNDING_STATE_SU_SOUNDDOWN\n", __FUNCTION__); + + /* + * + * bfee->bSoundingTimeout this flag still cannot avoid + * old sound down event happens in the new sounding period. + * 2015.12.10 + */ + if (_TRUE == bfee->bSoundingTimeout) { + RTW_WARN("%s: The entry[%d] is bSoundingTimeout!\n", __FUNCTION__, sounding->su_bfee_curidx); + bfee->bSoundingTimeout = _FALSE; + return; + } + + if (_TRUE == status) { + /* success */ + bfee->LogStatusFailCnt = 0; + info->SetHalSoundownOnDemandCnt++; + rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_STATUS, &status); + } else if (_TRUE == bfee->bDeleteSounding) { + RTW_WARN("%s: Delete entry[%d] sounding info!\n", __FUNCTION__, sounding->su_bfee_curidx); + rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_STATUS, &status); + bfee->bDeleteSounding = _FALSE; + } else { + bfee->LogStatusFailCnt++; + RTW_WARN("%s: LogStatusFailCnt=%d\n", __FUNCTION__, bfee->LogStatusFailCnt); + if (bfee->LogStatusFailCnt > 30) { + RTW_ERR("%s: LogStatusFailCnt > 30, Stop SOUNDING!!\n", __FUNCTION__); + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_LEAVE, bfee->mac_addr, ETH_ALEN, 1); + } + } + } else { + RTW_WARN("%s: unexpected sounding state:0x%02x\n", __FUNCTION__, sounding->state); return; + } - rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_ENTER, sta); + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_START_PERIOD, NULL, 0, 0); } -void beamforming_leave(PADAPTER adapter, u8 *ra) +static void _c2h_snd_txbf(PADAPTER adapter, u8 *buf, u8 buf_len) { - if (ra == NULL) - _beamforming_reset(adapter); - else - _deinit_entry(adapter, ra); + struct beamforming_info *info; + u8 res; + + info = GET_BEAMFORM_INFO(adapter); + + _cancel_timer_ex(&info->sounding_timeout_timer); + + res = C2H_SND_TXBF_GET_SND_RESULT(buf) ? _TRUE : _FALSE; + RTW_INFO("+%s: %s\n", __FUNCTION__, res==_TRUE?"Success":"Fail!"); + + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_END_PERIOD, &res, 1, 1); } -void beamforming_sounding_fail(PADAPTER adapter) +/* + * Description: + * This function is for phydm only + */ +enum beamforming_cap rtw_bf_bfee_get_entry_cap_by_macid(void *mlme, u8 macid) { - RTW_ERR("+%s: not implemented yet!\n", __FUNCTION__); + PADAPTER adapter; + enum beamforming_cap cap = BEAMFORMING_CAP_NONE; + + + adapter = mlme_to_adapter((struct mlme_priv *)mlme); + cap = _bfee_get_entry_cap_by_macid(adapter, macid); + + return cap; } -u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER adapter, struct beamformee_entry *entry) +struct beamformer_entry *rtw_bf_bfer_get_entry_by_addr(PADAPTER adapter, u8 *ra) { + return _bfer_get_entry_by_addr(adapter, ra); +} + +struct beamformee_entry *rtw_bf_bfee_get_entry_by_addr(PADAPTER adapter, u8 *ra) +{ + return _bfee_get_entry_by_addr(adapter, ra); +} + +void rtw_bf_get_ndpa_packet(PADAPTER adapter, union recv_frame *precv_frame) +{ + RTW_DBG("+%s\n", __FUNCTION__); +} + +u32 rtw_bf_get_report_packet(PADAPTER adapter, union recv_frame *precv_frame) +{ + u32 ret = _SUCCESS; + struct beamforming_info *info; + struct beamformee_entry *bfee = NULL; + u8 *pframe; + u32 frame_len; + u8 *ta; + u8 *frame_body; + u8 category, action; + u8 *pMIMOCtrlField, *pCSIMatrix; + u8 Nc = 0, Nr = 0, CH_W = 0, Ng = 0, CodeBook = 0; + u16 CSIMatrixLen = 0; + + + RTW_INFO("+%s\n", __FUNCTION__); + + info = GET_BEAMFORM_INFO(adapter); + pframe = precv_frame->u.hdr.rx_data; + frame_len = precv_frame->u.hdr.len; + + /* Memory comparison to see if CSI report is the same with previous one */ + ta = get_addr2_ptr(pframe); + bfee = _bfee_get_entry_by_addr(adapter, ta); + if (!bfee) + return _FAIL; + + frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); + category = frame_body[0]; + action = frame_body[1]; + + if ((category == RTW_WLAN_CATEGORY_VHT) + && (action == RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING)) { + pMIMOCtrlField = pframe + 26; + Nc = (*pMIMOCtrlField) & 0x7; + Nr = ((*pMIMOCtrlField) & 0x38) >> 3; + CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); + Ng = (*(pMIMOCtrlField+1)) & 0x3; + CodeBook = ((*(pMIMOCtrlField+1)) & 0x4) >> 2; + /* + * 24+(1+1+3)+2 + * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) + */ + pCSIMatrix = pMIMOCtrlField + 3 + Nc; + CSIMatrixLen = frame_len - 26 - 3 - Nc; + info->TargetCSIInfo.bVHT = _TRUE; + } else if ((category == RTW_WLAN_CATEGORY_HT) + && (action == RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING)) { + pMIMOCtrlField = pframe + 26; + Nc = (*pMIMOCtrlField) & 0x3; + Nr = ((*pMIMOCtrlField) & 0xC) >> 2; + CH_W = ((*pMIMOCtrlField) & 0x10) >> 4; + Ng = ((*pMIMOCtrlField) & 0x60) >> 5; + CodeBook = ((*(pMIMOCtrlField+1)) & 0x6) >> 1; + /* + * 24+(1+1+6)+2 + * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) + */ + pCSIMatrix = pMIMOCtrlField + 6 + Nr; + CSIMatrixLen = frame_len - 26 - 6 - Nr; + info->TargetCSIInfo.bVHT = _FALSE; + } + + /* Update current CSI report info */ + if ((_TRUE == info->bEnableSUTxBFWorkAround) + && (info->TargetSUBFee == bfee)) { + if ((info->TargetCSIInfo.Nc != Nc) || (info->TargetCSIInfo.Nr != Nr) || + (info->TargetCSIInfo.ChnlWidth != CH_W) || (info->TargetCSIInfo.Ng != Ng) || + (info->TargetCSIInfo.CodeBook != CodeBook)) { + info->TargetCSIInfo.Nc = Nc; + info->TargetCSIInfo.Nr = Nr; + info->TargetCSIInfo.ChnlWidth = CH_W; + info->TargetCSIInfo.Ng = Ng; + info->TargetCSIInfo.CodeBook = CodeBook; + + rtw_bf_cmd(adapter, BEAMFORMING_CTRL_SET_CSI_REPORT, (u8*)&info->TargetCSIInfo, sizeof(struct _RT_CSI_INFO), 1); + } + } + + RTW_INFO("%s: pkt type=%d-%d, Nc=%d, Nr=%d, CH_W=%d, Ng=%d, CodeBook=%d\n", + __FUNCTION__, category, action, Nc, Nr, CH_W, Ng, CodeBook); + + return ret; +} + +u8 rtw_bf_send_vht_gid_mgnt_packet(PADAPTER adapter, u8 *ra, u8 *gid, u8 *position) +{ + /* General */ struct xmit_priv *xmitpriv; struct mlme_priv *mlmepriv; struct xmit_frame *pmgntframe; + /* MISC */ struct pkt_attrib *attrib; struct rtw_ieee80211_hdr *wlanhdr; - u8 *pframe; + u8 *pframe, *ptr; xmitpriv = &adapter->xmitpriv; @@ -657,19 +1719,23 @@ u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER adapter, struct beamformee_entr wlanhdr = (struct rtw_ieee80211_hdr *)pframe; wlanhdr->frame_ctl = 0; - SetFrameSubType(pframe, attrib->subtype); - SetDuration(pframe, 0); + set_frame_sub_type(pframe, attrib->subtype); + set_duration(pframe, 0); SetFragNum(pframe, 0); SetSeqNum(pframe, 0); - _rtw_memcpy(wlanhdr->addr1, entry->mac_addr, ETH_ALEN); + _rtw_memcpy(wlanhdr->addr1, ra, ETH_ALEN); _rtw_memcpy(wlanhdr->addr2, adapter_mac_addr(adapter), ETH_ALEN); _rtw_memcpy(wlanhdr->addr3, get_bssid(mlmepriv), ETH_ALEN); pframe[24] = RTW_WLAN_CATEGORY_VHT; pframe[25] = RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT; - _rtw_memcpy(&pframe[26], entry->gid_valid, 8); - _rtw_memcpy(&pframe[34], entry->user_position, 16); + /* Set Membership Status Array */ + ptr = pframe + 26; + _rtw_memcpy(ptr, gid, 8); + /* Set User Position Array */ + ptr = pframe + 34; + _rtw_memcpy(ptr, position, 16); attrib->pktlen = 54; attrib->last_txcmdsz = attrib->pktlen; @@ -679,11 +1745,267 @@ u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER adapter, struct beamformee_entr return _TRUE; } -void beamforming_watchdog(PADAPTER adapter) +/* + * Description: + * On VHT GID management frame by an MU beamformee. + */ +void rtw_bf_get_vht_gid_mgnt_packet(PADAPTER adapter, union recv_frame *precv_frame) { + u8 *pframe; + u8 *ta, *gid, *position; + + + RTW_DBG("+%s\n", __FUNCTION__); + + pframe = precv_frame->u.hdr.rx_data; + + /* Get address by Addr2 */ + ta = get_addr2_ptr(pframe); + /* Remove signaling TA */ + ta[0] &= 0xFE; + + /* Membership Status Array */ + gid = pframe + 26; + /* User Position Array */ + position= pframe + 34; + + _bfer_set_entry_gid(adapter, ta, gid, position); } + +void rtw_bf_init(PADAPTER adapter) +{ + struct beamforming_info *info; + + + info = GET_BEAMFORM_INFO(adapter); + info->beamforming_cap = BEAMFORMING_CAP_NONE; + info->beamforming_state = BEAMFORMING_STATE_IDLE; +/* + info->bfee_entry[MAX_BEAMFORMEE_ENTRY_NUM]; + info->bfer_entry[MAX_BEAMFORMER_ENTRY_NUM]; +*/ + info->sounding_sequence = 0; + info->beamformee_su_cnt = 0; + info->beamformer_su_cnt = 0; + info->beamformee_su_reg_maping = 0; + info->beamformer_su_reg_maping = 0; + info->beamformee_mu_cnt = 0; + info->beamformer_mu_cnt = 0; + info->beamformee_mu_reg_maping = 0; + info->first_mu_bfee_index = 0xFF; + info->mu_bfer_curidx = 0xFF; + + _sounding_init(&info->sounding_info); + rtw_init_timer(&info->sounding_timer, adapter, _sounding_timer_handler, adapter); + rtw_init_timer(&info->sounding_timeout_timer, adapter, _sounding_timeout_timer_handler, adapter); + + info->SetHalBFEnterOnDemandCnt = 0; + info->SetHalBFLeaveOnDemandCnt = 0; + info->SetHalSoundownOnDemandCnt = 0; + + info->bEnableSUTxBFWorkAround = _TRUE; + info->TargetSUBFee = NULL; + + info->sounding_running = 0; +} + +void rtw_bf_cmd_hdl(PADAPTER adapter, u8 type, u8 *pbuf) +{ + switch (type) { + case BEAMFORMING_CTRL_ENTER: + _beamforming_enter(adapter, pbuf); + break; + + case BEAMFORMING_CTRL_LEAVE: + if (pbuf == NULL) + _beamforming_reset(adapter); + else + _beamforming_leave(adapter, pbuf); + break; + + case BEAMFORMING_CTRL_START_PERIOD: + _sounding_handler(adapter); + break; + + case BEAMFORMING_CTRL_END_PERIOD: + _beamforming_sounding_down(adapter, *pbuf); + break; + + case BEAMFORMING_CTRL_SET_GID_TABLE: + rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_SET_GID_TABLE, *(void**)pbuf); + break; + + case BEAMFORMING_CTRL_SET_CSI_REPORT: + rtw_hal_set_hwreg(adapter, HW_VAR_SOUNDING_CSI_REPORT, pbuf); + break; + + default: + break; + } +} + +u8 rtw_bf_cmd(PADAPTER adapter, s32 type, u8 *pbuf, s32 size, u8 enqueue) +{ + struct cmd_obj *ph2c; + struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + u8 *wk_buf; + u8 res = _SUCCESS; + + + if (!enqueue) { + rtw_bf_cmd_hdl(adapter, type, pbuf); + goto exit; + } + + ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (ph2c == NULL) { + res = _FAIL; + goto exit; + } + + pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (pdrvextra_cmd_parm == NULL) { + rtw_mfree((unsigned char *)ph2c, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + + if (pbuf != NULL) { + wk_buf = rtw_zmalloc(size); + if (wk_buf == NULL) { + rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); + rtw_mfree((u8 *)pdrvextra_cmd_parm, sizeof(struct drvextra_cmd_parm)); + res = _FAIL; + goto exit; + } + + _rtw_memcpy(wk_buf, pbuf, size); + } else { + wk_buf = NULL; + size = 0; + } + + pdrvextra_cmd_parm->ec_id = BEAMFORMING_WK_CID; + pdrvextra_cmd_parm->type = type; + pdrvextra_cmd_parm->size = size; + pdrvextra_cmd_parm->pbuf = wk_buf; + + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, ph2c); + +exit: + return res; +} + +void rtw_bf_update_attrib(PADAPTER adapter, struct pkt_attrib *attrib, struct sta_info *sta) +{ + if (sta) { + attrib->txbf_g_id = sta->cmn.bf_info.g_id; + attrib->txbf_p_aid = sta->cmn.bf_info.p_aid; + } +} + +void rtw_bf_c2h_handler(PADAPTER adapter, u8 id, u8 *buf, u8 buf_len) +{ + switch (id) { + case CMD_ID_C2H_SND_TXBF: + _c2h_snd_txbf(adapter, buf, buf_len); + break; + } +} + +#define toMbps(bytes, secs) (rtw_division64(bytes >> 17, secs)) +void rtw_bf_update_traffic(PADAPTER adapter) +{ + struct beamforming_info *info; + struct sounding_info *sounding; + struct beamformee_entry *bfee; + struct sta_info *sta; + u8 bfee_cnt, sounding_idx, i; + u16 tp[MAX_BEAMFORMEE_ENTRY_NUM] = {0}; + u8 tx_rate[MAX_BEAMFORMEE_ENTRY_NUM] = {0}; + u64 tx_bytes, last_bytes; + u32 time; + systime last_timestamp; + u8 set_timer = _FALSE; + + + info = GET_BEAMFORM_INFO(adapter); + sounding = &info->sounding_info; + + /* Check any bfee exist? */ + bfee_cnt = info->beamformee_su_cnt + info->beamformee_mu_cnt; + if (bfee_cnt == 0) + return; + + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (_FALSE == bfee->used) + continue; + + sta = rtw_get_stainfo(&adapter->stapriv, bfee->mac_addr); + if (!sta) { + RTW_ERR("%s: Cann't find sta_info for " MAC_FMT "!\n", __FUNCTION__, MAC_ARG(bfee->mac_addr)); + continue; + } + + last_timestamp = bfee->tx_timestamp; + last_bytes = bfee->tx_bytes; + bfee->tx_timestamp = rtw_get_current_time(); + bfee->tx_bytes = sta->sta_stats.tx_bytes; + if (last_timestamp) { + if (bfee->tx_bytes >= last_bytes) + tx_bytes = bfee->tx_bytes - last_bytes; + else + tx_bytes = bfee->tx_bytes + (~last_bytes); + time = rtw_get_time_interval_ms(last_timestamp, bfee->tx_timestamp); + time = (time > 1000) ? time/1000 : 1; + tp[i] = toMbps(tx_bytes, time); + tx_rate[i] = rtw_get_current_tx_rate(adapter, sta); + RTW_INFO("%s: BFee idx(%d), MadId(%d), TxTP=%lld bytes (%d Mbps), txrate=%d\n", + __FUNCTION__, i, bfee->mac_id, tx_bytes, tp[i], tx_rate[i]); + } + } + + sounding_idx = phydm_get_beamforming_sounding_info(GET_PDM_ODM(adapter), tp, MAX_BEAMFORMEE_ENTRY_NUM, tx_rate); + + for (i = 0; i < MAX_BEAMFORMEE_ENTRY_NUM; i++) { + bfee = &info->bfee_entry[i]; + if (_FALSE == bfee->used) { + if (sounding_idx & BIT(i)) + RTW_WARN("%s: bfee(%d) not in used but need sounding?!\n", __FUNCTION__, i); + continue; + } + + if (sounding_idx & BIT(i)) { + if (_FALSE == bfee->bApplySounding) { + bfee->bApplySounding = _TRUE; + bfee->SoundCnt = 0; + set_timer = _TRUE; + } + } else { + if (_TRUE == bfee->bApplySounding) { + bfee->bApplySounding = _FALSE; + bfee->bDeleteSounding = _TRUE; + bfee->SoundCnt = 0; + set_timer = _TRUE; + } + } + } + + if (_TRUE == set_timer) { + if (SOUNDING_STATE_NONE == info->sounding_info.state) { + info->sounding_info.state = SOUNDING_STATE_INIT; + _set_timer(&info->sounding_timer, 0); + } + } +} + #else /* !RTW_BEAMFORMING_VERSION_2 */ +#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ struct beamforming_entry *beamforming_get_entry_by_addr(struct mlme_priv *pmlmepriv, u8 *ra, u8 *idx) { u8 i = 0; @@ -733,7 +2055,7 @@ struct beamforming_entry *beamforming_get_free_entry(struct mlme_priv *pmlmepriv struct beamforming_entry *beamforming_add_entry(PADAPTER adapter, u8 *ra, u16 aid, - u16 mac_id, CHANNEL_WIDTH bw, BEAMFORMING_CAP beamfrom_cap, u8 *idx) + u16 mac_id, enum channel_width bw, BEAMFORMING_CAP beamfrom_cap, u8 *idx) { struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); struct beamforming_entry *pEntry = beamforming_get_free_entry(pmlmepriv, idx); @@ -795,8 +2117,10 @@ void beamforming_dym_ndpa_rate(PADAPTER adapter) { u16 NDPARate = MGN_6M; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); + s8 min_rssi = 0; - if (pHalData->MinUndecoratedPWDBForDM > 30) /* link RSSI > 30% */ + min_rssi = rtw_phydm_get_min_rssi(adapter); + if (min_rssi > 30) /* link RSSI > 30% */ NDPARate = MGN_24M; else NDPARate = MGN_6M; @@ -849,7 +2173,7 @@ void beamforming_dym_period(PADAPTER Adapter) rtw_hal_set_hwreg(Adapter, HW_VAR_SOUNDING_FW_NDPA, (u8 *)&Idx); } -BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) +BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, enum channel_width bw, u8 qidx) { struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; @@ -891,8 +2215,8 @@ BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 q fctrl = &pwlanhdr->frame_ctl; *(fctrl) = 0; - SetOrderBit(pframe); - SetFrameSubType(pframe, WIFI_ACTION_NOACK); + set_order_bit(pframe); + set_frame_sub_type(pframe, WIFI_ACTION_NOACK); _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); @@ -910,7 +2234,7 @@ BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 q else duration += 180; - SetDuration(pframe, duration); + set_duration(pframe, duration); /*HT control field*/ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); @@ -928,7 +2252,7 @@ BOOLEAN issue_ht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 q } -BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) +BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, enum channel_width bw, u8 qidx) { struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; @@ -967,8 +2291,8 @@ BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx fctrl = &pwlanhdr->frame_ctl; *(fctrl) = 0; - SetOrderBit(pframe); - SetFrameSubType(pframe, WIFI_ACTION_NOACK); + set_order_bit(pframe); + set_frame_sub_type(pframe, WIFI_ACTION_NOACK); _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); @@ -986,7 +2310,7 @@ BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx else duration += 180; - SetDuration(pframe, duration); + set_duration(pframe, duration); /* HT control field */ SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); @@ -1003,11 +2327,11 @@ BOOLEAN issue_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx return _TRUE; } -BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx) +BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, enum channel_width bw, u8 qidx) { return issue_ht_ndpa_packet(Adapter, ra, bw, qidx); } -BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) +BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, enum channel_width bw, u8 qidx) { struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; @@ -1054,12 +2378,12 @@ BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDT fctrl = &pwlanhdr->frame_ctl; *(fctrl) = 0; - SetFrameSubType(pframe, WIFI_NDPA); + set_frame_sub_type(pframe, WIFI_NDPA); _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); - if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) + if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) aSifsTime = 16; else aSifsTime = 10; @@ -1073,7 +2397,7 @@ BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDT else duration += 180; - SetDuration(pframe, duration); + set_duration(pframe, duration); sequence = pBeamInfo->sounding_sequence << 2; if (pBeamInfo->sounding_sequence >= 0x3f) @@ -1101,7 +2425,7 @@ BOOLEAN issue_vht_sw_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDT return _TRUE; } -BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) +BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, enum channel_width bw, u8 qidx) { struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; @@ -1140,12 +2464,12 @@ BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH b fctrl = &pwlanhdr->frame_ctl; *(fctrl) = 0; - SetFrameSubType(pframe, WIFI_NDPA); + set_frame_sub_type(pframe, WIFI_NDPA); _rtw_memcpy(pwlanhdr->addr1, ra, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(Adapter), ETH_ALEN); - if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) + if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) aSifsTime = 16; else aSifsTime = 10; @@ -1159,7 +2483,7 @@ BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH b else duration += 180; - SetDuration(pframe, duration); + set_duration(pframe, duration); sequence = pBeamInfo->sounding_sequence << 2; if (pBeamInfo->sounding_sequence >= 0x3f) @@ -1187,7 +2511,7 @@ BOOLEAN issue_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH b return _TRUE; } -BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx) +BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, enum channel_width bw, u8 qidx) { return issue_vht_ndpa_packet(Adapter, ra, aid, bw, qidx); } @@ -1245,9 +2569,9 @@ u16 beamforming_sounding_time(struct beamforming_info *pBeamInfo, SOUNDING_MODE return sounding_time; } -CHANNEL_WIDTH beamforming_sounding_bw(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) +enum channel_width beamforming_sounding_bw(struct beamforming_info *pBeamInfo, SOUNDING_MODE mode, u8 idx) { - CHANNEL_WIDTH sounding_bw = CHANNEL_WIDTH_20; + enum channel_width sounding_bw = CHANNEL_WIDTH_20; struct beamforming_entry BeamEntry = pBeamInfo->beamforming_entry[idx]; sounding_bw = BeamEntry.sound_bw; @@ -1384,7 +2708,7 @@ BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8 *idx) u8 *ra; u16 aid, mac_id; u8 wireless_mode; - CHANNEL_WIDTH bw = CHANNEL_WIDTH_20; + enum channel_width bw = CHANNEL_WIDTH_20; BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; /* The current setting does not support Beaforming */ @@ -1397,13 +2721,13 @@ BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8 *idx) return _FALSE; } - aid = psta->aid; - ra = psta->hwaddr; - mac_id = psta->mac_id; + aid = psta->cmn.aid; + ra = psta->cmn.mac_addr; + mac_id = psta->cmn.mac_id; wireless_mode = psta->wireless_mode; - bw = psta->bw_mode; + bw = psta->cmn.bw_mode; - if (IsSupportedHT(wireless_mode) || IsSupportedVHT(wireless_mode)) { + if (is_supported_ht(wireless_mode) || is_supported_vht(wireless_mode)) { /* 3 */ /* HT */ u8 cur_beamform; @@ -1417,7 +2741,7 @@ BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8 *idx) if (TEST_FLAG(cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) beamform_cap = (BEAMFORMING_CAP)(beamform_cap | BEAMFORMER_CAP_HT_EXPLICIT); #ifdef CONFIG_80211AC_VHT - if (IsSupportedVHT(wireless_mode)) { + if (is_supported_vht(wireless_mode)) { /* 3 */ /* VHT */ cur_beamform = psta->vhtpriv.beamform_cap; @@ -1453,8 +2777,8 @@ BOOLEAN beamforming_init_entry(PADAPTER adapter, struct sta_info *psta, u8 *idx) } pBeamformEntry->beamforming_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; - psta->txbf_paid = pBeamformEntry->p_aid; - psta->txbf_gid = pBeamformEntry->g_id; + psta->cmn.bf_info.p_aid = pBeamformEntry->p_aid; + psta->cmn.bf_info.g_id = pBeamformEntry->g_id; RTW_INFO("%s Idx %d\n", __FUNCTION__, *idx); } else @@ -1586,73 +2910,18 @@ void beamforming_watchdog(PADAPTER Adapter) beamforming_dym_period(Adapter); beamforming_dym_ndpa_rate(Adapter); } -#endif /* !RTW_BEAMFORMING_VERSION_2 */ #endif/* #if (BEAMFORMING_SUPPORT ==0) - for diver defined beamforming*/ -u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame) +u32 rtw_beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame) { u32 ret = _SUCCESS; #if (BEAMFORMING_SUPPORT == 1) PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - ret = Beamforming_GetReportFrame(pDM_Odm, precv_frame); + ret = beamforming_get_report_frame(pDM_Odm, precv_frame); #else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -#ifdef RTW_BEAMFORMING_VERSION_2 - struct beamformee_entry *pBeamformEntry = NULL; - struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; - u8 *pframe = precv_frame->u.hdr.rx_data; - u32 frame_len = precv_frame->u.hdr.len; - u8 *ta; - u8 *frame_body; - u8 category, action; - u8 *pMIMOCtrlField, *pCSIMatrix; - u8 Nc = 0, Nr = 0, CH_W = 0; - u16 CSIMatrixLen = 0; - - - RTW_DBG("+%s\n", __FUNCTION__); - - /* Memory comparison to see if CSI report is the same with previous one */ - ta = GetAddr2Ptr(pframe); - pBeamformEntry = beamforming_get_bfee_entry_by_addr(Adapter, ta); - if (!pBeamformEntry) - return _FAIL; - - frame_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); - category = frame_body[0]; - action = frame_body[1]; - - if ((category == RTW_WLAN_CATEGORY_VHT) - && (action == RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING)) { - pMIMOCtrlField = pframe + 26; - Nc = ((*pMIMOCtrlField) & 0x7) + 1; - Nr = (((*pMIMOCtrlField) & 0x38) >> 3) + 1; - CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); - /* - * 24+(1+1+3)+2 - * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) - */ - pCSIMatrix = pMIMOCtrlField + 3 + Nc; - CSIMatrixLen = frame_len - 26 - 3 - Nc; - } else if ((category == RTW_WLAN_CATEGORY_HT) - && (action == RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING)) { - pMIMOCtrlField = pframe + 26; - Nc = ((*pMIMOCtrlField) & 0x3) + 1; - Nr = (((*pMIMOCtrlField) & 0xC) >> 2) + 1; - CH_W = ((*pMIMOCtrlField) & 0x10) >> 4; - /* - * 24+(1+1+6)+2 - * ==> MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2) - */ - pCSIMatrix = pMIMOCtrlField + 6 + Nr; - CSIMatrixLen = frame_len - 26 - 6 - Nr; - } - - RTW_INFO("%s: pkt type=%d-%d, Nc=%d, Nr=%d, CH_W=%d\n", - __FUNCTION__, category, action, Nc, Nr, CH_W); -#else /* !RTW_BEAMFORMING_VERSION_2 */ struct beamforming_entry *pBeamformEntry = NULL; struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); u8 *pframe = precv_frame->u.hdr.rx_data; @@ -1660,10 +2929,10 @@ u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_fram u8 *ta; u8 idx, offset; - /*RTW_INFO("beamforming_get_report_frame\n");*/ + /*RTW_INFO("rtw_beamforming_get_report_frame\n");*/ /*Memory comparison to see if CSI report is the same with previous one*/ - ta = GetAddr2Ptr(pframe); + ta = get_addr2_ptr(pframe); pBeamformEntry = beamforming_get_entry_by_addr(pmlmepriv, ta, &idx); if (pBeamformEntry->beamforming_entry_cap & BEAMFORMER_CAP_VHT_SU) offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ @@ -1687,37 +2956,33 @@ u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_fram pBeamformEntry->bDefaultCSI = _TRUE; else pBeamformEntry->bDefaultCSI = _FALSE; -#endif /* !RTW_BEAMFORMING_VERSION_2 */ #endif return ret; } -void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame) +void rtw_beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame) { #if (BEAMFORMING_SUPPORT == 1) PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - Beamforming_GetNDPAFrame(pDM_Odm, precv_frame); + beamforming_get_ndpa_frame(pDM_Odm, precv_frame); #else /*(BEAMFORMING_SUPPORT == 0)- for drv beamfoming*/ -#ifdef RTW_BEAMFORMING_VERSION_2 - RTW_DBG("+%s\n", __FUNCTION__); -#else /* !RTW_BEAMFORMING_VERSION_2 */ u8 *ta; u8 idx, Sequence; u8 *pframe = precv_frame->u.hdr.rx_data; struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); struct beamforming_entry *pBeamformEntry = NULL; - /*RTW_INFO("beamforming_get_ndpa_frame\n");*/ + /*RTW_INFO("rtw_beamforming_get_ndpa_frame\n");*/ if (IS_HARDWARE_TYPE_8812(Adapter) == _FALSE) return; - else if (GetFrameSubType(pframe) != WIFI_NDPA) + else if (get_frame_sub_type(pframe) != WIFI_NDPA) return; - ta = GetAddr2Ptr(pframe); + ta = get_addr2_ptr(pframe); /*Remove signaling TA. */ ta[0] = ta[0] & 0xFE; @@ -1764,84 +3029,30 @@ void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame /*Update LogSeq & PreLogSeq*/ pBeamformEntry->PreLogSeq = pBeamformEntry->LogSeq; pBeamformEntry->LogSeq = Sequence; -#endif /* !RTW_BEAMFORMING_VERSION_2 */ + #endif } -/* octets in data header, no WEP */ -#define sMacHdrLng 24 -/* VHT Group ID (GID) Management Frame */ -#define FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY (sMacHdrLng + 2) -#define FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY (sMacHdrLng + 10) -/* VHT GID Management Frame Info */ -#define GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(_pStart) LE_BITS_TO_1BYTE((_pStart), 0, 8) -#define GET_VHT_GID_MGNT_INFO_USER_POSITION(_pStart) LE_BITS_TO_1BYTE((_pStart), 0, 8) -/* - * Description: - * On VHT GID management frame by an MU beamformee. - * - * 2015.05.20. Created by tynli. - */ -u32 beamforming_get_vht_gid_mgnt_frame(PADAPTER adapter, union recv_frame *precv_frame) -{ -#ifdef RTW_BEAMFORMING_VERSION_2 - u8 *ta; - u8 idx; - u8 *pframe; - u8 *pBuffer = NULL; - struct beamformer_entry *bfer = NULL; - RTW_DBG("+%s\n", __FUNCTION__); - - pframe = precv_frame->u.hdr.rx_data; - /* Get BFer entry by Addr2 */ - ta = GetAddr2Ptr(pframe); - /* Remove signaling TA */ - ta[0] &= 0xFE; - - bfer = beamforming_get_bfer_entry_by_addr(adapter, ta); - if (!bfer) { - RTW_INFO("%s: Cannot find BFer entry!!\n", __FUNCTION__); - return _FAIL; - } - - /* Parsing Membership Status Array */ - pBuffer = pframe + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; - for (idx = 0; idx < 8; idx++) - bfer->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); - - /* Parsing User Position Array */ - pBuffer = pframe + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; - for (idx = 0; idx < 16; idx++) - bfer->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); - - /* Config HW GID table */ - beamforming_wk_cmd(adapter, BEAMFORMING_CTRL_SET_GID_TABLE, (u8*)&bfer, sizeof(struct beamformer_entry *), 1); - - return _SUCCESS; -#else /* !RTW_BEAMFORMING_VERSION_2 */ - return _FAIL; -#endif /* !RTW_BEAMFORMING_VERSION_2 */ -} void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); #if (BEAMFORMING_SUPPORT == 1) /*(BEAMFORMING_SUPPORT == 1)- for PHYDM beamfoming*/ switch (type) { case BEAMFORMING_CTRL_ENTER: { struct sta_info *psta = (PVOID)pbuf; - u16 staIdx = psta->mac_id; + u16 staIdx = psta->cmn.mac_id; - Beamforming_Enter(pDM_Odm, staIdx); + beamforming_enter(pDM_Odm, staIdx); break; } case BEAMFORMING_CTRL_LEAVE: - Beamforming_Leave(pDM_Odm, pbuf); + beamforming_leave(pDM_Odm, pbuf); break; default: break; @@ -1865,10 +3076,6 @@ void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf) rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_CLK, NULL); break; - case BEAMFORMING_CTRL_SET_GID_TABLE: - rtw_hal_set_hwreg(padapter, HW_VAR_SOUNDING_SET_GID_TABLE, *(void**)pbuf); - break; - default: break; } @@ -1880,8 +3087,14 @@ u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enque struct cmd_obj *ph2c; struct drvextra_cmd_parm *pdrvextra_cmd_parm; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); u8 res = _SUCCESS; + /*20170214 ad_hoc mode and mp_mode not support BF*/ + if ((padapter->registrypriv.mp_mode == 1) + || (pmlmeinfo->state == WIFI_FW_ADHOC_STATE)) + return res; if (enqueue) { u8 *wk_buf; @@ -1934,9 +3147,10 @@ u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enque void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) { if (psta) { - pattrib->txbf_g_id = psta->txbf_gid; - pattrib->txbf_p_aid = psta->txbf_paid; + pattrib->txbf_g_id = psta->cmn.bf_info.g_id; + pattrib->txbf_p_aid = psta->cmn.bf_info.p_aid; } } +#endif /* !RTW_BEAMFORMING_VERSION_2 */ -#endif +#endif /* CONFIG_BEAMFORMING */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_br_ext.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_br_ext.c index b330edf9e81a..6509df3dd875 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_br_ext.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_br_ext.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_BR_EXT_C_ #ifdef __KERNEL__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_bt_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_bt_mp.c index ee6f328015b4..9b4fc2432506 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_bt_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_bt_mp.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 @@ -36,7 +31,7 @@ void MPh2c_timeout_handle(void *FunctionContext) RTW_INFO("[MPT], MPh2c_timeout_handle\n"); pAdapter = (PADAPTER)FunctionContext; - pMptCtx = &pAdapter->mppriv.MptCtx; + pMptCtx = &pAdapter->mppriv.mpt_ctx; pMptCtx->bMPh2c_timeout = _TRUE; @@ -48,7 +43,7 @@ void MPh2c_timeout_handle(void *FunctionContext) u32 WaitC2Hevent(PADAPTER pAdapter, u8 *C2H_event, u32 delay_time) { - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); pMptCtx->bMPh2c_timeout = _FALSE; if (pAdapter->registrypriv.mp_mode == 0) { @@ -107,7 +102,7 @@ mptbt_SendH2c( { /* KIRQL OldIrql = KeGetCurrentIrql(); */ BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS; - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); u1Byte i; RTW_INFO("[MPT], mptbt_SendH2c()=========>\n"); @@ -205,7 +200,7 @@ mptbt_BtFwOpCodeProcess( { u1Byte H2C_Parameter[6] = {0}; PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; u2Byte paraLen = 0, i; BT_CTRL_STATUS h2cStatus = BT_STATUS_H2C_SUCCESS, c2hStatus = BT_STATUS_C2H_SUCCESS; @@ -266,7 +261,7 @@ mptbt_BtReady( u1Byte retStatus = BT_STATUS_BT_OP_SUCCESS; u1Byte btOpcode; u1Byte btOpcodeVer = 0; - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; u1Byte i; u1Byte btFwVer = 0, bdAddr[6] = {0}; @@ -353,16 +348,16 @@ mptbt_BtReady( void mptbt_close_WiFiRF(PADAPTER Adapter) { - PHY_SetBBReg(Adapter, 0x824, 0xF, 0x0); - PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x0); - PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x0); + phy_set_bb_reg(Adapter, 0x824, 0xF, 0x0); + phy_set_bb_reg(Adapter, 0x824, 0x700000, 0x0); + phy_set_rf_reg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x0); } void mptbt_open_WiFiRF(PADAPTER Adapter) { - PHY_SetBBReg(Adapter, 0x824, 0x700000, 0x3); - PHY_SetBBReg(Adapter, 0x824, 0xF, 0x2); - PHY_SetRFReg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); + phy_set_bb_reg(Adapter, 0x824, 0x700000, 0x3); + phy_set_bb_reg(Adapter, 0x824, 0xF, 0x2); + phy_set_rf_reg(Adapter, RF_PATH_A, 0x0, 0xF0000, 0x3); } u4Byte mptbt_switch_RF(PADAPTER Adapter, u1Byte Enter) @@ -468,10 +463,10 @@ MPTBT_FwC2hBtMpCtrl( ) { u32 i; - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)tmpBuf; - if (Adapter->bBTFWReady == _FALSE || Adapter->registrypriv.mp_mode == 0) { + if (GET_HAL_DATA(Adapter)->bBTFWReady == _FALSE || Adapter->registrypriv.mp_mode == 0) { /* RTW_INFO("Ignore C2H BT MP Info since not in MP mode\n"); */ return; } @@ -537,7 +532,7 @@ mptbt_BtGetGeneral( IN PBT_RSP_CMD pBtRsp ) { - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_EXT_C2H pExtC2h = (PBT_EXT_C2H)&pMptCtx->c2hBuf[0]; u1Byte h2cParaBuf[6] = {0}; u1Byte h2cParaLen = 0; @@ -1512,7 +1507,7 @@ mptbt_BtControlProcess( { u1Byte H2C_Parameter[6] = {0}; PBT_H2C pH2c = (PBT_H2C)&H2C_Parameter[0]; - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); PBT_REQ_CMD pBtReq = (PBT_REQ_CMD)pInBuf; PBT_RSP_CMD pBtRsp; u1Byte i; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex.c index 4338f3bc687c..d1d8355a94af 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,18 +11,11 @@ * 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 - * - * - ******************************************************************************/ -#ifdef CONFIG_BT_COEXIST - + *****************************************************************************/ #include -#include #include - +#ifdef CONFIG_BT_COEXIST +#include void rtw_btcoex_Initialize(PADAPTER padapter) { @@ -34,6 +27,16 @@ void rtw_btcoex_PowerOnSetting(PADAPTER padapter) hal_btcoex_PowerOnSetting(padapter); } +void rtw_btcoex_AntInfoSetting(PADAPTER padapter) +{ + hal_btcoex_AntInfoSetting(padapter); +} + +void rtw_btcoex_PowerOffSetting(PADAPTER padapter) +{ + hal_btcoex_PowerOffSetting(padapter); +} + void rtw_btcoex_PreLoadFirmware(PADAPTER padapter) { hal_btcoex_PreLoadFirmware(padapter); @@ -240,6 +243,16 @@ void rtw_btcoex_switchband_notify(u8 under_scan, u8 band_type) hal_btcoex_switchband_notify(under_scan, band_type); } +void rtw_btcoex_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length) +{ + hal_btcoex_WlFwDbgInfoNotify(padapter, tmpBuf, length); +} + +void rtw_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id) +{ + hal_btcoex_rx_rate_change_notify(padapter, is_data_frame, rate_id); +} + void rtw_btcoex_SwitchBtTRxMask(PADAPTER padapter) { hal_btcoex_SwitchBtTRxMask(padapter); @@ -377,11 +390,23 @@ void rtw_btcoex_StackUpdateProfileInfo(void) hal_btcoex_StackUpdateProfileInfo(); } -void rtw_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON) +void rtw_btcoex_pta_off_on_notify(PADAPTER padapter, u8 bBTON) { - hal_btcoex_BTOffOnNotify(padapter, bBTON); + hal_btcoex_pta_off_on_notify(padapter, bBTON); } +#ifdef CONFIG_RF4CE_COEXIST +void rtw_btcoex_SetRf4ceLinkState(PADAPTER padapter, u8 state) +{ + hal_btcoex_set_rf4ce_link_state(state); +} + +u8 rtw_btcoex_GetRf4ceLinkState(PADAPTER padapter) +{ + return hal_btcoex_get_rf4ce_link_state(); +} +#endif + /* ================================================== * Below Functions are called by BT-Coex * ================================================== */ @@ -403,7 +428,7 @@ void rtw_btcoex_LPS_Enter(PADAPTER padapter) rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, lpsVal, "BTCOEX"); } -void rtw_btcoex_LPS_Leave(PADAPTER padapter) +u8 rtw_btcoex_LPS_Leave(PADAPTER padapter) { struct pwrctrl_priv *pwrpriv; @@ -415,6 +440,8 @@ void rtw_btcoex_LPS_Leave(PADAPTER padapter) LPS_RF_ON_check(padapter, 100); pwrpriv->bpower_saving = _FALSE; } + + return _TRUE; } u16 rtw_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data) @@ -459,7 +486,7 @@ u8 rtw_btcoex_get_pg_rfe_type(PADAPTER padapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - return pHalData->RFEType; + return pHalData->rfe_type; } u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter) @@ -468,7 +495,7 @@ u8 rtw_btcoex_is_tfbga_package_type(PADAPTER padapter) #ifdef CONFIG_RTL8723B if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA80) - || (pHalData->PackageType == PACKAGE_TFBGA90)) + || (pHalData->PackageType == PACKAGE_TFBGA90)) return _TRUE; #endif @@ -480,7 +507,7 @@ u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter) PHAL_DATA_TYPE pHalData; pHalData = GET_HAL_DATA(padapter); - + return (pHalData->AntDivCfg == 0) ? _FALSE : _TRUE; } @@ -1339,14 +1366,14 @@ void rtw_btcoex_recvmsgbysocket(void *data) /* attend ack */ pcoex_info->BT_attend = _TRUE; RTW_INFO("RX_ATTEND_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); - rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); + rtw_btcoex_pta_off_on_notify(pbtcoexadapter, pcoex_info->BT_attend); break; case RX_ATTEND_REQ: pcoex_info->BT_attend = _TRUE; RTW_INFO("RX_BT_ATTEND_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); rtw_btcoex_sendmsgbysocket(pbtcoexadapter, attend_ack, sizeof(attend_ack), _FALSE); - rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); + rtw_btcoex_pta_off_on_notify(pbtcoexadapter, pcoex_info->BT_attend); break; case RX_INVITE_REQ: @@ -1354,21 +1381,21 @@ void rtw_btcoex_recvmsgbysocket(void *data) pcoex_info->BT_attend = _TRUE; RTW_INFO("RX_INVITE_REQ!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); rtw_btcoex_sendmsgbysocket(pbtcoexadapter, invite_rsp, sizeof(invite_rsp), _FALSE); - rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); + rtw_btcoex_pta_off_on_notify(pbtcoexadapter, pcoex_info->BT_attend); break; case RX_INVITE_RSP: /*invite rsp*/ pcoex_info->BT_attend = _TRUE; RTW_INFO("RX_INVITE_RSP!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); - rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); + rtw_btcoex_pta_off_on_notify(pbtcoexadapter, pcoex_info->BT_attend); break; case RX_LEAVE_ACK: /* mean BT know wifi will leave */ pcoex_info->BT_attend = _FALSE; RTW_INFO("RX_LEAVE_ACK!,sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); - rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); + rtw_btcoex_pta_off_on_notify(pbtcoexadapter, pcoex_info->BT_attend); break; case RX_BT_LEAVE: @@ -1376,7 +1403,7 @@ void rtw_btcoex_recvmsgbysocket(void *data) rtw_btcoex_sendmsgbysocket(pbtcoexadapter, leave_ack, sizeof(leave_ack), _FALSE); /* no ack */ pcoex_info->BT_attend = _FALSE; RTW_INFO("RX_BT_LEAVE!sock_open:%d, BT_attend:%d\n", pcoex_info->sock_open, pcoex_info->BT_attend); - rtw_btcoex_BTOffOnNotify(pbtcoexadapter, pcoex_info->BT_attend); + rtw_btcoex_pta_off_on_notify(pbtcoexadapter, pcoex_info->BT_attend); break; default: @@ -1545,7 +1572,7 @@ void rtw_btcoex_init_socket(_adapter *padapter) pbtcoexadapter = padapter; /* We expect BT is off if BT don't send ack to wifi */ RTW_INFO("We expect BT is off if BT send ack to wifi\n"); - rtw_btcoex_BTOffOnNotify(pbtcoexadapter, _FALSE); + rtw_btcoex_pta_off_on_notify(pbtcoexadapter, _FALSE); if (rtw_btcoex_create_kernel_socket(padapter) == _SUCCESS) pcoex_info->is_exist = _TRUE; else { @@ -1715,3 +1742,22 @@ void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType) } #endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ #endif /* CONFIG_BT_COEXIST */ + +void rtw_btcoex_set_ant_info(PADAPTER padapter) +{ +#ifdef CONFIG_BT_COEXIST + PHAL_DATA_TYPE hal = GET_HAL_DATA(padapter); + + if (hal->EEPROMBluetoothCoexist == _TRUE) { + u8 bMacPwrCtrlOn = _FALSE; + + rtw_btcoex_AntInfoSetting(padapter); + rtw_hal_get_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); + if (bMacPwrCtrlOn == _TRUE) + rtw_btcoex_PowerOnSetting(padapter); + } + else +#endif + rtw_btcoex_wifionly_AntInfoSetting(padapter); +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex_wifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex_wifionly.c new file mode 100644 index 000000000000..e26b3a0499b5 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_btcoex_wifionly.c @@ -0,0 +1,42 @@ +/****************************************************************************** + * + * Copyright(c) 2013 - 2017 Realtek Corporation. + * + * 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 +#include +#include + +void rtw_btcoex_wifionly_switchband_notify(PADAPTER padapter) +{ + hal_btcoex_wifionly_switchband_notify(padapter); +} + +void rtw_btcoex_wifionly_scan_notify(PADAPTER padapter) +{ + hal_btcoex_wifionly_scan_notify(padapter); +} + +void rtw_btcoex_wifionly_hw_config(PADAPTER padapter) +{ + hal_btcoex_wifionly_hw_config(padapter); +} + +void rtw_btcoex_wifionly_initialize(PADAPTER padapter) +{ + hal_btcoex_wifionly_initlizevariables(padapter); +} + +void rtw_btcoex_wifionly_AntInfoSetting(PADAPTER padapter) +{ + hal_btcoex_wifionly_AntInfoSetting(padapter); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_cmd.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_cmd.c index 2077b91ce05b..d223e749cdd9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_cmd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_cmd.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_CMD_C_ #include @@ -38,8 +33,7 @@ sint _rtw_init_cmd_priv(struct cmd_priv *pcmdpriv) _rtw_init_sema(&(pcmdpriv->cmd_queue_sema), 0); /* _rtw_init_sema(&(pcmdpriv->cmd_done_sema), 0); */ - _rtw_init_sema(&(pcmdpriv->terminate_cmdthread_sema), 0); - + _rtw_init_sema(&(pcmdpriv->start_cmdthread_sema), 0); _rtw_init_queue(&(pcmdpriv->cmd_queue)); @@ -151,7 +145,6 @@ sint _rtw_init_evt_priv(struct evt_priv *pevtpriv) #ifdef CONFIG_EVENT_THREAD_MODE _rtw_init_sema(&(pevtpriv->evt_notify), 0); - _rtw_init_sema(&(pevtpriv->terminate_evtthread_sema), 0); pevtpriv->evt_allocated_buf = rtw_zmalloc(MAX_EVTSZ + 4); if (pevtpriv->evt_allocated_buf == NULL) { @@ -204,8 +197,6 @@ void _rtw_free_evt_priv(struct evt_priv *pevtpriv) #ifdef CONFIG_EVENT_THREAD_MODE _rtw_free_sema(&(pevtpriv->evt_notify)); - _rtw_free_sema(&(pevtpriv->terminate_evtthread_sema)); - if (pevtpriv->evt_allocated_buf) rtw_mfree(pevtpriv->evt_allocated_buf, MAX_EVTSZ + 4); @@ -236,7 +227,7 @@ void _rtw_free_cmd_priv(struct cmd_priv *pcmdpriv) _rtw_spinlock_free(&(pcmdpriv->cmd_queue.lock)); _rtw_free_sema(&(pcmdpriv->cmd_queue_sema)); /* _rtw_free_sema(&(pcmdpriv->cmd_done_sema)); */ - _rtw_free_sema(&(pcmdpriv->terminate_cmdthread_sema)); + _rtw_free_sema(&(pcmdpriv->start_cmdthread_sema)); if (pcmdpriv->cmd_allocated_buf) rtw_mfree(pcmdpriv->cmd_allocated_buf, MAX_CMDSZ + CMDBUFF_ALIGN_SZ); @@ -532,12 +523,10 @@ void rtw_free_cmd_obj(struct cmd_obj *pcmd) void rtw_stop_cmd_thread(_adapter *adapter) { - if (adapter->cmdThread && - ATOMIC_READ(&(adapter->cmdpriv.cmdthd_running)) == _TRUE && - adapter->cmdpriv.stop_req == 0) { - adapter->cmdpriv.stop_req = 1; + if (adapter->cmdThread) { _rtw_up_sema(&adapter->cmdpriv.cmd_queue_sema); - _rtw_down_sema(&adapter->cmdpriv.terminate_cmdthread_sema); + rtw_thread_stop(adapter->cmdThread); + adapter->cmdThread = NULL; } } @@ -546,7 +535,7 @@ thread_return rtw_cmd_thread(thread_context context) u8 ret; struct cmd_obj *pcmd; u8 *pcmdbuf, *prspbuf; - u32 cmd_start_time; + systime cmd_start_time; u32 cmd_process_time; u8(*cmd_hdl)(_adapter *padapter, u8 *pbuf); void (*pcmd_callback)(_adapter *dev, struct cmd_obj *pcmd); @@ -559,10 +548,8 @@ thread_return rtw_cmd_thread(thread_context context) pcmdbuf = pcmdpriv->cmd_buf; prspbuf = pcmdpriv->rsp_buf; - - pcmdpriv->stop_req = 0; ATOMIC_SET(&(pcmdpriv->cmdthd_running), _TRUE); - _rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema); + _rtw_up_sema(&pcmdpriv->start_cmdthread_sema); while (1) { @@ -572,16 +559,10 @@ thread_return rtw_cmd_thread(thread_context context) } if (RTW_CANNOT_RUN(padapter)) { - RTW_PRINT("%s: DriverStopped(%s) SurpriseRemoved(%s) break at line %d\n", - __func__ - , rtw_is_drv_stopped(padapter) ? "True" : "False" - , rtw_is_surprise_removed(padapter) ? "True" : "False" - , __LINE__); - break; - } - - if (pcmdpriv->stop_req) { - RTW_PRINT(FUNC_ADPT_FMT" stop_req:%u, break\n", FUNC_ADPT_ARG(padapter), pcmdpriv->stop_req); + RTW_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", + FUNC_ADPT_ARG(padapter), + rtw_is_drv_stopped(padapter) ? "True" : "False", + rtw_is_surprise_removed(padapter) ? "True" : "False"); break; } @@ -681,8 +662,7 @@ thread_return rtw_cmd_thread(thread_context context) _enter_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); if (pcmd->sctx) { if (0) - RTW_PRINT(FUNC_ADPT_FMT" pcmd->sctx\n", - FUNC_ADPT_ARG(pcmd->padapter)); + RTW_PRINT(FUNC_ADPT_FMT" pcmd->sctx\n", FUNC_ADPT_ARG(pcmd->padapter)); if (pcmd->res == H2C_SUCCESS) rtw_sctx_done(&pcmd->sctx); else @@ -738,14 +718,22 @@ thread_return rtw_cmd_thread(thread_context context) rtw_mfree(extra_parm->pbuf, extra_parm->size); } + _enter_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); + if (pcmd->sctx) { + if (0) + RTW_PRINT(FUNC_ADPT_FMT" pcmd->sctx\n", FUNC_ADPT_ARG(pcmd->padapter)); + rtw_sctx_done_err(&pcmd->sctx, RTW_SCTX_DONE_CMD_DROP); + } + _exit_critical_mutex(&(pcmd->padapter->cmdpriv.sctx_mutex), NULL); + rtw_free_cmd_obj(pcmd); } while (1); - _rtw_up_sema(&pcmdpriv->terminate_cmdthread_sema); + RTW_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(padapter)); + rtw_thread_wait_stop(); - thread_exit(); - + return 0; } @@ -854,13 +842,21 @@ u8 rtw_setstandby_cmd(_adapter *padapter, uint action) return ret; } +void rtw_init_sitesurvey_parm(_adapter *padapter, struct sitesurvey_parm *pparm) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + + + _rtw_memset(pparm, 0, sizeof(struct sitesurvey_parm)); + pparm->scan_mode = pmlmepriv->scan_mode; +} + /* rtw_sitesurvey_cmd(~) ### NOTE:#### (!!!!) MUST TAKE CARE THAT BEFORE CALLING THIS FUNC, YOU SHOULD HAVE LOCKED pmlmepriv->lock */ -u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, - struct rtw_ieee80211_channel *ch, int ch_num) +u8 rtw_sitesurvey_cmd(_adapter *padapter, struct sitesurvey_parm *pparm) { u8 res = _FAIL; struct cmd_obj *ph2c; @@ -871,7 +867,6 @@ u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #endif /* CONFIG_P2P */ - #ifdef CONFIG_LPS if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_SCAN, 1); @@ -892,60 +887,25 @@ u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, return _FAIL; } + if (pparm) + _rtw_memcpy(psurveyPara, pparm, sizeof(struct sitesurvey_parm)); + else + psurveyPara->scan_mode = pmlmepriv->scan_mode; + rtw_free_network_queue(padapter, _FALSE); - init_h2fwcmd_w_parm_no_rsp(ph2c, psurveyPara, GEN_CMD_CODE(_SiteSurvey)); - /* psurveyPara->bsslimit = 48; */ - psurveyPara->scan_mode = pmlmepriv->scan_mode; - - /* prepare ssid list */ - if (ssid) { - int i; - for (i = 0; i < ssid_num && i < RTW_SSID_SCAN_AMOUNT; i++) { - if (ssid[i].SsidLength) { - _rtw_memcpy(&psurveyPara->ssid[i], &ssid[i], sizeof(NDIS_802_11_SSID)); - psurveyPara->ssid_num++; - if (0) - RTW_INFO(FUNC_ADPT_FMT" ssid:(%s, %d)\n", FUNC_ADPT_ARG(padapter), - psurveyPara->ssid[i].Ssid, psurveyPara->ssid[i].SsidLength); - } - } - } - - /* prepare channel list */ - if (ch) { - int i; - for (i = 0; i < ch_num && i < RTW_CHANNEL_SCAN_AMOUNT; i++) { - if (ch[i].hw_value && !(ch[i].flags & RTW_IEEE80211_CHAN_DISABLED)) { - _rtw_memcpy(&psurveyPara->ch[i], &ch[i], sizeof(struct rtw_ieee80211_channel)); - psurveyPara->ch_num++; - if (0) - RTW_INFO(FUNC_ADPT_FMT" ch:%u\n", FUNC_ADPT_ARG(padapter), - psurveyPara->ch[i].hw_value); - } - } - } - set_fwstate(pmlmepriv, _FW_UNDER_SURVEY); res = rtw_enqueue_cmd(pcmdpriv, ph2c); if (res == _SUCCESS) { + u32 scan_timeout_ms; pmlmepriv->scan_start_time = rtw_get_current_time(); - -#ifdef CONFIG_SCAN_BACKOP - if (rtw_mi_buddy_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) { - if (IsSupported5G(padapter->registrypriv.wireless_mode) - && IsSupported24G(padapter->registrypriv.wireless_mode)) /* dual band */ - mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_DUAL_BAND); - else /* single band */ - mlme_set_scan_to_timer(pmlmepriv, CONC_SCANNING_TIMEOUT_SINGLE_BAND); - } else -#endif /* CONFIG_SCAN_BACKOP */ - mlme_set_scan_to_timer(pmlmepriv, SCANNING_TIMEOUT); + scan_timeout_ms = rtw_scan_timeout_decision(padapter); + mlme_set_scan_to_timer(pmlmepriv,scan_timeout_ms); rtw_led_control(padapter, LED_CTL_SITE_SURVEY); } else @@ -1268,7 +1228,7 @@ static u8 rtw_createbss_cmd(_adapter *adapter, int flags, bool adhoc u8 res = _SUCCESS; if (req_ch > 0 && req_bw >= 0 && req_offset >= 0) { - if (!rtw_chset_is_chbw_valid(adapter->mlmeextpriv.channel_set, req_ch, req_bw, req_offset)) { + if (!rtw_chset_is_chbw_valid(adapter_to_chset(adapter), req_ch, req_bw, req_offset)) { res = _FAIL; goto exit; } @@ -1371,6 +1331,7 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) NDIS_802_11_NETWORK_INFRASTRUCTURE ndis_network_mode = pnetwork->network.InfrastructureMode; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); u32 tmp_len; u8 *ptmp = NULL; #ifdef CONFIG_RTW_80211R @@ -1408,12 +1369,9 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) set_fwstate(pmlmepriv, WIFI_STATION_STATE); break; - case Ndis802_11APMode: - case Ndis802_11AutoUnknown: - case Ndis802_11InfrastructureMax: - case Ndis802_11Monitor: + default: + rtw_warn_on(1); break; - } } @@ -1461,6 +1419,9 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) pqospriv->qos_option = 0; if (pregistrypriv->wmm_enable) { +#ifdef CONFIG_WMMPS_STA + rtw_uapsd_use_default_setting(padapter); +#endif /* CONFIG_WMMPS_STA */ tmp_len = rtw_restruct_wmm_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, psecnetwork->IELength); if (psecnetwork->IELength != tmp_len) { @@ -1483,8 +1444,6 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) (padapter->securitypriv.dot11PrivacyAlgrthm != _TKIP_)) { rtw_ht_use_default_setting(padapter); - rtw_build_wmm_ie_ht(padapter, &psecnetwork->IEs[0], &psecnetwork->IELength); - /* rtw_restructure_ht_ie */ rtw_restructure_ht_ie(padapter, &pnetwork->network.IEs[12], &psecnetwork->IEs[0], pnetwork->network.IELength - 12, &psecnetwork->IELength, @@ -1497,7 +1456,7 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) if (phtpriv->ht_option && REGSTY_IS_11AC_ENABLE(pregistrypriv) && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) - && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent)) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) ) { rtw_restructure_vht_ie(padapter, &pnetwork->network.IEs[0], &psecnetwork->IEs[0], pnetwork->network.IELength, &psecnetwork->IELength); @@ -1580,11 +1539,13 @@ u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork) return res; } -u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* for sta_mode */ +u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, int flags) /* for sta_mode */ { struct cmd_obj *cmdobj = NULL; struct disconnect_parm *param = NULL; struct cmd_priv *cmdpriv = &padapter->cmdpriv; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + struct submit_ctx sctx; u8 res = _SUCCESS; @@ -1597,8 +1558,13 @@ u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* } param->deauth_timeout_ms = deauth_timeout_ms; - if (enqueue) { - /* need enqueue, prepare cmd_obj and enqueue */ + if (flags & RTW_CMDF_DIRECTLY) { + /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ + if (disconnect_hdl(padapter, (u8 *)param) != H2C_SUCCESS) + res = _FAIL; + rtw_mfree((u8 *)param, sizeof(*param)); + + } else { cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); if (cmdobj == NULL) { res = _FAIL; @@ -1606,12 +1572,18 @@ u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue) /* goto exit; } init_h2fwcmd_w_parm_no_rsp(cmdobj, param, _DisConnect_CMD_); + if (flags & RTW_CMDF_WAIT_ACK) { + cmdobj->sctx = &sctx; + rtw_sctx_init(&sctx, 2000); + } res = rtw_enqueue_cmd(cmdpriv, cmdobj); - } else { - /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ - if (H2C_SUCCESS != disconnect_hdl(padapter, (u8 *)param)) - res = _FAIL; - rtw_mfree((u8 *)param, sizeof(*param)); + if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { + rtw_sctx_wait(&sctx, __func__); + _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + if (sctx.status == RTW_SCTX_SUBMITTED) + cmdobj->sctx = NULL; + _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + } } exit: @@ -1674,7 +1646,7 @@ u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_type, bool goto exit; } - _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); + _rtw_memcpy(psetstakey_para->addr, sta->cmn.mac_addr, ETH_ALEN); if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) psetstakey_para->algorithm = (unsigned char) psecuritypriv->dot11PrivacyAlgrthm; @@ -1736,10 +1708,14 @@ u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue) s16 cam_id = 0; u8 res = _SUCCESS; + if (!sta) { + RTW_ERR("%s sta == NULL\n", __func__); + goto exit; + } if (!enqueue) { - while ((cam_id = rtw_camid_search(padapter, sta->hwaddr, -1, -1)) >= 0) { - RTW_PRINT("clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(sta->hwaddr), cam_id); + while ((cam_id = rtw_camid_search(padapter, sta->cmn.mac_addr, -1, -1)) >= 0) { + RTW_PRINT("clear key for addr:"MAC_FMT", camid:%d\n", MAC_ARG(sta->cmn.mac_addr), cam_id); clear_cam_entry(padapter, cam_id); rtw_camid_free(padapter, cam_id); } @@ -1769,7 +1745,7 @@ u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue) ph2c->rsp = (u8 *) psetstakey_rsp; ph2c->rspsz = sizeof(struct set_stakey_rsp); - _rtw_memcpy(psetstakey_para->addr, sta->hwaddr, ETH_ALEN); + _rtw_memcpy(psetstakey_para->addr, sta->cmn.mac_addr, ETH_ALEN); psetstakey_para->algorithm = _NO_PRIVACY_; @@ -2088,12 +2064,12 @@ u8 rtw_dynamic_chk_wk_cmd(_adapter *padapter) } -u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue) +u8 rtw_set_chbw_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 flags) { struct cmd_obj *pcmdobj; struct set_ch_parm *set_ch_parm; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; - + struct submit_ctx sctx; u8 res = _SUCCESS; @@ -2112,7 +2088,13 @@ u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue) set_ch_parm->bw = bw; set_ch_parm->ch_offset = ch_offset; - if (enqueue) { + if (flags & RTW_CMDF_DIRECTLY) { + /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ + if (H2C_SUCCESS != rtw_set_chbw_hdl(padapter, (u8 *)set_ch_parm)) + res = _FAIL; + + rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); + } else { /* need enqueue, prepare cmd_obj and enqueue */ pcmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); if (pcmdobj == NULL) { @@ -2122,13 +2104,21 @@ u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue) } init_h2fwcmd_w_parm_no_rsp(pcmdobj, set_ch_parm, GEN_CMD_CODE(_SetChannel)); - res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); - } else { - /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ - if (H2C_SUCCESS != set_ch_hdl(padapter, (u8 *)set_ch_parm)) - res = _FAIL; - rtw_mfree((u8 *)set_ch_parm, sizeof(*set_ch_parm)); + if (flags & RTW_CMDF_WAIT_ACK) { + pcmdobj->sctx = &sctx; + rtw_sctx_init(&sctx, 10 * 1000); + } + + res = rtw_enqueue_cmd(pcmdpriv, pcmdobj); + + if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { + rtw_sctx_wait(&sctx, __func__); + _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + if (sctx.status == RTW_SCTX_SUBMITTED) + pcmdobj->sctx = NULL; + _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + } } /* do something based on res... */ @@ -2239,7 +2229,7 @@ inline u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_ RTW_PRINT("%s country_code:\"%c%c\" mapping to chplan:0x%02x\n", __func__, country_code[0], country_code[1], ent->chplan); - return _rtw_set_chplan_cmd(adapter, flags, RTW_CHPLAN_MAX, ent, swconfig); + return _rtw_set_chplan_cmd(adapter, flags, RTW_CHPLAN_UNSPECIFIED, ent, swconfig); } u8 rtw_led_blink_cmd(_adapter *padapter, PVOID pLed) @@ -2564,7 +2554,9 @@ u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) LPS_Leave(padapter, "TRAFFIC_BUSY"); else { #ifdef CONFIG_CONCURRENT_MODE + #ifndef CONFIG_FW_MULTI_PORT_SUPPORT if (padapter->hw_port == HW_PORT0) + #endif #endif rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_TRAFFIC_BUSY, 1); } @@ -2589,6 +2581,12 @@ u8 traffic_status_watchdog(_adapter *padapter, u8 from_timer) session_tracker_chk_cmd(padapter, NULL); +#ifdef CONFIG_BEAMFORMING +#ifdef RTW_BEAMFORMING_VERSION_2 + rtw_bf_update_traffic(padapter); +#endif /* RTW_BEAMFORMING_VERSION_2 */ +#endif /* CONFIG_BEAMFORMING */ + pmlmepriv->LinkDetectInfo.NumRxOkInPeriod = 0; pmlmepriv->LinkDetectInfo.NumTxOkInPeriod = 0; pmlmepriv->LinkDetectInfo.NumRxUnicastOkInPeriod = 0; @@ -2616,20 +2614,23 @@ static void dynamic_update_bcn_check(_adapter *padapter) if (!MLME_IS_AP(padapter)) return; -#ifdef CONFIG_80211N_HT if (pmlmeext->bstart_bss) { /* In 10 * 2 = 20s, there are no legacy AP, update HT info */ static u8 count = 1; + if (count % 10 == 0) { count = 1; + if (_FALSE == ATOMIC_READ(&pmlmepriv->olbc) && _FALSE == ATOMIC_READ(&pmlmepriv->olbc_ht)) { + if (rtw_ht_operation_update(padapter) > 0) { update_beacon(padapter, _HT_CAPABILITY_IE_, NULL, _FALSE); update_beacon(padapter, _HT_ADD_INFO_IE_, NULL, _TRUE); } } } + /* In 2s, there are any legacy AP, update HT info, and then reset count */ if (_FALSE != ATOMIC_READ(&pmlmepriv->olbc) @@ -2644,9 +2645,9 @@ static void dynamic_update_bcn_check(_adapter *padapter) ATOMIC_SET(&pmlmepriv->olbc_ht, _FALSE); count = 0; } + count ++; } -#endif /* CONFIG_80211N_HT */ } void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter) { @@ -2654,7 +2655,7 @@ void rtw_iface_dynamic_chk_wk_hdl(_adapter *padapter) #ifdef CONFIG_ACTIVE_KEEP_ALIVE_CHECK #ifdef CONFIG_AP_MODE - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) expire_timeout_chk(padapter); #endif #endif /* CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ @@ -2837,7 +2838,7 @@ u8 rtw_lps_ctrl_wk_cmd(_adapter *padapter, u8 lps_ctrl_type, u8 enqueue) void rtw_dm_in_lps_hdl(_adapter *padapter) { - rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS, NULL); + rtw_hal_set_hwreg(padapter, HW_VAR_DM_IN_LPS_LCLK, NULL); } u8 rtw_dm_in_lps_wk_cmd(_adapter *padapter) @@ -3250,6 +3251,79 @@ inline u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev { return _p2p_roch_cmd(adapter, cookie, wdev, NULL, 0, 0, flags); } + +inline u8 rtw_mgnt_tx_cmd(_adapter *adapter, u8 tx_ch, u8 no_cck, const u8 *buf, size_t len, int wait_ack, u8 flags) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *parm; + struct mgnt_tx_parm *mgnt_parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + struct submit_ctx sctx; + u8 res = _SUCCESS; + + mgnt_parm = (struct mgnt_tx_parm *)rtw_zmalloc(sizeof(struct mgnt_tx_parm)); + if (mgnt_parm == NULL) { + res = _FAIL; + goto exit; + } + + mgnt_parm->tx_ch = tx_ch; + mgnt_parm->no_cck = no_cck; + mgnt_parm->buf = buf; + mgnt_parm->len = len; + mgnt_parm->wait_ack = wait_ack; + + if (flags & RTW_CMDF_DIRECTLY) { + /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ + if (H2C_SUCCESS != rtw_mgnt_tx_handler(adapter, (u8 *)mgnt_parm)) + res = _FAIL; + rtw_mfree((u8 *)mgnt_parm, sizeof(*mgnt_parm)); + } else { + /* need enqueue, prepare cmd_obj and enqueue */ + parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (parm == NULL) { + rtw_mfree((u8 *)mgnt_parm, sizeof(*mgnt_parm)); + res = _FAIL; + goto exit; + } + + parm->ec_id = MGNT_TX_WK_CID; + parm->type = 0; + parm->size = sizeof(*mgnt_parm); + parm->pbuf = (u8 *)mgnt_parm; + + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); + if (cmdobj == NULL) { + res = _FAIL; + rtw_mfree((u8 *)mgnt_parm, sizeof(*mgnt_parm)); + rtw_mfree((u8 *)parm, sizeof(*parm)); + goto exit; + } + + init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + if (flags & RTW_CMDF_WAIT_ACK) { + cmdobj->sctx = &sctx; + rtw_sctx_init(&sctx, 10 * 1000); + } + + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + + if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { + rtw_sctx_wait(&sctx, __func__); + _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + if (sctx.status == RTW_SCTX_SUBMITTED) + cmdobj->sctx = NULL; + _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + if (sctx.status != RTW_SCTX_DONE_SUCCESS) + res = _FAIL; + } + } + +exit: + return res; +} + #endif /* CONFIG_IOCTL_CFG80211 */ #endif /* CONFIG_P2P */ @@ -3300,7 +3374,7 @@ static void rtw_chk_hi_queue_hdl(_adapter *padapter) { struct sta_info *psta_bmc; struct sta_priv *pstapriv = &padapter->stapriv; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); u8 empty = _FALSE; psta_bmc = rtw_get_bcmc_stainfo(padapter); @@ -3411,7 +3485,7 @@ u8 rtw_dfs_master_hdl(_adapter *adapter) for (i = 0; i < dvobj->iface_nums; i++) { if (!dvobj->padapters[i]) continue; - if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE) + if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE | WIFI_MESH_STATE) && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_ASOC_STATE)) break; } @@ -3420,7 +3494,7 @@ u8 rtw_dfs_master_hdl(_adapter *adapter) /* what? */ rtw_warn_on(1); } else { - rtw_chset_update_non_ocp(dvobj->padapters[i]->mlmeextpriv.channel_set + rtw_chset_update_non_ocp(rfctl->channel_set , rfctl->radar_detect_ch, rfctl->radar_detect_bw, rfctl->radar_detect_offset); rfctl->radar_detected = 1; @@ -3440,6 +3514,11 @@ u8 rtw_dfs_master_hdl(_adapter *adapter) rtw_hal_set_hwreg(adapter, HW_VAR_TXPAUSE, &pause); rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; + + if (rtw_mi_check_fwstate(adapter, WIFI_UNDER_LINKING|WIFI_SITE_MONITOR) == _FALSE) { + ResumeTxBeacon(adapter); + rtw_mi_tx_beacon_hdl(adapter); + } } set_timer: @@ -3483,9 +3562,9 @@ u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue) return res; } -void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS) +void rtw_dfs_master_timer_hdl(void *ctx) { - _adapter *adapter = (_adapter *)FunctionContext; + _adapter *adapter = (_adapter *)ctx; rtw_dfs_master_cmd(adapter, _TRUE); } @@ -3509,6 +3588,9 @@ void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset) rfctl->radar_detected = 0; + if (IS_CH_WAITING(rfctl)) + StopTxBeacon(adapter); + if (!rfctl->dfs_master_enabled) { RTW_INFO(FUNC_ADPT_FMT" set dfs_master_enabled\n", FUNC_ADPT_ARG(adapter)); rfctl->dfs_master_enabled = 1; @@ -3547,6 +3629,11 @@ void rtw_dfs_master_disable(_adapter *adapter, u8 ch, u8 bw, u8 offset, bool by_ rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; _cancel_timer_ex(&adapter->mlmepriv.dfs_master_timer); + if (rtw_mi_check_fwstate(adapter, WIFI_UNDER_LINKING|WIFI_SITE_MONITOR) == _FALSE) { + ResumeTxBeacon(adapter); + rtw_mi_tx_beacon_hdl(adapter); + } + if (overlap_radar_detect_ch) { u8 pause = 0x00; @@ -3583,12 +3670,27 @@ void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action) case MLME_STA_CONNECTED: MSTATE_STA_LD_NUM(&mstate)++; break; + case MLME_STA_DISCONNECTED: + break; +#ifdef CONFIG_AP_MODE case MLME_AP_STARTED: MSTATE_AP_NUM(&mstate)++; break; case MLME_AP_STOPPED: - case MLME_STA_DISCONNECTED: + break; +#endif +#ifdef CONFIG_RTW_MESH + case MLME_MESH_STARTED: + MSTATE_MESH_NUM(&mstate)++; + break; + case MLME_MESH_STOPPED: + break; +#endif + case MLME_ACTION_NONE: + /* caller without effect of decision */ + break; default: + rtw_warn_on(1); break; } @@ -3609,7 +3711,7 @@ void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action) if (MSTATE_STA_LD_NUM(&mstate) > 0) { /* rely on AP on which STA mode connects */ - if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) + if (rtw_is_dfs_chbw(u_ch, u_bw, u_offset)) ld_sta_in_dfs = _TRUE; goto apply; } @@ -3619,20 +3721,21 @@ void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action) goto apply; } - if (MSTATE_AP_NUM(&mstate) == 0) { - /* No working AP mode */ + if (!MSTATE_AP_NUM(&mstate) && !MSTATE_MESH_NUM(&mstate)) { + /* No working AP/Mesh mode */ goto apply; } - if (rtw_is_dfs_ch(u_ch, u_bw, u_offset)) + if (rtw_is_dfs_chbw(u_ch, u_bw, u_offset)) needed = _TRUE; apply: RTW_INFO(FUNC_ADPT_FMT" needed:%d, self_action:%u\n" , FUNC_ADPT_ARG(adapter), needed, self_action); - RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, %u,%u,%u\n" - , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate), MSTATE_AP_NUM(&mstate) + RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, lg_sta_num:%u, ap_num:%u, mesh_num:%u, %u,%u,%u\n" + , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_STA_LG_NUM(&mstate) + , MSTATE_AP_NUM(&mstate), MSTATE_MESH_NUM(&mstate) , u_ch, u_bw, u_offset); if (needed == _TRUE) @@ -3841,6 +3944,160 @@ u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len) return res; } +#ifdef CONFIG_MP_INCLUDED +static s32 rtw_mp_cmd_hdl(_adapter *padapter, u8 mp_cmd_id) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + int ret = H2C_SUCCESS; + uint status = _SUCCESS; + u8 rfreg0; + + if (mp_cmd_id == MP_START) { + if (padapter->registrypriv.mp_mode == 0) { + rtw_intf_stop(padapter); + rtw_hal_deinit(padapter); + padapter->registrypriv.mp_mode = 1; +#ifdef CONFIG_RF_POWER_TRIM + if (!IS_HARDWARE_TYPE_8814A(padapter) && !IS_HARDWARE_TYPE_8822B(padapter)) { + padapter->registrypriv.RegPwrTrimEnable = 1; + rtw_hal_read_chip_info(padapter); + } +#endif /*CONFIG_RF_POWER_TRIM*/ + rtw_reset_drv_sw(padapter); + status = rtw_hal_init(padapter); + if (status == _FAIL) { + ret = H2C_REJECTED; + goto exit; + } +#ifndef RTW_HALMAC + rtw_intf_start(padapter); +#endif /* !RTW_HALMAC */ +#ifdef RTW_HALMAC /*for New IC*/ + MPT_InitializeAdapter(padapter, 1); +#endif /* CONFIG_MP_INCLUDED */ + } + + if (padapter->registrypriv.mp_mode == 0) { + ret = H2C_REJECTED; + goto exit; + } + + if (padapter->mppriv.mode == MP_OFF) { + if (mp_start_test(padapter) == _FAIL) { + ret = H2C_REJECTED; + goto exit; + } + padapter->mppriv.mode = MP_ON; + MPT_PwrCtlDM(padapter, 0); + } + padapter->mppriv.bmac_filter = _FALSE; +#ifdef CONFIG_RTL8723B +#ifdef CONFIG_USB_HCI + rtw_write32(padapter, 0x765, 0x0000); + rtw_write32(padapter, 0x948, 0x0280); +#else + rtw_write32(padapter, 0x765, 0x0000); + rtw_write32(padapter, 0x948, 0x0000); +#endif +#ifdef CONFIG_FOR_RTL8723BS_VQ0 + rtw_write32(padapter, 0x765, 0x0000); + rtw_write32(padapter, 0x948, 0x0280); +#endif + rtw_write8(padapter, 0x66, 0x27); /*Open BT uart Log*/ + rtw_write8(padapter, 0xc50, 0x20); /*for RX init Gain*/ +#endif + odm_write_dig(&pHalData->odmpriv, 0x20); + + } else if (mp_cmd_id == MP_STOP) { + if (padapter->registrypriv.mp_mode == 1) { + MPT_DeInitAdapter(padapter); + rtw_intf_stop(padapter); + rtw_hal_deinit(padapter); + padapter->registrypriv.mp_mode = 0; + rtw_reset_drv_sw(padapter); + status = rtw_hal_init(padapter); + if (status == _FAIL) { + ret = H2C_REJECTED; + goto exit; + } +#ifndef RTW_HALMAC + rtw_intf_start(padapter); +#endif /* !RTW_HALMAC */ + } + + if (padapter->mppriv.mode != MP_OFF) { + mp_stop_test(padapter); + padapter->mppriv.mode = MP_OFF; + } + + } else { + RTW_INFO(FUNC_ADPT_FMT"invalid id:%d\n", FUNC_ADPT_ARG(padapter), mp_cmd_id); + ret = H2C_PARAMETERS_ERROR; + rtw_warn_on(1); + } + +exit: + return ret; +} + +u8 rtw_mp_cmd(_adapter *adapter, u8 mp_cmd_id, u8 flags) +{ + struct cmd_obj *cmdobj; + struct drvextra_cmd_parm *parm; + struct cmd_priv *pcmdpriv = &adapter->cmdpriv; + struct submit_ctx sctx; + u8 res = _SUCCESS; + + parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (parm == NULL) { + res = _FAIL; + goto exit; + } + + parm->ec_id = MP_CMD_WK_CID; + parm->type = mp_cmd_id; + parm->size = 0; + parm->pbuf = NULL; + + if (flags & RTW_CMDF_DIRECTLY) { + /* no need to enqueue, do the cmd hdl directly and free cmd parameter */ + if (H2C_SUCCESS != rtw_mp_cmd_hdl(adapter, mp_cmd_id)) + res = _FAIL; + rtw_mfree((u8 *)parm, sizeof(*parm)); + } else { + /* need enqueue, prepare cmd_obj and enqueue */ + cmdobj = (struct cmd_obj *)rtw_zmalloc(sizeof(*cmdobj)); + if (cmdobj == NULL) { + res = _FAIL; + rtw_mfree((u8 *)parm, sizeof(*parm)); + goto exit; + } + + init_h2fwcmd_w_parm_no_rsp(cmdobj, parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + if (flags & RTW_CMDF_WAIT_ACK) { + cmdobj->sctx = &sctx; + rtw_sctx_init(&sctx, 10 * 1000); + } + + res = rtw_enqueue_cmd(pcmdpriv, cmdobj); + + if (res == _SUCCESS && (flags & RTW_CMDF_WAIT_ACK)) { + rtw_sctx_wait(&sctx, __func__); + _enter_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + if (sctx.status == RTW_SCTX_SUBMITTED) + cmdobj->sctx = NULL; + _exit_critical_mutex(&pcmdpriv->sctx_mutex, NULL); + if (sctx.status != RTW_SCTX_DONE_SUCCESS) + res = _FAIL; + } + } + +exit: + return res; +} +#endif /*CONFIG_MP_INCLUDED*/ + #ifdef CONFIG_RTW_CUSTOMER_STR static s32 rtw_customer_str_cmd_hdl(_adapter *adapter, u8 write, const u8 *cstr) { @@ -4442,11 +4699,28 @@ u8 rtw_drvextra_cmd_hdl(_adapter *padapter, unsigned char *pbuf) case TEST_H2C_CID: rtw_hal_fill_h2c_cmd(padapter, pdrvextra_cmd->pbuf[0], pdrvextra_cmd->size - 1, &pdrvextra_cmd->pbuf[1]); break; + case MP_CMD_WK_CID: +#ifdef CONFIG_MP_INCLUDED + ret = rtw_mp_cmd_hdl(padapter, pdrvextra_cmd->type); +#endif + break; #ifdef CONFIG_RTW_CUSTOMER_STR case CUSTOMER_STR_WK_CID: ret = rtw_customer_str_cmd_hdl(padapter, pdrvextra_cmd->type, pdrvextra_cmd->pbuf); break; #endif + +#ifdef CONFIG_RTW_REPEATER_SON + case RSON_SCAN_WK_CID: + rtw_rson_scan_cmd_hdl(padapter, pdrvextra_cmd->type); + break; +#endif + +#ifdef CONFIG_IOCTL_CFG80211 + case MGNT_TX_WK_CID: + ret = rtw_mgnt_tx_handler(padapter, pdrvextra_cmd->pbuf); + break; +#endif /* CONFIG_IOCTL_CFG80211 */ default: break; } @@ -4526,7 +4800,6 @@ void rtw_joinbss_cmd_callback(_adapter *padapter, struct cmd_obj *pcmd) void rtw_create_ibss_post_hdl(_adapter *padapter, int status) { _irqL irqL; - u8 timer_cancelled; struct sta_info *psta = NULL; struct wlan_network *pwlan = NULL; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -4536,7 +4809,7 @@ void rtw_create_ibss_post_hdl(_adapter *padapter, int status) if (status != H2C_SUCCESS) _set_timer(&pmlmepriv->assoc_timer, 1); - _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); + _cancel_timer_ex(&pmlmepriv->assoc_timer); _enter_critical_bh(&pmlmepriv->lock, &irqL); @@ -4592,7 +4865,7 @@ void rtw_setstaKey_cmdrsp_callback(_adapter *padapter , struct cmd_obj *pcmd) goto exit; } - /* psta->aid = psta->mac_id = psetstakey_rsp->keyid; */ /* CAM_ID(CAM_ENTRY) */ + /* psta->cmn.aid = psta->cmn.mac_id = psetstakey_rsp->keyid; */ /* CAM_ID(CAM_ENTRY) */ exit: @@ -4614,7 +4887,7 @@ void rtw_setassocsta_cmdrsp_callback(_adapter *padapter, struct cmd_obj *pcmd) goto exit; } - psta->aid = psta->mac_id = passocsta_rsp->cam_id; + psta->cmn.aid = psta->cmn.mac_id = passocsta_rsp->cam_id; _enter_critical_bh(&pmlmepriv->lock, &irqL); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_debug.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_debug.c index 97095753f7f4..cdb9c690f270 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_debug.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_debug.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_DEBUG_C_ #include @@ -65,6 +60,9 @@ void dump_drv_cfg(void *sel) #ifdef RTW_USE_CFG80211_STA_EVENT RTW_PRINT_SEL(sel, "RTW_USE_CFG80211_STA_EVENT\n"); #endif + #ifdef CONFIG_RADIO_WORK + RTW_PRINT_SEL(sel, "CONFIG_RADIO_WORK\n"); + #endif #else RTW_PRINT_SEL(sel, "WEXT\n"); #endif @@ -170,7 +168,17 @@ void dump_drv_cfg(void *sel) #ifdef CONFIG_PCI_HCI #endif + RTW_PRINT_SEL(sel, "\n=== XMIT-INFO ===\n"); + RTW_PRINT_SEL(sel, "NR_XMITFRAME = %d\n", NR_XMITFRAME); + RTW_PRINT_SEL(sel, "NR_XMITBUFF = %d\n", NR_XMITBUFF); RTW_PRINT_SEL(sel, "MAX_XMITBUF_SZ = %d\n", MAX_XMITBUF_SZ); + RTW_PRINT_SEL(sel, "NR_XMIT_EXTBUFF = %d\n", NR_XMIT_EXTBUFF); + RTW_PRINT_SEL(sel, "MAX_XMIT_EXTBUF_SZ = %d\n", MAX_XMIT_EXTBUF_SZ); + RTW_PRINT_SEL(sel, "MAX_CMDBUF_SZ = %d\n", MAX_CMDBUF_SZ); + + RTW_PRINT_SEL(sel, "\n=== RECV-INFO ===\n"); + RTW_PRINT_SEL(sel, "NR_RECVFRAME = %d\n", NR_RECVFRAME); + RTW_PRINT_SEL(sel, "NR_RECVBUFF = %d\n", NR_RECVBUFF); RTW_PRINT_SEL(sel, "MAX_RECVBUF_SZ = %d\n", MAX_RECVBUF_SZ); } @@ -231,7 +239,7 @@ void mac_reg_dump(void *sel, _adapter *adapter) for (i = 0x0; i < 0x800; i += 4) { if (j % 4 == 1) - RTW_PRINT_SEL(sel, "0x%03x", i); + RTW_PRINT_SEL(sel, "0x%04x", i); _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); if ((j++) % 4 == 0) _RTW_PRINT_SEL(sel, "\n"); @@ -241,7 +249,7 @@ void mac_reg_dump(void *sel, _adapter *adapter) { for (i = 0x1000; i < 0x1650; i += 4) { if (j % 4 == 1) - RTW_PRINT_SEL(sel, "0x%03x", i); + RTW_PRINT_SEL(sel, "0x%04x", i); _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); if ((j++) % 4 == 0) _RTW_PRINT_SEL(sel, "\n"); @@ -249,10 +257,11 @@ void mac_reg_dump(void *sel, _adapter *adapter) } #endif /* CONFIG_RTL8814A */ -#ifdef CONFIG_RTL8822B + +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) for (i = 0x1000; i < 0x1800; i += 4) { if (j % 4 == 1) - RTW_PRINT_SEL(sel, "0x%03x", i); + RTW_PRINT_SEL(sel, "0x%04x", i); _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); if ((j++) % 4 == 0) _RTW_PRINT_SEL(sel, "\n"); @@ -267,16 +276,16 @@ void bb_reg_dump(void *sel, _adapter *adapter) RTW_PRINT_SEL(sel, "======= BB REG =======\n"); for (i = 0x800; i < 0x1000; i += 4) { if (j % 4 == 1) - RTW_PRINT_SEL(sel, "0x%03x", i); + RTW_PRINT_SEL(sel, "0x%04x", i); _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); if ((j++) % 4 == 0) _RTW_PRINT_SEL(sel, "\n"); } -#ifdef CONFIG_RTL8822B +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) for (i = 0x1800; i < 0x2000; i += 4) { if (j % 4 == 1) - RTW_PRINT_SEL(sel, "0x%03x", i); + RTW_PRINT_SEL(sel, "0x%04x", i); _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); if ((j++) % 4 == 0) _RTW_PRINT_SEL(sel, "\n"); @@ -284,6 +293,26 @@ void bb_reg_dump(void *sel, _adapter *adapter) #endif /* CONFIG_RTL8822B */ } +void bb_reg_dump_ex(void *sel, _adapter *adapter) +{ + int i, j = 1; + + RTW_PRINT_SEL(sel, "======= BB REG =======\n"); + for (i = 0x800; i < 0x1000; i += 4) { + RTW_PRINT_SEL(sel, "0x%04x", i); + _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); + _RTW_PRINT_SEL(sel, "\n"); + } + +#if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) + for (i = 0x1800; i < 0x2000; i += 4) { + RTW_PRINT_SEL(sel, "0x%04x", i); + _RTW_PRINT_SEL(sel, " 0x%08x ", rtw_read32(adapter, i)); + _RTW_PRINT_SEL(sel, "\n"); + } +#endif /* CONFIG_RTL8822B */ +} + void rf_reg_dump(void *sel, _adapter *adapter) { int i, j = 1, path; @@ -312,55 +341,13 @@ void rf_reg_dump(void *sel, _adapter *adapter) } } -static u8 fwdl_test_chksum_fail = 0; -static u8 fwdl_test_wintint_rdy_fail = 0; - -bool rtw_fwdl_test_trigger_chksum_fail(void) -{ - if (fwdl_test_chksum_fail) { - RTW_PRINT("fwdl test case: trigger chksum_fail\n"); - fwdl_test_chksum_fail--; - return _TRUE; - } - return _FALSE; -} - -bool rtw_fwdl_test_trigger_wintint_rdy_fail(void) -{ - if (fwdl_test_wintint_rdy_fail) { - RTW_PRINT("fwdl test case: trigger wintint_rdy_fail\n"); - fwdl_test_wintint_rdy_fail--; - return _TRUE; - } - return _FALSE; -} - -static u32 g_wait_hiq_empty_ms = 0; - -u32 rtw_get_wait_hiq_empty_ms(void) -{ - return g_wait_hiq_empty_ms; -} - -static u8 del_rx_ampdu_test_no_tx_fail = 0; - -bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void) -{ - if (del_rx_ampdu_test_no_tx_fail) { - RTW_PRINT("del_rx_ampdu test case: trigger no_tx_fail\n"); - del_rx_ampdu_test_no_tx_fail--; - return _TRUE; - } - return _FALSE; -} - -void rtw_sink_rtp_seq_dbg(_adapter *adapter, _pkt *pkt) +void rtw_sink_rtp_seq_dbg(_adapter *adapter, u8 *ehdr_pos) { struct recv_priv *precvpriv = &(adapter->recvpriv); if (precvpriv->sink_udpport > 0) { - if (*((u16 *)((pkt->data) + 0x24)) == cpu_to_be16(precvpriv->sink_udpport)) { + if (*((u16 *)(ehdr_pos + 0x24)) == cpu_to_be16(precvpriv->sink_udpport)) { precvpriv->pre_rtp_rxseq = precvpriv->cur_rtp_rxseq; - precvpriv->cur_rtp_rxseq = be16_to_cpu(*((u16 *)((pkt->data) + 0x2C))); + precvpriv->cur_rtp_rxseq = be16_to_cpu(*((u16 *)(ehdr_pos + 0x2C))); if (precvpriv->pre_rtp_rxseq + 1 != precvpriv->cur_rtp_rxseq) RTW_INFO("%s : RTP Seq num from %d to %d\n", __FUNCTION__, precvpriv->pre_rtp_rxseq, precvpriv->cur_rtp_rxseq); } @@ -430,6 +417,10 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) dump_mi_status(sel, dvobj); +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + RTW_PRINT_SEL(sel, "default port id:%d\n\n", dvobj->default_port_id); +#endif /* CONFIG_FW_MULTI_PORT_SUPPORT */ + RTW_PRINT_SEL(sel, "dev status:%s%s\n\n" , dev_is_surprise_removed(dvobj) ? " SR" : "" , dev_is_drv_stopped(dvobj) ? " DS" : "" @@ -491,7 +482,7 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) P2P_INFO_DASH "-------\n"); - rtw_mi_get_ch_setting_union(dvobj->padapters[IFACE_ID0], &u_ch, &u_bw, &u_offset); + rtw_mi_get_ch_setting_union(dvobj_get_primary_adapter(dvobj), &u_ch, &u_bw, &u_offset); RTW_PRINT_SEL(sel, "%55s %3u,%u,%u\n" , "union:" , u_ch, u_bw, u_offset @@ -506,22 +497,6 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) #ifdef CONFIG_DFS_MASTER if (rfctl->radar_detect_ch != 0) { - u32 non_ocp_ms; - u32 cac_ms; - - for (i = 0; i < dvobj->iface_nums; i++) { - if (!dvobj->padapters[i]) - continue; - if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE) - && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_ASOC_STATE)) - break; - } - - if (i >= dvobj->iface_nums) { - RTW_PRINT_SEL(sel, "DFS master enable without AP mode???"); - goto end_dfs_master; - } - RTW_PRINT_SEL(sel, "%55s %3u,%u,%u" , "radar_detect:" , rfctl->radar_detect_ch @@ -529,20 +504,42 @@ void dump_adapters_status(void *sel, struct dvobj_priv *dvobj) , rfctl->radar_detect_offset ); - _RTW_PRINT_SEL(sel, ", domain:%u", rtw_odm_get_dfs_domain(dvobj->padapters[IFACE_ID0])); + if (rfctl->radar_detect_by_others) + _RTW_PRINT_SEL(sel, ", by AP of STA link"); + else { + u32 non_ocp_ms; + u32 cac_ms; + u8 dfs_domain = rtw_odm_get_dfs_domain(dvobj_get_primary_adapter(dvobj)); - rtw_get_ch_waiting_ms(dvobj->padapters[i] - , rfctl->radar_detect_ch - , rfctl->radar_detect_bw - , rfctl->radar_detect_offset - , &non_ocp_ms - , &cac_ms - ); + _RTW_PRINT_SEL(sel, ", domain:%u", dfs_domain); + + for (i = 0; i < dvobj->iface_nums; i++) { + if (!dvobj->padapters[i]) + continue; + if (check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_AP_STATE | WIFI_MESH_STATE) + && check_fwstate(&dvobj->padapters[i]->mlmepriv, WIFI_ASOC_STATE)) + break; + } + + if (i >= dvobj->iface_nums) { + RTW_PRINT_SEL(sel, "DFS master enable without AP/Mesh mode???"); + goto end_dfs_master; + } + + rtw_get_ch_waiting_ms(dvobj->padapters[i] + , rfctl->radar_detect_ch + , rfctl->radar_detect_bw + , rfctl->radar_detect_offset + , &non_ocp_ms + , &cac_ms + ); + + if (non_ocp_ms) + _RTW_PRINT_SEL(sel, ", non_ocp:%d", non_ocp_ms); + if (cac_ms) + _RTW_PRINT_SEL(sel, ", cac:%d", cac_ms); + } - if (non_ocp_ms) - _RTW_PRINT_SEL(sel, ", non_ocp:%d", non_ocp_ms); - if (cac_ms) - _RTW_PRINT_SEL(sel, ", cac:%d", cac_ms); end_dfs_master: _RTW_PRINT_SEL(sel, "\n"); } @@ -728,6 +725,108 @@ ssize_t proc_set_read_reg(struct file *file, const char __user *buffer, size_t c } +int proc_get_rx_stat(struct seq_file *m, void *v) +{ + _irqL irqL; + _list *plist, *phead; + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct sta_info *psta = NULL; + struct stainfo_stats *pstats = NULL; + struct sta_priv *pstapriv = &(adapter->stapriv); + u32 i, j; + u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + for (i = 0; i < NUM_STA; i++) { + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + plist = get_next(plist); + pstats = &psta->sta_stats; + + if (pstats == NULL) + continue; + if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), 6) != _TRUE)) { + RTW_PRINT_SEL(m, "MAC :\t\t"MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); + RTW_PRINT_SEL(m, "data_rx_cnt :\t%llu\n", sta_rx_data_uc_pkts(psta) - pstats->last_rx_data_uc_pkts); + pstats->last_rx_data_uc_pkts = sta_rx_data_uc_pkts(psta); + RTW_PRINT_SEL(m, "duplicate_cnt :\t%u\n", pstats->duplicate_cnt); + pstats->duplicate_cnt = 0; + RTW_PRINT_SEL(m, "rx_per_rate_cnt :\n"); + + for (j = 0; j < 0x60; j++) { + RTW_PRINT_SEL(m, "%08u ", pstats->rxratecnt[j]); + pstats->rxratecnt[j] = 0; + if ((j%8) == 7) + RTW_PRINT_SEL(m, "\n"); + } + RTW_PRINT_SEL(m, "\n"); + } + } + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + return 0; +} + +int proc_get_tx_stat(struct seq_file *m, void *v) +{ + _irqL irqL; + _list *plist, *phead; + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct sta_info *psta = NULL, *sta_rec[NUM_STA]; + struct stainfo_stats *pstats = NULL; + struct sta_priv *pstapriv = &(adapter->stapriv); + u32 i, macid_rec_idx = 0; + u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + u8 null_addr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; + struct submit_ctx gotc2h; + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + for (i = 0; i < NUM_STA; i++) { + sta_rec[i] = NULL; + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + plist = get_next(plist); + if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(adapter), 6) != _TRUE)) { + sta_rec[macid_rec_idx++] = psta; + } + } + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + for (i = 0; i < macid_rec_idx; i++) { + pstats = &(sta_rec[i]->sta_stats); + if (pstats == NULL) + continue; + pstapriv->c2h_sta = sta_rec[i]; + rtw_hal_reqtxrpt(adapter, sta_rec[i]->cmn.mac_id); + rtw_sctx_init(&gotc2h, 60); + pstapriv->gotc2h = &gotc2h; + if (rtw_sctx_wait(&gotc2h, __func__)) { + RTW_PRINT_SEL(m, "MAC :\t\t"MAC_FMT "\n", MAC_ARG(sta_rec[i]->cmn.mac_addr)); + RTW_PRINT_SEL(m, "data_sent_cnt :\t%u\n", pstats->tx_ok_cnt + pstats->tx_fail_cnt); + RTW_PRINT_SEL(m, "success_cnt :\t%u\n", pstats->tx_ok_cnt); + RTW_PRINT_SEL(m, "failure_cnt :\t%u\n", pstats->tx_fail_cnt); + RTW_PRINT_SEL(m, "retry_cnt :\t%u\n\n", pstats->tx_retry_cnt); + } else { + RTW_PRINT_SEL(m, "Warming : Query timeout, operation abort!!\n"); + RTW_PRINT_SEL(m, "\n"); + pstapriv->c2h_sta = NULL; + break; + } + } + return 0; +} + int proc_get_fwstate(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -1204,6 +1303,52 @@ ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, s #endif /* CONFIG_SCAN_BACKOP */ +#ifdef CONFIG_RTW_REPEATER_SON +int proc_get_rson_data(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char rson_data_str[256]; + + rtw_rson_get_property_str(padapter, rson_data_str); + RTW_PRINT_SEL(m, "%s\n", rson_data_str); + return 0; +} + +ssize_t proc_set_rson_data(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + char tmp[64] = {0}; + int num; + u8 field[10], value[64]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + num = sscanf(tmp, "%s %s", field, value); + if (num != 2) { + RTW_INFO("Invalid format : echo > son_data\n"); + return count; + } + RTW_INFO("field=%s value=%s\n", field, value); + num = rtw_rson_set_property(padapter, field, value); + if (num != 1) { + RTW_INFO("Invalid field(%s) or value(%s)\n", field, value); + return count; + } + } + return count; +} +#endif /*CONFIG_RTW_REPEATER_SON*/ + int proc_get_survey_info(struct seq_file *m, void *v) { _irqL irqL; @@ -1225,10 +1370,14 @@ int proc_get_survey_info(struct seq_file *m, void *v) _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); phead = get_list_head(queue); if (!phead) - return 0; + goto _exit; plist = get_next(phead); if (!plist) - return 0; + goto _exit; + +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_show_survey_info(m, plist, phead); +#else RTW_PRINT_SEL(m, "%5s %-17s %3s %-3s %-4s %-4s %5s %32s %32s\n", "index", "bssid", "ch", "RSSI", "SdBm", "Noise", "age", "flag", "ssid"); while (1) { @@ -1246,8 +1395,9 @@ int proc_get_survey_info(struct seq_file *m, void *v) notify_signal = translate_percentage_to_dbm(pnetwork->network.PhyInfo.SignalStrength);/* dbm */ } -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(notify_noise)); +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + if (IS_NM_ENABLE(padapter)) + notify_noise = rtw_noise_query_by_chan_num(padapter, pnetwork->network.Configuration.DSConfig); #endif ie_wpa = rtw_get_wpa_ie(&pnetwork->network.IEs[12], &ielen, pnetwork->network.IELength - 12); @@ -1271,11 +1421,13 @@ int proc_get_survey_info(struct seq_file *m, void *v) (int)pnetwork->network.Rssi, notify_signal, notify_noise, - rtw_get_passing_time_ms((u32)pnetwork->last_scanned), + rtw_get_passing_time_ms(pnetwork->last_scanned), flag_str, pnetwork->network.Ssid.Ssid); plist = get_next(plist); } +#endif +_exit: _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); return 0; @@ -1295,7 +1447,7 @@ ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_ return -EFAULT; #ifdef CONFIG_MP_INCLUDED - if (rtw_mi_mp_mode_check(padapter)) { + if (rtw_mp_mode_check(padapter)) { RTW_INFO("MP mode block Scan request\n"); goto exit; } @@ -1335,7 +1487,7 @@ ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_ goto cancel_ps_deny; } #endif - _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, NULL, 0); + _status = rtw_set_802_11_bssid_list_scan(padapter, NULL); cancel_ps_deny: rtw_ps_deny_cancel(padapter, PS_DENY_SCAN); @@ -1355,17 +1507,16 @@ int proc_get_ap_info(struct seq_file *m, void *v) psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); if (psta) { - int i; - struct recv_reorder_ctrl *preorder_ctrl; - RTW_PRINT_SEL(m, "SSID=%s\n", cur_network->network.Ssid.Ssid); - RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); + RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); RTW_PRINT_SEL(m, "cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); RTW_PRINT_SEL(m, "wireless_mode=0x%x, rtsen=%d, cts2slef=%d\n", psta->wireless_mode, psta->rtsen, psta->cts2self); - RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); + RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", + psta->state, psta->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); #ifdef CONFIG_80211N_HT RTW_PRINT_SEL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); - RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); + RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n" + , psta->cmn.bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); RTW_PRINT_SEL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); RTW_PRINT_SEL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); RTW_PRINT_SEL(m, "ldpc_cap=0x%x, stbc_cap=0x%x, beamform_cap=0x%x\n", psta->htpriv.ldpc_cap, psta->htpriv.stbc_cap, psta->htpriv.beamform_cap); @@ -1387,8 +1538,7 @@ ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t { struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + struct recv_priv *precvpriv = &padapter->recvpriv; char cmd[32] = {0}; u8 cnt = 0; @@ -1401,12 +1551,13 @@ ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t int num = sscanf(cmd, "%hhx", &cnt); if (0 == cnt) { - pdbgpriv->dbg_rx_ampdu_drop_count = 0; - pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; - pdbgpriv->dbg_rx_ampdu_loss_count = 0; - pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; - pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; - pdbgpriv->dbg_rx_conflic_mac_addr_cnt = 0; + precvpriv->dbg_rx_ampdu_drop_count = 0; + precvpriv->dbg_rx_ampdu_forced_indicate_count = 0; + precvpriv->dbg_rx_ampdu_loss_count = 0; + precvpriv->dbg_rx_dup_mgt_frame_drop_count = 0; + precvpriv->dbg_rx_ampdu_window_shift_cnt = 0; + precvpriv->dbg_rx_conflic_mac_addr_cnt = 0; + precvpriv->dbg_rx_drop_count = 0; } } @@ -1420,8 +1571,6 @@ int proc_get_trx_info(struct seq_file *m, void *v) _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct recv_priv *precvpriv = &padapter->recvpriv; - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; struct hw_xmit *phwxmit; dump_os_queue(m, padapter); @@ -1438,21 +1587,26 @@ int proc_get_trx_info(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "%d, hwq.accnt=%d\n", i, phwxmit->accnt); } + rtw_hal_get_hwreg(padapter, HW_VAR_DUMP_MAC_TXFIFO, (u8 *)m); + #ifdef CONFIG_USB_HCI RTW_PRINT_SEL(m, "rx_urb_pending_cn=%d\n", ATOMIC_READ(&(precvpriv->rx_pending_cnt))); #endif + dump_rx_bh_tk(m, &GET_PRIMARY_ADAPTER(padapter)->recvpriv); + /* Folowing are RX info */ + RTW_PRINT_SEL(m, "RX: Count of Packets dropped by Driver: %llu\n", (unsigned long long)precvpriv->dbg_rx_drop_count); /* Counts of packets whose seq_num is less than preorder_ctrl->indicate_seq, Ex delay, retransmission, redundant packets and so on */ - RTW_PRINT_SEL(m, "Rx: Counts of Packets Whose Seq_Num Less Than Reorder Control Seq_Num: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_drop_count); + RTW_PRINT_SEL(m, "Rx: Counts of Packets Whose Seq_Num Less Than Reorder Control Seq_Num: %llu\n", (unsigned long long)precvpriv->dbg_rx_ampdu_drop_count); /* How many times the Rx Reorder Timer is triggered. */ - RTW_PRINT_SEL(m, "Rx: Reorder Time-out Trigger Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_forced_indicate_count); + RTW_PRINT_SEL(m, "Rx: Reorder Time-out Trigger Counts: %llu\n", (unsigned long long)precvpriv->dbg_rx_ampdu_forced_indicate_count); /* Total counts of packets loss */ - RTW_PRINT_SEL(m, "Rx: Packet Loss Counts: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_loss_count); - RTW_PRINT_SEL(m, "Rx: Duplicate Management Frame Drop Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_dup_mgt_frame_drop_count); - RTW_PRINT_SEL(m, "Rx: AMPDU BA window shift Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_ampdu_window_shift_cnt); + RTW_PRINT_SEL(m, "Rx: Packet Loss Counts: %llu\n", (unsigned long long)precvpriv->dbg_rx_ampdu_loss_count); + RTW_PRINT_SEL(m, "Rx: Duplicate Management Frame Drop Count: %llu\n", (unsigned long long)precvpriv->dbg_rx_dup_mgt_frame_drop_count); + RTW_PRINT_SEL(m, "Rx: AMPDU BA window shift Count: %llu\n", (unsigned long long)precvpriv->dbg_rx_ampdu_window_shift_cnt); /*The same mac addr counts*/ - RTW_PRINT_SEL(m, "Rx: Conflict MAC Address Frames Count: %llu\n", (unsigned long long)pdbgpriv->dbg_rx_conflic_mac_addr_cnt); + RTW_PRINT_SEL(m, "Rx: Conflict MAC Address Frames Count: %llu\n", (unsigned long long)precvpriv->dbg_rx_conflic_mac_addr_cnt); return 0; } @@ -1496,7 +1650,6 @@ ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t co int proc_get_rate_ctl(struct seq_file *m, void *v) { struct net_device *dev = m->private; - int i; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); u8 data_rate = 0, sgi = 0, data_fb = 0; @@ -1520,6 +1673,7 @@ ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t c { struct net_device *dev = data; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); char tmp[32]; u8 fix_rate; u8 data_fb; @@ -1540,6 +1694,11 @@ ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t c u8 fix_rate_ori = adapter->fix_rate; adapter->fix_rate = fix_rate; + if (fix_rate == 0xFF) + hal_data->ForcedDataRate = 0; + else + hal_data->ForcedDataRate = hw_rate_to_m_rate(fix_rate & 0x7F); + if (adapter->fix_bw != 0xFF && fix_rate_ori != fix_rate) rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); } @@ -1549,6 +1708,94 @@ ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t c return count; } + +#ifdef CONFIG_AP_MODE +int proc_get_bmc_tx_rate(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + struct sta_info *psta = NULL; + + if (!MLME_IS_AP(adapter) && !MLME_IS_MESH(adapter)) { + RTW_PRINT_SEL(m, "[ERROR] Not in SoftAP/Mesh mode !!\n"); + return 0; + } + + RTW_PRINT_SEL(m, " BMC Tx rate - %s\n", MGN_RATE_STR(adapter->bmc_tx_rate)); + return 0; +} + +ssize_t proc_set_bmc_tx_rate(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + char tmp[32]; + u8 bmc_tx_rate; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhx", &bmc_tx_rate); + + if (num >= 1) + /*adapter->bmc_tx_rate = hw_rate_to_m_rate(bmc_tx_rate);*/ + adapter->bmc_tx_rate = bmc_tx_rate; + } + + return count; +} +#endif /*CONFIG_AP_MODE*/ + + +int proc_get_tx_power_offset(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + int i; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + RTW_PRINT_SEL(m, "Tx power offset - %u\n", adapter->power_offset); + return 0; +} + +ssize_t proc_set_tx_power_offset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u8 power_offset = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhu", &power_offset); + + if (num >= 1) { + if (power_offset > 5) + power_offset = 0; + + adapter->power_offset = power_offset; + } + } + + return count; +} + int proc_get_bw_ctl(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -1637,6 +1884,30 @@ ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_ return count; } #endif + +static u8 fwdl_test_chksum_fail = 0; +static u8 fwdl_test_wintint_rdy_fail = 0; + +bool rtw_fwdl_test_trigger_chksum_fail(void) +{ + if (fwdl_test_chksum_fail) { + RTW_PRINT("fwdl test case: trigger chksum_fail\n"); + fwdl_test_chksum_fail--; + return _TRUE; + } + return _FALSE; +} + +bool rtw_fwdl_test_trigger_wintint_rdy_fail(void) +{ + if (fwdl_test_wintint_rdy_fail) { + RTW_PRINT("fwdl test case: trigger wintint_rdy_fail\n"); + fwdl_test_wintint_rdy_fail--; + return _TRUE; + } + return _FALSE; +} + ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; @@ -1658,6 +1929,18 @@ ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, si return count; } +static u8 del_rx_ampdu_test_no_tx_fail = 0; + +bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void) +{ + if (del_rx_ampdu_test_no_tx_fail) { + RTW_PRINT("del_rx_ampdu test case: trigger no_tx_fail\n"); + del_rx_ampdu_test_no_tx_fail--; + return _TRUE; + } + return _FALSE; +} + ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; @@ -1725,6 +2008,13 @@ ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buff } #endif /* CONFIG_DFS_MASTER */ +static u32 g_wait_hiq_empty_ms = 0; + +u32 rtw_get_wait_hiq_empty_ms(void) +{ + return g_wait_hiq_empty_ms; +} + ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; @@ -1746,7 +2036,54 @@ ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, si return count; } -int proc_get_suspend_resume_info(struct seq_file *m, void *v) +static systime sta_linking_test_start_time = 0; +static u32 sta_linking_test_wait_ms = 0; +static u8 sta_linking_test_force_fail = 0; + +void rtw_sta_linking_test_set_start(void) +{ + sta_linking_test_start_time = rtw_get_current_time(); +} + +bool rtw_sta_linking_test_wait_done(void) +{ + return rtw_get_passing_time_ms(sta_linking_test_start_time) >= sta_linking_test_wait_ms; +} + +bool rtw_sta_linking_test_force_fail(void) +{ + return sta_linking_test_force_fail; +} + +ssize_t proc_set_sta_linking_test(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + u32 wait_ms = 0; + u8 force_fail = 0; + int num = sscanf(tmp, "%u %hhu", &wait_ms, &force_fail); + + if (num >= 1) + sta_linking_test_wait_ms = wait_ms; + if (num >= 2) + sta_linking_test_force_fail = force_fail; + } + + return count; +} + +int proc_get_ps_dbg_info(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); @@ -1781,9 +2118,39 @@ int proc_get_suspend_resume_info(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "dbg_rpwm_toogle_cnt=%d\n", pdbgpriv->dbg_rpwm_toogle_cnt); RTW_PRINT_SEL(m, "dbg_rpwm_timeout_fail_cnt=%d\n", pdbgpriv->dbg_rpwm_timeout_fail_cnt); RTW_PRINT_SEL(m, "dbg_sreset_cnt=%d\n", pdbgpriv->dbg_sreset_cnt); + RTW_PRINT_SEL(m, "dbg_fw_mem_dl_error_cnt=%d\n", pdbgpriv->dbg_fw_mem_dl_error_cnt); return 0; } +ssize_t proc_set_ps_dbg_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter->dvobj; + struct debug_priv *pdbgpriv = &dvobj->drv_dbg; + char tmp[32]; + u8 ps_dbg_cmd_id; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhx", &ps_dbg_cmd_id); + + if (ps_dbg_cmd_id == 1) /*Clean all*/ + _rtw_memset(pdbgpriv, 0, sizeof(struct debug_priv)); + + } + + return count; +} + #ifdef CONFIG_DBG_COUNTER @@ -2130,6 +2497,7 @@ int proc_get_rx_signal(struct seq_file *m, void *v) /* RTW_PRINT_SEL(m, "rxpwdb:%d\n", padapter->recvpriv.rxpwdb); */ RTW_PRINT_SEL(m, "signal_strength:%u\n", padapter->recvpriv.signal_strength); RTW_PRINT_SEL(m, "signal_qual:%u\n", padapter->recvpriv.signal_qual); +#ifdef CONFIG_MP_INCLUDED if (padapter->registrypriv.mp_mode == 1) { if (padapter->mppriv.antenna_rx == ANTENNA_A) RTW_PRINT_SEL(m, "Antenna: A\n"); @@ -2149,9 +2517,7 @@ int proc_get_rx_signal(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "Antenna: __\n"); return 0; } - - rtw_get_noise(padapter); - RTW_PRINT_SEL(m, "noise:%d\n", padapter->recvpriv.noise); +#endif #ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA rtw_odm_get_perpkt_rssi(m, padapter); rtw_get_raw_rssi_info(m, padapter); @@ -2199,6 +2565,7 @@ ssize_t proc_set_rx_signal(struct file *file, const char __user *buffer, size_t } #ifdef CONFIG_80211N_HT + int proc_get_ht_enable(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2332,6 +2699,50 @@ ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size } +int proc_get_mac_rptbuf(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u16 i; + u16 mac_id; + u32 shcut_addr = 0; + u32 read_addr = 0; +#ifdef CONFIG_RTL8814A + RTW_PRINT_SEL(m, "TX ShortCut:\n"); + for (mac_id = 0; mac_id < 64; mac_id++) { + rtw_write16(padapter, 0x140, 0x662 | ((mac_id & BIT5) >> 5)); + shcut_addr = 0x8000; + shcut_addr = shcut_addr | ((mac_id & 0x1f) << 7); + RTW_PRINT_SEL(m, "mac_id=%d, 0x140=%x =>\n", mac_id, 0x662 | ((mac_id & BIT5) >> 5)); + for (i = 0; i < 30; i++) { + read_addr = 0; + read_addr = shcut_addr | (i << 2); + RTW_PRINT_SEL(m, "i=%02d: MAC_%04x= %08x ", i, read_addr, rtw_read32(padapter, read_addr)); + if (!((i + 1) % 4)) + RTW_PRINT_SEL(m, "\n"); + if (i == 29) + RTW_PRINT_SEL(m, "\n"); + } + } +#endif /* CONFIG_RTL8814A */ + return 0; +} + +void dump_regsty_rx_ampdu_size_limit(void *sel, _adapter *adapter) +{ + struct registry_priv *regsty = adapter_to_regsty(adapter); + int i; + + RTW_PRINT_SEL(sel, "%-3s %-3s %-3s %-3s %-4s\n" + , "", "20M", "40M", "80M", "160M"); + for (i = 0; i < 4; i++) + RTW_PRINT_SEL(sel, "%dSS %3u %3u %3u %4u\n", i + 1 + , regsty->rx_ampdu_sz_limit_by_nss_bw[i][0] + , regsty->rx_ampdu_sz_limit_by_nss_bw[i][1] + , regsty->rx_ampdu_sz_limit_by_nss_bw[i][2] + , regsty->rx_ampdu_sz_limit_by_nss_bw[i][3]); +} + int proc_get_rx_ampdu(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2344,10 +2755,12 @@ int proc_get_rx_ampdu(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "%u%s\n", padapter->fix_rx_ampdu_accept, "(fixed)"); _RTW_PRINT_SEL(m, "size: "); - if (padapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) - RTW_PRINT_SEL(m, "%u%s\n", rtw_rx_ampdu_size(padapter), "(auto)"); - else + if (padapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) { + RTW_PRINT_SEL(m, "%u%s\n", rtw_rx_ampdu_size(padapter), "(auto) with conditional limit:"); + dump_regsty_rx_ampdu_size_limit(m, padapter); + } else RTW_PRINT_SEL(m, "%u%s\n", padapter->fix_rx_ampdu_size, "(fixed)"); + RTW_PRINT_SEL(m, "\n"); RTW_PRINT_SEL(m, "%19s %17s\n", "fix_rx_ampdu_accept", "fix_rx_ampdu_size"); @@ -2437,6 +2850,48 @@ ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer return count; } +int proc_get_tx_max_agg_num(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + + if (padapter) + RTW_PRINT_SEL(m, "tx max AMPDU num = 0x%02x\n", padapter->driver_tx_max_agg_num); + + return 0; +} + +ssize_t proc_set_tx_max_agg_num(struct file *file, const char __user *buffer + , size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u8 agg_num; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhx ", &agg_num); + + if (padapter && (num == 1)) { + RTW_INFO("padapter->driver_tx_max_agg_num = 0x%02x\n", agg_num); + + padapter->driver_tx_max_agg_num = agg_num; + } + } + + return count; +} + int proc_get_rx_ampdu_density(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2524,37 +2979,107 @@ ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, return count; } -#endif /* CONFIG_80211N_HT */ -int proc_get_mac_rptbuf(struct seq_file *m, void *v) +#ifdef CONFIG_TX_AMSDU +int proc_get_tx_amsdu(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - u16 i; - u16 mac_id; - u32 shcut_addr = 0; - u32 read_addr = 0; -#ifdef CONFIG_RTL8814A - RTW_PRINT_SEL(m, "TX ShortCut:\n"); - for (mac_id = 0; mac_id < 64; mac_id++) { - rtw_write16(padapter, 0x140, 0x662 | ((mac_id & BIT5) >> 5)); - shcut_addr = 0x8000; - shcut_addr = shcut_addr | ((mac_id & 0x1f) << 7); - RTW_PRINT_SEL(m, "mac_id=%d, 0x140=%x =>\n", mac_id, 0x662 | ((mac_id & BIT5) >> 5)); - for (i = 0; i < 30; i++) { - read_addr = 0; - read_addr = shcut_addr | (i << 2); - RTW_PRINT_SEL(m, "i=%02d: MAC_%04x= %08x ", i, read_addr, rtw_read32(padapter, read_addr)); - if (!((i + 1) % 4)) - RTW_PRINT_SEL(m, "\n"); - if (i == 29) - RTW_PRINT_SEL(m, "\n"); - } + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + if (padapter) + { + RTW_PRINT_SEL(m, "tx amsdu = %d\n", padapter->tx_amsdu); + RTW_PRINT_SEL(m, "amsdu set timer conut = %u\n", pxmitpriv->amsdu_debug_set_timer); + RTW_PRINT_SEL(m, "amsdu time out count = %u\n", pxmitpriv->amsdu_debug_timeout); + RTW_PRINT_SEL(m, "amsdu coalesce one count = %u\n", pxmitpriv->amsdu_debug_coalesce_one); + RTW_PRINT_SEL(m, "amsdu coalesce two count = %u\n", pxmitpriv->amsdu_debug_coalesce_two); } -#endif /* CONFIG_RTL8814A */ + return 0; } +ssize_t proc_set_tx_amsdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + char tmp[32]; + u32 amsdu; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d ", &amsdu); + + if (padapter && (num == 1)) { + RTW_INFO("padapter->tx_amsdu = %x\n", amsdu); + + if (amsdu > 3) + padapter->tx_amsdu = 0; + else if(amsdu == 3) + { + pxmitpriv->amsdu_debug_set_timer = 0; + pxmitpriv->amsdu_debug_timeout = 0; + pxmitpriv->amsdu_debug_coalesce_one = 0; + pxmitpriv->amsdu_debug_coalesce_two = 0; + } + else + padapter->tx_amsdu = amsdu; + } + } + + return count; +} + +int proc_get_tx_amsdu_rate(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + if (padapter) + RTW_PRINT_SEL(m, "tx amsdu rate = %d Mbps\n", padapter->tx_amsdu_rate); + + return 0; +} + +ssize_t proc_set_tx_amsdu_rate(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u32 amsdu_rate; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d ", &amsdu_rate); + + if (padapter && (num == 1)) { + RTW_INFO("padapter->tx_amsdu_rate = %x\n", amsdu_rate); + padapter->tx_amsdu_rate = amsdu_rate; + } + } + + return count; +} +#endif /* CONFIG_TX_AMSDU */ +#endif /* CONFIG_80211N_HT */ + int proc_get_en_fwps(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2616,6 +3141,144 @@ int proc_get_two_path_rssi(struct seq_file *m, void *v) } */ #ifdef CONFIG_80211N_HT +void rtw_dump_dft_phy_cap(void *sel, _adapter *adapter) +{ + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct ht_priv *phtpriv = &pmlmepriv->htpriv; + #ifdef CONFIG_80211AC_VHT + struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; + #endif + + #ifdef CONFIG_80211AC_VHT + RTW_PRINT_SEL(sel, "[DFT CAP] VHT STBC Tx : %s\n", (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] VHT STBC Rx : %s\n", (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) ? "V" : "X"); + #endif + RTW_PRINT_SEL(sel, "[DFT CAP] HT STBC Tx : %s\n", (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] HT STBC Rx : %s\n\n", (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) ? "V" : "X"); + + #ifdef CONFIG_80211AC_VHT + RTW_PRINT_SEL(sel, "[DFT CAP] VHT LDPC Tx : %s\n", (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_TX)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] VHT LDPC Rx : %s\n", (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX)) ? "V" : "X"); + #endif + RTW_PRINT_SEL(sel, "[DFT CAP] HT LDPC Tx : %s\n", (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_TX)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] HT LDPC Rx : %s\n\n", (TEST_FLAG(phtpriv->ldpc_cap, LDPC_HT_ENABLE_RX)) ? "V" : "X"); + + #ifdef CONFIG_BEAMFORMING + #ifdef CONFIG_80211AC_VHT + RTW_PRINT_SEL(sel, "[DFT CAP] VHT MU Bfer : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] VHT MU Bfee : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] VHT SU Bfer : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] VHT SU Bfee : %s\n", (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) ? "V" : "X"); + #endif + RTW_PRINT_SEL(sel, "[DFT CAP] HT Bfer : %s\n", (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DFT CAP] HT Bfee : %s\n", (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) ? "V" : "X"); + #endif +} + +void rtw_get_dft_phy_cap(void *sel, _adapter *adapter) +{ + RTW_PRINT_SEL(sel, "\n ======== PHY CAP protocol ========\n"); + rtw_ht_use_default_setting(adapter); + #ifdef CONFIG_80211AC_VHT + rtw_vht_use_default_setting(adapter); + #endif + rtw_dump_dft_phy_cap(sel, adapter); +} + +void rtw_dump_drv_phy_cap(void *sel, _adapter *adapter) +{ + struct registry_priv *pregistry_priv = &adapter->registrypriv; + + RTW_PRINT_SEL(sel, "\n ======== DRV's configuration ========\n"); + #if 0 + RTW_PRINT_SEL(sel, "[DRV CAP] TRx Capability : 0x%08x\n", phy_spec->trx_cap); + RTW_PRINT_SEL(sel, "[DRV CAP] Tx Stream Num Index : %d\n", (phy_spec->trx_cap >> 24) & 0xFF); /*Tx Stream Num Index [31:24]*/ + RTW_PRINT_SEL(sel, "[DRV CAP] Rx Stream Num Index : %d\n", (phy_spec->trx_cap >> 16) & 0xFF); /*Rx Stream Num Index [23:16]*/ + RTW_PRINT_SEL(sel, "[DRV CAP] Tx Path Num Index : %d\n", (phy_spec->trx_cap >> 8) & 0xFF);/*Tx Path Num Index [15:8]*/ + RTW_PRINT_SEL(sel, "[DRV CAP] Rx Path Num Index : %d\n", (phy_spec->trx_cap & 0xFF));/*Rx Path Num Index [7:0]*/ + #endif + + RTW_PRINT_SEL(sel, "[DRV CAP] STBC Capability : 0x%02x\n", pregistry_priv->stbc_cap); + RTW_PRINT_SEL(sel, "[DRV CAP] VHT STBC Tx : %s\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT1)) ? "V" : "X"); /*BIT1: Enable VHT STBC Tx*/ + RTW_PRINT_SEL(sel, "[DRV CAP] VHT STBC Rx : %s\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT0)) ? "V" : "X"); /*BIT0: Enable VHT STBC Rx*/ + RTW_PRINT_SEL(sel, "[DRV CAP] HT STBC Tx : %s\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT5)) ? "V" : "X"); /*BIT5: Enable HT STBC Tx*/ + RTW_PRINT_SEL(sel, "[DRV CAP] HT STBC Rx : %s\n\n", (TEST_FLAG(pregistry_priv->stbc_cap, BIT4)) ? "V" : "X"); /*BIT4: Enable HT STBC Rx*/ + + RTW_PRINT_SEL(sel, "[DRV CAP] LDPC Capability : 0x%02x\n", pregistry_priv->ldpc_cap); + RTW_PRINT_SEL(sel, "[DRV CAP] VHT LDPC Tx : %s\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT1)) ? "V" : "X"); /*BIT1: Enable VHT LDPC Tx*/ + RTW_PRINT_SEL(sel, "[DRV CAP] VHT LDPC Rx : %s\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT0)) ? "V" : "X"); /*BIT0: Enable VHT LDPC Rx*/ + RTW_PRINT_SEL(sel, "[DRV CAP] HT LDPC Tx : %s\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT5)) ? "V" : "X"); /*BIT5: Enable HT LDPC Tx*/ + RTW_PRINT_SEL(sel, "[DRV CAP] HT LDPC Rx : %s\n\n", (TEST_FLAG(pregistry_priv->ldpc_cap, BIT4)) ? "V" : "X"); /*BIT4: Enable HT LDPC Rx*/ + #ifdef CONFIG_BEAMFORMING + #if 0 + RTW_PRINT_SEL(sel, "[DRV CAP] TxBF parameter : 0x%08x\n", phy_spec->txbf_param); + RTW_PRINT_SEL(sel, "[DRV CAP] VHT Sounding Dim : %d\n", (phy_spec->txbf_param >> 24) & 0xFF); /*VHT Sounding Dim [31:24]*/ + RTW_PRINT_SEL(sel, "[DRV CAP] VHT Steering Ant : %d\n", (phy_spec->txbf_param >> 16) & 0xFF); /*VHT Steering Ant [23:16]*/ + RTW_PRINT_SEL(sel, "[DRV CAP] HT Sounding Dim : %d\n", (phy_spec->txbf_param >> 8) & 0xFF); /*HT Sounding Dim [15:8]*/ + RTW_PRINT_SEL(sel, "[DRV CAP] HT Steering Ant : %d\n", phy_spec->txbf_param & 0xFF); /*HT Steering Ant [7:0]*/ + #endif + + /* + * BIT0: Enable VHT SU Beamformer + * BIT1: Enable VHT SU Beamformee + * BIT2: Enable VHT MU Beamformer, depend on VHT SU Beamformer + * BIT3: Enable VHT MU Beamformee, depend on VHT SU Beamformee + * BIT4: Enable HT Beamformer + * BIT5: Enable HT Beamformee + */ + RTW_PRINT_SEL(sel, "[DRV CAP] TxBF Capability : 0x%02x\n", pregistry_priv->beamform_cap); + RTW_PRINT_SEL(sel, "[DRV CAP] VHT MU Bfer : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT2)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DRV CAP] VHT MU Bfee : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT3)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DRV CAP] VHT SU Bfer : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT0)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DRV CAP] VHT SU Bfee : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT1)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DRV CAP] HT Bfer : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT4)) ? "V" : "X"); + RTW_PRINT_SEL(sel, "[DRV CAP] HT Bfee : %s\n", (TEST_FLAG(pregistry_priv->beamform_cap, BIT5)) ? "V" : "X"); + + RTW_PRINT_SEL(sel, "[DRV CAP] Tx Bfer rf_num : %d\n", pregistry_priv->beamformer_rf_num); + RTW_PRINT_SEL(sel, "[DRV CAP] Tx Bfee rf_num : %d\n", pregistry_priv->beamformee_rf_num); + #endif +} + +int proc_get_stbc_cap(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + + if (pregpriv) + RTW_PRINT_SEL(m, "0x%02x\n", pregpriv->stbc_cap); + + return 0; +} + +ssize_t proc_set_stbc_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; + u32 mode; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d ", &mode); + + if (pregpriv) { + pregpriv->stbc_cap = mode; + RTW_INFO("stbc_cap = 0x%02x\n", mode); + } + } + + return count; +} int proc_get_rx_stbc(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2657,6 +3320,88 @@ ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t co return count; } +int proc_get_ldpc_cap(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + + if (pregpriv) + RTW_PRINT_SEL(m, "0x%02x\n", pregpriv->ldpc_cap); + + return 0; +} + +ssize_t proc_set_ldpc_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; + u32 mode; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d ", &mode); + + if (pregpriv) { + pregpriv->ldpc_cap = mode; + RTW_INFO("ldpc_cap = 0x%02x\n", mode); + } + } + + return count; +} +#ifdef CONFIG_BEAMFORMING +int proc_get_txbf_cap(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + + if (pregpriv) + RTW_PRINT_SEL(m, "0x%02x\n", pregpriv->beamform_cap); + + return 0; +} + +ssize_t proc_set_txbf_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; + u32 mode; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d ", &mode); + + if (pregpriv) { + pregpriv->beamform_cap = mode; + RTW_INFO("beamform_cap = 0x%02x\n", mode); + } + } + + return count; +} +#endif #endif /* CONFIG_80211N_HT */ /*int proc_get_rssi_disp(struct seq_file *m, void *v) @@ -2736,16 +3481,19 @@ int proc_get_all_sta_info(struct seq_file *m, void *v) plist = get_next(plist); - /* if(extra_arg == psta->aid) */ + /* if(extra_arg == psta->cmn.aid) */ { RTW_PRINT_SEL(m, "==============================\n"); - RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); + RTW_PRINT_SEL(m, "sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); RTW_PRINT_SEL(m, "rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); - RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); + RTW_PRINT_SEL(m, "state=0x%x, aid=%d, macid=%d, raid=%d\n", + psta->state, psta->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); #ifdef CONFIG_80211N_HT RTW_PRINT_SEL(m, "qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); - RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); + RTW_PRINT_SEL(m, "bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n" + , psta->cmn.bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); RTW_PRINT_SEL(m, "ampdu_enable = %d\n", psta->htpriv.ampdu_enable); + RTW_PRINT_SEL(m, "tx_amsdu_enable = %d\n", psta->htpriv.tx_amsdu_enable); RTW_PRINT_SEL(m, "agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); #endif /* CONFIG_80211N_HT */ RTW_PRINT_SEL(m, "sleepq_len=%d\n", psta->sleepq_len); @@ -2767,12 +3515,21 @@ int proc_get_all_sta_info(struct seq_file *m, void *v) #ifdef CONFIG_TDLS RTW_PRINT_SEL(m, "tdls_sta_state=0x%08x\n", psta->tdls_sta_state); RTW_PRINT_SEL(m, "PeerKey_Lifetime=%d\n", psta->TDLS_PeerKey_Lifetime); - RTW_PRINT_SEL(m, "rx_data_pkts=%llu\n", psta->sta_stats.rx_data_pkts); - RTW_PRINT_SEL(m, "rx_bytes=%llu\n", psta->sta_stats.rx_bytes); +#endif /* CONFIG_TDLS */ + RTW_PRINT_SEL(m, "rx_data_uc_pkts=%llu\n", sta_rx_data_uc_pkts(psta)); + RTW_PRINT_SEL(m, "rx_data_mc_pkts=%llu\n", psta->sta_stats.rx_data_mc_pkts); + RTW_PRINT_SEL(m, "rx_data_bc_pkts=%llu\n", psta->sta_stats.rx_data_bc_pkts); + RTW_PRINT_SEL(m, "rx_uc_bytes=%llu\n", sta_rx_uc_bytes(psta)); + RTW_PRINT_SEL(m, "rx_mc_bytes=%llu\n", psta->sta_stats.rx_mc_bytes); + RTW_PRINT_SEL(m, "rx_bc_bytes=%llu\n", psta->sta_stats.rx_bc_bytes); + RTW_PRINT_SEL(m, "rx_avg_tp =%d (Bps)\n", psta->cmn.rx_moving_average_tp); + RTW_PRINT_SEL(m, "tx_data_pkts=%llu\n", psta->sta_stats.tx_pkts); RTW_PRINT_SEL(m, "tx_bytes=%llu\n", psta->sta_stats.tx_bytes); -#endif /* CONFIG_TDLS */ - + RTW_PRINT_SEL(m, "tx_avg_tp =%d (MBps)\n", psta->cmn.tx_moving_average_tp); +#ifdef CONFIG_RTW_80211K + RTW_PRINT_SEL(m, "rm_en_cap="RM_CAP_FMT"\n", RM_CAP_ARG(psta->rm_en_cap)); +#endif dump_st_ctl(m, &psta->st_ctl); if (STA_OP_WFD_MODE(psta)) @@ -2833,48 +3590,49 @@ int proc_get_best_channel(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; - for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { - if (pmlmeext->channel_set[i].ChannelNum == 1) + for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { + if (rfctl->channel_set[i].ChannelNum == 1) index_24G = i; - if (pmlmeext->channel_set[i].ChannelNum == 36) + if (rfctl->channel_set[i].ChannelNum == 36) index_5G = i; } - for (i = 0; (i < MAX_CHANNEL_NUM) && (pmlmeext->channel_set[i].ChannelNum != 0) ; i++) { + for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { /* 2.4G */ - if (pmlmeext->channel_set[i].ChannelNum == 6) { - if (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count) { + if (rfctl->channel_set[i].ChannelNum == 6) { + if (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_24G].rx_count) { index_24G = i; - best_channel_24G = pmlmeext->channel_set[i].ChannelNum; + best_channel_24G = rfctl->channel_set[i].ChannelNum; } } /* 5G */ - if (pmlmeext->channel_set[i].ChannelNum >= 36 - && pmlmeext->channel_set[i].ChannelNum < 140) { + if (rfctl->channel_set[i].ChannelNum >= 36 + && rfctl->channel_set[i].ChannelNum < 140) { /* Find primary channel */ - if (((pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) - && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { + if (((rfctl->channel_set[i].ChannelNum - 36) % 8 == 0) + && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { index_5G = i; - best_channel_5G = pmlmeext->channel_set[i].ChannelNum; + best_channel_5G = rfctl->channel_set[i].ChannelNum; } } - if (pmlmeext->channel_set[i].ChannelNum >= 149 - && pmlmeext->channel_set[i].ChannelNum < 165) { + if (rfctl->channel_set[i].ChannelNum >= 149 + && rfctl->channel_set[i].ChannelNum < 165) { /* find primary channel */ - if (((pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) - && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { + if (((rfctl->channel_set[i].ChannelNum - 149) % 8 == 0) + && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { index_5G = i; - best_channel_5G = pmlmeext->channel_set[i].ChannelNum; + best_channel_5G = rfctl->channel_set[i].ChannelNum; } } #if 1 /* debug */ RTW_PRINT_SEL(m, "The rx cnt of channel %3d = %d\n", - pmlmeext->channel_set[i].ChannelNum, pmlmeext->channel_set[i].rx_count); + rfctl->channel_set[i].ChannelNum, rfctl->channel_set[i].rx_count); #endif } @@ -2888,6 +3646,7 @@ ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size { struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; char tmp[32]; @@ -2901,8 +3660,8 @@ ssize_t proc_set_best_channel(struct file *file, const char __user *buffer, size if (buffer && !copy_from_user(tmp, buffer, count)) { int i; - for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) - pmlmeext->channel_set[i].rx_count = 0; + for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) + rfctl->channel_set[i].rx_count = 0; RTW_INFO("set %s\n", "Clean Best Channel Count"); } @@ -3005,6 +3764,55 @@ int proc_get_btcoex_info(struct seq_file *m, void *v) return 0; } + +#ifdef CONFIG_RF4CE_COEXIST +int proc_get_rf4ce_state(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + u8 state = 0, voice = 0; + + state = rtw_btcoex_GetRf4ceLinkState(adapter); + + RTW_PRINT_SEL(m, "RF4CE %s\n", state?"Connected":"Disconnect"); + + return 0; +} + +/* This interface is designed for user space application to inform RF4CE state + * Initial define for DHC 1295 E387 project + * + * echo state voice > rf4ce_state + * state + * 0: RF4CE disconnected + * 1: RF4CE connected + */ +ssize_t proc_set_rf4ce_state(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u8 state; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhx", &state); + + if (num >= 1) + rtw_btcoex_SetRf4ceLinkState(adapter, state); + } + + return count; +} +#endif /* CONFIG_RF4CE_COEXIST */ #endif /* CONFIG_BT_COEXIST */ #if defined(DBG_CONFIG_ERROR_DETECT) @@ -3012,8 +3820,23 @@ int proc_get_sreset(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct dvobj_priv *psdpriv = padapter->dvobj; + struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct sreset_priv *psrtpriv = &pHalData->srestpriv; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + if (psrtpriv->dbg_sreset_ctrl == _TRUE) { + RTW_PRINT_SEL(m, "self_dect_tx_cnt:%llu\n", psrtpriv->self_dect_tx_cnt); + RTW_PRINT_SEL(m, "self_dect_rx_cnt:%llu\n", psrtpriv->self_dect_rx_cnt); + RTW_PRINT_SEL(m, "self_dect_fw_cnt:%llu\n", psrtpriv->self_dect_fw_cnt); + RTW_PRINT_SEL(m, "self_dect_scan_cnt:%llu\n", psrtpriv->self_dect_scan_cnt); + RTW_PRINT_SEL(m, "txbuf_empty_cnt:%llu\n", psrtpriv->txbuf_empty_cnt); + RTW_PRINT_SEL(m, "tx_dma_status_cnt:%llu\n", psrtpriv->tx_dma_status_cnt); + RTW_PRINT_SEL(m, "rx_dma_status_cnt:%llu\n", psrtpriv->rx_dma_status_cnt); + RTW_PRINT_SEL(m, "self_dect_case:%d\n", psrtpriv->self_dect_case); + RTW_PRINT_SEL(m, "dbg_sreset_cnt:%d\n", pdbgpriv->dbg_sreset_cnt); + } return 0; } @@ -3021,6 +3844,8 @@ ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t cou { struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct sreset_priv *psrtpriv = &pHalData->srestpriv; char tmp[32]; s32 trigger_point; @@ -3038,6 +3863,8 @@ ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t cou if (trigger_point == SRESET_TGP_NULL) rtw_hal_sreset_reset(padapter); + else if (trigger_point == 99) + psrtpriv->dbg_sreset_ctrl = _TRUE; else sreset_set_trigger_point(padapter, trigger_point); } @@ -3049,6 +3876,63 @@ ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t cou #ifdef CONFIG_PCI_HCI +int proc_get_pci_aspm(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct pci_priv *pcipriv = &(pdvobjpriv->pcipriv); + u8 tmp8 = 0; + u16 tmp16 = 0; + u32 tmp32 = 0; + u8 l1_idle = 0; + + + RTW_PRINT_SEL(m, "***** ASPM Capability *****\n"); + + pci_read_config_dword(pdvobjpriv->ppcidev, pcipriv->pciehdr_offset + PCI_EXP_LNKCAP, &tmp32); + + RTW_PRINT_SEL(m, "CLK REQ: %s\n", (tmp32&PCI_EXP_LNKCAP_CLKPM) ? "Enable" : "Disable"); + RTW_PRINT_SEL(m, "ASPM L0s: %s\n", (tmp32&BIT10) ? "Enable" : "Disable"); + RTW_PRINT_SEL(m, "ASPM L1: %s\n", (tmp32&BIT11) ? "Enable" : "Disable"); + + tmp8 = rtw_hal_pci_l1off_capability(padapter); + RTW_PRINT_SEL(m, "ASPM L1OFF: %s\n", tmp8 ? "Enable" : "Disable"); + + RTW_PRINT_SEL(m, "***** ASPM CTRL Reg *****\n"); + + pci_read_config_word(pdvobjpriv->ppcidev, pcipriv->pciehdr_offset + PCI_EXP_LNKCTL, &tmp16); + + RTW_PRINT_SEL(m, "CLK REQ: %s\n", (tmp16&PCI_EXP_LNKCTL_CLKREQ_EN) ? "Enable" : "Disable"); + RTW_PRINT_SEL(m, "ASPM L0s: %s\n", (tmp16&BIT0) ? "Enable" : "Disable"); + RTW_PRINT_SEL(m, "ASPM L1: %s\n", (tmp16&BIT1) ? "Enable" : "Disable"); + + tmp8 = rtw_hal_pci_l1off_nic_support(padapter); + RTW_PRINT_SEL(m, "ASPM L1OFF: %s\n", tmp8 ? "Enable" : "Disable"); + + RTW_PRINT_SEL(m, "***** ASPM Backdoor *****\n"); + + tmp8 = rtw_hal_pci_dbi_read(padapter, 0x719); + RTW_PRINT_SEL(m, "CLK REQ: %s\n", (tmp8 & BIT4) ? "Enable" : "Disable"); + + tmp8 = rtw_hal_pci_dbi_read(padapter, 0x70f); + l1_idle = tmp8 & 0x38; + RTW_PRINT_SEL(m, "ASPM L0s: %s\n", (tmp8&BIT7) ? "Enable" : "Disable"); + + tmp8 = rtw_hal_pci_dbi_read(padapter, 0x719); + RTW_PRINT_SEL(m, "ASPM L1: %s\n", (tmp8 & BIT3) ? "Enable" : "Disable"); + + tmp8 = rtw_hal_pci_dbi_read(padapter, 0x718); + RTW_PRINT_SEL(m, "ASPM L1OFF: %s\n", (tmp8 & BIT5) ? "Enable" : "Disable"); + + RTW_PRINT_SEL(m, "********* MISC **********\n"); + RTW_PRINT_SEL(m, "ASPM L1 Idel Time: 0x%x\n", l1_idle>>3); + RTW_PRINT_SEL(m, "*************************\n"); + + return 0; +} + int proc_get_rx_ring(struct seq_file *m, void *v) { _irqL irqL; @@ -3113,11 +3997,12 @@ int proc_get_tx_ring(struct seq_file *m, void *v) for (j = 0; j < pxmitpriv->txringcount[i]; j++) { #ifdef CONFIG_TRX_BD_ARCH struct tx_buf_desc *entry = &tx_ring->buf_desc[j]; + RTW_PRINT_SEL(m, " buf_desc[%03d]: %p\n", j, entry); #else struct tx_desc *entry = &tx_ring->desc[j]; + RTW_PRINT_SEL(m, " desc[%03d]: %p\n", j, entry); #endif - RTW_PRINT_SEL(m, " desc[%03d]: %p\n", j, entry); for (k = 0; k < sizeof(*entry) / 4; k++) { if ((k % 4) == 0) RTW_PRINT_SEL(m, " 0x%03x", k); @@ -3133,6 +4018,152 @@ int proc_get_tx_ring(struct seq_file *m, void *v) return 0; } + +#ifdef DBG_TXBD_DESC_DUMP +int proc_get_tx_ring_ext(struct seq_file *m, void *v) +{ + _irqL irqL; + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *) rtw_netdev_priv(dev); + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct rtw_tx_desc_backup *pbuf; + int i, j, k, idx; + + RTW_PRINT_SEL(m, "<<<< tx ring ext dump settings >>>>\n"); + RTW_PRINT_SEL(m, " - backup frame num: %d\n", TX_BAK_FRMAE_CNT); + RTW_PRINT_SEL(m, " - backup max. desc size: %d bytes\n", TX_BAK_DESC_LEN); + RTW_PRINT_SEL(m, " - backup data size: %d bytes\n\n", TX_BAK_DATA_LEN); + + if (!pxmitpriv->dump_txbd_desc) { + RTW_PRINT_SEL(m, "Dump function is disabled.\n"); + return 0; + } + + _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); + for (i = 0; i < HW_QUEUE_ENTRY; i++) { + struct rtw_tx_ring *tx_ring = &pxmitpriv->tx_ring[i]; + + idx = rtw_get_tx_desc_backup(padapter, i, &pbuf); + + RTW_PRINT_SEL(m, "Tx ring[%d]", i); + switch (i) { + case 0: + RTW_PRINT_SEL(m, " (VO)\n"); + break; + case 1: + RTW_PRINT_SEL(m, " (VI)\n"); + break; + case 2: + RTW_PRINT_SEL(m, " (BE)\n"); + break; + case 3: + RTW_PRINT_SEL(m, " (BK)\n"); + break; + case 4: + RTW_PRINT_SEL(m, " (BCN)\n"); + break; + case 5: + RTW_PRINT_SEL(m, " (MGT)\n"); + break; + case 6: + RTW_PRINT_SEL(m, " (HIGH)\n"); + break; + case 7: + RTW_PRINT_SEL(m, " (TXCMD)\n"); + break; + default: + RTW_PRINT_SEL(m, " (?)\n"); + break; + } + + RTW_PRINT_SEL(m, " Entries: %d\n", TX_BAK_FRMAE_CNT); + RTW_PRINT_SEL(m, " Last idx: %d\n", idx); + + for (j = 0; j < TX_BAK_FRMAE_CNT; j++) { + RTW_PRINT_SEL(m, " desc[%03d]:\n", j); + + for (k = 0; k < (pbuf->tx_desc_size) / 4; k++) { + if ((k % 4) == 0) + RTW_PRINT_SEL(m, " 0x%03x", k); + + RTW_PRINT_SEL(m, " 0x%08x ", ((int *)pbuf->tx_bak_desc)[k]); + + if ((k % 4) == 3) + RTW_PRINT_SEL(m, "\n"); + } + +#if 1 /* data dump */ + if (pbuf->tx_desc_size) { + RTW_PRINT_SEL(m, " data[%03d]:\n", j); + + for (k = 0; k < (TX_BAK_DATA_LEN) / 4; k++) { + if ((k % 4) == 0) + RTW_PRINT_SEL(m, " 0x%03x", k); + + RTW_PRINT_SEL(m, " 0x%08x ", ((int *)pbuf->tx_bak_data_hdr)[k]); + + if ((k % 4) == 3) + RTW_PRINT_SEL(m, "\n"); + } + RTW_PRINT_SEL(m, "\n"); + } +#endif + + RTW_PRINT_SEL(m, " R/W pointer: %d/%d\n", pbuf->tx_bak_rp, pbuf->tx_bak_wp); + + pbuf = pbuf + 1; + } + RTW_PRINT_SEL(m, "\n"); + } + _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); + + return 0; +} + +ssize_t proc_set_tx_ring_ext(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + _irqL irqL; + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + char tmp[32]; + u32 reset = 0; + u32 dump = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%u %u", &dump, &reset); + + if (num != 2) { + RTW_INFO("invalid parameter!\n"); + return count; + } + + _enter_critical(&pdvobjpriv->irq_th_lock, &irqL); + pxmitpriv->dump_txbd_desc = (BOOLEAN) dump; + + if (reset == 1) + rtw_tx_desc_backup_reset(); + + _exit_critical(&pdvobjpriv->irq_th_lock, &irqL); + + } + + return count; +} + +#endif + #endif #ifdef CONFIG_WOWLAN @@ -3159,7 +4190,7 @@ int proc_get_pattern_info(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "\n======[Pattern Info.]======\n"); RTW_PRINT_SEL(m, "pattern number: %d\n", total); RTW_PRINT_SEL(m, "support default patterns: %c\n", - (pregistrypriv->default_patterns_en) ? 'Y' : 'N'); + (pwrpriv->default_patterns_en) ? 'Y' : 'N'); for (k = 0; k < total ; k++) { RTW_PRINT_SEL(m, "\npattern idx: %d\n", k); @@ -3196,6 +4227,7 @@ int proc_get_pattern_info(struct seq_file *m, void *v) return 0; } + ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { @@ -3217,7 +4249,7 @@ ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, return -EFAULT; } - if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_NUM) { + if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_CAM_NUM) { RTW_INFO("WARNING: priv-pattern is full(idx: %d)\n", pwrpriv->wowlan_pattern_idx); RTW_INFO("WARNING: please clean priv-pattern first\n"); @@ -3243,6 +4275,62 @@ ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, return count; } +int proc_get_wakeup_event(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *registry_par = &padapter->registrypriv; + + RTW_PRINT_SEL(m, "wakeup event: %#02x\n", registry_par->wakeup_event); + return 0; +} + +ssize_t proc_set_wakeup_event(struct file *file, const char __user *buffer, + size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); + struct registry_priv *registry_par = &padapter->registrypriv; + u32 wakeup_event = 0; + + u8 tmp[8] = {0}; + int ret = 0, num = 0; + u8 index = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) + num = sscanf(tmp, "%u", &wakeup_event); + else + return -EFAULT; + + if (wakeup_event <= 0x07) { + registry_par->wakeup_event = wakeup_event; + + if (wakeup_event & BIT(1)) + pwrctrlpriv->default_patterns_en = _TRUE; + else + pwrctrlpriv->default_patterns_en = _FALSE; + + rtw_wow_pattern_sw_reset(padapter); + + RTW_INFO("%s: wakeup_event: %#2x, default pattern: %d\n", + __func__, registry_par->wakeup_event, + pwrctrlpriv->default_patterns_en); + } else { + return -EINVAL; + } + + return count; +} + int proc_get_wakeup_reason(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -3253,7 +4341,7 @@ int proc_get_wakeup_reason(struct seq_file *m, void *v) RTW_PRINT_SEL(m, "last wake reason: %#02x\n", val); return 0; } -#endif +#endif /*CONFIG_WOWLAN*/ #ifdef CONFIG_GPIO_WAKEUP int proc_get_wowlan_gpio_info(struct seq_file *m, void *v) @@ -3298,8 +4386,16 @@ ssize_t proc_set_wowlan_gpio_info(struct file *file, const char __user *buffer, rtw_ps_deny(padapter, PS_DENY_IOCTL); LeaveAllPowerSaveModeDirect(padapter); + + #ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE + if (pwrpriv->is_high_active == 0) + rtw_hal_set_input_gpio(padapter, WAKEUP_GPIO_IDX); + else + rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, 0); + #else val8 = (pwrpriv->is_high_active == 0) ? 1 : 0; rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); + #endif rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); RTW_INFO("set %s %d\n", "gpio_high_active", @@ -3379,6 +4475,7 @@ int proc_get_ps_info(struct seq_file *m, void *v) struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); u8 ips_mode = pwrpriv->ips_mode; u8 lps_mode = pwrpriv->power_mgnt; + u8 lps_level = pwrpriv->lps_level; char *str = ""; RTW_PRINT_SEL(m, "======Power Saving Info:======\n"); @@ -3420,12 +4517,142 @@ int proc_get_ps_info(struct seq_file *m, void *v) RTW_PRINT_SEL(m, " DTIM: %d\n", pwrpriv->dtim); RTW_PRINT_SEL(m, " LPS enter count:%d, LPS leave count:%d\n", pwrpriv->lps_enter_cnts, pwrpriv->lps_leave_cnts); + + if (lps_level == LPS_LCLK) + str = "LPS_LCLK"; + else if (lps_level == LPS_PG) + str = "LPS_PG"; + else + str = "LPS_NORMAL"; + RTW_PRINT_SEL(m, " LPS level: %s\n", str); + RTW_PRINT_SEL(m, "=============================\n"); return 0; } + +#ifdef CONFIG_WMMPS_STA +int proc_get_wmmps_info(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char *uapsd_max_sp_str=""; + + if (pregpriv){ + switch(pregpriv->uapsd_max_sp_len) { + case 0: + uapsd_max_sp_str = "NO_LIMIT"; + break; + case 1: + uapsd_max_sp_str = "TWO_MSDU"; + break; + case 2: + uapsd_max_sp_str = "FOUR_MSDU"; + break; + case 3: + uapsd_max_sp_str = "SIX_MSDU"; + break; + default: + uapsd_max_sp_str = "UNSPECIFIED"; + break; + } + + RTW_PRINT_SEL(m, "====== WMMPS_STA Info:======\n"); + RTW_PRINT_SEL(m, "uapsd_max_sp_len=0x%02x (%s)\n", pregpriv->uapsd_max_sp_len, uapsd_max_sp_str); + RTW_PRINT_SEL(m, "uapsd_ac_enable=0x%02x\n", pregpriv->uapsd_ac_enable); + RTW_PRINT_SEL(m, "BIT0 - AC_VO UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_VO) ? "Enabled" : "Disabled"); + RTW_PRINT_SEL(m, "BIT1 - AC_VI UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_VI) ? "Enabled" : "Disabled"); + RTW_PRINT_SEL(m, "BIT2 - AC_BK UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_BK) ? "Enabled" : "Disabled"); + RTW_PRINT_SEL(m, "BIT3 - AC_BE UAPSD: %s\n", (pregpriv->uapsd_ac_enable & DRV_CFG_UAPSD_BE) ? "Enabled" : "Disabled"); + RTW_PRINT_SEL(m, "============================\n"); + } + + return 0; +} + +ssize_t proc_set_wmmps_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; + u8 uapsd_ac_setting; + u8 uapsd_max_sp_len_setting; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhu %hhx", &uapsd_max_sp_len_setting, &uapsd_ac_setting); + + if (pregpriv) { + if (num >= 1){ + pregpriv->uapsd_max_sp_len = uapsd_max_sp_len_setting; + RTW_INFO("uapsd_max_sp_len = %d\n", pregpriv->uapsd_max_sp_len); + } + + if (num >= 2){ + pregpriv->uapsd_ac_enable = uapsd_ac_setting; + RTW_INFO("uapsd_ac_enable = 0x%02x\n", pregpriv->uapsd_ac_enable); + } + } + } + + return count; +} +#endif /* CONFIG_WMMPS_STA */ #endif /* CONFIG_POWER_SAVING */ #ifdef CONFIG_TDLS +int proc_get_tdls_enable(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + + if (pregpriv) + RTW_PRINT_SEL(m, "TDLS is %s !\n", (rtw_is_tdls_enabled(padapter) == _TRUE) ? "enabled" : "disabled"); + + return 0; +} + +ssize_t proc_set_tdls_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregpriv = &padapter->registrypriv; + char tmp[32]; + u32 en_tdls = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d ", &en_tdls); + + if (pregpriv) { + if (en_tdls > 0) + rtw_enable_tdls_func(padapter); + else + rtw_disable_tdls_func(padapter, _FALSE); + } + } + + return count; +} + static int proc_tdls_display_tdls_function_info(struct seq_file *m) { struct net_device *dev = m->private; @@ -3437,6 +4664,8 @@ static int proc_tdls_display_tdls_function_info(struct seq_file *m) int j = 0; RTW_PRINT_SEL(m, "============[TDLS Function Info]============\n"); + RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Enable", (rtw_is_tdls_enabled(padapter) == _TRUE) ? "_TRUE" : "_FALSE"); + RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Driver Setup", (ptdlsinfo->driver_setup == _TRUE) ? "_TRUE" : "_FALSE"); RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Prohibited", (ptdlsinfo->ap_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Channel Switch Prohibited", (ptdlsinfo->ch_switch_prohibited == _TRUE) ? "_TRUE" : "_FALSE"); RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Link Established", (ptdlsinfo->link_established == _TRUE) ? "_TRUE" : "_FALSE"); @@ -3500,8 +4729,6 @@ static int proc_tdls_display_tdls_function_info(struct seq_file *m) #endif RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Device Discovered", (ptdlsinfo->dev_discovered == _TRUE) ? "_TRUE" : "_FALSE"); - RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Enable", (ptdlsinfo->tdls_enable == _TRUE) ? "_TRUE" : "_FALSE"); - RTW_PRINT_SEL(m, "%-*s = %s\n", SpaceBtwnItemAndValue, "TDLS Driver Setup", (ptdlsinfo->driver_setup == _TRUE) ? "_TRUE" : "_FALSE"); return 0; } @@ -3650,7 +4877,7 @@ static int proc_tdls_display_tdls_sta_info(struct seq_file *m) if (psta->tdls_sta_state != TDLS_STATE_NONE) { /* We got one TDLS sta info to show */ RTW_PRINT_SEL(m, "============[TDLS Peer STA Info: STA %d]============\n", ++NumOfTdlsStaToShow); - RTW_PRINT_SEL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(psta->hwaddr)); + RTW_PRINT_SEL(m, "%-*s = "MAC_FMT"\n", SpaceBtwnItemAndValue, "Mac Address", MAC_ARG(psta->cmn.mac_addr)); RTW_PRINT_SEL(m, "%-*s =", SpaceBtwnItemAndValue, "TDLS STA State"); SpaceBtwnItemAndValueTmp = 0; FirstMatchFound = _FALSE; @@ -3727,7 +4954,7 @@ static int proc_tdls_display_tdls_sta_info(struct seq_file *m) RTW_PRINT_SEL(m, "\n"); RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Bandwidth Mode"); - switch (psta->bw_mode) { + switch (psta->cmn.bw_mode) { case CHANNEL_WIDTH_20: RTW_PRINT_SEL(m, "%s\n", "20MHz"); break; @@ -3743,6 +4970,15 @@ static int proc_tdls_display_tdls_sta_info(struct seq_file *m) case CHANNEL_WIDTH_80_80: RTW_PRINT_SEL(m, "%s\n", "80MHz + 80MHz"); break; + case CHANNEL_WIDTH_5: + RTW_PRINT_SEL(m, "%s\n", "5MHz"); + break; + case CHANNEL_WIDTH_10: + RTW_PRINT_SEL(m, "%s\n", "10MHz"); + break; + default: + RTW_PRINT_SEL(m, "(%d)%s\n", psta->cmn.bw_mode, "invalid"); + break; } RTW_PRINT_SEL(m, "%-*s = ", SpaceBtwnItemAndValue, "Privacy"); @@ -3873,6 +5109,52 @@ ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t co return count; } +#ifdef DBG_XMIT_BLOCK +int proc_get_xmit_block(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + dump_xmit_block(m, padapter); + + return 0; +} + +ssize_t proc_set_xmit_block(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u8 xb_mode, xb_reason; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhx %hhx", &xb_mode, &xb_reason); + + if (num != 2) { + RTW_INFO("invalid parameter!\n"); + return count; + } + + if (xb_mode == 0)/*set*/ + rtw_set_xmit_block(padapter, xb_reason); + else if (xb_mode == 1)/*clear*/ + rtw_clr_xmit_block(padapter, xb_reason); + else + RTW_INFO("invalid parameter!\n"); + } + + return count; +} +#endif #include int proc_get_efuse_map(struct seq_file *m, void *v) @@ -4032,7 +5314,7 @@ ssize_t proc_set_tx_sa_query(struct file *file, const char __user *buffer, size_ while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); plist = get_next(plist); - _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); + _rtw_memcpy(&mac_addr[psta->cmn.mac_id][0], psta->cmn.mac_addr, ETH_ALEN); } } _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); @@ -4120,7 +5402,7 @@ ssize_t proc_set_tx_deauth(struct file *file, const char __user *buffer, size_t while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); plist = get_next(plist); - _rtw_memcpy(&mac_addr[psta->mac_id][0], psta->hwaddr, ETH_ALEN); + _rtw_memcpy(&mac_addr[psta->cmn.mac_id][0], psta->cmn.mac_addr, ETH_ALEN); } } _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); @@ -4236,6 +5518,86 @@ int proc_get_mcc_info(struct seq_file *m, void *v) return 0; } +int proc_get_mcc_policy_table(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + rtw_hal_dump_mcc_policy_table(m); + return 0; +} + +ssize_t proc_set_mcc_policy_table(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[255]; + s32 mcc_policy_table_idx; + u32 mcc_duration; + u32 mcc_tsf_sync_offset; + u32 mcc_start_time_offset; + u32 mcc_interval; + s32 mcc_guard_offset0; + s32 mcc_guard_offset1; + + if (NULL == buffer) { + RTW_INFO(FUNC_ADPT_FMT ": input buffer is NULL!\n", FUNC_ADPT_ARG(padapter)); + return -EFAULT; + } + + if (count < 1) { + RTW_INFO(FUNC_ADPT_FMT ": input length is 0!\n", FUNC_ADPT_ARG(padapter)); + return -EFAULT; + } + + if (count > sizeof(tmp)) { + RTW_INFO(FUNC_ADPT_FMT ": input length is too large\n", FUNC_ADPT_ARG(padapter)); + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + #if 1 + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + _adapter *iface = NULL; + u8 i = 0; + int num = sscanf(tmp, "%d %u %u %u %u %d %d" + , &mcc_policy_table_idx, &mcc_duration, &mcc_tsf_sync_offset, &mcc_start_time_offset + , &mcc_interval, &mcc_guard_offset0, &mcc_guard_offset1); + + if (num < 7) { + RTW_INFO(FUNC_ADPT_FMT ": input parameters < 7\n", FUNC_ADPT_ARG(padapter)); + return -EINVAL; + } +#if 0 + RTW_INFO("mcc_policy_table_idx:%d\n", mcc_policy_table_idx); + RTW_INFO("mcc_duration:%d\n", mcc_duration); + RTW_INFO("mcc_tsf_sync_offset:%d\n", mcc_tsf_sync_offset); + RTW_INFO("mcc_start_time_offset:%d\n", mcc_start_time_offset); + RTW_INFO("mcc_interval:%d\n", mcc_interval); + RTW_INFO("mcc_guard_offset0:%d\n", mcc_guard_offset0); + RTW_INFO("mcc_guard_offset1:%d\n", mcc_guard_offset1); +#endif + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + iface->registrypriv.rtw_mcc_policy_table_idx = mcc_policy_table_idx; + iface->registrypriv.rtw_mcc_duration = mcc_duration; + iface->registrypriv.rtw_mcc_tsf_sync_offset = mcc_tsf_sync_offset; + iface->registrypriv.rtw_mcc_start_time_offset = mcc_start_time_offset; + iface->registrypriv.rtw_mcc_interval = mcc_interval; + iface->registrypriv.rtw_mcc_guard_offset0 = mcc_guard_offset0; + iface->registrypriv.rtw_mcc_guard_offset1 = mcc_guard_offset1; + } + + rtw_hal_mcc_update_switch_channel_policy_table(padapter); + #endif + } + + return count; +} + ssize_t proc_set_mcc_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; @@ -4580,4 +5942,304 @@ ssize_t proc_set_mcc_sta_bw80_target_tp(struct file *file, const char __user *bu } #endif /* CONFIG_MCC_MODE */ +int proc_get_ack_timeout(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u8 ack_timeout_val, ack_timeout_val_cck; + + ack_timeout_val = rtw_read8(padapter, REG_ACKTO); + +#ifdef CONFIG_RTL8821C + ack_timeout_val_cck = rtw_read8(padapter, REG_ACKTO_CCK_8821C); + RTW_PRINT_SEL(m, "Current CCK packet ACK Timeout = %d us (0x%x).\n", ack_timeout_val_cck, ack_timeout_val_cck); + RTW_PRINT_SEL(m, "Current non-CCK packet ACK Timeout = %d us (0x%x).\n", ack_timeout_val, ack_timeout_val); +#else + RTW_PRINT_SEL(m, "Current ACK Timeout = %d us (0x%x).\n", ack_timeout_val, ack_timeout_val); +#endif + + return 0; +} + +ssize_t proc_set_ack_timeout(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u32 ack_timeout_ms, ack_timeout_ms_cck; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + int num = sscanf(tmp, "%u %u", &ack_timeout_ms, &ack_timeout_ms_cck); + +#ifdef CONFIG_RTL8821C + if (num < 2) { + RTW_INFO(FUNC_ADPT_FMT ": input parameters < 2\n", FUNC_ADPT_ARG(padapter)); + return -EINVAL; + } +#else + if (num < 1) { + RTW_INFO(FUNC_ADPT_FMT ": input parameters < 1\n", FUNC_ADPT_ARG(padapter)); + return -EINVAL; + } +#endif + /* This register sets the Ack time out value after Tx unicast packet. It is in units of us. */ + rtw_write8(padapter, REG_ACKTO, (u8)ack_timeout_ms); + +#ifdef CONFIG_RTL8821C + /* This register sets the Ack time out value after Tx unicast CCK packet. It is in units of us. */ + rtw_write8(padapter, REG_ACKTO_CCK_8821C, (u8)ack_timeout_ms_cck); + RTW_INFO("Set CCK packet ACK Timeout to %d us.\n", ack_timeout_ms_cck); + RTW_INFO("Set non-CCK packet ACK Timeout to %d us.\n", ack_timeout_ms); +#else + RTW_INFO("Set ACK Timeout to %d us.\n", ack_timeout_ms); +#endif + } + + return count; +} + +ssize_t proc_set_iqk_fw_offload(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + _adapter *pri_adapter = GET_PRIMARY_ADAPTER(adapter); + HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); + char tmp[32]; + u32 enable = 0; + + if (buffer == NULL) { + RTW_INFO("input buffer is NULL!\n"); + return -EFAULT; + } + + if (count < 1) { + RTW_INFO("input length is 0!\n"); + return -EFAULT; + } + + if (count > sizeof(tmp)) { + RTW_INFO("input length is too large\n"); + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + int num = sscanf(tmp, "%d", &enable); + + if (num < 1) { + RTW_INFO("input parameters < 1\n"); + return -EINVAL; + } + + if (hal->RegIQKFWOffload != enable) { + hal->RegIQKFWOffload = enable; + rtw_hal_update_iqk_fw_offload_cap(pri_adapter); + } + } + + return count; +} + +int proc_get_iqk_fw_offload(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + HAL_DATA_TYPE *hal = GET_HAL_DATA(adapter); + + + RTW_PRINT_SEL(m, "IQK FW offload:%s\n", hal->RegIQKFWOffload?"enable":"disable"); + return 0; +} + +#ifdef CONFIG_DBG_RF_CAL +int proc_get_iqk_info(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + return 0; +} + +ssize_t proc_set_iqk(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u32 recovery, clear, segment; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d %d %d", &recovery, &clear, &segment); + + rtw_hal_iqk_test(padapter, recovery, clear, segment); + } + + return count; + +} + +int proc_get_lck_info(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + return 0; +} + +ssize_t proc_set_lck(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u32 trigger; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%d", &trigger); + + rtw_hal_lck_test(padapter); + } + + return count; +} +#endif /* CONFIG_DBG_RF_CAL */ + #endif /* CONFIG_PROC_DEBUG */ +#define RTW_BUFDUMP_BSIZE 16 +#if 1 +inline void RTW_BUF_DUMP_SEL(uint _loglevel, void *sel, u8 *_titlestring, + bool _idx_show, const u8 *_hexdata, int _hexdatalen) +{ + int __i; + u8 *ptr = (u8 *)_hexdata; + + if (_loglevel <= rtw_drv_log_level) { + if (_titlestring) { + if (sel == RTW_DBGDUMP) + _RTW_PRINT_SEL(sel, "%s", DRIVER_PREFIX); + _RTW_PRINT_SEL(sel, "%s", _titlestring); + if (_hexdatalen >= RTW_BUFDUMP_BSIZE) + _RTW_PRINT_SEL(sel, "\n"); + } + + for (__i = 0; __i < _hexdatalen; __i++) { + if (((__i % RTW_BUFDUMP_BSIZE) == 0) && (_hexdatalen >= RTW_BUFDUMP_BSIZE)) { + if (sel == RTW_DBGDUMP) + _RTW_PRINT_SEL(sel, "%s", DRIVER_PREFIX); + if (_idx_show) + _RTW_PRINT_SEL(sel, "0x%03X: ", __i); + } + _RTW_PRINT_SEL(sel, "%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); + if (((__i + 1) % RTW_BUFDUMP_BSIZE) == 0) + _RTW_PRINT_SEL(sel, "\n"); + } + _RTW_PRINT_SEL(sel, "\n"); + } +} +#else +inline void _RTW_STR_DUMP_SEL(void *sel, char *str_out) +{ + if (sel == RTW_DBGDUMP) + _dbgdump("%s\n", str_out); + #if defined(_seqdump) + else + _seqdump(sel, "%s\n", str_out); + #endif /*_seqdump*/ +} +inline void RTW_BUF_DUMP_SEL(uint _loglevel, void *sel, u8 *_titlestring, + bool _idx_show, u8 *_hexdata, int _hexdatalen) +{ + int __i, len; + int __j, idx; + int block_num, remain_byte; + char str_out[128] = {'\0'}; + char str_val[32] = {'\0'}; + char *p = NULL; + u8 *ptr = (u8 *)_hexdata; + + if (_loglevel <= rtw_drv_log_level) { + /*dump title*/ + p = &str_out[0]; + if (_titlestring) { + if (sel == RTW_DBGDUMP) { + len = snprintf(str_val, sizeof(str_val), "%s", DRIVER_PREFIX); + strncpy(p, str_val, len); + p += len; + } + len = snprintf(str_val, sizeof(str_val), "%s", _titlestring); + strncpy(p, str_val, len); + p += len; + } + if (p != &str_out[0]) { + _RTW_STR_DUMP_SEL(sel, str_out); + _rtw_memset(&str_out, '\0', sizeof(str_out)); + } + + /*dump buffer*/ + block_num = _hexdatalen / RTW_BUFDUMP_BSIZE; + remain_byte = _hexdatalen % RTW_BUFDUMP_BSIZE; + for (__i = 0; __i < block_num; __i++) { + p = &str_out[0]; + if (sel == RTW_DBGDUMP) { + len = snprintf(str_val, sizeof(str_val), "%s", DRIVER_PREFIX); + strncpy(p, str_val, len); + p += len; + } + if (_idx_show) { + len = snprintf(str_val, sizeof(str_val), "0x%03X: ", __i * RTW_BUFDUMP_BSIZE); + strncpy(p, str_val, len); + p += len; + } + for (__j =0; __j < RTW_BUFDUMP_BSIZE; __j++) { + idx = __i * RTW_BUFDUMP_BSIZE + __j; + len = snprintf(str_val, sizeof(str_val), "%02X%s", ptr[idx], (((__j + 1) % 4) == 0) ? " " : " "); + strncpy(p, str_val, len); + p += len; + } + _RTW_STR_DUMP_SEL(sel, str_out); + _rtw_memset(&str_out, '\0', sizeof(str_out)); + } + + p = &str_out[0]; + if ((sel == RTW_DBGDUMP) && remain_byte) { + len = snprintf(str_val, sizeof(str_val), "%s", DRIVER_PREFIX); + strncpy(p, str_val, len); + p += len; + } + if (_idx_show && remain_byte) { + len = snprintf(str_val, sizeof(str_val), "0x%03X: ", block_num * RTW_BUFDUMP_BSIZE); + strncpy(p, str_val, len); + p += len; + } + for (__i = 0; __i < remain_byte; __i++) { + idx = block_num * RTW_BUFDUMP_BSIZE + __i; + len = snprintf(str_val, sizeof(str_val), "%02X%s", ptr[idx], (((__i + 1) % 4) == 0) ? " " : " "); + strncpy(p, str_val, len); + p += len; + } + _RTW_STR_DUMP_SEL(sel, str_out); + } +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_eeprom.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_eeprom.c index d7bca033fee1..d48996e86182 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_eeprom.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_eeprom.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_EEPROM_C_ #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ieee80211.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ieee80211.c index f9f319a910ef..bc95728db3a7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ieee80211.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ieee80211.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _IEEE80211_C #ifdef CONFIG_PLATFORM_INTEL_BYT @@ -853,23 +848,26 @@ u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen) return match; } -u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type) +u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, enum bss_type frame_type) { u8 *wps = NULL; RTW_INFO("[%s] frame_type = %d\n", __FUNCTION__, frame_type); switch (frame_type) { - case 1: - case 3: { + case BSS_TYPE_BCN: + case BSS_TYPE_PROB_RSP: { /* Beacon or Probe Response */ wps = rtw_get_wps_ie(in_ie + _PROBERSP_IE_OFFSET_, in_len - _PROBERSP_IE_OFFSET_, wps_ie, wps_ielen); break; } - case 2: { + case BSS_TYPE_PROB_REQ: { /* Probe Request */ wps = rtw_get_wps_ie(in_ie + _PROBEREQ_IE_OFFSET_ , in_len - _PROBEREQ_IE_OFFSET_ , wps_ie, wps_ielen); break; } + default: + case BSS_TYPE_UNDEF: + break; } return wps; } @@ -1236,6 +1234,10 @@ ParseRes rtw_ieee802_11_parse_elems(u8 *start, uint len, elems->vht_op_mode_notify = pos; elems->vht_op_mode_notify_len = elen; break; + case _EID_RRM_EN_CAP_IE_: + elems->rm_en_cap = pos; + elems->rm_en_cap_len = elen; + break; default: unknown++; if (!show_errors) @@ -2589,13 +2591,43 @@ u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set) return nss; } +u32 rtw_ht_mcs_set_to_bitmap(u8 *mcs_set, u8 nss) +{ + u8 i; + u32 bitmap = 0; + + for (i = 0; i < nss; i++) + bitmap |= mcs_set[i] << (i * 8); + + RTW_INFO("ht_mcs_set=%02x %02x %02x %02x, nss=%u, bitmap=%08x\n" + , mcs_set[0], mcs_set[1], mcs_set[2], mcs_set[3], nss, bitmap); + + return bitmap; +} + /* show MCS rate, unit: 100Kbps */ u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate) { u16 max_rate = 0; - /*MCS_rate[2] = 3T3R , MCS_rate[1] = 2T2R , MCS_rate[0] = 1T1R*/ - if (MCS_rate[2]) { + if (MCS_rate[3]) { + if (MCS_rate[3] & BIT(7)) + max_rate = (bw_40MHz) ? ((short_GI) ? 6000 : 5400) : ((short_GI) ? 2889 : 2600); + else if (MCS_rate[3] & BIT(6)) + max_rate = (bw_40MHz) ? ((short_GI) ? 5400 : 4860) : ((short_GI) ? 2600 : 2340); + else if (MCS_rate[3] & BIT(5)) + max_rate = (bw_40MHz) ? ((short_GI) ? 4800 : 4320) : ((short_GI) ? 2311 : 2080); + else if (MCS_rate[3] & BIT(4)) + max_rate = (bw_40MHz) ? ((short_GI) ? 3600 : 3240) : ((short_GI) ? 1733 : 1560); + else if (MCS_rate[3] & BIT(3)) + max_rate = (bw_40MHz) ? ((short_GI) ? 2400 : 2160) : ((short_GI) ? 1156 : 1040); + else if (MCS_rate[3] & BIT(2)) + max_rate = (bw_40MHz) ? ((short_GI) ? 1800 : 1620) : ((short_GI) ? 867 : 780); + else if (MCS_rate[3] & BIT(1)) + max_rate = (bw_40MHz) ? ((short_GI) ? 1200 : 1080) : ((short_GI) ? 578 : 520); + else if (MCS_rate[3] & BIT(0)) + max_rate = (bw_40MHz) ? ((short_GI) ? 600 : 540) : ((short_GI) ? 289 : 260); + } else if (MCS_rate[2]) { if (MCS_rate[2] & BIT(7)) max_rate = (bw_40MHz) ? ((short_GI) ? 4500 : 4050) : ((short_GI) ? 2167 : 1950); else if (MCS_rate[2] & BIT(6)) @@ -2707,3 +2739,4 @@ const char *action_public_str(u8 action) action = (action >= ACT_PUBLIC_MAX) ? ACT_PUBLIC_MAX : action; return _action_public_str[action]; } + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_io.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_io.c index 683da1694754..cb8e6b8c0ed9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_io.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_io.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /* The purpose of rtw_io.c @@ -56,7 +51,7 @@ jackson@realtek.com.tw #error "Shall be Linux or Windows, but not both!\n" #endif -#ifdef CONFIG_SDIO_HCI +#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_PLATFORM_RTL8197D) #define rtw_le16_to_cpu(val) val #define rtw_le32_to_cpu(val) val #define rtw_cpu_to_le16(val) val diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_query.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_query.c index 4f8232dfaf80..6f7613ecd9b0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_query.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_query.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_IOCTL_QUERY_C_ #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_rtl.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_rtl.c index ab4a3871c935..5d9e76b604f5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_rtl.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_rtl.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_IOCTL_RTL_C_ #include @@ -432,13 +427,14 @@ NDIS_STATUS oid_rt_get_channelplan_hdl(struct oid_par_priv *poid_par_priv) { NDIS_STATUS status = NDIS_STATUS_SUCCESS; PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); if (poid_par_priv->type_of_oid != QUERY_OID) { status = NDIS_STATUS_NOT_ACCEPTED; return status; } *poid_par_priv->bytes_rw = poid_par_priv->information_buf_len; - *(u16 *)poid_par_priv->information_buf = padapter->mlmepriv.ChannelPlan ; + *(u16 *)poid_par_priv->information_buf = rfctl->ChannelPlan; return status; } @@ -446,13 +442,14 @@ NDIS_STATUS oid_rt_set_channelplan_hdl(struct oid_par_priv *poid_par_priv) { NDIS_STATUS status = NDIS_STATUS_SUCCESS; PADAPTER padapter = (PADAPTER)(poid_par_priv->adapter_context); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); if (poid_par_priv->type_of_oid != SET_OID) { status = NDIS_STATUS_NOT_ACCEPTED; return status; } - padapter->mlmepriv.ChannelPlan = *(u16 *)poid_par_priv->information_buf ; + rfctl->ChannelPlan = *(u16 *)poid_par_priv->information_buf; return status; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_set.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_set.c index 934dc957ddd4..c3da5a0fb049 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_set.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_ioctl_set.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_IOCTL_SET_C_ #include @@ -79,6 +74,7 @@ u8 rtw_do_join(_adapter *padapter) _list *plist, *phead; u8 *pibss = NULL; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct sitesurvey_parm parm; _queue *queue = &(pmlmepriv->scanned_queue); u8 ret = _SUCCESS; @@ -96,6 +92,10 @@ u8 rtw_do_join(_adapter *padapter) pmlmepriv->to_join = _TRUE; + rtw_init_sitesurvey_parm(padapter, &parm); + _rtw_memcpy(&parm.ssid[0], &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); + parm.ssid_num = 1; + if (_rtw_queue_empty(queue) == _TRUE) { _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); @@ -107,7 +107,7 @@ u8 rtw_do_join(_adapter *padapter) || rtw_to_roam(padapter) > 0 ) { /* submit site_survey_cmd */ - ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); + ret = rtw_sitesurvey_cmd(padapter, &parm); if (_SUCCESS != ret) { pmlmepriv->to_join = _FALSE; } @@ -161,7 +161,7 @@ u8 rtw_do_join(_adapter *padapter) /* for funk to do roaming */ /* funk will reconnect, but funk will not sitesurvey before reconnect */ if (pmlmepriv->sitesurveyctrl.traffic_busy == _FALSE) - rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); + rtw_sitesurvey_cmd(padapter, &parm); } } @@ -173,7 +173,7 @@ u8 rtw_do_join(_adapter *padapter) || rtw_to_roam(padapter) > 0 ) { /* RTW_INFO("rtw_do_join() when no desired bss in scanning queue\n"); */ - ret = rtw_sitesurvey_cmd(padapter, &pmlmepriv->assoc_ssid, 1, NULL, 0); + ret = rtw_sitesurvey_cmd(padapter, &parm); if (_SUCCESS != ret) { pmlmepriv->to_join = _FALSE; } @@ -302,7 +302,7 @@ u8 rtw_set_802_11_bssid(_adapter *padapter, u8 *bssid) goto release_mlme_lock;/* it means driver is in WIFI_ADHOC_MASTER_STATE, we needn't create bss again. */ } else { - rtw_disassoc_cmd(padapter, 0, _TRUE); + rtw_disassoc_cmd(padapter, 0, 0); if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) rtw_indicate_disconnect(padapter, 0, _FALSE); @@ -374,7 +374,7 @@ u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid) if (rtw_is_same_ibss(padapter, pnetwork) == _FALSE) { /* if in WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE, create bss or rejoin again */ - rtw_disassoc_cmd(padapter, 0, _TRUE); + rtw_disassoc_cmd(padapter, 0, 0); if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) rtw_indicate_disconnect(padapter, 0, _FALSE); @@ -395,7 +395,7 @@ u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid) #endif } else { - rtw_disassoc_cmd(padapter, 0, _TRUE); + rtw_disassoc_cmd(padapter, 0, 0); if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) rtw_indicate_disconnect(padapter, 0, _FALSE); @@ -514,8 +514,8 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct wlan_network *cur_network = &pmlmepriv->cur_network; NDIS_802_11_NETWORK_INFRASTRUCTURE *pold_state = &(cur_network->network.InfrastructureMode); - - + u8 ap2sta_mode = _FALSE; + u8 ret = _TRUE; if (*pold_state != networktype) { /* RTW_INFO("change mode, old_mode=%d, new_mode=%d, fw_state=0x%x\n", *pold_state, networktype, get_fwstate(pmlmepriv)); */ @@ -523,7 +523,7 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, if (*pold_state == Ndis802_11APMode) { /* change to other mode from Ndis802_11APMode */ cur_network->join_res = -1; - + ap2sta_mode = _TRUE; #ifdef CONFIG_NATIVEAP_MLME stop_ap_mode(padapter); #endif @@ -532,7 +532,7 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, _enter_critical_bh(&pmlmepriv->lock, &irqL); if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || (*pold_state == Ndis802_11IBSS)) - rtw_disassoc_cmd(padapter, 0, _TRUE); + rtw_disassoc_cmd(padapter, 0, 0); if ((check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) || (check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE) == _TRUE)) @@ -555,6 +555,9 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, case Ndis802_11Infrastructure: set_fwstate(pmlmepriv, WIFI_STATION_STATE); + + if (ap2sta_mode) + rtw_init_bcmc_stainfo(padapter); break; case Ndis802_11APMode: @@ -572,6 +575,9 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, case Ndis802_11Monitor: set_fwstate(pmlmepriv, WIFI_MONITOR_STATE); break; + default: + ret = _FALSE; + rtw_warn_on(1); } /* SecClearAllKeys(adapter); */ @@ -580,8 +586,7 @@ u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, _exit_critical_bh(&pmlmepriv->lock, &irqL); } - - return _TRUE; + return ret; } @@ -595,7 +600,7 @@ u8 rtw_set_802_11_disassociate(_adapter *padapter) if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { - rtw_disassoc_cmd(padapter, 0, _TRUE); + rtw_disassoc_cmd(padapter, 0, 0); rtw_indicate_disconnect(padapter, 0, _FALSE); /* modify for CONFIG_IEEE80211W, none 11w can use it */ rtw_free_assoc_resources_cmd(padapter); @@ -610,21 +615,21 @@ u8 rtw_set_802_11_disassociate(_adapter *padapter) } #if 1 -u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num) +u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, struct sitesurvey_parm *pparm) { _irqL irqL; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; u8 res = _TRUE; _enter_critical_bh(&pmlmepriv->lock, &irqL); - res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, ch, ch_num); + res = rtw_sitesurvey_cmd(padapter, pparm); _exit_critical_bh(&pmlmepriv->lock, &irqL); return res; } #else -u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num) +u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, struct sitesurvey_parm *pparm) { _irqL irqL; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -656,7 +661,7 @@ u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, i _enter_critical_bh(&pmlmepriv->lock, &irqL); - res = rtw_sitesurvey_cmd(padapter, pssid, ssid_max_num, NULL, 0, ch, ch_num); + res = rtw_sitesurvey_cmd(padapter, pparm); _exit_critical_bh(&pmlmepriv->lock, &irqL); } @@ -1022,9 +1027,6 @@ u8 rtw_set_802_11_add_key(_adapter *padapter, NDIS_802_11_KEY *key) if (encryptionalgo == _TKIP_) { padapter->securitypriv.busetkipkey = _FALSE; - /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ - - /* if TKIP, save the Receive/Transmit MIC key in KeyMaterial[128-255] */ if ((key->KeyIndex & 0x10000000)) { _rtw_memcpy(&stainfo->dot11tkiptxmickey, key->KeyMaterial + 16, 8); @@ -1150,22 +1152,20 @@ u16 rtw_get_cur_max_rate(_adapter *adapter) if (psta == NULL) return 0; - short_GI = query_ra_short_GI(psta, psta->bw_mode); + short_GI = query_ra_short_GI(psta, rtw_get_tx_bw_mode(adapter, psta)); #ifdef CONFIG_80211N_HT - if (IsSupportedHT(psta->wireless_mode)) { + if (is_supported_ht(psta->wireless_mode)) { rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - - max_rate = rtw_mcs_rate( - rf_type, - ((psta->bw_mode == CHANNEL_WIDTH_40) ? 1 : 0), - short_GI, - psta->htpriv.ht_cap.supp_mcs_set - ); + max_rate = rtw_mcs_rate(rf_type + , (psta->cmn.bw_mode == CHANNEL_WIDTH_40) ? 1 : 0 + , short_GI + , psta->htpriv.ht_cap.supp_mcs_set + ); } #ifdef CONFIG_80211AC_VHT - else if (IsSupportedVHT(psta->wireless_mode)) - max_rate = ((rtw_vht_mcs_to_data_rate(psta->bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10; + else if (is_supported_vht(psta->wireless_mode)) + max_rate = ((rtw_vht_mcs_to_data_rate(psta->cmn.bw_mode, short_GI, pmlmepriv->vhtpriv.vht_highest_rate) + 1) >> 1) * 10; #endif /* CONFIG_80211AC_VHT */ else #endif /* CONFIG_80211N_HT */ @@ -1228,7 +1228,8 @@ int rtw_set_country(_adapter *adapter, const char *country_code) #ifdef CONFIG_RTW_IOCTL_SET_COUNTRY return rtw_set_country_cmd(adapter, RTW_CMDF_WAIT_ACK, country_code, 1); #else - return _FAIL; + RTW_INFO("%s(): not applied\n", __func__); + return _SUCCESS; #endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_iol.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_iol.c index 42d0b6beec40..aafac3fc234e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_iol.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_iol.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mem.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mem.c index b68a456177de..d9f5652f9df8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mem.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mem.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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 #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mi.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mi.c index 6038e5732420..5bc17c3d13a6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mi.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mi.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2015 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_MI_C_ #include @@ -32,6 +27,82 @@ void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw) iface_state->union_offset = offset; } +#ifdef CONFIG_P2P +static u8 _rtw_mi_p2p_listen_scan_chk(_adapter *adapter) +{ + int i; + _adapter *iface; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u8 p2p_listen_scan_state = _FALSE; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_LISTEN) || + rtw_p2p_chk_state(&iface->wdinfo, P2P_STATE_SCAN)) { + p2p_listen_scan_state = _TRUE; + break; + } + } + return p2p_listen_scan_state; +} +#endif +u8 rtw_mi_stayin_union_ch_chk(_adapter *adapter) +{ + u8 rst = _TRUE; + u8 u_ch, u_bw, u_offset; + u8 o_ch, o_bw, o_offset; + + u_ch = rtw_mi_get_union_chan(adapter); + u_bw = rtw_mi_get_union_bw(adapter); + u_offset = rtw_mi_get_union_offset(adapter); + + o_ch = rtw_get_oper_ch(adapter); + o_bw = rtw_get_oper_bw(adapter); + o_offset = rtw_get_oper_choffset(adapter); + + if ((u_ch != o_ch) || (u_bw != o_bw) || (u_offset != o_offset)) + rst = _FALSE; + + #ifdef DBG_IFACE_STATUS + if (rst == _FALSE) { + RTW_ERR("%s Not stay in union channel\n", __func__); + if (GET_HAL_DATA(adapter)->bScanInProcess == _TRUE) + RTW_ERR("ScanInProcess\n"); + #ifdef CONFIG_P2P + if (_rtw_mi_p2p_listen_scan_chk(adapter)) + RTW_ERR("P2P in listen or scan state\n"); + #endif + RTW_ERR("union ch, bw, offset: %u,%u,%u\n", u_ch, u_bw, u_offset); + RTW_ERR("oper ch, bw, offset: %u,%u,%u\n", o_ch, o_bw, o_offset); + RTW_ERR("=========================\n"); + } + #endif + return rst; +} + +u8 rtw_mi_stayin_union_band_chk(_adapter *adapter) +{ + u8 rst = _TRUE; + u8 u_ch, o_ch; + u8 u_band, o_band; + + u_ch = rtw_mi_get_union_chan(adapter); + o_ch = rtw_get_oper_ch(adapter); + u_band = (u_ch > 14) ? BAND_ON_5G : BAND_ON_2_4G; + o_band = (o_ch > 14) ? BAND_ON_5G : BAND_ON_2_4G; + + if (u_ch != o_ch) + if(u_band != o_band) + rst = _FALSE; + + #ifdef DBG_IFACE_STATUS + if (rst == _FALSE) + RTW_ERR("%s Not stay in union band\n", __func__); + #endif + + return rst; +} + /* Find union about ch, bw, ch_offset of all linked/linking interfaces */ int _rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset, bool include_self) { @@ -110,8 +181,12 @@ inline int rtw_mi_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw return _rtw_mi_get_ch_setting_union(adapter, ch, bw, offset, 0); } +#define MI_STATUS_SELF_ONLY 0 +#define MI_STATUS_OTHERS_ONLY 1 +#define MI_STATUS_ALL 2 + /* For now, not return union_ch/bw/offset */ -void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, bool include_self) +void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, u8 target_sel) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); _adapter *iface; @@ -122,23 +197,32 @@ void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, bool include_sel for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; - if (include_self == _FALSE && iface == adapter) + if (target_sel == MI_STATUS_SELF_ONLY && iface != adapter) + continue; + if (target_sel == MI_STATUS_OTHERS_ONLY && iface == adapter) continue; if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) { MSTATE_STA_NUM(mstate)++; - if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) + if (check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE) { MSTATE_STA_LD_NUM(mstate)++; + #ifdef CONFIG_TDLS + if (iface->tdlsinfo.link_established == _TRUE) + MSTATE_TDLS_LD_NUM(mstate)++; + #endif + } if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING) == _TRUE) MSTATE_STA_LG_NUM(mstate)++; +#ifdef CONFIG_AP_MODE } else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE ) { MSTATE_AP_NUM(mstate)++; if (iface->stapriv.asoc_sta_count > 2) MSTATE_AP_LD_NUM(mstate)++; +#endif } else if (check_fwstate(&iface->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE @@ -146,11 +230,29 @@ void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, bool include_sel MSTATE_ADHOC_NUM(mstate)++; if (iface->stapriv.asoc_sta_count > 2) MSTATE_ADHOC_LD_NUM(mstate)++; + +#ifdef CONFIG_RTW_MESH + } else if (check_fwstate(&iface->mlmepriv, WIFI_MESH_STATE) == _TRUE + && check_fwstate(&iface->mlmepriv, _FW_LINKED) == _TRUE + ) { + MSTATE_MESH_NUM(mstate)++; + if (iface->stapriv.asoc_sta_count > 2) + MSTATE_MESH_LD_NUM(mstate)++; +#endif + } if (check_fwstate(&iface->mlmepriv, WIFI_UNDER_WPS) == _TRUE) MSTATE_WPS_NUM(mstate)++; + if (check_fwstate(&iface->mlmepriv, WIFI_SITE_MONITOR) == _TRUE) { + MSTATE_SCAN_NUM(mstate)++; + + if (mlmeext_scan_state(&iface->mlmeextpriv) != SCAN_DISABLE + && mlmeext_scan_state(&iface->mlmeextpriv) != SCAN_BACK_OP) + MSTATE_SCAN_ENTER_NUM(mstate)++; + } + #ifdef CONFIG_IOCTL_CFG80211 if (rtw_cfg80211_get_is_mgmt_tx(iface)) MSTATE_MGMT_TX_NUM(mstate)++; @@ -165,32 +267,79 @@ void _rtw_mi_status(_adapter *adapter, struct mi_state *mstate, bool include_sel inline void rtw_mi_status(_adapter *adapter, struct mi_state *mstate) { - return _rtw_mi_status(adapter, mstate, 1); + return _rtw_mi_status(adapter, mstate, MI_STATUS_ALL); } + inline void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate) { - return _rtw_mi_status(adapter, mstate, 0); + return _rtw_mi_status(adapter, mstate, MI_STATUS_OTHERS_ONLY); } + +inline void rtw_mi_status_no_others(_adapter *adapter, struct mi_state *mstate) +{ + return _rtw_mi_status(adapter, mstate, MI_STATUS_SELF_ONLY); +} + +/* For now, not handle union_ch/bw/offset */ +inline void rtw_mi_status_merge(struct mi_state *d, struct mi_state *a) +{ + d->sta_num += a->sta_num; + d->ld_sta_num += a->ld_sta_num; + d->lg_sta_num += a->lg_sta_num; +#ifdef CONFIG_TDLS + d->ld_tdls_num += a->ld_tdls_num; +#endif +#ifdef CONFIG_AP_MODE + d->ap_num += a->ap_num; + d->ld_ap_num += a->ld_ap_num; +#endif + d->adhoc_num += a->adhoc_num; + d->ld_adhoc_num += a->ld_adhoc_num; +#ifdef CONFIG_RTW_MESH + d->mesh_num += a->mesh_num; + d->ld_mesh_num += a->ld_mesh_num; +#endif + d->scan_num += a->scan_num; + d->scan_enter_num += a->scan_enter_num; + d->uwps_num += a->uwps_num; +#ifdef CONFIG_IOCTL_CFG80211 + #ifdef CONFIG_P2P + d->roch_num += a->roch_num; + #endif + d->mgmt_tx_num += a->mgmt_tx_num; +#endif +} + void dump_mi_status(void *sel, struct dvobj_priv *dvobj) { RTW_PRINT_SEL(sel, "== dvobj-iface_state ==\n"); RTW_PRINT_SEL(sel, "sta_num:%d\n", DEV_STA_NUM(dvobj)); RTW_PRINT_SEL(sel, "linking_sta_num:%d\n", DEV_STA_LG_NUM(dvobj)); RTW_PRINT_SEL(sel, "linked_sta_num:%d\n", DEV_STA_LD_NUM(dvobj)); +#ifdef CONFIG_TDLS + RTW_PRINT_SEL(sel, "linked_tdls_num:%d\n", DEV_TDLS_LD_NUM(dvobj)); +#endif +#ifdef CONFIG_AP_MODE RTW_PRINT_SEL(sel, "ap_num:%d\n", DEV_AP_NUM(dvobj)); RTW_PRINT_SEL(sel, "linked_ap_num:%d\n", DEV_AP_LD_NUM(dvobj)); +#endif RTW_PRINT_SEL(sel, "adhoc_num:%d\n", DEV_ADHOC_NUM(dvobj)); RTW_PRINT_SEL(sel, "linked_adhoc_num:%d\n", DEV_ADHOC_LD_NUM(dvobj)); +#ifdef CONFIG_RTW_MESH + RTW_PRINT_SEL(sel, "mesh_num:%d\n", DEV_MESH_NUM(dvobj)); + RTW_PRINT_SEL(sel, "linked_mesh_num:%d\n", DEV_MESH_LD_NUM(dvobj)); +#endif #ifdef CONFIG_P2P RTW_PRINT_SEL(sel, "p2p_device_num:%d\n", rtw_mi_stay_in_p2p_mode(dvobj->padapters[IFACE_ID0])); #endif + RTW_PRINT_SEL(sel, "scan_num:%d\n", DEV_STA_NUM(dvobj)); + RTW_PRINT_SEL(sel, "under_wps_num:%d\n", DEV_WPS_NUM(dvobj)); #if defined(CONFIG_IOCTL_CFG80211) #if defined(CONFIG_P2P) RTW_PRINT_SEL(sel, "roch_num:%d\n", DEV_ROCH_NUM(dvobj)); #endif RTW_PRINT_SEL(sel, "mgmt_tx_num:%d\n", DEV_MGMT_TX_NUM(dvobj)); #endif - RTW_PRINT_SEL(sel, "under_wps_num:%d\n", DEV_WPS_NUM(dvobj)); RTW_PRINT_SEL(sel, "union_ch:%d\n", DEV_U_CH(dvobj)); RTW_PRINT_SEL(sel, "union_bw:%d\n", DEV_U_BW(dvobj)); RTW_PRINT_SEL(sel, "union_offset:%d\n", DEV_U_OFFSET(dvobj)); @@ -214,7 +363,6 @@ inline void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state) _adapter *iface; if (state == WIFI_MONITOR_STATE - || state == WIFI_SITE_MONITOR || state == 0xFFFFFFFF ) return; @@ -252,11 +400,11 @@ u8 rtw_mi_check_status(_adapter *adapter, u8 type) switch (type) { case MI_LINKED: - if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_NUM(iface_state) || MSTATE_ADHOC_NUM(iface_state)) /*check_fwstate(&iface->mlmepriv, _FW_LINKED)*/ + if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_NUM(iface_state) || MSTATE_ADHOC_NUM(iface_state) || MSTATE_MESH_NUM(iface_state)) /*check_fwstate(&iface->mlmepriv, _FW_LINKED)*/ ret = _TRUE; break; case MI_ASSOC: - if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_LD_NUM(iface_state) || MSTATE_ADHOC_LD_NUM(iface_state)) + if (MSTATE_STA_LD_NUM(iface_state) || MSTATE_AP_LD_NUM(iface_state) || MSTATE_ADHOC_LD_NUM(iface_state) || MSTATE_MESH_LD_NUM(iface_state)) ret = _TRUE; break; case MI_UNDER_WPS: @@ -282,6 +430,17 @@ u8 rtw_mi_check_status(_adapter *adapter, u8 type) ret = _TRUE; break; +#ifdef CONFIG_RTW_MESH + case MI_MESH: + if (MSTATE_MESH_NUM(iface_state)) + ret = _TRUE; + break; + case MI_MESH_ASSOC: + if (MSTATE_MESH_LD_NUM(iface_state)) + ret = _TRUE; + break; +#endif + case MI_STA_NOLINK: /* this is misleading, but not used now */ if (MSTATE_STA_NUM(iface_state) && (!(MSTATE_STA_LD_NUM(iface_state) || MSTATE_STA_LG_NUM(iface_state)))) ret = _TRUE; @@ -301,28 +460,6 @@ u8 rtw_mi_check_status(_adapter *adapter, u8 type) return ret; } -u8 rtw_mi_mp_mode_check(_adapter *padapter) -{ -#ifdef CONFIG_MP_INCLUDED -#ifdef CONFIG_CONCURRENT_MODE - int i; - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - _adapter *iface = NULL; - - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - - if ((iface) && (iface->registrypriv.mp_mode == 1)) - return _TRUE; - } -#else - if (padapter->registrypriv.mp_mode == 1) - return _TRUE; -#endif -#endif /* CONFIG_MP_INCLUDED */ - return _FALSE; -} - /* * return value : 0 is failed or have not interface meet condition * return value : !0 is success or interface numbers which meet condition @@ -351,27 +488,77 @@ static u8 _rtw_mi_process(_adapter *padapter, bool exclude_self, } return ret; } -static u8 _rtw_mi_netif_stop_queue(_adapter *padapter, void *data) +static u8 _rtw_mi_process_without_schk(_adapter *padapter, bool exclude_self, + void *data, u8(*ops_func)(_adapter *padapter, void *data)) +{ + int i; + _adapter *iface; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + u8 ret = 0; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface) { + if ((exclude_self) && (iface == padapter)) + continue; + + if (ops_func) + if (ops_func(iface, data) == _TRUE) + ret++; + } + } + return ret; +} + +static u8 _rtw_mi_netif_caroff_qstop(_adapter *padapter, void *data) { - bool carrier_off = *(bool *)data; struct net_device *pnetdev = padapter->pnetdev; - if (carrier_off) - netif_carrier_off(pnetdev); + rtw_netif_carrier_off(pnetdev); rtw_netif_stop_queue(pnetdev); return _TRUE; } -u8 rtw_mi_netif_stop_queue(_adapter *padapter, bool carrier_off) +u8 rtw_mi_netif_caroff_qstop(_adapter *padapter) { - bool in_data = carrier_off; - - return _rtw_mi_process(padapter, _FALSE, &in_data, _rtw_mi_netif_stop_queue); + return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_caroff_qstop); } -u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter, bool carrier_off) +u8 rtw_mi_buddy_netif_caroff_qstop(_adapter *padapter) { - bool in_data = carrier_off; + return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_caroff_qstop); +} - return _rtw_mi_process(padapter, _TRUE, &in_data, _rtw_mi_netif_stop_queue); +static u8 _rtw_mi_netif_caron_qstart(_adapter *padapter, void *data) +{ + struct net_device *pnetdev = padapter->pnetdev; + + rtw_netif_carrier_on(pnetdev); + rtw_netif_start_queue(pnetdev); + return _TRUE; +} +u8 rtw_mi_netif_caron_qstart(_adapter *padapter) +{ + return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_caron_qstart); +} +u8 rtw_mi_buddy_netif_caron_qstart(_adapter *padapter) +{ + return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_caron_qstart); +} + +static u8 _rtw_mi_netif_stop_queue(_adapter *padapter, void *data) +{ + struct net_device *pnetdev = padapter->pnetdev; + + rtw_netif_stop_queue(pnetdev); + return _TRUE; +} +u8 rtw_mi_netif_stop_queue(_adapter *padapter) +{ + return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_stop_queue); +} +u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter) +{ + return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_stop_queue); } static u8 _rtw_mi_netif_wake_queue(_adapter *padapter, void *data) @@ -408,6 +595,23 @@ u8 rtw_mi_buddy_netif_carrier_on(_adapter *padapter) return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_carrier_on); } +static u8 _rtw_mi_netif_carrier_off(_adapter *padapter, void *data) +{ + struct net_device *pnetdev = padapter->pnetdev; + + if (pnetdev) + rtw_netif_carrier_off(pnetdev); + return _TRUE; +} +u8 rtw_mi_netif_carrier_off(_adapter *padapter) +{ + return _rtw_mi_process(padapter, _FALSE, NULL, _rtw_mi_netif_carrier_off); +} +u8 rtw_mi_buddy_netif_carrier_off(_adapter *padapter) +{ + return _rtw_mi_process(padapter, _TRUE, NULL, _rtw_mi_netif_carrier_off); +} + static u8 _rtw_mi_scan_abort(_adapter *adapter, void *data) { bool bwait = *(bool *)data; @@ -447,18 +651,27 @@ void rtw_mi_buddy_start_drv_threads(_adapter *adapter) _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_start_drv_threads); } -static u8 _rtw_mi_stop_drv_threads(_adapter *adapter, void *data) +static void _rtw_mi_stop_drv_threads(_adapter *adapter, bool exclude_self) { - rtw_stop_drv_threads(adapter); - return _TRUE; + int i; + _adapter *iface = NULL; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if ((iface) && (iface->bup == _TRUE)) + if ((exclude_self) && (iface == adapter)) + continue; + rtw_stop_drv_threads(iface); + } } void rtw_mi_stop_drv_threads(_adapter *adapter) { - _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_stop_drv_threads); + _rtw_mi_stop_drv_threads(adapter, _FALSE); } void rtw_mi_buddy_stop_drv_threads(_adapter *adapter) { - _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_stop_drv_threads); + _rtw_mi_stop_drv_threads(adapter, _TRUE); } static u8 _rtw_mi_cancel_all_timer(_adapter *adapter, void *data) @@ -482,11 +695,11 @@ static u8 _rtw_mi_reset_drv_sw(_adapter *adapter, void *data) } void rtw_mi_reset_drv_sw(_adapter *adapter) { - _rtw_mi_process(adapter, _FALSE, NULL, _rtw_mi_reset_drv_sw); + _rtw_mi_process_without_schk(adapter, _FALSE, NULL, _rtw_mi_reset_drv_sw); } void rtw_mi_buddy_reset_drv_sw(_adapter *adapter) { - _rtw_mi_process(adapter, _TRUE, NULL, _rtw_mi_reset_drv_sw); + _rtw_mi_process_without_schk(adapter, _TRUE, NULL, _rtw_mi_reset_drv_sw); } static u8 _rtw_mi_intf_start(_adapter *adapter, void *data) @@ -565,58 +778,14 @@ void rtw_mi_buddy_set_scan_deny(_adapter *adapter, u32 ms) _rtw_mi_process(adapter, _TRUE, &in_data, _rtw_mi_set_scan_deny); } -#endif - -struct nulldata_param { - unsigned char *da; - unsigned int power_mode; - int try_cnt; - int wait_ms; -}; - -static u8 _rtw_mi_issue_nulldata(_adapter *padapter, void *data) -{ - struct nulldata_param *pnulldata_param = (struct nulldata_param *)data; - - if (is_client_associated_to_ap(padapter) == _TRUE) { - /* TODO: TDLS peers */ - issue_nulldata(padapter, pnulldata_param->da, pnulldata_param->power_mode, pnulldata_param->try_cnt, pnulldata_param->wait_ms); - return _TRUE; - } - return _FALSE; -} - -u8 rtw_mi_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -{ - struct nulldata_param nparam; - - nparam.da = da; - nparam.power_mode = power_mode;/*0 or 1*/ - nparam.try_cnt = try_cnt; - nparam.wait_ms = wait_ms; - - return _rtw_mi_process(padapter, _FALSE, &nparam, _rtw_mi_issue_nulldata); -} -u8 rtw_mi_buddy_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms) -{ - struct nulldata_param nparam; - - nparam.da = da; - nparam.power_mode = power_mode; - nparam.try_cnt = try_cnt; - nparam.wait_ms = wait_ms; - - return _rtw_mi_process(padapter, _TRUE, &nparam, _rtw_mi_issue_nulldata); -} +#endif /*CONFIG_SET_SCAN_DENY_TIMER*/ static u8 _rtw_mi_beacon_update(_adapter *padapter, void *data) { - struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; - - if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE + if (!MLME_IS_STA(padapter) && check_fwstate(&padapter->mlmepriv, _FW_LINKED) == _TRUE) { - RTW_INFO(ADPT_FMT"-WIFI_FW_AP_STATE - update_beacon\n", ADPT_ARG(padapter)); - update_beacon(padapter, 0, NULL, _TRUE); + RTW_INFO(ADPT_FMT" - update_beacon\n", ADPT_ARG(padapter)); + update_beacon(padapter, 0xFF, NULL, _TRUE); } return _TRUE; } @@ -635,7 +804,7 @@ static u8 _rtw_mi_hal_dump_macaddr(_adapter *padapter, void *data) { u8 mac_addr[ETH_ALEN] = {0}; - rtw_hal_get_macaddr_port(padapter, mac_addr); + rtw_hal_get_hwreg(padapter, HW_VAR_MAC_ADDR, mac_addr); RTW_INFO(ADPT_FMT"MAC Address ="MAC_FMT"\n", ADPT_ARG(padapter), MAC_ARG(mac_addr)); return _TRUE; } @@ -984,9 +1153,9 @@ u8 rtw_mi_buddy_sreset_adapter_hdl(_adapter *padapter, u8 bstart) } static u8 _rtw_mi_tx_beacon_hdl(_adapter *adapter, void *data) { - if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE - && check_fwstate(&adapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE - ) { + if ((MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) + && check_fwstate(&adapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE + ) { adapter->mlmepriv.update_bcn = _TRUE; #ifndef CONFIG_INTERRUPT_BASED_TXBCN #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) @@ -1009,7 +1178,7 @@ static u8 _rtw_mi_set_tx_beacon_cmd(_adapter *adapter, void *data) { struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { + if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { if (pmlmepriv->update_bcn == _TRUE) set_tx_beacon_cmd(adapter); } @@ -1195,7 +1364,7 @@ static s32 _rtw_mi_buddy_clone_bcmc_packet(_adapter *adapter, union recv_frame * rtw_dbg_skb_process(adapter, precvframe, pcloneframe); #endif - if (pattrib->physt && pphy_status) + if (pphy_status) rx_query_phy_status(pcloneframe, pphy_status); ret = rtw_recv_entry(pcloneframe); @@ -1217,6 +1386,8 @@ void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvf struct recv_priv *precvpriv = &padapter->recvpriv;/*primary_padapter*/ _queue *pfree_recv_queue = &precvpriv->free_recv_queue; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + u8 *fhead = get_recvframe_data(precvframe); + u8 type = GetFrameType(fhead); for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; @@ -1224,6 +1395,8 @@ void rtw_mi_buddy_clone_bcmc_packet(_adapter *padapter, union recv_frame *precvf continue; if (rtw_is_adapter_up(iface) == _FALSE || iface->registered == 0) continue; + if (type == WIFI_DATA_TYPE && !adapter_allow_bmc_data_rx(iface)) + continue; pcloneframe = rtw_alloc_recvframe(pfree_recv_queue); if (pcloneframe) { @@ -1284,3 +1457,4 @@ void rtw_mi_update_ap_bmc_camid(_adapter *padapter, u8 camid_a, u8 camid_b) } #endif } + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme.c index 8315f5fb3b43..736b9241b8a4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_MLME_C_ #include @@ -25,6 +20,27 @@ extern void indicate_wx_scan_complete_event(_adapter *padapter); extern u8 rtw_do_join(_adapter *padapter); +void rtw_init_mlme_timer(_adapter *padapter) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + + rtw_init_timer(&(pmlmepriv->assoc_timer), padapter, rtw_join_timeout_handler, padapter); + rtw_init_timer(&(pmlmepriv->scan_to_timer), padapter, rtw_scan_timeout_handler, padapter); + +#ifdef CONFIG_DFS_MASTER + rtw_init_timer(&(pmlmepriv->dfs_master_timer), padapter, rtw_dfs_master_timer_hdl, padapter); +#endif + +#ifdef CONFIG_SET_SCAN_DENY_TIMER + rtw_init_timer(&(pmlmepriv->set_scan_deny_timer), padapter, rtw_set_scan_deny_timer_hdl, padapter); +#endif + +#ifdef RTK_DMP_PLATFORM + _init_workitem(&(pmlmepriv->Linkup_workitem), Linkup_workitem_callback, padapter); + _init_workitem(&(pmlmepriv->Linkdown_workitem), Linkdown_workitem_callback, padapter); +#endif +} + sint _rtw_init_mlme_priv(_adapter *padapter) { sint i; @@ -925,6 +941,11 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) phead = get_list_head(queue); plist = get_next(phead); +#if 0 + RTW_INFO("%s => ssid:%s , rssi:%ld , ss:%d\n", + __func__, target->Ssid.Ssid, target->Rssi, target->PhyInfo.SignalStrength); +#endif + #ifdef CONFIG_P2P if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) feature = 1; /* p2p enable */ @@ -954,10 +975,13 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) if (rtw_roam_flags(adapter)) { /* TODO: don't select netowrk in the same ess as oldest if it's new enough*/ } - +#ifdef CONFIG_RSSI_PRIORITY + if ((oldest == NULL) || (pnetwork->network.PhyInfo.SignalStrength < oldest->network.PhyInfo.SignalStrength)) + oldest = pnetwork; +#else if (oldest == NULL || time_after(oldest->last_scanned, pnetwork->last_scanned)) oldest = pnetwork; - +#endif plist = get_next(plist); } @@ -974,6 +998,14 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) if (pnetwork == NULL) { goto exit; } +#ifdef CONFIG_RSSI_PRIORITY + RTW_DBG("%s => ssid:%s ,bssid:"MAC_FMT" will be deleted from scanned_queue (rssi:%ld , ss:%d)\n", + __func__, pnetwork->network.Ssid.Ssid, MAC_ARG(pnetwork->network.MacAddress), pnetwork->network.Rssi, pnetwork->network.PhyInfo.SignalStrength); +#else + RTW_DBG("%s => ssid:%s ,bssid:"MAC_FMT" will be deleted from scanned_queue\n", + __func__, pnetwork->network.Ssid.Ssid, MAC_ARG(pnetwork->network.MacAddress)); +#endif + #ifdef CONFIG_ANTENNA_DIVERSITY rtw_hal_get_odm_var(adapter, HAL_ODM_ANTDIV_SELECT, &(target->PhyInfo.Optimum_antenna), NULL); #endif @@ -1024,12 +1056,12 @@ void rtw_update_scanned_network(_adapter *adapter, WLAN_BSSID_EX *target) pnetwork->last_scanned = rtw_get_current_time(); - /* target.Reserved[0]==1, means that scaned network is a bcn frame. */ - if ((pnetwork->network.IELength > target->IELength) && (target->Reserved[0] == 1)) + /* target.Reserved[0]==BSS_TYPE_BCN, means that scanned network is a bcn frame. */ + if ((pnetwork->network.IELength > target->IELength) && (target->Reserved[0] == BSS_TYPE_BCN)) update_ie = _FALSE; /* probe resp(3) > beacon(1) > probe req(2) */ - if ((target->Reserved[0] != 2) && + if ((target->Reserved[0] != BSS_TYPE_PROB_REQ) && (target->Reserved[0] >= pnetwork->network.Reserved[0]) ) update_ie = _TRUE; @@ -1211,7 +1243,7 @@ void rtw_survey_event_callback(_adapter *adapter, u8 *pbuf) void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) { _irqL irqL; - u8 timer_cancelled; + struct sitesurvey_parm parm; struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); #ifdef CONFIG_RTW_80211R struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; @@ -1239,7 +1271,7 @@ void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) _clr_fwstate_(pmlmepriv, _FW_UNDER_SURVEY); _exit_critical_bh(&pmlmepriv->lock, &irqL); - _cancel_timer(&pmlmepriv->scan_to_timer, &timer_cancelled); + _cancel_timer_ex(&pmlmepriv->scan_to_timer); _enter_critical_bh(&pmlmepriv->lock, &irqL); @@ -1291,8 +1323,13 @@ void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf) RTW_INFO("try_to_join, but select scanning queue fail, to_roam:%d\n", rtw_to_roam(adapter)); if (rtw_to_roam(adapter) != 0) { + + rtw_init_sitesurvey_parm(adapter, &parm); + _rtw_memcpy(&parm.ssid[0], &pmlmepriv->assoc_ssid, sizeof(NDIS_802_11_SSID)); + parm.ssid_num = 1; + if (rtw_dec_to_roam(adapter) == 0 - || _SUCCESS != rtw_sitesurvey_cmd(adapter, &pmlmepriv->assoc_ssid, 1, NULL, 0) + || _SUCCESS != rtw_sitesurvey_cmd(adapter, &parm) ) { rtw_set_to_roam(adapter, 0); #ifdef CONFIG_INTEL_WIDI @@ -1405,13 +1442,17 @@ static void free_scanqueue(struct mlme_priv *pmlmepriv) } -void rtw_reset_rx_info(struct debug_priv *pdbgpriv) +void rtw_reset_rx_info(_adapter *adapter) { - pdbgpriv->dbg_rx_ampdu_drop_count = 0; - pdbgpriv->dbg_rx_ampdu_forced_indicate_count = 0; - pdbgpriv->dbg_rx_ampdu_loss_count = 0; - pdbgpriv->dbg_rx_dup_mgt_frame_drop_count = 0; - pdbgpriv->dbg_rx_ampdu_window_shift_cnt = 0; + struct recv_priv *precvpriv = &adapter->recvpriv; + + precvpriv->dbg_rx_ampdu_drop_count = 0; + precvpriv->dbg_rx_ampdu_forced_indicate_count = 0; + precvpriv->dbg_rx_ampdu_loss_count = 0; + precvpriv->dbg_rx_dup_mgt_frame_drop_count = 0; + precvpriv->dbg_rx_ampdu_window_shift_cnt = 0; + precvpriv->dbg_rx_drop_count = 0; + precvpriv->dbg_rx_conflic_mac_addr_cnt = 0; } /* @@ -1424,8 +1465,6 @@ void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) struct mlme_priv *pmlmepriv = &adapter->mlmepriv; struct sta_priv *pstapriv = &adapter->stapriv; struct wlan_network *tgt_network = &pmlmepriv->cur_network; - struct dvobj_priv *psdpriv = adapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; #ifdef CONFIG_TDLS @@ -1433,7 +1472,7 @@ void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) #endif /* CONFIG_TDLS */ - RTW_INFO("%s-"ADPT_FMT" tgt_network MacAddress=" MAC_FMT"ssid=%s\n", + RTW_INFO("%s-"ADPT_FMT" tgt_network MacAddress=" MAC_FMT" ssid=%s\n", __func__, ADPT_ARG(adapter), MAC_ARG(tgt_network->network.MacAddress), tgt_network->network.Ssid.Ssid); if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { @@ -1505,7 +1544,7 @@ void rtw_free_assoc_resources(_adapter *adapter, int lock_scanned_queue) adapter->securitypriv.key_mask = 0; - rtw_reset_rx_info(pdbgpriv); + rtw_reset_rx_info(adapter); } @@ -1528,16 +1567,7 @@ void rtw_indicate_connect(_adapter *padapter) rtw_led_control(padapter, LED_CTL_LINK); - -#ifdef CONFIG_DRVEXT_MODULE - if (padapter->drvextpriv.enable_wpa) - indicate_l2_connect(padapter); - else -#endif - { - rtw_os_indicate_connect(padapter); - } - + rtw_os_indicate_connect(padapter); } rtw_set_to_roam(padapter, 0); @@ -1548,7 +1578,7 @@ void rtw_indicate_connect(_adapter *padapter) RTW_INFO("change to widi listen\n"); } #endif /* CONFIG_INTEL_WIDI */ - if (!check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) + if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) rtw_mi_set_scan_deny(padapter, 3000); @@ -1597,7 +1627,7 @@ void rtw_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generate #ifdef CONFIG_WAPI_SUPPORT psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) - rtw_wapi_return_one_sta_info(padapter, psta->hwaddr); + rtw_wapi_return_one_sta_info(padapter, psta->cmn.mac_addr); else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE)) rtw_wapi_return_all_sta_info(padapter); @@ -1658,7 +1688,7 @@ inline void rtw_indicate_scan_done(_adapter *padapter, bool aborted) static u32 _rtw_wait_scan_done(_adapter *adapter, u8 abort, u32 timeout_ms) { - u32 start; + systime start; u32 pass_ms; struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); @@ -1699,17 +1729,11 @@ static u32 _rtw_wait_scan_done(_adapter *adapter, u8 abort, u32 timeout_ms) void rtw_scan_wait_completed(_adapter *adapter) { - u32 scan_to = SCANNING_TIMEOUT; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + struct ss_res *ss = &pmlmeext->sitesurvey_res; -#ifdef CONFIG_SCAN_BACKOP - if (IsSupported5G(adapter->registrypriv.wireless_mode) - && IsSupported24G(adapter->registrypriv.wireless_mode)) /*dual band*/ - scan_to = CONC_SCANNING_TIMEOUT_DUAL_BAND; - else /*single band*/ - scan_to = CONC_SCANNING_TIMEOUT_SINGLE_BAND; -#endif /* CONFIG_SCAN_BACKOP */ - - _rtw_wait_scan_done(adapter, _FALSE, scan_to); + _rtw_wait_scan_done(adapter, _FALSE, ss->scan_timeout_ms); } u32 rtw_scan_abort_timeout(_adapter *adapter, u32 timeout_ms) @@ -1734,7 +1758,7 @@ void rtw_scan_abort(_adapter *adapter) static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wlan_network *pnetwork) { int i; - struct sta_info *bmc_sta, *psta = NULL; + struct sta_info *psta = NULL; struct recv_reorder_ctrl *preorder_ctrl; struct sta_priv *pstapriv = &padapter->stapriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; @@ -1746,17 +1770,17 @@ static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wl if (psta) { /* update ptarget_sta */ RTW_INFO("%s\n", __FUNCTION__); - psta->aid = pnetwork->join_res; + psta->cmn.aid = pnetwork->join_res; #if 0 /* alloc macid when call rtw_alloc_stainfo(), and release macid when call rtw_free_stainfo() */ #ifdef CONFIG_CONCURRENT_MODE if (PRIMARY_ADAPTER == padapter->adapter_type) - psta->mac_id = 0; + psta->cmn.mac_id = 0; else - psta->mac_id = 2; + psta->cmn.mac_id = 2; #else - psta->mac_id = 0; + psta->cmn.mac_id = 0; #endif #endif /* removed */ @@ -1765,11 +1789,10 @@ static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wl /* update station supportRate */ psta->bssratelen = rtw_get_rateset_len(pnetwork->network.SupportedRates); _rtw_memcpy(psta->bssrateset, pnetwork->network.SupportedRates, psta->bssratelen); - rtw_hal_update_sta_rate_mask(padapter, psta); + rtw_hal_update_sta_ra_info(padapter, psta); psta->wireless_mode = pmlmeext->cur_wireless_mode; - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); - + rtw_hal_update_sta_wset(padapter, psta); /* sta mode */ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); @@ -1809,7 +1832,7 @@ static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wl } - /* for A-MPDU Rx reordering buffer control for bmc_sta & sta_info */ + /* for A-MPDU Rx reordering buffer control for sta_info */ /* if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff */ /* todo: check if AP can send A-MPDU packets */ for (i = 0; i < 16 ; i++) { @@ -1817,34 +1840,20 @@ static struct sta_info *rtw_joinbss_update_stainfo(_adapter *padapter, struct wl preorder_ctrl = &psta->recvreorder_ctrl[i]; preorder_ctrl->enable = _FALSE; preorder_ctrl->indicate_seq = 0xffff; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq); -#endif + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_CLEAR indicate_seq:%u\n" + , FUNC_ADPT_ARG(padapter), i, preorder_ctrl->indicate_seq); + #endif preorder_ctrl->wend_b = 0xffff; preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; } - - - bmc_sta = rtw_get_bcmc_stainfo(padapter); - if (bmc_sta) { - for (i = 0; i < 16 ; i++) { - /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ - preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; - preorder_ctrl->enable = _FALSE; - preorder_ctrl->indicate_seq = 0xffff; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq); -#endif - preorder_ctrl->wend_b = 0xffff; - preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ - preorder_ctrl->ampdu_size = RX_AMPDU_SIZE_INVALID; - } - } } +#ifdef CONFIG_RTW_80211K + _rtw_memcpy(&psta->rm_en_cap, pnetwork->network.PhyInfo.rm_en_cap, 5); +#endif + return psta; } @@ -1931,7 +1940,6 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) { _irqL irqL, irqL2; static u8 retry = 0; - u8 timer_cancelled; struct sta_info *ptarget_sta = NULL, *pcur_sta = NULL; struct sta_priv *pstapriv = &adapter->stapriv; struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); @@ -2042,7 +2050,7 @@ void rtw_joinbss_event_prehandle(_adapter *adapter, u8 *pbuf) } /* s5. Cancle assoc_timer */ - _cancel_timer(&pmlmepriv->assoc_timer, &timer_cancelled); + _cancel_timer_ex(&pmlmepriv->assoc_timer); } else { @@ -2119,21 +2127,21 @@ void rtw_sta_media_status_rpt(_adapter *adapter, struct sta_info *sta, bool conn return; } - if (sta->mac_id >= macid_ctl->num) { + if (sta->cmn.mac_id >= macid_ctl->num) { RTW_PRINT(FUNC_ADPT_FMT" invalid macid:%u\n" - , FUNC_ADPT_ARG(adapter), sta->mac_id); + , FUNC_ADPT_ARG(adapter), sta->cmn.mac_id); rtw_warn_on(1); return; } - if (!rtw_macid_is_used(macid_ctl, sta->mac_id)) { + if (!rtw_macid_is_used(macid_ctl, sta->cmn.mac_id)) { RTW_PRINT(FUNC_ADPT_FMT" macid:%u not is used, set connected to 0\n" - , FUNC_ADPT_ARG(adapter), sta->mac_id); + , FUNC_ADPT_ARG(adapter), sta->cmn.mac_id); connected = 0; rtw_warn_on(1); } - if (connected && !rtw_macid_is_bmc(macid_ctl, sta->mac_id)) { + if (connected && !rtw_macid_is_bmc(macid_ctl, sta->cmn.mac_id)) { miracast_enabled = STA_OP_WFD_MODE(sta) != 0 && is_miracast_enabled(adapter); miracast_sink = miracast_enabled && (STA_OP_WFD_MODE(sta) & MIRACAST_SINK); @@ -2142,39 +2150,41 @@ void rtw_sta_media_status_rpt(_adapter *adapter, struct sta_info *sta, bool conn role = H2C_MSR_ROLE_TDLS; else #endif - if (MLME_IS_STA(adapter)) { - if (MLME_IS_GC(adapter)) - role = H2C_MSR_ROLE_GO; - else - role = H2C_MSR_ROLE_AP; - } else if (MLME_IS_AP(adapter)) { - if (MLME_IS_GO(adapter)) - role = H2C_MSR_ROLE_GC; - else - role = H2C_MSR_ROLE_STA; - } else if (MLME_IS_ADHOC(adapter) || MLME_IS_ADHOC_MASTER(adapter)) - role = H2C_MSR_ROLE_ADHOC; + if (MLME_IS_STA(adapter)) { + if (MLME_IS_GC(adapter)) + role = H2C_MSR_ROLE_GO; + else + role = H2C_MSR_ROLE_AP; + } else if (MLME_IS_AP(adapter)) { + if (MLME_IS_GO(adapter)) + role = H2C_MSR_ROLE_GC; + else + role = H2C_MSR_ROLE_STA; + } else if (MLME_IS_ADHOC(adapter) || MLME_IS_ADHOC_MASTER(adapter)) + role = H2C_MSR_ROLE_ADHOC; + else if (MLME_IS_MESH(adapter)) + role = H2C_MSR_ROLE_MESH; #ifdef CONFIG_WFD if (role == H2C_MSR_ROLE_GC - || role == H2C_MSR_ROLE_GO - || role == H2C_MSR_ROLE_TDLS - ) { + || role == H2C_MSR_ROLE_GO + || role == H2C_MSR_ROLE_TDLS + ) { if (adapter->wfd_info.rtsp_ctrlport - || adapter->wfd_info.tdls_rtsp_ctrlport - || adapter->wfd_info.peer_rtsp_ctrlport) + || adapter->wfd_info.tdls_rtsp_ctrlport + || adapter->wfd_info.peer_rtsp_ctrlport) rtw_wfd_st_switch(sta, 1); } #endif } rtw_hal_set_FwMediaStatusRpt_single_cmd(adapter - , connected - , miracast_enabled - , miracast_sink - , role - , sta->mac_id - ); + , connected + , miracast_enabled + , miracast_sink + , role + , sta->cmn.mac_id + ); } u8 rtw_sta_media_status_rpt_cmd(_adapter *adapter, struct sta_info *sta, bool connected) @@ -2242,7 +2252,7 @@ void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) #endif #if defined(CONFIG_AP_MODE) && defined (CONFIG_NATIVEAP_MLME) - if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { + if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { psta = rtw_get_stainfo(&adapter->stapriv, pstassoc->macaddr); if (psta) { u8 *passoc_req = NULL; @@ -2251,7 +2261,6 @@ void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) rtw_sta_media_status_rpt(adapter, psta, 1); #ifndef CONFIG_AUTO_AP_MODE - ap_sta_info_defer_update(adapter, psta); /* report to upper layer */ @@ -2300,8 +2309,6 @@ void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf) goto exit; } - rtw_hal_set_odm_var(adapter, HAL_ODM_STA_INFO, psta, _TRUE); - rtw_sta_media_status_rpt(adapter, psta, 1); if (adapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) @@ -2450,19 +2457,24 @@ void rtw_sta_mstatus_disc_rpt(_adapter *adapter, u8 mac_id) { struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; - RTW_INFO("%s "ADPT_FMT" - mac_id=%d\n", __func__, ADPT_ARG(adapter), mac_id); - if (mac_id >= 0 && mac_id < macid_ctl->num) { - rtw_hal_set_FwMediaStatusRpt_single_cmd(adapter, 0, 0, 0, 0, mac_id); - /* - * For safety, prevent from keeping macid sleep. - * If we can sure all power mode enter/leave are paired, - * this check can be removed. - * Lucas@20131113 - */ - /* wakeup macid after disconnect. */ - /*if (MLME_IS_STA(adapter))*/ - rtw_hal_macid_wakeup(adapter, mac_id); + u8 id_is_shared = mac_id == RTW_DEFAULT_MGMT_MACID; /* TODO: real shared macid judgment */ + + RTW_INFO(FUNC_ADPT_FMT" - mac_id=%d%s\n", FUNC_ADPT_ARG(adapter) + , mac_id, id_is_shared ? " shared" : ""); + + if (!id_is_shared) { + rtw_hal_set_FwMediaStatusRpt_single_cmd(adapter, 0, 0, 0, 0, mac_id); + /* + * For safety, prevent from keeping macid sleep. + * If we can sure all power mode enter/leave are paired, + * this check can be removed. + * Lucas@20131113 + */ + /* wakeup macid after disconnect. */ + /*if (MLME_IS_STA(adapter))*/ + rtw_hal_macid_wakeup(adapter, mac_id); + } } else { RTW_PRINT(FUNC_ADPT_FMT" invalid macid:%u\n" , FUNC_ADPT_ARG(adapter), mac_id); @@ -2475,17 +2487,14 @@ void rtw_sta_mstatus_report(_adapter *adapter) struct wlan_network *tgt_network = &pmlmepriv->cur_network; struct sta_info *psta = NULL; - if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && - check_fwstate(pmlmepriv, _FW_LINKED)) { + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, WIFI_ASOC_STATE)) { psta = rtw_get_stainfo(&adapter->stapriv, tgt_network->network.MacAddress); if (psta) - rtw_sta_mstatus_disc_rpt(adapter, psta->mac_id); + rtw_sta_mstatus_disc_rpt(adapter, psta->cmn.mac_id); else { RTW_INFO("%s "ADPT_FMT" - mac_addr: "MAC_FMT" psta == NULL\n", __func__, ADPT_ARG(adapter), MAC_ARG(tgt_network->network.MacAddress)); rtw_warn_on(1); } - } else { - RTW_DBG("%s: fwstate: %08x\n", __func__, pmlmepriv->fw_state); } } @@ -2518,8 +2527,7 @@ void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf) if (psta) rtw_wfd_st_switch(psta, 0); - /* if(check_fwstate(pmlmepriv, WIFI_AP_STATE)) */ - if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { + if (MLME_IS_AP(adapter)) { #ifdef CONFIG_IOCTL_CFG80211 #ifdef COMPAT_KERNEL_RELEASE @@ -2667,11 +2675,11 @@ void rtw_wmm_event_callback(PADAPTER padapter, u8 *pbuf) } /* -* _rtw_join_timeout_handler - Timeout/faliure handler for CMD JoinBss -* @adapter: pointer to _adapter structure +* rtw_join_timeout_handler - Timeout/failure handler for CMD JoinBss */ -void _rtw_join_timeout_handler(_adapter *adapter) +void rtw_join_timeout_handler(void *ctx) { + _adapter *adapter = (_adapter *)ctx; _irqL irqL; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; @@ -2751,8 +2759,9 @@ void _rtw_join_timeout_handler(_adapter *adapter) * rtw_scan_timeout_handler - Timeout/Faliure handler for CMD SiteSurvey * @adapter: pointer to _adapter structure */ -void rtw_scan_timeout_handler(_adapter *adapter) +void rtw_scan_timeout_handler(void *ctx) { + _adapter *adapter = (_adapter *)ctx; _irqL irqL; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; RTW_INFO(FUNC_ADPT_FMT" fw_state=%x\n", FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); @@ -2805,25 +2814,10 @@ void rtw_mlme_reset_auto_scan_int(_adapter *adapter, u8 *reason) void rtw_drv_scan_by_self(_adapter *padapter, u8 reason) { + struct sitesurvey_parm parm; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct rtw_ieee80211_channel ch_for_2040_bss[14] = { - {1, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {2, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {3, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {4, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {5, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {6, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {7, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {8, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {9, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {10, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {11, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {12, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {13, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - {14, RTW_IEEE80211_CHAN_PASSIVE_SCAN}, - }; - struct rtw_ieee80211_channel *ch_sel = NULL; - int ch_num = 0; + int i; + if (rtw_is_scan_deny(padapter)) goto exit; @@ -2862,11 +2856,17 @@ void rtw_drv_scan_by_self(_adapter *padapter, u8 reason) /* only for 20/40 BSS */ if (reason == RTW_AUTO_SCAN_REASON_2040_BSS) { - ch_sel = ch_for_2040_bss; - ch_num = 14; + rtw_init_sitesurvey_parm(padapter, &parm); + for (i=0;i<14;i++) { + parm.ch[i].hw_value = i + 1; + parm.ch[i].flags = RTW_IEEE80211_CHAN_PASSIVE_SCAN; + } + parm.ch_num = 14; + rtw_set_802_11_bssid_list_scan(padapter, &parm); + goto exit; } - rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, ch_sel, ch_num); + rtw_set_802_11_bssid_list_scan(padapter, NULL); exit: return; } @@ -2938,12 +2938,18 @@ void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter) /* auto site survey */ rtw_auto_scan_handler(adapter); -#ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK #ifdef CONFIG_AP_MODE - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (MLME_IS_AP(adapter)|| MLME_IS_MESH(adapter)) { + #ifndef CONFIG_ACTIVE_KEEP_ALIVE_CHECK expire_timeout_chk(adapter); -#endif -#endif /* !CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ + #endif /* !CONFIG_ACTIVE_KEEP_ALIVE_CHECK */ + + #ifdef CONFIG_BMC_TX_RATE_SELECT + rtw_update_bmc_sta_tx_rate(adapter); + #endif /*CONFIG_BMC_TX_RATE_SELECT*/ + } +#endif /*CONFIG_AP_MODE*/ + #ifdef CONFIG_BR_EXT @@ -2976,6 +2982,61 @@ void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter) } +/*TP_avg(t) = (1/10) * TP_avg(t-1) + (9/10) * TP(t) MBps*/ +static void collect_sta_traffic_statistics(_adapter *adapter) +{ + struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; + struct sta_info *sta; + u16 curr_tx_mbytes = 0, curr_rx_mbytes = 0; + int i; + + for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { + sta = macid_ctl->sta[i]; + if (sta && !is_broadcast_mac_addr(sta->cmn.mac_addr)) { + if (sta->sta_stats.last_tx_bytes > sta->sta_stats.tx_bytes) + sta->sta_stats.last_tx_bytes = sta->sta_stats.tx_bytes; + if (sta->sta_stats.last_rx_bytes > sta->sta_stats.rx_bytes) + sta->sta_stats.last_rx_bytes = sta->sta_stats.rx_bytes; + if (sta->sta_stats.last_rx_bc_bytes > sta->sta_stats.rx_bc_bytes) + sta->sta_stats.last_rx_bc_bytes = sta->sta_stats.rx_bc_bytes; + if (sta->sta_stats.last_rx_mc_bytes > sta->sta_stats.rx_mc_bytes) + sta->sta_stats.last_rx_mc_bytes = sta->sta_stats.rx_mc_bytes; + + curr_tx_mbytes = ((sta->sta_stats.tx_bytes - sta->sta_stats.last_tx_bytes) >> 20) / 2; /*MBps*/ + curr_rx_mbytes = ((sta->sta_stats.rx_bytes - sta->sta_stats.last_rx_bytes) >> 20) / 2; /*MBps*/ + sta->sta_stats.tx_tp_mbytes = curr_tx_mbytes; + sta->sta_stats.rx_tp_mbytes = curr_rx_mbytes; + + sta->cmn.tx_moving_average_tp = + (sta->cmn.tx_moving_average_tp / 10) + (curr_tx_mbytes * 9 / 10); + + sta->cmn.rx_moving_average_tp = + (sta->cmn.rx_moving_average_tp / 10) + (curr_rx_mbytes * 9 /10); + + if (adapter->bsta_tp_dump) + dump_sta_traffic(RTW_DBGDUMP, adapter, sta); + + sta->sta_stats.last_tx_bytes = sta->sta_stats.tx_bytes; + sta->sta_stats.last_rx_bytes = sta->sta_stats.rx_bytes; + sta->sta_stats.last_rx_bc_bytes = sta->sta_stats.rx_bc_bytes; + sta->sta_stats.last_rx_mc_bytes = sta->sta_stats.rx_mc_bytes; + } + } +} + +void rtw_sta_traffic_info(void *sel, _adapter *adapter) +{ + struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; + struct sta_info *sta; + int i; + + for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { + sta = macid_ctl->sta[i]; + if (sta && !is_broadcast_mac_addr(sta->cmn.mac_addr)) + dump_sta_traffic(sel, adapter, sta); + } +} + /*#define DBG_TRAFFIC_STATISTIC*/ static void collect_traffic_statistics(_adapter *padapter) { @@ -3017,23 +3078,36 @@ static void collect_traffic_statistics(_adapter *padapter) #endif } -void rtw_dynamic_check_timer_handlder(_adapter *adapter) +void rtw_dynamic_check_timer_handlder(void *ctx) { + struct dvobj_priv *pdvobj = (struct dvobj_priv *)ctx; + _adapter *adapter = dvobj_get_primary_adapter(pdvobj); + +#if (MP_DRIVER == 1) + if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm == 0) { /* for MP ODM dynamic Tx power tracking */ + /* RTW_INFO("%s mp_dm =0 return\n", __func__); */ + goto exit; + } +#endif + if (!adapter) - return; + goto exit; if (!rtw_is_hw_init_completed(adapter)) - return; + goto exit; if (RTW_CANNOT_RUN(adapter)) - return; + goto exit; collect_traffic_statistics(adapter); - + collect_sta_traffic_statistics(adapter); rtw_mi_dynamic_check_timer_handlder(adapter); if (!is_drv_in_lps(adapter)) rtw_dynamic_chk_wk_cmd(adapter); + +exit: + _set_timer(&pdvobj->dynamic_chk_timer, 2000); } @@ -3052,8 +3126,10 @@ inline void rtw_clear_scan_deny(_adapter *adapter) RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(adapter)); } -void rtw_set_scan_deny_timer_hdl(_adapter *adapter) +void rtw_set_scan_deny_timer_hdl(void *ctx) { + _adapter *adapter = (_adapter *)ctx; + rtw_clear_scan_deny(adapter); } void rtw_set_scan_deny(_adapter *adapter, u32 ms) @@ -3083,6 +3159,11 @@ static int rtw_check_roaming_candidate(struct mlme_priv *mlme u8 *ptmp = NULL; #endif +#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) + if (rtw_rson_isupdate_roamcan(mlme, candidate, competitor)) + goto update; + goto exit; +#endif if (is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE) goto exit; @@ -3133,7 +3214,7 @@ static int rtw_check_roaming_candidate(struct mlme_priv *mlme goto exit; } #if 1 - if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms) + if (rtw_get_passing_time_ms(competitor->last_scanned) >= mlme->roam_scanr_exp_ms) goto exit; if (competitor->network.Rssi - mlme->cur_network_scanned->network.Rssi < mlme->roam_rssi_diff_th) @@ -3198,14 +3279,37 @@ int rtw_select_roaming_candidate(struct mlme_priv *mlme) } if (candidate == NULL) { + /* if parent note lost the path to root and there is no other cadidate, report disconnection */ +#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) + struct rtw_rson_struct rson_curr; + u8 rson_score; + + rtw_get_rson_struct(&(mlme->cur_network_scanned->network), &rson_curr); + rson_score = rtw_cal_rson_score(&rson_curr, mlme->cur_network_scanned->network.Rssi); + if (check_fwstate(mlme, _FW_LINKED) + && ((rson_score == RTW_RSON_SCORE_NOTCNNT) + || (rson_score == RTW_RSON_SCORE_NOTSUP))) + receive_disconnect(adapter, mlme->cur_network_scanned->network.MacAddress + , WLAN_REASON_EXPIRATION_CHK, _FALSE); +#endif RTW_INFO("%s: return _FAIL(candidate == NULL)\n", __FUNCTION__); ret = _FAIL; goto exit; } else { +#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) + struct rtw_rson_struct rson_curr; + u8 rson_score; + + rtw_get_rson_struct(&(candidate->network), &rson_curr); + rson_score = rtw_cal_rson_score(&rson_curr, candidate->network.Rssi); + RTW_INFO("%s: candidate: %s("MAC_FMT", ch:%u) rson_score:%d\n", __FUNCTION__, + candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), + candidate->network.Configuration.DSConfig, rson_score); +#else RTW_INFO("%s: candidate: %s("MAC_FMT", ch:%u)\n", __FUNCTION__, candidate->network.Ssid.Ssid, MAC_ARG(candidate->network.MacAddress), candidate->network.Configuration.DSConfig); - +#endif mlme->roam_network = candidate; if (_rtw_memcmp(candidate->network.MacAddress, mlme->roam_tgt_addr, ETH_ALEN) == _TRUE) @@ -3231,6 +3335,27 @@ static int rtw_check_join_candidate(struct mlme_priv *mlme int updated = _FALSE; _adapter *adapter = container_of(mlme, _adapter, mlmepriv); + if (rtw_chset_search_ch(adapter_to_chset(adapter), competitor->network.Configuration.DSConfig) < 0) + goto exit; + +#if defined(CONFIG_RTW_REPEATER_SON) && (!defined(CONFIG_RTW_REPEATER_SON_ROOT)) + s16 rson_score; + struct rtw_rson_struct rson_data; + + if (rtw_rson_choose(candidate, competitor)) { + *candidate = competitor; + rtw_get_rson_struct(&((*candidate)->network), &rson_data); + rson_score = rtw_cal_rson_score(&rson_data, (*candidate)->network.Rssi); + RTW_INFO("[assoc_ssid:%s] new candidate: %s("MAC_FMT", ch%u) rson_score:%d\n", + mlme->assoc_ssid.Ssid, + (*candidate)->network.Ssid.Ssid, + MAC_ARG((*candidate)->network.MacAddress), + (*candidate)->network.Configuration.DSConfig, + rson_score); + return _TRUE; + } + return _FALSE; +#endif /* check bssid, if needed */ if (mlme->assoc_by_bssid == _TRUE) { @@ -3251,7 +3376,7 @@ static int rtw_check_join_candidate(struct mlme_priv *mlme #ifdef CONFIG_LAYER2_ROAMING if (rtw_to_roam(adapter) > 0) { - if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms + if (rtw_get_passing_time_ms(competitor->last_scanned) >= mlme->roam_scanr_exp_ms || is_same_ess(&competitor->network, &mlme->cur_network.network) == _FALSE ) goto exit; @@ -3370,7 +3495,7 @@ int rtw_select_and_join_from_scanned_queue(struct mlme_priv *pmlmepriv) } else #endif { - rtw_disassoc_cmd(adapter, 0, _TRUE); + rtw_disassoc_cmd(adapter, 0, 0); rtw_indicate_disconnect(adapter, 0, _FALSE); rtw_free_assoc_resources(adapter, 0); } @@ -3526,12 +3651,111 @@ sint rtw_set_key(_adapter *adapter, struct security_priv *psecuritypriv, sint ke } +#ifdef CONFIG_WMMPS_STA +/* + * rtw_uapsd_use_default_setting + * This function is used for setting default uapsd max sp length to uapsd_max_sp_len + * in qos_priv data structure from registry. In additional, it will also map default uapsd + * ac to each uapsd TID, delivery-enabled and trigger-enabled of corresponding TID. + * + * Arguments: + * @padapter: _adapter pointer. + * + * Auther: Arvin Liu + * Date: 2017/05/03 + */ +void rtw_uapsd_use_default_setting(_adapter *padapter) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct qos_priv *pqospriv = &pmlmepriv->qospriv; + struct registry_priv *pregistrypriv = &padapter->registrypriv; + + if (pregistrypriv->uapsd_ac_enable != 0) { + pqospriv->uapsd_max_sp_len = pregistrypriv->uapsd_max_sp_len; + + CLEAR_FLAGS(pqospriv->uapsd_tid); + CLEAR_FLAGS(pqospriv->uapsd_tid_delivery_enabled); + CLEAR_FLAGS(pqospriv->uapsd_tid_trigger_enabled); + + /* check the uapsd setting of AC_VO from registry then map these setting to each TID if necessary */ + if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_VO)) { + SET_FLAG(pqospriv->uapsd_tid, WMM_TID7); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID7); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID7); + SET_FLAG(pqospriv->uapsd_tid, WMM_TID6); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID6); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID6); + } + + /* check the uapsd setting of AC_VI from registry then map these setting to each TID if necessary */ + if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_VI)) { + SET_FLAG(pqospriv->uapsd_tid, WMM_TID5); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID5); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID5); + SET_FLAG(pqospriv->uapsd_tid, WMM_TID4); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID4); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID4); + } + + /* check the uapsd setting of AC_BK from registry then map these setting to each TID if necessary */ + if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_BK)) { + SET_FLAG(pqospriv->uapsd_tid, WMM_TID2); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID2); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID2); + SET_FLAG(pqospriv->uapsd_tid, WMM_TID1); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID1); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID1); + } + + /* check the uapsd setting of AC_BE from registry then map these setting to each TID if necessary */ + if(TEST_FLAG(pregistrypriv->uapsd_ac_enable, DRV_CFG_UAPSD_BE)) { + SET_FLAG(pqospriv->uapsd_tid, WMM_TID3); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID3); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID3); + SET_FLAG(pqospriv->uapsd_tid, WMM_TID0); + SET_FLAG(pqospriv->uapsd_tid_delivery_enabled, WMM_TID0); + SET_FLAG(pqospriv->uapsd_tid_trigger_enabled, WMM_TID0); + } + + RTW_INFO("[WMMPS] UAPSD MAX SP Len = 0x%02x, UAPSD TID enabled = 0x%02x\n", + pqospriv->uapsd_max_sp_len, (u8)pqospriv->uapsd_tid); + } + +} + +/* + * rtw_is_wmmps_mode + * This function is used for checking whether Driver and an AP support uapsd function or not. + * If both of them support uapsd function, it will return true. Otherwise returns false. + * + * Arguments: + * @padapter: _adapter pointer. + * + * Auther: Arvin Liu + * Date: 2017/06/12 + */ +bool rtw_is_wmmps_mode(_adapter *padapter) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct qos_priv *pqospriv = &pmlmepriv->qospriv; + + if ((pqospriv->uapsd_ap_supported) && ((pqospriv->uapsd_tid & BIT_MASK_TID_TC) != 0)) + return _TRUE; + + return _FALSE; +} +#endif /* CONFIG_WMMPS_STA */ /* adjust IEs for rtw_joinbss_cmd in WMM */ int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len) { +#ifdef CONFIG_WMMPS_STA + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct qos_priv *pqospriv = &pmlmepriv->qospriv; +#endif /* CONFIG_WMMPS_STA */ unsigned int ielength = 0; unsigned int i, j; + u8 qos_info = 0; i = 12; /* after the fixed IE */ while (i < in_len) { @@ -3554,7 +3778,42 @@ int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, u } out_ie[initial_out_len + 1] = 0x07; out_ie[initial_out_len + 6] = 0x00; - out_ie[initial_out_len + 8] = 0x00; + +#ifdef CONFIG_WMMPS_STA + switch(pqospriv->uapsd_max_sp_len) { + case NO_LIMIT: + /* do nothing */ + break; + case TWO_MSDU: + SET_FLAG(qos_info, BIT5); + break; + case FOUR_MSDU: + SET_FLAG(qos_info, BIT6); + break; + case SIX_MSDU: + SET_FLAG(qos_info, BIT5); + SET_FLAG(qos_info, BIT6); + break; + default: + /* do nothing */ + break; + }; + + /* check TID7 and TID6 for AC_VO to set corresponding Qos_info bit in WMM IE */ + if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID7)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID6))) + SET_FLAG(qos_info, WMM_IE_UAPSD_VO); + /* check TID5 and TID4 for AC_VI to set corresponding Qos_info bit in WMM IE */ + if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID5)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID4))) + SET_FLAG(qos_info, WMM_IE_UAPSD_VI); + /* check TID2 and TID1 for AC_BK to set corresponding Qos_info bit in WMM IE */ + if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID2)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID1))) + SET_FLAG(qos_info, WMM_IE_UAPSD_BK); + /* check TID3 and TID0 for AC_BE to set corresponding Qos_info bit in WMM IE */ + if((TEST_FLAG(pqospriv->uapsd_tid, WMM_TID3)) && (TEST_FLAG(pqospriv->uapsd_tid, WMM_TID0))) + SET_FLAG(qos_info, WMM_IE_UAPSD_BE); +#endif /* CONFIG_WMMPS_STA */ + + out_ie[initial_out_len + 8] = qos_info; break; } @@ -3716,10 +3975,6 @@ sint rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len) }*/ ielength += psecuritypriv->supplicant_ie[1] + 2; rtw_report_sec_ie(adapter, authmode, psecuritypriv->supplicant_ie); - -#ifdef CONFIG_DRVEXT_MODULE - drvext_report_sec_ie(&adapter->drvextpriv, authmode, sec_ie); -#endif } iEntry = SecIsInPMKIDList(adapter, pmlmepriv->assoc_bssid); @@ -3968,11 +4223,16 @@ unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, ui HT_CAP_AMPDU_DENSITY best_ampdu_density; unsigned char *p, *pframe; struct rtw_ieee80211_ht_cap ht_capie; - u8 cbw40_enable = 0, rf_type = 0, operation_bw = 0, rf_num = 0, rx_stbc_nss = 0; + u8 cbw40_enable = 0, rf_type = 0, operation_bw = 0, rf_num = 0, rx_stbc_nss = 0, rx_nss = 0; struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct ht_priv *phtpriv = &pmlmepriv->htpriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); +#ifdef CONFIG_80211AC_VHT + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; +#endif /* CONFIG_80211AC_VHT */ phtpriv->ht_option = _FALSE; @@ -4064,28 +4324,28 @@ unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, ui /* update default supported_mcs_set */ rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + rx_nss = rtw_min(rf_type_to_rf_rx_cnt(rf_type), hal_spec->rx_nss_num); - switch (rf_type) { - case RF_1T1R: + switch (rx_nss) { + case 1: set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_1R); break; - - case RF_2T2R: - case RF_1T2R: -#ifdef CONFIG_DISABLE_MCS13TO15 + case 2: + #ifdef CONFIG_DISABLE_MCS13TO15 if (((cbw40_enable == 1) && (operation_bw == CHANNEL_WIDTH_40)) && (pregistrypriv->wifi_spec != 1)) set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R_13TO15_OFF); else + #endif set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -#else /* CONFIG_DISABLE_MCS13TO15 */ - set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_2R); -#endif /* CONFIG_DISABLE_MCS13TO15 */ break; - case RF_3T3R: + case 3: set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_3R); break; + case 4: + set_mcs_rate_by_mask(ht_capie.supp_mcs_set, MCS_RATE_4R); + break; default: - RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); + RTW_WARN("rf_type:%d or rx_nss:%u is not expected\n", rf_type, hal_spec->rx_nss_num); } { @@ -4153,7 +4413,14 @@ unsigned int rtw_restructure_ht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, ui SET_HT_CAP_TXBF_RECEIVE_NDP_CAP(&ht_capie, 1); /* Explicit Compressed Beamforming Feedback Capable */ SET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(&ht_capie, 2); + rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); +#ifdef CONFIG_80211AC_VHT + /* IOT action suggested by Yu Chen 2017/3/3 */ + if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) && + !GET_VHT_CAPABILITY_ELE_MU_BFER(&pvhtpriv->beamform_cap)) + rf_num = (rf_num >= 2 ? 2 : rf_num); +#endif SET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(&ht_capie, rf_num); } #endif/*CONFIG_BEAMFORMING*/ @@ -4248,36 +4515,39 @@ void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel) if ((cbw40_enable) && (pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info & BIT(1)) && (pmlmeinfo->HT_info.infos[0] & BIT(2))) { + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); int i; u8 rf_type = RF_1T1R; + u8 tx_nss = 0; rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + tx_nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); /* update the MCS set */ for (i = 0; i < 16; i++) pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; /* update the MCS rates */ - switch (rf_type) { - case RF_1T1R: - case RF_1T2R: + switch (tx_nss) { + case 1: set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); break; - case RF_2T2R: -#ifdef CONFIG_DISABLE_MCS13TO15 + case 2: + #ifdef CONFIG_DISABLE_MCS13TO15 if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); else + #endif set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -#else /* CONFIG_DISABLE_MCS13TO15 */ - set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -#endif /* CONFIG_DISABLE_MCS13TO15 */ break; - case RF_3T3R: + case 3: set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); break; + case 4: + set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_4R); + break; default: - RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); + RTW_WARN("rf_type:%d or tx_nss_num:%u is not expected\n", rf_type, hal_spec->tx_nss_num); } /* switch to the 40M Hz mode accoring to the AP */ @@ -4315,46 +4585,6 @@ void rtw_update_ht_cap(_adapter *padapter, u8 *pie, uint ie_len, u8 channel) /* Config current HT Protection mode. */ /* */ pmlmeinfo->HT_protection = pmlmeinfo->HT_info.infos[1] & 0x3; - - - -#if 0 /* move to rtw_update_sta_info_client() */ - /* for A-MPDU Rx reordering buffer control for bmc_sta & sta_info */ - /* if A-MPDU Rx is enabled, reseting rx_ordering_ctrl wstart_b(indicate_seq) to default value=0xffff */ - /* todo: check if AP can send A-MPDU packets */ - bmc_sta = rtw_get_bcmc_stainfo(padapter); - if (bmc_sta) { - for (i = 0; i < 16 ; i++) { - /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ - preorder_ctrl = &bmc_sta->recvreorder_ctrl[i]; - preorder_ctrl->enable = _FALSE; - preorder_ctrl->indicate_seq = 0xffff; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq); -#endif - preorder_ctrl->wend_b = 0xffff; - preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ - } - } - - psta = rtw_get_stainfo(&padapter->stapriv, pcur_network->network.MacAddress); - if (psta) { - for (i = 0; i < 16 ; i++) { - /* preorder_ctrl = &precvpriv->recvreorder_ctrl[i]; */ - preorder_ctrl = &psta->recvreorder_ctrl[i]; - preorder_ctrl->enable = _FALSE; - preorder_ctrl->indicate_seq = 0xffff; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d indicate_seq:%u\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq); -#endif - preorder_ctrl->wend_b = 0xffff; - preorder_ctrl->wsize_b = 64;/* max_ampdu_sz; */ /* ex. 32(kbytes) -> wsize_b=32 */ - } - } -#endif - } #ifdef CONFIG_TDLS @@ -4539,7 +4769,6 @@ void _rtw_roaming(_adapter *padapter, struct wlan_network *tgt_network) } #endif /* CONFIG_LAYER2_ROAMING */ -#ifdef CONFIG_80211N_HT bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset) { struct registry_priv *regsty = adapter_to_regsty(adapter); @@ -4564,12 +4793,12 @@ bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset) return _TRUE; } -#endif sint rtw_linked_check(_adapter *padapter) { - if ((check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) || - (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) == _TRUE)) { + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter) + || MLME_IS_ADHOC(padapter) || MLME_IS_ADHOC_MASTER(padapter) + ) { if (padapter->stapriv.asoc_sta_count > 2) return _TRUE; } else { @@ -4579,23 +4808,33 @@ sint rtw_linked_check(_adapter *padapter) } return _FALSE; } +/*#define DBG_ADAPTER_STATE_CHK*/ u8 rtw_is_adapter_up(_adapter *padapter) { if (padapter == NULL) return _FALSE; if (RTW_CANNOT_RUN(padapter)) { - RTW_INFO(FUNC_ADPT_FMT "-(bSurpriseRemoved == _TRUE) || ( bDriverStopped == _TRUE)\n", FUNC_ADPT_ARG(padapter)); + #ifdef DBG_ADAPTER_STATE_CHK + RTW_INFO(FUNC_ADPT_FMT " FALSE -bDriverStopped(%s) bSurpriseRemoved(%s)\n" + , FUNC_ADPT_ARG(padapter) + , rtw_is_drv_stopped(padapter) ? "True" : "False" + , rtw_is_surprise_removed(padapter) ? "True" : "False"); + #endif return _FALSE; } if (!rtw_is_hw_init_completed(padapter)) { - /*RTW_INFO(FUNC_ADPT_FMT "-(hw_init_completed == _FALSE)\n", FUNC_ADPT_ARG(padapter));*/ + #ifdef DBG_ADAPTER_STATE_CHK + RTW_INFO(FUNC_ADPT_FMT " FALSE -(hw_init_completed == _FALSE)\n", FUNC_ADPT_ARG(padapter)); + #endif return _FALSE; } if (padapter->bup == _FALSE) { - /*RTW_INFO(FUNC_ADPT_FMT "-(bup == _FALSE)\n", FUNC_ADPT_ARG(padapter));*/ + #ifdef DBG_ADAPTER_STATE_CHK + RTW_INFO(FUNC_ADPT_FMT " FALSE -(bup == _FALSE)\n", FUNC_ADPT_ARG(padapter)); + #endif return _FALSE; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme_ext.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme_ext.c index 99e028a6e982..004b1604df1b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme_ext.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mlme_ext.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_MLME_EXT_C_ #include @@ -78,7 +73,7 @@ struct action_handler OnAction_tbl[] = { {RTW_WLAN_CATEGORY_DLS, "ACTION_DLS", &OnAction_dls}, {RTW_WLAN_CATEGORY_BACK, "ACTION_BACK", &OnAction_back}, {RTW_WLAN_CATEGORY_PUBLIC, "ACTION_PUBLIC", on_action_public}, - {RTW_WLAN_CATEGORY_RADIO_MEASUREMENT, "ACTION_RADIO_MEASUREMENT", &DoReserved}, + {RTW_WLAN_CATEGORY_RADIO_MEAS, "ACTION_RADIO_MEAS", &on_action_rm}, {RTW_WLAN_CATEGORY_FT, "ACTION_FT", &OnAction_ft}, {RTW_WLAN_CATEGORY_HT, "ACTION_HT", &OnAction_ht}, #ifdef CONFIG_IEEE80211W @@ -155,6 +150,7 @@ static struct ch_list_t RTW_ChannelPlan2G[] = { /* 6, RTW_RD_2G_GLOBAL */ CH_LIST_ENT(14, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14), /* 7, RTW_RD_2G_MKK2 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), /* 8, RTW_RD_2G_FCC2 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), + /* 9, RTW_RD_2G_IC1 */ CH_LIST_ENT(13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13), }; #ifdef CONFIG_IEEE80211_BAND_5GHZ @@ -170,30 +166,48 @@ static struct ch_list_t RTW_ChannelPlan5G[] = { /* 8, RTW_RD_5G_FCC5 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), /* 9, RTW_RD_5G_FCC6 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), /* 10, RTW_RD_5G_FCC7 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), - /* 11, RTW_RD_5G_KCC1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161), - /* 12, RTW_RD_5G_MKK1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), - /* 13, RTW_RD_5G_MKK2 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), - /* 14, RTW_RD_5G_MKK3 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), - /* 15, RTW_RD_5G_NCC1 */ CH_LIST_ENT(16, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), - /* 16, RTW_RD_5G_NCC2 */ CH_LIST_ENT(8, 56, 60, 64, 149, 153, 157, 161, 165), - /* 17, RTW_RD_5G_NCC3 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), - /* 18, RTW_RD_5G_ETSI4 */ CH_LIST_ENT(4, 36, 40, 44, 48), - /* 19, RTW_RD_5G_ETSI5 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), - /* 20, RTW_RD_5G_FCC8 */ CH_LIST_ENT(4, 149, 153, 157, 161), - /* 21, RTW_RD_5G_ETSI6 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), - /* 22, RTW_RD_5G_ETSI7 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), - /* 23, RTW_RD_5G_ETSI8 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), - /* 24, RTW_RD_5G_ETSI9 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), - /* 25, RTW_RD_5G_ETSI10 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), - /* 26, RTW_RD_5G_ETSI11 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 149, 153, 157, 161, 165), - /* 27, RTW_RD_5G_NCC4 */ CH_LIST_ENT(17, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), - /* 28, RTW_RD_5G_ETSI12 */ CH_LIST_ENT(4, 149, 153, 157, 161), - /* 29, RTW_RD_5G_FCC9 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), - /* 30, RTW_RD_5G_ETSI13 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140), - /* 31, RTW_RD_5G_FCC10 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161), - /* 32, RTW_RD_5G_MKK4 */ CH_LIST_ENT(4, 36, 40, 44, 48), - /* 33, RTW_RD_5G_ETSI14 */ CH_LIST_ENT(11, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140), - /* 34, RTW_RD_5G_FCC11 */ CH_LIST_ENT(25, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, 149, 153, 157, 161, 165), + /* 11, RTW_RD_5G_IC1 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), + /* 12, RTW_RD_5G_KCC1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 149, 153, 157, 161), + /* 13, RTW_RD_5G_MKK1 */ CH_LIST_ENT(19, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), + /* 14, RTW_RD_5G_MKK2 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), + /* 15, RTW_RD_5G_MKK3 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), + /* 16, RTW_RD_5G_NCC1 */ CH_LIST_ENT(16, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), + /* 17, RTW_RD_5G_NCC2 */ CH_LIST_ENT(8, 56, 60, 64, 149, 153, 157, 161, 165), + /* 18, RTW_RD_5G_NCC3 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), + /* 19, RTW_RD_5G_ETSI4 */ CH_LIST_ENT(4, 36, 40, 44, 48), + /* 20, RTW_RD_5G_ETSI5 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), + /* 21, RTW_RD_5G_FCC8 */ CH_LIST_ENT(4, 149, 153, 157, 161), + /* 22, RTW_RD_5G_ETSI6 */ CH_LIST_ENT(8, 36, 40, 44, 48, 52, 56, 60, 64), + /* 23, RTW_RD_5G_ETSI7 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), + /* 24, RTW_RD_5G_ETSI8 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), + /* 25, RTW_RD_5G_ETSI9 */ CH_LIST_ENT(11, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140), + /* 26, RTW_RD_5G_ETSI10 */ CH_LIST_ENT(5, 149, 153, 157, 161, 165), + /* 27, RTW_RD_5G_ETSI11 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140, 149, 153, 157, 161, 165), + /* 28, RTW_RD_5G_NCC4 */ CH_LIST_ENT(17, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), + /* 29, RTW_RD_5G_ETSI12 */ CH_LIST_ENT(4, 149, 153, 157, 161), + /* 30, RTW_RD_5G_FCC9 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), + /* 31, RTW_RD_5G_ETSI13 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140), + /* 32, RTW_RD_5G_FCC10 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161), + /* 33, RTW_RD_5G_MKK4 */ CH_LIST_ENT(4, 36, 40, 44, 48), + /* 34, RTW_RD_5G_ETSI14 */ CH_LIST_ENT(11, 36, 40, 44, 48, 52, 56, 60, 64, 132, 136, 140), + /* 35, RTW_RD_5G_FCC11 */ CH_LIST_ENT(25, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, 149, 153, 157, 161, 165), + /* 36, RTW_RD_5G_ETSI15 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 149, 153, 157, 161, 165), + /* 37, RTW_RD_5G_MKK5 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), + /* 38, RTW_RD_5G_ETSI16 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), + /* 39, RTW_RD_5G_ETSI17 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), + /* 40, RTW_RD_5G_FCC12*/ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), + /* 41, RTW_RD_5G_FCC13 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), + /* 42, RTW_RD_5G_FCC14 */ CH_LIST_ENT(21, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), + /* 43, RTW_RD_5G_FCC15 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), + /* 44, RTW_RD_5G_FCC16 */ CH_LIST_ENT(13, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165), + /* 45, RTW_RD_5G_ETSI18 */ CH_LIST_ENT(9, 36, 40, 44, 48, 149, 153, 157, 161, 165), + /* 46, RTW_RD_5G_ETSI19 */ CH_LIST_ENT(24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 149, 153, 157, 161, 165), + /* 47, RTW_RD_5G_FCC17 */ CH_LIST_ENT(16, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140), + /* 48, RTW_RD_5G_ETSI20 */ CH_LIST_ENT(9, 52, 56, 60, 64, 149, 153, 157, 161, 165), + /* 49, RTW_RD_5G_IC2 */ CH_LIST_ENT(22, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 132, 136, 140, 144, 149, 153, 157, 161, 165), + /* 50, RTW_RD_5G_ETSI21 */ CH_LIST_ENT(13, 100, 104, 108, 112, 116, 132, 136, 140, 149, 153, 157, 161, 165), + /* 51, RTW_RD_5G_FCC18 */ CH_LIST_ENT(8, 100, 104, 108, 112, 116, 132, 136, 140), + /* 52, RTW_RD_5G_WORLD */ CH_LIST_ENT(25, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, 149, 153, 157, 161, 165), /* === Below are driver defined for legacy channel plan compatible, NO static index assigned ==== */ /* RTW_RD_5G_OLD_FCC1 */ CH_LIST_ENT(20, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 136, 140, 149, 153, 157, 161, 165), @@ -246,10 +260,10 @@ static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[] = { CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC1, TXPWR_LMT_FCC), /* 0x25, RTW_CHPLAN_FCC1_FCC1 */ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI1, TXPWR_LMT_ETSI), /* 0x26, RTW_CHPLAN_WORLD_ETSI1 */ CHPLAN_ENT(RTW_RD_2G_MKK1, RTW_RD_5G_MKK1, TXPWR_LMT_MKK), /* 0x27, RTW_CHPLAN_MKK1_MKK1 */ - CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_KCC1, TXPWR_LMT_ETSI), /* 0x28, RTW_CHPLAN_WORLD_KCC1 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_KCC1, TXPWR_LMT_KCC), /* 0x28, RTW_CHPLAN_WORLD_KCC1 */ CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC2, TXPWR_LMT_FCC), /* 0x29, RTW_CHPLAN_WORLD_FCC2 */ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_NULL, TXPWR_LMT_FCC), /* 0x2A, RTW_CHPLAN_FCC2_NULL */ - CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2B, */ + CHPLAN_ENT(RTW_RD_2G_IC1, RTW_RD_5G_IC2, TXPWR_LMT_IC), /* 0x2B, RTW_CHPLAN_IC1_IC2 */ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2C, */ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2D, */ CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_NULL, TXPWR_LMT_WW), /* 0x2E, */ @@ -305,6 +319,29 @@ static RT_CHANNEL_PLAN_MAP RTW_ChannelPlanMap[] = { CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC5, TXPWR_LMT_FCC), /* 0x60, RTW_CHPLAN_FCC1_FCC5 */ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x61, RTW_CHPLAN_FCC2_FCC7 */ CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC1, TXPWR_LMT_FCC), /* 0x62, RTW_CHPLAN_FCC2_FCC1 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI15, TXPWR_LMT_ETSI), /* 0x63, RTW_CHPLAN_WORLD_ETSI15 */ + CHPLAN_ENT(RTW_RD_2G_MKK2, RTW_RD_5G_MKK5, TXPWR_LMT_MKK), /* 0x64, RTW_CHPLAN_MKK2_MKK5 */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI16, TXPWR_LMT_ETSI), /* 0x65, RTW_CHPLAN_ETSI1_ETSI16 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC14, TXPWR_LMT_FCC), /* 0x66, RTW_CHPLAN_FCC1_FCC14 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC12, TXPWR_LMT_FCC), /* 0x67, RTW_CHPLAN_FCC1_FCC12 */ + CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC14, TXPWR_LMT_FCC), /* 0x68, RTW_CHPLAN_FCC2_FCC14 */ + CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC12, TXPWR_LMT_FCC), /* 0x69, RTW_CHPLAN_FCC2_FCC12 */ + CHPLAN_ENT(RTW_RD_2G_ETSI1, RTW_RD_5G_ETSI17, TXPWR_LMT_ETSI), /* 0x6A, RTW_CHPLAN_ETSI1_ETSI17 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC16, TXPWR_LMT_FCC), /* 0x6B, RTW_CHPLAN_WORLD_FCC16 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC13, TXPWR_LMT_FCC), /* 0x6C, RTW_CHPLAN_WORLD_FCC13 */ + CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC15, TXPWR_LMT_FCC), /* 0x6D, RTW_CHPLAN_FCC2_FCC15 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC12, TXPWR_LMT_FCC), /* 0x6E, RTW_CHPLAN_WORLD_FCC12 */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_ETSI8, TXPWR_LMT_ETSI), /* 0x6F, RTW_CHPLAN_NULL_ETSI8 */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_ETSI18, TXPWR_LMT_ETSI), /* 0x70, RTW_CHPLAN_NULL_ETSI18 */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_ETSI17, TXPWR_LMT_ETSI), /* 0x71, RTW_CHPLAN_NULL_ETSI17 */ + CHPLAN_ENT(RTW_RD_2G_NULL, RTW_RD_5G_ETSI19, TXPWR_LMT_ETSI), /* 0x72, RTW_CHPLAN_NULL_ETSI19 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_FCC7, TXPWR_LMT_FCC), /* 0x73, RTW_CHPLAN_WORLD_FCC7 */ + CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC17, TXPWR_LMT_FCC), /* 0x74, RTW_CHPLAN_FCC2_FCC17 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI20, TXPWR_LMT_ETSI), /* 0x75, RTW_CHPLAN_WORLD_ETSI20 */ + CHPLAN_ENT(RTW_RD_2G_FCC2, RTW_RD_5G_FCC11, TXPWR_LMT_FCC), /* 0x76, RTW_CHPLAN_FCC2_FCC11 */ + CHPLAN_ENT(RTW_RD_2G_WORLD, RTW_RD_5G_ETSI21, TXPWR_LMT_ETSI), /* 0x77, RTW_CHPLAN_WORLD_ETSI21 */ + CHPLAN_ENT(RTW_RD_2G_FCC1, RTW_RD_5G_FCC18, TXPWR_LMT_FCC), /* 0x78, RTW_CHPLAN_FCC1_FCC18 */ + CHPLAN_ENT(RTW_RD_2G_MKK2, RTW_RD_5G_MKK1, TXPWR_LMT_MKK), /* 0x79, RTW_CHPLAN_MKK2_MKK1 */ }; static RT_CHANNEL_PLAN_MAP RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE = @@ -329,11 +366,342 @@ bool rtw_chplan_is_empty(u8 id) return _FALSE; } +bool rtw_regsty_is_excl_chs(struct registry_priv *regsty, u8 ch) +{ + int i; + + for (i = 0; i < MAX_CHANNEL_NUM; i++) { + if (regsty->excl_chs[i] == 0) + break; + if (regsty->excl_chs[i] == ch) + return _TRUE; + } + return _FALSE; +} + +inline u8 rtw_rd_5g_band1_passive(u8 rtw_rd_5g) +{ + u8 passive = 0; + + switch (rtw_rd_5g) { + case RTW_RD_5G_FCC13: + case RTW_RD_5G_FCC16: + case RTW_RD_5G_ETSI18: + case RTW_RD_5G_ETSI19: + case RTW_RD_5G_WORLD: + passive = 1; + }; + + return passive; +} + +inline u8 rtw_rd_5g_band4_passive(u8 rtw_rd_5g) +{ + u8 passive = 0; + + switch (rtw_rd_5g) { + case RTW_RD_5G_MKK5: + case RTW_RD_5G_ETSI16: + case RTW_RD_5G_ETSI18: + case RTW_RD_5G_ETSI19: + case RTW_RD_5G_WORLD: + passive = 1; + }; + + return passive; +} + +static void init_channel_list(_adapter *padapter, RT_CHANNEL_INFO *channel_set + , struct p2p_channels *channel_list) +{ + struct registry_priv *regsty = adapter_to_regsty(padapter); + + struct p2p_oper_class_map op_class[] = { + { IEEE80211G, 81, 1, 13, 1, BW20 }, + { IEEE80211G, 82, 14, 14, 1, BW20 }, +#if 0 /* Do not enable HT40 on 2 GHz */ + { IEEE80211G, 83, 1, 9, 1, BW40PLUS }, + { IEEE80211G, 84, 5, 13, 1, BW40MINUS }, +#endif + { IEEE80211A, 115, 36, 48, 4, BW20 }, + { IEEE80211A, 116, 36, 44, 8, BW40PLUS }, + { IEEE80211A, 117, 40, 48, 8, BW40MINUS }, + { IEEE80211A, 124, 149, 161, 4, BW20 }, + { IEEE80211A, 125, 149, 169, 4, BW20 }, + { IEEE80211A, 126, 149, 157, 8, BW40PLUS }, + { IEEE80211A, 127, 153, 161, 8, BW40MINUS }, + { -1, 0, 0, 0, 0, BW20 } + }; + + int cla, op; + + cla = 0; + + for (op = 0; op_class[op].op_class; op++) { + u8 ch; + struct p2p_oper_class_map *o = &op_class[op]; + struct p2p_reg_class *reg = NULL; + + for (ch = o->min_chan; ch <= o->max_chan; ch += o->inc) { + if (rtw_chset_search_ch(channel_set, ch) == -1) + continue; + + if ((padapter->registrypriv.ht_enable == 0) && (o->inc == 8)) + continue; + + if ((REGSTY_IS_BW_5G_SUPPORT(regsty, CHANNEL_WIDTH_40)) && + ((o->bw == BW40MINUS) || (o->bw == BW40PLUS))) + continue; + + if (reg == NULL) { + reg = &channel_list->reg_class[cla]; + cla++; + reg->reg_class = o->op_class; + reg->channels = 0; + } + reg->channel[reg->channels] = ch; + reg->channels++; + } + } + channel_list->reg_classes = cla; + +} + +static u8 init_channel_set(_adapter *padapter, u8 ChannelPlan, RT_CHANNEL_INFO *channel_set) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + struct registry_priv *regsty = adapter_to_regsty(padapter); + u8 index, chanset_size = 0; + u8 b5GBand = _FALSE, b2_4GBand = _FALSE; + u8 Index2G = 0, Index5G = 0; + int i; + + if (!rtw_is_channel_plan_valid(ChannelPlan)) { + RTW_ERR("ChannelPlan ID 0x%02X error !!!!!\n", ChannelPlan); + return chanset_size; + } + + _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); + + if (IsSupported24G(regsty->wireless_mode) && hal_chk_band_cap(padapter, BAND_CAP_2G)) + b2_4GBand = _TRUE; + + if (is_supported_5g(regsty->wireless_mode) && hal_chk_band_cap(padapter, BAND_CAP_5G)) + b5GBand = _TRUE; + + if (b2_4GBand == _FALSE && b5GBand == _FALSE) { + RTW_WARN("HW band_cap has no intersection with SW wireless_mode setting\n"); + return chanset_size; + } + + if (b2_4GBand) { + if (ChannelPlan == RTW_CHPLAN_REALTEK_DEFINE) + Index2G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index2G; + else + Index2G = RTW_ChannelPlanMap[ChannelPlan].Index2G; + + for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan2G[Index2G]); index++) { + if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index)) == _TRUE) + continue; + + if (chanset_size >= MAX_CHANNEL_NUM) { + RTW_WARN("chset size can't exceed MAX_CHANNEL_NUM(%u)\n", MAX_CHANNEL_NUM); + break; + } + + channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index); + + if (ChannelPlan == RTW_CHPLAN_GLOBAL_DOAMIN + || Index2G == RTW_RD_2G_GLOBAL + ) { + /* Channel 1~11 is active, and 12~14 is passive */ + if (channel_set[chanset_size].ChannelNum >= 1 && channel_set[chanset_size].ChannelNum <= 11) + channel_set[chanset_size].ScanType = SCAN_ACTIVE; + else if ((channel_set[chanset_size].ChannelNum >= 12 && channel_set[chanset_size].ChannelNum <= 14)) + channel_set[chanset_size].ScanType = SCAN_PASSIVE; + } else if (ChannelPlan == RTW_CHPLAN_WORLD_WIDE_13 + || ChannelPlan == RTW_CHPLAN_WORLD_WIDE_5G + || Index2G == RTW_RD_2G_WORLD + ) { + /* channel 12~13, passive scan */ + if (channel_set[chanset_size].ChannelNum <= 11) + channel_set[chanset_size].ScanType = SCAN_ACTIVE; + else + channel_set[chanset_size].ScanType = SCAN_PASSIVE; + } else + channel_set[chanset_size].ScanType = SCAN_ACTIVE; + + chanset_size++; + } + } + +#ifdef CONFIG_IEEE80211_BAND_5GHZ + if (b5GBand) { + if (ChannelPlan == RTW_CHPLAN_REALTEK_DEFINE) + Index5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index5G; + else + Index5G = RTW_ChannelPlanMap[ChannelPlan].Index5G; + + for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan5G[Index5G]); index++) { + if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index)) == _TRUE) + continue; + #ifndef CONFIG_DFS + if (rtw_is_dfs_ch(CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index))) + continue; + #endif + + if (chanset_size >= MAX_CHANNEL_NUM) { + RTW_WARN("chset size can't exceed MAX_CHANNEL_NUM(%u)\n", MAX_CHANNEL_NUM); + break; + } + + channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index); + + if ((ChannelPlan == RTW_CHPLAN_WORLD_WIDE_5G) /* all channels passive */ + || (rtw_is_5g_band1(channel_set[chanset_size].ChannelNum) + && rtw_rd_5g_band1_passive(Index5G)) /* band1 passive */ + || (rtw_is_5g_band4(channel_set[chanset_size].ChannelNum) + && rtw_rd_5g_band4_passive(Index5G)) /* band4 passive */ + || (rtw_is_dfs_ch(channel_set[chanset_size].ChannelNum)) /* DFS channel(band2, 3) passive */ + ) + channel_set[chanset_size].ScanType = SCAN_PASSIVE; + else + channel_set[chanset_size].ScanType = SCAN_ACTIVE; + + chanset_size++; + } + } + + #ifdef CONFIG_DFS_MASTER + for (i = 0; i < chanset_size; i++) + channel_set[i].non_ocp_end_time = rtw_get_current_time(); + #endif +#endif /* CONFIG_IEEE80211_BAND_5GHZ */ + + if (chanset_size) + RTW_INFO(FUNC_ADPT_FMT" ChannelPlan ID:0x%02x, ch num:%d\n" + , FUNC_ADPT_ARG(padapter), ChannelPlan, chanset_size); + else + RTW_WARN(FUNC_ADPT_FMT" ChannelPlan ID:0x%02x, final chset has no channel\n" + , FUNC_ADPT_ARG(padapter), ChannelPlan); + + return chanset_size; +} + +#ifdef CONFIG_TXPWR_LIMIT +void rtw_txpwr_init_regd(struct rf_ctl_t *rfctl) +{ + u8 regd; + u8 regd_name; + struct regd_exc_ent *exc; + struct txpwr_lmt_ent *ent; + _irqL irqL; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + rfctl->regd_name = NULL; + + if (rfctl->txpwr_regd_num == 0) { + RTW_PRINT("there is no any txpwr_regd\n"); + goto release_lock; + } + + /* search from exception mapping */ + exc = _rtw_regd_exc_search(rfctl + , rfctl->country_ent ? rfctl->country_ent->alpha2 : NULL + , rfctl->ChannelPlan); + if (exc) { + u8 has_country = (exc->country[0] == '\0' && exc->country[1] == '\0') ? 0 : 1; + + if (strcmp(exc->regd_name, regd_str(TXPWR_LMT_NONE)) == 0) + rfctl->regd_name = regd_str(TXPWR_LMT_NONE); + else if (strcmp(exc->regd_name, regd_str(TXPWR_LMT_WW)) == 0) + rfctl->regd_name = regd_str(TXPWR_LMT_WW); + else { + ent = _rtw_txpwr_lmt_get_by_name(rfctl, exc->regd_name); + if (ent) + rfctl->regd_name = ent->regd_name; + } + + RTW_PRINT("exception mapping country:%c%c domain:0x%02x to%s regd_name:%s\n" + , has_country ? exc->country[0] : '0' + , has_country ? exc->country[1] : '0' + , exc->domain + , rfctl->regd_name ? "" : " unknown" + , exc->regd_name + ); + if (rfctl->regd_name) + goto release_lock; + } + + /* follow default channel plan mapping */ + if (rfctl->ChannelPlan == RTW_CHPLAN_REALTEK_DEFINE) + regd = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; + else + regd = RTW_ChannelPlanMap[rfctl->ChannelPlan].regd; + + if (regd == TXPWR_LMT_NONE) + rfctl->regd_name = regd_str(TXPWR_LMT_NONE); + else if (regd == TXPWR_LMT_WW) + rfctl->regd_name = regd_str(TXPWR_LMT_WW); + else { + ent = _rtw_txpwr_lmt_get_by_name(rfctl, regd_str(regd)); + if (ent) + rfctl->regd_name = ent->regd_name; + } + + RTW_PRINT("default mapping domain:0x%02x to%s regd_name:%s\n" + , rfctl->ChannelPlan + , rfctl->regd_name ? "" : " unknown" + , regd_str(regd) + ); + if (rfctl->regd_name) + goto release_lock; + + switch (regd) { + /* + * To support older chips without IC and KCC regd: + * IC not found, use FCC instead + * KCC not found, use ETSI instead + */ + case TXPWR_LMT_IC: + case TXPWR_LMT_KCC: + if (regd == TXPWR_LMT_IC) + regd = TXPWR_LMT_FCC; + else if (regd == TXPWR_LMT_KCC) + regd = TXPWR_LMT_ETSI; + ent = _rtw_txpwr_lmt_get_by_name(rfctl, regd_str(regd)); + if (ent) + rfctl->regd_name = ent->regd_name; + RTW_PRINT("alternate regd_name:%s %s\n" + , regd_str(regd) + , rfctl->regd_name ? "is used" : "not found" + ); + if (rfctl->regd_name) + break; + default: + rfctl->regd_name = regd_str(TXPWR_LMT_WW); + RTW_PRINT("assign %s for default case\n", regd_str(TXPWR_LMT_WW)); + break; + }; + +release_lock: + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); +} +#endif /* CONFIG_TXPWR_LIMIT */ + void rtw_rfctl_init(_adapter *adapter) { struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); - _rtw_memset(rfctl, 0, sizeof(*rfctl)); + rfctl->max_chan_nums = init_channel_set(adapter, rfctl->ChannelPlan, rfctl->channel_set); + init_channel_list(adapter, rfctl->channel_set, &rfctl->channel_list); + +#ifdef CONFIG_TXPWR_LIMIT + _rtw_mutex_init(&rfctl->txpwr_lmt_mutex); + _rtw_init_listhead(&rfctl->reg_exc_list); + _rtw_init_listhead(&rfctl->txpwr_lmt_list); +#endif #ifdef CONFIG_DFS_MASTER rfctl->cac_start_time = rfctl->cac_end_time = RTW_CAC_STOPPED; @@ -342,6 +710,21 @@ void rtw_rfctl_init(_adapter *adapter) #endif } +void rtw_rfctl_deinit(_adapter *adapter) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + +#ifdef CONFIG_TXPWR_LIMIT + rtw_regd_exc_list_free(rfctl); + rtw_txpwr_lmt_list_free(rfctl); + _rtw_mutex_free(&rfctl->txpwr_lmt_mutex); +#endif + +#ifdef CONFIG_DFS_MASTER + /* TODO: dfs_master_timer */ +#endif +} + #ifdef CONFIG_DFS_MASTER /* * called in rtw_dfs_master_enable() @@ -456,7 +839,7 @@ bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) goto exit; - for (i = 0; ch_set[i].ChannelNum != 0; i++) { + for (i = 0; i < MAX_CHANNEL_NUM && ch_set[i].ChannelNum != 0; i++) { if (!rtw_ch2freq(ch_set[i].ChannelNum)) { rtw_warn_on(1); continue; @@ -480,7 +863,7 @@ bool rtw_chset_is_ch_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) u32 rtw_chset_get_ch_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) { int ms = 0; - u32 current_time; + systime current_time; u32 hi = 0, lo = 0; int i; @@ -489,7 +872,7 @@ u32 rtw_chset_get_ch_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset current_time = rtw_get_current_time(); - for (i = 0; ch_set[i].ChannelNum != 0; i++) { + for (i = 0; i < MAX_CHANNEL_NUM && ch_set[i].ChannelNum != 0; i++) { if (!rtw_ch2freq(ch_set[i].ChannelNum)) { rtw_warn_on(1); continue; @@ -526,7 +909,7 @@ static void _rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) goto exit; - for (i = 0; ch_set[i].ChannelNum != 0; i++) { + for (i = 0; i < MAX_CHANNEL_NUM && ch_set[i].ChannelNum != 0; i++) { if (!rtw_ch2freq(ch_set[i].ChannelNum)) { rtw_warn_on(1); continue; @@ -564,8 +947,8 @@ u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non u32 cac_ms; u8 in_rd_range = 0; /* if in current radar detection range*/ - if (rtw_chset_is_ch_non_ocp(mlmeext->channel_set, ch, bw, offset)) - non_ocp_ms = rtw_chset_get_ch_non_ocp_ms(mlmeext->channel_set, ch, bw, offset); + if (rtw_chset_is_ch_non_ocp(rfctl->channel_set, ch, bw, offset)) + non_ocp_ms = rtw_chset_get_ch_non_ocp_ms(rfctl->channel_set, ch, bw, offset); else non_ocp_ms = 0; @@ -586,7 +969,7 @@ u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non in_rd_range = 1; } - if (!rtw_is_dfs_ch(ch, bw, offset)) + if (!rtw_is_dfs_chbw(ch, bw, offset)) cac_ms = 0; else if (in_rd_range && !non_ocp_ms) { if (IS_CH_WAITING(rfctl)) @@ -631,6 +1014,7 @@ void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset) if (rfctl->cac_end_time == RTW_CAC_STOPPED) rfctl->cac_end_time++; } +#endif /* CONFIG_DFS_MASTER */ /* choose channel with shortest waiting (non ocp + cac) time */ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags) @@ -639,7 +1023,6 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 #define DBG_CHOOSE_SHORTEST_WAITING_CH 0 #endif - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); struct registry_priv *regsty = adapter_to_regsty(adapter); u8 ch, bw, offset; @@ -657,12 +1040,12 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 if (!hal_is_bw_support(adapter, bw)) continue; - for (i = 0; i < mlmeext->max_chan_nums; i++) { - u32 non_ocp_ms; - u32 cac_ms; - u32 waiting_ms; + for (i = 0; i < rfctl->max_chan_nums; i++) { + u32 non_ocp_ms = 0; + u32 cac_ms = 0; + u32 waiting_ms = 0; - ch = mlmeext->channel_set[i].ChannelNum; + ch = rfctl->channel_set[i].ChannelNum; if ((d_flags & RTW_CHF_2G) && ch <= 14) continue; @@ -681,25 +1064,27 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 if (!rtw_get_offset_by_chbw(ch, bw, &offset)) continue; - if (!rtw_chset_is_chbw_valid(mlmeext->channel_set, ch, bw, offset)) + if (!rtw_chset_is_chbw_valid(rfctl->channel_set, ch, bw, offset)) continue; - if ((d_flags & RTW_CHF_NON_OCP) && rtw_chset_is_ch_non_ocp(mlmeext->channel_set, ch, bw, offset)) + if ((d_flags & RTW_CHF_NON_OCP) && rtw_chset_is_ch_non_ocp(rfctl->channel_set, ch, bw, offset)) continue; - if ((d_flags & RTW_CHF_DFS) && rtw_is_dfs_ch(ch, bw, offset)) + if ((d_flags & RTW_CHF_DFS) && rtw_is_dfs_chbw(ch, bw, offset)) continue; if ((d_flags & RTW_CHF_LONG_CAC) && rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) continue; - if ((d_flags & RTW_CHF_NON_DFS) && !rtw_is_dfs_ch(ch, bw, offset)) + if ((d_flags & RTW_CHF_NON_DFS) && !rtw_is_dfs_chbw(ch, bw, offset)) continue; if ((d_flags & RTW_CHF_NON_LONG_CAC) && !rtw_is_long_cac_ch(ch, bw, offset, rtw_odm_get_dfs_domain(adapter))) continue; + #ifdef CONFIG_DFS_MASTER waiting_ms = rtw_get_ch_waiting_ms(adapter, ch, bw, offset, &non_ocp_ms, &cac_ms); + #endif if (DBG_CHOOSE_SHORTEST_WAITING_CH) RTW_INFO(FUNC_ADPT_FMT":%u,%u,%u %u(non_ocp:%u, cac:%u)\n" @@ -732,7 +1117,6 @@ bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 return _FALSE; } -#endif /* CONFIG_DFS_MASTER */ void dump_country_chplan(void *sel, const struct country_chplan *ent) { @@ -805,7 +1189,7 @@ void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set) { u8 i; - for (i = 0; ch_set[i].ChannelNum != 0; i++) { + for (i = 0; i < MAX_CHANNEL_NUM && ch_set[i].ChannelNum != 0; i++) { RTW_PRINT_SEL(sel, "ch:%3u, freq:%u, scan_type:%d" , ch_set[i].ChannelNum, rtw_ch2freq(ch_set[i].ChannelNum), ch_set[i].ScanType); @@ -814,7 +1198,7 @@ void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set) #endif #ifdef CONFIG_DFS_MASTER - if (rtw_is_dfs_ch(ch_set[i].ChannelNum, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE)) { + if (rtw_is_dfs_ch(ch_set[i].ChannelNum)) { if (CH_IS_NON_OCP(&ch_set[i])) _RTW_PRINT_SEL(sel, ", non_ocp:%d" , rtw_systime_to_ms(ch_set[i].non_ocp_end_time - rtw_get_current_time())); @@ -831,19 +1215,23 @@ void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set) void dump_cur_chset(void *sel, _adapter *adapter) { - struct mlme_priv *mlme = &adapter->mlmepriv; - struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); struct registry_priv *regsty = adapter_to_regsty(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); int i; - if (mlme->country_ent) - dump_country_chplan(sel, mlme->country_ent); + if (rfctl->country_ent) + dump_country_chplan(sel, rfctl->country_ent); else - RTW_PRINT_SEL(sel, "chplan:0x%02X\n", mlme->ChannelPlan); + RTW_PRINT_SEL(sel, "chplan:0x%02X\n", rfctl->ChannelPlan); - RTW_PRINT_SEL(sel, "2G_PLS:%u, 5G_PLS:%u\n" - , hal_data->Regulation2_4G, hal_data->Regulation5G); +#ifdef CONFIG_TXPWR_LIMIT + RTW_PRINT_SEL(sel, "PLS regd:%s\n", rfctl->regd_name); +#endif + +#ifdef CONFIG_DFS_MASTER + RTW_PRINT_SEL(sel, "dfs_domain:%u\n", rtw_odm_get_dfs_domain(adapter)); +#endif for (i = 0; i < MAX_CHANNEL_NUM; i++) if (regsty->excl_chs[i] != 0) @@ -859,7 +1247,7 @@ void dump_cur_chset(void *sel, _adapter *adapter) RTW_PRINT_SEL(sel, "\n"); } - dump_chset(sel, mlmeext->channel_set); + dump_chset(sel, rfctl->channel_set); } /* @@ -869,17 +1257,19 @@ void dump_cur_chset(void *sel, _adapter *adapter) * * return the index of channel_num in channel_set, -1 if not found */ -int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) +int rtw_chset_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch) { int i; - for (i = 0; ch_set[i].ChannelNum != 0; i++) { + + if (ch == 0) + return -1; + + for (i = 0; i < MAX_CHANNEL_NUM && ch_set[i].ChannelNum != 0; i++) { if (ch == ch_set[i].ChannelNum) - break; + return i; } - if (i >= ch_set[i].ChannelNum) - return -1; - return i; + return -1; } /* @@ -907,7 +1297,7 @@ u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset) for (i = 0; i < op_ch_num; i++) { if (0) RTW_INFO("%u,%u,%u - cch:%u, bw:%u, op_ch:%u\n", ch, bw, offset, cch, bw, *(op_chs + i)); - if (rtw_ch_set_search_ch(ch_set, *(op_chs + i)) == -1) + if (rtw_chset_search_ch(ch_set, *(op_chs + i)) == -1) break; } @@ -988,43 +1378,14 @@ void init_mlme_default_rate_set(_adapter *padapter) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - unsigned char supported_b_mode[b_mode_rate_num] = - {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_}; - unsigned char supported_g_mode[g_mode_rate_num] = - {_6M_RATE_, _9M_RATE_, _12M_RATE_, _18M_RATE_,\ - _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_}; + unsigned char mixed_datarate[NumRates] = {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_, _9M_RATE_, _12M_RATE_, _18M_RATE_, _24M_RATE_, _36M_RATE_, _48M_RATE_, _54M_RATE_, 0xff}; + unsigned char mixed_basicrate[NumRates] = {_1M_RATE_, _2M_RATE_, _5M_RATE_, _11M_RATE_, _6M_RATE_, _12M_RATE_, _24M_RATE_, 0xff,}; unsigned char supported_mcs_set[16] = {0xff, 0xff, 0xff, 0x00, 0x00, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}; - unsigned char end_set[1] = {0xff}; - u8 offset = 0; -#if 1 - if (IsSupportedTxCCK(padapter->registrypriv.wireless_mode)) { - _rtw_memcpy(pmlmeext->datarate, - supported_b_mode, b_mode_rate_num); - _rtw_memcpy(pmlmeext->basicrate, - supported_b_mode, b_mode_rate_num); - offset += b_mode_rate_num; - RTW_INFO("%s: support CCK\n", __func__); - } - - if (IsSupportedTxOFDM(padapter->registrypriv.wireless_mode)) { - _rtw_memcpy(pmlmeext->datarate + offset, - supported_g_mode, g_mode_rate_num); - _rtw_memcpy(pmlmeext->basicrate + offset, - supported_g_mode, g_mode_rate_num); - offset += g_mode_rate_num; - RTW_INFO("%s: support OFDM\n", __func__); - } - _rtw_memcpy(pmlmeext->datarate + offset, end_set, 1); - _rtw_memcpy(pmlmeext->basicrate + offset, end_set, 1); -#else _rtw_memcpy(pmlmeext->datarate, mixed_datarate, NumRates); _rtw_memcpy(pmlmeext->basicrate, mixed_basicrate, NumRates); -#endif -#ifdef CONFIG_80211N_HT - _rtw_memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, - sizeof(pmlmeext->default_supported_mcs_set)); -#endif + + _rtw_memcpy(pmlmeext->default_supported_mcs_set, supported_mcs_set, sizeof(pmlmeext->default_supported_mcs_set)); } static void init_mlme_ext_priv_value(_adapter *padapter) @@ -1095,203 +1456,20 @@ static void init_mlme_ext_priv_value(_adapter *padapter) pmlmeext->action_public_dialog_token = 0xff; } -static int has_channel(RT_CHANNEL_INFO *channel_set, - u8 chanset_size, - u8 chan) +void init_mlme_ext_timer(_adapter *padapter) { - int i; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - for (i = 0; i < chanset_size; i++) { - if (channel_set[i].ChannelNum == chan) - return 1; - } - - return 0; -} - -static void init_channel_list(_adapter *padapter, RT_CHANNEL_INFO *channel_set, - u8 chanset_size, - struct p2p_channels *channel_list) -{ - struct registry_priv *regsty = adapter_to_regsty(padapter); - - struct p2p_oper_class_map op_class[] = { - { IEEE80211G, 81, 1, 13, 1, BW20 }, - { IEEE80211G, 82, 14, 14, 1, BW20 }, -#if 0 /* Do not enable HT40 on 2 GHz */ - { IEEE80211G, 83, 1, 9, 1, BW40PLUS }, - { IEEE80211G, 84, 5, 13, 1, BW40MINUS }, + rtw_init_timer(&pmlmeext->survey_timer, padapter, survey_timer_hdl, padapter); + rtw_init_timer(&pmlmeext->link_timer, padapter, link_timer_hdl, padapter); +#ifdef CONFIG_RTW_80211R + rtw_init_timer(&pmlmeext->ft_link_timer, padapter, ft_link_timer_hdl, padapter); + rtw_init_timer(&pmlmeext->ft_roam_timer, padapter, ft_roam_timer_hdl, padapter); #endif - { IEEE80211A, 115, 36, 48, 4, BW20 }, - { IEEE80211A, 116, 36, 44, 8, BW40PLUS }, - { IEEE80211A, 117, 40, 48, 8, BW40MINUS }, - { IEEE80211A, 124, 149, 161, 4, BW20 }, - { IEEE80211A, 125, 149, 169, 4, BW20 }, - { IEEE80211A, 126, 149, 157, 8, BW40PLUS }, - { IEEE80211A, 127, 153, 161, 8, BW40MINUS }, - { -1, 0, 0, 0, 0, BW20 } - }; - int cla, op; - - cla = 0; - - for (op = 0; op_class[op].op_class; op++) { - u8 ch; - struct p2p_oper_class_map *o = &op_class[op]; - struct p2p_reg_class *reg = NULL; - - for (ch = o->min_chan; ch <= o->max_chan; ch += o->inc) { - if (!has_channel(channel_set, chanset_size, ch)) - continue; -#ifdef CONFIG_80211N_HT - if ((0 == padapter->registrypriv.ht_enable) && (8 == o->inc)) - continue; - - if ((REGSTY_IS_BW_5G_SUPPORT(regsty, CHANNEL_WIDTH_40)) && - ((BW40MINUS == o->bw) || (BW40PLUS == o->bw))) - continue; +#ifdef CONFIG_RTW_REPEATER_SON + rtw_init_timer(&pmlmeext->rson_scan_timer, padapter, rson_timer_hdl, padapter); #endif - if (reg == NULL) { - reg = &channel_list->reg_class[cla]; - cla++; - reg->reg_class = o->op_class; - reg->channels = 0; - } - reg->channel[reg->channels] = ch; - reg->channels++; - } - } - channel_list->reg_classes = cla; - -} - -bool rtw_regsty_is_excl_chs(struct registry_priv *regsty, u8 ch) -{ - int i; - - for (i = 0; i < MAX_CHANNEL_NUM; i++) { - if (regsty->excl_chs[i] == 0) - break; - if (regsty->excl_chs[i] == ch) - return _TRUE; - } - return _FALSE; -} - -static u8 init_channel_set(_adapter *padapter, u8 ChannelPlan, RT_CHANNEL_INFO *channel_set) -{ - struct registry_priv *regsty = adapter_to_regsty(padapter); - u8 index, chanset_size = 0; - u8 b5GBand = _FALSE, b2_4GBand = _FALSE; - u8 Index2G = 0, Index5G = 0; - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); - int i; - - if (!rtw_is_channel_plan_valid(ChannelPlan)) { - RTW_ERR("ChannelPlan ID 0x%02X error !!!!!\n", ChannelPlan); - return chanset_size; - } - - _rtw_memset(channel_set, 0, sizeof(RT_CHANNEL_INFO) * MAX_CHANNEL_NUM); - - if (IsSupported24G(padapter->registrypriv.wireless_mode)) - b2_4GBand = _TRUE; - - if (IsSupported5G(padapter->registrypriv.wireless_mode)) - b5GBand = _TRUE; - - if (b2_4GBand) { - if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) - Index2G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index2G; - else - Index2G = RTW_ChannelPlanMap[ChannelPlan].Index2G; - - for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan2G[Index2G]); index++) { - if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index)) == _TRUE) - continue; - - channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan2G[Index2G], index); - - if (RTW_CHPLAN_GLOBAL_DOAMIN == ChannelPlan - || RTW_CHPLAN_GLOBAL_NULL == ChannelPlan - ) { - /* Channel 1~11 is active, and 12~14 is passive */ - if (channel_set[chanset_size].ChannelNum >= 1 && channel_set[chanset_size].ChannelNum <= 11) - channel_set[chanset_size].ScanType = SCAN_ACTIVE; - else if ((channel_set[chanset_size].ChannelNum >= 12 && channel_set[chanset_size].ChannelNum <= 14)) - channel_set[chanset_size].ScanType = SCAN_PASSIVE; - } else if (RTW_CHPLAN_WORLD_WIDE_13 == ChannelPlan - || RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan - || RTW_RD_2G_WORLD == Index2G - ) { - /* channel 12~13, passive scan */ - if (channel_set[chanset_size].ChannelNum <= 11) - channel_set[chanset_size].ScanType = SCAN_ACTIVE; - else - channel_set[chanset_size].ScanType = SCAN_PASSIVE; - } else - channel_set[chanset_size].ScanType = SCAN_ACTIVE; - - chanset_size++; - } - } - -#ifdef CONFIG_IEEE80211_BAND_5GHZ - if (b5GBand) { - if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) - Index5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.Index5G; - else - Index5G = RTW_ChannelPlanMap[ChannelPlan].Index5G; - - for (index = 0; index < CH_LIST_LEN(RTW_ChannelPlan5G[Index5G]); index++) { - if (rtw_regsty_is_excl_chs(regsty, CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index)) == _TRUE) - continue; -#ifdef CONFIG_DFS - channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index); - if (channel_set[chanset_size].ChannelNum <= 48 - || channel_set[chanset_size].ChannelNum >= 149 - ) { - if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ - channel_set[chanset_size].ScanType = SCAN_PASSIVE; - else - channel_set[chanset_size].ScanType = SCAN_ACTIVE; - } else - channel_set[chanset_size].ScanType = SCAN_PASSIVE; - chanset_size++; -#else /* CONFIG_DFS */ - if (CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index) <= 48 - || CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index) >= 149 - ) { - channel_set[chanset_size].ChannelNum = CH_LIST_CH(RTW_ChannelPlan5G[Index5G], index); - if (RTW_CHPLAN_WORLD_WIDE_5G == ChannelPlan) /* passive scan for all 5G channels */ - channel_set[chanset_size].ScanType = SCAN_PASSIVE; - else - channel_set[chanset_size].ScanType = SCAN_ACTIVE; - chanset_size++; - } -#endif /* CONFIG_DFS */ - } - } - - #ifdef CONFIG_DFS_MASTER - for (i = 0; i < chanset_size; i++) - channel_set[i].non_ocp_end_time = rtw_get_current_time(); - #endif -#endif /* CONFIG_IEEE80211_BAND_5GHZ */ - - if (RTW_CHPLAN_REALTEK_DEFINE == ChannelPlan) { - hal_data->Regulation2_4G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; - hal_data->Regulation5G = RTW_CHANNEL_PLAN_MAP_REALTEK_DEFINE.regd; - } else { - hal_data->Regulation2_4G = RTW_ChannelPlanMap[ChannelPlan].regd; - hal_data->Regulation5G = RTW_ChannelPlanMap[ChannelPlan].regd; - } - - RTW_INFO(FUNC_ADPT_FMT" ChannelPlan ID:0x%02x, ch num:%d\n" - , FUNC_ADPT_ARG(padapter), ChannelPlan, chanset_size); - - return chanset_size; } int init_mlme_ext_priv(_adapter *padapter) @@ -1318,8 +1496,6 @@ int init_mlme_ext_priv(_adapter *padapter) init_mlme_ap_info(padapter); #endif - pmlmeext->max_chan_nums = init_channel_set(padapter, pmlmepriv->ChannelPlan, pmlmeext->channel_set); - init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); pmlmeext->last_scan_time = 0; pmlmeext->mlmeext_init = _TRUE; @@ -1348,7 +1524,6 @@ void free_mlme_ext_priv(struct mlme_ext_priv *pmlmeext) if (rtw_is_drv_stopped(padapter)) { _cancel_timer_ex(&pmlmeext->survey_timer); _cancel_timer_ex(&pmlmeext->link_timer); - /* _cancel_timer_ex(&pmlmeext->ADDBA_timer); */ } } @@ -1394,9 +1569,8 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) #endif /* CONFIG_AP_MODE */ u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; u8 *pframe = precv_frame->u.hdr.rx_data; - struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(pframe)); - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, get_addr2_ptr(pframe)); + struct recv_priv *precvpriv = &padapter->recvpriv; #if 0 @@ -1404,7 +1578,7 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) u8 *pbuf; pbuf = GetAddr1Ptr(pframe); RTW_INFO("A1-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); - pbuf = GetAddr2Ptr(pframe); + pbuf = get_addr2_ptr(pframe); RTW_INFO("A2-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); pbuf = GetAddr3Ptr(pframe); RTW_INFO("A3-%x:%x:%x:%x:%x:%x\n", *pbuf, *(pbuf + 1), *(pbuf + 2), *(pbuf + 3), *(pbuf + 4), *(pbuf + 5)); @@ -1422,13 +1596,13 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) ptable = mlme_sta_tbl; - index = GetFrameSubType(pframe) >> 4; + index = get_frame_sub_type(pframe) >> 4; #ifdef CONFIG_TDLS if ((index << 4) == WIFI_ACTION) { /* category==public (4), action==TDLS_DISCOVERY_RESPONSE */ if (*(pframe + 24) == RTW_WLAN_CATEGORY_PUBLIC && *(pframe + 25) == TDLS_DISCOVERY_RESPONSE) { - RTW_INFO("[TDLS] Recv %s from "MAC_FMT"\n", rtw_tdls_action_txt(TDLS_DISCOVERY_RESPONSE), MAC_ARG(GetAddr2Ptr(pframe))); + RTW_INFO("[TDLS] Recv %s from "MAC_FMT"\n", rtw_tdls_action_txt(TDLS_DISCOVERY_RESPONSE), MAC_ARG(get_addr2_ptr(pframe))); On_TDLS_Dis_Rsp(padapter, precv_frame); } } @@ -1444,7 +1618,7 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) if (GetRetry(pframe)) { if (precv_frame->u.hdr.attrib.seq_num == psta->RxMgmtFrameSeqNum) { /* drop the duplicate management frame */ - pdbgpriv->dbg_rx_dup_mgt_frame_drop_count++; + precvpriv->dbg_rx_dup_mgt_frame_drop_count++; RTW_INFO("Drop duplicate management frame with seq_num = %d.\n", precv_frame->u.hdr.attrib.seq_num); return; } @@ -1459,9 +1633,9 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) #endif #ifdef CONFIG_AP_MODE - switch (GetFrameSubType(pframe)) { + switch (get_frame_sub_type(pframe)) { case WIFI_AUTH: - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (MLME_IS_AP(padapter)) ptable->func = &OnAuth; else ptable->func = &OnAuthClient; @@ -1469,32 +1643,30 @@ void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame) case WIFI_ASSOCREQ: case WIFI_REASSOCREQ: _mgt_dispatcher(padapter, ptable, precv_frame); -#ifdef CONFIG_HOSTAPD_MLME - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + #ifdef CONFIG_HOSTAPD_MLME + if (MLME_IS_AP(padapter)) rtw_hostapd_mlme_rx(padapter, precv_frame); -#endif + #endif break; case WIFI_PROBEREQ: - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -#ifdef CONFIG_HOSTAPD_MLME + _mgt_dispatcher(padapter, ptable, precv_frame); + #ifdef CONFIG_HOSTAPD_MLME + if (MLME_IS_AP(padapter)) rtw_hostapd_mlme_rx(padapter, precv_frame); -#else - _mgt_dispatcher(padapter, ptable, precv_frame); -#endif - } else - _mgt_dispatcher(padapter, ptable, precv_frame); + #endif break; case WIFI_BEACON: _mgt_dispatcher(padapter, ptable, precv_frame); break; case WIFI_ACTION: - /* if(check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) */ _mgt_dispatcher(padapter, ptable, precv_frame); break; default: _mgt_dispatcher(padapter, ptable, precv_frame); - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + #ifdef CONFIG_HOSTAPD_MLME + if (MLME_IS_AP(padapter)) rtw_hostapd_mlme_rx(padapter, precv_frame); + #endif break; } #else @@ -1636,7 +1808,7 @@ unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) return _SUCCESS; if (check_fwstate(pmlmepriv, _FW_LINKED) == _FALSE && - check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE) == _FALSE) + check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE | WIFI_MESH_STATE) == _FALSE) return _SUCCESS; @@ -1710,32 +1882,32 @@ unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) /* generate pairing ID */ mac_addr = adapter_mac_addr(padapter); - peer_addr = psta->hwaddr; + peer_addr = psta->cmn.mac_addr; psta->pid = (u16)(((mac_addr[4] << 8) + mac_addr[5]) + ((peer_addr[4] << 8) + peer_addr[5])); /* update peer stainfo */ psta->isrc = _TRUE; /* get a unique AID */ - if (psta->aid > 0) - RTW_INFO("old AID %d\n", psta->aid); + if (psta->cmn.aid > 0) + RTW_INFO("old AID %d\n", psta->cmn.aid); else { - for (psta->aid = 1; psta->aid <= NUM_STA; psta->aid++) - if (pstapriv->sta_aid[psta->aid - 1] == NULL) + for (psta->cmn.aid = 1; psta->cmn.aid <= NUM_STA; psta->cmn.aid++) + if (pstapriv->sta_aid[psta->cmn.aid - 1] == NULL) break; - if (psta->aid > pstapriv->max_num_sta) { - psta->aid = 0; + if (psta->cmn.aid > pstapriv->max_num_sta) { + psta->cmn.aid = 0; RTW_INFO("no room for more AIDs\n"); return _SUCCESS; } else { - pstapriv->sta_aid[psta->aid - 1] = psta; - RTW_INFO("allocate new AID = (%d)\n", psta->aid); + pstapriv->sta_aid[psta->cmn.aid - 1] = psta; + RTW_INFO("allocate new AID = (%d)\n", psta->cmn.aid); } } psta->qos_option = 1; - psta->bw_mode = CHANNEL_WIDTH_20; + psta->cmn.bw_mode = CHANNEL_WIDTH_20; psta->ieee8021x_blocked = _FALSE; #ifdef CONFIG_80211N_HT psta->htpriv.ht_option = _TRUE; @@ -1755,7 +1927,7 @@ unsigned int OnProbeReq(_adapter *padapter, union recv_frame *precv_frame) psta->state |= _FW_LINKED; _exit_critical_bh(&psta->lock, &irqL); - report_add_sta_event(padapter, psta->hwaddr); + report_add_sta_event(padapter, psta->cmn.mac_addr); } @@ -1822,7 +1994,7 @@ unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) #ifdef CONFIG_P2P if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { if (_TRUE == pwdinfo->tx_prov_disc_info.benable) { - if (_rtw_memcmp(pwdinfo->tx_prov_disc_info.peerIFAddr, GetAddr2Ptr(pframe), ETH_ALEN)) { + if (_rtw_memcmp(pwdinfo->tx_prov_disc_info.peerIFAddr, get_addr2_ptr(pframe), ETH_ALEN)) { if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_CLIENT)) { pwdinfo->tx_prov_disc_info.benable = _FALSE; issue_p2p_provision_request(padapter, @@ -1842,7 +2014,7 @@ unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING)) { if (_TRUE == pwdinfo->nego_req_info.benable) { RTW_INFO("[%s] P2P State is GONEGO ING!\n", __FUNCTION__); - if (_rtw_memcmp(pwdinfo->nego_req_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN)) { + if (_rtw_memcmp(pwdinfo->nego_req_info.peerDevAddr, get_addr2_ptr(pframe), ETH_ALEN)) { pwdinfo->nego_req_info.benable = _FALSE; issue_p2p_GO_request(padapter, pwdinfo->nego_req_info.peerDevAddr); } @@ -1850,7 +2022,7 @@ unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_INVITE_REQ)) { if (_TRUE == pwdinfo->invitereq_info.benable) { RTW_INFO("[%s] P2P_STATE_TX_INVITE_REQ!\n", __FUNCTION__); - if (_rtw_memcmp(pwdinfo->invitereq_info.peer_macaddr, GetAddr2Ptr(pframe), ETH_ALEN)) { + if (_rtw_memcmp(pwdinfo->invitereq_info.peer_macaddr, get_addr2_ptr(pframe), ETH_ALEN)) { pwdinfo->invitereq_info.benable = _FALSE; issue_p2p_invitation_request(padapter, pwdinfo->invitereq_info.peer_macaddr); } @@ -1859,7 +2031,11 @@ unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) #endif - if (mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) { + if ((mlmeext_chk_scan_state(pmlmeext, SCAN_PROCESS)) +#ifdef CONFIG_RTW_REPEATER_SON + || (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) +#endif + ) { rtw_mi_report_survey_event(padapter, precv_frame); return _SUCCESS; } @@ -1867,7 +2043,7 @@ unsigned int OnProbeRsp(_adapter *padapter, union recv_frame *precv_frame) #if 0 /* move to validate_recv_mgnt_frame */ if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta != NULL) psta->sta_stats.rx_mgnt_pkts++; } @@ -1908,9 +2084,7 @@ static void rtw_check_legacy_ap(_adapter *padapter, u8 *pframe, u32 len) return; } -#ifdef CONFIG_80211N_HT cur_op_mode = pmlmepriv->ht_op_mode & HT_INFO_OPERATION_MODE_OP_MODE_MASK; -#endif /* for legacy ap */ if (elems.ht_capabilities == NULL && elems.ht_capabilities_len == 0) { @@ -1946,6 +2120,8 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) #endif #endif /* CONFIG_TDLS */ + if (validate_beacon_len(pframe, len) == _FALSE) + return _SUCCESS; #ifdef CONFIG_ATTEMPT_TO_FIX_AP_BEACON_ERROR p = rtw_get_ie(pframe + sizeof(struct rtw_ieee80211_hdr_3addr) + _BEACON_IE_OFFSET_, _EXT_SUPPORTEDRATES_IE_, &ielen, precv_frame->u.hdr.len - sizeof(struct rtw_ieee80211_hdr_3addr) - _BEACON_IE_OFFSET_); @@ -1962,12 +2138,22 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) rtw_mi_report_survey_event(padapter, precv_frame); return _SUCCESS; } - +#ifdef CONFIG_RTW_REPEATER_SON + if (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) + rtw_mi_report_survey_event(padapter, precv_frame); +#endif rtw_check_legacy_ap(padapter, pframe, len); if (_rtw_memcmp(GetAddr3Ptr(pframe), get_my_bssid(&pmlmeinfo->network), ETH_ALEN)) { - if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { + if ((pmlmeinfo->state & WIFI_FW_AUTH_NULL) + && rtw_sta_linking_test_wait_done() + ) { + if (rtw_sta_linking_test_force_fail()) { + set_link_timer(pmlmeext, 1); + return _SUCCESS; + } + /* we should update current network before auth, or some IE is wrong */ pbss = (WLAN_BSSID_EX *)rtw_malloc(sizeof(WLAN_BSSID_EX)); if (pbss) { @@ -2007,7 +2193,8 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) _rtw_memset(pmlmeext->bcn_delay_ratio, 0, sizeof(pmlmeext->bcn_delay_ratio)); #ifdef CONFIG_P2P_PS - process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); + /* Comment by YiWei , in wifi p2p spec the "3.3 P2P Power Management" , "These mechanisms are available in a P2P Group in which only P2P Devices are associated." */ + /* process_p2p_ps_ie(padapter, (pframe + WLAN_HDR_A3_LEN), (len - WLAN_HDR_A3_LEN)); */ #endif /* CONFIG_P2P_PS */ #if defined(CONFIG_P2P) && defined(CONFIG_CONCURRENT_MODE) @@ -2028,7 +2215,7 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) } if (((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) && (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta != NULL) { #ifdef CONFIG_PATCH_JOIN_WRONG_CHANNEL /* Merge from 8712 FW code */ @@ -2055,7 +2242,7 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) update_beacon_info(padapter, pframe, len, psta); } - pmlmepriv->cur_network_scanned->network.Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; + pmlmepriv->cur_network_scanned->network.Rssi = precv_frame->u.hdr.attrib.phy_info.recv_signal_power; adaptive_early_32k(pmlmeext, pframe, len); @@ -2096,7 +2283,7 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) u8 rate_set[16]; u8 rate_num = 0; - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta != NULL) { /* * update WMM, ERP in the beacon @@ -2114,7 +2301,7 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) goto _END_ONBEACON_; } - psta = rtw_alloc_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_alloc_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta == NULL) { RTW_INFO(FUNC_ADPT_FMT" Exceed the upper limit of supported clients\n", FUNC_ADPT_ARG(padapter)); goto _END_ONBEACON_; @@ -2129,7 +2316,7 @@ unsigned int OnBeacon(_adapter *padapter, union recv_frame *precv_frame) update_TSF(pmlmeext, pframe, len); /* report sta add event */ - report_add_sta_event(padapter, GetAddr2Ptr(pframe)); + report_add_sta_event(padapter, get_addr2_ptr(pframe)); } } } @@ -2172,7 +2359,7 @@ unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) RTW_INFO("+OnAuth\n"); - sa = GetAddr2Ptr(pframe); + sa = get_addr2_ptr(pframe); auth_mode = psecuritypriv->dot11AuthAlgrthm; @@ -2373,7 +2560,7 @@ unsigned int OnAuth(_adapter *padapter, union recv_frame *precv_frame) pstat = &stat; _rtw_memset((char *)pstat, '\0', sizeof(stat)); pstat->auth_seq = 2; - _rtw_memcpy(pstat->hwaddr, sa, 6); + _rtw_memcpy(pstat->cmn.mac_addr, sa, 6); #ifdef CONFIG_NATIVEAP_MLME issue_auth(padapter, pstat, (unsigned short)status); @@ -2506,15 +2693,11 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) u16 capab_info, listen_interval; struct rtw_ieee802_11_elems elems; struct sta_info *pstat; - unsigned char reassoc, *p, *pos, *wpa_ie; - unsigned char WMM_IE[] = {0x00, 0x50, 0xf2, 0x02, 0x00, 0x01}; - int i, ie_len, wpa_ie_len, left; - u8 rate_set[16]; - u8 rate_num; + unsigned char reassoc, *p, *pos; + int i, ie_len, left; unsigned short status = _STATS_SUCCESSFUL_; unsigned short frame_type, ie_offset = 0; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct security_priv *psecuritypriv = &padapter->securitypriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *cur = &(pmlmeinfo->network); @@ -2539,7 +2722,7 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) if ((pmlmeinfo->state & 0x03) != WIFI_FW_AP_STATE) return _FAIL; - frame_type = GetFrameSubType(pframe); + frame_type = get_frame_sub_type(pframe); if (frame_type == WIFI_ASSOCREQ) { reassoc = 0; ie_offset = _ASOCREQ_IE_OFFSET_; @@ -2555,21 +2738,12 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) return _FAIL; } - pstat = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + pstat = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (pstat == (struct sta_info *)NULL) { status = _RSON_CLS2_; goto asoc_class2_error; } - capab_info = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN); - /* capab_info = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN)); */ - /* listen_interval = le16_to_cpu(*(unsigned short *)(pframe + WLAN_HDR_A3_LEN+2)); */ - listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN + 2); - - left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); - pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); - - RTW_INFO("%s\n", __FUNCTION__); /* check if this stat has been successfully authenticated/assocated */ @@ -2586,7 +2760,6 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) pstat->state |= WIFI_FW_ASSOC_STATE; } - #if 0/* todo:tkip_countermeasures */ if (hapd->tkip_countermeasures) { resp = WLAN_REASON_MICHAEL_MIC_FAILURE; @@ -2594,8 +2767,19 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) } #endif - pstat->capability = capab_info; + /* now parse all ieee802_11 ie to point to elems */ + left = pkt_len - (IEEE80211_3ADDR_LEN + ie_offset); + pos = pframe + (IEEE80211_3ADDR_LEN + ie_offset); + if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed) { + RTW_INFO("STA " MAC_FMT " sent invalid association request\n", + MAC_ARG(pstat->cmn.mac_addr)); + status = _STATS_FAILURE_; + goto OnAssocReqFail; + } + rtw_ap_parse_sta_capability(padapter, pstat, pframe + WLAN_HDR_A3_LEN); + + listen_interval = RTW_GET_LE16(pframe + WLAN_HDR_A3_LEN + 2); #if 0/* todo: */ /* check listen_interval */ if (listen_interval > hapd->conf->max_listen_interval) { @@ -2610,290 +2794,40 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) pstat->listen_interval = listen_interval; #endif - /* now parse all ieee802_11 ie to point to elems */ - if (rtw_ieee802_11_parse_elems(pos, left, &elems, 1) == ParseFailed || - !elems.ssid) { - RTW_INFO("STA " MAC_FMT " sent invalid association request\n", - MAC_ARG(pstat->hwaddr)); - status = _STATS_FAILURE_; - goto OnAssocReqFail; - } - - /* now we should check all the fields... */ /* checking SSID */ - p = rtw_get_ie(pframe + WLAN_HDR_A3_LEN + ie_offset, _SSID_IE_, &ie_len, - pkt_len - WLAN_HDR_A3_LEN - ie_offset); - if (p == NULL) - status = _STATS_FAILURE_; - - if (ie_len == 0) /* broadcast ssid, however it is not allowed in assocreq */ - status = _STATS_FAILURE_; - else { - /* check if ssid match */ - if (!_rtw_memcmp((void *)(p + 2), cur->Ssid.Ssid, cur->Ssid.SsidLength)) - status = _STATS_FAILURE_; - - if (ie_len != cur->Ssid.SsidLength) - status = _STATS_FAILURE_; - } - - if (_STATS_SUCCESSFUL_ != status) - goto OnAssocReqFail; - - rtw_ies_get_supported_rate(pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset, rate_set, &rate_num); - if (rate_num == 0) { - RTW_INFO(FUNC_ADPT_FMT" RX assoc-req with no supported rate\n", FUNC_ADPT_ARG(padapter)); + if (elems.ssid == NULL + || elems.ssid_len == 0 + || elems.ssid_len != cur->Ssid.SsidLength + || _rtw_memcmp(elems.ssid, cur->Ssid.Ssid, cur->Ssid.SsidLength) == _FALSE + ) { status = _STATS_FAILURE_; goto OnAssocReqFail; } - _rtw_memcpy(pstat->bssrateset, rate_set, rate_num); - pstat->bssratelen = rate_num; - UpdateBrateTblForSoftAP(pstat->bssrateset, pstat->bssratelen); + + /* (Extended) Supported rates */ + status = rtw_ap_parse_sta_supported_rates(padapter, pstat + , pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset); + if (status != _STATS_SUCCESSFUL_) + goto OnAssocReqFail; /* check RSN/WPA/WPS */ - pstat->dot8021xalg = 0; - pstat->wpa_psk = 0; - pstat->wpa_group_cipher = 0; - pstat->wpa2_group_cipher = 0; - pstat->wpa_pairwise_cipher = 0; - pstat->wpa2_pairwise_cipher = 0; - _rtw_memset(pstat->wpa_ie, 0, sizeof(pstat->wpa_ie)); - if ((psecuritypriv->wpa_psk & BIT(1)) && elems.rsn_ie) { - - int group_cipher = 0, pairwise_cipher = 0; - - wpa_ie = elems.rsn_ie; - wpa_ie_len = elems.rsn_ie_len; - - if (rtw_parse_wpa2_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { - pstat->dot8021xalg = 1;/* psk, todo:802.1x */ - pstat->wpa_psk |= BIT(1); - - pstat->wpa2_group_cipher = group_cipher & psecuritypriv->wpa2_group_cipher; - pstat->wpa2_pairwise_cipher = pairwise_cipher & psecuritypriv->wpa2_pairwise_cipher; - - if (!pstat->wpa2_group_cipher) - status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; - - if (!pstat->wpa2_pairwise_cipher) - status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; - } else - status = WLAN_STATUS_INVALID_IE; - - } else if ((psecuritypriv->wpa_psk & BIT(0)) && elems.wpa_ie) { - - int group_cipher = 0, pairwise_cipher = 0; - - wpa_ie = elems.wpa_ie; - wpa_ie_len = elems.wpa_ie_len; - - if (rtw_parse_wpa_ie(wpa_ie - 2, wpa_ie_len + 2, &group_cipher, &pairwise_cipher, NULL) == _SUCCESS) { - pstat->dot8021xalg = 1;/* psk, todo:802.1x */ - pstat->wpa_psk |= BIT(0); - - pstat->wpa_group_cipher = group_cipher & psecuritypriv->wpa_group_cipher; - pstat->wpa_pairwise_cipher = pairwise_cipher & psecuritypriv->wpa_pairwise_cipher; - - if (!pstat->wpa_group_cipher) - status = WLAN_STATUS_GROUP_CIPHER_NOT_VALID; - - if (!pstat->wpa_pairwise_cipher) - status = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID; - - } else - status = WLAN_STATUS_INVALID_IE; - - } else { - wpa_ie = NULL; - wpa_ie_len = 0; - } - - if (_STATS_SUCCESSFUL_ != status) + status = rtw_ap_parse_sta_security_ie(padapter, pstat, &elems); + if (status != _STATS_SUCCESSFUL_) goto OnAssocReqFail; - pstat->flags &= ~(WLAN_STA_WPS | WLAN_STA_MAYBE_WPS); - /* if (hapd->conf->wps_state && wpa_ie == NULL) { */ /* todo: to check ap if supporting WPS */ - if (wpa_ie == NULL) { - if (elems.wps_ie) { - RTW_INFO("STA included WPS IE in " - "(Re)Association Request - assume WPS is " - "used\n"); - pstat->flags |= WLAN_STA_WPS; - /* wpabuf_free(sta->wps_ie); */ - /* sta->wps_ie = wpabuf_alloc_copy(elems.wps_ie + 4, */ - /* elems.wps_ie_len - 4); */ - } else { - RTW_INFO("STA did not include WPA/RSN IE " - "in (Re)Association Request - possible WPS " - "use\n"); - pstat->flags |= WLAN_STA_MAYBE_WPS; - } - - - /* AP support WPA/RSN, and sta is going to do WPS, but AP is not ready */ - /* that the selected registrar of AP is _FLASE */ - if ((psecuritypriv->wpa_psk > 0) - && (pstat->flags & (WLAN_STA_WPS | WLAN_STA_MAYBE_WPS))) { - if (pmlmepriv->wps_beacon_ie) { - u8 selected_registrar = 0; - - rtw_get_wps_attr_content(pmlmepriv->wps_beacon_ie, pmlmepriv->wps_beacon_ie_len, WPS_ATTR_SELECTED_REGISTRAR , &selected_registrar, NULL); - - if (!selected_registrar) { - RTW_INFO("selected_registrar is _FALSE , or AP is not ready to do WPS\n"); - - status = _STATS_UNABLE_HANDLE_STA_; - - goto OnAssocReqFail; - } - } - } - - } else { - int copy_len; - - if (psecuritypriv->wpa_psk == 0) { - RTW_INFO("STA " MAC_FMT ": WPA/RSN IE in association " - "request, but AP don't support WPA/RSN\n", MAC_ARG(pstat->hwaddr)); - - status = WLAN_STATUS_INVALID_IE; - - goto OnAssocReqFail; - - } - - if (elems.wps_ie) { - RTW_INFO("STA included WPS IE in " - "(Re)Association Request - WPS is " - "used\n"); - pstat->flags |= WLAN_STA_WPS; - copy_len = 0; - } else - copy_len = ((wpa_ie_len + 2) > sizeof(pstat->wpa_ie)) ? (sizeof(pstat->wpa_ie)) : (wpa_ie_len + 2); - - - if (copy_len > 0) - _rtw_memcpy(pstat->wpa_ie, wpa_ie - 2, copy_len); - - } - - /* check if there is WMM IE & support WWM-PS */ - pstat->flags &= ~WLAN_STA_WME; - pstat->qos_option = 0; - pstat->qos_info = 0; - pstat->has_legacy_ac = _TRUE; - pstat->uapsd_vo = 0; - pstat->uapsd_vi = 0; - pstat->uapsd_be = 0; - pstat->uapsd_bk = 0; - if (pmlmepriv->qospriv.qos_option) { - p = pframe + WLAN_HDR_A3_LEN + ie_offset; - ie_len = 0; - for (;;) { - p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &ie_len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); - if (p != NULL) { - if (_rtw_memcmp(p + 2, WMM_IE, 6)) { + rtw_ap_parse_sta_wmm_ie(padapter, pstat + , pframe + WLAN_HDR_A3_LEN + ie_offset, pkt_len - WLAN_HDR_A3_LEN - ie_offset); - pstat->flags |= WLAN_STA_WME; - - pstat->qos_option = 1; - pstat->qos_info = *(p + 8); - - pstat->max_sp_len = (pstat->qos_info >> 5) & 0x3; - - if ((pstat->qos_info & 0xf) != 0xf) - pstat->has_legacy_ac = _TRUE; - else - pstat->has_legacy_ac = _FALSE; - - if (pstat->qos_info & 0xf) { - if (pstat->qos_info & BIT(0)) - pstat->uapsd_vo = BIT(0) | BIT(1); - else - pstat->uapsd_vo = 0; - - if (pstat->qos_info & BIT(1)) - pstat->uapsd_vi = BIT(0) | BIT(1); - else - pstat->uapsd_vi = 0; - - if (pstat->qos_info & BIT(2)) - pstat->uapsd_bk = BIT(0) | BIT(1); - else - pstat->uapsd_bk = 0; - - if (pstat->qos_info & BIT(3)) - pstat->uapsd_be = BIT(0) | BIT(1); - else - pstat->uapsd_be = 0; - - } - - break; - } - } else - break; - p = p + ie_len + 2; - } - } - - -#ifdef CONFIG_80211N_HT - if (pmlmepriv->htpriv.ht_option == _FALSE) - goto bypass_ht_chk; - - /* save HT capabilities in the sta object */ - _rtw_memset(&pstat->htpriv.ht_cap, 0, sizeof(struct rtw_ieee80211_ht_cap)); - if (elems.ht_capabilities && elems.ht_capabilities_len >= sizeof(struct rtw_ieee80211_ht_cap)) { - pstat->flags |= WLAN_STA_HT; - - pstat->flags |= WLAN_STA_WME; - - _rtw_memcpy(&pstat->htpriv.ht_cap, elems.ht_capabilities, sizeof(struct rtw_ieee80211_ht_cap)); - - } else - pstat->flags &= ~WLAN_STA_HT; -bypass_ht_chk: - - if ((pmlmepriv->htpriv.ht_option == _FALSE) && (pstat->flags & WLAN_STA_HT)) { - rtw_warn_on(1); - status = _STATS_FAILURE_; - goto OnAssocReqFail; - } -#endif /* CONFIG_80211N_HT */ - -#ifdef CONFIG_80211AC_VHT - if (pmlmepriv->vhtpriv.vht_option == _FALSE) - goto bypass_vht_chk; - - _rtw_memset(&pstat->vhtpriv, 0, sizeof(struct vht_priv)); - if (elems.vht_capabilities && elems.vht_capabilities_len == 12) { - pstat->flags |= WLAN_STA_VHT; - - _rtw_memcpy(pstat->vhtpriv.vht_cap, elems.vht_capabilities, 12); - - if (elems.vht_op_mode_notify && elems.vht_op_mode_notify_len == 1) - _rtw_memcpy(&pstat->vhtpriv.vht_op_mode_notify, elems.vht_op_mode_notify, 1); - else /* for Frame without Operating Mode notify ie; default: 80M */ - pstat->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; - } else - pstat->flags &= ~WLAN_STA_VHT; -bypass_vht_chk: - - if ((pmlmepriv->vhtpriv.vht_option == _FALSE) && (pstat->flags & WLAN_STA_VHT)) { - rtw_warn_on(1); - status = _STATS_FAILURE_; - goto OnAssocReqFail; - } -#endif /* CONFIG_80211AC_VHT */ + rtw_ap_parse_sta_ht_ie(padapter, pstat, &elems); + rtw_ap_parse_sta_vht_ie(padapter, pstat, &elems); if (((pstat->flags & WLAN_STA_HT) || (pstat->flags & WLAN_STA_VHT)) && ((pstat->wpa2_pairwise_cipher & WPA_CIPHER_TKIP) || (pstat->wpa_pairwise_cipher & WPA_CIPHER_TKIP))) { - RTW_INFO("(V)HT: " MAC_FMT " tried to use TKIP with (V)HT association\n", MAC_ARG(pstat->hwaddr)); + RTW_INFO("(V)HT: " MAC_FMT " tried to use TKIP with (V)HT association\n", MAC_ARG(pstat->cmn.mac_addr)); pstat->flags &= ~WLAN_STA_HT; pstat->flags &= ~WLAN_STA_VHT; @@ -2902,24 +2836,6 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) */ } - - /* - * if (hapd->iface->current_mode->mode == HOSTAPD_MODE_IEEE80211G) */ /* ? */ - pstat->flags |= WLAN_STA_NONERP; - for (i = 0; i < pstat->bssratelen; i++) { - if ((pstat->bssrateset[i] & 0x7f) > 22) { - pstat->flags &= ~WLAN_STA_NONERP; - break; - } - } - - if (pstat->capability & WLAN_CAPABILITY_SHORT_PREAMBLE) - pstat->flags |= WLAN_STA_SHORT_PREAMBLE; - else - pstat->flags &= ~WLAN_STA_SHORT_PREAMBLE; - - - if (status != _STATS_SUCCESSFUL_) goto OnAssocReqFail; @@ -2943,22 +2859,28 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) pstat->p2p_status_code = p2p_status_code; #endif /* CONFIG_P2P */ +#ifdef CONFIG_RTW_REPEATER_SON + if (rtw_rson_ap_check_sta(padapter, pframe, pkt_len, ie_offset)) + goto OnAssocReqFail; +#endif + /* TODO: identify_proprietary_vendor_ie(); */ /* Realtek proprietary IE */ /* identify if this is Broadcom sta */ /* identify if this is ralink sta */ /* Customer proprietary IE */ - - +#ifdef CONFIG_RTW_80211K + rtw_ap_parse_sta_rm_en_cap(padapter, pstat, &elems); +#endif /* get a unique AID */ - if (pstat->aid > 0) - RTW_INFO(" old AID %d\n", pstat->aid); + if (pstat->cmn.aid > 0) + RTW_INFO(" old AID %d\n", pstat->cmn.aid); else { - for (pstat->aid = 1; pstat->aid <= NUM_STA; pstat->aid++) { - if (pstapriv->sta_aid[pstat->aid - 1] == NULL) { - if (pstat->aid > pstapriv->max_num_sta) { - pstat->aid = 0; + for (pstat->cmn.aid = 1; pstat->cmn.aid <= NUM_STA; pstat->cmn.aid++) { + if (pstapriv->sta_aid[pstat->cmn.aid - 1] == NULL) { + if (pstat->cmn.aid > pstapriv->max_num_sta) { + pstat->cmn.aid = 0; RTW_INFO(" no room for more AIDs\n"); @@ -2968,8 +2890,8 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) } else { - pstapriv->sta_aid[pstat->aid - 1] = pstat; - RTW_INFO("allocate new AID = (%d)\n", pstat->aid); + pstapriv->sta_aid[pstat->cmn.aid - 1] = pstat; + RTW_INFO("allocate new AID = (%d)\n", pstat->cmn.aid); break; } } @@ -2980,7 +2902,7 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) pstat->state &= (~WIFI_FW_ASSOC_STATE); pstat->state |= WIFI_FW_ASSOC_SUCCESS; /* RTW_INFO("==================%s, %d, (%x), bpairwise_key_installed=%d, MAC:"MAC_FMT"\n" - , __func__, __LINE__, pstat->state, pstat->bpairwise_key_installed, MAC_ARG(pstat->hwaddr)); */ + , __func__, __LINE__, pstat->state, pstat->bpairwise_key_installed, MAC_ARG(pstat->cmn.mac_addr)); */ #ifdef CONFIG_IEEE80211W if (pstat->bpairwise_key_installed != _TRUE) #endif /* CONFIG_IEEE80211W */ @@ -3042,12 +2964,12 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) #endif /* CONFIG_IEEE80211W */ { /* .3-(1) report sta add event */ - report_add_sta_event(padapter, pstat->hwaddr); + report_add_sta_event(padapter, pstat->cmn.mac_addr); } #ifdef CONFIG_IEEE80211W if (pstat->bpairwise_key_installed == _TRUE && padapter->securitypriv.binstallBIPkey == _TRUE) { - RTW_INFO(MAC_FMT"\n", MAC_ARG(pstat->hwaddr)); - issue_action_SA_Query(padapter, pstat->hwaddr, 0, 0, IEEE80211W_RIGHT_KEY); + RTW_INFO(MAC_FMT"\n", MAC_ARG(pstat->cmn.mac_addr)); + issue_action_SA_Query(padapter, pstat->cmn.mac_addr, 0, 0, IEEE80211W_RIGHT_KEY); } #endif /* CONFIG_IEEE80211W */ #endif /* CONFIG_NATIVEAP_MLME */ @@ -3058,7 +2980,7 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) asoc_class2_error: #ifdef CONFIG_NATIVEAP_MLME - issue_deauth(padapter, (void *)GetAddr2Ptr(pframe), status); + issue_deauth(padapter, (void *)get_addr2_ptr(pframe), status); #endif return _FAIL; @@ -3067,7 +2989,7 @@ unsigned int OnAssocReq(_adapter *padapter, union recv_frame *precv_frame) #ifdef CONFIG_NATIVEAP_MLME - pstat->aid = 0; + pstat->cmn.aid = 0; if (frame_type == WIFI_ASSOCREQ) issue_asocrsp(padapter, status, pstat, WIFI_ASSOCRSP); else @@ -3178,6 +3100,12 @@ unsigned int OnAssocRsp(_adapter *padapter, union recv_frame *precv_frame) padapter->tdlsinfo.ch_switch_prohibited = _TRUE; break; #endif /* CONFIG_TDLS */ + +#ifdef CONFIG_RTW_80211K + case _EID_RRM_EN_CAP_IE_: + RM_IE_handler(padapter, pIE); + break; +#endif default: break; } @@ -3235,7 +3163,7 @@ unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) rtw_lock_rx_suspend_timeout(8000); #ifdef CONFIG_AP_MODE - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { + if (MLME_IS_AP(padapter)) { _irqL irqL; struct sta_info *psta; struct sta_priv *pstapriv = &padapter->stapriv; @@ -3245,9 +3173,9 @@ unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" - , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); + , FUNC_ADPT_ARG(padapter), reason, get_addr2_ptr(pframe)); - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta) { u8 updated = _FALSE; @@ -3286,10 +3214,10 @@ unsigned int OnDeAuth(_adapter *padapter, union recv_frame *precv_frame) } RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM, ignore=%d\n" - , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe), ignore_received_deauth); + , FUNC_ADPT_ARG(padapter), reason, get_addr2_ptr(pframe), ignore_received_deauth); if (0 == ignore_received_deauth) - receive_disconnect(padapter, GetAddr2Ptr(pframe), reason, _FALSE); + receive_disconnect(padapter, get_addr2_ptr(pframe), reason, _FALSE); } pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; return _SUCCESS; @@ -3325,7 +3253,7 @@ unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) rtw_lock_rx_suspend_timeout(8000); #ifdef CONFIG_AP_MODE - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { + if (MLME_IS_AP(padapter)) { _irqL irqL; struct sta_info *psta; struct sta_priv *pstapriv = &padapter->stapriv; @@ -3335,9 +3263,9 @@ unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) /* _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL); */ RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" - , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); + , FUNC_ADPT_ARG(padapter), reason, get_addr2_ptr(pframe)); - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta) { u8 updated = _FALSE; @@ -3358,9 +3286,9 @@ unsigned int OnDisassoc(_adapter *padapter, union recv_frame *precv_frame) #endif { RTW_PRINT(FUNC_ADPT_FMT" reason=%u, ta=%pM\n" - , FUNC_ADPT_ARG(padapter), reason, GetAddr2Ptr(pframe)); + , FUNC_ADPT_ARG(padapter), reason, get_addr2_ptr(pframe)); - receive_disconnect(padapter, GetAddr2Ptr(pframe), reason, _FALSE); + receive_disconnect(padapter, get_addr2_ptr(pframe), reason, _FALSE); } pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; return _SUCCESS; @@ -3392,7 +3320,7 @@ unsigned int on_action_spct_ch_switch(_adapter *padapter, struct sta_info *psta, struct ieee80211_info_element *ie; RTW_INFO(FUNC_NDEV_FMT" from "MAC_FMT"\n", - FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(psta->hwaddr)); + FUNC_NDEV_ARG(padapter->pnetdev), MAC_ARG(psta->cmn.mac_addr)); for_each_ie(ie, ies, ies_len) { if (ie->id == WLAN_EID_CHANNEL_SWITCH) { @@ -3423,7 +3351,7 @@ unsigned int on_action_spct_ch_switch(_adapter *padapter, struct sta_info *psta, * 2. things after channel switching */ - ret = rtw_set_ch_cmd(padapter, ch, bwmode, ch_offset, _TRUE); + ret = rtw_set_chbw_cmd(padapter, ch, bwmode, ch_offset, 0); } exit: @@ -3443,7 +3371,7 @@ unsigned int on_action_spct(_adapter *padapter, union recv_frame *precv_frame) RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(padapter->pnetdev)); - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (!psta) goto exit; @@ -3497,7 +3425,7 @@ unsigned int on_action_wnm(_adapter *adapter, union recv_frame *rframe) int cnt = 0; char msg[16]; - sta = rtw_get_stainfo(stapriv, GetAddr2Ptr(frame)); + sta = rtw_get_stainfo(stapriv, get_addr2_ptr(frame)); if (!sta) goto exit; @@ -3533,11 +3461,6 @@ u8 rtw_rx_ampdu_size(_adapter *adapter) u8 size; HT_CAP_AMPDU_FACTOR max_rx_ampdu_factor; - if (adapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) { - size = adapter->fix_rx_ampdu_size; - goto exit; - } - #ifdef CONFIG_BT_COEXIST if (rtw_btcoex_IsBTCoexCtrlAMPDUSize(adapter) == _TRUE) { size = rtw_btcoex_GetAMPDUSize(adapter); @@ -3559,7 +3482,14 @@ u8 rtw_rx_ampdu_size(_adapter *adapter) max_rx_ampdu_factor = (HT_CAP_AMPDU_FACTOR)adapter->driver_rx_ampdu_factor; else rtw_hal_get_def_var(adapter, HW_VAR_MAX_RX_AMPDU_FACTOR, &max_rx_ampdu_factor); - + + /* In Maximum A-MPDU Length Exponent subfield of A-MPDU Parameters field of HT Capabilities element, + the unit of max_rx_ampdu_factor are octets. 8K, 16K, 32K, 64K is right. + But the buffer size subfield of Block Ack Parameter Set field in ADDBA action frame indicates + the number of buffers available for this particular TID. Each buffer is equal to max. size of + MSDU or AMSDU. + The size variable means how many MSDUs or AMSDUs, it's not Kbytes. + */ if (MAX_AMPDU_FACTOR_64K == max_rx_ampdu_factor) size = 64; else if (MAX_AMPDU_FACTOR_32K == max_rx_ampdu_factor) @@ -3728,6 +3658,35 @@ u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 ac return ret; } +u8 rx_ampdu_size_sta_limit(_adapter *adapter, struct sta_info *sta) +{ + u8 sz_limit = 0xFF; + +#ifdef CONFIG_80211N_HT + struct registry_priv *regsty = adapter_to_regsty(adapter); + struct mlme_priv *mlme = &adapter->mlmepriv; + struct mlme_ext_info *mlmeinfo = &adapter->mlmeextpriv.mlmext_info; + s8 nss = -1; + u8 bw = rtw_min(sta->cmn.bw_mode, adapter->mlmeextpriv.cur_bwmode); + + #ifdef CONFIG_80211AC_VHT + if (is_supported_vht(sta->wireless_mode)) { + nss = rtw_min(rtw_vht_mcsmap_to_nss(mlme->vhtpriv.vht_mcs_map) + , rtw_vht_mcsmap_to_nss(sta->vhtpriv.vht_mcs_map)); + } else + #endif + if (is_supported_ht(sta->wireless_mode)) { + nss = rtw_min(rtw_ht_mcsset_to_nss(mlmeinfo->HT_caps.u.HT_cap_element.MCS_rate) + , rtw_ht_mcsset_to_nss(sta->htpriv.ht_cap.supp_mcs_set)); + } + + if (nss >= 1) + sz_limit = regsty->rx_ampdu_sz_limit_by_nss_bw[nss - 1][bw]; +#endif /* CONFIG_80211N_HT */ + + return sz_limit; +} + /** * rx_ampdu_apply_sta - Apply RX AMPDU setting to the specific @sta * @adapter: the adapter to which @sta belongs @@ -3761,19 +3720,28 @@ u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 siz u16 rtw_rx_ampdu_apply(_adapter *adapter) { u16 adj_cnt = 0; - struct mlme_ext_priv *mlmeext; + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; struct sta_info *sta; u8 accept = rtw_rx_ampdu_is_accept(adapter); - u8 size = rtw_rx_ampdu_size(adapter); + u8 size; - mlmeext = &adapter->mlmeextpriv; + if (adapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) + size = adapter->fix_rx_ampdu_size; + else + size = rtw_rx_ampdu_size(adapter); - if (mlmeext_msr(mlmeext) == WIFI_FW_STATION_STATE) { + if (MLME_IS_STA(adapter)) { sta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); - if (sta) - adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); + if (sta) { + u8 sta_size = size; - } else if (mlmeext_msr(mlmeext) == WIFI_FW_AP_STATE) { + if (adapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) + sta_size = rtw_min(size, rx_ampdu_size_sta_limit(adapter, sta)); + adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, sta_size); + } + /* TODO: TDLS peer */ + + } else if (MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) { _irqL irqL; _list *phead, *plist; u8 peer_num = 0; @@ -3801,11 +3769,18 @@ u16 rtw_rx_ampdu_apply(_adapter *adapter) for (i = 0; i < peer_num; i++) { sta = rtw_get_stainfo_by_offset(pstapriv, peers[i]); - if (sta) - adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, size); + if (sta) { + u8 sta_size = size; + + if (adapter->fix_rx_ampdu_size == RX_AMPDU_SIZE_INVALID) + sta_size = rtw_min(size, rx_ampdu_size_sta_limit(adapter, sta)); + adj_cnt += rx_ampdu_apply_sta(adapter, sta, accept, sta_size); + } } } + /* TODO: ADHOC */ + return adj_cnt; } @@ -3821,6 +3796,8 @@ unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); u8 *pframe = precv_frame->u.hdr.rx_data; struct sta_priv *pstapriv = &padapter->stapriv; + struct registry_priv *pregpriv = &padapter->registrypriv; + #ifdef CONFIG_80211N_HT RTW_INFO("%s\n", __FUNCTION__); @@ -3839,7 +3816,7 @@ unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) if (!(pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) return _SUCCESS; - addr = GetAddr2Ptr(pframe); + addr = get_addr2_ptr(pframe); psta = rtw_get_stainfo(pstapriv, addr); if (psta == NULL) @@ -3875,12 +3852,20 @@ unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) /* status = frame_body[3] | (frame_body[4] << 8); */ /* endian issue */ status = RTW_GET_LE16(&frame_body[3]); tid = ((frame_body[5] >> 2) & 0x7); - if (status == 0) { /* successful */ RTW_INFO("agg_enable for TID=%d\n", tid); psta->htpriv.agg_enable_bitmap |= 1 << tid; psta->htpriv.candidate_tid_bitmap &= ~BIT(tid); + /* amsdu in ampdu */ + if (pregpriv->tx_ampdu_amsdu == 0) + psta->htpriv.tx_amsdu_enable = _FALSE; + else if (pregpriv->tx_ampdu_amsdu == 1) + psta->htpriv.tx_amsdu_enable = _TRUE; + else { + if (frame_body[5] & 1) + psta->htpriv.tx_amsdu_enable = _TRUE; + } } else psta->htpriv.agg_enable_bitmap &= ~BIT(tid); @@ -3922,42 +3907,20 @@ unsigned int OnAction_back(_adapter *padapter, union recv_frame *precv_frame) } #ifdef CONFIG_P2P - -static int get_reg_classes_full_count(struct p2p_channels channel_list) +int get_reg_classes_full_count(struct p2p_channels *channel_list) { int cnt = 0; int i; - for (i = 0; i < channel_list.reg_classes; i++) - cnt += channel_list.reg_class[i].channels; + for (i = 0; i < channel_list->reg_classes; i++) + cnt += channel_list->reg_class[i].channels; return cnt; } -static void get_channel_cnt_24g_5gl_5gh(struct mlme_ext_priv *pmlmeext, u8 *p24g_cnt, u8 *p5gl_cnt, u8 *p5gh_cnt) -{ - int i = 0; - - *p24g_cnt = 0; - *p5gl_cnt = 0; - *p5gh_cnt = 0; - - for (i = 0; i < pmlmeext->max_chan_nums; i++) { - if (pmlmeext->channel_set[i].ChannelNum <= 14) - (*p24g_cnt)++; - else if ((pmlmeext->channel_set[i].ChannelNum > 14) && (pmlmeext->channel_set[i].ChannelNum <= 48)) { - /* Just include the channel 36, 40, 44, 48 channels for 5G low */ - (*p5gl_cnt)++; - } else if ((pmlmeext->channel_set[i].ChannelNum >= 149) && (pmlmeext->channel_set[i].ChannelNum <= 161)) { - /* Just include the channel 149, 153, 157, 161 channels for 5G high */ - (*p5gh_cnt)++; - } - } -} - void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) { - + struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; u8 action = P2P_PUB_ACTION_ACTION; u32 p2poui = cpu_to_be32(P2POUI); @@ -4004,7 +3967,7 @@ void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -4189,8 +4152,8 @@ void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ /* + number of channels in all classes */ len_channellist_attr = 3 - + (1 + 1) * (u16)(pmlmeext->channel_list.reg_classes) - + get_reg_classes_full_count(pmlmeext->channel_list); + + (1 + 1) * (u16)(ch_list->reg_classes) + + get_reg_classes_full_count(ch_list); #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) @@ -4235,36 +4198,22 @@ void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) /* Channel List */ p2pie[p2pielen++] = union_ch; - } else { - int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { - /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; - - /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; - - /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; - } - } -#else /* CONFIG_CONCURRENT_MODE */ + } else +#endif /* CONFIG_CONCURRENT_MODE */ { int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { + for (j = 0; j < ch_list->reg_classes; j++) { /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; + p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; + p2pie[p2pielen++] = ch_list->reg_class[j].channels; /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; + for (i = 0; i < ch_list->reg_class[j].channels; i++) + p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; } } -#endif /* CONFIG_CONCURRENT_MODE */ /* Device Info */ /* Type: */ @@ -4369,7 +4318,7 @@ void issue_p2p_GO_request(_adapter *padapter, u8 *raddr) void issue_p2p_GO_response(_adapter *padapter, u8 *raddr, u8 *frame_body, uint len, u8 result) { - + struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; u8 action = P2P_PUB_ACTION_ACTION; u32 p2poui = cpu_to_be32(P2POUI); @@ -4419,7 +4368,7 @@ void issue_p2p_GO_response(_adapter *padapter, u8 *raddr, u8 *frame_body, uint l SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -4636,8 +4585,8 @@ void issue_p2p_GO_response(_adapter *padapter, u8 *raddr, u8 *frame_body, uint l /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ /* + number of channels in all classes */ len_channellist_attr = 3 - + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes - + get_reg_classes_full_count(pmlmeext->channel_list); + + (1 + 1) * (u16)ch_list->reg_classes + + get_reg_classes_full_count(ch_list); #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) @@ -4682,37 +4631,22 @@ void issue_p2p_GO_response(_adapter *padapter, u8 *raddr, u8 *frame_body, uint l /*Channel List*/ p2pie[p2pielen++] = union_chan; - } else { - int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { - /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; - - /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; - - /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; - } - } -#else /* CONFIG_CONCURRENT_MODE */ + } else +#endif /* CONFIG_CONCURRENT_MODE */ { int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { + for (j = 0; j < ch_list->reg_classes; j++) { /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; + p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; + p2pie[p2pielen++] = ch_list->reg_class[j].channels; /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; + for (i = 0; i < ch_list->reg_class[j].channels; i++) + p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; } } -#endif /* CONFIG_CONCURRENT_MODE */ - /* Device Info */ /* Type: */ @@ -4847,7 +4781,7 @@ void issue_p2p_GO_confirm(_adapter *padapter, u8 *raddr, u8 result) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5038,7 +4972,7 @@ void issue_p2p_GO_confirm(_adapter *padapter, u8 *raddr, u8 result) void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) { - + struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; u8 action = P2P_PUB_ACTION_ACTION; u32 p2poui = cpu_to_be32(P2POUI); @@ -5085,7 +5019,7 @@ void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5192,8 +5126,8 @@ void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ /* + number of channels in all classes */ len_channellist_attr = 3 - + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes - + get_reg_classes_full_count(pmlmeext->channel_list); + + (1 + 1) * (u16)ch_list->reg_classes + + get_reg_classes_full_count(ch_list); #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) @@ -5235,36 +5169,22 @@ void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) /* Channel List */ p2pie[p2pielen++] = union_ch; - } else { - int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { - /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; - - /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; - - /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; - } - } -#else /* CONFIG_CONCURRENT_MODE */ + } else +#endif /* CONFIG_CONCURRENT_MODE */ { int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { + for (j = 0; j < ch_list->reg_classes; j++) { /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; + p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; + p2pie[p2pielen++] = ch_list->reg_class[j].channels; /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; + for (i = 0; i < ch_list->reg_class[j].channels; i++) + p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; } } -#endif /* CONFIG_CONCURRENT_MODE */ /* P2P Group ID */ @@ -5352,7 +5272,7 @@ void issue_p2p_invitation_request(_adapter *padapter, u8 *raddr) void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken, u8 status_code) { - + struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; u8 action = P2P_PUB_ACTION_ACTION; u32 p2poui = cpu_to_be32(P2POUI); @@ -5398,7 +5318,7 @@ void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5510,8 +5430,8 @@ void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ /* + number of channels in all classes */ len_channellist_attr = 3 - + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes - + get_reg_classes_full_count(pmlmeext->channel_list); + + (1 + 1) * (u16)ch_list->reg_classes + + get_reg_classes_full_count(ch_list); #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_check_status(padapter, MI_LINKED) && padapter->registrypriv.full_ch_in_p2p_handshake == 0) @@ -5553,36 +5473,22 @@ void issue_p2p_invitation_response(_adapter *padapter, u8 *raddr, u8 dialogToken /* Channel List */ p2pie[p2pielen++] = union_ch; - } else { - int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { - /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; - - /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; - - /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; - } - } -#else /* CONFIG_CONCURRENT_MODE */ + } else +#endif /* CONFIG_CONCURRENT_MODE */ { int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { + for (j = 0; j < ch_list->reg_classes; j++) { /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; + p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; + p2pie[p2pielen++] = ch_list->reg_class[j].channels; /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; + for (i = 0; i < ch_list->reg_class[j].channels; i++) + p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; } } -#endif /* CONFIG_CONCURRENT_MODE */ } pframe = rtw_set_ie(pframe, _VENDOR_SPECIFIC_IE_, p2pielen, (unsigned char *) p2pie, &pattrib->pktlen); @@ -5649,7 +5555,7 @@ void issue_p2p_provision_request(_adapter *padapter, u8 *pssid, u8 ussidlen, u8 SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5791,7 +5697,7 @@ void issue_probersp_p2p(_adapter *padapter, unsigned char *da) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(fctrl, WIFI_PROBERSP); + set_frame_sub_type(fctrl, WIFI_PROBERSP); pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = pattrib->hdrlen; @@ -6128,7 +6034,7 @@ int _issue_probereq_p2p(_adapter *padapter, u8 *da, int wait_ack) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_PROBEREQ); + set_frame_sub_type(pframe, WIFI_PROBEREQ); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -6398,7 +6304,7 @@ int issue_probereq_p2p_ex(_adapter *adapter, u8 *da, int try_cnt, int wait_ms) { int ret; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); do { ret = _issue_probereq_p2p(adapter, da, wait_ms > 0 ? _TRUE : _FALSE); @@ -6522,10 +6428,10 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) /* Commented by Kurt 20120113 */ /* Get peer_dev_addr here if peer doesn't issue prov_disc frame. */ if (_rtw_memcmp(pwdinfo->rx_prov_disc_info.peerDevAddr, empty_addr, ETH_ALEN)) - _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); + _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, get_addr2_ptr(pframe), ETH_ALEN); result = process_p2p_group_negotation_req(pwdinfo, frame_body, len); - issue_p2p_GO_response(padapter, GetAddr2Ptr(pframe), frame_body, len, result); + issue_p2p_GO_response(padapter, get_addr2_ptr(pframe), frame_body, len, result); #ifdef CONFIG_INTEL_WIDI if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_LISTEN) { padapter->mlmepriv.widi_state = INTEL_WIDI_STATE_WFD_CONNECTION; @@ -6553,7 +6459,7 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); pwdinfo->nego_req_info.benable = _FALSE; result = process_p2p_group_negotation_resp(pwdinfo, frame_body, len); - issue_p2p_GO_confirm(pwdinfo->padapter, GetAddr2Ptr(pframe), result); + issue_p2p_GO_confirm(pwdinfo->padapter, get_addr2_ptr(pframe), result); if (P2P_STATUS_SUCCESS == result) { if (rtw_p2p_role(pwdinfo) == P2P_ROLE_CLIENT) { pwdinfo->p2p_info.operation_ch[0] = pwdinfo->peer_operating_ch; @@ -6654,7 +6560,7 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) u8 operatingch_info[5] = { 0x00 }; if (rtw_get_p2p_attr_content(merged_p2pie, merged_p2p_ielen, P2P_ATTR_OPERATING_CH, operatingch_info, &attr_contentlen)) { - if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, (u32)operatingch_info[4]) >= 0) { + if (rtw_chset_search_ch(adapter_to_chset(padapter), (u32)operatingch_info[4]) >= 0) { /* The operating channel is acceptable for this device. */ pwdinfo->rx_invitereq_info.operation_ch[0] = operatingch_info[4]; #ifdef CONFIG_P2P_OP_CHK_SOCIAL_CH @@ -6731,7 +6637,7 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) RTW_INFO("[%s] status_code = %d\n", __FUNCTION__, status_code); pwdinfo->inviteresp_info.token = frame_body[7]; - issue_p2p_invitation_response(padapter, GetAddr2Ptr(pframe), pwdinfo->inviteresp_info.token, status_code); + issue_p2p_invitation_response(padapter, get_addr2_ptr(pframe), pwdinfo->inviteresp_info.token, status_code); _set_timer(&pwdinfo->restore_p2p_state_timer, 3000); } #ifdef CONFIG_INTEL_WIDI @@ -6796,7 +6702,7 @@ unsigned int on_action_public_p2p(union recv_frame *precv_frame) case P2P_PROVISION_DISC_REQ: RTW_INFO("[%s] Got Provisioning Discovery Request Frame\n", __FUNCTION__); process_p2p_provdisc_req(pwdinfo, pframe, len); - _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, GetAddr2Ptr(pframe), ETH_ALEN); + _rtw_memcpy(pwdinfo->rx_prov_disc_info.peerDevAddr, get_addr2_ptr(pframe), ETH_ALEN); /* 20110902 Kurt */ /* Add the following statement to avoid receiving duplicate prov disc req. such that pre_p2p_state would be covered. */ @@ -7031,14 +6937,14 @@ unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame) #ifdef CONFIG_80211N_HT #ifdef CONFIG_AP_MODE if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) - rtw_process_ht_action_smps(padapter, GetAddr2Ptr(pframe), frame_body[2]); + rtw_process_ht_action_smps(padapter, get_addr2_ptr(pframe), frame_body[2]); #endif /*CONFIG_AP_MODE*/ #endif /*CONFIG_80211N_HT*/ break; case RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING: #ifdef CONFIG_BEAMFORMING /*RTW_INFO("RTW_WLAN_ACTION_HT_COMPRESS_BEAMFORMING\n");*/ - beamforming_get_report_frame(padapter, precv_frame); + rtw_beamforming_get_report_frame(padapter, precv_frame); #endif /*CONFIG_BEAMFORMING*/ break; default: @@ -7069,11 +6975,11 @@ unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame _rtw_memcpy(&tid, &pframe[WLAN_HDR_A3_LEN + 2], sizeof(u16)); RTW_INFO("OnAction_sa_query request,action=%d, tid=%04x, pframe=%02x-%02x\n" , pframe[WLAN_HDR_A3_LEN + 1], tid, pframe[WLAN_HDR_A3_LEN + 2], pframe[WLAN_HDR_A3_LEN + 3]); - issue_action_SA_Query(padapter, GetAddr2Ptr(pframe), 1, tid, IEEE80211W_RIGHT_KEY); + issue_action_SA_Query(padapter, get_addr2_ptr(pframe), 1, tid, IEEE80211W_RIGHT_KEY); break; case 1: /* SA Query rsp */ - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta != NULL) _cancel_timer_ex(&psta->dot11w_expire_timer); @@ -7095,6 +7001,15 @@ unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame } #endif /* CONFIG_IEEE80211W */ +unsigned int on_action_rm(_adapter *padapter, union recv_frame *precv_frame) +{ +#ifdef CONFIG_RTW_80211K + return rm_on_action(padapter, precv_frame); +#else + return _SUCCESS; +#endif /* CONFIG_RTW_80211K */ +} + unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame) { return _SUCCESS; @@ -7124,7 +7039,7 @@ unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame) case RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING: #ifdef CONFIG_BEAMFORMING /*RTW_INFO("RTW_WLAN_ACTION_VHT_COMPRESSED_BEAMFORMING\n");*/ - beamforming_get_report_frame(padapter, precv_frame); + rtw_beamforming_get_report_frame(padapter, precv_frame); #endif /*CONFIG_BEAMFORMING*/ break; case RTW_WLAN_ACTION_VHT_OPMODE_NOTIFICATION: @@ -7136,7 +7051,9 @@ unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame) break; case RTW_WLAN_ACTION_VHT_GROUPID_MANAGEMENT: #ifdef CONFIG_BEAMFORMING - beamforming_get_vht_gid_mgnt_frame(padapter, precv_frame); +#ifdef RTW_BEAMFORMING_VERSION_2 + rtw_beamforming_get_vht_gid_mgnt_frame(padapter, precv_frame); +#endif /* RTW_BEAMFORMING_VERSION_2 */ #endif /* CONFIG_BEAMFORMING */ break; default: @@ -7241,7 +7158,7 @@ unsigned int OnAction(_adapter *padapter, union recv_frame *precv_frame) unsigned int DoReserved(_adapter *padapter, union recv_frame *precv_frame) { - /* RTW_INFO("rcvd mgt frame(%x, %x)\n", (GetFrameSubType(pframe) >> 4), *(unsigned int *)GetAddr1Ptr(pframe)); */ + /* RTW_INFO("rcvd mgt frame(%x, %x)\n", (get_frame_sub_type(pframe) >> 4), *(unsigned int *)GetAddr1Ptr(pframe)); */ return _SUCCESS; } @@ -7312,21 +7229,13 @@ void update_monitor_frame_attrib(_adapter *padapter, struct pkt_attrib *pattrib) struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct sta_info *psta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *pbcmc_sta = NULL; psta = rtw_get_stainfo(pstapriv, pattrib->ra); - pbcmc_sta = rtw_get_bcmc_stainfo(padapter); pattrib->hdrlen = 24; pattrib->nr_frags = 1; pattrib->priority = 7; - - if (pbcmc_sta) - pattrib->mac_id = pbcmc_sta->mac_id; - else { - pattrib->mac_id = 0; - RTW_INFO("mgmt use mac_id 0 will affect RA\n"); - } + pattrib->mac_id = RTW_DEFAULT_MGMT_MACID; pattrib->qsel = QSLT_MGNT; pattrib->pktlen = 0; @@ -7378,25 +7287,12 @@ void update_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib) u8 wireless_mode; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct xmit_priv *pxmitpriv = &padapter->xmitpriv; - struct sta_info *psta = NULL; - struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *pbcmc_sta = NULL; /* _rtw_memset((u8 *)(pattrib), 0, sizeof(struct pkt_attrib)); */ - pbcmc_sta = rtw_get_bcmc_stainfo(padapter); - pattrib->hdrlen = 24; pattrib->nr_frags = 1; pattrib->priority = 7; - - if (pbcmc_sta) - pattrib->mac_id = pbcmc_sta->mac_id; - else { - pattrib->mac_id = 1; /* use STA's BCMC sta-info macid */ - - if (MLME_IS_AP(padapter) || MLME_IS_GO(padapter)) - RTW_INFO("%s-"ADPT_FMT" get bcmc sta_info fail,use MACID=1\n", __func__, ADPT_ARG(padapter)); - } + pattrib->mac_id = RTW_DEFAULT_MGMT_MACID; pattrib->qsel = QSLT_MGNT; #ifdef CONFIG_MCC_MODE @@ -7427,24 +7323,32 @@ void update_mgntframe_attrib(_adapter *padapter, struct pkt_attrib *pattrib) pattrib->mbssid = 0; pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; - -#ifdef CONFIG_BEAMFORMING - psta = rtw_get_stainfo(pstapriv, pattrib->ra); - if (psta) - update_attrib_txbf_info(padapter, pattrib, psta); -#endif - } void update_mgntframe_attrib_addr(_adapter *padapter, struct xmit_frame *pmgntframe) { u8 *pframe; struct pkt_attrib *pattrib = &pmgntframe->attrib; +#if defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) + struct sta_info *sta = NULL; +#endif pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; _rtw_memcpy(pattrib->ra, GetAddr1Ptr(pframe), ETH_ALEN); - _rtw_memcpy(pattrib->ta, GetAddr2Ptr(pframe), ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_addr2_ptr(pframe), ETH_ALEN); + +#if defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) + sta = pattrib->psta; + if (!sta) { + sta = rtw_get_stainfo(&padapter->stapriv, pattrib->ra); + pattrib->psta = sta; + } + #ifdef CONFIG_BEAMFORMING + if (sta) + update_attrib_txbf_info(padapter, pattrib, sta); + #endif +#endif /* defined(CONFIG_BEAMFORMING) || defined(CONFIG_ANTENNA_DIVERSITY) */ } void dump_mgntframe(_adapter *padapter, struct xmit_frame *pmgntframe) @@ -7644,12 +7548,12 @@ void issue_beacon(_adapter *padapter, int timeout_ms) SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); /* pmlmeext->mgnt_seq++; */ - SetFrameSubType(pframe, WIFI_BEACON); + set_frame_sub_type(pframe, WIFI_BEACON); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); - if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { /* RTW_INFO("ie len=%d\n", cur_network->IELength); */ #ifdef CONFIG_P2P /* for P2P : Primary Device Type & Device Name */ @@ -7790,6 +7694,10 @@ void issue_beacon(_adapter *padapter, int timeout_ms) pframe += len; pattrib->pktlen += len; +#ifdef CONFIG_MCC_MODE + pframe = rtw_hal_mcc_append_go_p2p_ie(padapter, pframe, &pattrib->pktlen); +#endif /* CONFIG_MCC_MODE*/ + #ifdef CONFIG_WFD len = rtw_append_beacon_wfd_ie(padapter, pframe); pframe += len; @@ -7797,7 +7705,9 @@ void issue_beacon(_adapter *padapter, int timeout_ms) #endif } #endif /* CONFIG_P2P */ - +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_append_ie(padapter, pframe, &pattrib->pktlen); +#endif #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_BEACON_VENDOR_IE_BIT); #endif @@ -7939,7 +7849,7 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(fctrl, WIFI_PROBERSP); + set_frame_sub_type(fctrl, WIFI_PROBERSP); pattrib->hdrlen = sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = pattrib->hdrlen; @@ -8019,6 +7929,9 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe pattrib->pktlen += ssid_ielen_diff; } } +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_append_ie(padapter, pframe, &pattrib->pktlen); +#endif #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_PROBERESP_VENDOR_IE_BIT); #endif @@ -8098,6 +8011,10 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe pframe += len; pattrib->pktlen += len; +#ifdef CONFIG_MCC_MODE + pframe = rtw_hal_mcc_append_go_p2p_ie(padapter, pframe, &pattrib->pktlen); +#endif /* CONFIG_MCC_MODE*/ + #ifdef CONFIG_WFD len = rtw_append_probe_resp_wfd_ie(padapter, pframe); pframe += len; @@ -8123,7 +8040,7 @@ void issue_probersp(_adapter *padapter, unsigned char *da, u8 is_valid_p2p_probe u16 cu_ch = (u16)cur_network->Configuration.DSConfig; RTW_INFO("%s, reply rc(pid=0x%x) device "MAC_FMT" in ch=%d\n", __FUNCTION__, - psta->pid, MAC_ARG(psta->hwaddr), cu_ch); + psta->pid, MAC_ARG(psta->cmn.mac_addr), cu_ch); /* append vendor specific ie */ _rtw_memcpy(RC_INFO, RC_OUI, sizeof(RC_OUI)); @@ -8199,7 +8116,7 @@ int _issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_PROBEREQ); + set_frame_sub_type(pframe, WIFI_PROBEREQ); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -8262,7 +8179,7 @@ int issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch { int ret = _FAIL; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) goto exit; @@ -8345,7 +8262,7 @@ void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_AUTH); + set_frame_sub_type(pframe, WIFI_AUTH); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -8354,7 +8271,7 @@ void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status if (psta) { /* for AP mode */ #ifdef CONFIG_NATIVEAP_MLME - _rtw_memcpy(pwlanhdr->addr1, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr1, psta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); @@ -8524,15 +8441,15 @@ void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *p fctrl = &(pwlanhdr->frame_ctl); *(fctrl) = 0; - _rtw_memcpy((void *)GetAddr1Ptr(pwlanhdr), pstat->hwaddr, ETH_ALEN); - _rtw_memcpy((void *)GetAddr2Ptr(pwlanhdr), adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy((void *)GetAddr1Ptr(pwlanhdr), pstat->cmn.mac_addr, ETH_ALEN); + _rtw_memcpy((void *)get_addr2_ptr(pwlanhdr), adapter_mac_addr(padapter), ETH_ALEN); _rtw_memcpy((void *)GetAddr3Ptr(pwlanhdr), get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; if ((pkt_type == WIFI_ASSOCRSP) || (pkt_type == WIFI_REASSOCRSP)) - SetFrameSubType(pwlanhdr, pkt_type); + set_frame_sub_type(pwlanhdr, pkt_type); else return; @@ -8548,7 +8465,7 @@ void issue_asocrsp(_adapter *padapter, unsigned short status, struct sta_info *p ie_status = cpu_to_le16(status); pframe = rtw_set_fixed_ie(pframe , _STATUS_CODE_ , (unsigned char *)&ie_status, &(pattrib->pktlen)); - val = cpu_to_le16(pstat->aid | BIT(14) | BIT(15)); + val = cpu_to_le16(pstat->cmn.aid | BIT(14) | BIT(15)); pframe = rtw_set_fixed_ie(pframe, _ASOC_ID_ , (unsigned char *)&val, &(pattrib->pktlen)); if (pstat->bssratelen <= 8) @@ -8728,6 +8645,7 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) #endif /* CONFIG_P2P */ #ifdef CONFIG_DFS + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); u16 cap; /* Dot H */ @@ -8766,9 +8684,9 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; if (is_reassoc == _TRUE) - SetFrameSubType(pframe, WIFI_REASSOCREQ); + set_frame_sub_type(pframe, WIFI_REASSOCREQ); else - SetFrameSubType(pframe, WIFI_ASSOCREQ); + set_frame_sub_type(pframe, WIFI_ASSOCREQ); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -8811,16 +8729,17 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) pframe = rtw_set_ie(pframe, EID_PowerCap, 2, pow_cap_ele, &(pattrib->pktlen)); /* supported channels */ - do { - if (pmlmeext->channel_set[sup_ch_idx].ChannelNum <= 14) { + while (sup_ch_idx < rfctl->max_chan_nums && rfctl->channel_set[sup_ch_idx].ChannelNum != 0) { + if (rfctl->channel_set[sup_ch_idx].ChannelNum <= 14) { + /* TODO: fix 2.4G supported channel when channel doesn't start from 1 and continuous */ sup_ch[0] = 1; /* First channel number */ - sup_ch[1] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; /* Number of channel */ + sup_ch[1] = rfctl->channel_set[sup_ch_idx].ChannelNum; /* Number of channel */ } else { - sup_ch[idx_5g++] = pmlmeext->channel_set[sup_ch_idx].ChannelNum; + sup_ch[idx_5g++] = rfctl->channel_set[sup_ch_idx].ChannelNum; sup_ch[idx_5g++] = 1; } sup_ch_idx++; - } while (pmlmeext->channel_set[sup_ch_idx].ChannelNum != 0); + } pframe = rtw_set_ie(pframe, EID_SupportedChannels, idx_5g, sup_ch, &(pattrib->pktlen)); } #endif /* CONFIG_DFS */ @@ -8906,6 +8825,16 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) else RTW_INFO("%s: Connect to AP without 11b and 11g data rate!\n", __FUNCTION__); +#ifdef CONFIG_RTW_80211K + if (pmlmeinfo->network.PhyInfo.rm_en_cap[0] /* RM Enabled Capabilities */ + | pmlmeinfo->network.PhyInfo.rm_en_cap[1] + | pmlmeinfo->network.PhyInfo.rm_en_cap[2] + | pmlmeinfo->network.PhyInfo.rm_en_cap[3] + | pmlmeinfo->network.PhyInfo.rm_en_cap[4]) + pframe = rtw_set_ie(pframe, _EID_RRM_EN_CAP_IE_, 5, + (u8 *)padapter->rmpriv.rm_en_cap_def, &(pattrib->pktlen)); +#endif /* CONFIG_RTW_80211K */ + /* vendor specific IE, such as WPA, WMM, WPS */ for (i = sizeof(NDIS_802_11_FIXED_IEs); i < pmlmeinfo->network.IELength;) { pIE = (PNDIS_802_11_VARIABLE_IEs)(pmlmeinfo->network.IEs + i); @@ -9130,6 +9059,9 @@ void _issue_assocreq(_adapter *padapter, u8 is_reassoc) pframe += wfdielen; pattrib->pktlen += wfdielen; #endif +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_append_ie(padapter, pframe, &pattrib->pktlen); +#endif #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE pattrib->pktlen += rtw_build_vendor_ie(padapter , pframe , WIFI_ASSOCREQ_VENDOR_IE_BIT); #endif @@ -9223,9 +9155,9 @@ static int _issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int p fctrl = &(pwlanhdr->frame_ctl); *(fctrl) = 0; - if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) + if (MLME_IS_AP(padapter)) SetFrDs(fctrl); - else if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) + else if (MLME_IS_STA(padapter)) SetToDs(fctrl); if (power_mode) @@ -9237,7 +9169,7 @@ static int _issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int p SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_DATA_NULL); + set_frame_sub_type(pframe, WIFI_DATA_NULL); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -9256,8 +9188,6 @@ static int _issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int p } /* - * [IMPORTANT] Don't call this function in interrupt context - * * When wait_ms > 0, this function should be called at process context * wait_ms == 0 means that there is no need to wait ack through C2H_CCX_TX_RPT * wait_ms > 0 means you want to wait ack through C2H_CCX_TX_RPT, and the value of wait_ms means the interval between each TX @@ -9268,23 +9198,17 @@ int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mod { int ret = _FAIL; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct sta_info *psta; - u8 macid_sleep_reg_access = _TRUE; #ifdef CONFIG_MCC_MODE if (MCC_EN(padapter)) { - /* driver doesn't access macid sleep reg under MCC */ if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) { - macid_sleep_reg_access = _FALSE; - if (da == NULL) { RTW_INFO("Warning: Do not tx null data to AP under MCC mode\n"); rtw_warn_on(1); } - } } #endif @@ -9292,24 +9216,10 @@ int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mod if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) goto exit; - /* da == NULL, assum it's null data for sta to ap*/ + /* da == NULL, assum it's null data for sta to ap */ if (da == NULL) da = get_my_bssid(&(pmlmeinfo->network)); - psta = rtw_get_stainfo(&padapter->stapriv, da); - if (psta) { - if (macid_sleep_reg_access) { - if (power_mode) - rtw_hal_macid_sleep(padapter, psta->mac_id); - else - rtw_hal_macid_wakeup(padapter, psta->mac_id); - } - } else { - RTW_INFO(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", - FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode ? "sleep" : "wakeup"); - rtw_warn_on(1); - } - do { ret = _issue_nulldata(padapter, da, power_mode, wait_ms > 0 ? _TRUE : _FALSE); @@ -9344,31 +9254,6 @@ int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mod return ret; } -/* - * [IMPORTANT] This function run in interrupt context - * - * The null data packet would be sent without power bit, - * and not guarantee success. - */ -s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode) -{ - int ret; - struct mlme_ext_priv *pmlmeext; - struct mlme_ext_info *pmlmeinfo; - - - pmlmeext = &padapter->mlmeextpriv; - pmlmeinfo = &pmlmeext->mlmext_info; - - /* da == NULL, assum it's null data for sta to ap*/ - if (da == NULL) - da = get_my_bssid(&(pmlmeinfo->network)); - - ret = _issue_nulldata(padapter, da, power_mode, _FALSE); - - return ret; -} - /* when wait_ack is ture, this function shoule be called at process context */ static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int wait_ack) { @@ -9409,9 +9294,9 @@ static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, i fctrl = &(pwlanhdr->frame_ctl); *(fctrl) = 0; - if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) + if (MLME_IS_AP(padapter)) SetFrDs(fctrl); - else if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) + else if (MLME_IS_STA(padapter)) SetToDs(fctrl); if (pattrib->mdata) @@ -9431,7 +9316,7 @@ static int _issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, i SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); + set_frame_sub_type(pframe, WIFI_QOS_DATA_NULL); pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); @@ -9460,7 +9345,7 @@ int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_c { int ret = _FAIL; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -9555,7 +9440,7 @@ static int _issue_deauth(_adapter *padapter, unsigned char *da, unsigned short r SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_DEAUTH); + set_frame_sub_type(pframe, WIFI_DEAUTH); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -9601,7 +9486,7 @@ int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_c { int ret = _FAIL; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) goto exit; @@ -9682,7 +9567,7 @@ void issue_action_spct_ch_switch(_adapter *padapter, u8 *ra, u8 new_ch, u8 ch_of SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -9757,7 +9642,7 @@ void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned ch SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -9858,7 +9743,7 @@ static int issue_action_ba(_adapter *padapter, unsigned char *raddr, unsigned ch SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -9880,6 +9765,12 @@ static int issue_action_ba(_adapter *padapter, unsigned char *raddr, unsigned ch BA_para_set = (0x1002 | ((tid & 0xf) << 2)); /* immediate ack & 64 buffer size */ #endif +#ifdef CONFIG_TX_AMSDU + if (padapter->tx_amsdu >= 1) /* TX AMSDU enabled */ + BA_para_set |= BIT(0); + else /* TX AMSDU disabled */ + BA_para_set &= ~BIT(0); +#endif BA_para_set = cpu_to_le16(BA_para_set); pframe = rtw_set_fixed_ie(pframe, 2, (unsigned char *)(&(BA_para_set)), &(pattrib->pktlen)); @@ -9918,9 +9809,9 @@ static int issue_action_ba(_adapter *padapter, unsigned char *raddr, unsigned ch BA_para_set |= (size << 6) & RTW_IEEE80211_ADDBA_PARAM_BUF_SIZE_MASK; if (!padapter->registrypriv.wifi_spec) { - if (pregpriv->ampdu_amsdu == 0) /* disabled */ + if (pregpriv->rx_ampdu_amsdu == 0) /* disabled */ BA_para_set &= ~BIT(0); - else if (pregpriv->ampdu_amsdu == 1) /* enabled */ + else if (pregpriv->rx_ampdu_amsdu == 1) /* enabled */ BA_para_set |= BIT(0); } @@ -10015,7 +9906,7 @@ inline u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, { int ret = _FAIL; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(adapter))) goto exit; @@ -10047,8 +9938,8 @@ inline u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, } if (try_cnt && wait_ms) { - RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" tid=%u%s, %d/%d in %u ms\n" - , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), tid + RTW_INFO(FUNC_ADPT_FMT" ra="MAC_FMT" status:=%u tid=%u size:%u%s, %d/%d in %u ms\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(ra), status, tid, size , ret == _SUCCESS ? ", acked" : "", i, try_cnt, rtw_get_passing_time_ms(start)); } @@ -10093,7 +9984,7 @@ int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 { int ret = _FAIL; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(adapter))) goto exit; @@ -10133,7 +10024,7 @@ int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 return ret; } -static void issue_action_BSSCoexistPacket(_adapter *padapter) +void issue_action_BSSCoexistPacket(_adapter *padapter) { _irqL irqL; _list *plist, *phead; @@ -10189,7 +10080,7 @@ static void issue_action_BSSCoexistPacket(_adapter *padapter) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -10339,7 +10230,7 @@ int _issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoP SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -10374,7 +10265,7 @@ int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 New { int ret = _FAIL; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); if (rtw_rfctl_is_tx_blocked_by_ch_waiting(adapter_to_rfctl(padapter))) goto exit; @@ -10455,9 +10346,9 @@ static unsigned int _send_delba_sta_tid(_adapter *adapter, u8 initiator, struct if (rtw_del_rx_ampdu_test_trigger_no_tx_fail()) ret = _FAIL; else if (wait_ack) - ret = issue_del_ba_ex(adapter, sta->hwaddr, tid, 37, initiator, 3, 1); + ret = issue_del_ba_ex(adapter, sta->cmn.mac_addr, tid, 37, initiator, 3, 1); else - issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); + issue_del_ba(adapter, sta->cmn.mac_addr, tid, 37, initiator); if (ret == _FAIL && sta->recvreorder_ctrl[tid].enable == _FALSE) sta->recvreorder_ctrl[tid].ampdu_size = ampdu_size_bak; @@ -10468,7 +10359,7 @@ static unsigned int _send_delba_sta_tid(_adapter *adapter, u8 initiator, struct if (force || sta->htpriv.agg_enable_bitmap & BIT(tid)) { sta->htpriv.agg_enable_bitmap &= ~BIT(tid); sta->htpriv.candidate_tid_bitmap &= ~BIT(tid); - issue_del_ba(adapter, sta->hwaddr, tid, 37, initiator); + issue_del_ba(adapter, sta->cmn.mac_addr, tid, 37, initiator); } #endif } @@ -10527,6 +10418,14 @@ unsigned int send_beacon(_adapter *padapter) #endif #ifdef CONFIG_PCI_HCI + /* bypass TX BCN queue because op ch is switching/waiting */ + if (check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) + #ifdef CONFIG_DFS_MASTER + || IS_CH_WAITING(adapter_to_rfctl(padapter)) + #endif + ) + return _SUCCESS; + /* RTW_INFO("%s\n", __FUNCTION__); */ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); @@ -10546,27 +10445,47 @@ unsigned int send_beacon(_adapter *padapter) #endif #if defined(CONFIG_USB_HCI) || defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); - rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); - rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); - do { - issue_beacon(padapter, 100); - issue++; + /* bypass TX BCN queue because op ch is switching/waiting */ + if (check_fwstate(&padapter->mlmepriv, WIFI_OP_CH_SWITCHING) + #ifdef CONFIG_DFS_MASTER + || IS_CH_WAITING(adapter_to_rfctl(padapter)) + #endif + ) + return _SUCCESS; + +#if defined(CONFIG_USB_HCI) +#if defined(CONFIG_RTL8812A) + if (IS_FULL_SPEED_USB(padapter)) { + issue_beacon(padapter, 300); + bxmitok = _TRUE; + } else +#endif +#endif + { + rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); + rtw_hal_set_hwreg(padapter, HW_VAR_DL_BCN_SEL, NULL); do { - rtw_yield_os(); - rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); - poll++; - } while ((poll % 10) != 0 && _FALSE == bxmitok && !RTW_CANNOT_RUN(padapter)); - - } while (_FALSE == bxmitok && issue < 100 && !RTW_CANNOT_RUN(padapter)); + issue_beacon(padapter, 100); + issue++; + do { + rtw_yield_os(); + rtw_hal_get_hwreg(padapter, HW_VAR_BCN_VALID, (u8 *)(&bxmitok)); + poll++; + } while ((poll % 10) != 0 && _FALSE == bxmitok && !RTW_CANNOT_RUN(padapter)); + } while (bxmitok == _FALSE && (issue < 100) && !RTW_CANNOT_RUN(padapter)); + } if (RTW_CANNOT_RUN(padapter)) return _FAIL; if (_FALSE == bxmitok) { RTW_INFO("%s fail! %u ms\n", __FUNCTION__, rtw_get_passing_time_ms(start)); + #ifdef CONFIG_BCN_RECOVERY + GET_HAL_DATA(padapter)->issue_bcn_fail++; + #endif /*CONFIG_BCN_RECOVERY*/ return _FAIL; } else { u32 passing_time = rtw_get_passing_time_ms(start); @@ -10614,14 +10533,18 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI int i; u32 len; u8 *p; + u8 rf_path; u16 val16, subtype; u8 *pframe = precv_frame->u.hdr.rx_data; u32 packet_len = precv_frame->u.hdr.len; u8 ie_offset; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct registry_priv *pregistrypriv = &padapter->registrypriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); if (len > MAX_IE_SZ) { @@ -10631,21 +10554,21 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI _rtw_memset(bssid, 0, sizeof(WLAN_BSSID_EX)); - subtype = GetFrameSubType(pframe); + subtype = get_frame_sub_type(pframe); if (subtype == WIFI_BEACON) { - bssid->Reserved[0] = 1; + bssid->Reserved[0] = BSS_TYPE_BCN; ie_offset = _BEACON_IE_OFFSET_; } else { /* FIXME : more type */ if (subtype == WIFI_PROBERSP) { ie_offset = _PROBERSP_IE_OFFSET_; - bssid->Reserved[0] = 3; + bssid->Reserved[0] = BSS_TYPE_PROB_RSP; } else if (subtype == WIFI_PROBEREQ) { ie_offset = _PROBEREQ_IE_OFFSET_; - bssid->Reserved[0] = 2; + bssid->Reserved[0] = BSS_TYPE_PROB_REQ; } else { - bssid->Reserved[0] = 0; + bssid->Reserved[0] = BSS_TYPE_UNDEF; ie_offset = _FIXED_IE_LENGTH_; } } @@ -10658,9 +10581,19 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI /* get the signal strength */ /* bssid->Rssi = precv_frame->u.hdr.attrib.SignalStrength; */ /* 0-100 index. */ - bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.RecvSignalPower; /* in dBM.raw data */ - bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.SignalQuality;/* in percentage */ - bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.SignalStrength;/* in percentage */ + bssid->Rssi = precv_frame->u.hdr.attrib.phy_info.recv_signal_power; /* in dBM.raw data */ + bssid->PhyInfo.SignalQuality = precv_frame->u.hdr.attrib.phy_info.signal_quality;/* in percentage */ + bssid->PhyInfo.SignalStrength = precv_frame->u.hdr.attrib.phy_info.signal_strength;/* in percentage */ + + /* get rx_snr */ + if (precv_frame->u.hdr.attrib.data_rate >= DESC_RATE11M) { + bssid->PhyInfo.is_cck_rate = 0; + for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) + bssid->PhyInfo.rx_snr[rf_path] = + precv_frame->u.hdr.attrib.phy_info.rx_snr[rf_path]; + } else + bssid->PhyInfo.is_cck_rate = 1; + #ifdef CONFIG_ANTENNA_DIVERSITY rtw_hal_get_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &(bssid->PhyInfo.Optimum_antenna), NULL); #endif @@ -10735,7 +10668,7 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI /* FIXME */ bssid->InfrastructureMode = Ndis802_11Infrastructure; - _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); + _rtw_memcpy(bssid->MacAddress, get_addr2_ptr(pframe), ETH_ALEN); bssid->Privacy = 1; return _SUCCESS; } @@ -10772,7 +10705,7 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI if (val16 & BIT(0)) { bssid->InfrastructureMode = Ndis802_11Infrastructure; - _rtw_memcpy(bssid->MacAddress, GetAddr2Ptr(pframe), ETH_ALEN); + _rtw_memcpy(bssid->MacAddress, get_addr2_ptr(pframe), ETH_ALEN); } else { bssid->InfrastructureMode = Ndis802_11IBSS; _rtw_memcpy(bssid->MacAddress, GetAddr3Ptr(pframe), ETH_ALEN); @@ -10822,6 +10755,14 @@ u8 collect_bss_info(_adapter *padapter, union recv_frame *precv_frame, WLAN_BSSI if (bssid->Configuration.DSConfig != rtw_get_oper_ch(padapter)) bssid->PhyInfo.SignalQuality = 101; +#ifdef CONFIG_RTW_80211K + p = rtw_get_ie(bssid->IEs + ie_offset, _EID_RRM_EN_CAP_IE_, &len, bssid->IELength - ie_offset); + if (p) + _rtw_memcpy(bssid->PhyInfo.rm_en_cap, (p + 2), *(p + 1)); + + /* save freerun counter */ + bssid->PhyInfo.free_cnt = precv_frame->u.hdr.attrib.free_cnt; +#endif return _SUCCESS; } @@ -10873,6 +10814,7 @@ void start_create_ibss(_adapter *padapter) rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); join_type = 0; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); report_join_res(padapter, 1); pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; @@ -10949,7 +10891,7 @@ void start_clnt_join(_adapter *padapter) if (_rtw_memcmp(&(scanned->network.Ssid), &(pnetwork->Ssid), sizeof(NDIS_802_11_SSID)) == _TRUE && _rtw_memcmp(scanned->network.MacAddress, pnetwork->MacAddress, sizeof(NDIS_802_11_MAC_ADDRESS)) == _TRUE ) { - ie_offset = (scanned->network.Reserved[0] == 2 ? 0 : 12); + ie_offset = (scanned->network.Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12); if (rtw_get_p2p_ie(scanned->network.IEs + ie_offset, scanned->network.IELength - ie_offset, NULL, NULL)) has_p2p_ie = _TRUE; break; @@ -10992,9 +10934,13 @@ void start_clnt_join(_adapter *padapter) } } else #endif + { + rtw_sta_linking_test_set_start(); pmlmeinfo->state = WIFI_FW_AUTH_NULL | WIFI_FW_STATION_STATE; + } } else if (caps & cap_IBSS) { /* adhoc client */ Set_MSR(padapter, WIFI_FW_ADHOC_STATE); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); val8 = 0xcf; rtw_hal_set_hwreg(padapter, HW_VAR_SEC_CFG, (u8 *)(&val8)); @@ -11071,6 +11017,9 @@ unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsi RTW_INFO("%s\n", __FUNCTION__); +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_do_disconnect(padapter); +#endif if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { if (pmlmeinfo->state & WIFI_FW_ASSOC_SUCCESS) { if (report_del_sta_event(padapter, MacAddr, reason, _TRUE, locally_generated) != _FAIL) @@ -11092,6 +11041,7 @@ unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsi #ifdef CONFIG_80211D static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct registry_priv *pregistrypriv; struct mlme_ext_priv *pmlmeext; RT_CHANNEL_INFO *chplan_new; @@ -11156,7 +11106,7 @@ static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) _RTW_INFO("}\n"); #endif - _rtw_memcpy(chplan_sta, pmlmeext->channel_set, sizeof(chplan_sta)); + _rtw_memcpy(chplan_sta, rfctl->channel_set, sizeof(chplan_sta)); #ifdef CONFIG_RTW_DEBUG i = 0; RTW_INFO("%s: STA channel plan {", __FUNCTION__); @@ -11167,8 +11117,8 @@ static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) _RTW_INFO("}\n"); #endif - _rtw_memset(pmlmeext->channel_set, 0, sizeof(pmlmeext->channel_set)); - chplan_new = pmlmeext->channel_set; + _rtw_memset(rfctl->channel_set, 0, sizeof(rfctl->channel_set)); + chplan_new = rfctl->channel_set; i = j = k = 0; if (pregistrypriv->wireless_mode & WIRELESS_11G) { @@ -11332,13 +11282,13 @@ static void process_80211d(PADAPTER padapter, WLAN_BSSID_EX *bssid) /* If channel is used by AP, set channel scan type to active */ channel = bssid->Configuration.DSConfig; - chplan_new = pmlmeext->channel_set; + chplan_new = rfctl->channel_set; i = 0; - while ((i < MAX_CHANNEL_NUM) && (chplan_new[i].ChannelNum != 0)) { + while (i < MAX_CHANNEL_NUM && chplan_new[i].ChannelNum != 0) { if (chplan_new[i].ChannelNum == channel) { if (chplan_new[i].ScanType == SCAN_PASSIVE) { /* 5G Bnad 2, 3 (DFS) doesn't change to active scan */ - if (channel >= 52 && channel <= 144) + if (rtw_is_dfs_ch(channel)) break; chplan_new[i].ScanType = SCAN_ACTIVE; @@ -11369,6 +11319,8 @@ void report_survey_event(_adapter *padapter, union recv_frame *precv_frame) struct cmd_priv *pcmdpriv; /* u8 *pframe = precv_frame->u.hdr.rx_data; */ /* uint len = precv_frame->u.hdr.len; */ + RT_CHANNEL_INFO *chset = adapter_to_chset(padapter); + int ch_set_idx = -1; if (!padapter) return; @@ -11414,6 +11366,16 @@ void report_survey_event(_adapter *padapter, union recv_frame *precv_frame) process_80211d(padapter, &psurvey_evt->bss); #endif +#ifdef CONFIG_DFS + ch_set_idx = rtw_chset_search_ch(chset, psurvey_evt->bss.Configuration.DSConfig); + if (ch_set_idx >= 0) { + if (psurvey_evt->bss.InfrastructureMode == Ndis802_11Infrastructure + && (psurvey_evt->bss.Ssid.SsidLength == 0 + || is_all_null(psurvey_evt->bss.Ssid.Ssid, psurvey_evt->bss.Ssid.SsidLength) == _TRUE)) + chset[ch_set_idx].hidden_bss_cnt++; + } +#endif + rtw_enqueue_cmd(pcmdpriv, pcmd_obj); pmlmeext->sitesurvey_res.bss_cnt++; @@ -11597,7 +11559,7 @@ u32 report_del_sta_event(_adapter *padapter, unsigned char *MacAddr, unsigned sh _rtw_memcpy((unsigned char *)(pdel_sta_evt->rsvd), (unsigned char *)(&reason), 2); psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); if (psta) - mac_id = (int)psta->mac_id; + mac_id = (int)psta->cmn.mac_id; else mac_id = (-1); pdel_sta_evt->mac_id = mac_id; @@ -11733,9 +11695,9 @@ bool rtw_port_switch_chk(_adapter *adapter) } #endif /* CONFIG_WOWLAN */ - /* AP should use port0 for ctl frame's ack */ + /* AP/Mesh should use port0 for ctl frame's ack */ if ((if_port1_mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { - RTW_INFO("%s "ADPT_FMT" is AP/GO\n", __func__, ADPT_ARG(if_port1)); + RTW_INFO("%s "ADPT_FMT" is AP/GO/Mesh\n", __func__, ADPT_ARG(if_port1)); switch_needed = _TRUE; goto exit; } @@ -11811,14 +11773,17 @@ void update_sta_info(_adapter *padapter, struct sta_info *psta) psta->htpriv.beamform_cap = pmlmepriv->htpriv.beamform_cap; _rtw_memcpy(&psta->htpriv.ht_cap, &pmlmeinfo->HT_caps, sizeof(struct rtw_ieee80211_ht_cap)); + #ifdef CONFIG_BEAMFORMING + psta->htpriv.beamform_cap = pmlmepriv->htpriv.beamform_cap; + psta->cmn.bf_info.ht_beamform_cap = pmlmepriv->htpriv.beamform_cap; + #endif } else #endif /* CONFIG_80211N_HT */ { #ifdef CONFIG_80211N_HT psta->htpriv.ht_option = _FALSE; - psta->htpriv.ampdu_enable = _FALSE; - + psta->htpriv.tx_amsdu_enable = _FALSE; psta->htpriv.sgi_20m = _FALSE; psta->htpriv.sgi_40m = _FALSE; #endif /* CONFIG_80211N_HT */ @@ -11833,7 +11798,7 @@ void update_sta_info(_adapter *padapter, struct sta_info *psta) psta->htpriv.candidate_tid_bitmap = 0x0;/* reset */ #endif /* CONFIG_80211N_HT */ - psta->bw_mode = pmlmeext->cur_bwmode; + psta->cmn.bw_mode = pmlmeext->cur_bwmode; /* QoS */ if (pmlmepriv->qospriv.qos_option) @@ -11841,8 +11806,15 @@ void update_sta_info(_adapter *padapter, struct sta_info *psta) #ifdef CONFIG_80211AC_VHT _rtw_memcpy(&psta->vhtpriv, &pmlmepriv->vhtpriv, sizeof(struct vht_priv)); + if (psta->vhtpriv.vht_option) { + psta->cmn.ra_info.is_vht_enable = _TRUE; + #ifdef CONFIG_BEAMFORMING + psta->vhtpriv.beamform_cap = pmlmepriv->vhtpriv.beamform_cap; + psta->cmn.bf_info.vht_beamform_cap = pmlmepriv->vhtpriv.beamform_cap; + #endif /*CONFIG_BEAMFORMING*/ + } #endif /* CONFIG_80211AC_VHT */ - + psta->cmn.ra_info.is_support_sgi = query_ra_short_GI(psta, rtw_get_tx_bw_mode(padapter, psta)); update_ldpc_stbc_cap(psta); _enter_critical_bh(&psta->lock, &irqL); @@ -11857,9 +11829,23 @@ static void rtw_mlmeext_disconnect(_adapter *padapter) struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); + u8 self_action = MLME_ACTION_UNKNOWN; u8 state_backup = (pmlmeinfo->state & 0x03); u8 ASIX_ID[] = {0x00, 0x0E, 0xC6}; + if (MLME_IS_AP(padapter)) + self_action = MLME_AP_STOPPED; + else if (MLME_IS_MESH(padapter)) + self_action = MLME_MESH_STOPPED; + else if (MLME_IS_STA(padapter)) + self_action = MLME_STA_DISCONNECTED; + else if (MLME_IS_ADHOC(padapter) || MLME_IS_ADHOC_MASTER(padapter)) + self_action = MLME_ADHOC_STOPPED; + else if (MLME_IS_NULL(padapter)) + self_action = MLME_ACTION_NONE; + else + rtw_warn_on(1); + /* set_opmode_cmd(padapter, infra_client_with_mlme); */ rtw_hal_set_hwreg(padapter, HW_VAR_MLME_DISCONNECT, 0); @@ -11903,10 +11889,7 @@ static void rtw_mlmeext_disconnect(_adapter *padapter) #endif #ifdef CONFIG_DFS_MASTER - if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) - rtw_dfs_master_status_apply(padapter, MLME_AP_STOPPED); - else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) - rtw_dfs_master_status_apply(padapter, MLME_STA_DISCONNECTED); + rtw_dfs_master_status_apply(padapter, self_action); #endif { @@ -11934,6 +11917,17 @@ static void rtw_mlmeext_disconnect(_adapter *padapter) padapter->tdlsinfo.ch_switch_prohibited = _FALSE; #endif /* CONFIG_TDLS */ +#ifdef CONFIG_WMMPS_STA + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { + /* reset currently related uapsd setting when the connection has broken */ + pmlmepriv->qospriv.uapsd_max_sp_len = 0; + pmlmepriv->qospriv.uapsd_tid = 0; + pmlmepriv->qospriv.uapsd_tid_delivery_enabled = 0; + pmlmepriv->qospriv.uapsd_tid_trigger_enabled = 0; + pmlmepriv->qospriv.uapsd_ap_supported = 0; + } +#endif /* CONFIG_WMMPS_STA */ + } void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) @@ -11994,10 +11988,12 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); if (psta) { /* only for infra. mode */ - /* RTW_INFO("set_sta_rate\n"); */ - psta->wireless_mode = pmlmeext->cur_wireless_mode; +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + rtw_hal_set_default_port_id_cmd(padapter, psta->cmn.mac_id); +#endif + /* set per sta rate after updating HT cap. */ set_sta_rate(padapter, psta); @@ -12005,7 +12001,7 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) /* wakeup macid after join bss successfully to ensure the subsequent data frames can be sent out normally */ - rtw_hal_macid_wakeup(padapter, psta->mac_id); + rtw_hal_macid_wakeup(padapter, psta->cmn.mac_id); } #ifndef CONFIG_IOCTL_CFG80211 @@ -12027,7 +12023,9 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) } #ifdef CONFIG_LPS + #ifndef CONFIG_FW_MULTI_PORT_SUPPORT if (get_hw_port(padapter) == HW_PORT0) + #endif rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_CONNECT, 0); #endif @@ -12039,7 +12037,9 @@ void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res) exit_mlmeext_joinbss_event_callback: rtw_join_done_chk_ch(padapter, join_res); - +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_join_done(padapter); +#endif RTW_INFO("=>%s - End to Connection without 4-way\n", __FUNCTION__); } @@ -12076,11 +12076,11 @@ void mlmeext_sta_add_event_callback(_adapter *padapter, struct sta_info *psta) /* update adhoc sta_info */ update_sta_info(padapter, psta); - rtw_hal_update_sta_rate_mask(padapter, psta); + rtw_hal_update_sta_ra_info(padapter, psta); /* ToDo: HT for Ad-hoc */ psta->wireless_mode = rtw_check_network_type(psta->bssrateset, psta->bssratelen, pmlmeext->cur_channel); - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); + rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _TRUE); /* rate radaptive */ Update_RA_Entry(padapter, psta); @@ -12103,51 +12103,17 @@ Following are the functions for the timer handlers *****************************************************************************/ void _linked_info_dump(_adapter *padapter) { - int i; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - HAL_DATA_TYPE *HalData = GET_HAL_DATA(padapter); - int UndecoratedSmoothedPWDB = 0; - if (padapter->bLinkInfoDump) { - - RTW_INFO("\n============["ADPT_FMT"] linked status check ===================\n", ADPT_ARG(padapter)); - - if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE) { - rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); - - RTW_INFO("AP[" MAC_FMT "] - UndecoratedSmoothedPWDB:%d\n", - MAC_ARG(padapter->mlmepriv.cur_network.network.MacAddress), UndecoratedSmoothedPWDB); - } else if ((pmlmeinfo->state & 0x03) == _HW_STATE_AP_) { - _irqL irqL; - _list *phead, *plist; - - struct sta_info *psta = NULL; - struct sta_priv *pstapriv = &padapter->stapriv; - - _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); - phead = &pstapriv->asoc_list; - plist = get_next(phead); - while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { - psta = LIST_CONTAINOR(plist, struct sta_info, asoc_list); - plist = get_next(plist); - - RTW_INFO("STA[" MAC_FMT "]:UndecoratedSmoothedPWDB:%d\n", - MAC_ARG(psta->hwaddr), psta->rssi_stat.UndecoratedSmoothedPWDB); - } - _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); - - } - - /*============ tx info ============ */ rtw_hal_get_def_var(padapter, HW_DEF_RA_INFO_DUMP, RTW_DBGDUMP); - rtw_hal_set_odm_var(padapter, HAL_ODM_RX_INFO_DUMP, RTW_DBGDUMP, _FALSE); - } - - } +/******************************************************************** + +When station does not receive any packet in MAX_CONTINUAL_NORXPACKET_COUNT*2 seconds, +recipient station will teardown the block ack by issuing DELBA frame. + +*********************************************************************/ void rtw_delba_check(_adapter *padapter, struct sta_info *psta, u8 from_timer) { int i = 0; @@ -12170,9 +12136,9 @@ void rtw_delba_check(_adapter *padapter, struct sta_info *psta, u8 from_timer) if (_TRUE == rtw_inc_and_chk_continual_no_rx_packet(psta, i)) { /* send a DELBA frame to the peer STA with the Reason Code field set to TIMEOUT */ if (!from_timer) - ret = issue_del_ba_ex(padapter, psta->hwaddr, i, 39, 0, 3, 1); + ret = issue_del_ba_ex(padapter, psta->cmn.mac_addr, i, 39, 0, 3, 1); else - issue_del_ba(padapter, psta->hwaddr, i, 39, 0); + issue_del_ba(padapter, psta->cmn.mac_addr, i, 39, 0); psta->recvreorder_ctrl[i].enable = _FALSE; if (ret != _FAIL) psta->recvreorder_ctrl[i].ampdu_size = RX_AMPDU_SIZE_INVALID; @@ -12189,7 +12155,6 @@ void rtw_delba_check(_adapter *padapter, struct sta_info *psta, u8 from_timer) u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) { u8 ret = _FALSE; - int i = 0; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -12209,7 +12174,7 @@ u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) ); RTW_INFO(FUNC_ADPT_FMT" tx_pkts:%llu, link_count:%u\n", FUNC_ADPT_ARG(padapter) - , padapter->xmitpriv.tx_pkts + , sta_tx_pkts(psta) , pmlmeinfo->link_count ); #endif @@ -12224,12 +12189,6 @@ u8 chk_ap_is_alive(_adapter *padapter, struct sta_info *psta) sta_update_last_rx_pkts(psta); - /* - record last rx data packets for every tid. - */ - for (i = 0; i < TID_NUM; i++) - psta->sta_stats.last_rx_data_qos_pkts[i] = psta->sta_stats.rx_data_qos_pkts[i]; - return ret; } @@ -12241,8 +12200,8 @@ u8 chk_adhoc_peer_is_alive(struct sta_info *psta) RTW_INFO("sta:"MAC_FMT", rssi:%d, rx:"STA_PKTS_FMT", beacon:%llu, probersp_to_self:%llu" /*", probersp_bm:%llu, probersp_uo:%llu, probereq:%llu, BI:%u"*/ ", expire_to:%u\n" - , MAC_ARG(psta->hwaddr) - , psta->rssi_stat.UndecoratedSmoothedPWDB + , MAC_ARG(psta->cmn.mac_addr) + , psta->cmn.rssi_stat.rssi , STA_RX_PKTS_DIFF_ARG(psta) , psta->sta_stats.rx_beacon_pkts - psta->sta_stats.last_rx_beacon_pkts , psta->sta_stats.rx_probersp_pkts - psta->sta_stats.last_rx_probersp_pkts @@ -12313,11 +12272,11 @@ void linked_status_chk_tdls(_adapter *padapter) if (psta->alive_count >= ALIVE_MIN) { if (chk_tdls_peer_sta_is_alive(padapter, psta) == _FALSE) { if (psta->alive_count < ALIVE_MAX) { - _rtw_memcpy(checkalive[num_checkalive].addr, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(checkalive[num_checkalive].addr, psta->cmn.mac_addr, ETH_ALEN); checkalive[num_checkalive].psta = psta; num_checkalive++; } else { - _rtw_memcpy(teardown[num_teardown].addr, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(teardown[num_teardown].addr, psta->cmn.mac_addr, ETH_ALEN); teardown[num_teardown].psta = psta; num_teardown++; } @@ -12377,6 +12336,8 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) struct recv_priv *precvpriv = &padapter->recvpriv; #endif + if (padapter->registrypriv.mp_mode == _TRUE) + return; if (is_client_associated_to_ap(padapter)) { /* linked infrastructure client mode */ @@ -12385,7 +12346,9 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) int rx_chk_limit; int link_count_limit; -#ifdef CONFIG_LAYER2_ROAMING +#if defined(CONFIG_RTW_REPEATER_SON) + rtw_rson_scan_wk_cmd(padapter, RSON_SCAN_PROCESS); +#elif defined(CONFIG_LAYER2_ROAMING) if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) { RTW_INFO("signal_strength_data.avg_val = %d\n", precvpriv->signal_strength_data.avg_val); if (precvpriv->signal_strength_data.avg_val < pmlmepriv->roam_rssi_threshold) { @@ -12406,7 +12369,7 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) return; #endif -#if defined(DBG_ROAMING_TEST) +#if defined(DBG_ROAMING_TEST) || defined(CONFIG_RTW_REPEATER_SON) rx_chk_limit = 1; #elif defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) rx_chk_limit = 4; @@ -12458,14 +12421,14 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) is_p2p_enable = !rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE); #endif -#ifdef CONFIG_DELBA_CHECK +#ifdef CONFIG_ISSUE_DELBA_WHEN_NO_TRAFFIC /*issue delba when ap does not tx data packet that is Broadcom ap */ rtw_delba_check(padapter, psta, from_timer); #endif if (chk_ap_is_alive(padapter, psta) == _FALSE) rx_chk = _FAIL; - if (pxmitpriv->last_tx_pkts == pxmitpriv->tx_pkts) + if (sta_last_tx_pkts(psta) == sta_tx_pkts(psta)) tx_chk = _FAIL; #if defined(CONFIG_ACTIVE_KEEP_ALIVE_CHECK) && !defined(CONFIG_LPS_LCLK_WD_TIMER) @@ -12476,7 +12439,7 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) && (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) #endif ) { - u8 backup_ch = 0, backup_bw, backup_offset; + u8 backup_ch = 0, backup_bw = 0, backup_offset = 0; u8 union_ch = 0, union_bw, union_offset; if (!rtw_mi_get_ch_setting_union(padapter, &union_ch, &union_bw, &union_offset) @@ -12492,10 +12455,10 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) } if (rx_chk != _SUCCESS) - issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, psta->hwaddr, 0, 0, 3, 1); + issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, psta->cmn.mac_addr, 0, 0, 3, 1); if ((tx_chk != _SUCCESS && pmlmeinfo->link_count++ == link_count_limit) || rx_chk != _SUCCESS) { - tx_chk = issue_nulldata(padapter, psta->hwaddr, 0, 3, 1); + tx_chk = issue_nulldata(padapter, psta->cmn.mac_addr, 0, 3, 1); /* if tx acked and p2p disabled, set rx_chk _SUCCESS to reset retry count */ if (tx_chk == _SUCCESS && !is_p2p_enable) rx_chk = _SUCCESS; @@ -12515,9 +12478,9 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) #ifdef DBG_EXPIRATION_CHK RTW_INFO("issue_probereq to trigger probersp, retry=%d\n", pmlmeext->retry); #endif - issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); - issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); - issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, 0); + issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, (from_timer ? 0 : 1)); + issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, (from_timer ? 0 : 1)); + issue_probereq_ex(padapter, &pmlmeinfo->network.Ssid, pmlmeinfo->network.MacAddress, 0, 0, 0, (from_timer ? 0 : 1)); } } @@ -12526,11 +12489,14 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) /* FW tx nulldata under MCC mode, we just check ap is alive */ && (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) #endif /* CONFIG_MCC_MODE */ - ) { -#ifdef DBG_EXPIRATION_CHK + ) { + #ifdef DBG_EXPIRATION_CHK RTW_INFO("%s issue_nulldata(%d)\n", __FUNCTION__, from_timer ? 1 : 0); -#endif - tx_chk = issue_nulldata_in_interrupt(padapter, NULL, from_timer ? 1 : 0); + #endif + if (from_timer) + tx_chk = issue_nulldata(padapter, NULL, 1, 0, 0); + else + tx_chk = issue_nulldata(padapter, NULL, 0, 1, 1); } } @@ -12549,7 +12515,7 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) if (tx_chk == _FAIL) pmlmeinfo->link_count %= (link_count_limit + 1); else { - pxmitpriv->last_tx_pkts = pxmitpriv->tx_pkts; + psta->sta_stats.last_tx_pkts = psta->sta_stats.tx_pkts; pmlmeinfo->link_count = 0; } @@ -12571,7 +12537,7 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); plist = get_next(plist); - if (is_broadcast_mac_addr(psta->hwaddr)) + if (is_broadcast_mac_addr(psta->cmn.mac_addr)) continue; if (chk_adhoc_peer_is_alive(psta) || !psta->expire_to) @@ -12594,15 +12560,16 @@ void linked_status_chk(_adapter *padapter, u8 from_timer) plist = get_next(plist); rtw_list_delete(&psta->list); RTW_INFO(FUNC_ADPT_FMT" ibss expire "MAC_FMT"\n" - , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->hwaddr)); - report_del_sta_event(padapter, psta->hwaddr, WLAN_REASON_EXPIRATION_CHK, from_timer ? _TRUE : _FALSE, _FALSE); + , FUNC_ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr)); + report_del_sta_event(padapter, psta->cmn.mac_addr, WLAN_REASON_EXPIRATION_CHK, from_timer ? _TRUE : _FALSE, _FALSE); } } } -void survey_timer_hdl(_adapter *padapter) +void survey_timer_hdl(void *ctx) { + _adapter *padapter = (_adapter *)ctx; struct cmd_obj *cmd; struct sitesurvey_parm *psurveyPara; struct cmd_priv *pcmdpriv = &padapter->cmdpriv; @@ -12633,8 +12600,20 @@ void survey_timer_hdl(_adapter *padapter) return; } -void link_timer_hdl(_adapter *padapter) +#ifdef CONFIG_RTW_REPEATER_SON +/* 100ms pass, stop rson_scan */ +void rson_timer_hdl(void *ctx) { + _adapter *padapter = (_adapter *)ctx; + + rtw_rson_scan_wk_cmd(padapter, RSON_SCAN_DISABLE); +} + +#endif + +void link_timer_hdl(void *ctx) +{ + _adapter *padapter = (_adapter *)ctx; /* static unsigned int rx_pkt = 0; */ /* static u64 tx_cnt = 0; */ /* struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); */ @@ -12647,6 +12626,9 @@ void link_timer_hdl(_adapter *padapter) WLAN_BSSID_EX *pnetwork = (WLAN_BSSID_EX *)(&(pmlmeinfo->network)); #endif + if (rtw_sta_linking_test_force_fail()) + RTW_INFO("rtw_sta_linking_test_force_fail\n"); + if (pmlmeinfo->state & WIFI_FW_AUTH_NULL) { RTW_INFO("link_timer_hdl:no beacon while connecting\n"); pmlmeinfo->state = WIFI_FW_NULL_STATE; @@ -12703,8 +12685,10 @@ void link_timer_hdl(_adapter *padapter) return; } -void addba_timer_hdl(struct sta_info *psta) +void addba_timer_hdl(void *ctx) { + struct sta_info *psta = (struct sta_info *)ctx; + #ifdef CONFIG_80211N_HT struct ht_priv *phtpriv; @@ -12766,7 +12750,7 @@ void report_sta_timeout_event(_adapter *padapter, u8 *MacAddr, unsigned short re psta = rtw_get_stainfo(&padapter->stapriv, MacAddr); if (psta) - mac_id = (int)psta->mac_id; + mac_id = (int)psta->cmn.mac_id; else mac_id = (-1); @@ -12782,15 +12766,16 @@ void report_sta_timeout_event(_adapter *padapter, u8 *MacAddr, unsigned short re void clnt_sa_query_timeout(_adapter *padapter) { - rtw_disassoc_cmd(padapter, 0, _TRUE); + rtw_disassoc_cmd(padapter, 0, 0); rtw_indicate_disconnect(padapter, 0, _FALSE); rtw_free_assoc_resources(padapter, 1); RTW_INFO("SA query timeout client disconnect\n"); } -void sa_query_timer_hdl(struct sta_info *psta) +void sa_query_timer_hdl(void *ctx) { + struct sta_info *psta = (struct sta_info *)ctx; _adapter *padapter = psta->padapter; _irqL irqL; struct sta_priv *pstapriv = &padapter->stapriv; @@ -12800,7 +12785,7 @@ void sa_query_timer_hdl(struct sta_info *psta) check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) clnt_sa_query_timeout(padapter); else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) - report_sta_timeout_event(padapter, psta->hwaddr, WLAN_REASON_PREV_AUTH_NOT_VALID); + report_sta_timeout_event(padapter, psta->cmn.mac_addr, WLAN_REASON_PREV_AUTH_NOT_VALID); } #endif /* CONFIG_IEEE80211W */ @@ -12816,8 +12801,9 @@ void start_clnt_ft_action(_adapter *padapter, u8 *pTargetAddr) _set_timer(&pmlmeext->ft_link_timer, REASSOC_TO); } -void ft_link_timer_hdl(_adapter *padapter) +void ft_link_timer_hdl(void *ctx) { + _adapter *padapter = (_adapter *)ctx; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); @@ -12839,8 +12825,9 @@ void ft_link_timer_hdl(_adapter *padapter) } } -void ft_roam_timer_hdl(_adapter *padapter) +void ft_roam_timer_hdl(void *ctx) { + _adapter *padapter = (_adapter *)ctx; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress @@ -12885,7 +12872,7 @@ void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -13010,6 +12997,40 @@ u8 NULL_hdl(_adapter *padapter, u8 *pbuf) } #ifdef CONFIG_AUTO_AP_MODE +void rtw_auto_ap_rx_msg_dump(_adapter *padapter, union recv_frame *precv_frame, u8 *ehdr_pos) +{ + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + struct sta_info *psta = precv_frame->u.hdr.psta; + struct ethhdr *ehdr = (struct ethhdr *)ehdr_pos; + + RTW_INFO("eth rx: got eth_type=0x%x\n", ntohs(ehdr->h_proto)); + + if (psta && psta->isrc && psta->pid > 0) { + u16 rx_pid; + + rx_pid = *(u16 *)(ehdr_pos + ETH_HLEN); + + RTW_INFO("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", + rx_pid, MAC_ARG(psta->cmn.mac_addr), psta->pid); + + if (rx_pid == psta->pid) { + int i; + u16 len = *(u16 *)(ehdr_pos + ETH_HLEN + 2); + /* u16 ctrl_type = *(u16 *)(ehdr_pos + ETH_HLEN + 4); */ + + /* RTW_INFO("eth, RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); */ + RTW_INFO("eth, RC: len=0x%x\n", len); + + for (i = 0; i < len; i++) + RTW_INFO("0x%x\n", *(ehdr_pos + ETH_HLEN + 4 + i)); + /* RTW_INFO("0x%x\n", *(ehdr_pos + ETH_HLEN + 6 + i)); */ + + RTW_INFO("eth, RC-end\n"); + } + } + +} + void rtw_start_auto_ap(_adapter *adapter) { RTW_INFO("%s\n", __FUNCTION__); @@ -13114,9 +13135,6 @@ u8 setopmode_hdl(_adapter *padapter, u8 *pbuf) if (psetop->mode == Ndis802_11APMode) { pmlmeinfo->state = WIFI_FW_AP_STATE; type = _HW_STATE_AP_; -#ifdef CONFIG_NATIVEAP_MLME - /* start_ap_mode(padapter); */ -#endif } else if (psetop->mode == Ndis802_11Infrastructure) { pmlmeinfo->state &= ~(BIT(0) | BIT(1)); /* clear state */ pmlmeinfo->state |= WIFI_FW_STATION_STATE;/* set to STATION_STATE */ @@ -13128,6 +13146,10 @@ u8 setopmode_hdl(_adapter *padapter, u8 *pbuf) else type = _HW_STATE_NOLINK_; +#ifdef CONFIG_AP_PORT_SWAP + rtw_hal_set_hwreg(padapter, HW_VAR_PORT_SWITCH, (u8 *)(&type)); +#endif + rtw_hal_set_hwreg(padapter, HW_VAR_SET_OPMODE, (u8 *)(&type)); #ifdef CONFIG_AUTO_AP_MODE @@ -13194,14 +13216,6 @@ u8 createbss_hdl(_adapter *padapter, u8 *pbuf) pmlmeinfo->agg_enable_bitmap = 0; pmlmeinfo->candidate_tid_bitmap = 0; - /* config the initial gain under linking, need to write the BB registers */ - /* initialgain = 0x1E; */ - /*rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &initialgain, _FALSE);*/ - - /* disable dynamic functions, such as high power, DIG */ - rtw_phydm_ability_backup(padapter); - rtw_phydm_func_disable_all(padapter); - /* cancel link timer */ _cancel_timer_ex(&pmlmeext->link_timer); @@ -13343,10 +13357,7 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) rtw_bss_get_chbw(pnetwork , &pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); -#ifdef CONFIG_80211N_HT - rtw_adjust_chbw(padapter, pmlmeext->cur_channel, &pmlmeext->cur_bwmode, - &pmlmeext->cur_ch_offset); -#endif + rtw_adjust_chbw(padapter, pmlmeext->cur_channel, &pmlmeext->cur_bwmode, &pmlmeext->cur_ch_offset); #if 0 if (padapter->registrypriv.wifi_spec) { @@ -13393,6 +13404,8 @@ u8 join_cmd_hdl(_adapter *padapter, u8 *pbuf) rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, pmlmeinfo->network.MacAddress); join_type = 0; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); + if (MLME_IS_STA(padapter)) + rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTING); doiqk = _TRUE; rtw_hal_set_hwreg(padapter , HW_VAR_DO_IQK , &doiqk); @@ -13446,6 +13459,8 @@ u8 disconnect_hdl(_adapter *padapter, unsigned char *pbuf) rtw_free_uc_swdec_pending_queue(padapter); + rtw_sta_mstatus_report(padapter); + return H2C_SUCCESS; } @@ -13609,6 +13624,44 @@ u8 rtw_scan_sparse(_adapter *adapter, struct rtw_ieee80211_channel *ch, u8 ch_nu return ret_num; } +#define SCANNING_TIMEOUT_EX 2000 +u32 rtw_scan_timeout_decision(_adapter *padapter) +{ + u32 back_op_times= 0; + u8 max_chan_num; + u16 scan_ms; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + struct ss_res *ss = &pmlmeext->sitesurvey_res; + + if (is_supported_5g(padapter->registrypriv.wireless_mode) + && IsSupported24G(padapter->registrypriv.wireless_mode)) + max_chan_num = MAX_CHANNEL_NUM;/* dual band */ + else + max_chan_num = MAX_CHANNEL_NUM_2G;/*single band*/ + + #ifdef CONFIG_SCAN_BACKOP + if (rtw_mi_buddy_check_mlmeinfo_state(padapter, WIFI_FW_AP_STATE)) + back_op_times = (max_chan_num / ss->scan_cnt_max) * ss->backop_ms; + #endif + + if (ss->duration) + scan_ms = ss->duration; + else + #if defined(CONFIG_RTW_ACS) && defined(CONFIG_RTW_ACS_DBG) + if (IS_ACS_ENABLE(padapter) && rtw_is_acs_st_valid(padapter)) + scan_ms = rtw_acs_get_adv_st(padapter); + else + #endif /*CONFIG_RTW_ACS*/ + scan_ms = ss->scan_ch_ms; + + ss->scan_timeout_ms = (scan_ms * max_chan_num) + back_op_times + SCANNING_TIMEOUT_EX; + #ifdef DBG_SITESURVEY + RTW_INFO("%s , scan_timeout_ms = %d (ms)\n", __func__, ss->scan_timeout_ms); + #endif /*DBG_SITESURVEY*/ + return ss->scan_timeout_ms; +} + static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel *out, u32 out_num, struct rtw_ieee80211_channel *in, u32 in_num) { @@ -13616,7 +13669,7 @@ static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel int scan_ch_num = 0; int set_idx; u8 chan; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); /* clear first */ _rtw_memset(out, 0, sizeof(struct rtw_ieee80211_channel) * out_num); @@ -13633,7 +13686,7 @@ static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel if (rtw_mlme_band_check(padapter, in[i].hw_value) == _FALSE) continue; - set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, in[i].hw_value); + set_idx = rtw_chset_search_ch(rfctl->channel_set, in[i].hw_value); if (set_idx >= 0) { if (j >= out_num) { RTW_PRINT(FUNC_ADPT_FMT" out_num:%u not enough\n", @@ -13643,7 +13696,7 @@ static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel _rtw_memcpy(&out[j], &in[i], sizeof(struct rtw_ieee80211_channel)); - if (pmlmeext->channel_set[set_idx].ScanType == SCAN_PASSIVE) + if (rfctl->channel_set[set_idx].ScanType == SCAN_PASSIVE) out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; j++; @@ -13654,8 +13707,8 @@ static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel /* if out is empty, use channel_set as default */ if (j == 0) { - for (i = 0; i < pmlmeext->max_chan_nums; i++) { - chan = pmlmeext->channel_set[i].ChannelNum; + for (i = 0; i < rfctl->max_chan_nums; i++) { + chan = rfctl->channel_set[i].ChannelNum; if (rtw_mlme_band_check(padapter, chan) == _TRUE) { if (rtw_mlme_ignore_chan(padapter, chan) == _TRUE) continue; @@ -13671,7 +13724,7 @@ static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel out[j].hw_value = chan; - if (pmlmeext->channel_set[i].ScanType == SCAN_PASSIVE) + if (rfctl->channel_set[i].ScanType == SCAN_PASSIVE) out[j].flags |= RTW_IEEE80211_CHAN_PASSIVE_SCAN; j++; @@ -13688,10 +13741,14 @@ static int rtw_scan_ch_decision(_adapter *padapter, struct rtw_ieee80211_channel static void sitesurvey_res_reset(_adapter *adapter, struct sitesurvey_parm *parm) { struct ss_res *ss = &adapter->mlmeextpriv.sitesurvey_res; + RT_CHANNEL_INFO *chset = adapter_to_chset(adapter); int i; ss->bss_cnt = 0; ss->channel_idx = 0; +#ifdef CONFIG_DFS + ss->dfs_ch_ssid_scan = 0; +#endif ss->igi_scan = 0; ss->igi_before_scan = 0; #ifdef CONFIG_SCAN_BACKOP @@ -13700,11 +13757,12 @@ static void sitesurvey_res_reset(_adapter *adapter, struct sitesurvey_parm *parm #if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) ss->is_sw_antdiv_bl_scan = 0; #endif - + ss->ssid_num = 0; for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { if (parm->ssid[i].SsidLength) { _rtw_memcpy(ss->ssid[i].Ssid, parm->ssid[i].Ssid, IW_ESSID_MAX_SIZE); ss->ssid[i].SsidLength = parm->ssid[i].SsidLength; + ss->ssid_num++; } else ss->ssid[i].SsidLength = 0; } @@ -13714,7 +13772,17 @@ static void sitesurvey_res_reset(_adapter *adapter, struct sitesurvey_parm *parm , parm->ch, parm->ch_num ); +#ifdef CONFIG_DFS + for (i = 0; i < MAX_CHANNEL_NUM; i++) + chset[i].hidden_bss_cnt = 0; +#endif + + ss->bw = parm->bw; + ss->igi = parm->igi; + ss->token = parm->token; + ss->duration = parm->duration; ss->scan_mode = parm->scan_mode; + ss->token = parm->token; } static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE *type) @@ -13725,7 +13793,8 @@ static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE * struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; struct ss_res *ss = &pmlmeext->sitesurvey_res; - + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + int ch_set_idx; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &padapter->wdinfo; #endif @@ -13745,12 +13814,10 @@ static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE * * Commented by Albert 2011/06/03 * The driver is in the find phase, it should go through the social channel. */ - int ch_set_idx; - scan_ch = pwdinfo->social_chan[ss->channel_idx]; - ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, scan_ch); + ch_set_idx = rtw_chset_search_ch(rfctl->channel_set, scan_ch); if (ch_set_idx >= 0) - scan_type = pmlmeext->channel_set[ch_set_idx].ScanType; + scan_type = rfctl->channel_set[ch_set_idx].ScanType; else scan_type = SCAN_ACTIVE; } else @@ -13758,10 +13825,30 @@ static u8 sitesurvey_pick_ch_behavior(_adapter *padapter, u8 *ch, RT_SCAN_TYPE * { struct rtw_ieee80211_channel *ch; +#ifdef CONFIG_DFS + if (ss->channel_idx != 0 && ss->dfs_ch_ssid_scan == 0 + && pmlmeext->sitesurvey_res.ssid_num + && rtw_is_dfs_ch(ss->ch[ss->channel_idx - 1].hw_value) + ) { + ch_set_idx = rtw_chset_search_ch(rfctl->channel_set, ss->ch[ss->channel_idx - 1].hw_value); + if (ch_set_idx != -1 && rfctl->channel_set[ch_set_idx].hidden_bss_cnt) { + ss->channel_idx--; + ss->dfs_ch_ssid_scan = 1; + } + } else + ss->dfs_ch_ssid_scan = 0; +#endif /* CONFIG_DFS */ + if (ss->channel_idx < ss->ch_num) { ch = &ss->ch[ss->channel_idx]; scan_ch = ch->hw_value; - scan_type = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; + + #if defined(CONFIG_RTW_ACS) && defined(CONFIG_RTW_ACS_DBG) + if (IS_ACS_ENABLE(padapter) && rtw_is_acs_passiv_scan(padapter)) + scan_type = SCAN_PASSIVE; + else + #endif /*CONFIG_RTW_ACS*/ + scan_type = (ch->flags & RTW_IEEE80211_CHAN_PASSIVE_SCAN) ? SCAN_PASSIVE : SCAN_ACTIVE; } } @@ -13852,6 +13939,8 @@ void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct ss_res *ss = &pmlmeext->sitesurvey_res; + u8 ssid_scan = 0; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -13860,19 +13949,11 @@ void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType) if (survey_channel != 0) { set_channel_bwmode(padapter, survey_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - if (ACS_ENABLE == GET_ACS_STATE(padapter)) { - ACS_OP acs_op = ACS_RESET; - - rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); - rtw_set_acs_channel(padapter, survey_channel); -#ifdef DBG_AUTO_CHNL_SEL_NHM - RTW_INFO("[ACS-"ADPT_FMT"]-set ch:%u\n", - ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); +#ifdef CONFIG_DFS + if (ScanType == SCAN_PASSIVE && ss->dfs_ch_ssid_scan) + ssid_scan = 1; + else #endif - } -#endif - if (ScanType == SCAN_ACTIVE) { #ifdef CONFIG_P2P #ifdef CONFIG_IOCTL_CFG80211 @@ -13888,19 +13969,6 @@ void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType) } else #endif /* CONFIG_P2P */ { - int i; - - for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { - if (pmlmeext->sitesurvey_res.ssid[i].SsidLength) { - /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ - if (padapter->registrypriv.wifi_spec) - issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); - else - issue_probereq_ex(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL, 0, 0, 0, 0); - issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); - } - } - if (pmlmeext->sitesurvey_res.scan_mode == SCAN_ACTIVE) { /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ if (padapter->registrypriv.wifi_spec) @@ -13909,6 +13977,23 @@ void site_survey(_adapter *padapter, u8 survey_channel, RT_SCAN_TYPE ScanType) issue_probereq_ex(padapter, NULL, NULL, 0, 0, 0, 0); issue_probereq(padapter, NULL, NULL); } + + ssid_scan = 1; + } + } + + if (ssid_scan) { + int i; + + for (i = 0; i < RTW_SSID_SCAN_AMOUNT; i++) { + if (pmlmeext->sitesurvey_res.ssid[i].SsidLength) { + /* IOT issue, When wifi_spec is not set, send one probe req without WPS IE. */ + if (padapter->registrypriv.wifi_spec) + issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); + else + issue_probereq_ex(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL, 0, 0, 0, 0); + issue_probereq(padapter, &(pmlmeext->sitesurvey_res.ssid[i]), NULL); + } } } } else { @@ -13980,61 +14065,78 @@ void survey_done_set_ch_bw(_adapter *padapter) set_channel_bwmode(padapter, cur_channel, cur_ch_offset, cur_bwmode); } -#if 1 /** - * sitesurvey_ps_annc - check and doing ps announcement for all the adapters of given @dvobj - * @padapter + * rtw_ps_annc - check and doing ps announcement for all the adapters + * @adapter: the requesting adapter * @ps: power saving or not * * Returns: 0: no ps announcement is doing. 1: ps announcement is doing */ - -u8 sitesurvey_ps_annc(_adapter *padapter, bool ps) +u8 rtw_ps_annc(_adapter *adapter, bool ps) { - u8 ps_anc = 0; - - if (rtw_mi_issue_nulldata(padapter, NULL, ps, 3, 500)) - ps_anc = 1; - return ps_anc; -} -#else -/** - * sitesurvey_ps_annc - check and doing ps announcement for all the adapters of given @dvobj - * @dvobj: the dvobj to check - * @ps: power saving or not - * - * Returns: 0: no ps announcement is doing. 1: ps announcement is doing - */ - -u8 sitesurvey_ps_annc(struct dvobj_priv *dvobj, bool ps) -{ - _adapter *adapter; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + _adapter *iface; int i; u8 ps_anc = 0; for (i = 0; i < dvobj->iface_nums; i++) { - adapter = dvobj->padapters[i]; - if (!adapter) + iface = dvobj->padapters[i]; + if (!iface) continue; - if (ps) { - if (is_client_associated_to_ap(adapter) == _TRUE) { + if (MLME_IS_STA(iface)) { + if (is_client_associated_to_ap(iface) == _TRUE) { /* TODO: TDLS peers */ - issue_nulldata(adapter, NULL, 1, 3, 500); - ps_anc = 1; - } - } else { - if (is_client_associated_to_ap(adapter) == _TRUE) { - /* TODO: TDLS peers */ - issue_nulldata(adapter, NULL, 0, 3, 500); + issue_nulldata(iface, NULL, ps, 3, 500); ps_anc = 1; } } } return ps_anc; } + +void rtw_leave_opch(_adapter *adapter) +{ + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) + return; #endif + /* prepare to leave operating channel */ + mlmeext_set_scan_state(pmlmeext, SCAN_LEAVING_OP); + + /* clear HW TX queue */ + rtw_hal_set_hwreg(adapter, HW_VAR_CHECK_TXBUF, 0); + + rtw_hal_macid_sleep_all_used(adapter); + + rtw_ps_annc(adapter, 1); + + mlmeext_set_scan_state(pmlmeext, SCAN_LEAVE_OP); +} + +void rtw_back_opch(_adapter *adapter) +{ + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(adapter) && rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) + return; +#endif + + if (mlmeext_scan_state(pmlmeext) == SCAN_DISABLE) + return; + + mlmeext_set_scan_state(pmlmeext, SCAN_BACKING_OP); + rtw_hal_macid_wakeup_all_used(adapter); + rtw_ps_annc(adapter, 0); + + mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); + rtw_mi_os_xmit_schedule(adapter); +} + void sitesurvey_set_igi(_adapter *adapter) { struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; @@ -14048,7 +14150,7 @@ void sitesurvey_set_igi(_adapter *adapter) case SCAN_ENTER: #ifdef CONFIG_P2P #ifdef CONFIG_IOCTL_CFG80211 - if (adapter_wdev_data(adapter)->p2p_enabled == _TRUE && pwdinfo->driver_interface == DRIVER_CFG80211) + if (pwdinfo->driver_interface == DRIVER_CFG80211 && rtw_cfg80211_is_p2p_scan(adapter)) igi = 0x30; else #endif /* CONFIG_IOCTL_CFG80211 */ @@ -14056,6 +14158,14 @@ void sitesurvey_set_igi(_adapter *adapter) igi = 0x28; else #endif /* CONFIG_P2P */ + if (ss->igi) + igi = ss->igi; + else + #if defined(CONFIG_RTW_ACS) && defined(CONFIG_RTW_ACS_DBG) + if (IS_ACS_ENABLE(adapter) && rtw_is_acs_igi_valid(adapter)) + igi = rtw_acs_get_adv_igi(adapter); + else + #endif /*CONFIG_RTW_ACS*/ igi = 0x1e; /* record IGI status */ @@ -14074,11 +14184,11 @@ void sitesurvey_set_igi(_adapter *adapter) #ifdef CONFIG_SCAN_BACKOP case SCAN_BACKING_OP: /* write IGI for op channel when DIG is not enabled */ - ODM_Write_DIG(GET_ODM(adapter), ss->igi_before_scan); + odm_write_dig(adapter_to_phydm(adapter), ss->igi_before_scan); break; case SCAN_LEAVE_OP: /* write IGI for scan when DIG is not enabled */ - ODM_Write_DIG(GET_ODM(adapter), ss->igi_scan); + odm_write_dig(adapter_to_phydm(adapter), ss->igi_scan); break; #endif /* CONFIG_SCAN_BACKOP */ default: @@ -14165,8 +14275,10 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) /* clear HW TX queue before scan */ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); + rtw_hal_macid_sleep_all_used(padapter); + /* power save state announcement */ - if (sitesurvey_ps_annc(padapter, 1)) { + if (rtw_ps_annc(padapter, 1)) { mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); mlmeext_set_scan_next_state(pmlmeext, SCAN_ENTER); set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ @@ -14203,31 +14315,20 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) u8 next_state; u32 scan_ms; -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - if ((ACS_ENABLE == GET_ACS_STATE(padapter)) && (0 != rtw_get_acs_channel(padapter))) { - ACS_OP acs_op = ACS_SELECT; - - rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); - } +#ifdef CONFIG_RTW_ACS + if (IS_ACS_ENABLE(padapter)) + rtw_acs_get_rst(padapter); #endif next_state = sitesurvey_pick_ch_behavior(padapter, &scan_ch, &scan_type); - if (next_state != SCAN_PROCESS) { -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - if (ACS_ENABLE == GET_ACS_STATE(padapter)) { - rtw_set_acs_channel(padapter, 0); -#ifdef DBG_AUTO_CHNL_SEL_NHM - RTW_INFO("[ACS-"ADPT_FMT"]-set ch:%u\n", ADPT_ARG(padapter), rtw_get_acs_channel(padapter)); -#endif - } -#endif + if (next_state != SCAN_PROCESS) { mlmeext_set_scan_state(pmlmeext, next_state); goto operation_by_state; } /* still SCAN_PROCESS state */ - if (0) + #ifdef DBG_SITESURVEY #ifdef CONFIG_P2P RTW_INFO(FUNC_ADPT_FMT" %s ch:%u (cnt:%u,idx:%d) at %dms, %c%c%c\n" , FUNC_ADPT_ARG(padapter) @@ -14249,7 +14350,7 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) , ss->ssid[0].SsidLength ? 'S' : ' ' ); #endif /* CONFIG_P2P */ - + #endif /*DBG_SITESURVEY*/ #ifdef DBG_FIXED_CHAN if (pmlmeext->fixed_chan != 0xff) RTW_INFO(FUNC_ADPT_FMT" fixed_chan:%u\n", pmlmeext->fixed_chan); @@ -14271,18 +14372,15 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) scan_ms = scan_ms / 2; #endif -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - { - struct noise_info info; - - info.bPauseDIG = _FALSE; - info.IGIValue = 0; - info.max_time = scan_ms / 2; - info.chan = scan_ch; - rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, _FALSE); - } +#ifdef CONFIG_RTW_ACS + if (IS_ACS_ENABLE(padapter)) + rtw_acs_trigger(padapter, scan_ms, scan_ch); #endif +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + if (IS_NM_ENABLE(padapter)) + rtw_noise_measure(padapter, scan_ch, _FALSE, 0, scan_ms / 2); +#endif set_survey_timer(pmlmeext, scan_ms); break; } @@ -14302,14 +14400,14 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) rtw_warn_on(1); } - if (0) + #ifdef DBG_SITESURVEY RTW_INFO(FUNC_ADPT_FMT" %s ch:%u, bw:%u, offset:%u at %dms\n" , FUNC_ADPT_ARG(padapter) , mlmeext_scan_state_str(pmlmeext) , back_ch, back_bw, back_ch_offset , rtw_get_passing_time_ms(padapter->mlmepriv.scan_start_time) ); - + #endif /*DBG_SITESURVEY*/ set_channel_bwmode(padapter, back_ch, back_ch_offset, back_bw); sitesurvey_set_msr(padapter, _FALSE); @@ -14319,7 +14417,8 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC)) { sitesurvey_set_igi(padapter); - sitesurvey_ps_annc(padapter, 0); + rtw_hal_macid_wakeup_all_used(padapter); + rtw_ps_annc(padapter, 0); } mlmeext_set_scan_state(pmlmeext, SCAN_BACK_OP); @@ -14344,15 +14443,16 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) case SCAN_LEAVING_OP: /* - * prepare to leave operating channel - */ + * prepare to leave operating channel + */ /* clear HW TX queue before scan */ rtw_hal_set_hwreg(padapter, HW_VAR_CHECK_TXBUF, 0); + rtw_hal_macid_sleep_all_used(padapter); if (mlmeext_chk_scan_backop_flags(pmlmeext, SS_BACKOP_PS_ANNC) - && sitesurvey_ps_annc(padapter, 1) - ) { + && rtw_ps_annc(padapter, 1) + ) { mlmeext_set_scan_state(pmlmeext, SCAN_PS_ANNC_WAIT); mlmeext_set_scan_next_state(pmlmeext, SCAN_LEAVE_OP); set_survey_timer(pmlmeext, 50); /* delay 50ms to protect nulldata(1) */ @@ -14454,8 +14554,11 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) #ifdef CONFIG_MCC_MODE /* start MCC fail, then tx null data */ if (!rtw_hal_set_mcc_setting_scan_complete(padapter)) -#endif /* CONFIG_MCC_MODE */ - sitesurvey_ps_annc(padapter, 0); +#endif + { + rtw_hal_macid_wakeup_all_used(padapter); + rtw_ps_annc(padapter, 0); + } /* apply rx ampdu setting */ rtw_rx_ampdu_apply(padapter); @@ -14463,10 +14566,25 @@ u8 sitesurvey_cmd_hdl(_adapter *padapter, u8 *pbuf) mlmeext_set_scan_state(pmlmeext, SCAN_DISABLE); report_surveydone_event(padapter); +#ifdef CONFIG_RTW_ACS + if (IS_ACS_ENABLE(padapter)) + rtw_acs_select_best_chan(padapter); +#endif +#if defined(CONFIG_BACKGROUND_NOISE_MONITOR) && defined(DBG_NOISE_MONITOR) + if (IS_NM_ENABLE(padapter)) + rtw_noise_info_dump(RTW_DBGDUMP, padapter); +#endif issue_action_BSSCoexistPacket(padapter); issue_action_BSSCoexistPacket(padapter); issue_action_BSSCoexistPacket(padapter); + +#ifdef CONFIG_RTW_80211K + if (ss->token) + rm_post_event(padapter, ss->token, RM_EV_survey_done); +#endif /* CONFIG_RTW_80211K */ + + break; } return H2C_SUCCESS; @@ -14629,10 +14747,10 @@ void rtw_ap_wep_pk_setting(_adapter *adapter, struct sta_info *psta) sta_pparm.algorithm = psecuritypriv->dot11PrivacyAlgrthm; sta_pparm.keyid = keyid; _rtw_memcpy(sta_pparm.key, &(psecuritypriv->dot11DefKey[keyid].skey[0]), 16); - _rtw_memcpy(sta_pparm.addr, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(sta_pparm.addr, psta->cmn.mac_addr, ETH_ALEN); RTW_PRINT(FUNC_ADPT_FMT"set WEP - PK with "MAC_FMT" keyid:%u\n" - , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->hwaddr), keyid); + , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr), keyid); set_stakey_hdl(adapter, (u8 *)&sta_pparm); } @@ -14725,7 +14843,6 @@ u8 add_ba_hdl(_adapter *padapter, unsigned char *pbuf) /* pmlmeinfo->candidate_tid_bitmap |= (0x1 << pparm->tid); */ /* psta->htpriv.candidate_tid_bitmap |= BIT(pparm->tid); */ issue_addba_req(padapter, pparm->addr, (u8)pparm->tid); - /* _set_timer(&pmlmeext->ADDBA_timer, ADDBA_TO); */ _set_timer(&psta->addba_retry_timer, ADDBA_TO); } #ifdef CONFIG_TDLS @@ -14762,13 +14879,17 @@ u8 add_ba_rsp_hdl(_adapter *padapter, unsigned char *pbuf) /* status = 0 means accept this addba req, so update indicate seq = start_seq under this compile flag */ if (pparm->status == 0) { preorder_ctrl->indicate_seq = pparm->start_seq; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, start_seq: %d\n", __func__, __LINE__, - preorder_ctrl->indicate_seq, pparm->start_seq); -#endif + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_UPDATE indicate_seq:%d, start_seq:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, pparm->start_seq); + #endif } #else preorder_ctrl->indicate_seq = 0xffff; + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_CLEAR indicate_seq:%d, start_seq:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, pparm->start_seq); + #endif #endif /* @@ -15017,16 +15138,34 @@ void change_band_update_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 ch) u8 network_type, rate_len, total_rate_len, remainder_rate_len; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); u8 erpinfo = 0x4; if (ch >= 36) { network_type = WIRELESS_11A; total_rate_len = IEEE80211_NUM_OFDM_RATESLEN; rtw_remove_bcn_ie(padapter, pnetwork, _ERPINFO_IE_); + #ifdef CONFIG_80211AC_VHT + /* if channel in 5G band, then add vht ie . */ + if ((pmlmepriv->htpriv.ht_option == _TRUE) + && REGSTY_IS_11AC_ENABLE(&padapter->registrypriv) + && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) + ) { + if (REGSTY_IS_11AC_AUTO(&padapter->registrypriv)) + rtw_vht_ies_attach(padapter, pnetwork); + /*else*/ + /*TODO vht_enable == 1*/ + } + #endif } else { network_type = WIRELESS_11BG; total_rate_len = IEEE80211_CCK_RATE_LEN + IEEE80211_NUM_OFDM_RATESLEN; rtw_add_bcn_ie(padapter, pnetwork, _ERPINFO_IE_, &erpinfo, 1); + #ifdef CONFIG_80211AC_VHT + rtw_vht_ies_detach(padapter, pnetwork); + #endif } rtw_set_supported_rate(pnetwork->SupportedRates, network_type); @@ -15090,9 +15229,9 @@ void rtw_join_done_chk_ch(_adapter *adapter, int join_res) if (!iface || iface == adapter) continue; - if (check_fwstate(mlme, WIFI_AP_STATE) - && check_fwstate(mlme, WIFI_ASOC_STATE) - ) { + if ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) + && check_fwstate(mlme, WIFI_ASOC_STATE) + ) { bool is_grouped = rtw_is_chbw_grouped(u_ch, u_bw, u_offset , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset); @@ -15102,10 +15241,8 @@ void rtw_join_done_chk_ch(_adapter *adapter, int join_res) /* restore original bw, adjust bw by registry setting on target ch */ mlmeext->cur_bwmode = mlme->ori_bw; mlmeext->cur_channel = u_ch; -#ifdef CONFIG_80211N_HT rtw_adjust_chbw(iface , mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset); -#endif /* CONFIG_80211N_HT */ rtw_sync_chbw(&mlmeext->cur_channel, &mlmeext->cur_bwmode, &mlmeext->cur_ch_offset , &u_ch, &u_bw, &u_offset); @@ -15116,12 +15253,19 @@ void rtw_join_done_chk_ch(_adapter *adapter, int join_res) _rtw_memcpy(&(mlme->cur_network.network), &(mlmeext->mlmext_info.network), sizeof(WLAN_BSSID_EX)); rtw_start_bss_hdl_after_chbw_decided(iface); + + if (MLME_IS_GO(iface) || MLME_IS_MESH(iface)) { /* pure AP is not needed*/ + #if defined(CONFIG_IOCTL_CFG80211) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) + rtw_cfg80211_ch_switch_notify(iface + , mlmeext->cur_channel, mlmeext->cur_bwmode, mlmeext->cur_ch_offset + , mlme->htpriv.ht_option); + #endif + } } - update_beacon(iface, 0, NULL, _TRUE); + clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); + update_beacon(iface, 0xFF, NULL, _TRUE); } - - clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); } #ifdef CONFIG_DFS_MASTER @@ -15136,11 +15280,12 @@ void rtw_join_done_chk_ch(_adapter *adapter, int join_res) if (!iface || iface == adapter) continue; - if (check_fwstate(mlme, WIFI_AP_STATE) - && check_fwstate(mlme, WIFI_ASOC_STATE)) - update_beacon(iface, 0, NULL, _TRUE); - - clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); + if ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) + && check_fwstate(mlme, WIFI_ASOC_STATE) + ) { + clr_fwstate(mlme, WIFI_OP_CH_SWITCHING); + update_beacon(iface, 0xFF, NULL, _TRUE); + } } #ifdef CONFIG_DFS_MASTER rtw_dfs_master_status_apply(adapter, MLME_STA_DISCONNECTED); @@ -15197,10 +15342,11 @@ int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) dvobj = adapter_to_dvobj(adapter); rtw_mi_status_no_self(adapter, &mstate); - RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, ap_num:%u\n" - , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate), MSTATE_AP_NUM(&mstate)); + RTW_INFO(FUNC_ADPT_FMT" ld_sta_num:%u, ap_num:%u, mesh_num:%u\n" + , FUNC_ADPT_ARG(adapter), MSTATE_STA_LD_NUM(&mstate) + , MSTATE_AP_NUM(&mstate), MSTATE_MESH_NUM(&mstate)); - if (!MSTATE_STA_LD_NUM(&mstate) && !MSTATE_AP_NUM(&mstate)) { + if (!MSTATE_STA_LD_NUM(&mstate) && !MSTATE_AP_NUM(&mstate) && !MSTATE_MESH_NUM(&mstate)) { /* consider linking STA? */ goto connect_allow_hdl; } @@ -15252,7 +15398,7 @@ int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) } #endif /* CONFIG_CFG80211_ONECHANNEL_UNDER_CONCURRENT */ - if (MSTATE_STA_LD_NUM(&mstate) + MSTATE_AP_LD_NUM(&mstate) >= 2) + if (MSTATE_STA_LD_NUM(&mstate) + MSTATE_AP_LD_NUM(&mstate) + MSTATE_MESH_LD_NUM(&mstate) >= 2) connect_allow = _FALSE; RTW_INFO(FUNC_ADPT_FMT" connect_allow:%d\n" @@ -15281,22 +15427,23 @@ int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) if (!iface || iface == adapter) continue; - if (check_fwstate(mlme, WIFI_AP_STATE) - && check_fwstate(mlme, WIFI_ASOC_STATE) - ) { -#ifdef CONFIG_SPCT_CH_SWITCH + if ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) + && check_fwstate(mlme, WIFI_ASOC_STATE) + ) { + #ifdef CONFIG_SPCT_CH_SWITCH if (1) rtw_ap_inform_ch_switch(iface, pmlmeext->cur_channel , pmlmeext->cur_ch_offset); else -#endif + #endif rtw_sta_flush(iface, _FALSE); rtw_hal_set_hwreg(iface, HW_VAR_CHECK_TXBUF, 0); set_fwstate(mlme, WIFI_OP_CH_SWITCHING); + } else if (check_fwstate(mlme, WIFI_STATION_STATE) && check_fwstate(mlme, WIFI_ASOC_STATE) - ) { - rtw_disassoc_cmd(iface, 500, _FALSE); + ) { + rtw_disassoc_cmd(iface, 500, RTW_CMDF_DIRECTLY); rtw_indicate_disconnect(iface, 0, _FALSE); rtw_free_assoc_resources(iface, 1); } @@ -15318,7 +15465,7 @@ int rtw_chk_start_clnt_join(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset) } -u8 set_ch_hdl(_adapter *padapter, u8 *pbuf) +u8 rtw_set_chbw_hdl(_adapter *padapter, u8 *pbuf) { struct set_ch_parm *set_ch_parm; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -15345,7 +15492,7 @@ u8 set_ch_hdl(_adapter *padapter, u8 *pbuf) u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf) { struct SetChannelPlan_param *setChannelPlan_param; - struct mlme_priv *mlme = &padapter->mlmepriv; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; if (!pbuf) @@ -15356,11 +15503,14 @@ u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf) if (!rtw_is_channel_plan_valid(setChannelPlan_param->channel_plan)) return H2C_PARAMETERS_ERROR; - mlme->country_ent = setChannelPlan_param->country_ent; - mlme->ChannelPlan = setChannelPlan_param->channel_plan; + rfctl->country_ent = setChannelPlan_param->country_ent; + rfctl->ChannelPlan = setChannelPlan_param->channel_plan; - pmlmeext->max_chan_nums = init_channel_set(padapter, setChannelPlan_param->channel_plan, pmlmeext->channel_set); - init_channel_list(padapter, pmlmeext->channel_set, pmlmeext->max_chan_nums, &pmlmeext->channel_list); + rfctl->max_chan_nums = init_channel_set(padapter, rfctl->ChannelPlan, rfctl->channel_set); + init_channel_list(padapter, rfctl->channel_set, &rfctl->channel_list); +#ifdef CONFIG_TXPWR_LIMIT + rtw_txpwr_init_regd(rfctl); +#endif rtw_hal_set_odm_var(padapter, HAL_ODM_REGULATION, NULL, _TRUE); @@ -15380,7 +15530,7 @@ u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf) ledBlink_param = (struct LedBlink_param *)pbuf; -#ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD +#ifdef CONFIG_RTW_LED_HANDLED_BY_CMD_THREAD BlinkHandler((PLED_DATA)ledBlink_param->pLed); #endif @@ -15409,13 +15559,13 @@ u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf) rtw_hal_set_hwreg(padapter, HW_VAR_TXPAUSE, &gval8); - rtw_disassoc_cmd(padapter, 0, _FALSE); + rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); rtw_indicate_disconnect(padapter, 0, _FALSE); rtw_free_assoc_resources(padapter, 1); rtw_free_network_queue(padapter, _TRUE); - if (((new_ch_no >= 52) && (new_ch_no <= 64)) || ((new_ch_no >= 100) && (new_ch_no <= 140))) - RTW_INFO("Switched to DFS band (ch %02x) again!!\n", new_ch_no); + if (rtw_is_dfs_ch(new_ch_no)) + RTW_INFO("Switched to DFS band (ch %u) again!!\n", new_ch_no); return H2C_SUCCESS; #else @@ -15437,12 +15587,14 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) struct sta_info *ptdls_sta = NULL; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + struct sta_info *ap_sta = rtw_get_stainfo(&padapter->stapriv, get_my_bssid(&(pmlmeinfo->network))); u8 survey_channel, i, min, option; struct tdls_txmgmt txmgmt; u32 setchtime, resp_sleep = 0, wait_time; u8 zaddr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; u8 ret; u8 doiqk; + u64 tx_ra_bitmap = 0; if (!pbuf) return H2C_PARAMETERS_ERROR; @@ -15471,17 +15623,19 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) /* leave ALL PS when TDLS is established */ rtw_pwr_wakeup(padapter); - rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_WRCR, 0); - RTW_INFO("Created Direct Link with "MAC_FMT"\n", MAC_ARG(ptdls_sta->hwaddr)); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_TDLS_LINKED); + RTW_INFO("Created Direct Link with "MAC_FMT"\n", MAC_ARG(ptdls_sta->cmn.mac_addr)); /* Set TDLS sta rate. */ /* Update station supportRate */ - rtw_hal_update_sta_rate_mask(padapter, ptdls_sta); + rtw_hal_update_sta_ra_info(padapter, ptdls_sta); + tx_ra_bitmap = ptdls_sta->cmn.ra_info.ramask; + if (pmlmeext->cur_channel > 14) { - if (ptdls_sta->ra_mask & 0xffff000) + if (tx_ra_bitmap & 0xffff000) sta_band |= WIRELESS_11_5N ; - if (ptdls_sta->ra_mask & 0xff0) + if (tx_ra_bitmap & 0xff0) sta_band |= WIRELESS_11A; /* 5G band */ @@ -15491,21 +15645,22 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) #endif } else { - if (ptdls_sta->ra_mask & 0xffff000) + if (tx_ra_bitmap & 0xffff000) sta_band |= WIRELESS_11_24N; - if (ptdls_sta->ra_mask & 0xff0) + if (tx_ra_bitmap & 0xff0) sta_band |= WIRELESS_11G; - if (ptdls_sta->ra_mask & 0x0f) + if (tx_ra_bitmap & 0x0f) sta_band |= WIRELESS_11B; } ptdls_sta->wireless_mode = sta_band; - ptdls_sta->raid = rtw_hal_networktype_to_raid(padapter, ptdls_sta); - set_sta_rate(padapter, ptdls_sta); - rtw_sta_media_status_rpt(padapter, ptdls_sta, 1); + rtw_hal_update_sta_wset(padapter, ptdls_sta); /* Sta mode */ rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, ptdls_sta, _TRUE); + + set_sta_rate(padapter, ptdls_sta); + rtw_sta_media_status_rpt(padapter, ptdls_sta, 1); break; } case TDLS_ISSUE_PTI: @@ -15517,8 +15672,10 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) case TDLS_CH_SW_RESP: _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); txmgmt.status_code = 0; - _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); + if (ap_sta) + rtw_hal_macid_sleep(padapter, ap_sta->cmn.mac_id); issue_nulldata(padapter, NULL, 1, 3, 3); RTW_INFO("[TDLS ] issue tdls channel switch response\n"); @@ -15527,12 +15684,12 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) /* If we receive TDLS_CH_SW_REQ at off channel which it's target is AP's channel */ /* then we just switch to AP's channel*/ if (padapter->mlmeextpriv.cur_channel == pchsw_info->off_ch_num) { - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_END_TO_BASE_CHNL); break; } if (ret == _SUCCESS) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_OFF_CHNL); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_TO_OFF_CHNL); else RTW_INFO("[TDLS] issue_tdls_ch_switch_rsp wait ack fail !!!!!!!!!!\n"); @@ -15550,7 +15707,7 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) /* switch back to base-chnl */ set_channel_bwmode(padapter, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode); - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_START); pchsw_info->ch_sw_state &= ~(TDLS_CH_SWITCH_PREPARE_STATE); @@ -15559,23 +15716,26 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) rtw_tdls_set_ch_sw_oper_control(padapter, _TRUE); break; case TDLS_CH_SW_TO_OFF_CHNL: + if (ap_sta) + rtw_hal_macid_sleep(padapter, ap_sta->cmn.mac_id); issue_nulldata(padapter, NULL, 1, 3, 3); + if (padapter->registrypriv.wifi_spec == 0) { if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) _set_timer(&ptdls_sta->ch_sw_timer, (u32)(ptdls_sta->ch_switch_timeout) / 1000); + } if (rtw_tdls_do_ch_sw(padapter, ptdls_sta, TDLS_CH_SW_OFF_CHNL, pchsw_info->off_ch_num, pchsw_info->ch_offset, (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20, ptdls_sta->ch_switch_time) == _SUCCESS) { pchsw_info->ch_sw_state &= ~(TDLS_PEER_AT_OFF_STATE); if (pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE) { - if (issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta->hwaddr, 0, 1, 3) == _FAIL) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); + if (issue_nulldata_to_TDLS_peer_STA(ptdls_sta->padapter, ptdls_sta->cmn.mac_addr, 0, 1, + (padapter->registrypriv.wifi_spec == 0) ? 3 : 0) == _FAIL) + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_TO_BASE_CHNL); } } else { - u8 bcancelled; - if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) - _cancel_timer(&ptdls_sta->ch_sw_timer, &bcancelled); + _cancel_timer_ex(&ptdls_sta->ch_sw_timer); } @@ -15592,7 +15752,7 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) #endif if (option == TDLS_CH_SW_END_TO_BASE_CHNL) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_TO_BASE_CHNL); break; case TDLS_CH_SW_TO_BASE_CHNL_UNSOLICITED: @@ -15604,13 +15764,15 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) /* Send unsolicited channel switch rsp. to peer */ _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); txmgmt.status_code = 0; - _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); issue_tdls_ch_switch_rsp(padapter, &txmgmt, _FALSE); } } if (rtw_tdls_do_ch_sw(padapter, ptdls_sta, TDLS_CH_SW_BASE_CHNL, pmlmeext->cur_channel, pmlmeext->cur_ch_offset, pmlmeext->cur_bwmode, ptdls_sta->ch_switch_time) == _SUCCESS) { + if (ap_sta) + rtw_hal_macid_wakeup(padapter, ap_sta->cmn.mac_id); issue_nulldata(padapter, NULL, 0, 3, 3); /* set ch sw monitor timer for responder */ if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) @@ -15620,15 +15782,15 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) break; #endif case TDLS_RS_RCR: - rtw_hal_set_hwreg(padapter, HW_VAR_TDLS_RS_RCR, 0); - RTW_INFO("[TDLS] write REG_RCR, set bit6 on\n"); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_TDLS_NOLINK); break; case TDLS_TEARDOWN_STA: _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); - txmgmt.status_code = 0; - _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); + txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; + _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); issue_tdls_teardown(padapter, &txmgmt, _TRUE); + break; case TDLS_TEARDOWN_STA_LOCALLY: #ifdef CONFIG_TDLS_CH_SW @@ -15642,6 +15804,10 @@ u8 tdls_hdl(_adapter *padapter, unsigned char *pbuf) #endif rtw_sta_media_status_rpt(padapter, ptdls_sta, 0); free_tdls_sta(padapter, ptdls_sta); + + if (ptdlsinfo->tdls_sctx != NULL) + rtw_sctx_done(&(ptdlsinfo->tdls_sctx)); + break; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp.c index 0315428331cf..564be07bdd26 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_MP_C_ #include #ifdef PLATFORM_FREEBSD @@ -342,7 +337,6 @@ s32 init_mp_priv(PADAPTER padapter) pmppriv->antenna_rx = ANTENNA_AB; break; case RF_2T2R: - case RF_2T2R_GREEN: pmppriv->antenna_tx = ANTENNA_AB; pmppriv->antenna_rx = ANTENNA_AB; break; @@ -353,7 +347,7 @@ s32 init_mp_priv(PADAPTER padapter) } pHalData->AntennaRxPath = pmppriv->antenna_rx; - pHalData->AntennaTxPath = pmppriv->antenna_tx; + pHalData->antenna_tx_path = pmppriv->antenna_tx; return _SUCCESS; } @@ -394,135 +388,204 @@ static VOID PHY_SetRFPathSwitch_default( void mpt_InitHWConfig(PADAPTER Adapter) { + PHAL_DATA_TYPE hal; + + hal = GET_HAL_DATA(Adapter); + if (IS_HARDWARE_TYPE_8723B(Adapter)) { /* TODO: <20130114, Kordan> The following setting is only for DPDT and Fixed board type. */ /* TODO: A better solution is configure it according EFUSE during the run-time. */ - PHY_SetMacReg(Adapter, 0x64, BIT20, 0x0); /* 0x66[4]=0 */ - PHY_SetMacReg(Adapter, 0x64, BIT24, 0x0); /* 0x66[8]=0 */ - PHY_SetMacReg(Adapter, 0x40, BIT4, 0x0); /* 0x40[4]=0 */ - PHY_SetMacReg(Adapter, 0x40, BIT3, 0x1); /* 0x40[3]=1 */ - PHY_SetMacReg(Adapter, 0x4C, BIT24, 0x1); /* 0x4C[24:23]=10 */ - PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); /* 0x4C[24:23]=10 */ - PHY_SetBBReg(Adapter, 0x944, BIT1 | BIT0, 0x3); /* 0x944[1:0]=11 */ - PHY_SetBBReg(Adapter, 0x930, bMaskByte0, 0x77); /* 0x930[7:0]=77 */ - PHY_SetMacReg(Adapter, 0x38, BIT11, 0x1); /* 0x38[11]=1 */ + phy_set_mac_reg(Adapter, 0x64, BIT20, 0x0); /* 0x66[4]=0 */ + phy_set_mac_reg(Adapter, 0x64, BIT24, 0x0); /* 0x66[8]=0 */ + phy_set_mac_reg(Adapter, 0x40, BIT4, 0x0); /* 0x40[4]=0 */ + phy_set_mac_reg(Adapter, 0x40, BIT3, 0x1); /* 0x40[3]=1 */ + phy_set_mac_reg(Adapter, 0x4C, BIT24, 0x1); /* 0x4C[24:23]=10 */ + phy_set_mac_reg(Adapter, 0x4C, BIT23, 0x0); /* 0x4C[24:23]=10 */ + phy_set_bb_reg(Adapter, 0x944, BIT1 | BIT0, 0x3); /* 0x944[1:0]=11 */ + phy_set_bb_reg(Adapter, 0x930, bMaskByte0, 0x77);/* 0x930[7:0]=77 */ + phy_set_mac_reg(Adapter, 0x38, BIT11, 0x1);/* 0x38[11]=1 */ /* TODO: <20130206, Kordan> The default setting is wrong, hard-coded here. */ - PHY_SetMacReg(Adapter, 0x778, 0x3, 0x3); /* Turn off hardware PTA control (Asked by Scott) */ - PHY_SetMacReg(Adapter, 0x64, bMaskDWord, 0x36000000); /* Fix BT S0/S1 */ - PHY_SetMacReg(Adapter, 0x948, bMaskDWord, 0x0); /* Fix BT can't Tx */ + phy_set_mac_reg(Adapter, 0x778, 0x3, 0x3); /* Turn off hardware PTA control (Asked by Scott) */ + phy_set_mac_reg(Adapter, 0x64, bMaskDWord, 0x36000000);/* Fix BT S0/S1 */ + phy_set_mac_reg(Adapter, 0x948, bMaskDWord, 0x0); /* Fix BT can't Tx */ /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou) */ - PHY_SetBBReg(Adapter, 0xA00, BIT8, 0x0); /*0xA01[0] = 0*/ + phy_set_bb_reg(Adapter, 0xA00, BIT8, 0x0); /*0xA01[0] = 0*/ } else if (IS_HARDWARE_TYPE_8821(Adapter)) { /* <20131121, VincentL> Add for 8821AU DPDT setting and fix switching antenna issue (Asked by Rock) <20131122, VincentL> Enable for all 8821A/8811AU (Asked by Alex)*/ - PHY_SetMacReg(Adapter, 0x4C, BIT23, 0x0); /*0x4C[23:22]=01*/ - PHY_SetMacReg(Adapter, 0x4C, BIT22, 0x1); /*0x4C[23:22]=01*/ + phy_set_mac_reg(Adapter, 0x4C, BIT23, 0x0); /*0x4C[23:22]=01*/ + phy_set_mac_reg(Adapter, 0x4C, BIT22, 0x1); /*0x4C[23:22]=01*/ } else if (IS_HARDWARE_TYPE_8188ES(Adapter)) - PHY_SetMacReg(Adapter, 0x4C , BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ + phy_set_mac_reg(Adapter, 0x4C , BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ #ifdef CONFIG_RTL8814A else if (IS_HARDWARE_TYPE_8814A(Adapter)) PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8814A, 0x2000); #endif + +#ifdef CONFIG_RTL8812A + else if (IS_HARDWARE_TYPE_8812(Adapter)) { + rtw_write32(Adapter, 0x520, rtw_read32(Adapter, 0x520) | 0x8000); + rtw_write32(Adapter, 0x524, rtw_read32(Adapter, 0x524) & (~0x800)); + } +#endif + + #ifdef CONFIG_RTL8822B - else if (IS_HARDWARE_TYPE_8822B(Adapter)) + else if (IS_HARDWARE_TYPE_8822B(Adapter)) { + u32 tmp_reg = 0; + PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8822B, 0x2000); + /* fixed wifi can't 2.4g tx suggest by Szuyitasi 20160504 */ + phy_set_bb_reg(Adapter, 0x70, bMaskByte3, 0x0e); + RTW_INFO(" 0x73 = 0x%x\n", phy_query_bb_reg(Adapter, 0x70, bMaskByte3)); + phy_set_bb_reg(Adapter, 0x1704, bMaskDWord, 0x0000ff00); + RTW_INFO(" 0x1704 = 0x%x\n", phy_query_bb_reg(Adapter, 0x1704, bMaskDWord)); + phy_set_bb_reg(Adapter, 0x1700, bMaskDWord, 0xc00f0038); + RTW_INFO(" 0x1700 = 0x%x\n", phy_query_bb_reg(Adapter, 0x1700, bMaskDWord)); + } #endif /* CONFIG_RTL8822B */ #ifdef CONFIG_RTL8821C else if (IS_HARDWARE_TYPE_8821C(Adapter)) PlatformEFIOWrite2Byte(Adapter, REG_RXFLTMAP1_8821C, 0x2000); #endif /* CONFIG_RTL8821C */ -} - -#ifdef CONFIG_RTL8188E - #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8188E(a, b) - #define PHY_LCCalibrate(a) PHY_LCCalibrate_8188E(&(GET_HAL_DATA(a)->odmpriv)) - #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8188E(a, b) -#endif - -#ifdef CONFIG_RTL8814A - #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv), b) - #define PHY_LCCalibrate(a) PHY_LCCalibrate_8814A(&(GET_HAL_DATA(a)->odmpriv)) - #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8814A(a, b) -#endif /* CONFIG_RTL8814A */ - -#ifdef CONFIG_RTL8812A - #define PHY_IQCalibrate(_Adapter, b) PHY_IQCalibrate_8812A(_Adapter, b) - #define PHY_LCCalibrate(_Adapter) PHY_LCCalibrate_8812A(&(GET_HAL_DATA(_Adapter)->odmpriv)) - #define PHY_SetRFPathSwitch(_Adapter, b) PHY_SetRFPathSwitch_8812A(_Adapter, b) -#endif - -#ifdef CONFIG_RTL8821A - #define PHY_IQCalibrate(_Adapter, b) PHY_IQCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv), b) - #define PHY_LCCalibrate(_Adapter) PHY_LCCalibrate_8821A(&(GET_HAL_DATA(_Adapter)->odmpriv)) - #define PHY_SetRFPathSwitch(_Adapter, b) PHY_SetRFPathSwitch_8812A(_Adapter, b) -#endif - -#ifdef CONFIG_RTL8192E - #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8192E(a, b) - #define PHY_LCCalibrate(a) PHY_LCCalibrate_8192E(&(GET_HAL_DATA(a)->odmpriv)) - #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8192E(a, b) -#endif /* CONFIG_RTL8812A_8821A */ - -#ifdef CONFIG_RTL8723B -static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -{ - PHAL_DATA_TYPE pHalData; - u8 b2ant; /* false:1ant, true:2-ant */ - u8 RF_Path; /* 0:S1, 1:S0 */ - - pHalData = GET_HAL_DATA(padapter); - b2ant = pHalData->EEPROMBluetoothAntNum == Ant_x2 ? _TRUE : _FALSE; - - PHY_IQCalibrate_8723B(padapter, bReCovery, _FALSE, b2ant, pHalData->ant_path); -} - - -#define PHY_LCCalibrate(a) PHY_LCCalibrate_8723B(&(GET_HAL_DATA(a)->odmpriv)) -#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8723B(a, b) -#endif - -#ifdef CONFIG_RTL8703B -static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -{ - PHY_IQCalibrate_8703B(padapter, bReCovery); -} - - -#define PHY_LCCalibrate(a) PHY_LCCalibrate_8703B(&(GET_HAL_DATA(a)->odmpriv)) -#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8703B(a, b) -#endif - #ifdef CONFIG_RTL8188F -static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) -{ - PHY_IQCalibrate_8188F(padapter, bReCovery, _FALSE); + else if (IS_HARDWARE_TYPE_8188F(Adapter)) { + if (IS_A_CUT(hal->version_id) || IS_B_CUT(hal->version_id)) { + RTW_INFO("%s() Active large power detection\n", __func__); + phy_active_large_power_detection_8188f(&(GET_HAL_DATA(Adapter)->odmpriv)); + } + } +#endif } +static void PHY_IQCalibrate(PADAPTER padapter, u8 bReCovery) +{ + halrf_iqk_trigger(&(GET_HAL_DATA(padapter)->odmpriv), bReCovery); +} -#define PHY_LCCalibrate(a) PHY_LCCalibrate_8188F(&(GET_HAL_DATA(a)->odmpriv)) -#define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8188F(a, b) +static void PHY_LCCalibrate(PADAPTER padapter) +{ + halrf_lck_trigger(&(GET_HAL_DATA(padapter)->odmpriv)); +} + +static u8 PHY_QueryRFPathSwitch(PADAPTER padapter) +{ + u8 bmain = 0; +/* + if (IS_HARDWARE_TYPE_8723B(padapter)) { +#ifdef CONFIG_RTL8723B + bmain = PHY_QueryRFPathSwitch_8723B(padapter); #endif - + } else if (IS_HARDWARE_TYPE_8188E(padapter)) { +#ifdef CONFIG_RTL8188E + bmain = PHY_QueryRFPathSwitch_8188E(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8814A(padapter)) { +#ifdef CONFIG_RTL8814A + bmain = PHY_QueryRFPathSwitch_8814A(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8812(padapter) || IS_HARDWARE_TYPE_8821(padapter)) { +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) + bmain = PHY_QueryRFPathSwitch_8812A(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8192E(padapter)) { +#ifdef CONFIG_RTL8192E + bmain = PHY_QueryRFPathSwitch_8192E(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8703B(padapter)) { +#ifdef CONFIG_RTL8703B + bmain = PHY_QueryRFPathSwitch_8703B(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8188F(padapter)) { +#ifdef CONFIG_RTL8188F + bmain = PHY_QueryRFPathSwitch_8188F(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8822B(padapter)) { #ifdef CONFIG_RTL8822B - #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8822B(a, b) - #define PHY_LCCalibrate(a) - #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8822B(a, b) -#endif /* CONFIG_RTL8822B */ - + bmain = PHY_QueryRFPathSwitch_8822B(padapter); +#endif + } else if (IS_HARDWARE_TYPE_8723D(padapter)) { #ifdef CONFIG_RTL8723D - #define PHY_IQCalibrate(a, b) PHY_IQCalibrate_8723D(a, b) - #define PHY_LCCalibrate(a) PHY_LCCalibrate_8723D(&(GET_HAL_DATA(a)->odmpriv)) - #define PHY_SetRFPathSwitch(a, b) PHY_SetRFPathSwitch_8723D(a, b) + bmain = PHY_QueryRFPathSwitch_8723D(padapter); +#endif + } else +*/ + + if (IS_HARDWARE_TYPE_8821C(padapter)) { +#ifdef CONFIG_RTL8821C + bmain = phy_query_rf_path_switch_8821c(padapter); +#endif + } + + return bmain; +} + +static void PHY_SetRFPathSwitch(PADAPTER padapter , BOOLEAN bMain) { + + if (IS_HARDWARE_TYPE_8723B(padapter)) { +#ifdef CONFIG_RTL8723B + phy_set_rf_path_switch_8723b(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8188E(padapter)) { +#ifdef CONFIG_RTL8188E + phy_set_rf_path_switch_8188e(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8814A(padapter)) { +#ifdef CONFIG_RTL8814A + phy_set_rf_path_switch_8814a(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8812(padapter) || IS_HARDWARE_TYPE_8821(padapter)) { +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) + phy_set_rf_path_switch_8812a(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8192E(padapter)) { +#ifdef CONFIG_RTL8192E + phy_set_rf_path_switch_8192e(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8703B(padapter)) { +#ifdef CONFIG_RTL8703B + phy_set_rf_path_switch_8703b(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8188F(padapter)) { +#ifdef CONFIG_RTL8188F + phy_set_rf_path_switch_8188f(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8822B(padapter)) { +#ifdef CONFIG_RTL8822B + phy_set_rf_path_switch_8822b(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8723D(padapter)) { +#ifdef CONFIG_RTL8723D + phy_set_rf_path_switch_8723d(padapter, bMain); +#endif + } else if (IS_HARDWARE_TYPE_8821C(padapter)) { +#ifdef CONFIG_RTL8821C + phy_set_rf_path_switch_8821c(padapter, bMain); +#endif + } +} + +#ifdef CONFIG_ANTENNA_DIVERSITY +u8 rtw_mp_set_antdiv(PADAPTER padapter, BOOLEAN bMain) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + u8 cur_ant, change_ant; + + if (!pHalData->AntDivCfg) + return _FALSE; + /*rtw_hal_get_odm_var(padapter, HAL_ODM_ANTDIV_SELECT, &cur_ant, NULL);*/ + change_ant = (bMain == MAIN_ANT) ? MAIN_ANT : AUX_ANT; + + RTW_INFO("%s: config %s\n", __func__, (bMain == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"); + rtw_antenna_select_cmd(padapter, change_ant, _FALSE); + + return _TRUE; +} #endif -#ifdef CONFIG_RTL8821C - #define PHY_IQCalibrate(a, b) - #define PHY_LCCalibrate(a) - #define PHY_SetRFPathSwitch(a, b) -#endif /* CONFIG_RTL8821C */ s32 MPT_InitializeAdapter( IN PADAPTER pAdapter, @@ -531,7 +594,7 @@ MPT_InitializeAdapter( { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); s32 rtStatus = _SUCCESS; - PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; + PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; u32 ledsetting; struct mlme_priv *pmlmepriv = &pAdapter->mlmepriv; @@ -545,7 +608,7 @@ MPT_InitializeAdapter( pMptCtx->MptH2cRspEvent = _FALSE; pMptCtx->MptBtC2hEvent = _FALSE; _rtw_init_sema(&pMptCtx->MPh2c_Sema, 0); - _init_timer(&pMptCtx->MPh2c_timeout_timer, pAdapter->pnetdev, MPh2c_timeout_handle, pAdapter); + rtw_init_timer(&pMptCtx->MPh2c_timeout_timer, pAdapter, MPh2c_timeout_handle, pAdapter); #endif mpt_InitHWConfig(pAdapter); @@ -555,13 +618,13 @@ MPT_InitializeAdapter( if (IS_HARDWARE_TYPE_8723B(pAdapter)) { /* <20130522, Kordan> Turn off equalizer to improve Rx sensitivity. (Asked by EEChou)*/ - PHY_SetBBReg(pAdapter, 0xA00, BIT8, 0x0); + phy_set_bb_reg(pAdapter, 0xA00, BIT8, 0x0); PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /*default use Main*/ /*<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten. */ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); else - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); } /*set ant to wifi side in mp mode*/ rtw_write16(pAdapter, 0x870, 0x300); @@ -570,7 +633,7 @@ MPT_InitializeAdapter( pMptCtx->bMptWorkItemInProgress = _FALSE; pMptCtx->CurrMptAct = NULL; - pMptCtx->MptRfPath = ODM_RF_PATH_A; + pMptCtx->mpt_rf_path = RF_PATH_A; /* ------------------------------------------------------------------------- */ /* Don't accept any packets */ rtw_write32(pAdapter, REG_RCR, 0); @@ -584,25 +647,25 @@ MPT_InitializeAdapter( PHY_LCCalibrate(pAdapter); PHY_IQCalibrate(pAdapter, _FALSE); - /* dm_CheckTXPowerTracking(&pHalData->odmpriv); */ /* trigger thermal meter */ + /* dm_check_txpowertracking(&pHalData->odmpriv); */ /* trigger thermal meter */ PHY_SetRFPathSwitch(pAdapter, 1/*pHalData->bDefaultAntenna*/); /* default use Main */ - pMptCtx->backup0xc50 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); - pMptCtx->backup0xc58 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); - pMptCtx->backup0xc30 = (u1Byte)PHY_QueryBBReg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); - pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); - pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); + pMptCtx->backup0xc50 = (u1Byte)phy_query_bb_reg(pAdapter, rOFDM0_XAAGCCore1, bMaskByte0); + pMptCtx->backup0xc58 = (u1Byte)phy_query_bb_reg(pAdapter, rOFDM0_XBAGCCore1, bMaskByte0); + pMptCtx->backup0xc30 = (u1Byte)phy_query_bb_reg(pAdapter, rOFDM0_RxDetector1, bMaskByte0); + pMptCtx->backup0x52_RF_A = (u1Byte)phy_query_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); + pMptCtx->backup0x52_RF_B = (u1Byte)phy_query_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); #ifdef CONFIG_RTL8188E rtw_write32(pAdapter, REG_MACID_NO_LINK_0, 0x0); rtw_write32(pAdapter, REG_MACID_NO_LINK_1, 0x0); #endif #ifdef CONFIG_RTL8814A if (IS_HARDWARE_TYPE_8814A(pAdapter)) { - pHalData->BackUp_IG_REG_4_Chnl_Section[0] = (u1Byte)PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); - pHalData->BackUp_IG_REG_4_Chnl_Section[1] = (u1Byte)PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); - pHalData->BackUp_IG_REG_4_Chnl_Section[2] = (u1Byte)PHY_QueryBBReg(pAdapter, rC_IGI_Jaguar2, bMaskByte0); - pHalData->BackUp_IG_REG_4_Chnl_Section[3] = (u1Byte)PHY_QueryBBReg(pAdapter, rD_IGI_Jaguar2, bMaskByte0); + pHalData->BackUp_IG_REG_4_Chnl_Section[0] = (u1Byte)phy_query_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0); + pHalData->BackUp_IG_REG_4_Chnl_Section[1] = (u1Byte)phy_query_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0); + pHalData->BackUp_IG_REG_4_Chnl_Section[2] = (u1Byte)phy_query_bb_reg(pAdapter, rC_IGI_Jaguar2, bMaskByte0); + pHalData->BackUp_IG_REG_4_Chnl_Section[3] = (u1Byte)phy_query_bb_reg(pAdapter, rD_IGI_Jaguar2, bMaskByte0); } #endif return rtStatus; @@ -630,7 +693,7 @@ MPT_DeInitAdapter( IN PADAPTER pAdapter ) { - PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; + PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; pMptCtx->bMptDrvUnload = _TRUE; #if defined(CONFIG_RTL8723B) @@ -638,7 +701,7 @@ MPT_DeInitAdapter( _cancel_timer_ex(&pMptCtx->MPh2c_timeout_timer); #endif #if defined(CONFIG_RTL8723B) - PHY_SetBBReg(pAdapter, 0xA01, BIT0, 1); /* /suggestion by jerry for MP Rx. */ + phy_set_bb_reg(pAdapter, 0xA01, BIT0, 1); /* /suggestion by jerry for MP Rx. */ #endif #if 0 /* for Windows */ PlatformFreeWorkItem(&(pMptCtx->MptWorkItem)); @@ -653,15 +716,15 @@ MPT_DeInitAdapter( static u8 mpt_ProStartTest(PADAPTER padapter) { - PMPT_CONTEXT pMptCtx = &padapter->mppriv.MptCtx; + PMPT_CONTEXT pMptCtx = &padapter->mppriv.mpt_ctx; pMptCtx->bMassProdTest = _TRUE; - pMptCtx->bStartContTx = _FALSE; + pMptCtx->is_start_cont_tx = _FALSE; pMptCtx->bCckContTx = _FALSE; pMptCtx->bOfdmContTx = _FALSE; pMptCtx->bSingleCarrier = _FALSE; - pMptCtx->bCarrierSuppression = _FALSE; - pMptCtx->bSingleTone = _FALSE; + pMptCtx->is_carrier_suppression = _FALSE; + pMptCtx->is_single_tone = _FALSE; pMptCtx->HWTxmode = PACKETS_TX; return _SUCCESS; @@ -692,63 +755,56 @@ void rtw_mp_trigger_lck(PADAPTER padapter) PHY_LCCalibrate(padapter); } -static void disable_dm(PADAPTER padapter) +static void init_mp_data(PADAPTER padapter) { u8 v8; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - /* 3 1. disable firmware dynamic mechanism */ - /* disable Power Training, Rate Adaptive */ + /*disable BCN*/ v8 = rtw_read8(padapter, REG_BCN_CTRL); v8 &= ~EN_BCN_FUNCTION; rtw_write8(padapter, REG_BCN_CTRL, v8); - /* 3 2. disable driver dynamic mechanism */ - rtw_phydm_func_disable_all(padapter); - - /* enable APK, LCK and IQK but disable power tracking */ - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; - rtw_phydm_func_set(padapter, ODM_RF_CALIBRATION); - - /* #ifdef CONFIG_BT_COEXIST */ - /* rtw_btcoex_Switch(padapter, 0); */ /* remove for BT MP Down. */ - /* #endif */ + pDM_Odm->rf_calibrate_info.txpowertrack_control = _FALSE; } - void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + u32 rf_ability; if (bstart == 1) { RTW_INFO("in MPT_PwrCtlDM start\n"); - rtw_phydm_func_set(padapter, ODM_RF_TX_PWR_TRACK | ODM_RF_CALIBRATION); - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; + rf_ability = ((u32)halrf_cmn_info_get(pDM_Odm, HALRF_CMNINFO_ABILITY)) | HAL_RF_TX_PWR_TRACK; + halrf_cmn_info_set(pDM_Odm, HALRF_CMNINFO_ABILITY, rf_ability); + + pDM_Odm->rf_calibrate_info.txpowertrack_control = _TRUE; padapter->mppriv.mp_dm = 1; } else { RTW_INFO("in MPT_PwrCtlDM stop\n"); - disable_dm(padapter); - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; + rf_ability = ((u32)halrf_cmn_info_get(pDM_Odm, HALRF_CMNINFO_ABILITY)) & ~HAL_RF_TX_PWR_TRACK; + halrf_cmn_info_set(pDM_Odm, HALRF_CMNINFO_ABILITY, rf_ability); + pDM_Odm->rf_calibrate_info.txpowertrack_control = _FALSE; padapter->mppriv.mp_dm = 0; { - TXPWRTRACK_CFG c; + struct _TXPWRTRACK_CFG c; u1Byte chnl = 0 ; - _rtw_memset(&c, 0, sizeof(TXPWRTRACK_CFG)); - ConfigureTxpowerTrack(pDM_Odm, &c); - ODM_ClearTxPowerTrackingState(pDM_Odm); - if (*c.ODM_TxPwrTrackSetPwr) { - if (pDM_Odm->SupportICType == ODM_RTL8188F) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, chnl); - else if (pDM_Odm->SupportICType == ODM_RTL8723D) { - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); + _rtw_memset(&c, 0, sizeof(struct _TXPWRTRACK_CFG)); + configure_txpower_track(pDM_Odm, &c); + odm_clear_txpowertracking_state(pDM_Odm); + if (*c.odm_tx_pwr_track_set_pwr) { + if (pDM_Odm->support_ic_type == ODM_RTL8188F) + (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, MIX_MODE, RF_PATH_A, chnl); + else if (pDM_Odm->support_ic_type == ODM_RTL8723D) { + (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, RF_PATH_A, chnl); SetTxPower(padapter); } else { - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_A, chnl); - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, ODM_RF_PATH_B, chnl); + (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, RF_PATH_A, chnl); + (*c.odm_tx_pwr_track_set_pwr)(pDM_Odm, BBSWING, RF_PATH_B, chnl); } } } @@ -812,7 +868,7 @@ u32 mp_join(PADAPTER padapter, u8 mode) /* init mp_start_test status */ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { - rtw_disassoc_cmd(padapter, 500, _TRUE); + rtw_disassoc_cmd(padapter, 500, 0); rtw_indicate_disconnect(padapter, 0, _FALSE); rtw_free_assoc_resources(padapter, 1); } @@ -841,7 +897,7 @@ u32 mp_join(PADAPTER padapter, u8 mode) set_fwstate(pmlmepriv, WIFI_STATION_STATE); /* 3 3. join psudo AdHoc */ tgt_network->join_res = 1; - tgt_network->aid = psta->aid = 1; + tgt_network->aid = psta->cmn.aid = 1; _rtw_memcpy(&padapter->registrypriv.dev_network, &bssid, length); rtw_update_registrypriv_dev_network(padapter); @@ -866,6 +922,7 @@ u32 mp_join(PADAPTER padapter, u8 mode) rtw_hal_set_hwreg(padapter, HW_VAR_BSSID, padapter->registrypriv.dev_network.MacAddress); join_type = 0; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ADHOC_STARTED); report_join_res(padapter, 1); pmlmeinfo->state |= WIFI_FW_ASSOC_SUCCESS; @@ -890,17 +947,10 @@ s32 mp_start_test(PADAPTER padapter) padapter->registrypriv.mp_mode = 1; - /* 3 disable dynamic mechanism */ - disable_dm(padapter); + init_mp_data(padapter); #ifdef CONFIG_RTL8814A rtl8814_InitHalDm(padapter); #endif /* CONFIG_RTL8814A */ -#ifdef CONFIG_RTL8822B - rtl8822b_phy_init_haldm(padapter); -#endif /* CONFIG_RTL8822B */ -#ifdef CONFIG_RTL8821C - rtl8821c_phy_init_haldm(padapter); -#endif /* CONFIG_RTL8821C */ #ifdef CONFIG_RTL8812A rtl8812_InitHalDm(padapter); #endif /* CONFIG_RTL8812A */ @@ -925,7 +975,7 @@ s32 mp_start_test(PADAPTER padapter) /* 3 0. update mp_priv */ - if (padapter->registrypriv.rf_config == RF_MAX_TYPE) { + if (!RF_TYPE_VALID(padapter->registrypriv.rf_config)) { /* switch (phal->rf_type) { */ switch (GET_RF_TYPE(padapter)) { case RF_1T1R: @@ -938,7 +988,6 @@ s32 mp_start_test(PADAPTER padapter) pmppriv->antenna_rx = ANTENNA_AB; break; case RF_2T2R: - case RF_2T2R_GREEN: pmppriv->antenna_tx = ANTENNA_AB; pmppriv->antenna_rx = ANTENNA_AB; break; @@ -1146,6 +1195,10 @@ void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain) } +u8 MP_PHY_QueryRFPathSwitch(PADAPTER pAdapter) +{ + return PHY_QueryRFPathSwitch(pAdapter); +} s32 SetThermalMeter(PADAPTER pAdapter, u8 target_ther) { @@ -1185,18 +1238,6 @@ void SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) hal_mpt_SetCarrierSuppressionTx(pAdapter, bStart); } -void SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) -{ - PhySetTxPowerLevel(pAdapter); - hal_mpt_SetCCKContinuousTx(pAdapter, bStart); -} - -void SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) -{ - PhySetTxPowerLevel(pAdapter); - hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); -} /* mpt_StartOfdmContTx */ - void SetContinuousTx(PADAPTER pAdapter, u8 bStart) { PhySetTxPowerLevel(pAdapter); @@ -1246,6 +1287,48 @@ static struct xmit_frame *alloc_mp_xmitframe(struct xmit_priv *pxmitpriv) } +#ifdef CONFIG_PCIE_HCI +static u8 check_nic_enough_desc(_adapter *padapter, struct pkt_attrib *pattrib) +{ + u32 prio; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct rtw_tx_ring *ring; + + switch (pattrib->qsel) { + case 0: + case 3: + prio = BE_QUEUE_INX; + break; + case 1: + case 2: + prio = BK_QUEUE_INX; + break; + case 4: + case 5: + prio = VI_QUEUE_INX; + break; + case 6: + case 7: + prio = VO_QUEUE_INX; + break; + default: + prio = BE_QUEUE_INX; + break; + } + + ring = &pxmitpriv->tx_ring[prio]; + + /* + * for now we reserve two free descriptor as a safety boundary + * between the tail and the head + */ + if ((ring->entries - ring->qlen) >= 2) + return _TRUE; + else + return _FALSE; +} +#endif + static thread_return mp_xmit_packet_thread(thread_context context) { struct xmit_frame *pxmitframe; @@ -1264,6 +1347,12 @@ static thread_return mp_xmit_packet_thread(thread_context context) RTW_INFO("%s:pkTx Start\n", __func__); while (1) { pxmitframe = alloc_mp_xmitframe(pxmitpriv); +#ifdef CONFIG_PCIE_HCI + if(check_nic_enough_desc(padapter, &pmptx->attrib) == _FALSE) { + rtw_usleep_os(1000); + continue; + } +#endif if (pxmitframe == NULL) { if (pmptx->stop || RTW_CANNOT_RUN(padapter)) @@ -1299,7 +1388,8 @@ static thread_return mp_xmit_packet_thread(thread_context context) pmptx->pallocated_buf = NULL; pmptx->stop = 1; - thread_exit(); + thread_exit(NULL); + return 0; } void fill_txdesc_for_mp(PADAPTER padapter, u8 *ptxdesc) @@ -1662,13 +1752,13 @@ static void Rtw_MPSetMacTxEDCA(PADAPTER padapter) rtw_write32(padapter, 0x508 , 0x00a422); /* Disable EDCA BE Txop for MP pkt tx adjust Packet interval */ /* RTW_INFO("%s:write 0x508~~~~~~ 0x%x\n", __func__,rtw_read32(padapter, 0x508)); */ - PHY_SetMacReg(padapter, 0x458 , bMaskDWord , 0x0); - /* RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" ,__func__,PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); */ - PHY_SetMacReg(padapter, 0x460 , bMaskLWord , 0x0); /* fast EDCA queue packet interval & time out vaule */ - /* PHY_SetMacReg(padapter, ODM_EDCA_VO_PARAM ,bMaskLWord , 0x431C); */ - /* PHY_SetMacReg(padapter, ODM_EDCA_BE_PARAM ,bMaskLWord , 0x431C); */ - /* PHY_SetMacReg(padapter, ODM_EDCA_BK_PARAM ,bMaskLWord , 0x431C); */ - RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" , __func__, PHY_QueryBBReg(padapter, 0x460, bMaskDWord)); + phy_set_mac_reg(padapter, 0x458 , bMaskDWord , 0x0); + /*RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" ,__func__, phy_query_bb_reg(padapter, 0x460, bMaskDWord));*/ + phy_set_mac_reg(padapter, 0x460 , bMaskLWord , 0x0); /* fast EDCA queue packet interval & time out value*/ + /*phy_set_mac_reg(padapter, ODM_EDCA_VO_PARAM ,bMaskLWord , 0x431C);*/ + /*phy_set_mac_reg(padapter, ODM_EDCA_BE_PARAM ,bMaskLWord , 0x431C);*/ + /*phy_set_mac_reg(padapter, ODM_EDCA_BK_PARAM ,bMaskLWord , 0x431C);*/ + RTW_INFO("%s()!!!!! 0x460 = 0x%x\n" , __func__, phy_query_bb_reg(padapter, 0x460, bMaskDWord)); } @@ -1696,13 +1786,12 @@ void SetPacketTx(PADAPTER padapter) _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); bmcast = IS_MCAST(pattrib->ra); - if (bmcast) { - pattrib->mac_id = 1; + if (bmcast) pattrib->psta = rtw_get_bcmc_stainfo(padapter); - } else { - pattrib->mac_id = 0; + else pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); - } + + pattrib->mac_id = pattrib->psta->cmn.mac_id; pattrib->mbssid = 0; pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; @@ -1777,7 +1866,7 @@ void SetPacketTx(PADAPTER padapter) /* 3 4. make wlan header, make_wlanhdr() */ hdr = (struct rtw_ieee80211_hdr *)pkt_start; - SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); + set_frame_sub_type(&hdr->frame_ctl, pattrib->subtype); _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); /* DA */ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); /* SA */ @@ -1821,8 +1910,10 @@ void SetPacketTx(PADAPTER padapter) /* 3 6. start thread */ #ifdef PLATFORM_LINUX pmp_priv->tx.PktTxThread = kthread_run(mp_xmit_packet_thread, pmp_priv, "RTW_MP_THREAD"); - if (IS_ERR(pmp_priv->tx.PktTxThread)) - RTW_INFO("Create PktTx Thread Fail !!!!!\n"); + if (IS_ERR(pmp_priv->tx.PktTxThread)) { + RTW_ERR("Create PktTx Thread Fail !!!!!\n"); + pmp_priv->tx.PktTxThread = NULL; + } #endif #ifdef PLATFORM_FREEBSD { @@ -1849,7 +1940,7 @@ void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB) if (bStartRx) { #ifdef CONFIG_RTL8723B - PHY_SetMacReg(pAdapter, 0xe70, BIT23 | BIT22, 0x3); /* Power on adc (in RX_WAIT_CCA state) */ + phy_set_mac_reg(pAdapter, 0xe70, BIT23 | BIT22, 0x3); /* Power on adc (in RX_WAIT_CCA state) */ write_bbreg(pAdapter, 0xa01, BIT0, bDisable);/* improve Rx performance by jerry */ #endif pHalData->ReceiveConfig = RCR_AAP | RCR_APM | RCR_AM | RCR_AMF | RCR_HTC_LOC_CTRL; @@ -1877,7 +1968,7 @@ void SetPacketRx(PADAPTER pAdapter, u8 bStartRx, u8 bAB) pHalData->ReceiveConfig |= RCR_AB; } else { #ifdef CONFIG_RTL8723B - PHY_SetMacReg(pAdapter, 0xe70, BIT23 | BIT22, 0x00); /* Power off adc (in RX_WAIT_CCA state) */ + phy_set_mac_reg(pAdapter, 0xe70, BIT23 | BIT22, 0x00); /* Power off adc (in RX_WAIT_CCA state)*/ write_bbreg(pAdapter, 0xa01, BIT0, bEnable);/* improve Rx performance by jerry */ #endif pHalData->ReceiveConfig = 0; @@ -2107,7 +2198,7 @@ void _rtw_mp_xmit_priv(struct xmit_priv *pxmitpriv) #endif u8 -MptToMgntRate( +mpt_to_mgnt_rate( IN ULONG MptRateIdx ) { @@ -2291,7 +2382,7 @@ MptToMgntRate( case MPT_RATE_LAST: /* fully automatiMGN_VHT2SS_MCS1; */ default: - RTW_INFO("<===MptToMgntRate(), Invalid Rate: %d!!\n", MptRateIdx); + RTW_INFO("<===mpt_to_mgnt_rate(), Invalid Rate: %d!!\n", MptRateIdx); return 0x0; } } @@ -2556,7 +2647,7 @@ u8 HwRateToMPTRate(u8 rate) break; default: - RTW_INFO("HwRateToMRate(): Non supported Rate [%x]!!!\n", rate); + RTW_INFO("hw_rate_to_m_rate(): Non supported Rate [%x]!!!\n", rate); break; } return ret_rate; @@ -2592,6 +2683,17 @@ u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr) return _FAIL; } +u8 rtw_mp_mode_check(PADAPTER pAdapter) +{ + PADAPTER primary_adapter = GET_PRIMARY_ADAPTER(pAdapter); + + if (primary_adapter->registrypriv.mp_mode == 1) + return _TRUE; + else + return _FALSE; +} + + ULONG mpt_ProQueryCalTxPower( PADAPTER pAdapter, u8 RfPath @@ -2599,24 +2701,24 @@ ULONG mpt_ProQueryCalTxPower( { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); ULONG TxPower = 1; u1Byte rate = 0; struct txpwr_idx_comp tic; - u8 mgn_rate = MptToMgntRate(pMptCtx->MptRateIndex); + u8 mgn_rate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); - TxPower = rtw_hal_get_tx_power_index(pAdapter, RfPath, mgn_rate, pHalData->CurrentChannelBW, pHalData->CurrentChannel, &tic); + TxPower = rtw_hal_get_tx_power_index(pAdapter, RfPath, mgn_rate, pHalData->current_channel_bw, pHalData->current_channel, &tic); RTW_INFO("bw=%d, ch=%d, rate=%d, txPower:%u = %u + (%d=%d:%d) + (%d) + (%d)\n", - pHalData->CurrentChannelBW, pHalData->CurrentChannel, mgn_rate + pHalData->current_channel_bw, pHalData->current_channel, mgn_rate , TxPower, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); pAdapter->mppriv.txpoweridx = (u8)TxPower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)TxPower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)TxPower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)TxPower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)TxPower; + pMptCtx->TxPwrLevel[RF_PATH_A] = (u8)TxPower; + pMptCtx->TxPwrLevel[RF_PATH_B] = (u8)TxPower; + pMptCtx->TxPwrLevel[RF_PATH_C] = (u8)TxPower; + pMptCtx->TxPwrLevel[RF_PATH_D] = (u8)TxPower; hal_mpt_SetTxPower(pAdapter); return TxPower; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp_ioctl.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp_ioctl.c index ffeea1cdfd9d..035d2815d76a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp_ioctl.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_mp_ioctl.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_MP_IOCTL_C_ #include @@ -2439,7 +2434,7 @@ unsigned int mp_ioctl_xmit_packet_hdl(struct oid_par_priv *poid_par_priv) fctrl = &(pwlanhdr->frame_ctl); *(fctrl) = 0; - SetFrameSubType(pframe, WIFI_DATA); + set_frame_sub_type(pframe, WIFI_DATA); _rtw_memcpy(pwlanhdr->addr1, pethhdr->h_dest, ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, pethhdr->h_source, ETH_ALEN); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_odm.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_odm.c index d9b7db1867a9..d5833b94fa9a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_odm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_odm.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,185 +11,57 @@ * 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 #include -const char *odm_comp_str[] = { - /* BIT0 */"ODM_COMP_DIG", - /* BIT1 */"ODM_COMP_RA_MASK", - /* BIT2 */"ODM_COMP_DYNAMIC_TXPWR", - /* BIT3 */"ODM_COMP_FA_CNT", - /* BIT4 */"ODM_COMP_RSSI_MONITOR", - /* BIT5 */"ODM_COMP_SNIFFER", - /* BIT6 */"ODM_COMP_ANT_DIV", - /* BIT7 */"ODM_COMP_DFS", - /* BIT8 */"ODM_COMP_NOISY_DETECT", - /* BIT9 */"ODM_COMP_RATE_ADAPTIVE", - /* BIT10 */"ODM_COMP_PATH_DIV", - /* BIT11 */"ODM_COMP_CCX", - /* BIT12 */"ODM_COMP_DYNAMIC_PRICCA", - /* BIT13 */NULL, - /* BIT14 */"ODM_COMP_MP", - /* BIT15 */"ODM_COMP_CFO_TRACKING", - /* BIT16 */"ODM_COMP_ACS", - /* BIT17 */"PHYDM_COMP_ADAPTIVITY", - /* BIT18 */"PHYDM_COMP_RA_DBG", - /* BIT19 */"PHYDM_COMP_TXBF", - /* BIT20 */"ODM_COMP_EDCA_TURBO", - /* BIT21 */"ODM_COMP_EARLY_MODE", - /* BIT22 */"ODM_FW_DEBUG_TRACE", - /* BIT23 */NULL, - /* BIT24 */"ODM_COMP_TX_PWR_TRACK", - /* BIT25 */"ODM_COMP_RX_GAIN_TRACK", - /* BIT26 */"ODM_COMP_CALIBRATION", - /* BIT27 */NULL, - /* BIT28 */"ODM_PHY_CONFIG", - /* BIT29 */"ODM_COMP_INIT", - /* BIT30 */"ODM_COMP_COMMON", -}; - -#define RTW_ODM_COMP_MAX 31 - -const char *odm_ability_str[] = { - /* BIT0 */"ODM_BB_DIG", - /* BIT1 */"ODM_BB_RA_MASK", - /* BIT2 */"ODM_BB_DYNAMIC_TXPWR", - /* BIT3 */"ODM_BB_FA_CNT", - /* BIT4 */"ODM_BB_RSSI_MONITOR", - /* BIT5 */"ODM_BB_CCK_PD", - /* BIT6 */"ODM_BB_ANT_DIV", - /* BIT7 */NULL, - /* BIT8 */"ODM_BB_PWR_TRAIN", - /* BIT9 */"ODM_BB_RATE_ADAPTIVE", - /* BIT10 */"ODM_BB_PATH_DIV", - /* BIT11 */NULL, - /* BIT12 */NULL, - /* BIT13 */"ODM_BB_ADAPTIVITY", - /* BIT14 */"ODM_BB_CFO_TRACKING", - /* BIT15 */"ODM_BB_NHM_CNT", - /* BIT16 */"ODM_BB_PRIMARY_CCA", - /* BIT17 */"ODM_BB_TXBF", - /* BIT18 */"ODM_BB_DYNAMIC_ARFR", - /* BIT19 */NULL, - /* BIT20 */"ODM_MAC_EDCA_TURBO", - /* BIT21 */"ODM_MAC_EARLY_MODE", - /* BIT22 */NULL, - /* BIT23 */NULL, - /* BIT24 */"ODM_RF_TX_PWR_TRACK", - /* BIT25 */"ODM_RF_RX_GAIN_TRACK", - /* BIT26 */"ODM_RF_CALIBRATION", -}; - -#define RTW_ODM_ABILITY_MAX 27 - -const char *odm_dbg_level_str[] = { - NULL, - "ODM_DBG_OFF", - "ODM_DBG_SERIOUS", - "ODM_DBG_WARNING", - "ODM_DBG_LOUD", - "ODM_DBG_TRACE", -}; - -#define RTW_ODM_DBG_LEVEL_NUM 6 - -void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter) +u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &pHalData->odmpriv; - int cnt = 0; - u64 dbg_comp = 0; - int i; + struct PHY_DM_STRUCT *podmpriv = &pHalData->odmpriv; + u32 result = 0; - rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_FLAG, &dbg_comp, NULL); - - RTW_PRINT_SEL(sel, "odm.DebugComponents = 0x%016llx\n", dbg_comp); - for (i = 0; i < RTW_ODM_COMP_MAX; i++) { - if (odm_comp_str[i]) - RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", - (BIT0 & (dbg_comp >> i)) ? '+' : ' ', i, odm_comp_str[i]); + switch (ops) { + case HAL_PHYDM_DIS_ALL_FUNC: + podmpriv->support_ability = DYNAMIC_FUNC_DISABLE; + halrf_cmn_info_set(podmpriv, HALRF_CMNINFO_ABILITY, DYNAMIC_FUNC_DISABLE); + break; + case HAL_PHYDM_FUNC_SET: + podmpriv->support_ability |= ability; + break; + case HAL_PHYDM_FUNC_CLR: + podmpriv->support_ability &= ~(ability); + break; + case HAL_PHYDM_ABILITY_BK: + /* dm flag backup*/ + podmpriv->bk_support_ability = podmpriv->support_ability; + pHalData->bk_rf_ability = halrf_cmn_info_get(podmpriv, HALRF_CMNINFO_ABILITY); + break; + case HAL_PHYDM_ABILITY_RESTORE: + /* restore dm flag */ + podmpriv->support_ability = podmpriv->bk_support_ability; + halrf_cmn_info_set(podmpriv, HALRF_CMNINFO_ABILITY, pHalData->bk_rf_ability); + break; + case HAL_PHYDM_ABILITY_SET: + podmpriv->support_ability = ability; + break; + case HAL_PHYDM_ABILITY_GET: + result = podmpriv->support_ability; + break; } -} - -inline void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps) -{ - rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_FLAG, &comps, _FALSE); -} - -void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &pHalData->odmpriv; - int cnt = 0; - u32 dbg_level = 0; - int i; - - rtw_hal_get_odm_var(adapter, HAL_ODM_DBG_LEVEL, &dbg_level, NULL); - RTW_PRINT_SEL(sel, "odm.DebugLevel = %u\n", dbg_level); - for (i = 0; i < RTW_ODM_DBG_LEVEL_NUM; i++) { - if (odm_dbg_level_str[i]) - RTW_PRINT_SEL(sel, "%u %s\n", i, odm_dbg_level_str[i]); - } -} - -inline void rtw_odm_dbg_level_set(_adapter *adapter, u32 level) -{ - rtw_hal_set_odm_var(adapter, HAL_ODM_DBG_LEVEL, &level, _FALSE); -} - -void rtw_odm_ability_msg(void *sel, _adapter *adapter) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &pHalData->odmpriv; - int cnt = 0; - u32 ability = 0; - int i; - - ability = rtw_phydm_ability_get(adapter); - RTW_PRINT_SEL(sel, "odm.SupportAbility = 0x%08x\n", ability); - for (i = 0; i < RTW_ODM_ABILITY_MAX; i++) { - if (odm_ability_str[i]) - RTW_PRINT_SEL(sel, "%cBIT%-2d %s\n", - (BIT0 << i) & ability ? '+' : ' ', i, odm_ability_str[i]); - } -} - -inline void rtw_odm_ability_set(_adapter *adapter, u32 ability) -{ - rtw_phydm_ability_set(adapter, ability); + return result; } /* set ODM_CMNINFO_IC_TYPE based on chip_type */ void rtw_odm_init_ic_type(_adapter *adapter) { - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &hal_data->odmpriv; + struct PHY_DM_STRUCT *odm = adapter_to_phydm(adapter); u4Byte ic_type = chip_type_to_odm_ic_type(rtw_get_chip_type(adapter)); rtw_warn_on(!ic_type); - ODM_CmnInfoInit(odm, ODM_CMNINFO_IC_TYPE, ic_type); -} - -inline void rtw_odm_set_force_igi_lb(_adapter *adapter, u8 lb) -{ - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - - hal_data->u1ForcedIgiLb = lb; -} - -inline u8 rtw_odm_get_force_igi_lb(_adapter *adapter) -{ - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - - return hal_data->u1ForcedIgiLb; + odm_cmn_info_init(odm, ODM_CMNINFO_IC_TYPE, ic_type); } void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter) @@ -203,9 +75,6 @@ void rtw_odm_adaptivity_ver_msg(void *sel, _adapter *adapter) void rtw_odm_adaptivity_en_msg(void *sel, _adapter *adapter) { struct registry_priv *regsty = &adapter->registrypriv; - struct mlme_priv *mlme = &adapter->mlmepriv; - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &hal_data->odmpriv; RTW_PRINT_SEL(sel, "RTW_ADAPTIVITY_EN_"); @@ -281,51 +150,48 @@ bool rtw_odm_adaptivity_needed(_adapter *adapter) void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *odm = adapter_to_phydm(adapter); rtw_odm_adaptivity_config_msg(sel, adapter); RTW_PRINT_SEL(sel, "%10s %16s %16s %22s %12s\n" - , "TH_L2H_ini", "TH_EDCCA_HL_diff", "TH_L2H_ini_mode2", "TH_EDCCA_HL_diff_mode2", "EDCCA_enable"); + , "th_l2h_ini", "th_edcca_hl_diff", "th_l2h_ini_mode2", "th_edcca_hl_diff_mode2", "edcca_enable"); RTW_PRINT_SEL(sel, "0x%-8x %-16d 0x%-14x %-22d %-12d\n" - , (u8)odm->TH_L2H_ini - , odm->TH_EDCCA_HL_diff - , (u8)odm->TH_L2H_ini_mode2 - , odm->TH_EDCCA_HL_diff_mode2 - , odm->EDCCA_enable + , (u8)odm->th_l2h_ini + , odm->th_edcca_hl_diff + , (u8)odm->th_l2h_ini_mode2 + , odm->th_edcca_hl_diff_mode2 + , odm->edcca_enable ); RTW_PRINT_SEL(sel, "%15s %9s\n", "AdapEnableState", "Adap_Flag"); RTW_PRINT_SEL(sel, "%-15x %-9x\n" - , odm->Adaptivity_enable + , odm->adaptivity_enable , odm->adaptivity_flag ); } -void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable) +void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 th_l2h_ini, s8 th_edcca_hl_diff, s8 th_l2h_ini_mode2, s8 th_edcca_hl_diff_mode2, u8 edcca_enable) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *odm = adapter_to_phydm(adapter); - odm->TH_L2H_ini = TH_L2H_ini; - odm->TH_EDCCA_HL_diff = TH_EDCCA_HL_diff; - odm->TH_L2H_ini_mode2 = TH_L2H_ini_mode2; - odm->TH_EDCCA_HL_diff_mode2 = TH_EDCCA_HL_diff_mode2; - odm->EDCCA_enable = EDCCA_enable; + odm->th_l2h_ini = th_l2h_ini; + odm->th_edcca_hl_diff = th_edcca_hl_diff; + odm->th_l2h_ini_mode2 = th_l2h_ini_mode2; + odm->th_edcca_hl_diff_mode2 = th_edcca_hl_diff_mode2; + odm->edcca_enable = edcca_enable; } void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter) { - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &(hal_data->odmpriv); + struct PHY_DM_STRUCT *odm = adapter_to_phydm(adapter); - RTW_PRINT_SEL(sel, "RxRate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", - HDATA_RATE(odm->RxRate), odm->RSSI_A, odm->RSSI_B); + RTW_PRINT_SEL(sel, "rx_rate = %s, RSSI_A = %d(%%), RSSI_B = %d(%%)\n", + HDATA_RATE(odm->rx_rate), odm->RSSI_A, odm->RSSI_B); } -void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) +void rtw_odm_acquirespinlock(_adapter *adapter, enum rt_spinlock_type type) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); _irqL irqL; @@ -338,7 +204,7 @@ void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) } } -void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) +void rtw_odm_releasespinlock(_adapter *adapter, enum rt_spinlock_type type) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); _irqL irqL; @@ -351,34 +217,46 @@ void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type) } } -#ifdef CONFIG_DFS_MASTER inline u8 rtw_odm_get_dfs_domain(_adapter *adapter) { - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - PDM_ODM_T pDM_Odm = &(hal_data->odmpriv); +#ifdef CONFIG_DFS_MASTER + struct PHY_DM_STRUCT *pDM_Odm = adapter_to_phydm(adapter); - return pDM_Odm->DFS_RegionDomain; + return pDM_Odm->dfs_region_domain; +#else + return PHYDM_DFS_DOMAIN_UNKNOWN; +#endif } +inline u8 rtw_odm_dfs_domain_unknown(_adapter *adapter) +{ +#ifdef CONFIG_DFS_MASTER + return rtw_odm_get_dfs_domain(adapter) == PHYDM_DFS_DOMAIN_UNKNOWN; +#else + return 1; +#endif +} + +#ifdef CONFIG_DFS_MASTER inline VOID rtw_odm_radar_detect_reset(_adapter *adapter) { - phydm_radar_detect_reset(GET_ODM(adapter)); + phydm_radar_detect_reset(adapter_to_phydm(adapter)); } inline VOID rtw_odm_radar_detect_disable(_adapter *adapter) { - phydm_radar_detect_disable(GET_ODM(adapter)); + phydm_radar_detect_disable(adapter_to_phydm(adapter)); } /* called after ch, bw is set */ inline VOID rtw_odm_radar_detect_enable(_adapter *adapter) { - phydm_radar_detect_enable(GET_ODM(adapter)); + phydm_radar_detect_enable(adapter_to_phydm(adapter)); } inline BOOLEAN rtw_odm_radar_detect(_adapter *adapter) { - return phydm_radar_detect(GET_ODM(adapter)); + return phydm_radar_detect(adapter_to_phydm(adapter)); } #endif /* CONFIG_DFS_MASTER */ @@ -390,12 +268,11 @@ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) _adapter *adapter = rframe->u.hdr.adapter; + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); struct rx_pkt_attrib *attrib = &rframe->u.hdr.attrib; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; u8 *wlanhdr = get_recvframe_data(rframe); - if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) { + if (phydm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) { /* * 8723D: * type_0(CCK) @@ -424,7 +301,7 @@ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) */ if ((*phys & 0xf) == 0) { - struct _Phy_Status_Rpt_Jaguar2_Type0 *phys_t0 = (struct _Phy_Status_Rpt_Jaguar2_Type0 *)phys; + struct _phy_status_rpt_jaguar2_type0 *phys_t0 = (struct _phy_status_rpt_jaguar2_type0 *)phys; if (DBG_RX_PHYSTATUS_CHINFO) { RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u)\n" @@ -437,13 +314,13 @@ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) } } else if ((*phys & 0xf) == 1) { - struct _Phy_Status_Rpt_Jaguar2_Type1 *phys_t1 = (struct _Phy_Status_Rpt_Jaguar2_Type1 *)phys; + struct _phy_status_rpt_jaguar2_type1 *phys_t1 = (struct _phy_status_rpt_jaguar2_type1 *)phys; u8 rxsc = (attrib->data_rate > DESC_RATE11M && attrib->data_rate < DESC_RATEMCS0) ? phys_t1->l_rxsc : phys_t1->ht_rxsc; u8 pkt_cch = 0; u8 pkt_bw = CHANNEL_WIDTH_20; #if ODM_IC_11N_SERIES_SUPPORT - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { + if (phydm->support_ic_type & ODM_IC_11N_SERIES) { /* RXSC N-series */ #define RXSC_DUP 0 #define RXSC_LSC 1 @@ -471,7 +348,7 @@ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) #endif /* ODM_IC_11N_SERIES_SUPPORT */ #if ODM_IC_11AC_SERIES_SUPPORT - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { + if (phydm->support_ic_type & ODM_IC_11AC_SERIES) { /* RXSC AC-series */ #define RXSC_DUP 0 /* 0: RX from all SC of current rf_mode */ @@ -558,7 +435,7 @@ void rtw_odm_parse_rx_phy_status_chinfo(union recv_frame *rframe, u8 *phys) attrib->ch = pkt_cch; } else { - struct _Phy_Status_Rpt_Jaguar2_Type2 *phys_t2 = (struct _Phy_Status_Rpt_Jaguar2_Type2 *)phys; + struct _phy_status_rpt_jaguar2_type2 *phys_t2 = (struct _phy_status_rpt_jaguar2_type2 *)phys; if (DBG_RX_PHYSTATUS_CHINFO) { RTW_PRINT("phys_t%u ta="MAC_FMT" %s, %s(band:%u, ch:%u, l_rxsc:%u, ht_rxsc:%u)\n" diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_p2p.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_p2p.c index c42497a885be..180bca4a1e5b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_p2p.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_p2p.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_P2P_C_ #include @@ -85,7 +80,7 @@ static u32 go_add_group_info_attr(struct wifidirect_info *pwdinfo, u8 *pbuf) pcur += ETH_ALEN; /* P2P interface address */ - _rtw_memcpy(pcur, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(pcur, psta->cmn.mac_addr, ETH_ALEN); pcur += ETH_ALEN; *pcur = psta->dev_cap; @@ -182,7 +177,7 @@ static void issue_group_disc_req(struct wifidirect_info *pwdinfo, u8 *da) SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -242,7 +237,7 @@ static void issue_p2p_devdisc_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 s SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -320,7 +315,7 @@ static void issue_p2p_provision_resp(struct wifidirect_info *pwdinfo, u8 *raddr, SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -424,7 +419,7 @@ static void issue_p2p_presence_resp(struct wifidirect_info *pwdinfo, u8 *da, u8 SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -757,6 +752,7 @@ u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunnel _adapter *padapter = pwdinfo->padapter; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct wifi_display_info *pwfd_info = padapter->wdinfo.wfd_info; + u16 v16 = 0; if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) goto exit; @@ -794,36 +790,43 @@ u32 build_probe_resp_wfd_ie(struct wifidirect_info *pwdinfo, u8 *pbuf, u8 tunnel if (is_any_client_associated(pwdinfo->padapter)) { if (pwdinfo->wfd_tdls_enable) { /* TDLS mode + WSD ( WFD Service Discovery ) */ - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); } else { /* WiFi Direct mode + WSD ( WFD Service Discovery ) */ - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); } } else { if (pwdinfo->wfd_tdls_enable) { /* available for WFD session + TDLS mode + WSD ( WFD Service Discovery ) */ - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); } else { /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); } } } else { if (pwdinfo->wfd_tdls_enable) { /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); } else { - /* available for WFD session + WiFi Direct mode + WSD ( WFD Service Discovery ) */ - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); } } } else { - if (pwdinfo->wfd_tdls_enable) - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT); - else - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT); - + if (pwdinfo->wfd_tdls_enable) { + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); + } else { + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_WSD | WFD_DEVINFO_HDCP_SUPPORT; + RTW_PUT_BE16(wfdie + wfdielen, v16); + } } wfdielen += 2; @@ -2328,7 +2331,7 @@ u32 process_assoc_req_p2p_ie(struct wifidirect_info *pwdinfo, u8 *pframe, uint l if (!rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) return P2P_STATUS_FAIL_REQUEST_UNABLE; - frame_type = GetFrameSubType(pframe); + frame_type = get_frame_sub_type(pframe); if (frame_type == WIFI_ASSOCREQ) ie_offset = _ASOCREQ_IE_OFFSET_; else /* WIFI_REASSOCREQ */ @@ -2467,7 +2470,7 @@ u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint le /* _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ /* issue GO Discoverability Request */ - issue_group_disc_req(pwdinfo, psta->hwaddr); + issue_group_disc_req(pwdinfo, psta->cmn.mac_addr); /* _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ status = P2P_STATUS_SUCCESS; @@ -2491,7 +2494,7 @@ u32 process_p2p_devdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint le /* issue Device Discoverability Response */ - issue_p2p_devdisc_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); + issue_p2p_devdisc_resp(pwdinfo, get_addr2_ptr(pframe), status, dialogToken); return (status == P2P_STATUS_SUCCESS) ? _TRUE : _FALSE; @@ -2535,7 +2538,7 @@ u8 process_p2p_provdisc_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint l break; } } - issue_p2p_provision_resp(pwdinfo, GetAddr2Ptr(pframe), frame_body, uconfig_method); + issue_p2p_provision_resp(pwdinfo, get_addr2_ptr(pframe), frame_body, uconfig_method); } } RTW_INFO("[%s] config method = %s\n", __FUNCTION__, pwdinfo->rx_prov_disc_info.strconfig_method_desc_of_prov_disc_req); @@ -2571,26 +2574,15 @@ u8 rtw_p2p_get_peer_ch_list(struct wifidirect_info *pwdinfo, u8 *ch_content, u8 return ch_no; } -u8 rtw_p2p_check_peer_oper_ch(struct mlme_ext_priv *pmlmeext, u8 ch) -{ - u8 i = 0; - - for (i = 0; i < pmlmeext->max_chan_nums; i++) { - if (pmlmeext->channel_set[i].ChannelNum == ch) - return _SUCCESS; - } - - return _FAIL; -} - -u8 rtw_p2p_ch_inclusion(struct mlme_ext_priv *pmlmeext, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) +u8 rtw_p2p_ch_inclusion(_adapter *adapter, u8 *peer_ch_list, u8 peer_ch_num, u8 *ch_list_inclusioned) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); int i = 0, j = 0, temp = 0; u8 ch_no = 0; for (i = 0; i < peer_ch_num; i++) { - for (j = temp; j < pmlmeext->max_chan_nums; j++) { - if (*(peer_ch_list + i) == pmlmeext->channel_set[j].ChannelNum) { + for (j = temp; j < rfctl->max_chan_nums; j++) { + if (*(peer_ch_list + i) == rfctl->channel_set[j].ChannelNum) { ch_list_inclusioned[ch_no++] = *(peer_ch_list + i); temp = j; break; @@ -2715,7 +2707,7 @@ u8 process_p2p_group_negotation_req(struct wifidirect_info *pwdinfo, u8 *pframe, if (rtw_get_p2p_attr_content(p2p_ie, p2p_ielen, P2P_ATTR_CH_LIST, ch_content, &ch_cnt)) { peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, ch_content, ch_cnt, peer_ch_list); - ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); + ch_num_inclusioned = rtw_p2p_ch_inclusion(padapter, peer_ch_list, peer_ch_num, ch_list_inclusioned); if (ch_num_inclusioned == 0) { RTW_INFO("[%s] No common channel in channel list!\n", __FUNCTION__); @@ -2910,7 +2902,7 @@ u8 process_p2p_group_negotation_resp(struct wifidirect_info *pwdinfo, u8 *pframe RTW_INFO("[%s] channel list attribute found, len = %d\n", __FUNCTION__, pwdinfo->channel_list_attr_len); peer_ch_num = rtw_p2p_get_peer_ch_list(pwdinfo, pwdinfo->channel_list_attr, pwdinfo->channel_list_attr_len, peer_ch_list); - ch_num_inclusioned = rtw_p2p_ch_inclusion(&padapter->mlmeextpriv, peer_ch_list, peer_ch_num, ch_list_inclusioned); + ch_num_inclusioned = rtw_p2p_ch_inclusion(padapter, peer_ch_list, peer_ch_num, ch_list_inclusioned); if (ch_num_inclusioned == 0) { RTW_INFO("[%s] No common channel in channel list!\n", __FUNCTION__); @@ -3004,9 +2996,8 @@ u8 process_p2p_group_negotation_confirm(struct wifidirect_info *pwdinfo, u8 *pfr result = attr_content; if (attr_content == P2P_STATUS_SUCCESS) { - u8 bcancelled = 0; - _cancel_timer(&pwdinfo->restore_p2p_state_timer, &bcancelled); + _cancel_timer_ex(&pwdinfo->restore_p2p_state_timer); /* Commented by Albert 20100911 */ /* Todo: Need to handle the case which both Intents are the same. */ @@ -3073,7 +3064,7 @@ u8 process_p2p_presence_req(struct wifidirect_info *pwdinfo, u8 *pframe, uint le /* todo: check NoA attribute */ - issue_p2p_presence_resp(pwdinfo, GetAddr2Ptr(pframe), status, dialogToken); + issue_p2p_presence_resp(pwdinfo, get_addr2_ptr(pframe), status, dialogToken); return _TRUE; } @@ -3082,19 +3073,20 @@ void find_phase_handler(_adapter *padapter) { struct wifidirect_info *pwdinfo = &padapter->wdinfo; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - NDIS_802_11_SSID ssid; + struct sitesurvey_parm parm; _irqL irqL; u8 _status = 0; - _rtw_memset((unsigned char *)&ssid, 0, sizeof(NDIS_802_11_SSID)); - _rtw_memcpy(ssid.Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN); - ssid.SsidLength = P2P_WILDCARD_SSID_LEN; + rtw_init_sitesurvey_parm(padapter, &parm); + _rtw_memcpy(&parm.ssid[0].Ssid, pwdinfo->p2p_wildcard_ssid, P2P_WILDCARD_SSID_LEN); + parm.ssid[0].SsidLength = P2P_WILDCARD_SSID_LEN; + parm.ssid_num = 1; rtw_p2p_set_state(pwdinfo, P2P_STATE_FIND_PHASE_SEARCH); _enter_critical_bh(&pmlmepriv->lock, &irqL); - _status = rtw_sitesurvey_cmd(padapter, &ssid, 1, NULL, 0); + _status = rtw_sitesurvey_cmd(padapter, &parm); _exit_critical_bh(&pmlmepriv->lock, &irqL); @@ -3119,7 +3111,7 @@ void restore_p2p_state_handler(_adapter *padapter) if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_RX_PROVISION_DIS_RSP)) { set_channel_bwmode(padapter, union_ch, union_offset, union_bw); - rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); + rtw_back_opch(padapter); } } #endif @@ -3193,8 +3185,7 @@ void p2p_concurrent_handler(_adapter *padapter) if (pwdinfo->driver_interface == DRIVER_CFG80211) { RTW_INFO("%s, switch ch back to union_ch=%d\n", __func__, union_ch); set_channel_bwmode(padapter, union_ch, union_offset, union_bw); - - rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); + rtw_back_opch(padapter); } else if (pwdinfo->driver_interface == DRIVER_WEXT) { if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE)) { @@ -3204,8 +3195,7 @@ void p2p_concurrent_handler(_adapter *padapter) RTW_INFO("[%s] P2P_STATE_IDLE, ext_listen_period = %d\n", __FUNCTION__, pwdinfo->ext_listen_period); if (union_ch != pwdinfo->listen_channel) { - /* Will switch to listen channel so that need to send the NULL data with PW bit to AP. */ - rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); + rtw_leave_opch(padapter); set_channel_bwmode(padapter, pwdinfo->listen_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); } @@ -3218,6 +3208,7 @@ void p2p_concurrent_handler(_adapter *padapter) /* Todo: To check the value of pwdinfo->ext_listen_period is equal to 0 or not. */ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); } + } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) || rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_FAIL) || (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_ING) && pwdinfo->nego_req_info.benable == _FALSE) || @@ -3237,17 +3228,19 @@ void p2p_concurrent_handler(_adapter *padapter) rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); } rtw_p2p_set_state(pwdinfo, P2P_STATE_IDLE); - rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); + rtw_back_opch(padapter); } /* Todo: To check the value of pwdinfo->ext_listen_interval is equal to 0 or not. */ _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_interval); + } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_GONEGO_OK)) { /* The driver had finished the P2P handshake successfully. */ val8 = 0; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); set_channel_bwmode(padapter, union_ch, union_offset, union_bw); - rtw_mi_buddy_issue_nulldata(padapter, NULL, 0, 3, 500); + rtw_back_opch(padapter); + } else if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_TX_PROVISION_DIS_REQ)) { val8 = 1; set_channel_bwmode(padapter, pwdinfo->tx_prov_disc_info.peer_channel_num[0], HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); @@ -3282,10 +3275,134 @@ void p2p_concurrent_handler(_adapter *padapter) #endif #ifdef CONFIG_IOCTL_CFG80211 +static u8 _stay_in_cur_chan(_adapter *padapter) +{ + int i; + _adapter *iface; + struct mlme_priv *pmlmepriv; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + u8 rst = _FALSE; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface) { + pmlmepriv = &iface->mlmepriv; + + if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS) == _TRUE) { + RTW_ERR(ADPT_FMT"- _FW_UNDER_LINKING |WIFI_UNDER_WPS (mlme state:0x%x)\n", + ADPT_ARG(iface), get_fwstate(&iface->mlmepriv)); + rst = _TRUE; + break; + } + #ifdef CONFIG_AP_MODE + if (MLME_IS_AP(iface) || MLME_IS_MESH(iface)) { + if (rtw_ap_sta_linking_state_check(iface) == _TRUE) { + RTW_ERR(ADPT_FMT"- SoftAP/Mesh -have sta under linking\n", ADPT_ARG(iface)); + rst = _TRUE; + break; + } + } + #endif + } + } + + return rst; +} + static int ro_ch_handler(_adapter *adapter, u8 *buf) { - /* TODO: move remain on channel logical here */ - return H2C_SUCCESS; + int ret = H2C_SUCCESS; + struct p2p_roch_parm *roch_parm = (struct p2p_roch_parm *)buf; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); + struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &adapter->cfg80211_wdinfo; + struct wifidirect_info *pwdinfo = &adapter->wdinfo; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + u8 ready_on_channel = _FALSE; + u8 remain_ch; + unsigned int duration; + + _enter_critical_mutex(&pwdev_priv->roch_mutex, NULL); + + if (rtw_cfg80211_get_is_roch(adapter) != _TRUE) + goto exit; + + remain_ch = (u8) ieee80211_frequency_to_channel(roch_parm->ch.center_freq); + duration = roch_parm->duration; + + RTW_INFO(FUNC_ADPT_FMT" ch:%u duration:%d, cookie:0x%llx\n" + , FUNC_ADPT_ARG(adapter), remain_ch, roch_parm->duration, roch_parm->cookie); + + if (roch_parm->wdev && roch_parm->cookie) { + if (pcfg80211_wdinfo->ro_ch_wdev != roch_parm->wdev) { + RTW_WARN(FUNC_ADPT_FMT" ongoing wdev:%p, wdev:%p\n" + , FUNC_ADPT_ARG(adapter), pcfg80211_wdinfo->ro_ch_wdev, roch_parm->wdev); + rtw_warn_on(1); + } + + if (pcfg80211_wdinfo->remain_on_ch_cookie != roch_parm->cookie) { + RTW_WARN(FUNC_ADPT_FMT" ongoing cookie:0x%llx, cookie:0x%llx\n" + , FUNC_ADPT_ARG(adapter), pcfg80211_wdinfo->remain_on_ch_cookie, roch_parm->cookie); + rtw_warn_on(1); + } + } + + if (_stay_in_cur_chan(adapter) == _TRUE) { + remain_ch = rtw_mi_get_union_chan(adapter); + RTW_INFO(FUNC_ADPT_FMT" stay in union ch:%d\n", FUNC_ADPT_ARG(adapter), remain_ch); + } + + #ifdef CONFIG_CONCURRENT_MODE + if (rtw_mi_check_status(adapter, MI_LINKED) && (0 != rtw_mi_get_union_chan(adapter))) { + if ((remain_ch != rtw_mi_get_union_chan(adapter)) && !check_fwstate(&adapter->mlmepriv, _FW_LINKED)) { + if ( + #ifdef RTW_ROCH_BACK_OP + ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1 || + #endif + (remain_ch != pmlmeext->cur_channel)) { + + rtw_leave_opch(adapter); + + #ifdef RTW_ROCH_BACK_OP + RTW_INFO("%s, set switch ch timer, duration=%d\n", __func__, duration - pwdinfo->ext_listen_interval); + ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); + _set_timer(&pwdinfo->ap_p2p_switch_timer, duration - pwdinfo->ext_listen_interval); + #endif + } + } + ready_on_channel = _TRUE; + } else + #endif /* CONFIG_CONCURRENT_MODE */ + { + if (remain_ch != rtw_get_oper_ch(adapter)) + ready_on_channel = _TRUE; + } + + if (ready_on_channel == _TRUE) { + #ifndef RTW_SINGLE_WIPHY + if (!check_fwstate(&adapter->mlmepriv, _FW_LINKED)) + #endif + { + #ifdef CONFIG_CONCURRENT_MODE + if (rtw_get_oper_ch(adapter) != remain_ch) + #endif + { + /* if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) */ + set_channel_bwmode(adapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); + } + } + } + + #ifdef CONFIG_BT_COEXIST + rtw_btcoex_ScanNotify(adapter, _TRUE); + #endif + + RTW_INFO("%s, set ro ch timer, duration=%d\n", __func__, duration); + _set_timer(&pcfg80211_wdinfo->remain_on_ch_timer, duration); + +exit: + _exit_critical_mutex(&pwdev_priv->roch_mutex, NULL); + + return ret; } static int cancel_ro_ch_handler(_adapter *padapter, u8 *buf) @@ -3338,6 +3455,8 @@ static int cancel_ro_ch_handler(_adapter *padapter, u8 *buf) } set_channel_bwmode(padapter, ch, offset, bw); + if (rtw_mi_check_status(padapter, MI_LINKED)) + rtw_back_opch(padapter); rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); #ifdef CONFIG_DEBUG_CFG80211 @@ -3380,6 +3499,11 @@ static void rtw_change_p2pie_op_ch(_adapter *padapter, const u8 *frame_body, u32 u8 *ies, *p2p_ie; u32 ies_len, p2p_ielen; +#ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter)) + return; +#endif /* CONFIG_MCC_MODE */ + ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; @@ -3406,6 +3530,11 @@ static void rtw_change_p2pie_ch_list(_adapter *padapter, const u8 *frame_body, u u8 *ies, *p2p_ie; u32 ies_len, p2p_ielen; +#ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter)) + return; +#endif /* CONFIG_MCC_MODE */ + ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; @@ -3532,6 +3661,11 @@ static void rtw_cfg80211_adjust_p2pie_channel(_adapter *padapter, const u8 *fram u32 ies_len, p2p_ielen; u8 union_ch = rtw_mi_get_union_chan(padapter); +#ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter)) + return; +#endif /* CONFIG_MCC_MODE */ + ies = (u8 *)(frame_body + _PUBLIC_ACTION_IE_OFFSET_); ies_len = len - _PUBLIC_ACTION_IE_OFFSET_; @@ -3881,7 +4015,7 @@ int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) if (nego_info->token != dialogToken) rtw_wdev_nego_info_init(nego_info); - _rtw_memcpy(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); + _rtw_memcpy(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : get_addr2_ptr(buf), ETH_ALEN); if (iaddr) _rtw_memcpy(tx ? nego_info->iface_addr : nego_info->peer_iface_addr, iaddr, ETH_ALEN); nego_info->active = tx ? 1 : 0; @@ -3935,7 +4069,7 @@ int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) iaddr = cont; if (nego_info->token == dialogToken && nego_info->state == 0 - && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE + && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : get_addr2_ptr(buf), ETH_ALEN) == _TRUE ) { if (iaddr) _rtw_memcpy(tx ? nego_info->iface_addr : nego_info->peer_iface_addr, iaddr, ETH_ALEN); @@ -3987,7 +4121,7 @@ int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) status = *cont; if (nego_info->token == dialogToken && nego_info->state == 1 - && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE + && _rtw_memcmp(nego_info->peer_mac, tx ? GetAddr1Ptr(buf) : get_addr2_ptr(buf), ETH_ALEN) == _TRUE ) { nego_info->status = (status == -1) ? 0xff : status; nego_info->conf_op_ch = (op_ch == -1) ? 0 : op_ch; @@ -4035,7 +4169,7 @@ int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) if (invit_info->token != dialogToken) rtw_wdev_invit_info_init(invit_info); - _rtw_memcpy(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN); + _rtw_memcpy(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : get_addr2_ptr(buf), ETH_ALEN); if (gbssid) _rtw_memcpy(invit_info->group_bssid, gbssid, ETH_ALEN); invit_info->active = tx ? 1 : 0; @@ -4095,7 +4229,7 @@ int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) gbssid = cont; if (invit_info->token == dialogToken && invit_info->state == 0 - && _rtw_memcmp(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : GetAddr2Ptr(buf), ETH_ALEN) == _TRUE + && _rtw_memcmp(invit_info->peer_mac, tx ? GetAddr1Ptr(buf) : get_addr2_ptr(buf), ETH_ALEN) == _TRUE ) { invit_info->status = (status == -1) ? 0xff : status; invit_info->rsp_op_ch = op_ch; @@ -4173,24 +4307,23 @@ int rtw_p2p_check_frames(_adapter *padapter, const u8 *buf, u32 len, u8 tx) switch (OUI_Subtype) { case P2P_NOTICE_OF_ABSENCE: - RTW_INFO("RTW_%s:P2P_NOTICE_OF_ABSENCE, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); + RTW_INFO("RTW_%s:P2P_NOTICE_OF_ABSENCE, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); break; case P2P_PRESENCE_REQUEST: - RTW_INFO("RTW_%s:P2P_PRESENCE_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); + RTW_INFO("RTW_%s:P2P_PRESENCE_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); break; case P2P_PRESENCE_RESPONSE: - RTW_INFO("RTW_%s:P2P_PRESENCE_RESPONSE, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); + RTW_INFO("RTW_%s:P2P_PRESENCE_RESPONSE, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); break; case P2P_GO_DISC_REQUEST: - RTW_INFO("RTW_%s:P2P_GO_DISC_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", dialogToken); + RTW_INFO("RTW_%s:P2P_GO_DISC_REQUEST, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", dialogToken); break; default: - RTW_INFO("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx == _TRUE) ? "TX" : "RX", OUI_Subtype, dialogToken); + RTW_INFO("RTW_%s:OUI_Subtype=%d, dialogToken=%d\n", (tx == _TRUE) ? "Tx" : "Rx", OUI_Subtype, dialogToken); break; } - } else - RTW_INFO("RTW_%s:action frame category=%d\n", (tx == _TRUE) ? "TX" : "RX", category); + } return is_p2p_frame; } @@ -4201,7 +4334,7 @@ void rtw_init_cfg80211_wifidirect_info(_adapter *padapter) _rtw_memset(pcfg80211_wdinfo, 0x00, sizeof(struct cfg80211_wifidirect_info)); - _init_timer(&pcfg80211_wdinfo->remain_on_ch_timer, padapter->pnetdev, ro_ch_timer_process, padapter); + rtw_init_timer(&pcfg80211_wdinfo->remain_on_ch_timer, padapter, ro_ch_timer_process, padapter); } #endif /* CONFIG_IOCTL_CFG80211 */ @@ -4328,8 +4461,10 @@ void process_p2p_ps_ie(PADAPTER padapter, u8 *IEs, u32 IELength) if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) return; #ifdef CONFIG_CONCURRENT_MODE +#ifndef CONFIG_FW_MULTI_PORT_SUPPORT if (padapter->hw_port != HW_PORT0) return; +#endif #endif if (IELength <= _BEACON_IE_OFFSET_) return; @@ -4406,7 +4541,8 @@ void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct wifidirect_info *pwdinfo = &(padapter->wdinfo); - + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + u32 ps_deny = 0; /* Pre action for p2p state */ switch (p2p_ps_state) { @@ -4428,6 +4564,16 @@ void p2p_ps_wk_hdl(_adapter *padapter, u8 p2p_ps_state) } break; case P2P_PS_ENABLE: + _enter_pwrlock(&adapter_to_pwrctl(padapter)->lock); + ps_deny = rtw_ps_deny_get(padapter); + _exit_pwrlock(&adapter_to_pwrctl(padapter)->lock); + + if ((ps_deny & (PS_DENY_SCAN | PS_DENY_JOIN)) + || rtw_mi_check_fwstate(padapter, (_FW_UNDER_SURVEY | _FW_UNDER_LINKING))) { + pwdinfo->p2p_ps_mode = P2P_PS_NONE; + RTW_DBG(FUNC_ADPT_FMT" Block P2P PS under site survey or LINKING\n", FUNC_ADPT_ARG(padapter)); + return; + } if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) { #ifdef CONFIG_MCC_MODE if (MCC_EN(padapter)) { @@ -4475,7 +4621,9 @@ u8 p2p_ps_wk_cmd(_adapter *padapter, u8 p2p_ps_state, u8 enqueue) if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) #ifdef CONFIG_CONCURRENT_MODE +#ifndef CONFIG_FW_MULTI_PORT_SUPPORT || (padapter->hw_port != HW_PORT0) +#endif #endif ) return res; @@ -4853,13 +5001,13 @@ void rtw_init_wifidirect_timers(_adapter *padapter) { struct wifidirect_info *pwdinfo = &padapter->wdinfo; - _init_timer(&pwdinfo->find_phase_timer, padapter->pnetdev, find_phase_timer_process, padapter); - _init_timer(&pwdinfo->restore_p2p_state_timer, padapter->pnetdev, restore_p2p_state_timer_process, padapter); - _init_timer(&pwdinfo->pre_tx_scan_timer, padapter->pnetdev, pre_tx_scan_timer_process, padapter); - _init_timer(&pwdinfo->reset_ch_sitesurvey, padapter->pnetdev, reset_ch_sitesurvey_timer_process, padapter); - _init_timer(&pwdinfo->reset_ch_sitesurvey2, padapter->pnetdev, reset_ch_sitesurvey_timer_process2, padapter); + rtw_init_timer(&pwdinfo->find_phase_timer, padapter, find_phase_timer_process, padapter); + rtw_init_timer(&pwdinfo->restore_p2p_state_timer, padapter, restore_p2p_state_timer_process, padapter); + rtw_init_timer(&pwdinfo->pre_tx_scan_timer, padapter, pre_tx_scan_timer_process, padapter); + rtw_init_timer(&pwdinfo->reset_ch_sitesurvey, padapter, reset_ch_sitesurvey_timer_process, padapter); + rtw_init_timer(&pwdinfo->reset_ch_sitesurvey2, padapter, reset_ch_sitesurvey_timer_process2, padapter); #ifdef CONFIG_CONCURRENT_MODE - _init_timer(&pwdinfo->ap_p2p_switch_timer, padapter->pnetdev, ap_p2p_switch_timer_process, padapter); + rtw_init_timer(&pwdinfo->ap_p2p_switch_timer, padapter, ap_p2p_switch_timer_process, padapter); #endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_pwrctrl.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_pwrctrl.c index eb893a0793fc..c43a954c4167 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_pwrctrl.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_pwrctrl.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_PWRCTRL_C_ #include @@ -158,7 +153,7 @@ int ips_leave(_adapter *padapter) _exit_pwrlock(&pwrpriv->lock); if (_SUCCESS == ret) - ODM_DMReset(&GET_HAL_DATA(padapter)->odmpriv); + odm_dm_reset(&GET_HAL_DATA(padapter)->odmpriv); #ifdef CONFIG_BT_COEXIST if (_SUCCESS == ret) @@ -200,7 +195,7 @@ bool rtw_pwr_unassociated_idle(_adapter *adapter) goto exit; } - if (adapter_to_pwrctl(adapter)->ips_deny_time >= rtw_get_current_time()) { + if (time_after(adapter_to_pwrctl(adapter)->ips_deny_time, rtw_get_current_time())) { /* RTW_INFO("%s ips_deny_time\n", __func__); */ goto exit; } @@ -216,19 +211,20 @@ bool rtw_pwr_unassociated_idle(_adapter *adapter) #endif #endif if (check_fwstate(pmlmepriv, WIFI_ASOC_STATE | WIFI_SITE_MONITOR) - || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) - || check_fwstate(pmlmepriv, WIFI_AP_STATE) - || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) -#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) - || rtw_cfg80211_get_is_roch(iface) == _TRUE -#elif defined(CONFIG_P2P) - || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) - || rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) -#endif -#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) - || rtw_get_passing_time_ms(pcfg80211_wdinfo->last_ro_ch_time) < 3000 -#endif - ) + || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) + || MLME_IS_AP(iface) + || MLME_IS_MESH(iface) + || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) + #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) + || rtw_cfg80211_get_is_roch(iface) == _TRUE + #elif defined(CONFIG_P2P) + || rtw_p2p_chk_state(pwdinfo, P2P_STATE_IDLE) + || rtw_p2p_chk_state(pwdinfo, P2P_STATE_LISTEN) + #endif + #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) + || rtw_get_passing_time_ms(pcfg80211_wdinfo->last_ro_ch_time) < 3000 + #endif + ) goto exit; } @@ -393,10 +389,9 @@ void rtw_ps_processor(_adapter *padapter) return; } -void pwr_state_check_handler(RTW_TIMER_HDL_ARGS); -void pwr_state_check_handler(RTW_TIMER_HDL_ARGS) +void pwr_state_check_handler(void *ctx) { - _adapter *padapter = (_adapter *)FunctionContext; + _adapter *padapter = (_adapter *)ctx; rtw_ps_cmd(padapter); } @@ -404,7 +399,7 @@ void pwr_state_check_handler(RTW_TIMER_HDL_ARGS) void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) { #ifdef CONFIG_CHECK_LEAVE_LPS - static u32 start_time = 0; + static systime start_time = 0; static u32 xmit_cnt = 0; u8 bLeaveLPS = _FALSE; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -456,6 +451,61 @@ void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets) #endif /* CONFIG_CHECK_LEAVE_LPS */ } +#ifdef CONFIG_LPS_LCLK +u8 rtw_cpwm_polling(_adapter *adapter, u8 cpwm_orig) +{ + u8 result = _FAIL; + u8 cpwm_now; + u8 poll_cnt = 0; + systime start_time; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + struct debug_priv *pdbgpriv = &(adapter_to_dvobj(adapter)->drv_dbg); + + /*RTW_INFO("%s.....\n", __func__);*/ + + start_time = rtw_get_current_time(); + + /* polling cpwm */ + do { + rtw_msleep_os(1); + poll_cnt++; + cpwm_now = 0; + rtw_hal_get_hwreg(adapter, HW_VAR_CPWM, &cpwm_now); + + if ((cpwm_orig ^ cpwm_now) & 0x80) { + pwrpriv->cpwm = PS_STATE_S4; + pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; + #ifdef DBG_CHECK_FW_PS_STATE + RTW_INFO("%s: polling cpwm OK! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" + , __func__, poll_cnt, cpwm_orig, cpwm_now, rtw_read8(adapter, REG_CR)); + if (rtw_fw_ps_state(adapter) == _FAIL) { + RTW_INFO("leave 32k but fw state in 32k\n"); + pdbgpriv->dbg_rpwm_toogle_cnt++; + } + #endif /* DBG_CHECK_FW_PS_STATE */ + result = _SUCCESS; + break; + } + + if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) { + RTW_ERR("%s: polling cpwm timeout! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x\n" + , __func__, poll_cnt, cpwm_orig, cpwm_now); + #ifdef DBG_CHECK_FW_PS_STATE + if (rtw_fw_ps_state(adapter) == _FAIL) { + RTW_INFO("rpwm timeout and fw ps state in 32k\n"); + pdbgpriv->dbg_rpwm_timeout_fail_cnt++; + } + #endif /* DBG_CHECK_FW_PS_STATE */ + + #ifdef CONFIG_LPS_RPWM_TIMER + _set_timer(&pwrpriv->pwr_rpwm_timer, 1); + #endif /* CONFIG_LPS_RPWM_TIMER */ + break; + } + } while (1); + return result; +} +#endif /* * Description: * This function MUST be called under power lock protect @@ -469,9 +519,9 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) { u8 rpwm; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); -#ifdef CONFIG_DETECT_CPWM_BY_POLLING +#ifdef CONFIG_LPS_LCLK u8 cpwm_orig; -#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ +#endif struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; @@ -487,6 +537,7 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) #ifdef CONFIG_LPS_LCLK || ((pwrpriv->rpwm >= PS_STATE_S2) && (pslv >= PS_STATE_S2)) #endif + || (pwrpriv->lps_level == LPS_NORMAL) ) { return; } @@ -500,12 +551,9 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) return; } - if (rtw_is_drv_stopped(padapter)) { - - if (pslv < PS_STATE_S2) { + if (rtw_is_drv_stopped(padapter)) + if (pslv < PS_STATE_S2) return; - } - } rpwm = pslv | pwrpriv->tog; #ifdef CONFIG_LPS_LCLK @@ -516,7 +564,7 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) pwrpriv->rpwm = pslv; -#ifdef CONFIG_DETECT_CPWM_BY_POLLING +#ifdef CONFIG_LPS_LCLK cpwm_orig = 0; if (rpwm & PS_ACK) rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); @@ -534,47 +582,15 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) /* No LPS 32K, No Ack */ if (rpwm & PS_ACK) { #ifdef CONFIG_DETECT_CPWM_BY_POLLING - u32 start_time; - u8 cpwm_now; - u8 poll_cnt = 0; - - start_time = rtw_get_current_time(); - - /* polling cpwm */ - do { - rtw_msleep_os(1); - poll_cnt++; - cpwm_now = 0; - rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now); - if ((cpwm_orig ^ cpwm_now) & 0x80) { - pwrpriv->cpwm = PS_STATE_S4; - pwrpriv->cpwm_tog = cpwm_now & PS_TOGGLE; -#ifdef DBG_CHECK_FW_PS_STATE - RTW_INFO("%s: polling cpwm OK! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x , 0x100=0x%x\n" - , __FUNCTION__, poll_cnt, cpwm_orig, cpwm_now, rtw_read8(padapter, REG_CR)); - if (rtw_fw_ps_state(padapter) == _FAIL) { - RTW_INFO("leave 32k but fw state in 32k\n"); - pdbgpriv->dbg_rpwm_toogle_cnt++; - } -#endif /* DBG_CHECK_FW_PS_STATE */ - break; - } - - if (rtw_get_passing_time_ms(start_time) > LPS_RPWM_WAIT_MS) { - RTW_INFO("%s: polling cpwm timeout! poll_cnt=%d, cpwm_orig=%02x, cpwm_now=%02x\n", __FUNCTION__, poll_cnt, cpwm_orig, cpwm_now); -#ifdef DBG_CHECK_FW_PS_STATE - if (rtw_fw_ps_state(padapter) == _FAIL) { - RTW_INFO("rpwm timeout and fw ps state in 32k\n"); - pdbgpriv->dbg_rpwm_timeout_fail_cnt++; - } -#endif /* DBG_CHECK_FW_PS_STATE */ -#ifdef CONFIG_LPS_RPWM_TIMER - _set_timer(&pwrpriv->pwr_rpwm_timer, 1); -#endif /* CONFIG_LPS_RPWM_TIMER */ - break; - } - } while (1); -#endif /* CONFIG_DETECT_CPWM_BY_POLLING */ + rtw_cpwm_polling(padapter, cpwm_orig); + #else + #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN) + if (pwrpriv->wowlan_mode == _TRUE || + pwrpriv->wowlan_ap_mode == _TRUE || + pwrpriv->wowlan_p2p_mode == _TRUE) + rtw_cpwm_polling(padapter, cpwm_orig); + #endif /*#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_P2P_WOWLAN)*/ + #endif /*#ifdef CONFIG_DETECT_CPWM_BY_POLLING*/ } else #endif /* CONFIG_LPS_LCLK */ { @@ -585,7 +601,7 @@ void rtw_set_rpwm(PADAPTER padapter, u8 pslv) u8 PS_RDY_CHECK(_adapter *padapter) { - u32 curr_time, delta_time; + u32 delta_ms; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); #ifdef CONFIG_P2P @@ -607,26 +623,24 @@ u8 PS_RDY_CHECK(_adapter *padapter) return _FALSE; #endif - curr_time = rtw_get_current_time(); - - delta_time = curr_time - pwrpriv->DelayLPSLastTimeStamp; - - if (delta_time < LPS_DELAY_TIME) + delta_ms = rtw_get_passing_time_ms(pwrpriv->DelayLPSLastTimeStamp); + if (delta_ms < LPS_DELAY_MS) return _FALSE; if (check_fwstate(pmlmepriv, WIFI_SITE_MONITOR) - || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) - || check_fwstate(pmlmepriv, WIFI_AP_STATE) - || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) -#if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) - || rtw_cfg80211_get_is_roch(padapter) == _TRUE -#endif - || rtw_is_scan_deny(padapter) -#ifdef CONFIG_TDLS - /* TDLS link is established. */ - || (padapter->tdlsinfo.link_established == _TRUE) -#endif /* CONFIG_TDLS */ - ) + || check_fwstate(pmlmepriv, WIFI_UNDER_LINKING | WIFI_UNDER_WPS) + || MLME_IS_AP(padapter) + || MLME_IS_MESH(padapter) + || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE | WIFI_ADHOC_STATE) + #if defined(CONFIG_P2P) && defined(CONFIG_IOCTL_CFG80211) + || rtw_cfg80211_get_is_roch(padapter) == _TRUE + #endif + || rtw_is_scan_deny(padapter) + #ifdef CONFIG_TDLS + /* TDLS link is established. */ + || (padapter->tdlsinfo.link_established == _TRUE) + #endif /* CONFIG_TDLS */ + ) return _FALSE; if ((padapter->securitypriv.dot11AuthAlgrthm == dot11AuthAlgrthm_8021X) && (padapter->securitypriv.binstallGrpkey == _FALSE)) { @@ -647,7 +661,7 @@ void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); int cnt = 0; - u32 start_time; + systime start_time; u8 val8 = 0; u8 cpwm_orig = 0, cpwm_now = 0; u8 parm[H2C_INACTIVE_PS_LEN] = {0}; @@ -689,11 +703,11 @@ void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable) /* H2C done, enter 32k */ if (val8 == 0) { /* ser rpwm to enter 32k */ - val8 = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1); + rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &val8); RTW_INFO("%s: read rpwm=%02x\n", __FUNCTION__, val8); val8 += 0x80; val8 |= BIT(0); - rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1, val8); + rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&val8)); RTW_INFO("%s: write rpwm=%02x\n", __FUNCTION__, val8); adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; cnt = val8 = 0; @@ -722,11 +736,10 @@ void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable) rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig); /* ser rpwm */ - val8 = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1); - val8 &= 0x80; + rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &val8); val8 += 0x80; val8 |= BIT(6); - rtw_write8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1, val8); + rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&val8)); RTW_INFO("%s: write rpwm=%02x\n", __FUNCTION__, val8); adapter_to_pwrctl(padapter)->tog = (val8 + 0x80) & 0x80; @@ -764,6 +777,7 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + struct registry_priv *pregistrypriv = &padapter->registrypriv; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #endif /* CONFIG_P2P */ @@ -774,6 +788,9 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode _list *plist, *phead; struct sta_info *ptdls_sta; #endif /* CONFIG_TDLS */ +#ifdef CONFIG_LPS_PG + u8 lps_pg_hdl_id = 0; +#endif @@ -786,15 +803,28 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode return; #ifndef CONFIG_BT_COEXIST - if ((pwrpriv->smart_ps == smart_ps) && - (pwrpriv->bcn_ant_mode == bcn_ant_mode)) - return; +#ifdef CONFIG_WMMPS_STA + if (!rtw_is_wmmps_mode(padapter)) +#endif /* CONFIG_WMMPS_STA */ + if ((pwrpriv->smart_ps == smart_ps) && + (pwrpriv->bcn_ant_mode == bcn_ant_mode)) + return; #endif /* !CONFIG_BT_COEXIST */ } +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + if (PS_MODE_ACTIVE != ps_mode) { + rtw_set_ps_rsvd_page(padapter); + rtw_set_default_port_id(padapter); + } +#endif + #ifdef CONFIG_LPS_PG - if ((PS_MODE_ACTIVE != ps_mode) && (pwrpriv->blpspg_info_up)) - rtw_hal_set_lps_pg_info(padapter); + if ((PS_MODE_ACTIVE != ps_mode) && (pwrpriv->blpspg_info_up)) { + /*rtw_hal_set_lps_pg_info(padapter);*/ + lps_pg_hdl_id = LPS_PG_INFO_CFG; + rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); + } #endif #ifdef CONFIG_LPS_LCLK @@ -835,7 +865,7 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) - issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); + issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 0, 0, 0); plist = get_next(plist); } } @@ -848,7 +878,8 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode if (pwrpriv->wowlan_mode == _TRUE || pwrpriv->wowlan_ap_mode == _TRUE || pwrpriv->wowlan_p2p_mode == _TRUE) { - u32 start_time, delay_ms; + systime start_time; + u32 delay_ms; u8 val8; delay_ms = 20; start_time = rtw_get_current_time(); @@ -867,8 +898,22 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode rtw_usleep_os(100); } while (1); } +#endif +#ifdef CONFIG_LPS_PG + if (pwrpriv->lps_level == LPS_PG) { + lps_pg_hdl_id = LPS_PG_REDLEMEM; + rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); + } #endif rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); + +#ifdef CONFIG_LPS_PG + if (pwrpriv->lps_level == LPS_PG) { + lps_pg_hdl_id = LPS_PG_RESEND_H2C; + rtw_hal_set_hwreg(padapter, HW_VAR_LPS_PG_HANDLE, (u8 *)(&lps_pg_hdl_id)); + } +#endif + #ifdef CONFIG_LPS_POFF rtw_hal_set_hwreg(padapter, HW_VAR_LPS_POFF_SET_MODE, (u8 *)(&ps_mode)); @@ -908,7 +953,7 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode ptdls_sta = LIST_CONTAINOR(plist, struct sta_info, hash_list); if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) - issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 0, 0); + issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 1, 0, 0); plist = get_next(plist); } } @@ -927,6 +972,11 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode pwrpriv->pwr_mode = ps_mode; pwrpriv->smart_ps = smart_ps; pwrpriv->bcn_ant_mode = bcn_ant_mode; + +#ifdef CONFIG_WMMPS_STA + pwrpriv->wmm_smart_ps = pregistrypriv->wmm_smart_ps; +#endif /* CONFIG_WMMPS_STA */ + rtw_hal_set_hwreg(padapter, HW_VAR_H2C_FW_PWRMODE, (u8 *)(&ps_mode)); #ifdef CONFIG_P2P_PS @@ -971,7 +1021,7 @@ void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode */ s32 LPS_RF_ON_check(PADAPTER padapter, u32 delay_ms) { - u32 start_time; + systime start_time; u8 bAwake = _FALSE; s32 err = 0; @@ -1014,7 +1064,7 @@ void LPS_Enter(PADAPTER padapter, const char *msg) /* RTW_INFO("+LeisurePSEnter\n"); */ - if (_FALSE == padapter->bFWReady) + if (GET_HAL_DATA(padapter)->bFWReady == _FALSE) return; #ifdef CONFIG_BT_COEXIST @@ -1030,9 +1080,11 @@ void LPS_Enter(PADAPTER padapter, const char *msg) if (n_assoc_iface != 1) return; +#ifndef CONFIG_FW_MULTI_PORT_SUPPORT /* Skip lps enter request for adapter not port0 */ if (get_hw_port(padapter) != HW_PORT0) return; +#endif for (i = 0; i < dvobj->iface_nums; i++) { if (PS_RDY_CHECK(dvobj->padapters[i]) == _FALSE) @@ -1049,6 +1101,12 @@ void LPS_Enter(PADAPTER padapter, const char *msg) /* Idle for a while if we connect to AP a while ago. */ if (pwrpriv->LpsIdleCount >= 2) { /* 4 Sec */ if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) { + +#ifdef CONFIG_WMMPS_STA + if (rtw_is_wmmps_mode(padapter)) + msg = "WMMPS_IDLE"; +#endif /* CONFIG_WMMPS_STA */ + sprintf(buf, "WIFI-%s", msg); pwrpriv->bpower_saving = _TRUE; rtw_set_ps_mode(padapter, pwrpriv->power_mgnt, padapter->registrypriv.smart_ps, 0, buf); @@ -1086,6 +1144,12 @@ void LPS_Leave(PADAPTER padapter, const char *msg) if (pwrpriv->bLeisurePs) { if (pwrpriv->pwr_mode != PS_MODE_ACTIVE) { + +#ifdef CONFIG_WMMPS_STA + if (rtw_is_wmmps_mode(padapter)) + msg = "WMMPS_BUSY"; +#endif /* CONFIG_WMMPS_STA */ + sprintf(buf, "WIFI-%s", msg); rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, buf); @@ -1104,6 +1168,20 @@ void LPS_Leave(PADAPTER padapter, const char *msg) * RTW_INFO("-LeisurePSLeave\n"); */ } + +void rtw_wow_lps_level_decide(_adapter *adapter, u8 wow_en) +{ +#if defined(CONFIG_USB_HCI) && defined(CONFIG_LPS_LCLK) + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); + + if (wow_en) { + pwrpriv->lps_level_bk = pwrpriv->lps_level; + pwrpriv->lps_level = LPS_LCLK; + } else + pwrpriv->lps_level = pwrpriv->lps_level_bk; +#endif +} #endif void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) @@ -1115,7 +1193,7 @@ void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; #ifndef CONFIG_DETECT_CPWM_BY_POLLING u8 cpwm_orig, cpwm_now; - u32 start_time; + systime start_time; #endif /* CONFIG_DETECT_CPWM_BY_POLLING */ @@ -1200,7 +1278,7 @@ void LeaveAllPowerSaveModeDirect(PADAPTER Adapter) } else #endif { -#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) +#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_RTL8188E) #ifdef CONFIG_IPS if (_FALSE == ips_leave(pri_padapter)) RTW_INFO("======> ips_leave fail.............\n"); @@ -1250,7 +1328,13 @@ void LeaveAllPowerSaveMode(IN PADAPTER Adapter) #endif #ifdef CONFIG_P2P_PS - p2p_ps_wk_cmd(Adapter, P2P_PS_DISABLE, enqueue); + for (i = 0; i < dvobj->iface_nums; i++) { + _adapter *iface = dvobj->padapters[i]; + struct wifidirect_info *pwdinfo = &(iface->wdinfo); + + if (pwdinfo->p2p_ps_mode > P2P_PS_NONE) + p2p_ps_wk_cmd(iface, P2P_PS_DISABLE, enqueue); + } #endif /* CONFIG_P2P_PS */ #ifdef CONFIG_LPS @@ -1289,7 +1373,7 @@ void LPS_Leave_check( PADAPTER padapter) { struct pwrctrl_priv *pwrpriv; - u32 start_time; + systime start_time; u8 bReady; @@ -1339,6 +1423,11 @@ void cpwm_int_hdl( { struct pwrctrl_priv *pwrpriv; + if (!padapter) + goto exit; + + if (RTW_CANNOT_RUN(padapter)) + goto exit; pwrpriv = adapter_to_pwrctl(padapter); #if 0 @@ -1378,7 +1467,7 @@ static void cpwm_event_callback(struct work_struct *work) { struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, cpwm_event); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); - _adapter *adapter = dvobj->padapters[IFACE_ID0]; + _adapter *adapter = dvobj_get_primary_adapter(dvobj); struct reportpwrstate_parm report; /* RTW_INFO("%s\n",__FUNCTION__); */ @@ -1387,6 +1476,15 @@ static void cpwm_event_callback(struct work_struct *work) cpwm_int_hdl(adapter, &report); } +static void dma_event_callback(struct work_struct *work) +{ + struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, dma_event); + struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); + _adapter *adapter = dvobj_get_primary_adapter(dvobj); + + rtw_unregister_tx_alive(adapter); +} + #ifdef CONFIG_LPS_RPWM_TIMER static void rpwmtimeout_workitem_callback(struct work_struct *work) { @@ -1397,9 +1495,15 @@ static void rpwmtimeout_workitem_callback(struct work_struct *work) pwrpriv = container_of(work, struct pwrctrl_priv, rpwmtimeoutwi); dvobj = pwrctl_to_dvobj(pwrpriv); - padapter = dvobj->padapters[IFACE_ID0]; + padapter = dvobj_get_primary_adapter(dvobj); /* RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); */ + if (!padapter) + return; + + if (RTW_CANNOT_RUN(padapter)) + return; + _enter_pwrlock(&pwrpriv->lock); if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { RTW_INFO("%s: rpwm=0x%02X cpwm=0x%02X CPWM done!\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); @@ -1446,6 +1550,12 @@ static void pwr_rpwm_timeout_handler(void *FunctionContext) padapter = (PADAPTER)FunctionContext; pwrpriv = adapter_to_pwrctl(padapter); + if (!padapter) + return; + + if (RTW_CANNOT_RUN(padapter)) + return; + RTW_INFO("+%s: rpwm=0x%02X cpwm=0x%02X\n", __func__, pwrpriv->rpwm, pwrpriv->cpwm); if ((pwrpriv->rpwm == pwrpriv->cpwm) || (pwrpriv->cpwm >= PS_STATE_S2)) { @@ -1881,7 +1991,8 @@ void rtw_unregister_evt_alive(PADAPTER padapter) void rtw_init_pwrctrl_priv(PADAPTER padapter) { struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); - int i = 0; + struct registry_priv *registry_par = &padapter->registrypriv; + u8 val8 = 0; #if defined(CONFIG_CONCURRENT_MODE) @@ -1905,10 +2016,14 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) pwrctrlpriv->ips_mode = padapter->registrypriv.ips_mode; pwrctrlpriv->ips_mode_req = padapter->registrypriv.ips_mode; + pwrctrlpriv->ips_deny_time = rtw_get_current_time(); + pwrctrlpriv->lps_level = padapter->registrypriv.lps_level; pwrctrlpriv->pwr_state_check_interval = RTW_PWR_STATE_CHK_INTERVAL; pwrctrlpriv->pwr_state_check_cnts = 0; + #ifdef CONFIG_AUTOSUSPEND pwrctrlpriv->bInternalAutoSuspend = _FALSE; + #endif pwrctrlpriv->bInSuspend = _FALSE; pwrctrlpriv->bkeepfwalive = _FALSE; @@ -1948,18 +2063,21 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) _init_workitem(&pwrctrlpriv->cpwm_event, cpwm_event_callback, NULL); + _init_workitem(&pwrctrlpriv->dma_event, dma_event_callback, NULL); + #ifdef CONFIG_LPS_RPWM_TIMER pwrctrlpriv->brpwmtimeout = _FALSE; _init_workitem(&pwrctrlpriv->rpwmtimeoutwi, rpwmtimeout_workitem_callback, NULL); - _init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter->pnetdev, pwr_rpwm_timeout_handler, padapter); + rtw_init_timer(&pwrctrlpriv->pwr_rpwm_timer, padapter, pwr_rpwm_timeout_handler, padapter); #endif /* CONFIG_LPS_RPWM_TIMER */ #endif /* CONFIG_LPS_LCLK */ - rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler); + rtw_init_timer(&pwrctrlpriv->pwr_state_check_timer, padapter, pwr_state_check_handler, padapter); pwrctrlpriv->wowlan_mode = _FALSE; pwrctrlpriv->wowlan_ap_mode = _FALSE; pwrctrlpriv->wowlan_p2p_mode = _FALSE; + pwrctrlpriv->wowlan_in_resume = _FALSE; pwrctrlpriv->wowlan_last_wake_reason = 0; #ifdef CONFIG_RESUME_IN_WORKQUEUE @@ -1975,30 +2093,38 @@ void rtw_init_pwrctrl_priv(PADAPTER padapter) #ifdef CONFIG_GPIO_WAKEUP /*default low active*/ pwrctrlpriv->is_high_active = HIGH_ACTIVE; + + #ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE + if (pwrctrlpriv->is_high_active == 0) + rtw_hal_set_input_gpio(padapter, WAKEUP_GPIO_IDX); + else + rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, 0); + #else val8 = (pwrctrlpriv->is_high_active == 0) ? 1 : 0; rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); RTW_INFO("%s: set GPIO_%d %d as default.\n", __func__, WAKEUP_GPIO_IDX, val8); + #endif /*CONFIG_WAKEUP_GPIO_INPUT_MODE*/ #endif /* CONFIG_GPIO_WAKEUP */ #ifdef CONFIG_WOWLAN - pwrctrlpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; - pwrctrlpriv->wowlan_in_resume = _FALSE; - for (i = 0 ; i < MAX_WKFM_NUM; i++) { - _rtw_memset(pwrctrlpriv->patterns[i].content, '\0', - sizeof(pwrctrlpriv->patterns[i].content)); - _rtw_memset(pwrctrlpriv->patterns[i].mask, '\0', - sizeof(pwrctrlpriv->patterns[i].mask)); - pwrctrlpriv->patterns[i].len = 0; - } + if (registry_par->wakeup_event & BIT(1)) + pwrctrlpriv->default_patterns_en = _TRUE; + else + pwrctrlpriv->default_patterns_en = _FALSE; + + rtw_wow_pattern_sw_reset(padapter); #ifdef CONFIG_PNO_SUPPORT pwrctrlpriv->pno_inited = _FALSE; pwrctrlpriv->pnlo_info = NULL; pwrctrlpriv->pscan_info = NULL; pwrctrlpriv->pno_ssid_list = NULL; #endif /* CONFIG_PNO_SUPPORT */ +#ifdef CONFIG_WOW_PATTERN_HW_CAM + _rtw_mutex_init(&pwrctrlpriv->wowlan_pattern_cam_mutex); +#endif pwrctrlpriv->wowlan_aoac_rpt_loc = 0; #endif /* CONFIG_WOWLAN */ @@ -2045,6 +2171,10 @@ void rtw_free_pwrctrl_priv(PADAPTER adapter) if (pwrctrlpriv->pno_ssid_list != NULL) printk("****** pno_ssid_list memory leak********\n"); #endif +#ifdef CONFIG_WOW_PATTERN_HW_CAM + _rtw_mutex_free(&pwrctrlpriv->wowlan_pattern_cam_mutex); +#endif + #endif /* CONFIG_WOWLAN */ #if defined(CONFIG_HAS_EARLYSUSPEND) || defined(CONFIG_ANDROID_POWER) @@ -2063,7 +2193,7 @@ static void resume_workitem_callback(struct work_struct *work) { struct pwrctrl_priv *pwrpriv = container_of(work, struct pwrctrl_priv, resume_work); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); - _adapter *adapter = dvobj->padapters[IFACE_ID0]; + _adapter *adapter = dvobj_get_primary_adapter(dvobj); RTW_INFO("%s\n", __FUNCTION__); @@ -2118,7 +2248,7 @@ static void rtw_late_resume(struct early_suspend *h) { struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); - _adapter *adapter = dvobj->padapters[IFACE_ID0]; + _adapter *adapter = dvobj_get_primary_adapter(dvobj); RTW_INFO("%s\n", __FUNCTION__); @@ -2171,7 +2301,7 @@ static void rtw_late_resume(android_early_suspend_t *h) { struct pwrctrl_priv *pwrpriv = container_of(h, struct pwrctrl_priv, early_suspend); struct dvobj_priv *dvobj = pwrctl_to_dvobj(pwrpriv); - _adapter *adapter = dvobj->padapters[IFACE_ID0]; + _adapter *adapter = dvobj_get_primary_adapter(dvobj); RTW_INFO("%s\n", __FUNCTION__); if (pwrpriv->do_late_resume) { @@ -2236,7 +2366,7 @@ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) struct mlme_priv *pmlmepriv; int ret = _SUCCESS; int i; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); /* for LPS */ LeaveAllPowerSaveMode(padapter); @@ -2245,7 +2375,7 @@ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) padapter = GET_PRIMARY_ADAPTER(padapter); pmlmepriv = &padapter->mlmepriv; - if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) + if (time_after(rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms), pwrpriv->ips_deny_time)) pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); @@ -2271,7 +2401,11 @@ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) } #endif - if (pwrpriv->bInternalAutoSuspend == _FALSE && pwrpriv->bInSuspend) { + if (pwrpriv->bInSuspend + #ifdef CONFIG_AUTOSUSPEND + && pwrpriv->bInternalAutoSuspend == _FALSE + #endif + ) { RTW_INFO("%s wait bInSuspend...\n", __func__); while (pwrpriv->bInSuspend && ((rtw_get_passing_time_ms(start) <= 3000 && !rtw_is_do_late_resume(pwrpriv)) @@ -2285,17 +2419,21 @@ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) } /* System suspend is not allowed to wakeup */ - if ((pwrpriv->bInternalAutoSuspend == _FALSE) && (_TRUE == pwrpriv->bInSuspend)) { + if ((_TRUE == pwrpriv->bInSuspend) + #ifdef CONFIG_AUTOSUSPEND + && (pwrpriv->bInternalAutoSuspend == _FALSE) + #endif + ) { ret = _FAIL; goto exit; } - - /* block??? */ +#ifdef CONFIG_AUTOSUSPEND + /* usb autosuspend block??? */ if ((pwrpriv->bInternalAutoSuspend == _TRUE) && (padapter->net_closed == _TRUE)) { ret = _FAIL; goto exit; } - +#endif /* I think this should be check in IPS, LPS, autosuspend functions... */ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { #if defined(CONFIG_BT_COEXIST) && defined (CONFIG_AUTOSUSPEND) @@ -2363,7 +2501,7 @@ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller) } exit: - if (pwrpriv->ips_deny_time < rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms)) + if (time_after(rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms), pwrpriv->ips_deny_time)) pwrpriv->ips_deny_time = rtw_get_current_time() + rtw_ms_to_systime(ips_deffer_ms); return ret; @@ -2389,6 +2527,19 @@ int rtw_pm_set_lps(_adapter *padapter, u8 mode) return ret; } +int rtw_pm_set_lps_level(_adapter *padapter, u8 level) +{ + int ret = 0; + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); + + if (level < LPS_LEVEL_MAX) + pwrctrlpriv->lps_level = level; + else + ret = -EINVAL; + + return ret; +} + int rtw_pm_set_ips(_adapter *padapter, u8 mode) { struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_recv.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_recv.c index 3d65fd6cde82..9d70cd893273 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_recv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_recv.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_RECV_C_ #include @@ -30,7 +25,7 @@ #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS); +static void rtw_signal_stat_timer_hdl(void *ctx); enum { SIGNAL_STAT_CALC_PROFILE_0 = 0, @@ -79,6 +74,11 @@ sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter) _rtw_spinlock_init(&precvpriv->lock); +#ifdef CONFIG_RECV_THREAD_MODE + _rtw_init_sema(&precvpriv->recv_sema, 0); + +#endif + _rtw_init_queue(&precvpriv->free_recv_queue); _rtw_init_queue(&precvpriv->recv_pending_queue); _rtw_init_queue(&precvpriv->uc_swdec_pending_queue); @@ -139,7 +139,7 @@ sint _rtw_init_recv_priv(struct recv_priv *precvpriv, _adapter *padapter) res = rtw_hal_init_recv_priv(padapter); #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS - rtw_init_timer(&precvpriv->signal_stat_timer, padapter, RTW_TIMER_HDL_NAME(signal_stat)); + rtw_init_timer(&precvpriv->signal_stat_timer, padapter, rtw_signal_stat_timer_hdl, padapter); precvpriv->signal_stat_sampling_interval = 2000; /* ms */ /* precvpriv->signal_stat_converging_constant = 5000; */ /* ms */ @@ -160,7 +160,6 @@ void rtw_mfree_recv_priv_lock(struct recv_priv *precvpriv) _rtw_spinlock_free(&precvpriv->lock); #ifdef CONFIG_RECV_THREAD_MODE _rtw_free_sema(&precvpriv->recv_sema); - _rtw_free_sema(&precvpriv->terminate_recvthread_sema); #endif _rtw_spinlock_free(&precvpriv->free_recv_queue.lock); @@ -601,11 +600,11 @@ union recv_frame *decryptor(_adapter *padapter, union recv_frame *precv_frame) } } - if ((prxattrib->encrypt > 0) && ((prxattrib->bdecrypted == 0) || (psecuritypriv->sw_decrypt == _TRUE))) { + if (prxattrib->encrypt && !prxattrib->bdecrypted) { -#ifdef CONFIG_CONCURRENT_MODE - if (!IS_MCAST(prxattrib->ra)) /* bc/mc packets use sw decryption for concurrent mode */ -#endif + #ifdef CONFIG_CONCURRENT_MODE + if (!IS_MCAST(prxattrib->ra)) /* bc/mc packets may use sw decryption for concurrent mode */ + #endif psecuritypriv->hw_decrypted = _FALSE; #ifdef DBG_RX_SW_DECRYPTOR @@ -767,22 +766,27 @@ union recv_frame *portctrl(_adapter *adapter, union recv_frame *precv_frame) } -sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache); -sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcache *prxcache) +sint recv_decache(union recv_frame *precv_frame, u8 bretry) { - sint tid = precv_frame->u.hdr.attrib.priority; + struct sta_info *sta = precv_frame->u.hdr.psta; + struct stainfo_rxcache *prxcache = &sta->sta_recvpriv.rxcache; + sint tid = precv_frame->u.hdr.attrib.priority; u16 seq_ctrl = ((precv_frame->u.hdr.attrib.seq_num & 0xffff) << 4) | (precv_frame->u.hdr.attrib.frag_num & 0xf); - - if (tid > 15) { - + if (tid > 15) return _FAIL; - } if (1) { /* if(bretry) */ if (seq_ctrl == prxcache->tid_rxseq[tid]) { + /* for non-AMPDU case */ + sta->sta_stats.duplicate_cnt++; + + if (sta->sta_stats.duplicate_cnt % 100 == 0) + RTW_INFO("%s: tid=%u seq=%d frag=%d\n", __func__ + , tid, precv_frame->u.hdr.attrib.seq_num + , precv_frame->u.hdr.attrib.frag_num); return _FAIL; } @@ -795,58 +799,118 @@ sint recv_decache(union recv_frame *precv_frame, u8 bretry, struct stainfo_rxcac } -void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame); -void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame) +/* VALID_PN_CHK + * Return true when PN is legal, otherwise false. + * Legal PN: + * 1. If old PN is 0, any PN is legal + * 2. PN > old PN + */ +#define PN_LESS_CHK(a, b) (((a-b) & 0x800000000000) != 0) +#define VALID_PN_CHK(new, old) (((old) == 0) || PN_LESS_CHK(old, new)) +#define CCMPH_2_KEYID(ch) (((ch) & 0x00000000c0000000) >> 30) +#define CCMPH_2_PN(ch) ((ch) & 0x000000000000ffff) \ + | (((ch) & 0xffffffff00000000) >> 16) +sint recv_ucast_pn_decache(union recv_frame *precv_frame); +sint recv_ucast_pn_decache(union recv_frame *precv_frame) +{ + _adapter *padapter = precv_frame->u.hdr.adapter; + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + struct sta_info *sta = precv_frame->u.hdr.psta; + struct stainfo_rxcache *prxcache = &sta->sta_recvpriv.rxcache; + u8 *pdata = precv_frame->u.hdr.rx_data; + u32 data_len = precv_frame->u.hdr.len; + sint tid = precv_frame->u.hdr.attrib.priority; + u64 tmp_iv_hdr = 0; + u64 curr_pn = 0, pkt_pn = 0; + + if (tid > 15) + return _FAIL; + + if (pattrib->encrypt == _AES_) { + tmp_iv_hdr = le64_to_cpu(*(u64*)(pdata + pattrib->hdrlen)); + pkt_pn = CCMPH_2_PN(tmp_iv_hdr); + + tmp_iv_hdr = le64_to_cpu(*(u64*)prxcache->iv[tid]); + curr_pn = CCMPH_2_PN(tmp_iv_hdr); + + if (!VALID_PN_CHK(pkt_pn, curr_pn)) { + /* return _FAIL; */ + } else + _rtw_memcpy(prxcache->iv[tid], (pdata + pattrib->hdrlen), sizeof(prxcache->iv[tid])); + } + + return _SUCCESS; +} + +sint recv_bcast_pn_decache(union recv_frame *precv_frame); +sint recv_bcast_pn_decache(union recv_frame *precv_frame) +{ + _adapter *padapter = precv_frame->u.hdr.adapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct security_priv *psecuritypriv = &padapter->securitypriv; + struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + u8 *pdata = precv_frame->u.hdr.rx_data; + u32 data_len = precv_frame->u.hdr.len; + u64 tmp_iv_hdr = 0; + u64 curr_pn = 0, pkt_pn = 0; + u8 key_id; + + if ((pattrib->encrypt == _AES_) && + (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { + + tmp_iv_hdr = le64_to_cpu(*(u64*)(pdata + pattrib->hdrlen)); + key_id = CCMPH_2_KEYID(tmp_iv_hdr); + pkt_pn = CCMPH_2_PN(tmp_iv_hdr); + + curr_pn = le64_to_cpu(*(u64*)psecuritypriv->iv_seq[key_id]); + curr_pn &= 0x0000ffffffffffff; + + if (!VALID_PN_CHK(pkt_pn, curr_pn)) + return _FAIL; + + *(u64*)psecuritypriv->iv_seq[key_id] = cpu_to_le64(pkt_pn); + } + + return _SUCCESS; +} + +void process_pwrbit_data(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *psta) { #ifdef CONFIG_AP_MODE unsigned char pwrbit; u8 *ptr = precv_frame->u.hdr.rx_data; struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *psta = NULL; - - psta = rtw_get_stainfo(pstapriv, pattrib->src); pwrbit = GetPwrMgt(ptr); - if (psta) { - if (pwrbit) { - if (!(psta->state & WIFI_SLEEP_STATE)) { - /* psta->state |= WIFI_SLEEP_STATE; */ - /* pstapriv->sta_dz_bitmap |= BIT(psta->aid); */ + if (pwrbit) { + if (!(psta->state & WIFI_SLEEP_STATE)) { + /* psta->state |= WIFI_SLEEP_STATE; */ + /* pstapriv->sta_dz_bitmap |= BIT(psta->cmn.aid); */ - stop_sta_xmit(padapter, psta); + stop_sta_xmit(padapter, psta); - /* RTW_INFO("to sleep, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ - } - } else { - if (psta->state & WIFI_SLEEP_STATE) { - /* psta->state ^= WIFI_SLEEP_STATE; */ - /* pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); */ - - wakeup_sta_to_xmit(padapter, psta); - - /* RTW_INFO("to wakeup, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ - } + /* RTW_INFO("to sleep, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ } + } else { + if (psta->state & WIFI_SLEEP_STATE) { + /* psta->state ^= WIFI_SLEEP_STATE; */ + /* pstapriv->sta_dz_bitmap &= ~BIT(psta->cmn.aid); */ + wakeup_sta_to_xmit(padapter, psta); + + /* RTW_INFO("to wakeup, sta_dz_bitmap=%x\n", pstapriv->sta_dz_bitmap); */ + } } - #endif } -void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); -void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame) +void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *psta) { #ifdef CONFIG_AP_MODE struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *psta = NULL; - - psta = rtw_get_stainfo(pstapriv, pattrib->src); - - if (!psta) - return; #ifdef CONFIG_TDLS if (!(psta->tdls_sta_state & TDLS_LINKED_STATE)) { @@ -891,7 +955,7 @@ void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame) xmit_delivery_enabled_frames(padapter, psta); } else { /* issue one qos null frame with More data bit = 0 and the EOSP bit set (=1) */ - issue_qos_nulldata(padapter, psta->hwaddr, (u16)pattrib->priority, 0, 0); + issue_qos_nulldata(padapter, psta->cmn.mac_addr, (u16)pattrib->priority, 0, 0); } } @@ -913,6 +977,9 @@ sint OnTDLS(_adapter *adapter, union recv_frame *precv_frame) u8 WFA_OUI[3] = { 0x50, 0x6f, 0x9a }; #endif /* CONFIG_WFD */ struct tdls_info *ptdlsinfo = &(adapter->tdlsinfo); + u8 *ptr = precv_frame->u.hdr.rx_data; + struct sta_priv *pstapriv = &(adapter->stapriv); + struct sta_info *ptdls_sta = NULL; /* point to action field */ paction += pattrib->hdrlen @@ -930,41 +997,54 @@ sint OnTDLS(_adapter *adapter, union recv_frame *precv_frame) return ret; } - if (ptdlsinfo->tdls_enable == _FALSE) { + if (rtw_is_tdls_enabled(adapter) == _FALSE) { RTW_INFO("recv tdls frame, " "but tdls haven't enabled\n"); ret = _FAIL; return ret; } + ptdls_sta = rtw_get_stainfo(pstapriv, get_sa(ptr)); + if (ptdls_sta == NULL) { + switch (*paction) { + case TDLS_SETUP_REQUEST: + case TDLS_DISCOVERY_REQUEST: + break; + default: + RTW_INFO("[TDLS] %s - Direct Link Peer = "MAC_FMT" not found for action = %d\n", __func__, MAC_ARG(get_sa(ptr)), *paction); + ret = _FAIL; + goto exit; + } + } + switch (*paction) { case TDLS_SETUP_REQUEST: - ret = On_TDLS_Setup_Req(adapter, precv_frame); + ret = On_TDLS_Setup_Req(adapter, precv_frame, ptdls_sta); break; case TDLS_SETUP_RESPONSE: - ret = On_TDLS_Setup_Rsp(adapter, precv_frame); + ret = On_TDLS_Setup_Rsp(adapter, precv_frame, ptdls_sta); break; case TDLS_SETUP_CONFIRM: - ret = On_TDLS_Setup_Cfm(adapter, precv_frame); + ret = On_TDLS_Setup_Cfm(adapter, precv_frame, ptdls_sta); break; case TDLS_TEARDOWN: - ret = On_TDLS_Teardown(adapter, precv_frame); + ret = On_TDLS_Teardown(adapter, precv_frame, ptdls_sta); break; case TDLS_DISCOVERY_REQUEST: ret = On_TDLS_Dis_Req(adapter, precv_frame); break; case TDLS_PEER_TRAFFIC_INDICATION: - ret = On_TDLS_Peer_Traffic_Indication(adapter, precv_frame); + ret = On_TDLS_Peer_Traffic_Indication(adapter, precv_frame, ptdls_sta); break; case TDLS_PEER_TRAFFIC_RESPONSE: - ret = On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame); + ret = On_TDLS_Peer_Traffic_Rsp(adapter, precv_frame, ptdls_sta); break; #ifdef CONFIG_TDLS_CH_SW case TDLS_CHANNEL_SWITCH_REQUEST: - ret = On_TDLS_Ch_Switch_Req(adapter, precv_frame); + ret = On_TDLS_Ch_Switch_Req(adapter, precv_frame, ptdls_sta); break; case TDLS_CHANNEL_SWITCH_RESPONSE: - ret = On_TDLS_Ch_Switch_Rsp(adapter, precv_frame); + ret = On_TDLS_Ch_Switch_Rsp(adapter, precv_frame, ptdls_sta); break; #endif #ifdef CONFIG_WFD @@ -1024,25 +1104,25 @@ void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_in psta = prframe->u.hdr.psta; if (psta) { + u8 is_ra_bmc = IS_MCAST(pattrib->ra); + pstats = &psta->sta_stats; pstats->rx_data_pkts++; pstats->rx_bytes += sz; - - /*record rx packets for every tid*/ - pstats->rx_data_qos_pkts[pattrib->priority]++; - -#ifdef CONFIG_TDLS - if (psta->tdls_sta_state & TDLS_LINKED_STATE) { - struct sta_info *pap_sta = NULL; - pap_sta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); - if (pap_sta) { - pstats = &pap_sta->sta_stats; - pstats->rx_data_pkts++; - pstats->rx_bytes += sz; - } + if (is_broadcast_mac_addr(pattrib->ra)) { + pstats->rx_data_bc_pkts++; + pstats->rx_bc_bytes += sz; + } else if (is_ra_bmc) { + pstats->rx_data_mc_pkts++; + pstats->rx_mc_bytes += sz; + } + + if (!is_ra_bmc) { + pstats->rxratecnt[pattrib->data_rate]++; + /*record rx packets for every tid*/ + pstats->rx_data_qos_pkts[pattrib->priority]++; } -#endif /* CONFIG_TDLS */ } #ifdef CONFIG_CHECK_LEAVE_LPS @@ -1051,11 +1131,6 @@ void count_rx_stats(_adapter *padapter, union recv_frame *prframe, struct sta_in } -sint sta2sta_data_frame( - _adapter *adapter, - union recv_frame *precv_frame, - struct sta_info **psta -); sint sta2sta_data_frame( _adapter *adapter, union recv_frame *precv_frame, @@ -1069,7 +1144,7 @@ sint sta2sta_data_frame( struct mlme_priv *pmlmepriv = &adapter->mlmepriv; u8 *mybssid = get_bssid(pmlmepriv); u8 *myhwaddr = adapter_mac_addr(adapter); - u8 *sta_addr = NULL; + u8 *sta_addr = pattrib->ta; sint bmcast = IS_MCAST(pattrib->dst); #ifdef CONFIG_TDLS @@ -1107,14 +1182,12 @@ sint sta2sta_data_frame( goto exit; } - sta_addr = pattrib->src; - } else if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { #ifdef CONFIG_TDLS /* direct link data transfer */ if (ptdlsinfo->link_established == _TRUE) { - ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); + *psta = ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->ta); if (ptdls_sta == NULL) { ret = _FAIL; goto exit; @@ -1149,10 +1222,10 @@ sint sta2sta_data_frame( #endif /* process UAPSD tdls sta */ - process_pwrbit_data(adapter, precv_frame); + process_pwrbit_data(adapter, precv_frame, ptdls_sta); /* if NULL-frame, check pwrbit */ - if ((GetFrameSubType(ptr) & WIFI_DATA_NULL) == WIFI_DATA_NULL) { + if ((get_frame_sub_type(ptr) & WIFI_DATA_NULL) == WIFI_DATA_NULL) { /* NULL-frame with pwrbit=1, buffer_STA should buffer frames for sleep_STA */ if (GetPwrMgt(ptr)) { /* it would be triggered when we are off channel and receiving NULL DATA */ @@ -1174,15 +1247,12 @@ sint sta2sta_data_frame( goto exit; } - if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) - process_wmmps_data(adapter, precv_frame); + if ((get_frame_sub_type(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) + process_wmmps_data(adapter, precv_frame, ptdls_sta); ptdls_sta->tdls_sta_state &= ~(TDLS_WAIT_PTR_STATE); } - - sta_addr = pattrib->src; - } else #endif /* CONFIG_TDLS */ { @@ -1191,8 +1261,6 @@ sint sta2sta_data_frame( ret = _FAIL; goto exit; } - - sta_addr = pattrib->bssid; } } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { @@ -1208,13 +1276,11 @@ sint sta2sta_data_frame( ret = _FAIL; goto exit; } - - sta_addr = pattrib->src; } } else if (check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) { _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, get_addr2_ptr(ptr), ETH_ALEN); _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); @@ -1223,17 +1289,10 @@ sint sta2sta_data_frame( } else ret = _FAIL; - - - if (bmcast) - *psta = rtw_get_bcmc_stainfo(adapter); - else - *psta = rtw_get_stainfo(pstapriv, sta_addr); /* get ap_info */ - #ifdef CONFIG_TDLS - if (ptdls_sta != NULL) - *psta = ptdls_sta; -#endif /* CONFIG_TDLS */ + if (ptdls_sta == NULL) +#endif + *psta = rtw_get_stainfo(pstapriv, sta_addr); if (*psta == NULL) { #ifdef CONFIG_MP_INCLUDED @@ -1251,10 +1310,6 @@ sint sta2sta_data_frame( } -sint ap2sta_data_frame( - _adapter *adapter, - union recv_frame *precv_frame, - struct sta_info **psta); sint ap2sta_data_frame( _adapter *adapter, union recv_frame *precv_frame, @@ -1277,19 +1332,20 @@ sint ap2sta_data_frame( /* filter packets that SA is myself or multicast or broadcast */ if (_rtw_memcmp(myhwaddr, pattrib->src, ETH_ALEN)) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s SA="MAC_FMT", myhwaddr="MAC_FMT"\n", - __FUNCTION__, MAC_ARG(pattrib->src), MAC_ARG(myhwaddr)); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" SA="MAC_FMT", myhwaddr="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(pattrib->src), MAC_ARG(myhwaddr)); + #endif ret = _FAIL; goto exit; } /* da should be for me */ if ((!_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN)) && (!bmcast)) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s DA="MAC_FMT"\n", __func__, MAC_ARG(pattrib->dst)); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DA="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(pattrib->dst)); + #endif ret = _FAIL; goto exit; } @@ -1299,10 +1355,10 @@ sint ap2sta_data_frame( if (_rtw_memcmp(pattrib->bssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || _rtw_memcmp(mybssid, "\x0\x0\x0\x0\x0\x0", ETH_ALEN) || (!_rtw_memcmp(pattrib->bssid, mybssid, ETH_ALEN))) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s BSSID="MAC_FMT", mybssid="MAC_FMT"\n", - __func__, MAC_ARG(pattrib->bssid), MAC_ARG(mybssid)); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" BSSID="MAC_FMT", mybssid="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(pattrib->bssid), MAC_ARG(mybssid)); + #endif if (!bmcast) { RTW_INFO(ADPT_FMT" -issue_deauth to the nonassociated ap=" MAC_FMT " for the reason(7)\n", ADPT_ARG(adapter), MAC_ARG(pattrib->bssid)); @@ -1313,23 +1369,21 @@ sint ap2sta_data_frame( goto exit; } - if (bmcast) - *psta = rtw_get_bcmc_stainfo(adapter); - else - *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get ap_info */ - + *psta = rtw_get_stainfo(pstapriv, pattrib->ta); if (*psta == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under STATION_MODE ; drop pkt\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" can't get psta under STATION_MODE ; drop pkt\n" + , FUNC_ADPT_ARG(adapter)); + #endif ret = _FAIL; goto exit; } - if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { + /*if ((get_frame_sub_type(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) { } + */ - if (GetFrameSubType(ptr) & BIT(6)) { + if (get_frame_sub_type(ptr) & BIT(6)) { /* No data, will not indicate to upper layer, temporily count it here */ count_rx_stats(adapter, precv_frame, *psta); ret = RTW_RX_HANDLED; @@ -1339,7 +1393,7 @@ sint ap2sta_data_frame( } else if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE) && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, get_addr2_ptr(ptr), ETH_ALEN); _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); @@ -1347,9 +1401,10 @@ sint ap2sta_data_frame( *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ if (*psta == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" can't get psta under WIFI_MP_STATE ; drop pkt\n" + , FUNC_ADPT_ARG(adapter)); + #endif ret = _FAIL; goto exit; } @@ -1361,11 +1416,11 @@ sint ap2sta_data_frame( goto exit; } else { if (_rtw_memcmp(myhwaddr, pattrib->dst, ETH_ALEN) && (!bmcast)) { - *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ + *psta = rtw_get_stainfo(pstapriv, pattrib->ta); if (*psta == NULL) { /* for AP multicast issue , modify by yiwei */ - static u32 send_issue_deauth_time = 0; + static systime send_issue_deauth_time = 0; /* RTW_INFO("After send deauth , %u ms has elapsed.\n", rtw_get_passing_time_ms(send_issue_deauth_time)); */ @@ -1380,9 +1435,10 @@ sint ap2sta_data_frame( } ret = _FAIL; -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s fw_state:0x%x\n", __FUNCTION__, get_fwstate(pmlmepriv)); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" fw_state:0x%x\n" + , FUNC_ADPT_ARG(adapter), get_fwstate(pmlmepriv)); + #endif } exit: @@ -1392,10 +1448,6 @@ sint ap2sta_data_frame( } -sint sta2ap_data_frame( - _adapter *adapter, - union recv_frame *precv_frame, - struct sta_info **psta); sint sta2ap_data_frame( _adapter *adapter, union recv_frame *precv_frame, @@ -1416,7 +1468,7 @@ sint sta2ap_data_frame( goto exit; } - *psta = rtw_get_stainfo(pstapriv, pattrib->src); + *psta = rtw_get_stainfo(pstapriv, pattrib->ta); if (*psta == NULL) { #ifdef CONFIG_DFS_MASTER struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); @@ -1437,12 +1489,12 @@ sint sta2ap_data_frame( goto exit; } - process_pwrbit_data(adapter, precv_frame); + process_pwrbit_data(adapter, precv_frame, *psta); - if ((GetFrameSubType(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) - process_wmmps_data(adapter, precv_frame); + if ((get_frame_sub_type(ptr) & WIFI_QOS_DATA_TYPE) == WIFI_QOS_DATA_TYPE) + process_wmmps_data(adapter, precv_frame, *psta); - if (GetFrameSubType(ptr) & BIT(6)) { + if (get_frame_sub_type(ptr) & BIT(6)) { /* No data, will not indicate to upper layer, temporily count it here */ count_rx_stats(adapter, precv_frame, *psta); ret = RTW_RX_HANDLED; @@ -1452,7 +1504,7 @@ sint sta2ap_data_frame( (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { /* RTW_INFO("%s ,in WIFI_MP_STATE\n",__func__); */ _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->src, GetAddr2Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, get_addr2_ptr(ptr), ETH_ALEN); _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); _rtw_memcpy(pattrib->ra, pattrib->dst, ETH_ALEN); _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); @@ -1460,9 +1512,10 @@ sint sta2ap_data_frame( *psta = rtw_get_stainfo(pstapriv, pattrib->bssid); /* get sta_info */ if (*psta == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s can't get psta under WIFI_MP_STATE ; drop pkt\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" can't get psta under WIFI_MP_STATE ; drop pkt\n" + , FUNC_ADPT_ARG(adapter)); + #endif ret = _FAIL; goto exit; } @@ -1504,7 +1557,7 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) if (!_rtw_memcmp(GetAddr1Ptr(pframe), adapter_mac_addr(padapter), ETH_ALEN)) return _FAIL; - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(pframe)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(pframe)); if (psta == NULL) return _FAIL; @@ -1512,13 +1565,13 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) psta->sta_stats.rx_ctrl_pkts++; /* only handle ps-poll */ - if (GetFrameSubType(pframe) == WIFI_PSPOLL) { + if (get_frame_sub_type(pframe) == WIFI_PSPOLL) { #ifdef CONFIG_AP_MODE u16 aid; u8 wmmps_ac = 0; aid = GetAid(pframe); - if (psta->aid != aid) + if (psta->cmn.aid != aid) return _FAIL; switch (pattrib->priority) { @@ -1550,7 +1603,7 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) psta->state ^= WIFI_STA_ALIVE_CHK_STATE; } - if ((psta->state & WIFI_SLEEP_STATE) && (pstapriv->sta_dz_bitmap & BIT(psta->aid))) { + if ((psta->state & WIFI_SLEEP_STATE) && (pstapriv->sta_dz_bitmap & BIT(psta->cmn.aid))) { _irqL irqL; _list *xmitframe_plist, *xmitframe_phead; struct xmit_frame *pxmitframe = NULL; @@ -1589,7 +1642,7 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) rtw_hal_xmitframe_enqueue(padapter, pxmitframe); if (psta->sleepq_len == 0) { - pstapriv->tim_bitmap &= ~BIT(psta->aid); + pstapriv->tim_bitmap &= ~BIT(psta->cmn.aid); /* RTW_INFO("after handling ps-poll, tim=%x\n", pstapriv->tim_bitmap); */ @@ -1606,18 +1659,18 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) _exit_critical_bh(&pxmitpriv->lock, &irqL); /* RTW_INFO("no buffered packets to xmit\n"); */ - if (pstapriv->tim_bitmap & BIT(psta->aid)) { + if (pstapriv->tim_bitmap & BIT(psta->cmn.aid)) { if (psta->sleepq_len == 0) { RTW_INFO("no buffered packets to xmit\n"); /* issue nulldata with More data bit = 0 to indicate we have no buffered packets */ - issue_nulldata_in_interrupt(padapter, psta->hwaddr, 0); + issue_nulldata(padapter, psta->cmn.mac_addr, 0, 0, 0); } else { RTW_INFO("error!psta->sleepq_len=%d\n", psta->sleepq_len); psta->sleepq_len = 0; } - pstapriv->tim_bitmap &= ~BIT(psta->aid); + pstapriv->tim_bitmap &= ~BIT(psta->cmn.aid); /* upate BCN for TIM IE */ /* update_BCNTIM(padapter); */ @@ -1626,9 +1679,9 @@ sint validate_recv_ctrl_frame(_adapter *padapter, union recv_frame *precv_frame) } } #endif /* CONFIG_AP_MODE */ - } else if (GetFrameSubType(pframe) == WIFI_NDPA) { + } else if (get_frame_sub_type(pframe) == WIFI_NDPA) { #ifdef CONFIG_BEAMFORMING - beamforming_get_ndpa_frame(padapter, precv_frame); + rtw_beamforming_get_ndpa_frame(padapter, precv_frame); #endif/*CONFIG_BEAMFORMING*/ } @@ -1642,18 +1695,6 @@ sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) { /* struct mlme_priv *pmlmepriv = &adapter->mlmepriv; */ - -#if 0 - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { -#ifdef CONFIG_NATIVEAP_MLME - mgt_dispatcher(padapter, precv_frame); -#else - rtw_hostapd_mlme_rx(padapter, precv_frame); -#endif - } else - mgt_dispatcher(padapter, precv_frame); -#endif - precv_frame = recvframe_chk_defrag(padapter, precv_frame); if (precv_frame == NULL) { return _SUCCESS; @@ -1661,14 +1702,14 @@ sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) { /* for rx pkt statistics */ - struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, GetAddr2Ptr(precv_frame->u.hdr.rx_data)); + struct sta_info *psta = rtw_get_stainfo(&padapter->stapriv, get_addr2_ptr(precv_frame->u.hdr.rx_data)); if (psta) { psta->sta_stats.rx_mgnt_pkts++; - if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_BEACON) + if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_BEACON) psta->sta_stats.rx_beacon_pkts++; - else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) + else if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_PROBEREQ) psta->sta_stats.rx_probereq_pkts++; - else if (GetFrameSubType(precv_frame->u.hdr.rx_data) == WIFI_PROBERSP) { + else if (get_frame_sub_type(precv_frame->u.hdr.rx_data) == WIFI_PROBERSP) { if (_rtw_memcmp(adapter_mac_addr(padapter), GetAddr1Ptr(precv_frame->u.hdr.rx_data), ETH_ALEN) == _TRUE) psta->sta_stats.rx_probersp_pkts++; else if (is_broadcast_mac_addr(GetAddr1Ptr(precv_frame->u.hdr.rx_data)) @@ -1714,7 +1755,7 @@ sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) case 3: _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); break; default: @@ -1733,11 +1774,9 @@ sint validate_recv_mgnt_frame(PADAPTER padapter, union recv_frame *precv_frame) } -sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame); sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) { u8 bretry; - u8 *psa, *pda, *pbssid; struct sta_info *psta = NULL; u8 *ptr = precv_frame->u.hdr.rx_data; struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; @@ -1745,75 +1784,62 @@ sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) struct security_priv *psecuritypriv = &adapter->securitypriv; sint ret = _SUCCESS; - bretry = GetRetry(ptr); - pda = get_da(ptr); - psa = get_sa(ptr); - pbssid = get_hdr_bssid(ptr); - - if (pbssid == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s pbssid == NULL\n", __func__); -#endif - ret = _FAIL; - goto exit; - } - - _rtw_memcpy(pattrib->dst, pda, ETH_ALEN); - _rtw_memcpy(pattrib->src, psa, ETH_ALEN); - - _rtw_memcpy(pattrib->bssid, pbssid, ETH_ALEN); switch (pattrib->to_fr_ds) { case 0: - _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); - _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); + _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, get_addr2_ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->bssid, GetAddr3Ptr(ptr), ETH_ALEN); ret = sta2sta_data_frame(adapter, precv_frame, &psta); break; case 1: - _rtw_memcpy(pattrib->ra, pda, ETH_ALEN); - _rtw_memcpy(pattrib->ta, pbssid, ETH_ALEN); + _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->dst, GetAddr1Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, GetAddr3Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->bssid, get_addr2_ptr(ptr), ETH_ALEN); ret = ap2sta_data_frame(adapter, precv_frame, &psta); break; case 2: - _rtw_memcpy(pattrib->ra, pbssid, ETH_ALEN); - _rtw_memcpy(pattrib->ta, psa, ETH_ALEN); + _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->dst, GetAddr3Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->src, get_addr2_ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->bssid, GetAddr1Ptr(ptr), ETH_ALEN); ret = sta2ap_data_frame(adapter, precv_frame, &psta); break; case 3: - _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); - ret = _FAIL; - break; - default: + /* WDS is not supported */ ret = _FAIL; break; - } if (ret == _FAIL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s case:%d, res:%d\n", __FUNCTION__, pattrib->to_fr_ds, ret); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" case:%d, res:%d\n" + , FUNC_ADPT_ARG(adapter), pattrib->to_fr_ds, ret); + #endif goto exit; } else if (ret == RTW_RX_HANDLED) goto exit; if (psta == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s psta == NULL\n", __func__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" psta == NULL, ra="MAC_FMT", ta="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(pattrib->ra), MAC_ARG(pattrib->ta)); + #endif ret = _FAIL; goto exit; } - /* psta->rssi = prxcmd->rssi; */ - /* psta->signal_quality= prxcmd->sq; */ precv_frame->u.hdr.psta = psta; @@ -1827,9 +1853,9 @@ sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 32 : 26; if (pattrib->priority != 0 && pattrib->priority != 3) - adapter->recvpriv.bIsAnyNonBEPkts = _TRUE; + adapter->recvpriv.is_any_non_be_pkts = _TRUE; else - adapter->recvpriv.bIsAnyNonBEPkts = _FALSE; + adapter->recvpriv.is_any_non_be_pkts = _FALSE; } else { pattrib->priority = 0; pattrib->hdrlen = pattrib->to_fr_ds == 3 ? 30 : 24; @@ -1839,20 +1865,33 @@ sint validate_recv_data_frame(_adapter *adapter, union recv_frame *precv_frame) if (pattrib->order) /* HT-CTRL 11n */ pattrib->hdrlen += 4; - precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; + if (!IS_MCAST(pattrib->ra)) { + precv_frame->u.hdr.preorder_ctrl = &psta->recvreorder_ctrl[pattrib->priority]; - /* decache, drop duplicate recv packets */ - if (recv_decache(precv_frame, bretry, &psta->sta_recvpriv.rxcache) == _FAIL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s recv_decache return _FAIL\n", __func__); -#endif - ret = _FAIL; - goto exit; + /* decache, drop duplicate recv packets */ + if ((recv_decache(precv_frame, bretry) == _FAIL) || + (recv_ucast_pn_decache(precv_frame) == _FAIL)) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_decache return _FAIL for sta="MAC_FMT"\n" + , FUNC_ADPT_ARG(adapter), MAC_ARG(psta->cmn.mac_addr)); + #endif + ret = _FAIL; + goto exit; + } + } else { + if (recv_bcast_pn_decache(precv_frame) == _FAIL) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recv_bcast_pn_decache _FAIL for invalid PN!\n" + , FUNC_ADPT_ARG(adapter)); + #endif + ret = _FAIL; + goto exit; + } + + precv_frame->u.hdr.preorder_ctrl = NULL; } if (pattrib->privacy) { - - #ifdef CONFIG_TDLS if ((psta->tdls_sta_state & TDLS_LINKED_STATE) && (psta->dot118021XPrivacy == _AES_)) pattrib->encrypt = psta->dot118021XPrivacy; @@ -1885,7 +1924,7 @@ static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_fram u8 subtype; type = GetFrameType(ptr); - subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ + subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ if (adapter->securitypriv.binstallBIPkey == _TRUE) { /* unicast management frame decrypt */ @@ -1893,7 +1932,7 @@ static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_fram (subtype == WIFI_DEAUTH || subtype == WIFI_DISASSOC || subtype == WIFI_ACTION)) { u8 *ppp, *mgmt_DATA; u32 data_len = 0; - ppp = GetAddr2Ptr(ptr); + ppp = get_addr2_ptr(ptr); pattrib->bdecrypted = 0; pattrib->encrypt = _AES_; @@ -1901,7 +1940,7 @@ static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_fram /* set iv and icv length */ SET_ICE_IV_LEN(pattrib->iv_len, pattrib->icv_len, pattrib->encrypt); _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); /* actual management data frame body */ data_len = pattrib->pkt_len - pattrib->hdrlen - pattrib->iv_len - pattrib->icv_len; mgmt_DATA = rtw_zmalloc(data_len); @@ -1958,7 +1997,7 @@ static sint validate_80211w_mgmt(_adapter *adapter, union recv_frame *precv_fram } } /* 802.11w protect */ else { - psta = rtw_get_stainfo(pstapriv, GetAddr2Ptr(ptr)); + psta = rtw_get_stainfo(pstapriv, get_addr2_ptr(ptr)); if (subtype == WIFI_ACTION && psta && psta->bpairwise_key_installed == _TRUE) { /* according 802.11-2012 standard, these five types are not robust types */ @@ -2013,10 +2052,12 @@ sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) sint retval = _SUCCESS; struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; + struct recv_priv *precvpriv = &adapter->recvpriv; u8 *ptr = precv_frame->u.hdr.rx_data; u8 ver = (unsigned char)(*ptr) & 0x3 ; #ifdef CONFIG_FIND_BEST_CHANNEL + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; #endif @@ -2034,9 +2075,9 @@ sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) #ifdef CONFIG_FIND_BEST_CHANNEL if (pmlmeext->sitesurvey_res.state == SCAN_PROCESS) { - int ch_set_idx = rtw_ch_set_search_ch(pmlmeext->channel_set, rtw_get_oper_ch(adapter)); + int ch_set_idx = rtw_chset_search_ch(rfctl->channel_set, rtw_get_oper_ch(adapter)); if (ch_set_idx >= 0) - pmlmeext->channel_set[ch_set_idx].rx_count++; + rfctl->channel_set[ch_set_idx].rx_count++; } #endif @@ -2067,7 +2108,7 @@ sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) } type = GetFrameType(ptr); - subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ + subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ pattrib->to_fr_ds = get_tofr_ds(ptr); @@ -2143,7 +2184,7 @@ sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) } } else { - if (rtw_wapi_drop_for_key_absent(adapter, GetAddr2Ptr(ptr))) { + if (rtw_wapi_drop_for_key_absent(adapter, get_addr2_ptr(ptr))) { retval = _FAIL; WAPI_TRACE(WAPI_RX, "drop for key absent for rx\n"); DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_wapi_key_err); @@ -2156,30 +2197,32 @@ sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) pattrib->qos = (subtype & BIT(7)) ? 1 : 0; retval = validate_recv_data_frame(adapter, precv_frame); if (retval == _FAIL) { - struct recv_priv *precvpriv = &adapter->recvpriv; - precvpriv->rx_drop++; + precvpriv->dbg_rx_drop_count++; DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_err); } else if (retval == _SUCCESS) { -#ifdef DBG_RX_DUMP_EAP - u8 bDumpRxPkt; - u16 eth_type; + #ifdef DBG_RX_DUMP_EAP + if (!pattrib->encrypt || pattrib->bdecrypted) { + u8 bDumpRxPkt; + u16 eth_type; - /* dump eapol */ - rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); - /* get ether_type */ - _rtw_memcpy(ð_type, ptr + pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE, 2); - eth_type = ntohs((unsigned short) eth_type); - if ((bDumpRxPkt == 4) && (eth_type == 0x888e)) - dump_rx_packet(ptr); -#endif + /* dump eapol */ + rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); + /* get ether_type */ + _rtw_memcpy(ð_type, ptr + pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE, 2); + eth_type = ntohs((unsigned short) eth_type); + if ((bDumpRxPkt == 4) && (eth_type == 0x888e)) + dump_rx_packet(ptr); + } + #endif } else DBG_COUNTER(adapter->rx_logs.core_rx_pre_data_handled); break; default: DBG_COUNTER(adapter->rx_logs.core_rx_pre_unknown); -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME validate_recv_data_frame fail! type=0x%x\n", type); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" fail! type=0x%x\n" + , FUNC_ADPT_ARG(adapter), type); + #endif retval = _FAIL; break; } @@ -2193,8 +2236,6 @@ sint validate_recv_frame(_adapter *adapter, union recv_frame *precv_frame) /* remove the wlanhdr and add the eth_hdr */ #if 1 - -sint wlanhdr_to_ethhdr(union recv_frame *precvframe); sint wlanhdr_to_ethhdr(union recv_frame *precvframe) { sint rmv_len; @@ -2238,37 +2279,6 @@ sint wlanhdr_to_ethhdr(union recv_frame *precvframe) eth_type = ntohs((unsigned short)eth_type); /* pattrib->ether_type */ pattrib->eth_type = eth_type; -#ifdef CONFIG_AUTO_AP_MODE - if (0x8899 == pattrib->eth_type) { - struct sta_info *psta = precvframe->u.hdr.psta; - - RTW_INFO("wlan rx: got eth_type=0x%x\n", pattrib->eth_type); - - if (psta && psta->isrc && psta->pid > 0) { - u16 rx_pid; - - rx_pid = *(u16 *)(ptr + rmv_len + 2); - - RTW_INFO("wlan rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", - rx_pid, MAC_ARG(psta->hwaddr), psta->pid); - - if (rx_pid == psta->pid) { - int i; - u16 len = *(u16 *)(ptr + rmv_len + 4); - /* u16 ctrl_type = *(u16*)(ptr+rmv_len+6); */ - - /* RTW_INFO("RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); */ - RTW_INFO("RC: len=0x%x\n", len); - - for (i = 0; i < len; i++) - RTW_INFO("0x%x\n", *(ptr + rmv_len + 6 + i)); - /* RTW_INFO("0x%x\n", *(ptr+rmv_len+8+i)); */ - - RTW_INFO("RC-end\n"); - } - } - } -#endif /* CONFIG_AUTO_AP_MODE */ if ((check_fwstate(pmlmepriv, WIFI_MP_STATE) == _TRUE)) { ptr += rmv_len ; @@ -2675,8 +2685,62 @@ union recv_frame *recvframe_chk_defrag(PADAPTER padapter, union recv_frame *prec } +static int rtw_recv_indicatepkt_check(union recv_frame *rframe, u8 *ehdr_pos, u32 pkt_len) +{ + _adapter *adapter = rframe->u.hdr.adapter; + struct recv_priv *recvpriv = &adapter->recvpriv; + struct ethhdr *ehdr = (struct ethhdr *)ehdr_pos; + int ret = _FAIL; + +#ifdef CONFIG_WAPI_SUPPORT + if (rtw_wapi_check_for_drop(adapter, rframe, ehdr_pos)) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" rtw_wapi_check_for_drop\n" + , FUNC_ADPT_ARG(adapter)); + #endif + goto exit; + } +#endif + + if (rframe->u.hdr.psta) + rtw_st_ctl_rx(rframe->u.hdr.psta, ehdr_pos); + + if (ntohs(ehdr->h_proto) == 0x888e) + RTW_PRINT("recv eapol packet\n"); + + if (recvpriv->sink_udpport > 0) + rtw_sink_rtp_seq_dbg(adapter, ehdr_pos); + +#ifdef DBG_UDP_PKT_LOSE_11AC + #define PAYLOAD_LEN_LOC_OF_IP_HDR 0x10 /*ethernet payload length location of ip header (DA + SA+eth_type+(version&hdr_len)) */ + + if (ntohs(ehdr->h_proto) == ETH_P_ARP) { + /* ARP Payload length will be 42bytes or 42+18(tailer)=60bytes*/ + if (pkt_len != 42 && pkt_len != 60) + RTW_INFO("Error !!%s,ARP Payload length %u not correct\n" , __func__ , pkt_len); + } else if (ntohs(ehdr->h_proto) == ETH_P_IP) { + if (be16_to_cpu(*((u16 *)(ehdr_pos + PAYLOAD_LEN_LOC_OF_IP_HDR))) != (pkt_len) - ETH_HLEN) { + RTW_INFO("Error !!%s,Payload length not correct\n" , __func__); + RTW_INFO("%s, IP header describe Total length=%u\n" , __func__ , be16_to_cpu(*((u16 *)(ehdr_pos + PAYLOAD_LEN_LOC_OF_IP_HDR)))); + RTW_INFO("%s, Pkt real length=%u\n" , __func__ , (pkt_len) - ETH_HLEN); + } + } +#endif + +#ifdef CONFIG_AUTO_AP_MODE + if (ntohs(ehdr->h_proto) == 0x8899) + rtw_auto_ap_rx_msg_dump(adapter, rframe, ehdr_pos); +#endif + + ret = _SUCCESS; + +exit: + return ret; +} + int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) { + struct rx_pkt_attrib *rattrib = &prframe->u.hdr.attrib; int a_len, padding_len; u16 nSubframe_Length; u8 nr_subframes, i; @@ -2688,13 +2752,12 @@ int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) nr_subframes = 0; - recvframe_pull(prframe, prframe->u.hdr.attrib.hdrlen); + recvframe_pull(prframe, rattrib->hdrlen); - if (prframe->u.hdr.attrib.iv_len > 0) - recvframe_pull(prframe, prframe->u.hdr.attrib.iv_len); + if (rattrib->iv_len > 0) + recvframe_pull(prframe, rattrib->iv_len); a_len = prframe->u.hdr.len; - pdata = prframe->u.hdr.rx_data; while (a_len > ETH_HLEN) { @@ -2713,14 +2776,17 @@ int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) break; } + if (rtw_recv_indicatepkt_check(prframe, rtw_os_pkt_data(sub_pkt), rtw_os_pkt_len(sub_pkt)) == _SUCCESS) + subframes[nr_subframes++] = sub_pkt; + else + rtw_os_pkt_free(sub_pkt); + /* move the data point to data content */ pdata += ETH_HLEN; a_len -= ETH_HLEN; - subframes[nr_subframes++] = sub_pkt; - if (nr_subframes >= MAX_SUBFRAME_COUNT) { - RTW_INFO("ParseSubframe(): Too many Subframes! Packets dropped!\n"); + RTW_WARN("ParseSubframe(): Too many Subframes! Packets dropped!\n"); break; } @@ -2745,7 +2811,7 @@ int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) /* Indicat the packets to upper layer */ if (sub_pkt) - rtw_os_recv_indicate_pkt(padapter, sub_pkt, &prframe->u.hdr.attrib); + rtw_os_recv_indicate_pkt(padapter, sub_pkt, prframe); } prframe->u.hdr.len = 0; @@ -2754,75 +2820,123 @@ int amsdu_to_msdu(_adapter *padapter, union recv_frame *prframe) return ret; } -int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num); -int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) +static int recv_process_mpdu(_adapter *padapter, union recv_frame *prframe) +{ + struct recv_priv *precvpriv = &padapter->recvpriv; + _queue *pfree_recv_queue = &padapter->recvpriv.free_recv_queue; + struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; + int ret; + + if (pattrib->amsdu) { + ret = amsdu_to_msdu(padapter, prframe); + if (ret != _SUCCESS) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" amsdu_to_msdu fail\n" + , FUNC_ADPT_ARG(padapter)); + #endif + rtw_free_recvframe(prframe, pfree_recv_queue); + goto exit; + } + } else { + ret = wlanhdr_to_ethhdr(prframe); + if (ret != _SUCCESS) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" wlanhdr_to_ethhdr: drop pkt\n" + , FUNC_ADPT_ARG(padapter)); + #endif + rtw_free_recvframe(prframe, pfree_recv_queue); + goto exit; + } + + if (!RTW_CANNOT_RUN(padapter)) { + ret = rtw_recv_indicatepkt_check(prframe + , get_recvframe_data(prframe), get_recvframe_len(prframe)); + if (ret != _SUCCESS) { + rtw_free_recvframe(prframe, pfree_recv_queue); + goto exit; + } + + /* indicate this recv_frame */ + ret = rtw_recv_indicatepkt(padapter, prframe); + if (ret != _SUCCESS) { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" rtw_recv_indicatepkt fail!\n" + , FUNC_ADPT_ARG(padapter)); + #endif + goto exit; + } + } else { + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" DS:%u SR:%u\n" + , FUNC_ADPT_ARG(padapter) + , rtw_is_drv_stopped(padapter) + , rtw_is_surprise_removed(padapter)); + #endif + ret = _SUCCESS; /* don't count as packet drop */ + rtw_free_recvframe(prframe, pfree_recv_queue); + } + } + +exit: + return ret; +} + +#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) +static int check_indicate_seq(struct recv_reorder_ctrl *preorder_ctrl, u16 seq_num) { PADAPTER padapter = preorder_ctrl->padapter; - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + struct recv_priv *precvpriv = &padapter->recvpriv; u8 wsize = preorder_ctrl->wsize_b; u16 wend = (preorder_ctrl->indicate_seq + wsize - 1) & 0xFFF; /* % 4096; */ /* Rx Reorder initialize condition. */ if (preorder_ctrl->indicate_seq == 0xFFFF) { preorder_ctrl->indicate_seq = seq_num; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d init IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, seq_num); -#endif - - /* DbgPrint("check_indicate_seq, 1st->indicate_seq=%d\n", precvpriv->indicate_seq); */ + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_INIT indicate_seq:%d, seq_num:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, seq_num); + #endif } - /* DbgPrint("enter->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ - /* Drop out the packet which SeqNum is smaller than WinStart */ if (SN_LESS(seq_num, preorder_ctrl->indicate_seq)) { - /* DbgPrint("CheckRxTsIndicateSeq(): Packet Drop! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ - -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("%s IndicateSeq: %d > NewSeq: %d\n", __FUNCTION__, - preorder_ctrl->indicate_seq, seq_num); -#endif - - + #ifdef DBG_RX_DROP_FRAME + RTW_INFO(FUNC_ADPT_FMT" tid:%u indicate_seq:%d > seq_num:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, seq_num); + #endif return _FALSE; } - /* */ - /* Sliding window manipulation. Conditions includes: */ - /* 1. Incoming SeqNum is equal to WinStart =>Window shift 1 */ - /* 2. Incoming SeqNum is larger than the WinEnd => Window shift N */ - /* */ + /* + * Sliding window manipulation. Conditions includes: + * 1. Incoming SeqNum is equal to WinStart =>Window shift 1 + * 2. Incoming SeqNum is larger than the WinEnd => Window shift N + */ if (SN_EQUAL(seq_num, preorder_ctrl->indicate_seq)) { preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_EQUAL indicate_seq:%d, seq_num:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, seq_num); + #endif -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d SN_EQUAL IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, seq_num); -#endif } else if (SN_LESS(wend, seq_num)) { - /* DbgPrint("CheckRxTsIndicateSeq(): Window Shift! IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ - /* boundary situation, when seq_num cross 0xFFF */ if (seq_num >= (wsize - 1)) preorder_ctrl->indicate_seq = seq_num + 1 - wsize; else preorder_ctrl->indicate_seq = 0xFFF - (wsize - (seq_num + 1)) + 1; - pdbgpriv->dbg_rx_ampdu_window_shift_cnt++; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d SN_LESS(wend, seq_num) IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, seq_num); -#endif - } - /* DbgPrint("exit->check_indicate_seq(): IndicateSeq: %d, NewSeq: %d\n", precvpriv->indicate_seq, seq_num); */ + precvpriv->dbg_rx_ampdu_window_shift_cnt++; + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_LESS(wend, seq_num) indicate_seq:%d, seq_num:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, seq_num); + #endif + } return _TRUE; } -int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe); -int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe) +static int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union recv_frame *prframe) { struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; @@ -2874,20 +2988,22 @@ int enqueue_reorder_recvframe(struct recv_reorder_ctrl *preorder_ctrl, union rec } -void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq); -void recv_indicatepkts_pkt_loss_cnt(struct debug_priv *pdbgpriv, u64 prev_seq, u64 current_seq) +static void recv_indicatepkts_pkt_loss_cnt(_adapter *padapter, u64 prev_seq, u64 current_seq) { - if (current_seq < prev_seq) - pdbgpriv->dbg_rx_ampdu_loss_count += (4096 + current_seq - prev_seq); + struct recv_priv *precvpriv = &padapter->recvpriv; - else - pdbgpriv->dbg_rx_ampdu_loss_count += (current_seq - prev_seq); + if (current_seq < prev_seq) { + precvpriv->dbg_rx_ampdu_loss_count += (4096 + current_seq - prev_seq); + precvpriv->rx_drop += (4096 + current_seq - prev_seq); + } else { + precvpriv->dbg_rx_ampdu_loss_count += (current_seq - prev_seq); + precvpriv->rx_drop += (current_seq - prev_seq); + } } -int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced); -int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) + +static int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *preorder_ctrl, int bforced) { /* _irqL irql; */ - /* u8 bcancelled; */ _list *phead, *plist; union recv_frame *prframe; struct rx_pkt_attrib *pattrib; @@ -2895,8 +3011,6 @@ int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *pre int bPktInBuf = _FALSE; struct recv_priv *precvpriv = &padapter->recvpriv; _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_in_oder); @@ -2916,7 +3030,7 @@ int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *pre /* Handling some condition for forced indicate case. */ if (bforced == _TRUE) { - pdbgpriv->dbg_rx_ampdu_forced_indicate_count++; + precvpriv->dbg_rx_ampdu_forced_indicate_count++; if (rtw_is_list_empty(phead)) { /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ /* _rtw_spinunlock_ex(&ppending_recvframe_queue->lock); */ @@ -2926,13 +3040,12 @@ int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *pre prframe = LIST_CONTAINOR(plist, union recv_frame, u); pattrib = &prframe->u.hdr.attrib; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, pattrib->seq_num); -#endif - recv_indicatepkts_pkt_loss_cnt(pdbgpriv, preorder_ctrl->indicate_seq, pattrib->seq_num); + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u FORCE indicate_seq:%d, seq_num:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, pattrib->seq_num); + #endif + recv_indicatepkts_pkt_loss_cnt(padapter, preorder_ctrl->indicate_seq, pattrib->seq_num); preorder_ctrl->indicate_seq = pattrib->seq_num; - } /* Prepare indication list and indication. */ @@ -2958,10 +3071,10 @@ int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *pre if (SN_EQUAL(preorder_ctrl->indicate_seq, pattrib->seq_num)) { preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) & 0xFFF; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, pattrib->seq_num); -#endif + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_EQUAL indicate_seq:%d, seq_num:%d\n" + , FUNC_ADPT_ARG(padapter), preorder_ctrl->tid, preorder_ctrl->indicate_seq, pattrib->seq_num); + #endif } #if 0 @@ -2970,8 +3083,8 @@ int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *pre /* Cancel previous pending timer. */ /* PlatformCancelTimer(Adapter, &pTS->RxPktPendingTimer); */ if (bforced != _TRUE) { - /* RTW_INFO("_cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled);\n"); */ - _cancel_timer(&preorder_ctrl->reordering_ctrl_timer, &bcancelled); + /* RTW_INFO("_cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer);\n"); */ + _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); } } #endif @@ -2985,19 +3098,8 @@ int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *pre /* indicate this recv_frame */ /* DbgPrint("recv_indicatepkts_in_order, indicate_seq=%d, seq_num=%d\n", precvpriv->indicate_seq, pattrib->seq_num); */ - if (!pattrib->amsdu) { - /* RTW_INFO("recv_indicatepkts_in_order, amsdu!=1, indicate_seq=%d, seq_num=%d\n", preorder_ctrl->indicate_seq, pattrib->seq_num); */ - - if (!RTW_CANNOT_RUN(padapter)) - rtw_recv_indicatepkt(padapter, prframe);/*indicate this recv_frame*/ - - } else if (pattrib->amsdu == 1) { - if (amsdu_to_msdu(padapter, prframe) != _SUCCESS) - rtw_free_recvframe(prframe, &precvpriv->free_recv_queue); - } else { - /* error condition; */ - } - + if (recv_process_mpdu(padapter, prframe) != _SUCCESS) + precvpriv->dbg_rx_drop_count++; /* Update local variables. */ bPktInBuf = _FALSE; @@ -3033,114 +3135,34 @@ int recv_indicatepkts_in_order(_adapter *padapter, struct recv_reorder_ctrl *pre } -int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe); -int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) +static int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) { _irqL irql; int retval = _SUCCESS; struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; struct recv_reorder_ctrl *preorder_ctrl = prframe->u.hdr.preorder_ctrl; - _queue *ppending_recvframe_queue = &preorder_ctrl->pending_recvframe_queue; - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + _queue *ppending_recvframe_queue = preorder_ctrl ? &preorder_ctrl->pending_recvframe_queue : NULL; + struct recv_priv *precvpriv = &padapter->recvpriv; + + if (!pattrib->qos || !preorder_ctrl || preorder_ctrl->enable == _FALSE) + goto _success_exit; DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_reoder); - if (!pattrib->amsdu) { - /* s1. */ - retval = wlanhdr_to_ethhdr(prframe); - if (retval != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); -#endif - return retval; - } - - /* if ((pattrib->qos!=1) || pattrib->priority!=0 || IS_MCAST(pattrib->ra) */ - /* || (pattrib->eth_type==0x0806) || (pattrib->ack_policy!=0)) */ - if (pattrib->qos != 1) { - if (!RTW_CANNOT_RUN(padapter)) { - - rtw_recv_indicatepkt(padapter, prframe); - return _SUCCESS; - - } - -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s pattrib->qos !=1\n", __FUNCTION__); -#endif - - return _FAIL; - - } - - if (preorder_ctrl->enable == _FALSE) { - /* indicate this recv_frame */ - preorder_ctrl->indicate_seq = pattrib->seq_num; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, pattrib->seq_num); -#endif - - rtw_recv_indicatepkt(padapter, prframe); - - preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) % 4096; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, pattrib->seq_num); -#endif - - return _SUCCESS; - } - -#ifndef CONFIG_RECV_REORDERING_CTRL - /* indicate this recv_frame */ - rtw_recv_indicatepkt(padapter, prframe); - return _SUCCESS; -#endif - - } else if (pattrib->amsdu == 1) { /* temp filter->means didn't support A-MSDUs in a A-MPDU */ - if (preorder_ctrl->enable == _FALSE) { - preorder_ctrl->indicate_seq = pattrib->seq_num; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, pattrib->seq_num); -#endif - - retval = amsdu_to_msdu(padapter, prframe); - - preorder_ctrl->indicate_seq = (preorder_ctrl->indicate_seq + 1) % 4096; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d, NewSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq, pattrib->seq_num); -#endif - - if (retval != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); -#endif - } - - return retval; - } - } else { - - } - _enter_critical_bh(&ppending_recvframe_queue->lock, &irql); - /* s2. check if winstart_b(indicate_seq) needs to been updated */ if (!check_indicate_seq(preorder_ctrl, pattrib->seq_num)) { - pdbgpriv->dbg_rx_ampdu_drop_count++; + precvpriv->dbg_rx_ampdu_drop_count++; /* pHTInfo->RxReorderDropCounter++; */ /* ReturnRFDList(Adapter, pRfd); */ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ /* return _FAIL; */ -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s check_indicate_seq fail\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" check_indicate_seq fail\n" + , FUNC_ADPT_ARG(padapter)); + #endif #if 0 rtw_recv_indicatepkt(padapter, prframe); @@ -3158,9 +3180,10 @@ int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) /* DbgPrint("recv_indicatepkt_reorder, enqueue_reorder_recvframe fail!\n"); */ /* _exit_critical_ex(&ppending_recvframe_queue->lock, &irql); */ /* return _FAIL; */ -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s enqueue_reorder_recvframe fail\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" enqueue_reorder_recvframe fail\n" + , FUNC_ADPT_ARG(padapter)); + #endif goto _err_exit; } @@ -3188,6 +3211,7 @@ int recv_indicatepkt_reorder(_adapter *padapter, union recv_frame *prframe) _cancel_timer_ex(&preorder_ctrl->reordering_ctrl_timer); } + return RTW_RX_HANDLED; _success_exit: @@ -3225,69 +3249,38 @@ void rtw_reordering_ctrl_timeout_handler(void *pcontext) _exit_critical_bh(&ppending_recvframe_queue->lock, &irql); } +#endif /* defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) */ -int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe); -int process_recv_indicatepkts(_adapter *padapter, union recv_frame *prframe) +static void recv_set_iseq_before_mpdu_process(union recv_frame *rframe, u16 seq_num, const char *caller) { - int retval = _SUCCESS; - /* struct recv_priv *precvpriv = &padapter->recvpriv; */ - /* struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; */ - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; -#ifdef CONFIG_TDLS - struct sta_info *psta = prframe->u.hdr.psta; -#endif /* CONFIG_TDLS */ - -#ifdef CONFIG_80211N_HT - - struct ht_priv *phtpriv = &pmlmepriv->htpriv; - - DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate); - -#ifdef CONFIG_TDLS - if ((phtpriv->ht_option == _TRUE) || - ((psta->tdls_sta_state & TDLS_LINKED_STATE) && - (psta->htpriv.ht_option == _TRUE) && - (psta->htpriv.ampdu_enable == _TRUE))) /* B/G/N Mode */ -#else - if (phtpriv->ht_option == _TRUE) /* B/G/N Mode */ -#endif /* CONFIG_TDLS */ - { - /* prframe->u.hdr.preorder_ctrl = &precvpriv->recvreorder_ctrl[pattrib->priority]; */ - - if (recv_indicatepkt_reorder(padapter, prframe) != _SUCCESS) { /* including perform A-MPDU Rx Ordering Buffer Control */ -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s recv_indicatepkt_reorder error!\n", __FUNCTION__); -#endif - - if (!RTW_CANNOT_RUN(padapter)) { - retval = _FAIL; - return retval; - } - } - } else /* B/G mode */ -#endif - { - retval = wlanhdr_to_ethhdr(prframe); - if (retval != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr error!\n", __FUNCTION__); -#endif - return retval; - } - - if (!RTW_CANNOT_RUN(padapter)) { - /* indicate this recv_frame */ - rtw_recv_indicatepkt(padapter, prframe); - } else { - - retval = _FAIL; - return retval; - } +#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) + struct recv_reorder_ctrl *reorder_ctrl = rframe->u.hdr.preorder_ctrl; + if (reorder_ctrl) { + reorder_ctrl->indicate_seq = seq_num; + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ %s("ADPT_FMT")-B tid:%u indicate_seq:%d, seq_num:%d\n" + , caller, ADPT_ARG(reorder_ctrl->padapter) + , reorder_ctrl->tid, reorder_ctrl->indicate_seq, seq_num); + #endif } +#endif +} - return retval; +static void recv_set_iseq_after_mpdu_process(union recv_frame *rframe, u16 seq_num, const char *caller) +{ +#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) + struct recv_reorder_ctrl *reorder_ctrl = rframe->u.hdr.preorder_ctrl; + if (reorder_ctrl) { + reorder_ctrl->indicate_seq = (reorder_ctrl->indicate_seq + 1) % 4096; + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ %s("ADPT_FMT")-A tid:%u indicate_seq:%d, seq_num:%d\n" + , caller, ADPT_ARG(reorder_ctrl->padapter) + , reorder_ctrl->tid, reorder_ctrl->indicate_seq, seq_num); + #endif + } +#endif } #ifdef CONFIG_MP_INCLUDED @@ -3306,7 +3299,7 @@ int validate_mp_recv_frame(_adapter *adapter, union recv_frame *precv_frame) if (1) { u8 bDumpRxPkt; type = GetFrameType(ptr); - subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ + subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ rtw_hal_get_def_var(adapter, HAL_DEF_DBG_DUMP_RXPKT, &(bDumpRxPkt)); if (bDumpRxPkt == 1) { /* dump all rx packets */ @@ -3328,11 +3321,11 @@ int validate_mp_recv_frame(_adapter *adapter, union recv_frame *precv_frame) } if (pmppriv->bSetRxBssid == _TRUE) { - sa = GetAddr2Ptr(ptr); + sa = get_addr2_ptr(ptr); da = GetAddr1Ptr(ptr); bs = GetAddr3Ptr(ptr); type = GetFrameType(ptr); - subtype = GetFrameSubType(ptr); /* bit(7)~bit(2) */ + subtype = get_frame_sub_type(ptr); /* bit(7)~bit(2) */ if (_rtw_memcmp(bs, adapter->mppriv.network_macaddr, ETH_ALEN) == _FALSE) ret = _FAIL; @@ -3346,7 +3339,7 @@ int validate_mp_recv_frame(_adapter *adapter, union recv_frame *precv_frame) if (!adapter->mppriv.bmac_filter) return ret; - if (_rtw_memcmp(GetAddr2Ptr(ptr), adapter->mppriv.mac_filter, ETH_ALEN) == _FALSE) + if (_rtw_memcmp(get_addr2_ptr(ptr), adapter->mppriv.mac_filter, ETH_ALEN) == _FALSE) ret = _FAIL; return ret; @@ -3501,7 +3494,7 @@ int mp_recv_frame(_adapter *padapter, union recv_frame *rframe) case 3: _rtw_memcpy(pattrib->ra, GetAddr1Ptr(ptr), ETH_ALEN); - _rtw_memcpy(pattrib->ta, GetAddr2Ptr(ptr), ETH_ALEN); + _rtw_memcpy(pattrib->ta, get_addr2_ptr(ptr), ETH_ALEN); ret = _FAIL; break; @@ -3513,9 +3506,10 @@ int mp_recv_frame(_adapter *padapter, union recv_frame *rframe) ret = MPwlanhdr_to_ethhdr(rframe); if (ret != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" wlanhdr_to_ethhdr: drop pkt\n" + , FUNC_ADPT_ARG(padapter)); + #endif rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ret = _FAIL; goto exit; @@ -3524,20 +3518,22 @@ int mp_recv_frame(_adapter *padapter, union recv_frame *rframe) /* indicate this recv_frame */ ret = rtw_recv_indicatepkt(padapter, rframe); if (ret != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" rtw_recv_indicatepkt fail!\n" + , FUNC_ADPT_ARG(padapter)); + #endif rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ ret = _FAIL; goto exit; } } else { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s ecv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__, - rtw_is_drv_stopped(padapter) ? "True" : "False", - rtw_is_surprise_removed(padapter) ? "True" : "False"); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" bDriverStopped(%s) OR bSurpriseRemoved(%s)\n" + , FUNC_ADPT_ARG(padapter) + , rtw_is_drv_stopped(padapter) ? "True" : "False" + , rtw_is_surprise_removed(padapter) ? "True" : "False"); + #endif ret = _FAIL; rtw_free_recvframe(rframe, pfree_recv_queue);/* free this recv_frame */ goto exit; @@ -3695,13 +3691,13 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, tmp_16bit = 0; rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_CHANNEL); tmp_16bit = CHAN2FREQ(rtw_get_oper_ch(padapter)); - /*tmp_16bit = CHAN2FREQ(pHalData->CurrentChannel);*/ + /*tmp_16bit = CHAN2FREQ(pHalData->current_channel);*/ memcpy(&hdr_buf[rt_len], &tmp_16bit, 2); rt_len += 2; /* channel flags */ tmp_16bit = 0; - if (pHalData->CurrentBandType == 0) + if (pHalData->current_band_type == 0) tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_2GHZ); else tmp_16bit |= cpu_to_le16(IEEE80211_CHAN_5GHZ); @@ -3721,7 +3717,7 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, /* dBm Antenna Signal */ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL); - hdr_buf[rt_len] = pattrib->phy_info.RecvSignalPower; + hdr_buf[rt_len] = pattrib->phy_info.recv_signal_power; rt_len += 1; #if 0 @@ -3732,7 +3728,7 @@ static sint fill_radiotap_hdr(_adapter *padapter, union recv_frame *precvframe, /* Signal Quality */ rtap_hdr->it_present |= (1 << IEEE80211_RADIOTAP_LOCK_QUALITY); - hdr_buf[rt_len] = pattrib->phy_info.SignalQuality; + hdr_buf[rt_len] = pattrib->phy_info.signal_quality; rt_len += 1; #endif @@ -3966,21 +3962,18 @@ int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) prframe = decryptor(padapter, prframe); if (prframe == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s decryptor: drop pkt\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" decryptor: drop pkt\n" + , FUNC_ADPT_ARG(padapter)); + #endif ret = _FAIL; DBG_COUNTER(padapter->rx_logs.core_rx_post_decrypt_err); goto _recv_data_drop; } #ifdef DBG_RX_BMC_FRAME - if (IS_MCAST(pattrib->ra)) { - u8 *pbuf = prframe->u.hdr.rx_data; - u8 *sa_addr = get_sa(pbuf); - - RTW_INFO("%s =>"ADPT_FMT" Rx BC/MC from MAC: "MAC_FMT"\n", __func__, ADPT_ARG(padapter), MAC_ARG(sa_addr)); - } + if (IS_MCAST(pattrib->ra)) + RTW_INFO("%s =>"ADPT_FMT" Rx BC/MC from "MAC_FMT"\n", __func__, ADPT_ARG(padapter), MAC_ARG(pattrib->ta)); #endif #if 0 @@ -4013,18 +4006,20 @@ int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) prframe = recvframe_chk_defrag(padapter, prframe); if (prframe == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s recvframe_chk_defrag: drop pkt\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" recvframe_chk_defrag: drop pkt\n" + , FUNC_ADPT_ARG(padapter)); + #endif DBG_COUNTER(padapter->rx_logs.core_rx_post_defrag_err); goto _recv_data_drop; } prframe = portctrl(padapter, prframe); if (prframe == NULL) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s portctrl: drop pkt\n", __FUNCTION__); -#endif + #ifdef DBG_RX_DROP_FRAME + RTW_INFO("DBG_RX_DROP_FRAME "FUNC_ADPT_FMT" portctrl: drop pkt\n" + , FUNC_ADPT_ARG(padapter)); + #endif ret = _FAIL; DBG_COUNTER(padapter->rx_logs.core_rx_post_portctrl_err); goto _recv_data_drop; @@ -4036,75 +4031,30 @@ int recv_func_posthandle(_adapter *padapter, union recv_frame *prframe) rtw_wapi_update_info(padapter, prframe); #endif -#ifdef CONFIG_80211N_HT - ret = process_recv_indicatepkts(padapter, prframe); - if (ret != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s process_recv_indicatepkts fail!\n", __FUNCTION__); -#endif - rtw_free_recvframe(orig_prframe, pfree_recv_queue);/* free this recv_frame */ - DBG_COUNTER(padapter->rx_logs.core_rx_post_indicate_err); +#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) + /* including perform A-MPDU Rx Ordering Buffer Control */ + ret = recv_indicatepkt_reorder(padapter, prframe); + if (ret == _FAIL) { + rtw_free_recvframe(orig_prframe, pfree_recv_queue); goto _recv_data_drop; - } -#else /* CONFIG_80211N_HT */ - if (!pattrib->amsdu) { - ret = wlanhdr_to_ethhdr(prframe); - if (ret != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s wlanhdr_to_ethhdr: drop pkt\n", __FUNCTION__); + } else if (ret == RTW_RX_HANDLED) /* queued OR indicated in order */ + goto _exit_recv_func; #endif - rtw_free_recvframe(orig_prframe, pfree_recv_queue);/* free this recv_frame */ - goto _recv_data_drop; - } - if (!RTW_CANNOT_RUN(padapter)) { - /* indicate this recv_frame */ - ret = rtw_recv_indicatepkt(padapter, prframe); - if (ret != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s rtw_recv_indicatepkt fail!\n", __FUNCTION__); -#endif - goto _recv_data_drop; - } - } else { - -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s recv_func:bDriverStopped(%s) OR bSurpriseRemoved(%s)\n", __func__ - , rtw_is_drv_stopped(padapter) ? "True" : "False" - , rtw_is_surprise_removed(padapter) ? "True" : "False"); -#endif - ret = _FAIL; - rtw_free_recvframe(orig_prframe, pfree_recv_queue); /* free this recv_frame */ - } - - } else if (pattrib->amsdu == 1) { - - ret = amsdu_to_msdu(padapter, prframe); - if (ret != _SUCCESS) { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s amsdu_to_msdu fail\n", __FUNCTION__); -#endif - rtw_free_recvframe(orig_prframe, pfree_recv_queue); - goto _recv_data_drop; - } - } else { -#ifdef DBG_RX_DROP_FRAME - RTW_INFO("DBG_RX_DROP_FRAME %s what is this condition??\n", __FUNCTION__); -#endif + recv_set_iseq_before_mpdu_process(prframe, pattrib->seq_num, __func__); + ret = recv_process_mpdu(padapter, prframe); + recv_set_iseq_after_mpdu_process(prframe, pattrib->seq_num, __func__); + if (ret == _FAIL) goto _recv_data_drop; - } -#endif /* CONFIG_80211N_HT */ _exit_recv_func: return ret; _recv_data_drop: - precvpriv->rx_drop++; + precvpriv->dbg_rx_drop_count++; return ret; } - -int recv_func(_adapter *padapter, union recv_frame *rframe); int recv_func(_adapter *padapter, union recv_frame *rframe) { int ret; @@ -4208,9 +4158,9 @@ s32 rtw_recv_entry(union recv_frame *precvframe) } #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS -void rtw_signal_stat_timer_hdl(RTW_TIMER_HDL_ARGS) +static void rtw_signal_stat_timer_hdl(void *ctx) { - _adapter *adapter = (_adapter *)FunctionContext; + _adapter *adapter = (_adapter *)ctx; struct recv_priv *recvpriv = &adapter->recvpriv; u32 tmp_s, tmp_q; @@ -4314,7 +4264,7 @@ static void rx_process_rssi(_adapter *padapter, union recv_frame *prframe) struct signal_stat *signal_stat = &padapter->recvpriv.signal_strength_data; #endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ - /* RTW_INFO("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->RecvSignalPower,pattrib->signal_strength); */ + /* RTW_INFO("process_rssi=> pattrib->rssil(%d) signal_strength(%d)\n ",pattrib->recv_signal_power,pattrib->signal_strength); */ /* if(pRfd->Status.bPacketToSelf || pRfd->Status.bPacketBeacon) */ { #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS @@ -4325,7 +4275,7 @@ static void rx_process_rssi(_adapter *padapter, union recv_frame *prframe) } signal_stat->total_num++; - signal_stat->total_val += pattrib->phy_info.SignalStrength; + signal_stat->total_val += pattrib->phy_info.signal_strength; signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; #else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ @@ -4335,9 +4285,9 @@ static void rx_process_rssi(_adapter *padapter, union recv_frame *prframe) last_rssi = padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index]; padapter->recvpriv.signal_strength_data.total_val -= last_rssi; } - padapter->recvpriv.signal_strength_data.total_val += pattrib->phy_info.SignalStrength; + padapter->recvpriv.signal_strength_data.total_val += pattrib->phy_info.signal_strength; - padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.SignalStrength; + padapter->recvpriv.signal_strength_data.elements[padapter->recvpriv.signal_strength_data.index++] = pattrib->phy_info.signal_strength; if (padapter->recvpriv.signal_strength_data.index >= PHY_RSSI_SLID_WIN_MAX) padapter->recvpriv.signal_strength_data.index = 0; @@ -4382,11 +4332,11 @@ static void rx_process_link_qual(_adapter *padapter, union recv_frame *prframe) } signal_stat->total_num++; - signal_stat->total_val += pattrib->phy_info.SignalQuality; + signal_stat->total_val += pattrib->phy_info.signal_quality; signal_stat->avg_val = signal_stat->total_val / signal_stat->total_num; #else /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ - if (pattrib->phy_info.SignalQuality != 0) { + if (pattrib->phy_info.signal_quality != 0) { /* */ /* 1. Record the general EVM to the sliding window. */ /* */ @@ -4395,9 +4345,9 @@ static void rx_process_link_qual(_adapter *padapter, union recv_frame *prframe) last_evm = padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index]; padapter->recvpriv.signal_qual_data.total_val -= last_evm; } - padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.SignalQuality; + padapter->recvpriv.signal_qual_data.total_val += pattrib->phy_info.signal_quality; - padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.SignalQuality; + padapter->recvpriv.signal_qual_data.elements[padapter->recvpriv.signal_qual_data.index++] = pattrib->phy_info.signal_quality; if (padapter->recvpriv.signal_qual_data.index >= PHY_LINKQUALITY_SLID_WIN_MAX) padapter->recvpriv.signal_qual_data.index = 0; @@ -4432,47 +4382,36 @@ void rx_query_phy_status( PADAPTER padapter = precvframe->u.hdr.adapter; struct rx_pkt_attrib *pattrib = &precvframe->u.hdr.attrib; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PODM_PHY_INFO_T pPHYInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); + struct phydm_phyinfo_struct *p_phy_info = &pattrib->phy_info; u8 *wlanhdr; - ODM_PACKET_INFO_T pkt_info; - u8 *sa; + struct phydm_perpkt_info_struct pkt_info; + u8 *ta, *ra; + u8 is_ra_bmc; struct sta_priv *pstapriv; struct sta_info *psta = NULL; - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; + struct recv_priv *precvpriv = &padapter->recvpriv; /* _irqL irqL; */ - pkt_info.bPacketMatchBSSID = _FALSE; - pkt_info.bPacketToSelf = _FALSE; - pkt_info.bPacketBeacon = _FALSE; + pkt_info.is_packet_match_bssid = _FALSE; + pkt_info.is_packet_to_self = _FALSE; + pkt_info.is_packet_beacon = _FALSE; + pkt_info.ppdu_cnt = pattrib->ppdu_cnt; + pkt_info.station_id = 0xFF; wlanhdr = get_recvframe_data(precvframe); - pkt_info.bPacketMatchBSSID = (!IsFrameTypeCtrl(wlanhdr)) - && (!pattrib->icv_err) && (!pattrib->crc_err) - && _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN); + ta = get_ta(wlanhdr); + ra = get_ra(wlanhdr); + is_ra_bmc = IS_MCAST(ra); - pkt_info.bToSelf = (!pattrib->icv_err) && (!pattrib->crc_err) - && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); - - pkt_info.bPacketToSelf = pkt_info.bPacketMatchBSSID - && _rtw_memcmp(get_ra(wlanhdr), adapter_mac_addr(padapter), ETH_ALEN); - - pkt_info.bPacketBeacon = pkt_info.bPacketMatchBSSID - && (GetFrameSubType(wlanhdr) == WIFI_BEACON); - - sa = get_ta(wlanhdr); - - pkt_info.StationID = 0xFF; - - if (_rtw_memcmp(adapter_mac_addr(padapter), sa, ETH_ALEN) == _TRUE) { - static u32 start_time = 0; + if (_rtw_memcmp(adapter_mac_addr(padapter), ta, ETH_ALEN) == _TRUE) { + static systime start_time = 0; #if 0 /*For debug */ if (IsFrameTypeCtrl(wlanhdr)) { RTW_INFO("-->Control frame: Y\n"); RTW_INFO("-->pkt_len: %d\n", pattrib->pkt_len); - RTW_INFO("-->Sub Type = 0x%X\n", GetFrameSubType(wlanhdr)); + RTW_INFO("-->Sub Type = 0x%X\n", get_frame_sub_type(wlanhdr)); } /* Dump first 40 bytes of header */ @@ -4488,32 +4427,47 @@ void rx_query_phy_status( RTW_PRINT("Warning!!! %s: Confilc mac addr!!\n", __func__); start_time = rtw_get_current_time(); } - pdbgpriv->dbg_rx_conflic_mac_addr_cnt++; + precvpriv->dbg_rx_conflic_mac_addr_cnt++; } else { pstapriv = &padapter->stapriv; - psta = rtw_get_stainfo(pstapriv, sa); + psta = rtw_get_stainfo(pstapriv, ta); if (psta) - pkt_info.StationID = psta->mac_id; + pkt_info.station_id = psta->cmn.mac_id; } - pkt_info.DataRate = pattrib->data_rate; + pkt_info.is_packet_match_bssid = (!IsFrameTypeCtrl(wlanhdr)) + && (!pattrib->icv_err) && (!pattrib->crc_err) + && _rtw_memcmp(get_hdr_bssid(wlanhdr), get_bssid(&padapter->mlmepriv), ETH_ALEN); - /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ - ODM_PhyStatusQuery(&pHalData->odmpriv, pPHYInfo, pphy_status, &pkt_info); - if (psta) - psta->rssi = pattrib->phy_info.RecvSignalPower; - /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ + pkt_info.is_to_self = (!pattrib->icv_err) && (!pattrib->crc_err) + && _rtw_memcmp(ra, adapter_mac_addr(padapter), ETH_ALEN); + + pkt_info.is_packet_to_self = pkt_info.is_packet_match_bssid + && _rtw_memcmp(ra, adapter_mac_addr(padapter), ETH_ALEN); + + pkt_info.is_packet_beacon = pkt_info.is_packet_match_bssid + && (get_frame_sub_type(wlanhdr) == WIFI_BEACON); + + if (psta && IsFrameTypeData(wlanhdr)) { + if (is_ra_bmc) + psta->curr_rx_rate_bmc = pattrib->data_rate; + else + psta->curr_rx_rate = pattrib->data_rate; + } + pkt_info.data_rate = pattrib->data_rate; + + odm_phy_status_query(&pHalData->odmpriv, p_phy_info, pphy_status, &pkt_info); { precvframe->u.hdr.psta = NULL; - if (pkt_info.bPacketMatchBSSID - && (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) - ) { + if ((!MLME_IS_MESH(padapter) && pkt_info.is_packet_match_bssid) + || padapter->registrypriv.mp_mode == 1 + ) { if (psta) { precvframe->u.hdr.psta = psta; rx_process_phy_info(padapter, precvframe); } - } else if (pkt_info.bPacketToSelf || pkt_info.bPacketBeacon) { + } else if (pkt_info.is_packet_to_self || pkt_info.is_packet_beacon) { if (psta) precvframe->u.hdr.psta = psta; @@ -4548,19 +4502,36 @@ void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index) ATOMIC_SET(&sta->continual_no_rx_packet[tid_index], 0); } +u8 adapter_allow_bmc_data_rx(_adapter *adapter) +{ + if (check_fwstate(&adapter->mlmepriv, WIFI_MONITOR_STATE | WIFI_MP_STATE) == _TRUE) + return 1; + + if (MLME_IS_AP(adapter)) + return 0; + + if (rtw_linked_check(adapter) == _FALSE) + return 0; + + return 1; +} s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status) { s32 ret = _SUCCESS; -#ifdef CONFIG_CONCURRENT_MODE - u8 *pda; u8 *pbuf = precvframe->u.hdr.rx_data; + u8 *pda = get_ra(pbuf); + u8 ra_is_bmc = IS_MCAST(pda); +#ifdef CONFIG_CONCURRENT_MODE _adapter *iface = NULL; _adapter *primary_padapter = precvframe->u.hdr.adapter; - pda = get_ra(pbuf); + #ifdef CONFIG_MP_INCLUDED + if (rtw_mp_mode_check(primary_padapter)) + goto bypass_concurrent_hdl; + #endif - if (IS_MCAST(pda) == _FALSE) { /*unicast packets*/ + if (ra_is_bmc == _FALSE) { /*unicast packets*/ iface = rtw_get_iface_by_macddr(primary_padapter , pda); if (NULL == iface) { RTW_INFO("%s [WARN] Cannot find appropriate adapter - mac_addr : "MAC_FMT"\n", __func__, MAC_ARG(pda)); @@ -4569,7 +4540,125 @@ s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status) precvframe->u.hdr.adapter = iface; } else /* Handle BC/MC Packets */ rtw_mi_buddy_clone_bcmc_packet(primary_padapter, precvframe, pphy_status); -#endif +bypass_concurrent_hdl: +#endif /* CONFIG_CONCURRENT_MODE */ + /* skip unnecessary bmc data frame for primary adapter */ + if (ra_is_bmc == _TRUE && GetFrameType(pbuf) == WIFI_DATA_TYPE + && !adapter_allow_bmc_data_rx(precvframe->u.hdr.adapter) + ) { + rtw_free_recvframe(precvframe, &precvframe->u.hdr.adapter->recvpriv.free_recv_queue); + goto exit; + } + + if (pphy_status) + rx_query_phy_status(precvframe, pphy_status); + ret = rtw_recv_entry(precvframe); + +exit: return ret; } + +#ifdef CONFIG_RECV_THREAD_MODE +thread_return rtw_recv_thread(thread_context context) +{ + _adapter *adapter = (_adapter *)context; + struct recv_priv *recvpriv = &adapter->recvpriv; + s32 err = _SUCCESS; +#ifdef PLATFORM_LINUX + struct sched_param param = { .sched_priority = 1 }; + + sched_setscheduler(current, SCHED_FIFO, ¶m); +#endif /* PLATFORM_LINUX */ + thread_enter("RTW_RECV_THREAD"); + + RTW_INFO(FUNC_ADPT_FMT" enter\n", FUNC_ADPT_ARG(adapter)); + + do { + err = _rtw_down_sema(&recvpriv->recv_sema); + if (_FAIL == err) { + RTW_ERR(FUNC_ADPT_FMT" down recv_sema fail!\n", FUNC_ADPT_ARG(adapter)); + goto exit; + } + + if (RTW_CANNOT_RUN(adapter)) { + RTW_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", + FUNC_ADPT_ARG(adapter), + rtw_is_drv_stopped(adapter) ? "True" : "False", + rtw_is_surprise_removed(adapter) ? "True" : "False"); + goto exit; + } + + err = rtw_hal_recv_hdl(adapter); + + if (err == RTW_RFRAME_UNAVAIL + || err == RTW_RFRAME_PKT_UNAVAIL + ) { + rtw_msleep_os(1); + _rtw_up_sema(&recvpriv->recv_sema); + } + + flush_signals_thread(); + + } while (err != _FAIL); + +exit: + + RTW_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(adapter)); + + rtw_thread_wait_stop(); + + return 0; +} +#endif /* CONFIG_RECV_THREAD_MODE */ + +#if DBG_RX_BH_TRACKING +void rx_bh_tk_set_stage(struct recv_priv *recv, u32 s) +{ + recv->rx_bh_stage = s; +} + +void rx_bh_tk_set_buf(struct recv_priv *recv, void *buf, void *data, u32 dlen) +{ + if (recv->rx_bh_cbuf) + recv->rx_bh_lbuf = recv->rx_bh_cbuf; + recv->rx_bh_cbuf = buf; + if (buf) { + recv->rx_bh_cbuf_data = data; + recv->rx_bh_cbuf_dlen = dlen; + recv->rx_bh_buf_dq_cnt++; + } else { + recv->rx_bh_cbuf_data = NULL; + recv->rx_bh_cbuf_dlen = 0; + } +} + +void rx_bh_tk_set_buf_pos(struct recv_priv *recv, void *pos) +{ + if (recv->rx_bh_cbuf) { + recv->rx_bh_cbuf_pos = pos - recv->rx_bh_cbuf_data; + } else { + rtw_warn_on(1); + recv->rx_bh_cbuf_pos = 0; + } +} + +void rx_bh_tk_set_frame(struct recv_priv *recv, void *frame) +{ + recv->rx_bh_cframe = frame; +} + +void dump_rx_bh_tk(void *sel, struct recv_priv *recv) +{ + RTW_PRINT_SEL(sel, "[RXBHTK]s:%u, buf_dqc:%u, lbuf:%p, cbuf:%p, dlen:%u, pos:%u, cframe:%p\n" + , recv->rx_bh_stage + , recv->rx_bh_buf_dq_cnt + , recv->rx_bh_lbuf + , recv->rx_bh_cbuf + , recv->rx_bh_cbuf_dlen + , recv->rx_bh_cbuf_pos + , recv->rx_bh_cframe + ); +} +#endif /* DBG_RX_BH_TRACKING */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rf.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rf.c index a7d06b9fda43..982a01ccb38b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rf.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_RF_C_ #include @@ -546,6 +541,30 @@ const u8 _band_to_band_cap[] = { 0, }; +const u8 _rf_type_to_rf_tx_cnt[] = { + 1, /*RF_1T1R*/ + 1, /*RF_1T2R*/ + 2, /*RF_2T2R*/ + 2, /*RF_2T3R*/ + 2, /*RF_2T4R*/ + 3, /*RF_3T3R*/ + 3, /*RF_3T4R*/ + 4, /*RF_4T4R*/ + 1, /*RF_TYPE_MAX*/ +}; + +const u8 _rf_type_to_rf_rx_cnt[] = { + 1, /*RF_1T1R*/ + 2, /*RF_1T2R*/ + 2, /*RF_2T2R*/ + 3, /*RF_2T3R*/ + 4, /*RF_2T4R*/ + 3, /*RF_3T3R*/ + 4, /*RF_3T4R*/ + 4, /*RF_4T4R*/ + 1, /*RF_TYPE_MAX*/ +}; + #ifdef CONFIG_80211AC_VHT #define COUNTRY_CHPLAN_ASSIGN_EN_11AC(_val) , .en_11ac = (_val) #else @@ -571,57 +590,93 @@ const u8 _band_to_band_cap[] = { #elif RTW_DEF_MODULE_REGULATORY_CERT -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AE_HMC_M2) -static const struct country_chplan RTL8821AE_HMC_M2_country_chplan_map[] = { - COUNTRY_CHPLAN_ENT("CN", 0x51, 1, 0xFB), /* China */ - COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0xFB), /* Russia(fac/gost), Kaliningrad */ - COUNTRY_CHPLAN_ENT("UA", 0x26, 0, 0xFB), /* Ukraine */ +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AE_HMC_M2) /* 2013 certify */ +static const struct country_chplan RTL8821AE_HMC_M2_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x34, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("CL", 0x30, 1, 0x3F1), /* Chile */ + COUNTRY_CHPLAN_ENT("CN", 0x51, 1, 0x3FB), /* China */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0x3F1), /* Mexico */ + COUNTRY_CHPLAN_ENT("MY", 0x47, 1, 0x3F1), /* Malaysia */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 0, 0x3FB), /* Ukraine */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ }; -static const u16 RTL8821AE_HMC_M2_country_chplan_map_sz = sizeof(RTL8821AE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); #endif -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AU) -static const struct country_chplan RTL8821AU_country_chplan_map[] = { - COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0xFB), /* Russia(fac/gost), Kaliningrad */ - COUNTRY_CHPLAN_ENT("UA", 0x26, 0, 0xFB), /* Ukraine */ +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8821AU) /* 2014 certify */ +static const struct country_chplan RTL8821AU_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x34, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0x3FB), /* Russia(fac/gost), Kaliningrad */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 0, 0x3FB), /* Ukraine */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ }; -static const u16 RTL8821AU_country_chplan_map_sz = sizeof(RTL8821AU_country_chplan_map) / sizeof(struct country_chplan); #endif -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AENF_NGFF) -static const struct country_chplan RTL8812AENF_NGFF_country_chplan_map[] = { +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AENF_NGFF) /* 2014 certify */ +static const struct country_chplan RTL8812AENF_NGFF_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ }; -static const u16 RTL8812AENF_NGFF_country_chplan_map_sz = sizeof(RTL8812AENF_NGFF_country_chplan_map) / sizeof(struct country_chplan); #endif -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AEBT_HMC) -static const struct country_chplan RTL8812AEBT_HMC_country_chplan_map[] = { +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8812AEBT_HMC) /* 2013 certify */ +static const struct country_chplan RTL8812AEBT_HMC_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x34, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("RU", 0x59, 0, 0x3FB), /* Russia(fac/gost), Kaliningrad */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 0, 0x3FB), /* Ukraine */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ }; -static const u16 RTL8812AEBT_HMC_country_chplan_map_sz = sizeof(RTL8812AEBT_HMC_country_chplan_map) / sizeof(struct country_chplan); #endif -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8188EE_HMC_M2) -static const struct country_chplan RTL8188EE_HMC_M2_country_chplan_map[] = { +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8188EE_HMC_M2) /* 2012 certify */ +static const struct country_chplan RTL8188EE_HMC_M2_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0x3F1), /* Mexico */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ }; -static const u16 RTL8188EE_HMC_M2_country_chplan_map_sz = sizeof(RTL8188EE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); #endif -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BE_HMC_M2) -static const struct country_chplan RTL8723BE_HMC_M2_country_chplan_map[] = { +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BE_HMC_M2) /* 2013 certify */ +static const struct country_chplan RTL8723BE_HMC_M2_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0x3F1), /* Mexico */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ }; -static const u16 RTL8723BE_HMC_M2_country_chplan_map_sz = sizeof(RTL8723BE_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); #endif -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BS_NGFF1216) -static const struct country_chplan RTL8723BS_NGFF1216_country_chplan_map[] = { +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723BS_NGFF1216) /* 2014 certify */ +static const struct country_chplan RTL8723BS_NGFF1216_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0x3F1), /* Mexico */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ }; -static const u16 RTL8723BS_NGFF1216_country_chplan_map_sz = sizeof(RTL8723BS_NGFF1216_country_chplan_map) / sizeof(struct country_chplan); #endif -#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8192EEBT_HMC_M2) -static const struct country_chplan RTL8192EEBT_HMC_M2_country_chplan_map[] = { +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8192EEBT_HMC_M2) /* 2013 certify */ +static const struct country_chplan RTL8192EEBT_HMC_M2_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x20, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0x3F1), /* Mexico */ + COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0x3FF), /* United States of America (USA) */ +}; +#endif + +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8723DE_NGFF1630) /* 2016 certify */ +static const struct country_chplan RTL8723DE_NGFF1630_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CA", 0x2A, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0x3F1), /* Mexico */ +}; +#endif + +#if (RTW_DEF_MODULE_REGULATORY_CERT & RTW_MODULE_RTL8822BE) /* 2016 certify */ +static const struct country_chplan RTL8822BE_country_chplan_exc_map[] = { + COUNTRY_CHPLAN_ENT("CL", 0x30, 1, 0x3F1), /* Chile */ }; -static const u16 RTL8192EEBT_HMC_M2_country_chplan_map_sz = sizeof(RTL8192EEBT_HMC_M2_country_chplan_map) / sizeof(struct country_chplan); #endif /** @@ -639,29 +694,35 @@ static const struct country_chplan *rtw_def_module_get_chplan_from_country(const /* TODO: runtime selection for multi driver */ #if (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AE_HMC_M2) - hal_map = RTL8821AE_HMC_M2_country_chplan_map; - hal_map_sz = RTL8821AE_HMC_M2_country_chplan_map_sz; + hal_map = RTL8821AE_HMC_M2_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8821AE_HMC_M2_country_chplan_exc_map) / sizeof(struct country_chplan); #elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8821AU) - hal_map = RTL8821AU_country_chplan_map; - hal_map_sz = RTL8821AU_country_chplan_map_sz; + hal_map = RTL8821AU_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8821AU_country_chplan_exc_map) / sizeof(struct country_chplan); #elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AENF_NGFF) - hal_map = RTL8812AENF_NGFF_country_chplan_map; - hal_map_sz = RTL8812AENF_NGFF_country_chplan_map_sz; + hal_map = RTL8812AENF_NGFF_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8812AENF_NGFF_country_chplan_exc_map) / sizeof(struct country_chplan); #elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8812AEBT_HMC) - hal_map = RTL8812AEBT_HMC_country_chplan_map; - hal_map_sz = RTL8812AEBT_HMC_country_chplan_map_sz; + hal_map = RTL8812AEBT_HMC_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8812AEBT_HMC_country_chplan_exc_map) / sizeof(struct country_chplan); #elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8188EE_HMC_M2) - hal_map = RTL8188EE_HMC_M2_country_chplan_map; - hal_map_sz = RTL8188EE_HMC_M2_country_chplan_map_sz; + hal_map = RTL8188EE_HMC_M2_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8188EE_HMC_M2_country_chplan_exc_map) / sizeof(struct country_chplan); #elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BE_HMC_M2) - hal_map = RTL8723BE_HMC_M2_country_chplan_map; - hal_map_sz = RTL8723BE_HMC_M2_country_chplan_map_sz; + hal_map = RTL8723BE_HMC_M2_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8723BE_HMC_M2_country_chplan_exc_map) / sizeof(struct country_chplan); #elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723BS_NGFF1216) - hal_map = RTL8723BS_NGFF1216_country_chplan_map; - hal_map_sz = RTL8723BS_NGFF1216_country_chplan_map_sz; + hal_map = RTL8723BS_NGFF1216_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8723BS_NGFF1216_country_chplan_exc_map) / sizeof(struct country_chplan); #elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8192EEBT_HMC_M2) - hal_map = RTL8192EEBT_HMC_M2_country_chplan_map; - hal_map_sz = RTL8192EEBT_HMC_M2_country_chplan_map_sz; + hal_map = RTL8192EEBT_HMC_M2_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8192EEBT_HMC_M2_country_chplan_exc_map) / sizeof(struct country_chplan); +#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8723DE_NGFF1630) + hal_map = RTL8723DE_NGFF1630_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8723DE_NGFF1630_country_chplan_exc_map) / sizeof(struct country_chplan); +#elif (RTW_DEF_MODULE_REGULATORY_CERT == RTW_MODULE_RTL8822BE) + hal_map = RTL8822BE_country_chplan_exc_map; + hal_map_sz = sizeof(RTL8822BE_country_chplan_exc_map) / sizeof(struct country_chplan); #endif if (hal_map == NULL || hal_map_sz == 0) @@ -680,239 +741,238 @@ static const struct country_chplan *rtw_def_module_get_chplan_from_country(const #endif /* CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP or RTW_DEF_MODULE_REGULATORY_CERT */ static const struct country_chplan country_chplan_map[] = { - COUNTRY_CHPLAN_ENT("AD", 0x26, 1, 0x00), /* Andorra */ - COUNTRY_CHPLAN_ENT("AE", 0x26, 1, 0xFB), /* United Arab Emirates */ - COUNTRY_CHPLAN_ENT("AF", 0x42, 1, 0x00), /* Afghanistan */ - COUNTRY_CHPLAN_ENT("AG", 0x30, 1, 0x00), /* Antigua & Barbuda */ - COUNTRY_CHPLAN_ENT("AI", 0x26, 1, 0x00), /* Anguilla(UK) */ - COUNTRY_CHPLAN_ENT("AL", 0x26, 1, 0xF1), /* Albania */ - COUNTRY_CHPLAN_ENT("AM", 0x26, 1, 0xB0), /* Armenia */ - COUNTRY_CHPLAN_ENT("AO", 0x26, 1, 0xE0), /* Angola */ - COUNTRY_CHPLAN_ENT("AQ", 0x26, 1, 0x00), /* Antarctica */ - COUNTRY_CHPLAN_ENT("AR", 0x57, 1, 0xF3), /* Argentina */ - COUNTRY_CHPLAN_ENT("AS", 0x34, 1, 0x00), /* American Samoa */ - COUNTRY_CHPLAN_ENT("AT", 0x26, 1, 0xFB), /* Austria */ - COUNTRY_CHPLAN_ENT("AU", 0x45, 1, 0xFB), /* Australia */ - COUNTRY_CHPLAN_ENT("AW", 0x34, 1, 0xB0), /* Aruba */ - COUNTRY_CHPLAN_ENT("AZ", 0x26, 1, 0xF1), /* Azerbaijan */ - COUNTRY_CHPLAN_ENT("BA", 0x26, 1, 0xF1), /* Bosnia & Herzegovina */ - COUNTRY_CHPLAN_ENT("BB", 0x34, 1, 0x50), /* Barbados */ - COUNTRY_CHPLAN_ENT("BD", 0x26, 1, 0xF1), /* Bangladesh */ - COUNTRY_CHPLAN_ENT("BE", 0x26, 1, 0xFB), /* Belgium */ - COUNTRY_CHPLAN_ENT("BF", 0x26, 1, 0xB0), /* Burkina Faso */ - COUNTRY_CHPLAN_ENT("BG", 0x26, 1, 0xF1), /* Bulgaria */ - COUNTRY_CHPLAN_ENT("BH", 0x47, 1, 0xF1), /* Bahrain */ - COUNTRY_CHPLAN_ENT("BI", 0x26, 1, 0xB0), /* Burundi */ - COUNTRY_CHPLAN_ENT("BJ", 0x26, 1, 0xB0), /* Benin */ - COUNTRY_CHPLAN_ENT("BN", 0x47, 1, 0x10), /* Brunei */ - COUNTRY_CHPLAN_ENT("BO", 0x30, 1, 0xF1), /* Bolivia */ - COUNTRY_CHPLAN_ENT("BR", 0x34, 1, 0xF1), /* Brazil */ - COUNTRY_CHPLAN_ENT("BS", 0x34, 1, 0x20), /* Bahamas */ - COUNTRY_CHPLAN_ENT("BW", 0x26, 1, 0xF1), /* Botswana */ - COUNTRY_CHPLAN_ENT("BY", 0x26, 1, 0xF1), /* Belarus */ - COUNTRY_CHPLAN_ENT("BZ", 0x34, 1, 0x00), /* Belize */ - COUNTRY_CHPLAN_ENT("CA", 0x34, 1, 0xFB), /* Canada */ - COUNTRY_CHPLAN_ENT("CC", 0x26, 1, 0x00), /* Cocos (Keeling) Islands (Australia) */ - COUNTRY_CHPLAN_ENT("CD", 0x26, 1, 0xB0), /* Congo, Republic of the */ - COUNTRY_CHPLAN_ENT("CF", 0x26, 1, 0xB0), /* Central African Republic */ - COUNTRY_CHPLAN_ENT("CG", 0x26, 1, 0xB0), /* Congo, Democratic Republic of the. Zaire */ - COUNTRY_CHPLAN_ENT("CH", 0x26, 1, 0xFB), /* Switzerland */ - COUNTRY_CHPLAN_ENT("CI", 0x26, 1, 0xF1), /* Cote d'Ivoire */ - COUNTRY_CHPLAN_ENT("CK", 0x26, 1, 0x00), /* Cook Islands */ - COUNTRY_CHPLAN_ENT("CL", 0x30, 1, 0xF1), /* Chile */ - COUNTRY_CHPLAN_ENT("CM", 0x26, 1, 0xB0), /* Cameroon */ - COUNTRY_CHPLAN_ENT("CN", 0x48, 1, 0xFB), /* China */ - COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0xF1), /* Colombia */ - COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0xF1), /* Costa Rica */ - COUNTRY_CHPLAN_ENT("CV", 0x26, 1, 0xB0), /* Cape Verde */ - COUNTRY_CHPLAN_ENT("CX", 0x45, 1, 0x00), /* Christmas Island (Australia) */ - COUNTRY_CHPLAN_ENT("CY", 0x26, 1, 0xFB), /* Cyprus */ - COUNTRY_CHPLAN_ENT("CZ", 0x26, 1, 0xFB), /* Czech Republic */ - COUNTRY_CHPLAN_ENT("DE", 0x26, 1, 0xFB), /* Germany */ - COUNTRY_CHPLAN_ENT("DJ", 0x26, 1, 0x80), /* Djibouti */ - COUNTRY_CHPLAN_ENT("DK", 0x26, 1, 0xFB), /* Denmark */ - COUNTRY_CHPLAN_ENT("DM", 0x34, 1, 0x00), /* Dominica */ - COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0xF1), /* Dominican Republic */ - COUNTRY_CHPLAN_ENT("DZ", 0x26, 1, 0xF1), /* Algeria */ - COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0xF1), /* Ecuador */ - COUNTRY_CHPLAN_ENT("EE", 0x26, 1, 0xFB), /* Estonia */ - COUNTRY_CHPLAN_ENT("EG", 0x47, 0, 0xF1), /* Egypt */ - COUNTRY_CHPLAN_ENT("EH", 0x47, 1, 0x80), /* Western Sahara */ - COUNTRY_CHPLAN_ENT("ER", 0x26, 1, 0x00), /* Eritrea */ - COUNTRY_CHPLAN_ENT("ES", 0x26, 1, 0xFB), /* Spain, Canary Islands, Ceuta, Melilla */ - COUNTRY_CHPLAN_ENT("ET", 0x26, 1, 0xB0), /* Ethiopia */ - COUNTRY_CHPLAN_ENT("FI", 0x26, 1, 0xFB), /* Finland */ - COUNTRY_CHPLAN_ENT("FJ", 0x34, 1, 0x00), /* Fiji */ - COUNTRY_CHPLAN_ENT("FK", 0x26, 1, 0x00), /* Falkland Islands (Islas Malvinas) (UK) */ - COUNTRY_CHPLAN_ENT("FM", 0x34, 1, 0x00), /* Micronesia, Federated States of (USA) */ - COUNTRY_CHPLAN_ENT("FO", 0x26, 1, 0x00), /* Faroe Islands (Denmark) */ - COUNTRY_CHPLAN_ENT("FR", 0x26, 1, 0xFB), /* France */ - COUNTRY_CHPLAN_ENT("GA", 0x26, 1, 0xB0), /* Gabon */ - COUNTRY_CHPLAN_ENT("GB", 0x26, 1, 0xFB), /* Great Britain (United Kingdom; England) */ - COUNTRY_CHPLAN_ENT("GD", 0x34, 1, 0xB0), /* Grenada */ - COUNTRY_CHPLAN_ENT("GE", 0x26, 1, 0x00), /* Georgia */ - COUNTRY_CHPLAN_ENT("GF", 0x26, 1, 0x80), /* French Guiana */ - COUNTRY_CHPLAN_ENT("GG", 0x26, 1, 0x00), /* Guernsey (UK) */ - COUNTRY_CHPLAN_ENT("GH", 0x26, 1, 0xF1), /* Ghana */ - COUNTRY_CHPLAN_ENT("GI", 0x26, 1, 0x00), /* Gibraltar (UK) */ - COUNTRY_CHPLAN_ENT("GL", 0x26, 1, 0x00), /* Greenland (Denmark) */ - COUNTRY_CHPLAN_ENT("GM", 0x26, 1, 0xB0), /* Gambia */ - COUNTRY_CHPLAN_ENT("GN", 0x26, 1, 0x10), /* Guinea */ - COUNTRY_CHPLAN_ENT("GP", 0x26, 1, 0x00), /* Guadeloupe (France) */ - COUNTRY_CHPLAN_ENT("GQ", 0x26, 1, 0xB0), /* Equatorial Guinea */ - COUNTRY_CHPLAN_ENT("GR", 0x26, 1, 0xFB), /* Greece */ - COUNTRY_CHPLAN_ENT("GS", 0x26, 1, 0x00), /* South Georgia and the Sandwich Islands (UK) */ - COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0xF1), /* Guatemala */ - COUNTRY_CHPLAN_ENT("GU", 0x34, 1, 0x00), /* Guam (USA) */ - COUNTRY_CHPLAN_ENT("GW", 0x26, 1, 0xB0), /* Guinea-Bissau */ - COUNTRY_CHPLAN_ENT("GY", 0x44, 1, 0x00), /* Guyana */ - COUNTRY_CHPLAN_ENT("HK", 0x26, 1, 0xFB), /* Hong Kong */ - COUNTRY_CHPLAN_ENT("HM", 0x45, 1, 0x00), /* Heard and McDonald Islands (Australia) */ - COUNTRY_CHPLAN_ENT("HN", 0x32, 1, 0xF1), /* Honduras */ - COUNTRY_CHPLAN_ENT("HR", 0x26, 1, 0xF9), /* Croatia */ - COUNTRY_CHPLAN_ENT("HT", 0x34, 1, 0x50), /* Haiti */ - COUNTRY_CHPLAN_ENT("HU", 0x26, 1, 0xFB), /* Hungary */ - COUNTRY_CHPLAN_ENT("ID", 0x54, 0, 0xF3), /* Indonesia */ - COUNTRY_CHPLAN_ENT("IE", 0x26, 1, 0xFB), /* Ireland */ - COUNTRY_CHPLAN_ENT("IL", 0x47, 1, 0xF1), /* Israel */ - COUNTRY_CHPLAN_ENT("IM", 0x26, 1, 0x00), /* Isle of Man (UK) */ - COUNTRY_CHPLAN_ENT("IN", 0x47, 1, 0xF1), /* India */ - COUNTRY_CHPLAN_ENT("IQ", 0x26, 1, 0x00), /* Iraq */ - COUNTRY_CHPLAN_ENT("IR", 0x26, 0, 0x00), /* Iran */ - COUNTRY_CHPLAN_ENT("IS", 0x26, 1, 0xFB), /* Iceland */ - COUNTRY_CHPLAN_ENT("IT", 0x26, 1, 0xFB), /* Italy */ - COUNTRY_CHPLAN_ENT("JE", 0x26, 1, 0x00), /* Jersey (UK) */ - COUNTRY_CHPLAN_ENT("JM", 0x51, 1, 0xF1), /* Jamaica */ - COUNTRY_CHPLAN_ENT("JO", 0x49, 1, 0xFB), /* Jordan */ - COUNTRY_CHPLAN_ENT("JP", 0x27, 1, 0xFF), /* Japan- Telec */ - COUNTRY_CHPLAN_ENT("KE", 0x47, 1, 0xF9), /* Kenya */ - COUNTRY_CHPLAN_ENT("KG", 0x26, 1, 0xF1), /* Kyrgyzstan */ - COUNTRY_CHPLAN_ENT("KH", 0x26, 1, 0xF1), /* Cambodia */ - COUNTRY_CHPLAN_ENT("KI", 0x26, 1, 0x00), /* Kiribati */ - COUNTRY_CHPLAN_ENT("KN", 0x34, 1, 0x00), /* Saint Kitts and Nevis */ - COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0xFB), /* South Korea */ - COUNTRY_CHPLAN_ENT("KW", 0x47, 1, 0xFB), /* Kuwait */ - COUNTRY_CHPLAN_ENT("KY", 0x34, 1, 0x00), /* Cayman Islands (UK) */ - COUNTRY_CHPLAN_ENT("KZ", 0x26, 1, 0x00), /* Kazakhstan */ - COUNTRY_CHPLAN_ENT("LA", 0x26, 1, 0x00), /* Laos */ - COUNTRY_CHPLAN_ENT("LB", 0x26, 1, 0xF1), /* Lebanon */ - COUNTRY_CHPLAN_ENT("LC", 0x34, 1, 0x00), /* Saint Lucia */ - COUNTRY_CHPLAN_ENT("LI", 0x26, 1, 0xFB), /* Liechtenstein */ - COUNTRY_CHPLAN_ENT("LK", 0x26, 1, 0xF1), /* Sri Lanka */ - COUNTRY_CHPLAN_ENT("LR", 0x26, 1, 0xB0), /* Liberia */ - COUNTRY_CHPLAN_ENT("LS", 0x26, 1, 0xF1), /* Lesotho */ - COUNTRY_CHPLAN_ENT("LT", 0x26, 1, 0xFB), /* Lithuania */ - COUNTRY_CHPLAN_ENT("LU", 0x26, 1, 0xFB), /* Luxembourg */ - COUNTRY_CHPLAN_ENT("LV", 0x26, 1, 0xFB), /* Latvia */ - COUNTRY_CHPLAN_ENT("LY", 0x26, 1, 0x00), /* Libya */ - COUNTRY_CHPLAN_ENT("MA", 0x47, 1, 0xF1), /* Morocco */ - COUNTRY_CHPLAN_ENT("MC", 0x26, 1, 0xFB), /* Monaco */ - COUNTRY_CHPLAN_ENT("MD", 0x26, 1, 0xF1), /* Moldova */ - COUNTRY_CHPLAN_ENT("ME", 0x26, 1, 0xF1), /* Montenegro */ - COUNTRY_CHPLAN_ENT("MF", 0x34, 1, 0x00), /* Saint Martin */ - COUNTRY_CHPLAN_ENT("MG", 0x26, 1, 0x20), /* Madagascar */ - COUNTRY_CHPLAN_ENT("MH", 0x34, 1, 0x00), /* Marshall Islands (USA) */ - COUNTRY_CHPLAN_ENT("MK", 0x26, 1, 0xF1), /* Republic of Macedonia (FYROM) */ - COUNTRY_CHPLAN_ENT("ML", 0x26, 1, 0xB0), /* Mali */ - COUNTRY_CHPLAN_ENT("MM", 0x26, 1, 0x00), /* Burma (Myanmar) */ - COUNTRY_CHPLAN_ENT("MN", 0x26, 1, 0x00), /* Mongolia */ - COUNTRY_CHPLAN_ENT("MO", 0x26, 1, 0x00), /* Macau */ - COUNTRY_CHPLAN_ENT("MP", 0x34, 1, 0x00), /* Northern Mariana Islands (USA) */ - COUNTRY_CHPLAN_ENT("MQ", 0x26, 1, 0x40), /* Martinique (France) */ - COUNTRY_CHPLAN_ENT("MR", 0x26, 1, 0xA0), /* Mauritania */ - COUNTRY_CHPLAN_ENT("MS", 0x26, 1, 0x00), /* Montserrat (UK) */ - COUNTRY_CHPLAN_ENT("MT", 0x26, 1, 0xFB), /* Malta */ - COUNTRY_CHPLAN_ENT("MU", 0x26, 1, 0xB0), /* Mauritius */ - COUNTRY_CHPLAN_ENT("MV", 0x26, 1, 0x00), /* Maldives */ - COUNTRY_CHPLAN_ENT("MW", 0x26, 1, 0xB0), /* Malawi */ - COUNTRY_CHPLAN_ENT("MX", 0x34, 1, 0xF1), /* Mexico */ - COUNTRY_CHPLAN_ENT("MY", 0x47, 1, 0xF1), /* Malaysia */ - COUNTRY_CHPLAN_ENT("MZ", 0x26, 1, 0xF1), /* Mozambique */ - COUNTRY_CHPLAN_ENT("NA", 0x26, 0, 0x00), /* Namibia */ - COUNTRY_CHPLAN_ENT("NC", 0x26, 1, 0x00), /* New Caledonia */ - COUNTRY_CHPLAN_ENT("NE", 0x26, 1, 0xB0), /* Niger */ - COUNTRY_CHPLAN_ENT("NF", 0x45, 1, 0x00), /* Norfolk Island (Australia) */ - COUNTRY_CHPLAN_ENT("NG", 0x50, 1, 0xF9), /* Nigeria */ - COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0xF1), /* Nicaragua */ - COUNTRY_CHPLAN_ENT("NL", 0x26, 1, 0xFB), /* Netherlands */ - COUNTRY_CHPLAN_ENT("NO", 0x26, 1, 0xFB), /* Norway */ - COUNTRY_CHPLAN_ENT("NP", 0x47, 1, 0xF0), /* Nepal */ - COUNTRY_CHPLAN_ENT("NR", 0x26, 1, 0x00), /* Nauru */ - COUNTRY_CHPLAN_ENT("NU", 0x45, 1, 0x00), /* Niue */ - COUNTRY_CHPLAN_ENT("NZ", 0x45, 1, 0xFB), /* New Zealand */ - COUNTRY_CHPLAN_ENT("OM", 0x26, 1, 0xF9), /* Oman */ - COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0xF1), /* Panama */ - COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0xF1), /* Peru */ - COUNTRY_CHPLAN_ENT("PF", 0x26, 1, 0x00), /* French Polynesia (France) */ - COUNTRY_CHPLAN_ENT("PG", 0x26, 1, 0xF1), /* Papua New Guinea */ - COUNTRY_CHPLAN_ENT("PH", 0x26, 1, 0xF1), /* Philippines */ - COUNTRY_CHPLAN_ENT("PK", 0x51, 1, 0xF1), /* Pakistan */ - COUNTRY_CHPLAN_ENT("PL", 0x26, 1, 0xFB), /* Poland */ - COUNTRY_CHPLAN_ENT("PM", 0x26, 1, 0x00), /* Saint Pierre and Miquelon (France) */ - COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0xF1), /* Puerto Rico */ - COUNTRY_CHPLAN_ENT("PT", 0x26, 1, 0xFB), /* Portugal */ - COUNTRY_CHPLAN_ENT("PW", 0x34, 1, 0x00), /* Palau */ - COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0xF1), /* Paraguay */ - COUNTRY_CHPLAN_ENT("QA", 0x51, 1, 0xF9), /* Qatar */ - COUNTRY_CHPLAN_ENT("RE", 0x26, 1, 0x00), /* Reunion (France) */ - COUNTRY_CHPLAN_ENT("RO", 0x26, 1, 0xF1), /* Romania */ - COUNTRY_CHPLAN_ENT("RS", 0x26, 1, 0xF1), /* Serbia, Kosovo */ - COUNTRY_CHPLAN_ENT("RU", 0x59, 1, 0xFB), /* Russia(fac/gost), Kaliningrad */ - COUNTRY_CHPLAN_ENT("RW", 0x26, 1, 0xB0), /* Rwanda */ - COUNTRY_CHPLAN_ENT("SA", 0x26, 1, 0xFB), /* Saudi Arabia */ - COUNTRY_CHPLAN_ENT("SB", 0x26, 1, 0x00), /* Solomon Islands */ - COUNTRY_CHPLAN_ENT("SC", 0x34, 1, 0x90), /* Seychelles */ - COUNTRY_CHPLAN_ENT("SE", 0x26, 1, 0xFB), /* Sweden */ - COUNTRY_CHPLAN_ENT("SG", 0x47, 1, 0xFB), /* Singapore */ - COUNTRY_CHPLAN_ENT("SH", 0x26, 1, 0x00), /* Saint Helena (UK) */ - COUNTRY_CHPLAN_ENT("SI", 0x26, 1, 0xFB), /* Slovenia */ - COUNTRY_CHPLAN_ENT("SJ", 0x26, 1, 0x00), /* Svalbard (Norway) */ - COUNTRY_CHPLAN_ENT("SK", 0x26, 1, 0xFB), /* Slovakia */ - COUNTRY_CHPLAN_ENT("SL", 0x26, 1, 0xB0), /* Sierra Leone */ - COUNTRY_CHPLAN_ENT("SM", 0x26, 1, 0x00), /* San Marino */ - COUNTRY_CHPLAN_ENT("SN", 0x26, 1, 0xF1), /* Senegal */ - COUNTRY_CHPLAN_ENT("SO", 0x26, 1, 0x00), /* Somalia */ - COUNTRY_CHPLAN_ENT("SR", 0x34, 1, 0x00), /* Suriname */ - COUNTRY_CHPLAN_ENT("ST", 0x34, 1, 0x80), /* Sao Tome and Principe */ - COUNTRY_CHPLAN_ENT("SV", 0x30, 1, 0xF1), /* El Salvador */ - COUNTRY_CHPLAN_ENT("SX", 0x34, 1, 0x00), /* Sint Marteen */ - COUNTRY_CHPLAN_ENT("SZ", 0x26, 1, 0x20), /* Swaziland */ - COUNTRY_CHPLAN_ENT("TC", 0x26, 1, 0x00), /* Turks and Caicos Islands (UK) */ - COUNTRY_CHPLAN_ENT("TD", 0x26, 1, 0xB0), /* Chad */ - COUNTRY_CHPLAN_ENT("TF", 0x26, 1, 0x80), /* French Southern and Antarctic Lands (FR Southern Territories) */ - COUNTRY_CHPLAN_ENT("TG", 0x26, 1, 0xB0), /* Togo */ - COUNTRY_CHPLAN_ENT("TH", 0x26, 1, 0xF1), /* Thailand */ - COUNTRY_CHPLAN_ENT("TJ", 0x26, 1, 0x40), /* Tajikistan */ - COUNTRY_CHPLAN_ENT("TK", 0x45, 1, 0x00), /* Tokelau */ - COUNTRY_CHPLAN_ENT("TM", 0x26, 1, 0x00), /* Turkmenistan */ - COUNTRY_CHPLAN_ENT("TN", 0x47, 1, 0xF1), /* Tunisia */ - COUNTRY_CHPLAN_ENT("TO", 0x26, 1, 0x00), /* Tonga */ - COUNTRY_CHPLAN_ENT("TR", 0x26, 1, 0xF1), /* Turkey, Northern Cyprus */ - COUNTRY_CHPLAN_ENT("TT", 0x42, 1, 0xF1), /* Trinidad & Tobago */ - COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0xFF), /* Taiwan */ - COUNTRY_CHPLAN_ENT("TZ", 0x26, 1, 0xF0), /* Tanzania */ - COUNTRY_CHPLAN_ENT("UA", 0x26, 1, 0xFB), /* Ukraine */ - COUNTRY_CHPLAN_ENT("UG", 0x26, 1, 0xF1), /* Uganda */ - COUNTRY_CHPLAN_ENT("US", 0x34, 1, 0xFF), /* United States of America (USA) */ - COUNTRY_CHPLAN_ENT("UY", 0x34, 1, 0xF1), /* Uruguay */ - COUNTRY_CHPLAN_ENT("UZ", 0x47, 1, 0xF0), /* Uzbekistan */ - COUNTRY_CHPLAN_ENT("VA", 0x26, 1, 0x00), /* Holy See (Vatican City) */ - COUNTRY_CHPLAN_ENT("VC", 0x34, 1, 0x10), /* Saint Vincent and the Grenadines */ - COUNTRY_CHPLAN_ENT("VE", 0x30, 1, 0xF1), /* Venezuela */ - COUNTRY_CHPLAN_ENT("VI", 0x34, 1, 0x00), /* United States Virgin Islands (USA) */ - COUNTRY_CHPLAN_ENT("VN", 0x26, 1, 0xF1), /* Vietnam */ - COUNTRY_CHPLAN_ENT("VU", 0x26, 1, 0x00), /* Vanuatu */ - COUNTRY_CHPLAN_ENT("WF", 0x26, 1, 0x00), /* Wallis and Futuna (France) */ - COUNTRY_CHPLAN_ENT("WS", 0x34, 1, 0x00), /* Samoa */ - COUNTRY_CHPLAN_ENT("YE", 0x26, 1, 0x40), /* Yemen */ - COUNTRY_CHPLAN_ENT("YT", 0x26, 1, 0x80), /* Mayotte (France) */ - COUNTRY_CHPLAN_ENT("ZA", 0x26, 1, 0xF1), /* South Africa */ - COUNTRY_CHPLAN_ENT("ZM", 0x26, 1, 0xB0), /* Zambia */ - COUNTRY_CHPLAN_ENT("ZW", 0x26, 1, 0xF1), /* Zimbabwe */ + COUNTRY_CHPLAN_ENT("AD", 0x26, 1, 0x000), /* Andorra */ + COUNTRY_CHPLAN_ENT("AE", 0x26, 1, 0x3FB), /* United Arab Emirates */ + COUNTRY_CHPLAN_ENT("AF", 0x42, 1, 0x000), /* Afghanistan */ + COUNTRY_CHPLAN_ENT("AG", 0x26, 1, 0x000), /* Antigua & Barbuda */ + COUNTRY_CHPLAN_ENT("AI", 0x26, 1, 0x000), /* Anguilla(UK) */ + COUNTRY_CHPLAN_ENT("AL", 0x26, 1, 0x3F1), /* Albania */ + COUNTRY_CHPLAN_ENT("AM", 0x26, 1, 0x2B0), /* Armenia */ + COUNTRY_CHPLAN_ENT("AN", 0x26, 1, 0x3F1), /* Netherlands Antilles */ + COUNTRY_CHPLAN_ENT("AO", 0x47, 1, 0x2E0), /* Angola */ + COUNTRY_CHPLAN_ENT("AQ", 0x26, 1, 0x000), /* Antarctica */ + COUNTRY_CHPLAN_ENT("AR", 0x57, 1, 0x3F3), /* Argentina */ + COUNTRY_CHPLAN_ENT("AS", 0x34, 1, 0x000), /* American Samoa */ + COUNTRY_CHPLAN_ENT("AT", 0x26, 1, 0x3FB), /* Austria */ + COUNTRY_CHPLAN_ENT("AU", 0x45, 1, 0x3FB), /* Australia */ + COUNTRY_CHPLAN_ENT("AW", 0x34, 1, 0x0B0), /* Aruba */ + COUNTRY_CHPLAN_ENT("AZ", 0x26, 1, 0x3F1), /* Azerbaijan */ + COUNTRY_CHPLAN_ENT("BA", 0x26, 1, 0x3F1), /* Bosnia & Herzegovina */ + COUNTRY_CHPLAN_ENT("BB", 0x34, 1, 0x250), /* Barbados */ + COUNTRY_CHPLAN_ENT("BD", 0x26, 1, 0x3F1), /* Bangladesh */ + COUNTRY_CHPLAN_ENT("BE", 0x26, 1, 0x3FB), /* Belgium */ + COUNTRY_CHPLAN_ENT("BF", 0x26, 1, 0x2B0), /* Burkina Faso */ + COUNTRY_CHPLAN_ENT("BG", 0x26, 1, 0x3F1), /* Bulgaria */ + COUNTRY_CHPLAN_ENT("BH", 0x47, 1, 0x3F1), /* Bahrain */ + COUNTRY_CHPLAN_ENT("BI", 0x26, 1, 0x2B0), /* Burundi */ + COUNTRY_CHPLAN_ENT("BJ", 0x26, 1, 0x2B0), /* Benin */ + COUNTRY_CHPLAN_ENT("BN", 0x47, 1, 0x210), /* Brunei */ + COUNTRY_CHPLAN_ENT("BO", 0x73, 1, 0x3F1), /* Bolivia */ + COUNTRY_CHPLAN_ENT("BR", 0x34, 1, 0x3F1), /* Brazil */ + COUNTRY_CHPLAN_ENT("BS", 0x34, 1, 0x220), /* Bahamas */ + COUNTRY_CHPLAN_ENT("BW", 0x26, 1, 0x2F1), /* Botswana */ + COUNTRY_CHPLAN_ENT("BY", 0x26, 1, 0x3F1), /* Belarus */ + COUNTRY_CHPLAN_ENT("BZ", 0x34, 1, 0x000), /* Belize */ + COUNTRY_CHPLAN_ENT("CA", 0x2B, 1, 0x3FB), /* Canada */ + COUNTRY_CHPLAN_ENT("CC", 0x26, 1, 0x000), /* Cocos (Keeling) Islands (Australia) */ + COUNTRY_CHPLAN_ENT("CD", 0x26, 1, 0x2B0), /* Congo, Republic of the */ + COUNTRY_CHPLAN_ENT("CF", 0x26, 1, 0x2B0), /* Central African Republic */ + COUNTRY_CHPLAN_ENT("CG", 0x26, 1, 0x2B0), /* Congo, Democratic Republic of the. Zaire */ + COUNTRY_CHPLAN_ENT("CH", 0x26, 1, 0x3FB), /* Switzerland */ + COUNTRY_CHPLAN_ENT("CI", 0x26, 1, 0x3F1), /* Cote d'Ivoire */ + COUNTRY_CHPLAN_ENT("CK", 0x26, 1, 0x000), /* Cook Islands */ + COUNTRY_CHPLAN_ENT("CL", 0x73, 1, 0x3F1), /* Chile */ + COUNTRY_CHPLAN_ENT("CM", 0x26, 1, 0x2B0), /* Cameroon */ + COUNTRY_CHPLAN_ENT("CN", 0x48, 1, 0x3FB), /* China */ + COUNTRY_CHPLAN_ENT("CO", 0x34, 1, 0x3F1), /* Colombia */ + COUNTRY_CHPLAN_ENT("CR", 0x34, 1, 0x3F1), /* Costa Rica */ + COUNTRY_CHPLAN_ENT("CV", 0x26, 1, 0x2B0), /* Cape Verde */ + COUNTRY_CHPLAN_ENT("CX", 0x45, 1, 0x000), /* Christmas Island (Australia) */ + COUNTRY_CHPLAN_ENT("CY", 0x26, 1, 0x3FB), /* Cyprus */ + COUNTRY_CHPLAN_ENT("CZ", 0x26, 1, 0x3FB), /* Czech Republic */ + COUNTRY_CHPLAN_ENT("DE", 0x26, 1, 0x3FB), /* Germany */ + COUNTRY_CHPLAN_ENT("DJ", 0x26, 1, 0x280), /* Djibouti */ + COUNTRY_CHPLAN_ENT("DK", 0x26, 1, 0x3FB), /* Denmark */ + COUNTRY_CHPLAN_ENT("DM", 0x34, 1, 0x000), /* Dominica */ + COUNTRY_CHPLAN_ENT("DO", 0x34, 1, 0x3F1), /* Dominican Republic */ + COUNTRY_CHPLAN_ENT("DZ", 0x26, 1, 0x3F1), /* Algeria */ + COUNTRY_CHPLAN_ENT("EC", 0x34, 1, 0x3F1), /* Ecuador */ + COUNTRY_CHPLAN_ENT("EE", 0x26, 1, 0x3FB), /* Estonia */ + COUNTRY_CHPLAN_ENT("EG", 0x47, 0, 0x3F1), /* Egypt */ + COUNTRY_CHPLAN_ENT("EH", 0x47, 1, 0x280), /* Western Sahara */ + COUNTRY_CHPLAN_ENT("ER", 0x26, 1, 0x000), /* Eritrea */ + COUNTRY_CHPLAN_ENT("ES", 0x26, 1, 0x3FB), /* Spain, Canary Islands, Ceuta, Melilla */ + COUNTRY_CHPLAN_ENT("ET", 0x26, 1, 0x0B0), /* Ethiopia */ + COUNTRY_CHPLAN_ENT("FI", 0x26, 1, 0x3FB), /* Finland */ + COUNTRY_CHPLAN_ENT("FJ", 0x34, 1, 0x200), /* Fiji */ + COUNTRY_CHPLAN_ENT("FK", 0x26, 1, 0x000), /* Falkland Islands (Islas Malvinas) (UK) */ + COUNTRY_CHPLAN_ENT("FM", 0x34, 1, 0x000), /* Micronesia, Federated States of (USA) */ + COUNTRY_CHPLAN_ENT("FO", 0x26, 1, 0x000), /* Faroe Islands (Denmark) */ + COUNTRY_CHPLAN_ENT("FR", 0x26, 1, 0x3FB), /* France */ + COUNTRY_CHPLAN_ENT("GA", 0x26, 1, 0x2B0), /* Gabon */ + COUNTRY_CHPLAN_ENT("GB", 0x26, 1, 0x3FB), /* Great Britain (United Kingdom; England) */ + COUNTRY_CHPLAN_ENT("GD", 0x34, 1, 0x0B0), /* Grenada */ + COUNTRY_CHPLAN_ENT("GE", 0x26, 1, 0x200), /* Georgia */ + COUNTRY_CHPLAN_ENT("GF", 0x26, 1, 0x080), /* French Guiana */ + COUNTRY_CHPLAN_ENT("GG", 0x26, 1, 0x000), /* Guernsey (UK) */ + COUNTRY_CHPLAN_ENT("GH", 0x26, 1, 0x3F1), /* Ghana */ + COUNTRY_CHPLAN_ENT("GI", 0x26, 1, 0x200), /* Gibraltar (UK) */ + COUNTRY_CHPLAN_ENT("GL", 0x26, 1, 0x200), /* Greenland (Denmark) */ + COUNTRY_CHPLAN_ENT("GM", 0x26, 1, 0x2B0), /* Gambia */ + COUNTRY_CHPLAN_ENT("GN", 0x26, 1, 0x210), /* Guinea */ + COUNTRY_CHPLAN_ENT("GP", 0x26, 1, 0x200), /* Guadeloupe (France) */ + COUNTRY_CHPLAN_ENT("GQ", 0x26, 1, 0x2B0), /* Equatorial Guinea */ + COUNTRY_CHPLAN_ENT("GR", 0x26, 1, 0x3FB), /* Greece */ + COUNTRY_CHPLAN_ENT("GS", 0x26, 1, 0x000), /* South Georgia and the Sandwich Islands (UK) */ + COUNTRY_CHPLAN_ENT("GT", 0x34, 1, 0x3F1), /* Guatemala */ + COUNTRY_CHPLAN_ENT("GU", 0x34, 1, 0x200), /* Guam (USA) */ + COUNTRY_CHPLAN_ENT("GW", 0x26, 1, 0x2B0), /* Guinea-Bissau */ + COUNTRY_CHPLAN_ENT("GY", 0x44, 1, 0x000), /* Guyana */ + COUNTRY_CHPLAN_ENT("HK", 0x26, 1, 0x3FB), /* Hong Kong */ + COUNTRY_CHPLAN_ENT("HM", 0x45, 1, 0x000), /* Heard and McDonald Islands (Australia) */ + COUNTRY_CHPLAN_ENT("HN", 0x32, 1, 0x3F1), /* Honduras */ + COUNTRY_CHPLAN_ENT("HR", 0x26, 1, 0x3F9), /* Croatia */ + COUNTRY_CHPLAN_ENT("HT", 0x34, 1, 0x250), /* Haiti */ + COUNTRY_CHPLAN_ENT("HU", 0x26, 1, 0x3FB), /* Hungary */ + COUNTRY_CHPLAN_ENT("ID", 0x54, 0, 0x3F3), /* Indonesia */ + COUNTRY_CHPLAN_ENT("IE", 0x26, 1, 0x3FB), /* Ireland */ + COUNTRY_CHPLAN_ENT("IL", 0x47, 1, 0x3F1), /* Israel */ + COUNTRY_CHPLAN_ENT("IM", 0x26, 1, 0x000), /* Isle of Man (UK) */ + COUNTRY_CHPLAN_ENT("IN", 0x48, 1, 0x3F1), /* India */ + COUNTRY_CHPLAN_ENT("IQ", 0x26, 1, 0x000), /* Iraq */ + COUNTRY_CHPLAN_ENT("IR", 0x26, 0, 0x000), /* Iran */ + COUNTRY_CHPLAN_ENT("IS", 0x26, 1, 0x3FB), /* Iceland */ + COUNTRY_CHPLAN_ENT("IT", 0x26, 1, 0x3FB), /* Italy */ + COUNTRY_CHPLAN_ENT("JE", 0x26, 1, 0x000), /* Jersey (UK) */ + COUNTRY_CHPLAN_ENT("JM", 0x51, 1, 0x3F1), /* Jamaica */ + COUNTRY_CHPLAN_ENT("JO", 0x49, 1, 0x3FB), /* Jordan */ + COUNTRY_CHPLAN_ENT("JP", 0x27, 1, 0x3FF), /* Japan- Telec */ + COUNTRY_CHPLAN_ENT("KE", 0x47, 1, 0x3F9), /* Kenya */ + COUNTRY_CHPLAN_ENT("KG", 0x26, 1, 0x3F1), /* Kyrgyzstan */ + COUNTRY_CHPLAN_ENT("KH", 0x26, 1, 0x3F1), /* Cambodia */ + COUNTRY_CHPLAN_ENT("KI", 0x26, 1, 0x000), /* Kiribati */ + COUNTRY_CHPLAN_ENT("KN", 0x34, 1, 0x000), /* Saint Kitts and Nevis */ + COUNTRY_CHPLAN_ENT("KR", 0x28, 1, 0x3FB), /* South Korea */ + COUNTRY_CHPLAN_ENT("KW", 0x47, 1, 0x3FB), /* Kuwait */ + COUNTRY_CHPLAN_ENT("KY", 0x34, 1, 0x000), /* Cayman Islands (UK) */ + COUNTRY_CHPLAN_ENT("KZ", 0x26, 1, 0x300), /* Kazakhstan */ + COUNTRY_CHPLAN_ENT("LA", 0x26, 1, 0x000), /* Laos */ + COUNTRY_CHPLAN_ENT("LB", 0x26, 1, 0x3F1), /* Lebanon */ + COUNTRY_CHPLAN_ENT("LC", 0x34, 1, 0x000), /* Saint Lucia */ + COUNTRY_CHPLAN_ENT("LI", 0x26, 1, 0x3FB), /* Liechtenstein */ + COUNTRY_CHPLAN_ENT("LK", 0x26, 1, 0x3F1), /* Sri Lanka */ + COUNTRY_CHPLAN_ENT("LR", 0x26, 1, 0x2B0), /* Liberia */ + COUNTRY_CHPLAN_ENT("LS", 0x26, 1, 0x3F1), /* Lesotho */ + COUNTRY_CHPLAN_ENT("LT", 0x26, 1, 0x3FB), /* Lithuania */ + COUNTRY_CHPLAN_ENT("LU", 0x26, 1, 0x3FB), /* Luxembourg */ + COUNTRY_CHPLAN_ENT("LV", 0x26, 1, 0x3FB), /* Latvia */ + COUNTRY_CHPLAN_ENT("LY", 0x26, 1, 0x000), /* Libya */ + COUNTRY_CHPLAN_ENT("MA", 0x47, 1, 0x3F1), /* Morocco */ + COUNTRY_CHPLAN_ENT("MC", 0x26, 1, 0x3FB), /* Monaco */ + COUNTRY_CHPLAN_ENT("MD", 0x26, 1, 0x3F1), /* Moldova */ + COUNTRY_CHPLAN_ENT("ME", 0x26, 1, 0x3F1), /* Montenegro */ + COUNTRY_CHPLAN_ENT("MF", 0x34, 1, 0x000), /* Saint Martin */ + COUNTRY_CHPLAN_ENT("MG", 0x26, 1, 0x220), /* Madagascar */ + COUNTRY_CHPLAN_ENT("MH", 0x34, 1, 0x000), /* Marshall Islands (USA) */ + COUNTRY_CHPLAN_ENT("MK", 0x26, 1, 0x3F1), /* Republic of Macedonia (FYROM) */ + COUNTRY_CHPLAN_ENT("ML", 0x26, 1, 0x2B0), /* Mali */ + COUNTRY_CHPLAN_ENT("MM", 0x26, 1, 0x000), /* Burma (Myanmar) */ + COUNTRY_CHPLAN_ENT("MN", 0x26, 1, 0x000), /* Mongolia */ + COUNTRY_CHPLAN_ENT("MO", 0x26, 1, 0x200), /* Macau */ + COUNTRY_CHPLAN_ENT("MP", 0x34, 1, 0x000), /* Northern Mariana Islands (USA) */ + COUNTRY_CHPLAN_ENT("MQ", 0x26, 1, 0x240), /* Martinique (France) */ + COUNTRY_CHPLAN_ENT("MR", 0x26, 1, 0x2A0), /* Mauritania */ + COUNTRY_CHPLAN_ENT("MS", 0x26, 1, 0x000), /* Montserrat (UK) */ + COUNTRY_CHPLAN_ENT("MT", 0x26, 1, 0x3FB), /* Malta */ + COUNTRY_CHPLAN_ENT("MU", 0x26, 1, 0x2B0), /* Mauritius */ + COUNTRY_CHPLAN_ENT("MV", 0x47, 1, 0x000), /* Maldives */ + COUNTRY_CHPLAN_ENT("MW", 0x26, 1, 0x2B0), /* Malawi */ + COUNTRY_CHPLAN_ENT("MX", 0x61, 1, 0x3F1), /* Mexico */ + COUNTRY_CHPLAN_ENT("MY", 0x63, 1, 0x3F1), /* Malaysia */ + COUNTRY_CHPLAN_ENT("MZ", 0x26, 1, 0x3F1), /* Mozambique */ + COUNTRY_CHPLAN_ENT("NA", 0x26, 1, 0x300), /* Namibia */ + COUNTRY_CHPLAN_ENT("NC", 0x26, 1, 0x000), /* New Caledonia */ + COUNTRY_CHPLAN_ENT("NE", 0x26, 1, 0x2B0), /* Niger */ + COUNTRY_CHPLAN_ENT("NF", 0x45, 1, 0x000), /* Norfolk Island (Australia) */ + COUNTRY_CHPLAN_ENT("NG", 0x75, 1, 0x3F9), /* Nigeria */ + COUNTRY_CHPLAN_ENT("NI", 0x34, 1, 0x3F1), /* Nicaragua */ + COUNTRY_CHPLAN_ENT("NL", 0x26, 1, 0x3FB), /* Netherlands */ + COUNTRY_CHPLAN_ENT("NO", 0x26, 1, 0x3FB), /* Norway */ + COUNTRY_CHPLAN_ENT("NP", 0x47, 1, 0x2F0), /* Nepal */ + COUNTRY_CHPLAN_ENT("NR", 0x26, 1, 0x000), /* Nauru */ + COUNTRY_CHPLAN_ENT("NU", 0x45, 1, 0x000), /* Niue */ + COUNTRY_CHPLAN_ENT("NZ", 0x45, 1, 0x3FB), /* New Zealand */ + COUNTRY_CHPLAN_ENT("OM", 0x26, 1, 0x3F9), /* Oman */ + COUNTRY_CHPLAN_ENT("PA", 0x34, 1, 0x3F1), /* Panama */ + COUNTRY_CHPLAN_ENT("PE", 0x34, 1, 0x3F1), /* Peru */ + COUNTRY_CHPLAN_ENT("PF", 0x26, 1, 0x000), /* French Polynesia (France) */ + COUNTRY_CHPLAN_ENT("PG", 0x26, 1, 0x3F1), /* Papua New Guinea */ + COUNTRY_CHPLAN_ENT("PH", 0x26, 1, 0x3F1), /* Philippines */ + COUNTRY_CHPLAN_ENT("PK", 0x51, 1, 0x3F1), /* Pakistan */ + COUNTRY_CHPLAN_ENT("PL", 0x26, 1, 0x3FB), /* Poland */ + COUNTRY_CHPLAN_ENT("PM", 0x26, 1, 0x000), /* Saint Pierre and Miquelon (France) */ + COUNTRY_CHPLAN_ENT("PR", 0x34, 1, 0x3F1), /* Puerto Rico */ + COUNTRY_CHPLAN_ENT("PT", 0x26, 1, 0x3FB), /* Portugal */ + COUNTRY_CHPLAN_ENT("PW", 0x34, 1, 0x000), /* Palau */ + COUNTRY_CHPLAN_ENT("PY", 0x34, 1, 0x3F1), /* Paraguay */ + COUNTRY_CHPLAN_ENT("QA", 0x51, 1, 0x3F9), /* Qatar */ + COUNTRY_CHPLAN_ENT("RE", 0x26, 1, 0x000), /* Reunion (France) */ + COUNTRY_CHPLAN_ENT("RO", 0x26, 1, 0x3F1), /* Romania */ + COUNTRY_CHPLAN_ENT("RS", 0x26, 1, 0x3F1), /* Serbia, Kosovo */ + COUNTRY_CHPLAN_ENT("RU", 0x59, 1, 0x3FB), /* Russia(fac/gost), Kaliningrad */ + COUNTRY_CHPLAN_ENT("RW", 0x26, 1, 0x2B0), /* Rwanda */ + COUNTRY_CHPLAN_ENT("SA", 0x26, 1, 0x3FB), /* Saudi Arabia */ + COUNTRY_CHPLAN_ENT("SB", 0x26, 1, 0x000), /* Solomon Islands */ + COUNTRY_CHPLAN_ENT("SC", 0x34, 1, 0x290), /* Seychelles */ + COUNTRY_CHPLAN_ENT("SE", 0x26, 1, 0x3FB), /* Sweden */ + COUNTRY_CHPLAN_ENT("SG", 0x26, 1, 0x3FB), /* Singapore */ + COUNTRY_CHPLAN_ENT("SH", 0x26, 1, 0x000), /* Saint Helena (UK) */ + COUNTRY_CHPLAN_ENT("SI", 0x26, 1, 0x3FB), /* Slovenia */ + COUNTRY_CHPLAN_ENT("SJ", 0x26, 1, 0x000), /* Svalbard (Norway) */ + COUNTRY_CHPLAN_ENT("SK", 0x26, 1, 0x3FB), /* Slovakia */ + COUNTRY_CHPLAN_ENT("SL", 0x26, 1, 0x2B0), /* Sierra Leone */ + COUNTRY_CHPLAN_ENT("SM", 0x26, 1, 0x000), /* San Marino */ + COUNTRY_CHPLAN_ENT("SN", 0x26, 1, 0x3F1), /* Senegal */ + COUNTRY_CHPLAN_ENT("SO", 0x26, 1, 0x000), /* Somalia */ + COUNTRY_CHPLAN_ENT("SR", 0x74, 1, 0x000), /* Suriname */ + COUNTRY_CHPLAN_ENT("ST", 0x34, 1, 0x280), /* Sao Tome and Principe */ + COUNTRY_CHPLAN_ENT("SV", 0x30, 1, 0x3F1), /* El Salvador */ + COUNTRY_CHPLAN_ENT("SX", 0x34, 1, 0x000), /* Sint Marteen */ + COUNTRY_CHPLAN_ENT("SZ", 0x26, 1, 0x020), /* Swaziland */ + COUNTRY_CHPLAN_ENT("TC", 0x26, 1, 0x000), /* Turks and Caicos Islands (UK) */ + COUNTRY_CHPLAN_ENT("TD", 0x26, 1, 0x2B0), /* Chad */ + COUNTRY_CHPLAN_ENT("TF", 0x26, 1, 0x280), /* French Southern and Antarctic Lands (FR Southern Territories) */ + COUNTRY_CHPLAN_ENT("TG", 0x26, 1, 0x2B0), /* Togo */ + COUNTRY_CHPLAN_ENT("TH", 0x26, 1, 0x3F1), /* Thailand */ + COUNTRY_CHPLAN_ENT("TJ", 0x26, 1, 0x240), /* Tajikistan */ + COUNTRY_CHPLAN_ENT("TK", 0x45, 1, 0x000), /* Tokelau */ + COUNTRY_CHPLAN_ENT("TM", 0x26, 1, 0x000), /* Turkmenistan */ + COUNTRY_CHPLAN_ENT("TN", 0x47, 1, 0x3F1), /* Tunisia */ + COUNTRY_CHPLAN_ENT("TO", 0x26, 1, 0x000), /* Tonga */ + COUNTRY_CHPLAN_ENT("TR", 0x26, 1, 0x3F1), /* Turkey, Northern Cyprus */ + COUNTRY_CHPLAN_ENT("TT", 0x42, 1, 0x3F1), /* Trinidad & Tobago */ + COUNTRY_CHPLAN_ENT("TW", 0x76, 1, 0x3FF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("TZ", 0x26, 1, 0x2F0), /* Tanzania */ + COUNTRY_CHPLAN_ENT("UA", 0x36, 1, 0x3FB), /* Ukraine */ + COUNTRY_CHPLAN_ENT("UG", 0x26, 1, 0x2F1), /* Uganda */ + COUNTRY_CHPLAN_ENT("US", 0x76, 1, 0x3FF), /* United States of America (USA) */ + COUNTRY_CHPLAN_ENT("UY", 0x30, 1, 0x3F1), /* Uruguay */ + COUNTRY_CHPLAN_ENT("UZ", 0x47, 1, 0x2F0), /* Uzbekistan */ + COUNTRY_CHPLAN_ENT("VA", 0x26, 1, 0x000), /* Holy See (Vatican City) */ + COUNTRY_CHPLAN_ENT("VC", 0x34, 1, 0x010), /* Saint Vincent and the Grenadines */ + COUNTRY_CHPLAN_ENT("VE", 0x30, 1, 0x3F1), /* Venezuela */ + COUNTRY_CHPLAN_ENT("VI", 0x34, 1, 0x000), /* United States Virgin Islands (USA) */ + COUNTRY_CHPLAN_ENT("VN", 0x26, 1, 0x3F1), /* Vietnam */ + COUNTRY_CHPLAN_ENT("VU", 0x26, 1, 0x000), /* Vanuatu */ + COUNTRY_CHPLAN_ENT("WF", 0x26, 1, 0x000), /* Wallis and Futuna (France) */ + COUNTRY_CHPLAN_ENT("WS", 0x34, 1, 0x000), /* Samoa */ + COUNTRY_CHPLAN_ENT("YE", 0x26, 1, 0x040), /* Yemen */ + COUNTRY_CHPLAN_ENT("YT", 0x26, 1, 0x280), /* Mayotte (France) */ + COUNTRY_CHPLAN_ENT("ZA", 0x26, 1, 0x3F1), /* South Africa */ + COUNTRY_CHPLAN_ENT("ZM", 0x26, 1, 0x2B0), /* Zambia */ + COUNTRY_CHPLAN_ENT("ZW", 0x26, 1, 0x3F1), /* Zimbabwe */ }; -u16 const country_chplan_map_sz = sizeof(country_chplan_map) / sizeof(struct country_chplan); - /* * rtw_get_chplan_from_country - * @country_code: string of country code @@ -938,10 +998,10 @@ const struct country_chplan *rtw_get_chplan_from_country(const char *country_cod #ifdef CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP map = CUSTOMIZED_country_chplan_map; - map_sz = CUSTOMIZED_country_chplan_map_sz; + map_sz = sizeof(CUSTOMIZED_country_chplan_map) / sizeof(struct country_chplan); #else map = country_chplan_map; - map_sz = country_chplan_map_sz; + map_sz = sizeof(country_chplan_map) / sizeof(struct country_chplan); #endif for (i = 0; i < map_sz; i++) { @@ -960,6 +1020,629 @@ const struct country_chplan *rtw_get_chplan_from_country(const char *country_cod return ent; } +const char *const _regd_str[] = { + "NONE", + "FCC", + "MKK", + "ETSI", + "IC", + "KCC", + "WW", +}; + +#ifdef CONFIG_TXPWR_LIMIT +void _dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl) +{ + struct regd_exc_ent *ent; + _list *cur, *head; + + RTW_PRINT_SEL(sel, "regd_exc_num:%u\n", rfctl->regd_exc_num); + + if (!rfctl->regd_exc_num) + goto exit; + + RTW_PRINT_SEL(sel, "%-7s %-6s %-9s\n", "country", "domain", "regd_name"); + + head = &rfctl->reg_exc_list; + cur = get_next(head); + + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + u8 has_country; + + ent = LIST_CONTAINOR(cur, struct regd_exc_ent, list); + cur = get_next(cur); + has_country = (ent->country[0] == '\0' && ent->country[1] == '\0') ? 0 : 1; + + RTW_PRINT_SEL(sel, " %c%c 0x%02x %s\n" + , has_country ? ent->country[0] : '0' + , has_country ? ent->country[1] : '0' + , ent->domain + , ent->regd_name + ); + } + +exit: + return; +} + +inline void dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl) +{ + _irqL irqL; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + _dump_regd_exc_list(sel, rfctl); + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); +} + +void rtw_regd_exc_add_with_nlen(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *regd_name, u32 nlen) +{ + struct regd_exc_ent *ent; + _irqL irqL; + + if (!regd_name || !nlen) { + rtw_warn_on(1); + goto exit; + } + + ent = (struct regd_exc_ent *)rtw_zmalloc(sizeof(struct regd_exc_ent) + nlen + 1); + if (!ent) + goto exit; + + _rtw_init_listhead(&ent->list); + if (country) + _rtw_memcpy(ent->country, country, 2); + ent->domain = domain; + _rtw_memcpy(ent->regd_name, regd_name, nlen); + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + rtw_list_insert_tail(&ent->list, &rfctl->reg_exc_list); + rfctl->regd_exc_num++; + + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + +exit: + return; +} + +inline void rtw_regd_exc_add(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *regd_name) +{ + rtw_regd_exc_add_with_nlen(rfctl, country, domain, regd_name, strlen(regd_name)); +} + +struct regd_exc_ent *_rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain) +{ + struct regd_exc_ent *ent; + _list *cur, *head; + u8 match = 0; + + head = &rfctl->reg_exc_list; + cur = get_next(head); + + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + u8 has_country; + + ent = LIST_CONTAINOR(cur, struct regd_exc_ent, list); + cur = get_next(cur); + has_country = (ent->country[0] == '\0' && ent->country[1] == '\0') ? 0 : 1; + + /* entry has country condition to match */ + if (has_country) { + if (!country) + continue; + if (ent->country[0] != country[0] + || ent->country[1] != country[1]) + continue; + } + + /* entry has domain condition to match */ + if (ent->domain != 0xFF) { + if (domain == 0xFF) + continue; + if (ent->domain != domain) + continue; + } + + match = 1; + break; + } + +exit: + if (match) + return ent; + else + return NULL; +} + +inline struct regd_exc_ent *rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain) +{ + struct regd_exc_ent *ent; + _irqL irqL; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + ent = _rtw_regd_exc_search(rfctl, country, domain); + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + return ent; +} + +void rtw_regd_exc_list_free(struct rf_ctl_t *rfctl) +{ + struct regd_exc_ent *ent; + _irqL irqL; + _list *cur, *head; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + head = &rfctl->reg_exc_list; + cur = get_next(head); + + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct regd_exc_ent, list); + cur = get_next(cur); + rtw_list_delete(&ent->list); + rtw_mfree((u8 *)ent, sizeof(struct regd_exc_ent) + strlen(ent->regd_name) + 1); + } + rfctl->regd_exc_num = 0; + + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); +} + +void dump_txpwr_lmt(void *sel, _adapter *adapter) +{ +#define TMP_STR_LEN 16 + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + _irqL irqL; + char fmt[16]; + char tmp_str[TMP_STR_LEN]; + s8 *lmt_idx = NULL; + int bw, band, ch_num, tlrs, ntx_idx, rs, i, path; + u8 ch, n, rfpath_num; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + _dump_regd_exc_list(sel, rfctl); + RTW_PRINT_SEL(sel, "\n"); + + if (!rfctl->txpwr_regd_num) + goto release_lock; + + lmt_idx = rtw_malloc(sizeof(s8) * RF_PATH_MAX * rfctl->txpwr_regd_num); + if (!lmt_idx) { + RTW_ERR("%s alloc fail\n", __func__); + goto release_lock; + } + + RTW_PRINT_SEL(sel, "txpwr_lmt_2g_cck_ofdm_state:0x%02x\n", rfctl->txpwr_lmt_2g_cck_ofdm_state); + #ifdef CONFIG_IEEE80211_BAND_5GHZ + if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + RTW_PRINT_SEL(sel, "txpwr_lmt_5g_cck_ofdm_state:0x%02x\n", rfctl->txpwr_lmt_5g_cck_ofdm_state); + RTW_PRINT_SEL(sel, "txpwr_lmt_5g_20_40_ref:0x%02x\n", rfctl->txpwr_lmt_5g_20_40_ref); + #endif + RTW_PRINT_SEL(sel, "\n"); + + for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { + if (!hal_is_band_support(adapter, band)) + continue; + + rfpath_num = (band == BAND_ON_2_4G ? hal_spec->rfpath_num_2g : hal_spec->rfpath_num_5g); + + for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; bw++) { + + if (bw >= CHANNEL_WIDTH_160) + break; + if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) + break; + + if (band == BAND_ON_2_4G) + ch_num = CENTER_CH_2G_NUM; + else + ch_num = center_chs_5g_num(bw); + + if (ch_num == 0) { + rtw_warn_on(1); + break; + } + + for (tlrs = TXPWR_LMT_RS_CCK; tlrs < TXPWR_LMT_RS_NUM; tlrs++) { + + if (band == BAND_ON_2_4G && tlrs == TXPWR_LMT_RS_VHT) + continue; + if (band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) + continue; + if (bw > CHANNEL_WIDTH_20 && (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM)) + continue; + if (bw > CHANNEL_WIDTH_40 && tlrs == TXPWR_LMT_RS_HT) + continue; + if (tlrs == TXPWR_LMT_RS_VHT && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + continue; + + for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { + struct txpwr_lmt_ent *ent; + _list *cur, *head; + + if (ntx_idx >= hal_spec->tx_nss_num) + continue; + + /* bypass CCK multi-TX is not defined */ + if (tlrs == TXPWR_LMT_RS_CCK && ntx_idx > RF_1TX) { + if (band == BAND_ON_2_4G + && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_CCK_1T << ntx_idx))) + continue; + } + + /* bypass OFDM multi-TX is not defined */ + if (tlrs == TXPWR_LMT_RS_OFDM && ntx_idx > RF_1TX) { + if (band == BAND_ON_2_4G + && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) + continue; + #ifdef CONFIG_IEEE80211_BAND_5GHZ + if (band == BAND_ON_5G + && !(rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) + continue; + #endif + } + + /* bypass 5G 20M, 40M pure reference */ + #ifdef CONFIG_IEEE80211_BAND_5GHZ + if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { + if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_HT_FROM_VHT) { + if (tlrs == TXPWR_LMT_RS_HT) + continue; + } else if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_VHT_FROM_HT) { + if (tlrs == TXPWR_LMT_RS_VHT && bw <= CHANNEL_WIDTH_40) + continue; + } + } + #endif + + /* choose n-SS mapping rate section to get lmt diff value */ + if (tlrs == TXPWR_LMT_RS_CCK) + rs = CCK; + else if (tlrs == TXPWR_LMT_RS_OFDM) + rs = OFDM; + else if (tlrs == TXPWR_LMT_RS_HT) + rs = HT_1SS + ntx_idx; + else if (tlrs == TXPWR_LMT_RS_VHT) + rs = VHT_1SS + ntx_idx; + else { + RTW_ERR("%s invalid tlrs %u\n", __func__, tlrs); + continue; + } + + RTW_PRINT_SEL(sel, "[%s][%s][%s][%uT]\n" + , band_str(band) + , ch_width_str(bw) + , txpwr_lmt_rs_str(tlrs) + , ntx_idx + 1 + ); + + /* header for limit in db */ + RTW_PRINT_SEL(sel, "%3s ", "ch"); + + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + + sprintf(fmt, "%%%zus%%s ", strlen(ent->regd_name) < 4 ? 5 - strlen(ent->regd_name) : 1); + snprintf(tmp_str, TMP_STR_LEN, fmt + , strcmp(ent->regd_name, rfctl->regd_name) == 0 ? "*" : "" + , ent->regd_name); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } + sprintf(fmt, "%%%zus%%s ", strlen(regd_str(TXPWR_LMT_WW)) < 4 ? 5 - strlen(regd_str(TXPWR_LMT_WW)) : 1); + snprintf(tmp_str, TMP_STR_LEN, fmt + , strcmp(rfctl->regd_name, regd_str(TXPWR_LMT_WW)) == 0 ? "*" : "" + , regd_str(TXPWR_LMT_WW)); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + + /* header for limit offset */ + for (path = 0; path < RF_PATH_MAX; path++) { + if (path >= rfpath_num) + break; + _RTW_PRINT_SEL(sel, "|"); + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + _RTW_PRINT_SEL(sel, "%3c " + , strcmp(ent->regd_name, rfctl->regd_name) == 0 ? rf_path_char(path) : ' '); + } + _RTW_PRINT_SEL(sel, "%3c " + , strcmp(rfctl->regd_name, regd_str(TXPWR_LMT_WW)) == 0 ? rf_path_char(path) : ' '); + } + _RTW_PRINT_SEL(sel, "\n"); + + for (n = 0; n < ch_num; n++) { + s8 lmt; + s8 lmt_offset; + u8 base; + + if (band == BAND_ON_2_4G) + ch = n + 1; + else + ch = center_chs_5g(bw, n); + + if (ch == 0) { + rtw_warn_on(1); + break; + } + + /* dump limit in db */ + RTW_PRINT_SEL(sel, "%3u ", ch); + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + lmt = phy_get_txpwr_lmt_abs(adapter, ent->regd_name, band, bw, tlrs, ntx_idx, ch, 0); + if (lmt == MAX_POWER_INDEX) { + sprintf(fmt, "%%%zus ", strlen(ent->regd_name) >= 5 ? strlen(ent->regd_name) + 1 : 5); + snprintf(tmp_str, TMP_STR_LEN, fmt, "NA"); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else { + if (lmt == -1) { /* -0.5 */ + sprintf(fmt, "%%%zus ", strlen(ent->regd_name) >= 5 ? strlen(ent->regd_name) + 1 : 5); + snprintf(tmp_str, TMP_STR_LEN, fmt, "-0.5"); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else if (lmt % 2) { /* n.5 */ + sprintf(fmt, "%%%zud.5 ", strlen(ent->regd_name) >= 5 ? strlen(ent->regd_name) - 1 : 3); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / 2); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else { /* n */ + sprintf(fmt, "%%%zud ", strlen(ent->regd_name) >= 5 ? strlen(ent->regd_name) + 1 : 5); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / 2); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } + } + } + lmt = phy_get_txpwr_lmt_abs(adapter, regd_str(TXPWR_LMT_WW), band, bw, tlrs, ntx_idx, ch, 0); + if (lmt == MAX_POWER_INDEX) { + sprintf(fmt, "%%%zus ", strlen(regd_str(TXPWR_LMT_WW)) >= 5 ? strlen(regd_str(TXPWR_LMT_WW)) + 1 : 5); + snprintf(tmp_str, TMP_STR_LEN, fmt, "NA"); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else { + if (lmt == -1) { /* -0.5 */ + sprintf(fmt, "%%%zus ", strlen(regd_str(TXPWR_LMT_WW)) >= 5 ? strlen(regd_str(TXPWR_LMT_WW)) + 1 : 5); + snprintf(tmp_str, TMP_STR_LEN, fmt, "-0.5"); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else if (lmt % 2) { /* n.5 */ + sprintf(fmt, "%%%zud.5 ", strlen(regd_str(TXPWR_LMT_WW)) >= 5 ? strlen(regd_str(TXPWR_LMT_WW)) - 1 : 3); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / 2); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } else { /* n */ + sprintf(fmt, "%%%zud ", strlen(regd_str(TXPWR_LMT_WW)) >= 5 ? strlen(regd_str(TXPWR_LMT_WW)) + 1 : 5); + snprintf(tmp_str, TMP_STR_LEN, fmt, lmt / 2); + _RTW_PRINT_SEL(sel, "%s", tmp_str); + } + } + + /* dump limit offset of each path */ + for (path = RF_PATH_A; path < RF_PATH_MAX; path++) { + if (path >= rfpath_num) + break; + + base = PHY_GetTxPowerByRateBase(adapter, band, path, rs); + + _RTW_PRINT_SEL(sel, "|"); + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + i = 0; + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + lmt_offset = phy_get_txpwr_lmt(adapter, ent->regd_name, band, bw, path, rs, ntx_idx, ch, 0); + if (lmt_offset == MAX_POWER_INDEX) { + *(lmt_idx + i * RF_PATH_MAX + path) = MAX_POWER_INDEX; + _RTW_PRINT_SEL(sel, "%3s ", "NA"); + } else { + *(lmt_idx + i * RF_PATH_MAX + path) = lmt_offset + base; + _RTW_PRINT_SEL(sel, "%3d ", lmt_offset); + } + i++; + } + lmt_offset = phy_get_txpwr_lmt(adapter, regd_str(TXPWR_LMT_WW), band, bw, path, rs, ntx_idx, ch, 0); + if (lmt_offset == MAX_POWER_INDEX) + _RTW_PRINT_SEL(sel, "%3s ", "NA"); + else + _RTW_PRINT_SEL(sel, "%3d ", lmt_offset); + + } + + /* compare limit_idx of each path, print 'x' when mismatch */ + if (rfpath_num > 1) { + for (i = 0; i < rfctl->txpwr_regd_num; i++) { + for (path = 0; path < RF_PATH_MAX; path++) { + if (path >= rfpath_num) + break; + if (*(lmt_idx + i * RF_PATH_MAX + path) != *(lmt_idx + i * RF_PATH_MAX + ((path + 1) % rfpath_num))) + break; + } + if (path >= rfpath_num) + _RTW_PRINT_SEL(sel, " "); + else + _RTW_PRINT_SEL(sel, "x"); + } + } + _RTW_PRINT_SEL(sel, "\n"); + + } + RTW_PRINT_SEL(sel, "\n"); + } + } /* loop for rate sections */ + } /* loop for bandwidths */ + } /* loop for bands */ + + if (lmt_idx) + rtw_mfree(lmt_idx, sizeof(s8) * RF_PATH_MAX * rfctl->txpwr_regd_num); + +release_lock: + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); +} + +/* search matcing first, if not found, alloc one */ +void rtw_txpwr_lmt_add_with_nlen(struct rf_ctl_t *rfctl, const char *regd_name, u32 nlen + , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt) +{ + struct txpwr_lmt_ent *ent; + _irqL irqL; + _list *cur, *head; + s8 pre_lmt; + + if (!regd_name || !nlen) { + rtw_warn_on(1); + goto exit; + } + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + /* search for existed entry */ + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + + if (strlen(ent->regd_name) == nlen + && _rtw_memcmp(ent->regd_name, regd_name, nlen) == _TRUE) + goto chk_lmt_val; + } + + /* alloc new one */ + ent = (struct txpwr_lmt_ent *)rtw_zvmalloc(sizeof(struct txpwr_lmt_ent) + nlen + 1); + if (!ent) + goto release_lock; + + _rtw_init_listhead(&ent->list); + _rtw_memcpy(ent->regd_name, regd_name, nlen); + { + u8 j, k, l, m; + + for (j = 0; j < MAX_2_4G_BANDWIDTH_NUM; ++j) + for (k = 0; k < TXPWR_LMT_RS_NUM_2G; ++k) + for (m = 0; m < CENTER_CH_2G_NUM; ++m) + for (l = 0; l < MAX_TX_COUNT; ++l) + ent->lmt_2g[j][k][m][l] = MAX_POWER_INDEX; + #ifdef CONFIG_IEEE80211_BAND_5GHZ + for (j = 0; j < MAX_5G_BANDWIDTH_NUM; ++j) + for (k = 0; k < TXPWR_LMT_RS_NUM_5G; ++k) + for (m = 0; m < CENTER_CH_5G_ALL_NUM; ++m) + for (l = 0; l < MAX_TX_COUNT; ++l) + ent->lmt_5g[j][k][m][l] = MAX_POWER_INDEX; + #endif + } + + rtw_list_insert_tail(&ent->list, &rfctl->txpwr_lmt_list); + rfctl->txpwr_regd_num++; + +chk_lmt_val: + if (band == BAND_ON_2_4G) + pre_lmt = ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]; + #ifdef CONFIG_IEEE80211_BAND_5GHZ + else if (band == BAND_ON_5G) + pre_lmt = ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]; + #endif + else + goto release_lock; + + if (pre_lmt != MAX_POWER_INDEX) + RTW_PRINT("duplicate txpwr_lmt for [%s][%s][%s][%s][%uT][%d]\n" + , regd_name, band_str(band), ch_width_str(bw), txpwr_lmt_rs_str(tlrs), ntx_idx + 1 + , band == BAND_ON_2_4G ? ch_idx + 1 : center_ch_5g_all[ch_idx]); + + lmt = rtw_min(pre_lmt, lmt); + if (band == BAND_ON_2_4G) + ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx] = lmt; + #ifdef CONFIG_IEEE80211_BAND_5GHZ + else if (band == BAND_ON_5G) + ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx] = lmt; + #endif + + if (0) + RTW_PRINT("%s, %4s, %6s, %7s, %uT, ch%3d = %d\n" + , regd_name, band_str(band), ch_width_str(bw), txpwr_lmt_rs_str(tlrs), ntx_idx + 1 + , band == BAND_ON_2_4G ? ch_idx + 1 : center_ch_5g_all[ch_idx] + , lmt); + +release_lock: + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + +exit: + return; +} + +inline void rtw_txpwr_lmt_add(struct rf_ctl_t *rfctl, const char *regd_name + , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt) +{ + rtw_txpwr_lmt_add_with_nlen(rfctl, regd_name, strlen(regd_name) + , band, bw, tlrs, ntx_idx, ch_idx, lmt); +} + +struct txpwr_lmt_ent *_rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *regd_name) +{ + struct txpwr_lmt_ent *ent; + _list *cur, *head; + u8 found = 0; + + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + + if (strcmp(ent->regd_name, regd_name) == 0) { + found = 1; + break; + } + } + + if (found) + return ent; + return NULL; +} + +inline struct txpwr_lmt_ent *rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *regd_name) +{ + struct txpwr_lmt_ent *ent; + _irqL irqL; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + ent = _rtw_txpwr_lmt_get_by_name(rfctl, regd_name); + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + return ent; +} + +void rtw_txpwr_lmt_list_free(struct rf_ctl_t *rfctl) +{ + struct txpwr_lmt_ent *ent; + _irqL irqL; + _list *cur, *head; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + if (ent->regd_name == rfctl->regd_name) + rfctl->regd_name = regd_str(TXPWR_LMT_NONE); + rtw_list_delete(&ent->list); + rtw_vmfree((u8 *)ent, sizeof(struct txpwr_lmt_ent) + strlen(ent->regd_name) + 1); + } + rfctl->txpwr_regd_num = 0; + + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); +} +#endif /* CONFIG_TXPWR_LIMIT */ + int rtw_ch_to_bb_gain_sel(int ch) { int sel = -1; @@ -1109,24 +1792,62 @@ void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch) } } -bool rtw_is_dfs_range(u32 hi, u32 lo) +inline u8 rtw_is_5g_band1(u8 ch) { - return rtw_is_range_overlap(hi, lo, 5720 + 10, 5260 - 10) ? _TRUE : _FALSE; + if (ch >= 36 && ch <= 48) + return 1; + return 0; } -bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset) +inline u8 rtw_is_5g_band2(u8 ch) +{ + if (ch >= 52 && ch <= 64) + return 1; + return 0; +} + +inline u8 rtw_is_5g_band3(u8 ch) +{ + if (ch >= 100 && ch <= 144) + return 1; + return 0; +} + +inline u8 rtw_is_5g_band4(u8 ch) +{ + if (ch >= 149 && ch <= 177) + return 1; + return 0; +} + +inline u8 rtw_is_dfs_range(u32 hi, u32 lo) +{ + return rtw_is_range_overlap(hi, lo, 5720 + 10, 5260 - 10); +} + +u8 rtw_is_dfs_ch(u8 ch) { u32 hi, lo; - if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE) - return _FALSE; + if (!rtw_chbw_to_freq_range(ch, CHANNEL_WIDTH_20, HAL_PRIME_CHNL_OFFSET_DONT_CARE, &hi, &lo)) + return 0; - return rtw_is_dfs_range(hi, lo) ? _TRUE : _FALSE; + return rtw_is_dfs_range(hi, lo); +} + +u8 rtw_is_dfs_chbw(u8 ch, u8 bw, u8 offset) +{ + u32 hi, lo; + + if (!rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo)) + return 0; + + return rtw_is_dfs_range(hi, lo); } bool rtw_is_long_cac_range(u32 hi, u32 lo, u8 dfs_region) { - return (dfs_region == PHYDM_DFS_DOMAIN_ETSI && rtw_is_range_overlap(hi, lo, 5660 + 10, 5600 - 10)) ? _TRUE : _FALSE; + return (dfs_region == PHYDM_DFS_DOMAIN_ETSI && rtw_is_range_overlap(hi, lo, 5650, 5600)) ? _TRUE : _FALSE; } bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset, u8 dfs_region) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm.c new file mode 100644 index 000000000000..f29f45a295c3 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm.c @@ -0,0 +1,2415 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 +#include +#include "rtw_rm_fsm.h" + +#define pstr(s) s+strlen(s) + +u8 rm_post_event_hdl(_adapter *padapter, u8 *pbuf) +{ +#ifdef CONFIG_RTW_80211K + struct rm_event *pev = (struct rm_event *)pbuf; + + _rm_post_event(padapter, pev->rmid, pev->evid); + rm_handler(padapter, pev); +#endif + return H2C_SUCCESS; +} + +#ifdef CONFIG_RTW_80211K + +/* 802.11-2012 Table E-1 Operationg classes in United States */ +static RT_OPERATING_CLASS RTW_OP_CLASS_US[] = { + /* 0, OP_CLASS_NULL */ { 0, 0, {}}, + /* 1, OP_CLASS_1 */ {115, 4, {36, 40, 44, 48}}, + /* 2, OP_CLASS_2 */ {118, 4, {52, 56, 60, 64}}, + /* 3, OP_CLASS_3 */ {124, 4, {149, 153, 157, 161}}, + /* 4, OP_CLASS_4 */ {121, 11, {100, 104, 108, 112, 116, 120, 124, + 128, 132, 136, 140}}, + /* 5, OP_CLASS_5 */ {125, 5, {149, 153, 157, 161, 165}}, + /* 6, OP_CLASS_12 */ { 81, 11, {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}} +}; + +struct cmd_meas_type_ { + u8 id; + char *name; +}; + +char *rm_type_req_name(u8 meas_type) { + + switch (meas_type) { + case basic_req: + return "basic_req"; + case cca_req: + return "cca_req"; + case rpi_histo_req: + return "rpi_histo_req"; + case ch_load_req: + return "ch_load_req"; + case noise_histo_req: + return "noise_histo_req"; + case bcn_req: + return "bcn_req"; + case frame_req: + return "frame_req"; + case sta_statis_req: + return "sta_statis_req"; + } + return "unknown_req"; +}; + +char *rm_type_rep_name(u8 meas_type) { + + switch (meas_type) { + case basic_rep: + return "basic_rep"; + case cca_rep: + return "cca_rep"; + case rpi_histo_rep: + return "rpi_histo_rep"; + case ch_load_rep: + return "ch_load_rep"; + case noise_histo_rep: + return "noise_histo_rep"; + case bcn_rep: + return "bcn_rep"; + case frame_rep: + return "frame_rep"; + case sta_statis_rep: + return "sta_statis_rep"; + } + return "unknown_rep"; +}; + +char *rm_en_cap_name(enum rm_cap_en en) +{ + switch (en) { + case RM_LINK_MEAS_CAP_EN: + return "RM_LINK_MEAS_CAP_EN"; + case RM_NB_REP_CAP_EN: + return "RM_NB_REP_CAP_EN"; + case RM_PARAL_MEAS_CAP_EN: + return "RM_PARAL_MEAS_CAP_EN"; + case RM_REPEAT_MEAS_CAP_EN: + return "RM_REPEAT_MEAS_CAP_EN"; + case RM_BCN_PASSIVE_MEAS_CAP_EN: + return "RM_BCN_PASSIVE_MEAS_CAP_EN"; + case RM_BCN_ACTIVE_MEAS_CAP_EN: + return "RM_BCN_ACTIVE_MEAS_CAP_EN"; + case RM_BCN_TABLE_MEAS_CAP_EN: + return "RM_BCN_TABLE_MEAS_CAP_EN"; + case RM_BCN_MEAS_REP_COND_CAP_EN: + return "RM_BCN_MEAS_REP_COND_CAP_EN"; + + case RM_FRAME_MEAS_CAP_EN: + return "RM_FRAME_MEAS_CAP_EN"; + case RM_CH_LOAD_CAP_EN: + return "RM_CH_LOAD_CAP_EN"; + case RM_NOISE_HISTO_CAP_EN: + return "RM_NOISE_HISTO_CAP_EN"; + case RM_STATIS_MEAS_CAP_EN: + return "RM_STATIS_MEAS_CAP_EN"; + case RM_LCI_MEAS_CAP_EN: + return "RM_LCI_MEAS_CAP_EN"; + case RM_LCI_AMIMUTH_CAP_EN: + return "RM_LCI_AMIMUTH_CAP_EN"; + case RM_TRANS_STREAM_CAT_MEAS_CAP_EN: + return "RM_TRANS_STREAM_CAT_MEAS_CAP_EN"; + case RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN: + return "RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN"; + + case RM_AP_CH_REP_CAP_EN: + return "RM_AP_CH_REP_CAP_EN"; + case RM_RM_MIB_CAP_EN: + return "RM_RM_MIB_CAP_EN"; + case RM_OP_CH_MAX_MEAS_DUR0: + return "RM_OP_CH_MAX_MEAS_DUR0"; + case RM_OP_CH_MAX_MEAS_DUR1: + return "RM_OP_CH_MAX_MEAS_DUR1"; + case RM_OP_CH_MAX_MEAS_DUR2: + return "RM_OP_CH_MAX_MEAS_DUR2"; + case RM_NONOP_CH_MAX_MEAS_DUR0: + return "RM_NONOP_CH_MAX_MEAS_DUR0"; + case RM_NONOP_CH_MAX_MEAS_DUR1: + return "RM_NONOP_CH_MAX_MEAS_DUR1"; + case RM_NONOP_CH_MAX_MEAS_DUR2: + return "RM_NONOP_CH_MAX_MEAS_DUR2"; + + case RM_MEAS_PILOT_CAP0: + return "RM_MEAS_PILOT_CAP0"; /* 24-26 */ + case RM_MEAS_PILOT_CAP1: + return "RM_MEAS_PILOT_CAP1"; + case RM_MEAS_PILOT_CAP2: + return "RM_MEAS_PILOT_CAP2"; + case RM_MEAS_PILOT_TRANS_INFO_CAP_EN: + return "RM_MEAS_PILOT_TRANS_INFO_CAP_EN"; + case RM_NB_REP_TSF_OFFSET_CAP_EN: + return "RM_NB_REP_TSF_OFFSET_CAP_EN"; + case RM_RCPI_MEAS_CAP_EN: + return "RM_RCPI_MEAS_CAP_EN"; /* 29 */ + case RM_RSNI_MEAS_CAP_EN: + return "RM_RSNI_MEAS_CAP_EN"; + case RM_BSS_AVG_ACCESS_DELAY_CAP_EN: + return "RM_BSS_AVG_ACCESS_DELAY_CAP_EN"; + + case RM_AVALB_ADMIS_CAPACITY_CAP_EN: + return "RM_AVALB_ADMIS_CAPACITY_CAP_EN"; + case RM_ANT_CAP_EN: + return "RM_ANT_CAP_EN"; + case RM_RSVD: + case RM_MAX: + default: + break; + } + return "unknown"; +} + +int rm_en_cap_chk_and_set(struct rm_obj *prm, enum rm_cap_en en) +{ + int idx; + u8 cap; + + + if (en >= RM_MAX) + return _FALSE; + + idx = en / 8; + cap = prm->psta->padapter->rmpriv.rm_en_cap_def[idx]; + + if (!(cap & BIT(en - (idx*8)))) { + RTW_INFO("RM: %s incapable\n",rm_en_cap_name(en)); + rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); + return _FALSE; + } + return _SUCCESS; +} + +static u8 rm_get_oper_class_via_ch(u8 ch) +{ + int i,j,sz; + + + sz = sizeof(RTW_OP_CLASS_US)/sizeof(struct _RT_OPERATING_CLASS); + + for (i = 0; i < sz; i++) { + for (j = 0; j < RTW_OP_CLASS_US[i].Len; j++) { + if ( ch == RTW_OP_CLASS_US[i].Channel[j]) { + RTW_INFO("RM: ch %u in oper_calss %u\n", + ch, RTW_OP_CLASS_US[i].global_op_class); + return RTW_OP_CLASS_US[i].global_op_class; + break; + } + } + } + return 0; +} + +static u8 rm_get_ch_set( + struct rtw_ieee80211_channel *pch_set, u8 op_class, u8 ch_num) +{ + int i,j,sz; + u8 ch_amount = 0; + + + sz = sizeof(RTW_OP_CLASS_US)/sizeof(struct _RT_OPERATING_CLASS); + + if (ch_num != 0) { + pch_set[0].hw_value = ch_num; + ch_amount = 1; + RTW_INFO("RM: meas_ch->hw_value = %u\n", pch_set->hw_value); + goto done; + } + + for (i = 0; i < sz; i++) { + + if (RTW_OP_CLASS_US[i].global_op_class == op_class) { + + for (j = 0; j < RTW_OP_CLASS_US[i].Len; j++) { + pch_set[j].hw_value = + RTW_OP_CLASS_US[i].Channel[j]; + RTW_INFO("RM: meas_ch[%d].hw_value = %u\n", + j, pch_set[j].hw_value); + } + ch_amount = RTW_OP_CLASS_US[i].Len; + break; + } + } +done: + return ch_amount; +} + +static int is_wildcard_bssid(u8 *bssid) +{ + int i; + u8 val8 = 0xff; + + + for (i=0;i<6;i++) + val8 &= bssid[i]; + + if (val8 == 0xff) + return _SUCCESS; + return _FALSE; +} + +static u8 *build_wlan_hdr(_adapter *padapter, struct xmit_frame *pmgntframe, + struct sta_info *psta, u16 frame_type) +{ + u8 *pframe; + u16 *fctrl; + struct pkt_attrib *pattr; + struct rtw_ieee80211_hdr *pwlanhdr; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + + + /* update attribute */ + pattr = &pmgntframe->attrib; + update_mgntframe_attrib(padapter, pattr); + + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + fctrl = &(pwlanhdr->frame_ctl); + *(fctrl) = 0; + + _rtw_memcpy(pwlanhdr->addr1, psta->cmn.mac_addr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, + get_my_bssid(&(pmlmeinfo->network)),ETH_ALEN); + + RTW_INFO("RM: dst = " MAC_FMT "\n", MAC_ARG(pwlanhdr->addr1)); + + SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); + pmlmeext->mgnt_seq++; + SetFragNum(pframe, 0); + + set_frame_sub_type(pframe, WIFI_ACTION); + + pframe += sizeof(struct rtw_ieee80211_hdr_3addr); + pattr->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); + + return pframe; +} + +void rm_set_rep_mode(struct rm_obj *prm, u8 mode) +{ + + RTW_INFO("RM: rmid=%x set %s\n", + prm->rmid, + mode|MEAS_REP_MOD_INCAP?"INCAP": + mode|MEAS_REP_MOD_REFUSE?"REFUSE": + mode|MEAS_REP_MOD_LATE?"LATE":""); + + prm->p.m_mode |= mode; +} + +int issue_null_reply(struct rm_obj *prm) +{ + int len=0, my_len; + u8 *pframe, m_mode; + _adapter *padapter = prm->psta->padapter; + struct pkt_attrib *pattr; + struct xmit_frame *pmgntframe; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + + + m_mode = prm->p.m_mode; + if (m_mode || prm->p.rpt == 0) { + RTW_INFO("RM: rmid=%x reply (%s repeat=%d)\n", + prm->rmid, + m_mode&MEAS_REP_MOD_INCAP?"INCAP": + m_mode&MEAS_REP_MOD_REFUSE?"REFUSE": + m_mode&MEAS_REP_MOD_LATE?"LATE":"no content", + prm->p.rpt); + } + + switch (prm->p.action_code) { + case RM_ACT_RADIO_MEAS_REQ: + len = 8; + break; + case RM_ACT_NB_REP_REQ: + len = 3; + break; + case RM_ACT_LINK_MEAS_REQ: + len = 3; + break; + default: + break; + } + + if (len==0) + return _FALSE; + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (pmgntframe == NULL) { + RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__); + return _FALSE; + } + pattr = &pmgntframe->attrib; + pframe = build_wlan_hdr(padapter, pmgntframe, prm->psta, WIFI_ACTION); + pframe = rtw_set_fixed_ie(pframe, 3, &prm->p.category, &pattr->pktlen); + + my_len = 0; + if (len>5) { + prm->p.len = len - 3 - 2; + pframe = rtw_set_fixed_ie(pframe, len - 3, + &prm->p.e_id, &my_len); + } + + pattr->pktlen += my_len; + pattr->last_txcmdsz = pattr->pktlen; + dump_mgntframe(padapter, pmgntframe); + + return _SUCCESS; +} + +int ready_for_scan(struct rm_obj *prm) +{ + _adapter *padapter = prm->psta->padapter; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + + + if (rtw_is_scan_deny(padapter)) + return _FALSE; + + if (!rtw_is_adapter_up(padapter)) + return _FALSE; + + if (rtw_mi_busy_traffic_check(padapter, _FALSE)) + return _FALSE; + + if (check_fwstate(pmlmepriv, WIFI_AP_STATE) + && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { + RTW_INFO(FUNC_ADPT_FMT" WIFI_AP_STATE && WIFI_UNDER_WPS\n", + FUNC_ADPT_ARG(padapter)); + return _FALSE; + } + if (check_fwstate(pmlmepriv, + (_FW_UNDER_SURVEY | _FW_UNDER_LINKING)) == _TRUE) { + RTW_INFO(FUNC_ADPT_FMT" _FW_UNDER_SURVEY|_FW_UNDER_LINKING\n", + FUNC_ADPT_ARG(padapter)); + return _FALSE; + } + +#ifdef CONFIG_CONCURRENT_MODE + if (rtw_mi_buddy_check_fwstate(padapter, + (_FW_UNDER_SURVEY | _FW_UNDER_LINKING | WIFI_UNDER_WPS))) { + RTW_INFO(FUNC_ADPT_FMT", but buddy_intf is under scanning or linking or wps_phase\n", + FUNC_ADPT_ARG(padapter)); + return _FALSE; + } +#endif + return _SUCCESS; +} + +int rm_sitesurvey(struct rm_obj *prm) +{ + int meas_ch_num=0; + u8 ch_num=0, op_class=0, val8; + struct rtw_ieee80211_channel *pch_set; + struct sitesurvey_parm parm; + + + RTW_INFO("RM: rmid=%x %s\n",prm->rmid, __func__); + + pch_set = &prm->q.ch_set[0]; + + _rtw_memset(pch_set, 0, + sizeof(struct rtw_ieee80211_channel) * MAX_OP_CHANNEL_SET_NUM); + + if (prm->q.ch_num == 0) { + /* ch_num=0 : scan all ch in operating class */ + op_class = prm->q.op_class; + + } else if (prm->q.ch_num == 255) { + /* 802.11 p.499 */ + /* ch_num=255 : scan all ch in current operating class */ + op_class = rm_get_oper_class_via_ch( + (u8)prm->psta->padapter->mlmeextpriv.cur_channel); + } else + ch_num = prm->q.ch_num; + + /* get means channel */ + meas_ch_num = rm_get_ch_set(pch_set, op_class, ch_num); + prm->q.ch_set_ch_amount = meas_ch_num; + + _rtw_memset(&parm, 0, sizeof(struct sitesurvey_parm)); + _rtw_memcpy(parm.ch, pch_set, + sizeof(struct rtw_ieee80211_channel) * MAX_OP_CHANNEL_SET_NUM); + + _rtw_memcpy(&parm.ssid[0], &prm->q.opt.bcn.ssid, IW_ESSID_MAX_SIZE); + + parm.ssid_num = 1; + parm.scan_mode = prm->q.m_mode; + parm.ch_num = meas_ch_num; + parm.igi = 0; + parm.token = prm->rmid; + parm.duration = prm->q.meas_dur; + /* parm.bw = BW_20M; */ + + rtw_sitesurvey_cmd(prm->psta->padapter, &parm); + + return _SUCCESS; +} + +static u8 translate_percentage_to_rcpi(u32 SignalStrengthIndex) +{ + s32 SignalPower; /* in dBm. */ + u8 rcpi; + + /* Translate to dBm (x=y-100) */ + SignalPower = SignalStrengthIndex - 100; + + /* RCPI = Int{(Power in dBm + 110)*2} for 0dBm > Power > -110dBm + * 0 : power <= -110.0 dBm + * 1 : power = -109.5 dBm + * 2 : power = -109.0 dBm + */ + + rcpi = (SignalPower + 110)*2; + return rcpi; +} + +static int rm_parse_ch_load_s_elem(struct rm_obj *prm, u8 *pbody, int req_len) +{ + u8 *popt_id; + int i, p=0; /* position */ + int len = req_len; + + + prm->q.opt_s_elem_len = len; +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: opt_s_elem_len=%d\n", len); +#endif + while (len) { + + switch (pbody[p]) { + case ch_load_rep_info: + /* check RM_EN */ + rm_en_cap_chk_and_set(prm, RM_CH_LOAD_CAP_EN); + + _rtw_memcpy(&(prm->q.opt.clm.rep_cond), + &pbody[p+2], sizeof(prm->q.opt.clm.rep_cond)); + + RTW_INFO("RM: ch_load_rep_info=%u:%u\n", + prm->q.opt.clm.rep_cond.cond, + prm->q.opt.clm.rep_cond.threshold); + break; + default: + break; + + } + len = len - (int)pbody[p+1] - 2; + p = p + (int)pbody[p+1] + 2; +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: opt_s_elem_len=%d\n",len); +#endif + } + return _SUCCESS; +} + +static int rm_parse_noise_histo_s_elem(struct rm_obj *prm, + u8 *pbody, int req_len) +{ + u8 *popt_id; + int i, p=0; /* position */ + int len = req_len; + + + prm->q.opt_s_elem_len = len; +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: opt_s_elem_len=%d\n", len); +#endif + + while (len) { + + switch (pbody[p]) { + case noise_histo_rep_info: + /* check RM_EN */ + rm_en_cap_chk_and_set(prm, RM_NOISE_HISTO_CAP_EN); + + _rtw_memcpy(&(prm->q.opt.nhm.rep_cond), + &pbody[p+2], sizeof(prm->q.opt.nhm.rep_cond)); + + RTW_INFO("RM: noise_histo_rep_info=%u:%u\n", + prm->q.opt.nhm.rep_cond.cond, + prm->q.opt.nhm.rep_cond.threshold); + break; + default: + break; + + } + len = len - (int)pbody[p+1] - 2; + p = p + (int)pbody[p+1] + 2; +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: opt_s_elem_len=%d\n",len); +#endif + } + return _SUCCESS; +} + +static int rm_parse_bcn_req_s_elem(struct rm_obj *prm, u8 *pbody, int req_len) +{ + u8 *popt_id; + int i, p=0; /* position */ + int len = req_len; + + + /* opt length,2:pbody[0]+ pbody[1] */ + /* first opt id : pbody[18] */ + + prm->q.opt_s_elem_len = len; +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: opt_s_elem_len=%d\n", len); +#endif + + popt_id = prm->q.opt.bcn.opt_id; + while (len && prm->q.opt.bcn.opt_id_num < BCN_REQ_OPT_MAX_NUM) { + + switch (pbody[p]) { + case bcn_req_ssid: + RTW_INFO("bcn_req_ssid\n"); + +#if (DBG_BCN_REQ_WILDCARD) + RTW_INFO("DBG set ssid to WILDCARD\n"); +#else +#if (DBG_BCN_REQ_SSID) + RTW_INFO("DBG set ssid to %s\n",DBG_BCN_REQ_SSID_NAME); + i = strlen(DBG_BCN_REQ_SSID_NAME); + prm->q.opt.bcn.ssid.SsidLength = i; + _rtw_memcpy(&(prm->q.opt.bcn.ssid.Ssid), + DBG_BCN_REQ_SSID_NAME, i); + +#else /* original */ + prm->q.opt.bcn.ssid.SsidLength = pbody[p+1]; + _rtw_memcpy(&(prm->q.opt.bcn.ssid.Ssid), + &pbody[p+2], pbody[p+1]); +#endif +#endif + + RTW_INFO("RM: bcn_req_ssid=%s\n", + prm->q.opt.bcn.ssid.Ssid); + + popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; + break; + + case bcn_req_rep_info: + /* check RM_EN */ + rm_en_cap_chk_and_set(prm, RM_BCN_MEAS_REP_COND_CAP_EN); + + _rtw_memcpy(&(prm->q.opt.bcn.rep_cond), + &pbody[p+2], sizeof(prm->q.opt.bcn.rep_cond)); + + RTW_INFO("bcn_req_rep_info=%u:%u\n", + prm->q.opt.bcn.rep_cond.cond, + prm->q.opt.bcn.rep_cond.threshold); + + /*popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p];*/ + break; + + case bcn_req_rep_detail: +#if DBG_BCN_REQ_DETAIL + prm->q.opt.bcn.rep_detail = 2; /* all IE in beacon */ +#else + prm->q.opt.bcn.rep_detail = pbody[p+2]; +#endif + popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; + +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: report_detail=%d\n", + prm->q.opt.bcn.rep_detail); +#endif + break; + + case bcn_req_req: + RTW_INFO("RM: bcn_req_req\n"); + + prm->q.opt.bcn.req_start = rtw_malloc(pbody[p+1]); + + if (prm->q.opt.bcn.req_start == NULL) { + RTW_ERR("RM: req_start malloc fail!!\n"); + break; + } + + for (i = 0; i < pbody[p+1]; i++) + *((prm->q.opt.bcn.req_start)+i) = + pbody[p+2+i]; + + prm->q.opt.bcn.req_len = pbody[p+1]; + popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; + break; + + case bcn_req_ac_ch_rep: +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: bcn_req_ac_ch_rep\n"); +#endif + popt_id[prm->q.opt.bcn.opt_id_num++] = pbody[p]; + break; + + default: + break; + + } + len = len - (int)pbody[p+1] - 2; + p = p + (int)pbody[p+1] + 2; +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: opt_s_elem_len=%d\n",len); +#endif + } + + return _SUCCESS; +} + +static int rm_parse_meas_req(struct rm_obj *prm, u8 *pbody) +{ + int p; /* position */ + int req_len; + + + req_len = (int)pbody[1]; + p = 5; + + prm->q.op_class = pbody[p++]; + prm->q.ch_num = pbody[p++]; + prm->q.rand_intvl = le16_to_cpu(*(u16*)(&pbody[p])); + p+=2; + prm->q.meas_dur = le16_to_cpu(*(u16*)(&pbody[p])); + p+=2; + + if (prm->q.m_type == bcn_req) { + /* + * 0: passive + * 1: active + * 2: bcn_table + */ + prm->q.m_mode = pbody[p++]; + + /* BSSID */ + _rtw_memcpy(&(prm->q.bssid), &pbody[p], 6); + p+=6; + + /* + * default, used when Reporting detail subelement + * is not included in Beacon Request + */ + prm->q.opt.bcn.rep_detail = 2; + } + + if (req_len-(p-2) <= 0) /* without sub-element */ + return _SUCCESS; + + switch (prm->q.m_type) { + case bcn_req: + rm_parse_bcn_req_s_elem(prm, &pbody[p], req_len-(p-2)); + break; + case ch_load_req: + rm_parse_ch_load_s_elem(prm, &pbody[p], req_len-(p-2)); + break; + case noise_histo_req: + rm_parse_noise_histo_s_elem(prm, &pbody[p], req_len-(p-2)); + break; + default: + break; + } + + return _SUCCESS; +} + +/* receive measurement request */ +int rm_recv_radio_mens_req(_adapter *padapter, + union recv_frame *precv_frame, struct sta_info *psta) +{ + struct rm_obj *prm; + struct rm_priv *prmpriv = &padapter->rmpriv; + u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + + sizeof(struct rtw_ieee80211_hdr_3addr)); + u8 *pmeas_body = &pdiag_body[5]; + u8 rmid, update = 0; + + +#if 0 + /* search existing rm_obj */ + rmid = psta->cmn.aid << 16 + | pdiag_body[2] << 8 + | RM_SLAVE; + + prm = rm_get_rmobj(padapter, rmid); + if (prm) { + RTW_INFO("RM: Found an exist meas rmid=%u\n", rmid); + update = 1; + } else +#endif + prm = rm_alloc_rmobj(padapter); + + if (prm == NULL) { + RTW_ERR("RM: unable to alloc rm obj for requeset\n"); + return _FALSE; + } + + prm->psta = psta; + prm->q.diag_token = pdiag_body[2]; + prm->q.rpt = le16_to_cpu(*(u16*)(&pdiag_body[3])); + + /* Figure 8-104 Measurement Requested format */ + prm->q.e_id = pmeas_body[0]; + prm->q.m_token = pmeas_body[2]; + prm->q.m_mode = pmeas_body[3]; + prm->q.m_type = pmeas_body[4]; + + prm->rmid = psta->cmn.aid << 16 + | prm->q.diag_token << 8 + | RM_SLAVE; + + RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid, + MAC_ARG(prm->psta->cmn.mac_addr)); + +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: element_id = %d\n", prm->q.e_id); + RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]); + RTW_INFO("RM: meas_token = %d\n", prm->q.m_token); + RTW_INFO("RM: meas_mode = %d\n", prm->q.m_mode); + RTW_INFO("RM: meas_type = %d\n", prm->q.m_type); +#endif + + if (prm->q.e_id != _MEAS_REQ_IE_) /* 38 */ + return _FALSE; + + switch (prm->q.m_type) { + case bcn_req: + RTW_INFO("RM: recv beacon_request\n"); + switch (prm->q.m_mode) { + case bcn_req_passive: + rm_en_cap_chk_and_set(prm, RM_BCN_PASSIVE_MEAS_CAP_EN); + break; + case bcn_req_active: + rm_en_cap_chk_and_set(prm, RM_BCN_ACTIVE_MEAS_CAP_EN); + break; + case bcn_req_bcn_table: + rm_en_cap_chk_and_set(prm, RM_BCN_TABLE_MEAS_CAP_EN); + break; + default: + rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); + break; + } + break; + case ch_load_req: + RTW_INFO("RM: recv ch_load_request\n"); + rm_en_cap_chk_and_set(prm, RM_CH_LOAD_CAP_EN); + break; + case noise_histo_req: + RTW_INFO("RM: recv noise_histogram_request\n"); + rm_en_cap_chk_and_set(prm, RM_NOISE_HISTO_CAP_EN); + break; + default: + RTW_INFO("RM: recv unknown request type 0x%02x\n", + prm->q.m_type); + rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); + goto done; + } + rm_parse_meas_req(prm, pmeas_body); +done: + if (!update) + rm_enqueue_rmobj(padapter, prm, _FALSE); + + return _SUCCESS; +} + +/* receive measurement report */ +int rm_recv_radio_mens_rep(_adapter *padapter, + union recv_frame *precv_frame, struct sta_info *psta) +{ + int ret = _FALSE; + struct rm_obj *prm; + u32 rmid; + u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + + sizeof(struct rtw_ieee80211_hdr_3addr)); + u8 *pmeas_body = &pdiag_body[3]; + + + rmid = psta->cmn.aid << 16 + | pdiag_body[2] << 8 + | RM_MASTER; + + prm = rm_get_rmobj(padapter, rmid); + if (prm == NULL) + return _FALSE; + + prm->p.action_code = pdiag_body[1]; + prm->p.diag_token = pdiag_body[2]; + + /* Figure 8-140 Measuremnt Report format */ + prm->p.e_id = pmeas_body[0]; + prm->p.m_token = pmeas_body[2]; + prm->p.m_mode = pmeas_body[3]; + prm->p.m_type = pmeas_body[4]; + + RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid, + MAC_ARG(prm->psta->cmn.mac_addr)); + +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: element_id = %d\n", prm->p.e_id); + RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]); + RTW_INFO("RM: meas_token = %d\n", prm->p.m_token); + RTW_INFO("RM: meas_mode = %d\n", prm->p.m_mode); + RTW_INFO("RM: meas_type = %d\n", prm->p.m_type); +#endif + if (prm->p.e_id != _MEAS_RSP_IE_) /* 39 */ + return _FALSE; + + RTW_INFO("RM: recv %s\n", rm_type_rep_name(prm->p.m_type)); + rm_post_event(padapter, prm->rmid, RM_EV_recv_rep); + + return ret; +} + +int rm_radio_mens_nb_rep(_adapter *padapter, + union recv_frame *precv_frame, struct sta_info *psta) +{ + u8 *pdiag_body = (u8 *)(precv_frame->u.hdr.rx_data + + sizeof(struct rtw_ieee80211_hdr_3addr)); + u8 *pmeas_body = &pdiag_body[3]; + u32 len = precv_frame->u.hdr.len; + u32 rmid; + struct rm_obj *prm; + + + rmid = psta->cmn.aid << 16 + | pdiag_body[2] << 8 + | RM_MASTER; + + prm = rm_get_rmobj(padapter, rmid); + if (prm == NULL) + return _FALSE; + + prm->p.action_code = pdiag_body[1]; + prm->p.diag_token = pdiag_body[2]; + prm->p.e_id = pmeas_body[0]; + + RTW_INFO("RM: rmid=%x, bssid " MAC_FMT "\n", prm->rmid, + MAC_ARG(prm->psta->cmn.mac_addr)); + +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: element_id = %d\n", prm->p.e_id); + RTW_INFO("RM: length = %d\n", (int)pmeas_body[1]); +#endif + rm_post_event(padapter, prm->rmid, RM_EV_recv_rep); + +#ifdef CONFIG_RTW_BSS_TRANS + ret = bss_transition_candidates_list_survey(padapter, + pframe_body+3, len, _FALSE); + if (ret == _FAIL) + return _FALSE; +#endif + rtw_cfg80211_rx_rrm_action(padapter, precv_frame); + + return _TRUE; +} + +unsigned int rm_on_action(_adapter *padapter, union recv_frame *precv_frame) +{ + u32 ret = _FAIL; + u8 *pframe = NULL; + u8 *pframe_body = NULL; + u8 action_code = 0; + u8 diag_token = 0; + struct rtw_ieee80211_hdr_3addr *whdr; + struct sta_info *psta; + + + pframe = precv_frame->u.hdr.rx_data; + + /* check RA matches or not */ + if (!_rtw_memcmp(adapter_mac_addr(padapter), + GetAddr1Ptr(pframe), ETH_ALEN)) + goto exit; + + whdr = (struct rtw_ieee80211_hdr_3addr *)pframe; + RTW_INFO("RM: %s bssid = " MAC_FMT "\n", + __func__, MAC_ARG(whdr->addr2)); + + psta = rtw_get_stainfo(&padapter->stapriv, whdr->addr2); + + if (!psta) { + RTW_ERR("RM: psta not found\n"); + goto exit; + } + + pframe_body = (unsigned char *)(pframe + + sizeof(struct rtw_ieee80211_hdr_3addr)); + + /* Figure 8-438 radio measurement request frame Action field format */ + /* Category = pframe_body[0] = 5 (Radio Measurement) */ + action_code = pframe_body[1]; + diag_token = pframe_body[2]; + +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: %s radio_action=%x, diag_token=%x\n", __func__, + action_code, diag_token); +#endif + + switch (action_code) { + + case RM_ACT_RADIO_MEAS_REQ: + RTW_INFO("RM: RM_ACT_RADIO_MEAS_REQ\n"); + ret = rm_recv_radio_mens_req(padapter, precv_frame, psta); + break; + + case RM_ACT_RADIO_MEAS_REP: + RTW_INFO("RM: RM_ACT_RADIO_MEAS_REP\n"); + ret = rm_recv_radio_mens_rep(padapter, precv_frame, psta); + break; + + case RM_ACT_LINK_MEAS_REQ: + RTW_INFO("RM: RM_ACT_LINK_MEAS_REQ\n"); + break; + + case RM_ACT_LINK_MEAS_REP: + RTW_INFO("RM: RM_ACT_LINK_MEAS_REP\n"); + break; + + case RM_ACT_NB_REP_REQ: + RTW_INFO("RM: RM_ACT_NB_REP_REQ\n"); + break; + + case RM_ACT_NB_REP_RESP: + RTW_INFO("RM: RM_ACT_NB_REP_RESP\n"); + ret = rm_radio_mens_nb_rep(padapter, precv_frame, psta); + break; + + default: + /* TODO reply incabable */ + RTW_ERR("RM: unknown specturm management action %2x\n", + action_code); + break; + } +exit: + return ret; +} + +static u8 *rm_gen_bcn_detail_elem(_adapter *padapter, u8 *pframe, + struct rm_obj *prm, struct wlan_network *pnetwork, + unsigned int *fr_len) +{ + WLAN_BSSID_EX *pbss = &pnetwork->network; + unsigned int my_len; + int j, k, len; + u8 *plen; + u8 *ptr; + u8 val8, eid; + + + my_len = 0; + /* Reporting Detail values + * 0: No fixed length fields or elements + * 1: All fixed length fields and any requested elements + * in the Request info element if present + * 2: All fixed length fields and elements + * 3-255: Reserved + */ + + /* report_detail = 0 */ + if (prm->q.opt.bcn.rep_detail == 0 + || prm->q.opt.bcn.rep_detail > 2) { + return pframe; + } + + /* ID */ + val8 = 1; /* 1:reported frame body */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + plen = pframe; + val8 = 0; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* report_detail = 2 */ + if (prm->q.opt.bcn.rep_detail == 2) { + pframe = rtw_set_fixed_ie(pframe, pbss->IELength - 4, + pbss->IEs, &my_len); /* -4 remove FCS */ + goto done; + } + + /* report_detail = 1 */ + /* all fixed lenght fields */ + pframe = rtw_set_fixed_ie(pframe, + _FIXED_IE_LENGTH_, pbss->IEs, &my_len); + + for (j = 0; j < prm->q.opt.bcn.opt_id_num; j++) { + switch (prm->q.opt.bcn.opt_id[j]) { + case bcn_req_ssid: + /* SSID */ +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: bcn_req_ssid\n"); +#endif + pframe = rtw_set_ie(pframe, _SSID_IE_, + pbss->Ssid.SsidLength, + pbss->Ssid.Ssid, &my_len); + break; + case bcn_req_req: + if (prm->q.opt.bcn.req_start == NULL) + break; +#if (RM_MORE_DBG_MSG) + RTW_INFO("RM: bcn_req_req"); +#endif + for (k=0; kq.opt.bcn.req_len; k++) { + eid = prm->q.opt.bcn.req_start[k]; + + val8 = pbss->IELength - _FIXED_IE_LENGTH_; + ptr = rtw_get_ie(pbss->IEs + _FIXED_IE_LENGTH_, + eid, &len, val8); + + if (!ptr) + continue; +#if (RM_MORE_DBG_MSG) + switch (eid) { + case EID_QBSSLoad: + RTW_INFO("RM: EID_QBSSLoad\n"); + break; + case EID_HTCapability: + RTW_INFO("RM: EID_HTCapability\n"); + break; + case _MDIE_: + RTW_INFO("RM: EID_MobilityDomain\n"); + break; + default: + RTW_INFO("RM: EID %d todo\n",eid); + break; + } +#endif + pframe = rtw_set_ie(pframe, eid, + len,ptr+2, &my_len); + } /* for() */ + break; + case bcn_req_ac_ch_rep: + default: + RTW_INFO("RM: OPT %d TODO\n",prm->q.opt.bcn.opt_id[j]); + break; + } + } +done: + /* + * update my length + * content length does NOT include ID and LEN + */ + val8 = my_len - 2; + rtw_set_fixed_ie(plen, 1, &val8, &j); + + /* update length to caller */ + *fr_len += my_len; + + return pframe; +} + +static u8 rm_get_rcpi(struct rm_obj *prm, struct wlan_network *pnetwork) +{ + return translate_percentage_to_rcpi( + pnetwork->network.PhyInfo.SignalStrength); +} + +static u8 rm_get_rsni(struct rm_obj *prm, struct wlan_network *pnetwork) +{ + int i; + u8 val8, snr; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(prm->psta->padapter); + + + if (pnetwork->network.PhyInfo.is_cck_rate) { + /* current HW doesn't have CCK RSNI */ + /* 255 indicates RSNI is unavailable */ + val8 = 255; + } else { + snr = 0; + for (i = 0; i < pHalData->NumTotalRFPath; i++) { + snr += pnetwork->network.PhyInfo.rx_snr[i]; + } + snr = snr / pHalData->NumTotalRFPath; + val8 = (u8)(snr + 10)*2; + } + return val8; +} + +u8 rm_bcn_req_cond_mach(struct rm_obj *prm, struct wlan_network *pnetwork) +{ + u8 val8; + + + switch(prm->q.opt.bcn.rep_cond.cond) { + case bcn_rep_cond_immediately: + return _SUCCESS; + case bcn_req_cond_rcpi_greater: + val8 = rm_get_rcpi(prm, pnetwork); + if (val8 > prm->q.opt.bcn.rep_cond.threshold) + return _SUCCESS; + break; + case bcn_req_cond_rcpi_less: + val8 = rm_get_rcpi(prm, pnetwork); + if (val8 < prm->q.opt.bcn.rep_cond.threshold) + return _SUCCESS; + break; + case bcn_req_cond_rsni_greater: + val8 = rm_get_rsni(prm, pnetwork); + if (val8 != 255 && val8 > prm->q.opt.bcn.rep_cond.threshold) + return _SUCCESS; + break; + case bcn_req_cond_rsni_less: + val8 = rm_get_rsni(prm, pnetwork); + if (val8 != 255 && val8 < prm->q.opt.bcn.rep_cond.threshold) + return _SUCCESS; + break; + default: + RTW_ERR("RM: bcn_req cond %u not support\n", + prm->q.opt.bcn.rep_cond.cond); + break; + } + return _FALSE; +} + +static u8 *rm_bcn_rep_fill_scan_resule (struct rm_obj *prm, + u8 *pframe, struct wlan_network *pnetwork, unsigned int *fr_len) +{ + int snr, i; + u8 val8, *plen; + u16 val16; + u32 val32; + u64 val64; + PWLAN_BSSID_EX pbss; + unsigned int my_len; + _adapter *padapter = prm->psta->padapter; + + + my_len = 0; + /* meas ID */ + val8 = EID_MeasureReport; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* remember position form elelment length */ + plen = pframe; + + /* meas_rpt_len */ + /* default 3 = mode + token + type but no beacon content */ + val8 = 3; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* meas_token */ + val8 = prm->q.m_token; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* meas_rpt_mode F8-141 */ + val8 = prm->p.m_mode; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* meas_type T8-81 */ + val8 = bcn_rep; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + if (pnetwork == NULL) + goto done; + + pframe = rtw_set_fixed_ie(pframe, 1, &prm->q.op_class, &my_len); + + /* channel */ + pbss = &pnetwork->network; + val8 = pbss->Configuration.DSConfig; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* Actual Measurement StartTime */ + val64 = cpu_to_le64(prm->meas_start_time); + pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len); + + /* Measurement Duration */ + val16 = prm->meas_end_time - prm->meas_start_time; + val16 = cpu_to_le16(val16); + pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len); + + /* TODO + * ReportedFrameInformation: + * 0 :beacon or probe rsp + * 1 :pilot frame + */ + val8 = 0; /* report frame info */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* RCPI */ + val8 = rm_get_rcpi(prm, pnetwork); + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* RSNI */ + val8 = rm_get_rsni(prm, pnetwork); + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* BSSID */ + pframe = rtw_set_fixed_ie(pframe, 6, (u8 *)&pbss->MacAddress, &my_len); + + /* + * AntennaID + * 0: unknown + * 255: multiple antenna (Diversity) + */ + val8 = 0; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* ParentTSF */ + val32 = prm->meas_start_time + pnetwork->network.PhyInfo.free_cnt; + pframe = rtw_set_fixed_ie(pframe, 4, (u8 *)&val32, &my_len); + + /* + * Generate Beacon detail + */ + pframe = rm_gen_bcn_detail_elem(padapter, pframe, + prm, pnetwork, &my_len); +done: + /* + * update my length + * content length does NOT include ID and LEN + */ + val8 = my_len - 2; + rtw_set_fixed_ie(plen, 1, &val8, &i); + + /* update length to caller */ + *fr_len += my_len; + + return pframe; +} + +static u8 *rm_gen_bcn_rep_ie (struct rm_obj *prm, + u8 *pframe, struct wlan_network *pnetwork, unsigned int *fr_len) +{ + int snr, i; + u8 val8, *plen; + u16 val16; + u32 val32; + u64 val64; + unsigned int my_len; + _adapter *padapter = prm->psta->padapter; + + + my_len = 0; + plen = pframe + 1; + pframe = rtw_set_fixed_ie(pframe, 7, &prm->p.e_id, &my_len); + + /* Actual Measurement StartTime */ + val64 = cpu_to_le64(prm->meas_start_time); + pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len); + + /* Measurement Duration */ + val16 = prm->meas_end_time - prm->meas_start_time; + val16 = cpu_to_le16(val16); + pframe = rtw_set_fixed_ie(pframe, 2, (u8*)&val16, &my_len); + + /* TODO + * ReportedFrameInformation: + * 0 :beacon or probe rsp + * 1 :pilot frame + */ + val8 = 0; /* report frame info */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* RCPI */ + val8 = rm_get_rcpi(prm, pnetwork); + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* RSNI */ + val8 = rm_get_rsni(prm, pnetwork); + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* BSSID */ + pframe = rtw_set_fixed_ie(pframe, 6, + (u8 *)&pnetwork->network.MacAddress, &my_len); + + /* + * AntennaID + * 0: unknown + * 255: multiple antenna (Diversity) + */ + val8 = 0; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* ParentTSF */ + val32 = prm->meas_start_time + pnetwork->network.PhyInfo.free_cnt; + pframe = rtw_set_fixed_ie(pframe, 4, (u8 *)&val32, &my_len); + + /* Generate Beacon detail */ + pframe = rm_gen_bcn_detail_elem(padapter, pframe, + prm, pnetwork, &my_len); +done: + /* + * update my length + * content length does NOT include ID and LEN + */ + val8 = my_len - 2; + rtw_set_fixed_ie(plen, 1, &val8, &i); + + /* update length to caller */ + *fr_len += my_len; + + return pframe; +} + +static int retrieve_scan_result(struct rm_obj *prm) +{ + _irqL irqL; + _list *plist, *phead; + _queue *queue; + _adapter *padapter = prm->psta->padapter; + struct rtw_ieee80211_channel *pch_set; + struct wlan_network *pnetwork = NULL; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + int i, meas_ch_num=0; + PWLAN_BSSID_EX pbss; + unsigned int matched_network; + int len, my_len; + u8 buf_idx, *pbuf = NULL, *tmp_buf = NULL; + + + tmp_buf = rtw_malloc(MAX_XMIT_EXTBUF_SZ); + if (tmp_buf == NULL) + return 0; + + my_len = 0; + buf_idx = 0; + matched_network = 0; + queue = &(pmlmepriv->scanned_queue); + + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + + phead = get_list_head(queue); + plist = get_next(phead); + + /* get requested measurement channel set */ + pch_set = prm->q.ch_set; + meas_ch_num = prm->q.ch_set_ch_amount; + + /* search scan queue to find requested SSID */ + while (1) { + + if (rtw_end_of_queue_search(phead, plist) == _TRUE) + break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + pbss = &pnetwork->network; + + /* + * report network if requested channel set contains + * the channel matchs selected network + */ + if (rtw_chset_search_ch(adapter_to_chset(padapter), + pbss->Configuration.DSConfig) == 0) + goto next; + + if (rtw_mlme_band_check(padapter, pbss->Configuration.DSConfig) + == _FALSE) + goto next; + + if (rtw_validate_ssid(&(pbss->Ssid)) == _FALSE) + goto next; + + /* go through measurement requested channels */ + for (i = 0; i < meas_ch_num; i++) { + + /* match channel */ + if (pch_set[i].hw_value != pbss->Configuration.DSConfig) + continue; + + /* match bssid */ + if (is_wildcard_bssid(prm->q.bssid) == FALSE) + if (_rtw_memcmp(prm->q.bssid, + pbss->MacAddress, 6) == _FALSE) { + continue; + } + /* + * default wildcard SSID. wildcard SSID: + * A SSID value (null) used to represent all SSIDs + */ + + /* match ssid */ + if ((prm->q.opt.bcn.ssid.SsidLength > 0) && + _rtw_memcmp(prm->q.opt.bcn.ssid.Ssid, + pbss->Ssid.Ssid, + prm->q.opt.bcn.ssid.SsidLength) == _FALSE) + continue; + + /* match condition */ + if (rm_bcn_req_cond_mach(prm, pnetwork) == _FALSE) { + RTW_INFO("RM: condition mismatch ch %u ssid %s bssid "MAC_FMT"\n", + pch_set[i].hw_value, pbss->Ssid.Ssid, + MAC_ARG(pbss->MacAddress)); + RTW_INFO("RM: condition %u:%u\n", + prm->q.opt.bcn.rep_cond.cond, + prm->q.opt.bcn.rep_cond.threshold); + continue; + } + + /* Found a matched SSID */ + matched_network++; + + RTW_INFO("RM: ch %u Found %s bssid "MAC_FMT"\n", + pch_set[i].hw_value, pbss->Ssid.Ssid, + MAC_ARG(pbss->MacAddress)); + + len = 0; + _rtw_memset(tmp_buf, 0, MAX_XMIT_EXTBUF_SZ); + rm_gen_bcn_rep_ie(prm, tmp_buf, pnetwork, &len); +new_packet: + if (my_len == 0) { + pbuf = rtw_malloc(MAX_XMIT_EXTBUF_SZ); + if (pbuf == NULL) + goto fail; + prm->buf[buf_idx].pbuf = pbuf; + } + + if ((MAX_XMIT_EXTBUF_SZ - (my_len+len+24+4)) > 0) { + pbuf = rtw_set_fixed_ie(pbuf, + len, tmp_buf, &my_len); + prm->buf[buf_idx].len = my_len; + } else { + if (my_len == 0) /* not enough space */ + goto fail; + + my_len = 0; + buf_idx++; + goto new_packet; + } + } /* for() */ +next: + plist = get_next(plist); + } /* while() */ +fail: + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + + if (tmp_buf) + rtw_mfree(tmp_buf, MAX_XMIT_EXTBUF_SZ); + + RTW_INFO("RM: Found %d matched %s\n", matched_network, + prm->q.opt.bcn.ssid.Ssid); + + if (prm->buf[buf_idx].pbuf) + return buf_idx+1; + + return 0; +} + +int issue_beacon_rep(struct rm_obj *prm) +{ + int i, my_len; + u8 *pframe; + _adapter *padapter = prm->psta->padapter; + struct pkt_attrib *pattr; + struct xmit_frame *pmgntframe; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + int pkt_num; + + + pkt_num = retrieve_scan_result(prm); + + if (pkt_num == 0) { + issue_null_reply(prm); + return _SUCCESS; + } + + for (i=0;iattrib; + pframe = build_wlan_hdr(padapter, + pmgntframe, prm->psta, WIFI_ACTION); + pframe = rtw_set_fixed_ie(pframe, + 3, &prm->p.category, &pattr->pktlen); + + my_len = 0; + pframe = rtw_set_fixed_ie(pframe, + prm->buf[i].len, prm->buf[i].pbuf, &my_len); + + pattr->pktlen += my_len; + pattr->last_txcmdsz = pattr->pktlen; + dump_mgntframe(padapter, pmgntframe); + } +fail: + for (i=0;ibuf[i].pbuf) { + rtw_mfree(prm->buf[i].pbuf, MAX_XMIT_EXTBUF_SZ); + prm->buf[i].pbuf = NULL; + prm->buf[i].len = 0; + } + } + return _SUCCESS; +} + +/* neighbor request */ +int issue_nb_req(struct rm_obj *prm) +{ + _adapter *padapter = prm->psta->padapter; + struct sta_info *psta = prm->psta; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + struct xmit_frame *pmgntframe = NULL; + struct pkt_attrib *pattr = NULL; + u8 val8; + u8 *pframe = NULL; + + + RTW_INFO("RM: %s\n", __func__); + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (pmgntframe == NULL) { + RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__); + return _FALSE; + } + pattr = &pmgntframe->attrib; + pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION); + pframe = rtw_set_fixed_ie(pframe, + 3, &prm->q.category, &pattr->pktlen); + + if (prm->q.pssid) { + + u8 sub_ie[64] = {0}; + u8 *pie = &sub_ie[2]; + + RTW_INFO("RM: Send NB Req to "MAC_FMT" for(SSID) %s searching\n", + MAC_ARG(pmlmepriv->cur_network.network.MacAddress), + pmlmepriv->cur_network.network.Ssid.Ssid); + + val8 = strlen(prm->q.pssid); + sub_ie[0] = 0; /*SSID*/ + sub_ie[1] = val8; + + _rtw_memcpy(pie, prm->q.pssid, val8); + + pframe = rtw_set_fixed_ie(pframe, val8 + 2, + sub_ie, &pattr->pktlen); + } else { + + if (!pmlmepriv->cur_network.network.Ssid.SsidLength) + RTW_INFO("RM: Send NB Req to "MAC_FMT"\n", + MAC_ARG(pmlmepriv->cur_network.network.MacAddress)); + else { + u8 sub_ie[64] = {0}; + u8 *pie = &sub_ie[2]; + + RTW_INFO("RM: Send NB Req to "MAC_FMT" for(SSID) %s searching\n", + MAC_ARG(pmlmepriv->cur_network.network.MacAddress), + pmlmepriv->cur_network.network.Ssid.Ssid); + + sub_ie[0] = 0; /*SSID*/ + sub_ie[1] = pmlmepriv->cur_network.network.Ssid.SsidLength; + + _rtw_memcpy(pie, pmlmepriv->cur_network.network.Ssid.Ssid, + pmlmepriv->cur_network.network.Ssid.SsidLength); + + pframe = rtw_set_fixed_ie(pframe, + pmlmepriv->cur_network.network.Ssid.SsidLength + 2, + sub_ie, &pattr->pktlen); + } + } + + pattr->last_txcmdsz = pattr->pktlen; + dump_mgntframe(padapter, pmgntframe); + + return _SUCCESS; +} + +static u8 *rm_gen_bcn_req_s_elem(_adapter *padapter, + u8 *pframe, unsigned int *fr_len) +{ + u8 val8; + unsigned int my_len = 0; + u8 bssid[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + + + val8 = bcn_req_active; /* measurement mode T8-64 */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + pframe = rtw_set_fixed_ie(pframe, 6, bssid, &my_len); + + /* update length to caller */ + *fr_len += my_len; + + /* optional subelements */ + return pframe; +} + +static u8 *rm_gen_ch_load_req_s_elem(_adapter *padapter, + u8 *pframe, unsigned int *fr_len) +{ + u8 val8; + unsigned int my_len = 0; + + + val8 = 1; /* 1: channel load T8-60 */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + val8 = 2; /* channel load length = 2 (extensible) */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + val8 = 0; /* channel load condition : 0 (issue when meas done) T8-61 */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + val8 = 0; /* channel load reference value : 0 */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* update length to caller */ + *fr_len += my_len; + + return pframe; +} + +static u8 *rm_gen_noise_histo_req_s_elem(_adapter *padapter, + u8 *pframe, unsigned int *fr_len) +{ + u8 val8; + unsigned int my_len = 0; + + + val8 = 1; /* 1: noise histogram T8-62 */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + val8 = 2; /* noise histogram length = 2 (extensible) */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + val8 = 0; /* noise histogram condition : 0 (issue when meas done) T8-63 */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + val8 = 0; /* noise histogram reference value : 0 */ + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + + /* update length to caller */ + *fr_len += my_len; + + return pframe; +} + +int issue_radio_meas_req(struct rm_obj *prm) +{ + u8 val8; + u8 *pframe; + u8 *plen; + u16 val16; + int my_len, i; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattr; + _adapter *padapter = prm->psta->padapter; + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + + RTW_INFO("RM: %s - %s\n", __func__, rm_type_req_name(prm->q.m_type)); + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (pmgntframe == NULL) { + RTW_ERR("RM: %s alloc xmit_frame fail\n",__func__); + return _FALSE; + } + pattr = &pmgntframe->attrib; + pframe = build_wlan_hdr(padapter, pmgntframe, prm->psta, WIFI_ACTION); + pframe = rtw_set_fixed_ie(pframe, 3, &prm->q.category, &pattr->pktlen); + + /* repeat */ + val16 = cpu_to_le16(prm->q.rpt); + pframe = rtw_set_fixed_ie(pframe, 2, + (unsigned char *)&(val16), &pattr->pktlen); + + my_len = 0; + plen = pframe + 1; + pframe = rtw_set_fixed_ie(pframe, 7, &prm->q.e_id, &my_len); + + /* random interval */ + val16 = 100; /* 100 TU */ + val16 = cpu_to_le16(val16); + pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len); + + /* measurement duration */ + val16 = 100; + val16 = cpu_to_le16(val16); + pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len); + + /* optional subelement */ + switch (prm->q.m_type) { + case bcn_req: + pframe = rm_gen_bcn_req_s_elem(padapter, pframe, &my_len); + break; + case ch_load_req: + pframe = rm_gen_ch_load_req_s_elem(padapter, pframe, &my_len); + break; + case noise_histo_req: + pframe = rm_gen_noise_histo_req_s_elem(padapter, + pframe, &my_len); + break; + case basic_req: + default: + break; + } + + /* length */ + val8 = (u8)my_len - 2; + rtw_set_fixed_ie(plen, 1, &val8, &i); + + pattr->pktlen += my_len; + + pattr->last_txcmdsz = pattr->pktlen; + dump_mgntframe(padapter, pmgntframe); + + return _SUCCESS; +} + +/* noise histogram */ +static u8 rm_get_anpi(struct rm_obj *prm, struct wlan_network *pnetwork) +{ + return translate_percentage_to_rcpi( + pnetwork->network.PhyInfo.SignalStrength); +} + +int rm_radio_meas_report_cond(struct rm_obj *prm) +{ + u8 val8; + int i; + + + switch (prm->q.m_type) { + case ch_load_req: + + val8 = prm->p.ch_load; + switch (prm->q.opt.clm.rep_cond.cond) { + case ch_load_cond_immediately: + return _SUCCESS; + case ch_load_cond_anpi_equal_greater: + if (val8 >= prm->q.opt.clm.rep_cond.threshold) + return _SUCCESS; + case ch_load_cond_anpi_equal_less: + if (val8 <= prm->q.opt.clm.rep_cond.threshold) + return _SUCCESS; + default: + break; + } + break; + case noise_histo_req: + val8 = prm->p.anpi; + switch (prm->q.opt.nhm.rep_cond.cond) { + case noise_histo_cond_immediately: + return _SUCCESS; + case noise_histo_cond_anpi_equal_greater: + if (val8 >= prm->q.opt.nhm.rep_cond.threshold) + return _SUCCESS; + break; + case noise_histo_cond_anpi_equal_less: + if (val8 <= prm->q.opt.nhm.rep_cond.threshold) + return _SUCCESS; + break; + default: + break; + } + break; + default: + break; + } + return _FAIL; +} + +int retrieve_radio_meas_result(struct rm_obj *prm) +{ + int i; + u8 val8; + + + switch (prm->q.m_type) { + case ch_load_req: +#ifdef CONFOG_RTK_ACS + val8 = rtw_acs_get_clm_ratio_by_ch_num( + prm->psta->padapter,prm->q.ch_num); + val8 = 255 * (val8/100); +#else + val8 = 0; +#endif + prm->p.ch_load = val8; + break; + case noise_histo_req: + /* ANPI */ +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + //val8 = rtw_noise_query_by_chan_num(padapter, cur_chan); + prm->p.anpi = 0; /* TODO */ +#else + val8 = 0; +#endif + /* IPI 0~10 TODO */ + for (i=0;i<11;i++) + prm->p.ipi[i] = i; + break; + default: + break; + } + return _SUCCESS; +} + +int issue_radio_meas_rep(struct rm_obj *prm) +{ + u8 val8; + u8 *pframe; + u8 *plen; + u16 val16; + u64 val64; + unsigned int my_len; + _adapter *padapter = prm->psta->padapter; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattr; + struct xmit_priv *pxmitpriv = &(padapter->xmitpriv); + struct sta_info *psta = prm->psta; + int i; + + + RTW_INFO("RM: %s\n", __func__); + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + if (pmgntframe == NULL) { + RTW_ERR("RM: ERR %s alloc xmit_frame fail\n",__func__); + return _FALSE; + } + pattr = &pmgntframe->attrib; + pframe = build_wlan_hdr(padapter, pmgntframe, psta, WIFI_ACTION); + pframe = rtw_set_fixed_ie(pframe, 3, + &prm->p.category, &pattr->pktlen); + + my_len = 0; + plen = pframe + 1; + pframe = rtw_set_fixed_ie(pframe, 7, &prm->p.e_id, &my_len); + + /* Actual Meas start time - 8 bytes */ + val64 = cpu_to_le64(prm->meas_start_time); + pframe = rtw_set_fixed_ie(pframe, 8, (u8 *)&val64, &my_len); + + /* measurement duration */ + val16 = prm->meas_end_time - prm->meas_start_time; + val16 = cpu_to_le16(val16); + pframe = rtw_set_fixed_ie(pframe, 2, (u8 *)&val16, &my_len); + + /* optional subelement */ + switch (prm->q.m_type) { + case ch_load_req: + val8 = prm->p.ch_load; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + break; + case noise_histo_req: + /* + * AntennaID + * 0: unknown + * 255: multiple antenna (Diversity) + */ + val8 = 0; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + /* ANPI */ + val8 = prm->p.anpi; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + /* IPI 0~10 */ + for (i=0;i<11;i++) { + val8 = prm->p.ipi[i]; + pframe = rtw_set_fixed_ie(pframe, 1, &val8, &my_len); + } + break; + default: + break; + } +done: + /* length */ + val8 = (u8)my_len-2; + rtw_set_fixed_ie(plen, 1, &val8, &i); /* use variable i to ignore it */ + + pattr->pktlen += my_len; + pattr->last_txcmdsz = pattr->pktlen; + dump_mgntframe(padapter, pmgntframe); + + return _SUCCESS; +} + +void rtw_ap_parse_sta_rm_en_cap(_adapter *padapter, + struct sta_info *psta, struct rtw_ieee802_11_elems *elem) +{ + RTW_INFO("assoc.rm_en_cap="RM_CAP_FMT"\n", RM_CAP_ARG(elem->rm_en_cap)); + _rtw_memcpy(psta->rm_en_cap, + (elem->rm_en_cap), elem->rm_en_cap_len); +} + +void RM_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) +{ + int i; + + _rtw_memcpy(&padapter->rmpriv.rm_en_cap_assoc, pIE->data, pIE->Length); + RTW_INFO("assoc.rm_en_cap="RM_CAP_FMT"\n", RM_CAP_ARG(pIE->data)); +} + +/* Debug command */ + +#if (RM_SUPPORT_IWPRIV_DBG) +static int hex2num(char c) +{ + if (c >= '0' && c <= '9') + return c - '0'; + if (c >= 'a' && c <= 'f') + return c - 'a' + 10; + if (c >= 'A' && c <= 'F') + return c - 'A' + 10; + return -1; +} + +int hex2byte(const char *hex) +{ + int a, b; + a = hex2num(*hex++); + if (a < 0) + return -1; + b = hex2num(*hex++); + if (b < 0) + return -1; + return (a << 4) | b; +} + +static char * hwaddr_parse(char *txt, u8 *addr) +{ + size_t i; + + for (i = 0; i < ETH_ALEN; i++) { + int a; + + a = hex2byte(txt); + if (a < 0) + return NULL; + txt += 2; + addr[i] = a; + if (i < ETH_ALEN - 1 && *txt++ != ':') + return NULL; + } + return txt; +} + +void rm_dbg_list_sta(_adapter *padapter, char *s) +{ + int i; + _irqL irqL; + struct sta_info *psta; + struct sta_priv *pstapriv = &padapter->stapriv; + _list *plist, *phead; + + + sprintf(pstr(s), "\n"); + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + for (i = 0; i < NUM_STA; i++) { + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); + + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, + struct sta_info, hash_list); + + plist = get_next(plist); + + sprintf(pstr(s), "=========================================\n"); + sprintf(pstr(s), "mac=" MAC_FMT "\n", + MAC_ARG(psta->cmn.mac_addr)); + sprintf(pstr(s), "state=0x%x, aid=%d, macid=%d\n", + psta->state, psta->cmn.aid, psta->cmn.mac_id); + sprintf(pstr(s), "rm_cap="RM_CAP_FMT"\n", + RM_CAP_ARG(psta->rm_en_cap)); + } + + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + sprintf(pstr(s), "=========================================\n"); +} + +void rm_dbg_help(_adapter *padapter, char *s) +{ + int i; + + + sprintf(pstr(s), "\n"); + sprintf(pstr(s), "rrm list_sta\n"); + sprintf(pstr(s), "rrm list_meas\n"); + + sprintf(pstr(s), "rrm add_meas ,m=,rpt=\n"); + sprintf(pstr(s), "rrm run_meas \n"); + sprintf(pstr(s), "rrm del_meas\n"); + + sprintf(pstr(s), "rrm run_meas rmid=xxxx,ev=xx\n"); + sprintf(pstr(s), "rrm activate\n"); + + for (i=0;istapriv; + _list *plist, *phead; + + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + for (i = 0; i < NUM_STA; i++) { + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); + + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, + struct sta_info, hash_list); + + plist = get_next(plist); + + if (psta->cmn.aid == aid) + goto done; + + if (pbssid && _rtw_memcmp(psta->cmn.mac_addr, + pbssid, 6)) + goto done; + } + + } + psta = NULL; +done: + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + return psta; +} + +static int rm_dbg_modify_meas(_adapter *padapter, char *s) +{ + struct rm_priv *prmpriv = &padapter->rmpriv; + struct mlme_ext_info *pmlmeinfo = &padapter->mlmeextpriv.mlmext_info; + struct rm_obj *prm; + struct sta_info *psta; + char *pmac, *ptr, *paid, *prpt, *pnbp, *pclm, *pnhm, *pbcn; + unsigned val; + u8 bssid[ETH_ALEN]; + + + /* example : + * rrm add_meas ,m=, + * rrm run_meas + */ + paid = strstr(s, "aid="); + pmac = strstr(s, "mac="); + pbcn = strstr(s, "m=bcn"); + pclm = strstr(s, "m=clm"); + pnhm = strstr(s, "m=nhm"); + pnbp = strstr(s, "m=nb"); + prpt = strstr(s, "rpt="); + + /* set all ',' to NULL (end of line) */ + ptr = s; + while (ptr) { + ptr = strchr(ptr, ','); + if (ptr) { + *(ptr) = 0x0; + ptr++; + } + } + prm = (struct rm_obj *)prmpriv->prm_sel; + prm->q.m_token = 1; + psta = prm->psta; + + if (paid) { /* find sta_info according to aid */ + paid += 4; /* skip aid= */ + sscanf(paid, "%u", &val); /* aid=x */ + psta = rm_get_sta(padapter, val, NULL); + + } else if (pmac) { /* find sta_info according to bssid */ + pmac += 4; /* skip mac= */ + if (hwaddr_parse(pmac, bssid) == NULL) { + sprintf(pstr(s), "Err: \nincorrect mac format\n"); + return _FAIL; + } + psta = rm_get_sta(padapter, 0xff, bssid); + } + + if (psta) { + prm->psta = psta; + +#if 0 + prm->q.diag_token = psta->rm_diag_token++; +#else + /* TODO dialog should base on sta_info */ + prm->q.diag_token = pmlmeinfo->dialogToken++; +#endif + prm->rmid = psta->cmn.aid << 16 + | prm->q.diag_token << 8 + | RM_MASTER; + } else + return _FAIL; + + prm->q.action_code = RM_ACT_RADIO_MEAS_REQ; + if (pbcn) { + prm->q.m_type = bcn_req; + } else if (pnhm) { + prm->q.m_type = noise_histo_req; + } else if (pclm) { + prm->q.m_type = ch_load_req; + } else if (pnbp) { + prm->q.action_code = RM_ACT_NB_REP_REQ; + } else + return _FAIL; + + if (prpt) { + prpt += 4; /* skip rpt= */ + sscanf(prpt, "%u", &val); + prm->q.rpt = (u8)val; + } + + return _SUCCESS; +} + +static void rm_dbg_activate_meas(_adapter *padapter, char *s) +{ + struct rm_priv *prmpriv = &(padapter->rmpriv); + struct rm_obj *prm; + + + if (prmpriv->prm_sel == NULL) { + sprintf(pstr(s), "\nErr: No inActivate measurement\n"); + return; + } + prm = (struct rm_obj *)prmpriv->prm_sel; + + /* verify attributes */ + if (prm->psta == NULL) { + sprintf(pstr(s), "\nErr: inActivate meas has no psta\n"); + return; + } + + /* measure current channel */ + prm->q.ch_num = padapter->mlmeextpriv.cur_channel; + prm->q.op_class = rm_get_oper_class_via_ch(prm->q.ch_num); + + /* enquee rmobj */ + rm_enqueue_rmobj(padapter, prm, _FALSE); + + sprintf(pstr(s), "\nActivate rmid=%x, state=%s, meas_type=%s\n", + prm->rmid, rm_state_name(prm->state), + rm_type_req_name(prm->q.m_type)); + + sprintf(pstr(s), "aid=%d, mac=" MAC_FMT "\n", + prm->psta->cmn.aid, MAC_ARG(prm->psta->cmn.mac_addr)); + + /* clearn inActivate prm info */ + prmpriv->prm_sel = NULL; +} + +static void rm_dbg_add_meas(_adapter *padapter, char *s) +{ + struct rm_priv *prmpriv = &(padapter->rmpriv); + struct rm_obj *prm; + char *pact; + + + /* example : + * rrm add_meas ,m= + * rrm run_meas + */ + prm = (struct rm_obj *)prmpriv->prm_sel; + if (prm == NULL) + prm = rm_alloc_rmobj(padapter); + + if (prm == NULL) { + sprintf(pstr(s), "\nErr: alloc meas fail\n"); + return; + } + + prmpriv->prm_sel = prm; + + pact = strstr(s, "act"); + if (rm_dbg_modify_meas(padapter, s) == _FAIL) { + + sprintf(pstr(s), "\nErr: add meas fail\n"); + rm_free_rmobj(prm); + prmpriv->prm_sel = NULL; + return; + } + prm->q.category = RTW_WLAN_CATEGORY_RADIO_MEAS; + prm->q.e_id = _MEAS_REQ_IE_; /* 38 */ + + if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) + sprintf(pstr(s), "\nAdd rmid=%x, meas_type=%s ok\n", + prm->rmid, rm_type_req_name(prm->q.m_type)); + else if (prm->q.action_code == RM_ACT_NB_REP_REQ) + sprintf(pstr(s), "\nAdd rmid=%x, meas_type=bcn_req ok\n", + prm->rmid); + + if (prm->psta) + sprintf(pstr(s), "mac="MAC_FMT"\n", + MAC_ARG(prm->psta->cmn.mac_addr)); + + if (pact) + rm_dbg_activate_meas(padapter, pstr(s)); +} + +static void rm_dbg_del_meas(_adapter *padapter, char *s) +{ + struct rm_priv *prmpriv = &padapter->rmpriv; + struct rm_obj *prm = (struct rm_obj *)prmpriv->prm_sel; + + + if (prm) { + sprintf(pstr(s), "\ndelete rmid=%x\n",prm->rmid); + + /* free inActivate meas - enqueue yet */ + prmpriv->prm_sel = NULL; + rtw_mfree(prmpriv->prm_sel, sizeof(struct rm_obj)); + } else + sprintf(pstr(s), "Err: no inActivate measurement\n"); +} + +static void rm_dbg_run_meas(_adapter *padapter, char *s) +{ + struct rm_obj *prm; + char *pevid, *prmid; + u32 rmid, evid; + + + prmid = strstr(s, "rmid="); /* hex */ + pevid = strstr(s, "evid="); /* dec */ + + if (prmid && pevid) { + prmid += 5; /* rmid= */ + sscanf(prmid, "%x", &rmid); + + pevid += 5; /* evid= */ + sscanf(pevid, "%u", &evid); + } else { + sprintf(pstr(s), "\nErr: incorrect attribute\n"); + return; + } + + prm = rm_get_rmobj(padapter, rmid); + + if (!prm) { + sprintf(pstr(s), "\nErr: measurement not found\n"); + return; + } + + if (evid >= RM_EV_max) { + sprintf(pstr(s), "\nErr: wrong event id\n"); + return; + } + + rm_post_event(padapter, prm->rmid, evid); + sprintf(pstr(s), "\npost %s to rmid=%x\n",rm_event_name(evid), rmid); +} + +static void rm_dbg_show_meas(struct rm_obj *prm, char *s) +{ + struct sta_info *psta; + + psta = prm->psta; + + if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { + + sprintf(pstr(s), "\nrmid=%x, meas_type=%s\n", + prm->rmid, rm_type_req_name(prm->q.m_type)); + + } else if (prm->q.action_code == RM_ACT_NB_REP_REQ) { + + sprintf(pstr(s), "\nrmid=%x, action=neighbor_req\n", + prm->rmid); + } else + sprintf(pstr(s), "\nrmid=%x, action=unknown\n", + prm->rmid); + + if (psta) + sprintf(pstr(s), "aid=%d, mac="MAC_FMT"\n", + psta->cmn.aid, MAC_ARG(psta->cmn.mac_addr)); + + sprintf(pstr(s), "clock=%d, state=%s, rpt=%u/%u\n", + (int)ATOMIC_READ(&prm->pclock->counter), + rm_state_name(prm->state), prm->p.rpt, prm->q.rpt); +} + +static void rm_dbg_list_meas(_adapter *padapter, char *s) +{ + int meas_amount; + _irqL irqL; + struct rm_obj *prm; + struct sta_info *psta; + struct rm_priv *prmpriv = &padapter->rmpriv; + _queue *queue = &prmpriv->rm_queue; + _list *plist, *phead; + + + sprintf(pstr(s), "\n"); + _enter_critical(&queue->lock, &irqL); + phead = get_list_head(queue); + plist = get_next(phead); + meas_amount = 0; + + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + prm = LIST_CONTAINOR(plist, struct rm_obj, list); + meas_amount++; + plist = get_next(plist); + psta = prm->psta; + sprintf(pstr(s), "=========================================\n"); + + rm_dbg_show_meas(prm, s); + } + _exit_critical(&queue->lock, &irqL); + + sprintf(pstr(s), "=========================================\n"); + + if (meas_amount==0) { + sprintf(pstr(s), "No Activate measurement\n"); + sprintf(pstr(s), "=========================================\n"); + } + + if (prmpriv->prm_sel == NULL) + sprintf(pstr(s), "\nNo inActivate measurement\n"); + else { + sprintf(pstr(s), "\ninActivate measurement\n"); + rm_dbg_show_meas((struct rm_obj *)prmpriv->prm_sel, s); + } +} +#endif /* RM_SUPPORT_IWPRIV_DBG */ + +void rm_dbg_cmd(_adapter *padapter, char *s) +{ +#if (RM_SUPPORT_IWPRIV_DBG) + if (_rtw_memcmp(s, "help", 4)) { + rm_dbg_help(padapter, s); + + } else if (_rtw_memcmp(s, "list_sta", 8)) { + rm_dbg_list_sta(padapter, s); + + } else if (_rtw_memcmp(s, "list_meas", 9)) { + rm_dbg_list_meas(padapter, s); + + } else if (_rtw_memcmp(s, "add_meas", 8)) { + rm_dbg_add_meas(padapter, s); + + } else if (_rtw_memcmp(s, "del_meas", 8)) { + rm_dbg_del_meas(padapter, s); + + } else if (_rtw_memcmp(s, "activate", 8)) { + rm_dbg_activate_meas(padapter, s); + + } else if (_rtw_memcmp(s, "run_meas", 8)) { + rm_dbg_run_meas(padapter, s); + } +#else + sprintf(pstr(s), "\n"); + sprintf(pstr(s), "rrm debug command was disabled\n"); +#endif +} +#endif /* CONFIG_RTW_80211K */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm_fsm.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm_fsm.c new file mode 100644 index 000000000000..1ed3c9d7d3ce --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rm_fsm.c @@ -0,0 +1,998 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 +#include +#include "rtw_rm_fsm.h" + +#ifdef CONFIG_RTW_80211K + +struct fsm_state { + u8 *name; + int(*fsm_func)(struct rm_obj *prm, enum RM_EV_ID evid); +}; + +static void rm_state_initial(struct rm_obj *prm); +static void rm_state_goto(struct rm_obj *prm, enum RM_STATE rm_state); +static void rm_state_run(struct rm_obj *prm, enum RM_EV_ID evid); +static struct rm_event *rm_dequeue_ev(_queue *queue); +static struct rm_obj *rm_dequeue_rm(_queue *queue); + +void rm_timer_callback(void *data) +{ + int i; + _adapter *padapter = (_adapter *)data; + struct rm_priv *prmpriv = &padapter->rmpriv; + struct rm_clock *pclock; + + + /* deal with clock */ + for (i=0;iclock[i]; + if (pclock->prm == NULL + ||(ATOMIC_READ(&(pclock->counter)) == 0)) + continue; + + ATOMIC_DEC(&(pclock->counter)); + + if (ATOMIC_READ(&(pclock->counter)) == 0) + rm_post_event(pclock->prm->psta->padapter, + pclock->prm->rmid, prmpriv->clock[i].evid); + } + _set_timer(&prmpriv->rm_timer, CLOCK_UNIT); +} + +int rtw_init_rm(_adapter *padapter) +{ + struct rm_priv *prmpriv = &padapter->rmpriv; + + + RTW_INFO("RM: %s\n",__func__); + _rtw_init_queue(&(prmpriv->rm_queue)); + _rtw_init_queue(&(prmpriv->ev_queue)); + + /* bit 0-7 */ + prmpriv->rm_en_cap_def[0] = 0 + /*| BIT(RM_LINK_MEAS_CAP_EN)*/ + | BIT(RM_NB_REP_CAP_EN) + /*| BIT(RM_PARAL_MEAS_CAP_EN)*/ + | BIT(RM_REPEAT_MEAS_CAP_EN) + | BIT(RM_BCN_PASSIVE_MEAS_CAP_EN) + | BIT(RM_BCN_ACTIVE_MEAS_CAP_EN) + | BIT(RM_BCN_TABLE_MEAS_CAP_EN) + /*| BIT(RM_BCN_MEAS_REP_COND_CAP_EN)*/; + + /* bit 8-15 */ + prmpriv->rm_en_cap_def[1] = 0 + /*| BIT(RM_FRAME_MEAS_CAP_EN - 8)*/ +#ifdef CONFIG_RTW_ACS + | BIT(RM_CH_LOAD_CAP_EN - 8) + | BIT(RM_NOISE_HISTO_CAP_EN - 8) +#endif + /*| BIT(RM_STATIS_MEAS_CAP_EN - 8)*/ + /*| BIT(RM_LCI_MEAS_CAP_EN - 8)*/ + /*| BIT(RM_LCI_AMIMUTH_CAP_EN - 8)*/ + /*| BIT(RM_TRANS_STREAM_CAT_MEAS_CAP_EN - 8)*/ + /*| BIT(RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN - 8)*/; + + /* bit 16-23 */ + prmpriv->rm_en_cap_def[2] = 0 + /*| BIT(RM_AP_CH_REP_CAP_EN - 16)*/ + /*| BIT(RM_RM_MIB_CAP_EN - 16)*/ + /*| BIT(RM_OP_CH_MAX_MEAS_DUR0 - 16)*/ + /*| BIT(RM_OP_CH_MAX_MEAS_DUR1 - 16)*/ + /*| BIT(RM_OP_CH_MAX_MEAS_DUR2 - 16)*/ + /*| BIT(RM_NONOP_CH_MAX_MEAS_DUR0 - 16)*/ + /*| BIT(RM_NONOP_CH_MAX_MEAS_DUR1 - 16)*/ + /*| BIT(RM_NONOP_CH_MAX_MEAS_DUR2 - 16)*/; + + /* bit 24-31 */ + prmpriv->rm_en_cap_def[3] = 0 + /*| BIT(RM_MEAS_PILOT_CAP0 - 24)*/ + /*| BIT(RM_MEAS_PILOT_CAP1 - 24)*/ + /*| BIT(RM_MEAS_PILOT_CAP2 - 24)*/ + /*| BIT(RM_MEAS_PILOT_TRANS_INFO_CAP_EN - 24)*/ + /*| BIT(RM_NB_REP_TSF_OFFSET_CAP_EN - 24)*/ + | BIT(RM_RCPI_MEAS_CAP_EN - 24) + | BIT(RM_RSNI_MEAS_CAP_EN - 24) + /*| BIT(RM_BSS_AVG_ACCESS_DELAY_CAP_EN - 24)*/; + + /* bit 32-39 */ + prmpriv->rm_en_cap_def[4] = 0 + /*| BIT(RM_BSS_AVG_ACCESS_DELAY_CAP_EN - 32)*/ + /*| BIT(RM_AVALB_ADMIS_CAPACITY_CAP_EN - 32)*/ + /*| BIT(RM_ANT_CAP_EN - 32)*/; + + prmpriv->enable = _TRUE; + + /* clock timer */ + rtw_init_timer(&prmpriv->rm_timer, + padapter, rm_timer_callback, padapter); + _set_timer(&prmpriv->rm_timer, CLOCK_UNIT); + + return _SUCCESS; +} + +int rtw_deinit_rm(_adapter *padapter) +{ + struct rm_priv *prmpriv = &padapter->rmpriv; + struct rm_obj *prm; + struct rm_event *pev; + + + RTW_INFO("RM: %s\n",__func__); + prmpriv->enable = _FALSE; + _cancel_timer_ex(&prmpriv->rm_timer); + + /* free all events and measurements */ + while((pev = rm_dequeue_ev(&prmpriv->ev_queue)) != NULL) + rtw_mfree((void *)pev, sizeof(struct rm_event)); + + while((prm = rm_dequeue_rm(&prmpriv->rm_queue)) != NULL) + rm_state_run(prm, RM_EV_cancel); + + _rtw_deinit_queue(&(prmpriv->rm_queue)); + _rtw_deinit_queue(&(prmpriv->ev_queue)); + + return _SUCCESS; +} + +int rtw_free_rm_priv(_adapter *padapter) +{ + return rtw_deinit_rm(padapter); +} + +static int rm_enqueue_ev(_queue *queue, struct rm_event *obj, bool to_head) +{ + _irqL irqL; + + + if (obj == NULL) + return _FAIL; + + _enter_critical(&queue->lock, &irqL); + + if (to_head) + rtw_list_insert_head(&obj->list, &queue->queue); + else + rtw_list_insert_tail(&obj->list, &queue->queue); + + _exit_critical(&queue->lock, &irqL); + + return _SUCCESS; +} + +static void rm_set_clock(struct rm_obj *prm, u32 ms, enum RM_EV_ID evid) +{ + ATOMIC_SET(&(prm->pclock->counter), (ms/CLOCK_UNIT)); + prm->pclock->evid = evid; +} + +static struct rm_clock *rm_alloc_clock(_adapter *padapter, struct rm_obj *prm) +{ + int i; + struct rm_priv *prmpriv = &padapter->rmpriv; + struct rm_clock *pclock = NULL; + + + for (i=0;iclock[i]; + + if (pclock->prm == NULL) { + pclock->prm = prm; + ATOMIC_SET(&(pclock->counter), 0); + pclock->evid = RM_EV_max; + break; + } + } + return pclock; +} + +static void rm_cancel_clock(struct rm_obj *prm) +{ + ATOMIC_SET(&(prm->pclock->counter), 0); + prm->pclock->evid = RM_EV_max; +} + +static void rm_free_clock(struct rm_clock *pclock) +{ + pclock->prm = NULL; + ATOMIC_SET(&(pclock->counter), 0); + pclock->evid = RM_EV_max; +} + +static int is_list_linked(const struct list_head *head) +{ + return head->prev != NULL; +} + +void rm_free_rmobj(struct rm_obj *prm) +{ + if (is_list_linked(&prm->list)) + rtw_list_delete(&prm->list); + + if (prm->q.pssid) + rtw_mfree(prm->q.pssid, strlen(prm->q.pssid)+1); + + if (prm->q.opt.bcn.req_start) + rtw_mfree(prm->q.opt.bcn.req_start, + prm->q.opt.bcn.req_len); + + if (prm->pclock) + rm_free_clock(prm->pclock); + + rtw_mfree((void *)prm, sizeof(struct rm_obj)); +} + +struct rm_obj *rm_alloc_rmobj(_adapter *padapter) +{ + struct rm_obj *prm; + + + prm = (struct rm_obj *)rtw_malloc(sizeof(struct rm_obj)); + if (prm == NULL) + return NULL; + + _rtw_memset(prm, 0, sizeof(struct rm_obj)); + + /* alloc timer */ + if ((prm->pclock = rm_alloc_clock(padapter, prm)) == NULL) { + rm_free_rmobj(prm); + return NULL; + } + return prm; +} + +int rm_enqueue_rmobj(_adapter *padapter, struct rm_obj *prm, bool to_head) +{ + _irqL irqL; + struct rm_priv *prmpriv = &padapter->rmpriv; + _queue *queue = &prmpriv->rm_queue; + + + if (prm == NULL) + return _FAIL; + + _enter_critical(&queue->lock, &irqL); + if (to_head) + rtw_list_insert_head(&prm->list, &queue->queue); + else + rtw_list_insert_tail(&prm->list, &queue->queue); + _exit_critical(&queue->lock, &irqL); + + rm_state_initial(prm); + + return _SUCCESS; +} + +static struct rm_obj *rm_dequeue_rm(_queue *queue) +{ + _irqL irqL; + struct rm_obj *prm; + + + _enter_critical(&queue->lock, &irqL); + if (rtw_is_list_empty(&(queue->queue))) + prm = NULL; + else { + prm = LIST_CONTAINOR(get_next(&(queue->queue)), + struct rm_obj, list); + /* rtw_list_delete(&prm->list); */ + } + _exit_critical(&queue->lock, &irqL); + + return prm; +} + +static struct rm_event *rm_dequeue_ev(_queue *queue) +{ + _irqL irqL; + struct rm_event *ev; + + + _enter_critical(&queue->lock, &irqL); + if (rtw_is_list_empty(&(queue->queue))) + ev = NULL; + else { + ev = LIST_CONTAINOR(get_next(&(queue->queue)), + struct rm_event, list); + rtw_list_delete(&ev->list); + } + _exit_critical(&queue->lock, &irqL); + + return ev; +} + +static struct rm_obj *_rm_get_rmobj(_queue *queue, u32 rmid) +{ + _irqL irqL; + _list *phead, *plist; + struct rm_obj *prm = NULL; + + + if (rmid == 0) + return NULL; + + _enter_critical(&queue->lock, &irqL); + + phead = get_list_head(queue); + plist = get_next(phead); + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + + prm = LIST_CONTAINOR(plist, struct rm_obj, list); + if (rmid == (prm->rmid)) { + _exit_critical(&queue->lock, &irqL); + return prm; + } + plist = get_next(plist); + } + _exit_critical(&queue->lock, &irqL); + + return NULL; +} + +struct sta_info *rm_get_psta(_adapter *padapter, u32 rmid) +{ + struct rm_priv *prmpriv = &padapter->rmpriv; + struct rm_obj *prm; + + + prm = _rm_get_rmobj(&prmpriv->rm_queue, rmid); + + if (prm) + return prm->psta; + + return NULL; +} + +struct rm_obj *rm_get_rmobj(_adapter *padapter, u32 rmid) +{ + struct rm_priv *prmpriv = &padapter->rmpriv; + + return _rm_get_rmobj(&prmpriv->rm_queue, rmid); +} + +u8 rtw_rm_post_envent_cmd(_adapter *padapter, u32 rmid, u8 evid) +{ + struct cmd_obj *pcmd; + struct rm_event *pev; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + u8 res = _SUCCESS; + + + pcmd = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (pcmd == NULL) { + res = _FAIL; + goto exit; + } + pev = (struct rm_event*)rtw_zmalloc(sizeof(struct rm_event)); + + if (pev == NULL) { + rtw_mfree((u8 *) pcmd, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + pev->rmid = rmid; + pev->evid = evid; + + init_h2fwcmd_w_parm_no_rsp(pcmd, pev, GEN_CMD_CODE(_RM_POST_EVENT)); + res = rtw_enqueue_cmd(pcmdpriv, pcmd); +exit: + return res; +} + +int rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid) +{ + if (padapter->rmpriv.enable == _FALSE) + return _FALSE; + + RTW_INFO("RM: post asyn %s to rmid=%x\n", rm_event_name(evid), rmid); + rtw_rm_post_envent_cmd(padapter, rmid, evid); + return _SUCCESS; +} + +int _rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid) +{ + struct rm_priv *prmpriv = &padapter->rmpriv; + struct rm_event *pev; + + if (evid >= RM_EV_max || rmid == 0) + return _FALSE; + + pev = (struct rm_event *)rtw_malloc(sizeof(struct rm_event)); + if (pev == NULL) + return _FALSE; + + pev->rmid = rmid; + pev->evid = evid; + + RTW_INFO("RM: post sync %s to rmid=%x\n", rm_event_name(evid), rmid); + rm_enqueue_ev(&prmpriv->ev_queue, pev, FALSE); + + return _SUCCESS; +} + +static void rm_bcast_aid_handler(_adapter *padapter, struct rm_event *pev) +{ + _irqL irqL; + _list *phead, *plist; + _queue *queue = &padapter->rmpriv.rm_queue; + struct rm_obj *prm; + + + _enter_critical(&queue->lock, &irqL); + phead = get_list_head(queue); + plist = get_next(phead); + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + + prm = LIST_CONTAINOR(plist, struct rm_obj, list); + plist = get_next(plist); + if (RM_GET_AID(pev->rmid) == RM_GET_AID(prm->rmid)) { + _exit_critical(&queue->lock, &irqL); + rm_state_run(prm, pev->evid); + _enter_critical(&queue->lock, &irqL); + } + } + _exit_critical(&queue->lock, &irqL); + return; +} + +/* main handler of RM (Resource Management) */ +void rm_handler(_adapter *padapter, struct rm_event *pe) +{ + int i; + struct rm_priv *prmpriv = &padapter->rmpriv; + struct rm_obj *prm; + struct rm_event *pev; + + + /* dequeue event */ + while((pev = rm_dequeue_ev(&prmpriv->ev_queue)) != NULL) + { + if (RM_IS_ID_FOR_ALL(pev->rmid)) { + /* apply to all aid mateched measurement */ + rm_bcast_aid_handler(padapter, pev); + rtw_mfree((void *)pev, sizeof(struct rm_event)); + continue; + } + + /* retrieve rmobj */ + prm = _rm_get_rmobj(&prmpriv->rm_queue, pev->rmid); + if (prm == NULL) { + RTW_ERR("RM: rmid=%x event=%s doesn't find rm obj\n", + pev->rmid, rm_event_name(pev->evid)); + rtw_mfree((void *)pev, sizeof(struct rm_event)); + return; + } + /* run state machine */ + rm_state_run(prm, pev->evid); + rtw_mfree((void *)pev, sizeof(struct rm_event)); + } +} + +static int rm_issue_meas_req(struct rm_obj *prm) +{ + switch (prm->q.action_code) { + case RM_ACT_RADIO_MEAS_REQ: + switch (prm->q.m_type) { + case bcn_req: + case ch_load_req: + case noise_histo_req: + issue_radio_meas_req(prm); + break; + default: + break; + } /* meas_type */ + break; + case RM_ACT_NB_REP_REQ: + /* issue neighbor request */ + issue_nb_req(prm); + break; + case RM_ACT_LINK_MEAS_REQ: + default: + return _FALSE; + } /* action_code */ + + return _SUCCESS; +} + +/* +* RM state machine +*/ + +static int rm_state_idle(struct rm_obj *prm, enum RM_EV_ID evid) +{ + _adapter *padapter = prm->psta->padapter; + u8 val8; + u32 val32; + + + prm->p.category = RTW_WLAN_CATEGORY_RADIO_MEAS; + + switch (evid) { + case RM_EV_state_in: + switch (prm->q.action_code) { + case RM_ACT_RADIO_MEAS_REQ: + /* copy attrib from meas_req to meas_rep */ + prm->p.action_code = RM_ACT_RADIO_MEAS_REP; + prm->p.diag_token = prm->q.diag_token; + prm->p.e_id = _MEAS_RSP_IE_; + prm->p.m_token = prm->q.m_token; + prm->p.m_type = prm->q.m_type; + prm->p.rpt = prm->q.rpt; + prm->p.ch_num = prm->q.ch_num; + prm->p.op_class = prm->q.op_class; + + if (prm->q.m_type == ch_load_req + || prm->q.m_type == noise_histo_req) { + /* + * phydm measure current ch periodically + * scan current ch is not necessary + */ + val8 = padapter->mlmeextpriv.cur_channel; + if (prm->q.ch_num == val8) + prm->poll_mode = 1; + } + RTW_INFO("RM: rmid=%x %s switch in repeat=%u\n", + prm->rmid, rm_type_req_name(prm->q.m_type), + prm->q.rpt); + break; + case RM_ACT_NB_REP_REQ: + prm->p.action_code = RM_ACT_NB_REP_RESP; + RTW_INFO("RM: rmid=%x Neighbor request switch in\n", + prm->rmid); + break; + case RM_ACT_LINK_MEAS_REQ: + prm->p.action_code = RM_ACT_LINK_MEAS_REP; + rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); + RTW_INFO("RM: rmid=%x Link meas switch in\n", + prm->rmid); + break; + default: + prm->p.action_code = prm->q.action_code; + rm_set_rep_mode(prm, MEAS_REP_MOD_INCAP); + RTW_INFO("RM: rmid=%x recv unknown action %d\n", + prm->rmid,prm->p.action_code); + break; + } /* switch() */ + + if (prm->rmid & RM_MASTER) { + if (rm_issue_meas_req(prm) == _SUCCESS) + rm_state_goto(prm, RM_ST_WAIT_MEAS); + else + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } else { + rm_state_goto(prm, RM_ST_DO_MEAS); + return _SUCCESS; + } + + if (prm->p.m_mode) { + issue_null_reply(prm); + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } + if (prm->q.rand_intvl) { + /* get low tsf to generate random interval */ + val32 = rtw_read32(padapter, REG_TSFTR); + val32 = val32 % prm->q.rand_intvl; + RTW_INFO("RM: rmid=%x rand_intval=%d, rand=%d\n", + prm->rmid, (int)prm->q.rand_intvl,val32); + rm_set_clock(prm, prm->q.rand_intvl, + RM_EV_delay_timer_expire); + return _SUCCESS; + } + break; + case RM_EV_delay_timer_expire: + rm_state_goto(prm, RM_ST_DO_MEAS); + break; + case RM_EV_cancel: + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_state_out: + rm_cancel_clock(prm); + break; + default: + break; + } + return _SUCCESS; +} + +/* we do the measuring */ +static int rm_state_do_meas(struct rm_obj *prm, enum RM_EV_ID evid) +{ + _adapter *padapter = prm->psta->padapter; + u8 val8; + u64 val64; + + + switch (evid) { + case RM_EV_state_in: + if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { + switch (prm->q.m_type) { + case bcn_req: + if (prm->q.m_mode == bcn_req_bcn_table) { + RTW_INFO("RM: rmid=%x Beacon table\n", + prm->rmid); + _rm_post_event(padapter, prm->rmid, + RM_EV_survey_done); + return _SUCCESS; + } + break; + case ch_load_req: + case noise_histo_req: + if (prm->poll_mode) + _rm_post_event(padapter, prm->rmid, + RM_EV_survey_done); + return _SUCCESS; + default: + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } + + if (!ready_for_scan(prm)) { + prm->wait_busy = RM_BUSY_TRAFFIC_TIMES; + RTW_INFO("RM: wait busy traffic - %d\n", + prm->wait_busy); + rm_set_clock(prm, RM_WAIT_BUSY_TIMEOUT, + RM_EV_busy_timer_expire); + return _SUCCESS; + } + } + _rm_post_event(padapter, prm->rmid, RM_EV_start_meas); + break; + case RM_EV_start_meas: + if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { + /* resotre measurement start time */ + rtw_hal_get_hwreg(padapter, HW_VAR_TSF, (u8 *)&val64); + prm->meas_start_time = val64; + + switch (prm->q.m_type) { + case bcn_req: + val8 = 1; /* Enable free run counter */ + rtw_hal_set_hwreg(padapter, + HW_VAR_FREECNT, &val8); + rm_sitesurvey(prm); + break; + case ch_load_req: + case noise_histo_req: + rm_sitesurvey(prm); + break; + default: + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + break; + } + } + /* handle measurement timeout */ + rm_set_clock(prm, RM_MEAS_TIMEOUT, RM_EV_meas_timer_expire); + break; + case RM_EV_survey_done: + if (prm->q.action_code == RM_ACT_RADIO_MEAS_REQ) { + switch (prm->q.m_type) { + case bcn_req: + rm_cancel_clock(prm); + rm_state_goto(prm, RM_ST_SEND_REPORT); + return _SUCCESS; + case ch_load_req: + case noise_histo_req: + retrieve_radio_meas_result(prm); + + if (rm_radio_meas_report_cond(prm) == _SUCCESS) + rm_state_goto(prm, RM_ST_SEND_REPORT); + else + rm_set_clock(prm, RM_COND_INTVL, + RM_EV_retry_timer_expire); + break; + default: + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } + } + break; + case RM_EV_meas_timer_expire: + RTW_INFO("RM: rmid=%x measurement timeount\n",prm->rmid); + rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); + issue_null_reply(prm); + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_busy_timer_expire: + if (!ready_for_scan(prm) && prm->wait_busy--) { + RTW_INFO("RM: wait busy - %d\n",prm->wait_busy); + rm_set_clock(prm, RM_WAIT_BUSY_TIMEOUT, + RM_EV_busy_timer_expire); + break; + } + else if (prm->wait_busy <= 0) { + RTW_INFO("RM: wait busy timeout\n"); + rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); + issue_null_reply(prm); + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } + _rm_post_event(padapter, prm->rmid, RM_EV_start_meas); + break; + case RM_EV_request_timer_expire: + rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); + issue_null_reply(prm); + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_retry_timer_expire: + /* expired due to meas condition mismatch, meas again */ + _rm_post_event(padapter, prm->rmid, RM_EV_start_meas); + break; + case RM_EV_cancel: + rm_set_rep_mode(prm, MEAS_REP_MOD_REFUSE); + issue_null_reply(prm); + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_state_out: + rm_cancel_clock(prm); + /* resotre measurement end time */ + rtw_hal_get_hwreg(padapter, HW_VAR_TSF, (u8 *)&val64); + _rtw_memcpy(&prm->meas_end_time, (char *)&val64, sizeof(u64)); + + val8 = 0; /* Disable free run counter */ + rtw_hal_set_hwreg(padapter, HW_VAR_FREECNT, &val8); + break; + default: + break; + } + + return _SUCCESS; +} + +static int rm_state_wait_meas(struct rm_obj *prm, enum RM_EV_ID evid) +{ + u8 val8; + u64 val64; + + + switch (evid) { + case RM_EV_state_in: + /* we create meas_req, waiting for peer report */ + rm_set_clock(prm, RM_REQ_TIMEOUT, + RM_EV_request_timer_expire); + break; + case RM_EV_recv_rep: + rm_state_goto(prm, RM_ST_RECV_REPORT); + break; + case RM_EV_request_timer_expire: + case RM_EV_cancel: + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_state_out: + rm_cancel_clock(prm); + break; + default: + break; + } + return _SUCCESS; +} + +static int rm_state_send_report(struct rm_obj *prm, enum RM_EV_ID evid) +{ + u8 val8; + + + switch (evid) { + case RM_EV_state_in: + /* we have to issue report */ + switch (prm->q.m_type) { + case bcn_req: + issue_beacon_rep(prm); + break; + case ch_load_req: + case noise_histo_req: + issue_radio_meas_rep(prm); + break; + default: + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } + + /* check repeat */ + if (prm->p.rpt) { + RTW_INFO("RM: rmid=%x repeat=%u/%u\n", + prm->rmid, prm->p.rpt, + prm->q.rpt); + prm->p.rpt--; + /* + * we recv meas_req, + * delay for a wihile and than meas again + */ + if (prm->poll_mode) + rm_set_clock(prm, RM_REPT_POLL_INTVL, + RM_EV_repeat_delay_expire); + else + rm_set_clock(prm, RM_REPT_SCAN_INTVL, + RM_EV_repeat_delay_expire); + return _SUCCESS; + } + /* we are done */ + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_repeat_delay_expire: + rm_state_goto(prm, RM_ST_DO_MEAS); + break; + case RM_EV_cancel: + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_state_out: + rm_cancel_clock(prm); + break; + default: + break; + } + return _SUCCESS; +} + +static int rm_state_recv_report(struct rm_obj *prm, enum RM_EV_ID evid) +{ + u8 val8; + + + switch (evid) { + case RM_EV_state_in: + /* we issue meas_req, got peer's meas report */ + switch (prm->p.action_code) { + case RM_ACT_RADIO_MEAS_REP: + /* check refuse, incapable and repeat */ + val8 = prm->p.m_mode; + if (val8) { + RTW_INFO("RM: rmid=%x peer reject (%s repeat=%d)\n", + prm->rmid, + val8|MEAS_REP_MOD_INCAP?"INCAP": + val8|MEAS_REP_MOD_REFUSE?"REFUSE": + val8|MEAS_REP_MOD_LATE?"LATE":"", + prm->p.rpt); + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } + break; + case RM_ACT_NB_REP_RESP: + /* report to upper layer if needing */ + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + default: + rm_state_goto(prm, RM_ST_END); + return _SUCCESS; + } + /* check repeat */ + if (prm->p.rpt) { + RTW_INFO("RM: rmid=%x repeat=%u/%u\n", + prm->rmid, prm->p.rpt, + prm->q.rpt); + prm->p.rpt--; + /* waitting more report */ + rm_state_goto(prm, RM_ST_WAIT_MEAS); + break; + } + /* we are done */ + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_cancel: + rm_state_goto(prm, RM_ST_END); + break; + case RM_EV_state_out: + rm_cancel_clock(prm); + break; + default: + break; + } + return _SUCCESS; +} + +static int rm_state_end(struct rm_obj *prm, enum RM_EV_ID evid) +{ + switch (evid) { + case RM_EV_state_in: + _rm_post_event(prm->psta->padapter, prm->rmid, RM_EV_state_out); + break; + + case RM_EV_cancel: + case RM_EV_state_out: + default: + rm_free_rmobj(prm); + break; + } + return _SUCCESS; +} + +struct fsm_state rm_fsm[] = { + {"RM_ST_IDLE", rm_state_idle}, + {"RM_ST_DO_MEAS", rm_state_do_meas}, + {"RM_ST_WAIT_MEAS", rm_state_wait_meas}, + {"RM_ST_SEND_REPORT", rm_state_send_report}, + {"RM_ST_RECV_REPORT", rm_state_recv_report}, + {"RM_ST_END", rm_state_end} +}; + +char *rm_state_name(enum RM_STATE state) +{ + return rm_fsm[state].name; +} + +char *rm_event_name(enum RM_EV_ID evid) +{ + switch(evid) { + case RM_EV_state_in: + return "RM_EV_state_in"; + case RM_EV_busy_timer_expire: + return "RM_EV_busy_timer_expire"; + case RM_EV_delay_timer_expire: + return "RM_EV_delay_timer_expire"; + case RM_EV_meas_timer_expire: + return "RM_EV_meas_timer_expire"; + case RM_EV_repeat_delay_expire: + return "RM_EV_repeat_delay_expire"; + case RM_EV_retry_timer_expire: + return "RM_EV_retry_timer_expire"; + case RM_EV_request_timer_expire: + return "RM_EV_request_timer_expire"; + case RM_EV_wait_report: + return "RM_EV_wait_report"; + case RM_EV_start_meas: + return "RM_EV_start_meas"; + case RM_EV_survey_done: + return "RM_EV_survey_done"; + case RM_EV_recv_rep: + return "RM_EV_recv_report"; + case RM_EV_cancel: + return "RM_EV_cancel"; + case RM_EV_state_out: + return "RM_EV_state_out"; + case RM_EV_max: + return "RM_EV_max"; + default: + return "RM_EV_unknown"; + } + return "UNKNOWN"; +} + +static void rm_state_initial(struct rm_obj *prm) +{ + prm->state = RM_ST_IDLE; + + RTW_INFO("\n"); + RTW_INFO("RM: rmid=%x %-18s -> %s\n",prm->rmid, + "new measurement", rm_fsm[prm->state].name); + + rm_post_event(prm->psta->padapter, prm->rmid, RM_EV_state_in); +} + +static void rm_state_run(struct rm_obj *prm, enum RM_EV_ID evid) +{ + RTW_INFO("RM: rmid=%x %-18s %s\n",prm->rmid, + rm_fsm[prm->state].name,rm_event_name(evid)); + + rm_fsm[prm->state].fsm_func(prm, evid); +} + +static void rm_state_goto(struct rm_obj *prm, enum RM_STATE rm_state) +{ + if (prm->state == rm_state) + return; + + rm_state_run(prm, RM_EV_state_out); + + RTW_INFO("\n"); + RTW_INFO("RM: rmid=%x %-18s -> %s\n",prm->rmid, + rm_fsm[prm->state].name, rm_fsm[rm_state].name); + + prm->state = rm_state; + rm_state_run(prm, RM_EV_state_in); +} +#endif /* CONFIG_RTW_80211K */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rson.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rson.c new file mode 100644 index 000000000000..9d3cd537304b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_rson.c @@ -0,0 +1,592 @@ +/****************************************************************************** + * + * 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 + * + * + ******************************************************************************/ +#define _RTW_RSON_C_ + +#include + +#ifdef CONFIG_RTW_REPEATER_SON + +/******** Custommize Part ***********************/ + +unsigned char RTW_RSON_OUI[] = {0xFA, 0xFA, 0xFA}; +#define RSON_SCORE_DIFF_TH 8 + +/* + Calculate the corresponding score. +*/ +inline u8 rtw_cal_rson_score(struct rtw_rson_struct *cand_rson_data, NDIS_802_11_RSSI Rssi) +{ + if ((cand_rson_data->hopcnt == RTW_RSON_HC_NOTREADY) + || (cand_rson_data->connectible == RTW_RSON_DENYCONNECT)) + return RTW_RSON_SCORE_NOTCNNT; + + return RTW_RSON_SCORE_MAX - (cand_rson_data->hopcnt * 10) + (Rssi/10); +} + +/*************************************************/ + + +static u8 rtw_rson_block_bssid_idx = 0; +u8 rtw_rson_block_bssid[10][6] = { + /*{0x02, 0xE0, 0x4C, 0x07, 0xC3, 0xF6}*/ +}; + +/* fake root, regard a real AP as a SO root */ +static u8 rtw_rson_root_bssid_idx = 0; +u8 rtw_rson_root_bssid[10][6] = { + /*{0x1c, 0x5f, 0x2b, 0x5a, 0x60, 0x24}*/ +}; + +int is_match_bssid(u8 *mac, u8 bssid_array[][6], int num) +{ + int i; + + for (i = 0; i < num; i++) + if (_rtw_memcmp(mac, bssid_array[i], 6) == _TRUE) + return _TRUE; + return _FALSE; +} + +void init_rtw_rson_data(struct dvobj_priv *dvobj) +{ + /*Aries todo. if pdvobj->rson_data.ver == 1 */ + dvobj->rson_data.ver = RTW_RSON_VER; + dvobj->rson_data.id = CONFIG_RTW_REPEATER_SON_ID; +#ifdef CONFIG_RTW_REPEATER_SON_ROOT + dvobj->rson_data.hopcnt = RTW_RSON_HC_ROOT; + dvobj->rson_data.connectible = RTW_RSON_ALLOWCONNECT; +#else + dvobj->rson_data.hopcnt = RTW_RSON_HC_NOTREADY; + dvobj->rson_data.connectible = RTW_RSON_DENYCONNECT; +#endif + dvobj->rson_data.loading = 0; + _rtw_memset(dvobj->rson_data.res, 0xAA, sizeof(dvobj->rson_data.res)); +} + +void rtw_rson_get_property_str(_adapter *padapter, char *rson_data_str) +{ + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + + sprintf(rson_data_str, "version : \t%d\nid : \t\t%08x\nhop count : \t%d\nconnectible : \t%s\nloading : \t%d\nreserve : \t%16ph\n", + pdvobj->rson_data.ver, + pdvobj->rson_data.id, + pdvobj->rson_data.hopcnt, + pdvobj->rson_data.connectible ? "connectable":"unconnectable", + pdvobj->rson_data.loading, + pdvobj->rson_data.res); +} + +int str2hexbuf(char *str, u8 *hexbuf, int len) +{ + u8 *p; + int i, slen, idx = 0; + + p = (unsigned char *)str; + if ((*p != '0') || (*(p+1) != 'x')) + return _FALSE; + slen = strlen(str); + if (slen > (len*2) + 2) + return _FALSE; + p += 2; + for (i = 0 ; i < len; i++, idx = idx+2) { + hexbuf[i] = key_2char2num(p[idx], p[idx + 1]); + if (slen <= idx+2) + break; + } + return _TRUE; +} + +int rtw_rson_set_property(_adapter *padapter, char *field, char *value) +{ + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + int num = 0; + + if (_rtw_memcmp(field, (u8 *)"ver", 3) == _TRUE) + pdvobj->rson_data.ver = rtw_atoi(value); + else if (_rtw_memcmp(field, (u8 *)"id", 2) == _TRUE) + num = sscanf(value, "%08x", &(pdvobj->rson_data.id)); + else if (_rtw_memcmp(field, (u8 *)"hc", 2) == _TRUE) + num = sscanf(value, "%hhu", &(pdvobj->rson_data.hopcnt)); + else if (_rtw_memcmp(field, (u8 *)"cnt", 3) == _TRUE) + num = sscanf(value, "%hhu", &(pdvobj->rson_data.connectible)); + else if (_rtw_memcmp(field, (u8 *)"loading", 2) == _TRUE) + num = sscanf(value, "%hhu", &(pdvobj->rson_data.loading)); + else if (_rtw_memcmp(field, (u8 *)"res", 2) == _TRUE) { + str2hexbuf(value, pdvobj->rson_data.res, 16); + return 1; + } else + return _FALSE; + return num; +} + +/* + return : TRUE -- competitor is taking advantage than condidate + FALSE -- we should continue keeping candidate +*/ +int rtw_rson_choose(struct wlan_network **candidate, struct wlan_network *competitor) +{ + s16 comp_score = 0, cand_score = 0; + struct rtw_rson_struct rson_cand, rson_comp; + + if (is_match_bssid(competitor->network.MacAddress, rtw_rson_block_bssid, rtw_rson_block_bssid_idx) == _TRUE) + return _FALSE; + + if ((competitor == NULL) + || (rtw_get_rson_struct(&(competitor->network), &rson_comp) != _TRUE) + || (rson_comp.id != CONFIG_RTW_REPEATER_SON_ID)) + return _FALSE; + + comp_score = rtw_cal_rson_score(&rson_comp, competitor->network.Rssi); + if (comp_score == RTW_RSON_SCORE_NOTCNNT) + return _FALSE; + + if (*candidate == NULL) + return _TRUE; + if (rtw_get_rson_struct(&((*candidate)->network), &rson_cand) != _TRUE) + return _FALSE; + + cand_score = rtw_cal_rson_score(&rson_cand, (*candidate)->network.Rssi); + RTW_INFO("%s: competitor_score=%d, candidate_score=%d\n", __func__, comp_score, cand_score); + if (comp_score - cand_score > RSON_SCORE_DIFF_TH) + return _TRUE; + + return _FALSE; +} + +inline u8 rtw_rson_varify_ie(u8 *p) +{ + u8 *ptr = NULL; + u8 ver; + u32 id; + u8 hopcnt; + u8 allcnnt; + + ptr = p + 2 + sizeof(RTW_RSON_OUI); + ver = *ptr; + + /* for (ver == 1) */ + if (ver != 1) + return _FALSE; + + return _TRUE; +} + +/* + Parsing RTK self-organization vendor IE +*/ +int rtw_get_rson_struct(WLAN_BSSID_EX *bssid, struct rtw_rson_struct *rson_data) +{ + sint limit = 0; + u32 len; + u8 *p; + + if ((rson_data == NULL) || (bssid == NULL)) + return -EINVAL; + + /* Default */ + rson_data->id = 0; + rson_data->ver = 0; + rson_data->hopcnt = 0; + rson_data->connectible = 0; + rson_data->loading = 0; + /* fake root */ + if (is_match_bssid(bssid->MacAddress, rtw_rson_root_bssid, rtw_rson_root_bssid_idx) == _TRUE) { + rson_data->id = CONFIG_RTW_REPEATER_SON_ID; + rson_data->ver = RTW_RSON_VER; + rson_data->hopcnt = RTW_RSON_HC_ROOT; + rson_data->connectible = RTW_RSON_ALLOWCONNECT; + rson_data->loading = 0; + return _TRUE; + } + limit = bssid->IELength - _BEACON_IE_OFFSET_; + + for (p = bssid->IEs + _BEACON_IE_OFFSET_; ; p += (len + 2)) { + p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &len, limit); + limit -= len; + if ((p == NULL) || (len == 0)) + break; + if (p && (_rtw_memcmp(p + 2, RTW_RSON_OUI, sizeof(RTW_RSON_OUI)) == _TRUE) + && rtw_rson_varify_ie(p)) { + p = p + 2 + sizeof(RTW_RSON_OUI); + rson_data->ver = *p; + /* for (ver == 1) */ + p = p + 1; + rson_data->id = le32_to_cpup((__le32 *)p); + p = p + 4; + rson_data->hopcnt = *p; + p = p + 1; + rson_data->connectible = *p; + p = p + 1; + rson_data->loading = *p; + + return _TRUE; + } + } + return -EBADMSG; +} + +u32 rtw_rson_append_ie(_adapter *padapter, unsigned char *pframe, u32 *len) +{ + u8 *ptr, *ori, ie_len = 0; + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); +/* static int iii = 0;*/ + + if ((!pdvobj) || (!pframe)) + return 0; + ptr = ori = pframe; + *ptr++ = _VENDOR_SPECIFIC_IE_; + *ptr++ = ie_len = sizeof(RTW_RSON_OUI)+sizeof(pdvobj->rson_data); + _rtw_memcpy(ptr, RTW_RSON_OUI, sizeof(RTW_RSON_OUI)); + ptr = ptr + sizeof(RTW_RSON_OUI); + *ptr++ = pdvobj->rson_data.ver; + *(s32 *)ptr = cpu_to_le32(pdvobj->rson_data.id); + ptr = ptr + sizeof(pdvobj->rson_data.id); + *ptr++ = pdvobj->rson_data.hopcnt; + *ptr++ = pdvobj->rson_data.connectible; + *ptr++ = pdvobj->rson_data.loading; + _rtw_memcpy(ptr, pdvobj->rson_data.res, sizeof(pdvobj->rson_data.res)); + pframe = ptr; +/* + iii = iii % 20; + if (iii++ == 0) + RTW_INFO("%s : RTW RSON IE : %20ph\n", __func__, ori); +*/ + *len += (ie_len+2); + return ie_len; + +} + +void rtw_rson_do_disconnect(_adapter *padapter) +{ + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); +#ifndef CONFIG_RTW_REPEATER_SON_ROOT + pdvobj->rson_data.ver = RTW_RSON_VER; + pdvobj->rson_data.id = CONFIG_RTW_REPEATER_SON_ID; + pdvobj->rson_data.hopcnt = RTW_RSON_HC_NOTREADY; + pdvobj->rson_data.connectible = RTW_RSON_DENYCONNECT; + pdvobj->rson_data.loading = 0; + rtw_mi_tx_beacon_hdl(padapter); +#endif +} + +void rtw_rson_join_done(_adapter *padapter) +{ + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + WLAN_BSSID_EX *cur_network = NULL; + struct rtw_rson_struct rson_data; + + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); + if (!padapter->mlmepriv.cur_network_scanned) + return; + cur_network = &(padapter->mlmepriv.cur_network_scanned->network); + if (rtw_get_rson_struct(cur_network, &rson_data) != _TRUE) { + RTW_ERR("%s: try to join a improper network(%s)\n", __func__, cur_network->Ssid.Ssid); + return; + } + +#ifndef CONFIG_RTW_REPEATER_SON_ROOT + /* update rson_data */ + pdvobj->rson_data.ver = RTW_RSON_VER; + pdvobj->rson_data.id = rson_data.id; + pdvobj->rson_data.hopcnt = rson_data.hopcnt + 1; + pdvobj->rson_data.connectible = RTW_RSON_ALLOWCONNECT; + pdvobj->rson_data.loading = 0; + rtw_mi_tx_beacon_hdl(padapter); +#endif +} + +int rtw_rson_isupdate_roamcan(struct mlme_priv *mlme + , struct wlan_network **candidate, struct wlan_network *competitor) +{ + struct rtw_rson_struct rson_cand, rson_comp, rson_curr; + s16 comp_score, cand_score, curr_score; + + if ((competitor == NULL) + || (rtw_get_rson_struct(&(competitor->network), &rson_comp) != _TRUE) + || (rson_comp.id != CONFIG_RTW_REPEATER_SON_ID)) + return _FALSE; + + if ((!mlme->cur_network_scanned) + || (mlme->cur_network_scanned == competitor) + || (rtw_get_rson_struct(&(mlme->cur_network_scanned->network), &rson_curr)) != _TRUE) + return _FALSE; + + if (rtw_get_passing_time_ms((u32)competitor->last_scanned) >= mlme->roam_scanr_exp_ms) + return _FALSE; + + comp_score = rtw_cal_rson_score(&rson_comp, competitor->network.Rssi); + curr_score = rtw_cal_rson_score(&rson_curr, mlme->cur_network_scanned->network.Rssi); + if (comp_score - curr_score < RSON_SCORE_DIFF_TH) + return _FALSE; + + if (*candidate == NULL) + return _TRUE; + + if (rtw_get_rson_struct(&((*candidate)->network), &rson_cand) != _TRUE) { + RTW_ERR("%s : Unable to get rson_struct from candidate(%s -- " MAC_FMT")\n", + __func__, (*candidate)->network.Ssid.Ssid, MAC_ARG((*candidate)->network.MacAddress)); + return _FALSE; + } + cand_score = rtw_cal_rson_score(&rson_cand, (*candidate)->network.Rssi); + RTW_DBG("comp_score=%d , cand_score=%d , curr_score=%d\n", comp_score, cand_score, curr_score); + if (cand_score < comp_score) + return _TRUE; + +#if 0 /* Handle 11R protocol */ +#ifdef CONFIG_RTW_80211R + if (rtw_chk_ft_flags(adapter, RTW_FT_SUPPORTED)) { + ptmp = rtw_get_ie(&competitor->network.IEs[12], _MDIE_, &mdie_len, competitor->network.IELength-12); + if (ptmp) { + if (!_rtw_memcmp(&pftpriv->mdid, ptmp+2, 2)) + goto exit; + + /*The candidate don't support over-the-DS*/ + if (rtw_chk_ft_flags(adapter, RTW_FT_STA_OVER_DS_SUPPORTED)) { + if ((rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED) && !(*(ptmp+4) & 0x01)) || + (!rtw_chk_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED) && (*(ptmp+4) & 0x01))) { + RTW_INFO("FT: ignore the candidate(" MAC_FMT ") for over-the-DS\n", MAC_ARG(competitor->network.MacAddress)); + rtw_clr_ft_flags(adapter, RTW_FT_OVER_DS_SUPPORTED); + goto exit; + } + } + } else + goto exit; + } +#endif +#endif + return _FALSE; +} + +void rtw_rson_show_survey_info(struct seq_file *m, _list *plist, _list *phead) +{ + struct wlan_network *pnetwork = NULL; + struct rtw_rson_struct rson_data; + s16 rson_score; + u16 index = 0; + + RTW_PRINT_SEL(m, "%5s %-17s %3s %5s %14s %10s %-3s %5s %32s\n", "index", "bssid", "ch", "id", "hop_cnt", "loading", "RSSI", "score", "ssid"); + while (1) { + if (rtw_end_of_queue_search(phead, plist) == _TRUE) + break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if (!pnetwork) + break; + + _rtw_memset(&rson_data, 0, sizeof(rson_data)); + rson_score = 0; + if (rtw_get_rson_struct(&(pnetwork->network), &rson_data) == _TRUE) + rson_score = rtw_cal_rson_score(&rson_data, pnetwork->network.Rssi); + RTW_PRINT_SEL(m, "%5d "MAC_FMT" %3d 0x%08x %6d %10d %6d %6d %32s\n", + ++index, + MAC_ARG(pnetwork->network.MacAddress), + pnetwork->network.Configuration.DSConfig, + rson_data.id, + rson_data.hopcnt, + rson_data.loading, + (int)pnetwork->network.Rssi, + rson_score, + pnetwork->network.Ssid.Ssid); + plist = get_next(plist); + } + +} + +/* + Description : As a AP role, We need to check the qualify of associating STA. + We also need to check if we are ready to be associated. + + return : TRUE -- AP REJECT this STA + FALSE -- AP ACCEPT this STA +*/ +u8 rtw_rson_ap_check_sta(_adapter *padapter, u8 *pframe, uint pkt_len, unsigned short ie_offset) +{ + struct wlan_network *pnetwork = NULL; + struct rtw_rson_struct rson_target; + struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); + int len = 0; + u8 ret = _FALSE; + u8 *p; + +#ifndef CONFIG_RTW_REPEATER_SON_ROOT + _rtw_memset(&rson_target, 0, sizeof(rson_target)); + for (p = pframe + WLAN_HDR_A3_LEN + ie_offset; ; p += (len + 2)) { + p = rtw_get_ie(p, _VENDOR_SPECIFIC_IE_, &len, pkt_len - WLAN_HDR_A3_LEN - ie_offset); + + if ((p == NULL) || (len == 0)) + break; + + if (p && (_rtw_memcmp(p + 2, RTW_RSON_OUI, sizeof(RTW_RSON_OUI)) == _TRUE) + && rtw_rson_varify_ie(p)) { + p = p + 2 + sizeof(RTW_RSON_OUI); + rson_target.ver = *p; + /* for (ver == 1) */ + p = p + 1; + rson_target.id = le32_to_cpup((__le32 *)p); + p = p + 4; + rson_target.hopcnt = *p; + p = p + 1; + rson_target.connectible = *p; + p = p + 1; + rson_target.loading = *p; + break; + } + } + + if (rson_target.id == 0) /* Normal STA, not a RSON STA */ + ret = _FALSE; + else if (rson_target.id != pdvobj->rson_data.id) { + ret = _TRUE; + RTW_INFO("%s : Reject AssoReq because RSON ID not match, STA=%08x, our=%08x\n", + __func__, rson_target.id, pdvobj->rson_data.id); + } else if ((pdvobj->rson_data.hopcnt == RTW_RSON_HC_NOTREADY) + || (pdvobj->rson_data.connectible == RTW_RSON_DENYCONNECT)) { + ret = _TRUE; + RTW_INFO("%s : Reject AssoReq becuase our hopcnt=%d or connectbile=%d\n", + __func__, pdvobj->rson_data.hopcnt, pdvobj->rson_data.connectible); + } +#endif + return ret; +} + +u8 rtw_rson_scan_wk_cmd(_adapter *padapter, int op) +{ + struct cmd_obj *ph2c; + struct drvextra_cmd_parm *pdrvextra_cmd_parm; + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + u8 *extra_cmd_buf; + u8 res = _SUCCESS; + + ph2c = (struct cmd_obj *)rtw_zmalloc(sizeof(struct cmd_obj)); + if (ph2c == NULL) { + res = _FAIL; + goto exit; + } + + pdrvextra_cmd_parm = (struct drvextra_cmd_parm *)rtw_zmalloc(sizeof(struct drvextra_cmd_parm)); + if (pdrvextra_cmd_parm == NULL) { + rtw_mfree((u8 *)ph2c, sizeof(struct cmd_obj)); + res = _FAIL; + goto exit; + } + pdrvextra_cmd_parm->ec_id = RSON_SCAN_WK_CID; + pdrvextra_cmd_parm->type = op; + pdrvextra_cmd_parm->size = 0; + pdrvextra_cmd_parm->pbuf = NULL; + + init_h2fwcmd_w_parm_no_rsp(ph2c, pdrvextra_cmd_parm, GEN_CMD_CODE(_Set_Drv_Extra)); + + res = rtw_enqueue_cmd(pcmdpriv, ph2c); + +exit: + return res; + +} + +void rtw_rson_scan_cmd_hdl(_adapter *padapter, int op) +{ + struct cmd_priv *pcmdpriv = &padapter->cmdpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + u8 val8; + + if (mlmeext_chk_scan_state(pmlmeext, SCAN_DISABLE) != _FALSE) + return; + if (op == RSON_SCAN_PROCESS) { + padapter->rtw_rson_scanstage = RSON_SCAN_PROCESS; + val8 = 0x1e; + rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &val8, _FALSE); + val8 = 1; + rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + issue_probereq(padapter, NULL, NULL); + /* stop rson_scan after 100ms */ + _set_timer(&(pmlmeext->rson_scan_timer), 100); + } else if (op == RSON_SCAN_DISABLE) { + padapter->rtw_rson_scanstage = RSON_SCAN_DISABLE; + val8 = 0; + rtw_hal_set_hwreg(padapter, HW_VAR_MLME_SITESURVEY, (u8 *)(&val8)); + val8 = 0xff; + rtw_hal_set_odm_var(padapter, HAL_ODM_INITIAL_GAIN, &val8, _FALSE); + /* report_surveydone_event(padapter);*/ + if (pmlmepriv->to_join == _TRUE) { + if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) != _TRUE) { + int s_ret; + + set_fwstate(pmlmepriv, _FW_UNDER_LINKING); + pmlmepriv->to_join = _FALSE; + s_ret = rtw_select_and_join_from_scanned_queue(pmlmepriv); + if (s_ret == _SUCCESS) + _set_timer(&pmlmepriv->assoc_timer, MAX_JOIN_TIMEOUT); + else if (s_ret == 2) { + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); + rtw_indicate_connect(padapter); + } else { + RTW_INFO("try_to_join, but select scanning queue fail, to_roam:%d\n", rtw_to_roam(padapter)); + if (rtw_to_roam(padapter) != 0) { + if (rtw_dec_to_roam(padapter) == 0) { + rtw_set_to_roam(padapter, 0); +#ifdef CONFIG_INTEL_WIDI + if (padapter->mlmepriv.widi_state == INTEL_WIDI_STATE_ROAMING) { + _rtw_memset(pmlmepriv->sa_ext, 0x00, L2SDTA_SERVICE_VE_LEN); + intel_widi_wk_cmd(padapter, INTEL_WIDI_LISTEN_WK, NULL, 0); + RTW_INFO("change to widi listen\n"); + } +#endif /* CONFIG_INTEL_WIDI */ + rtw_free_assoc_resources(padapter, 1); + rtw_indicate_disconnect(padapter, 0, _FALSE); + } else + pmlmepriv->to_join = _TRUE; + } else + rtw_indicate_disconnect(padapter, 0, _FALSE); + _clr_fwstate_(pmlmepriv, _FW_UNDER_LINKING); + } + } + } else { + if (rtw_chk_roam_flags(padapter, RTW_ROAM_ACTIVE)) { + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) + && check_fwstate(pmlmepriv, _FW_LINKED)) { + if (rtw_select_roaming_candidate(pmlmepriv) == _SUCCESS) { +#ifdef CONFIG_RTW_80211R + if (rtw_chk_ft_flags(padapter, RTW_FT_OVER_DS_SUPPORTED)) { + start_clnt_ft_action(adapter, (u8 *)pmlmepriv->roam_network->network.MacAddress); + } else { + /*wait a little time to retrieve packets buffered in the current ap while scan*/ + _set_timer(&pmlmeext->ft_roam_timer, 30); + } +#else + receive_disconnect(padapter, pmlmepriv->cur_network.network.MacAddress + , WLAN_REASON_ACTIVE_ROAM, _FALSE); +#endif + } + } + } + issue_action_BSSCoexistPacket(padapter); + issue_action_BSSCoexistPacket(padapter); + issue_action_BSSCoexistPacket(padapter); + } + } else { + RTW_ERR("%s : improper parameter -- op = %d\n", __func__, op); + } +} + +#endif /* CONFIG_RTW_REPEATER_SON */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sdio.c index 817d60b9ccfb..e8f49bfc30d1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_SDIO_C_ #include /* struct dvobj_priv and etc. */ @@ -39,22 +35,61 @@ */ static u8 sdio_io(struct dvobj_priv *d, u32 addr, void *buf, size_t len, u8 write, u8 cmd52) { + u32 addr_drv; /* address with driver defined bit */ int err; + u8 retry = 0; + u8 stop_retry = _FALSE; /* flag for stopping retry or not */ - if (cmd52) - addr = RTW_SDIO_ADDR_CMD52_GEN(addr); - - if (write) - err = d->intf_ops->write(d, addr, buf, len, 0); - else - err = d->intf_ops->read(d, addr, buf, len, 0); - if (err) { - RTW_INFO("%s: [ERROR] %s FAIL! error(%d)\n", - __FUNCTION__, write ? "write" : "read", err); + if (rtw_is_surprise_removed(dvobj_get_primary_adapter(d))) { + RTW_ERR("%s: bSurpriseRemoved, skip %s 0x%05x, %zu bytes\n", + __FUNCTION__, write?"write":"read", addr, len); return _FAIL; } + addr_drv = addr; + if (cmd52) + addr_drv = RTW_SDIO_ADDR_CMD52_GEN(addr_drv); + + do { + if (write) + err = d->intf_ops->write(d, addr_drv, buf, len, 0); + else + err = d->intf_ops->read(d, addr_drv, buf, len, 0); + if (!err) { + if (retry) { + RTW_INFO("%s: Retry %s OK! addr=0x%05x %zu bytes, retry=%u,%u\n", + __FUNCTION__, write?"write":"read", + addr, len, retry, ATOMIC_READ(&d->continual_io_error)); + RTW_INFO_DUMP("Data: ", buf, len); + } + rtw_reset_continual_io_error(d); + break; + } + RTW_ERR("%s: %s FAIL! error(%d) addr=0x%05x %zu bytes, retry=%u,%u\n", + __FUNCTION__, write?"write":"read", err, addr, len, + retry, ATOMIC_READ(&d->continual_io_error)); + + retry++; + stop_retry = rtw_inc_and_chk_continual_io_error(d); + if ((err == -1) || (stop_retry == _TRUE) || (retry > SD_IO_TRY_CNT)) { + /* critical error, unrecoverable */ + RTW_ERR("%s: Fatal error! Set surprise remove flag ON! (retry=%u,%u)\n", + __FUNCTION__, retry, ATOMIC_READ(&d->continual_io_error)); + rtw_set_surprise_removed(dvobj_get_primary_adapter(d)); + return _FAIL; + } + + /* WLAN IOREG or SDIO Local */ + if ((addr & 0x10000) || !(addr & 0xE000)) { + RTW_WARN("%s: Retry %s addr=0x%05x %zu bytes, retry=%u,%u\n", + __FUNCTION__, write?"write":"read", addr, len, + retry, ATOMIC_READ(&d->continual_io_error)); + continue; + } + return _FAIL; + } while (1); + return _SUCCESS; } @@ -88,11 +123,8 @@ u8 rtw_sdio_f0_read(struct dvobj_priv *d, u32 addr, void *buf, size_t len) addr = RTW_SDIO_ADDR_F0_GEN(addr); err = d->intf_ops->read(d, addr, buf, len, 0); - if (err) { - RTW_INFO("%s: [ERROR] Read f0 register FAIL!\n", __FUNCTION__); + if (err) ret = _FAIL; - } - return ret; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_security.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_security.c index b413893b62d2..dd5b1b2bea60 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_security.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_security.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_SECURITY_C_ #include @@ -826,7 +821,7 @@ u32 rtw_tkip_decrypt(_adapter *padapter, u8 *precvframe) if (stainfo != NULL) { if (IS_MCAST(prxattrib->ra)) { - static u32 start = 0; + static systime start = 0; static u32 no_gkey_bc_cnt = 0; static u32 no_gkey_mc_cnt = 0; @@ -1376,7 +1371,7 @@ static sint aes_cipher(u8 *key, uint hdrlen, u8 mic[8]; /* uint offset = 0; */ uint frtype = GetFrameType(pframe); - uint frsubtype = GetFrameSubType(pframe); + uint frsubtype = get_frame_sub_type(pframe); frsubtype = frsubtype >> 4; @@ -1685,7 +1680,7 @@ static sint aes_decipher(u8 *key, uint hdrlen, /* uint offset = 0; */ uint frtype = GetFrameType(pframe); - uint frsubtype = GetFrameSubType(pframe); + uint frsubtype = get_frame_sub_type(pframe); frsubtype = frsubtype >> 4; @@ -1953,7 +1948,7 @@ u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) if (stainfo != NULL) { if (IS_MCAST(prxattrib->ra)) { - static u32 start = 0; + static systime start = 0; static u32 no_gkey_bc_cnt = 0; static u32 no_gkey_mc_cnt = 0; @@ -1993,7 +1988,7 @@ u32 rtw_aes_decrypt(_adapter *padapter, u8 *precvframe) prwskey = psecuritypriv->dot118021XGrpKey[prxattrib->key_index].skey; if (psecuritypriv->dot118021XGrpKeyid != prxattrib->key_index) { - RTW_INFO("not match packet_index=%d, install_index=%d\n" + RTW_DBG("not match packet_index=%d, install_index=%d\n" , prxattrib->key_index, psecuritypriv->dot118021XGrpKeyid); res = _FAIL; goto exit; @@ -2210,7 +2205,7 @@ static int sha256_process(struct sha256_state *md, unsigned char *in, unsigned long n; #define block_size 64 - if (md->curlen > sizeof(md->buf)) + if (md->curlen >= sizeof(md->buf)) return -1; while (inlen > 0) { @@ -2888,11 +2883,11 @@ void wpa_tdls_generate_tpk(_adapter *padapter, PVOID sta) * added by the KDF anyway.. */ - if (os_memcmp(adapter_mac_addr(padapter), psta->hwaddr, ETH_ALEN) < 0) { + if (os_memcmp(adapter_mac_addr(padapter), psta->cmn.mac_addr, ETH_ALEN) < 0) { _rtw_memcpy(data, adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy(data + ETH_ALEN, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(data + ETH_ALEN, psta->cmn.mac_addr, ETH_ALEN); } else { - _rtw_memcpy(data, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(data, psta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(data + ETH_ALEN, adapter_mac_addr(padapter), ETH_ALEN); } _rtw_memcpy(data + 2 * ETH_ALEN, get_bssid(pmlmepriv), ETH_ALEN); @@ -3071,25 +3066,6 @@ int tdls_verify_mic(u8 *kck, u8 trans_seq, } #endif /* CONFIG_TDLS */ -void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS) -{ - _adapter *padapter = (_adapter *)FunctionContext; - - - - /* - if (RTW_CANNOT_RUN(padapter)) { - - return; - } - */ - - padapter->securitypriv.busetkipkey = _TRUE; - - - -} - /* Restore HW wep key setting according to key_mask */ void rtw_sec_restore_wep_key(_adapter *adapter) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sreset.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sreset.c index 6d241ca41b87..db954e2b54ce 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sreset.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sreset.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 #include @@ -219,6 +214,7 @@ void sreset_restore_network_station(_adapter *padapter) { u8 join_type = 0; rtw_hal_set_hwreg(padapter, HW_VAR_MLME_JOIN, (u8 *)(&join_type)); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_STA_CONNECTING); } Set_MSR(padapter, (pmlmeinfo->state & 0x3)); @@ -240,8 +236,8 @@ void sreset_restore_network_status(_adapter *padapter) if (check_fwstate(mlmepriv, WIFI_STATION_STATE)) { RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); sreset_restore_network_station(padapter); - } else if (check_fwstate(mlmepriv, WIFI_AP_STATE)) { - RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); + } else if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { + RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(padapter), MLME_IS_AP(padapter) ? "AP" : "MESH"); rtw_ap_restore_network(padapter); } else if (check_fwstate(mlmepriv, WIFI_ADHOC_STATE)) RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(mlmepriv)); @@ -273,7 +269,7 @@ void sreset_stop_adapter(_adapter *padapter) if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING)) { rtw_set_to_roam(padapter, 0); - _rtw_join_timeout_handler(padapter); + rtw_join_timeout_handler(padapter); } } @@ -311,7 +307,7 @@ void sreset_reset(_adapter *padapter) struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); struct xmit_priv *pxmitpriv = &padapter->xmitpriv; _irqL irqL; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sta_mgt.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sta_mgt.c index 26926ff8b752..232a240db38b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sta_mgt.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_sta_mgt.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_STA_MGT_C_ #include @@ -133,6 +128,46 @@ inline bool rtw_st_ctl_chk_reg_rule(struct st_ctl_t *st_ctl, _adapter *adapter, return ret; } +void rtw_st_ctl_rx(struct sta_info *sta, u8 *ehdr_pos) +{ + _adapter *adapter = sta->padapter; + struct ethhdr *etherhdr = (struct ethhdr *)ehdr_pos; + + if (ntohs(etherhdr->h_proto) == ETH_P_IP) { + u8 *ip = ehdr_pos + ETH_HLEN; + + if (GET_IPV4_PROTOCOL(ip) == 0x06 /* TCP */ + && rtw_st_ctl_chk_reg_s_proto(&sta->st_ctl, 0x06) == _TRUE + ) { + u8 *tcp = ip + GET_IPV4_IHL(ip) * 4; + + if (rtw_st_ctl_chk_reg_rule(&sta->st_ctl, adapter, IPV4_DST(ip), TCP_DST(tcp), IPV4_SRC(ip), TCP_SRC(tcp)) == _TRUE) { + if (GET_TCP_SYN(tcp) && GET_TCP_ACK(tcp)) { + session_tracker_add_cmd(adapter, sta + , IPV4_DST(ip), TCP_DST(tcp) + , IPV4_SRC(ip), TCP_SRC(tcp)); + if (DBG_SESSION_TRACKER) + RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" SYN-ACK\n" + , FUNC_ADPT_ARG(adapter) + , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) + , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); + } + if (GET_TCP_FIN(tcp)) { + session_tracker_del_cmd(adapter, sta + , IPV4_DST(ip), TCP_DST(tcp) + , IPV4_SRC(ip), TCP_SRC(tcp)); + if (DBG_SESSION_TRACKER) + RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" FIN\n" + , FUNC_ADPT_ARG(adapter) + , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) + , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); + } + } + + } + } +} + #define SESSION_TRACKER_FMT IP_FMT":"PORT_FMT" "IP_FMT":"PORT_FMT" %u %d" #define SESSION_TRACKER_ARG(st) IP_ARG(&(st)->local_naddr), PORT_ARG(&(st)->local_port), IP_ARG(&(st)->remote_naddr), PORT_ARG(&(st)->remote_port), (st)->status, rtw_get_passing_time_ms((st)->set_time) @@ -165,8 +200,6 @@ void dump_st_ctl(void *sel, struct st_ctl_t *st_ctl) void _rtw_init_stainfo(struct sta_info *psta); void _rtw_init_stainfo(struct sta_info *psta) { - - _rtw_memset((u8 *)psta, 0, sizeof(struct sta_info)); _rtw_spinlock_init(&psta->lock); @@ -177,50 +210,21 @@ void _rtw_init_stainfo(struct sta_info *psta) /* _rtw_init_listhead(&psta->wakeup_list); */ _rtw_init_queue(&psta->sleep_q); - psta->sleepq_len = 0; _rtw_init_sta_xmit_priv(&psta->sta_xmitpriv); _rtw_init_sta_recv_priv(&psta->sta_recvpriv); #ifdef CONFIG_AP_MODE - _rtw_init_listhead(&psta->asoc_list); - _rtw_init_listhead(&psta->auth_list); - - psta->expire_to = 0; - - psta->flags = 0; - - psta->capability = 0; - psta->bpairwise_key_installed = _FALSE; #ifdef CONFIG_RTW_80211R psta->ft_pairwise_key_installed = _FALSE; #endif - -#ifdef CONFIG_NATIVEAP_MLME - psta->nonerp_set = 0; - psta->no_short_slot_time_set = 0; - psta->no_short_preamble_set = 0; - psta->no_ht_gf_set = 0; - psta->no_ht_set = 0; - psta->ht_20mhz_set = 0; - psta->ht_40mhz_intolerant = 0; -#endif - -#ifdef CONFIG_TX_MCAST2UNI - psta->under_exist_checking = 0; -#endif /* CONFIG_TX_MCAST2UNI */ - - psta->keep_alive_trycnt = 0; - #endif /* CONFIG_AP_MODE */ rtw_st_ctl_init(&psta->st_ctl); - - } u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) @@ -293,6 +297,9 @@ u32 _rtw_init_sta_priv(struct sta_priv *pstapriv) _rtw_init_queue(&(pstapriv->acl_list.acl_node_q)); #endif +#if CONFIG_RTW_PRE_LINK_STA + rtw_pre_link_sta_ctl_init(pstapriv); +#endif return _SUCCESS; @@ -431,6 +438,10 @@ u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) _rtw_deinit_queue(&(pstapriv->acl_list.acl_node_q)); #endif +#if CONFIG_RTW_PRE_LINK_STA + rtw_pre_link_sta_ctl_deinit(pstapriv); +#endif + if (pstapriv->pallocated_stainfo_buf) rtw_vmfree(pstapriv->pallocated_stainfo_buf, sizeof(struct sta_info) * NUM_STA + 4); } @@ -439,11 +450,19 @@ u32 _rtw_free_sta_priv(struct sta_priv *pstapriv) } +static void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) +{ + _adapter *padapter = preorder_ctrl->padapter; + +#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) + rtw_init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter, rtw_reordering_ctrl_timeout_handler, preorder_ctrl); +#endif +} + /* struct sta_info *rtw_alloc_stainfo(_queue *pfree_sta_queue, unsigned char *hwaddr) */ struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) { _irqL irqL, irqL2; - uint tmp_aid; s32 index; _list *phash_list; struct sta_info *psta; @@ -467,14 +486,11 @@ struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) rtw_list_delete(&(psta->list)); /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL); */ - - tmp_aid = psta->aid; - _rtw_init_stainfo(psta); psta->padapter = pstapriv->padapter; - _rtw_memcpy(psta->hwaddr, hwaddr, ETH_ALEN); + _rtw_memcpy(psta->cmn.mac_addr, hwaddr, ETH_ALEN); index = wifi_mac_hash(hwaddr); @@ -498,13 +514,14 @@ struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) * In this case, this packet will be dropped by recv_decache function if we use the 0x00 as the default value for tid_rxseq variable. * So, we initialize the tid_rxseq variable as the 0xffff. */ - for (i = 0; i < 16; i++) + for (i = 0; i < 16; i++) { _rtw_memcpy(&psta->sta_recvpriv.rxcache.tid_rxseq[i], &wRxSeqInitialValue, 2); + _rtw_memset(&psta->sta_recvpriv.rxcache.iv[i], 0, sizeof(psta->sta_recvpriv.rxcache.iv[i])); + } - - init_addba_retry_timer(pstapriv->padapter, psta); + rtw_init_timer(&psta->addba_retry_timer, psta->padapter, addba_timer_hdl, psta); #ifdef CONFIG_IEEE80211W - init_dot11w_expire_timer(pstapriv->padapter, psta); + rtw_init_timer(&psta->dot11w_expire_timer, psta->padapter, sa_query_timer_hdl, psta); #endif /* CONFIG_IEEE80211W */ #ifdef CONFIG_TDLS rtw_init_tdls_timer(pstapriv->padapter, psta); @@ -513,16 +530,14 @@ struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) /* for A-MPDU Rx reordering buffer control */ for (i = 0; i < 16 ; i++) { preorder_ctrl = &psta->recvreorder_ctrl[i]; - preorder_ctrl->padapter = pstapriv->padapter; - + preorder_ctrl->tid = i; preorder_ctrl->enable = _FALSE; - preorder_ctrl->indicate_seq = 0xffff; -#ifdef DBG_RX_SEQ - RTW_INFO("DBG_RX_SEQ %s:%d IndicateSeq: %d\n", __FUNCTION__, __LINE__, - preorder_ctrl->indicate_seq); -#endif + #ifdef DBG_RX_SEQ + RTW_INFO("DBG_RX_SEQ "FUNC_ADPT_FMT" tid:%u SN_CLEAR indicate_seq:%d\n" + , FUNC_ADPT_ARG(pstapriv->padapter), i, preorder_ctrl->indicate_seq); + #endif preorder_ctrl->wend_b = 0xffff; /* preorder_ctrl->wsize_b = (NR_RECVBUFF-2); */ preorder_ctrl->wsize_b = 64;/* 64; */ @@ -535,14 +550,14 @@ struct sta_info *rtw_alloc_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) /* init for DM */ - psta->rssi_stat.UndecoratedSmoothedPWDB = (-1); - psta->rssi_stat.UndecoratedSmoothedCCK = (-1); + psta->cmn.rssi_stat.rssi = (-1); + psta->cmn.rssi_stat.rssi_cck = (-1); + psta->cmn.rssi_stat.rssi_ofdm = (-1); #ifdef CONFIG_ATMEL_RC_PATCH psta->flag_atmel_rc = 0; #endif /* init for the sequence number of received management frame */ psta->RxMgmtFrameSeqNum = 0xffff; - psta->ra_rpt_linked = _FALSE; rtw_alloc_macid(pstapriv->padapter, psta); @@ -571,18 +586,32 @@ u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct sta_priv *pstapriv = &padapter->stapriv; struct hw_xmit *phwxmit; - int pending_qcnt[4]; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + int pending_qcnt[4]; + u8 is_pre_link_sta = _FALSE; if (psta == NULL) goto exit; - _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); - rtw_list_delete(&psta->hash_list); - pstapriv->asoc_sta_count--; - _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); - rtw_mi_update_iface_status(&(padapter->mlmepriv), 0); +#ifdef CONFIG_RTW_80211K + rm_post_event(padapter, RM_ID_FOR_ALL(psta->cmn.aid), RM_EV_cancel); +#endif + is_pre_link_sta = rtw_is_pre_link_sta(pstapriv, psta->cmn.mac_addr); + + if (is_pre_link_sta == _FALSE) { + _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); + rtw_list_delete(&psta->hash_list); + pstapriv->asoc_sta_count--; + _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); + rtw_mi_update_iface_status(&(padapter->mlmepriv), 0); + } else { + _enter_critical_bh(&psta->lock, &irqL0); + psta->state = WIFI_FW_PRE_LINK; + _exit_critical_bh(&psta->lock, &irqL0); + } _enter_critical_bh(&psta->lock, &irqL0); psta->state &= ~_FW_LINKED; @@ -694,12 +723,13 @@ u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) } - if (!((psta->state & WIFI_AP_STATE) || MacAddr_isBcst(psta->hwaddr))) + if (!((psta->state & WIFI_AP_STATE) || MacAddr_isBcst(psta->cmn.mac_addr)) && is_pre_link_sta == _FALSE) rtw_hal_set_odm_var(padapter, HAL_ODM_STA_INFO, psta, _FALSE); /* release mac id for non-bc/mc station, */ - rtw_release_macid(pstapriv->padapter, psta); + if (is_pre_link_sta == _FALSE) + rtw_release_macid(pstapriv->padapter, psta); #ifdef CONFIG_AP_MODE @@ -732,14 +762,16 @@ u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) #ifdef CONFIG_NATIVEAP_MLME - pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); - pstapriv->tim_bitmap &= ~BIT(psta->aid); + if (pmlmeinfo->state == _HW_STATE_AP_) { + pstapriv->sta_dz_bitmap &= ~BIT(psta->cmn.aid); + pstapriv->tim_bitmap &= ~BIT(psta->cmn.aid); - /* rtw_indicate_sta_disassoc_event(padapter, psta); */ + /* rtw_indicate_sta_disassoc_event(padapter, psta); */ - if ((psta->aid > 0) && (pstapriv->sta_aid[psta->aid - 1] == psta)) { - pstapriv->sta_aid[psta->aid - 1] = NULL; - psta->aid = 0; + if ((psta->cmn.aid > 0) && (pstapriv->sta_aid[psta->cmn.aid - 1] == psta)) { + pstapriv->sta_aid[psta->cmn.aid - 1] = NULL; + psta->cmn.aid = 0; + } } #endif /* CONFIG_NATIVEAP_MLME */ @@ -752,19 +784,18 @@ u32 rtw_free_stainfo(_adapter *padapter , struct sta_info *psta) rtw_st_ctl_deinit(&psta->st_ctl); - _rtw_spinlock_free(&psta->lock); + if (is_pre_link_sta == _FALSE) { + _rtw_spinlock_free(&psta->lock); - /* _enter_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ - _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); - rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue)); - _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); - /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ + /* _enter_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ + _enter_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); + rtw_list_insert_tail(&psta->list, get_list_head(pfree_sta_queue)); + _exit_critical_bh(&(pstapriv->sta_hash_lock), &irqL0); + /* _exit_critical_bh(&(pfree_sta_queue->lock), &irqL0); */ + } exit: - - return _SUCCESS; - } /* free all stainfo which in sta_hash[all] */ @@ -796,8 +827,9 @@ void rtw_free_all_stainfo(_adapter *padapter) plist = get_next(plist); if (pbcmc_stainfo != psta) { - rtw_list_delete(&psta->hash_list); - /* rtw_free_stainfo(padapter , psta); */ + if (rtw_is_pre_link_sta(pstapriv, psta->cmn.mac_addr) == _FALSE) + rtw_list_delete(&psta->hash_list); + stainfo_offset = rtw_stainfo_offset(pstapriv, psta); if (stainfo_offset_valid(stainfo_offset)) free_sta_list[free_sta_num++] = stainfo_offset; @@ -855,7 +887,7 @@ struct sta_info *rtw_get_stainfo(struct sta_priv *pstapriv, u8 *hwaddr) psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); - if ((_rtw_memcmp(psta->hwaddr, addr, ETH_ALEN)) == _TRUE) { + if ((_rtw_memcmp(psta->cmn.mac_addr, addr, ETH_ALEN)) == _TRUE) { /* if found the matched address */ break; } @@ -887,9 +919,10 @@ u32 rtw_init_bcmc_stainfo(_adapter *padapter) goto exit; } #ifdef CONFIG_BEAMFORMING - psta->txbf_gid = 63; - psta->txbf_paid = 0; + psta->cmn.bf_info.g_id = 63; + psta->cmn.bf_info.p_aid = 0; #endif + ptxservq = &(psta->sta_xmitpriv.be_q); /* @@ -976,3 +1009,196 @@ void dump_macaddr_acl(void *sel, _adapter *adapter) } } #endif /* CONFIG_RTW_MACADDR_ACL */ + +bool rtw_is_pre_link_sta(struct sta_priv *stapriv, u8 *addr) +{ +#if CONFIG_RTW_PRE_LINK_STA + struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; + struct sta_info *sta = NULL; + u8 exist = _FALSE; + int i; + _irqL irqL; + + _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { + if (pre_link_sta_ctl->node[i].valid == _TRUE + && _rtw_memcmp(pre_link_sta_ctl->node[i].addr, addr, ETH_ALEN) == _TRUE + ) { + exist = _TRUE; + break; + } + } + _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + + return exist; +#else + return _FALSE; +#endif +} + +#if CONFIG_RTW_PRE_LINK_STA +struct sta_info *rtw_pre_link_sta_add(struct sta_priv *stapriv, u8 *hwaddr) +{ + struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; + struct pre_link_sta_node_t *node = NULL; + struct sta_info *sta = NULL; + u8 exist = _FALSE; + int i; + _irqL irqL; + + if (rtw_check_invalid_mac_address(hwaddr, _FALSE) == _TRUE) + goto exit; + + _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { + if (pre_link_sta_ctl->node[i].valid == _TRUE + && _rtw_memcmp(pre_link_sta_ctl->node[i].addr, hwaddr, ETH_ALEN) == _TRUE + ) { + node = &pre_link_sta_ctl->node[i]; + exist = _TRUE; + break; + } + + if (node == NULL && pre_link_sta_ctl->node[i].valid == _FALSE) + node = &pre_link_sta_ctl->node[i]; + } + + if (exist == _FALSE && node) { + _rtw_memcpy(node->addr, hwaddr, ETH_ALEN); + node->valid = _TRUE; + pre_link_sta_ctl->num++; + } + _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + + if (node == NULL) + goto exit; + + sta = rtw_get_stainfo(stapriv, hwaddr); + if (sta) + goto odm_hook; + + sta = rtw_alloc_stainfo(stapriv, hwaddr); + if (!sta) + goto exit; + + sta->state = WIFI_FW_PRE_LINK; + +odm_hook: + rtw_hal_set_odm_var(stapriv->padapter, HAL_ODM_STA_INFO, sta, _TRUE); + +exit: + return sta; +} + +void rtw_pre_link_sta_del(struct sta_priv *stapriv, u8 *hwaddr) +{ + struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; + struct pre_link_sta_node_t *node = NULL; + struct sta_info *sta = NULL; + u8 exist = _FALSE; + int i; + _irqL irqL; + + if (rtw_check_invalid_mac_address(hwaddr, _FALSE) == _TRUE) + goto exit; + + _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { + if (pre_link_sta_ctl->node[i].valid == _TRUE + && _rtw_memcmp(pre_link_sta_ctl->node[i].addr, hwaddr, ETH_ALEN) == _TRUE + ) { + node = &pre_link_sta_ctl->node[i]; + exist = _TRUE; + break; + } + } + + if (exist == _TRUE && node) { + node->valid = _FALSE; + pre_link_sta_ctl->num--; + } + _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + + if (exist == _FALSE) + goto exit; + + sta = rtw_get_stainfo(stapriv, hwaddr); + if (!sta) + goto exit; + + if (sta->state == WIFI_FW_PRE_LINK) + rtw_free_stainfo(stapriv->padapter, sta); + +exit: + return; +} + +void rtw_pre_link_sta_ctl_reset(struct sta_priv *stapriv) +{ + struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; + struct pre_link_sta_node_t *node = NULL; + struct sta_info *sta = NULL; + int i, j = 0; + _irqL irqL; + + u8 addrs[RTW_PRE_LINK_STA_NUM][ETH_ALEN]; + + _rtw_memset(addrs, 0, RTW_PRE_LINK_STA_NUM * ETH_ALEN); + + _enter_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { + if (pre_link_sta_ctl->node[i].valid == _FALSE) + continue; + _rtw_memcpy(&(addrs[j][0]), pre_link_sta_ctl->node[i].addr, ETH_ALEN); + pre_link_sta_ctl->node[i].valid = _FALSE; + pre_link_sta_ctl->num--; + j++; + } + _exit_critical_bh(&(pre_link_sta_ctl->lock), &irqL); + + for (i = 0; i < j; i++) { + sta = rtw_get_stainfo(stapriv, &(addrs[i][0])); + if (!sta) + continue; + + if (sta->state == WIFI_FW_PRE_LINK) + rtw_free_stainfo(stapriv->padapter, sta); + } +} + +void rtw_pre_link_sta_ctl_init(struct sta_priv *stapriv) +{ + struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; + int i; + + _rtw_spinlock_init(&pre_link_sta_ctl->lock); + pre_link_sta_ctl->num = 0; + for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) + pre_link_sta_ctl->node[i].valid = _FALSE; +} + +void rtw_pre_link_sta_ctl_deinit(struct sta_priv *stapriv) +{ + struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; + int i; + + rtw_pre_link_sta_ctl_reset(stapriv); + + _rtw_spinlock_free(&pre_link_sta_ctl->lock); +} + +void dump_pre_link_sta_ctl(void *sel, struct sta_priv *stapriv) +{ + struct pre_link_sta_ctl_t *pre_link_sta_ctl = &stapriv->pre_link_sta_ctl; + int i; + + RTW_PRINT_SEL(sel, "num:%d/%d\n", pre_link_sta_ctl->num, RTW_PRE_LINK_STA_NUM); + + for (i = 0; i < RTW_PRE_LINK_STA_NUM; i++) { + if (pre_link_sta_ctl->node[i].valid == _FALSE) + continue; + RTW_PRINT_SEL(sel, MAC_FMT"\n", MAC_ARG(pre_link_sta_ctl->node[i].addr)); + } +} +#endif /* CONFIG_RTW_PRE_LINK_STA */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_tdls.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_tdls.c index be31530daf7d..8a5e0d34c7e1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_tdls.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_tdls.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_TDLS_C_ #include @@ -27,7 +22,12 @@ extern unsigned char MCS_rate_2R[16]; extern unsigned char MCS_rate_1R[16]; -extern void process_wmmps_data(_adapter *padapter, union recv_frame *precv_frame); + +inline void rtw_tdls_set_link_established(_adapter *adapter, bool en) +{ + adapter->tdlsinfo.link_established = en; + rtw_mi_update_iface_status(&(adapter->mlmepriv), 0); +} void rtw_reset_tdls_info(_adapter *padapter) { @@ -41,7 +41,7 @@ void rtw_reset_tdls_info(_adapter *padapter) else ptdlsinfo->ch_switch_prohibited = _TRUE; - ptdlsinfo->link_established = _FALSE; + rtw_tdls_set_link_established(padapter, _FALSE); ptdlsinfo->sta_cnt = 0; ptdlsinfo->sta_maximum = _FALSE; @@ -62,6 +62,8 @@ void rtw_reset_tdls_info(_adapter *padapter) #ifdef CONFIG_WFD ptdlsinfo->wfd_info = &padapter->wfd_info; #endif + + ptdlsinfo->tdls_sctx = NULL; } int rtw_init_tdls_info(_adapter *padapter) @@ -71,7 +73,6 @@ int rtw_init_tdls_info(_adapter *padapter) rtw_reset_tdls_info(padapter); - ptdlsinfo->tdls_enable = _TRUE; #ifdef CONFIG_TDLS_DRIVER_SETUP ptdlsinfo->driver_setup = _TRUE; #else @@ -94,6 +95,62 @@ void rtw_free_tdls_info(struct tdls_info *ptdlsinfo) } +void rtw_free_all_tdls_sta(_adapter *padapter, u8 from_cmd_thread) +{ + struct sta_priv *pstapriv = &padapter->stapriv; + struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; + _irqL irqL; + _list *plist, *phead; + s32 index; + struct sta_info *psta = NULL; + u8 tdls_sta[NUM_STA][ETH_ALEN]; + u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; + struct submit_ctx sctx; + + _rtw_memset(tdls_sta, 0x00, sizeof(tdls_sta)); + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + for (index = 0; index < NUM_STA; index++) { + phead = &(pstapriv->sta_hash[index]); + plist = get_next(phead); + + while (rtw_end_of_queue_search(phead, plist) == _FALSE) { + psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + + plist = get_next(plist); + + if (psta->tdls_sta_state != TDLS_STATE_NONE) + _rtw_memcpy(tdls_sta[index], psta->cmn.mac_addr, ETH_ALEN); + } + } + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + for (index = 0; index < NUM_STA; index++) { + if (!_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN)) { + RTW_INFO("issue tear down to "MAC_FMT" by from_cmd_thread = %d\n", MAC_ARG(tdls_sta[index]), from_cmd_thread); + + if (from_cmd_thread == _TRUE) { + struct TDLSoption_param tdls_param; + + _rtw_memcpy(&(tdls_param.addr), tdls_sta[index], ETH_ALEN); + + tdls_param.option = TDLS_TEARDOWN_STA; + tdls_hdl(padapter, (unsigned char *)&(tdls_param)); + + tdls_param.option = TDLS_TEARDOWN_STA_LOCALLY; + tdls_hdl(padapter, (unsigned char *)&(tdls_param)); + } else { + if (rtw_tdls_cmd(padapter, tdls_sta[index], TDLS_TEARDOWN_STA) == _SUCCESS) { + ptdlsinfo->tdls_sctx = &sctx; + rtw_sctx_init(ptdlsinfo->tdls_sctx, 1000); + rtw_sctx_wait(ptdlsinfo->tdls_sctx, __func__); + ptdlsinfo->tdls_sctx = NULL; + } + } + } + } +} + int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len) { u8 tdls_prohibited_bit = 0x40; /* bit(38); TDLS_prohibited */ @@ -122,6 +179,79 @@ int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len) return _FALSE; } +u8 rtw_is_tdls_enabled(_adapter *padapter) +{ + return padapter->registrypriv.en_tdls; +} + +void rtw_set_tdls_enable(_adapter *padapter, u8 enable) +{ + padapter->registrypriv.en_tdls = enable; + RTW_INFO("%s: en_tdls = %d\n", __func__, rtw_is_tdls_enabled(padapter)); +} + +void rtw_enable_tdls_func(_adapter *padapter) +{ + if (rtw_is_tdls_enabled(padapter) == _TRUE) + return; + +#if 0 +#ifdef CONFIG_MCC_MODE + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC) == _TRUE) { + RTW_INFO("[TDLS] MCC is running, can't enable TDLS !\n"); + return; + } +#endif +#endif + rtw_set_tdls_enable(padapter, _TRUE); +} + +void rtw_disable_tdls_func(_adapter *padapter, u8 from_cmd_thread) +{ + if (rtw_is_tdls_enabled(padapter) == _FALSE) + return; + + rtw_free_all_tdls_sta(padapter, from_cmd_thread); + rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); + rtw_reset_tdls_info(padapter); + + rtw_set_tdls_enable(padapter, _FALSE); +} + +u8 rtw_is_tdls_sta_existed(_adapter *padapter) +{ + struct sta_priv *pstapriv = &padapter->stapriv; + struct sta_info *psta; + int i = 0; + _irqL irqL; + _list *plist, *phead; + u8 ret = _FALSE; + + if (rtw_is_tdls_enabled(padapter) == _FALSE) + return _FALSE; + + _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + for (i = 0; i < NUM_STA; i++) { + phead = &(pstapriv->sta_hash[i]); + plist = get_next(phead); + while ((rtw_end_of_queue_search(phead, plist)) == _FALSE) { + psta = LIST_CONTAINOR(plist, struct sta_info, hash_list); + plist = get_next(plist); + if (psta->tdls_sta_state != TDLS_STATE_NONE) { + ret = _TRUE; + goto Exit; + } + } + } + +Exit: + + _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); + + return ret; +} + u8 rtw_tdls_is_setup_allowed(_adapter *padapter) { struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; @@ -147,7 +277,7 @@ u8 rtw_tdls_is_chsw_allowed(_adapter *padapter) } #endif -int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ack) +int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int wait_ms) { int ret = _FAIL; struct xmit_frame *pmgntframe; @@ -198,15 +328,15 @@ int _issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsi SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); + set_frame_sub_type(pframe, WIFI_QOS_DATA_NULL); pframe += sizeof(struct rtw_ieee80211_hdr_3addr_qos); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); pattrib->last_txcmdsz = pattrib->pktlen; - if (wait_ack) - ret = dump_mgntframe_and_wait_ack(padapter, pmgntframe); + if (wait_ms) + ret = dump_mgntframe_and_wait_ack_timeout(padapter, pmgntframe, wait_ms); else { dump_mgntframe(padapter, pmgntframe); ret = _SUCCESS; @@ -226,7 +356,7 @@ int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsig { int ret; int i = 0; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); @@ -234,9 +364,9 @@ int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsig psta = rtw_get_stainfo(&padapter->stapriv, da); if (psta) { if (power_mode) - rtw_hal_macid_sleep(padapter, psta->mac_id); + rtw_hal_macid_sleep(padapter, psta->cmn.mac_id); else - rtw_hal_macid_wakeup(padapter, psta->mac_id); + rtw_hal_macid_wakeup(padapter, psta->cmn.mac_id); } else { RTW_INFO(FUNC_ADPT_FMT ": Can't find sta info for " MAC_FMT ", skip macid %s!!\n", FUNC_ADPT_ARG(padapter), MAC_ARG(da), power_mode ? "sleep" : "wakeup"); @@ -245,7 +375,7 @@ int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsig #endif do { - ret = _issue_nulldata_to_TDLS_peer_STA(padapter, da, power_mode, wait_ms > 0 ? _TRUE : _FALSE); + ret = _issue_nulldata_to_TDLS_peer_STA(padapter, da, power_mode, wait_ms); i++; @@ -300,7 +430,7 @@ void free_tdls_sta(_adapter *padapter, struct sta_info *ptdls_sta) if (ptdlsinfo->sta_cnt == 0) { rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); - ptdlsinfo->link_established = _FALSE; + rtw_tdls_set_link_established(padapter, _FALSE); } else RTW_INFO("Remain tdls sta:%02x\n", ptdlsinfo->sta_cnt); @@ -333,8 +463,10 @@ void rtw_tdls_process_ht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 ptdls_sta->flags |= WLAN_STA_WME; _rtw_memcpy(&ptdls_sta->htpriv.ht_cap, data, sizeof(struct rtw_ieee80211_ht_cap)); - } else + } else { ptdls_sta->flags &= ~WLAN_STA_HT; + return; + } if (ptdls_sta->flags & WLAN_STA_HT) { if (padapter->registrypriv.ht_enable == _TRUE) { @@ -366,17 +498,17 @@ void rtw_tdls_process_ht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 ptdls_sta->htpriv.rx_ampdu_min_spacing = max_AMPDU_len | min_MPDU_spacing; /* Check if sta support s Short GI 20M */ - if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20)) + if ((phtpriv->sgi_20m == _TRUE) && (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_20))) ptdls_sta->htpriv.sgi_20m = _TRUE; /* Check if sta support s Short GI 40M */ - if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_40)) + if ((phtpriv->sgi_40m == _TRUE) && (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SGI_40))) ptdls_sta->htpriv.sgi_40m = _TRUE; /* Bwmode would still followed AP's setting */ if (ptdls_sta->htpriv.ht_cap.cap_info & cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH)) { if (padapter->mlmeextpriv.cur_bwmode >= CHANNEL_WIDTH_40) - ptdls_sta->bw_mode = CHANNEL_WIDTH_40; + ptdls_sta->cmn.bw_mode = CHANNEL_WIDTH_40; ptdls_sta->htpriv.ch_offset = padapter->mlmeextpriv.cur_ch_offset; } @@ -415,6 +547,11 @@ u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattr { rtw_ht_use_default_setting(padapter); + if (padapter->registrypriv.wifi_spec == 1) { + padapter->mlmepriv.htpriv.sgi_20m = _FALSE; + padapter->mlmepriv.htpriv.sgi_40m = _FALSE; + } + rtw_restructure_ht_ie(padapter, NULL, pframe, 0, &(pattrib->pktlen), padapter->mlmeextpriv.cur_channel); return pframe + pattrib->pktlen; @@ -424,11 +561,12 @@ u8 *rtw_tdls_set_ht_cap(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattr #ifdef CONFIG_80211AC_VHT void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; - u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, rf_type = RF_1T1R; + u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, rf_type = RF_1T1R, tx_nss = 0; u8 *pcap_mcs; - u8 vht_mcs[2]; _rtw_memset(&ptdls_sta->vhtpriv, 0, sizeof(struct vht_priv)); if (data && Length == 12) { @@ -444,13 +582,15 @@ void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 #else ptdls_sta->vhtpriv.vht_op_mode_notify = CHANNEL_WIDTH_80; #endif - } else + } else { ptdls_sta->flags &= ~WLAN_STA_VHT; + return; + } if (ptdls_sta->flags & WLAN_STA_VHT) { if (REGSTY_IS_11AC_ENABLE(&padapter->registrypriv) && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) - && (!pmlmepriv->country_ent || COUNTRY_CHPLAN_EN_11AC(pmlmepriv->country_ent))) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent))) ptdls_sta->vhtpriv.vht_option = _TRUE; else ptdls_sta->vhtpriv.vht_option = _FALSE; @@ -475,6 +615,7 @@ void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 } ptdls_sta->vhtpriv.stbc_cap = cur_stbc_cap; + #ifdef CONFIG_BEAMFORMING /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && GET_VHT_CAPABILITY_ELE_SU_BFEE(data)) @@ -487,26 +628,68 @@ void rtw_tdls_process_vht_cap(_adapter *padapter, struct sta_info *ptdls_sta, u8 ptdls_sta->vhtpriv.beamform_cap = cur_beamform_cap; if (cur_beamform_cap) RTW_INFO("Current VHT Beamforming Setting = %02X\n", cur_beamform_cap); + #endif /*CONFIG_BEAMFORMING*/ /* B23 B24 B25 Maximum A-MPDU Length Exponent */ ptdls_sta->vhtpriv.ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(data); pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(data); - _rtw_memcpy(vht_mcs, pcap_mcs, 2); - rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) - vht_mcs[0] |= 0xfc; - else if (rf_type == RF_2T2R) - vht_mcs[0] |= 0xf0; - else if (rf_type == RF_3T3R) - vht_mcs[0] |= 0xc0; - - _rtw_memcpy(ptdls_sta->vhtpriv.vht_mcs_map, vht_mcs, 2); - + tx_nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); + rtw_vht_nss_to_mcsmap(tx_nss, ptdls_sta->vhtpriv.vht_mcs_map, pcap_mcs); ptdls_sta->vhtpriv.vht_highest_rate = rtw_get_vht_highest_rate(ptdls_sta->vhtpriv.vht_mcs_map); } +void rtw_tdls_process_vht_operation(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct registry_priv *regsty = adapter_to_regsty(padapter); + u8 operation_bw = 0; + + if (GET_VHT_OPERATION_ELE_CHL_WIDTH(data) >= 1) { + + operation_bw = CHANNEL_WIDTH_80; + + if (hal_is_bw_support(padapter, operation_bw) && REGSTY_IS_BW_5G_SUPPORT(regsty, operation_bw) + && (operation_bw <= pmlmeext->cur_bwmode)) + ptdls_sta->cmn.bw_mode = operation_bw; + else + ptdls_sta->cmn.bw_mode = pmlmeext->cur_bwmode; + } else + ptdls_sta->cmn.bw_mode = pmlmeext->cur_bwmode; +} + +void rtw_tdls_process_vht_op_mode_notify(_adapter *padapter, struct sta_info *ptdls_sta, u8 *data, u8 Length) +{ + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct registry_priv *regsty = adapter_to_regsty(padapter); + u8 target_bw; + u8 target_rxss, current_rxss; + + if (pvhtpriv->vht_option == _FALSE) + return; + + target_bw = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(data); + target_rxss = (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(data) + 1); + + if (hal_is_bw_support(padapter, target_bw) && REGSTY_IS_BW_5G_SUPPORT(regsty, target_bw) + && (target_bw <= pmlmeext->cur_bwmode)) + ptdls_sta->cmn.bw_mode = target_bw; + else + ptdls_sta->cmn.bw_mode = pmlmeext->cur_bwmode; + + current_rxss = rtw_vht_mcsmap_to_nss(ptdls_sta->vhtpriv.vht_mcs_map); + if (target_rxss != current_rxss) { + u8 vht_mcs_map[2] = {}; + + rtw_vht_nss_to_mcsmap(target_rxss, vht_mcs_map, ptdls_sta->vhtpriv.vht_mcs_map); + _rtw_memcpy(ptdls_sta->vhtpriv.vht_mcs_map, vht_mcs_map, 2); + } +} + u8 *rtw_tdls_set_aid(_adapter *padapter, u8 *pframe, struct pkt_attrib *pattrib) { return rtw_set_ie(pframe, EID_AID, 2, (u8 *)&(padapter->mlmepriv.cur_network.aid), &(pattrib->pktlen)); @@ -546,20 +729,22 @@ u8 *rtw_tdls_set_vht_op_mode_notify(_adapter *padapter, u8 *pframe, struct pkt_a #endif -u8 *rtw_tdls_set_sup_ch(struct mlme_ext_priv *pmlmeext, u8 *pframe, struct pkt_attrib *pattrib) +u8 *rtw_tdls_set_sup_ch(_adapter *adapter, u8 *pframe, struct pkt_attrib *pattrib) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); u8 sup_ch[30 * 2] = {0x00}, ch_set_idx = 0, sup_ch_idx = 2; - do { - if (pmlmeext->channel_set[ch_set_idx].ChannelNum <= 14) { + while (ch_set_idx < rfctl->max_chan_nums && rfctl->channel_set[ch_set_idx].ChannelNum != 0) { + if (rfctl->channel_set[ch_set_idx].ChannelNum <= 14) { + /* TODO: fix 2.4G supported channel when channel doesn't start from 1 and continuous */ sup_ch[0] = 1; /* First channel number */ - sup_ch[1] = pmlmeext->channel_set[ch_set_idx].ChannelNum; /* Number of channel */ + sup_ch[1] = rfctl->channel_set[ch_set_idx].ChannelNum; /* Number of channel */ } else { - sup_ch[sup_ch_idx++] = pmlmeext->channel_set[ch_set_idx].ChannelNum; + sup_ch[sup_ch_idx++] = rfctl->channel_set[ch_set_idx].ChannelNum; sup_ch[sup_ch_idx++] = 1; } ch_set_idx++; - } while (pmlmeext->channel_set[ch_set_idx].ChannelNum != 0 && ch_set_idx < MAX_CHANNEL_NUM); + } return rtw_set_ie(pframe, _SUPPORTED_CH_IE_, sup_ch_idx, sup_ch, &(pattrib->pktlen)); } @@ -606,7 +791,9 @@ u8 *rtw_tdls_set_ftie(struct tdls_txmgmt *ptxmgmt, u8 *pframe, struct pkt_attrib _rtw_memcpy(FTIE.Anonce, ANonce, WPA_NONCE_LEN); if (SNonce != NULL) _rtw_memcpy(FTIE.Snonce, SNonce, WPA_NONCE_LEN); - return rtw_set_ie(pframe, _FTIE_ , 82, (u8 *)FTIE.mic_ctrl, &(pattrib->pktlen)); + + return rtw_set_ie(pframe, _FTIE_, TDLS_FTIE_DATA_LEN, + (u8 *)FTIE.data, &(pattrib->pktlen)); } } @@ -816,10 +1003,14 @@ s32 rtw_tdls_do_ch_sw(_adapter *padapter, struct sta_info *ptdls_sta, u8 chnl_ty ch_sw_time_start = rtw_systime_to_ms(rtw_get_current_time()); - rtw_tdls_chsw_oper_init(padapter, TDLS_CH_SWITCH_OPER_OFFLOAD_TIMEOUT); - /* set mac_id sleep before channel switch */ - rtw_hal_macid_sleep(padapter, ptdls_sta->mac_id); + rtw_hal_macid_sleep(padapter, ptdls_sta->cmn.mac_id); + +#ifdef CONFIG_TDLS_CH_SW_BY_DRV + set_channel_bwmode(padapter, channel, channel_offset, bwmode); + ret = _SUCCESS; +#else + rtw_tdls_chsw_oper_init(padapter, TDLS_CH_SWITCH_OPER_OFFLOAD_TIMEOUT); /* channel switch IOs offload to FW */ if (rtw_hal_ch_sw_oper_offload(padapter, channel, channel_offset, bwmode) == _SUCCESS) { @@ -832,9 +1023,9 @@ s32 rtw_tdls_do_ch_sw(_adapter *padapter, struct sta_info *ptdls_sta, u8 chnl_ty rtw_set_oper_bw(padapter, bwmode); center_ch = rtw_get_center_ch(channel, bwmode, channel_offset); - pHalData->CurrentChannel = center_ch; + pHalData->current_channel = center_ch; pHalData->CurrentCenterFrequencyIndex1 = center_ch; - pHalData->CurrentChannelBW = bwmode; + pHalData->current_channel_bw = bwmode; pHalData->nCur40MhzPrimeSC = channel_offset; if (bwmode == CHANNEL_WIDTH_80) { @@ -855,25 +1046,27 @@ s32 rtw_tdls_do_ch_sw(_adapter *padapter, struct sta_info *ptdls_sta, u8 chnl_ty if (take_care_iqk == _TRUE) rtw_hal_ch_sw_iqk_info_restore(padapter, CH_SW_USE_CASE_TDLS); - ch_sw_time_spent = rtw_systime_to_ms(rtw_get_current_time()) - ch_sw_time_start; - - if (chnl_type == TDLS_CH_SW_OFF_CHNL) { - if ((u32)ch_switch_time / 1000 > ch_sw_time_spent) - wait_time = (u32)ch_switch_time / 1000 - ch_sw_time_spent; - else - wait_time = 0; - - if (wait_time > 0) - rtw_msleep_os(wait_time); - } - ret = _SUCCESS; } else RTW_INFO("[TDLS] chsw oper wait fail !!\n"); } +#endif + + if (ret == _SUCCESS) { + ch_sw_time_spent = rtw_systime_to_ms(rtw_get_current_time()) - ch_sw_time_start; + if (chnl_type == TDLS_CH_SW_OFF_CHNL) { + if ((u32)ch_switch_time / 1000 > ch_sw_time_spent) + wait_time = (u32)ch_switch_time / 1000 - ch_sw_time_spent; + else + wait_time = 0; + + if (wait_time > 0) + rtw_msleep_os(wait_time); + } + } /* set mac_id wakeup after channel switch */ - rtw_hal_macid_wakeup(padapter, ptdls_sta->mac_id); + rtw_hal_macid_wakeup(padapter, ptdls_sta->cmn.mac_id); return ret; } @@ -1035,14 +1228,36 @@ int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wa RTW_INFO("[TDLS] %s\n", __FUNCTION__); - ptxmgmt->action_code = TDLS_SETUP_REQUEST; if (rtw_tdls_is_setup_allowed(padapter) == _FALSE) goto exit; + if (IS_MCAST(ptxmgmt->peer)) + goto exit; + + ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); + if (ptdlsinfo->sta_maximum == _TRUE) { + if (ptdls_sta == NULL) + goto exit; + else if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) + goto exit; + } + pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) goto exit; + if (ptdls_sta == NULL) { + ptdls_sta = rtw_alloc_stainfo(pstapriv, ptxmgmt->peer); + if (ptdls_sta == NULL) { + RTW_INFO("[%s] rtw_alloc_stainfo fail\n", __FUNCTION__); + rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); + rtw_free_xmitframe(pxmitpriv, pmgntframe); + goto exit; + } + } + + ptxmgmt->action_code = TDLS_SETUP_REQUEST; + pattrib = &pmgntframe->attrib; pmgntframe->frame_tag = DATA_FRAMETAG; pattrib->ether_type = 0x890d; @@ -1054,18 +1269,6 @@ int issue_tdls_setup_req(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wa update_tdls_attrib(padapter, pattrib); - /* init peer sta_info */ - ptdls_sta = rtw_get_stainfo(pstapriv, ptxmgmt->peer); - if (ptdls_sta == NULL) { - ptdls_sta = rtw_alloc_stainfo(pstapriv, ptxmgmt->peer); - if (ptdls_sta == NULL) { - RTW_INFO("[%s] rtw_alloc_stainfo fail\n", __FUNCTION__); - rtw_free_xmitbuf(pxmitpriv, pmgntframe->pxmitbuf); - rtw_free_xmitframe(pxmitpriv, pmgntframe); - goto exit; - } - } - if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) ptdlsinfo->sta_cnt++; @@ -1133,7 +1336,12 @@ int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wai _rtw_memcpy(pattrib->dst, ptxmgmt->peer, ETH_ALEN); _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); + + if (ptxmgmt->status_code == _RSON_TDLS_TEAR_UN_RSN_) + _rtw_memcpy(pattrib->ra, ptxmgmt->peer, ETH_ALEN); + else + _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); + _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); update_tdls_attrib(padapter, pattrib); @@ -1156,9 +1364,6 @@ int _issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wai ret = _SUCCESS; } - if (rtw_tdls_is_driver_setup(padapter)) - rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEARDOWN_STA_LOCALLY); - exit: return ret; @@ -1175,6 +1380,9 @@ int issue_tdls_teardown(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 wait ret = _issue_tdls_teardown(padapter, ptxmgmt, wait_ack); } + if (rtw_tdls_is_driver_setup(padapter)) + rtw_tdls_cmd(padapter, ptxmgmt->peer, TDLS_TEARDOWN_STA_LOCALLY); + return ret; } @@ -1338,7 +1546,7 @@ int issue_tdls_dis_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, u8 priva SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -1376,9 +1584,9 @@ int issue_tdls_peer_traffic_rsp(_adapter *padapter, struct sta_info *ptdls_sta, pmgntframe->frame_tag = DATA_FRAMETAG; pattrib->ether_type = 0x890d; - _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(pattrib->dst, ptdls_sta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); + _rtw_memcpy(pattrib->ra, ptdls_sta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); update_tdls_attrib(padapter, pattrib); @@ -1421,7 +1629,7 @@ int issue_tdls_peer_traffic_indication(_adapter *padapter, struct sta_info *ptdl pmgntframe->frame_tag = DATA_FRAMETAG; pattrib->ether_type = 0x890d; - _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(pattrib->dst, ptdls_sta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); @@ -1474,9 +1682,9 @@ int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta) pmgntframe->frame_tag = DATA_FRAMETAG; pattrib->ether_type = 0x890d; - _rtw_memcpy(pattrib->dst, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(pattrib->dst, ptdls_sta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(pattrib->src, adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy(pattrib->ra, get_bssid(pmlmepriv), ETH_ALEN); + _rtw_memcpy(pattrib->ra, ptdls_sta->cmn.mac_addr, ETH_ALEN); _rtw_memcpy(pattrib->ta, pattrib->src, ETH_ALEN); update_tdls_attrib(padapter, pattrib); @@ -1560,10 +1768,13 @@ int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) struct rx_pkt_attrib *pattrib = &(precv_frame->u.hdr.attrib); struct tdls_info *ptdlsinfo = &(padapter->tdlsinfo); u8 empty_addr[ETH_ALEN] = { 0x00 }; - int UndecoratedSmoothedPWDB; + int rssi = 0; struct tdls_txmgmt txmgmt; int ret = _SUCCESS; + if (psta) + rssi = psta->cmn.rssi_stat.rssi; + _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); /* WFDTDLS: for sigma test, not to setup direct link automatically */ ptdlsinfo->dev_discovered = _TRUE; @@ -1579,11 +1790,11 @@ int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) if (ptdlsinfo->sta_maximum == _TRUE && ptdls_sta->alive_count >= 1) { if (_rtw_memcmp(ptdlsinfo->ss_record.macaddr, empty_addr, ETH_ALEN)) { _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); - ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; + ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.rx_pwdb_all; } else { - if (ptdlsinfo->ss_record.RxPWDBAll < pattrib->phy_info.RxPWDBAll) { + if (ptdlsinfo->ss_record.RxPWDBAll < pattrib->phy_info.rx_pwdb_all) { _rtw_memcpy(ptdlsinfo->ss_record.macaddr, psa, ETH_ALEN); - ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.RxPWDBAll; + ptdlsinfo->ss_record.RxPWDBAll = pattrib->phy_info.rx_pwdb_all; } } } @@ -1594,7 +1805,7 @@ int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) ret = _FAIL; goto exit; } else { - if (pattrib->phy_info.RxPWDBAll > ptdlsinfo->ss_record.RxPWDBAll) { + if (pattrib->phy_info.rx_pwdb_all > ptdlsinfo->ss_record.RxPWDBAll) { _rtw_memcpy(txmgmt.peer, ptdlsinfo->ss_record.macaddr, ETH_ALEN); /* issue_tdls_teardown(padapter, ptdlsinfo->ss_record.macaddr, _FALSE); */ } else { @@ -1604,10 +1815,9 @@ int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) } } - rtw_hal_get_def_var(padapter, HAL_DEF_UNDERCORATEDSMOOTHEDPWDB, &UndecoratedSmoothedPWDB); - if (pattrib->phy_info.RxPWDBAll + TDLS_SIGNAL_THRESH >= UndecoratedSmoothedPWDB) { - RTW_INFO("pattrib->RxPWDBAll=%d, pdmpriv->UndecoratedSmoothedPWDB=%d\n", pattrib->phy_info.RxPWDBAll, UndecoratedSmoothedPWDB); + if (pattrib->phy_info.rx_pwdb_all + TDLS_SIGNAL_THRESH >= rssi) { + RTW_INFO("pattrib->RxPWDBAll=%d, pdmpriv->undecorated_smoothed_pwdb=%d\n", pattrib->phy_info.rx_pwdb_all, rssi); _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); issue_tdls_setup_req(padapter, &txmgmt, _FALSE); } @@ -1619,11 +1829,10 @@ int On_TDLS_Dis_Rsp(_adapter *padapter, union recv_frame *precv_frame) } -sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) +sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; u8 *psa, *pmyid; - struct sta_info *ptdls_sta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; u8 *ptr = precv_frame->u.hdr.rx_data; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); @@ -1648,7 +1857,13 @@ sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); psa = get_sa(ptr); - ptdls_sta = rtw_get_stainfo(pstapriv, psa); + + if (ptdlsinfo->sta_maximum == _TRUE) { + if (ptdls_sta == NULL) + goto exit; + else if (!(ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE)) + goto exit; + } pmyid = adapter_mac_addr(padapter); ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; @@ -1658,8 +1873,7 @@ sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) - prx_pkt_attrib->icv_len - LLC_HEADER_SIZE - ETH_TYPE_LEN - - PAYLOAD_TYPE_LEN - - FIXED_IE; + - PAYLOAD_TYPE_LEN; if (ptdls_sta == NULL) ptdls_sta = rtw_alloc_stainfo(pstapriv, psa); @@ -1706,7 +1920,7 @@ sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) case _COUNTRY_IE_: break; case _EXT_SUPPORTEDRATES_IE_: - if (supportRateNum <= sizeof(supportRate)) { + if (supportRateNum < sizeof(supportRate)) { _rtw_memcpy(supportRate + supportRateNum, pIE->data, pIE->Length); supportRateNum += pIE->Length; } @@ -1829,11 +2043,10 @@ sint On_TDLS_Setup_Req(_adapter *padapter, union recv_frame *precv_frame) return _SUCCESS; } -int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) +int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { struct registry_priv *pregistrypriv = &padapter->registrypriv; struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; - struct sta_info *ptdls_sta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; u8 *ptr = precv_frame->u.hdr.rx_data; _irqL irqL; @@ -1855,13 +2068,6 @@ int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); psa = get_sa(ptr); - ptdls_sta = rtw_get_stainfo(pstapriv, psa); - - if (ptdls_sta == NULL) { - RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); - ret = _FAIL; - goto exit; - } ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len @@ -1870,8 +2076,7 @@ int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) - prx_pkt_attrib->icv_len - LLC_HEADER_SIZE - ETH_TYPE_LEN - - PAYLOAD_TYPE_LEN - - FIXED_IE; + - PAYLOAD_TYPE_LEN; _rtw_memcpy(&status_code, ptr + 2, 2); @@ -1896,7 +2101,7 @@ int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) case _COUNTRY_IE_: break; case _EXT_SUPPORTEDRATES_IE_: - if (supportRateNum <= sizeof(supportRate)) { + if (supportRateNum < sizeof(supportRate)) { _rtw_memcpy(supportRate + supportRateNum, pIE->data, pIE->Length); supportRateNum += pIE->Length; } @@ -1944,7 +2149,7 @@ int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) rtw_tdls_process_vht_cap(padapter, ptdls_sta, pIE->data, pIE->Length); break; case EID_OpModeNotification: - rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); + rtw_tdls_process_vht_op_mode_notify(padapter, ptdls_sta, pIE->data, pIE->Length); break; #endif case EID_BSSCoexistence: @@ -1968,35 +2173,30 @@ int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) rtw_tdls_process_wfd_ie(ptdlsinfo, ptr + FIXED_IE, parsing_length); #endif - if (status_code != _STATS_SUCCESSFUL_) - txmgmt.status_code = status_code; - else { - if (prx_pkt_attrib->encrypt) { - if (verify_ccmp == 1) { - txmgmt.status_code = _STATS_SUCCESSFUL_; - if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { - wpa_tdls_generate_tpk(padapter, ptdls_sta); - if (tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL) { - RTW_INFO("[TDLS] %s tdls_verify_mic fail, free_tdls_sta\n", __FUNCTION__); - free_tdls_sta(padapter, ptdls_sta); - ret = _FAIL; - goto exit; - } - ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; - } - } else - txmgmt.status_code = _STATS_INVALID_RSNIE_; - - } else + if (prx_pkt_attrib->encrypt) { + if (verify_ccmp == 1) { txmgmt.status_code = _STATS_SUCCESSFUL_; - } + if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { + wpa_tdls_generate_tpk(padapter, ptdls_sta); + if (tdls_verify_mic(ptdls_sta->tpk.kck, 2, plinkid_ie, prsnie, ptimeout_ie, pftie) == _FAIL) { + RTW_INFO("[TDLS] %s tdls_verify_mic fail, free_tdls_sta\n", __FUNCTION__); + free_tdls_sta(padapter, ptdls_sta); + ret = _FAIL; + goto exit; + } + ptdls_sta->TDLS_PeerKey_Lifetime = timeout_interval; + } + } else + txmgmt.status_code = _STATS_INVALID_RSNIE_; + } else + txmgmt.status_code = _STATS_SUCCESSFUL_; if (rtw_tdls_is_driver_setup(padapter) == _TRUE) { _rtw_memcpy(txmgmt.peer, prx_pkt_attrib->src, ETH_ALEN); issue_tdls_setup_cfm(padapter, &txmgmt); if (txmgmt.status_code == _STATS_SUCCESSFUL_) { - ptdlsinfo->link_established = _TRUE; + rtw_tdls_set_link_established(padapter, _TRUE); if (ptdls_sta->tdls_sta_state & TDLS_RESPONDER_STATE) { ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; @@ -2007,7 +2207,7 @@ int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) if (prx_pkt_attrib->encrypt) rtw_tdls_set_key(padapter, ptdls_sta); - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_ESTABLISHED); } } @@ -2020,10 +2220,9 @@ int On_TDLS_Setup_Rsp(_adapter *padapter, union recv_frame *precv_frame) } -int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) +int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; - struct sta_info *ptdls_sta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; u8 *ptr = precv_frame->u.hdr.rx_data; _irqL irqL; @@ -2038,13 +2237,6 @@ int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) int ret = _SUCCESS; psa = get_sa(ptr); - ptdls_sta = rtw_get_stainfo(pstapriv, psa); - - if (ptdls_sta == NULL) { - RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __FUNCTION__, MAC_ARG(psa)); - ret = _FAIL; - goto exit; - } ptr += prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; parsing_length = ((union recv_frame *)precv_frame)->u.hdr.len @@ -2053,8 +2245,7 @@ int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) - prx_pkt_attrib->icv_len - LLC_HEADER_SIZE - ETH_TYPE_LEN - - PAYLOAD_TYPE_LEN - - FIXED_IE; + - PAYLOAD_TYPE_LEN; _rtw_memcpy(&status_code, ptr + 2, 2); @@ -2092,9 +2283,10 @@ int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) #endif #ifdef CONFIG_80211AC_VHT case EID_VHTOperation: + rtw_tdls_process_vht_operation(padapter, ptdls_sta, pIE->data, pIE->Length); break; case EID_OpModeNotification: - rtw_process_vht_op_mode_notify(padapter, pIE->data, ptdls_sta); + rtw_tdls_process_vht_op_mode_notify(padapter, ptdls_sta, pIE->data, pIE->Length); break; #endif case _LINK_ID_IE_: @@ -2119,7 +2311,7 @@ int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) } if (rtw_tdls_is_driver_setup(padapter)) { - ptdlsinfo->link_established = _TRUE; + rtw_tdls_set_link_established(padapter, _TRUE); if (ptdls_sta->tdls_sta_state & TDLS_INITIATOR_STATE) { ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; @@ -2135,7 +2327,7 @@ int On_TDLS_Setup_Cfm(_adapter *padapter, union recv_frame *precv_frame) _set_timer(&ptdls_sta->TPK_timer, ONE_SEC); } - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ESTABLISHED); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_ESTABLISHED); } exit: @@ -2170,8 +2362,7 @@ int On_TDLS_Dis_Req(_adapter *padapter, union recv_frame *precv_frame) - prx_pkt_attrib->icv_len - LLC_HEADER_SIZE - ETH_TYPE_LEN - - PAYLOAD_TYPE_LEN - - FIXED_IE; + - PAYLOAD_TYPE_LEN; /* Parsing information element */ for (j = FIXED_IE; j < parsing_length;) { @@ -2202,28 +2393,21 @@ int On_TDLS_Dis_Req(_adapter *padapter, union recv_frame *precv_frame) } -int On_TDLS_Teardown(_adapter *padapter, union recv_frame *precv_frame) +int On_TDLS_Teardown(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { - u8 *psa; u8 *ptr = precv_frame->u.hdr.rx_data; struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *ptdls_sta = NULL; _irqL irqL; u8 reason; reason = *(ptr + prx_pkt_attrib->hdrlen + prx_pkt_attrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN + 2); RTW_INFO("[TDLS] %s Reason code(%d)\n", __FUNCTION__, reason); - psa = get_sa(ptr); - - ptdls_sta = rtw_get_stainfo(pstapriv, psa); - if (ptdls_sta != NULL) { - if (rtw_tdls_is_driver_setup(padapter)) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA_LOCALLY); - } + if (rtw_tdls_is_driver_setup(padapter)) + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY); return _SUCCESS; @@ -2243,36 +2427,29 @@ u8 TDLS_check_ch_state(uint state) } #endif -int On_TDLS_Peer_Traffic_Indication(_adapter *padapter, union recv_frame *precv_frame) +int On_TDLS_Peer_Traffic_Indication(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; - struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->src); u8 *ptr = precv_frame->u.hdr.rx_data; struct tdls_txmgmt txmgmt; ptr += pattrib->hdrlen + pattrib->iv_len + LLC_HEADER_SIZE + ETH_TYPE_LEN + PAYLOAD_TYPE_LEN; _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); - if (ptdls_sta != NULL) { txmgmt.dialog_token = *(ptr + 2); issue_tdls_peer_traffic_rsp(padapter, ptdls_sta, &txmgmt); - /* issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 0, 0); */ - } else { - RTW_INFO("from unknown sta:"MAC_FMT"\n", MAC_ARG(pattrib->src)); - return _FAIL; - } + /* issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 0, 0, 0); */ return _SUCCESS; } /* We process buffered data for 1. U-APSD, 2. ch. switch, 3. U-APSD + ch. switch here */ -int On_TDLS_Peer_Traffic_Rsp(_adapter *padapter, union recv_frame *precv_frame) +int On_TDLS_Peer_Traffic_Rsp(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->src); u8 wmmps_ac = 0; /* u8 state=TDLS_check_ch_state(ptdls_sta->tdls_sta_state); */ int i; @@ -2334,20 +2511,17 @@ int On_TDLS_Peer_Traffic_Rsp(_adapter *padapter, union recv_frame *precv_frame) } #ifdef CONFIG_TDLS_CH_SW -sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) +sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; - struct sta_info *ptdls_sta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; u8 *ptr = precv_frame->u.hdr.rx_data; struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; - u8 *psa; sint parsing_length; PNDIS_802_11_VARIABLE_IEs pIE; u8 FIXED_IE = 4; u16 j; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct tdls_txmgmt txmgmt; u8 zaddr[ETH_ALEN] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; u16 switch_time = TDLS_CH_SWITCH_TIME * 1000, switch_timeout = TDLS_CH_SWITCH_TIMEOUT * 1000; u8 take_care_iqk; @@ -2357,15 +2531,6 @@ sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) return _FAIL; } - _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); - psa = get_sa(ptr); - ptdls_sta = rtw_get_stainfo(pstapriv, psa); - - if (ptdls_sta == NULL) { - RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); - return _FAIL; - } - ptdls_sta->ch_switch_time = switch_time; ptdls_sta->ch_switch_timeout = switch_timeout; @@ -2376,8 +2541,7 @@ sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) - prx_pkt_attrib->icv_len - LLC_HEADER_SIZE - ETH_TYPE_LEN - - PAYLOAD_TYPE_LEN - - FIXED_IE; + - PAYLOAD_TYPE_LEN; pchsw_info->off_ch_num = *(ptr + 2); @@ -2432,7 +2596,7 @@ sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) central_chnl = rtw_get_center_ch(pchsw_info->off_ch_num, bw_mode, pchsw_info->ch_offset); if (rtw_hal_ch_sw_iqk_info_search(padapter, central_chnl, bw_mode) < 0) { if (!(pchsw_info->ch_sw_state & TDLS_CH_SWITCH_PREPARE_STATE)) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_PREPARE); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_PREPARE); return _FAIL; } @@ -2442,29 +2606,23 @@ sint On_TDLS_Ch_Switch_Req(_adapter *padapter, union recv_frame *precv_frame) if (!(pchsw_info->ch_sw_state & TDLS_CH_SW_INITIATOR_STATE)) _cancel_timer_ex(&ptdls_sta->ch_sw_monitor_timer); - /* Todo: check status */ - txmgmt.status_code = 0; - _rtw_memcpy(txmgmt.peer, psa, ETH_ALEN); - if (_rtw_memcmp(pchsw_info->addr, zaddr, ETH_ALEN) == _TRUE) - _rtw_memcpy(pchsw_info->addr, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(pchsw_info->addr, ptdls_sta->cmn.mac_addr, ETH_ALEN); if (ATOMIC_READ(&pchsw_info->chsw_on) == _FALSE) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_START); - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_RESP); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_RESP); return _SUCCESS; } -sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame) +sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta) { struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; - struct sta_info *ptdls_sta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; u8 *ptr = precv_frame->u.hdr.rx_data; struct rx_pkt_attrib *prx_pkt_attrib = &precv_frame->u.hdr.attrib; - u8 *psa; sint parsing_length; PNDIS_802_11_VARIABLE_IEs pIE; u8 FIXED_IE = 4; @@ -2477,20 +2635,12 @@ sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame) return _SUCCESS; } - psa = get_sa(ptr); - ptdls_sta = rtw_get_stainfo(pstapriv, psa); - - if (ptdls_sta == NULL) { - RTW_INFO("[%s] Direct Link Peer = "MAC_FMT" not found\n", __func__, MAC_ARG(psa)); - return _FAIL; - } - /* If we receive Unsolicited TDLS Channel Switch Response when channel switch is running, */ /* we will go back to base channel and terminate this channel switch procedure */ if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) { if (pmlmeext->cur_channel != rtw_get_oper_ch(padapter)) { RTW_INFO("[TDLS] Rx unsolicited channel switch response\n"); - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_BASE_CHNL); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_TO_BASE_CHNL); goto exit; } } @@ -2502,15 +2652,14 @@ sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame) - prx_pkt_attrib->icv_len - LLC_HEADER_SIZE - ETH_TYPE_LEN - - PAYLOAD_TYPE_LEN - - FIXED_IE; + - PAYLOAD_TYPE_LEN; _rtw_memcpy(&status_code, ptr + 2, 2); if (status_code != 0) { RTW_INFO("[TDLS] %s status_code:%d\n", __func__, status_code); pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE); - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_END); ret = _FAIL; goto exit; } @@ -2541,7 +2690,7 @@ sint On_TDLS_Ch_Switch_Rsp(_adapter *padapter, union recv_frame *precv_frame) if ((pmlmeext->cur_channel == rtw_get_oper_ch(padapter)) && (pchsw_info->ch_sw_state & TDLS_WAIT_CH_RSP_STATE)) { if (ATOMIC_READ(&pchsw_info->chsw_on) == _TRUE) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_TO_OFF_CHNL); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_TO_OFF_CHNL); } exit: @@ -2556,6 +2705,7 @@ void wfd_ie_tdls(_adapter *padapter, u8 *pframe, u32 *pktlen) struct wifi_display_info *pwfd_info = padapter->tdlsinfo.wfd_info; u8 wfdie[MAX_WFD_IE_LEN] = { 0x00 }; u32 wfdielen = 0; + u16 v16 = 0; if (!hal_chk_wl_func(padapter, WL_FUNC_MIRACAST)) return; @@ -2587,8 +2737,9 @@ void wfd_ie_tdls(_adapter *padapter, u8 *pframe, u32 *pktlen) /* Value1: */ /* WFD device information */ /* available for WFD session + Preferred TDLS + WSD ( WFD Service Discovery ) */ - RTW_PUT_BE16(wfdie + wfdielen, pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL - | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD); + v16 = pwfd_info->wfd_device_type | WFD_DEVINFO_SESSION_AVAIL + | WFD_DEVINFO_PC_TDLS | WFD_DEVINFO_WSD; + RTW_PUT_BE16(wfdie + wfdielen, v16); wfdielen += 2; /* Value2: */ @@ -2640,13 +2791,12 @@ void wfd_ie_tdls(_adapter *padapter, u8 *pframe, u32 *pktlen) } #endif /* CONFIG_WFD */ -void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct pkt_attrib *pattrib = &pxmitframe->attrib; - struct sta_info *ptdls_sta = rtw_get_stainfo((&padapter->stapriv) , pattrib->dst); - int i = 0 ; u32 time; u8 *pframe_head; @@ -2668,7 +2818,7 @@ void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitfr pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); - pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); + pframe = rtw_tdls_set_sup_ch(padapter, pframe, pattrib); pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); if (pattrib->encrypt) @@ -2703,7 +2853,7 @@ void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitfr if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14) && REGSTY_IS_11AC_ENABLE(pregistrypriv) && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) - && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) ) { pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); @@ -2717,23 +2867,18 @@ void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitfr } -void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct pkt_attrib *pattrib = &pxmitframe->attrib; - struct sta_info *ptdls_sta; u8 k; /* for random ANonce */ u8 *pftie = NULL, *ptimeout_ie = NULL, *plinkid_ie = NULL, *prsnie = NULL, *pftie_mic = NULL; u32 time; u8 *pframe_head; - ptdls_sta = rtw_get_stainfo(&(padapter->stapriv) , pattrib->dst); - - if (ptdls_sta == NULL) - RTW_INFO("[%s] %d ptdls_sta is NULL\n", __FUNCTION__, __LINE__); - - if (pattrib->encrypt && ptdls_sta != NULL) { + if (pattrib->encrypt) { for (k = 0; k < 8; k++) { time = rtw_get_current_time(); _rtw_memcpy(&ptdls_sta->ANonce[4 * k], (u8 *)&time, 4); @@ -2755,7 +2900,7 @@ void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfr pframe = rtw_tdls_set_dialog(pframe, pattrib, ptxmgmt); pframe = rtw_tdls_set_capability(padapter, pframe, pattrib); pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); - pframe = rtw_tdls_set_sup_ch(&(padapter->mlmeextpriv), pframe, pattrib); + pframe = rtw_tdls_set_sup_ch(padapter, pframe, pattrib); pframe = rtw_tdls_set_sup_reg_class(pframe, pattrib); if (pattrib->encrypt) { @@ -2803,7 +2948,7 @@ void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfr if ((padapter->mlmepriv.htpriv.ht_option == _TRUE) && (pmlmeext->cur_channel > 14) && REGSTY_IS_11AC_ENABLE(pregistrypriv) && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) - && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) ) { pframe = rtw_tdls_set_aid(padapter, pframe, pattrib); pframe = rtw_tdls_set_vht_cap(padapter, pframe, pattrib); @@ -2818,13 +2963,13 @@ void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfr } -void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct pkt_attrib *pattrib = &pxmitframe->attrib; - struct sta_info *ptdls_sta = rtw_get_stainfo((&padapter->stapriv) , pattrib->dst); unsigned int ie_len; unsigned char *p; @@ -2880,7 +3025,7 @@ void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitfr && (ptdls_sta->vhtpriv.vht_option == _TRUE) && (pmlmeext->cur_channel > 14) && REGSTY_IS_11AC_ENABLE(pregistrypriv) && hal_chk_proto_cap(padapter, PROTO_CAP_11AC) - && (!padapter->mlmepriv.country_ent || COUNTRY_CHPLAN_EN_11AC(padapter->mlmepriv.country_ent)) + && (!rfctl->country_ent || COUNTRY_CHPLAN_EN_11AC(rfctl->country_ent)) ) { pframe = rtw_tdls_set_vht_operation(padapter, pframe, pattrib, pmlmeext->cur_channel); pframe = rtw_tdls_set_vht_op_mode_notify(padapter, pframe, pattrib, pmlmeext->cur_bwmode); @@ -2888,10 +3033,9 @@ void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitfr #endif } -void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { struct pkt_attrib *pattrib = &pxmitframe->attrib; - struct sta_info *ptdls_sta = rtw_get_stainfo(&(padapter->stapriv) , pattrib->dst); u8 *pftie = NULL, *pftie_mic = NULL, *plinkid_ie = NULL; pframe = rtw_tdls_set_payload_type(pframe, pattrib); @@ -2948,7 +3092,7 @@ void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfram pframe = rtw_tdls_set_supported_rate(padapter, pframe, pattrib); - pframe = rtw_tdls_set_sup_ch(pmlmeext, pframe, pattrib); + pframe = rtw_tdls_set_sup_ch(padapter, pframe, pattrib); if (privacy) pframe = rtw_tdls_set_rsnie(ptxmgmt, pframe, pattrib, _TRUE, NULL); @@ -2971,12 +3115,11 @@ void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitfram } -void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { struct pkt_attrib *pattrib = &pxmitframe->attrib; u8 AC_queue = 0; - struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); pframe = rtw_tdls_set_payload_type(pframe, pattrib); pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); @@ -3002,11 +3145,10 @@ void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_ } -void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { struct pkt_attrib *pattrib = &pxmitframe->attrib; - struct sta_info *ptdls_sta = rtw_get_stainfo(&padapter->stapriv, pattrib->dst); pframe = rtw_tdls_set_payload_type(pframe, pattrib); pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); @@ -3020,12 +3162,11 @@ void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame * } #ifdef CONFIG_TDLS_CH_SW -void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; struct pkt_attrib *pattrib = &pxmitframe->attrib; struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); u16 switch_time = TDLS_CH_SWITCH_TIME * 1000, switch_timeout = TDLS_CH_SWITCH_TIMEOUT * 1000; ptdls_sta->ch_switch_time = switch_time; @@ -3057,12 +3198,11 @@ void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxm } -void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) +void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta) { struct pkt_attrib *pattrib = &pxmitframe->attrib; struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *ptdls_sta = rtw_get_stainfo(pstapriv, pattrib->dst); pframe = rtw_tdls_set_payload_type(pframe, pattrib); pframe = rtw_tdls_set_category(pframe, pattrib, RTW_WLAN_CATEGORY_TDLS); @@ -3151,9 +3291,10 @@ void _tdls_tpk_timer_hdl(void *FunctionContext) /* TPK_timer expired in a second */ /* Retry timer should set at least 301 sec. */ if (ptdls_sta->TPK_count >= (ptdls_sta->TDLS_PeerKey_Lifetime - 3)) { - RTW_INFO("[TDLS] %s, Re-Setup TDLS link with "MAC_FMT" since TPK lifetime expires!\n", __FUNCTION__, MAC_ARG(ptdls_sta->hwaddr)); + RTW_INFO("[TDLS] %s, Re-Setup TDLS link with "MAC_FMT" since TPK lifetime expires!\n", + __FUNCTION__, MAC_ARG(ptdls_sta->cmn.mac_addr)); ptdls_sta->TPK_count = 0; - _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); issue_tdls_setup_req(ptdls_sta->padapter, &txmgmt, _FALSE); } @@ -3167,7 +3308,7 @@ void _tdls_ch_switch_timer_hdl(void *FunctionContext) _adapter *padapter = ptdls_sta->padapter; struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_END_TO_BASE_CHNL); RTW_INFO("[TDLS] %s, can't get traffic from op_ch:%d\n", __func__, rtw_get_oper_ch(padapter)); } @@ -3199,7 +3340,7 @@ void _tdls_ch_switch_monitor_timer_hdl(void *FunctionContext) _adapter *padapter = ptdls_sta->padapter; struct tdls_ch_switch *pchsw_info = &padapter->tdlsinfo.chsw_info; - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_END); RTW_INFO("[TDLS] %s, does not receive ch sw req\n", __func__); } @@ -3208,36 +3349,40 @@ void _tdls_ch_switch_monitor_timer_hdl(void *FunctionContext) void _tdls_handshake_timer_hdl(void *FunctionContext) { struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; - _adapter *padapter = ptdls_sta->padapter; + _adapter *padapter = NULL; struct tdls_txmgmt txmgmt; _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); - _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; if (ptdls_sta != NULL) { + padapter = ptdls_sta->padapter; + RTW_INFO("[TDLS] Handshake time out\n"); if (ptdls_sta->tdls_sta_state & TDLS_LINKED_STATE) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA); else - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_TEARDOWN_STA_LOCALLY); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_TEARDOWN_STA_LOCALLY); } } void _tdls_pti_timer_hdl(void *FunctionContext) { struct sta_info *ptdls_sta = (struct sta_info *)FunctionContext; - _adapter *padapter = ptdls_sta->padapter; + _adapter *padapter = NULL; struct tdls_txmgmt txmgmt; _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); - _rtw_memcpy(txmgmt.peer, ptdls_sta->hwaddr, ETH_ALEN); + _rtw_memcpy(txmgmt.peer, ptdls_sta->cmn.mac_addr, ETH_ALEN); txmgmt.status_code = _RSON_TDLS_TEAR_TOOFAR_; if (ptdls_sta != NULL) { + padapter = ptdls_sta->padapter; + if (ptdls_sta->tdls_sta_state & TDLS_WAIT_PTR_STATE) { RTW_INFO("[TDLS] Doesn't receive PTR from peer dev:"MAC_FMT"; " - "Send TDLS Tear Down\n", MAC_ARG(ptdls_sta->hwaddr)); + "Send TDLS Tear Down\n", MAC_ARG(ptdls_sta->cmn.mac_addr)); issue_tdls_teardown(padapter, &txmgmt, _FALSE); } } @@ -3246,15 +3391,15 @@ void _tdls_pti_timer_hdl(void *FunctionContext) void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta) { psta->padapter = padapter; - _init_timer(&psta->TPK_timer, padapter->pnetdev, _tdls_tpk_timer_hdl, psta); + rtw_init_timer(&psta->TPK_timer, padapter, _tdls_tpk_timer_hdl, psta); #ifdef CONFIG_TDLS_CH_SW - _init_timer(&psta->ch_sw_timer, padapter->pnetdev, _tdls_ch_switch_timer_hdl, psta); - _init_timer(&psta->delay_timer, padapter->pnetdev, _tdls_delay_timer_hdl, psta); - _init_timer(&psta->stay_on_base_chnl_timer, padapter->pnetdev, _tdls_stay_on_base_chnl_timer_hdl, psta); - _init_timer(&psta->ch_sw_monitor_timer, padapter->pnetdev, _tdls_ch_switch_monitor_timer_hdl, psta); + rtw_init_timer(&psta->ch_sw_timer, padapter, _tdls_ch_switch_timer_hdl, psta); + rtw_init_timer(&psta->delay_timer, padapter, _tdls_delay_timer_hdl, psta); + rtw_init_timer(&psta->stay_on_base_chnl_timer, padapter, _tdls_stay_on_base_chnl_timer_hdl, psta); + rtw_init_timer(&psta->ch_sw_monitor_timer, padapter, _tdls_ch_switch_monitor_timer_hdl, psta); #endif - _init_timer(&psta->handshake_timer, padapter->pnetdev, _tdls_handshake_timer_hdl, psta); - _init_timer(&psta->pti_timer, padapter->pnetdev, _tdls_pti_timer_hdl, psta); + rtw_init_timer(&psta->handshake_timer, padapter, _tdls_handshake_timer_hdl, psta); + rtw_init_timer(&psta->pti_timer, padapter, _tdls_pti_timer_hdl, psta); } void rtw_free_tdls_timer(struct sta_info *psta) @@ -3270,36 +3415,6 @@ void rtw_free_tdls_timer(struct sta_info *psta) _cancel_timer_ex(&psta->pti_timer); } -u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta) -{ - unsigned char sta_band = 0; - unsigned int tx_ra_bitmap = 0; - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - WLAN_BSSID_EX *pcur_network = (WLAN_BSSID_EX *)&pmlmepriv->cur_network.network; - - rtw_hal_update_sta_rate_mask(padapter, psta); - tx_ra_bitmap = psta->ra_mask; - - if (pcur_network->Configuration.DSConfig > 14) { - if (tx_ra_bitmap & 0xffff000) - sta_band |= WIRELESS_11_5N | WIRELESS_11A; - else - sta_band |= WIRELESS_11A; - } else { - if (tx_ra_bitmap & 0xffff000) - sta_band |= WIRELESS_11_24N | WIRELESS_11G | WIRELESS_11B; - else if (tx_ra_bitmap & 0xff0) - sta_band |= WIRELESS_11G | WIRELESS_11B; - else - sta_band |= WIRELESS_11B; - } - - psta->wireless_mode = sta_band; - - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); - tx_ra_bitmap |= ((psta->raid << 28) & 0xf0000000); - return tx_ra_bitmap; -} int rtw_tdls_is_driver_setup(_adapter *padapter) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_vht.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_vht.c index 496a300faae4..372042e005c9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_vht.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_vht.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,15 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_VHT_C #include +#include #ifdef CONFIG_80211AC_VHT /* 20/40/80, ShortGI, MCS Rate */ @@ -101,7 +97,7 @@ u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map) return nss; } -void rtw_vht_nss_to_mcsmap(u8 nss, u8 *target_mcs_map, u8 *cur_mcs_map) +void rtw_vht_nss_to_mcsmap(u8 nss, u8 *target_mcs_map, u8 *cur_mcs_map) { u8 i, j; u8 cur_rate, target_rate; @@ -143,6 +139,8 @@ void rtw_vht_use_default_setting(_adapter *padapter) u8 mu_bfer, mu_bfee; #endif /* CONFIG_BEAMFORMING */ u8 rf_type = 0; + u8 tx_nss, rx_nss; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); pvhtpriv->sgi_80m = TEST_FLAG(pregistrypriv->short_gi, BIT2) ? _TRUE : _FALSE; @@ -224,119 +222,53 @@ void rtw_vht_use_default_setting(_adapter *padapter) pvhtpriv->ampdu_len = pregistrypriv->ampdu_factor; rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + tx_nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); + rx_nss = rtw_min(rf_type_to_rf_rx_cnt(rf_type), hal_spec->rx_nss_num); - if (rf_type == RF_3T3R) - pvhtpriv->vht_mcs_map[0] = 0xea; /* support 1SS MCS 0~9 2SS MCS 0~9 3SS MCS 0~9 */ - else if (rf_type == RF_2T2R) - pvhtpriv->vht_mcs_map[0] = 0xfa; /* support 1SS MCS 0~9 2SS MCS 0~9 */ - else - pvhtpriv->vht_mcs_map[0] = 0xfe; /* Only support 1SS MCS 0~9; */ - pvhtpriv->vht_mcs_map[1] = 0xff; - - if (pregistrypriv->vht_rate_sel == 1) { - pvhtpriv->vht_mcs_map[0] = 0xfc; /* support 1SS MCS 0~7 */ - } else if (pregistrypriv->vht_rate_sel == 2) { - pvhtpriv->vht_mcs_map[0] = 0xfd; /* Support 1SS MCS 0~8 */ - } else if (pregistrypriv->vht_rate_sel == 3) { - pvhtpriv->vht_mcs_map[0] = 0xfe; /* Support 1SS MCS 0~9 */ - } else if (pregistrypriv->vht_rate_sel == 4) { - pvhtpriv->vht_mcs_map[0] = 0xf0; /* support 1SS MCS 0~7 2SS MCS 0~7 */ - } else if (pregistrypriv->vht_rate_sel == 5) { - pvhtpriv->vht_mcs_map[0] = 0xf5; /* support 1SS MCS 0~8 2SS MCS 0~8 */ - } else if (pregistrypriv->vht_rate_sel == 6) { - pvhtpriv->vht_mcs_map[0] = 0xfa; /* support 1SS MCS 0~9 2SS MCS 0~9 */ - } else if (pregistrypriv->vht_rate_sel == 7) { - pvhtpriv->vht_mcs_map[0] = 0xf8; /* support 1SS MCS 0-7 2SS MCS 0~9 */ - } else if (pregistrypriv->vht_rate_sel == 8) { - pvhtpriv->vht_mcs_map[0] = 0xf9; /* support 1SS MCS 0-8 2SS MCS 0~9 */ - } else if (pregistrypriv->vht_rate_sel == 9) { - pvhtpriv->vht_mcs_map[0] = 0xf4; /* support 1SS MCS 0-7 2SS MCS 0~8 */ - } - + /* for now, vhtpriv.vht_mcs_map comes from RX NSS */ + rtw_vht_nss_to_mcsmap(rx_nss, pvhtpriv->vht_mcs_map, pregistrypriv->vht_rx_mcs_map); pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); } -u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate) +u64 rtw_vht_mcs_map_to_bitmap(u8 *mcs_map, u8 nss) { + u8 i, j, tmp; + u64 bitmap = 0; + u8 bits_nss = nss * 2; - u8 i, j , tmpRate; - u64 RateBitmap = 0; - u8 Bits_3ss = 6; - - for (i = j = 0; i < Bits_3ss; i += 2, j += 10) { + for (i = j = 0; i < bits_nss; i += 2, j += 10) { /* every two bits means single sptial stream */ - tmpRate = (pVHTRate[0] >> i) & 3; + tmp = (mcs_map[i / 8] >> i) & 3; - switch (tmpRate) { + switch (tmp) { case 2: - RateBitmap = RateBitmap | (0x03ff << j); + bitmap = bitmap | (0x03ff << j); break; case 1: - RateBitmap = RateBitmap | (0x01ff << j); + bitmap = bitmap | (0x01ff << j); break; - case 0: - RateBitmap = RateBitmap | (0x00ff << j); + bitmap = bitmap | (0x00ff << j); break; - default: break; } } - RTW_INFO("RateBitmap=%016llx , pVHTRate[0]=%02x, pVHTRate[1]=%02x\n", RateBitmap, pVHTRate[0], pVHTRate[1]); - return RateBitmap; + + RTW_INFO("vht_mcs_map=%02x %02x, nss=%u => bitmap=%016llx\n" + , mcs_map[0], mcs_map[1], nss, bitmap); + + return bitmap; } -void update_sta_vht_info_apmode(_adapter *padapter, PVOID sta) +#ifdef CONFIG_BEAMFORMING +void update_sta_vht_info_apmode_bf_cap(_adapter *padapter, struct sta_info *psta) { - struct sta_info *psta = (struct sta_info *)sta; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; struct vht_priv *pvhtpriv_sta = &psta->vhtpriv; - struct ht_priv *phtpriv_sta = &psta->htpriv; - u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, bw_mode = 0; u16 cur_beamform_cap = 0; - u8 *pcap_mcs; - if (pvhtpriv_sta->vht_option == _FALSE) - return; - - bw_mode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&pvhtpriv_sta->vht_op_mode_notify); - - /* if (bw_mode > psta->bw_mode) */ - psta->bw_mode = bw_mode; - - /* B4 Rx LDPC */ - if (TEST_FLAG(pvhtpriv_ap->ldpc_cap, LDPC_VHT_ENABLE_TX) && - GET_VHT_CAPABILITY_ELE_RX_LDPC(pvhtpriv_sta->vht_cap)) { - SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); - RTW_INFO("Current STA(%d) VHT LDPC = %02X\n", psta->aid, cur_ldpc_cap); - } - pvhtpriv_sta->ldpc_cap = cur_ldpc_cap; - - if (psta->bw_mode > pmlmeext->cur_bwmode) - psta->bw_mode = pmlmeext->cur_bwmode; - - if (psta->bw_mode == CHANNEL_WIDTH_80) { - /* B5 Short GI for 80 MHz */ - pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; - /* RTW_INFO("Current STA ShortGI80MHz = %d\n", pvhtpriv_sta->sgi_80m); */ - } else if (psta->bw_mode >= CHANNEL_WIDTH_160) { - /* B5 Short GI for 80 MHz */ - pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; - /* RTW_INFO("Current STA ShortGI160MHz = %d\n", pvhtpriv_sta->sgi_80m); */ - } - - /* B8 B9 B10 Rx STBC */ - if (TEST_FLAG(pvhtpriv_ap->stbc_cap, STBC_VHT_ENABLE_TX) && - GET_VHT_CAPABILITY_ELE_RX_STBC(pvhtpriv_sta->vht_cap)) { - SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); - RTW_INFO("Current STA(%d) VHT STBC = %02X\n", psta->aid, cur_stbc_cap); - } - pvhtpriv_sta->stbc_cap = cur_stbc_cap; - -#ifdef CONFIG_BEAMFORMING /* B11 SU Beamformer Capable, the target supports Beamformer and we are Beamformee */ if (TEST_FLAG(pvhtpriv_ap->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE) && GET_VHT_CAPABILITY_ELE_SU_BFEE(pvhtpriv_sta->vht_cap)) { @@ -352,9 +284,65 @@ void update_sta_vht_info_apmode(_adapter *padapter, PVOID sta) /*Shit to BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM*/ SET_FLAG(cur_beamform_cap, GET_VHT_CAPABILITY_ELE_SU_BFER_SOUND_DIM_NUM(pvhtpriv_sta->vht_cap) << 12); } - pvhtpriv_sta->beamform_cap = cur_beamform_cap; + if (cur_beamform_cap) - RTW_INFO("Current STA(%d) VHT Beamforming Setting = %02X\n", psta->aid, cur_beamform_cap); + RTW_INFO("Current STA(%d) VHT Beamforming Setting = %02X\n", psta->cmn.aid, cur_beamform_cap); + + pvhtpriv_sta->beamform_cap = cur_beamform_cap; + psta->cmn.bf_info.vht_beamform_cap = cur_beamform_cap; +} +#endif + +void update_sta_vht_info_apmode(_adapter *padapter, PVOID sta) +{ + struct sta_info *psta = (struct sta_info *)sta; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; + struct vht_priv *pvhtpriv_sta = &psta->vhtpriv; + u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, bw_mode = 0; + u8 *pcap_mcs; + + if (pvhtpriv_sta->vht_option == _FALSE) + return; + + bw_mode = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&pvhtpriv_sta->vht_op_mode_notify); + + /* if (bw_mode > psta->cmn.bw_mode) */ + psta->cmn.bw_mode = bw_mode; + psta->cmn.ra_info.is_vht_enable = _TRUE; + + /* B4 Rx LDPC */ + if (TEST_FLAG(pvhtpriv_ap->ldpc_cap, LDPC_VHT_ENABLE_TX) && + GET_VHT_CAPABILITY_ELE_RX_LDPC(pvhtpriv_sta->vht_cap)) { + SET_FLAG(cur_ldpc_cap, (LDPC_VHT_ENABLE_TX | LDPC_VHT_CAP_TX)); + RTW_INFO("Current STA(%d) VHT LDPC = %02X\n", psta->cmn.aid, cur_ldpc_cap); + } + pvhtpriv_sta->ldpc_cap = cur_ldpc_cap; + + if (psta->cmn.bw_mode > pmlmeext->cur_bwmode) + psta->cmn.bw_mode = pmlmeext->cur_bwmode; + + if (psta->cmn.bw_mode == CHANNEL_WIDTH_80) { + /* B5 Short GI for 80 MHz */ + pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI80M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; + /* RTW_INFO("Current STA ShortGI80MHz = %d\n", pvhtpriv_sta->sgi_80m); */ + } else if (psta->cmn.bw_mode >= CHANNEL_WIDTH_160) { + /* B5 Short GI for 80 MHz */ + pvhtpriv_sta->sgi_80m = (GET_VHT_CAPABILITY_ELE_SHORT_GI160M(pvhtpriv_sta->vht_cap) & pvhtpriv_ap->sgi_80m) ? _TRUE : _FALSE; + /* RTW_INFO("Current STA ShortGI160MHz = %d\n", pvhtpriv_sta->sgi_80m); */ + } + + /* B8 B9 B10 Rx STBC */ + if (TEST_FLAG(pvhtpriv_ap->stbc_cap, STBC_VHT_ENABLE_TX) && + GET_VHT_CAPABILITY_ELE_RX_STBC(pvhtpriv_sta->vht_cap)) { + SET_FLAG(cur_stbc_cap, (STBC_VHT_ENABLE_TX | STBC_VHT_CAP_TX)); + RTW_INFO("Current STA(%d) VHT STBC = %02X\n", psta->cmn.aid, cur_stbc_cap); + } + pvhtpriv_sta->stbc_cap = cur_stbc_cap; + +#ifdef CONFIG_BEAMFORMING + update_sta_vht_info_apmode_bf_cap(padapter, psta); #endif /* B23 B24 B25 Maximum A-MPDU Length Exponent */ @@ -362,9 +350,7 @@ void update_sta_vht_info_apmode(_adapter *padapter, PVOID sta) pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pvhtpriv_sta->vht_cap); _rtw_memcpy(pvhtpriv_sta->vht_mcs_map, pcap_mcs, 2); - pvhtpriv_sta->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv_sta->vht_mcs_map); - } void update_hw_vht_param(_adapter *padapter) @@ -383,14 +369,14 @@ void update_hw_vht_param(_adapter *padapter) void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) { + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, rf_type = RF_1T1R; + u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, rf_type = RF_1T1R, tx_nss = 0; u16 cur_beamform_cap = 0; u8 *pcap_mcs; - u8 vht_mcs[2]; if (pIE == NULL) return; @@ -489,18 +475,9 @@ void VHT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) pvhtpriv->ampdu_len = GET_VHT_CAPABILITY_ELE_MAX_RXAMPDU_FACTOR(pIE->data); pcap_mcs = GET_VHT_CAPABILITY_ELE_RX_MCS(pIE->data); - _rtw_memcpy(vht_mcs, pcap_mcs, 2); - rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - if ((rf_type == RF_1T1R) || (rf_type == RF_1T2R)) - vht_mcs[0] |= 0xfc; - else if (rf_type == RF_2T2R) - vht_mcs[0] |= 0xf0; - else if (rf_type == RF_3T3R) - vht_mcs[0] |= 0xc0; - - _rtw_memcpy(pvhtpriv->vht_mcs_map, vht_mcs, 2); - + tx_nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); + rtw_vht_nss_to_mcsmap(tx_nss, pvhtpriv->vht_mcs_map, pcap_mcs); pvhtpriv->vht_highest_rate = rtw_get_vht_highest_rate(pvhtpriv->vht_mcs_map); } @@ -526,7 +503,6 @@ void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta) u8 target_bw; u8 target_rxss, current_rxss; u8 update_ra = _FALSE; - u8 vht_mcs_map[2] = {}; if (pvhtpriv->vht_option == _FALSE) return; @@ -534,23 +510,25 @@ void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta) target_bw = GET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(pframe); target_rxss = (GET_VHT_OPERATING_MODE_FIELD_RX_NSS(pframe) + 1); - if (target_bw != psta->bw_mode) { + if (target_bw != psta->cmn.bw_mode) { if (hal_is_bw_support(padapter, target_bw) && REGSTY_IS_BW_5G_SUPPORT(regsty, target_bw) ) { update_ra = _TRUE; - psta->bw_mode = target_bw; + psta->cmn.bw_mode = target_bw; } } current_rxss = rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map); if (target_rxss != current_rxss) { + u8 vht_mcs_map[2] = {}; + update_ra = _TRUE; rtw_vht_nss_to_mcsmap(target_rxss, vht_mcs_map, psta->vhtpriv.vht_mcs_map); _rtw_memcpy(psta->vhtpriv.vht_mcs_map, vht_mcs_map, 2); - rtw_hal_update_sta_rate_mask(padapter, psta); + rtw_hal_update_sta_ra_info(padapter, psta); } if (update_ra) @@ -563,12 +541,10 @@ u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; /* struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; */ - u8 ChnlWidth, center_freq, bw_mode, rf_type = 0; + u8 ChnlWidth, center_freq, bw_mode; u32 len = 0; u8 operation[5]; - rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - _rtw_memset(operation, 0, 5); bw_mode = REGSTY_BW_5G(pregistrypriv); /* TODO: control op bw with other info */ @@ -589,34 +565,7 @@ u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel) SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ1(operation, center_freq);/* Todo: need to set correct center channel */ SET_VHT_OPERATION_ELE_CHL_CENTER_FREQ2(operation, 0); - if (padapter->registrypriv.rf_config != RF_MAX_TYPE) - rf_type = padapter->registrypriv.rf_config; - - switch (rf_type) { - case RF_1T1R: - operation[3] = 0xfe; - operation[4] = 0xff; - break; - case RF_1T2R: - case RF_2T2R: - case RF_2T2R_GREEN: - operation[3] = 0xfa; - operation[4] = 0xff; - break; - case RF_2T3R: - case RF_2T4R: - case RF_3T3R: - case RF_3T4R: - operation[3] = 0xea; - operation[4] = 0xff; - break; - case RF_4T4R: - operation[3] = 0xaa; - operation[4] = 0xff; - break; - default: - RTW_INFO("%s, %d, unknown rf type\n", __func__, __LINE__); - } + _rtw_memcpy(operation + 3, pvhtpriv->vht_mcs_map, 2); rtw_set_ie(pbuf, EID_VHTOperation, 5, operation, &len); @@ -629,18 +578,11 @@ u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; u32 len = 0; - u8 opmode = 0, rf_type = 0; + u8 opmode = 0; u8 chnl_width, rx_nss; chnl_width = bw; - - rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - if (rf_type == RF_3T3R) - rx_nss = 3; - else if (rf_type == RF_2T2R) - rx_nss = 2; - else - rx_nss = 1; + rx_nss = rtw_vht_mcsmap_to_nss(pvhtpriv->vht_mcs_map); SET_VHT_OPERATING_MODE_FIELD_CHNL_WIDTH(&opmode, chnl_width); SET_VHT_OPERATING_MODE_FIELD_RX_NSS(&opmode, (rx_nss - 1)); @@ -663,6 +605,8 @@ u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct vht_priv *pvhtpriv = &pmlmepriv->vhtpriv; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); pcap = pvhtpriv->vht_cap; _rtw_memset(pcap, 0, 32); @@ -695,47 +639,68 @@ u32 rtw_build_vht_cap_ie(_adapter *padapter, u8 *pbuf) SET_VHT_CAPABILITY_ELE_CHL_WIDTH(pcap, 0); /* B4 Rx LDPC */ - if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX)) + if (TEST_FLAG(pvhtpriv->ldpc_cap, LDPC_VHT_ENABLE_RX)) { SET_VHT_CAPABILITY_ELE_RX_LDPC(pcap, 1); + RTW_INFO("[VHT] Declare supporting RX LDPC\n"); + } /* B5 ShortGI for 80MHz */ SET_VHT_CAPABILITY_ELE_SHORT_GI80M(pcap, pvhtpriv->sgi_80m ? 1 : 0); /* We can receive Short GI of 80M */ + if (pvhtpriv->sgi_80m) + RTW_INFO("[VHT] Declare supporting SGI 80MHz\n"); /* B6 ShortGI for 160MHz */ /* SET_VHT_CAPABILITY_ELE_SHORT_GI160M(pcap, pvhtpriv->sgi_80m? 1 : 0); */ /* B7 Tx STBC */ - if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) + if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_TX)) { SET_VHT_CAPABILITY_ELE_TX_STBC(pcap, 1); + RTW_INFO("[VHT] Declare supporting TX STBC\n"); + } /* B8 B9 B10 Rx STBC */ if (TEST_FLAG(pvhtpriv->stbc_cap, STBC_VHT_ENABLE_RX)) { rtw_hal_get_def_var(padapter, HAL_DEF_RX_STBC, (u8 *)(&rx_stbc_nss)); SET_VHT_CAPABILITY_ELE_RX_STBC(pcap, rx_stbc_nss); + RTW_INFO("[VHT] Declare supporting RX STBC = %d\n", rx_stbc_nss); } - + #ifdef CONFIG_BEAMFORMING /* B11 SU Beamformer Capable */ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { SET_VHT_CAPABILITY_ELE_SU_BFER(pcap, 1); + RTW_INFO("[VHT] Declare supporting SU Bfer\n"); /* B16 17 18 Number of Sounding Dimensions */ rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMER_CAP, (u8 *)&rf_num); SET_VHT_CAPABILITY_ELE_SOUNDING_DIMENSIONS(pcap, rf_num); /* B19 MU Beamformer Capable */ - if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) + if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { SET_VHT_CAPABILITY_ELE_MU_BFER(pcap, 1); + RTW_INFO("[VHT] Declare supporting MU Bfer\n"); + } } /* B12 SU Beamformee Capable */ if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { SET_VHT_CAPABILITY_ELE_SU_BFEE(pcap, 1); - /* B13 14 15 Compressed Steering Number of Beamformer Antennas Supported */ + RTW_INFO("[VHT] Declare supporting SU Bfee\n"); + rtw_hal_get_def_var(padapter, HAL_DEF_BEAMFORMEE_CAP, (u8 *)&rf_num); + + /* IOT action suggested by Yu Chen 2017/3/3 */ + if ((pmlmeinfo->assoc_AP_vendor == HT_IOT_PEER_BROADCOM) && + !GET_VHT_CAPABILITY_ELE_MU_BFER(&pvhtpriv->beamform_cap)) + rf_num = (rf_num >= 2 ? 2 : rf_num); + + /* B13 14 15 Compressed Steering Number of Beamformer Antennas Supported */ SET_VHT_CAPABILITY_ELE_BFER_ANT_SUPP(pcap, rf_num); /* B20 SU Beamformee Capable */ - if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) + if (TEST_FLAG(pvhtpriv->beamform_cap, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE)) { SET_VHT_CAPABILITY_ELE_MU_BFEE(pcap, 1); + RTW_INFO("[VHT] Declare supporting MU Bfee\n"); + } } + #endif/*CONFIG_BEAMFORMING*/ /* B21 VHT TXOP PS */ SET_VHT_CAPABILITY_ELE_TXOP_PS(pcap, 0); @@ -854,4 +819,48 @@ void VHTOnAssocRsp(_adapter *padapter) rtw_hal_set_hwreg(padapter, HW_VAR_AMPDU_MAX_TIME, (u8 *)(&pvhtpriv->vht_highest_rate)); } +void rtw_vht_ies_attach(_adapter *padapter, WLAN_BSSID_EX *pnetwork) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + u8 cap_len, operation_len; + uint len = 0; + sint ie_len = 0; + u8 *p = NULL; + + p = rtw_get_ie(pnetwork->IEs + _BEACON_IE_OFFSET_, EID_VHTCapability, &ie_len, + (pnetwork->IELength - _BEACON_IE_OFFSET_)); + if (p && ie_len > 0) + return; + + rtw_vht_use_default_setting(padapter); + + /* VHT Operation mode notifiy bit in Extended IE (127) */ + SET_EXT_CAPABILITY_ELE_OP_MODE_NOTIF(pmlmepriv->ext_capab_ie_data, 1); + pmlmepriv->ext_capab_ie_len = 10; + rtw_set_ie(pnetwork->IEs + pnetwork->IELength, EID_EXTCapability, 8, pmlmepriv->ext_capab_ie_data, &len); + pnetwork->IELength += pmlmepriv->ext_capab_ie_len; + + /* VHT Capabilities element */ + cap_len = rtw_build_vht_cap_ie(padapter, pnetwork->IEs + pnetwork->IELength); + pnetwork->IELength += cap_len; + + /* VHT Operation element */ + operation_len = rtw_build_vht_operation_ie(padapter, pnetwork->IEs + pnetwork->IELength, + pnetwork->Configuration.DSConfig); + pnetwork->IELength += operation_len; + + pmlmepriv->vhtpriv.vht_option = _TRUE; +} + +void rtw_vht_ies_detach(_adapter *padapter, WLAN_BSSID_EX *pnetwork) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + + rtw_remove_bcn_ie(padapter, pnetwork, EID_EXTCapability); + rtw_remove_bcn_ie(padapter, pnetwork, EID_VHTCapability); + rtw_remove_bcn_ie(padapter, pnetwork, EID_VHTOperation); + + pmlmepriv->vhtpriv.vht_option = _FALSE; +} + #endif /* CONFIG_80211AC_VHT */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi.c index 5b84f77579e2..d8dcefcb20ab 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifdef CONFIG_WAPI_SUPPORT #include @@ -368,7 +382,7 @@ u8 rtw_wapi_is_wai_packet(_adapter *padapter, u8 *pkt_data) return 0; } - pTaddr = GetAddr2Ptr(pkt_data); + pTaddr = get_addr2_ptr(pkt_data); if (list_empty(&pWapiInfo->wapiSTAUsedList)) bFind = false; else { @@ -423,7 +437,7 @@ void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame) else precv_hdr->UserPriority = 0; - pTA = GetAddr2Ptr(ptr); + pTA = get_addr2_ptr(ptr); _rtw_memcpy((u8 *)precv_hdr->WapiSrcAddr, pTA, 6); pRecvPN = ptr + precv_hdr->attrib.hdrlen + 2; _rtw_memcpy((u8 *)precv_hdr->WapiTempPN, pRecvPN, 16); @@ -438,7 +452,8 @@ add to support WAPI to N-mode *****************************************************************************/ u8 rtw_wapi_check_for_drop( _adapter *padapter, - union recv_frame *precv_frame + union recv_frame *precv_frame, + u8 *ehdr_ops ) { PRT_WAPI_T pWapiInfo = &(padapter->wapiInfo); @@ -449,7 +464,7 @@ u8 rtw_wapi_check_for_drop( struct recv_frame_hdr *precv_hdr = &precv_frame->u.hdr; u8 WapiAEPNInitialValueSrc[16] = {0x37, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; u8 WapiAEMultiCastPNInitialValueSrc[16] = {0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C, 0x36, 0x5C} ; - u8 *ptr = precv_frame->u.hdr.rx_data; + u8 *ptr = ehdr_ops; int i; WAPI_TRACE(WAPI_RX, "===========> %s\n", __FUNCTION__); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi_sms4.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi_sms4.c index fc01212ecfe3..4b7cf957c8f2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi_sms4.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wapi_sms4.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifdef CONFIG_WAPI_SUPPORT #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wlan_util.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wlan_util.c index be671d07e863..be223fd99927 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wlan_util.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_wlan_util.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,21 +11,19 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_WLAN_UTIL_C_ #include +#include #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) #include #define ETH_TYPE_OFFSET 12 #define PROTOCOL_OFFSET 23 #define IP_OFFSET 30 + #define IPv6_OFFSET 38 + #define IPv6_PROTOCOL_OFFSET 20 #endif unsigned char ARTHEROS_OUI1[] = {0x00, 0x03, 0x7f}; @@ -103,217 +101,64 @@ int cckratesonly_included(unsigned char *rate, int ratelen) return _TRUE; } -#ifdef CONFIG_GET_RAID_BY_DRV -s8 rtw_get_tx_nss(_adapter *adapter, struct sta_info *psta) +s8 rtw_get_sta_rx_nss(_adapter *adapter, struct sta_info *psta) { - u8 rf_type = RF_1T1R, custom_rf_type, vht_mcs[2]; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + u8 rf_type = RF_1T1R, custom_rf_type; s8 nss = 1; - custom_rf_type = adapter->registrypriv.rf_config; - rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - if (!psta) return nss; - /* rf_config is dependent on efuse or sw config */ - if (custom_rf_type != RF_MAX_TYPE) + custom_rf_type = adapter->registrypriv.rf_config; + rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + if (RF_TYPE_VALID(custom_rf_type)) rf_type = custom_rf_type; -#ifdef CONFIG_80211AC_VHT - if (psta->vhtpriv.vht_option) { - u8 vht_mcs[2]; - struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); - struct vht_priv *pvhtpriv_ap = &pmlmepriv->vhtpriv; + nss = rtw_min(rf_type_to_rf_rx_cnt(rf_type), hal_spec->rx_nss_num); - _rtw_memcpy(vht_mcs, psta->vhtpriv.vht_mcs_map, 2); - /* doesn't support 5~8 SS so far */ - vht_mcs[1] = 0xff; - switch (rf_type) { - case RF_1T1R: - case RF_1T2R: - vht_mcs[0] |= 0xfc; - break; - case RF_2T2R: - case RF_2T4R: - case RF_2T2R_GREEN: - case RF_2T3R: - vht_mcs[0] |= 0xf0; - break; - case RF_3T3R: - case RF_3T4R: - vht_mcs[0] |= 0xc0; - break; - default: - RTW_INFO("%s,%d, unknown rf type\n", __func__, __LINE__); - break; - } - nss = rtw_vht_mcsmap_to_nss(vht_mcs); - } else -#endif /* CONFIG_80211AC_VHT */ - if (psta->htpriv.ht_option) { - u8 supp_mcs_set[4]; - - _rtw_memcpy(supp_mcs_set, psta->htpriv.ht_cap.supp_mcs_set, 4); - - switch (rf_type) { - case RF_1T1R: - case RF_1T2R: - supp_mcs_set[1] = supp_mcs_set[2] = supp_mcs_set[3] = 0; - break; - case RF_2T2R: - case RF_2T4R: - case RF_2T2R_GREEN: - case RF_2T3R: - supp_mcs_set[2] = supp_mcs_set[3] = 0; - break; - case RF_3T3R: - case RF_3T4R: - supp_mcs_set[3] = 0; - break; - default: - RTW_INFO("%s,%d, unknown rf type\n", __func__, __LINE__); - break; - } - nss = rtw_ht_mcsset_to_nss(supp_mcs_set); - } - - RTW_INFO("%s: %d SS, rf_type=%d\n", __func__, nss, rf_type); +#ifdef CONFIG_80211N_HT + #ifdef CONFIG_80211AC_VHT + if (psta->vhtpriv.vht_option) + nss = rtw_min(nss, rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map)); + else + #endif /* CONFIG_80211AC_VHT */ + if (psta->htpriv.ht_option) + nss = rtw_min(nss, rtw_ht_mcsset_to_nss(psta->htpriv.ht_cap.supp_mcs_set)); +#endif /*CONFIG_80211N_HT*/ + RTW_INFO("%s: %d SS\n", __func__, nss); return nss; } -u8 networktype_to_raid(_adapter *adapter, struct sta_info *psta) +s8 rtw_get_sta_tx_nss(_adapter *adapter, struct sta_info *psta) { - unsigned char raid; - switch (psta->wireless_mode) { - case WIRELESS_11B: - raid = RATR_INX_WIRELESS_B; - break; - case WIRELESS_11A: - case WIRELESS_11G: - raid = RATR_INX_WIRELESS_G; - break; - case WIRELESS_11BG: - raid = RATR_INX_WIRELESS_GB; - break; - case WIRELESS_11_24N: - case WIRELESS_11_5N: - raid = RATR_INX_WIRELESS_N; - break; - case WIRELESS_11A_5N: - case WIRELESS_11G_24N: - raid = RATR_INX_WIRELESS_NG; - break; - case WIRELESS_11BG_24N: - raid = RATR_INX_WIRELESS_NGB; - break; - default: - raid = RATR_INX_WIRELESS_GB; - break; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + u8 rf_type = RF_1T1R, custom_rf_type; + s8 nss = 1; - } - return raid; + if (!psta) + return nss; + custom_rf_type = adapter->registrypriv.rf_config; + rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + if (RF_TYPE_VALID(custom_rf_type)) + rf_type = custom_rf_type; + + nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); + +#ifdef CONFIG_80211N_HT + #ifdef CONFIG_80211AC_VHT + if (psta->vhtpriv.vht_option) + nss = rtw_min(nss, rtw_vht_mcsmap_to_nss(psta->vhtpriv.vht_mcs_map)); + else + #endif /* CONFIG_80211AC_VHT */ + if (psta->htpriv.ht_option) + nss = rtw_min(nss, rtw_ht_mcsset_to_nss(psta->htpriv.ht_cap.supp_mcs_set)); +#endif /*CONFIG_80211N_HT*/ + RTW_INFO("%s: %d SS\n", __func__, nss); + return nss; } -u8 networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta) -{ - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; - u8 raid = RATEID_IDX_BGN_40M_1SS, cur_rf_type, rf_type, custom_rf_type; - s8 tx_nss; - - tx_nss = rtw_get_tx_nss(adapter, psta); - - switch (psta->wireless_mode) { - case WIRELESS_11B: - raid = RATEID_IDX_B; - break; - case WIRELESS_11A: - case WIRELESS_11G: - raid = RATEID_IDX_G; - break; - case WIRELESS_11BG: - raid = RATEID_IDX_BG; - break; - case WIRELESS_11_24N: - case WIRELESS_11_5N: - case WIRELESS_11A_5N: - case WIRELESS_11G_24N: - if (tx_nss == 1) - raid = RATEID_IDX_GN_N1SS; - else if (tx_nss == 2) - raid = RATEID_IDX_GN_N2SS; - else if (tx_nss == 3) - raid = RATEID_IDX_BGN_3SS; - else - RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); - break; - case WIRELESS_11B_24N: - case WIRELESS_11BG_24N: - if (psta->bw_mode == CHANNEL_WIDTH_20) { - if (tx_nss == 1) - raid = RATEID_IDX_BGN_20M_1SS_BN; - else if (tx_nss == 2) - raid = RATEID_IDX_BGN_20M_2SS_BN; - else if (tx_nss == 3) - raid = RATEID_IDX_BGN_3SS; - else - RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); - } else { - if (tx_nss == 1) - raid = RATEID_IDX_BGN_40M_1SS; - else if (tx_nss == 2) - raid = RATEID_IDX_BGN_40M_2SS; - else if (tx_nss == 3) - raid = RATEID_IDX_BGN_3SS; - else - RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); - } - break; -#ifdef CONFIG_80211AC_VHT - case WIRELESS_11_5AC: - if (tx_nss == 1) - raid = RATEID_IDX_VHT_1SS; - else if (tx_nss == 2) - raid = RATEID_IDX_VHT_2SS; - else if (tx_nss == 3) - raid = RATEID_IDX_VHT_3SS; - else - RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); - break; - case WIRELESS_11_24AC: - if (psta->bw_mode >= CHANNEL_WIDTH_80) { - if (tx_nss == 1) - raid = RATEID_IDX_VHT_1SS; - else if (tx_nss == 2) - raid = RATEID_IDX_VHT_2SS; - else if (tx_nss == 3) - raid = RATEID_IDX_VHT_3SS; - else - RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); - } else { - if (tx_nss == 1) - raid = RATEID_IDX_MIX1; - else if (tx_nss == 2) - raid = RATEID_IDX_MIX2; - else if (tx_nss == 3) - raid = RATEID_IDX_VHT_3SS; - else - RTW_INFO("tx_nss error!(tx_nss=%d)\n", tx_nss); - } - break; -#endif - default: - RTW_INFO("unexpected wireless mode!(psta->wireless_mode=%x)\n", psta->wireless_mode); - break; - - } - - /* RTW_INFO("psta->wireless_mode=%x, tx_nss=%d\n", psta->wireless_mode, tx_nss); */ - - return raid; - -} -#endif u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen) { u8 network_type = 0; @@ -433,6 +278,9 @@ unsigned int ratetbl2rateset(_adapter *padapter, unsigned char *rateset) for (i = 0; i < NumRates; i++) { rate = pmlmeext->datarate[i]; + if (rtw_get_oper_ch(padapter) > 14 && rate < _6M_RATE_) /*5G no support CCK rate*/ + continue; + switch (rate) { case 0xff: return len; @@ -740,12 +588,12 @@ u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset) return center_ch; } -inline u32 rtw_get_on_oper_ch_time(_adapter *adapter) +inline systime rtw_get_on_oper_ch_time(_adapter *adapter) { return adapter_to_dvobj(adapter)->on_oper_ch_time; } -inline u32 rtw_get_on_cur_ch_time(_adapter *adapter) +inline systime rtw_get_on_cur_ch_time(_adapter *adapter) { if (adapter->mlmeextpriv.cur_channel == adapter_to_dvobj(adapter)->oper_channel) return adapter_to_dvobj(adapter)->on_oper_ch_time; @@ -792,9 +640,6 @@ void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char bool ori_overlap_radar_detect_ch = rtw_rfctl_overlap_radar_detect_ch(rfctl); bool new_overlap_radar_detect_ch = _rtw_rfctl_overlap_radar_detect_ch(rfctl, channel, bwmode, channel_offset); - if (new_overlap_radar_detect_ch) - rtw_odm_radar_detect_enable(padapter); - if (new_overlap_radar_detect_ch && IS_CH_WAITING(rfctl)) { u8 pause = 0xFF; @@ -828,7 +673,9 @@ void set_channel_bwmode(_adapter *padapter, unsigned char channel, unsigned char #endif #ifdef CONFIG_DFS_MASTER - if (ori_overlap_radar_detect_ch && !new_overlap_radar_detect_ch) { + if (new_overlap_radar_detect_ch) + rtw_odm_radar_detect_enable(padapter); + else if (ori_overlap_radar_detect_ch) { u8 pause = 0x00; rtw_odm_radar_detect_disable(padapter); @@ -900,7 +747,7 @@ int is_IBSS_empty(_adapter *padapter) for (i = 0; i < macid_ctl->num; i++) { if (!rtw_macid_is_used(macid_ctl, i)) continue; - if (rtw_macid_get_if_g(macid_ctl, i) != padapter->iface_id) + if (!rtw_macid_is_iface_specific(macid_ctl, i, padapter)) continue; if (!GET_H2CCMD_MSRRPT_PARM_OPMODE(&macid_ctl->h2c_msr[i])) continue; @@ -1431,7 +1278,7 @@ s16 rtw_camid_alloc(_adapter *adapter, struct sta_info *sta, u8 kid, bool *used) , FUNC_ADPT_ARG(adapter), MAC_ARG(addr), cam_id); #endif } else { - u8 *addr = sta ? sta->hwaddr : NULL; + u8 *addr = sta ? sta->cmn.mac_addr : NULL; if (!sta) { if (!(mlmeinfo->state & WIFI_FW_ASSOC_SUCCESS)) { @@ -1600,7 +1447,7 @@ void flush_all_cam_entry(_adapter *padapter) } else rtw_clearstakey_cmd(padapter, psta, _FALSE); } - } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { + } else if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { #if 1 int cam_id = -1; u8 *addr = adapter_mac_addr(padapter); @@ -1718,10 +1565,14 @@ void WMMOnAssocRsp(_adapter *padapter) struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct registry_priv *pregpriv = &padapter->registrypriv; +#ifdef CONFIG_WMMPS_STA + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct qos_priv *pqospriv = &pmlmepriv->qospriv; +#endif /* CONFIG_WMMPS_STA */ acm_mask = 0; - if (IsSupported5G(pmlmeext->cur_wireless_mode) || + if (is_supported_5g(pmlmeext->cur_wireless_mode) || (pmlmeext->cur_wireless_mode & WIRELESS_11_24N)) aSifsTime = 16; else @@ -1843,6 +1694,14 @@ void WMMOnAssocRsp(_adapter *padapter) pxmitpriv->wmm_para_seq[i] = inx[i]; RTW_INFO("wmm_para_seq(%d): %d\n", i, pxmitpriv->wmm_para_seq[i]); } + +#ifdef CONFIG_WMMPS_STA + /* if AP supports UAPSD function, driver must set each uapsd TID to coresponding mac register 0x693 */ + if (pmlmeinfo->WMM_param.QoS_info & AP_SUPPORTED_UAPSD) { + pqospriv->uapsd_ap_supported = 1; + rtw_hal_set_hwreg(padapter, HW_VAR_UAPSD_TID, NULL); + } +#endif /* CONFIG_WMMPS_STA */ } } @@ -1935,10 +1794,10 @@ static void bwmode_update_check(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pI if (phtpriv_sta->ht_option) { /* bwmode */ - psta->bw_mode = pmlmeext->cur_bwmode; + psta->cmn.bw_mode = pmlmeext->cur_bwmode; phtpriv_sta->ch_offset = pmlmeext->cur_ch_offset; } else { - psta->bw_mode = CHANNEL_WIDTH_20; + psta->cmn.bw_mode = CHANNEL_WIDTH_20; phtpriv_sta->ch_offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; } @@ -1956,12 +1815,13 @@ void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) unsigned int i; u8 rf_type = RF_1T1R; u8 max_AMPDU_len, min_MPDU_spacing; - u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0; + u8 cur_ldpc_cap = 0, cur_stbc_cap = 0, cur_beamform_cap = 0, tx_nss = 0; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct ht_priv *phtpriv = &pmlmepriv->htpriv; struct registry_priv *pregistrypriv = &padapter->registrypriv; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); if (pIE == NULL) return; @@ -2001,39 +1861,38 @@ void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_caps_info); pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps = le16_to_cpu(pmlmeinfo->HT_caps.u.HT_cap_element.HT_ext_caps); - rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - - /* update the MCS set */ for (i = 0; i < 16; i++) pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate[i] &= pmlmeext->default_supported_mcs_set[i]; - /* update the MCS rates */ - switch (rf_type) { - case RF_1T1R: - case RF_1T2R: + rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + tx_nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); + + switch (tx_nss) { + case 1: set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_1R); break; - case RF_2T2R: -#ifdef CONFIG_DISABLE_MCS13TO15 + case 2: + #ifdef CONFIG_DISABLE_MCS13TO15 if (pmlmeext->cur_bwmode == CHANNEL_WIDTH_40 && pregistrypriv->wifi_spec != 1) set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R_13TO15_OFF); else + #endif set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -#else /* CONFIG_DISABLE_MCS13TO15 */ - set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_2R); -#endif /* CONFIG_DISABLE_MCS13TO15 */ break; - case RF_3T3R: + case 3: set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_3R); break; + case 4: + set_mcs_rate_by_mask(pmlmeinfo->HT_caps.u.HT_cap_element.MCS_rate, MCS_RATE_4R); + break; default: - RTW_INFO("[warning] rf_type %d is not expected\n", rf_type); + RTW_WARN("rf_type:%d or tx_nss:%u is not expected\n", rf_type, hal_spec->tx_nss_num); } if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { /* Config STBC setting */ - if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_TX_STBC(pIE->data)) { + if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_TX) && GET_HT_CAP_ELE_RX_STBC(pIE->data)) { SET_FLAG(cur_stbc_cap, STBC_HT_ENABLE_TX); RTW_INFO("Enable HT Tx STBC !\n"); } @@ -2075,6 +1934,22 @@ void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) phtpriv->stbc_cap = cur_stbc_cap; #ifdef CONFIG_BEAMFORMING +#ifdef RTW_BEAMFORMING_VERSION_2 + /* Config beamforming setting */ + if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && + GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) { + SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE); + /* Shift to BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP*/ + SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_CHNL_ESTIMATION_NUM_ANTENNAS(pIE->data) << 6); + } + + if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE) && + GET_HT_CAP_TXBF_EXPLICIT_COMP_FEEDBACK_CAP(pIE->data)) { + SET_FLAG(cur_beamform_cap, BEAMFORMING_HT_BEAMFORMER_ENABLE); + /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ + SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); + } +#else /* !RTW_BEAMFORMING_VERSION_2 */ /* Config Tx beamforming setting */ if (TEST_FLAG(phtpriv->beamform_cap, BEAMFORMING_HT_BEAMFORMEE_ENABLE) && GET_HT_CAP_TXBF_EXPLICIT_COMP_STEERING_CAP(pIE->data)) { @@ -2089,6 +1964,7 @@ void HT_caps_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE) /* Shift to BEAMFORMING_HT_BEAMFORMER_STEER_NUM*/ SET_FLAG(cur_beamform_cap, GET_HT_CAP_TXBF_COMP_STEERING_NUM_ANTENNAS(pIE->data) << 4); } +#endif /* !RTW_BEAMFORMING_VERSION_2 */ phtpriv->beamform_cap = cur_beamform_cap; if (cur_beamform_cap) RTW_INFO("Client HT Beamforming Cap = 0x%02X\n", cur_beamform_cap); @@ -2262,26 +2138,77 @@ void update_ldpc_stbc_cap(struct sta_info *psta) #ifdef CONFIG_80211AC_VHT if (psta->vhtpriv.vht_option) { if (TEST_FLAG(psta->vhtpriv.ldpc_cap, LDPC_VHT_ENABLE_TX)) - psta->ldpc = 1; + psta->cmn.ldpc_en = VHT_LDPC_EN; + else + psta->cmn.ldpc_en = 0; if (TEST_FLAG(psta->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX)) - psta->stbc = 1; + psta->cmn.stbc_en = VHT_STBC_EN; + else + psta->cmn.stbc_en = 0; } else #endif /* CONFIG_80211AC_VHT */ if (psta->htpriv.ht_option) { if (TEST_FLAG(psta->htpriv.ldpc_cap, LDPC_HT_ENABLE_TX)) - psta->ldpc = 1; + psta->cmn.ldpc_en = HT_LDPC_EN; + else + psta->cmn.ldpc_en = 0; if (TEST_FLAG(psta->htpriv.stbc_cap, STBC_HT_ENABLE_TX)) - psta->stbc = 1; + psta->cmn.stbc_en = HT_STBC_EN; + else + psta->cmn.stbc_en = 0; } else { - psta->ldpc = 0; - psta->stbc = 0; + psta->cmn.ldpc_en = 0; + psta->cmn.stbc_en = 0; } #endif /* CONFIG_80211N_HT */ } +int check_ielen(u8 *start, uint len) +{ + int left = len; + u8 *pos = start; + int unknown = 0; + u8 id, elen; + + while (left >= 2) { + id = *pos++; + elen = *pos++; + left -= 2; + + if (elen > left) { + RTW_INFO("IEEE 802.11 element parse failed (id=%d elen=%d left=%lu)\n", + id, elen, (unsigned long) left); + return _FALSE; + } + if ((id == WLAN_EID_VENDOR_SPECIFIC) && (elen < 4)) + return _FALSE; + + left -= elen; + pos += elen; + } + if (left) + return _FALSE; + + return _TRUE; +} + +int validate_beacon_len(u8 *pframe, u32 len) +{ + u8 ie_offset = _BEACON_IE_OFFSET_ + sizeof(struct rtw_ieee80211_hdr_3addr); + + if (len < ie_offset) { + RTW_INFO("%s: incorrect beacon length(%d)\n", __func__, len); + return _FALSE; + } + + if (check_ielen(pframe + ie_offset, len - ie_offset) == _FALSE) + return _FALSE; + + return _TRUE; +} /* * rtw_get_bcn_keys: get beacon keys from recv frame @@ -2425,12 +2352,12 @@ int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) len = packet_len - sizeof(struct rtw_ieee80211_hdr_3addr); if (len > MAX_IE_SZ) { - RTW_INFO("%s IE too long for survey event\n", __func__); + RTW_WARN("%s IE too long for survey event\n", __func__); return _FAIL; } if (_rtw_memcmp(cur_network->network.MacAddress, pbssid, 6) == _FALSE) { - RTW_INFO("Oops: rtw_check_network_encrypt linked but recv other bssid bcn\n" MAC_FMT MAC_FMT, + RTW_WARN("Oops: rtw_check_network_encrypt linked but recv other bssid bcn\n" MAC_FMT MAC_FMT, MAC_ARG(pbssid), MAC_ARG(cur_network->network.MacAddress)); return _TRUE; } @@ -2449,34 +2376,32 @@ int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) pmlmepriv->new_beacon_cnts = 0; else if ((pmlmepriv->new_beacon_cnts == 0) || _rtw_memcmp(&recv_beacon, &pmlmepriv->new_beacon_keys, sizeof(recv_beacon)) == _FALSE) { - RTW_ERR("%s: start new beacon (seq=%d)\n", __func__, GetSequence(pframe)); + RTW_DBG("%s: start new beacon (seq=%d)\n", __func__, GetSequence(pframe)); if (pmlmepriv->new_beacon_cnts == 0) { RTW_ERR("%s: cur beacon key\n", __func__); RTW_DBG_EXPR(rtw_dump_bcn_keys(&pmlmepriv->cur_beacon_keys)); } - RTW_ERR("%s: new beacon key\n", __func__); + RTW_DBG("%s: new beacon key\n", __func__); RTW_DBG_EXPR(rtw_dump_bcn_keys(&recv_beacon)); memcpy(&pmlmepriv->new_beacon_keys, &recv_beacon, sizeof(recv_beacon)); pmlmepriv->new_beacon_cnts = 1; } else { - RTW_ERR("%s: new beacon again (seq=%d)\n", __func__, GetSequence(pframe)); + RTW_DBG("%s: new beacon again (seq=%d)\n", __func__, GetSequence(pframe)); pmlmepriv->new_beacon_cnts++; } /* if counter >= max, it means beacon is changed really */ if (pmlmepriv->new_beacon_cnts >= new_bcn_max) { - RTW_ERR("%s: new beacon occur!!\n", __func__); - /* check bw mode change only? */ pmlmepriv->cur_beacon_keys.ht_cap_info = recv_beacon.ht_cap_info; pmlmepriv->cur_beacon_keys.ht_info_infos_0_sco = recv_beacon.ht_info_infos_0_sco; - if (_rtw_memcmp(&recv_beacon, &pmlmepriv->cur_beacon_keys, sizeof(recv_beacon)) == _FALSE) { /* beacon is changed, have to do disconnect/connect */ + RTW_WARN("%s: new beacon occur!!\n", __func__); return _FAIL; } @@ -2512,7 +2437,7 @@ int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len) pmlmepriv->NumOfBcnInfoChkFail = 0; } - subtype = GetFrameSubType(pframe) >> 4; + subtype = get_frame_sub_type(pframe) >> 4; if (subtype == WIFI_BEACON) bssid->Reserved[0] = 1; @@ -2954,15 +2879,6 @@ unsigned int update_supported_rate(unsigned char *ptn, unsigned int ptn_sz) return mask; } -unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps) -{ - unsigned int mask = 0; - - mask = ((pHT_caps->u.HT_cap_element.MCS_rate[0] << 12) | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 20)); - - return mask; -} - int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode) { unsigned char bit_offset; @@ -2980,13 +2896,27 @@ int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bw return _FAIL; } -unsigned char get_highest_rate_idx(u32 mask) +unsigned char get_highest_rate_idx(u64 mask) { int i; unsigned char rate_idx = 0; - for (i = 31; i >= 0; i--) { - if (mask & BIT(i)) { + for (i = 63; i >= 0; i--) { + if ((mask >> i) & 0x01) { + rate_idx = i; + break; + } + } + + return rate_idx; +} +unsigned char get_lowest_rate_idx_ex(u64 mask, int start_bit) +{ + int i; + unsigned char rate_idx = 0; + + for (i = start_bit; i < 64; i++) { + if ((mask >> i) & 0x01) { rate_idx = i; break; } @@ -2995,30 +2925,15 @@ unsigned char get_highest_rate_idx(u32 mask) return rate_idx; } -unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps); -unsigned char get_highest_mcs_rate(struct HT_caps_element *pHT_caps) -{ - int i, mcs_rate; - - mcs_rate = (pHT_caps->u.HT_cap_element.MCS_rate[0] | (pHT_caps->u.HT_cap_element.MCS_rate[1] << 8)); - - for (i = 15; i >= 0; i--) { - if (mcs_rate & (0x1 << i)) - break; - } - - return i; -} - void Update_RA_Entry(_adapter *padapter, struct sta_info *psta) { - rtw_hal_update_ra_mask(psta, psta->rssi_level); + rtw_hal_update_ra_mask(psta); } void set_sta_rate(_adapter *padapter, struct sta_info *psta) { /* rate adaptive */ - rtw_hal_update_ra_mask(psta, psta->rssi_level); + rtw_hal_update_ra_mask(psta); } /* Update RRSR and Rate for USERATE */ @@ -3090,7 +3005,7 @@ unsigned char check_assoc_AP(u8 *pframe, uint len) return HT_IOT_PEER_CISCO; } else if (_rtw_memcmp(pIE->data, REALTEK_OUI, 3)) { u32 Vender = HT_IOT_PEER_REALTEK; -#ifdef CONFIG_80211N_HT + if (pIE->Length >= 5) { if (pIE->data[4] == 1) { /* if(pIE->data[5] & RT_HT_CAP_USE_LONG_PREAMBLE) */ @@ -3116,7 +3031,7 @@ unsigned char check_assoc_AP(u8 *pframe, uint len) } } } -#endif + RTW_INFO("link to Realtek AP\n"); return Vender; } else if (_rtw_memcmp(pIE->data, AIRGOCAP_OUI, 3)) { @@ -3361,7 +3276,12 @@ void process_addba_req(_adapter *padapter, u8 *paddba_req, u8 *addr) accept = rtw_rx_ampdu_is_accept(padapter); - size = rtw_rx_ampdu_size(padapter); + if (padapter->fix_rx_ampdu_size != RX_AMPDU_SIZE_INVALID) + size = padapter->fix_rx_ampdu_size; + else { + size = rtw_rx_ampdu_size(padapter); + size = rtw_min(size, rx_ampdu_size_sta_limit(padapter, psta)); + } if (accept == _TRUE) rtw_addbarsp_cmd(padapter, addr, tid, 0, size, start_seq); @@ -3488,8 +3408,6 @@ void beacon_timing_control(_adapter *padapter) rtw_hal_bcn_related_reg_setting(padapter); } -#define CONFIG_SHARED_BMC_MACID - void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num) { RTW_PRINT_SEL(sel, "0x%08x\n", map->m0); @@ -3595,24 +3513,48 @@ inline bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id) return rtw_macid_is_set(&macid_ctl->bmc, id); } -inline s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id) +inline u8 rtw_macid_get_iface_bmp(struct macid_ctl_t *macid_ctl, u8 id) { int i; - -#ifdef CONFIG_SHARED_BMC_MACID - if (rtw_macid_is_bmc(macid_ctl, id)) { - for (i = 0; i < CONFIG_IFACE_NUMBER; i++) - if (macid_ctl->iface_bmc[i] == id) - return i; - return -1; - } -#endif + u8 iface_bmp = 0; for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) - return i; + iface_bmp |= BIT(i); } - return -1; + return iface_bmp; +} + +inline bool rtw_macid_is_iface_shared(struct macid_ctl_t *macid_ctl, u8 id) +{ + int i; + u8 iface_bmp = 0; + + for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { + if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) { + if (iface_bmp) + return 1; + iface_bmp |= BIT(i); + } + } + + return 0; +} + +inline bool rtw_macid_is_iface_specific(struct macid_ctl_t *macid_ctl, u8 id, _adapter *adapter) +{ + int i; + u8 iface_bmp = 0; + + for (i = 0; i < CONFIG_IFACE_NUMBER; i++) { + if (rtw_macid_is_set(&macid_ctl->if_g[i], id)) { + if (iface_bmp || i != adapter->iface_id) + return 0; + iface_bmp |= BIT(i); + } + } + + return iface_bmp ? 1 : 0; } inline s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id) @@ -3638,38 +3580,31 @@ void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) u8 last_id = 0; u8 is_bc_sta = _FALSE; - if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) { - psta->mac_id = macid_ctl->num; + if (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN)) { + psta->cmn.mac_id = macid_ctl->num; return; } - if (_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) { + if (_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN)) { is_bc_sta = _TRUE; rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); /*init default value*/ } -#ifdef CONFIG_SHARED_BMC_MACID if (is_bc_sta -#ifdef CONFIG_CONCURRENT_MODE - && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) -#endif - ) { - /* use shared broadcast & multicast macid 1 for all ifaces which configure to station mode*/ - _enter_critical_bh(&macid_ctl->lock, &irqL); - rtw_macid_map_set(used_map, 1); - rtw_macid_map_set(&macid_ctl->bmc, 1); - rtw_macid_map_set(&macid_ctl->if_g[padapter->iface_id], 1); - macid_ctl->sta[1] = psta; - /* TODO ch_g? */ - _exit_critical_bh(&macid_ctl->lock, &irqL); - i = 1; + #ifdef CONFIG_CONCURRENT_MODE + && (MLME_IS_STA(padapter) || MLME_IS_NULL(padapter)) + #endif + ) { + /* STA mode have no BMC data TX, shared with this macid */ + /* When non-concurrent, only one BMC data TX is used, shared with this macid */ + /* TODO: When concurrent, non-security BMC data TX may use this, but will not control by specific macid sleep */ + i = RTW_DEFAULT_MGMT_MACID; goto assigned; } -#endif #ifdef CONFIG_MCC_MODE if (MCC_EN(padapter)) { - if (MLME_IS_AP(padapter) || MLME_IS_GO(padapter)) + if (MLME_IS_AP(padapter)) /* GO/AP assign client macid from 8 */ last_id = 8; } @@ -3678,11 +3613,6 @@ void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) _enter_critical_bh(&macid_ctl->lock, &irqL); for (i = last_id; i < macid_ctl->num; i++) { -#ifdef CONFIG_SHARED_BMC_MACID - if (i == 1) - continue; -#endif - #ifdef CONFIG_MCC_MODE /* macid 0/1 reserve for mcc for mgnt queue macid */ if (MCC_EN(padapter)) { @@ -3693,8 +3623,7 @@ void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) } #endif /* CONFIG_MCC_MODE */ - if (is_bc_sta) {/*for SoftAP's Broadcast sta-info*/ - /*TODO:non-security AP may allociated macid = 1*/ + if (is_bc_sta) { struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); if ((!rtw_macid_is_used(macid_ctl, i)) && (!rtw_sec_camid_is_used(cam_ctl, i))) @@ -3729,18 +3658,18 @@ void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta) _exit_critical_bh(&macid_ctl->lock, &irqL); if (i >= macid_ctl->num) { - psta->mac_id = macid_ctl->num; - RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" no available macid\n" - , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr)); + psta->cmn.mac_id = macid_ctl->num; + RTW_ERR(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" no available macid\n" + , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->cmn.mac_addr)); rtw_warn_on(1); goto exit; } else goto assigned; assigned: - psta->mac_id = i; - RTW_INFO(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u\n" - , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); + psta->cmn.mac_id = i; + RTW_INFO(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u\n" + , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id); exit: return; @@ -3752,65 +3681,75 @@ void rtw_release_macid(_adapter *padapter, struct sta_info *psta) u8 bc_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - u8 is_bc_sta = _FALSE; + u8 ifbmp; + int i; - if (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), ETH_ALEN)) - return; + if (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), ETH_ALEN)) + goto exit; - if (_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN)) - is_bc_sta = _TRUE; - -#ifdef CONFIG_SHARED_BMC_MACID - if (is_bc_sta -#ifdef CONFIG_CONCURRENT_MODE - && (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) -#endif - ) - return; - - if (psta->mac_id == 1) { - RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" with macid:%u\n" - , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); - if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) || check_fwstate(&padapter->mlmepriv, WIFI_NULL_STATE)) - rtw_warn_on(1); - return; + if (psta->cmn.mac_id >= macid_ctl->num) { + RTW_WARN(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u not valid\n" + , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 + , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id); + rtw_warn_on(1); + goto exit; } -#endif + + if (psta->cmn.mac_id == RTW_DEFAULT_MGMT_MACID) + goto msg; _enter_critical_bh(&macid_ctl->lock, &irqL); - if (psta->mac_id < macid_ctl->num) { - int i; + if (!rtw_macid_is_used(macid_ctl, psta->cmn.mac_id)) { + RTW_WARN(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u not used\n" + , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 + , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id); + _exit_critical_bh(&macid_ctl->lock, &irqL); + rtw_warn_on(1); + goto exit; + } - if (!rtw_macid_is_used(macid_ctl, psta->mac_id)) { - RTW_ERR(FUNC_ADPT_FMT" if%u, hwaddr:"MAC_FMT" macid:%u not used\n" - , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1, MAC_ARG(psta->hwaddr), psta->mac_id); - rtw_warn_on(1); - } + ifbmp = rtw_macid_get_iface_bmp(macid_ctl, psta->cmn.mac_id); + if (!(ifbmp & BIT(padapter->iface_id))) { + RTW_WARN(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u not used by self\n" + , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 + , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id); + _exit_critical_bh(&macid_ctl->lock, &irqL); + rtw_warn_on(1); + goto exit; + } - rtw_macid_map_clr(&macid_ctl->used, psta->mac_id); - rtw_macid_map_clr(&macid_ctl->bmc, psta->mac_id); + if (_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN)) { + struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); + u8 id = rtw_iface_bcmc_id_get(padapter); - if (is_bc_sta) { - struct cam_ctl_t *cam_ctl = dvobj_to_sec_camctl(dvobj); - u8 id = rtw_iface_bcmc_id_get(padapter); + if ((id != INVALID_SEC_MAC_CAM_ID) && (id < cam_ctl->num)) + rtw_sec_cam_map_clr(&cam_ctl->used, id); - if ((id != INVALID_SEC_MAC_CAM_ID) && (id < cam_ctl->num)) - rtw_sec_cam_map_clr(&cam_ctl->used, id); + rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); + } - rtw_iface_bcmc_id_set(padapter, INVALID_SEC_MAC_CAM_ID); - } + rtw_macid_map_clr(&macid_ctl->if_g[padapter->iface_id], psta->cmn.mac_id); - for (i = 0; i < CONFIG_IFACE_NUMBER; i++) - rtw_macid_map_clr(&macid_ctl->if_g[i], psta->mac_id); + ifbmp &= ~BIT(padapter->iface_id); + if (!ifbmp) { /* only used by self */ + rtw_macid_map_clr(&macid_ctl->used, psta->cmn.mac_id); + rtw_macid_map_clr(&macid_ctl->bmc, psta->cmn.mac_id); for (i = 0; i < 2; i++) - rtw_macid_map_clr(&macid_ctl->ch_g[i], psta->mac_id); - macid_ctl->sta[psta->mac_id] = NULL; + rtw_macid_map_clr(&macid_ctl->ch_g[i], psta->cmn.mac_id); + macid_ctl->sta[psta->cmn.mac_id] = NULL; } _exit_critical_bh(&macid_ctl->lock, &irqL); - psta->mac_id = macid_ctl->num; +msg: + RTW_INFO(FUNC_ADPT_FMT" if%u, mac_addr:"MAC_FMT" macid:%u\n" + , FUNC_ADPT_ARG(padapter), padapter->iface_id + 1 + , MAC_ARG(psta->cmn.mac_addr), psta->cmn.mac_id + ); + +exit: + psta->cmn.mac_id = macid_ctl->num; } /* For 8188E RA */ @@ -3895,8 +3834,31 @@ inline void rtw_macid_ctl_set_rate_bmp1(struct macid_ctl_t *macid_ctl, u8 id, u3 RTW_INFO("macid:%u, rate_bmp1:0x%08X\n", id, macid_ctl->rate_bmp1[id]); } +inline void rtw_macid_ctl_init_sleep_reg(struct macid_ctl_t *macid_ctl, u16 m0, u16 m1, u16 m2, u16 m3) +{ + macid_ctl->reg_sleep_m0 = m0; +#if (MACID_NUM_SW_LIMIT > 32) + macid_ctl->reg_sleep_m1 = m1; +#endif +#if (MACID_NUM_SW_LIMIT > 64) + macid_ctl->reg_sleep_m2 = m2; +#endif +#if (MACID_NUM_SW_LIMIT > 96) + macid_ctl->reg_sleep_m3 = m3; +#endif +} + inline void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl) { + int i; + u8 id = RTW_DEFAULT_MGMT_MACID; + + rtw_macid_map_set(&macid_ctl->used, id); + rtw_macid_map_set(&macid_ctl->bmc, id); + for (i = 0; i < CONFIG_IFACE_NUMBER; i++) + rtw_macid_map_set(&macid_ctl->if_g[i], id); + macid_ctl->sta[id] = NULL; + _rtw_spinlock_init(&macid_ctl->lock); } @@ -3933,7 +3895,7 @@ unsigned int setup_beacon_frame(_adapter *padapter, unsigned char *beacon_frame) _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(cur_network), ETH_ALEN); - SetFrameSubType(pframe, WIFI_BEACON); + set_frame_sub_type(pframe, WIFI_BEACON); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); len = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -4053,31 +4015,6 @@ _adapter *dvobj_get_adapter_by_addr(struct dvobj_priv *dvobj, u8 *addr) return adapter; } -#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip) -{ - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct in_device *my_ip_ptr = padapter->pnetdev->ip_ptr; - u8 ipaddress[4]; - - if ((pmlmeinfo->state & WIFI_FW_LINKING_STATE) || - pmlmeinfo->state & WIFI_FW_AP_STATE) { - if (my_ip_ptr != NULL) { - struct in_ifaddr *my_ifa_list = my_ip_ptr->ifa_list ; - if (my_ifa_list != NULL) { - ipaddress[0] = my_ifa_list->ifa_address & 0xFF; - ipaddress[1] = (my_ifa_list->ifa_address >> 8) & 0xFF; - ipaddress[2] = (my_ifa_list->ifa_address >> 16) & 0xFF; - ipaddress[3] = my_ifa_list->ifa_address >> 24; - RTW_INFO("%s: %d.%d.%d.%d ==========\n", __func__, - ipaddress[0], ipaddress[1], ipaddress[2], ipaddress[3]); - _rtw_memcpy(pcurrentip, ipaddress, 4); - } - } - } -} -#endif #ifdef CONFIG_WOWLAN bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, int *pattern_len, char *bit_mask) @@ -4155,23 +4092,42 @@ bool rtw_check_pattern_valid(u8 *input, u8 len) exit: return res; } +void rtw_wow_pattern_sw_reset(_adapter *adapter) +{ + int i; + struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(adapter); + + if (pwrctrlpriv->default_patterns_en == _TRUE) + pwrctrlpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; + else + pwrctrlpriv->wowlan_pattern_idx = 0; + + for (i = 0 ; i < MAX_WKFM_CAM_NUM; i++) { + _rtw_memset(pwrctrlpriv->patterns[i].content, '\0', sizeof(pwrctrlpriv->patterns[i].content)); + _rtw_memset(pwrctrlpriv->patterns[i].mask, '\0', sizeof(pwrctrlpriv->patterns[i].mask)); + pwrctrlpriv->patterns[i].len = 0; + } +} u8 rtw_set_default_pattern(_adapter *adapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); - struct registry_priv *pregistrypriv = &adapter->registrypriv; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; u8 index = 0; - u8 currentip[4]; u8 multicast_addr[3] = {0x01, 0x00, 0x5e}; u8 multicast_ip[4] = {0xe0, 0x28, 0x28, 0x2a}; - u8 unicast_mask[5] = {0x3f, 0x70, 0x80, 0xc0, 0x03}; - u8 multicast_mask[5] = {0x07, 0x70, 0x80, 0xc0, 0x03}; - u8 ip_protocol[3] = {0x08, 0x00, 0x45}; - u8 icmp_protocol[1] = {0x01}; - u8 tcp_protocol[1] = {0x06}; - u8 udp_protocol[1] = {0x11}; - if (pregistrypriv->default_patterns_en == _FALSE) + u8 unicast_mask[5] = {0x3f, 0x70, 0x80, 0xc0, 0x03}; + u8 icmpv6_mask[7] = {0x00, 0x70, 0x10, 0x00, 0xc0, 0xc0, 0x3f}; + u8 multicast_mask[5] = {0x07, 0x70, 0x80, 0xc0, 0x03}; + + u8 ip_protocol[3] = {0x08, 0x00, 0x45}; + u8 ipv6_protocol[3] = {0x86, 0xdd, 0x60}; + + u8 *target = NULL; + + if (pwrpriv->default_patterns_en == _FALSE) return 0; for (index = 0 ; index < DEFAULT_PATTERN_NUM ; index++) { @@ -4182,253 +4138,109 @@ u8 rtw_set_default_pattern(_adapter *adapter) pwrpriv->patterns[index].len = 0; } - rtw_get_current_ip_address(adapter, currentip); - /*TCP/ICMP unicast*/ for (index = 0 ; index < DEFAULT_PATTERN_NUM ; index++) { switch (index) { case 0: - _rtw_memcpy(pwrpriv->patterns[index].content, - adapter_mac_addr(adapter), + target = pwrpriv->patterns[index].content; + _rtw_memcpy(target, adapter_mac_addr(adapter), ETH_ALEN); - _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, - &ip_protocol, sizeof(ip_protocol)); - _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, - &tcp_protocol, sizeof(tcp_protocol)); - _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, - ¤tip, sizeof(currentip)); + + target += ETH_TYPE_OFFSET; + _rtw_memcpy(target, &ip_protocol, + sizeof(ip_protocol)); + + /* TCP */ + target += (PROTOCOL_OFFSET - ETH_TYPE_OFFSET); + _rtw_memset(target, 0x06, 1); + + target += (IP_OFFSET - PROTOCOL_OFFSET); + + _rtw_memcpy(target, pmlmeinfo->ip_addr, + RTW_IP_ADDR_LEN); + _rtw_memcpy(pwrpriv->patterns[index].mask, &unicast_mask, sizeof(unicast_mask)); - pwrpriv->patterns[index].len = IP_OFFSET + sizeof(currentip); + + pwrpriv->patterns[index].len = + IP_OFFSET + RTW_IP_ADDR_LEN; break; case 1: - _rtw_memcpy(pwrpriv->patterns[index].content, - adapter_mac_addr(adapter), + target = pwrpriv->patterns[index].content; + _rtw_memcpy(target, adapter_mac_addr(adapter), ETH_ALEN); - _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, - &ip_protocol, sizeof(ip_protocol)); - _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, - &icmp_protocol, sizeof(icmp_protocol)); - _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, - ¤tip, sizeof(currentip)); + + target += ETH_TYPE_OFFSET; + _rtw_memcpy(target, &ip_protocol, sizeof(ip_protocol)); + + /* ICMP */ + target += (PROTOCOL_OFFSET - ETH_TYPE_OFFSET); + _rtw_memset(target, 0x01, 1); + + target += (IP_OFFSET - PROTOCOL_OFFSET); + _rtw_memcpy(target, pmlmeinfo->ip_addr, + RTW_IP_ADDR_LEN); + _rtw_memcpy(pwrpriv->patterns[index].mask, &unicast_mask, sizeof(unicast_mask)); - pwrpriv->patterns[index].len = IP_OFFSET + sizeof(currentip); + pwrpriv->patterns[index].len = + + IP_OFFSET + RTW_IP_ADDR_LEN; break; +#ifdef CONFIG_IPV6 case 2: - _rtw_memcpy(pwrpriv->patterns[index].content, &multicast_addr, + if (pwrpriv->wowlan_ns_offload_en == _TRUE) { + target = pwrpriv->patterns[index].content; + target += ETH_TYPE_OFFSET; + + _rtw_memcpy(target, &ipv6_protocol, + sizeof(ipv6_protocol)); + + /* ICMPv6 */ + target += (IPv6_PROTOCOL_OFFSET - + ETH_TYPE_OFFSET); + _rtw_memset(target, 0x3a, 1); + + target += (IPv6_OFFSET - IPv6_PROTOCOL_OFFSET); + _rtw_memcpy(target, pmlmeinfo->ip6_addr, + RTW_IPv6_ADDR_LEN); + + _rtw_memcpy(pwrpriv->patterns[index].mask, + &icmpv6_mask, sizeof(icmpv6_mask)); + pwrpriv->patterns[index].len = + IPv6_OFFSET + RTW_IPv6_ADDR_LEN; + } + break; +#endif /*CONFIG_IPV6*/ + case 3: + target = pwrpriv->patterns[index].content; + _rtw_memcpy(target, &multicast_addr, sizeof(multicast_addr)); - _rtw_memcpy(pwrpriv->patterns[index].content + ETH_TYPE_OFFSET, - &ip_protocol, sizeof(ip_protocol)); - _rtw_memcpy(pwrpriv->patterns[index].content + PROTOCOL_OFFSET, - &udp_protocol, sizeof(udp_protocol)); - _rtw_memcpy(pwrpriv->patterns[index].content + IP_OFFSET, - &multicast_ip, sizeof(multicast_ip)); + + target += ETH_TYPE_OFFSET; + _rtw_memcpy(target, &ip_protocol, sizeof(ip_protocol)); + + /* UDP */ + target += (PROTOCOL_OFFSET - ETH_TYPE_OFFSET); + _rtw_memset(target, 0x11, 1); + + target += (IP_OFFSET - PROTOCOL_OFFSET); + _rtw_memcpy(target, &multicast_ip, + sizeof(multicast_ip)); + _rtw_memcpy(pwrpriv->patterns[index].mask, &multicast_mask, sizeof(multicast_mask)); + pwrpriv->patterns[index].len = IP_OFFSET + sizeof(multicast_ip); break; + default: + break; } } - return index; } -bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx) -{ - u32 data_l = 0, data_h = 0, rx_dma_buff_sz = 0, page_sz = 0; - u16 offset, rx_buf_ptr = 0; - u16 cam_start_offset = 0; - u16 ctrl_l = 0, ctrl_h = 0; - u8 count = 0, tmp = 0; - int i = 0; - bool res = _TRUE; - - if (idx > MAX_WKFM_NUM) { - RTW_INFO("[Error]: %s, pattern index is out of range\n", - __func__); - return _FALSE; - } - - rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, - (u8 *)&rx_dma_buff_sz); - - if (rx_dma_buff_sz == 0) { - RTW_INFO("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); - return _FALSE; - } - - rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); - - if (page_sz == 0) { - RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); - return _FALSE; - } - - offset = (u16)PageNum(rx_dma_buff_sz, page_sz); - cam_start_offset = offset * page_sz; - - ctrl_l = 0x0; - ctrl_h = 0x0; - - /* Enable RX packet buffer access */ - rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); - - /* Read the WKFM CAM */ - for (i = 0; i < (WKFMCAM_ADDR_NUM / 2); i++) { - /* - * Set Rx packet buffer offset. - * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. - * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE - * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 - * * Index: The index of the wake up frame mask - * * WKFMCAM_SIZE: the total size of one WKFM CAM - * * per entry offset of a WKFM CAM: Addr i * 4 bytes - */ - rx_buf_ptr = - (cam_start_offset + idx * WKFMCAM_SIZE + i * 8) >> 3; - rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); - - rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); - data_l = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); - data_h = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); - - RTW_INFO("[%d]: %08x %08x\n", i, data_h, data_l); - - count = 0; - - do { - tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); - rtw_udelay_os(2); - count++; - } while (!tmp && count < 100); - - if (count >= 100) { - RTW_INFO("%s count:%d\n", __func__, count); - res = _FALSE; - } - } - - /* Disable RX packet buffer access */ - rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, - DISABLE_TRXPKT_BUF_ACCESS); - return res; -} - -bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, - struct rtl_wow_pattern *context) -{ - u32 data = 0, rx_dma_buff_sz = 0, page_sz = 0; - u16 offset, rx_buf_ptr = 0; - u16 cam_start_offset = 0; - u16 ctrl_l = 0, ctrl_h = 0; - u8 count = 0, tmp = 0; - int res = 0, i = 0; - - if (idx > MAX_WKFM_NUM) { - RTW_INFO("[Error]: %s, pattern index is out of range\n", - __func__); - return _FALSE; - } - - rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, - (u8 *)&rx_dma_buff_sz); - - if (rx_dma_buff_sz == 0) { - RTW_INFO("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); - return _FALSE; - } - - rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); - - if (page_sz == 0) { - RTW_INFO("[Error]: %s, page_sz is 0!!\n", __func__); - return _FALSE; - } - - offset = (u16)PageNum(rx_dma_buff_sz, page_sz); - - cam_start_offset = offset * page_sz; - - if (IS_HARDWARE_TYPE_8188E(adapter)) { - ctrl_l = 0x0001; - ctrl_h = 0x0001; - } else { - ctrl_l = 0x0f01; - ctrl_h = 0xf001; - } - - /* Enable RX packet buffer access */ - rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); - - /* Write the WKFM CAM */ - for (i = 0; i < WKFMCAM_ADDR_NUM; i++) { - /* - * Set Rx packet buffer offset. - * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. - * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE - * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 - * * Index: The index of the wake up frame mask - * * WKFMCAM_SIZE: the total size of one WKFM CAM - * * per entry offset of a WKFM CAM: Addr i * 4 bytes - */ - rx_buf_ptr = - (cam_start_offset + idx * WKFMCAM_SIZE + i * 4) >> 3; - rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); - - if (i == 0) { - if (context->type == PATTERN_VALID) - data = BIT(31); - else if (context->type == PATTERN_BROADCAST) - data = BIT(31) | BIT(26); - else if (context->type == PATTERN_MULTICAST) - data = BIT(31) | BIT(25); - else if (context->type == PATTERN_UNICAST) - data = BIT(31) | BIT(24); - - if (context->crc != 0) - data |= context->crc; - - rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); - rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); - } else if (i == 1) { - data = 0; - rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); - rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); - } else if (i == 2 || i == 4) { - data = context->mask[i - 2]; - rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); - /* write to RX packet buffer*/ - rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); - } else if (i == 3 || i == 5) { - data = context->mask[i - 2]; - rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); - /* write to RX packet buffer*/ - rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); - } - - count = 0; - do { - tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); - rtw_udelay_os(2); - count++; - } while (tmp && count < 100); - - if (count >= 100) - res = _FALSE; - else - res = _TRUE; - } - - /* Disable RX packet buffer access */ - rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, - DISABLE_TRXPKT_BUF_ACCESS); - - return res; -} - - void rtw_dump_priv_pattern(_adapter *adapter, u8 idx) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); @@ -4469,20 +4281,13 @@ void rtw_dump_priv_pattern(_adapter *adapter, u8 idx) RTW_INFO("%s: len: %d\n", __func__, pwrctl->patterns[idx].len); } -void rtw_clean_pattern(_adapter *adapter) +void rtw_wow_pattern_sw_dump(_adapter *adapter) { - struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); - struct rtl_wow_pattern zero_pattern; - int i = 0; + int i; - _rtw_memset(&zero_pattern, 0, sizeof(struct rtl_wow_pattern)); - - zero_pattern.type = PATTERN_INVALID; - - for (i = 0; i < MAX_WKFM_NUM; i++) - rtw_write_to_frame_mask(adapter, i, &zero_pattern); - - rtw_write8(adapter, REG_WKFMCAM_NUM, 0); + RTW_INFO("********[RTK priv-patterns]*********\n"); + for (i = 0 ; i < MAX_WKFM_CAM_NUM; i++) + rtw_dump_priv_pattern(adapter, i); } void rtw_get_sec_iv(PADAPTER padapter, u8 *pcur_dot11txpn, u8 *StaAddr) @@ -4653,7 +4458,7 @@ int rtw_dev_nlo_info_set(struct pno_nlo_info *nlo_info, pno_ssid_t *ssid, } /* cipher array */ - fp = filp_open("/home/timlee/wpa_kk/wpa.conf", O_RDONLY, 0644); + fp = filp_open("/data/misc/wifi/wpa_supplicant.conf", O_RDONLY, 0644); if (IS_ERR(fp)) { RTW_INFO("Error, wpa_supplicant.conf doesn't exist.\n"); RTW_INFO("Error, cipher array using default value.\n"); @@ -4723,7 +4528,7 @@ int rtw_dev_scan_info_set(_adapter *padapter, pno_ssid_t *ssid, scan_info->ssid_channel_info[i].timeout = 100; scan_info->ssid_channel_info[i].tx_power = - PHY_GetTxPowerIndex(padapter, 0, 0x02, bw_mode, i + 1); + phy_get_tx_power_index(padapter, 0, 0x02, bw_mode, i + 1); scan_info->ssid_channel_info[i].channel = i + 1; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_xmit.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_xmit.c index 0e3a968f4b4c..e7902ca013e9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_xmit.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/core/rtw_xmit.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTW_XMIT_C_ #include @@ -59,6 +54,21 @@ void _rtw_init_sta_xmit_priv(struct sta_xmit_priv *psta_xmitpriv) } +void rtw_init_xmit_block(_adapter *padapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + _rtw_spinlock_init(&dvobj->xmit_block_lock); + dvobj->xmit_block = XMIT_BLOCK_NONE; + +} +void rtw_free_xmit_block(_adapter *padapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + _rtw_spinlock_free(&dvobj->xmit_block_lock); +} + s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) { int i; @@ -73,7 +83,6 @@ s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) _rtw_spinlock_init(&pxmitpriv->lock); _rtw_spinlock_init(&pxmitpriv->lock_sctx); _rtw_init_sema(&pxmitpriv->xmit_sema, 0); - _rtw_init_sema(&pxmitpriv->terminate_xmitthread_sema, 0); /* Please insert all the queue initializaiton using _rtw_init_queue below @@ -314,6 +323,32 @@ s32 _rtw_init_xmit_priv(struct xmit_priv *pxmitpriv, _adapter *padapter) rtw_sctx_init(&pxmitpriv->ack_tx_ops, 0); #endif +#ifdef CONFIG_TX_AMSDU + rtw_init_timer(&(pxmitpriv->amsdu_vo_timer), padapter, + rtw_amsdu_vo_timeout_handler, padapter); + pxmitpriv->amsdu_vo_timeout = RTW_AMSDU_TIMER_UNSET; + + rtw_init_timer(&(pxmitpriv->amsdu_vi_timer), padapter, + rtw_amsdu_vi_timeout_handler, padapter); + pxmitpriv->amsdu_vi_timeout = RTW_AMSDU_TIMER_UNSET; + + rtw_init_timer(&(pxmitpriv->amsdu_be_timer), padapter, + rtw_amsdu_be_timeout_handler, padapter); + pxmitpriv->amsdu_be_timeout = RTW_AMSDU_TIMER_UNSET; + + rtw_init_timer(&(pxmitpriv->amsdu_bk_timer), padapter, + rtw_amsdu_bk_timeout_handler, padapter); + pxmitpriv->amsdu_bk_timeout = RTW_AMSDU_TIMER_UNSET; + + pxmitpriv->amsdu_debug_set_timer = 0; + pxmitpriv->amsdu_debug_timeout = 0; + pxmitpriv->amsdu_debug_coalesce_one = 0; + pxmitpriv->amsdu_debug_coalesce_two = 0; +#endif +#ifdef DBG_TXBD_DESC_DUMP + pxmitpriv->dump_txbd_desc = 0; +#endif + rtw_init_xmit_block(padapter); rtw_hal_init_xmit_priv(padapter); exit: @@ -327,7 +362,6 @@ void rtw_mfree_xmit_priv_lock(struct xmit_priv *pxmitpriv) { _rtw_spinlock_free(&pxmitpriv->lock); _rtw_free_sema(&pxmitpriv->xmit_sema); - _rtw_free_sema(&pxmitpriv->terminate_xmitthread_sema); _rtw_spinlock_free(&pxmitpriv->be_pending.lock); _rtw_spinlock_free(&pxmitpriv->bk_pending.lock); @@ -413,7 +447,7 @@ void _rtw_free_xmit_priv(struct xmit_priv *pxmitpriv) #ifdef CONFIG_XMIT_ACK _rtw_mutex_free(&pxmitpriv->ack_tx_mutex); #endif - + rtw_free_xmit_block(padapter); out: return; } @@ -422,7 +456,7 @@ u8 rtw_get_tx_bw_mode(_adapter *adapter, struct sta_info *sta) { u8 bw; - bw = sta->bw_mode; + bw = sta->cmn.bw_mode; if (MLME_STATE(adapter) & WIFI_ASOC_STATE) { if (adapter->mlmeextpriv.cur_channel <= 14) bw = rtw_min(bw, ADAPTER_TX_BW_2G(adapter)); @@ -452,7 +486,7 @@ void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ for (i = 0; i < macid_ctl->num; i++) { if (!rtw_macid_is_used(macid_ctl, i)) continue; - if (rtw_macid_get_if_g(macid_ctl, i) != adapter->iface_id) + if (!rtw_macid_is_iface_specific(macid_ctl, i, adapter)) continue; if (bw == CHANNEL_WIDTH_20) /* CCK, OFDM always 20MHz */ @@ -490,7 +524,7 @@ void rtw_get_shared_macid_tx_rate_bmp_by_bw(struct dvobj_priv *dvobj, u8 bw, u16 for (i = 0; i < macid_ctl->num; i++) { if (!rtw_macid_is_used(macid_ctl, i)) continue; - if (rtw_macid_get_if_g(macid_ctl, i) != -1) + if (!rtw_macid_is_iface_shared(macid_ctl, i)) continue; if (bw == CHANNEL_WIDTH_20) /* CCK, OFDM always 20MHz */ @@ -615,7 +649,7 @@ void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj) /* TODO: per rfpath and rate section handling? */ if (update_ht_rs == _TRUE || update_vht_rs == _TRUE) - rtw_hal_set_tx_power_level(dvobj_get_primary_adapter(dvobj), hal_data->CurrentChannel); + rtw_hal_set_tx_power_level(dvobj_get_primary_adapter(dvobj), hal_data->current_channel); } } @@ -846,6 +880,38 @@ static void update_attrib_vcs_info(_adapter *padapter, struct xmit_frame *pxmitf } +#ifdef CONFIG_WMMPS_STA +/* + * update_attrib_trigger_frame_info + * For Station mode, if a specific TID of driver setting and an AP support uapsd function, the data + * frame with corresponding TID will be a trigger frame when driver is in wmm power saving mode. + * + * Arguments: + * @padapter: _adapter pointer. + * @pattrib: pkt_attrib pointer. + * + * Auther: Arvin Liu + * Date: 2017/06/05 + */ +static void update_attrib_trigger_frame_info(_adapter *padapter, struct pkt_attrib *pattrib) { + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); + struct qos_priv *pqospriv = &pmlmepriv->qospriv; + u8 trigger_frame_en = 0; + + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { + if ((pwrpriv->pwr_mode == PS_MODE_MIN) || (pwrpriv->pwr_mode == PS_MODE_MAX)) { + if((pqospriv->uapsd_ap_supported) && ((pqospriv->uapsd_tid & BIT(pattrib->priority)) == _TRUE)) { + trigger_frame_en = 1; + RTW_INFO("[WMMPS]"FUNC_ADPT_FMT": This is a Trigger Frame\n", FUNC_ADPT_ARG(padapter)); + } + } + } + + pattrib->trigger_frame = trigger_frame_en; +} +#endif /* CONFIG_WMMPS_STA */ + static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta) { struct mlme_ext_priv *mlmeext = &padapter->mlmeextpriv; @@ -862,14 +928,14 @@ static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattri /* qos_en, ht_en, init rate, ,bw, ch_offset, sgi */ pattrib->qos_en = psta->qos_option; - pattrib->raid = psta->raid; + pattrib->raid = psta->cmn.ra_info.rate_id; bw = rtw_get_tx_bw_mode(padapter, psta); pattrib->bwmode = rtw_min(bw, mlmeext->cur_bwmode); pattrib->sgi = query_ra_short_GI(psta, pattrib->bwmode); - pattrib->ldpc = psta->ldpc; - pattrib->stbc = psta->stbc; + pattrib->ldpc = psta->cmn.ldpc_en; + pattrib->stbc = psta->cmn.stbc_en; #ifdef CONFIG_80211N_HT pattrib->ht_en = psta->htpriv.ht_option; @@ -880,6 +946,17 @@ static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattri pattrib->ampdu_spacing = padapter->driver_ampdu_spacing; else pattrib->ampdu_spacing = psta->htpriv.rx_ampdu_min_spacing; + + /* check if enable ampdu */ + if (pattrib->ht_en && psta->htpriv.ampdu_enable) { + if (psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) { + pattrib->ampdu_en = _TRUE; + if (psta->htpriv.tx_amsdu_enable == _TRUE) + pattrib->amsdu_ampdu_en = _TRUE; + else + pattrib->amsdu_ampdu_en = _FALSE; + } + } #endif /* CONFIG_80211N_HT */ /* if(pattrib->ht_en && psta->htpriv.ampdu_enable) */ /* { */ @@ -891,7 +968,7 @@ static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattri if (pattrib->direct_link == _TRUE) { psta = pattrib->ptdls_sta; - pattrib->raid = psta->raid; + pattrib->raid = psta->cmn.ra_info.rate_id; #ifdef CONFIG_80211N_HT pattrib->bwmode = rtw_get_tx_bw_mode(padapter, psta); pattrib->ht_en = psta->htpriv.ht_option; @@ -919,7 +996,7 @@ static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib _rtw_memset(pattrib->dot118021x_UncstKey.skey, 0, 16); _rtw_memset(pattrib->dot11tkiptxmickey.skey, 0, 16); - pattrib->mac_id = psta->mac_id; + pattrib->mac_id = psta->cmn.mac_id; if (psta->ieee8021x_blocked == _TRUE) { @@ -1163,7 +1240,7 @@ s32 update_tdls_attrib(_adapter *padapter, struct pkt_attrib *pattrib) goto exit; } - pattrib->mac_id = psta->mac_id; + pattrib->mac_id = psta->cmn.mac_id; pattrib->psta = psta; pattrib->ack_policy = 0; /* get ether_hdr_len */ @@ -1286,7 +1363,8 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr if (!(psta->state & _FW_LINKED)) { DBG_COUNTER(padapter->tx_logs.core_tx_upd_attrib_err_link); - RTW_INFO("%s-"ADPT_FMT" psta("MAC_FMT")->state(0x%x) != _FW_LINKED\n", __func__, ADPT_ARG(padapter), MAC_ARG(psta->hwaddr), psta->state); + RTW_INFO("%s-"ADPT_FMT" psta("MAC_FMT")->state(0x%x) != _FW_LINKED\n", + __func__, ADPT_ARG(padapter), MAC_ARG(psta->cmn.mac_addr), psta->state); res = _FAIL; goto exit; } @@ -1413,6 +1491,9 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr pattrib->subtype = WIFI_DATA_TYPE; pattrib->priority = 0; + if (bmcast) + pattrib->rate = psta->init_rate; + if (check_fwstate(pmlmepriv, WIFI_AP_STATE | WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { if (pattrib->qos_en) set_qos(&pktfile, pattrib); @@ -1433,6 +1514,10 @@ static s32 update_attrib(_adapter *padapter, _pkt *pkt, struct pkt_attrib *pattr } } +#ifdef CONFIG_WMMPS_STA + update_attrib_trigger_frame_info(padapter, pattrib); +#endif /* CONFIG_WMMPS_STA */ + /* pattrib->priority = 5; */ /* force to used VI queue, for testing */ pattrib->hw_ssn_sel = pxmitpriv->hw_ssn_seq_no; rtw_set_tx_chksum_offload(pkt, pattrib); @@ -1650,7 +1735,7 @@ s32 rtw_make_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) _rtw_memset(hdr, 0, WLANHDR_OFFSET); - SetFrameSubType(fctrl, pattrib->subtype); + set_frame_sub_type(fctrl, pattrib->subtype); if (pattrib->subtype & WIFI_DATA_TYPE) { if ((check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE)) { @@ -1714,6 +1799,9 @@ s32 rtw_make_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) SetEOSP(qc, pattrib->eosp); SetAckpolicy(qc, pattrib->ack_policy); + + if(pattrib->amsdu) + SetAMsdu(qc, pattrib->amsdu); } /* TODO: fill HT Control Field */ @@ -1746,12 +1834,13 @@ s32 rtw_make_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattrib) SetSeqNum(hdr, pattrib->seqnum); #ifdef CONFIG_80211N_HT +#if 0 /* move into update_attrib_phy_info(). */ /* check if enable ampdu */ if (pattrib->ht_en && psta->htpriv.ampdu_enable) { if (psta->htpriv.agg_enable_bitmap & BIT(pattrib->priority)) pattrib->ampdu_en = _TRUE; } - +#endif /* re-check if enable ampdu by BA_starting_seqctrl */ if (pattrib->ampdu_en == _TRUE) { u16 tx_seq; @@ -1857,37 +1946,53 @@ s32 rtw_txframes_sta_ac_pending(_adapter *padapter, struct pkt_attrib *pattrib) int rtw_build_tdls_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt) { + struct pkt_attrib *pattrib = &pxmitframe->attrib; + struct sta_info *ptdls_sta = NULL; int res = _SUCCESS; + ptdls_sta = rtw_get_stainfo((&padapter->stapriv), pattrib->dst); + if (ptdls_sta == NULL) { + switch (ptxmgmt->action_code) { + case TDLS_DISCOVERY_REQUEST: + case TUNNELED_PROBE_REQ: + case TUNNELED_PROBE_RSP: + break; + default: + RTW_INFO("[TDLS] %s - Direct Link Peer = "MAC_FMT" not found for action = %d\n", __func__, MAC_ARG(pattrib->dst), ptxmgmt->action_code); + res = _FAIL; + goto exit; + } + } + switch (ptxmgmt->action_code) { case TDLS_SETUP_REQUEST: - rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_setup_req_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; case TDLS_SETUP_RESPONSE: - rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_setup_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; case TDLS_SETUP_CONFIRM: - rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_setup_cfm_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; case TDLS_TEARDOWN: - rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_teardown_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; case TDLS_DISCOVERY_REQUEST: rtw_build_tdls_dis_req_ies(padapter, pxmitframe, pframe, ptxmgmt); break; case TDLS_PEER_TRAFFIC_INDICATION: - rtw_build_tdls_peer_traffic_indication_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_peer_traffic_indication_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; #ifdef CONFIG_TDLS_CH_SW case TDLS_CHANNEL_SWITCH_REQUEST: - rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_ch_switch_req_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; case TDLS_CHANNEL_SWITCH_RESPONSE: - rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_ch_switch_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; #endif case TDLS_PEER_TRAFFIC_RESPONSE: - rtw_build_tdls_peer_traffic_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt); + rtw_build_tdls_peer_traffic_rsp_ies(padapter, pxmitframe, pframe, ptxmgmt, ptdls_sta); break; #ifdef CONFIG_WFD case TUNNELED_PROBE_REQ: @@ -1902,6 +2007,7 @@ int rtw_build_tdls_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pf break; } +exit: return res; } @@ -1921,7 +2027,7 @@ s32 rtw_make_tdls_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattr _rtw_memset(hdr, 0, WLANHDR_OFFSET); - SetFrameSubType(fctrl, pattrib->subtype); + set_frame_sub_type(fctrl, pattrib->subtype); switch (ptxmgmt->action_code) { case TDLS_SETUP_REQUEST: @@ -1992,7 +2098,7 @@ s32 rtw_make_tdls_wlanhdr(_adapter *padapter , u8 *hdr, struct pkt_attrib *pattr pattrib->icv_len = 8; pattrib->bswenc = _FALSE; } - pattrib->mac_id = ptdls_sta->mac_id; + pattrib->mac_id = ptdls_sta->cmn.mac_id; } else { res = _FAIL; goto exit; @@ -2126,16 +2232,242 @@ u32 rtw_calculate_wlan_pkt_size_by_attribue(struct pkt_attrib *pattrib) { u32 len = 0; - len = pattrib->hdrlen + pattrib->iv_len; /* WLAN Header and IV */ - len += SNAP_SIZE + sizeof(u16); /* LLC */ - len += pattrib->pktlen; - if (pattrib->encrypt == _TKIP_) - len += 8; /* MIC */ - len += ((pattrib->bswenc) ? pattrib->icv_len : 0); /* ICV */ + len = pattrib->hdrlen /* WLAN Header */ + + pattrib->iv_len /* IV */ + + SNAP_SIZE + sizeof(u16) /* LLC */ + + pattrib->pktlen + + (pattrib->encrypt == _TKIP_ ? 8 : 0) /* MIC */ + + (pattrib->bswenc ? pattrib->icv_len : 0) /* ICV */ + ; return len; } +#ifdef CONFIG_TX_AMSDU +s32 check_amsdu(struct xmit_frame *pxmitframe) +{ + struct pkt_attrib *pattrib; + s32 ret = _TRUE; + + if (!pxmitframe) + ret = _FALSE; + + pattrib = &pxmitframe->attrib; + + if (IS_MCAST(pattrib->ra)) + ret = _FALSE; + + if ((pattrib->ether_type == 0x888e) || + (pattrib->ether_type == 0x0806) || + (pattrib->ether_type == 0x88b4) || + (pattrib->dhcp_pkt == 1)) + ret = _FALSE; + + if ((pattrib->encrypt == _WEP40_) || + (pattrib->encrypt == _WEP104_) || + (pattrib->encrypt == _TKIP_)) + ret = _FALSE; + + if (!pattrib->qos_en) + ret = _FALSE; + + if (IS_AMSDU_AMPDU_NOT_VALID(pattrib)) + ret = _FALSE; + + return ret; +} + +s32 check_amsdu_tx_support(_adapter *padapter) +{ + struct dvobj_priv *pdvobjpriv; + int tx_amsdu; + int tx_amsdu_rate; + int current_tx_rate; + s32 ret = _FALSE; + + pdvobjpriv = adapter_to_dvobj(padapter); + tx_amsdu = padapter->tx_amsdu; + tx_amsdu_rate = padapter->tx_amsdu_rate; + current_tx_rate = pdvobjpriv->traffic_stat.cur_tx_tp; + + if (tx_amsdu == 1) + ret = _TRUE; + else if (tx_amsdu == 2 && (tx_amsdu_rate == 0 || current_tx_rate > tx_amsdu_rate)) + ret = _TRUE; + else + ret = _FALSE; + + return ret; +} + +s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitframe, struct xmit_frame *pxmitframe_queue) +{ + + struct pkt_file pktfile; + struct pkt_attrib *pattrib; + _pkt *pkt; + + struct pkt_file pktfile_queue; + struct pkt_attrib *pattrib_queue; + _pkt *pkt_queue; + + s32 llc_sz, mem_sz; + + s32 padding = 0; + + u8 *pframe, *mem_start; + u8 hw_hdr_offset; + + u16* len; + u8 *pbuf_start; + s32 res = _SUCCESS; + + if (pxmitframe->buf_addr == NULL) { + RTW_INFO("==> %s buf_addr==NULL\n", __FUNCTION__); + return _FAIL; + } + + + pbuf_start = pxmitframe->buf_addr; + +#ifdef CONFIG_USB_TX_AGGREGATION + hw_hdr_offset = TXDESC_SIZE + (pxmitframe->pkt_offset * PACKET_OFFSET_SZ); +#else +#ifdef CONFIG_TX_EARLY_MODE /* for SDIO && Tx Agg */ + hw_hdr_offset = TXDESC_OFFSET + EARLY_MODE_INFO_SIZE; +#else + hw_hdr_offset = TXDESC_OFFSET; +#endif +#endif + + mem_start = pbuf_start + hw_hdr_offset; //for DMA + + pattrib = &pxmitframe->attrib; + + pattrib->amsdu = 1; + + if (rtw_make_wlanhdr(padapter, mem_start, pattrib) == _FAIL) { + RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n")); + RTW_INFO("rtw_xmitframe_coalesce: rtw_make_wlanhdr fail; drop pkt\n"); + res = _FAIL; + goto exit; + } + + llc_sz = 0; + + pframe = mem_start; + + //SetMFrag(mem_start); + ClearMFrag(mem_start); + + pframe += pattrib->hdrlen; + + /* adding icv, if necessary... */ + if (pattrib->iv_len) { + _rtw_memcpy(pframe, pattrib->iv, pattrib->iv_len); // queue or new? + + RT_TRACE(_module_rtl871x_xmit_c_, _drv_notice_, + ("rtw_xmitframe_coalesce: keyid=%d pattrib->iv[3]=%.2x pframe=%.2x %.2x %.2x %.2x\n", + padapter->securitypriv.dot11PrivacyKeyIndex, pattrib->iv[3], *pframe, *(pframe + 1), *(pframe + 2), *(pframe + 3))); + + pframe += pattrib->iv_len; + } + + pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->iv_len; + + if(pxmitframe_queue) + { + pattrib_queue = &pxmitframe_queue->attrib; + pkt_queue = pxmitframe_queue->pkt; + + _rtw_open_pktfile(pkt_queue, &pktfile_queue); + _rtw_pktfile_read(&pktfile_queue, NULL, pattrib_queue->pkt_hdrlen); + + /* 802.3 MAC Header DA(6) SA(6) Len(2)*/ + + _rtw_memcpy(pframe, pattrib_queue->dst, ETH_ALEN); + pframe += ETH_ALEN; + + _rtw_memcpy(pframe, pattrib_queue->src, ETH_ALEN); + pframe += ETH_ALEN; + + len = (u16*) pframe; + pframe += 2; + + llc_sz = rtw_put_snap(pframe, pattrib_queue->ether_type); + pframe += llc_sz; + + mem_sz = _rtw_pktfile_read(&pktfile_queue, pframe, pattrib_queue->pktlen); + pframe += mem_sz; + + *len = htons(llc_sz + mem_sz); + + //calc padding + padding = 4 - ((ETH_HLEN + llc_sz + mem_sz) & (4-1)); + if(padding == 4) + padding = 0; + + //_rtw_memset(pframe,0xaa, padding); + pframe += padding; + + pattrib->last_txcmdsz += ETH_HLEN + llc_sz + mem_sz + padding ; + } + + //2nd mpdu + + pkt = pxmitframe->pkt; + _rtw_open_pktfile(pkt, &pktfile); + _rtw_pktfile_read(&pktfile, NULL, pattrib->pkt_hdrlen); + + /* 802.3 MAC Header DA(6) SA(6) Len(2) */ + + _rtw_memcpy(pframe, pattrib->dst, ETH_ALEN); + pframe += ETH_ALEN; + + _rtw_memcpy(pframe, pattrib->src, ETH_ALEN); + pframe += ETH_ALEN; + + len = (u16*) pframe; + pframe += 2; + + llc_sz = rtw_put_snap(pframe, pattrib->ether_type); + pframe += llc_sz; + + mem_sz = _rtw_pktfile_read(&pktfile, pframe, pattrib->pktlen); + + pframe += mem_sz; + + *len = htons(llc_sz + mem_sz); + + //the last ampdu has no padding + padding = 0; + + pattrib->nr_frags = 1; + + pattrib->last_txcmdsz += ETH_HLEN + llc_sz + mem_sz + padding + + ((pattrib->bswenc) ? pattrib->icv_len : 0) ; + + if ((pattrib->icv_len > 0) && (pattrib->bswenc)) { + _rtw_memcpy(pframe, pattrib->icv, pattrib->icv_len); + pframe += pattrib->icv_len; + } + + if (xmitframe_addmic(padapter, pxmitframe) == _FAIL) { + RT_TRACE(_module_rtl871x_xmit_c_, _drv_err_, ("xmitframe_addmic(padapter, pxmitframe)==_FAIL\n")); + RTW_INFO("xmitframe_addmic(padapter, pxmitframe)==_FAIL\n"); + res = _FAIL; + goto exit; + } + + xmitframe_swencrypt(padapter, pxmitframe); + + pattrib->vcs_mode = NONE_VCS; + +exit: + return res; +} +#endif /* CONFIG_TX_AMSDU */ + /* This sub-routine will perform all the following: @@ -2373,7 +2705,7 @@ s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame ori_len = BIP_AAD_SIZE + pattrib->pktlen; tmp_buf = BIP_AAD = rtw_zmalloc(ori_len); - subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ + subtype = get_frame_sub_type(pframe); /* bit(7)~bit(2) */ if (BIP_AAD == NULL) return _FAIL; @@ -2394,7 +2726,7 @@ s32 rtw_mgmt_xmitframe_coalesce(_adapter *padapter, _pkt *pkt, struct xmit_frame _rtw_memset(MME, 0, _MME_IE_LENGTH_); /* other types doesn't need the BIP */ - if (GetFrameSubType(pframe) != WIFI_DEAUTH && GetFrameSubType(pframe) != WIFI_DISASSOC) + if (get_frame_sub_type(pframe) != WIFI_DEAUTH && get_frame_sub_type(pframe) != WIFI_DISASSOC) goto xmitframe_coalesce_fail; MGMT_body = pframe + sizeof(struct rtw_ieee80211_hdr_3addr); @@ -2679,13 +3011,6 @@ void rtw_count_tx_stats(PADAPTER padapter, struct xmit_frame *pxmitframe, int sz pstats->tx_pkts += pkt_num; pstats->tx_bytes += sz; -#ifdef CONFIG_TDLS - if (pxmitframe->attrib.ptdls_sta != NULL) { - pstats = &(pxmitframe->attrib.ptdls_sta->sta_stats); - pstats->tx_pkts += pkt_num; - pstats->tx_bytes += sz; - } -#endif /* CONFIG_TDLS */ } #ifdef CONFIG_CHECK_LEAVE_LPS @@ -2759,7 +3084,7 @@ struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, pcmdframe->buf_addr = pxmitbuf->pbuf; /* initial memory to zero */ - _rtw_memset(pcmdframe->buf_addr, 0, pxmitbuf->alloc_sz); + _rtw_memset(pcmdframe->buf_addr, 0, MAX_CMDBUF_SZ); pxmitbuf->priv_data = pcmdframe; @@ -3229,6 +3554,84 @@ static struct xmit_frame *dequeue_one_xmitframe(struct xmit_priv *pxmitpriv, str return pxmitframe; } +static struct xmit_frame *get_one_xmitframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit, struct tx_servq *ptxservq, _queue *pframe_queue) +{ + _list *xmitframe_plist, *xmitframe_phead; + struct xmit_frame *pxmitframe = NULL; + + xmitframe_phead = get_list_head(pframe_queue); + xmitframe_plist = get_next(xmitframe_phead); + + while ((rtw_end_of_queue_search(xmitframe_phead, xmitframe_plist)) == _FALSE) { + pxmitframe = LIST_CONTAINOR(xmitframe_plist, struct xmit_frame, list); + break; + } + + return pxmitframe; +} + +struct xmit_frame *rtw_get_xframe(struct xmit_priv *pxmitpriv, int *num_frame) +{ + _irqL irqL0; + _list *sta_plist, *sta_phead; + struct hw_xmit *phwxmit_i = pxmitpriv->hwxmits; + sint entry = pxmitpriv->hwxmit_entry; + + struct hw_xmit *phwxmit; + struct tx_servq *ptxservq = NULL; + _queue *pframe_queue = NULL; + struct xmit_frame *pxmitframe = NULL; + _adapter *padapter = pxmitpriv->adapter; + struct registry_priv *pregpriv = &padapter->registrypriv; + int i, inx[4]; + +#ifdef CONFIG_USB_HCI + /* int j, tmp, acirp_cnt[4]; */ +#endif + + inx[0] = 0; + inx[1] = 1; + inx[2] = 2; + inx[3] = 3; + + *num_frame = 0; + + /*No amsdu when wifi_spec on*/ + if (pregpriv->wifi_spec == 1) { + return NULL; + } + + _enter_critical_bh(&pxmitpriv->lock, &irqL0); + + for (i = 0; i < entry; i++) { + phwxmit = phwxmit_i + inx[i]; + + sta_phead = get_list_head(phwxmit->sta_queue); + sta_plist = get_next(sta_phead); + + while ((rtw_end_of_queue_search(sta_phead, sta_plist)) == _FALSE) { + + ptxservq = LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending); + pframe_queue = &ptxservq->sta_pending; + + if(ptxservq->qcnt) + { + *num_frame = ptxservq->qcnt; + pxmitframe = get_one_xmitframe(pxmitpriv, phwxmit, ptxservq, pframe_queue); + goto exit; + } + sta_plist = get_next(sta_plist); + } + } + +exit: + + _exit_critical_bh(&pxmitpriv->lock, &irqL0); + + return pxmitframe; +} + + struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmit *phwxmit_i, sint entry) { _irqL irqL0; @@ -3308,7 +3711,6 @@ struct xmit_frame *rtw_dequeue_xframe(struct xmit_priv *pxmitpriv, struct hw_xmi _exit_critical_bh(&pxmitpriv->lock, &irqL0); - return pxmitframe; } @@ -3359,7 +3761,7 @@ __inline static struct tx_servq *rtw_get_sta_pending #ifdef CONFIG_RTL8711 - if (IS_MCAST(psta->hwaddr)) { + if (IS_MCAST(psta->cmn.mac_addr)) { ptxservq = &(psta->sta_xmitpriv.be_q); /* we will use be_q to queue bc/mc frames in BCMC_stainfo */ *ppstapending = &padapter->xmitpriv.bm_pending; } else @@ -3783,11 +4185,6 @@ static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib) qsel = pattrib->priority; -#ifdef CONFIG_CONCURRENT_MODE - /* if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) - * qsel = 7; */ -#endif - #ifdef CONFIG_MCC_MODE if (MCC_EN(padapter)) { /* Under MCC */ @@ -3961,7 +4358,7 @@ s32 rtw_monitor_xmit_entry(struct sk_buff *skb, struct net_device *ndev) */ s32 rtw_xmit(_adapter *padapter, _pkt **ppkt) { - static u32 start = 0; + static systime start = 0; static u32 drop_cnt = 0; #ifdef CONFIG_AP_MODE _irqL irqL0; @@ -4120,7 +4517,7 @@ sint xmitframe_enqueue_for_tdls_sleeping_sta(_adapter *padapter, struct xmit_fra /* Transmit TDLS PTI via AP */ if (ptdls_sta->sleepq_len == 1) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_ISSUE_PTI); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_ISSUE_PTI); ret = _TRUE; } @@ -4143,32 +4540,31 @@ inline bool xmitframe_hiq_filter(struct xmit_frame *xmitframe) _adapter *adapter = xmitframe->padapter; struct registry_priv *registry = &adapter->registrypriv; - if (rtw_get_intf_type(adapter) != RTW_PCIE) { + if (adapter->registrypriv.wifi_spec == 1) + allow = _TRUE; + else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_SPECIAL) { - if (adapter->registrypriv.wifi_spec == 1) - allow = _TRUE; - else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_SPECIAL) { + struct pkt_attrib *attrib = &xmitframe->attrib; - struct pkt_attrib *attrib = &xmitframe->attrib; - - if (attrib->ether_type == 0x0806 - || attrib->ether_type == 0x888e + if (attrib->ether_type == 0x0806 + || attrib->ether_type == 0x888e #ifdef CONFIG_WAPI_SUPPORT - || attrib->ether_type == 0x88B4 + || attrib->ether_type == 0x88B4 #endif - || attrib->dhcp_pkt - ) { - if (0) - RTW_INFO(FUNC_ADPT_FMT" ether_type:0x%04x%s\n", FUNC_ADPT_ARG(xmitframe->padapter) - , attrib->ether_type, attrib->dhcp_pkt ? " DHCP" : ""); - allow = _TRUE; - } - } else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_ALL) + || attrib->dhcp_pkt + ) { + if (0) + RTW_INFO(FUNC_ADPT_FMT" ether_type:0x%04x%s\n", FUNC_ADPT_ARG(xmitframe->padapter) + , attrib->ether_type, attrib->dhcp_pkt ? " DHCP" : ""); allow = _TRUE; - else if (registry->hiq_filter == RTW_HIQ_FILTER_DENY_ALL) { - } else - rtw_warn_on(1); - } + } + } else if (registry->hiq_filter == RTW_HIQ_FILTER_ALLOW_ALL) + allow = _TRUE; + else if (registry->hiq_filter == RTW_HIQ_FILTER_DENY_ALL) + allow = _FALSE; + else + rtw_warn_on(1); + return allow; } @@ -4190,7 +4586,7 @@ sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *p ret = xmitframe_enqueue_for_tdls_sleeping_sta(padapter, pxmitframe); #endif /* CONFIG_TDLS */ - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _FALSE) { + if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) { DBG_COUNTER(padapter->tx_logs.core_tx_ap_enqueue_warn_fwstate); return ret; } @@ -4285,7 +4681,7 @@ sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *p if (psta->state & WIFI_SLEEP_STATE) { u8 wmmps_ac = 0; - if (pstapriv->sta_dz_bitmap & BIT(psta->aid)) { + if (pstapriv->sta_dz_bitmap & BIT(psta->cmn.aid)) { rtw_list_delete(&pxmitframe->list); /* _enter_critical_bh(&psta->sleep_q.lock, &irqL); */ @@ -4318,10 +4714,10 @@ sint xmitframe_enqueue_for_sleeping_sta(_adapter *padapter, struct xmit_frame *p psta->sleepq_ac_len++; if (((psta->has_legacy_ac) && (!wmmps_ac)) || ((!psta->has_legacy_ac) && (wmmps_ac))) { - if (!(pstapriv->tim_bitmap & BIT(psta->aid))) + if (!(pstapriv->tim_bitmap & BIT(psta->cmn.aid))) update_tim = _TRUE; - pstapriv->tim_bitmap |= BIT(psta->aid); + pstapriv->tim_bitmap |= BIT(psta->cmn.aid); /* RTW_INFO("enqueue, sq_len=%d, tim=%x\n", psta->sleepq_len, pstapriv->tim_bitmap); */ @@ -4410,7 +4806,7 @@ void stop_sta_xmit(_adapter *padapter, struct sta_info *psta) #ifdef CONFIG_TDLS if (!(psta->tdls_sta_state & TDLS_LINKED_STATE)) #endif /* CONFIG_TDLS */ - pstapriv->sta_dz_bitmap |= BIT(psta->aid); + pstapriv->sta_dz_bitmap |= BIT(psta->cmn.aid); @@ -4537,14 +4933,14 @@ void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) } #endif /* CONFIG_TDLS */ - if (pstapriv->tim_bitmap & BIT(psta->aid)) { + if (pstapriv->tim_bitmap & BIT(psta->cmn.aid)) { /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ /* upate BCN for TIM IE */ /* update_BCNTIM(padapter); */ update_mask = BIT(0); } - pstapriv->tim_bitmap &= ~BIT(psta->aid); + pstapriv->tim_bitmap &= ~BIT(psta->cmn.aid); if (psta->state & WIFI_SLEEP_STATE) psta->state ^= WIFI_SLEEP_STATE; @@ -4555,7 +4951,7 @@ void wakeup_sta_to_xmit(_adapter *padapter, struct sta_info *psta) psta->state ^= WIFI_STA_ALIVE_CHK_STATE; } - pstapriv->sta_dz_bitmap &= ~BIT(psta->aid); + pstapriv->sta_dz_bitmap &= ~BIT(psta->cmn.aid); } /* for BC/MC Frames */ @@ -4691,7 +5087,7 @@ void xmit_delivery_enabled_frames(_adapter *padapter, struct sta_info *psta) goto exit; } #endif /* CONFIG_TDLS */ - pstapriv->tim_bitmap &= ~BIT(psta->aid); + pstapriv->tim_bitmap &= ~BIT(psta->cmn.aid); /* RTW_INFO("wakeup to xmit, qlen==0, update_BCNTIM, tim=%x\n", pstapriv->tim_bitmap); */ /* upate BCN for TIM IE */ @@ -4791,7 +5187,7 @@ static struct xmit_buf *dequeue_pending_xmitbuf_under_survey( if (_rtw_queue_empty(pqueue) == _FALSE) { _list *plist, *phead; - u8 type; + u8 type = 0; phead = get_list_head(pqueue); plist = phead; @@ -4805,11 +5201,11 @@ static struct xmit_buf *dequeue_pending_xmitbuf_under_survey( #ifdef CONFIG_USB_HCI pxmitframe = (struct xmit_frame *)pxmitbuf->priv_data; if (pxmitframe) - type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_SIZE + pxmitframe->pkt_offset * PACKET_OFFSET_SZ); + type = get_frame_sub_type(pxmitbuf->pbuf + TXDESC_SIZE + pxmitframe->pkt_offset * PACKET_OFFSET_SZ); else RTW_INFO("%s, !!!ERROR!!! For USB, TODO ITEM\n", __FUNCTION__); #else - type = GetFrameSubType(pxmitbuf->pbuf + TXDESC_OFFSET); + type = get_frame_sub_type(pxmitbuf->pbuf + TXDESC_OFFSET); #endif if ((type == WIFI_PROBEREQ) || @@ -4841,7 +5237,7 @@ static struct xmit_buf *dequeue_pending_xmitbuf_ext( if (_rtw_queue_empty(pqueue) == _FALSE) { _list *plist, *phead; - u8 type; + u8 type = 0; phead = get_list_head(pqueue); plist = phead; @@ -4870,6 +5266,9 @@ struct xmit_buf *select_and_dequeue_pending_xmitbuf(_adapter *padapter) struct xmit_priv *pxmitpriv = &padapter->xmitpriv; struct xmit_buf *pxmitbuf = NULL; + if (_TRUE == rtw_is_xmit_blocked(padapter)) + return pxmitbuf; + if (rtw_xmit_ac_blocked(padapter) == _TRUE) pxmitbuf = dequeue_pending_xmitbuf_under_survey(pxmitpriv); else { @@ -4916,12 +5315,74 @@ thread_return rtw_xmit_thread(thread_context context) flush_signals_thread(); } while (_SUCCESS == err); - _rtw_up_sema(&padapter->xmitpriv.terminate_xmitthread_sema); + RTW_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(padapter)); - thread_exit(); + rtw_thread_wait_stop(); + + return 0; } #endif +#ifdef DBG_XMIT_BLOCK +void dump_xmit_block(void *sel, _adapter *padapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + RTW_PRINT_SEL(sel, "[XMIT-BLOCK] xmit_block :0x%02x\n", dvobj->xmit_block); + if (dvobj->xmit_block & XMIT_BLOCK_REDLMEM) + RTW_PRINT_SEL(sel, "Reason:%s\n", "XMIT_BLOCK_REDLMEM"); + if (dvobj->xmit_block & XMIT_BLOCK_SUSPEND) + RTW_PRINT_SEL(sel, "Reason:%s\n", "XMIT_BLOCK_SUSPEND"); + if (dvobj->xmit_block == XMIT_BLOCK_NONE) + RTW_PRINT_SEL(sel, "Reason:%s\n", "XMIT_BLOCK_NONE"); +} +void dump_xmit_block_info(void *sel, const char *fun_name, _adapter *padapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + RTW_INFO("\n"ADPT_FMT" call %s\n", ADPT_ARG(padapter), fun_name); + dump_xmit_block(sel, padapter); +} +#define DBG_XMIT_BLOCK_DUMP(adapter) dump_xmit_block_info(RTW_DBGDUMP, __func__, adapter) +#endif + +void rtw_set_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason) +{ + _irqL irqL; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + _enter_critical_bh(&dvobj->xmit_block_lock, &irqL); + dvobj->xmit_block |= reason; + _exit_critical_bh(&dvobj->xmit_block_lock, &irqL); + + #ifdef DBG_XMIT_BLOCK + DBG_XMIT_BLOCK_DUMP(padapter); + #endif +} + +void rtw_clr_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason) +{ + _irqL irqL; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + _enter_critical_bh(&dvobj->xmit_block_lock, &irqL); + dvobj->xmit_block &= ~reason; + _exit_critical_bh(&dvobj->xmit_block_lock, &irqL); + + #ifdef DBG_XMIT_BLOCK + DBG_XMIT_BLOCK_DUMP(padapter); + #endif +} +bool rtw_is_xmit_blocked(_adapter *padapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + + #ifdef DBG_XMIT_BLOCK + DBG_XMIT_BLOCK_DUMP(padapter); + #endif + return ((dvobj->xmit_block) ? _TRUE : _FALSE); +} + bool rtw_xmit_ac_blocked(_adapter *adapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); @@ -4930,6 +5391,17 @@ bool rtw_xmit_ac_blocked(_adapter *adapter) struct mlme_ext_info *mlmeextinfo; bool blocked = _FALSE; int i; +#ifdef DBG_CONFIG_ERROR_DETECT +#ifdef DBG_CONFIG_ERROR_RESET +#ifdef CONFIG_USB_HCI + if (rtw_hal_sreset_inprogress(adapter) == _TRUE) { + blocked = _TRUE; + goto exit; + } +#endif/* #ifdef CONFIG_USB_HCI */ +#endif/* #ifdef DBG_CONFIG_ERROR_RESET */ +#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ + for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; @@ -4966,6 +5438,208 @@ bool rtw_xmit_ac_blocked(_adapter *adapter) return blocked; } +#ifdef CONFIG_TX_AMSDU +void rtw_amsdu_vo_timeout_handler(void *FunctionContext) +{ + _adapter *adapter = (_adapter *)FunctionContext; + + adapter->xmitpriv.amsdu_vo_timeout = RTW_AMSDU_TIMER_TIMEOUT; + + tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); +} + +void rtw_amsdu_vi_timeout_handler(void *FunctionContext) +{ + _adapter *adapter = (_adapter *)FunctionContext; + + adapter->xmitpriv.amsdu_vi_timeout = RTW_AMSDU_TIMER_TIMEOUT; + + tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); +} + +void rtw_amsdu_be_timeout_handler(void *FunctionContext) +{ + _adapter *adapter = (_adapter *)FunctionContext; + + adapter->xmitpriv.amsdu_be_timeout = RTW_AMSDU_TIMER_TIMEOUT; + + if (printk_ratelimit()) + RTW_INFO("%s Timeout!\n",__FUNCTION__); + + tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); +} + +void rtw_amsdu_bk_timeout_handler(void *FunctionContext) +{ + _adapter *adapter = (_adapter *)FunctionContext; + + adapter->xmitpriv.amsdu_bk_timeout = RTW_AMSDU_TIMER_TIMEOUT; + + tasklet_hi_schedule(&adapter->xmitpriv.xmit_tasklet); +} + +u8 rtw_amsdu_get_timer_status(_adapter *padapter, u8 priority) +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + u8 status = RTW_AMSDU_TIMER_UNSET; + + switch(priority) + { + case 1: + case 2: + status = pxmitpriv->amsdu_bk_timeout; + break; + case 4: + case 5: + status = pxmitpriv->amsdu_vi_timeout; + break; + case 6: + case 7: + status = pxmitpriv->amsdu_vo_timeout; + break; + case 0: + case 3: + default: + status = pxmitpriv->amsdu_be_timeout; + break; + } + return status; +} + +void rtw_amsdu_set_timer_status(_adapter *padapter, u8 priority, u8 status) +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + switch(priority) + { + case 1: + case 2: + pxmitpriv->amsdu_bk_timeout = status; + break; + case 4: + case 5: + pxmitpriv->amsdu_vi_timeout = status; + break; + case 6: + case 7: + pxmitpriv->amsdu_vo_timeout = status; + break; + case 0: + case 3: + default: + pxmitpriv->amsdu_be_timeout = status; + break; + } +} + +void rtw_amsdu_set_timer(_adapter *padapter, u8 priority) +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + + _timer* amsdu_timer = NULL; + + switch(priority) + { + case 1: + case 2: + amsdu_timer = &pxmitpriv->amsdu_bk_timer; + break; + case 4: + case 5: + amsdu_timer = &pxmitpriv->amsdu_vi_timer; + break; + case 6: + case 7: + amsdu_timer = &pxmitpriv->amsdu_vo_timer; + break; + case 0: + case 3: + default: + amsdu_timer = &pxmitpriv->amsdu_be_timer; + break; + } + _set_timer(amsdu_timer, 1); +} + +void rtw_amsdu_cancel_timer(_adapter *padapter, u8 priority) +{ + struct xmit_priv *pxmitpriv = &padapter->xmitpriv; + _timer* amsdu_timer = NULL; + + switch(priority) + { + case 1: + case 2: + amsdu_timer = &pxmitpriv->amsdu_bk_timer; + break; + case 4: + case 5: + amsdu_timer = &pxmitpriv->amsdu_vi_timer; + break; + case 6: + case 7: + amsdu_timer = &pxmitpriv->amsdu_vo_timer; + break; + case 0: + case 3: + default: + amsdu_timer = &pxmitpriv->amsdu_be_timer; + break; + } + _cancel_timer_ex(amsdu_timer); +} +#endif /* CONFIG_TX_AMSDU */ + +#ifdef DBG_TXBD_DESC_DUMP +static struct rtw_tx_desc_backup tx_backup[HW_QUEUE_ENTRY][TX_BAK_FRMAE_CNT]; +static u8 backup_idx[HW_QUEUE_ENTRY]; + +void rtw_tx_desc_backup(_adapter *padapter, struct xmit_frame *pxmitframe, u8 desc_size, u8 hwq) +{ + u16 reg_rp; + u16 reg_wp; + u32 tmp32; + u8 *pxmit_buf; + + if (rtw_get_hw_init_completed(padapter) == _FALSE) + return; + + pxmit_buf = pxmitframe->pxmitbuf->pbuf; + + _rtw_memcpy(tx_backup[hwq][backup_idx[hwq]].tx_bak_desc, pxmit_buf, desc_size); + _rtw_memcpy(tx_backup[hwq][backup_idx[hwq]].tx_bak_data_hdr, pxmit_buf+desc_size, TX_BAK_DATA_LEN); + + tmp32 = rtw_read32(padapter, get_txbd_rw_reg(hwq)); + + tx_backup[hwq][backup_idx[hwq]].tx_bak_rp = (tmp32>>16)&0xfff; + tx_backup[hwq][backup_idx[hwq]].tx_bak_wp = tmp32&0xfff; + + tx_backup[hwq][backup_idx[hwq]].tx_desc_size = desc_size; + + backup_idx[hwq] = (backup_idx[hwq] + 1) % TX_BAK_FRMAE_CNT; +} + +void rtw_tx_desc_backup_reset(void) +{ + int i, j; + + for (i = 0; i < HW_QUEUE_ENTRY; i++) { + for (j = 0; j < TX_BAK_FRMAE_CNT; j++) + _rtw_memset(&tx_backup[i][j], 0, sizeof(struct rtw_tx_desc_backup)); + + backup_idx[i] = 0; + } +} + +u8 rtw_get_tx_desc_backup(_adapter *padapter, u8 hwq, struct rtw_tx_desc_backup **pbak) +{ + *pbak = &tx_backup[hwq][0]; + + return backup_idx[hwq]; +} +#endif + void rtw_sctx_init(struct submit_ctx *sctx, int timeout_ms) { sctx->timeout_ms = timeout_ms; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/HalPwrSeqCmd.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/HalPwrSeqCmd.c index de709b106eec..389785c2bfe4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/HalPwrSeqCmd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/HalPwrSeqCmd.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /*++ Copyright (c) Realtek Semiconductor Corp. All rights reserved. @@ -54,9 +49,11 @@ u8 HalPwrSeqCmdParsing( { WLAN_PWR_CFG PwrCfgCmd = {0}; u8 bPollingBit = _FALSE; + u8 bHWICSupport = _FALSE; u32 AryIdx = 0; u8 value = 0; u32 offset = 0; + u8 flag = 0; u32 pollingCount = 0; /* polling autoload done. */ u32 maxPollingCnt = 5000; @@ -111,6 +108,14 @@ u8 HalPwrSeqCmdParsing( bPollingBit = _FALSE; offset = GET_PWR_CFG_OFFSET(PwrCfgCmd); + + rtw_hal_get_hwreg(padapter, HW_VAR_PWR_CMD, &bHWICSupport); + if (bHWICSupport && offset == 0x06) { + flag = 0; + maxPollingCnt = 100000; + } else + maxPollingCnt = 5000; + #ifdef CONFIG_GSPI_HCI if (GET_PWR_CFG_BASE(PwrCfgCmd) == PWR_BASEADDR_SDIO) offset = SPI_LOCAL_OFFSET | offset; @@ -131,7 +136,26 @@ u8 HalPwrSeqCmdParsing( if (pollingCount++ > maxPollingCnt) { RTW_ERR("HalPwrSeqCmdParsing: Fail to polling Offset[%#x]=%02x\n", offset, value); - return _FALSE; + + /* For PCIE + USB package poll power bit timeout issue only modify 8821AE and 8723BE */ + if (bHWICSupport && offset == 0x06 && flag == 0) { + + RTW_ERR("[WARNING] PCIE polling(0x%X) timeout(%d), Toggle 0x04[3] and try again.\n", offset, maxPollingCnt); + if (IS_HARDWARE_TYPE_8723DE(padapter)) + PlatformEFIOWrite1Byte(padapter, 0x40, (PlatformEFIORead1Byte(padapter, 0x40)) & (~BIT3)); + + PlatformEFIOWrite1Byte(padapter, 0x04, PlatformEFIORead1Byte(padapter, 0x04) | BIT3); + PlatformEFIOWrite1Byte(padapter, 0x04, PlatformEFIORead1Byte(padapter, 0x04) & ~BIT3); + + if (IS_HARDWARE_TYPE_8723DE(padapter)) + PlatformEFIOWrite1Byte(padapter, 0x40, PlatformEFIORead1Byte(padapter, 0x40)|BIT3); + + /* Retry Polling Process one more time */ + pollingCount = 0; + flag = 1; + } else { + return _FALSE; + } } } while (!bPollingBit); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.c deleted file mode 100644 index d8d4a11fa8e2..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.c +++ /dev/null @@ -1,1987 +0,0 @@ -//============================================================ -// Description: -// -// This file is for 92CE/92CU BT 1 Antenna Co-exist mechanism -// -// By cosa 02/11/2011 -// -//============================================================ - -//============================================================ -// include files -//============================================================ -#include "Mp_Precomp.h" - -#if WPP_SOFTWARE_TRACE -#include "HalBtc8188c2Ant.tmh" -#endif - -#if(BT_30_SUPPORT == 1) -//============================================================ -// Global variables, these are static variables -//============================================================ -static COEX_DM_8188C_2ANT GLCoexDm8188c2Ant; -static PCOEX_DM_8188C_2ANT pCoexDm=&GLCoexDm8188c2Ant; -static COEX_STA_8188C_2ANT GLCoexSta8188c2Ant; -static PCOEX_STA_8188C_2ANT pCoexSta=&GLCoexSta8188c2Ant; - -//============================================================ -// local function start with btdm_ -//============================================================ -u1Byte -halbtc8188c2ant_WifiRssiState( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte index, - IN u1Byte levelNum, - IN u1Byte rssiThresh, - IN u1Byte rssiThresh1 - ) -{ - s4Byte wifiRssi=0; - u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); - - if(levelNum == 2) - { - if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) - { - if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_HIGH; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else - { - if(wifiRssi < rssiThresh) - { - wifiRssiState = BTC_RSSI_STATE_LOW; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - else if(levelNum == 3) - { - if(rssiThresh > rssiThresh1) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); - return pCoexSta->preWifiRssiState[index]; - } - - if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) - { - if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) - { - if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_HIGH; - } - else if(wifiRssi < rssiThresh) - { - wifiRssiState = BTC_RSSI_STATE_LOW; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; - } - } - else - { - if(wifiRssi < rssiThresh1) - { - wifiRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - - pCoexSta->preWifiRssiState[index] = wifiRssiState; - - return wifiRssiState; -} - -u1Byte -halbtc8188c2ant_ActionAlgorithm( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - u1Byte algorithm=BT_8188C_2ANT_COEX_ALGO_UNDEFINED; - u1Byte numOfDiffProfile=0; - - if(!pStackInfo->bBtLinkExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); - return algorithm; - } - - if(pStackInfo->bScoExist) - numOfDiffProfile++; - if(pStackInfo->bHidExist) - numOfDiffProfile++; - if(pStackInfo->bPanExist) - numOfDiffProfile++; - if(pStackInfo->bA2dpExist) - numOfDiffProfile++; - - if(pStackInfo->bScoExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); - algorithm = BT_8188C_2ANT_COEX_ALGO_SCO; - } - else - { - if(numOfDiffProfile == 1) - { - if(pStackInfo->bHidExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); - algorithm = BT_8188C_2ANT_COEX_ALGO_HID; - } - else if(pStackInfo->bA2dpExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); - algorithm = BT_8188C_2ANT_COEX_ALGO_A2DP; - } - else if(pStackInfo->bPanExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); - algorithm = BT_8188C_2ANT_COEX_ALGO_PAN; - } - } - else - { - if( pStackInfo->bHidExist && - pStackInfo->bA2dpExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); - algorithm = BT_8188C_2ANT_COEX_ALGO_HID_A2DP; - } - else if( pStackInfo->bHidExist && - pStackInfo->bPanExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); - algorithm = BT_8188C_2ANT_COEX_ALGO_HID_PAN; - } - else if( pStackInfo->bPanExist && - pStackInfo->bA2dpExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); - algorithm = BT_8188C_2ANT_COEX_ALGO_PAN_A2DP; - } - } - } - return algorithm; -} - -VOID -halbtc8188c2ant_SetFwBalance( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bBalanceOn, - IN u1Byte ms0, - IN u1Byte ms1 - ) -{ - u1Byte H2C_Parameter[3] ={0}; - - if(bBalanceOn) - { - H2C_Parameter[2] = 1; - H2C_Parameter[1] = ms1; - H2C_Parameter[0] = ms0; - } - else - { - H2C_Parameter[2] = 0; - H2C_Parameter[1] = 0; - H2C_Parameter[0] = 0; - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", - bBalanceOn?"ON":"OFF", ms0, ms1, - H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); -} - -VOID -halbtc8188c2ant_Balance( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bBalanceOn, - IN u1Byte ms0, - IN u1Byte ms1 - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", - (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); - pCoexDm->bCurBalanceOn = bBalanceOn; - - if(!bForceExec) - { - if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) - return; - } - halbtc8188c2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); - - pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; -} - -VOID -halbtc8188c2ant_SetFwDiminishWifi( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bDacOn, - IN BOOLEAN bInterruptOn, - IN u1Byte fwDacSwingLvl, - IN BOOLEAN bNavOn - ) -{ - u1Byte H2C_Parameter[3] ={0}; - - if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); - fwDacSwingLvl = 0x18; - } - - H2C_Parameter[2] = 0; - H2C_Parameter[1] = fwDacSwingLvl; - H2C_Parameter[0] = 0; - if(bDacOn) - { - H2C_Parameter[2] |= 0x01; //BIT0 - if(bInterruptOn) - { - H2C_Parameter[2] |= 0x02; //BIT1 - } - } - if(bNavOn) - { - H2C_Parameter[2] |= 0x08; //BIT3 - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0xe=0x%x\n", - (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), - (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); - pBtCoexist->fBtcFillH2c(pBtCoexist, 0xe, 3, H2C_Parameter); -} - -VOID -halbtc8188c2ant_DiminishWifi( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bDacOn, - IN BOOLEAN bInterruptOn, - IN u1Byte fwDacSwingLvl, - IN BOOLEAN bNavOn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", - (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); - - pCoexDm->bCurDacOn = bDacOn; - pCoexDm->bCurInterruptOn = bInterruptOn; - pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; - pCoexDm->bCurNavOn = bNavOn; - - if(!bForceExec) - { - if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && - (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && - (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && - (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) - return; - } - halbtc8188c2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); - - pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; - pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; - pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; - pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; -} - -VOID -halbtc8188c2ant_SetSwRfRxLpfCorner( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bRxRfShrinkOn - ) -{ - if(bRxRfShrinkOn) - { - //Shrink RF Rx LPF corner - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, 0xf); - } - else - { - //Resume RF Rx LPF corner - // After initialized, we can use pCoexDm->btRf0x1eBackup - if(pBtCoexist->bInitilized) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0, pCoexDm->btRf0x1eBackup); - } - } -} - -VOID -halbtc8188c2ant_RfShrink( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bRxRfShrinkOn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", - (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); - pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; - - if(!bForceExec) - { - if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) - return; - } - halbtc8188c2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); - - pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -} - -VOID -halbtc8188c2ant_SetSwPenaltyTxRateAdaptive( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bLowPenaltyRa - ) -{ - u1Byte tmpU1; - - tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); - if(bLowPenaltyRa) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); - tmpU1 &= ~BIT2; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); - tmpU1 |= BIT2; - } - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -} - -VOID -halbtc8188c2ant_LowPenaltyRa( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bLowPenaltyRa - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", - (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); - pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; - - if(!bForceExec) - { - if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) - return; - } - halbtc8188c2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); - - pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -} - -VOID -halbtc8188c2ant_SetSwFullTimeDacSwing( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bSwDacSwingOn, - IN u4Byte swDacSwingLvl - ) -{ - u4Byte dacSwingLvl; - - if(bSwDacSwingOn) - { - if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) - { - dacSwingLvl = 0x18; - } - else - { - dacSwingLvl = swDacSwingLvl; - } - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); - } - else - { - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); - } -} - -VOID -halbtc8188c2ant_DacSwing( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bDacSwingOn, - IN u4Byte dacSwingLvl - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", - (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); - pCoexDm->bCurDacSwingOn = bDacSwingOn; - pCoexDm->curDacSwingLvl = dacSwingLvl; - - if(!bForceExec) - { - if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && - (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) - return; - } - delay_ms(30); - halbtc8188c2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); - - pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; - pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -} - -VOID -halbtc8188c2ant_SetAdcBackOff( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bAdcBackOff - ) -{ - if(bAdcBackOff) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); - } -} - -VOID -halbtc8188c2ant_AdcBackOff( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bAdcBackOff - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", - (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); - pCoexDm->bCurAdcBackOff = bAdcBackOff; - - if(!bForceExec) - { - if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) - return; - } - halbtc8188c2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); - - pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -} - -VOID -halbtc8188c2ant_SetAgcTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bAgcTableEn - ) -{ - u1Byte rssiAdjustVal=0; - - if(bAgcTableEn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); - - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00255); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); - - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x10255); - } - - // set rssiAdjustVal for wifi module. - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -} - - -VOID -halbtc8188c2ant_AgcTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bAgcTableEn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", - (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); - pCoexDm->bCurAgcTableEn = bAgcTableEn; - - if(!bForceExec) - { - if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) - return; - } - halbtc8188c2ant_SetAgcTable(pBtCoexist, bAgcTableEn); - - pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -} - -VOID -halbtc8188c2ant_SetCoexTable( - IN PBTC_COEXIST pBtCoexist, - IN u4Byte val0x6c4, - IN u4Byte val0x6c8, - IN u4Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); -} - -VOID -halbtc8188c2ant_CoexTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN u4Byte val0x6c4, - IN u4Byte val0x6c8, - IN u4Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", - (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); - pCoexDm->curVal0x6c4 = val0x6c4; - pCoexDm->curVal0x6c8 = val0x6c8; - pCoexDm->curVal0x6cc = val0x6cc; - - if(!bForceExec) - { - if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && - (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && - (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) - return; - } - halbtc8188c2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); - - pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; - pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; - pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -} - -VOID -halbtc8188c2ant_CoexAllOff( - IN PBTC_COEXIST pBtCoexist - ) -{ - // fw mechanism - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -} -VOID -halbtc8188c2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ -} - - -VOID -halbtc8188c2ant_MonitorBtState( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN stateChange=FALSE; - u4Byte BT_Polling, Ratio_Act, Ratio_STA; - u4Byte BT_Active, BT_State; - u4Byte regBTActive=0, regBTState=0, regBTPolling=0; - u4Byte btBusyThresh=0; - u4Byte fwVer=0; - static BOOLEAN bBtBusyTraffic=FALSE; - BOOLEAN bRejApAggPkt=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); - if(fwVer < 62) - { - regBTActive = 0x488; - regBTState = 0x48c; - regBTPolling = 0x490; - } - else - { - regBTActive = 0x444; - regBTState = 0x448; - if(fwVer >= 74) - regBTPolling = 0x44c; - else - regBTPolling = 0x700; - } - btBusyThresh = 60; - - BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); - BT_Active = BT_Active & 0x00ffffff; - - BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); - BT_State = BT_State & 0x00ffffff; - - BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); - - if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) - return; - - // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running - // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f - // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to - // HW divide trap. - if (BT_Polling==0) - return; - - Ratio_Act = BT_Active*1000/BT_Polling; - Ratio_STA = BT_State*1000/BT_Polling; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); - - if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - if(Ratio_STA < 60) // BT PAN idle - { - } - else - { - // Check if BT PAN (under BT 2.1) is uplink or downlink - if((Ratio_Act/Ratio_STA) < 2) - { // BT PAN Uplink - pCoexSta->bBtUplink = TRUE; - } - else - { // BT PAN downlink - pCoexSta->bBtUplink = FALSE; - } - } - } - - // Check BT is idle or not - if(!pBtCoexist->stackInfo.bBtLinkExist) - { - pCoexSta->bBtBusy = FALSE; - } - else - { - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - if(Ratio_Act<20) - { - pCoexSta->bBtBusy = FALSE; - } - else - { - pCoexSta->bBtBusy = TRUE; - } - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - if(Ratio_STA < btBusyThresh) - { - pCoexSta->bBtBusy = FALSE; - } - else - { - pCoexSta->bBtBusy = TRUE; - } - - if( (Ratio_STA < btBusyThresh) || - (Ratio_Act<180 && Ratio_STA<130) ) - { - pCoexSta->bA2dpBusy = FALSE; - } - else - { - pCoexSta->bA2dpBusy = TRUE; - } - } - } - - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); - - if(bBtBusyTraffic != pCoexSta->bBtBusy) - { // BT idle or BT non-idle - bBtBusyTraffic = pCoexSta->bBtBusy; - stateChange = TRUE; - } - - if(stateChange) - { - if(!pCoexSta->bBtBusy) - { - halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_CoexAllOff(pBtCoexist); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - } - else - { - halbtc8188c2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); - } - } - - if(stateChange) - { - bRejApAggPkt = pCoexSta->bBtBusy; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); - } -} - -VOID -halbtc8188c2ant_ActionA2dpBc4( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState; - u4Byte wifiBw, wifiTrafficDir; - - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - - if(pCoexSta->bBtBusy) - { - if(BTC_WIFI_BW_HT40 == wifiBw) - { - // fw mechanism first - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - } - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - } - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - } - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } -} - -VOID -halbtc8188c2ant_ActionA2dpBc8( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState; - u4Byte wifiBw, wifiTrafficDir; - BOOLEAN bWifiBusy=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - if(pCoexSta->bA2dpBusy && bWifiBusy) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - - // fw mechanism first - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - - // sw mechanism - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - } - else if(pCoexSta->bA2dpBusy) - { - // fw mechanism first - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } -} - -VOID -halbtc8188c2ant_ActionA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionA2dpBc4(pBtCoexist); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionA2dpBc8(pBtCoexist); - } -} - -VOID -halbtc8188c2ant_ActionPanBc4( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - if(bBtHsOn) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - else - { - if(pCoexSta->bBtBusy && bWifiBusy) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - } - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -} - -VOID -halbtc8188c2ant_ActionPanBc8( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState; - u4Byte wifiBw, wifiTrafficDir; - s4Byte wifiRssi; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); - - if(bBtHsOn) - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } - else - { - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); - - if(pCoexSta->bBtBusy && bWifiBusy) - { - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - // fw mechanism first - if(pCoexSta->bBtUplink) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - } - // sw mechanism - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - if(pCoexSta->bBtUplink) - { - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - } - else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || - (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) - { - // fw mechanism first - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); - - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - if(BTC_WIFI_BW_HT40 == wifiBw) - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); - else - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - // sw mechanism - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - // fw mechanism first - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); - - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - if(pCoexSta->bBtUplink) - { - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); - } - else - { - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - } - else - { - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - } - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else if(pCoexSta->bBtBusy && !bWifiBusy && (wifiRssi < 30)) - { - // fw mechanism first - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } - } -} - -VOID -halbtc8188c2ant_ActionPan( - IN PBTC_COEXIST pBtCoexist - ) -{ - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionPanBc4(pBtCoexist); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionPanBc8(pBtCoexist); - } -} - -VOID -halbtc8188c2ant_ActionHid( - IN PBTC_COEXIST pBtCoexist - ) -{ - u4Byte wifiBw, wifiTrafficDir; - BOOLEAN bWifiBusy=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - if(BTC_WIFI_BW_LEGACY == wifiBw) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else if(!bWifiBusy) - { - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -} - - -VOID -halbtc8188c2ant_ActionSco( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState; - u4Byte wifiBw; - - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - - // fw mechanism - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - // fw mechanism first - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - // fw mechanism first - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - } -} - -VOID -halbtc8188c2ant_ActionHidA2dpBc4( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState; - u4Byte wifiBw, wifiTrafficDir; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - - if(pCoexSta->bBtBusy) - { - if(BTC_WIFI_BW_HT40 == wifiBw) - { - // fw mechanism first - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - } - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else - { - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - // fw mechanism first - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x7, 0x20); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - } - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - } - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } -} -VOID -halbtc8188c2ant_ActionHidA2dpBc8( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState; - u4Byte wifiBw; - - if(pCoexSta->bBtBusy) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - // fw mechanism first - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else - { - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - // fw mechanism - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - } - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } -} - -VOID -halbtc8188c2ant_ActionHidA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionHidA2dpBc4(pBtCoexist); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionHidA2dpBc8(pBtCoexist); - } -} - -VOID -halbtc8188c2ant_ActionHidPanBc4( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u4Byte wifiBw, wifiTrafficDir; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - if(bBtHsOn) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - if(BTC_WIFI_BW_LEGACY == wifiBw) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(!bWifiBusy) - { - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - } - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -} -VOID -halbtc8188c2ant_ActionHidPanBc8( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState; - u4Byte wifiBw, wifiTrafficDir; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - if(!bBtHsOn) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); - if((pCoexSta->bBtBusy && bWifiBusy)) - { - // fw mechanism first - if(pCoexSta->bBtUplink) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); - } - else - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); - } - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } - } - else - { - if(BTC_INTF_USB == pBtCoexist->chipInterface) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8188c2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - } - else - { - if(pCoexSta->bBtBusy) - { - // fw mechanism - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - } -} - -VOID -halbtc8188c2ant_ActionHidPan( - IN PBTC_COEXIST pBtCoexist - ) -{ - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionHidPanBc4(pBtCoexist); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionHidPanBc8(pBtCoexist); - } -} - -VOID -halbtc8188c2ant_ActionPanA2dpBc4( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - if(bBtHsOn) - { - if(pCoexSta->bBtBusy) - { - // fw mechanism - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } - } - else - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - if(pCoexSta->bBtBusy && bWifiBusy) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } -} -VOID -halbtc8188c2ant_ActionPanA2dpBc8( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState; - u4Byte wifiBw; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - if(!bBtHsOn) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - wifiRssiState = halbtc8188c2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); - if((pCoexSta->bBtBusy && bWifiBusy)) - { - // fw mechanism first - if(pCoexSta->bBtUplink) - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); - } - else - { - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); - } - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } - } - else - { - if(pCoexSta->bBtBusy) - { - // fw mechanism - halbtc8188c2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8188c2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8188c2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - halbtc8188c2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } -} - -VOID -halbtc8188c2ant_ActionPanA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionPanA2dpBc4(pBtCoexist); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - halbtc8188c2ant_ActionPanA2dpBc8(pBtCoexist); - } -} - -//============================================================ -// extern function start with EXhalbtc8188c2ant_ -//============================================================ -VOID -EXhalbtc8188c2ant_PowerOnSetting( - IN PBTC_COEXIST pBtCoexist - ) -{ -} - -VOID -EXhalbtc8188c2ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bWifiOnly - ) -{ - u1Byte u1Tmp=0; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); - - // backup rf 0x1e value - pCoexDm->btRf0x1eBackup = - pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xf0); - - if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || - (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) - { - u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); - - halbtc8188c2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); - } -} - -VOID -EXhalbtc8188c2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); - - halbtc8188c2ant_InitCoexDm(pBtCoexist); -} - -VOID -EXhalbtc8188c2ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - pu1Byte cliBuf=pBtCoexist->cliBuf; - u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; - u4Byte u4Tmp[4]; - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ - pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); - CL_PRINTF(cliBuf); - - if(pBtCoexist->bManualControl) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); - CL_PRINTF(cliBuf); - } - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ - ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); - CL_PRINTF(cliBuf); - - // wifi status - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); - CL_PRINTF(cliBuf); - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); - CL_PRINTF(cliBuf); - - if(pStackInfo->bProfileNotified) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ - pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); - } - - // Sw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); - CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ - pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); - CL_PRINTF(cliBuf); - - // Fw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); - CL_PRINTF(cliBuf); - - // Hw setting - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ - pCoexDm->btRf0x1eBackup); - CL_PRINTF(cliBuf); - - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ - u1Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); - u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); - u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ - u4Tmp[0], u4Tmp[1], u4Tmp[2]); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -VOID -EXhalbtc8188c2ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_IPS_ENTER == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } - else if(BTC_IPS_LEAVE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); - //halbtc8188c2ant_InitCoexDm(pBtCoexist); - } -} - -VOID -EXhalbtc8188c2ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_LPS_ENABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); - halbtc8188c2ant_CoexAllOff(pBtCoexist); - } - else if(BTC_LPS_DISABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); - halbtc8188c2ant_InitCoexDm(pBtCoexist); - } -} - -VOID -EXhalbtc8188c2ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_SCAN_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); - } - else if(BTC_SCAN_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); - } -} - -VOID -EXhalbtc8188c2ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_ASSOCIATE_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); - } - else if(BTC_ASSOCIATE_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); - } -} - -VOID -EXhalbtc8188c2ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_MEDIA_CONNECT == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); - } - -} - -VOID -EXhalbtc8188c2ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(type == BTC_PACKET_DHCP) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); - } -} - -VOID -EXhalbtc8188c2ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ) -{ -} - -VOID -EXhalbtc8188c2ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); - - EXhalbtc8188c2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -} - -VOID -EXhalbtc8188c2ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte algorithm; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); - - // NOTE: - // sw mechanism must be done after fw mechanism - // - - if((BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || - (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) - { - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); - - halbtc8188c2ant_MonitorBtState(pBtCoexist); - algorithm = halbtc8188c2ant_ActionAlgorithm(pBtCoexist); - pCoexDm->curAlgorithm = algorithm; - switch(pCoexDm->curAlgorithm) - { - case BT_8188C_2ANT_COEX_ALGO_SCO: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); - halbtc8188c2ant_ActionSco(pBtCoexist); - break; - case BT_8188C_2ANT_COEX_ALGO_HID: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); - halbtc8188c2ant_ActionHid(pBtCoexist); - break; - case BT_8188C_2ANT_COEX_ALGO_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); - halbtc8188c2ant_ActionA2dp(pBtCoexist); - break; - case BT_8188C_2ANT_COEX_ALGO_PAN: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); - halbtc8188c2ant_ActionPan(pBtCoexist); - break; - case BT_8188C_2ANT_COEX_ALGO_HID_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); - halbtc8188c2ant_ActionHidA2dp(pBtCoexist); - break; - case BT_8188C_2ANT_COEX_ALGO_HID_PAN: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); - halbtc8188c2ant_ActionHidPan(pBtCoexist); - break; - case BT_8188C_2ANT_COEX_ALGO_PAN_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); - halbtc8188c2ant_ActionPanA2dp(pBtCoexist); - break; - default: - break; - } - } -} - - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.h deleted file mode 100644 index ce7ec564414f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8188c2Ant.h +++ /dev/null @@ -1,149 +0,0 @@ -//=========================================== -// The following is for 8188C 2Ant BT Co-exist definition -//=========================================== -#define BTC_RSSI_COEX_THRESH_TOL_8188C_2ANT 6 - -typedef enum _BT_INFO_SRC_8188C_2ANT{ - BT_INFO_SRC_8188C_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8188C_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8188C_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8188C_2ANT_MAX -}BT_INFO_SRC_8188C_2ANT,*PBT_INFO_SRC_8188C_2ANT; - -typedef enum _BT_8188C_2ANT_BT_STATUS{ - BT_8188C_2ANT_BT_STATUS_IDLE = 0x0, - BT_8188C_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8188C_2ANT_BT_STATUS_NON_IDLE = 0x2, - BT_8188C_2ANT_BT_STATUS_MAX -}BT_8188C_2ANT_BT_STATUS,*PBT_8188C_2ANT_BT_STATUS; - -typedef enum _BT_8188C_2ANT_COEX_ALGO{ - BT_8188C_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8188C_2ANT_COEX_ALGO_SCO = 0x1, - BT_8188C_2ANT_COEX_ALGO_HID = 0x2, - BT_8188C_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8188C_2ANT_COEX_ALGO_PAN = 0x4, - BT_8188C_2ANT_COEX_ALGO_HID_A2DP = 0x5, - BT_8188C_2ANT_COEX_ALGO_HID_PAN = 0x6, - BT_8188C_2ANT_COEX_ALGO_PAN_A2DP = 0x7, - BT_8188C_2ANT_COEX_ALGO_MAX -}BT_8188C_2ANT_COEX_ALGO,*PBT_8188C_2ANT_COEX_ALGO; - -typedef struct _COEX_DM_8188C_2ANT{ - // fw mechanism - BOOLEAN bPreBalanceOn; - BOOLEAN bCurBalanceOn; - - // diminishWifi - BOOLEAN bPreDacOn; - BOOLEAN bCurDacOn; - BOOLEAN bPreInterruptOn; - BOOLEAN bCurInterruptOn; - u1Byte preFwDacSwingLvl; - u1Byte curFwDacSwingLvl; - BOOLEAN bPreNavOn; - BOOLEAN bCurNavOn; - - // sw mechanism - BOOLEAN bPreRfRxLpfShrink; - BOOLEAN bCurRfRxLpfShrink; - u4Byte btRf0x1eBackup; - BOOLEAN bPreLowPenaltyRa; - BOOLEAN bCurLowPenaltyRa; - BOOLEAN bPreDacSwingOn; - u4Byte preDacSwingLvl; - BOOLEAN bCurDacSwingOn; - u4Byte curDacSwingLvl; - BOOLEAN bPreAdcBackOff; - BOOLEAN bCurAdcBackOff; - BOOLEAN bPreAgcTableEn; - BOOLEAN bCurAgcTableEn; - //u4Byte preVal0x6c0; - //u4Byte curVal0x6c0; - u4Byte preVal0x6c4; - u4Byte curVal0x6c4; - u4Byte preVal0x6c8; - u4Byte curVal0x6c8; - u4Byte preVal0x6cc; - u4Byte curVal0x6cc; - //BOOLEAN bLimitedDig; - - // algorithm related - u1Byte preAlgorithm; - u1Byte curAlgorithm; - //u1Byte btStatus; - //u1Byte wifiChnlInfo[3]; -} COEX_DM_8188C_2ANT, *PCOEX_DM_8188C_2ANT; - -typedef struct _COEX_STA_8188C_2ANT{ - u1Byte preWifiRssiState[4]; - BOOLEAN bBtBusy; - BOOLEAN bBtUplink; - BOOLEAN bBtDownLink; - BOOLEAN bA2dpBusy; -}COEX_STA_8188C_2ANT, *PCOEX_STA_8188C_2ANT; - -//=========================================== -// The following is interface which will notify coex module. -//=========================================== -VOID -EXhalbtc8188c2ant_PowerOnSetting( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8188c2ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bWifiOnly - ); -VOID -EXhalbtc8188c2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8188c2ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8188c2ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8188c2ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8188c2ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8188c2ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8188c2ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8188c2ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8188c2ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8188c2ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ); -VOID -EXhalbtc8188c2ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.c deleted file mode 100644 index 239c073c1b8b..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.c +++ /dev/null @@ -1,1992 +0,0 @@ -//============================================================ -// Description: -// -// This file is for 92D BT 2 Antenna Co-exist mechanism -// -// By cosa 02/11/2011 -// -//============================================================ - -//============================================================ -// include files -//============================================================ -#include "Mp_Precomp.h" - -#if WPP_SOFTWARE_TRACE -#include "HalBtc8192d2Ant.tmh" -#endif - -#if(BT_30_SUPPORT == 1) -//============================================================ -// Global variables, these are static variables -//============================================================ -static COEX_DM_8192D_2ANT GLCoexDm8192d2Ant; -static PCOEX_DM_8192D_2ANT pCoexDm=&GLCoexDm8192d2Ant; -static COEX_STA_8192D_2ANT GLCoexSta8192d2Ant; -static PCOEX_STA_8192D_2ANT pCoexSta=&GLCoexSta8192d2Ant; - -//============================================================ -// local function start with btdm_ -//============================================================ -u1Byte -halbtc8192d2ant_WifiRssiState( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte index, - IN u1Byte levelNum, - IN u1Byte rssiThresh, - IN u1Byte rssiThresh1 - ) -{ - s4Byte wifiRssi=0; - u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); - - if(levelNum == 2) - { - if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) - { - if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_HIGH; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else - { - if(wifiRssi < rssiThresh) - { - wifiRssiState = BTC_RSSI_STATE_LOW; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - else if(levelNum == 3) - { - if(rssiThresh > rssiThresh1) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); - return pCoexSta->preWifiRssiState[index]; - } - - if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) - { - if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) - { - if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_HIGH; - } - else if(wifiRssi < rssiThresh) - { - wifiRssiState = BTC_RSSI_STATE_LOW; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; - } - } - else - { - if(wifiRssi < rssiThresh1) - { - wifiRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - - pCoexSta->preWifiRssiState[index] = wifiRssiState; - - return wifiRssiState; -} - -u1Byte -halbtc8192d2ant_ActionAlgorithm( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - BOOLEAN bBtHsOn=FALSE; - u1Byte algorithm=BT_8192D_2ANT_COEX_ALGO_UNDEFINED; - u1Byte numOfDiffProfile=0; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - if(!pStackInfo->bBtLinkExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); - return algorithm; - } - - if(pStackInfo->bScoExist) - numOfDiffProfile++; - if(pStackInfo->bHidExist) - numOfDiffProfile++; - if(pStackInfo->bPanExist) - numOfDiffProfile++; - if(pStackInfo->bA2dpExist) - numOfDiffProfile++; - - if(pStackInfo->bScoExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO algorithm\n")); - algorithm = BT_8192D_2ANT_COEX_ALGO_SCO; - } - else - { - if(numOfDiffProfile == 1) - { - if(pStackInfo->bHidExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); - algorithm = BT_8192D_2ANT_COEX_ALGO_HID; - } - else if(pStackInfo->bA2dpExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); - algorithm = BT_8192D_2ANT_COEX_ALGO_A2DP; - } - else if(pStackInfo->bPanExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN only\n")); - algorithm = BT_8192D_2ANT_COEX_ALGO_PAN; - } - } - else - { - if( pStackInfo->bHidExist && - pStackInfo->bA2dpExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); - algorithm = BT_8192D_2ANT_COEX_ALGO_HID_A2DP; - } - else if( pStackInfo->bHidExist && - pStackInfo->bPanExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN\n")); - algorithm = BT_8192D_2ANT_COEX_ALGO_HID_PAN; - } - else if( pStackInfo->bPanExist && - pStackInfo->bA2dpExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN + A2DP\n")); - algorithm = BT_8192D_2ANT_COEX_ALGO_PAN_A2DP; - } - } - } - return algorithm; -} - -VOID -halbtc8192d2ant_SetFwBalance( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bBalanceOn, - IN u1Byte ms0, - IN u1Byte ms1 - ) -{ - u1Byte H2C_Parameter[3] ={0}; - - if(bBalanceOn) - { - H2C_Parameter[2] = 1; - H2C_Parameter[1] = ms1; - H2C_Parameter[0] = ms0; - } - else - { - H2C_Parameter[2] = 0; - H2C_Parameter[1] = 0; - H2C_Parameter[0] = 0; - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Balance=[%s:%dms:%dms], write 0xc=0x%x\n", - bBalanceOn?"ON":"OFF", ms0, ms1, - H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0xc, 3, H2C_Parameter); -} - -VOID -halbtc8192d2ant_Balance( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bBalanceOn, - IN u1Byte ms0, - IN u1Byte ms1 - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Balance %s\n", - (bForceExec? "force to":""), (bBalanceOn? "ON":"OFF"))); - pCoexDm->bCurBalanceOn = bBalanceOn; - - if(!bForceExec) - { - if(pCoexDm->bPreBalanceOn == pCoexDm->bCurBalanceOn) - return; - } - halbtc8192d2ant_SetFwBalance(pBtCoexist, bBalanceOn, ms0, ms1); - - pCoexDm->bPreBalanceOn = pCoexDm->bCurBalanceOn; -} - -VOID -halbtc8192d2ant_SetFwDiminishWifi( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bDacOn, - IN BOOLEAN bInterruptOn, - IN u1Byte fwDacSwingLvl, - IN BOOLEAN bNavOn - ) -{ - u1Byte H2C_Parameter[3] ={0}; - - if((pBtCoexist->stackInfo.minBtRssi <= -5) && (fwDacSwingLvl == 0x20)) - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], DiminishWiFi 0x20 original, but set 0x18 for Low RSSI!\n")); - fwDacSwingLvl = 0x18; - } - - H2C_Parameter[2] = 0; - H2C_Parameter[1] = fwDacSwingLvl; - H2C_Parameter[0] = 0; - if(bDacOn) - { - H2C_Parameter[2] |= 0x01; //BIT0 - if(bInterruptOn) - { - H2C_Parameter[2] |= 0x02; //BIT1 - } - } - if(bNavOn) - { - H2C_Parameter[2] |= 0x08; //BIT3 - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], bDacOn=%s, bInterruptOn=%s, bNavOn=%s, write 0x12=0x%x\n", - (bDacOn?"ON":"OFF"), (bInterruptOn?"ON":"OFF"), (bNavOn?"ON":"OFF"), - (H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2]))); - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x12, 3, H2C_Parameter); -} - - -VOID -halbtc8192d2ant_DiminishWifi( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bDacOn, - IN BOOLEAN bInterruptOn, - IN u1Byte fwDacSwingLvl, - IN BOOLEAN bNavOn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set Diminish Wifi, bDacOn=%s, bInterruptOn=%s, fwDacSwingLvl=%d, bNavOn=%s\n", - (bForceExec? "force to":""), (bDacOn? "ON":"OFF"), (bInterruptOn? "ON":"OFF"), fwDacSwingLvl, (bNavOn? "ON":"OFF"))); - - pCoexDm->bCurDacOn = bDacOn; - pCoexDm->bCurInterruptOn = bInterruptOn; - pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; - pCoexDm->bCurNavOn = bNavOn; - - if(!bForceExec) - { - if( (pCoexDm->bPreDacOn==pCoexDm->bCurDacOn) && - (pCoexDm->bPreInterruptOn==pCoexDm->bCurInterruptOn) && - (pCoexDm->preFwDacSwingLvl==pCoexDm->curFwDacSwingLvl) && - (pCoexDm->bPreNavOn==pCoexDm->bCurNavOn) ) - return; - } - halbtc8192d2ant_SetFwDiminishWifi(pBtCoexist, bDacOn, bInterruptOn, fwDacSwingLvl, bNavOn); - - pCoexDm->bPreDacOn = pCoexDm->bCurDacOn; - pCoexDm->bPreInterruptOn = pCoexDm->bCurInterruptOn; - pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; - pCoexDm->bPreNavOn = pCoexDm->bCurNavOn; -} - -VOID -halbtc8192d2ant_SetSwRfRxLpfCorner( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bRxRfShrinkOn - ) -{ - if(bRxRfShrinkOn) - { - //Shrink RF Rx LPF corner - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf2ff7); - } - else - { - //Resume RF Rx LPF corner - // After initialized, we can use pCoexDm->btRf0x1eBackup - if(pBtCoexist->bInitilized) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); - } - } -} - - -VOID -halbtc8192d2ant_RfShrink( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bRxRfShrinkOn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", - (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); - pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; - - if(!bForceExec) - { - if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) - return; - } - halbtc8192d2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); - - pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -} - -VOID -halbtc8192d2ant_SetSwPenaltyTxRateAdaptive( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bLowPenaltyRa - ) -{ - u1Byte tmpU1; - - tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); - if(bLowPenaltyRa) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); - tmpU1 &= ~BIT2; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); - tmpU1 |= BIT2; - } - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -} - -VOID -halbtc8192d2ant_LowPenaltyRa( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bLowPenaltyRa - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", - (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); - pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; - - if(!bForceExec) - { - if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) - return; - } - halbtc8192d2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); - - pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -} - -VOID -halbtc8192d2ant_SetSwFullTimeDacSwing( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bSwDacSwingOn, - IN u4Byte swDacSwingLvl - ) -{ - u4Byte dacSwingLvl; - - if(bSwDacSwingOn) - { - if((pBtCoexist->stackInfo.minBtRssi <= -5) && (swDacSwingLvl == 0x20)) - { - dacSwingLvl = 0x18; - } - else - { - dacSwingLvl = swDacSwingLvl; - } - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, dacSwingLvl); - } - else - { - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xfc000000, 0x30); - } -} - -VOID -halbtc8192d2ant_DacSwing( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bDacSwingOn, - IN u4Byte dacSwingLvl - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", - (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); - pCoexDm->bCurDacSwingOn = bDacSwingOn; - pCoexDm->curDacSwingLvl = dacSwingLvl; - - if(!bForceExec) - { - if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && - (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) - return; - } - delay_ms(30); - halbtc8192d2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); - - pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; - pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -} - -VOID -halbtc8192d2ant_SetAdcBackOff( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bAdcBackOff - ) -{ - if(bAdcBackOff) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); - } -} - -VOID -halbtc8192d2ant_AdcBackOff( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bAdcBackOff - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", - (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); - pCoexDm->bCurAdcBackOff = bAdcBackOff; - - if(!bForceExec) - { - if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) - return; - } - halbtc8192d2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); - - pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -} - -VOID -halbtc8192d2ant_SetAgcTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bAgcTableEn - ) -{ - u1Byte rssiAdjustVal=0; - - if(bAgcTableEn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0xa99); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xd4000); - - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b000001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b010001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b020001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b030001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b040001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b050001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b060001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b070001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b080001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b090001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0A0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7b0B0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7a0C0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x790D0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x780E0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770F0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x76100001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x75110001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x74120001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x73130001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x72140001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71150001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70160001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6f170001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6e180001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6d190001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6c1A0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6b1B0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6a1C0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x691D0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4f1E0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4e1F0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4d200001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4c210001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4b220001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x4a230001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49240001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48250001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47260001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46270001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45280001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44290001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x432A0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x422B0001); - - rssiAdjustVal = 12; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30a99); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); - - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B000001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B010001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B020001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B030001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B040001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B050001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7B060001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x7A070001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x79080001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x78090001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x770A0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x760B0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x750C0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x740D0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x730E0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x720F0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x71100001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x70110001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6F120001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6E130001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6D140001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6C150001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6B160001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x6A170001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x69180001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x68190001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x671A0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x661B0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x651C0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x641D0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x631E0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x621F0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x61200001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x60210001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x49220001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x48230001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x47240001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x46250001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x45260001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x44270001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x43280001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x42290001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x412A0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78, 0x402B0001); - } - - // set rssiAdjustVal for wifi module. - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -} - - - -VOID -halbtc8192d2ant_AgcTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bAgcTableEn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", - (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); - pCoexDm->bCurAgcTableEn = bAgcTableEn; - - if(!bForceExec) - { - if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) - return; - } - halbtc8192d2ant_SetAgcTable(pBtCoexist, bAgcTableEn); - - pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -} - -VOID -halbtc8192d2ant_SetCoexTable( - IN PBTC_COEXIST pBtCoexist, - IN u4Byte val0x6c4, - IN u4Byte val0x6c8, - IN u4Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, val0x6c4); - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6cc, val0x6cc); -} - -VOID -halbtc8192d2ant_CoexTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN u4Byte val0x6c4, - IN u4Byte val0x6c8, - IN u4Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", - (bForceExec? "force to":""), val0x6c4, val0x6c8, val0x6cc)); - pCoexDm->curVal0x6c4 = val0x6c4; - pCoexDm->curVal0x6c8 = val0x6c8; - pCoexDm->curVal0x6cc = val0x6cc; - - if(!bForceExec) - { - if( (pCoexDm->preVal0x6c4 == pCoexDm->curVal0x6c4) && - (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && - (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) - return; - } - halbtc8192d2ant_SetCoexTable(pBtCoexist, val0x6c4, val0x6c8, val0x6cc); - - pCoexDm->preVal0x6c4 = pCoexDm->curVal0x6c4; - pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; - pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -} - -VOID -halbtc8192d2ant_CoexAllOff( - IN PBTC_COEXIST pBtCoexist - ) -{ - // fw mechanism - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -} -VOID -halbtc8192d2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ -} - -VOID -halbtc8192d2ant_MonitorBtEnableDisable( - IN PBTC_COEXIST pBtCoexist, - IN u4Byte btActive - ) -{ - static BOOLEAN bPreBtDisabled=FALSE; - static u4Byte btDisableCnt=0; - BOOLEAN bBtDisabled=FALSE, bForceToRoam=FALSE; - u4Byte u4Tmp=0; - - // This function check if bt is disabled - if(btActive) - { - btDisableCnt = 0; - bBtDisabled = FALSE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); - } - else - { - btDisableCnt++; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", - btDisableCnt)); - if(btDisableCnt >= 2) - { - bBtDisabled = TRUE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); - } - } - if(bPreBtDisabled != bBtDisabled) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", - (bPreBtDisabled ? "disabled":"enabled"), - (bBtDisabled ? "disabled":"enabled"))); - - bForceToRoam = TRUE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_FORCE_TO_ROAM, &bForceToRoam); - - bPreBtDisabled = bBtDisabled; - } -} - -VOID -halbtc8192d2ant_MonitorBtState( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN stateChange=FALSE; - u4Byte BT_Polling, Ratio_Act, Ratio_STA; - u4Byte BT_Active, BT_State; - u4Byte regBTActive=0, regBTState=0, regBTPolling=0; - u4Byte btBusyThresh=0; - u4Byte fwVer=0; - static BOOLEAN bBtBusyTraffic=FALSE; - BOOLEAN bRejApAggPkt=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_FW_VER, &fwVer); - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FirmwareVersion = 0x%x(%d)\n", fwVer, fwVer)); - - regBTActive = 0x444; - regBTState = 0x448; - regBTPolling = 0x44c; - - btBusyThresh = 40; - - BT_Active = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTActive); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Active(0x%x)=0x%x\n", regBTActive, BT_Active)); - BT_Active = BT_Active & 0x00ffffff; - - BT_State = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTState); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_State(0x%x)=0x%x\n", regBTState, BT_State)); - BT_State = BT_State & 0x00ffffff; - - BT_Polling = pBtCoexist->fBtcRead4Byte(pBtCoexist, regBTPolling); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT_Polling(0x%x)=0x%x\n", regBTPolling, BT_Polling)); - - if(BT_Active==0xffffffff && BT_State==0xffffffff && BT_Polling==0xffffffff ) - return; - - // 2011/05/04 MH For Slim combo test meet a problem. Surprise remove and WLAN is running - // DHCP process. At the same time, the register read value might be zero. And cause BSOD 0x7f - // EXCEPTION_DIVIDED_BY_ZERO. In This case, the stack content may always be wrong due to - // HW divide trap. - if (BT_Polling==0) - return; - - halbtc8192d2ant_MonitorBtEnableDisable(pBtCoexist, BT_Active); - - Ratio_Act = BT_Active*1000/BT_Polling; - Ratio_STA = BT_State*1000/BT_Polling; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_Act=%d\n", Ratio_Act)); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Ratio_STA=%d\n", Ratio_STA)); - - if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - if(Ratio_STA < 60) // BT PAN idle - { - } - else - { - // Check if BT PAN (under BT 2.1) is uplink or downlink - if((Ratio_Act/Ratio_STA) < 2) - { // BT PAN Uplink - pCoexSta->bBtUplink = TRUE; - } - else - { // BT PAN downlink - pCoexSta->bBtUplink = FALSE; - } - } - } - - // Check BT is idle or not - if(!pBtCoexist->stackInfo.bBtLinkExist) - { - pCoexSta->bBtBusy = FALSE; - } - else - { - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - if(Ratio_Act<20) - { - pCoexSta->bBtBusy = FALSE; - } - else - { - pCoexSta->bBtBusy = TRUE; - } - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - if(Ratio_STA < btBusyThresh) - { - pCoexSta->bBtBusy = FALSE; - } - else - { - pCoexSta->bBtBusy = TRUE; - } - - if( (Ratio_STA < btBusyThresh) || - (Ratio_Act<180 && Ratio_STA<130) ) - { - pCoexSta->bA2dpBusy = FALSE; - } - else - { - pCoexSta->bA2dpBusy = TRUE; - } - } - } - - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &pCoexSta->bBtBusy); - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &pCoexSta->bBtBusy); - - if(bBtBusyTraffic != pCoexSta->bBtBusy) - { // BT idle or BT non-idle - bBtBusyTraffic = pCoexSta->bBtBusy; - stateChange = TRUE; - } - - if(stateChange) - { - if(!pCoexSta->bBtBusy) - { - halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_CoexAllOff(pBtCoexist); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - } - else - { - halbtc8192d2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); - } - } - - if(stateChange) - { - bRejApAggPkt = pCoexSta->bBtBusy; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, &bRejApAggPkt); - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); - } -} - -VOID -halbtc8192d2ant_ActionA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1=BTC_RSSI_STATE_HIGH; - u4Byte wifiBw, wifiTrafficDir; - BOOLEAN bWifiBusy=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - if(pCoexSta->bA2dpBusy && bWifiBusy) - { - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - } - else - { - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 40, 0); - } - } - - // fw mechanism first - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0xc, 0x18); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x18); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - } - else if(pCoexSta->bA2dpBusy) - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); - - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } -} - -VOID -halbtc8192d2ant_ActionPan( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState, wifiRssiState1; - u4Byte wifiBw, wifiTrafficDir; - s4Byte wifiRssi; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); - - if(bBtHsOn) - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } - else - { - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 3, 25, 50); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - } - else - { - wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 25, 0); - } - - if(pCoexSta->bBtBusy && bWifiBusy) - { - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - // fw mechanism first - if(pCoexSta->bBtUplink) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - } - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - if(pCoexSta->bBtUplink) - { - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - } - else if( (wifiRssiState == BTC_RSSI_STATE_MEDIUM) || - (wifiRssiState == BTC_RSSI_STATE_STAY_MEDIUM) ) - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); - - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - if(BTC_WIFI_BW_HT40 == wifiBw) - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); - else - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x20); - - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - if(pCoexSta->bBtUplink) - { - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE);//BT_FW_NAV_ON); - } - else - { - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - } - else - { - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - } - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else if(pCoexSta->bBtBusy && - !bWifiBusy && - (wifiRssi < 30)) - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x0a, 0x20); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } - } -} - - -VOID -halbtc8192d2ant_ActionHid( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState=BTC_RSSI_STATE_HIGH; - u4Byte wifiTrafficDir; - BOOLEAN bWifiBusy=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 45, 0); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 20, 0); - } - - if(pCoexSta->bBtBusy && bWifiBusy) - { - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - // fw mechanism first - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, TRUE, 0x18, FALSE); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x15); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x30, FALSE); - } - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } -} - - - -VOID -halbtc8192d2ant_ActionSco( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState; - u4Byte wifiBw; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - - if(BTC_WIFI_BW_HT40 == wifiBw) - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } -} - -VOID -halbtc8192d2ant_ActionHidA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1; - u4Byte wifiBw; - - if(pCoexSta->bBtBusy) - { - wifiRssiState1 = halbtc8192d2ant_WifiRssiState(pBtCoexist, 1, 2, 35, 0); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - // fw mechanism first - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else - { - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - // fw mechanism - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - } - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else - { - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - } - } - else - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } -} - - -VOID -halbtc8192d2ant_ActionHidPanBc4( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u4Byte wifiBw, wifiTrafficDir; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - if(bBtHsOn) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - if(BTC_WIFI_BW_LEGACY == wifiBw) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else if(!bWifiBusy) - { - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - } - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); -} -VOID -halbtc8192d2ant_ActionHidPanBc8( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState; - u4Byte wifiBw, wifiTrafficDir; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - if(!bBtHsOn) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); - if((pCoexSta->bBtBusy && bWifiBusy)) - { - // fw mechanism first - if(pCoexSta->bBtUplink) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); - } - else - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); - } - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } - } - else - { - if(BTC_INTF_USB == pBtCoexist->chipInterface) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); - if(BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - - halbtc8192d2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0x000000f0, 0x40000010); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0xa0); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - else if(BTC_WIFI_TRAFFIC_RX == wifiTrafficDir) - { - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x18); - } - } - else - { - if(pCoexSta->bBtBusy) - { - // fw mechanism - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - } -} - -VOID -halbtc8192d2ant_ActionHidPan( - IN PBTC_COEXIST pBtCoexist - ) -{ - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - halbtc8192d2ant_ActionHidPanBc4(pBtCoexist); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - halbtc8192d2ant_ActionHidPanBc8(pBtCoexist); - } -} - -VOID -halbtc8192d2ant_ActionPanA2dpBc4( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x0); - if(bBtHsOn) - { - if(pCoexSta->bBtBusy) - { - // fw mechanism - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } - } - else - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - if(pCoexSta->bBtBusy && bWifiBusy) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x20, 0x10); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - } - else - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0x0, FALSE); - } - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } -} -VOID -halbtc8192d2ant_ActionPanA2dpBc8( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bBtHsOn=FALSE, bWifiBusy=FALSE; - u1Byte wifiRssiState; - u4Byte wifiBw; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - if(!bBtHsOn) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - wifiRssiState = halbtc8192d2ant_WifiRssiState(pBtCoexist, 0, 2, 25, 0); - if((pCoexSta->bBtBusy && bWifiBusy)) - { - // fw mechanism first - if(pCoexSta->bBtUplink) - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x15, 0x20); - } - else - { - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, TRUE, 0x10, 0x20); - } - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, TRUE, FALSE, 0x20, FALSE); - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } - else - { - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } - } - else - { - if(pCoexSta->bBtBusy) - { - // fw mechanism - halbtc8192d2ant_Balance(pBtCoexist, NORMAL_EXEC, FALSE, 0, 0); - halbtc8192d2ant_DiminishWifi(pBtCoexist, NORMAL_EXEC, FALSE, FALSE, 0, FALSE); - - // sw mechanism - halbtc8192d2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, TRUE, 0x20); - } - else - { - halbtc8192d2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0x30); - } - } -} - -VOID -halbtc8192d2ant_ActionPanA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - if(BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) - { - halbtc8192d2ant_ActionPanA2dpBc4(pBtCoexist); - } - else if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - halbtc8192d2ant_ActionPanA2dpBc8(pBtCoexist); - } -} - -BOOLEAN -halbtc8192d2ant_IsBtCoexistEnter( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte macPhyMode; - BOOLEAN bRet=TRUE; - BOOLEAN bWifiUnder5G=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_MAC_PHY_MODE, &macPhyMode); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &bWifiUnder5G); - - if(BTC_SMSP != macPhyMode) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Only support single mac single phy!!\n")); - bRet = FALSE; - } - - if(bWifiUnder5G) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is under 5G or A band\n")); - halbtc8192d2ant_CoexAllOff(pBtCoexist); - bRet = FALSE; - } - - return bRet; -} - -//============================================================ -// extern function start with EXhalbtc8192d2ant_ -//============================================================ -VOID -EXhalbtc8192d2ant_PowerOnSetting( - IN PBTC_COEXIST pBtCoexist - ) -{ -} - -VOID -EXhalbtc8192d2ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bWifiOnly - ) -{ - u1Byte u1Tmp=0; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); - - // backup rf 0x1e value - pCoexDm->btRf0x1eBackup = - pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); - - if( (BTC_CHIP_CSR_BC4 == pBtCoexist->boardInfo.btChipType) || - (BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) ) - { - u1Tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd) & BIT0; - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, u1Tmp); - - halbtc8192d2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0xaaaa9aaa, 0xffbd0040, 0x40000010); - - // switch control, here we set pathA to control - // 0x878[13] = 1, 0:pathB, 1:pathA(default) - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x878, BIT13, 0x1); - - // antsel control, here we use phy0 and enable antsel. - // 0x87c[16:15] = b'11, enable antsel, antsel output pin - // 0x87c[30] = 0, 0: phy0, 1:phy 1 - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x87c, bMaskDWord, 0x1fff8); - - // antsel to Bt or Wifi, it depends Bt on/off. - // 0x860[9:8] = 'b10, b10:Bt On, WL2G off(default), b01:Bt off, WL2G on. - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x860, BIT9|BIT8, 0x2); - - // sw/hw control switch, here we set sw control - // 0x870[9:8] = 'b11 sw control, 'b00 hw control - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x870, BIT9|BIT8, 0x3); - } -} - -VOID -EXhalbtc8192d2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); - - halbtc8192d2ant_InitCoexDm(pBtCoexist); -} - -VOID -EXhalbtc8192d2ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - pu1Byte cliBuf=pBtCoexist->cliBuf; - u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; - u4Byte u4Tmp[4]; - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ - pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); - CL_PRINTF(cliBuf); - - if(pBtCoexist->bManualControl) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); - CL_PRINTF(cliBuf); - } - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ - ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); - CL_PRINTF(cliBuf); - - // wifi status - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); - CL_PRINTF(cliBuf); - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); - CL_PRINTF(cliBuf); - - if(pStackInfo->bProfileNotified) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ - pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); - } - - // Sw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); - CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ - pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); - CL_PRINTF(cliBuf); - - // Fw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); - CL_PRINTF(cliBuf); - - // Hw setting - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ - pCoexDm->btRf0x1eBackup); - CL_PRINTF(cliBuf); - - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ - u1Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); - u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); - u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6cc); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x6c4/0x6c8/0x6cc(coexTable)", \ - u4Tmp[0], u4Tmp[1], u4Tmp[2]); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -VOID -EXhalbtc8192d2ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_IPS_ENTER == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } - else if(BTC_IPS_LEAVE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); - //halbtc8192d2ant_InitCoexDm(pBtCoexist); - } -} - -VOID -EXhalbtc8192d2ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_LPS_ENABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); - halbtc8192d2ant_CoexAllOff(pBtCoexist); - } - else if(BTC_LPS_DISABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); - halbtc8192d2ant_InitCoexDm(pBtCoexist); - } -} - -VOID -EXhalbtc8192d2ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_SCAN_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); - } - else if(BTC_SCAN_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); - } -} - -VOID -EXhalbtc8192d2ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_ASSOCIATE_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); - } - else if(BTC_ASSOCIATE_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); - } -} - -VOID -EXhalbtc8192d2ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_MEDIA_CONNECT == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); - } -} - -VOID -EXhalbtc8192d2ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(type == BTC_PACKET_DHCP) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); - } -} - -VOID -EXhalbtc8192d2ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ) -{ -} - -VOID -EXhalbtc8192d2ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); - - EXhalbtc8192d2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -} - -VOID -EXhalbtc8192d2ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte algorithm; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); - - // NOTE: - // sw mechanism must be done after fw mechanism - // - if(!halbtc8192d2ant_IsBtCoexistEnter(pBtCoexist)) - return; - - if(BTC_CHIP_CSR_BC8 == pBtCoexist->boardInfo.btChipType) - { - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_GET_BT_RSSI, NULL); - - halbtc8192d2ant_MonitorBtState(pBtCoexist); - algorithm = halbtc8192d2ant_ActionAlgorithm(pBtCoexist); - pCoexDm->curAlgorithm = algorithm; - switch(pCoexDm->curAlgorithm) - { - case BT_8192D_2ANT_COEX_ALGO_SCO: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO\n")); - halbtc8192d2ant_ActionSco(pBtCoexist); - break; - case BT_8192D_2ANT_COEX_ALGO_HID: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID\n")); - halbtc8192d2ant_ActionHid(pBtCoexist); - break; - case BT_8192D_2ANT_COEX_ALGO_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP\n")); - halbtc8192d2ant_ActionA2dp(pBtCoexist); - break; - case BT_8192D_2ANT_COEX_ALGO_PAN: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN\n")); - halbtc8192d2ant_ActionPan(pBtCoexist); - break; - case BT_8192D_2ANT_COEX_ALGO_HID_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP\n")); - halbtc8192d2ant_ActionHidA2dp(pBtCoexist); - break; - case BT_8192D_2ANT_COEX_ALGO_HID_PAN: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+HID\n")); - halbtc8192d2ant_ActionHidPan(pBtCoexist); - break; - case BT_8192D_2ANT_COEX_ALGO_PAN_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP\n")); - halbtc8192d2ant_ActionPanA2dp(pBtCoexist); - break; - default: - break; - } - } -} - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.h deleted file mode 100644 index 85fd6742ca2f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192d2Ant.h +++ /dev/null @@ -1,170 +0,0 @@ -//=========================================== -// The following is for 8192D 2Ant BT Co-exist definition -//=========================================== -#define BTC_RSSI_COEX_THRESH_TOL_8192D_2ANT 6 - -typedef enum _BT_INFO_SRC_8192D_2ANT{ - BT_INFO_SRC_8192D_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8192D_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8192D_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8192D_2ANT_MAX -}BT_INFO_SRC_8192D_2ANT,*PBT_INFO_SRC_8192D_2ANT; - -typedef enum _BT_8192D_2ANT_BT_STATUS{ - BT_8192D_2ANT_BT_STATUS_IDLE = 0x0, - BT_8192D_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8192D_2ANT_BT_STATUS_NON_IDLE = 0x2, - BT_8192D_2ANT_BT_STATUS_MAX -}BT_8192D_2ANT_BT_STATUS,*PBT_8192D_2ANT_BT_STATUS; - -typedef enum _BT_8192D_2ANT_COEX_ALGO{ - BT_8192D_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8192D_2ANT_COEX_ALGO_SCO = 0x1, - BT_8192D_2ANT_COEX_ALGO_HID = 0x2, - BT_8192D_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8192D_2ANT_COEX_ALGO_PAN = 0x4, - BT_8192D_2ANT_COEX_ALGO_HID_A2DP = 0x5, - BT_8192D_2ANT_COEX_ALGO_HID_PAN = 0x6, - BT_8192D_2ANT_COEX_ALGO_PAN_A2DP = 0x7, - BT_8192D_2ANT_COEX_ALGO_MAX -}BT_8192D_2ANT_COEX_ALGO,*PBT_8192D_2ANT_COEX_ALGO; - -typedef struct _COEX_DM_8192D_2ANT{ - // fw mechanism - BOOLEAN bPreBalanceOn; - BOOLEAN bCurBalanceOn; - - // diminishWifi - BOOLEAN bPreDacOn; - BOOLEAN bCurDacOn; - BOOLEAN bPreInterruptOn; - BOOLEAN bCurInterruptOn; - u1Byte preFwDacSwingLvl; - u1Byte curFwDacSwingLvl; - BOOLEAN bPreNavOn; - BOOLEAN bCurNavOn; - - - - - - //BOOLEAN bPreDecBtPwr; - //BOOLEAN bCurDecBtPwr; - - //u1Byte preFwDacSwingLvl; - //u1Byte curFwDacSwingLvl; - //BOOLEAN bCurIgnoreWlanAct; - //BOOLEAN bPreIgnoreWlanAct; - //u1Byte prePsTdma; - //u1Byte curPsTdma; - //u1Byte psTdmaPara[5]; - //u1Byte psTdmaDuAdjType; - //BOOLEAN bResetTdmaAdjust; - //BOOLEAN bPrePsTdmaOn; - //BOOLEAN bCurPsTdmaOn; - //BOOLEAN bPreBtAutoReport; - //BOOLEAN bCurBtAutoReport; - - // sw mechanism - BOOLEAN bPreRfRxLpfShrink; - BOOLEAN bCurRfRxLpfShrink; - u4Byte btRf0x1eBackup; - BOOLEAN bPreLowPenaltyRa; - BOOLEAN bCurLowPenaltyRa; - BOOLEAN bPreDacSwingOn; - u4Byte preDacSwingLvl; - BOOLEAN bCurDacSwingOn; - u4Byte curDacSwingLvl; - BOOLEAN bPreAdcBackOff; - BOOLEAN bCurAdcBackOff; - BOOLEAN bPreAgcTableEn; - BOOLEAN bCurAgcTableEn; - //u4Byte preVal0x6c0; - //u4Byte curVal0x6c0; - u4Byte preVal0x6c4; - u4Byte curVal0x6c4; - u4Byte preVal0x6c8; - u4Byte curVal0x6c8; - u4Byte preVal0x6cc; - u4Byte curVal0x6cc; - //BOOLEAN bLimitedDig; - - // algorithm related - u1Byte preAlgorithm; - u1Byte curAlgorithm; - //u1Byte btStatus; - //u1Byte wifiChnlInfo[3]; -} COEX_DM_8192D_2ANT, *PCOEX_DM_8192D_2ANT; - -typedef struct _COEX_STA_8192D_2ANT{ - u1Byte preWifiRssiState[4]; - BOOLEAN bBtBusy; - BOOLEAN bBtUplink; - BOOLEAN bBtDownLink; - BOOLEAN bA2dpBusy; -}COEX_STA_8192D_2ANT, *PCOEX_STA_8192D_2ANT; - -//=========================================== -// The following is interface which will notify coex module. -//=========================================== -VOID -EXhalbtc8192d2ant_PowerOnSetting( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8192d2ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bWifiOnly - ); -VOID -EXhalbtc8192d2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8192d2ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8192d2ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8192d2ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8192d2ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8192d2ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8192d2ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8192d2ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8192d2ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8192d2ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ); -VOID -EXhalbtc8192d2ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.c deleted file mode 100644 index db5b42e48b3f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.c +++ /dev/null @@ -1,1544 +0,0 @@ -//============================================================ -// Description: -// -// This file is for RTL8723A Co-exist mechanism -// -// History -// 2012/08/22 Cosa first check in. -// 2012/11/14 Cosa Revise for 8723A 1Ant out sourcing. -// -//============================================================ - -//============================================================ -// include files -//============================================================ -#include "Mp_Precomp.h" - -#if WPP_SOFTWARE_TRACE -#include "HalBtc8723a1Ant.tmh" -#endif - -#if(BT_30_SUPPORT == 1) -//============================================================ -// Global variables, these are static variables -//============================================================ -static COEX_DM_8723A_1ANT GLCoexDm8723a1Ant; -static PCOEX_DM_8723A_1ANT pCoexDm=&GLCoexDm8723a1Ant; -static COEX_STA_8723A_1ANT GLCoexSta8723a1Ant; -static PCOEX_STA_8723A_1ANT pCoexSta=&GLCoexSta8723a1Ant; - -const char *const GLBtInfoSrc8723a1Ant[]={ - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -//============================================================ -// local function proto type if needed -//============================================================ -//============================================================ -// local function start with halbtc8723a1ant_ -//============================================================ -VOID -halbtc8723a1ant_Reg0x550Bit3( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bSet - ) -{ - u1Byte u1tmp=0; - - u1tmp = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x550); - if(bSet) - { - u1tmp |= BIT3; - } - else - { - u1tmp &= ~BIT3; - } - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x550, u1tmp); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], set 0x550[3]=%d\n", (bSet? 1:0))); -} - -VOID -halbtc8723a1ant_NotifyFwScan( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte scanType - ) -{ - u1Byte H2C_Parameter[1] ={0}; - - if(BTC_SCAN_START == scanType) - H2C_Parameter[0] = 0x1; - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Notify FW for wifi scan, write 0x3b=0x%x\n", - H2C_Parameter[0])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3b, 1, H2C_Parameter); -} - -VOID -halbtc8723a1ant_QueryBtInfo( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte H2C_Parameter[1] ={0}; - - pCoexSta->bC2hBtInfoReqSent = TRUE; - - H2C_Parameter[0] |= BIT0; // trigger - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", - H2C_Parameter[0])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); -} - -VOID -halbtc8723a1ant_SetSwRfRxLpfCorner( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bRxRfShrinkOn - ) -{ - if(bRxRfShrinkOn) - { - //Shrink RF Rx LPF corner - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); - } - else - { - //Resume RF Rx LPF corner - // After initialized, we can use pCoexDm->btRf0x1eBackup - if(pBtCoexist->bInitilized) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); - } - } -} - -VOID -halbtc8723a1ant_RfShrink( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bRxRfShrinkOn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", - (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); - pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; - - if(!bForceExec) - { - if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) - return; - } - halbtc8723a1ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); - - pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -} - -VOID -halbtc8723a1ant_SetSwPenaltyTxRateAdaptive( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bLowPenaltyRa - ) -{ - u1Byte tmpU1; - - tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); - tmpU1 |= BIT0; - if(bLowPenaltyRa) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); - tmpU1 &= ~BIT2; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); - tmpU1 |= BIT2; - } - - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -} - -VOID -halbtc8723a1ant_LowPenaltyRa( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bLowPenaltyRa - ) -{ - return; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", - (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); - pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; - - if(!bForceExec) - { - if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) - return; - } - halbtc8723a1ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); - - pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -} - -VOID -halbtc8723a1ant_SetCoexTable( - IN PBTC_COEXIST pBtCoexist, - IN u4Byte val0x6c0, - IN u4Byte val0x6c8, - IN u1Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -} - -VOID -halbtc8723a1ant_CoexTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN u4Byte val0x6c0, - IN u4Byte val0x6c8, - IN u1Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", - (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); - pCoexDm->curVal0x6c0 = val0x6c0; - pCoexDm->curVal0x6c8 = val0x6c8; - pCoexDm->curVal0x6cc = val0x6cc; - - if(!bForceExec) - { - if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && - (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && - (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) - return; - } - halbtc8723a1ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); - - pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; - pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; - pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -} - -VOID -halbtc8723a1ant_SetFwIgnoreWlanAct( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bEnable - ) -{ - u1Byte H2C_Parameter[1] ={0}; - - if(bEnable) - { - H2C_Parameter[0] |= BIT0; // function enable - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", - H2C_Parameter[0])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); -} - -VOID -halbtc8723a1ant_IgnoreWlanAct( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bEnable - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", - (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); - pCoexDm->bCurIgnoreWlanAct = bEnable; - - if(!bForceExec) - { - if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) - return; - } - halbtc8723a1ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); - - pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -} - -VOID -halbtc8723a1ant_SetFwPstdma( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type, - IN u1Byte byte1, - IN u1Byte byte2, - IN u1Byte byte3, - IN u1Byte byte4, - IN u1Byte byte5 - ) -{ - u1Byte H2C_Parameter[5] ={0}; - u1Byte realByte1=byte1, realByte5=byte5; - BOOLEAN bApEnable=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); - - // byte1[1:0] != 0 means enable pstdma - // for 2Ant bt coexist, if byte1 != 0 means enable pstdma - if(byte1) - { - if(bApEnable) - { - if(type != 5 && type != 12) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], FW for 1Ant AP mode\n")); - realByte1 &= ~BIT4; - realByte1 |= BIT5; - - realByte5 |= BIT5; - realByte5 &= ~BIT6; - } - } - } - H2C_Parameter[0] = realByte1; - H2C_Parameter[1] = byte2; - H2C_Parameter[2] = byte3; - H2C_Parameter[3] = byte4; - H2C_Parameter[4] = realByte5; - - pCoexDm->psTdmaPara[0] = realByte1; - pCoexDm->psTdmaPara[1] = byte2; - pCoexDm->psTdmaPara[2] = byte3; - pCoexDm->psTdmaPara[3] = byte4; - pCoexDm->psTdmaPara[4] = realByte5; - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", - H2C_Parameter[0], - H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); -} - -VOID -halbtc8723a1ant_PsTdma( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bTurnOn, - IN u1Byte type - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", - (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); - pCoexDm->bCurPsTdmaOn = bTurnOn; - pCoexDm->curPsTdma = type; - - if(!bForceExec) - { - if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && - (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) - return; - } - if(pCoexDm->bCurPsTdmaOn) - { - switch(pCoexDm->curPsTdma) - { - case 1: - default: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x0, 0x40); - break; - case 2: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x0, 0x40); - break; - case 3: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x3f, 0x3, 0x10, 0x40); - break; - case 4: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x15, 0x3, 0x10, 0x0); - break; - case 5: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0x15, 0x3, 0x35, 0xc0); - break; - - case 8: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); - break; - case 9: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); - break; - case 10: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x0, 0x40); - break; - case 11: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x0, 0x40); - break; - case 12: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0xa9, 0xa, 0x3, 0x15, 0xc0); - break; - - case 18: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); - break; - - case 20: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x2a, 0x2a, 0x0, 0x0); - break; - case 21: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x20, 0x3, 0x10, 0x40); - break; - case 22: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x1a, 0x1a, 0x2, 0x40); - break; - case 23: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x12, 0x12, 0x2, 0x40); - break; - case 24: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0xa, 0xa, 0x2, 0x40); - break; - case 25: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); - break; - case 26: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x93, 0x25, 0x3, 0x10, 0x0); - break; - case 27: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x13, 0x5, 0x5, 0x2, 0x40); - break; - case 28: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x3, 0x2f, 0x2f, 0x0, 0x0); - break; - - } - } - else - { - // disable PS tdma - switch(pCoexDm->curPsTdma) - { - case 8: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x8, 0x0, 0x0, 0x0, 0x0); - break; - case 0: - default: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); - pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); - break; - case 9: - halbtc8723a1ant_SetFwPstdma(pBtCoexist, type, 0x0, 0x0, 0x0, 0x0, 0x0); - pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x110); - break; - - } - } - - // update pre state - pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; - pCoexDm->prePsTdma = pCoexDm->curPsTdma; -} - - -VOID -halbtc8723a1ant_CoexAllOff( - IN PBTC_COEXIST pBtCoexist - ) -{ - // fw all off - halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - - // sw all off - halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - - // hw all off - halbtc8723a1ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -} - -VOID -halbtc8723a1ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ - // force to reset coex mechanism - halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -} - -VOID -halbtc8723a1ant_BtEnableAction( - IN PBTC_COEXIST pBtCoexist - ) -{ - halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -} - -VOID -halbtc8723a1ant_MonitorBtCtr( - IN PBTC_COEXIST pBtCoexist - ) -{ - u4Byte regHPTxRx, regLPTxRx, u4Tmp; - u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; - u1Byte u1Tmp; - - regHPTxRx = 0x770; - regLPTxRx = 0x774; - - u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); - regHPTx = u4Tmp & bMaskLWord; - regHPRx = (u4Tmp & bMaskHWord)>>16; - - u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); - regLPTx = u4Tmp & bMaskLWord; - regLPRx = (u4Tmp & bMaskHWord)>>16; - - pCoexSta->highPriorityTx = regHPTx; - pCoexSta->highPriorityRx = regHPRx; - pCoexSta->lowPriorityTx = regLPTx; - pCoexSta->lowPriorityRx = regLPRx; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); - - // reset counter - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -} - -VOID -halbtc8723a1ant_MonitorBtEnableDisable( - IN PBTC_COEXIST pBtCoexist - ) -{ - static BOOLEAN bPreBtDisabled=FALSE; - static u4Byte btDisableCnt=0; - BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; - - // This function check if bt is disabled - - if( pCoexSta->highPriorityTx == 0 && - pCoexSta->highPriorityRx == 0 && - pCoexSta->lowPriorityTx == 0 && - pCoexSta->lowPriorityRx == 0) - { - bBtActive = FALSE; - } - if( pCoexSta->highPriorityTx == 0xffff && - pCoexSta->highPriorityRx == 0xffff && - pCoexSta->lowPriorityTx == 0xffff && - pCoexSta->lowPriorityRx == 0xffff) - { - bBtActive = FALSE; - } - if(bBtActive) - { - btDisableCnt = 0; - bBtDisabled = FALSE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); - } - else - { - btDisableCnt++; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", - btDisableCnt)); - if(btDisableCnt >= 2) - { - bBtDisabled = TRUE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); - } - } - if(bPreBtDisabled != bBtDisabled) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", - (bPreBtDisabled ? "disabled":"enabled"), - (bBtDisabled ? "disabled":"enabled"))); - bPreBtDisabled = bBtDisabled; - if(!bBtDisabled) - { - halbtc8723a1ant_BtEnableAction(pBtCoexist); - } - else - { - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); - } - } -} - -VOID -halbtc8723a1ant_TdmaDurationAdjust( - IN PBTC_COEXIST pBtCoexist - ) -{ - static s4Byte up,dn,m,n,WaitCount; - s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration - u1Byte retryCount=0; - u1Byte btState; - BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; - u4Byte wifiBw; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - btState = pCoexDm->btStatus; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], TdmaDurationAdjust()\n")); - if(pCoexDm->psTdmaGlobalCnt != pCoexDm->psTdmaMonitorCnt) - { - pCoexDm->psTdmaMonitorCnt = 0; - pCoexDm->psTdmaGlobalCnt = 0; - } - if(pCoexDm->psTdmaMonitorCnt == 0) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], first run BT A2DP + WiFi busy state!!\n")); - if(btState == BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); - pCoexDm->psTdmaDuAdjType = 1; - } - else - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); - pCoexDm->psTdmaDuAdjType = 22; - } - //============ - up = 0; - dn = 0; - m = 1; - n= 3; - result = 0; - WaitCount = 0; - } - else - { - //accquire the BT TRx retry count from BT_Info byte2 - retryCount = pCoexSta->btRetryCnt; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], retryCount = %d\n", retryCount)); - result = 0; - WaitCount++; - - if(retryCount == 0) // no retry in the last 2-second duration - { - up++; - dn--; - - if (dn <= 0) - dn = 0; - - if(up >= n) // if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration - { - WaitCount = 0; - n = 3; - up = 0; - dn = 0; - result = 1; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Increase wifi duration!!\n")); - } - } - else if (retryCount <= 3) // <=3 retry in the last 2-second duration - { - up--; - dn++; - - if (up <= 0) - up = 0; - - if (dn == 2) // if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration - { - if (WaitCount <= 2) - m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ - else - m = 1; - - if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. - m = 20; - - n = 3*m; - up = 0; - dn = 0; - WaitCount = 0; - result = -1; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); - } - } - else //retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration - { - if (WaitCount == 1) - m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ - else - m = 1; - - if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. - m = 20; - - n = 3*m; - up = 0; - dn = 0; - WaitCount = 0; - result = -1; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); - } - - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT TxRx counter H+L <= 1200\n")); - if(btState != BT_STATE_8723A_1ANT_ACL_ONLY_BUSY) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], NOT ACL only busy!\n")); - if(BTC_WIFI_BW_HT40 != wifiBw) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 20MHz\n")); - if(result == -1) - { - if(pCoexDm->curPsTdma == 22) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); - pCoexDm->psTdmaDuAdjType = 23; - } - else if(pCoexDm->curPsTdma == 23) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); - pCoexDm->psTdmaDuAdjType = 24; - } - else if(pCoexDm->curPsTdma == 24) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); - pCoexDm->psTdmaDuAdjType = 25; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 25) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); - pCoexDm->psTdmaDuAdjType = 24; - } - else if(pCoexDm->curPsTdma == 24) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); - pCoexDm->psTdmaDuAdjType = 23; - } - else if(pCoexDm->curPsTdma == 23) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 22); - pCoexDm->psTdmaDuAdjType = 22; - } - } - // error handle, if not in the following state, - // set psTdma again. - if( (pCoexDm->psTdmaDuAdjType != 22) && - (pCoexDm->psTdmaDuAdjType != 23) && - (pCoexDm->psTdmaDuAdjType != 24) && - (pCoexDm->psTdmaDuAdjType != 25) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); - pCoexDm->psTdmaDuAdjType = 23; - } - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 40MHz\n")); - if(result == -1) - { - if(pCoexDm->curPsTdma == 23) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); - pCoexDm->psTdmaDuAdjType = 24; - } - else if(pCoexDm->curPsTdma == 24) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); - pCoexDm->psTdmaDuAdjType = 25; - } - else if(pCoexDm->curPsTdma == 25) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 27); - pCoexDm->psTdmaDuAdjType = 27; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 27) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 25); - pCoexDm->psTdmaDuAdjType = 25; - } - else if(pCoexDm->curPsTdma == 25) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); - pCoexDm->psTdmaDuAdjType = 24; - } - else if(pCoexDm->curPsTdma == 24) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 23); - pCoexDm->psTdmaDuAdjType = 23; - } - } - // error handle, if not in the following state, - // set psTdma again. - if( (pCoexDm->psTdmaDuAdjType != 23) && - (pCoexDm->psTdmaDuAdjType != 24) && - (pCoexDm->psTdmaDuAdjType != 25) && - (pCoexDm->psTdmaDuAdjType != 27) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 24); - pCoexDm->psTdmaDuAdjType = 24; - } - } - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], ACL only busy\n")); - if (result == -1) - { - if(pCoexDm->curPsTdma == 1) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); - pCoexDm->psTdmaDuAdjType = 9; - } - else if(pCoexDm->curPsTdma == 9) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 11) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); - pCoexDm->psTdmaDuAdjType = 9; - } - else if(pCoexDm->curPsTdma == 9) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); - pCoexDm->psTdmaDuAdjType = 1; - } - } - - // error handle, if not in the following state, - // set psTdma again. - if( (pCoexDm->psTdmaDuAdjType != 1) && - (pCoexDm->psTdmaDuAdjType != 2) && - (pCoexDm->psTdmaDuAdjType != 9) && - (pCoexDm->psTdmaDuAdjType != 11) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], duration case out of handle!!\n")); - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - } - } - } - - // if current PsTdma not match with the recorded one (when scan, dhcp...), - // then we have to adjust it back to the previous record one. - if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", - pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); - - if( !bScan && !bLink && !bRoam) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); - } - } - pCoexDm->psTdmaMonitorCnt++; -} - - -VOID -halbtc8723a1ant_CoexForWifiConnect( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bWifiConnected=FALSE, bWifiBusy=FALSE; - u1Byte btState, btInfoOriginal=0; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - - btState = pCoexDm->btStatus; - btInfoOriginal = pCoexSta->btInfoC2h[BT_INFO_SRC_8723A_1ANT_BT_RSP][0]; - - if(bWifiConnected) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi connected!!\n")); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - - if( !bWifiBusy && - ((BT_STATE_8723A_1ANT_NO_CONNECTION == btState) || - (BT_STATE_8723A_1ANT_CONNECT_IDLE == btState)) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], [Wifi is idle] or [Bt is non connected idle or Bt is connected idle]!!\n")); - - if(BT_STATE_8723A_1ANT_NO_CONNECTION == btState) - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); - else if(BT_STATE_8723A_1ANT_CONNECT_IDLE == btState) - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); - } - else - { - if( (BT_STATE_8723A_1ANT_SCO_ONLY_BUSY == btState) || - (BT_STATE_8723A_1ANT_ACL_SCO_BUSY == btState) || - (BT_STATE_8723A_1ANT_HID_BUSY == btState) || - (BT_STATE_8723A_1ANT_HID_SCO_BUSY == btState) ) - { - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0x60); - } - else - { - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); - } - switch(btState) - { - case BT_STATE_8723A_1ANT_NO_CONNECTION: - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); - break; - case BT_STATE_8723A_1ANT_CONNECT_IDLE: - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - break; - case BT_STATE_8723A_1ANT_INQ_OR_PAG: - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - break; - case BT_STATE_8723A_1ANT_SCO_ONLY_BUSY: - case BT_STATE_8723A_1ANT_ACL_SCO_BUSY: - case BT_STATE_8723A_1ANT_HID_BUSY: - case BT_STATE_8723A_1ANT_HID_SCO_BUSY: - halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); - break; - case BT_STATE_8723A_1ANT_ACL_ONLY_BUSY: - if (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) - { - halbtc8723a1ant_TdmaDurationAdjust(pBtCoexist); - } - else if(btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); - } - else if( (btInfoOriginal&BT_INFO_8723A_1ANT_B_A2DP) && - (btInfoOriginal&BT_INFO_8723A_1ANT_B_FTP) ) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - } - else - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); - } - break; - default: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], error!!!, undefined case in halbtc8723a1ant_CoexForWifiConnect()!!\n")); - break; - } - } - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi is disconnected!!\n")); - } - - pCoexDm->psTdmaGlobalCnt++; -} - -//============================================================ -// work around function start with wa_halbtc8723a1ant_ -//============================================================ -VOID -wa_halbtc8723a1ant_MonitorC2h( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte tmp1b=0x0; - u4Byte curC2hTotalCnt=0x0; - static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; - - curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_BT_RSP]; - - if(curC2hTotalCnt == preC2hTotalCnt) - { - sameCntPollingTime++; - } - else - { - preC2hTotalCnt = curC2hTotalCnt; - sameCntPollingTime = 0; - } - - if(sameCntPollingTime >= 2) - { - tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); - if(tmp1b != 0x0) - { - pCoexSta->c2hHangDetectCnt++; - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); - } - } -} - -//============================================================ -// extern function start with EXhalbtc8723a1ant_ -//============================================================ -VOID -EXhalbtc8723a1ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Init HW Config!!\n")); - - // backup rf 0x1e value - pCoexDm->btRf0x1eBackup = - pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); - - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); - - // enable counter statistics - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); - - // coex table - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, 0x0); // 1-Ant coex - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, 0xffff); // wifi break table - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c4, 0x55555555); //coex table - - // antenna switch control parameter - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x858, 0xaaaaaaaa); - - pBtCoexist->fBtcWrite2Byte(pBtCoexist, 0x860, 0x210); //set antenna at wifi side if ANTSW is software control - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x870, 0x300); //SPDT(connected with TRSW) control by hardware PTA - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x874, 0x22804000); //ANTSW keep by GNT_BT - - // coexistence parameters - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x1); // enable RTK mode PTA -} - -VOID -EXhalbtc8723a1ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); - - halbtc8723a1ant_InitCoexDm(pBtCoexist); -} - -VOID -EXhalbtc8723a1ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - pu1Byte cliBuf=pBtCoexist->cliBuf; - u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; - u4Byte u4Tmp[4]; - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ - pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); - CL_PRINTF(cliBuf); - - if(pBtCoexist->bManualControl) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); - CL_PRINTF(cliBuf); - } - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ - ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ - pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], - pCoexDm->wifiChnlInfo[2]); - CL_PRINTF(cliBuf); - - // wifi status - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); - CL_PRINTF(cliBuf); - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ - ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_1ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), - pCoexSta->btRssi, pCoexSta->btRetryCnt); - CL_PRINTF(cliBuf); - - if(pStackInfo->bProfileNotified) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ - pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); - } - - btInfoExt = pCoexSta->btInfoExt; - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ - (btInfoExt&BIT0)? "Basic rate":"EDR rate"); - CL_PRINTF(cliBuf); - - for(i=0; ibtInfoC2hCnt[i]) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a1Ant[i], \ - pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], - pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], - pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], - pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); - CL_PRINTF(cliBuf); - } - } - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ - pCoexSta->c2hHangDetectCnt); - CL_PRINTF(cliBuf); - - // Sw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); - CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ - pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); - CL_PRINTF(cliBuf); - - // Fw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); - CL_PRINTF(cliBuf); - - if(!pBtCoexist->bManualControl) - { - psTdmaCase = pCoexDm->curPsTdma; - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ - pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], - pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], - pCoexDm->psTdmaPara[4], psTdmaCase); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ", "IgnWlanAct", \ - pCoexDm->bCurIgnoreWlanAct); - CL_PRINTF(cliBuf); - } - - // Hw setting - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ - pCoexDm->btRf0x1eBackup); - CL_PRINTF(cliBuf); - - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); - u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); - u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ - u1Tmp[0], u1Tmp[1], u1Tmp[2]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ - u1Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ - u4Tmp[0], u1Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); - u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); - u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); - u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ - u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); - u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); - u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ - u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ - pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); - CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ - pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -VOID -EXhalbtc8723a1ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_IPS_ENTER == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); - halbtc8723a1ant_CoexAllOff(pBtCoexist); - } - else if(BTC_IPS_LEAVE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); - //halbtc8723a1ant_InitCoexDm(pBtCoexist); - } -} - -VOID -EXhalbtc8723a1ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_LPS_ENABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); - } - else if(BTC_LPS_DISABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 8); - } -} - -VOID -EXhalbtc8723a1ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - BOOLEAN bWifiConnected=FALSE; - - halbtc8723a1ant_NotifyFwScan(pBtCoexist, type); - - if(pBtCoexist->btInfo.bBtDisabled) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); - } - else - { - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - if(BTC_SCAN_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); - if(!bWifiConnected) // non-connected scan - { - //set 0x550[3]=1 before PsTdma - halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); - } - - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - } - else if(BTC_SCAN_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); - if(!bWifiConnected) // non-connected scan - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - } - else - { - halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); - } - } - } -} - -VOID -EXhalbtc8723a1ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - BOOLEAN bWifiConnected=FALSE; - - if(pBtCoexist->btInfo.bBtDisabled) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); - } - else - { - if(BTC_ASSOCIATE_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); - //set 0x550[3]=1 before PsTdma - halbtc8723a1ant_Reg0x550Bit3(pBtCoexist, TRUE); - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); // extend wifi slot - } - else if(BTC_ASSOCIATE_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - if(!bWifiConnected) // non-connected scan - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - } - else - { - halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); - } - } - } -} - -VOID -EXhalbtc8723a1ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_MEDIA_CONNECT == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); - } -} - -VOID -EXhalbtc8723a1ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(type == BTC_PACKET_DHCP) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); - if(pBtCoexist->btInfo.bBtDisabled) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); - } - else - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 18); - } - } -} - -VOID -EXhalbtc8723a1ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ) -{ - u1Byte btInfo=0; - u1Byte i, rspSource=0; - BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bForceLps=FALSE; - - pCoexSta->bC2hBtInfoReqSent = FALSE; - - rspSource = BT_INFO_SRC_8723A_1ANT_BT_RSP; - pCoexSta->btInfoC2hCnt[rspSource]++; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); - for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; - if(i == 0) - btInfo = tmpBuf[i]; - if(i == length-1) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); - } - } - - if(BT_INFO_SRC_8723A_1ANT_WIFI_FW != rspSource) - { - pCoexSta->btRetryCnt = - pCoexSta->btInfoC2h[rspSource][1]; - - pCoexSta->btRssi = - pCoexSta->btInfoC2h[rspSource][2]*2+10; - - pCoexSta->btInfoExt = - pCoexSta->btInfoC2h[rspSource][3]; - } - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - // check BIT2 first ==> check if bt is under inquiry or page scan - if(btInfo & BT_INFO_8723A_1ANT_B_INQ_PAGE) - { - pCoexSta->bC2hBtInquiryPage = TRUE; - } - else - { - pCoexSta->bC2hBtInquiryPage = FALSE; - } - btInfo &= ~BIT2; - if(!(btInfo & BIT0)) - { - pCoexDm->btStatus = BT_STATE_8723A_1ANT_NO_CONNECTION; - bForceLps = FALSE; - } - else - { - bForceLps = TRUE; - if(btInfo == 0x1) - { - pCoexDm->btStatus = BT_STATE_8723A_1ANT_CONNECT_IDLE; - } - else if(btInfo == 0x9) - { - pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_ONLY_BUSY; - bBtBusy = TRUE; - } - else if(btInfo == 0x13) - { - pCoexDm->btStatus = BT_STATE_8723A_1ANT_SCO_ONLY_BUSY; - bBtBusy = TRUE; - } - else if(btInfo == 0x1b) - { - pCoexDm->btStatus = BT_STATE_8723A_1ANT_ACL_SCO_BUSY; - bBtBusy = TRUE; - } - else if(btInfo == 0x29) - { - pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_BUSY; - bBtBusy = TRUE; - } - else if(btInfo == 0x3b) - { - pCoexDm->btStatus = BT_STATE_8723A_1ANT_HID_SCO_BUSY; - bBtBusy = TRUE; - } - } - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bBtBusy); - if(bForceLps) - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_ENTER_LPS, NULL); - else - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_NORMAL_LPS, NULL); - - if( (BT_STATE_8723A_1ANT_NO_CONNECTION == pCoexDm->btStatus) || - (BT_STATE_8723A_1ANT_CONNECT_IDLE == pCoexDm->btStatus) ) - { - if(pCoexSta->bC2hBtInquiryPage) - pCoexDm->btStatus = BT_STATE_8723A_1ANT_INQ_OR_PAG; - } -} - -VOID -EXhalbtc8723a1ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ) -{ - halbtc8723a1ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); - - halbtc8723a1ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); - halbtc8723a1ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); - - halbtc8723a1ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); - EXhalbtc8723a1ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -} - -VOID -EXhalbtc8723a1ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiConnected=FALSE; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 1Ant Periodical!!\n")); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - - // work around for c2h hang - wa_halbtc8723a1ant_MonitorC2h(pBtCoexist); - - halbtc8723a1ant_QueryBtInfo(pBtCoexist); - halbtc8723a1ant_MonitorBtCtr(pBtCoexist); - halbtc8723a1ant_MonitorBtEnableDisable(pBtCoexist); - - - if(bScan) - return; - if(bLink) - return; - - if(bWifiConnected) - { - if(pBtCoexist->btInfo.bBtDisabled) - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 9); - - halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - } - else - { - halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a1ant_CoexForWifiConnect(pBtCoexist); - } - } - else - { - halbtc8723a1ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - - halbtc8723a1ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a1ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - } -} - - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.h deleted file mode 100644 index e8c2fd003fee..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a1Ant.h +++ /dev/null @@ -1,171 +0,0 @@ -//=========================================== -// The following is for 8723A 1Ant BT Co-exist definition -//=========================================== -#define BT_INFO_8723A_1ANT_B_FTP BIT7 -#define BT_INFO_8723A_1ANT_B_A2DP BIT6 -#define BT_INFO_8723A_1ANT_B_HID BIT5 -#define BT_INFO_8723A_1ANT_B_SCO_BUSY BIT4 -#define BT_INFO_8723A_1ANT_B_ACL_BUSY BIT3 -#define BT_INFO_8723A_1ANT_B_INQ_PAGE BIT2 -#define BT_INFO_8723A_1ANT_B_SCO_ESCO BIT1 -#define BT_INFO_8723A_1ANT_B_CONNECTION BIT0 - -typedef enum _BT_STATE_8723A_1ANT{ - BT_STATE_8723A_1ANT_DISABLED = 0, - BT_STATE_8723A_1ANT_NO_CONNECTION = 1, - BT_STATE_8723A_1ANT_CONNECT_IDLE = 2, - BT_STATE_8723A_1ANT_INQ_OR_PAG = 3, - BT_STATE_8723A_1ANT_ACL_ONLY_BUSY = 4, - BT_STATE_8723A_1ANT_SCO_ONLY_BUSY = 5, - BT_STATE_8723A_1ANT_ACL_SCO_BUSY = 6, - BT_STATE_8723A_1ANT_HID_BUSY = 7, - BT_STATE_8723A_1ANT_HID_SCO_BUSY = 8, - BT_STATE_8723A_1ANT_MAX -}BT_STATE_8723A_1ANT, *PBT_STATE_8723A_1ANT; - -#define BTC_RSSI_COEX_THRESH_TOL_8723A_1ANT 2 - -typedef enum _BT_INFO_SRC_8723A_1ANT{ - BT_INFO_SRC_8723A_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8723A_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8723A_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8723A_1ANT_MAX -}BT_INFO_SRC_8723A_1ANT,*PBT_INFO_SRC_8723A_1ANT; - -typedef enum _BT_8723A_1ANT_BT_STATUS{ - BT_8723A_1ANT_BT_STATUS_IDLE = 0x0, - BT_8723A_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8723A_1ANT_BT_STATUS_NON_IDLE = 0x2, - BT_8723A_1ANT_BT_STATUS_MAX -}BT_8723A_1ANT_BT_STATUS,*PBT_8723A_1ANT_BT_STATUS; - -typedef enum _BT_8723A_1ANT_COEX_ALGO{ - BT_8723A_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8723A_1ANT_COEX_ALGO_SCO = 0x1, - BT_8723A_1ANT_COEX_ALGO_HID = 0x2, - BT_8723A_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8723A_1ANT_COEX_ALGO_PANEDR = 0x4, - BT_8723A_1ANT_COEX_ALGO_PANHS = 0x5, - BT_8723A_1ANT_COEX_ALGO_PANEDR_A2DP = 0x6, - BT_8723A_1ANT_COEX_ALGO_PANEDR_HID = 0x7, - BT_8723A_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, - BT_8723A_1ANT_COEX_ALGO_HID_A2DP = 0x9, - BT_8723A_1ANT_COEX_ALGO_MAX -}BT_8723A_1ANT_COEX_ALGO,*PBT_8723A_1ANT_COEX_ALGO; - -typedef struct _COEX_DM_8723A_1ANT{ - // fw mechanism - BOOLEAN bCurIgnoreWlanAct; - BOOLEAN bPreIgnoreWlanAct; - u1Byte prePsTdma; - u1Byte curPsTdma; - u1Byte psTdmaPara[5]; - u1Byte psTdmaDuAdjType; - u4Byte psTdmaMonitorCnt; - u4Byte psTdmaGlobalCnt; - BOOLEAN bResetTdmaAdjust; - BOOLEAN bPrePsTdmaOn; - BOOLEAN bCurPsTdmaOn; - - // sw mechanism - BOOLEAN bPreRfRxLpfShrink; - BOOLEAN bCurRfRxLpfShrink; - u4Byte btRf0x1eBackup; - BOOLEAN bPreLowPenaltyRa; - BOOLEAN bCurLowPenaltyRa; - u4Byte preVal0x6c0; - u4Byte curVal0x6c0; - u4Byte preVal0x6c8; - u4Byte curVal0x6c8; - u1Byte preVal0x6cc; - u1Byte curVal0x6cc; - BOOLEAN bLimitedDig; - - // algorithm related - u1Byte preAlgorithm; - u1Byte curAlgorithm; - u1Byte btStatus; - u1Byte wifiChnlInfo[3]; -} COEX_DM_8723A_1ANT, *PCOEX_DM_8723A_1ANT; - -typedef struct _COEX_STA_8723A_1ANT{ - u4Byte highPriorityTx; - u4Byte highPriorityRx; - u4Byte lowPriorityTx; - u4Byte lowPriorityRx; - u1Byte btRssi; - u1Byte preBtRssiState; - u1Byte preBtRssiState1; - u1Byte preWifiRssiState[4]; - BOOLEAN bC2hBtInfoReqSent; - u1Byte btInfoC2h[BT_INFO_SRC_8723A_1ANT_MAX][10]; - u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_1ANT_MAX]; - BOOLEAN bC2hBtInquiryPage; - u1Byte btRetryCnt; - u1Byte btInfoExt; - //BOOLEAN bHoldForStackOperation; - //u1Byte bHoldPeriodCnt; - // this is for c2h hang work-around - u4Byte c2hHangDetectCnt; -}COEX_STA_8723A_1ANT, *PCOEX_STA_8723A_1ANT; - -//=========================================== -// The following is interface which will notify coex module. -//=========================================== -VOID -EXhalbtc8723a1ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a1ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a1ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a1ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a1ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a1ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a1ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a1ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a1ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ); -VOID -EXhalbtc8723a1ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a1ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a1ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ); - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.c deleted file mode 100644 index f32bd9f8e33e..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.c +++ /dev/null @@ -1,3746 +0,0 @@ -//============================================================ -// Description: -// -// This file is for RTL8723A Co-exist mechanism -// -// History -// 2012/08/22 Cosa first check in. -// 2012/11/14 Cosa Revise for 8723A 2Ant out sourcing. -// -//============================================================ - -//============================================================ -// include files -//============================================================ -#include "Mp_Precomp.h" - -#if WPP_SOFTWARE_TRACE -#include "HalBtc8723a2Ant.tmh" -#endif - -#if(BT_30_SUPPORT == 1) -//============================================================ -// Global variables, these are static variables -//============================================================ -static COEX_DM_8723A_2ANT GLCoexDm8723a2Ant; -static PCOEX_DM_8723A_2ANT pCoexDm=&GLCoexDm8723a2Ant; -static COEX_STA_8723A_2ANT GLCoexSta8723a2Ant; -static PCOEX_STA_8723A_2ANT pCoexSta=&GLCoexSta8723a2Ant; - -const char *const GLBtInfoSrc8723a2Ant[]={ - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -//============================================================ -// local function proto type if needed -//============================================================ -//============================================================ -// local function start with halbtc8723a2ant_ -//============================================================ -BOOLEAN -halbtc8723a2ant_IsWifiIdle( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); - - if(bWifiConnected) - return FALSE; - if(bScan) - return FALSE; - if(bLink) - return FALSE; - if(bRoam) - return FALSE; - - return TRUE; -} - -BOOLEAN -halbtc8723a2ant_IsWifiConnectedIdle( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bWifiConnected=FALSE, bScan=FALSE, bLink=FALSE, bRoam=FALSE, bWifiBusy=FALSE; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_BUSY, &bWifiBusy); - - if(bScan) - return FALSE; - if(bLink) - return FALSE; - if(bRoam) - return FALSE; - if(bWifiConnected && !bWifiBusy) - return TRUE; - else - return FALSE; -} - -u1Byte -halbtc8723a2ant_BtRssiState( - u1Byte levelNum, - u1Byte rssiThresh, - u1Byte rssiThresh1 - ) -{ - s4Byte btRssi=0; - u1Byte btRssiState=pCoexSta->preBtRssiState; - - btRssi = pCoexSta->btRssi; - - if(levelNum == 2) - { - if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || - (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) - { - if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) - { - btRssiState = BTC_RSSI_STATE_HIGH; - } - else - { - btRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else - { - if(btRssi < rssiThresh) - { - btRssiState = BTC_RSSI_STATE_LOW; - } - else - { - btRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - else if(levelNum == 3) - { - if(rssiThresh > rssiThresh1) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT Rssi thresh error!!\n")); - return pCoexSta->preBtRssiState; - } - - if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_LOW) || - (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_LOW)) - { - if(btRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) - { - btRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - btRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else if( (pCoexSta->preBtRssiState == BTC_RSSI_STATE_MEDIUM) || - (pCoexSta->preBtRssiState == BTC_RSSI_STATE_STAY_MEDIUM)) - { - if(btRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) - { - btRssiState = BTC_RSSI_STATE_HIGH; - } - else if(btRssi < rssiThresh) - { - btRssiState = BTC_RSSI_STATE_LOW; - } - else - { - btRssiState = BTC_RSSI_STATE_STAY_MEDIUM; - } - } - else - { - if(btRssi < rssiThresh1) - { - btRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - btRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - - pCoexSta->preBtRssiState = btRssiState; - - return btRssiState; -} - -u1Byte -halbtc8723a2ant_WifiRssiState( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte index, - IN u1Byte levelNum, - IN u1Byte rssiThresh, - IN u1Byte rssiThresh1 - ) -{ - s4Byte wifiRssi=0; - u1Byte wifiRssiState=pCoexSta->preWifiRssiState[index]; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); - - if(levelNum == 2) - { - if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) - { - if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_HIGH; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else - { - if(wifiRssi < rssiThresh) - { - wifiRssiState = BTC_RSSI_STATE_LOW; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - else if(levelNum == 3) - { - if(rssiThresh > rssiThresh1) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], wifi RSSI thresh error!!\n")); - return pCoexSta->preWifiRssiState[index]; - } - - if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_LOW) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_LOW)) - { - if(wifiRssi >= (rssiThresh+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_LOW; - } - } - else if( (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_MEDIUM) || - (pCoexSta->preWifiRssiState[index] == BTC_RSSI_STATE_STAY_MEDIUM)) - { - if(wifiRssi >= (rssiThresh1+BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT)) - { - wifiRssiState = BTC_RSSI_STATE_HIGH; - } - else if(wifiRssi < rssiThresh) - { - wifiRssiState = BTC_RSSI_STATE_LOW; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_MEDIUM; - } - } - else - { - if(wifiRssi < rssiThresh1) - { - wifiRssiState = BTC_RSSI_STATE_MEDIUM; - } - else - { - wifiRssiState = BTC_RSSI_STATE_STAY_HIGH; - } - } - } - - pCoexSta->preWifiRssiState[index] = wifiRssiState; - - return wifiRssiState; -} - -VOID -halbtc8723a2ant_IndicateWifiChnlBwInfo( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - u1Byte H2C_Parameter[3] ={0}; - u4Byte wifiBw; - u1Byte wifiCentralChnl; - - // only 2.4G we need to inform bt the chnl mask - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifiCentralChnl); - if( (BTC_MEDIA_CONNECT == type) && - (wifiCentralChnl <= 14) ) - { - H2C_Parameter[0] = 0x1; - H2C_Parameter[1] = wifiCentralChnl; - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - H2C_Parameter[2] = 0x30; - else - H2C_Parameter[2] = 0x20; - } - - pCoexDm->wifiChnlInfo[0] = H2C_Parameter[0]; - pCoexDm->wifiChnlInfo[1] = H2C_Parameter[1]; - pCoexDm->wifiChnlInfo[2] = H2C_Parameter[2]; - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x19=0x%x\n", - H2C_Parameter[0]<<16|H2C_Parameter[1]<<8|H2C_Parameter[2])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x19, 3, H2C_Parameter); -} - -VOID -halbtc8723a2ant_QueryBtInfo( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte H2C_Parameter[1] ={0}; - - pCoexSta->bC2hBtInfoReqSent = TRUE; - - H2C_Parameter[0] |= BIT0; // trigger - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Query Bt Info, FW write 0x38=0x%x\n", - H2C_Parameter[0])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x38, 1, H2C_Parameter); -} -u1Byte -halbtc8723a2ant_ActionAlgorithm( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - BOOLEAN bBtHsOn=FALSE, bBtBusy=FALSE, bLimitedDig=FALSE; - u1Byte algorithm=BT_8723A_2ANT_COEX_ALGO_UNDEFINED; - u1Byte numOfDiffProfile=0; - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - - //====================== - // here we get BT status first - //====================== - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_IDLE; - - if((pStackInfo->bScoExist) ||(bBtHsOn) ||(pStackInfo->bHidExist)) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO or HID or HS exists, set BT non-idle !!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; - } - else - { - // A2dp profile - if( (pBtCoexist->stackInfo.numOfLink == 1) && - (pStackInfo->bA2dpExist) ) - { - if( (pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 100) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx < 100, set BT connected-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP, low priority tx+rx >= 100, set BT non-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; - } - } - // Pan profile - if( (pBtCoexist->stackInfo.numOfLink == 1) && - (pStackInfo->bPanExist) ) - { - if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority tx+rx < 600, set BT connected-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; - } - else - { - if(pCoexSta->lowPriorityTx) - { - if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, low priority rx/tx > 9, set BT connected-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; - } - } - } - if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN, set BT non-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; - } - } - // Pan+A2dp profile - if( (pBtCoexist->stackInfo.numOfLink == 2) && - (pStackInfo->bA2dpExist) && - (pStackInfo->bPanExist) ) - { - if((pCoexSta->lowPriorityTx+ pCoexSta->lowPriorityRx) < 600) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority tx+rx < 600, set BT connected-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; - } - else - { - if(pCoexSta->lowPriorityTx) - { - if((pCoexSta->lowPriorityRx /pCoexSta->lowPriorityTx)>9 ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, low priority rx/tx > 9, set BT connected-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE; - } - } - } - if(BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE != pCoexDm->btStatus) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN+A2DP, set BT non-idle!!!\n")); - pCoexDm->btStatus = BT_8723A_2ANT_BT_STATUS_NON_IDLE; - } - } - } - if(BT_8723A_2ANT_BT_STATUS_IDLE != pCoexDm->btStatus) - { - bBtBusy = TRUE; - bLimitedDig = TRUE; - } - else - { - bBtBusy = FALSE; - bLimitedDig = FALSE; - } - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bBtBusy); - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_LIMITED_DIG, &bLimitedDig); - //====================== - - if(!pStackInfo->bBtLinkExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], No profile exists!!!\n")); - return algorithm; - } - - if(pStackInfo->bScoExist) - numOfDiffProfile++; - if(pStackInfo->bHidExist) - numOfDiffProfile++; - if(pStackInfo->bPanExist) - numOfDiffProfile++; - if(pStackInfo->bA2dpExist) - numOfDiffProfile++; - - if(numOfDiffProfile == 1) - { - if(pStackInfo->bScoExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO only\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; - } - else - { - if(pStackInfo->bHidExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID only\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID; - } - else if(pStackInfo->bA2dpExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP only\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; - } - else if(pStackInfo->bPanExist) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(HS) only\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANHS; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PAN(EDR) only\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR; - } - } - } - } - else if(numOfDiffProfile == 2) - { - if(pStackInfo->bScoExist) - { - if(pStackInfo->bHidExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID; - } - else if(pStackInfo->bA2dpExist) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP ==> SCO\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; - } - else if(pStackInfo->bPanExist) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(HS)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + PAN(EDR)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } - else - { - if( pStackInfo->bHidExist && - pStackInfo->bA2dpExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; - } - else if( pStackInfo->bHidExist && - pStackInfo->bPanExist ) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(HS)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + PAN(EDR)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; - } - } - else if( pStackInfo->bPanExist && - pStackInfo->bA2dpExist ) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(HS)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_A2DP; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], A2DP + PAN(EDR)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP; - } - } - } - } - else if(numOfDiffProfile == 3) - { - if(pStackInfo->bScoExist) - { - if( pStackInfo->bHidExist && - pStackInfo->bA2dpExist ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP ==> HID\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID; - } - else if( pStackInfo->bHidExist && - pStackInfo->bPanExist ) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(HS)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + PAN(EDR)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; - } - } - else if( pStackInfo->bPanExist && - pStackInfo->bA2dpExist ) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(HS)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_SCO; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } - else - { - if( pStackInfo->bHidExist && - pStackInfo->bPanExist && - pStackInfo->bA2dpExist ) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(HS)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], HID + A2DP + PAN(EDR)\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR; - } - } - } - } - else if(numOfDiffProfile >= 3) - { - if(pStackInfo->bScoExist) - { - if( pStackInfo->bHidExist && - pStackInfo->bPanExist && - pStackInfo->bA2dpExist ) - { - if(bBtHsOn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n")); - - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n")); - algorithm = BT_8723A_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -BOOLEAN -halbtc8723a2ant_NeedToDecBtPwr( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bRet=FALSE; - BOOLEAN bBtHsOn=FALSE, bWifiConnected=FALSE; - s4Byte btHsRssi=0; - u1Byte btRssiState=BTC_RSSI_STATE_HIGH; - - btRssiState = halbtc8723a2ant_BtRssiState(2, 42, 0); - - if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn)) - return FALSE; - if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected)) - return FALSE; - if(!pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_S4_HS_RSSI, &btHsRssi)) - return FALSE; - if(BTC_RSSI_LOW(btRssiState)) - return FALSE; - - if(bWifiConnected) - { - if(bBtHsOn) - { - if(btHsRssi > 37) - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for HS mode!!\n")); - bRet = TRUE; - } - } - else - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Need to decrease bt power for Wifi is connected!!\n")); - bRet = TRUE; - } - } - - return bRet; -} - -VOID -halbtc8723a2ant_SetFwDacSwingLevel( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte dacSwingLvl - ) -{ - u1Byte H2C_Parameter[1] ={0}; - - // There are several type of dacswing - // 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 - H2C_Parameter[0] = dacSwingLvl; - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Set Dac Swing Level=0x%x\n", dacSwingLvl)); - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x29=0x%x\n", H2C_Parameter[0])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x29, 1, H2C_Parameter); -} - -VOID -halbtc8723a2ant_SetFwDecBtPwr( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bDecBtPwr - ) -{ - u1Byte H2C_Parameter[1] ={0}; - - H2C_Parameter[0] = 0; - - if(bDecBtPwr) - { - H2C_Parameter[0] |= BIT1; - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], decrease Bt Power : %s, FW write 0x21=0x%x\n", - (bDecBtPwr? "Yes!!":"No!!"), H2C_Parameter[0])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x21, 1, H2C_Parameter); -} - -VOID -halbtc8723a2ant_DecBtPwr( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bDecBtPwr - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s Dec BT power = %s\n", - (bForceExec? "force to":""), ((bDecBtPwr)? "ON":"OFF"))); - pCoexDm->bCurDecBtPwr = bDecBtPwr; - - if(!bForceExec) - { - if(pCoexDm->bPreDecBtPwr == pCoexDm->bCurDecBtPwr) - return; - } - halbtc8723a2ant_SetFwDecBtPwr(pBtCoexist, pCoexDm->bCurDecBtPwr); - - pCoexDm->bPreDecBtPwr = pCoexDm->bCurDecBtPwr; -} - -VOID -halbtc8723a2ant_FwDacSwingLvl( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN u1Byte fwDacSwingLvl - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s set FW Dac Swing level = %d\n", - (bForceExec? "force to":""), fwDacSwingLvl)); - pCoexDm->curFwDacSwingLvl = fwDacSwingLvl; - - if(!bForceExec) - { - if(pCoexDm->preFwDacSwingLvl == pCoexDm->curFwDacSwingLvl) - return; - } - - halbtc8723a2ant_SetFwDacSwingLevel(pBtCoexist, pCoexDm->curFwDacSwingLvl); - - pCoexDm->preFwDacSwingLvl = pCoexDm->curFwDacSwingLvl; -} - -VOID -halbtc8723a2ant_SetSwRfRxLpfCorner( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bRxRfShrinkOn - ) -{ - if(bRxRfShrinkOn) - { - //Shrink RF Rx LPF corner - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Shrink RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, 0xf0ff7); - } - else - { - //Resume RF Rx LPF corner - // After initialized, we can use pCoexDm->btRf0x1eBackup - if(pBtCoexist->bInitilized) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Resume RF Rx LPF corner!!\n")); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff, pCoexDm->btRf0x1eBackup); - } - } -} - -VOID -halbtc8723a2ant_RfShrink( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bRxRfShrinkOn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Rx RF Shrink = %s\n", - (bForceExec? "force to":""), ((bRxRfShrinkOn)? "ON":"OFF"))); - pCoexDm->bCurRfRxLpfShrink = bRxRfShrinkOn; - - if(!bForceExec) - { - if(pCoexDm->bPreRfRxLpfShrink == pCoexDm->bCurRfRxLpfShrink) - return; - } - halbtc8723a2ant_SetSwRfRxLpfCorner(pBtCoexist, pCoexDm->bCurRfRxLpfShrink); - - pCoexDm->bPreRfRxLpfShrink = pCoexDm->bCurRfRxLpfShrink; -} - -VOID -halbtc8723a2ant_SetSwPenaltyTxRateAdaptive( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bLowPenaltyRa - ) -{ - u1Byte tmpU1; - - tmpU1 = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x4fd); - tmpU1 |= BIT0; - if(bLowPenaltyRa) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set low penalty!!\n")); - tmpU1 &= ~BIT2; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Tx rate adaptive, set normal!!\n")); - tmpU1 |= BIT2; - } - - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x4fd, tmpU1); -} - -VOID -halbtc8723a2ant_LowPenaltyRa( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bLowPenaltyRa - ) -{ - return; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn LowPenaltyRA = %s\n", - (bForceExec? "force to":""), ((bLowPenaltyRa)? "ON":"OFF"))); - pCoexDm->bCurLowPenaltyRa = bLowPenaltyRa; - - if(!bForceExec) - { - if(pCoexDm->bPreLowPenaltyRa == pCoexDm->bCurLowPenaltyRa) - return; - } - halbtc8723a2ant_SetSwPenaltyTxRateAdaptive(pBtCoexist, pCoexDm->bCurLowPenaltyRa); - - pCoexDm->bPreLowPenaltyRa = pCoexDm->bCurLowPenaltyRa; -} - -VOID -halbtc8723a2ant_SetSwFullTimeDacSwing( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bSwDacSwingOn, - IN u4Byte swDacSwingLvl - ) -{ - if(bSwDacSwingOn) - { - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, swDacSwingLvl); - } - else - { - pBtCoexist->fBtcSetBbReg(pBtCoexist, 0x880, 0xff000000, 0xc0); - } -} - - -VOID -halbtc8723a2ant_DacSwing( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bDacSwingOn, - IN u4Byte dacSwingLvl - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn DacSwing=%s, dacSwingLvl=0x%x\n", - (bForceExec? "force to":""), ((bDacSwingOn)? "ON":"OFF"), dacSwingLvl)); - pCoexDm->bCurDacSwingOn = bDacSwingOn; - pCoexDm->curDacSwingLvl = dacSwingLvl; - - if(!bForceExec) - { - if( (pCoexDm->bPreDacSwingOn == pCoexDm->bCurDacSwingOn) && - (pCoexDm->preDacSwingLvl == pCoexDm->curDacSwingLvl) ) - return; - } - delay_ms(30); - halbtc8723a2ant_SetSwFullTimeDacSwing(pBtCoexist, bDacSwingOn, dacSwingLvl); - - pCoexDm->bPreDacSwingOn = pCoexDm->bCurDacSwingOn; - pCoexDm->preDacSwingLvl = pCoexDm->curDacSwingLvl; -} - -VOID -halbtc8723a2ant_SetAdcBackOff( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bAdcBackOff - ) -{ - if(bAdcBackOff) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level On!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a07611); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BB BackOff Level Off!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc04,0x3a05611); - } -} - -VOID -halbtc8723a2ant_AdcBackOff( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bAdcBackOff - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn AdcBackOff = %s\n", - (bForceExec? "force to":""), ((bAdcBackOff)? "ON":"OFF"))); - pCoexDm->bCurAdcBackOff = bAdcBackOff; - - if(!bForceExec) - { - if(pCoexDm->bPreAdcBackOff == pCoexDm->bCurAdcBackOff) - return; - } - halbtc8723a2ant_SetAdcBackOff(pBtCoexist, pCoexDm->bCurAdcBackOff); - - pCoexDm->bPreAdcBackOff = pCoexDm->bCurAdcBackOff; -} - -VOID -halbtc8723a2ant_SetAgcTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bAgcTableEn - ) -{ - u1Byte rssiAdjustVal=0; - - if(bAgcTableEn) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table On!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4e1c0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4d1d0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4c1e0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4b1f0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x4a200001); - - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xdc000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x90000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x51000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x12000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x00355); - - rssiAdjustVal = 6; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Agc Table Off!\n")); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x641c0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x631d0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x621e0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x611f0001); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0xc78,0x60200001); - - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x32000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0x71000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xb0000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x12, 0xfffff, 0xfc000); - pBtCoexist->fBtcSetRfReg(pBtCoexist, BTC_RF_A, 0x1a, 0xfffff, 0x30355); - } - - // set rssiAdjustVal for wifi module. - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, &rssiAdjustVal); -} - - -VOID -halbtc8723a2ant_AgcTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bAgcTableEn - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s %s Agc Table\n", - (bForceExec? "force to":""), ((bAgcTableEn)? "Enable":"Disable"))); - pCoexDm->bCurAgcTableEn = bAgcTableEn; - - if(!bForceExec) - { - if(pCoexDm->bPreAgcTableEn == pCoexDm->bCurAgcTableEn) - return; - } - halbtc8723a2ant_SetAgcTable(pBtCoexist, bAgcTableEn); - - pCoexDm->bPreAgcTableEn = pCoexDm->bCurAgcTableEn; -} - -VOID -halbtc8723a2ant_SetCoexTable( - IN PBTC_COEXIST pBtCoexist, - IN u4Byte val0x6c0, - IN u4Byte val0x6c8, - IN u1Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c0, val0x6c0); - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8)); - pBtCoexist->fBtcWrite4Byte(pBtCoexist, 0x6c8, val0x6c8); - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc)); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x6cc, val0x6cc); -} - -VOID -halbtc8723a2ant_CoexTable( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN u4Byte val0x6c0, - IN u4Byte val0x6c8, - IN u1Byte val0x6cc - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", - (bForceExec? "force to":""), val0x6c0, val0x6c8, val0x6cc)); - pCoexDm->curVal0x6c0 = val0x6c0; - pCoexDm->curVal0x6c8 = val0x6c8; - pCoexDm->curVal0x6cc = val0x6cc; - - if(!bForceExec) - { - if( (pCoexDm->preVal0x6c0 == pCoexDm->curVal0x6c0) && - (pCoexDm->preVal0x6c8 == pCoexDm->curVal0x6c8) && - (pCoexDm->preVal0x6cc == pCoexDm->curVal0x6cc) ) - return; - } - halbtc8723a2ant_SetCoexTable(pBtCoexist, val0x6c0, val0x6c8, val0x6cc); - - pCoexDm->preVal0x6c0 = pCoexDm->curVal0x6c0; - pCoexDm->preVal0x6c8 = pCoexDm->curVal0x6c8; - pCoexDm->preVal0x6cc = pCoexDm->curVal0x6cc; -} - -VOID -halbtc8723a2ant_SetFwIgnoreWlanAct( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bEnable - ) -{ - u1Byte H2C_Parameter[1] ={0}; - - if(bEnable) - { - H2C_Parameter[0] |= BIT0; // function enable - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], set FW for BT Ignore Wlan_Act, FW write 0x25=0x%x\n", - H2C_Parameter[0])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x25, 1, H2C_Parameter); -} - -VOID -halbtc8723a2ant_IgnoreWlanAct( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bEnable - ) -{ - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn Ignore WlanAct %s\n", - (bForceExec? "force to":""), (bEnable? "ON":"OFF"))); - pCoexDm->bCurIgnoreWlanAct = bEnable; - - if(!bForceExec) - { - if(pCoexDm->bPreIgnoreWlanAct == pCoexDm->bCurIgnoreWlanAct) - return; - } - halbtc8723a2ant_SetFwIgnoreWlanAct(pBtCoexist, bEnable); - - pCoexDm->bPreIgnoreWlanAct = pCoexDm->bCurIgnoreWlanAct; -} - -VOID -halbtc8723a2ant_SetFwPstdma( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte byte1, - IN u1Byte byte2, - IN u1Byte byte3, - IN u1Byte byte4, - IN u1Byte byte5 - ) -{ - u1Byte H2C_Parameter[5] ={0}; - - H2C_Parameter[0] = byte1; - H2C_Parameter[1] = byte2; - H2C_Parameter[2] = byte3; - H2C_Parameter[3] = byte4; - H2C_Parameter[4] = byte5; - - pCoexDm->psTdmaPara[0] = byte1; - pCoexDm->psTdmaPara[1] = byte2; - pCoexDm->psTdmaPara[2] = byte3; - pCoexDm->psTdmaPara[3] = byte4; - pCoexDm->psTdmaPara[4] = byte5; - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], FW write 0x3a(5bytes)=0x%x%08x\n", - H2C_Parameter[0], - H2C_Parameter[1]<<24|H2C_Parameter[2]<<16|H2C_Parameter[3]<<8|H2C_Parameter[4])); - - pBtCoexist->fBtcFillH2c(pBtCoexist, 0x3a, 5, H2C_Parameter); -} - -VOID -halbtc8723a2ant_PsTdma( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bForceExec, - IN BOOLEAN bTurnOn, - IN u1Byte type - ) -{ - u4Byte btTxRxCnt=0; - - btTxRxCnt = pCoexSta->highPriorityTx+pCoexSta->highPriorityRx+ - pCoexSta->lowPriorityTx+pCoexSta->lowPriorityRx; - - if(btTxRxCnt > 3000) - { - pCoexDm->bCurPsTdmaOn = TRUE; - pCoexDm->curPsTdma = 8; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], turn ON PS TDMA, type=%d for BT tx/rx counters=%d(>3000)\n", - pCoexDm->curPsTdma, btTxRxCnt)); - } - else - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], %s turn %s PS TDMA, type=%d\n", - (bForceExec? "force to":""), (bTurnOn? "ON":"OFF"), type)); - pCoexDm->bCurPsTdmaOn = bTurnOn; - pCoexDm->curPsTdma = type; - } - - if(!bForceExec) - { - if( (pCoexDm->bPrePsTdmaOn == pCoexDm->bCurPsTdmaOn) && - (pCoexDm->prePsTdma == pCoexDm->curPsTdma) ) - return; - } - if(pCoexDm->bCurPsTdmaOn) - { - switch(pCoexDm->curPsTdma) - { - case 1: - default: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); - break; - case 2: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); - break; - case 3: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); - break; - case 4: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0xe1, 0x80); - break; - case 5: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); - break; - case 6: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); - break; - case 7: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); - break; - case 8: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x5, 0x5, 0x60, 0x80); - break; - case 9: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x98); - break; - case 10: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0xe1, 0x98); - break; - case 11: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0xe1, 0x98); - break; - case 12: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); - break; - case 13: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x1a, 0x1a, 0x60, 0x98); - break; - case 14: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x12, 0x12, 0x60, 0x98); - break; - case 15: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0xa, 0xa, 0x60, 0x98); - break; - case 16: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0x60, 0x98); - break; - case 17: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xa3, 0x2f, 0x2f, 0x60, 0x80); - break; - case 18: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x5, 0x5, 0xe1, 0x98); - break; - case 19: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0xe1, 0x98); - break; - case 20: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0xe3, 0x25, 0x25, 0x60, 0x98); - break; - } - } - else - { - // disable PS tdma - switch(pCoexDm->curPsTdma) - { - case 0: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); - break; - case 1: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x0, 0x0); - break; - default: - halbtc8723a2ant_SetFwPstdma(pBtCoexist, 0x0, 0x0, 0x0, 0x8, 0x0); - break; - } - } - - // update pre state - pCoexDm->bPrePsTdmaOn = pCoexDm->bCurPsTdmaOn; - pCoexDm->prePsTdma = pCoexDm->curPsTdma; -} - - -VOID -halbtc8723a2ant_CoexAllOff( - IN PBTC_COEXIST pBtCoexist - ) -{ - // fw all off - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - - // sw all off - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - - // hw all off - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); -} - -VOID -halbtc8723a2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ - // force to reset coex mechanism - halbtc8723a2ant_CoexTable(pBtCoexist, FORCE_EXEC, 0x55555555, 0xffff, 0x3); - halbtc8723a2ant_PsTdma(pBtCoexist, FORCE_EXEC, FALSE, 0); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, FORCE_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, FORCE_EXEC, FALSE); - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); - - halbtc8723a2ant_AgcTable(pBtCoexist, FORCE_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, FORCE_EXEC, FALSE); - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, FORCE_EXEC, FALSE); - halbtc8723a2ant_RfShrink(pBtCoexist, FORCE_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, FORCE_EXEC, FALSE, 0xc0); -} - -VOID -halbtc8723a2ant_BtInquiryPage( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bLowPwrDisable=TRUE; - - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); - - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); -} - -VOID -halbtc8723a2ant_BtEnableAction( - IN PBTC_COEXIST pBtCoexist - ) -{ - BOOLEAN bWifiConnected=FALSE; - - // Here we need to resend some wifi info to BT - // because bt is reset and loss of the info. - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - if(bWifiConnected) - { - halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_CONNECT); - } - else - { - halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, BTC_MEDIA_DISCONNECT); - } - - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, FALSE); -} - -VOID -halbtc8723a2ant_MonitorBtCtr( - IN PBTC_COEXIST pBtCoexist - ) -{ - u4Byte regHPTxRx, regLPTxRx, u4Tmp; - u4Byte regHPTx=0, regHPRx=0, regLPTx=0, regLPRx=0; - u1Byte u1Tmp; - - regHPTxRx = 0x770; - regLPTxRx = 0x774; - - u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regHPTxRx); - regHPTx = u4Tmp & bMaskLWord; - regHPRx = (u4Tmp & bMaskHWord)>>16; - - u4Tmp = pBtCoexist->fBtcRead4Byte(pBtCoexist, regLPTxRx); - regLPTx = u4Tmp & bMaskLWord; - regLPRx = (u4Tmp & bMaskHWord)>>16; - - pCoexSta->highPriorityTx = regHPTx; - pCoexSta->highPriorityRx = regHPRx; - pCoexSta->lowPriorityTx = regLPTx; - pCoexSta->lowPriorityRx = regLPRx; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - regHPTxRx, regHPTx, regHPTx, regHPRx, regHPRx)); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - regLPTxRx, regLPTx, regLPTx, regLPRx, regLPRx)); - - // reset counter - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0xc); -} - -VOID -halbtc8723a2ant_MonitorBtEnableDisable( - IN PBTC_COEXIST pBtCoexist - ) -{ - static BOOLEAN bPreBtDisabled=FALSE; - static u4Byte btDisableCnt=0; - BOOLEAN bBtActive=TRUE, bBtDisabled=FALSE; - - // This function check if bt is disabled - - if( pCoexSta->highPriorityTx == 0 && - pCoexSta->highPriorityRx == 0 && - pCoexSta->lowPriorityTx == 0 && - pCoexSta->lowPriorityRx == 0) - { - bBtActive = FALSE; - } - if( pCoexSta->highPriorityTx == 0xffff && - pCoexSta->highPriorityRx == 0xffff && - pCoexSta->lowPriorityTx == 0xffff && - pCoexSta->lowPriorityRx == 0xffff) - { - bBtActive = FALSE; - } - if(bBtActive) - { - btDisableCnt = 0; - bBtDisabled = FALSE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is enabled !!\n")); - } - else - { - btDisableCnt++; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], bt all counters=0, %d times!!\n", - btDisableCnt)); - if(btDisableCnt >= 2) - { - bBtDisabled = TRUE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_BL_BT_DISABLE, &bBtDisabled); - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is disabled !!\n")); - } - } - if(bPreBtDisabled != bBtDisabled) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], BT is from %s to %s!!\n", - (bPreBtDisabled ? "disabled":"enabled"), - (bBtDisabled ? "disabled":"enabled"))); - bPreBtDisabled = bBtDisabled; - if(!bBtDisabled) - { - halbtc8723a2ant_BtEnableAction(pBtCoexist); - } - } -} - -BOOLEAN -halbtc8723a2ant_IsCommonAction( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - BOOLEAN bCommon=FALSE, bWifiConnected=FALSE; - BOOLEAN bLowPwrDisable=FALSE; - - if(!pStackInfo->bBtLinkExist) - { - bLowPwrDisable = FALSE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); - } - else - { - bLowPwrDisable = TRUE; - pBtCoexist->fBtcSet(pBtCoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &bLowPwrDisable); - } - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_CONNECTED, &bWifiConnected); - - if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && - BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt idle!!\n")); - - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - - bCommon = TRUE; - } - else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && - (BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT idle!!\n")); - - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - - bCommon = TRUE; - } - else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && - (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + Bt connected idle!!\n")); - - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - - bCommon = TRUE; - } - else if(!halbtc8723a2ant_IsWifiIdle(pBtCoexist) && - (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + Bt connected idle!!\n")); - - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - - bCommon = TRUE; - } - else if(halbtc8723a2ant_IsWifiIdle(pBtCoexist) && - (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi idle + BT non-idle!!\n")); - - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - - bCommon = TRUE; - } - else if(halbtc8723a2ant_IsWifiConnectedIdle(pBtCoexist) && - (BT_8723A_2ANT_BT_STATUS_NON_IDLE == pCoexDm->btStatus) ) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi connected-idle + BT non-idle!!\n")); - - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - - bCommon = TRUE; - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Wifi non-idle + BT non-idle!!\n")); - halbtc8723a2ant_LowPenaltyRa(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_RfShrink(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_FwDacSwingLvl(pBtCoexist, NORMAL_EXEC, 0x20); - - bCommon = FALSE; - } - - return bCommon; -} -VOID -halbtc8723a2ant_TdmaDurationAdjust( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bScoHid, - IN BOOLEAN bTxPause, - IN u1Byte maxInterval - ) -{ - static s4Byte up,dn,m,n,WaitCount; - s4Byte result; //0: no change, +1: increase WiFi duration, -1: decrease WiFi duration - u1Byte retryCount=0; - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TdmaDurationAdjust()\n")); - - if(pCoexDm->bResetTdmaAdjust) - { - pCoexDm->bResetTdmaAdjust = FALSE; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], first run TdmaDurationAdjust()!!\n")); - { - if(bScoHid) - { - if(bTxPause) - { - if(maxInterval == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); - pCoexDm->psTdmaDuAdjType = 13; - } - else if(maxInterval == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(maxInterval == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - } - else - { - if(maxInterval == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); - pCoexDm->psTdmaDuAdjType = 9; - } - else if(maxInterval == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(maxInterval == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - } - } - else - { - if(bTxPause) - { - if(maxInterval == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); - pCoexDm->psTdmaDuAdjType = 5; - } - else if(maxInterval == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(maxInterval == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - } - else - { - if(maxInterval == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); - pCoexDm->psTdmaDuAdjType = 1; - } - else if(maxInterval == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(maxInterval == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - } - } - } - //============ - up = 0; - dn = 0; - m = 1; - n= 3; - result = 0; - WaitCount = 0; - } - else - { - //accquire the BT TRx retry count from BT_Info byte2 - retryCount = pCoexSta->btRetryCnt; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], retryCount = %d\n", retryCount)); - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], up=%d, dn=%d, m=%d, n=%d, WaitCount=%d\n", - up, dn, m, n, WaitCount)); - result = 0; - WaitCount++; - - if(retryCount == 0) // no retry in the last 2-second duration - { - up++; - dn--; - - if (dn <= 0) - dn = 0; - - if(up >= n) // if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration - { - WaitCount = 0; - n = 3; - up = 0; - dn = 0; - result = 1; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Increase wifi duration!!\n")); - } - } - else if (retryCount <= 3) // <=3 retry in the last 2-second duration - { - up--; - dn++; - - if (up <= 0) - up = 0; - - if (dn == 2) // if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration - { - if (WaitCount <= 2) - m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ - else - m = 1; - - if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. - m = 20; - - n = 3*m; - up = 0; - dn = 0; - WaitCount = 0; - result = -1; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter<3!!\n")); - } - } - else //retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration - { - if (WaitCount == 1) - m++; // ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ - else - m = 1; - - if ( m >= 20) //m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. - m = 20; - - n = 3*m; - up = 0; - dn = 0; - WaitCount = 0; - result = -1; - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], Decrease wifi duration for retryCounter>3!!\n")); - } - - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], max Interval = %d\n", maxInterval)); - if(maxInterval == 1) - { - if(bTxPause) - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); - - if(pCoexDm->curPsTdma == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); - pCoexDm->psTdmaDuAdjType = 5; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 4) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - pCoexDm->psTdmaDuAdjType = 8; - } - if(pCoexDm->curPsTdma == 9) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); - pCoexDm->psTdmaDuAdjType = 13; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 12) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - pCoexDm->psTdmaDuAdjType = 16; - } - - if(result == -1) - { - if(pCoexDm->curPsTdma == 5) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - pCoexDm->psTdmaDuAdjType = 8; - } - else if(pCoexDm->curPsTdma == 13) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - pCoexDm->psTdmaDuAdjType = 16; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 8) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 5); - pCoexDm->psTdmaDuAdjType = 5; - } - else if(pCoexDm->curPsTdma == 16) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); - pCoexDm->psTdmaDuAdjType = 13; - } - } - } - else - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); - if(pCoexDm->curPsTdma == 5) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); - pCoexDm->psTdmaDuAdjType = 1; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 8) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - pCoexDm->psTdmaDuAdjType = 4; - } - if(pCoexDm->curPsTdma == 13) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); - pCoexDm->psTdmaDuAdjType = 9; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 16) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - pCoexDm->psTdmaDuAdjType = 12; - } - - if(result == -1) - { - if(pCoexDm->curPsTdma == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - pCoexDm->psTdmaDuAdjType = 4; - } - else if(pCoexDm->curPsTdma == 9) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - pCoexDm->psTdmaDuAdjType = 12; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 4) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 1); - pCoexDm->psTdmaDuAdjType = 1; - } - else if(pCoexDm->curPsTdma == 12) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); - pCoexDm->psTdmaDuAdjType = 9; - } - } - } - } - else if(maxInterval == 2) - { - if(bTxPause) - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); - if(pCoexDm->curPsTdma == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 4) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - pCoexDm->psTdmaDuAdjType = 8; - } - if(pCoexDm->curPsTdma == 9) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 12) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - pCoexDm->psTdmaDuAdjType = 16; - } - if(result == -1) - { - if(pCoexDm->curPsTdma == 5) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - pCoexDm->psTdmaDuAdjType = 8; - } - else if(pCoexDm->curPsTdma == 13) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - pCoexDm->psTdmaDuAdjType = 16; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 8) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - pCoexDm->psTdmaDuAdjType = 6; - } - else if(pCoexDm->curPsTdma == 16) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - pCoexDm->psTdmaDuAdjType = 14; - } - } - } - else - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); - if(pCoexDm->curPsTdma == 5) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 8) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - pCoexDm->psTdmaDuAdjType = 4; - } - if(pCoexDm->curPsTdma == 13) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 16) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - pCoexDm->psTdmaDuAdjType = 12; - } - if(result == -1) - { - if(pCoexDm->curPsTdma == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - pCoexDm->psTdmaDuAdjType = 4; - } - else if(pCoexDm->curPsTdma == 9) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - pCoexDm->psTdmaDuAdjType = 12; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 4) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - pCoexDm->psTdmaDuAdjType = 2; - } - else if(pCoexDm->curPsTdma == 12) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - pCoexDm->psTdmaDuAdjType = 10; - } - } - } - } - else if(maxInterval == 3) - { - if(bTxPause) - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 1\n")); - if(pCoexDm->curPsTdma == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 4) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - pCoexDm->psTdmaDuAdjType = 8; - } - if(pCoexDm->curPsTdma == 9) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 12) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - pCoexDm->psTdmaDuAdjType = 16; - } - if(result == -1) - { - if(pCoexDm->curPsTdma == 5) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - pCoexDm->psTdmaDuAdjType = 8; - } - else if(pCoexDm->curPsTdma == 13) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - pCoexDm->psTdmaDuAdjType = 16; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 8) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 7); - pCoexDm->psTdmaDuAdjType = 7; - } - else if(pCoexDm->curPsTdma == 16) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - pCoexDm->psTdmaDuAdjType = 15; - } - } - } - else - { - RT_TRACE(COMP_COEX, DBG_TRACE, ("[BTCoex], TxPause = 0\n")); - if(pCoexDm->curPsTdma == 5) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 6) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 7) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 8) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - pCoexDm->psTdmaDuAdjType = 4; - } - if(pCoexDm->curPsTdma == 13) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 14) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 15) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 16) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - pCoexDm->psTdmaDuAdjType = 12; - } - if(result == -1) - { - if(pCoexDm->curPsTdma == 1) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - pCoexDm->psTdmaDuAdjType = 4; - } - else if(pCoexDm->curPsTdma == 9) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - pCoexDm->psTdmaDuAdjType = 12; - } - } - else if (result == 1) - { - if(pCoexDm->curPsTdma == 4) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 3) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 2) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 3); - pCoexDm->psTdmaDuAdjType = 3; - } - else if(pCoexDm->curPsTdma == 12) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 11) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - else if(pCoexDm->curPsTdma == 10) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - pCoexDm->psTdmaDuAdjType = 11; - } - } - } - } - } - - // if current PsTdma not match with the recorded one (when scan, dhcp...), - // then we have to adjust it back to the previous record one. - if(pCoexDm->curPsTdma != pCoexDm->psTdmaDuAdjType) - { - BOOLEAN bScan=FALSE, bLink=FALSE, bRoam=FALSE; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], PsTdma type dismatch!!!, curPsTdma=%d, recordPsTdma=%d\n", - pCoexDm->curPsTdma, pCoexDm->psTdmaDuAdjType)); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); - - if( !bScan && !bLink && !bRoam) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, pCoexDm->psTdmaDuAdjType); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n")); - } - } -} - -// SCO only or SCO+PAN(HS) -VOID -halbtc8723a2ant_ActionSco( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1; - u4Byte wifiBw; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 11); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 15); - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - - -VOID -halbtc8723a2ant_ActionHid( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1; - u4Byte wifiBw; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 9); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 13); - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - -//A2DP only / PAN(EDR) only/ A2DP+PAN(HS) -VOID -halbtc8723a2ant_ActionA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1, btInfoExt; - u4Byte wifiBw; - - btInfoExt = pCoexSta->btInfoExt; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); - } - else - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); - } - } - else - { - if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); - } - else - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); - } - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 3); - } - else - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, FALSE, 1); - } - } - else - { - if(btInfoExt&BIT0) //a2dp rate, 1:basic /0:edr - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 3); - } - else - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, FALSE, TRUE, 1); - } - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - -VOID -halbtc8723a2ant_ActionPanEdr( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1, btInfoExt; - u4Byte wifiBw; - - btInfoExt = pCoexSta->btInfoExt; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - - -//PAN(HS) only -VOID -halbtc8723a2ant_ActionPanHs( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState; - u4Byte wifiBw; - - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - } - else - { - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - } - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - } - else - { - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, FALSE, 0); - } - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - -//PAN(EDR)+A2DP -VOID -halbtc8723a2ant_ActionPanEdrA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1, btInfoExt; - u4Byte wifiBw; - - btInfoExt = pCoexSta->btInfoExt; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - } - } - else - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - } - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 4); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 2); - } - } - else - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 8); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 6); - } - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - -VOID -halbtc8723a2ant_ActionPanEdrHid( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1; - u4Byte wifiBw; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - } - else - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - } - - // sw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - -// HID+A2DP+PAN(EDR) -VOID -halbtc8723a2ant_ActionHidA2dpPanEdr( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1, btInfoExt; - u4Byte wifiBw; - - btInfoExt = pCoexSta->btInfoExt; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - } - } - else - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - } - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 12); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 10); - } - } - else - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 16); - } - else //a2dp edr rate - { - halbtc8723a2ant_PsTdma(pBtCoexist, NORMAL_EXEC, TRUE, 14); - } - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - -VOID -halbtc8723a2ant_ActionHidA2dp( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte wifiRssiState, wifiRssiState1, btInfoExt; - u4Byte wifiBw; - - btInfoExt = pCoexSta->btInfoExt; - - if(halbtc8723a2ant_NeedToDecBtPwr(pBtCoexist)) - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, TRUE); - else - halbtc8723a2ant_DecBtPwr(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_CoexTable(pBtCoexist, NORMAL_EXEC, 0x55555555, 0xffff, 0x3); - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_U4_WIFI_BW, &wifiBw); - if(BTC_WIFI_BW_HT40 == wifiBw) - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 37, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); - } - else //a2dp edr rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); - } - } - else - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); - } - else //a2dp edr rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); - } - } - - // sw mechanism - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - wifiRssiState = halbtc8723a2ant_WifiRssiState(pBtCoexist, 0, 2, 27, 0); - wifiRssiState1 = halbtc8723a2ant_WifiRssiState(pBtCoexist, 1, 2, 47, 0); - - // fw mechanism - if( (wifiRssiState == BTC_RSSI_STATE_HIGH) || - (wifiRssiState == BTC_RSSI_STATE_STAY_HIGH) ) - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 3); - } - else //a2dp edr rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, FALSE, 1); - } - } - else - { - if(btInfoExt&BIT0) //a2dp basic rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 3); - } - else //a2dp edr rate - { - halbtc8723a2ant_TdmaDurationAdjust(pBtCoexist, TRUE, TRUE, 1); - } - } - - // sw mechanism - if( (wifiRssiState1 == BTC_RSSI_STATE_HIGH) || - (wifiRssiState1 == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, TRUE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - else - { - halbtc8723a2ant_AgcTable(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_AdcBackOff(pBtCoexist, NORMAL_EXEC, FALSE); - halbtc8723a2ant_DacSwing(pBtCoexist, NORMAL_EXEC, FALSE, 0xc0); - } - } -} - -VOID -halbtc8723a2ant_RunCoexistMechanism( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - u1Byte btInfoOriginal=0, btRetryCnt=0; - u1Byte algorithm=0; - - if(pBtCoexist->bManualControl) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Manual control!!!\n")); - return; - } - - if(pStackInfo->bProfileNotified) - { - if(pCoexSta->bHoldForStackOperation) - { - // if bt inquiry/page/pair, do not execute. - return; - } - - algorithm = halbtc8723a2ant_ActionAlgorithm(pBtCoexist); - if(pCoexSta->bHoldPeriodCnt && (BT_8723A_2ANT_COEX_ALGO_PANHS!=algorithm)) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex],Hold BT inquiry/page scan setting (cnt = %d)!!\n", - pCoexSta->bHoldPeriodCnt)); - if(pCoexSta->bHoldPeriodCnt >= 6) - { - pCoexSta->bHoldPeriodCnt = 0; - // next time the coexist parameters should be reset again. - } - else - pCoexSta->bHoldPeriodCnt++; - return; - } - - pCoexDm->curAlgorithm = algorithm; - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Algorithm = %d \n", pCoexDm->curAlgorithm)); - if(halbtc8723a2ant_IsCommonAction(pBtCoexist)) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant common.\n")); - pCoexDm->bResetTdmaAdjust = TRUE; - } - else - { - if(pCoexDm->curAlgorithm != pCoexDm->preAlgorithm) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], preAlgorithm=%d, curAlgorithm=%d\n", - pCoexDm->preAlgorithm, pCoexDm->curAlgorithm)); - pCoexDm->bResetTdmaAdjust = TRUE; - } - switch(pCoexDm->curAlgorithm) - { - case BT_8723A_2ANT_COEX_ALGO_SCO: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = SCO.\n")); - halbtc8723a2ant_ActionSco(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_HID: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID.\n")); - halbtc8723a2ant_ActionHid(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = A2DP.\n")); - halbtc8723a2ant_ActionA2dp(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_PANEDR: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n")); - halbtc8723a2ant_ActionPanEdr(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_PANHS: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HS mode.\n")); - halbtc8723a2ant_ActionPanHs(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n")); - halbtc8723a2ant_ActionPanEdrA2dp(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_PANEDR_HID: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n")); - halbtc8723a2ant_ActionPanEdrHid(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n")); - halbtc8723a2ant_ActionHidA2dpPanEdr(pBtCoexist); - break; - case BT_8723A_2ANT_COEX_ALGO_HID_A2DP: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n")); - halbtc8723a2ant_ActionHidA2dp(pBtCoexist); - break; - default: - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n")); - halbtc8723a2ant_CoexAllOff(pBtCoexist); - break; - } - pCoexDm->preAlgorithm = pCoexDm->curAlgorithm; - } - } -} - -//============================================================ -// work around function start with wa_halbtc8723a2ant_ -//============================================================ -VOID -wa_halbtc8723a2ant_MonitorC2h( - IN PBTC_COEXIST pBtCoexist - ) -{ - u1Byte tmp1b=0x0; - u4Byte curC2hTotalCnt=0x0; - static u4Byte preC2hTotalCnt=0x0, sameCntPollingTime=0x0; - - curC2hTotalCnt+=pCoexSta->btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_BT_RSP]; - - if(curC2hTotalCnt == preC2hTotalCnt) - { - sameCntPollingTime++; - } - else - { - preC2hTotalCnt = curC2hTotalCnt; - sameCntPollingTime = 0; - } - - if(sameCntPollingTime >= 2) - { - tmp1b = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x1af); - if(tmp1b != 0x0) - { - pCoexSta->c2hHangDetectCnt++; - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x1af, 0x0); - } - } -} - -//============================================================ -// extern function start with EXhalbtc8723a2ant_ -//============================================================ -VOID -EXhalbtc8723a2ant_PowerOnSetting( - IN PBTC_COEXIST pBtCoexist - ) -{ -} - -VOID -EXhalbtc8723a2ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bWifiOnly - ) -{ - u4Byte u4Tmp=0; - u1Byte u1Tmp=0; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Init HW Config!!\n")); - - // backup rf 0x1e value - pCoexDm->btRf0x1eBackup = - pBtCoexist->fBtcGetRfReg(pBtCoexist, BTC_RF_A, 0x1e, 0xfffff); - - // Enable counter statistics - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x76e, 0x4); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x778, 0x3); - pBtCoexist->fBtcWrite1Byte(pBtCoexist, 0x40, 0x20); -} - -VOID -EXhalbtc8723a2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Coex Mechanism Init!!\n")); - - halbtc8723a2ant_InitCoexDm(pBtCoexist); -} - -VOID -EXhalbtc8723a2ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ) -{ - PBTC_BOARD_INFO pBoardInfo=&pBtCoexist->boardInfo; - PBTC_STACK_INFO pStackInfo=&pBtCoexist->stackInfo; - pu1Byte cliBuf=pBtCoexist->cliBuf; - u1Byte u1Tmp[4], i, btInfoExt, psTdmaCase=0; - u4Byte u4Tmp[4]; - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", \ - pBoardInfo->pgAntNum, pBoardInfo->btdmAntNum); - CL_PRINTF(cliBuf); - - if(pBtCoexist->bManualControl) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "[Action Manual control]!!"); - CL_PRINTF(cliBuf); - } - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", "BT stack/ hci ext ver", \ - ((pStackInfo->bProfileNotified)? "Yes":"No"), pStackInfo->hciVersion); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", "Wifi channel informed to BT", \ - pCoexDm->wifiChnlInfo[0], pCoexDm->wifiChnlInfo[1], - pCoexDm->wifiChnlInfo[2]); - CL_PRINTF(cliBuf); - - // wifi status - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); - CL_PRINTF(cliBuf); - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[BT Status]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", \ - ((pCoexSta->bC2hBtInquiryPage)?("inquiry/page scan"):((BT_8723A_2ANT_BT_STATUS_IDLE == pCoexDm->btStatus)? "idle":( (BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE == pCoexDm->btStatus)? "connected-idle":"busy"))), - pCoexSta->btRssi, pCoexSta->btRetryCnt); - CL_PRINTF(cliBuf); - - if(pStackInfo->bProfileNotified) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", \ - pStackInfo->bScoExist, pStackInfo->bHidExist, pStackInfo->bPanExist, pStackInfo->bA2dpExist); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_BT_LINK_INFO); - } - - btInfoExt = pCoexSta->btInfoExt; - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Info A2DP rate", \ - (btInfoExt&BIT0)? "Basic rate":"EDR rate"); - CL_PRINTF(cliBuf); - - for(i=0; ibtInfoC2hCnt[i]) - { - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", GLBtInfoSrc8723a2Ant[i], \ - pCoexSta->btInfoC2h[i][0], pCoexSta->btInfoC2h[i][1], - pCoexSta->btInfoC2h[i][2], pCoexSta->btInfoC2h[i][3], - pCoexSta->btInfoC2h[i][4], pCoexSta->btInfoC2h[i][5], - pCoexSta->btInfoC2h[i][6], pCoexSta->btInfoC2hCnt[i]); - CL_PRINTF(cliBuf); - } - } - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "write 0x1af=0x0 num", \ - pCoexSta->c2hHangDetectCnt); - CL_PRINTF(cliBuf); - - // Sw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Sw mechanism]============"); - CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "SM1[ShRf/ LpRA/ LimDig]", \ - pCoexDm->bCurRfRxLpfShrink, pCoexDm->bCurLowPenaltyRa, pCoexDm->bLimitedDig); - CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", \ - pCoexDm->bCurAgcTableEn, pCoexDm->bCurAdcBackOff, pCoexDm->bCurDacSwingOn, pCoexDm->curDacSwingLvl); - CL_PRINTF(cliBuf); - - // Fw mechanism - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); - CL_PRINTF(cliBuf); - - if(!pBtCoexist->bManualControl) - { - psTdmaCase = pCoexDm->curPsTdma; - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", "PS TDMA", \ - pCoexDm->psTdmaPara[0], pCoexDm->psTdmaPara[1], - pCoexDm->psTdmaPara[2], pCoexDm->psTdmaPara[3], - pCoexDm->psTdmaPara[4], psTdmaCase); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "DecBtPwr/ IgnWlanAct", \ - pCoexDm->bCurDecBtPwr, pCoexDm->bCurIgnoreWlanAct); - CL_PRINTF(cliBuf); - } - - // Hw setting - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "RF-A, 0x1e initVal", \ - pCoexDm->btRf0x1eBackup); - CL_PRINTF(cliBuf); - - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x778); - u1Tmp[1] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x783); - u1Tmp[2] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x796); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", "0x778/ 0x783/ 0x796", \ - u1Tmp[0], u1Tmp[1], u1Tmp[2]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x880); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x880", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x40); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x40", \ - u1Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x550); - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x522); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x550(bcn ctrl)/0x522", \ - u4Tmp[0], u1Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x484); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x484(rate adaptive)", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xc50); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0xc50(dig)", \ - u4Tmp[0]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda0); - u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda4); - u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xda8); - u4Tmp[3] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0xdac); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0xda0/0xda4/0xda8/0xdac(FA cnt)", \ - u4Tmp[0], u4Tmp[1], u4Tmp[2], u4Tmp[3]); - CL_PRINTF(cliBuf); - - u4Tmp[0] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c0); - u4Tmp[1] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c4); - u4Tmp[2] = pBtCoexist->fBtcRead4Byte(pBtCoexist, 0x6c8); - u1Tmp[0] = pBtCoexist->fBtcRead1Byte(pBtCoexist, 0x6cc); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", \ - u4Tmp[0], u4Tmp[1], u4Tmp[2], u1Tmp[0]); - CL_PRINTF(cliBuf); - - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x770 (hp rx[31:16]/tx[15:0])", \ - pCoexSta->highPriorityRx, pCoexSta->highPriorityTx); - CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", "0x774(lp rx[31:16]/tx[15:0])", \ - pCoexSta->lowPriorityRx, pCoexSta->lowPriorityTx); - CL_PRINTF(cliBuf); - - pBtCoexist->fBtcDispDbgMsg(pBtCoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -VOID -EXhalbtc8723a2ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_IPS_ENTER == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS ENTER notify\n")); - halbtc8723a2ant_CoexAllOff(pBtCoexist); - } - else if(BTC_IPS_LEAVE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], IPS LEAVE notify\n")); - //halbtc8723a2ant_InitCoexDm(pBtCoexist); - } -} - -VOID -EXhalbtc8723a2ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_LPS_ENABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS ENABLE notify\n")); - } - else if(BTC_LPS_DISABLE == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], LPS DISABLE notify\n")); - } -} - -VOID -EXhalbtc8723a2ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_SCAN_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN START notify\n")); - } - else if(BTC_SCAN_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], SCAN FINISH notify\n")); - } -} - -VOID -EXhalbtc8723a2ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_ASSOCIATE_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT START notify\n")); - } - else if(BTC_ASSOCIATE_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], CONNECT FINISH notify\n")); - } -} - -VOID -EXhalbtc8723a2ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_MEDIA_CONNECT == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA connect notify\n")); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], MEDIA disconnect notify\n")); - } - - halbtc8723a2ant_IndicateWifiChnlBwInfo(pBtCoexist, type); -} - -VOID -EXhalbtc8723a2ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(type == BTC_PACKET_DHCP) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], DHCP Packet notify\n")); - } -} - -VOID -EXhalbtc8723a2ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ) -{ - u1Byte btInfo=0; - u1Byte i, rspSource=0; - BOOLEAN bBtBusy=FALSE, bLimitedDig=FALSE; - BOOLEAN bWifiConnected=FALSE, bBtHsOn=FALSE; - - pCoexSta->bC2hBtInfoReqSent = FALSE; - - rspSource = BT_INFO_SRC_8723A_2ANT_BT_RSP; - pCoexSta->btInfoC2hCnt[rspSource]++; - - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Bt info[%d], length=%d, hex data=[", rspSource, length)); - for(i=0; ibtInfoC2h[rspSource][i] = tmpBuf[i]; - if(i == 0) - btInfo = tmpBuf[i]; - if(i == length-1) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x]\n", tmpBuf[i])); - } - else - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("0x%02x, ", tmpBuf[i])); - } - } - - if(BT_INFO_SRC_8723A_2ANT_WIFI_FW != rspSource) - { - pCoexSta->btRetryCnt = - pCoexSta->btInfoC2h[rspSource][1]; - - pCoexSta->btRssi = - pCoexSta->btInfoC2h[rspSource][2]*2+10; - - pCoexSta->btInfoExt = - pCoexSta->btInfoC2h[rspSource][3]; - } - - pBtCoexist->fBtcGet(pBtCoexist, BTC_GET_BL_HS_OPERATION, &bBtHsOn); - // check BIT2 first ==> check if bt is under inquiry or page scan - if(btInfo & BT_INFO_8723A_2ANT_B_INQ_PAGE) - { - pCoexSta->bC2hBtInquiryPage = TRUE; - } - else - { - pCoexSta->bC2hBtInquiryPage = FALSE; - } -} - -VOID -EXhalbtc8723a2ant_StackOperationNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ) -{ - if(BTC_STACK_OP_INQ_PAGE_PAIR_START == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair start notify\n")); - pCoexSta->bHoldForStackOperation = TRUE; - pCoexSta->bHoldPeriodCnt = 1; - halbtc8723a2ant_BtInquiryPage(pBtCoexist); - } - else if(BTC_STACK_OP_INQ_PAGE_PAIR_FINISH == type) - { - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], StackOP Inquiry/page/pair finish notify\n")); - pCoexSta->bHoldForStackOperation = FALSE; - } -} - -VOID -EXhalbtc8723a2ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], Halt notify\n")); - - halbtc8723a2ant_IgnoreWlanAct(pBtCoexist, FORCE_EXEC, TRUE); - EXhalbtc8723a2ant_MediaStatusNotify(pBtCoexist, BTC_MEDIA_DISCONNECT); -} - -VOID -EXhalbtc8723a2ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ) -{ - RT_TRACE(COMP_COEX, DBG_LOUD, ("[BTCoex], 2Ant Periodical!!\n")); - - // work around for c2h hang - wa_halbtc8723a2ant_MonitorC2h(pBtCoexist); - - halbtc8723a2ant_QueryBtInfo(pBtCoexist); - halbtc8723a2ant_MonitorBtCtr(pBtCoexist); - halbtc8723a2ant_MonitorBtEnableDisable(pBtCoexist); - - halbtc8723a2ant_RunCoexistMechanism(pBtCoexist); -} - - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.h deleted file mode 100644 index f0cc8b546972..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723a2Ant.h +++ /dev/null @@ -1,184 +0,0 @@ -//=========================================== -// The following is for 8723A 2Ant BT Co-exist definition -//=========================================== -#define BT_INFO_8723A_2ANT_B_FTP BIT7 -#define BT_INFO_8723A_2ANT_B_A2DP BIT6 -#define BT_INFO_8723A_2ANT_B_HID BIT5 -#define BT_INFO_8723A_2ANT_B_SCO_BUSY BIT4 -#define BT_INFO_8723A_2ANT_B_ACL_BUSY BIT3 -#define BT_INFO_8723A_2ANT_B_INQ_PAGE BIT2 -#define BT_INFO_8723A_2ANT_B_SCO_ESCO BIT1 -#define BT_INFO_8723A_2ANT_B_CONNECTION BIT0 - -#define BTC_RSSI_COEX_THRESH_TOL_8723A_2ANT 2 - -typedef enum _BT_INFO_SRC_8723A_2ANT{ - BT_INFO_SRC_8723A_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8723A_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8723A_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8723A_2ANT_MAX -}BT_INFO_SRC_8723A_2ANT,*PBT_INFO_SRC_8723A_2ANT; - -typedef enum _BT_8723A_2ANT_BT_STATUS{ - BT_8723A_2ANT_BT_STATUS_IDLE = 0x0, - BT_8723A_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8723A_2ANT_BT_STATUS_NON_IDLE = 0x2, - BT_8723A_2ANT_BT_STATUS_MAX -}BT_8723A_2ANT_BT_STATUS,*PBT_8723A_2ANT_BT_STATUS; - -typedef enum _BT_8723A_2ANT_COEX_ALGO{ - BT_8723A_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8723A_2ANT_COEX_ALGO_SCO = 0x1, - BT_8723A_2ANT_COEX_ALGO_HID = 0x2, - BT_8723A_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8723A_2ANT_COEX_ALGO_PANEDR = 0x4, - BT_8723A_2ANT_COEX_ALGO_PANHS = 0x5, - BT_8723A_2ANT_COEX_ALGO_PANEDR_A2DP = 0x6, - BT_8723A_2ANT_COEX_ALGO_PANEDR_HID = 0x7, - BT_8723A_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x8, - BT_8723A_2ANT_COEX_ALGO_HID_A2DP = 0x9, - BT_8723A_2ANT_COEX_ALGO_MAX -}BT_8723A_2ANT_COEX_ALGO,*PBT_8723A_2ANT_COEX_ALGO; - -typedef struct _COEX_DM_8723A_2ANT{ - // fw mechanism - BOOLEAN bPreDecBtPwr; - BOOLEAN bCurDecBtPwr; - //BOOLEAN bPreBtLnaConstrain; - //BOOLEAN bCurBtLnaConstrain; - //u1Byte bPreBtPsdMode; - //u1Byte bCurBtPsdMode; - u1Byte preFwDacSwingLvl; - u1Byte curFwDacSwingLvl; - BOOLEAN bCurIgnoreWlanAct; - BOOLEAN bPreIgnoreWlanAct; - u1Byte prePsTdma; - u1Byte curPsTdma; - u1Byte psTdmaPara[5]; - u1Byte psTdmaDuAdjType; - BOOLEAN bResetTdmaAdjust; - BOOLEAN bPrePsTdmaOn; - BOOLEAN bCurPsTdmaOn; - //BOOLEAN bPreBtAutoReport; - //BOOLEAN bCurBtAutoReport; - - // sw mechanism - BOOLEAN bPreRfRxLpfShrink; - BOOLEAN bCurRfRxLpfShrink; - u4Byte btRf0x1eBackup; - BOOLEAN bPreLowPenaltyRa; - BOOLEAN bCurLowPenaltyRa; - BOOLEAN bPreDacSwingOn; - u4Byte preDacSwingLvl; - BOOLEAN bCurDacSwingOn; - u4Byte curDacSwingLvl; - BOOLEAN bPreAdcBackOff; - BOOLEAN bCurAdcBackOff; - BOOLEAN bPreAgcTableEn; - BOOLEAN bCurAgcTableEn; - u4Byte preVal0x6c0; - u4Byte curVal0x6c0; - u4Byte preVal0x6c8; - u4Byte curVal0x6c8; - u1Byte preVal0x6cc; - u1Byte curVal0x6cc; - BOOLEAN bLimitedDig; - - // algorithm related - u1Byte preAlgorithm; - u1Byte curAlgorithm; - u1Byte btStatus; - u1Byte wifiChnlInfo[3]; -} COEX_DM_8723A_2ANT, *PCOEX_DM_8723A_2ANT; - -typedef struct _COEX_STA_8723A_2ANT{ - u4Byte highPriorityTx; - u4Byte highPriorityRx; - u4Byte lowPriorityTx; - u4Byte lowPriorityRx; - u1Byte btRssi; - u1Byte preBtRssiState; - u1Byte preBtRssiState1; - u1Byte preWifiRssiState[4]; - BOOLEAN bC2hBtInfoReqSent; - u1Byte btInfoC2h[BT_INFO_SRC_8723A_2ANT_MAX][10]; - u4Byte btInfoC2hCnt[BT_INFO_SRC_8723A_2ANT_MAX]; - BOOLEAN bC2hBtInquiryPage; - u1Byte btRetryCnt; - u1Byte btInfoExt; - BOOLEAN bHoldForStackOperation; - u1Byte bHoldPeriodCnt; - // this is for c2h hang work-around - u4Byte c2hHangDetectCnt; -}COEX_STA_8723A_2ANT, *PCOEX_STA_8723A_2ANT; - -//=========================================== -// The following is interface which will notify coex module. -//=========================================== -VOID -EXhalbtc8723a2ant_PowerOnSetting( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a2ant_InitHwConfig( - IN PBTC_COEXIST pBtCoexist, - IN BOOLEAN bWifiOnly - ); -VOID -EXhalbtc8723a2ant_InitCoexDm( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a2ant_IpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a2ant_LpsNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a2ant_ScanNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a2ant_ConnectNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a2ant_MediaStatusNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a2ant_SpecialPacketNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a2ant_HaltNotify( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a2ant_Periodical( - IN PBTC_COEXIST pBtCoexist - ); -VOID -EXhalbtc8723a2ant_BtInfoNotify( - IN PBTC_COEXIST pBtCoexist, - IN pu1Byte tmpBuf, - IN u1Byte length - ); -VOID -EXhalbtc8723a2ant_StackOperationNotify( - IN PBTC_COEXIST pBtCoexist, - IN u1Byte type - ); -VOID -EXhalbtc8723a2ant_DisplayCoexInfo( - IN PBTC_COEXIST pBtCoexist - ); - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.c deleted file mode 100644 index b69d156689fc..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.c +++ /dev/null @@ -1,3997 +0,0 @@ -/* ************************************************************ - * Description: - * - * This file is for RTL8821A_CSR_CSR Co-exist mechanism - * - * History - * 2012/08/22 Cosa first check in. - * 2012/11/14 Cosa Revise for 8821A_CSR 2Ant out sourcing. - * - * ************************************************************ */ - -/* ************************************************************ - * include files - * ************************************************************ */ -#include "Mp_Precomp.h" - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821A_SUPPORT == 1) - -#define _BTCOEX_CSR 1 - -#ifndef rtw_warn_on_8821acsr2ant -#define rtw_warn_on_8821acsr2ant(condition) do {} while (0) -#endif -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8821a_csr_2ant glcoex_dm_8821a_csr_2ant; -static struct coex_dm_8821a_csr_2ant *coex_dm = &glcoex_dm_8821a_csr_2ant; -static struct coex_sta_8821a_csr_2ant glcoex_sta_8821a_csr_2ant; -static struct coex_sta_8821a_csr_2ant *coex_sta = &glcoex_sta_8821a_csr_2ant; - -const char *const glbt_info_src_8821a_csr_2ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8821a_csr_2ant = 20140901; -u32 glcoex_ver_8821a_csr_2ant = 0x51; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8821aCsr2ant_ - * ************************************************************ */ -u8 halbtc8821aCsr2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, - u8 rssi_thresh1) -{ - s32 bt_rssi = 0; - u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; - - bt_rssi = coex_sta->bt_rssi; - - if (level_num == 2) { - if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Rssi thresh error!!\n"); - BTC_TRACE(trace_buf); - return coex_sta->pre_bt_rssi_state; - } - - if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_MEDIUM) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_MEDIUM)) { - if (bt_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (bt_rssi < rssi_thresh1) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - coex_sta->pre_bt_rssi_state = bt_rssi_state; - - return bt_rssi_state; -} - -u8 halbtc8821aCsr2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, - IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -{ - s32 wifi_rssi = 0; - u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; - - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - - if (level_num == 2) { - if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) - || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi RSSI thresh error!!\n"); - BTC_TRACE(trace_buf); - return coex_sta->pre_wifi_rssi_state[index]; - } - - if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) - || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_MEDIUM) || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_MEDIUM)) { - if (wifi_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (wifi_rssi < rssi_thresh1) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; - - return wifi_rssi_state; -} - -void halbtc8821aCsr2ant_monitor_bt_enable_disable(IN struct btc_coexist - *btcoexist) -{ - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - - /* This function check if bt is disabled */ - - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); - BTC_TRACE(trace_buf); - } else { - bt_disable_cnt++; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], bt all counters=0, %d times!!\n", - bt_disable_cnt); - BTC_TRACE(trace_buf); - if (bt_disable_cnt >= 2) { - bt_disabled = true; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); - BTC_TRACE(trace_buf); - } - } - if (coex_sta->bt_disabled != bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); - BTC_TRACE(trace_buf); - coex_sta->bt_disabled = bt_disabled; - if (!bt_disabled) { - } else { - } - } -} - -void halbtc8821aCsr2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -{ - u32 reg_hp_txrx, reg_lp_txrx, u32tmp; - u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; - - reg_hp_txrx = 0x770; - reg_lp_txrx = 0x774; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); - reg_hp_tx = u32tmp & MASKLWORD; - reg_hp_rx = (u32tmp & MASKHWORD) >> 16; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); - reg_lp_tx = u32tmp & MASKLWORD; - reg_lp_rx = (u32tmp & MASKHWORD) >> 16; - - coex_sta->high_priority_tx = reg_hp_tx; - coex_sta->high_priority_rx = reg_hp_rx; - coex_sta->low_priority_tx = reg_lp_tx; - coex_sta->low_priority_rx = reg_lp_rx; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); - BTC_TRACE(trace_buf); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); - BTC_TRACE(trace_buf); - - /* reset counter */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x5d); -} - -void halbtc8821aCsr2ant_update_ra_mask(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 dis_rate_mask) -{ - coex_dm->cur_ra_mask = dis_rate_mask; - - if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) - btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, - &coex_dm->cur_ra_mask); - coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -} - -void halbtc8821aCsr2ant_auto_rate_fallback_retry(IN struct btc_coexist - *btcoexist, IN boolean force_exec, IN u8 type) -{ - boolean wifi_under_b_mode = false; - - coex_dm->cur_arfr_type = type; - - if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { - switch (coex_dm->cur_arfr_type) { - case 0: /* normal mode */ - btcoexist->btc_write_4byte(btcoexist, 0x430, - coex_dm->backup_arfr_cnt1); - btcoexist->btc_write_4byte(btcoexist, 0x434, - coex_dm->backup_arfr_cnt2); - break; - case 1: - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - if (wifi_under_b_mode) { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x01010101); - } else { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x04030201); - } - break; - default: - break; - } - } - - coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -} - -void halbtc8821aCsr2ant_retry_limit(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_retry_limit_type = type; - - if (force_exec || - (coex_dm->pre_retry_limit_type != - coex_dm->cur_retry_limit_type)) { - switch (coex_dm->cur_retry_limit_type) { - case 0: /* normal mode */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - coex_dm->backup_retry_limit); - break; - case 1: /* retry limit=8 */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - 0x0808); - break; - default: - break; - } - } - - coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -} - -void halbtc8821aCsr2ant_ampdu_max_time(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_ampdu_time_type = type; - - if (force_exec || - (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { - switch (coex_dm->cur_ampdu_time_type) { - case 0: /* normal mode */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - coex_dm->backup_ampdu_max_time); - break; - case 1: /* AMPDU timw = 0x38 * 32us */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - 0x38); - break; - case 2: - btcoexist->btc_write_1byte(btcoexist, 0x456, - 0x17); - break; - default: - break; - } - } - - coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -} - -void halbtc8821aCsr2Ant_AmpduMaxNum(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_ampdu_num_type = type; - - if (force_exec || - (coex_dm->pre_ampdu_num_type != coex_dm->cur_ampdu_num_type)) { - switch (coex_dm->cur_ampdu_num_type) { - case 0: /* normal mode */ - btcoexist->btc_write_2byte(btcoexist, 0x4ca, - coex_dm->backup_ampdu_max_num); - break; - case 1: - btcoexist->btc_write_2byte(btcoexist, 0x4ca, - 0x0808); - break; - case 2: - btcoexist->btc_write_2byte(btcoexist, 0x4ca, - 0x1f1f); - break; - default: - break; - } - } - - coex_dm->pre_ampdu_num_type = coex_dm->cur_ampdu_num_type; - -} - -void halbtc8821aCsr2ant_limited_tx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, - IN u8 retry_limit_type, IN u8 ampdu_time_type, IN u8 ampdu_num_type) -{ - switch (ra_mask_type) { - case 0: /* normal mode */ - halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, - 0x00000003); - break; - case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ - halbtc8821aCsr2ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8821aCsr2ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8821aCsr2ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8821aCsr2ant_ampdu_max_time(btcoexist, force_exec, - ampdu_time_type); - halbtc8821aCsr2Ant_AmpduMaxNum(btcoexist, force_exec, ampdu_num_type); -} - - - -void halbtc8821aCsr2ant_limited_rx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean rej_ap_agg_pkt, - IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -{ - boolean reject_rx_agg = rej_ap_agg_pkt; - boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; - u8 rx_agg_size = agg_buf_size; - - /* ============================================ */ - /* Rx Aggregation related setting */ - /* ============================================ */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, - &reject_rx_agg); - /* decide BT control aggregation buf size or not */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, - &bt_ctrl_rx_agg_size); - /* aggregation buf size, only work when BT control Rx aggregation size. */ - btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); - /* real update aggregation setting */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -} - -void halbtc8821aCsr2ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - coex_sta->c2h_bt_info_req_sent = true; - - h2c_parameter[0] |= BIT(0); /* trigger */ - - rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -u8 halbtc8821aCsr2ant_action_algorithm(IN struct btc_coexist *btcoexist) -{ - struct btc_stack_info *stack_info = &btcoexist->stack_info; - boolean bt_hs_on = false; - u8 algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED; - u8 num_of_diff_profile = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - /* sync StackInfo with BT firmware and stack */ - stack_info->hid_exist = coex_sta->hid_exist; - stack_info->bt_link_exist = coex_sta->bt_link_exist; - stack_info->sco_exist = coex_sta->sco_exist; - stack_info->pan_exist = coex_sta->pan_exist; - stack_info->a2dp_exist = coex_sta->a2dp_exist; - - if (!stack_info->bt_link_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], No profile exists!!!\n"); - BTC_TRACE(trace_buf); - return algorithm; - } - - if (stack_info->sco_exist) - num_of_diff_profile++; - if (stack_info->hid_exist) - num_of_diff_profile++; - if (stack_info->pan_exist) - num_of_diff_profile++; - if (stack_info->a2dp_exist) - num_of_diff_profile++; - - if (num_of_diff_profile == 1) { - if (stack_info->sco_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_SCO; - } else { - if (stack_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_HID; - } else if (stack_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], A2DP only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821A_CSR_2ANT_COEX_ALGO_A2DP; - } else if (stack_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(HS) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR; - } - } - } - } else if (num_of_diff_profile == 2) { - if (stack_info->sco_exist) { - if (stack_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } else if (stack_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP ==> SCO\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } else if (stack_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (stack_info->hid_exist && - stack_info->a2dp_exist) { - if (stack_info->num_of_hid >= 2) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID*2 + A2DP\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + A2DP\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; - } - } else if (stack_info->hid_exist && - stack_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } - } else if (stack_info->pan_exist && - stack_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP; - } - } - } - } else if (num_of_diff_profile == 3) { - if (stack_info->sco_exist) { - if (stack_info->hid_exist && - stack_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + A2DP ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } else if (stack_info->hid_exist && - stack_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } - } else if (stack_info->pan_exist && - stack_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (stack_info->hid_exist && - stack_info->pan_exist && - stack_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR; - } - } - } - } else if (num_of_diff_profile >= 3) { - if (stack_info->sco_exist) { - if (stack_info->hid_exist && - stack_info->pan_exist && - stack_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -boolean halbtc8821aCsr2ant_need_to_dec_bt_pwr(IN struct btc_coexist *btcoexist) -{ - boolean ret = false; - boolean bt_hs_on = false, wifi_connected = false; - s32 bt_hs_rssi = 0; - u8 bt_rssi_state; - - if (!btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on)) - return false; - if (!btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected)) - return false; - if (!btcoexist->btc_get(btcoexist, BTC_GET_S4_HS_RSSI, &bt_hs_rssi)) - return false; - - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - if (wifi_connected) { - if (bt_hs_on) { - if (bt_hs_rssi > 37) - ret = true; - } else { - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - ret = true; - } - } - - return ret; -} - -void halbtc8821aCsr2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, - IN u8 dac_swing_lvl) -{ - u8 h2c_parameter[1] = {0}; - - /* There are several type of dacswing */ - /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ - h2c_parameter[0] = dac_swing_lvl; - - btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -} - -void halbtc8821aCsr2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, - IN boolean dec_bt_pwr) -{ - u8 h2c_parameter[1] = {0}; - - h2c_parameter[0] = 0; - - if (dec_bt_pwr) - h2c_parameter[0] |= BIT(1); - - rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); - btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -} - -void halbtc8821aCsr2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean dec_bt_pwr) -{ - coex_dm->cur_dec_bt_pwr = dec_bt_pwr; - - if (!force_exec) { - if (coex_dm->pre_dec_bt_pwr == coex_dm->cur_dec_bt_pwr) - return; - } - - /* TODO: may CSR consider to decrease BT power? */ - /* halbtc8821aCsr2ant_set_fw_dec_bt_pwr(btcoexist, coex_dm->cur_dec_bt_pwr); */ - - coex_dm->pre_dec_bt_pwr = coex_dm->cur_dec_bt_pwr; -} - -void halbtc8821aCsr2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean enable_auto_report) -{ - u8 h2c_parameter[1] = {0}; - - h2c_parameter[0] = 0; - - if (enable_auto_report) - h2c_parameter[0] |= BIT(0); - - rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); - btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -} - -void halbtc8821aCsr2ant_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable_auto_report) -{ - coex_dm->cur_bt_auto_report = enable_auto_report; - - if (!force_exec) { - if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) - return; - } - /* halbtc8821aCsr2ant_set_bt_auto_report(btcoexist, coex_dm->cur_bt_auto_report); */ - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8821aCsr2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 fw_dac_swing_lvl) -{ - coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; - - if (!force_exec) { - if (coex_dm->pre_fw_dac_swing_lvl == - coex_dm->cur_fw_dac_swing_lvl) - return; - } - - halbtc8821aCsr2ant_set_fw_dac_swing_level(btcoexist, - coex_dm->cur_fw_dac_swing_lvl); - - coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -} - -void halbtc8821aCsr2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist - *btcoexist, IN boolean rx_rf_shrink_on) -{ - if (rx_rf_shrink_on) { - /* Shrink RF Rx LPF corner */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Shrink RF Rx LPF corner!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, - 0xffffc); - } else { - /* Resume RF Rx LPF corner */ - /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ - if (btcoexist->initilized) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Resume RF Rx LPF corner!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, - 0xfffff, coex_dm->bt_rf_0x1e_backup); - } - } -} - -void halbtc8821aCsr2ant_rf_shrink(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean rx_rf_shrink_on) -{ - coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; - - if (!force_exec) { - if (coex_dm->pre_rf_rx_lpf_shrink == - coex_dm->cur_rf_rx_lpf_shrink) - return; - } - halbtc8821aCsr2ant_set_sw_rf_rx_lpf_corner(btcoexist, - coex_dm->cur_rf_rx_lpf_shrink); - - coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; -} - -void halbtc8821aCsr2ant_set_sw_penalty_tx_rate_adaptive( - IN struct btc_coexist *btcoexist, IN boolean low_penalty_ra) -{ - u8 h2c_parameter[6] = {0}; - - h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ - - if (low_penalty_ra) { - h2c_parameter[1] |= BIT(0); - h2c_parameter[2] = - 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ - h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ - h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} - -void halbtc8821aCsr2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean low_penalty_ra) -{ - coex_dm->cur_low_penalty_ra = low_penalty_ra; - - if (!force_exec) { - if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) - return; - } - halbtc8821aCsr2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, - coex_dm->cur_low_penalty_ra); - - coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -} - -void halbtc8821aCsr2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, - IN u32 level) -{ - u8 val = (u8)level; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Write SwDacSwing = 0x%x\n", level); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); -} - -void halbtc8821aCsr2ant_set_sw_full_time_dac_swing(IN struct btc_coexist - *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) -{ - if (sw_dac_swing_on) - halbtc8821aCsr2ant_set_dac_swing_reg(btcoexist, - sw_dac_swing_lvl); - else - halbtc8821aCsr2ant_set_dac_swing_reg(btcoexist, 0x18); -} - - -void halbtc8821aCsr2ant_dac_swing(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) -{ - coex_dm->cur_dac_swing_on = dac_swing_on; - coex_dm->cur_dac_swing_lvl = dac_swing_lvl; - - if (!force_exec) { - if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && - (coex_dm->pre_dac_swing_lvl == - coex_dm->cur_dac_swing_lvl)) - return; - } - delay_ms(30); - halbtc8821aCsr2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, - dac_swing_lvl); - - coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; - coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; -} - -void halbtc8821aCsr2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, - IN boolean adc_back_off) -{ - if (adc_back_off) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BB BackOff Level On!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x3); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BB BackOff Level Off!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x8db, 0x60, 0x1); - } -} - -void halbtc8821aCsr2ant_adc_back_off(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean adc_back_off) -{ - coex_dm->cur_adc_back_off = adc_back_off; - - if (!force_exec) { - if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) - return; - } - halbtc8821aCsr2ant_set_adc_back_off(btcoexist, - coex_dm->cur_adc_back_off); - - coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -} - -void halbtc8821aCsr2ant_set_agc_table(IN struct btc_coexist *btcoexist, - IN boolean agc_table_en) -{ - u8 rssi_adjust_val = 0; - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); - if (agc_table_en) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Agc Table On!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x28F4B); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x10AB2); - rssi_adjust_val = 8; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Agc Table Off!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x2884B); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x104B2); - } - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); - - /* set rssi_adjust_val for wifi module. */ - btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, - &rssi_adjust_val); -} - -void halbtc8821aCsr2ant_agc_table(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean agc_table_en) -{ - coex_dm->cur_agc_table_en = agc_table_en; - - if (!force_exec) { - if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) - return; - } - halbtc8821aCsr2ant_set_agc_table(btcoexist, agc_table_en); - - coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -} - -void halbtc8821aCsr2ant_set_coex_table(IN struct btc_coexist *btcoexist, - IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -{ - btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); - - btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); - - btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); - - btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -} - -void halbtc8821aCsr2ant_coex_table(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, - IN u32 val0x6c8, IN u8 val0x6cc) -{ - coex_dm->cur_val0x6c0 = val0x6c0; - coex_dm->cur_val0x6c4 = val0x6c4; - coex_dm->cur_val0x6c8 = val0x6c8; - coex_dm->cur_val0x6cc = val0x6cc; - - if (!force_exec) { - if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && - (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && - (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && - (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) - return; - } - halbtc8821aCsr2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, - val0x6c8, val0x6cc); - - coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; - coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; - coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; - coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -} - -void halbtc8821aCsr2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 h2c_parameter[1] = {0}; - - if (enable) { - h2c_parameter[0] |= BIT(0); /* function enable */ - } - - rtw_warn_on_8821acsr2ant(_BTCOEX_CSR); - btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -} - -void halbtc8821aCsr2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable) -{ - coex_dm->cur_ignore_wlan_act = enable; - - if (!force_exec) { - if (coex_dm->pre_ignore_wlan_act == - coex_dm->cur_ignore_wlan_act) - return; - } - /* halbtc8821aCsr2ant_set_fw_ignore_wlan_act(btcoexist, enable); */ - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8821aCsr2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, - IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -{ - u8 h2c_parameter[6] = {0}; - - h2c_parameter[0] = byte1; - h2c_parameter[1] = byte2; - h2c_parameter[2] = byte3; - h2c_parameter[3] = byte4; - h2c_parameter[4] = byte5; - h2c_parameter[5] = 0x01; - - coex_dm->ps_tdma_para[0] = byte1; - coex_dm->ps_tdma_para[1] = byte2; - coex_dm->ps_tdma_para[2] = byte3; - coex_dm->ps_tdma_para[3] = byte4; - coex_dm->ps_tdma_para[4] = byte5; - coex_dm->ps_tdma_para[5] = 0x01; - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 6, h2c_parameter); -} - -void halbtc8821aCsr2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, - IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, - IN boolean limited_dig, IN boolean bt_lna_constrain) -{ - u32 wifi_bw; - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_HT40 != wifi_bw) { /* only shrink RF Rx LPF for HT40 */ - if (shrink_rx_lpf) - shrink_rx_lpf = false; - } - - halbtc8821aCsr2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); - halbtc8821aCsr2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, - low_penalty_ra); - - /* no limited DIG */ - /* halbtc8821aCsr2ant_setBtLnaConstrain(btcoexist, NORMAL_EXEC, bt_lna_constrain); */ -} - -void halbtc8821aCsr2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, - IN boolean agc_table_shift, IN boolean adc_back_off, - IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -{ - /* halbtc8821aCsr2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ - halbtc8821aCsr2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); - halbtc8821aCsr2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, - dac_swing_lvl); -} - -void halbtc8821aCsr2ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u32 u32tmp = 0; - u8 h2c_parameter[2] = {0}; - - if (init_hwcfg) { - /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp &= ~BIT(23); - u32tmp |= BIT(24); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - - btcoexist->btc_write_4byte(btcoexist, 0x974, 0x3ff); - btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); - - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { - /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ - h2c_parameter[0] = 1; - h2c_parameter[1] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } else { - /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ - h2c_parameter[0] = 0; - h2c_parameter[1] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } - } - - /* ext switch setting */ - switch (ant_pos_type) { - case BTC_ANT_WIFI_AT_MAIN: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, - 0x30, 0x1); - break; - case BTC_ANT_WIFI_AT_AUX: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, - 0x30, 0x2); - break; - } -} - -void halbtc8821aCsr2ant_ps_tdma(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean turn_on, IN u8 type) -{ - coex_dm->cur_ps_tdma_on = turn_on; - coex_dm->cur_ps_tdma = type; - - if (!force_exec) { - if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && - (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) - return; - } - if (turn_on) { - switch (type) { - case 1: - default: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x1a, 0x1a, 0xe1, 0x90); - break; - case 2: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x12, 0x12, 0xe1, 0x90); - break; - case 3: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x1c, 0x3, 0xf1, 0x90); - break; - case 4: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x10, 0x03, 0xf1, 0x90); - break; - case 5: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x1a, 0x1a, 0x60, 0x90); - break; - case 6: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x12, 0x12, 0x60, 0x90); - break; - case 7: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x1c, 0x3, 0x70, 0x90); - break; - case 8: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xa3, 0x10, 0x3, 0x70, 0x90); - break; - case 9: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x1a, 0x1a, 0xe1, 0x90); - break; - case 10: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x12, 0x12, 0xe1, 0x90); - break; - case 11: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0xa, 0xa, 0xe1, 0x90); - break; - case 12: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x5, 0x5, 0xe1, 0x90); - break; - case 13: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x1a, 0x1a, 0x60, 0x90); - break; - case 14: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x12, 0x12, 0x60, 0x90); - break; - case 15: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0xa, 0xa, 0x60, 0x90); - break; - case 16: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x5, 0x5, 0x60, 0x90); - break; - case 17: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xa3, 0x2f, 0x2f, 0x60, 0x90); - break; - case 18: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x5, 0x5, 0xe1, 0x90); - break; - case 19: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x25, 0x25, 0xe1, 0x90); - break; - case 20: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x25, 0x25, 0x60, 0x90); - break; - case 21: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x15, 0x03, 0x70, 0x90); - break; - case 22: /* ad2dp master */ - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xeb, 0x11, 0x11, 0x21, 0x10); - break; - case 23: /* a2dp slave */ - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xeb, 0x12, 0x12, 0x20, 0x10); - break; - case 71: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, - 0xe3, 0x1a, 0x1a, 0xe1, 0x90); - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 0: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - case 1: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - default: - halbtc8821aCsr2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - } - } - - /* update pre state */ - coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; - coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -} - -void halbtc8821aCsr2ant_coex_all_off(IN struct btc_coexist *btcoexist) -{ - /* fw all off */ - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - /* sw all off */ - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - /* hw all off */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55555555, - 0x55555555, 0xffff, 0x3); -} - -void halbtc8821aCsr2ant_coex_under_5g(IN struct btc_coexist *btcoexist) -{ - halbtc8821aCsr2ant_coex_all_off(btcoexist); - - halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); -} - -void halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - halbtc8821aCsr2ant_coex_table(btcoexist, FORCE_EXEC, 0x55555555, - 0x55555555, 0xffff, 0x3); - - halbtc8821aCsr2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, false); - - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -} - -void halbtc8821aCsr2ant_bt_inquiry_page(IN struct btc_coexist *btcoexist) -{ - boolean low_pwr_disable = true; - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, - 0x5afa5afa, 0xffff, 0x3); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); -} -boolean halbtc8821aCsr2ant_is_common_action(IN struct btc_coexist *btcoexist) -{ - boolean common = false, wifi_connected = false, wifi_busy = false; - boolean low_pwr_disable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (!wifi_connected && - BT_8821A_CSR_2ANT_BT_STATUS_IDLE == coex_dm->bt_status) { - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi IPS + BT IPS!!\n"); - BTC_TRACE(trace_buf); - - - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, - 0, 0); - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); - - common = true; - } else if (wifi_connected && - (BT_8821A_CSR_2ANT_BT_STATUS_IDLE == - coex_dm->bt_status)) { - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - if (wifi_busy) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Busy + BT IPS!!\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, - false, 1); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi LPS + BT IPS!!\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, - false, 1); - } - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, - 0, 0); - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); - - common = true; - } else if (!wifi_connected && - (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status)) { - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi IPS + BT LPS!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, - 0, 0); - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); - - common = true; - } else if (wifi_connected && - (BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status)) { - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - if (wifi_busy) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Busy + BT LPS!!\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, - false, 1); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi LPS + BT LPS!!\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, - false, 1); - } - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, true, - true); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, - 0, 0); - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); - - common = true; - } else if (!wifi_connected && - (BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == - coex_dm->bt_status)) { - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi IPS + BT Busy!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); */ - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, - 0, 0); - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, 0, 0, 0); - - common = true; - } else { - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - if (wifi_busy) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Busy + BT Busy!!\n"); - BTC_TRACE(trace_buf); - common = false; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi LPS + BT Busy!!\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 21); - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, false); - - common = true; - } - - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, true, - true); - } - - if (common == true) - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); - - return common; -} -void halbtc8821aCsr2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, - IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) -{ - static s32 up, dn, m, n, wait_count; - s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ - u8 retry_count = 0; - - if (coex_dm->reset_tdma_adjust) { - coex_dm->reset_tdma_adjust = false; - { - if (sco_hid) { - if (tx_pause) { - if (max_interval == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } else if (max_interval == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (max_interval == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } else { - if (max_interval == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } else if (max_interval == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (max_interval == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } - } - } else { - if (tx_pause) { - if (max_interval == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (max_interval == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (max_interval == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } - } else { - if (max_interval == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (max_interval == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (max_interval == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } - } - } - } - /* ============ */ - up = 0; - dn = 0; - m = 1; - n = 3; - result = 0; - wait_count = 0; - } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ - retry_count = coex_sta->bt_retry_cnt; - result = 0; - wait_count++; - - if (retry_count == - 0) { /* no retry in the last 2-second duration */ - up++; - dn--; - - if (dn <= 0) - dn = 0; - - if (up >= n) { /* if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration */ - wait_count = 0; - n = 3; - up = 0; - dn = 0; - result = 1; - } - } else if (retry_count <= - 3) { /* <=3 retry in the last 2-second duration */ - up--; - dn++; - - if (up <= 0) - up = 0; - - if (dn == 2) { /* if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration */ - if (wait_count <= 2) - m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ - else - m = 1; - - if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ - m = 20; - - n = 3 * m; - up = 0; - dn = 0; - wait_count = 0; - result = -1; - } - } else { /* retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration */ - if (wait_count == 1) - m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ - else - m = 1; - - if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ - m = 20; - - n = 3 * m; - up = 0; - dn = 0; - wait_count = 0; - result = -1; - } - - if (max_interval == 1) { - if (tx_pause) { - if (coex_dm->cur_ps_tdma == 71) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 13); - coex_dm->ps_tdma_du_adj_type = 13; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 16); - coex_dm->ps_tdma_du_adj_type = 16; - } - - if (result == -1) { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 16); - coex_dm->ps_tdma_du_adj_type = - 16; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 8) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 71); - coex_dm->ps_tdma_du_adj_type = 71; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 12); - coex_dm->ps_tdma_du_adj_type = 12; - } - - if (result == -1) { - if (coex_dm->cur_ps_tdma == 71) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 12); - coex_dm->ps_tdma_du_adj_type = - 12; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 4) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 71); - coex_dm->ps_tdma_du_adj_type = - 71; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } - } - } - } else if (max_interval == 2) { - if (tx_pause) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 16); - coex_dm->ps_tdma_du_adj_type = 16; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 16); - coex_dm->ps_tdma_du_adj_type = - 16; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 8) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 12); - coex_dm->ps_tdma_du_adj_type = 12; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 12); - coex_dm->ps_tdma_du_adj_type = - 12; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 4) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } - } - } - } else if (max_interval == 3) { - if (tx_pause) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 16); - coex_dm->ps_tdma_du_adj_type = 16; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 16); - coex_dm->ps_tdma_du_adj_type = - 16; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 8) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8821aCsr2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 12); - coex_dm->ps_tdma_du_adj_type = 12; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 12); - coex_dm->ps_tdma_du_adj_type = - 12; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 4) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8821aCsr2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } - } - } - } - } - - /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ - /* then we have to adjust it back to the previous record one. */ - if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { - boolean scan = false, link = false, roam = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", - coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (!scan && !link && !roam) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - coex_dm->ps_tdma_du_adj_type); - else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); - BTC_TRACE(trace_buf); - } - } - - /* when halbtc8821aCsr2ant_tdma_duration_adjust() is called, fw dac swing is included in the function. */ - /* if(coex_dm->ps_tdma_du_adj_type == 71) */ - /* halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc); //Skip because A2DP get worse at HT40 */ - /* else */ - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 0x6); -} - -/* SCO only or SCO+PAN(HS) */ -void halbtc8821aCsr2ant_action_sco(IN struct btc_coexist *btcoexist) -{ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55555555, - 0x55555555, 0xffffff, 0x3); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8821aCsr2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); - - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 1, 0, 2, 0); - - if (coex_sta->slave == false) - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, - true, 0x4); - else - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, - true, 0x2); - - /* - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); - - if(halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) - { - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x5a5a5a5a, 0x5a5a5a5a, 0xffff, 0x3); - } - else - { - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x5aea5aea, 0x5aea5aea, 0xffff, 0x3); - } - - if(BTC_WIFI_BW_HT40 == wifi_bw) - { - - - - - if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - else - { - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - - - if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,true,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); - } - else - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,true,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); - } - } - else - { - - - - if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - else - { - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - - - if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,true,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); - } - else - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,true,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); - } - } - */ -} - - -void halbtc8821aCsr2ant_action_hid(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); - else /* for HID quality & wifi performance balance at 11n mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5aea5aea, 0xffff, 0x3); - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 9); - else - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 13); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } else { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 9); - else - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 13); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -void halbtc8821aCsr2ant_action_a2dp(IN struct btc_coexist *btcoexist) -{ - halbtc8821aCsr2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); - - if (coex_sta->slave == false) { - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, - 0, 1); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, true, - 0x0c); - } else { - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0xfdfdfdfd, 0xdfdadfda, 0xffffff, 0x3); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); - halbtc8821aCsr2ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, - 0, 2); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, false, true, - 0x18); - } - - /* - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - - - - - if(halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if(BTC_WIFI_BW_HT40 == wifi_bw) - { - - if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, false, 1); - } - else - { - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, true, 1); - } - - - if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,false,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); - } - else - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,true,false,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); - } - } - else - { - - if( (bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, false, 1); - } - else - { - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, false, true, 1); - } - - - if( (wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH) ) - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,false,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,true,false,false,0x18); - } - else - { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist,false,false,false,false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist,false,false,false,0x18); - } - } - */ -} - -void halbtc8821aCsr2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; - u32 wifi_bw; - - bt_info_ext = coex_sta->bt_info_ext; - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - /* fw dac swing is called in halbtc8821aCsr2ant_tdma_duration_adjust() */ - /* halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); */ - - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - /* fw mechanism */ - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, - false, true, 2); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, - false, true, 1); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } else { - /* fw mechanism */ - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, - false, true, 2); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, - false, true, 1); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - -void halbtc8821aCsr2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); - else /* for HID quality & wifi performance balance at 11n mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5aff5aff, 0xffff, 0x3); - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 1); - else - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 5); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } else { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 1); - else - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 5); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - - -/* PAN(HS) only */ -void halbtc8821aCsr2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - /* fw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, - true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, - false); - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } else { - /* fw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, - true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, - false); - - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, - false, 1); - else - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, - false, 1); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - -/* PAN(EDR)+A2DP */ -void halbtc8821aCsr2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; - u32 wifi_bw; - - bt_info_ext = coex_sta->bt_info_ext; - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); - else /* for HID quality & wifi performance balance at 11n mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5afa5afa, 0xffff, 0x3); - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, false, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, false, 3); - } else { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, true, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, true, 3); - } - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - }; - } else { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, false, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, false, 3); - } else { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, true, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, false, true, 3); - } - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - -void halbtc8821aCsr2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); - else /* for HID quality & wifi performance balance at 11n mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5a5f5a5f, 0xffff, 0x3); - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 3); - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 10); - else - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } else { - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 10); - else - halbtc8821aCsr2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - -/* HID+A2DP+PAN(EDR) */ -void halbtc8821aCsr2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist - *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; - u32 wifi_bw; - - bt_info_ext = coex_sta->bt_info_ext; - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - halbtc8821aCsr2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); - else /* for HID quality & wifi performance balance at 11n mode */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 3); - } else { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 3); - } - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } else { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, false, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, false, 3); - } else { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 3); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 3); - } - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - -void halbtc8821aCsr2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -{ - u8 wifi_rssi_state, bt_rssi_state, bt_info_ext; - u32 wifi_bw; - - bt_info_ext = coex_sta->bt_info_ext; - wifi_rssi_state = halbtc8821aCsr2ant_wifi_rssi_state(btcoexist, 0, 2, - 15, 0); - bt_rssi_state = halbtc8821aCsr2ant_bt_rssi_state(2, 35, 0); - - if (halbtc8821aCsr2ant_need_to_dec_bt_pwr(btcoexist)) - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, true); - else - halbtc8821aCsr2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, false); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) { /* for HID at 11b/g mode */ - /* Allen halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); - } else { /* for HID quality & wifi performance balance at 11n mode */ - /* Allen halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, 0x55ff55ff, 0x5a5a5a5a, 0xffff, 0x3); */ - halbtc8821aCsr2ant_coex_table(btcoexist, NORMAL_EXEC, - 0x55ff55ff, 0x5f5b5f5b, 0xffffff, 0x3); - - } - - if (BTC_WIFI_BW_HT40 == wifi_bw) { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - } else { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - } - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } else { - /* fw mechanism */ - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (bt_info_ext & BIT(0)) { /* a2dp basic rate */ - /* halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, true, false, 2); */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - - } else { /* a2dp edr rate */ - /* Allen halbtc8821aCsr2ant_tdma_duration_adjust(btcoexist, true, false, 2); */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - } - } else { - if (bt_info_ext & BIT(0)) /* a2dp basic rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - else /* a2dp edr rate */ - halbtc8821aCsr2ant_tdma_duration_adjust( - btcoexist, true, true, 2); - } - - /* sw mechanism */ - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, true, - false, false, 0x18); - } else { - halbtc8821aCsr2ant_sw_mechanism1(btcoexist, false, - true, false, false); - halbtc8821aCsr2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); - } - } -} - -void halbtc8821aCsr2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - boolean wifi_under_5g = false; - u8 algorithm = 0; - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Manual control!!!\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - - if (wifi_under_5g) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), run 5G coex setting!!<===\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_coex_under_5g(btcoexist); - return; - } - - { - algorithm = halbtc8821aCsr2ant_action_algorithm(btcoexist); - if (coex_sta->c2h_bt_inquiry_page && - (BT_8821A_CSR_2ANT_COEX_ALGO_PANHS != algorithm)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under inquiry/page scan !!\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_bt_inquiry_page(btcoexist); - return; - } - - coex_dm->cur_algorithm = algorithm; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Algorithm = %d\n", coex_dm->cur_algorithm); - BTC_TRACE(trace_buf); - - if (halbtc8821aCsr2ant_is_common_action(btcoexist)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant common.\n"); - BTC_TRACE(trace_buf); - coex_dm->reset_tdma_adjust = true; - } else { - if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", - coex_dm->pre_algorithm, - coex_dm->cur_algorithm); - BTC_TRACE(trace_buf); - coex_dm->reset_tdma_adjust = true; - } - switch (coex_dm->cur_algorithm) { - case BT_8821A_CSR_2ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_sco( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_hid( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_a2dp( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_a2dp_pan_hs( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_pan_edr( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_pan_hs( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_pan_edr_a2dp( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_pan_edr_hid( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR - : - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_action_hid_a2dp( - btcoexist); - break; - default: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_coex_all_off( - btcoexist); - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } - } -} - - - -/* ************************************************************ - * work around function start with wa_halbtc8821aCsr2ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8821aCsr2ant_ - * ************************************************************ */ -void ex_halbtc8821aCsr2ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8821aCsr2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - if (wifi_only) - return; - - /* if(back_up) */ - { - /* backup rf 0x1e value */ - coex_dm->bt_rf_0x1e_backup = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x1e, 0xfffff); - coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, - 0x430); - coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, - 0x434); - coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( - btcoexist, 0x42a); - coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( - btcoexist, 0x456); - coex_dm->backup_ampdu_max_num = btcoexist->btc_read_2byte( - btcoexist, 0x4ca); - } - -#if 0 /* REMOVE */ - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); -#endif - - /* Antenna config */ - halbtc8821aCsr2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, - false); - - /* PTA parameter */ - halbtc8821aCsr2ant_coex_table(btcoexist, FORCE_EXEC, 0x55555555, - 0x55555555, 0xffff, 0x3); - - /* Enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, - 0xc); /* 0x76e[3] =1, WLAN_Act control by PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); - -#if 0 /* REMOVE */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -#endif -} - -void ex_halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Coex Mechanism Init!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821aCsr2ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8821aCsr2ant_display_coex_info(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_stack_info *stack_info = &btcoexist->stack_info; - u8 *cli_buf = btcoexist->cli_buf; - u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; - u32 u32tmp[4]; - u32 fw_ver = 0, bt_patch_ver = 0; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", - "Ant PG number/ Ant mechanism:", - board_info->pg_ant_num, board_info->btdm_ant_num); - CL_PRINTF(cli_buf); - - if (btcoexist->manual_control) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "[Action Manual control]!!"); - CL_PRINTF(cli_buf); - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8821a_csr_2ant, glcoex_ver_8821a_csr_2ant, - fw_ver, bt_patch_ver, bt_patch_ver); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", - "Wifi channel informed to BT", - coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], - coex_dm->wifi_chnl_info[2]); - CL_PRINTF(cli_buf); - - /* wifi status */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Wifi Status]============"); - CL_PRINTF(cli_buf); - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[BT Status]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", - "BT [status/ rssi/ retryCnt]", - ((coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") : (( - BT_8821A_CSR_2ANT_BT_STATUS_IDLE == coex_dm->bt_status) - ? "idle" : ((BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE - == coex_dm->bt_status) ? "connected-idle" : "busy"))), - coex_sta->bt_rssi, coex_sta->bt_retry_cnt); - CL_PRINTF(cli_buf); - - if (stack_info->profile_notified) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d", "SCO/HID/PAN/A2DP", - stack_info->sco_exist, stack_info->hid_exist, - stack_info->pan_exist, stack_info->a2dp_exist); - CL_PRINTF(cli_buf); - - btcoexist->btc_disp_dbg_msg(btcoexist, - BTC_DBG_DISP_BT_LINK_INFO); - } - - bt_info_ext = coex_sta->bt_info_ext; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "BT Info A2DP rate", - (bt_info_ext & BIT(0)) ? "Basic rate" : "EDR rate"); - CL_PRINTF(cli_buf); - - for (i = 0; i < BT_INFO_SRC_8821A_CSR_2ANT_MAX; i++) { - if (coex_sta->bt_info_c2h_cnt[i]) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", - glbt_info_src_8821a_csr_2ant[i], - coex_sta->bt_info_c2h[i][0], - coex_sta->bt_info_c2h[i][1], - coex_sta->bt_info_c2h[i][2], - coex_sta->bt_info_c2h[i][3], - coex_sta->bt_info_c2h[i][4], - coex_sta->bt_info_c2h[i][5], - coex_sta->bt_info_c2h[i][6], - coex_sta->bt_info_c2h_cnt[i]); - CL_PRINTF(cli_buf); - } - } - - /* Sw mechanism */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Sw mechanism]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", - "SM1[ShRf/ LpRA/ LimDig]", - coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, - coex_dm->limited_dig); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", - "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", - coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, - coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); - CL_PRINTF(cli_buf); - - /* Fw mechanism */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Fw mechanism]============"); - CL_PRINTF(cli_buf); - - if (!btcoexist->manual_control) { - ps_tdma_case = coex_dm->cur_ps_tdma; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d", - "PS TDMA", - coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], - coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], - coex_dm->ps_tdma_para[4], ps_tdma_case); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", - "DecBtPwr/ IgnWlanAct", - coex_dm->cur_dec_bt_pwr, coex_dm->cur_ignore_wlan_act); - CL_PRINTF(cli_buf); - } - - /* Hw setting */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Hw setting]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", - "RF-A, 0x1e initVal", - coex_dm->bt_rf_0x1e_backup); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x ", - "0x778 (W_Act)/ 0x6cc (CoTab Sel)", - u8tmp[0], u8tmp[1]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x8db); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xc5b); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x8db(ADC)/0xc5b[29:25](DAC)", - ((u8tmp[0] & 0x60) >> 5), ((u8tmp[1] & 0x3e) >> 1)); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0xcb4[7:0](ctrl)/ 0xcb4[29:28](val)", - u32tmp[0] & 0xff, ((u32tmp[0] & 0x30000000) >> 28)); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x974); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x40/ 0x4c[24:23]/ 0x974", - u8tmp[0], ((u32tmp[0] & 0x01800000) >> 23), u32tmp[1]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x550(bcn ctrl)/0x522", - u32tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa0a); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0xc50(DIG)/0xa0a(CCK-TH)", - u32tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "OFDM-FA/ CCK-FA", - u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x6c0/0x6c4/0x6c8", - u32tmp[0], u32tmp[1], u32tmp[2]); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770 (hi-pri Rx/Tx)", - coex_sta->high_priority_rx, coex_sta->high_priority_tx); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri Rx/Tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); - - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8821aCsr2ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - if (BTC_IPS_ENTER == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS ENTER notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - halbtc8821aCsr2ant_coex_all_off(btcoexist); - } else if (BTC_IPS_LEAVE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = false; - /* halbtc8821aCsr2ant_init_coex_dm(btcoexist); */ - } -} - -void ex_halbtc8821aCsr2ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - if (BTC_LPS_ENABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS ENABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = true; - } else if (BTC_LPS_DISABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS DISABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = false; - } -} - -void ex_halbtc8821aCsr2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - if (BTC_SCAN_START == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN START notify\n"); - BTC_TRACE(trace_buf); - } else if (BTC_SCAN_FINISH == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify\n"); - BTC_TRACE(trace_buf); - } -} - -void ex_halbtc8821aCsr2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - if (BTC_ASSOCIATE_START == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT START notify\n"); - BTC_TRACE(trace_buf); - } else if (BTC_ASSOCIATE_FINISH == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT FINISH notify\n"); - BTC_TRACE(trace_buf); - } -} - -void ex_halbtc8821aCsr2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_parameter[3] = {0}; - u32 wifi_bw; - u8 wifi_central_chnl; - - if (BTC_MEDIA_CONNECT == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA connect notify\n"); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA disconnect notify\n"); - BTC_TRACE(trace_buf); - } - - /* only 2.4G we need to inform bt the chnl mask */ - btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, - &wifi_central_chnl); - if ((BTC_MEDIA_CONNECT == type) && - (wifi_central_chnl <= 14)) { - h2c_parameter[0] = 0x1; - h2c_parameter[1] = wifi_central_chnl; - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) - h2c_parameter[2] = 0x30; - else - h2c_parameter[2] = 0x20; - } - -} - -void ex_halbtc8821aCsr2ant_specific_packet_notify(IN struct btc_coexist - *btcoexist, IN u8 type) -{ - if (type == BTC_PACKET_DHCP) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], DHCP Packet notify\n"); - BTC_TRACE(trace_buf); - } -} - -void ex_halbtc8821aCsr2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length) -{ - u8 bt_info = 0; - u8 i, rsp_source = 0; - boolean bt_busy = false, limited_dig = false; - boolean wifi_connected = false, bt_hs_on = false, - wifi_under_5g = false; - - coex_sta->c2h_bt_info_req_sent = false; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - - rsp_source = tmp_buf[0] & 0xf; - if (rsp_source >= BT_INFO_SRC_8821A_CSR_2ANT_MAX) - rsp_source = BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW; - coex_sta->bt_info_c2h_cnt[rsp_source]++; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, - length); - BTC_TRACE(trace_buf); - for (i = 0; i < length; i++) { - coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; - if (i == 1) - bt_info = tmp_buf[i]; - if (i == length - 1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - if (BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW != rsp_source) { - coex_sta->bt_retry_cnt = /* [3:0] */ - coex_sta->bt_info_c2h[rsp_source][2] & 0xf; - - coex_sta->bt_rssi = - coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; - - coex_sta->bt_info_ext = - coex_sta->bt_info_c2h[rsp_source][4]; - -#if 0 /* REMOVE */ - /* Here we need to resend some wifi info to BT */ - /* because bt is reset and loss of the info. */ - if ((coex_sta->bt_info_ext & BIT(1))) { - - if (wifi_connected) - ex_halbtc8821aCsr2ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8821aCsr2ant_media_status_notify( - btcoexist, BTC_MEDIA_DISCONNECT); - } -#endif - - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - if (bt_info == - BT_INFO_8821A_CSR_2ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_sta->bt_link_exist = true; - coex_dm->bt_status = - BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE; - } else if (bt_info & - BT_INFO_8821A_CSR_2ANT_B_CONNECTION) { /* connection exists and some link is busy */ - coex_sta->bt_link_exist = true; - - if (bt_info & BT_INFO_8821A_CSR_2ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - - if (bt_info & BT_INFO_8821A_CSR_2ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - - if (bt_info & BT_INFO_8821A_CSR_2ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - - if (bt_info & BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO) - coex_sta->sco_exist = true; - else - coex_sta->sco_exist = false; - - if (coex_sta->bt_info_ext & 0x80) - coex_sta->slave = true; /* Slave */ - else - coex_sta->slave = false; /* Master */ - - coex_dm->bt_status = - BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; - } else { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->slave = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; - coex_dm->bt_status = BT_8821A_CSR_2ANT_BT_STATUS_IDLE; - } - - if (bt_hs_on) - coex_dm->bt_status = - BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; - - if (bt_info & BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE) { - coex_sta->c2h_bt_inquiry_page = true; - coex_dm->bt_status = BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE; - } else - coex_sta->c2h_bt_inquiry_page = false; - - - if (BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE == coex_dm->bt_status) - bt_busy = true; - else - bt_busy = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - if (BT_8821A_CSR_2ANT_BT_STATUS_IDLE != coex_dm->bt_status) - limited_dig = true; - else - limited_dig = false; - coex_dm->limited_dig = limited_dig; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); - - halbtc8821aCsr2ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8821aCsr2ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - ex_halbtc8821aCsr2ant_media_status_notify(btcoexist, - BTC_MEDIA_DISCONNECT); -} - -void ex_halbtc8821aCsr2ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_WIFI_PNP_SLEEP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to SLEEP\n"); - BTC_TRACE(trace_buf); - halbtc8821aCsr2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ - /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ - /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ - coex_sta->under_ips = false; - coex_sta->under_lps = false; - } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to WAKE UP\n"); - BTC_TRACE(trace_buf); - } -} - -void ex_halbtc8821aCsr2ant_periodical(IN struct btc_coexist *btcoexist) -{ - halbtc8821aCsr2ant_monitor_bt_ctr(btcoexist); - halbtc8821aCsr2ant_monitor_bt_enable_disable(btcoexist); -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.h deleted file mode 100644 index 8d228fb17454..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821aCsr2Ant.h +++ /dev/null @@ -1,188 +0,0 @@ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821A_SUPPORT == 1) - -/* ******************************************* - * The following is for 8821A_CSR 2Ant BT Co-exist definition - * ******************************************* */ -#define BT_INFO_8821A_CSR_2ANT_B_FTP BIT(7) -#define BT_INFO_8821A_CSR_2ANT_B_A2DP BIT(6) -#define BT_INFO_8821A_CSR_2ANT_B_HID BIT(5) -#define BT_INFO_8821A_CSR_2ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8821A_CSR_2ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8821A_CSR_2ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8821A_CSR_2ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8821A_CSR_2ANT_B_CONNECTION BIT(0) - -#define BTC_RSSI_COEX_THRESH_TOL_8821A_CSR_2ANT 2 - -enum bt_info_src_8821a_csr_2ant { - BT_INFO_SRC_8821A_CSR_2ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8821A_CSR_2ANT_BT_RSP = 0x1, - BT_INFO_SRC_8821A_CSR_2ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8821A_CSR_2ANT_MAX -}; - -enum bt_8821a_csr_2ant_bt_status { - BT_8821A_CSR_2ANT_BT_STATUS_IDLE = 0x0, - BT_8821A_CSR_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8821A_CSR_2ANT_BT_STATUS_NON_IDLE = 0x2, - BT_8821A_CSR_2ANT_BT_STATUS_MAX -}; - -enum bt_8821a_csr_2ant_coex_algo { - BT_8821A_CSR_2ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8821A_CSR_2ANT_COEX_ALGO_SCO = 0x1, - BT_8821A_CSR_2ANT_COEX_ALGO_HID = 0x2, - BT_8821A_CSR_2ANT_COEX_ALGO_A2DP = 0x3, - BT_8821A_CSR_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR = 0x5, - BT_8821A_CSR_2ANT_COEX_ALGO_PANHS = 0x6, - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8821A_CSR_2ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8821A_CSR_2ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8821A_CSR_2ANT_COEX_ALGO_MAX = 0xb, -}; - -struct coex_dm_8821a_csr_2ant { - /* fw mechanism */ - boolean pre_dec_bt_pwr; - boolean cur_dec_bt_pwr; - u8 pre_fw_dac_swing_lvl; - u8 cur_fw_dac_swing_lvl; - boolean cur_ignore_wlan_act; - boolean pre_ignore_wlan_act; - u8 pre_ps_tdma; - u8 cur_ps_tdma; - u8 ps_tdma_para[6]; - u8 ps_tdma_du_adj_type; - boolean reset_tdma_adjust; - boolean pre_ps_tdma_on; - boolean cur_ps_tdma_on; - boolean pre_bt_auto_report; - boolean cur_bt_auto_report; - - /* sw mechanism */ - boolean pre_rf_rx_lpf_shrink; - boolean cur_rf_rx_lpf_shrink; - u32 bt_rf_0x1e_backup; - boolean pre_low_penalty_ra; - boolean cur_low_penalty_ra; - boolean pre_dac_swing_on; - u32 pre_dac_swing_lvl; - boolean cur_dac_swing_on; - u32 cur_dac_swing_lvl; - boolean pre_adc_back_off; - boolean cur_adc_back_off; - boolean pre_agc_table_en; - boolean cur_agc_table_en; - u32 pre_val0x6c0; - u32 cur_val0x6c0; - u32 pre_val0x6c4; - u32 cur_val0x6c4; - u32 pre_val0x6c8; - u32 cur_val0x6c8; - u8 pre_val0x6cc; - u8 cur_val0x6cc; - boolean limited_dig; - - u32 pre_ra_mask; - u32 cur_ra_mask; - - u8 cur_ampdu_num_type; - u8 pre_ampdu_num_type; - u16 backup_ampdu_max_num; - - u8 cur_ampdu_time_type; - u8 pre_ampdu_time_type; - u8 backup_ampdu_max_time; - - u8 cur_arfr_type; - u8 pre_arfr_type; - u32 backup_arfr_cnt1; - u32 backup_arfr_cnt2; - - u8 cur_retry_limit_type; - u8 pre_retry_limit_type; - u16 backup_retry_limit; - - /* algorithm related */ - u8 pre_algorithm; - u8 cur_algorithm; - u8 bt_status; - u8 wifi_chnl_info[3]; -}; - -struct coex_sta_8821a_csr_2ant { - boolean bt_disabled; - boolean bt_link_exist; - boolean sco_exist; - boolean a2dp_exist; - boolean slave; - boolean hid_exist; - boolean pan_exist; - - boolean under_lps; - boolean under_ips; - u32 high_priority_tx; - u32 high_priority_rx; - u32 low_priority_tx; - u32 low_priority_rx; - u8 bt_rssi; - u8 pre_bt_rssi_state; - u8 pre_wifi_rssi_state[4]; - boolean c2h_bt_info_req_sent; - u8 bt_info_c2h[BT_INFO_SRC_8821A_CSR_2ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8821A_CSR_2ANT_MAX]; - boolean c2h_bt_inquiry_page; - u8 bt_retry_cnt; - u8 bt_info_ext; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8821aCsr2ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8821aCsr2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8821aCsr2ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8821aCsr2ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821aCsr2ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821aCsr2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821aCsr2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821aCsr2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8821aCsr2ant_specific_packet_notify(IN struct btc_coexist - *btcoexist, IN u8 type); -void ex_halbtc8821aCsr2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8821aCsr2ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8821aCsr2ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8821aCsr2ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8821aCsr2ant_display_coex_info(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8821aCsr2ant_power_on_setting(btcoexist) -#define ex_halbtc8821aCsr2ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8821aCsr2ant_init_coex_dm(btcoexist) -#define ex_halbtc8821aCsr2ant_ips_notify(btcoexist, type) -#define ex_halbtc8821aCsr2ant_lps_notify(btcoexist, type) -#define ex_halbtc8821aCsr2ant_scan_notify(btcoexist, type) -#define ex_halbtc8821aCsr2ant_connect_notify(btcoexist, type) -#define ex_halbtc8821aCsr2ant_media_status_notify(btcoexist, type) -#define ex_halbtc8821aCsr2ant_specific_packet_notify(btcoexist, type) -#define ex_halbtc8821aCsr2ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8821aCsr2ant_halt_notify(btcoexist) -#define ex_halbtc8821aCsr2ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8821aCsr2ant_periodical(btcoexist) -#define ex_halbtc8821aCsr2ant_display_coex_info(btcoexist) -#endif - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8822b1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8822b1Ant.c deleted file mode 100644 index be0a2ac881de..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8822b1Ant.c +++ /dev/null @@ -1,6006 +0,0 @@ -/* ************************************************************ - * Description: - * - * This file is for RTL8822B Co-exist mechanism - * - * History - * 2012/11/15 Cosa first check in. - * - * ************************************************************ */ - -/* ************************************************************ - * include files - * ************************************************************ */ -#include "Mp_Precomp.h" - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8822B_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8822b_1ant glcoex_dm_8822b_1ant; -static struct coex_dm_8822b_1ant *coex_dm = &glcoex_dm_8822b_1ant; -static struct coex_sta_8822b_1ant glcoex_sta_8822b_1ant; -static struct coex_sta_8822b_1ant *coex_sta = &glcoex_sta_8822b_1ant; -static struct psdscan_sta_8822b_1ant gl_psd_scan_8822b_1ant; -static struct psdscan_sta_8822b_1ant *psd_scan = &gl_psd_scan_8822b_1ant; -static struct rfe_type_8822b_1ant gl_rfe_type_8822b_1ant; -static struct rfe_type_8822b_1ant *rfe_type = &gl_rfe_type_8822b_1ant; - - - -const char *const glbt_info_src_8822b_1ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8822b_1ant = 20160411; -u32 glcoex_ver_8822b_1ant = 0x14; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8822b1ant_ - * ************************************************************ */ -u8 halbtc8822b1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -{ - s32 bt_rssi = 0; - u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; - - bt_rssi = coex_sta->bt_rssi; - - if (level_num == 2) { - if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Rssi thresh error!!\n"); - BTC_TRACE(trace_buf); - return coex_sta->pre_bt_rssi_state; - } - - if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_MEDIUM) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_MEDIUM)) { - if (bt_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (bt_rssi < rssi_thresh1) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - coex_sta->pre_bt_rssi_state = bt_rssi_state; - - return bt_rssi_state; -} - -u8 halbtc8822b1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, - IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -{ - s32 wifi_rssi = 0; - u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; - - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - - if (level_num == 2) { - if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) - || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi RSSI thresh error!!\n"); - BTC_TRACE(trace_buf); - return coex_sta->pre_wifi_rssi_state[index]; - } - - if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) - || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_MEDIUM) || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_MEDIUM)) { - if (wifi_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (wifi_rssi < rssi_thresh1) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; - - return wifi_rssi_state; -} - -void halbtc8822b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 dis_rate_mask) -{ - coex_dm->cur_ra_mask = dis_rate_mask; - - if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) - btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, - &coex_dm->cur_ra_mask); - coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -} - -void halbtc8822b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - boolean wifi_under_b_mode = false; - - coex_dm->cur_arfr_type = type; - - if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { - switch (coex_dm->cur_arfr_type) { - case 0: /* normal mode */ - btcoexist->btc_write_4byte(btcoexist, 0x430, - coex_dm->backup_arfr_cnt1); - btcoexist->btc_write_4byte(btcoexist, 0x434, - coex_dm->backup_arfr_cnt2); - break; - case 1: - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - if (wifi_under_b_mode) { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x01010101); - } else { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x04030201); - } - break; - default: - break; - } - } - - coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -} - -void halbtc8822b1ant_retry_limit(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_retry_limit_type = type; - - if (force_exec || - (coex_dm->pre_retry_limit_type != - coex_dm->cur_retry_limit_type)) { - switch (coex_dm->cur_retry_limit_type) { - case 0: /* normal mode */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - coex_dm->backup_retry_limit); - break; - case 1: /* retry limit=8 */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - 0x0808); - break; - default: - break; - } - } - - coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -} - -void halbtc8822b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_ampdu_time_type = type; - - if (force_exec || - (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { - switch (coex_dm->cur_ampdu_time_type) { - case 0: /* normal mode */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - coex_dm->backup_ampdu_max_time); - break; - case 1: /* AMPDU timw = 0x38 * 32us */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - 0x38); - break; - default: - break; - } - } - - coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -} - -void halbtc8822b1ant_limited_tx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, - IN u8 retry_limit_type, IN u8 ampdu_time_type) -{ - switch (ra_mask_type) { - case 0: /* normal mode */ - halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, - 0x00000003); - break; - case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ - halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8822b1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8822b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8822b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -/* -1: true / don't care / don't care -max: false / false / don't care -7: false / true / 7 -*/ - -void halbtc8822b1ant_limited_rx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean rej_ap_agg_pkt, - IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -{ - boolean reject_rx_agg = rej_ap_agg_pkt; - boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; - u8 rx_agg_size = agg_buf_size; - - /* ============================================ */ - /* Rx Aggregation related setting */ - /* ============================================ */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, - &reject_rx_agg); - /* decide BT control aggregation buf size or not */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, - &bt_ctrl_rx_agg_size); - /* aggregation buf size, only work when BT control Rx aggregation size. */ - btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); - /* real update aggregation setting */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); - - -} - -void halbtc8822b1ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - coex_sta->c2h_bt_info_req_sent = true; - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -void halbtc8822b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -{ - u32 reg_hp_txrx, reg_lp_txrx, u32tmp; - u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; - static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ - /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ - - if (coex_sta->under_ips) { - /* coex_sta->high_priority_tx = 65535; */ - /* coex_sta->high_priority_rx = 65535; */ - /* coex_sta->low_priority_tx = 65535; */ - /* coex_sta->low_priority_rx = 65535; */ - /* return; */ - } - - reg_hp_txrx = 0x770; - reg_lp_txrx = 0x774; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); - reg_hp_tx = u32tmp & MASKLWORD; - reg_hp_rx = (u32tmp & MASKHWORD) >> 16; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); - reg_lp_tx = u32tmp & MASKLWORD; - reg_lp_rx = (u32tmp & MASKHWORD) >> 16; - - coex_sta->high_priority_tx = reg_hp_tx; - coex_sta->high_priority_rx = reg_hp_rx; - coex_sta->low_priority_tx = reg_lp_tx; - coex_sta->low_priority_rx = reg_lp_rx; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", - reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); - BTC_TRACE(trace_buf); - - /* reset counter */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); - - if ((coex_sta->low_priority_tx > 1150) && - (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->pop_event_cnt++; - - if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) - && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist) ) { - if (cnt_slave >= 3) { - bt_link_info->slave_role = true; - cnt_slave = 3; - } else { - cnt_slave ++; - } - } else { - if(cnt_slave == 0) { - bt_link_info->slave_role = false; - cnt_slave = 0; - } else{ - cnt_slave--; - } - - } - - if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && - (coex_sta->low_priority_rx == 0)) { - num_of_bt_counter_chk++; - - if (num_of_bt_counter_chk >= 3) { - halbtc8822b1ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; - } - } -#if 0 - /* Add Hi-Pri Tx/Rx counter to avoid false detection */ - if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && - (coex_sta->high_priority_tx + coex_sta->high_priority_rx - >= 160) - && (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->bt_hi_pri_link_exist = true; - else - coex_sta->bt_hi_pri_link_exist = false; - - if ((coex_sta->acl_busy) && - (coex_sta->num_of_profile == 0)) { - if (coex_sta->low_priority_tx + - coex_sta->low_priority_rx >= 160) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - coex_sta->wrong_profile_notification++; - } - } -#endif - -} - - -void halbtc8822b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) - { - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false; - static u8 cck_lock_counter = 0; - u32 total_cnt; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE,&wifi_under_b_mode); - - if (coex_sta->under_ips) { - coex_sta->crc_ok_cck = 0; - coex_sta->crc_ok_11g = 0; - coex_sta->crc_ok_11n = 0; - coex_sta->crc_ok_11n_agg = 0; - - coex_sta->crc_err_cck = 0; - coex_sta->crc_err_11g = 0; - coex_sta->crc_err_11n = 0; - coex_sta->crc_err_11n_agg = 0; - } else { - coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, - 0xf04); - coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf14); - coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf10); - coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xf0c); - - coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist,0xf00) + btcoexist->btc_read_2byte(btcoexist,0xf06); - - coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf16); - coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf12); - coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xf0e); - } - - - /* reset counter */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); - - if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { - total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + - coex_sta->crc_ok_11n_agg; - - if ((coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == - BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == - BT_8822B_1ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (total_cnt - - coex_sta->crc_ok_cck)) { - if (cck_lock_counter < 3) - cck_lock_counter++; - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - if (!coex_sta->pre_ccklock) { - - if (cck_lock_counter >= 3) - coex_sta->cck_lock = true; - else - coex_sta->cck_lock = false; - } else { - if (cck_lock_counter == 0) - coex_sta->cck_lock = false; - else - coex_sta->cck_lock = true; - } - - if (coex_sta->cck_lock) - coex_sta->cck_ever_lock = true; - - coex_sta->pre_ccklock = coex_sta->cck_lock; - - - } - - -boolean halbtc8822b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -{ - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false, pre_bt_off = false; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - if (coex_sta->bt_disabled != pre_bt_off) - { - pre_bt_off = coex_sta->bt_disabled; - - if (coex_sta->bt_disabled) - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); - else - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); - - BTC_TRACE(trace_buf); - - coex_sta->bt_coex_supported_feature = 0; - coex_sta->bt_coex_supported_version = 0; - return true; - } - - if (wifi_connected) { - if (wifi_busy != pre_wifi_busy) { - pre_wifi_busy = wifi_busy; - return true; - } - if (under_4way != pre_under_4way) { - pre_under_4way = under_4way; - return true; - } - if (bt_hs_on != pre_bt_hs_on) { - pre_bt_hs_on = bt_hs_on; - return true; - } - } - - return false; -} - -void halbtc8822b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - bt_link_info->bt_link_exist = coex_sta->bt_link_exist; - bt_link_info->sco_exist = coex_sta->sco_exist; - bt_link_info->a2dp_exist = coex_sta->a2dp_exist; - bt_link_info->pan_exist = coex_sta->pan_exist; - bt_link_info->hid_exist = coex_sta->hid_exist; - bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; - bt_link_info->acl_busy = coex_sta->acl_busy; - - /* work around for HS mode. */ - if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; - } - - /* check if Sco only */ - if (bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->sco_only = true; - else - bt_link_info->sco_only = false; - - /* check if A2dp only */ - if (!bt_link_info->sco_exist && - bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->a2dp_only = true; - else - bt_link_info->a2dp_only = false; - - /* check if Pan only */ - if (!bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->pan_only = true; - else - bt_link_info->pan_only = false; - - /* check if Hid only */ - if (!bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - bt_link_info->hid_exist) - bt_link_info->hid_only = true; - else - bt_link_info->hid_only = false; -} - -void halbtc8822b1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_parameter[3] = {0}; - u32 wifi_bw; - u8 wifi_central_chnl; - - /* only 2.4G we need to inform bt the chnl mask */ - btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, - &wifi_central_chnl); - if ((BTC_MEDIA_CONNECT == type) && - (wifi_central_chnl <= 14)) { - - h2c_parameter[0] = 0x1; /* enable BT AFH skip WL channel for 8822b because BT Rx LO interference */ - h2c_parameter[1] = wifi_central_chnl; - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_HT40 == wifi_bw) - h2c_parameter[2] = 0x30; - else - h2c_parameter[2] = 0x20; - } - - coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; - coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; - coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); - -} - -u8 halbtc8822b1ant_action_algorithm(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - u8 algorithm = BT_8822B_1ANT_COEX_ALGO_UNDEFINED; - u8 num_of_diff_profile = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - if (!bt_link_info->bt_link_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], No BT link exists!!!\n"); - BTC_TRACE(trace_buf); - return algorithm; - } - - if (bt_link_info->sco_exist) - num_of_diff_profile++; - if (bt_link_info->hid_exist) - num_of_diff_profile++; - if (bt_link_info->pan_exist) - num_of_diff_profile++; - if (bt_link_info->a2dp_exist) - num_of_diff_profile++; - - if (num_of_diff_profile == 1) { - if (bt_link_info->sco_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; - } else { - if (bt_link_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_HID; - } else if (bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = A2DP only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_A2DP; - } else if (bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = PAN(HS) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANEDR; - } - } - } - } else if (num_of_diff_profile == 2) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_HID; - } else if (bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; - } else if (bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + A2DP\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_HID_A2DP; - } else if (bt_link_info->hid_exist && - bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; - } - } else if (bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP; - } - } - } - } else if (num_of_diff_profile == 3) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_HID; - } else if (bt_link_info->hid_exist && - bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; - } - } else if (bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; - } - } - } - } else if (num_of_diff_profile >= 3) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist && - bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8822b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean enable_auto_report) -{ - u8 h2c_parameter[1] = {0}; - - h2c_parameter[0] = 0; - - if (enable_auto_report) - h2c_parameter[0] |= BIT(0); - - btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -} - -void halbtc8822b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable_auto_report) -{ - coex_dm->cur_bt_auto_report = enable_auto_report; - - if (!force_exec) { - if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) - return; - } - halbtc8822b1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8822b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ - u8 h2c_parameter[6] = {0}; - - h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ - - if (low_penalty_ra) { - h2c_parameter[1] |= BIT(0); - h2c_parameter[2] = - 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ - h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ - h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} - -void halbtc8822b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean low_penalty_ra) -{ - coex_dm->cur_low_penalty_ra = low_penalty_ra; - - if (!force_exec) { - if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) - return; - } - halbtc8822b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, - coex_dm->cur_low_penalty_ra); - - coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -} - -void halbtc8822b1ant_write_score_board( - IN struct btc_coexist *btcoexist, - IN u16 bitpos, - IN BOOLEAN state -) -{ - - static u16 originalval = 0x8002; - - if (state) - originalval = originalval | bitpos; - else - originalval = originalval & (~bitpos); - - btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -} - -void halbtc8822b1ant_read_score_board( - IN struct btc_coexist *btcoexist, - IN u16 *score_board_val -) -{ - - *score_board_val = (btcoexist->btc_read_2byte(btcoexist, - 0xaa)) & 0x7fff; -} - -void halbtc8822b1ant_post_activestate_to_bt( - IN struct btc_coexist *btcoexist, - IN boolean wifi_active -) -{ - - if (wifi_active) - halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); - else - halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); -} - - -void halbtc8822b1ant_post_onoffstate_to_bt( - IN struct btc_coexist *btcoexist, - IN boolean wifi_on -) -{ - - if (wifi_on) - halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); - else - halbtc8822b1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); -} - - -void halbtc8822b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -{ - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - u16 u16tmp; - - /* This function check if bt is disabled */ -#if 1 - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - - -#else - - /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ - halbtc8822b1ant_read_score_board(btcoexist, &u16tmp); - - bt_active = u16tmp & BIT(1); - - -#endif - - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - } else { - - bt_disable_cnt++; - if (bt_disable_cnt >= 2) { - bt_disabled = true; - bt_disable_cnt = 2; - } - - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - } - - - if (coex_sta->bt_disabled != bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); - BTC_TRACE(trace_buf); - coex_sta->bt_disabled = bt_disabled; - } - -} - - - -void halbtc8822b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, - boolean isenable) -{ - static u8 bitVal[5] = {0,0,0,0,0}; - static boolean state = false; - - if (state ==isenable) - return; - else - state = isenable; - - if (isenable) { - - /* enable GNT_WL, GNT_BT to GPIO for debug */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); - - /* store original value */ - bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ - bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ - bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ - bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ - bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ - - /* switch GPIO Mux */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ - - - } else { - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); - - /* Restore original value */ - /* switch GPIO Mux */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ - } - -} - - -u32 halbtc8822b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, - IN u16 reg_addr) -{ - u32 j = 0; - - - /* wait for ready bit before access 0x1700 */ - btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); - - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703) & BIT(5)) == 0) && - (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - return btcoexist->btc_read_4byte(btcoexist, - 0x1708); /* get read data */ - -} - -void halbtc8822b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, - IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -{ - u32 val, i = 0, j = 0, bitpos = 0; - - - if (bit_mask == 0x0) - return; - if (bit_mask == 0xffffffff) { - btcoexist->btc_write_4byte(btcoexist, 0x1704, - reg_value); /* put write data */ - - /* wait for ready bit before access 0x1700 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703) & BIT(5)) == 0) && - (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x1700, - 0xc00F0000 | reg_addr); - } else { - for (i = 0; i <= 31; i++) { - if (((bit_mask >> i) & 0x1) == 0x1) { - bitpos = i; - break; - } - } - - /* read back register value before write */ - val = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - reg_addr); - val = (val & (~bit_mask)) | (reg_value << bitpos); - - /* put write data value */ - btcoexist->btc_write_4byte(btcoexist, 0x1704, - val); /* put write data */ - - /* wait for ready bit before access 0x1700 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703) & BIT(5)) == 0) && - (j < BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - /* write data add*/ - - btcoexist->btc_write_4byte(btcoexist, 0x1700, - 0xc00F0000 | reg_addr); - - } - -} - -void halbtc8822b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 val; - - val = (enable) ? 1 : 0; - /* 0x38[7] */ - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, - val); /* 0x38[7] */ - -} - - -void halbtc8822b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, - IN boolean wifi_control) -{ - u8 val; - - val = (wifi_control) ? 1 : 0; - /* 0x70[26] */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, - val); /* 0x70[26] */ - -} - -void halbtc8822b1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, - IN u8 control_block, IN boolean sw_control, IN u8 state) -{ - u32 val = 0, bit_mask; - - state = state & 0x1; - /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) - 0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) - 0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) */ - val = (sw_control) ? ((state << 1) | 0x1) : 0; - - switch (control_block) { - case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: - default: - bit_mask = 0xc000; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ - bit_mask = 0x0c00; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ - break; - case BT_8822B_1ANT_GNT_BLOCK_RFC: - bit_mask = 0xc000; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ - break; - case BT_8822B_1ANT_GNT_BLOCK_BB: - bit_mask = 0x0c00; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ - break; - - } - -} - -void halbtc8822b1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, - IN u8 control_block, IN boolean sw_control, IN u8 state) -{ - u32 val = 0, bit_mask; - /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) - 0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) - 0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) */ - - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; - - switch (control_block) { - case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: - default: - bit_mask = 0x3000; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ - bit_mask = 0x0300; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ - break; - case BT_8822B_1ANT_GNT_BLOCK_RFC: - bit_mask = 0x3000; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ - break; - case BT_8822B_1ANT_GNT_BLOCK_BB: - bit_mask = 0x0300; - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ - break; - - } - -} - -void halbtc8822b1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, - IN u8 table_type, IN u16 table_content) -{ - u16 reg_addr = 0x0000; - - switch (table_type) { - case BT_8822B_1ANT_CTT_WL_VS_LTE: - reg_addr = 0xa0; - break; - case BT_8822B_1ANT_CTT_BT_VS_LTE: - reg_addr = 0xa4; - break; - } - - if (reg_addr != 0x0000) - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ - - -} - - -void halbtc8822b1ant_ltcoex_set_break_table(IN struct btc_coexist *btcoexist, - IN u8 table_type, IN u8 table_content) -{ - u16 reg_addr = 0x0000; - - switch (table_type) { - case BT_8822B_1ANT_LBTT_WL_BREAK_LTE: - reg_addr = 0xa8; - break; - case BT_8822B_1ANT_LBTT_BT_BREAK_LTE: - reg_addr = 0xac; - break; - case BT_8822B_1ANT_LBTT_LTE_BREAK_WL: - reg_addr = 0xb0; - break; - case BT_8822B_1ANT_LBTT_LTE_BREAK_BT: - reg_addr = 0xb4; - break; - } - - if (reg_addr != 0x0000) - halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ - - -} - -void halbtc8822b1ant_set_coex_table(IN struct btc_coexist *btcoexist, - IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -{ - btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); - - btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); - - btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); - - btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -} - -void halbtc8822b1ant_coex_table(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, - IN u32 val0x6c8, IN u8 val0x6cc) -{ - coex_dm->cur_val0x6c0 = val0x6c0; - coex_dm->cur_val0x6c4 = val0x6c4; - coex_dm->cur_val0x6c8 = val0x6c8; - coex_dm->cur_val0x6cc = val0x6cc; - - - - if (!force_exec) { - if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && - (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && - (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && - (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) - return; - } - halbtc8822b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, - val0x6cc); - - coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; - coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; - coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; - coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -} - -void halbtc8822b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - u32 break_table; - u8 select_table; - - - - coex_sta->coex_table_type = type; - - if (coex_sta->concurrent_rx_mode_on == true) { - - break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ - select_table = - 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ - } else { - - break_table = 0xffffff; - select_table = 0x3; - } - - switch (type) { - case 0: - halbtc8822b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, break_table, - select_table); - break; - case 1: - halbtc8822b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 2: - halbtc8822b1ant_coex_table(btcoexist, force_exec, - 0xaa5a5a5a, 0xaa5a5a5a, break_table, - select_table); - break; - case 3: - halbtc8822b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaa5a5a5a, break_table, - select_table); - break; - case 4: - halbtc8822b1ant_coex_table(btcoexist, - force_exec, 0xaa555555, 0xaa5a5a5a, - break_table, select_table); - break; - case 5: - halbtc8822b1ant_coex_table(btcoexist, - force_exec, 0x5a5a5a5a, 0x5a5a5a5a, - break_table, select_table); - break; - case 6: - halbtc8822b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaaaaa, break_table, - select_table); - break; - case 7: - halbtc8822b1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, break_table, - select_table); - break; - case 8: - halbtc8822b1ant_coex_table(btcoexist, force_exec, - 0xffffffff, 0xffffffff, break_table, - select_table); - break; - - default: - break; - } -} - -void halbtc8822b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - - - u8 h2c_parameter[1] = {0}; - - if (enable) { - h2c_parameter[0] |= BIT(0); /* function enable */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -} - -void halbtc8822b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable) -{ - - coex_dm->cur_ignore_wlan_act = enable; - - if (!force_exec) { - if (coex_dm->pre_ignore_wlan_act == - coex_dm->cur_ignore_wlan_act) - { - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; - return; - } - } - - halbtc8822b1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8822b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, - IN u8 lps_val, IN u8 rpwm_val) -{ - u8 lps = lps_val; - u8 rpwm = rpwm_val; - - btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); - btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -} - -void halbtc8822b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -{ - coex_dm->cur_lps = lps_val; - coex_dm->cur_rpwm = rpwm_val; - - if (!force_exec) { - if ((coex_dm->pre_lps == coex_dm->cur_lps) && - (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) - return; - } - halbtc8822b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); - - coex_dm->pre_lps = coex_dm->cur_lps; - coex_dm->pre_rpwm = coex_dm->cur_rpwm; -} - -void halbtc8822b1ant_ps_tdma_check_for_power_save_state( - IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -{ - u8 lps_mode = 0x0; - u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); - - if (lps_mode) { /* already under LPS state */ - if (new_ps_state) { - /* keep state under LPS, do nothing. */ - } else { - /* will leave LPS state, turn off psTdma first */ - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); - } else { - /* keep state under NO PS state, do nothing. */ - } - } -} - - -void halbtc8822b1ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -{ - boolean low_pwr_disable = false; - - switch (ps_type) { - case BTC_PS_WIFI_NATIVE: - /* recover to original 32k low power setting */ - coex_sta->force_lps_on = false; - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - coex_sta->force_lps_on = false; - break; - case BTC_PS_LPS_ON: - - coex_sta->force_lps_on = true; - halbtc8822b1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8822b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, - lps_val, rpwm_val); - /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - /* power save must executed before psTdma. */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, - NULL); - coex_sta->force_lps_on = true; - break; - case BTC_PS_LPS_OFF: - - coex_sta->force_lps_on = false; - halbtc8822b1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - coex_sta->force_lps_on = false; - break; - default: - break; - } -} - - -void halbtc8822b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, - IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -{ - u8 h2c_parameter[5] = {0}; - u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], FW for 1Ant AP mode\n"); - BTC_TRACE(trace_buf); - - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - - halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - - halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } else { - halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - - - h2c_parameter[0] = real_byte1; - h2c_parameter[1] = byte2; - h2c_parameter[2] = byte3; - h2c_parameter[3] = byte4; - h2c_parameter[4] = real_byte5; - - coex_dm->ps_tdma_para[0] = real_byte1; - coex_dm->ps_tdma_para[1] = byte2; - coex_dm->ps_tdma_para[2] = byte3; - coex_dm->ps_tdma_para[3] = byte4; - coex_dm->ps_tdma_para[4] = real_byte5; - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -} - -void halbtc8822b1ant_ps_tdma(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean turn_on, IN u8 type) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false; - static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; - static boolean pre_wifi_busy = false; - - coex_dm->cur_ps_tdma_on = turn_on; - coex_dm->cur_ps_tdma = type; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (wifi_busy != pre_wifi_busy) { - force_exec = true; - pre_wifi_busy = wifi_busy; - } - - /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ - if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) - psTdmaByte4Modify = 0x1; - else - psTdmaByte4Modify = 0x0; - - if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { - - force_exec = true; - pre_psTdmaByte4Modify = psTdmaByte4Modify; - } - - if (coex_dm->cur_ps_tdma_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********TDMA(on, %d) **********\n", - coex_dm->cur_ps_tdma); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], **********TDMA(off, %d) **********\n", - coex_dm->cur_ps_tdma); - BTC_TRACE(trace_buf); - } - - if (!force_exec) { - if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && - (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) - { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], return for no-TDMA case change\n"); - BTC_TRACE(trace_buf); - - return; - } - } - - - if (turn_on) { - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, - 0x1); /* enable TBTT nterrupt */ - - switch (type) { - default: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51,0x1a, 0x1a, 0x0, 0x10); - break; - case 1: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x3a,0x03,0x11, 0x10); - break; - case 3: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x3a, 0x03, 0x10, 0x10); - break; - case 4: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x21, 0x03, 0x10, 0x10); - break; - case 5: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x3,0x11, 0x11); - break; - case 7: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); - break; - case 8: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); - break; - case 13: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); - break; - case 14: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); - break; - case 15: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); - break; - case 17: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); - break;; - - case 20: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03,0x11, 0x10); - break; - case 22: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x25, 0x03,0x11, 0x10); - break; - case 32: - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x3,0x11, 0x11); - break; - case 41:/*HID*/ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51,0x45, 0x3, 0x11, 0x11); - break; - case 42:/*A2DP*/ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51,0x1e, 0x3, 0x10, 0x14| psTdmaByte4Modify); - break; - case 43:/*A2DP+HID*/ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51,0x45, 0x3, 0x10, 0x14); - break; - case 44:/*A2DP+OPP old */ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51,0x25, 0x3, 0x10, 0x10); - break; - case 45:/*OPP new -> WIFI FW check the ncuu_p ack of AP , if has no null_p ack , wifi fw will extened wifi slot */ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51,0x3a, 0x3, 0x10, 0x10); - break; - case 46:/*A2DP+OPP new-> WIFI FW check the ncuu_p ack of AP , if has no null_p ack , wifi fw will extened wifi slot*/ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x51,0x1a, 0x3, 0x10, 0x10); - break; - - } - } else { - - switch (type) { - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x0,0x0, 0x0, 0x0, 0x0); - /* - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_BT, FORCE_EXEC, false, - false); */ - break; - case 8: /* PTA Control */ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x8,0x0, 0x0, 0x0, 0x0); - /* - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, FORCE_EXEC, false, - false); */ - break; - case 9: /* Software control, Antenna at WiFi side */ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x0,0x0, 0x0, 0x0, 0x0); - /* - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_WIFI, FORCE_EXEC,false,false); */ - break; - case 10: /* under 5G , 0x778=1*/ - halbtc8822b1ant_set_fw_pstdma(btcoexist, - 0x0,0x0, 0x0, 0x0, 0x0); - - /* - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_WIFI5G, FORCE_EXEC, false, - false); */ - - break; - } - } - - - /* update pre state */ - coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; - coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -} - - -void halbtc8822b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, - IN boolean low_penalty_ra) -{ - halbtc8822b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -void halbtc8822b1ant_set_rfe_type(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - - - /* the following setup should be got from Efuse in the future */ - rfe_type->rfe_module_type = board_info->rfe_type; - - rfe_type->ext_ant_switch_ctrl_polarity = 0;; - - switch(rfe_type->rfe_module_type) - { - case 0: - default: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; - break; - case 1: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; - break; - case 2: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; - break; - case 3: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; - break; - case 4: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SP3T; /* SP3T */; - break; - } - - -} - - -void halbtc8822b1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - boolean switch_polatiry_inverse = false; - u8 regval_0xcbd = 0, regval_0x64; - u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - - if (!rfe_type->ext_ant_switch_exist) - return; - - coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; - - if (!force_exec) { - if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) - return; - } - - coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; - - /* swap control polarity if use different switch control polarity*/ - /* Normal switch polarity for SPDT, 0xcbd[1:0] = 2b'01 => Ant to BTG, 0xcbd[1:0] = 2b'10 => Ant to WLG */ - switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); - - - switch(pos_type) - { - default: - case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT: - case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE: - - break; - case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG: - switch_polatiry_inverse = ~switch_polatiry_inverse; - break; - case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA: - break; - } - - - if (rfe_type->ext_ant_switch_type == BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT) - { - switch(ctrl_type) - { - default: - case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ - - regval_0xcbd = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcbd[1:0] = 2b'01 for no switch_polatiry_inverse, ANTSWB =1, ANTSW =0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, regval_0xcbd); - - break; - case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ - - regval_0xcbd = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcbd[1:0] = 2b'10 for no switch_polatiry_inverse, ANTSWB =1, ANTSW =0 @ GNT_BT=1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, regval_0xcbd); - - break; - case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ - - /* no regval_0xcbd setup required, because antenna switch control value by antenna diversity */ - - break; - case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ - - regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); - break; - case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ - - /* no setup required, because antenna switch control value by BT vendor 0xac[1:0] */ - break; - } - } - - u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcbd); - u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ext Ant switch setup) 0xcbd = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", - u32tmp1, u32tmp2, u32tmp3); - BTC_TRACE(trace_buf); - - -} - - -void halbtc8822b1ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean force_exec, - IN u8 phase) - -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u8 u8tmp = 0; - u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - - coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; - - if (!force_exec) { - if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) - return; - } - - coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; - -#if 1 - u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0x54); - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u32tmp3, u8tmp, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); -#endif - - switch (phase) - { - case BT_8822B_1ANT_PHASE_COEX_INIT: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_COEX_INIT) **********\n" ); - BTC_TRACE(trace_buf); - - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, - BT_8822B_1ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, - BT_8822B_1ANT_CTT_BT_VS_LTE, 0xffff); - - /* set GNT_BT to SW high */ - halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); - - /* set GNT_WL to SW low */ - halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_LOW); - - /* set Path control owner to WL at initial step */ - halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8822B_1ANT_PCO_WLSIDE); - - coex_sta->run_time_state = false; - - /* Ext switch buffer mux */ - btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_BT; - - break; - case BT_8822B_1ANT_PHASE_WLANONLY_INIT: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLANONLY_INIT) **********\n" ); - BTC_TRACE(trace_buf); - - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, - BT_8822B_1ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, - BT_8822B_1ANT_CTT_BT_VS_LTE, 0xffff); - - /* set GNT_BT to SW Low */ - halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_LOW); - - /* Set GNT_WL to SW high */ - halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); - - /* set Path control owner to WL at initial step */ - halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8822B_1ANT_PCO_WLSIDE); - - coex_sta->run_time_state = false; - - /* Ext switch buffer mux */ - btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_WIFI; - - break; - case BT_8822B_1ANT_PHASE_WLAN_OFF: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLAN_OFF) **********\n" ); - BTC_TRACE(trace_buf); - - /* Disable LTE Coex Function in WiFi side */ - halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); - - /* set Path control owner to BT */ - halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8822B_1ANT_PCO_BTSIDE); - - /* Set Ext Ant Switch to BT control at wifi off step */ - halbtc8822b1ant_set_ext_ant_switch(btcoexist, - FORCE_EXEC, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); - - coex_sta->run_time_state = false; - - break; - case BT_8822B_1ANT_PHASE_2G_RUNTIME: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_2G_RUNTIME) **********\n" ); - BTC_TRACE(trace_buf); - - /* set GNT_BT to PTA */ - halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_PTA, - BT_8822B_1ANT_SIG_STA_SET_BY_HW); - - /* Set GNT_WL to PTA */ - halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_PTA, - BT_8822B_1ANT_SIG_STA_SET_BY_HW); - - /* set Path control owner to WL at runtime step */ - halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8822B_1ANT_PCO_WLSIDE); - - coex_sta->run_time_state = true; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_PTA; - - break; - case BT_8822B_1ANT_PHASE_5G_RUNTIME: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_5G_RUNTIME) **********\n" ); - BTC_TRACE(trace_buf); - - /* set GNT_BT to SW Hi */ - halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); - - /* Set GNT_WL to SW Hi */ - halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); - - /* set Path control owner to WL at runtime step */ - halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8822B_1ANT_PCO_WLSIDE); - - coex_sta->run_time_state = true; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_WIFI5G; - - break; - case BT_8822B_1ANT_PHASE_BTMPMODE : - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_BTMPMODE) **********\n" ); - BTC_TRACE(trace_buf); - - /* Disable LTE Coex Function in WiFi side */ - halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); - - /* set GNT_BT to SW Hi */ - halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); - - /* Set GNT_WL to SW Lo */ - halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_LOW); - - /* set Path control owner to WL */ - halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8822B_1ANT_PCO_WLSIDE); - - coex_sta->run_time_state = false; - - /* Set Ext Ant Switch to BT side at BT MP mode */ - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_BT; - - break; - } - - - if (phase != BT_8822B_1ANT_PHASE_WLAN_OFF) - { - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - halbtc8822b1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG); - break; - case BTC_ANT_PATH_WIFI5G: - halbtc8822b1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA); - break; - case BTC_ANT_PATH_BT: - halbtc8822b1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT); - break; - default: - case BTC_ANT_PATH_PTA: - halbtc8822b1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, - BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); - break; - } - - } -#if 1 - u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u32tmp3, u8tmp, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - -#endif - -} - - -void halbtc8822b1ant_coex_all_off(IN struct btc_coexist *btcoexist) -{ - /* sw all off */ - halbtc8822b1ant_sw_mechanism(btcoexist, false); - - /* hw all off */ - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} -boolean halbtc8822b1ant_is_common_action(IN struct btc_coexist *btcoexist) -{ - boolean common = false, wifi_connected = false, wifi_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (!wifi_connected && - BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT non connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8822b1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else { - if (wifi_busy) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); - BTC_TRACE(trace_buf); - } - - common = false; - } - - return common; -} - -void halbtc8822b1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], under 5g start \n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 10); - - halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8822B_1ANT_PHASE_5G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 5); - -} - - - -void halbtc8822b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - boolean wifi_under_5g = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if(wifi_under_5g) - { - halbtc8822b1ant_action_wifi_under5g(btcoexist); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wlan only -- under 5g ) **********\n"); - BTC_TRACE(trace_buf); - return; - } - - halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wlan only -- under 2g ) **********\n"); - BTC_TRACE(trace_buf); - -} - -/* ********************************************* - * - * Software Coex Mechanism start - * - * ********************************************* */ - -/* SCO only or SCO+PAN(HS) */ - -/* -void halbtc8822b1ant_action_sco(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8822b1ant_action_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8822b1ant_action_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8822b1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8822b1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8822b1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8822b1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8822b1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8822b1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, true); -} - -void halbtc8822b1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8822b1ant_sw_mechanism(btcoexist, true); -} - -*/ - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ -void halbtc8822b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex],action_bt_whck_test\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8822b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex],action_wifi_multi_port\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -} - -void halbtc8822b1ant_action_hs(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], action_hs\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); -} - -/*"""bt inquiry"""" + wifi any + bt any*/ -void halbtc8822b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, ap_enable = false, wifi_busy = false, - bt_busy = false; - - - boolean wifi_scan = false, link = false, roam = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (bt inquiry) **********\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** scan = %d, link =%d, roam = %d**********\n", - wifi_scan, link, roam); - BTC_TRACE(trace_buf); - - if ( (link) || (roam) || (coex_sta->wifi_is_high_pri_task)){ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (bt inquiry wifi connect or scan ) **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if ((!wifi_connected) && (!wifi_scan)) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (bt inquiry wifi non connect) **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist) { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (wifi_scan) { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (wifi_busy) { - - /* for BT inquiry/page fail after S4 resume */ - /* halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); */ - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - }else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (bt inquiry wifi connect) **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - } - -/* - if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if ((!wifi_connected) && (!wifi_scan)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - } else if (bt_link_info->a2dp_exist) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (wifi_scan) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - } else if (wifi_busy) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } -*/ -} - -void halbtc8822b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (bt sco hid only busy) **********\n"); - BTC_TRACE(trace_buf); - - /*SCO + wifi conected idle or busy / 0x778=1@wifi slot*/ - if (bt_link_info->sco_exist) { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - - } else { /* HID + wifi conected idle or busy / 0x778=1@wifi slot */ - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - - } -} - -/*wifi connected + bt acl busy*/ -void halbtc8822b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - - u8 bt_rssi_state; - - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - bt_rssi_state = halbtc8822b1ant_bt_rssi_state(2, 28, 0); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wifi connect acl busy) **********\n"); - BTC_TRACE(trace_buf); - - if (bt_link_info->hid_only) { /* HID + wifi conected idle or busy / 0x778=1@wifi slot */ - halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, - wifi_status); - return; - } else if (bt_link_info->a2dp_only) { /* A2DP + wifi conected idle or busy */ - if (BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } else { - if (coex_sta->scan_ap_num >= - BT_8822B_1ANT_WIFI_NOISY_THRESH) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 17); - } else { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 42); - } - - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = true; - } - - /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ - } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || - (bt_link_info->hid_exist && bt_link_info->a2dp_exist && - bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 44); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - } else if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { /* HID+A2DP */ - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - - } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && - bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP)*/ - /* - if (BT_8723D_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); - else - */ - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - } else { - /* BT no-profile busy (0x9) */ - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - } -} - -/*wifi not connected + bt action*/ -void halbtc8822b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wifi not connect) **********\n"); - BTC_TRACE(trace_buf); - - /* tdma and coex table */ - halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -/*""""wl not connected scan"""" + bt action*/ -void halbtc8822b1ant_action_wifi_not_connected_scan(IN struct btc_coexist - *btcoexist) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wifi non connect scan) **********\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8822b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8822b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8822b1ant_action_hs(btcoexist); - return; - } - - /* tdma and coex table */ - if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } else { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } - } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 5); - } -} - -/*""""wl not connected asso"""" + bt action*/ -void halbtc8822b1ant_action_wifi_not_connected_asso_auth( - IN struct btc_coexist *btcoexist) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wifi non connect asso_auth) **********\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8822b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8822b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8822b1ant_action_hs(btcoexist); - return; - } - - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || - (bt_link_info->a2dp_exist)) { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); - } -} - -/*""""wl connected scan"""" + bt action*/ -void halbtc8822b1ant_action_wifi_connected_scan(IN struct btc_coexist - *btcoexist) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wifi connect scan) **********\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8822b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8822b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8822b1ant_action_hs(btcoexist); - return; - } - - /* tdma and coex table */ - if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } else { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } - } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 5); - } -} - -/*""""wl connected specific packet"""" + bt action*/ -void halbtc8822b1ant_action_wifi_connected_specific_packet( - IN struct btc_coexist *btcoexist) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - boolean wifi_busy = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wifi connect specific packet) **********\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8822b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8822b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8822b1ant_action_hs(btcoexist); - return; - } - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* no specific packet process for both WiFi and BT very busy */ - if ((wifi_busy) && ((bt_link_info->pan_exist) || - (coex_sta->num_of_profile >= 2))) - return; - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else if (bt_link_info->a2dp_exist) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - } else if (bt_link_info->pan_exist) { - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - } else { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 5); - } -} - -/*wifi connected input point : to set different ps and tdma case (+bt different case)*/ -void halbtc8822b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -{ - - boolean wifi_busy = false; - boolean scan = false, link = false, roam = false; - boolean under_4way = false, ap_enable = false, wifi_under_5g=false; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect()===>\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - - if (wifi_under_5g) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under 5g<===\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_action_wifi_under5g(btcoexist); - - return; - } else { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under 2g<===\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - } - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - if (under_4way) { - halbtc8822b1ant_action_wifi_connected_specific_packet(btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - if (scan || link || roam) { - if (scan) - halbtc8822b1ant_action_wifi_connected_scan(btcoexist); - else - halbtc8822b1ant_action_wifi_connected_specific_packet( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* tdma and coex table */ - if (!wifi_busy) { - if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8822b1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) - /*sy modify case16 -> case17*/ - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - else - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); - } - } else { - if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8822b1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8822B_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else { - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - NORMAL_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) - /*sy modify case16 -> case17*/ - - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - else - halbtc8822b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); - } - } -} - -void halbtc8822b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - - u8 algorithm = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (runswcoexmech) **********\n"); - BTC_TRACE(trace_buf); - algorithm = halbtc8822b1ant_action_algorithm(btcoexist); - coex_dm->cur_algorithm = algorithm; - - if (halbtc8822b1ant_is_common_action(btcoexist)) { - - } else { - switch (coex_dm->cur_algorithm) { - case BT_8822B_1ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_sco(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_hid(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_a2dp(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_a2dp_pan_hs(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_pan_edr(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_pan_hs(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_pan_edr_a2dp(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_pan_edr_hid(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_hid_a2dp_pan_edr(btcoexist); */ - break; - case BT_8822B_1ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_action_hid_a2dp(btcoexist); */ - break; - default: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = coexist All Off!!\n"); - BTC_TRACE(trace_buf); - /* halbtc8822b1ant_coex_all_off(btcoexist); */ - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -void halbtc8822b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - boolean increase_scan_dev_num = false; - boolean bt_ctrl_agg_buf_size = false; - boolean miracast_plus_bt = false; - u8 agg_buf_size = 5; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0, wifi_bw; - u8 iot_peer = BTC_IOT_PEER_UNKNOWN; - boolean wifi_under_5g = false; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism()===>\n"); - BTC_TRACE(trace_buf); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (coex_sta->under_ips) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is under IPS !!!\n"); - BTC_TRACE(trace_buf); - return; - } - - if (!coex_sta->run_time_state){ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], return for run_time_state = false !!!\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if(wifi_under_5g) - { - halbtc8822b1ant_action_wifi_under5g(btcoexist); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 5G!!! \n"); - BTC_TRACE(trace_buf); - return; - }else{ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 2G!!!\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8822B_1ANT_PHASE_2G_RUNTIME); - } - - if (coex_sta->bt_whck_test) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under WHCK TEST!!!\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_bt_whck_test(btcoexist); - return; - } - - if (coex_sta->bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!!\n"); - halbtc8822b1ant_action_wifi_only(btcoexist); - return; - } - - if ((BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - increase_scan_dev_num = true; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, - &increase_scan_dev_num); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status >> 16; - - if ((num_of_wifi_link >= 2) || - (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", - num_of_wifi_link, wifi_link_status); - BTC_TRACE(trace_buf); - - if (bt_link_info->bt_link_exist) { - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, - 0, 1); - miracast_plus_bt = true; - } else { - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - miracast_plus_bt = false; - } - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if ((bt_link_info->a2dp_exist) && - (coex_sta->c2h_bt_inquiry_page)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8822b1ant_action_wifi_multi_port(btcoexist); - - return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if ((bt_link_info->bt_link_exist) && (wifi_connected)) { - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); - - if (BTC_IOT_PEER_CISCO != iot_peer) { - if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ - halbtc8822b1ant_limited_rx(btcoexist, - NORMAL_EXEC, true, false, 0x5); - else - halbtc8822b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, false, 0x5); - } else { - if (bt_link_info->sco_exist) - halbtc8822b1ant_limited_rx(btcoexist, - NORMAL_EXEC, true, false, 0x5); - else { - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8822b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x10); - else - halbtc8822b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x8); - } - } - - halbtc8822b1ant_sw_mechanism(btcoexist, true); - halbtc8822b1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - } else { - halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); - - halbtc8822b1ant_sw_mechanism(btcoexist, false); - halbtc8822b1ant_run_sw_coexist_mechanism( - btcoexist); /* //just print debug message */ - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8822b1ant_action_hs(btcoexist); - return; - } - - - if (!wifi_connected) { - boolean scan = false, link = false, roam = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is non connected-idle !!!\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || link || roam) { - if (scan) - halbtc8822b1ant_action_wifi_not_connected_scan( - btcoexist); - else - halbtc8822b1ant_action_wifi_not_connected_asso_auth( - btcoexist); - } else - halbtc8822b1ant_action_wifi_not_connected(btcoexist); - } else /* wifi LPS/Busy */ - halbtc8822b1ant_action_wifi_connected(btcoexist); -} - -u32 halbtc8822b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -{ - u8 j; - u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; - u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, - 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, - 32, 23, 15, 7, 0 - }; - - if (val == 0) - return 0; - - tmp = val; - - while (1) { - if (tmp == 1) - break; - else { - tmp = (tmp >> 1); - shiftcount++; - } - } - - - val_integerd_b = shiftcount + 1; - - tmp2 = 1; - for (j = 1; j <= val_integerd_b; j++) - tmp2 = tmp2 * 2; - - tmp = (val * 100) / tmp2; - tindex = tmp / 5; - - if (tindex > 20) - tindex = 20; - - val_fractiond_b = table_fraction[tindex]; - - result = val_integerd_b * 100 - val_fractiond_b; - - return result; - - -} - -void halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - - /* sw all off */ - halbtc8822b1ant_sw_mechanism(btcoexist, false); - - /* halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ - /* halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ - - coex_sta->pop_event_cnt = 0; -} - -void halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up, IN boolean wifi_only) -{ - - u8 u8tmp = 0; - boolean wifi_under_5g = false; - u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - - - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u32tmp3, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 1Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - coex_sta->bt_coex_supported_feature = 0; - coex_sta->bt_coex_supported_version = 0; - - /* Setup RF front end type */ - halbtc8822b1ant_set_rfe_type(btcoexist); - - /* 0xf0[15:12] --> Chip Cut information */ - coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, - 0xf1) & 0xf0) >> 4; - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, - 0x1); /* enable TBTT nterrupt */ - - /* BT report packet sample rate */ - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - /* Enable BT counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); - - /* Enable PTA (3-wire function form BT side) */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); - - /* Enable PTA (tx/rx signal form WiFi side) */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); - - /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1);*/ - - /* enable GNT_WL */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); - - if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) - halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, TRUE); - - /* Antenna config */ - if (wifi_only) { - - coex_sta->concurrent_rx_mode_on = false; - halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, BT_8822B_1ANT_PHASE_WLANONLY_INIT); - } else { - - coex_sta->concurrent_rx_mode_on = true; - - halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, BT_8822B_1ANT_PHASE_COEX_INIT); - } - - - /* PTA parameter */ - halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); - -} - - - -void halbtc8822b1ant_psd_showdata(IN struct btc_coexist *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - u32 delta_freq_per_point; - u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n\n============[PSD info] (%d)============\n", - psd_scan->psd_gen_count); - CL_PRINTF(cli_buf); - - if (psd_scan->psd_gen_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); - CL_PRINTF(cli_buf); - return; - } - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* if (psd_scan->is_psd_show_max_only) */ - if (0) { - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; - - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + - psd_scan->psd_max_value_point * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.0%d MHz", - freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.%d MHz", - freq1, freq2); - - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - - CL_PRINTF(cli_buf); - } else { - m = psd_scan->psd_start_point; - n = psd_scan->psd_start_point; - i = 1; - j = 1; - - while (1) { - do { - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * - delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (i == 1) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.0%2d", freq1, - freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.%3d", freq1, - freq2); - } else if ((i % 8 == 0) || - (m == psd_scan->psd_stop_point)) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000\n", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d\n", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d\n", freq1, freq2); - } else { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d", freq1, freq2); - } - - i++; - m++; - CL_PRINTF(cli_buf); - - } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); - - - do { - psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; - psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * - 100; - - if (j == 1) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.0%d", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.%d", psd_rep1, - psd_rep2); - } else if ((j % 8 == 0) || - (n == psd_scan->psd_stop_point)) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d\n", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d\n", psd_rep1, psd_rep2); - } else { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d", psd_rep1, psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d", psd_rep1, psd_rep2); - } - - j++; - n++; - CL_PRINTF(cli_buf); - - } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); - - if ((m > psd_scan->psd_stop_point) || - (n > psd_scan->psd_stop_point)) - break; - else { - i = 1; - j = 1; - } - - } - } - - -} - -void halbtc8822b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0, i_max = 0, val_max = 0; - - if (gen_count == 1) { - memcpy(psd_scan->psd_report_max_hold, - psd_scan->psd_report, - BT_8822B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); - - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - - } - - psd_scan->psd_max_value_point = 0; - psd_scan->psd_max_value = 0; - - } else { - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - if (psd_scan->psd_report[i] > - psd_scan->psd_report_max_hold[i]) - psd_scan->psd_report_max_hold[i] = - psd_scan->psd_report[i]; - - /* search Max Value */ - if (i == psd_scan->psd_start_point) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } else { - if (psd_scan->psd_report_max_hold[i] > - val_max) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } - } - - - - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - - } - - -} - -u32 halbtc8822b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -{ - /* reg 0x808[9:0]: FFT data x */ - /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ - /* reg 0x8b4[15:0]: FFT data y report */ - - u32 val = 0, psd_report = 0; - - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - - val &= 0xffbffc00; - val |= point; - - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - val |= 0x00400000; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - - -void halbtc8822b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, - IN u32 avgnum) -{ - u32 i, val, n, k = 0; - u32 points1 = 0, psd_report = 0; - u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; - u32 psd_center_freq = 20 * 10 ^ 6, freq, freq1, freq2; - boolean outloop = false; - u8 flag = 0; - u32 tmp, psd_rep1, psd_rep2; - u32 wifi_original_channel = 1; - - psd_scan->is_psd_running = true; - - do { - switch (flag) { - case 0: /* Get PSD parameters */ - default: - - psd_scan->psd_band_width = 40 * 1000000; - psd_scan->psd_point = points; - psd_scan->psd_start_base = points / 2; - psd_scan->psd_avg_num = avgnum; - psd_scan->real_cent_freq = cent_freq; - psd_scan->real_offset = offset; - psd_scan->real_span = span; - - - points1 = psd_scan->psd_point; - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* PSD point setup */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffff0fff; - - switch (psd_scan->psd_point) { - case 128: - val |= 0x0; - break; - case 256: - default: - val |= 0x00004000; - break; - case 512: - val |= 0x00008000; - break; - case 1024: - val |= 0x0000c000; - break; - } - - switch (psd_scan->psd_avg_num) { - case 1: - val |= 0x0; - break; - case 8: - val |= 0x00001000; - break; - case 16: - val |= 0x00002000; - break; - case 32: - default: - val |= 0x00003000; - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - flag = 1; - break; - case 1: /* calculate the PSD point index from freq/offset/span */ - psd_center_freq = psd_scan->psd_band_width / 2 + - offset * (1000000); - - start_p = psd_scan->psd_start_base + (psd_center_freq - - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_start_point = start_p - - psd_scan->psd_start_base; - - stop_p = psd_scan->psd_start_base + (psd_center_freq + - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_stop_point = stop_p - - psd_scan->psd_start_base - 1; - - flag = 2; - break; - case 2: /* set RF channel/BW/Mode */ - - /* set 3-wire off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val |= 0x00300000; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val &= 0xfeffffff; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* store WiFi original channel */ - wifi_original_channel = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x18, 0x3ff); - - /* Set RF channel */ - if (cent_freq == 2484) - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, 0xe); - else - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, (cent_freq - 2412) / 5 + - 1); /* WiFi TRx Mask on */ - - /* Set RF mode = Rx, RF Gain = 0x8a0 */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, - 0xfffff, 0x308a0); - - /* Set RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, - 0xfffff, 0x3e4); - - /* Set TRx mask off */ - /* un-lock TRx Mask setup */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, - 0x80, 0x1); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, - 0x1, 0x1); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x0); - - flag = 3; - break; - case 3: - memset(psd_scan->psd_report, 0, - psd_scan->psd_point * sizeof(u32)); - start_p = psd_scan->psd_start_point + - psd_scan->psd_start_base; - stop_p = psd_scan->psd_stop_point + - psd_scan->psd_start_base + 1; - - i = start_p; - - while (i < stop_p) { - if (i >= points1) - psd_report = - halbtc8822b1ant_psd_getdata( - btcoexist, i - points1); - else - psd_report = - halbtc8822b1ant_psd_getdata( - btcoexist, i); - - if (psd_report == 0) - tmp = 0; - else - /* tmp = 20*log10((double)psd_report); */ - /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ - tmp = 6 * halbtc8822b1ant_psd_log2base( - btcoexist, psd_report); - - n = i - psd_scan->psd_start_base; - psd_scan->psd_report[n] = tmp; - psd_rep1 = psd_scan->psd_report[n] / 100; - psd_rep2 = psd_scan->psd_report[n] - psd_rep1 * - 100; - - freq = ((cent_freq - 20) * 1000000 + n * - delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - i++; - - k = 0; - - /* Add Delay between PSD point */ - while (1) { - if (k++ > 20000) - break; - } - - } - - flag = 100; - break; - case 99: /* error */ - - outloop = true; - break; - case 100: /* recovery */ - - /* set 3-wire on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val &= 0xffcfffff; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val |= 0x01000000; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* PSD off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffbfffff; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - /* TRx Mask on */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x780); - - /* lock TRx Mask setup */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, - 0x80, 0x0); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, - 0x1, 0x0); - - /* Set RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, - 0xfffff, 0x0); - - /* restore WiFi original channel */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, - 0x3ff, wifi_original_channel); - - outloop = true; - break; - - } - - } while (!outloop); - - - - psd_scan->is_psd_running = false; - - -} - -#if (BTC_COEX_OFFLOAD == 1) -void halbtc8822b1ant_wifi_info_notify(IN struct btc_coexist *btcoexist) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 ap_num = 0; - s32 wifi_rssi = 0; - boolean wifi_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - h2c_para[0] = ap_num; /* AP number */ - h2c_para[1] = (u8)wifi_busy; /* Busy */ - h2c_para[2] = (u8)wifi_rssi; /* RSSI */ - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_INFO_NOTIFY, - opcode_ver, &h2c_para[0], 3); -} - -void halbtc8822b1ant_setManual(IN struct btc_coexist *btcoexist, - IN boolean manual) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 set_type = 0; - - if (manual) - set_type = 1; - else - set_type = 0; - - h2c_para[0] = set_type; /* set_type */ - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_SET_CONTROL, opcode_ver, - &h2c_para[0], 1); -} - -/* ************************************************************ - * work around function start with wa_halbtc8822b1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8822b1ant_ - * ************************************************************ */ - -void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) -{} -void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -{} -void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{} -void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{} -void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 ips_notify = 0; - - if (BTC_IPS_ENTER == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS ENTER notify\n"); - BTC_TRACE(trace_buf); - ips_notify = 1; - } else if (BTC_IPS_LEAVE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - } - - h2c_para[0] = ips_notify; /* IPS notify */ - h2c_para[1] = 0xff; /* LPS notify */ - h2c_para[2] = 0xff; /* RF state notify */ - h2c_para[3] = 0xff; /* pnp notify */ - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} -void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 lps_notify = 0; - - if (BTC_LPS_ENABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS ENABLE notify\n"); - BTC_TRACE(trace_buf); - lps_notify = 1; - } else if (BTC_LPS_DISABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS DISABLE notify\n"); - BTC_TRACE(trace_buf); - } - - h2c_para[0] = 0xff; /* IPS notify */ - h2c_para[1] = lps_notify; /* LPS notify */ - h2c_para[2] = 0xff; /* RF state notify */ - h2c_para[3] = 0xff; /* pnp notify */ - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} - -void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 scan_start = 0; - boolean under_4way = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - if (BTC_SCAN_START == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN START notify\n"); - BTC_TRACE(trace_buf); - scan_start = 1; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify\n"); - BTC_TRACE(trace_buf); - } - - h2c_para[0] = scan_start; /* scan notify */ - h2c_para[1] = 0xff; /* connect notify */ - h2c_para[2] = 0xff; /* specific packet notify */ - if (under_4way) - h2c_para[3] = 1; /* under 4way progress */ - else - h2c_para[3] = 0; - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} - -void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 connect_start = 0; - boolean under_4way = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - if (BTC_ASSOCIATE_START == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT START notify\n"); - BTC_TRACE(trace_buf); - connect_start = 1; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT FINISH notify\n"); - BTC_TRACE(trace_buf); - } - - h2c_para[0] = 0xff; /* scan notify */ - h2c_para[1] = connect_start; /* connect notify */ - h2c_para[2] = 0xff; /* specific packet notify */ - if (under_4way) - h2c_para[3] = 1; /* under 4way progress */ - else - h2c_para[3] = 0; - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} - -void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u32 wifi_bw; - u8 wifi_central_chnl; - u8 h2c_para[5] = {0}; - u8 opcode_ver = 0; - u8 port = 0, connected = 0, freq = 0, bandwidth = 0, iot_peer = 0; - boolean wifi_under_5g = false; - - if (BTC_MEDIA_CONNECT == type) - connected = 1; - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - bandwidth = (u8)wifi_bw; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if (wifi_under_5g) - freq = 1; - else - freq = 0; - btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, - &wifi_central_chnl); - btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); - - h2c_para[0] = (connected << 4) | - port; /* port need to be implemented in the future (p2p port, ...) */ - h2c_para[1] = (freq << 4) | bandwidth; - h2c_para[2] = wifi_central_chnl; - h2c_para[3] = iot_peer; - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_STATUS_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} - -void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 connect_start = 0; - boolean under_4way = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - h2c_para[0] = 0xff; /* scan notify */ - h2c_para[1] = 0xff; /* connect notify */ - h2c_para[2] = type; /* specific packet notify */ - if (under_4way) - h2c_para[3] = 1; /* under 4way progress */ - else - h2c_para[3] = 0; - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} - -void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length) -{} -void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 rfstate_notify = 0; - - if (BTC_RF_ON == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned ON!!\n"); - BTC_TRACE(trace_buf); - rfstate_notify = 1; - } else if (BTC_RF_OFF == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned OFF!!\n"); - BTC_TRACE(trace_buf); - } - - h2c_para[0] = 0xff; /* IPS notify */ - h2c_para[1] = 0xff; /* LPS notify */ - h2c_para[2] = rfstate_notify; /* RF state notify */ - h2c_para[3] = 0xff; /* pnp notify */ - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} - -void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) -{} -void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state) -{ - u8 h2c_para[4] = {0}; - u8 opcode_ver = 0; - u8 pnp_notify = 0; - - if (BTC_WIFI_PNP_SLEEP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to SLEEP\n"); - BTC_TRACE(trace_buf); - pnp_notify = 1; - } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to WAKE UP\n"); - BTC_TRACE(trace_buf); - } - - h2c_para[0] = 0xff; /* IPS notify */ - h2c_para[1] = 0xff; /* LPS notify */ - h2c_para[2] = 0xff; /* RF state notify */ - h2c_para[3] = pnp_notify; /* pnp notify */ - - btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_POWER_STATE_NOTIFY, - opcode_ver, &h2c_para[0], 4); -} - -void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -{} -void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) -{ - - halbtc8822b1ant_wifi_info_notify(btcoexist); -} - -void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - u8 *cli_buf = btcoexist->cli_buf; - u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; - u16 u16tmp[4]; - u32 u32tmp[4]; - u32 fa_of_dm, fa_cck; - u32 fw_ver = 0, bt_patch_ver = 0; - static u8 pop_report_in_10s = 0; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cli_buf); - - if (btcoexist->manual_control) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Under Manual Control]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - if (btcoexist->stop_coex_dm) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Coex is STOPPED]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - - if (psd_scan->ant_det_try_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", - "Ant PG Num/ Mech/ Pos", - board_info->pg_ant_num, board_info->btdm_ant_num, - board_info->btdm_ant_pos); - CL_PRINTF(cli_buf); - } else { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", - "Ant PG Num/ Mech(Ant_Det)/ Pos", - board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, - board_info->btdm_ant_pos, - psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, - psd_scan->ant_det_result); - CL_PRINTF(cli_buf); - - if (board_info->btdm_ant_det_finish) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "Ant Det PSD Value", - psd_scan->ant_det_peak_val); - CL_PRINTF(cli_buf); - } - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, fw_ver, - bt_patch_ver, bt_patch_ver); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", - "Wifi channel informed to BT", - coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], - coex_dm->wifi_chnl_info[2]); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", - "WifibHiPri/ Ccklock/ CckEverLock", - (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), - (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No")); - CL_PRINTF(cli_buf); - - /* wifi status */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Wifi Status]============"); - CL_PRINTF(cli_buf); - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[BT Status]============"); - CL_PRINTF(cli_buf); - - pop_report_in_10s++; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", - "BT [status/ rssi/ retryCnt/ popCnt]", - ((coex_sta->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi, coex_sta->bt_retry_cnt, - coex_sta->pop_event_cnt); - CL_PRINTF(cli_buf); - - if (pop_report_in_10s >= 5) { - coex_sta->pop_event_cnt = 0; - pop_report_in_10s = 0; - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d / %d", - "SCO/HID/PAN/A2DP/Hi-Pri", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist, - bt_link_info->bt_hi_pri_link_exist); - CL_PRINTF(cli_buf); - - { - bt_info_ext = coex_sta->bt_info_ext; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", - "BT Role/A2DP rate", - (bt_link_info->slave_role) ? "Slave" : "Master", - (bt_info_ext & BIT(0)) ? "BR" : "EDR"); - CL_PRINTF(cli_buf); - } - - /*bt info*/ - for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { - if (coex_sta->bt_info_c2h_cnt[i]) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", - glbt_info_src_8822b_1ant[i], - coex_sta->bt_info_c2h[i][0], - coex_sta->bt_info_c2h[i][1], - coex_sta->bt_info_c2h[i][2], - coex_sta->bt_info_c2h[i][3], - coex_sta->bt_info_c2h[i][4], - coex_sta->bt_info_c2h[i][5], - coex_sta->bt_info_c2h[i][6], - coex_sta->bt_info_c2h_cnt[i]); - CL_PRINTF(cli_buf); - } - } - - - if (btcoexist->manual_control) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms] (before Manual)============"); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "SM[LowPenaltyRA]", - coex_dm->cur_low_penalty_ra); - CL_PRINTF(cli_buf); - - ps_tdma_case = coex_dm->cur_ps_tdma; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", - "PS TDMA", - coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], - coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], - coex_dm->ps_tdma_para[4], ps_tdma_case, - (coex_dm->cur_ps_tdma_on ? "On" : "Off"), - (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "WL/BT Coex Table Type", - coex_sta->coex_table_type); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x6c0/0x6c4/0x6c8(coexTable)", - u32tmp[0], u32tmp[1], u32tmp[2]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x778/0x6cc/IgnWlanAct", - u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa0); - u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "LTE Coex Table W_L/B_L", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa8); - u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xac); - u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb0); - u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "LTE Break Table W_L/B_L/L_W/L_B", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, - u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); - CL_PRINTF(cli_buf); - - /* Hw setting */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Hw setting]============"); - CL_PRINTF(cli_buf); - - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", - "0x430/0x434/0x42a/0x456", - u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", - "LTE CoexOn/Path Ctrl Owner", - (int)((u32tmp[0]&BIT(7)) >> 7), ((u8tmp[0]&BIT(2)) ? "WL" : "BT")); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "LTE 3Wire/OPMode/UART/UARTMode", - (int)((u32tmp[0]&BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), - (int)((u32tmp[0]&BIT(3)) >> 3), - (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", - "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", - (int)((u32tmp[0]&BIT(12)) >> 12), (int)((u32tmp[0]&BIT(14)) >> 14), - ((u8tmp[0]&BIT(3)) ? "On" : "Off")); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", - (int)((u32tmp[0]&BIT(2)) >> 2), (int)((u32tmp[0]&BIT(3)) >> 3), - (int)((u32tmp[0]&BIT(1)) >> 1), (int)(u32tmp[0]&BIT(0))); - CL_PRINTF(cli_buf); - - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x4c6[4]/0x40[5] (WL/BT PTA)", - (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", - "0x550(bcn ctrl)/0x522/4-RxAGC", - u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); - u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - - fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) - >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ - ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & - 0xffff) ; - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; - - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", - u32tmp[1] & 0xff, u32tmp[0] & 0xffff, fa_of_dm, fa_cck); - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11n-Agg", - coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_Err CCK/11g/11n/11n-Agg", - coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770(high-pri rx/tx)", - coex_sta->high_priority_rx, coex_sta->high_priority_tx); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri rx/tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); -#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 1) - /* halbtc8822b1ant_monitor_bt_ctr(btcoexist); */ -#endif - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} -void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{} -void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{} -void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, - IN u8 op_code, IN u8 op_len, IN u8 *pdata) -{ - switch (op_code) { - case BTC_DBG_SET_COEX_MANUAL_CTRL: { - boolean manual = (boolean)*pdata; - - halbtc8822b1ant_setManual(btcoexist, manual); - } - break; - default: - break; - } -} - -#else -void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u8 u8tmp = 0x0; - u16 u16tmp = 0x0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Execute 8822b 1-Ant PowerOn Setting!! xxxxxxxxxxxxxxxx\n"); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Ant Det Finish = %s, Ant Det Number = %d\n", - board_info->btdm_ant_det_finish ? "Yes" : "No", - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - - btcoexist->stop_coex_dm = true; - - /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ - u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); - btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); - - /* set Path control owner to WiFi */ - halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8822B_1ANT_PCO_WLSIDE); - - /* set GNT_BT to high */ - halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to low */ - halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8822B_1ANT_GNT_BLOCK_RFC_BB, - BT_8822B_1ANT_GNT_CTRL_BY_SW, - BT_8822B_1ANT_SIG_STA_SET_TO_LOW); - - /* set WLAN_ACT = 0 */ - //btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - /* SD1 Chunchu red x issue */ - btcoexist->btc_write_1byte(btcoexist, 0xff1a, 0x0); - - halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); - - /* */ - /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ - /* Local setting bit define */ - /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ - /* BIT1: "0" for internal switch; "1" for external switch */ - /* BIT2: "0" for one antenna; "1" for two antenna */ - /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ - - u8tmp = 0; - board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; - - if (btcoexist->chip_interface == BTC_INTF_USB) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); - else if (btcoexist->chip_interface == BTC_INTF_SDIO) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); - - BTC_TRACE(trace_buf); - - -} - -void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (ini hw config) **********\n"); - - halbtc8822b1ant_init_hw_config(btcoexist, true, wifi_only); - btcoexist->stop_coex_dm = false; -} - -void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Coex Mechanism Init!!\n"); - BTC_TRACE(trace_buf); - - btcoexist->stop_coex_dm = false; - - halbtc8822b1ant_init_coex_dm(btcoexist); - - halbtc8822b1ant_query_bt_info(btcoexist); -} - -void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) -{ - - struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - u8 *cli_buf = btcoexist->cli_buf; - u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; - u16 u16tmp[4]; - u32 u32tmp[4]; - u32 fa_of_dm, fa_cck; - u32 fw_ver = 0, bt_patch_ver = 0; - static u8 pop_report_in_10s = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (display coexinfo) **********\n"); - BTC_TRACE(trace_buf); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** displaycoexinfostart, 0xcb4/0xcbd = 0x%x/0x%x\n", - btcoexist->btc_read_1byte(btcoexist, 0xcb4), - btcoexist->btc_read_1byte(btcoexist, 0xcbd)); - BTC_TRACE(trace_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cli_buf); - - if (btcoexist->manual_control) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Under Manual Control]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - - if (btcoexist->stop_coex_dm) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Coex is STOPPED]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - - if (psd_scan->ant_det_try_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "Ant PG Num/ Mech/ Pos/ RFE", - board_info->pg_ant_num, board_info->btdm_ant_num, - board_info->btdm_ant_pos, - rfe_type->rfe_module_type); - CL_PRINTF(cli_buf); - } else { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d/ %d/ %d (%d/%d/%d)", - "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", - board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, - board_info->btdm_ant_pos, - rfe_type->rfe_module_type, - psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, - psd_scan->ant_det_result); - CL_PRINTF(cli_buf); - - if (board_info->btdm_ant_det_finish) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "Ant Det PSD Value", - psd_scan->ant_det_peak_val); - CL_PRINTF(cli_buf); - } - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", - "Version Coex/ Fw/ Patch/ Cut", - glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, fw_ver, - bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", - "Wifi channel informed to BT", - coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], - coex_dm->wifi_chnl_info[2]); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", - "WifibHiPri/ Ccklock/ CckEverLock", - (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), - (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No")); - CL_PRINTF(cli_buf); - - /* wifi status */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Wifi Status]============"); - CL_PRINTF(cli_buf); - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[BT Status]============"); - CL_PRINTF(cli_buf); - - pop_report_in_10s++; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", - "BT [status/ rssi/ retryCnt/ popCnt]", - ((coex_sta->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, - coex_sta->pop_event_cnt); - CL_PRINTF(cli_buf); - /*bt rssi */ - /*bt pop_even_cnt : bt retry*/ - - if (pop_report_in_10s >= 5) { - coex_sta->pop_event_cnt = 0; - pop_report_in_10s = 0; - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d / %d", - "SCO/HID/PAN/A2DP/Hi-Pri", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist, - bt_link_info->bt_hi_pri_link_exist); - CL_PRINTF(cli_buf); - - { - bt_info_ext = coex_sta->bt_info_ext; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", - "Role/A2DP Rate/Bitpool/Feature/Ver", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, - coex_sta->bt_coex_supported_feature, - coex_sta->bt_coex_supported_version); - CL_PRINTF(cli_buf); - } - - /*bt info*/ - for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { - if (coex_sta->bt_info_c2h_cnt[i]) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", - glbt_info_src_8822b_1ant[i], - coex_sta->bt_info_c2h[i][0], - coex_sta->bt_info_c2h[i][1], - coex_sta->bt_info_c2h[i][2], - coex_sta->bt_info_c2h[i][3], - coex_sta->bt_info_c2h[i][4], - coex_sta->bt_info_c2h[i][5], - coex_sta->bt_info_c2h[i][6], - coex_sta->bt_info_c2h_cnt[i]); - CL_PRINTF(cli_buf); - } - } - - - if (btcoexist->manual_control) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms] (before Manual)============"); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "SM[LowPenaltyRA]", - coex_dm->cur_low_penalty_ra); - CL_PRINTF(cli_buf); - - /*(ps)tdma*/ - ps_tdma_case = coex_dm->cur_ps_tdma; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", - "PS TDMA", - coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], - coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], - coex_dm->ps_tdma_para[4], ps_tdma_case, - (coex_dm->cur_ps_tdma_on ? "On" : "Off"), - (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); - - CL_PRINTF(cli_buf); - - /*coex table type*/ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "WL/BT Coex Table Type", - coex_sta->coex_table_type); - CL_PRINTF(cli_buf); - - /*coex table :0x6c0 0x6c4 , break table: 0x6c8*/ - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x6c0/0x6c4/0x6c8(coexTable)", - u32tmp[0], u32tmp[1], u32tmp[2]); - CL_PRINTF(cli_buf); - - /*PTA : 0x778=1/3/d , WL BA,RTS,CTS :0x6cc H/L pri */ - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x778/0x6cc/IgnWlanAct", - u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); - CL_PRINTF(cli_buf); - - - /*LTE : WL/LTE coex table : 0xa0 */ - - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa0); - - /*LTE : BT/LTE coex table : 0xa4 */ - u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "LTE Coex Table W_L/B_L", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); - CL_PRINTF(cli_buf); - - /*LTE : WL/LTE break table : 0xa8 */ - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa8); - /*LTE : WL/LTE break table : 0xac */ - u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xac); - /*LTE : LTE/WL break table : 0xb0 */ - u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb0); - /*LTE : LTE/BT break table : 0xb4 */ - u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "LTE Break Table W_L/B_L/L_W/L_B", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, - u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); - CL_PRINTF(cli_buf); - - /* Hw setting */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Hw setting]============"); - CL_PRINTF(cli_buf); - - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", - "0x430/0x434/0x42a/0x456", - u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - /*ANT setting*/ - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xcb4); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xcbd); - u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0x1991); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0xcb4/0xcbd/0x1991", - u8tmp[1], u8tmp[2], u8tmp[3]); - CL_PRINTF(cli_buf); - - /*LTE on/off , Path ctrl owner*/ - /*sy add*/ - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x64); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x73/ 0x4c/ 0x64[0]", u8tmp[0], (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23, u8tmp[1]&0x1); - CL_PRINTF(cli_buf); - - - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", - "LTE CoexOn/Path Ctrl Owner", - (int)((u32tmp[0]&BIT(7)) >> 7), ((u8tmp[0]&BIT(2)) ? "WL" : "BT")); - CL_PRINTF(cli_buf); - - /*LTE mode*/ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "LTE 3Wire/OPMode/UART/UARTMode", - (int)((u32tmp[0]&BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), - (int)((u32tmp[0]&BIT(3)) >> 3), - (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", - "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", - (int)((u32tmp[0]&BIT(12)) >> 12), (int)((u32tmp[0]&BIT(14)) >> 14), - ((u8tmp[0]&BIT(3)) ? "On" : "Off")); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", - (int)((u32tmp[0]&BIT(2)) >> 2), (int)((u32tmp[0]&BIT(3)) >> 3), - (int)((u32tmp[0]&BIT(1)) >> 1), (int)(u32tmp[0]&BIT(0))); - CL_PRINTF(cli_buf); - - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x4c6[4]/0x40[5] (WL/BT PTA)", - (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x974); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x550(bcn ctrl)/0x522/0x974/0xc50", - u32tmp[0], u8tmp[0], u8tmp[1], u8tmp[2]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); - - fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); - - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", - u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11ac", - coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_Err CCK/11g/11n/11ac", - coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); - CL_PRINTF(cli_buf); - - /*0x770:bt high pri trx*/ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770(high-pri rx/tx)", - coex_sta->high_priority_rx, coex_sta->high_priority_tx); - CL_PRINTF(cli_buf); - /*0x774:bt low pri trx*/ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri rx/tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); - - halbtc8822b1ant_read_score_board(btcoexist, &u16tmp[0]); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", - "ScoreBoard[14:0] (from BT)", u16tmp[0]); - - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** displaycoexinfo end, 0xcb4/0xcbd = 0x%x/0x%x\n", - btcoexist->btc_read_1byte(btcoexist, 0xcb4), - btcoexist->btc_read_1byte(btcoexist, 0xcbd)); - BTC_TRACE(trace_buf); -} - - -void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - - if (btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - - - if (BTC_IPS_ENTER == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS ENTER notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8822B_1ANT_PHASE_WLAN_OFF); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } else if (BTC_IPS_LEAVE == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - - /*leave IPS : run ini hw config (exclude wifi only)*/ - halbtc8822b1ant_init_hw_config(btcoexist, false, false); - /*sw all off*/ - halbtc8822b1ant_init_coex_dm(btcoexist); - /*leave IPS : Query bt info*/ - halbtc8822b1ant_query_bt_info(btcoexist); - - coex_sta->under_ips = false; - } -} - -void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - if (btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - - if (BTC_LPS_ENABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS ENABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = true; - - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ - /* Write WL "Active" in Score-board for PS-TDMA */ - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - - } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ - /* Write WL "Non-Active" in Score-board for Native-PS */ - halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); - - } - } else if (BTC_LPS_DISABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS DISABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = false; - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - } -} - - -void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN notify()\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) - return; - - if (BTC_SCAN_START == type) - return; - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - - if (BTC_SCAN_START_2G == type) { - coex_sta->wifi_is_high_pri_task = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2g SCAN START notify\n"); - BTC_TRACE(trace_buf); - - - if (!wifi_connected) /* non-connected scan */ - halbtc8822b1ant_action_wifi_not_connected_scan( - btcoexist); - else /* wifi is connected */ - halbtc8822b1ant_action_wifi_connected_scan(btcoexist); - - } else { - coex_sta->wifi_is_high_pri_task = false; - - /*WL scan finish , then get and update sacn ap numbers */ - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &coex_sta->scan_ap_num); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - - if (!wifi_connected) /* non-connected scan */ - halbtc8822b1ant_action_wifi_not_connected(btcoexist); - else - halbtc8822b1ant_action_wifi_connected(btcoexist); - } - - -} - -void ex_halbtc8822b1ant_switchband_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - - boolean wifi_connected = false; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (switchband_notify) **********\n"); - BTC_TRACE(trace_buf); - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - - if(type == BTC_SWITCH_TO_5G) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_5G) **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_action_wifi_under5g(btcoexist); - return; - } else if (type == BTC_SWITCH_TO_24G_NoForScan) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_2G (no for scan)) **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_run_coexist_mechanism(btcoexist); - - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_2G) **********\n"); - BTC_TRACE(trace_buf); - - ex_halbtc8822b1ant_scan_notify(btcoexist, - BTC_SCAN_START_2G); - } - -} - -void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (connect notify) **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) - return; - - - if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { - - if (BTC_ASSOCIATE_5G_START== type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (5G associate start notify) **********\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_action_wifi_under5g(btcoexist); - - } else if (BTC_ASSOCIATE_5G_FINISH == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (5G associate finish notify) **********\n"); - BTC_TRACE(trace_buf); - - } - - return; - -} - - - if (BTC_ASSOCIATE_START == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2G CONNECT START notify\n"); - BTC_TRACE(trace_buf); - - coex_sta->wifi_is_high_pri_task = true; - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8822B_1ANT_PHASE_2G_RUNTIME); - - coex_dm->arp_cnt = 0; - - halbtc8822b1ant_action_wifi_not_connected_asso_auth(btcoexist); - - } else { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2G CONNECT Finish notify\n"); - BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - if (!wifi_connected) /* non-connected scan */ - halbtc8822b1ant_action_wifi_not_connected(btcoexist); - else - halbtc8822b1ant_action_wifi_connected(btcoexist); - } - -} - -void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_under_b_mode = false; - boolean wifi_under_5g = false; - u32 cnt_bt_cal_chk = 0; - boolean is_in_mp_mode = false; - u8 u8tmp = 0; - u32 u32tmp1 = 0, u32tmp2 = 0; - - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) - return; - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if(wifi_under_5g) - { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 5g media notify \n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - - halbtc8822b1ant_action_wifi_under5g(btcoexist); - return; - } - - - - if (BTC_MEDIA_CONNECT == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2g media connect notify"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - - /* Set CCK Tx/Rx high Pri except 11b mode */ - if (wifi_under_b_mode) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (media status notity under b mode) **********\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x00); /* CCK Rx */ - } else { - /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ - /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (media status notity not under b mode) **********\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x10); /* CCK Rx */ - } - - coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, - 0x430); - coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, - 0x434); - coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( - btcoexist, 0x42a); - coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( - btcoexist, 0x456); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2g media disconnect notify\n"); - BTC_TRACE(trace_buf); - coex_dm->arp_cnt = 0; - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); - - btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ - - coex_sta->cck_ever_lock = false; - } - - halbtc8822b1ant_update_wifi_channel_info(btcoexist, type); - -} - -void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean under_4way = false, wifi_under_5g = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if(wifi_under_5g) - { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 5g special packet notify \n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_action_wifi_under5g(btcoexist); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - if (under_4way) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ---- under_4way!!\n"); - BTC_TRACE(trace_buf); - - coex_sta->wifi_is_high_pri_task = true; - coex_sta->specific_pkt_period_cnt = 2; - } else if (BTC_PACKET_ARP == type) { - - coex_dm->arp_cnt++; - - if (coex_sta->wifi_is_high_pri_task) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); - BTC_TRACE(trace_buf); - } - - } else { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); - BTC_TRACE(trace_buf); - - coex_sta->wifi_is_high_pri_task = true; - coex_sta->specific_pkt_period_cnt = 2; - } - - if (coex_sta->wifi_is_high_pri_task) - halbtc8822b1ant_action_wifi_connected_specific_packet(btcoexist); - -} - -void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length) -{ - u8 bt_info = 0; - u8 i, rsp_source = 0; - boolean bt_busy = false; - boolean wifi_connected = false; - boolean wifi_under_5g = false; - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - - coex_sta->c2h_bt_info_req_sent = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (BtInfo Notify) **********\n" ); - BTC_TRACE(trace_buf); - - rsp_source = tmp_buf[0] & 0xf; - if (rsp_source >= BT_INFO_SRC_8822B_1ANT_MAX) - rsp_source = BT_INFO_SRC_8822B_1ANT_WIFI_FW; - coex_sta->bt_info_c2h_cnt[rsp_source]++; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, - length); - BTC_TRACE(trace_buf); - - for (i = 0; i < length; i++) { - coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; - if (i == 1) - bt_info = tmp_buf[i]; - if (i == length - 1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } - } - - - if (BT_INFO_SRC_8822B_1ANT_WIFI_FW != rsp_source) { - - /* if 0xff, it means BT is under WHCK test */ - if (bt_info == 0xff) - coex_sta->bt_whck_test = true; - else - coex_sta->bt_whck_test = false; - - coex_sta->bt_retry_cnt = /* [3:0] */ - coex_sta->bt_info_c2h[rsp_source][2] & 0xf; - - if (coex_sta->bt_retry_cnt >= 1) - coex_sta->pop_event_cnt++; - - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) - coex_sta->c2h_bt_page = true; - else - coex_sta->c2h_bt_page = false; - - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) - coex_sta->bt_create_connection = true; - else - coex_sta->bt_create_connection = false; - - /* unit: %, value-100 to translate to unit: dBm */ - coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; - - /* coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; */ - - if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { - coex_sta->a2dp_bit_pool = - coex_sta->bt_info_c2h[rsp_source][6]; - } else - coex_sta->a2dp_bit_pool = 0; - - if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) - coex_sta->acl_busy = true; - else - coex_sta->acl_busy = false; - - coex_sta->bt_info_ext = - coex_sta->bt_info_c2h[rsp_source][4]; - - /* Here we need to resend some wifi info to BT */ - /* because bt is reset and loss of the info. */ - - if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { - - /* Re-Init */ - if (coex_sta->bt_info_ext & BIT(1)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - if (wifi_connected) - halbtc8822b1ant_update_wifi_channel_info(btcoexist, - BTC_MEDIA_CONNECT); - else - halbtc8822b1ant_update_wifi_channel_info(btcoexist, - BTC_MEDIA_DISCONNECT); - } - - /* If Ignore_WLanAct && not SetUp_Link */ - if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - halbtc8822b1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); - } - } - /* check BIT2 first ==> check if bt is under inquiry or page scan */ - if (bt_info & BT_INFO_8822B_1ANT_B_INQ_PAGE) - coex_sta->c2h_bt_inquiry_page = true; - else - coex_sta->c2h_bt_inquiry_page = false; - } - - coex_sta->num_of_profile = 0; - - /* set link exist status */ - if (!(bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; - - coex_sta->bt_hi_pri_link_exist = false; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (bt_info & BT_INFO_8822B_1ANT_B_FTP) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8822B_1ANT_B_A2DP) { - coex_sta->a2dp_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8822B_1ANT_B_HID) { - coex_sta->hid_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) { - coex_sta->sco_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->sco_exist = false; - - } - - halbtc8822b1ant_update_bt_link_info(btcoexist); - - bt_info = bt_info & - 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ - - if (!(bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info == - BT_INFO_8822B_1ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); - BTC_TRACE(trace_buf); - } else if ((bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8822B_1ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_SCO_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info & BT_INFO_8822B_1ANT_B_ACL_BUSY) { - if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) - coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_ACL_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); - BTC_TRACE(trace_buf); - } else { - coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_MAX; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); - BTC_TRACE(trace_buf); - } - - if ((BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - bt_busy = true; - else - bt_busy = false; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - halbtc8822b1ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_RF_ON == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned ON!!\n"); - BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, true); - } else if (BTC_RF_OFF == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned OFF!!\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8822B_1ANT_PHASE_WLAN_OFF); - - halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - btcoexist->stop_coex_dm = true; - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); - halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); - - } -} - -void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); - halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); - - halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8822B_1ANT_PHASE_WLAN_OFF); - - halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8822b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, FALSE); - - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state) -{ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_WIFI_PNP_SLEEP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to SLEEP\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, false); - halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, false); - - halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8822b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8822B_1ANT_PHASE_WLAN_OFF); - - halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 5); - - halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, FALSE); - - btcoexist->stop_coex_dm = true; - } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to WAKE UP\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_post_activestate_to_bt(btcoexist, true); - halbtc8822b1ant_post_onoffstate_to_bt(btcoexist, true); - - btcoexist->stop_coex_dm = false; - } -} - -void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], *****************Coex DM Reset*****************\n"); - BTC_TRACE(trace_buf); - - halbtc8822b1ant_init_hw_config(btcoexist, false, false); - halbtc8822b1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) -{ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ==========================Periodical===========================\n"); - BTC_TRACE(trace_buf); - -#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 0) - halbtc8822b1ant_query_bt_info(btcoexist); -#endif - - halbtc8822b1ant_monitor_bt_ctr(btcoexist); - halbtc8822b1ant_monitor_wifi_ctr(btcoexist); - - halbtc8822b1ant_monitor_bt_enable_disable(btcoexist); - - /* for 4-way, DHCP, EAPOL packet */ - if (coex_sta->specific_pkt_period_cnt > 0) { - - coex_sta->specific_pkt_period_cnt--; - - if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) - coex_sta->wifi_is_high_pri_task = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); - BTC_TRACE(trace_buf); - } - - - if (coex_sta->bt_coex_supported_feature == 0) - coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); - - if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) - coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); - - if (halbtc8822b1ant_is_wifi_status_changed(btcoexist)) - halbtc8822b1ant_run_coexist_mechanism(btcoexist); - -} - -void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ -} - -void ex_halbtc8822b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - -} - -void ex_halbtc8822b1ant_psd_scan(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - -} - -void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ - -} - -void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, - IN u8 op_code, IN u8 op_len, IN u8 *pdata) -{} -#endif /* #if(BTC_COEX_OFFLOAD == 1) */ - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e1ant.c similarity index 99% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e1Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e1ant.c index 8a4d9777f0ff..1c60239fc38d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e1Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e1ant.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /* ************************************************************ * Description: * @@ -11,7 +25,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -916,9 +930,8 @@ void halbtc8192e1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[1] = {0}; - if (enable) { + if (enable) h2c_parameter[0] |= BIT(0); /* function enable */ - } btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); } @@ -1432,7 +1445,7 @@ void halbtc8192e1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist result = 0; wait_count = 0; } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ + /* acquire the BT TRx retry count from BT_Info byte2 */ retry_count = coex_sta->bt_retry_cnt; bt_info_ext = coex_sta->bt_info_ext; @@ -1845,6 +1858,7 @@ void halbtc8192e1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist u8 bt_rssi_state; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + bt_rssi_state = halbtc8192e1ant_bt_rssi_state(2, 28, 0); if ((coex_sta->low_priority_rx >= 1000) && @@ -2319,12 +2333,12 @@ void halbtc8192e1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) halbtc8192e1ant_action_wifi_multi_port(btcoexist); return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); } + miracast_plus_bt = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + if ((bt_link_info->bt_link_exist) && (wifi_connected)) { halbtc8192e1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); @@ -3414,4 +3428,4 @@ void ex_halbtc8192e1ant_dbg_control(IN struct btc_coexist *btcoexist, #endif /* #if (RTL8192E_SUPPORT == 1) */ -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ \ No newline at end of file +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e1Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e1ant.h similarity index 92% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e1Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e1ant.h index e75127c10a6d..10c34c1dbe0e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e1Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e1ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e2ant.c similarity index 84% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e2Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e2ant.c index b7af2c04fc47..fe578a196888 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e2Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e2ant.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /* ************************************************************ * Description: * @@ -11,7 +25,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -31,10 +45,23 @@ const char *const glbt_info_src_8192e_2ant[] = { "BT Info[bt rsp]", "BT Info[bt auto report]", }; - -u32 glcoex_ver_date_8192e_2ant = 20160412; -u32 glcoex_ver_8192e_2ant = 0x42; - +/* ************************************************************ + * BtCoex Version Format: + * 1. date : glcoex_ver_date_XXXXX_1ant + * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant + * 3. BtCoexVersion : glcoex_ver_btdesired_XXXXX_1ant + * 4. others : glcoex_ver_XXXXXX_XXXXX_1ant + * + * Variable should be indicated IC and Antenna numbers !!! + * Please strictly follow this order and naming style !!! + * + * ************************************************************ */ +u32 glcoex_ver_date_8192e_2ant = 20170113; +u32 glcoex_ver_8192e_2ant = 0x46; +u32 glcoex_ver_btdesired_8192e_2ant = 0x04; +/*1.fix miracast issue*/ +/*2.update BT FW for power on latch issue*/ +/*3. move the function of polling BT version to ex_halbtc8192e2ant_display_coex_info*/ /* ************************************************************ * local function proto type if needed * ************************************************************ @@ -168,59 +195,6 @@ u8 halbtc8192e2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, return wifi_rssi_state; } -void halbtc8192e2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -{ - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - - /* This function check if bt is disabled */ - - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); - BTC_TRACE(trace_buf); - } else { - bt_disable_cnt++; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], bt all counters=0, %d times!!\n", - bt_disable_cnt); - BTC_TRACE(trace_buf); - if (bt_disable_cnt >= 2) { - bt_disabled = true; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); - BTC_TRACE(trace_buf); - } - } - if (coex_sta->bt_disabled != bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); - BTC_TRACE(trace_buf); - coex_sta->bt_disabled = bt_disabled; - if (!bt_disabled) { - } else { - } - } -} - u32 halbtc8192e2ant_decide_ra_mask(IN struct btc_coexist *btcoexist, IN u8 ss_type, IN u32 ra_mask_type) { @@ -426,6 +400,49 @@ void halbtc8192e2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); } + +void halbtc8192e2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ +#if 1 + + coex_sta->crc_ok_cck = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); +#endif +} + + + void halbtc8192e2ant_query_bt_info(IN struct btc_coexist *btcoexist) { u8 h2c_parameter[1] = {0}; @@ -435,6 +452,10 @@ void halbtc8192e2ant_query_bt_info(IN struct btc_coexist *btcoexist) h2c_parameter[0] |= BIT(0); /* trigger */ btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],Query BT info!!!! H2C 0x61 = 0x1\n"); + BTC_TRACE(trace_buf); } boolean halbtc8192e2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) @@ -467,9 +488,11 @@ boolean halbtc8192e2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) return true; } - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); + wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, + 2, 34, 0); - if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || (BTC_RSSI_STATE_LOW == wifi_rssi_state)) + if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || + (BTC_RSSI_STATE_LOW == wifi_rssi_state)) return true; } @@ -1054,35 +1077,51 @@ void halbtc8192e2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, { switch (type) { case 0: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, + 0x5a5a5a5a, 0xffffff, 0x3); break; case 1: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5a5a5a5a, + 0x5a5a5a5a, 0xffffff, 0x3); break; case 2: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55dd55dd, + 0x5ada5ada, 0xffffff, 0x3); break; case 3: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fdf5fdf, 0x5fdb5fdb, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fdf5fdf, + 0x5fdb5fdb, 0xffffff, 0x3); break; case 4: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xdfffdfff, 0x5ffb5ffb, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xdfffdfff, + 0x5ffb5ffb, 0xffffff, 0x3); break; case 5: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5ddd5ddd, + 0x5fdb5fdb, 0xffffff, 0x3); break; case 6: - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fff5fff, 0x5a5a5a5a, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5fff5fff, + 0x5a5a5a5a, 0xffffff, 0x3); break; case 7: if (coex_sta->scan_ap_num <= NOISY_AP_NUM_THRESH_8192E) - halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xffffffff, 0xfafafafa, 0xffffff, 0x3); + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xffffffff, 0xfafafafa, 0xffffff, 0x3); else halbtc8192e2ant_coex_table(btcoexist, force_exec, 0xffffffff, 0x5a5a5a5a, 0xffffff, 0x3); break; case 8: halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x5f5f5f5f, 0x5a5a5a5a, 0xffffff, 0x3); break; + case 9: + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, 0xfafafafa, 0xffffff, 0x3); + break; + case 10: + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 11: + halbtc8192e2ant_coex_table(btcoexist, force_exec, 0x55555555, 0xfafafafa, 0xffffff, 0x3); + break; default: break; } @@ -1093,9 +1132,8 @@ void halbtc8192e2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[1] = {0}; - if (enable) { + if (enable) h2c_parameter[0] |= BIT(0); /* function enable */ - } btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); } @@ -1142,25 +1180,94 @@ void halbtc8192e2ant_lps_rpwm(IN struct btc_coexist *btcoexist, coex_dm->pre_rpwm = coex_dm->cur_rpwm; } +void halbtc8192e2ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +{ + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + /* will leave LPS state, turn off psTdma first */ + /*halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);*/ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + + } + } else { /* NO PS state */ + if (new_ps_state) { + /* will enter LPS state, turn off psTdma first */ + /*halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0);*/ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + } else { + /* keep state under NO PS state, do nothing. */ + } + } +} + + +void halbtc8192e2ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = false; + boolean bApEnable = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); + if (bApEnable) { + ps_type = BTC_PS_WIFI_NATIVE; + lps_val = 0x0; + rpwm_val = 0x0; + } + /*for 8192e, NO 32k*/ + low_pwr_disable = true; + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + coex_sta->force_lps_on = false; + btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, NULL); + break; + case BTC_PS_LPS_ON: + coex_sta->force_lps_on = true; + halbtc8192e2ant_ps_tdma_check_for_power_save_state(btcoexist, true); + halbtc8192e2ant_lps_rpwm(btcoexist, NORMAL_EXEC, lps_val, rpwm_val); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); + /* power save must executed before psTdma. */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, NULL); + break; + case BTC_PS_LPS_OFF: + coex_sta->force_lps_on = false; + halbtc8192e2ant_ps_tdma_check_for_power_save_state(btcoexist, false); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, NULL); + break; + default: + break; + } +} + void halbtc8192e2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) { u8 h2c_parameter[5] = {0}; - u8 realByte1 = byte1, realByte5 = byte5; - boolean bApEnable = false; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = false; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); - if (bApEnable) { - if ((byte1 & BIT4) && !(byte1 & BIT5)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], FW for 1Ant AP mode\n"); - realByte1 &= ~BIT4; - realByte1 |= BIT5; + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + } else if ((byte1 & BIT(4)) && (!(byte1 & BIT(5)))) + halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + else + halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - realByte5 |= BIT5; - realByte5 &= ~BIT6; - } - } h2c_parameter[0] = byte1; h2c_parameter[1] = byte2; @@ -1253,10 +1360,67 @@ void halbtc8192e2ant_set_ant_path(IN struct btc_coexist *btcoexist, } } +void halbtc8192e2ant_set_switch_ss_type(IN struct btc_coexist *btcoexist, + IN u8 ss_type) +{ + u8 mimo_ps = BTC_MIMO_PS_DYNAMIC; + u32 dis_ra_mask = 0x0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], REAL set SS Type = %d\n", ss_type); + BTC_TRACE(trace_buf); + + dis_ra_mask = halbtc8192e2ant_decide_ra_mask(btcoexist, ss_type, + coex_dm->cur_ra_mask_type); + halbtc8192e2ant_update_ra_mask(btcoexist, FORCE_EXEC, dis_ra_mask); + + if (ss_type == 1) { + /*halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1);*/ + /* switch ofdm path */ + btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x11); + btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x1); + btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81111111); + /* switch cck patch */ + /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x1); */ + /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x81); */ + mimo_ps = BTC_MIMO_PS_STATIC; + } else if (ss_type == 2) { + /*halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0);*/ + btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x33); + btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x3); + btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81121313); + /* remove, if 0xe77[2]=0x0 then CCK will fail, advised by Jenyu */ + /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x0); */ + /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x41); */ + mimo_ps = BTC_MIMO_PS_DYNAMIC; + } + + btcoexist->btc_set(btcoexist, BTC_SET_ACT_SEND_MIMO_PS, + &mimo_ps); /* set rx 1ss or 2ss */ +} + +void halbtc8192e2ant_switch_ss_type(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 new_ss_type) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s Switch SS Type = %d\n", + (force_exec ? "force to" : ""), new_ss_type); + BTC_TRACE(trace_buf); + coex_dm->cur_ss_type = new_ss_type; + + if (!force_exec) { + if (coex_dm->pre_ss_type == coex_dm->cur_ss_type) + return; + } + halbtc8192e2ant_set_switch_ss_type(btcoexist, coex_dm->cur_ss_type); + + coex_dm->pre_ss_type = coex_dm->cur_ss_type; +} + void halbtc8192e2ant_ps_tdma(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean turn_on, IN u8 type) { - s8 nWiFiDurationAdjust = 0x0; + s8 wifi_duration_adjust = 0x0; coex_dm->cur_ps_tdma_on = turn_on; coex_dm->cur_ps_tdma = type; @@ -1268,9 +1432,10 @@ void halbtc8192e2ant_ps_tdma(IN struct btc_coexist *btcoexist, } if (coex_sta->scan_ap_num >= 40) - nWiFiDurationAdjust = -15; + wifi_duration_adjust = -15; else if (coex_sta->scan_ap_num >= 20) - nWiFiDurationAdjust = -10; + wifi_duration_adjust = -10; + if (turn_on) { switch (type) { @@ -1336,31 +1501,53 @@ void halbtc8192e2ant_ps_tdma(IN struct btc_coexist *btcoexist, halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x25, 0x25, 0x60, 0x90); break; case 21: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x35, 0x03, 0x11, 0x11); + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x15, 0x03, 0x11, 0x11); break; - case 22: + case 22: /* d1,wb */ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x11, 0x14); break; - case 23: + case 23: /* d1,pb,TXpause */ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x63, 0x14, 0x03, 0x90, 0x14); break; - case 24: + case 24: /* d1,bb */ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x31, 0x14); break; - case 25: + case 25: /* d1,bb,TXpause */ halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x30, 0x14); break; + case 26: /*d1,wp,noTXpause*/ + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe1, 0x3c, 0x03, 0x11, 0x10); + break; + case 27: /*11,pp,noTXpause*/ + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x3c, 0x03, 0x11, 0x11); + break; + case 28: /*11,pp,noTXpause*/ + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x50, 0x03, 0x11, 0x11); + break; + case 29: + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x15, 0x03, 0x11, 0x11); + break; + case 30: + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x10, 0x14); + break; + case 31: /*d3,bb,TXpause*/ + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x14, 0x03, 0x30, 0x94); + break; + case 32: + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x61, 0x35, 0x03, 0x11, 0x11); + break; case 71: halbtc8192e2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); break; + /* following cases is for wifi rssi low // bad antenna isolation, started from 81 */ case 80: halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3c, 0x3, 0x10, 0x50); break; case 81: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3a+nWiFiDurationAdjust, 0x3, 0x10, 0x50); + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x3a + wifi_duration_adjust, 0x3, 0x10, 0x50); break; case 82: - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x30+nWiFiDurationAdjust, 0x03, 0x10, 0x50); + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x30 + wifi_duration_adjust, 0x03, 0x10, 0x50); break; case 83: halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x21, 0x03, 0x10, 0x50); @@ -1377,26 +1564,23 @@ void halbtc8192e2ant_ps_tdma(IN struct btc_coexist *btcoexist, case 87: halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x51, 0x14, 0x03, 0x10, 0x54); break; - + case 88: + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x53, 0x14, 0x03, 0x10, 0x54); + break; } } else { /* disable PS tdma */ switch (type) { default: case 0: /* ANT2PTA, 0x778=1 */ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - halbtc8192e2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, false, false); + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x8, 0x0, 0x0, 0x0, 0x0); + halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, false, false); break; case 1: /* ANT2BT, 0x778=3 */ - halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x8, 0x0); + halbtc8192e2ant_set_fw_pstdma(btcoexist, 0x0, 0x0, 0x0, 0x8, 0x0); delay_ms(5); - halbtc8192e2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_BT, false, false); + halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, false); break; - } } @@ -1405,124 +1589,58 @@ void halbtc8192e2ant_ps_tdma(IN struct btc_coexist *btcoexist, coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; } -void halbtc8192e2ant_set_switch_ss_type(IN struct btc_coexist *btcoexist, - IN u8 ss_type) + +void halbtc8192e2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) { - u8 mimo_ps = BTC_MIMO_PS_DYNAMIC; - u32 dis_ra_mask = 0x0; + static u32 bt_disable_cnt = 0; + boolean bt_active = true, bt_disabled = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], REAL set SS Type = %d\n", ss_type); - BTC_TRACE(trace_buf); + /* This function check if bt is disabled */ - dis_ra_mask = halbtc8192e2ant_decide_ra_mask(btcoexist, ss_type, - coex_dm->cur_ra_mask_type); - halbtc8192e2ant_update_ra_mask(btcoexist, FORCE_EXEC, dis_ra_mask); - - if (ss_type == 1) { - halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); - /* switch ofdm path */ - btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x11); - btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x1); - btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81111111); - /* switch cck patch */ - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x1); */ - /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x81); */ - mimo_ps = BTC_MIMO_PS_STATIC; - } else if (ss_type == 2) { - halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - btcoexist->btc_write_1byte(btcoexist, 0xc04, 0x33); - btcoexist->btc_write_1byte(btcoexist, 0xd04, 0x3); - btcoexist->btc_write_4byte(btcoexist, 0x90c, 0x81121313); - /* remove, if 0xe77[2]=0x0 then CCK will fail, advised by Jenyu */ - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0xe77, 0x4, 0x0); */ - /* btcoexist->btc_write_1byte(btcoexist, 0xa07, 0x41); */ - mimo_ps = BTC_MIMO_PS_DYNAMIC; - } - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_SEND_MIMO_PS, - &mimo_ps); /* set rx 1ss or 2ss */ -} - -void halbtc8192e2ant_switch_ss_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 new_ss_type) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], %s Switch SS Type = %d\n", - (force_exec ? "force to" : ""), new_ss_type); - BTC_TRACE(trace_buf); - coex_dm->cur_ss_type = new_ss_type; - - if (!force_exec) { - if (coex_dm->pre_ss_type == coex_dm->cur_ss_type) - return; - } - halbtc8192e2ant_set_switch_ss_type(btcoexist, coex_dm->cur_ss_type); - - coex_dm->pre_ss_type = coex_dm->cur_ss_type; -} - -void halbtc8192e2ant_ps_tdma_check_for_power_save_state( - IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -{ - u8 lps_mode = 0x0; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); - - if (lps_mode) { /* already under LPS state */ - if (new_ps_state) { - /* keep state under LPS, do nothing. */ - } else { - /* will leave LPS state, turn off psTdma first */ - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } else { - /* keep state under NO PS state, do nothing. */ + if (coex_sta->high_priority_tx == 0 && + coex_sta->high_priority_rx == 0 && + coex_sta->low_priority_tx == 0 && + coex_sta->low_priority_rx == 0) + bt_active = false; + if (coex_sta->high_priority_tx == 0xffff && + coex_sta->high_priority_rx == 0xffff && + coex_sta->low_priority_tx == 0xffff && + coex_sta->low_priority_rx == 0xffff) + bt_active = false; + if (bt_active) { + bt_disable_cnt = 0; + bt_disabled = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is enabled !!\n"); + BTC_TRACE(trace_buf); + } else { + bt_disable_cnt++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], bt all counters=0, %d times!!\n", + bt_disable_cnt); + BTC_TRACE(trace_buf); + if (bt_disable_cnt >= 2) { + bt_disabled = true; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!\n"); + BTC_TRACE(trace_buf); } } -} - -void halbtc8192e2ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -{ - boolean low_pwr_disable = false; - boolean bApEnable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &bApEnable); - - if (bApEnable) { - ps_type = BTC_PS_WIFI_NATIVE; - lps_val = 0x0; - rpwm_val = 0x0; - } - switch (ps_type) { - case BTC_PS_WIFI_NATIVE: - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - break; - case BTC_PS_LPS_ON: - halbtc8192e2ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8192e2ant_lps_rpwm(btcoexist, NORMAL_EXEC, - lps_val, rpwm_val); - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - /* power save must executed before psTdma. */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, - NULL); - break; - default: - break; + if (coex_sta->bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->bt_disabled ? "disabled" : "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + coex_sta->bt_disabled = bt_disabled; + if (bt_disabled) { + halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } } } @@ -1544,9 +1662,10 @@ void halbtc8192e2ant_coex_all_off(IN struct btc_coexist *btcoexist) void halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist) { + coex_sta->cnt_setup_link = 0; + /* force to reset coex mechanism */ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); + halbtc8192e2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); halbtc8192e2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); @@ -1559,14 +1678,16 @@ void halbtc8192e2ant_init_coex_dm(IN struct btc_coexist *btcoexist) void halbtc8192e2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) { + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + if (coex_sta->wifi_is_high_pri_task && (!bt_link_info->a2dp_exist)) { + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + } else { + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 29); + } -/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); @@ -1592,86 +1713,74 @@ boolean halbtc8192e2ant_is_common_action(IN struct btc_coexist *btcoexist) if (!wifi_connected) { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non-connected idle!!\n"); BTC_TRACE(trace_buf); - if ((BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) || - (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status)) { -/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ + if ((coex_dm->bt_status == BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE) || + (coex_dm->bt_status == BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE)) { halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); } else { -/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ - halbtc8192e2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); } - halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); common = true; } else { - if (BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) { + if (coex_dm->bt_status == BT_8192E_2ANT_BT_STATUS_NON_CONNECTED_IDLE) { + if (wifi_busy && (coex_sta->high_priority_rx > 10)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi busy + BT non connected-idle!!\n"); + BTC_TRACE(trace_buf); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT non connected-idle!!\n"); - BTC_TRACE(trace_buf); - - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ - - halbtc8192e2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 6); - halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - - common = true; - } else if (BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status) { + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 9); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 26); + halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + common = true; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected-idle + BT non connected-idle!!\n"); + BTC_TRACE(trace_buf); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + common = true; + } + } else if (coex_dm->bt_status == BT_8192E_2ANT_BT_STATUS_CONNECTED_IDLE) { if (bt_hs_on) return false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT connected-idle!!\n"); - BTC_TRACE(trace_buf); - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 2);*/ - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 6); - halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - - common = true; + if (wifi_busy) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi busy + BT connected-idle!!\n"); + BTC_TRACE(trace_buf); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 10); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 27); + halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + common = true; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected-idle + BT connected-idle!!\n"); + BTC_TRACE(trace_buf); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + common = true; + } } else { if (wifi_busy) { @@ -1683,27 +1792,20 @@ boolean halbtc8192e2ant_is_common_action(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); BTC_TRACE(trace_buf); - - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); -/* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 21); - halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, - NORMAL_EXEC, 6); - halbtc8192e2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, 0); - halbtc8192e2ant_sw_mechanism1(btcoexist, false, - false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, - false, false, 0x18); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); + halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); common = true; } } } - return common; } + + void halbtc8192e2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) { @@ -1833,7 +1935,7 @@ void halbtc8192e2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, result = 0; wait_count = 0; } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ + /* acquire the BT TRx retry count from BT_Info byte2 */ retry_count = coex_sta->bt_retry_cnt; result = 0; wait_count++; @@ -2585,6 +2687,7 @@ void halbtc8192e2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, /* then we have to adjust it back to the previous record one. */ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { boolean scan = false, link = false, roam = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); @@ -2632,9 +2735,9 @@ void halbtc8192e2ant_tdma_duration_adjust_for_wifi_rssi_low( result = 0; wait_count = 0; } else { - /*acquire the BT TRx retry count from BT_Info byte2*/ - /* retry_count = coex_sta->bt_retry_cnt;*/ - /* bt_info_ext = coex_sta->bt_info_ext; */ + /* acquire the BT TRx retry count from BT_Info byte2 + * retry_count = coex_sta->bt_retry_cnt; + * bt_info_ext = coex_sta->bt_info_ext; */ result = 0; wait_count++; @@ -2727,14 +2830,16 @@ void halbtc8192e2ant_tdma_duration_adjust_for_wifi_rssi_low( halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); coex_dm->ps_tdma_du_adj_type = 81; - } else if ((coex_dm->cur_ps_tdma == 81) && (coex_sta->scan_ap_num <= 5)) { - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); + } else if ((coex_dm->cur_ps_tdma == 81) && + (coex_sta->scan_ap_num <= 5)) { + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 81); coex_dm->ps_tdma_du_adj_type = 81; - } + } } if (coex_dm->cur_ps_tdma != 80 && - coex_dm->cur_ps_tdma != 81 && + coex_dm->cur_ps_tdma != 81 && coex_dm->cur_ps_tdma != 82 && coex_dm->cur_ps_tdma != 83 && coex_dm->cur_ps_tdma != 84) { @@ -2781,7 +2886,20 @@ void halbtc8192e2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, } } - +void halbtc8192e2ant_action_bt_relink(IN struct btc_coexist *btcoexist) +{ + if (coex_sta->wifi_is_high_pri_task) { + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + } else { + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + } + halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); +} /* SCO only or SCO+PAN(HS) */ @@ -2789,30 +2907,32 @@ void halbtc8192e2ant_action_sco(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; u32 wifi_bw; - u8 btThresh0 = 0, btThresh1 = 0; + u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); - bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); + halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, + &bt_thresh1); + bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, bt_thresh0, + bt_thresh1); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); + wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, + 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); else halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); else halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } @@ -2821,19 +2941,16 @@ void halbtc8192e2ant_action_sco_pan(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; u32 wifi_bw; - u8 btThresh0 = 0, btThresh1 = 0; + u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); - bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); - - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - - if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, + &bt_thresh1); + bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, bt_thresh0, + bt_thresh1); + wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, + 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); @@ -2852,13 +2969,17 @@ void halbtc8192e2ant_action_sco_pan(IN struct btc_coexist *btcoexist) halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, + 0x18); + else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, + 0x18); else - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, + 0x18); } @@ -2874,45 +2995,38 @@ void halbtc8192e2ant_action_hid(IN struct btc_coexist *btcoexist) bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); if (anttype == 0) { - /*ANTTYPE = 0 92E 2ant with SPDT*/ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + /*ANTTYPE = 0 2ant with SPDT*/ + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 28); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); } else if (anttype == 1) { - /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + /*2ant with coupler and bad ant. isolation, 3ant with bad ant. isolation*/ + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 28); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); } else if (anttype == 2) { - /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ + /*ANTTYPE = 2, 2ant with coupler and normal/good ant. isolation, 3ant with normal ant. isolation*/ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); } else { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); } } else if (anttype == 3) { - /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ + /*ANTTYPE = 3, 3ant with good ant. isolation*/ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); } else { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); } } - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } @@ -2923,7 +3037,7 @@ void halbtc8192e2ant_action_a2dp(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; boolean long_dist = false; - u8 anttype = 0; + u8 anttype = 0; btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); @@ -2931,50 +3045,42 @@ void halbtc8192e2ant_action_a2dp(IN struct btc_coexist *btcoexist) bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); if (anttype == 0) { - /*ANTTYPE = 0 92E 2ant with SPDT*/ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + /*ANTTYPE = 0 2ant with SPDT*/ + if ((coex_sta->scan_ap_num > 40) && (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) { + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 30); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } else { + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 88); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } } else if (anttype == 1) { - /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ + /*2ant with coupler and bad ant. isolation, 3ant with bad ant. isolation*/ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); } else { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 88); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); } } else if (anttype == 2) { - /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); + /*ANTTYPE = 2, 2ant with coupler and normal/good ant. isolation, 3ant with normal ant. isolation*/ + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); } else { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 88); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); } } else if (anttype == 3) { - /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); + /*ANTTYPE = 3, 3ant with good ant. isolation*/ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); } - + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x06); - else - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } void halbtc8192e2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) @@ -2982,7 +3088,8 @@ void halbtc8192e2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); + wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 15, + 0); bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -2996,11 +3103,13 @@ void halbtc8192e2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); } else if ((bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || (bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { - halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, 2); + halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, + 2); halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); } else if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, 2); + halbtc8192e2ant_tdma_duration_adjust(btcoexist, false, false, + 2); halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); } @@ -3009,20 +3118,28 @@ void halbtc8192e2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) if (BTC_WIFI_BW_HT40 == wifi_bw) { if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, true, 0x6); + halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, + true, 0x6); } else { - halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x6); + halbtc8192e2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, + true, 0x6); } } else { if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, true, 0x6); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, true, false, + true, 0x6); } else { - halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x6); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, + true, 0x6); } } } @@ -3031,18 +3148,15 @@ void halbtc8192e2ant_action_pan_edr(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 btThresh0 = 0, btThresh1 = 0; + u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); - bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); - /*wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0);*/ + halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, + &bt_thresh1); + bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, bt_thresh0, + bt_thresh1); + /* wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); */ wifi_rssi_state = BTC_RSSI_STATE_LOW; - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); else @@ -3057,14 +3171,7 @@ void halbtc8192e2ant_action_pan_edr(IN struct btc_coexist *btcoexist) halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } /* PAN(HS) only */ @@ -3077,7 +3184,6 @@ void halbtc8192e2ant_action_pan_hs(IN struct btc_coexist *btcoexist) 0); bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); - /* halbtc8192e2ant_switch_ss_type(btcoexist, NORMAL_EXEC, 1);*/ halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); @@ -3130,18 +3236,15 @@ void halbtc8192e2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 btThresh0 = 0, btThresh1 = 0; + u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); - bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); - /*wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0);*/ + halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, + &bt_thresh1); + bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, bt_thresh0, + bt_thresh1); + /* wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); */ wifi_rssi_state = BTC_RSSI_STATE_LOW; - if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); else @@ -3156,14 +3259,7 @@ void halbtc8192e2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } @@ -3171,41 +3267,31 @@ void halbtc8192e2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 btThresh0 = 0, btThresh1 = 0; + u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); - bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); + halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, + &bt_thresh1); + bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, bt_thresh0, + bt_thresh1); - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - - if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, + 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); else halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 10); else halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } /* HID+A2DP+PAN(EDR) */ @@ -3213,16 +3299,14 @@ void halbtc8192e2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 btThresh0 = 0, btThresh1 = 0; + u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &btThresh0, &btThresh1); - bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, btThresh0, btThresh1); - wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - - if ((BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8192e2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, + &bt_thresh1); + bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, bt_thresh0, + bt_thresh1); + wifi_rssi_state = halbtc8192e2ant_wifi_rssi_state(btcoexist, 0, 2, 34, + 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); @@ -3238,21 +3322,14 @@ void halbtc8192e2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } void halbtc8192e2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 btThresh0 = 0, btThresh1 = 0, anttype = 0; + u8 bt_thresh0 = 0, bt_thresh1 = 0, anttype = 0; btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); @@ -3260,51 +3337,43 @@ void halbtc8192e2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) bt_rssi_state = halbtc8192e2ant_bt_rssi_state(3, 34, 42); if (anttype == 0) { - /*92E 2ant with SPDT*/ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); - halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); - halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - + /*2ant with SPDT*/ + if ((coex_sta->scan_ap_num > 40) && (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)))) { + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 31); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); + } else { + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 88); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + } } else if (anttype == 1) { - /*92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation*/ + /*2ant with coupler and bad ant. isolation, 3ant with bad ant. isolation*/ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); } else { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); } } else if (anttype == 2) { - /*ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation*/ + /*ANTTYPE = 2, 2ant with coupler and normal/good ant. isolation, 3ant with normal ant. isolation*/ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 25); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); } else { - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 87); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); } } else if (anttype == 3) { - /*ANTTYPE = 3, 92E 3ant with good ant. isolation*/ - halbtc8192e2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); + /*ANTTYPE = 3, 3ant with good ant. isolation*/ halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); } halbtc8192e2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); halbtc8192e2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8192e2ant_sw_mechanism1(btcoexist, false, false, false, false); - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - else if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && - (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8192E)) - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, true, 0x06); - else - halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + halbtc8192e2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } void halbtc8192e2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) @@ -3339,6 +3408,14 @@ void halbtc8192e2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) return; } + if (coex_sta->is_setup_link) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is re-link !!!\n"); + halbtc8192e2ant_action_bt_relink(btcoexist); + return; + } + + coex_dm->cur_algorithm = algorithm; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", coex_dm->cur_algorithm); @@ -3472,7 +3549,7 @@ void halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, halbtc8192e2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); /* antenna switch control parameter */ - btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); + /* btcoexist->btc_write_4byte(btcoexist, 0x858, 0x55555555); */ /* coex parameters */ btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); @@ -3505,6 +3582,9 @@ void halbtc8192e2ant_init_hw_config(IN struct btc_coexist *btcoexist, u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); u8tmp |= BIT(0); btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); + + /* Give bt_coex_supported_version the default value */ + coex_sta->bt_coex_supported_version = 0; } /* ************************************************************ @@ -3540,7 +3620,9 @@ void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist) u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; u16 u16tmp[4]; u32 u32tmp[4]; - u32 fw_ver = 0, bt_patch_ver = 0; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; + u32 phyver = 0; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -3561,16 +3643,41 @@ void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Antenna type:", - board_info->ant_type); + board_info->ant_type); CL_PRINTF(cli_buf); + if (!coex_sta->bt_disabled) { + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + } + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + bt_coex_ver = coex_sta->bt_coex_supported_version & 0xff; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8192e_2ant, glcoex_ver_8192e_2ant, fw_ver, - bt_patch_ver, bt_patch_ver); + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8192e_2ant, glcoex_ver_8192e_2ant, + glcoex_ver_btdesired_8192e_2ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (coex_sta->bt_disabled ? "BT-disable" : + (bt_coex_ver >= glcoex_ver_btdesired_8192e_2ant ? + "Match" : "Mis-Match")))); + CL_PRINTF(cli_buf); + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d", + "W_FW/ B_FW/ Phy", fw_ver, bt_patch_ver, phyver); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", @@ -3579,6 +3686,16 @@ void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist) coex_dm->wifi_chnl_info[2]); CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/", "WifibHiPri", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); + CL_PRINTF(cli_buf); + +#if 0 + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/", "test patch version", + "20161003_v3"); + CL_PRINTF(cli_buf); +#endif + /* wifi status */ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Wifi Status]============"); @@ -3704,8 +3821,9 @@ void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", "0x778", - u8tmp[0]); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x778/0x880[29:25]", + u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); CL_PRINTF(cli_buf); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x92c); @@ -3734,6 +3852,33 @@ void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist) u32tmp[0]); CL_PRINTF(cli_buf); + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11n-agg", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11n-agg", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); + CL_PRINTF(cli_buf); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); @@ -3767,13 +3912,16 @@ void ex_halbtc8192e2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_TRACE(trace_buf); coex_sta->under_ips = true; halbtc8192e2ant_coex_all_off(btcoexist); - halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, - true); + halbtc8192e2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); + halbtc8192e2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); + ex_halbtc8192e2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); } else if (BTC_IPS_LEAVE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS LEAVE notify\n"); BTC_TRACE(trace_buf); coex_sta->under_ips = false; + halbtc8192e2ant_init_hw_config(btcoexist, false); + halbtc8192e2ant_init_coex_dm(btcoexist); } } @@ -3784,6 +3932,7 @@ void ex_halbtc8192e2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) "[BTCoex], LPS ENABLE notify\n"); BTC_TRACE(trace_buf); coex_sta->under_lps = true; + } else if (BTC_LPS_DISABLE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS DISABLE notify\n"); @@ -3803,7 +3952,8 @@ void ex_halbtc8192e2ant_scan_notify(IN struct btc_coexist *btcoexist, BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], SCAN FINISH notify\n"); BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); } } @@ -3815,10 +3965,18 @@ void ex_halbtc8192e2ant_connect_notify(IN struct btc_coexist *btcoexist, BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT START notify\n"); BTC_TRACE(trace_buf); + coex_sta->wifi_is_high_pri_task = true; + coex_sta->cnt_wifi_high_pri = 2; + halbtc8192e2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, false); + halbtc8192e2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + halbtc8192e2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); + halbtc8192e2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); } else if (BTC_ASSOCIATE_FINISH == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT FINISH notify\n"); BTC_TRACE(trace_buf); + coex_sta->wifi_is_high_pri_task = false; + halbtc8192e2ant_run_coexist_mechanism(btcoexist); } } @@ -3882,6 +4040,7 @@ void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, u8 i, rsp_source = 0; boolean bt_busy = false, limited_dig = false; boolean wifi_connected = false; + static u8 bt_info_for_wifi_fw_count = 0; coex_sta->c2h_bt_info_req_sent = false; @@ -3894,6 +4053,15 @@ void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, length); BTC_TRACE(trace_buf); + + /*avoid mailbox issue*/ + if (rsp_source == BT_INFO_SRC_8192E_2ANT_WIFI_FW) { + bt_info_for_wifi_fw_count++; + if (bt_info_for_wifi_fw_count < 5) + return; + } else + bt_info_for_wifi_fw_count = 0; + for (i = 0; i < length; i++) { coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; if (i == 1) @@ -3935,6 +4103,16 @@ void ex_halbtc8192e2ant_bt_info_notify(IN struct btc_coexist *btcoexist, btcoexist, BTC_MEDIA_DISCONNECT); } + if (coex_sta->bt_info_ext & BIT(2)) { + coex_sta->cnt_setup_link++; + coex_sta->is_setup_link = true; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else + coex_sta->is_setup_link = false; + if ((coex_sta->bt_info_ext & BIT(3))) { if (!btcoexist->manual_control && !btcoexist->stop_coex_dm) { @@ -4051,11 +4229,37 @@ void ex_halbtc8192e2ant_halt_notify(IN struct btc_coexist *btcoexist) void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist) { + boolean wifi_connected = false; + static u8 count = 0; + static boolean pre_wifi_connected = false; + +/*If wifi is connecting, the update of wifi channel mask may fail caused by wifi FW*/ + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + + if (pre_wifi_connected != wifi_connected) + count = 0; + + if (count < 10) + count++; + + if (count == 2) { + if (wifi_connected) + ex_halbtc8192e2ant_media_status_notify(btcoexist, BTC_MEDIA_CONNECT); + else + ex_halbtc8192e2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); + } + + pre_wifi_connected = wifi_connected; +/*If wifi is connecting, the update of wifi channel mask may fail caused by wifi FW*/ + #if (BT_AUTO_REPORT_ONLY_8192E_2ANT == 0) halbtc8192e2ant_query_bt_info(btcoexist); halbtc8192e2ant_monitor_bt_ctr(btcoexist); + halbtc8192e2ant_monitor_wifi_ctr(btcoexist); halbtc8192e2ant_monitor_bt_enable_disable(btcoexist); #else + halbtc8192e2ant_monitor_wifi_ctr(btcoexist); + if (halbtc8192e2ant_is_wifi_status_changed(btcoexist) || coex_dm->auto_tdma_adjust) halbtc8192e2ant_run_coexist_mechanism(btcoexist); @@ -4066,3 +4270,4 @@ void ex_halbtc8192e2ant_periodical(IN struct btc_coexist *btcoexist) #endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e2ant.h similarity index 85% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e2Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e2ant.h index 085f992f0cb4..3b5a8acdf74f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8192e2Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8192e2ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -17,7 +31,7 @@ #define BT_INFO_8192E_2ANT_B_CONNECTION BIT(0) #define BTC_RSSI_COEX_THRESH_TOL_8192E_2ANT 2 -#define NOISY_AP_NUM_THRESH_8192E 10 +#define NOISY_AP_NUM_THRESH_8192E 10 enum bt_info_src_8192e_2ant { BT_INFO_SRC_8192E_2ANT_WIFI_FW = 0x0, @@ -134,6 +148,7 @@ struct coex_sta_8192e_2ant { boolean a2dp_exist; boolean hid_exist; boolean pan_exist; + boolean force_lps_on; boolean under_lps; boolean under_ips; @@ -151,6 +166,21 @@ struct coex_sta_8192e_2ant { u8 bt_retry_cnt; u8 bt_info_ext; u8 scan_ap_num; + u32 bt_coex_supported_version; + u32 cnt_setup_link; + u32 cnt_wifi_high_pri; + boolean is_setup_link; + boolean wifi_is_high_pri_task; + + u32 crc_ok_cck; + u32 crc_ok_11g; + u32 crc_ok_11n; + u32 crc_ok_11n_vht; + + u32 crc_err_cck; + u32 crc_err_11g; + u32 crc_err_11n; + u32 crc_err_11n_vht; }; /* ******************************************* @@ -197,3 +227,4 @@ void ex_halbtc8192e2ant_display_coex_info(IN struct btc_coexist *btcoexist); #endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8703b1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8703b1ant.c similarity index 57% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8703b1Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8703b1ant.c index 022566999824..86621f8f7035 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8703b1Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8703b1ant.c @@ -1,3 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + /* ************************************************************ * Description: * @@ -11,7 +26,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -33,9 +48,21 @@ const char *const glbt_info_src_8703b_1ant[] = { "BT Info[bt rsp]", "BT Info[bt auto report]", }; +/* ************************************************************ + * BtCoex Version Format: + * 1. date : glcoex_ver_date_XXXXX_1ant + * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant + * 3. BtCoexVersion : glcoex_ver_btdesired_XXXXX_1ant + * 4. others : glcoex_ver_XXXXXX_XXXXX_1ant + * + * Variable should be indicated IC and Antenna numbers !!! + * Please strictly follow this order and naming style !!! + * + * ************************************************************ */ +u32 glcoex_ver_date_8703b_1ant = 20170626; +u32 glcoex_ver_8703b_1ant = 0x1a; +u32 glcoex_ver_btdesired_8703b_1ant = 0x16; -u32 glcoex_ver_date_8703b_1ant = 20160218; -u32 glcoex_ver_8703b_1ant = 0x09; /* ************************************************************ * local function proto type if needed @@ -184,7 +211,7 @@ void halbtc8703b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, void halbtc8703b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 type) { - boolean wifi_under_b_mode = false; + boolean wifi_under_b_mode = FALSE; coex_dm->cur_arfr_type = type; @@ -324,7 +351,6 @@ void halbtc8703b1ant_query_bt_info(IN struct btc_coexist *btcoexist) { u8 h2c_parameter[1] = {0}; - coex_sta->c2h_bt_info_req_sent = true; h2c_parameter[0] |= BIT(0); /* trigger */ @@ -335,7 +361,8 @@ void halbtc8703b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) { u32 reg_hp_txrx, reg_lp_txrx, u32tmp; u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; - static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; + static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0, + cnt_autoslot_hang = 0; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ @@ -357,6 +384,31 @@ void halbtc8703b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) coex_sta->low_priority_tx = reg_lp_tx; coex_sta->low_priority_rx = reg_lp_rx; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); + + BTC_TRACE(trace_buf); + + if (BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + + if (coex_sta->high_priority_rx >= 15) { + if (cnt_overhead < 3) + cnt_overhead++; + + if (cnt_overhead == 3) + coex_sta->is_hiPri_rx_overhead = TRUE; + } else { + if (cnt_overhead > 0) + cnt_overhead--; + + if (cnt_overhead == 0) + coex_sta->is_hiPri_rx_overhead = FALSE; + } + } else + coex_sta->is_hiPri_rx_overhead = FALSE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); @@ -370,202 +422,222 @@ void halbtc8703b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) (!coex_sta->c2h_bt_inquiry_page)) coex_sta->pop_event_cnt++; - if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) - && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { + if ((coex_sta->low_priority_rx >= 1150) && + (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) + && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && + (coex_sta->bt_link_exist)) { if (cnt_slave >= 3) { - bt_link_info->slave_role = true; + bt_link_info->slave_role = TRUE; cnt_slave = 3; } else cnt_slave++; } else { if (cnt_slave == 0) { - bt_link_info->slave_role = false; + bt_link_info->slave_role = FALSE; cnt_slave = 0; } else cnt_slave--; } - if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && - (coex_sta->low_priority_rx == 0)) { - num_of_bt_counter_chk++; - if (num_of_bt_counter_chk >= 3) { - halbtc8703b1ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; + if (coex_sta->is_tdma_btautoslot) { + if ((coex_sta->low_priority_tx >= 1300) && + (coex_sta->low_priority_rx <= 150)) { + if (cnt_autoslot_hang >= 2) { + coex_sta->is_tdma_btautoslot_hang = TRUE; + cnt_autoslot_hang = 2; + } else + cnt_autoslot_hang++; + } else { + if (cnt_autoslot_hang == 0) { + coex_sta->is_tdma_btautoslot_hang = FALSE; + cnt_autoslot_hang = 0; + } else + cnt_autoslot_hang--; } } + if (bt_link_info->hid_only) { + if (coex_sta->low_priority_rx > 50) + coex_sta->is_hid_low_pri_tx_overhead = true; + else + coex_sta->is_hid_low_pri_tx_overhead = false; + } -#if 0 - /* Add Hi-Pri Tx/Rx counter to avoid false detection */ - if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && - (coex_sta->high_priority_tx + coex_sta->high_priority_rx - >= 160) - && (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->bt_hi_pri_link_exist = true; - else - coex_sta->bt_hi_pri_link_exist = false; - - if ((coex_sta->acl_busy) && - (coex_sta->num_of_profile == 0)) { - if (coex_sta->low_priority_tx + - coex_sta->low_priority_rx >= 160) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - coex_sta->wrong_profile_notification++; + if (!coex_sta->bt_disabled) { + if ((coex_sta->high_priority_tx == 0) && + (coex_sta->high_priority_rx == 0) && + (coex_sta->low_priority_tx == 0) && + (coex_sta->low_priority_rx == 0)) { + num_of_bt_counter_chk++; + if (num_of_bt_counter_chk >= 3) { + halbtc8703b1ant_query_bt_info(btcoexist); + num_of_bt_counter_chk = 0; + } } } -#endif } void halbtc8703b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) { - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false; - static u8 cck_lock_counter = 0; - u32 total_cnt; + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE, wifi_under_b_mode = FALSE, + wifi_scan = FALSE, wifi_connected = FALSE; + boolean bt_idle = FALSE, wl_idle = FALSE, is_cck_deadlock = FALSE; + static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, + wl_noisy_count1 = 3, wl_noisy_count2 = 0; + u32 total_cnt, reg_val1, reg_val2, cnt_cck; + u32 cnt_crcok = 0, cnt_crcerr = 0; + static u8 cnt = 0, cnt_ccklocking = 0; + u8 h2c_parameter[1] = {0}; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + /*send h2c to query WL FW dbg info */ + if (((coex_dm->cur_ps_tdma_on) && (coex_sta->force_lps_ctrl)) || + ((coex_sta->acl_busy) && (bt_link_info->a2dp_exist))) { + h2c_parameter[0] = 0x8; + btcoexist->btc_fill_h2c(btcoexist, 0x69, 1, h2c_parameter); + } btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &wifi_under_b_mode); - if (coex_sta->under_ips) { - coex_sta->crc_ok_cck = 0; - coex_sta->crc_ok_11g = 0; - coex_sta->crc_ok_11n = 0; - coex_sta->crc_ok_11n_agg = 0; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); - coex_sta->crc_err_cck = 0; - coex_sta->crc_err_11g = 0; - coex_sta->crc_err_11n = 0; - coex_sta->crc_err_11n_agg = 0; - } else { - coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf88); - coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf94); - coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf90); - coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfb8); + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); - coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf84); - coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf96); - coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf92); - coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfba); + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + + cnt_crcok = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + + coex_sta->crc_ok_11n_vht; + + cnt_crcerr = coex_sta->crc_err_cck + coex_sta->crc_err_11g + + coex_sta->crc_err_11n + + coex_sta->crc_err_11n_vht; + + /* CCK lock identification */ + if (coex_sta->cck_lock) + cnt_ccklocking++; + else if (cnt_ccklocking != 0) + cnt_ccklocking--; + + if (cnt_ccklocking >= 3) { + cnt_ccklocking = 3; + coex_sta->cck_lock_ever = TRUE; } + /* WiFi environment noisy identification */ + cnt_cck = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; - /* reset counter */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); + if ((!wifi_busy) && (!coex_sta->cck_lock)) { + if (cnt_cck > 250) { + if (wl_noisy_count2 < 3) + wl_noisy_count2++; - if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { - total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + - coex_sta->crc_ok_11n_agg; + if (wl_noisy_count2 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count1 = 0; + } - if ((coex_dm->bt_status == BT_8703B_1ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == - BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == - BT_8703B_1ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (total_cnt - - coex_sta->crc_ok_cck)) { - if (cck_lock_counter < 3) - cck_lock_counter++; - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; + } else if (cnt_cck < 50) { + if (wl_noisy_count0 < 3) + wl_noisy_count0++; + + if (wl_noisy_count0 == 3) { + wl_noisy_count1 = 0; + wl_noisy_count2 = 0; } } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; + if (wl_noisy_count1 < 3) + wl_noisy_count1++; + + if (wl_noisy_count1 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count2 = 0; + } } - if (!coex_sta->pre_ccklock) { - - if (cck_lock_counter >= 3) - coex_sta->cck_lock = true; + if (wl_noisy_count2 == 3) + coex_sta->wl_noisy_level = 2; + else if (wl_noisy_count1 == 3) + coex_sta->wl_noisy_level = 1; else - coex_sta->cck_lock = false; - } else { - if (cck_lock_counter == 0) - coex_sta->cck_lock = false; - else - coex_sta->cck_lock = true; + coex_sta->wl_noisy_level = 0; } - if (coex_sta->cck_lock) - coex_sta->cck_ever_lock = true; - - coex_sta->pre_ccklock = coex_sta->cck_lock; - - } -boolean halbtc8703b1ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) -{ - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false, pre_bt_off = false; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - if (coex_sta->bt_disabled != pre_bt_off) { - pre_bt_off = coex_sta->bt_disabled; - - if (coex_sta->bt_disabled) - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); - else - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); - - BTC_TRACE(trace_buf); - return true; - } - - if (wifi_connected) { - if (wifi_busy != pre_wifi_busy) { - pre_wifi_busy = wifi_busy; - return true; - } - if (under_4way != pre_under_4way) { - pre_under_4way = under_4way; - return true; - } - if (bt_hs_on != pre_bt_hs_on) { - pre_bt_hs_on = bt_hs_on; - return true; - } - } - - return false; -} void halbtc8703b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; + boolean bt_hs_on = FALSE; + boolean bt_busy = FALSE; + + + coex_sta->num_of_profile = 0; + + /* set link exist status */ + if (!(coex_sta->bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { + coex_sta->bt_link_exist = FALSE; + coex_sta->pan_exist = FALSE; + coex_sta->a2dp_exist = FALSE; + coex_sta->hid_exist = FALSE; + coex_sta->sco_exist = FALSE; + } else { /* connection exists */ + coex_sta->bt_link_exist = TRUE; + if (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_FTP) { + coex_sta->pan_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->pan_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_A2DP) { + coex_sta->a2dp_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->a2dp_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_HID) { + coex_sta->hid_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->hid_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) { + coex_sta->sco_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->sco_exist = FALSE; + + } btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); @@ -574,13 +646,12 @@ void halbtc8703b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) bt_link_info->a2dp_exist = coex_sta->a2dp_exist; bt_link_info->pan_exist = coex_sta->pan_exist; bt_link_info->hid_exist = coex_sta->hid_exist; - bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; bt_link_info->acl_busy = coex_sta->acl_busy; /* work around for HS mode. */ if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; + bt_link_info->pan_exist = TRUE; + bt_link_info->bt_link_exist = TRUE; } /* check if Sco only */ @@ -588,38 +659,84 @@ void halbtc8703b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->sco_only = true; + bt_link_info->sco_only = TRUE; else - bt_link_info->sco_only = false; + bt_link_info->sco_only = FALSE; /* check if A2dp only */ if (!bt_link_info->sco_exist && bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->a2dp_only = true; + bt_link_info->a2dp_only = TRUE; else - bt_link_info->a2dp_only = false; + bt_link_info->a2dp_only = FALSE; /* check if Pan only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->pan_only = true; + bt_link_info->pan_only = TRUE; else - bt_link_info->pan_only = false; + bt_link_info->pan_only = FALSE; /* check if Hid only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && bt_link_info->hid_exist) - bt_link_info->hid_only = true; + bt_link_info->hid_only = TRUE; else - bt_link_info->hid_only = false; + bt_link_info->hid_only = FALSE; + + if (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_INQ_PAGE) { + coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_INQ_PAGE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); + } else if (!(coex_sta->bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { + coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); + } else if (coex_sta->bt_info == BT_INFO_8703B_1ANT_B_CONNECTION) { + /* connection exists but no busy */ + coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); + } else if (((coex_sta->bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_SCO_BUSY)) && + (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_ACL_BUSY)) { + coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); + } else if ((coex_sta->bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_SCO_BUSY)) { + coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); + } else if (coex_sta->bt_info & BT_INFO_8703B_1ANT_B_ACL_BUSY) { + coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_ACL_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); + } else { + coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_MAX; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); + } + + BTC_TRACE(trace_buf); + + if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + bt_busy = TRUE; + else + bt_busy = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); } + void halbtc8703b1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, IN u8 type) { @@ -707,6 +824,7 @@ void halbtc8703b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) return; } + halbtc8703b1ant_set_fw_low_penalty_ra(btcoexist, coex_dm->cur_low_penalty_ra); @@ -716,7 +834,7 @@ void halbtc8703b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, void halbtc8703b1ant_write_score_board( IN struct btc_coexist *btcoexist, IN u16 bitpos, - IN BOOLEAN state + IN boolean state ) { @@ -748,38 +866,131 @@ void halbtc8703b1ant_read_score_board( 0xaa)) & 0x7fff; } -void halbtc8703b1ant_post_activestate_to_bt( +void halbtc8703b1ant_post_state_to_bt( IN struct btc_coexist *btcoexist, - IN boolean wifi_active + IN u16 type, + IN boolean state ) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8703b1ant_post_state_to_bt: type = %d, state =%d\n", + type, state); + BTC_TRACE(trace_buf); - if (wifi_active) - halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); - else - halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); - - /* The BT should set "No Shunt-down" mode if WL = Active for BT Synthesizer on/off interference WL Lo issue at 8703b b-cut. */ - + halbtc8703b1ant_write_score_board(btcoexist, (u16) type, state); } -void halbtc8703b1ant_post_onoffState_to_bt( - IN struct btc_coexist *btcoexist, - IN boolean wifi_on -) +boolean halbtc8703b1ant_is_wifibt_status_changed(IN struct btc_coexist + *btcoexist) { + static boolean pre_wifi_busy = FALSE, pre_under_4way = FALSE, + pre_bt_hs_on = FALSE, pre_bt_off = FALSE, + pre_bt_slave = FALSE, pre_hid_low_pri_tx_overhead = FALSE, + pre_wifi_under_lps = FALSE, pre_bt_setup_link = FALSE, + pre_cck_lock = FALSE, pre_cck_lock_warn = FALSE; + static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; + boolean wifi_busy = FALSE, under_4way = FALSE, bt_hs_on = FALSE; + boolean wifi_connected = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - if (wifi_on) - halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); - else - halbtc8703b1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + if (coex_sta->bt_disabled != pre_bt_off) { + pre_bt_off = coex_sta->bt_disabled; + + if (coex_sta->bt_disabled) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is enabled !!\n"); + + BTC_TRACE(trace_buf); + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + + return TRUE; + } + + if (wifi_connected) { + if (wifi_busy != pre_wifi_busy) { + pre_wifi_busy = wifi_busy; + + if (wifi_busy) + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, TRUE); + else + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, FALSE); + return TRUE; + } + if (under_4way != pre_under_4way) { + pre_under_4way = under_4way; + return TRUE; + } + if (bt_hs_on != pre_bt_hs_on) { + pre_bt_hs_on = bt_hs_on; + return TRUE; + } + if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { + pre_wl_noisy_level = coex_sta->wl_noisy_level; + return TRUE; + } + if (coex_sta->under_lps != pre_wifi_under_lps) { + pre_wifi_under_lps = coex_sta->under_lps; + if (coex_sta->under_lps == TRUE) + return TRUE; + } + if (coex_sta->cck_lock != pre_cck_lock) { + pre_cck_lock = coex_sta->cck_lock; + return TRUE; + } + if (coex_sta->cck_lock_warn != pre_cck_lock_warn) { + pre_cck_lock_warn = coex_sta->cck_lock_warn; + return TRUE; + } + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->hid_busy_num != pre_hid_busy_num) { + pre_hid_busy_num = coex_sta->hid_busy_num; + return TRUE; + } + + if (bt_link_info->slave_role != pre_bt_slave) { + pre_bt_slave = bt_link_info->slave_role; + return TRUE; + } + + if (pre_hid_low_pri_tx_overhead != coex_sta->is_hid_low_pri_tx_overhead) { + pre_hid_low_pri_tx_overhead = coex_sta->is_hid_low_pri_tx_overhead; + return TRUE; + } + + if (pre_bt_setup_link != coex_sta->is_setupLink) { + pre_bt_setup_link = coex_sta->is_setupLink; + return TRUE; + } + } + + return FALSE; } + void halbtc8703b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) { static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; + boolean bt_active = TRUE, bt_disabled = FALSE; u16 u16tmp; /* This function check if bt is disabled */ @@ -788,12 +999,12 @@ void halbtc8703b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) coex_sta->high_priority_rx == 0 && coex_sta->low_priority_tx == 0 && coex_sta->low_priority_rx == 0) - bt_active = false; + bt_active = FALSE; if (coex_sta->high_priority_tx == 0xffff && coex_sta->high_priority_rx == 0xffff && coex_sta->low_priority_tx == 0xffff && coex_sta->low_priority_rx == 0xffff) - bt_active = false; + bt_active = FALSE; #else /* 8703b BT can't show correct on/off status in scoreboard[1] 2015/11/26 */ @@ -807,21 +1018,25 @@ void halbtc8703b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) if (bt_active) { bt_disable_cnt = 0; - bt_disabled = false; + bt_disabled = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, &bt_disabled); } else { bt_disable_cnt++; - if (bt_disable_cnt >= 2) { - bt_disabled = true; - bt_disable_cnt = 2; + if (bt_disable_cnt >= 10) { + bt_disabled = TRUE; + bt_disable_cnt = 10; } btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, &bt_disabled); } + if (bt_disabled) + halbtc8703b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); + else + halbtc8703b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, TRUE); if (coex_sta->bt_disabled != bt_disabled) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -834,6 +1049,8 @@ void halbtc8703b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) } } + + void halbtc8703b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, IN boolean isenable) { @@ -860,44 +1077,53 @@ void halbtc8703b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, u32 halbtc8703b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, IN u16 reg_addr) { - u32 j = 0; + u32 j = 0, delay_count = 0; + /* wait for ready bit before access 0x7c0/0x7c4 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } - /* wait for ready bit before access 0x7c0 */ btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x7c3)&BIT(5)) == 0) && - (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - return btcoexist->btc_read_4byte(btcoexist, 0x7c8); /* get read data */ } -void halbtc8703b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, +void halbtc8703b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist + *btcoexist, IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) { - u32 val, i = 0, j = 0, bitpos = 0; - + u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; if (bit_mask == 0x0) return; if (bit_mask == 0xffffffff) { + /* wait for ready bit before access 0x7c0/0x7c4 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x7c4, reg_value); /* put write data */ - /* wait for ready bit before access 0x7c0 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x7c3)&BIT(5)) == 0) && - (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0xc00F0000 | reg_addr); } else { @@ -913,17 +1139,22 @@ void halbtc8703b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist reg_addr); val = (val & (~bit_mask)) | (reg_value << bitpos); + /* wait for ready bit before access 0x7c0/0x7c4 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x7c4, val); /* put write data */ - /* wait for ready bit before access 0x7c0 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x7c3)&BIT(5)) == 0) && - (j < BT_8703B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0xc00F0000 | reg_addr); @@ -942,12 +1173,6 @@ void halbtc8703b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, } -void halbtc8703b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, - IN boolean low_penalty_ra) -{ - halbtc8703b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - void halbtc8703b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, IN boolean wifi_control) { @@ -962,69 +1187,69 @@ void halbtc8703b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, void halbtc8703b1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, IN u8 control_block, IN boolean sw_control, IN u8 state) { - u32 val = 0, bit_mask; + u32 val = 0, val_orig = 0; - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; + if (!sw_control) + val = 0x0; + else if (state & 0x1) + val = 0x3; + else + val = 0x1; + + val_orig = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); switch (control_block) { case BT_8703B_1ANT_GNT_BLOCK_RFC_BB: default: - bit_mask = 0xc000; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ - bit_mask = 0x0c00; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ + val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); break; case BT_8703B_1ANT_GNT_BLOCK_RFC: - bit_mask = 0xc000; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ + val = (val << 14) | (val_orig & 0xffff3fff); break; case BT_8703B_1ANT_GNT_BLOCK_BB: - bit_mask = 0x0c00; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ + val = (val << 10) | (val_orig & 0xfffff3ff); break; - } + halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, 0xffffffff, val); } + void halbtc8703b1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, IN u8 control_block, IN boolean sw_control, IN u8 state) { - u32 val = 0, bit_mask; + u32 val = 0, val_orig = 0; - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; + if (!sw_control) + val = 0x0; + else if (state & 0x1) + val = 0x3; + else + val = 0x1; + + val_orig = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); switch (control_block) { case BT_8703B_1ANT_GNT_BLOCK_RFC_BB: default: - bit_mask = 0x3000; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ - bit_mask = 0x0300; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ + val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); break; case BT_8703B_1ANT_GNT_BLOCK_RFC: - bit_mask = 0x3000; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ + val = (val << 12) | (val_orig & 0xffffcfff); break; case BT_8703B_1ANT_GNT_BLOCK_BB: - bit_mask = 0x0300; - halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ + val = (val << 8) | (val_orig & 0xfffffcff); break; - } + halbtc8703b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, 0xffffffff, val); } + void halbtc8703b1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, IN u8 table_type, IN u16 table_content) { @@ -1074,6 +1299,42 @@ void halbtc8703b1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, } +void halbtc8703b1ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 interval, + IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, + IN u8 val0x6c4_b3) +{ + static u8 pre_h2c_parameter[6] = {0}; + u8 cur_h2c_parameter[6] = {0}; + u8 i, match_cnt = 0; + + cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ + + cur_h2c_parameter[1] = interval; + cur_h2c_parameter[2] = val0x6c4_b0; + cur_h2c_parameter[3] = val0x6c4_b1; + cur_h2c_parameter[4] = val0x6c4_b2; + cur_h2c_parameter[5] = val0x6c4_b3; + + if (!force_exec) { + for (i = 1; i <= 5; i++) { + if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) + break; + + match_cnt++; + } + + if (match_cnt == 5) + return; + } + + for (i = 1; i <= 5; i++) + pre_h2c_parameter[i] = cur_h2c_parameter[i]; + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); +} + + void halbtc8703b1ant_set_coex_table(IN struct btc_coexist *btcoexist, IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) { @@ -1119,7 +1380,7 @@ void halbtc8703b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, coex_sta->coex_table_type = type; - if (coex_sta->concurrent_rx_mode_on == true) { + if (coex_sta->concurrent_rx_mode_on == TRUE) { break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ select_table = 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ @@ -1136,7 +1397,7 @@ void halbtc8703b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, break; case 1: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, + 0xa5555555, 0xaa5a5a5a, break_table, select_table); break; case 2: @@ -1146,67 +1407,57 @@ void halbtc8703b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, break; case 3: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xaa555555, 0xaa5a5a5a, break_table, + 0x55555555, 0x5a5a5a5a, break_table, select_table); break; case 4: - halbtc8703b1ant_coex_table(btcoexist, - force_exec, 0xaa555555, 0xaa5a5a5a, - break_table, select_table); + halbtc8703b1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, + select_table); break; case 5: - halbtc8703b1ant_coex_table(btcoexist, - force_exec, 0x5a5a5a5a, 0x5a5a5a5a, - break_table, select_table); + halbtc8703b1ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0x5a5a5a5a, break_table, + select_table); break; case 6: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaaaaa, break_table, + 0xa5555555, 0xaa5a5a5a, break_table, select_table); break; case 7: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, break_table, + 0xaa555555, 0xaa555555, break_table, select_table); break; case 8: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, + 0xa5555555, 0xaaaa5aaa, break_table, select_table); break; case 9: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, + 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); break; case 10: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, + 0xaaaaaaaa, 0xaaaaaaaa, break_table, select_table); break; case 11: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, + 0xa5a55555, 0xaaaa5a5a, break_table, select_table); break; case 12: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, + 0xa5555555, 0xaaaa5a5a, break_table, select_table); break; case 13: halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0xaaaaaaaa, break_table, - select_table); - break; - case 14: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5ada5ada, break_table, - select_table); - break; - case 15: - halbtc8703b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0xaaaaaaaa, break_table, + 0xaa5555aa, 0xaa5a5a5a, break_table, select_table); break; default: @@ -1219,9 +1470,8 @@ void halbtc8703b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[1] = {0}; - if (enable) { - h2c_parameter[0] |= BIT(0); /* function enable */ - } + if (enable) + h2c_parameter[0] |= BIT(0);/* function enable */ btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); } @@ -1281,16 +1531,14 @@ void halbtc8703b1ant_ps_tdma_check_for_power_save_state( /* keep state under LPS, do nothing. */ } else { /* will leave LPS state, turn off psTdma first */ - /*halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); */ - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); } } else { /* NO PS state */ if (new_ps_state) { /* will enter LPS state, turn off psTdma first */ - /*halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8);*/ - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); } else { /* keep state under NO PS state, do nothing. */ } @@ -1300,28 +1548,28 @@ void halbtc8703b1ant_ps_tdma_check_for_power_save_state( void halbtc8703b1ant_power_save_state(IN struct btc_coexist *btcoexist, IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) { - boolean low_pwr_disable = false; + boolean low_pwr_disable = FALSE; switch (ps_type) { case BTC_PS_WIFI_NATIVE: /* recover to original 32k low power setting */ - coex_sta->force_lps_on = false; - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, + coex_sta->force_lps_ctrl = FALSE; + low_pwr_disable = FALSE; + /* btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + &low_pwr_disable); */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_PRE_NORMAL_LPS, NULL); break; case BTC_PS_LPS_ON: - coex_sta->force_lps_on = true; + coex_sta->force_lps_ctrl = TRUE; halbtc8703b1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); + btcoexist, TRUE); halbtc8703b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, lps_val, rpwm_val); /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; + low_pwr_disable = TRUE; btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); @@ -1331,9 +1579,9 @@ void halbtc8703b1ant_power_save_state(IN struct btc_coexist *btcoexist, break; case BTC_PS_LPS_OFF: - coex_sta->force_lps_on = false; + coex_sta->force_lps_ctrl = TRUE; halbtc8703b1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); + btcoexist, FALSE); btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, NULL); @@ -1350,36 +1598,51 @@ void halbtc8703b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[5] = {0}; u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; + boolean ap_enable = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 ps_type = BTC_PS_WIFI_NATIVE; + + if (byte5 & BIT(2)) + coex_sta->is_tdma_btautoslot = TRUE; + else + coex_sta->is_tdma_btautoslot = FALSE; + + /* release bt-auto slot for auto-slot hang is detected!! */ + if (coex_sta->is_tdma_btautoslot) + if ((coex_sta->is_tdma_btautoslot_hang) || + (bt_link_info->slave_role)) + byte5 = byte5 & 0xfb; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], FW for 1Ant AP mode\n"); - BTC_TRACE(trace_buf); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], FW for AP mode\n"); + BTC_TRACE(trace_buf); + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); - halbtc8703b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8703b1ant_power_save_state(btcoexist, + ps_type, 0x0, + 0x0); } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + ps_type = BTC_PS_LPS_ON; halbtc8703b1ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, + btcoexist, ps_type, 0x50, 0x4); } else { - halbtc8703b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8703b1ant_power_save_state(btcoexist, ps_type, + 0x0, 0x0); } - h2c_parameter[0] = real_byte1; h2c_parameter[1] = byte2; h2c_parameter[2] = byte3; @@ -1393,6 +1656,9 @@ void halbtc8703b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, coex_dm->ps_tdma_para[4] = real_byte5; btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + + if (ps_type == BTC_PS_WIFI_NATIVE) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_POST_NORMAL_LPS, NULL); } @@ -1400,10 +1666,10 @@ void halbtc8703b1ant_ps_tdma(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean turn_on, IN u8 type) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; u8 rssi_adjust_val = 0; static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; - static boolean pre_wifi_busy = false; + static boolean pre_wifi_busy = FALSE; coex_dm->cur_ps_tdma_on = turn_on; coex_dm->cur_ps_tdma = type; @@ -1411,7 +1677,7 @@ void halbtc8703b1ant_ps_tdma(IN struct btc_coexist *btcoexist, btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); if (wifi_busy != pre_wifi_busy) { - force_exec = true; + force_exec = TRUE; pre_wifi_busy = wifi_busy; } @@ -1423,7 +1689,7 @@ void halbtc8703b1ant_ps_tdma(IN struct btc_coexist *btcoexist, if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { - force_exec = true; + force_exec = TRUE; pre_psTdmaByte4Modify = psTdmaByte4Modify; } @@ -1456,74 +1722,129 @@ void halbtc8703b1ant_ps_tdma(IN struct btc_coexist *btcoexist, switch (type) { default: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); + 0x61, 0x35, 0x03, 0x11, 0x11); break; - case 3: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x3a, 0x03, 0x10, 0x10); + 0x51, 0x30, 0x03, 0x10, 0x50); break; case 4: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x21, 0x03, 0x10, 0x10); + 0x51, 0x21, 0x03, 0x10, 0x50); break; case 5: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x11); + 0x61, 0x3a, 0x03, 0x11, 0x11); break; case 6: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x20, 0x03, 0x11, 0x11); + 0x61, 0x20, 0x03, 0x11, 0x11); break; case 7: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); + 0x51, 0x10, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); break; case 8: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); + 0x51, 0x10, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 9: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 10: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x30, 0x03, 0x11, 0x10); + break; + case 11: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x25, 0x03, 0x11, 0x11 | + psTdmaByte4Modify); + break; + case 12: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x35, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); break; case 13: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); + 0x51, 0x25, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); break; case 14: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); + 0x51, 0x15, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); break; case 15: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); + 0x51, 0x20, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 16: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x15 | + psTdmaByte4Modify); break; case 17: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); + 0x61, 0x10, 0x03, 0x11, 0x14); + break; + case 18: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x30, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); break; case 19: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x10); + 0x61, 0x15, 0x03, 0x11, 0x10); break; case 20: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); + 0x61, 0x30, 0x03, 0x11, 0x10); break; case 21: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); + 0x61, 0x30, 0x03, 0x11, 0x10); break; case 22: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x25, 0x03, 0x11, 0x10); + 0x61, 0x25, 0x03, 0x11, 0x10); + break; + case 27: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x15); + break; + case 28: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x0b, 0x10, 0x54); break; case 32: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); + 0x61, 0x35, 0x03, 0x11, 0x11); break; case 33: halbtc8703b1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x10); + 0x61, 0x35, 0x03, 0x11, 0x10); + break; + case 57: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 58: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 67: + halbtc8703b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x10 | + psTdmaByte4Modify); break; - } } else { @@ -1531,39 +1852,42 @@ void halbtc8703b1ant_ps_tdma(IN struct btc_coexist *btcoexist, switch (type) { case 8: /* PTA Control */ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); + 0x0, 0x0, 0x0, 0x0); break; case 0: default: /* Software control, Antenna at BT side */ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); + 0x0, 0x0, 0x0, 0x0); break; case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ halbtc8703b1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); + 0x0, 0x0, 0x48, 0x0); break; } } - /* update pre state */ - coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; - coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; } void halbtc8703b1ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, - IN boolean wifi_off) + IN u8 ant_pos_type, IN boolean force_exec, + IN u8 phase) { - u32 cnt_bt_cal_chk = 0; - boolean is_in_mp_mode = false; - u8 u8tmp = 0; - u32 u32tmp1 = 0, u32tmp2 = 0; + u32 cnt_bt_cal_chk = 0; + boolean is_in_mp_mode = FALSE; + u8 u8tmp = 0; + u32 u32tmp1 = 0, u32tmp2 = 0; - coex_dm->cur_ant_pos_type = ant_pos_type; + + u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + + /* To avoid indirect access fail */ + if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { + force_exec = TRUE; + coex_sta->gnt_error_cnt++; + } #if 1 - u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); @@ -1574,31 +1898,53 @@ void halbtc8703b1ant_set_ant_path(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); #endif - if (init_hwcfg) { + coex_dm->cur_ant_pos_type = ant_pos_type; + + if (!force_exec) { + if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** Skip Antenna Path Setup because no change!!**********\n"); + BTC_TRACE(trace_buf); + return; + } + } + + coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; + + switch (phase) { + case BT_8703B_1ANT_PHASE_COEX_INIT: /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ halbtc8703b1ant_ltecoex_enable(btcoexist, 0x0); /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8703b1ant_ltecoex_set_coex_table(btcoexist, - BT_8703B_1ANT_CTT_WL_VS_LTE, 0xffff); + halbtc8703b1ant_ltecoex_set_coex_table( + btcoexist, + BT_8703B_1ANT_CTT_WL_VS_LTE, + 0xffff); /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8703b1ant_ltecoex_set_coex_table(btcoexist, - BT_8703B_1ANT_CTT_BT_VS_LTE, 0xffff); + halbtc8703b1ant_ltecoex_set_coex_table( + btcoexist, + BT_8703B_1ANT_CTT_BT_VS_LTE, + 0xffff); /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ while (cnt_bt_cal_chk <= 20) { - u8tmp = btcoexist->btc_read_1byte(btcoexist, - 0x49d); + u8tmp = btcoexist->btc_read_1byte( + btcoexist, + 0x49d); cnt_bt_cal_chk++; if (u8tmp & BIT(0)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", cnt_bt_cal_chk); BTC_TRACE(trace_buf); delay_ms(50); } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", cnt_bt_cal_chk); BTC_TRACE(trace_buf); @@ -1606,9 +1952,11 @@ void halbtc8703b1ant_set_ant_path(IN struct btc_coexist *btcoexist, } } + /* set Path control owner to WL at initial step */ - halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8703B_1ANT_PCO_WLSIDE); + halbtc8703b1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8703B_1ANT_PCO_WLSIDE); /* set GNT_BT to SW high */ halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, @@ -1621,107 +1969,126 @@ void halbtc8703b1ant_set_ant_path(IN struct btc_coexist *btcoexist, BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, BT_8703B_1ANT_SIG_STA_SET_TO_LOW); - coex_sta->gnt_control_by_PTA = false; + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; - } else if (wifi_off) { + coex_sta->run_time_state = FALSE; + break; + case BT_8703B_1ANT_PHASE_WLANONLY_INIT: + /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ + halbtc8703b1ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8703b1ant_ltecoex_set_coex_table( + btcoexist, + BT_8703B_1ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8703b1ant_ltecoex_set_coex_table( + btcoexist, + BT_8703B_1ANT_CTT_BT_VS_LTE, + 0xffff); + + /* set Path control owner to WL at initial step */ + halbtc8703b1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8703B_1ANT_PCO_WLSIDE); + + /* set GNT_BT to SW low */ + halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8703B_1ANT_GNT_BLOCK_RFC_BB, + BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8703B_1ANT_SIG_STA_SET_TO_LOW); + /* Set GNT_WL to SW high */ + halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8703B_1ANT_GNT_BLOCK_RFC_BB, + BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = + BTC_ANT_PATH_WIFI; + + coex_sta->run_time_state = FALSE; + break; + case BT_8703B_1ANT_PHASE_WLAN_OFF: /* Disable LTE Coex Function in WiFi side */ halbtc8703b1ant_ltecoex_enable(btcoexist, 0x0); /* set Path control owner to BT */ - halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8703B_1ANT_PCO_BTSIDE); + halbtc8703b1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8703B_1ANT_PCO_BTSIDE); - coex_sta->gnt_control_by_PTA = false; - } else { + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; - halbtc8703b1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8703B_1ANT_PCO_WLSIDE); + coex_sta->run_time_state = FALSE; + break; + case BT_8703B_1ANT_PHASE_2G_RUNTIME: + halbtc8703b1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8703B_1ANT_PCO_WLSIDE); - - if (force_exec || - (coex_dm->cur_ant_pos_type != coex_dm->pre_ant_pos_type) || - init_hwcfg || wifi_off) { - /* internal switch setting */ - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - /* set GNT_BT to low */ - halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8703B_1ANT_GNT_BLOCK_RFC_BB, - BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8703B_1ANT_SIG_STA_SET_TO_LOW); - /* Set GNT_WL to high */ - halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8703B_1ANT_GNT_BLOCK_RFC_BB, - BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); - - coex_sta->gnt_control_by_PTA = false; - break; - case BTC_ANT_PATH_BT: - /*halbtc8703b1ant_ltecoex_pathcontrol_owner( - btcoexist, BT_8703B_1ANT_PCO_BTSIDE);*/ - /* set GNT_BT to high */ - halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8703B_1ANT_GNT_BLOCK_RFC_BB, - BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to low */ - halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8703B_1ANT_GNT_BLOCK_RFC_BB, - BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8703B_1ANT_SIG_STA_SET_TO_LOW); - - coex_sta->gnt_control_by_PTA = false; - break; - default: - case BTC_ANT_PATH_PTA: - /* set GNT_BT to PTA */ - halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, + /* set GNT_BT to PTA */ + halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, BT_8703B_1ANT_GNT_BLOCK_RFC_BB, BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA, BT_8703B_1ANT_SIG_STA_SET_BY_HW); - /* Set GNT_WL to PTA */ - halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, + /* Set GNT_WL to PTA */ + halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, BT_8703B_1ANT_GNT_BLOCK_RFC_BB, BT_8703B_1ANT_GNT_TYPE_CTRL_BY_PTA, BT_8703B_1ANT_SIG_STA_SET_BY_HW); - coex_sta->gnt_control_by_PTA = true; - break; - } - } + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_PTA; + + coex_sta->run_time_state = TRUE; + break; + case BT_8703B_1ANT_PHASE_BTMPMODE: + halbtc8703b1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8703B_1ANT_PCO_WLSIDE); + + /* set GNT_BT to high */ + halbtc8703b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8703B_1ANT_GNT_BLOCK_RFC_BB, + BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8703B_1ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to low */ + halbtc8703b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8703B_1ANT_GNT_BLOCK_RFC_BB, + BT_8703B_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8703B_1ANT_SIG_STA_SET_TO_LOW); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; + + coex_sta->run_time_state = FALSE; + break; } + #if 1 u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); u32tmp2 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); - if (init_hwcfg) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ant-Setup Init) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u8tmp, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - } else if (wifi_off) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ant-Setup WiFi off) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u8tmp, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ant-Setup Run time) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u8tmp, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - } -#endif - coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (After Ant-Setup) 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", + u8tmp, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); + +#endif } boolean halbtc8703b1ant_is_common_action(IN struct btc_coexist *btcoexist) { - boolean common = false, wifi_connected = false, wifi_busy = false; + boolean common = FALSE, wifi_connected = FALSE, wifi_busy = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); @@ -1733,47 +2100,35 @@ boolean halbtc8703b1ant_is_common_action(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); BTC_TRACE(trace_buf); - - /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ - - common = true; + common = TRUE; } else if (wifi_connected && (BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected + BT non connected-idle!!\n"); BTC_TRACE(trace_buf); - - /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ - - common = true; + common = TRUE; } else if (!wifi_connected && - (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { + (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); BTC_TRACE(trace_buf); - - /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ - - common = true; + common = TRUE; } else if (wifi_connected && - (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { + (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected + BT connected-idle!!\n"); BTC_TRACE(trace_buf); - - /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ - - common = true; + common = TRUE; } else if (!wifi_connected && - (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { + (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE != + coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); BTC_TRACE(trace_buf); - - /* halbtc8703b1ant_sw_mechanism(btcoexist, false); */ - - common = true; + common = TRUE; } else { if (wifi_busy) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -1785,77 +2140,12 @@ boolean halbtc8703b1ant_is_common_action(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); } - common = false; + common = FALSE; } return common; } -/* ********************************************* - * - * Software Coex Mechanism start - * - * ********************************************* */ - -/* SCO only or SCO+PAN(HS) */ - -/* -void halbtc8703b1ant_action_sco(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8703b1ant_action_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8703b1ant_action_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8703b1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8703b1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8703b1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8703b1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8703b1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8703b1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, true); -} - -void halbtc8703b1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8703b1ant_sw_mechanism(btcoexist, true); -} - -*/ /* ********************************************* * @@ -1865,9 +2155,9 @@ void halbtc8703b1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) u8 halbtc8703b1ant_action_algorithm(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - u8 algorithm = BT_8703B_1ANT_COEX_ALGO_UNDEFINED; - u8 num_of_diff_profile = 0; + boolean bt_hs_on = FALSE; + u8 algorithm = BT_8703B_1ANT_COEX_ALGO_UNDEFINED; + u8 num_of_diff_profile = 0; btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); @@ -2066,44 +2356,63 @@ u8 halbtc8703b1ant_action_algorithm(IN struct btc_coexist *btcoexist) return algorithm; } - - -void halbtc8703b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) +void halbtc8703b1ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); } -void halbtc8703b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) +void halbtc8703b1ant_action_bt_hs(IN struct btc_coexist *btcoexist) { - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, - false, false); - halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -} - -void halbtc8703b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } -void halbtc8703b1ant_action_hs(IN struct btc_coexist *btcoexist) +void halbtc8703b1ant_action_bt_relink(IN struct btc_coexist *btcoexist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + if (coex_sta->is_bt_multi_link == TRUE) + return; + + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); +} + +void halbtc8703b1ant_action_bt_idle(IN struct btc_coexist *btcoexist) +{ + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_busy) { + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); + } else {/* if wl busy */ + + if (BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + + if (coex_sta->is_hiPri_rx_overhead) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + else + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + } else { + + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + } + } } void halbtc8703b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, ap_enable = false, wifi_busy = false, - bt_busy = false; - boolean wifi_scan = false, wifi_link = false, wifi_roam = false; + boolean wifi_connected = FALSE, ap_enable = FALSE, wifi_busy = FALSE, + bt_busy = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); @@ -2118,502 +2427,303 @@ void halbtc8703b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { - - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + } else if (((wifi_scan) || (wifi_busy)) && + (coex_sta->bt_create_connection)) { + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); } else if ((!wifi_connected) && (!wifi_scan)) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { + + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); } else if (bt_link_info->a2dp_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); } else if (wifi_scan) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 20); } else if (wifi_busy) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); } } void halbtc8703b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) + *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false; + boolean wifi_connected = FALSE, wifi_busy = FALSE, wifi_cckdeadlock_ap = FALSE; + u32 wifi_bw = 1; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); - /* tdma and coex table */ + if ((iot_peer == BTC_IOT_PEER_ATHEROS) && (coex_sta->cck_lock_ever)) + wifi_cckdeadlock_ap = TRUE; if (bt_link_info->sco_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else { /* HID */ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); + } else { + if ((wifi_cckdeadlock_ap) && (coex_sta->is_bt_multi_link)) { + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 18); + } else if (coex_sta->is_hid_low_pri_tx_overhead) { + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 18); + } else if (wifi_bw == 0) { /* if 11bg mode */ + + if (coex_sta->is_bt_multi_link) { + halbtc8703b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 11); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } else { + halbtc8703b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 11); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } + } else { + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } } } + +void halbtc8703b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) +{ + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); + halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 10); + halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); +} + +void halbtc8703b1ant_action_wifi_native_lps(IN struct btc_coexist *btcoexist) +{ + halbtc8703b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 5); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + +void halbtc8703b1ant_action_wifi_cck_dead_lock(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if ((bt_link_info->hid_exist) && (bt_link_info->a2dp_exist) && + (!bt_link_info->pan_exist)) { + + if ((coex_sta->cck_lock) || (coex_sta->cck_lock_warn)) { + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 28); + } else { + + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } + } +} + +void halbtc8703b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); + + if ((BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) || + (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + else if (!bt_link_info->pan_exist) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + else + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + +void halbtc8703b1ant_action_wifi_linkscan_process(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (bt_link_info->pan_exist) + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + else if (bt_link_info->a2dp_exist) + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 27); + else + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); +} + void halbtc8703b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) + *btcoexist) { + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = FALSE, wifi_turbo = FALSE, wifi_cckdeadlock_ap = FALSE; + u32 wifi_bw = 1; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false; - - + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy_level = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); - if (bt_link_info->hid_only) { /* HID */ - halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, - wifi_status); - coex_dm->auto_tdma_adjust = false; - return; + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; + + if ((iot_peer == BTC_IOT_PEER_ATHEROS) && (coex_sta->cck_lock_ever)) + wifi_cckdeadlock_ap = TRUE; + + if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { + + if (wifi_cckdeadlock_ap) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 12); } else if (bt_link_info->a2dp_only) { /* A2DP */ - if (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - if (coex_sta->scan_ap_num >= - BT_8703B_1ANT_WIFI_NOISY_THRESH) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 17); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 7); - } + if (wifi_cckdeadlock_ap) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else if (wifi_turbo) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + else + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = true; - } - } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || - (bt_link_info->hid_exist && bt_link_info->a2dp_exist && + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); + } else if (((bt_link_info->a2dp_exist) && + (bt_link_info->pan_exist)) || + (bt_link_info->hid_exist && bt_link_info->a2dp_exist && bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ - if (wifi_busy) { + if (wifi_cckdeadlock_ap) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else if (bt_link_info->hid_exist) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + else if (wifi_turbo) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + else + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 15); - else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - } else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = false; + if (wifi_busy) + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 13); + else + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 14); } else if (bt_link_info->hid_exist && bt_link_info->a2dp_exist) { /* HID+A2DP */ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); - coex_dm->auto_tdma_adjust = false; - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && - bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ - if (BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); + if (wifi_cckdeadlock_ap) { +#if 1 + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); +#endif + +#if 0 + halbtc8703b1ant_action_wifi_cck_dead_lock(btcoexist); +#endif + } else if (wifi_bw == 0) {/* if 11bg mode */ + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 12); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } else { + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } + + } else if ((bt_link_info->pan_only) + || (bt_link_info->hid_exist && bt_link_info->pan_exist)) { + /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ + + if (wifi_cckdeadlock_ap) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else if (bt_link_info->hid_exist) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + else if (wifi_turbo) + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); else - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); + halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = false; + if (!wifi_busy) + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 4); + else + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 3); } else { /* BT no-profile busy (0x9) */ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); } + } + void halbtc8703b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) { - /* tdma and coex table */ - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8703b1ant_action_wifi_not_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8703b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8703b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8703b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8703b1ant_action_hs(btcoexist); - return; - } - - /* tdma and coex table */ - if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8703b1ant_action_wifi_not_connected_asso_auth( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8703b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8703b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8703b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8703b1ant_action_hs(btcoexist); - return; - } - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || - (bt_link_info->a2dp_exist)) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); - } -} - -void halbtc8703b1ant_action_wifi_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8703b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8703b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8703b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8703b1ant_action_hs(btcoexist); - return; - } - - /* tdma and coex table */ - if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8703b1ant_action_wifi_connected_specific_packet( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - boolean wifi_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8703b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8703b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8703b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8703b1ant_action_hs(btcoexist); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* no specific packet process for both WiFi and BT very busy */ - if ((wifi_busy) && ((bt_link_info->pan_exist) || - (coex_sta->num_of_profile >= 2))) - return; - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else if (bt_link_info->a2dp_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } + halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); } void halbtc8703b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) { - boolean wifi_busy = false; - boolean scan = false, link = false, roam = false; - boolean under_4way = false, ap_enable = false; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect()===>\n"); + "[BTCoex], CoexForWifiConnect()===>\n"); BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - if (under_4way) { - halbtc8703b1ant_action_wifi_connected_specific_packet(btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); - BTC_TRACE(trace_buf); - return; - } + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - if (scan || link || roam) { - if (scan) - halbtc8703b1ant_action_wifi_connected_scan(btcoexist); + if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + + if (bt_link_info->hid_only)/* HID only */ + halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist); else - halbtc8703b1ant_action_wifi_connected_specific_packet( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); - BTC_TRACE(trace_buf); - return; - } + halbtc8703b1ant_action_wifi_connected_bt_acl_busy(btcoexist); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - - /* tdma and coex table */ - if (!wifi_busy) { - if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8703b1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || + } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == + coex_dm->bt_status) || (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else { - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8703b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - } - } else { - if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8703b1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else if ((BT_8703B_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8703B_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else { - /* halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); */ - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8703b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); - /* halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); */ - halbtc8703b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } + coex_dm->bt_status)) { + halbtc8703b1ant_action_bt_sco_hid_only_busy(btcoexist); + } else + halbtc8703b1ant_action_bt_idle(btcoexist); } + void halbtc8703b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) { - u8 algorithm = 0; + u8 algorithm = 0; algorithm = halbtc8703b1ant_action_algorithm(btcoexist); coex_dm->cur_algorithm = algorithm; @@ -2626,67 +2736,56 @@ void halbtc8703b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = SCO.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_sco(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_HID: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = HID.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_hid(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_A2DP: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = A2DP.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_a2dp(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_A2DP_PANHS: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_a2dp_pan_hs(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_PANEDR: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = PAN(EDR).\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_pan_edr(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_PANHS: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = HS mode.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_pan_hs(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_PANEDR_A2DP: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = PAN+A2DP.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_pan_edr_a2dp(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_PANEDR_HID: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_pan_edr_hid(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_hid_a2dp_pan_edr(btcoexist); */ break; case BT_8703B_1ANT_COEX_ALGO_HID_A2DP: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = HID+A2DP.\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_action_hid_a2dp(btcoexist); */ break; default: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action algorithm = coexist All Off!!\n"); BTC_TRACE(trace_buf); - /* halbtc8703b1ant_coex_all_off(btcoexist); */ break; } coex_dm->pre_algorithm = coex_dm->cur_algorithm; @@ -2695,18 +2794,24 @@ void halbtc8703b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) void halbtc8703b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) { - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - boolean increase_scan_dev_num = false; - boolean bt_ctrl_agg_buf_size = false; - boolean miracast_plus_bt = false; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = FALSE, bt_hs_on = FALSE; + boolean increase_scan_dev_num = FALSE; + boolean bt_ctrl_agg_buf_size = FALSE; + boolean miracast_plus_bt = FALSE, wifi_under_5g = FALSE; u8 agg_buf_size = 5; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0, wifi_bw; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0, wifi_bw; u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + boolean scan = FALSE, link = FALSE, roam = FALSE, under_4way = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism()===>\n"); + "[BTCoex], RunCoexistMechanism()===>\n"); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], under_lps = %d, force_lps_ctrl = %d, acl_busy = %d!!!\n", + coex_sta->under_lps, coex_sta->force_lps_ctrl, coex_sta->acl_busy); BTC_TRACE(trace_buf); if (btcoexist->manual_control) { @@ -2725,216 +2830,207 @@ void halbtc8703b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) if (coex_sta->under_ips) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is under IPS !!!\n"); + "[BTCoex], wifi is under IPS !!!\n"); + BTC_TRACE(trace_buf); + return; + } + +#if 1 + if ((coex_sta->under_lps) && (!coex_sta->force_lps_ctrl) && + (!coex_sta->acl_busy)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); + BTC_TRACE(trace_buf); + halbtc8703b1ant_action_wifi_native_lps(btcoexist); + return; + } +#endif + + if (!coex_sta->run_time_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], return for run_time_state = FALSE !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->freeze_coexrun_by_btinfo) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); BTC_TRACE(trace_buf); return; } if (coex_sta->bt_whck_test) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under WHCK TEST!!!\n"); + "[BTCoex], BT is under WHCK TEST!!!\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_action_bt_whck_test(btcoexist); + halbtc8703b1ant_action_bt_whql_test(btcoexist); return; } if (coex_sta->bt_disabled) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!!\n"); + "[BTCoex], BT is disabled !!!\n"); halbtc8703b1ant_action_wifi_only(btcoexist); return; } - if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - increase_scan_dev_num = true; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, - &increase_scan_dev_num); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status >> 16; - - if ((num_of_wifi_link >= 2) || - (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", - num_of_wifi_link, wifi_link_status); - BTC_TRACE(trace_buf); - - if (bt_link_info->bt_link_exist) { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, - 0, 1); - miracast_plus_bt = true; - } else { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - miracast_plus_bt = false; - } - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8703b1ant_action_bt_inquiry(btcoexist); - } else - halbtc8703b1ant_action_wifi_multi_port(btcoexist); - - return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if ((bt_link_info->bt_link_exist) && (wifi_connected)) { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); - - if (BTC_IOT_PEER_CISCO != iot_peer) { - if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ - halbtc8703b1ant_limited_rx(btcoexist, - NORMAL_EXEC, true, false, 0x5); - else - halbtc8703b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, false, 0x5); - } else { - if (bt_link_info->sco_exist) - halbtc8703b1ant_limited_rx(btcoexist, - NORMAL_EXEC, true, false, 0x5); - else { - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8703b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x10); - else - halbtc8703b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x8); - } - } - - halbtc8703b1ant_sw_mechanism(btcoexist, true); - halbtc8703b1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - } else { - halbtc8703b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); - - halbtc8703b1ant_sw_mechanism(btcoexist, false); - halbtc8703b1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); if (coex_sta->c2h_bt_inquiry_page) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); + "[BTCoex], BT is under inquiry/page scan !!\n"); BTC_TRACE(trace_buf); halbtc8703b1ant_action_bt_inquiry(btcoexist); return; - } else if (bt_hs_on) { - halbtc8703b1ant_action_hs(btcoexist); + } + + if ((coex_sta->is_setupLink) && + (coex_sta->bt_relink_downcount != 0)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is re-link !!!\n"); + halbtc8703b1ant_action_bt_relink(btcoexist); return; } + if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + increase_scan_dev_num = TRUE; - if (!wifi_connected) { - boolean scan = false, link = false, roam = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, + &increase_scan_dev_num); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + + num_of_wifi_link = wifi_link_status >> 16; + + if ((num_of_wifi_link >= 2) || + (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is non connected-idle !!!\n"); + "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", + num_of_wifi_link, wifi_link_status); BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + if (bt_link_info->bt_link_exist) + miracast_plus_bt = TRUE; + else + miracast_plus_bt = FALSE; - if (scan || link || roam) { - if (scan) - halbtc8703b1ant_action_wifi_not_connected_scan( - btcoexist); + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); +#if 0 + halbtc8703b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + FALSE, 0x5); +#endif + halbtc8703b1ant_action_wifi_multi_port(btcoexist); + + return; + } else { + + miracast_plus_bt = FALSE; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + } + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + + if ((bt_link_info->bt_link_exist) && (wifi_connected)) { + + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + if (BTC_IOT_PEER_CISCO == iot_peer) { + + if (BTC_WIFI_BW_HT40 == wifi_bw) + halbtc8703b1ant_limited_rx(btcoexist, + NORMAL_EXEC, FALSE, TRUE, 0x10); else - halbtc8703b1ant_action_wifi_not_connected_asso_auth( - btcoexist); - } else - halbtc8703b1ant_action_wifi_not_connected(btcoexist); - } else /* wifi LPS/Busy */ - halbtc8703b1ant_action_wifi_connected(btcoexist); -} - -u32 halbtc8703b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -{ - u8 j; - u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; - u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, - 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, - 32, 23, 15, 7, 0 - }; - - if (val == 0) - return 0; - - tmp = val; - - while (1) { - if (tmp == 1) - break; - else { - tmp = (tmp >> 1); - shiftcount++; + halbtc8703b1ant_limited_rx(btcoexist, + NORMAL_EXEC, FALSE, TRUE, 0x8); } } + halbtc8703b1ant_run_sw_coexist_mechanism( + btcoexist); /* just print debug message */ - val_integerd_b = shiftcount + 1; + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - tmp2 = 1; - for (j = 1; j <= val_integerd_b; j++) - tmp2 = tmp2 * 2; + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is hs\n"); + BTC_TRACE(trace_buf); + halbtc8703b1ant_action_bt_hs(btcoexist); + return; + } - tmp = (val * 100) / tmp2; - tindex = tmp / 5; + if ((BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) || + (BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is idle\n"); + BTC_TRACE(trace_buf); + halbtc8703b1ant_action_bt_idle(btcoexist); + return; + } - if (tindex > 20) - tindex = 20; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); - val_fractiond_b = table_fraction[tindex]; + if (scan || link || roam || under_4way) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", + scan, link, roam, under_4way); + BTC_TRACE(trace_buf); - result = val_integerd_b * 100 - val_fractiond_b; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under linkscan process!!\n"); + BTC_TRACE(trace_buf); - return result; + halbtc8703b1ant_action_wifi_linkscan_process(btcoexist); + } else if (wifi_connected) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under connected!!\n"); + BTC_TRACE(trace_buf); + halbtc8703b1ant_action_wifi_connected(btcoexist); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under not-connected!!\n"); + BTC_TRACE(trace_buf); + halbtc8703b1ant_action_wifi_not_connected(btcoexist); + } } + void halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) { /* force to reset coex mechanism */ - /* sw all off */ - halbtc8703b1ant_sw_mechanism(btcoexist, false); + halbtc8703b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); - /* halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ - /* halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Coex Mechanism Init!!\n"); + BTC_TRACE(trace_buf); coex_sta->pop_event_cnt = 0; + coex_sta->cnt_RemoteNameReq = 0; + coex_sta->cnt_ReInit = 0; + coex_sta->cnt_setupLink = 0; + coex_sta->cnt_IgnWlanAct = 0; + coex_sta->cnt_Page = 0; + coex_sta->cnt_RoleSwitch = 0; } void halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, IN boolean back_up, IN boolean wifi_only) { u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; + u8 i = 0; u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70), u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); @@ -2950,6 +3046,19 @@ void halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, "[BTCoex], 1Ant Init HW Config!!\n"); BTC_TRACE(trace_buf); + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->gnt_error_cnt = 0; + coex_sta->bt_relink_downcount = 0; + coex_sta->wl_rx_rate = BTC_UNKNOWN; + + for (i = 0; i <= 9; i++) + coex_sta->bt_afh_map[i] = 0; + /* 0xf0[15:12] --> Chip Cut information */ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, 0xf1) & 0xf0) >> 4; @@ -2972,29 +3081,42 @@ void halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); +#if 0 if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) - halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); - - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ONOFF, TRUE); +#endif /* Antenna config */ - if (wifi_only) { - coex_sta->concurrent_rx_mode_on = false; + if (coex_sta->is_rf_state_off) { + + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_WLAN_OFF); + + btcoexist->stop_coex_dm = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** halbtc8703b1ant_init_hw_config (RF Off)**********\n"); + BTC_TRACE(trace_buf); + } else if (wifi_only) { + coex_sta->concurrent_rx_mode_on = FALSE; halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, true, false); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, false, false); + FORCE_EXEC, + BT_8703B_1ANT_PHASE_WLANONLY_INIT); } else { - coex_sta->concurrent_rx_mode_on = true; + coex_sta->concurrent_rx_mode_on = TRUE; btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, true, false); + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_COEX_INIT); } /* PTA parameter */ halbtc8703b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70), u32tmp1 = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); @@ -3010,498 +3132,6 @@ void halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, -void halbtc8703b1ant_psd_showdata(IN struct btc_coexist *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - u32 delta_freq_per_point; - u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n\n============[PSD info] (%d)============\n", - psd_scan->psd_gen_count); - CL_PRINTF(cli_buf); - - if (psd_scan->psd_gen_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); - CL_PRINTF(cli_buf); - return; - } - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* if (psd_scan->is_psd_show_max_only) */ - if (0) { - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; - - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + - psd_scan->psd_max_value_point * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.0%d MHz", - freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.%d MHz", - freq1, freq2); - - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - - CL_PRINTF(cli_buf); - } else { - m = psd_scan->psd_start_point; - n = psd_scan->psd_start_point; - i = 1; - j = 1; - - while (1) { - do { - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * - delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (i == 1) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.0%2d", freq1, - freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.%3d", freq1, - freq2); - } else if ((i % 8 == 0) || - (m == psd_scan->psd_stop_point)) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000\n", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d\n", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d\n", freq1, freq2); - } else { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d", freq1, freq2); - } - - i++; - m++; - CL_PRINTF(cli_buf); - - } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); - - - do { - psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; - psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * - 100; - - if (j == 1) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.0%d", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.%d", psd_rep1, - psd_rep2); - } else if ((j % 8 == 0) || - (n == psd_scan->psd_stop_point)) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d\n", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d\n", psd_rep1, psd_rep2); - } else { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d", psd_rep1, psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d", psd_rep1, psd_rep2); - } - - j++; - n++; - CL_PRINTF(cli_buf); - - } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); - - if ((m > psd_scan->psd_stop_point) || - (n > psd_scan->psd_stop_point)) - break; - else { - i = 1; - j = 1; - } - - } - } - - -} - -void halbtc8703b1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0, i_max = 0, val_max = 0; - - if (gen_count == 1) { - memcpy(psd_scan->psd_report_max_hold, - psd_scan->psd_report, - BT_8703B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); - - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - - } - - psd_scan->psd_max_value_point = 0; - psd_scan->psd_max_value = 0; - - } else { - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - if (psd_scan->psd_report[i] > - psd_scan->psd_report_max_hold[i]) - psd_scan->psd_report_max_hold[i] = - psd_scan->psd_report[i]; - - /* search Max Value */ - if (i == psd_scan->psd_start_point) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } else { - if (psd_scan->psd_report_max_hold[i] > - val_max) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } - } - - - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - - } - - -} - -u32 halbtc8703b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -{ - /* reg 0x808[9:0]: FFT data x */ - /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ - /* reg 0x8b4[15:0]: FFT data y report */ - - u32 val = 0, psd_report = 0; - - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - - val &= 0xffbffc00; - val |= point; - - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - val |= 0x00400000; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - - -boolean halbtc8703b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, - IN u32 avgnum, IN u32 loopcnt) -{ - u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; - u32 points1 = 0, psd_report = 0; - u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; - u32 psd_center_freq = 20 * 10 ^ 6; - boolean outloop = false, scan , roam, is_sweep_ok = true; - u8 flag = 0; - u32 tmp = 0, u32tmp1 = 0; - u32 wifi_original_channel = 1; - - psd_scan->is_psd_running = true; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); - BTC_TRACE(trace_buf); - - do { - switch (flag) { - case 0: /* Get PSD parameters */ - default: - - psd_scan->psd_band_width = 40 * 1000000; - psd_scan->psd_point = points; - psd_scan->psd_start_base = points / 2; - psd_scan->psd_avg_num = avgnum; - psd_scan->real_cent_freq = cent_freq; - psd_scan->real_offset = offset; - psd_scan->real_span = span; - - - points1 = psd_scan->psd_point; - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* PSD point setup */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffff0fff; - - switch (psd_scan->psd_point) { - case 128: - val |= 0x0; - break; - case 256: - default: - val |= 0x00004000; - break; - case 512: - val |= 0x00008000; - break; - case 1024: - val |= 0x0000c000; - break; - } - - switch (psd_scan->psd_avg_num) { - case 1: - val |= 0x0; - break; - case 8: - val |= 0x00001000; - break; - case 16: - val |= 0x00002000; - break; - case 32: - default: - val |= 0x00003000; - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - flag = 1; - break; - case 1: /* calculate the PSD point index from freq/offset/span */ - psd_center_freq = psd_scan->psd_band_width / 2 + - offset * (1000000); - - start_p = psd_scan->psd_start_base + (psd_center_freq - - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_start_point = start_p - - psd_scan->psd_start_base; - - stop_p = psd_scan->psd_start_base + (psd_center_freq + - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_stop_point = stop_p - - psd_scan->psd_start_base - 1; - - flag = 2; - break; - case 2: /* set RF channel/BW/Mode */ - - /* set 3-wire off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val |= 0x00300000; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val &= 0xfeffffff; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* Tx-pause on */ - btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); - - /* store WiFi original channel */ - wifi_original_channel = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x18, 0x3ff); - - /* Set RF channel */ - if (cent_freq == 2484) - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, 0xe); - else - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, (cent_freq - 2412) / 5 + - 1); /* WiFi TRx Mask on */ - - /* save original RCK value */ - u32tmp1 = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x1d, 0xfffff); - - /* Enter debug mode */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, - 0x2, 0x1); - - /* Set RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, - 0xfffff, 0x2e); - - - /* Set RF mode = Rx, RF Gain = 0x320a0 */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, - 0xfffff, 0x320a0); - - while (1) { - if (k++ > BT_8703B_1ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - flag = 3; - break; - case 3: - psd_scan->psd_gen_count = 0; - for (j = 1; j <= loopcnt; j++) { - - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || roam) { - is_sweep_ok = false; - break; - } - memset(psd_scan->psd_report, 0, - psd_scan->psd_point * sizeof(u32)); - start_p = psd_scan->psd_start_point + - psd_scan->psd_start_base; - stop_p = psd_scan->psd_stop_point + - psd_scan->psd_start_base + 1; - - i = start_p; - point_index = 0; - - while (i < stop_p) { - if (i >= points1) - psd_report = - halbtc8703b1ant_psd_getdata( - btcoexist, i - points1); - else - psd_report = - halbtc8703b1ant_psd_getdata( - btcoexist, i); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_raw_data = 0x%08x\n", - i, psd_report); - BTC_TRACE(trace_buf); - if (psd_report == 0) - tmp = 0; - else - /* tmp = 20*log10((double)psd_report); */ - /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ - tmp = 6 * halbtc8703b1ant_psd_log2base( - btcoexist, psd_report); - - n = i - psd_scan->psd_start_base; - psd_scan->psd_report[n] = tmp; - - - halbtc8703b1ant_psd_maxholddata( - btcoexist, j); - - i++; - - } - - psd_scan->psd_gen_count = j; - } - - flag = 100; - break; - case 99: /* error */ - - outloop = true; - break; - case 100: /* recovery */ - - /* set 3-wire on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val &= 0xffcfffff; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val |= 0x01000000; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* Tx-pause off */ - btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); - - /* PSD off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffbfffff; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - /* restore RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, - 0xfffff, u32tmp1); - - /* Exit debug mode */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, - 0x2, 0x0); - - /* restore WiFi original channel */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, - 0x3ff, wifi_original_channel); - - outloop = true; - break; - - } - - } while (!outloop); - - - - psd_scan->is_psd_running = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - /* ************************************************************ * work around function start with wa_halbtc8703b1ant_ * ************************************************************ @@ -3524,7 +3154,8 @@ void ex_halbtc8703b1ant_power_on_setting(IN struct btc_coexist *btcoexist) board_info->btdm_ant_num_by_ant_det); BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = true; + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = FALSE; /* enable BB, REG_SYS_FUNC_EN such that we can write BB/MAC reg correctly. */ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); @@ -3585,8 +3216,8 @@ void ex_halbtc8703b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) void ex_halbtc8703b1ant_init_hw_config(IN struct btc_coexist *btcoexist, IN boolean wifi_only) { - halbtc8703b1ant_init_hw_config(btcoexist, true, wifi_only); - btcoexist->stop_coex_dm = false; + halbtc8703b1ant_init_hw_config(btcoexist, TRUE, wifi_only); + btcoexist->stop_coex_dm = FALSE; } void ex_halbtc8703b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) @@ -3607,9 +3238,11 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; u16 u16tmp[4]; u32 u32tmp[4]; - u32 fa_of_dm, fa_cck; - u32 fw_ver = 0, bt_patch_ver = 0; - static u8 pop_report_in_10s = 0; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; + static u8 pop_report_in_10s = 0, cnt = 0; + u32 phyver = 0; + boolean lte_coex_on = FALSE; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -3632,6 +3265,30 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); } + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + if (psd_scan->ant_det_try_count == 0) { CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", "Ant PG Num/ Mech/ Pos", @@ -3642,9 +3299,11 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", "Ant PG Num/ Mech(Ant_Det)/ Pos", - board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, board_info->btdm_ant_pos, - psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, psd_scan->ant_det_result); CL_PRINTF(cli_buf); @@ -3656,19 +3315,30 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) } } - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", - "BT stack/ hci ext ver", - ((stack_info->profile_notified) ? "Yes" : "No"), - stack_info->hci_version); + + /*bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver;*/ + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + + bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8703b_1ant, glcoex_ver_8703b_1ant, + glcoex_ver_btdesired_8703b_1ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (bt_coex_ver >= glcoex_ver_btdesired_8703b_1ant ? + "Match":"Mis-Match"))); CL_PRINTF(cli_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", - "Version Coex/ Fw/ Patch/ Cut", - glcoex_ver_date_8703b_1ant, glcoex_ver_8703b_1ant, fw_ver, - bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", @@ -3680,7 +3350,7 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) "WifibHiPri/ Ccklock/ CckEverLock", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No")); + (coex_sta->cck_lock_ever ? "Yes" : "No")); CL_PRINTF(cli_buf); /* wifi status */ @@ -3711,27 +3381,88 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) pop_report_in_10s = 0; } - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d / %d", - "SCO/HID/PAN/A2DP/Hi-Pri", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist, - bt_link_info->bt_hi_pri_link_exist); + if (coex_sta->num_of_profile != 0) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s%s%s%s%s", + "Profiles", + ((bt_link_info->a2dp_exist) ? + ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : + "A2DP,") : ""), + ((bt_link_info->sco_exist) ? "HFP," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : + "HID(2/18),") : ""), + ((bt_link_info->pan_exist) ? "PAN," : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = None", + "Profiles"); + CL_PRINTF(cli_buf); - if (stack_info->profile_notified) - btcoexist->btc_disp_dbg_msg(btcoexist, - BTC_DBG_DISP_BT_LINK_INFO); - else { - bt_info_ext = coex_sta->bt_info_ext; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d", - "Role/A2DP Rate/Bitpool", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); + if (bt_link_info->a2dp_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", + "A2DP Rate/Bitpool/Auto_Slot", + ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), + coex_sta->a2dp_bit_pool, + ((coex_sta->is_autoslot) ? "On" : "Off") + ); CL_PRINTF(cli_buf); } + if (bt_link_info->hid_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "HID PairNum/Forbid_Slot", + coex_sta->hid_pair_cnt, + coex_sta->forbidden_slot + ); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", + "Role/RoleSwCnt/IgnWlact/Feature", + ((bt_link_info->slave_role) ? "Slave" : "Master"), + coex_sta->cnt_RoleSwitch, + ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), + coex_sta->bt_coex_supported_feature); + CL_PRINTF(cli_buf); + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "ReInit/ReLink/IgnWlact/Page/NameReq", + coex_sta->cnt_ReInit, + coex_sta->cnt_setupLink, + coex_sta->cnt_IgnWlanAct, + coex_sta->cnt_Page, + coex_sta->cnt_RemoteNameReq + ); + CL_PRINTF(cli_buf); + + halbtc8703b1ant_read_score_board(btcoexist, &u16tmp[0]); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", + "ScoreBoard[14:0] (from BT)", u16tmp[0]); + CL_PRINTF(cli_buf); + + if (coex_sta->num_of_profile > 0) { + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x%02x%02x%02x %02x%02x%02x%02x %02x%02x", + "AFH MAP", + coex_sta->bt_afh_map[0], + coex_sta->bt_afh_map[1], + coex_sta->bt_afh_map[2], + coex_sta->bt_afh_map[3], + coex_sta->bt_afh_map[4], + coex_sta->bt_afh_map[5], + coex_sta->bt_afh_map[6], + coex_sta->bt_afh_map[7], + coex_sta->bt_afh_map[8], + coex_sta->bt_afh_map[9] + ); + CL_PRINTF(cli_buf); + } for (i = 0; i < BT_INFO_SRC_8703B_1ANT_MAX; i++) { if (coex_sta->bt_info_c2h_cnt[i]) { @@ -3797,74 +3528,82 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); CL_PRINTF(cli_buf); - u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa0); - u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "LTE Coex Table W_L/B_L", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "BT_Empty/BT_Late", + coex_sta->wl_fw_dbg_info[4], + coex_sta->wl_fw_dbg_info[5]); CL_PRINTF(cli_buf); - u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa8); - u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xac); - u32tmp[2] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb0); - u32tmp[3] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb4); + u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "LTE Break Table W_L/B_L/L_W/L_B", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, - u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); - CL_PRINTF(cli_buf); + if (lte_coex_on) { + u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa0); + u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa4); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "LTE Coex Table W_L/B_L", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa8); + u32tmp[1] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xac); + u32tmp[2] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb0); + u32tmp[3] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb4); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "LTE Break Table W_L/B_L/L_W/L_B", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, + u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); + CL_PRINTF(cli_buf); + } /* Hw setting */ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", - "0x430/0x434/0x42a/0x456", - u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", "LTE CoexOn/Path Ctrl Owner", - (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); + (int)((u32tmp[0] & BIT(7)) >> 7), + ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "LTE 3Wire/OPMode/UART/UARTMode", - (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), - (int)((u32tmp[0] & BIT(3)) >> 3), - (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", - "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", - (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), - ((u8tmp[0] & BIT(3)) ? "On" : "Off")); + if (lte_coex_on) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "LTE 3Wire/OPMode/UART/UARTMode", + (int)((u32tmp[0] & BIT(6)) >> 6), + (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), + (int)((u32tmp[0] & BIT(3)) >> 3), + (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); + CL_PRINTF(cli_buf); + } + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", + "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", + ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), + ((u8tmp[0] & BIT(3)) ? "On" : "Off"), + coex_sta->gnt_error_cnt); CL_PRINTF(cli_buf); u32tmp[0] = halbtc8703b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", - (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), + (int)((u32tmp[0] & BIT(2)) >> 2), + (int)((u32tmp[0] & BIT(3)) >> 3), (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); CL_PRINTF(cli_buf); @@ -3874,7 +3613,8 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", "0x4c6[4]/0x40[5] (WL/BT PTA)", - (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); + (int)((u8tmp[0] & BIT(4)) >> 4), + (int)((u8tmp[1] & BIT(5)) >> 5)); CL_PRINTF(cli_buf); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); @@ -3885,56 +3625,50 @@ void ex_halbtc8703b1ant_display_coex_info(IN struct btc_coexist *btcoexist) u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); CL_PRINTF(cli_buf); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); - u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - - fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) - >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + - ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & - 0xffff) ; - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; - - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50); + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, PHYDM_INFO_CCA_CCK); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", - u32tmp[1] & 0xff, u32tmp[0] & 0xffff, fa_of_dm, fa_cck); + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11n-Agg", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d (Rx_rate Data/RTS= %d/%d)", + "CRC_OK CCK/11g/11n/11ac", coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht, + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_Err CCK/11g/11n/11n-Agg", + "CRC_Err CCK/11g/11n/11n-agg", coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770(high-pri rx/tx)", - coex_sta->high_priority_rx, coex_sta->high_priority_tx); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri rx/tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", + "WlHiPri/ Locking/ Locked/ Noisy", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), + (coex_sta->cck_lock ? "Yes" : "No"), + (coex_sta->cck_lock_ever ? "Yes" : "No"), + coex_sta->wl_noisy_level); CL_PRINTF(cli_buf); - halbtc8703b1ant_read_score_board(btcoexist, &u16tmp[0]); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", - "ScoreBoard[14:0] (from BT)", u16tmp[0]); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x770(Hi-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx, + (coex_sta->is_hiPri_rx_overhead ? "(scan overhead!!)" : "")); CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x774(Lo-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx, + (bt_link_info->slave_role ? "(Slave!!)" : ( + coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); + CL_PRINTF(cli_buf); btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); } @@ -3949,32 +3683,43 @@ void ex_halbtc8703b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS ENTER notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - coex_sta->under_lps = false; + coex_sta->under_ips = TRUE; + coex_sta->under_lps = FALSE; /* Write WL "Active" in Score-board for LPS off */ - halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE | + BT_8703B_1ANT_SCOREBOARD_ONOFF | + BT_8703B_1ANT_SCOREBOARD_SCAN | + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, + FALSE); + + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_WLAN_OFF); - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); halbtc8703b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_IPS_LEAVE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS LEAVE notify\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); - - halbtc8703b1ant_init_hw_config(btcoexist, false, false); +#if 0 + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE, TRUE); +#endif + halbtc8703b1ant_init_hw_config(btcoexist, FALSE, FALSE); halbtc8703b1ant_init_coex_dm(btcoexist); halbtc8703b1ant_query_bt_info(btcoexist); - coex_sta->under_ips = false; + coex_sta->under_ips = FALSE; } } void ex_halbtc8703b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) { + static boolean pre_force_lps_on = FALSE; + if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; @@ -3982,35 +3727,42 @@ void ex_halbtc8703b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS ENABLE notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_lps = true; - coex_sta->under_ips = false; + coex_sta->under_lps = TRUE; + coex_sta->under_ips = FALSE; - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ + if (coex_sta->force_lps_ctrl == TRUE) { /* LPS No-32K */ /* Write WL "Active" in Score-board for PS-TDMA */ - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); + pre_force_lps_on = TRUE; + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE, TRUE); } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ /* Write WL "Non-Active" in Score-board for Native-PS */ - halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); + pre_force_lps_on = FALSE; + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8703b1ant_action_wifi_native_lps(btcoexist); } } else if (BTC_LPS_DISABLE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS DISABLE notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_lps = false; - + coex_sta->under_lps = FALSE; /* Write WL "Active" in Score-board for LPS off */ - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE, TRUE); + if ((pre_force_lps_on == FALSE) && (!coex_sta->force_lps_ctrl)) + halbtc8703b1ant_query_bt_info(btcoexist); } } void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean wifi_connected = false; + boolean wifi_connected = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -4023,40 +3775,38 @@ void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, if (BTC_SCAN_START == type) { - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], SCAN START notify\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE | + BT_8703B_1ANT_SCOREBOARD_SCAN | + BT_8703B_1ANT_SCOREBOARD_ONOFF, + TRUE); /* Force antenna setup for no scan result issue */ - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); - if (!wifi_connected) /* non-connected scan */ - halbtc8703b1ant_action_wifi_not_connected_scan(btcoexist); - else /* wifi is connected */ - halbtc8703b1ant_action_wifi_connected_scan(btcoexist); + halbtc8703b1ant_run_coexist_mechanism(btcoexist); } else { - coex_sta->wifi_is_high_pri_task = false; + coex_sta->wifi_is_high_pri_task = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); + "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", + coex_sta->scan_ap_num); BTC_TRACE(trace_buf); - if (!wifi_connected) - halbtc8703b1ant_action_wifi_not_connected(btcoexist); - else - halbtc8703b1ant_action_wifi_connected(btcoexist); + halbtc8703b1ant_run_coexist_mechanism(btcoexist); } BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -4068,7 +3818,7 @@ void ex_halbtc8703b1ant_scan_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean wifi_connected = false; + boolean wifi_connected = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -4078,31 +3828,33 @@ void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, &wifi_connected); if (BTC_ASSOCIATE_START == type) { - coex_sta->wifi_is_high_pri_task = true; - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); + coex_sta->wifi_is_high_pri_task = TRUE; + + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE | + BT_8703B_1ANT_SCOREBOARD_SCAN | + BT_8703B_1ANT_SCOREBOARD_ONOFF, + TRUE); /* Force antenna setup for no scan result issue */ - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); + /* psd_scan->ant_det_is_ant_det_available = TRUE; */ BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT START notify\n"); BTC_TRACE(trace_buf); coex_dm->arp_cnt = 0; - halbtc8703b1ant_action_wifi_not_connected_asso_auth(btcoexist); + halbtc8703b1ant_run_coexist_mechanism(btcoexist); } else { - coex_sta->wifi_is_high_pri_task = false; + coex_sta->wifi_is_high_pri_task = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT FINISH notify\n"); BTC_TRACE(trace_buf); - if (!wifi_connected) /* non-connected scan */ - halbtc8703b1ant_action_wifi_not_connected(btcoexist); - else - halbtc8703b1ant_action_wifi_connected(btcoexist); + halbtc8703b1ant_run_coexist_mechanism(btcoexist); } } @@ -4110,7 +3862,7 @@ void ex_halbtc8703b1ant_connect_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean wifi_under_b_mode = false; + boolean wifi_under_b_mode = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -4122,13 +3874,15 @@ void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, "[BTCoex], MEDIA connect notify\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE | + BT_8703B_1ANT_SCOREBOARD_ONOFF, + TRUE); /* Force antenna setup for no scan result issue */ - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &wifi_under_b_mode); @@ -4162,12 +3916,13 @@ void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, "[BTCoex], MEDIA disconnect notify\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE, FALSE); btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ - coex_sta->cck_ever_lock = false; + coex_sta->cck_lock_ever = FALSE; } halbtc8703b1ant_update_wifi_channel_info(btcoexist, type); @@ -4177,11 +3932,10 @@ void ex_halbtc8703b1ant_media_status_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean under_4way = false; + boolean under_4way = FALSE; if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) + btcoexist->stop_coex_dm) return; @@ -4194,38 +3948,43 @@ void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, "[BTCoex], specific Packet ---- under_4way!!\n"); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; } else if (BTC_PACKET_ARP == type) { coex_dm->arp_cnt++; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); + "[BTCoex], specific Packet ARP notify -cnt = %d\n", + coex_dm->arp_cnt); BTC_TRACE(trace_buf); } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); + "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", + type); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; } - if (coex_sta->wifi_is_high_pri_task) - halbtc8703b1ant_action_wifi_connected_specific_packet(btcoexist); + if (coex_sta->wifi_is_high_pri_task) { + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_SCAN, TRUE); + halbtc8703b1ant_run_coexist_mechanism(btcoexist); + } } void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length) { - u8 bt_info = 0; u8 i, rsp_source = 0; - boolean wifi_connected = false; - boolean bt_busy = false; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE, + wifi_busy = FALSE; + static boolean is_scoreboard_scan = FALSE; - coex_sta->c2h_bt_info_req_sent = false; rsp_source = tmp_buf[0] & 0xf; if (rsp_source >= BT_INFO_SRC_8703B_1ANT_MAX) @@ -4233,13 +3992,13 @@ void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, coex_sta->bt_info_c2h_cnt[rsp_source]++; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, + "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, length); BTC_TRACE(trace_buf); + for (i = 0; i < length; i++) { coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; - if (i == 1) - bt_info = tmp_buf[i]; + if (i == length - 1) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", tmp_buf[i]); @@ -4251,191 +4010,275 @@ void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, } } + coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; + coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; + coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; + if (BT_INFO_SRC_8703B_1ANT_WIFI_FW != rsp_source) { /* if 0xff, it means BT is under WHCK test */ - if (bt_info == 0xff) - coex_sta->bt_whck_test = true; - else - coex_sta->bt_whck_test = false; + coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? TRUE : + FALSE); - coex_sta->bt_retry_cnt = /* [3:0] */ - coex_sta->bt_info_c2h[rsp_source][2] & 0xf; + coex_sta->bt_create_connection = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? TRUE : + FALSE); + + /* unit: %, value-100 to translate to unit: dBm */ + coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + + 10; + + coex_sta->c2h_bt_remote_name_req = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? TRUE : + FALSE); + + coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & + 0x10) ? TRUE : FALSE); + + coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & + 0x8) ? TRUE : FALSE); + + coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? + TRUE : FALSE); + + coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & + BT_INFO_8703B_1ANT_B_INQ_PAGE) ? TRUE : FALSE); + + coex_sta->a2dp_bit_pool = ((( + coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? + coex_sta->bt_info_c2h[rsp_source][6] : 0); + + coex_sta->is_bt_a2dp_sink = (coex_sta->bt_info_c2h[rsp_source][6] & 0x80) ? + TRUE : FALSE; + + coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & + 0xf; + + coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; + + coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; + + coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; + + coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; if (coex_sta->bt_retry_cnt >= 1) coex_sta->pop_event_cnt++; - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) - coex_sta->c2h_bt_page = true; + if (coex_sta->c2h_bt_remote_name_req) + coex_sta->cnt_RemoteNameReq++; + + if (coex_sta->bt_info_ext & BIT(1)) + coex_sta->cnt_ReInit++; + + if (coex_sta->bt_info_ext & BIT(2)) { + coex_sta->cnt_setupLink++; + coex_sta->is_setupLink = TRUE; + coex_sta->bt_relink_downcount = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->is_setupLink = FALSE; + coex_sta->bt_relink_downcount = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop in BT info!!\n"); + BTC_TRACE(trace_buf); + } + + if (coex_sta->bt_info_ext & BIT(3)) + coex_sta->cnt_IgnWlanAct++; + + if (coex_sta->bt_info_ext & BIT(6)) + coex_sta->cnt_RoleSwitch++; + + if (coex_sta->bt_info_ext & BIT(7)) + coex_sta->is_bt_multi_link = TRUE; else - coex_sta->c2h_bt_page = false; + coex_sta->is_bt_multi_link = FALSE; - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) - coex_sta->bt_create_connection = true; - else - coex_sta->bt_create_connection = false; + if (coex_sta->bt_create_connection) { + coex_sta->cnt_Page++; - /* unit: %, value-100 to translate to unit: dBm */ - coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, + &wifi_busy); - /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); - if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { - coex_sta->a2dp_bit_pool = - coex_sta->bt_info_c2h[rsp_source][6]; - } else - coex_sta->a2dp_bit_pool = 0; + if ((wifi_link) || (wifi_roam) || (wifi_scan) || + (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { - if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) - coex_sta->acl_busy = true; - else - coex_sta->acl_busy = false; + is_scoreboard_scan = TRUE; + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_SCAN, TRUE); - coex_sta->bt_info_ext = - coex_sta->bt_info_c2h[rsp_source][4]; + } else + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_SCAN, FALSE); + + } else { + if (is_scoreboard_scan) { + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_SCAN, FALSE); + is_scoreboard_scan = FALSE; + } + } /* Here we need to resend some wifi info to BT */ /* because bt is reset and loss of the info. */ - if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { + if ((!btcoexist->manual_control) && + (!btcoexist->stop_coex_dm)) { + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); /* Re-Init */ - if (coex_sta->bt_info_ext & BIT(1)) { + if ((coex_sta->bt_info_ext & BIT(1))) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); if (wifi_connected) - halbtc8703b1ant_update_wifi_channel_info(btcoexist, - BTC_MEDIA_CONNECT); + halbtc8703b1ant_update_wifi_channel_info( + btcoexist, BTC_MEDIA_CONNECT); else - halbtc8703b1ant_update_wifi_channel_info(btcoexist, - BTC_MEDIA_DISCONNECT); + halbtc8703b1ant_update_wifi_channel_info( + btcoexist, + BTC_MEDIA_DISCONNECT); } + /* If Ignore_WLanAct && not SetUp_Link */ - if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { + if ((coex_sta->bt_info_ext & BIT(3)) && + (!(coex_sta->bt_info_ext & BIT(2)))) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); BTC_TRACE(trace_buf); halbtc8703b1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); + FORCE_EXEC, FALSE); } } - /* check BIT2 first ==> check if bt is under inquiry or page scan */ - if (bt_info & BT_INFO_8703B_1ANT_B_INQ_PAGE) - coex_sta->c2h_bt_inquiry_page = true; - else - coex_sta->c2h_bt_inquiry_page = false; - } + if ((coex_sta->bt_info_ext & BIT(5))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); + BTC_TRACE(trace_buf); + coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); - coex_sta->num_of_profile = 0; - - /* set link exist status */ - if (!(bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; - - coex_sta->bt_hi_pri_link_exist = false; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (bt_info & BT_INFO_8703B_1ANT_B_FTP) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8703B_1ANT_B_A2DP) { - coex_sta->a2dp_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8703B_1ANT_B_HID) { - coex_sta->hid_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) { - coex_sta->sco_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->sco_exist = false; - + if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) + coex_sta->bt_ble_scan_para[0] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); + if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) + coex_sta->bt_ble_scan_para[1] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); + if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) + coex_sta->bt_ble_scan_para[2] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); } - - halbtc8703b1ant_update_bt_link_info(btcoexist); - bt_info = bt_info & - 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ - - if (!(bt_info & BT_INFO_8703B_1ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info == - BT_INFO_8703B_1ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); - BTC_TRACE(trace_buf); - } else if ((bt_info & BT_INFO_8703B_1ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8703B_1ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_SCO_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info & BT_INFO_8703B_1ANT_B_ACL_BUSY) { - if (BT_8703B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) - coex_dm->auto_tdma_adjust = false; - coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_ACL_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); - BTC_TRACE(trace_buf); - } else { - coex_dm->bt_status = BT_8703B_1ANT_BT_STATUS_MAX; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); - BTC_TRACE(trace_buf); - } - - if ((BT_8703B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8703B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - bt_busy = true; - else - bt_busy = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); - BTC_TRACE(trace_buf); - return; - } - - /* don't run coex mechanism while receve BTInfo if GNT_WL/GNT_BT control by SW */ - if (!coex_sta->gnt_control_by_PTA) - return; - halbtc8703b1ant_run_coexist_mechanism(btcoexist); } +void ex_halbtc8703b1ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i = 0; + static u8 tmp_buf_pre[10] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi Fw Dbg info = %d %d %d %d %d %d (len = %d)\n", + tmp_buf[0], tmp_buf[1], + tmp_buf[2], tmp_buf[3], + tmp_buf[4], tmp_buf[5], length); + BTC_TRACE(trace_buf); + + if (tmp_buf[0] == 0x8) { + for (i = 1; i <= 5; i++) { + coex_sta->wl_fw_dbg_info[i] = + (tmp_buf[i] >= tmp_buf_pre[i]) ? + (tmp_buf[i] - tmp_buf_pre[i]) : + (255 - tmp_buf_pre[i] + tmp_buf[i]); + + tmp_buf_pre[i] = tmp_buf[i]; + } + } +} + + +void ex_halbtc8703b1ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id) +{ + BOOLEAN wifi_connected = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (is_data_frame) { + coex_sta->wl_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rx_rate_change_notify data rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } else { + coex_sta->wl_rts_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rts_rate_change_notify RTS rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rts_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } + + if ((wifi_connected) && + ((coex_dm->bt_status == BT_8703B_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8703B_1ANT_BT_STATUS_ACL_SCO_BUSY) || + (coex_dm->bt_status == BT_8703B_1ANT_BT_STATUS_SCO_BUSY))) { + + if ((coex_sta->wl_rx_rate == BTC_CCK_5_5) || + (coex_sta->wl_rx_rate == BTC_OFDM_6) || + (coex_sta->wl_rx_rate == BTC_MCS_0)) { + + coex_sta->cck_lock_warn = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck lock warning...\n"); + BTC_TRACE(trace_buf); + } else if ((coex_sta->wl_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rx_rate == BTC_CCK_2) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_2)) { + + coex_sta->cck_lock = TRUE; + coex_sta->cck_lock_ever = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck locking...\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck unlock...\n"); + BTC_TRACE(trace_buf); + } + } else { + if ((coex_dm->bt_status == + BT_8703B_1ANT_BT_STATUS_CONNECTED_IDLE) || + (coex_dm->bt_status == + BT_8703B_1ANT_BT_STATUS_NON_CONNECTED_IDLE)) { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + } + } + +} + + + void ex_halbtc8703b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type) { @@ -4447,27 +4290,34 @@ void ex_halbtc8703b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, "[BTCoex], RF is turned ON!!\n"); BTC_TRACE(trace_buf); - coex_sta->wl_rf_off_on_event = true; - btcoexist->stop_coex_dm = false; - - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); - halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); - - /* halbtc8703b1ant_init_hw_config(btcoexist, false, false); */ + btcoexist->stop_coex_dm = FALSE; + coex_sta->is_rf_state_off = FALSE; +#if 0 + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ONOFF, TRUE); +#endif + /* halbtc8703b1ant_init_hw_config(btcoexist, FALSE, FALSE); */ } else if (BTC_RF_OFF == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF is turned OFF!!\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); - halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE | + BT_8703B_1ANT_SCOREBOARD_ONOFF | + BT_8703B_1ANT_SCOREBOARD_SCAN | + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, + FALSE); - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_WLAN_OFF); - btcoexist->stop_coex_dm = true; - coex_sta->wl_rf_off_on_event = false; + halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = TRUE; } } @@ -4476,18 +4326,23 @@ void ex_halbtc8703b1ant_halt_notify(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); - halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE | + BT_8703B_1ANT_SCOREBOARD_ONOFF | + BT_8703B_1ANT_SCOREBOARD_SCAN | + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, + FALSE); - halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, - false, true); + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8703B_1ANT_PHASE_WLAN_OFF); ex_halbtc8703b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); halbtc8703b1ant_enable_gnt_to_gpio(btcoexist, FALSE); - btcoexist->stop_coex_dm = true; + halbtc8703b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + btcoexist->stop_coex_dm = TRUE; } void ex_halbtc8703b1ant_pnp_notify(IN struct btc_coexist *btcoexist, @@ -4496,27 +4351,43 @@ void ex_halbtc8703b1ant_pnp_notify(IN struct btc_coexist *btcoexist, BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); BTC_TRACE(trace_buf); - if (BTC_WIFI_PNP_SLEEP == pnp_state) { + if ((BTC_WIFI_PNP_SLEEP == pnp_state) || + (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify to SLEEP\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, false); - halbtc8703b1ant_post_onoffState_to_bt(btcoexist, false); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE | + BT_8703B_1ANT_SCOREBOARD_ONOFF | + BT_8703B_1ANT_SCOREBOARD_SCAN | + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, + FALSE); - halbtc8703b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); + if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { - btcoexist->stop_coex_dm = true; + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_2G_RUNTIME); + } else { + + halbtc8703b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8703B_1ANT_PHASE_WLAN_OFF); + } + + btcoexist->stop_coex_dm = TRUE; } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify to WAKE UP\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_post_activestate_to_bt(btcoexist, true); - halbtc8703b1ant_post_onoffState_to_bt(btcoexist, true); - - btcoexist->stop_coex_dm = false; +#if 0 + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_ONOFF, TRUE); +#endif + btcoexist->stop_coex_dm = FALSE; } } @@ -4526,14 +4397,15 @@ void ex_halbtc8703b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) "[BTCoex], *****************Coex DM Reset*****************\n"); BTC_TRACE(trace_buf); - halbtc8703b1ant_init_hw_config(btcoexist, false, false); - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ + halbtc8703b1ant_init_hw_config(btcoexist, FALSE, FALSE); halbtc8703b1ant_init_coex_dm(btcoexist); } void ex_halbtc8703b1ant_periodical(IN struct btc_coexist *btcoexist) { + u32 bt_patch_ver; + boolean wifi_busy = FALSE; + boolean bt_relink_finish = FALSE; #if (BT_AUTO_REPORT_ONLY_8703B_1ANT == 0) halbtc8703b1ant_query_bt_info(btcoexist); @@ -4544,21 +4416,57 @@ void ex_halbtc8703b1ant_periodical(IN struct btc_coexist *btcoexist) halbtc8703b1ant_monitor_bt_enable_disable(btcoexist); +#if 0 + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + /* halbtc8703b1ant_read_score_board(btcoexist, &bt_scoreboard_val); */ + + if (wifi_busy) { + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, TRUE); + /* + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_WLBUSY, TRUE); + + if (bt_scoreboard_val & BIT(6)) + halbtc8703b1ant_query_bt_info(btcoexist); */ + } else { + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_UNDERTEST, FALSE); + /* + halbtc8703b1ant_post_state_to_bt(btcoexist, + BT_8703B_1ANT_SCOREBOARD_WLBUSY, + FALSE); */ + } +#endif + + if (coex_sta->bt_relink_downcount != 0) { + coex_sta->bt_relink_downcount--; + + if (coex_sta->bt_relink_downcount == 0) { + coex_sta->is_setupLink = FALSE; + bt_relink_finish = TRUE; + } + } + /* for 4-way, DHCP, EAPOL packet */ if (coex_sta->specific_pkt_period_cnt > 0) { coex_sta->specific_pkt_period_cnt--; - if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) - coex_sta->wifi_is_high_pri_task = false; + if ((coex_sta->specific_pkt_period_cnt == 0) && + (coex_sta->wifi_is_high_pri_task)) + coex_sta->wifi_is_high_pri_task = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); + "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", + (coex_sta->wifi_is_high_pri_task ? "Yes" : + "No")); BTC_TRACE(trace_buf); } - if (halbtc8703b1ant_is_wifibt_status_changed(btcoexist)) + if (halbtc8703b1ant_is_wifibt_status_changed(btcoexist) || (bt_relink_finish)) halbtc8703b1ant_run_coexist_mechanism(btcoexist); } @@ -4590,3 +4498,4 @@ void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) #endif #endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8703b1Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8703b1ant.h similarity index 75% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8703b1Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8703b1ant.h index cf167a5c7a61..073e036212df 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8703b1Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8703b1ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -18,7 +32,7 @@ #define BT_INFO_8703B_1ANT_B_CONNECTION BIT(0) #define BT_INFO_8703B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) + (((_BT_INFO_EXT_&BIT(0))) ? TRUE : FALSE) #define BTC_RSSI_COEX_THRESH_TOL_8703B_1ANT 2 @@ -118,6 +132,26 @@ enum bt_8703b_1ant_coex_algo { BT_8703B_1ANT_COEX_ALGO_MAX = 0xb, }; +enum bt_8703b_1ant_phase { + BT_8703B_1ANT_PHASE_COEX_INIT = 0x0, + BT_8703B_1ANT_PHASE_WLANONLY_INIT = 0x1, + BT_8703B_1ANT_PHASE_WLAN_OFF = 0x2, + BT_8703B_1ANT_PHASE_2G_RUNTIME = 0x3, + BT_8703B_1ANT_PHASE_5G_RUNTIME = 0x4, + BT_8703B_1ANT_PHASE_BTMPMODE = 0x5, + BT_8703B_1ANT_PHASE_ANTENNA_DET = 0x6, + BT_8703B_1ANT_PHASE_MAX +}; + +enum bt_8703b_1ant_Scoreboard { + BT_8703B_1ANT_SCOREBOARD_ACTIVE = BIT(0), + BT_8703B_1ANT_SCOREBOARD_ONOFF = BIT(1), + BT_8703B_1ANT_SCOREBOARD_SCAN = BIT(2), + BT_8703B_1ANT_SCOREBOARD_UNDERTEST = BIT(3), + BT_8703B_1ANT_SCOREBOARD_WLBUSY = BIT(6) +}; + + struct coex_dm_8703b_1ant { /* hw setting */ u8 pre_ant_pos_type; @@ -177,66 +211,112 @@ struct coex_dm_8703b_1ant { }; struct coex_sta_8703b_1ant { - boolean bt_disabled; - boolean bt_link_exist; - boolean sco_exist; - boolean a2dp_exist; - boolean hid_exist; - boolean pan_exist; - boolean bt_hi_pri_link_exist; + boolean bt_disabled; + boolean bt_link_exist; + boolean sco_exist; + boolean a2dp_exist; + boolean hid_exist; + boolean pan_exist; + boolean bt_hi_pri_link_exist; u8 num_of_profile; - boolean under_lps; - boolean under_ips; + boolean under_lps; + boolean under_ips; u32 specific_pkt_period_cnt; u32 high_priority_tx; u32 high_priority_rx; u32 low_priority_tx; u32 low_priority_rx; + boolean is_hiPri_rx_overhead; s8 bt_rssi; - boolean bt_tx_rx_mask; + boolean bt_tx_rx_mask; u8 pre_bt_rssi_state; u8 pre_wifi_rssi_state[4]; - boolean c2h_bt_info_req_sent; u8 bt_info_c2h[BT_INFO_SRC_8703B_1ANT_MAX][10]; u32 bt_info_c2h_cnt[BT_INFO_SRC_8703B_1ANT_MAX]; - boolean bt_whck_test; - boolean c2h_bt_inquiry_page; - boolean c2h_bt_page; /* Add for win8.1 page out issue */ - boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ + boolean bt_whck_test; + boolean c2h_bt_inquiry_page; + boolean c2h_bt_remote_name_req; + boolean c2h_bt_page; /* Add for win8.1 page out issue */ + boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ u8 bt_retry_cnt; u8 bt_info_ext; + u8 bt_info_ext2; u32 pop_event_cnt; u8 scan_ap_num; u32 crc_ok_cck; u32 crc_ok_11g; u32 crc_ok_11n; - u32 crc_ok_11n_agg; + u32 crc_ok_11n_vht; u32 crc_err_cck; u32 crc_err_11g; u32 crc_err_11n; - u32 crc_err_11n_agg; + u32 crc_err_11n_vht; + + boolean cck_lock; + boolean cck_lock_ever; + boolean cck_lock_warn; - boolean cck_lock; - boolean pre_ccklock; - boolean cck_ever_lock; u8 coex_table_type; + boolean force_lps_ctrl; - boolean force_lps_on; - u32 wrong_profile_notification; - - boolean concurrent_rx_mode_on; + boolean concurrent_rx_mode_on; u16 score_board; + u8 isolation_btween_wb; /* 0~ 50 */ u8 a2dp_bit_pool; u8 cut_version; boolean acl_busy; - boolean wl_rf_off_on_event; boolean bt_create_connection; - boolean gnt_control_by_PTA; + + u32 bt_coex_supported_feature; + u32 bt_coex_supported_version; + + u8 bt_ble_scan_type; + u32 bt_ble_scan_para[3]; + + boolean run_time_state; + boolean freeze_coexrun_by_btinfo; + + boolean is_A2DP_3M; + boolean voice_over_HOGP; + u8 bt_info; + boolean is_autoslot; + u8 forbidden_slot; + u8 hid_busy_num; + u8 hid_pair_cnt; + + u32 cnt_RemoteNameReq; + u32 cnt_setupLink; + u32 cnt_ReInit; + u32 cnt_IgnWlanAct; + u32 cnt_Page; + u32 cnt_RoleSwitch; + + u16 bt_reg_vendor_ac; + u16 bt_reg_vendor_ae; + + boolean is_setupLink; + u8 wl_noisy_level; + u32 gnt_error_cnt; + + u8 bt_afh_map[10]; + u8 bt_relink_downcount; + boolean is_tdma_btautoslot; + boolean is_tdma_btautoslot_hang; + + boolean is_rf_state_off; + + boolean is_hid_low_pri_tx_overhead; + boolean is_bt_multi_link; + boolean is_bt_a2dp_sink; + + u8 wl_fw_dbg_info[10]; + u8 wl_rx_rate; + u8 wl_rts_rx_rate; }; #define BT_8703B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ @@ -302,6 +382,10 @@ void ex_halbtc8703b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8703b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8703b1ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8703b1ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id); void ex_halbtc8703b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8703b1ant_halt_notify(IN struct btc_coexist *btcoexist); @@ -331,6 +415,8 @@ void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); #define ex_halbtc8703b1ant_media_status_notify(btcoexist, type) #define ex_halbtc8703b1ant_specific_packet_notify(btcoexist, type) #define ex_halbtc8703b1ant_bt_info_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8703b1ant_wl_fwdbginfo_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8703b1ant_rx_rate_change_notify(btcoexist, is_data_frame, btc_rate_id) #define ex_halbtc8703b1ant_rf_status_notify(btcoexist, type) #define ex_halbtc8703b1ant_halt_notify(btcoexist) #define ex_halbtc8703b1ant_pnp_notify(btcoexist, pnp_state) @@ -346,3 +432,4 @@ void ex_halbtc8703b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); #endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b1ant.c similarity index 84% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b1Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b1ant.c index 565b3bb76232..9c20add58366 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b1Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b1ant.c @@ -1,4845 +1,5238 @@ -/* ************************************************************ - * Description: - * - * This file is for RTL8723B Co-exist mechanism - * - * History - * 2012/11/15 Cosa first check in. - * - * ************************************************************ */ - -/* ************************************************************ - * include files - * ************************************************************ */ -#include "Mp_Precomp.h" - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8723B_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8723b_1ant glcoex_dm_8723b_1ant; -static struct coex_dm_8723b_1ant *coex_dm = &glcoex_dm_8723b_1ant; -static struct coex_sta_8723b_1ant glcoex_sta_8723b_1ant; -static struct coex_sta_8723b_1ant *coex_sta = &glcoex_sta_8723b_1ant; -static struct psdscan_sta_8723b_1ant gl_psd_scan_8723b_1ant; -static struct psdscan_sta_8723b_1ant *psd_scan = &gl_psd_scan_8723b_1ant; - - -const char *const glbt_info_src_8723b_1ant[]={ - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8723b_1ant = 20151015; -u32 glcoex_ver_8723b_1ant = 0x63; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8723b1ant_ - * ************************************************************ */ - -void halbtc8723b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 dis_rate_mask) -{ - coex_dm->cur_ra_mask = dis_rate_mask; - - if( force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) - btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, - &coex_dm->cur_ra_mask); - coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -} - -void halbtc8723b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - boolean wifi_under_b_mode = false; - - coex_dm->cur_arfr_type = type; - - if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { - switch (coex_dm->cur_arfr_type) { - case 0: /* normal mode */ - btcoexist->btc_write_4byte(btcoexist, 0x430, - coex_dm->backup_arfr_cnt1); - btcoexist->btc_write_4byte(btcoexist, 0x434, - coex_dm->backup_arfr_cnt2); - break; - case 1: - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - if (wifi_under_b_mode) { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x01010101); - } else { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x04030201); - } - break; - default: - break; - } - } - - coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -} - -void halbtc8723b1ant_retry_limit(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_retry_limit_type = type; - - if (force_exec || - (coex_dm->pre_retry_limit_type != - coex_dm->cur_retry_limit_type)) { - switch (coex_dm->cur_retry_limit_type) { - case 0: /* normal mode */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - coex_dm->backup_retry_limit); - break; - case 1: /* retry limit=8 */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - 0x0808); - break; - default: - break; - } - } - - coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -} - -void halbtc8723b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_ampdu_time_type = type; - - if (force_exec || - (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { - switch (coex_dm->cur_ampdu_time_type) { - case 0: /* normal mode */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - coex_dm->backup_ampdu_max_time); - break; - case 1: /* AMPDU timw = 0x38 * 32us */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - 0x38); - break; - default: - break; - } - } - - coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -} - -void halbtc8723b1ant_limited_tx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, - IN u8 retry_limit_type, IN u8 ampdu_time_type) -{ - switch (ra_mask_type) { - case 0: /* normal mode */ - halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, - 0x00000003); - break; - case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ - halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8723b1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8723b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8723b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8723b1ant_limited_rx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean rej_ap_agg_pkt, - IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -{ - boolean reject_rx_agg = rej_ap_agg_pkt; - boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; - u8 rx_agg_size = agg_buf_size; - - /* ============================================ */ - /* Rx Aggregation related setting */ - /* ============================================ */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, - &reject_rx_agg); - /* decide BT control aggregation buf size or not */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, - &bt_ctrl_rx_agg_size); - /* aggregation buf size, only work when BT control Rx aggregation size. */ - btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); - /* real update aggregation setting */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); - - -} - -void halbtc8723b1ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - coex_sta->c2h_bt_info_req_sent = true; - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -void halbtc8723b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -{ - u32 reg_hp_txrx, reg_lp_txrx, u32tmp; - u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; - static u32 num_of_bt_counter_chk = 0; - - reg_hp_txrx = 0x770; - reg_lp_txrx = 0x774; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); - reg_hp_tx = u32tmp & MASKLWORD; - reg_hp_rx = (u32tmp & MASKHWORD) >> 16; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); - reg_lp_tx = u32tmp & MASKLWORD; - reg_lp_rx = (u32tmp & MASKHWORD) >> 16; - - coex_sta->high_priority_tx = reg_hp_tx; - coex_sta->high_priority_rx = reg_hp_rx; - coex_sta->low_priority_tx = reg_lp_tx; - coex_sta->low_priority_rx = reg_lp_rx; - - if ((coex_sta->low_priority_tx > 1050) && - (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->pop_event_cnt++; - - /* reset counter */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); - - /* This part is for wifi FW and driver to update BT's status as disabled. */ - /* The flow is as the following */ - /* 1. disable BT */ - /* 2. if all BT Tx/Rx counter=0, after 6 sec we query bt info */ - /* 3. Because BT will not rsp from mailbox, so wifi fw will know BT is disabled */ - /* 4. FW will rsp c2h for BT that driver will know BT is disabled. */ - if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && - (reg_lp_rx == 0)) { - num_of_bt_counter_chk++; - if (num_of_bt_counter_chk == 3) - halbtc8723b1ant_query_bt_info(btcoexist); - } else - num_of_bt_counter_chk = 0; -} - - -void halbtc8723b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -{ - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false; - static u8 cck_lock_counter = 0; - u32 total_cnt; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - - if (coex_sta->under_ips) { - coex_sta->crc_ok_cck = 0; - coex_sta->crc_ok_11g = 0; - coex_sta->crc_ok_11n = 0; - coex_sta->crc_ok_11n_agg = 0; - - coex_sta->crc_err_cck = 0; - coex_sta->crc_err_11g = 0; - coex_sta->crc_err_11n = 0; - coex_sta->crc_err_11n_agg = 0; - } else { - coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf88); - coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf94); - coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf90); - coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfb8); - - coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf84); - coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf96); - coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf92); - coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfba); - } - - - /* reset counter */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); - - if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { - total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + - coex_sta->crc_ok_11n_agg; - - if ( (coex_dm->bt_status == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == - BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == - BT_8723B_1ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (total_cnt - -coex_sta->crc_ok_cck)) { - if (cck_lock_counter < 3) - cck_lock_counter++; - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - if (!coex_sta->pre_ccklock) { - - if (cck_lock_counter >= 3) - coex_sta->cck_lock = true; - else - coex_sta->cck_lock = false; - } else { - if (cck_lock_counter == 0) - coex_sta->cck_lock = false; - else - coex_sta->cck_lock = true; - } - - if (coex_sta->cck_lock) - coex_sta->cck_ever_lock = true; - - coex_sta->pre_ccklock = coex_sta->cck_lock; - - -} - -boolean halbtc8723b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -{ - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - if (wifi_connected) { - if (wifi_busy != pre_wifi_busy) { - pre_wifi_busy = wifi_busy; - return true; - } - if (under_4way != pre_under_4way) { - pre_under_4way = under_4way; - return true; - } - if (bt_hs_on != pre_bt_hs_on) { - pre_bt_hs_on = bt_hs_on; - return true; - } - - - } - - return false; -} - -void halbtc8723b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - bt_link_info->bt_link_exist = coex_sta->bt_link_exist; - bt_link_info->sco_exist = coex_sta->sco_exist; - bt_link_info->a2dp_exist = coex_sta->a2dp_exist; - bt_link_info->pan_exist = coex_sta->pan_exist; - bt_link_info->hid_exist = coex_sta->hid_exist; - bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; - - /* work around for HS mode. */ - if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; - } - - /* check if Sco only */ - if( bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist ) - bt_link_info->sco_only = true; - else - bt_link_info->sco_only = false; - - /* check if A2dp only */ - if( !bt_link_info->sco_exist && - bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist ) - bt_link_info->a2dp_only = true; - else - bt_link_info->a2dp_only = false; - - /* check if Pan only */ - if( !bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - bt_link_info->pan_exist && - !bt_link_info->hid_exist ) - bt_link_info->pan_only = true; - else - bt_link_info->pan_only = false; - - /* check if Hid only */ - if( !bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - bt_link_info->hid_exist ) - bt_link_info->hid_only = true; - else - bt_link_info->hid_only = false; -} - -void halbtc8723b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean enable_auto_report) -{ - u8 h2c_parameter[1] = {0}; - - h2c_parameter[0] = 0; - - if (enable_auto_report) - h2c_parameter[0] |= BIT(0); - - btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -} - -void halbtc8723b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable_auto_report) -{ - coex_dm->cur_bt_auto_report = enable_auto_report; - - if (!force_exec) { - if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) - return; - } - halbtc8723b1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ - u8 h2c_parameter[6] = {0}; - - h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ - - if (low_penalty_ra) { - h2c_parameter[1] |= BIT(0); - h2c_parameter[2] = - 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ - h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ - h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} - -void halbtc8723b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean low_penalty_ra) -{ - coex_dm->cur_low_penalty_ra = low_penalty_ra; - - if (!force_exec) { - if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) - return; - } - halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, - coex_dm->cur_low_penalty_ra); - - coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -} - -void halbtc8723b1ant_set_coex_table(IN struct btc_coexist *btcoexist, - IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -{ - btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); - - btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); - - btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); - - btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -} - -void halbtc8723b1ant_coex_table(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, - IN u32 val0x6c8, IN u8 val0x6cc) -{ - coex_dm->cur_val0x6c0 = val0x6c0; - coex_dm->cur_val0x6c4 = val0x6c4; - coex_dm->cur_val0x6c8 = val0x6c8; - coex_dm->cur_val0x6cc = val0x6cc; - - if (!force_exec) { - if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && - (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && - (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && - (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) - return; - } - halbtc8723b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, - val0x6cc); - - coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; - coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; - coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; - coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -} - -void halbtc8723b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - -#if BT_8723B_1ANT_ANTDET_ENABLE -#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE - if (board_info->btdm_ant_num_by_ant_det == 2) { - if (type == 3) - type = 14; - else if (type == 4) - type = 13; - else if (type == 5) - type = 8; - } -#endif -#endif - - coex_sta->coex_table_type = type; - - switch (type) { - case 0: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, 0xffffff, 0x3); - break; - case 1: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 2: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 3: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 4: - if ((coex_sta->cck_ever_lock) && - (coex_sta->scan_ap_num <= 5)) - halbtc8723b1ant_coex_table(btcoexist, - force_exec, 0x55555555, 0xaaaa5a5a, - 0xffffff, 0x3); - else - halbtc8723b1ant_coex_table(btcoexist, - force_exec, 0x55555555, 0x5a5a5a5a, - 0xffffff, 0x3); - break; - case 5: - if ((coex_sta->cck_ever_lock) && - (coex_sta->scan_ap_num <= 5)) - halbtc8723b1ant_coex_table(btcoexist, - force_exec, 0x5a5a5a5a, 0x5aaa5a5a, - 0xffffff, 0x3); - else - halbtc8723b1ant_coex_table(btcoexist, - force_exec, 0x5a5a5a5a, 0x5aaa5a5a, - 0xffffff, 0x3); - break; - case 6: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 7: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 8: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 9: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 10: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 11: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 12: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 13: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 14: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); - break; - case 15: - halbtc8723b1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); - break; - default: - break; - } -} - -void halbtc8723b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 h2c_parameter[1] = {0}; - - if (enable) { - h2c_parameter[0] |= BIT(0); /* function enable */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -} - -void halbtc8723b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable) -{ - coex_dm->cur_ignore_wlan_act = enable; - - if (!force_exec) { - if (coex_dm->pre_ignore_wlan_act == - coex_dm->cur_ignore_wlan_act) - return; - } - halbtc8723b1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8723b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, - IN u8 lps_val, IN u8 rpwm_val) -{ - u8 lps = lps_val; - u8 rpwm = rpwm_val; - - btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); - btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -} - -void halbtc8723b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -{ - coex_dm->cur_lps = lps_val; - coex_dm->cur_rpwm = rpwm_val; - - if (!force_exec) { - if ((coex_dm->pre_lps == coex_dm->cur_lps) && - (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) - return; - } - halbtc8723b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); - - coex_dm->pre_lps = coex_dm->cur_lps; - coex_dm->pre_rpwm = coex_dm->cur_rpwm; -} - -void halbtc8723b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, - IN boolean low_penalty_ra) -{ - halbtc8723b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -void halbtc8723b1ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, - IN boolean wifi_off) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; - boolean pg_ext_switch = false; - boolean use_ext_switch = false; - boolean is_in_mp_mode = false; - u8 h2c_parameter[2] = {0}, u8tmp = 0; - - coex_dm->cur_ant_pos_type = ant_pos_type; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, - &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ - - if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) - use_ext_switch = true; - -#if BT_8723B_1ANT_ANTDET_ENABLE -#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE - if (ant_pos_type == BTC_ANT_PATH_PTA) { - if ((board_info->btdm_ant_det_finish) && - (board_info->btdm_ant_num_by_ant_det == 2)) { - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_PATH_WIFI; - else - ant_pos_type = BTC_ANT_PATH_BT; - } - } -#endif -#endif - - if (init_hwcfg) { - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x780); /* WiFi TRx Mask on */ - /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ - /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT TRx Mask on */ - - if (fw_ver >= 0x180000) { - /* Use H2C to set GNT_BT to HIGH */ - h2c_parameter[0] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, - h2c_parameter); - } else { - /* set grant_bt to high */ - btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); - } - /* set wlan_act control by PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, - 0x0); /* BT select s0/s1 is controlled by BT */ - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); - btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); - btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); - } else if (wifi_off) { - if (fw_ver >= 0x180000) { - /* Use H2C to set GNT_BT to HIGH */ - h2c_parameter[0] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, - h2c_parameter); - } else { - /* set grant_bt to high */ - btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); - } - /* set wlan_act to always low */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, - &is_in_mp_mode); - if (!is_in_mp_mode) - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x20, 0x0); /* BT select s0/s1 is controlled by BT */ - else - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, - 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ - - /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp &= ~BIT(23); - u32tmp &= ~BIT(24); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - } else { - /* Use H2C to set GNT_BT to LOW */ - if (fw_ver >= 0x180000) { - if (btcoexist->btc_read_1byte(btcoexist, 0x765) != 0) { - h2c_parameter[0] = 0; - btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, - h2c_parameter); - } - } else { - /* BT calibration check */ - while (cnt_bt_cal_chk <= 20) { - u8tmp = btcoexist->btc_read_1byte(btcoexist, - 0x49d); - cnt_bt_cal_chk++; - if (u8tmp & BIT(0)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", - cnt_bt_cal_chk); - BTC_TRACE(trace_buf); - delay_ms(50); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", - cnt_bt_cal_chk); - BTC_TRACE(trace_buf); - break; - } - } - - /* set grant_bt to PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); - } - - if (btcoexist->btc_read_1byte(btcoexist, 0x76e) != 0xc) { - /* set wlan_act control by PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); - } - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, - 0x1); /* BT select s0/s1 is controlled by WiFi */ - } - - if (use_ext_switch) { - if (init_hwcfg) { - /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp &= ~BIT(23); - u32tmp |= BIT(24); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - - btcoexist->btc_write_4byte(btcoexist, 0x948, - 0x0); /* fixed internal switch S1->WiFi, S0->BT */ - - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) { - /* tell firmware "no antenna inverse" */ - h2c_parameter[0] = 0; - h2c_parameter[1] = 1; /* ext switch type */ - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } else { - /* tell firmware "antenna inverse" */ - h2c_parameter[0] = 1; - h2c_parameter[1] = 1; /* ext switch type */ - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } - } - - if (force_exec || - (coex_dm->cur_ant_pos_type != - coex_dm->pre_ant_pos_type)) { - /* ext switch setting */ - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x92c, 0x3, - 0x1); - else - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x92c, 0x3, - 0x2); - break; - case BTC_ANT_PATH_BT: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x92c, 0x3, - 0x2); - else - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x92c, 0x3, - 0x1); - break; - default: - case BTC_ANT_PATH_PTA: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x92c, 0x3, - 0x1); - else - btcoexist->btc_write_1byte_bitmask( - btcoexist, 0x92c, 0x3, - 0x2); - break; - } - } - } else { - if (init_hwcfg) { - /* 0x4c[23]=1, 0x4c[24]=0 Antenna control by 0x64 */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp |= BIT(23); - u32tmp &= ~BIT(24); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - - /* Fix Ext switch Main->S1, Aux->S0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, - 0x0); - - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) { - - /* tell firmware "no antenna inverse" */ - h2c_parameter[0] = 0; - h2c_parameter[1] = - 0; /* internal switch type */ - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } else { - - /* tell firmware "antenna inverse" */ - h2c_parameter[0] = 1; - h2c_parameter[1] = - 0; /* internal switch type */ - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } - } - - if (force_exec || - (coex_dm->cur_ant_pos_type != - coex_dm->pre_ant_pos_type)) { - /* internal switch setting */ - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_4byte( - btcoexist, 0x948, 0x0); - else - btcoexist->btc_write_4byte( - btcoexist, 0x948, - 0x280); - break; - case BTC_ANT_PATH_BT: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_4byte( - btcoexist, 0x948, - 0x280); - else - btcoexist->btc_write_4byte( - btcoexist, 0x948, 0x0); - break; - default: - case BTC_ANT_PATH_PTA: - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - btcoexist->btc_write_4byte( - btcoexist, 0x948, - 0x200); - else - btcoexist->btc_write_4byte( - btcoexist, 0x948, 0x80); - break; - } - } - } - - coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; -} - -void halbtc8723b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, - IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -{ - u8 h2c_parameter[5] = {0}; - u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - } - } - - h2c_parameter[0] = real_byte1; - h2c_parameter[1] = byte2; - h2c_parameter[2] = byte3; - h2c_parameter[3] = byte4; - h2c_parameter[4] = real_byte5; - - coex_dm->ps_tdma_para[0] = real_byte1; - coex_dm->ps_tdma_para[1] = byte2; - coex_dm->ps_tdma_para[2] = byte3; - coex_dm->ps_tdma_para[3] = byte4; - coex_dm->ps_tdma_para[4] = real_byte5; - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -} - - -void halbtc8723b1ant_ps_tdma(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean turn_on, IN u8 type) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false; - u8 rssi_adjust_val = 0; - u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, - ps_tdma_byte3_val = 0x10; - s8 wifi_duration_adjust = 0x0; - static boolean pre_wifi_busy = false; - - coex_dm->cur_ps_tdma_on = turn_on; - coex_dm->cur_ps_tdma = type; - -#if BT_8723B_1ANT_ANTDET_ENABLE -#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE - if (board_info->btdm_ant_num_by_ant_det == 2) { - if (turn_on) - type = type + - 100; /* for WiFi RSSI low or BT RSSI low */ - else - type = 1; /* always translate to TDMA(off,1) for TDMA-off case */ - } - -#endif -#endif - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (wifi_busy != pre_wifi_busy) { - force_exec = true; - pre_wifi_busy = wifi_busy; - } - - if (!force_exec) { - if( (coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && - (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma) ) - return; - } - - if (coex_sta->scan_ap_num <= 5) { - wifi_duration_adjust = 5; - - if (coex_sta->a2dp_bit_pool >= 35) - wifi_duration_adjust = -10; - else if (coex_sta->a2dp_bit_pool >= 45) - wifi_duration_adjust = -15; - } else if (coex_sta->scan_ap_num >= 40) { - wifi_duration_adjust = -15; - - if (coex_sta->a2dp_bit_pool < 35) - wifi_duration_adjust = -5; - else if (coex_sta->a2dp_bit_pool < 45) - wifi_duration_adjust = -10; - } else if (coex_sta->scan_ap_num >= 20) { - wifi_duration_adjust = -10; - - if (coex_sta->a2dp_bit_pool >= 45) - wifi_duration_adjust = -15; - } else { - wifi_duration_adjust = 0; - - if (coex_sta->a2dp_bit_pool >= 35) - wifi_duration_adjust = -10; - else if (coex_sta->a2dp_bit_pool >= 45) - wifi_duration_adjust = -15; - } - - if ((type == 1) || (type == 2) || (type == 9) || (type == 11) || - (type == 101) - || (type == 102) || (type == 109) || (type == 101)) { - if (!coex_sta->force_lps_on) { /* Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ - ps_tdma_byte0_val = 0x61; /* no null-pkt */ - ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ - ps_tdma_byte4_val = - 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ - } else { - ps_tdma_byte0_val = 0x51; /* null-pkt */ - ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ - ps_tdma_byte4_val = - 0x50; /* 0x778 = d/1 toggle, dynamic slot */ - } - } else if ((type == 3) || (type == 13) || (type == 14) || - (type == 103) || (type == 113) || (type == 114)) { - ps_tdma_byte0_val = 0x51; /* null-pkt */ - ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ - ps_tdma_byte4_val = - 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ -#if 0 - if (!wifi_busy) - ps_tdma_byte4_val = ps_tdma_byte4_val | - 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ -#endif - } else { /* native power save case */ - ps_tdma_byte0_val = 0x61; /* no null-pkt */ - ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ - ps_tdma_byte4_val = - 0x11; /* 0x778 = d/1 toggle, no dynamic slot */ - /* psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case */ - } - - /* if (bt_link_info->slave_role == true) */ - if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) - ps_tdma_byte4_val = ps_tdma_byte4_val | - 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ - - if (type > 100) { - ps_tdma_byte0_val = ps_tdma_byte0_val | - 0x82; /* set antenna control by SW */ - ps_tdma_byte3_val = ps_tdma_byte3_val | - 0x60; /* set antenna no toggle, control by antenna diversity */ - } - - - if (turn_on) { - switch (type) { - default: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, - 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); - break; - case 1: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x3a + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 2: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x2d + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 3: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x30, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 4: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x14, 0x0); - break; - case 5: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x1f, 0x3, - ps_tdma_byte3_val, 0x11); - break; - case 6: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x20, 0x3, - ps_tdma_byte3_val, 0x11); - break; - case 7: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, - 0xc, 0x5, 0x0, 0x0); - break; - case 8: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - break; - case 9: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 10: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0xa, 0x0, 0x40); - break; - case 11: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 12: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, - 0x0a, 0x0a, 0x0, 0x50); - break; - case 13: - if (coex_sta->scan_ap_num <= 3) - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x40, 0x3, - ps_tdma_byte3_val, - ps_tdma_byte4_val); - else - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, - ps_tdma_byte4_val); - break; - case 14: - if (coex_sta->scan_ap_num <= 3) - halbtc8723b1ant_set_fw_pstdma(btcoexist, - 0x51, 0x30, 0x3, 0x10, 0x50); - else - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, - ps_tdma_byte4_val); - break; - case 15: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, - 0xa, 0x3, 0x8, 0x0); - break; - case 16: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, - 0x15, 0x3, 0x10, 0x0); - break; - case 18: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, - 0x25, 0x3, 0x10, 0x0); - break; - case 20: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x3f, 0x03, - ps_tdma_byte3_val, 0x10); - break; - case 21: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x61, - 0x25, 0x03, 0x11, 0x11); - break; - case 22: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x25, 0x03, - ps_tdma_byte3_val, 0x10); - break; - case 23: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x18); - break; - case 24: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x3, 0x31, 0x18); - break; - case 25: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - break; - case 26: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, - 0xa, 0x3, 0x31, 0x18); - break; - case 27: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0x31, 0x98); - break; - case 28: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x69, - 0x25, 0x3, 0x31, 0x0); - break; - case 29: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xab, - 0x1a, 0x1a, 0x1, 0x10); - break; - case 30: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, - 0x30, 0x3, 0x10, 0x10); - break; - case 31: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1a, 0x1a, 0, 0x58); - break; - case 32: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x35, 0x3, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 33: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x35, 0x3, - ps_tdma_byte3_val, 0x10); - break; - case 34: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x53, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 35: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x63, - 0x1a, 0x1a, 0x0, 0x10); - break; - case 36: - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, - 0x12, 0x3, 0x14, 0x50); - break; - case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ - /* here softap mode screen off will cost 70-80mA for phone */ - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x23, - 0x18, 0x00, 0x10, 0x24); - break; - - /* for 1-Ant translate to 2-Ant */ - case 101: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x3a + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 102: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x2d + - wifi_duration_adjust, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 103: - /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); */ - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x3a, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 105: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x15, 0x3, - ps_tdma_byte3_val, 0x11); - break; - case 106: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x20, 0x3, - ps_tdma_byte3_val, 0x11); - break; - case 109: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 111: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 113: - /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x12, 0x12, 0x0, ps_tdma_byte4_val); */ - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 114: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x21, 0x3, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 120: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x3f, 0x03, - ps_tdma_byte3_val, 0x10); - break; - case 122: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x25, 0x03, - ps_tdma_byte3_val, 0x10); - break; - case 132: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x25, 0x03, - ps_tdma_byte3_val, ps_tdma_byte4_val); - break; - case 133: - halbtc8723b1ant_set_fw_pstdma(btcoexist, - ps_tdma_byte0_val, 0x25, 0x03, - ps_tdma_byte3_val, 0x11); - break; - - } - } else { - - /* disable PS tdma */ - switch (type) { - case 8: /* PTA Control */ - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - break; - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - break; - case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ - halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - } - } - rssi_adjust_val = 0; - btcoexist->btc_set(btcoexist, - BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", - btcoexist->btc_read_4byte(btcoexist, 0x948), - btcoexist->btc_read_1byte(btcoexist, 0x765), - btcoexist->btc_read_1byte(btcoexist, 0x67)); - BTC_TRACE(trace_buf); - - /* update pre state */ - coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; - coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -} - -void halbtc8723b1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - static s32 up, dn, m, n, wait_count; - s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ - u8 retry_count = 0, bt_info_ext; - boolean wifi_busy = false; - - if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) - wifi_busy = true; - else - wifi_busy = false; - - if ((BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == - wifi_status) || - (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || - (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == - wifi_status)) { - if (coex_dm->cur_ps_tdma != 1 && - coex_dm->cur_ps_tdma != 2 && - coex_dm->cur_ps_tdma != 3 && - coex_dm->cur_ps_tdma != 9) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 9); - coex_dm->ps_tdma_du_adj_type = 9; - - up = 0; - dn = 0; - m = 1; - n = 3; - result = 0; - wait_count = 0; - } - return; - } - - if (!coex_dm->auto_tdma_adjust) { - coex_dm->auto_tdma_adjust = true; - - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - /* ============ */ - up = 0; - dn = 0; - m = 1; - n = 3; - result = 0; - wait_count = 0; - } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ - retry_count = coex_sta->bt_retry_cnt; - bt_info_ext = coex_sta->bt_info_ext; - - if ((coex_sta->low_priority_tx) > 1050 || - (coex_sta->low_priority_rx) > 1250) - retry_count++; - - result = 0; - wait_count++; - - if (retry_count == - 0) { /* no retry in the last 2-second duration */ - up++; - dn--; - - if (dn <= 0) - dn = 0; - - if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ - wait_count = 0; - n = 3; - up = 0; - dn = 0; - result = 1; - } - } else if (retry_count <= - 3) { /* <=3 retry in the last 2-second duration */ - up--; - dn++; - - if (up <= 0) - up = 0; - - if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ - if (wait_count <= 2) - m++; /* to avoid loop between the two levels */ - else - m = 1; - - if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ - m = 20; - - n = 3 * m; - up = 0; - dn = 0; - wait_count = 0; - result = -1; - } - } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ - if (wait_count == 1) - m++; /* to avoid loop between the two levels */ - else - m = 1; - - if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ - m = 20; - - n = 3 * m; - up = 0; - dn = 0; - wait_count = 0; - result = -1; - } - - if (result == -1) { - /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) - { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } - else */ if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } - } else if (result == 1) { - /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) - { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } - else */ if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = 1; - } - } else { /* no change */ - /* Bryant Modify - if(wifi_busy != pre_wifi_busy) - { - pre_wifi_busy = wifi_busy; - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); - } - */ - - } - - if (coex_dm->cur_ps_tdma != 1 && - coex_dm->cur_ps_tdma != 2 && - coex_dm->cur_ps_tdma != 9 && - coex_dm->cur_ps_tdma != 11) { - /* recover to previous adjust type */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - coex_dm->ps_tdma_du_adj_type); - } - } -} - -void halbtc8723b1ant_ps_tdma_check_for_power_save_state( - IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -{ - u8 lps_mode = 0x0; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); - - if (lps_mode) { /* already under LPS state */ - if (new_ps_state) { - /* keep state under LPS, do nothing. */ - } else { - /* will leave LPS state, turn off psTdma first */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - } else { - /* keep state under NO PS state, do nothing. */ - } - } -} - -void halbtc8723b1ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -{ - boolean low_pwr_disable = false; - - switch (ps_type) { - case BTC_PS_WIFI_NATIVE: - /* recover to original 32k low power setting */ - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - coex_sta->force_lps_on = false; - break; - case BTC_PS_LPS_ON: - halbtc8723b1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8723b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, - lps_val, rpwm_val); - /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - /* power save must executed before psTdma. */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, - NULL); - coex_sta->force_lps_on = true; - break; - case BTC_PS_LPS_OFF: - halbtc8723b1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - coex_sta->force_lps_on = false; - break; - default: - break; - } -} - -void halbtc8723b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, - false, false); -} - -void halbtc8723b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -{ - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - - /* This function check if bt is disabled */ - - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - } else { - bt_disable_cnt++; - if (bt_disable_cnt >= 2) - bt_disabled = true; - } - if (coex_sta->bt_disabled != bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); - BTC_TRACE(trace_buf); - - coex_sta->bt_disabled = bt_disabled; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - if (bt_disabled) { - halbtc8723b1ant_action_wifi_only(btcoexist); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - } - } -} - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ -void halbtc8723b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -{ - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8723b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8723b1ant_action_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8723b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, ap_enable = false, wifi_busy = false, - bt_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - if (coex_sta->bt_abnormal_scan) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 33); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - } else if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || - (bt_link_info->a2dp_exist)) { - /* SCO/HID/A2DP busy */ - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - if (coex_sta->c2h_bt_remote_name_req) - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 33); - else - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if ((bt_link_info->pan_exist) || (wifi_busy)) { - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - if (coex_sta->c2h_bt_remote_name_req) - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 33); - else - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - - } -} - -void halbtc8723b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - /* tdma and coex table */ - - if (bt_link_info->sco_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else { /* HID */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } -} - -void halbtc8723b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips)) - bt_link_info->slave_role = true; - else - bt_link_info->slave_role = false; - - if (bt_link_info->hid_only) { /* HID */ - halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, - wifi_status); - coex_dm->auto_tdma_adjust = false; - return; - } else if (bt_link_info->a2dp_only) { /* A2DP */ - if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - halbtc8723b1ant_tdma_duration_adjust_for_acl(btcoexist, - wifi_status); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = true; - } - } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || - (bt_link_info->hid_exist && bt_link_info->a2dp_exist && - bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { /* HID+A2DP */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - coex_dm->auto_tdma_adjust = false; - - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && - bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - /* BT no-profile busy (0x9) */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } -} - -void halbtc8723b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -{ - /* power save state */ - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, - false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8723b1ant_action_wifi_not_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* Bryant Add */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8723b1ant_action_wifi_not_connected_asso_auth( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || - (bt_link_info->a2dp_exist)) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); - } -} - -void halbtc8723b1ant_action_wifi_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 20); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - /* Bryant Add */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8723b1ant_action_wifi_connected_specific_packet( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* no specific packet process for both WiFi and BT very busy */ - if ((wifi_busy) && ((bt_link_info->pan_exist) || - (coex_sta->num_of_profile >= 2))) - return; - - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else if (bt_link_info->a2dp_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - NORMAL_EXEC, false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8723b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -{ - boolean wifi_busy = false; - boolean scan = false, link = false, roam = false; - boolean under_4way = false, ap_enable = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect()===>\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - if (under_4way) { - halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - if (scan || link || roam) { - if (scan) - halbtc8723b1ant_action_wifi_connected_scan(btcoexist); - else - halbtc8723b1ant_action_wifi_connected_specific_packet( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* power save state */ - if (!ap_enable && - BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && - !btcoexist->bt_link_info.hid_only) { - if (btcoexist->bt_link_info.a2dp_only) { /* A2DP */ - if (!wifi_busy) - halbtc8723b1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else { /* busy */ - if (coex_sta->scan_ap_num >= - BT_8723B_1ANT_WIFI_NOISY_THRESH) /* no force LPS, no PS-TDMA, use pure TDMA */ - halbtc8723b1ant_power_save_state( - btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - else - halbtc8723b1ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } - } else if ((coex_sta->pan_exist == false) && - (coex_sta->a2dp_exist == false) && - (coex_sta->hid_exist == false)) - halbtc8723b1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8723b1ant_power_save_state(btcoexist, - BTC_PS_LPS_ON, 0x50, 0x4); - } else - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - /* tdma and coex table */ - if (!wifi_busy) { - if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8723b1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else { - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8723b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); - /* if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) */ - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - /* else - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); */ - } - } else { - if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8723b1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else { - /* halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - halbtc8723b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); - if ((coex_sta->high_priority_tx) + - (coex_sta->high_priority_rx) <= 60) - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - else - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 7); */ - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8723b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); - halbtc8723b1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - - } - } -} - -void halbtc8723b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false, wifi_busy = false; - boolean increase_scan_dev_num = false; - boolean bt_ctrl_agg_buf_size = false; - boolean miracast_plus_bt = false; - u8 agg_buf_size = 5; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0, wifi_bw; - u8 iot_peer = BTC_IOT_PEER_UNKNOWN; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism()===>\n"); - BTC_TRACE(trace_buf); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (coex_sta->under_ips) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is under IPS !!!\n"); - BTC_TRACE(trace_buf); - return; - } - - if (coex_sta->bt_whck_test) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under WHCK TEST!!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b1ant_action_bt_whck_test(btcoexist); - return; - } - - if ((BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - increase_scan_dev_num = true; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, - &increase_scan_dev_num); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status >> 16; - - if ((num_of_wifi_link >= 2) || - (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { - if (bt_link_info->bt_link_exist) { - halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, - 0, 1); - miracast_plus_bt = true; - } else { - halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, - 0, 0); - miracast_plus_bt = false; - } - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (((bt_link_info->a2dp_exist) || (wifi_busy)) && - (coex_sta->c2h_bt_inquiry_page)) - halbtc8723b1ant_action_bt_inquiry(btcoexist); - else - halbtc8723b1ant_action_wifi_multi_port(btcoexist); - - return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if ((bt_link_info->bt_link_exist) && (wifi_connected)) { - halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); - - /* if(BTC_IOT_PEER_CISCO != iot_peer) */ - if ((BTC_IOT_PEER_CISCO != iot_peer) && - (BTC_IOT_PEER_BROADCOM != iot_peer)) { - if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ - /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, true, false, 0x5); */ - halbtc8723b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, false, 0x5); - else - halbtc8723b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, false, 0x5); - /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); */ - } else { - if (bt_link_info->sco_exist) - halbtc8723b1ant_limited_rx(btcoexist, - NORMAL_EXEC, true, false, 0x5); - else { - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8723b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x10); - else - halbtc8723b1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x8); - } - } - - halbtc8723b1ant_sw_mechanism(btcoexist, true); - } else { - halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); - - halbtc8723b1ant_sw_mechanism(btcoexist, false); - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8723b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8723b1ant_action_hs(btcoexist); - return; - } - - - if (!wifi_connected) { - boolean scan = false, link = false, roam = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is non connected-idle !!!\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || link || roam) { - if (scan) - halbtc8723b1ant_action_wifi_not_connected_scan( - btcoexist); - else - halbtc8723b1ant_action_wifi_not_connected_asso_auth( - btcoexist); - } else - halbtc8723b1ant_action_wifi_not_connected(btcoexist); - } else /* wifi LPS/Busy */ - halbtc8723b1ant_action_wifi_connected(btcoexist); -} - -void halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - - /* sw all off */ - halbtc8723b1ant_sw_mechanism(btcoexist, false); - - /* halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ - /* halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ - - coex_sta->pop_event_cnt = 0; -} - -void halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up, IN boolean wifi_only) -{ - u32 u32tmp = 0; /* , fw_ver; */ - u8 u8tmpa = 0, u8tmpb = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 1Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - psd_scan->ant_det_is_ant_det_available = false; - - /* 0xf0[15:12] --> Chip Cut information */ - coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, - 0xf1) & 0xf0) >> 4; - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, - 0x1); /* enable TBTT nterrupt */ - - /* 0x790[5:0]=0x5 */ - btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); - - /* Enable counter statistics */ - /* btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); //0x76e[3] =1, WLAN_Act control by PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); - - - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); //BT select s0/s1 is controlled by WiFi */ - - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - /* Antenna config */ - if (wifi_only) - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, true, false); - else - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, true, false); - - /* PTA parameter */ - halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); - u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); - u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", - u32tmp, u8tmpa, u8tmpb); - BTC_TRACE(trace_buf); -} - -void halbtc8723b1ant_mechanism_switch(IN struct btc_coexist *btcoexist, - IN boolean bSwitchTo2Antenna) -{ - - if (bSwitchTo2Antenna) { /* 1-Ant -> 2-Ant */ - /* un-lock TRx Mask setup for 8723b f-cut */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x1); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x1); - /* WiFi TRx Mask on */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x0); - - /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, - 0x7c45); - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, - 0x7c45); - - /* BT TRx Mask on */ - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x1); - - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, false); - } else { - /* WiFi TRx Mask on */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x780); - - /* lock TRx Mask setup for 8723b f-cut */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x0); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x0); - - /* BT TRx Mask on */ - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); - - /* BT TRx Mask ock 0x2c[0], 0x30[0] = 0 */ - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, - 0x7c44); - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, - 0x7c44); - - - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); - } - -} - -u32 halbtc8723b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -{ - u8 j; - u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; - u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, - 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, - 32, 23, 15, 7, 0 - }; - - if (val == 0) - return 0; - - tmp = val; - - while (1) { - if (tmp == 1) - break; - else { - tmp = (tmp >> 1); - shiftcount++; - } - } - - - val_integerd_b = shiftcount + 1; - - tmp2 = 1; - for (j = 1; j <= val_integerd_b; j++) - tmp2 = tmp2 * 2; - - tmp = (val * 100) / tmp2; - tindex = tmp / 5; - - if (tindex > 20) - tindex = 20; - - val_fractiond_b = table_fraction[tindex]; - - result = val_integerd_b * 100 - val_fractiond_b; - - return result; - - -} - -void halbtc8723b1ant_psd_show_antenna_detect_result(IN struct btc_coexist - *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - struct btc_board_info *board_info = &btcoexist->board_info; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n============[Antenna Detection info] ============\n"); - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 1) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", - "Ant Det Result", "2-Antenna (Bad-Isolation)", - BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else if (psd_scan->ant_det_result == 2) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "2-Antenna (Good-Isolation)", - BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset, - BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "1-Antenna", - BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT, - BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", - "Antenna Detection Finish", - (board_info->btdm_ant_det_finish - ? "Yes" : "No")); - CL_PRINTF(cli_buf); - - switch (psd_scan->ant_det_result) { - case 0: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is not available)"); - break; - case 1: /* 2-Ant bad-isolation */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 2: /* 2-Ant good-isolation */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 3: /* 1-Ant */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 4: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Uncertainty result)"); - break; - case 5: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); - break; - case 6: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(WiFi is Scanning)"); - break; - case 7: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is not idle)"); - break; - case 8: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Abort by WiFi Scanning)"); - break; - case 9: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Antenna Init is not ready)"); - break; - case 10: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is Inquiry or page)"); - break; - case 11: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is Disabled)"); - break; - } - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Ant Detect Total Count", psd_scan->ant_det_try_count); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Ant Detect Fail Count", psd_scan->ant_det_fail_count); - CL_PRINTF(cli_buf); - - if ((!board_info->btdm_ant_det_finish) && - (psd_scan->ant_det_result != 5)) - return; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", - (psd_scan->ant_det_result ? "ok" : "fail")); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", - psd_scan->ant_det_bt_tx_time); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", - psd_scan->ant_det_bt_le_channel); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", - "WiFi PSD Cent-Ch/Offset/Span", - psd_scan->real_cent_freq, psd_scan->real_offset, - psd_scan->real_span); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", - "PSD Pre-Scan Peak Value", - psd_scan->ant_det_pre_psdscan_peak_val / 100); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", - "PSD Pre-Scan result", - (psd_scan->ant_det_result != 5 ? "ok" : "fail"), - BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 5) - return; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", - "PSD Scan Peak Value", psd_scan->ant_det_peak_val); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", - "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", - (board_info->tfbga_package) ? "Yes" : "No"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "PSD Threshold Offset", psd_scan->ant_det_thres_offset); - CL_PRINTF(cli_buf); - -} - -void halbtc8723b1ant_psd_showdata(IN struct btc_coexist *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - u32 delta_freq_per_point; - u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n\n============[PSD info] (%d)============\n", - psd_scan->psd_gen_count); - CL_PRINTF(cli_buf); - - if (psd_scan->psd_gen_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); - CL_PRINTF(cli_buf); - return; - } - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* if (psd_scan->is_psd_show_max_only) */ - if (0) { - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; - - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + - psd_scan->psd_max_value_point * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.0%d MHz", - freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.%d MHz", - freq1, freq2); - - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - - CL_PRINTF(cli_buf); - } else { - m = psd_scan->psd_start_point; - n = psd_scan->psd_start_point; - i = 1; - j = 1; - - while (1) { - do { - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * - delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (i == 1) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.0%2d", freq1, - freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.%3d", freq1, - freq2); - } else if ((i % 8 == 0) || - (m == psd_scan->psd_stop_point)) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000\n", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d\n", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d\n", freq1, freq2); - } else { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d", freq1, freq2); - } - - i++; - m++; - CL_PRINTF(cli_buf); - - } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); - - - do { - psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; - psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * - 100; - - if (j == 1) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.0%d", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.%d", psd_rep1, - psd_rep2); - } else if ((j % 8 == 0) || - (n == psd_scan->psd_stop_point)) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d\n", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d\n", psd_rep1, psd_rep2); - } else { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d", psd_rep1, psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d", psd_rep1, psd_rep2); - } - - j++; - n++; - CL_PRINTF(cli_buf); - - } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); - - if ((m > psd_scan->psd_stop_point) || - (n > psd_scan->psd_stop_point)) - break; - else { - i = 1; - j = 1; - } - - } - } - - -} - -void halbtc8723b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0, i_max = 0, val_max = 0; - - if (gen_count == 1) { - memcpy(psd_scan->psd_report_max_hold, - psd_scan->psd_report, - BT_8723B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); - - psd_scan->psd_max_value_point = 0; - psd_scan->psd_max_value = 0; - - } else { - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - if (psd_scan->psd_report[i] > - psd_scan->psd_report_max_hold[i]) - psd_scan->psd_report_max_hold[i] = - psd_scan->psd_report[i]; - - /* search Max Value */ - if (i == psd_scan->psd_start_point) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } else { - if (psd_scan->psd_report_max_hold[i] > - val_max) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } - } - - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - - } - - -} - -u32 halbtc8723b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -{ - /* reg 0x808[9:0]: FFT data x */ - /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ - /* reg 0x8b4[15:0]: FFT data y report */ - - u32 val = 0, psd_report = 0; - int k = 0; - - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - - val &= 0xffbffc00; - val |= point; - - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - val |= 0x00400000; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - while (1) { - if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - - -boolean halbtc8723b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, - IN u32 avgnum, IN u32 loopcnt) -{ - u32 i, val, n, k = 0, j, point_index = 0; - u32 points1 = 0, psd_report = 0; - u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; - u32 psd_center_freq = 20 * 10 ^ 6; - boolean outloop = false, scan , roam, is_sweep_ok = true; - u8 flag = 0; - u32 tmp; - u32 wifi_original_channel = 1; - - psd_scan->is_psd_running = true; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); - BTC_TRACE(trace_buf); - - do { - switch (flag) { - case 0: /* Get PSD parameters */ - default: - - psd_scan->psd_band_width = 40 * 1000000; - psd_scan->psd_point = points; - psd_scan->psd_start_base = points / 2; - psd_scan->psd_avg_num = avgnum; - psd_scan->real_cent_freq = cent_freq; - psd_scan->real_offset = offset; - psd_scan->real_span = span; - - - points1 = psd_scan->psd_point; - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* PSD point setup */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffff0fff; - - switch (psd_scan->psd_point) { - case 128: - val |= 0x0; - break; - case 256: - default: - val |= 0x00004000; - break; - case 512: - val |= 0x00008000; - break; - case 1024: - val |= 0x0000c000; - break; - } - - switch (psd_scan->psd_avg_num) { - case 1: - val |= 0x0; - break; - case 8: - val |= 0x00001000; - break; - case 16: - val |= 0x00002000; - break; - case 32: - default: - val |= 0x00003000; - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - flag = 1; - break; - case 1: /* calculate the PSD point index from freq/offset/span */ - psd_center_freq = psd_scan->psd_band_width / 2 + - offset * (1000000); - - start_p = psd_scan->psd_start_base + (psd_center_freq - - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_start_point = start_p - - psd_scan->psd_start_base; - - stop_p = psd_scan->psd_start_base + (psd_center_freq + - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_stop_point = stop_p - - psd_scan->psd_start_base - 1; - - flag = 2; - break; - case 2: /* set RF channel/BW/Mode */ - - /* set 3-wire off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val |= 0x00300000; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val &= 0xfeffffff; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* store WiFi original channel */ - wifi_original_channel = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x18, 0x3ff); - - /* Set RF channel */ - if (cent_freq == 2484) - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, 0xe); - else - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, (cent_freq - 2412) / 5 + - 1); /* WiFi TRx Mask on */ - - - /* Set RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, - 0xfffff, 0x3e4); - - /* Set TRx mask off */ - /* un-lock TRx Mask setup */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, - 0x80, 0x1); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, - 0x1, 0x1); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x0); - - /* Set RF mode = Rx, RF Gain = 0x8a0 */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, - 0xfffff, 0x308a0); - - while (1) { - if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - flag = 3; - break; - case 3: - psd_scan->psd_gen_count = 0; - for (j = 1; j <= loopcnt; j++) { - - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || roam) { - is_sweep_ok = false; - break; - } - memset(psd_scan->psd_report, 0, - psd_scan->psd_point * sizeof(u32)); - start_p = psd_scan->psd_start_point + - psd_scan->psd_start_base; - stop_p = psd_scan->psd_stop_point + - psd_scan->psd_start_base + 1; - - i = start_p; - point_index = 0; - - while (i < stop_p) { - if (i >= points1) - psd_report = - halbtc8723b1ant_psd_getdata( - btcoexist, i - points1); - else - psd_report = - halbtc8723b1ant_psd_getdata( - btcoexist, i); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_raw_data = 0x%08x\n", - i, psd_report); - BTC_TRACE(trace_buf); - if (psd_report == 0) - tmp = 0; - else - /* tmp = 20*log10((double)psd_report); */ - /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ - tmp = 6 * halbtc8723b1ant_psd_log2base( - btcoexist, psd_report); - - n = i - psd_scan->psd_start_base; - psd_scan->psd_report[n] = tmp; - - - halbtc8723b1ant_psd_max_holddata( - btcoexist, j); - - i++; - - } - - psd_scan->psd_gen_count = j; - } - - flag = 100; - break; - case 99: /* error */ - - outloop = true; - break; - case 100: /* recovery */ - - /* set 3-wire on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val &= 0xffcfffff; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val |= 0x01000000; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* PSD off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffbfffff; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - /* TRx Mask on */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x780); - - /* lock TRx Mask setup */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, - 0x80, 0x0); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, - 0x1, 0x0); - - /* Set RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, - 0xfffff, 0x0); - - /* restore WiFi original channel */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, - 0x3ff, wifi_original_channel); - - outloop = true; - break; - - } - - } while (!outloop); - - - - psd_scan->is_psd_running = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - -void halbtc8723b1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 bt_tx_time, IN u32 bt_le_channel) -{ - u32 i = 0; - u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; - s32 wlpsd_offset = -4; - u8 bt_le_ch[13] = {3,6,8,11,13,16,18,21,23,26,28,31,33}; - - u8 h2c_parameter[3] ={0},u8tmpa,u8tmpb; - - u8 state=0; - boolean outloop = false, bt_resp = false; - u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, - u32tmp; - struct btc_board_info *board_info = &btcoexist->board_info; - - board_info->btdm_ant_det_finish = false; - memset(psd_scan->ant_det_peak_val, 0, 16*sizeof(u8)); - memset(psd_scan->ant_det_peak_freq, 0, 16*sizeof(u8)); - - if (board_info->tfbga_package) /* for TFBGA */ - psd_scan->ant_det_thres_offset = 5; - else - psd_scan->ant_det_thres_offset = 0; - - do { - switch (state) { - case 0: - if (bt_le_channel == 39) - wlpsd_cent_freq = 2484; - else { - for (i = 1; i <= 13; i++) { - if (bt_le_ch[i - 1] == - bt_le_channel) { - wlpsd_cent_freq = 2412 - + (i - 1) * 5; - break; - } - } - - if (i == 14) { - - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", - bt_le_channel); - BTC_TRACE(trace_buf); - outloop = true; - break; - } - } - - wlpsd_sweep_count = bt_tx_time * 238 / - 100; /* bt_tx_time/0.42 */ - wlpsd_sweep_count = wlpsd_sweep_count / 5; - - if (wlpsd_sweep_count % 5 != 0) - wlpsd_sweep_count = (wlpsd_sweep_count / - 5 + 1) * 5; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", - bt_tx_time, bt_le_channel); - BTC_TRACE(trace_buf); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", - wlpsd_cent_freq, - wlpsd_offset, - wlpsd_span, - wlpsd_sweep_count); - BTC_TRACE(trace_buf); - - state = 1; - break; - case 1: /* stop coex DM & set antenna path */ - /* Stop Coex DM */ - btcoexist->stop_coex_dm = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); - BTC_TRACE(trace_buf); - - /* set native power save */ - halbtc8723b1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - - /* Set TDMA off, */ - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, - false, 0); - - /* Set coex table */ - halbtc8723b1ant_coex_table_with_type(btcoexist, - FORCE_EXEC, 0); - - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); - BTC_TRACE(trace_buf); - } - - /* Set Antenna path, switch WiFi to un-certain antenna port */ - halbtc8723b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_BT, FORCE_EXEC, false, - false); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); - BTC_TRACE(trace_buf); - - /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ - h2c_parameter[0] = 0x1; - h2c_parameter[1] = 0xd; - h2c_parameter[2] = 0x14; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", - h2c_parameter[1], - h2c_parameter[2]); - BTC_TRACE(trace_buf); - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, - h2c_parameter); - - u32tmp = btcoexist->btc_read_4byte(btcoexist, - 0x948); - u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); - u8tmpb = btcoexist->btc_read_1byte(btcoexist, - 0x778); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x778=0x%x\n", - u32tmp, u8tmpa, u8tmpb); - BTC_TRACE(trace_buf); - - state = 2; - break; - case 2: /* Pre-sweep background psd */ - if (!halbtc8723b1ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, wlpsd_span, - BT_8723B_1ANT_ANTDET_PSD_POINTS, - BT_8723B_1ANT_ANTDET_PSD_AVGNUM, 3)) { - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - - psd_scan->ant_det_pre_psdscan_peak_val = - psd_scan->psd_max_value; - - if (psd_scan->psd_max_value > - (BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset) * 100) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", - psd_scan->psd_max_value / 100, - BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 5; - state = 99; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", - psd_scan->psd_max_value / 100, - BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - state = 3; - } - break; - case 3: - bt_resp = btcoexist->btc_set_bt_ant_detection( - btcoexist, (u8)(bt_tx_time & 0xff), - (u8)(bt_le_channel & 0xff)); - - if (!halbtc8723b1ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, - wlpsd_span, - BT_8723B_1ANT_ANTDET_PSD_POINTS, - BT_8723B_1ANT_ANTDET_PSD_AVGNUM, - wlpsd_sweep_count)) { - board_info->btdm_ant_det_finish - = false; - board_info->btdm_ant_num_by_ant_det - = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - - psd_scan->ant_det_psd_scan_peak_val = - psd_scan->psd_max_value; - psd_scan->ant_det_psd_scan_peak_freq = - psd_scan->psd_max_value_point; - state = 4; - break; - case 4: - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = - psd_scan->psd_band_width / - psd_scan->psd_point; - - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * - 100; - - freq = ((psd_scan->real_cent_freq - 20) * - 1000000 + psd_scan->psd_max_value_point - * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", - freq1, freq2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_freq, - BT_8723B_1ANT_ANTDET_BUF_LEN, - "%d.0%d", freq1, freq2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", - freq1, freq2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_freq, - BT_8723B_1ANT_ANTDET_BUF_LEN, - "%d.%d", freq1, freq2); - } - - if (psd_rep2 < 10) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB\n", - psd_rep1, psd_rep2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_val, - BT_8723B_1ANT_ANTDET_BUF_LEN, - "%d.0%d", psd_rep1, psd_rep2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB\n", - psd_rep1, psd_rep2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_val, - BT_8723B_1ANT_ANTDET_BUF_LEN, - "%d.%d", psd_rep1, psd_rep2); - } - - psd_scan->ant_det_is_btreply_available = true; - - if (bt_resp == false) { - psd_scan->ant_det_is_btreply_available = - false; - psd_scan->ant_det_result = 0; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) { - psd_scan->ant_det_result = 1; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 2; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset) * 100) { - psd_scan->ant_det_result = 2; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 2; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT) * - 100) { - psd_scan->ant_det_result = 3; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); - BTC_TRACE(trace_buf); - } else { - psd_scan->ant_det_result = 4; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); - BTC_TRACE(trace_buf); - } - - state = 99; - break; - case 99: /* restore setup */ - - /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ - h2c_parameter[0] = 0x0; - h2c_parameter[1] = 0x0; - h2c_parameter[2] = 0x0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", - h2c_parameter[1], h2c_parameter[2]); - BTC_TRACE(trace_buf); - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, - h2c_parameter); - - /* Set Antenna Path */ - halbtc8723b1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_PTA, FORCE_EXEC, false, - false); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); - BTC_TRACE(trace_buf); - - /* Resume Coex DM */ - btcoexist->stop_coex_dm = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); - BTC_TRACE(trace_buf); - - /* stimulate coex running */ - halbtc8723b1ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - - outloop = true; - break; - } - - } while (!outloop); - - - -} - -void halbtc8723b1ant_psd_antenna_detection_check(IN struct btc_coexist - *btcoexist) -{ - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - - boolean scan, roam; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - - /* psd_scan->ant_det_bt_tx_time = 20; */ - psd_scan->ant_det_bt_tx_time = - BT_8723B_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ - psd_scan->ant_det_bt_le_channel = BT_8723B_1ANT_ANTDET_BTTXCHANNEL; - - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan || roam) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 6; - } else if (coex_sta->bt_disabled) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 11; - } else if (coex_sta->num_of_profile >= 1) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 7; - } else if ( - !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 9; - } else if (coex_sta->c2h_bt_inquiry_page) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 10; - } else - halbtc8723b1ant_psd_antenna_detection(btcoexist, - psd_scan->ant_det_bt_tx_time, - psd_scan->ant_det_bt_le_channel); - - if (!board_info->btdm_ant_det_finish) - ant_det_fail_count++; - - psd_scan->ant_det_fail_count = ant_det_fail_count; - -} - - -/* ************************************************************ - * work around function start with wa_halbtc8723b1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8723b1ant_ - * ************************************************************ */ -void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u8 u8tmp=0x0; - u16 u16tmp=0x0; - u32 value; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Execute 8723b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Ant Det Finish = %s, Ant Det Number = %d\n", - (board_info->btdm_ant_det_finish ? "Yes" : "No"), - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - - - btcoexist->stop_coex_dm = true; - - btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); - - /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ - u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); - btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); - - /* set GRAN_BT = 1 */ - btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); - /* set WLAN_ACT = 0 */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - /* */ - /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ - /* Local setting bit define */ - /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ - /* BIT1: "0" for internal switch; "1" for external switch */ - /* BIT2: "0" for one antenna; "1" for two antenna */ - /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ - if(btcoexist->chip_interface == BTC_INTF_USB) { - /* fixed at S0 for USB interface */ - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); - - u8tmp |= 0x1; /* antenna inverse */ - btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); - - board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; - } else { - /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ - if (board_info->single_ant_path == 0) { - /* set to S1 */ - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); - board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; - value = 1; - } else if (board_info->single_ant_path == 1) { - /* set to S0 */ - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); - u8tmp |= 0x1; /* antenna inverse */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; - value = 0; - } - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, - &value); - - if(btcoexist->chip_interface == BTC_INTF_PCI) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, - u8tmp); - else if(btcoexist->chip_interface == BTC_INTF_SDIO) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, - u8tmp); - } -} - -void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8723b1ant_init_hw_config(btcoexist, true, wifi_only); - btcoexist->stop_coex_dm = false; -} - -void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Coex Mechanism Init!!\n"); - BTC_TRACE(trace_buf); - - btcoexist->stop_coex_dm = false; - - halbtc8723b1ant_init_coex_dm(btcoexist); - - halbtc8723b1ant_query_bt_info(btcoexist); -} - -void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - u8 *cli_buf = btcoexist->cli_buf; - u8 u8tmp[4], i, bt_info_ext, ps_tdma_case=0; - u16 u16tmp[4]; - u32 u32tmp[4]; - u32 fa_ofdm, fa_cck; - u32 fw_ver=0, bt_patch_ver=0; - static u8 pop_report_in_10s = 0; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cli_buf); - - if(btcoexist->manual_control) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Under Manual Control]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - if(btcoexist->stop_coex_dm) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Coex is STOPPED]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - - if (psd_scan->ant_det_try_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", - "Ant PG Num/ Mech/ Pos", - board_info->pg_ant_num, board_info->btdm_ant_num, - board_info->btdm_ant_pos); - CL_PRINTF(cli_buf); - } else { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", - "Ant PG Num/ Mech(Ant_Det)/ Pos", - board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, - board_info->btdm_ant_pos, - psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, - psd_scan->ant_det_result); - CL_PRINTF(cli_buf); - - if (board_info->btdm_ant_det_finish) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "Ant Det PSD Value", - psd_scan->ant_det_peak_val); - CL_PRINTF(cli_buf); - } - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", - "Version Coex/ Fw/ Patch/ Cut", - glcoex_ver_date_8723b_1ant, glcoex_ver_8723b_1ant, fw_ver, - bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", - "Wifi channel informed to BT", - coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], - coex_dm->wifi_chnl_info[2]); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", - "WifibHiPri/ Ccklock/ CckEverLock", - (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), - (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No")); - CL_PRINTF(cli_buf); - - /* wifi status */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Wifi Status]============"); - CL_PRINTF(cli_buf); - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[BT Status]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "BT Abnormal scan", - (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); - CL_PRINTF(cli_buf); - - pop_report_in_10s++; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", - "BT [status/ rssi/ retryCnt/ popCnt]", - ((coex_sta->bt_disabled)? ("disabled"): (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi, coex_sta->bt_retry_cnt, - coex_sta->pop_event_cnt); - CL_PRINTF(cli_buf); - - if (pop_report_in_10s >= 5) { - coex_sta->pop_event_cnt = 0; - pop_report_in_10s = 0; - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d / %d / %d", - "SCO/HID/PAN/A2DP/NameReq/WHQL", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist, - coex_sta->c2h_bt_remote_name_req, - coex_sta->bt_whck_test); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "BT Role", - (bt_link_info->slave_role) ? "Slave" : "Master"); - CL_PRINTF(cli_buf); - - bt_info_ext = coex_sta->bt_info_ext; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d", - "A2DP Rate/Bitpool", - (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); - CL_PRINTF(cli_buf); - - for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) { - if (coex_sta->bt_info_c2h_cnt[i]) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", - glbt_info_src_8723b_1ant[i], - coex_sta->bt_info_c2h[i][0], - coex_sta->bt_info_c2h[i][1], - coex_sta->bt_info_c2h[i][2], - coex_sta->bt_info_c2h[i][3], - coex_sta->bt_info_c2h[i][4], - coex_sta->bt_info_c2h[i][5], - coex_sta->bt_info_c2h[i][6], - coex_sta->bt_info_c2h_cnt[i]); - CL_PRINTF(cli_buf); - } - } - - - if(btcoexist->manual_control) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms] (before Manual)============"); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "SM[LowPenaltyRA]", - coex_dm->cur_low_penalty_ra); - CL_PRINTF(cli_buf); - - ps_tdma_case = coex_dm->cur_ps_tdma; - if (board_info->btdm_ant_num_by_ant_det == 2) { - if (coex_dm->cur_ps_tdma_on) - ps_tdma_case = ps_tdma_case + - 100; /* for WiFi RSSI low or BT RSSI low */ - else - ps_tdma_case = - 1; /* always translate to TDMA(off,1) for TDMA-off case */ - } - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", - "PS TDMA", - coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], - coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], - coex_dm->ps_tdma_para[4], ps_tdma_case, - (coex_dm->cur_ps_tdma_on ? "On" : "Off"), - (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Coex Table Type", - coex_sta->coex_table_type); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "IgnWlanAct", - coex_dm->cur_ignore_wlan_act); - CL_PRINTF(cli_buf); - - /* - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", - coex_dm->error_condition); - CL_PRINTF(cli_buf); - */ - - /* Hw setting */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Hw setting]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", - "backup ARFR1/ARFR2/RL/AMaxTime", - coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, - coex_dm->backup_retry_limit, - coex_dm->backup_ampdu_max_time); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", - "0x430/0x434/0x42a/0x456", - u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x880); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x778/0x6cc/0x880[29:25]", - u8tmp[0], u32tmp[0], (u32tmp[1] & 0x3e000000) >> 25); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x764); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x76e); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x948/ 0x67[5] / 0x764 / 0x76e", - u32tmp[0], ((u8tmp[0] & 0x20) >> 5), (u32tmp[1] & 0xffff), - u8tmp[1]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", - u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x38[11]/0x40/0x4c[24:23]/0x64[0]", - ((u8tmp[0] & 0x8) >> 3), u8tmp[1], - ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x550(bcn ctrl)/0x522", - u32tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0xc50(dig)/0x49c(null-drop)", - u32tmp[0] & 0xff, u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); - u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - - fa_ofdm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) - >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + - ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & - 0xffff) ; - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "OFDM-CCA/OFDM-FA/CCK-FA", - u32tmp[0] & 0xffff, fa_ofdm, fa_cck); - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11n-Agg", - coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_Err CCK/11g/11n/11n-Agg", - coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x6c0/0x6c4/0x6c8(coexTable)", - u32tmp[0], u32tmp[1], u32tmp[2]); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770(high-pri rx/tx)", - coex_sta->high_priority_rx, coex_sta->high_priority_tx); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri rx/tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); -#if (BT_AUTO_REPORT_ONLY_8723B_1ANT == 1) - /* halbtc8723b1ant_monitor_bt_ctr(btcoexist); */ -#endif - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - if(btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - - if (BTC_IPS_ENTER == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS ENTER notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } else if (BTC_IPS_LEAVE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - - halbtc8723b1ant_init_hw_config(btcoexist, false, false); - halbtc8723b1ant_init_coex_dm(btcoexist); - halbtc8723b1ant_query_bt_info(btcoexist); - - coex_sta->under_ips = false; - } -} - -void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - if(btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - - if (BTC_LPS_ENABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS ENABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = true; - } else if (BTC_LPS_DISABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS DISABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = false; - } -} - -void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected=false, bt_hs_on=false; - u32 wifi_link_status=0; - u32 num_of_wifi_link=0; - boolean bt_ctrl_agg_buf_size=false; - u8 agg_buf_size=5; - - u8 u8tmpa, u8tmpb; - u32 u32tmp; - - if(btcoexist->manual_control || - btcoexist->stop_coex_dm ) - return; - - if (BTC_SCAN_START == type) { - coex_sta->wifi_is_high_pri_task = true; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN START notify\n"); - BTC_TRACE(trace_buf); - psd_scan->ant_det_is_ant_det_available = true; - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); /* Force antenna setup for no scan result issue */ - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); - u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); - u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", - u32tmp, u8tmpa, u8tmpb); - BTC_TRACE(trace_buf); - } else { - coex_sta->wifi_is_high_pri_task = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &coex_sta->scan_ap_num); - } - - if(coex_sta->bt_disabled) - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, -&wifi_connected); - - halbtc8723b1ant_query_bt_info(btcoexist); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status>>16; - if (num_of_wifi_link >= 2) { - halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8723b1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8723b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8723b1ant_action_hs(btcoexist); - return; - } - - if (BTC_SCAN_START == type) { - if (!wifi_connected) /* non-connected scan */ - halbtc8723b1ant_action_wifi_not_connected_scan( - btcoexist); - else /* wifi is connected */ - halbtc8723b1ant_action_wifi_connected_scan(btcoexist); - } else if (BTC_SCAN_FINISH == type) { - if (!wifi_connected) /* non-connected scan */ - halbtc8723b1ant_action_wifi_not_connected(btcoexist); - else - halbtc8723b1ant_action_wifi_connected(btcoexist); - } -} - -void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected=false, bt_hs_on=false; - u32 wifi_link_status=0; - u32 num_of_wifi_link=0; - boolean bt_ctrl_agg_buf_size=false; - u8 agg_buf_size=5; - - if(btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled ) - return; - - if (BTC_ASSOCIATE_START == type) { - coex_sta->wifi_is_high_pri_task = true; - psd_scan->ant_det_is_ant_det_available = true; - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); /* Force antenna setup for no scan result issue */ - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT START notify\n"); - BTC_TRACE(trace_buf); - coex_dm->arp_cnt = 0; - } else { - coex_sta->wifi_is_high_pri_task = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT FINISH notify\n"); - BTC_TRACE(trace_buf); - /* coex_dm->arp_cnt = 0; */ - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status >> 16; - if (num_of_wifi_link >= 2) { - halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8723b1ant_action_wifi_multi_port(btcoexist); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8723b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8723b1ant_action_hs(btcoexist); - return; - } - - if (BTC_ASSOCIATE_START == type) - halbtc8723b1ant_action_wifi_not_connected_asso_auth(btcoexist); - else if (BTC_ASSOCIATE_FINISH == type) { - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - if (!wifi_connected) /* non-connected scan */ - halbtc8723b1ant_action_wifi_not_connected(btcoexist); - else - halbtc8723b1ant_action_wifi_connected(btcoexist); - } -} - -void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_parameter[3] ={0}; - u32 wifi_bw; - u8 wifi_central_chnl; - boolean wifi_under_b_mode = false; - - if(btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled ) - return; - - if (BTC_MEDIA_CONNECT == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA connect notify\n"); - BTC_TRACE(trace_buf); - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); /* Force antenna setup for no scan result issue */ - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, false, false); - psd_scan->ant_det_is_ant_det_available = true; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - - /* Set CCK Tx/Rx high Pri except 11b mode */ - if (wifi_under_b_mode) { - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x00); /* CCK Rx */ - } else { - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x10); /* CCK Rx */ - } - - coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, - 0x430); - coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, - 0x434); - coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( - btcoexist, 0x42a); - coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( - btcoexist, 0x456); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA disconnect notify\n"); - BTC_TRACE(trace_buf); - coex_dm->arp_cnt = 0; - - btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ - - coex_sta->cck_ever_lock = false; - } - - /* only 2.4G we need to inform bt the chnl mask */ - btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, - &wifi_central_chnl); - if ((BTC_MEDIA_CONNECT == type) && - (wifi_central_chnl <= 14)) { - /* h2c_parameter[0] = 0x1; */ - h2c_parameter[0] = 0x0; - h2c_parameter[1] = wifi_central_chnl; - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) - h2c_parameter[2] = 0x30; - else - h2c_parameter[2] = 0x20; - } - - coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; - coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; - coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -} - -void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean bt_hs_on=false; - u32 wifi_link_status=0; - u32 num_of_wifi_link=0; - boolean bt_ctrl_agg_buf_size=false, under_4way=false; - u8 agg_buf_size=5; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - if(btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled ) - return; - - if (BTC_PACKET_DHCP == type || - BTC_PACKET_EAPOL == type || - BTC_PACKET_ARP == type) { - if (BTC_PACKET_ARP == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ARP notify\n"); - BTC_TRACE(trace_buf); - - coex_dm->arp_cnt++; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ARP Packet Count = %d\n", - coex_dm->arp_cnt); - BTC_TRACE(trace_buf); - - if ((coex_dm->arp_cnt >= 10) && - (!under_4way)) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ - coex_sta->wifi_is_high_pri_task = false; - else - coex_sta->wifi_is_high_pri_task = true; - } else { - coex_sta->wifi_is_high_pri_task = true; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet DHCP or EAPOL notify\n"); - BTC_TRACE(trace_buf); - } - } else { - coex_sta->wifi_is_high_pri_task = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet [Type = %d] notify\n", type); - BTC_TRACE(trace_buf); - } - - coex_sta->specific_pkt_period_cnt = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status >> 16; - if (num_of_wifi_link >= 2) { - halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - halbtc8723b1ant_action_wifi_multi_port(btcoexist); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8723b1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8723b1ant_action_hs(btcoexist); - return; - } - - if (BTC_PACKET_DHCP == type || - BTC_PACKET_EAPOL == type || - ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) - halbtc8723b1ant_action_wifi_connected_specific_packet(btcoexist); -} - -void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length) -{ - u8 bt_info = 0; - u8 i, rsp_source=0; - boolean wifi_connected=false; - boolean bt_busy=false; - struct btc_board_info *board_info = &btcoexist->board_info; - - coex_sta->c2h_bt_info_req_sent = false; - - rsp_source = tmp_buf[0]&0xf; - if(rsp_source >= BT_INFO_SRC_8723B_1ANT_MAX) - rsp_source = BT_INFO_SRC_8723B_1ANT_WIFI_FW; - coex_sta->bt_info_c2h_cnt[rsp_source]++; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, -"[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, -length); - BTC_TRACE(trace_buf); - for (i = 0; i < length; i++) { - coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; - if (i == 1) - bt_info = tmp_buf[i]; - if (i == length - 1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } - } - - /* if 0xff, it means BT is under WHCK test */ - if (bt_info == 0xff) - coex_sta->bt_whck_test = true; - else - coex_sta->bt_whck_test = false; - - if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rsp_source) { - coex_sta->bt_retry_cnt = /* [3:0] */ - coex_sta->bt_info_c2h[rsp_source][2]&0xf; - - if (coex_sta->bt_retry_cnt >= 1) - coex_sta->pop_event_cnt++; - - if (coex_sta->bt_info_c2h[rsp_source][2]&0x20) - coex_sta->c2h_bt_remote_name_req = true; - else - coex_sta->c2h_bt_remote_name_req = false; - - coex_sta->bt_rssi = - coex_sta->bt_info_c2h[rsp_source][3]*2-90; - /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ - - coex_sta->bt_info_ext = - coex_sta->bt_info_c2h[rsp_source][4]; - - if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) { - coex_sta->a2dp_bit_pool = - coex_sta->bt_info_c2h[rsp_source][6]; - } else - coex_sta->a2dp_bit_pool = 0; - - coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] - & 0x40); - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, - &coex_sta->bt_tx_rx_mask); - -#if BT_8723B_1ANT_ANTDET_ENABLE -#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE - if ((board_info->btdm_ant_det_finish) && - (board_info->btdm_ant_num_by_ant_det == 2)) { - if (coex_sta->bt_tx_rx_mask) { - /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x1\n"); - BTC_TRACE(trace_buf); - - /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ - btcoexist->btc_set_bt_reg(btcoexist, - BTC_BT_REG_RF, 0x2c, 0x7c45); - btcoexist->btc_set_bt_reg(btcoexist, - BTC_BT_REG_RF, 0x30, 0x7c45); - - btcoexist->btc_set_bt_reg(btcoexist, - BTC_BT_REG_RF, 0x3c, 0x1); - } - } else -#endif -#endif - - { - if (!coex_sta->bt_tx_rx_mask) { - /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, - 0x3c, 0x15); - - /* BT TRx Mask lock 0x2c[0], 0x30[0] = 0 */ - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, - 0x2c, 0x7c44); - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, - 0x30, 0x7c44); - } - } - - /* Here we need to resend some wifi info to BT */ - /* because bt is reset and loss of the info. */ - if (coex_sta->bt_info_ext & BIT(1)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - if (wifi_connected) - ex_halbtc8723b1ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8723b1ant_media_status_notify( - btcoexist, BTC_MEDIA_DISCONNECT); - } - - if (coex_sta->bt_info_ext & BIT(3)) { - if(!btcoexist->manual_control && - !btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); - } - } else { - /* BT already NOT ignore Wlan active, do nothing here. */ - } -#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) - if ((coex_sta->bt_info_ext & BIT(4))) { - /* BT auto report already enabled, do nothing */ - } else - halbtc8723b1ant_bt_auto_report(btcoexist, FORCE_EXEC, - true); -#endif - } - - /* check BIT2 first ==> check if bt is under inquiry or page scan */ - if (bt_info & BT_INFO_8723B_1ANT_B_INQ_PAGE) - coex_sta->c2h_bt_inquiry_page = true; - else - coex_sta->c2h_bt_inquiry_page = false; - - coex_sta->num_of_profile = 0; - - /* set link exist status */ - if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; - - coex_sta->bt_hi_pri_link_exist = false; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (bt_info & BT_INFO_8723B_1ANT_B_FTP) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8723B_1ANT_B_A2DP) { - coex_sta->a2dp_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8723B_1ANT_B_HID) { - coex_sta->hid_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) { - coex_sta->sco_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->sco_exist = false; - - if ((coex_sta->hid_exist == false) && - (coex_sta->c2h_bt_inquiry_page == false) && - (coex_sta->sco_exist == false)) { - if (coex_sta->high_priority_tx + - coex_sta->high_priority_rx >= 160) { - coex_sta->hid_exist = true; - coex_sta->wrong_profile_notification++; - coex_sta->num_of_profile++; - bt_info = bt_info | 0x28; - } - } - - /* Add Hi-Pri Tx/Rx counter to avoid false detection */ - if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && - (coex_sta->high_priority_tx + - coex_sta->high_priority_rx >= 160) - && (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->bt_hi_pri_link_exist = true; - - if ((bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) && - (coex_sta->num_of_profile == 0)) { - if (coex_sta->low_priority_tx + - coex_sta->low_priority_rx >= 160) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - coex_sta->wrong_profile_notification++; - bt_info = bt_info | 0x88; - } - } - } - - halbtc8723b1ant_update_bt_link_info(btcoexist); - - bt_info = bt_info & - 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ - - if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) - coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; - else if (bt_info == - BT_INFO_8723B_1ANT_B_CONNECTION) /* connection exists but no busy */ - coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE; - else if ((bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8723B_1ANT_B_SCO_BUSY)) - coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_SCO_BUSY; - else if (bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) { - if(BT_8723B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) - coex_dm->auto_tdma_adjust = false; - coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_ACL_BUSY; - } else - coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_MAX; - - if( (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status) ) - bt_busy = true; - else - bt_busy = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - halbtc8723b1ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u32 u32tmp; - u8 u8tmpa,u8tmpb, u8tmpc; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_RF_ON == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned ON!!\n"); - BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; - } else if (BTC_RF_OFF == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned OFF!!\n"); - BTC_TRACE(trace_buf); - - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, -0x0, 0x0); - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, -FORCE_EXEC, false, true); - - halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - btcoexist->stop_coex_dm = true; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); - u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); - u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); - u8tmpc = btcoexist->btc_read_1byte(btcoexist, 0x76e); - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", - u32tmp, u8tmpa, u8tmpb, u8tmpc); - BTC_TRACE(trace_buf); - - } -} - -void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, - false, true); - - halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8723b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state) -{ - if (BTC_WIFI_PNP_SLEEP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to SLEEP\n"); - BTC_TRACE(trace_buf); - - halbtc8723b1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, - FORCE_EXEC, false, true); - halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - - /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ - /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ - /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ - coex_sta->under_ips = false; - coex_sta->under_lps = false; - btcoexist->stop_coex_dm = true; - } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to WAKE UP\n"); - BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; - halbtc8723b1ant_init_hw_config(btcoexist, false, false); - halbtc8723b1ant_init_coex_dm(btcoexist); - halbtc8723b1ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -{ - - halbtc8723b1ant_init_hw_config(btcoexist, false, false); - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ - halbtc8723b1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ==========================Periodical===========================\n"); - BTC_TRACE(trace_buf); - -#if(BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) - halbtc8723b1ant_query_bt_info(btcoexist); - halbtc8723b1ant_monitor_bt_enable_disable(btcoexist); -#else - halbtc8723b1ant_monitor_bt_ctr(btcoexist); - halbtc8723b1ant_monitor_wifi_ctr(btcoexist); -#if BT_8723B_1ANT_ANTDET_ENABLE - halbtc8723b1ant_monitor_bt_enable_disable(btcoexist); -#endif - - if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && - (bt_link_info->hid_exist == true)) - bt_link_info->hid_exist = false; - - if( halbtc8723b1ant_is_wifi_status_changed(btcoexist) || - coex_dm->auto_tdma_adjust ) - halbtc8723b1ant_run_coexist_mechanism(btcoexist); - - coex_sta->specific_pkt_period_cnt++; - - /* sample to set bt to execute Ant detection */ - /* btcoexist->btc_set_bt_ant_detection(btcoexist, 20, 14); - * - if (psd_scan->is_ant_det_enable) - { - if (psd_scan->psd_gen_count > psd_scan->realseconds) - psd_scan->psd_gen_count = 0; - - halbtc8723b1ant_antenna_detection(btcoexist, psd_scan->realcent_freq, psd_scan->realoffset, psd_scan->realspan, psd_scan->realseconds); - psd_scan->psd_gen_total_count +=2; - psd_scan->psd_gen_count += 2; - } - */ -#endif -} - -void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ -#if BT_8723B_1ANT_ANTDET_ENABLE - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - /*boolean scan, roam;*/ - - if (seconds == 0) { - psd_scan->ant_det_try_count = 0; - psd_scan->ant_det_fail_count = 0; - ant_det_count = 0; - ant_det_fail_count = 0; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - return; - } - - if (!board_info->btdm_ant_det_finish) { - psd_scan->ant_det_inteval_count = - psd_scan->ant_det_inteval_count + 2; - - if (psd_scan->ant_det_inteval_count >= - BT_8723B_1ANT_ANTDET_RETRY_INTERVAL) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b1ant_psd_antenna_detection_check(btcoexist); - - if (board_info->btdm_ant_det_finish) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); - BTC_TRACE(trace_buf); -#if 1 - if (board_info->btdm_ant_num_by_ant_det == 2) - halbtc8723b1ant_mechanism_switch( - btcoexist, true); - else - halbtc8723b1ant_mechanism_switch( - btcoexist, false); -#endif - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); - BTC_TRACE(trace_buf); - } - psd_scan->ant_det_inteval_count = 0; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", - psd_scan->ant_det_inteval_count); - BTC_TRACE(trace_buf); - } - - } -#endif - - -/* - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - - psd_scan->ant_det_bt_tx_time = seconds; - psd_scan->ant_det_bt_le_channel = cent_freq; - - if (seconds == 0) - { - psd_scan->ant_det_try_count = 0; - psd_scan->ant_det_fail_count = 0; - ant_det_count = 0; - ant_det_fail_count = 0; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - return; - } - else - { - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan ||roam) - { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 6; - } - else if (coex_sta->num_of_profile >= 1) - { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 7; - } - else if (!psd_scan->ant_det_is_ant_det_available) - { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 9; - } - else if (coex_sta->c2h_bt_inquiry_page) - { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 10; - } - else - { - - } - - if (!board_info->btdm_ant_det_finish) - ant_det_fail_count++; - - psd_scan->ant_det_fail_count = ant_det_fail_count; - } -*/ -} - - -void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ -#if BT_8723B_1ANT_ANTDET_ENABLE - struct btc_board_info *board_info = &btcoexist->board_info; - - if (psd_scan->ant_det_try_count != 0) { - halbtc8723b1ant_psd_show_antenna_detect_result(btcoexist); - - if (board_info->btdm_ant_det_finish) - halbtc8723b1ant_psd_showdata(btcoexist); - return; - } -#endif - - /* halbtc8723b1ant_show_psd_data(btcoexist); */ -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * Description: + * + * This file is for RTL8723B Co-exist mechanism + * + * History + * 2012/11/15 Cosa first check in. + * + * ************************************************************ */ + +/* ************************************************************ + * include files + * ************************************************************ */ +#include "mp_precomp.h" + +#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + +#if (RTL8723B_SUPPORT == 1) +/* ************************************************************ + * Global variables, these are static variables + * ************************************************************ */ +static u8 *trace_buf = &gl_btc_trace_buf[0]; +static struct coex_dm_8723b_1ant glcoex_dm_8723b_1ant; +static struct coex_dm_8723b_1ant *coex_dm = &glcoex_dm_8723b_1ant; +static struct coex_sta_8723b_1ant glcoex_sta_8723b_1ant; +static struct coex_sta_8723b_1ant *coex_sta = &glcoex_sta_8723b_1ant; +static struct psdscan_sta_8723b_1ant gl_psd_scan_8723b_1ant; +static struct psdscan_sta_8723b_1ant *psd_scan = &gl_psd_scan_8723b_1ant; + + +const char *const glbt_info_src_8723b_1ant[] = { + "BT Info[wifi fw]", + "BT Info[bt rsp]", + "BT Info[bt auto report]", +}; + +u32 glcoex_ver_date_8723b_1ant = 20170517; +u32 glcoex_ver_8723b_1ant = 0x6a; +u32 glcoex_ver_btdesired_8723b_1ant = 0x6a; + +/* ************************************************************ + * local function proto type if needed + * ************************************************************ + * ************************************************************ + * local function start with halbtc8723b1ant_ + * ************************************************************ */ + +void halbtc8723b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 dis_rate_mask) +{ + coex_dm->cur_ra_mask = dis_rate_mask; + + if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, + &coex_dm->cur_ra_mask); + coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; +} + +void halbtc8723b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + boolean wifi_under_b_mode = false; + + coex_dm->cur_arfr_type = type; + + if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { + switch (coex_dm->cur_arfr_type) { + case 0: /* normal mode */ + btcoexist->btc_write_4byte(btcoexist, 0x430, + coex_dm->backup_arfr_cnt1); + btcoexist->btc_write_4byte(btcoexist, 0x434, + coex_dm->backup_arfr_cnt2); + break; + case 1: + btcoexist->btc_get(btcoexist, + BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + if (wifi_under_b_mode) { + btcoexist->btc_write_4byte(btcoexist, + 0x430, 0x0); + btcoexist->btc_write_4byte(btcoexist, + 0x434, 0x01010101); + } else { + btcoexist->btc_write_4byte(btcoexist, + 0x430, 0x0); + btcoexist->btc_write_4byte(btcoexist, + 0x434, 0x04030201); + } + break; + default: + break; + } + } + + coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; +} + +void halbtc8723b1ant_retry_limit(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + coex_dm->cur_retry_limit_type = type; + + if (force_exec || + (coex_dm->pre_retry_limit_type != + coex_dm->cur_retry_limit_type)) { + switch (coex_dm->cur_retry_limit_type) { + case 0: /* normal mode */ + btcoexist->btc_write_2byte(btcoexist, 0x42a, + coex_dm->backup_retry_limit); + break; + case 1: /* retry limit=8 */ + btcoexist->btc_write_2byte(btcoexist, 0x42a, + 0x0808); + break; + default: + break; + } + } + + coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; +} + +void halbtc8723b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + coex_dm->cur_ampdu_time_type = type; + + if (force_exec || + (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { + switch (coex_dm->cur_ampdu_time_type) { + case 0: /* normal mode */ + btcoexist->btc_write_1byte(btcoexist, 0x456, + coex_dm->backup_ampdu_max_time); + break; + case 1: /* AMPDU timw = 0x38 * 32us */ + btcoexist->btc_write_1byte(btcoexist, 0x456, + 0x38); + break; + default: + break; + } + } + + coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; +} + +void halbtc8723b1ant_limited_tx(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, + IN u8 retry_limit_type, IN u8 ampdu_time_type) +{ + switch (ra_mask_type) { + case 0: /* normal mode */ + halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, + 0x0); + break; + case 1: /* disable cck 1/2 */ + halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, + 0x00000003); + break; + case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ + halbtc8723b1ant_update_ra_mask(btcoexist, force_exec, + 0x0001f1f7); + break; + default: + break; + } + + halbtc8723b1ant_auto_rate_fallback_retry(btcoexist, force_exec, + arfr_type); + halbtc8723b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); + halbtc8723b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); +} + +void halbtc8723b1ant_limited_rx(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean rej_ap_agg_pkt, + IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) +{ + boolean reject_rx_agg = rej_ap_agg_pkt; + boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; + u8 rx_agg_size = agg_buf_size; + + /* ============================================ */ + /* Rx Aggregation related setting */ + /* ============================================ */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, + &reject_rx_agg); + /* decide BT control aggregation buf size or not */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, + &bt_ctrl_rx_agg_size); + /* aggregation buf size, only work when BT control Rx aggregation size. */ + btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); + /* real update aggregation setting */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); + + +} + +void halbtc8723b1ant_query_bt_info(IN struct btc_coexist *btcoexist) +{ + u8 h2c_parameter[1] = {0}; + + coex_sta->c2h_bt_info_req_sent = true; + + h2c_parameter[0] |= BIT(0); /* trigger */ + + btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); +} + +void halbtc8723b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) +{ + u32 reg_hp_txrx, reg_lp_txrx, u32tmp; + u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; + static u32 num_of_bt_counter_chk = 0; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ + /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ + + reg_hp_txrx = 0x770; + reg_lp_txrx = 0x774; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); + reg_hp_tx = u32tmp & MASKLWORD; + reg_hp_rx = (u32tmp & MASKHWORD) >> 16; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); + reg_lp_tx = u32tmp & MASKLWORD; + reg_lp_rx = (u32tmp & MASKHWORD) >> 16; + + coex_sta->high_priority_tx = reg_hp_tx; + coex_sta->high_priority_rx = reg_hp_rx; + coex_sta->low_priority_tx = reg_lp_tx; + coex_sta->low_priority_rx = reg_lp_rx; + + if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && + (bt_link_info->hid_exist == true)) + bt_link_info->hid_exist = false; + + if ((coex_sta->low_priority_tx > 1050) && + (!coex_sta->c2h_bt_inquiry_page)) + coex_sta->pop_event_cnt++; + + if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips) + && (coex_sta->low_priority_rx >= + coex_sta->low_priority_tx) && + (!coex_sta->c2h_bt_inquiry_page)) + bt_link_info->slave_role = true; + else + bt_link_info->slave_role = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); + BTC_TRACE(trace_buf); + + /* reset counter */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); + + /* This part is for wifi FW and driver to update BT's status as disabled. */ + /* The flow is as the following */ + /* 1. disable BT */ + /* 2. if all BT Tx/Rx counter=0, after 6 sec we query bt info */ + /* 3. Because BT will not rsp from mailbox, so wifi fw will know BT is disabled */ + /* 4. FW will rsp c2h for BT that driver will know BT is disabled. */ + if ((reg_hp_tx == 0) && (reg_hp_rx == 0) && (reg_lp_tx == 0) && + (reg_lp_rx == 0)) { + num_of_bt_counter_chk++; + if (num_of_bt_counter_chk >= 3) { + halbtc8723b1ant_query_bt_info(btcoexist); + num_of_bt_counter_chk = 0; + } + } + +} + + +void halbtc8723b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ + s32 wifi_rssi = 0; + boolean wifi_busy = false, wifi_under_b_mode = false; + static u8 cck_lock_counter = 0; + u32 total_cnt; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + +#if 1 + + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + +#endif + + if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { + total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + + coex_sta->crc_ok_11n_vht; + + if ((coex_dm->bt_status == BT_8723B_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == + BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY) || + (coex_dm->bt_status == + BT_8723B_1ANT_BT_STATUS_SCO_BUSY)) { + if (coex_sta->crc_ok_cck > (total_cnt - + coex_sta->crc_ok_cck)) { + if (cck_lock_counter < 3) + cck_lock_counter++; + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + + if (!coex_sta->pre_ccklock) { + + if (cck_lock_counter >= 3) + coex_sta->cck_lock = true; + else + coex_sta->cck_lock = false; + } else { + if (cck_lock_counter == 0) + coex_sta->cck_lock = false; + else + coex_sta->cck_lock = true; + } + + if (coex_sta->cck_lock) + coex_sta->cck_ever_lock = true; + + coex_sta->pre_ccklock = coex_sta->cck_lock; + + +} + +boolean halbtc8723b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) +{ + static boolean pre_wifi_busy = false, pre_under_4way = false, + pre_bt_hs_on = false; + boolean wifi_busy = false, under_4way = false, bt_hs_on = false; + boolean wifi_connected = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (wifi_connected) { + if (wifi_busy != pre_wifi_busy) { + pre_wifi_busy = wifi_busy; + return true; + } + if (under_4way != pre_under_4way) { + pre_under_4way = under_4way; + return true; + } + if (bt_hs_on != pre_bt_hs_on) { + pre_bt_hs_on = bt_hs_on; + return true; + } + + + } + + return false; +} + +void halbtc8723b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) +{ + static u32 bt_disable_cnt = 0; + boolean bt_active = true, bt_disabled = false, bt_change = false; + + /* This function check if bt is disabled */ + + if (coex_sta->high_priority_tx == 0 && + coex_sta->high_priority_rx == 0 && + coex_sta->low_priority_tx == 0 && + coex_sta->low_priority_rx == 0) + bt_active = false; + if (coex_sta->high_priority_tx == 0xffff && + coex_sta->high_priority_rx == 0xffff && + coex_sta->low_priority_tx == 0xffff && + coex_sta->low_priority_rx == 0xffff) + bt_active = false; + if (bt_active) { + bt_disable_cnt = 0; + bt_disabled = false; + } else { + bt_disable_cnt++; + if (bt_disable_cnt >= 10) + bt_disabled = true; + } + if (coex_sta->bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->bt_disabled ? "disabled" : "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + bt_change = true; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + + btcoexist->btc_set(btcoexist, + BTC_SET_BL_BT_ENABLE_DISABLE_CHANGE, + &bt_change); + + coex_sta->bt_disabled = bt_disabled; + } else { + btcoexist->btc_set(btcoexist, + BTC_SET_BL_BT_ENABLE_DISABLE_CHANGE, + &bt_change); + } +} + +void halbtc8723b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + bt_link_info->bt_link_exist = coex_sta->bt_link_exist; + bt_link_info->sco_exist = coex_sta->sco_exist; + bt_link_info->a2dp_exist = coex_sta->a2dp_exist; + bt_link_info->pan_exist = coex_sta->pan_exist; + bt_link_info->hid_exist = coex_sta->hid_exist; + bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; + + /* work around for HS mode. */ + if (bt_hs_on) { + bt_link_info->pan_exist = true; + bt_link_info->bt_link_exist = true; + } + + /* check if Sco only */ + if (bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->sco_only = true; + else + bt_link_info->sco_only = false; + + /* check if A2dp only */ + if (!bt_link_info->sco_exist && + bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->a2dp_only = true; + else + bt_link_info->a2dp_only = false; + + /* check if Pan only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->pan_only = true; + else + bt_link_info->pan_only = false; + + /* check if Hid only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + bt_link_info->hid_exist) + bt_link_info->hid_only = true; + else + bt_link_info->hid_only = false; +} + +void halbtc8723b1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, + IN boolean enable_auto_report) +{ + u8 h2c_parameter[1] = {0}; + + h2c_parameter[0] = 0; + + if (enable_auto_report) + h2c_parameter[0] |= BIT(0); + + btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); +} + +void halbtc8723b1ant_bt_auto_report(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable_auto_report) +{ + coex_dm->cur_bt_auto_report = enable_auto_report; + + if (!force_exec) { + if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) + return; + } + halbtc8723b1ant_set_bt_auto_report(btcoexist, + coex_dm->cur_bt_auto_report); + + coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; +} + +void halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist + *btcoexist, IN boolean low_penalty_ra) +{ + u8 h2c_parameter[6] = {0}; + + h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ + + if (low_penalty_ra) { + h2c_parameter[1] |= BIT(0); + h2c_parameter[2] = + 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ + h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ + h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ + h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ + } + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); +} + +void halbtc8723b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean low_penalty_ra) +{ + coex_dm->cur_low_penalty_ra = low_penalty_ra; + + if (!force_exec) { + if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) + return; + } + halbtc8723b1ant_set_sw_penalty_tx_rate_adaptive(btcoexist, + coex_dm->cur_low_penalty_ra); + + coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; +} + +void halbtc8723b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, + IN boolean low_penalty_ra) +{ + halbtc8723b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); +} + +void halbtc8723b1ant_set_coex_table(IN struct btc_coexist *btcoexist, + IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) +{ + btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); + + btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); + + btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); + + btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); +} + + + +void halbtc8723b1ant_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, + IN u32 val0x6c8, IN u8 val0x6cc) +{ + coex_dm->cur_val0x6c0 = val0x6c0; + coex_dm->cur_val0x6c4 = val0x6c4; + coex_dm->cur_val0x6c8 = val0x6c8; + coex_dm->cur_val0x6cc = val0x6cc; + + if (!force_exec) { + if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && + (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && + (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && + (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) + return; + } + halbtc8723b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, + val0x6cc); + + coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; + coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; + coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; + coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; +} + +void halbtc8723b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + +#if BT_8723B_1ANT_ANTDET_ENABLE +#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE + if (board_info->btdm_ant_num_by_ant_det == 2) { + if (type == 3) + type = 14; + else if (type == 4) + type = 13; + else if (type == 5) + type = 8; + } +#endif +#endif + + coex_sta->coex_table_type = type; + + switch (type) { + case 0: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555555, 0xffffff, 0x3); + break; + case 1: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); + break; + case 2: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0x5a5a5a5a, 0xffffff, 0x3); + break; + case 3: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, 0xffffff, 0x3); + break; + case 4: + if ((coex_sta->cck_ever_lock) && + (coex_sta->scan_ap_num <= 5)) + halbtc8723b1ant_coex_table(btcoexist, + force_exec, 0x55555555, 0xaaaa5a5a, + 0xffffff, 0x3); + else + halbtc8723b1ant_coex_table(btcoexist, + force_exec, 0x55555555, 0x5a5a5a5a, + 0xffffff, 0x3); + break; + case 5: + if ((coex_sta->cck_ever_lock) && + (coex_sta->scan_ap_num <= 5)) + halbtc8723b1ant_coex_table(btcoexist, + force_exec, 0x5a5a5a5a, 0x5aaa5a5a, + 0xffffff, 0x3); + else + halbtc8723b1ant_coex_table(btcoexist, + force_exec, 0x5a5a5a5a, 0x5aaa5a5a, + 0xffffff, 0x3); + break; + case 6: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 7: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 8: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 9: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 10: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 11: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 12: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 13: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 14: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); + break; + case 15: + halbtc8723b1ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 16: + halbtc8723b1ant_coex_table(btcoexist, + force_exec, 0x55555555, 0x5a5a5aaa, + 0xffffff, 0x3); + break; + case 17: + halbtc8723b1ant_coex_table(btcoexist, + force_exec, 0x55555555, 0xaaaa5aaa, + 0xffffff, 0x3); + break; + case 18: + halbtc8723b1ant_coex_table(btcoexist, + force_exec, 0x55555555, 0x5a5a5a6a, + 0xffffff, 0x3); + break; + default: + break; + } +} + +void halbtc8723b1ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 interval, + IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, + IN u8 val0x6c4_b3) +{ + static u8 pre_h2c_parameter[6] = {0}; + u8 cur_h2c_parameter[6] = {0}; + u8 i, match_cnt = 0; + + cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ + + cur_h2c_parameter[1] = interval; + cur_h2c_parameter[2] = val0x6c4_b0; + cur_h2c_parameter[3] = val0x6c4_b1; + cur_h2c_parameter[4] = val0x6c4_b2; + cur_h2c_parameter[5] = val0x6c4_b3; + + if (!force_exec) { + for (i = 1; i <= 5; i++) { + if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) + break; + + match_cnt++; + } + + if (match_cnt == 5) + return; + } + + for (i = 1; i <= 5; i++) + pre_h2c_parameter[i] = cur_h2c_parameter[i]; + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); +} + + +void halbtc8723b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + u8 h2c_parameter[1] = {0}; + + if (enable) + h2c_parameter[0] |= BIT(0); /* function enable */ + + btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); +} + +void halbtc8723b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable) +{ + coex_dm->cur_ignore_wlan_act = enable; + + if (!force_exec) { + if (coex_dm->pre_ignore_wlan_act == + coex_dm->cur_ignore_wlan_act) + return; + } + halbtc8723b1ant_set_fw_ignore_wlan_act(btcoexist, enable); + + coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; +} + +void halbtc8723b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, + IN u8 lps_val, IN u8 rpwm_val) +{ + u8 lps = lps_val; + u8 rpwm = rpwm_val; + + btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); + btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); +} + +void halbtc8723b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) +{ + coex_dm->cur_lps = lps_val; + coex_dm->cur_rpwm = rpwm_val; + + if (!force_exec) { + if ((coex_dm->pre_lps == coex_dm->cur_lps) && + (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) + return; + } + halbtc8723b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); + + coex_dm->pre_lps = coex_dm->cur_lps; + coex_dm->pre_rpwm = coex_dm->cur_rpwm; +} + +void halbtc8723b1ant_set_ant_path(IN struct btc_coexist *btcoexist, + IN u8 ant_pos_type, IN boolean force_exec, IN boolean init_hwcfg, + IN boolean wifi_off) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; + boolean pg_ext_switch = false; + boolean use_ext_switch = false; + boolean is_in_mp_mode = false; + u8 h2c_parameter[2] = {0}, u8tmp = 0; + u32 u32tmp_1[4]; + boolean is_fw_ready; + + coex_dm->cur_ant_pos_type = ant_pos_type; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, + &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ + + if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) + use_ext_switch = true; + +#if BT_8723B_1ANT_ANTDET_ENABLE +#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE + if (ant_pos_type == BTC_ANT_PATH_PTA) { + if ((board_info->btdm_ant_det_finish) && + (board_info->btdm_ant_num_by_ant_det == 2)) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = BTC_ANT_PATH_WIFI; + else + ant_pos_type = BTC_ANT_PATH_BT; + } + } +#endif +#endif + + if (init_hwcfg) { + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x780); /* WiFi TRx Mask on */ + /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ + /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); */ /*BT TRx Mask on */ + + if (fw_ver >= 0x180000) { + /* Use H2C to set GNT_BT to HIGH */ + h2c_parameter[0] = 1; + btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, + h2c_parameter); + + cnt_bt_cal_chk = 0; + while (1) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_FW_READY, &is_fw_ready); + if (is_fw_ready == false) { + BTC_SPRINTF(trace_buf , BT_TMP_BUF_SIZE, + ("halbtc8723b1ant_set_ant_path(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); + BTC_TRACE(trace_buf); + break; + } + + if (btcoexist->btc_read_1byte(btcoexist, + 0x765) == 0x18) + break; + + cnt_bt_cal_chk++; + if (cnt_bt_cal_chk > 20) + break; + } + } else { + /* set grant_bt to high */ + btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); + } + /* set wlan_act control by PTA */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x0); /* BT select s0/s1 is controlled by BT */ + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); + btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); + } else if (wifi_off) { + if (fw_ver >= 0x180000) { + /* Use H2C to set GNT_BT to HIGH */ + h2c_parameter[0] = 1; + btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, + h2c_parameter); + + cnt_bt_cal_chk = 0; + while (1) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_FW_READY, &is_fw_ready); + if (is_fw_ready == false) { + BTC_SPRINTF(trace_buf , BT_TMP_BUF_SIZE, + ("halbtc8723b1ant_set_ant_path(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); + BTC_TRACE(trace_buf); + break; + } + + if (btcoexist->btc_read_1byte(btcoexist, + 0x765) == 0x18) + break; + + cnt_bt_cal_chk++; + if (cnt_bt_cal_chk > 20) + break; + } + } else { + /* set grant_bt to high */ + btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); + } + /* set wlan_act to always low */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, + &is_in_mp_mode); + if (!is_in_mp_mode) + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, + 0x20, 0x0); /* BT select s0/s1 is controlled by BT */ + else + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, + 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ + + /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 */ + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp &= ~BIT(23); + u32tmp &= ~BIT(24); + btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); + } else { + /* Use H2C to set GNT_BT to LOW */ + if (fw_ver >= 0x180000) { + if (btcoexist->btc_read_1byte(btcoexist, 0x765) != 0) { + h2c_parameter[0] = 0; + btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, + h2c_parameter); + + cnt_bt_cal_chk = 0; + while (1) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_FW_READY, &is_fw_ready); + if (is_fw_ready == false) { + BTC_SPRINTF(trace_buf , + BT_TMP_BUF_SIZE, + ("halbtc8723b1ant_set_ant_path(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); + BTC_TRACE(trace_buf); + break; + } + + if (btcoexist->btc_read_1byte(btcoexist, + 0x765) == 0x0) + break; + + cnt_bt_cal_chk++; + if (cnt_bt_cal_chk > 20) + break; + } + } + } else { + /* BT calibration check */ + while (cnt_bt_cal_chk <= 20) { + u8tmp = btcoexist->btc_read_1byte(btcoexist, + 0x49d); + cnt_bt_cal_chk++; + if (u8tmp & BIT(0)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + delay_ms(50); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + break; + } + } + + /* set grant_bt to PTA */ + btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); + } + + if (btcoexist->btc_read_1byte(btcoexist, 0x76e) != 0xc) { + /* set wlan_act control by PTA */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); + } + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x1); /* BT select s0/s1 is controlled by WiFi */ + } + + if (use_ext_switch) { + if (init_hwcfg) { + /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp &= ~BIT(23); + u32tmp |= BIT(24); + btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); + + + u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, + 0x948); + if ((u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte(btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte(btcoexist, 0x948, + 0x0); + + + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) { + /* tell firmware "no antenna inverse" */ + h2c_parameter[0] = 0; + h2c_parameter[1] = 1; /* ext switch type */ + btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, + h2c_parameter); + } else { + /* tell firmware "antenna inverse" */ + h2c_parameter[0] = 1; + h2c_parameter[1] = 1; /* ext switch type */ + btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, + h2c_parameter); + } + } + + if (force_exec || + (coex_dm->cur_ant_pos_type != + coex_dm->pre_ant_pos_type)) { + /* ext switch setting */ + switch (ant_pos_type) { + case BTC_ANT_PATH_WIFI: + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x92c, 0x3, + 0x1); + else + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x92c, 0x3, + 0x2); + break; + case BTC_ANT_PATH_BT: + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x92c, 0x3, + 0x2); + else + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x92c, 0x3, + 0x1); + break; + default: + case BTC_ANT_PATH_PTA: + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x92c, 0x3, + 0x1); + else + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x92c, 0x3, + 0x2); + break; + } + } + } else { + if (init_hwcfg) { + /* 0x4c[23]=1, 0x4c[24]=0 Antenna control by 0x64 */ + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp |= BIT(23); + u32tmp &= ~BIT(24); + btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); + + /* Fix Ext switch Main->S1, Aux->S0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, + 0x0); + + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) { + + /* tell firmware "no antenna inverse" */ + h2c_parameter[0] = 0; + h2c_parameter[1] = + 0; /* internal switch type */ + btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, + h2c_parameter); + } else { + + /* tell firmware "antenna inverse" */ + h2c_parameter[0] = 1; + h2c_parameter[1] = + 0; /* internal switch type */ + btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, + h2c_parameter); + } + } + + if (force_exec || + (coex_dm->cur_ant_pos_type != + coex_dm->pre_ant_pos_type)) { + /* internal switch setting */ + switch (ant_pos_type) { + case BTC_ANT_PATH_WIFI: + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) { + u32tmp_1[0] = btcoexist->btc_read_4byte( + btcoexist, 0x948); + if ((u32tmp_1[0] == 0x40) || + (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte( + btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte( + btcoexist, 0x948, 0x0); + } else { + u32tmp_1[0] = btcoexist->btc_read_4byte( + btcoexist, 0x948); + if ((u32tmp_1[0] == 0x40) || + (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte( + btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte( + btcoexist, 0x948, + 0x280); + } + break; + case BTC_ANT_PATH_BT: + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) { + u32tmp_1[0] = btcoexist->btc_read_4byte( + btcoexist, 0x948); + if ((u32tmp_1[0] == 0x40) || + (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte( + btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte( + btcoexist, 0x948, + 0x280); + } else { + u32tmp_1[0] = btcoexist->btc_read_4byte( + btcoexist, 0x948); + if ((u32tmp_1[0] == 0x40) || + (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte( + btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte( + btcoexist, 0x948, 0x0); + } + break; + default: + case BTC_ANT_PATH_PTA: + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + btcoexist->btc_write_4byte( + btcoexist, 0x948, + 0x200); + else + btcoexist->btc_write_4byte( + btcoexist, 0x948, 0x80); + break; + } + } + } + + coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; +} + +void halbtc8723b1ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +{ + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + /* will leave LPS state, turn off psTdma first */ + /* halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 8); */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } + } else { /* NO PS state */ + if (new_ps_state) { + /* will enter LPS state, turn off psTdma first */ + /* halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 8); */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } else { + /* keep state under NO PS state, do nothing. */ + } + } +} + + +void halbtc8723b1ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = false; + + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + low_pwr_disable = false; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + NULL); + coex_sta->force_lps_on = false; + break; + case BTC_PS_LPS_ON: + halbtc8723b1ant_ps_tdma_check_for_power_save_state( + btcoexist, true); + halbtc8723b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, + lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = true; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + /* power save must executed before psTdma. */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, + NULL); + coex_sta->force_lps_on = true; + break; + case BTC_PS_LPS_OFF: + halbtc8723b1ant_ps_tdma_check_for_power_save_state( + btcoexist, false); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + coex_sta->force_lps_on = false; + break; + default: + break; + } +} + + +void halbtc8723b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, + IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) +{ + u8 h2c_parameter[5] = {0}; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if (ap_enable) { + if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + halbtc8723b1ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } + } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + halbtc8723b1ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + + } else { + halbtc8723b1ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } + + h2c_parameter[0] = real_byte1; + h2c_parameter[1] = byte2; + h2c_parameter[2] = byte3; + h2c_parameter[3] = byte4; + h2c_parameter[4] = real_byte5; + + coex_dm->ps_tdma_para[0] = real_byte1; + coex_dm->ps_tdma_para[1] = byte2; + coex_dm->ps_tdma_para[2] = byte3; + coex_dm->ps_tdma_para[3] = byte4; + coex_dm->ps_tdma_para[4] = real_byte5; + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); +} + + +void halbtc8723b1ant_ps_tdma(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean turn_on, IN u8 type) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = false; + u8 rssi_adjust_val = 0; + u8 ps_tdma_byte4_val = 0x50, ps_tdma_byte0_val = 0x51, + ps_tdma_byte3_val = 0x10; + s8 wifi_duration_adjust = 0x0; + static boolean pre_wifi_busy = false; + + coex_dm->cur_ps_tdma_on = turn_on; + coex_dm->cur_ps_tdma = type; + +#if BT_8723B_1ANT_ANTDET_ENABLE +#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE + if (board_info->btdm_ant_num_by_ant_det == 2) { + if (turn_on) + type = type + + 100; /* for WiFi RSSI low or BT RSSI low */ + else + type = 1; /* always translate to TDMA(off,1) for TDMA-off case */ + } + +#endif +#endif + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (wifi_busy != pre_wifi_busy) { + force_exec = true; + pre_wifi_busy = wifi_busy; + } + + if (!force_exec) { + if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && + (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) + return; + } + + if (coex_sta->scan_ap_num <= 5) { + wifi_duration_adjust = 5; + + if (coex_sta->a2dp_bit_pool >= 35) + wifi_duration_adjust = -10; + else if (coex_sta->a2dp_bit_pool >= 45) + wifi_duration_adjust = -15; + } else if (coex_sta->scan_ap_num >= 40) { + wifi_duration_adjust = -15; + + if (coex_sta->a2dp_bit_pool < 35) + wifi_duration_adjust = -5; + else if (coex_sta->a2dp_bit_pool < 45) + wifi_duration_adjust = -10; + } else if (coex_sta->scan_ap_num >= 20) { + wifi_duration_adjust = -10; + + if (coex_sta->a2dp_bit_pool >= 45) + wifi_duration_adjust = -15; + } else { + wifi_duration_adjust = 0; + + if (coex_sta->a2dp_bit_pool >= 35) + wifi_duration_adjust = -10; + else if (coex_sta->a2dp_bit_pool >= 45) + wifi_duration_adjust = -15; + } + + if ((type == 1) || (type == 2) || (type == 9) || (type == 11) || + (type == 101) + || (type == 102) || (type == 109) || (type == 101)) { +#if 0 + if (!coex_sta->force_lps_on) { /* Native power save TDMA, only for A2DP-only case 1/2/9/11 while wifi noisy threshold > 30 */ + ps_tdma_byte0_val = 0x61; /* no null-pkt */ + ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ + ps_tdma_byte4_val = + 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ + } else { +#endif + ps_tdma_byte0_val = 0x51; /* null-pkt */ + ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ + ps_tdma_byte4_val = + 0x50; /* 0x778 = d/1 toggle, dynamic slot */ +#if 0 + } +#endif + } else if ((type == 3) || (type == 13) || (type == 14) || + (type == 103) || (type == 113) || (type == 114)) { + ps_tdma_byte0_val = 0x51; /* null-pkt */ + ps_tdma_byte3_val = 0x10; /* tx-pause at BT-slot */ + ps_tdma_byte4_val = + 0x10; /* 0x778 = d/1 toggle, no dynamic slot */ +#if 0 + if (!wifi_busy) + ps_tdma_byte4_val = ps_tdma_byte4_val | + 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ +#endif + } else { /* native power save case */ + ps_tdma_byte0_val = 0x61; /* no null-pkt */ + ps_tdma_byte3_val = 0x11; /* no tx-pause at BT-slot */ + ps_tdma_byte4_val = + 0x11; /* 0x778 = d/1 toggle, no dynamic slot */ + /* psTdmaByte4Va is not defne for 0x778 = d/1, 1/1 case */ + } + + /* if (bt_link_info->slave_role == true) */ + if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) + ps_tdma_byte4_val = ps_tdma_byte4_val | + 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ + + if (type > 100) { + ps_tdma_byte0_val = ps_tdma_byte0_val | + 0x82; /* set antenna control by SW */ + ps_tdma_byte3_val = ps_tdma_byte3_val | + 0x60; /* set antenna no toggle, control by antenna diversity */ + } + + + if (turn_on) { + switch (type) { + default: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, + 0x1a, 0x1a, 0x0, ps_tdma_byte4_val); + break; + case 1: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x3a + + wifi_duration_adjust, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 2: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x2d + + wifi_duration_adjust, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 3: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x30, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 4: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, + 0x15, 0x3, 0x14, 0x0); + break; + case 5: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x1f, 0x3, + ps_tdma_byte3_val, 0x11); + break; + case 6: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x20, 0x3, + ps_tdma_byte3_val, 0x11); + break; + case 7: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, + 0xc, 0x5, 0x0, 0x0); + break; + case 8: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, + 0x25, 0x3, 0x10, 0x0); + break; + case 9: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x3, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 10: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, + 0xa, 0xa, 0x0, 0x40); + break; + case 11: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 12: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, + 0x0a, 0x0a, 0x0, 0x50); + break; + case 13: + if (coex_sta->scan_ap_num <= 3) + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x40, 0x3, + ps_tdma_byte3_val, + ps_tdma_byte4_val); + else + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x3, + ps_tdma_byte3_val, + ps_tdma_byte4_val); + break; + case 14: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x3, 0x10, 0x54); +#if 0 + if (coex_sta->scan_ap_num <= 3) + halbtc8723b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x30, 0x3, 0x10, 0x50); + else + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x3, + ps_tdma_byte3_val, + ps_tdma_byte4_val); +#endif + break; + case 15: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x13, + 0xa, 0x3, 0x8, 0x0); + break; + case 16: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, + 0x15, 0x3, 0x10, 0x0); + break; + case 17: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + 0x55, 0x10, 0x3, 0x10, 0x54); + break; + case 18: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x93, + 0x25, 0x3, 0x10, 0x0); + break; + case 20: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x3f, 0x03, + ps_tdma_byte3_val, 0x10); + break; + case 21: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x03, 0x11, 0x11); + break; + case 22: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x25, 0x03, + ps_tdma_byte3_val, 0x10); + break; + case 23: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, + 0x25, 0x3, 0x31, 0x18); + break; + case 24: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, + 0x15, 0x3, 0x31, 0x18); + break; + case 25: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, + 0xa, 0x3, 0x31, 0x18); + break; + case 26: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, + 0xa, 0x3, 0x31, 0x18); + break; + case 27: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xe3, + 0x25, 0x3, 0x31, 0x98); + break; + case 28: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x69, + 0x25, 0x3, 0x31, 0x0); + break; + case 29: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xab, + 0x1a, 0x1a, 0x1, 0x10); + break; + case 30: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, + 0x30, 0x3, 0x10, 0x10); + break; + case 31: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, + 0x1a, 0x1a, 0, 0x58); + break; + case 32: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x35, 0x3, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 33: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x35, 0x3, + ps_tdma_byte3_val, 0x10); + break; + case 34: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x53, + 0x1a, 0x1a, 0x0, 0x10); + break; + case 35: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x63, + 0x1a, 0x1a, 0x0, 0x10); + break; + case 36: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0xd3, + 0x12, 0x3, 0x14, 0x50); + break; + case 37: + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x3, 0x10, 0x54); + break; + case 40: /* SoftAP only with no sta associated,BT disable ,TDMA mode for power saving */ + /* here softap mode screen off will cost 70-80mA for phone */ + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x23, + 0x18, 0x00, 0x10, 0x24); + break; + case 41: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x7, 0x10, 0x54); + break; + case 42: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + 0x55, 0x10, 0x7, 0x10, 0x54); + break; + /* for 1-Ant translate to 2-Ant */ + case 101: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x3a + + wifi_duration_adjust, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 102: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x2d + + wifi_duration_adjust, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 103: + /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x1d, 0x1d, 0x0, ps_tdma_byte4_val); */ + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x3a, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 105: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x15, 0x3, + ps_tdma_byte3_val, 0x11); + break; + case 106: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x20, 0x3, + ps_tdma_byte3_val, 0x11); + break; + case 109: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x3, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 111: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 113: + /* halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x51, 0x12, 0x12, 0x0, ps_tdma_byte4_val); */ + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x3, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 114: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x21, 0x3, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 120: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x3f, 0x03, + ps_tdma_byte3_val, 0x10); + break; + case 122: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x25, 0x03, + ps_tdma_byte3_val, 0x10); + break; + case 132: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x25, 0x03, + ps_tdma_byte3_val, ps_tdma_byte4_val); + break; + case 133: + halbtc8723b1ant_set_fw_pstdma(btcoexist, + ps_tdma_byte0_val, 0x25, 0x03, + ps_tdma_byte3_val, 0x11); + break; + + } + } else { + + /* disable PS tdma */ + switch (type) { + case 8: /* PTA Control */ + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x8, + 0x0, 0x0, 0x0, 0x0); + break; + case 0: + default: /* Software control, Antenna at BT side */ + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x0, 0x0); + break; + case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ + halbtc8723b1ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x48, 0x0); + break; + } + } + rssi_adjust_val = 0; + btcoexist->btc_set(btcoexist, + BTC_SET_U1_RSSI_ADJ_VAL_FOR_1ANT_COEX_TYPE, &rssi_adjust_val); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", + btcoexist->btc_read_4byte(btcoexist, 0x948), + btcoexist->btc_read_1byte(btcoexist, 0x765), + btcoexist->btc_read_1byte(btcoexist, 0x67)); + BTC_TRACE(trace_buf); + + /* update pre state */ + coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; + coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; +} + +void halbtc8723b1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist + *btcoexist, IN u8 wifi_status) +{ + static s32 up, dn, m, n, wait_count; + s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ + u8 retry_count = 0, bt_info_ext; + boolean wifi_busy = false; + + if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY == wifi_status) + wifi_busy = true; + else + wifi_busy = false; + + if ((BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == + wifi_status) || + (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || + (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT == + wifi_status)) { + if (coex_dm->cur_ps_tdma != 1 && + coex_dm->cur_ps_tdma != 2 && + coex_dm->cur_ps_tdma != 3 && + coex_dm->cur_ps_tdma != 9) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 9); + coex_dm->ps_tdma_du_adj_type = 9; + + up = 0; + dn = 0; + m = 1; + n = 3; + result = 0; + wait_count = 0; + } + return; + } + + if (!coex_dm->auto_tdma_adjust) { + coex_dm->auto_tdma_adjust = true; + + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); + coex_dm->ps_tdma_du_adj_type = 2; + /* ============ */ + up = 0; + dn = 0; + m = 1; + n = 3; + result = 0; + wait_count = 0; + } else { + /* acquire the BT TRx retry count from BT_Info byte2 */ + retry_count = coex_sta->bt_retry_cnt; + bt_info_ext = coex_sta->bt_info_ext; + + if ((coex_sta->low_priority_tx) > 1050 || + (coex_sta->low_priority_rx) > 1250) + retry_count++; + + result = 0; + wait_count++; + + if (retry_count == + 0) { /* no retry in the last 2-second duration */ + up++; + dn--; + + if (dn <= 0) + dn = 0; + + if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ + wait_count = 0; + n = 3; + up = 0; + dn = 0; + result = 1; + } + } else if (retry_count <= + 3) { /* <=3 retry in the last 2-second duration */ + up--; + dn++; + + if (up <= 0) + up = 0; + + if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ + if (wait_count <= 2) + m++; /* to avoid loop between the two levels */ + else + m = 1; + + if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ + m = 20; + + n = 3 * m; + up = 0; + dn = 0; + wait_count = 0; + result = -1; + } + } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ + if (wait_count == 1) + m++; /* to avoid loop between the two levels */ + else + m = 1; + + if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ + m = 20; + + n = 3 * m; + up = 0; + dn = 0; + wait_count = 0; + result = -1; + } + + if (result == -1) { + /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && + ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) + { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); + coex_dm->ps_tdma_du_adj_type = 9; + } + else */ if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = 2; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 9); + coex_dm->ps_tdma_du_adj_type = 9; + } else if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = 11; + } + } else if (result == 1) { + /* if( (BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(bt_info_ext)) && + ((coex_dm->cur_ps_tdma == 1) ||(coex_dm->cur_ps_tdma == 2)) ) + { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); + coex_dm->ps_tdma_du_adj_type = 9; + } + else */ if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 9); + coex_dm->ps_tdma_du_adj_type = 9; + } else if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = 2; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 1); + coex_dm->ps_tdma_du_adj_type = 1; + } + } else { /* no change */ + /* Bryant Modify + if(wifi_busy != pre_wifi_busy) + { + pre_wifi_busy = wifi_busy; + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, true, coex_dm->cur_ps_tdma); + } + */ + + } + + if (coex_dm->cur_ps_tdma != 1 && + coex_dm->cur_ps_tdma != 2 && + coex_dm->cur_ps_tdma != 9 && + coex_dm->cur_ps_tdma != 11) { + /* recover to previous adjust type */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + coex_dm->ps_tdma_du_adj_type); + } + } +} + + +/* ********************************************* + * + * Non-Software Coex Mechanism start + * + * ********************************************* */ +void halbtc8723b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) +{ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, + false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +} + + +void halbtc8723b1ant_action_hs(IN struct btc_coexist *btcoexist) +{ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); +} + +void halbtc8723b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = false, ap_enable = false, wifi_busy = false, + bt_busy = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + + if (coex_sta->bt_abnormal_scan) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 33); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } else if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + NORMAL_EXEC, false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || + (bt_link_info->a2dp_exist)) { + /* SCO/HID/A2DP busy */ + + if (coex_sta->c2h_bt_remote_name_req) + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 33); + else + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 32); + + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } else if ((bt_link_info->pan_exist) || (wifi_busy)) { + + if (coex_sta->c2h_bt_remote_name_req) + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 33); + else + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 32); + + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } else { + + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + NORMAL_EXEC, false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + + } +} + +void halbtc8723b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist + *btcoexist, IN u8 wifi_status) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + /* tdma and coex table */ + + if (bt_link_info->sco_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + } else { /* HID */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + } +} + +void halbtc8723b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) +{ + halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, FORCE_EXEC, + false, false); +} + +void halbtc8723b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) +{ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, + false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); +} + +void halbtc8723b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist + *btcoexist, IN u8 wifi_status) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + u32 wifi_bw = 1; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips)) + bt_link_info->slave_role = true; + else + bt_link_info->slave_role = false; + + if (bt_link_info->hid_only) { /* HID */ + halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, + wifi_status); + coex_dm->auto_tdma_adjust = false; + return; + } else if (bt_link_info->a2dp_only) { /* A2DP */ + if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 32); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + coex_dm->auto_tdma_adjust = false; + } else { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 37); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 16); + coex_dm->auto_tdma_adjust = false; + } + } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || + (bt_link_info->hid_exist && bt_link_info->a2dp_exist && + bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + coex_dm->auto_tdma_adjust = false; + } else if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { /* HID+A2DP */ + +#if 1 + + coex_dm->auto_tdma_adjust = false; + + if (iot_peer == BTC_IOT_PEER_ATHEROS) { + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 17); + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); + } else { + if (coex_sta->a2dp_bit_pool < 40) { /*for longer wifi slot RS1 */ + if (wifi_bw == 0) { /*11bg mode*/ +#if 1 + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8723b1ant_set_wltoggle_coex_table(btcoexist, NORMAL_EXEC, + 0x1, 0xaa, 0x5a, 0x5a, 0x5a); + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); +#endif +#if 0 + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 18); + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 41); +#endif + + } else { /*11n mode*/ + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); + } + } else { /*for shorter wifi slot RS2 */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); + if (wifi_bw == 0) /* 11bg mode */ + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 16); + else /*11n mode*/ + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + } + } +#endif + } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && + bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ + + if (BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 9); + else + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 3); + + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + coex_dm->auto_tdma_adjust = false; + } else { + /* BT no-profile busy (0x9) */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + coex_dm->auto_tdma_adjust = false; + } +} + +void halbtc8723b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) +{ + + /* tdma and coex table */ + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, + false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +} + +void halbtc8723b1ant_action_wifi_not_connected_scan(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + /* tdma and coex table */ + if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + if (bt_link_info->a2dp_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 32); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } else if (bt_link_info->a2dp_exist && + bt_link_info->pan_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 22); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } else { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 20); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } + } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); + } else { + /* Bryant Add */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + NORMAL_EXEC, false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + } +} + +void halbtc8723b1ant_action_wifi_not_connected_asso_auth( + IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + /* tdma and coex table */ + if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || + (bt_link_info->a2dp_exist)) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); + } else if (bt_link_info->pan_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); + halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); + } else { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + NORMAL_EXEC, false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); + } +} + +void halbtc8723b1ant_action_wifi_connected_scan(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + /* tdma and coex table */ + if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + if (bt_link_info->a2dp_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 32); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } else if (bt_link_info->a2dp_exist && + bt_link_info->pan_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 22); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } else { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 20); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } + } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN); + } else { + /* Bryant Add */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + NORMAL_EXEC, false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + } +} + +void halbtc8723b1ant_action_wifi_connected_specific_packet( + IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + /* no specific packet process for both WiFi and BT very busy */ + if ((wifi_busy) && ((bt_link_info->pan_exist) || + (coex_sta->num_of_profile >= 2))) + return; + + /* tdma and coex table */ + if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + } else if (bt_link_info->a2dp_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } else if (bt_link_info->pan_exist) { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } else { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + NORMAL_EXEC, false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + } +} + +void halbtc8723b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) +{ + boolean wifi_busy = false; + boolean scan = false, link = false, roam = false; + boolean under_4way = false, ap_enable = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect()===>\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + if (under_4way) { + halbtc8723b1ant_action_wifi_connected_specific_packet( + btcoexist); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); + BTC_TRACE(trace_buf); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + if (scan || link || roam) { + if (scan) + halbtc8723b1ant_action_wifi_connected_scan(btcoexist); + else + halbtc8723b1ant_action_wifi_connected_specific_packet( + btcoexist); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); + BTC_TRACE(trace_buf); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + + /* tdma and coex table */ + if (!wifi_busy) { + if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + halbtc8723b1ant_action_wifi_connected_bt_acl_busy( + btcoexist, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); + } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == + coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE); + } else { + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 8); + halbtc8723b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); + /* if ((coex_sta->high_priority_tx) + + (coex_sta->high_priority_rx) <= 60) */ + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 2); + /* else + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); */ + } + } else { + if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + halbtc8723b1ant_action_wifi_connected_bt_acl_busy( + btcoexist, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); + } else if ((BT_8723B_1ANT_BT_STATUS_SCO_BUSY == + coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8723b1ant_action_bt_sco_hid_only_busy(btcoexist, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY); + } else { + /* halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 8); + halbtc8723b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); + if ((coex_sta->high_priority_tx) + + (coex_sta->high_priority_rx) <= 60) + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 2); + else + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); */ + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 32); + halbtc8723b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); + halbtc8723b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + + } + } +} + +void halbtc8723b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = false, bt_hs_on = false, wifi_busy = false; + boolean increase_scan_dev_num = false; + boolean bt_ctrl_agg_buf_size = false; + boolean miracast_plus_bt = false; + u8 agg_buf_size = 5; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0, wifi_bw; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism()===>\n"); + BTC_TRACE(trace_buf); + + if (btcoexist->manual_control) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (btcoexist->stop_coex_dm) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->under_ips) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under IPS !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->bt_whck_test) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under WHCK TEST!!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b1ant_action_bt_whck_test(btcoexist); + return; + } + + if ((BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + increase_scan_dev_num = true; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, + &increase_scan_dev_num); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + + if ((num_of_wifi_link >= 2) || + (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { + if (bt_link_info->bt_link_exist) { + halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, + 0, 1); + miracast_plus_bt = true; + } else { + halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, + 0, 0); + miracast_plus_bt = false; + } + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, + bt_ctrl_agg_buf_size, agg_buf_size); + + if (((bt_link_info->a2dp_exist) || (wifi_busy)) && + (coex_sta->c2h_bt_inquiry_page)) + halbtc8723b1ant_action_bt_inquiry(btcoexist); + else + halbtc8723b1ant_action_wifi_multi_port(btcoexist); + + return; + } + + miracast_plus_bt = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + if ((bt_link_info->bt_link_exist) && (wifi_connected)) { + halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + /* if(BTC_IOT_PEER_CISCO != iot_peer) */ + if ((BTC_IOT_PEER_CISCO != iot_peer) && + (BTC_IOT_PEER_BROADCOM != iot_peer)) { + if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ + /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, true, false, 0x5); */ + halbtc8723b1ant_limited_rx(btcoexist, + NORMAL_EXEC, true, false, 0x5); + else + halbtc8723b1ant_limited_rx(btcoexist, + NORMAL_EXEC, false, false, 0x5); + /* halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x8); */ + } else { + if (bt_link_info->sco_exist) + halbtc8723b1ant_limited_rx(btcoexist, + NORMAL_EXEC, true, false, 0x5); + else if (bt_link_info->hid_exist) + halbtc8723b1ant_limited_rx(btcoexist, + NORMAL_EXEC, false, true, 0x8); + else { + if (BTC_WIFI_BW_HT40 == wifi_bw) + halbtc8723b1ant_limited_rx(btcoexist, + NORMAL_EXEC, false, true, 0x10); + else + halbtc8723b1ant_limited_rx(btcoexist, + NORMAL_EXEC, false, true, 0x8); + } + } + + halbtc8723b1ant_sw_mechanism(btcoexist, true); + + /* low pelnaty ra in pcr ra */ + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 35); + + } else { + halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + + halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, + 0x5); + + halbtc8723b1ant_sw_mechanism(btcoexist, false); + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8723b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8723b1ant_action_hs(btcoexist); + return; + } + + + if (!wifi_connected) { + boolean scan = false, link = false, roam = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is non connected-idle !!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + + if (scan || link || roam) { + if (scan) + halbtc8723b1ant_action_wifi_not_connected_scan( + btcoexist); + else + halbtc8723b1ant_action_wifi_not_connected_asso_auth( + btcoexist); + } else + halbtc8723b1ant_action_wifi_not_connected(btcoexist); + } else /* wifi LPS/Busy */ + halbtc8723b1ant_action_wifi_connected(btcoexist); +} + +void halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + /* force to reset coex mechanism */ + + /* sw all off */ + halbtc8723b1ant_sw_mechanism(btcoexist, false); + + /* halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); */ + /* halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); */ + + coex_sta->pop_event_cnt = 0; +} + +void halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean back_up, IN boolean wifi_only) +{ + u32 u32tmp = 0; /* , fw_ver; */ + u8 u8tmpa = 0, u8tmpb = 0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 1Ant Init HW Config!!\n"); + BTC_TRACE(trace_buf); + + psd_scan->ant_det_is_ant_det_available = false; + + + /* Give bt_coex_supported_version the default value */ + coex_sta->bt_coex_supported_version = 0; + + /* 0xf0[15:12] --> Chip Cut information */ + coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, + 0xf1) & 0xf0) >> 4; + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, + 0x1); /* enable TBTT nterrupt */ + + /* 0x790[5:0]=0x5 */ + btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); + + /* Enable counter statistics */ + /* btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); */ /*0x76e[3] =1, WLAN_Act control by PTA */ + btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); + + + /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); */ /*BT select s0/s1 is controlled by WiFi */ + + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); + + /* Antenna config */ + if (wifi_only) + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, + FORCE_EXEC, true, false); + else + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, + FORCE_EXEC, true, false); + + /* PTA parameter */ + halbtc8723b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); + u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); + u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", + u32tmp, u8tmpa, u8tmpb); + BTC_TRACE(trace_buf); + +} + +/* Donot remove optimize off flag, otherwise antenna detection would trigger BT collapsed */ +#ifdef PLATFORM_WINDOWS +#pragma optimize("", off) +#endif +void halbtc8723b1ant_mechanism_switch(IN struct btc_coexist *btcoexist, + IN boolean bSwitchTo2Antenna) +{ + + if (bSwitchTo2Antenna) { + + /* BT TRx mask off */ + btcoexist->btc_set_bt_trx_mask(btcoexist, 0); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT TRx Mask off for mechanism_switch\n"); + + BTC_TRACE(trace_buf); + + } else { + + /* BT TRx mask on */ + btcoexist->btc_set_bt_trx_mask(btcoexist, 1); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT TRx Mask on for mechanism_switch\n"); + + BTC_TRACE(trace_buf); + } + + +#if 0 + if (bSwitchTo2Antenna) { /* 1-Ant -> 2-Ant */ + /* un-lock TRx Mask setup for 8723b f-cut */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x1); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x1); + /* WiFi TRx Mask on */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x0); + + /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ + btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, + 0x7c45); + btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, + 0x7c45); + + /* BT TRx Mask on */ + btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x1); + + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, + FORCE_EXEC, false, false); + } else { + /* WiFi TRx Mask on */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x780); + + /* lock TRx Mask setup for 8723b f-cut */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, 0x80, 0x0); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, 0x1, 0x0); + + /* BT TRx Mask on */ + btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); + + /* BT TRx Mask ock 0x2c[0], 0x30[0] = 0 */ + btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x2c, + 0x7c44); + btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x30, + 0x7c44); + + + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + FORCE_EXEC, false, false); + } + +#endif +} + +u32 halbtc8723b1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) +{ + u8 j; + u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; + u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, + 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, + 32, 23, 15, 7, 0 + }; + + if (val == 0) + return 0; + + tmp = val; + + while (1) { + if (tmp == 1) + break; + + tmp = (tmp >> 1); + shiftcount++; + } + + + val_integerd_b = shiftcount + 1; + + tmp2 = 1; + for (j = 1; j <= val_integerd_b; j++) + tmp2 = tmp2 * 2; + + tmp = (val * 100) / tmp2; + tindex = tmp / 5; + + if (tindex > 20) + tindex = 20; + + val_fractiond_b = table_fraction[tindex]; + + result = val_integerd_b * 100 - val_fractiond_b; + + return result; + + +} + +void halbtc8723b1ant_psd_show_antenna_detect_result(IN struct btc_coexist + *btcoexist) +{ + u8 *cli_buf = btcoexist->cli_buf; + struct btc_board_info *board_info = &btcoexist->board_info; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n============[Antenna Detection info] ============\n"); + CL_PRINTF(cli_buf); + + if (psd_scan->ant_det_result == 1) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", + "Ant Det Result", "2-Antenna (Bad-Isolation)", + BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); + else if (psd_scan->ant_det_result == 2) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", + "Ant Det Result", "2-Antenna (Good-Isolation)", + BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION + + psd_scan->ant_det_thres_offset, + BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", + "Ant Det Result", "1-Antenna", + BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT, + BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION + + psd_scan->ant_det_thres_offset); + + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", + "Antenna Detection Finish", + (board_info->btdm_ant_det_finish + ? "Yes" : "No")); + CL_PRINTF(cli_buf); + + switch (psd_scan->ant_det_result) { + case 0: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(BT is not available)"); + break; + case 1: /* 2-Ant bad-isolation */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(BT is available)"); + break; + case 2: /* 2-Ant good-isolation */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(BT is available)"); + break; + case 3: /* 1-Ant */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(BT is available)"); + break; + case 4: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(Uncertainty result)"); + break; + case 5: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); + break; + case 6: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(WiFi is Scanning)"); + break; + case 7: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(BT is not idle)"); + break; + case 8: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(Abort by WiFi Scanning)"); + break; + case 9: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(Antenna Init is not ready)"); + break; + case 10: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(BT is Inquiry or page)"); + break; + case 11: + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "(BT is Disabled)"); + break; + } + CL_PRINTF(cli_buf); + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "Ant Detect Total Count", psd_scan->ant_det_try_count); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "Ant Detect Fail Count", psd_scan->ant_det_fail_count); + CL_PRINTF(cli_buf); + + if ((!board_info->btdm_ant_det_finish) && + (psd_scan->ant_det_result != 5)) + return; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", + (psd_scan->ant_det_result ? "ok" : "fail")); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", + psd_scan->ant_det_bt_tx_time); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", + psd_scan->ant_det_bt_le_channel); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", + "WiFi PSD Cent-Ch/Offset/Span", + psd_scan->real_cent_freq, psd_scan->real_offset, + psd_scan->real_span); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", + "PSD Pre-Scan Peak Value", + psd_scan->ant_det_pre_psdscan_peak_val / 100); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", + "PSD Pre-Scan result", + (psd_scan->ant_det_result != 5 ? "ok" : "fail"), + BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND + + psd_scan->ant_det_thres_offset); + CL_PRINTF(cli_buf); + + if (psd_scan->ant_det_result == 5) + return; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", + "PSD Scan Peak Value", psd_scan->ant_det_peak_val); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", + "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); + CL_PRINTF(cli_buf); + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", + (board_info->tfbga_package) ? "Yes" : "No"); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "PSD Threshold Offset", psd_scan->ant_det_thres_offset); + CL_PRINTF(cli_buf); + +} + +void halbtc8723b1ant_psd_showdata(IN struct btc_coexist *btcoexist) +{ + u8 *cli_buf = btcoexist->cli_buf; + u32 delta_freq_per_point; + u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n\n============[PSD info] (%d)============\n", + psd_scan->psd_gen_count); + CL_PRINTF(cli_buf); + + if (psd_scan->psd_gen_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); + CL_PRINTF(cli_buf); + return; + } + + if (psd_scan->psd_point == 0) + delta_freq_per_point = 0; + else + delta_freq_per_point = psd_scan->psd_band_width / + psd_scan->psd_point; + + /* if (psd_scan->is_psd_show_max_only) */ + if (0) { + psd_rep1 = psd_scan->psd_max_value / 100; + psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; + + freq = ((psd_scan->real_cent_freq - 20) * 1000000 + + psd_scan->psd_max_value_point * delta_freq_per_point); + freq1 = freq / 1000000; + freq2 = freq / 1000 - freq1 * 1000; + + if (freq2 < 100) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n Freq = %d.0%d MHz", + freq1, freq2); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n Freq = %d.%d MHz", + freq1, freq2); + + if (psd_rep2 < 10) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + ", Value = %d.0%d dB, (%d)\n", + psd_rep1, psd_rep2, psd_scan->psd_max_value); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + ", Value = %d.%d dB, (%d)\n", + psd_rep1, psd_rep2, psd_scan->psd_max_value); + + CL_PRINTF(cli_buf); + } else { + m = psd_scan->psd_start_point; + n = psd_scan->psd_start_point; + i = 1; + j = 1; + + while (1) { + do { + freq = ((psd_scan->real_cent_freq - 20) * + 1000000 + m * + delta_freq_per_point); + freq1 = freq / 1000000; + freq2 = freq / 1000 - freq1 * 1000; + + if (i == 1) { + if (freq2 == 0) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "\r\n Freq%6d.000", + freq1); + else if (freq2 < 100) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "\r\n Freq%6d.0%2d", + freq1, + freq2); + else + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "\r\n Freq%6d.%3d", + freq1, + freq2); + } else if ((i % 8 == 0) || + (m == psd_scan->psd_stop_point)) { + if (freq2 == 0) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%6d.000\n", freq1); + else if (freq2 < 100) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%6d.0%2d\n", freq1, + freq2); + else + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%6d.%3d\n", freq1, + freq2); + } else { + if (freq2 == 0) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%6d.000", freq1); + else if (freq2 < 100) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%6d.0%2d", freq1, + freq2); + else + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%6d.%3d", freq1, + freq2); + } + + i++; + m++; + CL_PRINTF(cli_buf); + + } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); + + + do { + psd_rep1 = psd_scan->psd_report_max_hold[n] / + 100; + psd_rep2 = psd_scan->psd_report_max_hold[n] - + psd_rep1 * + 100; + + if (j == 1) { + if (psd_rep2 < 10) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "\r\n Val %7d.0%d", + psd_rep1, + psd_rep2); + else + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "\r\n Val %7d.%d", + psd_rep1, + psd_rep2); + } else if ((j % 8 == 0) || + (n == psd_scan->psd_stop_point)) { + if (psd_rep2 < 10) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%7d.0%d\n", psd_rep1, + psd_rep2); + else + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%7d.%d\n", psd_rep1, + psd_rep2); + } else { + if (psd_rep2 < 10) + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%7d.0%d", psd_rep1, + psd_rep2); + else + CL_SPRINTF(cli_buf, + BT_TMP_BUF_SIZE, + "%7d.%d", psd_rep1, + psd_rep2); + } + + j++; + n++; + CL_PRINTF(cli_buf); + + } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); + + if ((m > psd_scan->psd_stop_point) || + (n > psd_scan->psd_stop_point)) + break; + + i = 1; + j = 1; + } + } + + +} + +void halbtc8723b1ant_psd_max_holddata(IN struct btc_coexist *btcoexist, + IN u32 gen_count) +{ + u32 i = 0, i_max = 0, val_max = 0; + + if (gen_count == 1) { + memcpy(psd_scan->psd_report_max_hold, + psd_scan->psd_report, + BT_8723B_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); + + psd_scan->psd_max_value_point = 0; + psd_scan->psd_max_value = 0; + + } else { + for (i = psd_scan->psd_start_point; + i <= psd_scan->psd_stop_point; i++) { + if (psd_scan->psd_report[i] > + psd_scan->psd_report_max_hold[i]) + psd_scan->psd_report_max_hold[i] = + psd_scan->psd_report[i]; + + /* search Max Value */ + if (i == psd_scan->psd_start_point) { + i_max = i; + val_max = psd_scan->psd_report_max_hold[i]; + } else { + if (psd_scan->psd_report_max_hold[i] > + val_max) { + i_max = i; + val_max = psd_scan->psd_report_max_hold[i]; + } + } + + } + + psd_scan->psd_max_value_point = i_max; + psd_scan->psd_max_value = val_max; + + } + + +} + +u32 halbtc8723b1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) +{ + /* reg 0x808[9:0]: FFT data x */ + /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ + /* reg 0x8b4[15:0]: FFT data y report */ + + u32 val = 0, psd_report = 0; + int k = 0; + + val = btcoexist->btc_read_4byte(btcoexist, 0x808); + + val &= 0xffbffc00; + val |= point; + + btcoexist->btc_write_4byte(btcoexist, 0x808, val); + + val |= 0x00400000; + btcoexist->btc_write_4byte(btcoexist, 0x808, val); + + while (1) { + if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) + break; + } + + val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); + + psd_report = val & 0x0000ffff; + + return psd_report; +} + + +boolean halbtc8723b1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, + IN u32 avgnum, IN u32 loopcnt) +{ + u32 i, val, n, k = 0, j, point_index = 0; + u32 points1 = 0, psd_report = 0; + u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; + u32 psd_center_freq = 20 * 10 ^ 6; + boolean outloop = false, scan , roam, is_sweep_ok = true; + u8 flag = 0; + u32 tmp; + u32 wifi_original_channel = 1; + + psd_scan->is_psd_running = true; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); + BTC_TRACE(trace_buf); + + do { + switch (flag) { + case 0: /* Get PSD parameters */ + default: + + psd_scan->psd_band_width = 40 * 1000000; + psd_scan->psd_point = points; + psd_scan->psd_start_base = points / 2; + psd_scan->psd_avg_num = avgnum; + psd_scan->real_cent_freq = cent_freq; + psd_scan->real_offset = offset; + psd_scan->real_span = span; + + + points1 = psd_scan->psd_point; + delta_freq_per_point = psd_scan->psd_band_width / + psd_scan->psd_point; + + /* PSD point setup */ + val = btcoexist->btc_read_4byte(btcoexist, 0x808); + val &= 0xffff0fff; + + switch (psd_scan->psd_point) { + case 128: + val |= 0x0; + break; + case 256: + default: + val |= 0x00004000; + break; + case 512: + val |= 0x00008000; + break; + case 1024: + val |= 0x0000c000; + break; + } + + switch (psd_scan->psd_avg_num) { + case 1: + val |= 0x0; + break; + case 8: + val |= 0x00001000; + break; + case 16: + val |= 0x00002000; + break; + case 32: + default: + val |= 0x00003000; + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x808, val); + + flag = 1; + break; + case 1: /* calculate the PSD point index from freq/offset/span */ + psd_center_freq = psd_scan->psd_band_width / 2 + + offset * (1000000); + + start_p = psd_scan->psd_start_base + (psd_center_freq - + span * (1000000) / 2) / delta_freq_per_point; + psd_scan->psd_start_point = start_p - + psd_scan->psd_start_base; + + stop_p = psd_scan->psd_start_base + (psd_center_freq + + span * (1000000) / 2) / delta_freq_per_point; + psd_scan->psd_stop_point = stop_p - + psd_scan->psd_start_base - 1; + + flag = 2; + break; + case 2: /* set RF channel/BW/Mode */ + + /* set 3-wire off */ + val = btcoexist->btc_read_4byte(btcoexist, 0x88c); + val |= 0x00300000; + btcoexist->btc_write_4byte(btcoexist, 0x88c, val); + + /* CCK off */ + val = btcoexist->btc_read_4byte(btcoexist, 0x800); + val &= 0xfeffffff; + btcoexist->btc_write_4byte(btcoexist, 0x800, val); + + /* store WiFi original channel */ + wifi_original_channel = btcoexist->btc_get_rf_reg( + btcoexist, BTC_RF_A, 0x18, 0x3ff); + + /* Set RF channel */ + if (cent_freq == 2484) + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, + 0x18, 0x3ff, 0xe); + else + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, + 0x18, 0x3ff, (cent_freq - 2412) / 5 + + 1); /* WiFi TRx Mask on */ + + + /* Set RF Rx filter corner */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, + 0xfffff, 0x3e4); + + /* Set TRx mask off */ + /* un-lock TRx Mask setup */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, + 0x80, 0x1); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, + 0x1, 0x1); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, + 0xfffff, 0x0); + + /* Set RF mode = Rx, RF Gain = 0x8a0 */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, + 0xfffff, 0x308a0); + + while (1) { + if (k++ > BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY) + break; + } + flag = 3; + break; + case 3: + psd_scan->psd_gen_count = 0; + for (j = 1; j <= loopcnt; j++) { + + btcoexist->btc_get(btcoexist, + BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, + BTC_GET_BL_WIFI_ROAM, &roam); + + if (scan || roam) { + is_sweep_ok = false; + break; + } + memset(psd_scan->psd_report, 0, + psd_scan->psd_point * sizeof(u32)); + start_p = psd_scan->psd_start_point + + psd_scan->psd_start_base; + stop_p = psd_scan->psd_stop_point + + psd_scan->psd_start_base + 1; + + i = start_p; + point_index = 0; + + while (i < stop_p) { + if (i >= points1) + psd_report = + halbtc8723b1ant_psd_getdata( + btcoexist, i - points1); + else + psd_report = + halbtc8723b1ant_psd_getdata( + btcoexist, i); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "Point=%d, psd_raw_data = 0x%08x\n", + i, psd_report); + BTC_TRACE(trace_buf); + if (psd_report == 0) + tmp = 0; + else + /* tmp = 20*log10((double)psd_report); */ + /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ + tmp = 6 * halbtc8723b1ant_psd_log2base( + btcoexist, psd_report); + + n = i - psd_scan->psd_start_base; + psd_scan->psd_report[n] = tmp; + + + halbtc8723b1ant_psd_max_holddata( + btcoexist, j); + + i++; + + } + + psd_scan->psd_gen_count = j; + } + + flag = 100; + break; + case 99: /* error */ + + outloop = true; + break; + case 100: /* recovery */ + + /* set 3-wire on */ + val = btcoexist->btc_read_4byte(btcoexist, 0x88c); + val &= 0xffcfffff; + btcoexist->btc_write_4byte(btcoexist, 0x88c, val); + + /* CCK on */ + val = btcoexist->btc_read_4byte(btcoexist, 0x800); + val |= 0x01000000; + btcoexist->btc_write_4byte(btcoexist, 0x800, val); + + /* PSD off */ + val = btcoexist->btc_read_4byte(btcoexist, 0x808); + val &= 0xffbfffff; + btcoexist->btc_write_4byte(btcoexist, 0x808, val); + + /* TRx Mask on */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, + 0xfffff, 0x780); + + /* lock TRx Mask setup */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdd, + 0x80, 0x0); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xdf, + 0x1, 0x0); + + /* Set RF Rx filter corner */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, + 0xfffff, 0x0); + + /* restore WiFi original channel */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, + 0x3ff, wifi_original_channel); + + outloop = true; + break; + + } + + } while (!outloop); + + + + psd_scan->is_psd_running = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); + BTC_TRACE(trace_buf); + return is_sweep_ok; + +} + +void halbtc8723b1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 bt_tx_time, IN u32 bt_le_channel) +{ + u32 i = 0; + u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; + s32 wlpsd_offset = -4; + u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; + + u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; + + u8 state = 0; + boolean outloop = false, bt_resp = false; + u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, + u32tmp; + struct btc_board_info *board_info = &btcoexist->board_info; + + board_info->btdm_ant_det_finish = false; + memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); + memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); + + if (board_info->tfbga_package) /* for TFBGA */ + psd_scan->ant_det_thres_offset = 5; + else + psd_scan->ant_det_thres_offset = 0; + + do { + switch (state) { + case 0: + if (bt_le_channel == 39) + wlpsd_cent_freq = 2484; + else { + for (i = 1; i <= 13; i++) { + if (bt_le_ch[i - 1] == + bt_le_channel) { + wlpsd_cent_freq = 2412 + + (i - 1) * 5; + break; + } + } + + if (i == 14) { + + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", + bt_le_channel); + BTC_TRACE(trace_buf); + outloop = true; + break; + } + } + + wlpsd_sweep_count = bt_tx_time * 238 / + 100; /* bt_tx_time/0.42 */ + wlpsd_sweep_count = wlpsd_sweep_count / 5; + + if (wlpsd_sweep_count % 5 != 0) + wlpsd_sweep_count = (wlpsd_sweep_count / + 5 + 1) * 5; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", + bt_tx_time, bt_le_channel); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", + wlpsd_cent_freq, + wlpsd_offset, + wlpsd_span, + wlpsd_sweep_count); + BTC_TRACE(trace_buf); + + state = 1; + break; + case 1: /* stop coex DM & set antenna path */ + /* Stop Coex DM */ + + /* + btcoexist->stop_coex_dm = true; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); + BTC_TRACE(trace_buf); */ + + /* Set TDMA off, */ + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, + false, 0); + + /* Set coex table */ + halbtc8723b1ant_coex_table_with_type(btcoexist, + FORCE_EXEC, 0); + + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); + BTC_TRACE(trace_buf); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); + BTC_TRACE(trace_buf); + } + + /* Set Antenna path, switch WiFi to un-certain antenna port */ + halbtc8723b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_BT, FORCE_EXEC, false, + false); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); + BTC_TRACE(trace_buf); + + /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ + h2c_parameter[0] = 0x1; + h2c_parameter[1] = 0xd; + h2c_parameter[2] = 0x14; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", + h2c_parameter[1], + h2c_parameter[2]); + BTC_TRACE(trace_buf); + + btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, + h2c_parameter); + + u32tmp = btcoexist->btc_read_4byte(btcoexist, + 0x948); + u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); + u8tmpb = btcoexist->btc_read_1byte(btcoexist, + 0x778); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x778=0x%x\n", + u32tmp, u8tmpa, u8tmpb); + BTC_TRACE(trace_buf); + + state = 2; + break; + case 2: /* Pre-sweep background psd */ + if (!halbtc8723b1ant_psd_sweep_point(btcoexist, + wlpsd_cent_freq, wlpsd_offset, wlpsd_span, + BT_8723B_1ANT_ANTDET_PSD_POINTS, + BT_8723B_1ANT_ANTDET_PSD_AVGNUM, 3)) { + board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_num_by_ant_det = 1; + psd_scan->ant_det_result = 8; + state = 99; + break; + } + + psd_scan->ant_det_pre_psdscan_peak_val = + psd_scan->psd_max_value; + + if (psd_scan->psd_max_value > + (BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND + + psd_scan->ant_det_thres_offset) * 100) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", + psd_scan->psd_max_value / 100, + BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND + + psd_scan->ant_det_thres_offset); + BTC_TRACE(trace_buf); + board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_num_by_ant_det = 1; + psd_scan->ant_det_result = 5; + state = 99; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", + psd_scan->psd_max_value / 100, + BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND + + psd_scan->ant_det_thres_offset); + BTC_TRACE(trace_buf); + state = 3; + } + break; + case 3: + bt_resp = btcoexist->btc_set_bt_ant_detection( + btcoexist, (u8)(bt_tx_time & 0xff), + (u8)(bt_le_channel & 0xff)); + + if (!halbtc8723b1ant_psd_sweep_point(btcoexist, + wlpsd_cent_freq, wlpsd_offset, + wlpsd_span, + BT_8723B_1ANT_ANTDET_PSD_POINTS, + BT_8723B_1ANT_ANTDET_PSD_AVGNUM, + wlpsd_sweep_count)) { + board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_num_by_ant_det = 1; + psd_scan->ant_det_result = 8; + state = 99; + break; + } + + psd_scan->ant_det_psd_scan_peak_val = + psd_scan->psd_max_value; + psd_scan->ant_det_psd_scan_peak_freq = + psd_scan->psd_max_value_point; + state = 4; + break; + case 4: + + if (psd_scan->psd_point == 0) + delta_freq_per_point = 0; + else + delta_freq_per_point = + psd_scan->psd_band_width / + psd_scan->psd_point; + + psd_rep1 = psd_scan->psd_max_value / 100; + psd_rep2 = psd_scan->psd_max_value - psd_rep1 * + 100; + + freq = ((psd_scan->real_cent_freq - 20) * + 1000000 + psd_scan->psd_max_value_point + * delta_freq_per_point); + freq1 = freq / 1000000; + freq2 = freq / 1000 - freq1 * 1000; + + if (freq2 < 100) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", + freq1, freq2); + BTC_TRACE(trace_buf); + CL_SPRINTF(psd_scan->ant_det_peak_freq, + BT_8723B_1ANT_ANTDET_BUF_LEN, + "%d.0%d", freq1, freq2); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", + freq1, freq2); + BTC_TRACE(trace_buf); + CL_SPRINTF(psd_scan->ant_det_peak_freq, + BT_8723B_1ANT_ANTDET_BUF_LEN, + "%d.%d", freq1, freq2); + } + + if (psd_rep2 < 10) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + ", Value = %d.0%d dB\n", + psd_rep1, psd_rep2); + BTC_TRACE(trace_buf); + CL_SPRINTF(psd_scan->ant_det_peak_val, + BT_8723B_1ANT_ANTDET_BUF_LEN, + "%d.0%d", psd_rep1, psd_rep2); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + ", Value = %d.%d dB\n", + psd_rep1, psd_rep2); + BTC_TRACE(trace_buf); + CL_SPRINTF(psd_scan->ant_det_peak_val, + BT_8723B_1ANT_ANTDET_BUF_LEN, + "%d.%d", psd_rep1, psd_rep2); + } + + psd_scan->ant_det_is_btreply_available = true; + + if (bt_resp == false) { + psd_scan->ant_det_is_btreply_available = + false; + psd_scan->ant_det_result = 0; + board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_num_by_ant_det = 1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); + BTC_TRACE(trace_buf); + } else if (psd_scan->psd_max_value > + (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) + * 100) { + psd_scan->ant_det_result = 1; + board_info->btdm_ant_det_finish = true; + board_info->btdm_ant_det_already_init_phydm = + true; + board_info->btdm_ant_num_by_ant_det = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); + BTC_TRACE(trace_buf); + } else if (psd_scan->psd_max_value > + (BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION + + psd_scan->ant_det_thres_offset) * 100) { + psd_scan->ant_det_result = 2; + board_info->btdm_ant_det_finish = true; + board_info->btdm_ant_det_already_init_phydm = + true; + board_info->btdm_ant_num_by_ant_det = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); + BTC_TRACE(trace_buf); + } else if (psd_scan->psd_max_value > + (BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT) * + 100) { + psd_scan->ant_det_result = 3; + board_info->btdm_ant_det_finish = true; + board_info->btdm_ant_det_already_init_phydm = + true; + board_info->btdm_ant_num_by_ant_det = 1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); + BTC_TRACE(trace_buf); + } else { + psd_scan->ant_det_result = 4; + board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_num_by_ant_det = 1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); + BTC_TRACE(trace_buf); + } + + state = 99; + break; + case 99: /* restore setup */ + + /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ + h2c_parameter[0] = 0x0; + h2c_parameter[1] = 0x0; + h2c_parameter[2] = 0x0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", + h2c_parameter[1], h2c_parameter[2]); + BTC_TRACE(trace_buf); + + btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, + h2c_parameter); + + /* Set Antenna Path */ + halbtc8723b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_PTA, FORCE_EXEC, false, + false); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); + BTC_TRACE(trace_buf); + + /* Resume Coex DM */ + /* + btcoexist->stop_coex_dm = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); + BTC_TRACE(trace_buf); */ + + /* stimulate coex running */ + /* + halbtc8723b1ant_run_coexist_mechanism( + btcoexist); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); + BTC_TRACE(trace_buf); + */ + + outloop = true; + break; + } + + } while (!outloop); + + + +} + +void halbtc8723b1ant_psd_antenna_detection_check(IN struct btc_coexist + *btcoexist) +{ + static u32 ant_det_count = 0, ant_det_fail_count = 0; + struct btc_board_info *board_info = &btcoexist->board_info; + + boolean scan, roam; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + + + /* psd_scan->ant_det_bt_tx_time = 20; */ + psd_scan->ant_det_bt_tx_time = + BT_8723B_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ + psd_scan->ant_det_bt_le_channel = BT_8723B_1ANT_ANTDET_BTTXCHANNEL; + + ant_det_count++; + + psd_scan->ant_det_try_count = ant_det_count; + + if (scan || roam) { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 6; + } else if (coex_sta->bt_disabled) { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 11; + } else if (coex_sta->num_of_profile >= 1) { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 7; + } else if ( + !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 9; + } else if (coex_sta->c2h_bt_inquiry_page) { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 10; + } else { + btcoexist->stop_coex_dm = true; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); + BTC_TRACE(trace_buf); + + halbtc8723b1ant_psd_antenna_detection(btcoexist, + psd_scan->ant_det_bt_tx_time, + psd_scan->ant_det_bt_le_channel); + + delay_ms(psd_scan->ant_det_bt_tx_time); + + btcoexist->stop_coex_dm = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); + BTC_TRACE(trace_buf); + + /* stimulate coex running */ + + halbtc8723b1ant_run_coexist_mechanism( + btcoexist); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); + BTC_TRACE(trace_buf); + } + + board_info->ant_det_result = psd_scan->ant_det_result; + if (!board_info->btdm_ant_det_finish) + ant_det_fail_count++; + + psd_scan->ant_det_fail_count = ant_det_fail_count; + +} + + +/* ************************************************************ + * work around function start with wa_halbtc8723b1ant_ + * ************************************************************ + * ************************************************************ + * extern function start with ex_halbtc8723b1ant_ + * ************************************************************ */ +void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u8 u8tmp = 0x0; + u16 u16tmp = 0x0; + u32 value; + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx Execute 8723b 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "Ant Det Finish = %s, Ant Det Number = %d\n", + (board_info->btdm_ant_det_finish ? "Yes" : "No"), + board_info->btdm_ant_num_by_ant_det); + BTC_TRACE(trace_buf); + + + btcoexist->stop_coex_dm = true; + + btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); + + /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ + u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); + btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); + + /* set GRAN_BT = 1 */ + btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); + /* set WLAN_ACT = 0 */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); + + /* */ + /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ + /* Local setting bit define */ + /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ + /* BIT1: "0" for internal switch; "1" for external switch */ + /* BIT2: "0" for one antenna; "1" for two antenna */ + /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ + if (btcoexist->chip_interface == BTC_INTF_USB) { + /* fixed at S0 for USB interface */ + btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); + + u8tmp |= 0x1; /* antenna inverse */ + btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); + + board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; + } else { + /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ + if (board_info->single_ant_path == 0) { + /* set to S1 */ + btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); + board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; + value = 1; + } else if (board_info->single_ant_path == 1) { + /* set to S0 */ + btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); + u8tmp |= 0x1; /* antenna inverse */ + board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; + value = 0; + } + + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, + &value); + + if (btcoexist->chip_interface == BTC_INTF_PCI) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, + u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_SDIO) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, + u8tmp); + } +} + +void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) +{ +} + +void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only) +{ + halbtc8723b1ant_init_hw_config(btcoexist, true, wifi_only); + btcoexist->stop_coex_dm = false; +} + +void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Coex Mechanism Init!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->stop_coex_dm = false; + + halbtc8723b1ant_init_coex_dm(btcoexist); + + halbtc8723b1ant_query_bt_info(btcoexist); +} + +void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 *cli_buf = btcoexist->cli_buf; + u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; + u16 u16tmp[4]; + u32 u32tmp[4]; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0; + u32 bt_coex_ver = 0; + static u8 pop_report_in_10s = 0; + u32 phyver = 0; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[BT Coexist info]============"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Under Manual Control]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + if (btcoexist->stop_coex_dm) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Coex is STOPPED]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + + if (psd_scan->ant_det_try_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", + "Ant PG Num/ Mech/ Pos", + board_info->pg_ant_num, board_info->btdm_ant_num, + board_info->btdm_ant_pos); + CL_PRINTF(cli_buf); + } else { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %d (%d/%d/%d)", + "Ant PG Num/ Mech(Ant_Det)/ Pos", + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + board_info->btdm_ant_pos, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, + psd_scan->ant_det_result); + CL_PRINTF(cli_buf); + + if (board_info->btdm_ant_det_finish) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + CL_PRINTF(cli_buf); + } + } + + if (board_info->ant_det_result_five_complete) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant number by AntDet", + board_info->btdm_ant_num_by_ant_det); + CL_PRINTF(cli_buf); + } + + /* btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); */ + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8723b_1ant, glcoex_ver_8723b_1ant, + glcoex_ver_btdesired_8723b_1ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (bt_coex_ver >= glcoex_ver_btdesired_8723b_1ant ? + "Match" : "Mis-Match"))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", + "Wifi channel informed to BT", + coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], + coex_dm->wifi_chnl_info[2]); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", + "WifibHiPri/ Ccklock/ CckEverLock", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), + (coex_sta->cck_lock ? "Yes" : "No"), + (coex_sta->cck_ever_lock ? "Yes" : "No")); + CL_PRINTF(cli_buf); + + /* wifi status */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Wifi Status]============"); + CL_PRINTF(cli_buf); + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[BT Status]============"); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", + "BT Abnormal scan", + (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); + CL_PRINTF(cli_buf); + + pop_report_in_10s++; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", + "BT [status/ rssi/ retryCnt/ popCnt]", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") + : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) + ? "connected-idle" : "busy")))), + coex_sta->bt_rssi, coex_sta->bt_retry_cnt, + coex_sta->pop_event_cnt); + CL_PRINTF(cli_buf); + + if (pop_report_in_10s >= 5) { + coex_sta->pop_event_cnt = 0; + pop_report_in_10s = 0; + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d / %d / %d / %d / %d / %d", + "SCO/HID/PAN/A2DP/NameReq/WHQL", + bt_link_info->sco_exist, bt_link_info->hid_exist, + bt_link_info->pan_exist, bt_link_info->a2dp_exist, + coex_sta->c2h_bt_remote_name_req, + coex_sta->bt_whck_test); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", + "BT Role", + (bt_link_info->slave_role) ? "Slave" : "Master"); + CL_PRINTF(cli_buf); + + bt_info_ext = coex_sta->bt_info_ext; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d", + "A2DP Rate/Bitpool", + (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); + CL_PRINTF(cli_buf); + + for (i = 0; i < BT_INFO_SRC_8723B_1ANT_MAX; i++) { + if (coex_sta->bt_info_c2h_cnt[i]) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", + glbt_info_src_8723b_1ant[i], + coex_sta->bt_info_c2h[i][0], + coex_sta->bt_info_c2h[i][1], + coex_sta->bt_info_c2h[i][2], + coex_sta->bt_info_c2h[i][3], + coex_sta->bt_info_c2h[i][4], + coex_sta->bt_info_c2h[i][5], + coex_sta->bt_info_c2h[i][6], + coex_sta->bt_info_c2h_cnt[i]); + CL_PRINTF(cli_buf); + } + } + + + if (btcoexist->manual_control) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[mechanisms] (before Manual)============"); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[mechanisms]============"); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "SM[LowPenaltyRA]", + coex_dm->cur_low_penalty_ra); + CL_PRINTF(cli_buf); + + ps_tdma_case = coex_dm->cur_ps_tdma; + if (board_info->btdm_ant_num_by_ant_det == 2) { + if (coex_dm->cur_ps_tdma_on) + ps_tdma_case = ps_tdma_case + + 100; /* for WiFi RSSI low or BT RSSI low */ + else + ps_tdma_case = + 1; /* always translate to TDMA(off,1) for TDMA-off case */ + } + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", + "PS TDMA", + coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], + coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], + coex_dm->ps_tdma_para[4], ps_tdma_case, + (coex_dm->cur_ps_tdma_on ? "On" : "Off"), + (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); + + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "Coex Table Type", + coex_sta->coex_table_type); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "IgnWlanAct", + coex_dm->cur_ignore_wlan_act); + CL_PRINTF(cli_buf); + + /* + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Latest error condition(should be 0)", + coex_dm->error_condition); + CL_PRINTF(cli_buf); + */ + + /* Hw setting */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Hw setting]============"); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", + "backup ARFR1/ARFR2/RL/AMaxTime", + coex_dm->backup_arfr_cnt1, coex_dm->backup_arfr_cnt2, + coex_dm->backup_retry_limit, + coex_dm->backup_ampdu_max_time); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); + u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", + "0x430/0x434/0x42a/0x456", + u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); + CL_PRINTF(cli_buf); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x880); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x778/0x6cc/0x880[29:25]", + u8tmp[0], u32tmp[0], (u32tmp[1] & 0x3e000000) >> 25); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x764); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x76e); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "0x948/ 0x67[5] / 0x764 / 0x76e", + u32tmp[0], ((u8tmp[0] & 0x20) >> 5), (u32tmp[1] & 0xffff), + u8tmp[1]); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", + u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); + CL_PRINTF(cli_buf); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "0x38[11]/0x40/0x4c[24:23]/0x64[0]", + ((u8tmp[0] & 0x8) >> 3), u8tmp[1], + ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "0x550(bcn ctrl)/0x522", + u32tmp[0], u8tmp[0]); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "0xc50(dig)/0x49c(null-drop)", + u32tmp[0] & 0xff, u8tmp[0]); + CL_PRINTF(cli_buf); + + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11n-agg", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11n-agg", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x6c0/0x6c4/0x6c8(coexTable)", + u32tmp[0], u32tmp[1], u32tmp[2]); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(high-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x774(low-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx); + CL_PRINTF(cli_buf); +#if (BT_AUTO_REPORT_ONLY_8723B_1ANT == 1) + /* halbtc8723b1ant_monitor_bt_ctr(btcoexist); */ +#endif + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); +} + + +void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (BTC_IPS_ENTER == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS ENTER notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_ips = true; + + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, + FORCE_EXEC, false, true); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } else if (BTC_IPS_LEAVE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS LEAVE notify\n"); + BTC_TRACE(trace_buf); + + halbtc8723b1ant_init_hw_config(btcoexist, false, false); + halbtc8723b1ant_init_coex_dm(btcoexist); + halbtc8723b1ant_query_bt_info(btcoexist); + + coex_sta->under_ips = false; + } +} + +void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (BTC_LPS_ENABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS ENABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = true; + } else if (BTC_LPS_DISABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS DISABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = false; + } +} + +void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_connected = false, bt_hs_on = false; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = false; + u8 agg_buf_size = 5; + + u8 u8tmpa, u8tmpb; + u32 u32tmp; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + if (BTC_SCAN_START == type) { + coex_sta->wifi_is_high_pri_task = true; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify\n"); + BTC_TRACE(trace_buf); + psd_scan->ant_det_is_ant_det_available = true; + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 8); /* Force antenna setup for no scan result issue */ + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + FORCE_EXEC, false, false); + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); + u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); + u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x\n", + u32tmp, u8tmpa, u8tmpb); + BTC_TRACE(trace_buf); + } else { + coex_sta->wifi_is_high_pri_task = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN FINISH notify\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + } + + if (coex_sta->bt_disabled) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + halbtc8723b1ant_query_bt_info(btcoexist); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + if (num_of_wifi_link >= 2) { + halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, + bt_ctrl_agg_buf_size, agg_buf_size); + halbtc8723b1ant_action_wifi_multi_port(btcoexist); + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8723b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8723b1ant_action_hs(btcoexist); + return; + } + + if (BTC_SCAN_START == type) { + if (!wifi_connected) /* non-connected scan */ + halbtc8723b1ant_action_wifi_not_connected_scan( + btcoexist); + else /* wifi is connected */ + halbtc8723b1ant_action_wifi_connected_scan(btcoexist); + } else if (BTC_SCAN_FINISH == type) { + if (!wifi_connected) /* non-connected scan */ + halbtc8723b1ant_action_wifi_not_connected(btcoexist); + else + halbtc8723b1ant_action_wifi_connected(btcoexist); + } +} + +void ex_halbtc8723b1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (type == 2) /* two antenna */ + halbtc8723b1ant_mechanism_switch(btcoexist, true); + else /* one antenna */ + halbtc8723b1ant_mechanism_switch(btcoexist, false); +} + +void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_connected = false, bt_hs_on = false; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = false; + u8 agg_buf_size = 5; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + if (BTC_ASSOCIATE_START == type) { + coex_sta->wifi_is_high_pri_task = true; + psd_scan->ant_det_is_ant_det_available = true; + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 8); /* Force antenna setup for no scan result issue */ + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + FORCE_EXEC, false, false); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT START notify\n"); + BTC_TRACE(trace_buf); + coex_dm->arp_cnt = 0; + } else { + coex_sta->wifi_is_high_pri_task = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT FINISH notify\n"); + BTC_TRACE(trace_buf); + /* coex_dm->arp_cnt = 0; */ + } + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + if (num_of_wifi_link >= 2) { + halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, + bt_ctrl_agg_buf_size, agg_buf_size); + halbtc8723b1ant_action_wifi_multi_port(btcoexist); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8723b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8723b1ant_action_hs(btcoexist); + return; + } + + if (BTC_ASSOCIATE_START == type) + halbtc8723b1ant_action_wifi_not_connected_asso_auth(btcoexist); + else if (BTC_ASSOCIATE_FINISH == type) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + if (!wifi_connected) /* non-connected scan */ + halbtc8723b1ant_action_wifi_not_connected(btcoexist); + else + halbtc8723b1ant_action_wifi_connected(btcoexist); + } +} + +void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_parameter[3] = {0}; + u32 wifi_bw; + u8 wifi_central_chnl; + boolean wifi_under_b_mode = false; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + if (BTC_MEDIA_CONNECT == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA connect notify\n"); + BTC_TRACE(trace_buf); + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 8); /* Force antenna setup for no scan result issue */ + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, + FORCE_EXEC, false, false); + psd_scan->ant_det_is_ant_det_available = true; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + /* Set CCK Tx/Rx high Pri except 11b mode */ + if (wifi_under_b_mode) { + btcoexist->btc_write_1byte(btcoexist, 0x6cd, + 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, + 0x00); /* CCK Rx */ + } else { + btcoexist->btc_write_1byte(btcoexist, 0x6cd, + 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, + 0x10); /* CCK Rx */ + } + + coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, + 0x430); + coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, + 0x434); + coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( + btcoexist, 0x42a); + coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( + btcoexist, 0x456); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA disconnect notify\n"); + BTC_TRACE(trace_buf); + coex_dm->arp_cnt = 0; + + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ + + coex_sta->cck_ever_lock = false; + } + + /* only 2.4G we need to inform bt the chnl mask */ + btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, + &wifi_central_chnl); + if ((BTC_MEDIA_CONNECT == type) && + (wifi_central_chnl <= 14)) { + /* h2c_parameter[0] = 0x1; */ + h2c_parameter[0] = 0x0; + h2c_parameter[1] = wifi_central_chnl; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) + h2c_parameter[2] = 0x30; + else + h2c_parameter[2] = 0x20; + } + + coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; + coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; + coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; + + btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); +} + +void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean bt_hs_on = false; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = false, under_4way = false; + u8 agg_buf_size = 5; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + if (BTC_PACKET_DHCP == type || + BTC_PACKET_EAPOL == type || + BTC_PACKET_ARP == type) { + if (BTC_PACKET_ARP == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ARP notify\n"); + BTC_TRACE(trace_buf); + + coex_dm->arp_cnt++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ARP Packet Count = %d\n", + coex_dm->arp_cnt); + BTC_TRACE(trace_buf); + + if ((coex_dm->arp_cnt >= 10) && + (!under_4way)) /* if APR PKT > 10 after connect, do not go to ActionWifiConnectedSpecificPacket(btcoexist) */ + coex_sta->wifi_is_high_pri_task = false; + else + coex_sta->wifi_is_high_pri_task = true; + } else { + coex_sta->wifi_is_high_pri_task = true; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet DHCP or EAPOL notify\n"); + BTC_TRACE(trace_buf); + } + } else { + coex_sta->wifi_is_high_pri_task = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet [Type = %d] notify\n", type); + BTC_TRACE(trace_buf); + } + + coex_sta->specific_pkt_period_cnt = 0; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + if (num_of_wifi_link >= 2) { + halbtc8723b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8723b1ant_limited_rx(btcoexist, NORMAL_EXEC, false, + bt_ctrl_agg_buf_size, agg_buf_size); + halbtc8723b1ant_action_wifi_multi_port(btcoexist); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8723b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8723b1ant_action_hs(btcoexist); + return; + } + + if (BTC_PACKET_DHCP == type || + BTC_PACKET_EAPOL == type || + ((BTC_PACKET_ARP == type) && (coex_sta->wifi_is_high_pri_task))) + halbtc8723b1ant_action_wifi_connected_specific_packet( + btcoexist); +} + +/* Donot remove optimize off flag, otherwise antenna detection would trigger BT collapsed */ +#ifdef PLATFORM_WINDOWS +#pragma optimize("", off) +#endif +void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 bt_info = 0; + u8 i, rsp_source = 0; + boolean wifi_connected = false; + boolean bt_busy = false; + struct btc_board_info *board_info = &btcoexist->board_info; + + coex_sta->c2h_bt_info_req_sent = false; + + rsp_source = tmp_buf[0] & 0xf; + if (rsp_source >= BT_INFO_SRC_8723B_1ANT_MAX) + rsp_source = BT_INFO_SRC_8723B_1ANT_WIFI_FW; + coex_sta->bt_info_c2h_cnt[rsp_source]++; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, + length); + BTC_TRACE(trace_buf); + for (i = 0; i < length; i++) { + coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; + if (i == 1) + bt_info = tmp_buf[i]; + if (i == length - 1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } + } + + /* if 0xff, it means BT is under WHCK test */ + if (bt_info == 0xff) + coex_sta->bt_whck_test = true; + else + coex_sta->bt_whck_test = false; + + if (BT_INFO_SRC_8723B_1ANT_WIFI_FW != rsp_source) { + coex_sta->bt_retry_cnt = /* [3:0] */ + coex_sta->bt_info_c2h[rsp_source][2] & 0xf; + + if (coex_sta->bt_retry_cnt >= 1) + coex_sta->pop_event_cnt++; + + if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) + coex_sta->c2h_bt_remote_name_req = true; + else + coex_sta->c2h_bt_remote_name_req = false; + + coex_sta->bt_rssi = + coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; + /* coex_sta->bt_info_c2h[rsp_source][3]*2+10; */ + + coex_sta->bt_info_ext = + coex_sta->bt_info_c2h[rsp_source][4]; + + if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { + coex_sta->a2dp_bit_pool = + coex_sta->bt_info_c2h[rsp_source][6] & 0x7f; + } else + coex_sta->a2dp_bit_pool = 0; + + coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] + & 0x40); + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, + &coex_sta->bt_tx_rx_mask); + + if (btcoexist->stop_coex_dm) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT info Notify() return because stop_coex_dm\n"); + BTC_TRACE(trace_buf); + + return; + } + + +#if BT_8723B_1ANT_ANTDET_ENABLE +#if BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE + if ((board_info->btdm_ant_det_finish) && + (board_info->btdm_ant_num_by_ant_det == 2)) { + if (coex_sta->bt_tx_rx_mask) { + + /* BT TRx mask off */ + btcoexist->btc_set_bt_trx_mask(btcoexist, 0); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT TRx Mask off for BT Info Notify\n"); + BTC_TRACE(trace_buf); +#if 0 + /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x1\n"); + BTC_TRACE(trace_buf); + + /* BT TRx Mask un-lock 0x2c[0], 0x30[0] = 1 */ + btcoexist->btc_set_bt_reg(btcoexist, + BTC_BT_REG_RF, 0x2c, 0x7c45); + btcoexist->btc_set_bt_reg(btcoexist, + BTC_BT_REG_RF, 0x30, 0x7c45); + + btcoexist->btc_set_bt_reg(btcoexist, + BTC_BT_REG_RF, 0x3c, 0x1); +#endif + } + } else +#endif +#endif + + { + if (!coex_sta->bt_tx_rx_mask) { + + /* BT TRx mask on */ + btcoexist->btc_set_bt_trx_mask(btcoexist, 1); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT TRx Mask on for BT Info Notify\n"); + BTC_TRACE(trace_buf); +#if 0 + /* BT into is responded by BT FW and BT RF REG 0x3C != 0x15 => Need to switch BT TRx Mask */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x15\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_bt_reg(btcoexist, + BTC_BT_REG_RF, + 0x3c, 0x15); + + /* BT TRx Mask lock 0x2c[0], 0x30[0] = 0 */ + btcoexist->btc_set_bt_reg(btcoexist, + BTC_BT_REG_RF, + 0x2c, 0x7c44); + btcoexist->btc_set_bt_reg(btcoexist, + BTC_BT_REG_RF, + 0x30, 0x7c44); +#endif + } + } + + /* Here we need to resend some wifi info to BT */ + /* because bt is reset and loss of the info. */ + if (coex_sta->bt_info_ext & BIT(1)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + if (wifi_connected) + ex_halbtc8723b1ant_media_status_notify( + btcoexist, BTC_MEDIA_CONNECT); + else + ex_halbtc8723b1ant_media_status_notify( + btcoexist, BTC_MEDIA_DISCONNECT); + } + + if (coex_sta->bt_info_ext & BIT(3)) { + if (!btcoexist->manual_control && + !btcoexist->stop_coex_dm) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b1ant_ignore_wlan_act(btcoexist, + FORCE_EXEC, false); + } + } else { + /* BT already NOT ignore Wlan active, do nothing here. */ + } +#if (BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) + if ((coex_sta->bt_info_ext & BIT(4))) { + /* BT auto report already enabled, do nothing */ + } else + halbtc8723b1ant_bt_auto_report(btcoexist, FORCE_EXEC, + true); +#endif + } + + /* check BIT2 first ==> check if bt is under inquiry or page scan */ + if (bt_info & BT_INFO_8723B_1ANT_B_INQ_PAGE) + coex_sta->c2h_bt_inquiry_page = true; + else + coex_sta->c2h_bt_inquiry_page = false; + + coex_sta->num_of_profile = 0; + + /* set link exist status */ + if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) { + coex_sta->bt_link_exist = false; + coex_sta->pan_exist = false; + coex_sta->a2dp_exist = false; + coex_sta->hid_exist = false; + coex_sta->sco_exist = false; + + coex_sta->bt_hi_pri_link_exist = false; + } else { /* connection exists */ + coex_sta->bt_link_exist = true; + if (bt_info & BT_INFO_8723B_1ANT_B_FTP) { + coex_sta->pan_exist = true; + coex_sta->num_of_profile++; + } else + coex_sta->pan_exist = false; + if (bt_info & BT_INFO_8723B_1ANT_B_A2DP) { + coex_sta->a2dp_exist = true; + coex_sta->num_of_profile++; + } else + coex_sta->a2dp_exist = false; + if (bt_info & BT_INFO_8723B_1ANT_B_HID) { + coex_sta->hid_exist = true; + coex_sta->num_of_profile++; + } else + coex_sta->hid_exist = false; + if (bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) { + coex_sta->sco_exist = true; + coex_sta->num_of_profile++; + } else + coex_sta->sco_exist = false; + + if ((coex_sta->hid_exist == false) && + (coex_sta->c2h_bt_inquiry_page == false) && + (coex_sta->sco_exist == false)) { + if (coex_sta->high_priority_tx + + coex_sta->high_priority_rx >= 160) { + coex_sta->hid_exist = true; + coex_sta->wrong_profile_notification++; + coex_sta->num_of_profile++; + bt_info = bt_info | 0x28; + } + } + + /* Add Hi-Pri Tx/Rx counter to avoid false detection */ + if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && + (coex_sta->high_priority_tx + + coex_sta->high_priority_rx >= 160) + && (!coex_sta->c2h_bt_inquiry_page)) + coex_sta->bt_hi_pri_link_exist = true; + + if ((bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) && + (coex_sta->num_of_profile == 0)) { + if (coex_sta->low_priority_tx + + coex_sta->low_priority_rx >= 160) { + coex_sta->pan_exist = true; + coex_sta->num_of_profile++; + coex_sta->wrong_profile_notification++; + bt_info = bt_info | 0x88; + } + } + } + + halbtc8723b1ant_update_bt_link_info(btcoexist); + + bt_info = bt_info & + 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ + + if (!(bt_info & BT_INFO_8723B_1ANT_B_CONNECTION)) + coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; + else if (bt_info == + BT_INFO_8723B_1ANT_B_CONNECTION) /* connection exists but no busy */ + coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE; + else if ((bt_info & BT_INFO_8723B_1ANT_B_SCO_ESCO) || + (bt_info & BT_INFO_8723B_1ANT_B_SCO_BUSY)) + coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_SCO_BUSY; + else if (bt_info & BT_INFO_8723B_1ANT_B_ACL_BUSY) { + if (BT_8723B_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) + coex_dm->auto_tdma_adjust = false; + coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_ACL_BUSY; + } else + coex_dm->bt_status = BT_8723B_1ANT_BT_STATUS_MAX; + + if ((BT_8723B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + bt_busy = true; + else + bt_busy = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + + halbtc8723b1ant_run_coexist_mechanism(btcoexist); +} + +void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u32 u32tmp; + u8 u8tmpa, u8tmpb, u8tmpc; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); + BTC_TRACE(trace_buf); + + if (BTC_RF_ON == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned ON!!\n"); + BTC_TRACE(trace_buf); + btcoexist->stop_coex_dm = false; + } else if (BTC_RF_OFF == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned OFF!!\n"); + BTC_TRACE(trace_buf); + + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, + FORCE_EXEC, false, true); + + halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); + btcoexist->stop_coex_dm = true; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); + u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); + u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x67); + u8tmpc = btcoexist->btc_read_1byte(btcoexist, 0x76e); + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x67=0x%x, 0x76e=0x%x\n", + u32tmp, u8tmpa, u8tmpb, u8tmpc); + BTC_TRACE(trace_buf); + + } +} + +void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); + BTC_TRACE(trace_buf); + + halbtc8723b1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, + false, true); + + halbtc8723b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); + + ex_halbtc8723b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); + + btcoexist->stop_coex_dm = true; +} + +void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state) +{ + if (BTC_WIFI_PNP_SLEEP == pnp_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to SLEEP\n"); + BTC_TRACE(trace_buf); + + halbtc8723b1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, + FORCE_EXEC, false, true); + halbtc8723b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + + /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ + /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ + /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ + coex_sta->under_ips = false; + coex_sta->under_lps = false; + btcoexist->stop_coex_dm = true; + } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to WAKE UP\n"); + BTC_TRACE(trace_buf); + btcoexist->stop_coex_dm = false; + halbtc8723b1ant_init_hw_config(btcoexist, false, false); + halbtc8723b1ant_init_coex_dm(btcoexist); + halbtc8723b1ant_query_bt_info(btcoexist); + } +} + +void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) +{ + + halbtc8723b1ant_init_hw_config(btcoexist, false, false); + /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ + /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x2, 0xfffff, 0x0); */ + halbtc8723b1ant_init_coex_dm(btcoexist); +} + +void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist) +{ + u32 bt_patch_ver; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ==========================Periodical===========================\n"); + BTC_TRACE(trace_buf); + +#if (BT_AUTO_REPORT_ONLY_8723B_1ANT == 0) + halbtc8723b1ant_query_bt_info(btcoexist); +#endif + halbtc8723b1ant_monitor_bt_ctr(btcoexist); + halbtc8723b1ant_monitor_wifi_ctr(btcoexist); + + halbtc8723b1ant_monitor_bt_enable_disable(btcoexist); + + + if (halbtc8723b1ant_is_wifi_status_changed(btcoexist) || + coex_dm->auto_tdma_adjust || + btcoexist->bt_info.bt_enable_disable_change) + halbtc8723b1ant_run_coexist_mechanism(btcoexist); + + if (((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) && (!coex_sta->bt_disabled)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, &coex_sta->bt_coex_supported_version); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + coex_sta->specific_pkt_period_cnt++; + + /* sample to set bt to execute Ant detection */ + /* btcoexist->btc_set_bt_ant_detection(btcoexist, 20, 14); + * + if (psd_scan->is_ant_det_enable) + { + if (psd_scan->psd_gen_count > psd_scan->realseconds) + psd_scan->psd_gen_count = 0; + + halbtc8723b1ant_antenna_detection(btcoexist, psd_scan->realcent_freq, psd_scan->realoffset, psd_scan->realspan, psd_scan->realseconds); + psd_scan->psd_gen_total_count +=2; + psd_scan->psd_gen_count += 2; + } + */ +} + +/* Donot remove optimize off flag, otherwise antenna detection would trigger BT collapsed */ +#ifdef PLATFORM_WINDOWS +#pragma optimize("", off) +#endif +void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ +#if BT_8723B_1ANT_ANTDET_ENABLE + static u32 ant_det_count = 0, ant_det_fail_count = 0; + struct btc_board_info *board_info = &btcoexist->board_info; + /*boolean scan, roam;*/ + + if (seconds == 0) { + psd_scan->ant_det_try_count = 0; + psd_scan->ant_det_fail_count = 0; + ant_det_count = 0; + ant_det_fail_count = 0; + board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_num_by_ant_det = 1; + return; + } + + if (!board_info->btdm_ant_det_finish) { + psd_scan->ant_det_inteval_count = + psd_scan->ant_det_inteval_count + 2; + + if (psd_scan->ant_det_inteval_count >= + BT_8723B_1ANT_ANTDET_RETRY_INTERVAL) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b1ant_psd_antenna_detection_check(btcoexist); + + if (board_info->btdm_ant_det_finish) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); + BTC_TRACE(trace_buf); + + +#if 1 + if (board_info->btdm_ant_num_by_ant_det == 2) + halbtc8723b1ant_mechanism_switch( + btcoexist, true); + else + halbtc8723b1ant_mechanism_switch( + btcoexist, false); +#endif + + board_info->btdm_ant_det_complete_fail = false; + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); + BTC_TRACE(trace_buf); + + board_info->btdm_ant_det_complete_fail = true; + } + psd_scan->ant_det_inteval_count = 0; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", + psd_scan->ant_det_inteval_count); + BTC_TRACE(trace_buf); + } + + } +#endif + + + /* + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + + + psd_scan->ant_det_bt_tx_time = seconds; + psd_scan->ant_det_bt_le_channel = cent_freq; + + if (seconds == 0) + { + psd_scan->ant_det_try_count = 0; + psd_scan->ant_det_fail_count = 0; + ant_det_count = 0; + ant_det_fail_count = 0; + board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_num_by_ant_det = 1; + return; + } + else + { + ant_det_count++; + + psd_scan->ant_det_try_count = ant_det_count; + + if (scan ||roam) + { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 6; + } + else if (coex_sta->num_of_profile >= 1) + { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 7; + } + else if (!psd_scan->ant_det_is_ant_det_available) + { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 9; + } + else if (coex_sta->c2h_bt_inquiry_page) + { + board_info->btdm_ant_det_finish = false; + psd_scan->ant_det_result = 10; + } + else + { + + } + + if (!board_info->btdm_ant_det_finish) + ant_det_fail_count++; + + psd_scan->ant_det_fail_count = ant_det_fail_count; + } + */ +} + + +void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) +{ +#if BT_8723B_1ANT_ANTDET_ENABLE + struct btc_board_info *board_info = &btcoexist->board_info; + + if (psd_scan->ant_det_try_count != 0) { + halbtc8723b1ant_psd_show_antenna_detect_result(btcoexist); + + if (board_info->btdm_ant_det_finish) + halbtc8723b1ant_psd_showdata(btcoexist); + return; + } +#endif + + /* halbtc8723b1ant_show_psd_data(btcoexist); */ +} + +#endif + +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b1Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b1ant.h similarity index 89% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b1Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b1ant.h index 19bac7b351e5..adb29d492bd7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b1Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b1ant.h @@ -1,288 +1,307 @@ - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8723B_SUPPORT == 1) -/* ******************************************* - * The following is for 8723B 1ANT BT Co-exist definition - * ******************************************* */ -#define BT_AUTO_REPORT_ONLY_8723B_1ANT 1 - -#define BT_INFO_8723B_1ANT_B_FTP BIT(7) -#define BT_INFO_8723B_1ANT_B_A2DP BIT(6) -#define BT_INFO_8723B_1ANT_B_HID BIT(5) -#define BT_INFO_8723B_1ANT_B_SCO_BUSY BIT(4) -#define BT_INFO_8723B_1ANT_B_ACL_BUSY BIT(3) -#define BT_INFO_8723B_1ANT_B_INQ_PAGE BIT(2) -#define BT_INFO_8723B_1ANT_B_SCO_ESCO BIT(1) -#define BT_INFO_8723B_1ANT_B_CONNECTION BIT(0) - -#define BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) - -#define BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT 2 - -#define BT_8723B_1ANT_WIFI_NOISY_THRESH 50 /* 30 //max: 255 */ - -/* for Antenna detection */ -#define BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 -#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 -#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 -#define BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT 32 -#define BT_8723B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -#define BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 -#define BT_8723B_1ANT_ANTDET_ENABLE 1 -#define BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 1 -#define BT_8723B_1ANT_ANTDET_BTTXTIME 100 -#define BT_8723B_1ANT_ANTDET_BTTXCHANNEL 39 - -enum bt_info_src_8723b_1ant { - BT_INFO_SRC_8723B_1ANT_WIFI_FW = 0x0, - BT_INFO_SRC_8723B_1ANT_BT_RSP = 0x1, - BT_INFO_SRC_8723B_1ANT_BT_ACTIVE_SEND = 0x2, - BT_INFO_SRC_8723B_1ANT_MAX -}; - -enum bt_8723b_1ant_bt_status { - BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, - BT_8723B_1ANT_BT_STATUS_INQ_PAGE = 0x2, - BT_8723B_1ANT_BT_STATUS_ACL_BUSY = 0x3, - BT_8723B_1ANT_BT_STATUS_SCO_BUSY = 0x4, - BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, - BT_8723B_1ANT_BT_STATUS_MAX -}; - -enum bt_8723b_1ant_wifi_status { - BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, - BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, - BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, - BT_8723B_1ANT_WIFI_STATUS_MAX -}; - -enum bt_8723b_1ant_coex_algo { - BT_8723B_1ANT_COEX_ALGO_UNDEFINED = 0x0, - BT_8723B_1ANT_COEX_ALGO_SCO = 0x1, - BT_8723B_1ANT_COEX_ALGO_HID = 0x2, - BT_8723B_1ANT_COEX_ALGO_A2DP = 0x3, - BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, - BT_8723B_1ANT_COEX_ALGO_PANEDR = 0x5, - BT_8723B_1ANT_COEX_ALGO_PANHS = 0x6, - BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, - BT_8723B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8723B_1ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8723B_1ANT_COEX_ALGO_MAX = 0xb, -}; - -struct coex_dm_8723b_1ant { - /* hw setting */ - u8 pre_ant_pos_type; - u8 cur_ant_pos_type; - /* fw mechanism */ - boolean cur_ignore_wlan_act; - boolean pre_ignore_wlan_act; - u8 pre_ps_tdma; - u8 cur_ps_tdma; - u8 ps_tdma_para[5]; - u8 ps_tdma_du_adj_type; - boolean auto_tdma_adjust; - boolean pre_ps_tdma_on; - boolean cur_ps_tdma_on; - boolean pre_bt_auto_report; - boolean cur_bt_auto_report; - u8 pre_lps; - u8 cur_lps; - u8 pre_rpwm; - u8 cur_rpwm; - - /* sw mechanism */ - boolean pre_low_penalty_ra; - boolean cur_low_penalty_ra; - u32 pre_val0x6c0; - u32 cur_val0x6c0; - u32 pre_val0x6c4; - u32 cur_val0x6c4; - u32 pre_val0x6c8; - u32 cur_val0x6c8; - u8 pre_val0x6cc; - u8 cur_val0x6cc; - - u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ - u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ - u16 backup_retry_limit; - u8 backup_ampdu_max_time; - - /* algorithm related */ - u8 bt_status; - u8 wifi_chnl_info[3]; - - u32 pre_ra_mask; - u32 cur_ra_mask; - u8 pre_arfr_type; - u8 cur_arfr_type; - u8 pre_retry_limit_type; - u8 cur_retry_limit_type; - u8 pre_ampdu_time_type; - u8 cur_ampdu_time_type; - u32 arp_cnt; - - u8 error_condition; -}; - -struct coex_sta_8723b_1ant { - boolean bt_disabled; - boolean bt_link_exist; - boolean sco_exist; - boolean a2dp_exist; - boolean hid_exist; - boolean pan_exist; - boolean bt_hi_pri_link_exist; - u8 num_of_profile; - boolean bt_abnormal_scan; - - boolean under_lps; - boolean under_ips; - u32 specific_pkt_period_cnt; - u32 high_priority_tx; - u32 high_priority_rx; - u32 low_priority_tx; - u32 low_priority_rx; - s8 bt_rssi; - boolean bt_tx_rx_mask; - boolean c2h_bt_info_req_sent; - u8 bt_info_c2h[BT_INFO_SRC_8723B_1ANT_MAX][10]; - u32 bt_info_c2h_cnt[BT_INFO_SRC_8723B_1ANT_MAX]; - boolean bt_whck_test; - boolean c2h_bt_inquiry_page; - boolean c2h_bt_remote_name_req; - boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ - u8 bt_retry_cnt; - u8 bt_info_ext; - u32 pop_event_cnt; - u8 scan_ap_num; - - u32 crc_ok_cck; - u32 crc_ok_11g; - u32 crc_ok_11n; - u32 crc_ok_11n_agg; - - u32 crc_err_cck; - u32 crc_err_11g; - u32 crc_err_11n; - u32 crc_err_11n_agg; - - boolean cck_lock; - boolean pre_ccklock; - boolean cck_ever_lock; - u8 coex_table_type; - - boolean force_lps_on; - u32 wrong_profile_notification; - - u8 a2dp_bit_pool; - u8 cut_version; -}; - -#define BT_8723B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ -#define BT_8723B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ -#define BT_8723B_1ANT_ANTDET_BUF_LEN 16 - -struct psdscan_sta_8723b_1ant { - - u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ - u32 ant_det_bt_tx_time; - u32 ant_det_pre_psdscan_peak_val; - boolean ant_det_is_ant_det_available; - u32 ant_det_psd_scan_peak_val; - boolean ant_det_is_btreply_available; - u32 ant_det_psd_scan_peak_freq; - - u8 ant_det_result; - u8 ant_det_peak_val[BT_8723B_1ANT_ANTDET_BUF_LEN]; - u8 ant_det_peak_freq[BT_8723B_1ANT_ANTDET_BUF_LEN]; - u32 ant_det_try_count; - u32 ant_det_fail_count; - u32 ant_det_inteval_count; - u32 ant_det_thres_offset; - - u32 real_cent_freq; - s32 real_offset; - u32 real_span; - - u32 psd_band_width; /* unit: Hz */ - u32 psd_point; /* 128/256/512/1024 */ - u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ - u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ - u32 psd_start_point; - u32 psd_stop_point; - u32 psd_max_value_point; - u32 psd_max_value; - u32 psd_start_base; - u32 psd_avg_num; /* 1/8/16/32 */ - u32 psd_gen_count; - boolean is_psd_running; - boolean is_psd_show_max_only; -}; - -/* ******************************************* - * The following is interface which will notify coex module. - * ******************************************* */ -void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only); -void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length); -void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type); -void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state); -void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist); -void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); - -void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); - -#else -#define ex_halbtc8723b1ant_power_on_setting(btcoexist) -#define ex_halbtc8723b1ant_pre_load_firmware(btcoexist) -#define ex_halbtc8723b1ant_init_hw_config(btcoexist, wifi_only) -#define ex_halbtc8723b1ant_init_coex_dm(btcoexist) -#define ex_halbtc8723b1ant_ips_notify(btcoexist, type) -#define ex_halbtc8723b1ant_lps_notify(btcoexist, type) -#define ex_halbtc8723b1ant_scan_notify(btcoexist, type) -#define ex_halbtc8723b1ant_connect_notify(btcoexist, type) -#define ex_halbtc8723b1ant_media_status_notify(btcoexist, type) -#define ex_halbtc8723b1ant_specific_packet_notify(btcoexist, type) -#define ex_halbtc8723b1ant_bt_info_notify(btcoexist, tmp_buf, length) -#define ex_halbtc8723b1ant_rf_status_notify(btcoexist, type) -#define ex_halbtc8723b1ant_halt_notify(btcoexist) -#define ex_halbtc8723b1ant_pnp_notify(btcoexist, pnp_state) -#define ex_halbtc8723b1ant_coex_dm_reset(btcoexist) -#define ex_halbtc8723b1ant_periodical(btcoexist) -#define ex_halbtc8723b1ant_display_coex_info(btcoexist) -#define ex_halbtc8723b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) -#define ex_halbtc8723b1ant_display_ant_detection(btcoexist) - -#endif - -#endif +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + +#if (RTL8723B_SUPPORT == 1) +/* ******************************************* + * The following is for 8723B 1ANT BT Co-exist definition + * ******************************************* */ +#define BT_AUTO_REPORT_ONLY_8723B_1ANT 1 + +#define BT_INFO_8723B_1ANT_B_FTP BIT(7) +#define BT_INFO_8723B_1ANT_B_A2DP BIT(6) +#define BT_INFO_8723B_1ANT_B_HID BIT(5) +#define BT_INFO_8723B_1ANT_B_SCO_BUSY BIT(4) +#define BT_INFO_8723B_1ANT_B_ACL_BUSY BIT(3) +#define BT_INFO_8723B_1ANT_B_INQ_PAGE BIT(2) +#define BT_INFO_8723B_1ANT_B_SCO_ESCO BIT(1) +#define BT_INFO_8723B_1ANT_B_CONNECTION BIT(0) + +#define BT_INFO_8723B_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ + (((_BT_INFO_EXT_&BIT(0))) ? true : false) + +#define BTC_RSSI_COEX_THRESH_TOL_8723B_1ANT 2 + +#define BT_8723B_1ANT_WIFI_NOISY_THRESH 50 /* 30 /max: 255 */ + +/* for Antenna detection */ +#define BT_8723B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 +#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 +#define BT_8723B_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 48 +#define BT_8723B_1ANT_ANTDET_PSDTHRES_1ANT 32 +#define BT_8723B_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ +#define BT_8723B_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 +#define BT_8723B_1ANT_ANTDET_ENABLE 1 +#define BT_8723B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 1 +#define BT_8723B_1ANT_ANTDET_BTTXTIME 100 +#define BT_8723B_1ANT_ANTDET_BTTXCHANNEL 39 + +enum bt_info_src_8723b_1ant { + BT_INFO_SRC_8723B_1ANT_WIFI_FW = 0x0, + BT_INFO_SRC_8723B_1ANT_BT_RSP = 0x1, + BT_INFO_SRC_8723B_1ANT_BT_ACTIVE_SEND = 0x2, + BT_INFO_SRC_8723B_1ANT_MAX +}; + +enum bt_8723b_1ant_bt_status { + BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, + BT_8723B_1ANT_BT_STATUS_CONNECTED_IDLE = 0x1, + BT_8723B_1ANT_BT_STATUS_INQ_PAGE = 0x2, + BT_8723B_1ANT_BT_STATUS_ACL_BUSY = 0x3, + BT_8723B_1ANT_BT_STATUS_SCO_BUSY = 0x4, + BT_8723B_1ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, + BT_8723B_1ANT_BT_STATUS_MAX +}; + +enum bt_8723b_1ant_wifi_status { + BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_IDLE = 0x0, + BT_8723B_1ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN = 0x1, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SCAN = 0x2, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_SPECIFIC_PKT = 0x3, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_IDLE = 0x4, + BT_8723B_1ANT_WIFI_STATUS_CONNECTED_BUSY = 0x5, + BT_8723B_1ANT_WIFI_STATUS_MAX +}; + +enum bt_8723b_1ant_coex_algo { + BT_8723B_1ANT_COEX_ALGO_UNDEFINED = 0x0, + BT_8723B_1ANT_COEX_ALGO_SCO = 0x1, + BT_8723B_1ANT_COEX_ALGO_HID = 0x2, + BT_8723B_1ANT_COEX_ALGO_A2DP = 0x3, + BT_8723B_1ANT_COEX_ALGO_A2DP_PANHS = 0x4, + BT_8723B_1ANT_COEX_ALGO_PANEDR = 0x5, + BT_8723B_1ANT_COEX_ALGO_PANHS = 0x6, + BT_8723B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, + BT_8723B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, + BT_8723B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, + BT_8723B_1ANT_COEX_ALGO_HID_A2DP = 0xa, + BT_8723B_1ANT_COEX_ALGO_MAX = 0xb, +}; + +struct coex_dm_8723b_1ant { + /* hw setting */ + u8 pre_ant_pos_type; + u8 cur_ant_pos_type; + /* fw mechanism */ + boolean cur_ignore_wlan_act; + boolean pre_ignore_wlan_act; + u8 pre_ps_tdma; + u8 cur_ps_tdma; + u8 ps_tdma_para[5]; + u8 ps_tdma_du_adj_type; + boolean auto_tdma_adjust; + boolean pre_ps_tdma_on; + boolean cur_ps_tdma_on; + boolean pre_bt_auto_report; + boolean cur_bt_auto_report; + u8 pre_lps; + u8 cur_lps; + u8 pre_rpwm; + u8 cur_rpwm; + + /* sw mechanism */ + boolean pre_low_penalty_ra; + boolean cur_low_penalty_ra; + u32 pre_val0x6c0; + u32 cur_val0x6c0; + u32 pre_val0x6c4; + u32 cur_val0x6c4; + u32 pre_val0x6c8; + u32 cur_val0x6c8; + u8 pre_val0x6cc; + u8 cur_val0x6cc; + + u32 backup_arfr_cnt1; /* Auto Rate Fallback Retry cnt */ + u32 backup_arfr_cnt2; /* Auto Rate Fallback Retry cnt */ + u16 backup_retry_limit; + u8 backup_ampdu_max_time; + + /* algorithm related */ + u8 bt_status; + u8 wifi_chnl_info[3]; + + u32 pre_ra_mask; + u32 cur_ra_mask; + u8 pre_arfr_type; + u8 cur_arfr_type; + u8 pre_retry_limit_type; + u8 cur_retry_limit_type; + u8 pre_ampdu_time_type; + u8 cur_ampdu_time_type; + u32 arp_cnt; + + u8 error_condition; +}; + +struct coex_sta_8723b_1ant { + boolean bt_disabled; + boolean bt_enable_disable_change; + boolean bt_link_exist; + boolean sco_exist; + boolean a2dp_exist; + boolean hid_exist; + boolean pan_exist; + boolean bt_hi_pri_link_exist; + u8 num_of_profile; + boolean bt_abnormal_scan; + + boolean under_lps; + boolean under_ips; + u32 specific_pkt_period_cnt; + u32 high_priority_tx; + u32 high_priority_rx; + u32 low_priority_tx; + u32 low_priority_rx; + s8 bt_rssi; + boolean bt_tx_rx_mask; + boolean c2h_bt_info_req_sent; + u8 bt_info_c2h[BT_INFO_SRC_8723B_1ANT_MAX][10]; + u32 bt_info_c2h_cnt[BT_INFO_SRC_8723B_1ANT_MAX]; + boolean bt_whck_test; + boolean c2h_bt_inquiry_page; + boolean c2h_bt_remote_name_req; + boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ + u8 bt_retry_cnt; + u8 bt_info_ext; + u32 pop_event_cnt; + u8 scan_ap_num; + + u32 crc_ok_cck; + u32 crc_ok_11g; + u32 crc_ok_11n; + u32 crc_ok_11n_vht; + + u32 crc_err_cck; + u32 crc_err_11g; + u32 crc_err_11n; + u32 crc_err_11n_vht; + + boolean cck_lock; + boolean pre_ccklock; + boolean cck_ever_lock; + u8 coex_table_type; + + boolean force_lps_on; + u32 wrong_profile_notification; + u32 bt_coex_supported_version; + u8 a2dp_bit_pool; + u8 cut_version; +}; + +#define BT_8723B_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ +#define BT_8723B_1ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ +#define BT_8723B_1ANT_ANTDET_BUF_LEN 16 + +struct psdscan_sta_8723b_1ant { + + u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ + u32 ant_det_bt_tx_time; + u32 ant_det_pre_psdscan_peak_val; + boolean ant_det_is_ant_det_available; + u32 ant_det_psd_scan_peak_val; + boolean ant_det_is_btreply_available; + u32 ant_det_psd_scan_peak_freq; + + u8 ant_det_result; + u8 ant_det_peak_val[BT_8723B_1ANT_ANTDET_BUF_LEN]; + u8 ant_det_peak_freq[BT_8723B_1ANT_ANTDET_BUF_LEN]; + u32 ant_det_try_count; + u32 ant_det_fail_count; + u32 ant_det_inteval_count; + u32 ant_det_thres_offset; + + u32 real_cent_freq; + s32 real_offset; + u32 real_span; + + u32 psd_band_width; /* unit: Hz */ + u32 psd_point; /* 128/256/512/1024 */ + u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ + u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ + u32 psd_start_point; + u32 psd_stop_point; + u32 psd_max_value_point; + u32 psd_max_value; + u32 psd_start_base; + u32 psd_avg_num; /* 1/8/16/32 */ + u32 psd_gen_count; + boolean is_psd_running; + boolean is_psd_show_max_only; +}; + +/* ******************************************* + * The following is interface which will notify coex module. + * ******************************************* */ +void ex_halbtc8723b1ant_power_on_setting(IN struct btc_coexist *btcoexist); +void ex_halbtc8723b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist); +void ex_halbtc8723b1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only); +void ex_halbtc8723b1ant_init_coex_dm(IN struct btc_coexist *btcoexist); +void ex_halbtc8723b1ant_ips_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_lps_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8723b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8723b1ant_halt_notify(IN struct btc_coexist *btcoexist); +void ex_halbtc8723b1ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state); +void ex_halbtc8723b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); +void ex_halbtc8723b1ant_periodical(IN struct btc_coexist *btcoexist); +void ex_halbtc8723b1ant_display_coex_info(IN struct btc_coexist *btcoexist); +void ex_halbtc8723b1ant_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); + +void ex_halbtc8723b1ant_display_ant_detection(IN struct btc_coexist *btcoexist); + +#else +#define ex_halbtc8723b1ant_power_on_setting(btcoexist) +#define ex_halbtc8723b1ant_pre_load_firmware(btcoexist) +#define ex_halbtc8723b1ant_init_hw_config(btcoexist, wifi_only) +#define ex_halbtc8723b1ant_init_coex_dm(btcoexist) +#define ex_halbtc8723b1ant_ips_notify(btcoexist, type) +#define ex_halbtc8723b1ant_lps_notify(btcoexist, type) +#define ex_halbtc8723b1ant_scan_notify(btcoexist, type) +#define ex_halbtc8723b1ant_set_antenna_notify(btcoexist, type) +#define ex_halbtc8723b1ant_connect_notify(btcoexist, type) +#define ex_halbtc8723b1ant_media_status_notify(btcoexist, type) +#define ex_halbtc8723b1ant_specific_packet_notify(btcoexist, type) +#define ex_halbtc8723b1ant_bt_info_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8723b1ant_rf_status_notify(btcoexist, type) +#define ex_halbtc8723b1ant_halt_notify(btcoexist) +#define ex_halbtc8723b1ant_pnp_notify(btcoexist, pnp_state) +#define ex_halbtc8723b1ant_coex_dm_reset(btcoexist) +#define ex_halbtc8723b1ant_periodical(btcoexist) +#define ex_halbtc8723b1ant_display_coex_info(btcoexist) +#define ex_halbtc8723b1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) +#define ex_halbtc8723b1ant_display_ant_detection(btcoexist) + +#endif + +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b2ant.c similarity index 91% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b2Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b2ant.c index 2c34f678a807..066dafb5ac0f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b2Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b2ant.c @@ -1,4920 +1,4989 @@ -/* ************************************************************ - * Description: - * - * This file is for RTL8723B Co-exist mechanism - * - * History - * 2012/11/15 Cosa first check in. - * - * ************************************************************ */ - -/* ************************************************************ - * include files - * ************************************************************ */ -#include "Mp_Precomp.h" - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8723B_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8723b_2ant glcoex_dm_8723b_2ant; -static struct coex_dm_8723b_2ant *coex_dm = &glcoex_dm_8723b_2ant; -static struct coex_sta_8723b_2ant glcoex_sta_8723b_2ant; -static struct coex_sta_8723b_2ant *coex_sta = &glcoex_sta_8723b_2ant; - -const char *const glbt_info_src_8723b_2ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8723b_2ant = 20151223; -u32 glcoex_ver_8723b_2ant = 0x4a; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8723b2ant_ - * ************************************************************ */ -u8 halbtc8723b2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, - u8 rssi_thresh, u8 rssi_thresh1) -{ - s32 bt_rssi = 0; - u8 bt_rssi_state = *ppre_bt_rssi_state; - - bt_rssi = coex_sta->bt_rssi; - - if (level_num == 2) { - if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Rssi thresh error!!\n"); - BTC_TRACE(trace_buf); - return *ppre_bt_rssi_state; - } - - if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || - (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { - if (bt_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (bt_rssi < rssi_thresh1) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - *ppre_bt_rssi_state = bt_rssi_state; - - return bt_rssi_state; -} - -u8 halbtc8723b2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, - IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, - IN u8 rssi_thresh1) -{ - s32 wifi_rssi = 0; - u8 wifi_rssi_state = *pprewifi_rssi_state; - - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - - if (level_num == 2) { - if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || - (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi RSSI thresh error!!\n"); - BTC_TRACE(trace_buf); - return *pprewifi_rssi_state; - } - - if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || - (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || - (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { - if (wifi_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (wifi_rssi < rssi_thresh1) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - *pprewifi_rssi_state = wifi_rssi_state; - - return wifi_rssi_state; -} - -void halbtc8723b2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -{ - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - - /* This function check if bt is disabled */ - - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - } else { - bt_disable_cnt++; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], bt all counters=0, %d times!!\n", - bt_disable_cnt); - BTC_TRACE(trace_buf); - if (bt_disable_cnt >= 2) - bt_disabled = true; - } - if (coex_sta->bt_disabled != bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); - BTC_TRACE(trace_buf); - - coex_sta->bt_disabled = bt_disabled; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - if (bt_disabled) { - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - } - } -} - - -void halbtc8723b2ant_limited_rx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean rej_ap_agg_pkt, - IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -{ - boolean reject_rx_agg = rej_ap_agg_pkt; - boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; - u8 rx_agg_size = agg_buf_size; - - /* ============================================ */ - /* Rx Aggregation related setting */ - /* ============================================ */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, - &reject_rx_agg); - /* decide BT control aggregation buf size or not */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, - &bt_ctrl_rx_agg_size); - /* aggregation buf size, only work when BT control Rx aggregation size. */ - btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); - /* real update aggregation setting */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); -} - -void halbtc8723b2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -{ - u32 reg_hp_txrx, reg_lp_txrx, u32tmp; - u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - reg_hp_txrx = 0x770; - reg_lp_txrx = 0x774; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); - reg_hp_tx = u32tmp & MASKLWORD; - reg_hp_rx = (u32tmp & MASKHWORD) >> 16; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); - reg_lp_tx = u32tmp & MASKLWORD; - reg_lp_rx = (u32tmp & MASKHWORD) >> 16; - - coex_sta->high_priority_tx = reg_hp_tx; - coex_sta->high_priority_rx = reg_hp_rx; - coex_sta->low_priority_tx = reg_lp_tx; - coex_sta->low_priority_rx = reg_lp_rx; - - if ((coex_sta->low_priority_tx > 1050) && - (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->pop_event_cnt++; - - if ((coex_sta->low_priority_rx >= 950) && - (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) && - (!coex_sta->under_ips)) - bt_link_info->slave_role = true; - else - bt_link_info->slave_role = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); - BTC_TRACE(trace_buf); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", - reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); - BTC_TRACE(trace_buf); - - /* reset counter */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); -} - -void halbtc8723b2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -{ - - - if (coex_sta->under_ips) { - coex_sta->crc_ok_cck = 0; - coex_sta->crc_ok_11g = 0; - coex_sta->crc_ok_11n = 0; - coex_sta->crc_ok_11n_agg = 0; - - coex_sta->crc_err_cck = 0; - coex_sta->crc_err_11g = 0; - coex_sta->crc_err_11n = 0; - coex_sta->crc_err_11n_agg = 0; - } else { - coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf88); - coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf94); - coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf90); - coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfb8); - - coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf84); - coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf96); - coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf92); - coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfba); - } - - /* reset counter */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -} - -void halbtc8723b2ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - coex_sta->c2h_bt_info_req_sent = true; - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); -} - -boolean halbtc8723b2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) -{ - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false; - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; - u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - if (wifi_connected) { - if (wifi_busy != pre_wifi_busy) { - pre_wifi_busy = wifi_busy; - return true; - } - if (under_4way != pre_under_4way) { - pre_under_4way = under_4way; - return true; - } - if (bt_hs_on != pre_bt_hs_on) { - pre_bt_hs_on = bt_hs_on; - return true; - } - - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || - (BTC_RSSI_STATE_LOW == wifi_rssi_state)) - return true; - - } - - return false; -} - -void halbtc8723b2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - bt_link_info->bt_link_exist = coex_sta->bt_link_exist; - bt_link_info->sco_exist = coex_sta->sco_exist; - bt_link_info->a2dp_exist = coex_sta->a2dp_exist; - bt_link_info->pan_exist = coex_sta->pan_exist; - bt_link_info->hid_exist = coex_sta->hid_exist; - - /* work around for HS mode. */ - if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; - } - - /* check if Sco only */ - if (bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->sco_only = true; - else - bt_link_info->sco_only = false; - - /* check if A2dp only */ - if (!bt_link_info->sco_exist && - bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->a2dp_only = true; - else - bt_link_info->a2dp_only = false; - - /* check if Pan only */ - if (!bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->pan_only = true; - else - bt_link_info->pan_only = false; - - /* check if Hid only */ - if (!bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - bt_link_info->hid_exist) - bt_link_info->hid_only = true; - else - bt_link_info->hid_only = false; -} - -u8 halbtc8723b2ant_action_algorithm(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - u8 algorithm = BT_8723B_2ANT_COEX_ALGO_UNDEFINED; - u8 num_of_diff_profile = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - if (!bt_link_info->bt_link_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], No BT link exists!!!\n"); - BTC_TRACE(trace_buf); - return algorithm; - } - - if (bt_link_info->sco_exist) - num_of_diff_profile++; - if (bt_link_info->hid_exist) - num_of_diff_profile++; - if (bt_link_info->pan_exist) - num_of_diff_profile++; - if (bt_link_info->a2dp_exist) - num_of_diff_profile++; - - if (num_of_diff_profile == 1) { - if (bt_link_info->sco_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; - } else { - if (bt_link_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_HID; - } else if (bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], A2DP only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP; - } else if (bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(HS) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR; - } - } - } - } else if (num_of_diff_profile == 2) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } else if (bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP ==> SCO\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } else if (bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { - { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + A2DP\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_HID_A2DP; - } - } else if (bt_link_info->hid_exist && - bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } - } else if (bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP; - } - } - } - } else if (num_of_diff_profile == 3) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + A2DP ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } else if (bt_link_info->hid_exist && - bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } - } else if (bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], HID + A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; - } - } - } - } else if (num_of_diff_profile >= 3) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist && - bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8723b2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, - IN u8 dac_swing_lvl) -{ - u8 h2c_parameter[1] = {0}; - - /* There are several type of dacswing */ - /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ - h2c_parameter[0] = dac_swing_lvl; - - btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); -} - -void halbtc8723b2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, - IN u8 dec_bt_pwr_lvl) -{ - u8 h2c_parameter[1] = {0}; - - h2c_parameter[0] = dec_bt_pwr_lvl; - - btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -} - -void halbtc8723b2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -{ - coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; - - if (!force_exec) { - if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) - return; - } - halbtc8723b2ant_set_fw_dec_bt_pwr(btcoexist, - coex_dm->cur_bt_dec_pwr_lvl); - - coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; -} - -void halbtc8723b2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean enable_auto_report) -{ - u8 h2c_parameter[1] = {0}; - - h2c_parameter[0] = 0; - - if (enable_auto_report) - h2c_parameter[0] |= BIT(0); - - btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -} - -void halbtc8723b2ant_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable_auto_report) -{ - coex_dm->cur_bt_auto_report = enable_auto_report; - - if (!force_exec) { - if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) - return; - } - halbtc8723b2ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8723b2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 fw_dac_swing_lvl) -{ - coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; - - if (!force_exec) { - if (coex_dm->pre_fw_dac_swing_lvl == - coex_dm->cur_fw_dac_swing_lvl) - return; - } - - halbtc8723b2ant_set_fw_dac_swing_level(btcoexist, - coex_dm->cur_fw_dac_swing_lvl); - - coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; -} - -void halbtc8723b2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, - IN boolean rx_rf_shrink_on) -{ - if (rx_rf_shrink_on) { - /* Shrink RF Rx LPF corner */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Shrink RF Rx LPF corner!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, - 0xffffc); - } else { - /* Resume RF Rx LPF corner */ - /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ - if (btcoexist->initilized) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Resume RF Rx LPF corner!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, - 0xfffff, coex_dm->bt_rf_0x1e_backup); - } - } -} - -void halbtc8723b2ant_rf_shrink(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean rx_rf_shrink_on) -{ - coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; - - if (!force_exec) { - if (coex_dm->pre_rf_rx_lpf_shrink == - coex_dm->cur_rf_rx_lpf_shrink) - return; - } - halbtc8723b2ant_set_sw_rf_rx_lpf_corner(btcoexist, - coex_dm->cur_rf_rx_lpf_shrink); - - coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; -} - -void halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ - u8 h2c_parameter[6] = {0}; - - h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ - - if (low_penalty_ra) { - h2c_parameter[1] |= BIT(0); - h2c_parameter[2] = - 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ - h2c_parameter[3] = 0xf4; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xf5; /* MCS6 or OFDM48 */ - h2c_parameter[5] = 0xf6; /* MCS5 or OFDM36 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} - -void halbtc8723b2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean low_penalty_ra) -{ - coex_dm->cur_low_penalty_ra = low_penalty_ra; - - if (!force_exec) { - if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) - return; - } - halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, - coex_dm->cur_low_penalty_ra); - - coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -} - -void halbtc8723b2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, - IN u32 level) -{ - u8 val = (u8)level; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Write SwDacSwing = 0x%x\n", level); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x883, 0x3e, val); -} - -void halbtc8723b2ant_set_sw_full_time_dac_swing(IN struct btc_coexist - *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) -{ - if (sw_dac_swing_on) - halbtc8723b2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); - else - halbtc8723b2ant_set_dac_swing_reg(btcoexist, 0x18); -} - - -void halbtc8723b2ant_dac_swing(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) -{ - coex_dm->cur_dac_swing_on = dac_swing_on; - coex_dm->cur_dac_swing_lvl = dac_swing_lvl; - - if (!force_exec) { - if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && - (coex_dm->pre_dac_swing_lvl == - coex_dm->cur_dac_swing_lvl)) - return; - } - delay_ms(30); - halbtc8723b2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, - dac_swing_lvl); - - coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; - coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; -} - -void halbtc8723b2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, - IN boolean adc_back_off) -{ - if (adc_back_off) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BB BackOff Level On!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x3); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BB BackOff Level Off!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x1); - } -} - -void halbtc8723b2ant_adc_back_off(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean adc_back_off) -{ - coex_dm->cur_adc_back_off = adc_back_off; - - if (!force_exec) { - if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) - return; - } - halbtc8723b2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); - - coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; -} - -void halbtc8723b2ant_set_agc_table(IN struct btc_coexist *btcoexist, - IN boolean agc_table_en) -{ - u8 rssi_adjust_val = 0; - - /* =================BB AGC Gain Table */ - if (agc_table_en) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BB Agc Table On!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6e1A0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6d1B0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6c1C0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6b1D0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6a1E0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x691F0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x68200001); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BB Agc Table Off!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); - btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa4200001); - } - - - /* =================RF Gain */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); - if (agc_table_en) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Agc Table On!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x38fff); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x38ffe); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Agc Table Off!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x380c3); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, - 0x28ce6); - } - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); - if (agc_table_en) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Agc Table On!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, - 0x38fff); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, - 0x38ffe); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Agc Table Off!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, - 0x380c3); - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, - 0x28ce6); - } - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); - - /* set rssi_adjust_val for wifi module. */ - if (agc_table_en) - rssi_adjust_val = 8; - btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, - &rssi_adjust_val); -} - -void halbtc8723b2ant_agc_table(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean agc_table_en) -{ - coex_dm->cur_agc_table_en = agc_table_en; - - if (!force_exec) { - if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) - return; - } - halbtc8723b2ant_set_agc_table(btcoexist, agc_table_en); - - coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; -} - -void halbtc8723b2ant_set_coex_table(IN struct btc_coexist *btcoexist, - IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -{ - btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); - - btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); - - btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); - - btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -} - -void halbtc8723b2ant_coex_table(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, - IN u32 val0x6c8, IN u8 val0x6cc) -{ - coex_dm->cur_val0x6c0 = val0x6c0; - coex_dm->cur_val0x6c4 = val0x6c4; - coex_dm->cur_val0x6c8 = val0x6c8; - coex_dm->cur_val0x6cc = val0x6cc; - - if (!force_exec) { - if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && - (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && - (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && - (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) - return; - } - halbtc8723b2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, - val0x6cc); - - coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; - coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; - coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; - coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -} - -void halbtc8723b2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_sta->coex_table_type = type; - - switch (type) { - case 0: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, 0xffffff, 0x3); - break; - case 1: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5afa5afa, 0xffffff, 0x3); - break; - case 2: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); - break; - case 3: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 4: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0xffffffff, 0xffffffff, 0xffffff, 0x3); - break; - case 5: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); - break; - case 6: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); - break; - case 7: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 8: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 9: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 10: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 11: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 12: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); - break; - case 13: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); - break; - case 14: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); - break; - case 15: - halbtc8723b2ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); - break; - default: - break; - } -} - -void halbtc8723b2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 h2c_parameter[1] = {0}; - - if (enable) { - h2c_parameter[0] |= BIT(0); /* function enable */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -} - -void halbtc8723b2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, - IN u8 lps_val, IN u8 rpwm_val) -{ - u8 lps = lps_val; - u8 rpwm = rpwm_val; - - btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); - btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -} - -void halbtc8723b2ant_lps_rpwm(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -{ - coex_dm->cur_lps = lps_val; - coex_dm->cur_rpwm = rpwm_val; - - if (!force_exec) { - if ((coex_dm->pre_lps == coex_dm->cur_lps) && - (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) - return; - } - halbtc8723b2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); - - coex_dm->pre_lps = coex_dm->cur_lps; - coex_dm->pre_rpwm = coex_dm->cur_rpwm; -} - -void halbtc8723b2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable) -{ - coex_dm->cur_ignore_wlan_act = enable; - - if (!force_exec) { - if (coex_dm->pre_ignore_wlan_act == - coex_dm->cur_ignore_wlan_act) - return; - } - halbtc8723b2ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8723b2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, - IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -{ - u8 h2c_parameter[5] = {0}; - - - if ((coex_sta->a2dp_exist) && (coex_sta->hid_exist)) - byte5 = byte5 | 0x1; - - h2c_parameter[0] = byte1; - h2c_parameter[1] = byte2; - h2c_parameter[2] = byte3; - h2c_parameter[3] = byte4; - h2c_parameter[4] = byte5; - - coex_dm->ps_tdma_para[0] = byte1; - coex_dm->ps_tdma_para[1] = byte2; - coex_dm->ps_tdma_para[2] = byte3; - coex_dm->ps_tdma_para[3] = byte4; - coex_dm->ps_tdma_para[4] = byte5; - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -} - -void halbtc8723b2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, - IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, - IN boolean limited_dig, IN boolean bt_lna_constrain) -{ - /* - u32 wifi_bw; - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if(BTC_WIFI_BW_HT40 != wifi_bw) - { - if (shrink_rx_lpf) - shrink_rx_lpf = false; - } - */ - - /* halbtc8723b2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ - halbtc8723b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -void halbtc8723b2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, - IN boolean agc_table_shift, IN boolean adc_back_off, - IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -{ - /* halbtc8723b2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ - /* halbtc8723b2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ - /* halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, dac_swing_lvl); */ -} - -void halbtc8723b2ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - PADAPTER pAdapter = btcoexist->Adapter; - u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; - boolean pg_ext_switch = false; - boolean use_ext_switch = false; - u8 h2c_parameter[2] = {0}; - u32 u32tmp_1[4]; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, - &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ - - if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) - use_ext_switch = true; - - if (init_hwcfg) { - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); - btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); - btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); - - if (fw_ver >= 0x180000) { - /* Use H2C to set GNT_BT to High to avoid A2DP click */ - h2c_parameter[0] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, - h2c_parameter); - - cnt_bt_cal_chk = 0; - while(1) - { - if( pAdapter->bFWReady == FALSE ) - { - //RT_TRACE(COMP_INIT , DBG_LOUD, ("halbtc8723b2ant_SetAntPath(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); - break; - } - - if( btcoexist->btc_read_1byte(btcoexist, 0x765) == 0x18 ) - break; - - cnt_bt_cal_chk++; - if( cnt_bt_cal_chk > 20 ) - break; - } - } else - btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); - u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); - if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) - btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); - else - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x0); /* WiFi TRx Mask off */ - /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ - /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x01); //BT TRx Mask off */ - - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { - /* tell firmware "no antenna inverse" */ - h2c_parameter[0] = 0; - } else { - /* tell firmware "antenna inverse" */ - h2c_parameter[0] = 1; - } - - if (use_ext_switch) { - /* ext switch type */ - h2c_parameter[1] = 1; - } else { - /* int switch type */ - h2c_parameter[1] = 0; - } - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, h2c_parameter); - } else { - if (fw_ver >= 0x180000) { - /* Use H2C to set GNT_BT to "Control by PTA"*/ - h2c_parameter[0] = 0; - btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, - h2c_parameter); - - cnt_bt_cal_chk = 0; - while(1) - { - if( pAdapter->bFWReady == FALSE ) - { - //RT_TRACE(COMP_INIT , DBG_LOUD, ("halbtc8723b2ant_SetAntPath(): we don't need to wait for H2C command completion because of Fw download fail!!!\n")); - break; - } - - if( btcoexist->btc_read_1byte(btcoexist, 0x765) == 0x0 ) - break; - - cnt_bt_cal_chk++; - if( cnt_bt_cal_chk > 20 ) - break; - } - } else - btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); - } - - /* ext switch setting */ - if (use_ext_switch) { - if (init_hwcfg) { - /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp &= ~BIT(23); - u32tmp |= BIT(24); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - } - u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); - if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) - btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); - else - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); - - switch (ant_pos_type) { - case BTC_ANT_WIFI_AT_MAIN: - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0x92c, 0x3, - 0x1); /* ext switch main at wifi */ - break; - case BTC_ANT_WIFI_AT_AUX: - btcoexist->btc_write_1byte_bitmask(btcoexist, - 0x92c, 0x3, - 0x2); /* ext switch aux at wifi */ - break; - } - } else { /* internal switch */ - if (init_hwcfg) { - /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp |= BIT(23); - u32tmp &= ~BIT(24); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - } - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, - 0x0); /* fixed external switch S1->Main, S0->Aux */ - switch (ant_pos_type) { - case BTC_ANT_WIFI_AT_MAIN: - u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); - if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) - btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); - else - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); - break; - case BTC_ANT_WIFI_AT_AUX: - u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); - if( (u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) - btcoexist->btc_write_4byte(btcoexist, 0x948, u32tmp_1[0]); - else - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x280); - break; - } - } -} -#if 0 -boolean halbtc8723b2ant_CoexSwitchThresCheck(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state1, bt_rssi_state; - u32 vendor; - u8 offset = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); - - /* if (vendor == BTC_VENDOR_LENOVO) */ - /* offset = 20; */ - - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - if (BTC_RSSI_LOW(wifi_rssi_state1) || BTC_RSSI_LOW(bt_rssi_state)) - return true; - - return false; -} -#endif - -void halbtc8723b2ant_ps_tdma(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean turn_on, IN u8 type) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state1, bt_rssi_state; - s8 wifi_duration_adjust = 0x0; - u8 psTdmaByte4Modify = 0x0; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], %s turn %s PS TDMA, type=%d\n", - (force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type); - BTC_TRACE(trace_buf); - coex_dm->cur_ps_tdma_on = turn_on; - coex_dm->cur_ps_tdma = type; - - if (!(BTC_RSSI_HIGH(wifi_rssi_state1) && - BTC_RSSI_HIGH(bt_rssi_state)) && turn_on) - /* if (halbtc8723b2ant_CoexSwitchThresCheck(btcoexist) && turn_on) */ - { - type = type + 100; /* for WiFi RSSI low or BT RSSI low */ - coex_dm->is_switch_to_1dot5_ant = true; - } else - coex_dm->is_switch_to_1dot5_ant = false; - - - if (!force_exec) { - if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && - (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) - return; - } - - if (coex_sta->scan_ap_num <= 5) { - if (coex_sta->a2dp_bit_pool >= 45) - wifi_duration_adjust = -15; - else if (coex_sta->a2dp_bit_pool >= 35) - wifi_duration_adjust = -10; - else - wifi_duration_adjust = 5; - } else if (coex_sta->scan_ap_num <= 20) { - if (coex_sta->a2dp_bit_pool >= 45) - wifi_duration_adjust = -15; - else if (coex_sta->a2dp_bit_pool >= 35) - wifi_duration_adjust = -10; - else - wifi_duration_adjust = 0; - } else if (coex_sta->scan_ap_num <= 40) { - if (coex_sta->a2dp_bit_pool >= 45) - wifi_duration_adjust = -15; - else if (coex_sta->a2dp_bit_pool >= 35) - wifi_duration_adjust = -10; - else - wifi_duration_adjust = -5; - } else { - if (coex_sta->a2dp_bit_pool >= 45) - wifi_duration_adjust = -15; - else if (coex_sta->a2dp_bit_pool >= 35) - wifi_duration_adjust = -10; - else - wifi_duration_adjust = -10; - } - - if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) - psTdmaByte4Modify = - 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ - - - if (turn_on) { - switch (type) { - case 1: - default: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c + wifi_duration_adjust, 0x03, 0xf1, - 0x90 | psTdmaByte4Modify); - break; - case 2: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d + wifi_duration_adjust, 0x03, 0xf1, - 0x90 | psTdmaByte4Modify); - break; - case 3: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xf1, 0x90 | - psTdmaByte4Modify); - break; - case 4: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x03, 0xf1, 0x90 | - psTdmaByte4Modify); - break; - case 5: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c + wifi_duration_adjust, 0x3, 0x70, - 0x90 | psTdmaByte4Modify); - break; - case 6: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d + wifi_duration_adjust, 0x3, 0x70, - 0x90 | psTdmaByte4Modify); - break; - case 7: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0x70, 0x90 | - psTdmaByte4Modify); - break; - case 8: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, - 0x10, 0x3, 0x70, 0x90 | - psTdmaByte4Modify); - break; - case 9: - /* - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c + wifi_duration_adjust, 0x03, 0xf1, - 0x90 | psTdmaByte4Modify); - */ - /* Bryant Modify for BT no-profile busy case */ - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c + wifi_duration_adjust, 0x03, 0xf1, - 0x91); - - break; - case 10: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d + wifi_duration_adjust, 0x03, 0xf1, - 0x90 | psTdmaByte4Modify); - break; - case 11: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xf1, 0x90 | - psTdmaByte4Modify); - break; - case 12: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0xf1, 0x90 | - psTdmaByte4Modify); - break; - case 13: - /* - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c + wifi_duration_adjust, 0x3, 0x70, - 0x90 | psTdmaByte4Modify); - */ - /* Bryant Modify for BT no-profile busy case */ - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c + wifi_duration_adjust, 0x3, 0x70, - 0x91); - break; - case 14: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x2d + wifi_duration_adjust, 0x3, 0x70, - 0x90 | psTdmaByte4Modify); - break; - case 15: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0x70, 0x90 | - psTdmaByte4Modify); - break; - case 16: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0x70, 0x90 | - psTdmaByte4Modify); - break; - case 17: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, - 0x2f, 0x2f, 0x60, 0x90); - break; - case 18: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x5, 0x5, 0xe1, 0x90); - break; - case 19: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x25, 0xe1, 0x90); - break; - case 20: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x25, 0x60, 0x90); - break; - case 21: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x03, 0x70, 0x90); - break; - case 22: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0xf1, 0x90); - break; - case 23: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, 0x10); - break; - - case 33: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xf1, 0x91); - - break; - case 71: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c + wifi_duration_adjust, 0x03, 0xf1, - 0x90); - break; - case 101: - case 105: - case 113: - case 171: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x3a + wifi_duration_adjust, 0x03, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 102: - case 106: - case 110: - case 114: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x2d + wifi_duration_adjust, 0x03, 0x70, - 0x50 | psTdmaByte4Modify); - break; - case 103: - case 107: - case 111: - case 115: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1c, 0x03, 0x70, 0x50 | - psTdmaByte4Modify); - break; - case 104: - case 108: - case 112: - case 116: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x03, 0x70, 0x50 | - psTdmaByte4Modify); - break; - case 109: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0xf1, 0x90 | - psTdmaByte4Modify); - break; - /* case 113: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3c, 0x03, 0x70, 0x90 | - psTdmaByte4Modify); - break; */ - case 121: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x15, 0x03, 0x70, 0x90 | - psTdmaByte4Modify); - break; - case 122: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, 0x11); - break; - case 123: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, 0x10); - break; - case 133: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1c, 0x3, 0x70, 0x51); - - break; - } - } else { - /* disable PS tdma */ - switch (type) { - case 0: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - case 1: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - default: - halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x40, 0x0); - break; - } - } - - /* update pre state */ - coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; - coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -} - -void halbtc8723b2ant_ps_tdma_check_for_power_save_state( - IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -{ - u8 lps_mode = 0x0; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); - - if (lps_mode) { /* already under LPS state */ - if (new_ps_state) { - /* keep state under LPS, do nothing. */ - } else { - /* will leave LPS state, turn off psTdma first */ - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); - } else { - /* keep state under NO PS state, do nothing. */ - } - } -} - -void halbtc8723b2ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -{ - boolean low_pwr_disable = false; - - switch (ps_type) { - case BTC_PS_WIFI_NATIVE: - /* recover to original 32k low power setting */ - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - coex_sta->force_lps_on = false; - break; - case BTC_PS_LPS_ON: - halbtc8723b2ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8723b2ant_lps_rpwm(btcoexist, NORMAL_EXEC, - lps_val, rpwm_val); - /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - /* power save must executed before psTdma. */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, - NULL); - coex_sta->force_lps_on = true; - break; - case BTC_PS_LPS_OFF: - halbtc8723b2ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - coex_sta->force_lps_on = false; - break; - default: - break; - } -} - - -void halbtc8723b2ant_coex_all_off(IN struct btc_coexist *btcoexist) -{ - /* fw all off */ - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - /* hw all off */ - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); - halbtc8723b2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); - - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - coex_sta->pop_event_cnt = 0; - -} - -void halbtc8723b2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - boolean wifi_connected = false; - boolean low_pwr_disable = true; - boolean scan = false, link = false, roam = false; - boolean wifi_busy = false; - - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - if (coex_sta->bt_abnormal_scan) { - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 23); - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - } else if (scan || link || roam) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi link process + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - } else if (wifi_connected) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - if (wifi_busy) - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - else - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - } - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - /* - coex_dm->need_recover0x948 = true; - coex_dm->backup0x948 = btcoexist->btc_read_4byte(btcoexist, 0x948); - - halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_AUX, false, false); - */ -} - - -void halbtc8723b2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) -{ - u32 u32tmp; - u8 u8tmpa, u8tmpb; - - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); - u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); - u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", - u32tmp, u8tmpa, u8tmpb); - BTC_TRACE(trace_buf); -} - -boolean halbtc8723b2ant_action_wifi_idle_process(IN struct btc_coexist - *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u8 ap_num = 0; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - /* wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES-coex_dm->switch_thres_offset-coex_dm->switch_thres_offset, 0); */ - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); - - /* define the office environment */ - if (BTC_RSSI_HIGH(wifi_rssi_state1) && - (coex_sta->hid_exist == true) && - (coex_sta->a2dp_exist == true)) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n"); - BTC_TRACE(trace_buf); - - halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - - return true; - } else { - halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x18); - return false; - } - - -} - - - -boolean halbtc8723b2ant_is_common_action(IN struct btc_coexist *btcoexist) -{ - boolean common = false, wifi_connected = false, wifi_busy = false; - boolean bt_hs_on = false, low_pwr_disable = false; - boolean asus_8723b = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (!wifi_connected) { - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x8); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi non-connected idle!!\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x0); - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, - 0x18); - - common = true; - } else { - if (BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) { - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, - false, false, 0x8); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT non connected-idle!!\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x0); - halbtc8723b2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - - halbtc8723b2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 0xb); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, - false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - - common = true; - } else if (BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status) { - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - if (bt_hs_on) - return false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT connected-idle!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, - false, false, 0x8); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x0); - halbtc8723b2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 0); - - halbtc8723b2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 0xb); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - - common = true; - } else { - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - - if (wifi_busy) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); - BTC_TRACE(trace_buf); - /* btcoexist->btc_get(btcoexist, - BTC_GET_BL_IS_ASUS_8723B, &asus_8723b); - if (!asus_8723b) - common = false; - else - common = halbtc8723b2ant_action_wifi_idle_process( - btcoexist); */ - common = false; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); - BTC_TRACE(trace_buf); - /* common = false; */ - common = halbtc8723b2ant_action_wifi_idle_process( - btcoexist); - } - } - } - - return common; -} -void halbtc8723b2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, - IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) -{ - static s32 up, dn, m, n, wait_count; - s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ - u8 retry_count = 0; - - if (!coex_dm->auto_tdma_adjust) { - coex_dm->auto_tdma_adjust = true; - { - if (sco_hid) { - if (tx_pause) { - if (max_interval == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } else if (max_interval == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (max_interval == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } else { - if (max_interval == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } else if (max_interval == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (max_interval == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } - } - } else { - if (tx_pause) { - if (max_interval == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (max_interval == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (max_interval == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } - } else { - if (max_interval == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (max_interval == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (max_interval == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } - } - } - } - /* ============ */ - up = 0; - dn = 0; - m = 1; - n = 3; - result = 0; - wait_count = 0; - } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ - retry_count = coex_sta->bt_retry_cnt; - - if ((coex_sta->low_priority_tx) > 1050 || - (coex_sta->low_priority_rx) > 1250) - retry_count++; - - result = 0; - wait_count++; - - if (retry_count == - 0) { /* no retry in the last 2-second duration */ - up++; - dn--; - - if (dn <= 0) - dn = 0; - - if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ - wait_count = 0; - n = 3; - up = 0; - dn = 0; - result = 1; - } - } else if (retry_count <= - 3) { /* <=3 retry in the last 2-second duration */ - up--; - dn++; - - if (up <= 0) - up = 0; - - if (dn == 2) {/* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ - if (wait_count <= 2) - m++; /* to avoid loop between the two levels */ - else - m = 1; - - if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ - m = 20; - - n = 3 * m; - up = 0; - dn = 0; - wait_count = 0; - result = -1; - } - } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ - if (wait_count == 1) - m++; /* to avoid loop between the two levels */ - else - m = 1; - - if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ - m = 20; - - n = 3 * m; - up = 0; - dn = 0; - wait_count = 0; - result = -1; - } - - if (max_interval == 1) { - if (tx_pause) { - if (coex_dm->cur_ps_tdma == 71) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 13); - coex_dm->ps_tdma_du_adj_type = 13; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 16); - coex_dm->ps_tdma_du_adj_type = 16; - } - - if (result == -1) { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 16); - coex_dm->ps_tdma_du_adj_type = - 16; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 8) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 5); - coex_dm->ps_tdma_du_adj_type = - 5; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 13); - coex_dm->ps_tdma_du_adj_type = - 13; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 71); - coex_dm->ps_tdma_du_adj_type = 71; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 9); - coex_dm->ps_tdma_du_adj_type = 9; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 12); - coex_dm->ps_tdma_du_adj_type = 12; - } - - if (result == -1) { - if (coex_dm->cur_ps_tdma == 71) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 12); - coex_dm->ps_tdma_du_adj_type = - 12; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 4) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 71); - coex_dm->ps_tdma_du_adj_type = - 71; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 9); - coex_dm->ps_tdma_du_adj_type = - 9; - } - } - } - } else if (max_interval == 2) { - if (tx_pause) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 6); - coex_dm->ps_tdma_du_adj_type = 6; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 14); - coex_dm->ps_tdma_du_adj_type = 14; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 16); - coex_dm->ps_tdma_du_adj_type = 16; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 16); - coex_dm->ps_tdma_du_adj_type = - 16; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 8) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 6); - coex_dm->ps_tdma_du_adj_type = - 6; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 14); - coex_dm->ps_tdma_du_adj_type = - 14; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 2); - coex_dm->ps_tdma_du_adj_type = 2; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 10); - coex_dm->ps_tdma_du_adj_type = 10; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 12); - coex_dm->ps_tdma_du_adj_type = 12; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 12); - coex_dm->ps_tdma_du_adj_type = - 12; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 4) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 2); - coex_dm->ps_tdma_du_adj_type = - 2; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 10); - coex_dm->ps_tdma_du_adj_type = - 10; - } - } - } - } else if (max_interval == 3) { - if (tx_pause) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); - coex_dm->ps_tdma_du_adj_type = 7; - } else if (coex_dm->cur_ps_tdma == 4) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 8); - coex_dm->ps_tdma_du_adj_type = 8; - } - if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 15); - coex_dm->ps_tdma_du_adj_type = 15; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 16); - coex_dm->ps_tdma_du_adj_type = 16; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 8); - coex_dm->ps_tdma_du_adj_type = - 8; - } else if (coex_dm->cur_ps_tdma == 13) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 16); - coex_dm->ps_tdma_du_adj_type = - 16; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 8) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 7); - coex_dm->ps_tdma_du_adj_type = - 7; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 15); - coex_dm->ps_tdma_du_adj_type = - 15; - } - } - } else { - if (coex_dm->cur_ps_tdma == 5) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 6) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 7) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 3); - coex_dm->ps_tdma_du_adj_type = 3; - } else if (coex_dm->cur_ps_tdma == 8) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 4); - coex_dm->ps_tdma_du_adj_type = 4; - } - if (coex_dm->cur_ps_tdma == 13) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 14) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 15) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 11); - coex_dm->ps_tdma_du_adj_type = 11; - } else if (coex_dm->cur_ps_tdma == 16) { - halbtc8723b2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 12); - coex_dm->ps_tdma_du_adj_type = 12; - } - if (result == -1) { - if (coex_dm->cur_ps_tdma == 1) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 4); - coex_dm->ps_tdma_du_adj_type = - 4; - } else if (coex_dm->cur_ps_tdma == 9) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 12); - coex_dm->ps_tdma_du_adj_type = - 12; - } - } else if (result == 1) { - if (coex_dm->cur_ps_tdma == 4) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 3) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 2) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 3); - coex_dm->ps_tdma_du_adj_type = - 3; - } else if (coex_dm->cur_ps_tdma == 12) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 11) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } else if (coex_dm->cur_ps_tdma == 10) { - halbtc8723b2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 11); - coex_dm->ps_tdma_du_adj_type = - 11; - } - } - } - } - } - - /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ - /* then we have to adjust it back to the previous record one. */ - if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { - boolean scan = false, link = false, roam = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", - coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (!scan && !link && !roam) - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - coex_dm->ps_tdma_du_adj_type); - else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); - BTC_TRACE(trace_buf); - } - } -} - -/* SCO only or SCO+PAN(HS) */ -void halbtc8723b2ant_action_sco(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for SCO quality at 11b/g mode */ - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - else /* for SCO quality & wifi performance balance at 11n mode */ - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); /* for voice quality */ - - /* sw mechanism */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - true, 0x4); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - true, 0x4); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - true, 0x4); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - true, 0x4); - } - } -} - - -void halbtc8723b2ant_action_hid(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - else /* for HID quality & wifi performance balance at 11n mode */ - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 9); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); - else - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - - /* sw mechanism */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -void halbtc8723b2ant_action_a2dp(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - u8 ap_num = 0; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); - - /* define the office environment */ - if ((ap_num >= 10) && BTC_RSSI_HIGH(wifi_rssi_state1) && - BTC_RSSI_HIGH(bt_rssi_state)) { - /* dbg_print(" AP#>10(%d)\n", ap_num); */ - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x0); - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x8); - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - true, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - true, 0x18); - } - return; - - } - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - } else { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 13); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } - - - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, false, - 1); - else - halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 1); - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8723b2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - } else { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 13); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } - - halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 2); - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8723b2ant_action_pan_edr(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 10); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - } else { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 13); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } - - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); - else - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - - /* sw mechanism */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - - -/* PAN(HS) only */ -void halbtc8723b2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* PAN(EDR)+A2DP */ -void halbtc8723b2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u8 ap_num = 0; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - else - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &ap_num); - - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 12); - - if(ap_num < 10) - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 1); - else - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 3); - - } else { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 13); - if(ap_num < 10) - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 1); - else - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); - } - - /* sw mechanism */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8723b2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - } else { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 14); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } - - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (BTC_WIFI_BW_HT40 == wifi_bw) { - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 3); - /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x780); - } else { - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, - 6); - /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, - 0xfffff, 0x0); - } - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 2); - } else { - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x0); - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 2); - } - - /* sw mechanism */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -/* HID+A2DP+PAN(EDR) */ -void halbtc8723b2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - } else { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 14); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || - (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, - true, 3); - else - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, - false, 3); - } else - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); - - /* sw mechanism */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8723b2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, - prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; - u32 wifi_bw; - u8 ap_num = 0; - - wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, 15, 0); - /* bt_rssi_state = halbtc8723b2ant_bt_rssi_state(2, 29, 0); */ - wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state1, 2, - BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 0); - bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 3, - BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - - coex_dm->switch_thres_offset, 37); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &ap_num); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - - halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x5); - - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_LEGACY == wifi_bw) { - if (BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - } else { - /* only 802.11N mode we have to dec bt power to 4 degree */ - if (BTC_RSSI_HIGH(bt_rssi_state)) { - /* need to check ap Number of Not */ - if (ap_num < 10) - halbtc8723b2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, 4); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, - NORMAL_EXEC, 2); - } else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - } - - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - } else { - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 14); - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } - - if(BTC_RSSI_HIGH(bt_rssi_state)) { - if(ap_num < 10) - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 1); - else - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 3); - } else { - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 18); - btcoexist->btc_write_1byte(btcoexist, 0x456, 0x38); - btcoexist->btc_write_2byte(btcoexist, 0x42a, 0x0808); - btcoexist->btc_write_4byte(btcoexist, 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, 0x434, 0x01010000); - - if(ap_num < 10) - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 1); - else - halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); - } - - /* sw mechanism */ - if (BTC_WIFI_BW_HT40 == wifi_bw) { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } else { - if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || - (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, - false, 0x18); - } else { - halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - } -} - -void halbtc8723b2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -{ - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8723b2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - /* hw all off */ - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ - halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8723b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); -} - -void halbtc8723b2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - u32 num_of_wifi_link = 0; - u32 wifi_link_status = 0; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean miracast_plus_bt = false; - boolean scan = false, link = false, roam = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism()===>\n"); - BTC_TRACE(trace_buf); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (coex_sta->under_ips) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is under IPS !!!\n"); - BTC_TRACE(trace_buf); - return; - } - - if (coex_sta->bt_whck_test) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under WHCK TEST!!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_bt_whck_test(btcoexist); - return; - } - - algorithm = halbtc8723b2ant_action_algorithm(btcoexist); - if (coex_sta->c2h_bt_inquiry_page && - (BT_8723B_2ANT_COEX_ALGO_PANHS != algorithm)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under inquiry/page scan !!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_bt_inquiry(btcoexist); - return; - } else { - /* - if(coex_dm->need_recover0x948) - { - coex_dm->need_recover0x948 = false; - btcoexist->btc_write_4byte(btcoexist, 0x948, coex_dm->backup0x948); - } - */ - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || link || roam) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under Link Process !!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_wifi_link_process(btcoexist); - return; - } - - /* for P2P */ - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status >> 16; - - if ((num_of_wifi_link >= 2) || - (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", - num_of_wifi_link, wifi_link_status); - BTC_TRACE(trace_buf); - - if (bt_link_info->bt_link_exist) - miracast_plus_bt = true; - else - miracast_plus_bt = false; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - halbtc8723b2ant_action_wifi_multi_port(btcoexist); - - return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - } - - coex_dm->cur_algorithm = algorithm; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", - coex_dm->cur_algorithm); - BTC_TRACE(trace_buf); - - if (halbtc8723b2ant_is_common_action(btcoexist)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant common.\n"); - BTC_TRACE(trace_buf); - coex_dm->auto_tdma_adjust = false; - } else { - if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", - coex_dm->pre_algorithm, coex_dm->cur_algorithm); - BTC_TRACE(trace_buf); - coex_dm->auto_tdma_adjust = false; - } - switch (coex_dm->cur_algorithm) { - case BT_8723B_2ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_sco(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_hid(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_a2dp(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_a2dp_pan_hs(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_pan_edr(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_pan_hs(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_pan_edr_a2dp(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_pan_edr_hid(btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8723B_2ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_action_hid_a2dp(btcoexist); - break; - default: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_coex_all_off(btcoexist); - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - -void halbtc8723b2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) -{ - boolean is_in_mp_mode = false; - u8 h2c_parameter[2] = {0}; - u32 fw_ver = 0; - - /* set wlan_act to low */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, - 0x780); /* WiFi goto standby while GNT_BT 0-->1 */ - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); - if (fw_ver >= 0x180000) { - /* Use H2C to set GNT_BT to HIGH */ - h2c_parameter[0] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, h2c_parameter); - } else - btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, - &is_in_mp_mode); - if (!is_in_mp_mode) - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, - 0x0); /* BT select s0/s1 is controlled by BT */ - else - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, - 0x1); /* BT select s0/s1 is controlled by WiFi */ -} - -void halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up) -{ - u8 u8tmp = 0; - u32 vendor; - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 2Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); - if (vendor == BTC_VENDOR_LENOVO) - coex_dm->switch_thres_offset = 0; - else if (vendor == BTC_VENDOR_ASUS) - coex_dm->switch_thres_offset = 0; - else - coex_dm->switch_thres_offset = 20; - - /* 0xf0[15:12] --> Chip Cut information */ - coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, - 0xf1) & 0xf0) >> 4; - - /* backup rf 0x1e value */ - coex_dm->bt_rf_0x1e_backup = - btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff); - - /* 0x790[5:0]=0x5 */ - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); - u8tmp &= 0xc0; - u8tmp |= 0x5; - btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); - - /* Antenna config */ - halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, - false); - coex_sta->dis_ver_info_cnt = 0; - - /* PTA parameter */ - halbtc8723b2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - /* Enable counter statistics */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, - 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); -} - -/* ************************************************************ - * work around function start with wa_halbtc8723b2ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8723b2ant_ - * ************************************************************ */ -void ex_halbtc8723b2ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u16 u16tmp = 0x0; - u32 value = 0; - u32 u32tmp_1[4]; - - btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); - - /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ - u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); - btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); - DbgPrint("--- TEST 5 ---\n"); - - btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); - - if (btcoexist->chip_interface == BTC_INTF_USB) { - /* fixed at S0 for USB interface */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; - } else { - /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ - if (board_info->single_ant_path == 0) { - /* set to S1 */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; - } else if (board_info->single_ant_path == 1) { - /* set to S0 */ - board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; - } - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, - &value); - } -} - -void ex_halbtc8723b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ - - /* */ - /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ - /* Local setting bit define */ - /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ - /* BIT1: "0" for internal switch; "1" for external switch */ - /* BIT2: "0" for one antenna; "1" for two antenna */ - /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ - if (btcoexist->chip_interface == BTC_INTF_USB) { - /* fixed at S0 for USB interface */ - u8tmp |= 0x1; /* antenna inverse */ - btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); - } else { - /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ - if (board_info->single_ant_path == 0) { - } else if (board_info->single_ant_path == 1) { - /* set to S0 */ - u8tmp |= 0x1; /* antenna inverse */ - } - - if (btcoexist->chip_interface == BTC_INTF_PCI) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, - u8tmp); - else if (btcoexist->chip_interface == BTC_INTF_SDIO) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, - u8tmp); - } -} - -void ex_halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8723b2ant_init_hw_config(btcoexist, true); -} - -void ex_halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Coex Mechanism Init!!\n"); - BTC_TRACE(trace_buf); - - halbtc8723b2ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - u8 *cli_buf = btcoexist->cli_buf; - u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; - u32 u32tmp[4]; - u32 fa_of_dm, fa_cck; - u32 fw_ver = 0, bt_patch_ver = 0; - static u8 pop_report_in_10s = 0; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cli_buf); - - if (btcoexist->manual_control) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Under Manual Control]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", - "Ant PG number/ Ant mechanism:", - board_info->pg_ant_num, board_info->btdm_ant_num); - CL_PRINTF(cli_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", - "Version Coex/ Fw/ Patch/ Cut", - glcoex_ver_date_8723b_2ant, glcoex_ver_8723b_2ant, fw_ver, - bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", - "Wifi channel informed to BT", - coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], - coex_dm->wifi_chnl_info[2]); - CL_PRINTF(cli_buf); - - /* wifi status */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Wifi Status]============"); - CL_PRINTF(cli_buf); - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[BT Status]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "BT Abnormal scan", - (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); - CL_PRINTF(cli_buf); - - pop_report_in_10s++; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", - "BT [status/ rssi/ retryCnt/ popCnt]", - ((coex_sta->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") - : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, - coex_sta->pop_event_cnt); - CL_PRINTF(cli_buf); - - if (pop_report_in_10s >= 5) { - coex_sta->pop_event_cnt = 0; - pop_report_in_10s = 0; - } - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d / %d / %d", - "SCO/HID/PAN/A2DP/NameReq/WHQL", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist, - coex_sta->c2h_bt_remote_name_req, - coex_sta->bt_whck_test); - CL_PRINTF(cli_buf); - - { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "BT Role", - (bt_link_info->slave_role) ? "Slave" : "Master"); - CL_PRINTF(cli_buf); - } - - bt_info_ext = coex_sta->bt_info_ext; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", - "A2DP Rate/Bitpool", - (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); - CL_PRINTF(cli_buf); - - for (i = 0; i < BT_INFO_SRC_8723B_2ANT_MAX; i++) { - if (coex_sta->bt_info_c2h_cnt[i]) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", - glbt_info_src_8723b_2ant[i], - coex_sta->bt_info_c2h[i][0], - coex_sta->bt_info_c2h[i][1], - coex_sta->bt_info_c2h[i][2], - coex_sta->bt_info_c2h[i][3], - coex_sta->bt_info_c2h[i][4], - coex_sta->bt_info_c2h[i][5], - coex_sta->bt_info_c2h[i][6], - coex_sta->bt_info_c2h_cnt[i]); - CL_PRINTF(cli_buf); - } - } - - /* Sw mechanism */ - if (btcoexist->manual_control) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Sw mechanism] (before Manual)============"); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Sw mechanism]============"); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", - "SM1[ShRf/ LpRA/ LimDig]", - coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, - coex_dm->limited_dig); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", - "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", - coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, - coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); - CL_PRINTF(cli_buf); - - /* Fw mechanism */ - if (btcoexist->manual_control) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Fw mechanism] (before Manual) ============"); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Fw mechanism]============"); - - ps_tdma_case = coex_dm->cur_ps_tdma; - - if (coex_dm->is_switch_to_1dot5_ant) - ps_tdma_case = ps_tdma_case + 100; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", - "PS TDMA", - coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], - coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], - coex_dm->ps_tdma_para[4], ps_tdma_case, - (coex_dm->cur_ps_tdma_on ? "On" : "Off"), - (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Coex Table Type", - coex_sta->coex_table_type); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", - "DecBtPwr/ IgnWlanAct", - coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); - CL_PRINTF(cli_buf); - - /* Hw setting */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Hw setting]============"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", - "RF-A, 0x1e initVal", - coex_dm->bt_rf_0x1e_backup); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x778/0x880[29:25]", - u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); - CL_PRINTF(cli_buf); - - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x765); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x948/ 0x67[5] / 0x765", - u32tmp[0], ((u8tmp[0] & 0x20) >> 5), u8tmp[1]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", - u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); - CL_PRINTF(cli_buf); - - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x38[11]/0x40/0x4c[24:23]/0x64[0]", - ((u8tmp[0] & 0x8) >> 3), u8tmp[1], - ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x550(bcn ctrl)/0x522", - u32tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0xc50(dig)/0x49c(null-drop)", - u32tmp[0] & 0xff, u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); - u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - - fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) - >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ - ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & - 0xffff) ; - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "OFDM-CCA/OFDM-FA/CCK-FA", - u32tmp[0] & 0xffff, fa_of_dm, fa_cck); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11n-Agg", - coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_Err CCK/11g/11n/11n-Agg", - coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", - u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770(high-pri rx/tx)", - coex_sta->high_priority_rx, coex_sta->high_priority_tx); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri rx/tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); -#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 1) - /* halbtc8723b2ant_monitor_bt_ctr(btcoexist); */ -#endif - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8723b2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - if (BTC_IPS_ENTER == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS ENTER notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); - halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - halbtc8723b2ant_coex_all_off(btcoexist); - } else if (BTC_IPS_LEAVE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = false; - halbtc8723b2ant_init_hw_config(btcoexist, false); - halbtc8723b2ant_init_coex_dm(btcoexist); - halbtc8723b2ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8723b2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - if (BTC_LPS_ENABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS ENABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = true; - } else if (BTC_LPS_DISABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS DISABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = false; - } -} - -void ex_halbtc8723b2ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u32 u32tmp; - u8 u8tmpa, u8tmpb; - - - - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); - u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); - u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); - - if (BTC_SCAN_START == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN START notify\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); - } else if (BTC_SCAN_FINISH == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &coex_sta->scan_ap_num); - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", - u32tmp, u8tmpa, u8tmpb); - BTC_TRACE(trace_buf); -} - -void ex_halbtc8723b2ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - if (BTC_ASSOCIATE_START == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT START notify\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); - } else if (BTC_ASSOCIATE_FINISH == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT FINISH notify\n"); - BTC_TRACE(trace_buf); - } -} - -void ex_halbtc8723b2ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_parameter[3] = {0}; - u32 wifi_bw; - u8 wifi_central_chnl; - u8 ap_num = 0; - - if (BTC_MEDIA_CONNECT == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA connect notify\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, FALSE, FALSE); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA disconnect notify\n"); - BTC_TRACE(trace_buf); - } - - /* only 2.4G we need to inform bt the chnl mask */ - btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, - &wifi_central_chnl); - if ((BTC_MEDIA_CONNECT == type) && - (wifi_central_chnl <= 14)) { - h2c_parameter[0] = 0x1; - h2c_parameter[1] = wifi_central_chnl; - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) - h2c_parameter[2] = 0x30; - else { - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &ap_num); - if (ap_num < 10) - h2c_parameter[2] = 0x30; - else - h2c_parameter[2] = 0x20; - } - } - - coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; - coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; - coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); -} - -void ex_halbtc8723b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - if (type == BTC_PACKET_DHCP) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], DHCP Packet notify\n"); - BTC_TRACE(trace_buf); - } -} - -void ex_halbtc8723b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length) -{ - u8 bt_info = 0; - u8 i, rsp_source = 0; - boolean bt_busy = false, limited_dig = false; - boolean wifi_connected = false; - - coex_sta->c2h_bt_info_req_sent = false; - - rsp_source = tmp_buf[0] & 0xf; - if (rsp_source >= BT_INFO_SRC_8723B_2ANT_MAX) - rsp_source = BT_INFO_SRC_8723B_2ANT_WIFI_FW; - coex_sta->bt_info_c2h_cnt[rsp_source]++; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, - length); - BTC_TRACE(trace_buf); - for (i = 0; i < length; i++) { - coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; - if (i == 1) - bt_info = tmp_buf[i]; - if (i == length - 1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } - } - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n"); - BTC_TRACE(trace_buf); - return; - } - - /* if 0xff, it means BT is under WHCK test */ - if (bt_info == 0xff) - coex_sta->bt_whck_test = true; - else - coex_sta->bt_whck_test = false; - - if (BT_INFO_SRC_8723B_2ANT_WIFI_FW != rsp_source) { - coex_sta->bt_retry_cnt = /* [3:0] */ - coex_sta->bt_info_c2h[rsp_source][2] & 0xf; - - if (coex_sta->bt_retry_cnt >= 1) - coex_sta->pop_event_cnt++; - - coex_sta->bt_rssi = - coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; - - coex_sta->bt_info_ext = - coex_sta->bt_info_c2h[rsp_source][4]; - - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) - coex_sta->c2h_bt_remote_name_req = true; - else - coex_sta->c2h_bt_remote_name_req = false; - - if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) { - coex_sta->a2dp_bit_pool = - coex_sta->bt_info_c2h[rsp_source][6]; - } else - coex_sta->a2dp_bit_pool = 0; - - coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] - & 0x40); - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, - &coex_sta->bt_tx_rx_mask); - if (coex_sta->bt_tx_rx_mask) { - /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, - 0x3c, 0x01); - } - - /* Here we need to resend some wifi info to BT */ - /* because bt is reset and loss of the info. */ - if ((coex_sta->bt_info_ext & BIT(1))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - if (wifi_connected) - ex_halbtc8723b2ant_media_status_notify( - btcoexist, BTC_MEDIA_CONNECT); - else - ex_halbtc8723b2ant_media_status_notify( - btcoexist, BTC_MEDIA_DISCONNECT); - } - - if ((coex_sta->bt_info_ext & BIT(3))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, - false); - } else { - /* BT already NOT ignore Wlan active, do nothing here. */ - } -#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) - if ((coex_sta->bt_info_ext & BIT(4))) { - /* BT auto report already enabled, do nothing */ - } else - halbtc8723b2ant_bt_auto_report(btcoexist, FORCE_EXEC, - true); -#endif - } - - /* check BIT2 first ==> check if bt is under inquiry or page scan */ - if (bt_info & BT_INFO_8723B_2ANT_B_INQ_PAGE) - coex_sta->c2h_bt_inquiry_page = true; - else - coex_sta->c2h_bt_inquiry_page = false; - - /* set link exist status */ - if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (bt_info & BT_INFO_8723B_2ANT_B_FTP) - coex_sta->pan_exist = true; - else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8723B_2ANT_B_A2DP) - coex_sta->a2dp_exist = true; - else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8723B_2ANT_B_HID) - coex_sta->hid_exist = true; - else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) - coex_sta->sco_exist = true; - else - coex_sta->sco_exist = false; - - if ((coex_sta->hid_exist == false) && - (coex_sta->c2h_bt_inquiry_page == false) && - (coex_sta->sco_exist == false)) { - if (coex_sta->high_priority_tx + - coex_sta->high_priority_rx >= 160) { - coex_sta->hid_exist = true; - bt_info = bt_info | 0x28; - } - } - } - - halbtc8723b2ant_update_bt_link_info(btcoexist); - - if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info == - BT_INFO_8723B_2ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); - BTC_TRACE(trace_buf); - } else if ((bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8723B_2ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_SCO_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info & BT_INFO_8723B_2ANT_B_ACL_BUSY) { - coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_ACL_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); - BTC_TRACE(trace_buf); - } else { - coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_MAX; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); - BTC_TRACE(trace_buf); - } - - if ((BT_8723B_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8723B_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { - bt_busy = true; - limited_dig = true; - } else { - bt_busy = false; - limited_dig = false; - } - - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - coex_dm->limited_dig = limited_dig; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); - - halbtc8723b2ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8723b2ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); - /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ - /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 */ - halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8723b2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); -} - -void ex_halbtc8723b2ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_WIFI_PNP_SLEEP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to SLEEP\n"); - BTC_TRACE(trace_buf); - - /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ - /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ - /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ - coex_sta->under_ips = false; - coex_sta->under_lps = false; - } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to WAKE UP\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_init_hw_config(btcoexist, false); - halbtc8723b2ant_init_coex_dm(btcoexist); - halbtc8723b2ant_query_bt_info(btcoexist); - } -} - -void ex_halbtc8723b2ant_periodical(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ==========================Periodical===========================\n"); - BTC_TRACE(trace_buf); - if (coex_sta->dis_ver_info_cnt <= 5) { - coex_sta->dis_ver_info_cnt += 1; - if (coex_sta->dis_ver_info_cnt == 3) { - /* Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial */ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Set GNT_BT control by PTA\n"); - BTC_TRACE(trace_buf); - halbtc8723b2ant_set_ant_path(btcoexist, - BTC_ANT_WIFI_AT_MAIN, false, false); - } - } - -#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) - halbtc8723b2ant_query_bt_info(btcoexist); - halbtc8723b2ant_monitor_bt_enable_disable(btcoexist); -#else - halbtc8723b2ant_monitor_bt_ctr(btcoexist); - halbtc8723b2ant_monitor_wifi_ctr(btcoexist); - - /* for some BT speaker that Hi-Pri pkt appear begore start play, this will cause HID exist */ - if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && - (bt_link_info->hid_exist == true)) - bt_link_info->hid_exist = false; - - if (halbtc8723b2ant_is_wifi_status_changed(btcoexist) || - coex_dm->auto_tdma_adjust) - halbtc8723b2ant_run_coexist_mechanism(btcoexist); -#endif -} - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * Description: + * + * This file is for RTL8723B Co-exist mechanism + * + * History + * 2012/11/15 Cosa first check in. + * + * ************************************************************ */ + +/* ************************************************************ + * include files + * ************************************************************ */ +#include "mp_precomp.h" + +#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + +#if (RTL8723B_SUPPORT == 1) +/* ************************************************************ + * Global variables, these are static variables + * ************************************************************ */ +static u8 *trace_buf = &gl_btc_trace_buf[0]; +static struct coex_dm_8723b_2ant glcoex_dm_8723b_2ant; +static struct coex_dm_8723b_2ant *coex_dm = &glcoex_dm_8723b_2ant; +static struct coex_sta_8723b_2ant glcoex_sta_8723b_2ant; +static struct coex_sta_8723b_2ant *coex_sta = &glcoex_sta_8723b_2ant; + +const char *const glbt_info_src_8723b_2ant[] = { + "BT Info[wifi fw]", + "BT Info[bt rsp]", + "BT Info[bt auto report]", +}; + +u32 glcoex_ver_date_8723b_2ant = 20170517; +u32 glcoex_ver_8723b_2ant = 0x4d; +u32 glcoex_ver_btdesired_8723b_2ant = 0x4d; + +/* ************************************************************ + * local function proto type if needed + * ************************************************************ + * ************************************************************ + * local function start with halbtc8723b2ant_ + * ************************************************************ */ +u8 halbtc8723b2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, + u8 rssi_thresh, u8 rssi_thresh1) +{ + s32 bt_rssi = 0; + u8 bt_rssi_state = *ppre_bt_rssi_state; + + bt_rssi = coex_sta->bt_rssi; + + if (level_num == 2) { + if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Rssi thresh error!!\n"); + BTC_TRACE(trace_buf); + return *ppre_bt_rssi_state; + } + + if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || + (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { + if (bt_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (bt_rssi < rssi_thresh1) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + *ppre_bt_rssi_state = bt_rssi_state; + + return bt_rssi_state; +} + +u8 halbtc8723b2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, + IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, + IN u8 rssi_thresh1) +{ + s32 wifi_rssi = 0; + u8 wifi_rssi_state = *pprewifi_rssi_state; + + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + + if (level_num == 2) { + if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || + (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi RSSI thresh error!!\n"); + BTC_TRACE(trace_buf); + return *pprewifi_rssi_state; + } + + if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || + (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || + (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { + if (wifi_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8723B_2ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (wifi_rssi < rssi_thresh1) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + *pprewifi_rssi_state = wifi_rssi_state; + + return wifi_rssi_state; +} + +void halbtc8723b2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) +{ + static u32 bt_disable_cnt = 0; + boolean bt_active = true, bt_disabled = false; + + /* This function check if bt is disabled */ + + if (coex_sta->high_priority_tx == 0 && + coex_sta->high_priority_rx == 0 && + coex_sta->low_priority_tx == 0 && + coex_sta->low_priority_rx == 0) + bt_active = false; + if (coex_sta->high_priority_tx == 0xffff && + coex_sta->high_priority_rx == 0xffff && + coex_sta->low_priority_tx == 0xffff && + coex_sta->low_priority_rx == 0xffff) + bt_active = false; + if (bt_active) { + bt_disable_cnt = 0; + bt_disabled = false; + } else { + bt_disable_cnt++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], bt all counters=0, %d times!!\n", + bt_disable_cnt); + BTC_TRACE(trace_buf); + if (bt_disable_cnt >= 10) + bt_disabled = true; + } + if (coex_sta->bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->bt_disabled ? "disabled" : "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + + coex_sta->bt_disabled = bt_disabled; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + if (bt_disabled) { + btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + NULL); + } + } +} + + +void halbtc8723b2ant_limited_rx(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean rej_ap_agg_pkt, + IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) +{ + boolean reject_rx_agg = rej_ap_agg_pkt; + boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; + u8 rx_agg_size = agg_buf_size; + + /* ============================================ */ + /* Rx Aggregation related setting */ + /* ============================================ */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, + &reject_rx_agg); + /* decide BT control aggregation buf size or not */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, + &bt_ctrl_rx_agg_size); + /* aggregation buf size, only work when BT control Rx aggregation size. */ + btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); + /* real update aggregation setting */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); +} + +void halbtc8723b2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) +{ + u32 reg_hp_txrx, reg_lp_txrx, u32tmp; + u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + reg_hp_txrx = 0x770; + reg_lp_txrx = 0x774; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); + reg_hp_tx = u32tmp & MASKLWORD; + reg_hp_rx = (u32tmp & MASKHWORD) >> 16; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); + reg_lp_tx = u32tmp & MASKLWORD; + reg_lp_rx = (u32tmp & MASKHWORD) >> 16; + + coex_sta->high_priority_tx = reg_hp_tx; + coex_sta->high_priority_rx = reg_hp_rx; + coex_sta->low_priority_tx = reg_lp_tx; + coex_sta->low_priority_rx = reg_lp_rx; + + if ((coex_sta->low_priority_tx > 1050) && + (!coex_sta->c2h_bt_inquiry_page)) + coex_sta->pop_event_cnt++; + + if ((coex_sta->low_priority_rx >= 950) && + (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) && + (!coex_sta->under_ips)) + bt_link_info->slave_role = true; + else + bt_link_info->slave_role = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], High Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", + reg_hp_txrx, reg_hp_tx, reg_hp_tx, reg_hp_rx, reg_hp_rx); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Low Priority Tx/Rx (reg 0x%x)=0x%x(%d)/0x%x(%d)\n", + reg_lp_txrx, reg_lp_tx, reg_lp_tx, reg_lp_rx, reg_lp_rx); + BTC_TRACE(trace_buf); + + /* reset counter */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); +} + +void halbtc8723b2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ +#if 1 + + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + +#endif +} + +void halbtc8723b2ant_query_bt_info(IN struct btc_coexist *btcoexist) +{ + u8 h2c_parameter[1] = {0}; + + coex_sta->c2h_bt_info_req_sent = true; + + h2c_parameter[0] |= BIT(0); /* trigger */ + + btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); +} + +boolean halbtc8723b2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) +{ + static boolean pre_wifi_busy = false, pre_under_4way = false, + pre_bt_hs_on = false; + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + boolean wifi_busy = false, under_4way = false, bt_hs_on = false; + boolean wifi_connected = false; + u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (wifi_connected) { + if (wifi_busy != pre_wifi_busy) { + pre_wifi_busy = wifi_busy; + return true; + } + if (under_4way != pre_under_4way) { + pre_under_4way = under_4way; + return true; + } + if (bt_hs_on != pre_bt_hs_on) { + pre_bt_hs_on = bt_hs_on; + return true; + } + + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + if ((BTC_RSSI_STATE_HIGH == wifi_rssi_state) || + (BTC_RSSI_STATE_LOW == wifi_rssi_state)) + return true; + + } + + return false; +} + +void halbtc8723b2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + bt_link_info->bt_link_exist = coex_sta->bt_link_exist; + bt_link_info->sco_exist = coex_sta->sco_exist; + bt_link_info->a2dp_exist = coex_sta->a2dp_exist; + bt_link_info->pan_exist = coex_sta->pan_exist; + bt_link_info->hid_exist = coex_sta->hid_exist; + + /* work around for HS mode. */ + if (bt_hs_on) { + bt_link_info->pan_exist = true; + bt_link_info->bt_link_exist = true; + } + + /* check if Sco only */ + if (bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->sco_only = true; + else + bt_link_info->sco_only = false; + + /* check if A2dp only */ + if (!bt_link_info->sco_exist && + bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->a2dp_only = true; + else + bt_link_info->a2dp_only = false; + + /* check if Pan only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->pan_only = true; + else + bt_link_info->pan_only = false; + + /* check if Hid only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + bt_link_info->hid_exist) + bt_link_info->hid_only = true; + else + bt_link_info->hid_only = false; +} + +u8 halbtc8723b2ant_action_algorithm(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = false; + u8 algorithm = BT_8723B_2ANT_COEX_ALGO_UNDEFINED; + u8 num_of_diff_profile = 0; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + if (!bt_link_info->bt_link_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No BT link exists!!!\n"); + BTC_TRACE(trace_buf); + return algorithm; + } + + if (bt_link_info->sco_exist) + num_of_diff_profile++; + if (bt_link_info->hid_exist) + num_of_diff_profile++; + if (bt_link_info->pan_exist) + num_of_diff_profile++; + if (bt_link_info->a2dp_exist) + num_of_diff_profile++; + + if (num_of_diff_profile == 1) { + if (bt_link_info->sco_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; + } else { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_HID; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_A2DP; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], PAN(HS) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], PAN(EDR) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR; + } + } + } + } else if (num_of_diff_profile == 2) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + A2DP ==> SCO\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_SCO; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + A2DP\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_HID_A2DP; + } + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_HID; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP; + } + } + } + } else if (num_of_diff_profile == 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + A2DP ==> HID\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_HID_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; + } + } + } + } else if (num_of_diff_profile >= 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8723B_2ANT_COEX_ALGO_PANEDR_HID; + } + } + } + } + + return algorithm; +} + +void halbtc8723b2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, + IN u8 dac_swing_lvl) +{ + u8 h2c_parameter[1] = {0}; + + /* There are several type of dacswing */ + /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ + h2c_parameter[0] = dac_swing_lvl; + + btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); +} + +void halbtc8723b2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, + IN u8 dec_bt_pwr_lvl) +{ + u8 h2c_parameter[1] = {0}; + + h2c_parameter[0] = dec_bt_pwr_lvl; + + btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); +} + +void halbtc8723b2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 dec_bt_pwr_lvl) +{ + coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; + + if (!force_exec) { + if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) + return; + } + halbtc8723b2ant_set_fw_dec_bt_pwr(btcoexist, + coex_dm->cur_bt_dec_pwr_lvl); + + coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; +} + +void halbtc8723b2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, + IN boolean enable_auto_report) +{ + u8 h2c_parameter[1] = {0}; + + h2c_parameter[0] = 0; + + if (enable_auto_report) + h2c_parameter[0] |= BIT(0); + + btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); +} + +void halbtc8723b2ant_bt_auto_report(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable_auto_report) +{ + coex_dm->cur_bt_auto_report = enable_auto_report; + + if (!force_exec) { + if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) + return; + } + halbtc8723b2ant_set_bt_auto_report(btcoexist, + coex_dm->cur_bt_auto_report); + + coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; +} + +void halbtc8723b2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 fw_dac_swing_lvl) +{ + coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; + + if (!force_exec) { + if (coex_dm->pre_fw_dac_swing_lvl == + coex_dm->cur_fw_dac_swing_lvl) + return; + } + + halbtc8723b2ant_set_fw_dac_swing_level(btcoexist, + coex_dm->cur_fw_dac_swing_lvl); + + coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; +} + +void halbtc8723b2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, + IN boolean rx_rf_shrink_on) +{ + if (rx_rf_shrink_on) { + /* Shrink RF Rx LPF corner */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Shrink RF Rx LPF corner!!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff, + 0xffffc); + } else { + /* Resume RF Rx LPF corner */ + /* After initialized, we can use coex_dm->bt_rf_0x1e_backup */ + if (btcoexist->initilized) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Resume RF Rx LPF corner!!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1e, + 0xfffff, coex_dm->bt_rf_0x1e_backup); + } + } +} + +void halbtc8723b2ant_rf_shrink(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean rx_rf_shrink_on) +{ + coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; + + if (!force_exec) { + if (coex_dm->pre_rf_rx_lpf_shrink == + coex_dm->cur_rf_rx_lpf_shrink) + return; + } + halbtc8723b2ant_set_sw_rf_rx_lpf_corner(btcoexist, + coex_dm->cur_rf_rx_lpf_shrink); + + coex_dm->pre_rf_rx_lpf_shrink = coex_dm->cur_rf_rx_lpf_shrink; +} + +void halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist + *btcoexist, IN boolean low_penalty_ra) +{ + u8 h2c_parameter[6] = {0}; + + h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ + + if (low_penalty_ra) { + h2c_parameter[1] |= BIT(0); + h2c_parameter[2] = + 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ + h2c_parameter[3] = 0xf4; /* MCS7 or OFDM54 */ + h2c_parameter[4] = 0xf5; /* MCS6 or OFDM48 */ + h2c_parameter[5] = 0xf6; /* MCS5 or OFDM36 */ + } + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); +} + +void halbtc8723b2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean low_penalty_ra) +{ + coex_dm->cur_low_penalty_ra = low_penalty_ra; + + if (!force_exec) { + if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) + return; + } + halbtc8723b2ant_set_sw_penalty_tx_rate_adaptive(btcoexist, + coex_dm->cur_low_penalty_ra); + + coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; +} + +void halbtc8723b2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, + IN u32 level) +{ + u8 val = (u8)level; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Write SwDacSwing = 0x%x\n", level); + BTC_TRACE(trace_buf); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x883, 0x3e, val); +} + +void halbtc8723b2ant_set_sw_full_time_dac_swing(IN struct btc_coexist + *btcoexist, IN boolean sw_dac_swing_on, IN u32 sw_dac_swing_lvl) +{ + if (sw_dac_swing_on) + halbtc8723b2ant_set_dac_swing_reg(btcoexist, sw_dac_swing_lvl); + else + halbtc8723b2ant_set_dac_swing_reg(btcoexist, 0x18); +} + + +void halbtc8723b2ant_dac_swing(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) +{ + coex_dm->cur_dac_swing_on = dac_swing_on; + coex_dm->cur_dac_swing_lvl = dac_swing_lvl; + + if (!force_exec) { + if ((coex_dm->pre_dac_swing_on == coex_dm->cur_dac_swing_on) && + (coex_dm->pre_dac_swing_lvl == + coex_dm->cur_dac_swing_lvl)) + return; + } + delay_ms(30); + halbtc8723b2ant_set_sw_full_time_dac_swing(btcoexist, dac_swing_on, + dac_swing_lvl); + + coex_dm->pre_dac_swing_on = coex_dm->cur_dac_swing_on; + coex_dm->pre_dac_swing_lvl = coex_dm->cur_dac_swing_lvl; +} + +void halbtc8723b2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, + IN boolean adc_back_off) +{ + if (adc_back_off) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB BackOff Level On!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x3); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB BackOff Level Off!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc05, 0x30, 0x1); + } +} + +void halbtc8723b2ant_adc_back_off(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean adc_back_off) +{ + coex_dm->cur_adc_back_off = adc_back_off; + + if (!force_exec) { + if (coex_dm->pre_adc_back_off == coex_dm->cur_adc_back_off) + return; + } + halbtc8723b2ant_set_adc_back_off(btcoexist, coex_dm->cur_adc_back_off); + + coex_dm->pre_adc_back_off = coex_dm->cur_adc_back_off; +} + +void halbtc8723b2ant_set_agc_table(IN struct btc_coexist *btcoexist, + IN boolean agc_table_en) +{ + u8 rssi_adjust_val = 0; + + /* =================BB AGC Gain Table */ + if (agc_table_en) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table On!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6e1A0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6d1B0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6c1C0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6b1D0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x6a1E0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x691F0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0x68200001); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table Off!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xaa1A0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa91B0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa81C0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa71D0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa61E0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa51F0001); + btcoexist->btc_write_4byte(btcoexist, 0xc78, 0xa4200001); + } + + + /* =================RF Gain */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x02000); + if (agc_table_en) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Agc Table On!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, + 0x38fff); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, + 0x38ffe); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Agc Table Off!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, + 0x380c3); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x3b, 0xfffff, + 0x28ce6); + } + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xef, 0xfffff, 0x0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x1); + if (agc_table_en) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Agc Table On!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, + 0x38fff); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, + 0x38ffe); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Agc Table Off!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, + 0x380c3); + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x40, 0xfffff, + 0x28ce6); + } + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xed, 0xfffff, 0x0); + + /* set rssi_adjust_val for wifi module. */ + if (agc_table_en) + rssi_adjust_val = 8; + btcoexist->btc_set(btcoexist, BTC_SET_U1_RSSI_ADJ_VAL_FOR_AGC_TABLE_ON, + &rssi_adjust_val); +} + +void halbtc8723b2ant_agc_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean agc_table_en) +{ + coex_dm->cur_agc_table_en = agc_table_en; + + if (!force_exec) { + if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) + return; + } + halbtc8723b2ant_set_agc_table(btcoexist, agc_table_en); + + coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; +} + +void halbtc8723b2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, + IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, + IN boolean limited_dig, IN boolean bt_lna_constrain) +{ + /* + u32 wifi_bw; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + if(BTC_WIFI_BW_HT40 != wifi_bw) + { + if (shrink_rx_lpf) + shrink_rx_lpf = false; + } + */ + + /* halbtc8723b2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ + halbtc8723b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); +} + +void halbtc8723b2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, + IN boolean agc_table_shift, IN boolean adc_back_off, + IN boolean sw_dac_swing, IN u32 dac_swing_lvl) +{ + /* halbtc8723b2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ + /* halbtc8723b2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ + /* halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, dac_swing_lvl); */ +} + +void halbtc8723b2ant_set_coex_table(IN struct btc_coexist *btcoexist, + IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) +{ + btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); + + btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); + + btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); + + btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); +} + +void halbtc8723b2ant_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, + IN u32 val0x6c8, IN u8 val0x6cc) +{ + coex_dm->cur_val0x6c0 = val0x6c0; + coex_dm->cur_val0x6c4 = val0x6c4; + coex_dm->cur_val0x6c8 = val0x6c8; + coex_dm->cur_val0x6cc = val0x6cc; + + if (!force_exec) { + if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && + (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && + (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && + (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) + return; + } + halbtc8723b2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, + val0x6cc); + + coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; + coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; + coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; + coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; +} + +void halbtc8723b2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + coex_sta->coex_table_type = type; + + switch (type) { + case 0: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555555, 0xffffff, 0x3); + break; + case 1: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5afa5afa, 0xffffff, 0x3); + break; + case 2: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x5ada5ada, 0x5ada5ada, 0xffffff, 0x3); + break; + case 3: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0xaaaaaaaa, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 4: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0xffffffff, 0xffffffff, 0xffffff, 0x3); + break; + case 5: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x5fff5fff, 0x5fff5fff, 0xffffff, 0x3); + break; + case 6: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55ff55ff, 0x5a5a5a5a, 0xffffff, 0x3); + break; + case 7: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 8: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 9: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 10: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 11: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 12: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0x5ada5ada, 0xffffff, 0x3); + break; + case 13: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x5fff5fff, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 14: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x5fff5fff, 0x5ada5ada, 0xffffff, 0x3); + break; + case 15: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0x55dd55dd, 0xaaaaaaaa, 0xffffff, 0x3); + break; + case 16: + halbtc8723b2ant_coex_table(btcoexist, force_exec, + 0xffff55ff, 0xfafafafa, 0xffffff, 0x3); + break; + default: + break; + } +} + +void halbtc8723b2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + u8 h2c_parameter[1] = {0}; + + if (enable) + h2c_parameter[0] |= BIT(0); /* function enable */ + + btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); +} + +void halbtc8723b2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable) +{ + coex_dm->cur_ignore_wlan_act = enable; + + if (!force_exec) { + if (coex_dm->pre_ignore_wlan_act == + coex_dm->cur_ignore_wlan_act) + return; + } + halbtc8723b2ant_set_fw_ignore_wlan_act(btcoexist, enable); + + coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; +} + +void halbtc8723b2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, + IN u8 lps_val, IN u8 rpwm_val) +{ + u8 lps = lps_val; + u8 rpwm = rpwm_val; + + btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); + btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); +} + +void halbtc8723b2ant_lps_rpwm(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) +{ + coex_dm->cur_lps = lps_val; + coex_dm->cur_rpwm = rpwm_val; + + if (!force_exec) { + if ((coex_dm->pre_lps == coex_dm->cur_lps) && + (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) + return; + } + halbtc8723b2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); + + coex_dm->pre_lps = coex_dm->cur_lps; + coex_dm->pre_rpwm = coex_dm->cur_rpwm; +} + +void halbtc8723b2ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +{ + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0x0, 0, 0, 48, 0}; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + /* will leave LPS state, turn off psTdma first */ + /* halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 1); */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } + } else { /* NO PS state */ + if (new_ps_state) { + /* will enter LPS state, turn off psTdma first */ + /* halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 1); */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } else { + /* keep state under NO PS state, do nothing. */ + } + } +} + +void halbtc8723b2ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = false; + + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + low_pwr_disable = false; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + NULL); + coex_sta->force_lps_on = false; + break; + case BTC_PS_LPS_ON: + halbtc8723b2ant_ps_tdma_check_for_power_save_state( + btcoexist, true); + halbtc8723b2ant_lps_rpwm(btcoexist, NORMAL_EXEC, + lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = true; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + /* power save must executed before psTdma. */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, + NULL); + coex_sta->force_lps_on = true; + break; + case BTC_PS_LPS_OFF: + halbtc8723b2ant_ps_tdma_check_for_power_save_state( + btcoexist, false); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + coex_sta->force_lps_on = false; + break; + default: + break; + } +} + + +void halbtc8723b2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, + IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) +{ + u8 h2c_parameter[5] = {0}; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = false; + +#if 0 + if ((coex_sta->a2dp_exist) && (coex_sta->hid_exist)) + byte5 = byte5 | 0x1; +#endif + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if (ap_enable) { + if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + halbtc8723b2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } + } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + halbtc8723b2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + + } else { + halbtc8723b2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } + + h2c_parameter[0] = byte1; + h2c_parameter[1] = byte2; + h2c_parameter[2] = byte3; + h2c_parameter[3] = byte4; + h2c_parameter[4] = byte5; + + coex_dm->ps_tdma_para[0] = byte1; + coex_dm->ps_tdma_para[1] = byte2; + coex_dm->ps_tdma_para[2] = byte3; + coex_dm->ps_tdma_para[3] = byte4; + coex_dm->ps_tdma_para[4] = byte5; + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); +} + +void halbtc8723b2ant_ps_tdma(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean turn_on, IN u8 type) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state1, bt_rssi_state; + s8 wifi_duration_adjust = 0x0; + u8 psTdmaByte4Modify = 0x0; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES + - coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s turn %s PS TDMA, type=%d\n", + (force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type); + BTC_TRACE(trace_buf); + coex_dm->cur_ps_tdma_on = turn_on; + coex_dm->cur_ps_tdma = type; + + if (!(BTC_RSSI_HIGH(wifi_rssi_state1) && + BTC_RSSI_HIGH(bt_rssi_state)) && turn_on) + /* if (halbtc8723b2ant_CoexSwitchThresCheck(btcoexist) && turn_on) */ + { + type = type + 100; /* for WiFi RSSI low or BT RSSI low */ + coex_dm->is_switch_to_1dot5_ant = true; + } else + coex_dm->is_switch_to_1dot5_ant = false; + + + if (!force_exec) { + if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && + (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) + return; + } + + if (coex_sta->scan_ap_num <= 5) { + if (coex_sta->a2dp_bit_pool >= 45) + wifi_duration_adjust = -15; + else if (coex_sta->a2dp_bit_pool >= 35) + wifi_duration_adjust = -10; + else + wifi_duration_adjust = 5; + } else if (coex_sta->scan_ap_num <= 20) { + if (coex_sta->a2dp_bit_pool >= 45) + wifi_duration_adjust = -15; + else if (coex_sta->a2dp_bit_pool >= 35) + wifi_duration_adjust = -10; + else + wifi_duration_adjust = 0; + } else if (coex_sta->scan_ap_num <= 40) { + if (coex_sta->a2dp_bit_pool >= 45) + wifi_duration_adjust = -15; + else if (coex_sta->a2dp_bit_pool >= 35) + wifi_duration_adjust = -10; + else + wifi_duration_adjust = -5; + } else { + if (coex_sta->a2dp_bit_pool >= 45) + wifi_duration_adjust = -15; + else if (coex_sta->a2dp_bit_pool >= 35) + wifi_duration_adjust = -10; + else + wifi_duration_adjust = -10; + } + + if ((bt_link_info->slave_role == true) && (bt_link_info->a2dp_exist)) + psTdmaByte4Modify = + 0x1; /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ + + + if (turn_on) { + switch (type) { + case 1: + default: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c + wifi_duration_adjust, 0x03, 0xf1, + 0x90 | psTdmaByte4Modify); + break; + case 2: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x2d + wifi_duration_adjust, 0x03, 0xf1, + 0x90 | psTdmaByte4Modify); + break; + case 3: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x1c, 0x3, 0xf1, 0x90 | + psTdmaByte4Modify); + break; + case 4: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x10, 0x03, 0xf1, 0x90 | + psTdmaByte4Modify); + break; + case 5: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c + wifi_duration_adjust, 0x3, 0x70, + 0x90 | psTdmaByte4Modify); + break; + case 6: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x2d + wifi_duration_adjust, 0x3, 0x70, + 0x90 | psTdmaByte4Modify); + break; + case 7: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x1c, 0x3, 0x70, 0x90 | + psTdmaByte4Modify); + break; + case 8: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, + 0x10, 0x3, 0x70, 0x90 | + psTdmaByte4Modify); + break; + case 9: + /* + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c + wifi_duration_adjust, 0x03, 0xf1, + 0x90 | psTdmaByte4Modify); + */ + /* Bryant Modify for BT no-profile busy case */ + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c + wifi_duration_adjust, 0x03, 0xf1, + 0x91); + + break; + case 10: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x2d + wifi_duration_adjust, 0x03, 0xf1, + 0x90 | psTdmaByte4Modify); + break; + case 11: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x1c, 0x3, 0xf1, 0x90 | + psTdmaByte4Modify); + break; + case 12: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x10, 0x3, 0xf1, 0x90 | + psTdmaByte4Modify); + break; + case 13: + /* + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c + wifi_duration_adjust, 0x3, 0x70, + 0x90 | psTdmaByte4Modify); + */ + /* Bryant Modify for BT no-profile busy case */ + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c + wifi_duration_adjust, 0x3, 0x70, + 0x91); + break; + case 14: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x2d + wifi_duration_adjust, 0x3, 0x70, + 0x90 | psTdmaByte4Modify); + break; + case 15: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x1c, 0x3, 0x70, 0x90 | + psTdmaByte4Modify); + break; + case 16: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x10, 0x3, 0x70, 0x90 | + psTdmaByte4Modify); + break; + case 17: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xa3, + 0x2f, 0x2f, 0x60, 0x90); + break; + case 18: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x5, 0x5, 0xe1, 0x90); + break; + case 19: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x25, 0x25, 0xe1, 0x90); + break; + case 20: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x25, 0x25, 0x60, 0x90); + break; + case 21: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x15, 0x03, 0x70, 0x90); + break; + case 22: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x35, 0x03, 0xf1, 0x90); + break; + case 23: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x35, 0x03, 0x71, 0x10); + break; + + case 25: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x30, 0x03, 0x71, 0x10); + break; + case 30: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x10, 0x3, 0x70, 0x54); + break; + case 33: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x1c, 0x3, 0xf1, 0x91); + + break; + case 71: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c + wifi_duration_adjust, 0x03, 0xf1, + 0x90); + break; + case 101: + case 105: + case 113: + case 171: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x3a + wifi_duration_adjust, 0x03, 0x70, + 0x50 | psTdmaByte4Modify); + break; + case 102: + case 106: + case 110: + case 114: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x2d + wifi_duration_adjust, 0x03, 0x70, + 0x50 | psTdmaByte4Modify); + break; + case 103: + case 107: + case 111: + case 115: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x1c, 0x03, 0x70, 0x50 | + psTdmaByte4Modify); + break; + case 104: + case 108: + case 112: + case 116: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x10, 0x03, 0x70, 0x50 | + psTdmaByte4Modify); + break; + case 109: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c, 0x03, 0xf1, 0x90 | + psTdmaByte4Modify); + break; + /* case 113: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x3c, 0x03, 0x70, 0x90 | + psTdmaByte4Modify); + break; */ + case 121: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x15, 0x03, 0x70, 0x90 | + psTdmaByte4Modify); + break; + case 122: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x35, 0x03, 0x71, 0x11); + break; + case 123: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x35, 0x03, 0x71, 0x10); + break; + case 125: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x30, 0x03, 0x70, 0x51); + break; + case 130: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x10, 0x3, 0x70, 0x54); + break; + case 133: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x1c, 0x3, 0x70, 0x51); + + break; + } + } else { + /* disable PS tdma */ + switch (type) { + case 0: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x40, 0x0); + break; + case 1: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x48, 0x0); + break; + default: + halbtc8723b2ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x40, 0x0); + break; + } + } + + /* update pre state */ + coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; + coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; +} + + +void halbtc8723b2ant_set_ant_path(IN struct btc_coexist *btcoexist, + IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u32 fw_ver = 0, u32tmp = 0, cnt_bt_cal_chk = 0; + boolean pg_ext_switch = false; + boolean use_ext_switch = false; + u8 h2c_parameter[2] = {0}; + u32 u32tmp_1[4]; + boolean is_fw_ready; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_EXT_SWITCH, &pg_ext_switch); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, + &fw_ver); /* [31:16]=fw ver, [15:0]=fw sub ver */ + + if ((fw_ver > 0 && fw_ver < 0xc0000) || pg_ext_switch) + use_ext_switch = true; + + if (init_hwcfg) { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x39, 0x8, 0x1); + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x944, 0x3, 0x3); + btcoexist->btc_write_1byte(btcoexist, 0x930, 0x77); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, 0x1); + + if (fw_ver >= 0x180000) { + /* Use H2C to set GNT_BT to High to avoid A2DP click */ + h2c_parameter[0] = 1; + btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, + h2c_parameter); + + cnt_bt_cal_chk = 0; + while (1) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_FW_READY, &is_fw_ready); + if (is_fw_ready == false) + break; + + if (btcoexist->btc_read_1byte(btcoexist, + 0x765) == 0x18) + break; + + cnt_bt_cal_chk++; + if (cnt_bt_cal_chk > 20) + break; + } + } else + btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); + u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); + if ((u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte(btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x0); /* WiFi TRx Mask off */ + /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ + /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x01); */ /*BT TRx Mask off */ + + if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { + /* tell firmware "no antenna inverse" */ + h2c_parameter[0] = 0; + } else { + /* tell firmware "antenna inverse" */ + h2c_parameter[0] = 1; + } + + if (use_ext_switch) { + /* ext switch type */ + h2c_parameter[1] = 1; + } else { + /* int switch type */ + h2c_parameter[1] = 0; + } + btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, h2c_parameter); + } else { + if (fw_ver >= 0x180000) { + /* Use H2C to set GNT_BT to "Control by PTA"*/ + h2c_parameter[0] = 0; + btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, + h2c_parameter); + + cnt_bt_cal_chk = 0; + while (1) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_FW_READY, &is_fw_ready); + if (is_fw_ready == false) + break; + + if (btcoexist->btc_read_1byte(btcoexist, + 0x765) == 0x0) + break; + + cnt_bt_cal_chk++; + if (cnt_bt_cal_chk > 20) + break; + } + } else + btcoexist->btc_write_1byte(btcoexist, 0x765, 0x0); + } + + /* ext switch setting */ + if (use_ext_switch) { + if (init_hwcfg) { + /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp &= ~BIT(23); + u32tmp |= BIT(24); + btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); + } + u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); + if ((u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte(btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); + + switch (ant_pos_type) { + case BTC_ANT_WIFI_AT_MAIN: + btcoexist->btc_write_1byte_bitmask(btcoexist, + 0x92c, 0x3, + 0x1); /* ext switch main at wifi */ + break; + case BTC_ANT_WIFI_AT_AUX: + btcoexist->btc_write_1byte_bitmask(btcoexist, + 0x92c, 0x3, + 0x2); /* ext switch aux at wifi */ + break; + } + } else { /* internal switch */ + if (init_hwcfg) { + /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp |= BIT(23); + u32tmp &= ~BIT(24); + btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); + } + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, + 0x0); /* fixed external switch S1->Main, S0->Aux */ + switch (ant_pos_type) { + case BTC_ANT_WIFI_AT_MAIN: + u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, + 0x948); + if ((u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte(btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte(btcoexist, 0x948, + 0x0); + break; + case BTC_ANT_WIFI_AT_AUX: + u32tmp_1[0] = btcoexist->btc_read_4byte(btcoexist, + 0x948); + if ((u32tmp_1[0] == 0x40) || (u32tmp_1[0] == 0x240)) + btcoexist->btc_write_4byte(btcoexist, 0x948, + u32tmp_1[0]); + else + btcoexist->btc_write_4byte(btcoexist, 0x948, + 0x280); + break; + } + } +} +#if 0 +boolean halbtc8723b2ant_CoexSwitchThresCheck(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state1, bt_rssi_state; + u32 vendor; + u8 offset = 0; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); + + /* if (vendor == BTC_VENDOR_LENOVO) */ + /* offset = 20; */ + + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES + - coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + if (BTC_RSSI_LOW(wifi_rssi_state1) || BTC_RSSI_LOW(bt_rssi_state)) + return true; + + return false; +} +#endif + + +void halbtc8723b2ant_coex_all_off(IN struct btc_coexist *btcoexist) +{ + /* fw all off */ + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + /* sw all off */ + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + + /* hw all off */ + /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +} + +void halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + /* force to reset coex mechanism */ + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); + halbtc8723b2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); + + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + + coex_sta->pop_event_cnt = 0; + +} + +void halbtc8723b2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + boolean wifi_connected = false; + boolean low_pwr_disable = true; + boolean scan = false, link = false, roam = false; + boolean wifi_busy = false; + + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + + if (coex_sta->bt_abnormal_scan) { + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 23); + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + } else if (scan || link || roam) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi link process + BT Inq/Page!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 7); + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); + } else if (wifi_connected) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi connected + BT Inq/Page!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 7); + + if (wifi_busy) + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 3); + else + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + } + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + /* + coex_dm->need_recover0x948 = true; + coex_dm->backup0x948 = btcoexist->btc_read_4byte(btcoexist, 0x948); + + halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_AUX, false, false); + */ +} + + +void halbtc8723b2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) +{ + u32 u32tmp; + u8 u8tmpa, u8tmpb; + + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); + + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + + + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); + u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); + u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", + u32tmp, u8tmpa, u8tmpb); + BTC_TRACE(trace_buf); +} + +boolean halbtc8723b2ant_action_wifi_idle_process(IN struct btc_coexist + *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u8 ap_num = 0; + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + /* wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, 1, 2, BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES-coex_dm->switch_thres_offset-coex_dm->switch_thres_offset, 0); */ + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset - coex_dm->switch_thres_offset, 0); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); + + /* define the office environment */ + if (BTC_RSSI_HIGH(wifi_rssi_state1) && + (coex_sta->hid_exist == true) && + (coex_sta->a2dp_exist == true)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi idle process for BT HID+A2DP exist!!\n"); + BTC_TRACE(trace_buf); + + halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x6); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + /* sw all off */ + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, + false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, + 0x18); + + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + + return true; + } + + halbtc8723b2ant_dac_swing(btcoexist, NORMAL_EXEC, true, 0x18); + return false; +} + + + +boolean halbtc8723b2ant_is_common_action(IN struct btc_coexist *btcoexist) +{ + boolean common = false, wifi_connected = false, wifi_busy = false; + boolean bt_hs_on = false, low_pwr_disable = false; + boolean asus_8723b = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_connected) { + low_pwr_disable = false; + btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, + 0x8); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi non-connected idle!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x0); + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, + false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, + 0x18); + + common = true; + } else { + if (BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + low_pwr_disable = false; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, + false, false, 0x8); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi connected + BT non connected-idle!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, + 0xfffff, 0x0); + halbtc8723b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 1); + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, + 0xb); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, + false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + + common = true; + } else if (BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status) { + low_pwr_disable = true; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + + if (bt_hs_on) + return false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi connected + BT connected-idle!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, + false, false, 0x8); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, + 0xfffff, 0x0); + halbtc8723b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 1); + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, + 0xb); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + + common = true; + } else { + low_pwr_disable = true; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + + if (wifi_busy) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); + BTC_TRACE(trace_buf); + /* btcoexist->btc_get(btcoexist, + BTC_GET_BL_IS_ASUS_8723B, &asus_8723b); + if (!asus_8723b) + common = false; + else + common = halbtc8723b2ant_action_wifi_idle_process( + btcoexist); */ + common = false; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); + BTC_TRACE(trace_buf); + /* common = false; */ + common = halbtc8723b2ant_action_wifi_idle_process( + btcoexist); + } + } + } + + return common; +} +void halbtc8723b2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, + IN boolean sco_hid, IN boolean tx_pause, IN u8 max_interval) +{ + static s32 up, dn, m, n, wait_count; + s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ + u8 retry_count = 0; + + if (!coex_dm->auto_tdma_adjust) { + coex_dm->auto_tdma_adjust = true; + { + if (sco_hid) { + if (tx_pause) { + if (max_interval == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 13); + coex_dm->ps_tdma_du_adj_type = + 13; + } else if (max_interval == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 14); + coex_dm->ps_tdma_du_adj_type = + 14; + } else if (max_interval == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } + } else { + if (max_interval == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 9); + coex_dm->ps_tdma_du_adj_type = + 9; + } else if (max_interval == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 10); + coex_dm->ps_tdma_du_adj_type = + 10; + } else if (max_interval == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } + } + } else { + if (tx_pause) { + if (max_interval == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 5); + coex_dm->ps_tdma_du_adj_type = + 5; + } else if (max_interval == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 6); + coex_dm->ps_tdma_du_adj_type = + 6; + } else if (max_interval == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } + } else { + if (max_interval == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 1); + coex_dm->ps_tdma_du_adj_type = + 1; + } else if (max_interval == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = + 2; + } else if (max_interval == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } + } + } + } + /* ============ */ + up = 0; + dn = 0; + m = 1; + n = 3; + result = 0; + wait_count = 0; + } else { + /* acquire the BT TRx retry count from BT_Info byte2 */ + retry_count = coex_sta->bt_retry_cnt; + + if ((coex_sta->low_priority_tx) > 1050 || + (coex_sta->low_priority_rx) > 1250) + retry_count++; + + result = 0; + wait_count++; + + if (retry_count == + 0) { /* no retry in the last 2-second duration */ + up++; + dn--; + + if (dn <= 0) + dn = 0; + + if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ + wait_count = 0; + n = 3; + up = 0; + dn = 0; + result = 1; + } + } else if (retry_count <= + 3) { /* <=3 retry in the last 2-second duration */ + up--; + dn++; + + if (up <= 0) + up = 0; + + if (dn == 2) {/* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ + if (wait_count <= 2) + m++; /* to avoid loop between the two levels */ + else + m = 1; + + if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ + m = 20; + + n = 3 * m; + up = 0; + dn = 0; + wait_count = 0; + result = -1; + } + } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ + if (wait_count == 1) + m++; /* to avoid loop between the two levels */ + else + m = 1; + + if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ + m = 20; + + n = 3 * m; + up = 0; + dn = 0; + wait_count = 0; + result = -1; + } + + if (max_interval == 1) { + if (tx_pause) { + if (coex_dm->cur_ps_tdma == 71) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 5); + coex_dm->ps_tdma_du_adj_type = 5; + } else if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 5); + coex_dm->ps_tdma_du_adj_type = 5; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 6); + coex_dm->ps_tdma_du_adj_type = 6; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 7); + coex_dm->ps_tdma_du_adj_type = 7; + } else if (coex_dm->cur_ps_tdma == 4) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 8); + coex_dm->ps_tdma_du_adj_type = 8; + } + if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 13); + coex_dm->ps_tdma_du_adj_type = 13; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 14); + coex_dm->ps_tdma_du_adj_type = 14; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 15); + coex_dm->ps_tdma_du_adj_type = 15; + } else if (coex_dm->cur_ps_tdma == 12) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 16); + coex_dm->ps_tdma_du_adj_type = 16; + } + + if (result == -1) { + if (coex_dm->cur_ps_tdma == 5) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 6); + coex_dm->ps_tdma_du_adj_type = + 6; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 8); + coex_dm->ps_tdma_du_adj_type = + 8; + } else if (coex_dm->cur_ps_tdma == 13) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 14); + coex_dm->ps_tdma_du_adj_type = + 14; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 16); + coex_dm->ps_tdma_du_adj_type = + 16; + } + } else if (result == 1) { + if (coex_dm->cur_ps_tdma == 8) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 6); + coex_dm->ps_tdma_du_adj_type = + 6; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 5); + coex_dm->ps_tdma_du_adj_type = + 5; + } else if (coex_dm->cur_ps_tdma == 16) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 14); + coex_dm->ps_tdma_du_adj_type = + 14; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 13); + coex_dm->ps_tdma_du_adj_type = + 13; + } + } + } else { + if (coex_dm->cur_ps_tdma == 5) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 71); + coex_dm->ps_tdma_du_adj_type = 71; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 2); + coex_dm->ps_tdma_du_adj_type = 2; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 3); + coex_dm->ps_tdma_du_adj_type = 3; + } else if (coex_dm->cur_ps_tdma == 8) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 4); + coex_dm->ps_tdma_du_adj_type = 4; + } + if (coex_dm->cur_ps_tdma == 13) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 9); + coex_dm->ps_tdma_du_adj_type = 9; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 10); + coex_dm->ps_tdma_du_adj_type = 10; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 11); + coex_dm->ps_tdma_du_adj_type = 11; + } else if (coex_dm->cur_ps_tdma == 16) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 12); + coex_dm->ps_tdma_du_adj_type = 12; + } + + if (result == -1) { + if (coex_dm->cur_ps_tdma == 71) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 1); + coex_dm->ps_tdma_du_adj_type = + 1; + } else if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = + 2; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 4); + coex_dm->ps_tdma_du_adj_type = + 4; + } else if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 10); + coex_dm->ps_tdma_du_adj_type = + 10; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 12); + coex_dm->ps_tdma_du_adj_type = + 12; + } + } else if (result == 1) { + if (coex_dm->cur_ps_tdma == 4) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = + 2; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 1); + coex_dm->ps_tdma_du_adj_type = + 1; + } else if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 71); + coex_dm->ps_tdma_du_adj_type = + 71; + } else if (coex_dm->cur_ps_tdma == 12) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 10); + coex_dm->ps_tdma_du_adj_type = + 10; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 9); + coex_dm->ps_tdma_du_adj_type = + 9; + } + } + } + } else if (max_interval == 2) { + if (tx_pause) { + if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 6); + coex_dm->ps_tdma_du_adj_type = 6; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 6); + coex_dm->ps_tdma_du_adj_type = 6; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 7); + coex_dm->ps_tdma_du_adj_type = 7; + } else if (coex_dm->cur_ps_tdma == 4) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 8); + coex_dm->ps_tdma_du_adj_type = 8; + } + if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 14); + coex_dm->ps_tdma_du_adj_type = 14; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 14); + coex_dm->ps_tdma_du_adj_type = 14; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 15); + coex_dm->ps_tdma_du_adj_type = 15; + } else if (coex_dm->cur_ps_tdma == 12) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 16); + coex_dm->ps_tdma_du_adj_type = 16; + } + if (result == -1) { + if (coex_dm->cur_ps_tdma == 5) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 6); + coex_dm->ps_tdma_du_adj_type = + 6; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 8); + coex_dm->ps_tdma_du_adj_type = + 8; + } else if (coex_dm->cur_ps_tdma == 13) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 14); + coex_dm->ps_tdma_du_adj_type = + 14; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 16); + coex_dm->ps_tdma_du_adj_type = + 16; + } + } else if (result == 1) { + if (coex_dm->cur_ps_tdma == 8) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 6); + coex_dm->ps_tdma_du_adj_type = + 6; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 6); + coex_dm->ps_tdma_du_adj_type = + 6; + } else if (coex_dm->cur_ps_tdma == 16) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 14); + coex_dm->ps_tdma_du_adj_type = + 14; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 14); + coex_dm->ps_tdma_du_adj_type = + 14; + } + } + } else { + if (coex_dm->cur_ps_tdma == 5) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 2); + coex_dm->ps_tdma_du_adj_type = 2; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 2); + coex_dm->ps_tdma_du_adj_type = 2; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 3); + coex_dm->ps_tdma_du_adj_type = 3; + } else if (coex_dm->cur_ps_tdma == 8) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 4); + coex_dm->ps_tdma_du_adj_type = 4; + } + if (coex_dm->cur_ps_tdma == 13) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 10); + coex_dm->ps_tdma_du_adj_type = 10; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 10); + coex_dm->ps_tdma_du_adj_type = 10; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 11); + coex_dm->ps_tdma_du_adj_type = 11; + } else if (coex_dm->cur_ps_tdma == 16) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 12); + coex_dm->ps_tdma_du_adj_type = 12; + } + if (result == -1) { + if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = + 2; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 4); + coex_dm->ps_tdma_du_adj_type = + 4; + } else if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 10); + coex_dm->ps_tdma_du_adj_type = + 10; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 12); + coex_dm->ps_tdma_du_adj_type = + 12; + } + } else if (result == 1) { + if (coex_dm->cur_ps_tdma == 4) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = + 2; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 2); + coex_dm->ps_tdma_du_adj_type = + 2; + } else if (coex_dm->cur_ps_tdma == 12) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 10); + coex_dm->ps_tdma_du_adj_type = + 10; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 10); + coex_dm->ps_tdma_du_adj_type = + 10; + } + } + } + } else if (max_interval == 3) { + if (tx_pause) { + if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 7); + coex_dm->ps_tdma_du_adj_type = 7; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 7); + coex_dm->ps_tdma_du_adj_type = 7; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 7); + coex_dm->ps_tdma_du_adj_type = 7; + } else if (coex_dm->cur_ps_tdma == 4) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 8); + coex_dm->ps_tdma_du_adj_type = 8; + } + if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 15); + coex_dm->ps_tdma_du_adj_type = 15; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 15); + coex_dm->ps_tdma_du_adj_type = 15; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 15); + coex_dm->ps_tdma_du_adj_type = 15; + } else if (coex_dm->cur_ps_tdma == 12) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 16); + coex_dm->ps_tdma_du_adj_type = 16; + } + if (result == -1) { + if (coex_dm->cur_ps_tdma == 5) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 8); + coex_dm->ps_tdma_du_adj_type = + 8; + } else if (coex_dm->cur_ps_tdma == 13) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 16); + coex_dm->ps_tdma_du_adj_type = + 16; + } + } else if (result == 1) { + if (coex_dm->cur_ps_tdma == 8) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 7); + coex_dm->ps_tdma_du_adj_type = + 7; + } else if (coex_dm->cur_ps_tdma == 16) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 15); + coex_dm->ps_tdma_du_adj_type = + 15; + } + } + } else { + if (coex_dm->cur_ps_tdma == 5) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 3); + coex_dm->ps_tdma_du_adj_type = 3; + } else if (coex_dm->cur_ps_tdma == 6) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 3); + coex_dm->ps_tdma_du_adj_type = 3; + } else if (coex_dm->cur_ps_tdma == 7) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 3); + coex_dm->ps_tdma_du_adj_type = 3; + } else if (coex_dm->cur_ps_tdma == 8) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 4); + coex_dm->ps_tdma_du_adj_type = 4; + } + if (coex_dm->cur_ps_tdma == 13) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 11); + coex_dm->ps_tdma_du_adj_type = 11; + } else if (coex_dm->cur_ps_tdma == 14) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 11); + coex_dm->ps_tdma_du_adj_type = 11; + } else if (coex_dm->cur_ps_tdma == 15) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 11); + coex_dm->ps_tdma_du_adj_type = 11; + } else if (coex_dm->cur_ps_tdma == 16) { + halbtc8723b2ant_ps_tdma(btcoexist, + NORMAL_EXEC, true, 12); + coex_dm->ps_tdma_du_adj_type = 12; + } + if (result == -1) { + if (coex_dm->cur_ps_tdma == 1) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 4); + coex_dm->ps_tdma_du_adj_type = + 4; + } else if (coex_dm->cur_ps_tdma == 9) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 12); + coex_dm->ps_tdma_du_adj_type = + 12; + } + } else if (result == 1) { + if (coex_dm->cur_ps_tdma == 4) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 3) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 2) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 3); + coex_dm->ps_tdma_du_adj_type = + 3; + } else if (coex_dm->cur_ps_tdma == 12) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 11) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } else if (coex_dm->cur_ps_tdma == 10) { + halbtc8723b2ant_ps_tdma( + btcoexist, NORMAL_EXEC, + true, 11); + coex_dm->ps_tdma_du_adj_type = + 11; + } + } + } + } + } + + /* if current PsTdma not match with the recorded one (when scan, dhcp...), */ + /* then we have to adjust it back to the previous record one. */ + if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { + boolean scan = false, link = false, roam = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", + coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + + if (!scan && !link && !roam) + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + coex_dm->ps_tdma_du_adj_type); + else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], roaming/link/scan is under progress, will adjust next time!!!\n"); + BTC_TRACE(trace_buf); + } + } +} + +/* SCO only or SCO+PAN(HS) */ +void halbtc8723b2ant_action_sco(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + u32 wifi_bw; + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 4); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for SCO quality at 11b/g mode */ + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + else /* for SCO quality & wifi performance balance at 11n mode */ + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, + 0); /* for voice quality */ + + /* sw mechanism */ + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + true, 0x4); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + true, 0x4); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + true, 0x4); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + true, 0x4); + } + } +} + + +void halbtc8723b2ant_action_hid(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + u32 wifi_bw; + + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + if (BTC_WIFI_BW_LEGACY == wifi_bw) /* for HID at 11b/g mode */ + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + else /* for HID quality & wifi performance balance at 11n mode */ + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 9); + + if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || + (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); + else + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); + + /* sw mechanism */ + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ +void halbtc8723b2ant_action_a2dp(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u32 wifi_bw; + u8 ap_num = 0; + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); + + /* define the office environment */ + if ((ap_num >= 10) && BTC_RSSI_HIGH(wifi_rssi_state1) && + BTC_RSSI_HIGH(bt_rssi_state)) { + /* dbg_print(" AP#>10(%d)\n", ap_num); */ + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x0); + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, + 0x8); + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + + /* sw mechanism */ + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + true, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + true, 0x18); + } + return; + + } + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + + } else { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 13); + } + + + if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || + (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) + halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, false, + 1); + else + halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 1); + + /* sw mechanism */ + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +void halbtc8723b2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u32 wifi_bw; + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + + } else { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 13); + } + + halbtc8723b2ant_tdma_duration_adjust(btcoexist, false, true, 2); + + /* sw mechanism */ + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +void halbtc8723b2ant_action_pan_edr(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u32 wifi_bw; + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 10); + } else { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 13); + } + + if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || + (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); + else + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); + + /* sw mechanism */ + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + + +/* PAN(HS) only */ +void halbtc8723b2ant_action_pan_hs(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u32 wifi_bw; + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +/* PAN(EDR)+A2DP */ +void halbtc8723b2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u8 ap_num = 0; + u32 wifi_bw; + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &ap_num); + + if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || + (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 12); + + if (ap_num < 10) + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + false, 1); + else + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + false, 3); + + } else { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 13); + if (ap_num < 10) + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + true, 1); + else + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + true, 3); + } + + /* sw mechanism */ + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +void halbtc8723b2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u32 wifi_bw; + + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } else { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 14); + } + + if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || + (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + if (BTC_WIFI_BW_HT40 == wifi_bw) { + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, + 3); + /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, + 0xfffff, 0x780); + } else { + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, + 6); + /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, + 0xfffff, 0x0); + } + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, false, 2); + } else { + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + /* halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x0); + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 2); + } + + /* sw mechanism */ + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +/* HID+A2DP+PAN(EDR) */ +void halbtc8723b2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u32 wifi_bw; + + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 2, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } else { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 14); + } + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || + (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + if (BTC_WIFI_BW_HT40 == wifi_bw) + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + true, 3); + else + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + false, 3); + } else + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, true, 3); + + /* sw mechanism */ + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +void halbtc8723b2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW, + prewifi_rssi_state1 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; + u32 wifi_bw; + u8 ap_num = 0; + + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 35); + + + wifi_rssi_state = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, 15, 0); + /* bt_rssi_state = halbtc8723b2ant_bt_rssi_state(2, 29, 0); */ + wifi_rssi_state1 = halbtc8723b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state1, 2, + BT_8723B_2ANT_WIFI_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 0); + bt_rssi_state = halbtc8723b2ant_bt_rssi_state(&pre_bt_rssi_state, 3, + BT_8723B_2ANT_BT_RSSI_COEXSWITCH_THRES - + coex_dm->switch_thres_offset, 37); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &ap_num); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); + + halbtc8723b2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x5); + + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_LEGACY == wifi_bw) { + if (BTC_RSSI_HIGH(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else if (BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + } else { + /* only 802.11N mode we have to dec bt power to 4 degree */ + if (BTC_RSSI_HIGH(bt_rssi_state)) { + /* need to check ap Number of Not */ + if (ap_num < 10) + halbtc8723b2ant_dec_bt_pwr(btcoexist, + NORMAL_EXEC, 4); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, + NORMAL_EXEC, 2); + } else if (BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + } + +#if 1 + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 16); + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 30); +#endif +#if 0 + if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } else { + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 14); + } + + if (BTC_RSSI_HIGH(bt_rssi_state)) { + if (ap_num < 10) + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + false, 2); + + else + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + false, 3); + } else { + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 18); + btcoexist->btc_write_1byte(btcoexist, 0x456, 0x38); + btcoexist->btc_write_2byte(btcoexist, 0x42a, 0x0808); + btcoexist->btc_write_4byte(btcoexist, 0x430, 0x0); + btcoexist->btc_write_4byte(btcoexist, 0x434, 0x01010000); + + if (ap_num < 10) + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + true, 2); + + else + halbtc8723b2ant_tdma_duration_adjust(btcoexist, true, + true, 3); + } +#endif + /* sw mechanism */ + if (BTC_WIFI_BW_HT40 == wifi_bw) { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, true, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } else { + if ((wifi_rssi_state == BTC_RSSI_STATE_HIGH) || + (wifi_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, true, false, + false, 0x18); + } else { + halbtc8723b2ant_sw_mechanism1(btcoexist, false, true, + false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, + false, 0x18); + } + } +} + +void halbtc8723b2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) +{ + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + /* sw all off */ + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +} + +void halbtc8723b2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) +{ + halbtc8723b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8723b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + /* sw all off */ + halbtc8723b2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8723b2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + + /* hw all off */ + /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ + halbtc8723b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723b2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); +} + +void halbtc8723b2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) +{ + u8 algorithm = 0; + u32 num_of_wifi_link = 0; + u32 wifi_link_status = 0; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean miracast_plus_bt = false; + boolean scan = false, link = false, roam = false; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism()===>\n"); + BTC_TRACE(trace_buf); + + if (btcoexist->manual_control) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->under_ips) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under IPS !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->bt_whck_test) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under WHCK TEST!!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_bt_whck_test(btcoexist); + return; + } + + algorithm = halbtc8723b2ant_action_algorithm(btcoexist); + if (coex_sta->c2h_bt_inquiry_page && + (BT_8723B_2ANT_COEX_ALGO_PANHS != algorithm)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under inquiry/page scan !!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_bt_inquiry(btcoexist); + return; + } + + /* + if(coex_dm->need_recover0x948) + { + coex_dm->need_recover0x948 = false; + btcoexist->btc_write_4byte(btcoexist, 0x948, coex_dm->backup0x948); + } + */ + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + + if (scan || link || roam) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under Link Process !!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_wifi_link_process(btcoexist); + return; + } + + /* for P2P */ + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + + if ((num_of_wifi_link >= 2) || + (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", + num_of_wifi_link, wifi_link_status); + BTC_TRACE(trace_buf); + + if (bt_link_info->bt_link_exist) + miracast_plus_bt = true; + else + miracast_plus_bt = false; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + halbtc8723b2ant_action_wifi_multi_port(btcoexist); + + return; + } + + miracast_plus_bt = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + + coex_dm->cur_algorithm = algorithm; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", + coex_dm->cur_algorithm); + BTC_TRACE(trace_buf); + + if (halbtc8723b2ant_is_common_action(btcoexist)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant common.\n"); + BTC_TRACE(trace_buf); + coex_dm->auto_tdma_adjust = false; + } else { + if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", + coex_dm->pre_algorithm, coex_dm->cur_algorithm); + BTC_TRACE(trace_buf); + coex_dm->auto_tdma_adjust = false; + } + switch (coex_dm->cur_algorithm) { + case BT_8723B_2ANT_COEX_ALGO_SCO: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_sco(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_hid(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_a2dp(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_A2DP_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_a2dp_pan_hs(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_pan_edr(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_pan_hs(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_PANEDR_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_pan_edr_a2dp(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_PANEDR_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_pan_edr_hid(btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_hid_a2dp_pan_edr( + btcoexist); + break; + case BT_8723B_2ANT_COEX_ALGO_HID_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_action_hid_a2dp(btcoexist); + break; + default: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_coex_all_off(btcoexist); + break; + } + coex_dm->pre_algorithm = coex_dm->cur_algorithm; + } +} + +void halbtc8723b2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) +{ + boolean is_in_mp_mode = false; + u8 h2c_parameter[2] = {0}; + u32 fw_ver = 0; + + /* set wlan_act to low */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); + + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, + 0x780); /* WiFi goto standby while GNT_BT 0-->1 */ + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + if (fw_ver >= 0x180000) { + /* Use H2C to set GNT_BT to HIGH */ + h2c_parameter[0] = 1; + btcoexist->btc_fill_h2c(btcoexist, 0x6E, 1, h2c_parameter); + } else + btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_IS_IN_MP_MODE, + &is_in_mp_mode); + if (!is_in_mp_mode) + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x0); /* BT select s0/s1 is controlled by BT */ + else + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x1); /* BT select s0/s1 is controlled by WiFi */ +} + +void halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean back_up) +{ + u8 u8tmp = 0; + u32 vendor; + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 2Ant Init HW Config!!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_get(btcoexist, BTC_GET_U4_VENDOR, &vendor); + if (vendor == BTC_VENDOR_LENOVO) + coex_dm->switch_thres_offset = 0; + else if (vendor == BTC_VENDOR_ASUS) + coex_dm->switch_thres_offset = 0; + else + coex_dm->switch_thres_offset = 20; + + /* 0xf0[15:12] --> Chip Cut information */ + coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, + 0xf1) & 0xf0) >> 4; + + /* backup rf 0x1e value */ + coex_dm->bt_rf_0x1e_backup = + btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff); + + /* 0x790[5:0]=0x5 */ + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); + u8tmp &= 0xc0; + u8tmp |= 0x5; + btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); + + /* Antenna config */ + halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, true, + false); + coex_sta->dis_ver_info_cnt = 0; + + /* PTA parameter */ + halbtc8723b2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + + /* Enable counter statistics */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, + 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ + btcoexist->btc_write_1byte(btcoexist, 0x778, 0x3); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); + + /* Give bt_coex_supported_version the default value */ + coex_sta->bt_coex_supported_version = 0; + +} + +/* ************************************************************ + * work around function start with wa_halbtc8723b2ant_ + * ************************************************************ + * ************************************************************ + * extern function start with ex_halbtc8723b2ant_ + * ************************************************************ */ +void ex_halbtc8723b2ant_power_on_setting(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u16 u16tmp = 0x0; + u32 value = 0; + u32 u32tmp_1[4]; + + btcoexist->btc_write_1byte(btcoexist, 0x67, 0x20); + + /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ + u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); + btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); + + btcoexist->btc_write_4byte(btcoexist, 0x948, 0x0); + + if (btcoexist->chip_interface == BTC_INTF_USB) { + /* fixed at S0 for USB interface */ + board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; + } else { + /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ + if (board_info->single_ant_path == 0) { + /* set to S1 */ + board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; + } else if (board_info->single_ant_path == 1) { + /* set to S0 */ + board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; + } + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ANTPOSREGRISTRY_CTRL, + &value); + } +} + +void ex_halbtc8723b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ + + /* */ + /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ + /* Local setting bit define */ + /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ + /* BIT1: "0" for internal switch; "1" for external switch */ + /* BIT2: "0" for one antenna; "1" for two antenna */ + /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ + if (btcoexist->chip_interface == BTC_INTF_USB) { + /* fixed at S0 for USB interface */ + u8tmp |= 0x1; /* antenna inverse */ + btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); + } else { + if (board_info->single_ant_path == 1) { + /* set to S0 */ + u8tmp |= 0x1; /* antenna inverse */ + } + + if (btcoexist->chip_interface == BTC_INTF_PCI) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x384, + u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_SDIO) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, + u8tmp); + } +} + +void ex_halbtc8723b2ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only) +{ + halbtc8723b2ant_init_hw_config(btcoexist, true); +} + +void ex_halbtc8723b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Coex Mechanism Init!!\n"); + BTC_TRACE(trace_buf); + + halbtc8723b2ant_init_coex_dm(btcoexist); +} + +void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 *cli_buf = btcoexist->cli_buf; + u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; + u32 u32tmp[4]; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0; + u32 bt_coex_ver = 0; + static u8 pop_report_in_10s = 0; + u32 phyver = 0; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[BT Coexist info]============"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Under Manual Control]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", + "Ant PG number/ Ant mechanism:", + board_info->pg_ant_num, board_info->btdm_ant_num); + CL_PRINTF(cli_buf); + + /* btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); */ + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + bt_coex_ver = coex_sta->bt_coex_supported_version & 0xff; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8723b_2ant, glcoex_ver_8723b_2ant, + glcoex_ver_btdesired_8723b_2ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (bt_coex_ver >= glcoex_ver_btdesired_8723b_2ant ? + "Match" : "Mis-Match"))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", + "Wifi channel informed to BT", + coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], + coex_dm->wifi_chnl_info[2]); + CL_PRINTF(cli_buf); + + /* wifi status */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Wifi Status]============"); + CL_PRINTF(cli_buf); + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[BT Status]============"); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", + "BT Abnormal scan", + (coex_sta->bt_abnormal_scan) ? "Yes" : "No"); + CL_PRINTF(cli_buf); + + pop_report_in_10s++; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", + "BT [status/ rssi/ retryCnt/ popCnt]", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") + : ((BT_8723B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) + ? "connected-idle" : "busy")))), + coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, + coex_sta->pop_event_cnt); + CL_PRINTF(cli_buf); + + if (pop_report_in_10s >= 5) { + coex_sta->pop_event_cnt = 0; + pop_report_in_10s = 0; + } + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d / %d / %d / %d / %d / %d", + "SCO/HID/PAN/A2DP/NameReq/WHQL", + bt_link_info->sco_exist, bt_link_info->hid_exist, + bt_link_info->pan_exist, bt_link_info->a2dp_exist, + coex_sta->c2h_bt_remote_name_req, + coex_sta->bt_whck_test); + CL_PRINTF(cli_buf); + + { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", + "BT Role", + (bt_link_info->slave_role) ? "Slave" : "Master"); + CL_PRINTF(cli_buf); + } + + bt_info_ext = coex_sta->bt_info_ext; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", + "A2DP Rate/Bitpool", + (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool); + CL_PRINTF(cli_buf); + + for (i = 0; i < BT_INFO_SRC_8723B_2ANT_MAX; i++) { + if (coex_sta->bt_info_c2h_cnt[i]) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", + glbt_info_src_8723b_2ant[i], + coex_sta->bt_info_c2h[i][0], + coex_sta->bt_info_c2h[i][1], + coex_sta->bt_info_c2h[i][2], + coex_sta->bt_info_c2h[i][3], + coex_sta->bt_info_c2h[i][4], + coex_sta->bt_info_c2h[i][5], + coex_sta->bt_info_c2h[i][6], + coex_sta->bt_info_c2h_cnt[i]); + CL_PRINTF(cli_buf); + } + } + + /* Sw mechanism */ + if (btcoexist->manual_control) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Sw mechanism] (before Manual)============"); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Sw mechanism]============"); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", + "SM1[ShRf/ LpRA/ LimDig]", + coex_dm->cur_rf_rx_lpf_shrink, coex_dm->cur_low_penalty_ra, + coex_dm->limited_dig); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d(0x%x) ", + "SM2[AgcT/ AdcB/ SwDacSwing(lvl)]", + coex_dm->cur_agc_table_en, coex_dm->cur_adc_back_off, + coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); + CL_PRINTF(cli_buf); + + /* Fw mechanism */ + if (btcoexist->manual_control) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Fw mechanism] (before Manual) ============"); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Fw mechanism]============"); + + ps_tdma_case = coex_dm->cur_ps_tdma; + + if (coex_dm->is_switch_to_1dot5_ant) + ps_tdma_case = ps_tdma_case + 100; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", + "PS TDMA", + coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], + coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], + coex_dm->ps_tdma_para[4], ps_tdma_case, + (coex_dm->cur_ps_tdma_on ? "On" : "Off"), + (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "Coex Table Type", + coex_sta->coex_table_type); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", + "DecBtPwr/ IgnWlanAct", + coex_dm->cur_bt_dec_pwr_lvl, coex_dm->cur_ignore_wlan_act); + CL_PRINTF(cli_buf); + + /* Hw setting */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Hw setting]============"); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x", + "RF-A, 0x1e initVal", + coex_dm->bt_rf_0x1e_backup); + CL_PRINTF(cli_buf); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x880); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "0x778/0x880[29:25]", + u8tmp[0], (u32tmp[0] & 0x3e000000) >> 25); + CL_PRINTF(cli_buf); + + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x948); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x765); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x948/ 0x67[5] / 0x765", + u32tmp[0], ((u8tmp[0] & 0x20) >> 5), u8tmp[1]); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x92c); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x930); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x944); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x92c[1:0]/ 0x930[7:0]/0x944[1:0]", + u32tmp[0] & 0x3, u32tmp[1] & 0xff, u32tmp[2] & 0x3); + CL_PRINTF(cli_buf); + + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x39); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "0x38[11]/0x40/0x4c[24:23]/0x64[0]", + ((u8tmp[0] & 0x8) >> 3), u8tmp[1], + ((u32tmp[0] & 0x01800000) >> 23), u8tmp[2] & 0x1); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "0x550(bcn ctrl)/0x522", + u32tmp[0], u8tmp[0]); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xc50); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x49c); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "0xc50(dig)/0x49c(null-drop)", + u32tmp[0] & 0xff, u8tmp[0]); + CL_PRINTF(cli_buf); + + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11n-agg", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11n-agg", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x6cc); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "0x6c0/0x6c4/0x6c8/0x6cc(coexTable)", + u32tmp[0], u32tmp[1], u32tmp[2], u8tmp[0]); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(high-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x774(low-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx); + CL_PRINTF(cli_buf); +#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 1) + /* halbtc8723b2ant_monitor_bt_ctr(btcoexist); */ +#endif + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); +} + + +void ex_halbtc8723b2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + if (BTC_IPS_ENTER == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS ENTER notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_ips = true; + halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); + halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); + halbtc8723b2ant_coex_all_off(btcoexist); + } else if (BTC_IPS_LEAVE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS LEAVE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_ips = false; + halbtc8723b2ant_init_hw_config(btcoexist, false); + halbtc8723b2ant_init_coex_dm(btcoexist); + halbtc8723b2ant_query_bt_info(btcoexist); + } +} + +void ex_halbtc8723b2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + if (BTC_LPS_ENABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS ENABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = true; + } else if (BTC_LPS_DISABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS DISABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = false; + } +} + +void ex_halbtc8723b2ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u32 u32tmp; + u8 u8tmpa, u8tmpb; + + + + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x948); + u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); + u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); + + if (BTC_SCAN_START == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, + false, false); + } else if (BTC_SCAN_FINISH == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN FINISH notify\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], 0x948=0x%x, 0x765=0x%x, 0x76e=0x%x\n", + u32tmp, u8tmpa, u8tmpb); + BTC_TRACE(trace_buf); +} + +void ex_halbtc8723b2ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + if (BTC_ASSOCIATE_START == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT START notify\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, + false, false); + } else if (BTC_ASSOCIATE_FINISH == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT FINISH notify\n"); + BTC_TRACE(trace_buf); + } +} + +void ex_halbtc8723b2ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_parameter[3] = {0}; + u32 wifi_bw; + u8 wifi_central_chnl; + u8 ap_num = 0; + + if (BTC_MEDIA_CONNECT == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA connect notify\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_MAIN, + false, false); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA disconnect notify\n"); + BTC_TRACE(trace_buf); + } + + /* only 2.4G we need to inform bt the chnl mask */ + btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, + &wifi_central_chnl); + if ((BTC_MEDIA_CONNECT == type) && + (wifi_central_chnl <= 14)) { + h2c_parameter[0] = 0x1; + h2c_parameter[1] = wifi_central_chnl; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) + h2c_parameter[2] = 0x30; + else { + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &ap_num); + if (ap_num < 10) + h2c_parameter[2] = 0x30; + else + h2c_parameter[2] = 0x20; + } + } + + coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; + coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; + coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; + + btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); +} + +void ex_halbtc8723b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + if (type == BTC_PACKET_DHCP) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], DHCP Packet notify\n"); + BTC_TRACE(trace_buf); + } +} + +void ex_halbtc8723b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 bt_info = 0; + u8 i, rsp_source = 0; + boolean bt_busy = false, limited_dig = false; + boolean wifi_connected = false; + + coex_sta->c2h_bt_info_req_sent = false; + + rsp_source = tmp_buf[0] & 0xf; + if (rsp_source >= BT_INFO_SRC_8723B_2ANT_MAX) + rsp_source = BT_INFO_SRC_8723B_2ANT_WIFI_FW; + coex_sta->bt_info_c2h_cnt[rsp_source]++; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, + length); + BTC_TRACE(trace_buf); + for (i = 0; i < length; i++) { + coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; + if (i == 1) + bt_info = tmp_buf[i]; + if (i == length - 1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } + } + + if (btcoexist->manual_control) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), return for Manual CTRL<===\n"); + BTC_TRACE(trace_buf); + return; + } + + /* if 0xff, it means BT is under WHCK test */ + if (bt_info == 0xff) + coex_sta->bt_whck_test = true; + else + coex_sta->bt_whck_test = false; + + if (BT_INFO_SRC_8723B_2ANT_WIFI_FW != rsp_source) { + coex_sta->bt_retry_cnt = /* [3:0] */ + coex_sta->bt_info_c2h[rsp_source][2] & 0xf; + + if (coex_sta->bt_retry_cnt >= 1) + coex_sta->pop_event_cnt++; + + coex_sta->bt_rssi = + coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; + + coex_sta->bt_info_ext = + coex_sta->bt_info_c2h[rsp_source][4]; + + if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) + coex_sta->c2h_bt_remote_name_req = true; + else + coex_sta->c2h_bt_remote_name_req = false; + + if (coex_sta->bt_info_c2h[rsp_source][1] == 0x49) { + coex_sta->a2dp_bit_pool = + coex_sta->bt_info_c2h[rsp_source][6]; + } else + coex_sta->a2dp_bit_pool = 0; + + coex_sta->bt_tx_rx_mask = (coex_sta->bt_info_c2h[rsp_source][2] + & 0x40); + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TX_RX_MASK, + &coex_sta->bt_tx_rx_mask); + if (coex_sta->bt_tx_rx_mask) { + /* BT into is responded by BT FW and BT RF REG 0x3C != 0x01 => Need to switch BT TRx Mask */ + /* BT TRx mask off */ + btcoexist->btc_set_bt_trx_mask(btcoexist, 0); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT TRx Mask off for BT Info Notify\n"); + BTC_TRACE(trace_buf); +#if 0 + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Switch BT TRx Mask since BT RF REG 0x3C != 0x01\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, + 0x3c, 0x01); +#endif + } + + /* Here we need to resend some wifi info to BT */ + /* because bt is reset and loss of the info. */ + if ((coex_sta->bt_info_ext & BIT(1))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + if (wifi_connected) + ex_halbtc8723b2ant_media_status_notify( + btcoexist, BTC_MEDIA_CONNECT); + else + ex_halbtc8723b2ant_media_status_notify( + btcoexist, BTC_MEDIA_DISCONNECT); + } + + if ((coex_sta->bt_info_ext & BIT(3))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, + false); + } else { + /* BT already NOT ignore Wlan active, do nothing here. */ + } +#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) + if ((coex_sta->bt_info_ext & BIT(4))) { + /* BT auto report already enabled, do nothing */ + } else + halbtc8723b2ant_bt_auto_report(btcoexist, FORCE_EXEC, + true); +#endif + } + + /* check BIT2 first ==> check if bt is under inquiry or page scan */ + if (bt_info & BT_INFO_8723B_2ANT_B_INQ_PAGE) + coex_sta->c2h_bt_inquiry_page = true; + else + coex_sta->c2h_bt_inquiry_page = false; + + /* set link exist status */ + if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { + coex_sta->bt_link_exist = false; + coex_sta->pan_exist = false; + coex_sta->a2dp_exist = false; + coex_sta->hid_exist = false; + coex_sta->sco_exist = false; + } else { /* connection exists */ + coex_sta->bt_link_exist = true; + if (bt_info & BT_INFO_8723B_2ANT_B_FTP) + coex_sta->pan_exist = true; + else + coex_sta->pan_exist = false; + if (bt_info & BT_INFO_8723B_2ANT_B_A2DP) + coex_sta->a2dp_exist = true; + else + coex_sta->a2dp_exist = false; + if (bt_info & BT_INFO_8723B_2ANT_B_HID) + coex_sta->hid_exist = true; + else + coex_sta->hid_exist = false; + if (bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) + coex_sta->sco_exist = true; + else + coex_sta->sco_exist = false; + + if ((coex_sta->hid_exist == false) && + (coex_sta->c2h_bt_inquiry_page == false) && + (coex_sta->sco_exist == false)) { + if (coex_sta->high_priority_tx + + coex_sta->high_priority_rx >= 160) { + coex_sta->hid_exist = true; + bt_info = bt_info | 0x28; + } + } + } + + halbtc8723b2ant_update_bt_link_info(btcoexist); + + if (!(bt_info & BT_INFO_8723B_2ANT_B_CONNECTION)) { + coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); + BTC_TRACE(trace_buf); + } else if (bt_info == + BT_INFO_8723B_2ANT_B_CONNECTION) { /* connection exists but no busy */ + coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); + BTC_TRACE(trace_buf); + } else if ((bt_info & BT_INFO_8723B_2ANT_B_SCO_ESCO) || + (bt_info & BT_INFO_8723B_2ANT_B_SCO_BUSY)) { + coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); + BTC_TRACE(trace_buf); + } else if (bt_info & BT_INFO_8723B_2ANT_B_ACL_BUSY) { + coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_ACL_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_dm->bt_status = BT_8723B_2ANT_BT_STATUS_MAX; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); + BTC_TRACE(trace_buf); + } + + if ((BT_8723B_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8723B_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8723B_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { + bt_busy = true; + limited_dig = true; + } else { + bt_busy = false; + limited_dig = false; + } + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + + coex_dm->limited_dig = limited_dig; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); + + halbtc8723b2ant_run_coexist_mechanism(btcoexist); +} + +void ex_halbtc8723b2ant_halt_notify(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); + BTC_TRACE(trace_buf); + + halbtc8723b2ant_wifi_off_hw_cfg(btcoexist); + /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ + /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); */ /*BT goto standby while GNT_BT 1-->0 */ + halbtc8723b2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); + + ex_halbtc8723b2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); +} + +void ex_halbtc8723b2ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); + BTC_TRACE(trace_buf); + + if (BTC_WIFI_PNP_SLEEP == pnp_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to SLEEP\n"); + BTC_TRACE(trace_buf); + + /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ + /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ + /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ + coex_sta->under_ips = false; + coex_sta->under_lps = false; + } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to WAKE UP\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_init_hw_config(btcoexist, false); + halbtc8723b2ant_init_coex_dm(btcoexist); + halbtc8723b2ant_query_bt_info(btcoexist); + } +} + +void ex_halbtc8723b2ant_periodical(IN struct btc_coexist *btcoexist) +{ + u32 bt_patch_ver; + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ==========================Periodical===========================\n"); + BTC_TRACE(trace_buf); + if (coex_sta->dis_ver_info_cnt <= 5) { + coex_sta->dis_ver_info_cnt += 1; + if (coex_sta->dis_ver_info_cnt == 3) { + /* Antenna config to set 0x765 = 0x0 (GNT_BT control by PTA) after initial */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Set GNT_BT control by PTA\n"); + BTC_TRACE(trace_buf); + halbtc8723b2ant_set_ant_path(btcoexist, + BTC_ANT_WIFI_AT_MAIN, false, false); + } + } + + if (((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) && (!coex_sta->bt_disabled)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, &coex_sta->bt_coex_supported_version); + + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + +#if (BT_AUTO_REPORT_ONLY_8723B_2ANT == 0) + halbtc8723b2ant_query_bt_info(btcoexist); + halbtc8723b2ant_monitor_bt_enable_disable(btcoexist); +#else + halbtc8723b2ant_monitor_bt_ctr(btcoexist); + halbtc8723b2ant_monitor_wifi_ctr(btcoexist); + + /* for some BT speaker that Hi-Pri pkt appear begore start play, this will cause HID exist */ + if ((coex_sta->high_priority_tx + coex_sta->high_priority_rx < 50) && + (bt_link_info->hid_exist == true)) + bt_link_info->hid_exist = false; + + if (halbtc8723b2ant_is_wifi_status_changed(btcoexist) || + coex_dm->auto_tdma_adjust) + halbtc8723b2ant_run_coexist_mechanism(btcoexist); +#endif +} + +#endif + +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b2ant.h similarity index 90% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b2Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b2ant.h index 4fe39b295b9c..fb6149a68d92 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8723b2Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723b2ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -148,12 +162,14 @@ struct coex_sta_8723b_2ant { u32 crc_ok_cck; u32 crc_ok_11g; u32 crc_ok_11n; - u32 crc_ok_11n_agg; + u32 crc_ok_11n_vht; u32 crc_err_cck; u32 crc_err_11g; u32 crc_err_11n; - u32 crc_err_11n_agg; + u32 crc_err_11n_vht; + + u32 bt_coex_supported_version; u8 coex_table_type; boolean force_lps_on; @@ -212,3 +228,4 @@ void ex_halbtc8723b2ant_display_coex_info(IN struct btc_coexist *btcoexist); #endif #endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.c new file mode 100644 index 000000000000..d1a8361c4d41 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.c @@ -0,0 +1,82 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" + + +VOID +ex_hal8723b_wifi_only_hw_config( + IN struct wifi_only_cfg *pwifionlycfg + ) +{ + struct wifi_only_haldata *pwifionly_haldata = &pwifionlycfg->haldata_info; + + + halwifionly_write1byte(pwifionlycfg, 0x778, 0x3); /* Set pta for wifi first priority, 0x1 need to reference pta table to determine wifi and bt priority */ + halwifionly_bitmaskwrite1byte(pwifionlycfg, 0x40, 0x20, 0x1); + + /* Set Antenna path to Wifi */ + halwifionly_write2byte(pwifionlycfg, 0x0765, 0x8); /* Set pta for wifi first priority, 0x0 need to reference pta table to determine wifi and bt priority */ + halwifionly_write2byte(pwifionlycfg, 0x076e, 0xc); + + halwifionly_write4byte(pwifionlycfg, 0x000006c0, 0xaaaaaaaa); /* pta table, 0xaaaaaaaa means wifi is higher priority than bt */ + halwifionly_write4byte(pwifionlycfg, 0x000006c4, 0xaaaaaaaa); + + halwifionly_bitmaskwrite1byte(pwifionlycfg, 0x67, 0x20, 0x1); /* BT select s0/s1 is controlled by WiFi */ + + /* 0x948 setting */ + if (pwifionlycfg->chip_interface == WIFIONLY_INTF_PCI) { + /* HP Foxconn NGFF at S0 + not sure HP pg correct or not(EEPROMBluetoothSingleAntPath), so here we just write + 0x948=0x280 for HP HW id NIC. */ + if (pwifionly_haldata->customer_id == CUSTOMER_HP_1) { + halwifionly_write4byte(pwifionlycfg, 0x948, 0x280); + halwifionly_phy_set_rf_reg(pwifionlycfg, 0, 0x1, 0xfffff, 0x0); /* WiFi TRx Mask off */ + return; + } + } + + if (pwifionly_haldata->efuse_pg_antnum == 2) { + halwifionly_write4byte(pwifionlycfg, 0x948, 0x0); + } else { + /* 3Attention !!! For 8723BU !!!! + For 8723BU single ant case: jira [USB-1237] + Because of 8723BU S1 has HW problem, we only can use S0 instead. + Whether Efuse 0xc3 [6] is 0 or 1, we should always use S0 and write 0x948 to 80/280 + + -------------------------------------------------- + BT Team : + When in Single Ant case, Reg[0x948] has two case : 0x80 or 0x200 + When in Two Ant case, Reg[0x948] has two case : 0x280 or 0x0 + Efuse 0xc3 [6] Antenna Path + 0xc3 [6] = 0 ==> S1 ==> 0x948 = 0/40/200 + 0xc3 [6] = 1 ==> S0 ==> 0x948 = 80/240/280 */ + + if (pwifionlycfg->chip_interface == WIFIONLY_INTF_USB) + halwifionly_write4byte(pwifionlycfg, 0x948, 0x80); + else { + if (pwifionly_haldata->efuse_pg_antpath == 0) + halwifionly_write4byte(pwifionlycfg, 0x948, 0x0); + else + halwifionly_write4byte(pwifionlycfg, 0x948, 0x280); + } + + } + + + /* after 8723B F-cut, TRx Mask should be set when 0x948=0x0 or 0x280 + PHY_SetRFReg(Adapter, 0, 0x1, 0xfffff, 0x780); WiFi TRx Mask on */ + halwifionly_phy_set_rf_reg(pwifionlycfg, 0, 0x1, 0xfffff, 0x0); /*WiFi TRx Mask off */ + +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.h new file mode 100644 index 000000000000..9d386644318a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723bwifionly.h @@ -0,0 +1,22 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __INC_HAL8723BWIFIONLYHWCFG_H +#define __INC_HAL8723BWIFIONLYHWCFG_H + +VOID +ex_hal8723b_wifi_only_hw_config( + IN struct wifi_only_cfg *pwifionlycfg + ); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.c index c7151b770534..f607d772b4e0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.c @@ -1,3 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + /* ************************************************************ * Description: * @@ -11,7 +26,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -44,9 +59,9 @@ const char *const glbt_info_src_8723d_1ant[] = { * Please strictly follow this order and naming style !!! * * ************************************************************ */ -u32 glcoex_ver_date_8723d_1ant = 20161208; -u32 glcoex_ver_8723d_1ant = 0x12; -u32 glcoex_ver_btdesired_8723d_1ant = 0x10; +u32 glcoex_ver_date_8723d_1ant = 20171025; +u32 glcoex_ver_8723d_1ant = 0x20; +u32 glcoex_ver_btdesired_8723d_1ant = 0x20; /* ************************************************************ @@ -196,7 +211,7 @@ void halbtc8723d1ant_update_ra_mask(IN struct btc_coexist *btcoexist, void halbtc8723d1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 type) { - boolean wifi_under_b_mode = false; + boolean wifi_under_b_mode = FALSE; coex_dm->cur_arfr_type = type; @@ -372,6 +387,12 @@ void halbtc8723d1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) coex_sta->low_priority_tx = reg_lp_tx; coex_sta->low_priority_rx = reg_lp_rx; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); + + BTC_TRACE(trace_buf); + if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == coex_dm->bt_status) { @@ -380,16 +401,16 @@ void halbtc8723d1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) cnt_overhead++; if (cnt_overhead == 3) - coex_sta->is_hiPri_rx_overhead = true; + coex_sta->is_hiPri_rx_overhead = TRUE; } else { if (cnt_overhead > 0) cnt_overhead--; if (cnt_overhead == 0) - coex_sta->is_hiPri_rx_overhead = false; + coex_sta->is_hiPri_rx_overhead = FALSE; } } else - coex_sta->is_hiPri_rx_overhead = false; + coex_sta->is_hiPri_rx_overhead = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", @@ -409,13 +430,13 @@ void halbtc8723d1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { if (cnt_slave >= 2) { - bt_link_info->slave_role = true; + bt_link_info->slave_role = TRUE; cnt_slave = 2; } else cnt_slave++; } else { if (cnt_slave == 0) { - bt_link_info->slave_role = false; + bt_link_info->slave_role = FALSE; cnt_slave = 0; } else cnt_slave--; @@ -426,19 +447,26 @@ void halbtc8723d1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) if ((coex_sta->low_priority_tx >= 1300) && (coex_sta->low_priority_rx <= 150)) { if (cnt_autoslot_hang >= 2) { - coex_sta->is_tdma_btautoslot_hang = true; + coex_sta->is_tdma_btautoslot_hang = TRUE; cnt_autoslot_hang = 2; } else cnt_autoslot_hang++; } else { if (cnt_autoslot_hang == 0) { - coex_sta->is_tdma_btautoslot_hang = false; + coex_sta->is_tdma_btautoslot_hang = FALSE; cnt_autoslot_hang = 0; } else cnt_autoslot_hang--; } } + if (bt_link_info->hid_only) { + if (coex_sta->low_priority_tx > 50) + coex_sta->is_hid_low_pri_tx_overhead = true; + else + coex_sta->is_hid_low_pri_tx_overhead = false; + } + if (!coex_sta->bt_disabled) { if ((coex_sta->high_priority_tx == 0) && @@ -457,43 +485,79 @@ void halbtc8723d1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) void halbtc8723d1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) { -#if 1 - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false, - wifi_scan = false; - boolean bt_idle = false, wl_idle = false; - static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, - wl_noisy_count1 = 3, wl_noisy_count2 = 0; - u32 total_cnt, reg_val1, reg_val2, cck_cnt; + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE, wifi_under_b_mode = FALSE, + wifi_scan = FALSE, wifi_connected = FALSE; + boolean bt_idle = FALSE, wl_idle = FALSE, is_cck_deadlock = FALSE; + static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, + wl_noisy_count1 = 3, wl_noisy_count2 = 0; + u32 total_cnt, reg_val1, reg_val2, cnt_cck; + u32 cnt_crcok = 0, cnt_crcerr = 0; + static u8 cnt = 0, cnt_ccklocking = 0; + u8 h2c_parameter[1] = {0}; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); + /*send h2c to query WL FW dbg info */ + if (((coex_dm->cur_ps_tdma_on) && (coex_sta->force_lps_ctrl)) || + ((coex_sta->acl_busy) && (bt_link_info->a2dp_exist))) { + h2c_parameter[0] = 0x8; + btcoexist->btc_fill_h2c(btcoexist, 0x69, 1, h2c_parameter); + } - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); - coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_CCK); - coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_LEGACY); - coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_HT); - coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_VHT); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); - coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); - coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); - coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_HT); - coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_VHT); + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); - cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); - if (cck_cnt > 250) { + cnt_crcok = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + + coex_sta->crc_ok_11n_vht; + + cnt_crcerr = coex_sta->crc_err_cck + coex_sta->crc_err_11g + + coex_sta->crc_err_11n + + coex_sta->crc_err_11n_vht; + + /* CCK lock identification */ + if (coex_sta->cck_lock) + cnt_ccklocking++; + else if (cnt_ccklocking != 0) + cnt_ccklocking--; + + if (cnt_ccklocking >= 3) { + cnt_ccklocking = 3; + coex_sta->cck_lock_ever = TRUE; + } + + /* WiFi environment noisy identification */ + cnt_cck = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + + if ((!wifi_busy) && (!coex_sta->cck_lock)) { + if (cnt_cck > 250) { if (wl_noisy_count2 < 3) wl_noisy_count2++; @@ -501,7 +565,8 @@ void halbtc8723d1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) wl_noisy_count0 = 0; wl_noisy_count1 = 0; } - } else if (cck_cnt < 50) { + + } else if (cnt_cck < 50) { if (wl_noisy_count0 < 3) wl_noisy_count0++; @@ -509,6 +574,7 @@ void halbtc8723d1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) wl_noisy_count1 = 0; wl_noisy_count2 = 0; } + } else { if (wl_noisy_count1 < 3) wl_noisy_count1++; @@ -517,7 +583,7 @@ void halbtc8723d1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) wl_noisy_count0 = 0; wl_noisy_count2 = 0; } - } + } if (wl_noisy_count2 == 3) coex_sta->wl_noisy_level = 2; @@ -525,94 +591,72 @@ void halbtc8723d1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) coex_sta->wl_noisy_level = 1; else coex_sta->wl_noisy_level = 0; + } - if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { - total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; - - if ((coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (total_cnt - - coex_sta->crc_ok_cck)) { - if (cck_lock_counter < 3) - cck_lock_counter++; - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - if (!coex_sta->pre_ccklock) { - - if (cck_lock_counter >= 3) - coex_sta->cck_lock = true; - else - coex_sta->cck_lock = false; - } else { - if (cck_lock_counter == 0) - coex_sta->cck_lock = false; - else - coex_sta->cck_lock = true; - } - - if (coex_sta->cck_lock) - coex_sta->cck_ever_lock = true; - - coex_sta->pre_ccklock = coex_sta->cck_lock; - -#endif } + + + void halbtc8723d1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - boolean bt_busy = false; + boolean bt_hs_on = FALSE; + boolean bt_busy = FALSE; + u32 val = 0; + static u8 pre_num_of_profile = 0, cur_num_of_profile = 0, cnt = 0; + if (coex_sta->is_ble_scan_toggle) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); + BTC_TRACE(trace_buf); + coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); + + if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) + coex_sta->bt_ble_scan_para[0] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); + if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) + coex_sta->bt_ble_scan_para[1] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); + if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) + coex_sta->bt_ble_scan_para[2] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); + } coex_sta->num_of_profile = 0; /* set link exist status */ if (!(coex_sta->bt_info & BT_INFO_8723D_1ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; + coex_sta->bt_link_exist = FALSE; + coex_sta->pan_exist = FALSE; + coex_sta->a2dp_exist = FALSE; + coex_sta->hid_exist = FALSE; + coex_sta->sco_exist = FALSE; } else { /* connection exists */ - coex_sta->bt_link_exist = true; + coex_sta->bt_link_exist = TRUE; if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_FTP) { - coex_sta->pan_exist = true; + coex_sta->pan_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->pan_exist = false; + coex_sta->pan_exist = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_A2DP) { - coex_sta->a2dp_exist = true; + coex_sta->a2dp_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->a2dp_exist = false; + coex_sta->a2dp_exist = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_HID) { - coex_sta->hid_exist = true; + coex_sta->hid_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->hid_exist = false; + coex_sta->hid_exist = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_SCO_ESCO) { - coex_sta->sco_exist = true; + coex_sta->sco_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->sco_exist = false; + coex_sta->sco_exist = FALSE; } @@ -627,8 +671,8 @@ void halbtc8723d1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) /* work around for HS mode. */ if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; + bt_link_info->pan_exist = TRUE; + bt_link_info->bt_link_exist = TRUE; } /* check if Sco only */ @@ -636,36 +680,36 @@ void halbtc8723d1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->sco_only = true; + bt_link_info->sco_only = TRUE; else - bt_link_info->sco_only = false; + bt_link_info->sco_only = FALSE; /* check if A2dp only */ if (!bt_link_info->sco_exist && bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->a2dp_only = true; + bt_link_info->a2dp_only = TRUE; else - bt_link_info->a2dp_only = false; + bt_link_info->a2dp_only = FALSE; /* check if Pan only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->pan_only = true; + bt_link_info->pan_only = TRUE; else - bt_link_info->pan_only = false; + bt_link_info->pan_only = FALSE; /* check if Hid only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && bt_link_info->hid_exist) - bt_link_info->hid_only = true; + bt_link_info->hid_only = TRUE; else - bt_link_info->hid_only = false; + bt_link_info->hid_only = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_1ANT_B_INQ_PAGE) { coex_dm->bt_status = BT_8723D_1ANT_BT_STATUS_INQ_PAGE; @@ -706,11 +750,53 @@ void halbtc8723d1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) if ((BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || (BT_8723D_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - bt_busy = true; + bt_busy = TRUE; else - bt_busy = false; + bt_busy = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + + cur_num_of_profile = coex_sta->num_of_profile; + + if (cur_num_of_profile != pre_num_of_profile) + cnt = 2; + + if (bt_link_info->a2dp_exist) { + + if (((coex_sta->bt_a2dp_vendor_id == 0) && + (coex_sta->bt_a2dp_device_name == 0)) || + (cur_num_of_profile != pre_num_of_profile)) { + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_DEVICE_INFO, &val); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), get BT DEVICE_INFO = %x\n", val); + BTC_TRACE(trace_buf); + + coex_sta->bt_a2dp_vendor_id = (u8)(val & 0xff); + coex_sta->bt_a2dp_device_name = (val & 0xffffff00) >> 8; + } + + if (((coex_sta->legacy_forbidden_slot == 0) && + (coex_sta->le_forbidden_slot == 0)) || + (cur_num_of_profile != pre_num_of_profile) || + (cnt > 0)) { + + if (cnt > 0) + cnt--; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_FORBIDDEN_SLOT_VAL, &val); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), get BT FORBIDDEN_SLOT_VAL = %x, cnt = %d\n", val, cnt); + BTC_TRACE(trace_buf); + + coex_sta->legacy_forbidden_slot = (u16)(val & 0xffff); + coex_sta->le_forbidden_slot = (u16)((val & 0xffff0000) >> 16); + } + } + + pre_num_of_profile = coex_sta->num_of_profile; } @@ -748,7 +834,7 @@ void halbtc8723d1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, u8 halbtc8723d1ant_action_algorithm(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; + boolean bt_hs_on = FALSE; u8 algorithm = BT_8723D_1ANT_COEX_ALGO_UNDEFINED; u8 num_of_diff_profile = 0; @@ -1031,18 +1117,27 @@ void halbtc8723d1ant_write_score_board( ) { - static u16 originalval = 0x8002; + static u16 originalval = 0x8002, preval = 0x0; if (state) originalval = originalval | bitpos; else originalval = originalval & (~bitpos); + coex_sta->score_board_WB = originalval; + if (originalval != preval) { + + preval = originalval; btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); - + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8723d1ant_write_score_board: return for nochange\n"); + BTC_TRACE(trace_buf); + } } + void halbtc8723d1ant_read_score_board( IN struct btc_coexist *btcoexist, IN u16 *score_board_val @@ -1070,11 +1165,14 @@ void halbtc8723d1ant_post_state_to_bt( boolean halbtc8723d1ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) { - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false, pre_bt_off = false, pre_bt_slave = false; + static boolean pre_wifi_busy = FALSE, pre_under_4way = FALSE, + pre_bt_hs_on = FALSE, pre_bt_off = FALSE, + pre_bt_slave = FALSE, pre_hid_low_pri_tx_overhead = FALSE, + pre_wifi_under_lps = FALSE, pre_bt_setup_link = FALSE, + pre_cck_lock = FALSE, pre_cck_lock_warn = FALSE; static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; + boolean wifi_busy = FALSE, under_4way = FALSE, bt_hs_on = FALSE; + boolean wifi_connected = FALSE; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, @@ -1104,7 +1202,11 @@ boolean halbtc8723d1ant_is_wifibt_status_changed(IN struct btc_coexist coex_sta->bt_ble_scan_para[2] = 0; coex_sta->bt_reg_vendor_ac = 0xffff; coex_sta->bt_reg_vendor_ae = 0xffff; - return true; + coex_sta->legacy_forbidden_slot = 0; + coex_sta->le_forbidden_slot = 0; + coex_sta->bt_a2dp_vendor_id = 0; + coex_sta->bt_a2dp_device_name = 0; + return TRUE; } if (wifi_connected) { @@ -1113,45 +1215,68 @@ boolean halbtc8723d1ant_is_wifibt_status_changed(IN struct btc_coexist if (wifi_busy) halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_UNDERTEST, true); + BT_8723D_1ANT_SCOREBOARD_UNDERTEST, TRUE); else halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_UNDERTEST, false); - return true; + BT_8723D_1ANT_SCOREBOARD_UNDERTEST, FALSE); + return TRUE; } if (under_4way != pre_under_4way) { pre_under_4way = under_4way; - return true; + return TRUE; } if (bt_hs_on != pre_bt_hs_on) { pre_bt_hs_on = bt_hs_on; - return true; + return TRUE; } if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { pre_wl_noisy_level = coex_sta->wl_noisy_level; - return true; + return TRUE; + } + if (coex_sta->under_lps != pre_wifi_under_lps) { + pre_wifi_under_lps = coex_sta->under_lps; + if (coex_sta->under_lps == TRUE) + return TRUE; + } + if (coex_sta->cck_lock != pre_cck_lock) { + pre_cck_lock = coex_sta->cck_lock; + return TRUE; + } + if (coex_sta->cck_lock_warn != pre_cck_lock_warn) { + pre_cck_lock_warn = coex_sta->cck_lock_warn; + return TRUE; } } if (!coex_sta->bt_disabled) { if (coex_sta->hid_busy_num != pre_hid_busy_num) { pre_hid_busy_num = coex_sta->hid_busy_num; - return true; + return TRUE; + } + + if (bt_link_info->slave_role != pre_bt_slave) { + pre_bt_slave = bt_link_info->slave_role; + return TRUE; + } + + if (pre_hid_low_pri_tx_overhead != coex_sta->is_hid_low_pri_tx_overhead) { + pre_hid_low_pri_tx_overhead = coex_sta->is_hid_low_pri_tx_overhead; + return TRUE; + } + + if (pre_bt_setup_link != coex_sta->is_setupLink) { + pre_bt_setup_link = coex_sta->is_setupLink; + return TRUE; } } - if (bt_link_info->slave_role != pre_bt_slave) { - pre_bt_slave = bt_link_info->slave_role; - return true; - } - - return false; + return FALSE; } void halbtc8723d1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) { static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; + boolean bt_active = TRUE, bt_disabled = FALSE; u16 u16tmp; /* This function check if bt is disabled */ @@ -1160,12 +1285,12 @@ void halbtc8723d1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) coex_sta->high_priority_rx == 0 && coex_sta->low_priority_tx == 0 && coex_sta->low_priority_rx == 0) - bt_active = false; + bt_active = FALSE; if (coex_sta->high_priority_tx == 0xffff && coex_sta->high_priority_rx == 0xffff && coex_sta->low_priority_tx == 0xffff && coex_sta->low_priority_rx == 0xffff) - bt_active = false; + bt_active = FALSE; #else @@ -1180,14 +1305,14 @@ void halbtc8723d1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) if (bt_active) { bt_disable_cnt = 0; - bt_disabled = false; + bt_disabled = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, &bt_disabled); } else { bt_disable_cnt++; if (bt_disable_cnt >= 2) { - bt_disabled = true; + bt_disabled = TRUE; bt_disable_cnt = 2; } @@ -1196,9 +1321,9 @@ void halbtc8723d1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) } if (bt_disabled) - halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); + halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); else - halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); + halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, TRUE); if (coex_sta->bt_disabled != bt_disabled) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -1257,12 +1382,8 @@ u32 halbtc8723d1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, { u32 j = 0, delay_count = 0; - - /* wait for ready bit before access 0x7c0 */ - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); - while (1) { - if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { delay_ms(50); delay_count++; if (delay_count >= 10) { @@ -1273,6 +1394,9 @@ u32 halbtc8723d1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, break; } + /* wait for ready bit before access 0x7c0 */ + btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); + return btcoexist->btc_read_4byte(btcoexist, 0x7c8); /* get read data */ @@ -1288,22 +1412,22 @@ void halbtc8723d1ant_ltecoex_indirect_write_reg(IN struct btc_coexist if (bit_mask == 0x0) return; if (bit_mask == 0xffffffff) { + /* wait for ready bit before access 0x7c0/0x7c4 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x7c4, reg_value); /* put write data */ - /* wait for ready bit before access 0x7c0 */ - while (1) { - if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { - delay_ms(50); - delay_count++; - if (delay_count >= 10) { - delay_count = 0; - break; - } - } else - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0xc00F0000 | reg_addr); } else { @@ -1319,22 +1443,22 @@ void halbtc8723d1ant_ltecoex_indirect_write_reg(IN struct btc_coexist reg_addr); val = (val & (~bit_mask)) | (reg_value << bitpos); + /* wait for ready bit before access 0x7c0/0x7c4 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x7c4, val); /* put write data */ - /* wait for ready bit before access 0x7c0 */ - while (1) { - if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { - delay_ms(50); - delay_count++; - if (delay_count >= 10) { - delay_count = 0; - break; - } - } else - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0xc00F0000 | reg_addr); @@ -1560,7 +1684,7 @@ void halbtc8723d1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, coex_sta->coex_table_type = type; - if (coex_sta->concurrent_rx_mode_on == true) { + if (coex_sta->concurrent_rx_mode_on == TRUE) { break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ select_table = 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ @@ -1569,60 +1693,94 @@ void halbtc8723d1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, select_table = 0x3; } - switch (type) { - case 0: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, break_table, - select_table); - break; - case 1: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 2: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0xaa5a5a5a, 0xaa5a5a5a, break_table, - select_table); - break; - case 3: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 4: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 5: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, break_table, - select_table); - break; - case 6: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 7: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0xaa555555, 0xaa555555, break_table, - select_table); - break; - case 8: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0xaaaaaaaa, break_table, - select_table); - break; - case 9: - halbtc8723d1ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaaaa5aaa, break_table, - select_table); - break; - default: - break; - } + switch (type) { + case 0: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555555, break_table, + select_table); + break; + case 1: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, + select_table); + break; + case 2: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xaa5a5a5a, 0xaa5a5a5a, break_table, + select_table); + break; + case 3: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, break_table, + select_table); + break; + case 4: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, + select_table); + break; + case 5: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0x5a5a5a5a, break_table, + select_table); + break; + case 6: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, + select_table); + break; + case 7: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xaa555555, 0xaa555555, break_table, + select_table); + break; + case 8: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaaaa5aaa, break_table, + select_table); + break; + case 9: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0xaaaa5aaa, break_table, + select_table); + break; + case 10: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xaaaaaaaa, 0xaaaaaaaa, break_table, + select_table); + break; + case 11: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xa5a55555, 0xaaaa5a5a, break_table, + select_table); + break; + case 12: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaaaa5a5a, break_table, + select_table); + break; + case 13: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xaa5555aa, 0xaa5a5a5a, break_table, + select_table); + break; + case 14: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xaa5555aa, 0x5a5a5a5a, break_table, + select_table); + break; + case 15: + halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0xaaaaaaaa, 0x5a5a5a5a, break_table, + select_table); + /* halbtc8723d1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, break_table, + select_table); + */ + break; + default: + break; + } } void halbtc8723d1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, @@ -1692,16 +1850,12 @@ void halbtc8723d1ant_ps_tdma_check_for_power_save_state( /* keep state under LPS, do nothing. */ } else { /* will leave LPS state, turn off psTdma first */ - /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); */ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); } } else { /* NO PS state */ if (new_ps_state) { /* will enter LPS state, turn off psTdma first */ - /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8);*/ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); } else { @@ -1713,28 +1867,28 @@ void halbtc8723d1ant_ps_tdma_check_for_power_save_state( void halbtc8723d1ant_power_save_state(IN struct btc_coexist *btcoexist, IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) { - boolean low_pwr_disable = false; + boolean low_pwr_disable = FALSE; switch (ps_type) { case BTC_PS_WIFI_NATIVE: /* recover to original 32k low power setting */ - coex_sta->force_lps_on = false; - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, + coex_sta->force_lps_ctrl = FALSE; + low_pwr_disable = FALSE; + /* btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + &low_pwr_disable); */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_PRE_NORMAL_LPS, NULL); break; case BTC_PS_LPS_ON: - coex_sta->force_lps_on = true; + coex_sta->force_lps_ctrl = TRUE; halbtc8723d1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); + btcoexist, TRUE); halbtc8723d1ant_lps_rpwm(btcoexist, NORMAL_EXEC, lps_val, rpwm_val); /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; + low_pwr_disable = TRUE; btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); @@ -1744,9 +1898,9 @@ void halbtc8723d1ant_power_save_state(IN struct btc_coexist *btcoexist, break; case BTC_PS_LPS_OFF: - coex_sta->force_lps_on = false; + coex_sta->force_lps_ctrl = TRUE; halbtc8723d1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); + btcoexist, FALSE); btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, NULL); @@ -1762,13 +1916,14 @@ void halbtc8723d1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[5] = {0}; u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; + boolean ap_enable = FALSE; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 ps_type = BTC_PS_WIFI_NATIVE; if (byte5 & BIT(2)) - coex_sta->is_tdma_btautoslot = true; + coex_sta->is_tdma_btautoslot = TRUE; else - coex_sta->is_tdma_btautoslot = false; + coex_sta->is_tdma_btautoslot = FALSE; /* release bt-auto slot for auto-slot hang is detected!! */ if (coex_sta->is_tdma_btautoslot) @@ -1779,33 +1934,33 @@ void halbtc8723d1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], FW for AP mode\n"); - BTC_TRACE(trace_buf); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], FW for AP mode\n"); + BTC_TRACE(trace_buf); + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); - halbtc8723d1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8723d1ant_power_save_state(btcoexist, + ps_type, 0x0, + 0x0); } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + ps_type = BTC_PS_LPS_ON; halbtc8723d1ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, + btcoexist, ps_type, 0x50, 0x4); } else { - halbtc8723d1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8723d1ant_power_save_state(btcoexist, ps_type, 0x0, 0x0); } - h2c_parameter[0] = real_byte1; h2c_parameter[1] = byte2; h2c_parameter[2] = byte3; @@ -1819,6 +1974,9 @@ void halbtc8723d1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, coex_dm->ps_tdma_para[4] = real_byte5; btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + + if (ps_type == BTC_PS_WIFI_NATIVE) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_POST_NORMAL_LPS, NULL); } @@ -1827,9 +1985,9 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; - static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; - static boolean pre_wifi_busy = false; + boolean wifi_busy = FALSE; + static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; + static boolean pre_wifi_busy = FALSE; #if BT_8723D_1ANT_ANTDET_ENABLE @@ -1850,7 +2008,7 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); if (wifi_busy != pre_wifi_busy) { - force_exec = true; + force_exec = TRUE; pre_wifi_busy = wifi_busy; } @@ -1862,7 +2020,7 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { - force_exec = true; + force_exec = TRUE; pre_psTdmaByte4Modify = psTdmaByte4Modify; } @@ -1896,7 +2054,7 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 3: halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x3a, 0x03, 0x10, 0x50); + 0x51, 0x30, 0x03, 0x10, 0x50); break; case 4: halbtc8723d1ant_set_fw_pstdma(btcoexist, @@ -1904,7 +2062,7 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 5: halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x11); + 0x61, 0x3a, 0x03, 0x11, 0x11); break; case 6: halbtc8723d1ant_set_fw_pstdma(btcoexist, @@ -1922,7 +2080,7 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 9: halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x55, 0x10, 0x03, 0x10, 0x54 | + 0x51, 0x10, 0x03, 0x10, 0x54 | psTdmaByte4Modify); break; case 10: @@ -1931,23 +2089,23 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 11: halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x65, 0x25, 0x03, 0x11, 0x11 | + 0x61, 0x25, 0x03, 0x11, 0x11 | psTdmaByte4Modify); break; case 12: halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x55, 0x30, 0x03, 0x10, 0x50 | + 0x51, 0x35, 0x03, 0x10, 0x50 | psTdmaByte4Modify); break; case 13: halbtc8723d1ant_set_fw_pstdma(btcoexist, - 0x51, 0x25, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); + 0x51, 0x10, 0x07, 0x10, 0x54 | + psTdmaByte4Modify); break; case 14: halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x51, 0x15, 0x03, 0x10, 0x50 | - psTdmaByte4Modify); + psTdmaByte4Modify); break; case 15: halbtc8723d1ant_set_fw_pstdma(btcoexist, @@ -1988,10 +2146,23 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x61, 0x10, 0x03, 0x11, 0x10); break; + case 24: + halbtc8723d1ant_set_fw_pstdma(btcoexist, + 0x51, 0x08, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 25: + halbtc8723d1ant_set_fw_pstdma(btcoexist, + 0x51, 0x3a, 0x03, 0x11, 0x50); + break; case 27: halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x61, 0x10, 0x03, 0x11, 0x15); break; + case 28: + halbtc8723d1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x0b, 0x10, 0x54); + break; case 32: halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x61, 0x35, 0x03, 0x11, 0x11); @@ -2000,6 +2171,10 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x61, 0x35, 0x03, 0x11, 0x10); break; + case 36: + halbtc8723d1ant_set_fw_pstdma(btcoexist, + 0x61, 0x48, 0x03, 0x11, 0x10); + break; case 57: halbtc8723d1ant_set_fw_pstdma(btcoexist, 0x51, 0x10, 0x03, 0x10, 0x50 | @@ -2107,7 +2282,6 @@ void halbtc8723d1ant_ps_tdma(IN struct btc_coexist *btcoexist, } } - /* update pre state */ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; } @@ -2119,7 +2293,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, { struct btc_board_info *board_info = &btcoexist->board_info; u32 cnt_bt_cal_chk = 0; - boolean is_in_mp_mode = false, is_hw_ant_div_on = false; + boolean is_in_mp_mode = FALSE, is_hw_ant_div_on = FALSE; u8 u8tmp0 = 0, u8tmp1 = 0; u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; u16 u16tmp0, u16tmp1 = 0; @@ -2144,7 +2318,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, /* To avoid indirect access fail */ if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { - force_exec = true; + force_exec = TRUE; coex_sta->gnt_error_cnt++; } @@ -2204,7 +2378,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_BT; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; case BT_8723D_1ANT_PHASE_COEX_INIT: @@ -2263,7 +2437,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_BT; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; case BT_8723D_1ANT_PHASE_WLANONLY_INIT: /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ @@ -2299,7 +2473,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_WIFI; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; case BT_8723D_1ANT_PHASE_WLAN_OFF: /* Disable LTE Coex Function in WiFi side */ @@ -2313,10 +2487,12 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, BT_8723D_1ANT_PCO_BTSIDE); + /*halbtc8723d1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, TRUE);*/ + if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_BT; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; case BT_8723D_1ANT_PHASE_2G_RUNTIME: @@ -2367,7 +2543,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_PTA; - coex_sta->run_time_state = true; + coex_sta->run_time_state = TRUE; break; case BT_8723D_1ANT_PHASE_BTMPMODE: halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, @@ -2391,7 +2567,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_BT; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; case BT_8723D_1ANT_PHASE_ANTENNA_DET: halbtc8723d1ant_ltecoex_pathcontrol_owner(btcoexist, @@ -2415,7 +2591,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_BT; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; } @@ -2431,7 +2607,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, else /* 0x948 = 0x80, 0x0 while antenna diversity */ btcoexist->btc_write_2byte(btcoexist, 0x948, 0x40); - else if ((is_hw_ant_div_on == false) && + else if ((is_hw_ant_div_on == FALSE) && (phase != BT_8723D_1ANT_PHASE_WLAN_OFF)) { /* internal switch setting */ switch (ant_pos_type) { @@ -2497,7 +2673,7 @@ void halbtc8723d1ant_set_ant_path(IN struct btc_coexist *btcoexist, boolean halbtc8723d1ant_is_common_action(IN struct btc_coexist *btcoexist) { - boolean common = false, wifi_connected = false, wifi_busy = false; + boolean common = FALSE, wifi_connected = FALSE, wifi_busy = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); @@ -2509,35 +2685,35 @@ boolean halbtc8723d1ant_is_common_action(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); BTC_TRACE(trace_buf); - common = true; + common = TRUE; } else if (wifi_connected && (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected + BT non connected-idle!!\n"); BTC_TRACE(trace_buf); - common = true; + common = TRUE; } else if (!wifi_connected && (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); BTC_TRACE(trace_buf); - common = true; + common = TRUE; } else if (wifi_connected && (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected + BT connected-idle!!\n"); BTC_TRACE(trace_buf); - common = true; + common = TRUE; } else if (!wifi_connected && (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); BTC_TRACE(trace_buf); - common = true; + common = TRUE; } else { if (wifi_busy) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -2549,7 +2725,7 @@ boolean halbtc8723d1ant_is_common_action(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); } - common = false; + common = FALSE; } return common; @@ -2563,34 +2739,39 @@ boolean halbtc8723d1ant_is_common_action(IN struct btc_coexist *btcoexist) * ********************************************* */ void halbtc8723d1ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8723D_1ANT_PHASE_2G_RUNTIME); halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); } void halbtc8723d1ant_action_bt_hs(IN struct btc_coexist *btcoexist) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } void halbtc8723d1ant_action_bt_relink(IN struct btc_coexist *btcoexist) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - coex_sta->bt_relink_downcount = 2; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if (((!coex_sta->is_bt_multi_link) && (!bt_link_info->pan_exist)) || + ((bt_link_info->a2dp_exist) && (bt_link_info->hid_exist))) { + + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); + } } void halbtc8723d1ant_action_bt_idle(IN struct btc_coexist *btcoexist) { - boolean wifi_busy = false; + boolean wifi_busy = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); if (!wifi_busy) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { /* if wl busy */ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == @@ -2598,10 +2779,10 @@ void halbtc8723d1ant_action_bt_idle(IN struct btc_coexist *btcoexist) halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); } else { halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); } } @@ -2610,8 +2791,8 @@ void halbtc8723d1ant_action_bt_idle(IN struct btc_coexist *btcoexist) void halbtc8723d1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, wifi_busy = false, bt_busy = false; - boolean wifi_scan = false, wifi_link = false, wifi_roam = false; + boolean wifi_connected = FALSE, wifi_busy = FALSE, bt_busy = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); @@ -2624,7 +2805,7 @@ void halbtc8723d1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) - || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { + || (wifi_scan) || (coex_sta->wifi_is_high_pri_task))) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); @@ -2633,34 +2814,33 @@ void halbtc8723d1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 17); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 17); else - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); } else if ((!wifi_connected) && (!wifi_scan)) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); } else if (bt_link_info->pan_exist) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); } else if (bt_link_info->a2dp_exist) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); } else { - if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) - || (coex_sta->wifi_is_high_pri_task)) - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - else - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if ((wifi_link) || (wifi_roam) || (wifi_scan) || + (coex_sta->wifi_is_high_pri_task)) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + else + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 23); } } @@ -2669,93 +2849,132 @@ void halbtc8723d1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, wifi_busy = false; + boolean wifi_connected = FALSE, wifi_busy = FALSE, wifi_cckdeadlock_ap = FALSE; u32 wifi_bw = 1; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, - &wifi_bw); - + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + if ((iot_peer == BTC_IOT_PEER_ATHEROS) && (coex_sta->cck_lock_ever)) + wifi_cckdeadlock_ap = TRUE; if (bt_link_info->sco_exist) { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 5); - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 5); - } else if (coex_sta->hid_busy_num >= 2) { - /*for 4/18 hid */ - /* if 11bg mode */ - if (wifi_bw == 0) { - - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 11); + if (coex_sta->is_bt_multi_link) { + if (coex_sta->specific_pkt_period_cnt > 0) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 25); } else { - - if (wifi_busy) { - - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 11); - } else { - - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 6); - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 3); - - } + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } + } else if (coex_sta->is_hid_rcu) { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + + if (wifi_busy) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 36); + else + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 6); - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 3); + + if ((wifi_cckdeadlock_ap) && (coex_sta->is_hid_low_pri_tx_overhead)) { + + if (coex_sta->hid_busy_num < 2) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 18); + } else if (coex_sta->is_hid_low_pri_tx_overhead) { + if (coex_sta->hid_busy_num < 2) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 18); + } else if (coex_sta->hid_busy_num < 2) { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } else if (wifi_bw == 0) { /* if 11bg mode */ + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } else { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } } } void halbtc8723d1ant_action_wifi_only(IN struct btc_coexist *btcoexist) { - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, BT_8723D_1ANT_PHASE_2G_RUNTIME); - halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 10); + halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); +} + +void halbtc8723d1ant_action_wifi_native_lps(IN struct btc_coexist *btcoexist) +{ + halbtc8723d1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 5); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + +void halbtc8723d1ant_action_wifi_cck_dead_lock(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if ((bt_link_info->hid_exist) && (bt_link_info->a2dp_exist) && + (!bt_link_info->pan_exist)) { + + if ((coex_sta->cck_lock) || (coex_sta->cck_lock_warn)) { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 28); + } else { + + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } + } } void halbtc8723d1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 multi_port_type; - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8723D_1ANT_PHASE_2G_RUNTIME); - if ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) || - (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status)) - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - else if (!bt_link_info->pan_exist) - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - else - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_DUAL_BAND_CONNECTED, &multi_port_type); + + if (multi_port_type == BTC_MULTIPORT_SCC) { + if (bt_link_info->a2dp_exist) { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 17); + } else if (bt_link_info->pan_exist) { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + } else { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } + } else { + if ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) || + (BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + else if (!bt_link_info->pan_exist) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } } void halbtc8723d1ant_action_wifi_linkscan_process(IN struct btc_coexist @@ -2763,215 +2982,161 @@ void halbtc8723d1ant_action_wifi_linkscan_process(IN struct btc_coexist { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - if (bt_link_info->pan_exist) { + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - } else if (bt_link_info->a2dp_exist) { - - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 27); - - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } + if (bt_link_info->pan_exist) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + else if (bt_link_info->a2dp_exist) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 27); + else + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); } void halbtc8723d1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist *btcoexist) { - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false, wifi_turbo = false; - u32 wifi_bw = 1; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = FALSE, wifi_turbo = FALSE, wifi_cckdeadlock_ap = FALSE; + u32 wifi_bw = 1; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], scan_ap_num = %d, wl_noisy_level = %d\n", - coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + "############# [BTCoex], scan_ap_num = %d, wl_noisy_level = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); BTC_TRACE(trace_buf); -#if 1 if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; -#endif + wifi_turbo = TRUE; - if ((coex_sta->bt_relink_downcount != 0) - && (!bt_link_info->pan_exist) && (wifi_busy)) { + if ((iot_peer == BTC_IOT_PEER_ATHEROS) && (coex_sta->cck_lock_ever)) + wifi_cckdeadlock_ap = TRUE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); - BTC_TRACE(trace_buf); + if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { - /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32);*/ - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + if (wifi_cckdeadlock_ap) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 12); } else if (bt_link_info->a2dp_only) { /* A2DP */ - if (!wifi_busy) { - /*halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32);*/ - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 27); - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - if (coex_sta->wl_noisy_level == 2) - halbtc8723d1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 17); - else - halbtc8723d1ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 7); + if (wifi_cckdeadlock_ap) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else if (wifi_turbo) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - if (wifi_turbo) - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - else - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); } else if (((bt_link_info->a2dp_exist) && - (bt_link_info->pan_exist)) || - (bt_link_info->hid_exist && bt_link_info->a2dp_exist && + (bt_link_info->pan_exist)) || + (bt_link_info->hid_exist && bt_link_info->a2dp_exist && bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ - if ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num >= 2)) { - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - if (wifi_bw == 0) /* 11bg mode */ - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); + if (wifi_cckdeadlock_ap) { + if ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num < 2)) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); else - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 12); - } else if (wifi_busy) { - if (((coex_sta->a2dp_bit_pool > 40) && - (coex_sta->a2dp_bit_pool < 255)) || - (!coex_sta->is_A2DP_3M)) - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 15); - else if (wifi_turbo) - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 18); + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + } else if (bt_link_info->hid_exist) { + if (coex_sta->hid_busy_num < 2) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); else - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 13); - } else - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - - if (bt_link_info->hid_exist) halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - else if (wifi_turbo) - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); + } else if (wifi_turbo) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); else - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 13); + else + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 14); } else if (bt_link_info->hid_exist && bt_link_info->a2dp_exist) { /* HID+A2DP */ - if ((wifi_busy) && (coex_sta->hid_busy_num >= 2)) { /*for 4/18 hid */ - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - if (wifi_bw == 0) /* 11bg mode */ - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - else - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 9); - } else { - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 8); - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } + if (wifi_cckdeadlock_ap) { +#if 1 + if (coex_sta->hid_busy_num < 2) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + + if (coex_sta->hid_pair_cnt > 1) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 24); + else + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); +#endif + +#if 0 + halbtc8723d1ant_action_wifi_cck_dead_lock(btcoexist); +#endif + } else { + if (coex_sta->hid_busy_num < 2) /* 2/18 HID */ + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + else if (wifi_bw == 0)/* if 11bg mode */ + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 12); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + + if (coex_sta->hid_pair_cnt > 1) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 24); + else + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } } else if ((bt_link_info->pan_only) - || (bt_link_info->hid_exist && bt_link_info->pan_exist)) { - /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ + || (bt_link_info->hid_exist && bt_link_info->pan_exist)) { + /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ - if ((bt_link_info->hid_exist) && (bt_link_info->pan_exist) && - (coex_sta->hid_busy_num >= 2)) { - - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - if (wifi_bw == 0) /* 11bg mode */ - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - else - halbtc8723d1ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 12); - } else { - if (!wifi_busy) - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); + if (coex_sta->cck_lock_ever) { + if ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num < 2)) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); else - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 3); - - if (bt_link_info->hid_exist) - halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - else if (wifi_turbo) - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + } else if (bt_link_info->hid_exist) { + if (coex_sta->hid_busy_num < 2) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); else - halbtc8723d1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + } else if (wifi_turbo) + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + else + halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (!wifi_busy) + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 4); + else + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 3); } else { /* BT no-profile busy (0x9) */ - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); } + } + void halbtc8723d1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) { - /* tdma and coex table */ - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8723D_1ANT_PHASE_2G_RUNTIME); + /* tdma and coex table */ halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); } void halbtc8723d1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CoexForWifiConnect()===>\n"); @@ -2981,20 +3146,18 @@ void halbtc8723d1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) NORMAL_EXEC, BT_8723D_1ANT_PHASE_2G_RUNTIME); - if (BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + if ((coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY)) { if (bt_link_info->hid_only) /* HID only */ halbtc8723d1ant_action_bt_sco_hid_only_busy(btcoexist); else halbtc8723d1ant_action_wifi_connected_bt_acl_busy(btcoexist); - } else if ((BT_8723D_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8723d1ant_action_bt_sco_hid_only_busy(btcoexist); - } else - halbtc8723d1ant_action_bt_idle(btcoexist); + } else if (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_SCO_BUSY) + halbtc8723d1ant_action_bt_sco_hid_only_busy(btcoexist); + else + halbtc8723d1ant_action_bt_idle(btcoexist); } @@ -3073,15 +3236,15 @@ void halbtc8723d1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - boolean increase_scan_dev_num = false; - boolean bt_ctrl_agg_buf_size = false; - boolean miracast_plus_bt = false, wifi_under_5g = false; + boolean wifi_connected = FALSE, bt_hs_on = FALSE; + boolean increase_scan_dev_num = FALSE; + boolean bt_ctrl_agg_buf_size = FALSE; + boolean miracast_plus_bt = FALSE, wifi_under_5g = FALSE; u8 agg_buf_size = 5; u32 wifi_link_status = 0; u32 num_of_wifi_link = 0, wifi_bw; u8 iot_peer = BTC_IOT_PEER_UNKNOWN; - boolean scan = false, link = false, roam = false, under_4way = false; + boolean scan = FALSE, link = FALSE, roam = FALSE, under_4way = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); @@ -3093,6 +3256,11 @@ void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) "[BTCoex], RunCoexistMechanism()===>\n"); BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], under_lps = %d, force_lps_ctrl = %d, acl_busy = %d!!!\n", + coex_sta->under_lps, coex_sta->force_lps_ctrl, coex_sta->acl_busy); + BTC_TRACE(trace_buf); + if (btcoexist->manual_control) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); @@ -3116,18 +3284,27 @@ void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) if (!coex_sta->run_time_state) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], return for run_time_state = false !!!\n"); + "[BTCoex], return for run_time_state = FALSE !!!\n"); BTC_TRACE(trace_buf); return; } if (coex_sta->freeze_coexrun_by_btinfo) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); + "[BTCoex], return for freeze_coexrun_by_btinfo\n"); BTC_TRACE(trace_buf); return; } + if ((coex_sta->under_lps) && (!coex_sta->force_lps_ctrl) && + (!coex_sta->acl_busy)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); + BTC_TRACE(trace_buf); + halbtc8723d1ant_action_wifi_native_lps(btcoexist); + return; + } + if (coex_sta->bt_whck_test) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BT is under WHCK TEST!!!\n"); @@ -3151,17 +3328,18 @@ void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) return; } - if (coex_sta->is_setupLink) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is re-link !!!\n"); - halbtc8723d1ant_action_bt_relink(btcoexist); - return; + if ((coex_sta->is_setupLink) && + (coex_sta->bt_relink_downcount != 0)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is re-link !!!\n"); + halbtc8723d1ant_action_bt_relink(btcoexist); + return; } if ((BT_8723D_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || (BT_8723D_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || (BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - increase_scan_dev_num = true; + increase_scan_dev_num = TRUE; btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, &increase_scan_dev_num); @@ -3178,23 +3356,24 @@ void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) num_of_wifi_link, wifi_link_status); BTC_TRACE(trace_buf); - if (bt_link_info->bt_link_exist) - miracast_plus_bt = true; - else - miracast_plus_bt = false; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - - halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - false, 0x5); - +#if 0 + halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + FALSE, 0x5); +#endif if (scan || link || roam || under_4way) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", scan, link, roam, under_4way); BTC_TRACE(trace_buf); + if (bt_link_info->bt_link_exist) + miracast_plus_bt = TRUE; + else + miracast_plus_bt = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); BTC_TRACE(trace_buf); @@ -3205,11 +3384,6 @@ void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) halbtc8723d1ant_action_wifi_multi_port(btcoexist); return; - } else { - - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); } btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); @@ -3224,13 +3398,11 @@ void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) if (BTC_WIFI_BW_HT40 == wifi_bw) halbtc8723d1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x10); + NORMAL_EXEC, FALSE, TRUE, 0x10); else halbtc8723d1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x8); - } else - halbtc8723d1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); + NORMAL_EXEC, FALSE, TRUE, 0x8); + } } halbtc8723d1ant_run_sw_coexist_mechanism( @@ -3287,7 +3459,7 @@ void halbtc8723d1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) void halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) { /* force to reset coex mechanism */ - halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); + halbtc8723d1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Coex Mechanism Init!!\n"); @@ -3350,6 +3522,7 @@ void halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, coex_sta->isolation_btween_wb = BT_8723D_1ANT_DEFAULT_ISOLATION; coex_sta->gnt_error_cnt = 0; coex_sta->bt_relink_downcount = 0; + coex_sta->wl_rx_rate = BTC_UNKNOWN; for (i = 0; i <= 9; i++) coex_sta->bt_afh_map[i] = 0; @@ -3358,6 +3531,15 @@ void halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, 0xf1) & 0xf0) >> 4; + if (coex_sta->cut_version >= 0x3) + halbtc8723d1ant_post_state_to_bt(btcoexist, + BT_8723D_1ANT_SCOREBOARD_DKTOPP2M, + TRUE); + else + halbtc8723d1ant_post_state_to_bt(btcoexist, + BT_8723D_1ANT_SCOREBOARD_DKTOPP2M, + FALSE); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, 0x1); /* enable TBTT nterrupt */ @@ -3374,35 +3556,46 @@ void halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, /* Enable PTA (tx/rx signal form WiFi side) */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); - halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, true); + halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, TRUE); #if 0 /* check if WL firmware download ok */ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, true); + BT_8723D_1ANT_SCOREBOARD_ONOFF, TRUE); #endif /* PTA parameter */ - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - psd_scan->ant_det_is_ant_det_available = true; + halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); + + psd_scan->ant_det_is_ant_det_available = TRUE; /* Antenna config */ - if (wifi_only) { - coex_sta->concurrent_rx_mode_on = false; + if (coex_sta->is_rf_state_off) { + + halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8723D_1ANT_PHASE_WLAN_OFF); + + btcoexist->stop_coex_dm = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** halbtc8723d1ant_init_hw_config (RF Off)**********\n"); + BTC_TRACE(trace_buf); + } else if (wifi_only) { + coex_sta->concurrent_rx_mode_on = FALSE; halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, BT_8723D_1ANT_PHASE_WLANONLY_INIT); - btcoexist->stop_coex_dm = true; + btcoexist->stop_coex_dm = TRUE; } else { /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - coex_sta->concurrent_rx_mode_on = true; + coex_sta->concurrent_rx_mode_on = TRUE; btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x1, 0x0); @@ -3410,7 +3603,7 @@ void halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, FORCE_EXEC, BT_8723D_1ANT_PHASE_COEX_INIT); - btcoexist->stop_coex_dm = false; + btcoexist->stop_coex_dm = FALSE; } if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { @@ -3929,7 +4122,7 @@ boolean halbtc8723d1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, u32 points1 = 0, psd_report = 0; u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; u32 psd_center_freq = 20 * 10 ^ 6; - boolean outloop = false, scan , roam, is_sweep_ok = true; + boolean outloop = FALSE, scan, roam, is_sweep_ok = TRUE; u8 flag = 0; u32 tmp = 0, u32tmp1 = 0; u32 wifi_original_channel = 1; @@ -4074,7 +4267,7 @@ boolean halbtc8723d1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); if (scan || roam) { - is_sweep_ok = false; + is_sweep_ok = FALSE; break; } memset(psd_scan->psd_report, 0, @@ -4202,7 +4395,7 @@ boolean halbtc8723d1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, break; case 99: /* error */ - outloop = true; + outloop = TRUE; break; case 100: /* recovery */ @@ -4236,7 +4429,7 @@ boolean halbtc8723d1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, 0x3ff, wifi_original_channel); - outloop = true; + outloop = TRUE; break; } @@ -4265,7 +4458,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; u8 state = 0; - boolean outloop = false, bt_resp = false, ant_det_finish = false; + boolean outloop = FALSE, bt_resp = FALSE, ant_det_finish = FALSE; u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, u32tmp, u32tmp0, u32tmp1, u32tmp2 ; struct btc_board_info *board_info = &btcoexist->board_info; @@ -4307,7 +4500,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", bt_le_channel); BTC_TRACE(trace_buf); - outloop = true; + outloop = TRUE; break; } } @@ -4336,20 +4529,20 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist break; case 1: /* stop coex DM & set antenna path */ /* Stop Coex DM */ - btcoexist->stop_coex_dm = true; + btcoexist->stop_coex_dm = TRUE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); BTC_TRACE(trace_buf); - /* Set TDMA off, */ - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, - false, 0); - /* Set coex table */ halbtc8723d1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + /* Set TDMA off, */ + halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, + FALSE, 0); + if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -4404,7 +4597,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist wlpsd_cent_freq, wlpsd_offset, wlpsd_span, BT_8723D_1ANT_ANTDET_PSD_POINTS, BT_8723D_1ANT_ANTDET_PSD_AVGNUM, 3)) { - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; psd_scan->ant_det_result = 8; state = 99; @@ -4424,7 +4617,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist BT_8723D_1ANT_ANTDET_PSDTHRES_BACKGROUND + psd_scan->ant_det_thres_offset); BTC_TRACE(trace_buf); - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; psd_scan->ant_det_result = 5; state = 99; @@ -4454,7 +4647,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist BT_8723D_1ANT_ANTDET_PSD_POINTS, BT_8723D_1ANT_ANTDET_PSD_AVGNUM, BT_8723D_1ANT_ANTDET_PSD_SWWEEPCOUNT)) { - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; psd_scan->ant_det_result = 8; state = 99; @@ -4535,13 +4728,13 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist "%d.%d", psd_rep1, psd_rep2); } - psd_scan->ant_det_is_btreply_available = true; + psd_scan->ant_det_is_btreply_available = TRUE; - if (bt_resp == false) { + if (bt_resp == FALSE) { psd_scan->ant_det_is_btreply_available = - false; + FALSE; psd_scan->ant_det_result = 0; - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); @@ -4550,7 +4743,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) * 100) { psd_scan->ant_det_result = 1; - ant_det_finish = true; + ant_det_finish = TRUE; board_info->btdm_ant_num_by_ant_det = 2; coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->ant_det_psd_scan_peak_val / @@ -4562,7 +4755,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist (BT_8723D_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION + psd_scan->ant_det_thres_offset) * 100) { psd_scan->ant_det_result = 2; - ant_det_finish = true; + ant_det_finish = TRUE; board_info->btdm_ant_num_by_ant_det = 2; coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->ant_det_psd_scan_peak_val / @@ -4574,7 +4767,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist (BT_8723D_1ANT_ANTDET_PSDTHRES_1ANT) * 100) { psd_scan->ant_det_result = 3; - ant_det_finish = true; + ant_det_finish = TRUE; board_info->btdm_ant_num_by_ant_det = 1; coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->ant_det_psd_scan_peak_val / @@ -4584,7 +4777,7 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist BTC_TRACE(trace_buf); } else { psd_scan->ant_det_result = 4; - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); @@ -4618,13 +4811,13 @@ boolean halbtc8723d1ant_psd_antenna_detection(IN struct btc_coexist "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; + btcoexist->stop_coex_dm = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); BTC_TRACE(trace_buf); - outloop = true; + outloop = TRUE; break; } @@ -4643,7 +4836,7 @@ boolean halbtc8723d1ant_psd_antenna_detection_check(IN struct btc_coexist static u32 ant_det_count = 0, ant_det_fail_count = 0; struct btc_board_info *board_info = &btcoexist->board_info; - boolean scan, roam, ant_det_finish = false; + boolean scan, roam, ant_det_finish = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); @@ -4653,20 +4846,20 @@ boolean halbtc8723d1ant_psd_antenna_detection_check(IN struct btc_coexist psd_scan->ant_det_try_count = ant_det_count; if (scan || roam) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 6; } else if (coex_sta->bt_disabled) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 11; } else if (coex_sta->num_of_profile >= 1) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 7; } else if ( !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 9; } else if (coex_sta->c2h_bt_inquiry_page) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 10; } else { @@ -4687,7 +4880,7 @@ boolean halbtc8723d1ant_psd_antenna_detection_check(IN struct btc_coexist "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", psd_scan->ant_det_result, psd_scan->ant_det_fail_count, - ant_det_finish == true ? "Yes" : "No"); + ant_det_finish == TRUE ? "Yes" : "No"); BTC_TRACE(trace_buf); return ant_det_finish; @@ -4719,8 +4912,9 @@ void ex_halbtc8723d1ant_power_on_setting(IN struct btc_coexist *btcoexist) board_info->btdm_ant_num_by_ant_det); BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = true; - psd_scan->ant_det_is_ant_det_available = false; + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = FALSE; + psd_scan->ant_det_is_ant_det_available = FALSE; /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); @@ -4771,7 +4965,7 @@ void ex_halbtc8723d1ant_power_on_setting(IN struct btc_coexist *btcoexist) btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, true); + halbtc8723d1ant_enable_gnt_to_gpio(btcoexist, TRUE); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", @@ -4793,7 +4987,7 @@ void ex_halbtc8723d1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) void ex_halbtc8723d1ant_init_hw_config(IN struct btc_coexist *btcoexist, IN boolean wifi_only) { - halbtc8723d1ant_init_hw_config(btcoexist, true, wifi_only); + halbtc8723d1ant_init_hw_config(btcoexist, TRUE, wifi_only); } void ex_halbtc8723d1ant_init_coex_dm(IN struct btc_coexist *btcoexist) @@ -4812,9 +5006,9 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) u32 u32tmp[4]; u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; - static u8 pop_report_in_10s = 0; + static u8 pop_report_in_10s = 0, cnt = 0; u32 phyver = 0; - boolean lte_coex_on = false; + boolean lte_coex_on = FALSE; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -4837,6 +5031,41 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); } + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + if (psd_scan->ant_det_try_count == 0) { CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", "Ant PG Num/ Mech/ Pos", @@ -4924,12 +5153,12 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) pop_report_in_10s++; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", - "BT [status/ rssi/ retryCnt/ popCnt]", + "\r\n %-35s = %s/ %ddBm/ %d/ %d", + "BT status/ rssi/ retryCnt/ popCnt", ((coex_sta->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") + coex_sta->c2h_bt_inquiry_page) ? ("inquiry-page") : ((BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : + coex_dm->bt_status) ? "non-connected-idle" : ((BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) ? "connected-idle" : "busy")))), coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, @@ -4943,19 +5172,23 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) if (coex_sta->num_of_profile != 0) CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s%s%s%s%s", - "Profiles", - ((bt_link_info->a2dp_exist) ? "A2DP," : ""), - ((bt_link_info->sco_exist) ? "SCO," : ""), - ((bt_link_info->hid_exist) ? - ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : - "HID(2/18),") : ""), - ((bt_link_info->pan_exist) ? "PAN," : ""), - ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + "\r\n %-35s = %s%s%s%s%s (multilink = %d)", + "Profiles", + ((bt_link_info->a2dp_exist) ? + ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : + "A2DP,") : ""), + ((bt_link_info->sco_exist) ? "HFP," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->is_hid_rcu) ? "HID(RCU)" : + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : + "HID(2/18),")) : ""), + ((bt_link_info->pan_exist) ? + ((coex_sta->is_bt_opp_exist) ? "OPP," : "PAN,") : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : ""), + coex_sta->is_bt_multi_link); else CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = None", - "Profiles"); + "\r\n %-35s = None", "Profiles"); CL_PRINTF(cli_buf); @@ -4967,13 +5200,21 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) ((coex_sta->is_autoslot) ? "On" : "Off") ); CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %d/ %d", + "V_ID/D_name/FBSlot_Legacy/FBSlot_Le", + coex_sta->bt_a2dp_vendor_id, + coex_sta->bt_a2dp_device_name, + coex_sta->legacy_forbidden_slot, + coex_sta->le_forbidden_slot + ); + CL_PRINTF(cli_buf); } if (bt_link_info->hid_exist) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "HID PairNum/Forbid_Slot", - coex_sta->hid_pair_cnt, - coex_sta->forbidden_slot + coex_sta->hid_pair_cnt ); CL_PRINTF(cli_buf); } @@ -5014,20 +5255,20 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) if ((coex_sta->bt_reg_vendor_ae == 0xffff) || (coex_sta->bt_reg_vendor_ac == 0xffff)) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", - "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ 0x%04x", + "0xae[4]/0xac[1:0]/Scoreboard(B->W)", u16tmp[0]); else CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ %04x", - "0xae[4]/0xac[1:0]/Scoreboard", - (unsigned int)((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), + "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x", + "0xae[4]/0xac[1:0]/Scoreboard(B->W)", + ((unsigned int)(coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); CL_PRINTF(cli_buf); if (coex_sta->num_of_profile > 0) { CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", + "\r\n %-35s = %02x%02x%02x%02x %02x%02x%02x%02x %02x %02x", "AFH MAP", coex_sta->bt_afh_map[0], coex_sta->bt_afh_map[1], @@ -5093,19 +5334,25 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x", - "0x778/0x6cc", - u8tmp[0], u32tmp[0]); + "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x", + "0x778/0x6cc/Scoreboard(W->B)", + u8tmp[0], u32tmp[0], coex_sta->score_board_WB); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", "AntDiv/ ForceLPS", ((board_info->ant_div_cfg) ? "On" : "Off"), - ((coex_sta->force_lps_on) ? "On" : "Off")); + ((coex_sta->force_lps_ctrl) ? "On" : "Off")); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "BT_Empty/BT_Late", + coex_sta->wl_fw_dbg_info[4], + coex_sta->wl_fw_dbg_info[5]); CL_PRINTF(cli_buf); u32tmp[0] = halbtc8723d1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; + lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; if (lte_coex_on) { @@ -5179,7 +5426,7 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) } CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", + "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s (gnt_err = %d)", "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), @@ -5246,11 +5493,11 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) cca_cck, fa_cck, cca_ofdm, fa_ofdm); CL_PRINTF(cli_buf); -#if 1 - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11n-agg", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d (Rx_rate Data/RTS= %d/%d)", + "CRC_OK CCK/11g/11n/11ac", coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht, + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", @@ -5258,13 +5505,12 @@ void ex_halbtc8723d1ant_display_coex_info(IN struct btc_coexist *btcoexist) coex_sta->crc_err_cck, coex_sta->crc_err_11g, coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); CL_PRINTF(cli_buf); -#endif CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", "WlHiPri/ Locking/ Locked/ Noisy", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No"), + (coex_sta->cck_lock_ever ? "Yes" : "No"), coex_sta->wl_noisy_level); CL_PRINTF(cli_buf); @@ -5294,7 +5540,7 @@ void ex_halbtc8723d1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS ENTER notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_ips = true; + coex_sta->under_ips = TRUE; /* Write WL "Active" in Score-board for LPS off */ halbtc8723d1ant_post_state_to_bt(btcoexist, @@ -5302,36 +5548,39 @@ void ex_halbtc8723d1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BT_8723D_1ANT_SCOREBOARD_ONOFF | BT_8723D_1ANT_SCOREBOARD_SCAN | BT_8723D_1ANT_SCOREBOARD_UNDERTEST, - false); - - halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + FALSE); halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, BT_8723D_1ANT_PHASE_WLAN_OFF); halbtc8723d1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723d1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_IPS_LEAVE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS LEAVE notify\n"); BTC_TRACE(trace_buf); #if 0 halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_1ANT_SCOREBOARD_ACTIVE, TRUE); halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, true); + BT_8723D_1ANT_SCOREBOARD_ONOFF, TRUE); #endif - halbtc8723d1ant_init_hw_config(btcoexist, false, false); + halbtc8723d1ant_init_hw_config(btcoexist, FALSE, FALSE); halbtc8723d1ant_init_coex_dm(btcoexist);; - coex_sta->under_ips = false; + coex_sta->under_ips = FALSE; } } void ex_halbtc8723d1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) { + static boolean pre_force_lps_on = FALSE; + if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; @@ -5339,52 +5588,55 @@ void ex_halbtc8723d1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS ENABLE notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_lps = true; + coex_sta->under_lps = TRUE; - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ + if (coex_sta->force_lps_ctrl == TRUE) { /* LPS No-32K */ /* Write WL "Active" in Score-board for PS-TDMA */ + pre_force_lps_on = TRUE; halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_1ANT_SCOREBOARD_ACTIVE, TRUE); } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ /* Write WL "Non-Active" in Score-board for Native-PS */ + pre_force_lps_on = FALSE; halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); + BT_8723D_1ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8723d1ant_action_wifi_native_lps(btcoexist); } } else if (BTC_LPS_DISABLE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS DISABLE notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_lps = false; + coex_sta->under_lps = FALSE; /* Write WL "Active" in Score-board for LPS off */ halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_1ANT_SCOREBOARD_ACTIVE, TRUE); + if ((!pre_force_lps_on) && (!coex_sta->force_lps_ctrl)) + halbtc8723d1ant_query_bt_info(btcoexist); } } void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean wifi_connected = false; + boolean wifi_connected = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; - coex_sta->freeze_coexrun_by_btinfo = false; + coex_sta->freeze_coexrun_by_btinfo = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); - halbtc8723d1ant_query_bt_info(btcoexist); - if (BTC_SCAN_START == type) { if (!wifi_connected) - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], SCAN START notify\n"); @@ -5394,7 +5646,9 @@ void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, BT_8723D_1ANT_SCOREBOARD_ACTIVE | BT_8723D_1ANT_SCOREBOARD_SCAN | BT_8723D_1ANT_SCOREBOARD_ONOFF, - true); + TRUE); + + halbtc8723d1ant_query_bt_info(btcoexist); /* Force antenna setup for no scan result issue */ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, @@ -5405,7 +5659,7 @@ void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, } else { - coex_sta->wifi_is_high_pri_task = false; + coex_sta->wifi_is_high_pri_task = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); @@ -5427,7 +5681,7 @@ void ex_halbtc8723d1ant_scan_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean wifi_connected = false; + boolean wifi_connected = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -5438,13 +5692,13 @@ void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, if (BTC_ASSOCIATE_START == type) { - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; halbtc8723d1ant_post_state_to_bt(btcoexist, BT_8723D_1ANT_SCOREBOARD_ACTIVE | BT_8723D_1ANT_SCOREBOARD_SCAN | BT_8723D_1ANT_SCOREBOARD_ONOFF, - true); + TRUE); /* Force antenna setup for no scan result issue */ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, @@ -5461,11 +5715,11 @@ void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, /* To keep TDMA case during connect process, to avoid changed by Btinfo and runcoexmechanism */ - coex_sta->freeze_coexrun_by_btinfo = true; + coex_sta->freeze_coexrun_by_btinfo = TRUE; } else { - coex_sta->wifi_is_high_pri_task = false; - coex_sta->freeze_coexrun_by_btinfo = false; + coex_sta->wifi_is_high_pri_task = FALSE; + coex_sta->freeze_coexrun_by_btinfo = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT FINISH notify\n"); @@ -5479,7 +5733,7 @@ void ex_halbtc8723d1ant_connect_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean wifi_under_b_mode = false; + boolean wifi_under_b_mode = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -5494,7 +5748,7 @@ void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, halbtc8723d1ant_post_state_to_bt(btcoexist, BT_8723D_1ANT_SCOREBOARD_ACTIVE | BT_8723D_1ANT_SCOREBOARD_ONOFF, - true); + TRUE); /* Force antenna setup for no scan result issue */ halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, @@ -5534,12 +5788,12 @@ void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, false); + BT_8723D_1ANT_SCOREBOARD_ACTIVE, FALSE); btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ - coex_sta->cck_ever_lock = false; + coex_sta->cck_lock_ever = FALSE; } halbtc8723d1ant_update_wifi_channel_info(btcoexist, type); @@ -5549,7 +5803,8 @@ void ex_halbtc8723d1ant_media_status_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean under_4way = false; + boolean under_4way = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -5565,7 +5820,7 @@ void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, "[BTCoex], specific Packet ---- under_4way!!\n"); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; } else if (BTC_PACKET_ARP == type) { @@ -5575,6 +5830,10 @@ void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, coex_dm->arp_cnt); BTC_TRACE(trace_buf); + coex_sta->specific_pkt_period_cnt = 1; + + if (bt_link_info->sco_exist) + halbtc8723d1ant_run_coexist_mechanism(btcoexist); } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -5582,13 +5841,13 @@ void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, type); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; } if (coex_sta->wifi_is_high_pri_task) { halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, true); + BT_8723D_1ANT_SCOREBOARD_SCAN, TRUE); halbtc8723d1ant_run_coexist_mechanism(btcoexist); } } @@ -5597,12 +5856,12 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length) { u8 i, rsp_source = 0; - boolean wifi_connected = false; - boolean wifi_scan = false, wifi_link = false, wifi_roam = false, - wifi_busy = false; - static boolean is_scoreboard_scan = false; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE, + wifi_busy = FALSE; + static boolean is_scoreboard_scan = FALSE; - if (psd_scan->is_AntDet_running == true) { + if (psd_scan->is_AntDet_running == TRUE) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], bt_info_notify return for AntDet is running\n"); BTC_TRACE(trace_buf); @@ -5640,36 +5899,39 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, if (BT_INFO_SRC_8723D_1ANT_WIFI_FW != rsp_source) { /* if 0xff, it means BT is under WHCK test */ - coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? true : - false); + coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? TRUE : + FALSE); coex_sta->bt_create_connection = (( - coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? true : - false); + coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? TRUE : + FALSE); /* unit: %, value-100 to translate to unit: dBm */ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; coex_sta->c2h_bt_remote_name_req = (( - coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? true : - false); + coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? TRUE : + FALSE); coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & - 0x10) ? true : false); + 0x10) ? TRUE : FALSE); coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & - 0x9) ? true : false); + 0x8) ? TRUE : FALSE); coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? - true : false); + TRUE : FALSE); coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & - BT_INFO_8723D_1ANT_B_INQ_PAGE) ? true : false); + BT_INFO_8723D_1ANT_B_INQ_PAGE) ? TRUE : FALSE); coex_sta->a2dp_bit_pool = ((( coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? - coex_sta->bt_info_c2h[rsp_source][6] : 0); + (coex_sta->bt_info_c2h[rsp_source][6] & 0x7f) : 0); + + coex_sta->is_bt_a2dp_sink = (coex_sta->bt_info_c2h[rsp_source][6] & 0x80) ? + TRUE : FALSE; coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & 0xf; @@ -5682,6 +5944,8 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; + coex_sta->is_bt_opp_exist = (coex_sta->bt_info_ext2 & 0x1) ? TRUE : FALSE; + if (coex_sta->bt_retry_cnt >= 1) coex_sta->pop_event_cnt++; @@ -5693,9 +5957,18 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, if (coex_sta->bt_info_ext & BIT(2)) { coex_sta->cnt_setupLink++; - coex_sta->is_setupLink = true; - } else - coex_sta->is_setupLink = false; + coex_sta->is_setupLink = TRUE; + coex_sta->bt_relink_downcount = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->is_setupLink = FALSE; + coex_sta->bt_relink_downcount = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop in BT info!!\n"); + BTC_TRACE(trace_buf); + } if (coex_sta->bt_info_ext & BIT(3)) coex_sta->cnt_IgnWlanAct++; @@ -5703,6 +5976,21 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, if (coex_sta->bt_info_ext & BIT(6)) coex_sta->cnt_RoleSwitch++; + if (coex_sta->bt_info_ext & BIT(7)) + coex_sta->is_bt_multi_link = TRUE; + else + coex_sta->is_bt_multi_link = FALSE; + + if (coex_sta->bt_info_ext & BIT(0)) + coex_sta->is_hid_rcu = TRUE; + else + coex_sta->is_hid_rcu = FALSE; + + if (coex_sta->bt_info_ext & BIT(5)) + coex_sta->is_ble_scan_toggle = TRUE; + else + coex_sta->is_ble_scan_toggle = FALSE; + if (coex_sta->bt_create_connection) { coex_sta->cnt_Page++; @@ -5716,19 +6004,19 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, if ((wifi_link) || (wifi_roam) || (wifi_scan) || (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { - is_scoreboard_scan = true; + is_scoreboard_scan = TRUE; halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, true); + BT_8723D_1ANT_SCOREBOARD_SCAN, TRUE); } else halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, false); + BT_8723D_1ANT_SCOREBOARD_SCAN, FALSE); } else { if (is_scoreboard_scan) { halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_SCAN, false); - is_scoreboard_scan = false; + BT_8723D_1ANT_SCOREBOARD_SCAN, FALSE); + is_scoreboard_scan = FALSE; } } @@ -5765,7 +6053,7 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); BTC_TRACE(trace_buf); halbtc8723d1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); + FORCE_EXEC, FALSE); } else { if (coex_sta->bt_info_ext & BIT(2)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -5781,25 +6069,105 @@ void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, } - if ((coex_sta->bt_info_ext & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); - BTC_TRACE(trace_buf); - coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); - - if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) - coex_sta->bt_ble_scan_para[0] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); - if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) - coex_sta->bt_ble_scan_para[1] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); - if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) - coex_sta->bt_ble_scan_para[2] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); - } - halbtc8723d1ant_update_bt_link_info(btcoexist); halbtc8723d1ant_run_coexist_mechanism(btcoexist); } +void ex_halbtc8723d1ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i = 0; + static u8 tmp_buf_pre[10] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi Fw Dbg info = %d %d %d %d %d %d (len = %d)\n", + tmp_buf[0], tmp_buf[1], + tmp_buf[2], tmp_buf[3], + tmp_buf[4], tmp_buf[5], length); + BTC_TRACE(trace_buf); + + if (tmp_buf[0] == 0x8) { + for (i = 1; i <= 5; i++) { + coex_sta->wl_fw_dbg_info[i] = + (tmp_buf[i] >= tmp_buf_pre[i]) ? + (tmp_buf[i] - tmp_buf_pre[i]) : + (255 - tmp_buf_pre[i] + tmp_buf[i]); + + tmp_buf_pre[i] = tmp_buf[i]; + } + } +} + +void ex_halbtc8723d1ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id) +{ + BOOLEAN wifi_connected = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (is_data_frame) { + coex_sta->wl_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rx_rate_change_notify data rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } else { + coex_sta->wl_rts_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rts_rate_change_notify RTS rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rts_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } + + if ((wifi_connected) && + ((coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_ACL_SCO_BUSY) || + (coex_dm->bt_status == BT_8723D_1ANT_BT_STATUS_SCO_BUSY))) { + + if ((coex_sta->wl_rx_rate == BTC_CCK_5_5) || + (coex_sta->wl_rx_rate == BTC_OFDM_6) || + (coex_sta->wl_rx_rate == BTC_MCS_0)) { + + coex_sta->cck_lock_warn = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck lock warning...\n"); + BTC_TRACE(trace_buf); + } else if ((coex_sta->wl_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rx_rate == BTC_CCK_2) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_2)) { + + coex_sta->cck_lock = TRUE; + coex_sta->cck_lock_ever = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck locking...\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck unlock...\n"); + BTC_TRACE(trace_buf); + } + } else { + if ((coex_dm->bt_status == + BT_8723D_1ANT_BT_STATUS_CONNECTED_IDLE) || + (coex_dm->bt_status == + BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE)) { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + } + } + +} + void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, @@ -5814,12 +6182,13 @@ void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, "[BTCoex], RF is turned ON!!\n"); BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; + btcoexist->stop_coex_dm = FALSE; + coex_sta->is_rf_state_off = FALSE; #if 0 halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_1ANT_SCOREBOARD_ACTIVE, TRUE); halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, true); + BT_8723D_1ANT_SCOREBOARD_ONOFF, TRUE); #endif } else if (BTC_RF_OFF == type) { @@ -5833,15 +6202,16 @@ void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, BT_8723D_1ANT_SCOREBOARD_ONOFF | BT_8723D_1ANT_SCOREBOARD_SCAN | BT_8723D_1ANT_SCOREBOARD_UNDERTEST, - false); - - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + FALSE); halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, BT_8723D_1ANT_PHASE_WLAN_OFF); - btcoexist->stop_coex_dm = true; + halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = TRUE; } } @@ -5855,18 +6225,18 @@ void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist) BT_8723D_1ANT_SCOREBOARD_ONOFF | BT_8723D_1ANT_SCOREBOARD_SCAN | BT_8723D_1ANT_SCOREBOARD_UNDERTEST, - false); - - halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + FALSE); halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, BT_8723D_1ANT_PHASE_WLAN_OFF); - halbtc8723d1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); + /*halbtc8723d1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, TRUE);*/ ex_halbtc8723d1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - btcoexist->stop_coex_dm = true; + halbtc8723d1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + btcoexist->stop_coex_dm = TRUE; } void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, @@ -5886,7 +6256,7 @@ void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, BT_8723D_1ANT_SCOREBOARD_ONOFF | BT_8723D_1ANT_SCOREBOARD_SCAN | BT_8723D_1ANT_SCOREBOARD_UNDERTEST, - false); + FALSE); if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { @@ -5900,7 +6270,7 @@ void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, BT_8723D_1ANT_PHASE_WLAN_OFF); } - btcoexist->stop_coex_dm = true; + btcoexist->stop_coex_dm = TRUE; } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -5908,11 +6278,11 @@ void ex_halbtc8723d1ant_pnp_notify(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); #if 0 halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_1ANT_SCOREBOARD_ACTIVE, TRUE); halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_ONOFF, true); + BT_8723D_1ANT_SCOREBOARD_ONOFF, TRUE); #endif - btcoexist->stop_coex_dm = false; + btcoexist->stop_coex_dm = FALSE; } } @@ -5923,7 +6293,7 @@ void ex_halbtc8723d1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) "[BTCoex], *****************Coex DM Reset*****************\n"); BTC_TRACE(trace_buf); - halbtc8723d1ant_init_hw_config(btcoexist, false, false); + halbtc8723d1ant_init_hw_config(btcoexist, FALSE, FALSE); halbtc8723d1ant_init_coex_dm(btcoexist); } @@ -5931,11 +6301,11 @@ void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist) { struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; u4Byte value = 0; u32 bt_patch_ver; static u8 cnt = 0; - boolean bt_relink_finish = false; + boolean bt_relink_finish = FALSE, special_pkt_finish = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ************* Periodical *************\n"); @@ -5951,35 +6321,13 @@ void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist) halbtc8723d1ant_monitor_bt_enable_disable(btcoexist); -#if 0 - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* halbtc8723d1ant_read_score_board(btcoexist, &bt_scoreboard_val); */ - - if (wifi_busy) { - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_UNDERTEST, true); - /* - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_WLBUSY, true); - - if (bt_scoreboard_val & BIT(6)) - halbtc8723d1ant_query_bt_info(btcoexist); */ - } else { - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_UNDERTEST, false); - /* - halbtc8723d1ant_post_state_to_bt(btcoexist, - BT_8723D_1ANT_SCOREBOARD_WLBUSY, - false); */ - } -#endif - if (coex_sta->bt_relink_downcount != 0) { coex_sta->bt_relink_downcount--; - if (coex_sta->bt_relink_downcount == 0) - bt_relink_finish = true; + if (coex_sta->bt_relink_downcount == 0) { + coex_sta->is_setupLink = FALSE; + bt_relink_finish = TRUE; + } } /* for 4-way, DHCP, EAPOL packet */ @@ -5989,49 +6337,11 @@ void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist) if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) - coex_sta->wifi_is_high_pri_task = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", - (coex_sta->wifi_is_high_pri_task ? "Yes" : - "No")); - BTC_TRACE(trace_buf); - + coex_sta->wifi_is_high_pri_task = FALSE; + special_pkt_finish = TRUE; } if (!coex_sta->bt_disabled) { - if (coex_sta->bt_coex_supported_feature == 0) - btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, - &coex_sta->bt_coex_supported_feature); - - if ((coex_sta->bt_coex_supported_version == 0) || - (coex_sta->bt_coex_supported_version == 0xffff)) - btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, - &coex_sta->bt_coex_supported_version); - - if (coex_sta->bt_reg_vendor_ac == 0xffff) - coex_sta->bt_reg_vendor_ac = (u16)( - btcoexist->btc_get_bt_reg(btcoexist, 3, - 0xac) & 0xffff); - - if (coex_sta->bt_reg_vendor_ae == 0xffff) - coex_sta->bt_reg_vendor_ae = (u16)( - btcoexist->btc_get_bt_reg(btcoexist, 3, - 0xae) & 0xffff); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, - &bt_patch_ver); - btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; - - if (coex_sta->num_of_profile > 0) { - cnt++; - - if (cnt >= 3) { - btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, - &coex_sta->bt_afh_map[0]); - cnt = 0; - } - } #if BT_8723D_1ANT_ANTDET_ENABLE @@ -6060,7 +6370,8 @@ void ex_halbtc8723d1ant_periodical(IN struct btc_coexist *btcoexist) #endif } - if (halbtc8723d1ant_is_wifibt_status_changed(btcoexist)) + if (halbtc8723d1ant_is_wifibt_status_changed(btcoexist) || (bt_relink_finish) + || (special_pkt_finish)) halbtc8723d1ant_run_coexist_mechanism(btcoexist); @@ -6075,7 +6386,7 @@ void ex_halbtc8723d1ant_set_antenna_notify(IN struct btc_coexist *btcoexist, return; if (type == 2) { /* two antenna */ - board_info->ant_div_cfg = true; + board_info->ant_div_cfg = TRUE; halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, BT_8723D_1ANT_PHASE_2G_RUNTIME); @@ -6113,7 +6424,7 @@ void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, psd_scan->ant_det_fail_count = 0; ant_det_count = 0; ant_det_fail_count = 0; - board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; return; } @@ -6128,13 +6439,13 @@ void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); BTC_TRACE(trace_buf); - psd_scan->is_AntDet_running = true; + psd_scan->is_AntDet_running = TRUE; halbtc8723d1ant_read_score_board(btcoexist, &u16tmp); if (u16tmp & BIT( 2)) { /* Antenna detection is already done before last WL power on */ - board_info->btdm_ant_det_finish = true; + board_info->btdm_ant_det_finish = TRUE; psd_scan->ant_det_try_count = 1; psd_scan->ant_det_fail_count = 0; board_info->btdm_ant_num_by_ant_det = (u16tmp & @@ -6155,7 +6466,7 @@ void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, btcoexist); board_info->ant_det_result = psd_scan->ant_det_result; - btcoexist->bdontenterLPS = false; + btcoexist->bdontenterLPS = FALSE; if (board_info->btdm_ant_det_finish) { @@ -6164,7 +6475,7 @@ void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); if (board_info->btdm_ant_num_by_ant_det == 2) { - board_info->ant_div_cfg = true; + board_info->ant_div_cfg = TRUE; halbtc8723d1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, BT_8723D_1ANT_PHASE_2G_RUNTIME); @@ -6210,18 +6521,18 @@ void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, board_info->antdetval = psd_scan->ant_det_psd_scan_peak_val/100; - board_info->btdm_ant_det_complete_fail = false; + board_info->btdm_ant_det_complete_fail = FALSE; } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); BTC_TRACE(trace_buf); - board_info->btdm_ant_det_complete_fail = true; + board_info->btdm_ant_det_complete_fail = TRUE; } psd_scan->ant_det_inteval_count = 0; - psd_scan->is_AntDet_running = false; + psd_scan->is_AntDet_running = FALSE; /* stimulate coex running */ halbtc8723d1ant_run_coexist_mechanism( btcoexist); @@ -6236,9 +6547,9 @@ void ex_halbtc8723d1ant_antenna_detection(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); if (psd_scan->ant_det_inteval_count == 8) - btcoexist->bdontenterLPS = true; + btcoexist->bdontenterLPS = TRUE; else - btcoexist->bdontenterLPS = false; + btcoexist->bdontenterLPS = FALSE; } } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.h index 76edd5a30f2f..f34224f24fa7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d1ant.h @@ -1,3 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -19,7 +34,7 @@ #define BT_INFO_8723D_1ANT_B_CONNECTION BIT(0) #define BT_INFO_8723D_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) + (((_BT_INFO_EXT_&BIT(0))) ? TRUE : FALSE) #define BTC_RSSI_COEX_THRESH_TOL_8723D_1ANT 2 @@ -140,6 +155,8 @@ enum bt_8723d_1ant_Scoreboard { BT_8723D_1ANT_SCOREBOARD_ONOFF = BIT(1), BT_8723D_1ANT_SCOREBOARD_SCAN = BIT(2), BT_8723D_1ANT_SCOREBOARD_UNDERTEST = BIT(3), + BT_8723D_1ANT_SCOREBOARD_RXGAIN = BIT(4), + BT_8723D_1ANT_SCOREBOARD_DKTOPP2M = BIT(5), BT_8723D_1ANT_SCOREBOARD_WLBUSY = BIT(6) }; @@ -246,12 +263,11 @@ struct coex_sta_8723d_1ant { u32 crc_err_11n_vht; boolean cck_lock; - boolean pre_ccklock; - boolean cck_ever_lock; + boolean cck_lock_ever; + boolean cck_lock_warn; + u8 coex_table_type; - - boolean force_lps_on; - + boolean force_lps_ctrl; boolean concurrent_rx_mode_on; u16 score_board; @@ -297,6 +313,27 @@ struct coex_sta_8723d_1ant { u8 bt_relink_downcount; boolean is_tdma_btautoslot; boolean is_tdma_btautoslot_hang; + + boolean is_rf_state_off; + + boolean is_hid_low_pri_tx_overhead; + boolean is_bt_multi_link; + boolean is_bt_a2dp_sink; + + u8 wl_fw_dbg_info[10]; + u8 wl_rx_rate; + u8 wl_rts_rx_rate; + + u16 score_board_WB; + + boolean is_hid_rcu; + boolean is_ble_scan_toggle; + + u16 legacy_forbidden_slot; + u16 le_forbidden_slot; + u8 bt_a2dp_vendor_id; + u32 bt_a2dp_device_name; + boolean is_bt_opp_exist; }; #define BT_8723D_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ @@ -365,6 +402,10 @@ void ex_halbtc8723d1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8723d1ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8723d1ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8723d1ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id); void ex_halbtc8723d1ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8723d1ant_halt_notify(IN struct btc_coexist *btcoexist); @@ -396,6 +437,8 @@ void ex_halbtc8723d1ant_display_ant_detection(IN struct btc_coexist *btcoexist); #define ex_halbtc8723d1ant_media_status_notify(btcoexist, type) #define ex_halbtc8723d1ant_specific_packet_notify(btcoexist, type) #define ex_halbtc8723d1ant_bt_info_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8723d1ant_wl_fwdbginfo_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8723d1ant_rx_rate_change_notify(btcoexist, is_data_frame, btc_rate_id) #define ex_halbtc8723d1ant_rf_status_notify(btcoexist, type) #define ex_halbtc8723d1ant_halt_notify(btcoexist) #define ex_halbtc8723d1ant_pnp_notify(btcoexist, pnp_state) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.c index b6019246ab58..fe8bec2c5924 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.c @@ -1,3 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + /* ************************************************************ * Description: * @@ -11,7 +26,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -43,9 +58,9 @@ const char *const glbt_info_src_8723d_2ant[] = { * Please strictly follow this order and naming style !!! * * ************************************************************ */ -u32 glcoex_ver_date_8723d_2ant = 20161208; -u32 glcoex_ver_8723d_2ant = 0x12; -u32 glcoex_ver_btdesired_8723d_2ant = 0x10; +u32 glcoex_ver_date_8723d_2ant = 20171025; +u32 glcoex_ver_8723d_2ant = 0x20; +u32 glcoex_ver_btdesired_8723d_2ant = 0x20; /* ************************************************************ @@ -54,8 +69,9 @@ u32 glcoex_ver_btdesired_8723d_2ant = 0x10; * ************************************************************ * local function start with halbtc8723d2ant_ * ************************************************************ */ -u8 halbtc8723d2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, - u8 rssi_thresh, u8 rssi_thresh1) +u8 halbtc8723d2ant_bt_rssi_state(IN struct btc_coexist *btcoexist, + u8 *ppre_bt_rssi_state, u8 level_num, + u8 rssi_thresh, u8 rssi_thresh1) { s32 bt_rssi = 0; u8 bt_rssi_state = *ppre_bt_rssi_state; @@ -281,6 +297,12 @@ void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) coex_sta->low_priority_tx = reg_lp_tx; coex_sta->low_priority_rx = reg_lp_rx; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); + + BTC_TRACE(trace_buf); + if (BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == coex_dm->bt_status) { @@ -289,16 +311,16 @@ void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) cnt_overhead++; if (cnt_overhead == 3) - coex_sta->is_hiPri_rx_overhead = true; + coex_sta->is_hiPri_rx_overhead = TRUE; } else { if (cnt_overhead > 0) cnt_overhead--; if (cnt_overhead == 0) - coex_sta->is_hiPri_rx_overhead = false; + coex_sta->is_hiPri_rx_overhead = FALSE; } } else - coex_sta->is_hiPri_rx_overhead = false; + coex_sta->is_hiPri_rx_overhead = FALSE; /* reset counter */ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); @@ -312,13 +334,13 @@ void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { if (cnt_slave >= 2) { - bt_link_info->slave_role = true; + bt_link_info->slave_role = TRUE; cnt_slave = 2; } else cnt_slave++; } else { if (cnt_slave == 0) { - bt_link_info->slave_role = false; + bt_link_info->slave_role = FALSE; cnt_slave = 0; } else cnt_slave--; @@ -329,13 +351,13 @@ void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) if ((coex_sta->low_priority_tx >= 1300) && (coex_sta->low_priority_rx <= 150)) { if (cnt_autoslot_hang >= 2) { - coex_sta->is_tdma_btautoslot_hang = true; + coex_sta->is_tdma_btautoslot_hang = TRUE; cnt_autoslot_hang = 2; } else cnt_autoslot_hang++; } else { if (cnt_autoslot_hang == 0) { - coex_sta->is_tdma_btautoslot_hang = false; + coex_sta->is_tdma_btautoslot_hang = FALSE; cnt_autoslot_hang = 0; } else cnt_autoslot_hang--; @@ -345,9 +367,16 @@ void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) if (coex_sta->sco_exist) { if ((coex_sta->high_priority_tx >= 400) && (coex_sta->high_priority_rx >= 400)) - coex_sta->is_eSCO_mode = false; + coex_sta->is_eSCO_mode = FALSE; else - coex_sta->is_eSCO_mode = true; + coex_sta->is_eSCO_mode = TRUE; + } + + if (bt_link_info->hid_only) { + if (coex_sta->low_priority_tx > 50) + coex_sta->is_hid_low_pri_tx_overhead = true; + else + coex_sta->is_hid_low_pri_tx_overhead = false; } if (!coex_sta->bt_disabled) { @@ -368,41 +397,107 @@ void halbtc8723d2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) { -#if 1 - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false, - wifi_scan = false; - boolean bt_idle = false, wl_idle = false; - static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, - wl_noisy_count1 = 3, wl_noisy_count2 = 0; - u32 total_cnt, reg_val1, reg_val2, cck_cnt; + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE, wifi_under_b_mode = FALSE, + wifi_scan = FALSE, wifi_connected = FALSE; + boolean bt_idle = FALSE, wl_idle = FALSE, is_cck_deadlock = FALSE; + static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, + wl_noisy_count1 = 3, wl_noisy_count2 = 0; + u32 total_cnt, reg_val1, reg_val2, cnt_cck; + u32 cnt_crcok = 0, cnt_crcerr = 0, cnt_ccklocking = 0; + static u8 cnt = 0, cnt_cal = 0; + u8 h2c_parameter[1] = {0}; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_CCK); - coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_LEGACY); - coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_HT); - coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_OK_VHT); + /*send h2c to query WL FW dbg info */ + if (((coex_dm->cur_ps_tdma_on) && (coex_sta->force_lps_ctrl)) || + ((coex_sta->acl_busy) && (bt_link_info->a2dp_exist))) { + h2c_parameter[0] = 0x8; + btcoexist->btc_fill_h2c(btcoexist, 0x69, 1, h2c_parameter); + } - coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); - coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); - coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_HT); - coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( - btcoexist, PHYDM_INFO_CRC32_ERROR_VHT); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); - cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); - if (cck_cnt > 250) { + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + + cnt_crcok = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + + coex_sta->crc_ok_11n_vht; + + cnt_crcerr = coex_sta->crc_err_cck + coex_sta->crc_err_11g + + coex_sta->crc_err_11n + + coex_sta->crc_err_11n_vht; + + + if ((wifi_busy) && (cnt_crcerr != 0)) { + if (cnt_cal == 0) + coex_sta->cnt_crcok_max_in_10s = 0; + + cnt_cal++; + + if (cnt_crcok > coex_sta->cnt_crcok_max_in_10s) + coex_sta->cnt_crcok_max_in_10s = cnt_crcok; + + if (cnt_cal == 5) + cnt_cal = 0; + + coex_sta->now_crc_ratio = cnt_crcok/cnt_crcerr; + + if (cnt == 0) + coex_sta->acc_crc_ratio = coex_sta->now_crc_ratio; + else + coex_sta->acc_crc_ratio = (coex_sta->acc_crc_ratio * 7 + + coex_sta->now_crc_ratio * 3)/10; + + if (cnt >= 10) + cnt = 0; + else + cnt++; + } + + /* CCK lock identification */ + if (coex_sta->cck_lock) + cnt_ccklocking++; + else if (cnt_ccklocking != 0) + cnt_ccklocking--; + + if (cnt_ccklocking >= 3) { + cnt_ccklocking = 3; + coex_sta->cck_lock_ever = TRUE; + } + + /* WiFi environment noisy identification */ + cnt_cck = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + + if ((!wifi_busy) && (!coex_sta->cck_lock)) { + if (cnt_cck > 250) { if (wl_noisy_count2 < 3) wl_noisy_count2++; @@ -410,7 +505,8 @@ void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) wl_noisy_count0 = 0; wl_noisy_count1 = 0; } - } else if (cck_cnt < 50) { + + } else if (cnt_cck < 50) { if (wl_noisy_count0 < 3) wl_noisy_count0++; @@ -418,6 +514,7 @@ void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) wl_noisy_count1 = 0; wl_noisy_count2 = 0; } + } else { if (wl_noisy_count1 < 3) wl_noisy_count1++; @@ -434,94 +531,70 @@ void halbtc8723d2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) coex_sta->wl_noisy_level = 1; else coex_sta->wl_noisy_level = 0; - - if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { - total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; - - if ((coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (total_cnt - - coex_sta->crc_ok_cck)) { - if (cck_lock_counter < 3) - cck_lock_counter++; - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - if (!coex_sta->pre_ccklock) { - - if (cck_lock_counter >= 3) - coex_sta->cck_lock = true; - else - coex_sta->cck_lock = false; - } else { - if (cck_lock_counter == 0) - coex_sta->cck_lock = false; - else - coex_sta->cck_lock = true; - } - - if (coex_sta->cck_lock) - coex_sta->cck_ever_lock = true; - - coex_sta->pre_ccklock = coex_sta->cck_lock; - -#endif + } } + + void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - boolean bt_busy = false; + boolean bt_hs_on = FALSE; + boolean bt_busy = FALSE; + u32 val = 0; + static u8 pre_num_of_profile = 0, cur_num_of_profile = 0, cnt = 0; + if (coex_sta->is_ble_scan_toggle) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); + BTC_TRACE(trace_buf); + coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); + + if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) + coex_sta->bt_ble_scan_para[0] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); + if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) + coex_sta->bt_ble_scan_para[1] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); + if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) + coex_sta->bt_ble_scan_para[2] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); + } coex_sta->num_of_profile = 0; /* set link exist status */ if (!(coex_sta->bt_info & BT_INFO_8723D_2ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; + coex_sta->bt_link_exist = FALSE; + coex_sta->pan_exist = FALSE; + coex_sta->a2dp_exist = FALSE; + coex_sta->hid_exist = FALSE; + coex_sta->sco_exist = FALSE; } else { /* connection exists */ - coex_sta->bt_link_exist = true; + coex_sta->bt_link_exist = TRUE; if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_FTP) { - coex_sta->pan_exist = true; + coex_sta->pan_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->pan_exist = false; + coex_sta->pan_exist = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_A2DP) { - coex_sta->a2dp_exist = true; + coex_sta->a2dp_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->a2dp_exist = false; + coex_sta->a2dp_exist = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_HID) { - coex_sta->hid_exist = true; + coex_sta->hid_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->hid_exist = false; + coex_sta->hid_exist = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_SCO_ESCO) { - coex_sta->sco_exist = true; + coex_sta->sco_exist = TRUE; coex_sta->num_of_profile++; } else - coex_sta->sco_exist = false; + coex_sta->sco_exist = FALSE; } @@ -536,8 +609,8 @@ void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) /* work around for HS mode. */ if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; + bt_link_info->pan_exist = TRUE; + bt_link_info->bt_link_exist = TRUE; } /* check if Sco only */ @@ -545,36 +618,36 @@ void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->sco_only = true; + bt_link_info->sco_only = TRUE; else - bt_link_info->sco_only = false; + bt_link_info->sco_only = FALSE; /* check if A2dp only */ if (!bt_link_info->sco_exist && bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->a2dp_only = true; + bt_link_info->a2dp_only = TRUE; else - bt_link_info->a2dp_only = false; + bt_link_info->a2dp_only = FALSE; /* check if Pan only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->pan_only = true; + bt_link_info->pan_only = TRUE; else - bt_link_info->pan_only = false; + bt_link_info->pan_only = FALSE; /* check if Hid only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && bt_link_info->hid_exist) - bt_link_info->hid_only = true; + bt_link_info->hid_only = TRUE; else - bt_link_info->hid_only = false; + bt_link_info->hid_only = FALSE; if (coex_sta->bt_info & BT_INFO_8723D_2ANT_B_INQ_PAGE) { coex_dm->bt_status = BT_8723D_2ANT_BT_STATUS_INQ_PAGE; @@ -615,11 +688,53 @@ void halbtc8723d2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) if ((BT_8723D_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || (BT_8723D_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || (BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - bt_busy = true; + bt_busy = TRUE; else - bt_busy = false; + bt_busy = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + + cur_num_of_profile = coex_sta->num_of_profile; + + if (cur_num_of_profile != pre_num_of_profile) + cnt = 2; + + if (bt_link_info->a2dp_exist) { + + if (((coex_sta->bt_a2dp_vendor_id == 0) && + (coex_sta->bt_a2dp_device_name == 0)) || + (cur_num_of_profile != pre_num_of_profile)) { + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_DEVICE_INFO, &val); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), get BT DEVICE_INFO = %x\n", val); + BTC_TRACE(trace_buf); + + coex_sta->bt_a2dp_vendor_id = (u8)(val & 0xff); + coex_sta->bt_a2dp_device_name = (val & 0xffffff00) >> 8; + } + + if (((coex_sta->legacy_forbidden_slot == 0) && + (coex_sta->le_forbidden_slot == 0)) || + (cur_num_of_profile != pre_num_of_profile) || + (cnt > 0)) { + + if (cnt > 0) + cnt--; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_FORBIDDEN_SLOT_VAL, &val); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), get BT FORBIDDEN_SLOT_VAL = %x, cnt = %d\n", val, cnt); + BTC_TRACE(trace_buf); + + coex_sta->legacy_forbidden_slot = (u16)(val & 0xffff); + coex_sta->le_forbidden_slot = (u16)((val & 0xffff0000) >> 16); + } + } + + pre_num_of_profile = coex_sta->num_of_profile; } void halbtc8723d2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, @@ -653,21 +768,66 @@ void halbtc8723d2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, } -void halbtc8723d2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, - IN u8 dac_swing_lvl) +void halbtc8723d2ant_write_score_board( + IN struct btc_coexist *btcoexist, + IN u16 bitpos, + IN boolean state +) { - u8 h2c_parameter[1] = {0}; - /* There are several type of dacswing */ - /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ - h2c_parameter[0] = dac_swing_lvl; + static u16 originalval = 0x8002, preval = 0x0; - btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); + if (state) + originalval = originalval | bitpos; + else + originalval = originalval & (~bitpos); + + coex_sta->score_board_WB = originalval; + + if (originalval != preval) { + + preval = originalval; + btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8723d2ant_write_score_board: return for nochange\n"); + BTC_TRACE(trace_buf); + } } -void halbtc8723d2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, + + +void halbtc8723d2ant_read_score_board( + IN struct btc_coexist *btcoexist, + IN u16 *score_board_val +) +{ + + *score_board_val = (btcoexist->btc_read_2byte(btcoexist, + 0xaa)) & 0x7fff; +} + + +void halbtc8723d2ant_post_state_to_bt( + IN struct btc_coexist *btcoexist, + IN u16 type, + IN boolean state +) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8723d2ant_post_state_to_bt: type = %d, state =%d\n", + type, state); + BTC_TRACE(trace_buf); + + halbtc8723d2ant_write_score_board(btcoexist, (u16) type, state); + +} + + +void halbtc8723d2ant_adjust_wl_tx_power(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 fw_dac_swing_lvl) { + coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; if (!force_exec) { @@ -676,37 +836,96 @@ void halbtc8723d2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, return; } - halbtc8723d2ant_set_fw_dac_swing_level(btcoexist, - coex_dm->cur_fw_dac_swing_lvl); + btcoexist->btc_write_1byte(btcoexist, 0x883, fw_dac_swing_lvl); coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; } -void halbtc8723d2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, - IN u8 dec_bt_pwr_lvl) + +void halbtc8723d2ant_adjust_bt_tx_power(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 dec_bt_pwr_lvl) { u8 h2c_parameter[1] = {0}; - h2c_parameter[0] = dec_bt_pwr_lvl; - - btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); -} - -void halbtc8723d2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 dec_bt_pwr_lvl) -{ coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; if (!force_exec) { if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) return; } - halbtc8723d2ant_set_fw_dec_bt_pwr(btcoexist, - coex_dm->cur_bt_dec_pwr_lvl); + + h2c_parameter[0] = 0 - dec_bt_pwr_lvl; + + btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; } +void halbtc8723d2ant_adjust_wl_rx_gain(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean agc_table_en) +{ + u32 rx_gain_value_enable[] = {0xec120101, 0xeb130101, 0xce140101, 0xcd150101, 0xcc160101, + 0xcb170101, 0xca180101, 0x8d190101, 0x8c1a0101, 0x8b1b0101, + 0x4f1c0101, 0x4e1d0101, 0x4d1e0101, 0x4c1f0101, 0x0e200101, + 0x0d210101, 0x0c220101, 0x0b230101, 0xcf240001, 0xce250001, + 0xcd260001, 0xcc270001, 0x8f280001, 0xffffffff}; + u32 rx_gain_value_disable[] = {0xec120101, 0xeb130101, 0xea140101, 0xe9150101, 0xe8160101, + 0xe7170101, 0xe6180101, 0xe5190101, 0xe41a0101, 0xe31b0101, + 0xe21c0101, 0xe11d0101, 0xe01e0101, 0x861f0101, 0x85200101, + 0x84210101, 0x83220101, 0x82230101, 0x81240101, 0x80250101, + 0x44260101, 0x43270101, 0x42280101, 0xffffffff}; + + u8 i; + + coex_dm->cur_agc_table_en = agc_table_en; + + if (!force_exec) { + if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) + return; + } + + if (agc_table_en) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table On!\n"); + BTC_TRACE(trace_buf); + + for (i = 0; i <= 100; i++) { + if (rx_gain_value_enable[i] == 0xffffffff) + break; + + btcoexist->btc_write_4byte(btcoexist, + 0xc78, rx_gain_value_enable[i]); + } + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table Off!\n"); + BTC_TRACE(trace_buf); + + for (i = 0; i <= 100; i++) { + if (rx_gain_value_disable[i] == 0xffffffff) + break; + + btcoexist->btc_write_4byte(btcoexist, + 0xc78, rx_gain_value_disable[i]); + } + } + + + coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; +} + + +void halbtc8723d2ant_adjust_bt_rx_gain(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean rx_gain_en) +{ + + /* use scoreboard[4] to notify BT Rx gain table change */ + halbtc8723d2ant_post_state_to_bt(btcoexist, + BT_8723D_2ANT_SCOREBOARD_RXGAIN, rx_gain_en); +} + + void halbtc8723d2ant_set_fw_low_penalty_ra(IN struct btc_coexist *btcoexist, IN boolean low_penalty_ra) { @@ -781,60 +1000,17 @@ void halbtc8723d2ant_bt_auto_report(IN struct btc_coexist *btcoexist, coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; } -void halbtc8723d2ant_write_score_board( - IN struct btc_coexist *btcoexist, - IN u16 bitpos, - IN boolean state -) -{ - - static u16 originalval = 0x8002; - - if (state) - originalval = originalval | bitpos; - else - originalval = originalval & (~bitpos); - - - btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); - -} - -void halbtc8723d2ant_read_score_board( - IN struct btc_coexist *btcoexist, - IN u16 *score_board_val -) -{ - - *score_board_val = (btcoexist->btc_read_2byte(btcoexist, - 0xaa)) & 0x7fff; -} - - -void halbtc8723d2ant_post_state_to_bt( - IN struct btc_coexist *btcoexist, - IN u16 type, - IN boolean state -) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], halbtc8723d2ant_post_state_to_bt: type = %d, state =%d\n", - type, state); - BTC_TRACE(trace_buf); - - halbtc8723d2ant_write_score_board(btcoexist, (u16) type, state); - -} - boolean halbtc8723d2ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) { - - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false, pre_bt_off = false, pre_bt_slave = false; + static boolean pre_wifi_busy = FALSE, pre_under_4way = FALSE, + pre_bt_hs_on = FALSE, pre_bt_off = FALSE, + pre_bt_slave = FALSE, pre_hid_low_pri_tx_overhead = FALSE, + pre_wifi_under_lps = FALSE, pre_bt_setup_link = FALSE, + pre_cck_lock = FALSE, pre_cck_lock_warn = FALSE; static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; + boolean wifi_busy = FALSE, under_4way = FALSE, bt_hs_on = FALSE; + boolean wifi_connected = FALSE; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, @@ -864,7 +1040,11 @@ boolean halbtc8723d2ant_is_wifibt_status_changed(IN struct btc_coexist coex_sta->bt_ble_scan_para[2] = 0; coex_sta->bt_reg_vendor_ac = 0xffff; coex_sta->bt_reg_vendor_ae = 0xffff; - return true; + coex_sta->legacy_forbidden_slot = 0; + coex_sta->le_forbidden_slot = 0; + coex_sta->bt_a2dp_vendor_id = 0; + coex_sta->bt_a2dp_device_name = 0; + return TRUE; } if (wifi_connected) { @@ -873,45 +1053,68 @@ boolean halbtc8723d2ant_is_wifibt_status_changed(IN struct btc_coexist if (wifi_busy) halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true); + BT_8723D_2ANT_SCOREBOARD_UNDERTEST, TRUE); else halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false); - return true; + BT_8723D_2ANT_SCOREBOARD_UNDERTEST, FALSE); + return TRUE; } if (under_4way != pre_under_4way) { pre_under_4way = under_4way; - return true; + return TRUE; } if (bt_hs_on != pre_bt_hs_on) { pre_bt_hs_on = bt_hs_on; - return true; + return TRUE; } if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { pre_wl_noisy_level = coex_sta->wl_noisy_level; - return true; + return TRUE; + } + if (coex_sta->under_lps != pre_wifi_under_lps) { + pre_wifi_under_lps = coex_sta->under_lps; + if (coex_sta->under_lps == TRUE) + return TRUE; + } + if (coex_sta->cck_lock != pre_cck_lock) { + pre_cck_lock = coex_sta->cck_lock; + return TRUE; + } + if (coex_sta->cck_lock_warn != pre_cck_lock_warn) { + pre_cck_lock_warn = coex_sta->cck_lock_warn; + return TRUE; } } if (!coex_sta->bt_disabled) { if (coex_sta->hid_busy_num != pre_hid_busy_num) { pre_hid_busy_num = coex_sta->hid_busy_num; - return true; + return TRUE; + } + + if (bt_link_info->slave_role != pre_bt_slave) { + pre_bt_slave = bt_link_info->slave_role; + return TRUE; + } + + if (pre_hid_low_pri_tx_overhead != coex_sta->is_hid_low_pri_tx_overhead) { + pre_hid_low_pri_tx_overhead = coex_sta->is_hid_low_pri_tx_overhead; + return TRUE; + } + + if (pre_bt_setup_link != coex_sta->is_setupLink) { + pre_bt_setup_link = coex_sta->is_setupLink; + return TRUE; } } - if (bt_link_info->slave_role != pre_bt_slave) { - pre_bt_slave = bt_link_info->slave_role; - return true; - } - - return false; + return FALSE; } void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) { static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; + boolean bt_active = TRUE, bt_disabled = FALSE; u16 u16tmp; /* This function check if bt is disabled */ @@ -920,12 +1123,12 @@ void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) coex_sta->high_priority_rx == 0 && coex_sta->low_priority_tx == 0 && coex_sta->low_priority_rx == 0) - bt_active = false; + bt_active = FALSE; if (coex_sta->high_priority_tx == 0xffff && coex_sta->high_priority_rx == 0xffff && coex_sta->low_priority_tx == 0xffff && coex_sta->low_priority_rx == 0xffff) - bt_active = false; + bt_active = FALSE; #else @@ -940,14 +1143,14 @@ void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) if (bt_active) { bt_disable_cnt = 0; - bt_disabled = false; + bt_disabled = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, &bt_disabled); } else { bt_disable_cnt++; if (bt_disable_cnt >= 2) { - bt_disabled = true; + bt_disabled = TRUE; bt_disable_cnt = 2; } @@ -956,9 +1159,9 @@ void halbtc8723d2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) } if (bt_disabled) - halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); + halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); else - halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, true); + halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, TRUE); if (coex_sta->bt_disabled != bt_disabled) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -1017,12 +1220,9 @@ u32 halbtc8723d2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, { u32 j = 0, delay_count = 0; - - /* wait for ready bit before access 0x7c0 */ - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); - + /* wait for ready bit before access 0x7c0/0x7c4 */ while (1) { - if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { delay_ms(50); delay_count++; if (delay_count >= 10) { @@ -1033,6 +1233,8 @@ u32 halbtc8723d2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, break; } + btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0x800F0000 | reg_addr); + return btcoexist->btc_read_4byte(btcoexist, 0x7c8); /* get read data */ @@ -1048,22 +1250,22 @@ void halbtc8723d2ant_ltecoex_indirect_write_reg(IN struct btc_coexist if (bit_mask == 0x0) return; if (bit_mask == 0xffffffff) { + /* wait for ready bit before access 0x7c0/0x7c4 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x7c4, reg_value); /* put write data */ - /* wait for ready bit before access 0x7c0 */ - while (1) { - if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { - delay_ms(50); - delay_count++; - if (delay_count >= 10) { - delay_count = 0; - break; - } - } else - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0xc00F0000 | reg_addr); } else { @@ -1079,22 +1281,22 @@ void halbtc8723d2ant_ltecoex_indirect_write_reg(IN struct btc_coexist reg_addr); val = (val & (~bit_mask)) | (reg_value << bitpos); + /* wait for ready bit before access 0x7c0/0x7c4 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x7c4, val); /* put write data */ - /* wait for ready bit before access 0x7c0 */ - while (1) { - if ((btcoexist->btc_read_1byte(btcoexist, 0x7c3) & BIT(5)) == 0) { - delay_ms(50); - delay_count++; - if (delay_count >= 10) { - delay_count = 0; - break; - } - } else - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x7c0, 0xc00F0000 | reg_addr); @@ -1318,7 +1520,7 @@ void halbtc8723d2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, coex_sta->coex_table_type = type; - if (coex_sta->concurrent_rx_mode_on == true) { + if (coex_sta->concurrent_rx_mode_on == TRUE) { break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ select_table = 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ @@ -1327,50 +1529,50 @@ void halbtc8723d2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, select_table = 0x3; } - switch (type) { - case 0: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0xffffffff, 0xffffffff, break_table, select_table); - break; - case 1: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, select_table); - break; - case 2: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); - break; - case 3: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0xaa555555, 0xaa5a5a5a, break_table, select_table); - break; - case 4: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, select_table); - break; - case 5: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, break_table, select_table); - break; - case 6: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0xfafafafa, break_table, select_table); - break; - case 7: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0xaa5a5a5a, break_table, select_table); - break; - case 8: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0xa5555555, 0xfafafafa, break_table, select_table); - break; - case 9: - halbtc8723d2ant_coex_table(btcoexist, force_exec, - 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); - break; - default: - break; - } + switch (type) { + case 0: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0xffffffff, 0xffffffff, break_table, select_table); + break; + case 1: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0xfafafafa, break_table, select_table); + break; + case 2: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); + break; + case 3: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, break_table, select_table); + break; + case 4: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0xffff55ff, 0xfafafafa, break_table, select_table); + break; + case 5: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555555, break_table, select_table); + break; + case 6: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0xaaffffaa, 0xfafafafa, break_table, select_table); + break; + case 7: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0xaaffffaa, 0xfafafafa, break_table, select_table); + break; + case 8: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0xffff55ff, 0xfafafafa, break_table, select_table); + break; + case 9: + halbtc8723d2ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); + break; + default: + break; + } } void halbtc8723d2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, @@ -1440,16 +1642,12 @@ void halbtc8723d2ant_ps_tdma_check_for_power_save_state( /* keep state under LPS, do nothing. */ } else { /* will leave LPS state, turn off psTdma first */ - /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); */ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); } } else { /* NO PS state */ if (new_ps_state) { /* will enter LPS state, turn off psTdma first */ - /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8);*/ btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); } else { @@ -1461,40 +1659,40 @@ void halbtc8723d2ant_ps_tdma_check_for_power_save_state( void halbtc8723d2ant_power_save_state(IN struct btc_coexist *btcoexist, IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) { - boolean low_pwr_disable = false; + boolean low_pwr_disable = FALSE; switch (ps_type) { case BTC_PS_WIFI_NATIVE: + coex_sta->force_lps_ctrl = FALSE; /* recover to original 32k low power setting */ - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, + low_pwr_disable = FALSE; + /* btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + &low_pwr_disable); */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_PRE_NORMAL_LPS, NULL); - coex_sta->force_lps_on = false; break; case BTC_PS_LPS_ON: + coex_sta->force_lps_ctrl = TRUE; halbtc8723d2ant_ps_tdma_check_for_power_save_state( - btcoexist, true); + btcoexist, TRUE); halbtc8723d2ant_lps_rpwm(btcoexist, NORMAL_EXEC, lps_val, rpwm_val); /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; + low_pwr_disable = TRUE; btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); /* power save must executed before psTdma. */ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, NULL); - coex_sta->force_lps_on = true; break; case BTC_PS_LPS_OFF: + coex_sta->force_lps_ctrl = TRUE; halbtc8723d2ant_ps_tdma_check_for_power_save_state( - btcoexist, false); + btcoexist, FALSE); btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, NULL); - coex_sta->force_lps_on = false; break; default: break; @@ -1508,13 +1706,14 @@ void halbtc8723d2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[5] = {0}; u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; + boolean ap_enable = FALSE; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 ps_type = BTC_PS_WIFI_NATIVE; if (byte5 & BIT(2)) - coex_sta->is_tdma_btautoslot = true; + coex_sta->is_tdma_btautoslot = TRUE; else - coex_sta->is_tdma_btautoslot = false; + coex_sta->is_tdma_btautoslot = FALSE; /* release bt-auto slot for auto-slot hang is detected!! */ if (coex_sta->is_tdma_btautoslot) @@ -1525,28 +1724,29 @@ void halbtc8723d2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], FW for AP mode\n"); - BTC_TRACE(trace_buf); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], FW for AP mode\n"); + BTC_TRACE(trace_buf); + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); - halbtc8723d2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8723d2ant_power_save_state(btcoexist, + ps_type, 0x0, + 0x0); } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + ps_type = BTC_PS_LPS_ON; halbtc8723d2ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, + btcoexist, ps_type, 0x50, 0x4); } else { - halbtc8723d2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8723d2ant_power_save_state(btcoexist, ps_type, 0x0, 0x0); } @@ -1565,6 +1765,9 @@ void halbtc8723d2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, coex_dm->ps_tdma_para[4] = real_byte5; btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + + if (ps_type == BTC_PS_WIFI_NATIVE) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_POST_NORMAL_LPS, NULL); } void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, @@ -1586,7 +1789,7 @@ void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { - force_exec = true; + force_exec = TRUE; pre_psTdmaByte4Modify = psTdmaByte4Modify; } @@ -1721,7 +1924,7 @@ void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 103: halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x3a, 0x3, 0x10, + 0x30, 0x3, 0x10, 0x50 | psTdmaByte4Modify); break; case 104: @@ -1731,7 +1934,7 @@ void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 105: halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x25, 0x3, 0x10, + 0x35, 0x3, 0x10, 0x50 | psTdmaByte4Modify); break; case 106: @@ -1741,8 +1944,8 @@ void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 107: halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x20, 0x3, 0x10, - 0x50 | psTdmaByte4Modify); + 0x10, 0x7, 0x10, + 0x54); break; case 108: halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, @@ -1750,24 +1953,49 @@ void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, 0x50 | psTdmaByte4Modify); break; case 109: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, 0x10, 0x03, 0x10, 0x54 | psTdmaByte4Modify); break; case 110: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x55, + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, 0x30, 0x03, 0x10, 0x50 | psTdmaByte4Modify); break; case 111: - halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x65, + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, 0x25, 0x03, 0x11, - 0x11 | psTdmaByte4Modify); + 0x11); + break; + case 112: + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, + 0x4a, 0x3, 0x10, + 0x50); + break; + case 113: + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, + 0x48, 0x03, 0x11, + 0x10); + break; + case 116: + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, + 0x08, 0x03, 0x10, + 0x54 | psTdmaByte4Modify); + break; + case 117: + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, + 0x08, 0x03, 0x10, + 0x14 | psTdmaByte4Modify); + break; + case 119: + halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x14 | psTdmaByte4Modify); break; case 151: halbtc8723d2ant_set_fw_pstdma(btcoexist, 0x51, - 0x10, 0x03, 0x10, - 0x50 | psTdmaByte4Modify); + 0x10, 0x03, 0x10, + 0x50 | psTdmaByte4Modify); break; } } else { @@ -1788,9 +2016,9 @@ void halbtc8723d2ant_ps_tdma(IN struct btc_coexist *btcoexist, } } - /* update pre state */ coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; + } void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, @@ -1799,11 +2027,11 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, { struct btc_board_info *board_info = &btcoexist->board_info; u32 u32tmp = 0; - boolean pg_ext_switch = false, is_hw_ant_div_on = false; + boolean pg_ext_switch = FALSE, is_hw_ant_div_on = FALSE; u8 h2c_parameter[2] = {0}; u32 cnt_bt_cal_chk = 0; u8 u8tmp0 = 0, u8tmp1 = 0; - boolean is_in_mp_mode = false; + boolean is_in_mp_mode = FALSE; u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0; u16 u16tmp0 = 0, u16tmp1 = 0; @@ -1813,7 +2041,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, /* To avoid indirect access fail */ if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { - force_exec = true; + force_exec = TRUE; coex_sta->gnt_error_cnt++; } @@ -1836,6 +2064,8 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); #endif + coex_sta->is_2g_freerun = ((phase == BT_8723D_2ANT_PHASE_2G_FREERUN) ? TRUE : FALSE); + coex_dm->cur_ant_pos_type = ant_pos_type; if (!force_exec) { @@ -1874,7 +2104,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_PATH_WIFI; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; case BT_8723D_2ANT_PHASE_COEX_INIT: @@ -1941,7 +2171,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; if (BTC_ANT_PATH_AUTO == ant_pos_type) { if (board_info->btdm_ant_pos == @@ -1990,7 +2220,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; if (BTC_ANT_PATH_AUTO == ant_pos_type) { if (board_info->btdm_ant_pos == @@ -2016,7 +2246,9 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, btcoexist, BT_8723D_2ANT_PCO_BTSIDE); - coex_sta->run_time_state = false; + /*halbtc8723d2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, TRUE);*/ + + coex_sta->run_time_state = FALSE; break; case BT_8723D_2ANT_PHASE_2G_RUNTIME: @@ -2069,7 +2301,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, BT_8723D_2ANT_GNT_TYPE_CTRL_BY_PTA, BT_8723D_2ANT_SIG_STA_SET_BY_HW); - coex_sta->run_time_state = true; + coex_sta->run_time_state = TRUE; if (BTC_ANT_PATH_AUTO == ant_pos_type) { if (board_info->btdm_ant_pos == @@ -2081,6 +2313,27 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, BTC_ANT_WIFI_AT_AUX; } + break; + case BT_8723D_2ANT_PHASE_2G_FREERUN: + + /* set Path control owner to WL at runtime step */ + halbtc8723d2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8723D_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Hi */ + halbtc8723d2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8723D_2ANT_GNT_BLOCK_RFC_BB, + BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW Hi */ + halbtc8723d2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8723D_2ANT_GNT_BLOCK_RFC_BB, + BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8723D_2ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = TRUE; + break; case BT_8723D_2ANT_PHASE_BTMPMODE: /* Disable LTE Coex Function in WiFi side */ @@ -2107,7 +2360,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, BT_8723D_2ANT_GNT_TYPE_CTRL_BY_SW, BT_8723D_2ANT_SIG_STA_SET_TO_LOW); - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; if (BTC_ANT_PATH_AUTO == ant_pos_type) { if (board_info->btdm_ant_pos == @@ -2146,7 +2399,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, if (BTC_ANT_PATH_AUTO == ant_pos_type) ant_pos_type = BTC_ANT_WIFI_AT_AUX; - coex_sta->run_time_state = false; + coex_sta->run_time_state = FALSE; break; } @@ -2155,7 +2408,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, if ((is_hw_ant_div_on) && (phase != BT_8723D_2ANT_PHASE_ANTENNA_DET)) btcoexist->btc_write_2byte(btcoexist, 0x948, 0x140); - else if ((is_hw_ant_div_on == false) && + else if ((is_hw_ant_div_on == FALSE) && (phase != BT_8723D_2ANT_PHASE_WLAN_OFF)) { switch (ant_pos_type) { @@ -2197,7 +2450,7 @@ void halbtc8723d2ant_set_ant_path(IN struct btc_coexist *btcoexist, u8 halbtc8723d2ant_action_algorithm(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; + boolean bt_hs_on = FALSE; u8 algorithm = BT_8723D_2ANT_COEX_ALGO_UNDEFINED; u8 num_of_diff_profile = 0; @@ -2227,6 +2480,11 @@ u8 halbtc8723d2ant_action_algorithm(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); algorithm = BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY; } + } else if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP Sink\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8723D_2ANT_COEX_ALGO_A2DPSINK; } else if (num_of_diff_profile == 1) { if (bt_link_info->sco_exist) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -2415,25 +2673,57 @@ u8 halbtc8723d2ant_action_algorithm(IN struct btc_coexist *btcoexist) void halbtc8723d2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) { + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); /* fw all off */ - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } void halbtc8723d2ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } +void halbtc8723d2ant_action_freerun(IN struct btc_coexist *btcoexist) +{ + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], wifi_freerun!!\n"); + BTC_TRACE(trace_buf); + + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + + /* just for GNT_WL = 1 && GNT_BT = 1, not for antenna control */ + halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8723D_2ANT_PHASE_2G_FREERUN); + if (wifi_busy) + //halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + else + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); +} + + + void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist) { static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; @@ -2443,7 +2733,7 @@ void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false, wifi_turbo = false; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); @@ -2456,7 +2746,7 @@ void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist) #if 1 if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; + wifi_turbo = TRUE; #endif @@ -2466,48 +2756,55 @@ void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } } @@ -2516,9 +2813,9 @@ void halbtc8723d2ant_action_bt_hs(IN struct btc_coexist *btcoexist) void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) { - boolean wifi_connected = false; - boolean wifi_scan = false, wifi_link = false, wifi_roam = false; - boolean wifi_busy = false; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE; + boolean wifi_busy = FALSE; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; @@ -2531,8 +2828,13 @@ void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, FORCE_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) - || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { + || (wifi_scan) || (coex_sta->wifi_is_high_pri_task))) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); @@ -2542,10 +2844,10 @@ void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) 8); if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 15); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); } else if ((!wifi_connected) && (!wifi_scan)) { @@ -2555,56 +2857,65 @@ void halbtc8723d2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (bt_link_info->pan_exist) { - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); } else if (bt_link_info->a2dp_exist) { - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); } else { - if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) - || (coex_sta->wifi_is_high_pri_task)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if ((wifi_link) || (wifi_roam) || (wifi_scan) + || (coex_sta->wifi_is_high_pri_task)) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 23); } - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); } void halbtc8723d2ant_action_bt_relink(IN struct btc_coexist *btcoexist) { - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_sta->bt_relink_downcount = 2; + if (((!coex_sta->is_bt_multi_link) && (!bt_link_info->pan_exist)) || + ((bt_link_info->a2dp_exist) && (bt_link_info->hid_exist))) { + + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, FORCE_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } } void halbtc8723d2ant_action_bt_idle(IN struct btc_coexist *btcoexist) { - boolean wifi_busy = false; + boolean wifi_busy = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, FORCE_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + if (!wifi_busy) { halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 14); } else { /* if wl busy */ if (BT_8723D_1ANT_BT_STATUS_NON_CONNECTED_IDLE == @@ -2613,19 +2924,16 @@ void halbtc8723d2ant_action_bt_idle(IN struct btc_coexist *btcoexist) halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else { halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 12); } } - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - } @@ -2640,7 +2948,7 @@ void halbtc8723d2ant_action_sco(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; u32 wifi_bw = 1; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, @@ -2654,39 +2962,45 @@ void halbtc8723d2ant_action_sco(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; if (coex_sta->is_eSCO_mode) halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); else /* 2-Ant free run if eSCO mode */ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); } } @@ -2701,7 +3015,7 @@ void halbtc8723d2ant_action_hid(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; u32 wifi_bw = 1; @@ -2714,75 +3028,146 @@ void halbtc8723d2ant_action_hid(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; - /*for 4/18 hid */ - if (coex_sta->hid_busy_num >= 2) { - if (wifi_bw == 0) { /* if 11bg mode */ + if (coex_sta->is_hid_low_pri_tx_overhead) { - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 111); - } else { + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 108); + } else if (coex_sta->is_hid_rcu) { - if (wifi_busy) { - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 111); - } else { + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 113); + } else if (wifi_bw == 0) { /* if 11bg mode */ - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 3); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - } - } + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 111); } else { - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 3); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 111); } } } +void halbtc8723d2ant_action_a2dpsink(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif + + wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 1); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); + } else { + + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 105); + } + +} /* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ void halbtc8723d2ant_action_a2dp(IN struct btc_coexist *btcoexist) @@ -2794,12 +3179,23 @@ void halbtc8723d2ant_action_a2dp(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false, wifi_turbo = false; + + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3, bt_rssi_state3; + + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + u32 wifi_link_status = 0; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", coex_sta->scan_ap_num, coex_sta->wl_noisy_level); @@ -2807,7 +3203,7 @@ void halbtc8723d2ant_action_a2dp(IN struct btc_coexist *btcoexist) #if 1 if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; + wifi_turbo = TRUE; #endif wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, @@ -2816,79 +3212,97 @@ void halbtc8723d2ant_action_a2dp(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8723d2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 40, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + bt_rssi_state3 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state3, 2, + 80, 0); + +#if 1 + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8723d2ant_action_freerun(btcoexist); + } else { + + if (wifi_link_status & WIFI_P2P_GC_CONNECTED) { + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 15); + + } else { + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0x0); + } + + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if (BTC_RSSI_HIGH(wifi_rssi_state3)) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 119); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 101); + } + +#else if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 1); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 1); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 16); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; - - if ((coex_sta->bt_relink_downcount != 0) - && (wifi_busy)) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); - BTC_TRACE(trace_buf); - - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - - } else { - - if (wifi_turbo) - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - else - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 101); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 16); - /*halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 102);*/ - } + coex_dm->is_switch_to_1dot5_ant = TRUE; + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 101); } +#endif } @@ -2902,12 +3316,16 @@ void halbtc8723d2ant_action_pan_edr(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false, wifi_turbo = false; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3, bt_rssi_state3; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", coex_sta->scan_ap_num, coex_sta->wl_noisy_level); @@ -2915,7 +3333,7 @@ void halbtc8723d2ant_action_pan_edr(IN struct btc_coexist *btcoexist) #if 1 if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; + wifi_turbo = TRUE; #endif wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, @@ -2924,23 +3342,35 @@ void halbtc8723d2ant_action_pan_edr(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8723d2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 58, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + bt_rssi_state3 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state3, 2, + 47, 0); #if 0 - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); #endif @@ -2948,51 +3378,56 @@ void halbtc8723d2ant_action_pan_edr(IN struct btc_coexist *btcoexist) if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 3); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 3); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 4); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - if (wifi_turbo) - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - else - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); + /* for Lenovo CPT_For_WiFi OPP test */ + if ((btcoexist->board_info.customerID == RT_CID_LENOVO_CHINA) && + BTC_RSSI_HIGH(wifi_rssi_state3) && (wifi_busy)) { + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 103); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 104); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 112); + } else { + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + + if (wifi_busy) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 103); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 104); + } } #endif @@ -3008,7 +3443,13 @@ void halbtc8723d2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3, bt_rssi_state3; + + + boolean wifi_busy = FALSE; u32 wifi_bw = 1; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, @@ -3021,89 +3462,108 @@ void halbtc8723d2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8723d2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 40, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + bt_rssi_state3 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state3, 2, + 40, 0); + +#if 1 if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_action_freerun(btcoexist); + } else { - coex_dm->is_switch_to_1dot5_ant = false; + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0x0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if (coex_sta->hid_pair_cnt > 1) { + if (BTC_RSSI_HIGH(wifi_rssi_state3)) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 117); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 116); + } else { + if (BTC_RSSI_HIGH(wifi_rssi_state3)) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 119); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 109); + } + } + +#else + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 1); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 1); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 16); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - if ((coex_sta->bt_relink_downcount != 0) - && (wifi_busy)) { + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); - BTC_TRACE(trace_buf); - - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else if (wifi_busy) { - if (coex_sta->hid_busy_num >= 2) { - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - if (wifi_bw == 0) /*11bg mode */ - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - else - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 109); - } else { - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 101); - } + if (coex_sta->hid_pair_cnt > 1) { + if (BTC_RSSI_HIGH(wifi_rssi_state3)) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 117); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 116); } else { - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 1); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 16); + if (BTC_RSSI_HIGH(wifi_rssi_state3)) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 119); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 109); } - } - +#endif } @@ -3116,7 +3576,7 @@ void halbtc8723d2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false, wifi_turbo = false; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); @@ -3129,7 +3589,7 @@ void halbtc8723d2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) #if 1 if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; + wifi_turbo = TRUE; #endif @@ -3139,33 +3599,39 @@ void halbtc8723d2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); @@ -3174,40 +3640,37 @@ void halbtc8723d2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 7); + TRUE, 7); else halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 5); + TRUE, 5); } else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; if (wifi_turbo) - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); else - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); if (wifi_busy) { if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 107); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 105); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 105); } else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 106); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 106); } @@ -3224,12 +3687,20 @@ void halbtc8723d2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false, wifi_turbo = false; + + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3, bt_rssi_state3; + + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", coex_sta->scan_ap_num, coex_sta->wl_noisy_level); @@ -3237,7 +3708,7 @@ void halbtc8723d2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) #if 1 if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) - wifi_turbo = true; + wifi_turbo = TRUE; #endif @@ -3247,31 +3718,45 @@ void halbtc8723d2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8723d2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 40, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + bt_rssi_state3 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state3, 2, + 45, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); @@ -3280,44 +3765,43 @@ void halbtc8723d2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) if (((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) || (!coex_sta->is_A2DP_3M)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 7); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 5); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 6); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - if (wifi_turbo) - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 6); - else - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); + /* for Lenovo coex test case */ + if ((btcoexist->board_info.customerID == RT_CID_LENOVO_CHINA) && + (coex_sta->scan_ap_num <= 10)) { - if (wifi_busy) { + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - if ((coex_sta->a2dp_bit_pool > 40) && - (coex_sta->a2dp_bit_pool < 255)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 107); - else if (wifi_turbo) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 108); + /* for CPT_for_WiFi */ + if (BTC_RSSI_HIGH(bt_rssi_state3) && BTC_RSSI_LOW(wifi_rssi_state3)) { + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, FORCE_EXEC, 10); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 105); + } else { /* for CPT_for_BT */ + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); + } + } else { + + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if (wifi_busy) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 105); - } else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 106); - + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 106); + } } } @@ -3332,7 +3816,7 @@ void halbtc8723d2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; u32 wifi_bw = 1; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, @@ -3346,78 +3830,60 @@ void halbtc8723d2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 3); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 3); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 4); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - if (coex_sta->hid_busy_num >= 2) { - - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - if (wifi_bw == 0) /*11bg mode */ - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - else - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 110); - } else { - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - - if (wifi_busy) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 103); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 104); - } + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + if (wifi_busy) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 103); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 104); } } @@ -3433,7 +3899,7 @@ void halbtc8723d2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; u32 wifi_bw = 1; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, @@ -3443,36 +3909,42 @@ void halbtc8723d2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) wifi_rssi_state = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8723d2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, coex_sta->wifi_coex_thres2 , 0); - bt_rssi_state = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8723d2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x6); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0x90); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); @@ -3481,108 +3953,79 @@ void halbtc8723d2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) if (((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) || (!coex_sta->is_A2DP_3M)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 7); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 5); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 6); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - if (coex_sta->hid_busy_num >= 2) { - halbtc8723d2ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 8); - if (wifi_bw == 0) /*11bg mode */ - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x1, 0xaa, - 0x5a, 0xaa, - 0xaa); - else - halbtc8723d2ant_set_wltoggle_coex_table(btcoexist, - NORMAL_EXEC, - 0x2, 0xaa, - 0x5a, 0xaa, - 0xaa); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 110); - } else { - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - if (wifi_busy) { - - if ((coex_sta->a2dp_bit_pool > 40) && - (coex_sta->a2dp_bit_pool < 255)) - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 107); - else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 105); - } else - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 106); - } + if (wifi_busy) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 106); } } +void halbtc8723d2ant_action_wifi_native_lps(IN struct btc_coexist *btcoexist) +{ + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); +} void halbtc8723d2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) { - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 15); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); /* hw all off */ halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } void halbtc8723d2ant_action_wifi_linkscan_process(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, FORCE_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - if (bt_link_info->pan_exist) { - - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - - } else if (bt_link_info->a2dp_exist) { - - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 16); - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - } else { - - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - - halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - } - + if (bt_link_info->pan_exist) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + else if (bt_link_info->a2dp_exist) + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); + else + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); } void halbtc8723d2ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) { + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); /* fw all off */ - halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } void halbtc8723d2ant_action_wifi_connected(IN struct btc_coexist *btcoexist) @@ -3607,6 +4050,12 @@ void halbtc8723d2ant_action_wifi_connected(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); halbtc8723d2ant_action_a2dp(btcoexist); break; + case BT_8723D_2ANT_COEX_ALGO_A2DPSINK: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP Sink.\n"); + BTC_TRACE(trace_buf); + halbtc8723d2ant_action_a2dpsink(btcoexist); + break; case BT_8723D_2ANT_COEX_ALGO_A2DP_PANHS: BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); @@ -3669,11 +4118,11 @@ void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) u32 num_of_wifi_link = 0; u32 wifi_link_status = 0; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean miracast_plus_bt = false; - boolean scan = false, link = false, roam = false, - under_4way = false, - wifi_connected = false, wifi_under_5g = false, - bt_hs_on = false; + boolean miracast_plus_bt = FALSE; + boolean scan = FALSE, link = FALSE, roam = FALSE, + under_4way = FALSE, + wifi_connected = FALSE, wifi_under_5g = FALSE, + bt_hs_on = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); @@ -3685,6 +4134,11 @@ void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) "[BTCoex], RunCoexistMechanism()===>\n"); BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], under_lps = %d, force_lps_ctrl = %d, acl_busy = %d!!!\n", + coex_sta->under_lps, coex_sta->force_lps_ctrl, coex_sta->acl_busy); + BTC_TRACE(trace_buf); + if (btcoexist->manual_control) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); @@ -3708,18 +4162,27 @@ void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) if (!coex_sta->run_time_state) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], return for run_time_state = false !!!\n"); + "[BTCoex], return for run_time_state = FALSE !!!\n"); BTC_TRACE(trace_buf); return; } if (coex_sta->freeze_coexrun_by_btinfo) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); + "[BTCoex], return for freeze_coexrun_by_btinfo\n"); BTC_TRACE(trace_buf); return; } + if ((coex_sta->under_lps) && (!coex_sta->force_lps_ctrl) && + (!coex_sta->acl_busy)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); + BTC_TRACE(trace_buf); + halbtc8723d2ant_action_wifi_native_lps(btcoexist); + return; + } + if (coex_sta->bt_whck_test) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BT is under WHCK TEST!!!\n"); @@ -3744,9 +4207,12 @@ void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) return; } - if (coex_sta->is_setupLink) { + if ((coex_sta->is_setupLink) && + (coex_sta->bt_relink_downcount != 0) && + (!coex_sta->is_2g_freerun)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is re-link !!!\n"); + "[BTCoex], BT is re-link !!!\n"); + BTC_TRACE(trace_buf); halbtc8723d2ant_action_bt_relink(btcoexist); return; } @@ -3764,9 +4230,9 @@ void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); if (bt_link_info->bt_link_exist) - miracast_plus_bt = true; + miracast_plus_bt = TRUE; else - miracast_plus_bt = false; + miracast_plus_bt = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &miracast_plus_bt); @@ -3787,10 +4253,6 @@ void halbtc8723d2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) halbtc8723d2ant_action_wifi_multi_port(btcoexist); return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); } btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); @@ -3853,11 +4315,13 @@ void halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist) "[BTCoex], Coex Mechanism Init!!\n"); BTC_TRACE(trace_buf); - halbtc8723d2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8723d2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_tx_power(btcoexist, NORMAL_EXEC, 0xb2); + halbtc8723d2ant_adjust_bt_tx_power(btcoexist, NORMAL_EXEC, 0); + halbtc8723d2ant_adjust_wl_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8723d2ant_adjust_bt_rx_gain(btcoexist, NORMAL_EXEC, FALSE); /* sw all off */ - halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, false); + halbtc8723d2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); coex_sta->pop_event_cnt = 0; coex_sta->cnt_RemoteNameReq = 0; @@ -3865,6 +4329,7 @@ void halbtc8723d2ant_init_coex_dm(IN struct btc_coexist *btcoexist) coex_sta->cnt_setupLink = 0; coex_sta->cnt_IgnWlanAct = 0; coex_sta->cnt_Page = 0; + coex_sta->cnt_RoleSwitch = 0; halbtc8723d2ant_query_bt_info(btcoexist); } @@ -3915,6 +4380,7 @@ void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, coex_sta->bt_reg_vendor_ae = 0xffff; coex_sta->gnt_error_cnt = 0; coex_sta->bt_relink_downcount = 0; + coex_sta->wl_rx_rate = BTC_UNKNOWN; for (i = 0; i <= 9; i++) coex_sta->bt_afh_map[i] = 0; @@ -3953,13 +4419,13 @@ void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, /* Enable PTA (tx/rx signal form WiFi side) */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); - halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true); + halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, TRUE); #if 0 /* check if WL firmware download ok */ if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, true); + BT_8723D_2ANT_SCOREBOARD_ONOFF, TRUE); #endif /* Enable counter statistics */ @@ -3969,14 +4435,21 @@ void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); - halbtc8723d2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + psd_scan->ant_det_is_ant_det_available = TRUE; - halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + if (coex_sta->is_rf_state_off) { - psd_scan->ant_det_is_ant_det_available = true; + halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8723D_2ANT_PHASE_WLAN_OFF); - if (wifi_only) { - coex_sta->concurrent_rx_mode_on = false; + btcoexist->stop_coex_dm = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** halbtc8723d2ant_init_hw_config (RF Off)**********\n"); + BTC_TRACE(trace_buf); + } else if (wifi_only) { + coex_sta->concurrent_rx_mode_on = FALSE; /* Path config */ /* Set Antenna Path */ halbtc8723d2ant_set_ant_path(btcoexist, @@ -3984,12 +4457,12 @@ void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, FORCE_EXEC, BT_8723D_2ANT_PHASE_WLANONLY_INIT); - btcoexist->stop_coex_dm = true; + btcoexist->stop_coex_dm = TRUE; } else { /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); - coex_sta->concurrent_rx_mode_on = true; + coex_sta->concurrent_rx_mode_on = TRUE; /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ /* RF 0x1[0] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx */ @@ -4001,10 +4474,12 @@ void halbtc8723d2ant_init_hw_config(IN struct btc_coexist *btcoexist, FORCE_EXEC, BT_8723D_2ANT_PHASE_COEX_INIT); - btcoexist->stop_coex_dm = false; + btcoexist->stop_coex_dm = FALSE; } + halbtc8723d2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); } u32 halbtc8723d2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) @@ -4512,7 +4987,7 @@ boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, u32 points1 = 0, psd_report = 0; u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; u32 psd_center_freq = 20 * 10 ^ 6; - boolean outloop = false, scan , roam, is_sweep_ok = true; + boolean outloop = FALSE, scan, roam, is_sweep_ok = TRUE; u8 flag = 0; u32 tmp = 0, u32tmp1 = 0; u32 wifi_original_channel = 1; @@ -4657,7 +5132,7 @@ boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); if (scan || roam) { - is_sweep_ok = false; + is_sweep_ok = FALSE; break; } memset(psd_scan->psd_report, 0, @@ -4785,7 +5260,7 @@ boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, break; case 99: /* error */ - outloop = true; + outloop = TRUE; break; case 100: /* recovery */ @@ -4819,7 +5294,7 @@ boolean halbtc8723d2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, 0x3ff, wifi_original_channel); - outloop = true; + outloop = TRUE; break; } @@ -4848,7 +5323,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; u8 state = 0; - boolean outloop = false, bt_resp = false, ant_det_finish = false; + boolean outloop = FALSE, bt_resp = FALSE, ant_det_finish = FALSE; u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, u32tmp, u32tmp0, u32tmp1, u32tmp2 ; struct btc_board_info *board_info = &btcoexist->board_info; @@ -4890,7 +5365,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", bt_le_channel); BTC_TRACE(trace_buf); - outloop = true; + outloop = TRUE; break; } } @@ -4919,20 +5394,20 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist break; case 1: /* stop coex DM & set antenna path */ /* Stop Coex DM */ - btcoexist->stop_coex_dm = true; + btcoexist->stop_coex_dm = TRUE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); BTC_TRACE(trace_buf); /* Set TDMA off, */ - halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, - false, 0); - /* Set coex table */ halbtc8723d2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8723d2ant_ps_tdma(btcoexist, FORCE_EXEC, + FALSE, 0); + if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -4987,7 +5462,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist wlpsd_cent_freq, wlpsd_offset, wlpsd_span, BT_8723D_2ANT_ANTDET_PSD_POINTS, BT_8723D_2ANT_ANTDET_PSD_AVGNUM, 3)) { - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; psd_scan->ant_det_result = 8; state = 99; @@ -5007,7 +5482,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist BT_8723D_2ANT_ANTDET_PSDTHRES_BACKGROUND + psd_scan->ant_det_thres_offset); BTC_TRACE(trace_buf); - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; psd_scan->ant_det_result = 5; state = 99; @@ -5036,7 +5511,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist BT_8723D_2ANT_ANTDET_PSD_POINTS, BT_8723D_2ANT_ANTDET_PSD_AVGNUM, BT_8723D_2ANT_ANTDET_PSD_SWWEEPCOUNT)) { - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; psd_scan->ant_det_result = 8; state = 99; @@ -5117,13 +5592,13 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist "%d.%d", psd_rep1, psd_rep2); } - psd_scan->ant_det_is_btreply_available = true; + psd_scan->ant_det_is_btreply_available = TRUE; - if (bt_resp == false) { + if (bt_resp == FALSE) { psd_scan->ant_det_is_btreply_available = - false; + FALSE; psd_scan->ant_det_result = 0; - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); @@ -5132,7 +5607,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) * 100) { psd_scan->ant_det_result = 1; - ant_det_finish = true; + ant_det_finish = TRUE; board_info->btdm_ant_num_by_ant_det = 2; coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->ant_det_psd_scan_peak_val / @@ -5144,7 +5619,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist (BT_8723D_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION + psd_scan->ant_det_thres_offset) * 100) { psd_scan->ant_det_result = 2; - ant_det_finish = true; + ant_det_finish = TRUE; board_info->btdm_ant_num_by_ant_det = 2; coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->ant_det_psd_scan_peak_val / @@ -5156,7 +5631,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist (BT_8723D_2ANT_ANTDET_PSDTHRES_1ANT) * 100) { psd_scan->ant_det_result = 3; - ant_det_finish = true; + ant_det_finish = TRUE; board_info->btdm_ant_num_by_ant_det = 1; coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->ant_det_psd_scan_peak_val / @@ -5166,7 +5641,7 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist BTC_TRACE(trace_buf); } else { psd_scan->ant_det_result = 4; - ant_det_finish = false; + ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); @@ -5200,13 +5675,13 @@ boolean halbtc8723d2ant_psd_antenna_detection(IN struct btc_coexist "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; + btcoexist->stop_coex_dm = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); BTC_TRACE(trace_buf); - outloop = true; + outloop = TRUE; break; } @@ -5225,7 +5700,7 @@ boolean halbtc8723d2ant_psd_antenna_detection_check(IN struct btc_coexist static u32 ant_det_count = 0, ant_det_fail_count = 0; struct btc_board_info *board_info = &btcoexist->board_info; - boolean scan, roam, ant_det_finish = false; + boolean scan, roam, ant_det_finish = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); @@ -5235,20 +5710,20 @@ boolean halbtc8723d2ant_psd_antenna_detection_check(IN struct btc_coexist psd_scan->ant_det_try_count = ant_det_count; if (scan || roam) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 6; } else if (coex_sta->bt_disabled) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 11; } else if (coex_sta->num_of_profile >= 1) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 7; } else if ( !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 9; } else if (coex_sta->c2h_bt_inquiry_page) { - ant_det_finish = false; + ant_det_finish = FALSE; psd_scan->ant_det_result = 10; } else { @@ -5268,7 +5743,7 @@ boolean halbtc8723d2ant_psd_antenna_detection_check(IN struct btc_coexist "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", psd_scan->ant_det_result, psd_scan->ant_det_fail_count, - ant_det_finish == true ? "Yes" : "No"); + ant_det_finish == TRUE ? "Yes" : "No"); BTC_TRACE(trace_buf); return ant_det_finish; @@ -5300,8 +5775,9 @@ void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = true; - psd_scan->ant_det_is_ant_det_available = false; + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = FALSE; + psd_scan->ant_det_is_ant_det_available = FALSE; /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); @@ -5356,7 +5832,7 @@ void ex_halbtc8723d2ant_power_on_setting(IN struct btc_coexist *btcoexist) btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, true); + halbtc8723d2ant_enable_gnt_to_gpio(btcoexist, TRUE); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", @@ -5426,9 +5902,9 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) u16 u16tmp[4]; u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck, bt_coex_ver = 0; u32 fw_ver = 0, bt_patch_ver = 0; - static u8 pop_report_in_10s = 0; + static u8 pop_report_in_10s = 0, cnt = 0; u32 phyver = 0; - boolean lte_coex_on = false; + boolean lte_coex_on = FALSE; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -5443,6 +5919,42 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); } + if (!coex_sta->bt_disabled) { + + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + if (psd_scan->ant_det_try_count == 0) { CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", "Ant PG Num/ Mech/ Pos", @@ -5538,10 +6050,10 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) pop_report_in_10s++; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", - "BT [status/ rssi/ retryCnt/ popCnt]", + "\r\n %-35s = %s/ %ddBm/ %d/ %d", + "BT status/ rssi/ retryCnt/ popCnt", ((coex_sta->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") + coex_sta->c2h_bt_inquiry_page) ? ("inquiry-page") : ((BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE == coex_dm->bt_status) ? "non-connected idle" : ((BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) @@ -5555,22 +6067,25 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) pop_report_in_10s = 0; } - if (coex_sta->num_of_profile != 0) CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s%s%s%s%s", - "Profiles", - ((bt_link_info->a2dp_exist) ? "A2DP," : ""), - ((bt_link_info->sco_exist) ? "SCO," : ""), - ((bt_link_info->hid_exist) ? - ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : - "HID(2/18),") : ""), - ((bt_link_info->pan_exist) ? "PAN," : ""), - ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + "\r\n %-35s = %s%s%s%s%s (multilink = %d)", + "Profiles", + ((bt_link_info->a2dp_exist) ? + ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : + "A2DP,") : ""), + ((bt_link_info->sco_exist) ? "HFP," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->is_hid_rcu) ? "HID(RCU)" : + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : + "HID(2/18),")) : ""), + ((bt_link_info->pan_exist) ? + ((coex_sta->is_bt_opp_exist) ? "OPP," : "PAN,") : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : ""), + coex_sta->is_bt_multi_link); else CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = None", - "Profiles"); + "\r\n %-35s = None", "Profiles"); CL_PRINTF(cli_buf); @@ -5583,36 +6098,44 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) ((coex_sta->is_autoslot) ? "On" : "Off") ); CL_PRINTF(cli_buf); - } - if (bt_link_info->hid_exist) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "HID PairNum/Forbid_Slot", - coex_sta->hid_pair_cnt, - coex_sta->forbidden_slot + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %d/ %d", + "V_ID/D_name/FBSlot_Legacy/FBSlot_Le", + coex_sta->bt_a2dp_vendor_id, + coex_sta->bt_a2dp_device_name, + coex_sta->legacy_forbidden_slot, + coex_sta->le_forbidden_slot ); CL_PRINTF(cli_buf); } - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ 0x%x/ 0x%x", - "Role/IgnWlanAct/Feature/BLEScan", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), - coex_sta->bt_coex_supported_feature, - coex_sta->bt_ble_scan_type); + if (bt_link_info->hid_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "HID PairNum", + coex_sta->hid_pair_cnt + ); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", + "Role/RoleSwCnt/IgnWlact/Feature", + ((bt_link_info->slave_role) ? "Slave" : "Master"), + coex_sta->cnt_RoleSwitch, + ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), + coex_sta->bt_coex_supported_feature); CL_PRINTF(cli_buf); if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%08x/ 0x%08x/ 0x%08x", - "BLEScan Intv-Win TV/Init/Ble", + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "BLEScan Type/TV/Init/Ble", + coex_sta->bt_ble_scan_type, (coex_sta->bt_ble_scan_type & 0x1 ? coex_sta->bt_ble_scan_para[0] : 0x0), (coex_sta->bt_ble_scan_type & 0x2 ? coex_sta->bt_ble_scan_para[1] : 0x0), (coex_sta->bt_ble_scan_type & 0x4 ? coex_sta->bt_ble_scan_para[2] : 0x0)); - CL_PRINTF(cli_buf); } @@ -5630,20 +6153,20 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) if ((coex_sta->bt_reg_vendor_ae == 0xffff) || (coex_sta->bt_reg_vendor_ac == 0xffff)) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", - "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ 0x%04x", + "0xae[4]/0xac[1:0]/Scoreboard(B->W)", u16tmp[0]); else CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ %04x", - "0xae[4]/0xac[1:0]/Scoreboard", - (unsigned int)((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), + "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x", + "0xae[4]/0xac[1:0]/Scoreboard(B->W)", + ((unsigned int)(coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); CL_PRINTF(cli_buf); if (coex_sta->num_of_profile > 0) { CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", + "\r\n %-35s = %02x%02x%02x%02x %02x%02x%02x%02x %02x%02x", "AFH MAP", coex_sta->bt_afh_map[0], coex_sta->bt_afh_map[1], @@ -5711,24 +6234,30 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x", - "0x778/0x6cc", - u8tmp[0], u32tmp[0]); + "\r\n %-35s = 0x%x/ 0x%x/ 0x%04x", + "0x778/0x6cc/Scoreboard(W->B)", + u8tmp[0], u32tmp[0], coex_sta->score_board_WB); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", "AntDiv/ ForceLPS", ((board_info->ant_div_cfg) ? "On" : "Off"), - ((coex_sta->force_lps_on) ? "On" : "Off")); + ((coex_sta->force_lps_ctrl) ? "On" : "Off")); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "WL_DACSwing/ BT_Dec_Pwr", coex_dm->cur_fw_dac_swing_lvl, + "WL_Pwr/ BT_Pwr", coex_dm->cur_fw_dac_swing_lvl, coex_dm->cur_bt_dec_pwr_lvl); CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "BT_Empty/BT_Late", + coex_sta->wl_fw_dbg_info[4], + coex_sta->wl_fw_dbg_info[5]); + CL_PRINTF(cli_buf); + u32tmp[0] = halbtc8723d2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? true : false; + lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; if (lte_coex_on) { @@ -5801,7 +6330,7 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) } CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", + "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s (gnt_err = %d)", "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), @@ -5819,10 +6348,12 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x948); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x67); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x883); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0x948/0x67[7]", - u16tmp[0], (int)((u8tmp[0] & BIT(7)) >> 7)); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x948/0x67[7]/0x883", + u16tmp[0], (int)((u8tmp[0] & BIT(7)) >> 7), + u8tmp[1]); CL_PRINTF(cli_buf); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x964); @@ -5869,11 +6400,11 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) cca_cck, fa_cck, cca_ofdm, fa_ofdm); CL_PRINTF(cli_buf); -#if 1 - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11n-agg", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d (Rx_rate Data/RTS= %d/%d)", + "CRC_OK CCK/11g/11n/11ac", coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht, + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", @@ -5881,13 +6412,12 @@ void ex_halbtc8723d2ant_display_coex_info(IN struct btc_coexist *btcoexist) coex_sta->crc_err_cck, coex_sta->crc_err_11g, coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); CL_PRINTF(cli_buf); -#endif CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", "WlHiPri/ Locking/ Locked/ Noisy", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No"), + (coex_sta->cck_lock_ever ? "Yes" : "No"), coex_sta->wl_noisy_level); CL_PRINTF(cli_buf); @@ -5917,15 +6447,15 @@ void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS ENTER notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - coex_sta->under_lps = false; + coex_sta->under_ips = TRUE; + coex_sta->under_lps = FALSE; halbtc8723d2ant_post_state_to_bt(btcoexist, BT_8723D_2ANT_SCOREBOARD_ACTIVE | BT_8723D_2ANT_SCOREBOARD_ONOFF | BT_8723D_2ANT_SCOREBOARD_SCAN | BT_8723D_2ANT_SCOREBOARD_UNDERTEST, - false); + FALSE); halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, @@ -5937,15 +6467,15 @@ void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS LEAVE notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_ips = false; + coex_sta->under_ips = FALSE; #if 0 halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_2ANT_SCOREBOARD_ACTIVE, TRUE); halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, true); + BT_8723D_2ANT_SCOREBOARD_ONOFF, TRUE); #endif - halbtc8723d2ant_init_hw_config(btcoexist, false); + halbtc8723d2ant_init_hw_config(btcoexist, FALSE); halbtc8723d2ant_init_coex_dm(btcoexist); halbtc8723d2ant_query_bt_info(btcoexist); } @@ -5953,6 +6483,8 @@ void ex_halbtc8723d2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) { + static boolean pre_force_lps_on = FALSE; + if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; @@ -5960,29 +6492,35 @@ void ex_halbtc8723d2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS ENABLE notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_lps = true; - coex_sta->under_ips = false; + coex_sta->under_lps = TRUE; + coex_sta->under_ips = FALSE; - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ + if (coex_sta->force_lps_ctrl == TRUE) { /* LPS No-32K */ /* Write WL "Active" in Score-board for PS-TDMA */ + pre_force_lps_on = TRUE; halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_2ANT_SCOREBOARD_ACTIVE, TRUE); } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ /* Write WL "Non-Active" in Score-board for Native-PS */ + pre_force_lps_on = FALSE; halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); - } + BT_8723D_2ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8723d2ant_action_wifi_native_lps(btcoexist); + } } else if (BTC_LPS_DISABLE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS DISABLE notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_lps = false; + coex_sta->under_lps = FALSE; halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_2ANT_SCOREBOARD_ACTIVE, TRUE); + + if ((!pre_force_lps_on) && (!coex_sta->force_lps_ctrl)) + halbtc8723d2ant_query_bt_info(btcoexist); } } @@ -5991,7 +6529,7 @@ void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, { u32 u32tmp; u8 u8tmpa, u8tmpb; - boolean wifi_connected = false; + boolean wifi_connected = FALSE; if (btcoexist->manual_control || @@ -6002,12 +6540,11 @@ void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, &wifi_connected); /* this can't be removed for RF off_on event, or BT would dis-connect */ - halbtc8723d2ant_query_bt_info(btcoexist); if (BTC_SCAN_START == type) { if (!wifi_connected) - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], SCAN START notify\n"); @@ -6017,7 +6554,9 @@ void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, BT_8723D_2ANT_SCOREBOARD_ACTIVE | BT_8723D_2ANT_SCOREBOARD_SCAN | BT_8723D_2ANT_SCOREBOARD_ONOFF, - true); + TRUE); + + halbtc8723d2ant_query_bt_info(btcoexist); halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, @@ -6028,7 +6567,7 @@ void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, } else if (BTC_SCAN_FINISH == type) { - coex_sta->wifi_is_high_pri_task = false; + coex_sta->wifi_is_high_pri_task = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); @@ -6039,7 +6578,7 @@ void ex_halbtc8723d2ant_scan_notify(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, false); + BT_8723D_2ANT_SCOREBOARD_SCAN, FALSE); halbtc8723d2ant_run_coexist_mechanism(btcoexist); } @@ -6055,7 +6594,7 @@ void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, if (BTC_ASSOCIATE_START == type) { - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT START notify\n"); @@ -6065,7 +6604,7 @@ void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, BT_8723D_2ANT_SCOREBOARD_ACTIVE | BT_8723D_2ANT_SCOREBOARD_SCAN | BT_8723D_2ANT_SCOREBOARD_ONOFF, - true); + TRUE); halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, @@ -6075,14 +6614,14 @@ void ex_halbtc8723d2ant_connect_notify(IN struct btc_coexist *btcoexist, halbtc8723d2ant_run_coexist_mechanism(btcoexist); /* To keep TDMA case during connect process, to avoid changed by Btinfo and runcoexmechanism */ - coex_sta->freeze_coexrun_by_btinfo = true; + coex_sta->freeze_coexrun_by_btinfo = TRUE; coex_dm->arp_cnt = 0; } else if (BTC_ASSOCIATE_FINISH == type) { - coex_sta->wifi_is_high_pri_task = false; - coex_sta->freeze_coexrun_by_btinfo = false; + coex_sta->wifi_is_high_pri_task = FALSE; + coex_sta->freeze_coexrun_by_btinfo = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT FINISH notify\n"); @@ -6099,7 +6638,7 @@ void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, u32 wifi_bw; u8 wifi_central_chnl; u8 ap_num = 0; - boolean wifi_under_b_mode = false; + boolean wifi_under_b_mode = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -6114,7 +6653,7 @@ void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, halbtc8723d2ant_post_state_to_bt(btcoexist, BT_8723D_2ANT_SCOREBOARD_ACTIVE | BT_8723D_2ANT_SCOREBOARD_ONOFF, - true); + TRUE); halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, @@ -6147,7 +6686,7 @@ void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, false); + BT_8723D_2ANT_SCOREBOARD_ACTIVE, FALSE); } @@ -6157,7 +6696,7 @@ void ex_halbtc8723d2ant_media_status_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean under_4way = false; + boolean under_4way = FALSE; if (btcoexist->manual_control || btcoexist->stop_coex_dm) @@ -6172,7 +6711,7 @@ void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, "[BTCoex], specific Packet ---- under_4way!!\n"); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; } else if (BTC_PACKET_ARP == type) { @@ -6190,13 +6729,13 @@ void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, type); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; } if (coex_sta->wifi_is_high_pri_task) { halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_2ANT_SCOREBOARD_ACTIVE, TRUE); halbtc8723d2ant_run_coexist_mechanism(btcoexist); } @@ -6206,12 +6745,12 @@ void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length) { u8 i, rsp_source = 0; - boolean wifi_connected = false; - boolean wifi_scan = false, wifi_link = false, wifi_roam = false, - wifi_busy = false; - static boolean is_scoreboard_scan = false; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE, + wifi_busy = FALSE; + static boolean is_scoreboard_scan = FALSE; - if (psd_scan->is_AntDet_running == true) { + if (psd_scan->is_AntDet_running == TRUE) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], bt_info_notify return for AntDet is running\n"); BTC_TRACE(trace_buf); @@ -6249,36 +6788,39 @@ void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, if (BT_INFO_SRC_8723D_2ANT_WIFI_FW != rsp_source) { /* if 0xff, it means BT is under WHCK test */ - coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? true : - false); + coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? TRUE : + FALSE); coex_sta->bt_create_connection = (( - coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? true : - false); + coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? TRUE : + FALSE); /* unit: %, value-100 to translate to unit: dBm */ coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; coex_sta->c2h_bt_remote_name_req = (( - coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? true : - false); + coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? TRUE : + FALSE); coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & - 0x10) ? true : false); + 0x10) ? TRUE : FALSE); coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & - 0x9) ? true : false); + 0x8) ? TRUE : FALSE); coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? - true : false); + TRUE : FALSE); coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & - BT_INFO_8723D_2ANT_B_INQ_PAGE) ? true : false); + BT_INFO_8723D_2ANT_B_INQ_PAGE) ? TRUE : FALSE); coex_sta->a2dp_bit_pool = ((( coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? - coex_sta->bt_info_c2h[rsp_source][6] : 0); + (coex_sta->bt_info_c2h[rsp_source][6] & 0x7f) : 0); + + coex_sta->is_bt_a2dp_sink = (coex_sta->bt_info_c2h[rsp_source][6] & 0x80) ? + TRUE : FALSE; coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & 0xf; @@ -6291,6 +6833,8 @@ void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; + coex_sta->is_bt_opp_exist = (coex_sta->bt_info_ext2 & 0x1) ? TRUE : FALSE; + if (coex_sta->bt_retry_cnt >= 1) coex_sta->pop_event_cnt++; @@ -6302,13 +6846,40 @@ void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, if (coex_sta->bt_info_ext & BIT(2)) { coex_sta->cnt_setupLink++; - coex_sta->is_setupLink = true; - } else - coex_sta->is_setupLink = false; + coex_sta->is_setupLink = TRUE; + coex_sta->bt_relink_downcount = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->is_setupLink = FALSE; + coex_sta->bt_relink_downcount = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop in BT info!!\n"); + BTC_TRACE(trace_buf); + } if (coex_sta->bt_info_ext & BIT(3)) coex_sta->cnt_IgnWlanAct++; + if (coex_sta->bt_info_ext & BIT(6)) + coex_sta->cnt_RoleSwitch++; + + if (coex_sta->bt_info_ext & BIT(7)) + coex_sta->is_bt_multi_link = TRUE; + else + coex_sta->is_bt_multi_link = FALSE; + + if (coex_sta->bt_info_ext & BIT(0)) + coex_sta->is_hid_rcu = TRUE; + else + coex_sta->is_hid_rcu = FALSE; + + if (coex_sta->bt_info_ext & BIT(5)) + coex_sta->is_ble_scan_toggle = TRUE; + else + coex_sta->is_ble_scan_toggle = FALSE; + if (coex_sta->bt_create_connection) { coex_sta->cnt_Page++; @@ -6322,19 +6893,19 @@ void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, if ((wifi_link) || (wifi_roam) || (wifi_scan) || (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { - is_scoreboard_scan = true; + is_scoreboard_scan = TRUE; halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, true); + BT_8723D_2ANT_SCOREBOARD_SCAN, TRUE); } else halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, false); + BT_8723D_2ANT_SCOREBOARD_SCAN, FALSE); } else { if (is_scoreboard_scan) { halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_SCAN, false); - is_scoreboard_scan = false; + BT_8723D_2ANT_SCOREBOARD_SCAN, FALSE); + is_scoreboard_scan = FALSE; } } @@ -6371,7 +6942,7 @@ void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); BTC_TRACE(trace_buf); halbtc8723d2ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); + FORCE_EXEC, FALSE); } else { if (coex_sta->bt_info_ext & BIT(2)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -6387,25 +6958,108 @@ void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, } - if ((coex_sta->bt_info_ext & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); - BTC_TRACE(trace_buf); - coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt(btcoexist); - - if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) - coex_sta->bt_ble_scan_para[0] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x1); - if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) - coex_sta->bt_ble_scan_para[1] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x2); - if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) - coex_sta->bt_ble_scan_para[2] = btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, 0x4); - } - halbtc8723d2ant_update_bt_link_info(btcoexist); halbtc8723d2ant_run_coexist_mechanism(btcoexist); } +void ex_halbtc8723d2ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i = 0; + static u8 tmp_buf_pre[10] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi Fw Dbg info = %d %d %d %d %d %d (len = %d)\n", + tmp_buf[0], tmp_buf[1], + tmp_buf[2], tmp_buf[3], + tmp_buf[4], tmp_buf[5], length); + BTC_TRACE(trace_buf); + + if (tmp_buf[0] == 0x8) { + for (i = 1; i <= 5; i++) { + coex_sta->wl_fw_dbg_info[i] = + (tmp_buf[i] >= tmp_buf_pre[i]) ? + (tmp_buf[i] - tmp_buf_pre[i]) : + (255 - tmp_buf_pre[i] + tmp_buf[i]); + + tmp_buf_pre[i] = tmp_buf[i]; + } + } +} + + +void ex_halbtc8723d2ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id) +{ + BOOLEAN wifi_connected = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (is_data_frame) { + coex_sta->wl_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rx_rate_change_notify data rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } else { + coex_sta->wl_rts_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rts_rate_change_notify RTS rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rts_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } + + if ((wifi_connected) && + ((coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_ACL_SCO_BUSY) || + (coex_dm->bt_status == BT_8723D_2ANT_BT_STATUS_SCO_BUSY))) { + + if ((coex_sta->wl_rx_rate == BTC_CCK_5_5) || + (coex_sta->wl_rx_rate == BTC_OFDM_6) || + (coex_sta->wl_rx_rate == BTC_MCS_0)) { + + coex_sta->cck_lock_warn = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck lock warning...\n"); + BTC_TRACE(trace_buf); + } else if ((coex_sta->wl_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rx_rate == BTC_CCK_2) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_2)) { + + coex_sta->cck_lock = TRUE; + coex_sta->cck_lock_ever = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck locking...\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck unlock...\n"); + BTC_TRACE(trace_buf); + } + } else { + if ((coex_dm->bt_status == + BT_8723D_2ANT_BT_STATUS_CONNECTED_IDLE) || + (coex_dm->bt_status == + BT_8723D_2ANT_BT_STATUS_NON_CONNECTED_IDLE)) { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + } + } + +} + + + void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type) { @@ -6417,12 +7071,13 @@ void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, "[BTCoex], RF is turned ON!!\n"); BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; + btcoexist->stop_coex_dm = FALSE; + coex_sta->is_rf_state_off = FALSE; #if 0 halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_2ANT_SCOREBOARD_ACTIVE, TRUE); halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, true); + BT_8723D_2ANT_SCOREBOARD_ONOFF, TRUE); #endif } else if (BTC_RF_OFF == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -6441,10 +7096,10 @@ void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, BT_8723D_2ANT_SCOREBOARD_ONOFF | BT_8723D_2ANT_SCOREBOARD_SCAN | BT_8723D_2ANT_SCOREBOARD_UNDERTEST, - false); - - btcoexist->stop_coex_dm = true; + FALSE); + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = FALSE; } } @@ -6458,6 +7113,8 @@ void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist) FORCE_EXEC, BT_8723D_2ANT_PHASE_WLAN_OFF); + /*halbtc8723d2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, TRUE);*/ + ex_halbtc8723d2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); halbtc8723d2ant_post_state_to_bt(btcoexist, @@ -6465,7 +7122,7 @@ void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist) BT_8723D_2ANT_SCOREBOARD_ONOFF | BT_8723D_2ANT_SCOREBOARD_SCAN | BT_8723D_2ANT_SCOREBOARD_UNDERTEST, - false); + FALSE); } void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, @@ -6483,15 +7140,15 @@ void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ - coex_sta->under_ips = false; - coex_sta->under_lps = false; + coex_sta->under_ips = FALSE; + coex_sta->under_lps = FALSE; halbtc8723d2ant_post_state_to_bt(btcoexist, BT_8723D_2ANT_SCOREBOARD_ACTIVE | BT_8723D_2ANT_SCOREBOARD_ONOFF | BT_8723D_2ANT_SCOREBOARD_SCAN | BT_8723D_2ANT_SCOREBOARD_UNDERTEST, - false); + FALSE); if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { @@ -6512,9 +7169,9 @@ void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); #if 0 halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ACTIVE, true); + BT_8723D_2ANT_SCOREBOARD_ACTIVE, TRUE); halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_ONOFF, true); + BT_8723D_2ANT_SCOREBOARD_ONOFF, TRUE); #endif } } @@ -6522,10 +7179,10 @@ void ex_halbtc8723d2ant_pnp_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) { struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; u32 bt_patch_ver; static u8 cnt = 0; - boolean bt_relink_finish = false; + boolean bt_relink_finish = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ************* Periodical *************\n"); @@ -6546,28 +7203,30 @@ void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) if (wifi_busy) { halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_UNDERTEST, true); + BT_8723D_2ANT_SCOREBOARD_UNDERTEST, TRUE); /* halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_WLBUSY, true); + BT_8723D_2ANT_SCOREBOARD_WLBUSY, TRUE); if (bt_scoreboard_val & BIT(6)) halbtc8723d2ant_query_bt_info(btcoexist); */ } else { halbtc8723d2ant_post_state_to_bt(btcoexist, - BT_8723D_2ANT_SCOREBOARD_UNDERTEST, false); + BT_8723D_2ANT_SCOREBOARD_UNDERTEST, FALSE); /* halbtc8723d2ant_post_state_to_bt(btcoexist, BT_8723D_2ANT_SCOREBOARD_WLBUSY, - false); */ + FALSE); */ } #endif if (coex_sta->bt_relink_downcount != 0) { coex_sta->bt_relink_downcount--; - if (coex_sta->bt_relink_downcount == 0) - bt_relink_finish = true; + if (coex_sta->bt_relink_downcount == 0) { + coex_sta->is_setupLink = FALSE; + bt_relink_finish = TRUE; + } } /* for 4-way, DHCP, EAPOL packet */ @@ -6577,7 +7236,7 @@ void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) - coex_sta->wifi_is_high_pri_task = false; + coex_sta->wifi_is_high_pri_task = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", @@ -6588,38 +7247,6 @@ void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) } if (!coex_sta->bt_disabled) { - if (coex_sta->bt_coex_supported_feature == 0) - btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, - &coex_sta->bt_coex_supported_feature); - - if ((coex_sta->bt_coex_supported_version == 0) || - (coex_sta->bt_coex_supported_version == 0xffff)) - btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, - &coex_sta->bt_coex_supported_version); - - if (coex_sta->bt_reg_vendor_ac == 0xffff) - coex_sta->bt_reg_vendor_ac = (u16)( - btcoexist->btc_get_bt_reg(btcoexist, 3, - 0xac) & 0xffff); - - if (coex_sta->bt_reg_vendor_ae == 0xffff) - coex_sta->bt_reg_vendor_ae = (u16)( - btcoexist->btc_get_bt_reg(btcoexist, 3, - 0xae) & 0xffff); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, - &bt_patch_ver); - btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; - - if (coex_sta->num_of_profile > 0) { - cnt++; - - if (cnt >= 3) { - btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, - &coex_sta->bt_afh_map[0]); - cnt = 0; - } - } #if BT_8723D_2ANT_ANTDET_ENABLE @@ -6636,7 +7263,7 @@ void ex_halbtc8723d2ant_periodical(IN struct btc_coexist *btcoexist) } - if (halbtc8723d2ant_is_wifibt_status_changed(btcoexist)) + if (halbtc8723d2ant_is_wifibt_status_changed(btcoexist) || (bt_relink_finish)) halbtc8723d2ant_run_coexist_mechanism(btcoexist); } @@ -6649,7 +7276,7 @@ void ex_halbtc8723d2ant_set_antenna_notify(IN struct btc_coexist *btcoexist, return; if (type == 2) { /* two antenna */ - board_info->ant_div_cfg = true; + board_info->ant_div_cfg = TRUE; halbtc8723d2ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, FORCE_EXEC, @@ -6691,7 +7318,7 @@ void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, psd_scan->ant_det_fail_count = 0; ant_det_count = 0; ant_det_fail_count = 0; - board_info->btdm_ant_det_finish = false; + board_info->btdm_ant_det_finish = FALSE; board_info->btdm_ant_num_by_ant_det = 1; return; } @@ -6706,13 +7333,13 @@ void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); BTC_TRACE(trace_buf); - psd_scan->is_AntDet_running = true; + psd_scan->is_AntDet_running = TRUE; halbtc8723d2ant_read_score_board(btcoexist, &u16tmp); if (u16tmp & BIT( 2)) { /* Antenna detection is already done before last WL power on */ - board_info->btdm_ant_det_finish = true; + board_info->btdm_ant_det_finish = TRUE; psd_scan->ant_det_try_count = 1; psd_scan->ant_det_fail_count = 0; board_info->btdm_ant_num_by_ant_det = (u16tmp & @@ -6732,7 +7359,7 @@ void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, halbtc8723d2ant_psd_antenna_detection_check( btcoexist); - btcoexist->bdontenterLPS = false; + btcoexist->bdontenterLPS = FALSE; if (board_info->btdm_ant_det_finish) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -6775,7 +7402,7 @@ void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, board_info->antdetval = psd_scan->ant_det_psd_scan_peak_val/100; - board_info->btdm_ant_det_complete_fail = false; + board_info->btdm_ant_det_complete_fail = FALSE; } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -6784,7 +7411,7 @@ void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, } psd_scan->ant_det_inteval_count = 0; - psd_scan->is_AntDet_running = false; + psd_scan->is_AntDet_running = FALSE; /* stimulate coex running */ halbtc8723d2ant_run_coexist_mechanism( @@ -6799,9 +7426,9 @@ void ex_halbtc8723d2ant_antenna_detection(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); if (psd_scan->ant_det_inteval_count == 8) - btcoexist->bdontenterLPS = true; + btcoexist->bdontenterLPS = TRUE; else - btcoexist->bdontenterLPS = false; + btcoexist->bdontenterLPS = FALSE; } } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.h index 0a9f3cc21021..9075bb83a6c0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8723d2ant.h @@ -1,3 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -120,6 +135,7 @@ enum bt_8723d_2ant_coex_algo { BT_8723D_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, BT_8723D_2ANT_COEX_ALGO_HID_A2DP = 0xa, BT_8723D_2ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, + BT_8723D_2ANT_COEX_ALGO_A2DPSINK = 0xc, BT_8723D_2ANT_COEX_ALGO_MAX }; @@ -132,6 +148,7 @@ enum bt_8723d_2ant_phase { BT_8723D_2ANT_PHASE_BTMPMODE = 0x5, BT_8723D_2ANT_PHASE_ANTENNA_DET = 0x6, BT_8723D_2ANT_PHASE_COEX_POWERON = 0x7, + BT_8723D_2ANT_PHASE_2G_FREERUN = 0x8, BT_8723D_2ANT_PHASE_MAX }; @@ -140,6 +157,7 @@ enum bt_8723d_2ant_Scoreboard { BT_8723D_2ANT_SCOREBOARD_ONOFF = BIT(1), BT_8723D_2ANT_SCOREBOARD_SCAN = BIT(2), BT_8723D_2ANT_SCOREBOARD_UNDERTEST = BIT(3), + BT_8723D_2ANT_SCOREBOARD_RXGAIN = BIT(4), BT_8723D_2ANT_SCOREBOARD_WLBUSY = BIT(6) }; @@ -249,11 +267,16 @@ struct coex_sta_8723d_2ant { u32 crc_err_11n; u32 crc_err_11n_vht; + u32 acc_crc_ratio; + u32 now_crc_ratio; + u32 cnt_crcok_max_in_10s; + boolean cck_lock; - boolean pre_ccklock; - boolean cck_ever_lock; + boolean cck_lock_ever; + boolean cck_lock_warn; + u8 coex_table_type; - boolean force_lps_on; + boolean force_lps_ctrl; u8 dis_ver_info_cnt; @@ -311,6 +334,28 @@ struct coex_sta_8723d_2ant { boolean is_tdma_btautoslot_hang; boolean is_eSCO_mode; + + boolean is_rf_state_off; + + boolean is_hid_low_pri_tx_overhead; + boolean is_bt_multi_link; + boolean is_bt_a2dp_sink; + + u8 wl_fw_dbg_info[10]; + u8 wl_rx_rate; + u8 wl_rts_rx_rate; + + u16 score_board_WB; + boolean is_2g_freerun; + + boolean is_hid_rcu; + boolean is_ble_scan_toggle; + + u16 legacy_forbidden_slot; + u16 le_forbidden_slot; + u8 bt_a2dp_vendor_id; + u32 bt_a2dp_device_name; + boolean is_bt_opp_exist; }; #define BT_8723D_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ @@ -380,6 +425,10 @@ void ex_halbtc8723d2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8723d2ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8723d2ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8723d2ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id); void ex_halbtc8723d2ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8723d2ant_halt_notify(IN struct btc_coexist *btcoexist); @@ -406,6 +455,8 @@ void ex_halbtc8723d2ant_display_ant_detection(IN struct btc_coexist *btcoexist); #define ex_halbtc8723d2ant_media_status_notify(btcoexist, type) #define ex_halbtc8723d2ant_specific_packet_notify(btcoexist, type) #define ex_halbtc8723d2ant_bt_info_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8723d2ant_wl_fwdbginfo_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8723d2ant_rx_rate_change_notify(btcoexist, is_data_frame, btc_rate_id) #define ex_halbtc8723d2ant_rf_status_notify(btcoexist, type) #define ex_halbtc8723d2ant_halt_notify(btcoexist) #define ex_halbtc8723d2ant_pnp_notify(btcoexist, pnp_state) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a1ant.c similarity index 99% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a1Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a1ant.c index e094caa62658..0ac288ea8076 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a1Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a1ant.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /* ************************************************************ * Description: * @@ -11,7 +25,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -1444,7 +1458,7 @@ void halbtc8812a1ant_tdma_duration_adjust_for_acl(IN struct btc_coexist result = 0; wait_count = 0; } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ + /* acquire the BT TRx retry count from BT_Info byte2 */ retry_count = coex_sta->bt_retry_cnt; bt_info_ext = coex_sta->bt_info_ext; @@ -1868,6 +1882,7 @@ void halbtc8812a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist u8 bt_rssi_state; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + bt_rssi_state = halbtc8812a1ant_bt_rssi_state(2, 28, 0); if ((coex_sta->low_priority_rx >= 950) && (!coex_sta->under_ips)) @@ -2347,12 +2362,12 @@ void halbtc8812a1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) halbtc8812a1ant_action_wifi_multi_port(btcoexist); return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); } + miracast_plus_bt = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); if ((bt_link_info->bt_link_exist) && (wifi_connected)) { @@ -3375,6 +3390,7 @@ void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, u8 data_len = 4; u8 buf[6] = {0}; u8 dec_bt_pwr = 0, pwr_level = 0; + if (op_len == 2) { dec_bt_pwr = pdata[0]; pwr_level = pdata[1]; @@ -3403,6 +3419,7 @@ void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, { u8 data_len = 5; u8 buf[6] = {0}; + if (op_len == 3) { buf[0] = data_len; buf[1] = 0x5; /* OP_Code */ @@ -3430,6 +3447,7 @@ void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, { u8 data_len = 3; u8 buf[6] = {0}; + if (op_len == 1) { buf[0] = data_len; buf[1] = 0x1; /* OP_Code */ @@ -3454,4 +3472,4 @@ void ex_halbtc8812a1ant_dbg_control(IN struct btc_coexist *btcoexist, #endif -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ \ No newline at end of file +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a1Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a1ant.h similarity index 92% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a1Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a1ant.h index e786d375d7c8..08fbad259551 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a1Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a1ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a2ant.c similarity index 73% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a2Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a2ant.c index cd8a547e9746..e1e6572ed0f9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a2Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a2ant.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /* ************************************************************ * Description: * @@ -12,10 +26,11 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + #if (RTL8812A_SUPPORT == 1) /* ************************************************************ * Global variables, these are static variables @@ -31,16 +46,28 @@ const char *const glbt_info_src_8812a_2ant[] = { "BT Info[bt rsp]", "BT Info[bt auto report]", }; - -u32 glcoex_ver_date_8812a_2ant = 20150724; -u32 glcoex_ver_8812a_2ant = 0x37; +/* ************************************************************ + * BtCoex Version Format: + * 1. date : glcoex_ver_date_XXXXX_1ant + * 2. WifiCoexVersion : glcoex_ver_XXXX_1ant + * 3. BtCoexVersion : glcoex_ver_btdesired_XXXXX_1ant + * 4. others : glcoex_ver_XXXXXX_XXXXX_1ant + * + * Variable should be indicated IC and Antenna numbers !!! + * Please strictly follow this order and naming style !!! + * + * ************************************************************ */ +u32 glcoex_ver_date_8812a_2ant = 20160818; +u32 glcoex_ver_8812a_2ant = 0x3c; +u32 glcoex_ver_btdesired_8812a_2ant = 0x3c; +/*1. add coex. log for wifi/BT coex. version*/ /* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8812a2ant_ - * ************************************************************ */ +* local function proto type if needed +* ************************************************************ +* ************************************************************ +* local function start with halbtc8812a2ant_ +* ************************************************************ */ u8 halbtc8812a2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) { s32 bt_rssi = 0; @@ -103,6 +130,7 @@ u8 halbtc8812a2ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) return bt_rssi_state; } + u8 halbtc8812a2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) { @@ -168,62 +196,47 @@ u8 halbtc8812a2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, return wifi_rssi_state; } -void halbtc8812a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) + +void halbtc8812a2ant_set_enable_pta(IN struct btc_coexist *btcoexist, + IN boolean enablePTA) { - struct btc_stack_info *stack_info = &btcoexist->stack_info; - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - - /* This function check if bt is disabled */ - - /* only 8812a need to consider if core stack is installed. */ - if (!stack_info->hci_version) - bt_active = false; - - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); + if (enablePTA) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); + "[BTCoex], PTA is enable!\n"); BTC_TRACE(trace_buf); + btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); + } else { - bt_disable_cnt++; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], bt is detected as disabled %d times!!\n", - bt_disable_cnt); + "[BTCoex], PTA is disable!\n"); BTC_TRACE(trace_buf); - if (bt_disable_cnt >= 2) { - bt_disabled = true; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); - BTC_TRACE(trace_buf); - } + btcoexist->btc_write_1byte(btcoexist, 0x40, 0x00); + } - if (coex_sta->bt_disabled != bt_disabled) { +} + +void halbtc8812a2ant_enable_pta(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s turn Enable PTA %s\n", + (force_exec ? "force to" : ""), (enable ? "ON" : "OFF")); + BTC_TRACE(trace_buf); + coex_dm->cur_enable_pta = enable; + + if (!force_exec) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); + "[BTCoex], pre_enable_pta = %d, cur_enable_pta = %d!!\n", + coex_dm->pre_enable_pta, coex_dm->cur_enable_pta); BTC_TRACE(trace_buf); - coex_sta->bt_disabled = bt_disabled; - if (!bt_disabled) { - } else { - } + + if (coex_dm->pre_enable_pta == coex_dm->cur_enable_pta) + return; } + halbtc8812a2ant_set_enable_pta(btcoexist, enable); + + + coex_dm->pre_enable_pta = coex_dm->cur_enable_pta; } u32 halbtc8812a2ant_decide_ra_mask(IN struct btc_coexist *btcoexist, @@ -421,12 +434,55 @@ void halbtc8812a2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); } + +void halbtc8812a2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ +#if 1 + + coex_sta->crc_ok_cck = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); +#endif +} + + void halbtc8812a2ant_query_bt_info(IN struct btc_coexist *btcoexist) { u8 data_len = 3; u8 buf[5] = {0}; - - if (!coex_sta->bt_disabled) { + /* 8812a watch btifo to check BT enable/disable + * if(!btcoexist->bt_info.bt_disabled) */ + { if (!coex_sta->bt_info_query_cnt || (coex_sta->bt_info_c2h_cnt[BT_INFO_SRC_8812A_2ANT_BT_RSP] - coex_sta->bt_info_query_cnt) > 2) { @@ -479,6 +535,7 @@ void halbtc8812a2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; boolean bt_hs_on = false; +#if 1/* (BT_AUTO_REPORT_ONLY_8812A_2ANT == 1) / profile from bt patch */ btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); bt_link_info->bt_link_exist = coex_sta->bt_link_exist; @@ -493,7 +550,21 @@ void halbtc8812a2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) bt_link_info->pan_exist = true; bt_link_info->bt_link_exist = true; } +#else /* profile from bt stack */ + bt_link_info->bt_link_exist = stack_info->bt_link_exist; + bt_link_info->sco_exist = stack_info->sco_exist; + bt_link_info->a2dp_exist = stack_info->a2dp_exist; + bt_link_info->pan_exist = stack_info->pan_exist; + bt_link_info->hid_exist = stack_info->hid_exist; + /* for win-8 stack HID report error */ + if (!stack_info->hid_exist) + stack_info->hid_exist = + coex_sta->hid_exist; /* sync BTInfo with BT firmware and stack */ + /* when stack HID report error, here we use the info from bt fw. */ + if (!stack_info->bt_link_exist) + stack_info->bt_link_exist = coex_sta->bt_link_exist; +#endif /* check if Sco only */ if (bt_link_info->sco_exist && !bt_link_info->a2dp_exist && @@ -759,6 +830,15 @@ void halbtc8812a2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ h2c_parameter[0] = dac_swing_lvl; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Set Dac Swing Level=0x%x\n", + dac_swing_lvl); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], FW write 0x64=0x%x\n", + h2c_parameter[0]); + BTC_TRACE(trace_buf); + btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); } @@ -768,6 +848,11 @@ void halbtc8812a2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, u8 data_len = 4; u8 buf[6] = {0}; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], decrease Bt Power level = %d\n", + dec_bt_pwr_lvl); + BTC_TRACE(trace_buf); + buf[0] = data_len; buf[1] = 0x3; /* OP_Code */ buf[2] = 0x2; /* OP_Code_Length */ @@ -784,6 +869,11 @@ void halbtc8812a2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 dec_bt_pwr_lvl) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s Dec BT power level = %d\n", + (force_exec ? "force to" : ""), dec_bt_pwr_lvl); + BTC_TRACE(trace_buf); + coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; if (!force_exec) { @@ -799,6 +889,10 @@ void halbtc8812a2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 fw_dac_swing_lvl) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s set FW Dac Swing level = %d\n", + (force_exec ? "force to" : ""), fw_dac_swing_lvl); + BTC_TRACE(trace_buf); coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; if (!force_exec) { @@ -839,6 +933,11 @@ void halbtc8812a2ant_set_sw_rf_rx_lpf_corner(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_rf_shrink(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean rx_rf_shrink_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s turn Rx RF Shrink = %s\n", + (force_exec ? "force to" : ""), + ((rx_rf_shrink_on) ? "ON" : "OFF")); + BTC_TRACE(trace_buf); coex_dm->cur_rf_rx_lpf_shrink = rx_rf_shrink_on; if (!force_exec) { @@ -878,6 +977,11 @@ void halbtc8812a2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean low_penalty_ra) { return; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s turn LowPenaltyRA = %s\n", + (force_exec ? "force to" : ""), + ((low_penalty_ra) ? "ON" : "OFF")); + BTC_TRACE(trace_buf); coex_dm->cur_low_penalty_ra = low_penalty_ra; if (!force_exec) { @@ -896,7 +1000,8 @@ void halbtc8812a2ant_set_dac_swing_reg(IN struct btc_coexist *btcoexist, u8 val = (u8)level; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Write SwDacSwing = 0x%x\n", level); + "[BTCoex], Write SwDacSwing = 0x%x\n", + level); BTC_TRACE(trace_buf); btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc5b, 0x3e, val); } @@ -914,6 +1019,11 @@ void halbtc8812a2ant_set_sw_full_time_dac_swing(IN struct btc_coexist void halbtc8812a2ant_dac_swing(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean dac_swing_on, IN u32 dac_swing_lvl) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s turn DacSwing=%s, dac_swing_lvl=0x%x\n", + (force_exec ? "force to" : ""), ((dac_swing_on) ? "ON" : "OFF"), + dac_swing_lvl); + BTC_TRACE(trace_buf); coex_dm->cur_dac_swing_on = dac_swing_on; coex_dm->cur_dac_swing_lvl = dac_swing_lvl; @@ -950,6 +1060,12 @@ void halbtc8812a2ant_set_adc_back_off(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_adc_back_off(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean adc_back_off) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s turn AdcBackOff = %s\n", + (force_exec ? "force to" : ""), + ((adc_back_off) ? "ON" : "OFF")); + BTC_TRACE(trace_buf); + coex_dm->cur_adc_back_off = adc_back_off; if (!force_exec) { @@ -995,6 +1111,10 @@ void halbtc8812a2ant_set_agc_table(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_agc_table(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean agc_table_en) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], %s %s Agc Table\n", + (force_exec ? "force to" : ""), + ((agc_table_en) ? "Enable" : "Disable")); + BTC_TRACE(trace_buf); coex_dm->cur_agc_table_en = agc_table_en; if (!force_exec) { @@ -1009,12 +1129,24 @@ void halbtc8812a2ant_agc_table(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_set_coex_table(IN struct btc_coexist *btcoexist, IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], set coex table, set 0x6c0=0x%x\n", val0x6c0); + BTC_TRACE(trace_buf); btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], set coex table, set 0x6c4=0x%x\n", val0x6c4); + BTC_TRACE(trace_buf); btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], set coex table, set 0x6c8=0x%x\n", val0x6c8); + BTC_TRACE(trace_buf); btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], set coex table, set 0x6cc=0x%x\n", val0x6cc); + BTC_TRACE(trace_buf); btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); } @@ -1022,6 +1154,11 @@ void halbtc8812a2ant_coex_table(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s write Coex Table 0x6c0=0x%x, 0x6c4=0x%x, 0x6c8=0x%x, 0x6cc=0x%x\n", + (force_exec ? "force to" : ""), val0x6c0, val0x6c4, val0x6c8, + val0x6cc); + BTC_TRACE(trace_buf); coex_dm->cur_val0x6c0 = val0x6c0; coex_dm->cur_val0x6c4 = val0x6c4; coex_dm->cur_val0x6c8 = val0x6c8; @@ -1071,6 +1208,24 @@ void halbtc8812a2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, halbtc8812a2ant_coex_table(btcoexist, force_exec, 0x5ddd5ddd, 0x5fdb5fdb, 0xffffff, 0x3); break; + case 6: + halbtc8812a2ant_coex_table(btcoexist, force_exec, + 0x5fff5fff, 0x5a5a5a5a, 0xffffff, 0x3); + break; + case 7: + if (coex_sta->scan_ap_num <= 5) + halbtc8812a2ant_coex_table(btcoexist, + force_exec, 0xffffffff, 0xfafafafa, + 0xffffff, 0x3); + else + halbtc8812a2ant_coex_table(btcoexist, + force_exec, 0xffffffff, 0x5a5a5a5a, + 0xffffff, 0x3); + break; + case 8: + halbtc8812a2ant_coex_table(btcoexist, force_exec, + 0x5f5f5f5f, 0x5a5a5a5a, 0xffffff, 0x3); + break; default: break; @@ -1083,6 +1238,11 @@ void halbtc8812a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, u8 data_len = 3; u8 buf[5] = {0}; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s BT Ignore Wlan_Act\n", + (enable ? "Enable" : "Disable")); + BTC_TRACE(trace_buf); + buf[0] = data_len; buf[1] = 0x1; /* OP_Code */ buf[2] = 0x1; /* OP_Code_Length */ @@ -1098,6 +1258,10 @@ void halbtc8812a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean enable) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], %s turn Ignore WlanAct %s\n", + (force_exec ? "force to" : ""), (enable ? "ON" : "OFF")); + BTC_TRACE(trace_buf); coex_dm->cur_ignore_wlan_act = enable; if (!force_exec) { @@ -1146,6 +1310,13 @@ void halbtc8812a2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, coex_dm->ps_tdma_para[3] = byte4; coex_dm->ps_tdma_para[4] = real_byte5; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], PS-TDMA H2C cmd =0x%x%08x\n", + h2c_parameter[0], + h2c_parameter[1] << 24 | h2c_parameter[2] << 16 | + h2c_parameter[3] << 8 | h2c_parameter[4]); + + BTC_TRACE(trace_buf); btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); } @@ -1216,11 +1387,15 @@ void halbtc8812a2ant_set_ant_path(IN struct btc_coexist *btcoexist, btcoexist->btc_write_1byte(btcoexist, 0x76d, 0x1); } else if (wifi_off) { - } + } /* ext switch setting */ switch (ant_pos_type) { case BTC_ANT_WIFI_AT_CPL_MAIN: + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0xcb7); + u8tmp &= ~BIT(2); + u8tmp |= BIT(3); + btcoexist->btc_write_1byte(btcoexist, 0xcb7, u8tmp); break; case BTC_ANT_WIFI_AT_CPL_AUX: u8tmp = btcoexist->btc_read_1byte(btcoexist, 0xcb7); @@ -1236,84 +1411,123 @@ void halbtc8812a2ant_set_ant_path(IN struct btc_coexist *btcoexist, void halbtc8812a2ant_ps_tdma(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean turn_on, IN u8 type) { + s8 wifi_duration_adjust = 0x0; + coex_dm->cur_ps_tdma_on = turn_on; coex_dm->cur_ps_tdma = type; if (!force_exec) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], pre_ps_tdma_on = %d, cur_ps_tdma_on = %d!!\n", + coex_dm->pre_ps_tdma_on, coex_dm->cur_ps_tdma_on); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], pre_ps_tdma = %d, cur_ps_tdma = %d!!\n", + coex_dm->pre_ps_tdma, coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) return; } + + if (coex_sta->scan_ap_num >= 40) + wifi_duration_adjust = -15; + else if (coex_sta->scan_ap_num >= 20) + wifi_duration_adjust = -10; + + /* + if (!coex_sta->force_lps_on) + { + ps_tdma_byte0_val = 0x61; + ps_tdma_byte3_val = 0x11; + ps_tdma_byte4_val = 0x10; + } + + + if ( (type == 3) || (type == 13) || (type == 14) ) + { + ps_tdma_byte4_val = ps_tdma_byte4_val & 0xbf; + + if (!wifi_busy) + ps_tdma_byte4_val = ps_tdma_byte4_val | 0x1; + } + + if (bt_link_info->slave_role == true) + ps_tdma_byte4_val = ps_tdma_byte4_val | 0x1; + + */ if (turn_on) { switch (type) { case 1: - default: + default: /* d1,wb */ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1a, 0x1a, 0xa1, 0x90); + 0x3c, 0x03, 0x11, 0x10); break; case 2: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x12, 0x12, 0xa1, 0x90); + 0x32, 0x03, 0x11, 0x10); break; case 3: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xb1, 0x90); + 0x28, 0x03, 0x11, 0x10); break; case 4: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0xb1, 0x90); + 0x1e, 0x03, 0x11, 0x10); break; - case 5: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1a, 0x1a, 0x21, 0x10); + case 5: /* d1,pb,TXpause */ + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, + 0x3c, 0x03, 0x90, 0x10); break; case 6: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x12, 0x12, 0x21, 0x10); + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, + 0x32, 0x03, 0x90, 0x10); break; case 7: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0x21, 0x10); + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, + 0x28, 0x03, 0x90, 0x10); break; case 8: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0x21, 0x10); + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x63, + 0x1e, 0x03, 0x90, 0x10); break; - case 9: + case 9: /* d1,bb */ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1a, 0x1a, 0xa1, 0x10); + 0x3c, 0x03, 0x31, 0x10); break; case 10: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x12, 0x12, 0xa1, 0x10); + 0x32, 0x03, 0x31, 0x10); break; case 11: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xb1, 0x10); + 0x28, 0x03, 0x31, 0x10); break; case 12: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0xb1, 0x10); + 0x1e, 0x03, 0x31, 0x10); break; - case 13: + case 13: /* d1,bb,TXpause */ halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1a, 0x1a, 0x21, 0x10); + 0x3c, 0x03, 0x30, 0x10); break; case 14: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x12, 0x12, 0x21, 0x10); + 0x32, 0x03, 0x30, 0x10); break; case 15: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0x21, 0x10); + 0x28, 0x03, 0x30, 0x10); break; case 16: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x3, 0x21, 0x10); + 0x1e, 0x03, 0x30, 0x10); break; case 17: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x3, 0xb1, 0x11); + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x3, 0x11, 0x11); break; case 18: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xe3, @@ -1346,28 +1560,34 @@ void halbtc8812a2ant_ps_tdma(IN struct btc_coexist *btcoexist, break; /* following cases is for wifi rssi low, started from 81 */ + case 80: + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, + 0x3c, 0x3, 0x90, 0x50); + break; case 81: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x3a, 0x3, 0x90, 0x50); + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, + 0x3a + wifi_duration_adjust, 0x3, 0x90, + 0x50); break; case 82: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x2b, 0x3, 0x90, 0x50); + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, + 0x30 + wifi_duration_adjust, 0x03, 0x90, + 0x50); break; case 83: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x21, 0x3, 0x90, 0x50); + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, + 0x21, 0x03, 0x90, 0x50); break; case 84: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, 0x15, 0x3, 0x90, 0x50); break; case 85: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, 0x1d, 0x1d, 0x80, 0x50); break; case 86: - halbtc8812a2ant_set_fw_pstdma(btcoexist, 0xd3, + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x53, 0x15, 0x15, 0x80, 0x50); break; } @@ -1385,6 +1605,13 @@ void halbtc8812a2ant_ps_tdma(IN struct btc_coexist *btcoexist, halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, false, false); break; + case 2: /* ANT2BT, 0x778=3 */ + halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x8, 0x0); + delay_ms(5); + halbtc8812a2ant_set_ant_path(btcoexist, + BTC_ANT_WIFI_AT_CPL_MAIN, false, false); + break; default: halbtc8812a2ant_set_fw_pstdma(btcoexist, 0x0, 0x0, 0x0, 0x0, 0x0); @@ -1397,34 +1624,6 @@ void halbtc8812a2ant_ps_tdma(IN struct btc_coexist *btcoexist, coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; } -void halbtc8812a2ant_coex_all_off(IN struct btc_coexist *btcoexist) -{ - /* fw all off */ - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - /* hw all off */ - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - - halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); - halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); - halbtc8812a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); - - halbtc8812a2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -} void halbtc8812a2ant_ps_tdma_check_for_power_save_state( IN struct btc_coexist *btcoexist, IN boolean new_ps_state) @@ -1452,39 +1651,129 @@ void halbtc8812a2ant_ps_tdma_check_for_power_save_state( } } + void halbtc8812a2ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN boolean low_pwr_disable, IN u8 lps_val, - IN u8 rpwm_val) + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) { + boolean low_pwr_disable = false; + boolean ap_enable = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if (ap_enable) { + ps_type = BTC_PS_WIFI_NATIVE; + lps_val = 0x0; + rpwm_val = 0x0; + } switch (ps_type) { case BTC_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + low_pwr_disable = true; btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, NULL); + coex_sta->force_lps_on = false; break; case BTC_PS_LPS_ON: halbtc8812a2ant_ps_tdma_check_for_power_save_state( btcoexist, true); halbtc8812a2ant_lps_rpwm(btcoexist, NORMAL_EXEC, lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = true; btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); /* power save must executed before psTdma. */ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, NULL); + coex_sta->force_lps_on = true; + break; + case BTC_PS_LPS_OFF: + halbtc8812a2ant_ps_tdma_check_for_power_save_state( + btcoexist, false); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + coex_sta->force_lps_on = false; break; default: break; } } +void halbtc8812a2ant_coex_all_off(IN struct btc_coexist *btcoexist) +{ + /* fw all off */ + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + /* sw all off */ + halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + + /* hw all off */ + halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +} + +void halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + /* force to reset coex mechanism */ + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); + halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); + halbtc8812a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); + + halbtc8812a2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + + halbtc8812a2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); +} + +void halbtc8812a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) +{ + struct btc_stack_info *stack_info = &btcoexist->stack_info; + static u32 bt_disable_cnt = 0; + boolean bt_active = true, bt_disabled = false; + + /* This function check if bt is disabled */ + + /* only 8812a need to consider if core stack is installed. */ + /*if (!stack_info->hci_version)*/ + /*bt_active = false;*/ + + bt_disabled = btcoexist->bt_info.bt_disabled; + + if (coex_sta->pre_bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->pre_bt_disabled ? "disabled" : "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + coex_sta->pre_bt_disabled = bt_disabled; + + if (bt_disabled) { + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 2); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } + } +} + + void halbtc8812a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) { - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, - 0x0, 0x0); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); @@ -1495,6 +1784,7 @@ void halbtc8812a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) halbtc8812a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); } + boolean halbtc8812a2ant_is_common_action(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; @@ -1522,7 +1812,7 @@ boolean halbtc8812a2ant_is_common_action(IN struct btc_coexist *btcoexist) if (!wifi_connected) { halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - false, 0x0, 0x0); + 0x0, 0x0); halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -1561,7 +1851,7 @@ boolean halbtc8812a2ant_is_common_action(IN struct btc_coexist *btcoexist) "[BTCoex], Wifi connected + BT non connected-idle!!\n"); BTC_TRACE(trace_buf); halbtc8812a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, false, 0x0, 0x0); + BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -1588,7 +1878,7 @@ boolean halbtc8812a2ant_is_common_action(IN struct btc_coexist *btcoexist) "[BTCoex], Wifi connected + BT connected-idle!!\n"); BTC_TRACE(trace_buf); halbtc8812a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, true, 0x0, 0x0); + BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -1618,7 +1908,7 @@ boolean halbtc8812a2ant_is_common_action(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); halbtc8812a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, true, 0x0, 0x0); + BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -1652,10 +1942,17 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ u8 retry_count = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], TdmaDurationAdjust()\n"); + BTC_TRACE(trace_buf); + coex_dm->auto_tdma_adjust_low_rssi = false; if (!coex_dm->auto_tdma_adjust) { coex_dm->auto_tdma_adjust = true; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], first run TdmaDurationAdjust()!!\n"); + BTC_TRACE(trace_buf); { if (sco_hid) { if (tx_pause) { @@ -1775,8 +2072,17 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, result = 0; wait_count = 0; } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ + /* acquire the BT TRx retry count from BT_Info byte2 */ retry_count = coex_sta->bt_retry_cnt; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], retry_count = %d\n", + retry_count); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], up=%d, dn=%d, m=%d, n=%d, wait_count=%d\n", + up, dn, m, n, wait_count); + BTC_TRACE(trace_buf); + result = 0; wait_count++; @@ -1794,6 +2100,9 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, up = 0; dn = 0; result = 1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Increase wifi duration!!\n"); + BTC_TRACE(trace_buf); } } else if (retry_count <= 3) { /* <=3 retry in the last 2-second duration */ @@ -1817,6 +2126,9 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, dn = 0; wait_count = 0; result = -1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Decrease wifi duration for retry_counter<3!!\n"); + BTC_TRACE(trace_buf); } } else { /* retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration */ if (wait_count == 1) @@ -1832,15 +2144,23 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, dn = 0; wait_count = 0; result = -1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Decrease wifi duration for retry_counter>3!!\n"); + BTC_TRACE(trace_buf); } + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], max Interval = %d\n", + max_interval); + BTC_TRACE(trace_buf); + if (max_interval == 1) { if (tx_pause) { - if (coex_dm->cur_ps_tdma == 71) { - halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 5); - coex_dm->ps_tdma_du_adj_type = 5; - } else if (coex_dm->cur_ps_tdma == 1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], TxPause = 1\n"); + BTC_TRACE(trace_buf); + + if (coex_dm->cur_ps_tdma == 1) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); coex_dm->ps_tdma_du_adj_type = 5; @@ -1953,10 +2273,14 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, } } } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], TxPause = 0\n"); + BTC_TRACE(trace_buf); + if (coex_dm->cur_ps_tdma == 5) { halbtc8812a2ant_ps_tdma(btcoexist, - NORMAL_EXEC, true, 71); - coex_dm->ps_tdma_du_adj_type = 71; + NORMAL_EXEC, true, 1); + coex_dm->ps_tdma_du_adj_type = 1; } else if (coex_dm->cur_ps_tdma == 6) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); @@ -1989,13 +2313,7 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, } if (result == -1) { - if (coex_dm->cur_ps_tdma == 71) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 1); - coex_dm->ps_tdma_du_adj_type = - 1; - } else if (coex_dm->cur_ps_tdma == 1) { + if (coex_dm->cur_ps_tdma == 1) { halbtc8812a2ant_ps_tdma( btcoexist, NORMAL_EXEC, true, 2); @@ -2051,12 +2369,6 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, true, 1); coex_dm->ps_tdma_du_adj_type = 1; - } else if (coex_dm->cur_ps_tdma == 1) { - halbtc8812a2ant_ps_tdma( - btcoexist, NORMAL_EXEC, - true, 71); - coex_dm->ps_tdma_du_adj_type = - 71; } else if (coex_dm->cur_ps_tdma == 12) { halbtc8812a2ant_ps_tdma( btcoexist, NORMAL_EXEC, @@ -2080,6 +2392,10 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, } } else if (max_interval == 2) { if (tx_pause) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], TxPause = 1\n"); + BTC_TRACE(trace_buf); + if (coex_dm->cur_ps_tdma == 1) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); @@ -2192,6 +2508,10 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, } } } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], TxPause = 0\n"); + BTC_TRACE(trace_buf); + if (coex_dm->cur_ps_tdma == 5) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); @@ -2306,6 +2626,10 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, } } else if (max_interval == 3) { if (tx_pause) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], TxPause = 1\n"); + BTC_TRACE(trace_buf); + if (coex_dm->cur_ps_tdma == 1) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); @@ -2418,6 +2742,10 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, } } } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], TxPause = 0\n"); + BTC_TRACE(trace_buf); + if (coex_dm->cur_ps_tdma == 5) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); @@ -2537,6 +2865,7 @@ void halbtc8812a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, /* then we have to adjust it back to the previous record one. */ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { boolean scan = false, link = false, roam = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); @@ -2567,6 +2896,33 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( s32 result; /* 0: no change, +1: increase WiFi duration, -1: decrease WiFi duration */ u8 retry_count = 0, bt_info_ext; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low()\n"); + BTC_TRACE(trace_buf); +#if 0 + if ((BT_8812A_2ANT_WIFI_STATUS_NON_CONNECTED_ASSO_AUTH_SCAN == + wifi_status) || + (BT_8812A_2ANT_WIFI_STATUS_CONNECTED_SCAN == wifi_status) || + (BT_8812A_2ANT_WIFI_STATUS_CONNECTED_SPECIAL_PKT == + wifi_status)) { + if (coex_dm->cur_ps_tdma != 81 && + coex_dm->cur_ps_tdma != 82 && + coex_dm->cur_ps_tdma != 83 && + coex_dm->cur_ps_tdma != 84) { + halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 82); + coex_dm->ps_tdma_du_adj_type = 82; + + up = 0; + dn = 0; + m = 1; + n = 3; + result = 0; + wait_count = 0; + } + return; + } +#endif coex_dm->auto_tdma_adjust = false; retry_count = coex_sta->bt_retry_cnt; @@ -2574,13 +2930,17 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( if (!coex_dm->auto_tdma_adjust_low_rssi) { coex_dm->auto_tdma_adjust_low_rssi = true; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], first run TdmaDurationAdjustForWifiRssiLow()!!\n"); + BTC_TRACE(trace_buf); if (BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 83); coex_dm->ps_tdma_du_adj_type = 83; } else { - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 82); + halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 82); coex_dm->ps_tdma_du_adj_type = 82; } /* ============ */ @@ -2591,13 +2951,21 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( result = 0; wait_count = 0; } else { - /* accquire the BT TRx retry count from BT_Info byte2 + /* acquire the BT TRx retry count from BT_Info byte2 * retry_count = coex_sta->bt_retry_cnt; * bt_info_ext = coex_sta->bt_info_ext; */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], retry_count = %d\n", + retry_count); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], up=%d, dn=%d, m=%d, n=%d, wait_count=%d\n", + up, dn, m, n, wait_count); + BTC_TRACE(trace_buf); result = 0; wait_count++; - if ((coex_sta->low_priority_tx) > 1150 || + if ((coex_sta->low_priority_tx) > 1050 || (coex_sta->low_priority_rx) > 1250) retry_count++; @@ -2609,12 +2977,15 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( if (dn <= 0) dn = 0; - if (up >= n) { /* if retry count during continuous n*2 seconds is 0, enlarge WiFi duration */ + if (up >= n) { /* if ³sÄò n ­Ó2¬í retry count¬°0, «h½Õ¼eWiFi duration */ wait_count = 0; n = 3; up = 0; dn = 0; result = 1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Increase wifi duration!!\n"); + BTC_TRACE(trace_buf); } } else if (retry_count <= 3) { /* <=3 retry in the last 2-second duration */ @@ -2624,13 +2995,13 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( if (up <= 0) up = 0; - if (dn == 2) { /* if continuous 2 retry count(every 2 seconds) >0 and < 3, reduce WiFi duration */ + if (dn == 2) { /* if ³sÄò 2 ­Ó2¬í retry count< 3, «h½Õ¯¶WiFi duration */ if (wait_count <= 2) - m++; /* to avoid loop between the two levels */ + m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ else m = 1; - if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ + if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ m = 20; n = 3 * m; @@ -2638,14 +3009,17 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( dn = 0; wait_count = 0; result = -1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Decrease wifi duration for retry_counter<3!!\n"); + BTC_TRACE(trace_buf); } - } else { /* retry count > 3, once retry count > 3, to reduce WiFi duration */ + } else { /* retry count > 3, ¥u­n1¦¸ retry count > 3, «h½Õ¯¶WiFi duration */ if (wait_count == 1) - m++; /* to avoid loop between the two levels */ + m++; /* ÁקK¤@ª½¦b¨â­Ólevel¤¤¨Ó¦^ */ else m = 1; - if (m >= 20) /* maximum of m = 20 ' will recheck if need to adjust wifi duration in maximum time interval 120 seconds */ + if (m >= 20) /* m ³Ì¤j­È = 20 ' ³Ì¤j120¬í recheck¬O§_½Õ¾ã WiFi duration. */ m = 20; n = 3 * m; @@ -2653,15 +3027,24 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( dn = 0; wait_count = 0; result = -1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Decrease wifi duration for retry_counter>3!!\n"); + BTC_TRACE(trace_buf); } if (result == -1) { - if ((BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 81) || - (coex_dm->cur_ps_tdma == 82))) { + /* + if( (BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && + ((coex_dm->cur_ps_tdma == 81) ||(coex_dm->cur_ps_tdma == 82)) ) + { + halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 84); + coex_dm->ps_tdma_du_adj_type = 84; + } + */ + if (coex_dm->cur_ps_tdma == 80) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 84); - coex_dm->ps_tdma_du_adj_type = 84; + true, 82); + coex_dm->ps_tdma_du_adj_type = 82; } else if (coex_dm->cur_ps_tdma == 81) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 82); @@ -2676,13 +3059,15 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( coex_dm->ps_tdma_du_adj_type = 84; } } else if (result == 1) { - if ((BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && - ((coex_dm->cur_ps_tdma == 81) || - (coex_dm->cur_ps_tdma == 82))) { - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, - true, 83); - coex_dm->ps_tdma_du_adj_type = 83; - } else if (coex_dm->cur_ps_tdma == 84) { + /* + if( (BT_INFO_8812A_2ANT_A2DP_BASIC_RATE(bt_info_ext)) && + ((coex_dm->cur_ps_tdma == 81) ||(coex_dm->cur_ps_tdma == 82)) ) + { + halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 83); + coex_dm->ps_tdma_du_adj_type = 83; + } + */ + if (coex_dm->cur_ps_tdma == 84) { halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 83); coex_dm->ps_tdma_du_adj_type = 83; @@ -2694,10 +3079,16 @@ void halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 81); coex_dm->ps_tdma_du_adj_type = 81; + } else if ((coex_dm->cur_ps_tdma == 81) && + ((coex_sta->scan_ap_num <= 5))) { + halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, + true, 81); + coex_dm->ps_tdma_du_adj_type = 81; } } - if (coex_dm->cur_ps_tdma != 81 && + if (coex_dm->cur_ps_tdma != 80 && + coex_dm->cur_ps_tdma != 81 && coex_dm->cur_ps_tdma != 82 && coex_dm->cur_ps_tdma != 83 && coex_dm->cur_ps_tdma != 84) { @@ -2715,6 +3106,7 @@ void halbtc8812a2ant_get_bt_rssi_threshold(IN struct btc_coexist *btcoexist, btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &ant_type); + switch (ant_type) { case BTC_ANT_TYPE_0: *pThres0 = 100; @@ -2751,18 +3143,17 @@ void halbtc8812a2ant_action_sco(IN struct btc_coexist *btcoexist) u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, - &bt_thresh1); + /* halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); */ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, bt_thresh1); wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ + bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); /* power save state */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, - 0x0, 0x0); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); /* coex table */ if (BTC_RSSI_LOW(bt_rssi_state)) @@ -2827,18 +3218,17 @@ void halbtc8812a2ant_action_sco_hid(IN struct btc_coexist *btcoexist) u32 wifi_bw; u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, - &bt_thresh1); + /* halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); */ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, bt_thresh1); wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ + bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); /* power save state */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, - 0x0, 0x0); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); /* coex table */ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); @@ -2898,53 +3288,152 @@ void halbtc8812a2ant_action_hid(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 bt_thresh0 = 0, bt_thresh1 = 0; + u8 anttype = 0; - halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, - &bt_thresh1); - bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, - bt_thresh1); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); + + + /* halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); + * bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, bt_thresh1); */ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ + bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); + + + if (anttype == 0) { /* ANTTYPE = 0 92E 2ant with SPDT */ + /* power save state & pstdma & coex table */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, + 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } else if (anttype == + 1) { /* 92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation */ + /* power save state & pstdma & coex table */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, + 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } else if (anttype == + 2) { /* ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, true, 9); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 3); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, true, 9); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 3); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, true, 9); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 3); + } + } else if (anttype == + 3) { /* ANTTYPE = 3, 92E 3ant with good ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + } else { /* WIFI RSSI || BT RSSI == low */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } + } else { /* ANTTYPE = 4 for test */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } + } + /* power save state */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, - 0x0, 0x0); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); /* coex table */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - else - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); /* pstdma */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 9); - else - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); + halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); /* limited Rx */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x8); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x8); - else - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, - 0x8); - + halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); /* fw dac swing level */ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); @@ -2984,52 +3473,227 @@ void halbtc8812a2ant_action_a2dp(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 bt_thresh0 = 0, bt_thresh1 = 0; + u8 anttype = 0; boolean ap_enable = false; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); - halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, - &bt_thresh1); - bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, - bt_thresh1); + btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); + + /* halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); + * bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, bt_thresh1); */ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ + bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); - /* power save state */ - if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state)))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); - else - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, - 0x50, 0x4); + /* anttype = 4; */ - /* coex table */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + if (anttype == 0) { /* ANTTYPE = 0 92E 2ant with SPDT */ - /* pstdma */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, - 1); - else - halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( - btcoexist); + if (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A) { + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } else { + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state))) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } + } + + /* power save state & pstdma & coex table + * + if(BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state)) && (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) + { + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low(btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } + else if (BTC_RSSI_HIGH(wifi_rssi_state)&&(!BTC_RSSI_LOW(bt_rssi_state)) && (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) + { + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } + else + { + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low(btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + } + */ + } else if (anttype == + 1) { /* 92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, + false, 1); /* shielding room */ + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } + + } else if (anttype == + 2) { /* ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, + false, 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 5); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } + } else if (anttype == + 3) { /* ANTTYPE = 3, 92E 3ant with good ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + } else { /* WIFI RSSI || BT RSSI == low */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } + } else { /* ANTTYPE = 4 for test */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } + } /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + /* decrease BT power + * + if(BTC_RSSI_LOW(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + else if(BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else if (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + */ /* limited Rx */ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -3073,18 +3737,17 @@ void halbtc8812a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) u32 wifi_bw; u8 bt_thresh0 = 0, bt_thresh1 = 0; - halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, - &bt_thresh1); + /* halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); */ bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, bt_thresh1); wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ + bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); /* power save state */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, - 0x0, 0x0); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); /* coex table */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) @@ -3100,13 +3763,16 @@ void halbtc8812a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, true, 2); /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + /* + if(BTC_RSSI_LOW(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + else if(BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + */ /* limited Rx */ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -3149,10 +3815,7 @@ void halbtc8812a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; u8 bt_thresh0 = 0, bt_thresh1 = 0; - boolean ap_enable = false; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, @@ -3165,13 +3828,12 @@ void halbtc8812a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ /* power save state */ - if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state)))) + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); + 0x0, 0x0); else - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, - 0x50, 0x4); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, + 0x4); /* coex table */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) @@ -3186,12 +3848,7 @@ void halbtc8812a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); /* limited Rx */ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -3241,8 +3898,8 @@ void halbtc8812a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); /* power save state */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, - 0x0, 0x0); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); /* coex table */ halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); @@ -3251,13 +3908,17 @@ void halbtc8812a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + /* + + if(BTC_RSSI_LOW(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + else if(BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + */ /* limited Rx */ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -3300,62 +3961,42 @@ void halbtc8812a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; u8 bt_thresh0 = 0, bt_thresh1 = 0; - boolean ap_enable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, bt_thresh1); - wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ - /* power save state */ - if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state)))) + /* power save state */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); + 0x0, 0x0); else - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, - 0x50, 0x4); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, + 0x4); /* coex table */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); else halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); /* pstdma */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, false, 3); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_tdma_duration_adjust(btcoexist, false, true, 3); else { coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 86); } /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); /* limited Rx */ halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); @@ -3363,9 +4004,8 @@ void halbtc8812a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) /* fw dac swing level */ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - /* sw mechanism */ + /* sw mechanism */ if (BTC_WIFI_BW_HT40 == wifi_bw) { if (BTC_RSSI_HIGH(wifi_rssi_state)) { halbtc8812a2ant_sw_mechanism1(btcoexist, true, false, @@ -3393,16 +4033,14 @@ void halbtc8812a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) } } + void halbtc8812a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; u8 bt_thresh0 = 0, bt_thresh1 = 0; - boolean ap_enable = false; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); @@ -3414,17 +4052,16 @@ void halbtc8812a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ /* power save state */ - if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state)))) + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); + 0x0, 0x0); else if (BTC_RSSI_LOW(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); + 0x0, 0x0); else - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, - 0x50, 0x4); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, + 0x4); /* coex table */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) @@ -3445,13 +4082,17 @@ void halbtc8812a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 85); /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + /* + + if(BTC_RSSI_LOW(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + else if(BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + */ /* limited Rx */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, @@ -3504,10 +4145,6 @@ void halbtc8812a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; u8 bt_thresh0 = 0, bt_thresh1 = 0; - boolean ap_enable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); @@ -3519,17 +4156,16 @@ void halbtc8812a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ /* power save state */ - if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state)))) + if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); + 0x0, 0x0); else if (BTC_RSSI_LOW(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); + 0x0, 0x0); else - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, - 0x50, 0x4); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, + 0x4); /* coex table */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) @@ -3552,13 +4188,16 @@ void halbtc8812a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) } /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + /* + if(BTC_RSSI_LOW(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + else if(BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + */ /* limited Rx */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, @@ -3622,8 +4261,8 @@ void halbtc8812a2ant_action_hid_a2dp_pan_hs(IN struct btc_coexist *btcoexist) /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ /* power save state */ - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, true, - 0x0, 0x0); + halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, + 0x0); /* coex table */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) @@ -3644,13 +4283,17 @@ void halbtc8812a2ant_action_hid_a2dp_pan_hs(IN struct btc_coexist *btcoexist) halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + /* + + if(BTC_RSSI_LOW(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + else if(BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + */ /* limited Rx */ if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, @@ -3701,73 +4344,198 @@ void halbtc8812a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH, bt_rssi_state = BTC_RSSI_STATE_HIGH; u32 wifi_bw; - u8 bt_thresh0 = 0, bt_thresh1 = 0; - boolean ap_enable = false; + u8 anttype = 0; - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); + btcoexist->btc_get(btcoexist, BTC_GET_U1_ANT_TYPE, &anttype); - halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, - &bt_thresh1); - bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, - bt_thresh1); + + /* halbtc8812a2ant_get_bt_rssi_threshold(btcoexist, &bt_thresh0, &bt_thresh1); + * bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, bt_thresh0, bt_thresh1); */ wifi_rssi_state = halbtc8812a2ant_wifi_rssi_state(btcoexist, 0, 2, 34, 0); - /* bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); */ + bt_rssi_state = halbtc8812a2ant_bt_rssi_state(3, 34, 42); - /* power save state */ - if ((ap_enable == true) || (BTC_RSSI_HIGH(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state)))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); - else - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, true, - 0x50, 0x4); + if (anttype == 0) { /* ANTTYPE = 0 92E 2ant with SPDT */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, true, + 83); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); - /* coex table */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - else - halbtc8812a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } else { + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, true, + 83); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + } + } else if (anttype == + 1) { /* 92E 2ant with coupler and bad ant. isolation, 92E 3ant with bad ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, + true, 2); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } else { + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, true, + 83); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + } + } else if (anttype == + 2) { /* ANTTYPE = 2, 92E 2ant with coupler and normal/good ant. isolation, 92E 3ant with normal ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, + true, 2); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 0); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, true, + 83); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + } + } else if (anttype == + 3) { /* ANTTYPE = 3, 92E 3ant with good ant. isolation */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); - /* pstdma */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, false, 2); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_tdma_duration_adjust(btcoexist, true, true, 2); - else { - coex_dm->auto_tdma_adjust = false; - halbtc8812a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 82); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + } else { /* WIFI RSSI || BT RSSI == low */ + coex_dm->auto_tdma_adjust = false; + coex_dm->auto_tdma_adjust_low_rssi = false; + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 1); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + } + } else { /* ANTTYPE = 4 for test */ + /* power save state & pstdma & coex table */ + if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & shielding room */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } else if (BTC_RSSI_HIGH(wifi_rssi_state) && + (!BTC_RSSI_LOW(bt_rssi_state)) && + (coex_sta->scan_ap_num > NOISY_AP_NUM_THRESH_8812A)) { + /* WIFI RSSI = high & BT RSSI = high & noisy environment */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } else { /* WIFI RSSI || BT RSSI == low */ + halbtc8812a2ant_power_save_state(btcoexist, + BTC_PS_LPS_ON, 0x50, 0x4); + halbtc8812a2ant_tdma_duration_adjust_for_wifi_rssi_low( + btcoexist); + halbtc8812a2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 7); + } } /* decrease BT power */ - if (BTC_RSSI_LOW(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - else if (BTC_RSSI_MEDIUM(bt_rssi_state)) - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - else - halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + /* + + if(BTC_RSSI_LOW(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + else if(BTC_RSSI_MEDIUM(bt_rssi_state)) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + else if (coex_sta->scan_ap_num < NOISY_AP_NUM_THRESH_8812A) + halbtc8812a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 4); + */ /* limited Rx */ - if (BTC_RSSI_HIGH(wifi_rssi_state) && (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x8); - else if (BTC_RSSI_LOW(wifi_rssi_state) && - (!BTC_RSSI_LOW(bt_rssi_state))) - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x8); - else - halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, - 0x8); + halbtc8812a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, 0x8); /* fw dac swing level */ halbtc8812a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); @@ -3802,7 +4570,6 @@ void halbtc8812a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) } } - void halbtc8812a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) { halbtc8812a2ant_coex_all_off(btcoexist); @@ -3829,13 +4596,6 @@ void halbtc8812a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) return; } - if (btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); - BTC_TRACE(trace_buf); - return; - } - if (coex_sta->under_ips) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], wifi is under IPS !!!\n"); @@ -4017,8 +4777,8 @@ void halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, /* enable counter statistics */ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); - /* enable PTA */ - btcoexist->btc_write_1byte(btcoexist, 0x40, 0x20); + /* disable PTA to avoid BT insn't on */ + btcoexist->btc_write_1byte(btcoexist, 0x40, 0x00); /* bt clock related */ u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x4); @@ -4029,6 +4789,10 @@ void halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x7); u8tmp |= BIT(1); btcoexist->btc_write_1byte(btcoexist, 0x7, u8tmp); + + /* Give bt_coex_supported_version the default value */ + coex_sta->bt_coex_supported_version = 0; + } /* ************************************************************ @@ -4045,7 +4809,6 @@ void ex_halbtc8812a2ant_init_hw_config(IN struct btc_coexist *btcoexist, IN boolean wifi_only) { halbtc8812a2ant_init_hw_config(btcoexist, true); - btcoexist->stop_coex_dm = false; } void ex_halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) @@ -4053,19 +4816,43 @@ void ex_halbtc8812a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Coex Mechanism Init!!\n"); BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; + halbtc8812a2ant_init_coex_dm(btcoexist); } + +void ex_halbtc8812a2ant_pta_off_on_notify(IN struct btc_coexist *btcoexist, + IN u8 bt_status) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BToff/on notify\n"); + BTC_TRACE(trace_buf); + + if (BTC_BT_OFF == bt_status) { + /* PTA off */ + btcoexist->bt_info.bt_disabled = true; + halbtc8812a2ant_enable_pta(btcoexist, FORCE_EXEC, false); + + } else { + /* PTA on */ + btcoexist->bt_info.bt_disabled = false; + halbtc8812a2ant_enable_pta(btcoexist, FORCE_EXEC, true); + } + +} + + void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) { struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_stack_info *stack_info = &btcoexist->stack_info; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; u8 *cli_buf = btcoexist->cli_buf; u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; u16 u16tmp[4]; u32 u32tmp[4]; - u32 fw_ver = 0, bt_patch_ver = 0; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; + u32 phyver = 0; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -4080,27 +4867,43 @@ void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); } - if (btcoexist->stop_coex_dm) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Coex is STOPPED]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d ", "Ant PG number/ Ant mechanism:", board_info->pg_ant_num, board_info->btdm_ant_num); CL_PRINTF(cli_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); +#if 0 + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "Antenna type:", + board_info->ant_type); + CL_PRINTF(cli_buf); +#endif + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", + "BT stack/ hci ext ver", + ((stack_info->profile_notified) ? "Yes" : "No"), + stack_info->hci_version); + CL_PRINTF(cli_buf); + + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + bt_coex_ver = coex_sta->bt_coex_supported_version & 0xff; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%d/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8812a_2ant, glcoex_ver_8812a_2ant, fw_ver, - bt_patch_ver, bt_patch_ver); + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8812a_2ant, glcoex_ver_8812a_2ant, + glcoex_ver_btdesired_8812a_2ant, bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : (bt_coex_ver >= + glcoex_ver_btdesired_8812a_2ant ? "Match" : + "Mis-Match"))); + CL_PRINTF(cli_buf); + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d", + "W_FW/ B_FW/ Phy", + fw_ver, bt_patch_ver, phyver); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", @@ -4120,7 +4923,7 @@ void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d] ", "BT [status/ rssi/ retryCnt]", - ((coex_sta->bt_disabled) ? ("disabled") : (( + ((btcoexist->bt_info.bt_disabled) ? ("disabled") : (( coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") : ((BT_8812A_2ANT_BT_STATUS_NON_CONNECTED_IDLE == coex_dm->bt_status) ? "non-connected idle" : @@ -4174,6 +4977,10 @@ void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) coex_dm->cur_dac_swing_on, coex_dm->cur_dac_swing_lvl); CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x ", "Rate Mask", + btcoexist->bt_info.ra_mask); + CL_PRINTF(cli_buf); + /* Fw mechanism */ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Fw mechanism]============"); @@ -4181,12 +4988,12 @@ void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) ps_tdma_case = coex_dm->cur_ps_tdma; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d/%d)", + "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (auto:%d/%d)", "PS TDMA", coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], - coex_dm->ps_tdma_para[4], - ps_tdma_case, coex_dm->auto_tdma_adjust, + coex_dm->ps_tdma_para[4], ps_tdma_case, + coex_dm->auto_tdma_adjust, coex_dm->auto_tdma_adjust_low_rssi); CL_PRINTF(cli_buf); @@ -4264,12 +5071,31 @@ void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist) u32tmp[0], u8tmp[0]); CL_PRINTF(cli_buf); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "0xf48/ 0xa5b (FA cnt-- OFDM : CCK)", - u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11n-agg", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11n-agg", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); CL_PRINTF(cli_buf); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); @@ -4301,13 +5127,11 @@ void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) { boolean wifi_under_5g = false; - if (btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - if (BTC_IPS_ENTER == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS ENTER notify\n"); BTC_TRACE(trace_buf); + coex_sta->under_ips = true; halbtc8812a2ant_coex_all_off(btcoexist); halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_WIFI_AT_CPL_AUX, @@ -4316,6 +5140,7 @@ void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS notify, force set BT to ignore Wlan active!!\n"); BTC_TRACE(trace_buf); + halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ex_halbtc8812a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); @@ -4323,6 +5148,7 @@ void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS LEAVE notify\n"); BTC_TRACE(trace_buf); + coex_sta->under_ips = false; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, @@ -4331,6 +5157,7 @@ void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS notify, force set BT NOT to ignore Wlan active!!\n"); BTC_TRACE(trace_buf); + halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, false); } @@ -4339,19 +5166,17 @@ void ex_halbtc8812a2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) void ex_halbtc8812a2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - - if (btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - if (BTC_LPS_ENABLE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS ENABLE notify\n"); BTC_TRACE(trace_buf); + coex_sta->under_lps = true; } else if (BTC_LPS_DISABLE == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS DISABLE notify\n"); BTC_TRACE(trace_buf); + coex_sta->under_lps = false; } } @@ -4367,6 +5192,9 @@ void ex_halbtc8812a2ant_scan_notify(IN struct btc_coexist *btcoexist, BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], SCAN FINISH notify\n"); BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); } } @@ -4395,7 +5223,7 @@ void ex_halbtc8812a2ant_media_status_notify(IN struct btc_coexist *btcoexist, if (btcoexist->manual_control || btcoexist->stop_coex_dm || - coex_sta->bt_disabled) + btcoexist->bt_info.bt_disabled) return; if (BTC_MEDIA_CONNECT == type) { @@ -4445,7 +5273,6 @@ void ex_halbtc8812a2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, "[BTCoex], DHCP Packet notify\n"); BTC_TRACE(trace_buf); } - } void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, @@ -4468,6 +5295,7 @@ void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, length); BTC_TRACE(trace_buf); + for (i = 0; i < length; i++) { coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; if (i == 1) @@ -4499,6 +5327,7 @@ void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); BTC_TRACE(trace_buf); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); if (wifi_connected) @@ -4624,37 +5453,8 @@ void ex_halbtc8812a2ant_bt_info_notify(IN struct btc_coexist *btcoexist, halbtc8812a2ant_run_coexist_mechanism(btcoexist); } -void ex_halbtc8812a2ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_RF_ON == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned ON!!\n"); - BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; - } - if (BTC_RF_OFF == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned OFF!!\n"); - BTC_TRACE(trace_buf); - - halbtc8812a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - true, 0x0, 0x0); - halbtc8812a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); - /* halbtc8812a2ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, FORCE_EXEC, false, true); */ - halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - btcoexist->stop_coex_dm = true; - - } -} - - void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); BTC_TRACE(trace_buf); @@ -4663,6 +5463,7 @@ void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify, force set BT to ignore Wlan active!!\n"); BTC_TRACE(trace_buf); + halbtc8812a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ex_halbtc8812a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); @@ -4670,16 +5471,65 @@ void ex_halbtc8812a2ant_halt_notify(IN struct btc_coexist *btcoexist) btcoexist->btc_write_1byte(btcoexist, 0x522, 0xff); /* 0x40[7:6]=2'b01, modify BT mode. */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0xc0, 0x2); - btcoexist->stop_coex_dm = true; + /* PTA off. */ +#ifndef CONFIG_PCI_HCI + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x0); +#endif } void ex_halbtc8812a2ant_periodical(IN struct btc_coexist *btcoexist) { + static u8 dis_ver_info_cnt = 0; + u32 fw_ver = 0, bt_patch_ver = 0; + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_stack_info *stack_info = &btcoexist->stack_info; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ==========================Periodical===========================\n"); + BTC_TRACE(trace_buf); + + if (dis_ver_info_cnt <= 5) { + dis_ver_info_cnt += 1; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ****************************************************************\n"); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Ant PG Num/ Ant Mech/ Ant Pos = %d/ %d/ %d\n", + board_info->pg_ant_num, board_info->btdm_ant_num, + board_info->btdm_ant_pos); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT stack/ hci ext ver = %s / %d\n", + ((stack_info->profile_notified) ? "Yes" : "No"), + stack_info->hci_version); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexVer/ FwVer/ PatchVer = %d_%x/ 0x%x/ 0x%x(%d)\n", + glcoex_ver_date_8812a_2ant, glcoex_ver_8812a_2ant, + fw_ver, bt_patch_ver, bt_patch_ver); + BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ****************************************************************\n"); + BTC_TRACE(trace_buf); + } + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + coex_sta->bt_coex_supported_version = + btcoexist->btc_get_bt_coex_supported_version(btcoexist); + #if (BT_AUTO_REPORT_ONLY_8812A_2ANT == 0) halbtc8812a2ant_query_bt_info(btcoexist); halbtc8812a2ant_monitor_bt_ctr(btcoexist); + halbtc8812a2ant_monitor_wifi_ctr(btcoexist); halbtc8812a2ant_monitor_bt_enable_disable(btcoexist); #else + halbtc8812a2ant_monitor_wifi_ctr(btcoexist); + if (halbtc8812a2ant_is_wifi_status_changed(btcoexist) || coex_dm->auto_tdma_adjust || coex_dm->auto_tdma_adjust_low_rssi) @@ -4695,10 +5545,12 @@ void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Set Dec BT power\n"); BTC_TRACE(trace_buf); + { u8 data_len = 4; u8 buf[6] = {0}; u8 dec_bt_pwr = 0, pwr_level = 0; + if (op_len == 2) { dec_bt_pwr = pdata[0]; pwr_level = pdata[1]; @@ -4713,6 +5565,7 @@ void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, "[BTCoex], Set Dec BT power=%d, pwr_level=%d\n", dec_bt_pwr, pwr_level); BTC_TRACE(trace_buf); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_CTRL_BT_COEX, (void *)&buf[0]); @@ -4727,6 +5580,7 @@ void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, { u8 data_len = 5; u8 buf[6] = {0}; + if (op_len == 3) { buf[0] = data_len; buf[1] = 0x5; /* OP_Code */ @@ -4754,6 +5608,7 @@ void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, { u8 data_len = 3; u8 buf[6] = {0}; + if (op_len == 1) { buf[0] = data_len; buf[1] = 0x1; /* OP_Code */ @@ -4779,4 +5634,5 @@ void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, #endif -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ \ No newline at end of file +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a2ant.h similarity index 83% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a2Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a2ant.h index be08dd391258..2b7f4aabe45b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8812a2Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8812a2ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -21,6 +35,7 @@ (((_BT_INFO_EXT_&BIT(0))) ? true : false) #define BTC_RSSI_COEX_THRESH_TOL_8812A_2ANT 2 +#define NOISY_AP_NUM_THRESH_8812A 50 enum bt_info_src_8812a_2ant { BT_INFO_SRC_8812A_2ANT_WIFI_FW = 0x0, @@ -122,6 +137,9 @@ struct coex_dm_8812a_2ant { u8 cur_retry_limit_type; u8 pre_ampdu_time_type; u8 cur_ampdu_time_type; + + boolean cur_enable_pta; + boolean pre_enable_pta; }; struct coex_sta_8812a_2ant { @@ -149,6 +167,22 @@ struct coex_sta_8812a_2ant { boolean c2h_bt_inquiry_page; u8 bt_retry_cnt; u8 bt_info_ext; + u8 scan_ap_num; + boolean pre_bt_disabled; + u32 pre_bt_info_c2h_cnt_bt_rsp; + u32 pre_bt_info_c2h_cnt_bt_send; + boolean force_lps_on; + u32 bt_coex_supported_version; + + u32 crc_ok_cck; + u32 crc_ok_11g; + u32 crc_ok_11n; + u32 crc_ok_11n_vht; + + u32 crc_err_cck; + u32 crc_err_11g; + u32 crc_err_11n; + u32 crc_err_11n_vht; }; /* ******************************************* @@ -180,6 +214,8 @@ void ex_halbtc8812a2ant_periodical(IN struct btc_coexist *btcoexist); void ex_halbtc8812a2ant_display_coex_info(IN struct btc_coexist *btcoexist); void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, IN u8 op_code, IN u8 op_len, IN u8 *pdata); +void ex_halbtc8812a2ant_pta_off_on_notify(IN struct btc_coexist *btcoexist, + IN u8 bt_status); #else #define ex_halbtc8812a2ant_power_on_setting(btcoexist) @@ -197,6 +233,9 @@ void ex_halbtc8812a2ant_dbg_control(IN struct btc_coexist *btcoexist, #define ex_halbtc8812a2ant_periodical(btcoexist) #define ex_halbtc8812a2ant_display_coex_info(btcoexist) #define ex_halbtc8812a2ant_dbg_control(btcoexist, op_code, op_len, pdata) +#define ex_halbtc8812a2ant_pta_off_on_notify(btcoexist, bt_status) + #endif #endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a1Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a1ant.c similarity index 89% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a1Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a1ant.c index 81ddf035143d..694ab82a0dba 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a1Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a1ant.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /* ************************************************************ * Description: * @@ -11,7 +25,7 @@ * ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -31,8 +45,9 @@ const char *const glbt_info_src_8821a_1ant[] = { "BT Info[bt auto report]", }; -u32 glcoex_ver_date_8821a_1ant = 20150615; -u32 glcoex_ver_8821a_1ant = 0x61; +u32 glcoex_ver_date_8821a_1ant = 20170206; +u32 glcoex_ver_8821a_1ant = 0x67; +u32 glcoex_ver_btdesired_8821a_1ant = 0x62; /* ************************************************************ * local function proto type if needed @@ -294,9 +309,9 @@ void halbtc8821a1ant_limited_tx(IN struct btc_coexist *btcoexist, } -/* ture/xxxx/x:1 +/* true/xxxx/x:1 * false/false/x: 64 - * false/ture/x:x */ + * false/true/x:x */ void halbtc8821a1ant_limited_rx(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean rej_ap_agg_pkt, IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) @@ -355,6 +370,42 @@ void halbtc8821a1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); } +void halbtc8821a1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ +#if 1 + + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + +#endif +} + + void halbtc8821a1ant_query_bt_info(IN struct btc_coexist *btcoexist) { u8 h2c_parameter[1] = {0}; @@ -698,8 +749,8 @@ void halbtc8821a1ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist h2c_parameter[2] = 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ h2c_parameter[3] = 0xf5; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48// */ - h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 // */ + h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48 */ + h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 */ } btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); @@ -720,6 +771,12 @@ void halbtc8821a1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; } +void halbtc8821a1ant_sw_mechanism(IN struct btc_coexist *btcoexist, + IN boolean low_penalty_ra) +{ + halbtc8821a1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); +} + void halbtc8821a1ant_set_coex_table(IN struct btc_coexist *btcoexist, IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) { @@ -807,9 +864,8 @@ void halbtc8821a1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[1] = {0}; - if (enable) { + if (enable) h2c_parameter[0] |= BIT(0); /* function enable */ - } btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); } @@ -829,44 +885,6 @@ void halbtc8821a1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; } -void halbtc8821a1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, - IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -{ - u8 h2c_parameter[5] = {0}; - u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], FW for 1Ant AP mode\n"); - BTC_TRACE(trace_buf); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - } - } - - h2c_parameter[0] = real_byte1; - h2c_parameter[1] = byte2; - h2c_parameter[2] = byte3; - h2c_parameter[3] = byte4; - h2c_parameter[4] = real_byte5; - - coex_dm->ps_tdma_para[0] = real_byte1; - coex_dm->ps_tdma_para[1] = byte2; - coex_dm->ps_tdma_para[2] = byte3; - coex_dm->ps_tdma_para[3] = byte4; - coex_dm->ps_tdma_para[4] = real_byte5; - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -} - void halbtc8821a1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, IN u8 lps_val, IN u8 rpwm_val) { @@ -894,12 +912,6 @@ void halbtc8821a1ant_lps_rpwm(IN struct btc_coexist *btcoexist, coex_dm->pre_rpwm = coex_dm->cur_rpwm; } -void halbtc8821a1ant_sw_mechanism(IN struct btc_coexist *btcoexist, - IN boolean low_penalty_ra) -{ - halbtc8821a1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - void halbtc8821a1ant_set_ant_path(IN struct btc_coexist *btcoexist, IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) { @@ -908,6 +920,7 @@ void halbtc8821a1ant_set_ant_path(IN struct btc_coexist *btcoexist, u8 h2c_parameter[2] = {0}; if (init_hwcfg) { + /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); u32tmp &= ~BIT(23); @@ -917,24 +930,33 @@ void halbtc8821a1ant_set_ant_path(IN struct btc_coexist *btcoexist, /* 0x765 = 0x18 */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { +if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { +BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, +"[BTCoex], 1\n"); +BTC_TRACE(trace_buf); /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ h2c_parameter[0] = 1; h2c_parameter[1] = 1; btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, h2c_parameter); - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x1); //Main Ant to BT for IPS case 0x4c[23]=1 */ + /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x1); */ /*Main Ant to BT for IPS case 0x4c[23]=1 */ } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 2\n"); + BTC_TRACE(trace_buf); /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ h2c_parameter[0] = 0; h2c_parameter[1] = 1; btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, h2c_parameter); - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x0); //Aux Ant to BT for IPS case 0x4c[23]=1 */ + /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, 0x0); */ /*Aux Ant to BT for IPS case 0x4c[23]=1 */ } } else if (wifi_off) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 3\n"); + BTC_TRACE(trace_buf); /* 0x4c[24:23]=00, Set Antenna control by BT_RFE_CTRL BT Vendor 0xac=0xf002 */ u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); u32tmp &= ~BIT(23); @@ -944,6 +966,9 @@ void halbtc8821a1ant_set_ant_path(IN struct btc_coexist *btcoexist, /* 0x765 = 0x18 */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x3); } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 4\n"); + BTC_TRACE(trace_buf); /* 0x765 = 0x0 */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x765, 0x18, 0x0); } @@ -984,6 +1009,120 @@ void halbtc8821a1ant_set_ant_path(IN struct btc_coexist *btcoexist, } } + +void halbtc8821a1ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +{ + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + /* will leave LPS state, turn off psTdma first */ +/* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false,8); */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } + } else { /* NO PS state */ + if (new_ps_state) { + /* will enter LPS state, turn off psTdma first */ +/* halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false,8); */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } else { + /* keep state under NO PS state, do nothing. */ + } + } +} + +void halbtc8821a1ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = false; + + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + low_pwr_disable = false; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + NULL); + break; + case BTC_PS_LPS_ON: + halbtc8821a1ant_ps_tdma_check_for_power_save_state( + btcoexist, true); + halbtc8821a1ant_lps_rpwm(btcoexist, NORMAL_EXEC, + lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = true; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + /* power save must executed before psTdma. */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, + NULL); + break; + case BTC_PS_LPS_OFF: + halbtc8821a1ant_ps_tdma_check_for_power_save_state( + btcoexist, false); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + break; + default: + break; + } +} + +void halbtc8821a1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, + IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) +{ + u8 h2c_parameter[5] = {0}; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if (ap_enable) { + if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + halbtc8821a1ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } +} else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { +halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + + } else { + halbtc8821a1ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } + + h2c_parameter[0] = real_byte1; + h2c_parameter[1] = byte2; + h2c_parameter[2] = byte3; + h2c_parameter[3] = byte4; + h2c_parameter[4] = real_byte5; + + coex_dm->ps_tdma_para[0] = real_byte1; + coex_dm->ps_tdma_para[1] = byte2; + coex_dm->ps_tdma_para[2] = byte3; + coex_dm->ps_tdma_para[3] = byte4; + coex_dm->ps_tdma_para[4] = real_byte5; + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); +} + void halbtc8821a1ant_ps_tdma(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean turn_on, IN u8 type) { @@ -1070,10 +1209,13 @@ void halbtc8821a1ant_ps_tdma(IN struct btc_coexist *btcoexist, 0x0a, 0x0a, 0x0, 0x50); break; case 13: + halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, - 0x12, 0x12, 0x0, 0x50); + 0x40, 0x3, 0x10, 0x50); + break; case 14: + halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, 0x1e, 0x3, 0x10, 0x14); break; @@ -1181,6 +1323,17 @@ void halbtc8821a1ant_ps_tdma(IN struct btc_coexist *btcoexist, halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, 0x30, 0x3, 0x10, 0x11); break; + case 44: + halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, + 0x20, 0x3, 0x10, 0x14); + case 45: + halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, + 0x25, 0x3, 0x10, 0x10); + break; + case 46: + halbtc8821a1ant_set_fw_pstdma(btcoexist, 0x51, + 0x35, 0x3, 0x10, 0x10); + break; } } else { /* disable PS tdma */ @@ -1257,7 +1410,8 @@ boolean halbtc8821a1ant_is_common_action(IN struct btc_coexist *btcoexist) common = true; } else if (!wifi_connected && - (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { + (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); BTC_TRACE(trace_buf); @@ -1265,7 +1419,8 @@ boolean halbtc8821a1ant_is_common_action(IN struct btc_coexist *btcoexist) common = true; } else if (wifi_connected && - (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { + (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected + BT connected-idle!!\n"); BTC_TRACE(trace_buf); @@ -1273,7 +1428,8 @@ boolean halbtc8821a1ant_is_common_action(IN struct btc_coexist *btcoexist) common = true; } else if (!wifi_connected && - (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { + (BT_8821A_1ANT_BT_STATUS_CONNECTED_IDLE != + coex_dm->bt_status)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); BTC_TRACE(trace_buf); @@ -1297,76 +1453,201 @@ boolean halbtc8821a1ant_is_common_action(IN struct btc_coexist *btcoexist) return common; } -void halbtc8821a1ant_ps_tdma_check_for_power_save_state( - IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +/* ********************************************* + * + * Software Coex Mechanism start + * + * ********************************************* */ + +void halbtc8821a1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) { - u8 lps_mode = 0x0; - btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + /* halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); */ + halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, false, false); + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +} +/* SCO only or SCO+PAN(HS) */ +void halbtc8821a1ant_action_sco(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - if (lps_mode) { /* already under LPS state */ - if (new_ps_state) { - /* keep state under LPS, do nothing. */ - } else { - /* will leave LPS state, turn off psTdma first */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 0); - } else { - /* keep state under NO PS state, do nothing. */ - } + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); + + halbtc8821a1ant_sw_mechanism(btcoexist, true); +} + +void halbtc8821a1ant_action_hid(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); + + halbtc8821a1ant_sw_mechanism(btcoexist, true); +} + +/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ +void halbtc8821a1ant_action_a2dp(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 44); + + halbtc8821a1ant_sw_mechanism(btcoexist, false); +} + +void halbtc8821a1ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); + + halbtc8821a1ant_sw_mechanism(btcoexist, false); +} + +void halbtc8821a1ant_action_pan_edr(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); + + halbtc8821a1ant_sw_mechanism(btcoexist, false); +} + +/* PAN(HS) only */ +void halbtc8821a1ant_action_pan_hs(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); + + halbtc8821a1ant_sw_mechanism(btcoexist, false); +} + +/* PAN(EDR)+A2DP */ +void halbtc8821a1ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); + + halbtc8821a1ant_sw_mechanism(btcoexist, false); +} + +void halbtc8821a1ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); + + halbtc8821a1ant_sw_mechanism(btcoexist, true); +} + +/* HID+A2DP+PAN(EDR) */ +void halbtc8821a1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); + + halbtc8821a1ant_sw_mechanism(btcoexist, true); +} + +void halbtc8821a1ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 44); + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + + halbtc8821a1ant_sw_mechanism(btcoexist, true); +} + +/* ********************************************* + * + * Non-Software Coex Mechanism start + * + * ********************************************* */ +void halbtc8821a1ant_action_hs(IN struct btc_coexist *btcoexist) +{ + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 45); + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); +} + +void halbtc8821a1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = false, ap_enable = false, wifi_busy = false, + bt_busy = false; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + + if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } + + + else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || + (bt_link_info->a2dp_exist)) { + /* SCO/HID/A2DP busy */ + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } + + + + else if ((bt_link_info->a2dp_exist) && + (bt_link_info->hid_exist)) { + /* A2DP+HID busy */ + + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, + 14); + + halbtc8821a1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + } + + + else if ((bt_link_info->pan_exist) || (wifi_busy)) { + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); + + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } else { + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); + + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); } } -void halbtc8821a1ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +void halbtc8821a1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist + *btcoexist, IN u8 wifi_status) { - boolean low_pwr_disable = false; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = false; - switch (ps_type) { - case BTC_PS_WIFI_NATIVE: - /* recover to original 32k low power setting */ - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - break; - case BTC_PS_LPS_ON: - halbtc8821a1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8821a1ant_lps_rpwm(btcoexist, NORMAL_EXEC, - lps_val, rpwm_val); - /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - /* power save must executed before psTdma. */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, - NULL); - break; - case BTC_PS_LPS_OFF: - halbtc8821a1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - break; - default: - break; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + /* tdma and coex table */ + + if (bt_link_info->sco_exist) { + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + } else { /* HID */ + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); + halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); } } void halbtc8821a1ant_coex_under_5g(IN struct btc_coexist *btcoexist) { - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); halbtc8821a1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); @@ -1416,7 +1697,7 @@ void halbtc8821a1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) "[BTCoex], bt all counters=0, %d times!!\n", bt_disable_cnt); BTC_TRACE(trace_buf); - if (bt_disable_cnt >= 2) { + if (bt_disable_cnt >= 10) { bt_disabled = true; btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, &bt_disabled); @@ -1443,178 +1724,13 @@ void halbtc8821a1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) } } -/* ********************************************* - * - * Software Coex Mechanism start - * - * ********************************************* */ - -void halbtc8821a1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - /* halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, NORMAL_EXEC, false, false); */ - halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, false, false); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} -/* SCO only or SCO+PAN(HS) */ -void halbtc8821a1ant_action_sco(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, true); -} - -void halbtc8821a1ant_action_hid(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, true); -} - -/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ -void halbtc8821a1ant_action_a2dp(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8821a1ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8821a1ant_action_pan_edr(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, false); -} - -/* PAN(HS) only */ -void halbtc8821a1ant_action_pan_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, false); -} - -/* PAN(EDR)+A2DP */ -void halbtc8821a1ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8821a1ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, true); -} - -/* HID+A2DP+PAN(EDR) */ -void halbtc8821a1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, true); -} - -void halbtc8821a1ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_sw_mechanism(btcoexist, true); -} - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ void halbtc8821a1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) { - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); } -void halbtc8821a1ant_action_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8821a1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, ap_enable = false, wifi_busy = false, - bt_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - if ((!wifi_connected) && (!coex_sta->wifi_is_high_pri_task)) { - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } - - /* sy modify */ - else if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || - (bt_link_info->a2dp_exist)) { - /* SCO/HID/A2DP busy */ - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } - - /* sy modify */ - - else if ((bt_link_info->a2dp_exist) && - (bt_link_info->hid_exist)) { - /* A2DP+HID busy */ - halbtc8821a1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 14); - - halbtc8821a1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 1); - } - - - else if ((bt_link_info->pan_exist) || (wifi_busy)) { - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - } -} - -void halbtc8821a1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - /* tdma and coex table */ - - if (bt_link_info->sco_exist) { - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 41); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } else { /* HID */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 42); - halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} void halbtc8821a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist *btcoexist, IN u8 wifi_status) @@ -1622,6 +1738,7 @@ void halbtc8821a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist u8 bt_rssi_state; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + bt_rssi_state = halbtc8821a1ant_bt_rssi_state(2, 28, 0); if (bt_link_info->hid_only) { /* HID */ @@ -1674,7 +1791,7 @@ void halbtc8821a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || (bt_link_info->hid_exist && bt_link_info->a2dp_exist && bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ - halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 43); + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 46); halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); coex_dm->auto_tdma_adjust = false; } else { @@ -1686,9 +1803,6 @@ void halbtc8821a1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist void halbtc8821a1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) { - /* power save state */ - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); /* tdma and coex table */ halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); @@ -1700,18 +1814,17 @@ void halbtc8821a1ant_action_wifi_not_connected_scan(IN struct btc_coexist { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); /* tdma and coex table */ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { if (bt_link_info->a2dp_exist) { - /* sy modify */ + halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - } else if (bt_link_info->a2dp_exist && bt_link_info->pan_exist) { + } else if (bt_link_info->a2dp_exist && + bt_link_info->pan_exist) { halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); halbtc8821a1ant_coex_table_with_type(btcoexist, @@ -1742,9 +1855,6 @@ void halbtc8821a1ant_action_wifi_not_connected_asso_auth( { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - /* tdma and coex table */ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { /* sy modify */ @@ -1764,9 +1874,6 @@ void halbtc8821a1ant_action_wifi_connected_scan(IN struct btc_coexist { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - /* tdma and coex table */ if (BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { if (bt_link_info->a2dp_exist) { @@ -1807,9 +1914,6 @@ void halbtc8821a1ant_action_wifi_connected_specific_packet( { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - /* tdma and coex table */ /* sy modify */ if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || @@ -1848,7 +1952,8 @@ void halbtc8821a1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &under_4way); if (under_4way) { - halbtc8821a1ant_action_wifi_connected_specific_packet(btcoexist); + halbtc8821a1ant_action_wifi_connected_specific_packet( + btcoexist); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); BTC_TRACE(trace_buf); @@ -1873,19 +1978,6 @@ void halbtc8821a1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - /* power save state */ - if (!ap_enable && - BT_8821A_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status && - !btcoexist->bt_link_info.hid_only) { - if (!wifi_busy && btcoexist->bt_link_info.a2dp_only) /* A2DP */ - halbtc8821a1ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); - else - halbtc8821a1ant_power_save_state(btcoexist, - BTC_PS_LPS_ON, 0x50, 0x4); - } else - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); /* tdma and coex table */ if (!wifi_busy) { @@ -2120,6 +2212,9 @@ void halbtc8821a1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) halbtc8821a1ant_run_sw_coexist_mechanism(btcoexist); + /* low pelnaty ra in pcr ra */ + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); if (coex_sta->c2h_bt_inquiry_page) { halbtc8821a1ant_action_bt_inquiry(btcoexist); @@ -2197,6 +2292,13 @@ void halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + /* Give bt_coex_supported_version the default value */ + coex_sta->bt_coex_supported_version = 0; + + /* 0xf0[15:12] --> Chip Cut information */ + coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, + 0xf1) & 0xf0) >> 4; + /* Antenna config */ if (wifi_under_5g) halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, true, @@ -2223,6 +2325,14 @@ void halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, * ************************************************************ */ void ex_halbtc8821a1ant_power_on_setting(IN struct btc_coexist *btcoexist) { + struct btc_board_info *board_info = &btcoexist->board_info; + +if (board_info->single_ant_path == 0) { +board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; + } else if (board_info->single_ant_path == 1) { + board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; + } + } void ex_halbtc8821a1ant_init_hw_config(IN struct btc_coexist *btcoexist, @@ -2253,6 +2363,9 @@ void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist) u16 u16tmp[4]; u32 u32tmp[4]; u32 fw_ver = 0, bt_patch_ver = 0; + u32 bt_coex_ver = 0; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 phyver = 0; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -2281,13 +2394,28 @@ void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist) board_info->btdm_ant_pos); CL_PRINTF(cli_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + /* btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); */ + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8821a_1ant, glcoex_ver_8821a_1ant, fw_ver, - bt_patch_ver, bt_patch_ver); + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8821a_1ant, glcoex_ver_8821a_1ant, + glcoex_ver_btdesired_8821a_1ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (bt_coex_ver >= glcoex_ver_btdesired_8821a_1ant ? + "Match" : "Mis-Match"))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", @@ -2440,14 +2568,34 @@ void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist) u32tmp[0] & 0xff); CL_PRINTF(cli_buf); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "OFDM-FA/ CCK-FA", - u32tmp[0], (u8tmp[0] << 8) + u8tmp[1]); + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11n-agg", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11n-agg", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); @@ -2606,6 +2754,85 @@ void ex_halbtc8821a1ant_scan_notify(IN struct btc_coexist *btcoexist, } } +/* copy scan notify content to switch band notify */ +void ex_halbtc8821a1ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_connected = false, bt_hs_on = false; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = false; + u8 agg_buf_size = 5; + boolean wifi_under_5g = false; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + if (wifi_under_5g) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for 5G <===\n"); + BTC_TRACE(trace_buf); + halbtc8821a1ant_coex_under_5g(btcoexist); + return; + } + + if (BTC_SCAN_START == type) { + coex_sta->wifi_is_high_pri_task = true; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify\n"); + BTC_TRACE(trace_buf); + + halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, + 8); /* Force antenna setup for no scan result issue */ + } else { + coex_sta->wifi_is_high_pri_task = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN FINISH notify\n"); + BTC_TRACE(trace_buf); + } + + if (coex_sta->bt_disabled) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + halbtc8821a1ant_query_bt_info(btcoexist); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + if (num_of_wifi_link >= 2) { + halbtc8821a1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8821a1ant_limited_rx(btcoexist, NORMAL_EXEC, false, + bt_ctrl_agg_buf_size, agg_buf_size); + halbtc8821a1ant_action_wifi_multi_port(btcoexist); + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8821a1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8821a1ant_action_hs(btcoexist); + return; + } + + if (BTC_SCAN_START == type) { + if (!wifi_connected) /* non-connected scan */ + halbtc8821a1ant_action_wifi_not_connected_scan( + btcoexist); + else /* wifi is connected */ + halbtc8821a1ant_action_wifi_connected_scan(btcoexist); + } else if (BTC_SCAN_FINISH == type) { + if (!wifi_connected) /* non-connected scan */ + halbtc8821a1ant_action_wifi_not_connected(btcoexist); + else + halbtc8821a1ant_action_wifi_connected(btcoexist); + } +} void ex_halbtc8821a1ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type) { @@ -2710,10 +2937,11 @@ void ex_halbtc8821a1ant_media_status_notify(IN struct btc_coexist *btcoexist, /* only 2.4G we need to inform bt the chnl mask */ btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, &wifi_central_chnl); - if ((BTC_MEDIA_CONNECT == type) && - (wifi_central_chnl <= 14)) { - /* h2c_parameter[0] = 0x1; */ - h2c_parameter[0] = 0x0; + +if ((wifi_central_chnl <= 14) && (type == BTC_MEDIA_CONNECT)) { + +h2c_parameter[0] = 0x1; + /*h2c_parameter[0] = 0x0;*/ h2c_parameter[1] = wifi_central_chnl; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); if (BTC_WIFI_BW_HT40 == wifi_bw) @@ -2809,7 +3037,8 @@ void ex_halbtc8821a1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, return; } - halbtc8821a1ant_action_wifi_connected_specific_packet(btcoexist); + halbtc8821a1ant_action_wifi_connected_specific_packet( + btcoexist); } } @@ -3016,8 +3245,6 @@ void ex_halbtc8821a1ant_halt_notify(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); BTC_TRACE(trace_buf); - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); halbtc8821a1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, true); /* halbtc8821a1ant_set_ant_path_d_cut(btcoexist, false, false, false, BTC_ANT_PATH_BT, BTC_WIFI_STAT_NORMAL_OFF); */ @@ -3050,8 +3277,6 @@ void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, "[BTCoex], Pnp notify to SLEEP\n"); BTC_TRACE(trace_buf); - halbtc8821a1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); halbtc8821a1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); halbtc8821a1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); halbtc8821a1ant_set_ant_path(btcoexist, BTC_ANT_PATH_BT, false, @@ -3077,11 +3302,22 @@ void ex_halbtc8821a1ant_pnp_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8821a1ant_periodical(IN struct btc_coexist *btcoexist) { + u32 bt_patch_ver; + + if (((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) && (!coex_sta->bt_disabled)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, &coex_sta->bt_coex_supported_version); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + #if (BT_AUTO_REPORT_ONLY_8821A_1ANT == 0) halbtc8821a1ant_query_bt_info(btcoexist); - halbtc8821a1ant_monitor_bt_ctr(btcoexist); halbtc8821a1ant_monitor_bt_enable_disable(btcoexist); #else + halbtc8821a1ant_monitor_bt_ctr(btcoexist); + halbtc8821a1ant_monitor_wifi_ctr(btcoexist); + halbtc8821a1ant_monitor_bt_enable_disable(btcoexist); if (halbtc8821a1ant_is_wifi_status_changed(btcoexist) || coex_dm->auto_tdma_adjust) { /* if(coex_sta->specific_pkt_period_cnt > 2) */ @@ -3098,3 +3334,4 @@ void ex_halbtc8821a1ant_periodical(IN struct btc_coexist *btcoexist) #endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a1Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a1ant.h similarity index 84% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a1Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a1ant.h index 6c9c327e34b9..c9c141c0a095 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a1Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a1ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -133,7 +147,21 @@ struct coex_sta_8821a_1ant { u32 high_priority_rx; u32 low_priority_tx; u32 low_priority_rx; + + u32 crc_ok_cck; + u32 crc_ok_11g; + u32 crc_ok_11n; + u32 crc_ok_11n_vht; + + u32 crc_err_cck; + u32 crc_err_11g; + u32 crc_err_11n; + u32 crc_err_11n_vht; + + u32 bt_coex_supported_version; + u8 cut_version; u8 bt_rssi; + u8 scan_ap_num; boolean bt_tx_rx_mask; u8 pre_bt_rssi_state; u8 pre_wifi_rssi_state[4]; @@ -145,8 +173,7 @@ struct coex_sta_8821a_1ant { boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ u8 bt_retry_cnt; u8 bt_info_ext; - boolean - bt_whck_test; /* Add for ASUS WHQL TEST that enable wifi test bt */ + boolean bt_whck_test; /* Add for ASUS WHQL TEST that enable wifi test bt */ }; /* ******************************************* @@ -162,6 +189,8 @@ void ex_halbtc8821a1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821a1ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type); +void ex_halbtc8821a1ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type); void ex_halbtc8821a1ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821a1ant_media_status_notify(IN struct btc_coexist *btcoexist, @@ -183,6 +212,7 @@ void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist); #define ex_halbtc8821a1ant_ips_notify(btcoexist, type) #define ex_halbtc8821a1ant_lps_notify(btcoexist, type) #define ex_halbtc8821a1ant_scan_notify(btcoexist, type) +#define ex_halbtc8821a1ant_switchband_notify(btcoexist, type) #define ex_halbtc8821a1ant_connect_notify(btcoexist, type) #define ex_halbtc8821a1ant_media_status_notify(btcoexist, type) #define ex_halbtc8821a1ant_specific_packet_notify(btcoexist, type) @@ -195,3 +225,4 @@ void ex_halbtc8821a1ant_display_coex_info(IN struct btc_coexist *btcoexist); #endif #endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a2Ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a2ant.c similarity index 94% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a2Ant.c rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a2ant.c index 010a422001b1..802f298a4c74 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a2Ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a2ant.c @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /* ************************************************************ * Description: * @@ -11,7 +25,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -31,8 +45,10 @@ const char *const glbt_info_src_8821a_2ant[] = { "BT Info[bt auto report]", }; -u32 glcoex_ver_date_8821a_2ant = 20150921; -u32 glcoex_ver_8821a_2ant = 0x58; +u32 glcoex_ver_date_8821a_2ant = 20161130; +u32 glcoex_ver_8821a_2ant = 0x61; +u32 glcoex_ver_btdesired_8821a_2ant = 0x5c; + /* modify 20140903v43 a2dpandhid tdmaonoff a2dp glitch _ tdma off 778=3(case1)->778=1(case0) * and to improve tp while a2dphid case23->case25 , case123->case125 for asus spec * and modify for asus bt WHQL test _ tdma off_ 778=3->1_ @@ -169,58 +185,6 @@ u8 halbtc8821a2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, return wifi_rssi_state; } -void halbtc8821a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -{ - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - - /* This function check if bt is disabled */ - - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); - BTC_TRACE(trace_buf); - } else { - bt_disable_cnt++; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], bt all counters=0, %d times!!\n", - bt_disable_cnt); - BTC_TRACE(trace_buf); - if (bt_disable_cnt >= 2) { - bt_disabled = true; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); - BTC_TRACE(trace_buf); - } - } - if (coex_sta->bt_disabled != bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); - BTC_TRACE(trace_buf); - coex_sta->bt_disabled = bt_disabled; - if (!bt_disabled) { - } else { - } - } -} void halbtc8821a2ant_limited_rx(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean rej_ap_agg_pkt, @@ -289,39 +253,37 @@ void halbtc8821a2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) void halbtc8821a2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) { - if (coex_sta->under_ips) { - coex_sta->crc_ok_cck = 0; - coex_sta->crc_ok_11g = 0; - coex_sta->crc_ok_11n = 0; - coex_sta->crc_ok_11n_agg = 0; +#if 1 - coex_sta->crc_err_cck = 0; - coex_sta->crc_err_11g = 0; - coex_sta->crc_err_11n = 0; - coex_sta->crc_err_11n_agg = 0; - } else { - coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf88); - coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf94); - coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf90); - coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfb8); + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); - coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf84); - coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf96); - coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf92); - coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfba); - } + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); - /* reset counter */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); +#endif } void halbtc8821a2ant_query_bt_info(IN struct btc_coexist *btcoexist) @@ -378,6 +340,57 @@ boolean halbtc8821a2ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) return false; } +void halbtc8821a2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) +{ + static u32 bt_disable_cnt = 0; + boolean bt_active = true, bt_disabled = false; + + /* This function check if bt is disabled */ + + if (coex_sta->high_priority_tx == 0 && + coex_sta->high_priority_rx == 0 && + coex_sta->low_priority_tx == 0 && + coex_sta->low_priority_rx == 0) + bt_active = false; + if (coex_sta->high_priority_tx == 0xffff && + coex_sta->high_priority_rx == 0xffff && + coex_sta->low_priority_tx == 0xffff && + coex_sta->low_priority_rx == 0xffff) + bt_active = false; + if (bt_active) { + bt_disable_cnt = 0; + bt_disabled = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is enabled !!\n"); + BTC_TRACE(trace_buf); + } else { + bt_disable_cnt++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], bt all counters=0, %d times!!\n", + bt_disable_cnt); + BTC_TRACE(trace_buf); + if (bt_disable_cnt >= 10) { + bt_disabled = true; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!\n"); + BTC_TRACE(trace_buf); + } + } + if (coex_sta->bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->bt_disabled ? "disabled" : "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + coex_sta->bt_disabled = bt_disabled; + /* if (!bt_disabled) {} else {} */ + } +} + void halbtc8821a2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; @@ -767,12 +780,12 @@ void halbtc8821a2ant_set_sw_penalty_tx_rate_adaptive(IN struct btc_coexist h2c_parameter[1] |= BIT(0); h2c_parameter[2] = 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ - h2c_parameter[3] = 0xf5; /* MCS7 or OFDM54 */ + h2c_parameter[3] = 0xf3; /* MCS7 or OFDM54 */ h2c_parameter[4] = 0xa0; /* MCS6 or OFDM48 */ h2c_parameter[5] = 0xa0; /* MCS5 or OFDM36 */ - /* h2c_parameter[3] = 0xf7; //MCS7 or OFDM54 */ - /* h2c_parameter[4] = 0xf8; //MCS6 or OFDM48 */ - /* h2c_parameter[5] = 0xf9; //MCS5 or OFDM36 */ + /* h2c_parameter[3] = 0xf7; */ /*MCS7 or OFDM54 */ + /* h2c_parameter[4] = 0xf8; */ /*MCS6 or OFDM48 */ + /* h2c_parameter[5] = 0xf9; /MCS5 or OFDM36 */ } btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); @@ -957,6 +970,25 @@ void halbtc8821a2ant_agc_table(IN struct btc_coexist *btcoexist, coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; } +void halbtc8821a2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, + IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, + IN boolean limited_dig, IN boolean bt_lna_constrain) +{ + + + /* halbtc8821a2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ + halbtc8821a2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); +} + +void halbtc8821a2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, + IN boolean agc_table_shift, IN boolean adc_back_off, + IN boolean sw_dac_swing, IN u32 dac_swing_lvl) +{ + + halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, + dac_swing_lvl); +} + void halbtc8821a2ant_set_coex_table(IN struct btc_coexist *btcoexist, IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) { @@ -1072,6 +1104,10 @@ void halbtc8821a2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, halbtc8821a2ant_coex_table(btcoexist, force_exec, 0xfafafafa, 0xfafafafa, 0xffffff, 0x3); break; + case 18: + halbtc8821a2ant_coex_table(btcoexist, force_exec, + 0x5555555f, 0x5ada5ada, 0xffffff, 0x3); + break; default: break; } @@ -1082,13 +1118,28 @@ void halbtc8821a2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[1] = {0}; - if (enable) { + if (enable) h2c_parameter[0] |= BIT(0); /* function enable */ - } btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); } +void halbtc8821a2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable) +{ + coex_dm->cur_ignore_wlan_act = enable; + + if (!force_exec) { + if (coex_dm->pre_ignore_wlan_act == + coex_dm->cur_ignore_wlan_act) + return; + } + halbtc8821a2ant_set_fw_ignore_wlan_act(btcoexist, enable); + + coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; +} + + void halbtc8821a2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, IN u8 lps_val, IN u8 rpwm_val) { @@ -1116,25 +1167,105 @@ void halbtc8821a2ant_lps_rpwm(IN struct btc_coexist *btcoexist, coex_dm->pre_rpwm = coex_dm->cur_rpwm; } -void halbtc8821a2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable) +void halbtc8821a2ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) { - coex_dm->cur_ignore_wlan_act = enable; + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0x0, 0, 0, 48, 0}; - if (!force_exec) { - if (coex_dm->pre_ignore_wlan_act == - coex_dm->cur_ignore_wlan_act) - return; + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } + } else { /* NO PS state */ + if (new_ps_state) { + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } else { + } } - halbtc8821a2ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; } +void halbtc8821a2ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = false; + + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + low_pwr_disable = false; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + NULL); + coex_sta->force_lps_on = false; + break; + case BTC_PS_LPS_ON: + halbtc8821a2ant_ps_tdma_check_for_power_save_state( + btcoexist, true); + halbtc8821a2ant_lps_rpwm(btcoexist, NORMAL_EXEC, + lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = true; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + /*power save must executed before psTdma*/ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, + NULL); + coex_sta->force_lps_on = true; + break; + case BTC_PS_LPS_OFF: + halbtc8821a2ant_ps_tdma_check_for_power_save_state( + btcoexist, false); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + coex_sta->force_lps_on = false; + break; + default: + break; + } +} + + void halbtc8821a2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) { u8 h2c_parameter[5] = {0}; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = false; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if (ap_enable) { + if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + halbtc8821a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } +} else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { +halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, 0x4); + + } else { + halbtc8821a2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } h2c_parameter[0] = byte1; h2c_parameter[1] = byte2; @@ -1151,81 +1282,6 @@ void halbtc8821a2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); } -void halbtc8821a2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, - IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, - IN boolean limited_dig, IN boolean bt_lna_constrain) -{ - /* - u32 wifi_bw; - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if(BTC_WIFI_BW_HT40 != wifi_bw) - { - if (shrink_rx_lpf) - shrink_rx_lpf = false; - } - */ - - /* halbtc8821a2ant_rf_shrink(btcoexist, NORMAL_EXEC, shrink_rx_lpf); */ - halbtc8821a2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -void halbtc8821a2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, - IN boolean agc_table_shift, IN boolean adc_back_off, - IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -{ - /* halbtc8821a2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ - /* halbtc8821a2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ - halbtc8821a2ant_dac_swing(btcoexist, NORMAL_EXEC, sw_dac_swing, - dac_swing_lvl); -} - -void halbtc8821a2ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u32 u32tmp = 0; - u8 h2c_parameter[2] = {0}; - - if (init_hwcfg) { - /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ - u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp &= ~BIT(23); - u32tmp |= BIT(24); - btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - - btcoexist->btc_write_4byte(btcoexist, 0x974, 0x3ff); - /* btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); */ - - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { - /* tell firmware "antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ - h2c_parameter[0] = 1; - h2c_parameter[1] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } else { - /* tell firmware "no antenna inverse" ==> WRONG firmware antenna control code.==>need fw to fix */ - h2c_parameter[0] = 0; - h2c_parameter[1] = 1; - btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, - h2c_parameter); - } - } - - /* ext switch setting */ - switch (ant_pos_type) { - case BTC_ANT_WIFI_AT_MAIN: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, - 0x30, 0x1); - break; - case BTC_ANT_WIFI_AT_AUX: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, - 0x30, 0x2); - break; - } -} - void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean turn_on, IN u8 type) { @@ -1351,7 +1407,7 @@ void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 23: halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1e, 0x03, 0xf0, 0x14); + 0x1e, 0x03, 0xf1, 0x94); break; case 24: case 124: @@ -1367,6 +1423,14 @@ void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x30, 0x03, 0xf1, 0x90); break; + case 27: + halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x23, 0x03, 0x70, 0x50); + break; + case 28: + halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, + 0x1e, 0x03, 0xf1, 0x94); + break; case 71: /* halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xe3, 0x1a, 0x1a, 0xe1, 0x90); */ @@ -1419,7 +1483,7 @@ void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, break; case 123: halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1c, 0x03, 0x70, 0x54); + 0x1e, 0x03, 0x70, 0x54); break; /* case25/case125 : for lenovo bt pan tp degrade<30% while wifi downlink */ case 125: @@ -1430,6 +1494,14 @@ void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, 0x30, 0x03, 0x70, 0x50); break; + case 127: + halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x28, 0x03, 0x70, 0x50); + break; + case 128: + halbtc8821a2ant_set_fw_pstdma(btcoexist, 0xd3, + 0x1e, 0x03, 0x70, 0x54); + break; } } else { /* disable PS tdma */ @@ -1454,81 +1526,55 @@ void halbtc8821a2ant_ps_tdma(IN struct btc_coexist *btcoexist, coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; } -void halbtc8821a2ant_ps_tdma_check_for_power_save_state( - IN struct btc_coexist *btcoexist, IN boolean new_ps_state) + +void halbtc8821a2ant_set_ant_path(IN struct btc_coexist *btcoexist, + IN u8 ant_pos_type, IN boolean init_hwcfg, IN boolean wifi_off) { - u8 lps_mode = 0x0; + struct btc_board_info *board_info = &btcoexist->board_info; + u32 u32tmp = 0; + u8 h2c_parameter[2] = {0}; - btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + if (init_hwcfg) { + /* 0x4c[23]=0, 0x4c[24]=1 Antenna control by WL/BT */ + u32tmp = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp &= ~BIT(23); + u32tmp |= BIT(24); + btcoexist->btc_write_4byte(btcoexist, 0x4c, u32tmp); - if (lps_mode) { /* already under LPS state */ - if (new_ps_state) { - /* keep state under LPS, do nothing. */ + btcoexist->btc_write_4byte(btcoexist, 0x974, 0x3ff); + /* btcoexist->btc_write_1byte(btcoexist, 0xcb4, 0x77); */ + + if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) { + + h2c_parameter[0] = 1; + h2c_parameter[1] = 1; + btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, + h2c_parameter); } else { - /* will leave LPS state, turn off psTdma first */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 1); - } else { - /* keep state under NO PS state, do nothing. */ + + h2c_parameter[0] = 0; + h2c_parameter[1] = 1; + btcoexist->btc_fill_h2c(btcoexist, 0x65, 2, + h2c_parameter); } } -} -void halbtc8821a2ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -{ - boolean low_pwr_disable = false; - - switch (ps_type) { - case BTC_PS_WIFI_NATIVE: - /* recover to original 32k low power setting */ - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - coex_sta->force_lps_on = false; + /* ext switch setting */ + switch (ant_pos_type) { + case BTC_ANT_WIFI_AT_MAIN: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, + 0x30, 0x1); break; - case BTC_PS_LPS_ON: - halbtc8821a2ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8821a2ant_lps_rpwm(btcoexist, NORMAL_EXEC, - lps_val, rpwm_val); - /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - /* power save must executed before psTdma. */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, - NULL); - coex_sta->force_lps_on = true; - break; - case BTC_PS_LPS_OFF: - halbtc8821a2ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - coex_sta->force_lps_on = false; - break; - default: + case BTC_ANT_WIFI_AT_AUX: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, + 0x30, 0x2); break; } } - void halbtc8821a2ant_coex_all_off(IN struct btc_coexist *btcoexist) { /* fw all off */ - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); @@ -1549,21 +1595,6 @@ void halbtc8821a2ant_coex_under_5g(IN struct btc_coexist *btcoexist) halbtc8821a2ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, true); } -void halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8821a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); - halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); - halbtc8821a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); - - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -} - void halbtc8821a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) { u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; @@ -1588,23 +1619,19 @@ void halbtc8821a2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - if (scan || link || roam) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi link process + BT Inq/Page!!\n"); BTC_TRACE(trace_buf); halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 15); + 7); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); } else if (wifi_connected) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Wifi connected + BT Inq/Page!!\n"); BTC_TRACE(trace_buf); halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 15); + 7); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -1627,7 +1654,7 @@ void halbtc8821a2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) { u8 u8tmpa, u8tmpb; - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 15); + halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); @@ -1680,14 +1707,12 @@ boolean halbtc8821a2ant_action_wifi_idle_process(IN struct btc_coexist halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); return true; } - /* */ + /* */ else if (coex_sta->pan_exist == true) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -1705,8 +1730,6 @@ boolean halbtc8821a2ant_action_wifi_idle_process(IN struct btc_coexist halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); return true; @@ -1747,8 +1770,6 @@ boolean halbtc8821a2ant_is_common_action(IN struct btc_coexist *btcoexist) 0x0); halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); @@ -1778,15 +1799,14 @@ boolean halbtc8821a2ant_is_common_action(IN struct btc_coexist *btcoexist) halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xb); halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, + halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, + false, false); halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); @@ -1812,8 +1832,6 @@ boolean halbtc8821a2ant_is_common_action(IN struct btc_coexist *btcoexist) halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_power_save_state(btcoexist, - BTC_PS_WIFI_NATIVE, 0x0, 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, @@ -1979,7 +1997,7 @@ void halbtc8821a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, result = 0; wait_count = 0; } else { - /* accquire the BT TRx retry count from BT_Info byte2 */ + /* acquire the BT TRx retry count from BT_Info byte2 */ retry_count = coex_sta->bt_retry_cnt; result = 0; wait_count++; @@ -2741,6 +2759,7 @@ void halbtc8821a2ant_tdma_duration_adjust(IN struct btc_coexist *btcoexist, /* then we have to adjust it back to the previous record one. */ if (coex_dm->cur_ps_tdma != coex_dm->ps_tdma_du_adj_type) { boolean scan = false, link = false, roam = false; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], PsTdma type dismatch!!!, cur_ps_tdma=%d, recordPsTdma=%d\n", coex_dm->cur_ps_tdma, coex_dm->ps_tdma_du_adj_type); @@ -2802,8 +2821,6 @@ void halbtc8821a2ant_action_sco(IN struct btc_coexist *btcoexist) } } - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); /* for voice quality */ @@ -2843,6 +2860,8 @@ void halbtc8821a2ant_action_hid(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state, bt_rssi_state; u32 wifi_bw; + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, @@ -2866,9 +2885,6 @@ void halbtc8821a2ant_action_hid(IN struct btc_coexist *btcoexist) else /* for HID quality & wifi performance balance at 11n mode */ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 24); /* sw mechanism */ @@ -2921,8 +2937,6 @@ void halbtc8821a2ant_action_a2dp(IN struct btc_coexist *btcoexist) if ((ap_num >= 10) && BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { /* dbg_print(" AP#>10(%d)\n", ap_num); */ - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); @@ -2933,10 +2947,8 @@ void halbtc8821a2ant_action_a2dp(IN struct btc_coexist *btcoexist) halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - /* halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); + halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); + /* halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); */ /* sw mechanism */ btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); @@ -2965,19 +2977,13 @@ void halbtc8821a2ant_action_a2dp(IN struct btc_coexist *btcoexist) else halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); } else { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); } - if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, false, 1); */ @@ -3043,13 +3049,9 @@ void halbtc8821a2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); } else { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); } halbtc8821a2ant_tdma_duration_adjust(btcoexist, false, true, 2); @@ -3111,13 +3113,9 @@ void halbtc8821a2ant_action_pan_edr(IN struct btc_coexist *btcoexist) if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 10); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); } else { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); } if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || @@ -3184,8 +3182,6 @@ void halbtc8821a2ant_action_pan_hs(IN struct btc_coexist *btcoexist) halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); @@ -3242,13 +3238,6 @@ void halbtc8821a2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) else halbtc8821a2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); - else - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || @@ -3303,6 +3292,8 @@ void halbtc8821a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; u32 wifi_bw; + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, @@ -3320,13 +3311,9 @@ void halbtc8821a2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); } else { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); } if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || @@ -3389,6 +3376,8 @@ void halbtc8821a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) u8 wifi_rssi_state, wifi_rssi_state1, bt_rssi_state; u32 wifi_bw; + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); wifi_rssi_state1 = halbtc8821a2ant_wifi_rssi_state(btcoexist, 1, 2, @@ -3409,13 +3398,9 @@ void halbtc8821a2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); } else { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); } btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); @@ -3467,6 +3452,8 @@ void halbtc8821a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) u32 wifi_bw; u8 ap_num = 0; + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + wifi_rssi_state = halbtc8821a2ant_wifi_rssi_state(btcoexist, 0, 2, 15, 0); /* bt_rssi_state = halbtc8821a2ant_bt_rssi_state(2, 29, 0); */ @@ -3477,7 +3464,7 @@ void halbtc8821a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); - halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x5); + halbtc8821a2ant_limited_rx(btcoexist, NORMAL_EXEC, false, true, 0x6); halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); @@ -3508,23 +3495,20 @@ void halbtc8821a2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) } if (BTC_RSSI_HIGH(wifi_rssi_state1) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, - 0x0, 0x0); + halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 18); } else { halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 14); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); + 18); } if ((bt_rssi_state == BTC_RSSI_STATE_HIGH) || (bt_rssi_state == BTC_RSSI_STATE_STAY_HIGH)) { /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, false, 3); */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); + halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 28); } else { /* halbtc8821a2ant_tdma_duration_adjust(btcoexist, true, true, 3); */ - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 23); + halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 28); } /* sw mechanism */ @@ -3565,9 +3549,6 @@ void halbtc8821a2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); } @@ -3585,8 +3566,6 @@ void halbtc8821a2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff, 0x0); */ halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821a2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); halbtc8821a2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 1); } @@ -3643,8 +3622,6 @@ void halbtc8821a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); halbtc8821a2ant_action_bt_inquiry(btcoexist); return; - } else { - } btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); @@ -3682,11 +3659,10 @@ void halbtc8821a2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) halbtc8821a2ant_action_wifi_multi_port(btcoexist); return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); } + miracast_plus_bt = false; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); coex_dm->cur_algorithm = algorithm; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", @@ -3798,6 +3774,19 @@ void halbtc8821a2ant_wifi_off_hw_cfg(IN struct btc_coexist *btcoexist) btcoexist->btc_write_1byte(btcoexist, 0x765, 0x18); } +void halbtc8821a2ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + /* force to reset coex mechanism */ + halbtc8821a2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8821a2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 1); + halbtc8821a2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 6); + halbtc8821a2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 0); + + halbtc8821a2ant_sw_mechanism1(btcoexist, false, false, false, false); + halbtc8821a2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); +} + void halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, IN boolean back_up) { @@ -3808,6 +3797,13 @@ void halbtc8821a2ant_init_hw_config(IN struct btc_coexist *btcoexist, "[BTCoex], 2Ant Init HW Config!!\n"); BTC_TRACE(trace_buf); + /* Give bt_coex_supported_version the default value */ + coex_sta->bt_coex_supported_version = 0; + + /* 0xf0[15:12] --> Chip Cut information */ + coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, + 0xf1) & 0xf0) >> 4; + /* backup rf 0x1e value */ coex_dm->bt_rf_0x1e_backup = btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1e, 0xfffff); @@ -3849,7 +3845,7 @@ void ex_halbtc8821a2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) struct btc_board_info *board_info = &btcoexist->board_info; u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ - /* */ + /* */ /* S0 or S1 setting and Local register setting(By the setting fw can get ant number, S0/S1, ... info) */ /* Local setting bit define */ /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ @@ -3899,8 +3895,10 @@ void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist) u8 *cli_buf = btcoexist->cli_buf; u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; u32 u32tmp[4]; - u32 fa_of_dm, fa_cck; u32 fw_ver = 0, bt_patch_ver = 0; + u32 bt_coex_ver = 0; + u32 phyver = 0; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -3920,13 +3918,28 @@ void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist) board_info->pg_ant_num, board_info->btdm_ant_num); CL_PRINTF(cli_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + /* btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); */ + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + bt_coex_ver = coex_sta->bt_coex_supported_version & 0xff; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", - "CoexVer/ FwVer/ PatchVer", - glcoex_ver_date_8821a_2ant, glcoex_ver_8821a_2ant, fw_ver, - bt_patch_ver, bt_patch_ver); + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8821a_2ant, glcoex_ver_8821a_2ant, + glcoex_ver_btdesired_8821a_2ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (bt_coex_ver >= glcoex_ver_btdesired_8821a_2ant ? + "Match" : "Mis-Match"))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", @@ -4086,35 +4099,31 @@ void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist) u32tmp[0] & 0xff, u8tmp[0]); CL_PRINTF(cli_buf); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); - u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - - fa_of_dm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) - >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + \ - ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & - 0xffff) ; - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "OFDM-CCA/OFDM-FA/CCK-FA", - u32tmp[0] & 0xffff, fa_of_dm, fa_cck); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11n-Agg", + "CRC_OK CCK/11g/11n/11n-agg", coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_Err CCK/11g/11n/11n-Agg", + "CRC_Err CCK/11g/11n/11n-agg", coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); CL_PRINTF(cli_buf); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); @@ -4202,6 +4211,31 @@ void ex_halbtc8821a2ant_scan_notify(IN struct btc_coexist *btcoexist, BTC_TRACE(trace_buf); } +/* copy scan notify content to switch band notify */ +void ex_halbtc8821a2ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 u8tmpa, u8tmpb; + + u8tmpa = btcoexist->btc_read_1byte(btcoexist, 0x765); + u8tmpb = btcoexist->btc_read_1byte(btcoexist, 0x76e); + + if (BTC_SCAN_START == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify\n"); + BTC_TRACE(trace_buf); + } else if (BTC_SCAN_FINISH == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN FINISH notify\n"); + BTC_TRACE(trace_buf); + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], 0x765=0x%x, 0x76e=0x%x\n", u8tmpa, + u8tmpb); + BTC_TRACE(trace_buf); +} + void ex_halbtc8821a2ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type) { @@ -4498,7 +4532,7 @@ void ex_halbtc8821a2ant_halt_notify(IN struct btc_coexist *btcoexist) halbtc8821a2ant_wifi_off_hw_cfg(btcoexist); /* remove due to interrupt is disabled that polling c2h will fail and delay 100ms. */ - /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); //BT goto standby while GNT_BT 1-->0 */ + /* btcoexist->btc_set_bt_reg(btcoexist, BTC_BT_REG_RF, 0x3c, 0x15); */ /*BT goto standby while GNT_BT 1-->0 */ halbtc8821a2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); ex_halbtc8821a2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); @@ -4526,6 +4560,8 @@ void ex_halbtc8821a2ant_pnp_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist) { + u32 bt_patch_ver; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ==========================Periodical===========================\n"); BTC_TRACE(trace_buf); @@ -4542,12 +4578,20 @@ void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist) } } + if (((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) && (!coex_sta->bt_disabled)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, &coex_sta->bt_coex_supported_version); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + #if (BT_AUTO_REPORT_ONLY_8821A_2ANT == 0) halbtc8821a2ant_query_bt_info(btcoexist); halbtc8821a2ant_monitor_bt_enable_disable(btcoexist); #else halbtc8821a2ant_monitor_bt_ctr(btcoexist); halbtc8821a2ant_monitor_wifi_ctr(btcoexist); + halbtc8821a2ant_monitor_bt_enable_disable(btcoexist); if (halbtc8821a2ant_is_wifi_status_changed(btcoexist) || coex_dm->auto_tdma_adjust) @@ -4557,4 +4601,4 @@ void ex_halbtc8821a2ant_periodical(IN struct btc_coexist *btcoexist) #endif -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ \ No newline at end of file +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a2Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a2ant.h similarity index 87% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a2Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a2ant.h index 73252dd1fb9c..d76f566f966b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8821a2Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821a2ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -139,17 +153,19 @@ struct coex_sta_8821a_2ant { boolean c2h_bt_inquiry_page; u8 bt_retry_cnt; u8 bt_info_ext; - + u8 scan_ap_num; u32 crc_ok_cck; u32 crc_ok_11g; u32 crc_ok_11n; - u32 crc_ok_11n_agg; + u32 crc_ok_11n_vht; u32 crc_err_cck; u32 crc_err_11g; u32 crc_err_11n; - u32 crc_err_11n_agg; + u32 crc_err_11n_vht; + u32 bt_coex_supported_version; + u8 cut_version; u8 coex_table_type; boolean force_lps_on; @@ -170,6 +186,8 @@ void ex_halbtc8821a2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821a2ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type); +void ex_halbtc8821a2ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type); void ex_halbtc8821a2ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821a2ant_media_status_notify(IN struct btc_coexist *btcoexist, @@ -192,6 +210,7 @@ void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist); #define ex_halbtc8821a2ant_ips_notify(btcoexist, type) #define ex_halbtc8821a2ant_lps_notify(btcoexist, type) #define ex_halbtc8821a2ant_scan_notify(btcoexist, type) +#define ex_halbtc8821a2ant_switchband_notify(btcoexist, type) #define ex_halbtc8821a2ant_connect_notify(btcoexist, type) #define ex_halbtc8821a2ant_media_status_notify(btcoexist, type) #define ex_halbtc8821a2ant_specific_packet_notify(btcoexist, type) @@ -203,3 +222,4 @@ void ex_halbtc8821a2ant_display_coex_info(IN struct btc_coexist *btcoexist); #endif #endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.c index 3e722d4aa06f..0abc5a1c77e0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.c @@ -1,5979 +1,5613 @@ -/* ************************************************************ - * Description: - * - * This file is for RTL8821C Co-exist mechanism - * - * History - * 2012/11/15 Cosa first check in. - * - * ************************************************************ */ - -/* ************************************************************ - * include files - * ************************************************************ */ -#include "Mp_Precomp.h" - -#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) - -#if (RTL8821C_SUPPORT == 1) -/* ************************************************************ - * Global variables, these are static variables - * ************************************************************ */ -static u8 *trace_buf = &gl_btc_trace_buf[0]; -static struct coex_dm_8821c_1ant glcoex_dm_8821c_1ant; -static struct coex_dm_8821c_1ant *coex_dm = &glcoex_dm_8821c_1ant; -static struct coex_sta_8821c_1ant glcoex_sta_8821c_1ant; -static struct coex_sta_8821c_1ant *coex_sta = &glcoex_sta_8821c_1ant; -static struct psdscan_sta_8821c_1ant gl_psd_scan_8821c_1ant; -static struct psdscan_sta_8821c_1ant *psd_scan = &gl_psd_scan_8821c_1ant; -static struct rfe_type_8821c_1ant gl_rfe_type_8821c_1ant; -static struct rfe_type_8821c_1ant *rfe_type = &gl_rfe_type_8821c_1ant; - - -const char *const glbt_info_src_8821c_1ant[] = { - "BT Info[wifi fw]", - "BT Info[bt rsp]", - "BT Info[bt auto report]", -}; - -u32 glcoex_ver_date_8821c_1ant = 20160316; -u32 glcoex_ver_8821c_1ant = 0x00; - -/* ************************************************************ - * local function proto type if needed - * ************************************************************ - * ************************************************************ - * local function start with halbtc8821c1ant_ - * ************************************************************ */ -u8 halbtc8821c1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) -{ - s32 bt_rssi = 0; - u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; - - bt_rssi = coex_sta->bt_rssi; - - if (level_num == 2) { - if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Rssi thresh error!!\n"); - BTC_TRACE(trace_buf); - return coex_sta->pre_bt_rssi_state; - } - - if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_LOW)) { - if (bt_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_MEDIUM) || - (coex_sta->pre_bt_rssi_state == - BTC_RSSI_STATE_STAY_MEDIUM)) { - if (bt_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) - bt_rssi_state = BTC_RSSI_STATE_HIGH; - else if (bt_rssi < rssi_thresh) - bt_rssi_state = BTC_RSSI_STATE_LOW; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (bt_rssi < rssi_thresh1) - bt_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - coex_sta->pre_bt_rssi_state = bt_rssi_state; - - return bt_rssi_state; -} - -u8 halbtc8821c1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, - IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) -{ - s32 wifi_rssi = 0; - u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; - - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - - if (level_num == 2) { - if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) - || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else { - if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } else if (level_num == 3) { - if (rssi_thresh > rssi_thresh1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi RSSI thresh error!!\n"); - BTC_TRACE(trace_buf); - return coex_sta->pre_wifi_rssi_state[index]; - } - - if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) - || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_LOW)) { - if (wifi_rssi >= (rssi_thresh + - BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; - } else if ((coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_MEDIUM) || - (coex_sta->pre_wifi_rssi_state[index] == - BTC_RSSI_STATE_STAY_MEDIUM)) { - if (wifi_rssi >= (rssi_thresh1 + - BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) - wifi_rssi_state = BTC_RSSI_STATE_HIGH; - else if (wifi_rssi < rssi_thresh) - wifi_rssi_state = BTC_RSSI_STATE_LOW; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; - } else { - if (wifi_rssi < rssi_thresh1) - wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; - else - wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; - } - } - - coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; - - return wifi_rssi_state; -} - -void halbtc8821c1ant_update_ra_mask(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 dis_rate_mask) -{ - coex_dm->cur_ra_mask = dis_rate_mask; - - if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) - btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, - &coex_dm->cur_ra_mask); - coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; -} - -void halbtc8821c1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - boolean wifi_under_b_mode = false; - - coex_dm->cur_arfr_type = type; - - if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { - switch (coex_dm->cur_arfr_type) { - case 0: /* normal mode */ - btcoexist->btc_write_4byte(btcoexist, 0x430, - coex_dm->backup_arfr_cnt1); - btcoexist->btc_write_4byte(btcoexist, 0x434, - coex_dm->backup_arfr_cnt2); - break; - case 1: - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - if (wifi_under_b_mode) { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x01010101); - } else { - btcoexist->btc_write_4byte(btcoexist, - 0x430, 0x0); - btcoexist->btc_write_4byte(btcoexist, - 0x434, 0x04030201); - } - break; - default: - break; - } - } - - coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; -} - -void halbtc8821c1ant_retry_limit(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_retry_limit_type = type; - - if (force_exec || - (coex_dm->pre_retry_limit_type != - coex_dm->cur_retry_limit_type)) { - switch (coex_dm->cur_retry_limit_type) { - case 0: /* normal mode */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - coex_dm->backup_retry_limit); - break; - case 1: /* retry limit=8 */ - btcoexist->btc_write_2byte(btcoexist, 0x42a, - 0x0808); - break; - default: - break; - } - } - - coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; -} - -void halbtc8821c1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - coex_dm->cur_ampdu_time_type = type; - - if (force_exec || - (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { - switch (coex_dm->cur_ampdu_time_type) { - case 0: /* normal mode */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - coex_dm->backup_ampdu_max_time); - break; - case 1: /* AMPDU timw = 0x38 * 32us */ - btcoexist->btc_write_1byte(btcoexist, 0x456, - 0x38); - break; - default: - break; - } - } - - coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; -} - -void halbtc8821c1ant_limited_tx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, - IN u8 retry_limit_type, IN u8 ampdu_time_type) -{ - switch (ra_mask_type) { - case 0: /* normal mode */ - halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, - 0x0); - break; - case 1: /* disable cck 1/2 */ - halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, - 0x00000003); - break; - case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ - halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, - 0x0001f1f7); - break; - default: - break; - } - - halbtc8821c1ant_auto_rate_fallback_retry(btcoexist, force_exec, - arfr_type); - halbtc8821c1ant_retry_limit(btcoexist, force_exec, retry_limit_type); - halbtc8821c1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); -} - -void halbtc8821c1ant_limited_rx(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean rej_ap_agg_pkt, - IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) -{ - boolean reject_rx_agg = rej_ap_agg_pkt; - boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; - u8 rx_agg_size = agg_buf_size; - - /* ============================================ */ - /* Rx Aggregation related setting */ - /* ============================================ */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, - &reject_rx_agg); - /* decide BT control aggregation buf size or not */ - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, - &bt_ctrl_rx_agg_size); - /* aggregation buf size, only work when BT control Rx aggregation size. */ - btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); - /* real update aggregation setting */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); - - -} - -void halbtc8821c1ant_query_bt_info(IN struct btc_coexist *btcoexist) -{ - u8 h2c_parameter[1] = {0}; - - coex_sta->c2h_bt_info_req_sent = true; - - h2c_parameter[0] |= BIT(0); /* trigger */ - - btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WL query BT info!!\n"); - BTC_TRACE(trace_buf); -} - -void halbtc8821c1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) -{ - u32 reg_hp_txrx, reg_lp_txrx, u32tmp; - u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; - static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ - /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ - - reg_hp_txrx = 0x770; - reg_lp_txrx = 0x774; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); - reg_hp_tx = u32tmp & MASKLWORD; - reg_hp_rx = (u32tmp & MASKHWORD) >> 16; - - u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); - reg_lp_tx = u32tmp & MASKLWORD; - reg_lp_rx = (u32tmp & MASKHWORD) >> 16; - - coex_sta->high_priority_tx = reg_hp_tx; - coex_sta->high_priority_rx = reg_hp_rx; - coex_sta->low_priority_tx = reg_lp_tx; - coex_sta->low_priority_rx = reg_lp_rx; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", - reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); - - BTC_TRACE(trace_buf); - - /* reset counter */ - btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); - - if ((coex_sta->low_priority_tx > 1150) && - (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->pop_event_cnt++; - - if ((coex_sta->low_priority_rx >= 1150) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) - && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { - if (cnt_slave >= 3) { - bt_link_info->slave_role = true; - cnt_slave = 3; - } else - cnt_slave++; - } else { - if (cnt_slave == 0) { - bt_link_info->slave_role = false; - cnt_slave = 0; - } else - cnt_slave--; - - } - - if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && - (coex_sta->low_priority_rx == 0)) { - num_of_bt_counter_chk++; - if (num_of_bt_counter_chk >= 3) { - halbtc8821c1ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; - } - } - -#if 0 - /* Add Hi-Pri Tx/Rx counter to avoid false detection */ - if (((coex_sta->hid_exist) || (coex_sta->sco_exist)) && - (coex_sta->high_priority_tx + coex_sta->high_priority_rx - >= 160) - && (!coex_sta->c2h_bt_inquiry_page)) - coex_sta->bt_hi_pri_link_exist = true; - else - coex_sta->bt_hi_pri_link_exist = false; - - if ((coex_sta->acl_busy) && - (coex_sta->num_of_profile == 0)) { - if (coex_sta->low_priority_tx + - coex_sta->low_priority_rx >= 160) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - coex_sta->wrong_profile_notification++; - } - } -#endif - -} - - - -void halbtc8821c1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) -{ - s32 wifi_rssi = 0; - boolean wifi_busy = false, wifi_under_b_mode = false; - static u8 cck_lock_counter = 0; - u32 total_cnt; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - - if (coex_sta->under_ips) { - coex_sta->crc_ok_cck = 0; - coex_sta->crc_ok_11g = 0; - coex_sta->crc_ok_11n = 0; - coex_sta->crc_ok_11n_agg = 0; - - coex_sta->crc_err_cck = 0; - coex_sta->crc_err_11g = 0; - coex_sta->crc_err_11n = 0; - coex_sta->crc_err_11n_agg = 0; - } else { - coex_sta->crc_ok_cck = btcoexist->btc_read_2byte(btcoexist, - 0xf04); - coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf14); - coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf10); - coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xf0c); - - coex_sta->crc_err_cck = btcoexist->btc_read_2byte(btcoexist,0xf00) + btcoexist->btc_read_2byte(btcoexist,0xf06); - - coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf16); - coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf12); - coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xf0e); - } - - - /* reset counter */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xb58, 0x1, 0x0); - - if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { - total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + - coex_sta->crc_ok_11n + - coex_sta->crc_ok_11n_agg; - - if ((coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_BUSY) || - (coex_dm->bt_status == - BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY) || - (coex_dm->bt_status == - BT_8821C_1ANT_BT_STATUS_SCO_BUSY)) { - if (coex_sta->crc_ok_cck > (total_cnt - - coex_sta->crc_ok_cck)) { - if (cck_lock_counter < 3) - cck_lock_counter++; - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - } else { - if (cck_lock_counter > 0) - cck_lock_counter--; - } - - if (!coex_sta->pre_ccklock) { - - if (cck_lock_counter >= 3) - coex_sta->cck_lock = true; - else - coex_sta->cck_lock = false; - } else { - if (cck_lock_counter == 0) - coex_sta->cck_lock = false; - else - coex_sta->cck_lock = true; - } - - if (coex_sta->cck_lock) - coex_sta->cck_ever_lock = true; - - coex_sta->pre_ccklock = coex_sta->cck_lock; - - -} - -boolean halbtc8821c1ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) -{ - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false, pre_bt_off = false; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - if (coex_sta->bt_disabled != pre_bt_off) { - pre_bt_off = coex_sta->bt_disabled; - - if (coex_sta->bt_disabled) - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); - else - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); - - BTC_TRACE(trace_buf); - - coex_sta->bt_coex_supported_feature = 0; - coex_sta->bt_coex_supported_version = 0; - return true; - } - - if (wifi_connected) { - if (wifi_busy != pre_wifi_busy) { - pre_wifi_busy = wifi_busy; - return true; - } - if (under_4way != pre_under_4way) { - pre_under_4way = under_4way; - return true; - } - if (bt_hs_on != pre_bt_hs_on) { - pre_bt_hs_on = bt_hs_on; - return true; - } - } - - return false; -} - -void halbtc8821c1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - bt_link_info->bt_link_exist = coex_sta->bt_link_exist; - bt_link_info->sco_exist = coex_sta->sco_exist; - bt_link_info->a2dp_exist = coex_sta->a2dp_exist; - bt_link_info->pan_exist = coex_sta->pan_exist; - bt_link_info->hid_exist = coex_sta->hid_exist; - bt_link_info->bt_hi_pri_link_exist = coex_sta->bt_hi_pri_link_exist; - bt_link_info->acl_busy = coex_sta->acl_busy; - - /* work around for HS mode. */ - if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; - } - - /* check if Sco only */ - if (bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->sco_only = true; - else - bt_link_info->sco_only = false; - - /* check if A2dp only */ - if (!bt_link_info->sco_exist && - bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->a2dp_only = true; - else - bt_link_info->a2dp_only = false; - - /* check if Pan only */ - if (!bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - bt_link_info->pan_exist && - !bt_link_info->hid_exist) - bt_link_info->pan_only = true; - else - bt_link_info->pan_only = false; - - /* check if Hid only */ - if (!bt_link_info->sco_exist && - !bt_link_info->a2dp_exist && - !bt_link_info->pan_exist && - bt_link_info->hid_exist) - bt_link_info->hid_only = true; - else - bt_link_info->hid_only = false; -} - -void halbtc8821c1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - u8 h2c_parameter[3] = {0}; - u32 wifi_bw; - u8 wifi_central_chnl; - - /* only 2.4G we need to inform bt the chnl mask */ - btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, - &wifi_central_chnl); - if ((BTC_MEDIA_CONNECT == type) && - (wifi_central_chnl <= 14)) { - h2c_parameter[0] = - 0x1; /* enable BT AFH skip WL channel for 8821c because BT Rx LO interference */ - /* h2c_parameter[0] = 0x0; */ - h2c_parameter[1] = wifi_central_chnl; - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) - h2c_parameter[2] = 0x30; - else - h2c_parameter[2] = 0x20; - } - - coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; - coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; - coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); - -} - -u8 halbtc8821c1ant_action_algorithm(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; - u8 algorithm = BT_8821C_1ANT_COEX_ALGO_UNDEFINED; - u8 num_of_diff_profile = 0; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - - if (!bt_link_info->bt_link_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], No BT link exists!!!\n"); - BTC_TRACE(trace_buf); - return algorithm; - } - - if (bt_link_info->sco_exist) - num_of_diff_profile++; - if (bt_link_info->hid_exist) - num_of_diff_profile++; - if (bt_link_info->pan_exist) - num_of_diff_profile++; - if (bt_link_info->a2dp_exist) - num_of_diff_profile++; - - if (num_of_diff_profile == 1) { - if (bt_link_info->sco_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; - } else { - if (bt_link_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_HID; - } else if (bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = A2DP only\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_A2DP; - } else if (bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = PAN(HS) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = PAN(EDR) only\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANEDR; - } - } - } - } else if (num_of_diff_profile == 2) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_HID; - } else if (bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; - } else if (bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + A2DP\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_HID_A2DP; - } else if (bt_link_info->hid_exist && - bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; - } - } else if (bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP; - } - } - } - } else if (num_of_diff_profile == 3) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_HID; - } else if (bt_link_info->hid_exist && - bt_link_info->pan_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; - } - } else if (bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } else { - if (bt_link_info->hid_exist && - bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_HID_A2DP; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR; - } - } - } - } else if (num_of_diff_profile >= 3) { - if (bt_link_info->sco_exist) { - if (bt_link_info->hid_exist && - bt_link_info->pan_exist && - bt_link_info->a2dp_exist) { - if (bt_hs_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); - BTC_TRACE(trace_buf); - - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); - BTC_TRACE(trace_buf); - algorithm = - BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; - } - } - } - } - - return algorithm; -} - -void halbtc8821c1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean enable_auto_report) -{ - u8 h2c_parameter[1] = {0}; - - h2c_parameter[0] = 0; - - if (enable_auto_report) - h2c_parameter[0] |= BIT(0); - - btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); -} - -void halbtc8821c1ant_bt_auto_report(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable_auto_report) -{ - coex_dm->cur_bt_auto_report = enable_auto_report; - - if (!force_exec) { - if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) - return; - } - halbtc8821c1ant_set_bt_auto_report(btcoexist, - coex_dm->cur_bt_auto_report); - - coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; -} - -void halbtc8821c1ant_set_fw_low_penalty_ra(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ - u8 h2c_parameter[6] = {0}; - - h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ - - if (low_penalty_ra) { - h2c_parameter[1] |= BIT(0); - h2c_parameter[2] = - 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ - h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ - h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} - -void halbtc8821c1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean low_penalty_ra) -{ - coex_dm->cur_low_penalty_ra = low_penalty_ra; - - if (!force_exec) { - if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) - return; - } - halbtc8821c1ant_set_fw_low_penalty_ra(btcoexist, - coex_dm->cur_low_penalty_ra); - - coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; -} - -void halbtc8821c1ant_sw_mechanism(IN struct btc_coexist *btcoexist, - IN boolean low_penalty_ra) -{ - halbtc8821c1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -void halbtc8821c1ant_write_score_board( - IN struct btc_coexist *btcoexist, - IN u16 bitpos, - IN BOOLEAN state -) -{ - - static u16 originalval = 0x8002; - - if (state) - originalval = originalval | bitpos; - else - originalval = originalval & (~bitpos); - - btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); -} - -void halbtc8821c1ant_read_score_board( - IN struct btc_coexist *btcoexist, - IN u16 *score_board_val -) -{ - - *score_board_val = (btcoexist->btc_read_2byte(btcoexist, - 0xaa)) & 0x7fff; -} - -void halbtc8821c1ant_post_activestate_to_bt( - IN struct btc_coexist *btcoexist, - IN boolean wifi_active -) -{ - - if (wifi_active) - halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); - else - halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); -} - - -void halbtc8821c1ant_post_onoffstate_to_bt( - IN struct btc_coexist *btcoexist, - IN boolean wifi_on -) -{ - - if (wifi_on) - halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); - else - halbtc8821c1ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); -} - -void halbtc8821c1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) -{ - static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; - u16 u16tmp; - - /* This function check if bt is disabled */ -#if 0 - if (coex_sta->high_priority_tx == 0 && - coex_sta->high_priority_rx == 0 && - coex_sta->low_priority_tx == 0 && - coex_sta->low_priority_rx == 0) - bt_active = false; - if (coex_sta->high_priority_tx == 0xffff && - coex_sta->high_priority_rx == 0xffff && - coex_sta->low_priority_tx == 0xffff && - coex_sta->low_priority_rx == 0xffff) - bt_active = false; - - -#else - - /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ - halbtc8821c1ant_read_score_board(btcoexist, &u16tmp); - - bt_active = u16tmp & BIT(1); - - -#endif - - if (bt_active) { - bt_disable_cnt = 0; - bt_disabled = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - } else { - - bt_disable_cnt++; - if (bt_disable_cnt >= 2) { - bt_disabled = true; - bt_disable_cnt = 2; - } - - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, - &bt_disabled); - } - - - if (coex_sta->bt_disabled != bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is from %s to %s!!\n", - (coex_sta->bt_disabled ? "disabled" : "enabled"), - (bt_disabled ? "disabled" : "enabled")); - BTC_TRACE(trace_buf); - coex_sta->bt_disabled = bt_disabled; - } - -} - -void halbtc8821c1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, - boolean isenable) -{ - static u8 bitVal[5] = {0,0,0,0,0}; - static boolean state = false; - - if (state ==isenable) - return; - else - state = isenable; - - if (isenable) { - - /* enable GNT_WL, GNT_BT to GPIO for debug */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); - - /* store original value */ - bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ - bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ - bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ - bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ - bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ - - /* switch GPIO Mux */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ - - - } else { - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); - - /* Restore original value */ - /* switch GPIO Mux */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ - } - -} - -u32 halbtc8821c1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, - IN u16 reg_addr) -{ - u32 j = 0; - - - /* wait for ready bit before access 0x1700 */ - btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); - - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703)&BIT(5)) == 0) && - (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - return btcoexist->btc_read_4byte(btcoexist, - 0x1708); /* get read data */ - -} - -void halbtc8821c1ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, - IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) -{ - u32 val, i = 0, j = 0, bitpos = 0; - - - if (bit_mask == 0x0) - return; - if (bit_mask == 0xffffffff) { - btcoexist->btc_write_4byte(btcoexist, 0x1704, - reg_value); /* put write data */ - - /* wait for ready bit before access 0x1700 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703)&BIT(5)) == 0) && - (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x1700, - 0xc00F0000 | reg_addr); - } else { - for (i = 0; i <= 31; i++) { - if (((bit_mask >> i) & 0x1) == 0x1) { - bitpos = i; - break; - } - } - - /* read back register value before write */ - val = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - reg_addr); - val = (val & (~bit_mask)) | (reg_value << bitpos); - - btcoexist->btc_write_4byte(btcoexist, 0x1704, - val); /* put write data */ - - /* wait for ready bit before access 0x1700 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703)&BIT(5)) == 0) && - (j < BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - - btcoexist->btc_write_4byte(btcoexist, 0x1700, - 0xc00F0000 | reg_addr); - - } - -} - -void halbtc8821c1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 val; - - val = (enable) ? 1 : 0; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, - val); /* 0x38[7] */ - -} - -void halbtc8821c1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, - IN boolean wifi_control) -{ - u8 val; - - val = (wifi_control) ? 1 : 0; - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, - val); /* 0x70[26] */ - -} - -void halbtc8821c1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, - IN u8 control_block, IN boolean sw_control, IN u8 state) -{ - u32 val = 0, bit_mask; - - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; - - switch (control_block) { - case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: - default: - bit_mask = 0xc000; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ - bit_mask = 0x0c00; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ - break; - case BT_8821C_1ANT_GNT_BLOCK_RFC: - bit_mask = 0xc000; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ - break; - case BT_8821C_1ANT_GNT_BLOCK_BB: - bit_mask = 0x0c00; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ - break; - - } - -} - -void halbtc8821c1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, - IN u8 control_block, IN boolean sw_control, IN u8 state) -{ - u32 val = 0, bit_mask; - - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; - - switch (control_block) { - case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: - default: - bit_mask = 0x3000; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ - bit_mask = 0x0300; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ - break; - case BT_8821C_1ANT_GNT_BLOCK_RFC: - bit_mask = 0x3000; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ - break; - case BT_8821C_1ANT_GNT_BLOCK_BB: - bit_mask = 0x0300; - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ - break; - - } - -} - -void halbtc8821c1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, - IN u8 table_type, IN u16 table_content) -{ - u16 reg_addr = 0x0000; - - switch (table_type) { - case BT_8821C_1ANT_CTT_WL_VS_LTE: - reg_addr = 0xa0; - break; - case BT_8821C_1ANT_CTT_BT_VS_LTE: - reg_addr = 0xa4; - break; - } - - if (reg_addr != 0x0000) - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ - - -} - - -void halbtc8821c1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, - IN u8 table_type, IN u8 table_content) -{ - u16 reg_addr = 0x0000; - - switch (table_type) { - case BT_8821C_1ANT_LBTT_WL_BREAK_LTE: - reg_addr = 0xa8; - break; - case BT_8821C_1ANT_LBTT_BT_BREAK_LTE: - reg_addr = 0xac; - break; - case BT_8821C_1ANT_LBTT_LTE_BREAK_WL: - reg_addr = 0xb0; - break; - case BT_8821C_1ANT_LBTT_LTE_BREAK_BT: - reg_addr = 0xb4; - break; - } - - if (reg_addr != 0x0000) - halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, - 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ - - -} - -void halbtc8821c1ant_set_coex_table(IN struct btc_coexist *btcoexist, - IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) -{ - btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); - - btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); - - btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); - - btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); -} - -void halbtc8821c1ant_coex_table(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, - IN u32 val0x6c8, IN u8 val0x6cc) -{ - coex_dm->cur_val0x6c0 = val0x6c0; - coex_dm->cur_val0x6c4 = val0x6c4; - coex_dm->cur_val0x6c8 = val0x6c8; - coex_dm->cur_val0x6cc = val0x6cc; - - if (!force_exec) { - if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && - (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && - (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && - (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) - return; - } - - halbtc8821c1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, - val0x6cc); - - coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; - coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; - coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; - coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; -} - -void halbtc8821c1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 type) -{ - u32 break_table; - u8 select_table; - - coex_sta->coex_table_type = type; - - if (coex_sta->concurrent_rx_mode_on == true) { - break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ - select_table = - 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ - } else { - break_table = 0xffffff; - select_table = 0x3; - } - - switch (type) { - case 0: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x55555555, break_table, - select_table); - break; - case 1: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0x5a5a5a5a, break_table, - select_table); - break; - case 2: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0xaa5a5a5a, 0xaa5a5a5a, break_table, - select_table); - break; - case 3: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0xaa555555, 0xaa5a5a5a, break_table, - select_table); - break; - case 4: - halbtc8821c1ant_coex_table(btcoexist, - force_exec, 0xaa555555, 0xaa5a5a5a, - break_table, select_table); - break; - case 5: - halbtc8821c1ant_coex_table(btcoexist, - force_exec, 0x5a5a5a5a, 0x5a5a5a5a, - break_table, select_table); - break; - case 6: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaaaaa, break_table, - select_table); - break; - case 7: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, break_table, - select_table); - break; - case 8: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, - select_table); - break; - case 9: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, - select_table); - break; - case 10: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, - select_table); - break; - case 11: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, - select_table); - break; - case 12: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0x5ada5ada, break_table, - select_table); - break; - case 13: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0xaaaaaaaa, break_table, - select_table); - break; - case 14: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5ada5ada, break_table, - select_table); - break; - case 15: - halbtc8821c1ant_coex_table(btcoexist, force_exec, - 0x55dd55dd, 0xaaaaaaaa, break_table, - select_table); - break; - default: - break; - } -} - -void halbtc8821c1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean enable) -{ - u8 h2c_parameter[1] = {0}; - - if (enable) { - h2c_parameter[0] |= BIT(0); /* function enable */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); -} - -void halbtc8821c1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean enable) -{ - coex_dm->cur_ignore_wlan_act = enable; - - if (!force_exec) { - if (coex_dm->pre_ignore_wlan_act == - coex_dm->cur_ignore_wlan_act) - return; - } - halbtc8821c1ant_set_fw_ignore_wlan_act(btcoexist, enable); - - coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; -} - -void halbtc8821c1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, - IN u8 lps_val, IN u8 rpwm_val) -{ - u8 lps = lps_val; - u8 rpwm = rpwm_val; - - btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); - btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); -} - -void halbtc8821c1ant_lps_rpwm(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) -{ - coex_dm->cur_lps = lps_val; - coex_dm->cur_rpwm = rpwm_val; - - if (!force_exec) { - if ((coex_dm->pre_lps == coex_dm->cur_lps) && - (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) - return; - } - halbtc8821c1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); - - coex_dm->pre_lps = coex_dm->cur_lps; - coex_dm->pre_rpwm = coex_dm->cur_rpwm; -} - -void halbtc8821c1ant_ps_tdma_check_for_power_save_state( - IN struct btc_coexist *btcoexist, IN boolean new_ps_state) -{ - u8 lps_mode = 0x0; - u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); - - if (lps_mode) { /* already under LPS state */ - if (new_ps_state) { - /* keep state under LPS, do nothing. */ - } else { - /* will leave LPS state, turn off psTdma first */ - /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); */ - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); - } - } else { /* NO PS state */ - if (new_ps_state) { - /* will enter LPS state, turn off psTdma first */ - /*halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8);*/ - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); - } else { - /* keep state under NO PS state, do nothing. */ - } - } -} - -void halbtc8821c1ant_power_save_state(IN struct btc_coexist *btcoexist, - IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) -{ - boolean low_pwr_disable = false; - - switch (ps_type) { - case BTC_PS_WIFI_NATIVE: - /* recover to original 32k low power setting */ - coex_sta->force_lps_on = false; - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, - NULL); - - break; - case BTC_PS_LPS_ON: - coex_sta->force_lps_on = true; - halbtc8821c1ant_ps_tdma_check_for_power_save_state( - btcoexist, true); - halbtc8821c1ant_lps_rpwm(btcoexist, NORMAL_EXEC, - lps_val, rpwm_val); - /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; - btcoexist->btc_set(btcoexist, - BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - /* power save must executed before psTdma. */ - btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, - NULL); - - break; - case BTC_PS_LPS_OFF: - coex_sta->force_lps_on = false; - halbtc8821c1ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, - NULL); - - break; - default: - break; - } -} - - -void halbtc8821c1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, - IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) -{ - u8 h2c_parameter[5] = {0}; - u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], FW for 1Ant AP mode\n"); - BTC_TRACE(trace_buf); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); - - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); - - halbtc8821c1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - - halbtc8821c1ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); - } else { - halbtc8821c1ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } - - - h2c_parameter[0] = real_byte1; - h2c_parameter[1] = byte2; - h2c_parameter[2] = byte3; - h2c_parameter[3] = byte4; - h2c_parameter[4] = real_byte5; - - coex_dm->ps_tdma_para[0] = real_byte1; - coex_dm->ps_tdma_para[1] = byte2; - coex_dm->ps_tdma_para[2] = byte3; - coex_dm->ps_tdma_para[3] = byte4; - coex_dm->ps_tdma_para[4] = real_byte5; - - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); -} - - -void halbtc8821c1ant_ps_tdma(IN struct btc_coexist *btcoexist, - IN boolean force_exec, IN boolean turn_on, IN u8 type) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - struct btc_board_info *board_info = &btcoexist->board_info; - boolean wifi_busy = false; - static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; - static boolean pre_wifi_busy = false; - - -#if BT_8821C_1ANT_ANTDET_ENABLE -#if BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE - if (board_info->btdm_ant_num_by_ant_det == 2) { - if (turn_on) - type = type + - 100; /* for WiFi RSSI low or BT RSSI low */ - } - -#endif -#endif - - coex_dm->cur_ps_tdma_on = turn_on; - coex_dm->cur_ps_tdma = type; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (wifi_busy != pre_wifi_busy) { - force_exec = true; - pre_wifi_busy = wifi_busy; - } - - /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ - if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) - psTdmaByte4Modify = 0x1; - else - psTdmaByte4Modify = 0x0; - - if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { - - force_exec = true; - pre_psTdmaByte4Modify = psTdmaByte4Modify; - } - - if (!force_exec) { - if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && - (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) - return; - } - - if (coex_dm->cur_ps_tdma_on) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** TDMA(on, %d) **********\n", - coex_dm->cur_ps_tdma); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** TDMA(off, %d) **********\n", - coex_dm->cur_ps_tdma); - BTC_TRACE(trace_buf); - } - - - if (turn_on) { - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, - 0x1); /* enable TBTT nterrupt */ - - switch (type) { - default: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); - break; - - case 3: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x3a, 0x03, 0x10, 0x10); - break; - case 4: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x21, 0x03, 0x10, 0x10); - break; - case 5: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x11); - break; - case 6: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x20, 0x03, 0x11, 0x11); - break; - case 7: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); - break; - case 8: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x10, 0x03, 0x10, 0x14 | psTdmaByte4Modify); - break; - case 13: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x25, 0x03, 0x10, 0x10 | psTdmaByte4Modify); - break; - case 14: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x15, 0x03, 0x10, 0x10 | psTdmaByte4Modify); - break; - case 15: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x51, 0x20, 0x03, 0x10, 0x10 | psTdmaByte4Modify); - break; - case 17: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x10, 0x03, 0x11, 0x14 | psTdmaByte4Modify); - break;; - case 19: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x15, 0x03, 0x11, 0x10); - break; - case 20: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 21: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x30, 0x03, 0x11, 0x10); - break; - case 22: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x25, 0x03, 0x11, 0x10); - break; - case 32: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x11); - break; - case 33: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0x61, 0x35, 0x03, 0x11, 0x10); - break; - - /* 1-Ant to 2-Ant TDMA case */ - case 103: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x3a, 0x03, 0x70, 0x10); - break; - case 104: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x21, 0x03, 0x70, 0x10); - break; - case 105: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x15, 0x03, 0x71, 0x11); - break; - case 106: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x20, 0x03, 0x71, 0x11); - break; - case 107: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x10, 0x03, 0x70, 0x14 | psTdmaByte4Modify); - break; - case 108: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x10, 0x03, 0x70, 0x14 | psTdmaByte4Modify); - break; - case 113: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x25, 0x03, 0x70, 0x10 | psTdmaByte4Modify); - break; - case 114: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x15, 0x03, 0x70, 0x10 | psTdmaByte4Modify); - break; - case 115: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xd3, 0x20, 0x03, 0x70, 0x10 | psTdmaByte4Modify); - break; - case 117: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x10, 0x03, 0x71, 0x14 | psTdmaByte4Modify); - break;; - case 119: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x15, 0x03, 0x71, 0x10); - break; - case 120: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x30, 0x03, 0x71, 0x10); - break; - case 121: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x30, 0x03, 0x71, 0x10); - break; - case 122: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x25, 0x03, 0x71, 0x10); - break; - case 132: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x35, 0x03, 0x71, 0x11); - break; - case 133: - halbtc8821c1ant_set_fw_pstdma(btcoexist, - 0xe3, 0x35, 0x03, 0x71, 0x10); - break; - - } - } else { - - /* disable PS tdma */ - switch (type) { - case 8: /* PTA Control */ - halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x8, - 0x0, 0x0, 0x0, 0x0); - break; - case 0: - default: /* Software control, Antenna at BT side */ - halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x0, 0x0); - break; - case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ - halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, - 0x0, 0x0, 0x48, 0x0); - break; - } - } - - /* update pre state */ - coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; - coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; -} - -void halbtc8821c1ant_set_int_block(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) -{ - u8 regval_0xcba; - u32 u32tmp1 = 0; - - coex_dm->cur_int_block_status = pos_type; - - if (!force_exec) { - if (coex_dm->pre_int_block_status == coex_dm->cur_int_block_status) - return; - } - - coex_dm->pre_int_block_status = coex_dm->cur_int_block_status; - - regval_0xcba = btcoexist->btc_read_1byte(btcoexist, 0xcba); - - switch(pos_type){ - - case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: - regval_0xcba = regval_0xcba & (~(BIT(2)) ) | BIT(0); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ - break; - case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: - regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ - regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ - regval_0xcba = regval_0xcba & (~(BIT(7)) ) | BIT(6); /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ - - break; - case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: - regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ - regval_0xcba = regval_0xcba & (~(BIT(5))) | BIT(4); /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ - regval_0xcba = regval_0xcba | BIT(6) | BIT(7); /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ - - break; - } - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, regval_0xcba); - - u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb8); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Int Block setup) 0xcb8 = 0x%08x **********\n", - u32tmp1); - BTC_TRACE(trace_buf); - -} - -void halbtc8821c1ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) -{ - -#if 0 - boolean switch_polatiry_inverse = false; - u8 regval_0xcb6; - u32 u32tmp1 = 0, u32tmp2 = 0; - - if (!rfe_type->ext_band_switch_exist) - return; - - coex_dm->cur_ext_band_switch_status = pos_type; - - if (!force_exec) { - if (coex_dm->pre_ext_band_switch_status == coex_dm->cur_ext_band_switch_status) - return; - } - - coex_dm->pre_ext_band_switch_status = coex_dm->cur_ext_band_switch_status; - - /* swap control polarity if use different switch control polarity*/ - switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); - - /*swap control polarity for WL_A, default polarity 0xcb4[21] = 0 && 0xcb4[23] = 1 is for WL_G */ - switch_polatiry_inverse = (pos_type == BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLA? ~switch_polatiry_inverse: switch_polatiry_inverse); - - regval_0xcb6 = btcoexist->btc_read_1byte(btcoexist, 0xcb6); - - /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ - regval_0xcb6 = (switch_polatiry_inverse == 1? ( (regval_0xcb6 & (~(BIT(7))) ) | BIT(5)) : ( (regval_0xcb6 & (~(BIT(5))) ) | BIT(7)) ); - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, regval_0xcb6); - - u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb0); - u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ext Band switch setup) 0xcb0 = 0x%08x, 0xcb4 = 0x%08x**********\n", - u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); -#endif - -} - -void halbtc8821c1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - boolean switch_polatiry_inverse = false; - u8 regval_0xcb7 = 0, regval_0x64; - u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - - if (!rfe_type->ext_ant_switch_exist) - return; - - coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; - - if (!force_exec) { - if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) - return; - } - - coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; - - /* swap control polarity if use different switch control polarity*/ - /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ - /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ - switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); - - /* swap control polarity if 1-Ant at Aux */ - if ( (rfe_type->ext_ant_switch_type == BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT) && (board_info->single_ant_path == 0) ) - switch_polatiry_inverse = ~switch_polatiry_inverse; - - switch(pos_type) - { - default: - case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT: - case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE: - - break; - case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG: - switch_polatiry_inverse = (rfe_type->wlg_Locate_at_btg == 0? ~switch_polatiry_inverse: switch_polatiry_inverse); - break; - case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA: - /*switch_polatiry_inverse = (rfe_type->ext_band_switch_exist == 1? ~switch_polatiry_inverse: switch_polatiry_inverse);*/ - break; - } - - - switch(ctrl_type) - { - default: - case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ - - regval_0xcb7 = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); - - break; - case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ - - regval_0xcb7 = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); - - break; - case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ - - /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ - - break; - case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ - - regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); - break; - case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ - - /* no setup required, because antenna switch control value by BT vendor 0xac[1:0] */ - break; - } - - u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", - u32tmp1, u32tmp2, u32tmp3); - BTC_TRACE(trace_buf); - - -} - -void halbtc8821c1ant_set_rfe_type(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - -#if 0 - rfe_type->ext_band_switch_exist = false; - rfe_type->ext_band_switch_type = BT_8821C_1ANT_EXT_BAND_SWITCH_USE_SPDT; // SPDT; - rfe_type->ext_band_switch_ctrl_polarity = 0; - - if (rfe_type->ext_band_switch_exist) { - - /* band switch use RFE_ctrl1 (pin name: PAPE_A) and RFE_ctrl3 (pin name: LNAON_A) */ - - /* set RFE_ctrl1 as software control */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); - - /* set RFE_ctrl3 as software control */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); - - } -#endif - - /* the following setup should be got from Efuse in the future */ - rfe_type->rfe_module_type = board_info->rfe_type; - - rfe_type->ext_ant_switch_ctrl_polarity = 0; - rfe_type->ext_ant_switch_diversity = false; - - switch(rfe_type->rfe_module_type) - { - case 0: - default: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ - rfe_type->wlg_Locate_at_btg = false; - rfe_type->ext_ant_switch_diversity = true; - break; - case 1: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ - rfe_type->wlg_Locate_at_btg = false; - break; - case 2: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ - rfe_type->wlg_Locate_at_btg = true; - break; - case 3: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ - rfe_type->wlg_Locate_at_btg = false; - break; - case 4: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */; - rfe_type->wlg_Locate_at_btg = true; - break; - case 5: - rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ - rfe_type->wlg_Locate_at_btg = false; - - } - - - if (rfe_type->wlg_Locate_at_btg) - halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); - else - halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); - - -} - - -void halbtc8821c1ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean force_exec, - IN u8 phase ) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u32 cnt_bt_cal_chk = 0; - boolean is_in_mp_mode = false; - u8 u8tmp = 0; - u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - u16 u16tmp1 = 0; - -#if BT_8821C_1ANT_ANTDET_ENABLE -#if BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE - if (ant_pos_type == BTC_ANT_PATH_PTA) { - if ((board_info->btdm_ant_det_finish) && - (board_info->btdm_ant_num_by_ant_det == 2)) { - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_PATH_WIFI; - else - ant_pos_type = BTC_ANT_PATH_BT; - } - } -#endif -#endif - - coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; - - if (!force_exec) { - if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) - return; - } - - coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; - -#if 1 - u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0x38); - u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0x54); - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); - - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u32tmp3, u8tmp, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); -#endif - - - switch (phase) - { - case BT_8821C_1ANT_PHASE_COEX_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_1ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_1ANT_CTT_BT_VS_LTE, 0xffff); - - /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ - while (cnt_bt_cal_chk <= 20) { - u8tmp = btcoexist->btc_read_1byte(btcoexist, - 0x49d); - cnt_bt_cal_chk++; - if (u8tmp & BIT(0)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", - cnt_bt_cal_chk); - BTC_TRACE(trace_buf); - delay_ms(50); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", - cnt_bt_cal_chk); - BTC_TRACE(trace_buf); - break; - } - } - - /* set Path control owner to WL at initial step */ - halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_1ANT_PCO_WLSIDE); - - /* set GNT_BT to SW high */ - halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to SW low */ - halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_LOW); - - coex_sta->run_time_state = false; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_BT; - - break; - case BT_8821C_1ANT_PHASE_WLANONLY_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_1ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c1ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_1ANT_CTT_BT_VS_LTE, 0xffff); - - /* set Path control owner to WL at initial step */ - halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_1ANT_PCO_WLSIDE); - - /* set GNT_BT to SW Low */ - halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_LOW); - /* Set GNT_WL to SW high */ - halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - - coex_sta->run_time_state = false; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_WIFI; - - break; - case BT_8821C_1ANT_PHASE_WLAN_OFF: - /* Disable LTE Coex Function in WiFi side */ - halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); - - /* set Path control owner to BT */ - halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_1ANT_PCO_BTSIDE); - - /* Set Ext Ant Switch to BT control at wifi off step */ - halbtc8821c1ant_set_ext_ant_switch(btcoexist, - FORCE_EXEC, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); - - coex_sta->run_time_state = false; - break; - case BT_8821C_1ANT_PHASE_2G_RUNTIME: - - /* set Path control owner to WL at runtime step */ - halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_1ANT_PCO_WLSIDE); - - /* set GNT_BT to PTA */ - halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8821C_1ANT_SIG_STA_SET_BY_HW); - - if (rfe_type->wlg_Locate_at_btg) /* Set GNT_WL to PTA */ - halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8821C_1ANT_SIG_STA_SET_BY_HW); - else /* Set GNT_WL to SW High */ - halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - - coex_sta->run_time_state = true; - - if (BTC_ANT_PATH_AUTO == ant_pos_type){ - if (rfe_type->wlg_Locate_at_btg) - ant_pos_type = BTC_ANT_PATH_WIFI; - else - ant_pos_type = BTC_ANT_PATH_PTA; - } - - if (rfe_type->wlg_Locate_at_btg) - halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); - else - halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); - - break; - case BT_8821C_1ANT_PHASE_5G_RUNTIME: - - /* set Path control owner to WL at runtime step */ - halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_1ANT_PCO_WLSIDE); - - /* set GNT_BT to SW Hi */ - halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - - /* Set GNT_WL to SW Hi */ - halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - - coex_sta->run_time_state = true; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) { - /* if (rfe_type->ext_band_switch_exist) - ant_pos_type = BTC_ANT_PATH_PTA; - else */ - ant_pos_type = BTC_ANT_PATH_WIFI5G; - } - - halbtc8821c1ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); - - break; - case BT_8821C_1ANT_PHASE_BTMPMODE: - /* Disable LTE Coex Function in WiFi side */ - halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); - - /* set Path control owner to WL */ - halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_1ANT_PCO_WLSIDE); - - /* set GNT_BT to SW Hi */ - halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - - /* Set GNT_WL to SW Lo */ - halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_LOW); - - coex_sta->run_time_state = false; - - /* Set Ext Ant Switch to BT side at BT MP mode */ - if (BTC_ANT_PATH_AUTO == ant_pos_type) - ant_pos_type = BTC_ANT_PATH_BT; - - break; - } - - if (phase != BT_8821C_1ANT_PHASE_WLAN_OFF) - { - switch (ant_pos_type) { - case BTC_ANT_PATH_WIFI: - halbtc8821c1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG); - break; - case BTC_ANT_PATH_WIFI5G: - halbtc8821c1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA); - break; - case BTC_ANT_PATH_BT: - halbtc8821c1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT); - break; - default: - case BTC_ANT_PATH_PTA: - halbtc8821c1ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); - break; - } - - } -#if 1 - u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); - - BTC_TRACE(trace_buf); -#endif -} - - -boolean halbtc8821c1ant_is_common_action(IN struct btc_coexist *btcoexist) -{ - boolean common = false, wifi_connected = false, wifi_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (!wifi_connected && - BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT non connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (wifi_connected && - (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT connected-idle!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else if (!wifi_connected && - (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE != coex_dm->bt_status)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); - BTC_TRACE(trace_buf); - - /* halbtc8821c1ant_sw_mechanism(btcoexist, false); */ - - common = true; - } else { - if (wifi_busy) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); - BTC_TRACE(trace_buf); - } - - common = false; - } - - return common; -} - - -/* ********************************************* - * - * Software Coex Mechanism start - * - * ********************************************* */ - -/* SCO only or SCO+PAN(HS) */ - -/* -void halbtc8821c1ant_action_sco(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8821c1ant_action_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8821c1ant_action_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8821c1ant_action_a2dp_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8821c1ant_action_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8821c1ant_action_pan_hs(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, false); -} - - -void halbtc8821c1ant_action_pan_edr_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, false); -} - -void halbtc8821c1ant_action_pan_edr_hid(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, true); -} - - -void halbtc8821c1ant_action_hid_a2dp_pan_edr(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, true); -} - -void halbtc8821c1ant_action_hid_a2dp(IN struct btc_coexist* btcoexist) -{ - halbtc8821c1ant_sw_mechanism(btcoexist, true); -} - -*/ - -/* ********************************************* - * - * Non-Software Coex Mechanism start - * - * ********************************************* */ -void halbtc8821c1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) -{ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8821c1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) -{ - - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8821C_1ANT_PHASE_5G_RUNTIME); -} - - -void halbtc8821c1ant_action_wifi_only(IN struct btc_coexist *btcoexist) -{ - boolean wifi_under_5g = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if(wifi_under_5g) - { - halbtc8821c1ant_action_wifi_under5g(btcoexist); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (wlan only -- under 5g ) **********\n"); - BTC_TRACE(trace_buf); - return; - } - - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); -} - -void halbtc8821c1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) -{ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8821c1ant_action_hs(IN struct btc_coexist *btcoexist) -{ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); -} - -void halbtc8821c1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, ap_enable = false, wifi_busy = false, - bt_busy = false; - boolean wifi_scan = false, wifi_link = false, wifi_roam = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); - - if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); - - } else if ((!wifi_connected) && (!wifi_scan)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 22); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - } else if (bt_link_info->a2dp_exist) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (wifi_scan) { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - - } else if (wifi_busy) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 21); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 19); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } -} - -void halbtc8821c1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - /* tdma and coex table */ - - if (bt_link_info->sco_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else { /* HID */ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } -} - -void halbtc8821c1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist - *btcoexist, IN u8 wifi_status) -{ - - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - if (bt_link_info->hid_only) { /* HID */ - halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, - wifi_status); - coex_dm->auto_tdma_adjust = false; - return; - } else if (bt_link_info->a2dp_only) { /* A2DP */ - if (BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } else { - - if (coex_sta->scan_ap_num >= - BT_8821C_1ANT_WIFI_NOISY_THRESH) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 17); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 7); - } - - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = true; - } - } else if (((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) || - (bt_link_info->hid_exist && bt_link_info->a2dp_exist && - bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ - - if (wifi_busy) { - - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 15); - else - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - } else - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 14); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = false; - } else if (bt_link_info->hid_exist && - bt_link_info->a2dp_exist) { /* HID+A2DP */ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 8); - coex_dm->auto_tdma_adjust = false; - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && - bt_link_info->pan_exist)) { /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ - if (BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE == wifi_status) - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 4); - else - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); - coex_dm->auto_tdma_adjust = false; - } else { - /* BT no-profile busy (0x9) */ - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 33); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - coex_dm->auto_tdma_adjust = false; - } -} - -void halbtc8821c1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) -{ - /* tdma and coex table */ - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, - BT_8821C_1ANT_PHASE_2G_RUNTIME ); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); -} - -void halbtc8821c1ant_action_wifi_not_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_action_bt_inquiry(btcoexist); - } else - halbtc8821c1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8821c1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8821c1ant_action_hs(btcoexist); - return; - } - - /* tdma and coex table */ - if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8821c1ant_action_wifi_connected_scan(IN struct btc_coexist - *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_action_bt_inquiry(btcoexist); - } else - halbtc8821c1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8821c1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8821c1ant_action_hs(btcoexist); - return; - } - - - /* tdma and coex table */ - if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - if (bt_link_info->a2dp_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else if (bt_link_info->a2dp_exist && - bt_link_info->pan_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 22); - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_SCAN); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8821c1ant_action_wifi_not_connected_asso_auth( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_action_bt_inquiry(btcoexist); - } else - halbtc8821c1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8821c1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8821c1ant_action_hs(btcoexist); - return; - } - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || - (bt_link_info->a2dp_exist)) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); - } -} - -void halbtc8821c1ant_action_wifi_connected_specific_packet( - IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - boolean wifi_busy = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - - num_of_wifi_link = wifi_link_status >> 16; - - if (num_of_wifi_link >= 2) { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_action_bt_inquiry(btcoexist); - } else - halbtc8821c1ant_action_wifi_multi_port(btcoexist); - return; - } - - if (coex_sta->c2h_bt_inquiry_page) { - halbtc8821c1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8821c1ant_action_hs(btcoexist); - return; - } - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - /* no specific packet process for both WiFi and BT very busy */ - if ((wifi_busy) && ((bt_link_info->pan_exist) || - (coex_sta->num_of_profile >= 2))) - return; - - /* tdma and coex table */ - if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); - } else if (bt_link_info->a2dp_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 32); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else if (bt_link_info->pan_exist) { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 20); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 8); - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); - } -} - -void halbtc8821c1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) -{ - boolean wifi_busy = false; - boolean scan = false, link = false, roam = false; - boolean under_4way = false, ap_enable = false, wifi_under_5g = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect()===>\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - - if (wifi_under_5g) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 5G!!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_action_wifi_under5g(btcoexist); - return; - } else { - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - if (under_4way) { - halbtc8821c1ant_action_wifi_connected_specific_packet(btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - if (scan || link || roam) { - if (scan) - halbtc8821c1ant_action_wifi_connected_scan(btcoexist); - else - halbtc8821c1ant_action_wifi_connected_specific_packet( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, - &ap_enable); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - - /* tdma and coex table */ - if (!wifi_busy) { - if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8821c1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_IDLE); - } else { - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); - - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 2); - } - } else { - if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { - halbtc8821c1ant_action_wifi_connected_bt_acl_busy( - btcoexist, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else if ((BT_8821C_1ANT_BT_STATUS_SCO_BUSY == - coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == - coex_dm->bt_status)) { - halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist, - BT_8821C_1ANT_WIFI_STATUS_CONNECTED_BUSY); - } else { - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, true, - 32); - - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - - halbtc8821c1ant_coex_table_with_type(btcoexist, - NORMAL_EXEC, 4); - } - } -} - -void halbtc8821c1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - u8 algorithm = 0; - - algorithm = halbtc8821c1ant_action_algorithm(btcoexist); - coex_dm->cur_algorithm = algorithm; - - if (halbtc8821c1ant_is_common_action(btcoexist)) { - - } else { - switch (coex_dm->cur_algorithm) { - case BT_8821C_1ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_sco(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_hid(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_a2dp(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_a2dp_pan_hs(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_pan_edr(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_pan_hs(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_pan_edr_a2dp(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_pan_edr_hid(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_hid_a2dp_pan_edr(btcoexist); */ - break; - case BT_8821C_1ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_action_hid_a2dp(btcoexist); */ - break; - default: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action algorithm = coexist All Off!!\n"); - BTC_TRACE(trace_buf); - /* halbtc8821c1ant_coex_all_off(btcoexist); */ - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; - } -} - - -void halbtc8821c1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) -{ - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean wifi_connected = false, bt_hs_on = false; - boolean increase_scan_dev_num = false; - boolean bt_ctrl_agg_buf_size = false; - boolean miracast_plus_bt = false, wifi_under_5g = false; - u8 agg_buf_size = 5; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0, wifi_bw; - u8 iot_peer = BTC_IOT_PEER_UNKNOWN; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism()===>\n"); - BTC_TRACE(trace_buf); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (coex_sta->under_ips) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is under IPS !!!\n"); - BTC_TRACE(trace_buf); - return; - } - - if (!coex_sta->run_time_state){ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], return for run_time_state = false !!!\n"); - BTC_TRACE(trace_buf); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - - if (wifi_under_5g) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 5G!!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_action_wifi_under5g(btcoexist); - return; - } else{ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 2G!!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - } - - if (coex_sta->bt_whck_test) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is under WHCK TEST!!!\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_action_bt_whck_test(btcoexist); - return; - } - - if (coex_sta->bt_disabled) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!!\n"); - halbtc8821c1ant_action_wifi_only(btcoexist); - return; - } - - if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - increase_scan_dev_num = true; - - btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, - &increase_scan_dev_num); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, - &wifi_link_status); - num_of_wifi_link = wifi_link_status >> 16; - - if ((num_of_wifi_link >= 2) || - (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", - num_of_wifi_link, wifi_link_status); - BTC_TRACE(trace_buf); - - if (bt_link_info->bt_link_exist) { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, - 0, 1); - miracast_plus_bt = true; - } else { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - miracast_plus_bt = false; - } - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, - bt_ctrl_agg_buf_size, agg_buf_size); - - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_action_bt_inquiry(btcoexist); - } else - halbtc8821c1ant_action_wifi_multi_port(btcoexist); - - - return; - } else { - miracast_plus_bt = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, - &miracast_plus_bt); - } - - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - - if ((bt_link_info->bt_link_exist) && (wifi_connected)) { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); - - btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); - - if (BTC_IOT_PEER_CISCO != iot_peer) { - if (bt_link_info->sco_exist) /* if (bt_link_info->bt_hi_pri_link_exist) */ - halbtc8821c1ant_limited_rx(btcoexist, - NORMAL_EXEC, true, false, 0x5); - else - halbtc8821c1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, false, 0x5); - } else { - if (bt_link_info->sco_exist) - halbtc8821c1ant_limited_rx(btcoexist, - NORMAL_EXEC, true, false, 0x5); - else { - if (BTC_WIFI_BW_HT40 == wifi_bw) - halbtc8821c1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x10); - else - halbtc8821c1ant_limited_rx(btcoexist, - NORMAL_EXEC, false, true, 0x8); - } - } - - halbtc8821c1ant_sw_mechanism(btcoexist, true); - halbtc8821c1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - } else { - halbtc8821c1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); - - halbtc8821c1ant_limited_rx(btcoexist, NORMAL_EXEC, false, false, - 0x5); - - halbtc8821c1ant_sw_mechanism(btcoexist, false); - halbtc8821c1ant_run_sw_coexist_mechanism( - btcoexist); /* just print debug message */ - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - if (coex_sta->c2h_bt_inquiry_page) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "############# [BTCoex], BT Is Inquirying\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_action_bt_inquiry(btcoexist); - return; - } else if (bt_hs_on) { - halbtc8821c1ant_action_hs(btcoexist); - return; - } - - - if (!wifi_connected) { - boolean scan = false, link = false, roam = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], wifi is non connected-idle !!!\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || link || roam) { - if (scan) - halbtc8821c1ant_action_wifi_not_connected_scan( - btcoexist); - else - halbtc8821c1ant_action_wifi_not_connected_asso_auth( - btcoexist); - } else - halbtc8821c1ant_action_wifi_not_connected(btcoexist); - } else /* wifi LPS/Busy */ - halbtc8821c1ant_action_wifi_connected(btcoexist); -} - -void halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - /* force to reset coex mechanism */ - - /* sw all off */ - halbtc8821c1ant_sw_mechanism(btcoexist, false); - - coex_sta->pop_event_cnt = 0; -} - -void halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean back_up, IN boolean wifi_only) -{ - u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - u16 u16tmp1 = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - - - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u32tmp3, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], 1Ant Init HW Config!!\n"); - BTC_TRACE(trace_buf); - - coex_sta->bt_coex_supported_feature = 0; - coex_sta->bt_coex_supported_version = 0; - - /* Setup RF front end type */ - halbtc8821c1ant_set_rfe_type(btcoexist); - - /* 0xf0[15:12] --> Chip Cut information */ - coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, - 0xf1) & 0xf0) >> 4; - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, - 0x1); /* enable TBTT nterrupt */ - - /* BT report packet sample rate */ - btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); - - /* Init 0x778 = 0x1 for 1-Ant */ - btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); - - /* Enable PTA (3-wire function form BT side) */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); - - /* Enable PTA (tx/rx signal form WiFi side) */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); - - halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); - - /* check if WL firmware download ok */ - if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) - halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); - - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 8); - - /* Antenna config */ - if (wifi_only) { - coex_sta->concurrent_rx_mode_on = false; - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, BT_8821C_1ANT_PHASE_WLANONLY_INIT); - } else { - coex_sta->concurrent_rx_mode_on = true; - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ - - /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx, mask Tx only */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); - - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, BT_8821C_1ANT_PHASE_COEX_INIT); - } - - /* PTA parameter */ - halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - - psd_scan->ant_det_is_ant_det_available = TRUE; - - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u32tmp3, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - -} - -u32 halbtc8821c1ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -{ - u8 j; - u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; - u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, - 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, - 32, 23, 15, 7, 0 - }; - - if (val == 0) - return 0; - - tmp = val; - - while (1) { - if (tmp == 1) - break; - else { - tmp = (tmp >> 1); - shiftcount++; - } - } - - - val_integerd_b = shiftcount + 1; - - tmp2 = 1; - for (j = 1; j <= val_integerd_b; j++) - tmp2 = tmp2 * 2; - - tmp = (val * 100) / tmp2; - tindex = tmp / 5; - - if (tindex > 20) - tindex = 20; - - val_fractiond_b = table_fraction[tindex]; - - result = val_integerd_b * 100 - val_fractiond_b; - - return result; - - -} - -void halbtc8821c1ant_psd_show_antenna_detect_result(IN struct btc_coexist - *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - struct btc_board_info *board_info = &btcoexist->board_info; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n============[Antenna Detection info] ============\n"); - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 1) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", - "Ant Det Result", "2-Antenna (Bad-Isolation)", - BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else if (psd_scan->ant_det_result == 2) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "2-Antenna (Good-Isolation)", - BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset, - BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "1-Antenna", - BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT, - BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", - "Antenna Detection Finish", - (board_info->btdm_ant_det_finish - ? "Yes" : "No")); - CL_PRINTF(cli_buf); - - switch (psd_scan->ant_det_result) { - case 0: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is not available)"); - break; - case 1: /* 2-Ant bad-isolation */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 2: /* 2-Ant good-isolation */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 3: /* 1-Ant */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 4: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Uncertainty result)"); - break; - case 5: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); - break; - case 6: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(WiFi is Scanning)"); - break; - case 7: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is not idle)"); - break; - case 8: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Abort by WiFi Scanning)"); - break; - case 9: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Antenna Init is not ready)"); - break; - case 10: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is Inquiry or page)"); - break; - case 11: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is Disabled)"); - break; - } - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Ant Detect Total Count", psd_scan->ant_det_try_count); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Ant Detect Fail Count", psd_scan->ant_det_fail_count); - CL_PRINTF(cli_buf); - - if ((!board_info->btdm_ant_det_finish) && - (psd_scan->ant_det_result != 5)) - return; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", - (psd_scan->ant_det_result ? "ok" : "fail")); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", - psd_scan->ant_det_bt_tx_time); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", - psd_scan->ant_det_bt_le_channel); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", - "WiFi PSD Cent-Ch/Offset/Span", - psd_scan->real_cent_freq, psd_scan->real_offset, - psd_scan->real_span); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", - "PSD Pre-Scan Peak Value", - psd_scan->ant_det_pre_psdscan_peak_val / 100); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", - "PSD Pre-Scan result", - (psd_scan->ant_det_result != 5 ? "ok" : "fail"), - BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 5) - return; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", - "PSD Scan Peak Value", psd_scan->ant_det_peak_val); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", - "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", - (board_info->tfbga_package) ? "Yes" : "No"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "PSD Threshold Offset", psd_scan->ant_det_thres_offset); - CL_PRINTF(cli_buf); - -} - - - -void halbtc8821c1ant_psd_showdata(IN struct btc_coexist *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - u32 delta_freq_per_point; - u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n\n============[PSD info] (%d)============\n", - psd_scan->psd_gen_count); - CL_PRINTF(cli_buf); - - if (psd_scan->psd_gen_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); - CL_PRINTF(cli_buf); - return; - } - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* if (psd_scan->is_psd_show_max_only) */ - if (0) { - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; - - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + - psd_scan->psd_max_value_point * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.0%d MHz", - freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.%d MHz", - freq1, freq2); - - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - - CL_PRINTF(cli_buf); - } else { - m = psd_scan->psd_start_point; - n = psd_scan->psd_start_point; - i = 1; - j = 1; - - while (1) { - do { - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * - delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (i == 1) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.0%2d", freq1, - freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.%3d", freq1, - freq2); - } else if ((i % 8 == 0) || - (m == psd_scan->psd_stop_point)) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000\n", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d\n", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d\n", freq1, freq2); - } else { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d", freq1, freq2); - } - - i++; - m++; - CL_PRINTF(cli_buf); - - } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); - - - do { - psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; - psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * - 100; - - if (j == 1) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.0%d", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.%d", psd_rep1, - psd_rep2); - } else if ((j % 8 == 0) || - (n == psd_scan->psd_stop_point)) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d\n", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d\n", psd_rep1, psd_rep2); - } else { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d", psd_rep1, psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d", psd_rep1, psd_rep2); - } - - j++; - n++; - CL_PRINTF(cli_buf); - - } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); - - if ((m > psd_scan->psd_stop_point) || - (n > psd_scan->psd_stop_point)) - break; - else { - i = 1; - j = 1; - } - - } - } - - -} - -void halbtc8821c1ant_psd_maxholddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0, i_max = 0, val_max = 0; - - if (gen_count == 1) { - memcpy(psd_scan->psd_report_max_hold, - psd_scan->psd_report, - BT_8821C_1ANT_ANTDET_PSD_POINTS * sizeof(u32)); - - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - - } - - psd_scan->psd_max_value_point = 0; - psd_scan->psd_max_value = 0; - - } else { - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - if (psd_scan->psd_report[i] > - psd_scan->psd_report_max_hold[i]) - psd_scan->psd_report_max_hold[i] = - psd_scan->psd_report[i]; - - /* search Max Value */ - if (i == psd_scan->psd_start_point) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } else { - if (psd_scan->psd_report_max_hold[i] > - val_max) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } - } - - - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - - } - - -} - -u32 halbtc8821c1ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -{ - /* reg 0x808[9:0]: FFT data x */ - /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ - /* reg 0x8b4[15:0]: FFT data y report */ - - u32 val = 0, psd_report = 0; - - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - - val &= 0xffbffc00; - val |= point; - - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - val |= 0x00400000; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - - -boolean halbtc8821c1ant_psd_sweep_point(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, - IN u32 avgnum, IN u32 loopcnt) -{ - u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; - u32 points1 = 0, psd_report = 0; - u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; - u32 psd_center_freq = 20 * 10 ^ 6; - boolean outloop = false, scan , roam, is_sweep_ok = true; - u8 flag = 0; - u32 tmp = 0, u32tmp1 = 0; - u32 wifi_original_channel = 1; - - psd_scan->is_psd_running = true; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); - BTC_TRACE(trace_buf); - - do { - switch (flag) { - case 0: /* Get PSD parameters */ - default: - - psd_scan->psd_band_width = 40 * 1000000; - psd_scan->psd_point = points; - psd_scan->psd_start_base = points / 2; - psd_scan->psd_avg_num = avgnum; - psd_scan->real_cent_freq = cent_freq; - psd_scan->real_offset = offset; - psd_scan->real_span = span; - - - points1 = psd_scan->psd_point; - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* PSD point setup */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffff0fff; - - switch (psd_scan->psd_point) { - case 128: - val |= 0x0; - break; - case 256: - default: - val |= 0x00004000; - break; - case 512: - val |= 0x00008000; - break; - case 1024: - val |= 0x0000c000; - break; - } - - switch (psd_scan->psd_avg_num) { - case 1: - val |= 0x0; - break; - case 8: - val |= 0x00001000; - break; - case 16: - val |= 0x00002000; - break; - case 32: - default: - val |= 0x00003000; - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - flag = 1; - break; - case 1: /* calculate the PSD point index from freq/offset/span */ - psd_center_freq = psd_scan->psd_band_width / 2 + - offset * (1000000); - - start_p = psd_scan->psd_start_base + (psd_center_freq - - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_start_point = start_p - - psd_scan->psd_start_base; - - stop_p = psd_scan->psd_start_base + (psd_center_freq + - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_stop_point = stop_p - - psd_scan->psd_start_base - 1; - - flag = 2; - break; - case 2: /* set RF channel/BW/Mode */ - - /* set 3-wire off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val |= 0x00300000; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val &= 0xfeffffff; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* Tx-pause on */ - btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); - - /* store WiFi original channel */ - wifi_original_channel = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x18, 0x3ff); - - /* Set RF channel */ - if (cent_freq == 2484) - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, 0xe); - else - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, (cent_freq - 2412) / 5 + - 1); /* WiFi TRx Mask on */ - - /* save original RCK value */ - u32tmp1 = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x1d, 0xfffff); - - /* Enter debug mode */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, - 0x2, 0x1); - - /* Set RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, - 0xfffff, 0x2e); - - - /* Set RF mode = Rx, RF Gain = 0x320a0 */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, - 0xfffff, 0x320a0); - - while (1) { - if (k++ > BT_8821C_1ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - flag = 3; - break; - case 3: - psd_scan->psd_gen_count = 0; - for (j = 1; j <= loopcnt; j++) { - - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || roam) { - is_sweep_ok = false; - break; - } - memset(psd_scan->psd_report, 0, - psd_scan->psd_point * sizeof(u32)); - start_p = psd_scan->psd_start_point + - psd_scan->psd_start_base; - stop_p = psd_scan->psd_stop_point + - psd_scan->psd_start_base + 1; - - i = start_p; - point_index = 0; - - while (i < stop_p) { - if (i >= points1) - psd_report = - halbtc8821c1ant_psd_getdata( - btcoexist, i - points1); - else - psd_report = - halbtc8821c1ant_psd_getdata( - btcoexist, i); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_raw_data = 0x%08x\n", - i, psd_report); - BTC_TRACE(trace_buf); - if (psd_report == 0) - tmp = 0; - else - /* tmp = 20*log10((double)psd_report); */ - /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ - tmp = 6 * halbtc8821c1ant_psd_log2base( - btcoexist, psd_report); - - n = i - psd_scan->psd_start_base; - psd_scan->psd_report[n] = tmp; - - - halbtc8821c1ant_psd_maxholddata( - btcoexist, j); - - i++; - - } - - psd_scan->psd_gen_count = j; - } - - flag = 100; - break; - case 99: /* error */ - - outloop = true; - break; - case 100: /* recovery */ - - /* set 3-wire on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val &= 0xffcfffff; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val |= 0x01000000; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* Tx-pause off */ - btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); - - /* PSD off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffbfffff; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - /* restore RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, - 0xfffff, u32tmp1); - - /* Exit debug mode */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, - 0x2, 0x0); - - /* restore WiFi original channel */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, - 0x3ff, wifi_original_channel); - - outloop = true; - break; - - } - - } while (!outloop); - - - - psd_scan->is_psd_running = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - - -void halbtc8821c1ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 bt_tx_time, IN u32 bt_le_channel) -{ - u32 i = 0; - u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; - s32 wlpsd_offset = -4; - u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; - - u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; - - u8 state = 0; - boolean outloop = false, bt_resp = false; - u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, - u32tmp, u32tmp0, u32tmp1, u32tmp2 ; - struct btc_board_info *board_info = &btcoexist->board_info; - - board_info->btdm_ant_det_finish = false; - memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); - memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); - - if (board_info->tfbga_package) /* for TFBGA */ - psd_scan->ant_det_thres_offset = 5; - else - psd_scan->ant_det_thres_offset = 0; - - do { - switch (state) { - case 0: - if (bt_le_channel == 39) - wlpsd_cent_freq = 2484; - else { - for (i = 1; i <= 13; i++) { - if (bt_le_ch[i - 1] == - bt_le_channel) { - wlpsd_cent_freq = 2412 - + (i - 1) * 5; - break; - } - } - - if (i == 14) { - - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", - bt_le_channel); - BTC_TRACE(trace_buf); - outloop = true; - break; - } - } - - wlpsd_sweep_count = bt_tx_time * 238 / - 100; /* bt_tx_time/0.42 */ - wlpsd_sweep_count = wlpsd_sweep_count / 5; - - if (wlpsd_sweep_count % 5 != 0) - wlpsd_sweep_count = (wlpsd_sweep_count / - 5 + 1) * 5; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", - bt_tx_time, bt_le_channel); - BTC_TRACE(trace_buf); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", - wlpsd_cent_freq, - wlpsd_offset, - wlpsd_span, - wlpsd_sweep_count); - BTC_TRACE(trace_buf); - - state = 1; - break; - case 1: /* stop coex DM & set antenna path */ - /* Stop Coex DM */ - btcoexist->stop_coex_dm = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); - BTC_TRACE(trace_buf); - - /* Set TDMA off, */ - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, - false, 0); - - /* Set coex table */ - halbtc8821c1ant_coex_table_with_type(btcoexist, - FORCE_EXEC, 0); - - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); - BTC_TRACE(trace_buf); - } - - halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); - - halbtc8821c1ant_set_ext_ant_switch( btcoexist, - FORCE_EXEC, - BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT); - - /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ - /* set GNT_BT to SW high */ - halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to SW high */ - halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_1ANT_GNT_BLOCK_RFC_BB, - BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); - BTC_TRACE(trace_buf); - - /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ - h2c_parameter[0] = 0x1; - h2c_parameter[1] = 0xd; - h2c_parameter[2] = 0x14; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", - h2c_parameter[1], - h2c_parameter[2]); - BTC_TRACE(trace_buf); - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, - h2c_parameter); - - u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); - u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det) **********\n", - u32tmp0, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - - state = 2; - break; - case 2: /* Pre-sweep background psd */ - if (!halbtc8821c1ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, wlpsd_span, - BT_8821C_1ANT_ANTDET_PSD_POINTS, - BT_8821C_1ANT_ANTDET_PSD_AVGNUM, 3)) { - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - - psd_scan->ant_det_pre_psdscan_peak_val = - psd_scan->psd_max_value; - - if (psd_scan->psd_max_value > - (BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset) * 100) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", - psd_scan->psd_max_value / 100, - BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 5; - state = 99; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", - psd_scan->psd_max_value / 100, - BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - state = 3; - } - break; - case 3: - - bt_resp = btcoexist->btc_set_bt_ant_detection( - btcoexist, (u8)(bt_tx_time & 0xff), - (u8)(bt_le_channel & 0xff)); - - if (!halbtc8821c1ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, - wlpsd_span, - BT_8821C_1ANT_ANTDET_PSD_POINTS, - BT_8821C_1ANT_ANTDET_PSD_AVGNUM, - wlpsd_sweep_count)) { - board_info->btdm_ant_det_finish - = false; - board_info->btdm_ant_num_by_ant_det - = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - - psd_scan->ant_det_psd_scan_peak_val = - psd_scan->psd_max_value; - psd_scan->ant_det_psd_scan_peak_freq = - psd_scan->psd_max_value_point; - state = 4; - break; - case 4: - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = - psd_scan->psd_band_width / - psd_scan->psd_point; - - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * - 100; - - freq = ((psd_scan->real_cent_freq - 20) * - 1000000 + psd_scan->psd_max_value_point - * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", - freq1, freq2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_freq, - BT_8821C_1ANT_ANTDET_BUF_LEN, - "%d.0%d", freq1, freq2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", - freq1, freq2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_freq, - BT_8821C_1ANT_ANTDET_BUF_LEN, - "%d.%d", freq1, freq2); - } - - if (psd_rep2 < 10) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB\n", - psd_rep1, psd_rep2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_val, - BT_8821C_1ANT_ANTDET_BUF_LEN, - "%d.0%d", psd_rep1, psd_rep2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB\n", - psd_rep1, psd_rep2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_val, - BT_8821C_1ANT_ANTDET_BUF_LEN, - "%d.%d", psd_rep1, psd_rep2); - } - - psd_scan->ant_det_is_btreply_available = true; - - if (bt_resp == false) { - psd_scan->ant_det_is_btreply_available = - false; - psd_scan->ant_det_result = 0; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) { - psd_scan->ant_det_result = 1; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 2; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset) * 100) { - psd_scan->ant_det_result = 2; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 2; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT) * - 100) { - psd_scan->ant_det_result = 3; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); - BTC_TRACE(trace_buf); - } else { - psd_scan->ant_det_result = 4; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); - BTC_TRACE(trace_buf); - } - - state = 99; - break; - case 99: /* restore setup */ - - /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ - h2c_parameter[0] = 0x0; - h2c_parameter[1] = 0x0; - h2c_parameter[2] = 0x0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", - h2c_parameter[1], h2c_parameter[2]); - BTC_TRACE(trace_buf); - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, - h2c_parameter); - - /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_1ANT_PHASE_2G_RUNTIME); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); - BTC_TRACE(trace_buf); - - /* Resume Coex DM */ - btcoexist->stop_coex_dm = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); - BTC_TRACE(trace_buf); - - /* stimulate coex running */ - halbtc8821c1ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - - outloop = true; - break; - } - - } while (!outloop); - - - -} - -void halbtc8821c1ant_psd_antenna_detection_check(IN struct btc_coexist - *btcoexist) -{ - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - - boolean scan, roam; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - - /* psd_scan->ant_det_bt_tx_time = 20; */ - psd_scan->ant_det_bt_tx_time = - BT_8821C_1ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ - psd_scan->ant_det_bt_le_channel = BT_8821C_1ANT_ANTDET_BTTXCHANNEL; - - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan || roam) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 6; - } else if (coex_sta->bt_disabled) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 11; - } else if (coex_sta->num_of_profile >= 1) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 7; - } else if ( - !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 9; - } else if (coex_sta->c2h_bt_inquiry_page) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 10; - } else { - - btcoexist->stop_coex_dm = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_psd_antenna_detection(btcoexist, - psd_scan->ant_det_bt_tx_time, - psd_scan->ant_det_bt_le_channel); - - delay_ms(psd_scan->ant_det_bt_tx_time); - - btcoexist->stop_coex_dm = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); - BTC_TRACE(trace_buf); - - /* stimulate coex running */ - /* - halbtc8821c1ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - */ - } - - if (!board_info->btdm_ant_det_finish) - ant_det_fail_count++; - - psd_scan->ant_det_fail_count = ant_det_fail_count; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", - psd_scan->ant_det_result, - psd_scan->ant_det_fail_count, - board_info->btdm_ant_det_finish == TRUE ? "Yes" : "No"); - BTC_TRACE(trace_buf); - -} - - -/* ************************************************************ - * work around function start with wa_halbtc8821c1ant_ - * ************************************************************ - * ************************************************************ - * extern function start with ex_halbtc8821c1ant_ - * ************************************************************ */ -void ex_halbtc8821c1ant_power_on_setting(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - u8 u8tmp = 0x0; - u16 u16tmp = 0x0; - u32 value = 0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Execute 8821c 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Ant Det Finish = %s, Ant Det Number = %d\n", - (board_info->btdm_ant_det_finish ? "Yes" : "No"), - board_info->btdm_ant_num_by_ant_det); - BTC_TRACE(trace_buf); - - btcoexist->stop_coex_dm = true; - psd_scan->ant_det_is_ant_det_available = FALSE; - - /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ - u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); - btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); - - /* Local setting bit define */ - /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ - /* BIT1: "0" for internal switch; "1" for external switch */ - /* BIT2: "0" for one antenna; "1" for two antenna */ - /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ - - /* Check efuse 0xc3[6] for Single Antenna Path */ - if (board_info->single_ant_path == 0) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** Single Antenna, Antenna at Aux Port**********\n"); - BTC_TRACE(trace_buf); - - board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; - - u8tmp = 1; - } else if (board_info->single_ant_path == 1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** Single Antenna, Antenna at Main Port**********\n"); - BTC_TRACE(trace_buf); - - board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; - - u8tmp = 0; - } - - - /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ - if (btcoexist->chip_interface == BTC_INTF_PCI) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); - else if (btcoexist->chip_interface == BTC_INTF_USB) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); - else if (btcoexist->chip_interface == BTC_INTF_SDIO) - btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); - - /* Setup RF front end type */ - halbtc8821c1ant_set_rfe_type(btcoexist); - - /* Set Antenna Path to BT side */ - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_1ANT_PHASE_COEX_INIT); - - /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", - halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); - BTC_TRACE(trace_buf); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x**********\n", - btcoexist->btc_read_4byte(btcoexist, 0x70), btcoexist->btc_read_4byte(btcoexist, 0xcb4)); - BTC_TRACE(trace_buf); - -} - -void ex_halbtc8821c1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) -{ -} - -void ex_halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, - IN boolean wifi_only) -{ - halbtc8821c1ant_init_hw_config(btcoexist, true, wifi_only); - btcoexist->stop_coex_dm = false; - -} - -void ex_halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Coex Mechanism Init!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_init_coex_dm(btcoexist); - - /* halbtc8821c1ant_query_bt_info(btcoexist); */ -} - -void ex_halbtc8821c1ant_display_coex_info(IN struct btc_coexist *btcoexist) -{ - struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_stack_info *stack_info = &btcoexist->stack_info; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - u8 *cli_buf = btcoexist->cli_buf; - u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; - u16 u16tmp[4]; - u32 u32tmp[4]; - u32 fa_of_dm, fa_cck; - u32 fw_ver = 0, bt_patch_ver = 0; - static u8 pop_report_in_10s = 0; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[BT Coexist info]============"); - CL_PRINTF(cli_buf); - - if (btcoexist->manual_control) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Under Manual Control]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - if (btcoexist->stop_coex_dm) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Coex is STOPPED]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); - } - - if (psd_scan->ant_det_try_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s / %d", - "Ant PG Num/ Mech/ Pos/ RFE", - board_info->pg_ant_num, board_info->btdm_ant_num, - (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT? "Main" : "Aux"), - rfe_type->rfe_module_type); - CL_PRINTF(cli_buf); - } else { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", - "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", - board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, - (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT ? "Main" : "Aux"), - rfe_type->rfe_module_type, - psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, - psd_scan->ant_det_result); - CL_PRINTF(cli_buf); - - if (board_info->btdm_ant_det_finish) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "Ant Det PSD Value", - psd_scan->ant_det_peak_val); - CL_PRINTF(cli_buf); - } - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", - "BT stack/ hci ext ver", - ((stack_info->profile_notified) ? "Yes" : "No"), - stack_info->hci_version); - CL_PRINTF(cli_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", - "Version Coex/ Fw/ Patch/ Cut", - glcoex_ver_date_8821c_1ant, glcoex_ver_8821c_1ant, fw_ver, - bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", - "Wifi channel informed to BT", - coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], - coex_dm->wifi_chnl_info[2]); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", - "WifibHiPri/ Ccklock/ CckEverLock", - (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), - (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No")); - CL_PRINTF(cli_buf); - - /* wifi status */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Wifi Status]============"); - CL_PRINTF(cli_buf); - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[BT Status]============"); - CL_PRINTF(cli_buf); - - pop_report_in_10s++; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", - "BT [status/ rssi/ retryCnt/ popCnt]", - ((coex_sta->bt_disabled) ? ("disabled") : (( - coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") - : ((BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) ? "non-connected idle" : - ((BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) - ? "connected-idle" : "busy")))), - coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, - coex_sta->pop_event_cnt); - CL_PRINTF(cli_buf); - - if (pop_report_in_10s >= 5) { - coex_sta->pop_event_cnt = 0; - pop_report_in_10s = 0; - } - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d / %d", - "SCO/HID/PAN/A2DP/Hi-Pri", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist, - bt_link_info->bt_hi_pri_link_exist); - CL_PRINTF(cli_buf); - - if (stack_info->profile_notified) - btcoexist->btc_disp_dbg_msg(btcoexist, - BTC_DBG_DISP_BT_LINK_INFO); - else { - bt_info_ext = coex_sta->bt_info_ext; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", - "Role/A2DP Rate/Bitpool/Feature/Ver", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, - coex_sta->bt_coex_supported_feature, - coex_sta->bt_coex_supported_version); - CL_PRINTF(cli_buf); - } - - - for (i = 0; i < BT_INFO_SRC_8821C_1ANT_MAX; i++) { - if (coex_sta->bt_info_c2h_cnt[i]) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", - glbt_info_src_8821c_1ant[i], - coex_sta->bt_info_c2h[i][0], - coex_sta->bt_info_c2h[i][1], - coex_sta->bt_info_c2h[i][2], - coex_sta->bt_info_c2h[i][3], - coex_sta->bt_info_c2h[i][4], - coex_sta->bt_info_c2h[i][5], - coex_sta->bt_info_c2h[i][6], - coex_sta->bt_info_c2h_cnt[i]); - CL_PRINTF(cli_buf); - } - } - - - if (btcoexist->manual_control) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms] (before Manual)============"); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms]============"); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "SM[LowPenaltyRA]", - coex_dm->cur_low_penalty_ra); - CL_PRINTF(cli_buf); - - ps_tdma_case = coex_dm->cur_ps_tdma; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", - "PS TDMA", - coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], - coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], - coex_dm->ps_tdma_para[4], ps_tdma_case, - (coex_dm->cur_ps_tdma_on ? "On" : "Off"), - (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "WL/BT Coex Table Type", - coex_sta->coex_table_type); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x6c0/0x6c4/0x6c8(coexTable)", - u32tmp[0], u32tmp[1], u32tmp[2]); - CL_PRINTF(cli_buf); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x778/0x6cc/IgnWlanAct", - u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa0); - u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "LTE Coex Table W_L/B_L", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0xa8); - u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0xac); - u32tmp[2] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb0); - u32tmp[3] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, - 0xb4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "LTE Break Table W_L/B_L/L_W/L_B", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, - u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); - CL_PRINTF(cli_buf); - - /* Hw setting */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[Hw setting]============"); - CL_PRINTF(cli_buf); - - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", - "0x430/0x434/0x42a/0x456", - u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - - u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", - "LTE CoexOn/Path Ctrl Owner", - (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "LTE 3Wire/OPMode/UART/UARTMode", - (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), - (int)((u32tmp[0] & BIT(3)) >> 3), - (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", - "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", - (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), - ((u8tmp[0] & BIT(3)) ? "On" : "Off")); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", - (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), - (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); - CL_PRINTF(cli_buf); - - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", - "0xcb0/0xcb4/0xcb8[23:16]", - u32tmp[0], u32tmp[1],u8tmp[0], ( (u8tmp[0] & 0x5) == 0x1 ? "BTG": ( (u8tmp[0] & 0xf0) == 0x70? "WL_G" : "WL_A" ) )); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x4c[24:23]/0x64[0]/x4c6[4]/0x40[5]", - (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23 , u8tmp[2]&0x1 , (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); - u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", - "0x550/0x522/4-RxAGC/0xc50", - u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); - - fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); - - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", - u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_OK CCK/11g/11n/11ac", - coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "CRC_Err CCK/11g/11n/11ac", - coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770(high-pri rx/tx)", - coex_sta->high_priority_rx, coex_sta->high_priority_tx); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri rx/tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); - - halbtc8821c1ant_read_score_board(btcoexist, &u16tmp[0]); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", - "ScoreBoard[14:0] (from BT)", u16tmp[0]); - CL_PRINTF(cli_buf); - - btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); -} - - -void ex_halbtc8821c1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - if (btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - - if (BTC_IPS_ENTER == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS ENTER notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - - /* Write WL "Active" in Score-board for LPS off */ - halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_1ANT_PHASE_WLAN_OFF); - - halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - } else if (BTC_IPS_LEAVE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], IPS LEAVE notify\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); - - halbtc8821c1ant_init_hw_config(btcoexist, false, false); - halbtc8821c1ant_init_coex_dm(btcoexist);; - - coex_sta->under_ips = false; - } -} - -void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) -{ - if (btcoexist->manual_control || btcoexist->stop_coex_dm) - return; - - if (BTC_LPS_ENABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS ENABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = true; - - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ - /* Write WL "Active" in Score-board for PS-TDMA */ - halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); - - } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ - /* Write WL "Non-Active" in Score-board for Native-PS */ - halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); - - } - } else if (BTC_LPS_DISABLE == type) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], LPS DISABLE notify\n"); - BTC_TRACE(trace_buf); - coex_sta->under_lps = false; - - /* Write WL "Active" in Score-board for LPS off */ - halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); - - } -} - -void ex_halbtc8821c1ant_scan_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN notify()\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - if (BTC_SCAN_START == type) //for dual band, no action for BTC_SCAN_START, the action is change to switchband_notify - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - halbtc8821c1ant_query_bt_info(btcoexist); - - if (BTC_SCAN_START_2G == type) { - - if (!wifi_connected) - coex_sta->wifi_is_high_pri_task = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN START notify (2G)\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, - 8); - - /* Force antenna setup for no scan result issue */ - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - - if (!wifi_connected) /* non-connected scan */ - halbtc8821c1ant_action_wifi_not_connected_scan(btcoexist); - else /* wifi is connected */ - halbtc8821c1ant_action_wifi_connected_scan(btcoexist); - - } else { - - coex_sta->wifi_is_high_pri_task = false; - - btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, - &coex_sta->scan_ap_num); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); - BTC_TRACE(trace_buf); - - if (!wifi_connected) - halbtc8821c1ant_action_wifi_not_connected(btcoexist); - else - halbtc8821c1ant_action_wifi_connected(btcoexist); - } - - -} - -void ex_halbtc8821c1ant_switchband_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - - boolean wifi_connected = false, bt_hs_on = false; - u32 wifi_link_status = 0; - u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; - u8 agg_buf_size = 5; - - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - - if(type == BTC_SWITCH_TO_5G) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], switchband_notify --- switch to 5G\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_action_wifi_under5g(btcoexist); - - } else { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], switchband_notify --- switch to 2G\n"); - BTC_TRACE(trace_buf); - - ex_halbtc8821c1ant_scan_notify(btcoexist, - BTC_SCAN_START_2G); - } -} - - -void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_connected = false; - - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { - - if (BTC_ASSOCIATE_5G_START == type) - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], connect_notify --- 5G start\n"); - else - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], connect_notify --- 5G finish\n"); - - BTC_TRACE(trace_buf); - - halbtc8821c1ant_action_wifi_under5g(btcoexist); - return; - } - - if (BTC_ASSOCIATE_START == type) { - - coex_sta->wifi_is_high_pri_task = true; - - /* Force antenna setup for no scan result issue */ - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT START notify (2G)\n"); - BTC_TRACE(trace_buf); - - coex_dm->arp_cnt = 0; - - halbtc8821c1ant_action_wifi_not_connected_asso_auth(btcoexist); - } else { - - coex_sta->wifi_is_high_pri_task = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT FINISH notify (2G)\n"); - BTC_TRACE(trace_buf); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - if (!wifi_connected) /* non-connected scan */ - halbtc8821c1ant_action_wifi_not_connected(btcoexist); - else - halbtc8821c1ant_action_wifi_connected(btcoexist); - } - -} - -void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean wifi_under_b_mode = false, wifi_under_5g = false; - - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm) - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +/* ************************************************************ + * Description: + * + * This file is for RTL8821C Co-exist mechanism + * + * History + * 2012/11/15 Cosa first check in. + * + * ************************************************************ */ + +/* ************************************************************ + * include files + * ************************************************************ */ +#include "mp_precomp.h" + +#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + +#if (RTL8821C_SUPPORT == 1) +/* ************************************************************ + * Global variables, these are static variables + * ************************************************************ */ +static u8 *trace_buf = &gl_btc_trace_buf[0]; +static struct coex_dm_8821c_1ant glcoex_dm_8821c_1ant; +static struct coex_dm_8821c_1ant *coex_dm = &glcoex_dm_8821c_1ant; +static struct coex_sta_8821c_1ant glcoex_sta_8821c_1ant; +static struct coex_sta_8821c_1ant *coex_sta = &glcoex_sta_8821c_1ant; +static struct psdscan_sta_8821c_1ant gl_psd_scan_8821c_1ant; +static struct psdscan_sta_8821c_1ant *psd_scan = &gl_psd_scan_8821c_1ant; +static struct rfe_type_8821c_1ant gl_rfe_type_8821c_1ant; +static struct rfe_type_8821c_1ant *rfe_type = &gl_rfe_type_8821c_1ant; + + +const char *const glbt_info_src_8821c_1ant[] = { + "BT Info[wifi fw]", + "BT Info[bt rsp]", + "BT Info[bt auto report]", +}; + +u32 glcoex_ver_date_8821c_1ant = 20170727; +u32 glcoex_ver_8821c_1ant = 0x1b; +u32 glcoex_ver_btdesired_8821c_1ant = 0x1b; + + +/* ************************************************************ + * local function proto type if needed + * ************************************************************ + * ************************************************************ + * local function start with halbtc8821c1ant_ + * ************************************************************ */ +u8 halbtc8821c1ant_bt_rssi_state(u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) +{ + s32 bt_rssi = 0; + u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; + + bt_rssi = coex_sta->bt_rssi; + + if (level_num == 2) { + if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Rssi thresh error!!\n"); + BTC_TRACE(trace_buf); + return coex_sta->pre_bt_rssi_state; + } + + if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_MEDIUM) || + (coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_STAY_MEDIUM)) { + if (bt_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (bt_rssi < rssi_thresh1) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + coex_sta->pre_bt_rssi_state = bt_rssi_state; + + return bt_rssi_state; +} + +u8 halbtc8821c1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, + IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) +{ + s32 wifi_rssi = 0; + u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; + + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + + if (level_num == 2) { + if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) + || + (coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi RSSI thresh error!!\n"); + BTC_TRACE(trace_buf); + return coex_sta->pre_wifi_rssi_state[index]; + } + + if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) + || + (coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_MEDIUM) || + (coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_STAY_MEDIUM)) { + if (wifi_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (wifi_rssi < rssi_thresh1) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; + + return wifi_rssi_state; +} + +void halbtc8821c1ant_update_ra_mask(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 dis_rate_mask) +{ + coex_dm->cur_ra_mask = dis_rate_mask; + + if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, + &coex_dm->cur_ra_mask); + coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; +} + +void halbtc8821c1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + boolean wifi_under_b_mode = FALSE; + + coex_dm->cur_arfr_type = type; + + if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { + switch (coex_dm->cur_arfr_type) { + case 0: /* normal mode */ + btcoexist->btc_write_4byte(btcoexist, 0x430, + coex_dm->backup_arfr_cnt1); + btcoexist->btc_write_4byte(btcoexist, 0x434, + coex_dm->backup_arfr_cnt2); + break; + case 1: + btcoexist->btc_get(btcoexist, + BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + if (wifi_under_b_mode) { + btcoexist->btc_write_4byte(btcoexist, + 0x430, 0x0); + btcoexist->btc_write_4byte(btcoexist, + 0x434, 0x01010101); + } else { + btcoexist->btc_write_4byte(btcoexist, + 0x430, 0x0); + btcoexist->btc_write_4byte(btcoexist, + 0x434, 0x04030201); + } + break; + default: + break; + } + } + + coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; +} + +void halbtc8821c1ant_retry_limit(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + coex_dm->cur_retry_limit_type = type; + + if (force_exec || + (coex_dm->pre_retry_limit_type != + coex_dm->cur_retry_limit_type)) { + switch (coex_dm->cur_retry_limit_type) { + case 0: /* normal mode */ + btcoexist->btc_write_2byte(btcoexist, 0x42a, + coex_dm->backup_retry_limit); + break; + case 1: /* retry limit=8 */ + btcoexist->btc_write_2byte(btcoexist, 0x42a, + 0x0808); + break; + default: + break; + } + } + + coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; +} + +void halbtc8821c1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + coex_dm->cur_ampdu_time_type = type; + + if (force_exec || + (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { + switch (coex_dm->cur_ampdu_time_type) { + case 0: /* normal mode */ + btcoexist->btc_write_1byte(btcoexist, 0x456, + coex_dm->backup_ampdu_max_time); + break; + case 1: /* AMPDU timw = 0x38 * 32us */ + btcoexist->btc_write_1byte(btcoexist, 0x456, + 0x38); + break; + default: + break; + } + } + + coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; +} + +void halbtc8821c1ant_limited_tx(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, + IN u8 retry_limit_type, IN u8 ampdu_time_type) +{ + switch (ra_mask_type) { + case 0: /* normal mode */ + halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, + 0x0); + break; + case 1: /* disable cck 1/2 */ + halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, + 0x00000003); + break; + case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ + halbtc8821c1ant_update_ra_mask(btcoexist, force_exec, + 0x0001f1f7); + break; + default: + break; + } + + halbtc8821c1ant_auto_rate_fallback_retry(btcoexist, force_exec, arfr_type); + halbtc8821c1ant_retry_limit(btcoexist, force_exec, retry_limit_type); + halbtc8821c1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); +} + +void halbtc8821c1ant_limited_rx(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean rej_ap_agg_pkt, + IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) +{ + boolean reject_rx_agg = rej_ap_agg_pkt; + boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; + u8 rx_agg_size = agg_buf_size; + + /* ============================================ */ + /* Rx Aggregation related setting */ + /* ============================================ */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, + &reject_rx_agg); + /* decide BT control aggregation buf size or not */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, + &bt_ctrl_rx_agg_size); + /* aggregation buf size, only work when BT control Rx aggregation size. */ + btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); + /* real update aggregation setting */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); + + +} + +void halbtc8821c1ant_query_bt_info(IN struct btc_coexist *btcoexist) +{ + u8 h2c_parameter[1] = {0}; + + if (coex_sta->bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No query BT info because BT is disabled!\n"); + BTC_TRACE(trace_buf); + return; + } + + + h2c_parameter[0] |= BIT(0); /* trigger */ + + btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WL query BT info!!\n"); + BTC_TRACE(trace_buf); +} + +void halbtc8821c1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) +{ + u32 reg_hp_txrx, reg_lp_txrx, u32tmp; + u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; + static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0, + cnt_autoslot_hang = 0; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ + /* if (! (btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8) ) */ + + reg_hp_txrx = 0x770; + reg_lp_txrx = 0x774; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); + reg_hp_tx = u32tmp & MASKLWORD; + reg_hp_rx = (u32tmp & MASKHWORD) >> 16; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); + reg_lp_tx = u32tmp & MASKLWORD; + reg_lp_rx = (u32tmp & MASKHWORD) >> 16; + + coex_sta->high_priority_tx = reg_hp_tx; + coex_sta->high_priority_rx = reg_hp_rx; + coex_sta->low_priority_tx = reg_lp_tx; + coex_sta->low_priority_rx = reg_lp_rx; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); + + BTC_TRACE(trace_buf); + + if (BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + + if (coex_sta->high_priority_rx >= 15) { + if (cnt_overhead < 3) + cnt_overhead++; + + if (cnt_overhead == 3) + coex_sta->is_hiPri_rx_overhead = TRUE; + + } else { + if (cnt_overhead > 0) + cnt_overhead--; + + if (cnt_overhead == 0) + coex_sta->is_hiPri_rx_overhead = FALSE; + } + } else + coex_sta->is_hiPri_rx_overhead = FALSE; + + /* reset counter */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); + + if ((coex_sta->low_priority_tx > 1150) && + (!coex_sta->c2h_bt_inquiry_page)) + coex_sta->pop_event_cnt++; + + if ((coex_sta->low_priority_rx >= 1150) && + (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) + && (!coex_sta->under_ips) + && (!coex_sta->c2h_bt_inquiry_page) + && ((bt_link_info->a2dp_exist) || (bt_link_info->pan_exist))) { + if (cnt_slave >= 2) { + bt_link_info->slave_role = TRUE; + cnt_slave = 2; + } else + cnt_slave++; + } else { + if (cnt_slave == 0) { + bt_link_info->slave_role = FALSE; + cnt_slave = 0; + } else + cnt_slave--; + } + + if (coex_sta->is_tdma_btautoslot) { + if ((coex_sta->low_priority_tx >= 1300) && + (coex_sta->low_priority_rx <= 150)) { + if (cnt_autoslot_hang >= 2) { + coex_sta->is_tdma_btautoslot_hang = TRUE; + cnt_autoslot_hang = 2; + } else + cnt_autoslot_hang++; + } else { + if (cnt_autoslot_hang == 0) { + coex_sta->is_tdma_btautoslot_hang = FALSE; + cnt_autoslot_hang = 0; + } else + cnt_autoslot_hang--; + } + } + + if (bt_link_info->hid_only) { + if (coex_sta->low_priority_rx > 50) + coex_sta->is_hid_low_pri_tx_overhead = true; + else + coex_sta->is_hid_low_pri_tx_overhead = false; + } + + if (!coex_sta->bt_disabled) { + + if ((coex_sta->high_priority_tx == 0) && + (coex_sta->high_priority_rx == 0) && + (coex_sta->low_priority_tx == 0) && + (coex_sta->low_priority_rx == 0)) { + num_of_bt_counter_chk++; + if (num_of_bt_counter_chk >= 3) { + halbtc8821c1ant_query_bt_info(btcoexist); + num_of_bt_counter_chk = 0; + } + } + } + +} + + + +void halbtc8821c1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE, wifi_under_b_mode = FALSE, + wifi_scan = FALSE, wifi_connected = FALSE; + boolean bt_idle = FALSE, wl_idle = FALSE, is_cck_deadlock = FALSE; + static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, + wl_noisy_count1 = 3, wl_noisy_count2 = 0; + u32 total_cnt, reg_val1, reg_val2, cnt_cck; + u32 cnt_crcok = 0, cnt_crcerr = 0; + static u8 cnt = 0, cnt_ccklocking = 0; + u8 h2c_parameter[1] = {0}; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + /* Only enable for windows becaus 8821cu H2C 0x69 unknown fail @ linux */ + if (btcoexist->chip_interface != BTC_INTF_USB) { + /*send h2c to query WL FW dbg info */ + if (((coex_dm->cur_ps_tdma_on) && (coex_sta->force_lps_ctrl)) || + ((coex_sta->acl_busy) && (bt_link_info->a2dp_exist))) { + h2c_parameter[0] = 0x8; + btcoexist->btc_fill_h2c(btcoexist, 0x69, 1, h2c_parameter); + } + } + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + + cnt_crcok = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + + coex_sta->crc_ok_11n_vht; + + cnt_crcerr = coex_sta->crc_err_cck + coex_sta->crc_err_11g + + coex_sta->crc_err_11n + + coex_sta->crc_err_11n_vht; + + /* CCK lock identification */ + if (coex_sta->cck_lock) + cnt_ccklocking++; + else if (cnt_ccklocking != 0) + cnt_ccklocking--; + + if (cnt_ccklocking >= 3) { + cnt_ccklocking = 3; + coex_sta->cck_lock_ever = TRUE; + } + + /* WiFi environment noisy identification */ + cnt_cck = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + + if ((!wifi_busy) && (!coex_sta->cck_lock)) { + if (cnt_cck > 250) { + if (wl_noisy_count2 < 3) + wl_noisy_count2++; + + if (wl_noisy_count2 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count1 = 0; + } + + } else if (cnt_cck < 50) { + if (wl_noisy_count0 < 3) + wl_noisy_count0++; + + if (wl_noisy_count0 == 3) { + wl_noisy_count1 = 0; + wl_noisy_count2 = 0; + } + + } else { + if (wl_noisy_count1 < 3) + wl_noisy_count1++; + + if (wl_noisy_count1 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count2 = 0; + } + } + + if (wl_noisy_count2 == 3) + coex_sta->wl_noisy_level = 2; + else if (wl_noisy_count1 == 3) + coex_sta->wl_noisy_level = 1; + else + coex_sta->wl_noisy_level = 0; + } + +} + + +void halbtc8821c1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + boolean bt_busy = FALSE; + + + coex_sta->num_of_profile = 0; + + /* set link exist status */ + if (!(coex_sta->bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { + coex_sta->bt_link_exist = FALSE; + coex_sta->pan_exist = FALSE; + coex_sta->a2dp_exist = FALSE; + coex_sta->hid_exist = FALSE; + coex_sta->sco_exist = FALSE; + } else { /* connection exists */ + coex_sta->bt_link_exist = TRUE; + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_FTP) { + coex_sta->pan_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->pan_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_A2DP) { + coex_sta->a2dp_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->a2dp_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_HID) { + coex_sta->hid_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->hid_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) { + coex_sta->sco_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->sco_exist = FALSE; + + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + bt_link_info->bt_link_exist = coex_sta->bt_link_exist; + bt_link_info->sco_exist = coex_sta->sco_exist; + bt_link_info->a2dp_exist = coex_sta->a2dp_exist; + bt_link_info->pan_exist = coex_sta->pan_exist; + bt_link_info->hid_exist = coex_sta->hid_exist; + bt_link_info->acl_busy = coex_sta->acl_busy; + + /* work around for HS mode. */ + if (bt_hs_on) { + bt_link_info->pan_exist = TRUE; + bt_link_info->bt_link_exist = TRUE; + } + + /* check if Sco only */ + if (bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->sco_only = TRUE; + else + bt_link_info->sco_only = FALSE; + + /* check if A2dp only */ + if (!bt_link_info->sco_exist && + bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->a2dp_only = TRUE; + else + bt_link_info->a2dp_only = FALSE; + + /* check if Pan only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->pan_only = TRUE; + else + bt_link_info->pan_only = FALSE; + + /* check if Hid only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + bt_link_info->hid_exist) + bt_link_info->hid_only = TRUE; + else + bt_link_info->hid_only = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_INQ_PAGE) { + coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_INQ_PAGE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); + } else if (!(coex_sta->bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { + coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); + } else if (coex_sta->bt_info == BT_INFO_8821C_1ANT_B_CONNECTION) { + /* connection exists but no busy */ + coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); + } else if (((coex_sta->bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_SCO_BUSY)) && + (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_ACL_BUSY)) { + coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); + } else if ((coex_sta->bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_SCO_BUSY)) { + coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); + } else if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_ACL_BUSY) { + coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_ACL_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); + } else { + coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_MAX; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); + } + + BTC_TRACE(trace_buf); + + if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + bt_busy = TRUE; + else + bt_busy = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); +} + +void halbtc8821c1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_parameter[3] = {0}, i; + u32 wifi_bw; + u8 wifi_central_chnl = 0; + u8 wifi_5g_chnl[19] = {120, 124, 128, 132, 136, 140, 144, 149, + 153, 157, 118, 126, 134, 142, 151, 159, + 122, 138, 155}; + u8 bt_skip_cneter_chanl[19] = {2, 8, 17, 26, 34, 42, 51, 62, + 71, 77, 2, 12, 29, 46, 66, 76, + 10, 37, 68}; + u8 bt_skip_span[19] = {4, 8, 8, 10, 8, 10, 8, 8, 10, 4, 4, 16, + 16, 16, 16, 4, 20, 34, 20}; + boolean wifi_under_5g = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (type == BTC_MEDIA_CONNECT) { + + if (!wifi_under_5g) { + + btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, + &wifi_central_chnl); + + h2c_parameter[0] = 0x1; + h2c_parameter[1] = wifi_central_chnl; + + if (wifi_bw == BTC_WIFI_BW_HT40) + h2c_parameter[2] = 0x30; + else + h2c_parameter[2] = 0x20; + } else { /* for 5G */ + + wifi_central_chnl = + btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x18, 0xfffff) & 0xff; + + for (i = 0; i <= 18; i++) { + if (wifi_central_chnl == wifi_5g_chnl[i]) + break; + } + + if (i <= 18) { + h2c_parameter[0] = 0x3; + h2c_parameter[1] = bt_skip_cneter_chanl[i]; + h2c_parameter[2] = bt_skip_span[i]; + } + + } + } + + coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; + coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; + coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; + coex_sta->wl_center_channel = wifi_central_chnl; + + btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], para[0:2] = 0x%x 0x%x 0x%x\n", + h2c_parameter[0], h2c_parameter[1], h2c_parameter[2]); + BTC_TRACE(trace_buf); + +} + +u8 halbtc8821c1ant_action_algorithm(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + u8 algorithm = BT_8821C_1ANT_COEX_ALGO_UNDEFINED; + u8 num_of_diff_profile = 0; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + if (!bt_link_info->bt_link_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No BT link exists!!!\n"); + BTC_TRACE(trace_buf); + return algorithm; + } + + if (bt_link_info->sco_exist) + num_of_diff_profile++; + if (bt_link_info->hid_exist) + num_of_diff_profile++; + if (bt_link_info->pan_exist) + num_of_diff_profile++; + if (bt_link_info->a2dp_exist) + num_of_diff_profile++; + + if (num_of_diff_profile == 1) { + if (bt_link_info->sco_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; + } else { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_HID; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = A2DP only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_A2DP; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = PAN(HS) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = PAN(EDR) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANEDR; + } + } + } + } else if (num_of_diff_profile == 2) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_HID; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + A2DP\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_HID_A2DP; + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_HID_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP; + } + } + } + } else if (num_of_diff_profile == 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_HID; + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_HID_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_1ANT_COEX_ALGO_SCO; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_HID_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR; + } + } + } + } else if (num_of_diff_profile >= 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8821C_1ANT_COEX_ALGO_PANEDR_HID; + } + } + } + } + + return algorithm; +} + +void halbtc8821c1ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, + IN boolean enable_auto_report) +{ + u8 h2c_parameter[1] = {0}; + + h2c_parameter[0] = 0; + + if (enable_auto_report) + h2c_parameter[0] |= BIT(0); + + btcoexist->btc_fill_h2c(btcoexist, 0x68, 1, h2c_parameter); +} + +void halbtc8821c1ant_bt_auto_report(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable_auto_report) +{ + coex_dm->cur_bt_auto_report = enable_auto_report; + + if (!force_exec) { + if (coex_dm->pre_bt_auto_report == coex_dm->cur_bt_auto_report) + return; + } + halbtc8821c1ant_set_bt_auto_report(btcoexist, + coex_dm->cur_bt_auto_report); + + coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; +} + + +void halbtc8821c1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean low_penalty_ra) +{ + +#if 1 + coex_dm->cur_low_penalty_ra = low_penalty_ra; + + if (!force_exec) { + if (coex_dm->pre_low_penalty_ra == + coex_dm->cur_low_penalty_ra) + return; + } + + if (low_penalty_ra) + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 15); + else + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); + + coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; + +#endif + +} + +void halbtc8821c1ant_write_score_board( + IN struct btc_coexist *btcoexist, + IN u16 bitpos, + IN boolean state +) +{ + + static u16 originalval = 0x8002, preval = 0x0; + + if (state) + originalval = originalval | bitpos; + else + originalval = originalval & (~bitpos); + + coex_sta->score_board_WB = originalval; + + if (originalval != preval) { + + preval = originalval; + btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c1ant_write_score_board: return for nochange\n"); + BTC_TRACE(trace_buf); + } +} + +void halbtc8821c1ant_read_score_board( + IN struct btc_coexist *btcoexist, + IN u16 *score_board_val +) +{ + + *score_board_val = (btcoexist->btc_read_2byte(btcoexist, + 0xaa)) & 0x7fff; +} + +void halbtc8821c1ant_post_state_to_bt( + IN struct btc_coexist *btcoexist, + IN u16 type, + IN boolean state +) +{ + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c1ant_post_state_to_bt: type = %d, state =%d\n", + type, state); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_write_score_board(btcoexist, (u16) type, state); +} + +boolean halbtc8821c1ant_is_wifibt_status_changed(IN struct btc_coexist + *btcoexist) +{ + static boolean pre_wifi_busy = FALSE, pre_under_4way = FALSE, + pre_bt_hs_on = FALSE, pre_bt_off = FALSE, + pre_bt_slave = FALSE, pre_hid_low_pri_tx_overhead = FALSE, + pre_wifi_under_lps = FALSE, pre_bt_setup_link = FALSE, + pre_cck_lock = FALSE, pre_cck_lock_warn = FALSE; + static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; + boolean wifi_busy = FALSE, under_4way = FALSE, bt_hs_on = FALSE; + boolean wifi_connected = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (coex_sta->bt_disabled != pre_bt_off) { + pre_bt_off = coex_sta->bt_disabled; + + if (coex_sta->bt_disabled) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is enabled !!\n"); + + BTC_TRACE(trace_buf); + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->bt_reg_vendor_ac = 0xffff; + coex_sta->bt_reg_vendor_ae = 0xffff; + return TRUE; + } + + + if (wifi_connected) { +#if 0 + if ((wifi_busy) && + (coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_BUSY)) + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, TRUE); + else + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, FALSE); +#endif + if (wifi_busy != pre_wifi_busy) { + pre_wifi_busy = wifi_busy; + return TRUE; + } + if (under_4way != pre_under_4way) { + pre_under_4way = under_4way; + return TRUE; + } + if (bt_hs_on != pre_bt_hs_on) { + pre_bt_hs_on = bt_hs_on; + return TRUE; + } + if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { + pre_wl_noisy_level = coex_sta->wl_noisy_level; + return TRUE; + } + if (coex_sta->under_lps != pre_wifi_under_lps) { + pre_wifi_under_lps = coex_sta->under_lps; + if (coex_sta->under_lps == TRUE) + return TRUE; + } + if (coex_sta->cck_lock != pre_cck_lock) { + pre_cck_lock = coex_sta->cck_lock; + return TRUE; + } + if (coex_sta->cck_lock_warn != pre_cck_lock_warn) { + pre_cck_lock_warn = coex_sta->cck_lock_warn; + return TRUE; + } + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->hid_busy_num != pre_hid_busy_num) { + pre_hid_busy_num = coex_sta->hid_busy_num; + return TRUE; + } + + if (bt_link_info->slave_role != pre_bt_slave) { + pre_bt_slave = bt_link_info->slave_role; + return TRUE; + } + + if (pre_hid_low_pri_tx_overhead != coex_sta->is_hid_low_pri_tx_overhead) { + pre_hid_low_pri_tx_overhead = coex_sta->is_hid_low_pri_tx_overhead; + return TRUE; + } + + if (pre_bt_setup_link != coex_sta->is_setupLink) { + pre_bt_setup_link = coex_sta->is_setupLink; + return TRUE; + } + } + + return FALSE; +} + + +void halbtc8821c1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) +{ + static u32 bt_disable_cnt = 0; + boolean bt_active = TRUE, bt_disabled = FALSE, wifi_under_5g = FALSE; + u16 u16tmp; + + /* This function check if bt is disabled */ +#if 0 + if (coex_sta->high_priority_tx == 0 && + coex_sta->high_priority_rx == 0 && + coex_sta->low_priority_tx == 0 && + coex_sta->low_priority_rx == 0) + bt_active = FALSE; + if (coex_sta->high_priority_tx == 0xffff && + coex_sta->high_priority_rx == 0xffff && + coex_sta->low_priority_tx == 0xffff && + coex_sta->low_priority_rx == 0xffff) + bt_active = FALSE; + + +#else + + /* Read BT on/off status from scoreboard[1], enable this only if BT patch support this feature */ + halbtc8821c1ant_read_score_board(btcoexist, &u16tmp); + + bt_active = u16tmp & BIT(1); + + +#endif + + if (bt_active) { + bt_disable_cnt = 0; + bt_disabled = FALSE; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + } else { + + bt_disable_cnt++; + if (bt_disable_cnt >= 2) { + bt_disabled = TRUE; + bt_disable_cnt = 2; + } + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((wifi_under_5g) || (bt_disabled)) + halbtc8821c1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); + else + halbtc8821c1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, TRUE); + + + if (coex_sta->bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->bt_disabled ? "disabled" : "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + coex_sta->bt_disabled = bt_disabled; + } + +} + +void halbtc8821c1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, + boolean isenable) +{ +#if BT_8821C_1ANT_COEX_DBG + static u8 bitVal[5] = {0, 0, 0, 0, 0}; + static boolean state = FALSE; + /* + if (state ==isenable) + return; + else + state = isenable; + */ + if (isenable) { + + /* enable GNT_WL, GNT_BT to GPIO for debug */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); + + /* store original value */ + bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, + 0x66) & BIT(4)) >> 4; /*0x66[4] */ + bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, + 0x67) & BIT(0)); /*0x66[8] */ + bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, + 0x42) & BIT(3)) >> 3; /*0x40[19] */ + bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, + 0x65) & BIT(7)) >> 7; /*0x64[15] */ + bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, + 0x72) & BIT(2)) >> 2; /*0x70[18] */ + + /* switch GPIO Mux */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + 0x0); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + 0x0); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + 0x0); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + 0x0); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + 0x0); /*0x70[18] = 0 */ + + + } else { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); + + /* Restore original value */ + /* switch GPIO Mux */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + bitVal[0]); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + bitVal[1]); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + bitVal[2]); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + bitVal[3]); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + bitVal[4]); /*0x70[18] = 0 */ + } + +#endif +} + +u32 halbtc8821c1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, + IN u16 reg_addr) +{ + u32 j = 0, delay_count = 0; + + /* wait for ready bit before access 0x1700 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + + btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); + + return btcoexist->btc_read_4byte(btcoexist, + 0x1708); /* get read data */ +} + +void halbtc8821c1ant_ltecoex_indirect_write_reg(IN struct btc_coexist + *btcoexist, + IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) +{ + u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; + + if (bit_mask == 0x0) + return; + + if (bit_mask == 0xffffffff) { + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + + btcoexist->btc_write_4byte(btcoexist, 0x1704, + reg_value); /* put write data */ + + btcoexist->btc_write_4byte(btcoexist, 0x1700, + 0xc00F0000 | reg_addr); + } else { + for (i = 0; i <= 31; i++) { + if (((bit_mask >> i) & 0x1) == 0x1) { + bitpos = i; + break; + } + } + + /* read back register value before write */ + val = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + reg_addr); + val = (val & (~bit_mask)) | (reg_value << bitpos); + + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + + btcoexist->btc_write_4byte(btcoexist, 0x1704, + val); /* put write data */ + + btcoexist->btc_write_4byte(btcoexist, 0x1700, + 0xc00F0000 | reg_addr); + + } + +} + +void halbtc8821c1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + u8 val; + + val = (enable) ? 1 : 0; + halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, + val); /* 0x38[7] */ + +} + +void halbtc8821c1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, + IN boolean wifi_control) +{ + u8 val; + + val = (wifi_control) ? 1 : 0; + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, + val); /* 0x70[26] */ + +} + +void halbtc8821c1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, + IN u8 control_block, IN boolean sw_control, IN u8 state) +{ + u32 val = 0, val_orig = 0; + + if (!sw_control) + val = 0x0; + else if (state & 0x1) + val = 0x3; + else + val = 0x1; + + val_orig = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + + switch (control_block) { + case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: + default: + val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); + break; + case BT_8821C_1ANT_GNT_BLOCK_RFC: + val = (val << 14) | (val_orig & 0xffff3fff); + break; + case BT_8821C_1ANT_GNT_BLOCK_BB: + val = (val << 10) | (val_orig & 0xfffff3ff); + break; + } + + halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, 0xffffffff, val); +} + +void halbtc8821c1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, + IN u8 control_block, IN boolean sw_control, IN u8 state) +{ + u32 val = 0, val_orig = 0; + + if (!sw_control) + val = 0x0; + else if (state & 0x1) + val = 0x3; + else + val = 0x1; + + val_orig = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + + switch (control_block) { + case BT_8821C_1ANT_GNT_BLOCK_RFC_BB: + default: + val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); + break; + case BT_8821C_1ANT_GNT_BLOCK_RFC: + val = (val << 12) | (val_orig & 0xffffcfff); + break; + case BT_8821C_1ANT_GNT_BLOCK_BB: + val = (val << 8) | (val_orig & 0xfffffcff); + break; + } + + halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, 0xffffffff, val); +} + +void halbtc8821c1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, + IN u8 table_type, IN u16 table_content) +{ + u16 reg_addr = 0x0000; + + switch (table_type) { + case BT_8821C_1ANT_CTT_WL_VS_LTE: + reg_addr = 0xa0; + break; + case BT_8821C_1ANT_CTT_BT_VS_LTE: + reg_addr = 0xa4; + break; + } + + if (reg_addr != 0x0000) + halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, + 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ + + +} + + +void halbtc8821c1ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, + IN u8 table_type, IN u8 table_content) +{ + u16 reg_addr = 0x0000; + + switch (table_type) { + case BT_8821C_1ANT_LBTT_WL_BREAK_LTE: + reg_addr = 0xa8; + break; + case BT_8821C_1ANT_LBTT_BT_BREAK_LTE: + reg_addr = 0xac; + break; + case BT_8821C_1ANT_LBTT_LTE_BREAK_WL: + reg_addr = 0xb0; + break; + case BT_8821C_1ANT_LBTT_LTE_BREAK_BT: + reg_addr = 0xb4; + break; + } + + if (reg_addr != 0x0000) + halbtc8821c1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, + 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ + + +} + +void halbtc8821c1ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 interval, + IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, + IN u8 val0x6c4_b3) +{ + static u8 pre_h2c_parameter[6] = {0}; + u8 cur_h2c_parameter[6] = {0}; + u8 i, match_cnt = 0; + + cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ + + cur_h2c_parameter[1] = interval; + cur_h2c_parameter[2] = val0x6c4_b0; + cur_h2c_parameter[3] = val0x6c4_b1; + cur_h2c_parameter[4] = val0x6c4_b2; + cur_h2c_parameter[5] = val0x6c4_b3; + + if (!force_exec) { + for (i = 1; i <= 5; i++) { + if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) + break; + + match_cnt++; + } + + if (match_cnt == 5) + return; + } + + for (i = 1; i <= 5; i++) + pre_h2c_parameter[i] = cur_h2c_parameter[i]; + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); +} + + +void halbtc8821c1ant_set_coex_table(IN struct btc_coexist *btcoexist, + IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) +{ + btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); + + btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); + + btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); + + btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); +} + +void halbtc8821c1ant_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, + IN u32 val0x6c8, IN u8 val0x6cc) +{ + coex_dm->cur_val0x6c0 = val0x6c0; + coex_dm->cur_val0x6c4 = val0x6c4; + coex_dm->cur_val0x6c8 = val0x6c8; + coex_dm->cur_val0x6cc = val0x6cc; + + if (!force_exec) { + if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && + (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && + (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && + (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) + return; + } + + halbtc8821c1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, + val0x6cc); + + coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; + coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; + coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; + coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; +} + +void halbtc8821c1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + u32 break_table; + u8 select_table; + + coex_sta->coex_table_type = type; + + if (coex_sta->concurrent_rx_mode_on == TRUE) { + /* set WL hi-pri can break BT */ + break_table = 0xf0ffffff; + /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ + select_table = 0xb; + } else { + break_table = 0xffffff; + select_table = 0x3; + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** Table-%d **********\n", + coex_sta->coex_table_type); + BTC_TRACE(trace_buf); + + switch (type) { + case 0: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555555, break_table, + select_table); + break; + case 1: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, + select_table); + break; + case 2: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xaa5a5a5a, 0xaa5a5a5a, break_table, + select_table); + break; + case 3: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0x5a5a5a5a, break_table, + select_table); + break; + case 4: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, + select_table); + break; + case 5: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0x5a5a5a5a, break_table, + select_table); + break; + case 6: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, + select_table); + break; + case 7: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xaa555555, 0xaa555555, break_table, + select_table); + break; + case 8: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaaaa5aaa, break_table, + select_table); + break; + case 9: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0xaaaa5aaa, break_table, + select_table); + break; + case 10: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xaaaaaaaa, 0xaaaaaaaa, break_table, + select_table); + break; + case 11: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xa5a55555, 0xaaaa5a5a, break_table, + select_table); + break; + case 12: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaaaa5a5a, break_table, + select_table); + break; + case 13: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xaa5555aa, 0xaa5a5a5a, break_table, + select_table); + break; + case 14: + halbtc8821c1ant_coex_table(btcoexist, force_exec, + 0xaa5555aa, 0x5a5a5a5a, break_table, + select_table); + break; + default: + break; + } +} + +void halbtc8821c1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + u8 h2c_parameter[1] = {0}; + + if (enable) + h2c_parameter[0] |= BIT(0); /* function enable */ + + btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); +} + +void halbtc8821c1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable) +{ + coex_dm->cur_ignore_wlan_act = enable; + + if (!force_exec) { + if (coex_dm->pre_ignore_wlan_act == + coex_dm->cur_ignore_wlan_act) + return; + } + halbtc8821c1ant_set_fw_ignore_wlan_act(btcoexist, enable); + + coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; +} + +void halbtc8821c1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, + IN u8 lps_val, IN u8 rpwm_val) +{ + u8 lps = lps_val; + u8 rpwm = rpwm_val; + + btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); + btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); +} + +void halbtc8821c1ant_lps_rpwm(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) +{ + coex_dm->cur_lps = lps_val; + coex_dm->cur_rpwm = rpwm_val; + + if (!force_exec) { + if ((coex_dm->pre_lps == coex_dm->cur_lps) && + (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) + return; + } + halbtc8821c1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); + + coex_dm->pre_lps = coex_dm->cur_lps; + coex_dm->pre_rpwm = coex_dm->cur_rpwm; +} + +void halbtc8821c1ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +{ + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + /* will leave LPS state, turn off psTdma first */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } + } else { /* NO PS state */ + if (new_ps_state) { + /* will enter LPS state, turn off psTdma first */ + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } else { + /* keep state under NO PS state, do nothing. */ + } + } +} + +boolean halbtc8821c1ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = FALSE, result = TRUE; + + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + coex_sta->force_lps_ctrl = FALSE; + low_pwr_disable = FALSE; + /* btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_PRE_NORMAL_LPS, + NULL); + + break; + case BTC_PS_LPS_ON: + coex_sta->force_lps_ctrl = TRUE; + halbtc8821c1ant_ps_tdma_check_for_power_save_state( + btcoexist, TRUE); + halbtc8821c1ant_lps_rpwm(btcoexist, NORMAL_EXEC, + lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = TRUE; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + /* power save must executed before psTdma. */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, + NULL); + + break; + case BTC_PS_LPS_OFF: + coex_sta->force_lps_ctrl = TRUE; + halbtc8821c1ant_ps_tdma_check_for_power_save_state( + btcoexist, FALSE); + result = btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + + break; + default: + break; + } + + return result; +} + + +void halbtc8821c1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, + IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) +{ + u8 h2c_parameter[5] = {0}; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = FALSE, result = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 ps_type = BTC_PS_WIFI_NATIVE; + + if (byte5 & BIT(2)) + coex_sta->is_tdma_btautoslot = TRUE; + else + coex_sta->is_tdma_btautoslot = FALSE; + + /* release bt-auto slot for auto-slot hang is detected!! */ + if (coex_sta->is_tdma_btautoslot) + if ((coex_sta->is_tdma_btautoslot_hang) || + (bt_link_info->slave_role)) + byte5 = byte5 & 0xfb; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c1ant_set_fw_pstdma == FW for 1Ant AP mode\n"); + BTC_TRACE(trace_buf); + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8821c1ant_power_save_state(btcoexist, + ps_type, 0x0, + 0x0); + } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c1ant_set_fw_pstdma == Force LPS Leave (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); + + ps_type = BTC_PS_LPS_OFF; + if (!halbtc8821c1ant_power_save_state(btcoexist, ps_type, 0x50, 0x4)) + result = TRUE; + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c1ant_set_fw_pstdma == native power save (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); + + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8821c1ant_power_save_state(btcoexist, ps_type, + 0x0, + 0x0); + } + + coex_sta->is_set_ps_state_fail = result; + + if (!coex_sta->is_set_ps_state_fail) { + h2c_parameter[0] = real_byte1; + h2c_parameter[1] = byte2; + h2c_parameter[2] = byte3; + h2c_parameter[3] = byte4; + h2c_parameter[4] = real_byte5; + + coex_dm->ps_tdma_para[0] = real_byte1; + coex_dm->ps_tdma_para[1] = byte2; + coex_dm->ps_tdma_para[2] = byte3; + coex_dm->ps_tdma_para[3] = byte4; + coex_dm->ps_tdma_para[4] = real_byte5; + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + + } else { + coex_sta->cnt_set_ps_state_fail++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c1ant_set_fw_pstdma == Force Leave LPS Fail (cnt = %d)\n", + coex_sta->cnt_set_ps_state_fail); + BTC_TRACE(trace_buf); + } + + if (ps_type == BTC_PS_WIFI_NATIVE) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_POST_NORMAL_LPS, NULL); +} + + +void halbtc8821c1ant_ps_tdma(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean turn_on, IN u8 type) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + struct btc_board_info *board_info = &btcoexist->board_info; + boolean wifi_busy = FALSE; + static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; + static boolean pre_wifi_busy = FALSE; + + + coex_dm->cur_ps_tdma_on = turn_on; + coex_dm->cur_ps_tdma = type; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (wifi_busy != pre_wifi_busy) { + force_exec = TRUE; + pre_wifi_busy = wifi_busy; + } + + /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ + if ((bt_link_info->slave_role) && (bt_link_info->a2dp_exist)) + psTdmaByte4Modify = 0x1; + else + psTdmaByte4Modify = 0x0; + + if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { + force_exec = TRUE; + pre_psTdmaByte4Modify = psTdmaByte4Modify; + } + + if (!force_exec) { + if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && + (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", + (coex_dm->cur_ps_tdma_on ? "on" : "off"), + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + return; + } + } + + if (coex_dm->cur_ps_tdma_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(on, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, + 0x1); /* enable TBTT nterrupt */ + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(off, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + } + + + if (turn_on) { + switch (type) { + default: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x35, 0x03, 0x11, 0x11); + break; + case 3: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x30, 0x03, 0x10, 0x50); + break; + case 4: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x21, 0x03, 0x10, 0x50); + break; + case 5: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x3a, 0x03, 0x11, 0x11); + break; + case 6: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x20, 0x03, 0x11, 0x10); + break; + case 7: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 8: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 9: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 10: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x30, 0x03, 0x11, 0x10); + break; + case 11: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x25, 0x03, 0x11, 0x11); + break; + case 12: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x35, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 13: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x07, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 14: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x15, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 15: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x20, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 16: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x15 | + psTdmaByte4Modify); + break; + case 17: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x14 | + psTdmaByte4Modify); + break; + case 18: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x30, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 19: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x15, 0x03, 0x11, 0x10); + break; + case 20: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x30, 0x03, 0x11, 0x10); + break; + case 21: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x30, 0x03, 0x11, 0x10); + break; + case 22: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x25, 0x03, 0x11, 0x10); + break; + case 23: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x10); + break; + case 24: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x08, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 27: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x15); + break; + case 28: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x0b, 0x10, 0x54); + break; + case 32: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x35, 0x03, 0x11, 0x11); + break; + case 33: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x35, 0x03, 0x11, 0x10); + break; + case 57: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 58: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 67: + halbtc8821c1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x10 | + psTdmaByte4Modify); + break; + } + } else { + + /* disable PS tdma */ + switch (type) { + case 8: /* PTA Control */ + halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x8, + 0x0, 0x0, 0x0, 0x0); + break; + case 0: + default: /* Software control, Antenna at BT side */ + halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x0, 0x0); + break; + case 1: /* 2-Ant, 0x778=3, antenna control by antenna diversity */ + halbtc8821c1ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x48, 0x0); + break; + } + } + + if (!coex_sta->is_set_ps_state_fail) { + /* update pre state */ + coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; + coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; + } +} + +void halbtc8821c1ant_set_int_block(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 pos_type) +{ +#if 0 + u8 regval_0xcba; + u32 u32tmp1 = 0; + + coex_dm->cur_int_block_status = pos_type; + + if (!force_exec) { + if (coex_dm->pre_int_block_status == + coex_dm->cur_int_block_status) + return; + } + + coex_dm->pre_int_block_status = coex_dm->cur_int_block_status; + + regval_0xcba = btcoexist->btc_read_1byte(btcoexist, 0xcba); + + switch (pos_type) { + + case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: + regval_0xcba = (regval_0xcba | BIT(0)) & (~(BIT( + 2))); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ + regval_0xcba = regval_0xcba & 0x0f; + + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc1d, 0x0f, 0x5); */ /* Gain Table */ + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xa9e, 0x0f, 0x2); */ /* CCK Gain Table */ + + break; + case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: + regval_0xcba = regval_0xcba & (~(BIT(2) | BIT( + 0))); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ + + /* regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; */ /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ + /* regval_0xcba = (regval_0xcba | BIT(6)) & (~(BIT(7)) ) ; */ /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc1d, 0x0f, 0x0); */ /* Gain Table */ + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xa9e, 0x0f, 0x6); */ /* CCK Gain Table */ + + break; + case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: + regval_0xcba = regval_0xcba & (~(BIT(2) | BIT( + 0))); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ + /*regval_0xcba = (regval_0xcba | BIT(4)) & (~(BIT(5))); */ /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ + /*regval_0xcba = regval_0xcba | BIT(6) | BIT(7); */ /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ + + break; + } + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, + regval_0xcba); + + u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb8); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (After Int Block setup) 0xcb8 = 0x%08x **********\n", + u32tmp1); + BTC_TRACE(trace_buf); + +#endif +} + +void halbtc8821c1ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 pos_type) +{ + +#if 0 + boolean switch_polatiry_inverse = FALSE; + u8 regval_0xcb6; + u32 u32tmp1 = 0, u32tmp2 = 0; + + if (!rfe_type->ext_band_switch_exist) + return; + + coex_dm->cur_ext_band_switch_status = pos_type; + + if (!force_exec) { + if (coex_dm->pre_ext_band_switch_status == + coex_dm->cur_ext_band_switch_status) + return; + } + + coex_dm->pre_ext_band_switch_status = + coex_dm->cur_ext_band_switch_status; + + /* swap control polarity if use different switch control polarity*/ + switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1 + ? ~switch_polatiry_inverse : switch_polatiry_inverse); + + /*swap control polarity for WL_A, default polarity 0xcb4[21] = 0 && 0xcb4[23] = 1 is for WL_G */ + switch_polatiry_inverse = (pos_type == + BT_8821C_1ANT_EXT_BAND_SWITCH_TO_WLA ? ~switch_polatiry_inverse + : switch_polatiry_inverse); + + regval_0xcb6 = btcoexist->btc_read_1byte(btcoexist, 0xcb6); + + /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ + regval_0xcb6 = (switch_polatiry_inverse == 1 ? ((regval_0xcb6 & (~(BIT( + 7)))) | BIT(5)) : ((regval_0xcb6 & (~(BIT(5)))) | BIT(7))); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, + regval_0xcb6); + + u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb0); + u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (After Ext Band switch setup) 0xcb0 = 0x%08x, 0xcb4 = 0x%08x**********\n", + u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); +#endif + +} + +void halbtc8821c1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + boolean switch_polatiry_inverse = FALSE; + u8 regval_0xcb7 = 0, regval_0x64; + u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; + + if (!rfe_type->ext_ant_switch_exist) + return; + + coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; + + if (!force_exec) { + if (coex_dm->pre_ext_ant_switch_status == + coex_dm->cur_ext_ant_switch_status) + return; + } + + coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; + + /* swap control polarity if use different switch control polarity*/ + /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ + /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ + if (rfe_type->ext_ant_switch_ctrl_polarity) + switch_polatiry_inverse = ~switch_polatiry_inverse; + + /* swap control polarity if 1-Ant at Aux */ + if (rfe_type->ant_at_main_port == FALSE) + switch_polatiry_inverse = ~switch_polatiry_inverse; + + switch (pos_type) { + default: + case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT: + case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE: + case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA: + + break; + case BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG: + if (!rfe_type->wlg_Locate_at_btg) + switch_polatiry_inverse = ~switch_polatiry_inverse; + break; + } + + if (board_info->ant_div_cfg) + ctrl_type = BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV; + + + switch (ctrl_type) { + default: + case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ + + regval_0xcb7 = (switch_polatiry_inverse == FALSE ? + 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, + 0x30, regval_0xcb7); + + break; + case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ + + regval_0xcb7 = (switch_polatiry_inverse == FALSE ? + 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, + 0x30, regval_0xcb7); + + break; + case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x88); /* */ + + /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ + + break; + case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x1); /* 0x4c[23] = 1 */ + + regval_0x64 = (switch_polatiry_inverse == FALSE ? 0x0 : + 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, + regval_0x64); + break; + case BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x0); /* 0x4c[24] = 0 */ + + /* no setup required, because antenna switch control value by BT vendor 0xac[1:0] */ + break; + } + + /* PAPE, LNA_ON control by BT while WLAN off for current leakage issue */ + if (ctrl_type == BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT) { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x0); /* PAPE 0x64[29] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x10, + 0x0); /* LNA_ON 0x64[28] = 0 */ + } else { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x1); /* PAPE 0x64[29] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x10, + 0x1); /* LNA_ON 0x64[28] = 1 */ + } + +#if BT_8821C_1ANT_COEX_DBG + u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x\n", + u32tmp1, u32tmp2, u32tmp3); + BTC_TRACE(trace_buf); +#endif + +} + +void halbtc8821c1ant_set_rfe_type(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + + + /* the following setup should be got from Efuse in the future */ + rfe_type->rfe_module_type = board_info->rfe_type & 0x1f; + + rfe_type->ext_ant_switch_ctrl_polarity = 0; + + switch (rfe_type->rfe_module_type) { + case 0: + case 8: + default: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 1: + case 9: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, WLG */ + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 2: + case 10: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, BTG */ + rfe_type->wlg_Locate_at_btg = TRUE; + rfe_type->ant_at_main_port = TRUE; + break; + case 3: + case 11: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, WLG */ + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = FALSE; + break; + case 4: + case 12: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, BTG */ + rfe_type->wlg_Locate_at_btg = TRUE; + rfe_type->ant_at_main_port = FALSE; + break; + case 5: + case 13: + rfe_type->ext_ant_switch_exist = FALSE; /*2-Ant, no switch, WLG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_NONE; + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 6: + case 14: + rfe_type->ext_ant_switch_exist = FALSE; /*2-Ant, no antenna switch, WLG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_NONE; + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 7: + case 15: + rfe_type->ext_ant_switch_exist = TRUE; /*2-Ant, DPDT, BTG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; + rfe_type->wlg_Locate_at_btg = TRUE; + rfe_type->ant_at_main_port = TRUE; + break; + } + +#if 0 + if (rfe_type->wlg_Locate_at_btg) + halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, + BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); + else + halbtc8821c1ant_set_int_block(btcoexist, FORCE_EXEC, + BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); +#endif + +} + + +void halbtc8821c1ant_set_ant_path(IN struct btc_coexist *btcoexist, + IN u8 ant_pos_type, IN boolean force_exec, + IN u8 phase) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u32 cnt_bt_cal_chk = 0; + boolean is_in_mp_mode = FALSE; + u8 u8tmp = 0; + u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; + u16 u16tmp1 = 0; + + + u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + + /* To avoid indirect access fail */ + if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { + force_exec = TRUE; + coex_sta->gnt_error_cnt++; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],(Before Ant Setup) 0x38= 0x%x\n", + u32tmp1); + BTC_TRACE(trace_buf); + } + + +#if BT_8821C_1ANT_COEX_DBG + + u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0x54); + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); + + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],(Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + u32tmp3, u8tmp, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); +#endif + + coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],(Before Ant Setup) pre_ant_pos_type = 0x%x, cur_ant_pos_type = 0x%x\n", + coex_dm->pre_ant_pos_type, + coex_dm->cur_ant_pos_type); + BTC_TRACE(trace_buf); + + + if (!force_exec) { + if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) + return; + } + + coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; + + + switch (phase) { + case BT_8821C_1ANT_PHASE_COEX_POWERON: + + /* set Path control owner to BT at power-on step */ + halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8821C_1ANT_PCO_BTSIDE); + + /* set GNT_BT to SW high */ + halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW high */ + halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; + + coex_sta->run_time_state = FALSE; + + break; + case BT_8821C_1ANT_PHASE_COEX_INIT: + /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ + halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c1ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_1ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c1ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_1ANT_CTT_BT_VS_LTE, + 0xffff); + + /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ + while (cnt_bt_cal_chk <= 20) { + u8tmp = btcoexist->btc_read_1byte( + btcoexist, + 0x49c); + cnt_bt_cal_chk++; + if (u8tmp & BIT(1)) { + BTC_SPRINTF( + trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", + cnt_bt_cal_chk); + BTC_TRACE( + trace_buf); + delay_ms(50); + } else { + BTC_SPRINTF( + trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", + cnt_bt_cal_chk); + BTC_TRACE( + trace_buf); + break; + } + } + + /* set Path control owner to WL at initial step */ + halbtc8821c1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_1ANT_PCO_WLSIDE); + + /* set GNT_BT to SW high */ + halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW low */ + halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_LOW); + + coex_sta->run_time_state = FALSE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; + + break; + case BT_8821C_1ANT_PHASE_WLANONLY_INIT: + /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ + halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c1ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_1ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c1ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_1ANT_CTT_BT_VS_LTE, + 0xffff); + + /* set Path control owner to WL at initial step */ + halbtc8821c1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_1ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Low */ + halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_LOW); + /* Set GNT_WL to SW high */ + halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = FALSE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_WIFI; + + break; + case BT_8821C_1ANT_PHASE_WLAN_OFF: + /* Disable LTE Coex Function in WiFi side */ + halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); + + /* set Path control owner to BT */ + halbtc8821c1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_1ANT_PCO_BTSIDE); + + /* Set Ext Ant Switch to BT control at wifi off step */ + halbtc8821c1ant_set_ext_ant_switch(btcoexist, + FORCE_EXEC, + BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, + BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); + + halbtc8821c1ant_ignore_wlan_act(btcoexist, + FORCE_EXEC, TRUE); + + coex_sta->run_time_state = FALSE; + break; + case BT_8821C_1ANT_PHASE_2G_RUNTIME: + + while (cnt_bt_cal_chk <= 20) { + /* 0x49c[0]=1 WL IQK, 0x49c[1]=1 BT IQK*/ + u8tmp = btcoexist->btc_read_1byte( + btcoexist, + 0x49c); + + cnt_bt_cal_chk++; + if (u8tmp & BIT(0)) { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ########### WL is IQK (wait cnt=%d)\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + delay_ms(50); + } else if (u8tmp & BIT(1)) { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ########### BT is IQK (wait cnt=%d)\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + delay_ms(50); + } else { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ********** WL and BT is NOT IQK (wait cnt=%d)\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + break; + } + } + + /* set Path control owner to WL at runtime step */ + halbtc8821c1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_1ANT_PCO_WLSIDE); + + /* set GNT_BT to PTA */ + halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8821C_1ANT_SIG_STA_SET_BY_HW); + + halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8821C_1ANT_SIG_STA_SET_BY_HW); + + coex_sta->run_time_state = TRUE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (rfe_type->wlg_Locate_at_btg) + ant_pos_type = + BTC_ANT_PATH_WIFI; + else + ant_pos_type = BTC_ANT_PATH_PTA; + } + + if (rfe_type->wlg_Locate_at_btg) + halbtc8821c1ant_set_int_block(btcoexist, + NORMAL_EXEC, + BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); + else + halbtc8821c1ant_set_int_block(btcoexist, + NORMAL_EXEC, + BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); + + break; + case BT_8821C_1ANT_PHASE_5G_RUNTIME: + + /* set Path control owner to WL at runtime step */ + halbtc8821c1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_1ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Hi */ + halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8821C_1ANT_SIG_STA_SET_BY_HW); + + /* Set GNT_WL to SW Hi */ + halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = TRUE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + /* if (rfe_type->ext_band_switch_exist) + ant_pos_type = BTC_ANT_PATH_PTA; + else */ + ant_pos_type = + BTC_ANT_PATH_WIFI5G; + } + + halbtc8821c1ant_set_int_block(btcoexist, + NORMAL_EXEC, + BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); + + break; + case BT_8821C_1ANT_PHASE_BTMPMODE: + /* Disable LTE Coex Function in WiFi side */ + halbtc8821c1ant_ltecoex_enable(btcoexist, 0x0); + + /* set Path control owner to WL */ + halbtc8821c1ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_1ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Hi */ + halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + + /* Set GNT_WL to SW Lo */ + halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_LOW); + + coex_sta->run_time_state = FALSE; + + /* Set Ext Ant Switch to BT side at BT MP mode */ + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; + + break; + case BT_8821C_1ANT_PHASE_ANTENNA_DET: + halbtc8821c1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8821C_1ANT_PCO_WLSIDE); + + /* set GNT_BT to high */ + halbtc8821c1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to high */ + halbtc8821c1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_1ANT_GNT_BLOCK_RFC_BB, + BT_8821C_1ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_1ANT_SIG_STA_SET_TO_HIGH); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; + + coex_sta->run_time_state = FALSE; + + break; + } + + if (phase != BT_8821C_1ANT_PHASE_WLAN_OFF) { + switch (ant_pos_type) { + case BTC_ANT_PATH_WIFI: + halbtc8821c1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLG); + break; + case BTC_ANT_PATH_WIFI5G + : + halbtc8821c1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8821C_1ANT_EXT_ANT_SWITCH_TO_WLA); + break; + case BTC_ANT_PATH_BT: + halbtc8821c1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8821C_1ANT_EXT_ANT_SWITCH_TO_BT); + break; + default: + case BTC_ANT_PATH_PTA: + halbtc8821c1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8821C_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, + BT_8821C_1ANT_EXT_ANT_SWITCH_TO_NOCARE); + break; + } + + } + +#if BT_8821C_1ANT_COEX_DBG + u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],(After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); + + BTC_TRACE(trace_buf); +#endif +} + + +boolean halbtc8821c1ant_is_common_action(IN struct btc_coexist *btcoexist) +{ + boolean common = FALSE, wifi_connected = FALSE, wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_connected && + BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); + BTC_TRACE(trace_buf); + + common = TRUE; + } else if (wifi_connected && + (BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi connected + BT non connected-idle!!\n"); + BTC_TRACE(trace_buf); + + common = TRUE; + } else if (!wifi_connected && + (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); + BTC_TRACE(trace_buf); + + common = TRUE; + } else if (wifi_connected && + (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi connected + BT connected-idle!!\n"); + BTC_TRACE(trace_buf); + + common = TRUE; + } else if (!wifi_connected && + (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE != + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); + BTC_TRACE(trace_buf); + + common = TRUE; + } else { + if (wifi_busy) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); + BTC_TRACE(trace_buf); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); + BTC_TRACE(trace_buf); + } + + common = FALSE; + } + + return common; +} + + +/* ********************************************* + * + * Software Coex Mechanism start + * + * ********************************************* */ + + + +/* ********************************************* + * + * Non-Software Coex Mechanism start + * + * ********************************************* */ +void halbtc8821c1ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) +{ + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + +void halbtc8821c1ant_action_bt_hs(IN struct btc_coexist *btcoexist) +{ + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); +} + +void halbtc8821c1ant_action_bt_relink(IN struct btc_coexist *btcoexist) +{ + if (coex_sta->is_bt_multi_link == TRUE) + return; + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + +void halbtc8821c1ant_action_bt_idle(IN struct btc_coexist *btcoexist) +{ + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_busy) { + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); + } else { /* if wl busy */ + + if (BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + } else { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + } + } + +} + +void halbtc8821c1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = FALSE, wifi_busy = FALSE, + bt_busy = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); + + + if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) + || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + + if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 17); + else + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + } else if ((!wifi_connected) && (!wifi_scan)) { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } else if (bt_link_info->pan_exist) { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + } else if (bt_link_info->a2dp_exist) { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); + } else { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) + || (coex_sta->wifi_is_high_pri_task)) + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + else + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 23); + } +} + +void halbtc8821c1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = FALSE, wifi_busy = FALSE, wifi_cckdeadlock_ap = FALSE; + u32 wifi_bw = 1; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + if ((iot_peer == BTC_IOT_PEER_ATHEROS) && (coex_sta->cck_lock_ever)) + wifi_cckdeadlock_ap = TRUE; + + if (bt_link_info->sco_exist) { + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); + } else { + /* for HID exist */ + if ((wifi_cckdeadlock_ap) && (coex_sta->is_bt_multi_link)) { + + if (coex_sta->hid_busy_num < 2) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 18); + } else if (coex_sta->is_hid_low_pri_tx_overhead) { + if (coex_sta->hid_busy_num < 2) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 18); + } else if (coex_sta->hid_busy_num < 2) { + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } else if (wifi_bw == 0) { /* if 11bg mode */ + + if (coex_sta->is_bt_multi_link) { + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } else { + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 11); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } + } else { + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 11); + } + } +} + +void halbtc8821c1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) +{ + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8821C_1ANT_PHASE_5G_RUNTIME); + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + + +void halbtc8821c1ant_action_wifi_only(IN struct btc_coexist *btcoexist) +{ + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 10); + halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); +} + +void halbtc8821c1ant_action_wifi_native_lps(IN struct btc_coexist *btcoexist) +{ + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + +void halbtc8821c1ant_action_wifi_cck_dead_lock(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if ((bt_link_info->hid_exist) && (bt_link_info->a2dp_exist) && + (!bt_link_info->pan_exist)) { + + if ((coex_sta->cck_lock) || (coex_sta->cck_lock_warn)) { + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 28); + } else { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } + } +} + +void halbtc8821c1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if ((BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) || + (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + else if (!bt_link_info->pan_exist) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 2); + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + + +void halbtc8821c1ant_action_wifi_linkscan_process(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if (bt_link_info->pan_exist) { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + } else if (bt_link_info->a2dp_exist) { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 27); + } else { + + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + } + +} + +void halbtc8821c1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = FALSE, wifi_turbo = FALSE, wifi_cckdeadlock_ap = FALSE; + u32 wifi_bw = 1; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy_level = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; + + if ((iot_peer == BTC_IOT_PEER_ATHEROS) && (coex_sta->cck_lock_ever)) + wifi_cckdeadlock_ap = TRUE; + + if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { + + if (wifi_cckdeadlock_ap) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 12); + } else if (bt_link_info->a2dp_only) { /* A2DP */ + + if (wifi_cckdeadlock_ap) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + else if (wifi_turbo) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); + } else if (((bt_link_info->a2dp_exist) && + (bt_link_info->pan_exist)) || + (bt_link_info->hid_exist && bt_link_info->a2dp_exist && + bt_link_info->pan_exist)) { /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ + + if (wifi_cckdeadlock_ap) { + if ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num < 2)) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + } else if (bt_link_info->hid_exist) { + if (coex_sta->hid_busy_num < 2) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + } else if (wifi_turbo) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 13); + else + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 14); + } else if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { /* HID+A2DP */ + + if (wifi_cckdeadlock_ap) { +#if 1 + if (coex_sta->hid_busy_num < 2) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + + if (coex_sta->hid_pair_cnt > 1) + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 24); + else + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); +#endif + +#if 0 + halbtc8821c1ant_action_wifi_cck_dead_lock(btcoexist); +#endif + } else { + if (coex_sta->hid_busy_num < 2) /* 2/18 HID */ + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + else if (wifi_bw == 0)/* if 11bg mode */ + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 12); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + + if (coex_sta->hid_pair_cnt > 1) + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 24); + else + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } + } else if ((bt_link_info->pan_only) + || (bt_link_info->hid_exist && bt_link_info->pan_exist)) { + /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ + + if (wifi_cckdeadlock_ap) { + if ((bt_link_info->hid_exist) && (coex_sta->hid_busy_num < 2)) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 14); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 13); + } else if (bt_link_info->hid_exist) { + if (coex_sta->hid_busy_num < 2) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + } else if (wifi_turbo) + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + else + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (!wifi_busy) + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 4); + else + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 3); + } else { + /* BT no-profile busy (0x9) */ + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + } + +} + +void halbtc8821c1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) +{ + /* tdma and coex table */ + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); +} + +void halbtc8821c1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = FALSE; + boolean wifi_under_5g = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect()===>\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); if (wifi_under_5g) { - + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], WiFi is under 5G!!!\n"); BTC_TRACE(trace_buf); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); - halbtc8821c1ant_action_wifi_under5g(btcoexist); - return; - } - - if (BTC_MEDIA_CONNECT == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA connect notify\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, true); - - /* Force antenna setup for no scan result issue */ - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - - /* Set CCK Tx/Rx high Pri except 11b mode */ - if (wifi_under_b_mode) { - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x00); /* CCK Rx */ - } else { - /* btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); */ /*CCK Tx */ - /* btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); */ /*CCK Rx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x10); /* CCK Rx */ - } - - coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, - 0x430); - coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, - 0x434); - coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( - btcoexist, 0x42a); - coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( - btcoexist, 0x456); - } else { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], MEDIA disconnect notify\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, false); - - btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ - - coex_sta->cck_ever_lock = false; - } - - halbtc8821c1ant_update_wifi_channel_info(btcoexist, type); - -} - -void ex_halbtc8821c1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - boolean under_4way = false, wifi_under_5g = false; - - if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) - return; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if (wifi_under_5g) { - + halbtc8821c1ant_action_wifi_under5g(btcoexist); + return; + } + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + + if ((coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY)) { + + if (bt_link_info->hid_only) /* HID only */ + halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist); + else + halbtc8821c1ant_action_wifi_connected_bt_acl_busy(btcoexist); + + } else if (coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_SCO_BUSY) + halbtc8821c1ant_action_bt_sco_hid_only_busy(btcoexist); + else + halbtc8821c1ant_action_bt_idle(btcoexist); + +} + +void halbtc8821c1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) +{ + u8 algorithm = 0; + + algorithm = halbtc8821c1ant_action_algorithm(btcoexist); + coex_dm->cur_algorithm = algorithm; + + if (!halbtc8821c1ant_is_common_action(btcoexist)) { + switch (coex_dm->cur_algorithm) { + case BT_8821C_1ANT_COEX_ALGO_SCO: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = SCO.\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HID.\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = A2DP.\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_A2DP_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = PAN(EDR).\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HS mode.\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_PANEDR_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = PAN+A2DP.\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_PANEDR_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_HID_A2DP_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); + BTC_TRACE(trace_buf); + break; + case BT_8821C_1ANT_COEX_ALGO_HID_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HID+A2DP.\n"); + BTC_TRACE(trace_buf); + break; + default: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = coexist All Off!!\n"); + BTC_TRACE(trace_buf); + break; + } + coex_dm->pre_algorithm = coex_dm->cur_algorithm; + } +} + + +void halbtc8821c1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = FALSE, bt_hs_on = FALSE; + boolean increase_scan_dev_num = FALSE; + boolean bt_ctrl_agg_buf_size = FALSE; + boolean miracast_plus_bt = FALSE, wifi_under_5g = FALSE; + u8 agg_buf_size = 5; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0, wifi_bw; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + boolean scan = FALSE, link = FALSE, roam = FALSE, under_4way = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &under_4way); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism()===>\n"); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], under_lps = %d, force_lps_ctrl = %d, acl_busy = %d!!!\n", + coex_sta->under_lps, coex_sta->force_lps_ctrl, coex_sta->acl_busy); + BTC_TRACE(trace_buf); + + if (btcoexist->manual_control) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (btcoexist->stop_coex_dm) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->under_ips) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under IPS !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (!coex_sta->run_time_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], return for run_time_state = FALSE !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->freeze_coexrun_by_btinfo) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); + BTC_TRACE(trace_buf); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((wifi_under_5g) && + (coex_sta->switch_band_notify_to != BTC_SWITCH_TO_24G) && + (coex_sta->switch_band_notify_to != BTC_SWITCH_TO_24G_NOFORSCAN)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], WiFi is under 5G!!!\n"); BTC_TRACE(trace_buf); - - halbtc8821c1ant_action_wifi_under5g(btcoexist); - return; - } - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); - - if (under_4way) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ---- under_4way!!\n"); - BTC_TRACE(trace_buf); - - coex_sta->wifi_is_high_pri_task = true; - coex_sta->specific_pkt_period_cnt = 2; - } else if (BTC_PACKET_ARP == type) { - - coex_dm->arp_cnt++; - - if (coex_sta->wifi_is_high_pri_task) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); - BTC_TRACE(trace_buf); - } - - } else { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); - BTC_TRACE(trace_buf); - - coex_sta->wifi_is_high_pri_task = true; - coex_sta->specific_pkt_period_cnt = 2; - } - - if (coex_sta->wifi_is_high_pri_task) - halbtc8821c1ant_action_wifi_connected_specific_packet(btcoexist); -} - -void ex_halbtc8821c1ant_bt_info_notify(IN struct btc_coexist *btcoexist, - IN u8 *tmp_buf, IN u8 length) -{ - u8 bt_info = 0; - u8 i, rsp_source = 0; - boolean wifi_connected = false; - boolean bt_busy = false; - - coex_sta->c2h_bt_info_req_sent = false; - - rsp_source = tmp_buf[0] & 0xf; - if (rsp_source >= BT_INFO_SRC_8821C_1ANT_MAX) - rsp_source = BT_INFO_SRC_8821C_1ANT_WIFI_FW; - coex_sta->bt_info_c2h_cnt[rsp_source]++; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, - length); - BTC_TRACE(trace_buf); - for (i = 0; i < length; i++) { - coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; - if (i == 1) - bt_info = tmp_buf[i]; - if (i == length - 1) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", - tmp_buf[i]); - BTC_TRACE(trace_buf); - } - } - - if (BT_INFO_SRC_8821C_1ANT_WIFI_FW != rsp_source) { - - /* if 0xff, it means BT is under WHCK test */ - if (bt_info == 0xff) - coex_sta->bt_whck_test = true; - else - coex_sta->bt_whck_test = false; - - coex_sta->bt_retry_cnt = /* [3:0] */ - coex_sta->bt_info_c2h[rsp_source][2] & 0xf; - - if (coex_sta->bt_retry_cnt >= 1) - coex_sta->pop_event_cnt++; - - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) - coex_sta->c2h_bt_page = true; - else - coex_sta->c2h_bt_page = false; - - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) - coex_sta->bt_create_connection = true; - else - coex_sta->bt_create_connection = false; - - /* unit: %, value-100 to translate to unit: dBm */ - coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; - - /* coex_sta->bt_info_c2h[rsp_source][3] * 2 - 90; */ - - if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { - coex_sta->a2dp_bit_pool = - coex_sta->bt_info_c2h[rsp_source][6]; - } else - coex_sta->a2dp_bit_pool = 0; - - if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) - coex_sta->acl_busy = true; - else - coex_sta->acl_busy = false; - - coex_sta->bt_info_ext = - coex_sta->bt_info_c2h[rsp_source][4]; - - /* Here we need to resend some wifi info to BT */ - /* because bt is reset and loss of the info. */ - - if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { - - /* Re-Init */ - if (coex_sta->bt_info_ext & BIT(1)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); - BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - if (wifi_connected) - halbtc8821c1ant_update_wifi_channel_info(btcoexist, - BTC_MEDIA_CONNECT); - else - halbtc8821c1ant_update_wifi_channel_info(btcoexist, - BTC_MEDIA_DISCONNECT); - } - - /* If Ignore_WLanAct && not SetUp_Link */ - if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); - } - } - /* check BIT2 first ==> check if bt is under inquiry or page scan */ - if (bt_info & BT_INFO_8821C_1ANT_B_INQ_PAGE) - coex_sta->c2h_bt_inquiry_page = true; - else - coex_sta->c2h_bt_inquiry_page = false; - } - - coex_sta->num_of_profile = 0; - - /* set link exist status */ - if (!(bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; - - coex_sta->bt_hi_pri_link_exist = false; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (bt_info & BT_INFO_8821C_1ANT_B_FTP) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->pan_exist = false; - if (bt_info & BT_INFO_8821C_1ANT_B_A2DP) { - coex_sta->a2dp_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->a2dp_exist = false; - if (bt_info & BT_INFO_8821C_1ANT_B_HID) { - coex_sta->hid_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->hid_exist = false; - if (bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) { - coex_sta->sco_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->sco_exist = false; - - } - - halbtc8821c1ant_update_bt_link_info(btcoexist); - - bt_info = bt_info & - 0x1f; /* mask profile bit for connect-ilde identification ( for CSR case: A2DP idle --> 0x41) */ - - if (!(bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info == - BT_INFO_8821C_1ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); - BTC_TRACE(trace_buf); - } else if ((bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8821C_1ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_SCO_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info & BT_INFO_8821C_1ANT_B_ACL_BUSY) { - if (BT_8821C_1ANT_BT_STATUS_ACL_BUSY != coex_dm->bt_status) - coex_dm->auto_tdma_adjust = false; - coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_ACL_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); - BTC_TRACE(trace_buf); - } else { - coex_dm->bt_status = BT_8821C_1ANT_BT_STATUS_MAX; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); - BTC_TRACE(trace_buf); - } - - if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) - bt_busy = true; - else - bt_busy = false; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); - BTC_TRACE(trace_buf); - return; - } - - halbtc8821c1ant_run_coexist_mechanism(btcoexist); -} - -void ex_halbtc8821c1ant_rf_status_notify(IN struct btc_coexist *btcoexist, - IN u8 type) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_RF_ON == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned ON!!\n"); - BTC_TRACE(trace_buf); - - coex_sta->wl_rf_off_on_event = true; - btcoexist->stop_coex_dm = false; - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, TRUE); - halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); - - } else if (BTC_RF_OFF == type) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], RF is turned OFF!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); - halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); - - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_1ANT_PHASE_WLAN_OFF); - - btcoexist->stop_coex_dm = true; - coex_sta->wl_rf_off_on_event = false; - } -} - -void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); - BTC_TRACE(trace_buf); - - /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, FALSE); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); - halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); - - halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_1ANT_PHASE_WLAN_OFF); - - halbtc8821c1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, true); - - ex_halbtc8821c1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - - btcoexist->stop_coex_dm = true; -} - -void ex_halbtc8821c1ant_pnp_notify(IN struct btc_coexist *btcoexist, - IN u8 pnp_state) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); - BTC_TRACE(trace_buf); - - if (BTC_WIFI_PNP_SLEEP == pnp_state) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to SLEEP\n"); - BTC_TRACE(trace_buf); - - /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ - halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, FALSE); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, FALSE); - halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, FALSE); - - halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8821c1ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_1ANT_PHASE_WLAN_OFF); - - btcoexist->stop_coex_dm = true; - } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Pnp notify to WAKE UP\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_post_activestate_to_bt(btcoexist, TRUE); - halbtc8821c1ant_post_onoffstate_to_bt(btcoexist, TRUE); - - btcoexist->stop_coex_dm = false; - } -} - - -void ex_halbtc8821c1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) -{ - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], *****************Coex DM Reset*****************\n"); - BTC_TRACE(trace_buf); - - halbtc8821c1ant_init_hw_config(btcoexist, false, false); - halbtc8821c1ant_init_coex_dm(btcoexist); -} - -void ex_halbtc8821c1ant_periodical(IN struct btc_coexist *btcoexist) -{ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ============== Periodical ==============\n"); - BTC_TRACE(trace_buf); - -#if (BT_AUTO_REPORT_ONLY_8821C_1ANT == 0) - halbtc8821c1ant_query_bt_info(btcoexist); - -#endif - - halbtc8821c1ant_monitor_bt_ctr(btcoexist); - halbtc8821c1ant_monitor_wifi_ctr(btcoexist); - - halbtc8821c1ant_monitor_bt_enable_disable(btcoexist); - - /* for 4-way, DHCP, EAPOL packet */ - if (coex_sta->specific_pkt_period_cnt > 0) { - - coex_sta->specific_pkt_period_cnt--; - - if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) - coex_sta->wifi_is_high_pri_task = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); - BTC_TRACE(trace_buf); - } - - if (coex_sta->bt_coex_supported_feature == 0) - coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); - - if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) - coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); - - if (halbtc8821c1ant_is_wifibt_status_changed(btcoexist)) - halbtc8821c1ant_run_coexist_mechanism(btcoexist); - - -} - -void ex_halbtc8821c1ant_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ -#if BT_8821C_1ANT_ANTDET_ENABLE - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - /*boolean scan, roam;*/ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - - if (seconds == 0) { - psd_scan->ant_det_try_count = 0; - psd_scan->ant_det_fail_count = 0; - ant_det_count = 0; - ant_det_fail_count = 0; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - return; - } - - if (!board_info->btdm_ant_det_finish) { - psd_scan->ant_det_inteval_count = - psd_scan->ant_det_inteval_count + 2; - - if (psd_scan->ant_det_inteval_count >= - BT_8821C_2ANT_ANTDET_RETRY_INTERVAL) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); - BTC_TRACE(trace_buf); - halbtc8821c1ant_psd_antenna_detection_check(btcoexist); - - if (board_info->btdm_ant_det_finish) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); - BTC_TRACE(trace_buf); -#if 1 - if (board_info->btdm_ant_num_by_ant_det == 2) - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, - FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); - else - halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_PTA, - FORCE_EXEC, BT_8821C_1ANT_PHASE_2G_RUNTIME); -#endif - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); - BTC_TRACE(trace_buf); - } - psd_scan->ant_det_inteval_count = 0; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", - psd_scan->ant_det_inteval_count); - BTC_TRACE(trace_buf); - } - - } -#endif - - -} - - -void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist) -{ -#if BT_8821C_1ANT_ANTDET_ENABLE - struct btc_board_info *board_info = &btcoexist->board_info; - - if (psd_scan->ant_det_try_count != 0) { - halbtc8821c1ant_psd_show_antenna_detect_result(btcoexist); - - if (board_info->btdm_ant_det_finish) - halbtc8821c1ant_psd_showdata(btcoexist); - return; - } -#endif - -} - -void ex_halbtc8821c1ant_antenna_isolation(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - -} - -void ex_halbtc8821c1ant_psd_scan(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) -{ - - -} - - -#endif - -#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + + halbtc8821c1ant_action_wifi_under5g(btcoexist); + return; + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 2G!!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + } + + if ((coex_sta->under_lps) && (!coex_sta->force_lps_ctrl) && + (!coex_sta->acl_busy)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_action_wifi_native_lps(btcoexist); + return; + } + + if (coex_sta->bt_whck_test) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under WHCK TEST!!!\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_action_bt_whql_test(btcoexist); + return; + } + + if (coex_sta->bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!!\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_action_wifi_only(btcoexist); + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under inquiry/page scan !!\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_action_bt_inquiry(btcoexist); + return; + } + + if ((coex_sta->is_setupLink) && + (coex_sta->bt_relink_downcount != 0)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is re-link !!!\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_action_bt_relink(btcoexist); + return; + } + + if ((BT_8821C_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8821C_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + increase_scan_dev_num = TRUE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, + &increase_scan_dev_num); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + + num_of_wifi_link = wifi_link_status >> 16; + + if ((num_of_wifi_link >= 2) || + (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", + num_of_wifi_link, wifi_link_status); + BTC_TRACE(trace_buf); + + if (bt_link_info->bt_link_exist) + miracast_plus_bt = TRUE; + else + miracast_plus_bt = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + + if (scan || link || roam || under_4way) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", + scan, link, roam, under_4way); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_linkscan_process(btcoexist); + } else + halbtc8821c1ant_action_wifi_multi_port(btcoexist); + + return; + } else { + + miracast_plus_bt = FALSE; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + } + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + + if ((bt_link_info->bt_link_exist) && (wifi_connected)) { + + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + if (BTC_IOT_PEER_CISCO == iot_peer) { + + if (BTC_WIFI_BW_HT40 == wifi_bw) + halbtc8821c1ant_limited_rx(btcoexist, + NORMAL_EXEC, FALSE, TRUE, 0x10); + else + halbtc8821c1ant_limited_rx(btcoexist, + NORMAL_EXEC, FALSE, TRUE, 0x8); + } + } + + /* just print debug message */ + halbtc8821c1ant_run_sw_coexist_mechanism(btcoexist); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is hs\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_action_bt_hs(btcoexist); + return; + } + + if ((BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) || + (BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is idle\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_action_bt_idle(btcoexist); + return; + } + + if (scan || link || roam || under_4way) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", + scan, link, roam, under_4way); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under linkscan process!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_linkscan_process(btcoexist); + } else if (wifi_connected) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under connected!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_connected(btcoexist); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under not-connected!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_not_connected(btcoexist); + } +} + +void halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + /* force to reset coex mechanism */ + halbtc8821c1ant_low_penalty_ra(btcoexist, FORCE_EXEC, FALSE); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Coex Mechanism Init!!\n"); + BTC_TRACE(trace_buf); + + coex_sta->pop_event_cnt = 0; + coex_sta->cnt_RemoteNameReq = 0; + coex_sta->cnt_ReInit = 0; + coex_sta->cnt_setupLink = 0; + coex_sta->cnt_IgnWlanAct = 0; + coex_sta->cnt_Page = 0; + coex_sta->cnt_RoleSwitch = 0; + coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; + + halbtc8821c1ant_query_bt_info(btcoexist); +} + +void halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean back_up, IN boolean wifi_only) +{ + u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; + u16 u16tmp1 = 0; + u8 i; + struct btc_board_info *board_info = &btcoexist->board_info; + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 1Ant Init HW Config!!\n"); + BTC_TRACE(trace_buf); + + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],(Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + u32tmp3, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); + + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->bt_reg_vendor_ac = 0xffff; + coex_sta->bt_reg_vendor_ae = 0xffff; + coex_sta->isolation_btween_wb = BT_8821C_1ANT_DEFAULT_ISOLATION; + coex_sta->gnt_error_cnt = 0; + coex_sta->bt_relink_downcount = 0; + coex_sta->is_set_ps_state_fail = FALSE; + coex_sta->cnt_set_ps_state_fail = 0; + coex_sta->wl_rx_rate = BTC_UNKNOWN; + coex_sta->wl_rts_rx_rate = BTC_UNKNOWN; + coex_sta->wl_center_channel = 0; + + for (i = 0; i <= 9; i++) + coex_sta->bt_afh_map[i] = 0; + + /* Setup RF front end type */ + halbtc8821c1ant_set_rfe_type(btcoexist); + + /* 0xf0[15:12] --> Chip Cut information */ + coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, + 0xf1) & 0xf0) >> 4; + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, + 0x1); /* enable TBTT nterrupt */ + + /* BT report packet sample rate */ + btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); + + /* Init 0x778 = 0x1 for 1-Ant */ + btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); + + /* Enable PTA (3-wire function form BT side) */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); + + /* Enable PTA (tx/rx signal form WiFi side) */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); + + /* set GNT_BT=1 for coex table select both */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x763, 0x10, 0x1); + + halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); + +#if 0 + /* check if WL firmware download ok */ + /*if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6)*/ + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ONOFF, TRUE); +#endif + + /* PTA parameter */ + halbtc8821c1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); + + psd_scan->ant_det_is_ant_det_available = TRUE; + + /* Antenna config */ + if (coex_sta->is_rf_state_off) { + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_WLAN_OFF); + + btcoexist->stop_coex_dm = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** halbtc8821c1ant_init_hw_config (RF Off)**********\n"); + BTC_TRACE(trace_buf); + } else if (wifi_only) { + coex_sta->concurrent_rx_mode_on = FALSE; + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_WIFI, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_WLANONLY_INIT); + + btcoexist->stop_coex_dm = TRUE; + } else { + /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); + + coex_sta->concurrent_rx_mode_on = TRUE; + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_COEX_INIT); + + btcoexist->stop_coex_dm = FALSE; + } + + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u32tmp1 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp2 = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (After Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + u32tmp3, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); + +} + + +/* ************************************************************ + * work around function start with wa_halbtc8821c1ant_ + * ************************************************************ + * ************************************************************ + * extern function start with ex_halbtc8821c1ant_ + * ************************************************************ */ +void ex_halbtc8821c1ant_power_on_setting(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u8 u8tmp = 0x0; + u16 u16tmp = 0x0; + u32 value = 0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx Execute 8821c 1-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); + BTC_TRACE(trace_buf); + + + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = FALSE; + psd_scan->ant_det_is_ant_det_available = FALSE; + + /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ + u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); + btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); + + /* Local setting bit define */ + /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ + /* BIT1: "0" for internal switch; "1" for external switch */ + /* BIT2: "0" for one antenna; "1" for two antenna */ + /* NOTE: here default all internal switch and 1-antenna ==> BIT1=0 and BIT2=0 */ + + /* Set Antenna Path to BT side */ + /* Check efuse 0xc3[6] for Single Antenna Path */ + if (board_info->single_ant_path == 0) { + + board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; + u8tmp = 1; + } else if (board_info->single_ant_path == 1) { + + board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; + u8tmp = 0; + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d\n", + board_info->single_ant_path , board_info->btdm_ant_pos); + BTC_TRACE(trace_buf); + + /* Setup RF front end type */ + halbtc8821c1ant_set_rfe_type(btcoexist); + + /* Set Antenna Path to BT side */ + halbtc8821c1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_COEX_POWERON); + + /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ + if (btcoexist->chip_interface == BTC_INTF_PCI) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_USB) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_SDIO) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); + + /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ + halbtc8821c1ant_enable_gnt_to_gpio(btcoexist, TRUE); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x\n", + halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x\n", + btcoexist->btc_read_4byte(btcoexist, 0x70), + btcoexist->btc_read_4byte(btcoexist, 0xcb4)); + BTC_TRACE(trace_buf); + +} + +void ex_halbtc8821c1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) +{ +} + +void ex_halbtc8821c1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only) +{ + halbtc8821c1ant_init_hw_config(btcoexist, TRUE, wifi_only); +} + +void ex_halbtc8821c1ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + halbtc8821c1ant_init_coex_dm(btcoexist); +} + +void ex_halbtc8821c1ant_display_simple_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + u8 *cli_buf = btcoexist->cli_buf; + u32 bt_patch_ver = 0, bt_coex_ver = 0; + static u8 cnt = 0; + + + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + + // BT coex. info. + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n _____[BT Coexist info]____"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n __[Under Manual Control]_"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n _________________________"); + CL_PRINTF(cli_buf); + } + if (btcoexist->stop_coex_dm) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ____[Coex is STOPPED]____"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n _________________________"); + CL_PRINTF(cli_buf); + } + + if (psd_scan->ant_det_try_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s / 0x%x", + "Ant PG Num/ Mech/ Pos/ RFE", + board_info->pg_ant_num, board_info->btdm_ant_num, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type); + CL_PRINTF(cli_buf); + } else { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s/ 0x%x (%d/%d/%d)", + "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, + psd_scan->ant_det_result); + CL_PRINTF(cli_buf); + + if (board_info->btdm_ant_det_finish) { + + if (psd_scan->ant_det_result != 12) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant Det PSD Value", + psd_scan->ant_det_psd_scan_peak_val + / 100); + CL_PRINTF(cli_buf); + } + } + + bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8821c_1ant, glcoex_ver_8821c_1ant, + glcoex_ver_btdesired_8821c_1ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (coex_sta->bt_disabled ? "BT-disable" : + (bt_coex_ver >= glcoex_ver_btdesired_8821c_1ant ? + "Match" : "Mis-Match")))); + CL_PRINTF(cli_buf); + + // BT Status + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", "BT status", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") + : ((BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status) ? "connected-idle" : "busy"))))); + CL_PRINTF(cli_buf); + + // HW settings + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(Hi-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x774(Lo-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx, + (bt_link_info->slave_role ? "(Slave!!)" : ( + coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); + CL_PRINTF(cli_buf); + +} + +void ex_halbtc8821c1ant_display_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_stack_info *stack_info = &btcoexist->stack_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + u8 *cli_buf = btcoexist->cli_buf; + u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; + u16 u16tmp[4]; + u32 u32tmp[4]; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; + static u8 pop_report_in_10s = 0; + u32 phyver = 0; + boolean lte_coex_on = FALSE; + static u8 cnt = 0; + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[BT Coexist info]============"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Under Manual Control]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + if (btcoexist->stop_coex_dm) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Coex is STOPPED]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + + if (psd_scan->ant_det_try_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s / 0x%x", + "Ant PG Num/ Mech/ Pos/ RFE", + board_info->pg_ant_num, board_info->btdm_ant_num, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type); + CL_PRINTF(cli_buf); + } else { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s/ 0x%x (%d/%d/%d)", + "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, + psd_scan->ant_det_result); + CL_PRINTF(cli_buf); + + if (board_info->btdm_ant_det_finish) { + + if (psd_scan->ant_det_result != 12) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant Det PSD Value", + psd_scan->ant_det_psd_scan_peak_val + / 100); + CL_PRINTF(cli_buf); + } + } + + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + + bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8821c_1ant, glcoex_ver_8821c_1ant, + glcoex_ver_btdesired_8821c_1ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (coex_sta->bt_disabled ? "BT-disable" : + (bt_coex_ver >= glcoex_ver_btdesired_8821c_1ant ? + "Match" : "Mis-Match")))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x (RF-Ch = %d)", + "AFH Map to BT", + coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], + coex_dm->wifi_chnl_info[2], coex_sta->wl_center_channel); + CL_PRINTF(cli_buf); + + /* wifi status */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Wifi Status]============"); + CL_PRINTF(cli_buf); + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[BT Status]============"); + CL_PRINTF(cli_buf); + + pop_report_in_10s++; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", + "BT [status/ rssi/ retryCnt/ popCnt]", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") + : ((BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) + ? "connected-idle" : "busy")))), + coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, + coex_sta->pop_event_cnt); + CL_PRINTF(cli_buf); + + if (pop_report_in_10s >= 5) { + coex_sta->pop_event_cnt = 0; + pop_report_in_10s = 0; + } + + if (coex_sta->num_of_profile != 0) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s%s%s%s%s", + "Profiles", + ((bt_link_info->a2dp_exist) ? + ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : + "A2DP,") : ""), + ((bt_link_info->sco_exist) ? "HFP," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : + "HID(2/18),") : ""), + ((bt_link_info->pan_exist) ? "PAN," : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = None", "Profiles"); + + CL_PRINTF(cli_buf); + + if (bt_link_info->a2dp_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", + "A2DP Rate/Bitpool/Auto_Slot", + ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), + coex_sta->a2dp_bit_pool, + ((coex_sta->is_autoslot) ? "On" : "Off") + ); + CL_PRINTF(cli_buf); + } + + if (bt_link_info->hid_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "HID PairNum/Forbid_Slot", + coex_sta->hid_pair_cnt, + coex_sta->forbidden_slot + ); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", + "Role/RoleSwCnt/IgnWlact/Feature", + ((bt_link_info->slave_role) ? "Slave" : "Master"), + coex_sta->cnt_RoleSwitch, + ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), + coex_sta->bt_coex_supported_feature); + CL_PRINTF(cli_buf); + + if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "BLEScan Type/TV/Init/Ble", + coex_sta->bt_ble_scan_type, + (coex_sta->bt_ble_scan_type & 0x1 ? + coex_sta->bt_ble_scan_para[0] : 0x0), + (coex_sta->bt_ble_scan_type & 0x2 ? + coex_sta->bt_ble_scan_para[1] : 0x0), + (coex_sta->bt_ble_scan_type & 0x4 ? + coex_sta->bt_ble_scan_para[2] : 0x0)); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "ReInit/ReLink/IgnWlact/Page/NameReq", + coex_sta->cnt_ReInit, + coex_sta->cnt_setupLink, + coex_sta->cnt_IgnWlanAct, + coex_sta->cnt_Page, + coex_sta->cnt_RemoteNameReq + ); + CL_PRINTF(cli_buf); + + halbtc8821c1ant_read_score_board(btcoexist, &u16tmp[0]); + + if ((coex_sta->bt_reg_vendor_ae == 0xffff) || + (coex_sta->bt_reg_vendor_ac == 0xffff)) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard(B->W)", u16tmp[0]); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", + ((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), + coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); + CL_PRINTF(cli_buf); + + if (coex_sta->num_of_profile > 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x%02x%02x%02x %02x%02x%02x%02x %02x%02x", + "AFH MAP", + coex_sta->bt_afh_map[0], + coex_sta->bt_afh_map[1], + coex_sta->bt_afh_map[2], + coex_sta->bt_afh_map[3], + coex_sta->bt_afh_map[4], + coex_sta->bt_afh_map[5], + coex_sta->bt_afh_map[6], + coex_sta->bt_afh_map[7], + coex_sta->bt_afh_map[8], + coex_sta->bt_afh_map[9] + ); + CL_PRINTF(cli_buf); + } + + for (i = 0; i < BT_INFO_SRC_8821C_1ANT_MAX; i++) { + if (coex_sta->bt_info_c2h_cnt[i]) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", + glbt_info_src_8821c_1ant[i], + coex_sta->bt_info_c2h[i][0], + coex_sta->bt_info_c2h[i][1], + coex_sta->bt_info_c2h[i][2], + coex_sta->bt_info_c2h[i][3], + coex_sta->bt_info_c2h[i][4], + coex_sta->bt_info_c2h[i][5], + coex_sta->bt_info_c2h[i][6], + coex_sta->bt_info_c2h_cnt[i]); + CL_PRINTF(cli_buf); + } + } + + + if (btcoexist->manual_control) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[mechanisms] (before Manual)============"); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Mechanisms]============"); + + CL_PRINTF(cli_buf); + + ps_tdma_case = coex_dm->cur_ps_tdma; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s)", + "TDMA", + coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], + coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], + coex_dm->ps_tdma_para[4], ps_tdma_case, + (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off")); + + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", + "Table/0x6c0/0x6c4/0x6c8", + coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); + CL_PRINTF(cli_buf); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %04x", + "0x778/0x6cc/Scoreboard(W->B)", + u8tmp[0], u32tmp[0], coex_sta->score_board_WB); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", + "AntDiv/BtCtrlLPS/LPRA/PsFail", + ((board_info->ant_div_cfg) ? "On" : "Off"), + ((coex_sta->force_lps_ctrl) ? "On" : "Off"), + ((coex_dm->cur_low_penalty_ra) ? "On" : "Off"), + coex_sta->cnt_set_ps_state_fail); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "Null All/Retry/Ack/BT_Empty/BT_Late", + coex_sta->wl_fw_dbg_info[1], + coex_sta->wl_fw_dbg_info[2], + coex_sta->wl_fw_dbg_info[3], + coex_sta->wl_fw_dbg_info[4], + coex_sta->wl_fw_dbg_info[5]); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; + + if (lte_coex_on) { + + u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa0); + u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa4); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "LTE Coex Table W_L/B_L", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa8); + u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0xac); + u32tmp[2] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb0); + u32tmp[3] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb4); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "LTE Break Table W_L/B_L/L_W/L_B", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, + u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); + CL_PRINTF(cli_buf); + } + + /* Hw setting */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Hw setting]============"); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp[1] = halbtc8821c1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", + "LTE Coex/Path Owner", + ((lte_coex_on) ? "On" : "Off") , + ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); + CL_PRINTF(cli_buf); + + if (lte_coex_on) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %d/ %d", + "LTE 3Wire/OPMode/UART/UARTMode", + (int)((u32tmp[0] & BIT(6)) >> 6), + (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), + (int)((u32tmp[0] & BIT(3)) >> 3), + (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "LTE_Busy/UART_Busy", + (int)((u32tmp[1] & BIT(1)) >> 1), + (int)(u32tmp[1] & BIT(0))); + CL_PRINTF(cli_buf); + } + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", + "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", + ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), + ((u8tmp[0] & BIT(3)) ? "On" : "Off"), + coex_sta->gnt_error_cnt); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ 0x%x", + "GNT_WL/GNT_BT/ RF_0x1", + (int)((u32tmp[1] & BIT(2)) >> 2), + (int)((u32tmp[1] & BIT(3)) >> 3), + btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff)); + CL_PRINTF(cli_buf); + + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", + "0xcb0/0xcb4/0xcb8[23:16]", + u32tmp[0], u32tmp[1], u8tmp[0], + ((u8tmp[0] & 0x1) == 0x1 ? "(BTG)" : "(WL_A+G)")); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "4c[24:23]/64[0]/4c6[4]/40[5]", + (u32tmp[0] & (BIT(24) | BIT(23))) >> 23 , u8tmp[2] & 0x1 , + (int)((u8tmp[0] & BIT(4)) >> 4), + (int)((u8tmp[1] & BIT(5)) >> 5)); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); + u8tmp[3] = btcoexist->btc_read_1byte(btcoexist, 0x60a); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x/ 0x%x", + "0x550/0x522/4-RxAGC/0xc50/0x60a", + u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", + u8tmp[2], u8tmp[3]); + CL_PRINTF(cli_buf); + + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d (Rx_rate Data/RTS= %d/%d)", + "CRC_OK CCK/11g/11n/11ac", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht, + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11ac", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %s/ %d", + "HiPr/ Locking/ warn/ Locked/ Noisy", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), + (coex_sta->cck_lock ? "Yes" : "No"), + (coex_sta->cck_lock_warn ? "Yes" : "No"), + (coex_sta->cck_lock_ever ? "Yes" : "No"), + coex_sta->wl_noisy_level); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(Hi-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x774(Lo-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx, + (bt_link_info->slave_role ? "(Slave!!)" : ( + coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); + CL_PRINTF(cli_buf); + + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); +} + + +void ex_halbtc8821c1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (type == BTC_IPS_ENTER) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS ENTER notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_ips = TRUE; + + /* Write WL "Active" in Score-board for LPS off */ + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_ONOFF | + BT_8821C_1ANT_SCOREBOARD_SCAN | + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, + FALSE); + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_WLAN_OFF); + halbtc8821c1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (type == BTC_IPS_LEAVE) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS LEAVE notify\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE, TRUE); + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ONOFF, TRUE); +#endif + halbtc8821c1ant_init_hw_config(btcoexist, FALSE, FALSE); + halbtc8821c1ant_init_coex_dm(btcoexist); + + coex_sta->under_ips = FALSE; + } +} + +void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + static boolean pre_force_lps_on = FALSE; + + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (type == BTC_LPS_ENABLE) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS ENABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = TRUE; + + if (coex_sta->force_lps_ctrl == TRUE) { /* LPS No-32K */ + /* Write WL "Active" in Score-board for PS-TDMA */ + pre_force_lps_on = TRUE; + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE, TRUE); + } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ + /* Write WL "Non-Active" in Score-board for Native-PS */ + pre_force_lps_on = FALSE; + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE, FALSE); + + halbtc8821c1ant_action_wifi_native_lps(btcoexist); + } + } else if (type == BTC_LPS_DISABLE) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS DISABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = FALSE; + + /* Write WL "Active" in Score-board for LPS off */ + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE, TRUE); + + if ((!pre_force_lps_on) && (!coex_sta->force_lps_ctrl)) + halbtc8821c1ant_query_bt_info(btcoexist); + } +} + +void ex_halbtc8821c1ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_connected = FALSE; + boolean wifi_under_5g = FALSE; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + coex_sta->freeze_coexrun_by_btinfo = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); + + if (wifi_connected) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** WL connected before SCAN\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** WL is not connected before SCAN\n"); + + BTC_TRACE(trace_buf); + + if ((type == BTC_SCAN_START) || (type == BTC_SCAN_START_2G)) { + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_SCAN | + BT_8821C_1ANT_SCOREBOARD_ONOFF, + TRUE); + + halbtc8821c1ant_query_bt_info(btcoexist); + } + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((type == BTC_SCAN_START) && (wifi_under_5g)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify (5G)\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_under5g(btcoexist); + } else if ((type == BTC_SCAN_START_2G) || (type == BTC_SCAN_START)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify (2G)\n"); + BTC_TRACE(trace_buf); + + if (!wifi_connected) + coex_sta->wifi_is_high_pri_task = TRUE; + + /* Force antenna setup for no scan result issue */ + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + + halbtc8821c1ant_run_coexist_mechanism(btcoexist); + } else { + + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", + coex_sta->scan_ap_num); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = FALSE; + + halbtc8821c1ant_run_coexist_mechanism(btcoexist); + } + +} + +void ex_halbtc8821c1ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + + boolean wifi_connected = FALSE, bt_hs_on = FALSE; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = FALSE; + u8 agg_buf_size = 5; + + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + coex_sta->switch_band_notify_to = type; + + if (type == BTC_SWITCH_TO_5G) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], switchband_notify --- switch to 5G\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_under5g(btcoexist); + + } else if (type == BTC_SWITCH_TO_24G_NOFORSCAN) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], switchband_notify --- BTC_SWITCH_TO_2G (no for scan)\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_run_coexist_mechanism(btcoexist); + + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], switchband_notify --- switch to 2G\n"); + BTC_TRACE(trace_buf); + + ex_halbtc8821c1ant_scan_notify(btcoexist, + BTC_SCAN_START_2G); + } + + coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; +} + + +void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_SCAN | + BT_8821C_1ANT_SCOREBOARD_ONOFF, + TRUE); + + if ((type == BTC_ASSOCIATE_5G_START) || + (type == BTC_ASSOCIATE_5G_FINISH)) { + + if (type == BTC_ASSOCIATE_5G_START) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], connect_notify --- 5G start\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], connect_notify --- 5G finish\n"); + + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_under5g(btcoexist); + } else if (type == BTC_ASSOCIATE_START) { + + coex_sta->wifi_is_high_pri_task = TRUE; + coex_dm->arp_cnt = 0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT START notify (2G)\n"); + BTC_TRACE(trace_buf); + + /* Force antenna setup for no scan result issue */ + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + + halbtc8821c1ant_run_coexist_mechanism(btcoexist); + + /* To keep TDMA case during connect process, + to avoid changed by Btinfo and runcoexmechanism */ + coex_sta->freeze_coexrun_by_btinfo = TRUE; + } else { + + coex_sta->wifi_is_high_pri_task = FALSE; + coex_sta->freeze_coexrun_by_btinfo = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT FINISH notify (2G)\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_run_coexist_mechanism(btcoexist); + } + +} + +void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_under_b_mode = FALSE, wifi_under_5g = FALSE; + + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (type == BTC_MEDIA_CONNECT) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA connect notify\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_ONOFF, + TRUE); + + if (wifi_under_5g) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 5G!!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_under5g(btcoexist); + } else { + + /* Force antenna setup for no scan result issue */ + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + /* Set CCK Tx/Rx high Pri except 11b mode */ + if (wifi_under_b_mode) { + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x00); /* CCK Rx */ + } else { + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); /* CCK Rx */ + } + } + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA disconnect notify\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE, FALSE); + + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ + + coex_sta->cck_lock_ever = FALSE; + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + } + + halbtc8821c1ant_update_wifi_channel_info(btcoexist, type); + +} + +void ex_halbtc8821c1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean under_4way = FALSE, wifi_under_5g = FALSE; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (wifi_under_5g) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 5G!!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_action_wifi_under5g(btcoexist); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, &under_4way); + + if (under_4way) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ---- under_4way!!\n"); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = TRUE; + coex_sta->specific_pkt_period_cnt = 2; + } else if (type == BTC_PACKET_ARP) { + + coex_dm->arp_cnt++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ARP notify -cnt = %d\n", + coex_dm->arp_cnt); + BTC_TRACE(trace_buf); + + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", + type); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = TRUE; + coex_sta->specific_pkt_period_cnt = 2; + } + + if (coex_sta->wifi_is_high_pri_task) { + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_SCAN, TRUE); + halbtc8821c1ant_run_coexist_mechanism(btcoexist); + } + +} + +void ex_halbtc8821c1ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i, rsp_source = 0; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE, + wifi_busy = FALSE; + static boolean is_scoreboard_scan = FALSE; + + if (psd_scan->is_AntDet_running == TRUE) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], bt_info_notify return for AntDet is running\n"); + BTC_TRACE(trace_buf); + return; + } + + rsp_source = tmp_buf[0] & 0xf; + if (rsp_source >= BT_INFO_SRC_8821C_1ANT_MAX) + rsp_source = BT_INFO_SRC_8821C_1ANT_WIFI_FW; + coex_sta->bt_info_c2h_cnt[rsp_source]++; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, + length); + BTC_TRACE(trace_buf); + + for (i = 0; i < length; i++) { + coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; + + if (i == length - 1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } + } + + coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; + coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; + coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; + + if (BT_INFO_SRC_8821C_1ANT_WIFI_FW != rsp_source) { + + /* if 0xff, it means BT is under WHCK test */ + coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? TRUE : + FALSE); + + coex_sta->bt_create_connection = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? TRUE : + FALSE); + + /* unit: %, value-100 to translate to unit: dBm */ + coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + + 10; + + coex_sta->c2h_bt_remote_name_req = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? TRUE : + FALSE); + + coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & + 0x10) ? TRUE : FALSE); + + coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & + 0x8) ? TRUE : FALSE); + + coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? + TRUE : FALSE); + + coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & + BT_INFO_8821C_1ANT_B_INQ_PAGE) ? TRUE : FALSE); + + coex_sta->a2dp_bit_pool = ((( + coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? + (coex_sta->bt_info_c2h[rsp_source][6] & 0x7f) : 0); + + coex_sta->is_bt_a2dp_sink = (coex_sta->bt_info_c2h[rsp_source][6] & 0x80) ? + TRUE : FALSE; + + coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & + 0xf; + + coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; + + coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; + + coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; + + coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; + + if (coex_sta->bt_retry_cnt >= 1) + coex_sta->pop_event_cnt++; + + if (coex_sta->c2h_bt_remote_name_req) + coex_sta->cnt_RemoteNameReq++; + + if (coex_sta->bt_info_ext & BIT(1)) + coex_sta->cnt_ReInit++; + + if (coex_sta->bt_info_ext & BIT(2)) { + coex_sta->cnt_setupLink++; + coex_sta->is_setupLink = TRUE; + coex_sta->bt_relink_downcount = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->is_setupLink = FALSE; + coex_sta->bt_relink_downcount = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop in BT info!!\n"); + BTC_TRACE(trace_buf); + } + + if (coex_sta->bt_info_ext & BIT(3)) + coex_sta->cnt_IgnWlanAct++; + + if (coex_sta->bt_info_ext & BIT(6)) + coex_sta->cnt_RoleSwitch++; + + if (coex_sta->bt_info_ext & BIT(7)) + coex_sta->is_bt_multi_link = TRUE; + else + coex_sta->is_bt_multi_link = FALSE; + + if (coex_sta->bt_create_connection) { + coex_sta->cnt_Page++; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); + + if ((wifi_link) || (wifi_roam) || (wifi_scan) || + (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { + + is_scoreboard_scan = TRUE; + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_SCAN, TRUE); + + } else + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_SCAN, FALSE); + + } else { + if (is_scoreboard_scan) { + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_SCAN, FALSE); + is_scoreboard_scan = FALSE; + } + } + + /* Here we need to resend some wifi info to BT */ + /* because bt is reset and loss of the info. */ + + if ((!btcoexist->manual_control) && + (!btcoexist->stop_coex_dm)) { + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + /* Re-Init */ + if ((coex_sta->bt_info_ext & BIT(1))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); + BTC_TRACE(trace_buf); + if (wifi_connected) + halbtc8821c1ant_update_wifi_channel_info( + btcoexist, BTC_MEDIA_CONNECT); + else + halbtc8821c1ant_update_wifi_channel_info( + btcoexist, + BTC_MEDIA_DISCONNECT); + } + + /* If Ignore_WLanAct && not SetUp_Link */ + if ((coex_sta->bt_info_ext & BIT(3)) && + (!(coex_sta->bt_info_ext & BIT(2)))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); + BTC_TRACE(trace_buf); + halbtc8821c1ant_ignore_wlan_act(btcoexist, + FORCE_EXEC, FALSE); + } + } + + } + + if ((coex_sta->bt_info_ext & BIT(5))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); + BTC_TRACE(trace_buf); + coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt( + btcoexist); + + if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) + coex_sta->bt_ble_scan_para[0] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x1); + if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) + coex_sta->bt_ble_scan_para[1] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x2); + if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) + coex_sta->bt_ble_scan_para[2] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x4); + + } + + halbtc8821c1ant_update_bt_link_info(btcoexist); + + halbtc8821c1ant_run_coexist_mechanism(btcoexist); +} + +void ex_halbtc8821c1ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i = 0; + static u8 tmp_buf_pre[10] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi Fw Dbg info = %d %d %d %d %d %d (len = %d)\n", + tmp_buf[0], tmp_buf[1], + tmp_buf[2], tmp_buf[3], + tmp_buf[4], tmp_buf[5], length); + BTC_TRACE(trace_buf); + + if (tmp_buf[0] == 0x8) { + for (i = 1; i <= 5; i++) { + coex_sta->wl_fw_dbg_info[i] = + (tmp_buf[i] >= tmp_buf_pre[i]) ? + (tmp_buf[i] - tmp_buf_pre[i]) : + (255 - tmp_buf_pre[i] + tmp_buf[i]); + + tmp_buf_pre[i] = tmp_buf[i]; + } + } +} + + +void ex_halbtc8821c1ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id) +{ + BOOLEAN wifi_connected = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (is_data_frame) { + coex_sta->wl_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rx_rate_change_notify data rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } else { + coex_sta->wl_rts_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rts_rate_change_notify RTS rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rts_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } + + if ((wifi_connected) && + ((coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_ACL_SCO_BUSY) || + (coex_dm->bt_status == BT_8821C_1ANT_BT_STATUS_SCO_BUSY))) { + + if ((coex_sta->wl_rx_rate == BTC_CCK_5_5) || + (coex_sta->wl_rx_rate == BTC_OFDM_6) || + (coex_sta->wl_rx_rate == BTC_MCS_0)) { + + coex_sta->cck_lock_warn = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck lock warning...\n"); + BTC_TRACE(trace_buf); + } else if ((coex_sta->wl_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rx_rate == BTC_CCK_2) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_2)) { + + coex_sta->cck_lock = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck locking...\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck unlock...\n"); + BTC_TRACE(trace_buf); + } + } else { + if ((coex_dm->bt_status == + BT_8821C_1ANT_BT_STATUS_CONNECTED_IDLE) || + (coex_dm->bt_status == + BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE)) { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + } + } + +} + +void ex_halbtc8821c1ant_rf_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); + BTC_TRACE(trace_buf); + + if (type == BTC_RF_ON) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned ON!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->stop_coex_dm = FALSE; + coex_sta->is_rf_state_off = FALSE; +#if 0 + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_ONOFF, + TRUE); +#endif + } else if (type == BTC_RF_OFF) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned OFF!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_ONOFF | + BT_8821C_1ANT_SCOREBOARD_SCAN | + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, + FALSE); + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_WLAN_OFF); + halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = TRUE; + } +} + +void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_ONOFF | + BT_8821C_1ANT_SCOREBOARD_SCAN | + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, + FALSE); + + halbtc8821c1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_1ANT_PHASE_WLAN_OFF); + + ex_halbtc8821c1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); + + halbtc8821c1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + btcoexist->stop_coex_dm = TRUE; +} + +void ex_halbtc8821c1ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state) +{ + boolean wifi_under_5g = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((BTC_WIFI_PNP_SLEEP == pnp_state) || + (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to SLEEP\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_ONOFF | + BT_8821C_1ANT_SCOREBOARD_SCAN | + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, + FALSE); + + if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { + + if (wifi_under_5g) + halbtc8821c1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_1ANT_PHASE_5G_RUNTIME); + else + halbtc8821c1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_1ANT_PHASE_2G_RUNTIME); + } else { + + halbtc8821c1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_1ANT_PHASE_WLAN_OFF); + } + + btcoexist->stop_coex_dm = TRUE; + } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to WAKE UP\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_ACTIVE | + BT_8821C_1ANT_SCOREBOARD_ONOFF, + TRUE); +#endif + btcoexist->stop_coex_dm = FALSE; + } +} + + +void ex_halbtc8821c1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], *****************Coex DM Reset*****************\n"); + BTC_TRACE(trace_buf); + + halbtc8821c1ant_init_hw_config(btcoexist, FALSE, FALSE); + halbtc8821c1ant_init_coex_dm(btcoexist); +} + +void ex_halbtc8821c1ant_periodical(IN struct btc_coexist *btcoexist) +{ + + struct btc_board_info *board_info = &btcoexist->board_info; + boolean wifi_busy = FALSE; + u16 bt_scoreboard_val = 0; + boolean bt_relink_finish = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ************* Periodical *************\n"); + BTC_TRACE(trace_buf); + +#if (BT_AUTO_REPORT_ONLY_8821C_1ANT == 0) + halbtc8821c1ant_query_bt_info(btcoexist); + +#endif + + halbtc8821c1ant_monitor_bt_ctr(btcoexist); + halbtc8821c1ant_monitor_wifi_ctr(btcoexist); + + halbtc8821c1ant_monitor_bt_enable_disable(btcoexist); + +#if 0 + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + /* halbtc8821c1ant_read_score_board(btcoexist, &bt_scoreboard_val); */ + + if (wifi_busy) { + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, TRUE); + /* + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_WLBUSY, TRUE); + + if (bt_scoreboard_val & BIT(6)) + halbtc8821c1ant_query_bt_info(btcoexist); */ + } else { + halbtc8821c1ant_post_state_to_bt(btcoexist, + BT_8821C_1ANT_SCOREBOARD_UNDERTEST, FALSE); + } +#endif + + if (coex_sta->bt_relink_downcount != 0) { + coex_sta->bt_relink_downcount--; + + if (coex_sta->bt_relink_downcount == 0) { + coex_sta->is_setupLink = FALSE; + bt_relink_finish = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop by periodical count-down!!\n"); + BTC_TRACE(trace_buf); + } + } + + /* for 4-way, DHCP, EAPOL packet */ + if (coex_sta->specific_pkt_period_cnt > 0) { + + coex_sta->specific_pkt_period_cnt--; + + if ((coex_sta->specific_pkt_period_cnt == 0) && + (coex_sta->wifi_is_high_pri_task)) + coex_sta->wifi_is_high_pri_task = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ***************** Hi-Pri Task = %s\n", + (coex_sta->wifi_is_high_pri_task ? "Yes" : + "No")); + BTC_TRACE(trace_buf); + + } + + if (halbtc8821c1ant_is_wifibt_status_changed(btcoexist) || (bt_relink_finish) + || (coex_sta->is_set_ps_state_fail)) + halbtc8821c1ant_run_coexist_mechanism(btcoexist); + +} + +/*#pragma optimize( "", off )*/ +void ex_halbtc8821c1ant_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ + +} + + +void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist) +{ + +} + +void ex_halbtc8821c1ant_antenna_isolation(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ + + +} + +void ex_halbtc8821c1ant_psd_scan(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ + + +} + + +#endif + +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.h index a3cb76a0f7d4..bb34171f444e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c1ant.h @@ -1,3 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -6,6 +21,7 @@ /* ******************************************* * The following is for 8821C 1ANT BT Co-exist definition * ******************************************* */ +#define BT_8821C_1ANT_COEX_DBG 0 #define BT_AUTO_REPORT_ONLY_8821C_1ANT 1 #define BT_INFO_8821C_1ANT_B_FTP BIT(7) @@ -18,11 +34,13 @@ #define BT_INFO_8821C_1ANT_B_CONNECTION BIT(0) #define BT_INFO_8821C_1ANT_A2DP_BASIC_RATE(_BT_INFO_EXT_) \ - (((_BT_INFO_EXT_&BIT(0))) ? true : false) + (((_BT_INFO_EXT_&BIT(0))) ? TRUE : FALSE) #define BTC_RSSI_COEX_THRESH_TOL_8821C_1ANT 2 #define BT_8821C_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ +#define BT_8821C_1ANT_DEFAULT_ISOLATION 15 /* unit: dB */ + /* for Antenna detection */ #define BT_8821C_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 @@ -30,11 +48,11 @@ #define BT_8821C_1ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 55 #define BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT 35 #define BT_8821C_1ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -#define BT_8821C_1ANT_ANTDET_SWEEPPOINT_DELAY 40000 +#define BT_8821C_1ANT_ANTDET_SWEEPPOINT_DELAY 60000 #define BT_8821C_1ANT_ANTDET_ENABLE 0 -#define BT_8821C_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 #define BT_8821C_1ANT_ANTDET_BTTXTIME 100 #define BT_8821C_1ANT_ANTDET_BTTXCHANNEL 39 +#define BT_8821C_1ANT_ANTDET_PSD_SWWEEPCOUNT 50 #define BT_8821C_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 @@ -123,6 +141,7 @@ enum bt_8821c_1ant_coex_algo { enum bt_8821c_1ant_ext_ant_switch_type { BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT = 0x0, BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT = 0x1, + BT_8821C_1ANT_EXT_ANT_SWITCH_NONE = 0x2, BT_8821C_1ANT_EXT_ANT_SWITCH_MAX }; @@ -150,23 +169,32 @@ enum bt_8821c_1ant_ext_band_switch_pos_type { BT_8821C_1ANT_EXT_BAND_SWITCH_TO_MAX }; -enum bt_8821c_1ant_int_block{ +enum bt_8821c_1ant_int_block { BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG = 0x0, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG = 0x1, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG = 0x2, BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_MAX }; -enum bt_8821c_1ant_phase{ +enum bt_8821c_1ant_phase { BT_8821C_1ANT_PHASE_COEX_INIT = 0x0, - BT_8821C_1ANT_PHASE_WLANONLY_INIT = 0x1, + BT_8821C_1ANT_PHASE_WLANONLY_INIT = 0x1, BT_8821C_1ANT_PHASE_WLAN_OFF = 0x2, BT_8821C_1ANT_PHASE_2G_RUNTIME = 0x3, BT_8821C_1ANT_PHASE_5G_RUNTIME = 0x4, BT_8821C_1ANT_PHASE_BTMPMODE = 0x5, + BT_8821C_1ANT_PHASE_ANTENNA_DET = 0x6, + BT_8821C_1ANT_PHASE_COEX_POWERON = 0x7, BT_8821C_1ANT_PHASE_MAX }; +enum bt_8821c_1ant_Scoreboard { + BT_8821C_1ANT_SCOREBOARD_ACTIVE = BIT(0), + BT_8821C_1ANT_SCOREBOARD_ONOFF = BIT(1), + BT_8821C_1ANT_SCOREBOARD_SCAN = BIT(2), + BT_8821C_1ANT_SCOREBOARD_UNDERTEST = BIT(3), + BT_8821C_1ANT_SCOREBOARD_WLBUSY = BIT(6) +}; struct coex_dm_8821c_1ant { /* hw setting */ @@ -179,7 +207,6 @@ struct coex_dm_8821c_1ant { u8 cur_ps_tdma; u8 ps_tdma_para[5]; u8 ps_tdma_du_adj_type; - boolean auto_tdma_adjust; boolean pre_ps_tdma_on; boolean cur_ps_tdma_on; boolean pre_bt_auto_report; @@ -225,7 +252,7 @@ struct coex_dm_8821c_1ant { u32 pre_ext_ant_switch_status; u32 cur_ext_ant_switch_status; - + u8 pre_ext_band_switch_status; u8 cur_ext_band_switch_status; @@ -236,90 +263,138 @@ struct coex_dm_8821c_1ant { }; struct coex_sta_8821c_1ant { - boolean bt_disabled; - boolean bt_link_exist; - boolean sco_exist; - boolean a2dp_exist; - boolean hid_exist; - boolean pan_exist; - boolean bt_hi_pri_link_exist; + boolean bt_disabled; + boolean bt_link_exist; + boolean sco_exist; + boolean a2dp_exist; + boolean hid_exist; + boolean pan_exist; u8 num_of_profile; - boolean under_lps; - boolean under_ips; + boolean under_lps; + boolean under_ips; u32 specific_pkt_period_cnt; u32 high_priority_tx; u32 high_priority_rx; u32 low_priority_tx; u32 low_priority_rx; + boolean is_hiPri_rx_overhead; s8 bt_rssi; - boolean bt_tx_rx_mask; u8 pre_bt_rssi_state; u8 pre_wifi_rssi_state[4]; - boolean c2h_bt_info_req_sent; u8 bt_info_c2h[BT_INFO_SRC_8821C_1ANT_MAX][10]; u32 bt_info_c2h_cnt[BT_INFO_SRC_8821C_1ANT_MAX]; - boolean bt_whck_test; - boolean c2h_bt_inquiry_page; - boolean c2h_bt_page; /* Add for win8.1 page out issue */ - boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ - u8 bt_retry_cnt; + boolean bt_whck_test; + boolean c2h_bt_inquiry_page; + boolean c2h_bt_remote_name_req; + boolean c2h_bt_page; /* Add for win8.1 page out issue */ + boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ + u8 bt_info_ext; + u8 bt_info_ext2; u32 pop_event_cnt; u8 scan_ap_num; + u8 bt_retry_cnt; u32 crc_ok_cck; u32 crc_ok_11g; u32 crc_ok_11n; - u32 crc_ok_11n_agg; + u32 crc_ok_11n_vht; u32 crc_err_cck; u32 crc_err_11g; u32 crc_err_11n; - u32 crc_err_11n_agg; + u32 crc_err_11n_vht; + + boolean cck_lock; + boolean cck_lock_ever; + boolean cck_lock_warn; - boolean cck_lock; - boolean pre_ccklock; - boolean cck_ever_lock; u8 coex_table_type; - - boolean force_lps_on; - u32 wrong_profile_notification; - - boolean concurrent_rx_mode_on; - + boolean force_lps_ctrl; + boolean concurrent_rx_mode_on; u16 score_board; + u8 isolation_btween_wb; /* 0~ 50 */ u8 a2dp_bit_pool; u8 cut_version; boolean acl_busy; - boolean wl_rf_off_on_event; boolean bt_create_connection; - boolean run_time_state; u32 bt_coex_supported_feature; u32 bt_coex_supported_version; + + u8 bt_ble_scan_type; + u32 bt_ble_scan_para[3]; + + boolean run_time_state; + boolean freeze_coexrun_by_btinfo; + + boolean is_A2DP_3M; + boolean voice_over_HOGP; + u8 bt_info; + boolean is_autoslot; + u8 forbidden_slot; + u8 hid_busy_num; + u8 hid_pair_cnt; + + u32 cnt_RemoteNameReq; + u32 cnt_setupLink; + u32 cnt_ReInit; + u32 cnt_IgnWlanAct; + u32 cnt_Page; + u32 cnt_RoleSwitch; + + u16 bt_reg_vendor_ac; + u16 bt_reg_vendor_ae; + + boolean is_setupLink; + u8 wl_noisy_level; + u32 gnt_error_cnt; + + u8 bt_afh_map[10]; + u8 bt_relink_downcount; + boolean is_tdma_btautoslot; + boolean is_tdma_btautoslot_hang; + + u8 switch_band_notify_to; + boolean is_rf_state_off; + + boolean is_hid_low_pri_tx_overhead; + boolean is_bt_multi_link; + boolean is_bt_a2dp_sink; + boolean is_set_ps_state_fail; + u8 cnt_set_ps_state_fail; + + u8 wl_fw_dbg_info[10]; + u8 wl_rx_rate; + u8 wl_rts_rx_rate; + u8 wl_center_channel; + + u16 score_board_WB; }; -#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_DPDT 0 -#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_SPDT 1 +#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_DPDT 0 +#define BT_8821C_1ANT_EXT_BAND_SWITCH_USE_SPDT 1 -struct rfe_type_8821c_1ant{ +struct rfe_type_8821c_1ant { - u8 rfe_module_type; + u8 rfe_module_type; boolean ext_ant_switch_exist; u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ u8 ext_ant_switch_ctrl_polarity; /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ - + boolean ext_band_switch_exist; u8 ext_band_switch_type; /* 0:DPDT, 1:SPDT */ u8 ext_band_switch_ctrl_polarity; - boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ + boolean ant_at_main_port; - boolean ext_ant_switch_diversity; /* If diversity on */ + boolean wlg_Locate_at_btg; /* If TRUE: WLG at BTG, If FALSE: WLG at WLAG */ + + boolean ext_ant_switch_diversity; /* If diversity on */ }; #define BT_8821C_1ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ @@ -356,10 +431,13 @@ struct psdscan_sta_8821c_1ant { u32 psd_stop_point; u32 psd_max_value_point; u32 psd_max_value; + u32 psd_max_value2; + u32 psd_avg_value; /* filter loop_max_value that below BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ + u32 psd_loop_max_value[BT_8821C_1ANT_ANTDET_PSD_SWWEEPCOUNT]; /*max value in each loop */ u32 psd_start_base; u32 psd_avg_num; /* 1/8/16/32 */ u32 psd_gen_count; - boolean is_psd_running; + boolean is_AntDet_running; boolean is_psd_show_max_only; }; @@ -378,7 +456,7 @@ void ex_halbtc8821c1ant_lps_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8821c1ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c1ant_switchband_notify(IN struct btc_coexist *btcoexist, - IN u8 type); + IN u8 type); void ex_halbtc8821c1ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c1ant_media_status_notify(IN struct btc_coexist *btcoexist, @@ -387,6 +465,10 @@ void ex_halbtc8821c1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c1ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8821c1ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8821c1ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id); void ex_halbtc8821c1ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c1ant_halt_notify(IN struct btc_coexist *btcoexist); @@ -394,6 +476,7 @@ void ex_halbtc8821c1ant_pnp_notify(IN struct btc_coexist *btcoexist, IN u8 pnp_state); void ex_halbtc8821c1ant_coex_dm_reset(IN struct btc_coexist *btcoexist); void ex_halbtc8821c1ant_periodical(IN struct btc_coexist *btcoexist); +void ex_halbtc8821c1ant_display_simple_coex_info(IN struct btc_coexist *btcoexist); void ex_halbtc8821c1ant_display_coex_info(IN struct btc_coexist *btcoexist); void ex_halbtc8821c1ant_antenna_detection(IN struct btc_coexist *btcoexist, IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); @@ -412,16 +495,19 @@ void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist); #define ex_halbtc8821c1ant_ips_notify(btcoexist, type) #define ex_halbtc8821c1ant_lps_notify(btcoexist, type) #define ex_halbtc8821c1ant_scan_notify(btcoexist, type) -#define ex_halbtc8821c1ant_switchband_notify(btcoexist,type) +#define ex_halbtc8821c1ant_switchband_notify(btcoexist, type) #define ex_halbtc8821c1ant_connect_notify(btcoexist, type) #define ex_halbtc8821c1ant_media_status_notify(btcoexist, type) #define ex_halbtc8821c1ant_specific_packet_notify(btcoexist, type) #define ex_halbtc8821c1ant_bt_info_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8821c1ant_wl_fwdbginfo_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8821c1ant_rx_rate_change_notify(btcoexist, is_data_frame, btc_rate_id) #define ex_halbtc8821c1ant_rf_status_notify(btcoexist, type) #define ex_halbtc8821c1ant_halt_notify(btcoexist) #define ex_halbtc8821c1ant_pnp_notify(btcoexist, pnp_state) #define ex_halbtc8821c1ant_coex_dm_reset(btcoexist) #define ex_halbtc8821c1ant_periodical(btcoexist) +#define ex_halbtc8821c1ant_display_simple_coex_info(btcoexist) #define ex_halbtc8821c1ant_display_coex_info(btcoexist) #define ex_halbtc8821c1ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) #define ex_halbtc8821c1ant_antenna_isolation(btcoexist, cent_freq, offset, span, seconds) @@ -430,3 +516,5 @@ void ex_halbtc8821c1ant_display_ant_detection(IN struct btc_coexist *btcoexist); #endif #endif + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.c index 7579fa92d1c4..039386aba2e7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.c @@ -1,3 +1,19 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + /* ************************************************************ * Description: * @@ -11,7 +27,7 @@ /* ************************************************************ * include files * ************************************************************ */ -#include "Mp_Precomp.h" +#include "mp_precomp.h" #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -35,8 +51,10 @@ const char *const glbt_info_src_8821c_2ant[] = { "BT Info[bt auto report]", }; -u32 glcoex_ver_date_8821c_2ant = 20160316; -u32 glcoex_ver_8821c_2ant = 0x00; +u32 glcoex_ver_date_8821c_2ant = 20170727; +u32 glcoex_ver_8821c_2ant = 0x1b; +u32 glcoex_ver_btdesired_8821c_2ant = 0x1b; + /* ************************************************************ * local function proto type if needed @@ -44,7 +62,8 @@ u32 glcoex_ver_8821c_2ant = 0x00; * ************************************************************ * local function start with halbtc8821c2ant_ * ************************************************************ */ -u8 halbtc8821c2ant_bt_rssi_state(u8 *ppre_bt_rssi_state, u8 level_num, +u8 halbtc8821c2ant_bt_rssi_state(IN struct btc_coexist *btcoexist, + u8 *ppre_bt_rssi_state, u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) { s32 bt_rssi = 0; @@ -169,8 +188,10 @@ void halbtc8821c2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist, s8 interference_wl_tx = 0, interference_bt_tx = 0; - interference_wl_tx = BT_8821C_2ANT_WIFI_MAX_TX_POWER - isolation_measuared; - interference_bt_tx = BT_8821C_2ANT_BT_MAX_TX_POWER - isolation_measuared; + interference_wl_tx = BT_8821C_2ANT_WIFI_MAX_TX_POWER - + isolation_measuared; + interference_bt_tx = BT_8821C_2ANT_BT_MAX_TX_POWER - + isolation_measuared; @@ -238,7 +259,13 @@ void halbtc8821c2ant_query_bt_info(IN struct btc_coexist *btcoexist) { u8 h2c_parameter[1] = {0}; - coex_sta->c2h_bt_info_req_sent = true; + if (coex_sta->bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No query BT info because BT is disabled!\n"); + BTC_TRACE(trace_buf); + return; + } + h2c_parameter[0] |= BIT(0); /* trigger */ @@ -249,8 +276,8 @@ void halbtc8821c2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) { u32 reg_hp_txrx, reg_lp_txrx, u32tmp; u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; - static u8 num_of_bt_counter_chk = 0, cnt_slave = 0; - + static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_overhead = 0, + cnt_autoslot_hang = 0; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; reg_hp_txrx = 0x770; @@ -269,138 +296,292 @@ void halbtc8821c2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) coex_sta->low_priority_tx = reg_lp_tx; coex_sta->low_priority_rx = reg_lp_rx; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); + + BTC_TRACE(trace_buf); + + if (BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + + if (coex_sta->high_priority_rx >= 15) { + if (cnt_overhead < 3) + cnt_overhead++; + + if (cnt_overhead == 3) + coex_sta->is_hiPri_rx_overhead = TRUE; + + } else { + if (cnt_overhead > 0) + cnt_overhead--; + + if (cnt_overhead == 0) + coex_sta->is_hiPri_rx_overhead = FALSE; + } + } else + coex_sta->is_hiPri_rx_overhead = FALSE; /* reset counter */ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); - if ((coex_sta->low_priority_tx > 1050) && + if ((coex_sta->low_priority_tx > 1150) && (!coex_sta->c2h_bt_inquiry_page)) coex_sta->pop_event_cnt++; - if ((coex_sta->low_priority_rx >= 950) && (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) - && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && (coex_sta->bt_link_exist)) { + if ((coex_sta->low_priority_rx >= 1150) && + (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) + && (!coex_sta->under_ips) + && (!coex_sta->c2h_bt_inquiry_page) + && ((bt_link_info->a2dp_exist) || (bt_link_info->pan_exist))) { if (cnt_slave >= 2) { - bt_link_info->slave_role = true; + bt_link_info->slave_role = TRUE; cnt_slave = 2; } else cnt_slave++; } else { if (cnt_slave == 0) { - bt_link_info->slave_role = false; + bt_link_info->slave_role = FALSE; cnt_slave = 0; } else cnt_slave--; - } - if ((coex_sta->high_priority_tx == 0) && (coex_sta->high_priority_rx == 0) && (coex_sta->low_priority_tx == 0) && - (coex_sta->low_priority_rx == 0)) { - num_of_bt_counter_chk++; - if (num_of_bt_counter_chk >= 3) { - halbtc8821c2ant_query_bt_info(btcoexist); - num_of_bt_counter_chk = 0; + if (coex_sta->is_tdma_btautoslot) { + if ((coex_sta->low_priority_tx >= 1300) && + (coex_sta->low_priority_rx <= 150)) { + if (cnt_autoslot_hang >= 2) { + coex_sta->is_tdma_btautoslot_hang = TRUE; + cnt_autoslot_hang = 2; + } else + cnt_autoslot_hang++; + } else { + if (cnt_autoslot_hang == 0) { + coex_sta->is_tdma_btautoslot_hang = FALSE; + cnt_autoslot_hang = 0; + } else + cnt_autoslot_hang--; + } + } + + if (coex_sta->sco_exist) { + if ((coex_sta->high_priority_tx >= 400) && + (coex_sta->high_priority_rx >= 400)) + coex_sta->is_eSCO_mode = FALSE; + else + coex_sta->is_eSCO_mode = TRUE; + } + + if (bt_link_info->hid_only) { + if (coex_sta->low_priority_rx > 50) + coex_sta->is_hid_low_pri_tx_overhead = true; + else + coex_sta->is_hid_low_pri_tx_overhead = false; + } + + if (!coex_sta->bt_disabled) { + + if ((coex_sta->high_priority_tx == 0) && + (coex_sta->high_priority_rx == 0) && + (coex_sta->low_priority_tx == 0) && + (coex_sta->low_priority_rx == 0)) { + num_of_bt_counter_chk++; + if (num_of_bt_counter_chk >= 3) { + halbtc8821c2ant_query_bt_info(btcoexist); + num_of_bt_counter_chk = 0; + } } } } + void halbtc8821c2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) { + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE, wifi_under_b_mode = FALSE, + wifi_scan = FALSE, wifi_connected = FALSE; + boolean bt_idle = FALSE, wl_idle = FALSE, is_cck_deadlock = FALSE; + static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, + wl_noisy_count1 = 3, wl_noisy_count2 = 0; + u32 total_cnt, reg_val1, reg_val2, cnt_cck; + u32 cnt_crcok = 0, cnt_crcerr = 0; + static u8 cnt = 0, cnt_cal = 0, cnt_ccklocking = 0; + u8 h2c_parameter[1] = {0}; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - if (coex_sta->under_ips) { - coex_sta->crc_ok_cck = 0; - coex_sta->crc_ok_11g = 0; - coex_sta->crc_ok_11n = 0; - coex_sta->crc_ok_11n_agg = 0; - - coex_sta->crc_err_cck = 0; - coex_sta->crc_err_11g = 0; - coex_sta->crc_err_11n = 0; - coex_sta->crc_err_11n_agg = 0; - } else { - coex_sta->crc_ok_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf88); - coex_sta->crc_ok_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf94); - coex_sta->crc_ok_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf90); - coex_sta->crc_ok_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfb8); - - coex_sta->crc_err_cck = btcoexist->btc_read_4byte(btcoexist, - 0xf84); - coex_sta->crc_err_11g = btcoexist->btc_read_2byte(btcoexist, - 0xf96); - coex_sta->crc_err_11n = btcoexist->btc_read_2byte(btcoexist, - 0xf92); - coex_sta->crc_err_11n_agg = btcoexist->btc_read_2byte(btcoexist, - 0xfba); + /* Only enable for windows becaus 8821cu H2C 0x69 unknown fail @ linux */ + if (btcoexist->chip_interface != BTC_INTF_USB) { + /*send h2c to query WL FW dbg info */ + if (((coex_dm->cur_ps_tdma_on) && (coex_sta->force_lps_ctrl)) || + ((coex_sta->acl_busy) && (bt_link_info->a2dp_exist))) { + h2c_parameter[0] = 0x8; + btcoexist->btc_fill_h2c(btcoexist, 0x69, 1, h2c_parameter); + } } - /* reset counter */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x1); - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xf16, 0x1, 0x0); -} - -boolean halbtc8821c2ant_is_wifibt_status_changed(IN struct btc_coexist *btcoexist) -{ - static boolean pre_wifi_busy = false, pre_under_4way = false, - pre_bt_hs_on = false, pre_bt_off = false; - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; - boolean wifi_busy = false, under_4way = false, bt_hs_on = false; - boolean wifi_connected = false; - u8 wifi_rssi_state = BTC_RSSI_STATE_HIGH; - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, - &under_4way); + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); - if (coex_sta->bt_disabled != pre_bt_off) { - pre_bt_off = coex_sta->bt_disabled; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); - if (coex_sta->bt_disabled) - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is disabled !!\n"); + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + + cnt_crcok = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + + coex_sta->crc_ok_11n_vht; + + cnt_crcerr = coex_sta->crc_err_cck + coex_sta->crc_err_11g + + coex_sta->crc_err_11n + + coex_sta->crc_err_11n_vht; + + + if ((wifi_busy) && (cnt_crcerr != 0)) { + if (cnt_cal == 0) + coex_sta->cnt_crcok_max_in_10s = 0; + + cnt_cal++; + + if (cnt_crcok > coex_sta->cnt_crcok_max_in_10s) + coex_sta->cnt_crcok_max_in_10s = cnt_crcok; + + if (cnt_cal == 5) + cnt_cal = 0; + + coex_sta->now_crc_ratio = cnt_crcok/cnt_crcerr; + + if (cnt == 0) + coex_sta->acc_crc_ratio = coex_sta->now_crc_ratio; else - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BT is enabled !!\n"); + coex_sta->acc_crc_ratio = (coex_sta->acc_crc_ratio * 7 + + coex_sta->now_crc_ratio * 3)/10; - BTC_TRACE(trace_buf); - - coex_sta->bt_coex_supported_feature = 0; - coex_sta->bt_coex_supported_version = 0; - return true; + if (cnt >= 10) + cnt = 0; + else + cnt++; } - if (wifi_connected) { - if (wifi_busy != pre_wifi_busy) { - pre_wifi_busy = wifi_busy; - return true; - } - if (under_4way != pre_under_4way) { - pre_under_4way = under_4way; - return true; - } - if (bt_hs_on != pre_bt_hs_on) { - pre_bt_hs_on = bt_hs_on; - return true; - } + /* CCK lock identification */ + if (coex_sta->cck_lock) + cnt_ccklocking++; + else if (cnt_ccklocking != 0) + cnt_ccklocking--; + if (cnt_ccklocking >= 3) { + cnt_ccklocking = 3; + coex_sta->cck_lock_ever = TRUE; } - return false; + /* WiFi environment noisy identification */ + cnt_cck = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + + if ((!wifi_busy) && (!coex_sta->cck_lock)) { + if (cnt_cck > 250) { + if (wl_noisy_count2 < 3) + wl_noisy_count2++; + + if (wl_noisy_count2 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count1 = 0; + } + + } else if (cnt_cck < 50) { + if (wl_noisy_count0 < 3) + wl_noisy_count0++; + + if (wl_noisy_count0 == 3) { + wl_noisy_count1 = 0; + wl_noisy_count2 = 0; + } + + } else { + if (wl_noisy_count1 < 3) + wl_noisy_count1++; + + if (wl_noisy_count1 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count2 = 0; + } + } + + if (wl_noisy_count2 == 3) + coex_sta->wl_noisy_level = 2; + else if (wl_noisy_count1 == 3) + coex_sta->wl_noisy_level = 1; + else + coex_sta->wl_noisy_level = 0; + } } void halbtc8821c2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) { - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + boolean bt_busy = FALSE; + + coex_sta->num_of_profile = 0; + + /* set link exist status */ + if (!(coex_sta->bt_info & BT_INFO_8821C_1ANT_B_CONNECTION)) { + coex_sta->bt_link_exist = FALSE; + coex_sta->pan_exist = FALSE; + coex_sta->a2dp_exist = FALSE; + coex_sta->hid_exist = FALSE; + coex_sta->sco_exist = FALSE; + } else { /* connection exists */ + coex_sta->bt_link_exist = TRUE; + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_FTP) { + coex_sta->pan_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->pan_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_A2DP) { + coex_sta->a2dp_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->a2dp_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_HID) { + coex_sta->hid_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->hid_exist = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_1ANT_B_SCO_ESCO) { + coex_sta->sco_exist = TRUE; + coex_sta->num_of_profile++; + } else + coex_sta->sco_exist = FALSE; + + } + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); @@ -413,8 +594,8 @@ void halbtc8821c2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) /* work around for HS mode. */ if (bt_hs_on) { - bt_link_info->pan_exist = true; - bt_link_info->bt_link_exist = true; + bt_link_info->pan_exist = TRUE; + bt_link_info->bt_link_exist = TRUE; } /* check if Sco only */ @@ -422,69 +603,152 @@ void halbtc8821c2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->sco_only = true; + bt_link_info->sco_only = TRUE; else - bt_link_info->sco_only = false; + bt_link_info->sco_only = FALSE; /* check if A2dp only */ if (!bt_link_info->sco_exist && bt_link_info->a2dp_exist && !bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->a2dp_only = true; + bt_link_info->a2dp_only = TRUE; else - bt_link_info->a2dp_only = false; + bt_link_info->a2dp_only = FALSE; /* check if Pan only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && bt_link_info->pan_exist && !bt_link_info->hid_exist) - bt_link_info->pan_only = true; + bt_link_info->pan_only = TRUE; else - bt_link_info->pan_only = false; + bt_link_info->pan_only = FALSE; /* check if Hid only */ if (!bt_link_info->sco_exist && !bt_link_info->a2dp_exist && !bt_link_info->pan_exist && bt_link_info->hid_exist) - bt_link_info->hid_only = true; + bt_link_info->hid_only = TRUE; else - bt_link_info->hid_only = false; + bt_link_info->hid_only = FALSE; + + if (coex_sta->bt_info & BT_INFO_8821C_2ANT_B_INQ_PAGE) { + coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_INQ_PAGE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); + } else if (!(coex_sta->bt_info & BT_INFO_8821C_2ANT_B_CONNECTION)) { + coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); + } else if (coex_sta->bt_info == BT_INFO_8821C_2ANT_B_CONNECTION) { + /* connection exists but no busy */ + coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); + } else if (((coex_sta->bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8821C_2ANT_B_SCO_BUSY)) && + (coex_sta->bt_info & BT_INFO_8821C_2ANT_B_ACL_BUSY)) { + coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); + } else if ((coex_sta->bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8821C_2ANT_B_SCO_BUSY)) { + coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); + } else if (coex_sta->bt_info & BT_INFO_8821C_2ANT_B_ACL_BUSY) { + coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_ACL_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); + } else { + coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_MAX; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); + } + + BTC_TRACE(trace_buf); + + if ((BT_8821C_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8821C_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + bt_busy = TRUE; + else + bt_busy = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); } void halbtc8821c2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, IN u8 type) { - u8 h2c_parameter[3] = {0}; + u8 h2c_parameter[3] = {0}, i; u32 wifi_bw; - u8 wifi_central_chnl; + u8 wifi_central_chnl = 0; + u8 wifi_5g_chnl[19] = {120, 124, 128, 132, 136, 140, 144, 149, + 153, 157, 118, 126, 134, 142, 151, 159, + 122, 138, 155}; + u8 bt_skip_cneter_chanl[19] = {2, 8, 17, 26, 34, 42, 51, 62, + 71, 77, 2, 12, 29, 46, 66, 76, + 10, 37, 68}; + u8 bt_skip_span[19] = {4, 8, 8, 10, 8, 10, 8, 8, 10, 4, 4, 16, + 16, 16, 16, 4, 20, 34, 20}; + boolean wifi_under_5g = FALSE; - /* only 2.4G we need to inform bt the chnl mask */ - btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, - &wifi_central_chnl); - if ((BTC_MEDIA_CONNECT == type) && - (wifi_central_chnl <= 14)) { - h2c_parameter[0] = - 0x1; /* enable BT AFH skip WL channel for 8821c because BT Rx LO interference */ - /* h2c_parameter[0] = 0x0; */ - h2c_parameter[1] = wifi_central_chnl; - btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); - if (BTC_WIFI_BW_HT40 == wifi_bw) - h2c_parameter[2] = 0x30; - else - h2c_parameter[2] = 0x20; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (type == BTC_MEDIA_CONNECT) { + + if (!wifi_under_5g) { + + btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, + &wifi_central_chnl); + + h2c_parameter[0] = 0x1; + h2c_parameter[1] = wifi_central_chnl; + + if (wifi_bw == BTC_WIFI_BW_HT40) + h2c_parameter[2] = 0x30; + else + h2c_parameter[2] = 0x20; + } else { /* for 5G */ + + wifi_central_chnl = + btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x18, 0xfffff) & 0xff; + + for (i = 0; i <= 18; i++) { + if (wifi_central_chnl == wifi_5g_chnl[i]) + break; + } + + if (i <= 18) { + h2c_parameter[0] = 0x3; + h2c_parameter[1] = bt_skip_cneter_chanl[i]; + h2c_parameter[2] = bt_skip_span[i]; + } + + } } coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; + coex_sta->wl_center_channel = wifi_central_chnl; btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], para[0:2] = 0x%x 0x%x 0x%x\n", + h2c_parameter[0], h2c_parameter[1], h2c_parameter[2]); + BTC_TRACE(trace_buf); + } + + + void halbtc8821c2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, IN u8 dac_swing_lvl) { @@ -519,9 +783,11 @@ void halbtc8821c2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[1] = {0}; - h2c_parameter[0] = dec_bt_pwr_lvl; + h2c_parameter[0] = 0 - dec_bt_pwr_lvl; +#if 1 btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); +#endif } void halbtc8821c2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, @@ -539,40 +805,32 @@ void halbtc8821c2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; } -void halbtc8821c2ant_set_fw_low_penalty_ra(IN struct btc_coexist - *btcoexist, IN boolean low_penalty_ra) -{ - u8 h2c_parameter[6] = {0}; - - h2c_parameter[0] = 0x6; /* op_code, 0x6= Retry_Penalty */ - - if (low_penalty_ra) { - h2c_parameter[1] |= BIT(0); - h2c_parameter[2] = - 0x00; /* normal rate except MCS7/6/5, OFDM54/48/36 */ - h2c_parameter[3] = 0xf7; /* MCS7 or OFDM54 */ - h2c_parameter[4] = 0xf8; /* MCS6 or OFDM48 */ - h2c_parameter[5] = 0xf9; /* MCS5 or OFDM36 */ - } - - btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, h2c_parameter); -} void halbtc8821c2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean low_penalty_ra) { + +#if 1 coex_dm->cur_low_penalty_ra = low_penalty_ra; if (!force_exec) { - if (coex_dm->pre_low_penalty_ra == coex_dm->cur_low_penalty_ra) + if (coex_dm->pre_low_penalty_ra == + coex_dm->cur_low_penalty_ra) return; } - halbtc8821c2ant_set_fw_low_penalty_ra(btcoexist, - coex_dm->cur_low_penalty_ra); + + if (low_penalty_ra) + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 15); + else + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; + +#endif + } + void halbtc8821c2ant_set_bt_auto_report(IN struct btc_coexist *btcoexist, IN boolean enable_auto_report) { @@ -601,41 +859,34 @@ void halbtc8821c2ant_bt_auto_report(IN struct btc_coexist *btcoexist, coex_dm->pre_bt_auto_report = coex_dm->cur_bt_auto_report; } -void halbtc8821c2ant_sw_mechanism1(IN struct btc_coexist *btcoexist, - IN boolean shrink_rx_lpf, IN boolean low_penalty_ra, - IN boolean limited_dig, IN boolean bt_lna_constrain) -{ - - halbtc8821c2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); -} - -void halbtc8821c2ant_sw_mechanism2(IN struct btc_coexist *btcoexist, - IN boolean agc_table_shift, IN boolean adc_back_off, - IN boolean sw_dac_swing, IN u32 dac_swing_lvl) -{ - /* halbtc8821c2ant_agc_table(btcoexist, NORMAL_EXEC, agc_table_shift); */ - /* halbtc8821c2ant_adc_back_off(btcoexist, NORMAL_EXEC, adc_back_off); */ -} - void halbtc8821c2ant_write_score_board( IN struct btc_coexist *btcoexist, IN u16 bitpos, - IN BOOLEAN state + IN boolean state ) { - static u16 originalval = 0x8002; + static u16 originalval = 0x8002, preval = 0x0; if (state) originalval = originalval | bitpos; else originalval = originalval & (~bitpos); + coex_sta->score_board_WB = originalval; - btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); + if (originalval != preval) { + preval = originalval; + btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_write_score_board: return for nochange\n"); + BTC_TRACE(trace_buf); + } } + void halbtc8821c2ant_read_score_board( IN struct btc_coexist *btcoexist, IN u16 *score_board_val @@ -646,38 +897,136 @@ void halbtc8821c2ant_read_score_board( 0xaa)) & 0x7fff; } -void halbtc8821c2ant_post_activestate_to_bt( + +void halbtc8821c2ant_post_state_to_bt( IN struct btc_coexist *btcoexist, - IN boolean wifi_active + IN u16 type, + IN boolean state ) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_post_state_to_bt: type = %d, state =%d\n", + type, state); + BTC_TRACE(trace_buf); - if (wifi_active) - halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(0), TRUE); - else - halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(0), FALSE); - - /* The BT should set "No Shunt-down" mode if WL = Active for BT Synthesizer on/off interference WL Lo issue at 8703b b-cut. */ - + halbtc8821c2ant_write_score_board(btcoexist, (u16) type, state); } -void halbtc8821c2ant_post_onoffstate_to_bt( - IN struct btc_coexist *btcoexist, - IN boolean wifi_on -) + +boolean halbtc8821c2ant_is_wifibt_status_changed(IN struct btc_coexist + *btcoexist) { + static boolean pre_wifi_busy = FALSE, pre_under_4way = FALSE, + pre_bt_hs_on = FALSE, pre_bt_off = FALSE, + pre_bt_slave = FALSE, pre_hid_low_pri_tx_overhead = FALSE, + pre_wifi_under_lps = FALSE, pre_bt_setup_link = FALSE, + pre_cck_lock = FALSE, pre_cck_lock_warn = FALSE; + static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; + boolean wifi_busy = FALSE, under_4way = FALSE, bt_hs_on = FALSE; + boolean wifi_connected = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - if (wifi_on) - halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(1), TRUE); - else - halbtc8821c2ant_write_score_board(btcoexist, (u16) BIT(1), FALSE); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + if (coex_sta->bt_disabled != pre_bt_off) { + pre_bt_off = coex_sta->bt_disabled; + + if (coex_sta->bt_disabled) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is enabled !!\n"); + + BTC_TRACE(trace_buf); + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->bt_reg_vendor_ac = 0xffff; + coex_sta->bt_reg_vendor_ae = 0xffff; + return TRUE; + } + + + if (wifi_connected) { +#if 0 + if ((wifi_busy) && + (coex_dm->bt_status == BT_8821C_2ANT_BT_STATUS_ACL_BUSY)) + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, TRUE); + else + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, FALSE); +#endif + if (wifi_busy != pre_wifi_busy) { + pre_wifi_busy = wifi_busy; + return TRUE; + } + if (under_4way != pre_under_4way) { + pre_under_4way = under_4way; + return TRUE; + } + if (bt_hs_on != pre_bt_hs_on) { + pre_bt_hs_on = bt_hs_on; + return TRUE; + } + if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { + pre_wl_noisy_level = coex_sta->wl_noisy_level; + return TRUE; + } + if (coex_sta->under_lps != pre_wifi_under_lps) { + pre_wifi_under_lps = coex_sta->under_lps; + if (coex_sta->under_lps == TRUE) + return TRUE; + } + if (coex_sta->cck_lock != pre_cck_lock) { + pre_cck_lock = coex_sta->cck_lock; + return TRUE; + } + if (coex_sta->cck_lock_warn != pre_cck_lock_warn) { + pre_cck_lock_warn = coex_sta->cck_lock_warn; + return TRUE; + } + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->hid_busy_num != pre_hid_busy_num) { + pre_hid_busy_num = coex_sta->hid_busy_num; + return TRUE; + } + + if (bt_link_info->slave_role != pre_bt_slave) { + pre_bt_slave = bt_link_info->slave_role; + return TRUE; + } + + if (pre_hid_low_pri_tx_overhead != coex_sta->is_hid_low_pri_tx_overhead) { + pre_hid_low_pri_tx_overhead = coex_sta->is_hid_low_pri_tx_overhead; + return TRUE; + } + + if (pre_bt_setup_link != coex_sta->is_setupLink) { + pre_bt_setup_link = coex_sta->is_setupLink; + return TRUE; + } + } + + return FALSE; } void halbtc8821c2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) { static u32 bt_disable_cnt = 0; - boolean bt_active = true, bt_disabled = false; + boolean bt_active = TRUE, bt_disabled = FALSE, wifi_under_5g = FALSE; u16 u16tmp; /* This function check if bt is disabled */ @@ -686,12 +1035,12 @@ void halbtc8821c2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) coex_sta->high_priority_rx == 0 && coex_sta->low_priority_tx == 0 && coex_sta->low_priority_rx == 0) - bt_active = false; + bt_active = FALSE; if (coex_sta->high_priority_tx == 0xffff && coex_sta->high_priority_rx == 0xffff && coex_sta->low_priority_tx == 0xffff && coex_sta->low_priority_rx == 0xffff) - bt_active = false; + bt_active = FALSE; #else @@ -706,14 +1055,14 @@ void halbtc8821c2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) if (bt_active) { bt_disable_cnt = 0; - bt_disabled = false; + bt_disabled = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, &bt_disabled); } else { bt_disable_cnt++; if (bt_disable_cnt >= 2) { - bt_disabled = true; + bt_disabled = TRUE; bt_disable_cnt = 2; } @@ -721,6 +1070,13 @@ void halbtc8821c2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) &bt_disabled); } + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((wifi_under_5g) || (bt_disabled)) + halbtc8821c2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); + else + halbtc8821c2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, TRUE); + if (coex_sta->bt_disabled != bt_disabled) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -736,89 +1092,124 @@ void halbtc8821c2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) void halbtc8821c2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, boolean isenable) { - static u8 bitVal[5] = {0,0,0,0,0}; - static boolean state = false; - - if (state ==isenable) - return; - else - state = isenable; - +#if BT_8821C_2ANT_COEX_DBG + static u8 bitVal[5] = {0, 0, 0, 0, 0}; + static boolean state = FALSE; + /* + if (state ==isenable) + return; + else + state = isenable; + */ if (isenable) { - /* enable GNT_WL, GNT_BT to GPIO for debug */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], enable_gnt_to_gpio!!\n"); + BTC_TRACE(trace_buf); + + /* enable GNT_WL, GNT_BT to GPIO for debug */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); - /* store original value */ - bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, 0x66) & BIT(4)) >>4; /*0x66[4] */ - bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, 0x67) & BIT(0)); /*0x66[8] */ - bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, 0x42) & BIT(3)) >> 3; /*0x40[19] */ - bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, 0x65) & BIT(7)) >> 7; /*0x64[15] */ - bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, 0x72) & BIT(2)) >> 2; /*0x70[18] */ + /* store original value */ + bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, + 0x66) & BIT(4)) >> 4; /*0x66[4] */ + bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, + 0x67) & BIT(0)); /*0x66[8] */ + bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, + 0x42) & BIT(3)) >> 3; /*0x40[19] */ + bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, + 0x65) & BIT(7)) >> 7; /*0x64[15] */ + bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, + 0x72) & BIT(2)) >> 2; /*0x70[18] */ /* switch GPIO Mux */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), 0x0); /*0x66[4] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), 0x0); /*0x66[8] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), 0x0); /*0x40[19] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), 0x0); /*0x64[15] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), 0x0); /*0x70[18] = 0 */ - + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + 0x0); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + 0x0); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + 0x0); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + 0x0); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + 0x0); /*0x70[18] = 0 */ + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], disable_gnt_to_gpio!!\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); - /* Restore original value */ + /* Restore original value */ /* switch GPIO Mux */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), bitVal[0]); /*0x66[4] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), bitVal[1]); /*0x66[8] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), bitVal[2]); /*0x40[19] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), bitVal[3]); /*0x64[15] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), bitVal[4]); /*0x70[18] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + bitVal[0]); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + bitVal[1]); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + bitVal[2]); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + bitVal[3]); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + bitVal[4]); /*0x70[18] = 0 */ } +#endif } u32 halbtc8821c2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, IN u16 reg_addr) { - u32 j = 0; + u32 j = 0, delay_count = 0; + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } /* wait for ready bit before access 0x1700 */ btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703)&BIT(5)) == 0) && - (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - return btcoexist->btc_read_4byte(btcoexist, 0x1708); /* get read data */ } -void halbtc8821c2ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist, +void halbtc8821c2ant_ltecoex_indirect_write_reg(IN struct btc_coexist + *btcoexist, IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) { - u32 val, i = 0, j = 0, bitpos = 0; + u32 val, i = 0, j = 0, bitpos = 0, delay_count = 0; if (bit_mask == 0x0) return; if (bit_mask == 0xffffffff) { + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x1704, reg_value); /* put write data */ - /* wait for ready bit before access 0x1700 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703)&BIT(5)) == 0) && - (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - btcoexist->btc_write_4byte(btcoexist, 0x1700, 0xc00F0000 | reg_addr); } else { @@ -834,20 +1225,24 @@ void halbtc8821c2ant_ltecoex_indirect_write_reg(IN struct btc_coexist *btcoexist reg_addr); val = (val & (~bit_mask)) | (reg_value << bitpos); + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else + break; + } + btcoexist->btc_write_4byte(btcoexist, 0x1704, val); /* put write data */ - /* wait for ready bit before access 0x7c0 */ - do { - j++; - } while (((btcoexist->btc_read_1byte(btcoexist, - 0x1703)&BIT(5)) == 0) && - (j < BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT)); - - btcoexist->btc_write_4byte(btcoexist, 0x1700, 0xc00F0000 | reg_addr); - } } @@ -877,67 +1272,65 @@ void halbtc8821c2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, void halbtc8821c2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, IN u8 control_block, IN boolean sw_control, IN u8 state) { - u32 val = 0, bit_mask; + u32 val = 0, val_orig = 0; - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; + if (!sw_control) + val = 0x0; + else if (state & 0x1) + val = 0x3; + else + val = 0x1; + + val_orig = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); switch (control_block) { case BT_8821C_2ANT_GNT_BLOCK_RFC_BB: default: - bit_mask = 0xc000; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ - bit_mask = 0x0c00; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ + val = ((val << 14) | (val << 10)) | (val_orig & 0xffff33ff); break; case BT_8821C_2ANT_GNT_BLOCK_RFC: - bit_mask = 0xc000; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[15:14] */ + val = (val << 14) | (val_orig & 0xffff3fff); break; case BT_8821C_2ANT_GNT_BLOCK_BB: - bit_mask = 0x0c00; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[11:10] */ + val = (val << 10) | (val_orig & 0xfffff3ff); break; - } + halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, 0xffffffff, val); } void halbtc8821c2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, IN u8 control_block, IN boolean sw_control, IN u8 state) { - u32 val = 0, bit_mask; + u32 val = 0, val_orig = 0; - state = state & 0x1; - val = (sw_control) ? ((state << 1) | 0x1) : 0; + if (!sw_control) + val = 0x0; + else if (state & 0x1) + val = 0x3; + else + val = 0x1; + + val_orig = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); switch (control_block) { case BT_8821C_2ANT_GNT_BLOCK_RFC_BB: default: - bit_mask = 0x3000; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ - bit_mask = 0x0300; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ + val = ((val << 12) | (val << 8)) | (val_orig & 0xffffccff); break; case BT_8821C_2ANT_GNT_BLOCK_RFC: - bit_mask = 0x3000; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[13:12] */ + val = (val << 12) | (val_orig & 0xffffcfff); break; case BT_8821C_2ANT_GNT_BLOCK_BB: - bit_mask = 0x0300; - halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, - 0x38, bit_mask, val); /* 0x38[9:8] */ + val = (val << 8) | (val_orig & 0xfffffcff); break; - } + halbtc8821c2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, 0xffffffff, val); } void halbtc8821c2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, @@ -989,6 +1382,42 @@ void halbtc8821c2ant_ltecoex_set_break_table(IN struct btc_coexist *btcoexist, } +void halbtc8821c2ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 interval, + IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, + IN u8 val0x6c4_b3) +{ + static u8 pre_h2c_parameter[6] = {0}; + u8 cur_h2c_parameter[6] = {0}; + u8 i, match_cnt = 0; + + cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ + + cur_h2c_parameter[1] = interval; + cur_h2c_parameter[2] = val0x6c4_b0; + cur_h2c_parameter[3] = val0x6c4_b1; + cur_h2c_parameter[4] = val0x6c4_b2; + cur_h2c_parameter[5] = val0x6c4_b3; + + if (!force_exec) { + for (i = 1; i <= 5; i++) { + if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) + break; + + match_cnt++; + } + + if (match_cnt == 5) + return; + } + + for (i = 1; i <= 5; i++) + pre_h2c_parameter[i] = cur_h2c_parameter[i]; + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); +} + + void halbtc8821c2ant_set_coex_table(IN struct btc_coexist *btcoexist, IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) @@ -1035,7 +1464,7 @@ void halbtc8821c2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, coex_sta->coex_table_type = type; - if (coex_sta->concurrent_rx_mode_on == true) { + if (coex_sta->concurrent_rx_mode_on == TRUE) { break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ select_table = 0xb; /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ @@ -1051,7 +1480,7 @@ void halbtc8821c2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, break; case 1: halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0xaaaaaaaa, 0xaaaaaaaa, break_table, select_table); + 0x55555555, 0xfafafafa, break_table, select_table); break; case 2: halbtc8821c2ant_coex_table(btcoexist, force_exec, @@ -1059,27 +1488,35 @@ void halbtc8821c2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, break; case 3: halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0xdafadafa, 0xdafadafa, break_table, select_table); + 0x55555555, 0x5a5a5a5a, break_table, select_table); break; case 4: halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0xddffddff, 0xffbbffbb, break_table, select_table); + 0xffff55ff, 0xfafafafa, break_table, select_table); break; case 5: halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x5fff5fff, 0x5fff5fff, break_table, select_table); + 0x55555555, 0x55555555, break_table, select_table); break; case 6: halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x55ff55ff, 0x5a5a5a5a, break_table, select_table); + 0xaaffffaa, 0xfafafafa, break_table, select_table); break; case 7: halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x5aff55ff, 0x5a7a5a7a, break_table, select_table); + 0xaaffffaa, 0xfafafafa, break_table, select_table); break; case 8: halbtc8821c2ant_coex_table(btcoexist, force_exec, - 0x55555555, 0xaaaaaaaa, break_table, select_table); + 0xffff55ff, 0xfafafafa, break_table, select_table); + break; + case 9: + halbtc8821c2ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); + break; + case 10: + halbtc8821c2ant_coex_table(btcoexist, force_exec, + 0xaaaaaaaa, 0xaaaaaaaa, break_table, select_table); break; default: break; @@ -1153,63 +1590,75 @@ void halbtc8821c2ant_ps_tdma_check_for_power_save_state( /* keep state under LPS, do nothing. */ } else { /* will leave LPS state, turn off psTdma first */ - /*halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8); */ - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); } } else { /* NO PS state */ if (new_ps_state) { /* will enter LPS state, turn off psTdma first */ - /*halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, - 8);*/ - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); } else { /* keep state under NO PS state, do nothing. */ } } } -void halbtc8821c2ant_power_save_state(IN struct btc_coexist *btcoexist, +boolean halbtc8821c2ant_power_save_state(IN struct btc_coexist *btcoexist, IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) { - boolean low_pwr_disable = false; + boolean low_pwr_disable = FALSE, result = TRUE; switch (ps_type) { case BTC_PS_WIFI_NATIVE: + coex_sta->force_lps_ctrl = FALSE; /* recover to original 32k low power setting */ - low_pwr_disable = false; - btcoexist->btc_set(btcoexist, + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_power_save_state == BTC_PS_WIFI_NATIVE\n"); + BTC_TRACE(trace_buf); + + low_pwr_disable = FALSE; + /* btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, - &low_pwr_disable); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + &low_pwr_disable); */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_PRE_NORMAL_LPS, NULL); - coex_sta->force_lps_on = false; break; case BTC_PS_LPS_ON: + coex_sta->force_lps_ctrl = TRUE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_power_save_state == BTC_PS_LPS_ON\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_ps_tdma_check_for_power_save_state( - btcoexist, true); + btcoexist, TRUE); halbtc8821c2ant_lps_rpwm(btcoexist, NORMAL_EXEC, lps_val, rpwm_val); /* when coex force to enter LPS, do not enter 32k low power. */ - low_pwr_disable = true; + low_pwr_disable = TRUE; btcoexist->btc_set(btcoexist, BTC_SET_ACT_DISABLE_LOW_POWER, &low_pwr_disable); /* power save must executed before psTdma. */ btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, NULL); - coex_sta->force_lps_on = true; break; case BTC_PS_LPS_OFF: + coex_sta->force_lps_ctrl = TRUE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_power_save_state == BTC_PS_LPS_OFF\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_ps_tdma_check_for_power_save_state( - btcoexist, false); - btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + btcoexist, FALSE); + result = btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, NULL); - coex_sta->force_lps_on = false; break; default: break; } + + return result; } @@ -1219,59 +1668,89 @@ void halbtc8821c2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, { u8 h2c_parameter[5] = {0}; u8 real_byte1 = byte1, real_byte5 = byte5; - boolean ap_enable = false; + boolean ap_enable = FALSE, result = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 ps_type = BTC_PS_WIFI_NATIVE; + + if (byte5 & BIT(2)) + coex_sta->is_tdma_btautoslot = TRUE; + else + coex_sta->is_tdma_btautoslot = FALSE; + + /* release bt-auto slot for auto-slot hang is detected!! */ + if (coex_sta->is_tdma_btautoslot) + if ((coex_sta->is_tdma_btautoslot_hang) || + (bt_link_info->slave_role)) + byte5 = byte5 & 0xfb; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, &ap_enable); - if (ap_enable) { - if (byte1 & BIT(4) && !(byte1 & BIT(5))) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], FW for 1Ant AP mode\n"); - BTC_TRACE(trace_buf); - real_byte1 &= ~BIT(4); - real_byte1 |= BIT(5); + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_set_fw_pstdma == FW for AP mode\n"); + BTC_TRACE(trace_buf); - real_byte5 |= BIT(5); - real_byte5 &= ~BIT(6); + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); - halbtc8821c2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); - } + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8821c2ant_power_save_state(btcoexist, + ps_type, 0x0, 0x0); } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_set_fw_pstdma == Force LPS Leave (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); - halbtc8821c2ant_power_save_state( - btcoexist, BTC_PS_LPS_ON, 0x50, - 0x4); + ps_type = BTC_PS_LPS_OFF; + if (!halbtc8821c2ant_power_save_state(btcoexist, ps_type, 0x50, 0x4)) + result = TRUE; } else { - halbtc8821c2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, 0x0, - 0x0); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_set_fw_pstdma == Native LPS (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); + + ps_type = BTC_PS_WIFI_NATIVE; + halbtc8821c2ant_power_save_state(btcoexist, ps_type, 0x0, 0x0); } + coex_sta->is_set_ps_state_fail = result; - h2c_parameter[0] = real_byte1; - h2c_parameter[1] = byte2; - h2c_parameter[2] = byte3; - h2c_parameter[3] = byte4; - h2c_parameter[4] = real_byte5; + if (!coex_sta->is_set_ps_state_fail) { + h2c_parameter[0] = real_byte1; + h2c_parameter[1] = byte2; + h2c_parameter[2] = byte3; + h2c_parameter[3] = byte4; + h2c_parameter[4] = real_byte5; - coex_dm->ps_tdma_para[0] = real_byte1; - coex_dm->ps_tdma_para[1] = byte2; - coex_dm->ps_tdma_para[2] = byte3; - coex_dm->ps_tdma_para[3] = byte4; - coex_dm->ps_tdma_para[4] = real_byte5; + coex_dm->ps_tdma_para[0] = real_byte1; + coex_dm->ps_tdma_para[1] = byte2; + coex_dm->ps_tdma_para[2] = byte3; + coex_dm->ps_tdma_para[3] = byte4; + coex_dm->ps_tdma_para[4] = real_byte5; - btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + } else { + coex_sta->cnt_set_ps_state_fail++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8821c2ant_set_fw_pstdma == Force Leave LPS Fail (cnt = %d)\n", + coex_sta->cnt_set_ps_state_fail); + BTC_TRACE(trace_buf); + } + + if (ps_type == BTC_PS_WIFI_NATIVE) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_POST_NORMAL_LPS, NULL); } void halbtc8821c2ant_ps_tdma(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN boolean turn_on, IN u8 type) { - static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - coex_dm->cur_ps_tdma_on = turn_on; coex_dm->cur_ps_tdma = type; @@ -1282,120 +1761,220 @@ void halbtc8821c2ant_ps_tdma(IN struct btc_coexist *btcoexist, psTdmaByte4Modify = 0x0; if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { - - force_exec = true; + force_exec = TRUE; pre_psTdmaByte4Modify = psTdmaByte4Modify; } if (!force_exec) { if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && - (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) + (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", + (coex_dm->cur_ps_tdma_on ? "on" : "off"), + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); return; + } } - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], %s turn %s PS TDMA, type=%d\n", - (force_exec ? "force to" : ""), (turn_on ? "ON" : "OFF"), type); - BTC_TRACE(trace_buf); - - - if (turn_on) { + if (coex_dm->cur_ps_tdma_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(on, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, 0x1); /* enable TBTT nterrupt */ + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(off, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); } if (turn_on) { switch (type) { case 1: - default: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x10, 0x03, 0xf1, - 0x14 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x91, + 0x54 | psTdmaByte4Modify); break; case 2: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, + default: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, 0x11 | psTdmaByte4Modify); break; case 3: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x3a, 0x3, 0xf1, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x30, 0x3, 0x91, 0x10 | psTdmaByte4Modify); break; case 4: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x21, 0x3, 0xf1, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x21, 0x3, 0x91, 0x10 | psTdmaByte4Modify); break; case 5: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x30, 0x3, 0xf1, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x3, 0x91, 0x10 | psTdmaByte4Modify); break; case 6: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x3, 0xf1, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x3, 0x91, 0x10 | psTdmaByte4Modify); break; case 7: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x25, 0x3, 0xf1, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x20, 0x3, 0x91, 0x10 | psTdmaByte4Modify); break; + case 8: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x15, 0x03, 0x11, + 0x11); + break; + case 10: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x30, 0x03, 0x11, + 0x10); + break; case 11: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x30, 0x03, 0x71, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, 0x10 | psTdmaByte4Modify); break; case 12: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x21, 0x03, 0x71, - 0x11 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, 0x11); break; case 13: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x1c, 0x03, 0x71, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x1c, 0x03, 0x11, + 0x10 | psTdmaByte4Modify); + break; + case 14: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x20, 0x03, 0x11, + 0x11); + break; + case 15: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x14); + break; + case 16: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x15); + break; + case 21: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x30, 0x03, 0x11, + 0x10); + break; + case 22: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x03, 0x11, + 0x10); + break; + case 23: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x10); + break; + case 51: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x91, 0x10 | psTdmaByte4Modify); break; case 101: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x10, 0x03, 0x70, - 0x14 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x03, 0x10, + 0x54 | psTdmaByte4Modify); break; case 102: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xe3, - 0x35, 0x03, 0x71, + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, 0x11 | psTdmaByte4Modify); break; case 103: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x3a, 0x3, 0x70, - 0x10 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x30, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); break; case 104: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x21, 0x3, 0x70, - 0x10 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x21, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); break; case 105: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x30, 0x3, 0x70, - 0x10 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x45, 0x3, 0x10, + 0x50); break; case 106: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x1c, 0x3, 0x70, - 0x10 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x1a, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); break; case 107: - halbtc8821c2ant_set_fw_pstdma(btcoexist, 0xd3, - 0x25, 0x3, 0x70, - 0x10 | psTdmaByte4Modify); + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x7, 0x10, + 0x54 | psTdmaByte4Modify); + break; + case 108: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x30, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); + break; + case 109: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x03, 0x10, + 0x54 | psTdmaByte4Modify); + break; + case 110: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x30, 0x03, 0x10, + 0x50); + break; + case 111: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x03, 0x11, + 0x11); + break; + case 112: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x4a, 0x3, 0x10, + 0x50); + break; + case 115: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x35, 0x3, 0x10, + 0x50); + break; + case 116: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x08, 0x03, 0x10, + 0x54 | psTdmaByte4Modify); + break; + case 117: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x08, 0x03, 0x10, + 0x14 | psTdmaByte4Modify); + break; + case 119: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x14 | psTdmaByte4Modify); + break; + case 151: + halbtc8821c2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x03, 0x10, + 0x50 | psTdmaByte4Modify); break; - - } } else { /* disable PS tdma */ @@ -1415,193 +1994,260 @@ void halbtc8821c2ant_ps_tdma(IN struct btc_coexist *btcoexist, } } - /* update pre state */ - coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; - coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; + if (!coex_sta->is_set_ps_state_fail) { + /* update pre state */ + coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; + coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; + } } -void halbtc8821c2ant_set_int_block(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) +void halbtc8821c2ant_set_int_block(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 pos_type) { +#if 0 u8 regval_0xcba; u32 u32tmp1 = 0; - coex_dm->cur_int_block_status = pos_type; - + coex_dm->cur_int_block_status = pos_type; + if (!force_exec) { - if (coex_dm->pre_int_block_status == coex_dm->cur_int_block_status) - return; - } + if (coex_dm->pre_int_block_status == + coex_dm->cur_int_block_status) + return; + } coex_dm->pre_int_block_status = coex_dm->cur_int_block_status; regval_0xcba = btcoexist->btc_read_1byte(btcoexist, 0xcba); - switch(pos_type){ + switch (pos_type) { - case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: - regval_0xcba = regval_0xcba & (~(BIT(2)) ) | BIT(0); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ - break; - case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: - regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ - regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ - regval_0xcba = regval_0xcba & (~(BIT(7)) ) | BIT(6); /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ - - break; - case BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: - regval_0xcba = regval_0xcba & (~(BIT(2) | BIT(0)) ); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ - regval_0xcba = regval_0xcba & (~(BIT(5))) | BIT(4); /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ - regval_0xcba = regval_0xcba | BIT(6) | BIT(7); /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ - - break; + case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG: + regval_0xcba = (regval_0xcba | BIT(0)) & (~(BIT( + 2))); /* 0xcb8[16] = 1, 0xcb8[18] = 0, WL_G select BTG */ + regval_0xcba = regval_0xcba & 0x0f; + + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc1d, 0x0f, 0x5); */ /* Gain Table */ + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xa9e, 0x0f, 0x2); */ /* CCK Gain Table */ + + break; + case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG: + regval_0xcba = regval_0xcba & (~(BIT(2) | BIT( + 0))); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ + + /* regval_0xcba = regval_0xcba | BIT(4) | BIT(5) ; */ /* 0xcb8[21:20] = 2b'11, WL_G @ WLAG on */ + /* regval_0xcba = (regval_0xcba | BIT(6)) & (~(BIT(7)) ) ; */ /* 0xcb8[23:22] = 2b'01, WL_A @ WLAG off */ + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xc1d, 0x0f, 0x0); */ /* Gain Table */ + /*btcoexist->btc_write_1byte_bitmask(btcoexist, 0xa9e, 0x0f, 0x6); */ /* CCK Gain Table */ + + break; + case BT_8821C_1ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG: + regval_0xcba = regval_0xcba & (~(BIT(2) | BIT( + 0))); /* 0xcb8[16] = 0, 0xcb8[18] = 0, WL_G select WLAG */ + /*regval_0xcba = (regval_0xcba | BIT(4)) & (~(BIT(5))); */ /* 0xcb8[21:20] = 2b'01, WL_G @ WLAG off */ + /*regval_0xcba = regval_0xcba | BIT(6) | BIT(7); */ /* 0xcb8[23:22] = 2b'11, WL_A @ WLAG on */ + + break; } - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, regval_0xcba); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcba, 0xff, + regval_0xcba); u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb8); - + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ********** (After Int Block setup) 0xcb8 = 0x%08x **********\n", u32tmp1); BTC_TRACE(trace_buf); +#endif } -void halbtc8821c2ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 pos_type) +void halbtc8821c2ant_set_ext_band_switch(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 pos_type) { #if 0 - boolean switch_polatiry_inverse = false; - u8 regval_0xcb6; + boolean switch_polatiry_inverse = FALSE; + u8 regval_0xcb6; u32 u32tmp1 = 0, u32tmp2 = 0; - + if (!rfe_type->ext_band_switch_exist) - return; + return; + + coex_dm->cur_ext_band_switch_status = pos_type; - coex_dm->cur_ext_band_switch_status = pos_type; - if (!force_exec) { - if (coex_dm->pre_ext_band_switch_status == coex_dm->cur_ext_band_switch_status) - return; - } + if (coex_dm->pre_ext_band_switch_status == + coex_dm->cur_ext_band_switch_status) + return; + } - coex_dm->pre_ext_band_switch_status = coex_dm->cur_ext_band_switch_status; + coex_dm->pre_ext_band_switch_status = + coex_dm->cur_ext_band_switch_status; /* swap control polarity if use different switch control polarity*/ - switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); + switch_polatiry_inverse = (rfe_type->ext_band_switch_ctrl_polarity == 1 + ? ~switch_polatiry_inverse : switch_polatiry_inverse); /*swap control polarity for WL_A, default polarity 0xcb4[21] = 0 && 0xcb4[23] = 1 is for WL_G */ - switch_polatiry_inverse = (pos_type == BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLA? ~switch_polatiry_inverse: switch_polatiry_inverse); + switch_polatiry_inverse = (pos_type == + BT_8821C_2ANT_EXT_BAND_SWITCH_TO_WLA ? ~switch_polatiry_inverse + : switch_polatiry_inverse); regval_0xcb6 = btcoexist->btc_read_1byte(btcoexist, 0xcb6); - /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ - regval_0xcb6 = (switch_polatiry_inverse == 1? ( (regval_0xcb6 & (~(BIT(7))) ) | BIT(5)) : ( (regval_0xcb6 & (~(BIT(5))) ) | BIT(7)) ); - - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, regval_0xcb6); + /* for normal switch polrity, 0xcb4[21] =1 && 0xcb4[23] = 0 for WL_A, vice versa */ + regval_0xcb6 = (switch_polatiry_inverse == 1 ? ((regval_0xcb6 & (~(BIT( + 7)))) | BIT(5)) : ((regval_0xcb6 & (~(BIT(5)))) | BIT(7))); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb6, 0xff, + regval_0xcb6); u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb0); u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], ********** (After Ext Band switch setup) 0xcb0 = 0x%08x, 0xcb4 = 0x%08x**********\n", u32tmp1, u32tmp2); BTC_TRACE(trace_buf); -#endif +#endif } -void halbtc8821c2ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) +void halbtc8821c2ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) { struct btc_board_info *board_info = &btcoexist->board_info; - boolean switch_polatiry_inverse = false; + boolean switch_polatiry_inverse = FALSE; u8 regval_0xcb7 = 0, regval_0x64; u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; - - if (!rfe_type->ext_ant_switch_exist) - return; - coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; - + if (!rfe_type->ext_ant_switch_exist) + return; + + coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; + if (!force_exec) { - if (coex_dm->pre_ext_ant_switch_status == coex_dm->cur_ext_ant_switch_status) - return; - } + if (coex_dm->pre_ext_ant_switch_status == + coex_dm->cur_ext_ant_switch_status) + return; + } coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; /* swap control polarity if use different switch control polarity*/ /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ - switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1? ~switch_polatiry_inverse: switch_polatiry_inverse); + if (rfe_type->ext_ant_switch_ctrl_polarity) + switch_polatiry_inverse = ~switch_polatiry_inverse; - switch(pos_type) - { - default: - case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT: - case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE: - - break; - case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG: - switch_polatiry_inverse = (rfe_type->wlg_Locate_at_btg == 0? ~switch_polatiry_inverse: switch_polatiry_inverse); - break; - case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA: + /* swap control polarity if 1-Ant at Aux */ + if (rfe_type->ant_at_main_port == FALSE) + switch_polatiry_inverse = ~switch_polatiry_inverse; - break; - } - + switch (pos_type) { + default: + case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT: + case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE: + case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA: - switch(ctrl_type) - { - default: - case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ + break; + case BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG: + if (!rfe_type->wlg_Locate_at_btg) + switch_polatiry_inverse = ~switch_polatiry_inverse; - regval_0xcb7 = (switch_polatiry_inverse == false? 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); - - break; - case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as cotrol pin */ - - regval_0xcb7 = (switch_polatiry_inverse == false? 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, 0x30, regval_0xcb7); - - break; - case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x1); /* 0x4c[24] = 1 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); /* */ - - /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ - - break; - case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x1); /* 0x4c[23] = 1 */ - - regval_0x64 = (switch_polatiry_inverse == false? 0x0 : 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, regval_0x64); - break; - case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT: - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x80, 0x0); /* 0x4c[23] = 0 */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, 0x01, 0x0); /* 0x4c[24] = 0 */ - - /* no setup required, because antenna switch control value by BT vendor 0x1c[1:0] */ - break; + break; } - u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", + if (board_info->ant_div_cfg) + ctrl_type = BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV; + + + switch (ctrl_type) { + default: + case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x77); /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ + + regval_0xcb7 = (switch_polatiry_inverse == FALSE ? + 0x1 : 0x2); /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, + 0x30, regval_0xcb7); + + break; + case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x66); /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ + + regval_0xcb7 = (switch_polatiry_inverse == FALSE ? + 0x2 : 0x1); /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb7, + 0x30, regval_0xcb7); + + break; + case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x88); /* */ + + /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ + + break; + case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x1); /* 0x4c[23] = 1 */ + + regval_0x64 = (switch_polatiry_inverse == FALSE ? 0x0 : + 0x1); /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, + regval_0x64); + break; + case BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x0); /* 0x4c[24] = 0 */ + + /* no setup required, because antenna switch control value by BT vendor 0x1c[1:0] */ + break; + } + + /* PAPE, LNA_ON control by BT while WLAN off for current leakage issue */ + if (ctrl_type == BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT) { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x0); /* PAPE 0x64[29] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x10, + 0x0); /* LNA_ON 0x64[28] = 0 */ + } else { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x1); /* PAPE 0x64[29] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x10, + 0x1); /* LNA_ON 0x64[28] = 1 */ + } + +#if BT_8821C_2ANT_COEX_DBG + + u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x\n", u32tmp1, u32tmp2, u32tmp3); - BTC_TRACE(trace_buf); - + BTC_TRACE(trace_buf); +#endif } @@ -1609,113 +2255,115 @@ void halbtc8821c2ant_set_rfe_type(IN struct btc_coexist *btcoexist) { struct btc_board_info *board_info = &btcoexist->board_info; -#if 0 - rfe_type->ext_band_switch_exist = false; - rfe_type->ext_band_switch_type = BT_8821C_2ANT_EXT_BAND_SWITCH_USE_SPDT; // SPDT; - rfe_type->ext_band_switch_ctrl_polarity = 0; - - if (rfe_type->ext_band_switch_exist) { - - /* band switch use RFE_ctrl1 (pin name: PAPE_A) and RFE_ctrl3 (pin name: LNAON_A) */ - - /* set RFE_ctrl1 as software control */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); - - /* set RFE_ctrl3 as software control */ - btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); - - } -#endif /* the following setup should be got from Efuse in the future */ - rfe_type->rfe_module_type = board_info->rfe_type; - + rfe_type->rfe_module_type = board_info->rfe_type & 0x1f; + rfe_type->ext_ant_switch_ctrl_polarity = 0; - rfe_type->ext_ant_switch_diversity = false; - - switch(rfe_type->rfe_module_type) - { - case 0: - default: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ - rfe_type->wlg_Locate_at_btg = false; - /*rfe_type->ext_ant_switch_diversity = true;*/ - break; - case 1: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ - rfe_type->wlg_Locate_at_btg = false; - break; - case 2: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ - rfe_type->wlg_Locate_at_btg = true; - break; - case 3: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ - rfe_type->wlg_Locate_at_btg = false; - break; - case 4: - rfe_type->ext_ant_switch_exist = true; - rfe_type->ext_ant_switch_type = BT_8821C_1ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */; - rfe_type->wlg_Locate_at_btg = true; - break; - case 5: - rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ - rfe_type->wlg_Locate_at_btg = false; + switch (rfe_type->rfe_module_type) { + case 0: + case 8: + default: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 1: + case 9: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, WLG */ + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 2: + case 10: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, BTG */ + rfe_type->wlg_Locate_at_btg = TRUE; + rfe_type->ant_at_main_port = TRUE; + break; + case 3: + case 11: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = FALSE; + break; + case 4: + case 12: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */ + rfe_type->wlg_Locate_at_btg = TRUE; + rfe_type->ant_at_main_port = FALSE; + break; + case 5: + case 13: + rfe_type->ext_ant_switch_exist = FALSE; /*2-Ant, no switch, WLG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_NONE; + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 6: + case 14: + rfe_type->ext_ant_switch_exist = FALSE; /*2-Ant, no switch, WLG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_NONE; + rfe_type->wlg_Locate_at_btg = FALSE; + rfe_type->ant_at_main_port = TRUE; + break; + case 7: + case 15: + rfe_type->ext_ant_switch_exist = TRUE; /*2-Ant, DPDT, BTG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT; + rfe_type->wlg_Locate_at_btg = TRUE; + rfe_type->ant_at_main_port = TRUE; + break; } - - if (rfe_type->wlg_Locate_at_btg) - halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); +#if 0 + if (rfe_type->wlg_Locate_at_btg) + halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, + BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); else - halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); + halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, + BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); +#endif - } void halbtc8821c2ant_set_ant_path(IN struct btc_coexist *btcoexist, - IN u8 ant_pos_type, IN boolean force_exec, - IN u8 phase ) + IN u8 ant_pos_type, IN boolean force_exec, + IN u8 phase) { struct btc_board_info *board_info = &btcoexist->board_info; u32 cnt_bt_cal_chk = 0; - boolean is_in_mp_mode = false; + boolean is_in_mp_mode = FALSE; u8 u8tmp = 0; u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; u16 u16tmp1 = 0; -#if BT_8821C_2ANT_ANTDET_ENABLE -#if BT_8821C_2ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE - if (ant_pos_type == BTC_ANT_PATH_PTA) { - if ((board_info->btdm_ant_det_finish) && - (board_info->btdm_ant_num_by_ant_det == 2)) { - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_WIFI_AT_MAIN; - else - ant_pos_type = BTC_ANT_WIFI_AT_AUX; - } - } -#endif -#endif - - coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; - - if (!force_exec) { - if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) - return; - } - - coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; - -#if 1 u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + + /* To avoid indirect access fail */ + if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { + force_exec = TRUE; + coex_sta->gnt_error_cnt++; + } + + +#if BT_8821C_2ANT_COEX_DBG + u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); @@ -1723,267 +2371,421 @@ void halbtc8821c2ant_set_ant_path(IN struct btc_coexist *btcoexist, u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", + "[BTCoex], (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", u32tmp3, u8tmp, u32tmp1, u32tmp2); BTC_TRACE(trace_buf); #endif + coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; - switch (phase) - { - case BT_8821C_2ANT_PHASE_COEX_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_2ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_2ANT_CTT_BT_VS_LTE, 0xffff); - - /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ - while (cnt_bt_cal_chk <= 20) { - u8tmp = btcoexist->btc_read_1byte(btcoexist, - 0x49d); - cnt_bt_cal_chk++; - if (u8tmp & BIT(0)) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", - cnt_bt_cal_chk); - BTC_TRACE(trace_buf); - delay_ms(50); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", - cnt_bt_cal_chk); - BTC_TRACE(trace_buf); - break; - } - } - - /* set Path control owner to WL at initial step */ - halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_2ANT_PCO_WLSIDE); - - /* set GNT_BT to SW high */ - halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to SW high */ - halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - - coex_sta->run_time_state = false; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - { - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_WIFI_AT_MAIN; - else - ant_pos_type = BTC_ANT_WIFI_AT_AUX; - } - - break; - case BT_8821C_2ANT_PHASE_WLANONLY_INIT: - /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ - halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); - - /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_2ANT_CTT_WL_VS_LTE, 0xffff); - - /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ - halbtc8821c2ant_ltecoex_set_coex_table(btcoexist, - BT_8821C_2ANT_CTT_BT_VS_LTE, 0xffff); - - /* set Path control owner to WL at initial step */ - halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_2ANT_PCO_WLSIDE); - - /* set GNT_BT to SW Low */ - halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_LOW); - /* Set GNT_WL to SW high */ - halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - - coex_sta->run_time_state = false; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - { - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_WIFI_AT_MAIN; - else - ant_pos_type = BTC_ANT_WIFI_AT_AUX; - } - - break; - case BT_8821C_2ANT_PHASE_WLAN_OFF: - /* Disable LTE Coex Function in WiFi side */ - halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); - - /* set Path control owner to BT */ - halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_2ANT_PCO_BTSIDE); - - /* Set Ext Ant Switch to BT control at wifi off step */ - halbtc8821c2ant_set_ext_ant_switch(btcoexist, - FORCE_EXEC, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); - coex_sta->run_time_state = false; - break; - case BT_8821C_2ANT_PHASE_2G_RUNTIME: - - /* set Path control owner to WL at runtime step */ - halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_2ANT_PCO_WLSIDE); - - /* set GNT_BT to PTA */ - halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8821C_2ANT_SIG_STA_SET_BY_HW); - - /* Set GNT_WL to PTA */ - halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, - BT_8821C_2ANT_SIG_STA_SET_BY_HW); - - coex_sta->run_time_state = true; - - if (rfe_type->wlg_Locate_at_btg) - halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); - else - halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - { - if (rfe_type->ext_ant_switch_diversity) - ant_pos_type = BTC_ANT_WIFI_AT_DIVERSITY; - else { - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_WIFI_AT_MAIN; - else - ant_pos_type = BTC_ANT_WIFI_AT_AUX; - } - } - - break; - case BT_8821C_2ANT_PHASE_5G_RUNTIME: - - /* set Path control owner to WL at runtime step */ - halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_2ANT_PCO_WLSIDE); - - /* set GNT_BT to SW Hi */ - halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - - /* Set GNT_WL to SW Hi */ - halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - - coex_sta->run_time_state = true; - - halbtc8821c2ant_set_int_block(btcoexist, NORMAL_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - { - if (rfe_type->ext_ant_switch_diversity) - ant_pos_type = BTC_ANT_WIFI_AT_DIVERSITY; - else { - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_WIFI_AT_MAIN; - else - ant_pos_type = BTC_ANT_WIFI_AT_AUX; - } - } - - break; - case BT_8821C_2ANT_PHASE_BTMPMODE: - /* Disable LTE Coex Function in WiFi side */ - halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); - - /* set Path control owner to WL */ - halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, - BT_8821C_2ANT_PCO_WLSIDE); - - /* set GNT_BT to SW Hi */ - halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - - /* Set GNT_WL to SW Lo */ - halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_LOW); - - coex_sta->run_time_state = false; - - if (BTC_ANT_PATH_AUTO == ant_pos_type) - { - if (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT) - ant_pos_type = BTC_ANT_WIFI_AT_MAIN; - else - ant_pos_type = BTC_ANT_WIFI_AT_AUX; - } - - break; + if (!force_exec) { + if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) + return; } - if (phase != BT_8821C_2ANT_PHASE_WLAN_OFF) - { - switch (ant_pos_type) { - default: - case BTC_ANT_WIFI_AT_MAIN: - halbtc8821c2ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG); - break; - case BTC_ANT_WIFI_AT_AUX: - halbtc8821c2ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT); - break; - case BTC_ANT_WIFI_AT_DIVERSITY: - halbtc8821c2ant_set_ext_ant_switch( btcoexist, - force_exec, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); - break; - } - + coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; + + + switch (phase) { + case BT_8821C_2ANT_PHASE_COEX_POWERON: + + /* set Path control owner to WL at initial step */ + halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8821C_2ANT_PCO_BTSIDE); + + /* set GNT_BT to SW high */ + halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW high */ + halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = + BTC_ANT_WIFI_AT_MAIN; + else + ant_pos_type = + BTC_ANT_WIFI_AT_AUX; + } + + coex_sta->run_time_state = FALSE; + + break; + case BT_8821C_2ANT_PHASE_COEX_INIT: + /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ + halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c2ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_2ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c2ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_2ANT_CTT_BT_VS_LTE, + 0xffff); + + + /* Wait If BT IQK running, because Path control owner is at BT during BT IQK (setup by WiFi firmware) */ + while (cnt_bt_cal_chk <= 20) { + u8tmp = btcoexist->btc_read_1byte( + btcoexist, 0x49c); + cnt_bt_cal_chk++; + + if (u8tmp & BIT(1)) { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ########### BT is calibrating (wait cnt=%d) ###########\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + delay_ms(50); + } else { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ********** BT is NOT calibrating (wait cnt=%d)**********\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + break; } -#if 1 + } + + /* set Path control owner to WL at initial step */ + halbtc8821c2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW high */ + halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW high */ + halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = FALSE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = + BTC_ANT_WIFI_AT_MAIN; + else + ant_pos_type = + BTC_ANT_WIFI_AT_AUX; + } + + break; + case BT_8821C_2ANT_PHASE_WLANONLY_INIT: + /* Disable LTE Coex Function in WiFi side (this should be on if LTE coex is required) */ + halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c2ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_2ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 (this should be config if LTE coex is required) */ + halbtc8821c2ant_ltecoex_set_coex_table( + btcoexist, + BT_8821C_2ANT_CTT_BT_VS_LTE, + 0xffff); + + /* set Path control owner to WL at initial step */ + halbtc8821c2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Low */ + halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_LOW); + /* Set GNT_WL to SW high */ + halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = FALSE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = + BTC_ANT_WIFI_AT_MAIN; + else + ant_pos_type = + BTC_ANT_WIFI_AT_AUX; + } + + break; + case BT_8821C_2ANT_PHASE_WLAN_OFF: + /* Disable LTE Coex Function in WiFi side */ + halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); + + /* set Path control owner to BT */ + halbtc8821c2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_2ANT_PCO_BTSIDE); + + /* Set Ext Ant Switch to BT control at wifi off step */ + halbtc8821c2ant_set_ext_ant_switch(btcoexist, + FORCE_EXEC, + BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT, + BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); + + halbtc8821c2ant_ignore_wlan_act(btcoexist, FORCE_EXEC, TRUE); + + coex_sta->run_time_state = FALSE; + break; + case BT_8821C_2ANT_PHASE_2G_RUNTIME: + case BT_8821C_2ANT_PHASE_2G_RUNTIME_CONCURRENT: + + while (cnt_bt_cal_chk <= 20) { + /* 0x49c[0]=1 WL IQK, 0x49c[1]=1 BT IQK*/ + u8tmp = btcoexist->btc_read_1byte(btcoexist, + 0x49c); + + cnt_bt_cal_chk++; + if (u8tmp & BIT(0)) { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ########### WL is IQK (wait cnt=%d)\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + delay_ms(50); + } else if (u8tmp & BIT(1)) { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ########### BT is IQK (wait cnt=%d)\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + delay_ms(50); + } else { + BTC_SPRINTF(trace_buf, + BT_TMP_BUF_SIZE, + "[BTCoex], ********** WL and BT is NOT IQK (wait cnt=%d)\n", + cnt_bt_cal_chk); + BTC_TRACE(trace_buf); + break; + } + } + + /* set Path control owner to WL at runtime step */ + halbtc8821c2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_2ANT_PCO_WLSIDE); + + if (phase == + BT_8821C_2ANT_PHASE_2G_RUNTIME_CONCURRENT) { + /* set GNT_BT to PTA */ + halbtc8821c2ant_ltecoex_set_gnt_bt( + btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8821C_2ANT_SIG_STA_SET_BY_HW); + + /* Set GNT_WL to SW High */ + halbtc8821c2ant_ltecoex_set_gnt_wl( + btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + } else { + /* set GNT_BT to PTA */ + halbtc8821c2ant_ltecoex_set_gnt_bt( + btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8821C_2ANT_SIG_STA_SET_BY_HW); + + /* Set GNT_WL to PTA */ + halbtc8821c2ant_ltecoex_set_gnt_wl( + btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8821C_2ANT_SIG_STA_SET_BY_HW); + } + coex_sta->run_time_state = TRUE; + + if (rfe_type->wlg_Locate_at_btg) + halbtc8821c2ant_set_int_block(btcoexist, + NORMAL_EXEC, + BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); + else + halbtc8821c2ant_set_int_block(btcoexist, + NORMAL_EXEC, + BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = + BTC_ANT_WIFI_AT_MAIN; + else + ant_pos_type = + BTC_ANT_WIFI_AT_AUX; + } + + break; + case BT_8821C_2ANT_PHASE_5G_RUNTIME: + + /* set Path control owner to WL at runtime step */ + halbtc8821c2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Hi */ + halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8821C_2ANT_SIG_STA_SET_BY_HW); + + /* Set GNT_WL to SW Hi */ + halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = TRUE; + + halbtc8821c2ant_set_int_block(btcoexist, + NORMAL_EXEC, + BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG); + + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = + BTC_ANT_WIFI_AT_MAIN; + else + ant_pos_type = + BTC_ANT_WIFI_AT_AUX; + } + + + break; + case BT_8821C_2ANT_PHASE_BTMPMODE: + /* Disable LTE Coex Function in WiFi side */ + halbtc8821c2ant_ltecoex_enable(btcoexist, 0x0); + + /* set Path control owner to WL */ + halbtc8821c2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8821C_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Hi */ + halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + + /* Set GNT_WL to SW Lo */ + halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_LOW); + + coex_sta->run_time_state = FALSE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = + BTC_ANT_WIFI_AT_MAIN; + else + ant_pos_type = + BTC_ANT_WIFI_AT_AUX; + } + + break; + case BT_8821C_2ANT_PHASE_ANTENNA_DET: + halbtc8821c2ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8821C_2ANT_PCO_WLSIDE); + + /* set GNT_BT to high */ + halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to high */ + halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8821C_2ANT_GNT_BLOCK_RFC_BB, + BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) { + if (board_info->btdm_ant_pos == + BTC_ANTENNA_AT_MAIN_PORT) + ant_pos_type = + BTC_ANT_WIFI_AT_MAIN; + else + ant_pos_type = + BTC_ANT_WIFI_AT_AUX; + } + + coex_sta->run_time_state = FALSE; + + break; + } + + if (phase != BT_8821C_2ANT_PHASE_WLAN_OFF) { + switch (ant_pos_type) { + default: + case BTC_ANT_WIFI_AT_MAIN + : + halbtc8821c2ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG); + break; + case BTC_ANT_WIFI_AT_AUX + : + halbtc8821c2ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT); + break; + case BTC_ANT_WIFI_AT_DIVERSITY + : + halbtc8821c2ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV, + BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); + break; + } + + } + + + +#if BT_8821C_2ANT_COEX_DBG u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); - - BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); + + BTC_TRACE(trace_buf); #endif } @@ -1992,7 +2794,7 @@ void halbtc8821c2ant_set_ant_path(IN struct btc_coexist *btcoexist, u8 halbtc8821c2ant_action_algorithm(IN struct btc_coexist *btcoexist) { struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean bt_hs_on = false; + boolean bt_hs_on = FALSE; u8 algorithm = BT_8821C_2ANT_COEX_ALGO_UNDEFINED; u8 num_of_diff_profile = 0; @@ -2022,6 +2824,11 @@ u8 halbtc8821c2ant_action_algorithm(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); algorithm = BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY; } + } else if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP Sink\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8821C_2ANT_COEX_ALGO_A2DPSINK; } else if (num_of_diff_profile == 1) { if (bt_link_info->sco_exist) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, @@ -2077,7 +2884,8 @@ u8 halbtc8821c2ant_action_algorithm(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], SCO + PAN(EDR)\n"); BTC_TRACE(trace_buf); - algorithm = BT_8821C_2ANT_COEX_ALGO_PANEDR; + algorithm = + BT_8821C_2ANT_COEX_ALGO_PANEDR; } } } else { @@ -2209,173 +3017,24 @@ u8 halbtc8821c2ant_action_algorithm(IN struct btc_coexist *btcoexist) void halbtc8821c2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) { + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); /* fw all off */ - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } -void halbtc8821c2ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) +void halbtc8821c2ant_action_bt_whql_test(IN struct btc_coexist *btcoexist) { + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - /* fw all off */ - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, - BT_8821C_2ANT_PHASE_5G_RUNTIME); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } -void halbtc8821c2ant_action_init_coex_dm(IN struct btc_coexist *btcoexist) -{ - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - /* fw all off */ - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - - coex_sta->pop_event_cnt = 0; -} - -void halbtc8821c2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) -{ - - boolean wifi_connected = false; - boolean scan = false, link = false, roam = false; - boolean wifi_busy = false; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (link || roam || coex_sta->wifi_is_high_pri_task) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi link/roam/hi-pri-task process + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 8); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - - } else if (scan) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi scan process + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 8); - - if (coex_sta->bt_create_connection) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 12); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - - } else if (wifi_connected) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); - - if (wifi_busy) { - - if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - - } else - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - } else { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi no-link + BT Inq/Page!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - -} - -void halbtc8821c2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) -{ - u32 u32tmp, u32tmpb; - u8 u8tmpa; - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - - if ((bt_link_info->a2dp_exist) && (bt_link_info->acl_busy)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 13); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - -} - - -void halbtc8821c2ant_action_wifi_nonconnected(IN struct btc_coexist *btcoexist) -{ - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - /* fw all off */ - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - /* sw all off */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); -} - -void halbtc8821c2ant_action_bt_idle(IN struct btc_coexist *btcoexist) +void halbtc8821c2ant_action_bt_hs(IN struct btc_coexist *btcoexist) { static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; @@ -2384,24 +3043,85 @@ void halbtc8821c2ant_action_bt_idle(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif - boolean wifi_connected = false; - boolean scan = false, link = false, roam = false; - boolean wifi_busy = false; wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + + } else { + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } + +} + + +void halbtc8821c2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) +{ + + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE; + boolean wifi_busy = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); @@ -2409,54 +3129,109 @@ void halbtc8821c2ant_action_bt_idle(IN struct btc_coexist *btcoexist) btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); + + if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) + || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { - if (scan || link || roam) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi link process + BT Idle!!\n"); + "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); BTC_TRACE(trace_buf); halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 7); + 8); + + if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 15); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 11); + } else if ((!wifi_connected) && (!wifi_scan)) { - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 11); - } else if (wifi_connected) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi connected + BT Idle!!\n"); + "[BTCoex], Wifi no-link + no-scan + BT Inq/Page!!\n"); BTC_TRACE(trace_buf); - if (wifi_busy) { - if (!BTC_RSSI_HIGH(bt_rssi_state2)) - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 2); - else - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 0); - } else { - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 0); - } + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (bt_link_info->pan_exist) { + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + } else if (bt_link_info->a2dp_exist) { + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Wifi no-link + BT Idle!!\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, - 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) + || (coex_sta->wifi_is_high_pri_task)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 23); } - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); +} - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); + +void halbtc8821c2ant_action_bt_relink(IN struct btc_coexist *btcoexist) +{ + if (coex_sta->is_bt_multi_link == TRUE) + return; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); +} + + +void halbtc8821c2ant_action_bt_idle(IN struct btc_coexist *btcoexist) +{ + + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_busy) { + + halbtc8821c2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 14); + } else { /* if wl busy */ + + if (BT_8821C_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { +#if 0 + /* for Lenovo WL throughput rainning issue while BT non-connect-idle */ + if ((btcoexist->board_info.customerID == RT_CID_LENOVO_CHINA) && + (coex_sta->scan_ap_num <= 5)) + halbtc8821c2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 10); + else +#endif + halbtc8821c2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else { + + halbtc8821c2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, + 8); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 12); + } + } + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); } @@ -2471,56 +3246,56 @@ void halbtc8821c2ant_action_sco(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + if (coex_sta->is_eSCO_mode) + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + else /* 2-Ant free run if SCO mode */ + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); } - - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } @@ -2533,58 +3308,148 @@ void halbtc8821c2ant_action_hid(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + if (coex_sta->is_hid_low_pri_tx_overhead) { - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 108); + } else if (wifi_bw == 0) { /* if 11bg mode */ + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 111); + } else { + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 111); + } } +} - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); +void halbtc8821c2ant_action_a2dpsink(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif + + wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 1); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); + } else { + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 115); + } } + + /* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ void halbtc8821c2ant_action_a2dp(IN struct btc_coexist *btcoexist) { @@ -2595,75 +3460,86 @@ void halbtc8821c2ant_action_a2dp(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3, bt_rssi_state3; + + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8821c2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 40, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + bt_rssi_state3 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state3, 2, + 50, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 1); else - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); } else { - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + coex_dm->is_switch_to_1dot5_ant = TRUE; + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = true; - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - - if (wifi_busy) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102); - + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 101); } - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } void halbtc8821c2ant_action_pan_edr(IN struct btc_coexist *btcoexist) @@ -2675,34 +3551,58 @@ void halbtc8821c2ant_action_pan_edr(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3, bt_rssi_state3; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8821c2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 58, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + bt_rssi_state3 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state3, 2, + 47, 0); #if 0 - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); #endif @@ -2710,130 +3610,56 @@ void halbtc8821c2ant_action_pan_edr(IN struct btc_coexist *btcoexist) if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 3); else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 4); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + /* for Lenovo CPT_For_WiFi OPP test */ + if ((btcoexist->board_info.customerID == RT_CID_LENOVO_CHINA) && + BTC_RSSI_HIGH(wifi_rssi_state3) && (wifi_busy)) { + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - if (wifi_busy) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 112); + } else { + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + + if (wifi_busy) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 103); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 104); + } } #endif - - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } - -/* PAN(HS) only */ -void halbtc8821c2ant_action_pan_hs(IN struct btc_coexist *btcoexist) -{ - static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state, bt_rssi_state; - - static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; - static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; - - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); - - wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); - - wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, - &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); - - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); - - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); - - if (BTC_RSSI_HIGH(wifi_rssi_state) && - BTC_RSSI_HIGH(bt_rssi_state)) { - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - coex_dm->is_switch_to_1dot5_ant = false; - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && - BTC_RSSI_HIGH(bt_rssi_state2)) { - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - - coex_dm->is_switch_to_1dot5_ant = false; - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - - - } else { - - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - - coex_dm->is_switch_to_1dot5_ant = true; - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); - } - - - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); -} - - void halbtc8821c2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) { static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; @@ -2843,76 +3669,87 @@ void halbtc8821c2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3; + + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8821c2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 45, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 1); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 1); else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 2); - - + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); - - if (wifi_busy) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 101); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 102); + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + if (coex_sta->hid_pair_cnt > 1) { + if (BTC_RSSI_HIGH(wifi_rssi_state3)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 117); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 116); + } else { + if (BTC_RSSI_HIGH(wifi_rssi_state3)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 119); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 109); + } } - - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } @@ -2925,83 +3762,91 @@ void halbtc8821c2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif + wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) { - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); + if ((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = true; - - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + coex_dm->is_switch_to_1dot5_ant = TRUE; + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); if (wifi_busy) { - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); + if ((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 105); } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 106); } - - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } @@ -3016,81 +3861,113 @@ void halbtc8821c2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + + static u8 prewifi_rssi_state3 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state3 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state3, bt_rssi_state3; + + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + wifi_rssi_state3 = halbtc8821c2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state3, 2, + 40, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + bt_rssi_state3 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state3, 2, + 45, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) { - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); + if (((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) || + (!coex_sta->is_A2DP_3M)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); - halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + /* for Lenovo coex test case */ + if ((btcoexist->board_info.customerID == RT_CID_LENOVO_CHINA) && + (coex_sta->scan_ap_num <= 10)) { - if (wifi_busy) { + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); + /* for CPT_for_WiFi */ + if (BTC_RSSI_HIGH(bt_rssi_state3) && BTC_RSSI_LOW(wifi_rssi_state3)) { + halbtc8821c2ant_dec_bt_pwr(btcoexist, FORCE_EXEC, 10); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 105); + } else { /* for CPT_for_BT */ + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); + } + } else { + + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if (wifi_busy) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); - + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 106); + } } - - - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } void halbtc8821c2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) @@ -3101,81 +3978,71 @@ void halbtc8821c2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 3); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 3); else - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 4); - - + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 4); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); if (wifi_busy) - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 103); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 103); else - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 104); - + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 104); } - - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); - } /* HID+A2DP+PAN(EDR) */ @@ -3187,129 +4054,252 @@ void halbtc8821c2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; - u8 wifi_rssi_state2, bt_rssi_state2; - boolean wifi_busy = false; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); wifi_rssi_state = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state, 2, - coex_sta->wifi_coex_thres , 0); + coex_sta->wifi_coex_thres, 0); wifi_rssi_state2 = halbtc8821c2ant_wifi_rssi_state(btcoexist, &prewifi_rssi_state2, 2, - coex_sta->wifi_coex_thres2 , 0); + coex_sta->wifi_coex_thres2, 0); - bt_rssi_state = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state, 2, - coex_sta->bt_coex_thres , 0); + bt_rssi_state = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); - bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(&pre_bt_rssi_state2, 2, - coex_sta->bt_coex_thres2 , 0); + bt_rssi_state2 = halbtc8821c2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); if (BTC_RSSI_HIGH(wifi_rssi_state) && BTC_RSSI_HIGH(bt_rssi_state)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && BTC_RSSI_HIGH(bt_rssi_state2)) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 6); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); - coex_dm->is_switch_to_1dot5_ant = false; + coex_dm->is_switch_to_1dot5_ant = FALSE; halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); if (wifi_busy) { - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 7); + if (((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) || + (!coex_sta->is_A2DP_3M)) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 7); else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 5); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 6); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 6); } else { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - coex_dm->is_switch_to_1dot5_ant = true; + coex_dm->is_switch_to_1dot5_ant = TRUE; - halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 7); + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); - if (wifi_busy) { - - if ((coex_sta->a2dp_bit_pool > 40) && (coex_sta->a2dp_bit_pool < 255)) - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 107); - else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 105); - } else - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, true, 106); + if (wifi_busy) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 107); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 106); + } } - /* sw mechanism */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, true, - false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, - false, 0x18); -} - - - -void halbtc8821c2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) +void halbtc8821c2ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - /* sw mechanism all off */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8821C_2ANT_PHASE_5G_RUNTIME); + /* fw all off */ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); +} - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); +void halbtc8821c2ant_action_wifi_native_lps(IN struct btc_coexist *btcoexist) +{ + halbtc8821c2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 2); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } void halbtc8821c2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) { - halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0x18); + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); - /* sw mechanism all off */ - halbtc8821c2ant_sw_mechanism1(btcoexist, false, false, false, false); - halbtc8821c2ant_sw_mechanism2(btcoexist, false, false, false, 0x18); - /* hw all off */ halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); - - halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, false, 0); + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); } +void halbtc8821c2ant_action_wifi_linkscan_process(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if (bt_link_info->pan_exist) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + else if (bt_link_info->a2dp_exist) + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); + else + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); +} + +void halbtc8821c2ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) +{ + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + /* fw all off */ + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); +} + +void halbtc8821c2ant_action_wifi_connected(IN struct btc_coexist *btcoexist) +{ + switch (coex_dm->cur_algorithm) { + + case BT_8821C_2ANT_COEX_ALGO_SCO: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_sco(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_hid(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); + BTC_TRACE(trace_buf); + + /* for A2DP + OPP test but BTinfo is A2DP only in Lenovo test case */ + if (coex_sta->is_bt_multi_link) + halbtc8821c2ant_action_pan_edr_a2dp(btcoexist); + else + halbtc8821c2ant_action_a2dp(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_A2DPSINK: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP Sink.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_a2dpsink(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_a2dp_pan_hs(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_pan_edr(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_pan_edr_a2dp(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_PANEDR_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_pan_edr_hid(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_hid_a2dp_pan_edr( + btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_HID_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_hid_a2dp(btcoexist); + break; + case BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_bt_idle(btcoexist); + break; + default: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_coex_all_off(btcoexist); + break; + } + + coex_dm->pre_algorithm = coex_dm->cur_algorithm; + +} + void halbtc8821c2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) { - u8 algorithm = 0; - u32 num_of_wifi_link = 0; - u32 wifi_link_status = 0; + u8 algorithm = 0; + u32 num_of_wifi_link = 0; + u32 wifi_link_status = 0; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; - boolean miracast_plus_bt = false; - boolean scan = false, link = false, roam = false, wifi_connected = false, wifi_under_5g =false; - + boolean miracast_plus_bt = FALSE; + boolean scan = FALSE, link = FALSE, roam = FALSE, + under_4way = FALSE, + wifi_connected = FALSE, wifi_under_5g = FALSE, + bt_hs_on = FALSE; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RunCoexistMechanism()===>\n"); BTC_TRACE(trace_buf); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], under_lps = %d, force_lps_ctrl = %d, acl_busy = %d!!!\n", + coex_sta->under_lps, coex_sta->force_lps_ctrl, coex_sta->acl_busy); + BTC_TRACE(trace_buf); + if (btcoexist->manual_control) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); @@ -3331,39 +4321,55 @@ void halbtc8821c2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) return; } - if (!coex_sta->run_time_state){ + if (!coex_sta->run_time_state) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], return for run_time_state = false !!!\n"); + "[BTCoex], return for run_time_state = FALSE !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->freeze_coexrun_by_btinfo) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); BTC_TRACE(trace_buf); return; } btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if (wifi_under_5g) { - + if ((wifi_under_5g) && + (coex_sta->switch_band_notify_to != BTC_SWITCH_TO_24G) && + (coex_sta->switch_band_notify_to != BTC_SWITCH_TO_24G_NOFORSCAN)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], WiFi is under 5G!!!\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_action_wifi_under5g(btcoexist); return; - } else{ + } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], WiFi is under 2G!!!\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, - NORMAL_EXEC, BT_8821C_2ANT_PHASE_2G_RUNTIME); + NORMAL_EXEC, + BT_8821C_2ANT_PHASE_2G_RUNTIME); + } + + if ((coex_sta->under_lps) && (!coex_sta->force_lps_ctrl) && + (!coex_sta->acl_busy)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_wifi_native_lps(btcoexist); + return; } - if (coex_sta->bt_whck_test) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BT is under WHCK TEST!!!\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_action_bt_whck_test(btcoexist); + halbtc8821c2ant_action_bt_whql_test(btcoexist); return; } @@ -3383,15 +4389,12 @@ void halbtc8821c2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) return; } - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || link || roam) { + if ((coex_sta->is_setupLink) && + (coex_sta->bt_relink_downcount != 0)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under Link Process !!\n"); + "[BTCoex], BT is re-link !!!\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_action_wifi_link_process(btcoexist); + halbtc8821c2ant_action_bt_relink(btcoexist); return; } @@ -3408,144 +4411,124 @@ void halbtc8821c2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); if (bt_link_info->bt_link_exist) - miracast_plus_bt = true; + miracast_plus_bt = TRUE; else - miracast_plus_bt = false; + miracast_plus_bt = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &miracast_plus_bt); - halbtc8821c2ant_action_wifi_multi_port(btcoexist); + + if (scan || link || roam || under_4way) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", + scan, link, roam, under_4way); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c2ant_action_wifi_linkscan_process(btcoexist); + } else + halbtc8821c2ant_action_wifi_multi_port(btcoexist); return; } else { - miracast_plus_bt = false; + miracast_plus_bt = FALSE; btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, &miracast_plus_bt); } + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is hs\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_bt_hs(btcoexist); + return; + } + + if ((BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) || + (BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, bt idle!!.\n"); + BTC_TRACE(trace_buf); + + halbtc8821c2ant_action_bt_idle(btcoexist); + return; + } + algorithm = halbtc8821c2ant_action_algorithm(btcoexist); coex_dm->cur_algorithm = algorithm; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", coex_dm->cur_algorithm); BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); - if (!wifi_connected) { + if (scan || link || roam || under_4way) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under Link Process !!\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_wifi_linkscan_process(btcoexist); + } else if (wifi_connected) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, wifi non-connected!!.\n"); + "[BTCoex], Action 2-Ant, wifi connected!!.\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_action_wifi_nonconnected(btcoexist); - - } else if ((BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == - coex_dm->bt_status) || (BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE == - coex_dm->bt_status)) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, bt idle!!.\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_action_bt_idle(btcoexist); + halbtc8821c2ant_action_wifi_connected(btcoexist); } else { - if (coex_dm->cur_algorithm != coex_dm->pre_algorithm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], pre_algorithm=%d, cur_algorithm=%d\n", - coex_dm->pre_algorithm, coex_dm->cur_algorithm); - BTC_TRACE(trace_buf); - } - - switch (coex_dm->cur_algorithm) { - - case BT_8821C_2ANT_COEX_ALGO_SCO: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_sco(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_hid(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_a2dp(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_A2DP_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_a2dp_pan_hs(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_pan_edr(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_PANHS: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HS mode.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_pan_hs(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_PANEDR_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_pan_edr_a2dp(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_PANEDR_HID: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_pan_edr_hid(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_hid_a2dp_pan_edr( - btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_HID_A2DP: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_hid_a2dp(btcoexist); - break; - case BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_bt_idle(btcoexist); - break; - default: - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_action_coex_all_off(btcoexist); - break; - } - coex_dm->pre_algorithm = coex_dm->cur_algorithm; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, wifi not-connected!!.\n"); + BTC_TRACE(trace_buf); + halbtc8821c2ant_action_wifi_not_connected(btcoexist); } } +void halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Coex Mechanism Init!!\n"); + BTC_TRACE(trace_buf); + + halbtc8821c2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); + + halbtc8821c2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8821c2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_sta->pop_event_cnt = 0; + coex_sta->cnt_RemoteNameReq = 0; + coex_sta->cnt_ReInit = 0; + coex_sta->cnt_setupLink = 0; + coex_sta->cnt_IgnWlanAct = 0; + coex_sta->cnt_Page = 0; + coex_sta->cnt_RoleSwitch = 0; + coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; + + halbtc8821c2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + /* fw all off */ + halbtc8821c2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + halbtc8821c2ant_query_bt_info(btcoexist); +} + + void halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, IN boolean wifi_only) { u8 u8tmp = 0; u32 vendor; - u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0, u32tmp3 =0; + u32 u32tmp0 = 0, u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; + u8 i; u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); @@ -3553,7 +4536,7 @@ void halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", + "[BTCoex], (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", u32tmp3, u32tmp1, u32tmp2); BTC_TRACE(trace_buf);; @@ -3563,7 +4546,21 @@ void halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, coex_sta->bt_coex_supported_feature = 0; coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->bt_reg_vendor_ac = 0xffff; + coex_sta->bt_reg_vendor_ae = 0xffff; + coex_sta->isolation_btween_wb = BT_8821C_2ANT_DEFAULT_ISOLATION; + coex_sta->gnt_error_cnt = 0; + coex_sta->bt_relink_downcount = 0; + coex_sta->is_set_ps_state_fail = FALSE; + coex_sta->cnt_set_ps_state_fail = 0; + coex_sta->wl_rx_rate = BTC_UNKNOWN; + for (i = 0; i <= 9; i++) + coex_sta->bt_afh_map[i] = 0; /* 0xf0[15:12] --> Chip Cut information */ coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, @@ -3571,9 +4568,8 @@ void halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, coex_sta->dis_ver_info_cnt = 0; - /* default isolation = 15dB */ - coex_sta->isolation_btween_wb = BT_8821C_2ANT_DEFAULT_ISOLATION; - halbtc8821c2ant_coex_switch_threshold(btcoexist, coex_sta->isolation_btween_wb); + halbtc8821c2ant_coex_switch_threshold(btcoexist, + coex_sta->isolation_btween_wb); btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, 0x1); /* enable TBTT nterrupt */ @@ -3591,1215 +4587,71 @@ void halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, /* Enable PTA (tx/rx signal form WiFi side) */ btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); + /* set GNT_BT=1 for coex table select both */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x763, 0x10, 0x1); + halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, TRUE); +#if 0 /* check if WL firmware download ok */ - if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) - halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, true); + /*if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6)*/ + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ONOFF, TRUE); +#endif /* Enable counter statistics */ btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ - if (wifi_only) { - - coex_sta->concurrent_rx_mode_on = false; + /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ + /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); */ + psd_scan->ant_det_is_ant_det_available = TRUE; + + if (coex_sta->is_rf_state_off) { + + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_WLAN_OFF); + + btcoexist->stop_coex_dm = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** halbtc8821c2ant_init_hw_config (RF Off)**********\n"); + BTC_TRACE(trace_buf); + } else if (wifi_only) { + coex_sta->concurrent_rx_mode_on = FALSE; + /* Path config */ /* Set Antenna Path */ - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_WLANONLY_INIT); + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_WLANONLY_INIT); + + btcoexist->stop_coex_dm = TRUE; } else { - coex_sta->concurrent_rx_mode_on = true; + /*Set BT polluted packet on for Tx rate adaptive not including Tx retry break by PTA, 0x45c[19] =1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); + + coex_sta->concurrent_rx_mode_on = TRUE; /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); */ /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 for con-current Rx, mask Tx only */ btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); /* Set Antenna Path */ - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_COEX_INIT); - } + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_COEX_INIT); - /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ - /* btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); */ + btcoexist->stop_coex_dm = FALSE; + } halbtc8821c2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); - halbtc8821c2ant_ps_tdma(btcoexist, FORCE_EXEC, false, 0); - - psd_scan->ant_det_is_ant_det_available = TRUE; - - u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); - u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", - u32tmp3, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); + halbtc8821c2ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); } -u32 halbtc8821c2ant_psd_log2base(IN struct btc_coexist *btcoexist, IN u32 val) -{ - u8 j; - u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; - u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, - 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, - 32, 23, 15, 7, 0 - }; - - if (val == 0) - return 0; - - tmp = val; - - while (1) { - if (tmp == 1) - break; - else { - tmp = (tmp >> 1); - shiftcount++; - } - } - - - val_integerd_b = shiftcount + 1; - - tmp2 = 1; - for (j = 1; j <= val_integerd_b; j++) - tmp2 = tmp2 * 2; - - tmp = (val * 100) / tmp2; - tindex = tmp / 5; - - if (tindex > 20) - tindex = 20; - - val_fractiond_b = table_fraction[tindex]; - - result = val_integerd_b * 100 - val_fractiond_b; - - return result; - - -} - -void halbtc8821c2ant_psd_show_antenna_detect_result(IN struct btc_coexist - *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - struct btc_board_info *board_info = &btcoexist->board_info; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n============[Antenna Detection info] ============\n"); - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 1) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (>%d)", - "Ant Det Result", "2-Antenna (Bad-Isolation)", - BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else if (psd_scan->ant_det_result == 2) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "2-Antenna (Good-Isolation)", - BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset, - BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (%d~%d)", - "Ant Det Result", "1-Antenna", - BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT, - BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", - "Antenna Detection Finish", - (board_info->btdm_ant_det_finish - ? "Yes" : "No")); - CL_PRINTF(cli_buf); - - switch (psd_scan->ant_det_result) { - case 0: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is not available)"); - break; - case 1: /* 2-Ant bad-isolation */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 2: /* 2-Ant good-isolation */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 3: /* 1-Ant */ - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is available)"); - break; - case 4: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Uncertainty result)"); - break; - case 5: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "(Pre-Scan fai)"); - break; - case 6: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(WiFi is Scanning)"); - break; - case 7: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is not idle)"); - break; - case 8: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Abort by WiFi Scanning)"); - break; - case 9: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(Antenna Init is not ready)"); - break; - case 10: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is Inquiry or page)"); - break; - case 11: - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "(BT is Disabled)"); - break; - } - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Ant Detect Total Count", psd_scan->ant_det_try_count); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "Ant Detect Fail Count", psd_scan->ant_det_fail_count); - CL_PRINTF(cli_buf); - - if ((!board_info->btdm_ant_det_finish) && - (psd_scan->ant_det_result != 5)) - return; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "BT Response", - (psd_scan->ant_det_result ? "ok" : "fail")); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d ms", "BT Tx Time", - psd_scan->ant_det_bt_tx_time); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", "BT Tx Ch", - psd_scan->ant_det_bt_le_channel); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d", - "WiFi PSD Cent-Ch/Offset/Span", - psd_scan->real_cent_freq, psd_scan->real_offset, - psd_scan->real_span); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dB", - "PSD Pre-Scan Peak Value", - psd_scan->ant_det_pre_psdscan_peak_val / 100); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s (<= %d)", - "PSD Pre-Scan result", - (psd_scan->ant_det_result != 5 ? "ok" : "fail"), - BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - CL_PRINTF(cli_buf); - - if (psd_scan->ant_det_result == 5) - return; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s dB", - "PSD Scan Peak Value", psd_scan->ant_det_peak_val); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s MHz", - "PSD Scan Peak Freq", psd_scan->ant_det_peak_freq); - CL_PRINTF(cli_buf); - - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", "TFBGA Package", - (board_info->tfbga_package) ? "Yes" : "No"); - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "PSD Threshold Offset", psd_scan->ant_det_thres_offset); - CL_PRINTF(cli_buf); - -} - -void halbtc8821c2ant_psd_showdata(IN struct btc_coexist *btcoexist) -{ - u8 *cli_buf = btcoexist->cli_buf; - u32 delta_freq_per_point; - u32 freq, freq1, freq2, n = 0, i = 0, j = 0, m = 0, psd_rep1, psd_rep2; - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n\n============[PSD info] (%d)============\n", - psd_scan->psd_gen_count); - CL_PRINTF(cli_buf); - - if (psd_scan->psd_gen_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n No data !!\n"); - CL_PRINTF(cli_buf); - return; - } - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* if (psd_scan->is_psd_show_max_only) */ - if (0) { - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * 100; - - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + - psd_scan->psd_max_value_point * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.0%d MHz", - freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq = %d.%d MHz", - freq1, freq2); - - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB, (%d)\n", - psd_rep1, psd_rep2, psd_scan->psd_max_value); - - CL_PRINTF(cli_buf); - } else { - m = psd_scan->psd_start_point; - n = psd_scan->psd_start_point; - i = 1; - j = 1; - - while (1) { - do { - freq = ((psd_scan->real_cent_freq - 20) * 1000000 + m * - delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (i == 1) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.0%2d", freq1, - freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Freq%6d.%3d", freq1, - freq2); - } else if ((i % 8 == 0) || - (m == psd_scan->psd_stop_point)) { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000\n", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d\n", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d\n", freq1, freq2); - } else { - if (freq2 == 0) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.000", freq1); - else if (freq2 < 100) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.0%2d", freq1, freq2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%6d.%3d", freq1, freq2); - } - - i++; - m++; - CL_PRINTF(cli_buf); - - } while ((i <= 8) && (m <= psd_scan->psd_stop_point)); - - - do { - psd_rep1 = psd_scan->psd_report_max_hold[n] / 100; - psd_rep2 = psd_scan->psd_report_max_hold[n] - psd_rep1 * - 100; - - if (j == 1) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.0%d", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n Val %7d.%d", psd_rep1, - psd_rep2); - } else if ((j % 8 == 0) || - (n == psd_scan->psd_stop_point)) { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d\n", psd_rep1, - psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d\n", psd_rep1, psd_rep2); - } else { - if (psd_rep2 < 10) - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.0%d", psd_rep1, psd_rep2); - else - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "%7d.%d", psd_rep1, psd_rep2); - } - - j++; - n++; - CL_PRINTF(cli_buf); - - } while ((j <= 8) && (n <= psd_scan->psd_stop_point)); - - if ((m > psd_scan->psd_stop_point) || - (n > psd_scan->psd_stop_point)) - break; - else { - i = 1; - j = 1; - } - - } - } - - -} - -void halbtc8821c2ant_psd_maxholddata(IN struct btc_coexist *btcoexist, - IN u32 gen_count) -{ - u32 i = 0, i_max = 0, val_max = 0; - - if (gen_count == 1) { - memcpy(psd_scan->psd_report_max_hold, - psd_scan->psd_report, - BT_8821C_2ANT_ANTDET_PSD_POINTS * sizeof(u32)); - - psd_scan->psd_max_value_point = 0; - psd_scan->psd_max_value = 0; - - } else { - for (i = psd_scan->psd_start_point; - i <= psd_scan->psd_stop_point; i++) { - if (psd_scan->psd_report[i] > - psd_scan->psd_report_max_hold[i]) - psd_scan->psd_report_max_hold[i] = - psd_scan->psd_report[i]; - - /* search Max Value */ - if (i == psd_scan->psd_start_point) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } else { - if (psd_scan->psd_report_max_hold[i] > - val_max) { - i_max = i; - val_max = psd_scan->psd_report_max_hold[i]; - } - } - - } - - psd_scan->psd_max_value_point = i_max; - psd_scan->psd_max_value = val_max; - - } - - -} - -u32 halbtc8821c2ant_psd_getdata(IN struct btc_coexist *btcoexist, IN u32 point) -{ - /* reg 0x808[9:0]: FFT data x */ - /* reg 0x808[22]: 0-->1 to get 1 FFT data y */ - /* reg 0x8b4[15:0]: FFT data y report */ - - u32 val = 0, psd_report = 0; - int k = 0; - - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - - val &= 0xffbffc00; - val |= point; - - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - val |= 0x00400000; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - while (1) { - if (k++ > BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - - val = btcoexist->btc_read_4byte(btcoexist, 0x8b4); - - psd_report = val & 0x0000ffff; - - return psd_report; -} - - -boolean halbtc8821c2ant_psd_sweep_point(IN struct btc_coexist *btcoexist, - IN u32 cent_freq, IN s32 offset, IN u32 span, IN u32 points, - IN u32 avgnum, IN u32 loopcnt) -{ - u32 i = 0, val = 0, n = 0, k = 0, j, point_index = 0; - u32 points1 = 0, psd_report = 0; - u32 start_p = 0, stop_p = 0, delta_freq_per_point = 156250; - u32 psd_center_freq = 20 * 10 ^ 6; - boolean outloop = false, scan , roam, is_sweep_ok = true; - u8 flag = 0; - u32 tmp = 0, u32tmp1 = 0; - u32 wifi_original_channel = 1; - - psd_scan->is_psd_running = true; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Start!!\n"); - BTC_TRACE(trace_buf); - - do { - switch (flag) { - case 0: /* Get PSD parameters */ - default: - - psd_scan->psd_band_width = 40 * 1000000; - psd_scan->psd_point = points; - psd_scan->psd_start_base = points / 2; - psd_scan->psd_avg_num = avgnum; - psd_scan->real_cent_freq = cent_freq; - psd_scan->real_offset = offset; - psd_scan->real_span = span; - - - points1 = psd_scan->psd_point; - delta_freq_per_point = psd_scan->psd_band_width / - psd_scan->psd_point; - - /* PSD point setup */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffff0fff; - - switch (psd_scan->psd_point) { - case 128: - val |= 0x0; - break; - case 256: - default: - val |= 0x00004000; - break; - case 512: - val |= 0x00008000; - break; - case 1024: - val |= 0x0000c000; - break; - } - - switch (psd_scan->psd_avg_num) { - case 1: - val |= 0x0; - break; - case 8: - val |= 0x00001000; - break; - case 16: - val |= 0x00002000; - break; - case 32: - default: - val |= 0x00003000; - break; - } - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - flag = 1; - break; - case 1: /* calculate the PSD point index from freq/offset/span */ - psd_center_freq = psd_scan->psd_band_width / 2 + - offset * (1000000); - - start_p = psd_scan->psd_start_base + (psd_center_freq - - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_start_point = start_p - - psd_scan->psd_start_base; - - stop_p = psd_scan->psd_start_base + (psd_center_freq + - span * (1000000) / 2) / delta_freq_per_point; - psd_scan->psd_stop_point = stop_p - - psd_scan->psd_start_base - 1; - - flag = 2; - break; - case 2: /* set RF channel/BW/Mode */ - - /* set 3-wire off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val |= 0x00300000; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val &= 0xfeffffff; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* Tx-pause on */ - btcoexist->btc_write_1byte(btcoexist, 0x522, 0x6f); - - /* store WiFi original channel */ - wifi_original_channel = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x18, 0x3ff); - - /* Set RF channel */ - if (cent_freq == 2484) - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, 0xe); - else - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, - 0x18, 0x3ff, (cent_freq - 2412) / 5 + - 1); /* WiFi TRx Mask on */ - - /* save original RCK value */ - u32tmp1 = btcoexist->btc_get_rf_reg( - btcoexist, BTC_RF_A, 0x1d, 0xfffff); - - /* Enter debug mode */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, - 0x2, 0x1); - - /* Set RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, - 0xfffff, 0x2e); - - - /* Set RF mode = Rx, RF Gain = 0x320a0 */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, - 0xfffff, 0x320a0); - - while (1) { - if (k++ > BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY) - break; - } - flag = 3; - break; - case 3: - psd_scan->psd_gen_count = 0; - - for (j = 1; j <= loopcnt; j++) { - - /* btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x0, 0xfffff, 0x320a0); */ - - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, - BTC_GET_BL_WIFI_ROAM, &roam); - - if (scan || roam) { - is_sweep_ok = false; - break; - } - memset(psd_scan->psd_report, 0, - psd_scan->psd_point * sizeof(u32)); - start_p = psd_scan->psd_start_point + - psd_scan->psd_start_base; - stop_p = psd_scan->psd_stop_point + - psd_scan->psd_start_base + 1; - - i = start_p; - point_index = 0; - - while (i < stop_p) { - if (i >= points1) - psd_report = - halbtc8821c2ant_psd_getdata( - btcoexist, i - points1); - else - psd_report = - halbtc8821c2ant_psd_getdata( - btcoexist, i); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "Point=%d, psd_raw_data = 0x%08x\n", - i, psd_report); - BTC_TRACE(trace_buf); - if (psd_report == 0) - tmp = 0; - else - /* tmp = 20*log10((double)psd_report); */ - /* 20*log2(x)/log2(10), log2Base return theresult of the psd_report*100 */ - tmp = 6 * halbtc8821c2ant_psd_log2base( - btcoexist, psd_report); - - n = i - psd_scan->psd_start_base; - psd_scan->psd_report[n] = tmp; - - - halbtc8821c2ant_psd_maxholddata( - btcoexist, j); - - i++; - - } - - psd_scan->psd_gen_count = j; - - - /* - val = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - tmp = btcoexist->btc_read_4byte(btcoexist, 0x64); - u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0x6c4); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "0x54 = 0x%08x, 0x67 = 0x%08x, 0x6c4 = 0x%08x\n", val, (tmp & 0xff000000) >> 24 ,u32tmp1); - BTC_TRACE(trace_buf); - */ - - } - - flag = 100; - break; - case 99: /* error */ - - outloop = true; - break; - case 100: /* recovery */ - - /* set 3-wire on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x88c); - val &= 0xffcfffff; - btcoexist->btc_write_4byte(btcoexist, 0x88c, val); - - /* CCK on */ - val = btcoexist->btc_read_4byte(btcoexist, 0x800); - val |= 0x01000000; - btcoexist->btc_write_4byte(btcoexist, 0x800, val); - - /* Tx-pause off */ - btcoexist->btc_write_1byte(btcoexist, 0x522, 0x0); - - /* PSD off */ - val = btcoexist->btc_read_4byte(btcoexist, 0x808); - val &= 0xffbfffff; - btcoexist->btc_write_4byte(btcoexist, 0x808, val); - - /* restore RF Rx filter corner */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1d, - 0xfffff, u32tmp1); - - /* Exit debug mode */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0xde, - 0x2, 0x0); - - /* restore WiFi original channel */ - btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x18, - 0x3ff, wifi_original_channel); - - outloop = true; - break; - - } - - } while (!outloop); - - - - psd_scan->is_psd_running = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx PSD Sweep Stop!!\n"); - BTC_TRACE(trace_buf); - return is_sweep_ok; - -} - -void halbtc8821c2ant_psd_antenna_detection(IN struct btc_coexist *btcoexist, - IN u32 bt_tx_time, IN u32 bt_le_channel) -{ - u32 i = 0; - u32 wlpsd_cent_freq = 2484, wlpsd_span = 2, wlpsd_sweep_count = 50; - s32 wlpsd_offset = -4; - u8 bt_le_ch[13] = {3, 6, 8, 11, 13, 16, 18, 21, 23, 26, 28, 31, 33}; - - u8 h2c_parameter[3] = {0}, u8tmpa, u8tmpb; - - u8 state = 0; - boolean outloop = false, bt_resp = false; - u32 freq, freq1, freq2, psd_rep1, psd_rep2, delta_freq_per_point, - u32tmp, u32tmp0, u32tmp1, u32tmp2 ; - struct btc_board_info *board_info = &btcoexist->board_info; - - board_info->btdm_ant_det_finish = false; - memset(psd_scan->ant_det_peak_val, 0, 16 * sizeof(u8)); - memset(psd_scan->ant_det_peak_freq, 0, 16 * sizeof(u8)); - - if (board_info->tfbga_package) /* for TFBGA */ - psd_scan->ant_det_thres_offset = 5; - else - psd_scan->ant_det_thres_offset = 0; - - do { - switch (state) { - case 0: - if (bt_le_channel == 39) - wlpsd_cent_freq = 2484; - else { - for (i = 1; i <= 13; i++) { - if (bt_le_ch[i - 1] == - bt_le_channel) { - wlpsd_cent_freq = 2412 - + (i - 1) * 5; - break; - } - } - - if (i == 14) { - - BTC_SPRINTF(trace_buf, - BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Abort!!, Invalid LE channel = %d\n ", - bt_le_channel); - BTC_TRACE(trace_buf); - outloop = true; - break; - } - } - - wlpsd_sweep_count = bt_tx_time * 238 / - 100; /* bt_tx_time/0.42 */ - wlpsd_sweep_count = wlpsd_sweep_count / 5; - - if (wlpsd_sweep_count % 5 != 0) - wlpsd_sweep_count = (wlpsd_sweep_count / - 5 + 1) * 5; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), BT_LETxTime=%d, BT_LECh = %d\n", - bt_tx_time, bt_le_channel); - BTC_TRACE(trace_buf); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), wlpsd_cent_freq=%d, wlpsd_offset = %d, wlpsd_span = %d, wlpsd_sweep_count = %d\n", - wlpsd_cent_freq, - wlpsd_offset, - wlpsd_span, - wlpsd_sweep_count); - BTC_TRACE(trace_buf); - - state = 1; - break; - case 1: /* stop coex DM & set antenna path */ - /* Stop Coex DM */ - /* - btcoexist->stop_coex_dm = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); - BTC_TRACE(trace_buf); */ - - /* Set TDMA off, */ - halbtc8821c2ant_ps_tdma(btcoexist, FORCE_EXEC, - false, 0); - - /* Set coex table */ - halbtc8821c2ant_coex_table_with_type(btcoexist, - FORCE_EXEC, 0); - - if (board_info->btdm_ant_pos == - BTC_ANTENNA_AT_MAIN_PORT) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Main Port\n"); - BTC_TRACE(trace_buf); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna at Aux Port\n"); - BTC_TRACE(trace_buf); - } - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to BT!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_set_int_block(btcoexist, FORCE_EXEC, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); - - halbtc8821c2ant_set_ext_ant_switch( btcoexist, - FORCE_EXEC, - BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, - BT_8821C_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT); - - /* Set Antenna Path, both GNT_WL/GNT_BT = 1, and control by SW */ - /* set GNT_BT to SW high */ - halbtc8821c2ant_ltecoex_set_gnt_bt(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - /* Set GNT_WL to SW high */ - halbtc8821c2ant_ltecoex_set_gnt_wl(btcoexist, - BT_8821C_2ANT_GNT_BLOCK_RFC_BB, - BT_8821C_2ANT_GNT_TYPE_CTRL_BY_SW, - BT_8821C_2ANT_SIG_STA_SET_TO_HIGH); - - - /* Set AFH mask on at WiFi channel 2472MHz +/- 10MHz */ - h2c_parameter[0] = 0x1; - h2c_parameter[1] = 0xd; - h2c_parameter[2] = 0x14; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", - h2c_parameter[1], - h2c_parameter[2]); - BTC_TRACE(trace_buf); - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, - h2c_parameter); - - u32tmp = btcoexist->btc_read_2byte(btcoexist, 0x948); - u32tmp0 = btcoexist->btc_read_4byte(btcoexist, 0x70); - u32tmp1 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); - u32tmp2 = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** 0x948 = 0x%x, 0x70 = 0x%x, 0x38= 0x%x, 0x54= 0x%x (Before Ant Det) **********\n", - u32tmp, u32tmp0, u32tmp1, u32tmp2); - BTC_TRACE(trace_buf); - - state = 2; - break; - case 2: /* Pre-sweep background psd */ - if (!halbtc8821c2ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, wlpsd_span, - BT_8821C_2ANT_ANTDET_PSD_POINTS, - BT_8821C_2ANT_ANTDET_PSD_AVGNUM, 3)) { - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - - psd_scan->ant_det_pre_psdscan_peak_val = - psd_scan->psd_max_value; - - if (psd_scan->psd_max_value > - (BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset) * 100) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Abort Antenna Detection!! becaus background = %d > thres (%d)\n", - psd_scan->psd_max_value / 100, - BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - psd_scan->ant_det_result = 5; - state = 99; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Start Antenna Detection!! becaus background = %d <= thres (%d)\n", - psd_scan->psd_max_value / 100, - BT_8821C_2ANT_ANTDET_PSDTHRES_BACKGROUND - + psd_scan->ant_det_thres_offset); - BTC_TRACE(trace_buf); - state = 3; - } - break; - case 3: - bt_resp = btcoexist->btc_set_bt_ant_detection( - btcoexist, (u8)(bt_tx_time & 0xff), - (u8)(bt_le_channel & 0xff)); - - if (!halbtc8821c2ant_psd_sweep_point(btcoexist, - wlpsd_cent_freq, wlpsd_offset, - wlpsd_span, - BT_8821C_2ANT_ANTDET_PSD_POINTS, - BT_8821C_2ANT_ANTDET_PSD_AVGNUM, - wlpsd_sweep_count)) { - board_info->btdm_ant_det_finish - = false; - board_info->btdm_ant_num_by_ant_det - = 1; - psd_scan->ant_det_result = 8; - state = 99; - break; - } - - psd_scan->ant_det_psd_scan_peak_val = - psd_scan->psd_max_value; - psd_scan->ant_det_psd_scan_peak_freq = - psd_scan->psd_max_value_point; - state = 4; - break; - case 4: - - if (psd_scan->psd_point == 0) - delta_freq_per_point = 0; - else - delta_freq_per_point = - psd_scan->psd_band_width / - psd_scan->psd_point; - - psd_rep1 = psd_scan->psd_max_value / 100; - psd_rep2 = psd_scan->psd_max_value - psd_rep1 * - 100; - - freq = ((psd_scan->real_cent_freq - 20) * - 1000000 + psd_scan->psd_max_value_point - * delta_freq_per_point); - freq1 = freq / 1000000; - freq2 = freq / 1000 - freq1 * 1000; - - if (freq2 < 100) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.0%d MHz", - freq1, freq2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_freq, - BT_8821C_2ANT_ANTDET_BUF_LEN, - "%d.0%d", freq1, freq2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Max Value: Freq = %d.%d MHz", - freq1, freq2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_freq, - BT_8821C_2ANT_ANTDET_BUF_LEN, - "%d.%d", freq1, freq2); - } - - if (psd_rep2 < 10) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - ", Value = %d.0%d dB\n", - psd_rep1, psd_rep2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_val, - BT_8821C_2ANT_ANTDET_BUF_LEN, - "%d.0%d", psd_rep1, psd_rep2); - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - ", Value = %d.%d dB\n", - psd_rep1, psd_rep2); - BTC_TRACE(trace_buf); - CL_SPRINTF(psd_scan->ant_det_peak_val, - BT_8821C_2ANT_ANTDET_BUF_LEN, - "%d.%d", psd_rep1, psd_rep2); - } - - psd_scan->ant_det_is_btreply_available = true; - - if (bt_resp == false) { - psd_scan->ant_det_is_btreply_available = - false; - psd_scan->ant_det_result = 0; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), BT Response = Fail\n "); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION) - * 100) { - psd_scan->ant_det_result = 1; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 2; - coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Bad-Isolation!!\n"); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION - + psd_scan->ant_det_thres_offset) * 100) { - psd_scan->ant_det_result = 2; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 2; - coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 2-Ant, Good-Isolation!!\n"); - BTC_TRACE(trace_buf); - } else if (psd_scan->psd_max_value > - (BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT) * - 100) { - psd_scan->ant_det_result = 3; - board_info->btdm_ant_det_finish = true; - board_info->btdm_ant_num_by_ant_det = 1; - coex_sta->isolation_btween_wb = (u8)(85 - psd_scan->psd_max_value / 100) & 0xff; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant!!\n"); - BTC_TRACE(trace_buf); - } else { - psd_scan->ant_det_result = 4; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Detect Result = 1-Ant, un-certainity!!\n"); - BTC_TRACE(trace_buf); - } - - state = 99; - break; - case 99: /* restore setup */ - - /* Set AFH mask off at WiFi channel 2472MHz +/- 10MHz */ - h2c_parameter[0] = 0x0; - h2c_parameter[1] = 0x0; - h2c_parameter[2] = 0x0; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set AFH on, Cent-Ch= %d, Mask=%d\n", - h2c_parameter[1], h2c_parameter[2]); - BTC_TRACE(trace_buf); - - btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, - h2c_parameter); - - /* Set Antenna Path, GNT_WL/GNT_BT control by PTA */ - /* Set Antenna path, switch WiFi to certain antenna port */ - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_2G_RUNTIME); - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Set Antenna to PTA\n!!"); - BTC_TRACE(trace_buf); - - /* Resume Coex DM */ - /* - btcoexist->stop_coex_dm = false; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); - BTC_TRACE(trace_buf); */ - - /* stimulate coex running */ - - halbtc8821c2ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - - outloop = true; - break; - } - - } while (!outloop); - - - -} - -void halbtc8821c2ant_psd_antenna_detection_check(IN struct btc_coexist - *btcoexist) -{ - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - - boolean scan, roam; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); - - - /* psd_scan->ant_det_bt_tx_time = 20; */ - psd_scan->ant_det_bt_tx_time = - BT_8821C_2ANT_ANTDET_BTTXTIME; /* 0.42ms*50 = 20ms (0.42ms = 1 PSD sweep) */ - psd_scan->ant_det_bt_le_channel = BT_8821C_2ANT_ANTDET_BTTXCHANNEL; - - ant_det_count++; - - psd_scan->ant_det_try_count = ant_det_count; - - if (scan || roam) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 6; - } else if (coex_sta->bt_disabled) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 11; - } else if (coex_sta->num_of_profile >= 1) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 7; - } else if ( - !psd_scan->ant_det_is_ant_det_available) { /* Antenna initial setup is not ready */ - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 9; - } else if (coex_sta->c2h_bt_inquiry_page) { - board_info->btdm_ant_det_finish = false; - psd_scan->ant_det_result = 10; - } else { - - btcoexist->stop_coex_dm = true; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stop Coex DM!!\n"); - BTC_TRACE(trace_buf); - - halbtc8821c2ant_psd_antenna_detection(btcoexist, - psd_scan->ant_det_bt_tx_time, - psd_scan->ant_det_bt_le_channel); - - delay_ms(psd_scan->ant_det_bt_tx_time); - - btcoexist->stop_coex_dm = false; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Resume Coex DM\n!!"); - BTC_TRACE(trace_buf); - - /* stimulate coex running */ - - halbtc8821c2ant_run_coexist_mechanism( - btcoexist); - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Stimulate Coex running\n!!"); - BTC_TRACE(trace_buf); - } - - - if (!board_info->btdm_ant_det_finish) - ant_det_fail_count++; - - psd_scan->ant_det_fail_count = ant_det_fail_count; - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), result = %d, fail_count = %d, finish = %s\n", - psd_scan->ant_det_result, - psd_scan->ant_det_fail_count, - board_info->btdm_ant_det_finish == TRUE ? "Yes" : "No"); - BTC_TRACE(trace_buf); - -} /* ************************************************************ @@ -4826,7 +4678,8 @@ void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = true; + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = FALSE; psd_scan->ant_det_is_ant_det_available = FALSE; /* enable BB, REG_SYS_FUNC_EN such that we can write BB Register correctly. */ @@ -4843,7 +4696,7 @@ void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist) /* Check efuse 0xc3[6] for Single Antenna Path */ if (board_info->single_ant_path == 0) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** Single Antenna, Antenna at Aux Port**********\n"); + "[BTCoex], ********** Single Antenna, Antenna at Aux Port\n"); BTC_TRACE(trace_buf); board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; @@ -4851,19 +4704,26 @@ void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist) u8tmp = 7; } else if (board_info->single_ant_path == 1) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** Single Antenna, Antenna at Main Port**********\n"); + "[BTCoex], ********** Single Antenna, Antenna at Main Port\n"); BTC_TRACE(trace_buf); - board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; + board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; u8tmp = 6; } BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d **********\n", + "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d\n", board_info->single_ant_path , board_info->btdm_ant_pos); BTC_TRACE(trace_buf); + /* Setup RF front end type */ + halbtc8821c2ant_set_rfe_type(btcoexist); + + /* Set Antenna Path to BT side */ + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_2ANT_PHASE_COEX_POWERON); + /* Save"single antenna position" info in Local register setting for FW reading, because FW may not ready at power on */ if (btcoexist->chip_interface == BTC_INTF_PCI) btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); @@ -4872,15 +4732,6 @@ void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist) else if (btcoexist->chip_interface == BTC_INTF_SDIO) btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); - /* Setup RF front end type */ - halbtc8821c2ant_set_rfe_type(btcoexist); - - /* Set Antenna Path by Efuse */ - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_COEX_INIT); - /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, TRUE); @@ -4890,10 +4741,11 @@ void ex_halbtc8821c2ant_power_on_setting(IN struct btc_coexist *btcoexist) BTC_TRACE(trace_buf); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x**********\n", - btcoexist->btc_read_4byte(btcoexist, 0x70), btcoexist->btc_read_4byte(btcoexist, 0xcb4)); + "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x\n", + btcoexist->btc_read_4byte(btcoexist, 0x70), + btcoexist->btc_read_4byte(btcoexist, 0xcb4)); BTC_TRACE(trace_buf); - + } void ex_halbtc8821c2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) @@ -4933,33 +4785,167 @@ void ex_halbtc8821c2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) void ex_halbtc8821c2ant_init_hw_config(IN struct btc_coexist *btcoexist, IN boolean wifi_only) { - btcoexist->stop_coex_dm = false; halbtc8821c2ant_init_hw_config(btcoexist, wifi_only); } void ex_halbtc8821c2ant_init_coex_dm(IN struct btc_coexist *btcoexist) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Coex Mechanism Init!!\n"); - BTC_TRACE(trace_buf); - btcoexist->stop_coex_dm = false; + halbtc8821c2ant_init_coex_dm(btcoexist); +} +void ex_halbtc8821c2ant_display_simple_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + u8 *cli_buf = btcoexist->cli_buf; + u32 bt_patch_ver = 0, bt_coex_ver = 0; + static u8 cnt = 0; + + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + + // BT coex. info. + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n _____[BT Coexist info]____"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n __[Under Manual Control]_"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n _________________________"); + CL_PRINTF(cli_buf); + } + + if (psd_scan->ant_det_try_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s / 0x%x", + "Ant PG Num/ Mech/ Pos/ RFE", + board_info->pg_ant_num, board_info->btdm_ant_num, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type); + CL_PRINTF(cli_buf); + } else { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s/ 0x%x (%d/%d/%d)", + "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, + psd_scan->ant_det_result); + CL_PRINTF(cli_buf); + + + if (board_info->btdm_ant_det_finish) { + + if (psd_scan->ant_det_result != 12) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant Det PSD Value", + psd_scan->ant_det_psd_scan_peak_val + / 100); + CL_PRINTF(cli_buf); + } + } + + bt_coex_ver = (coex_sta->bt_coex_supported_version & 0xff); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8821c_2ant, glcoex_ver_8821c_2ant, + glcoex_ver_btdesired_8821c_2ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (coex_sta->bt_disabled ? "BT-disable" : + (bt_coex_ver >= glcoex_ver_btdesired_8821c_2ant ? + "Match" : "Mis-Match")))); + CL_PRINTF(cli_buf); + + // BT status + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s ", "BT status", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") + : ((BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status) ? "connected-idle" : "busy"))))); + CL_PRINTF(cli_buf); + + // HW settings + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(Hi-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x774(Lo-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx, + (bt_link_info->slave_role ? "(Slave!!)" : ( + coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); + CL_PRINTF(cli_buf); - halbtc8821c2ant_action_init_coex_dm(btcoexist); } void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) { struct btc_board_info *board_info = &btcoexist->board_info; - struct btc_stack_info *stack_info = &btcoexist->stack_info; struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 *cli_buf = btcoexist->cli_buf; - u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; - u16 u16tmp[4]; + u8 u8tmp[4], i, ps_tdma_case = 0; u32 u32tmp[4]; - u32 fa_of_dm, fa_cck; - u32 fw_ver = 0, bt_patch_ver = 0; + u16 u16tmp[4]; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; static u8 pop_report_in_10s = 0; + u32 phyver = 0; + boolean lte_coex_on = FALSE; + static u8 cnt = 0; + u32 ratio_crc, cnt_ok, cnt_err; CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n ============[BT Coexist info]============"); @@ -4973,66 +4959,120 @@ void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) "\r\n =========================================="); CL_PRINTF(cli_buf); } - if (btcoexist->stop_coex_dm) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n ============[Coex is STOPPED]============"); - CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n =========================================="); - CL_PRINTF(cli_buf); + + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } } if (psd_scan->ant_det_try_count == 0) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s / %d", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s / 0x%x", "Ant PG Num/ Mech/ Pos/ RFE", board_info->pg_ant_num, board_info->btdm_ant_num, - (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT? "Main" : "Aux"), - rfe_type->rfe_module_type); + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type); CL_PRINTF(cli_buf); } else { CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", + "\r\n %-35s = %d/ %d/ %s/ 0x%x (%d/%d/%d)", "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", - board_info->pg_ant_num, board_info->btdm_ant_num_by_ant_det, - (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT ? "Main" : "Aux"), - rfe_type->rfe_module_type, - psd_scan->ant_det_try_count, psd_scan->ant_det_fail_count, + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + board_info->rfe_type, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, psd_scan->ant_det_result); CL_PRINTF(cli_buf); + if (board_info->btdm_ant_det_finish) { - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", - "Ant Det PSD Value", - psd_scan->ant_det_peak_val); + + if (psd_scan->ant_det_result != 12) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant Det PSD Value", + psd_scan->ant_det_psd_scan_peak_val + / 100); CL_PRINTF(cli_buf); } } - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %d", - "BT stack/ hci ext ver", - ((stack_info->profile_notified) ? "Yes" : "No"), - stack_info->hci_version); - CL_PRINTF(cli_buf); - btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + + bt_coex_ver = (coex_sta->bt_coex_supported_version & 0xff); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)/ %c", - "Version Coex/ Fw/ Patch/ Cut", - glcoex_ver_date_8821c_2ant, glcoex_ver_8821c_2ant, fw_ver, - bt_patch_ver, bt_patch_ver, coex_sta->cut_version + 65); + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8821c_2ant, glcoex_ver_8821c_2ant, + glcoex_ver_btdesired_8821c_2ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (coex_sta->bt_disabled ? "BT-disable" : + (bt_coex_ver >= glcoex_ver_btdesired_8821c_2ant ? + "Match" : "Mis-Match")))); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", - "Wifi channel informed to BT", - coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], - coex_dm->wifi_chnl_info[2]); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", - "WifibHiPri/ Ccklock/ CckEverLock", - (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), - (coex_sta->cck_lock ? "Yes" : "No"), - (coex_sta->cck_ever_lock ? "Yes" : "No")); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x (RF-Ch = %d)", + "AFH Map to BT", + coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], + coex_dm->wifi_chnl_info[2], coex_sta->wl_center_channel); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d ", + "Isolation/WL_Thres/BT_Thres", + coex_sta->isolation_btween_wb, + coex_sta->wifi_coex_thres, + coex_sta->bt_coex_thres); CL_PRINTF(cli_buf); /* wifi status */ @@ -5046,7 +5086,8 @@ void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) CL_PRINTF(cli_buf); pop_report_in_10s++; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", "BT [status/ rssi/ retryCnt/ popCnt]", ((coex_sta->bt_disabled) ? ("disabled") : (( coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") @@ -5063,29 +5104,109 @@ void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) pop_report_in_10s = 0; } - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %d / %d / %d / %d / %d", - "SCO/HID/PAN/A2DP/Hi-Pri", - bt_link_info->sco_exist, bt_link_info->hid_exist, - bt_link_info->pan_exist, bt_link_info->a2dp_exist, - bt_link_info->bt_hi_pri_link_exist); + + if (coex_sta->num_of_profile != 0) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s%s%s%s%s", + "Profiles", + ((bt_link_info->a2dp_exist) ? + ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : + "A2DP,") : ""), + ((bt_link_info->sco_exist) ? "HFP," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : + "HID(2/18),") : ""), + ((bt_link_info->pan_exist) ? "PAN," : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = None", "Profiles"); + CL_PRINTF(cli_buf); - if (stack_info->profile_notified) - btcoexist->btc_disp_dbg_msg(btcoexist, - BTC_DBG_DISP_BT_LINK_INFO); - else { - bt_info_ext = coex_sta->bt_info_ext; - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s / %d/ %x/ %04x", - "Role/A2DP Rate/Bitpool/Feature/Ver", - ((bt_link_info->slave_role) ? "Slave" : "Master"), - (bt_info_ext & BIT(0)) ? "BR" : "EDR", coex_sta->a2dp_bit_pool, - coex_sta->bt_coex_supported_feature, - coex_sta->bt_coex_supported_version); + if (bt_link_info->a2dp_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", + "A2DP Rate/Bitpool/Auto_Slot", + ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), + coex_sta->a2dp_bit_pool, + ((coex_sta->is_autoslot) ? "On" : "Off") + ); CL_PRINTF(cli_buf); } + if (bt_link_info->hid_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "HID PairNum/Forbid_Slot", + coex_sta->hid_pair_cnt, + coex_sta->forbidden_slot + ); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", + "Role/RoleSwCnt/IgnWlact/Feature", + ((bt_link_info->slave_role) ? "Slave" : "Master"), + coex_sta->cnt_RoleSwitch, + ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), + coex_sta->bt_coex_supported_feature); + CL_PRINTF(cli_buf); + + if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "BLEScan Type/TV/Init/Ble", + coex_sta->bt_ble_scan_type, + (coex_sta->bt_ble_scan_type & 0x1 ? + coex_sta->bt_ble_scan_para[0] : 0x0), + (coex_sta->bt_ble_scan_type & 0x2 ? + coex_sta->bt_ble_scan_para[1] : 0x0), + (coex_sta->bt_ble_scan_type & 0x4 ? + coex_sta->bt_ble_scan_para[2] : 0x0)); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "ReInit/ReLink/IgnWlact/Page/NameReq", + coex_sta->cnt_ReInit, + coex_sta->cnt_setupLink, + coex_sta->cnt_IgnWlanAct, + coex_sta->cnt_Page, + coex_sta->cnt_RemoteNameReq + ); + CL_PRINTF(cli_buf); + + halbtc8821c2ant_read_score_board(btcoexist, &u16tmp[0]); + + if ((coex_sta->bt_reg_vendor_ae == 0xffff) || + (coex_sta->bt_reg_vendor_ac == 0xffff)) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard(B->W)", + ((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), + coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); + CL_PRINTF(cli_buf); + + if (coex_sta->num_of_profile > 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x%02x%02x%02x %02x%02x%02x%02x %02x%02x", + "AFH MAP", + coex_sta->bt_afh_map[0], + coex_sta->bt_afh_map[1], + coex_sta->bt_afh_map[2], + coex_sta->bt_afh_map[3], + coex_sta->bt_afh_map[4], + coex_sta->bt_afh_map[5], + coex_sta->bt_afh_map[6], + coex_sta->bt_afh_map[7], + coex_sta->bt_afh_map[8], + coex_sta->bt_afh_map[9] + ); + CL_PRINTF(cli_buf); + } for (i = 0; i < BT_INFO_SRC_8821C_2ANT_MAX; i++) { if (coex_sta->bt_info_c2h_cnt[i]) { @@ -5104,134 +5225,158 @@ void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) } } - + /* Sw mechanism */ if (btcoexist->manual_control) CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms] (before Manual)============"); + "============[mechanism] (before Manual)============"); else CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", - "============[mechanisms]============"); + "============[Mechanism]============"); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "SM[LowPenaltyRA]", - coex_dm->cur_low_penalty_ra); - CL_PRINTF(cli_buf); ps_tdma_case = coex_dm->cur_ps_tdma; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", - "PS TDMA", + "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s, %s)", + "TDMA", coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], coex_dm->ps_tdma_para[4], ps_tdma_case, - (coex_dm->cur_ps_tdma_on ? "On" : "Off"), - (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); - - CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", - "WL/BT Coex Table Type", - coex_sta->coex_table_type); + (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off"), + (coex_dm->is_switch_to_1dot5_ant ? "1.5Ant" : "2Ant")); CL_PRINTF(cli_buf); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x6c0/0x6c4/0x6c8(coexTable)", - u32tmp[0], u32tmp[1], u32tmp[2]); + "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", + "Table/0x6c0/0x6c4/0x6c8", + coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); CL_PRINTF(cli_buf); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", - "0x778/0x6cc/IgnWlanAct", - u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); + "\r\n %-35s = 0x%x/ 0x%x/ %04x", + "0x778/0x6cc/Scoreboard(W->B)", + u8tmp[0], u32tmp[0], coex_sta->score_board_WB); CL_PRINTF(cli_buf); - u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, - 0xa0); - u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, - 0xa4); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", + "AntDiv/BtCtrlLPS/LPRA/PsFail", + ((board_info->ant_div_cfg) ? "On" : "Off"), + ((coex_sta->force_lps_ctrl) ? "On" : "Off"), + ((coex_dm->cur_low_penalty_ra) ? "On" : "Off"), + coex_sta->cnt_set_ps_state_fail); + CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", - "LTE Coex Table W_L/B_L", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + "WL_DACSwing/ BT_Dec_Pwr", coex_dm->cur_fw_dac_swing_lvl, + coex_dm->cur_bt_dec_pwr_lvl); CL_PRINTF(cli_buf); - u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, - 0xa8); - u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, - 0xac); - u32tmp[2] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, - 0xb0); - u32tmp[3] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, - 0xb4); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, - "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "LTE Break Table W_L/B_L/L_W/L_B", - u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, - u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "Null All/Retry/Ack/BT_Empty/BT_Late", + coex_sta->wl_fw_dbg_info[1], + coex_sta->wl_fw_dbg_info[2], + coex_sta->wl_fw_dbg_info[3], + coex_sta->wl_fw_dbg_info[4], + coex_sta->wl_fw_dbg_info[5]); CL_PRINTF(cli_buf); + u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; + + if (lte_coex_on) { + + u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0xa0); + u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0xa4); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "LTE Coex Table W_L/B_L", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + CL_PRINTF(cli_buf); + + + u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0xa8); + u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0xac); + u32tmp[2] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0xb0); + u32tmp[3] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, + 0xb4); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "LTE Break Table W_L/B_L/L_W/L_B", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, + u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); + CL_PRINTF(cli_buf); + + } + /* Hw setting */ CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", "============[Hw setting]============"); CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); - u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", - "0x430/0x434/0x42a/0x456", - u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); - CL_PRINTF(cli_buf); - - u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp[1] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", - "LTE CoexOn/Path Ctrl Owner", - (int)((u32tmp[0] & BIT(7)) >> 7), ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", + "LTE Coex/Path Owner", + ((lte_coex_on) ? "On" : "Off") , + ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "LTE 3Wire/OPMode/UART/UARTMode", - (int)((u32tmp[0] & BIT(6)) >> 6), (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), - (int)((u32tmp[0] & BIT(3)) >> 3), - (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); + if (lte_coex_on) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %d/ %d", + "LTE 3Wire/OPMode/UART/UARTMode", + (int)((u32tmp[0] & BIT(6)) >> 6), + (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), + (int)((u32tmp[0] & BIT(3)) >> 3), + (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "LTE_Busy/UART_Busy", + (int)((u32tmp[1] & BIT(1)) >> 1), + (int)(u32tmp[1] & BIT(0))); + CL_PRINTF(cli_buf); + } + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", + "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", + ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), + ((u8tmp[0] & BIT(3)) ? "On" : "Off"), + coex_sta->gnt_error_cnt); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", - "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", - (int)((u32tmp[0] & BIT(12)) >> 12), (int)((u32tmp[0] & BIT(14)) >> 14), - ((u8tmp[0] & BIT(3)) ? "On" : "Off")); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ 0x%x", + "GNT_WL/GNT_BT/ RF_0x1", + (int)((u32tmp[1] & BIT(2)) >> 2), + (int)((u32tmp[1] & BIT(3)) >> 3), + btcoexist->btc_get_rf_reg(btcoexist, BTC_RF_A, 0x1, 0xfffff)); CL_PRINTF(cli_buf); - u32tmp[0] = halbtc8821c2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", - "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", - (int)((u32tmp[0] & BIT(2)) >> 2), (int)((u32tmp[0] & BIT(3)) >> 3), - (int)((u32tmp[0] & BIT(1)) >> 1), (int)(u32tmp[0] & BIT(0))); - CL_PRINTF(cli_buf); - - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", "0xcb0/0xcb4/0xcb8[23:16]", - u32tmp[0], u32tmp[1],u8tmp[0], ( (u8tmp[0] & 0x5) == 0x1 ? "BTG": ( (u8tmp[0] & 0xf0) == 0x70? "WL_G" : "WL_A" ) )); + u32tmp[0], u32tmp[1], u8tmp[0], + ((u8tmp[0] & 0x1) == 0x1 ? "(BTG)" : "(WL_A+G)")); CL_PRINTF(cli_buf); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); @@ -5239,64 +5384,73 @@ void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist) u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", - "0x4c[24:23]/0x64[0]/x4c6[4]/0x40[5]", - (u32tmp[0] & ( BIT(24) | BIT(23) )) >> 23 , u8tmp[2]&0x1 , (int)((u8tmp[0] & BIT(4)) >> 4), (int)((u8tmp[1] & BIT(5)) >> 5)); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "4c[24:23]/64[0]/4c6[4]/40[5]", + (u32tmp[0] & (BIT(24) | BIT(23))) >> 23 , u8tmp[2] & 0x1 , + (int)((u8tmp[0] & BIT(4)) >> 4), + (int)((u8tmp[1] & BIT(5)) >> 5)); CL_PRINTF(cli_buf); u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", "0x550/0x522/4-RxAGC/0xc50", u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); CL_PRINTF(cli_buf); - u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xf48); - u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xf4c); - u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xf08); - - u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); - u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5d); - - fa_of_dm = (u32tmp[0] & 0xffff) + (u32tmp[1] & 0xffff); - - fa_cck = (u8tmp[0] << 8) + u8tmp[1]; + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", - u32tmp[2] & 0xffff, fa_cck, ((u32tmp[2] & 0xffff0000) >> 16), fa_of_dm); + cca_cck, fa_cck, cca_ofdm, fa_ofdm); CL_PRINTF(cli_buf); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d (Rx_rate Data/RTS= %d/%d)", "CRC_OK CCK/11g/11n/11ac", coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, - coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht, + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d (Max ok = %d)", "CRC_Err CCK/11g/11n/11ac", coex_sta->crc_err_cck, coex_sta->crc_err_11g, - coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht, + coex_sta->cnt_crcok_max_in_10s); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %s/ %d", + "HiPr/ Locking/ warn/ Locked/ Noisy", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), + (coex_sta->cck_lock ? "Yes" : "No"), + (coex_sta->cck_lock_warn ? "Yes" : "No"), + (coex_sta->cck_lock_ever ? "Yes" : "No"), + coex_sta->wl_noisy_level); CL_PRINTF(cli_buf); CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x770(high-pri rx/tx)", + "0x770(Hi-pri rx/tx)", coex_sta->high_priority_rx, coex_sta->high_priority_tx); CL_PRINTF(cli_buf); - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", - "0x774(low-pri rx/tx)", - coex_sta->low_priority_rx, coex_sta->low_priority_tx); - CL_PRINTF(cli_buf); - halbtc8821c2ant_read_score_board(btcoexist, &u16tmp[0]); - - CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %04x", - "ScoreBoard[14:0] (from BT)", u16tmp[0]); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x774(Lo-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx, + (bt_link_info->slave_role ? "(Slave!!)" : ( + coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); CL_PRINTF(cli_buf); btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); @@ -5308,215 +5462,255 @@ void ex_halbtc8821c2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; - if (BTC_IPS_ENTER == type) { + if (type == BTC_IPS_ENTER) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS ENTER notify\n"); BTC_TRACE(trace_buf); - coex_sta->under_ips = true; - coex_sta->under_lps = false; + coex_sta->under_ips = TRUE; + coex_sta->under_lps = FALSE; + + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE | + BT_8821C_2ANT_SCOREBOARD_ONOFF | + BT_8821C_2ANT_SCOREBOARD_SCAN | + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, + FALSE); + + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_WLAN_OFF); - halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); - - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_WLAN_OFF); - halbtc8821c2ant_action_coex_all_off(btcoexist); - } else if (BTC_IPS_LEAVE == type) { - + } else if (type == BTC_IPS_LEAVE) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], IPS LEAVE notify\n"); BTC_TRACE(trace_buf); - - coex_sta->under_ips = false; + coex_sta->under_ips = FALSE; +#if 0 + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE, TRUE); - halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); - - halbtc8821c2ant_init_hw_config(btcoexist, false); - halbtc8821c2ant_action_init_coex_dm(btcoexist); + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ONOFF, TRUE); +#endif + + halbtc8821c2ant_init_hw_config(btcoexist, FALSE); + halbtc8821c2ant_init_coex_dm(btcoexist); halbtc8821c2ant_query_bt_info(btcoexist); } } void ex_halbtc8821c2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) { + static boolean pre_force_lps_on = FALSE; + if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; - if (BTC_LPS_ENABLE == type) { - + if (type == BTC_LPS_ENABLE) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS ENABLE notify\n"); BTC_TRACE(trace_buf); - - coex_sta->under_lps = true; - coex_sta->under_ips = false; + coex_sta->under_lps = TRUE; + coex_sta->under_ips = FALSE; - if (coex_sta->force_lps_on == true) { /* LPS No-32K */ + if (coex_sta->force_lps_ctrl == TRUE) { /* LPS No-32K */ /* Write WL "Active" in Score-board for PS-TDMA */ - halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); + pre_force_lps_on = TRUE; + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE, TRUE); } else { /* LPS-32K, need check if this h2c 0x71 can work?? (2015/08/28) */ /* Write WL "Non-Active" in Score-board for Native-PS */ - halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); + pre_force_lps_on = FALSE; + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8821c2ant_action_wifi_native_lps(btcoexist); } - } else if (BTC_LPS_DISABLE == type) { - + + } else if (type == BTC_LPS_DISABLE) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], LPS DISABLE notify\n"); BTC_TRACE(trace_buf); - - coex_sta->under_lps = false; + coex_sta->under_lps = FALSE; - halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE, TRUE); + + if ((!pre_force_lps_on) && (!coex_sta->force_lps_ctrl)) + halbtc8821c2ant_query_bt_info(btcoexist); } } void ex_halbtc8821c2ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - u32 u32tmp; - u8 u8tmpa, u8tmpb; - boolean wifi_connected = false; + boolean wifi_connected = FALSE; + boolean wifi_under_5g = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN notify()\n"); + "[BTCoex], SCAN notify()\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); - if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; - if (BTC_SCAN_START == type) //for dual band, no action for BTC_SCAN_START, the action is change to switchband_notify - return; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, &wifi_connected); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); + /* this can't be removed for RF off_on event, or BT would dis-connect */ + if ((type == BTC_SCAN_START) || (type == BTC_SCAN_START_2G)) { - halbtc8821c2ant_query_bt_info(btcoexist); /* this can't be removed for RF off_on event, or BT would dis-connect */ + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE | + BT_8821C_2ANT_SCOREBOARD_SCAN | + BT_8821C_2ANT_SCOREBOARD_ONOFF, + TRUE); - if (BTC_SCAN_START_2G == type) { + halbtc8821c2ant_query_bt_info(btcoexist); + } - if (!wifi_connected) - coex_sta->wifi_is_high_pri_task = true; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((type == BTC_SCAN_START) && (wifi_under_5g)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify (5G)\n"); + BTC_TRACE(trace_buf); + + halbtc8821c2ant_action_wifi_under5g(btcoexist); + } else if ((type == BTC_SCAN_START_2G) || (type == BTC_SCAN_START)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], SCAN START notify (2G)\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_2G_RUNTIME); + if (!wifi_connected) + coex_sta->wifi_is_high_pri_task = TRUE; + + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_2G_RUNTIME); halbtc8821c2ant_run_coexist_mechanism(btcoexist); - } else if (BTC_SCAN_FINISH == type) { - - coex_sta->wifi_is_high_pri_task = false; + } else if (type == BTC_SCAN_FINISH) { btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &coex_sta->scan_ap_num); BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", coex_sta->scan_ap_num); + "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", + coex_sta->scan_ap_num); BTC_TRACE(trace_buf); + coex_sta->wifi_is_high_pri_task = FALSE; + halbtc8821c2ant_run_coexist_mechanism(btcoexist); } } void ex_halbtc8821c2ant_switchband_notify(IN struct btc_coexist *btcoexist, - IN u8 type) + IN u8 type) { - boolean wifi_connected = false, bt_hs_on = false; + boolean wifi_connected = FALSE, bt_hs_on = FALSE; u32 wifi_link_status = 0; u32 num_of_wifi_link = 0; - boolean bt_ctrl_agg_buf_size = false; + boolean bt_ctrl_agg_buf_size = FALSE; u8 agg_buf_size = 5; - + if (btcoexist->manual_control || btcoexist->stop_coex_dm) return; - if(type == BTC_SWITCH_TO_5G) { - + coex_sta->switch_band_notify_to = type; + + if (type == BTC_SWITCH_TO_5G) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], switchband_notify --- switch to 5G\n"); BTC_TRACE(trace_buf); - + halbtc8821c2ant_action_wifi_under5g(btcoexist); + } else if (type == BTC_SWITCH_TO_24G_NOFORSCAN) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], switchband_notify --- BTC_SWITCH_TO_2G (no for scan)\n"); + BTC_TRACE(trace_buf); + + halbtc8821c2ant_run_coexist_mechanism(btcoexist); + } else { - + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], switchband_notify --- switch to 2G\n"); BTC_TRACE(trace_buf); - - ex_halbtc8821c2ant_scan_notify(btcoexist, - BTC_SCAN_START_2G); + + ex_halbtc8821c2ant_scan_notify(btcoexist, BTC_SCAN_START_2G); } + + coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; } void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - - halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); - if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) + btcoexist->stop_coex_dm) return; - if ( (BTC_ASSOCIATE_5G_START == type) || (BTC_ASSOCIATE_5G_FINISH== type)) { + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE | + BT_8821C_2ANT_SCOREBOARD_SCAN | + BT_8821C_2ANT_SCOREBOARD_ONOFF, + TRUE); - if (BTC_ASSOCIATE_5G_START == type) - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], connect_notify --- 5G start\n"); - else - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], connect_notify --- 5G finish\n"); - - BTC_TRACE(trace_buf); + if ((type == BTC_ASSOCIATE_5G_START) || + (type == BTC_ASSOCIATE_5G_FINISH)) { - halbtc8821c2ant_action_wifi_under5g(btcoexist); - return; - } + if (type == BTC_ASSOCIATE_5G_START) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], connect_notify --- 5G start\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], connect_notify --- 5G finish\n"); + BTC_TRACE(trace_buf); - if (BTC_ASSOCIATE_START == type) { + halbtc8821c2ant_action_wifi_under5g(btcoexist); + } else if (type == BTC_ASSOCIATE_START) { - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], CONNECT START notify (2G)\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_2G_RUNTIME); + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_2G_RUNTIME); halbtc8821c2ant_run_coexist_mechanism(btcoexist); + /* To keep TDMA case during connect process, + to avoid changed by Btinfo and runcoexmechanism */ + coex_sta->freeze_coexrun_by_btinfo = TRUE; + coex_dm->arp_cnt = 0; - } else if (BTC_ASSOCIATE_FINISH == type) { + } else if (type == BTC_ASSOCIATE_FINISH) { - coex_sta->wifi_is_high_pri_task = false; + coex_sta->wifi_is_high_pri_task = FALSE; + coex_sta->freeze_coexrun_by_btinfo = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], CONNECT FINISH notify (2G)\n"); + "[BTCoex], CONNECT FINISH notify (2G)\n"); BTC_TRACE(trace_buf); halbtc8821c2ant_run_coexist_mechanism(btcoexist); @@ -5530,67 +5724,66 @@ void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, u32 wifi_bw; u8 wifi_central_chnl; u8 ap_num = 0; - boolean wifi_under_b_mode = false, wifi_under_5g = false; + boolean wifi_under_b_mode = FALSE, wifi_under_5g = FALSE; if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) + btcoexist->stop_coex_dm) return; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); - if (wifi_under_5g) { - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], WiFi is under 5G!!!\n"); - BTC_TRACE(trace_buf); + if (type == BTC_MEDIA_CONNECT) { - halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); - halbtc8821c2ant_action_wifi_under5g(btcoexist); - return; - } - - if (BTC_MEDIA_CONNECT == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], MEDIA connect notify\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_post_activestate_to_bt(btcoexist, true); + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE | + BT_8821C_2ANT_SCOREBOARD_ONOFF, + TRUE); - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_2G_RUNTIME); + if (wifi_under_5g) { - /* psd_scan->ant_det_is_ant_det_available = TRUE; */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 5G!!!\n"); + BTC_TRACE(trace_buf); - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, - &wifi_under_b_mode); - - /* Set CCK Tx/Rx high Pri except 11b mode */ - if (wifi_under_b_mode) { - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x00); /* CCK Rx */ + halbtc8821c2ant_action_wifi_under5g(btcoexist); } else { - btcoexist->btc_write_1byte(btcoexist, 0x6cd, - 0x00); /* CCK Tx */ - btcoexist->btc_write_1byte(btcoexist, 0x6cf, - 0x10); /* CCK Rx */ - } + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_2G_RUNTIME); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + /* Set CCK Tx/Rx high Pri except 11b mode */ + if (wifi_under_b_mode) { + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x00); /* CCK Rx */ + } else { + + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); /* CCK Rx */ + } + } } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], MEDIA disconnect notify\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_post_activestate_to_bt(btcoexist, false); - btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ + + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE, FALSE); + + coex_sta->cck_lock_ever = FALSE; + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; } @@ -5600,21 +5793,20 @@ void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8821c2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type) { - boolean under_4way = false, wifi_under_5g = false; + boolean under_4way = FALSE, wifi_under_5g = FALSE; if (btcoexist->manual_control || - btcoexist->stop_coex_dm || - coex_sta->bt_disabled) + btcoexist->stop_coex_dm) return; btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); if (wifi_under_5g) { - + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], WiFi is under 5G!!!\n"); BTC_TRACE(trace_buf); - + halbtc8821c2ant_action_wifi_under5g(btcoexist); return; } @@ -5628,46 +5820,45 @@ void ex_halbtc8821c2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, "[BTCoex], specific Packet ---- under_4way!!\n"); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; - } else if (BTC_PACKET_ARP == type) { + } else if (type == BTC_PACKET_ARP) { coex_dm->arp_cnt++; - - if (coex_sta->wifi_is_high_pri_task) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet ARP notify -cnt = %d\n", coex_dm->arp_cnt); - BTC_TRACE(trace_buf); - } + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ARP notify -cnt = %d\n", + coex_dm->arp_cnt); + BTC_TRACE(trace_buf); } else { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", type); + "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", + type); BTC_TRACE(trace_buf); - coex_sta->wifi_is_high_pri_task = true; + coex_sta->wifi_is_high_pri_task = TRUE; coex_sta->specific_pkt_period_cnt = 2; } - if (coex_sta->wifi_is_high_pri_task) + if (coex_sta->wifi_is_high_pri_task) { + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_SCAN, TRUE); halbtc8821c2ant_run_coexist_mechanism(btcoexist); + } } void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length) { - u8 bt_info = 0; u8 i, rsp_source = 0; - boolean bt_busy = false, limited_dig = false; - boolean wifi_connected = false; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE, + wifi_busy = FALSE; + static boolean is_scoreboard_scan = FALSE; - coex_sta->c2h_bt_info_req_sent = false; - - btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, - &wifi_connected); rsp_source = tmp_buf[0] & 0xf; if (rsp_source >= BT_INFO_SRC_8821C_2ANT_MAX) @@ -5675,13 +5866,12 @@ void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, coex_sta->bt_info_c2h_cnt[rsp_source]++; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], Bt info[%d], length=%d, hex data=[", rsp_source, + "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, length); BTC_TRACE(trace_buf); + for (i = 0; i < length; i++) { coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; - if (i == 1) - bt_info = tmp_buf[i]; if (i == length - 1) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", @@ -5694,51 +5884,130 @@ void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, } } + coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; + coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; + coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; + if (BT_INFO_SRC_8821C_2ANT_WIFI_FW != rsp_source) { /* if 0xff, it means BT is under WHCK test */ - if (bt_info == 0xff) - coex_sta->bt_whck_test = true; - else - coex_sta->bt_whck_test = false; + coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? TRUE : + FALSE); - coex_sta->bt_retry_cnt = /* [3:0] */ - coex_sta->bt_info_c2h[rsp_source][2] & 0xf; + coex_sta->bt_create_connection = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? TRUE : + FALSE); + + /* unit: %, value-100 to translate to unit: dBm */ + coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + + 10; + + coex_sta->c2h_bt_remote_name_req = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? TRUE : + FALSE); + + coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & + 0x10) ? TRUE : FALSE); + + coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & + 0x8) ? TRUE : FALSE); + + coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? + TRUE : FALSE); + + coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & + BT_INFO_8821C_2ANT_B_INQ_PAGE) ? TRUE : FALSE); + + coex_sta->a2dp_bit_pool = ((( + coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? + (coex_sta->bt_info_c2h[rsp_source][6] & 0x7f) : 0); + + coex_sta->is_bt_a2dp_sink = (coex_sta->bt_info_c2h[rsp_source][6] & 0x80) ? + TRUE : FALSE; + + coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & + 0xf; + + coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; + + coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; + + coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; + + coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; if (coex_sta->bt_retry_cnt >= 1) coex_sta->pop_event_cnt++; - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x80) - coex_sta->bt_create_connection = true; + if (coex_sta->c2h_bt_remote_name_req) + coex_sta->cnt_RemoteNameReq++; + + if (coex_sta->bt_info_ext & BIT(1)) + coex_sta->cnt_ReInit++; + + if (coex_sta->bt_info_ext & BIT(2)) { + coex_sta->cnt_setupLink++; + coex_sta->is_setupLink = TRUE; + coex_sta->bt_relink_downcount = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->is_setupLink = FALSE; + coex_sta->bt_relink_downcount = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop in BT info!!\n"); + BTC_TRACE(trace_buf); + } + + if (coex_sta->bt_info_ext & BIT(3)) + coex_sta->cnt_IgnWlanAct++; + + if (coex_sta->bt_info_ext & BIT(6)) + coex_sta->cnt_RoleSwitch++; + + if (coex_sta->bt_info_ext & BIT(7)) + coex_sta->is_bt_multi_link = TRUE; else - coex_sta->bt_create_connection = false; + coex_sta->is_bt_multi_link = FALSE; - /* unit: %, value-100 to translate to unit: dBm */ - coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + 10; + if (coex_sta->bt_create_connection) { + coex_sta->cnt_Page++; - if (coex_sta->bt_info_c2h[rsp_source][2] & 0x20) - coex_sta->c2h_bt_remote_name_req = true; - else - coex_sta->c2h_bt_remote_name_req = false; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, + &wifi_busy); - if ((coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) { - coex_sta->a2dp_bit_pool = - coex_sta->bt_info_c2h[rsp_source][6]; - } else - coex_sta->a2dp_bit_pool = 0; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); - if (coex_sta->bt_info_c2h[rsp_source][1] & 0x9) - coex_sta->acl_busy = true; - else - coex_sta->acl_busy = false; + if ((wifi_link) || (wifi_roam) || (wifi_scan) || + (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { - coex_sta->bt_info_ext = - coex_sta->bt_info_c2h[rsp_source][4]; + is_scoreboard_scan = TRUE; + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_SCAN, TRUE); + + } else + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_SCAN, FALSE); + + } else { + if (is_scoreboard_scan) { + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_SCAN, FALSE); + is_scoreboard_scan = FALSE; + } + } /* Here we need to resend some wifi info to BT */ /* because bt is reset and loss of the info. */ - if ((!btcoexist->manual_control) && (!btcoexist->stop_coex_dm)) { + if ((!btcoexist->manual_control) && + (!btcoexist->stop_coex_dm)) { + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); /* Re-Init */ if ((coex_sta->bt_info_ext & BIT(1))) { @@ -5746,132 +6015,162 @@ void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); BTC_TRACE(trace_buf); if (wifi_connected) - ex_halbtc8821c2ant_media_status_notify( + halbtc8821c2ant_update_wifi_channel_info( btcoexist, BTC_MEDIA_CONNECT); else - ex_halbtc8821c2ant_media_status_notify( - btcoexist, BTC_MEDIA_DISCONNECT); + halbtc8821c2ant_update_wifi_channel_info( + btcoexist, + BTC_MEDIA_DISCONNECT); } /* If Ignore_WLanAct && not SetUp_Link */ - if ((coex_sta->bt_info_ext & BIT(3)) && (!(coex_sta->bt_info_ext & BIT(2)))) { + if ((coex_sta->bt_info_ext & BIT(3)) && + (!(coex_sta->bt_info_ext & BIT(2))) && + (!(coex_sta->bt_info_ext & BIT(6)))) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); BTC_TRACE(trace_buf); halbtc8821c2ant_ignore_wlan_act(btcoexist, - FORCE_EXEC, false); + FORCE_EXEC, FALSE); + } else { + if (coex_sta->bt_info_ext & BIT(2)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ignore Wlan active because Re-link!!\n"); + BTC_TRACE(trace_buf); + } else if (coex_sta->bt_info_ext & BIT(6)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ignore Wlan active because Role-Switch!!\n"); + BTC_TRACE(trace_buf); + } } } - /* check BIT2 first ==> check if bt is under inquiry or page scan */ - if (bt_info & BT_INFO_8821C_2ANT_B_INQ_PAGE) - coex_sta->c2h_bt_inquiry_page = true; - else - coex_sta->c2h_bt_inquiry_page = false; } - coex_sta->num_of_profile = 0; - - /* set link exist status */ - if (!(bt_info & BT_INFO_8821C_2ANT_B_CONNECTION)) { - coex_sta->bt_link_exist = false; - coex_sta->pan_exist = false; - coex_sta->a2dp_exist = false; - coex_sta->hid_exist = false; - coex_sta->sco_exist = false; - } else { /* connection exists */ - coex_sta->bt_link_exist = true; - if (bt_info & BT_INFO_8821C_2ANT_B_FTP) { - coex_sta->pan_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->pan_exist = false; - - if (bt_info & BT_INFO_8821C_2ANT_B_A2DP) { - coex_sta->a2dp_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->a2dp_exist = false; - - if (bt_info & BT_INFO_8821C_2ANT_B_HID) { - coex_sta->hid_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->hid_exist = false; - - if (bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) { - coex_sta->sco_exist = true; - coex_sta->num_of_profile++; - } else - coex_sta->sco_exist = false; + if ((coex_sta->bt_info_ext & BIT(5))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); + BTC_TRACE(trace_buf); + coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt( + btcoexist); + if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) + coex_sta->bt_ble_scan_para[0] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x1); + if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) + coex_sta->bt_ble_scan_para[1] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x2); + if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) + coex_sta->bt_ble_scan_para[2] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x4); } halbtc8821c2ant_update_bt_link_info(btcoexist); - if (!(bt_info & BT_INFO_8821C_2ANT_B_CONNECTION)) { - coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info == - BT_INFO_8821C_2ANT_B_CONNECTION) { /* connection exists but no busy */ - coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); - BTC_TRACE(trace_buf); - } else if ((bt_info & BT_INFO_8821C_2ANT_B_SCO_ESCO) || - (bt_info & BT_INFO_8821C_2ANT_B_SCO_BUSY)) { - coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_SCO_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); - BTC_TRACE(trace_buf); - } else if (bt_info & BT_INFO_8821C_2ANT_B_ACL_BUSY) { - coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_ACL_BUSY; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); - BTC_TRACE(trace_buf); - } else { - coex_dm->bt_status = BT_8821C_2ANT_BT_STATUS_MAX; - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); - BTC_TRACE(trace_buf); - } - - if ((BT_8821C_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || - (BT_8821C_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || - (BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) { - bt_busy = true; - limited_dig = true; - } else { - bt_busy = false; - limited_dig = false; - } - - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); - - coex_dm->limited_dig = limited_dig; - btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_LIMITED_DIG, &limited_dig); - - if (btcoexist->manual_control) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Manual CTRL<===\n"); - BTC_TRACE(trace_buf); - return; - } - - if (btcoexist->stop_coex_dm) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], BtInfoNotify(), No run_coexist_mechanism return for Stop Coex DM <===\n"); - BTC_TRACE(trace_buf); - return; - } - halbtc8821c2ant_run_coexist_mechanism(btcoexist); } +void ex_halbtc8821c2ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i = 0; + static u8 tmp_buf_pre[10] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi Fw Dbg info = %d %d %d %d %d %d (len = %d)\n", + tmp_buf[0], tmp_buf[1], + tmp_buf[2], tmp_buf[3], + tmp_buf[4], tmp_buf[5], length); + BTC_TRACE(trace_buf); + + if (tmp_buf[0] == 0x8) { + for (i = 1; i <= 5; i++) { + coex_sta->wl_fw_dbg_info[i] = + (tmp_buf[i] >= tmp_buf_pre[i]) ? + (tmp_buf[i] - tmp_buf_pre[i]) : + (255 - tmp_buf_pre[i] + tmp_buf[i]); + + tmp_buf_pre[i] = tmp_buf[i]; + } + } +} + + +void ex_halbtc8821c2ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id) +{ + BOOLEAN wifi_connected = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (is_data_frame) { + coex_sta->wl_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rx_rate_change_notify data rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } else { + coex_sta->wl_rts_rx_rate = btc_rate_id; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rts_rate_change_notify RTS rate id = %d, RTS_Rate = %d\n", + coex_sta->wl_rts_rx_rate, coex_sta->wl_rts_rx_rate); + BTC_TRACE(trace_buf); + } + + if ((wifi_connected) && + ((coex_dm->bt_status == BT_8821C_2ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8821C_2ANT_BT_STATUS_ACL_SCO_BUSY) || + (coex_dm->bt_status == BT_8821C_2ANT_BT_STATUS_SCO_BUSY))) { + + if ((coex_sta->wl_rx_rate == BTC_CCK_5_5) || + (coex_sta->wl_rx_rate == BTC_OFDM_6) || + (coex_sta->wl_rx_rate == BTC_MCS_0)) { + + coex_sta->cck_lock_warn = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck lock warning...\n"); + BTC_TRACE(trace_buf); + } else if ((coex_sta->wl_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rx_rate == BTC_CCK_2) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_1) || + (coex_sta->wl_rts_rx_rate == BTC_CCK_2)) { + + coex_sta->cck_lock = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck locking...\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], cck unlock...\n"); + BTC_TRACE(trace_buf); + } + } else { + if ((coex_dm->bt_status == + BT_8821C_2ANT_BT_STATUS_CONNECTED_IDLE) || + (coex_dm->bt_status == + BT_8821C_2ANT_BT_STATUS_NON_CONNECTED_IDLE)) { + coex_sta->cck_lock_warn = FALSE; + coex_sta->cck_lock = FALSE; + } + } + +} + + + void ex_halbtc8821c2ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type) { @@ -5883,28 +6182,34 @@ void ex_halbtc8821c2ant_rf_status_notify(IN struct btc_coexist *btcoexist, "[BTCoex], RF is turned ON!!\n"); BTC_TRACE(trace_buf); - coex_sta->wl_rf_off_on_event = true; - btcoexist->stop_coex_dm = false; - - halbtc8821c2ant_post_activestate_to_bt(btcoexist, TRUE); - halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, TRUE); + btcoexist->stop_coex_dm = FALSE; + coex_sta->is_rf_state_off = FALSE; +#if 0 + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ONOFF, TRUE); +#endif } else if (BTC_RF_OFF == type) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF is turned OFF!!\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_WLAN_OFF); - + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_WLAN_OFF); + halbtc8821c2ant_action_coex_all_off(btcoexist); - halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); - halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); - btcoexist->stop_coex_dm = true; - coex_sta->wl_rf_off_on_event = false; + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE | + BT_8821C_2ANT_SCOREBOARD_ONOFF | + BT_8821C_2ANT_SCOREBOARD_SCAN | + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, + FALSE); + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = TRUE; } } @@ -5913,26 +6218,31 @@ void ex_halbtc8821c2ant_halt_notify(IN struct btc_coexist *btcoexist) BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); BTC_TRACE(trace_buf); - halbtc8821c2ant_set_ant_path(btcoexist, - BTC_ANT_PATH_AUTO, - FORCE_EXEC, - BT_8821C_2ANT_PHASE_WLAN_OFF); + halbtc8821c2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_2ANT_PHASE_WLAN_OFF); ex_halbtc8821c2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); - halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, FALSE); - - halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); - halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE | + BT_8821C_2ANT_SCOREBOARD_ONOFF | + BT_8821C_2ANT_SCOREBOARD_SCAN | + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, + FALSE); } void ex_halbtc8821c2ant_pnp_notify(IN struct btc_coexist *btcoexist, IN u8 pnp_state) { + boolean wifi_under_5g = FALSE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); BTC_TRACE(trace_buf); - if (BTC_WIFI_PNP_SLEEP == pnp_state) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((BTC_WIFI_PNP_SLEEP == pnp_state) || + (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify to SLEEP\n"); BTC_TRACE(trace_buf); @@ -5940,29 +6250,54 @@ void ex_halbtc8821c2ant_pnp_notify(IN struct btc_coexist *btcoexist, /* Sinda 20150819, workaround for driver skip leave IPS/LPS to speed up sleep time. */ /* Driver do not leave IPS/LPS when driver is going to sleep, so BTCoexistence think wifi is still under IPS/LPS */ /* BT should clear UnderIPS/UnderLPS state to avoid mismatch state after wakeup. */ - coex_sta->under_ips = false; - coex_sta->under_lps = false; + coex_sta->under_ips = FALSE; + coex_sta->under_lps = FALSE; - halbtc8821c2ant_enable_gnt_to_gpio(btcoexist, FALSE); + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE | + BT_8821C_2ANT_SCOREBOARD_ONOFF | + BT_8821C_2ANT_SCOREBOARD_SCAN | + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, + FALSE); - halbtc8821c2ant_post_activestate_to_bt(btcoexist, FALSE); - halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, FALSE); + if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { + + if (wifi_under_5g) + halbtc8821c2ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_2ANT_PHASE_5G_RUNTIME); + else + halbtc8821c2ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8821C_2ANT_PHASE_2G_RUNTIME); + } else { + + halbtc8821c2ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8821C_2ANT_PHASE_WLAN_OFF); + } } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify to WAKE UP\n"); BTC_TRACE(trace_buf); - - halbtc8821c2ant_post_activestate_to_bt(btcoexist, TRUE); - halbtc8821c2ant_post_onoffstate_to_bt(btcoexist, TRUE); +#if 0 + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_ONOFF, TRUE); +#endif } } void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist) { - struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + struct btc_board_info *board_info = &btcoexist->board_info; + boolean wifi_busy = FALSE; + boolean bt_relink_finish = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ============== Periodical ==============\n"); + "[BTCoex], ************* Periodical *************\n"); BTC_TRACE(trace_buf); #if (BT_AUTO_REPORT_ONLY_8821C_2ANT == 0) @@ -5973,124 +6308,82 @@ void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist) halbtc8821c2ant_monitor_wifi_ctr(btcoexist); halbtc8821c2ant_monitor_bt_enable_disable(btcoexist); +#if 0 + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + /* halbtc8821c2ant_read_score_board(btcoexist, &bt_scoreboard_val); */ + + if (wifi_busy) { + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, TRUE); + /* + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_WLBUSY, TRUE); + + if (bt_scoreboard_val & BIT(6)) + halbtc8821c2ant_query_bt_info(btcoexist); */ + } else { + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_UNDERTEST, FALSE); + /* + halbtc8821c2ant_post_state_to_bt(btcoexist, + BT_8821C_2ANT_SCOREBOARD_WLBUSY, + FALSE); */ + } +#endif + + if (coex_sta->bt_relink_downcount != 0) { + coex_sta->bt_relink_downcount--; + + if (coex_sta->bt_relink_downcount == 0) { + coex_sta->is_setupLink = FALSE; + bt_relink_finish = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop by periodical count-down!!\n"); + BTC_TRACE(trace_buf); + } + } + /* for 4-way, DHCP, EAPOL packet */ if (coex_sta->specific_pkt_period_cnt > 0) { coex_sta->specific_pkt_period_cnt--; - if ((coex_sta->specific_pkt_period_cnt == 0) && (coex_sta->wifi_is_high_pri_task)) - coex_sta->wifi_is_high_pri_task = false; + if ((coex_sta->specific_pkt_period_cnt == 0) && + (coex_sta->wifi_is_high_pri_task)) + coex_sta->wifi_is_high_pri_task = FALSE; BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", (coex_sta->wifi_is_high_pri_task ? "Yes" : "No")); + "[BTCoex], ***************** Hi-Pri Task = %s\n", + (coex_sta->wifi_is_high_pri_task ? "Yes" : + "No")); BTC_TRACE(trace_buf); } - if (coex_sta->bt_coex_supported_feature == 0) - coex_sta->bt_coex_supported_feature = btcoexist->btc_get_bt_coex_supported_feature(btcoexist); - - if ( (coex_sta->bt_coex_supported_version == 0) && (!coex_sta->bt_disabled) ) - coex_sta->bt_coex_supported_version = btcoexist->btc_get_bt_coex_supported_version(btcoexist); - - if (halbtc8821c2ant_is_wifibt_status_changed(btcoexist)) + if (halbtc8821c2ant_is_wifibt_status_changed(btcoexist) || (bt_relink_finish) + || (coex_sta->is_set_ps_state_fail)) halbtc8821c2ant_run_coexist_mechanism(btcoexist); } +/*#pragma optimize( "", off )*/ void ex_halbtc8821c2ant_antenna_detection(IN struct btc_coexist *btcoexist, IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Ext Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - -#if BT_8821C_2ANT_ANTDET_ENABLE - static u32 ant_det_count = 0, ant_det_fail_count = 0; - struct btc_board_info *board_info = &btcoexist->board_info; - /*boolean scan, roam;*/ - - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx Call AntennaDetect()!!\n"); - BTC_TRACE(trace_buf); - - if (seconds == 0) { - psd_scan->ant_det_try_count = 0; - psd_scan->ant_det_fail_count = 0; - ant_det_count = 0; - ant_det_fail_count = 0; - board_info->btdm_ant_det_finish = false; - board_info->btdm_ant_num_by_ant_det = 1; - return; - } - - if (!board_info->btdm_ant_det_finish) { - psd_scan->ant_det_inteval_count = - psd_scan->ant_det_inteval_count + 2; - - if (psd_scan->ant_det_inteval_count >= - BT_8821C_2ANT_ANTDET_RETRY_INTERVAL) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is up, Try Detect!!\n"); - BTC_TRACE(trace_buf); - halbtc8821c2ant_psd_antenna_detection_check(btcoexist); - - if (board_info->btdm_ant_det_finish) { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Success!!\n"); - BTC_TRACE(trace_buf); - -#if 0 - board_info->btdm_ant_det_finish = false; -#endif - -#if 0 - if (board_info->btdm_ant_num_by_ant_det == 2) - halbtc8821c2ant_mechanism_switch( - btcoexist, true); - else - halbtc8821c2ant_mechanism_switch( - btcoexist, false); -#endif - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Fail!!\n"); - BTC_TRACE(trace_buf); - } - psd_scan->ant_det_inteval_count = 0; - } else { - BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, - "xxxxxxxxxxxxxxxx AntennaDetect(), Antenna Det Timer is not up! (%d)\n", - psd_scan->ant_det_inteval_count); - BTC_TRACE(trace_buf); - } - - } -#endif - - } void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist) { -#if BT_8821C_2ANT_ANTDET_ENABLE - struct btc_board_info *board_info = &btcoexist->board_info; - - if (psd_scan->ant_det_try_count != 0) { - halbtc8821c2ant_psd_show_antenna_detect_result(btcoexist); - - if (board_info->btdm_ant_det_finish) - halbtc8821c2ant_psd_showdata(btcoexist); - return; - } -#endif - } #endif #endif /* #if (RTL8821C_SUPPORT == 1) */ + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.h index 5c6abbfce724..a690aea337fb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821c2ant.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) @@ -6,6 +20,7 @@ /* ******************************************* * The following is for 8821C 2Ant BT Co-exist definition * ******************************************* */ +#define BT_8821C_2ANT_COEX_DBG 0 #define BT_AUTO_REPORT_ONLY_8821C_2ANT 1 @@ -40,11 +55,12 @@ #define BT_8821C_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 52 #define BT_8821C_2ANT_ANTDET_PSDTHRES_1ANT 40 #define BT_8821C_2ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ -#define BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY 40000 +#define BT_8821C_2ANT_ANTDET_SWEEPPOINT_DELAY 60000 #define BT_8821C_2ANT_ANTDET_ENABLE 0 -#define BT_8821C_2ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 #define BT_8821C_2ANT_ANTDET_BTTXTIME 100 #define BT_8821C_2ANT_ANTDET_BTTXCHANNEL 39 +#define BT_8821C_2ANT_ANTDET_PSD_SWWEEPCOUNT 50 + #define BT_8821C_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 @@ -118,9 +134,17 @@ enum bt_8821c_2ant_coex_algo { BT_8821C_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, BT_8821C_2ANT_COEX_ALGO_HID_A2DP = 0xa, BT_8821C_2ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, + BT_8821C_2ANT_COEX_ALGO_A2DPSINK = 0xc, BT_8821C_2ANT_COEX_ALGO_MAX }; +enum bt_8821c_2ant_ext_ant_switch_type { + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT = 0x0, + BT_8821C_2ANT_EXT_ANT_SWITCH_USE_SPDT = 0x1, + BT_8821C_2ANT_EXT_ANT_SWITCH_NONE = 0x2, + BT_8821C_2ANT_EXT_ANT_SWITCH_MAX +}; + enum bt_8821c_2ant_ext_ant_switch_ctrl_type { BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, BT_8821C_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, @@ -144,23 +168,36 @@ enum bt_8821c_2ant_ext_band_switch_pos_type { BT_8821C_2ANT_EXT_BAND_SWITCH_TO_MAX }; -enum bt_8821c_2ant_int_block{ +enum bt_8821c_2ant_int_block { BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG = 0x0, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG = 0x1, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG = 0x2, BT_8821C_2ANT_INT_BLOCK_SWITCH_TO_MAX }; -enum bt_8821c_2ant_phase{ +enum bt_8821c_2ant_phase { BT_8821C_2ANT_PHASE_COEX_INIT = 0x0, - BT_8821C_2ANT_PHASE_WLANONLY_INIT = 0x1, + BT_8821C_2ANT_PHASE_WLANONLY_INIT = 0x1, BT_8821C_2ANT_PHASE_WLAN_OFF = 0x2, BT_8821C_2ANT_PHASE_2G_RUNTIME = 0x3, BT_8821C_2ANT_PHASE_5G_RUNTIME = 0x4, - BT_8821C_2ANT_PHASE_BTMPMODE = 0x5, + BT_8821C_2ANT_PHASE_BTMPMODE = 0x5, + BT_8821C_2ANT_PHASE_ANTENNA_DET = 0x6, + BT_8821C_2ANT_PHASE_COEX_POWERON = 0x7, + BT_8821C_2ANT_PHASE_2G_RUNTIME_CONCURRENT = 0x8, BT_8821C_2ANT_PHASE_MAX }; +enum bt_8821c_2ant_Scoreboard { + BT_8821C_2ANT_SCOREBOARD_ACTIVE = BIT(0), + BT_8821C_2ANT_SCOREBOARD_ONOFF = BIT(1), + BT_8821C_2ANT_SCOREBOARD_SCAN = BIT(2), + BT_8821C_2ANT_SCOREBOARD_UNDERTEST = BIT(3), + BT_8821C_2ANT_SCOREBOARD_WLBUSY = BIT(6) +}; + + + struct coex_dm_8821c_2ant { /* hw setting */ u32 pre_ant_pos_type; @@ -177,7 +214,6 @@ struct coex_dm_8821c_2ant { u8 ps_tdma_para[5]; u8 ps_tdma_du_adj_type; boolean reset_tdma_adjust; - boolean auto_tdma_adjust; boolean pre_ps_tdma_on; boolean cur_ps_tdma_on; boolean pre_bt_auto_report; @@ -227,7 +263,7 @@ struct coex_dm_8821c_2ant { u32 pre_ext_ant_switch_status; u32 cur_ext_ant_switch_status; - + u8 pre_ext_band_switch_status; u8 cur_ext_band_switch_status; @@ -236,58 +272,62 @@ struct coex_dm_8821c_2ant { }; struct coex_sta_8821c_2ant { - boolean bt_disabled; - boolean bt_link_exist; - boolean sco_exist; - boolean a2dp_exist; - boolean hid_exist; - boolean pan_exist; + boolean bt_disabled; + boolean bt_link_exist; + boolean sco_exist; + boolean a2dp_exist; + boolean hid_exist; + boolean pan_exist; - boolean under_lps; - boolean under_ips; + boolean under_lps; + boolean under_ips; u32 high_priority_tx; u32 high_priority_rx; u32 low_priority_tx; u32 low_priority_rx; + boolean is_hiPri_rx_overhead; u8 bt_rssi; - boolean bt_tx_rx_mask; u8 pre_bt_rssi_state; u8 pre_wifi_rssi_state[4]; - boolean c2h_bt_info_req_sent; u8 bt_info_c2h[BT_INFO_SRC_8821C_2ANT_MAX][10]; u32 bt_info_c2h_cnt[BT_INFO_SRC_8821C_2ANT_MAX]; boolean bt_whck_test; - boolean c2h_bt_inquiry_page; - boolean c2h_bt_remote_name_req; - u8 bt_retry_cnt; + boolean c2h_bt_inquiry_page; + boolean c2h_bt_remote_name_req; + u8 bt_info_ext; + u8 bt_info_ext2; u32 pop_event_cnt; u8 scan_ap_num; + u8 bt_retry_cnt; u32 crc_ok_cck; u32 crc_ok_11g; u32 crc_ok_11n; - u32 crc_ok_11n_agg; + u32 crc_ok_11n_vht; u32 crc_err_cck; u32 crc_err_11g; u32 crc_err_11n; - u32 crc_err_11n_agg; + u32 crc_err_11n_vht; - - boolean cck_lock; - boolean pre_ccklock; - boolean cck_ever_lock; + u32 acc_crc_ratio; + u32 now_crc_ratio; + u32 cnt_crcok_max_in_10s; + + boolean cck_lock; + boolean cck_lock_ever; + boolean cck_lock_warn; u8 coex_table_type; - boolean force_lps_on; + boolean force_lps_ctrl; u8 dis_ver_info_cnt; u8 a2dp_bit_pool; u8 cut_version; - boolean concurrent_rx_mode_on; + boolean concurrent_rx_mode_on; u16 score_board; u8 isolation_btween_wb; /* 0~ 50 */ @@ -298,36 +338,84 @@ struct coex_sta_8821c_2ant { u8 num_of_profile; boolean acl_busy; - boolean wl_rf_off_on_event; boolean bt_create_connection; - boolean run_time_state; boolean wifi_is_high_pri_task; u32 specific_pkt_period_cnt; u32 bt_coex_supported_feature; u32 bt_coex_supported_version; + + u8 bt_ble_scan_type; + u32 bt_ble_scan_para[3]; + + boolean run_time_state; + boolean freeze_coexrun_by_btinfo; + + boolean is_A2DP_3M; + boolean voice_over_HOGP; + u8 bt_info; + boolean is_autoslot; + u8 forbidden_slot; + u8 hid_busy_num; + u8 hid_pair_cnt; + + u32 cnt_RemoteNameReq; + u32 cnt_setupLink; + u32 cnt_ReInit; + u32 cnt_IgnWlanAct; + u32 cnt_Page; + u32 cnt_RoleSwitch; + + u16 bt_reg_vendor_ac; + u16 bt_reg_vendor_ae; + + boolean is_setupLink; + u8 wl_noisy_level; + u32 gnt_error_cnt; + + u8 bt_afh_map[10]; + u8 bt_relink_downcount; + boolean is_tdma_btautoslot; + boolean is_tdma_btautoslot_hang; + + boolean is_eSCO_mode; + u8 switch_band_notify_to; + boolean is_rf_state_off; + + boolean is_hid_low_pri_tx_overhead; + boolean is_bt_multi_link; + boolean is_bt_a2dp_sink; + boolean is_set_ps_state_fail; + u8 cnt_set_ps_state_fail; + + u8 wl_fw_dbg_info[10]; + u8 wl_rx_rate; + u8 wl_rts_rx_rate; + u8 wl_center_channel; + + u16 score_board_WB; }; -#define BT_8821C_2ANT_EXT_ANT_SWITCH_USE_DPDT 0 -#define BT_8821C_2ANT_EXT_ANT_SWITCH_USE_SPDT 1 -#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_DPDT 0 -#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_SPDT 1 +#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_DPDT 0 +#define BT_8821C_2ANT_EXT_BAND_SWITCH_USE_SPDT 1 -struct rfe_type_8821c_2ant{ +struct rfe_type_8821c_2ant { - u8 rfe_module_type; + u8 rfe_module_type; boolean ext_ant_switch_exist; u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ u8 ext_ant_switch_ctrl_polarity; /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ - + boolean ext_band_switch_exist; u8 ext_band_switch_type; /* 0:DPDT, 1:SPDT */ u8 ext_band_switch_ctrl_polarity; - boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ + boolean ant_at_main_port; - boolean ext_ant_switch_diversity; /* If diversity on */ + boolean wlg_Locate_at_btg; /* If TRUE: WLG at BTG, If FALSE: WLG at WLAG */ + + boolean ext_ant_switch_diversity; /* If diversity on */ }; #define BT_8821C_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ @@ -364,10 +452,13 @@ struct psdscan_sta_8821c_2ant { u32 psd_stop_point; u32 psd_max_value_point; u32 psd_max_value; + u32 psd_max_value2; + u32 psd_avg_value; /* filter loop_max_value that below BT_8821C_1ANT_ANTDET_PSDTHRES_1ANT, and average the rest*/ + u32 psd_loop_max_value[BT_8821C_2ANT_ANTDET_PSD_SWWEEPCOUNT]; /*max value in each loop */ u32 psd_start_base; u32 psd_avg_num; /* 1/8/16/32 */ u32 psd_gen_count; - boolean is_psd_running; + boolean is_AntDet_running; boolean is_psd_show_max_only; }; @@ -387,7 +478,7 @@ void ex_halbtc8821c2ant_lps_notify(IN struct btc_coexist *btcoexist, void ex_halbtc8821c2ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c2ant_switchband_notify(IN struct btc_coexist *btcoexist, - IN u8 type); + IN u8 type); void ex_halbtc8821c2ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c2ant_media_status_notify(IN struct btc_coexist *btcoexist, @@ -396,12 +487,17 @@ void ex_halbtc8821c2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c2ant_bt_info_notify(IN struct btc_coexist *btcoexist, IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8821c2ant_wl_fwdbginfo_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8821c2ant_rx_rate_change_notify(IN struct btc_coexist *btcoexist, + IN BOOLEAN is_data_frame, IN u8 btc_rate_id); void ex_halbtc8821c2ant_rf_status_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8821c2ant_halt_notify(IN struct btc_coexist *btcoexist); void ex_halbtc8821c2ant_pnp_notify(IN struct btc_coexist *btcoexist, IN u8 pnp_state); void ex_halbtc8821c2ant_periodical(IN struct btc_coexist *btcoexist); +void ex_halbtc8821c2ant_display_simple_coex_info(IN struct btc_coexist *btcoexist); void ex_halbtc8821c2ant_display_coex_info(IN struct btc_coexist *btcoexist); void ex_halbtc8821c2ant_antenna_detection(IN struct btc_coexist *btcoexist, IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); @@ -416,18 +512,23 @@ void ex_halbtc8821c2ant_display_ant_detection(IN struct btc_coexist *btcoexist); #define ex_halbtc8821c2ant_ips_notify(btcoexist, type) #define ex_halbtc8821c2ant_lps_notify(btcoexist, type) #define ex_halbtc8821c2ant_scan_notify(btcoexist, type) -#define ex_halbtc8821c2ant_switchband_notify(btcoexist,type) +#define ex_halbtc8821c2ant_switchband_notify(btcoexist, type) #define ex_halbtc8821c2ant_connect_notify(btcoexist, type) #define ex_halbtc8821c2ant_media_status_notify(btcoexist, type) #define ex_halbtc8821c2ant_specific_packet_notify(btcoexist, type) #define ex_halbtc8821c2ant_bt_info_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8821c2ant_wl_fwdbginfo_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8821c2ant_rx_rate_change_notify(btcoexist, is_data_frame, btc_rate_id) #define ex_halbtc8821c2ant_rf_status_notify(btcoexist, type) #define ex_halbtc8821c2ant_halt_notify(btcoexist) #define ex_halbtc8821c2ant_pnp_notify(btcoexist, pnp_state) #define ex_halbtc8821c2ant_periodical(btcoexist) +#define ex_halbtc8821c2ant_display_simple_coex_info(btcoexist) #define ex_halbtc8821c2ant_display_coex_info(btcoexist) #define ex_halbtc8821c2ant_display_ant_detection(btcoexist) -#define ex_halbtc8821c2ant_antenna_detection(btcoexist, centFreq, offset, span, seconds) +#define ex_halbtc8821c2ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) #endif #endif + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.c new file mode 100644 index 000000000000..ffa32ed3f789 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.c @@ -0,0 +1,200 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" + +static struct rfe_type_8821c_wifi_only gl_rfe_type_8821c_1ant; +static struct rfe_type_8821c_wifi_only *rfe_type = &gl_rfe_type_8821c_1ant; + + + +VOID hal8821c_wifi_only_switch_antenna( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ) +{ + boolean switch_polatiry_inverse = false; + u8 regval_0xcb7 = 0; + u8 pos_type, ctrl_type; + + if (!rfe_type->ext_ant_switch_exist) + return; + + /* swap control polarity if use different switch control polarity*/ + /* Normal switch polarity for DPDT, 0xcb4[29:28] = 2b'01 => BTG to Main, WLG to Aux, 0xcb4[29:28] = 2b'10 => BTG to Aux, WLG to Main */ + /* Normal switch polarity for SPDT, 0xcb4[29:28] = 2b'01 => Ant to BTG, 0xcb4[29:28] = 2b'10 => Ant to WLG */ + if (rfe_type->ext_ant_switch_ctrl_polarity) + switch_polatiry_inverse = !switch_polatiry_inverse; + + /* swap control polarity if 1-Ant at Aux */ + if (rfe_type->ant_at_main_port == false) + switch_polatiry_inverse = !switch_polatiry_inverse; + + if (is_5g) + pos_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLA; + else + pos_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLG; + + switch (pos_type) { + default: + case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLA: + + break; + case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLG: + if (!rfe_type->wlg_Locate_at_btg) + switch_polatiry_inverse = !switch_polatiry_inverse; + break; + } + + if (pwifionlycfg->haldata_info.ant_div_cfg) + ctrl_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_ANTDIV; + else + ctrl_type = BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BBSW; + + + switch (ctrl_type) { + default: + case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BBSW: + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x4c, 0x01800000, 0x2); + + /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0x000000ff, 0x77); + + regval_0xcb7 = (switch_polatiry_inverse == false ? 0x1 : 0x2); + + /* 0xcb4[29:28] = 2b'01 for no switch_polatiry_inverse, DPDT_SEL_N =1, DPDT_SEL_P =0 */ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0x30000000, regval_0xcb7); + break; + + case BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x4c, 0x01800000, 0x2); + + /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as control pin */ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0x000000ff, 0x88); + + /* no regval_0xcb7 setup required, because antenna switch control value by antenna diversity */ + + break; + + } + +} + + +VOID halbtc8821c_wifi_only_set_rfe_type( + IN struct wifi_only_cfg *pwifionlycfg + ) +{ + + /* the following setup should be got from Efuse in the future */ + rfe_type->rfe_module_type = (pwifionlycfg->haldata_info.rfe_type) & 0x1f; + + rfe_type->ext_ant_switch_ctrl_polarity = 0; + + switch (rfe_type->rfe_module_type) { + case 0: + default: + rfe_type->ext_ant_switch_exist = true; + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; /*2-Ant, DPDT, WLG*/ + rfe_type->wlg_Locate_at_btg = false; + rfe_type->ant_at_main_port = true; + break; + case 1: + rfe_type->ext_ant_switch_exist = true; + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, WLG */ + rfe_type->wlg_Locate_at_btg = false; + rfe_type->ant_at_main_port = true; + break; + case 2: + rfe_type->ext_ant_switch_exist = true; + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_SPDT; /*1-Ant, Main, DPDT or SPDT, BTG */ + rfe_type->wlg_Locate_at_btg = true; + rfe_type->ant_at_main_port = true; + break; + case 3: + rfe_type->ext_ant_switch_exist = true; + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, WLG */ + rfe_type->wlg_Locate_at_btg = false; + rfe_type->ant_at_main_port = false; + break; + case 4: + rfe_type->ext_ant_switch_exist = true; + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; /*1-Ant, Aux, DPDT, BTG */ + rfe_type->wlg_Locate_at_btg = true; + rfe_type->ant_at_main_port = false; + break; + case 5: + rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_NONE; + rfe_type->wlg_Locate_at_btg = false; + rfe_type->ant_at_main_port = true; + break; + case 6: + rfe_type->ext_ant_switch_exist = false; /*2-Ant, no antenna switch, WLG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_NONE; + rfe_type->wlg_Locate_at_btg = false; + rfe_type->ant_at_main_port = true; + break; + case 7: + rfe_type->ext_ant_switch_exist = true; /*2-Ant, DPDT, BTG*/ + rfe_type->ext_ant_switch_type = + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT; + rfe_type->wlg_Locate_at_btg = true; + rfe_type->ant_at_main_port = true; + break; + } + +} + + +VOID +ex_hal8821c_wifi_only_hw_config( + IN struct wifi_only_cfg *pwifionlycfg + ) +{ + halbtc8821c_wifi_only_set_rfe_type(pwifionlycfg); + + /* set gnt_wl, gnt_bt control owner to WL*/ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x70, 0x400000, 0x1); + + /*gnt_wl=1 , gnt_bt=0*/ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1704, 0xffffffff, 0x7700); + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1700, 0xffffffff, 0xc00f0038); +} + +VOID +ex_hal8821c_wifi_only_scannotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ) +{ + hal8821c_wifi_only_switch_antenna(pwifionlycfg, is_5g); +} + +VOID +ex_hal8821c_wifi_only_switchbandnotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ) +{ + hal8821c_wifi_only_switch_antenna(pwifionlycfg, is_5g); +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.h new file mode 100644 index 000000000000..1949b59c0747 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8821cwifionly.h @@ -0,0 +1,84 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __INC_HAL8821CWIFIONLYHWCFG_H +#define __INC_HAL8821CWIFIONLYHWCFG_H + + +struct rfe_type_8821c_wifi_only { + + u8 rfe_module_type; + boolean ext_ant_switch_exist; + u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ + u8 ext_ant_switch_ctrl_polarity; /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ + + boolean ant_at_main_port; + + boolean wlg_Locate_at_btg; /* If true: WLG at BTG, If false: WLG at WLAG */ + + boolean ext_ant_switch_diversity; /* If diversity on */ +}; + +enum bt_8821c_wifi_only_ext_ant_switch_type { + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_DPDT = 0x0, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_USE_SPDT = 0x1, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_NONE = 0x2, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_MAX +}; + +enum bt_8821c_wifi_only_ext_ant_switch_ctrl_type { + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_CTRL_MAX +}; + +enum bt_8821c_wifi_only_ext_ant_switch_pos_type { + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_BT = 0x0, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLG = 0x1, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_WLA = 0x2, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_NOCARE = 0x3, + BT_8821C_WIFI_ONLY_EXT_ANT_SWITCH_TO_MAX +}; + + +VOID +hal8821c_wifi_only_switch_antenna( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ); + +VOID +halbtc8821c_wifi_only_set_rfe_type( + IN struct wifi_only_cfg *pwifionlycfg + ); + + +VOID +ex_hal8821c_wifi_only_hw_config( + IN struct wifi_only_cfg *pwifionlycfg + ); +VOID +ex_hal8821c_wifi_only_scannotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ); +VOID +ex_hal8821c_wifi_only_switchbandnotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b1ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b1ant.c new file mode 100644 index 000000000000..1db3b7364918 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b1ant.c @@ -0,0 +1,7130 @@ +/* ************************************************************ + * Description: + * + * This file is for RTL8822B Co-exist mechanism + * + * History + * 2012/11/15 Cosa first check in. + * + * ************************************************************ */ + +/* ************************************************************ + * include files + * ************************************************************ */ +/*only for rf4ce*/ +#include "mp_precomp.h" + + + +#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + +#if (RTL8822B_SUPPORT == 1) +/* ************************************************************ + * Global variables, these are static variables + * ************************************************************ */ +static u8 *trace_buf = &gl_btc_trace_buf[0]; +static struct coex_dm_8822b_1ant glcoex_dm_8822b_1ant; +static struct coex_dm_8822b_1ant *coex_dm = &glcoex_dm_8822b_1ant; +static struct coex_sta_8822b_1ant glcoex_sta_8822b_1ant; +static struct coex_sta_8822b_1ant *coex_sta = &glcoex_sta_8822b_1ant; +static struct psdscan_sta_8822b_1ant gl_psd_scan_8822b_1ant; +static struct psdscan_sta_8822b_1ant *psd_scan = &gl_psd_scan_8822b_1ant; +static struct rfe_type_8822b_1ant gl_rfe_type_8822b_1ant; +static struct rfe_type_8822b_1ant *rfe_type = &gl_rfe_type_8822b_1ant; + + + +static const char *const glbt_info_src_8822b_1ant[] = { + "BT Info[wifi fw]", + "BT Info[bt rsp]", + "BT Info[bt auto report]", +}; + +static u32 glcoex_ver_date_8822b_1ant = 20170707; +static u32 glcoex_ver_8822b_1ant = 0x46; +static u32 glcoex_ver_btdesired_8822b_1ant = 0x42; + + +/* ************************************************************ + * local function proto type if needed + * ************************************************************ + * ************************************************************ + * local function start with halbtc8822b1ant_ + * ************************************************************ */ +#if 0 +static +u8 halbtc8822b1ant_bt_rssi_state(IN struct btc_coexist *btcoexist, + u8 level_num, u8 rssi_thresh, u8 rssi_thresh1) +{ + s32 bt_rssi = 0; + u8 bt_rssi_state = coex_sta->pre_bt_rssi_state; + + bt_rssi = coex_sta->bt_rssi; + + if (level_num == 2) { + if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Rssi thresh error!!\n"); + BTC_TRACE(trace_buf); + return coex_sta->pre_bt_rssi_state; + } + + if ((coex_sta->pre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_MEDIUM) || + (coex_sta->pre_bt_rssi_state == + BTC_RSSI_STATE_STAY_MEDIUM)) { + if (bt_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (bt_rssi < rssi_thresh1) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + coex_sta->pre_bt_rssi_state = bt_rssi_state; + + return bt_rssi_state; +} +#endif + +static +u8 halbtc8822b1ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, + IN u8 index, IN u8 level_num, IN u8 rssi_thresh, IN u8 rssi_thresh1) +{ + s32 wifi_rssi = 0; + u8 wifi_rssi_state = coex_sta->pre_wifi_rssi_state[index]; + + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + + if (level_num == 2) { + if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) + || + (coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi RSSI thresh error!!\n"); + BTC_TRACE(trace_buf); + return coex_sta->pre_wifi_rssi_state[index]; + } + + if ((coex_sta->pre_wifi_rssi_state[index] == BTC_RSSI_STATE_LOW) + || + (coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_MEDIUM) || + (coex_sta->pre_wifi_rssi_state[index] == + BTC_RSSI_STATE_STAY_MEDIUM)) { + if (wifi_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (wifi_rssi < rssi_thresh1) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + coex_sta->pre_wifi_rssi_state[index] = wifi_rssi_state; + + return wifi_rssi_state; +} + +static +void halbtc8822b1ant_update_ra_mask(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 dis_rate_mask) +{ + coex_dm->cur_ra_mask = dis_rate_mask; + + if (force_exec || (coex_dm->pre_ra_mask != coex_dm->cur_ra_mask)) + btcoexist->btc_set(btcoexist, BTC_SET_ACT_UPDATE_RAMASK, + &coex_dm->cur_ra_mask); + coex_dm->pre_ra_mask = coex_dm->cur_ra_mask; +} + +static +void halbtc8822b1ant_auto_rate_fallback_retry(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + boolean wifi_under_b_mode = FALSE; + + coex_dm->cur_arfr_type = type; + + if (force_exec || (coex_dm->pre_arfr_type != coex_dm->cur_arfr_type)) { + switch (coex_dm->cur_arfr_type) { + case 0: /* normal mode */ + btcoexist->btc_write_4byte(btcoexist, 0x430, + coex_dm->backup_arfr_cnt1); + btcoexist->btc_write_4byte(btcoexist, 0x434, + coex_dm->backup_arfr_cnt2); + break; + case 1: + btcoexist->btc_get(btcoexist, + BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + if (wifi_under_b_mode) { + btcoexist->btc_write_4byte(btcoexist, + 0x430, 0x0); + btcoexist->btc_write_4byte(btcoexist, + 0x434, 0x01010101); + } else { + btcoexist->btc_write_4byte(btcoexist, + 0x430, 0x0); + btcoexist->btc_write_4byte(btcoexist, + 0x434, 0x04030201); + } + break; + default: + break; + } + } + + coex_dm->pre_arfr_type = coex_dm->cur_arfr_type; +} + +static +void halbtc8822b1ant_retry_limit(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + coex_dm->cur_retry_limit_type = type; + + if (force_exec || + (coex_dm->pre_retry_limit_type != + coex_dm->cur_retry_limit_type)) { + switch (coex_dm->cur_retry_limit_type) { + case 0: /* normal mode */ + btcoexist->btc_write_2byte(btcoexist, 0x42a, + coex_dm->backup_retry_limit); + break; + case 1: /* retry limit=8 */ + btcoexist->btc_write_2byte(btcoexist, 0x42a, + 0x0808); + break; + default: + break; + } + } + + coex_dm->pre_retry_limit_type = coex_dm->cur_retry_limit_type; +} + +static +void halbtc8822b1ant_ampdu_max_time(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + coex_dm->cur_ampdu_time_type = type; + + if (force_exec || + (coex_dm->pre_ampdu_time_type != coex_dm->cur_ampdu_time_type)) { + switch (coex_dm->cur_ampdu_time_type) { + case 0: /* normal mode */ + btcoexist->btc_write_1byte(btcoexist, 0x456, + coex_dm->backup_ampdu_max_time); + break; + case 1: /* AMPDU timw = 0x38 * 32us */ + btcoexist->btc_write_1byte(btcoexist, 0x456, + 0x38); + break; + default: + break; + } + } + + coex_dm->pre_ampdu_time_type = coex_dm->cur_ampdu_time_type; +} + +static +void halbtc8822b1ant_limited_tx(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 ra_mask_type, IN u8 arfr_type, + IN u8 retry_limit_type, IN u8 ampdu_time_type) +{ + switch (ra_mask_type) { + case 0: /* normal mode */ + halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, + 0x0); + break; + case 1: /* disable cck 1/2 */ + halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, + 0x00000003); + break; + case 2: /* disable cck 1/2/5.5, ofdm 6/9/12/18/24, mcs 0/1/2/3/4 */ + halbtc8822b1ant_update_ra_mask(btcoexist, force_exec, + 0x0001f1f7); + break; + default: + break; + } + + halbtc8822b1ant_auto_rate_fallback_retry(btcoexist, force_exec, + arfr_type); + halbtc8822b1ant_retry_limit(btcoexist, force_exec, retry_limit_type); + halbtc8822b1ant_ampdu_max_time(btcoexist, force_exec, ampdu_time_type); +} + +/* + * rx agg size setting : + * 1: TRUE / don't care / don't care + * max: FALSE / FALSE / don't care + * 7: FALSE / TRUE / 7 + */ + +static +void halbtc8822b1ant_limited_rx(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean rej_ap_agg_pkt, + IN boolean bt_ctrl_agg_buf_size, IN u8 agg_buf_size) +{ + boolean reject_rx_agg = rej_ap_agg_pkt; + boolean bt_ctrl_rx_agg_size = bt_ctrl_agg_buf_size; + u8 rx_agg_size = agg_buf_size; + + /* ============================================ */ + /* Rx Aggregation related setting */ + /* ============================================ */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_TO_REJ_AP_AGG_PKT, + &reject_rx_agg); + /* decide BT control aggregation buf size or not */ + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_CTRL_AGG_SIZE, + &bt_ctrl_rx_agg_size); + /* aggregation buf size, only work when BT control Rx aggregation size*/ + btcoexist->btc_set(btcoexist, BTC_SET_U1_AGG_BUF_SIZE, &rx_agg_size); + /* real update aggregation setting */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_AGGREGATE_CTRL, NULL); + + +} + +static +void halbtc8822b1ant_query_bt_info(IN struct btc_coexist *btcoexist) +{ + u8 h2c_parameter[1] = {0}; + + if (coex_sta->bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No query BT info because BT is disabled!\n"); + BTC_TRACE(trace_buf); + return; + } + + + h2c_parameter[0] |= BIT(0); /* trigger */ + + btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WL query BT info!!\n"); + BTC_TRACE(trace_buf); +} + + + +static +void halbtc8822b1ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) +{ + u32 reg_hp_txrx, reg_lp_txrx, u32tmp; + u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; + static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_autoslot_hang = 0; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + +#if 0 + /* to avoid 0x76e[3] = 1 (WLAN_Act control by PTA) during IPS */ + if (!(btcoexist->btc_read_1byte(btcoexist, 0x76e) & 0x8)) +#endif + +#if 0 + if (coex_sta->under_ips) { + /* coex_sta->high_priority_tx = 65535; */ + /* coex_sta->high_priority_rx = 65535; */ + /* coex_sta->low_priority_tx = 65535; */ + /* coex_sta->low_priority_rx = 65535; */ + /* return; */ + } +#endif + + reg_hp_txrx = 0x770; + reg_lp_txrx = 0x774; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); + reg_hp_tx = u32tmp & MASKLWORD; + reg_hp_rx = (u32tmp & MASKHWORD) >> 16; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); + reg_lp_tx = u32tmp & MASKLWORD; + reg_lp_rx = (u32tmp & MASKHWORD) >> 16; + + coex_sta->high_priority_tx = reg_hp_tx; + coex_sta->high_priority_rx = reg_hp_rx; + coex_sta->low_priority_tx = reg_lp_tx; + coex_sta->low_priority_rx = reg_lp_rx; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Hi-Pri Rx/Tx: %d/%d, Lo-Pri Rx/Tx: %d/%d\n", + reg_hp_rx, reg_hp_tx, reg_lp_rx, reg_lp_tx); + BTC_TRACE(trace_buf); + + /* reset counter */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); + + if ((coex_sta->low_priority_tx > 1150) && + (!coex_sta->c2h_bt_inquiry_page)) + coex_sta->pop_event_cnt++; + + if ((coex_sta->low_priority_rx >= 1150) && + (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) + && (!coex_sta->under_ips) && + (!coex_sta->c2h_bt_inquiry_page) && + (coex_sta->bt_link_exist)) { + if (cnt_slave >= 3) { + bt_link_info->slave_role = TRUE; + cnt_slave = 3; + } else { + cnt_slave++; + } + } else { + if (cnt_slave == 0) { + bt_link_info->slave_role = FALSE; + cnt_slave = 0; + } else { + cnt_slave--; + } + + } + + if (coex_sta->is_tdma_btautoslot) { + if ((coex_sta->low_priority_tx >= 1300) && + (coex_sta->low_priority_rx <= 150)) { + if (cnt_autoslot_hang >= 2) { + coex_sta->is_tdma_btautoslot_hang = TRUE; + cnt_autoslot_hang = 2; + } else { + cnt_autoslot_hang++; + } + } else { + if (cnt_autoslot_hang == 0) { + coex_sta->is_tdma_btautoslot_hang = FALSE; + cnt_autoslot_hang = 0; + } else { + cnt_autoslot_hang--; + } + } + } + + if (bt_link_info->hid_only) { + if (coex_sta->low_priority_rx > 50) + coex_sta->is_hid_low_pri_tx_overhead = true; + else + coex_sta->is_hid_low_pri_tx_overhead = false; + } + + if ((coex_sta->high_priority_tx == 0) && + (coex_sta->high_priority_rx == 0) && + (coex_sta->low_priority_tx == 0) && + (coex_sta->low_priority_rx == 0)) { + num_of_bt_counter_chk++; + + if (num_of_bt_counter_chk >= 3) { + halbtc8822b1ant_query_bt_info( + btcoexist); + num_of_bt_counter_chk = 0; + } + } + +} + + +static +void halbtc8822b1ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ +#if 1 + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE, wifi_under_b_mode = FALSE, + wifi_scan = FALSE; + static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, + wl_noisy_count1 = 3, wl_noisy_count2 = 0; + u32 total_cnt, cck_cnt; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_VHT); + + cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + + if (cck_cnt > 250) { + if (wl_noisy_count2 < 3) + wl_noisy_count2++; + + if (wl_noisy_count2 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count1 = 0; + } + + } else if (cck_cnt < 50) { + if (wl_noisy_count0 < 3) + wl_noisy_count0++; + + if (wl_noisy_count0 == 3) { + wl_noisy_count1 = 0; + wl_noisy_count2 = 0; + } + + } else { + if (wl_noisy_count1 < 3) + wl_noisy_count1++; + + if (wl_noisy_count1 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count2 = 0; + } + } + + if (wl_noisy_count2 == 3) + coex_sta->wl_noisy_level = 2; + else if (wl_noisy_count1 == 3) + coex_sta->wl_noisy_level = 1; + else + coex_sta->wl_noisy_level = 0; + + if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { + total_cnt = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + coex_sta->crc_ok_11n_vht; + + if ((coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY) + || + (coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_SCO_BUSY)) { + if (coex_sta->crc_ok_cck > (total_cnt - + coex_sta->crc_ok_cck)) { + if (cck_lock_counter < 3) + cck_lock_counter++; + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + + if (!coex_sta->pre_ccklock) { + + if (cck_lock_counter >= 3) + coex_sta->cck_lock = TRUE; + else + coex_sta->cck_lock = FALSE; + } else { + if (cck_lock_counter == 0) + coex_sta->cck_lock = FALSE; + else + coex_sta->cck_lock = TRUE; + } + + if (coex_sta->cck_lock) + coex_sta->cck_ever_lock = TRUE; + + coex_sta->pre_ccklock = coex_sta->cck_lock; + +#endif +} + + +static +boolean halbtc8822b1ant_is_wifi_status_changed(IN struct btc_coexist *btcoexist) +{ + static boolean pre_wifi_busy = FALSE, pre_under_4way = FALSE, + pre_bt_hs_on = FALSE, pre_rf4ce_enabled = FALSE, pre_bt_off = FALSE, + pre_bt_slave = FALSE, pre_hid_low_pri_tx_overhead = FALSE, + pre_wifi_under_lps = FALSE, pre_bt_setup_link = FALSE; + static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; + boolean wifi_busy = FALSE, under_4way = FALSE, bt_hs_on = FALSE, rf4ce_enabled = FALSE; + boolean wifi_connected = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (coex_sta->bt_disabled != pre_bt_off) { + pre_bt_off = coex_sta->bt_disabled; + + if (coex_sta->bt_disabled) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is enabled !!\n"); + + BTC_TRACE(trace_buf); + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + return TRUE; + } + btcoexist->btc_get(btcoexist, BTC_GET_BL_RF4CE_CONNECTED, &rf4ce_enabled); + + if (rf4ce_enabled != pre_rf4ce_enabled) { + pre_rf4ce_enabled = rf4ce_enabled; + + if (rf4ce_enabled) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rf4ce is enabled !!\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], rf4ce is disabled !!\n"); + + BTC_TRACE(trace_buf); + + + return TRUE; + } + + if (wifi_connected) { + if (wifi_busy != pre_wifi_busy) { + pre_wifi_busy = wifi_busy; + return TRUE; + } + if (under_4way != pre_under_4way) { + pre_under_4way = under_4way; + return TRUE; + } + if (bt_hs_on != pre_bt_hs_on) { + pre_bt_hs_on = bt_hs_on; + return TRUE; + } + if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { + pre_wl_noisy_level = coex_sta->wl_noisy_level; + return TRUE; + } + if (coex_sta->under_lps != pre_wifi_under_lps) { + pre_wifi_under_lps = coex_sta->under_lps; + if (coex_sta->under_lps) + return TRUE; + } + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->hid_busy_num != pre_hid_busy_num) { + pre_hid_busy_num = coex_sta->hid_busy_num; + return TRUE; + } + + if (bt_link_info->slave_role != pre_bt_slave) { + pre_bt_slave = bt_link_info->slave_role; + return TRUE; + } + + if (pre_hid_low_pri_tx_overhead != coex_sta->is_hid_low_pri_tx_overhead) { + pre_hid_low_pri_tx_overhead = coex_sta->is_hid_low_pri_tx_overhead; + return TRUE; + } + + if (pre_bt_setup_link != coex_sta->is_setupLink) { + pre_bt_setup_link = coex_sta->is_setupLink; + return TRUE; + } + } + + return FALSE; +} + + + +static +void halbtc8822b1ant_update_bt_link_info(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + boolean bt_busy = FALSE; + + + coex_sta->num_of_profile = 0; + + /* set link exist status */ + if (!(coex_sta->bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { + coex_sta->bt_link_exist = FALSE; + coex_sta->pan_exist = FALSE; + coex_sta->a2dp_exist = FALSE; + coex_sta->hid_exist = FALSE; + coex_sta->sco_exist = FALSE; + } else { /* connection exists */ + coex_sta->bt_link_exist = TRUE; + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_FTP) { + coex_sta->pan_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->pan_exist = FALSE; + } + + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_A2DP) { + coex_sta->a2dp_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->a2dp_exist = FALSE; + } + + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_HID) { + coex_sta->hid_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->hid_exist = FALSE; + } + + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) { + coex_sta->sco_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->sco_exist = FALSE; + } + + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + bt_link_info->bt_link_exist = coex_sta->bt_link_exist; + bt_link_info->sco_exist = coex_sta->sco_exist; + bt_link_info->a2dp_exist = coex_sta->a2dp_exist; + bt_link_info->pan_exist = coex_sta->pan_exist; + bt_link_info->hid_exist = coex_sta->hid_exist; + bt_link_info->acl_busy = coex_sta->acl_busy; + + /* work around for HS mode. */ + if (bt_hs_on) { + bt_link_info->pan_exist = TRUE; + bt_link_info->bt_link_exist = TRUE; + } + + /* check if Sco only */ + if (bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->sco_only = TRUE; + else + bt_link_info->sco_only = FALSE; + + /* check if A2dp only */ + if (!bt_link_info->sco_exist && + bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->a2dp_only = TRUE; + else + bt_link_info->a2dp_only = FALSE; + + /* check if Pan only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->pan_only = TRUE; + else + bt_link_info->pan_only = FALSE; + + /* check if Hid only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + bt_link_info->hid_exist) + bt_link_info->hid_only = TRUE; + else + bt_link_info->hid_only = FALSE; + + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_INQ_PAGE) { + coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_INQ_PAGE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); + } else if (!(coex_sta->bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { + coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); + } else if (coex_sta->bt_info == BT_INFO_8822B_1ANT_B_CONNECTION) { + /* connection exists but no busy */ + coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); + } else if (((coex_sta->bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_SCO_BUSY)) && + (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_ACL_BUSY)) { + coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); + } else if ((coex_sta->bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_SCO_BUSY)) { + coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); + } else if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_ACL_BUSY) { + coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_ACL_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); + } else { + coex_dm->bt_status = BT_8822B_1ANT_BT_STATUS_MAX; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); + } + + BTC_TRACE(trace_buf); + + if ((coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_SCO_BUSY) || + (coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY)) + bt_busy = TRUE; + else + bt_busy = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); +} + + +static +void halbtc8822b1ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_parameter[3] = {0}; + u32 wifi_bw; + u8 wifi_central_chnl; + + /* only 2.4G we need to inform bt the chnl mask */ + btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, + &wifi_central_chnl); + if ((BTC_MEDIA_CONNECT == type) && + (wifi_central_chnl <= 14)) { + + /* enable BT AFH skip WL channel for 8822b + * because BT Rx LO interference + */ + h2c_parameter[0] = 0x1; + h2c_parameter[1] = wifi_central_chnl; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + if (BTC_WIFI_BW_HT40 == wifi_bw) + h2c_parameter[2] = 0x30; + else + h2c_parameter[2] = 0x20; + } + + coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; + coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; + coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; + + btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); + +} + +static +u8 halbtc8822b1ant_action_algorithm(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + u8 algorithm = BT_8822B_1ANT_COEX_ALGO_UNDEFINED; + u8 num_of_diff_profile = 0; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + if (!bt_link_info->bt_link_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No BT link exists!!!\n"); + BTC_TRACE(trace_buf); + return algorithm; + } + + if (bt_link_info->sco_exist) + num_of_diff_profile++; + if (bt_link_info->hid_exist) + num_of_diff_profile++; + if (bt_link_info->pan_exist) + num_of_diff_profile++; + if (bt_link_info->a2dp_exist) + num_of_diff_profile++; + + if (num_of_diff_profile == 1) { + if (bt_link_info->sco_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; + } else { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_HID; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = A2DP only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_A2DP; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = PAN(HS) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = PAN(EDR) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANEDR; + } + } + } + } else if (num_of_diff_profile == 2) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_HID; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + A2DP ==> SCO\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + A2DP\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_HID_A2DP; + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_HID_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP; + } + } + } + } else if (num_of_diff_profile == 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + A2DP ==> HID\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_HID; + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_HID_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_1ANT_COEX_ALGO_SCO; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + A2DP + PAN(EDR) ==> HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_HID_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = HID + A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR; + } + } + } + } else if (num_of_diff_profile >= 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Error!!! BT Profile = SCO + HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Profile = SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_1ANT_COEX_ALGO_PANEDR_HID; + } + } + } + } + + return algorithm; +} + + + + + + + +static +void halbtc8822b1ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, + IN u8 dac_swing_lvl) +{ + u8 h2c_parameter[1] = {0}; + u32 RTL97F_8822B = 0; + + if (RTL97F_8822B) + return; + + /* There are several type of dacswing */ + /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ + h2c_parameter[0] = dac_swing_lvl; + + btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); +} + + +static +void halbtc8822b1ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 fw_dac_swing_lvl) +{ + u32 RTL97F_8822B = 0; + + if (RTL97F_8822B) + return; + + coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; + + if (!force_exec) { + if (coex_dm->pre_fw_dac_swing_lvl == + coex_dm->cur_fw_dac_swing_lvl) + return; + } + + halbtc8822b1ant_set_fw_dac_swing_level(btcoexist, + coex_dm->cur_fw_dac_swing_lvl); + + coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; +} + +static +void halbtc8822b1ant_low_penalty_ra(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean low_penalty_ra) +{ +#if 1 + coex_dm->cur_low_penalty_ra = low_penalty_ra; + + if (!force_exec) { + if (coex_dm->pre_low_penalty_ra == + coex_dm->cur_low_penalty_ra) + return; + } + + if (low_penalty_ra) + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 25); + else + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); + + coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; + +#endif +} + +static +void halbtc8822b1ant_write_score_board( + IN struct btc_coexist *btcoexist, + IN u16 bitpos, + IN boolean state +) +{ + + static u16 originalval = 0x8002; + + if (state) + originalval = originalval | bitpos; + else + originalval = originalval & (~bitpos); + + btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); +} + +static +void halbtc8822b1ant_read_score_board( + IN struct btc_coexist *btcoexist, + IN u16 *score_board_val +) +{ + + *score_board_val = (btcoexist->btc_read_2byte(btcoexist, + 0xaa)) & 0x7fff; +} + +static +void halbtc8822b1ant_post_state_to_bt( + IN struct btc_coexist *btcoexist, + IN u16 type, + IN boolean state +) +{ + + halbtc8822b1ant_write_score_board(btcoexist, (u16) type, state); + +} + + +static +void halbtc8822b1ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) +{ + static u32 bt_disable_cnt = 0; + boolean bt_active = TRUE, bt_disabled = FALSE, + wifi_under_5g = FALSE; + u16 u16tmp; + + /* This function check if bt is disabled */ +#if 0 + if (coex_sta->high_priority_tx == 0 && + coex_sta->high_priority_rx == 0 && + coex_sta->low_priority_tx == 0 && + coex_sta->low_priority_rx == 0) + bt_active = FALSE; + if (coex_sta->high_priority_tx == 0xffff && + coex_sta->high_priority_rx == 0xffff && + coex_sta->low_priority_tx == 0xffff && + coex_sta->low_priority_rx == 0xffff) + bt_active = FALSE; + + +#else + + /* Read BT on/off status from scoreboard[1], + * enable this only if BT patch support this feature + */ + halbtc8822b1ant_read_score_board(btcoexist, &u16tmp); + + bt_active = u16tmp & BIT(1); + + +#endif + + if (bt_active) { + bt_disable_cnt = 0; + bt_disabled = FALSE; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + } else { + + bt_disable_cnt++; + if (bt_disable_cnt >= 2) { + bt_disabled = TRUE; + bt_disable_cnt = 2; + } + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + } + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, + &wifi_under_5g); + + if ((wifi_under_5g) || (bt_disabled)) + halbtc8822b1ant_low_penalty_ra(btcoexist, + NORMAL_EXEC, FALSE); + else + halbtc8822b1ant_low_penalty_ra(btcoexist, + NORMAL_EXEC, TRUE); + + + if (coex_sta->bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->bt_disabled ? "disabled" : + "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + coex_sta->bt_disabled = bt_disabled; + } + +} + + + +static +void halbtc8822b1ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, + boolean isenable) +{ +#if BT_8822B_1ANT_COEX_DBG + static u8 bitVal[5] = {0, 0, 0, 0, 0}; + static boolean state = FALSE; + + if (state == isenable) + return; + + state = isenable; + + if (isenable) { + + /* enable GNT_WL, GNT_BT to GPIO for debug */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); + + /* store original value */ + bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, + 0x66) & BIT(4)) >> 4; /*0x66[4] */ + bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, + 0x67) & BIT(0)); /*0x66[8] */ + bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, + 0x42) & BIT(3)) >> 3; /*0x40[19] */ + bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, + 0x65) & BIT(7)) >> 7; /*0x64[15] */ + bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, + 0x72) & BIT(2)) >> 2; /*0x70[18] */ + + /* switch GPIO Mux */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + 0x0); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + 0x0); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + 0x0); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + 0x0); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + 0x0); /*0x70[18] = 0 */ + + + } else { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); + + /* Restore original value */ + /* switch GPIO Mux */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + bitVal[0]); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + bitVal[1]); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + bitVal[2]); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + bitVal[3]); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + bitVal[4]); /*0x70[18] = 0 */ + } +#endif +} + + + +static +u32 halbtc8822b1ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, + IN u16 reg_addr) +{ + u32 delay_count = 0; + + /* wait for ready bit before access 0x1700 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else { + break; + } + } + + btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); + + return btcoexist->btc_read_4byte(btcoexist, + 0x1708); /* get read data */ +} + + +static +void halbtc8822b1ant_ltecoex_indirect_write_reg(IN struct btc_coexist + *btcoexist, + IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) +{ + u32 val, i = 0, bitpos = 0, delay_count = 0; + + + if (bit_mask == 0x0) + return; + + if (bit_mask == 0xffffffff) { + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else { + break; + } + } + + btcoexist->btc_write_4byte(btcoexist, 0x1704, + reg_value); /* put write data */ + + btcoexist->btc_write_4byte(btcoexist, 0x1700, + 0xc00F0000 | reg_addr); + } else { + for (i = 0; i <= 31; i++) { + if (((bit_mask >> i) & 0x1) == 0x1) { + bitpos = i; + break; + } + } + + /* read back register value before write */ + val = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + reg_addr); + val = (val & (~bit_mask)) | (reg_value << bitpos); + + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else { + break; + } + } + + btcoexist->btc_write_4byte(btcoexist, 0x1704, + val); /* put write data */ + + btcoexist->btc_write_4byte(btcoexist, 0x1700, + 0xc00F0000 | reg_addr); + + } + +} + + +static +void halbtc8822b1ant_ltecoex_enable(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + u8 val; + + val = (enable) ? 1 : 0; + /* 0x38[7] */ + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, val); + +} + + + +static +void halbtc8822b1ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, + IN boolean wifi_control) +{ + u8 val; + + val = (wifi_control) ? 1 : 0; + /* 0x70[26] */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, val); + +} + + +static +void halbtc8822b1ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, + IN u8 control_block, IN boolean sw_control, IN u8 state) +{ + u32 val = 0, bit_mask; + + state = state & 0x1; + /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) + *0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) + *0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) + */ + val = (sw_control) ? ((state << 1) | 0x1) : 0; + + switch (control_block) { + case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: + default: + bit_mask = 0xc000; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[15:14] */ + bit_mask = 0x0c00; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[11:10] */ + break; + case BT_8822B_1ANT_GNT_BLOCK_RFC: + bit_mask = 0xc000; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[15:14] */ + break; + case BT_8822B_1ANT_GNT_BLOCK_BB: + bit_mask = 0x0c00; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[11:10] */ + break; + + } + +} + + +static +void halbtc8822b1ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, + IN u8 control_block, IN boolean sw_control, IN u8 state) +{ + u32 val = 0, bit_mask; + /*LTE indirect 0x38=0xccxx (sw : gnt_wl=1,sw gnt_bt=1) + *0x38=0xddxx (sw : gnt_bt=1 , sw gnt_wl=0) + *0x38=0x55xx(hw pta :gnt_wl /gnt_bt ) + */ + + state = state & 0x1; + val = (sw_control) ? ((state << 1) | 0x1) : 0; + + switch (control_block) { + case BT_8822B_1ANT_GNT_BLOCK_RFC_BB: + default: + bit_mask = 0x3000; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[13:12] */ + bit_mask = 0x0300; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[9:8] */ + break; + case BT_8822B_1ANT_GNT_BLOCK_RFC: + bit_mask = 0x3000; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[13:12] */ + break; + case BT_8822B_1ANT_GNT_BLOCK_BB: + bit_mask = 0x0300; + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[9:8] */ + break; + + } + +} + + +static +void halbtc8822b1ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, + IN u8 table_type, IN u16 table_content) +{ + u16 reg_addr = 0x0000; + + switch (table_type) { + case BT_8822B_1ANT_CTT_WL_VS_LTE: + reg_addr = 0xa0; + break; + case BT_8822B_1ANT_CTT_BT_VS_LTE: + reg_addr = 0xa4; + break; + } + + if (reg_addr != 0x0000) + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, + 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ + + +} + + + +#if 0 +static +void halbtc8822b1ant_ltcoex_set_break_table(IN struct btc_coexist *btcoexist, + IN u8 table_type, IN u8 table_content) +{ + u16 reg_addr = 0x0000; + + switch (table_type) { + case BT_8822B_1ANT_LBTT_WL_BREAK_LTE: + reg_addr = 0xa8; + break; + case BT_8822B_1ANT_LBTT_BT_BREAK_LTE: + reg_addr = 0xac; + break; + case BT_8822B_1ANT_LBTT_LTE_BREAK_WL: + reg_addr = 0xb0; + break; + case BT_8822B_1ANT_LBTT_LTE_BREAK_BT: + reg_addr = 0xb4; + break; + } + + if (reg_addr != 0x0000) + halbtc8822b1ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, + 0xff, table_content); /* 0xa8[15:0] or 0xb4[15:0] */ + + +} +#endif + + + + +static +void halbtc8822b1ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 interval, + IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, + IN u8 val0x6c4_b3) +{ + static u8 pre_h2c_parameter[6] = {0}; + u8 cur_h2c_parameter[6] = {0}; + u8 i, match_cnt = 0; + + cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ + + cur_h2c_parameter[1] = interval; + cur_h2c_parameter[2] = val0x6c4_b0; + cur_h2c_parameter[3] = val0x6c4_b1; + cur_h2c_parameter[4] = val0x6c4_b2; + cur_h2c_parameter[5] = val0x6c4_b3; + + if (!force_exec) { + for (i = 1; i <= 5; i++) { + if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) + break; + + match_cnt++; + } + + if (match_cnt == 5) + return; + } + + for (i = 1; i <= 5; i++) + pre_h2c_parameter[i] = cur_h2c_parameter[i]; + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); +} + + + +static +void halbtc8822b1ant_set_coex_table(IN struct btc_coexist *btcoexist, + IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) +{ + btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); + + btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); + + btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); + + btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); +} + + +static +void halbtc8822b1ant_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, + IN u32 val0x6c8, IN u8 val0x6cc) +{ + coex_dm->cur_val0x6c0 = val0x6c0; + coex_dm->cur_val0x6c4 = val0x6c4; + coex_dm->cur_val0x6c8 = val0x6c8; + coex_dm->cur_val0x6cc = val0x6cc; + + + + if (!force_exec) { + if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && + (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && + (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && + (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) + return; + } + halbtc8822b1ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, + val0x6cc); + + coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; + coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; + coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; + coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; +} + + +static +void halbtc8822b1ant_coex_table_with_type(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + u32 break_table; + u8 select_table; + + + + coex_sta->coex_table_type = type; + + if (coex_sta->concurrent_rx_mode_on) { + break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ + select_table = 0x3; /* set Tx response = Hi-Pri + * (ex: Transmitting ACK,BA,CTS) + */ + } else { + break_table = 0xffffff; + select_table = 0x3; + } + + switch (type) { + case 0: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555555, break_table, + select_table); + break; + case 1: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, break_table, + select_table); + break; + case 2: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xaa5a5a5a, 0xaa5a5a5a, break_table, + select_table); + break; + case 3: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0xaa5a5a5a, break_table, + select_table); + break; + case 4: + halbtc8822b1ant_coex_table(btcoexist, + force_exec, 0xaa555555, 0xaa5a5a5a, + break_table, select_table); + break; + case 5: + halbtc8822b1ant_coex_table(btcoexist, + force_exec, 0x5a5a5a5a, 0x5a5a5a5a, + break_table, select_table); + break; + case 6: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0xaaaaaaaa, break_table, + select_table); + break; + case 7: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xaaaaaaaa, 0xaaaaaaaa, break_table, + select_table); + break; + case 8: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xffffffff, 0xffffffff, break_table, + select_table); + break; + case 9: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x5a5a5555, 0xaaaa5a5a, break_table, + select_table); + break; + case 10: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xaaaa5aaa, 0xaaaa5aaa, break_table, + select_table); + break; + case 11: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xaaaaa5aa, 0xaaaaaaaa, break_table, + select_table); + break; + case 12: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xaaaaa5aa, 0xaaaaa5aa, break_table, + select_table); + break; + case 13: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0xaaaa5a5a, break_table, + select_table); + break; + case 14: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x5a5a555a, 0xaaaa5a5a, break_table, + select_table); + break; + case 15: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0xaaaa55aa, break_table, + select_table); + break; + case 16: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x5a5a555a, 0x5a5a555a, break_table, + select_table); + break; + case 17: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xaaaa55aa, 0xaaaa55aa, break_table, + select_table); + break; + case 18: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5aaa5a5a, break_table, + select_table); + break; + case 19: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaaaa5aaa, break_table, + select_table); + break; + case 20: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0xaaaa5aaa, break_table, + select_table); + break; + case 21: + halbtc8822b1ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555a5a, break_table, + select_table); + break; + default: + break; + } +} + + +static +void halbtc8822b1ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + + + u8 h2c_parameter[1] = {0}; + + if (enable) + h2c_parameter[0] |= BIT(0); /* function enable */ + + btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); +} + + +static +void halbtc8822b1ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable) +{ + + coex_dm->cur_ignore_wlan_act = enable; + + if (!force_exec) { + if (coex_dm->pre_ignore_wlan_act == + coex_dm->cur_ignore_wlan_act) { + + coex_dm->pre_ignore_wlan_act = + coex_dm->cur_ignore_wlan_act; + return; + } + } + + halbtc8822b1ant_set_fw_ignore_wlan_act(btcoexist, enable); + + coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; +} + + +static +void halbtc8822b1ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, + IN u8 lps_val, IN u8 rpwm_val) +{ + u8 lps = lps_val; + u8 rpwm = rpwm_val; + + btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); + btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); +} + + +static +void halbtc8822b1ant_lps_rpwm(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) +{ + coex_dm->cur_lps = lps_val; + coex_dm->cur_rpwm = rpwm_val; + + if (!force_exec) { + if ((coex_dm->pre_lps == coex_dm->cur_lps) && + (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) + return; + } + halbtc8822b1ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); + + coex_dm->pre_lps = coex_dm->cur_lps; + coex_dm->pre_rpwm = coex_dm->cur_rpwm; +} + + + +static +void halbtc8822b1ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +{ + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0x8, 0, 0, 0, 0}; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + /* will leave LPS state, turn off psTdma first */ + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } + } else { /* NO PS state */ + if (new_ps_state) { + /* will enter LPS state, turn off psTdma first */ + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } else { + /* keep state under NO PS state, do nothing. */ + } + } +} + + + + +static +boolean halbtc8822b1ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = FALSE, result = TRUE; + + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + /* recover to original 32k low power setting */ + coex_sta->force_lps_ctrl = FALSE; + low_pwr_disable = FALSE; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + NULL); + break; + case BTC_PS_LPS_ON: + + coex_sta->force_lps_ctrl = TRUE; + halbtc8822b1ant_ps_tdma_check_for_power_save_state( + btcoexist, TRUE); + halbtc8822b1ant_lps_rpwm(btcoexist, NORMAL_EXEC, + lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = TRUE; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + /* power save must executed before psTdma. */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, + NULL); + + break; + case BTC_PS_LPS_OFF: + + coex_sta->force_lps_ctrl = TRUE; + halbtc8822b1ant_ps_tdma_check_for_power_save_state( + btcoexist, FALSE); + result = btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + + break; + default: + break; + } + + return result; +} + + + + +static +void halbtc8822b1ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, + IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) +{ + u8 h2c_parameter[5] = {0}; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = FALSE, result = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if (byte5 & BIT(2)) + coex_sta->is_tdma_btautoslot = TRUE; + else + coex_sta->is_tdma_btautoslot = FALSE; + + /* release bt-auto slot for auto-slot hang is detected!! */ + if (coex_sta->is_tdma_btautoslot) + if ((coex_sta->is_tdma_btautoslot_hang) || + (bt_link_info->slave_role)) + byte5 = byte5 & 0xfb; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b1ant_set_fw_pstdma == FW for 1Ant AP mode\n"); + BTC_TRACE(trace_buf); + + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + halbtc8822b1ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, + 0x0); + + } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b1ant_set_fw_pstdma == Force LPS (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); + if (!halbtc8822b1ant_power_save_state(btcoexist, BTC_PS_LPS_OFF, 0x50, 0x4)) + result = TRUE; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b1ant_set_fw_pstdma == native power save (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); + halbtc8822b1ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, + 0x0); + } + + + coex_sta->is_set_ps_state_fail = result; + + if (!coex_sta->is_set_ps_state_fail) { + h2c_parameter[0] = real_byte1; + h2c_parameter[1] = byte2; + h2c_parameter[2] = byte3; + h2c_parameter[3] = byte4; + h2c_parameter[4] = real_byte5; + + coex_dm->ps_tdma_para[0] = real_byte1; + coex_dm->ps_tdma_para[1] = byte2; + coex_dm->ps_tdma_para[2] = byte3; + coex_dm->ps_tdma_para[3] = byte4; + coex_dm->ps_tdma_para[4] = real_byte5; + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + + } else { + coex_sta->cnt_set_ps_state_fail++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b1ant_set_fw_pstdma == Force Leave LPS Fail (cnt = %d)\n", + coex_sta->cnt_set_ps_state_fail); + BTC_TRACE(trace_buf); + } +} + + + +static +void halbtc8822b1ant_ps_tdma(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean turn_on, IN u8 type) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = FALSE; + static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; + static boolean pre_wifi_busy = FALSE; + + coex_dm->cur_ps_tdma_on = turn_on; + coex_dm->cur_ps_tdma = type; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (wifi_busy != pre_wifi_busy) { + force_exec = TRUE; + pre_wifi_busy = wifi_busy; + } + + /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ + if (bt_link_info->slave_role) + psTdmaByte4Modify = 0x1; + else + psTdmaByte4Modify = 0x0; + + if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { + + force_exec = TRUE; + pre_psTdmaByte4Modify = psTdmaByte4Modify; + } + + if (!force_exec) { + if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && + (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", + (coex_dm->cur_ps_tdma_on ? "on" : "off"), + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + return; + } + } + + if (coex_dm->cur_ps_tdma_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(on, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, + 0x1); /* enable TBTT nterrupt */ + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(off, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + } + + + + if (turn_on) { + + /* enable TBTT nterrupt */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, 0x1); + + switch (type) { + default: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x35, 0x03, 0x11, 0x11); + break; + case 1: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x3a, 0x03, 0x11, 0x10); + break; + case 3: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x30, 0x03, 0x10, 0x50); + break; + case 4: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x21, 0x03, 0x10, 0x50); + break; + case 5: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x15, 0x3, 0x11, 0x11); + break; + case 6: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x20, 0x3, 0x11, 0x10); + break; + case 7: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 8: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x14 | + psTdmaByte4Modify); + break; + case 11: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x25, 0x03, 0x11, 0x10 | + psTdmaByte4Modify); + break; + case 12: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x30, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 13: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x07, 0x10, 0x54 | + psTdmaByte4Modify); + break; + case 14: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x15, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + case 15: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x20, 0x03, 0x10, 0x10 | + psTdmaByte4Modify); + break; + case 17: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x14 | + psTdmaByte4Modify); + break; + case 18: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x10, 0x03, 0x10, 0x50 | + psTdmaByte4Modify); + break; + + case 20: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x30, 0x03, 0x11, 0x10); + break; + case 22: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x25, 0x03, 0x11, 0x10); + break; + case 27: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x10, 0x03, 0x11, 0x15); + break; + case 32: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x35, 0x3, 0x11, 0x11); + break; + case 33: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x35, 0x03, 0x11, 0x10); + break; + case 41: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x45, 0x3, 0x11, 0x11); + break; + case 42: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x1e, 0x3, 0x10, 0x14 | + psTdmaByte4Modify); + break; + case 43: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x45, 0x3, 0x10, 0x14); + break; + case 44: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x25, 0x3, 0x10, 0x10); + break; + case 45: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x29, 0x3, 0x10, 0x10); + break; + case 46: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x1a, 0x3, 0x10, 0x10); + break; + case 47: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x32, 0x3, 0x10, 0x10); + break; + case 48: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x29, 0x3, 0x10, 0x10); + break; + case 49: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x55, 0x10, 0x3, 0x10, 0x54); + break; + case 50: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x51, 0x4a, 0x3, 0x10, 0x10); + break; + case 51: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x61, 0x35, 0x3, 0x10, 0x11); + break; + + } + } else { + + switch (type) { + case 0: + default: /* Software control, Antenna at BT side */ + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x0, 0x0, 0x0, 0x0, 0x0); +#if 0 + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_BT, FORCE_EXEC, FALSE, + FALSE); +#endif + break; +#if 0 +/* 08:1ant:PTA Control -0x778=1-ant hw control,40:2ant:sw control-diversity */ +#endif + case 8: + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x8, 0x0, 0x0, 0x0, 0x0); +#if 0 + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_PTA, FORCE_EXEC, FALSE, + FALSE); +#endif + break; + case 9: /* Software control, Antenna at WiFi side */ + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x0, 0x0, 0x0, 0x0, 0x0); +#if 0 + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_WIFI, FORCE_EXEC, FALSE, FALSE); +#endif + break; + case 10: /* under 5G , 0x778=1*/ + halbtc8822b1ant_set_fw_pstdma(btcoexist, + 0x0, 0x0, 0x0, 0x0, 0x0); + +#if 0 + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_WIFI5G, FORCE_EXEC, FALSE, + FALSE); +#endif + break; + } + } + + + if (!coex_sta->is_set_ps_state_fail) { + /* update pre state */ + coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; + coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; + } +} + + + +static +void halbtc8822b1ant_sw_mechanism(IN struct btc_coexist *btcoexist, + IN boolean low_penalty_ra) +{ + halbtc8822b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, low_penalty_ra); +} + +/* rf4 type by efuse, and for ant at main aux inverse use, + * because is 2x2, and control types are the same, does not need + */ + +static +void halbtc8822b1ant_set_rfe_type(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); + + /* the following setup should be got from Efuse in the future */ + rfe_type->rfe_module_type = board_info->rfe_type; + + rfe_type->ext_ant_switch_ctrl_polarity = 0; + + switch (rfe_type->rfe_module_type) { + case 0: + default: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 1: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 2: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 3: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 4: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 5: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 6: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 7: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + } + + +} + +/*anttenna control by bb mac bt antdiv pta to write 0x4c 0xcb4,0xcbd*/ + + +static +void halbtc8822b1ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) +{ + boolean switch_polatiry_inverse = FALSE; + u8 regval_0xcbd = 0, regval_0x64; + u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; + + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); + + if (!rfe_type->ext_ant_switch_exist) + return; + + coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; + + if (!force_exec) { + if (coex_dm->pre_ext_ant_switch_status == + coex_dm->cur_ext_ant_switch_status) + return; + } + + coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; + + /* swap control polarity if use different switch control polarity*/ + /* Normal switch polarity for SPDT, + * 0xcbd[1:0] = 2b'01 => Ant to BTG, + * 0xcbd[1:0] = 2b'10 => Ant to WLG + */ + switch_polatiry_inverse = (rfe_type->ext_ant_switch_ctrl_polarity == 1 ? + ~switch_polatiry_inverse : switch_polatiry_inverse); + + + switch (pos_type) { + default: + case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT: + case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE: + + break; + case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG: + break; + case BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA: + break; + } + + + if (rfe_type->ext_ant_switch_type == + BT_8822B_1ANT_EXT_ANT_SWITCH_USE_SPDT) { + switch (ctrl_type) { + default: + case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: + /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4e, 0x80, + 0x0); + /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4f, 0x01, + 0x1); + /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as ctrl pin*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcb4, 0xff, + 0x77); + + /* 0xcbd[1:0] = 2b'01 for no switch_polatiry_inverse, + * ANTSWB =1, ANTSW =0 + */ + regval_0xcbd = (!switch_polatiry_inverse ? 0x1 : 0x2); + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, + regval_0xcbd); + + break; + case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: + /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4e, 0x80, + 0x0); + /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4f, 0x01, + 0x1); + /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as ctrl pin */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcb4, 0xff, + 0x66); + + /* 0xcbd[1:0] = 2b'10 for no switch_polatiry_inverse, + * ANTSWB =1, ANTSW =0 @ GNT_BT=1 + */ + regval_0xcbd = (!switch_polatiry_inverse ? 0x2 : 0x1); + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, + regval_0xcbd); + + break; + case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: + /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4e, 0x80, + 0x0); + /* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4f, 0x01, + 0x1); + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcb4, 0xff, + 0x88); + + /* no regval_0xcbd setup required, because + * antenna switch control value by antenna diversity + */ + + break; + case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: + /* 0x4c[23] = 1 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4e, 0x80, + 0x1); + + /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, + * DPDT_SEL_N =1, DPDT_SEL_P =0 + */ + regval_0x64 = (!switch_polatiry_inverse ? 0x0 : 0x1); + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x64, 0x1, + regval_0x64); + break; + case BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT: + /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4e, 0x80, + 0x0); + /* 0x4c[24] = 0 */ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x4f, 0x01, + 0x0); + + /* no setup required, because antenna switch control + * value by BT vendor 0xac[1:0] + */ + break; + } + } + + u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcbc); + u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (After Ext Ant switch setup) 0xcbc = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x**********\n", + u32tmp1, u32tmp2, u32tmp3); + BTC_TRACE(trace_buf); + + +} + +/* set gnt_wl gnt_bt control by sw high low, or + * hwpta while in power on, ini, wlan off, wlan only, wl2g non-currrent, + * wl2g current, wl5g + */ + + +static +void halbtc8822b1ant_set_ant_path(IN struct btc_coexist *btcoexist, + IN u8 ant_pos_type, IN boolean force_exec, + IN u8 phase) + +{ +#if BT_8822B_1ANT_COEX_DBG + u8 u8tmp = 0; +#endif + u32 u32tmp1 = 0; +#if BT_8822B_1ANT_COEX_DBG + u32 u32tmp2 = 0, u32tmp3 = 0; +#endif + + u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + + /* To avoid indirect access fail */ + if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { + force_exec = TRUE; + coex_sta->gnt_error_cnt++; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],(Before Ant Setup) 0x38= 0x%x\n", + u32tmp1); + BTC_TRACE(trace_buf); + } + + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); + + coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; + + if (!force_exec) { + if (coex_dm->cur_ant_pos_type == + coex_dm->pre_ant_pos_type) + return; + } + + coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; + +#if BT_8822B_1ANT_COEX_DBG + u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0x54); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", + u32tmp3, u8tmp, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); +#endif + + switch (phase) { + case BT_8822B_1ANT_PHASE_COEX_INIT: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_COEX_INIT) **********\n"); + BTC_TRACE(trace_buf); + + /* Disable LTE Coex Function in WiFi side + * (this should be on if LTE coex is required) + */ + halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, + BT_8822B_1ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, + BT_8822B_1ANT_CTT_BT_VS_LTE, + 0xffff); + + /* set GNT_BT to SW high */ + halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); + + /* set GNT_WL to SW low */ + halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_LOW); + + /* set Path control owner to WL at initial step */ + halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_1ANT_PCO_WLSIDE); + + coex_sta->run_time_state = FALSE; + + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, + 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, + 0x8, 0x0); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; + + break; + case BT_8822B_1ANT_PHASE_WLANONLY_INIT: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLANONLY_INIT) **********\n"); + BTC_TRACE(trace_buf); + + /* Disable LTE Coex Function in WiFi side + * (this should be on if LTE coex is required) + */ + halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, + BT_8822B_1ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b1ant_ltecoex_set_coex_table(btcoexist, + BT_8822B_1ANT_CTT_BT_VS_LTE, + 0xffff); + + /* set GNT_BT to SW Low */ + halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_LOW); + + /* Set GNT_WL to SW high */ + halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); + + /* set Path control owner to WL at initial step */ + halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_1ANT_PCO_WLSIDE); + + coex_sta->run_time_state = FALSE; + + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, + 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, + 0x8, 0x0); + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_WIFI; + + break; + case BT_8822B_1ANT_PHASE_WLAN_OFF: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_WLAN_OFF) **********\n"); + BTC_TRACE(trace_buf); + + /* Disable LTE Coex Function in WiFi side */ + halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); + + /* set Path control owner to BT */ + halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_1ANT_PCO_BTSIDE); + + /* Set Ext Ant Switch to BT control at wifi off step */ + halbtc8822b1ant_set_ext_ant_switch(btcoexist, + FORCE_EXEC, + BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BT, + BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); + + coex_sta->run_time_state = FALSE; + + break; + case BT_8822B_1ANT_PHASE_2G_RUNTIME: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_2G_RUNTIME) **********\n"); + BTC_TRACE(trace_buf); + + /* set GNT_BT to PTA */ + halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_PTA, + BT_8822B_1ANT_SIG_STA_SET_BY_HW); + + /* Set GNT_WL to PTA */ + halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_PTA, + BT_8822B_1ANT_SIG_STA_SET_BY_HW); + + /* set Path control owner to WL at runtime step */ + halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_1ANT_PCO_WLSIDE); + + coex_sta->run_time_state = TRUE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_PTA; + + break; + case BT_8822B_1ANT_PHASE_5G_RUNTIME: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_5G_RUNTIME) **********\n"); + BTC_TRACE(trace_buf); + + /* set GNT_BT to SW Hi */ + halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); + + /* Set GNT_WL to SW Hi */ + halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); + + /* set Path control owner to WL at runtime step */ + halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_1ANT_PCO_WLSIDE); + + coex_sta->run_time_state = TRUE; + + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = + BTC_ANT_PATH_WIFI5G; + + break; + case BT_8822B_1ANT_PHASE_BTMPMODE: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (set_ant_path - 1ANT_PHASE_BTMPMODE) **********\n"); + BTC_TRACE(trace_buf); + + /* Disable LTE Coex Function in WiFi side */ + halbtc8822b1ant_ltecoex_enable(btcoexist, 0x0); + + /* set GNT_BT to SW Hi */ + halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); + + /* Set GNT_WL to SW Lo */ + halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_LOW); + + /* set Path control owner to WL */ + halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_1ANT_PCO_WLSIDE); + + coex_sta->run_time_state = FALSE; + + /* Set Ext Ant Switch to BT side at BT MP mode */ + if (BTC_ANT_PATH_AUTO == ant_pos_type) + ant_pos_type = BTC_ANT_PATH_BT; + + break; + } + + + if (phase != BT_8822B_1ANT_PHASE_WLAN_OFF) { + switch (ant_pos_type) { + case BTC_ANT_PATH_WIFI: + halbtc8822b1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLG); + break; + case BTC_ANT_PATH_WIFI5G + : + halbtc8822b1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8822B_1ANT_EXT_ANT_SWITCH_TO_WLA); + break; + case BTC_ANT_PATH_BT: + halbtc8822b1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW, + BT_8822B_1ANT_EXT_ANT_SWITCH_TO_BT); + break; + default: + case BTC_ANT_PATH_PTA: + halbtc8822b1ant_set_ext_ant_switch( + btcoexist, + force_exec, + BT_8822B_1ANT_EXT_ANT_SWITCH_CTRL_BY_PTA, + BT_8822B_1ANT_EXT_ANT_SWITCH_TO_NOCARE); + break; + } + + } +#if BT_8822B_1ANT_COEX_DBG + u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (After Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", + u32tmp3, u8tmp, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); + +#endif + +} + + + +static +void halbtc8822b1ant_set_rx_gain(IN struct btc_coexist *btcoexist, + IN boolean agc_table_en) +{ + u8 rssi_adjust_val = 0; + + /* =================BB AGC Gain Table */ + if (agc_table_en) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table On!\n"); + BTC_TRACE(trace_buf); + + + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + btcoexist->btc_write_1byte(btcoexist, 0xc5b, 0xc8); + btcoexist->btc_write_1byte(btcoexist, 0xe5b, 0xc8); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xff000003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xae2e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xad300003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xac320003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xab360003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8d380003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8c3a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8b3c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8a3e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6e400003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6d420003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6c440003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6b460003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6a480003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x694a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x684c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x674e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x66500003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x65520003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x64540003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x64560003); + + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x007e0403); + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table Off!\n"); + BTC_TRACE(trace_buf); + + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + btcoexist->btc_write_1byte(btcoexist, 0xc5b, 0xd8); + btcoexist->btc_write_1byte(btcoexist, 0xe5b, 0xd8); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xff000003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xe62e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xe5300003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc8320003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc6360003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc5380003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc43a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc33c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc23e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc1400003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc0420003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa5440003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa4460003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa3480003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa24a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa14c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x834e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x82500003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x81520003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x80540003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x65560003); + + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x007e0403); + } + + +} + + +static +void halbtc8822b1ant_rx_gain(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean agc_table_en) +{ + coex_dm->cur_agc_table_en = agc_table_en; + + if (!force_exec) { + if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) + return; + } + halbtc8822b1ant_set_rx_gain(btcoexist, agc_table_en); + + coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; +} + + +static +void halbtc8822b1ant_action_bt_idle(IN struct btc_coexist *btcoexist) +{ + + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (bt idle) **********\n"); + BTC_TRACE(trace_buf); + + if (!wifi_busy) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (bt idle wl not busy) **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } else { /* if wl busy */ + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + + if (BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, + 8); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** else(bt non connect idle wl not busy) **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 12); + } + } + +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif +} + + +static +boolean halbtc8822b1ant_is_common_action(IN struct btc_coexist *btcoexist) +{ + boolean common = FALSE, wifi_connected = FALSE, wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_connected && + coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi non connected-idle + BT non connected-idle!!\n"); + BTC_TRACE(trace_buf); + + /* halbtc8822b1ant_sw_mechanism(btcoexist, FALSE); */ + + common = TRUE; + } else if (wifi_connected && + (coex_dm->bt_status == + BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi connected + BT non connected-idle!!\n"); + BTC_TRACE(trace_buf); + + /* halbtc8822b1ant_sw_mechanism(btcoexist, FALSE); */ + + common = TRUE; + } else if (!wifi_connected && + (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi non connected-idle + BT connected-idle!!\n"); + BTC_TRACE(trace_buf); + + /* halbtc8822b1ant_sw_mechanism(btcoexist, FALSE); */ + + common = TRUE; + } else if (wifi_connected && + (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi connected + BT connected-idle!!\n"); + BTC_TRACE(trace_buf); + + /* halbtc8822b1ant_sw_mechanism(btcoexist, FALSE); */ + + common = TRUE; + } else if (!wifi_connected && + (BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE != + coex_dm->bt_status)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi non connected-idle + BT Busy!!\n"); + BTC_TRACE(trace_buf); + + /* halbtc8822b1ant_sw_mechanism(btcoexist, FALSE); */ + + common = TRUE; + } else { + if (wifi_busy) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi Connected-Busy + BT Busy!!\n"); + BTC_TRACE(trace_buf); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi Connected-Idle + BT Busy!!\n"); + BTC_TRACE(trace_buf); + } + + common = FALSE; + } + + return common; +} + + +static +void halbtc8822b1ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], under 5g start\n"); + BTC_TRACE(trace_buf); + /* for test : s3 bt disappear , fail rate 1/600*/ +#if 0 + halbtc8822b1ant_ignore_wlan_act(btcoexist, NORMAL_EXEC, TRUE); +#endif + /*set sw gnt wl bt high*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +#if 0 + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + + halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, FALSE, 5); +#endif +} + + + + +static +void halbtc8822b1ant_action_wifi_only(IN struct btc_coexist *btcoexist) +{ + boolean wifi_under_5g = FALSE, rf4ce_enabled = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + if (wifi_under_5g) { + halbtc8822b1ant_action_wifi_under5g(btcoexist); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (wlan only -- under 5g ) **********\n"); + BTC_TRACE(trace_buf); + return; + } + + if (rf4ce_enabled) { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x45e, 0x8, 0x1); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 50); + + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + return; + } + halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); + + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (wlan only -- under 2g ) **********\n"); + BTC_TRACE(trace_buf); + +} + +static +void halbtc8822b1ant_action_wifi_native_lps(IN struct btc_coexist *btcoexist) +{ + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 5); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +} + + +/* ********************************************* + * + * Non-Software Coex Mechanism start + * + * ********************************************* */ + +static +void halbtc8822b1ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],action_bt_whck_test\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +} + +static +void halbtc8822b1ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex],action_wifi_multi_port\n"); + BTC_TRACE(trace_buf); + + /*halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8);*/ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + + +} + + +static +void halbtc8822b1ant_action_hs(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], action_hs\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 5); + + +} + +static +void halbtc8822b1ant_action_bt_relink(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], run bt multi link function\n"); + BTC_TRACE(trace_buf); + + if (coex_sta->is_bt_multi_link) + return; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], run bt_re-link function\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + +} + +#if 0 +static +void halbtc8822b1ant_action_bt_idle(IN struct btc_coexist *btcoexist) +{ + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_busy) { + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 6); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 3); + + } else { /* if wl busy */ + + if (BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 33); + } else { + + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 32); + + } + + } + +} +#endif + +/*"""bt inquiry"""" + wifi any + bt any*/ + +static +void halbtc8822b1ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) +{ + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = FALSE, ap_enable = FALSE, wifi_busy = FALSE, + bt_busy = FALSE, rf4ce_enabled = FALSE; + + + boolean wifi_scan = FALSE, link = FALSE, roam = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (bt inquiry) **********\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** scan = %d, link =%d, roam = %d**********\n", + wifi_scan, link, roam); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + + if ((link) || (roam) || (coex_sta->wifi_is_high_pri_task)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (bt inquiry wifi connect or scan ) **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 1); + + } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + + } else if ((!wifi_connected) && (!wifi_scan)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (bt inquiry wifi non connect) **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + + } else if (bt_link_info->a2dp_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 3); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + + } else if (wifi_scan) { + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 20); + + + } else if (wifi_busy) { + + /* for BT inquiry/page fail after S4 resume */ +#if 0 + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 20); +#endif + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 15); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + /*aaaa->55aa for bt connect while wl busy*/ + + if (rf4ce_enabled) { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x45e, 0x8, 0x1); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 50); + } + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (bt inquiry wifi connect) **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 4); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + + } + +#if 0 + if ((wifi_link) || (wifi_roam) || (coex_sta->wifi_is_high_pri_task)) { + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + + } else if ((wifi_scan) && (coex_sta->bt_create_connection)) { + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 6); + + } else if ((!wifi_connected) && (!wifi_scan)) { + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + } else if ((bt_link_info->a2dp_exist) && (bt_link_info->pan_exist)) { + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + } else if (bt_link_info->a2dp_exist) { + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } else if (wifi_scan) { + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 20); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + } else if (wifi_busy) { + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } else { + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 19); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + } +#endif +} + +static +void halbtc8822b1ant_action_bt_sco_hid_only_busy(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = FALSE, wifi_busy = FALSE; + u32 wifi_bw = 1; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + + + if (bt_link_info->sco_exist) { + /*halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 5); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 5);*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + } else { + + if (coex_sta->is_hid_low_pri_tx_overhead) { + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 6); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 18); + } else if (wifi_bw == 0) { /* if 11bg mode */ + + if (coex_sta->is_bt_multi_link) { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + /*halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 11); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 11);*/ + } else { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + /*halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 6); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 11);*/ + } + } else { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + /*halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 6); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 11);*/ + } + } +} + +static +void halbtc8822b1ant_action_wifi_connected_bt_acl_busy(IN struct btc_coexist + *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + u32 wifi_bw = 1; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy_level = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; + + if ((coex_sta->bt_relink_downcount != 0) + && (!bt_link_info->pan_exist) && (wifi_busy)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); + BTC_TRACE(trace_buf); + + /*halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + } else if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { + /*halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 12); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 6);*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } else if (bt_link_info->a2dp_only) { /* A2DP */ + + /*halbtc8822b1ant_ps_tdma(btcoexist, + NORMAL_EXEC, TRUE, 7); + + if (wifi_turbo) + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 19); + else + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4);*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } else if (((bt_link_info->a2dp_exist) && + (bt_link_info->pan_exist)) || + (bt_link_info->hid_exist && bt_link_info->a2dp_exist && + bt_link_info->pan_exist)) { + /* A2DP+PAN(OPP,FTP), HID+A2DP+PAN(OPP,FTP) */ + + if (wifi_busy) + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 13); + else + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 14); + + if (bt_link_info->hid_exist) + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + else if (wifi_turbo) + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 19); + else + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } else if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { /* HID+A2DP */ + + if (wifi_bw == 0) {/* if 11bg mode */ + /*halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 21);*/ + /*halbtc8822b1ant_set_wltoggle_coex_table(btcoexist, + NORMAL_EXEC, 1, 0x55, 0x55, 0x5a, 0x5a);*/ + /*halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 49);*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } else { + /*halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 21);*/ + /*halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + TRUE, 8);*/ + /*halbtc8822b1ant_set_wltoggle_coex_table(btcoexist, + NORMAL_EXEC, 1, 0x55, 0x55, 0x5a, 0x5a);*/ + /*halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 49);*/ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } + /* PAN(OPP,FTP), HID+PAN(OPP,FTP) */ + + } else if ((bt_link_info->pan_only) || (bt_link_info->hid_exist && bt_link_info->pan_exist)) { + + if (!wifi_busy) + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 4); + else + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 3); + + if (bt_link_info->hid_exist) + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + else if (wifi_turbo) + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 19); + else + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + } else { + /* BT no-profile busy (0x9) */ + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 33); + } + +} + + +/*wifi not connected + bt action*/ + +static +void halbtc8822b1ant_action_wifi_not_connected(IN struct btc_coexist *btcoexist) +{ + boolean rf4ce_enabled = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (wifi not connect) **********\n"); + BTC_TRACE(trace_buf); + + /* tdma and coex table */ + if (rf4ce_enabled) { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x45e, 0x8, 0x1); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 50); + return; + } + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); +} + +/*""""wl not connected scan"""" + bt action*/ +static +void halbtc8822b1ant_action_wifi_not_connected_scan(IN struct btc_coexist + *btcoexist) +{ + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = FALSE; + u8 agg_buf_size = 5; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (wifi non connect scan) **********\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + + num_of_wifi_link = wifi_link_status >> 16; + + if (num_of_wifi_link >= 2) { + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + bt_ctrl_agg_buf_size, agg_buf_size); + + if (coex_sta->c2h_bt_inquiry_page) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is Inquirying\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_inquiry(btcoexist); + } else { + halbtc8822b1ant_action_wifi_multi_port(btcoexist); + } + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8822b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8822b1ant_action_hs(btcoexist); + return; + } + /* tdma and coex table */ + if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + if (bt_link_info->a2dp_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 32); + } else if (bt_link_info->a2dp_exist && + bt_link_info->pan_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 22); + } else { + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 20); + } + } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist); + } else { + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 5); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + } +} + +/*""""wl not connected asso"""" + bt action*/ + +static +void halbtc8822b1ant_action_wifi_not_connected_asso_auth( + IN struct btc_coexist *btcoexist) +{ + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = FALSE; + u8 agg_buf_size = 5; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (wifi non connect asso_auth) **********\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + + num_of_wifi_link = wifi_link_status >> 16; + + if (num_of_wifi_link >= 2) { + + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + bt_ctrl_agg_buf_size, + agg_buf_size); + + if (coex_sta->c2h_bt_inquiry_page) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is Inquirying\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_inquiry(btcoexist); + } else { + halbtc8822b1ant_action_wifi_multi_port( + btcoexist); + } + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8822b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8822b1ant_action_hs(btcoexist); + return; + } + + + /* tdma and coex table */ + if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist) || + (bt_link_info->a2dp_exist)) { + halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + + } else if (bt_link_info->pan_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 4); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 20); + + } else { + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 2); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + + } +} + +/*""""wl connected scan"""" + bt action*/ + +static +void halbtc8822b1ant_action_wifi_connected_scan(IN struct btc_coexist + *btcoexist) +{ + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = FALSE; + u8 agg_buf_size = 5; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (wifi connect scan) **********\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + + num_of_wifi_link = wifi_link_status >> 16; + + if (num_of_wifi_link >= 2) { + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + bt_ctrl_agg_buf_size, agg_buf_size); + + if (coex_sta->c2h_bt_inquiry_page) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is Inquirying\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_inquiry(btcoexist); + } else { + halbtc8822b1ant_action_wifi_multi_port(btcoexist); + } + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8822b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8822b1ant_action_hs(btcoexist); + return; + } + + /* tdma and coex table */ + if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + if (bt_link_info->a2dp_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 32); + } else if (bt_link_info->a2dp_exist && + bt_link_info->pan_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 22); + + } else { + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 20); + } + } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist); + } else { +#if 0 + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); +#endif + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 1); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 20); +#if 0 + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 6); +#endif + + } +} + +/*""""wl connected specific packet"""" + bt action*/ + +static +void halbtc8822b1ant_action_wifi_connected_specific_packet( + IN struct btc_coexist *btcoexist) +{ + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0; + boolean bt_ctrl_agg_buf_size = FALSE; + u8 agg_buf_size = 5; + boolean wifi_busy = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (wifi connect specific packet) **********\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + + num_of_wifi_link = wifi_link_status >> 16; + + if (num_of_wifi_link >= 2) { + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + bt_ctrl_agg_buf_size, agg_buf_size); + + if (coex_sta->c2h_bt_inquiry_page) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is Inquirying\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_inquiry(btcoexist); + } else { + halbtc8822b1ant_action_wifi_multi_port(btcoexist); + } + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + halbtc8822b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8822b1ant_action_hs(btcoexist); + return; + } + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + /* no specific packet process for both WiFi and BT very busy */ + if ((wifi_busy) && ((bt_link_info->pan_exist) || + (coex_sta->num_of_profile >= 2))) + return; + + /* tdma and coex table */ + if ((bt_link_info->sco_exist) || (bt_link_info->hid_exist)) { + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + + } else if (bt_link_info->a2dp_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 15); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 32); + /*for a2dp glitch,change from 1 to 15*/ + + } else if (bt_link_info->pan_exist) { + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 1); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 20); + + } else { + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 5); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + + } +} + +static +void halbtc8822b1ant_action_a2dpsink(IN struct btc_coexist *btcoexist) +{ + + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0xcbd, 0x3, 1); + halbtc8822b1ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 8); + +} + +/* wifi connected input point: + * to set different ps and tdma case (+bt different case) + */ + +static +void halbtc8822b1ant_action_wifi_connected(IN struct btc_coexist *btcoexist) +{ + + boolean wifi_busy = FALSE, rf4ce_enabled = FALSE; + boolean scan = FALSE, link = FALSE, roam = FALSE; + boolean under_4way = FALSE, ap_enable = FALSE, wifi_under_5g = FALSE; + u8 wifi_rssi_state; + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect()===>\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (wifi_under_5g) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect(), return for wifi is under 5g<===\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_action_wifi_under5g(btcoexist); + + return; + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect(), return for wifi is under 2g<===\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (under_4way) { + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_action_wifi_connected_specific_packet( + btcoexist); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect(), return for wifi is under 4way<===\n"); + BTC_TRACE(trace_buf); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + if (scan || link || roam) { + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + if (scan) + halbtc8822b1ant_action_wifi_connected_scan(btcoexist); + else + halbtc8822b1ant_action_wifi_connected_specific_packet( + btcoexist); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CoexForWifiConnect(), return for wifi is under scan<===\n"); + BTC_TRACE(trace_buf); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + /* tdma and coex table */ + if (!wifi_busy) { + if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + halbtc8822b1ant_action_wifi_connected_bt_acl_busy( + btcoexist); + } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == + coex_dm->bt_status) || + (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist); + } else { + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, + 8); + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + if ((coex_sta->high_priority_tx) + + (coex_sta->high_priority_rx) <= 60) + /*sy modify case16 -> case17*/ + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + else + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + } + } else { + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + if (BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) { + halbtc8822b1ant_action_wifi_connected_bt_acl_busy( + btcoexist); + } else if ((BT_8822B_1ANT_BT_STATUS_SCO_BUSY == + coex_dm->bt_status) || + (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == + coex_dm->bt_status)) { + halbtc8822b1ant_action_bt_sco_hid_only_busy(btcoexist); + } else { + if (rf4ce_enabled) { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x45e, 0x8, 0x1); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 50); + return; + } + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, + 8); + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + +#if 0 + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 32); + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, NORMAL_EXEC, BT_8822B_1ANT_PHASE_2G_RUNTIME); +#endif + + + + wifi_rssi_state = halbtc8822b1ant_wifi_rssi_state( + btcoexist, 1, 2, 25, 0); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** before **********\n"); + BTC_TRACE(trace_buf); +#if 0 + if ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) && + (coex_sta->scan_ap_num <= 3) && + (wifi_rssi_state == BTC_RSSI_STATE_LOW || + wifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { +#endif + if (BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + if (rf4ce_enabled) { + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x45e, 0x8, 0x1); + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 50); + return; + } + + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + } else + + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); +#if 0 + else if ((coex_sta->high_priority_tx + + coex_sta->high_priority_rx) <= 60) + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + else + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); +#endif + } + } +} + +static +void halbtc8822b1ant_run_sw_coexist_mechanism(IN struct btc_coexist *btcoexist) +{ + + u8 algorithm = 0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (run sw coexmech) **********\n"); + BTC_TRACE(trace_buf); + algorithm = halbtc8822b1ant_action_algorithm(btcoexist); + coex_dm->cur_algorithm = algorithm; + + if (halbtc8822b1ant_is_common_action(btcoexist)) { + + } else { + switch (coex_dm->cur_algorithm) { + case BT_8822B_1ANT_COEX_ALGO_SCO: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = SCO.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_sco(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HID.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_hid(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = A2DP.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_a2dp(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_A2DP_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = A2DP+PAN(HS).\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_a2dp_pan_hs(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = PAN(EDR).\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_pan_edr(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HS mode.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_pan_hs(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = PAN+A2DP.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_pan_edr_a2dp(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_A2DPSINK: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP Sink.\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_a2dpsink(btcoexist); + break; + + case BT_8822B_1ANT_COEX_ALGO_PANEDR_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = PAN(EDR)+HID.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_pan_edr_hid(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HID+A2DP+PAN.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_hid_a2dp_pan_edr(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_HID_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = HID+A2DP.\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_action_hid_a2dp(btcoexist); +#endif + break; + case BT_8822B_1ANT_COEX_ALGO_NOPROFILEBUSY: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_idle(btcoexist); + break; + + default: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action algorithm = coexist All Off!!\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_coex_all_off(btcoexist); +#endif + break; + } + coex_dm->pre_algorithm = coex_dm->cur_algorithm; + } +} + +static +void halbtc8822b1ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) +{ + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean wifi_connected = FALSE, bt_hs_on = FALSE; + boolean increase_scan_dev_num = FALSE; + boolean bt_ctrl_agg_buf_size = FALSE; + boolean miracast_plus_bt = FALSE; + u8 agg_buf_size = 5; + u32 wifi_link_status = 0; + u32 num_of_wifi_link = 0, wifi_bw; + u8 iot_peer = BTC_IOT_PEER_UNKNOWN; + boolean wifi_under_5g = FALSE; + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism()===>\n"); + BTC_TRACE(trace_buf); + + if (btcoexist->manual_control) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (btcoexist->stop_coex_dm) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->under_ips) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under IPS !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if ((coex_sta->under_lps) && + (coex_dm->bt_status != BT_8822B_1ANT_BT_STATUS_ACL_BUSY)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_wifi_native_lps(btcoexist); + return; + } + + if (!coex_sta->run_time_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], return for run_time_state = FALSE !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->freeze_coexrun_by_btinfo) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); + BTC_TRACE(trace_buf); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + if (wifi_under_5g) { + halbtc8822b1ant_action_wifi_under5g(btcoexist); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 5G!!!\n"); + BTC_TRACE(trace_buf); + return; + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 2G!!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + if (coex_sta->bt_whck_test) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under WHCK TEST!!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_whck_test(btcoexist); + return; + } + + if (coex_sta->bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8822b1ant_action_wifi_only(btcoexist); + return; + } + + if (coex_sta->is_setupLink) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is re-link !!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_relink(btcoexist); + return; + } + + if ((BT_8822B_1ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8822B_1ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + increase_scan_dev_num = TRUE; + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + + btcoexist->btc_set(btcoexist, BTC_SET_BL_INC_SCAN_DEV_NUM, + &increase_scan_dev_num); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + + if ((num_of_wifi_link >= 2) || + (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", + num_of_wifi_link, wifi_link_status); + BTC_TRACE(trace_buf); + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + + if (bt_link_info->bt_link_exist) { + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, + 0, 1); + miracast_plus_bt = TRUE; + } else { + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, + 0, 0); + miracast_plus_bt = FALSE; + } + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, + bt_ctrl_agg_buf_size, agg_buf_size); + + if ((bt_link_info->a2dp_exist) && + (coex_sta->c2h_bt_inquiry_page)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is Inquirying\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_inquiry(btcoexist); + } else { + halbtc8822b1ant_action_wifi_multi_port(btcoexist); + } + + return; + } + + miracast_plus_bt = FALSE; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + if ((bt_link_info->bt_link_exist) && (wifi_connected)) { + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 1, 1, 0, 1); + + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + if (BTC_IOT_PEER_CISCO != iot_peer) { +#if 0 + if (bt_link_info->bt_hi_pri_link_exist) +#endif + if (bt_link_info->sco_exist) + halbtc8822b1ant_limited_rx(btcoexist, + NORMAL_EXEC, TRUE, FALSE, 0x5); + else + halbtc8822b1ant_limited_rx(btcoexist, + NORMAL_EXEC, FALSE, FALSE, 0x5); + } else { + halbtc8822b1ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + if (bt_link_info->sco_exist) + halbtc8822b1ant_limited_rx(btcoexist, + NORMAL_EXEC, TRUE, FALSE, 0x5); + else { + if (BTC_WIFI_BW_HT40 == wifi_bw) + halbtc8822b1ant_limited_rx(btcoexist, + NORMAL_EXEC, FALSE, TRUE, 0x10); + else + halbtc8822b1ant_limited_rx(btcoexist, + NORMAL_EXEC, FALSE, TRUE, 0x8); + } + } + + halbtc8822b1ant_sw_mechanism(btcoexist, TRUE); + halbtc8822b1ant_run_sw_coexist_mechanism( + btcoexist); /* just print debug message */ + } else { + halbtc8822b1ant_limited_tx(btcoexist, NORMAL_EXEC, 0, 0, 0, 0); + + halbtc8822b1ant_limited_rx(btcoexist, NORMAL_EXEC, FALSE, FALSE, + 0x5); + + halbtc8822b1ant_sw_mechanism(btcoexist, FALSE); + halbtc8822b1ant_run_sw_coexist_mechanism( + btcoexist); /* just print debug message */ + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + if (coex_sta->c2h_bt_inquiry_page) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is Inquirying\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_bt_inquiry(btcoexist); + return; + } else if (bt_hs_on) { + halbtc8822b1ant_action_hs(btcoexist); + return; + } + + + if (!wifi_connected) { + boolean scan = FALSE, link = FALSE, roam = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is non connected-idle !!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + + if (scan) + halbtc8822b1ant_action_wifi_not_connected_scan( + btcoexist); + else if (link || roam) + halbtc8822b1ant_action_wifi_not_connected_asso_auth( + btcoexist); + else + halbtc8822b1ant_action_wifi_not_connected(btcoexist); + } else /* wifi LPS/Busy */ + halbtc8822b1ant_action_wifi_connected(btcoexist); +} + +static +void halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + /* force to reset coex mechanism */ + + halbtc8822b1ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); + + /* sw all off */ + halbtc8822b1ant_sw_mechanism(btcoexist, FALSE); + +#if 0 + halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 8); + halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); +#endif + + coex_sta->pop_event_cnt = 0; +} + +static +void halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean back_up, IN boolean wifi_only) +{ + + u8 u8tmp = 0, i = 0; + u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; + + + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u32tmp1 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp2 = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x**********\n", + u32tmp3, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 1Ant Init HW Config!!\n"); + BTC_TRACE(trace_buf); + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->bt_reg_vendor_ac = 0xffff; + coex_sta->bt_reg_vendor_ae = 0xffff; + coex_sta->isolation_btween_wb = BT_8822B_1ANT_DEFAULT_ISOLATION; + coex_sta->gnt_error_cnt = 0; + coex_sta->bt_relink_downcount = 0; + coex_sta->is_set_ps_state_fail = FALSE; + coex_sta->cnt_set_ps_state_fail = 0; + + for (i = 0; i <= 9; i++) + coex_sta->bt_afh_map[i] = 0; + + /* Setup RF front end type */ + halbtc8822b1ant_set_rfe_type(btcoexist); + + /* 0xf0[15:12] --> Chip Cut information */ + coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, + 0xf1) & 0xf0) >> 4; + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, + 0x1); /* enable TBTT nterrupt */ + + /* BT report packet sample rate */ + /* 0x790[5:0]=0x5 */ + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x790); + u8tmp &= 0xc0; + u8tmp |= 0x5; + btcoexist->btc_write_1byte(btcoexist, 0x790, u8tmp); + + /* Enable BT counter statistics */ + btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); + + /* Enable PTA (3-wire function form BT side) */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); + + /* Enable PTA (tx/rx signal form WiFi side) */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); + /*GNT_BT=1 while select both */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x763, 0x10, 0x1); + +#if 0 + /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); +#endif + + /* enable GNT_WL */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, 0x40, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x1, 0x0); + + if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ONOFF, TRUE); + + /* Antenna config */ + if (coex_sta->is_rf_state_off) { + + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_WLAN_OFF); + + btcoexist->stop_coex_dm = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** halbtc8822b1ant_init_hw_config (RF Off)**********\n"); + BTC_TRACE(trace_buf); + } else if (wifi_only) { + + coex_sta->concurrent_rx_mode_on = FALSE; + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_WIFI, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_WLANONLY_INIT); + } else { + + coex_sta->concurrent_rx_mode_on = TRUE; + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_COEX_INIT); + } + + /* PTA parameter */ + halbtc8822b1ant_coex_table_with_type(btcoexist, FORCE_EXEC, 0); + halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); + +} + +#if (BTC_COEX_OFFLOAD == 1) +void halbtc8822b1ant_wifi_info_notify(IN struct btc_coexist *btcoexist) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 ap_num = 0; + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, &ap_num); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + h2c_para[0] = ap_num; /* AP number */ + h2c_para[1] = (u8)wifi_busy; /* Busy */ + h2c_para[2] = (u8)wifi_rssi; /* RSSI */ + + btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_INFO_NOTIFY, + opcode_ver, &h2c_para[0], 3); +} + +void halbtc8822b1ant_setManual(IN struct btc_coexist *btcoexist, + IN boolean manual) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 set_type = 0; + + if (manual) + set_type = 1; + else + set_type = 0; + + h2c_para[0] = set_type; /* set_type */ + + btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_SET_CONTROL, + opcode_ver, + &h2c_para[0], 1); +} + +/* ************************************************************ + * work around function start with wa_halbtc8822b1ant_ + * ************************************************************ + * ************************************************************ + * extern function start with ex_halbtc8822b1ant_ + * ************************************************************ */ + +void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) +{ + coex_sta->is_rf_state_off = FALSE; + +} +void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) +{} +void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only) +{} +static +void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{} +void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 ips_notify = 0; + + if (BTC_IPS_ENTER == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS ENTER notify\n"); + BTC_TRACE(trace_buf); + ips_notify = 1; + } else if (BTC_IPS_LEAVE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS LEAVE notify\n"); + BTC_TRACE(trace_buf); + } + + h2c_para[0] = ips_notify; /* IPS notify */ + h2c_para[1] = 0xff; /* LPS notify */ + h2c_para[2] = 0xff; /* RF state notify */ + h2c_para[3] = 0xff; /* pnp notify */ + + btcoexist->btc_coex_h2c_process(btcoexist, + COL_OP_WIFI_POWER_STATE_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} +void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 lps_notify = 0; + + if (BTC_LPS_ENABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS ENABLE notify\n"); + BTC_TRACE(trace_buf); + lps_notify = 1; + } else if (BTC_LPS_DISABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS DISABLE notify\n"); + BTC_TRACE(trace_buf); + } + + h2c_para[0] = 0xff; /* IPS notify */ + h2c_para[1] = lps_notify; /* LPS notify */ + h2c_para[2] = 0xff; /* RF state notify */ + h2c_para[3] = 0xff; /* pnp notify */ + + btcoexist->btc_coex_h2c_process(btcoexist, + COL_OP_WIFI_POWER_STATE_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} + +void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 scan_start = 0; + boolean under_4way = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + if (BTC_SCAN_START == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify\n"); + BTC_TRACE(trace_buf); + scan_start = 1; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN FINISH notify\n"); + BTC_TRACE(trace_buf); + } + + h2c_para[0] = scan_start; /* scan notify */ + h2c_para[1] = 0xff; /* connect notify */ + h2c_para[2] = 0xff; /* specific packet notify */ + if (under_4way) + h2c_para[3] = 1; /* under 4way progress */ + else + h2c_para[3] = 0; + + btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} + +void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 connect_start = 0; + boolean under_4way = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + if (BTC_ASSOCIATE_START == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT START notify\n"); + BTC_TRACE(trace_buf); + connect_start = 1; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT FINISH notify\n"); + BTC_TRACE(trace_buf); + } + + h2c_para[0] = 0xff; /* scan notify */ + h2c_para[1] = connect_start; /* connect notify */ + h2c_para[2] = 0xff; /* specific packet notify */ + if (under_4way) + h2c_para[3] = 1; /* under 4way progress */ + else + h2c_para[3] = 0; + + btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} + +void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u32 wifi_bw; + u8 wifi_central_chnl; + u8 h2c_para[5] = {0}; + u8 opcode_ver = 0; + u8 port = 0, connected = 0, freq = 0, bandwidth = 0, iot_peer = 0; + boolean wifi_under_5g = FALSE; + + if (BTC_MEDIA_CONNECT == type) + connected = 1; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + bandwidth = (u8)wifi_bw; + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + if (wifi_under_5g) + freq = 1; + else + freq = 0; + btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, + &wifi_central_chnl); + btcoexist->btc_get(btcoexist, BTC_GET_U1_IOT_PEER, &iot_peer); + + /* port need to be implemented in the future (p2p port, ...) */ + h2c_para[0] = (connected << 4) | port; + h2c_para[1] = (freq << 4) | bandwidth; + h2c_para[2] = wifi_central_chnl; + h2c_para[3] = iot_peer; + btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_STATUS_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} + +void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 connect_start = 0; + boolean under_4way = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + h2c_para[0] = 0xff; /* scan notify */ + h2c_para[1] = 0xff; /* connect notify */ + h2c_para[2] = type; /* specific packet notify */ + if (under_4way) + h2c_para[3] = 1; /* under 4way progress */ + else + h2c_para[3] = 0; + + btcoexist->btc_coex_h2c_process(btcoexist, COL_OP_WIFI_PROGRESS_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} + +void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{} +void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 rfstate_notify = 0; + + if (BTC_RF_ON == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned ON!!\n"); + BTC_TRACE(trace_buf); + rfstate_notify = 1; + coex_sta->is_rf_state_off = FALSE; + } else if (BTC_RF_OFF == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned OFF!!\n"); + BTC_TRACE(trace_buf); + coex_sta->is_rf_state_off = TRUE; + } + + h2c_para[0] = 0xff; /* IPS notify */ + h2c_para[1] = 0xff; /* LPS notify */ + h2c_para[2] = rfstate_notify; /* RF state notify */ + h2c_para[3] = 0xff; /* pnp notify */ + + btcoexist->btc_coex_h2c_process(btcoexist, + COL_OP_WIFI_POWER_STATE_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} + +void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) +{} +void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state) +{ + u8 h2c_para[4] = {0}; + u8 opcode_ver = 0; + u8 pnp_notify = 0; + + if (BTC_WIFI_PNP_SLEEP == pnp_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to SLEEP\n"); + BTC_TRACE(trace_buf); + pnp_notify = 1; + } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to WAKE UP\n"); + BTC_TRACE(trace_buf); + } + + h2c_para[0] = 0xff; /* IPS notify */ + h2c_para[1] = 0xff; /* LPS notify */ + h2c_para[2] = 0xff; /* RF state notify */ + h2c_para[3] = pnp_notify; /* pnp notify */ + + btcoexist->btc_coex_h2c_process(btcoexist, + COL_OP_WIFI_POWER_STATE_NOTIFY, + opcode_ver, &h2c_para[0], 4); +} + +void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) +{} +void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) +{ + + halbtc8822b1ant_wifi_info_notify(btcoexist); +} + +void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_stack_info *stack_info = &btcoexist->stack_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + u8 *cli_buf = btcoexist->cli_buf; + u8 u8tmp[4], i, bt_info_ext, ps_tdma_case = 0; + u16 u16tmp[4]; + u32 u32tmp[4]; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; + static u8 pop_report_in_10s = 0; + u32 phyver = 0; + boolean lte_coex_on = FALSE; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[BT Coexist info]============"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Under Manual Control]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + if (btcoexist->stop_coex_dm) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Coex is STOPPED]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + + if (psd_scan->ant_det_try_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s / %d", + "Ant PG Num/ Mech/ Pos/ RFE", + board_info->pg_ant_num, board_info->btdm_ant_num, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + rfe_type->rfe_module_type); + CL_PRINTF(cli_buf); + } else { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", + "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + rfe_type->rfe_module_type, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, + psd_scan->ant_det_result); + CL_PRINTF(cli_buf); + + if (board_info->btdm_ant_det_finish) { + if (psd_scan->ant_det_result != 12) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant Det PSD Value", + psd_scan->ant_det_psd_scan_peak_val / 100); + + CL_PRINTF(cli_buf); + } + } + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, &bt_patch_ver); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%x/ 0x%x/ 0x%x(%d)", + "CoexVer/ FwVer/ PatchVer", + glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, fw_ver, + bt_patch_ver, bt_patch_ver); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", + "Wifi channel informed to BT", + coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], + coex_dm->wifi_chnl_info[2]); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s", + "WifibHiPri/ Ccklock/ CckEverLock", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), + (coex_sta->cck_lock ? "Yes" : "No"), + (coex_sta->cck_ever_lock ? "Yes" : "No")); + CL_PRINTF(cli_buf); + + /* wifi status */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Wifi Status]============"); + CL_PRINTF(cli_buf); + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[BT Status]============"); + CL_PRINTF(cli_buf); + + pop_report_in_10s++; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = [%s/ %d/ %d/ %d] ", + "BT [status/ rssi/ retryCnt/ popCnt]", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page scan") + : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE == coex_dm->bt_status) + ? "connected-idle" : "busy")))), + coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, + coex_sta->pop_event_cnt); + CL_PRINTF(cli_buf); + + if (pop_report_in_10s >= 5) { + coex_sta->pop_event_cnt = 0; + pop_report_in_10s = 0; + } + + if (coex_sta->num_of_profile != 0) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s%s%s%s%s", + "Profiles", + ((bt_link_info->a2dp_exist) ? "A2DP," : ""), + ((bt_link_info->sco_exist) ? "SCO," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : "HID(2/18),") : ""), + ((bt_link_info->pan_exist) ? "PAN," : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = None", "Profiles"); + + CL_PRINTF(cli_buf); + + if (bt_link_info->a2dp_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", + "A2DP Rate/Bitpool/Auto_Slot", + ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), + coex_sta->a2dp_bit_pool, + ((coex_sta->is_autoslot) ? "On" : "Off")); + CL_PRINTF(cli_buf); + } + + if (bt_link_info->hid_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "HID PairNum/Forbid_Slot", + coex_sta->hid_pair_cnt, + coex_sta->forbidden_slot + ); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ 0x%x/ 0x%x", + "Role/IgnWlanAct/Feature/BLEScan", + ((bt_link_info->slave_role) ? "Slave" : "Master"), + ((coex_dm->cur_ignore_wlan_act) ? "Yes":"No"), + coex_sta->bt_coex_supported_feature, + coex_sta->bt_ble_scan_type); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "ReInit/ReLink/IgnWlact/Page/NameReq", + coex_sta->cnt_ReInit, + coex_sta->cnt_setupLink, + coex_sta->cnt_IgnWlanAct, + coex_sta->cnt_Page, + coex_sta->cnt_RemoteNameReq + ); + CL_PRINTF(cli_buf); + + halbtc8822b1ant_read_score_board(btcoexist, &u16tmp[0]); + + if ((coex_sta->bt_reg_vendor_ae == 0xffff) || + (coex_sta->bt_reg_vendor_ac == 0xffff)) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", + ((coex_sta->bt_reg_vendor_ae & BIT(4))>>4), + coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); + CL_PRINTF(cli_buf); + + for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { + if (coex_sta->bt_info_c2h_cnt[i]) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", + glbt_info_src_8822b_1ant[i], + coex_sta->bt_info_c2h[i][0], + coex_sta->bt_info_c2h[i][1], + coex_sta->bt_info_c2h[i][2], + coex_sta->bt_info_c2h[i][3], + coex_sta->bt_info_c2h[i][4], + coex_sta->bt_info_c2h[i][5], + coex_sta->bt_info_c2h[i][6], + coex_sta->bt_info_c2h_cnt[i]); + CL_PRINTF(cli_buf); + } + } + + + if (btcoexist->manual_control) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[mechanisms] (before Manual)============"); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[mechanisms]============"); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "SM[LowPenaltyRA]", + coex_dm->cur_low_penalty_ra); + CL_PRINTF(cli_buf); + + ps_tdma_case = coex_dm->cur_ps_tdma; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x case-%d (%s,%s)", + "PS TDMA", + coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], + coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], + coex_dm->ps_tdma_para[4], ps_tdma_case, + (coex_dm->cur_ps_tdma_on ? "On" : "Off"), + (coex_dm->auto_tdma_adjust ? "Adj" : "Fix")); + + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d", + "WL/BT Coex Table Type", + coex_sta->coex_table_type); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x6c0/0x6c4/0x6c8(coexTable)", + u32tmp[0], u32tmp[1], u32tmp[2]); + CL_PRINTF(cli_buf); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x", + "0x778/0x6cc/IgnWlanAct", + u8tmp[0], u32tmp[0], coex_dm->cur_ignore_wlan_act); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa0); + u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa4); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "LTE Coex Table W_L/B_L", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa8); + u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xac); + u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb0); + u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb4); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "LTE Break Table W_L/B_L/L_W/L_B", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, + u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); + CL_PRINTF(cli_buf); + + /* Hw setting */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Hw setting]============"); + CL_PRINTF(cli_buf); +#if 0 + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x430); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x434); + u16tmp[0] = btcoexist->btc_read_2byte(btcoexist, 0x42a); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x456); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/0x%x/0x%x/0x%x", + "0x430/0x434/0x42a/0x456", + u32tmp[0], u32tmp[1], u16tmp[0], u8tmp[0]); + CL_PRINTF(cli_buf); +#endif + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %s", + "LTE CoexOn/Path Ctrl Owner", + (int)((u32tmp[0]&BIT(7)) >> 7), + ((u8tmp[0]&BIT(2)) ? "WL" : "BT")); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "LTE 3Wire/OPMode/UART/UARTMode", + (int)((u32tmp[0]&BIT(6)) >> 6), + (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), + (int)((u32tmp[0]&BIT(3)) >> 3), + (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %s", + "GNT_WL_SWCtrl/GNT_BT_SWCtrl/Dbg", + (int)((u32tmp[0]&BIT(12)) >> 12), + (int)((u32tmp[0]&BIT(14)) >> 14), + ((u8tmp[0]&BIT(3)) ? "On" : "Off")); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "GNT_WL/GNT_BT/LTE_Busy/UART_Busy", + (int)((u32tmp[0]&BIT(2)) >> 2), + (int)((u32tmp[0]&BIT(3)) >> 3), + (int)((u32tmp[0]&BIT(1)) >> 1), (int)(u32tmp[0]&BIT(0))); + CL_PRINTF(cli_buf); + + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "0x4c6[4]/0x40[5] (WL/BT PTA)", + (int)((u8tmp[0] & BIT(4)) >> 4), + (int)((u8tmp[1] & BIT(5)) >> 5)); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x/ %s", + "0x550(bcn ctrl)/0x522/4-RxAGC", + u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off"); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xda0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xda4); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0xda8); + u32tmp[3] = btcoexist->btc_read_4byte(btcoexist, 0xcf0); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xa5b); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0xa5c); + + fa_ofdm = ((u32tmp[0] & 0xffff0000) >> 16) + ((u32tmp[1] & 0xffff0000) + >> 16) + (u32tmp[1] & 0xffff) + (u32tmp[2] & 0xffff) + + ((u32tmp[3] & 0xffff0000) >> 16) + (u32tmp[3] & + 0xffff); + fa_cck = (u8tmp[0] << 8) + u8tmp[1]; + + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xc50); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "0xc50/OFDM-CCA/OFDM-FA/CCK-FA", + u32tmp[1] & 0xff, u32tmp[0] & 0xffff, fa_ofdm, fa_cck); + CL_PRINTF(cli_buf); + + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11n-Agg", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_agg); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11n-Agg", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_agg); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(high-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x774(low-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx); + CL_PRINTF(cli_buf); +#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 1) + /* halbtc8822b1ant_monitor_bt_ctr(btcoexist); */ +#endif + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); +} +void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{} +void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) +{} +void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, + IN u8 op_code, IN u8 op_len, IN u8 *pdata) +{ + switch (op_code) { + case BTC_DBG_SET_COEX_MANUAL_CTRL: { + boolean manual = (boolean) *pdata; + + halbtc8822b1ant_setManual(btcoexist, manual); + } + break; + default: + break; + } +} + +#else +void ex_halbtc8822b1ant_power_on_setting(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u8 u8tmp = 0x0; + u16 u16tmp = 0x0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx Execute 8822b 1-Ant PowerOn Setting!! xxxxxxxxxxxxxxxx\n"); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "Ant Det Finish = %s, Ant Det Number = %d\n", + board_info->btdm_ant_det_finish ? "Yes" : "No", + board_info->btdm_ant_num_by_ant_det); + BTC_TRACE(trace_buf); + + btcoexist->stop_coex_dm = TRUE; + + /* enable BB, REG_SYS_FUNC_EN such that we can write 0x948 correctly. */ + u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); + btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); + + /* set Path control owner to WiFi */ + halbtc8822b1ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_1ANT_PCO_WLSIDE); + + /* set GNT_BT to high */ + halbtc8822b1ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to low */ + halbtc8822b1ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_1ANT_GNT_BLOCK_RFC_BB, + BT_8822B_1ANT_GNT_CTRL_BY_SW, + BT_8822B_1ANT_SIG_STA_SET_TO_LOW); + + /* set WLAN_ACT = 0 */ + /* btcoexist->btc_write_1byte(btcoexist, 0x76e, 0x4); */ + + /* SD1 Chunchu red x issue */ + btcoexist->btc_write_1byte(btcoexist, 0xff1a, 0x0); + + halbtc8822b1ant_enable_gnt_to_gpio(btcoexist, TRUE); + + /* */ + /* S0 or S1 setting and Local register setting + * (By the setting fw can get ant number, S0/S1, ... info) + */ + /* Local setting bit define */ + /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ + /* BIT1: "0" for internal switch; "1" for external switch */ + /* BIT2: "0" for one antenna; "1" for two antenna */ + /* NOTE: here default all internal switch and 1-antenna ==> + * BIT1=0 and BIT2=0 + */ + + u8tmp = 0; + board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; + + if (btcoexist->chip_interface == BTC_INTF_USB) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_SDIO) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); + + BTC_TRACE(trace_buf); + + +} + +void ex_halbtc8822b1ant_pre_load_firmware(IN struct btc_coexist *btcoexist) +{ +} + +void ex_halbtc8822b1ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (ini hw config) **********\n"); + + halbtc8822b1ant_init_hw_config(btcoexist, TRUE, wifi_only); + btcoexist->stop_coex_dm = FALSE; +} + +void ex_halbtc8822b1ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Coex Mechanism Init!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->stop_coex_dm = FALSE; + + halbtc8822b1ant_init_coex_dm(btcoexist); + + halbtc8822b1ant_query_bt_info(btcoexist); +} + + +void ex_halbtc8822b1ant_display_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + u8 *cli_buf = btcoexist->cli_buf; + u8 u8tmp[4], i, ps_tdma_case = 0; + u16 u16tmp[4]; + u32 u32tmp[4]; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; + static u8 pop_report_in_10s = 0; + u32 phyver = 0; + boolean lte_coex_on = FALSE; + static u8 cnt = 0; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[BT Coexist info]============"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Under Manual Control]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + if (btcoexist->stop_coex_dm) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Coex is STOPPED]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + + if (psd_scan->ant_det_try_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s / %d", + "Ant PG Num/ Mech/ Pos/ RFE", + board_info->pg_ant_num, board_info->btdm_ant_num, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + rfe_type->rfe_module_type); + CL_PRINTF(cli_buf); + } else { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", + "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + rfe_type->rfe_module_type, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, + psd_scan->ant_det_result); + CL_PRINTF(cli_buf); + + if (board_info->btdm_ant_det_finish) { + + if (psd_scan->ant_det_result != 12) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant Det PSD Value", + psd_scan->ant_det_psd_scan_peak_val + / 100); + CL_PRINTF(cli_buf); + } + } + + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + + bt_coex_ver = ((coex_sta->bt_coex_supported_version & 0xff00) >> 8); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8822b_1ant, glcoex_ver_8822b_1ant, + glcoex_ver_btdesired_8822b_1ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (coex_sta->bt_disabled ? "BT-disable" : + (bt_coex_ver >= glcoex_ver_btdesired_8822b_1ant ? + "Match" : "Mis-Match")))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", + "AFH Map to BT", + coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], + coex_dm->wifi_chnl_info[2]); + CL_PRINTF(cli_buf); + + /* wifi status */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Wifi Status]============"); + CL_PRINTF(cli_buf); + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[BT Status]============"); + CL_PRINTF(cli_buf); + + pop_report_in_10s++; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", + "BT [status/ rssi/ retryCnt/ popCnt]", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") + : ((BT_8822B_1ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((coex_dm->bt_status == BT_8822B_1ANT_BT_STATUS_CONNECTED_IDLE) + ? "connected-idle" : "busy")))), + coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, + coex_sta->pop_event_cnt); + CL_PRINTF(cli_buf); + + if (pop_report_in_10s >= 5) { + coex_sta->pop_event_cnt = 0; + pop_report_in_10s = 0; + } + + if (coex_sta->num_of_profile != 0) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s%s%s%s%s", + "Profiles", + ((bt_link_info->a2dp_exist) ? + ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : + "A2DP,") : ""), + ((bt_link_info->sco_exist) ? "HFP," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : + "HID(2/18),") : ""), + ((bt_link_info->pan_exist) ? "PAN," : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = None", "Profiles"); + + CL_PRINTF(cli_buf); + + if (bt_link_info->a2dp_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", + "A2DP Rate/Bitpool/Auto_Slot", + ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), + coex_sta->a2dp_bit_pool, + ((coex_sta->is_autoslot) ? "On" : "Off") + ); + CL_PRINTF(cli_buf); + } + + if (bt_link_info->hid_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "HID PairNum/Forbid_Slot", + coex_sta->hid_pair_cnt, + coex_sta->forbidden_slot + ); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", + "Role/RoleSwCnt/IgnWlact/Feature", + ((bt_link_info->slave_role) ? "Slave" : "Master"), + coex_sta->cnt_RoleSwitch, + ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), + coex_sta->bt_coex_supported_feature); + CL_PRINTF(cli_buf); + + if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "BLEScan Type/TV/Init/Ble", + coex_sta->bt_ble_scan_type, + (coex_sta->bt_ble_scan_type & 0x1 ? + coex_sta->bt_ble_scan_para[0] : 0x0), + (coex_sta->bt_ble_scan_type & 0x2 ? + coex_sta->bt_ble_scan_para[1] : 0x0), + (coex_sta->bt_ble_scan_type & 0x4 ? + coex_sta->bt_ble_scan_para[2] : 0x0)); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "ReInit/ReLink/IgnWlact/Page/NameReq", + coex_sta->cnt_ReInit, + coex_sta->cnt_setupLink, + coex_sta->cnt_IgnWlanAct, + coex_sta->cnt_Page, + coex_sta->cnt_RemoteNameReq + ); + CL_PRINTF(cli_buf); + + halbtc8822b1ant_read_score_board(btcoexist, &u16tmp[0]); + + if ((coex_sta->bt_reg_vendor_ae == 0xffff) || + (coex_sta->bt_reg_vendor_ac == 0xffff)) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", + (int)((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), + coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); + CL_PRINTF(cli_buf); + + if (coex_sta->num_of_profile > 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", + "AFH MAP", + coex_sta->bt_afh_map[0], + coex_sta->bt_afh_map[1], + coex_sta->bt_afh_map[2], + coex_sta->bt_afh_map[3], + coex_sta->bt_afh_map[4], + coex_sta->bt_afh_map[5], + coex_sta->bt_afh_map[6], + coex_sta->bt_afh_map[7], + coex_sta->bt_afh_map[8], + coex_sta->bt_afh_map[9] + ); + CL_PRINTF(cli_buf); + } + + for (i = 0; i < BT_INFO_SRC_8822B_1ANT_MAX; i++) { + if (coex_sta->bt_info_c2h_cnt[i]) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", + glbt_info_src_8822b_1ant[i], + coex_sta->bt_info_c2h[i][0], + coex_sta->bt_info_c2h[i][1], + coex_sta->bt_info_c2h[i][2], + coex_sta->bt_info_c2h[i][3], + coex_sta->bt_info_c2h[i][4], + coex_sta->bt_info_c2h[i][5], + coex_sta->bt_info_c2h[i][6], + coex_sta->bt_info_c2h_cnt[i]); + CL_PRINTF(cli_buf); + } + } + + + if (btcoexist->manual_control) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[mechanisms] (before Manual)============"); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Mechanisms]============"); + + CL_PRINTF(cli_buf); + + ps_tdma_case = coex_dm->cur_ps_tdma; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s)", + "TDMA", + coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], + coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], + coex_dm->ps_tdma_para[4], ps_tdma_case, + (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off")); + + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", + "Table/0x6c0/0x6c4/0x6c8", + coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); + CL_PRINTF(cli_buf); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x", + "0x778/0x6cc", + u8tmp[0], u32tmp[0]); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", + "AntDiv/BtCtrlLPS/LPRA/PsFail", + ((board_info->ant_div_cfg) ? "On" : "Off"), + ((coex_sta->force_lps_ctrl) ? "On" : "Off"), + ((coex_dm->cur_low_penalty_ra) ? "On" : "Off"), + coex_sta->cnt_set_ps_state_fail); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; + + if (lte_coex_on) { + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa0); + u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa4); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "LTE Coex Table W_L/B_L", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xa8); + u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xac); + u32tmp[2] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb0); + u32tmp[3] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, + 0xb4); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "LTE Break Table W_L/B_L/L_W/L_B", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, + u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); + CL_PRINTF(cli_buf); + } + + /* Hw setting */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Hw setting]============"); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp[1] = halbtc8822b1ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", + "LTE Coex/Path Owner", + ((lte_coex_on) ? "On" : "Off"), + ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); + CL_PRINTF(cli_buf); + + if (lte_coex_on) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %d/ %d", + "LTE 3Wire/OPMode/UART/UARTMode", + (int)((u32tmp[0] & BIT(6)) >> 6), + (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), + (int)((u32tmp[0] & BIT(3)) >> 3), + (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "LTE_Busy/UART_Busy", + (int)((u32tmp[1] & BIT(1)) >> 1), + (int)(u32tmp[1] & BIT(0))); + CL_PRINTF(cli_buf); + } + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", + "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", + ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), + ((u8tmp[0] & BIT(3)) ? "On" : "Off"), + coex_sta->gnt_error_cnt); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "GNT_WL/GNT_BT", + (int)((u32tmp[1] & BIT(2)) >> 2), + (int)((u32tmp[1] & BIT(3)) >> 3)); + CL_PRINTF(cli_buf); + + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcb0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", + "0xcb0/0xcb4/0xcb8[23:16]", + u32tmp[0], u32tmp[1], u8tmp[0], + ((u8tmp[0] & 0x1) == 0x1 ? "(BTG)" : "(WL_A+G)")); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "4c[24:23]/64[0]/4c6[4]/40[5]", + (int)((u32tmp[0] & (BIT(24) | BIT(23))) >> 23), + u8tmp[2] & 0x1, + (int)((u8tmp[0] & BIT(4)) >> 4), + (int)((u8tmp[1] & BIT(5)) >> 5)); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", + "0x550/0x522/4-RxAGC/0xc50", + u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); + CL_PRINTF(cli_buf); + + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm); + CL_PRINTF(cli_buf); + + +#if 1 + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11ac", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_Err CCK/11g/11n/11ac", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht); + CL_PRINTF(cli_buf); +#endif + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", + "WlHiPri/ Locking/ Locked/ Noisy", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), + (coex_sta->cck_lock ? "Yes" : "No"), + (coex_sta->cck_ever_lock ? "Yes" : "No"), + coex_sta->wl_noisy_level); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(Hi-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x774(Lo-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx, + (bt_link_info->slave_role ? "(Slave!!)" : ( + coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); + CL_PRINTF(cli_buf); + + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); +} + +void ex_halbtc8822b1ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + + if (BTC_IPS_ENTER == type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS ENTER notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_ips = TRUE; + + /* Write WL "Active" in Score-board for LPS off */ + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, FALSE); + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ONOFF, FALSE); + halbtc8822b1ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_WLAN_OFF); + + + } else if (BTC_IPS_LEAVE == type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS LEAVE notify\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, TRUE); + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ONOFF, TRUE); + + /*leave IPS : run ini hw config (exclude wifi only)*/ + halbtc8822b1ant_init_hw_config(btcoexist, FALSE, FALSE); + /*sw all off*/ + halbtc8822b1ant_init_coex_dm(btcoexist); + /*leave IPS : Query bt info*/ + halbtc8822b1ant_query_bt_info(btcoexist); + + coex_sta->under_ips = FALSE; + } +} + +void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + static boolean pre_force_lps_on = FALSE; + + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (type == BTC_LPS_ENABLE) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS ENABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = TRUE; + + if (coex_sta->force_lps_ctrl) { /* LPS No-32K */ + /* Write WL "Active" in Score-board for PS-TDMA */ + pre_force_lps_on = TRUE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS ENABLE notify-force LPS control\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, TRUE); + } else { + /* LPS-32K, need check if this h2c 0x71 can work?? + * (2015/08/28) + */ + /* Write WL "Non-Active" in Score-board for Native-PS */ + pre_force_lps_on = FALSE; + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, FALSE); + } + } else if (BTC_LPS_DISABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS DISABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = FALSE; + + /* Write WL "Active" in Score-board for LPS off */ + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, TRUE); + + if ((!pre_force_lps_on) && (!coex_sta->force_lps_ctrl)) + halbtc8822b1ant_query_bt_info(btcoexist); + } +} + +void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_connected = FALSE; + boolean wifi_under_5g = FALSE; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + coex_sta->freeze_coexrun_by_btinfo = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (wifi_connected) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** WL connected before SCAN\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** WL is not connected before SCAN\n"); + + BTC_TRACE(trace_buf); + + halbtc8822b1ant_query_bt_info(btcoexist); + + /*2.4 g 1*/ + if (BTC_SCAN_START == type) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + /*5 g 1*/ + + if (wifi_under_5g) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (scan_notify_5g_scan_action 1) **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_wifi_under5g(btcoexist); + return; + } + + /* 2.4G.2.3*/ + coex_sta->wifi_is_high_pri_task = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (scan_notify_start action) **********\n"); + BTC_TRACE(trace_buf); + + if (!wifi_connected) { /* non-connected scan */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** wifi not connected 2g scan action 1 **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_wifi_not_connected_scan( + btcoexist); + } else { /* wifi is connected */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** wifi connected 2g scan action 2 **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_wifi_connected_scan( + btcoexist); + } + + return; + } + + if (BTC_SCAN_START_2G == type) { + coex_sta->wifi_is_high_pri_task = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (scan_notify_2g_sacn_start_for_switch_band_used) **********\n"); + BTC_TRACE(trace_buf); + + if (!wifi_connected) { /* non-connected scan */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** wifi not connected 2g scan action 3 **********\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_action_wifi_not_connected_scan( + btcoexist); + } else { /* wifi is connected */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** wifi connected 2g sacn action 4**********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_wifi_connected_scan(btcoexist); + } + } else { + coex_sta->wifi_is_high_pri_task = FALSE; + + /* 2.4G 5 WL scan finish, then get and update sacn ap numbers */ + /*5 g 4*/ + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (scan_finish_notify) **********\n"); + BTC_TRACE(trace_buf); + + if (!wifi_connected) /* non-connected scan */ + halbtc8822b1ant_action_wifi_not_connected(btcoexist); + else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** scan_finish_notify action wifi connected **********\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_action_wifi_connected(btcoexist); + } + } +} + + + +void ex_halbtc8822b1ant_scan_notify_without_bt(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + + boolean wifi_under_5g = FALSE; + + if (BTC_SCAN_START == type) { + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (wifi_under_5g) { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, + 0x3, 1); + return; + } + + /* under 2.4G */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, + 0x3, 2); + return; + } + if (BTC_SCAN_START_2G == type) + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, 2); +} + +void ex_halbtc8822b1ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (switchband_notify) **********\n"); + BTC_TRACE(trace_buf); + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + coex_sta->switch_band_notify_to = type; + /*2.4g 4.*//*5 g 2*/ + if (type == BTC_SWITCH_TO_5G) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (switchband_notify 5g action 2) **********\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_action_wifi_under5g(btcoexist); + return; + } else if (type == BTC_SWITCH_TO_24G_NOFORSCAN) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (switchband_notify BTC_SWITCH_TO_2G (no for scan)) **********\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_run_coexist_mechanism(btcoexist); + /*5 g 3*/ + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (switchband_notify 2g action 5) **********\n"); + BTC_TRACE(trace_buf); + + ex_halbtc8822b1ant_scan_notify(btcoexist, + BTC_SCAN_START_2G); + } + coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; + +} + + +void ex_halbtc8822b1ant_switchband_notify_without_bt(IN struct btc_coexist + *btcoexist, + IN u8 type) +{ + boolean wifi_under_5g = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (type == BTC_SWITCH_TO_5G) { + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, + 0x3, 1); + return; + } else if (type == BTC_SWITCH_TO_24G_NOFORSCAN) { + + if (wifi_under_5g) + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, + 0x3, 1); + + else + btcoexist->btc_write_1byte_bitmask(btcoexist, + 0xcbd, 0x3, 2); + } else { + + ex_halbtc8822b1ant_scan_notify_without_bt(btcoexist, + BTC_SCAN_START_2G); + } + +} + +void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_connected = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (connect notify) **********\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_SCAN, TRUE); + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + + if ((BTC_ASSOCIATE_5G_START == type) || + (BTC_ASSOCIATE_5G_FINISH == type)) { + + if (BTC_ASSOCIATE_5G_START == type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (5G associate start notify) **********\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_action_wifi_under5g(btcoexist); + + } else if (BTC_ASSOCIATE_5G_FINISH == type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (5G associate finish notify) **********\n"); + BTC_TRACE(trace_buf); + + } + + return; + + } + + + if (BTC_ASSOCIATE_START == type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 2G CONNECT START notify\n"); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = TRUE; + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + coex_dm->arp_cnt = 0; + + halbtc8822b1ant_action_wifi_not_connected_asso_auth(btcoexist); + + coex_sta->freeze_coexrun_by_btinfo = TRUE; + + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 2G CONNECT Finish notify\n"); + BTC_TRACE(trace_buf); + coex_sta->wifi_is_high_pri_task = FALSE; + coex_sta->freeze_coexrun_by_btinfo = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (!wifi_connected) /* non-connected scan */ + halbtc8822b1ant_action_wifi_not_connected(btcoexist); + else + halbtc8822b1ant_action_wifi_connected(btcoexist); + } + +} + +void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_under_b_mode = FALSE; + boolean wifi_under_5g = FALSE; + + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + + + + if (BTC_MEDIA_CONNECT == type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 2g media connect notify"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, TRUE); + + if (wifi_under_5g) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 5g media notify\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_action_wifi_under5g(btcoexist); + return; + } + /* Force antenna setup for no scan result issue */ + halbtc8822b1ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + /* Set CCK Tx/Rx high Pri except 11b mode */ + if (wifi_under_b_mode) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (media status notity under b mode) **********\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_write_1byte(btcoexist, 0x6cd, + 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, + 0x00); /* CCK Rx */ + } else { +#if 0 + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x10); /*CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x10); /*CCK Rx */ +#endif + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (media status notity not under b mode) **********\n"); + BTC_TRACE(trace_buf); + btcoexist->btc_write_1byte(btcoexist, 0x6cd, + 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, + 0x10); /* CCK Rx */ + } + + coex_dm->backup_arfr_cnt1 = btcoexist->btc_read_4byte(btcoexist, + 0x430); + coex_dm->backup_arfr_cnt2 = btcoexist->btc_read_4byte(btcoexist, + 0x434); + coex_dm->backup_retry_limit = btcoexist->btc_read_2byte( + btcoexist, 0x42a); + coex_dm->backup_ampdu_max_time = btcoexist->btc_read_1byte( + btcoexist, 0x456); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 2g media disconnect notify\n"); + BTC_TRACE(trace_buf); + coex_dm->arp_cnt = 0; + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, FALSE); + + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ + + coex_sta->cck_ever_lock = FALSE; + } + + halbtc8822b1ant_update_wifi_channel_info(btcoexist, type); + +} + +void ex_halbtc8822b1ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean under_4way = FALSE, wifi_under_5g = FALSE; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + if (wifi_under_5g) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 5g special packet notify\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_action_wifi_under5g(btcoexist); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (under_4way) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ---- under_4way!!\n"); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = TRUE; + coex_sta->specific_pkt_period_cnt = 2; + } else if (BTC_PACKET_ARP == type) { + + coex_dm->arp_cnt++; + + if (coex_sta->wifi_is_high_pri_task) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ARP notify -cnt = %d\n", + coex_dm->arp_cnt); + BTC_TRACE(trace_buf); + } + + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", + type); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = TRUE; + coex_sta->specific_pkt_period_cnt = 2; + } + + if (coex_sta->wifi_is_high_pri_task) + halbtc8822b1ant_action_wifi_connected_specific_packet( + btcoexist); + +} + + +void ex_halbtc8822b1ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i, rsp_source = 0; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE, + wifi_busy = FALSE; + static boolean is_scoreboard_scan = FALSE; + + if (psd_scan->is_AntDet_running) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], bt_info_notify return for AntDet is running\n"); + BTC_TRACE(trace_buf); + return; + } + + rsp_source = tmp_buf[0] & 0xf; + if (rsp_source >= BT_INFO_SRC_8822B_1ANT_MAX) + rsp_source = BT_INFO_SRC_8822B_1ANT_WIFI_FW; + coex_sta->bt_info_c2h_cnt[rsp_source]++; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, + length); + BTC_TRACE(trace_buf); + + for (i = 0; i < length; i++) { + coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; + + if (i == length - 1) { + /* last one */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } else { + /* normal */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } + } + + coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; + coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; + coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; + + if (BT_INFO_SRC_8822B_1ANT_WIFI_FW != rsp_source) { + + /* if 0xff, it means BT is under WHCK test */ + coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? TRUE : + FALSE); + + coex_sta->bt_create_connection = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? TRUE : + FALSE); + + /* unit: %, value-100 to translate to unit: dBm */ + coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + + 10; + + coex_sta->c2h_bt_remote_name_req = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? TRUE : + FALSE); + + coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & + 0x10) ? TRUE : FALSE); + + coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & + 0x9) ? TRUE : FALSE); + + coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? + TRUE : FALSE); + + coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & + BT_INFO_8822B_1ANT_B_INQ_PAGE) ? TRUE : FALSE); + + coex_sta->a2dp_bit_pool = ((( + coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? + (coex_sta->bt_info_c2h[rsp_source][6] & 0x7f) : 0); + + coex_sta->is_bt_a2dp_sink = (coex_sta->bt_info_c2h[rsp_source][6] & 0x80) ? + TRUE : FALSE; + + coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & + 0xf; + + coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; + + coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; + + coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; + + coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; + if (coex_sta->bt_retry_cnt >= 1) + coex_sta->pop_event_cnt++; + + if (coex_sta->c2h_bt_remote_name_req) + coex_sta->cnt_RemoteNameReq++; + + if (coex_sta->bt_info_ext & BIT(1)) + coex_sta->cnt_ReInit++; + + if (coex_sta->bt_info_ext & BIT(2)) { + coex_sta->cnt_setupLink++; + coex_sta->is_setupLink = TRUE; + coex_sta->bt_relink_downcount = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->is_setupLink = FALSE; + coex_sta->bt_relink_downcount = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop in BT info!!\n"); + BTC_TRACE(trace_buf); + } + + if (coex_sta->bt_info_ext & BIT(3)) + coex_sta->cnt_IgnWlanAct++; + + if (coex_sta->bt_info_ext & BIT(6)) + coex_sta->cnt_RoleSwitch++; + + if (coex_sta->bt_info_ext & BIT(7)) + coex_sta->is_bt_multi_link = TRUE; + else + coex_sta->is_bt_multi_link = FALSE; + + if (coex_sta->bt_create_connection) { + coex_sta->cnt_Page++; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, + &wifi_busy); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); + + if ((wifi_link) || (wifi_roam) || (wifi_scan) || + (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { + + is_scoreboard_scan = TRUE; + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_SCAN, TRUE); + + } else + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_SCAN, FALSE); + + } else { + if (is_scoreboard_scan) { + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_SCAN, FALSE); + is_scoreboard_scan = FALSE; + } + } + + /* Here we need to resend some wifi info to BT */ + /* because bt is reset and loss of the info. */ + + if ((!btcoexist->manual_control) && + (!btcoexist->stop_coex_dm)) { + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + /* Re-Init */ + if ((coex_sta->bt_info_ext & BIT(1))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); + BTC_TRACE(trace_buf); + if (wifi_connected) + halbtc8822b1ant_update_wifi_channel_info( + btcoexist, BTC_MEDIA_CONNECT); + else + halbtc8822b1ant_update_wifi_channel_info( + btcoexist, + BTC_MEDIA_DISCONNECT); + } + + /* If Ignore_WLanAct && not SetUp_Link */ + if ((coex_sta->bt_info_ext & BIT(3)) && + (!(coex_sta->bt_info_ext & BIT(2)))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b1ant_ignore_wlan_act(btcoexist, + FORCE_EXEC, FALSE); + } + } + + } + + if ((coex_sta->bt_info_ext & BIT(5))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); + BTC_TRACE(trace_buf); + coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt( + btcoexist); + + if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) + coex_sta->bt_ble_scan_para[0] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x1); + if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) + coex_sta->bt_ble_scan_para[1] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x2); + if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) + coex_sta->bt_ble_scan_para[2] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x4); + + } + + + halbtc8822b1ant_update_bt_link_info(btcoexist); + + halbtc8822b1ant_run_coexist_mechanism(btcoexist); +} + + +void ex_halbtc8822b1ant_rf_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); + BTC_TRACE(trace_buf); + + if (BTC_RF_ON == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned ON!!\n"); + BTC_TRACE(trace_buf); + btcoexist->stop_coex_dm = FALSE; + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ONOFF, TRUE); + + } else if (BTC_RF_OFF == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned OFF!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ONOFF, FALSE); + halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_WLAN_OFF); + /* for test : s3 bt disppear , fail rate 1/600*/ + + halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, TRUE); + + btcoexist->stop_coex_dm = TRUE; + } +} + +void ex_halbtc8822b1ant_halt_notify(IN struct btc_coexist *btcoexist) +{ + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ONOFF, FALSE); + + halbtc8822b1ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_WLAN_OFF); + /* for test : s3 bt disppear , fail rate 1/600*/ + + halbtc8822b1ant_ignore_wlan_act(btcoexist, FORCE_EXEC, TRUE); + + ex_halbtc8822b1ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); + btcoexist->stop_coex_dm = TRUE; +} + + +void ex_halbtc8822b1ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state) +{ + boolean wifi_under_5g = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((pnp_state == BTC_WIFI_PNP_SLEEP) || + (pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to SLEEP\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE | + BT_8822B_1ANT_SCOREBOARD_ONOFF | + BT_8822B_1ANT_SCOREBOARD_SCAN | + BT_8822B_1ANT_SCOREBOARD_UNDERTEST, + FALSE); + + if (pnp_state == BTC_WIFI_PNP_SLEEP_KEEP_ANT) { + + if (wifi_under_5g) + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_5G_RUNTIME); + else + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_1ANT_PHASE_2G_RUNTIME); + } else { + + halbtc8822b1ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_1ANT_PHASE_WLAN_OFF); + } + + btcoexist->stop_coex_dm = TRUE; + } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to WAKE UP\n"); + BTC_TRACE(trace_buf); +#if 0 + halbtc8822b1ant_post_state_to_bt(btcoexist, + BT_8822B_1ANT_SCOREBOARD_ACTIVE | + BT_8822B_1ANT_SCOREBOARD_ONOFF, + TRUE); +#endif + btcoexist->stop_coex_dm = FALSE; + } +} + +void ex_halbtc8822b1ant_coex_dm_reset(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], *****************Coex DM Reset*****************\n"); + BTC_TRACE(trace_buf); + + halbtc8822b1ant_init_hw_config(btcoexist, FALSE, FALSE); + halbtc8822b1ant_init_coex_dm(btcoexist); +} + +void ex_halbtc8822b1ant_periodical(IN struct btc_coexist *btcoexist) +{ + boolean bt_relink_finish = FALSE; + +#if 0 + boolean rf4ce_connected = FALSE; +#endif + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ==========================Periodical===========================\n"); + BTC_TRACE(trace_buf); + +#if (BT_AUTO_REPORT_ONLY_8822B_1ANT == 0) + halbtc8822b1ant_query_bt_info(btcoexist); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ==========================Periodical-auto report only===========================\n"); + BTC_TRACE(trace_buf); + +#endif + + halbtc8822b1ant_monitor_bt_ctr(btcoexist); + halbtc8822b1ant_monitor_wifi_ctr(btcoexist); + + halbtc8822b1ant_monitor_bt_enable_disable(btcoexist); + +#if 0 + /*RF4CE for arris , rf4ce always on*/ + btcoexist->btc_get(btcoexist, BTC_GET_BL_RF4CE_CONNECTED, &rf4ce_connected); + if (rf4ce_connected){ + btcoexist->btc_write_1byte_bitmask( + btcoexist, 0x45e, 0x8, 0x1); + + halbtc8822b1ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, + 50); + + halbtc8822b1ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 1); + return; + } +#endif + + if (coex_sta->bt_relink_downcount != 0) { + coex_sta->bt_relink_downcount--; + + if (coex_sta->bt_relink_downcount == 0) { + coex_sta->is_setupLink = FALSE; + bt_relink_finish = TRUE; + } + } + + /* for 4-way, DHCP, EAPOL packet */ + if (coex_sta->specific_pkt_period_cnt > 0) { + + coex_sta->specific_pkt_period_cnt--; + + if ((coex_sta->specific_pkt_period_cnt == 0) && + (coex_sta->wifi_is_high_pri_task)) + coex_sta->wifi_is_high_pri_task = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", + (coex_sta->wifi_is_high_pri_task ? "Yes" : + "No")); + BTC_TRACE(trace_buf); + } + + if (halbtc8822b1ant_is_wifi_status_changed(btcoexist) || (bt_relink_finish) + || (coex_sta->is_set_ps_state_fail)) + halbtc8822b1ant_run_coexist_mechanism(btcoexist); +} + +void ex_halbtc8822b1ant_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ +} + +void ex_halbtc8822b1ant_antenna_isolation(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ + + +} + +void ex_halbtc8822b1ant_psd_scan(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ + + +} + +void ex_halbtc8822b1ant_display_ant_detection(IN struct btc_coexist *btcoexist) +{ + +} + +void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, + IN u8 op_code, IN u8 op_len, IN u8 *pdata) +{} +#endif /* #if(BTC_COEX_OFFLOAD == 1) */ + +#endif + +#else + +void ex_halbtc8822b1ant_switch_band_without_bt(IN struct btc_coexist *btcoexist, + IN boolean wifi_only_5g) +{ + /* ant switch WL2G or WL5G*/ + if (wifi_only_5g) + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, 1); + + else + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x3, 2); + +} + +#endif /* #if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8822b1Ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b1ant.h similarity index 80% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8822b1Ant.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b1ant.h index 4f091f17bfe5..0ba11936dcc6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtc8822b1Ant.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b1ant.h @@ -6,6 +6,7 @@ /* ******************************************* * The following is for 8822B 1ANT BT Co-exist definition * ******************************************* */ +#define BT_8822B_1ANT_COEX_DBG 0 #define BT_AUTO_REPORT_ONLY_8822B_1ANT 1 #define BT_INFO_8822B_1ANT_B_FTP BIT(7) @@ -22,7 +23,8 @@ #define BTC_RSSI_COEX_THRESH_TOL_8822B_1ANT 2 -#define BT_8822B_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ +#define BT_8822B_1ANT_WIFI_NOISY_THRESH 150 /* max: 255 */ +#define BT_8822B_1ANT_DEFAULT_ISOLATION 15 /* unit: dB */ /* for Antenna detection */ #define BT_8822B_1ANT_ANTDET_PSDTHRES_BACKGROUND 50 @@ -34,7 +36,7 @@ #define BT_8822B_1ANT_ANTDET_COEXMECHANISMSWITCH_ENABLE 0 #define BT_8822B_1ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 -#define BT_8822B_1ANT_WIFI_NOISY_THRESH 30 /* max: 255 */ + enum bt_8822b_1ant_signal_state { @@ -114,9 +116,11 @@ enum bt_8822b_1ant_coex_algo { BT_8822B_1ANT_COEX_ALGO_PANHS = 0x6, BT_8822B_1ANT_COEX_ALGO_PANEDR_A2DP = 0x7, BT_8822B_1ANT_COEX_ALGO_PANEDR_HID = 0x8, - BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, - BT_8822B_1ANT_COEX_ALGO_HID_A2DP = 0xa, - BT_8822B_1ANT_COEX_ALGO_MAX = 0xb, + BT_8822B_1ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, + BT_8822B_1ANT_COEX_ALGO_HID_A2DP = 0xa, + BT_8822B_1ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, + BT_8822B_1ANT_COEX_ALGO_A2DPSINK = 0xc, + BT_8822B_1ANT_COEX_ALGO_MAX }; enum bt_8822b_1ant_ext_ant_switch_type { @@ -142,9 +146,9 @@ enum bt_8822b_1ant_ext_ant_switch_pos_type { BT_8822B_1ANT_EXT_ANT_SWITCH_TO_MAX }; -enum bt_8822b_1ant_phase{ +enum bt_8822b_1ant_phase { BT_8822B_1ANT_PHASE_COEX_INIT = 0x0, - BT_8822B_1ANT_PHASE_WLANONLY_INIT = 0x1, + BT_8822B_1ANT_PHASE_WLANONLY_INIT = 0x1, BT_8822B_1ANT_PHASE_WLAN_OFF = 0x2, BT_8822B_1ANT_PHASE_2G_RUNTIME = 0x3, BT_8822B_1ANT_PHASE_5G_RUNTIME = 0x4, @@ -152,6 +156,14 @@ enum bt_8822b_1ant_phase{ BT_8822B_1ANT_PHASE_MAX }; +/*ADD SCOREBOARD TO FIX BT LPS 32K ISSUE WHILE WL BUSY*/ +enum bt_8822b_1ant_Scoreboard { + BT_8822B_1ANT_SCOREBOARD_ACTIVE = BIT(0), + BT_8822B_1ANT_SCOREBOARD_ONOFF = BIT(1), + BT_8822B_1ANT_SCOREBOARD_SCAN = BIT(2), + BT_8822B_1ANT_SCOREBOARD_UNDERTEST = BIT(3), + BT_8822B_1ANT_SCOREBOARD_WLBUSY = BIT(6) +}; struct coex_dm_8822b_1ant { /* hw setting */ @@ -173,6 +185,8 @@ struct coex_dm_8822b_1ant { u8 cur_lps; u8 pre_rpwm; u8 cur_rpwm; + u8 pre_fw_dac_swing_lvl; + u8 cur_fw_dac_swing_lvl; /* sw mechanism */ boolean pre_low_penalty_ra; @@ -212,6 +226,8 @@ struct coex_dm_8822b_1ant { u32 cur_ext_ant_switch_status; u8 error_condition; + boolean pre_agc_table_en; + boolean cur_agc_table_en; }; struct coex_sta_8822b_1ant { @@ -221,7 +237,6 @@ struct coex_sta_8822b_1ant { boolean a2dp_exist; boolean hid_exist; boolean pan_exist; - boolean bt_hi_pri_link_exist; u8 num_of_profile; boolean under_lps; @@ -231,63 +246,105 @@ struct coex_sta_8822b_1ant { u32 high_priority_rx; u32 low_priority_tx; u32 low_priority_rx; + boolean is_hiPri_rx_overhead; s8 bt_rssi; - boolean bt_tx_rx_mask; u8 pre_bt_rssi_state; u8 pre_wifi_rssi_state[4]; - boolean c2h_bt_info_req_sent; u8 bt_info_c2h[BT_INFO_SRC_8822B_1ANT_MAX][10]; u32 bt_info_c2h_cnt[BT_INFO_SRC_8822B_1ANT_MAX]; boolean bt_whck_test; boolean c2h_bt_inquiry_page; - boolean c2h_bt_page; /* Add for win8.1 page out issue */ + boolean c2h_bt_remote_name_req; + boolean c2h_bt_page; /* Add for win8.1 page out issue */ boolean wifi_is_high_pri_task; /* Add for win8.1 page out issue */ - u8 bt_retry_cnt; + u8 bt_info_ext; + u8 bt_info_ext2; u32 pop_event_cnt; u8 scan_ap_num; + u8 bt_retry_cnt; u32 crc_ok_cck; u32 crc_ok_11g; u32 crc_ok_11n; - u32 crc_ok_11n_agg; + u32 crc_ok_11n_vht; u32 crc_err_cck; u32 crc_err_11g; u32 crc_err_11n; - u32 crc_err_11n_agg; + u32 crc_err_11n_vht; boolean cck_lock; boolean pre_ccklock; boolean cck_ever_lock; u8 coex_table_type; - boolean force_lps_on; - u32 wrong_profile_notification; + boolean force_lps_ctrl; boolean concurrent_rx_mode_on; - u32 special_pkt_period_cnt; - u16 score_board; + u8 isolation_btween_wb; /* 0~ 50 */ u8 a2dp_bit_pool; u8 cut_version; - boolean acl_busy; - boolean wl_rf_off_on_event; - boolean bt_create_connection; - boolean run_time_state; + boolean acl_busy; + boolean bt_create_connection; u32 bt_coex_supported_feature; u32 bt_coex_supported_version; + + u8 bt_ble_scan_type; + u32 bt_ble_scan_para[3]; + + boolean run_time_state; + boolean freeze_coexrun_by_btinfo; + + boolean is_A2DP_3M; + boolean voice_over_HOGP; + u8 bt_info; + boolean is_autoslot; + u8 forbidden_slot; + u8 hid_busy_num; + u8 hid_pair_cnt; + + u32 cnt_RemoteNameReq; + u32 cnt_setupLink; + u32 cnt_ReInit; + u32 cnt_IgnWlanAct; + u32 cnt_Page; + u32 cnt_RoleSwitch; + + u16 bt_reg_vendor_ac; + u16 bt_reg_vendor_ae; + + boolean is_setupLink; + u8 wl_noisy_level; + u32 gnt_error_cnt; + u8 bt_afh_map[10]; + u8 bt_relink_downcount; + boolean is_tdma_btautoslot; + boolean is_tdma_btautoslot_hang; + + u8 switch_band_notify_to; + boolean is_rf_state_off; + + boolean is_hid_low_pri_tx_overhead; + boolean is_bt_multi_link; + boolean is_bt_a2dp_sink; + boolean rf4ce_enabled; + + boolean is_set_ps_state_fail; + u8 cnt_set_ps_state_fail; }; -struct rfe_type_8822b_1ant{ +struct rfe_type_8822b_1ant { - u8 rfe_module_type; + u8 rfe_module_type; boolean ext_ant_switch_exist; - u8 ext_ant_switch_type; - u8 ext_ant_switch_ctrl_polarity; /* iF 0: ANTSW(rfe_sel9)=0, ANTSWB(rfe_sel8)=1 => Ant to BT/5G */ + u8 ext_ant_switch_type; + /* iF 0: ANTSW(rfe_sel9)=0, ANTSWB(rfe_sel8)=1 => Ant to BT/5G */ + u8 ext_ant_switch_ctrl_polarity; }; @@ -330,6 +387,7 @@ struct psdscan_sta_8822b_1ant { u32 psd_gen_count; boolean is_psd_running; boolean is_psd_show_max_only; + boolean is_AntDet_running; }; /* ******************************************* @@ -346,8 +404,13 @@ void ex_halbtc8822b1ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8822b1ant_scan_notify(IN struct btc_coexist *btcoexist, IN u8 type); +void ex_halbtc8822b1ant_scan_notify_without_bt(IN struct btc_coexist *btcoexist, + IN u8 type); void ex_halbtc8822b1ant_switchband_notify(IN struct btc_coexist *btcoexist, - IN u8 type); + IN u8 type); +void ex_halbtc8822b1ant_switchband_notify_without_bt(IN struct btc_coexist + *btcoexist, + IN u8 type); void ex_halbtc8822b1ant_connect_notify(IN struct btc_coexist *btcoexist, IN u8 type); void ex_halbtc8822b1ant_media_status_notify(IN struct btc_coexist *btcoexist, @@ -386,7 +449,9 @@ void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, #define ex_halbtc8822b1ant_ips_notify(btcoexist, type) #define ex_halbtc8822b1ant_lps_notify(btcoexist, type) #define ex_halbtc8822b1ant_scan_notify(btcoexist, type) +#define ex_halbtc8822b1ant_scan_notify_without_bt(btcoexist, type) #define ex_halbtc8822b1ant_switchband_notify(btcoexist, type) +#define ex_halbtc8822b1ant_switchband_notify_without_bt(btcoexist, type) #define ex_halbtc8822b1ant_connect_notify(btcoexist, type) #define ex_halbtc8822b1ant_media_status_notify(btcoexist, type) #define ex_halbtc8822b1ant_specific_packet_notify(btcoexist, type) @@ -404,5 +469,12 @@ void ex_halbtc8822b1ant_dbg_control(IN struct btc_coexist *btcoexist, #define ex_halbtc8822b1ant_display_ant_detection(btcoexist) #define ex_halbtc8822b1ant_dbg_control(btcoexist, op_code, op_len, pdata) #endif +#else + +void ex_halbtc8822b1ant_init_hw_config_without_bt(IN struct btc_coexist + *btcoexist); +void ex_halbtc8822b1ant_switch_band_without_bt(IN struct btc_coexist *btcoexist, + IN boolean wifi_only_5g); + #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.c new file mode 100644 index 000000000000..d111bcf67ad6 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.c @@ -0,0 +1,6112 @@ +/* ************************************************************ + * Description: + * + * This file is for RTL8822B Co-exist mechanism + * + * History + * 2012/11/15 Cosa first check in. + * + * ************************************************************ */ + +/* ************************************************************ + * include files + * ************************************************************ */ +#include "mp_precomp.h" + +#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + +#if (RTL8822B_SUPPORT == 1) +/* ************************************************************ + * Global variables, these are static variables + * ************************************************************ */ +static u8 *trace_buf = &gl_btc_trace_buf[0]; +static struct coex_dm_8822b_2ant glcoex_dm_8822b_2ant; +static struct coex_dm_8822b_2ant *coex_dm = &glcoex_dm_8822b_2ant; +static struct coex_sta_8822b_2ant glcoex_sta_8822b_2ant; +static struct coex_sta_8822b_2ant *coex_sta = &glcoex_sta_8822b_2ant; +static struct psdscan_sta_8822b_2ant gl_psd_scan_8822b_2ant; +static struct psdscan_sta_8822b_2ant *psd_scan = &gl_psd_scan_8822b_2ant; +static struct rfe_type_8822b_2ant gl_rfe_type_8822b_2ant; +static struct rfe_type_8822b_2ant *rfe_type = &gl_rfe_type_8822b_2ant; + +static const char *const glbt_info_src_8822b_2ant[] = { + "BT Info[wifi fw]", + "BT Info[bt rsp]", + "BT Info[bt auto report]", +}; + +static u32 glcoex_ver_date_8822b_2ant = 20170707; +static u32 glcoex_ver_8822b_2ant = 0x46; +static u32 glcoex_ver_btdesired_8822b_2ant = 0x42; + + +/* ************************************************************ + * local function proto type if needed + * ************************************************************ + * ************************************************************ + * local function start with halbtc8822b2ant_ + * ************************************************************ */ +static +u8 halbtc8822b2ant_bt_rssi_state(IN struct btc_coexist *btcoexist, + u8 *ppre_bt_rssi_state, u8 level_num, + u8 rssi_thresh, u8 rssi_thresh1) +{ + s32 bt_rssi = 0; + u8 bt_rssi_state = *ppre_bt_rssi_state; + + bt_rssi = coex_sta->bt_rssi; + + if (level_num == 2) { + if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT Rssi thresh error!!\n"); + BTC_TRACE(trace_buf); + return *ppre_bt_rssi_state; + } + + if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_LOW) || + (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (bt_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((*ppre_bt_rssi_state == BTC_RSSI_STATE_MEDIUM) || + (*ppre_bt_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { + if (bt_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) + bt_rssi_state = BTC_RSSI_STATE_HIGH; + else if (bt_rssi < rssi_thresh) + bt_rssi_state = BTC_RSSI_STATE_LOW; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (bt_rssi < rssi_thresh1) + bt_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + bt_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + *ppre_bt_rssi_state = bt_rssi_state; + + return bt_rssi_state; +} + + +static +u8 halbtc8822b2ant_wifi_rssi_state(IN struct btc_coexist *btcoexist, + IN u8 *pprewifi_rssi_state, IN u8 level_num, IN u8 rssi_thresh, + IN u8 rssi_thresh1) +{ + s32 wifi_rssi = 0; + u8 wifi_rssi_state = *pprewifi_rssi_state; + + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + + if (level_num == 2) { + if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || + (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else { + if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } else if (level_num == 3) { + if (rssi_thresh > rssi_thresh1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi RSSI thresh error!!\n"); + BTC_TRACE(trace_buf); + return *pprewifi_rssi_state; + } + + if ((*pprewifi_rssi_state == BTC_RSSI_STATE_LOW) || + (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_LOW)) { + if (wifi_rssi >= (rssi_thresh + + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_LOW; + } else if ((*pprewifi_rssi_state == BTC_RSSI_STATE_MEDIUM) || + (*pprewifi_rssi_state == BTC_RSSI_STATE_STAY_MEDIUM)) { + if (wifi_rssi >= (rssi_thresh1 + + BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT)) + wifi_rssi_state = BTC_RSSI_STATE_HIGH; + else if (wifi_rssi < rssi_thresh) + wifi_rssi_state = BTC_RSSI_STATE_LOW; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_MEDIUM; + } else { + if (wifi_rssi < rssi_thresh1) + wifi_rssi_state = BTC_RSSI_STATE_MEDIUM; + else + wifi_rssi_state = BTC_RSSI_STATE_STAY_HIGH; + } + } + + *pprewifi_rssi_state = wifi_rssi_state; + + return wifi_rssi_state; +} + + +static +void halbtc8822b2ant_coex_switch_threshold(IN struct btc_coexist *btcoexist, + IN u8 isolation_measuared) +{ + s8 interference_wl_tx = 0, interference_bt_tx = 0; + + + interference_wl_tx = BT_8822B_2ANT_WIFI_MAX_TX_POWER - + isolation_measuared; + interference_bt_tx = BT_8822B_2ANT_BT_MAX_TX_POWER - + isolation_measuared; + + + + coex_sta->wifi_coex_thres = BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; + coex_sta->wifi_coex_thres2 = BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES2; + + coex_sta->bt_coex_thres = BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES1; + coex_sta->bt_coex_thres2 = BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES2; + + +#if 0 + coex_sta->wifi_coex_thres = interference_wl_tx + BT_8822B_2ANT_WIFI_SIR_THRES1; + coex_sta->wifi_coex_thres2 = interference_wl_tx + BT_8822B_2ANT_WIFI_SIR_THRES2; + + coex_sta->bt_coex_thres = interference_bt_tx + BT_8822B_2ANT_BT_SIR_THRES1; + coex_sta->bt_coex_thres2 = interference_bt_tx + BT_8822B_2ANT_BT_SIR_THRES2; +#endif + + + + + +#if 0 + if (BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - + BT_8822B_2ANT_DEFAULT_ISOLATION)) + coex_sta->wifi_coex_thres = BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES1; + else + coex_sta->wifi_coex_thres = BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - + BT_8822B_2ANT_DEFAULT_ISOLATION); + + if (BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES1 < (isolation_measuared - + BT_8822B_2ANT_DEFAULT_ISOLATION)) + coex_sta->bt_coex_thres = BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES1; + else + coex_sta->bt_coex_thres = BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES1 - (isolation_measuared - + BT_8822B_2ANT_DEFAULT_ISOLATION); + +#endif +} + +static +void halbtc8822b2ant_query_bt_info(IN struct btc_coexist *btcoexist) +{ + u8 h2c_parameter[1] = {0}; + + if (coex_sta->bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No query BT info because BT is disabled!\n"); + BTC_TRACE(trace_buf); + return; + } + + + h2c_parameter[0] |= BIT(0); /* trigger */ + + btcoexist->btc_fill_h2c(btcoexist, 0x61, 1, h2c_parameter); +} + + +static +void halbtc8822b2ant_monitor_bt_ctr(IN struct btc_coexist *btcoexist) +{ + u32 reg_hp_txrx, reg_lp_txrx, u32tmp; + u32 reg_hp_tx = 0, reg_hp_rx = 0, reg_lp_tx = 0, reg_lp_rx = 0; + static u8 num_of_bt_counter_chk = 0, cnt_slave = 0, cnt_autoslot_hang = 0; + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + reg_hp_txrx = 0x770; + reg_lp_txrx = 0x774; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_hp_txrx); + reg_hp_tx = u32tmp & MASKLWORD; + reg_hp_rx = (u32tmp & MASKHWORD) >> 16; + + u32tmp = btcoexist->btc_read_4byte(btcoexist, reg_lp_txrx); + reg_lp_tx = u32tmp & MASKLWORD; + reg_lp_rx = (u32tmp & MASKHWORD) >> 16; + + coex_sta->high_priority_tx = reg_hp_tx; + coex_sta->high_priority_rx = reg_hp_rx; + coex_sta->low_priority_tx = reg_lp_tx; + coex_sta->low_priority_rx = reg_lp_rx; + + + /* reset counter */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, 0xc); + + if ((coex_sta->low_priority_tx > 1050) && + (!coex_sta->c2h_bt_inquiry_page)) + coex_sta->pop_event_cnt++; + + if ((coex_sta->low_priority_rx >= 950) && + (coex_sta->low_priority_rx >= coex_sta->low_priority_tx) + && (!coex_sta->under_ips) && (!coex_sta->c2h_bt_inquiry_page) && + (coex_sta->bt_link_exist)) { + if (cnt_slave >= 2) { + bt_link_info->slave_role = TRUE; + cnt_slave = 2; + } else { + cnt_slave++; + } + } else { + if (cnt_slave == 0) { + bt_link_info->slave_role = FALSE; + cnt_slave = 0; + } else { + cnt_slave--; + } + + } + + if (coex_sta->is_tdma_btautoslot) { + if ((coex_sta->low_priority_tx >= 1300) && + (coex_sta->low_priority_rx <= 150)) { + if (cnt_autoslot_hang >= 2) { + coex_sta->is_tdma_btautoslot_hang = TRUE; + cnt_autoslot_hang = 2; + } else { + cnt_autoslot_hang++; + } + } else { + if (cnt_autoslot_hang == 0) { + coex_sta->is_tdma_btautoslot_hang = FALSE; + cnt_autoslot_hang = 0; + } else { + cnt_autoslot_hang--; + } + } + } + + if (coex_sta->sco_exist) { + if ((coex_sta->high_priority_tx >= 400) && + (coex_sta->high_priority_rx >= 400)) + coex_sta->is_eSCO_mode = FALSE; + else + coex_sta->is_eSCO_mode = TRUE; + } + + if (bt_link_info->hid_only) { + if (coex_sta->low_priority_rx > 50) + coex_sta->is_hid_low_pri_tx_overhead = true; + else + coex_sta->is_hid_low_pri_tx_overhead = false; + } + + if ((coex_sta->high_priority_tx == 0) && + (coex_sta->high_priority_rx == 0) && + (coex_sta->low_priority_tx == 0) && + (coex_sta->low_priority_rx == 0)) { + num_of_bt_counter_chk++; + if (num_of_bt_counter_chk >= 3) { + halbtc8822b2ant_query_bt_info(btcoexist); + num_of_bt_counter_chk = 0; + } + } + +} + +static +void halbtc8822b2ant_monitor_wifi_ctr(IN struct btc_coexist *btcoexist) +{ +#if 1 + s32 wifi_rssi = 0; + boolean wifi_busy = FALSE, wifi_under_b_mode = FALSE, + wifi_scan = FALSE; + boolean bt_idle = FALSE; + static u8 cck_lock_counter = 0, wl_noisy_count0 = 0, + wl_noisy_count1 = 3, wl_noisy_count2 = 0; + u32 total_cnt, cck_cnt; + u32 cnt_crcok = 0, cnt_crcerr = 0; + static u8 cnt = 0; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_S4_WIFI_RSSI, &wifi_rssi); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + + coex_sta->crc_ok_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_CCK); + coex_sta->crc_ok_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_LEGACY); + coex_sta->crc_ok_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_HT); + coex_sta->crc_ok_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_OK_VHT); + + coex_sta->crc_err_cck = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_CCK); + coex_sta->crc_err_11g = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_LEGACY); + coex_sta->crc_err_11n = btcoexist->btc_phydm_query_PHY_counter( + btcoexist, PHYDM_INFO_CRC32_ERROR_HT); + coex_sta->crc_err_11n_vht = + btcoexist->btc_phydm_query_PHY_counter( + btcoexist, + PHYDM_INFO_CRC32_ERROR_VHT); + + cnt_crcok = coex_sta->crc_ok_cck + coex_sta->crc_ok_11g + + coex_sta->crc_ok_11n + + coex_sta->crc_ok_11n_vht; + + cnt_crcerr = coex_sta->crc_err_cck + coex_sta->crc_err_11g + + coex_sta->crc_err_11n + + coex_sta->crc_err_11n_vht; + + if ((wifi_busy) && (cnt_crcerr != 0)) { + + coex_sta->now_crc_ratio = cnt_crcok/cnt_crcerr; + + if (cnt == 0) + coex_sta->acc_crc_ratio = coex_sta->now_crc_ratio; + else + coex_sta->acc_crc_ratio = (coex_sta->acc_crc_ratio * 7 + + coex_sta->now_crc_ratio * 3)/10; + + if (cnt >= 10) + cnt = 0; + else + cnt++; + } + + cck_cnt = coex_sta->crc_ok_cck + coex_sta->crc_err_cck; + + if ((coex_dm->bt_status == + BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE) || + (coex_dm->bt_status == + BT_8822B_2ANT_BT_STATUS_CONNECTED_IDLE) || + (coex_sta->bt_disabled)) + bt_idle = TRUE; + + if (cck_cnt > 250) { + if (wl_noisy_count2 < 3) + wl_noisy_count2++; + + if (wl_noisy_count2 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count1 = 0; + } + + } else if (cck_cnt < 50) { + if (wl_noisy_count0 < 3) + wl_noisy_count0++; + + if (wl_noisy_count0 == 3) { + wl_noisy_count1 = 0; + wl_noisy_count2 = 0; + } + + } else { + if (wl_noisy_count1 < 3) + wl_noisy_count1++; + + if (wl_noisy_count1 == 3) { + wl_noisy_count0 = 0; + wl_noisy_count2 = 0; + } + } + + if (wl_noisy_count2 == 3) + coex_sta->wl_noisy_level = 2; + else if (wl_noisy_count1 == 3) + coex_sta->wl_noisy_level = 1; + else + coex_sta->wl_noisy_level = 0; + + if ((wifi_busy) && (wifi_rssi >= 30) && (!wifi_under_b_mode)) { + total_cnt = cnt_crcok; + + if ((coex_dm->bt_status == + BT_8822B_1ANT_BT_STATUS_ACL_BUSY) || + (coex_dm->bt_status == + BT_8822B_1ANT_BT_STATUS_ACL_SCO_BUSY) || + (coex_dm->bt_status == + BT_8822B_1ANT_BT_STATUS_SCO_BUSY)) { + if (coex_sta->crc_ok_cck > (total_cnt - + coex_sta->crc_ok_cck)) { + if (cck_lock_counter < 3) + cck_lock_counter++; + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + } else { + if (cck_lock_counter > 0) + cck_lock_counter--; + } + + if (!coex_sta->pre_ccklock) { + + if (cck_lock_counter >= 3) + coex_sta->cck_lock = TRUE; + else + coex_sta->cck_lock = FALSE; + } else { + if (cck_lock_counter == 0) + coex_sta->cck_lock = FALSE; + else + coex_sta->cck_lock = TRUE; + } + + if (coex_sta->cck_lock) + coex_sta->cck_ever_lock = TRUE; + + coex_sta->pre_ccklock = coex_sta->cck_lock; + +#endif +} + + +static +boolean halbtc8822b2ant_is_wifibt_status_changed(IN struct btc_coexist + *btcoexist) +{ + static boolean pre_wifi_busy = FALSE, pre_under_4way = FALSE, + pre_bt_hs_on = FALSE, pre_bt_off = FALSE, + pre_bt_slave = FALSE, pre_hid_low_pri_tx_overhead = FALSE, + pre_wifi_under_lps = FALSE, pre_bt_setup_link = FALSE; + static u8 pre_hid_busy_num = 0, pre_wl_noisy_level = 0; + boolean wifi_busy = FALSE, under_4way = FALSE, bt_hs_on = FALSE; + boolean wifi_connected = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (coex_sta->bt_disabled != pre_bt_off) { + pre_bt_off = coex_sta->bt_disabled; + + if (coex_sta->bt_disabled) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled !!\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is enabled !!\n"); + + BTC_TRACE(trace_buf); + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->bt_reg_vendor_ac = 0xffff; + coex_sta->bt_reg_vendor_ae = 0xffff; + return TRUE; + } + + + if (wifi_connected) { + if (wifi_busy != pre_wifi_busy) { + pre_wifi_busy = wifi_busy; + return TRUE; + } + if (under_4way != pre_under_4way) { + pre_under_4way = under_4way; + return TRUE; + } + if (bt_hs_on != pre_bt_hs_on) { + pre_bt_hs_on = bt_hs_on; + return TRUE; + } + if (coex_sta->wl_noisy_level != pre_wl_noisy_level) { + pre_wl_noisy_level = coex_sta->wl_noisy_level; + return TRUE; + } + if (coex_sta->under_lps != pre_wifi_under_lps) { + pre_wifi_under_lps = coex_sta->under_lps; + if (coex_sta->under_lps) + return TRUE; + } + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->hid_busy_num != pre_hid_busy_num) { + pre_hid_busy_num = coex_sta->hid_busy_num; + return TRUE; + } + + if (bt_link_info->slave_role != pre_bt_slave) { + pre_bt_slave = bt_link_info->slave_role; + return TRUE; + } + + if (pre_hid_low_pri_tx_overhead != coex_sta->is_hid_low_pri_tx_overhead) { + pre_hid_low_pri_tx_overhead = coex_sta->is_hid_low_pri_tx_overhead; + return TRUE; + } + + if (pre_bt_setup_link != coex_sta->is_setupLink) { + pre_bt_setup_link = coex_sta->is_setupLink; + return TRUE; + } + } + + return FALSE; +} + + +static +void halbtc8822b2ant_update_bt_link_info(IN struct btc_coexist *btcoexist) +{ + + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + boolean bt_busy = FALSE; + + coex_sta->num_of_profile = 0; + + /* set link exist status */ + if (!(coex_sta->bt_info & BT_INFO_8822B_1ANT_B_CONNECTION)) { + coex_sta->bt_link_exist = FALSE; + coex_sta->pan_exist = FALSE; + coex_sta->a2dp_exist = FALSE; + coex_sta->hid_exist = FALSE; + coex_sta->sco_exist = FALSE; + } else { /* connection exists */ + coex_sta->bt_link_exist = TRUE; + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_FTP) { + coex_sta->pan_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->pan_exist = FALSE; + } + + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_A2DP) { + coex_sta->a2dp_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->a2dp_exist = FALSE; + } + + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_HID) { + coex_sta->hid_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->hid_exist = FALSE; + } + + if (coex_sta->bt_info & BT_INFO_8822B_1ANT_B_SCO_ESCO) { + coex_sta->sco_exist = TRUE; + coex_sta->num_of_profile++; + } else { + coex_sta->sco_exist = FALSE; + } + + } + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + bt_link_info->bt_link_exist = coex_sta->bt_link_exist; + bt_link_info->sco_exist = coex_sta->sco_exist; + bt_link_info->a2dp_exist = coex_sta->a2dp_exist; + bt_link_info->pan_exist = coex_sta->pan_exist; + bt_link_info->hid_exist = coex_sta->hid_exist; + bt_link_info->acl_busy = coex_sta->acl_busy; + + /* work around for HS mode. */ + if (bt_hs_on) { + bt_link_info->pan_exist = TRUE; + bt_link_info->bt_link_exist = TRUE; + } + + /* check if Sco only */ + if (bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->sco_only = TRUE; + else + bt_link_info->sco_only = FALSE; + + /* check if A2dp only */ + if (!bt_link_info->sco_exist && + bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->a2dp_only = TRUE; + else + bt_link_info->a2dp_only = FALSE; + + /* check if Pan only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + bt_link_info->pan_exist && + !bt_link_info->hid_exist) + bt_link_info->pan_only = TRUE; + else + bt_link_info->pan_only = FALSE; + + /* check if Hid only */ + if (!bt_link_info->sco_exist && + !bt_link_info->a2dp_exist && + !bt_link_info->pan_exist && + bt_link_info->hid_exist) + bt_link_info->hid_only = TRUE; + else + bt_link_info->hid_only = FALSE; + + if (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_INQ_PAGE) { + coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_INQ_PAGE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Inq/page!!!\n"); + } else if (!(coex_sta->bt_info & BT_INFO_8822B_2ANT_B_CONNECTION)) { + coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Connected idle!!!\n"); + } else if (coex_sta->bt_info == BT_INFO_8822B_2ANT_B_CONNECTION) { + /* connection exists but no busy */ + coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_CONNECTED_IDLE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Connected-idle!!!\n"); + } else if (((coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_BUSY)) && + (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_ACL_BUSY)) { + coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_ACL_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL SCO busy!!!\n"); + } else if ((coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_ESCO) || + (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_SCO_BUSY)) { + coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_SCO_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT SCO busy!!!\n"); + } else if (coex_sta->bt_info & BT_INFO_8822B_2ANT_B_ACL_BUSY) { + coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_ACL_BUSY; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT ACL busy!!!\n"); + } else { + coex_dm->bt_status = BT_8822B_2ANT_BT_STATUS_MAX; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), BT Non-Defined state!!!\n"); + } + + BTC_TRACE(trace_buf); + + if ((BT_8822B_2ANT_BT_STATUS_ACL_BUSY == coex_dm->bt_status) || + (BT_8822B_2ANT_BT_STATUS_SCO_BUSY == coex_dm->bt_status) || + (BT_8822B_2ANT_BT_STATUS_ACL_SCO_BUSY == coex_dm->bt_status)) + bt_busy = TRUE; + else + bt_busy = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_TRAFFIC_BUSY, &bt_busy); +} + + +static +void halbtc8822b2ant_update_wifi_channel_info(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + u8 h2c_parameter[3] = {0}; + u32 wifi_bw; + u8 wifi_central_chnl; + u32 RTL97F_8822B = 0; + + if (RTL97F_8822B) + return; + + /* only 2.4G we need to inform bt the chnl mask */ + btcoexist->btc_get(btcoexist, BTC_GET_U1_WIFI_CENTRAL_CHNL, + &wifi_central_chnl); + if ((BTC_MEDIA_CONNECT == type) && + (wifi_central_chnl <= 14)) { + /* enable BT AFH skip WL channel for 8822b + * because BT Rx LO interference + */ + h2c_parameter[0] = 0x1; +#if 0 + h2c_parameter[0] = 0x0; +#endif + h2c_parameter[1] = wifi_central_chnl; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + if (BTC_WIFI_BW_HT40 == wifi_bw) + h2c_parameter[2] = 0x30; + else + h2c_parameter[2] = 0x20; + } + + coex_dm->wifi_chnl_info[0] = h2c_parameter[0]; + coex_dm->wifi_chnl_info[1] = h2c_parameter[1]; + coex_dm->wifi_chnl_info[2] = h2c_parameter[2]; + + btcoexist->btc_fill_h2c(btcoexist, 0x66, 3, h2c_parameter); + +} + + +static +void halbtc8822b2ant_set_fw_dac_swing_level(IN struct btc_coexist *btcoexist, + IN u8 dac_swing_lvl) +{ + u8 h2c_parameter[1] = {0}; + u32 RTL97F_8822B = 0; + + if (RTL97F_8822B) + return; + + /* There are several type of dacswing */ + /* 0x18/ 0x10/ 0xc/ 0x8/ 0x4/ 0x6 */ + h2c_parameter[0] = dac_swing_lvl; + + btcoexist->btc_fill_h2c(btcoexist, 0x64, 1, h2c_parameter); +} + + +static +void halbtc8822b2ant_fw_dac_swing_lvl(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 fw_dac_swing_lvl) +{ + u32 RTL97F_8822B = 0; + + if (RTL97F_8822B) + return; + + coex_dm->cur_fw_dac_swing_lvl = fw_dac_swing_lvl; + + if (!force_exec) { + if (coex_dm->pre_fw_dac_swing_lvl == + coex_dm->cur_fw_dac_swing_lvl) + return; + } + + halbtc8822b2ant_set_fw_dac_swing_level(btcoexist, + coex_dm->cur_fw_dac_swing_lvl); + + coex_dm->pre_fw_dac_swing_lvl = coex_dm->cur_fw_dac_swing_lvl; +} + +static +void halbtc8822b2ant_set_fw_dec_bt_pwr(IN struct btc_coexist *btcoexist, + IN u8 dec_bt_pwr_lvl) +{ + u32 RTL97F_8822B = 0; + u8 h2c_parameter[1] = {0}; + + if (RTL97F_8822B) + return; + + h2c_parameter[0] = dec_bt_pwr_lvl; + + btcoexist->btc_fill_h2c(btcoexist, 0x62, 1, h2c_parameter); +} + +static +void halbtc8822b2ant_dec_bt_pwr(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 dec_bt_pwr_lvl) +{ + coex_dm->cur_bt_dec_pwr_lvl = dec_bt_pwr_lvl; + + if (!force_exec) { + if (coex_dm->pre_bt_dec_pwr_lvl == coex_dm->cur_bt_dec_pwr_lvl) + return; + } + halbtc8822b2ant_set_fw_dec_bt_pwr(btcoexist, + coex_dm->cur_bt_dec_pwr_lvl); + + coex_dm->pre_bt_dec_pwr_lvl = coex_dm->cur_bt_dec_pwr_lvl; +} + +static +void halbtc8822b2ant_low_penalty_ra(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean low_penalty_ra) +{ + +#if 1 + coex_dm->cur_low_penalty_ra = low_penalty_ra; + + if (!force_exec) { + if (coex_dm->pre_low_penalty_ra == + coex_dm->cur_low_penalty_ra) + return; + } + + if (low_penalty_ra) + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 50); + else + btcoexist->btc_phydm_modify_RA_PCR_threshold(btcoexist, 0, 0); + + coex_dm->pre_low_penalty_ra = coex_dm->cur_low_penalty_ra; + +#endif + +} + +static +void halbtc8822b2ant_write_score_board( + IN struct btc_coexist *btcoexist, + IN u16 bitpos, + IN boolean state +) +{ + + static u16 originalval = 0x8002; + + if (state) + originalval = originalval | bitpos; + else + originalval = originalval & (~bitpos); + + + btcoexist->btc_write_2byte(btcoexist, 0xaa, originalval); + +} + +static +void halbtc8822b2ant_read_score_board( + IN struct btc_coexist *btcoexist, + IN u16 *score_board_val +) +{ + + *score_board_val = (btcoexist->btc_read_2byte(btcoexist, + 0xaa)) & 0x7fff; +} + +static +void halbtc8822b2ant_post_state_to_bt( + IN struct btc_coexist *btcoexist, + IN u16 type, + IN BOOLEAN state +) +{ + + halbtc8822b2ant_write_score_board(btcoexist, (u16) type, state); + +} + + + +static +void halbtc8822b2ant_monitor_bt_enable_disable(IN struct btc_coexist *btcoexist) +{ + static u32 bt_disable_cnt = 0; + boolean bt_active = TRUE, bt_disabled = FALSE, wifi_under_5g = FALSE; + u16 u16tmp; + + /* This function check if bt is disabled */ +#if 0 + if (coex_sta->high_priority_tx == 0 && + coex_sta->high_priority_rx == 0 && + coex_sta->low_priority_tx == 0 && + coex_sta->low_priority_rx == 0) + bt_active = FALSE; + if (coex_sta->high_priority_tx == 0xffff && + coex_sta->high_priority_rx == 0xffff && + coex_sta->low_priority_tx == 0xffff && + coex_sta->low_priority_rx == 0xffff) + bt_active = FALSE; + + +#else + + /* Read BT on/off status from scoreboard[1], + * enable this only if BT patch support this feature + */ + halbtc8822b2ant_read_score_board(btcoexist, &u16tmp); + + bt_active = u16tmp & BIT(1); + + +#endif + + if (bt_active) { + bt_disable_cnt = 0; + bt_disabled = FALSE; + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + } else { + + bt_disable_cnt++; + if (bt_disable_cnt >= 10) { + bt_disabled = TRUE; + bt_disable_cnt = 10; + } + + btcoexist->btc_set(btcoexist, BTC_SET_BL_BT_DISABLE, + &bt_disabled); + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((wifi_under_5g) || (bt_disabled)) + halbtc8822b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); + else + halbtc8822b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, TRUE); + + + if (coex_sta->bt_disabled != bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is from %s to %s!!\n", + (coex_sta->bt_disabled ? "disabled" : "enabled"), + (bt_disabled ? "disabled" : "enabled")); + BTC_TRACE(trace_buf); + coex_sta->bt_disabled = bt_disabled; + } + +} + +static +void halbtc8822b2ant_enable_gnt_to_gpio(IN struct btc_coexist *btcoexist, + boolean isenable) +{ +#if BT_8822B_2ANT_COEX_DBG + static u8 bitVal[5] = {0, 0, 0, 0, 0}; +#if 0 + static boolean state = FALSE; + + if (state == isenable) + return; + + state = isenable; +#endif + + if (isenable) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], enable_gnt_to_gpio!!\n"); + BTC_TRACE(trace_buf); + + /* enable GNT_WL, GNT_BT to GPIO for debug */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x1); + + /* store original value */ + bitVal[0] = (btcoexist->btc_read_1byte(btcoexist, + 0x66) & BIT(4)) >> 4; /*0x66[4] */ + bitVal[1] = (btcoexist->btc_read_1byte(btcoexist, + 0x67) & BIT(0)); /*0x66[8] */ + bitVal[2] = (btcoexist->btc_read_1byte(btcoexist, + 0x42) & BIT(3)) >> 3; /*0x40[19] */ + bitVal[3] = (btcoexist->btc_read_1byte(btcoexist, + 0x65) & BIT(7)) >> 7; /*0x64[15] */ + bitVal[4] = (btcoexist->btc_read_1byte(btcoexist, + 0x72) & BIT(2)) >> 2; /*0x70[18] */ + + /* switch GPIO Mux */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + 0x0); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + 0x0); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + 0x0); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + 0x0); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + 0x0); /*0x70[18] = 0 */ + + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], disable_gnt_to_gpio!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x8, 0x0); + + /* Restore original value */ + /* switch GPIO Mux */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, BIT(4), + bitVal[0]); /*0x66[4] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, BIT(0), + bitVal[1]); /*0x66[8] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x42, BIT(3), + bitVal[2]); /*0x40[19] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x65, BIT(7), + bitVal[3]); /*0x64[15] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x72, BIT(2), + bitVal[4]); /*0x70[18] = 0 */ + } + +#endif +} + + +static +u32 halbtc8822b2ant_ltecoex_indirect_read_reg(IN struct btc_coexist *btcoexist, + IN u16 reg_addr) +{ + u32 delay_count = 0; + + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else { + break; + } + } + + /* wait for ready bit before access 0x1700 */ + btcoexist->btc_write_4byte(btcoexist, 0x1700, 0x800F0000 | reg_addr); + + return btcoexist->btc_read_4byte(btcoexist, + 0x1708); /* get read data */ + +} + + +static +void halbtc8822b2ant_ltecoex_indirect_write_reg(IN struct btc_coexist + *btcoexist, + IN u16 reg_addr, IN u32 bit_mask, IN u32 reg_value) +{ + u32 val, i = 0, bitpos = 0, delay_count = 0; + + + if (bit_mask == 0x0) + return; + if (bit_mask == 0xffffffff) { + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else { + break; + } + } + + btcoexist->btc_write_4byte(btcoexist, 0x1704, + reg_value); /* put write data */ + + btcoexist->btc_write_4byte(btcoexist, 0x1700, + 0xc00F0000 | reg_addr); + } else { + for (i = 0; i <= 31; i++) { + if (((bit_mask >> i) & 0x1) == 0x1) { + bitpos = i; + break; + } + } + + /* read back register value before write */ + val = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + reg_addr); + val = (val & (~bit_mask)) | (reg_value << bitpos); + + /* wait for ready bit before access 0x1700/0x1704 */ + while (1) { + if ((btcoexist->btc_read_1byte(btcoexist, 0x1703)&BIT(5)) == 0) { + delay_ms(50); + delay_count++; + if (delay_count >= 10) { + delay_count = 0; + break; + } + } else { + break; + } + } + + btcoexist->btc_write_4byte(btcoexist, 0x1704, + val); /* put write data */ + + btcoexist->btc_write_4byte(btcoexist, 0x1700, + 0xc00F0000 | reg_addr); + } + +} + + +static +void halbtc8822b2ant_ltecoex_enable(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + u8 val; + + val = (enable) ? 1 : 0; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, 0x38, 0x80, + val); /* 0x38[7] */ + +} + +static +void halbtc8822b2ant_ltecoex_pathcontrol_owner(IN struct btc_coexist *btcoexist, + IN boolean wifi_control) +{ + u8 val; + + val = (wifi_control) ? 1 : 0; + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x73, 0x4, + val); /* 0x70[26] */ + +} + +static +void halbtc8822b2ant_ltecoex_set_gnt_bt(IN struct btc_coexist *btcoexist, + IN u8 control_block, IN boolean sw_control, IN u8 state) +{ + u32 val = 0, bit_mask; + + state = state & 0x1; + val = (sw_control) ? ((state << 1) | 0x1) : 0; + + switch (control_block) { + case BT_8822B_2ANT_GNT_BLOCK_RFC_BB: + default: + bit_mask = 0xc000; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[15:14] */ + bit_mask = 0x0c00; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[11:10] */ + break; + case BT_8822B_2ANT_GNT_BLOCK_RFC: + bit_mask = 0xc000; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[15:14] */ + break; + case BT_8822B_2ANT_GNT_BLOCK_BB: + bit_mask = 0x0c00; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[11:10] */ + break; + + } + +} + +static +void halbtc8822b2ant_ltecoex_set_gnt_wl(IN struct btc_coexist *btcoexist, + IN u8 control_block, IN boolean sw_control, IN u8 state) +{ + u32 val = 0, bit_mask; + + state = state & 0x1; + val = (sw_control) ? ((state << 1) | 0x1) : 0; + + switch (control_block) { + case BT_8822B_2ANT_GNT_BLOCK_RFC_BB: + default: + bit_mask = 0x3000; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[13:12] */ + bit_mask = 0x0300; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[9:8] */ + break; + case BT_8822B_2ANT_GNT_BLOCK_RFC: + bit_mask = 0x3000; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[13:12] */ + break; + case BT_8822B_2ANT_GNT_BLOCK_BB: + bit_mask = 0x0300; + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, + 0x38, bit_mask, val); /* 0x38[9:8] */ + break; + + } + +} + +static +void halbtc8822b2ant_ltecoex_set_coex_table(IN struct btc_coexist *btcoexist, + IN u8 table_type, IN u16 table_content) +{ + u16 reg_addr = 0x0000; + + switch (table_type) { + case BT_8822B_2ANT_CTT_WL_VS_LTE: + reg_addr = 0xa0; + break; + case BT_8822B_2ANT_CTT_BT_VS_LTE: + reg_addr = 0xa4; + break; + } + + if (reg_addr != 0x0000) + halbtc8822b2ant_ltecoex_indirect_write_reg(btcoexist, reg_addr, + 0xffff, table_content); /* 0xa0[15:0] or 0xa4[15:0] */ + + +} + + +static +void halbtc8822b2ant_set_wltoggle_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 interval, + IN u8 val0x6c4_b0, IN u8 val0x6c4_b1, IN u8 val0x6c4_b2, + IN u8 val0x6c4_b3) +{ + static u8 pre_h2c_parameter[6] = {0}; + u8 cur_h2c_parameter[6] = {0}; + u8 i, match_cnt = 0; + + cur_h2c_parameter[0] = 0x7; /* op_code, 0x7= wlan toggle slot*/ + + cur_h2c_parameter[1] = interval; + cur_h2c_parameter[2] = val0x6c4_b0; + cur_h2c_parameter[3] = val0x6c4_b1; + cur_h2c_parameter[4] = val0x6c4_b2; + cur_h2c_parameter[5] = val0x6c4_b3; + + if (!force_exec) { + for (i = 1; i <= 5; i++) { + if (cur_h2c_parameter[i] != pre_h2c_parameter[i]) + break; + + match_cnt++; + } + + if (match_cnt == 5) + return; + } + + for (i = 1; i <= 5; i++) + pre_h2c_parameter[i] = cur_h2c_parameter[i]; + + btcoexist->btc_fill_h2c(btcoexist, 0x69, 6, cur_h2c_parameter); +} + +static +void halbtc8822b2ant_set_coex_table(IN struct btc_coexist *btcoexist, + IN u32 val0x6c0, IN u32 val0x6c4, IN u32 val0x6c8, IN u8 val0x6cc) +{ + btcoexist->btc_write_4byte(btcoexist, 0x6c0, val0x6c0); + + btcoexist->btc_write_4byte(btcoexist, 0x6c4, val0x6c4); + + btcoexist->btc_write_4byte(btcoexist, 0x6c8, val0x6c8); + + btcoexist->btc_write_1byte(btcoexist, 0x6cc, val0x6cc); +} + +static +void halbtc8822b2ant_coex_table(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u32 val0x6c0, IN u32 val0x6c4, + IN u32 val0x6c8, IN u8 val0x6cc) +{ + coex_dm->cur_val0x6c0 = val0x6c0; + coex_dm->cur_val0x6c4 = val0x6c4; + coex_dm->cur_val0x6c8 = val0x6c8; + coex_dm->cur_val0x6cc = val0x6cc; + + if (!force_exec) { + if ((coex_dm->pre_val0x6c0 == coex_dm->cur_val0x6c0) && + (coex_dm->pre_val0x6c4 == coex_dm->cur_val0x6c4) && + (coex_dm->pre_val0x6c8 == coex_dm->cur_val0x6c8) && + (coex_dm->pre_val0x6cc == coex_dm->cur_val0x6cc)) + return; + } + halbtc8822b2ant_set_coex_table(btcoexist, val0x6c0, val0x6c4, val0x6c8, + val0x6cc); + + coex_dm->pre_val0x6c0 = coex_dm->cur_val0x6c0; + coex_dm->pre_val0x6c4 = coex_dm->cur_val0x6c4; + coex_dm->pre_val0x6c8 = coex_dm->cur_val0x6c8; + coex_dm->pre_val0x6cc = coex_dm->cur_val0x6cc; +} + +static +void halbtc8822b2ant_coex_table_with_type(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 type) +{ + u32 break_table; + u8 select_table; + + coex_sta->coex_table_type = type; + + if (coex_sta->concurrent_rx_mode_on) { + break_table = 0xf0ffffff; /* set WL hi-pri can break BT */ + /* set Tx response = Hi-Pri (ex: Transmitting ACK,BA,CTS) */ + select_table = 0xb; + } else { + break_table = 0xffffff; + select_table = 0x3; + } + + switch (type) { + case 0: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0xffffffff, 0xffffffff, break_table, select_table); + break; + case 1: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, break_table, select_table); + break; + case 2: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0x5a5a5a5a, break_table, select_table); + break; + case 3: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, break_table, select_table); + break; + case 4: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a5a5a, break_table, select_table); + break; + case 5: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x55555555, break_table, select_table); + break; + case 6: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xfafafafa, break_table, select_table); + break; + case 7: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xaa5a5a5a, break_table, select_table); + break; + case 8: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0xa5555555, 0xfafafafa, break_table, select_table); + break; + case 9: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0x5a5a5a5a, 0xaaaa5aaa, break_table, select_table); + break; + case 10: + halbtc8822b2ant_coex_table(btcoexist, force_exec, + 0x55555555, 0x5a5a555a, break_table, select_table); + break; + default: + break; + } +} + +static +void halbtc8822b2ant_set_fw_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean enable) +{ + u8 h2c_parameter[1] = {0}; + u32 RTL97F_8822B = 0; + + if (RTL97F_8822B) + return; + + if (enable) + h2c_parameter[0] |= BIT(0); /* function enable */ + + btcoexist->btc_fill_h2c(btcoexist, 0x63, 1, h2c_parameter); +} + +static +void halbtc8822b2ant_ignore_wlan_act(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean enable) +{ + coex_dm->cur_ignore_wlan_act = enable; + + if (!force_exec) { + if (coex_dm->pre_ignore_wlan_act == + coex_dm->cur_ignore_wlan_act) + return; + } + halbtc8822b2ant_set_fw_ignore_wlan_act(btcoexist, enable); + + coex_dm->pre_ignore_wlan_act = coex_dm->cur_ignore_wlan_act; +} + +static +void halbtc8822b2ant_set_lps_rpwm(IN struct btc_coexist *btcoexist, + IN u8 lps_val, IN u8 rpwm_val) +{ + u8 lps = lps_val; + u8 rpwm = rpwm_val; + + btcoexist->btc_set(btcoexist, BTC_SET_U1_LPS_VAL, &lps); + btcoexist->btc_set(btcoexist, BTC_SET_U1_RPWM_VAL, &rpwm); +} + +static +void halbtc8822b2ant_lps_rpwm(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 lps_val, IN u8 rpwm_val) +{ + coex_dm->cur_lps = lps_val; + coex_dm->cur_rpwm = rpwm_val; + + if (!force_exec) { + if ((coex_dm->pre_lps == coex_dm->cur_lps) && + (coex_dm->pre_rpwm == coex_dm->cur_rpwm)) + return; + } + halbtc8822b2ant_set_lps_rpwm(btcoexist, lps_val, rpwm_val); + + coex_dm->pre_lps = coex_dm->cur_lps; + coex_dm->pre_rpwm = coex_dm->cur_rpwm; +} + + +static +void halbtc8822b2ant_ps_tdma_check_for_power_save_state( + IN struct btc_coexist *btcoexist, IN boolean new_ps_state) +{ + u8 lps_mode = 0x0; + u8 h2c_parameter[5] = {0, 0, 0, 0x40, 0}; + u32 RTL97F_8822B = 0; + + if (RTL97F_8822B) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_LPS_MODE, &lps_mode); + + if (lps_mode) { /* already under LPS state */ + if (new_ps_state) { + /* keep state under LPS, do nothing. */ + } else { + /* will leave LPS state, turn off psTdma first */ +#if 0 + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, + 8); +#endif + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } + } else { /* NO PS state */ + if (new_ps_state) { + /* will enter LPS state, turn off psTdma first */ +#if 0 + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, + 8); +#endif + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, + h2c_parameter); + } else { + /* keep state under NO PS state, do nothing. */ + } + } +} + + +static +boolean halbtc8822b2ant_power_save_state(IN struct btc_coexist *btcoexist, + IN u8 ps_type, IN u8 lps_val, IN u8 rpwm_val) +{ + boolean low_pwr_disable = FALSE, result = TRUE; + + switch (ps_type) { + case BTC_PS_WIFI_NATIVE: + coex_sta->force_lps_ctrl = FALSE; + /* recover to original 32k low power setting */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b2ant_power_save_state == BTC_PS_WIFI_NATIVE\n"); + BTC_TRACE(trace_buf); + + low_pwr_disable = FALSE; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + btcoexist->btc_set(btcoexist, BTC_SET_ACT_NORMAL_LPS, + NULL); + break; + case BTC_PS_LPS_ON: + coex_sta->force_lps_ctrl = TRUE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b2ant_power_save_state == BTC_PS_LPS_ON\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_ps_tdma_check_for_power_save_state( + btcoexist, TRUE); + halbtc8822b2ant_lps_rpwm(btcoexist, NORMAL_EXEC, + lps_val, rpwm_val); + /* when coex force to enter LPS, do not enter 32k low power. */ + low_pwr_disable = TRUE; + btcoexist->btc_set(btcoexist, + BTC_SET_ACT_DISABLE_LOW_POWER, + &low_pwr_disable); + /* power save must executed before psTdma. */ + btcoexist->btc_set(btcoexist, BTC_SET_ACT_ENTER_LPS, + NULL); + break; + case BTC_PS_LPS_OFF: + coex_sta->force_lps_ctrl = TRUE; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b2ant_power_save_state == BTC_PS_LPS_OFF\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_ps_tdma_check_for_power_save_state( + btcoexist, FALSE); + result = btcoexist->btc_set(btcoexist, BTC_SET_ACT_LEAVE_LPS, + NULL); + break; + default: + break; + } + + return result; +} + + + + +static +void halbtc8822b2ant_set_fw_pstdma(IN struct btc_coexist *btcoexist, + IN u8 byte1, IN u8 byte2, IN u8 byte3, IN u8 byte4, IN u8 byte5) +{ + u8 h2c_parameter[5] = {0}; + u8 real_byte1 = byte1, real_byte5 = byte5; + boolean ap_enable = FALSE, result = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + if (byte5 & BIT(2)) + coex_sta->is_tdma_btautoslot = TRUE; + else + coex_sta->is_tdma_btautoslot = FALSE; + + /* release bt-auto slot for auto-slot hang is detected!! */ + if (coex_sta->is_tdma_btautoslot) + if ((coex_sta->is_tdma_btautoslot_hang) || + (bt_link_info->slave_role)) + byte5 = byte5 & 0xfb; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_AP_MODE_ENABLE, + &ap_enable); + + if ((ap_enable) && (byte1 & BIT(4) && !(byte1 & BIT(5)))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b2ant_set_fw_pstdma == FW for AP mode\n"); + BTC_TRACE(trace_buf); + + real_byte1 &= ~BIT(4); + real_byte1 |= BIT(5); + + real_byte5 |= BIT(5); + real_byte5 &= ~BIT(6); + + halbtc8822b2ant_power_save_state(btcoexist, + BTC_PS_WIFI_NATIVE, 0x0, 0x0); + } else if (byte1 & BIT(4) && !(byte1 & BIT(5))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b2ant_set_fw_pstdma == Force LPS (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); + +#if 0 + halbtc8822b2ant_power_save_state( + btcoexist, BTC_PS_LPS_ON, 0x50, + 0x4); +#endif + if (!halbtc8822b2ant_power_save_state(btcoexist, BTC_PS_LPS_OFF, 0x50, 0x4)) + result = TRUE; + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b2ant_set_fw_pstdma == Native LPS (byte1 = 0x%x)\n", byte1); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_power_save_state(btcoexist, BTC_PS_WIFI_NATIVE, + 0x0, + 0x0); + } + + + coex_sta->is_set_ps_state_fail = result; + + if (!coex_sta->is_set_ps_state_fail) { + h2c_parameter[0] = real_byte1; + h2c_parameter[1] = byte2; + h2c_parameter[2] = byte3; + h2c_parameter[3] = byte4; + h2c_parameter[4] = real_byte5; + + coex_dm->ps_tdma_para[0] = real_byte1; + coex_dm->ps_tdma_para[1] = byte2; + coex_dm->ps_tdma_para[2] = byte3; + coex_dm->ps_tdma_para[3] = byte4; + coex_dm->ps_tdma_para[4] = real_byte5; + + btcoexist->btc_fill_h2c(btcoexist, 0x60, 5, h2c_parameter); + + } else { + coex_sta->cnt_set_ps_state_fail++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], halbtc8822b2ant_set_fw_pstdma == Force Leave LPS Fail (cnt = %d)\n", + coex_sta->cnt_set_ps_state_fail); + BTC_TRACE(trace_buf); + } +} + + +static +void halbtc8822b2ant_ps_tdma(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean turn_on, IN u8 type) +{ + static u8 psTdmaByte4Modify = 0x0, pre_psTdmaByte4Modify = 0x0; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + coex_dm->cur_ps_tdma_on = turn_on; + coex_dm->cur_ps_tdma = type; + + /* 0x778 = 0x1 at wifi slot (no blocking BT Low-Pri pkts) */ + if (bt_link_info->slave_role) + psTdmaByte4Modify = 0x1; + else + psTdmaByte4Modify = 0x0; + + if (pre_psTdmaByte4Modify != psTdmaByte4Modify) { + force_exec = TRUE; + pre_psTdmaByte4Modify = psTdmaByte4Modify; + } + + if (!force_exec) { + if ((coex_dm->pre_ps_tdma_on == coex_dm->cur_ps_tdma_on) && + (coex_dm->pre_ps_tdma == coex_dm->cur_ps_tdma)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Skip TDMA because no change TDMA(%s, %d)\n", + (coex_dm->cur_ps_tdma_on ? "on" : "off"), + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + return; + } + } + + if (coex_dm->cur_ps_tdma_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(on, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, + 0x1); /* enable TBTT nterrupt */ + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** TDMA(off, %d) **********\n", + coex_dm->cur_ps_tdma); + BTC_TRACE(trace_buf); + } + + + if (turn_on) { + switch (type) { + case 1: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x91, + 0x54 | psTdmaByte4Modify); + break; + case 2: + default: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, + 0x11 | psTdmaByte4Modify); + break; + case 3: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x3a, 0x3, 0x91, + 0x10 | psTdmaByte4Modify); + break; + case 4: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x21, 0x3, 0x91, + 0x10 | psTdmaByte4Modify); + break; + case 5: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x3, 0x91, + 0x10 | psTdmaByte4Modify); + break; + case 6: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x3, 0x91, + 0x10 | psTdmaByte4Modify); + break; + case 7: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x20, 0x3, 0x91, + 0x10 | psTdmaByte4Modify); + break; + case 8: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x15, 0x03, 0x11, + 0x11); + break; + case 10: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x30, 0x03, 0x11, + 0x10); + break; + case 11: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, + 0x10 | psTdmaByte4Modify); + break; + case 12: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, 0x11); + break; + case 13: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x1c, 0x03, 0x11, + 0x10 | psTdmaByte4Modify); + break; + case 14: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x20, 0x03, 0x11, + 0x11); + break; + case 15: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x14); + break; + case 16: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x15); + break; + case 21: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x30, 0x03, 0x11, + 0x10); + break; + case 22: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x03, 0x11, + 0x10); + break; + case 23: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x11, + 0x10); + break; + case 51: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x10, 0x03, 0x91, + 0x10 | psTdmaByte4Modify); + break; + case 101: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x03, 0x11, + 0x11 | psTdmaByte4Modify); + break; + case 102: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x35, 0x03, 0x11, + 0x11 | psTdmaByte4Modify); + break; + case 103: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x3a, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); + break; + case 104: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x21, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); + break; + case 105: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x30, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); + break; + case 106: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); + break; + case 107: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x7, 0x10, + 0x54 | psTdmaByte4Modify); + break; + case 108: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x30, 0x3, 0x10, + 0x50 | psTdmaByte4Modify); + break; + case 109: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x03, 0x10, + 0x54 | psTdmaByte4Modify); + break; + case 110: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x55, + 0x30, 0x03, 0x10, + 0x50 | psTdmaByte4Modify); + break; + case 111: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x61, + 0x25, 0x03, 0x11, + 0x11 | psTdmaByte4Modify); + break; + case 151: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x51, + 0x10, 0x03, 0x10, + 0x50 | psTdmaByte4Modify); + break; + } + } else { + /* disable PS tdma */ + switch (type) { +#if 0 +/* 08:1ant:PTA Control -0x778=1-ant hw control,40:2ant:sw control-diversity */ +#endif + + case 0: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x40, 0x0); + break; + default: + halbtc8822b2ant_set_fw_pstdma(btcoexist, 0x0, + 0x0, 0x0, 0x40, 0x0); + break; + } + } + + if (!coex_sta->is_set_ps_state_fail) { + /* update pre state */ + coex_dm->pre_ps_tdma_on = coex_dm->cur_ps_tdma_on; + coex_dm->pre_ps_tdma = coex_dm->cur_ps_tdma; + } +} + +/*anttenna control by bb mac bt antdiv pta to write 0x4c 0xcb4,0xcbd*/ +static +void halbtc8822b2ant_set_ext_ant_switch(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN u8 ctrl_type, IN u8 pos_type) +{ +#if 0 + struct btc_board_info *board_info = &btcoexist->board_info; +#endif + boolean switch_polatiry_inverse = FALSE; + u8 regval_0xcbc = 0, regval_0x64; +#if BT_8822B_2ANT_COEX_DBG + u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; +#endif + + if (!rfe_type->ext_ant_switch_exist) + return; + + coex_dm->cur_ext_ant_switch_status = (ctrl_type << 8) + pos_type; + + if (!force_exec) { + if (coex_dm->pre_ext_ant_switch_status == + coex_dm->cur_ext_ant_switch_status) + return; + } + coex_dm->pre_ext_ant_switch_status = coex_dm->cur_ext_ant_switch_status; + +#if 0 + switch (pos_type) { + default: + case BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT: + case BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE: + break; + case BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG: + break; + case BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA: + break; + } +#endif + +#if 0 + if (board_info->ant_div_cfg) + ctrl_type = BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV; +#endif + + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); + + + switch (ctrl_type) { + default: + case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + /* BB SW, DPDT use RFE_ctrl8 and RFE_ctrl9 as conctrol pin */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x77); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, + 0x03, 01); + + break; + case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + /* PTA, DPDT use RFE_ctrl8 and RFE_ctrl9 as conctrol pin */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x66); + + /* 0xcb4[29:28] = 2b'10 for no switch_polatiry_inverse, + * DPDT_SEL_N =1, DPDT_SEL_P =0 @ GNT_BT=1 + */ + regval_0xcbc = (!switch_polatiry_inverse ? 0x2 : 0x1); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbc, + 0x03, regval_0xcbc); + + break; + case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1);/* 0x4c[24] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, 0xff, 0x88); + break; + case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x1); /* 0x4c[23] = 1 */ + + /* 0x64[0] = 1b'0 for no switch_polatiry_inverse, + * DPDT_SEL_N =1, DPDT_SEL_P =0 + */ + regval_0x64 = (!switch_polatiry_inverse ? 0x0 : 0x1); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x64, 0x1, + regval_0x64); + break; + case BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x0); /* 0x4c[24] = 0 */ + + /* no setup required, because antenna switch control value by + * BT vendor 0x1c[1:0] + */ + break; + } + + /* PAPE, LNA_ON control by BT while WLAN off for current leakage issue*/ + if (ctrl_type == BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT) { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x0); /* PAPE 0x64[29] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x10, + 0x0); /* LNA_ON 0x64[28] = 0 */ + } else { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x20, + 0x1); /* PAPE 0x64[29] = 1 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x67, 0x10, + 0x1); /* LNA_ON 0x64[28] = 1 */ + } + +#if BT_8822B_2ANT_COEX_DBG + + u32tmp1 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u32tmp2 = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0x64) & 0xff; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (After Ext Ant switch setup) 0xcb4 = 0x%08x, 0x4c = 0x%08x, 0x64= 0x%02x\n", + u32tmp1, u32tmp2, u32tmp3); + BTC_TRACE(trace_buf); +#endif + + + +} + +/* rf4 type by efuse, and for ant at main aux inverse use, + * because is 2x2, and control types are the same, does not need + */ +static +void halbtc8822b2ant_set_rfe_type(IN struct btc_coexist *btcoexist) +{ + + struct btc_board_info *board_info = &btcoexist->board_info; + + + rfe_type->ext_band_switch_exist = FALSE; + rfe_type->ext_band_switch_type = + BT_8822B_2ANT_EXT_BAND_SWITCH_USE_SPDT; /* SPDT; */ + rfe_type->ext_band_switch_ctrl_polarity = 0; + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); + + if (rfe_type->ext_band_switch_exist) { + + /* band switch use RFE_ctrl1 (pin name: PAPE_A) and + * RFE_ctrl3 (pin name: LNAON_A) + */ + + /* set RFE_ctrl1 as software control */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb0, 0xf0, 0x7); + + /* set RFE_ctrl3 as software control */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb1, 0xf0, 0x7); + + } + + + /* the following setup should be got from Efuse in the future */ + rfe_type->rfe_module_type = board_info->rfe_type; + + rfe_type->ext_ant_switch_ctrl_polarity = 0; + + switch (rfe_type->rfe_module_type) { + case 0: + default: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 1: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 2: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 3: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 4: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = + BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 5: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 6: + rfe_type->ext_ant_switch_exist = TRUE; + rfe_type->ext_ant_switch_type = BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + case 7: + rfe_type->ext_ant_switch_exist = TRUE; +rfe_type->ext_ant_switch_type = BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT; + break; + } + +#if 0 + + if (rfe_type->wlg_Locate_at_btg) + halbtc8822b2ant_set_int_block(btcoexist, FORCE_EXEC, + BT_8822B_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG); + else + halbtc8822b2ant_set_int_block(btcoexist, FORCE_EXEC, + BT_8822B_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG); +#endif + +} + +/* set gnt_wl gnt_bt control by sw high low, or hwpta while in + * power on, ini, wlan off, wlan only, wl2g non-currrent, wl2g current, wl5g + */ +static +void halbtc8822b2ant_set_ant_path(IN struct btc_coexist *btcoexist, + IN u8 ant_pos_type, IN boolean force_exec, + IN u8 phase) +{ +#if BT_8822B_2ANT_COEX_DBG + u8 u8tmp = 0; +#endif + u32 u32tmp1 = 0; +#if BT_8822B_2ANT_COEX_DBG + u32 u32tmp2 = 0, u32tmp3 = 0; +#endif + + u32tmp1 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + + /* To avoid indirect access fail */ + if (((u32tmp1 & 0xf000) >> 12) != ((u32tmp1 & 0x0f00) >> 8)) { + force_exec = TRUE; + coex_sta->gnt_error_cnt++; + } + + /* Ext switch buffer mux */ + btcoexist->btc_write_1byte(btcoexist, 0x974, 0xff); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x1991, 0x3, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbe, 0x8, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + + coex_dm->cur_ant_pos_type = (ant_pos_type << 8) + phase; + + if (!force_exec) { + if (coex_dm->cur_ant_pos_type == coex_dm->pre_ant_pos_type) + return; + } + + coex_dm->pre_ant_pos_type = coex_dm->cur_ant_pos_type; + +#if BT_8822B_2ANT_COEX_DBG + u32tmp1 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0x38); + u32tmp2 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0x54); + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); + + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (Before Ant Setup) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + u32tmp3, u8tmp, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); +#endif + + switch (phase) { + case BT_8822B_2ANT_PHASE_COEX_POWERON: + + /* set Path control owner to WL at initial step */ + halbtc8822b2ant_ltecoex_pathcontrol_owner(btcoexist, + BT_8822B_2ANT_PCO_BTSIDE); + + /* set GNT_BT to SW high */ + halbtc8822b2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW high */ + halbtc8822b2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = FALSE; + + break; + case BT_8822B_2ANT_PHASE_COEX_INIT: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x1); /* 0x4c[24] = 1 */ + /* Disable LTE Coex Function in WiFi side + * (this should be on if LTE coex is required) + */ + halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b2ant_ltecoex_set_coex_table( + btcoexist, + BT_8822B_2ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b2ant_ltecoex_set_coex_table( + btcoexist, + BT_8822B_2ANT_CTT_BT_VS_LTE, + 0xffff); + + /* set Path control owner to WL at initial step */ + halbtc8822b2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8822B_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW high */ + halbtc8822b2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW high */ + halbtc8822b2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = FALSE; + + break; + case BT_8822B_2ANT_PHASE_WLANONLY_INIT: + /* Disable LTE Coex Function in WiFi side + * (this should be on if LTE coex is required) + */ + halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); + + /* GNT_WL_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b2ant_ltecoex_set_coex_table( + btcoexist, + BT_8822B_2ANT_CTT_WL_VS_LTE, + 0xffff); + + /* GNT_BT_LTE always = 1 + * (this should be config if LTE coex is required) + */ + halbtc8822b2ant_ltecoex_set_coex_table( + btcoexist, + BT_8822B_2ANT_CTT_BT_VS_LTE, + 0xffff); + + /* set Path control owner to WL at initial step */ + halbtc8822b2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8822B_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Low */ + halbtc8822b2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_LOW); + /* Set GNT_WL to SW high */ + halbtc8822b2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + + coex_sta->run_time_state = FALSE; + + + break; + case BT_8822B_2ANT_PHASE_WLAN_OFF: + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4e, + 0x80, 0x0); /* 0x4c[23] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4f, + 0x01, 0x0); /* 0x4c[24] = 0 */ + /* Disable LTE Coex Function in WiFi side */ + halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); + + /* set Path control owner to BT */ + halbtc8822b2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8822B_2ANT_PCO_BTSIDE); + + /* Set Ext Ant Switch to BT control at wifi off step */ + halbtc8822b2ant_set_ext_ant_switch(btcoexist, + FORCE_EXEC, + BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT, + BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE); + coex_sta->run_time_state = FALSE; + break; + case BT_8822B_2ANT_PHASE_2G_RUNTIME: + case BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT: + + /* set Path control owner to WL at runtime step */ + halbtc8822b2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8822B_2ANT_PCO_WLSIDE); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcb4, + 0xff, 0x66); + if (phase == + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT) { + /* set GNT_BT to PTA */ + halbtc8822b2ant_ltecoex_set_gnt_bt( + btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8822B_2ANT_SIG_STA_SET_BY_HW); + + /* Set GNT_WL to SW High */ + halbtc8822b2ant_ltecoex_set_gnt_wl( + btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + } else { + /* set GNT_BT to PTA */ + halbtc8822b2ant_ltecoex_set_gnt_bt( + btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8822B_2ANT_SIG_STA_SET_BY_HW); + + /* Set GNT_WL to PTA */ + halbtc8822b2ant_ltecoex_set_gnt_wl( + btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_PTA, + BT_8822B_2ANT_SIG_STA_SET_BY_HW); + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ************* under2g 0xcbd setting =2 *************\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, 0x03, 02); + break; + + case BT_8822B_2ANT_PHASE_5G_RUNTIME: + + /* set Path control owner to WL at runtime step */ + halbtc8822b2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8822B_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Hi */ + halbtc8822b2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW Hi */ + halbtc8822b2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + coex_sta->run_time_state = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ************* under5g 0xcbd setting =1 *************\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0xcbd, + 0x03, 01); + + break; + case BT_8822B_2ANT_PHASE_BTMPMODE: + /* Disable LTE Coex Function in WiFi side */ + halbtc8822b2ant_ltecoex_enable(btcoexist, 0x0); + + /* set Path control owner to WL */ + halbtc8822b2ant_ltecoex_pathcontrol_owner( + btcoexist, + BT_8822B_2ANT_PCO_WLSIDE); + + /* set GNT_BT to SW Hi */ + halbtc8822b2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + + /* Set GNT_WL to SW Lo */ + halbtc8822b2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_LOW); + + coex_sta->run_time_state = FALSE; + break; + } +#if BT_8822B_2ANT_COEX_DBG + u32tmp1 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp2 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u8tmp = btcoexist->btc_read_1byte(btcoexist, 0x73); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (After Ant-Setup phase---%d) 0xcb4 = 0x%x, 0x73 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + phase, u32tmp3, u8tmp, u32tmp1, u32tmp2); + + BTC_TRACE(trace_buf); +#endif + +} + + +static +void halbtc8822b2ant_set_rx_gain(IN struct btc_coexist *btcoexist, + IN boolean agc_table_en) +{ + u8 rssi_adjust_val = 0; + + /* =================BB AGC Gain Table */ + if (agc_table_en) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table On!\n"); + BTC_TRACE(trace_buf); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + btcoexist->btc_write_1byte(btcoexist, 0xc5b, 0xc8); + btcoexist->btc_write_1byte(btcoexist, 0xe5b, 0xc8); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xff000003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xae2e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xad300003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xac320003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xab360003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8d380003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8c3a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8b3c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x8a3e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6e400003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6d420003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6c440003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6b460003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x6a480003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x694a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x684c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x674e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x66500003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x65520003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x64540003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x64560003); + + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x007e0403); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BB Agc Table Off!\n"); + BTC_TRACE(trace_buf); + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + btcoexist->btc_write_1byte(btcoexist, 0xc5b, 0xd8); + btcoexist->btc_write_1byte(btcoexist, 0xe5b, 0xd8); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xff000003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xe62e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xe5300003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc8320003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc6360003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc5380003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc43a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc33c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc23e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc1400003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xc0420003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa5440003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa4460003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa3480003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa24a0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0xa14c0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x834e0003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x82500003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x81520003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x80540003); + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x65560003); + + btcoexist->btc_write_4byte(btcoexist, 0x81c, 0x007e0403); + } + +} + + +static +void halbtc8822b2ant_rx_gain(IN struct btc_coexist *btcoexist, + IN boolean force_exec, IN boolean agc_table_en) +{ + coex_dm->cur_agc_table_en = agc_table_en; + + if (!force_exec) { + if (coex_dm->pre_agc_table_en == coex_dm->cur_agc_table_en) + return; + } + halbtc8822b2ant_set_rx_gain(btcoexist, agc_table_en); + + coex_dm->pre_agc_table_en = coex_dm->cur_agc_table_en; +} + + +static +u8 halbtc8822b2ant_action_algorithm(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean bt_hs_on = FALSE; + u8 algorithm = BT_8822B_2ANT_COEX_ALGO_UNDEFINED; + u8 num_of_diff_profile = 0; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + if (!bt_link_info->bt_link_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No BT link exists!!!\n"); + BTC_TRACE(trace_buf); + return algorithm; + } + + if (bt_link_info->sco_exist) + num_of_diff_profile++; + if (bt_link_info->hid_exist) + num_of_diff_profile++; + if (bt_link_info->pan_exist) + num_of_diff_profile++; + if (bt_link_info->a2dp_exist) + num_of_diff_profile++; + + if (num_of_diff_profile == 0) { + + if (bt_link_info->acl_busy) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], No-Profile busy\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_NOPROFILEBUSY; + } + } else if ((bt_link_info->a2dp_exist) && (coex_sta->is_bt_a2dp_sink)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP Sink\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_A2DPSINK; + } else if (num_of_diff_profile == 1) { + if (bt_link_info->sco_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_SCO; + } else { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_HID; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP only\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_A2DP; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], PAN(HS) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], PAN(EDR) only\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR; + } + } + } + } else if (num_of_diff_profile == 2) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_SCO; + } else if (bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + A2DP ==> A2DP\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_A2DP; + } else if (bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_SCO; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + A2DP\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_HID_A2DP; + } + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_HID; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_A2DP_PANHS; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR_A2DP; + } + } + } + } else if (num_of_diff_profile == 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->a2dp_exist) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + A2DP ==> HID + A2DP\n"); + BTC_TRACE(trace_buf); + algorithm = BT_8822B_2ANT_COEX_ALGO_HID_A2DP; + } else if (bt_link_info->hid_exist && + bt_link_info->pan_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR_HID; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR_HID; + } + } else if (bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR_A2DP; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + A2DP + PAN(EDR) ==> HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_PANEDR_A2DP; + } + } + } else { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], HID + A2DP + PAN(EDR)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; + } + } + } + } else if (num_of_diff_profile >= 3) { + if (bt_link_info->sco_exist) { + if (bt_link_info->hid_exist && + bt_link_info->pan_exist && + bt_link_info->a2dp_exist) { + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Error!!! SCO + HID + A2DP + PAN(HS)\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCO + HID + A2DP + PAN(EDR)==>PAN(EDR)+HID\n"); + BTC_TRACE(trace_buf); + algorithm = + BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR; + } + } + } + } + + return algorithm; +} + + +static +void halbtc8822b2ant_action_coex_all_off(IN struct btc_coexist *btcoexist) +{ + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + +#if 0 + /*halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT);*/ +#endif + + /* fw all off */ + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + +} + +static +void halbtc8822b2ant_action_wifi_under5g(IN struct btc_coexist *btcoexist) +{ + + /* fw all off */ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ************* under5g *************\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + +} + +static +void halbtc8822b2ant_action_wifi_native_lps(IN struct btc_coexist *btcoexist) +{ +#if 0 + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 2); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); +#endif + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + +} + + +static +void halbtc8822b2ant_action_bt_inquiry(IN struct btc_coexist *btcoexist) +{ + + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE; + boolean wifi_busy = FALSE; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); + + if ((coex_sta->bt_create_connection) && ((wifi_link) || (wifi_roam) + || (wifi_scan) || (wifi_busy) || (coex_sta->wifi_is_high_pri_task))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi link/roam/Scan/busy/hi-pri-task + BT Inq/Page!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, + 8); + + if ((bt_link_info->a2dp_exist) && (!bt_link_info->pan_exist)) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 15); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 11); + } else if ((!wifi_connected) && (!wifi_scan)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Wifi no-link + no-scan + BT Inq/Page!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (bt_link_info->pan_exist) { + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + + + } else if (bt_link_info->a2dp_exist) { +#if 0 + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); +#endif + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 10); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + + } else { + + if ((wifi_link) || (wifi_roam) || (wifi_scan) || (wifi_busy) + || (coex_sta->wifi_is_high_pri_task)) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 23); + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + } + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif +} + +static +void halbtc8822b2ant_action_wifi_link_process(IN struct btc_coexist *btcoexist) +{ + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd4); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if (bt_link_info->pan_exist) { + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 22); + + } else if (bt_link_info->a2dp_exist) { + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 16); + + } else { + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 21); + + } + +} + +static +void halbtc8822b2ant_action_wifi_nonconnected(IN struct btc_coexist *btcoexist) +{ + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +#if 0 + /*halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT);*/ +#endif + + /* fw all off */ + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif +} + +static +void halbtc8822b2ant_action_bt_relink(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], run bt multi link function\n"); + BTC_TRACE(trace_buf); + + if (coex_sta->is_bt_multi_link) + return; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], run bt re-link function\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + +} + +static +void halbtc8822b2ant_action_bt_idle(IN struct btc_coexist *btcoexist) +{ + + boolean wifi_busy = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + if (!wifi_busy) { + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 14); + } else { /* if wl busy */ + + if (BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) { + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, + 0); + } else { + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, + 8); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 12); + } + } + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, FORCE_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif +} + +/* SCO only or SCO+PAN(HS) */ +static +void halbtc8822b2ant_action_sco(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres , 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + /*halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0);*/ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + if (coex_sta->is_eSCO_mode) + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + else /* 2-Ant free run if SCO mode */ + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, 8); + } + +} + + +static +void halbtc8822b2ant_action_hid(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, &wifi_bw); + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + /*halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0);*/ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + if (coex_sta->is_hid_low_pri_tx_overhead) { + + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 4); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 108); + } else if (wifi_bw == 0) { /* if 11bg mode */ + + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 111); + } else { + + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 111); + } + } + +} + + +static +void halbtc8822b2ant_action_a2dpsink(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; +#if 0 + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); +#endif + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + /*halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0);*/ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 1); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 16); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + if ((coex_sta->bt_relink_downcount != 0) + && (wifi_busy)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + + } else { + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 105); + } + + } + +} + +/* A2DP only / PAN(EDR) only/ A2DP+PAN(HS) */ +static +void halbtc8822b2ant_action_a2dp(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + /*halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0);*/ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 1); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 16); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + if ((coex_sta->bt_relink_downcount != 0) + && (wifi_busy)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + + } else { + + if (wifi_turbo) + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 10); + else + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, + 10); +#if 0 +halbtc8822b2ant_coex_table_with_type(btcoexist, +NORMAL_EXEC, +7); +#endif + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 109); + } + + } + +} + + +static +void halbtc8822b2ant_action_pan_edr(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + +#if 0 + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); +#endif + + +#if 1 + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 3); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 4); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 103); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 104); + } + +#endif + +} + +static +void halbtc8822b2ant_action_hid_a2dp(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + /*halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0);*/ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 1); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 16); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + if ((coex_sta->bt_relink_downcount != 0) + && (wifi_busy)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Re-Link + A2DP + WL busy\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); + } else { + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 109); + } + } + +} + +static +void halbtc8822b2ant_action_a2dp_pan_hs(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif + + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2);*/ + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) { + + if ((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 7); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 5); + } else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 6); + + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + if (wifi_turbo) + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 6); + else + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, + 7); + + if (wifi_busy) { + + if ((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 107); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 105); + } else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 106); + + } + +} + + + + +/* PAN(EDR)+A2DP */ +static +void halbtc8822b2ant_action_pan_edr_a2dp(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) { + + if (((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) || + (!coex_sta->is_A2DP_3M)) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 7); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 5); + } else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 6); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, + 8); + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 107); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 106); + } + +} + + +static +void halbtc8822b2ant_action_pan_edr_hid(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 2); + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 3); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 4); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); + halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0); + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 8); + + if (wifi_busy) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 103); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 104); + } + +} + + +/* HID+A2DP+PAN(EDR) */ +static +void halbtc8822b2ant_action_hid_a2dp_pan_edr(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE; + u32 wifi_bw = 1; + + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_BW, + &wifi_bw); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 4); + + if (wifi_busy) { + + if (((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) || + (!coex_sta->is_A2DP_3M)) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 7); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 5); + } else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 6); + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + if (coex_sta->hid_busy_num >= 2) { + halbtc8822b2ant_coex_table_with_type(btcoexist, + NORMAL_EXEC, 8); + + if (wifi_bw == 0) { + halbtc8822b2ant_set_wltoggle_coex_table( + btcoexist, + NORMAL_EXEC, + 0x1, 0xaa, + 0x5a, 0xaa, + 0xaa); + } + else + halbtc8822b2ant_set_wltoggle_coex_table( + btcoexist, + NORMAL_EXEC, + 0x2, 0xaa, + 0x5a, 0xaa, + 0xaa); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 110); + } else { + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 1); + + if (wifi_busy) { + + if ((coex_sta->a2dp_bit_pool > 40) && + (coex_sta->a2dp_bit_pool < 255)) + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 107); + else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, + TRUE, 105); + } else + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, TRUE, + 106); + } + } + +} + +static +void halbtc8822b2ant_action_bt_whck_test(IN struct btc_coexist *btcoexist) +{ + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); +#if 0 + /*halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT);*/ +#endif + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); +} + +static +void halbtc8822b2ant_action_bt_hs(IN struct btc_coexist *btcoexist) +{ + static u8 prewifi_rssi_state = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state, bt_rssi_state; + + static u8 prewifi_rssi_state2 = BTC_RSSI_STATE_LOW; + static u8 pre_bt_rssi_state2 = BTC_RSSI_STATE_LOW; + u8 wifi_rssi_state2, bt_rssi_state2; + boolean wifi_busy = FALSE, wifi_turbo = FALSE; + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], scan_ap_num = %d, wl_noisy = %d\n", + coex_sta->scan_ap_num, coex_sta->wl_noisy_level); + BTC_TRACE(trace_buf); + +#if 1 + if ((wifi_busy) && (coex_sta->wl_noisy_level == 0)) + wifi_turbo = TRUE; +#endif + + + wifi_rssi_state = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state, 2, + coex_sta->wifi_coex_thres, 0); + + wifi_rssi_state2 = halbtc8822b2ant_wifi_rssi_state(btcoexist, + &prewifi_rssi_state2, 2, + coex_sta->wifi_coex_thres2, 0); + + bt_rssi_state = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state, 2, + coex_sta->bt_coex_thres, 0); + + bt_rssi_state2 = halbtc8822b2ant_bt_rssi_state(btcoexist, + &pre_bt_rssi_state2, 2, + coex_sta->bt_coex_thres2, 0); + + if (BTC_RSSI_HIGH(wifi_rssi_state) && + BTC_RSSI_HIGH(bt_rssi_state)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } else if (BTC_RSSI_HIGH(wifi_rssi_state2) && + BTC_RSSI_HIGH(bt_rssi_state2)) { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + coex_dm->is_switch_to_1dot5_ant = FALSE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + + } else { + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + coex_dm->is_switch_to_1dot5_ant = TRUE; + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + } + +} + +static +void halbtc8822b2ant_action_wifi_multi_port(IN struct btc_coexist *btcoexist) +{ + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + /* hw all off */ + /*halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0);*/ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, TRUE); + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 0); + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xc8); + +#if 0 + /*halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT);*/ +#endif + + /*halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0);*/ +} + +static +void halbtc8822b2ant_action_wifi_connected(IN struct btc_coexist *btcoexist) + { + switch (coex_dm->cur_algorithm) { + + case BT_8822B_2ANT_COEX_ALGO_SCO: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = SCO.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_sco(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_hid(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_a2dp(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_A2DPSINK: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP Sink.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_a2dpsink(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_A2DP_PANHS: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = A2DP+PAN(HS).\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_a2dp_pan_hs(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN(EDR).\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_pan_edr(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_PANEDR_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN+A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_pan_edr_a2dp(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_PANEDR_HID: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = PAN(EDR)+HID.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_pan_edr_hid(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID+A2DP+PAN.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_hid_a2dp_pan_edr( + btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_HID_A2DP: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = HID+A2DP.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_hid_a2dp(btcoexist); + break; + case BT_8822B_2ANT_COEX_ALGO_NOPROFILEBUSY: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = No-Profile busy.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_bt_idle(btcoexist); + break; + default: + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, algorithm = coexist All Off!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8822b2ant_action_coex_all_off(btcoexist); + break; + } + + coex_dm->pre_algorithm = coex_dm->cur_algorithm; + + } + +static +void halbtc8822b2ant_run_coexist_mechanism(IN struct btc_coexist *btcoexist) +{ + u8 algorithm = 0; + u32 num_of_wifi_link = 0; + u32 wifi_link_status = 0; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + boolean miracast_plus_bt = FALSE; + boolean scan = FALSE, link = FALSE, roam = FALSE, + under_4way = FALSE, + wifi_connected = FALSE, wifi_under_5g = + FALSE, + bt_hs_on = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &roam); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism()===>\n"); + BTC_TRACE(trace_buf); + + if (btcoexist->manual_control) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Manual CTRL <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (btcoexist->stop_coex_dm) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), return for Stop Coex DM <===\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->under_ips) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under IPS !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if ((coex_sta->under_lps) && + (coex_dm->bt_status != BT_8822B_2ANT_BT_STATUS_ACL_BUSY)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RunCoexistMechanism(), wifi is under LPS !!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_wifi_native_lps(btcoexist); + return; + } + + if (!coex_sta->run_time_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], return for run_time_state = FALSE !!!\n"); + BTC_TRACE(trace_buf); + return; + } + + if (coex_sta->freeze_coexrun_by_btinfo) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BtInfoNotify(), return for freeze_coexrun_by_btinfo\n"); + BTC_TRACE(trace_buf); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((wifi_under_5g) && + (coex_sta->switch_band_notify_to != BTC_SWITCH_TO_24G) && + (coex_sta->switch_band_notify_to != BTC_SWITCH_TO_24G_NOFORSCAN)) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 5G!!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8822b2ant_action_wifi_under5g(btcoexist); + return; + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 2G!!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME); + + + if (coex_sta->bt_whck_test) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under WHCK TEST!!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_bt_whck_test(btcoexist); + return; + } + + if (coex_sta->bt_disabled) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is disabled!!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8822b2ant_action_coex_all_off(btcoexist); + return; + } + + if (coex_sta->c2h_bt_inquiry_page) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is under inquiry/page scan !!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8822b2ant_action_bt_inquiry(btcoexist); + return; + } + + if (coex_sta->is_setupLink) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT is re-link !!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + halbtc8822b2ant_action_bt_relink(btcoexist); + return; + } + + /* for P2P */ + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_LINK_STATUS, + &wifi_link_status); + num_of_wifi_link = wifi_link_status >> 16; + + if ((num_of_wifi_link >= 2) || + (wifi_link_status & WIFI_P2P_GO_CONNECTED)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], Multi-Port num_of_wifi_link = %d, wifi_link_status = 0x%x\n", + num_of_wifi_link, wifi_link_status); + BTC_TRACE(trace_buf); + + if (bt_link_info->bt_link_exist) + miracast_plus_bt = TRUE; + else + miracast_plus_bt = FALSE; + + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + + if (scan || link || roam || under_4way) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], scan = %d, link = %d, roam = %d 4way = %d!!!\n", + scan, link, roam, under_4way); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], wifi is under linkscan process + Multi-Port !!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_action_wifi_link_process(btcoexist); + } else { + halbtc8822b2ant_action_wifi_multi_port(btcoexist); + } + + return; + } + + miracast_plus_bt = FALSE; + btcoexist->btc_set(btcoexist, BTC_SET_BL_MIRACAST_PLUS_BT, + &miracast_plus_bt); + + + + btcoexist->btc_get(btcoexist, BTC_GET_BL_HS_OPERATION, &bt_hs_on); + + if (bt_hs_on) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "############# [BTCoex], BT Is hs\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_bt_hs(btcoexist); + return; + } + + if ((BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) || + (BT_8822B_2ANT_BT_STATUS_CONNECTED_IDLE == + coex_dm->bt_status)) { + halbtc8822b2ant_rx_gain(btcoexist, NORMAL_EXEC, FALSE); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, bt idle!!.\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_action_bt_idle(btcoexist); + return; + } + + algorithm = halbtc8822b2ant_action_algorithm(btcoexist); + coex_dm->cur_algorithm = algorithm; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Algorithm = %d\n", + coex_dm->cur_algorithm); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + if (scan || link || roam || under_4way) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under Link Process !!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_wifi_link_process(btcoexist); + } else if (wifi_connected) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, wifi connected!!.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_wifi_connected(btcoexist); + + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Action 2-Ant, wifi not-connected!!.\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_action_wifi_nonconnected(btcoexist); + } +} + +static +void halbtc8822b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Coex Mechanism Init!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_low_penalty_ra(btcoexist, NORMAL_EXEC, FALSE); + + halbtc8822b2ant_coex_table_with_type(btcoexist, NORMAL_EXEC, 5); +#if 0 + /*halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, NORMAL_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT);*/ +#endif + + /* fw all off */ + halbtc8822b2ant_ps_tdma(btcoexist, NORMAL_EXEC, FALSE, 0); + + halbtc8822b2ant_fw_dac_swing_lvl(btcoexist, NORMAL_EXEC, 0xd8); +#if 0 + /*halbtc8822b2ant_dec_bt_pwr(btcoexist, NORMAL_EXEC, 0);*/ +#endif + + coex_sta->pop_event_cnt = 0; + coex_sta->cnt_RemoteNameReq = 0; + coex_sta->cnt_ReInit = 0; + coex_sta->cnt_setupLink = 0; + coex_sta->cnt_IgnWlanAct = 0; + coex_sta->cnt_Page = 0; + coex_sta->cnt_RoleSwitch = 0; + coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; + + halbtc8822b2ant_query_bt_info(btcoexist); +} + + +static +void halbtc8822b2ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only) +{ + u32 u32tmp1 = 0, u32tmp2 = 0, u32tmp3 = 0; + u32 RTL97F_8822B = 0; + u8 i = 0; + + + u32tmp3 = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u32tmp1 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp2 = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + + if (RTL97F_8822B) { + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x66, 0x04, 0x0); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x0); + + /* set GNT_BT to SW high */ + halbtc8822b2ant_ltecoex_set_gnt_bt(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + /* Set GNT_WL to SW high */ + halbtc8822b2ant_ltecoex_set_gnt_wl(btcoexist, + BT_8822B_2ANT_GNT_BLOCK_RFC_BB, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH); + return; + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], (Before Init HW config) 0xcb4 = 0x%x, 0x38= 0x%x, 0x54= 0x%x\n", + u32tmp3, u32tmp1, u32tmp2); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], 2Ant Init HW Config!!\n"); + BTC_TRACE(trace_buf); + + coex_sta->bt_coex_supported_feature = 0; + coex_sta->bt_coex_supported_version = 0; + coex_sta->bt_ble_scan_type = 0; + coex_sta->bt_ble_scan_para[0] = 0; + coex_sta->bt_ble_scan_para[1] = 0; + coex_sta->bt_ble_scan_para[2] = 0; + coex_sta->bt_reg_vendor_ac = 0xffff; + coex_sta->bt_reg_vendor_ae = 0xffff; + coex_sta->isolation_btween_wb = BT_8822B_2ANT_DEFAULT_ISOLATION; + coex_sta->gnt_error_cnt = 0; + coex_sta->bt_relink_downcount = 0; + coex_sta->is_set_ps_state_fail = FALSE; + coex_sta->cnt_set_ps_state_fail = 0; + + for (i = 0; i <= 9; i++) + coex_sta->bt_afh_map[i] = 0; + + /* 0xf0[15:12] --> Chip Cut information */ + coex_sta->cut_version = (btcoexist->btc_read_1byte(btcoexist, + 0xf1) & 0xf0) >> 4; + + coex_sta->dis_ver_info_cnt = 0; + + halbtc8822b2ant_coex_switch_threshold(btcoexist, + coex_sta->isolation_btween_wb); + + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x550, 0x8, + 0x1); /* enable TBTT nterrupt */ + + /* BT report packet sample rate */ + btcoexist->btc_write_1byte(btcoexist, 0x790, 0x5); + + /* Init 0x778 = 0x1 for 2-Ant */ + btcoexist->btc_write_1byte(btcoexist, 0x778, 0x1); + + /* Enable PTA (3-wire function form BT side) */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x40, 0x20, 0x1); + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x41, 0x02, 0x1); + + /* Enable PTA (tx/rx signal form WiFi side) */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x4c6, 0x10, 0x1); + + halbtc8822b2ant_enable_gnt_to_gpio(btcoexist, TRUE); + + /*GNT_BT=1 while select both */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x763, 0x10, 0x1); + + + /* check if WL firmware download ok */ +#if 0 + if (btcoexist->btc_read_1byte(btcoexist, 0x80) == 0xc6) +#endif + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ONOFF, TRUE); + + /* Enable counter statistics */ + btcoexist->btc_write_1byte(btcoexist, 0x76e, + 0x4); /* 0x76e[3] =1, WLAN_Act control by PTA */ + +#if 0 + /* WLAN_Tx by GNT_WL 0x950[29] = 0 */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x20, 0x0); +#endif + + halbtc8822b2ant_coex_table_with_type(btcoexist, FORCE_EXEC, 5); + + halbtc8822b2ant_ps_tdma(btcoexist, FORCE_EXEC, FALSE, 0); + + psd_scan->ant_det_is_ant_det_available = TRUE; + + if (coex_sta->is_rf_state_off) { + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_WLAN_OFF); + + btcoexist->stop_coex_dm = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** halbtc8822b2ant_init_hw_config (RF Off)**********\n"); + BTC_TRACE(trace_buf); + } else if (wifi_only) { + coex_sta->concurrent_rx_mode_on = FALSE; + /* Path config */ + /* Set Antenna Path */ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_WLANONLY_INIT); + + btcoexist->stop_coex_dm = TRUE; + } else { + /* Set BT polluted packet on for Tx rate adaptive not including + * Tx retry break by PTA, 0x45c[19] =1 + */ + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x45e, 0x8, 0x1); + + coex_sta->concurrent_rx_mode_on = TRUE; +#if 0 + btcoexist->btc_write_1byte_bitmask(btcoexist, 0x953, 0x2, 0x1); +#endif + + /* RF 0x1[1] = 0->Set GNT_WL_RF_Rx always = 1 for + * con-current Rx, mask Tx only + */ + btcoexist->btc_set_rf_reg(btcoexist, BTC_RF_A, 0x1, 0x2, 0x0); + + /* Set Antenna Path */ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_COEX_INIT); + + btcoexist->stop_coex_dm = FALSE; + } +} + + + +/* ************************************************************ + * work around function start with wa_halbtc8822b2ant_ + * ************************************************************ + * ************************************************************ + * extern function start with ex_halbtc8822b2ant_ + * ************************************************************ */ +void ex_halbtc8822b2ant_power_on_setting(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u8 u8tmp = 0x0; + u16 u16tmp = 0x0; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "xxxxxxxxxxxxxxxx Execute 8822b 2-Ant PowerOn Setting xxxxxxxxxxxxxxxx!!\n"); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "Ant Det Finish = %s, Ant Det Number = %d\n", + (board_info->btdm_ant_det_finish ? "Yes" : "No"), + board_info->btdm_ant_num_by_ant_det); + BTC_TRACE(trace_buf); + + + btcoexist->stop_coex_dm = TRUE; + psd_scan->ant_det_is_ant_det_available = FALSE; + + /* enable BB, REG_SYS_FUNC_EN such that we can write BB Reg correctly */ + u16tmp = btcoexist->btc_read_2byte(btcoexist, 0x2); + btcoexist->btc_write_2byte(btcoexist, 0x2, u16tmp | BIT(0) | BIT(1)); + + + /* Local setting bit define */ + /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ + /* BIT1: "0" for internal switch; "1" for external switch */ + /* BIT2: "0" for one antenna; "1" for two antenna */ + /* NOTE: here default all internal switch and 1-antenna ==> + * BIT1=0 and BIT2=0 + */ + + /* Check efuse 0xc3[6] for Single Antenna Path */ +#if 0 + if (board_info->single_ant_path == 0) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** Single Antenna, Antenna at Aux Port\n"); + BTC_TRACE(trace_buf); + + board_info->btdm_ant_pos = BTC_ANTENNA_AT_AUX_PORT; + + u8tmp = 7; + } else if (board_info->single_ant_path == 1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** Single Antenna, Antenna at Main Port\n"); + BTC_TRACE(trace_buf); + + board_info->btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; + + u8tmp = 6; + } + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** (Power On) single_ant_path = %d, btdm_ant_pos = %d\n", + board_info->single_ant_path , board_info->btdm_ant_pos); + BTC_TRACE(trace_buf); +#endif + + /* Setup RF front end type */ + halbtc8822b2ant_set_rfe_type(btcoexist); + + /* Set Antenna Path to BT side */ + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_COEX_POWERON); + + /* Save"single antenna position" info in Local register setting for + * FW reading, because FW may not ready at power on + */ + if (btcoexist->chip_interface == BTC_INTF_PCI) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_USB) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_SDIO) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, u8tmp); + + /* enable GNT_WL/GNT_BT debug signal to GPIO14/15 */ + halbtc8822b2ant_enable_gnt_to_gpio(btcoexist, TRUE); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** LTE coex Reg 0x38 (Power-On) = 0x%x**********\n", + halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x38)); + BTC_TRACE(trace_buf); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** MAC Reg 0x70/ BB Reg 0xcb4 (Power-On) = 0x%x / 0x%x\n", + btcoexist->btc_read_4byte(btcoexist, 0x70), + btcoexist->btc_read_4byte(btcoexist, 0xcb4)); + BTC_TRACE(trace_buf); + +} + +void ex_halbtc8822b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + u8 u8tmp = 0x4; /* Set BIT2 by default since it's 2ant case */ + + /* */ + /* S0 or S1 setting and Local register setting + * (By the setting fw can get ant number, S0/S1, ... info) + */ + /* Local setting bit define */ + /* BIT0: "0" for no antenna inverse; "1" for antenna inverse */ + /* BIT1: "0" for internal switch; "1" for external switch */ + /* BIT2: "0" for one antenna; "1" for two antenna */ + /* NOTE: here default all internal switch and 1-antenna ==> + * BIT1=0 and BIT2=0 + */ + if (btcoexist->chip_interface == BTC_INTF_USB) { + /* fixed at S0 for USB interface */ + u8tmp |= 0x1; /* antenna inverse */ + btcoexist->btc_write_local_reg_1byte(btcoexist, 0xfe08, u8tmp); + } else { + /* for PCIE and SDIO interface, we check efuse 0xc3[6] */ + if (board_info->single_ant_path == 0) { + } else if (board_info->single_ant_path == 1) { + /* set to S0 */ + u8tmp |= 0x1; /* antenna inverse */ + } + + if (btcoexist->chip_interface == BTC_INTF_PCI) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x3e0, + u8tmp); + else if (btcoexist->chip_interface == BTC_INTF_SDIO) + btcoexist->btc_write_local_reg_1byte(btcoexist, 0x60, + u8tmp); + } +} + +void ex_halbtc8822b2ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only) +{ + halbtc8822b2ant_init_hw_config(btcoexist, wifi_only); +} + +void ex_halbtc8822b2ant_init_coex_dm(IN struct btc_coexist *btcoexist) +{ + + halbtc8822b2ant_init_coex_dm(btcoexist); +} + +void ex_halbtc8822b2ant_display_coex_info(IN struct btc_coexist *btcoexist) +{ + struct btc_board_info *board_info = &btcoexist->board_info; + struct btc_bt_link_info *bt_link_info = &btcoexist->bt_link_info; + + u8 *cli_buf = btcoexist->cli_buf; + u8 u8tmp[4], i, ps_tdma_case = 0; + u32 u32tmp[4]; + u16 u16tmp[4]; + u32 fa_ofdm, fa_cck, cca_ofdm, cca_cck, ratio_ofdm; + u32 fw_ver = 0, bt_patch_ver = 0, bt_coex_ver = 0; + static u8 pop_report_in_10s = 0; + u32 phyver = 0; + boolean lte_coex_on = FALSE; + static u8 cnt = 0; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[BT Coexist info]============"); + CL_PRINTF(cli_buf); + + if (btcoexist->manual_control) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n ============[Under Manual Control]============"); + CL_PRINTF(cli_buf); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n =========================================="); + CL_PRINTF(cli_buf); + } + + if (!coex_sta->bt_disabled) { + if (coex_sta->bt_coex_supported_feature == 0) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_FEATURE, + &coex_sta->bt_coex_supported_feature); + + if ((coex_sta->bt_coex_supported_version == 0) || + (coex_sta->bt_coex_supported_version == 0xffff)) + btcoexist->btc_get(btcoexist, BTC_GET_U4_SUPPORTED_VERSION, + &coex_sta->bt_coex_supported_version); + + if (coex_sta->bt_reg_vendor_ac == 0xffff) + coex_sta->bt_reg_vendor_ac = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xac) & 0xffff); + + if (coex_sta->bt_reg_vendor_ae == 0xffff) + coex_sta->bt_reg_vendor_ae = (u16)( + btcoexist->btc_get_bt_reg(btcoexist, 3, + 0xae) & 0xffff); + + btcoexist->btc_get(btcoexist, BTC_GET_U4_BT_PATCH_VER, + &bt_patch_ver); + btcoexist->bt_info.bt_get_fw_ver = bt_patch_ver; + + if (coex_sta->num_of_profile > 0) { + cnt++; + + if (cnt >= 3) { + btcoexist->btc_get_bt_afh_map_from_bt(btcoexist, 0, + &coex_sta->bt_afh_map[0]); + cnt = 0; + } + } + } + + if (psd_scan->ant_det_try_count == 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s / %d", + "Ant PG Num/ Mech/ Pos/ RFE", + board_info->pg_ant_num, board_info->btdm_ant_num, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + rfe_type->rfe_module_type); + CL_PRINTF(cli_buf); + } else { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %s/ %d (%d/%d/%d)", + "Ant PG Num/ Mech(Ant_Det)/ Pos/ RFE", + board_info->pg_ant_num, + board_info->btdm_ant_num_by_ant_det, + (board_info->btdm_ant_pos == BTC_ANTENNA_AT_MAIN_PORT + ? "Main" : "Aux"), + rfe_type->rfe_module_type, + psd_scan->ant_det_try_count, + psd_scan->ant_det_fail_count, + psd_scan->ant_det_result); + CL_PRINTF(cli_buf); + + + if (board_info->btdm_ant_det_finish) { + + if (psd_scan->ant_det_result != 12) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s", + "Ant Det PSD Value", + psd_scan->ant_det_peak_val); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d", + "Ant Det PSD Value", + psd_scan->ant_det_psd_scan_peak_val + / 100); + CL_PRINTF(cli_buf); + } + } + + + bt_patch_ver = btcoexist->bt_info.bt_get_fw_ver; + btcoexist->btc_get(btcoexist, BTC_GET_U4_WIFI_FW_VER, &fw_ver); + phyver = btcoexist->btc_get_bt_phydm_version(btcoexist); + + bt_coex_ver = (coex_sta->bt_coex_supported_version & 0xff); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d_%02x/ 0x%02x/ 0x%02x (%s)", + "CoexVer WL/ BT_Desired/ BT_Report", + glcoex_ver_date_8822b_2ant, glcoex_ver_8822b_2ant, + glcoex_ver_btdesired_8822b_2ant, + bt_coex_ver, + (bt_coex_ver == 0xff ? "Unknown" : + (coex_sta->bt_disabled ? "BT-disable" : + (bt_coex_ver >= glcoex_ver_btdesired_8822b_2ant ? + "Match" : "Mis-Match")))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ v%d/ %c", + "W_FW/ B_FW/ Phy/ Kt", + fw_ver, bt_patch_ver, phyver, + coex_sta->cut_version + 65); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x ", + "AFH Map to BT", + coex_dm->wifi_chnl_info[0], coex_dm->wifi_chnl_info[1], + coex_dm->wifi_chnl_info[2]); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d / %d / %d ", + "Isolation/WL_Thres/BT_Thres", + coex_sta->isolation_btween_wb, + coex_sta->wifi_coex_thres, + coex_sta->bt_coex_thres); + CL_PRINTF(cli_buf); + + /* wifi status */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Wifi Status]============"); + CL_PRINTF(cli_buf); + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_WIFI_STATUS); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[BT Status]============"); + CL_PRINTF(cli_buf); + + pop_report_in_10s++; + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = [%s/ %d dBm/ %d/ %d] ", + "BT [status/ rssi/ retryCnt/ popCnt]", + ((coex_sta->bt_disabled) ? ("disabled") : (( + coex_sta->c2h_bt_inquiry_page) ? ("inquiry/page") + : ((BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE == + coex_dm->bt_status) ? "non-connected idle" : + ((coex_dm->bt_status == BT_8822B_2ANT_BT_STATUS_CONNECTED_IDLE) + ? "connected-idle" : "busy")))), + coex_sta->bt_rssi - 100, coex_sta->bt_retry_cnt, + coex_sta->pop_event_cnt); + CL_PRINTF(cli_buf); + + if (pop_report_in_10s >= 5) { + coex_sta->pop_event_cnt = 0; + pop_report_in_10s = 0; + } + + + if (coex_sta->num_of_profile != 0) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s%s%s%s%s", + "Profiles", + ((bt_link_info->a2dp_exist) ? + ((coex_sta->is_bt_a2dp_sink) ? "A2DP sink," : + "A2DP,") : ""), + ((bt_link_info->sco_exist) ? "HFP," : ""), + ((bt_link_info->hid_exist) ? + ((coex_sta->hid_busy_num >= 2) ? "HID(4/18)," : + "HID(2/18),") : ""), + ((bt_link_info->pan_exist) ? "PAN," : ""), + ((coex_sta->voice_over_HOGP) ? "Voice" : "")); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = None", "Profiles"); + + CL_PRINTF(cli_buf); + + + if (bt_link_info->a2dp_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s", + "A2DP Rate/Bitpool/Auto_Slot", + ((coex_sta->is_A2DP_3M) ? "3M" : "No_3M"), + coex_sta->a2dp_bit_pool, + ((coex_sta->is_autoslot) ? "On" : "Off") + ); + CL_PRINTF(cli_buf); + } + + if (bt_link_info->hid_exist) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "HID PairNum/Forbid_Slot", + coex_sta->hid_pair_cnt, + coex_sta->forbidden_slot + ); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %d/ %s/ 0x%x", + "Role/RoleSwCnt/IgnWlact/Feature", + ((bt_link_info->slave_role) ? "Slave" : "Master"), + coex_sta->cnt_RoleSwitch, + ((coex_dm->cur_ignore_wlan_act) ? "Yes" : "No"), + coex_sta->bt_coex_supported_feature); + CL_PRINTF(cli_buf); + + if ((coex_sta->bt_ble_scan_type & 0x7) != 0x0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "BLEScan Type/TV/Init/Ble", + coex_sta->bt_ble_scan_type, + (coex_sta->bt_ble_scan_type & 0x1 ? + coex_sta->bt_ble_scan_para[0] : 0x0), + (coex_sta->bt_ble_scan_type & 0x2 ? + coex_sta->bt_ble_scan_para[1] : 0x0), + (coex_sta->bt_ble_scan_type & 0x4 ? + coex_sta->bt_ble_scan_para[2] : 0x0)); + CL_PRINTF(cli_buf); + } + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", + "ReInit/ReLink/IgnWlact/Page/NameReq", + coex_sta->cnt_ReInit, + coex_sta->cnt_setupLink, + coex_sta->cnt_IgnWlanAct, + coex_sta->cnt_Page, + coex_sta->cnt_RemoteNameReq + ); + CL_PRINTF(cli_buf); + + halbtc8822b2ant_read_score_board(btcoexist, &u16tmp[0]); + + if ((coex_sta->bt_reg_vendor_ae == 0xffff) || + (coex_sta->bt_reg_vendor_ac == 0xffff)) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = x/ x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", u16tmp[0]); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %04x", + "0xae[4]/0xac[1:0]/Scoreboard", + (int)((coex_sta->bt_reg_vendor_ae & BIT(4)) >> 4), + coex_sta->bt_reg_vendor_ac & 0x3, u16tmp[0]); + CL_PRINTF(cli_buf); + + if (coex_sta->num_of_profile > 0) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x", + "AFH MAP", + coex_sta->bt_afh_map[0], + coex_sta->bt_afh_map[1], + coex_sta->bt_afh_map[2], + coex_sta->bt_afh_map[3], + coex_sta->bt_afh_map[4], + coex_sta->bt_afh_map[5], + coex_sta->bt_afh_map[6], + coex_sta->bt_afh_map[7], + coex_sta->bt_afh_map[8], + coex_sta->bt_afh_map[9] + ); + CL_PRINTF(cli_buf); + } + + for (i = 0; i < BT_INFO_SRC_8822B_2ANT_MAX; i++) { + if (coex_sta->bt_info_c2h_cnt[i]) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x %02x %02x(%d)", + glbt_info_src_8822b_2ant[i], + coex_sta->bt_info_c2h[i][0], + coex_sta->bt_info_c2h[i][1], + coex_sta->bt_info_c2h[i][2], + coex_sta->bt_info_c2h[i][3], + coex_sta->bt_info_c2h[i][4], + coex_sta->bt_info_c2h[i][5], + coex_sta->bt_info_c2h[i][6], + coex_sta->bt_info_c2h_cnt[i]); + CL_PRINTF(cli_buf); + } + } + + /* Sw mechanism */ + if (btcoexist->manual_control) + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[mechanism] (before Manual)============"); + else + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Mechanism]============"); + + CL_PRINTF(cli_buf); + + + ps_tdma_case = coex_dm->cur_ps_tdma; + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %02x %02x %02x %02x %02x (case-%d, %s, %s)", + "TDMA", + coex_dm->ps_tdma_para[0], coex_dm->ps_tdma_para[1], + coex_dm->ps_tdma_para[2], coex_dm->ps_tdma_para[3], + coex_dm->ps_tdma_para[4], ps_tdma_case, + (coex_dm->cur_ps_tdma_on ? "TDMA On" : "TDMA Off"), + (coex_dm->is_switch_to_1dot5_ant ? "1.5Ant" : "2Ant")); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6c0); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0x6c4); + u32tmp[2] = btcoexist->btc_read_4byte(btcoexist, 0x6c8); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ 0x%x/ 0x%x/ 0x%x", + "Table/0x6c0/0x6c4/0x6c8", + coex_sta->coex_table_type, u32tmp[0], u32tmp[1], u32tmp[2]); + CL_PRINTF(cli_buf); + + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x778); + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x6cc); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x", + "0x778/0x6cc", + u8tmp[0], u32tmp[0]); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", + "AntDiv/BtCtrlLPS/LPRA/PsFail", + ((board_info->ant_div_cfg) ? "On" : "Off"), + ((coex_sta->force_lps_ctrl) ? "On" : "Off"), + ((coex_dm->cur_low_penalty_ra) ? "On" : "Off"), + coex_sta->cnt_set_ps_state_fail); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "WL_DACSwing/ BT_Dec_Pwr", coex_dm->cur_fw_dac_swing_lvl, + coex_dm->cur_bt_dec_pwr_lvl); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + lte_coex_on = ((u32tmp[0] & BIT(7)) >> 7) ? TRUE : FALSE; + + if (lte_coex_on) { + + u32tmp[0] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0xa0); + u32tmp[1] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0xa4); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = 0x%x/ 0x%x", + "LTE Coex Table W_L/B_L", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff); + CL_PRINTF(cli_buf); + + + u32tmp[0] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0xa8); + u32tmp[1] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0xac); + u32tmp[2] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0xb0); + u32tmp[3] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, + 0xb4); + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "LTE Break Table W_L/B_L/L_W/L_B", + u32tmp[0] & 0xffff, u32tmp[1] & 0xffff, + u32tmp[2] & 0xffff, u32tmp[3] & 0xffff); + CL_PRINTF(cli_buf); + + } + + /* Hw setting */ + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s", + "============[Hw setting]============"); + CL_PRINTF(cli_buf); + + u32tmp[0] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x38); + u32tmp[1] = halbtc8822b2ant_ltecoex_indirect_read_reg(btcoexist, 0x54); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x73); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s", + "LTE Coex/Path Owner", + ((lte_coex_on) ? "On" : "Off"), + ((u8tmp[0] & BIT(2)) ? "WL" : "BT")); + CL_PRINTF(cli_buf); + + if (lte_coex_on) { + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %d/ %d/ %d/ %d", + "LTE 3Wire/OPMode/UART/UARTMode", + (int)((u32tmp[0] & BIT(6)) >> 6), + (int)((u32tmp[0] & (BIT(5) | BIT(4))) >> 4), + (int)((u32tmp[0] & BIT(3)) >> 3), + (int)(u32tmp[0] & (BIT(2) | BIT(1) | BIT(0)))); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "LTE_Busy/UART_Busy", + (int)((u32tmp[1] & BIT(1)) >> 1), + (int)(u32tmp[1] & BIT(0))); + CL_PRINTF(cli_buf); + } + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = %s (BB:%s)/ %s (BB:%s)/ %s %d", + "GNT_WL_Ctrl/GNT_BT_Ctrl/Dbg", + ((u32tmp[0] & BIT(12)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(8)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(14)) ? "SW" : "HW"), + ((u32tmp[0] & BIT(10)) ? "SW" : "HW"), + ((u8tmp[0] & BIT(3)) ? "On" : "Off"), + coex_sta->gnt_error_cnt); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "GNT_WL/GNT_BT", + (int)((u32tmp[1] & BIT(2)) >> 2), + (int)((u32tmp[1] & BIT(3)) >> 3)); + CL_PRINTF(cli_buf); + + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0xcbc); + u32tmp[1] = btcoexist->btc_read_4byte(btcoexist, 0xcb4); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0xcba); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%04x/ 0x%04x/ 0x%02x %s", + "0xcbc/0xcb4/0xcb8[23:16]", + u32tmp[0], u32tmp[1], u8tmp[0], + ((u8tmp[0] & 0x1) == 0x1 ? "(BTG)" : "(WL_A+G)")); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x4c); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0x64); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x4c6); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x40); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x", + "4c[24:23]/64[0]/4c6[4]/40[5]", + (int)(u32tmp[0] & (BIT(24) | BIT(23))) >> 23, u8tmp[2] & 0x1, + (int)((u8tmp[0] & BIT(4)) >> 4), + (int)((u8tmp[1] & BIT(5)) >> 5)); + CL_PRINTF(cli_buf); + + u32tmp[0] = btcoexist->btc_read_4byte(btcoexist, 0x550); + u8tmp[0] = btcoexist->btc_read_1byte(btcoexist, 0x522); + u8tmp[1] = btcoexist->btc_read_1byte(btcoexist, 0x953); + u8tmp[2] = btcoexist->btc_read_1byte(btcoexist, 0xc50); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ %s/ 0x%x", + "0x550/0x522/4-RxAGC/0xc50", + u32tmp[0], u8tmp[0], (u8tmp[1] & 0x2) ? "On" : "Off", u8tmp[2]); + CL_PRINTF(cli_buf); + + fa_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_OFDM); + fa_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_FA_CCK); + cca_ofdm = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_OFDM); + cca_cck = btcoexist->btc_phydm_query_PHY_counter(btcoexist, + PHYDM_INFO_CCA_CCK); + + ratio_ofdm = (fa_ofdm == 0) ? 1000 : (cca_ofdm/fa_ofdm); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, + "\r\n %-35s = 0x%x/ 0x%x/ 0x%x/ 0x%x (%d)", + "CCK-CCA/CCK-FA/OFDM-CCA/OFDM-FA", + cca_cck, fa_cck, cca_ofdm, fa_ofdm, + ratio_ofdm); + CL_PRINTF(cli_buf); + +#if 1 + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d", + "CRC_OK CCK/11g/11n/11ac", + coex_sta->crc_ok_cck, coex_sta->crc_ok_11g, + coex_sta->crc_ok_11n, coex_sta->crc_ok_11n_vht); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d (%d, %d)", + "CRC_Err CCK/11g/11n/11ac", + coex_sta->crc_err_cck, coex_sta->crc_err_11g, + coex_sta->crc_err_11n, coex_sta->crc_err_11n_vht, + coex_sta->now_crc_ratio, coex_sta->acc_crc_ratio); + CL_PRINTF(cli_buf); +#endif + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s/ %s/ %s/ %d", + "WlHiPri/ Locking/ Locked/ Noisy", + (coex_sta->wifi_is_high_pri_task ? "Yes" : "No"), + (coex_sta->cck_lock ? "Yes" : "No"), + (coex_sta->cck_ever_lock ? "Yes" : "No"), + coex_sta->wl_noisy_level); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d", + "0x770(Hi-pri rx/tx)", + coex_sta->high_priority_rx, coex_sta->high_priority_tx); + CL_PRINTF(cli_buf); + + CL_SPRINTF(cli_buf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d %s", + "0x774(Lo-pri rx/tx)", + coex_sta->low_priority_rx, coex_sta->low_priority_tx, + (bt_link_info->slave_role ? "(Slave!!)" : ( + coex_sta->is_tdma_btautoslot_hang ? "(auto-slot hang!!)" : ""))); + CL_PRINTF(cli_buf); + + btcoexist->btc_disp_dbg_msg(btcoexist, BTC_DBG_DISP_COEX_STATISTICS); +} + + +void ex_halbtc8822b2ant_ips_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (BTC_IPS_ENTER == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS ENTER notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_ips = TRUE; + coex_sta->under_lps = FALSE; + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, FALSE); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ONOFF, FALSE); + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_WLAN_OFF); + + halbtc8822b2ant_action_coex_all_off(btcoexist); + } else if (BTC_IPS_LEAVE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], IPS LEAVE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_ips = FALSE; + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ONOFF, TRUE); + halbtc8822b2ant_init_hw_config(btcoexist, FALSE); + halbtc8822b2ant_init_coex_dm(btcoexist); + halbtc8822b2ant_query_bt_info(btcoexist); + } +} + + + +void ex_halbtc8822b2ant_lps_notify(IN struct btc_coexist *btcoexist, IN u8 type) +{ + static boolean pre_force_lps_on = FALSE; + + if (btcoexist->manual_control || btcoexist->stop_coex_dm) + return; + + if (BTC_LPS_ENABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS ENABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = TRUE; + coex_sta->under_ips = FALSE; + + if (coex_sta->force_lps_ctrl) { /* LPS No-32K */ + /* Write WL "Active" in Score-board for PS-TDMA */ + pre_force_lps_on = TRUE; + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + + } else { + /* LPS-32K, need check if this h2c 0x71 can work?? + * (2015/08/28) + */ + /* Write WL "Non-Active" in Score-board for Native-PS */ + pre_force_lps_on = FALSE; + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, FALSE); + } + + } else if (BTC_LPS_DISABLE == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], LPS DISABLE notify\n"); + BTC_TRACE(trace_buf); + coex_sta->under_lps = FALSE; + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + + if ((!pre_force_lps_on) && (!coex_sta->force_lps_ctrl)) + halbtc8822b2ant_query_bt_info(btcoexist); + } +} + +void ex_halbtc8822b2ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_connected = FALSE; + boolean wifi_under_5g = FALSE; + + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN notify()\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + /* this can't be removed for RF off_on event, or BT would dis-connect */ + halbtc8822b2ant_query_bt_info(btcoexist); + + if (BTC_SCAN_START == type) { + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, + &wifi_under_5g); + + if (wifi_under_5g) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** SCAN START notify (5g)\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_action_wifi_under5g(btcoexist); + return; + } + + coex_sta->wifi_is_high_pri_task = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** SCAN START notify (2g)\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_run_coexist_mechanism( + btcoexist); + + return; + } + + + if (BTC_SCAN_START_2G == type) { + + if (!wifi_connected) + coex_sta->wifi_is_high_pri_task = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN START notify (2G)\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_SCAN, TRUE); + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME); + + halbtc8822b2ant_run_coexist_mechanism(btcoexist); + + } else if (BTC_SCAN_FINISH == type) { + + coex_sta->wifi_is_high_pri_task = FALSE; + + btcoexist->btc_get(btcoexist, BTC_GET_U1_AP_NUM, + &coex_sta->scan_ap_num); + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], SCAN FINISH notify (Scan-AP = %d)\n", + coex_sta->scan_ap_num); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_SCAN, FALSE); + + halbtc8822b2ant_run_coexist_mechanism(btcoexist); + } + +} + +void ex_halbtc8822b2ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + coex_sta->switch_band_notify_to = type; + + if (type == BTC_SWITCH_TO_5G) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], switchband_notify --- switch to 5G\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_action_wifi_under5g(btcoexist); + + } else if (type == BTC_SWITCH_TO_24G_NOFORSCAN) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ********** switchband_notify BTC_SWITCH_TO_2G (no for scan)\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_run_coexist_mechanism(btcoexist); + + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], switchband_notify --- switch to 2G\n"); + BTC_TRACE(trace_buf); + + ex_halbtc8822b2ant_scan_notify(btcoexist, + BTC_SCAN_START_2G); + } + coex_sta->switch_band_notify_to = BTC_NOT_SWITCH; +} + + +void ex_halbtc8822b2ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + if ((BTC_ASSOCIATE_5G_START == type) || + (BTC_ASSOCIATE_5G_FINISH == type)) { + + if (BTC_ASSOCIATE_5G_START == type) + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], connect_notify --- 5G start\n"); + else + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], connect_notify --- 5G finish\n"); + + BTC_TRACE(trace_buf); + + halbtc8822b2ant_action_wifi_under5g(btcoexist); + return; + } + + + if (BTC_ASSOCIATE_START == type) { + + coex_sta->wifi_is_high_pri_task = TRUE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT START notify (2G)\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME); + + halbtc8822b2ant_action_wifi_link_process(btcoexist); + + /* To keep TDMA case during connect process, + * to avoid changed by Btinfo and runcoexmechanism + */ + coex_sta->freeze_coexrun_by_btinfo = TRUE; + + coex_dm->arp_cnt = 0; + + } else if (BTC_ASSOCIATE_FINISH == type) { + + coex_sta->wifi_is_high_pri_task = FALSE; + coex_sta->freeze_coexrun_by_btinfo = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], CONNECT FINISH notify (2G)\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_run_coexist_mechanism(btcoexist); + } +} + +void ex_halbtc8822b2ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean wifi_under_b_mode = FALSE, wifi_under_5g = FALSE; + + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (BTC_MEDIA_CONNECT == type) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA connect notify\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + + if (wifi_under_5g) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 5G!!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_action_wifi_under5g(btcoexist); + return; + } + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, + &wifi_under_b_mode); + + /* Set CCK Tx/Rx high Pri except 11b mode */ + if (wifi_under_b_mode) { + btcoexist->btc_write_1byte(btcoexist, 0x6cd, + 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, + 0x00); /* CCK Rx */ + } else { + + btcoexist->btc_write_1byte(btcoexist, 0x6cd, + 0x00); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, + 0x10); /* CCK Rx */ + } + + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], MEDIA disconnect notify\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_write_1byte(btcoexist, 0x6cd, 0x0); /* CCK Tx */ + btcoexist->btc_write_1byte(btcoexist, 0x6cf, 0x0); /* CCK Rx */ + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, FALSE); + } + + + halbtc8822b2ant_update_wifi_channel_info(btcoexist, type); +} + +void ex_halbtc8822b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + boolean under_4way = FALSE, wifi_under_5g = FALSE; + + if (btcoexist->manual_control || + btcoexist->stop_coex_dm) + return; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if (wifi_under_5g) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], WiFi is under 5G!!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_action_wifi_under5g(btcoexist); + return; + } + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_4_WAY_PROGRESS, + &under_4way); + + if (under_4way) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ---- under_4way!!\n"); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = TRUE; + coex_sta->specific_pkt_period_cnt = 2; + + } else if (BTC_PACKET_ARP == type) { + + coex_dm->arp_cnt++; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet ARP notify -cnt = %d\n", + coex_dm->arp_cnt); + BTC_TRACE(trace_buf); + + } else { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], specific Packet DHCP or EAPOL notify [Type = %d]\n", + type); + BTC_TRACE(trace_buf); + + coex_sta->wifi_is_high_pri_task = TRUE; + coex_sta->specific_pkt_period_cnt = 2; + } + + if (coex_sta->wifi_is_high_pri_task) + halbtc8822b2ant_run_coexist_mechanism(btcoexist); + +} + + +void ex_halbtc8822b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length) +{ + u8 i, rsp_source = 0; + boolean wifi_connected = FALSE; + boolean wifi_scan = FALSE, wifi_link = FALSE, wifi_roam = FALSE, + wifi_busy = FALSE; + static boolean is_scoreboard_scan = FALSE; + + + rsp_source = tmp_buf[0] & 0xf; + if (rsp_source >= BT_INFO_SRC_8822B_2ANT_MAX) + rsp_source = BT_INFO_SRC_8822B_2ANT_WIFI_FW; + coex_sta->bt_info_c2h_cnt[rsp_source]++; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Bt_info[%d], len=%d, data=[", rsp_source, + length); + BTC_TRACE(trace_buf); + + for (i = 0; i < length; i++) { + coex_sta->bt_info_c2h[rsp_source][i] = tmp_buf[i]; + + if (i == length - 1) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x]\n", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } else { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "0x%02x, ", + tmp_buf[i]); + BTC_TRACE(trace_buf); + } + } + + coex_sta->bt_info = coex_sta->bt_info_c2h[rsp_source][1]; + coex_sta->bt_info_ext = coex_sta->bt_info_c2h[rsp_source][4]; + coex_sta->bt_info_ext2 = coex_sta->bt_info_c2h[rsp_source][5]; + + if (BT_INFO_SRC_8822B_2ANT_WIFI_FW != rsp_source) { + + /* if 0xff, it means BT is under WHCK test */ + coex_sta->bt_whck_test = ((coex_sta->bt_info == 0xff) ? TRUE : + FALSE); + + coex_sta->bt_create_connection = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x80) ? TRUE : + FALSE); + + /* unit: %, value-100 to translate to unit: dBm */ + coex_sta->bt_rssi = coex_sta->bt_info_c2h[rsp_source][3] * 2 + + 10; + + coex_sta->c2h_bt_remote_name_req = (( + coex_sta->bt_info_c2h[rsp_source][2] & 0x20) ? TRUE : + FALSE); + + coex_sta->is_A2DP_3M = ((coex_sta->bt_info_c2h[rsp_source][2] & + 0x10) ? TRUE : FALSE); + + coex_sta->acl_busy = ((coex_sta->bt_info_c2h[rsp_source][1] & + 0x9) ? TRUE : FALSE); + + coex_sta->voice_over_HOGP = ((coex_sta->bt_info_ext & 0x10) ? + TRUE : FALSE); + + coex_sta->c2h_bt_inquiry_page = ((coex_sta->bt_info & + BT_INFO_8822B_2ANT_B_INQ_PAGE) ? TRUE : FALSE); + + coex_sta->a2dp_bit_pool = ((( + coex_sta->bt_info_c2h[rsp_source][1] & 0x49) == 0x49) ? + (coex_sta->bt_info_c2h[rsp_source][6] & 0x7f) : 0); + + coex_sta->is_bt_a2dp_sink = (coex_sta->bt_info_c2h[rsp_source][6] & 0x80) ? + TRUE : FALSE; + + coex_sta->bt_retry_cnt = coex_sta->bt_info_c2h[rsp_source][2] & + 0xf; + + coex_sta->is_autoslot = coex_sta->bt_info_ext2 & 0x8; + + coex_sta->forbidden_slot = coex_sta->bt_info_ext2 & 0x7; + + coex_sta->hid_busy_num = (coex_sta->bt_info_ext2 & 0x30) >> 4; + + coex_sta->hid_pair_cnt = (coex_sta->bt_info_ext2 & 0xc0) >> 6; + + if (coex_sta->bt_retry_cnt >= 1) + coex_sta->pop_event_cnt++; + + if (coex_sta->c2h_bt_remote_name_req) + coex_sta->cnt_RemoteNameReq++; + + if (coex_sta->bt_info_ext & BIT(1)) + coex_sta->cnt_ReInit++; + + if (coex_sta->bt_info_ext & BIT(2)) { + coex_sta->cnt_setupLink++; + coex_sta->is_setupLink = TRUE; + coex_sta->bt_relink_downcount = 2; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link start in BT info!!\n"); + BTC_TRACE(trace_buf); + } else { + coex_sta->is_setupLink = FALSE; + coex_sta->bt_relink_downcount = 0; + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Re-Link stop in BT info!!\n"); + BTC_TRACE(trace_buf); + } + + + if (coex_sta->bt_info_ext & BIT(3)) + coex_sta->cnt_IgnWlanAct++; + + if (coex_sta->bt_info_ext & BIT(6)) + coex_sta->cnt_RoleSwitch++; + + if (coex_sta->bt_info_ext & BIT(7)) + coex_sta->is_bt_multi_link = TRUE; + else + coex_sta->is_bt_multi_link = FALSE; + + if (coex_sta->bt_create_connection) { + coex_sta->cnt_Page++; + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, + &wifi_busy); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_SCAN, &wifi_scan); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_LINK, &wifi_link); + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_ROAM, &wifi_roam); + + if ((wifi_link) || (wifi_roam) || (wifi_scan) || + (coex_sta->wifi_is_high_pri_task) || (wifi_busy)) { + + is_scoreboard_scan = TRUE; + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_SCAN, TRUE); + + } else + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_SCAN, FALSE); + + } else { + if (is_scoreboard_scan) { + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_SCAN, FALSE); + is_scoreboard_scan = FALSE; + } + } + + /* Here we need to resend some wifi info to BT */ + /* because bt is reset and loss of the info. */ + + if ((!btcoexist->manual_control) && + (!btcoexist->stop_coex_dm)) { + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_CONNECTED, + &wifi_connected); + + /* Re-Init */ + if ((coex_sta->bt_info_ext & BIT(1))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit1 check, send wifi BW&Chnl to BT!!\n"); + BTC_TRACE(trace_buf); + if (wifi_connected) + halbtc8822b2ant_update_wifi_channel_info( + btcoexist, BTC_MEDIA_CONNECT); + else + halbtc8822b2ant_update_wifi_channel_info( + btcoexist, + BTC_MEDIA_DISCONNECT); + } + + + /* If Ignore_WLanAct && not SetUp_Link */ + if ((coex_sta->bt_info_ext & BIT(3)) && + (!(coex_sta->bt_info_ext & BIT(2))) && + (!(coex_sta->bt_info_ext & BIT(6)))) { + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit3 check, set BT NOT to ignore Wlan active!!\n"); + BTC_TRACE(trace_buf); + halbtc8822b2ant_ignore_wlan_act(btcoexist, + FORCE_EXEC, FALSE); + } else { + if (coex_sta->bt_info_ext & BIT(2)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ignore Wlan active because Re-link!!\n"); + BTC_TRACE(trace_buf); + } else if (coex_sta->bt_info_ext & BIT(6)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ignore Wlan active because Role-Switch!!\n"); + BTC_TRACE(trace_buf); + } + } + } + + } + + if ((coex_sta->bt_info_ext & BIT(5))) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], BT ext info bit4 check, query BLE Scan type!!\n"); + BTC_TRACE(trace_buf); + coex_sta->bt_ble_scan_type = btcoexist->btc_get_ble_scan_type_from_bt( + btcoexist); + + if ((coex_sta->bt_ble_scan_type & 0x1) == 0x1) + coex_sta->bt_ble_scan_para[0] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x1); + if ((coex_sta->bt_ble_scan_type & 0x2) == 0x2) + coex_sta->bt_ble_scan_para[1] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x2); + if ((coex_sta->bt_ble_scan_type & 0x4) == 0x4) + coex_sta->bt_ble_scan_para[2] = + btcoexist->btc_get_ble_scan_para_from_bt(btcoexist, + 0x4); + } + + halbtc8822b2ant_update_bt_link_info(btcoexist); + + halbtc8822b2ant_run_coexist_mechanism(btcoexist); +} + + +void ex_halbtc8822b2ant_rf_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], RF Status notify\n"); + BTC_TRACE(trace_buf); + + if (BTC_RF_ON == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned ON!!\n"); + BTC_TRACE(trace_buf); + + btcoexist->stop_coex_dm = FALSE; + coex_sta->is_rf_state_off = FALSE; +#if 0 + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ONOFF, TRUE); +#endif + } else if (BTC_RF_OFF == type) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], RF is turned OFF!!\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_WLAN_OFF); + + halbtc8822b2ant_action_coex_all_off(btcoexist); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE | + BT_8822B_2ANT_SCOREBOARD_ONOFF | + BT_8822B_2ANT_SCOREBOARD_SCAN | + BT_8822B_2ANT_SCOREBOARD_UNDERTEST, + FALSE); + + btcoexist->stop_coex_dm = TRUE; + coex_sta->is_rf_state_off = TRUE; + } +} + +void ex_halbtc8822b2ant_halt_notify(IN struct btc_coexist *btcoexist) +{ + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Halt notify\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_WLAN_OFF); + + ex_halbtc8822b2ant_media_status_notify(btcoexist, BTC_MEDIA_DISCONNECT); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ONOFF, FALSE); +} + +void ex_halbtc8822b2ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state) +{ + boolean wifi_under_5g = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, "[BTCoex], Pnp notify\n"); + BTC_TRACE(trace_buf); + + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifi_under_5g); + + if ((BTC_WIFI_PNP_SLEEP == pnp_state) || + (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state)) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to SLEEP\n"); + BTC_TRACE(trace_buf); + + /* Sinda 20150819, workaround for driver skip leave IPS/LPS to + * speed up sleep time. + * Driver do not leave IPS/LPS when driver is going to sleep, + * so BTCoexistence think wifi is still under IPS/LPS. + * BT should clear UnderIPS/UnderLPS state to avoid mismatch + * state after wakeup. + */ + coex_sta->under_ips = FALSE; + coex_sta->under_lps = FALSE; + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, FALSE); + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ONOFF, FALSE); + + + if (BTC_WIFI_PNP_SLEEP_KEEP_ANT == pnp_state) { + + if (wifi_under_5g) + halbtc8822b2ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_5G_RUNTIME); + else + halbtc8822b2ant_set_ant_path(btcoexist, + BTC_ANT_PATH_AUTO, FORCE_EXEC, + BT_8822B_2ANT_PHASE_2G_RUNTIME); + } else { + + halbtc8822b2ant_set_ant_path(btcoexist, BTC_ANT_PATH_AUTO, + FORCE_EXEC, + BT_8822B_2ANT_PHASE_WLAN_OFF); + } + } else if (BTC_WIFI_PNP_WAKE_UP == pnp_state) { + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], Pnp notify to WAKE UP\n"); + BTC_TRACE(trace_buf); + + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ACTIVE, TRUE); + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_ONOFF, TRUE); + } +} + +void ex_halbtc8822b2ant_periodical(IN struct btc_coexist *btcoexist) +{ + boolean wifi_busy = FALSE; + u16 bt_scoreboard_val = 0; + boolean bt_relink_finish = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ************* Periodical *************\n"); + BTC_TRACE(trace_buf); + +#if (BT_AUTO_REPORT_ONLY_8822B_2ANT == 0) + halbtc8822b2ant_query_bt_info(btcoexist); +#endif + + halbtc8822b2ant_monitor_bt_ctr(btcoexist); + halbtc8822b2ant_monitor_wifi_ctr(btcoexist); + halbtc8822b2ant_monitor_bt_enable_disable(btcoexist); + +#if 1 + btcoexist->btc_get(btcoexist, BTC_GET_BL_WIFI_BUSY, &wifi_busy); + halbtc8822b2ant_read_score_board(btcoexist, &bt_scoreboard_val); + + if (wifi_busy) { + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_UNDERTEST, TRUE); + /*for bt lps32 clock offset*/ + if (bt_scoreboard_val & BIT(6)) + halbtc8822b2ant_query_bt_info(btcoexist); + } else { + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_UNDERTEST, FALSE); +#if 0 + halbtc8822b2ant_post_state_to_bt(btcoexist, + BT_8822B_2ANT_SCOREBOARD_WLBUSY, + FALSE); +#endif + } +#endif + + if (coex_sta->bt_relink_downcount != 0) { + coex_sta->bt_relink_downcount--; + + if (coex_sta->bt_relink_downcount == 0) { + coex_sta->is_setupLink = FALSE; + bt_relink_finish = TRUE; + } + } + + /* for 4-way, DHCP, EAPOL packet */ + if (coex_sta->specific_pkt_period_cnt > 0) { + + coex_sta->specific_pkt_period_cnt--; + + if ((coex_sta->specific_pkt_period_cnt == 0) && + (coex_sta->wifi_is_high_pri_task)) + coex_sta->wifi_is_high_pri_task = FALSE; + + BTC_SPRINTF(trace_buf, BT_TMP_BUF_SIZE, + "[BTCoex], ***************** Hi-Pri Task = %s*****************\n", + (coex_sta->wifi_is_high_pri_task ? "Yes" : + "No")); + BTC_TRACE(trace_buf); + + } + + if (halbtc8822b2ant_is_wifibt_status_changed(btcoexist) || (bt_relink_finish) + || (coex_sta->is_set_ps_state_fail)) + halbtc8822b2ant_run_coexist_mechanism(btcoexist); +} + +void ex_halbtc8822b2ant_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds) +{ + +} + + +void ex_halbtc8822b2ant_display_ant_detection(IN struct btc_coexist *btcoexist) +{ +} + + +#endif + +#endif /* #if (RTL8822B_SUPPORT == 1) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.h new file mode 100644 index 000000000000..56567ebabb62 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822b2ant.h @@ -0,0 +1,526 @@ + +#if (BT_SUPPORT == 1 && COEX_SUPPORT == 1) + +#if (RTL8822B_SUPPORT == 1) + +/* ******************************************* + * The following is for 8822B 2Ant BT Co-exist definition + * ******************************************* */ +#define BT_8822B_2ANT_COEX_DBG 0 +#define BT_AUTO_REPORT_ONLY_8822B_2ANT 1 + + + + +#define BT_INFO_8822B_2ANT_B_FTP BIT(7) +#define BT_INFO_8822B_2ANT_B_A2DP BIT(6) +#define BT_INFO_8822B_2ANT_B_HID BIT(5) +#define BT_INFO_8822B_2ANT_B_SCO_BUSY BIT(4) +#define BT_INFO_8822B_2ANT_B_ACL_BUSY BIT(3) +#define BT_INFO_8822B_2ANT_B_INQ_PAGE BIT(2) +#define BT_INFO_8822B_2ANT_B_SCO_ESCO BIT(1) +#define BT_INFO_8822B_2ANT_B_CONNECTION BIT(0) + +#define BTC_RSSI_COEX_THRESH_TOL_8822B_2ANT 2 + + +/* unit: % WiFi RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation. + * (default = 42) + */ +#define BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES1 30 +/* unit: % BT RSSI Threshold for 2-Ant free-run/2-Ant TDMA translation. + * (default = 46) + */ +#define BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES1 20 +/* unit: % WiFi RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation. + * (default = 42) + */ +#define BT_8822B_2ANT_WIFI_RSSI_COEXSWITCH_THRES2 30 +/* unit: % BT RSSI Threshold for 1-Ant TDMA/1-Ant PS-TDMA translation. + * (default = 46) + */ +#define BT_8822B_2ANT_BT_RSSI_COEXSWITCH_THRES2 20 +#define BT_8822B_2ANT_DEFAULT_ISOLATION 15 /* unit: dB */ +#define BT_8822B_2ANT_WIFI_MAX_TX_POWER 15 /* unit: dBm */ +#define BT_8822B_2ANT_BT_MAX_TX_POWER 3 /* unit: dBm */ +#define BT_8822B_2ANT_WIFI_SIR_THRES1 -15 /* unit: dB */ +#define BT_8822B_2ANT_WIFI_SIR_THRES2 -30 /* unit: dB */ +#define BT_8822B_2ANT_BT_SIR_THRES1 -15 /* unit: dB */ +#define BT_8822B_2ANT_BT_SIR_THRES2 -30 /* unit: dB */ + + +/* for Antenna detection */ +#define BT_8822B_2ANT_ANTDET_PSDTHRES_BACKGROUND 50 +#define BT_8822B_2ANT_ANTDET_PSDTHRES_2ANT_BADISOLATION 70 +#define BT_8822B_2ANT_ANTDET_PSDTHRES_2ANT_GOODISOLATION 52 +#define BT_8822B_2ANT_ANTDET_PSDTHRES_1ANT 40 +#define BT_8822B_2ANT_ANTDET_RETRY_INTERVAL 10 /* retry timer if ant det is fail, unit: second */ +#define BT_8822B_2ANT_ANTDET_SWEEPPOINT_DELAY 60000 +#define BT_8822B_2ANT_ANTDET_ENABLE 0 +#define BT_8822B_2ANT_ANTDET_BTTXTIME 100 +#define BT_8822B_2ANT_ANTDET_BTTXCHANNEL 39 +#define BT_8822B_2ANT_ANTDET_PSD_SWWEEPCOUNT 50 + + +#define BT_8822B_2ANT_LTECOEX_INDIRECTREG_ACCESS_TIMEOUT 30000 + +enum bt_8822b_2ant_signal_state { + BT_8822B_2ANT_SIG_STA_SET_TO_LOW = 0x0, + BT_8822B_2ANT_SIG_STA_SET_BY_HW = 0x0, + BT_8822B_2ANT_SIG_STA_SET_TO_HIGH = 0x1, + BT_8822B_2ANT_SIG_STA_MAX +}; + +enum bt_8822b_2ant_path_ctrl_owner { + BT_8822B_2ANT_PCO_BTSIDE = 0x0, + BT_8822B_2ANT_PCO_WLSIDE = 0x1, + BT_8822B_2ANT_PCO_MAX +}; + +enum bt_8822b_2ant_gnt_ctrl_type { + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_PTA = 0x0, + BT_8822B_2ANT_GNT_TYPE_CTRL_BY_SW = 0x1, + BT_8822B_2ANT_GNT_TYPE_MAX +}; + +enum bt_8822b_2ant_gnt_ctrl_block { + BT_8822B_2ANT_GNT_BLOCK_RFC_BB = 0x0, + BT_8822B_2ANT_GNT_BLOCK_RFC = 0x1, + BT_8822B_2ANT_GNT_BLOCK_BB = 0x2, + BT_8822B_2ANT_GNT_BLOCK_MAX +}; + +enum bt_8822b_2ant_lte_coex_table_type { + BT_8822B_2ANT_CTT_WL_VS_LTE = 0x0, + BT_8822B_2ANT_CTT_BT_VS_LTE = 0x1, + BT_8822B_2ANT_CTT_MAX +}; + +enum bt_8822b_2ant_lte_break_table_type { + BT_8822B_2ANT_LBTT_WL_BREAK_LTE = 0x0, + BT_8822B_2ANT_LBTT_BT_BREAK_LTE = 0x1, + BT_8822B_2ANT_LBTT_LTE_BREAK_WL = 0x2, + BT_8822B_2ANT_LBTT_LTE_BREAK_BT = 0x3, + BT_8822B_2ANT_LBTT_MAX +}; + +enum bt_info_src_8822b_2ant { + BT_INFO_SRC_8822B_2ANT_WIFI_FW = 0x0, + BT_INFO_SRC_8822B_2ANT_BT_RSP = 0x1, + BT_INFO_SRC_8822B_2ANT_BT_ACTIVE_SEND = 0x2, + BT_INFO_SRC_8822B_2ANT_MAX +}; + +enum bt_8822b_2ant_bt_status { + BT_8822B_2ANT_BT_STATUS_NON_CONNECTED_IDLE = 0x0, + BT_8822B_2ANT_BT_STATUS_CONNECTED_IDLE = 0x1, + BT_8822B_2ANT_BT_STATUS_INQ_PAGE = 0x2, + BT_8822B_2ANT_BT_STATUS_ACL_BUSY = 0x3, + BT_8822B_2ANT_BT_STATUS_SCO_BUSY = 0x4, + BT_8822B_2ANT_BT_STATUS_ACL_SCO_BUSY = 0x5, + BT_8822B_2ANT_BT_STATUS_MAX +}; + +enum bt_8822b_2ant_coex_algo { + BT_8822B_2ANT_COEX_ALGO_UNDEFINED = 0x0, + BT_8822B_2ANT_COEX_ALGO_SCO = 0x1, + BT_8822B_2ANT_COEX_ALGO_HID = 0x2, + BT_8822B_2ANT_COEX_ALGO_A2DP = 0x3, + BT_8822B_2ANT_COEX_ALGO_A2DP_PANHS = 0x4, + BT_8822B_2ANT_COEX_ALGO_PANEDR = 0x5, + BT_8822B_2ANT_COEX_ALGO_PANHS = 0x6, + BT_8822B_2ANT_COEX_ALGO_PANEDR_A2DP = 0x7, + BT_8822B_2ANT_COEX_ALGO_PANEDR_HID = 0x8, + BT_8822B_2ANT_COEX_ALGO_HID_A2DP_PANEDR = 0x9, + BT_8822B_2ANT_COEX_ALGO_HID_A2DP = 0xa, + BT_8822B_2ANT_COEX_ALGO_NOPROFILEBUSY = 0xb, + BT_8822B_2ANT_COEX_ALGO_A2DPSINK = 0xc, + BT_8822B_2ANT_COEX_ALGO_MAX +}; + +enum bt_8822b_2ant_ext_ant_switch_type { + BT_8822B_2ANT_EXT_ANT_SWITCH_USE_DPDT = 0x0, + BT_8822B_2ANT_EXT_ANT_SWITCH_USE_SPDT = 0x1, + BT_8822B_2ANT_EXT_ANT_SWITCH_NONE = 0x2, + BT_8822B_2ANT_EXT_ANT_SWITCH_MAX +}; + +enum bt_8822b_2ant_ext_ant_switch_ctrl_type { + BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BBSW = 0x0, + BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_PTA = 0x1, + BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_ANTDIV = 0x2, + BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_MAC = 0x3, + BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_BY_BT = 0x4, + BT_8822B_2ANT_EXT_ANT_SWITCH_CTRL_MAX +}; + +enum bt_8822b_2ant_ext_ant_switch_pos_type { + BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_BT = 0x0, + BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLG = 0x1, + BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_WLA = 0x2, + BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_NOCARE = 0x3, + BT_8822B_2ANT_EXT_ANT_SWITCH_MAIN_TO_MAX +}; + +enum bt_8822b_2ant_ext_band_switch_pos_type { + BT_8822B_2ANT_EXT_BAND_SWITCH_TO_WLG = 0x0, + BT_8822B_2ANT_EXT_BAND_SWITCH_TO_WLA = 0x1, + BT_8822B_2ANT_EXT_BAND_SWITCH_TO_MAX +}; + +enum bt_8822b_2ant_int_block { + BT_8822B_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_BTG = 0x0, + BT_8822B_2ANT_INT_BLOCK_SWITCH_TO_WLG_OF_WLAG = 0x1, + BT_8822B_2ANT_INT_BLOCK_SWITCH_TO_WLA_OF_WLAG = 0x2, + BT_8822B_2ANT_INT_BLOCK_SWITCH_TO_MAX +}; + +enum bt_8822b_2ant_phase { + BT_8822B_2ANT_PHASE_COEX_INIT = 0x0, + BT_8822B_2ANT_PHASE_WLANONLY_INIT = 0x1, + BT_8822B_2ANT_PHASE_WLAN_OFF = 0x2, + BT_8822B_2ANT_PHASE_2G_RUNTIME = 0x3, + BT_8822B_2ANT_PHASE_5G_RUNTIME = 0x4, + BT_8822B_2ANT_PHASE_BTMPMODE = 0x5, + BT_8822B_2ANT_PHASE_ANTENNA_DET = 0x6, + BT_8822B_2ANT_PHASE_COEX_POWERON = 0x7, + BT_8822B_2ANT_PHASE_2G_RUNTIME_CONCURRENT = 0x8, + BT_8822B_2ANT_PHASE_MAX +}; + +/*ADD SCOREBOARD TO FIX BT LPS 32K ISSUE WHILE WL BUSY*/ + +enum bt_8822b_2ant_Scoreboard { + BT_8822B_2ANT_SCOREBOARD_ACTIVE = BIT(0), + BT_8822B_2ANT_SCOREBOARD_ONOFF = BIT(1), + BT_8822B_2ANT_SCOREBOARD_SCAN = BIT(2), + BT_8822B_2ANT_SCOREBOARD_UNDERTEST = BIT(3), + BT_8822B_2ANT_SCOREBOARD_WLBUSY = BIT(6) +}; + + + + + +struct coex_dm_8822b_2ant { + /* hw setting */ + u32 pre_ant_pos_type; + u32 cur_ant_pos_type; + /* fw mechanism */ + u8 pre_bt_dec_pwr_lvl; + u8 cur_bt_dec_pwr_lvl; + u8 pre_fw_dac_swing_lvl; + u8 cur_fw_dac_swing_lvl; + boolean cur_ignore_wlan_act; + boolean pre_ignore_wlan_act; + u8 pre_ps_tdma; + u8 cur_ps_tdma; + u8 ps_tdma_para[5]; + u8 ps_tdma_du_adj_type; + boolean reset_tdma_adjust; + boolean pre_ps_tdma_on; + boolean cur_ps_tdma_on; + boolean pre_bt_auto_report; + boolean cur_bt_auto_report; + + /* sw mechanism */ + boolean pre_rf_rx_lpf_shrink; + boolean cur_rf_rx_lpf_shrink; + u32 bt_rf_0x1e_backup; + boolean pre_low_penalty_ra; + boolean cur_low_penalty_ra; + boolean pre_dac_swing_on; + u32 pre_dac_swing_lvl; + boolean cur_dac_swing_on; + u32 cur_dac_swing_lvl; + boolean pre_adc_back_off; + boolean cur_adc_back_off; + boolean pre_agc_table_en; + boolean cur_agc_table_en; + u32 pre_val0x6c0; + u32 cur_val0x6c0; + u32 pre_val0x6c4; + u32 cur_val0x6c4; + u32 pre_val0x6c8; + u32 cur_val0x6c8; + u8 pre_val0x6cc; + u8 cur_val0x6cc; + boolean limited_dig; + + /* algorithm related */ + u8 pre_algorithm; + u8 cur_algorithm; + u8 bt_status; + u8 wifi_chnl_info[3]; + + boolean need_recover0x948; + u32 backup0x948; + + u8 pre_lps; + u8 cur_lps; + u8 pre_rpwm; + u8 cur_rpwm; + + boolean is_switch_to_1dot5_ant; + u8 switch_thres_offset; + u32 arp_cnt; + + u32 pre_ext_ant_switch_status; + u32 cur_ext_ant_switch_status; + + u8 pre_ext_band_switch_status; + u8 cur_ext_band_switch_status; + + u8 pre_int_block_status; + u8 cur_int_block_status; +}; + + +struct coex_sta_8822b_2ant { + boolean bt_disabled; + boolean bt_link_exist; + boolean sco_exist; + boolean a2dp_exist; + boolean hid_exist; + boolean pan_exist; + + boolean under_lps; + boolean under_ips; + u32 high_priority_tx; + u32 high_priority_rx; + u32 low_priority_tx; + u32 low_priority_rx; + boolean is_hiPri_rx_overhead; + u8 bt_rssi; + u8 pre_bt_rssi_state; + u8 pre_wifi_rssi_state[4]; + u8 bt_info_c2h[BT_INFO_SRC_8822B_2ANT_MAX][10]; + u32 bt_info_c2h_cnt[BT_INFO_SRC_8822B_2ANT_MAX]; + boolean bt_whck_test; + boolean c2h_bt_inquiry_page; + boolean c2h_bt_remote_name_req; + + u8 bt_info_ext; + u8 bt_info_ext2; + u32 pop_event_cnt; + u8 scan_ap_num; + u8 bt_retry_cnt; + + u32 crc_ok_cck; + u32 crc_ok_11g; + u32 crc_ok_11n; + u32 crc_ok_11n_vht; + + u32 crc_err_cck; + u32 crc_err_11g; + u32 crc_err_11n; + u32 crc_err_11n_vht; + + u32 acc_crc_ratio; + u32 now_crc_ratio; + + boolean cck_lock; + boolean pre_ccklock; + boolean cck_ever_lock; + + u8 coex_table_type; + boolean force_lps_ctrl; + + u8 dis_ver_info_cnt; + + u8 a2dp_bit_pool; + u8 cut_version; + + boolean concurrent_rx_mode_on; + + u16 score_board; + u8 isolation_btween_wb; /* 0~ 50 */ + u8 wifi_coex_thres; + u8 bt_coex_thres; + u8 wifi_coex_thres2; + u8 bt_coex_thres2; + + u8 num_of_profile; + boolean acl_busy; + boolean bt_create_connection; + boolean wifi_is_high_pri_task; + u32 specific_pkt_period_cnt; + u32 bt_coex_supported_feature; + u32 bt_coex_supported_version; + + u8 bt_ble_scan_type; + u32 bt_ble_scan_para[3]; + + boolean run_time_state; + boolean freeze_coexrun_by_btinfo; + + boolean is_A2DP_3M; + boolean voice_over_HOGP; + u8 bt_info; + boolean is_autoslot; + u8 forbidden_slot; + u8 hid_busy_num; + u8 hid_pair_cnt; + + u32 cnt_RemoteNameReq; + u32 cnt_setupLink; + u32 cnt_ReInit; + u32 cnt_IgnWlanAct; + u32 cnt_Page; + u32 cnt_RoleSwitch; + + u16 bt_reg_vendor_ac; + u16 bt_reg_vendor_ae; + + boolean is_setupLink; + u8 wl_noisy_level; + u32 gnt_error_cnt; + + u8 bt_afh_map[10]; + u8 bt_relink_downcount; + boolean is_tdma_btautoslot; + boolean is_tdma_btautoslot_hang; + + boolean is_eSCO_mode; + u8 switch_band_notify_to; + boolean is_rf_state_off; + + boolean is_hid_low_pri_tx_overhead; + boolean is_bt_multi_link; + boolean is_bt_a2dp_sink; + + boolean is_set_ps_state_fail; + u8 cnt_set_ps_state_fail; +}; + + +#define BT_8822B_2ANT_EXT_BAND_SWITCH_USE_DPDT 0 +#define BT_8822B_2ANT_EXT_BAND_SWITCH_USE_SPDT 1 + + +struct rfe_type_8822b_2ant { + + u8 rfe_module_type; + boolean ext_ant_switch_exist; + u8 ext_ant_switch_type; /* 0:DPDT, 1:SPDT */ + /* iF 0: DPDT_P=0, DPDT_N=1 => BTG to Main, WL_A+G to Aux */ + u8 ext_ant_switch_ctrl_polarity; + + boolean ext_band_switch_exist; + u8 ext_band_switch_type; /* 0:DPDT, 1:SPDT */ + u8 ext_band_switch_ctrl_polarity; + + /* If true: WLG at BTG, If false: WLG at WLAG */ + boolean wlg_Locate_at_btg; + + boolean ext_ant_switch_diversity; /* If diversity on */ +}; + +#define BT_8822B_2ANT_ANTDET_PSD_POINTS 256 /* MAX:1024 */ +#define BT_8822B_2ANT_ANTDET_PSD_AVGNUM 1 /* MAX:3 */ +#define BT_8822B_2ANT_ANTDET_BUF_LEN 16 + +struct psdscan_sta_8822b_2ant { + + u32 ant_det_bt_le_channel; /* BT LE Channel ex:2412 */ + u32 ant_det_bt_tx_time; + u32 ant_det_pre_psdscan_peak_val; + boolean ant_det_is_ant_det_available; + u32 ant_det_psd_scan_peak_val; + boolean ant_det_is_btreply_available; + u32 ant_det_psd_scan_peak_freq; + + u8 ant_det_result; + u8 ant_det_peak_val[BT_8822B_2ANT_ANTDET_BUF_LEN]; + u8 ant_det_peak_freq[BT_8822B_2ANT_ANTDET_BUF_LEN]; + u32 ant_det_try_count; + u32 ant_det_fail_count; + u32 ant_det_inteval_count; + u32 ant_det_thres_offset; + + u32 real_cent_freq; + s32 real_offset; + u32 real_span; + + u32 psd_band_width; /* unit: Hz */ + u32 psd_point; /* 128/256/512/1024 */ + u32 psd_report[1024]; /* unit:dB (20logx), 0~255 */ + u32 psd_report_max_hold[1024]; /* unit:dB (20logx), 0~255 */ + u32 psd_start_point; + u32 psd_stop_point; + u32 psd_max_value_point; + u32 psd_max_value; + u32 psd_max_value2; + /* filter loop_max_value that below BT_8822B_1ANT_ANTDET_PSDTHRES_1ANT, + * and average the rest + */ + u32 psd_avg_value; + /*max value in each loop */ + u32 psd_loop_max_value[BT_8822B_2ANT_ANTDET_PSD_SWWEEPCOUNT]; + u32 psd_start_base; + u32 psd_avg_num; /* 1/8/16/32 */ + u32 psd_gen_count; + boolean is_AntDet_running; + boolean is_psd_show_max_only; +}; + + +/* ******************************************* + * The following is interface which will notify coex module. + * ******************************************* */ +void ex_halbtc8822b2ant_power_on_setting(IN struct btc_coexist *btcoexist); +void ex_halbtc8822b2ant_pre_load_firmware(IN struct btc_coexist *btcoexist); +void ex_halbtc8822b2ant_init_hw_config(IN struct btc_coexist *btcoexist, + IN boolean wifi_only); +void ex_halbtc8822b2ant_init_coex_dm(IN struct btc_coexist *btcoexist); +void ex_halbtc8822b2ant_ips_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_lps_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_scan_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_switchband_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_connect_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_media_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_specific_packet_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_bt_info_notify(IN struct btc_coexist *btcoexist, + IN u8 *tmp_buf, IN u8 length); +void ex_halbtc8822b2ant_rf_status_notify(IN struct btc_coexist *btcoexist, + IN u8 type); +void ex_halbtc8822b2ant_halt_notify(IN struct btc_coexist *btcoexist); +void ex_halbtc8822b2ant_pnp_notify(IN struct btc_coexist *btcoexist, + IN u8 pnp_state); +void ex_halbtc8822b2ant_periodical(IN struct btc_coexist *btcoexist); +void ex_halbtc8822b2ant_display_coex_info(IN struct btc_coexist *btcoexist); +void ex_halbtc8822b2ant_antenna_detection(IN struct btc_coexist *btcoexist, + IN u32 cent_freq, IN u32 offset, IN u32 span, IN u32 seconds); +void ex_halbtc8822b2ant_display_ant_detection(IN struct btc_coexist *btcoexist); + + +#else +#define ex_halbtc8822b2ant_power_on_setting(btcoexist) +#define ex_halbtc8822b2ant_pre_load_firmware(btcoexist) +#define ex_halbtc8822b2ant_init_hw_config(btcoexist, wifi_only) +#define ex_halbtc8822b2ant_init_coex_dm(btcoexist) +#define ex_halbtc8822b2ant_ips_notify(btcoexist, type) +#define ex_halbtc8822b2ant_lps_notify(btcoexist, type) +#define ex_halbtc8822b2ant_scan_notify(btcoexist, type) +#define ex_halbtc8822b2ant_switchband_notify(btcoexist, type) +#define ex_halbtc8822b2ant_connect_notify(btcoexist, type) +#define ex_halbtc8822b2ant_media_status_notify(btcoexist, type) +#define ex_halbtc8822b2ant_specific_packet_notify(btcoexist, type) +#define ex_halbtc8822b2ant_bt_info_notify(btcoexist, tmp_buf, length) +#define ex_halbtc8822b2ant_rf_status_notify(btcoexist, type) +#define ex_halbtc8822b2ant_halt_notify(btcoexist) +#define ex_halbtc8822b2ant_pnp_notify(btcoexist, pnp_state) +#define ex_halbtc8822b2ant_periodical(btcoexist) +#define ex_halbtc8822b2ant_display_coex_info(btcoexist) +#define ex_halbtc8822b2ant_display_ant_detection(btcoexist) +#define ex_halbtc8822b2ant_antenna_detection(btcoexist, cent_freq, offset, span, seconds) +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.c new file mode 100644 index 000000000000..8de640966cb4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.c @@ -0,0 +1,68 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" + + +VOID +ex_hal8822b_wifi_only_hw_config( + IN struct wifi_only_cfg *pwifionlycfg + ) +{ + /*BB control*/ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x4c, 0x01800000, 0x2); + /*SW control*/ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcb4, 0xff, 0x77); + /*antenna mux switch */ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x974, 0x300, 0x3); + + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1990, 0x300, 0x0); + + halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcbc, 0x80000, 0x0); + /*switch to WL side controller and gnt_wl gnt_bt debug signal */ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x70, 0xff000000, 0x0e); + /*gnt_wl=1 , gnt_bt=0*/ + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1704, 0xffffffff, 0x7700); + halwifionly_phy_set_bb_reg(pwifionlycfg, 0x1700, 0xffffffff, 0xc00f0038); +} + +VOID +ex_hal8822b_wifi_only_scannotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ) +{ + hal8822b_wifi_only_switch_antenna(pwifionlycfg, is_5g); +} + +VOID +ex_hal8822b_wifi_only_switchbandnotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ) +{ + hal8822b_wifi_only_switch_antenna(pwifionlycfg, is_5g); +} + +VOID +hal8822b_wifi_only_switch_antenna(IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ) +{ + + if (is_5g) + halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcbc, 0x300, 0x1); + else + halwifionly_phy_set_bb_reg(pwifionlycfg, 0xcbc, 0x300, 0x2); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.h new file mode 100644 index 000000000000..4ca6f4837e70 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtc8822bwifionly.h @@ -0,0 +1,36 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __INC_HAL8822BWIFIONLYHWCFG_H +#define __INC_HAL8822BWIFIONLYHWCFG_H + +VOID +ex_hal8822b_wifi_only_hw_config( + IN struct wifi_only_cfg *pwifionlycfg + ); +VOID +ex_hal8822b_wifi_only_scannotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ); +VOID +ex_hal8822b_wifi_only_switchbandnotify( + IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ); +VOID +hal8822b_wifi_only_switch_antenna(IN struct wifi_only_cfg *pwifionlycfg, + IN u1Byte is_5g + ); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtcOutSrc.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtcoutsrc.h similarity index 88% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtcOutSrc.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtcoutsrc.h index 2b5e54807f6a..0f209671c7e0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/HalBtcOutSrc.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/halbtcoutsrc.h @@ -1,6 +1,120 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef __HALBTC_OUT_SRC_H__ #define __HALBTC_OUT_SRC_H__ +enum { + BTC_CCK_1, + BTC_CCK_2, + BTC_CCK_5_5, + BTC_CCK_11, + BTC_OFDM_6, + BTC_OFDM_9, + BTC_OFDM_12, + BTC_OFDM_18, + BTC_OFDM_24, + BTC_OFDM_36, + BTC_OFDM_48, + BTC_OFDM_54, + BTC_MCS_0, + BTC_MCS_1, + BTC_MCS_2, + BTC_MCS_3, + BTC_MCS_4, + BTC_MCS_5, + BTC_MCS_6, + BTC_MCS_7, + BTC_MCS_8, + BTC_MCS_9, + BTC_MCS_10, + BTC_MCS_11, + BTC_MCS_12, + BTC_MCS_13, + BTC_MCS_14, + BTC_MCS_15, + BTC_MCS_16, + BTC_MCS_17, + BTC_MCS_18, + BTC_MCS_19, + BTC_MCS_20, + BTC_MCS_21, + BTC_MCS_22, + BTC_MCS_23, + BTC_MCS_24, + BTC_MCS_25, + BTC_MCS_26, + BTC_MCS_27, + BTC_MCS_28, + BTC_MCS_29, + BTC_MCS_30, + BTC_MCS_31, + BTC_VHT_1SS_MCS_0, + BTC_VHT_1SS_MCS_1, + BTC_VHT_1SS_MCS_2, + BTC_VHT_1SS_MCS_3, + BTC_VHT_1SS_MCS_4, + BTC_VHT_1SS_MCS_5, + BTC_VHT_1SS_MCS_6, + BTC_VHT_1SS_MCS_7, + BTC_VHT_1SS_MCS_8, + BTC_VHT_1SS_MCS_9, + BTC_VHT_2SS_MCS_0, + BTC_VHT_2SS_MCS_1, + BTC_VHT_2SS_MCS_2, + BTC_VHT_2SS_MCS_3, + BTC_VHT_2SS_MCS_4, + BTC_VHT_2SS_MCS_5, + BTC_VHT_2SS_MCS_6, + BTC_VHT_2SS_MCS_7, + BTC_VHT_2SS_MCS_8, + BTC_VHT_2SS_MCS_9, + BTC_VHT_3SS_MCS_0, + BTC_VHT_3SS_MCS_1, + BTC_VHT_3SS_MCS_2, + BTC_VHT_3SS_MCS_3, + BTC_VHT_3SS_MCS_4, + BTC_VHT_3SS_MCS_5, + BTC_VHT_3SS_MCS_6, + BTC_VHT_3SS_MCS_7, + BTC_VHT_3SS_MCS_8, + BTC_VHT_3SS_MCS_9, + BTC_VHT_4SS_MCS_0, + BTC_VHT_4SS_MCS_1, + BTC_VHT_4SS_MCS_2, + BTC_VHT_4SS_MCS_3, + BTC_VHT_4SS_MCS_4, + BTC_VHT_4SS_MCS_5, + BTC_VHT_4SS_MCS_6, + BTC_VHT_4SS_MCS_7, + BTC_VHT_4SS_MCS_8, + BTC_VHT_4SS_MCS_9, + BTC_MCS_32, + BTC_UNKNOWN, + BTC_PKT_MGNT, + BTC_PKT_CTRL, + BTC_PKT_UNKNOWN, + BTC_PKT_NOT_FOR_ME, + BTC_RATE_MAX +}; + +enum { + BTC_MULTIPORT_SCC, + BTC_MULTIPORT_MCC_DUAL_CHANNEL, + BTC_MULTIPORT_MCC_DUAL_BAND, + BTC_MULTIPORT_MAX +}; #define BTC_COEX_OFFLOAD 0 #define BTC_TMP_BUF_SHORT 20 @@ -111,6 +225,7 @@ struct btc_board_info { u8 single_ant_path; /* current used for 8723b only, 1=>s0, 0=>s1 */ boolean tfbga_package; /* for Antenna detect threshold */ boolean btdm_ant_det_finish; + boolean btdm_ant_det_already_init_phydm; u8 ant_type; u8 rfe_type; u8 ant_div_cfg; @@ -118,6 +233,7 @@ struct btc_board_info { u8 ant_det_result; boolean ant_det_result_five_complete; u32 antdetval; + u8 customerID; }; typedef enum _BTC_DBG_OPCODE { @@ -234,7 +350,9 @@ typedef enum _BTC_GET_TYPE { /* type BOOLEAN */ BTC_GET_BL_HS_OPERATION, BTC_GET_BL_HS_CONNECTING, + BTC_GET_BL_WIFI_FW_READY, BTC_GET_BL_WIFI_CONNECTED, + BTC_GET_BL_WIFI_DUAL_BAND_CONNECTED, BTC_GET_BL_WIFI_BUSY, BTC_GET_BL_WIFI_SCAN, BTC_GET_BL_WIFI_LINK, @@ -247,6 +365,7 @@ typedef enum _BTC_GET_TYPE { BTC_GET_BL_EXT_SWITCH, BTC_GET_BL_WIFI_IS_IN_MP_MODE, BTC_GET_BL_IS_ASUS_8723B, + BTC_GET_BL_RF4CE_CONNECTED, /* type s4Byte */ BTC_GET_S4_WIFI_RSSI, @@ -261,6 +380,8 @@ typedef enum _BTC_GET_TYPE { BTC_GET_U4_VENDOR, BTC_GET_U4_SUPPORTED_VERSION, BTC_GET_U4_SUPPORTED_FEATURE, + BTC_GET_U4_BT_DEVICE_INFO, + BTC_GET_U4_BT_FORBIDDEN_SLOT_VAL, BTC_GET_U4_WIFI_IQK_TOTAL, BTC_GET_U4_WIFI_IQK_OK, BTC_GET_U4_WIFI_IQK_FAIL, @@ -275,6 +396,9 @@ typedef enum _BTC_GET_TYPE { BTC_GET_U1_ANT_TYPE, BTC_GET_U1_IOT_PEER, + /* type u2Byte */ + BTC_GET_U2_BEACON_PERIOD, + /*===== for 1Ant ======*/ BTC_GET_U1_LPS_MODE, @@ -285,6 +409,7 @@ typedef enum _BTC_GET_TYPE { typedef enum _BTC_SET_TYPE { /* type BOOLEAN */ BTC_SET_BL_BT_DISABLE, + BTC_SET_BL_BT_ENABLE_DISABLE_CHANGE, BTC_SET_BL_BT_TRAFFIC_BUSY, BTC_SET_BL_BT_LIMITED_DIG, BTC_SET_BL_FORCE_TO_ROAM, @@ -313,6 +438,8 @@ typedef enum _BTC_SET_TYPE { BTC_SET_ACT_LEAVE_LPS, BTC_SET_ACT_ENTER_LPS, BTC_SET_ACT_NORMAL_LPS, + BTC_SET_ACT_PRE_NORMAL_LPS, + BTC_SET_ACT_POST_NORMAL_LPS, BTC_SET_ACT_DISABLE_LOW_POWER, BTC_SET_ACT_UPDATE_RAMASK, BTC_SET_ACT_SEND_MIMO_PS, @@ -563,7 +690,7 @@ typedef u4Byte typedef VOID (*BFP_BTC_SET_RF_REG)( IN PVOID pBtcContext, - IN u1Byte eRFPath, + IN enum rf_path eRFPath, IN u4Byte RegAddr, IN u4Byte BitMask, IN u4Byte Data @@ -571,7 +698,7 @@ typedef VOID typedef u4Byte (*BFP_BTC_GET_RF_REG)( IN PVOID pBtcContext, - IN u1Byte eRFPath, + IN enum rf_path eRFPath, IN u4Byte RegAddr, IN u4Byte BitMask ); @@ -665,6 +792,12 @@ typedef u4Byte IN u1Byte info_type ); +typedef VOID +(*BTC_PHYDM_MODIFY_ANTDIV_HWSW)( + IN PVOID pDM_Odm, + IN u1Byte type + ); + typedef u1Byte (*BFP_BTC_GET_ANT_DET_VAL_FROM_BT)( @@ -751,6 +884,12 @@ struct btc_bt_link_info { boolean acl_busy; }; +#ifdef CONFIG_RF4CE_COEXIST +struct btc_rf4ce_info { + u8 link_state; +}; +#endif + struct btc_statistics { u32 cnt_bind; u32 cnt_power_on; @@ -769,6 +908,7 @@ struct btc_statistics { u32 cnt_coex_dm_switch; u32 cnt_stack_operation_notify; u32 cnt_dbg_ctrl; + u32 cnt_rate_id_notify; }; struct btc_coexist { @@ -778,6 +918,10 @@ struct btc_coexist { struct btc_bt_info bt_info; /*some bt info referenced by non-bt module*/ struct btc_stack_info stack_info; struct btc_bt_link_info bt_link_info; + +#ifdef CONFIG_RF4CE_COEXIST + struct btc_rf4ce_info rf4ce_info; +#endif BTC_CHIP_INTERFACE chip_interface; PVOID odm_priv; @@ -827,6 +971,7 @@ struct btc_coexist { BFP_BTC_GET_PHYDM_VERSION btc_get_bt_phydm_version; BTC_PHYDM_MODIFY_RA_PCR_THRESHLOD btc_phydm_modify_RA_PCR_threshold; BTC_PHYDM_CMNINFOQUERY btc_phydm_query_PHY_counter; + BTC_PHYDM_MODIFY_ANTDIV_HWSW btc_phydm_modify_ANTDIV_HwSw; BFP_BTC_GET_ANT_DET_VAL_FROM_BT btc_get_ant_det_val_from_bt; BFP_BTC_GET_BLE_SCAN_TYPE_FROM_BT btc_get_ble_scan_type_from_bt; BFP_BTC_GET_BLE_SCAN_PARA_FROM_BT btc_get_ble_scan_para_from_bt; @@ -904,6 +1049,18 @@ EXhalbtcoutsrc_RfStatusNotify( IN u1Byte type ); VOID +EXhalbtcoutsrc_WlFwDbgInfoNotify( + IN PBTC_COEXIST pBtCoexist, + IN pu1Byte tmpBuf, + IN u1Byte length + ); +VOID +EXhalbtcoutsrc_rx_rate_change_notify( + IN PBTC_COEXIST pBtCoexist, + IN BOOLEAN is_data_frame, + IN u1Byte btc_rate_id + ); +VOID EXhalbtcoutsrc_StackOperationNotify( IN PBTC_COEXIST pBtCoexist, IN u1Byte type diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/Mp_Precomp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/mp_precomp.h similarity index 63% rename from drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/Mp_Precomp.h rename to drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/mp_precomp.h index 0299b2c42d4c..b7402aac5583 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/Mp_Precomp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/btc/mp_precomp.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __MP_PRECOMP_H__ #define __MP_PRECOMP_H__ @@ -41,10 +36,10 @@ #define WPP_SOFTWARE_TRACE 0 -typedef enum _BTC_MSG_COMP_TYPE{ +typedef enum _BTC_MSG_COMP_TYPE { COMP_COEX = 0, COMP_MAX -}BTC_MSG_COMP_TYPE; +} BTC_MSG_COMP_TYPE; extern u4Byte GLBtcDbgType[]; #define DBG_OFF 0 @@ -64,26 +59,27 @@ extern u4Byte GLBtcDbgType[]; #define HS_SUPPORT 0 #endif -#include "HalBtcOutSrc.h" -#include "HalBtc8188c2Ant.h" -#include "HalBtc8192d2Ant.h" -#include "HalBtc8192e1Ant.h" -#include "HalBtc8192e2Ant.h" -#include "HalBtc8723a1Ant.h" -#include "HalBtc8723a2Ant.h" -#include "HalBtc8723b1Ant.h" -#include "HalBtc8723b2Ant.h" -#include "HalBtc8812a1Ant.h" -#include "HalBtc8812a2Ant.h" -#include "HalBtc8821a1Ant.h" -#include "HalBtc8821a2Ant.h" -#include "HalBtc8821aCsr2Ant.h" -#include "HalBtc8703b1Ant.h" +#include "halbtcoutsrc.h" +#include "halbtc8192e1ant.h" +#include "halbtc8192e2ant.h" +#include "halbtc8723b1ant.h" +#include "halbtc8723b2ant.h" +#include "halbtc8812a1ant.h" +#include "halbtc8812a2ant.h" +#include "halbtc8821a1ant.h" +#include "halbtc8821a2ant.h" +#include "halbtc8703b1ant.h" #include "halbtc8723d1ant.h" #include "halbtc8723d2ant.h" -#include "HalBtc8822b1Ant.h" +#include "halbtc8822b1ant.h" +#include "halbtc8822b2ant.h" #include "halbtc8821c1ant.h" #include "halbtc8821c2ant.h" +/* for wifi only mode */ +#include "hal_btcoex_wifionly.h" +#include "halbtc8723bwifionly.h" +#include "halbtc8822bwifionly.h" +#include "halbtc8821cwifionly.h" -#endif // __MP_PRECOMP_H__ +#endif /* __MP_PRECOMP_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/efuse_mask.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/efuse_mask.h index e1c38c1961df..82705690d93e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/efuse_mask.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/efuse_mask.h @@ -1,98 +1,138 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #if DEV_BUS_TYPE == RT_USB_INTERFACE -#if defined(CONFIG_RTL8188E) - #include "rtl8188e/HalEfuseMask8188E_USB.h" -#endif + #if defined(CONFIG_RTL8188E) + #include "rtl8188e/HalEfuseMask8188E_USB.h" + #endif -#if defined(CONFIG_RTL8812A) - #include "rtl8812a/HalEfuseMask8812A_USB.h" -#endif + #if defined(CONFIG_RTL8812A) + #include "rtl8812a/HalEfuseMask8812A_USB.h" + #endif -#if defined(CONFIG_RTL8821A) - #include "rtl8812a/HalEfuseMask8821A_USB.h" -#endif + #if defined(CONFIG_RTL8821A) + #include "rtl8812a/HalEfuseMask8821A_USB.h" + #endif -#if defined(CONFIG_RTL8192E) - #include "rtl8192e/HalEfuseMask8192E_USB.h" -#endif + #if defined(CONFIG_RTL8192E) + #include "rtl8192e/HalEfuseMask8192E_USB.h" + #endif -#if defined(CONFIG_RTL8723B) - #include "rtl8723b/HalEfuseMask8723B_USB.h" -#endif + #if defined(CONFIG_RTL8723B) + #include "rtl8723b/HalEfuseMask8723B_USB.h" + #endif -#if defined(CONFIG_RTL8814A) - #include "rtl8814a/HalEfuseMask8814A_USB.h" -#endif + #if defined(CONFIG_RTL8814A) + #include "rtl8814a/HalEfuseMask8814A_USB.h" + #endif -#if defined(CONFIG_RTL8703B) - #include "rtl8703b/HalEfuseMask8703B_USB.h" -#endif + #if defined(CONFIG_RTL8703B) + #include "rtl8703b/HalEfuseMask8703B_USB.h" + #endif -#if defined(CONFIG_RTL8723D) - #include "rtl8723d/HalEfuseMask8723D_USB.h" -#endif + #if defined(CONFIG_RTL8723D) + #include "rtl8723d/HalEfuseMask8723D_USB.h" + #endif -#if defined(CONFIG_RTL8188F) - #include "rtl8188f/HalEfuseMask8188F_USB.h" -#endif + #if defined(CONFIG_RTL8188F) + #include "rtl8188f/HalEfuseMask8188F_USB.h" + #endif -#if defined(CONFIG_RTL8822B) - #include "rtl8822b/HalEfuseMask8822B_USB.h" -#endif + #if defined(CONFIG_RTL8822B) + #include "rtl8822b/HalEfuseMask8822B_USB.h" + #endif + + #if defined(CONFIG_RTL8821C) + #include "rtl8821c/HalEfuseMask8821C_USB.h" + #endif #elif DEV_BUS_TYPE == RT_PCI_INTERFACE -#if defined(CONFIG_RTL8188E) - #include "rtl8188e/HalEfuseMask8188E_PCIE.h" -#endif + #if defined(CONFIG_RTL8188E) + #include "rtl8188e/HalEfuseMask8188E_PCIE.h" + #endif -#if defined(CONFIG_RTL8812A) - #include "rtl8812a/HalEfuseMask8812A_PCIE.h" -#endif + #if defined(CONFIG_RTL8812A) + #include "rtl8812a/HalEfuseMask8812A_PCIE.h" + #endif -#if defined(CONFIG_RTL8821A) - #include "rtl8812a/HalEfuseMask8821A_PCIE.h" -#endif + #if defined(CONFIG_RTL8821A) + #include "rtl8812a/HalEfuseMask8821A_PCIE.h" + #endif -#if defined(CONFIG_RTL8192E) - #include "rtl8192e/HalEfuseMask8192E_PCIE.h" -#endif + #if defined(CONFIG_RTL8192E) + #include "rtl8192e/HalEfuseMask8192E_PCIE.h" + #endif -#if defined(CONFIG_RTL8723B) - #include "rtl8723b/HalEfuseMask8723B_PCIE.h" -#endif + #if defined(CONFIG_RTL8723B) + #include "rtl8723b/HalEfuseMask8723B_PCIE.h" + #endif -#if defined(CONFIG_RTL8814A) - #include "rtl8814a/HalEfuseMask8814A_PCIE.h" -#endif + #if defined(CONFIG_RTL8814A) + #include "rtl8814a/HalEfuseMask8814A_PCIE.h" + #endif -#if defined(CONFIG_RTL8703B) - #include "rtl8703b/HalEfuseMask8703B_PCIE.h" -#endif + #if defined(CONFIG_RTL8703B) + #include "rtl8703b/HalEfuseMask8703B_PCIE.h" + #endif -#if defined(CONFIG_RTL8822B) - #include "rtl8822b/HalEfuseMask8822B_PCIE.h" -#endif -#if defined(CONFIG_RTL8723D) - #include "rtl8723d/HalEfuseMask8723D_PCIE.h" -#endif + #if defined(CONFIG_RTL8822B) + #include "rtl8822b/HalEfuseMask8822B_PCIE.h" + #endif + #if defined(CONFIG_RTL8723D) + #include "rtl8723d/HalEfuseMask8723D_PCIE.h" + #endif + #if defined(CONFIG_RTL8821C) + #include "rtl8821c/HalEfuseMask8821C_PCIE.h" + #endif #elif DEV_BUS_TYPE == RT_SDIO_INTERFACE + #if defined(CONFIG_RTL8723B) + #include "rtl8723b/HalEfuseMask8723B_SDIO.h" + #endif -#if defined(CONFIG_RTL8188E) - #include "rtl8188e/HalEfuseMask8188E_SDIO.h" -#endif + #if defined(CONFIG_RTL8188E) + #include "rtl8188e/HalEfuseMask8188E_SDIO.h" + #endif -#if defined(CONFIG_RTL8703B) - #include "rtl8703b/HalEfuseMask8703B_SDIO.h" -#endif + #if defined(CONFIG_RTL8703B) + #include "rtl8703b/HalEfuseMask8703B_SDIO.h" + #endif -#if defined(CONFIG_RTL8188F) - #include "rtl8188f/HalEfuseMask8188F_SDIO.h" -#endif + #if defined(CONFIG_RTL8188F) + #include "rtl8188f/HalEfuseMask8188F_SDIO.h" + #endif -#if defined(CONFIG_RTL8723D) - #include "rtl8723d/HalEfuseMask8723D_SDIO.h" -#endif + #if defined(CONFIG_RTL8723D) + #include "rtl8723d/HalEfuseMask8723D_SDIO.h" + #endif + + #if defined(CONFIG_RTL8192E) + #include "rtl8192e/HalEfuseMask8192E_SDIO.h" + #endif + + #if defined(CONFIG_RTL8821A) + #include "rtl8812a/HalEfuseMask8821A_SDIO.h" + #endif + + #if defined(CONFIG_RTL8821C) + #include "rtl8821c/HalEfuseMask8821C_SDIO.h" + #endif + + #if defined(CONFIG_RTL8822B) + #include "rtl8822b/HalEfuseMask8822B_SDIO.h" + #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c index 1ecae7b165f8..0ad1d6c75852 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.c @@ -1,22 +1,17 @@ /****************************************************************************** -* -* 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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "Mp_Precomp.h"*/ #include @@ -44,7 +39,7 @@ u1Byte Array_MP_8723D_MPCIE[] = { 0xFF, 0xFF, 0x7C, - 0x70, + 0x30, 0x00, 0x00, 0x00, diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h index 5a7f6c1da86a..8f97872f8e32 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_PCIE.h @@ -1,22 +1,17 @@ /****************************************************************************** -* -* 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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /****************************************************************************** * MPCIE.TXT diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c index 13e973fa0c8d..bc40b1c8f5d4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.c @@ -1,21 +1,17 @@ /****************************************************************************** -* -* 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 -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 #include "HalEfuseMask8723D_SDIO.h" diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h index dc4fafc661cb..d4b818797a99 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_SDIO.h @@ -1,21 +1,17 @@ /****************************************************************************** -* -* 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 -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /****************************************************************************** * MSDIO.TXT diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c index dbccd825c23c..a461d63bc3fb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.c @@ -1,22 +1,17 @@ /****************************************************************************** -* -* 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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "Mp_Precomp.h" */ /* #include "../odm_precomp.h" */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h index 888fc472e0cf..61cf1f3d730a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/efuse/rtl8723d/HalEfuseMask8723D_USB.h @@ -1,22 +1,17 @@ /****************************************************************************** -* -* 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 -* -* -******************************************************************************/ + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex.c index 1cc85e5974eb..3717e3d2a2ba 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,19 +11,14 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define __HAL_BTCOEX_C__ #ifdef CONFIG_BT_COEXIST #include #include -#include +#include "btc/mp_precomp.h" /* ************************************ * Global variables @@ -181,6 +176,8 @@ typedef enum _bt_op_code { BT_OP_GET_BT_ANT_DET_VAL = 0x2c, BT_OP_GET_BT_BLE_SCAN_PARA = 0x2d, BT_OP_GET_BT_BLE_SCAN_TYPE = 0x2e, + BT_OP_GET_BT_DEVICE_INFO = 0x30, + BT_OP_GET_BT_FORBIDDEN_SLOT_VAL = 0x31, BT_OP_MAX } BT_OP_CODE; @@ -278,6 +275,22 @@ static u8 halbtcoutsrc_IsCsrBtCoex(PBTC_COEXIST pBtCoexist) return _FALSE; } +static void halbtcoutsrc_EnterPwrLock(PBTC_COEXIST pBtCoexist) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj((PADAPTER)pBtCoexist->Adapter); + struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); + + _enter_pwrlock(&pwrpriv->lock); +} + +static void halbtcoutsrc_ExitPwrLock(PBTC_COEXIST pBtCoexist) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj((PADAPTER)pBtCoexist->Adapter); + struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); + + _exit_pwrlock(&pwrpriv->lock); +} + static u8 halbtcoutsrc_IsHwMailboxExist(PBTC_COEXIST pBtCoexist) { if (pBtCoexist->board_info.bt_chip_type == BTC_CHIP_CSR_BC4 @@ -290,7 +303,7 @@ static u8 halbtcoutsrc_IsHwMailboxExist(PBTC_COEXIST pBtCoexist) return _TRUE; } -static void halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) +static u8 halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) { PADAPTER padapter; @@ -300,7 +313,7 @@ static void halbtcoutsrc_LeaveLps(PBTC_COEXIST pBtCoexist) pBtCoexist->bt_info.bt_ctrl_lps = _TRUE; pBtCoexist->bt_info.bt_lps_on = _FALSE; - rtw_btcoex_LPS_Leave(padapter); + return rtw_btcoex_LPS_Leave(padapter); } void halbtcoutsrc_EnterLps(PBTC_COEXIST pBtCoexist) @@ -333,7 +346,7 @@ void halbtcoutsrc_NormalLps(PBTC_COEXIST pBtCoexist) /* recover the LPS state to the original */ #if 0 - padapter->HalFunc.UpdateLPSStatusHandler( + padapter->hal_func.UpdateLPSStatusHandler( padapter, pPSC->RegLeisurePsMode, pPSC->RegPowerSaveMode); @@ -341,6 +354,24 @@ void halbtcoutsrc_NormalLps(PBTC_COEXIST pBtCoexist) } } +void halbtcoutsrc_Pre_NormalLps(PBTC_COEXIST pBtCoexist) +{ + PADAPTER padapter; + + padapter = pBtCoexist->Adapter; + + if (pBtCoexist->bt_info.bt_ctrl_lps) { + pBtCoexist->bt_info.bt_lps_on = _FALSE; + rtw_btcoex_LPS_Leave(padapter); + } +} + +void halbtcoutsrc_Post_NormalLps(PBTC_COEXIST pBtCoexist) +{ + if (pBtCoexist->bt_info.bt_ctrl_lps) + pBtCoexist->bt_info.bt_ctrl_lps = _FALSE; +} + /* * Constraint: * 1. this function will request pwrctrl->lock @@ -352,7 +383,7 @@ void halbtcoutsrc_LeaveLowPower(PBTC_COEXIST pBtCoexist) PHAL_DATA_TYPE pHalData; struct pwrctrl_priv *pwrctrl; s32 ready; - u32 stime; + systime stime; s32 utime; u32 timeout; /* unit: ms */ @@ -463,9 +494,50 @@ void halbtcoutsrc_AggregationCheck(PBTC_COEXIST pBtCoexist) rtw_btcoex_rx_ampdu_apply(padapter); } +u8 halbtcoutsrc_is_autoload_fail(PBTC_COEXIST pBtCoexist) +{ + PADAPTER padapter; + PHAL_DATA_TYPE pHalData; + + padapter = pBtCoexist->Adapter; + pHalData = GET_HAL_DATA(padapter); + + return pHalData->bautoload_fail_flag; +} + +u8 halbtcoutsrc_is_fw_ready(PBTC_COEXIST pBtCoexist) +{ + PADAPTER padapter; + + padapter = pBtCoexist->Adapter; + + return GET_HAL_DATA(padapter)->bFWReady; +} + +u8 halbtcoutsrc_IsDualBandConnected(PADAPTER padapter) +{ + u8 ret = BTC_MULTIPORT_SCC; + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter) && (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC))) { + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *mccobjpriv = &(dvobj->mcc_objpriv); + u8 band0 = mccobjpriv->iface[0]->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; + u8 band1 = mccobjpriv->iface[1]->mlmeextpriv.cur_channel > 14 ? BAND_ON_5G : BAND_ON_2_4G; + + if (band0 != band1) + ret = BTC_MULTIPORT_MCC_DUAL_BAND; + else + ret = BTC_MULTIPORT_MCC_DUAL_CHANNEL; + } +#endif + + return ret; +} + u8 halbtcoutsrc_IsWifiBusy(PADAPTER padapter) { - if (rtw_mi_check_status(padapter, MI_AP_MODE)) + if (rtw_mi_check_status(padapter, MI_AP_ASSOC)) return _TRUE; if (rtw_mi_busy_traffic_check(padapter, _FALSE)) return _TRUE; @@ -544,8 +616,8 @@ u32 halbtcoutsrc_GetWifiLinkStatus(PBTC_COEXIST pBtCoexist) static void _btmpoper_timer_hdl(void *p) { - if (GLBtcBtMpRptWait) { - GLBtcBtMpRptWait = 0; + if (GLBtcBtMpRptWait == _TRUE) { + GLBtcBtMpRptWait = _FALSE; _rtw_up_sema(&GLBtcBtMpRptSema); } } @@ -561,7 +633,6 @@ static u8 _btmpoper_cmd(PBTC_COEXIST pBtCoexist, u8 opcode, u8 opcodever, u8 *cm u8 buf[H2C_BTMP_OPER_LEN] = {0}; u8 buflen; u8 seq; - u8 timer_cancelled; s32 ret; @@ -579,31 +650,32 @@ static u8 _btmpoper_cmd(PBTC_COEXIST pBtCoexist, u8 opcode, u8 opcodever, u8 *cm if (cmd && size) _rtw_memcpy(buf + 2, cmd, size); - GLBtcBtMpRptWait = 1; - GLBtcBtMpRptWiFiOK = 0; - GLBtcBtMpRptBTOK = 0; + GLBtcBtMpRptWait = _TRUE; + GLBtcBtMpRptWiFiOK = _FALSE; + GLBtcBtMpRptBTOK = _FALSE; GLBtcBtMpRptStatus = 0; padapter = pBtCoexist->Adapter; _set_timer(&GLBtcBtMpOperTimer, BTC_MPOPER_TIMEOUT); if (rtw_hal_fill_h2c_cmd(padapter, H2C_BT_MP_OPER, buflen, buf) == _FAIL) { - _cancel_timer(&GLBtcBtMpOperTimer, &timer_cancelled); + _cancel_timer_ex(&GLBtcBtMpOperTimer); ret = BT_STATUS_H2C_FAIL; goto exit; } _rtw_down_sema(&GLBtcBtMpRptSema); - /* GLBtcBtMpRptWait should be 0 here*/ + /* GLBtcBtMpRptWait should be _FALSE here*/ - if (!GLBtcBtMpRptWiFiOK) { + if (GLBtcBtMpRptWiFiOK == _FALSE) { RTW_ERR("%s: Didn't get H2C Rsp Event!\n", __FUNCTION__); ret = BT_STATUS_H2C_TIMTOUT; goto exit; } - if (!GLBtcBtMpRptBTOK) { + if (GLBtcBtMpRptBTOK == _FALSE) { RTW_DBG("%s: Didn't get BT response!\n", __FUNCTION__); ret = BT_STATUS_H2C_BT_NO_RSP; goto exit; } + if (seq != GLBtcBtMpRptSeq) { RTW_ERR("%s: Sequence number not match!(%d!=%d)!\n", __FUNCTION__, seq, GLBtcBtMpRptSeq); @@ -674,14 +746,7 @@ u32 halbtcoutsrc_GetBtPatchVer(PBTC_COEXIST pBtCoexist) s32 halbtcoutsrc_GetWifiRssi(PADAPTER padapter) { - PHAL_DATA_TYPE pHalData; - s32 UndecoratedSmoothedPWDB = 0; - - pHalData = GET_HAL_DATA(padapter); - - UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; - - return UndecoratedSmoothedPWDB; + return rtw_phydm_get_min_rssi(padapter); } u32 halbtcoutsrc_GetBtCoexSupportedFeature(void *pBtcContext) @@ -746,6 +811,68 @@ u32 halbtcoutsrc_GetBtCoexSupportedVersion(void *pBtcContext) return data; } +u32 halbtcoutsrc_GetBtDeviceInfo(void *pBtcContext) +{ + PBTC_COEXIST pBtCoexist; + u32 ret = BT_STATUS_BT_OP_SUCCESS; + u32 btDeviceInfo = 0; + + pBtCoexist = (PBTC_COEXIST)pBtcContext; + + if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { + u8 buf[3] = {0}; + _irqL irqL; + u8 op_code; + u8 status; + + _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); + + op_code = BT_OP_GET_BT_DEVICE_INFO; + status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); + if (status == BT_STATUS_BT_OP_SUCCESS) + btDeviceInfo = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); + else + ret = SET_BT_MP_OPER_RET(op_code, status); + + _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); + + } else + ret = BT_STATUS_NOT_IMPLEMENT; + + return btDeviceInfo; +} + +u32 halbtcoutsrc_GetBtForbiddenSlotVal(void *pBtcContext) +{ + PBTC_COEXIST pBtCoexist; + u32 ret = BT_STATUS_BT_OP_SUCCESS; + u32 btForbiddenSlotVal = 0; + + pBtCoexist = (PBTC_COEXIST)pBtcContext; + + if (halbtcoutsrc_IsHwMailboxExist(pBtCoexist) == _TRUE) { + u8 buf[3] = {0}; + _irqL irqL; + u8 op_code; + u8 status; + + _enter_critical_mutex(&GLBtcBtMpOperLock, &irqL); + + op_code = BT_OP_GET_BT_FORBIDDEN_SLOT_VAL; + status = _btmpoper_cmd(pBtCoexist, op_code, 0, buf, 0); + if (status == BT_STATUS_BT_OP_SUCCESS) + btForbiddenSlotVal = le32_to_cpu(*(u32 *)GLBtcBtMpRptRsp); + else + ret = SET_BT_MP_OPER_RET(op_code, status); + + _exit_critical_mutex(&GLBtcBtMpOperLock, &irqL); + + } else + ret = BT_STATUS_NOT_IMPLEMENT; + + return btForbiddenSlotVal; +} + static u8 halbtcoutsrc_GetWifiScanAPNum(PADAPTER padapter) { struct mlme_priv *pmlmepriv; @@ -777,6 +904,7 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) s32 *pS4Tmp; u32 *pU4Tmp; u8 *pU1Tmp; + u16 *pU2Tmp; u8 ret; @@ -793,6 +921,7 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) pS4Tmp = (s32 *)pOutBuf; pU4Tmp = (u32 *)pOutBuf; pU1Tmp = (u8 *)pOutBuf; + pU2Tmp = (u16*)pOutBuf; ret = _TRUE; switch (getType) { @@ -806,10 +935,18 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) ret = _FALSE; break; + case BTC_GET_BL_WIFI_FW_READY: + *pu8 = halbtcoutsrc_is_fw_ready(pBtCoexist); + break; + case BTC_GET_BL_WIFI_CONNECTED: *pu8 = (rtw_mi_check_status(padapter, MI_LINKED)) ? _TRUE : _FALSE; break; + case BTC_GET_BL_WIFI_DUAL_BAND_CONNECTED: + *pu8 = halbtcoutsrc_IsDualBandConnected(padapter); + break; + case BTC_GET_BL_WIFI_BUSY: *pu8 = halbtcoutsrc_IsWifiBusy(padapter); break; @@ -837,7 +974,7 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) break; case BTC_GET_BL_WIFI_UNDER_5G: - *pu8 = (pHalData->CurrentBandType == 1) ? _TRUE : _FALSE; + *pu8 = (pHalData->current_band_type == BAND_ON_5G) ? _TRUE : _FALSE; break; case BTC_GET_BL_WIFI_AP_MODE_ENABLE: @@ -870,6 +1007,17 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) *pu8 = _FALSE; break; + case BTC_GET_BL_RF4CE_CONNECTED: +#ifdef CONFIG_RF4CE_COEXIST + if (hal_btcoex_get_rf4ce_link_state() == 0) + *pu8 = FALSE; + else + *pu8 = TRUE; +#else + *pu8 = FALSE; +#endif + break; + case BTC_GET_S4_WIFI_RSSI: *pS4Tmp = halbtcoutsrc_GetWifiRssi(padapter); break; @@ -883,7 +1031,7 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) if (IsLegacyOnly(mlmeext->cur_wireless_mode)) *pU4Tmp = BTC_WIFI_BW_LEGACY; else { - switch (pHalData->CurrentChannelBW) { + switch (pHalData->current_channel_bw) { case CHANNEL_WIDTH_20: *pU4Tmp = BTC_WIFI_BW_HT20; break; @@ -897,7 +1045,7 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) *pU4Tmp = BTC_WIFI_BW_HT160; break; default: - RTW_INFO("[BTCOEX] unkown bandwidth(%d)\n", pHalData->CurrentChannelBW); + RTW_INFO("[BTCOEX] unknown bandwidth(%d)\n", pHalData->current_channel_bw); *pU4Tmp = BTC_WIFI_BW_HT40; break; } @@ -917,8 +1065,8 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) break; case BTC_GET_U4_WIFI_FW_VER: - *pU4Tmp = pHalData->FirmwareVersion << 16; - *pU4Tmp |= pHalData->FirmwareSubVersion; + *pU4Tmp = pHalData->firmware_version << 16; + *pU4Tmp |= pHalData->firmware_sub_version; break; case BTC_GET_U4_WIFI_LINK_STATUS: @@ -940,16 +1088,24 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) *pU4Tmp = halbtcoutsrc_GetBtCoexSupportedFeature(pBtCoexist); break; + case BTC_GET_U4_BT_DEVICE_INFO: + *pU4Tmp = halbtcoutsrc_GetBtDeviceInfo(pBtCoexist); + break; + + case BTC_GET_U4_BT_FORBIDDEN_SLOT_VAL: + *pU4Tmp = halbtcoutsrc_GetBtForbiddenSlotVal(pBtCoexist); + break; + case BTC_GET_U4_WIFI_IQK_TOTAL: - *pU4Tmp = pHalData->odmpriv.nIQK_Cnt; + *pU4Tmp = pHalData->odmpriv.n_iqk_cnt; break; case BTC_GET_U4_WIFI_IQK_OK: - *pU4Tmp = pHalData->odmpriv.nIQK_OK_Cnt; + *pU4Tmp = pHalData->odmpriv.n_iqk_ok_cnt; break; case BTC_GET_U4_WIFI_IQK_FAIL: - *pU4Tmp = pHalData->odmpriv.nIQK_Fail_Cnt; + *pU4Tmp = pHalData->odmpriv.n_iqk_fail_cnt; break; case BTC_GET_U1_WIFI_DOT11_CHNL: @@ -957,7 +1113,7 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) break; case BTC_GET_U1_WIFI_CENTRAL_CHNL: - *pU1Tmp = pHalData->CurrentChannel; + *pU1Tmp = pHalData->current_channel; break; case BTC_GET_U1_WIFI_HS_CHNL: @@ -1020,6 +1176,10 @@ u8 halbtcoutsrc_Get(void *pBtcContext, u8 getType, void *pOutBuf) *pU1Tmp = padapter->dvobj->pwrctl_priv.pwr_mode; break; + case BTC_GET_U2_BEACON_PERIOD: + *pU2Tmp = mlmeext->mlmext_info.bcn_interval; + break; + default: ret = _FALSE; break; @@ -1037,6 +1197,7 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) u8 *pU1Tmp; u32 *pU4Tmp; u8 ret; + u8 result = _TRUE; pBtCoexist = (PBTC_COEXIST)pBtcContext; @@ -1056,6 +1217,10 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) pBtCoexist->bt_info.bt_disabled = *pu8; break; + case BTC_SET_BL_BT_ENABLE_DISABLE_CHANGE: + pBtCoexist->bt_info.bt_enable_disable_change = *pu8; + break; + case BTC_SET_BL_BT_TRAFFIC_BUSY: pBtCoexist->bt_info.bt_busy = *pu8; break; @@ -1126,7 +1291,7 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) /* the following are some action which will be triggered */ case BTC_SET_ACT_LEAVE_LPS: - halbtcoutsrc_LeaveLps(pBtCoexist); + result = halbtcoutsrc_LeaveLps(pBtCoexist); break; case BTC_SET_ACT_ENTER_LPS: @@ -1137,11 +1302,20 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) halbtcoutsrc_NormalLps(pBtCoexist); break; + case BTC_SET_ACT_PRE_NORMAL_LPS: + halbtcoutsrc_Pre_NormalLps(pBtCoexist); + break; + + case BTC_SET_ACT_POST_NORMAL_LPS: + halbtcoutsrc_Post_NormalLps(pBtCoexist); + break; + case BTC_SET_ACT_DISABLE_LOW_POWER: halbtcoutsrc_DisableLowPower(pBtCoexist, *pu8); break; case BTC_SET_ACT_UPDATE_RAMASK: + /* pBtCoexist->bt_info.ra_mask = *pU4Tmp; if (check_fwstate(&padapter->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { @@ -1150,8 +1324,9 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) cur_network = &padapter->mlmeextpriv.mlmext_info.network; psta = rtw_get_stainfo(&padapter->stapriv, cur_network->MacAddress); - rtw_hal_update_ra_mask(psta, 0); + rtw_hal_update_ra_mask(psta); } + */ break; case BTC_SET_ACT_SEND_MIMO_PS: { @@ -1219,7 +1394,7 @@ u8 halbtcoutsrc_Set(void *pBtcContext, u8 setType, void *pInBuf) break; } - return ret; + return result; } u8 halbtcoutsrc_UnderIps(PBTC_COEXIST pBtCoexist) @@ -1258,26 +1433,6 @@ u8 halbtcoutsrc_Under32K(PBTC_COEXIST pBtCoexist) return _FALSE; } -u8 halbtcoutsrc_is_autoload_fail(PBTC_COEXIST pBtCoexist) -{ - PADAPTER padapter; - PHAL_DATA_TYPE pHalData; - - padapter = pBtCoexist->Adapter; - pHalData = GET_HAL_DATA(padapter); - - return pHalData->bautoload_fail_flag; -} - -u8 halbtcoutsrc_is_fw_ready(PBTC_COEXIST pBtCoexist) -{ - PADAPTER padapter; - - padapter = pBtCoexist->Adapter; - - return padapter->bFWReady; -} - void halbtcoutsrc_DisplayCoexStatistics(PBTC_COEXIST pBtCoexist) { #if 0 @@ -1484,18 +1639,20 @@ void halbtcoutsrc_DisplayWifiStatus(PBTC_COEXIST pBtCoexist) BOOLEAN bBtHsOn = _FALSE, bLowPower = _FALSE; u8 wifiChnl = 0, wifiP2PChnl = 0, nScanAPNum = 0, FwPSState; u32 iqk_cnt_total = 0, iqk_cnt_ok = 0, iqk_cnt_fail = 0; + u16 wifiBcnInterval = 0; wifiLinkStatus = halbtcoutsrc_GetWifiLinkStatus(pBtCoexist); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d", "STA/vWifi/HS/p2pGo/p2pGc", \ + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d/ %d/ %d (mcc+2band = %d)", "STA/vWifi/HS/p2pGo/p2pGc", ((wifiLinkStatus & WIFI_STA_CONNECTED) ? 1 : 0), ((wifiLinkStatus & WIFI_AP_CONNECTED) ? 1 : 0), ((wifiLinkStatus & WIFI_HS_CONNECTED) ? 1 : 0), ((wifiLinkStatus & WIFI_P2P_GO_CONNECTED) ? 1 : 0), - ((wifiLinkStatus & WIFI_P2P_GC_CONNECTED) ? 1 : 0)); + ((wifiLinkStatus & WIFI_P2P_GC_CONNECTED) ? 1 : 0), + halbtcoutsrc_IsDualBandConnected(padapter) ? 1 : 0); CL_PRINTF(cliBuf); pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_SCAN, &bScan); pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_LINK, &bLink); pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_ROAM, &bRoam); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "Link/ Roam/ Scan", \ + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d/ %d/ %d ", "Link/ Roam/ Scan", bLink, bRoam, bScan); CL_PRINTF(cliBuf); @@ -1514,10 +1671,12 @@ void halbtcoutsrc_DisplayWifiStatus(PBTC_COEXIST pBtCoexist) pBtCoexist->btc_get(pBtCoexist, BTC_GET_S4_WIFI_RSSI, &wifiRssi); pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_WIFI_DOT11_CHNL, &wifiChnl); + pBtCoexist->btc_get(pBtCoexist, BTC_GET_U2_BEACON_PERIOD, &wifiBcnInterval); if ((wifiLinkStatus & WIFI_P2P_GO_CONNECTED) || (wifiLinkStatus & WIFI_P2P_GC_CONNECTED)) pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_WIFI_P2P_CHNL, &wifiP2PChnl); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dBm/ %d/ %d", "RSSI/ STA_Chnl/ P2P_Chnl", \ - wifiRssi -100, wifiChnl, wifiP2PChnl); + + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %d dBm/ %d/ %d/ %d", "RSSI/ STA_Chnl/ P2P_Chnl/ BI", + wifiRssi-100, wifiChnl, wifiP2PChnl, wifiBcnInterval); CL_PRINTF(cliBuf); pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_UNDER_5G, &wifiFreq); @@ -1526,7 +1685,7 @@ void halbtcoutsrc_DisplayWifiStatus(PBTC_COEXIST pBtCoexist) pBtCoexist->btc_get(pBtCoexist, BTC_GET_U4_WIFI_TRAFFIC_DIRECTION, &wifiTrafficDir); pBtCoexist->btc_get(pBtCoexist, BTC_GET_BL_WIFI_UNDER_B_MODE, &bWifiUnderBMode); pBtCoexist->btc_get(pBtCoexist, BTC_GET_U1_AP_NUM, &nScanAPNum); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ %s/ %d ", "Band/ BW/ Traffic/ APCnt", \ + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %s / %s/ %s/ %d ", "Band/ BW/ Traffic/ APCnt", GLBtcWifiFreqString[wifiFreq], ((bWifiUnderBMode) ? "11b" : GLBtcWifiBwString[wifiBw]), ((!bWifiBusy) ? "idle" : ((BTC_WIFI_TRAFFIC_TX == wifiTrafficDir) ? "uplink" : "downlink")), nScanAPNum); @@ -1539,7 +1698,7 @@ void halbtcoutsrc_DisplayWifiStatus(PBTC_COEXIST pBtCoexist) ((halbtcoutsrc_Under32K(pBtCoexist) == _TRUE) ? ", 32k" : "")); CL_PRINTF(cliBuf); - CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x (0x%x/0x%x)", "Power mode cmd(lps/rpwm)", \ + CL_SPRINTF(cliBuf, BT_TMP_BUF_SIZE, "\r\n %-35s = %02x %02x %02x %02x %02x %02x (0x%x/0x%x)", "Power mode cmd(lps/rpwm)", pBtCoexist->pwrModeVal[0], pBtCoexist->pwrModeVal[1], pBtCoexist->pwrModeVal[2], pBtCoexist->pwrModeVal[3], pBtCoexist->pwrModeVal[4], pBtCoexist->pwrModeVal[5], @@ -1692,7 +1851,7 @@ void halbtcoutsrc_SetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask, u32 Data pBtCoexist = (PBTC_COEXIST)pBtcContext; padapter = pBtCoexist->Adapter; - PHY_SetBBReg(padapter, RegAddr, BitMask, Data); + phy_set_bb_reg(padapter, RegAddr, BitMask, Data); } @@ -1705,10 +1864,10 @@ u32 halbtcoutsrc_GetBbReg(void *pBtcContext, u32 RegAddr, u32 BitMask) pBtCoexist = (PBTC_COEXIST)pBtcContext; padapter = pBtCoexist->Adapter; - return PHY_QueryBBReg(padapter, RegAddr, BitMask); + return phy_query_bb_reg(padapter, RegAddr, BitMask); } -void halbtcoutsrc_SetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) +void halbtcoutsrc_SetRfReg(void *pBtcContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data) { PBTC_COEXIST pBtCoexist; PADAPTER padapter; @@ -1717,10 +1876,10 @@ void halbtcoutsrc_SetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMa pBtCoexist = (PBTC_COEXIST)pBtcContext; padapter = pBtCoexist->Adapter; - PHY_SetRFReg(padapter, eRFPath, RegAddr, BitMask, Data); + phy_set_rf_reg(padapter, eRFPath, RegAddr, BitMask, Data); } -u32 halbtcoutsrc_GetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMask) +u32 halbtcoutsrc_GetRfReg(void *pBtcContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask) { PBTC_COEXIST pBtCoexist; PADAPTER padapter; @@ -1729,7 +1888,7 @@ u32 halbtcoutsrc_GetRfReg(void *pBtcContext, u8 eRFPath, u32 RegAddr, u32 BitMas pBtCoexist = (PBTC_COEXIST)pBtcContext; padapter = pBtCoexist->Adapter; - return PHY_QueryRFReg(padapter, eRFPath, RegAddr, BitMask); + return phy_query_rf_reg(padapter, eRFPath, RegAddr, BitMask); } u16 halbtcoutsrc_SetBtReg(void *pBtcContext, u8 RegType, u32 RegAddr, u32 Data) @@ -1789,23 +1948,28 @@ u8 halbtcoutsrc_SetBtAntDetection(void *pBtcContext, u8 txTime, u8 btChnl) BOOLEAN halbtcoutsrc_SetBtTRXMASK( - IN PVOID pBtcContext, + IN PVOID pBtcContext, IN u1Byte bt_trx_mask ) { + /* Always return _FALSE since we don't implement this yet */ #if 0 - struct btc_coexist *pBtCoexist=(struct btc_coexist *)pBtcContext; - PADAPTER Adapter=pBtCoexist->Adapter; - BOOLEAN bStatus=FALSE; - u1Byte btCanTx=0; + struct btc_coexist *pBtCoexist = (struct btc_coexist *)pBtcContext; + PADAPTER Adapter = pBtCoexist->Adapter; + BOOLEAN bStatus = FALSE; + u1Byte btCanTx = 0; - if(IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) - { + if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter) || IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter) + || IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { + + if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) bStatus = NDBG_SetBtTRXMASK(Adapter, 1, bt_trx_mask, &btCanTx); + else + bStatus = NDBG_SetBtTRXMASK(Adapter, 2, bt_trx_mask, &btCanTx); } - if(bStatus && btCanTx) + if (bStatus) return TRUE; else return FALSE; @@ -2153,6 +2317,14 @@ u32 halbtcoutsrc_GetPhydmVersion(void *pBtcContext) return RELEASE_VERSION_8723D; #endif +#ifdef CONFIG_RTL8821C + return RELEASE_VERSION_8821C; +#endif +} + +void halbtcoutsrc_phydm_modify_AntDiv_HwSw(void *pBtcContext, u8 is_hw) +{ + /* empty function since we don't need it */ } void halbtcoutsrc_phydm_modify_RA_PCR_threshold(void *pBtcContext, u8 RA_offset_direction, u8 RA_threshold_offset) @@ -2171,7 +2343,7 @@ u32 halbtcoutsrc_phydm_query_PHY_counter(void *pBtcContext, u8 info_type) /* switch to #if 0 in case the phydm version does not provide the function */ #if 1 - return PHYDM_CmnInfoQuery((PDM_ODM_T)pBtCoexist->odm_priv, (PHYDM_INFO_QUERY_E)info_type); + return phydm_cmn_info_query((struct PHY_DM_STRUCT *)pBtCoexist->odm_priv, (enum phydm_info_query_e)info_type); #else return 0; #endif @@ -2298,7 +2470,6 @@ void BT_CoexOffloadC2hCheck(PADAPTER Adapter, u8 *Buffer, u8 Length) u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) { PBTC_COEXIST pBtCoexist = &GLBtCoexist; - u8 antNum = 1, chipType = 0, singleAntPath = 0; HAL_DATA_TYPE *pHalData = GET_HAL_DATA((PADAPTER)padapter); if (pBtCoexist->bBinded) @@ -2319,6 +2490,14 @@ u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) pBtCoexist->bt_info.increase_scan_dev_num = _FALSE; pBtCoexist->bt_info.miracast_plus_bt = _FALSE; + return _TRUE; +} + +void EXhalbtcoutsrc_AntInfoSetting(void *padapter) +{ + PBTC_COEXIST pBtCoexist = &GLBtCoexist; + u8 antNum = 1, singleAntPath = 0; + antNum = rtw_btcoex_get_pg_ant_num((PADAPTER)padapter); EXhalbtcoutsrc_SetAntNum(BT_COEX_ANT_TYPE_PG, antNum); @@ -2326,6 +2505,9 @@ u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) singleAntPath = rtw_btcoex_get_pg_single_ant_path((PADAPTER)padapter); EXhalbtcoutsrc_SetSingleAntPath(singleAntPath); } + + pBtCoexist->board_info.customerID = RT_CID_DEFAULT; + /* set default antenna position to main port */ pBtCoexist->board_info.btdm_ant_pos = BTC_ANTENNA_AT_MAIN_PORT; @@ -2334,9 +2516,10 @@ u8 EXhalbtcoutsrc_BindBtCoexWithAdapter(void *padapter) pBtCoexist->board_info.tfbga_package = rtw_btcoex_is_tfbga_package_type((PADAPTER)padapter); + pBtCoexist->board_info.rfe_type = rtw_btcoex_get_pg_rfe_type((PADAPTER)padapter); + pBtCoexist->board_info.ant_div_cfg = rtw_btcoex_get_ant_div_cfg((PADAPTER)padapter); - return _TRUE; } u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) @@ -2395,6 +2578,7 @@ u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) pBtCoexist->btc_get_bt_phydm_version = halbtcoutsrc_GetPhydmVersion; pBtCoexist->btc_phydm_modify_RA_PCR_threshold = halbtcoutsrc_phydm_modify_RA_PCR_threshold; pBtCoexist->btc_phydm_query_PHY_counter = halbtcoutsrc_phydm_query_PHY_counter; + pBtCoexist->btc_phydm_modify_ANTDIV_HwSw = halbtcoutsrc_phydm_modify_AntDiv_HwSw; pBtCoexist->cli_buf = &GLBtcDbgBuf[0]; @@ -2411,25 +2595,28 @@ u8 EXhalbtcoutsrc_InitlizeVariables(void *padapter) /* BT Control H2C/C2H*/ GLBtcBtMpOperSeq = 0; _rtw_mutex_init(&GLBtcBtMpOperLock); - _init_timer(&GLBtcBtMpOperTimer, ((PADAPTER)padapter)->pnetdev, _btmpoper_timer_hdl, pBtCoexist); + rtw_init_timer(&GLBtcBtMpOperTimer, padapter, _btmpoper_timer_hdl, pBtCoexist); _rtw_init_sema(&GLBtcBtMpRptSema, 0); GLBtcBtMpRptSeq = 0; GLBtcBtMpRptStatus = 0; _rtw_memset(GLBtcBtMpRptRsp, 0, C2H_MAX_SIZE); GLBtcBtMpRptRspSize = 0; - GLBtcBtMpRptWait = 0; - GLBtcBtMpRptWiFiOK = 0; - GLBtcBtMpRptBTOK = 0; + GLBtcBtMpRptWait = _FALSE; + GLBtcBtMpRptWiFiOK = _FALSE; + GLBtcBtMpRptBTOK = _FALSE; return _TRUE; } void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist) { + HAL_DATA_TYPE *pHalData = NULL; + if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; - /* Power on setting function is only added in 8723B currently */ + pHalData = GET_HAL_DATA((PADAPTER)pBtCoexist->Adapter); + if (IS_HARDWARE_TYPE_8723B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723b2ant_power_on_setting(pBtCoexist); @@ -2437,6 +2624,11 @@ void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist) ex_halbtc8723b1ant_power_on_setting(pBtCoexist); } + if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8703b1ant_power_on_setting(pBtCoexist); + } + if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_power_on_setting(pBtCoexist); @@ -2444,12 +2636,21 @@ void EXhalbtcoutsrc_PowerOnSetting(PBTC_COEXIST pBtCoexist) ex_halbtc8723d1ant_power_on_setting(pBtCoexist); } - if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) - ex_halbtc8822b1ant_power_on_setting(pBtCoexist); + ex_halbtc8821a1ant_power_on_setting(pBtCoexist); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8821a2ant_power_on_setting(pBtCoexist); } - if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { + if ((IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8822b1ant_power_on_setting(pBtCoexist); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_power_on_setting(pBtCoexist); + } + + if ((IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_power_on_setting(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) @@ -2494,9 +2695,12 @@ void EXhalbtcoutsrc_init_hw_config(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) pBtCoexist->statistics.cnt_init_hw_config++; if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_init_hw_config(pBtCoexist, bWifiOnly); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_init_hw_config(pBtCoexist, bWifiOnly); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_init_hw_config(pBtCoexist, bWifiOnly); @@ -2526,11 +2730,21 @@ void EXhalbtcoutsrc_init_hw_config(PBTC_COEXIST pBtCoexist, u8 bWifiOnly) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_init_hw_config(pBtCoexist, bWifiOnly); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_init_hw_config(pBtCoexist, bWifiOnly); + #ifdef CONFIG_FW_MULTI_PORT_SUPPORT + rtw_hal_set_default_port_id_cmd(pBtCoexist->Adapter, 0); + rtw_hal_set_wifi_port_id_cmd(pBtCoexist->Adapter); + #endif } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_init_hw_config(pBtCoexist, bWifiOnly); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821c1ant_init_hw_config(pBtCoexist, bWifiOnly); + #ifdef CONFIG_FW_MULTI_PORT_SUPPORT + rtw_hal_set_default_port_id_cmd(pBtCoexist->Adapter, 0); + rtw_hal_set_wifi_port_id_cmd(pBtCoexist->Adapter); + #endif } } @@ -2542,9 +2756,12 @@ void EXhalbtcoutsrc_init_coex_dm(PBTC_COEXIST pBtCoexist) pBtCoexist->statistics.cnt_init_coex_dm++; if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_init_coex_dm(pBtCoexist); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_init_coex_dm(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_init_coex_dm(pBtCoexist); @@ -2574,6 +2791,8 @@ void EXhalbtcoutsrc_init_coex_dm(PBTC_COEXIST pBtCoexist) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_init_coex_dm(pBtCoexist); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_init_coex_dm(pBtCoexist); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_init_coex_dm(pBtCoexist); @@ -2607,9 +2826,12 @@ void EXhalbtcoutsrc_ips_notify(PBTC_COEXIST pBtCoexist, u8 type) * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_ips_notify(pBtCoexist, ipsType); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_ips_notify(pBtCoexist, ipsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_ips_notify(pBtCoexist, ipsType); @@ -2639,6 +2861,8 @@ void EXhalbtcoutsrc_ips_notify(PBTC_COEXIST pBtCoexist, u8 type) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_ips_notify(pBtCoexist, ipsType); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_ips_notify(pBtCoexist, ipsType); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_ips_notify(pBtCoexist, ipsType); @@ -2670,9 +2894,12 @@ void EXhalbtcoutsrc_lps_notify(PBTC_COEXIST pBtCoexist, u8 type) } if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_lps_notify(pBtCoexist, lpsType); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_lps_notify(pBtCoexist, lpsType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_lps_notify(pBtCoexist, lpsType); @@ -2702,6 +2929,8 @@ void EXhalbtcoutsrc_lps_notify(PBTC_COEXIST pBtCoexist, u8 type) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_lps_notify(pBtCoexist, lpsType); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_lps_notify(pBtCoexist, lpsType); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_lps_notify(pBtCoexist, lpsType); @@ -2732,9 +2961,12 @@ void EXhalbtcoutsrc_scan_notify(PBTC_COEXIST pBtCoexist, u8 type) * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_scan_notify(pBtCoexist, scanType); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_scan_notify(pBtCoexist, scanType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_scan_notify(pBtCoexist, scanType); @@ -2764,6 +2996,8 @@ void EXhalbtcoutsrc_scan_notify(PBTC_COEXIST pBtCoexist, u8 type) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_scan_notify(pBtCoexist, scanType); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_scan_notify(pBtCoexist, scanType); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_scan_notify(pBtCoexist, scanType); @@ -2804,28 +3038,24 @@ void EXhalbtcoutsrc_SetAntennaPathNotify(PBTC_COEXIST pBtCoexist, u8 type) #endif } -void EXhalbtcoutsrc_connect_notify(PBTC_COEXIST pBtCoexist, u8 action) +void EXhalbtcoutsrc_connect_notify(PBTC_COEXIST pBtCoexist, u8 assoType) { - u8 assoType; - if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) return; pBtCoexist->statistics.cnt_connect_notify++; if (pBtCoexist->manual_control) return; - - if (action) - assoType = BTC_ASSOCIATE_START; - else - assoType = BTC_ASSOCIATE_FINISH; - + /* All notify is called in cmd thread, don't need to leave low power again * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_connect_notify(pBtCoexist, assoType); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_connect_notify(pBtCoexist, assoType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_connect_notify(pBtCoexist, assoType); @@ -2855,6 +3085,8 @@ void EXhalbtcoutsrc_connect_notify(PBTC_COEXIST pBtCoexist, u8 action) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_connect_notify(pBtCoexist, assoType); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_connect_notify(pBtCoexist, assoType); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_connect_notify(pBtCoexist, assoType); @@ -2885,9 +3117,12 @@ void EXhalbtcoutsrc_media_status_notify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_media_status_notify(pBtCoexist, mStatus); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_media_status_notify(pBtCoexist, mStatus); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_media_status_notify(pBtCoexist, mStatus); @@ -2917,6 +3152,8 @@ void EXhalbtcoutsrc_media_status_notify(PBTC_COEXIST pBtCoexist, RT_MEDIA_STATUS } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_media_status_notify(pBtCoexist, mStatus); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_media_status_notify(pBtCoexist, mStatus); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_media_status_notify(pBtCoexist, mStatus); @@ -2952,9 +3189,12 @@ void EXhalbtcoutsrc_specific_packet_notify(PBTC_COEXIST pBtCoexist, u8 pktType) * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_specific_packet_notify(pBtCoexist, packetType); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_specific_packet_notify(pBtCoexist, packetType); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_specific_packet_notify(pBtCoexist, packetType); @@ -2984,6 +3224,8 @@ void EXhalbtcoutsrc_specific_packet_notify(PBTC_COEXIST pBtCoexist, u8 pktType) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_specific_packet_notify(pBtCoexist, packetType); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_specific_packet_notify(pBtCoexist, packetType); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_specific_packet_notify(pBtCoexist, packetType); @@ -3005,9 +3247,12 @@ void EXhalbtcoutsrc_bt_info_notify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 lengt * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_bt_info_notify(pBtCoexist, tmpBuf, length); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_bt_info_notify(pBtCoexist, tmpBuf, length); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_bt_info_notify(pBtCoexist, tmpBuf, length); @@ -3037,6 +3282,8 @@ void EXhalbtcoutsrc_bt_info_notify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 lengt } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_bt_info_notify(pBtCoexist, tmpBuf, length); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_bt_info_notify(pBtCoexist, tmpBuf, length); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_bt_info_notify(pBtCoexist, tmpBuf, length); @@ -3047,6 +3294,50 @@ void EXhalbtcoutsrc_bt_info_notify(PBTC_COEXIST pBtCoexist, u8 *tmpBuf, u8 lengt /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ } +void EXhalbtcoutsrc_WlFwDbgInfoNotify(PBTC_COEXIST pBtCoexist, u8* tmpBuf, u8 length) +{ + if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) + return; + + if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8703b1ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); + } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8723d1ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8723d2ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); + } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8821c2ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); + else if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8821c1ant_wl_fwdbginfo_notify(pBtCoexist, tmpBuf, length); + } +} + +void EXhalbtcoutsrc_rx_rate_change_notify(PBTC_COEXIST pBtCoexist, u8 is_data_frame, u8 btc_rate_id) +{ + if (!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) + return; + + pBtCoexist->statistics.cnt_rate_id_notify++; + + if (IS_HARDWARE_TYPE_8703B(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8703b1ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); + } else if (IS_HARDWARE_TYPE_8723D(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8723d1ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8723d2ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); + } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { + if (pBtCoexist->board_info.btdm_ant_num == 1) + ex_halbtc8821c1ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8821c2ant_rx_rate_change_notify(pBtCoexist, is_data_frame, btc_rate_id); + } +} + VOID EXhalbtcoutsrc_RfStatusNotify( IN PBTC_COEXIST pBtCoexist, @@ -3072,6 +3363,8 @@ EXhalbtcoutsrc_RfStatusNotify( } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_rf_status_notify(pBtCoexist, type); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_rf_status_notify(pBtCoexist, type); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_rf_status_notify(pBtCoexist, type); @@ -3112,9 +3405,12 @@ void EXhalbtcoutsrc_halt_notify(PBTC_COEXIST pBtCoexist) return; if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_halt_notify(pBtCoexist); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_halt_notify(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_halt_notify(pBtCoexist); @@ -3144,6 +3440,8 @@ void EXhalbtcoutsrc_halt_notify(PBTC_COEXIST pBtCoexist) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_halt_notify(pBtCoexist); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_halt_notify(pBtCoexist); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_halt_notify(pBtCoexist); @@ -3187,9 +3485,12 @@ void EXhalbtcoutsrc_pnp_notify(PBTC_COEXIST pBtCoexist, u8 pnpState) else if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8723d2ant_pnp_notify(pBtCoexist, pnpState); } else if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_pnp_notify(pBtCoexist, pnpState); - else if (pBtCoexist->board_info.btdm_ant_num == 1) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_pnp_notify(pBtCoexist, pnpState); else if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_pnp_notify(pBtCoexist, pnpState); @@ -3202,6 +3503,8 @@ void EXhalbtcoutsrc_pnp_notify(PBTC_COEXIST pBtCoexist, u8 pnpState) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_pnp_notify(pBtCoexist, pnpState); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_pnp_notify(pBtCoexist, pnpState); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_pnp_notify(pBtCoexist, pnpState); @@ -3252,9 +3555,12 @@ void EXhalbtcoutsrc_periodical(PBTC_COEXIST pBtCoexist) * halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_periodical(pBtCoexist); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_periodical(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) { if (!halbtcoutsrc_UnderIps(pBtCoexist)) @@ -3286,6 +3592,8 @@ void EXhalbtcoutsrc_periodical(PBTC_COEXIST pBtCoexist) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_periodical(pBtCoexist); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_periodical(pBtCoexist); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_periodical(pBtCoexist); @@ -3503,10 +3811,16 @@ void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) halbtcoutsrc_LeaveLowPower(pBtCoexist); + /* To prevent the racing with IPS enter */ + halbtcoutsrc_EnterPwrLock(pBtCoexist); + if (IS_HARDWARE_TYPE_8821(pBtCoexist->Adapter)) { +#if 0 if (halbtcoutsrc_IsCsrBtCoex(pBtCoexist) == _TRUE) ex_halbtc8821aCsr2ant_display_coex_info(pBtCoexist); - else if (pBtCoexist->board_info.btdm_ant_num == 2) + else +#endif + if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821a2ant_display_coex_info(pBtCoexist); else if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8821a1ant_display_coex_info(pBtCoexist); @@ -3536,6 +3850,8 @@ void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) } else if (IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_display_coex_info(pBtCoexist); + else if (pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_display_coex_info(pBtCoexist); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_display_coex_info(pBtCoexist); @@ -3543,6 +3859,8 @@ void EXhalbtcoutsrc_DisplayBtCoexInfo(PBTC_COEXIST pBtCoexist) ex_halbtc8821c1ant_display_coex_info(pBtCoexist); } + halbtcoutsrc_ExitPwrLock(pBtCoexist); + halbtcoutsrc_NormalLowPower(pBtCoexist); } @@ -3566,14 +3884,12 @@ void EXhalbtcoutsrc_DisplayAntDetection(PBTC_COEXIST pBtCoexist) halbtcoutsrc_NormalLowPower(pBtCoexist); } -void EXhalbtcoutsrc_BTOffOnNotify(PBTC_COEXIST pBtCoexist, u8 bBTON) +void ex_halbtcoutsrc_pta_off_on_notify(PBTC_COEXIST pBtCoexist, u8 bBTON) { -#if 0 /* Jenyu Need commit to windows' SVN */ if (IS_HARDWARE_TYPE_8812(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) - ex_halbtc8812a2ant_bt_off_on_notify(pBtCoexist, (bBTON == _TRUE) ? BTC_BT_ON : BTC_BT_OFF); + ex_halbtc8812a2ant_pta_off_on_notify(pBtCoexist, (bBTON == _TRUE) ? BTC_BT_ON : BTC_BT_OFF); } -#endif } void EXhalbtcoutsrc_set_rfe_type(u8 type) @@ -3581,6 +3897,18 @@ void EXhalbtcoutsrc_set_rfe_type(u8 type) GLBtCoexist.board_info.rfe_type= type; } +#ifdef CONFIG_RF4CE_COEXIST +void EXhalbtcoutsrc_set_rf4ce_link_state(u8 state) +{ + GLBtCoexist.rf4ce_info.link_state = state; +} + +u8 EXhalbtcoutsrc_get_rf4ce_link_state(void) +{ + return GLBtCoexist.rf4ce_info.link_state; +} +#endif + void EXhalbtcoutsrc_switchband_notify(struct btc_coexist *pBtCoexist, u8 type) { if(!halbtcoutsrc_IsBtCoexistAvailable(pBtCoexist)) @@ -3589,12 +3917,14 @@ void EXhalbtcoutsrc_switchband_notify(struct btc_coexist *pBtCoexist, u8 type) if(pBtCoexist->manual_control) return; - - halbtcoutsrc_LeaveLowPower(pBtCoexist); + /* Driver should guarantee that the HW status isn't in low power mode */ + /* halbtcoutsrc_LeaveLowPower(pBtCoexist); */ if(IS_HARDWARE_TYPE_8822B(pBtCoexist->Adapter)) { if(pBtCoexist->board_info.btdm_ant_num == 1) ex_halbtc8822b1ant_switchband_notify(pBtCoexist, type); + else if(pBtCoexist->board_info.btdm_ant_num == 2) + ex_halbtc8822b2ant_switchband_notify(pBtCoexist, type); } else if (IS_HARDWARE_TYPE_8821C(pBtCoexist->Adapter)) { if (pBtCoexist->board_info.btdm_ant_num == 2) ex_halbtc8821c2ant_switchband_notify(pBtCoexist, type); @@ -3602,7 +3932,278 @@ void EXhalbtcoutsrc_switchband_notify(struct btc_coexist *pBtCoexist, u8 type) ex_halbtc8821c1ant_switchband_notify(pBtCoexist, type); } - halbtcoutsrc_NormalLowPower(pBtCoexist); + /* halbtcoutsrc_NormalLowPower(pBtCoexist); */ +} + +u8 EXhalbtcoutsrc_rate_id_to_btc_rate_id(u8 rate_id) +{ + u8 btc_rate_id = BTC_UNKNOWN; + + switch (rate_id) { + /* CCK rates */ + case DESC_RATE1M: + btc_rate_id = BTC_CCK_1; + break; + case DESC_RATE2M: + btc_rate_id = BTC_CCK_2; + break; + case DESC_RATE5_5M: + btc_rate_id = BTC_CCK_5_5; + break; + case DESC_RATE11M: + btc_rate_id = BTC_CCK_11; + break; + + /* OFDM rates */ + case DESC_RATE6M: + btc_rate_id = BTC_OFDM_6; + break; + case DESC_RATE9M: + btc_rate_id = BTC_OFDM_9; + break; + case DESC_RATE12M: + btc_rate_id = BTC_OFDM_12; + break; + case DESC_RATE18M: + btc_rate_id = BTC_OFDM_18; + break; + case DESC_RATE24M: + btc_rate_id = BTC_OFDM_24; + break; + case DESC_RATE36M: + btc_rate_id = BTC_OFDM_36; + break; + case DESC_RATE48M: + btc_rate_id = BTC_OFDM_48; + break; + case DESC_RATE54M: + btc_rate_id = BTC_OFDM_54; + break; + + /* MCS rates */ + case DESC_RATEMCS0: + btc_rate_id = BTC_MCS_0; + break; + case DESC_RATEMCS1: + btc_rate_id = BTC_MCS_1; + break; + case DESC_RATEMCS2: + btc_rate_id = BTC_MCS_2; + break; + case DESC_RATEMCS3: + btc_rate_id = BTC_MCS_3; + break; + case DESC_RATEMCS4: + btc_rate_id = BTC_MCS_4; + break; + case DESC_RATEMCS5: + btc_rate_id = BTC_MCS_5; + break; + case DESC_RATEMCS6: + btc_rate_id = BTC_MCS_6; + break; + case DESC_RATEMCS7: + btc_rate_id = BTC_MCS_7; + break; + case DESC_RATEMCS8: + btc_rate_id = BTC_MCS_8; + break; + case DESC_RATEMCS9: + btc_rate_id = BTC_MCS_9; + break; + case DESC_RATEMCS10: + btc_rate_id = BTC_MCS_10; + break; + case DESC_RATEMCS11: + btc_rate_id = BTC_MCS_11; + break; + case DESC_RATEMCS12: + btc_rate_id = BTC_MCS_12; + break; + case DESC_RATEMCS13: + btc_rate_id = BTC_MCS_13; + break; + case DESC_RATEMCS14: + btc_rate_id = BTC_MCS_14; + break; + case DESC_RATEMCS15: + btc_rate_id = BTC_MCS_15; + break; + case DESC_RATEMCS16: + btc_rate_id = BTC_MCS_16; + break; + case DESC_RATEMCS17: + btc_rate_id = BTC_MCS_17; + break; + case DESC_RATEMCS18: + btc_rate_id = BTC_MCS_18; + break; + case DESC_RATEMCS19: + btc_rate_id = BTC_MCS_19; + break; + case DESC_RATEMCS20: + btc_rate_id = BTC_MCS_20; + break; + case DESC_RATEMCS21: + btc_rate_id = BTC_MCS_21; + break; + case DESC_RATEMCS22: + btc_rate_id = BTC_MCS_22; + break; + case DESC_RATEMCS23: + btc_rate_id = BTC_MCS_23; + break; + case DESC_RATEMCS24: + btc_rate_id = BTC_MCS_24; + break; + case DESC_RATEMCS25: + btc_rate_id = BTC_MCS_25; + break; + case DESC_RATEMCS26: + btc_rate_id = BTC_MCS_26; + break; + case DESC_RATEMCS27: + btc_rate_id = BTC_MCS_27; + break; + case DESC_RATEMCS28: + btc_rate_id = BTC_MCS_28; + break; + case DESC_RATEMCS29: + btc_rate_id = BTC_MCS_29; + break; + case DESC_RATEMCS30: + btc_rate_id = BTC_MCS_30; + break; + case DESC_RATEMCS31: + btc_rate_id = BTC_MCS_31; + break; + + case DESC_RATEVHTSS1MCS0: + btc_rate_id = BTC_VHT_1SS_MCS_0; + break; + case DESC_RATEVHTSS1MCS1: + btc_rate_id = BTC_VHT_1SS_MCS_1; + break; + case DESC_RATEVHTSS1MCS2: + btc_rate_id = BTC_VHT_1SS_MCS_2; + break; + case DESC_RATEVHTSS1MCS3: + btc_rate_id = BTC_VHT_1SS_MCS_3; + break; + case DESC_RATEVHTSS1MCS4: + btc_rate_id = BTC_VHT_1SS_MCS_4; + break; + case DESC_RATEVHTSS1MCS5: + btc_rate_id = BTC_VHT_1SS_MCS_5; + break; + case DESC_RATEVHTSS1MCS6: + btc_rate_id = BTC_VHT_1SS_MCS_6; + break; + case DESC_RATEVHTSS1MCS7: + btc_rate_id = BTC_VHT_1SS_MCS_7; + break; + case DESC_RATEVHTSS1MCS8: + btc_rate_id = BTC_VHT_1SS_MCS_8; + break; + case DESC_RATEVHTSS1MCS9: + btc_rate_id = BTC_VHT_1SS_MCS_9; + break; + + case DESC_RATEVHTSS2MCS0: + btc_rate_id = BTC_VHT_2SS_MCS_0; + break; + case DESC_RATEVHTSS2MCS1: + btc_rate_id = BTC_VHT_2SS_MCS_1; + break; + case DESC_RATEVHTSS2MCS2: + btc_rate_id = BTC_VHT_2SS_MCS_2; + break; + case DESC_RATEVHTSS2MCS3: + btc_rate_id = BTC_VHT_2SS_MCS_3; + break; + case DESC_RATEVHTSS2MCS4: + btc_rate_id = BTC_VHT_2SS_MCS_4; + break; + case DESC_RATEVHTSS2MCS5: + btc_rate_id = BTC_VHT_2SS_MCS_5; + break; + case DESC_RATEVHTSS2MCS6: + btc_rate_id = BTC_VHT_2SS_MCS_6; + break; + case DESC_RATEVHTSS2MCS7: + btc_rate_id = BTC_VHT_2SS_MCS_7; + break; + case DESC_RATEVHTSS2MCS8: + btc_rate_id = BTC_VHT_2SS_MCS_8; + break; + case DESC_RATEVHTSS2MCS9: + btc_rate_id = BTC_VHT_2SS_MCS_9; + break; + + case DESC_RATEVHTSS3MCS0: + btc_rate_id = BTC_VHT_3SS_MCS_0; + break; + case DESC_RATEVHTSS3MCS1: + btc_rate_id = BTC_VHT_3SS_MCS_1; + break; + case DESC_RATEVHTSS3MCS2: + btc_rate_id = BTC_VHT_3SS_MCS_2; + break; + case DESC_RATEVHTSS3MCS3: + btc_rate_id = BTC_VHT_3SS_MCS_3; + break; + case DESC_RATEVHTSS3MCS4: + btc_rate_id = BTC_VHT_3SS_MCS_4; + break; + case DESC_RATEVHTSS3MCS5: + btc_rate_id = BTC_VHT_3SS_MCS_5; + break; + case DESC_RATEVHTSS3MCS6: + btc_rate_id = BTC_VHT_3SS_MCS_6; + break; + case DESC_RATEVHTSS3MCS7: + btc_rate_id = BTC_VHT_3SS_MCS_7; + break; + case DESC_RATEVHTSS3MCS8: + btc_rate_id = BTC_VHT_3SS_MCS_8; + break; + case DESC_RATEVHTSS3MCS9: + btc_rate_id = BTC_VHT_3SS_MCS_9; + break; + + case DESC_RATEVHTSS4MCS0: + btc_rate_id = BTC_VHT_4SS_MCS_0; + break; + case DESC_RATEVHTSS4MCS1: + btc_rate_id = BTC_VHT_4SS_MCS_1; + break; + case DESC_RATEVHTSS4MCS2: + btc_rate_id = BTC_VHT_4SS_MCS_2; + break; + case DESC_RATEVHTSS4MCS3: + btc_rate_id = BTC_VHT_4SS_MCS_3; + break; + case DESC_RATEVHTSS4MCS4: + btc_rate_id = BTC_VHT_4SS_MCS_4; + break; + case DESC_RATEVHTSS4MCS5: + btc_rate_id = BTC_VHT_4SS_MCS_5; + break; + case DESC_RATEVHTSS4MCS6: + btc_rate_id = BTC_VHT_4SS_MCS_6; + break; + case DESC_RATEVHTSS4MCS7: + btc_rate_id = BTC_VHT_4SS_MCS_7; + break; + case DESC_RATEVHTSS4MCS8: + btc_rate_id = BTC_VHT_4SS_MCS_8; + break; + case DESC_RATEVHTSS4MCS9: + btc_rate_id = BTC_VHT_4SS_MCS_9; + break; + } + + return btc_rate_id; } static void halbt_init_hw_config92C(PADAPTER padapter) @@ -3661,6 +4262,7 @@ void hal_btcoex_SetBTCoexist(PADAPTER padapter, u8 bBtExist) { PHAL_DATA_TYPE pHalData; + pHalData = GET_HAL_DATA(padapter); pHalData->bt_coexist.bBtExist = bBtExist; } @@ -3677,6 +4279,7 @@ u8 hal_btcoex_IsBtExist(PADAPTER padapter) { PHAL_DATA_TYPE pHalData; + pHalData = GET_HAL_DATA(padapter); return pHalData->bt_coexist.bBtExist; } @@ -3704,7 +4307,6 @@ void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum) { PHAL_DATA_TYPE pHalData; - pHalData = GET_HAL_DATA(padapter); pHalData->bt_coexist.btTotalAntNum = antNum; @@ -3715,13 +4317,8 @@ u8 hal_btcoex_Initialize(PADAPTER padapter) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); u8 ret; - _rtw_memset(&GLBtCoexist, 0, sizeof(GLBtCoexist)); - hal_btcoex_SetBTCoexist(padapter, rtw_btcoex_get_bt_coexist(padapter)); - hal_btcoex_SetChipType(padapter, rtw_btcoex_get_chip_type(padapter)); - hal_btcoex_SetPgAntNum(padapter, rtw_btcoex_get_pg_ant_num(padapter)); - ret = EXhalbtcoutsrc_InitlizeVariables((void *)padapter); return ret; @@ -3732,6 +4329,23 @@ void hal_btcoex_PowerOnSetting(PADAPTER padapter) EXhalbtcoutsrc_PowerOnSetting(&GLBtCoexist); } +void hal_btcoex_AntInfoSetting(PADAPTER padapter) +{ + hal_btcoex_SetBTCoexist(padapter, rtw_btcoex_get_bt_coexist(padapter)); + hal_btcoex_SetChipType(padapter, rtw_btcoex_get_chip_type(padapter)); + hal_btcoex_SetPgAntNum(padapter, rtw_btcoex_get_pg_ant_num(padapter)); + + EXhalbtcoutsrc_AntInfoSetting(padapter); +} + +void hal_btcoex_PowerOffSetting(PADAPTER padapter) +{ + /* Clear the WiFi on/off bit in scoreboard reg. if necessary */ + if (IS_HARDWARE_TYPE_8703B(padapter) || IS_HARDWARE_TYPE_8723D(padapter) + || IS_HARDWARE_TYPE_8821C(padapter) || IS_HARDWARE_TYPE_8822B(padapter)) + rtw_write16(padapter, 0xaa, 0x8000); +} + void hal_btcoex_PreLoadFirmware(PADAPTER padapter) { EXhalbtcoutsrc_PreLoadFirmware(&GLBtCoexist); @@ -3763,7 +4377,25 @@ void hal_btcoex_ScanNotify(PADAPTER padapter, u8 type) void hal_btcoex_ConnectNotify(PADAPTER padapter, u8 action) { - EXhalbtcoutsrc_connect_notify(&GLBtCoexist, action); + u8 assoType = 0; + u8 is_5g_band = _FALSE; + + is_5g_band = (padapter->mlmeextpriv.cur_channel > 14) ? _TRUE : _FALSE; + + if (action == _TRUE) { + if (is_5g_band == _TRUE) + assoType = BTC_ASSOCIATE_5G_START; + else + assoType = BTC_ASSOCIATE_START; + } + else { + if (is_5g_band == _TRUE) + assoType = BTC_ASSOCIATE_5G_FINISH; + else + assoType = BTC_ASSOCIATE_FINISH; + } + + EXhalbtcoutsrc_connect_notify(&GLBtCoexist, assoType); } void hal_btcoex_MediaStatusNotify(PADAPTER padapter, u8 mediaStatus) @@ -3794,7 +4426,7 @@ void hal_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) u8 extid, status, len, seq; - if (!GLBtcBtMpRptWait) + if (GLBtcBtMpRptWait == _FALSE) return; if ((length < 3) || (!tmpBuf)) @@ -3804,28 +4436,32 @@ void hal_btcoex_BtMpRptNotify(PADAPTER padapter, u8 length, u8 *tmpBuf) /* not response from BT FW then exit*/ switch (extid) { case C2H_WIFI_FW_ACTIVE_RSP: - GLBtcBtMpRptWiFiOK = 1; - return; + GLBtcBtMpRptWiFiOK = _TRUE; + break; case C2H_TRIG_BY_BT_FW: - _cancel_timer_ex(&GLBtcBtMpOperTimer); - GLBtcBtMpRptWait = 0; - GLBtcBtMpRptBTOK = 1; + GLBtcBtMpRptBTOK = _TRUE; + + status = tmpBuf[1] & 0xF; + len = length - 3; + seq = tmpBuf[2] >> 4; + + GLBtcBtMpRptSeq = seq; + GLBtcBtMpRptStatus = status; + _rtw_memcpy(GLBtcBtMpRptRsp, tmpBuf + 3, len); + GLBtcBtMpRptRspSize = len; + break; default: return; } - status = tmpBuf[1] & 0xF; - len = length - 3; - seq = tmpBuf[2] >> 4; - - GLBtcBtMpRptSeq = seq; - GLBtcBtMpRptStatus = status; - _rtw_memcpy(GLBtcBtMpRptRsp, tmpBuf + 3, len); - GLBtcBtMpRptRspSize = len; - _rtw_up_sema(&GLBtcBtMpRptSema); + if ((GLBtcBtMpRptWiFiOK == _TRUE) && (GLBtcBtMpRptBTOK == _TRUE)) { + GLBtcBtMpRptWait = _FALSE; + _cancel_timer_ex(&GLBtcBtMpOperTimer); + _rtw_up_sema(&GLBtcBtMpRptSema); + } } void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state) @@ -3844,6 +4480,10 @@ void hal_btcoex_SuspendNotify(PADAPTER padapter, u8 state) #endif break; case BTCOEX_SUSPEND_STATE_RESUME: +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + /* re-download FW after resume, inform WL FW port number */ + rtw_hal_set_wifi_port_id_cmd(GLBtCoexist.Adapter); +#endif EXhalbtcoutsrc_pnp_notify(&GLBtCoexist, BTC_WIFI_PNP_WAKE_UP); break; } @@ -4158,9 +4798,9 @@ void hal_btcoex_StackUpdateProfileInfo(void) EXhalbtcoutsrc_StackUpdateProfileInfo(); } -void hal_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON) +void hal_btcoex_pta_off_on_notify(PADAPTER padapter, u8 bBTON) { - EXhalbtcoutsrc_BTOffOnNotify(&GLBtCoexist, bBTON); + ex_halbtcoutsrc_pta_off_on_notify(&GLBtCoexist, bBTON); } /* @@ -4358,6 +4998,19 @@ void hal_btcoex_set_rfe_type(u8 type) { EXhalbtcoutsrc_set_rfe_type(type); } + +#ifdef CONFIG_RF4CE_COEXIST +void hal_btcoex_set_rf4ce_link_state(u8 state) +{ + EXhalbtcoutsrc_set_rf4ce_link_state(state); +} + +u8 hal_btcoex_get_rf4ce_link_state(void) +{ + return EXhalbtcoutsrc_get_rf4ce_link_state(); +} +#endif /* CONFIG_RF4CE_COEXIST */ + void hal_btcoex_switchband_notify(u8 under_scan, u8 band_type) { switch (band_type) { @@ -4375,4 +5028,14 @@ void hal_btcoex_switchband_notify(u8 under_scan, u8 band_type) break; } } + +void hal_btcoex_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length) +{ + EXhalbtcoutsrc_WlFwDbgInfoNotify(&GLBtCoexist, tmpBuf, length); +} + +void hal_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id) +{ + EXhalbtcoutsrc_rx_rate_change_notify(&GLBtCoexist, is_data_frame, EXhalbtcoutsrc_rate_id_to_btc_rate_id(rate_id)); +} #endif /* CONFIG_BT_COEXIST */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex_wifionly.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex_wifionly.c new file mode 100644 index 000000000000..33555656aac5 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_btcoex_wifionly.c @@ -0,0 +1,178 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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 "btc/mp_precomp.h" +#include + +struct wifi_only_cfg GLBtCoexistWifiOnly; + +void halwifionly_write1byte(PVOID pwifionlyContext, u32 RegAddr, u8 Data) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + rtw_write8(Adapter, RegAddr, Data); +} + +void halwifionly_write2byte(PVOID pwifionlyContext, u32 RegAddr, u16 Data) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + rtw_write16(Adapter, RegAddr, Data); +} + +void halwifionly_write4byte(PVOID pwifionlyContext, u32 RegAddr, u32 Data) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + rtw_write32(Adapter, RegAddr, Data); +} + +u8 halwifionly_read1byte(PVOID pwifionlyContext, u32 RegAddr) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + return rtw_read8(Adapter, RegAddr); +} + +u16 halwifionly_read2byte(PVOID pwifionlyContext, u32 RegAddr) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + return rtw_read16(Adapter, RegAddr); +} + +u32 halwifionly_read4byte(PVOID pwifionlyContext, u32 RegAddr) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + return rtw_read32(Adapter, RegAddr); +} + +void halwifionly_bitmaskwrite1byte(PVOID pwifionlyContext, u32 regAddr, u8 bitMask, u8 data) +{ + u8 originalValue, bitShift = 0; + u8 i; + + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + if (bitMask != 0xff) { + originalValue = rtw_read8(Adapter, regAddr); + for (i = 0; i <= 7; i++) { + if ((bitMask >> i) & 0x1) + break; + } + bitShift = i; + data = ((originalValue) & (~bitMask)) | (((data << bitShift)) & bitMask); + } + rtw_write8(Adapter, regAddr, data); +} + +void halwifionly_phy_set_rf_reg(PVOID pwifionlyContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + phy_set_rf_reg(Adapter, eRFPath, RegAddr, BitMask, Data); +} + +void halwifionly_phy_set_bb_reg(PVOID pwifionlyContext, u32 RegAddr, u32 BitMask, u32 Data) +{ + struct wifi_only_cfg *pwifionlycfg = (struct wifi_only_cfg *)pwifionlyContext; + PADAPTER Adapter = pwifionlycfg->Adapter; + + phy_set_bb_reg(Adapter, RegAddr, BitMask, Data); +} + +void hal_btcoex_wifionly_switchband_notify(PADAPTER padapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + u8 is_5g = _FALSE; + + if (pHalData->current_band_type == BAND_ON_5G) + is_5g = _TRUE; + + if (IS_HARDWARE_TYPE_8822B(padapter)) + ex_hal8822b_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); + else if (IS_HARDWARE_TYPE_8821C(padapter)) + ex_hal8821c_wifi_only_switchbandnotify(&GLBtCoexistWifiOnly, is_5g); +} + +void hal_btcoex_wifionly_scan_notify(PADAPTER padapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + u8 is_5g = _FALSE; + + if (pHalData->current_band_type == BAND_ON_5G) + is_5g = _TRUE; + + if (IS_HARDWARE_TYPE_8822B(padapter)) + ex_hal8822b_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); + else if (IS_HARDWARE_TYPE_8821C(padapter)) + ex_hal8821c_wifi_only_scannotify(&GLBtCoexistWifiOnly, is_5g); +} + +void hal_btcoex_wifionly_hw_config(PADAPTER padapter) +{ + struct wifi_only_cfg *pwifionlycfg = &GLBtCoexistWifiOnly; + + if (IS_HARDWARE_TYPE_8723B(padapter)) + ex_hal8723b_wifi_only_hw_config(pwifionlycfg); + else if (IS_HARDWARE_TYPE_8822B(padapter)) + ex_hal8822b_wifi_only_hw_config(pwifionlycfg); + else if (IS_HARDWARE_TYPE_8821C(padapter)) + ex_hal8821c_wifi_only_hw_config(pwifionlycfg); +} + +void hal_btcoex_wifionly_initlizevariables(PADAPTER padapter) +{ + struct wifi_only_cfg *pwifionlycfg = &GLBtCoexistWifiOnly; + struct wifi_only_haldata *pwifionly_haldata = &pwifionlycfg->haldata_info; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + + _rtw_memset(&GLBtCoexistWifiOnly, 0, sizeof(GLBtCoexistWifiOnly)); + + pwifionlycfg->Adapter = padapter; + +#ifdef CONFIG_PCI_HCI + pwifionlycfg->chip_interface = WIFIONLY_INTF_PCI; +#elif defined(CONFIG_USB_HCI) + pwifionlycfg->chip_interface = WIFIONLY_INTF_USB; +#elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) + pwifionlycfg->chip_interface = WIFIONLY_INTF_SDIO; +#else + pwifionlycfg->chip_interface = WIFIONLY_INTF_UNKNOWN; +#endif + + pwifionly_haldata->customer_id = CUSTOMER_NORMAL; +} + +void hal_btcoex_wifionly_AntInfoSetting(PADAPTER padapter) +{ + struct wifi_only_cfg *pwifionlycfg = &GLBtCoexistWifiOnly; + struct wifi_only_haldata *pwifionly_haldata = &pwifionlycfg->haldata_info; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + + pwifionly_haldata->efuse_pg_antnum = pHalData->EEPROMBluetoothAntNum; + pwifionly_haldata->efuse_pg_antpath = pHalData->ant_path; + pwifionly_haldata->rfe_type = pHalData->rfe_type; + pwifionly_haldata->ant_div_cfg = pHalData->AntDivCfg; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com.c index a9096eba418a..136f16d62373 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_COM_C_ #include @@ -24,6 +19,24 @@ #include "hal_data.h" +#ifdef RTW_HALMAC +#include "../../hal/hal_halmac.h" +#endif + +void rtw_dump_fw_info(void *sel, _adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = NULL; + + if (!adapter) + return; + + hal_data = GET_HAL_DATA(adapter); + if (hal_data->bFWReady) + RTW_PRINT_SEL(sel, "FW VER -%d.%d\n", hal_data->firmware_version, hal_data->firmware_sub_version); + else + RTW_PRINT_SEL(sel, "FW not ready\n"); +} + /* #define CONFIG_GTK_OL_DBG */ /*#define DBG_SEC_CAM_MOVE*/ @@ -34,7 +47,7 @@ void rtw_hal_move_sta_gk_to_dk(_adapter *adapter) int cam_id, index = 0; u8 *addr = NULL; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (!MLME_IS_STA(adapter)) return; addr = get_bssid(pmlmepriv); @@ -174,19 +187,19 @@ void rtw_hal_config_rftype(PADAPTER padapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - if (IS_1T1R(pHalData->VersionID)) { + if (IS_1T1R(pHalData->version_id)) { pHalData->rf_type = RF_1T1R; pHalData->NumTotalRFPath = 1; - } else if (IS_2T2R(pHalData->VersionID)) { + } else if (IS_2T2R(pHalData->version_id)) { pHalData->rf_type = RF_2T2R; pHalData->NumTotalRFPath = 2; - } else if (IS_1T2R(pHalData->VersionID)) { + } else if (IS_1T2R(pHalData->version_id)) { pHalData->rf_type = RF_1T2R; pHalData->NumTotalRFPath = 2; - } else if (IS_3T3R(pHalData->VersionID)) { + } else if (IS_3T3R(pHalData->version_id)) { pHalData->rf_type = RF_3T3R; pHalData->NumTotalRFPath = 3; - } else if (IS_4T4R(pHalData->VersionID)) { + } else if (IS_4T4R(pHalData->version_id)) { pHalData->rf_type = RF_4T4R; pHalData->NumTotalRFPath = 4; } else { @@ -215,11 +228,8 @@ void rtw_hal_config_rftype(PADAPTER padapter) * def_chplan channel plan used when HW/SW both invalid * AutoLoadFail efuse autoload fail or not * - * Return: - * Final channel plan decision - * */ -u8 hal_com_config_channel_plan( +void hal_com_config_channel_plan( IN PADAPTER padapter, IN char *hw_alpha2, IN u8 hw_chplan, @@ -229,6 +239,7 @@ u8 hal_com_config_channel_plan( IN BOOLEAN AutoLoadFail ) { + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); PHAL_DATA_TYPE pHalData; u8 force_hw_chplan = _FALSE; int chplan = -1; @@ -289,7 +300,7 @@ u8 hal_com_config_channel_plan( /* cancel hw_alpha2 because chplan is specified by sw_chplan*/ country_ent = NULL; chplan = sw_chplan; - } else if (sw_chplan != RTW_CHPLAN_MAX) + } else if (sw_chplan != RTW_CHPLAN_UNSPECIFIED) RTW_PRINT("%s unsupported sw_chplan:0x%02X\n", __func__, sw_chplan); done: @@ -302,10 +313,9 @@ u8 hal_com_config_channel_plan( } else RTW_PRINT("%s chplan:0x%02X\n", __func__, chplan); - padapter->mlmepriv.country_ent = country_ent; + rfctl->country_ent = country_ent; + rfctl->ChannelPlan = chplan; pHalData->bDisableSWChannelPlan = force_hw_chplan; - - return chplan; } BOOLEAN @@ -317,7 +327,7 @@ HAL_IsLegalChannel( BOOLEAN bLegalChannel = _TRUE; if (Channel > 14) { - if (IsSupported5G(Adapter->registrypriv.wireless_mode) == _FALSE) { + if (is_supported_5g(Adapter->registrypriv.wireless_mode) == _FALSE) { bLegalChannel = _FALSE; RTW_INFO("Channel > 14 but wireless_mode do not support 5G\n"); } @@ -600,7 +610,7 @@ u8 MRateToHwRate(u8 rate) return ret; } -u8 HwRateToMRate(u8 rate) +u8 hw_rate_to_m_rate(u8 rate) { u8 ret_rate = MGN_1M; @@ -860,7 +870,7 @@ u8 HwRateToMRate(u8 rate) break; default: - RTW_INFO("HwRateToMRate(): Non supported Rate [%x]!!!\n", rate); + RTW_INFO("hw_rate_to_m_rate(): Non supported Rate [%x]!!!\n", rate); break; } @@ -1100,6 +1110,12 @@ Hal_MappingOutPipe( } +void rtw_hal_reqtxrpt(_adapter *padapter, u8 macid) +{ + if (padapter->hal_func.reqtxrpt) + padapter->hal_func.reqtxrpt(padapter, macid); +} + void rtw_hal_dump_macaddr(void *sel, _adapter *adapter) { int i; @@ -1113,7 +1129,7 @@ void rtw_hal_dump_macaddr(void *sel, _adapter *adapter) for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if (iface) { - rtw_hal_get_macaddr_port(iface, mac_addr); + rtw_hal_get_hwreg(iface, HW_VAR_MAC_ADDR, mac_addr); RTW_PRINT_SEL(sel, ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", ADPT_ARG(iface), iface->hw_port, MAC_ARG(mac_addr)); } @@ -1121,12 +1137,56 @@ void rtw_hal_dump_macaddr(void *sel, _adapter *adapter) #endif } -void rtw_restore_mac_addr(_adapter *adapter) +#ifdef RTW_HALMAC +void rtw_hal_hw_port_enable(_adapter *adapter) +{ +#if 1 + u8 port_enable = _TRUE; + + rtw_hal_set_hwreg(adapter, HW_VAR_PORT_CFG, &port_enable); +#else + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct rtw_halmac_bcn_ctrl bcn_ctrl; + + _rtw_memset(&bcn_ctrl, 0, sizeof(struct rtw_halmac_bcn_ctrl)); + bcn_ctrl.enable_bcn = 1; + + /*rtw_halmac_get_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, + struct rtw_halmac_bcn_ctrl *bcn_ctrl)*/ + if (rtw_halmac_set_bcn_ctrl(dvobj, get_hw_port(adapter), &bcn_ctrl) == -1) { + RTW_ERR(ADPT_FMT" - hw port(%d) enable fail!!\n", ADPT_ARG(adapter), get_hw_port(adapter)); + rtw_warn_on(1); + } +#endif +} +void rtw_hal_hw_port_disable(_adapter *adapter) +{ + u8 port_enable = _FALSE; + + rtw_hal_set_hwreg(adapter, HW_VAR_PORT_CFG, &port_enable); +} + +void rtw_restore_hw_port_cfg(_adapter *adapter) { #ifdef CONFIG_MI_WITH_MBSSID_CAM + +#else + int i; _adapter *iface; struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface) + rtw_hal_hw_port_enable(iface); + } +#endif +} +#endif + +void rtw_restore_mac_addr(_adapter *adapter) +{ +#ifdef CONFIG_MI_WITH_MBSSID_CAM rtw_mbid_cam_restore(adapter); #else int i; @@ -1136,7 +1196,7 @@ void rtw_restore_mac_addr(_adapter *adapter) for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if (iface) - rtw_hal_set_macaddr_port(iface, adapter_mac_addr(iface)); + rtw_hal_set_hwreg(iface, HW_VAR_MAC_ADDR, adapter_mac_addr(iface)); } #endif if (1) @@ -1149,7 +1209,8 @@ void rtw_init_hal_com_default_value(PADAPTER Adapter) struct registry_priv *regsty = adapter_to_regsty(Adapter); pHalData->AntDetection = 1; - pHalData->u1ForcedIgiLb = regsty->force_igi_lb; + pHalData->antenna_test = _FALSE; + pHalData->RegIQKFWOffload = regsty->iqk_fw_offload; } #ifdef CONFIG_FW_C2H_REG @@ -1253,7 +1314,7 @@ void rtw_hal_c2h_pkt_pre_hdl(_adapter *adapter, u8 *buf, u16 len) void rtw_hal_c2h_pkt_hdl(_adapter *adapter, u8 *buf, u16 len) { #ifdef RTW_HALMAC - adapter->HalFunc.hal_mac_c2h_handler(adapter, buf, len); + adapter->hal_func.hal_mac_c2h_handler(adapter, buf, len); #else u8 parse_fail = 0; u8 bypass = 0; @@ -1325,7 +1386,6 @@ int c2h_iqk_offload_wait(_adapter *adapter, u32 timeout_ms) #define GET_C2H_MAC_HIDDEN_RPT_WL_FUNC(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 0, 4) #define GET_C2H_MAC_HIDDEN_RPT_HW_STYPE(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 5, 4, 4) #define GET_C2H_MAC_HIDDEN_RPT_BW(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 0, 3) -#define GET_C2H_MAC_HIDDEN_RPT_FAB(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 3, 2) #define GET_C2H_MAC_HIDDEN_RPT_ANT_NUM(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 6, 5, 3) #define GET_C2H_MAC_HIDDEN_RPT_80211_PROTOCOL(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 2, 2) #define GET_C2H_MAC_HIDDEN_RPT_NIC_ROUTER(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 7, 6, 2) @@ -1353,7 +1413,6 @@ int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len) u8 wl_func; u8 hw_stype; u8 bw; - u8 fab; u8 ant_num; u8 protocol; u8 nic; @@ -1379,7 +1438,6 @@ int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len) hw_stype = GET_C2H_MAC_HIDDEN_RPT_HW_STYPE(data); bw = GET_C2H_MAC_HIDDEN_RPT_BW(data); - fab = GET_C2H_MAC_HIDDEN_RPT_FAB(data); ant_num = GET_C2H_MAC_HIDDEN_RPT_ANT_NUM(data); protocol = GET_C2H_MAC_HIDDEN_RPT_80211_PROTOCOL(data); @@ -1396,7 +1454,6 @@ int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len) RTW_PRINT("wl_func:0x%x\n", wl_func); RTW_PRINT("hw_stype:0x%x\n", hw_stype); RTW_PRINT("bw:0x%x\n", bw); - RTW_PRINT("fab:0x%x\n", fab); RTW_PRINT("ant_num:0x%x\n", ant_num); RTW_PRINT("protocol:0x%x\n", protocol); RTW_PRINT("nic:0x%x\n", nic); @@ -1411,11 +1468,12 @@ int c2h_mac_hidden_rpt_hdl(_adapter *adapter, u8 *data, u8 len) hal_data->PackageType = package_type; hal_spec->wl_func &= mac_hidden_wl_func_to_hal_wl_func(wl_func); hal_spec->bw_cap &= mac_hidden_max_bw_to_hal_bw_cap(bw); - hal_spec->nss_num = rtw_min(hal_spec->nss_num, ant_num); + hal_spec->tx_nss_num = rtw_min(hal_spec->tx_nss_num, ant_num); + hal_spec->rx_nss_num = rtw_min(hal_spec->rx_nss_num, ant_num); hal_spec->proto_cap &= mac_hidden_proto_to_hal_proto_cap(protocol); + hal_spec->hci_type = hci_type; /* TODO: tr_switch */ - /* TODO: fab */ ret = _SUCCESS; @@ -1441,6 +1499,19 @@ int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len) RTW_PRINT("%s: 0x%02X\n", __func__, *(data + i)); } + #ifdef CONFIG_RTL8188F + if (IS_8188F(hal_data->version_id)) { + #define GET_C2H_MAC_HIDDEN_RPT_IRV(_data) LE_BITS_TO_1BYTE(((u8 *)(_data)) + 0, 0, 4) + u8 irv = GET_C2H_MAC_HIDDEN_RPT_IRV(data); + + if (DBG_C2H_MAC_HIDDEN_RPT_HANDLE) + RTW_PRINT("irv:0x%x\n", irv); + + if(irv != 0xf) + hal_data->version_id.CUTVersion = irv; + } + #endif + ret = _SUCCESS; exit: @@ -1449,10 +1520,11 @@ int c2h_mac_hidden_rpt_2_hdl(_adapter *adapter, u8 *data, u8 len) int hal_read_mac_hidden_rpt(_adapter *adapter) { + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); int ret = _FAIL; int ret_fwdl; u8 mac_hidden_rpt[MAC_HIDDEN_RPT_LEN + MAC_HIDDEN_RPT_2_LEN] = {0}; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); u32 cnt = 0; u32 timeout_ms = 800; u32 min_cnt = 10; @@ -1471,7 +1543,9 @@ int hal_read_mac_hidden_rpt(_adapter *adapter) rtw_write8(adapter, REG_C2HEVT_MSG_NORMAL, C2H_DEFEATURE_RSVD); /* download FW */ + pHalData->not_xmitframe_fw_dl = 1; ret_fwdl = rtw_hal_fw_dl(adapter, _FALSE); + pHalData->not_xmitframe_fw_dl = 0; if (ret_fwdl != _SUCCESS) goto mac_hidden_rpt_hdl; @@ -1761,22 +1835,77 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs) } #endif /* CONFIG_RTW_CUSTOMER_STR */ -u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta) +void rtw_hal_update_sta_wset(_adapter *adapter, struct sta_info *psta) { -#ifdef CONFIG_GET_RAID_BY_DRV /*Just for 8188E now*/ - if (IS_NEW_GENERATION_IC(adapter)) - return networktype_to_raid_ex(adapter, psta); - else - return networktype_to_raid(adapter, psta); -#else - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - u8 bw; + u8 w_set = 0; - bw = rtw_get_tx_bw_mode(adapter, psta); + if (psta->wireless_mode & WIRELESS_11B) + w_set |= WIRELESS_CCK; - return phydm_rate_id_mapping(&pHalData->odmpriv, psta->wireless_mode, pHalData->rf_type, bw); -#endif + if ((psta->wireless_mode & WIRELESS_11G) || (psta->wireless_mode & WIRELESS_11A)) + w_set |= WIRELESS_OFDM; + + if (psta->wireless_mode & WIRELESS_11_24N) + w_set |= WIRELESS_HT; + + if ((psta->wireless_mode & WIRELESS_11AC) || (psta->wireless_mode & WIRELESS_11_5N)) + w_set |= WIRELESS_VHT; + + psta->cmn.support_wireless_set = w_set; } + +void rtw_hal_update_sta_mimo_type(_adapter *adapter, struct sta_info *psta) +{ + s8 tx_nss, rx_nss; + + tx_nss = rtw_get_sta_tx_nss(adapter, psta); + rx_nss = rtw_get_sta_rx_nss(adapter, psta); + if ((tx_nss == 1) && (rx_nss == 1)) + psta->cmn.mimo_type = RF_1T1R; + else if ((tx_nss == 1) && (rx_nss == 2)) + psta->cmn.mimo_type = RF_1T2R; + else if ((tx_nss == 2) && (rx_nss == 2)) + psta->cmn.mimo_type = RF_2T2R; + else if ((tx_nss == 2) && (rx_nss == 3)) + psta->cmn.mimo_type = RF_2T3R; + else if ((tx_nss == 2) && (rx_nss == 4)) + psta->cmn.mimo_type = RF_2T4R; + else if ((tx_nss == 3) && (rx_nss == 3)) + psta->cmn.mimo_type = RF_3T3R; + else if ((tx_nss == 3) && (rx_nss == 4)) + psta->cmn.mimo_type = RF_3T4R; + else if ((tx_nss == 4) && (rx_nss == 4)) + psta->cmn.mimo_type = RF_4T4R; + else + rtw_warn_on(1); + + RTW_INFO("STA - MAC_ID:%d, Tx - %d SS, Rx - %d SS\n", + psta->cmn.mac_id, tx_nss, rx_nss); +} + +void rtw_hal_update_sta_smps_cap(_adapter *adapter, struct sta_info *psta) +{ + /*Spatial Multiplexing Power Save*/ +#if 0 + if (check_fwstate(&adapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { + #ifdef CONFIG_80211N_HT + if (psta->htpriv.ht_option) { + if (psta->htpriv.smps_cap == 0) + psta->cmn.sm_ps = SM_PS_STATIC; + else if (psta->htpriv.smps_cap == 1) + psta->cmn.sm_ps = SM_PS_DYNAMIC; + else + psta->cmn.sm_ps = SM_PS_DISABLE; + } + #endif /* CONFIG_80211N_HT */ + } else +#endif + psta->cmn.sm_ps = SM_PS_DISABLE; + + RTW_INFO("STA - MAC_ID:%d, SM_PS %d\n", + psta->cmn.mac_id, psta->cmn.sm_ps); +} + u8 rtw_get_mgntframe_raid(_adapter *adapter, unsigned char network_type) { @@ -1794,14 +1923,13 @@ u8 rtw_get_mgntframe_raid(_adapter *adapter, unsigned char network_type) void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) { - u8 i, rf_type, limit; - u64 tx_ra_bitmap; + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); + u8 i, rf_type, tx_nss; + u64 tx_ra_bitmap = 0; if (psta == NULL) return; - tx_ra_bitmap = 0; - /* b/g mode ra_bitmap */ for (i = 0; i < sizeof(psta->bssrateset); i++) { if (psta->bssrateset[i]) @@ -1809,47 +1937,40 @@ void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta) } #ifdef CONFIG_80211N_HT + rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); + tx_nss = rtw_min(rf_type_to_rf_tx_cnt(rf_type), hal_spec->tx_nss_num); #ifdef CONFIG_80211AC_VHT - /* AC mode ra_bitmap */ - if (psta->vhtpriv.vht_option) - tx_ra_bitmap |= (rtw_vht_rate_to_bitmap(psta->vhtpriv.vht_mcs_map) << 12); - else + if (psta->vhtpriv.vht_option) { + /* AC mode ra_bitmap */ + tx_ra_bitmap |= (rtw_vht_mcs_map_to_bitmap(psta->vhtpriv.vht_mcs_map, tx_nss) << 12); + } else #endif /* CONFIG_80211AC_VHT */ - { + if (psta->htpriv.ht_option) { /* n mode ra_bitmap */ - if (psta->htpriv.ht_option) { - rf_type = RF_1T1R; - rtw_hal_get_hwreg(padapter, HW_VAR_RF_TYPE, (u8 *)(&rf_type)); - if (rf_type == RF_2T2R) - limit = 16; /* 2R */ - else if (rf_type == RF_3T3R) - limit = 24; /* 3R */ - else - limit = 8; /* 1R */ - - /* Handling SMPS mode for AP MODE only*/ - if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { - /*0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ - if (psta->htpriv.smps_cap == 0 || psta->htpriv.smps_cap == 1) { - /*operate with only one active receive chain // 11n-MCS rate <= MSC7*/ - limit = 8;/* 1R*/ - } - } - - for (i = 0; i < limit; i++) { - if (psta->htpriv.ht_cap.supp_mcs_set[i / 8] & BIT(i % 8)) - tx_ra_bitmap |= BIT(i + 12); + /* Handling SMPS mode for AP MODE only*/ + if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { + /*0:static SMPS, 1:dynamic SMPS, 3:SMPS disabled, 2:reserved*/ + if (psta->htpriv.smps_cap == 0 || psta->htpriv.smps_cap == 1) { + /*operate with only one active receive chain // 11n-MCS rate <= MSC7*/ + tx_nss = rtw_min(tx_nss, 1); } } + + tx_ra_bitmap |= (rtw_ht_mcs_set_to_bitmap(psta->htpriv.ht_cap.supp_mcs_set, tx_nss) << 12); } - RTW_INFO("supp_mcs_set = %02x, %02x, %02x, rf_type=%d, tx_ra_bitmap=%016llx\n" - , psta->htpriv.ht_cap.supp_mcs_set[0], psta->htpriv.ht_cap.supp_mcs_set[1], psta->htpriv.ht_cap.supp_mcs_set[2], rf_type, tx_ra_bitmap); #endif /* CONFIG_80211N_HT */ - psta->ra_mask = tx_ra_bitmap; + psta->cmn.ra_info.ramask = tx_ra_bitmap; psta->init_rate = get_highest_rate_idx(tx_ra_bitmap) & 0x3f; } +void rtw_hal_update_sta_ra_info(PADAPTER padapter, struct sta_info *psta) +{ + rtw_hal_update_sta_mimo_type(padapter, psta); + rtw_hal_update_sta_smps_cap(padapter, psta); + rtw_hal_update_sta_rate_mask(padapter, psta); +} + #ifndef SEC_CAM_ACCESS_TIMEOUT_MS #define SEC_CAM_ACCESS_TIMEOUT_MS 200 #endif @@ -1863,7 +1984,7 @@ u32 rtw_sec_read_cam(_adapter *adapter, u8 addr) _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; u32 rdata; u32 cnt = 0; - u32 start = 0, end = 0; + systime start = 0, end = 0; u8 timeout = 0; u8 sr = 0; @@ -1905,7 +2026,7 @@ void rtw_sec_write_cam(_adapter *adapter, u8 addr, u32 wdata) { _mutex *mutex = &adapter_to_dvobj(adapter)->cam_ctl.sec_cam_access_mutex; u32 cnt = 0; - u32 start = 0, end = 0; + systime start = 0, end = 0; u8 timeout = 0; u8 sr = 0; @@ -2324,10 +2445,12 @@ int rtw_mbid_cam_cache_dump(void *sel, const char *fun_name, _adapter *adapter) iface = dvobj->padapters[iface_id]; if (iface) { - if (check_fwstate(&iface->mlmepriv, WIFI_STATION_STATE) == _TRUE) + if (MLME_IS_STA(iface)) RTW_PRINT_SEL(sel, "ROLE:%s\n", "STA"); - else if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE) + else if (MLME_IS_AP(iface)) RTW_PRINT_SEL(sel, "ROLE:%s\n", "AP"); + else if (MLME_IS_MESH(iface)) + RTW_PRINT_SEL(sel, "ROLE:%s\n", "MESH"); else RTW_PRINT_SEL(sel, "ROLE:%s\n", "NONE"); } @@ -2412,7 +2535,7 @@ static void enable_mbssid_cam(_adapter *adapter) { u8 max_cam_id = rtw_get_max_mbid_cam_id(adapter); /*enable MBSSID*/ - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_ENMBID); + rtw_hal_rcr_add(adapter, RCR_ENMBID); if (max_cam_id != INVALID_CAM_ID) { rtw_write8(adapter, REG_MBID_NUM, ((rtw_read8(adapter, REG_MBID_NUM) & 0xF8) | (max_cam_id & 0x07))); @@ -2500,10 +2623,19 @@ void rtw_hal_change_macaddr_mbid(_adapter *adapter, u8 *mac_addr) write_mbssid_cam(adapter, entry_id, mac_addr); } +#ifdef CONFIG_SWTIMER_BASED_TXBCN +u16 rtw_hal_bcn_interval_adjust(_adapter *adapter, u16 bcn_interval) +{ + if (adapter_to_dvobj(adapter)->inter_bcn_space != bcn_interval) + return adapter_to_dvobj(adapter)->inter_bcn_space; + else + return bcn_interval; +} +#endif/*CONFIG_SWTIMER_BASED_TXBCN*/ #endif/*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ -void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) +static void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) { u8 idx = 0; u32 reg_macid = 0; @@ -2514,6 +2646,9 @@ void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(val)); +#ifdef RTW_HALMAC + rtw_halmac_set_mac_address(adapter_to_dvobj(adapter), adapter->hw_port, val); +#else /* !RTW_HALMAC */ switch (adapter->hw_port) { case HW_PORT0: default: @@ -2537,8 +2672,10 @@ void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val) for (idx = 0; idx < 6; idx++) rtw_write8(GET_PRIMARY_ADAPTER(adapter), (reg_macid + idx), val[idx]); +#endif /* !RTW_HALMAC */ } -void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) + +static void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) { u8 idx = 0; u32 reg_macid = 0; @@ -2547,6 +2684,9 @@ void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) return; _rtw_memset(mac_addr, 0, ETH_ALEN); +#ifdef RTW_HALMAC + rtw_halmac_get_mac_address(adapter_to_dvobj(adapter), adapter->hw_port, mac_addr); +#else /* !RTW_HALMAC */ switch (adapter->hw_port) { case HW_PORT0: default: @@ -2570,13 +2710,17 @@ void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr) for (idx = 0; idx < 6; idx++) mac_addr[idx] = rtw_read8(GET_PRIMARY_ADAPTER(adapter), (reg_macid + idx)); +#endif /* !RTW_HALMAC */ RTW_INFO("%s "ADPT_FMT"- hw port(%d) mac_addr ="MAC_FMT"\n", __func__, ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(mac_addr)); } -void rtw_hal_set_bssid(_adapter *adapter, u8 *val) +static void rtw_hal_set_bssid(_adapter *adapter, u8 *val) { +#ifdef RTW_HALMAC + rtw_halmac_set_bssid(adapter_to_dvobj(adapter), adapter->hw_port, val); +#else /* !RTW_HALMAC */ u8 idx = 0; u32 reg_bssid = 0; @@ -2603,12 +2747,180 @@ void rtw_hal_set_bssid(_adapter *adapter, u8 *val) for (idx = 0 ; idx < 6; idx++) rtw_write8(adapter, (reg_bssid + idx), val[idx]); +#endif /* !RTW_HALMAC */ RTW_INFO("%s "ADPT_FMT"- hw port -%d BSSID: "MAC_FMT"\n", __func__, ADPT_ARG(adapter), adapter->hw_port, MAC_ARG(val)); } -void rtw_hal_get_msr(_adapter *adapter, u8 *net_type) +static inline u8 hw_var_rcr_config(_adapter *adapter, u32 rcr) { + int err; + + err = rtw_write32(adapter, REG_RCR, rcr); + if (err == _SUCCESS) + GET_HAL_DATA(adapter)->ReceiveConfig = rcr; + return err; +} + +static inline u8 hw_var_rcr_get(_adapter *adapter, u32 *rcr) +{ + u32 v32; + + v32 = rtw_read32(adapter, REG_RCR); + if (rcr) + *rcr = v32; + GET_HAL_DATA(adapter)->ReceiveConfig = v32; + return _SUCCESS; +} + +/* only check SW RCR variable */ +inline u8 rtw_hal_rcr_check(_adapter *adapter, u32 check_bit) +{ + PHAL_DATA_TYPE hal; + u32 rcr; + + hal = GET_HAL_DATA(adapter); + + rcr = hal->ReceiveConfig; + if ((rcr & check_bit) == check_bit) + return 1; + + return 0; +} + +inline u8 rtw_hal_rcr_add(_adapter *adapter, u32 add) +{ + PHAL_DATA_TYPE hal; + u32 rcr; + u8 ret = _SUCCESS; + + hal = GET_HAL_DATA(adapter); + + rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); + rcr |= add; + if (rcr != hal->ReceiveConfig) + ret = rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); + + return ret; +} + +inline u8 rtw_hal_rcr_clear(_adapter *adapter, u32 clear) +{ + PHAL_DATA_TYPE hal; + u32 rcr; + u8 ret = _SUCCESS; + + hal = GET_HAL_DATA(adapter); + + rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); + rcr &= ~clear; + if (rcr != hal->ReceiveConfig) + ret = rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); + + return ret; +} + +void rtw_hal_rcr_set_chk_bssid(_adapter *adapter, u8 self_action) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + u32 rcr, rcr_new; + struct mi_state mstate, mstate_s; + + rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); + rcr_new = rcr; + +#ifdef CONFIG_MI_WITH_MBSSID_CAM + rcr_new &= ~(RCR_CBSSID_BCN | RCR_CBSSID_DATA); +#else + rtw_mi_status_no_self(adapter, &mstate); + rtw_mi_status_no_others(adapter, &mstate_s); + + /* only adjust parameters interested */ + switch (self_action) { + case MLME_SCAN_ENTER: + mstate_s.scan_num = 1; + mstate_s.scan_enter_num = 1; + break; + case MLME_SCAN_DONE: + mstate_s.scan_enter_num = 0; + break; +#ifdef CONFIG_TDLS + case MLME_TDLS_LINKED: + mstate_s.ld_tdls_num = 1; + break; + case MLME_TDLS_NOLINK: + mstate_s.ld_tdls_num = 0; + break; +#endif +#ifdef CONFIG_AP_MODE + case MLME_AP_STARTED: + mstate_s.ap_num = 1; + break; + case MLME_AP_STOPPED: + mstate_s.ap_num = 0; + mstate_s.ld_ap_num = 0; + break; +#endif +#ifdef CONFIG_RTW_MESH + case MLME_MESH_STARTED: + mstate_s.mesh_num = 1; + break; + case MLME_MESH_STOPPED: + mstate_s.mesh_num = 0; + mstate_s.ld_mesh_num = 0; + break; +#endif + case MLME_ACTION_NONE: + case MLME_STA_CONNECTING: + case MLME_ADHOC_STARTED: + /* caller without effect of decision */ + break; + default: + rtw_warn_on(1); + }; + + rtw_mi_status_merge(&mstate, &mstate_s); + + if (MSTATE_AP_NUM(&mstate) || MSTATE_MESH_NUM(&mstate) || MSTATE_TDLS_LD_NUM(&mstate) + #ifdef CONFIG_FIND_BEST_CHANNEL + || MSTATE_SCAN_ENTER_NUM(&mstate) + #endif + || hal_data->in_cta_test + ) + rcr_new &= ~RCR_CBSSID_DATA; + else + rcr_new |= RCR_CBSSID_DATA; + + if ((MSTATE_AP_NUM(&mstate) && adapter->registrypriv.wifi_spec) /* for 11n Logo 4.2.31/4.2.32 */ + || MSTATE_MESH_NUM(&mstate) + || MSTATE_SCAN_ENTER_NUM(&mstate) + || hal_data->in_cta_test + ) + rcr_new &= ~RCR_CBSSID_BCN; + else + rcr_new |= RCR_CBSSID_BCN; +#endif /* CONFIG_MI_WITH_MBSSID_CAM */ + + if (rcr != rcr_new) + rtw_hal_set_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr_new); +} + +static void hw_var_set_rcr_am(_adapter *adapter, u8 enable) +{ + u32 rcr = RCR_AM; + + if (enable) + rtw_hal_rcr_add(adapter, rcr); + else + rtw_hal_rcr_clear(adapter, rcr); +} + +static void rtw_hal_get_msr(_adapter *adapter, u8 *net_type) +{ +#ifdef RTW_HALMAC + rtw_halmac_get_network_type(adapter_to_dvobj(adapter), + adapter->hw_port, net_type); +#else /* !RTW_HALMAC */ switch (adapter->hw_port) { case HW_PORT0: /*REG_CR - BIT[17:16]-Network Type for port 1*/ @@ -2638,20 +2950,35 @@ void rtw_hal_get_msr(_adapter *adapter, u8 *net_type) rtw_warn_on(1); break; } +#endif /* !RTW_HALMAC */ } -void rtw_hal_set_msr(_adapter *adapter, u8 net_type) +#if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) /*For 2 hw ports - 88E/92E/8812/8821/8723B*/ +static u8 rtw_hal_net_type_decision(_adapter *adapter, u8 net_type) { + if ((adapter->hw_port == HW_PORT0) && (rtw_get_mbid_cam_entry_num(adapter))) { + if (net_type != _HW_STATE_NOLINK_) + return _HW_STATE_AP_; + } + return net_type; +} +#endif +static void rtw_hal_set_msr(_adapter *adapter, u8 net_type) +{ +#ifdef RTW_HALMAC + #if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) + net_type = rtw_hal_net_type_decision(adapter, net_type); + #endif + rtw_halmac_set_network_type(adapter_to_dvobj(adapter), + adapter->hw_port, net_type); +#else /* !RTW_HALMAC */ u8 val8 = 0; switch (adapter->hw_port) { case HW_PORT0: -#if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) /*For 2 hw ports - 88E/92E/8812/8821/8723B*/ - if (rtw_get_mbid_cam_entry_num(adapter)) { - if (net_type != _HW_STATE_NOLINK_) - net_type = _HW_STATE_AP_; - } -#endif + #if defined(CONFIG_MI_WITH_MBSSID_CAM) && defined(CONFIG_MBSSID_CAM) + net_type = rtw_hal_net_type_decision(adapter, net_type); + #endif /*REG_CR - BIT[17:16]-Network Type for port 0*/ val8 = rtw_read8(adapter, MSR) & 0x0C; val8 |= net_type; @@ -2689,29 +3016,19 @@ void rtw_hal_set_msr(_adapter *adapter, u8 net_type) rtw_warn_on(1); break; } +#endif /* !RTW_HALMAC */ } -void rtw_hal_port_reconfig(_adapter *adapter, u8 port) +static void hw_var_set_bcn_interval(struct _ADAPTER *a, u16 interval) { -#ifdef CONFIG_CONCURRENT_MODE - u8 hal_port_num = 0; - struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - - if (port > (hal_spec->port_num - 1)) { - RTW_INFO("[WARN] "ADPT_FMT"- hw_port : %d,will switch to invalid port-%d\n", - ADPT_ARG(adapter), adapter->hw_port, port); - rtw_warn_on(1); - } - - RTW_PRINT(ADPT_FMT"- hw_port : %d,will switch to port-%d\n", - ADPT_ARG(adapter), adapter->hw_port, port); - -#endif - +#ifdef RTW_HALMAC + rtw_halmac_set_bcn_interval(adapter_to_dvobj(a), a->hw_port, interval); +#else /* !RTW_HALMAC */ + RTW_ERR(FUNC_ADPT_FMT ": Not implemented yet!!\n", FUNC_ADPT_ARG(a)); + rtw_warn_on(1); +#endif /* !RTW_HALMAC */ } - void hw_var_port_switch(_adapter *adapter) { #ifdef CONFIG_CONCURRENT_MODE @@ -2928,9 +3245,191 @@ const char *const _h2c_msr_role_str[] = { "GO", "TDLS", "ADHOC", + "MESH", "INVALID", }; +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT +s32 rtw_hal_set_default_port_id_cmd(_adapter *adapter, u8 mac_id) +{ + s32 ret = _SUCCESS; + u8 parm[H2C_DEFAULT_PORT_ID_LEN] = {0}; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + SET_H2CCMD_DFTPID_PORT_ID(parm, adapter->hw_port); + SET_H2CCMD_DFTPID_MAC_ID(parm, mac_id); + + RTW_DBG_DUMP("DFT port id parm:", parm, H2C_DEFAULT_PORT_ID_LEN); + RTW_INFO("%s port_id :%d, mad_id:%d\n", __func__, adapter->hw_port, mac_id); + + ret = rtw_hal_fill_h2c_cmd(adapter, H2C_DEFAULT_PORT_ID, H2C_DEFAULT_PORT_ID_LEN, parm); + dvobj->default_port_id = adapter->hw_port; + + return ret; +} +s32 rtw_set_default_port_id(_adapter *adapter) +{ + s32 ret = _SUCCESS; + struct sta_info *psta; + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + if (adapter->hw_port == dvobj->default_port_id) + return ret; + + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) { + psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); + if (psta) + ret = rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); + } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { + + } else { + } + + return ret; +} +s32 rtw_set_ps_rsvd_page(_adapter *adapter) +{ + s32 ret = _SUCCESS; + u16 media_status_rpt = RT_MEDIA_CONNECT; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + if (adapter->hw_port == dvobj->default_port_id) + return ret; + + rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, + (u8 *)&media_status_rpt); + + return ret; +} + +#endif + +#ifdef CONFIG_P2P_PS +#ifdef RTW_HALMAC +void rtw_set_p2p_ps_offload_cmd(_adapter *adapter, u8 p2p_ps_state) +{ + PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); + struct wifidirect_info *pwdinfo = &adapter->wdinfo; + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + WLAN_BSSID_EX *cur_network = &(pmlmeinfo->network); + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta; + HAL_P2P_PS_PARA p2p_ps_para; + int status = -1; + u8 i; + + _rtw_memset(&p2p_ps_para, 0, sizeof(HAL_P2P_PS_PARA)); + _rtw_memcpy((&p2p_ps_para) , &hal->p2p_ps_offload , sizeof(hal->p2p_ps_offload)); + + (&p2p_ps_para)->p2p_port_id = adapter->hw_port; + (&p2p_ps_para)->p2p_group = 0; + psta = rtw_get_stainfo(pstapriv, cur_network->MacAddress); + if (psta) { + (&p2p_ps_para)->p2p_macid = psta->cmn.mac_id; + } else { + if (p2p_ps_state != P2P_PS_DISABLE) { + RTW_ERR("%s , psta was NULL\n", __func__); + return; + } + } + + + switch (p2p_ps_state) { + case P2P_PS_DISABLE: + RTW_INFO("P2P_PS_DISABLE\n"); + _rtw_memset(&p2p_ps_para , 0, sizeof(HAL_P2P_PS_PARA)); + break; + + case P2P_PS_ENABLE: + RTW_INFO("P2P_PS_ENABLE\n"); + /* update CTWindow value. */ + if (pwdinfo->ctwindow > 0) { + (&p2p_ps_para)->ctwindow_en = 1; + (&p2p_ps_para)->ctwindow_length = pwdinfo->ctwindow; + /*RTW_INFO("%s , ctwindow_length = %d\n" , __func__ , (&p2p_ps_para)->ctwindow_length);*/ + } + + + if ((pwdinfo->opp_ps == 1) || (pwdinfo->noa_num > 0)) { + (&p2p_ps_para)->offload_en = 1; + if (pwdinfo->role == P2P_ROLE_GO) { + (&p2p_ps_para)->role = 1; + (&p2p_ps_para)->all_sta_sleep = 0; + } else + (&p2p_ps_para)->role = 0; + + (&p2p_ps_para)->discovery = 0; + } + /* hw only support 2 set of NoA */ + for (i = 0; i < pwdinfo->noa_num; i++) { + /* To control the register setting for which NOA */ + (&p2p_ps_para)->noa_sel = i; + (&p2p_ps_para)->noa_en = 1; + /* config P2P NoA Descriptor Register */ + /* config NOA duration */ + (&p2p_ps_para)->noa_duration_para = pwdinfo->noa_duration[i]; + /* config NOA interval */ + (&p2p_ps_para)->noa_interval_para = pwdinfo->noa_interval[i]; + /* config NOA start time */ + (&p2p_ps_para)->noa_start_time_para = pwdinfo->noa_start_time[i]; + /* config NOA count */ + (&p2p_ps_para)->noa_count_para = pwdinfo->noa_count[i]; + /*RTW_INFO("%s , noa_duration_para = %d , noa_interval_para = %d , noa_start_time_para = %d , noa_count_para = %d\n" , __func__ , + (&p2p_ps_para)->noa_duration_para , (&p2p_ps_para)->noa_interval_para , + (&p2p_ps_para)->noa_start_time_para , (&p2p_ps_para)->noa_count_para);*/ + status = rtw_halmac_p2pps(adapter_to_dvobj(adapter) , (&p2p_ps_para)); + if (status == -1) + RTW_ERR("%s , rtw_halmac_p2pps fail\n", __func__); + } + + break; + + case P2P_PS_SCAN: + /*This feature FW not ready 20161116 YiWei*/ + return; + RTW_INFO("P2P_PS_SCAN\n"); + (&p2p_ps_para)->discovery = 1; + /* + (&p2p_ps_para)->ctwindow_length = pwdinfo->ctwindow; + (&p2p_ps_para)->noa_duration_para = pwdinfo->noa_duration[0]; + (&p2p_ps_para)->noa_interval_para = pwdinfo->noa_interval[0]; + (&p2p_ps_para)->noa_start_time_para = pwdinfo->noa_start_time[0]; + (&p2p_ps_para)->noa_count_para = pwdinfo->noa_count[0]; + */ + break; + + case P2P_PS_SCAN_DONE: + /*This feature FW not ready 20161116 YiWei*/ + return; + RTW_INFO("P2P_PS_SCAN_DONE\n"); + (&p2p_ps_para)->discovery = 0; + /* + pwdinfo->p2p_ps_state = P2P_PS_ENABLE; + (&p2p_ps_para)->ctwindow_length = pwdinfo->ctwindow; + (&p2p_ps_para)->noa_duration_para = pwdinfo->noa_duration[0]; + (&p2p_ps_para)->noa_interval_para = pwdinfo->noa_interval[0]; + (&p2p_ps_para)->noa_start_time_para = pwdinfo->noa_start_time[0]; + (&p2p_ps_para)->noa_count_para = pwdinfo->noa_count[0]; + */ + break; + + default: + break; + } + + if (p2p_ps_state != P2P_PS_ENABLE || (&p2p_ps_para)->noa_en == 0) { + status = rtw_halmac_p2pps(adapter_to_dvobj(adapter) , (&p2p_ps_para)); + if (status == -1) + RTW_ERR("%s , rtw_halmac_p2pps fail\n", __func__); + } + _rtw_memcpy(&hal->p2p_ps_offload , (&p2p_ps_para) , sizeof(hal->p2p_ps_offload)); + +} +#endif /* RTW_HALMAC */ +#endif /* CONFIG_P2P */ + /* * rtw_hal_set_FwMediaStatusRpt_cmd - * @@ -2957,30 +3456,15 @@ s32 rtw_hal_set_FwMediaStatusRpt_cmd(_adapter *adapter, bool opmode, bool miraca SET_H2CCMD_MSRRPT_PARM_ROLE(parm, role); SET_H2CCMD_MSRRPT_PARM_MACID(parm, macid); SET_H2CCMD_MSRRPT_PARM_MACID_END(parm, macid_end); - - RTW_DBG_DUMP("MediaStatusRpt parm:", parm, H2C_MEDIA_STATUS_RPT_LEN); - -#ifdef CONFIG_DFS_MASTER - /* workaround for TXPAUSE cleared issue by FW's MediaStatusRpt handling */ - if (macid_ind == 0 && macid == 1) { - u8 parm0_bak = parm[0]; - - SET_H2CCMD_MSRRPT_PARM_MACID_IND(&parm0_bak, 0); - if (macid_ctl->h2c_msr[macid] == parm0_bak) { - ret = _SUCCESS; - goto post_action; - } - } +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + SET_H2CCMD_MSRRPT_PARM_PORT_NUM(parm, adapter->hw_port); #endif + RTW_DBG_DUMP("MediaStatusRpt parm:", parm, H2C_MEDIA_STATUS_RPT_LEN); ret = rtw_hal_fill_h2c_cmd(adapter, H2C_MEDIA_STATUS_RPT, H2C_MEDIA_STATUS_RPT_LEN, parm); if (ret != _SUCCESS) goto exit; -#ifdef CONFIG_DFS_MASTER -post_action: -#endif - #if defined(CONFIG_RTL8188E) if (rtw_get_chip_type(adapter) == RTL8188E) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); @@ -3045,7 +3529,7 @@ inline s32 rtw_hal_set_FwMediaStatusRpt_range_cmd(_adapter *adapter, bool opmode void rtw_hal_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) { - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; u8 u1H2CRsvdPageParm[H2C_RSVDPAGE_LOC_LEN] = {0}; u8 ret = 0; @@ -3072,7 +3556,7 @@ void rtw_hal_switch_gpio_wl_ctrl(_adapter *padapter, u8 index, u8 enable) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - if (IS_8723D_SERIES(pHalData->VersionID)) + if (IS_8723D_SERIES(pHalData->version_id) || IS_8822B_SERIES(pHalData->version_id)) rtw_hal_set_hwreg(padapter, HW_SET_GPIO_WL_CTRL, (u8 *)(&enable)); /* * Switch GPIO_13, GPIO_14 to wlan control, or pull GPIO_13,14 MUST fail. @@ -3081,7 +3565,12 @@ void rtw_hal_switch_gpio_wl_ctrl(_adapter *padapter, u8 index, u8 enable) * TODO: GPIO_8 multi function? */ - if (index == 13 || index == 14) + if ((index == 13 || index == 14) + #if defined(CONFIG_RTL8821A) && defined(CONFIG_SDIO_HCI) + /* 8821A's LED2 circuit(used by HW_LED strategy) needs enable WL GPIO control of GPIO[14:13], can't disable */ + && (!IS_HW_LED_STRATEGY(rtw_led_get_strategy(padapter)) || enable) + #endif + ) rtw_hal_set_hwreg(padapter, HW_SET_GPIO_WL_CTRL, (u8 *)(&enable)); } @@ -3137,30 +3626,70 @@ void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval) __FUNCTION__, index, outputval); } } +void rtw_hal_set_input_gpio(_adapter *padapter, u8 index) +{ + if (index <= 7) { + /* config GPIO mode */ + rtw_write8(padapter, REG_GPIO_PIN_CTRL + 3, + rtw_read8(padapter, REG_GPIO_PIN_CTRL + 3) & ~BIT(index)); + + /* config GPIO Sel */ + /* 0: input */ + /* 1: output */ + rtw_write8(padapter, REG_GPIO_PIN_CTRL + 2, + rtw_read8(padapter, REG_GPIO_PIN_CTRL + 2) & ~BIT(index)); + + } else if (index <= 15) { + /* 88C Series: */ + /* index: 11~8 transform to 3~0 */ + /* 8723 Series: */ + /* index: 12~8 transform to 4~0 */ + + index -= 8; + + /* config GPIO mode */ + rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 3, + rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 3) & ~BIT(index)); + + /* config GPIO Sel */ + /* 0: input */ + /* 1: output */ + rtw_write8(padapter, REG_GPIO_PIN_CTRL_2 + 2, + rtw_read8(padapter, REG_GPIO_PIN_CTRL_2 + 2) & ~BIT(index)); + } else + RTW_INFO("%s: invalid GPIO%d\n", __func__, index); + +} + #endif void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) { - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; u8 res = 0, count = 0, ret = 0; #ifdef CONFIG_WOWLAN u8 u1H2CAoacRsvdPageParm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; - RTW_INFO("AOACRsvdPageLoc: RWC=%d ArpRsp=%d NbrAdv=%d GtkRsp=%d GtkInfo=%d ProbeReq=%d NetworkList=%d\n", - rsvdpageloc->LocRemoteCtrlInfo, rsvdpageloc->LocArpRsp, - rsvdpageloc->LocNbrAdv, rsvdpageloc->LocGTKRsp, - rsvdpageloc->LocGTKInfo, rsvdpageloc->LocProbeReq, - rsvdpageloc->LocNetList); + RTW_INFO("%s: RWC: %d ArpRsp: %d NbrAdv: %d LocNDPInfo: %d\n", + __func__, rsvdpageloc->LocRemoteCtrlInfo, + rsvdpageloc->LocArpRsp, rsvdpageloc->LocNbrAdv, + rsvdpageloc->LocNDPInfo); + RTW_INFO("%s:GtkRsp: %d GtkInfo: %d ProbeReq: %d NetworkList: %d\n", + __func__, rsvdpageloc->LocGTKRsp, rsvdpageloc->LocGTKInfo, + rsvdpageloc->LocProbeReq, rsvdpageloc->LocNetList); if (check_fwstate(pmlmepriv, _FW_LINKED)) { SET_H2CCMD_AOAC_RSVDPAGE_LOC_REMOTE_WAKE_CTRL_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocRemoteCtrlInfo); SET_H2CCMD_AOAC_RSVDPAGE_LOC_ARP_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocArpRsp); - /* SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, rsvdpageloc->LocNbrAdv); */ + SET_H2CCMD_AOAC_RSVDPAGE_LOC_NEIGHBOR_ADV(u1H2CAoacRsvdPageParm, + rsvdpageloc->LocNbrAdv); + SET_H2CCMD_AOAC_RSVDPAGE_LOC_NDP_INFO(u1H2CAoacRsvdPageParm, + rsvdpageloc->LocNDPInfo); +#ifdef CONFIG_GTK_OL SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_RSP(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKRsp); SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_INFO(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKInfo); -#ifdef CONFIG_GTK_OL SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(u1H2CAoacRsvdPageParm, rsvdpageloc->LocGTKEXTMEM); #endif /* CONFIG_GTK_OL */ ret = rtw_hal_fill_h2c_cmd(padapter, @@ -3168,13 +3697,14 @@ void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc H2C_AOAC_RSVDPAGE_LOC_LEN, u1H2CAoacRsvdPageParm); + RTW_INFO("AOAC Report=%d\n", rsvdpageloc->LocAOACReport); _rtw_memset(&u1H2CAoacRsvdPageParm, 0, sizeof(u1H2CAoacRsvdPageParm)); SET_H2CCMD_AOAC_RSVDPAGE_LOC_AOAC_REPORT(u1H2CAoacRsvdPageParm, - rsvdpageloc->LocAOACReport); + rsvdpageloc->LocAOACReport); ret = rtw_hal_fill_h2c_cmd(padapter, - H2C_AOAC_RSVDPAGE3, - H2C_AOAC_RSVDPAGE_LOC_LEN, - u1H2CAoacRsvdPageParm); + H2C_AOAC_RSVDPAGE3, + H2C_AOAC_RSVDPAGE_LOC_LEN, + u1H2CAoacRsvdPageParm); pwrpriv->wowlan_aoac_rpt_loc = rsvdpageloc->LocAOACReport; } #ifdef CONFIG_PNO_SUPPORT @@ -3196,6 +3726,125 @@ void rtw_hal_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc #endif /* CONFIG_WOWLAN */ } +/*#define DBG_GET_RSVD_PAGE*/ +int rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, + u32 page_num, u8 *buffer, u32 buffer_size) +{ + u32 addr = 0, size = 0, count = 0; + u32 page_size = 0, data_low = 0, data_high = 0; + u16 txbndy = 0, offset = 0; + u8 i = 0; + bool rst = _FALSE; + + rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); + + addr = page_offset * page_size; + size = page_num * page_size; + + if (buffer_size < size) { + RTW_ERR("%s buffer_size(%d) < get page total size(%d)\n", + __func__, buffer_size, size); + return rst; + } +#ifdef RTW_HALMAC + if (rtw_halmac_dump_fifo(adapter_to_dvobj(adapter), 2, addr, size, buffer) < 0) + rst = _FALSE; + else + rst = _TRUE; +#else + txbndy = rtw_read8(adapter, REG_TDECTRL + 1); + + offset = (txbndy + page_offset) * page_size / 8; + count = (buffer_size / 8) + 1; + + rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x69); + + for (i = 0 ; i < count ; i++) { + rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, offset + i); + data_low = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); + data_high = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); + _rtw_memcpy(buffer + (i * 8), + &data_low, sizeof(data_low)); + _rtw_memcpy(buffer + ((i * 8) + 4), + &data_high, sizeof(data_high)); + } + rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x0); + rst = _TRUE; +#endif /*RTW_HALMAC*/ + +#ifdef DBG_GET_RSVD_PAGE + RTW_INFO("%s [page_offset:%d , page_num:%d][start_addr:0x%04x , size:%d]\n", + __func__, page_offset, page_num, addr, size); + RTW_INFO_DUMP("\n", buffer, size); + RTW_INFO(" ==================================================\n"); +#endif + return rst; +} + +void rtw_dump_rsvd_page(void *sel, _adapter *adapter, u8 page_offset, u8 page_num) +{ + u32 page_size = 0; + u8 *buffer = NULL; + u32 buf_size = 0; + + if (page_num == 0) + return; + + RTW_PRINT_SEL(sel, "======= RSVD PAGE DUMP =======\n"); + RTW_PRINT_SEL(sel, "page_offset:%d, page_num:%d\n", page_offset, page_num); + + rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); + if (page_size) { + buf_size = page_size * page_num; + buffer = rtw_zvmalloc(buf_size); + + if (buffer) { + rtw_hal_get_rsvd_page(adapter, page_offset, page_num, buffer, buf_size); + RTW_DUMP_SEL(sel, buffer, buf_size); + rtw_vmfree(buffer, buf_size); + } else + RTW_PRINT_SEL(sel, "ERROR - rsvd_buf mem allocate failed\n"); + } else + RTW_PRINT_SEL(sel, "ERROR - Tx page size is zero ??\n"); + + RTW_PRINT_SEL(sel, "==========================\n"); +} + +#ifdef CONFIG_SUPPORT_FIFO_DUMP +void rtw_dump_fifo(void *sel, _adapter *adapter, u8 fifo_sel, u32 fifo_addr, u32 fifo_size) +{ + u8 *buffer = NULL; + u8 buff_size = 0; + static const char * const fifo_sel_str[] = { + "TX", "RX", "RSVD_PAGE", "REPORT", "LLT", "RXBUF_FW" + }; + + if (fifo_sel > 5) { + RTW_ERR("fifo_sel:%d invalid\n", fifo_sel); + return; + } + + RTW_PRINT_SEL(sel, "========= FIFO DUMP =========\n"); + RTW_PRINT_SEL(sel, "%s FIFO DUMP [start_addr:0x%04x , size:%d]\n", fifo_sel_str[fifo_sel], fifo_addr, fifo_size); + + if (fifo_size) { + buff_size = RND4(fifo_size); + buffer = rtw_zvmalloc(buff_size); + if (buffer == NULL) + buff_size = 0; + } + + rtw_halmac_dump_fifo(adapter_to_dvobj(adapter), fifo_sel, fifo_addr, buff_size, buffer); + + if (buffer) { + RTW_DUMP_SEL(sel, buffer, fifo_size); + rtw_vmfree(buffer, buff_size); + } + + RTW_PRINT_SEL(sel, "==========================\n"); +} +#endif + #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) static void rtw_hal_force_enable_rxdma(_adapter *adapter) { @@ -3206,7 +3855,7 @@ static void rtw_hal_force_enable_rxdma(_adapter *adapter) rtw_write32(adapter, REG_RXPKT_NUM, (rtw_read32(adapter, REG_RXPKT_NUM) & (~RW_RELEASE_EN))); } - +#if defined(CONFIG_RTL8188E) static void rtw_hal_disable_tx_report(_adapter *adapter) { rtw_write8(adapter, REG_TX_RPT_CTRL, @@ -3220,7 +3869,7 @@ static void rtw_hal_enable_tx_report(_adapter *adapter) ((rtw_read8(adapter, REG_TX_RPT_CTRL) | BIT(1))) | BIT(5)); RTW_INFO("enable TX_RPT:0x%02x\n", rtw_read8(adapter, REG_TX_RPT_CTRL)); } - +#endif static void rtw_hal_release_rx_dma(_adapter *adapter) { u32 val32 = 0; @@ -3238,7 +3887,6 @@ static u8 rtw_hal_pause_rx_dma(_adapter *adapter) PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); u8 ret = 0; s8 trycnt = 100; - u16 len = 0; u32 tmp = 0; int res = 0; /* RX DMA stop */ @@ -3262,17 +3910,7 @@ static u8 rtw_hal_pause_rx_dma(_adapter *adapter) } #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) else { - /* If RX_DMA is not idle, receive one pkt from DMA */ - res = sdio_local_read(adapter, - SDIO_REG_RX0_REQ_LEN, 4, (u8 *)&tmp); - len = le16_to_cpu(tmp); - RTW_PRINT("RX len:%d\n", len); - - if (len > 0) - res = RecvOnePkt(adapter, len); - else - RTW_PRINT("read length fail %d\n", len); - + res = RecvOnePkt(adapter); RTW_PRINT("RecvOnePkt Result: %d\n", res); } #endif /* CONFIG_SDIO_HCI || CONFIG_GSPI_HCI */ @@ -3287,12 +3925,12 @@ static u8 rtw_hal_pause_rx_dma(_adapter *adapter) } while (trycnt--); if (trycnt < 0) { - tmp = rtw_read16(adapter, REG_RXPKT_NUM + 3); + tmp = rtw_read16(adapter, REG_RXPKT_NUM + 2); RTW_PRINT("Stop RX DMA failed......\n"); - RTW_PRINT("%s, RXPKT_NUM: 0x%04x\n", - __func__, tmp); - tmp = rtw_read16(adapter, REG_RXPKT_NUM + 2); + RTW_PRINT("%s, RXPKT_NUM: 0x%02x\n", + __func__, ((tmp & 0xFF00) >> 8)); + if (tmp & BIT(3)) RTW_PRINT("%s, RX DMA has req\n", __func__); @@ -3306,6 +3944,7 @@ static u8 rtw_hal_pause_rx_dma(_adapter *adapter) } #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) +#ifndef RTW_HALMAC static u8 rtw_hal_enable_cpwm2(_adapter *adapter) { u8 ret = 0; @@ -3334,55 +3973,99 @@ static u8 rtw_hal_enable_cpwm2(_adapter *adapter) RTW_INFO("sdio_local_write fail\n"); ret = _FAIL; } - return ret; #endif /* CONFIG_CPIO_WAKEUP */ } +#endif #endif /* CONFIG_SDIO_HCI, CONFIG_GSPI_HCI */ #endif /* CONFIG_WOWLAN || CONFIG_AP_WOWLAN */ #ifdef CONFIG_WOWLAN /* * rtw_hal_check_wow_ctrl - * chk_type: _TRUE means to check enable, if 0x690 & bit1, WOW enable successful - * _FALSE means to check disable, if 0x690 & bit1, WOW disable fail + * chk_type: _TRUE means to check enable, if 0x690 & bit1 (for 8051), WOW enable successful. + * If 0x1C7 == 0 (for 3081), WOW enable successful. + * _FALSE means to check disable, if 0x690 & bit1 (for 8051), WOW disable fail. + * If 0x120 & bit16 || 0x284 & bit18 (for 3081), WOW disable fail. */ static u8 rtw_hal_check_wow_ctrl(_adapter *adapter, u8 chk_type) { + u32 fe1_imr = 0xFF, rxpkt_num = 0xFF; u8 mstatus = 0; + u8 reason = 0xFF; u8 trycnt = 25; u8 res = _FALSE; - mstatus = rtw_read8(adapter, REG_WOW_CTRL); - RTW_INFO("%s mstatus:0x%02x\n", __func__, mstatus); + if (IS_HARDWARE_TYPE_JAGUAR2(adapter)) { + if (chk_type) { + reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); + RTW_DBG("%s reason:0x%02x\n", __func__, reason); - if (chk_type) { - while (!(mstatus & BIT1) && trycnt > 1) { - mstatus = rtw_read8(adapter, REG_WOW_CTRL); - RTW_PRINT("Loop index: %d :0x%02x\n", - trycnt, mstatus); - trycnt--; - rtw_msleep_os(20); + while (reason && trycnt > 1) { + reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); + RTW_DBG("Loop index: %d :0x%02x\n", + trycnt, reason); + trycnt--; + rtw_msleep_os(20); + } + if (!reason) + res = _TRUE; + else + res = _FALSE; + } else { + /* Wait FW to cleare 0x120 bit16, 0x284 bit18 to 0 */ + fe1_imr = rtw_read32(adapter, REG_FE1IMR); /* RxDone IMR for 3081 */ + rxpkt_num = rtw_read32(adapter, REG_RXPKT_NUM); /* Release RXDMA */ + RTW_DBG("%s REG_FE1IMR (reg120): 0x%x, REG_RXPKT_NUM(reg284): 0x%x\n", __func__, fe1_imr, rxpkt_num); + + while (((fe1_imr & BIT_FS_RXDONE_INT_EN) || (rxpkt_num & BIT_RW_RELEASE_EN)) && trycnt > 1) { + rtw_msleep_os(20); + fe1_imr = rtw_read32(adapter, REG_FE1IMR); + rxpkt_num = rtw_read32(adapter, REG_RXPKT_NUM); + RTW_PRINT("Loop index: %d :0x%x, 0x%x\n", + trycnt, fe1_imr, rxpkt_num); + trycnt--; + } + + if ((fe1_imr & BIT_FS_RXDONE_INT_EN) || (rxpkt_num & BIT_RW_RELEASE_EN)) + res = _FALSE; + else + res = _TRUE; } - if (mstatus & BIT1) - res = _TRUE; - else - res = _FALSE; } else { - while (mstatus & BIT1 && trycnt > 1) { - mstatus = rtw_read8(adapter, REG_WOW_CTRL); - RTW_PRINT("Loop index: %d :0x%02x\n", - trycnt, mstatus); - trycnt--; - rtw_msleep_os(20); - } + mstatus = rtw_read8(adapter, REG_WOW_CTRL); + RTW_DBG("%s mstatus:0x%02x\n", __func__, mstatus); - if (mstatus & BIT1) - res = _FALSE; - else - res = _TRUE; + + if (chk_type) { + while (!(mstatus & BIT1) && trycnt > 1) { + mstatus = rtw_read8(adapter, REG_WOW_CTRL); + RTW_DBG("Loop index: %d :0x%02x\n", + trycnt, mstatus); + trycnt--; + rtw_msleep_os(20); + } + if (mstatus & BIT1) + res = _TRUE; + else + res = _FALSE; + } else { + while (mstatus & BIT1 && trycnt > 1) { + mstatus = rtw_read8(adapter, REG_WOW_CTRL); + RTW_DBG("Loop index: %d :0x%02x\n", + trycnt, mstatus); + trycnt--; + rtw_msleep_os(20); + } + + if (mstatus & BIT1) + res = _FALSE; + else + res = _TRUE; + } } - RTW_PRINT("%s check_type: %d res: %d trycnt: %d\n", + + RTW_INFO("%s check_type: %d res: %d trycnt: %d\n", __func__, chk_type, res, (25 - trycnt)); return res; } @@ -3397,7 +4080,7 @@ static u8 rtw_hal_check_pno_enabled(_adapter *adapter) if (ppwrpriv->wowlan_pno_enable && ppwrpriv->wowlan_in_resume == _FALSE) { res = rtw_read8(adapter, REG_PNO_STATUS); while (!(res & BIT(7)) && count < 25) { - RTW_INFO("[%d] cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", + RTW_DBG("[%d] cmd: 0x81 REG_PNO_STATUS: 0x%02x\n", count, res); res = rtw_read8(adapter, REG_PNO_STATUS); count++; @@ -3430,13 +4113,13 @@ static void rtw_hal_fw_sync_cam_id(_adapter *adapter) int cam_id, index = 0; u8 *addr = NULL; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (!MLME_IS_STA(adapter)) return; addr = get_bssid(pmlmepriv); if (addr == NULL) { - RTW_INFO("%s: get bssid MAC addr fail!!\n", __func__); + RTW_ERR("%s: get bssid MAC addr fail!!\n", __func__); return; } @@ -3455,6 +4138,7 @@ static void rtw_hal_fw_sync_cam_id(_adapter *adapter) rtw_write8(adapter, REG_SECCFG, 0xcc); } + static void rtw_hal_update_gtk_offload_info(_adapter *adapter) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); @@ -3465,10 +4149,10 @@ static void rtw_hal_update_gtk_offload_info(_adapter *adapter) struct cam_ctl_t *cam_ctl = &dvobj->cam_ctl; _irqL irqL; u8 get_key[16]; - u8 gtk_keyindex = 0, offset = 0; + u8 gtk_id = 0, offset = 0, i = 0, sz = 0; u64 replay_count = 0; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (!MLME_IS_STA(adapter)) return; _rtw_memset(get_key, 0, sizeof(get_key)); @@ -3476,54 +4160,60 @@ static void rtw_hal_update_gtk_offload_info(_adapter *adapter) paoac_rpt->replay_counter_eapol_key, 8); /*read gtk key index*/ - gtk_keyindex = paoac_rpt->key_index; + gtk_id = paoac_rpt->key_index; - if (gtk_keyindex == 5 || gtk_keyindex == 0) { + if (gtk_id == 5 || gtk_id == 0) { RTW_INFO("%s no rekey event happened.\n", __func__); - } else if (gtk_keyindex > 0 && gtk_keyindex < 4) { - + } else if (gtk_id > 0 && gtk_id < 4) { RTW_INFO("%s update security key.\n", __func__); - /*read key from sec-cam,for DK ,keyindex is equal to cam-id*/ - rtw_sec_read_cam_ent(adapter, gtk_keyindex, NULL, NULL, get_key); - + rtw_sec_read_cam_ent(adapter, gtk_id, + NULL, NULL, get_key); rtw_clean_hw_dk_cam(adapter); - if (_rtw_camid_is_gk(adapter, gtk_keyindex)) { + + if (_rtw_camid_is_gk(adapter, gtk_id)) { _enter_critical_bh(&cam_ctl->lock, &irqL); - _rtw_memcpy(&dvobj->cam_cache[gtk_keyindex].key, get_key, 16); + _rtw_memcpy(&dvobj->cam_cache[gtk_id].key, + get_key, 16); _exit_critical_bh(&cam_ctl->lock, &irqL); } else { struct setkey_parm parm_gtk; - parm_gtk.algorithm = psecuritypriv->dot118021XGrpPrivacy; - parm_gtk.keyid = gtk_keyindex; + parm_gtk.algorithm = paoac_rpt->security_type; + parm_gtk.keyid = gtk_id; _rtw_memcpy(parm_gtk.key, get_key, 16); setkey_hdl(adapter, (u8 *)&parm_gtk); } /*update key into related sw variable and sec-cam cache*/ - psecuritypriv->dot118021XGrpKeyid = gtk_keyindex; - _rtw_memcpy(&psecuritypriv->dot118021XGrpKey[gtk_keyindex], + psecuritypriv->dot118021XGrpKeyid = gtk_id; + _rtw_memcpy(&psecuritypriv->dot118021XGrpKey[gtk_id], get_key, 16); /* update SW TKIP TX/RX MIC value */ if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) { offset = RTW_KEK_LEN + RTW_TKIP_MIC_LEN; _rtw_memcpy( - &psecuritypriv->dot118021XGrptxmickey[gtk_keyindex], + &psecuritypriv->dot118021XGrptxmickey[gtk_id], &(paoac_rpt->group_key[offset]), RTW_TKIP_MIC_LEN); offset = RTW_KEK_LEN; _rtw_memcpy( - &psecuritypriv->dot118021XGrprxmickey[gtk_keyindex], + &psecuritypriv->dot118021XGrprxmickey[gtk_id], &(paoac_rpt->group_key[offset]), RTW_TKIP_MIC_LEN); } + /* Update broadcast RX IV */ + if (psecuritypriv->dot118021XGrpPrivacy == _AES_) { + sz = sizeof(psecuritypriv->iv_seq[0]); + for (i = 0 ; i < 4 ; i++) + _rtw_memset(psecuritypriv->iv_seq[i], 0, sz); + } - RTW_PRINT("GTK (%d) "KEY_FMT"\n", gtk_keyindex, - KEY_ARG(psecuritypriv->dot118021XGrpKey[gtk_keyindex].skey)); + RTW_INFO("GTK (%d) "KEY_FMT"\n", gtk_id, + KEY_ARG(psecuritypriv->dot118021XGrpKey[gtk_id].skey)); } - + rtw_clean_dk_section(adapter); rtw_write8(adapter, REG_SECCFG, 0x0c); @@ -3534,58 +4224,19 @@ static void rtw_hal_update_gtk_offload_info(_adapter *adapter) dump_sec_cam_cache(RTW_DBGDUMP, adapter); #endif } -#endif +#endif /*CONFIG_GTK_OL*/ static void rtw_dump_aoac_rpt(_adapter *adapter) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); struct aoac_report *paoac_rpt = &pwrctl->wowlan_aoac_rpt; - + RTW_INFO_DUMP("[AOAC-RPT] IV -", paoac_rpt->iv, 8); RTW_INFO_DUMP("[AOAC-RPT] Replay counter of EAPOL key - ", paoac_rpt->replay_counter_eapol_key, 8); RTW_INFO_DUMP("[AOAC-RPT] Group key - ", paoac_rpt->group_key, 32); RTW_INFO("[AOAC-RPT] Key Index - %d\n", paoac_rpt->key_index); - RTW_INFO("[AOAC-RPT] Security Type - %d\n", paoac_rpt->scurity_type); -} - -static bool rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, - u32 page_num, u8 *buffer, u32 buffer_size) -{ - u32 addr = 0, size = 0, page_size = 0, data_low = 0, data_high = 0; - u16 txbndy = 0, offset = 0; - u8 i = 0, count = 0; - bool rst = _FALSE; - - rtw_hal_get_def_var(adapter, HAL_DEF_TX_PAGE_SIZE, &page_size); - - addr = page_offset * page_size; - size = page_num * page_size; - - if (buffer_size < size) { - RTW_ERR("%s buffer_size(%d) < get page total size(%d)\n", - __func__, buffer_size, size); - return rst; - } - - txbndy = rtw_read8(adapter, REG_TDECTRL + 1); - - offset = (txbndy + page_offset) << 4; - count = (sizeof(struct aoac_report) / 8) + 1; - - rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x69); - - for (i = 0 ; i < count ; i++) { - rtw_write32(adapter, REG_PKTBUF_DBG_CTRL, offset + i); - data_low = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); - data_high = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); - _rtw_memcpy(buffer + (i * 8), - &data_low, sizeof(data_low)); - _rtw_memcpy(buffer + ((i * 8) + 4), - &data_high, sizeof(data_high)); - } - rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, 0x0); - return _TRUE; + RTW_INFO("[AOAC-RPT] Security Type - %d\n", paoac_rpt->security_type); } static void rtw_hal_get_aoac_rpt(_adapter *adapter) @@ -3607,17 +4258,17 @@ static void rtw_hal_get_aoac_rpt(_adapter *adapter) buffer = rtw_zvmalloc(buf_size); - if (NULL == buffer) { + if (buffer == NULL) { RTW_ERR("%s buffer allocate failed size(%d)\n", __func__, buf_size); return; } RTW_INFO("Get AOAC Report from rsvd page_offset:%d\n", page_offset); - + ret = rtw_hal_get_rsvd_page(adapter, page_offset, page_number, buffer, buf_size); - + if (ret == _FALSE) { RTW_ERR("%s get aoac report failed\n", __func__); rtw_warn_on(1); @@ -3633,13 +4284,12 @@ static void rtw_hal_get_aoac_rpt(_adapter *adapter) paoac_rpt->replay_counter_eapol_key[7 - i]; paoac_rpt->replay_counter_eapol_key[7 - i] = tmp; } - - /* rtw_dump_aoac_rpt(adapter); */ - + + rtw_dump_aoac_rpt(adapter); + _exit: if (buffer) rtw_vmfree(buffer, buf_size); - } static void rtw_hal_update_tx_iv(_adapter *adapter) @@ -3650,34 +4300,34 @@ static void rtw_hal_update_tx_iv(_adapter *adapter) struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); struct security_priv *psecpriv = &adapter->securitypriv; - + u16 val16 = 0; u32 val32 = 0; u64 txiv = 0; u8 *pval = NULL; - + psta = rtw_get_stainfo(&adapter->stapriv, get_my_bssid(&pmlmeinfo->network)); /* Update TX iv data. */ pval = (u8 *)&paoac_rpt->iv; - + if (psecpriv->dot11PrivacyAlgrthm == _TKIP_) { val16 = ((u16)(paoac_rpt->iv[2]) << 0) + ((u16)(paoac_rpt->iv[0]) << 8); - val32 = ((u32)(paoac_rpt->iv[4])<< 0) + - ((u32)(paoac_rpt->iv[5]) << 8) + + val32 = ((u32)(paoac_rpt->iv[4]) << 0) + + ((u32)(paoac_rpt->iv[5]) << 8) + ((u32)(paoac_rpt->iv[6]) << 16) + ((u32)(paoac_rpt->iv[7]) << 24); } else if (psecpriv->dot11PrivacyAlgrthm == _AES_) { val16 = ((u16)(paoac_rpt->iv[0]) << 0) + ((u16)(paoac_rpt->iv[1]) << 8); - val32 = ((u32) (paoac_rpt->iv[4]) << 0) + - ((u32)(paoac_rpt->iv[5]) << 8) + + val32 = ((u32)(paoac_rpt->iv[4]) << 0) + + ((u32)(paoac_rpt->iv[5]) << 8) + ((u32)(paoac_rpt->iv[6]) << 16) + ((u32)(paoac_rpt->iv[7]) << 24); } - + if (psta) { txiv = val16 + ((u64)val32 << 16); if (txiv != 0) @@ -3687,24 +4337,34 @@ static void rtw_hal_update_tx_iv(_adapter *adapter) static void rtw_hal_update_sw_security_info(_adapter *adapter) { + struct security_priv *psecpriv = &adapter->securitypriv; + rtw_hal_update_tx_iv(adapter); - rtw_hal_update_gtk_offload_info(adapter); +#ifdef CONFIG_GTK_OL + if (psecpriv->binstallKCK_KEK == _TRUE && + psecpriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) + rtw_hal_update_gtk_offload_info(adapter); +#endif } static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) { - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; u8 adopt = 1, check_period = 5; u8 ret = _FAIL; - RTW_INFO("%s(): enable = %d\n", __func__, enable); SET_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, enable); SET_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); - +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + SET_H2CCMD_KEEPALIVE_PARM_PORT_NUM(u1H2CKeepAliveParm, adapter->hw_port); + RTW_INFO("%s(): enable = %d, port = %d\n", __func__, enable, adapter->hw_port); +#else + RTW_INFO("%s(): enable = %d\n", __func__, enable); +#endif ret = rtw_hal_fill_h2c_cmd(adapter, H2C_KEEP_ALIVE, H2C_KEEP_ALIVE_CTRL_LEN, @@ -3715,16 +4375,21 @@ static u8 rtw_hal_set_keep_alive_cmd(_adapter *adapter, u8 enable, u8 pkt_type) static u8 rtw_hal_set_disconnect_decision_cmd(_adapter *adapter, u8 enable) { - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN] = {0}; - u8 adopt = 1, check_period = 10, trypkt_num = 0; + u8 adopt = 1, check_period = 30, trypkt_num = 5; u8 ret = _FAIL; - RTW_INFO("%s(): enable = %d\n", __func__, enable); SET_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, enable); SET_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + SET_H2CCMD_DISCONDECISION_PORT_NUM(u1H2CDisconDecisionParm, adapter->hw_port); + RTW_INFO("%s(): enable = %d, port = %d\n", __func__, enable, adapter->hw_port); +#else + RTW_INFO("%s(): enable = %d\n", __func__, enable); +#endif ret = rtw_hal_fill_h2c_cmd(adapter, H2C_DISCON_DECISION, @@ -3735,18 +4400,22 @@ static u8 rtw_hal_set_disconnect_decision_cmd(_adapter *adapter, u8 enable) static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_unit) { + struct registry_priv *registry_par = &adapter->registrypriv; struct security_priv *psecpriv = &adapter->securitypriv; struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 u1H2CWoWlanCtrlParm[H2C_WOWLAN_LEN] = {0}; - u8 discont_wake = 1, gpionum = 0, gpio_dur = 0; + u8 discont_wake = 0, gpionum = 0, gpio_dur = 0; u8 hw_unicast = 0, gpio_pulse_cnt = 0, gpio_pulse_en = 0; u8 sdio_wakeup_enable = 1; u8 gpio_high_active = 0; u8 magic_pkt = 0; u8 gpio_unit = 0; /*0: 64ns, 1: 8ms*/ u8 ret = _FAIL; +#ifdef CONFIG_DIS_UPHY + u8 dis_uphy = 0, dis_uphy_unit = 0, dis_uphy_time = 0; +#endif /* CONFIG_DIS_UPHY */ #ifdef CONFIG_GPIO_WAKEUP gpio_high_active = ppwrpriv->is_high_active; @@ -3754,13 +4423,17 @@ static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_un sdio_wakeup_enable = 0; #endif /* CONFIG_GPIO_WAKEUP */ - if (!ppwrpriv->wowlan_pno_enable) + if (!ppwrpriv->wowlan_pno_enable && + registry_par->wakeup_event & BIT(0)) magic_pkt = enable; - if (psecpriv->dot11PrivacyAlgrthm == _WEP40_ || psecpriv->dot11PrivacyAlgrthm == _WEP104_) - hw_unicast = 1; - else - hw_unicast = 0; + if ((registry_par->wakeup_event & BIT(1)) && + (psecpriv->dot11PrivacyAlgrthm == _WEP40_ || + psecpriv->dot11PrivacyAlgrthm == _WEP104_)) + hw_unicast = 1; + + if (registry_par->wakeup_event & BIT(2)) + discont_wake = enable; RTW_INFO("%s(): enable=%d change_unit=%d\n", __func__, enable, change_unit); @@ -3787,7 +4460,11 @@ static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_un SET_H2CCMD_WOWLAN_GPIO_ACTIVE(u1H2CWoWlanCtrlParm, gpio_high_active); #ifdef CONFIG_GTK_OL - SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 0); + if (psecpriv->binstallKCK_KEK == _TRUE && + psecpriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) + SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 0); + else + SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, 1); #else SET_H2CCMD_WOWLAN_REKEY_WAKE_UP(u1H2CWoWlanCtrlParm, enable); #endif @@ -3801,6 +4478,26 @@ static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_un SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(u1H2CWoWlanCtrlParm, gpio_pulse_en); SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(u1H2CWoWlanCtrlParm, gpio_pulse_cnt); +#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE + if (enable) + SET_H2CCMD_WOWLAN_GPIO_INPUT_EN(u1H2CWoWlanCtrlParm, 1); +#endif + +#ifdef CONFIG_DIS_UPHY + if (enable) { + dis_uphy = 1; + /* time unit: 0 -> ms, 1 -> 256 ms*/ + dis_uphy_unit = 1; + dis_uphy_time = 0x4; + } + + SET_H2CCMD_WOWLAN_DIS_UPHY(u1H2CWoWlanCtrlParm, dis_uphy); + SET_H2CCMD_WOWLAN_HOST_2_DEV(u1H2CWoWlanCtrlParm, 1); + SET_H2CCMD_WOWLAN_DIS_UPHY_UNIT(u1H2CWoWlanCtrlParm, dis_uphy_unit); + SET_H2CCMD_WOWLAN_DIS_UPHY_TIME(u1H2CWoWlanCtrlParm, dis_uphy_time); +#endif /* CONFIG_DIS_UPHY */ + + ret = rtw_hal_fill_h2c_cmd(adapter, H2C_WOWLAN, H2C_WOWLAN_LEN, @@ -3810,7 +4507,7 @@ static u8 rtw_hal_set_wowlan_ctrl_cmd(_adapter *adapter, u8 enable, u8 change_un static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) { - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; struct security_priv *psecuritypriv = &(adapter->securitypriv); struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); struct registry_priv *pregistrypriv = &adapter->registrypriv; @@ -3825,34 +4522,37 @@ static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN( u1H2CRemoteWakeCtrlParm, 1); #ifdef CONFIG_GTK_OL - if (psecuritypriv->binstallKCK_KEK == _TRUE) { + if (psecuritypriv->binstallKCK_KEK == _TRUE && + psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( u1H2CRemoteWakeCtrlParm, 1); } else { + RTW_INFO("no kck kek\n"); SET_H2CCMD_REMOTE_WAKE_CTRL_GTK_OFFLOAD_EN( u1H2CRemoteWakeCtrlParm, 0); } #endif /* CONFIG_GTK_OL */ - if (pregistrypriv->default_patterns_en == _FALSE) { - SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN( - u1H2CRemoteWakeCtrlParm, enable); - /* - * filter NetBios name service pkt to avoid being waked-up - * by this kind of unicast pkt this exceptional modification - * is used for match competitor's behavior - */ - SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN( +#ifdef CONFIG_IPV6 + if (ppwrpriv->wowlan_ns_offload_en == _TRUE) { + RTW_INFO("enable NS offload\n"); + SET_H2CCMD_REMOTE_WAKE_CTRL_NDP_OFFLOAD_EN( u1H2CRemoteWakeCtrlParm, enable); } - if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) - SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( + /* + * filter NetBios name service pkt to avoid being waked-up + * by this kind of unicast pkt this exceptional modification + * is used for match competitor's behavior + */ + + SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN( u1H2CRemoteWakeCtrlParm, enable); - +#endif /*CONFIG_IPV6*/ + if ((psecuritypriv->dot11PrivacyAlgrthm == _AES_) || (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) || - (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { + (psecuritypriv->dot11PrivacyAlgrthm == _NO_PRIVACY_)) { SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( u1H2CRemoteWakeCtrlParm, 0); } else { @@ -3860,6 +4560,20 @@ static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) u1H2CRemoteWakeCtrlParm, 1); } + if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_ && + psecuritypriv->ndisauthtype == Ndis802_11AuthModeWPA2PSK) { + SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( + u1H2CRemoteWakeCtrlParm, enable); + + if (IS_HARDWARE_TYPE_8188E(adapter) || + IS_HARDWARE_TYPE_8812(adapter)) { + SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN( + u1H2CRemoteWakeCtrlParm, 0); + SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION( + u1H2CRemoteWakeCtrlParm, 1); + } + } + SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP( u1H2CRemoteWakeCtrlParm, 1); } @@ -3892,11 +4606,11 @@ static u8 rtw_hal_set_remote_wake_ctrl_cmd(_adapter *adapter, u8 enable) static u8 rtw_hal_set_global_info_cmd(_adapter *adapter, u8 group_alg, u8 pairwise_alg) { - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 ret = _FAIL; u8 u1H2CAOACGlobalInfoParm[H2C_AOAC_GLOBAL_INFO_LEN] = {0}; - RTW_INFO("%s(): group_alg=%d pairwise_alg=%d\n", + RTW_DBG("%s(): group_alg=%d pairwise_alg=%d\n", __func__, group_alg, pairwise_alg); SET_H2CCMD_AOAC_GLOBAL_INFO_PAIRWISE_ENC_ALG(u1H2CAOACGlobalInfoParm, pairwise_alg); @@ -3916,12 +4630,12 @@ static u8 rtw_hal_set_scan_offload_info_cmd(_adapter *adapter, PRSVDPAGE_LOC rsvdpageloc, u8 enable) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 u1H2CScanOffloadInfoParm[H2C_SCAN_OFFLOAD_CTRL_LEN] = {0}; u8 res = 0, count = 0, ret = _FAIL; - RTW_INFO("%s: loc_probe_packet:%d, loc_scan_info: %d loc_ssid_info:%d\n", + RTW_DBG("%s: loc_probe_packet:%d, loc_scan_info: %d loc_ssid_info:%d\n", __func__, rsvdpageloc->LocProbePacket, rsvdpageloc->LocScanInfo, rsvdpageloc->LocSSIDInfo); @@ -3948,13 +4662,12 @@ void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable) struct security_priv *psecpriv = &padapter->securitypriv; struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct registry_priv *pregistry = &padapter->registrypriv; struct sta_info *psta = NULL; u16 media_status_rpt; u8 pkt_type = 0; u8 ret = _SUCCESS; - RTW_PRINT("+%s()+: enable=%d\n", __func__, enable); - rtw_hal_set_wowlan_ctrl_cmd(padapter, enable, _FALSE); if (enable) { @@ -3963,7 +4676,9 @@ void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable) psecpriv->dot11PrivacyAlgrthm); if (!(ppwrpriv->wowlan_pno_enable)) { - rtw_hal_set_disconnect_decision_cmd(padapter, enable); + if (pregistry->wakeup_event & BIT(2)) + rtw_hal_set_disconnect_decision_cmd(padapter, + enable); #ifdef CONFIG_ARP_KEEP_ALIVE if ((psecpriv->dot11PrivacyAlgrthm == _WEP40_) || (psecpriv->dot11PrivacyAlgrthm == _WEP104_)) @@ -3990,7 +4705,6 @@ void rtw_hal_set_fw_wow_related_cmd(_adapter *padapter, u8 enable) rtw_hal_set_remote_wake_ctrl_cmd(padapter, enable); } - RTW_PRINT("-%s()-\n", __func__); } #endif /* CONFIG_WOWLAN */ @@ -3999,7 +4713,7 @@ static u8 rtw_hal_set_ap_wowlan_ctrl_cmd(_adapter *adapter, u8 enable) { struct security_priv *psecpriv = &adapter->securitypriv; struct pwrctrl_priv *ppwrpriv = adapter_to_pwrctl(adapter); - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 u1H2CAPWoWlanCtrlParm[H2C_AP_WOW_GPIO_CTRL_LEN] = {0}; u8 gpionum = 0, gpio_dur = 0; @@ -4014,7 +4728,7 @@ static u8 rtw_hal_set_ap_wowlan_ctrl_cmd(_adapter *adapter, u8 enable) sdio_wakeup_enable = 0; #endif /*CONFIG_GPIO_WAKEUP*/ - RTW_INFO("%s(): enable=%d\n", __func__, enable); + RTW_DBG("%s(): enable=%d\n", __func__, enable); SET_H2CCMD_AP_WOW_GPIO_CTRL_INDEX(u1H2CAPWoWlanCtrlParm, gpionum); @@ -4037,11 +4751,11 @@ static u8 rtw_hal_set_ap_wowlan_ctrl_cmd(_adapter *adapter, u8 enable) static u8 rtw_hal_set_ap_offload_ctrl_cmd(_adapter *adapter, u8 enable) { - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 u1H2CAPOffloadCtrlParm[H2C_WOWLAN_LEN] = {0}; u8 ret = _FAIL; - RTW_INFO("%s(): bFuncEn=%d\n", __func__, enable); + RTW_DBG("%s(): bFuncEn=%d\n", __func__, enable); SET_H2CCMD_AP_WOWLAN_EN(u1H2CAPOffloadCtrlParm, enable); @@ -4055,11 +4769,11 @@ static u8 rtw_hal_set_ap_offload_ctrl_cmd(_adapter *adapter, u8 enable) static u8 rtw_hal_set_ap_ps_cmd(_adapter *adapter, u8 enable) { - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 ap_ps_parm[H2C_AP_PS_LEN] = {0}; u8 ret = _FAIL; - RTW_INFO("%s(): enable=%d\n" , __func__ , enable); + RTW_DBG("%s(): enable=%d\n" , __func__ , enable); SET_H2CCMD_AP_WOW_PS_EN(ap_ps_parm, enable); #ifndef CONFIG_USB_HCI @@ -4081,12 +4795,12 @@ static u8 rtw_hal_set_ap_ps_cmd(_adapter *adapter, u8 enable) static void rtw_hal_set_ap_rsvdpage_loc_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpageloc) { - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; u8 rsvdparm[H2C_AOAC_RSVDPAGE_LOC_LEN] = {0}; u8 ret = _FAIL, header = 0; if (pHalFunc->fill_h2c_cmd == NULL) { - RTW_INFO("%s: Please hook fill_h2c_cmd first!\n", __func__); + RTW_ERR("%s: Please hook fill_h2c_cmd first!\n", __func__); return; } @@ -4104,7 +4818,7 @@ static void rtw_hal_set_ap_rsvdpage_loc_cmd(PADAPTER padapter, H2C_BCN_RSVDPAGE_LEN, rsvdparm); if (ret == _FAIL) - RTW_INFO("%s: H2C_BCN_RSVDPAGE cmd fail\n", __func__); + RTW_WARN("%s: H2C_BCN_RSVDPAGE cmd fail\n", __func__); rtw_msleep_os(10); @@ -4117,7 +4831,7 @@ static void rtw_hal_set_ap_rsvdpage_loc_cmd(PADAPTER padapter, H2C_PROBERSP_RSVDPAGE_LEN, rsvdparm); if (ret == _FAIL) - RTW_INFO("%s: H2C_PROBERSP_RSVDPAGE cmd fail\n", __func__); + RTW_WARN("%s: H2C_PROBERSP_RSVDPAGE cmd fail\n", __func__); rtw_msleep_os(10); } @@ -4134,8 +4848,9 @@ static void rtw_hal_ap_wow_enable(_adapter *padapter) struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); struct security_priv *psecuritypriv = &padapter->securitypriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; struct sta_info *psta = NULL; + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); #ifdef DBG_CHECK_FW_PS_STATE struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; @@ -4147,7 +4862,7 @@ static void rtw_hal_ap_wow_enable(_adapter *padapter) #ifdef DBG_CHECK_FW_PS_STATE if (rtw_fw_ps_state(padapter) == _FAIL) { pdbgpriv->dbg_enwow_dload_fw_fail_cnt++; - RTW_PRINT("wowlan enable no leave 32k\n"); + RTW_WARN("wowlan enable no leave 32k\n"); } #endif /*DBG_CHECK_FW_PS_STATE*/ @@ -4161,42 +4876,45 @@ static void rtw_hal_ap_wow_enable(_adapter *padapter) issue_beacon(padapter, 0); rtw_msleep_os(2); - + #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(padapter)) rtw_hal_disable_tx_report(padapter); - + #endif /* RX DMA stop */ res = rtw_hal_pause_rx_dma(padapter); if (res == _FAIL) - RTW_PRINT("[WARNING] pause RX DMA fail\n"); + RTW_WARN("[WARNING] pause RX DMA fail\n"); #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) /* Enable CPWM2 only. */ res = rtw_hal_enable_cpwm2(padapter); if (res == _FAIL) - RTW_PRINT("[WARNING] enable cpwm2 fail\n"); + RTW_WARN("[WARNING] enable cpwm2 fail\n"); #endif #ifdef CONFIG_GPIO_WAKEUP rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _TRUE); #endif /* 5. Set Enable WOWLAN H2C command. */ - RTW_PRINT("Set Enable AP WOWLan cmd\n"); + RTW_DBG("Set Enable AP WOWLan cmd\n"); rtw_hal_set_fw_ap_wow_related_cmd(padapter, 1); rtw_write8(padapter, REG_MCUTST_WOWLAN, 0); #ifdef CONFIG_USB_HCI rtw_mi_intf_stop(padapter); +#endif +#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) /* Invoid SE0 reset signal during suspending*/ rtw_write8(padapter, REG_RSV_CTRL, 0x20); - rtw_write8(padapter, REG_RSV_CTRL, 0x60); -#endif /*CONFIG_USB_HCI*/ + if (IS_8188F(pHalData->version_id) == FALSE) + rtw_write8(padapter, REG_RSV_CTRL, 0x60); +#endif } static void rtw_hal_ap_wow_disable(_adapter *padapter) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; #ifdef DBG_CHECK_FW_PS_STATE struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; @@ -4208,7 +4926,7 @@ static void rtw_hal_ap_wow_disable(_adapter *padapter) /* 1. Read wakeup reason*/ pwrctl->wowlan_wake_reason = rtw_read8(padapter, REG_MCUTST_WOWLAN); - RTW_PRINT("wakeup_reason: 0x%02x\n", + RTW_INFO("%s: wakeup_reason: 0x%02x\n", __func__, pwrctl->wowlan_wake_reason); rtw_hal_set_fw_ap_wow_related_cmd(padapter, 0); @@ -4217,21 +4935,32 @@ static void rtw_hal_ap_wow_disable(_adapter *padapter) #ifdef DBG_CHECK_FW_PS_STATE if (rtw_fw_ps_state(padapter) == _FAIL) { pdbgpriv->dbg_diswow_dload_fw_fail_cnt++; - RTW_PRINT("wowlan enable no leave 32k\n"); + RTW_WARN("wowlan enable no leave 32k\n"); } #endif /*DBG_CHECK_FW_PS_STATE*/ + #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(padapter)) rtw_hal_enable_tx_report(padapter); + #endif rtw_hal_force_enable_rxdma(padapter); rtw_hal_fw_dl(padapter, _FALSE); #ifdef CONFIG_GPIO_WAKEUP + #ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE + if (pwrctl->is_high_active == 0) + rtw_hal_set_input_gpio(padapter, WAKEUP_GPIO_IDX); + else + rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, 0); + #else val8 = (pwrctl->is_high_active == 0) ? 1 : 0; - RTW_PRINT("Set Wake GPIO to default(%d).\n", val8); + RTW_INFO("%s: Set Wake GPIO to default(%d).\n", __func__, val8); rtw_hal_set_output_gpio(padapter, WAKEUP_GPIO_IDX, val8); + + rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _FALSE); + #endif/*CONFIG_WAKEUP_GPIO_INPUT_MODE*/ #endif media_status_rpt = RT_MEDIA_CONNECT; @@ -4322,7 +5051,7 @@ static void rtw_hal_construct_P2PBeacon(_adapter *padapter, u8 *pframe, u32 *pLe SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); /* pmlmeext->mgnt_seq++; */ - SetFrameSubType(pframe, WIFI_BEACON); + set_frame_sub_type(pframe, WIFI_BEACON); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -4555,17 +5284,6 @@ static void rtw_hal_construct_P2PBeacon(_adapter *padapter, u8 *pframe, u32 *pLe #endif } -static int get_reg_classes_full_count(struct p2p_channels channel_list) -{ - int cnt = 0; - int i; - - for (i = 0; i < channel_list.reg_classes; i++) - cnt += channel_list.reg_class[i].channels; - - return cnt; -} - static void rtw_hal_construct_P2PProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength) { /* struct xmit_frame *pmgntframe; */ @@ -4612,7 +5330,7 @@ static void rtw_hal_construct_P2PProbeRsp(_adapter *padapter, u8 *pframe, u32 *p _rtw_memcpy(pwlanhdr->addr3, mac, ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetFrameSubType(fctrl, WIFI_PROBERSP); + set_frame_sub_type(fctrl, WIFI_PROBERSP); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); pframe += pktlen; @@ -4889,6 +5607,7 @@ static void rtw_hal_construct_P2PProbeRsp(_adapter *padapter, u8 *pframe, u32 *p } static void rtw_hal_construct_P2PNegoRsp(_adapter *padapter, u8 *pframe, u32 *pLength) { + struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); unsigned char category = RTW_WLAN_CATEGORY_PUBLIC; u8 action = P2P_PUB_ACTION_ACTION; u32 p2poui = cpu_to_be32(P2POUI); @@ -4934,7 +5653,7 @@ static void rtw_hal_construct_P2PNegoRsp(_adapter *padapter, u8 *pframe, u32 *pL _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); pframe += pktlen; @@ -5133,8 +5852,8 @@ static void rtw_hal_construct_P2PNegoRsp(_adapter *padapter, u8 *pframe, u32 *pL /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ /* + number of channels in all classes */ len_channellist_attr = 3 - + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes - + get_reg_classes_full_count(pmlmeext->channel_list); + + (1 + 1) * (u16)ch_list->reg_classes + + get_reg_classes_full_count(ch_list); #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_buddy_check_fwstate(padapter, _FW_LINKED)) @@ -5180,37 +5899,22 @@ static void rtw_hal_construct_P2PNegoRsp(_adapter *padapter, u8 *pframe, u32 *pL /* Channel List */ p2pie[p2pielen++] = union_ch; - } else { - int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { - /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; - - /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; - - /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; - } - } -#else /* CONFIG_CONCURRENT_MODE */ + } else +#endif /* CONFIG_CONCURRENT_MODE */ { int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { + for (j = 0; j < ch_list->reg_classes; j++) { /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; + p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; + p2pie[p2pielen++] = ch_list->reg_class[j].channels; /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; + for (i = 0; i < ch_list->reg_class[j].channels; i++) + p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; } } -#endif /* CONFIG_CONCURRENT_MODE */ - /* Device Info */ /* Type: */ @@ -5350,7 +6054,7 @@ static void rtw_hal_construct_P2PInviteRsp(_adapter *padapter, u8 *pframe, u32 * _rtw_memset(pwlanhdr->addr3, 0, ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5406,6 +6110,8 @@ static void rtw_hal_construct_P2PInviteRsp(_adapter *padapter, u8 *pframe, u32 * /* due to defult value is FAIL INFO UNAVAILABLE, so the following IE is not needed */ #if 0 if (status_code == P2P_STATUS_SUCCESS) { + struct p2p_channels *ch_list = &(adapter_to_rfctl(padapter)->channel_list); + if (rtw_p2p_chk_role(pwdinfo, P2P_ROLE_GO)) { /* The P2P Invitation request frame asks this Wi-Fi device to be the P2P GO */ /* In this case, the P2P Invitation response frame should carry the two more P2P attributes. */ @@ -5460,8 +6166,8 @@ static void rtw_hal_construct_P2PInviteRsp(_adapter *padapter, u8 *pframe, u32 * /* + ( Operating Class (1) + Number of Channels(1) ) * Operation Classes (?) */ /* + number of channels in all classes */ len_channellist_attr = 3 - + (1 + 1) * (u16)pmlmeext->channel_list.reg_classes - + get_reg_classes_full_count(pmlmeext->channel_list); + + (1 + 1) * (u16)ch_list->reg_classes + + get_reg_classes_full_count(ch_list); #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_check_status(padapter, MI_LINKED)) @@ -5507,36 +6213,22 @@ static void rtw_hal_construct_P2PInviteRsp(_adapter *padapter, u8 *pframe, u32 * /* Channel List */ p2pie[p2pielen++] = union_ch; - } else { - int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { - /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; - - /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; - - /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; - } - } -#else /* CONFIG_CONCURRENT_MODE */ + } else +#endif /* CONFIG_CONCURRENT_MODE */ { int i, j; - for (j = 0; j < pmlmeext->channel_list.reg_classes; j++) { + for (j = 0; j < ch_list->reg_classes; j++) { /* Operating Class */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].reg_class; + p2pie[p2pielen++] = ch_list->reg_class[j].reg_class; /* Number of Channels */ - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channels; + p2pie[p2pielen++] = ch_list->reg_class[j].channels; /* Channel List */ - for (i = 0; i < pmlmeext->channel_list.reg_class[j].channels; i++) - p2pie[p2pielen++] = pmlmeext->channel_list.reg_class[j].channel[i]; + for (i = 0; i < ch_list->reg_class[j].channels; i++) + p2pie[p2pielen++] = ch_list->reg_class[j].channel[i]; } } -#endif /* CONFIG_CONCURRENT_MODE */ } #endif @@ -5605,7 +6297,7 @@ static void rtw_hal_construct_P2PProvisionDisRsp(_adapter *padapter, u8 *pframe, _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5679,7 +6371,7 @@ static void rtw_hal_construct_P2PProvisionDisRsp(_adapter *padapter, u8 *pframe, u8 rtw_hal_set_FwP2PRsvdPage_cmd(_adapter *adapter, PRSVDPAGE_LOC rsvdpageloc) { u8 u1H2CP2PRsvdPageParm[H2C_P2PRSVDPAGE_LOC_LEN] = {0}; - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 ret = _FAIL; RTW_INFO("P2PRsvdPageLoc: P2PBeacon=%d P2PProbeRsp=%d NegoRsp=%d InviteRsp=%d PDRsp=%d\n", @@ -5708,7 +6400,7 @@ u8 rtw_hal_set_p2p_wowlan_offload_cmd(_adapter *adapter) u8 offload_cmd[H2C_P2P_OFFLOAD_LEN] = {0}; struct wifidirect_info *pwdinfo = &(adapter->wdinfo); struct P2P_WoWlan_Offload_t *p2p_wowlan_offload = (struct P2P_WoWlan_Offload_t *)offload_cmd; - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u8 ret = _FAIL; _rtw_memset(p2p_wowlan_offload, 0 , sizeof(struct P2P_WoWlan_Offload_t)); @@ -5770,7 +6462,7 @@ static void rtw_hal_construct_beacon(_adapter *padapter, SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); /* pmlmeext->mgnt_seq++; */ - SetFrameSubType(pframe, WIFI_BEACON); + set_frame_sub_type(pframe, WIFI_BEACON); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5860,10 +6552,10 @@ static void rtw_hal_construct_PSPoll(_adapter *padapter, fctrl = &(pwlanhdr->frame_ctl); *(fctrl) = 0; SetPwrMgt(fctrl); - SetFrameSubType(pframe, WIFI_PSPOLL); + set_frame_sub_type(pframe, WIFI_PSPOLL); /* AID. */ - SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); + set_duration(pframe, (pmlmeinfo->aid | 0xc000)); /* BSSID. */ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); @@ -5928,7 +6620,7 @@ void rtw_hal_construct_NullFunctionData( if (bQoS == _TRUE) { struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; - SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); + set_frame_sub_type(pframe, WIFI_QOS_DATA_NULL); pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; SetPriority(&pwlanqoshdr->qc, AC); @@ -5936,7 +6628,7 @@ void rtw_hal_construct_NullFunctionData( pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); } else { - SetFrameSubType(pframe, WIFI_DATA_NULL); + set_frame_sub_type(pframe, WIFI_DATA_NULL); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); } @@ -5969,7 +6661,7 @@ void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, _rtw_memcpy(pwlanhdr->addr3, bssid, ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetFrameSubType(fctrl, WIFI_PROBERSP); + set_frame_sub_type(fctrl, WIFI_PROBERSP); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); pframe += pktlen; @@ -5985,6 +6677,52 @@ void rtw_hal_construct_ProbeRsp(_adapter *padapter, u8 *pframe, u32 *pLength, } #ifdef CONFIG_WOWLAN +static void rtw_hal_append_tkip_mic(PADAPTER padapter, + u8 *pframe, u32 offset) +{ + struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct rtw_ieee80211_hdr *pwlanhdr; + struct mic_data micdata; + struct sta_info *psta = NULL; + int res = 0; + + u8 *payload = (u8 *)(pframe + offset); + + u8 mic[8]; + u8 priority[4] = {0x0}; + u8 null_key[16] = {0x0}; + + RTW_DBG("%s(): Add MIC, offset: %d\n", __func__, offset); + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + psta = rtw_get_stainfo(&padapter->stapriv, + get_my_bssid(&(pmlmeinfo->network))); + if (psta != NULL) { + res = _rtw_memcmp(&psta->dot11tkiptxmickey.skey[0], + null_key, 16); + if (res == _TRUE) + RTW_INFO("%s(): STA dot11tkiptxmickey==0\n", __func__); + rtw_secmicsetkey(&micdata, &psta->dot11tkiptxmickey.skey[0]); + } + + rtw_secmicappend(&micdata, pwlanhdr->addr3, 6); /* DA */ + + rtw_secmicappend(&micdata, pwlanhdr->addr2, 6); /* SA */ + + priority[0] = 0; + + rtw_secmicappend(&micdata, &priority[0], 4); + + rtw_secmicappend(&micdata, payload, 36); /* payload length = 8 + 28 */ + + rtw_secgetmic(&micdata, &(mic[0])); + + payload += 36; + + _rtw_memcpy(payload, &(mic[0]), 8); +} /* * Description: * Construct the ARP response packet to support ARP offload. @@ -6008,7 +6746,7 @@ static void rtw_hal_construct_ARPRsp( u8 *pARPRspPkt = pframe; /* for TKIP Cal MIC */ u8 *payload = pframe; - u8 EncryptionHeadOverhead = 0; + u8 EncryptionHeadOverhead = 0, arp_offset = 0; /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; @@ -6020,14 +6758,150 @@ static void rtw_hal_construct_ARPRsp( /* MAC Header. */ /* ------------------------------------------------------------------------- */ SetFrameType(fctrl, WIFI_DATA); - /* SetFrameSubType(fctrl, 0); */ + /* set_frame_sub_type(fctrl, 0); */ SetToDs(fctrl); _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetDuration(pwlanhdr, 0); + set_duration(pwlanhdr, 0); + /* SET_80211_HDR_FRAME_CONTROL(pARPRspPkt, 0); */ + /* SET_80211_HDR_TYPE_AND_SUBTYPE(pARPRspPkt, Type_Data); */ + /* SET_80211_HDR_TO_DS(pARPRspPkt, 1); */ + /* SET_80211_HDR_ADDRESS1(pARPRspPkt, pMgntInfo->Bssid); */ + /* SET_80211_HDR_ADDRESS2(pARPRspPkt, Adapter->CurrentAddress); */ + /* SET_80211_HDR_ADDRESS3(pARPRspPkt, pMgntInfo->Bssid); */ + + /* SET_80211_HDR_DURATION(pARPRspPkt, 0); */ + /* SET_80211_HDR_FRAGMENT_SEQUENCE(pARPRspPkt, 0); */ +#ifdef CONFIG_WAPI_SUPPORT + *pLength = sMacHdrLng; +#else + *pLength = 24; +#endif + switch (psecuritypriv->dot11PrivacyAlgrthm) { + case _WEP40_: + case _WEP104_: + EncryptionHeadOverhead = 4; + break; + case _TKIP_: + EncryptionHeadOverhead = 8; + break; + case _AES_: + EncryptionHeadOverhead = 8; + break; +#ifdef CONFIG_WAPI_SUPPORT + case _SMS4_: + EncryptionHeadOverhead = 18; + break; +#endif + default: + EncryptionHeadOverhead = 0; + } + + if (EncryptionHeadOverhead > 0) { + _rtw_memset(&(pframe[*pLength]), 0, EncryptionHeadOverhead); + *pLength += EncryptionHeadOverhead; + /* SET_80211_HDR_WEP(pARPRspPkt, 1); */ /* Suggested by CCW. */ + SetPrivacy(fctrl); + } + + /* ------------------------------------------------------------------------- */ + /* Frame Body. */ + /* ------------------------------------------------------------------------- */ + arp_offset = *pLength; + pARPRspPkt = (u8 *)(pframe + arp_offset); + payload = pARPRspPkt; /* Get Payload pointer */ + /* LLC header */ + _rtw_memcpy(pARPRspPkt, ARPLLCHeader, 8); + *pLength += 8; + + /* ARP element */ + pARPRspPkt += 8; + SET_ARP_PKT_HW(pARPRspPkt, 0x0100); + SET_ARP_PKT_PROTOCOL(pARPRspPkt, 0x0008); /* IP protocol */ + SET_ARP_PKT_HW_ADDR_LEN(pARPRspPkt, 6); + SET_ARP_PKT_PROTOCOL_ADDR_LEN(pARPRspPkt, 4); + SET_ARP_PKT_OPERATION(pARPRspPkt, 0x0200); /* ARP response */ + SET_ARP_PKT_SENDER_MAC_ADDR(pARPRspPkt, adapter_mac_addr(padapter)); + SET_ARP_PKT_SENDER_IP_ADDR(pARPRspPkt, pIPAddress); +#ifdef CONFIG_ARP_KEEP_ALIVE + if (!is_zero_mac_addr(pmlmepriv->gw_mac_addr)) { + SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, pmlmepriv->gw_mac_addr); + SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, pmlmepriv->gw_ip); + } else +#endif + { + SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, + get_my_bssid(&(pmlmeinfo->network))); + SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, + pIPAddress); + RTW_DBG("%s Target Mac Addr:" MAC_FMT "\n", __FUNCTION__, + MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); + RTW_DBG("%s Target IP Addr" IP_FMT "\n", __FUNCTION__, + IP_ARG(pIPAddress)); + } + + *pLength += 28; + + if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { + if (IS_HARDWARE_TYPE_8188E(padapter) || + IS_HARDWARE_TYPE_8812(padapter)) { + rtw_hal_append_tkip_mic(padapter, pframe, arp_offset); + } + *pLength += 8; + } +} + +#ifdef CONFIG_IPV6 +/* + * Description: Neighbor Discovery Offload. + */ +static void rtw_hal_construct_na_message(_adapter *padapter, + u8 *pframe, u32 *pLength) +{ + struct rtw_ieee80211_hdr *pwlanhdr = NULL; + struct mlme_priv *pmlmepriv = &padapter->mlmepriv; + struct wlan_network *cur_network = &pmlmepriv->cur_network; + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &pmlmeext->mlmext_info; + struct security_priv *psecuritypriv = &padapter->securitypriv; + + u32 pktlen = 0; + u16 *fctrl = NULL; + + u8 ns_hdr[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x86, 0xDD}; + u8 ipv6_info[4] = {0x60, 0x00, 0x00, 0x00}; + u8 ipv6_contx[4] = {0x00, 0x20, 0x3a, 0xff}; + u8 icmpv6_hdr[8] = {0x88, 0x00, 0x00, 0x00, 0x60, 0x00, 0x00, 0x00}; + u8 val8 = 0; + + u8 *p_na_msg = pframe; + /* for TKIP Cal MIC */ + u8 *payload = pframe; + u8 EncryptionHeadOverhead = 0, na_msg_offset = 0; + /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + fctrl = &pwlanhdr->frame_ctl; + *(fctrl) = 0; + + /* ------------------------------------------------------------------------- */ + /* MAC Header. */ + /* ------------------------------------------------------------------------- */ + SetFrameType(fctrl, WIFI_DATA); + SetToDs(fctrl); + _rtw_memcpy(pwlanhdr->addr1, + get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, + adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, + get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + SetSeqNum(pwlanhdr, 0); + set_duration(pwlanhdr, 0); #ifdef CONFIG_WAPI_SUPPORT *pLength = sMacHdrLng; @@ -6064,43 +6938,101 @@ static void rtw_hal_construct_ARPRsp( /* ------------------------------------------------------------------------- */ /* Frame Body. */ /* ------------------------------------------------------------------------- */ - pARPRspPkt = (u8 *)(pframe + *pLength); - payload = pARPRspPkt; /* Get Payload pointer */ + na_msg_offset = *pLength; + p_na_msg = (u8 *)(pframe + na_msg_offset); + payload = p_na_msg; /* Get Payload pointer */ + /* LLC header */ - _rtw_memcpy(pARPRspPkt, ARPLLCHeader, 8); - *pLength += 8; + val8 = sizeof(ns_hdr); + _rtw_memcpy(p_na_msg, ns_hdr, val8); + *pLength += val8; + p_na_msg += val8; - /* ARP element */ - pARPRspPkt += 8; - SET_ARP_PKT_HW(pARPRspPkt, 0x0100); - SET_ARP_PKT_PROTOCOL(pARPRspPkt, 0x0008); /* IP protocol */ - SET_ARP_PKT_HW_ADDR_LEN(pARPRspPkt, 6); - SET_ARP_PKT_PROTOCOL_ADDR_LEN(pARPRspPkt, 4); - SET_ARP_PKT_OPERATION(pARPRspPkt, 0x0200); /* ARP response */ - SET_ARP_PKT_SENDER_MAC_ADDR(pARPRspPkt, adapter_mac_addr(padapter)); - SET_ARP_PKT_SENDER_IP_ADDR(pARPRspPkt, pIPAddress); -#ifdef CONFIG_ARP_KEEP_ALIVE - if (!is_zero_mac_addr(pmlmepriv->gw_mac_addr)) { - SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, pmlmepriv->gw_mac_addr); - SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, pmlmepriv->gw_ip); - } else -#endif - { - SET_ARP_PKT_TARGET_MAC_ADDR(pARPRspPkt, - get_my_bssid(&(pmlmeinfo->network))); - SET_ARP_PKT_TARGET_IP_ADDR(pARPRspPkt, - pIPAddress); - RTW_INFO("%s Target Mac Addr:" MAC_FMT "\n", __FUNCTION__, - MAC_ARG(get_my_bssid(&(pmlmeinfo->network)))); - RTW_INFO("%s Target IP Addr" IP_FMT "\n", __FUNCTION__, - IP_ARG(pIPAddress)); - } + /* IPv6 Header */ + /* 1 . Information (4 bytes): 0x60 0x00 0x00 0x00 */ + val8 = sizeof(ipv6_info); + _rtw_memcpy(p_na_msg, ipv6_info, val8); + *pLength += val8; + p_na_msg += val8; - *pLength += 28; + /* 2 . playload : 0x00 0x20 , NextProt : 0x3a (ICMPv6) HopLim : 0xff */ + val8 = sizeof(ipv6_contx); + _rtw_memcpy(p_na_msg, ipv6_contx, val8); + *pLength += val8; + p_na_msg += val8; - if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) + /* 3 . SA : 16 bytes , DA : 16 bytes ( Fw will filled ) */ + _rtw_memset(&(p_na_msg[*pLength]), 0, 32); + *pLength += 32; + p_na_msg += 32; + + /* ICMPv6 */ + /* 1. Type : 0x88 (NA) + * 2. Code : 0x00 + * 3. ChechSum : 0x00 0x00 (RSvd) + * 4. NAFlag: 0x60 0x00 0x00 0x00 ( Solicited , Override) + */ + val8 = sizeof(icmpv6_hdr); + _rtw_memcpy(p_na_msg, icmpv6_hdr, val8); + *pLength += val8; + p_na_msg += val8; + + /* TA: 16 bytes*/ + _rtw_memset(&(p_na_msg[*pLength]), 0, 16); + *pLength += 16; + p_na_msg += 16; + + /* ICMPv6 Target Link Layer Address */ + p_na_msg[0] = 0x02; /* type */ + p_na_msg[1] = 0x01; /* len 1 unit of 8 octes */ + *pLength += 2; + p_na_msg += 2; + + _rtw_memset(&(p_na_msg[*pLength]), 0, 6); + *pLength += 6; + p_na_msg += 6; + + if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) { + if (IS_HARDWARE_TYPE_8188E(padapter) || + IS_HARDWARE_TYPE_8812(padapter)) { + rtw_hal_append_tkip_mic(padapter, pframe, + na_msg_offset); + } *pLength += 8; + } } +/* + * Description: Neighbor Discovery Protocol Information. + */ +static void rtw_hal_construct_ndp_info(_adapter *padapter, + u8 *pframe, u32 *pLength) +{ + struct mlme_ext_priv *pmlmeext = NULL; + struct mlme_ext_info *pmlmeinfo = NULL; + struct rtw_ndp_info ndp_info; + u8 *pndp_info = pframe; + u8 len = sizeof(struct rtw_ndp_info); + + /*RTW_INFO("%s: len: %d\n", __func__, len);*/ + + pmlmeext = &padapter->mlmeextpriv; + pmlmeinfo = &pmlmeext->mlmext_info; + + _rtw_memset(pframe, 0, len); + _rtw_memset(&ndp_info, 0, len); + + ndp_info.enable = 1; + ndp_info.check_remote_ip = 0; + ndp_info.num_of_target_ip = 1; + + _rtw_memcpy(&ndp_info.target_link_addr, adapter_mac_addr(padapter), + ETH_ALEN); + _rtw_memcpy(&ndp_info.target_ipv6_addr, pmlmeinfo->ip6_addr, + RTW_IPv6_ADDR_LEN); + + _rtw_memcpy(pndp_info, &ndp_info, len); +} +#endif /* CONFIG_IPV6 */ #ifdef CONFIG_PNO_SUPPORT static void rtw_hal_construct_ProbeReq(_adapter *padapter, u8 *pframe, @@ -6130,7 +7062,7 @@ static void rtw_hal_construct_ProbeReq(_adapter *padapter, u8 *pframe, _rtw_memcpy(pwlanhdr->addr2, mac, ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetFrameSubType(pframe, WIFI_PROBEREQ); + set_frame_sub_type(pframe, WIFI_PROBEREQ); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); pframe += pktlen; @@ -6296,7 +7228,6 @@ static void rtw_hal_construct_GTKRsp( struct security_priv *psecuritypriv = &padapter->securitypriv; static u8 LLCHeader[8] = {0xAA, 0xAA, 0x03, 0x00, 0x00, 0x00, 0x88, 0x8E}; static u8 GTKbody_a[11] = {0x01, 0x03, 0x00, 0x5F, 0x02, 0x03, 0x12, 0x00, 0x10, 0x42, 0x0B}; - u8 mic[RTW_TKIP_MIC_LEN] = {0}; u8 *pGTKRspPkt = pframe; u8 EncryptionHeadOverhead = 0; /* RTW_INFO("%s:%d\n", __FUNCTION__, bForcePowerSave); */ @@ -6310,7 +7241,7 @@ static void rtw_hal_construct_GTKRsp( /* MAC Header. */ /* ------------------------------------------------------------------------- */ SetFrameType(fctrl, WIFI_DATA); - /* SetFrameSubType(fctrl, 0); */ + /* set_frame_sub_type(fctrl, 0); */ SetToDs(fctrl); _rtw_memcpy(pwlanhdr->addr1, @@ -6323,7 +7254,7 @@ static void rtw_hal_construct_GTKRsp( get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); SetSeqNum(pwlanhdr, 0); - SetDuration(pwlanhdr, 0); + set_duration(pwlanhdr, 0); #ifdef CONFIG_WAPI_SUPPORT *pLength = sMacHdrLng; @@ -6376,7 +7307,8 @@ static void rtw_hal_construct_GTKRsp( /* TKIP key_length = 32, AES key_length = 16 */ if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) GTKbody_a[8] = 0x20; - + + /* GTK frame body after LLC, part 1 */ _rtw_memcpy(pGTKRspPkt, GTKbody_a, 11); *pLength += 11; pGTKRspPkt += 11; @@ -6385,9 +7317,8 @@ static void rtw_hal_construct_GTKRsp( *pLength += 88; pGTKRspPkt += 88; - if (psecuritypriv->dot11PrivacyAlgrthm == _TKIP_) + if (psecuritypriv->dot118021XGrpPrivacy == _TKIP_) *pLength += 8; - } #endif /* CONFIG_GTK_OL */ @@ -6401,17 +7332,16 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, struct mlme_ext_priv *pmlmeext; struct mlme_ext_info *pmlmeinfo; u32 ARPLength = 0, GTKLength = 0, PNOLength = 0, ScanInfoLength = 0; - u32 SSIDLegnth = 0, ProbeReqLength = 0; + u32 SSIDLegnth = 0, ProbeReqLength = 0, ns_len = 0; u8 CurtPktPageNum = 0; - u8 currentip[4]; u8 cur_dot11txpn[8]; #ifdef CONFIG_GTK_OL struct sta_priv *pstapriv = &adapter->stapriv; struct sta_info *psta; + struct security_priv *psecpriv = &adapter->securitypriv; u8 kek[RTW_KEK_LEN]; u8 kck[RTW_KCK_LEN]; - u32 gtk_index = 0; #endif /* CONFIG_GTK_OL */ #ifdef CONFIG_PNO_SUPPORT int pno_index; @@ -6421,17 +7351,16 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, pmlmeext = &adapter->mlmeextpriv; pmlmeinfo = &pmlmeext->mlmext_info; - if (pwrctl->wowlan_pno_enable == _FALSE) { + if (pwrctl->wowlan_pno_enable == _FALSE) { /* ARP RSP * 1 page */ - rtw_get_current_ip_address(adapter, currentip); rsvd_page_loc->LocArpRsp = *page_num; - RTW_INFO("LocArpRsp: %d\n", rsvd_page_loc->LocArpRsp); + RTW_DBG("LocArpRsp: %d\n", rsvd_page_loc->LocArpRsp); rtw_hal_construct_ARPRsp(adapter, &pframe[index], - &ARPLength, currentip); - + &ARPLength, pmlmeinfo->ip_addr); + rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], ARPLength, _FALSE, _FALSE, _TRUE); @@ -6441,6 +7370,35 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); +#ifdef CONFIG_IPV6 + /* 2 NS offload and NDP Info*/ + if (pwrctl->wowlan_ns_offload_en == _TRUE) { + rsvd_page_loc->LocNbrAdv = *page_num; + RTW_DBG("LocNbrAdv: %d\n", rsvd_page_loc->LocNbrAdv); + rtw_hal_construct_na_message(adapter, + &pframe[index], &ns_len); + rtw_hal_fill_fake_txdesc(adapter, + &pframe[index - tx_desc], + ns_len, _FALSE, + _FALSE, _TRUE); + CurtPktPageNum = (u8)PageNum(tx_desc + ns_len, + page_size); + *page_num += CurtPktPageNum; + index += (CurtPktPageNum * page_size); + + rsvd_page_loc->LocNDPInfo = *page_num; + RTW_DBG("LocNDPInfo: %d\n", + rsvd_page_loc->LocNDPInfo); + + rtw_hal_construct_ndp_info(adapter, + &pframe[index - tx_desc], + &ns_len); + CurtPktPageNum = + (u8)PageNum(tx_desc + ns_len, page_size); + *page_num += CurtPktPageNum; + index += (CurtPktPageNum * page_size); + } +#endif /*CONFIG_IPV6*/ /* 3 SEC IV * 1 page */ rtw_get_sec_iv(adapter, cur_dot11txpn, @@ -6448,7 +7406,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, rsvd_page_loc->LocRemoteCtrlInfo = *page_num; - RTW_INFO("LocRemoteCtrlInfo: %d\n", rsvd_page_loc->LocRemoteCtrlInfo); + RTW_DBG("LocRemoteCtrlInfo: %d\n", rsvd_page_loc->LocRemoteCtrlInfo); _rtw_memcpy(pframe + index - tx_desc, cur_dot11txpn, _AES_IV_LEN_); @@ -6474,37 +7432,36 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, /* 3 KEK, KCK */ rsvd_page_loc->LocGTKInfo = *page_num; - - gtk_index = psecuritypriv->dot118021XGrpKeyid; - GTKLength = 0; - - RTW_INFO("LocGTKInfo: %d, gtk_index:%d\n", - rsvd_page_loc->LocGTKInfo, gtk_index); + RTW_DBG("LocGTKInfo: %d\n", rsvd_page_loc->LocGTKInfo); if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8812(adapter)) { + struct security_priv *psecpriv = NULL; + + psecpriv = &adapter->securitypriv; _rtw_memcpy(pframe + index - tx_desc, - &psecuritypriv->dot11PrivacyAlgrthm, 1); + &psecpriv->dot11PrivacyAlgrthm, 1); _rtw_memcpy(pframe + index - tx_desc + 1, - &psecuritypriv->dot118021XGrpPrivacy, 1); + &psecpriv->dot118021XGrpPrivacy, 1); _rtw_memcpy(pframe + index - tx_desc + 2, kck, RTW_KCK_LEN); _rtw_memcpy(pframe + index - tx_desc + 2 + RTW_KCK_LEN, kek, RTW_KEK_LEN); - GTKLength = tx_desc + 2 + RTW_KCK_LEN + RTW_KEK_LEN; + CurtPktPageNum = (u8)PageNum(tx_desc + 2 + RTW_KCK_LEN + RTW_KEK_LEN, page_size); } else { - _rtw_memcpy(pframe + index - tx_desc, kck, RTW_KCK_LEN); - _rtw_memcpy(pframe + index - tx_desc + RTW_KCK_LEN, kek, RTW_KEK_LEN); - GTKLength = tx_desc + RTW_KCK_LEN + RTW_KEK_LEN; - } - if (psta != NULL && - psecuritypriv->dot118021XGrpPrivacy == _TKIP_) { - _rtw_memcpy(pframe + index - tx_desc + 56, - &psta->dot11tkiptxmickey, RTW_TKIP_MIC_LEN); - GTKLength += RTW_TKIP_MIC_LEN; + _rtw_memcpy(pframe + index - tx_desc, kck, RTW_KCK_LEN); + _rtw_memcpy(pframe + index - tx_desc + RTW_KCK_LEN, + kek, RTW_KEK_LEN); + GTKLength = tx_desc + RTW_KCK_LEN + RTW_KEK_LEN; + + if (psta != NULL && + psecuritypriv->dot118021XGrpPrivacy == _TKIP_) { + _rtw_memcpy(pframe + index - tx_desc + 56, + &psta->dot11tkiptxmickey, RTW_TKIP_MIC_LEN); + GTKLength += RTW_TKIP_MIC_LEN; + } + CurtPktPageNum = (u8)PageNum(GTKLength, page_size); } - - CurtPktPageNum = (u8)PageNum(GTKLength, page_size); #if 0 { int i; @@ -6517,18 +7474,18 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, printk("\n"); } - RTW_INFO("%s(): HW_VAR_SET_TX_CMD: KEK KCK %p %d\n", + RTW_DBG("%s(): HW_VAR_SET_TX_CMD: KEK KCK %p %d\n", __FUNCTION__, &pframe[index - tx_desc], (tx_desc + RTW_KCK_LEN + RTW_KEK_LEN)); #endif - GTKLength = 0; + *page_num += CurtPktPageNum; index += (CurtPktPageNum * page_size); /* 3 GTK Response */ rsvd_page_loc->LocGTKRsp = *page_num; - RTW_INFO("LocGTKRsp: %d\n", rsvd_page_loc->LocGTKRsp); + RTW_DBG("LocGTKRsp: %d\n", rsvd_page_loc->LocGTKRsp); rtw_hal_construct_GTKRsp(adapter, &pframe[index], >KLength); rtw_hal_fill_fake_txdesc(adapter, &pframe[index - tx_desc], @@ -6537,7 +7494,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, { int gj; printk("123GTK pkt=>\n"); - for (gj = 0; gj < GTKLegnth + tx_desc; gj++) { + for (gj = 0; gj < GTKLength + tx_desc; gj++) { printk(" %02x ", pframe[index - tx_desc + gj]); if ((gj + 1) % 16 == 0) printk("\n"); @@ -6545,9 +7502,9 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, printk(" <=end\n"); } - RTW_INFO("%s(): HW_VAR_SET_TX_CMD: GTK RSP %p %d\n", + RTW_DBG("%s(): HW_VAR_SET_TX_CMD: GTK RSP %p %d\n", __FUNCTION__, &pframe[index - tx_desc], - (tx_desc + GTKLegnth)); + (tx_desc + GTKLength)); #endif CurtPktPageNum = (u8)PageNum(tx_desc + GTKLength, page_size); @@ -6559,7 +7516,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, /* below page is empty for GTK extension memory */ /* 3(11) GTK EXT MEM */ rsvd_page_loc->LocGTKEXTMEM = *page_num; - + RTW_DBG("LocGTKEXTMEM: %d\n", rsvd_page_loc->LocGTKEXTMEM); CurtPktPageNum = 2; if (page_size >= 256) @@ -6567,15 +7524,16 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; /* extension memory for FW */ + *total_pkt_len = index + (page_size * CurtPktPageNum); +#endif /* CONFIG_GTK_OL */ + index += (CurtPktPageNum * page_size); /*Reserve 1 page for AOAC report*/ rsvd_page_loc->LocAOACReport = *page_num; - RTW_INFO("LocAOACReport: %d\n", rsvd_page_loc->LocAOACReport); - + RTW_DBG("LocAOACReport: %d\n", rsvd_page_loc->LocAOACReport); *page_num += 1; *total_pkt_len = index + (page_size * 1); -#endif /* CONFIG_GTK_OL */ } else { #ifdef CONFIG_PNO_SUPPORT if (pwrctl->wowlan_in_resume == _FALSE && @@ -6584,7 +7542,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, /* Broadcast Probe Request */ rsvd_page_loc->LocProbePacket = *page_num; - RTW_INFO("loc_probe_req: %d\n", + RTW_DBG("loc_probe_req: %d\n", rsvd_page_loc->LocProbePacket); rtw_hal_construct_ProbeReq( @@ -6631,7 +7589,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, /* PNO INFO Page */ rsvd_page_loc->LocPNOInfo = *page_num; - RTW_INFO("LocPNOInfo: %d\n", rsvd_page_loc->LocPNOInfo); + RTW_DBG("LocPNOInfo: %d\n", rsvd_page_loc->LocPNOInfo); rtw_hal_construct_PNO_info(adapter, &pframe[index - tx_desc], &PNOLength); @@ -6642,7 +7600,7 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, /* Scan Info Page */ rsvd_page_loc->LocScanInfo = *page_num; - RTW_INFO("LocScanInfo: %d\n", rsvd_page_loc->LocScanInfo); + RTW_DBG("LocScanInfo: %d\n", rsvd_page_loc->LocScanInfo); rtw_hal_construct_scan_info(adapter, &pframe[index - tx_desc], &ScanInfoLength); @@ -6651,7 +7609,6 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, *page_num += CurtPktPageNum; *total_pkt_len = index + ScanInfoLength; index += (CurtPktPageNum * page_size); - } #endif /* CONFIG_PNO_SUPPORT */ } @@ -6660,17 +7617,32 @@ void rtw_hal_set_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, static void rtw_hal_gate_bb(_adapter *adapter, bool stop) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); - u8 val8 = 0; + u8 i = 0, val8 = 0, empty = _FAIL; u16 val16 = 0; if (stop) { + /* checking TX queue status */ + for (i = 0 ; i < 5 ; i++) { + rtw_hal_get_hwreg(adapter, HW_VAR_CHK_MGQ_CPU_EMPTY, &empty); + if (empty) { + break; + } else { + RTW_WARN("%s: MGQ_CPU is busy(%d)!\n", + __func__, i); + rtw_mdelay_os(10); + } + } + + if (val8 == 5) + RTW_ERR("%s: Polling MGQ_CPU empty fail!\n", __func__); + /* Pause TX*/ pwrpriv->wowlan_txpause_status = rtw_read8(adapter, REG_TXPAUSE); rtw_write8(adapter, REG_TXPAUSE, 0xff); val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); val8 &= ~BIT(0); rtw_write8(adapter, REG_SYS_FUNC_EN, val8); - RTW_INFO("%s: BB gated: 0x%02x, store TXPAUSE: %02x\n", + RTW_DBG("%s: BB gated: 0x%02x, store TXPAUSE: %02x\n", __func__, rtw_read8(adapter, REG_SYS_FUNC_EN), pwrpriv->wowlan_txpause_status); @@ -6678,7 +7650,7 @@ static void rtw_hal_gate_bb(_adapter *adapter, bool stop) val8 = rtw_read8(adapter, REG_SYS_FUNC_EN); val8 |= BIT(0); rtw_write8(adapter, REG_SYS_FUNC_EN, val8); - RTW_INFO("%s: BB release: 0x%02x, recover TXPAUSE:%02x\n", + RTW_DBG("%s: BB release: 0x%02x, recover TXPAUSE:%02x\n", __func__, rtw_read8(adapter, REG_SYS_FUNC_EN), pwrpriv->wowlan_txpause_status); /* release TX*/ @@ -6700,6 +7672,111 @@ static void rtw_hal_reset_mac_rx(_adapter *adapter) RTW_INFO("0x%04x: %02x\n", REG_CR, rtw_read8(adapter, REG_CR)); } +static u8 rtw_hal_wow_pattern_generate(_adapter *adapter, u8 idx, struct rtl_wow_pattern *pwow_pattern) +{ + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); + u8 *pattern; + u8 len = 0; + u8 *mask; + + u8 mask_hw[MAX_WKFM_SIZE] = {0}; + u8 content[MAX_WKFM_PATTERN_SIZE] = {0}; + u8 broadcast_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; + u8 multicast_addr1[2] = {0x33, 0x33}; + u8 multicast_addr2[3] = {0x01, 0x00, 0x5e}; + u8 mask_len = 0; + u8 mac_addr[ETH_ALEN] = {0}; + u16 count = 0; + int i, j; + + if (pwrctl->wowlan_pattern_idx > MAX_WKFM_CAM_NUM) { + RTW_ERR("%s pattern_idx is more than MAX_FMC_NUM: %d\n", + __func__, MAX_WKFM_CAM_NUM); + return _FAIL; + } + + pattern = pwrctl->patterns[idx].content; + len = pwrctl->patterns[idx].len; + mask = pwrctl->patterns[idx].mask; + + _rtw_memcpy(mac_addr, adapter_mac_addr(adapter), ETH_ALEN); + _rtw_memset(pwow_pattern, 0, sizeof(struct rtl_wow_pattern)); + + mask_len = DIV_ROUND_UP(len, 8); + + /* 1. setup A1 table */ + if (memcmp(pattern, broadcast_addr, ETH_ALEN) == 0) + pwow_pattern->type = PATTERN_BROADCAST; + else if (memcmp(pattern, multicast_addr1, 2) == 0) + pwow_pattern->type = PATTERN_MULTICAST; + else if (memcmp(pattern, multicast_addr2, 3) == 0) + pwow_pattern->type = PATTERN_MULTICAST; + else if (memcmp(pattern, mac_addr, ETH_ALEN) == 0) + pwow_pattern->type = PATTERN_UNICAST; + else + pwow_pattern->type = PATTERN_INVALID; + + /* translate mask from os to mask for hw */ + + /****************************************************************************** + * pattern from OS uses 'ethenet frame', like this: + + | 6 | 6 | 2 | 20 | Variable | 4 | + |--------+--------+------+-----------+------------+-----| + | 802.3 Mac Header | IP Header | TCP Packet | FCS | + | DA | SA | Type | + + * BUT, packet catched by our HW is in '802.11 frame', begin from LLC, + + | 24 or 30 | 6 | 2 | 20 | Variable | 4 | + |-------------------+--------+------+-----------+------------+-----| + | 802.11 MAC Header | LLC | IP Header | TCP Packet | FCS | + | Others | Tpye | + + * Therefore, we need translate mask_from_OS to mask_to_hw. + * We should left-shift mask by 6 bits, then set the new bit[0~5] = 0, + * because new mask[0~5] means 'SA', but our HW packet begins from LLC, + * bit[0~5] corresponds to first 6 Bytes in LLC, they just don't match. + ******************************************************************************/ + /* Shift 6 bits */ + for (i = 0; i < mask_len - 1; i++) { + mask_hw[i] = mask[i] >> 6; + mask_hw[i] |= (mask[i + 1] & 0x3F) << 2; + } + + mask_hw[i] = (mask[i] >> 6) & 0x3F; + /* Set bit 0-5 to zero */ + mask_hw[0] &= 0xC0; + + for (i = 0; i < (MAX_WKFM_SIZE / 4); i++) { + pwow_pattern->mask[i] = mask_hw[i * 4]; + pwow_pattern->mask[i] |= (mask_hw[i * 4 + 1] << 8); + pwow_pattern->mask[i] |= (mask_hw[i * 4 + 2] << 16); + pwow_pattern->mask[i] |= (mask_hw[i * 4 + 3] << 24); + } + + /* To get the wake up pattern from the mask. + * We do not count first 12 bits which means + * DA[6] and SA[6] in the pattern to match HW design. */ + count = 0; + for (i = 12; i < len; i++) { + if ((mask[i / 8] >> (i % 8)) & 0x01) { + content[count] = pattern[i]; + count++; + } + } + + pwow_pattern->crc = rtw_calc_crc(content, count); + + if (pwow_pattern->crc != 0) { + if (pwow_pattern->type == PATTERN_INVALID) + pwow_pattern->type = PATTERN_VALID; + } + + return _SUCCESS; +} + +#ifndef CONFIG_WOW_PATTERN_HW_CAM static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) { u8 val8 = 0; @@ -6708,7 +7785,7 @@ static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) val8 = rtw_read8(adapter, REG_FIFOPAGE + 3); if (val8 != 0) - RTW_INFO("%s:[%04x]some PKTs in TXPKTBUF\n", + RTW_WARN("%s:[%04x]some PKTs in TXPKTBUF\n", __func__, (REG_FIFOPAGE + 3)); rtw_hal_reset_mac_rx(adapter); @@ -6719,7 +7796,7 @@ static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) rxff_bndy = rx_dma_buff_sz - 1; rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); - RTW_INFO("%s: wow mode, 0x%04x: 0x%04x\n", __func__, + RTW_DBG("%s: wow mode, 0x%04x: 0x%04x\n", __func__, REG_TRXFF_BNDY + 2, rtw_read16(adapter, (REG_TRXFF_BNDY + 2))); } else { @@ -6727,12 +7804,219 @@ static void rtw_hal_set_wow_rxff_boundary(_adapter *adapter, bool wow_mode) (u8 *)&rx_dma_buff_sz); rxff_bndy = rx_dma_buff_sz - 1; rtw_write16(adapter, (REG_TRXFF_BNDY + 2), rxff_bndy); - RTW_INFO("%s: normal mode, 0x%04x: 0x%04x\n", __func__, + RTW_DBG("%s: normal mode, 0x%04x: 0x%04x\n", __func__, REG_TRXFF_BNDY + 2, rtw_read16(adapter, (REG_TRXFF_BNDY + 2))); } } +bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx) +{ + u32 data_l = 0, data_h = 0, rx_dma_buff_sz = 0, page_sz = 0; + u16 offset, rx_buf_ptr = 0; + u16 cam_start_offset = 0; + u16 ctrl_l = 0, ctrl_h = 0; + u8 count = 0, tmp = 0; + int i = 0; + bool res = _TRUE; + + if (idx > MAX_WKFM_CAM_NUM) { + RTW_ERR("[Error]: %s, pattern index is out of range\n", + __func__); + return _FALSE; + } + + rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, + (u8 *)&rx_dma_buff_sz); + + if (rx_dma_buff_sz == 0) { + RTW_ERR("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); + return _FALSE; + } + + rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); + + if (page_sz == 0) { + RTW_ERR("[Error]: %s, page_sz is 0!!\n", __func__); + return _FALSE; + } + + offset = (u16)PageNum(rx_dma_buff_sz, page_sz); + cam_start_offset = offset * page_sz; + + ctrl_l = 0x0; + ctrl_h = 0x0; + + /* Enable RX packet buffer access */ + rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); + + /* Read the WKFM CAM */ + for (i = 0; i < (WKFMCAM_ADDR_NUM / 2); i++) { + /* + * Set Rx packet buffer offset. + * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. + * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE + * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 + * * Index: The index of the wake up frame mask + * * WKFMCAM_SIZE: the total size of one WKFM CAM + * * per entry offset of a WKFM CAM: Addr i * 4 bytes + */ + rx_buf_ptr = + (cam_start_offset + idx * WKFMCAM_SIZE + i * 8) >> 3; + rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); + + rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); + data_l = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_L); + data_h = rtw_read32(adapter, REG_PKTBUF_DBG_DATA_H); + + RTW_DBG("[%d]: %08x %08x\n", i, data_h, data_l); + + count = 0; + + do { + tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); + rtw_udelay_os(2); + count++; + } while (!tmp && count < 100); + + if (count >= 100) { + RTW_ERR("%s count:%d\n", __func__, count); + res = _FALSE; + } + } + + /* Disable RX packet buffer access */ + rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, + DISABLE_TRXPKT_BUF_ACCESS); + return res; +} + +bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, + struct rtl_wow_pattern *context) +{ + u32 data = 0, rx_dma_buff_sz = 0, page_sz = 0; + u16 offset, rx_buf_ptr = 0; + u16 cam_start_offset = 0; + u16 ctrl_l = 0, ctrl_h = 0; + u8 count = 0, tmp = 0; + int res = 0, i = 0; + + if (idx > MAX_WKFM_CAM_NUM) { + RTW_ERR("[Error]: %s, pattern index is out of range\n", + __func__); + return _FALSE; + } + + rtw_hal_get_def_var(adapter, HAL_DEF_RX_DMA_SZ_WOW, + (u8 *)&rx_dma_buff_sz); + + if (rx_dma_buff_sz == 0) { + RTW_ERR("[Error]: %s, rx_dma_buff_sz is 0!!\n", __func__); + return _FALSE; + } + + rtw_hal_get_def_var(adapter, HAL_DEF_RX_PAGE_SIZE, (u8 *)&page_sz); + + if (page_sz == 0) { + RTW_ERR("[Error]: %s, page_sz is 0!!\n", __func__); + return _FALSE; + } + + offset = (u16)PageNum(rx_dma_buff_sz, page_sz); + + cam_start_offset = offset * page_sz; + + if (IS_HARDWARE_TYPE_8188E(adapter)) { + ctrl_l = 0x0001; + ctrl_h = 0x0001; + } else { + ctrl_l = 0x0f01; + ctrl_h = 0xf001; + } + + /* Enable RX packet buffer access */ + rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, RXPKT_BUF_SELECT); + + /* Write the WKFM CAM */ + for (i = 0; i < WKFMCAM_ADDR_NUM; i++) { + /* + * Set Rx packet buffer offset. + * RxBufer pointer increases 1, we can access 8 bytes in Rx packet buffer. + * CAM start offset (unit: 1 byte) = Index*WKFMCAM_SIZE + * RxBufer pointer addr = (CAM start offset + per entry offset of a WKFMCAM)/8 + * * Index: The index of the wake up frame mask + * * WKFMCAM_SIZE: the total size of one WKFM CAM + * * per entry offset of a WKFM CAM: Addr i * 4 bytes + */ + rx_buf_ptr = + (cam_start_offset + idx * WKFMCAM_SIZE + i * 4) >> 3; + rtw_write16(adapter, REG_PKTBUF_DBG_CTRL, rx_buf_ptr); + + if (i == 0) { + if (context->type == PATTERN_VALID) + data = BIT(31); + else if (context->type == PATTERN_BROADCAST) + data = BIT(31) | BIT(26); + else if (context->type == PATTERN_MULTICAST) + data = BIT(31) | BIT(25); + else if (context->type == PATTERN_UNICAST) + data = BIT(31) | BIT(24); + + if (context->crc != 0) + data |= context->crc; + + rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); + rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); + } else if (i == 1) { + data = 0; + rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); + rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); + } else if (i == 2 || i == 4) { + data = context->mask[i - 2]; + rtw_write32(adapter, REG_PKTBUF_DBG_DATA_L, data); + /* write to RX packet buffer*/ + rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_l); + } else if (i == 3 || i == 5) { + data = context->mask[i - 2]; + rtw_write32(adapter, REG_PKTBUF_DBG_DATA_H, data); + /* write to RX packet buffer*/ + rtw_write16(adapter, REG_RXPKTBUF_CTRL, ctrl_h); + } + + count = 0; + do { + tmp = rtw_read8(adapter, REG_RXPKTBUF_CTRL); + rtw_udelay_os(2); + count++; + } while (tmp && count < 100); + + if (count >= 100) + res = _FALSE; + else + res = _TRUE; + } + + /* Disable RX packet buffer access */ + rtw_write8(adapter, REG_PKT_BUFF_ACCESS_CTRL, + DISABLE_TRXPKT_BUF_ACCESS); + + return res; +} +void rtw_clean_pattern(_adapter *adapter) +{ + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); + struct rtl_wow_pattern zero_pattern; + int i = 0; + + _rtw_memset(&zero_pattern, 0, sizeof(struct rtl_wow_pattern)); + + zero_pattern.type = PATTERN_INVALID; + + for (i = 0; i < MAX_WKFM_CAM_NUM; i++) + rtw_write_to_frame_mask(adapter, i, &zero_pattern); + + rtw_write8(adapter, REG_WKFMCAM_NUM, 0); +} static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, u8 len, u8 *mask, u8 idx) { @@ -6750,9 +8034,9 @@ static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, u16 count = 0; int i, j; - if (pwrctl->wowlan_pattern_idx > MAX_WKFM_NUM) { - RTW_INFO("%s pattern_idx is more than MAX_FMC_NUM: %d\n", - __func__, MAX_WKFM_NUM); + if (pwrctl->wowlan_pattern_idx > MAX_WKFM_CAM_NUM) { + RTW_ERR("%s pattern_idx is more than MAX_FMC_NUM: %d\n", + __func__, MAX_WKFM_CAM_NUM); return _FALSE; } @@ -6846,46 +8130,294 @@ static int rtw_hal_set_pattern(_adapter *adapter, u8 *pattern, return res; } - -static void rtw_hal_dl_pattern(_adapter *adapter, u8 mode) +void rtw_fill_pattern(_adapter *adapter) { - struct registry_priv *pregistrypriv = &adapter->registrypriv; + int i = 0, total = 0, index; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); - int i = 0, total = 0; + struct rtl_wow_pattern wow_pattern; total = pwrpriv->wowlan_pattern_idx; - if (total > MAX_WKFM_NUM) - total = MAX_WKFM_NUM; + if (total > MAX_WKFM_CAM_NUM) + total = MAX_WKFM_CAM_NUM; - rtw_clean_pattern(adapter); + for (i = 0 ; i < total ; i++) { + if (_SUCCESS == rtw_hal_wow_pattern_generate(adapter, i, &wow_pattern)) { + + index = i; + if (!pwrpriv->bInSuspend) + index += 2; + + if (rtw_write_to_frame_mask(adapter, index, &wow_pattern) == _FALSE) + RTW_ERR("%s: ERROR!! idx: %d write_to_frame_mask_cam fail\n", __func__, i); + } + + } + rtw_write8(adapter, REG_WKFMCAM_NUM, total); + +} + +#else /*CONFIG_WOW_PATTERN_HW_CAM*/ + +#define WOW_CAM_ACCESS_TIMEOUT_MS 200 +#define WOW_VALID_BIT BIT31 +#define WOW_BC_BIT BIT26 +#define WOW_MC_BIT BIT25 +#define WOW_UC_BIT BIT24 + +static u32 _rtw_wow_pattern_read_cam(_adapter *adapter, u8 addr) +{ + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + _mutex *mutex = &pwrpriv->wowlan_pattern_cam_mutex; + + u32 rdata = 0; + u32 cnt = 0; + systime start = 0; + u8 timeout = 0; + u8 rst = _FALSE; + + _enter_critical_mutex(mutex, NULL); + + rtw_write32(adapter, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | BIT_WKFCAM_ADDR_V2(addr)); + + start = rtw_get_current_time(); + while (1) { + if (rtw_is_surprise_removed(adapter)) + break; + + cnt++; + if (0 == (rtw_read32(adapter, REG_WKFMCAM_CMD) & BIT_WKFCAM_POLLING_V1)) { + rst = _SUCCESS; + break; + } + if (rtw_get_passing_time_ms(start) > WOW_CAM_ACCESS_TIMEOUT_MS) { + timeout = 1; + break; + } + } + + rdata = rtw_read32(adapter, REG_WKFMCAM_RWD); + + _exit_critical_mutex(mutex, NULL); + + /*RTW_INFO("%s ==> addr:0x%02x , rdata:0x%08x\n", __func__, addr, rdata);*/ + + if (timeout) + RTW_ERR(FUNC_ADPT_FMT" failed due to polling timeout\n", FUNC_ADPT_ARG(adapter)); + + return rdata; +} +void rtw_wow_pattern_read_cam_ent(_adapter *adapter, u8 id, struct rtl_wow_pattern *context) +{ + int i; + u32 rdata; + + _rtw_memset(context, 0, sizeof(struct rtl_wow_pattern)); + + for (i = 4; i >= 0; i--) { + rdata = _rtw_wow_pattern_read_cam(adapter, (id << 3) | i); + + switch (i) { + case 4: + if (rdata & WOW_BC_BIT) + context->type = PATTERN_BROADCAST; + else if (rdata & WOW_MC_BIT) + context->type = PATTERN_MULTICAST; + else if (rdata & WOW_UC_BIT) + context->type = PATTERN_UNICAST; + else + context->type = PATTERN_INVALID; + + context->crc = rdata & 0xFFFF; + break; + default: + _rtw_memcpy(&context->mask[i], (u8 *)(&rdata), 4); + break; + } + } +} + +static void _rtw_wow_pattern_write_cam(_adapter *adapter, u8 addr, u32 wdata) +{ + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + _mutex *mutex = &pwrpriv->wowlan_pattern_cam_mutex; + u32 cnt = 0; + systime start = 0, end = 0; + u8 timeout = 0; + + /*RTW_INFO("%s ==> addr:0x%02x , wdata:0x%08x\n", __func__, addr, wdata);*/ + _enter_critical_mutex(mutex, NULL); + + rtw_write32(adapter, REG_WKFMCAM_RWD, wdata); + rtw_write32(adapter, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | BIT_WKFCAM_WE | BIT_WKFCAM_ADDR_V2(addr)); + + start = rtw_get_current_time(); + while (1) { + if (rtw_is_surprise_removed(adapter)) + break; + + cnt++; + if (0 == (rtw_read32(adapter, REG_WKFMCAM_CMD) & BIT_WKFCAM_POLLING_V1)) + break; + + if (rtw_get_passing_time_ms(start) > WOW_CAM_ACCESS_TIMEOUT_MS) { + timeout = 1; + break; + } + } + end = rtw_get_current_time(); + + _exit_critical_mutex(mutex, NULL); + + if (timeout) { + RTW_ERR(FUNC_ADPT_FMT" addr:0x%02x, wdata:0x%08x, to:%u, polling:%u, %d ms\n" + , FUNC_ADPT_ARG(adapter), addr, wdata, timeout, cnt, rtw_get_time_interval_ms(start, end)); + } +} + +void rtw_wow_pattern_write_cam_ent(_adapter *adapter, u8 id, struct rtl_wow_pattern *context) +{ + int j; + u8 addr; + u32 wdata = 0; + + for (j = 4; j >= 0; j--) { + switch (j) { + case 4: + wdata = context->crc; + + if (PATTERN_BROADCAST == context->type) + wdata |= WOW_BC_BIT; + if (PATTERN_MULTICAST == context->type) + wdata |= WOW_MC_BIT; + if (PATTERN_UNICAST == context->type) + wdata |= WOW_UC_BIT; + if (PATTERN_INVALID != context->type) + wdata |= WOW_VALID_BIT; + break; + default: + wdata = context->mask[j]; + break; + } + + addr = (id << 3) + j; + + _rtw_wow_pattern_write_cam(adapter, addr, wdata); + } +} + +static u8 _rtw_wow_pattern_clean_cam(_adapter *adapter) +{ + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + _mutex *mutex = &pwrpriv->wowlan_pattern_cam_mutex; + u32 cnt = 0; + systime start = 0; + u8 timeout = 0; + u8 rst = _FAIL; + + _enter_critical_mutex(mutex, NULL); + rtw_write32(adapter, REG_WKFMCAM_CMD, BIT_WKFCAM_POLLING_V1 | BIT_WKFCAM_CLR_V1); + + start = rtw_get_current_time(); + while (1) { + if (rtw_is_surprise_removed(adapter)) + break; + + cnt++; + if (0 == (rtw_read32(adapter, REG_WKFMCAM_CMD) & BIT_WKFCAM_POLLING_V1)) { + rst = _SUCCESS; + break; + } + if (rtw_get_passing_time_ms(start) > WOW_CAM_ACCESS_TIMEOUT_MS) { + timeout = 1; + break; + } + } + _exit_critical_mutex(mutex, NULL); + + if (timeout) + RTW_ERR(FUNC_ADPT_FMT" falied ,polling timeout\n", FUNC_ADPT_ARG(adapter)); + + return rst; +} + +void rtw_clean_pattern(_adapter *adapter) +{ + if (_FAIL == _rtw_wow_pattern_clean_cam(adapter)) + RTW_ERR("rtw_clean_pattern failed\n"); +} + +void rtw_dump_wow_pattern(void *sel, struct rtl_wow_pattern *pwow_pattern, u8 idx) +{ + int j; + + RTW_PRINT_SEL(sel, "=======WOW CAM-ID[%d]=======\n", idx); + RTW_PRINT_SEL(sel, "[WOW CAM] type:%d\n", pwow_pattern->type); + RTW_PRINT_SEL(sel, "[WOW CAM] crc:0x%04x\n", pwow_pattern->crc); + for (j = 0; j < 4; j++) + RTW_PRINT_SEL(sel, "[WOW CAM] Mask:0x%08x\n", pwow_pattern->mask[j]); +} + +void rtw_fill_pattern(_adapter *adapter) +{ + int i = 0, total = 0; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + struct rtl_wow_pattern wow_pattern; + + total = pwrpriv->wowlan_pattern_idx; + + if (total > MAX_WKFM_CAM_NUM) + total = MAX_WKFM_CAM_NUM; + + for (i = 0 ; i < total ; i++) { + if (_SUCCESS == rtw_hal_wow_pattern_generate(adapter, i, &wow_pattern)) { + rtw_dump_wow_pattern(RTW_DBGDUMP, &wow_pattern, i); + rtw_wow_pattern_write_cam_ent(adapter, i, &wow_pattern); + } + } +} + +#endif +void rtw_wow_pattern_cam_dump(_adapter *adapter) +{ + +#ifndef CONFIG_WOW_PATTERN_HW_CAM + int i; + + for (i = 0 ; i < MAX_WKFM_CAM_NUM; i++) { + RTW_INFO("=======[%d]=======\n", i); + rtw_read_from_frame_mask(adapter, i); + } +#else + struct rtl_wow_pattern context; + int i; + + for (i = 0 ; i < MAX_WKFM_CAM_NUM; i++) { + rtw_wow_pattern_read_cam_ent(adapter, i, &context); + rtw_dump_wow_pattern(RTW_DBGDUMP, &context, i); + } + +#endif +} + + +static void rtw_hal_dl_pattern(_adapter *adapter, u8 mode) +{ + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); switch (mode) { case 0: - RTW_INFO("%s: total patterns: %d\n", __func__, total); + rtw_clean_pattern(adapter); + RTW_INFO("%s: total patterns: %d\n", __func__, pwrpriv->wowlan_pattern_idx); break; case 1: rtw_set_default_pattern(adapter); - for (i = 0 ; i < total ; i++) { - rtw_hal_set_pattern(adapter, - pwrpriv->patterns[i].content, - pwrpriv->patterns[i].len, - pwrpriv->patterns[i].mask, i); - } - rtw_write8(adapter, REG_WKFMCAM_NUM, total); - RTW_INFO("%s: pattern total: %d downloaded\n", - __func__, total); + rtw_fill_pattern(adapter); + RTW_INFO("%s: pattern total: %d downloaded\n", __func__, pwrpriv->wowlan_pattern_idx); break; case 2: - pwrpriv->wowlan_pattern_idx = DEFAULT_PATTERN_NUM; - - for (i = DEFAULT_PATTERN_NUM ; i < MAX_WKFM_NUM ; i++) { - _rtw_memset(pwrpriv->patterns[i].content, '\0', - sizeof(pwrpriv->patterns[i].content)); - _rtw_memset(pwrpriv->patterns[i].mask, '\0', - sizeof(pwrpriv->patterns[i].mask)); - pwrpriv->patterns[i].len = 0; - } + rtw_clean_pattern(adapter); + rtw_wow_pattern_sw_reset(adapter); RTW_INFO("%s: clean patterns\n", __func__); break; default: @@ -6899,13 +8431,14 @@ static void rtw_hal_wow_enable(_adapter *adapter) struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); struct security_priv *psecuritypriv = &adapter->securitypriv; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; struct sta_info *psta = NULL; + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); int res; u16 media_status_rpt; - RTW_PRINT("%s, WOWLAN_ENABLE\n", __func__); + RTW_INFO("%s, WOWLAN_ENABLE\n", __func__); rtw_hal_gate_bb(adapter, _TRUE); #ifdef CONFIG_GTK_OL if (psecuritypriv->binstallKCK_KEK == _TRUE) @@ -6914,106 +8447,175 @@ static void rtw_hal_wow_enable(_adapter *adapter) if (IS_HARDWARE_TYPE_8723B(adapter)) rtw_hal_backup_rate(adapter); - /* RX DMA stop */ - if (IS_HARDWARE_TYPE_8188E(adapter)) - rtw_hal_disable_tx_report(adapter); - - res = rtw_hal_pause_rx_dma(adapter); - if (res == _FAIL) - RTW_PRINT("[WARNING] pause RX DMA fail\n"); - - /* Reconfig RX_FF Boundary */ - rtw_hal_set_wow_rxff_boundary(adapter, _TRUE); - - /* redownload wow pattern */ - rtw_hal_dl_pattern(adapter, 1); - rtw_hal_fw_dl(adapter, _TRUE); media_status_rpt = RT_MEDIA_CONNECT; rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)&media_status_rpt); + /* RX DMA stop */ + #if defined(CONFIG_RTL8188E) + if (IS_HARDWARE_TYPE_8188E(adapter)) + rtw_hal_disable_tx_report(adapter); + #endif + + res = rtw_hal_pause_rx_dma(adapter); + if (res == _FAIL) + RTW_WARN("[WARNING] pause RX DMA fail\n"); + + #ifndef CONFIG_WOW_PATTERN_HW_CAM + /* Reconfig RX_FF Boundary */ + rtw_hal_set_wow_rxff_boundary(adapter, _TRUE); + #endif + + /* redownload wow pattern */ + rtw_hal_dl_pattern(adapter, 1); + if (!pwrctl->wowlan_pno_enable) { psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); - if (psta != NULL) + + if (psta != NULL) { + #ifdef CONFIG_FW_MULTI_PORT_SUPPORT + rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); + #endif + rtw_sta_media_status_rpt(adapter, psta, 1); + } } #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) /* Enable CPWM2 only. */ res = rtw_hal_enable_cpwm2(adapter); if (res == _FAIL) - RTW_PRINT("[WARNING] enable cpwm2 fail\n"); + RTW_WARN("[WARNING] enable cpwm2 fail\n"); #endif #ifdef CONFIG_GPIO_WAKEUP rtw_hal_switch_gpio_wl_ctrl(adapter, WAKEUP_GPIO_IDX, _TRUE); #endif /* Set WOWLAN H2C command. */ - RTW_PRINT("Set WOWLan cmd\n"); rtw_hal_set_fw_wow_related_cmd(adapter, 1); res = rtw_hal_check_wow_ctrl(adapter, _TRUE); if (res == _FALSE) - RTW_INFO("[Error]%s: set wowlan CMD fail!!\n", __func__); + RTW_ERR("[Error]%s: set wowlan CMD fail!!\n", __func__); pwrctl->wowlan_wake_reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); - RTW_PRINT("wowlan_wake_reason: 0x%02x\n", + RTW_INFO("%s: wowlan_wake_reason: 0x%02x\n", __func__, pwrctl->wowlan_wake_reason); #ifdef CONFIG_GTK_OL_DBG dump_sec_cam(RTW_DBGDUMP, adapter); + dump_sec_cam_cache(RTW_DBGDUMP, adapter); #endif #ifdef CONFIG_USB_HCI /* free adapter's resource */ rtw_mi_intf_stop(adapter); +#endif +#if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) /* Invoid SE0 reset signal during suspending*/ rtw_write8(adapter, REG_RSV_CTRL, 0x20); - rtw_write8(adapter, REG_RSV_CTRL, 0x60); -#endif /*CONFIG_USB_HCI*/ + if (IS_8188F(pHalData->version_id) == FALSE) + rtw_write8(adapter, REG_RSV_CTRL, 0x60); +#endif rtw_hal_gate_bb(adapter, _FALSE); } +#define DBG_WAKEUP_REASON +#ifdef DBG_WAKEUP_REASON +void _dbg_wake_up_reason_string(_adapter *adapter, const char *srt_res) +{ + RTW_INFO(ADPT_FMT "- wake up reason - %s\n", ADPT_ARG(adapter), srt_res); +} +void _dbg_rtw_wake_up_reason(_adapter *adapter, u8 reason) +{ + if (RX_PAIRWISEKEY == reason) + _dbg_wake_up_reason_string(adapter, "Rx pairwise key"); + else if (RX_GTK == reason) + _dbg_wake_up_reason_string(adapter, "Rx GTK"); + else if (RX_FOURWAY_HANDSHAKE == reason) + _dbg_wake_up_reason_string(adapter, "Rx four way handshake"); + else if (RX_DISASSOC == reason) + _dbg_wake_up_reason_string(adapter, "Rx disassoc"); + else if (RX_DEAUTH == reason) + _dbg_wake_up_reason_string(adapter, "Rx deauth"); + else if (RX_ARP_REQUEST == reason) + _dbg_wake_up_reason_string(adapter, "Rx ARP request"); + else if (FW_DECISION_DISCONNECT == reason) + _dbg_wake_up_reason_string(adapter, "FW detect disconnect"); + else if (RX_MAGIC_PKT == reason) + _dbg_wake_up_reason_string(adapter, "Rx magic packet"); + else if (RX_UNICAST_PKT == reason) + _dbg_wake_up_reason_string(adapter, "Rx unicast packet"); + else if (RX_PATTERN_PKT == reason) + _dbg_wake_up_reason_string(adapter, "Rx pattern packet"); + else if (RTD3_SSID_MATCH == reason) + _dbg_wake_up_reason_string(adapter, "RTD3 SSID match"); + else if (RX_REALWOW_V2_WAKEUP_PKT == reason) + _dbg_wake_up_reason_string(adapter, "Rx real WOW V2 wakeup packet"); + else if (RX_REALWOW_V2_ACK_LOST == reason) + _dbg_wake_up_reason_string(adapter, "Rx real WOW V2 ack lost"); + else if (ENABLE_FAIL_DMA_IDLE == reason) + _dbg_wake_up_reason_string(adapter, "enable fail DMA idle"); + else if (ENABLE_FAIL_DMA_PAUSE == reason) + _dbg_wake_up_reason_string(adapter, "enable fail DMA pause"); + else if (AP_OFFLOAD_WAKEUP == reason) + _dbg_wake_up_reason_string(adapter, "AP offload wakeup"); + else if (CLK_32K_UNLOCK == reason) + _dbg_wake_up_reason_string(adapter, "clk 32k unlock"); + else if (RTIME_FAIL_DMA_IDLE == reason) + _dbg_wake_up_reason_string(adapter, "RTIME fail DMA idle"); + else if (CLK_32K_LOCK == reason) + _dbg_wake_up_reason_string(adapter, "clk 32k lock"); + else + _dbg_wake_up_reason_string(adapter, "unknown reasoen"); +} +#endif + static void rtw_hal_wow_disable(_adapter *adapter) { struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); struct security_priv *psecuritypriv = &adapter->securitypriv; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; struct sta_info *psta = NULL; int res; u16 media_status_rpt; u8 val8; - RTW_PRINT("%s, WOWLAN_DISABLE\n", __func__); + RTW_INFO("%s, WOWLAN_DISABLE\n", __func__); if (!pwrctl->wowlan_pno_enable) { psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(pmlmepriv)); if (psta != NULL) rtw_sta_media_status_rpt(adapter, psta, 0); else - RTW_INFO("%s: psta is null\n", __func__); + RTW_WARN("%s: psta is null\n", __func__); } if (0) { - RTW_INFO("0x630:0x%02x\n", rtw_read8(adapter, 0x630)); - RTW_INFO("0x631:0x%02x\n", rtw_read8(adapter, 0x631)); + RTW_DBG("0x630:0x%02x\n", rtw_read8(adapter, 0x630)); + RTW_DBG("0x631:0x%02x\n", rtw_read8(adapter, 0x631)); + RTW_DBG("0x634:0x%02x\n", rtw_read8(adapter, 0x634)); + RTW_DBG("0x1c7:0x%02x\n", rtw_read8(adapter, 0x1c7)); } pwrctl->wowlan_wake_reason = rtw_read8(adapter, REG_WOWLAN_WAKE_REASON); - RTW_PRINT("wakeup_reason: 0x%02x\n", + RTW_INFO("%s: wakeup_reason: 0x%02x\n", __func__, pwrctl->wowlan_wake_reason); + #ifdef DBG_WAKEUP_REASON + _dbg_rtw_wake_up_reason(adapter, pwrctl->wowlan_wake_reason); + #endif rtw_hal_set_fw_wow_related_cmd(adapter, 0); res = rtw_hal_check_wow_ctrl(adapter, _FALSE); if (res == _FALSE) { - RTW_INFO("[Error]%s: disable WOW cmd fail\n!!", __func__); + RTW_ERR("[Error]%s: disable WOW cmd fail\n!!", __func__); rtw_hal_force_enable_rxdma(adapter); } @@ -7021,37 +8623,47 @@ static void rtw_hal_wow_disable(_adapter *adapter) res = rtw_hal_pause_rx_dma(adapter); if (res == _FAIL) - RTW_PRINT("[WARNING] pause RX DMA fail\n"); + RTW_WARN("[WARNING] pause RX DMA fail\n"); /* clean HW pattern match */ rtw_hal_dl_pattern(adapter, 0); + #ifndef CONFIG_WOW_PATTERN_HW_CAM /* config RXFF boundary to original */ rtw_hal_set_wow_rxff_boundary(adapter, _FALSE); - + #endif rtw_hal_release_rx_dma(adapter); + #if defined(CONFIG_RTL8188E) if (IS_HARDWARE_TYPE_8188E(adapter)) rtw_hal_enable_tx_report(adapter); - -#ifdef CONFIG_GTK_OL - if (((pwrctl->wowlan_wake_reason != RX_DISASSOC) || + #endif + + if ((pwrctl->wowlan_wake_reason != RX_DISASSOC) || (pwrctl->wowlan_wake_reason != RX_DEAUTH) || - (pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT)) && - psecuritypriv->binstallKCK_KEK == _TRUE) { + (pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT)) { rtw_hal_get_aoac_rpt(adapter); rtw_hal_update_sw_security_info(adapter); } -#endif /*CONFIG_GTK_OL*/ rtw_hal_fw_dl(adapter, _FALSE); #ifdef CONFIG_GPIO_WAKEUP + +#ifdef CONFIG_WAKEUP_GPIO_INPUT_MODE + if (pwrctl->is_high_active == 0) + rtw_hal_set_input_gpio(adapter, WAKEUP_GPIO_IDX); + else + rtw_hal_set_output_gpio(adapter, WAKEUP_GPIO_IDX, 0); +#else val8 = (pwrctl->is_high_active == 0) ? 1 : 0; - RTW_PRINT("Set Wake GPIO to default(%d).\n", val8); + RTW_INFO("%s: Set Wake GPIO to default(%d).\n", __func__, val8); + rtw_hal_set_output_gpio(adapter, WAKEUP_GPIO_IDX, val8); + rtw_hal_switch_gpio_wl_ctrl(adapter, WAKEUP_GPIO_IDX, _FALSE); #endif +#endif if ((pwrctl->wowlan_wake_reason != FW_DECISION_DISCONNECT) && (pwrctl->wowlan_wake_reason != RX_PAIRWISEKEY) && (pwrctl->wowlan_wake_reason != RX_DISASSOC) && @@ -7061,8 +8673,12 @@ static void rtw_hal_wow_disable(_adapter *adapter) rtw_hal_set_hwreg(adapter, HW_VAR_H2C_FW_JOINBSSRPT, (u8 *)&media_status_rpt); - if (psta != NULL) + if (psta != NULL) { + #ifdef CONFIG_FW_MULTI_PORT_SUPPORT + rtw_hal_set_default_port_id_cmd(adapter, psta->cmn.mac_id); + #endif rtw_sta_media_status_rpt(adapter, psta, 1); + } } rtw_hal_gate_bb(adapter, _FALSE); } @@ -7165,39 +8781,27 @@ void rtw_hal_set_p2p_wow_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 index, } #endif /* CONFIG_P2P_WOWLAN */ -#ifdef CONFIG_LPS_PG - #define LPSPG_RSVD_PAGE_SET_MACID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 0, 8, _value)/*used macid*/ - #define LPSPG_RSVD_PAGE_SET_MBSSCAMID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 8, 8, _value)/*used BSSID CAM entry*/ - #define LPSPG_RSVD_PAGE_SET_PMC_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 16, 8, _value)/*Max used Pattern Match CAM entry*/ - #define LPSPG_RSVD_PAGE_SET_MU_RAID_GID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 24, 8, _value)/*Max MU rate table Group ID*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x04, 0, 8, _value)/*used Security CAM entry number*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID1(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 0, 8, _value)/*used Security CAM entry -1*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID2(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 8, 8, _value)/*used Security CAM entry -2*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID3(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 16, 8, _value)/*used Security CAM entry -3*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID4(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 24, 8, _value)/*used Security CAM entry -4*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID5(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 0, 8, _value)/*used Security CAM entry -5*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID6(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 8, 8, _value)/*used Security CAM entry -6*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID7(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 16, 8, _value)/*used Security CAM entry -7*/ - #define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID8(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 24, 8, _value)/*used Security CAM entry -8*/ -#endif #ifdef CONFIG_LPS_PG #include "hal_halmac.h" #define DBG_LPSPG_SEC_DUMP #define LPS_PG_INFO_RSVD_LEN 16 +#define LPS_PG_INFO_RSVD_PAGE_NUM 1 +#define DBG_LPSPG_INFO_DUMP static void rtw_hal_set_lps_pg_info_rsvd_page(_adapter *adapter) { - u8 cur_pag_num = 0; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); struct sta_info *psta = rtw_get_stainfo(&adapter->stapriv, get_bssid(&adapter->mlmepriv)); struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + PHAL_DATA_TYPE phal_data = GET_HAL_DATA(adapter); u8 lps_pg_info[LPS_PG_INFO_RSVD_LEN] = {0}; #ifdef CONFIG_MBSSID_CAM u8 cam_id = INVALID_CAM_ID; #endif u8 *psec_cam_id = lps_pg_info + 8; u8 sec_cam_num = 0; + u8 drv_rsvdpage_num = 0; if (!psta) { RTW_ERR("%s [ERROR] sta is NULL\n", __func__); @@ -7205,33 +8809,48 @@ static void rtw_hal_set_lps_pg_info_rsvd_page(_adapter *adapter) return; } - LPSPG_RSVD_PAGE_SET_MACID(lps_pg_info, psta->mac_id); /*used macid*/ - RTW_INFO("[LPSPG-INFO] mac_id:%d\n", psta->mac_id); + /*Byte 0 - used macid*/ + LPSPG_RSVD_PAGE_SET_MACID(lps_pg_info, psta->cmn.mac_id); + RTW_INFO("[LPSPG-INFO] mac_id:%d\n", psta->cmn.mac_id); #ifdef CONFIG_MBSSID_CAM + /*Byte 1 - used BSSID CAM entry*/ cam_id = rtw_mbid_cam_search_by_ifaceid(adapter, adapter->iface_id); if (cam_id != INVALID_CAM_ID) - LPSPG_RSVD_PAGE_SET_MBSSCAMID(lps_pg_info, cam_id); /*used BSSID CAM entry*/ + LPSPG_RSVD_PAGE_SET_MBSSCAMID(lps_pg_info, cam_id); RTW_INFO("[LPSPG-INFO] mbss_cam_id:%d\n", cam_id); #endif #ifdef CONFIG_WOWLAN /*&& pattern match cam used*/ + /*Btye 2 - Max used Pattern Match CAM entry*/ if (pwrpriv->wowlan_mode == _TRUE && check_fwstate(&adapter->mlmepriv, _FW_LINKED) == _TRUE) { - LPSPG_RSVD_PAGE_SET_PMC_NUM(lps_pg_info, pwrpriv->wowlan_pattern_idx); /*Max used Pattern Match CAM entry*/ - RTW_INFO("[LPSPG-INFO] Max Pattern Match CAM entry :%d\n", _value); + LPSPG_RSVD_PAGE_SET_PMC_NUM(lps_pg_info, pwrpriv->wowlan_pattern_idx); + RTW_INFO("[LPSPG-INFO] Max Pattern Match CAM entry :%d\n", pwrpriv->wowlan_pattern_idx); } #endif #ifdef CONFIG_BEAMFORMING /*&& MU BF*/ - LPSPG_RSVD_PAGE_SET_MU_RAID_GID(lps_pg_info, _value); /*Max MU rate table Group ID*/ + /*Btye 3 - Max MU rate table Group ID*/ + LPSPG_RSVD_PAGE_SET_MU_RAID_GID(lps_pg_info, _value); RTW_INFO("[LPSPG-INFO] Max MU rate table Group ID :%d\n", _value); #endif + /*Btye 8 ~15 - used Security CAM entry */ sec_cam_num = rtw_get_sec_camid(adapter, 8, psec_cam_id); + + /*Btye 4 - used Security CAM entry number*/ if (sec_cam_num < 8) - LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(lps_pg_info, sec_cam_num); /*used Security CAM entry number*/ + LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(lps_pg_info, sec_cam_num); RTW_INFO("[LPSPG-INFO] Security CAM entry number :%d\n", sec_cam_num); + /*Btye 5 - Txbuf used page number for fw offload*/ + if (pwrpriv->wowlan_mode == _TRUE || pwrpriv->wowlan_ap_mode == _TRUE) + drv_rsvdpage_num = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); + else + drv_rsvdpage_num = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); + LPSPG_RSVD_PAGE_SET_DRV_RSVDPAGE_NUM(lps_pg_info, drv_rsvdpage_num); + RTW_INFO("[LPSPG-INFO] DRV's rsvd page numbers :%d\n", drv_rsvdpage_num); + #ifdef DBG_LPSPG_SEC_DUMP { int i; @@ -7254,9 +8873,13 @@ static void rtw_hal_set_lps_pg_info_rsvd_page(_adapter *adapter) rtw_halmac_download_rsvd_page(dvobj, pwrpriv->lpspg_rsvd_page_locate, lps_pg_info, LPS_PG_INFO_RSVD_LEN); +#ifdef DBG_LPSPG_INFO_DUMP + RTW_INFO("Get LPS-PG INFO from rsvd page_offset:%d\n", pwrpriv->lpspg_rsvd_page_locate); + rtw_dump_rsvd_page(RTW_DBGDUMP, adapter, pwrpriv->lpspg_rsvd_page_locate, 1); +#endif } -#define DBG_LPSPG_INFO_DUMP + static u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); @@ -7273,7 +8896,7 @@ static u8 rtw_hal_set_lps_pg_info_cmd(_adapter *adapter) SET_H2CCMD_LPSPG_MBID_CAM_EN(lpspg_info, 1); /*BSSIDCAM_En*/ #endif -#ifdef CONFIG_WOWLAN /*&& pattern match cam used*/ +#if defined(CONFIG_WOWLAN) && defined(CONFIG_WOW_PATTERN_HW_CAM) if (pwrpriv->wowlan_mode == _TRUE && check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { @@ -7326,6 +8949,62 @@ u8 rtw_hal_set_lps_pg_info(_adapter *adapter) return ret; } + +void rtw_hal_lps_pg_rssi_lv_decide(_adapter *adapter, struct sta_info *sta) +{ +#if 0 + if (sta->cmn.ra_info.rssi_level >= 4) + sta->lps_pg_rssi_lv = 3; /*RSSI High - 1SS_VHT_MCS7*/ + else if (sta->cmn.ra_info.rssi_level >= 2) + sta->lps_pg_rssi_lv = 2; /*RSSI Middle - 1SS_VHT_MCS3*/ + else + sta->lps_pg_rssi_lv = 1; /*RSSI Lower - Lowest_rate*/ +#else + sta->lps_pg_rssi_lv = 0; +#endif + RTW_INFO("%s mac-id:%d, rssi:%d, rssi_level:%d, lps_pg_rssi_lv:%d\n", + __func__, sta->cmn.mac_id, sta->cmn.rssi_stat.rssi, sta->cmn.ra_info.rssi_level, sta->lps_pg_rssi_lv); +} + +void rtw_hal_lps_pg_handler(_adapter *adapter, enum lps_pg_hdl_id hdl_id) +{ + switch (hdl_id) { + case LPS_PG_INFO_CFG: + rtw_hal_set_lps_pg_info(adapter); + break; + case LPS_PG_REDLEMEM: + { + /*set xmit_block*/ + rtw_set_xmit_block(adapter, XMIT_BLOCK_REDLMEM); + if (_FAIL == rtw_hal_fw_mem_dl(adapter, FW_EMEM)) + rtw_warn_on(1); + /*clearn xmit_block*/ + rtw_clr_xmit_block(adapter, XMIT_BLOCK_REDLMEM); + } + break; + + case LPS_PG_RESEND_H2C: + { + struct macid_ctl_t *macid_ctl = &adapter->dvobj->macid_ctl; + struct sta_info *sta; + int i; + + for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { + sta = macid_ctl->sta[i]; + if (sta && !is_broadcast_mac_addr(sta->cmn.mac_addr)) { + rtw_hal_lps_pg_rssi_lv_decide(adapter, sta); + set_sta_rate(adapter, sta); + sta->lps_pg_rssi_lv = 0; + } + } + } + break; + + default: + break; + } +} + #endif /*CONFIG_LPS_PG*/ /* @@ -7337,24 +9016,30 @@ u8 rtw_hal_set_lps_pg_info(_adapter *adapter) * so we need to set the packet length to total lengh. * TRUE: At the second time, we should send the first packet (default:beacon) * to Hw again and set the lengh in descriptor to the real beacon lengh. + * page_num - The amount of reserved page which driver need. + * If this is not NULL, this function doesn't real download reserved + * page, but just count the number of reserved page. + * * 2009.10.15 by tynli. + * 2017.06.20 modified by Lucas. * * Page Size = 128: 8188e, 8723a/b, 8192c/d, * Page Size = 256: 8192e, 8821a * Page Size = 512: 8812a */ -void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) +/*#define DBG_DUMP_SET_RSVD_PAGE*/ +static void _rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished, u8 *page_num) { PHAL_DATA_TYPE pHalData; - struct xmit_frame *pcmdframe; + struct xmit_frame *pcmdframe = NULL; struct pkt_attrib *pattrib; struct xmit_priv *pxmitpriv; struct mlme_ext_priv *pmlmeext; struct mlme_ext_info *pmlmeinfo; struct pwrctrl_priv *pwrctl; struct mlme_priv *pmlmepriv = &adapter->mlmepriv; - struct hal_ops *pHalFunc = &adapter->HalFunc; + struct hal_ops *pHalFunc = &adapter->hal_func; u32 BeaconLength = 0, ProbeRspLength = 0, PSPollLength = 0; u32 NullDataLength = 0, QosNullLength = 0, BTQosNullLength = 0; u32 ProbeReqLength = 0, NullFunctionDataLength = 0; @@ -7389,33 +9074,42 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) return; } - if (pwrctl->wowlan_mode == _TRUE || pwrctl->wowlan_ap_mode == _TRUE) - RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); - else - RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); + /* Prepare ReservedPagePacket */ + if (page_num) { + ReservedPagePacket = rtw_zmalloc(MAX_CMDBUF_SZ); + if (!ReservedPagePacket) { + RTW_WARN("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); + *page_num = 0xFF; + return; + } + } else { + if (pwrctl->wowlan_mode == _TRUE || pwrctl->wowlan_ap_mode == _TRUE) + RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _TRUE); + else + RsvdPageNum = rtw_hal_get_txbuff_rsvd_page_num(adapter, _FALSE); - RTW_INFO("%s PageSize: %d, RsvdPageNUm: %d\n", __func__, PageSize, RsvdPageNum); + RTW_INFO("%s PageSize: %d, RsvdPageNUm: %d\n", __func__, PageSize, RsvdPageNum); - MaxRsvdPageBufSize = RsvdPageNum * PageSize; + MaxRsvdPageBufSize = RsvdPageNum * PageSize; + if (MaxRsvdPageBufSize > MAX_CMDBUF_SZ) { + RTW_ERR("%s MaxRsvdPageBufSize(%d) is larger than MAX_CMDBUF_SZ(%d)", + __func__, MaxRsvdPageBufSize, MAX_CMDBUF_SZ); + rtw_warn_on(1); + return; + } - if (MaxRsvdPageBufSize > MAX_CMDBUF_SZ) { - RTW_INFO("%s MaxRsvdPageBufSize(%d) is larger than MAX_CMDBUF_SZ(%d)", - __func__, MaxRsvdPageBufSize, MAX_CMDBUF_SZ); - rtw_warn_on(1); - return; + pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); + if (pcmdframe == NULL) { + RTW_ERR("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); + return; + } + + ReservedPagePacket = pcmdframe->buf_addr; } - pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv); - - if (pcmdframe == NULL) { - RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __FUNCTION__); - return; - } - - ReservedPagePacket = pcmdframe->buf_addr; _rtw_memset(&RsvdPageLoc, 0, sizeof(RSVDPAGE_LOC)); - /* beacon * 2 pages */ + /* beacon * 1 pages */ BufIndex = TxDescOffset; rtw_hal_construct_beacon(adapter, &ReservedPagePacket[BufIndex], &BeaconLength); @@ -7425,9 +9119,6 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) * packet, it will be filled in front of the packet in TXPKTBUF. */ CurtPktPageNum = (u8)PageNum((TxDescLen + BeaconLength), PageSize); - /* If we don't add 1 more page, ARP offload function will fail at 8723bs.*/ - if (CurtPktPageNum == 1) - CurtPktPageNum += 1; TotalPageNum += CurtPktPageNum; @@ -7467,24 +9158,29 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) BufIndex += (CurtPktPageNum * PageSize); #ifdef CONFIG_BT_COEXIST - /* BT Qos null data * 1 page */ - RsvdPageLoc.LocBTQosNull = TotalPageNum; - RTW_INFO("LocBTQosNull: %d\n", RsvdPageLoc.LocBTQosNull); - rtw_hal_construct_NullFunctionData( - adapter, - &ReservedPagePacket[BufIndex], - &BTQosNullLength, - get_my_bssid(&pmlmeinfo->network), - _TRUE, 0, 0, _FALSE); - rtw_hal_fill_fake_txdesc(adapter, - &ReservedPagePacket[BufIndex - TxDescLen], - BTQosNullLength, _FALSE, _TRUE, _FALSE); + if (pwrctl->wowlan_mode == _FALSE || + pwrctl->wowlan_in_resume == _TRUE) { + /* BT Qos null data * 1 page */ + RsvdPageLoc.LocBTQosNull = TotalPageNum; - CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, PageSize); + RTW_INFO("LocBTQosNull: %d\n", RsvdPageLoc.LocBTQosNull); - TotalPageNum += CurtPktPageNum; + rtw_hal_construct_NullFunctionData(adapter, + &ReservedPagePacket[BufIndex], + &BTQosNullLength, + get_my_bssid(&pmlmeinfo->network), + _TRUE, 0, 0, _FALSE); - BufIndex += (CurtPktPageNum * PageSize); + rtw_hal_fill_fake_txdesc(adapter, + &ReservedPagePacket[BufIndex - TxDescLen], + BTQosNullLength, _FALSE, _TRUE, _FALSE); + + CurtPktPageNum = (u8)PageNum(TxDescLen + BTQosNullLength, + PageSize); + + TotalPageNum += CurtPktPageNum; + BufIndex += (CurtPktPageNum * PageSize); + } #endif /* CONFIG_BT_COEXIT */ #ifdef CONFIG_MCC_MODE @@ -7492,12 +9188,13 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) dl_mcc_page = rtw_hal_dl_mcc_fw_rsvd_page(adapter, ReservedPagePacket, &BufIndex, TxDescLen, PageSize, &TotalPageNum, &TotalPacketLen, &RsvdPageLoc); - } else + } else { dl_mcc_page = _FAIL; + } - if (dl_mcc_page == _FAIL) { + if (dl_mcc_page == _FAIL) #endif /* CONFIG_MCC_MODE */ - + { /* null data * 1 page */ RsvdPageLoc.LocNullData = TotalPageNum; RTW_INFO("LocNullData: %d\n", RsvdPageLoc.LocNullData); @@ -7516,31 +9213,32 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) TotalPageNum += CurtPktPageNum; BufIndex += (CurtPktPageNum * PageSize); -#ifdef CONFIG_MCC_MODE } -#endif /* CONFIG_MCC_MODE */ - /* Qos null data * 1 page */ - RsvdPageLoc.LocQosNull = TotalPageNum; - RTW_INFO("LocQosNull: %d\n", RsvdPageLoc.LocQosNull); - rtw_hal_construct_NullFunctionData( - adapter, - &ReservedPagePacket[BufIndex], - &QosNullLength, - get_my_bssid(&pmlmeinfo->network), - _TRUE, 0, 0, _FALSE); - rtw_hal_fill_fake_txdesc(adapter, + if (pwrctl->wowlan_mode == _FALSE || + pwrctl->wowlan_in_resume == _TRUE) { + /* Qos null data * 1 page */ + RsvdPageLoc.LocQosNull = TotalPageNum; + RTW_INFO("LocQosNull: %d\n", RsvdPageLoc.LocQosNull); + rtw_hal_construct_NullFunctionData(adapter, + &ReservedPagePacket[BufIndex], + &QosNullLength, + get_my_bssid(&pmlmeinfo->network), + _TRUE, 0, 0, _FALSE); + rtw_hal_fill_fake_txdesc(adapter, &ReservedPagePacket[BufIndex - TxDescLen], QosNullLength, _FALSE, _FALSE, _FALSE); - CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, PageSize); + CurtPktPageNum = (u8)PageNum(TxDescLen + QosNullLength, + PageSize); - TotalPageNum += CurtPktPageNum; + TotalPageNum += CurtPktPageNum; + + BufIndex += (CurtPktPageNum * PageSize); + } TotalPacketLen = BufIndex + QosNullLength; - BufIndex += (CurtPktPageNum * PageSize); - #ifdef CONFIG_WOWLAN if (pwrctl->wowlan_mode == _TRUE && pwrctl->wowlan_in_resume == _FALSE) { @@ -7562,15 +9260,35 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) /* must reserved last 1 x page for LPS PG Info*/ pwrctl->lpspg_rsvd_page_locate = TotalPageNum; pwrctl->blpspg_info_up = _TRUE; + if (page_num) + TotalPageNum += LPS_PG_INFO_RSVD_PAGE_NUM; #endif download_page: + if (page_num) { + *page_num = TotalPageNum; + rtw_mfree(ReservedPagePacket, MAX_CMDBUF_SZ); + ReservedPagePacket = NULL; + return; + } + /* RTW_INFO("%s BufIndex(%d), TxDescLen(%d), PageSize(%d)\n",__func__, BufIndex, TxDescLen, PageSize);*/ RTW_INFO("%s PageNum(%d), pktlen(%d)\n", __func__, TotalPageNum, TotalPacketLen); +#ifdef CONFIG_LPS_PG + if ((TotalPacketLen + (LPS_PG_INFO_RSVD_PAGE_NUM * PageSize)) > MaxRsvdPageBufSize) { + pwrctl->lpspg_rsvd_page_locate = 0; + pwrctl->blpspg_info_up = _FALSE; + + RTW_ERR("%s rsvd page size is not enough!!TotalPacketLen+LPS_PG_INFO_LEN %d, MaxRsvdPageBufSize %d\n", + __func__, (TotalPacketLen + (LPS_PG_INFO_RSVD_PAGE_NUM * PageSize)), MaxRsvdPageBufSize); + rtw_warn_on(1); + } +#endif + if (TotalPacketLen > MaxRsvdPageBufSize) { - RTW_INFO("%s(ERROR): rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", + RTW_ERR("%s(ERROR): rsvd page size is not enough!!TotalPacketLen %d, MaxRsvdPageBufSize %d\n", __FUNCTION__, TotalPacketLen, MaxRsvdPageBufSize); rtw_warn_on(1); goto error; @@ -7590,7 +9308,11 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) RTW_INFO("%s: Set RSVD page location to Fw ,TotalPacketLen(%d), TotalPageNum(%d)\n", __func__, TotalPacketLen, TotalPageNum); - +#ifdef DBG_DUMP_SET_RSVD_PAGE + RTW_INFO(" ==================================================\n"); + RTW_INFO_DUMP("\n", ReservedPagePacket, TotalPacketLen); + RTW_INFO(" ==================================================\n"); +#endif if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { rtw_hal_set_FwRsvdPage_cmd(adapter, &RsvdPageLoc); #ifdef CONFIG_WOWLAN @@ -7613,14 +9335,205 @@ void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished) &RsvdPageLoc, 1); #endif /* CONFIG_PNO_SUPPORT */ } + #ifdef CONFIG_P2P_WOWLAN if (_TRUE == pwrctl->wowlan_p2p_mode) rtw_hal_set_FwP2PRsvdPage_cmd(adapter, &RsvdPageLoc); #endif /* CONFIG_P2P_WOWLAN */ + return; error: rtw_free_xmitframe(pxmitpriv, pcmdframe); } + +void rtw_hal_set_fw_rsvd_page(struct _ADAPTER *adapter, bool finished) +{ + _rtw_hal_set_fw_rsvd_page(adapter, finished, NULL); +} + +/** + * rtw_hal_get_rsvd_page_num() - Get needed reserved page number + * @adapter: struct _ADAPTER* + * + * Caculate needed reserved page number. + * In different state would get different number, for example normal mode and + * WOW mode would need different reserved page size. + * + * Return the number of reserved page which driver need. + */ +u8 rtw_hal_get_rsvd_page_num(struct _ADAPTER *adapter) +{ + u8 num = 0; + + + _rtw_hal_set_fw_rsvd_page(adapter, _FALSE, &num); + + return num; +} + +static void hw_var_set_mlme_sitesurvey(_adapter *adapter, u8 variable, u8 *val) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + u16 value_rxfltmap2; + int i; + _adapter *iface; + +#ifdef DBG_IFACE_STATUS + DBG_IFACE_STATUS_DUMP(adapter); +#endif + +#ifdef CONFIG_FIND_BEST_CHANNEL + /* Receive all data frames */ + value_rxfltmap2 = 0xFFFF; +#else + /* not to receive data frame */ + value_rxfltmap2 = 0; +#endif + + if (*((u8 *)val)) { /* under sitesurvey */ + /* + * 1. configure REG_RXFLTMAP2 + * 2. disable TSF update & buddy TSF update to avoid updating wrong TSF due to clear RCR_CBSSID_BCN + * 3. config RCR to receive different BSSID BCN or probe rsp + */ + rtw_write16(adapter, REG_RXFLTMAP2, value_rxfltmap2); + +#ifdef CONFIG_MI_WITH_MBSSID_CAM + /*do nothing~~*/ +#else + + /* disable update TSF */ + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + + if (rtw_linked_check(iface) + && !MLME_IS_AP(iface) && !MLME_IS_MESH(iface) + ) { + if (iface->hw_port == HW_PORT1) + rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1) | DIS_TSF_UDT); + else + rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL) | DIS_TSF_UDT); + + iface->mlmeextpriv.en_hw_update_tsf = _FALSE; + } + } +#endif /* CONFIG_MI_WITH_MBSSID_CAM */ + + rtw_hal_rcr_set_chk_bssid(adapter, MLME_SCAN_ENTER); + + /* Save orignal RRSR setting. needed? */ + hal_data->RegRRSR = rtw_read16(adapter, REG_RRSR); + + #if defined(CONFIG_BEAMFORMING) && (defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A)) + if (IS_8812_SERIES(hal_data->version_id) || IS_8821_SERIES(hal_data->version_id)) { + /* set 718[1:0]=2'b00 to avoid BF scan hang */ + hal_data->backup_snd_ptcl_ctrl = rtw_read8(adapter, REG_SND_PTCL_CTRL_8812A); + rtw_write8(adapter, REG_SND_PTCL_CTRL_8812A, (hal_data->backup_snd_ptcl_ctrl & 0xfc)); + } + #endif + + if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) + StopTxBeacon(adapter); + } else { /* sitesurvey done */ + /* + * 1. enable rx data frame + * 2. config RCR not to receive different BSSID BCN or probe rsp + * 3. doesn't enable TSF update & buddy TSF right now to avoid HW conflict + * so, we enable TSF update when rx first BCN after sitesurvey done + */ + if (rtw_mi_check_fwstate(adapter, _FW_LINKED | WIFI_AP_STATE | WIFI_MESH_STATE)) { + /* enable to rx data frame */ + rtw_write16(adapter, REG_RXFLTMAP2, 0xFFFF); + } + + rtw_hal_rcr_set_chk_bssid(adapter, MLME_SCAN_DONE); + +#ifdef CONFIG_MI_WITH_MBSSID_CAM + /*if ((rtw_mi_get_assoced_sta_num(adapter) == 1) && (!rtw_mi_check_status(adapter, MI_AP_MODE))) + rtw_write8(adapter, REG_BCN_CTRL, rtw_read8(adapter, REG_BCN_CTRL)&(~DIS_TSF_UDT));*/ +#else + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + if (rtw_linked_check(iface) + && !MLME_IS_AP(iface) && !MLME_IS_MESH(iface) + ) { + /* enable HW TSF update when recive beacon*/ + /*if (iface->hw_port == HW_PORT1) + rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1)&(~(DIS_TSF_UDT))); + else + rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL)&(~(DIS_TSF_UDT))); + */ + iface->mlmeextpriv.en_hw_update_tsf = _TRUE; + } + } +#endif /* CONFIG_MI_WITH_MBSSID_CAM */ + + /* Restore orignal RRSR setting. needed? */ + rtw_write16(adapter, REG_RRSR, hal_data->RegRRSR); + + #if defined(CONFIG_BEAMFORMING) && (defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A)) + if (IS_8812_SERIES(hal_data->version_id) || IS_8821_SERIES(hal_data->version_id)) { + /* Restore orignal 0x718 setting*/ + rtw_write8(adapter, REG_SND_PTCL_CTRL_8812A, hal_data->backup_snd_ptcl_ctrl); + } + #endif + + if (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) { + ResumeTxBeacon(adapter); + rtw_mi_tx_beacon_hdl(adapter); + } + } +} + +#ifdef CONFIG_TSF_RESET_OFFLOAD +static int rtw_hal_h2c_reset_tsf(_adapter *adapter, u8 reset_port) +{ + u8 buf[2]; + int ret; + + if (reset_port == HW_PORT0) { + buf[0] = 0x1; + buf[1] = 0; + } else { + buf[0] = 0x0; + buf[1] = 0x1; + } + + ret = rtw_hal_fill_h2c_cmd(adapter, H2C_RESET_TSF, 2, buf); + + return ret; +} + +int rtw_hal_reset_tsf(_adapter *adapter, u8 reset_port) +{ + u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; + u32 reg_reset_tsf_cnt = (reset_port == HW_PORT0) ? + REG_FW_RESET_TSF_CNT_0 : REG_FW_RESET_TSF_CNT_1; + int ret; + + /* site survey will cause reset tsf fail */ + rtw_mi_buddy_scan_abort(adapter, _FALSE); + reset_cnt_after = reset_cnt_before = rtw_read8(adapter, reg_reset_tsf_cnt); + ret = rtw_hal_h2c_reset_tsf(adapter, reset_port); + if (ret != _SUCCESS) + return ret; + + while ((reset_cnt_after == reset_cnt_before) && (loop_cnt < 10)) { + rtw_msleep_os(100); + loop_cnt++; + reset_cnt_after = rtw_read8(adapter, reg_reset_tsf_cnt); + } + + return (loop_cnt >= 10) ? _FAIL : _SUCCESS; +} +#endif /* CONFIG_TSF_RESET_OFFLOAD */ + static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) { struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; @@ -7635,13 +9548,14 @@ static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) if (!pmlmeext->en_hw_update_tsf) return; - /* check REG_RCR bit is set */ - if (!(rtw_read32(padapter, REG_RCR) & RCR_CBSSID_BCN)) + /* check RCR */ + if (!rtw_hal_rcr_check(padapter, RCR_CBSSID_BCN)) return; - /* enable hw update tsf function for non-AP */ - if (rtw_linked_check(padapter) && - check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) { + /* enable hw update tsf function for non-AP and non-Mesh */ + if (rtw_linked_check(padapter) + && !MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter) + ) { #ifdef CONFIG_CONCURRENT_MODE if (padapter->hw_port == HW_PORT1) rtw_write8(padapter, REG_BCN_CTRL_1, rtw_read8(padapter, REG_BCN_CTRL_1) & (~DIS_TSF_UDT)); @@ -7652,6 +9566,60 @@ static void rtw_hal_set_hw_update_tsf(PADAPTER padapter) pmlmeext->en_hw_update_tsf = _FALSE; } +static void hw_var_set_correct_tsf(_adapter *adapter) +{ +#ifdef CONFIG_MI_WITH_MBSSID_CAM + /*do nothing*/ +#else + u64 tsf; + struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *mlmeinfo = &(mlmeext->mlmext_info); + + tsf = mlmeext->TSFValue - rtw_modular64(mlmeext->TSFValue, (mlmeinfo->bcn_interval * 1024)) - 1024; /*us*/ + + if ((mlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE + || (mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) + StopTxBeacon(adapter); + + rtw_hal_correct_tsf(adapter, adapter->hw_port, tsf); + +#ifdef CONFIG_CONCURRENT_MODE + /* Update buddy port's TSF if it is SoftAP/Mesh for beacon TX issue! */ + if ((mlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE + && (rtw_mi_get_ap_num(adapter) || rtw_mi_get_mesh_num(adapter)) + ) { + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + int i; + _adapter *iface; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (!iface) + continue; + if (iface == adapter) + continue; + + if ((MLME_IS_AP(iface) || MLME_IS_MESH(iface)) + && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE + ) { + rtw_hal_correct_tsf(iface, iface->hw_port, tsf); + #ifdef CONFIG_TSF_RESET_OFFLOAD + if (rtw_hal_reset_tsf(iface, iface->hw_port) == _FAIL) + RTW_INFO("%s-[ERROR] "ADPT_FMT" Reset port%d TSF fail\n" + , __func__, ADPT_ARG(iface), iface->hw_port); + #endif /* CONFIG_TSF_RESET_OFFLOAD*/ + } + } + } +#endif /* CONFIG_CONCURRENT_MODE */ + + if ((mlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE + || (mlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) + ResumeTxBeacon(adapter); + +#endif /*CONFIG_MI_WITH_MBSSID_CAM*/ +} + #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset, u16 bwmode) @@ -7673,16 +9641,41 @@ s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset default: break; } - SET_H2CCMD_CH_SW_OPER_OFFLOAD_RFE_TYPE(ch_sw_h2c_buf, pHalData->RFEType); + SET_H2CCMD_CH_SW_OPER_OFFLOAD_RFE_TYPE(ch_sw_h2c_buf, pHalData->rfe_type); return rtw_hal_fill_h2c_cmd(padapter, H2C_CHNL_SWITCH_OPER_OFFLOAD, sizeof(ch_sw_h2c_buf), ch_sw_h2c_buf); } #endif #endif -void SetHwReg(_adapter *adapter, u8 variable, u8 *val) +#ifdef CONFIG_WMMPS_STA +void rtw_hal_update_uapsd_tid(_adapter *adapter) +{ + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct qos_priv *pqospriv = &pmlmepriv->qospriv; + + /* write complement of pqospriv->uapsd_tid to mac register 0x693 because + it's designed for "0" represents "enable" and "1" represents "disable" */ + rtw_write8(adapter, REG_WMMPS_UAPSD_TID, (u8)(~pqospriv->uapsd_tid)); +} +#endif /* CONFIG_WMMPS_STA */ + +#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) +/* For multi-port support, driver needs to inform the port ID to FW for btc operations */ +s32 rtw_hal_set_wifi_port_id_cmd(_adapter *adapter) +{ + u8 port_id = 0; + u8 h2c_buf[H2C_BTC_WL_PORT_ID_LEN] = {0}; + + SET_H2CCMD_BTC_WL_PORT_ID(h2c_buf, adapter->hw_port); + return rtw_hal_fill_h2c_cmd(adapter, H2C_BTC_WL_PORT_ID, H2C_BTC_WL_PORT_ID_LEN, h2c_buf); +} +#endif + +u8 SetHwReg(_adapter *adapter, u8 variable, u8 *val) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + u8 ret = _SUCCESS; switch (variable) { case HW_VAR_MEDIA_STATUS: { @@ -7701,6 +9694,18 @@ void SetHwReg(_adapter *adapter, u8 variable, u8 *val) case HW_VAR_BSSID: rtw_hal_set_bssid(adapter, val); break; + case HW_VAR_RCR: + ret = hw_var_rcr_config(adapter, *((u32 *)val)); + break; + case HW_VAR_ON_RCR_AM: + hw_var_set_rcr_am(adapter, 1); + break; + case HW_VAR_OFF_RCR_AM: + hw_var_set_rcr_am(adapter, 0); + break; + case HW_VAR_BEACON_INTERVAL: + hw_var_set_bcn_interval(adapter, *(u16 *)val); + break; #ifdef CONFIG_MBSSID_CAM case HW_VAR_MBSSID_CAM_WRITE: { u32 cmd = 0; @@ -7723,14 +9728,9 @@ void SetHwReg(_adapter *adapter, u8 variable, u8 *val) break; case HW_VAR_RCR_MBSSID_EN: if (*((u8 *)val)) - rtw_write32(adapter, REG_RCR, rtw_read32(adapter, REG_RCR) | RCR_ENMBID); - else { - u32 val32; - - val32 = rtw_read32(adapter, REG_RCR); - val32 &= ~(RCR_ENMBID); - rtw_write32(adapter, REG_RCR, val32); - } + rtw_hal_rcr_add(adapter, RCR_ENMBID); + else + rtw_hal_rcr_clear(adapter, RCR_ENMBID); break; #endif case HW_VAR_PORT_SWITCH: @@ -7739,7 +9739,7 @@ void SetHwReg(_adapter *adapter, u8 variable, u8 *val) case HW_VAR_INIT_RTS_RATE: { u16 brate_cfg = *((u16 *)val); u8 rate_index = 0; - HAL_VERSION *hal_ver = &hal_data->VersionID; + HAL_VERSION *hal_ver = &hal_data->version_id; if (IS_8188E(*hal_ver)) { @@ -7831,29 +9831,62 @@ void SetHwReg(_adapter *adapter, u8 variable, u8 *val) break; #endif /*defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN)*/ + case HW_VAR_MLME_SITESURVEY: + hw_var_set_mlme_sitesurvey(adapter, variable, val); + #ifdef CONFIG_BT_COEXIST + if (hal_data->EEPROMBluetoothCoexist == 1) + rtw_btcoex_ScanNotify(adapter, *val ? _TRUE : _FALSE); + #endif + break; + case HW_VAR_EN_HW_UPDATE_TSF: rtw_hal_set_hw_update_tsf(adapter); break; + case HW_VAR_CORRECT_TSF: + hw_var_set_correct_tsf(adapter); + break; + case HW_VAR_APFM_ON_MAC: hal_data->bMacPwrCtrlOn = *val; RTW_INFO("%s: bMacPwrCtrlOn=%d\n", __func__, hal_data->bMacPwrCtrlOn); break; +#ifdef CONFIG_WMMPS_STA + case HW_VAR_UAPSD_TID: + rtw_hal_update_uapsd_tid(adapter); + break; +#endif /* CONFIG_WMMPS_STA */ +#ifdef CONFIG_LPS_PG + case HW_VAR_LPS_PG_HANDLE: + rtw_hal_lps_pg_handler(adapter, *val); + break; +#endif +#ifdef CONFIG_LPS_LCLK_WD_TIMER + case HW_VAR_DM_IN_LPS_LCLK: + rtw_phydm_wd_lps_lclk_hdl(adapter); + break; +#endif default: if (0) RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", FUNC_ADPT_ARG(adapter), variable); + ret = _FAIL; break; } + return ret; } void GetHwReg(_adapter *adapter, u8 variable, u8 *val) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + u64 val64; switch (variable) { + case HW_VAR_MAC_ADDR: + rtw_hal_get_macaddr_port(adapter, val); + break; case HW_VAR_BASIC_RATE: *((u16 *)val) = hal_data->BasicRateSet; break; @@ -7875,6 +9908,41 @@ void GetHwReg(_adapter *adapter, u8 variable, u8 *val) case HW_VAR_APFM_ON_MAC: *val = hal_data->bMacPwrCtrlOn; break; + case HW_VAR_RCR: + hw_var_rcr_get(adapter, (u32 *)val); + break; + case HW_VAR_FWLPS_RF_ON: + /* When we halt NIC, we should check if FW LPS is leave. */ + if (rtw_is_surprise_removed(adapter) + || (adapter_to_pwrctl(adapter)->rf_pwrstate == rf_off) + ) { + /* + * If it is in HW/SW Radio OFF or IPS state, + * we do not check Fw LPS Leave, + * because Fw is unload. + */ + *val = _TRUE; + } else { + u32 rcr = 0; + + rtw_hal_get_hwreg(adapter, HW_VAR_RCR, (u8 *)&rcr); + if (rcr & (RCR_UC_MD_EN | RCR_BC_MD_EN | RCR_TIM_PARSER_EN)) + *val = _FALSE; + else + *val = _TRUE; + } + break; + + case HW_VAR_TSF: + /* read and save HIGH 32bits TSF value */ + val64 = rtw_read32(adapter, REG_TSFTR+4); + val64 = val64 << 32; + + /* read and save LOW 32bits TSF value */ + val64 |= rtw_read32(adapter, REG_TSFTR); + *((u64*)val) = val64; + break; + default: if (0) RTW_PRINT(FUNC_ADPT_FMT" variable(%d) not defined!\n", @@ -7884,6 +9952,27 @@ void GetHwReg(_adapter *adapter, u8 variable, u8 *val) } +static u32 _get_page_size(struct _ADAPTER *a) +{ +#ifdef RTW_HALMAC + struct dvobj_priv *d; + u32 size = 0; + int err = 0; + + + d = adapter_to_dvobj(a); + + err = rtw_halmac_get_page_size(d, &size); + if (!err) + return size; + + RTW_WARN(FUNC_ADPT_FMT ": Fail to get Page size!!(err=%d)\n", + FUNC_ADPT_ARG(a), err); +#endif /* RTW_HALMAC */ + + return PAGE_SIZE_128; +} + u8 SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) { @@ -7976,7 +10065,7 @@ GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) pstapriv = &adapter->stapriv; psta = rtw_get_stainfo(pstapriv, pmlmepriv->cur_network.network.MacAddress); if (psta) - *((int *)value) = psta->rssi_stat.UndecoratedSmoothedPWDB; + *((int *)value) = psta->cmn.rssi_stat.rssi; } break; case HAL_DEF_DBG_DUMP_RXPKT: @@ -7988,11 +10077,8 @@ GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) case HAL_DEF_ANT_DETECT: *((u8 *)value) = hal_data->AntDetection; break; - case HAL_DEF_MACID_SLEEP: - *(u8 *)value = _FALSE; - break; case HAL_DEF_TX_PAGE_SIZE: - *((u32 *)value) = PAGE_SIZE_128; + *((u32 *)value) = _get_page_size(adapter); break; case HAL_DEF_DBG_DIS_PWT: *(u8 *)value = hal_data->bDisableTXPowerTraining; @@ -8020,258 +10106,6 @@ GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value) return bResult; } -void SetHalODMVar( - PADAPTER Adapter, - HAL_ODM_VARIABLE eVariable, - PVOID pValue1, - BOOLEAN bSet) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T podmpriv = &pHalData->odmpriv; - /* _irqL irqL; */ - switch (eVariable) { - case HAL_ODM_STA_INFO: { - struct sta_info *psta = (struct sta_info *)pValue1; - if (bSet) { - RTW_INFO("### Set STA_(%d) info ###\n", psta->mac_id); - ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, psta); - } else { - RTW_INFO("### Clean STA_(%d) info ###\n", psta->mac_id); - /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ - ODM_CmnInfoPtrArrayHook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->mac_id, NULL); - - /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ - } - } - break; - case HAL_ODM_P2P_STATE: - ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DIRECT, bSet); - break; - case HAL_ODM_WIFI_DISPLAY_STATE: - ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_WIFI_DISPLAY, bSet); - break; - case HAL_ODM_REGULATION: - ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); - ODM_CmnInfoInit(podmpriv, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); - break; -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - case HAL_ODM_NOISE_MONITOR: { - struct noise_info *pinfo = (struct noise_info *)pValue1; - -#ifdef DBG_NOISE_MONITOR - RTW_INFO("### Noise monitor chan(%d)-bPauseDIG:%d,IGIValue:0x%02x,max_time:%d (ms) ###\n", - pinfo->chan, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); -#endif - - pHalData->noise[pinfo->chan] = ODM_InbandNoise_Monitor(podmpriv, pinfo->bPauseDIG, pinfo->IGIValue, pinfo->max_time); - RTW_INFO("chan_%d, noise = %d (dBm)\n", pinfo->chan, pHalData->noise[pinfo->chan]); -#ifdef DBG_NOISE_MONITOR - RTW_INFO("noise_a = %d, noise_b = %d noise_all:%d\n", - podmpriv->noise_level.noise[ODM_RF_PATH_A], - podmpriv->noise_level.noise[ODM_RF_PATH_B], - podmpriv->noise_level.noise_all); -#endif - } - break; -#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ - - case HAL_ODM_INITIAL_GAIN: { - u8 rx_gain = *((u8 *)(pValue1)); - /*printk("rx_gain:%x\n",rx_gain);*/ - if (rx_gain == 0xff) {/*restore rx gain*/ - /*ODM_Write_DIG(podmpriv,pDigTable->BackupIGValue);*/ - odm_PauseDIG(podmpriv, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, rx_gain); - } else { - /*pDigTable->BackupIGValue = pDigTable->CurIGValue;*/ - /*ODM_Write_DIG(podmpriv,rx_gain);*/ - odm_PauseDIG(podmpriv, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, rx_gain); - } - } - break; - case HAL_ODM_FA_CNT_DUMP: - if (*((u8 *)pValue1)) - podmpriv->DebugComponents |= (ODM_COMP_DIG | ODM_COMP_FA_CNT); - else - podmpriv->DebugComponents &= ~(ODM_COMP_DIG | ODM_COMP_FA_CNT); - break; - case HAL_ODM_DBG_FLAG: - ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_COMP, *((u8Byte *)pValue1)); - break; - case HAL_ODM_DBG_LEVEL: - ODM_CmnInfoUpdate(podmpriv, ODM_CMNINFO_DBG_LEVEL, *((u4Byte *)pValue1)); - break; - case HAL_ODM_RX_INFO_DUMP: { - PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(podmpriv , PHYDM_FALSEALMCNT); - pDIG_T pDM_DigTable = &podmpriv->DM_DigTable; - void *sel; - - sel = pValue1; - - _RTW_PRINT_SEL(sel , "============ Rx Info dump ===================\n"); - _RTW_PRINT_SEL(sel , "bLinked = %d, RSSI_Min = %d(%%), CurrentIGI = 0x%x\n", podmpriv->bLinked, podmpriv->RSSI_Min, pDM_DigTable->CurIGValue); - _RTW_PRINT_SEL(sel , "Cnt_Cck_fail = %d, Cnt_Ofdm_fail = %d, Total False Alarm = %d\n", FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all); - - if (podmpriv->bLinked) { - _RTW_PRINT_SEL(sel , "RxRate = %s", HDATA_RATE(podmpriv->RxRate)); - _RTW_PRINT_SEL(sel , " RSSI_A = %d(%%), RSSI_B = %d(%%)\n", podmpriv->RSSI_A, podmpriv->RSSI_B); -#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA - rtw_dump_raw_rssi_info(Adapter, sel); -#endif - } - } - break; - case HAL_ODM_RX_Dframe_INFO: { - void *sel; - - sel = pValue1; - - /*_RTW_PRINT_SEL(sel , "HAL_ODM_RX_Dframe_INFO\n");*/ -#ifdef DBG_RX_DFRAME_RAW_DATA - rtw_dump_rx_dframe_info(Adapter, sel); -#endif - } - break; - -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - case HAL_ODM_AUTO_CHNL_SEL: { - ACS_OP acs_op = *(ACS_OP *)pValue1; - - rtw_phydm_func_set(Adapter, ODM_BB_NHM_CNT); - - if (ACS_INIT == acs_op) { -#ifdef DBG_AUTO_CHNL_SEL_NHM - RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_INIT\n", ADPT_ARG(Adapter)); -#endif - odm_AutoChannelSelectInit(podmpriv); - } else if (ACS_RESET == acs_op) { - /* Reset statistics for auto channel selection mechanism.*/ -#ifdef DBG_AUTO_CHNL_SEL_NHM - RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_RESET\n", ADPT_ARG(Adapter)); -#endif - odm_AutoChannelSelectReset(podmpriv); - - } else if (ACS_SELECT == acs_op) { - /* Collect NHM measurement result after current channel */ -#ifdef DBG_AUTO_CHNL_SEL_NHM - RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: ACS_SELECT, CH(%d)\n", ADPT_ARG(Adapter), rtw_get_acs_channel(Adapter)); -#endif - odm_AutoChannelSelect(podmpriv, rtw_get_acs_channel(Adapter)); - } else - RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: Unexpected OP\n", ADPT_ARG(Adapter)); - - } - break; -#endif -#ifdef CONFIG_ANTENNA_DIVERSITY - case HAL_ODM_ANTDIV_SELECT: { - u8 antenna = (*(u8 *)pValue1); - - /*switch antenna*/ - ODM_UpdateRxIdleAnt(&pHalData->odmpriv, antenna); - /*RTW_INFO("==> HAL_ODM_ANTDIV_SELECT, Ant_(%s)\n", (antenna == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT");*/ - - } - break; -#endif - - default: - break; - } -} - -void GetHalODMVar( - PADAPTER Adapter, - HAL_ODM_VARIABLE eVariable, - PVOID pValue1, - PVOID pValue2) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T podmpriv = &pHalData->odmpriv; - - switch (eVariable) { -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - case HAL_ODM_NOISE_MONITOR: { - u8 chan = *(u8 *)pValue1; - *(s16 *)pValue2 = pHalData->noise[chan]; -#ifdef DBG_NOISE_MONITOR - RTW_INFO("### Noise monitor chan(%d)-noise:%d (dBm) ###\n", - chan, pHalData->noise[chan]); -#endif - } - break; -#endif/*#ifdef CONFIG_BACKGROUND_NOISE_MONITOR*/ - case HAL_ODM_DBG_FLAG: - *((u8Byte *)pValue1) = podmpriv->DebugComponents; - break; - case HAL_ODM_DBG_LEVEL: - *((u4Byte *)pValue1) = podmpriv->DebugLevel; - break; - -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - case HAL_ODM_AUTO_CHNL_SEL: { -#ifdef DBG_AUTO_CHNL_SEL_NHM - RTW_INFO("[ACS-"ADPT_FMT"] HAL_ODM_AUTO_CHNL_SEL: GET_BEST_CHAN\n", ADPT_ARG(Adapter)); -#endif - /* Retrieve better channel from NHM mechanism */ - if (IsSupported24G(Adapter->registrypriv.wireless_mode)) - *((u8 *)(pValue1)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_2_4G); - if (IsSupported5G(Adapter->registrypriv.wireless_mode)) - *((u8 *)(pValue2)) = ODM_GetAutoChannelSelectResult(podmpriv, BAND_ON_5G); - } - break; -#endif -#ifdef CONFIG_ANTENNA_DIVERSITY - case HAL_ODM_ANTDIV_SELECT: { - pFAT_T pDM_FatTable = &podmpriv->DM_FatTable; - *((u8 *)pValue1) = pDM_FatTable->RxIdleAnt; - } - break; -#endif - case HAL_ODM_INITIAL_GAIN: { - pDIG_T pDM_DigTable = &podmpriv->DM_DigTable; - *((u8 *)pValue1) = pDM_DigTable->CurIGValue; - } - break; - default: - break; - } -} - - -u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); - PDM_ODM_T podmpriv = &pHalData->odmpriv; - u32 result = 0; - - switch (ops) { - case HAL_PHYDM_DIS_ALL_FUNC: - podmpriv->SupportAbility = DYNAMIC_FUNC_DISABLE; - break; - case HAL_PHYDM_FUNC_SET: - podmpriv->SupportAbility |= ability; - break; - case HAL_PHYDM_FUNC_CLR: - podmpriv->SupportAbility &= ~(ability); - break; - case HAL_PHYDM_ABILITY_BK: - /* dm flag backup*/ - podmpriv->BK_SupportAbility = podmpriv->SupportAbility; - break; - case HAL_PHYDM_ABILITY_RESTORE: - /* restore dm flag */ - podmpriv->SupportAbility = podmpriv->BK_SupportAbility; - break; - case HAL_PHYDM_ABILITY_SET: - podmpriv->SupportAbility = ability; - break; - case HAL_PHYDM_ABILITY_GET: - result = podmpriv->SupportAbility; - break; - } - return result; -} - BOOLEAN eqNByte( @@ -8466,8 +10300,13 @@ ParseQualifiedString( return _FALSE; i = (*Start); - while ((c = In[(*Start)++]) != RightQualifier) - ; /* find ']' */ + c = In[(*Start)++]; + while (c != RightQualifier && c != '\0') + c = In[(*Start)++]; + + if (c == '\0') + return _FALSE; + j = (*Start) - 2; strncpy((char *)Out, (const char *)(In + i), j - i + 1); @@ -8503,14 +10342,14 @@ void rtw_hal_check_rxfifo_full(_adapter *adapter) if (regsty->check_hw_status == 1) { /* switch counter to RX fifo */ - if (IS_8188E(pHalData->VersionID) || - IS_8188F(pHalData->VersionID) || - IS_8812_SERIES(pHalData->VersionID) || - IS_8821_SERIES(pHalData->VersionID) || - IS_8723B_SERIES(pHalData->VersionID) || - IS_8192E(pHalData->VersionID) || - IS_8703B_SERIES(pHalData->VersionID) || - IS_8723D_SERIES(pHalData->VersionID)) { + if (IS_8188E(pHalData->version_id) || + IS_8188F(pHalData->version_id) || + IS_8812_SERIES(pHalData->version_id) || + IS_8821_SERIES(pHalData->version_id) || + IS_8723B_SERIES(pHalData->version_id) || + IS_8192E(pHalData->version_id) || + IS_8703B_SERIES(pHalData->version_id) || + IS_8723D_SERIES(pHalData->version_id)) { rtw_write8(adapter, REG_RXERR_RPT + 3, rtw_read8(adapter, REG_RXERR_RPT + 3) | 0xa0); save_cnt = _TRUE; } else { @@ -8615,6 +10454,10 @@ void rtw_dump_raw_rssi_info(_adapter *padapter, void *sel) #ifdef DBG_RX_DFRAME_RAW_DATA void rtw_dump_rx_dframe_info(_adapter *padapter, void *sel) { +#define DBG_RX_DFRAME_RAW_DATA_UC 0 +#define DBG_RX_DFRAME_RAW_DATA_BMC 1 +#define DBG_RX_DFRAME_RAW_DATA_TYPES 2 + _irqL irqL; u8 isCCKrate, rf_path; struct recv_priv *precvpriv = &(padapter->recvpriv); @@ -8622,9 +10465,8 @@ void rtw_dump_rx_dframe_info(_adapter *padapter, void *sel) struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta; struct sta_recv_dframe_info *psta_dframe_info; - int i; + int i, j; _list *plist, *phead; - char *BW; u8 bc_addr[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; u8 null_addr[6] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; @@ -8642,53 +10484,38 @@ void rtw_dump_rx_dframe_info(_adapter *padapter, void *sel) plist = get_next(plist); if (psta) { - psta_dframe_info = &psta->sta_dframe_info; - if ((_rtw_memcmp(psta->hwaddr, bc_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), 6) != _TRUE)) { - - - isCCKrate = (psta_dframe_info->sta_data_rate <= DESC_RATE11M) ? TRUE : FALSE; - - switch (psta_dframe_info->sta_bw_mode) { - - case CHANNEL_WIDTH_20: - BW = "20M"; - break; - - case CHANNEL_WIDTH_40: - BW = "40M"; - break; - - case CHANNEL_WIDTH_80: - BW = "80M"; - break; - - case CHANNEL_WIDTH_160: - BW = "160M"; - break; - - default: - BW = ""; - break; - } + if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), 6) != _TRUE)) { RTW_PRINT_SEL(sel, "==============================\n"); - _RTW_PRINT_SEL(sel, "macaddr =" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); - _RTW_PRINT_SEL(sel, "BW=%s, sgi =%d\n", BW, psta_dframe_info->sta_sgi); - _RTW_PRINT_SEL(sel, "Rx_Data_Rate = %s\n", HDATA_RATE(psta_dframe_info->sta_data_rate)); + RTW_PRINT_SEL(sel, "macaddr =" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); - for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { + for (j = 0; j < DBG_RX_DFRAME_RAW_DATA_TYPES; j++) { + if (j == DBG_RX_DFRAME_RAW_DATA_UC) { + psta_dframe_info = &psta->sta_dframe_info; + RTW_PRINT_SEL(sel, "\n"); + RTW_PRINT_SEL(sel, "Unicast:\n"); + } else if (j == DBG_RX_DFRAME_RAW_DATA_BMC) { + psta_dframe_info = &psta->sta_dframe_info_bmc; + RTW_PRINT_SEL(sel, "\n"); + RTW_PRINT_SEL(sel, "Broadcast/Multicast:\n"); + } - if (!isCCKrate) { + isCCKrate = (psta_dframe_info->sta_data_rate <= DESC_RATE11M) ? TRUE : FALSE; - _RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)", rf_path, psta_dframe_info->sta_RxPwr[rf_path]); - _RTW_PRINT_SEL(sel , ",rx_ofdm_snr:%d(dB)\n", psta_dframe_info->sta_ofdm_snr[rf_path]); + RTW_PRINT_SEL(sel, "BW=%s, sgi =%d\n", ch_width_str(psta_dframe_info->sta_bw_mode), psta_dframe_info->sta_sgi); + RTW_PRINT_SEL(sel, "Rx_Data_Rate = %s\n", HDATA_RATE(psta_dframe_info->sta_data_rate)); - } else - - _RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)\n", rf_path, (psta_dframe_info->sta_mimo_signal_strength[rf_path]) - 100); + for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { + if (!isCCKrate) { + RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)", rf_path, psta_dframe_info->sta_RxPwr[rf_path]); + _RTW_PRINT_SEL(sel , ",rx_ofdm_snr:%d(dB)\n", psta_dframe_info->sta_ofdm_snr[rf_path]); + } else + RTW_PRINT_SEL(sel , "RF_PATH_%d RSSI:%d(dBm)\n", rf_path, (psta_dframe_info->sta_mimo_signal_strength[rf_path]) - 100); + } } + } } } @@ -8709,7 +10536,7 @@ void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe) PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); struct rx_pkt_attrib *pattrib = &prframe->u.hdr.attrib; struct sta_info *psta = prframe->u.hdr.psta; - PODM_PHY_INFO_T pPhyInfo = (PODM_PHY_INFO_T)(&pattrib->phy_info); + struct phydm_phyinfo_struct *p_phy_info = &pattrib->phy_info; struct rx_raw_rssi *psample_pkt_rssi = &padapter->recvpriv.raw_rssi_info; psample_pkt_rssi->data_rate = pattrib->data_rate; ptr = prframe->u.hdr.rx_data; @@ -8720,15 +10547,15 @@ void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe) if (precvpriv->store_law_data_flag) { isCCKrate = (pattrib->data_rate <= DESC_RATE11M) ? TRUE : FALSE; - psample_pkt_rssi->pwdball = pPhyInfo->RxPWDBAll; - psample_pkt_rssi->pwr_all = pPhyInfo->RecvSignalPower; + psample_pkt_rssi->pwdball = p_phy_info->rx_pwdb_all; + psample_pkt_rssi->pwr_all = p_phy_info->recv_signal_power; for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { - psample_pkt_rssi->mimo_signal_strength[rf_path] = pPhyInfo->RxMIMOSignalStrength[rf_path]; - psample_pkt_rssi->mimo_signal_quality[rf_path] = pPhyInfo->RxMIMOSignalQuality[rf_path]; + psample_pkt_rssi->mimo_signal_strength[rf_path] = p_phy_info->rx_mimo_signal_strength[rf_path]; + psample_pkt_rssi->mimo_signal_quality[rf_path] = p_phy_info->rx_mimo_signal_quality[rf_path]; if (!isCCKrate) { - psample_pkt_rssi->ofdm_pwr[rf_path] = pPhyInfo->RxPwr[rf_path]; - psample_pkt_rssi->ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; + psample_pkt_rssi->ofdm_pwr[rf_path] = p_phy_info->rx_pwr[rf_path]; + psample_pkt_rssi->ofdm_snr[rf_path] = p_phy_info->rx_snr[rf_path]; } } #ifdef DBG_RX_DFRAME_RAW_DATA @@ -8736,19 +10563,23 @@ void rtw_store_phy_info(_adapter *padapter, union recv_frame *prframe) /*RTW_INFO("=>%s WIFI_DATA_TYPE or WIFI_QOS_DATA_TYPE\n", __FUNCTION__);*/ if (psta) { - psta_dframe_info = &psta->sta_dframe_info; - /*RTW_INFO("=>%s psta->hwaddr="MAC_FMT" !\n", __FUNCTION__, MAC_ARG(psta->hwaddr));*/ - if ((_rtw_memcmp(psta->hwaddr, bc_addr, ETH_ALEN) != _TRUE) || (padapter->registrypriv.mp_mode == 1)) { + if (IS_MCAST(get_ra(get_recvframe_data(prframe)))) + psta_dframe_info = &psta->sta_dframe_info_bmc; + else + psta_dframe_info = &psta->sta_dframe_info; + /*RTW_INFO("=>%s psta->cmn.mac_addr="MAC_FMT" !\n", + __FUNCTION__, MAC_ARG(psta->cmn.mac_addr));*/ + if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, ETH_ALEN) != _TRUE) || (padapter->registrypriv.mp_mode == 1)) { psta_dframe_info->sta_data_rate = pattrib->data_rate; psta_dframe_info->sta_sgi = pattrib->sgi; psta_dframe_info->sta_bw_mode = pattrib->bw; for (rf_path = 0; rf_path < pHalData->NumTotalRFPath; rf_path++) { - psta_dframe_info->sta_mimo_signal_strength[rf_path] = (pPhyInfo->RxMIMOSignalStrength[rf_path]);/*Percentage to dbm*/ + psta_dframe_info->sta_mimo_signal_strength[rf_path] = (p_phy_info->rx_mimo_signal_strength[rf_path]);/*Percentage to dbm*/ if (!isCCKrate) { - psta_dframe_info->sta_ofdm_snr[rf_path] = pPhyInfo->RxSNR[rf_path]; - psta_dframe_info->sta_RxPwr[rf_path] = pPhyInfo->RxPwr[rf_path]; + psta_dframe_info->sta_ofdm_snr[rf_path] = p_phy_info->rx_snr[rf_path]; + psta_dframe_info->sta_RxPwr[rf_path] = p_phy_info->rx_pwr[rf_path]; } } } @@ -8965,22 +10796,11 @@ void rtw_dump_cur_efuse(PADAPTER padapter) return; } - if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) - RTW_INFO("EFUSE FILE\n"); - else - RTW_INFO("HW EFUSE\n"); - #ifdef CONFIG_RTW_DEBUG - for (i = 0; i < mapsize; i++) { - if (i % 16 == 0) - RTW_PRINT_SEL(RTW_DBGDUMP, "0x%03x: ", i); - - _RTW_PRINT_SEL(RTW_DBGDUMP, "%02X%s" - , hal_data->efuse_eeprom_data[i] - , ((i + 1) % 16 == 0) ? "\n" : (((i + 1) % 8 == 0) ? " " : " ") - ); - } - _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); + if (hal_data->efuse_file_status == EFUSE_FILE_LOADED) + RTW_MAP_DUMP_SEL(RTW_DBGDUMP, "EFUSE FILE", hal_data->efuse_eeprom_data, mapsize); + else + RTW_MAP_DUMP_SEL(RTW_DBGDUMP, "HW EFUSE", hal_data->efuse_eeprom_data, mapsize); #endif } @@ -9113,12 +10933,12 @@ void rtw_bb_rf_gain_offset(_adapter *padapter) if (pHalData->EEPROMRFGainVal != 0xff) { - if (pHalData->ant_path == ODM_RF_PATH_A) + if (pHalData->ant_path == RF_PATH_A) GainValue = (pHalData->EEPROMRFGainVal & 0x0f); else GainValue = (pHalData->EEPROMRFGainVal & 0xf0) >> 4; - RTW_INFO("Ant PATH_%d GainValue Offset = 0x%x\n", (pHalData->ant_path == ODM_RF_PATH_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B), GainValue); + RTW_INFO("Ant PATH_%d GainValue Offset = 0x%x\n", (pHalData->ant_path == RF_PATH_A) ? (RF_PATH_A) : (RF_PATH_B), GainValue); for (i = 0; i < ArrayLen; i += 2) { /* RTW_INFO("ArrayLen in =%d ,Array 1 =0x%x ,Array2 =0x%x\n",i,Array[i],Array[i]+1); */ @@ -9134,7 +10954,7 @@ void rtw_bb_rf_gain_offset(_adapter *padapter) res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); RTW_INFO("Offset RF Gain. before reg 0x7f=0x%08x\n", res); - PHY_SetRFReg(padapter, RF_PATH_A, REG_RF_BB_GAIN_OFFSET, BIT18 | BIT17 | BIT16 | BIT15, target); + phy_set_rf_reg(padapter, RF_PATH_A, REG_RF_BB_GAIN_OFFSET, BIT18 | BIT17 | BIT16 | BIT15, target); res = rtw_hal_read_rfreg(padapter, RF_PATH_A, 0x7f, 0xffffffff); RTW_INFO("Offset RF Gain. After reg 0x7f=0x%08x\n", res); @@ -9304,10 +11124,18 @@ void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct registry_priv *registry_par = &padapter->registrypriv; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); u8 cur_wireless_mode = WIRELESS_INVALID; #ifdef CONFIG_USB_RX_AGGREGATION + if (!registry_par->dynamic_agg_enable) + return; + +#ifdef RTW_HALMAC + if (IS_HARDWARE_TYPE_8822BU(padapter) || IS_HARDWARE_TYPE_8821CU(padapter)) + rtw_hal_set_hwreg(padapter, HW_VAR_RXDMA_AGG_PG_TH, NULL); +#else /* !RTW_HALMAC */ if (IS_HARDWARE_TYPE_8821U(padapter)) { /* || IS_HARDWARE_TYPE_8192EU(padapter)) */ /* This AGG_PH_TH only for UsbRxAggMode == USB_RX_AGG_USB */ if ((pHalData->rxagg_mode == RX_AGG_USB) && (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE)) { @@ -9344,7 +11172,9 @@ void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer) rtw_set_usb_agg_by_mode(padapter, cur_wireless_mode); #endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */ } -#endif +#endif /* RTW_HALMAC */ +#endif /* CONFIG_USB_RX_AGGREGATION */ + } /* bus-agg check for SoftAP mode */ @@ -9353,7 +11183,7 @@ inline u8 rtw_hal_busagg_qsel_check(_adapter *padapter, u8 pre_qsel, u8 next_qse struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); u8 chk_rst = _SUCCESS; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) != _TRUE) + if (!MLME_IS_AP(padapter) && !MLME_IS_MESH(padapter)) return chk_rst; /* if((pre_qsel == 0xFF)||(next_qsel== 0xFF)) */ @@ -9418,7 +11248,9 @@ u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num) { u8 value = 0; u8 direction = 0; - u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; + u32 gpio_pin_input_val = REG_GPIO_PIN_CTRL; + u32 gpio_pin_output_val = REG_GPIO_PIN_CTRL + 1; + u32 gpio_pin_output_en = REG_GPIO_PIN_CTRL + 2; u8 gpio_num_to_set = gpio_num; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); @@ -9431,18 +11263,20 @@ u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num) LeaveAllPowerSaveModeDirect(adapter); if (gpio_num > 7) { - gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; + gpio_pin_input_val = REG_GPIO_PIN_CTRL_2; + gpio_pin_output_val = REG_GPIO_PIN_CTRL_2 + 1; + gpio_pin_output_en = REG_GPIO_PIN_CTRL_2 + 2; gpio_num_to_set = gpio_num - 8; } /* Read GPIO Direction */ - direction = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; + direction = (rtw_read8(adapter, gpio_pin_output_en) & BIT(gpio_num_to_set)) >> gpio_num_to_set; /* According the direction to read register value */ if (direction) - value = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; + value = (rtw_read8(adapter, gpio_pin_output_val) & BIT(gpio_num_to_set)) >> gpio_num_to_set; else - value = (rtw_read8(adapter, gpio_ctrl_reg_to_set) & BIT(gpio_num_to_set)) >> gpio_num; + value = (rtw_read8(adapter, gpio_pin_input_val) & BIT(gpio_num_to_set)) >> gpio_num_to_set; rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); RTW_INFO("%s direction=%d value=%d\n", __FUNCTION__, direction, value); @@ -9454,7 +11288,8 @@ int rtw_hal_set_gpio_output_value(_adapter *adapter, u8 gpio_num, bool isHigh) { u8 direction = 0; u8 res = -1; - u32 gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL + 2; + u32 gpio_pin_output_val = REG_GPIO_PIN_CTRL + 1; + u32 gpio_pin_output_en = REG_GPIO_PIN_CTRL + 2; u8 gpio_num_to_set = gpio_num; if (rtw_hal_gpio_func_check(adapter, gpio_num) == _FAIL) @@ -9465,19 +11300,20 @@ int rtw_hal_set_gpio_output_value(_adapter *adapter, u8 gpio_num, bool isHigh) LeaveAllPowerSaveModeDirect(adapter); if (gpio_num > 7) { - gpio_ctrl_reg_to_set = REG_GPIO_PIN_CTRL_2 + 2; + gpio_pin_output_val = REG_GPIO_PIN_CTRL_2 + 1; + gpio_pin_output_en = REG_GPIO_PIN_CTRL_2 + 2; gpio_num_to_set = gpio_num - 8; } /* Read GPIO direction */ - direction = (rtw_read8(adapter, REG_GPIO_PIN_CTRL + 2) & BIT(gpio_num)) >> gpio_num; + direction = (rtw_read8(adapter, gpio_pin_output_en) & BIT(gpio_num_to_set)) >> gpio_num_to_set; /* If GPIO is output direction, setting value. */ if (direction) { if (isHigh) - rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) | BIT(gpio_num_to_set)); + rtw_write8(adapter, gpio_pin_output_val, rtw_read8(adapter, gpio_pin_output_val) | BIT(gpio_num_to_set)); else - rtw_write8(adapter, gpio_ctrl_reg_to_set, rtw_read8(adapter, gpio_ctrl_reg_to_set) & ~BIT(gpio_num_to_set)); + rtw_write8(adapter, gpio_pin_output_val, rtw_read8(adapter, gpio_pin_output_val) & ~BIT(gpio_num_to_set)); RTW_INFO("%s Set gpio %x[%d]=%d\n", __FUNCTION__, REG_GPIO_PIN_CTRL + 1, gpio_num, isHigh); res = 0; @@ -9628,7 +11464,7 @@ void rtw_hal_ch_sw_iqk_info_backup(_adapter *padapter) u8 i; /* If it's an existed record, overwrite it */ - res = rtw_hal_ch_sw_iqk_info_search(padapter, pHalData->CurrentChannel, pHalData->CurrentChannelBW); + res = rtw_hal_ch_sw_iqk_info_search(padapter, pHalData->current_channel, pHalData->current_channel_bw); if ((res >= 0) && (res < MAX_IQK_INFO_BACKUP_CHNL_NUM)) { rtw_hal_set_hwreg(padapter, HW_VAR_CH_SW_IQK_INFO_BACKUP, (u8 *)&(pHalData->iqk_reg_backup[res])); return; @@ -9666,42 +11502,42 @@ void rtw_dump_mac_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_coun return; } if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x3); - mac_cck_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); - mac_ofdm_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x6); - mac_ht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x3); + mac_cck_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); + mac_ofdm_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x6); + mac_ht_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ mac_vht_ok = 0; if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); - mac_vht_ok = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x0); + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x1); + mac_vht_ok = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ } - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x4); - mac_cck_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); - mac_ofdm_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x7); - mac_ht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x4); + mac_cck_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); + mac_ofdm_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x7); + mac_ht_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ mac_vht_err = 0; if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x1); - mac_vht_err = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x1); + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x1); + mac_vht_err = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0]*/ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT26, 0x0);/*clear bit-26*/ } - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x5); - mac_cck_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x2); - mac_ofdm_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x9); - mac_ht_fa = PHY_QueryMacReg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x5); + mac_cck_fa = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x2); + mac_ofdm_fa = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT28 | BIT29 | BIT30 | BIT31, 0x9); + mac_ht_fa = phy_query_mac_reg(padapter, REG_RXERR_RPT, bMaskLWord);/* [15:0] */ /* Mac_DropPacket */ rtw_write32(padapter, REG_RXERR_RPT, (rtw_read32(padapter, REG_RXERR_RPT) & 0x0FFFFFFF) | Mac_DropPacket); @@ -9721,11 +11557,11 @@ void rtw_reset_mac_rx_counters(_adapter *padapter) if (IS_HARDWARE_TYPE_8703B(padapter) || IS_HARDWARE_TYPE_8723D(padapter) || IS_HARDWARE_TYPE_8188F(padapter)) - PHY_SetMacReg(padapter, REG_RCR, BIT19, 0x1); + phy_set_mac_reg(padapter, REG_RCR, BIT19, 0x1); /* reset mac counter */ - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x1); - PHY_SetMacReg(padapter, REG_RXERR_RPT, BIT27, 0x0); + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT27, 0x1); + phy_set_mac_reg(padapter, REG_RXERR_RPT, BIT27, 0x0); } void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter) @@ -9736,28 +11572,28 @@ void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_coun return; } if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { - cckok = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF); /* [13:0] */ - ofdmok = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF); /* [13:0] */ - htok = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF); /* [13:0] */ - vht_ok = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF); /* [13:0] */ - cckcrc = PHY_QueryBBReg(padapter, 0xF04, 0x3FFF0000); /* [29:16] */ - ofdmcrc = PHY_QueryBBReg(padapter, 0xF14, 0x3FFF0000); /* [29:16] */ - htcrc = PHY_QueryBBReg(padapter, 0xF10, 0x3FFF0000); /* [29:16] */ - vht_err = PHY_QueryBBReg(padapter, 0xF0C, 0x3FFF0000); /* [29:16] */ - CCK_FA = PHY_QueryBBReg(padapter, 0xA5C, bMaskLWord); - OFDM_FA = PHY_QueryBBReg(padapter, 0xF48, bMaskLWord); + cckok = phy_query_bb_reg(padapter, 0xF04, 0x3FFF); /* [13:0] */ + ofdmok = phy_query_bb_reg(padapter, 0xF14, 0x3FFF); /* [13:0] */ + htok = phy_query_bb_reg(padapter, 0xF10, 0x3FFF); /* [13:0] */ + vht_ok = phy_query_bb_reg(padapter, 0xF0C, 0x3FFF); /* [13:0] */ + cckcrc = phy_query_bb_reg(padapter, 0xF04, 0x3FFF0000); /* [29:16] */ + ofdmcrc = phy_query_bb_reg(padapter, 0xF14, 0x3FFF0000); /* [29:16] */ + htcrc = phy_query_bb_reg(padapter, 0xF10, 0x3FFF0000); /* [29:16] */ + vht_err = phy_query_bb_reg(padapter, 0xF0C, 0x3FFF0000); /* [29:16] */ + CCK_FA = phy_query_bb_reg(padapter, 0xA5C, bMaskLWord); + OFDM_FA = phy_query_bb_reg(padapter, 0xF48, bMaskLWord); } else { - cckok = PHY_QueryBBReg(padapter, 0xF88, bMaskDWord); - ofdmok = PHY_QueryBBReg(padapter, 0xF94, bMaskLWord); - htok = PHY_QueryBBReg(padapter, 0xF90, bMaskLWord); + cckok = phy_query_bb_reg(padapter, 0xF88, bMaskDWord); + ofdmok = phy_query_bb_reg(padapter, 0xF94, bMaskLWord); + htok = phy_query_bb_reg(padapter, 0xF90, bMaskLWord); vht_ok = 0; - cckcrc = PHY_QueryBBReg(padapter, 0xF84, bMaskDWord); - ofdmcrc = PHY_QueryBBReg(padapter, 0xF94, bMaskHWord); - htcrc = PHY_QueryBBReg(padapter, 0xF90, bMaskHWord); + cckcrc = phy_query_bb_reg(padapter, 0xF84, bMaskDWord); + ofdmcrc = phy_query_bb_reg(padapter, 0xF94, bMaskHWord); + htcrc = phy_query_bb_reg(padapter, 0xF90, bMaskHWord); vht_err = 0; - OFDM_FA = PHY_QueryBBReg(padapter, 0xCF0, bMaskLWord) + PHY_QueryBBReg(padapter, 0xCF2, bMaskLWord) + - PHY_QueryBBReg(padapter, 0xDA2, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA4, bMaskLWord) + - PHY_QueryBBReg(padapter, 0xDA6, bMaskLWord) + PHY_QueryBBReg(padapter, 0xDA8, bMaskLWord); + OFDM_FA = phy_query_bb_reg(padapter, 0xCF0, bMaskLWord) + phy_query_bb_reg(padapter, 0xCF2, bMaskLWord) + + phy_query_bb_reg(padapter, 0xDA2, bMaskLWord) + phy_query_bb_reg(padapter, 0xDA4, bMaskLWord) + + phy_query_bb_reg(padapter, 0xDA6, bMaskLWord) + phy_query_bb_reg(padapter, 0xDA8, bMaskLWord); CCK_FA = (rtw_read8(padapter, 0xA5B) << 8) | (rtw_read8(padapter, 0xA5C)); } @@ -9772,8 +11608,8 @@ void rtw_dump_phy_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_coun void rtw_reset_phy_trx_ok_counters(_adapter *padapter) { if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { - PHY_SetBBReg(padapter, 0xB58, BIT0, 0x1); - PHY_SetBBReg(padapter, 0xB58, BIT0, 0x0); + phy_set_bb_reg(padapter, 0xB58, BIT0, 0x1); + phy_set_bb_reg(padapter, 0xB58, BIT0, 0x0); } } void rtw_reset_phy_rx_counters(_adapter *padapter) @@ -9782,23 +11618,23 @@ void rtw_reset_phy_rx_counters(_adapter *padapter) if (IS_HARDWARE_TYPE_JAGUAR(padapter) || IS_HARDWARE_TYPE_JAGUAR2(padapter)) { rtw_reset_phy_trx_ok_counters(padapter); - PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x1);/* reset OFDA FA counter */ - PHY_SetBBReg(padapter, 0x9A4, BIT17, 0x0); + phy_set_bb_reg(padapter, 0x9A4, BIT17, 0x1);/* reset OFDA FA counter */ + phy_set_bb_reg(padapter, 0x9A4, BIT17, 0x0); - PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ - PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); + phy_set_bb_reg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ + phy_set_bb_reg(padapter, 0xA2C, BIT15, 0x1); } else { - PHY_SetBBReg(padapter, 0xF14, BIT16, 0x1); + phy_set_bb_reg(padapter, 0xF14, BIT16, 0x1); rtw_msleep_os(10); - PHY_SetBBReg(padapter, 0xF14, BIT16, 0x0); + phy_set_bb_reg(padapter, 0xF14, BIT16, 0x0); - PHY_SetBBReg(padapter, 0xD00, BIT27, 0x1);/* reset OFDA FA counter */ - PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x1);/* reset OFDA FA counter */ - PHY_SetBBReg(padapter, 0xD00, BIT27, 0x0); - PHY_SetBBReg(padapter, 0xC0C, BIT31, 0x0); + phy_set_bb_reg(padapter, 0xD00, BIT27, 0x1);/* reset OFDA FA counter */ + phy_set_bb_reg(padapter, 0xC0C, BIT31, 0x1);/* reset OFDA FA counter */ + phy_set_bb_reg(padapter, 0xD00, BIT27, 0x0); + phy_set_bb_reg(padapter, 0xC0C, BIT31, 0x0); - PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ - PHY_SetBBReg(padapter, 0xA2C, BIT15, 0x1); + phy_set_bb_reg(padapter, 0xA2C, BIT15, 0x0);/* reset CCK FA counter */ + phy_set_bb_reg(padapter, 0xA2C, BIT15, 0x1); } } #ifdef DBG_RX_COUNTER_DUMP @@ -9874,61 +11710,31 @@ void rtw_dump_rx_counters(_adapter *padapter) } } #endif -void rtw_get_noise(_adapter *padapter) +u8 rtw_get_current_tx_sgi(_adapter *padapter, struct sta_info *psta) { -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct noise_info info; - if (rtw_linked_check(padapter)) { - info.bPauseDIG = _TRUE; - info.IGIValue = 0x1e; - info.max_time = 100;/* ms */ - info.chan = pmlmeext->cur_channel ;/* rtw_get_oper_ch(padapter); */ - rtw_ps_deny(padapter, PS_DENY_IOCTL); - LeaveAllPowerSaveModeDirect(padapter); - - rtw_hal_set_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &info, _FALSE); - /* ODM_InbandNoise_Monitor(podmpriv,_TRUE,0x20,100); */ - rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); - rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(info.chan), &(padapter->recvpriv.noise)); -#ifdef DBG_NOISE_MONITOR - RTW_INFO("chan:%d,noise_level:%d\n", info.chan, padapter->recvpriv.noise); -#endif - } -#endif - -} -u8 rtw_get_current_tx_sgi(_adapter *padapter, u8 macid) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; u8 curr_tx_sgi = 0; + struct ra_sta_info *ra_info; -#if defined(CONFIG_RTL8188E) - curr_tx_sgi = ODM_RA_GetDecisionRate_8188E(pDM_Odm, macid); -#else - curr_tx_sgi = ((pRA_Table->link_tx_rate[macid]) & 0x80) >> 7; -#endif + if (!psta) + return curr_tx_sgi; + + ra_info = &psta->cmn.ra_info; + curr_tx_sgi = ((ra_info->curr_tx_rate) & 0x80) >> 7; return curr_tx_sgi; - } -u8 rtw_get_current_tx_rate(_adapter *padapter, u8 macid) +u8 rtw_get_current_tx_rate(_adapter *padapter, struct sta_info *psta) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; u8 rate_id = 0; + struct ra_sta_info *ra_info; -#if (RATE_ADAPTIVE_SUPPORT == 1) - rate_id = ODM_RA_GetDecisionRate_8188E(pDM_Odm, macid); -#else - rate_id = (pRA_Table->link_tx_rate[macid]) & 0x7f; -#endif + if (!psta) + return rate_id; + + ra_info = &psta->cmn.ra_info; + rate_id = ra_info->curr_tx_rate & 0x7f; return rate_id; - } void update_IOT_info(_adapter *padapter) @@ -9945,14 +11751,10 @@ void update_IOT_info(_adapter *padapter) case HT_IOT_PEER_RALINK: pmlmeinfo->turboMode_cts2self = 0; pmlmeinfo->turboMode_rtsen = 1; - /* disable high power */ - rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); break; case HT_IOT_PEER_REALTEK: /* rtw_write16(padapter, 0x4cc, 0xffff); */ /* rtw_write16(padapter, 0x546, 0x01c0); */ - /* disable high power */ - rtw_phydm_func_clr(padapter, ODM_BB_DYNAMIC_TXPWR); break; default: pmlmeinfo->turboMode_cts2self = 0; @@ -9961,30 +11763,6 @@ void update_IOT_info(_adapter *padapter) } } -#ifdef CONFIG_AUTO_CHNL_SEL_NHM -void rtw_acs_start(_adapter *padapter, bool bStart) -{ - if (_TRUE == bStart) { - ACS_OP acs_op = ACS_INIT; - - rtw_hal_set_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &acs_op, _TRUE); - rtw_set_acs_channel(padapter, 0); - SET_ACS_STATE(padapter, ACS_ENABLE); - } else { - SET_ACS_STATE(padapter, ACS_DISABLE); -#ifdef DBG_AUTO_CHNL_SEL_NHM - if (1) { - u8 best_24g_ch = 0; - u8 best_5g_ch = 0; - - rtw_hal_get_odm_var(padapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); - RTW_INFO("[ACS-"ADPT_FMT"] Best 2.4G CH:%u\n", ADPT_ARG(padapter), best_24g_ch); - RTW_INFO("[ACS-"ADPT_FMT"] Best 5G CH:%u\n", ADPT_ARG(padapter), best_5g_ch); - } -#endif - } -} -#endif /* TODO: merge with phydm, see odm_SetCrystalCap() */ void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) @@ -9996,13 +11774,13 @@ void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) case RTL8188E: case RTL8188F: /* write 0x24[16:11] = 0x24[22:17] = CrystalCap */ - PHY_SetBBReg(adapter, REG_AFE_XTAL_CTRL, 0x007FF800, (crystal_cap | (crystal_cap << 6))); + phy_set_bb_reg(adapter, REG_AFE_XTAL_CTRL, 0x007FF800, (crystal_cap | (crystal_cap << 6))); break; #endif #if defined(CONFIG_RTL8812A) case RTL8812: /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ - PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); + phy_set_bb_reg(adapter, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); break; #endif #if defined(CONFIG_RTL8723B) || defined(CONFIG_RTL8703B) || \ @@ -10014,13 +11792,13 @@ void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) case RTL8821: case RTL8192E: /* write 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ - PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x00FFF000, (crystal_cap | (crystal_cap << 6))); + phy_set_bb_reg(adapter, REG_MAC_PHY_CTRL, 0x00FFF000, (crystal_cap | (crystal_cap << 6))); break; #endif #if defined(CONFIG_RTL8814A) case RTL8814A: /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap*/ - PHY_SetBBReg(adapter, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); + phy_set_bb_reg(adapter, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); break; #endif #if defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) @@ -10029,8 +11807,8 @@ void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap) case RTL8821C: /* write 0x28[6:1] = 0x24[30:25] = CrystalCap */ crystal_cap = crystal_cap & 0x3F; - PHY_SetBBReg(adapter, REG_AFE_XTAL_CTRL, 0x7E000000, crystal_cap); - PHY_SetBBReg(adapter, REG_AFE_PLL_CTRL, 0x7E, crystal_cap); + phy_set_bb_reg(adapter, REG_AFE_XTAL_CTRL, 0x7E000000, crystal_cap); + phy_set_bb_reg(adapter, REG_AFE_PLL_CTRL, 0x7E, crystal_cap); break; #endif default: @@ -10151,7 +11929,8 @@ void dump_hal_spec(void *sel, _adapter *adapter) RTW_PRINT_SEL(sel, "rfpath_num_2g:%u\n", hal_spec->rfpath_num_2g); RTW_PRINT_SEL(sel, "rfpath_num_5g:%u\n", hal_spec->rfpath_num_5g); RTW_PRINT_SEL(sel, "max_tx_cnt:%u\n", hal_spec->max_tx_cnt); - RTW_PRINT_SEL(sel, "nss_num:%u\n", hal_spec->nss_num); + RTW_PRINT_SEL(sel, "tx_nss_num:%u\n", hal_spec->tx_nss_num); + RTW_PRINT_SEL(sel, "rx_nss_num:%u\n", hal_spec->rx_nss_num); RTW_PRINT_SEL(sel, "band_cap:"); for (i = 0; i < BAND_CAP_BIT_NUM; i++) { @@ -10246,9 +12025,9 @@ inline bool hal_is_wireless_mode_support(_adapter *adapter, u8 mode) /* * hal_largest_bw - starting from in_bw, get largest bw supported by HAL * @adapter: -* @in_bw: starting bw, value of CHANNEL_WIDTH +* @in_bw: starting bw, value of enum channel_width * -* Returns: value of CHANNEL_WIDTH +* Returns: value of enum channel_width */ u8 hal_largest_bw(_adapter *adapter, u8 in_bw) { @@ -10289,36 +12068,36 @@ void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf) void ResumeTxBeacon(_adapter *padapter) { - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); +#ifdef CONFIG_MI_WITH_MBSSID_CAM +#else + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, + rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2) | BIT(6)); +#ifdef RTW_HALMAC + /* Add this for driver using HALMAC because driver doesn't have setup time init by self */ + /* TBTT setup time */ + rtw_write8(padapter, REG_TBTT_PROHIBIT, TBTT_PROHIBIT_SETUP_TIME); +#endif - /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ - /* which should be read from register to a global variable. */ - - - pHalData->RegFwHwTxQCtrl |= BIT(6); - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); - rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, 0xff); - pHalData->RegReg542 |= BIT(0); - rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, pHalData->RegReg542); + /* TBTT hold time: 0x540[19:8] */ + rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME & 0xFF); + rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, + (rtw_read8(padapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME >> 8)); +#endif } void StopTxBeacon(_adapter *padapter) { - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); +#ifdef CONFIG_MI_WITH_MBSSID_CAM +#else + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, + rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2) & (~BIT6)); - - /* 2010.03.01. Marked by tynli. No need to call workitem beacause we record the value */ - /* which should be read from register to a global variable. */ - - - pHalData->RegFwHwTxQCtrl &= ~BIT(6); - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); - rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, 0x64); - pHalData->RegReg542 &= ~BIT(0); - rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, pHalData->RegReg542); - - /*CheckFwRsvdPageContent(padapter);*/ /* 2010.06.23. Added by tynli. */ + /* TBTT hold time: 0x540[19:8] */ + rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME_STOP_BCN & 0xFF); + rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, + (rtw_read8(padapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME_STOP_BCN >> 8)); +#endif } #ifdef CONFIG_MI_WITH_MBSSID_CAM /*HW port0 - MBSS*/ @@ -10326,7 +12105,7 @@ void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode) { RTW_INFO("%s()-"ADPT_FMT" mode = %d\n", __func__, ADPT_ARG(Adapter), mode); - rtw_write32(Adapter, REG_RCR, rtw_read32(Adapter, REG_RCR) & (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN))); + rtw_hal_rcr_set_chk_bssid(Adapter, MLME_ACTION_NONE); /* disable Port0 TSF update*/ rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL) | DIS_TSF_UDT); @@ -10335,7 +12114,7 @@ void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode) Set_MSR(Adapter, mode); if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { - if (!rtw_mi_check_status(Adapter, MI_AP_MODE)) + if (!rtw_mi_get_ap_num(Adapter) && !rtw_mi_get_mesh_num(Adapter)) StopTxBeacon(Adapter); rtw_write8(Adapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_ATIM);/*disable atim wnd*/ @@ -10355,9 +12134,9 @@ void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode) rtw_write8(Adapter, REG_BCNDMATIM, 0x02); /* 2ms */ /*rtw_write8(Adapter, REG_BCN_MAX_ERR, 0xFF);*/ - rtw_write8(Adapter, REG_ATIMWND, 0x0a); /* 10ms */ + rtw_write8(Adapter, REG_ATIMWND, 0x0c); /* 12ms */ rtw_write16(Adapter, REG_BCNTCFG, 0x00); - rtw_write16(Adapter, REG_TBTT_PROHIBIT, 0xff04); + rtw_write16(Adapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ /*reset TSF*/ @@ -10366,6 +12145,9 @@ void hw_var_set_opmode_mbid(_adapter *Adapter, u8 mode) /*enable BCN0 Function for if1*/ /*don't enable update TSF0 for if1 (due to TSF update when beacon,probe rsp are received)*/ rtw_write8(Adapter, REG_BCN_CTRL, (DIS_TSF_UDT | EN_BCN_FUNCTION | EN_TXBCN_RPT | DIS_BCNQ_SUB)); + #ifdef CONFIG_BCN_XMIT_PROTECT + rtw_write8(Adapter, REG_CCK_CHECK, rtw_read8(Adapter, REG_CCK_CHECK) | BIT_EN_BCN_PKT_REL); + #endif if (IS_HARDWARE_TYPE_8821(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter))/* select BCN on port 0 for DualBeacon*/ rtw_write8(Adapter, REG_CCK_CHECK, rtw_read8(Adapter, REG_CCK_CHECK) & (~BIT_BCN_PORT_SEL)); @@ -10411,3 +12193,152 @@ void rtw_hal_antdiv_rssi_compared(_adapter *padapter, WLAN_BSSID_EX *dst, WLAN_B } } #endif + +#ifdef CONFIG_PHY_CAPABILITY_QUERY +void rtw_dump_phy_cap_by_phydmapi(void *sel, _adapter *adapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); + struct phy_spec_t *phy_spec = &pHalData->phy_spec; + + RTW_PRINT_SEL(sel, "[PHY SPEC] TRx Capability : 0x%08x\n", phy_spec->trx_cap); + RTW_PRINT_SEL(sel, "[PHY SPEC] Tx Stream Num Index : %d\n", (phy_spec->trx_cap >> 24) & 0xFF); /*Tx Stream Num Index [31:24]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] Rx Stream Num Index : %d\n", (phy_spec->trx_cap >> 16) & 0xFF); /*Rx Stream Num Index [23:16]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] Tx Path Num Index : %d\n", (phy_spec->trx_cap >> 8) & 0xFF);/*Tx Path Num Index [15:8]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] Rx Path Num Index : %d\n\n", (phy_spec->trx_cap & 0xFF));/*Rx Path Num Index [7:0]*/ + + RTW_PRINT_SEL(sel, "[PHY SPEC] STBC Capability : 0x%08x\n", phy_spec->stbc_cap); + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT STBC Tx : %s\n", ((phy_spec->stbc_cap >> 24) & 0xFF) ? "Supported" : "N/A"); /*VHT STBC Tx [31:24]*/ + /*VHT STBC Rx [23:16] + 0 = not support + 1 = support for 1 spatial stream + 2 = support for 1 or 2 spatial streams + 3 = support for 1 or 2 or 3 spatial streams + 4 = support for 1 or 2 or 3 or 4 spatial streams*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT STBC Rx :%d\n", ((phy_spec->stbc_cap >> 16) & 0xFF)); + RTW_PRINT_SEL(sel, "[PHY SPEC] HT STBC Tx : %s\n", ((phy_spec->stbc_cap >> 8) & 0xFF) ? "Supported" : "N/A"); /*HT STBC Tx [15:8]*/ + /*HT STBC Rx [7:0] + 0 = not support + 1 = support for 1 spatial stream + 2 = support for 1 or 2 spatial streams + 3 = support for 1 or 2 or 3 spatial streams*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] HT STBC Rx : %d\n\n", (phy_spec->stbc_cap & 0xFF)); + + RTW_PRINT_SEL(sel, "[PHY SPEC] LDPC Capability : 0x%08x\n", phy_spec->ldpc_cap); + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT LDPC Tx : %s\n", ((phy_spec->ldpc_cap >> 24) & 0xFF) ? "Supported" : "N/A"); /*VHT LDPC Tx [31:24]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT LDPC Rx : %s\n", ((phy_spec->ldpc_cap >> 16) & 0xFF) ? "Supported" : "N/A"); /*VHT LDPC Rx [23:16]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] HT LDPC Tx : %s\n", ((phy_spec->ldpc_cap >> 8) & 0xFF) ? "Supported" : "N/A"); /*HT LDPC Tx [15:8]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] HT LDPC Rx : %s\n\n", (phy_spec->ldpc_cap & 0xFF) ? "Supported" : "N/A"); /*HT LDPC Rx [7:0]*/ + #ifdef CONFIG_BEAMFORMING + RTW_PRINT_SEL(sel, "[PHY SPEC] TxBF Capability : 0x%08x\n", phy_spec->txbf_cap); + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT MU Bfer : %s\n", ((phy_spec->txbf_cap >> 28) & 0xF) ? "Supported" : "N/A"); /*VHT MU Bfer [31:28]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT MU Bfee : %s\n", ((phy_spec->txbf_cap >> 24) & 0xF) ? "Supported" : "N/A"); /*VHT MU Bfee [27:24]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT SU Bfer : %s\n", ((phy_spec->txbf_cap >> 20) & 0xF) ? "Supported" : "N/A"); /*VHT SU Bfer [23:20]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT SU Bfee : %s\n", ((phy_spec->txbf_cap >> 16) & 0xF) ? "Supported" : "N/A"); /*VHT SU Bfee [19:16]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] HT Bfer : %s\n", ((phy_spec->txbf_cap >> 4) & 0xF) ? "Supported" : "N/A"); /*HT Bfer [7:4]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] HT Bfee : %s\n\n", (phy_spec->txbf_cap & 0xF) ? "Supported" : "N/A"); /*HT Bfee [3:0]*/ + + RTW_PRINT_SEL(sel, "[PHY SPEC] TxBF parameter : 0x%08x\n", phy_spec->txbf_param); + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT Sounding Dim : %d\n", (phy_spec->txbf_param >> 24) & 0xFF); /*VHT Sounding Dim [31:24]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] VHT Steering Ant : %d\n", (phy_spec->txbf_param >> 16) & 0xFF); /*VHT Steering Ant [23:16]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] HT Sounding Dim : %d\n", (phy_spec->txbf_param >> 8) & 0xFF); /*HT Sounding Dim [15:8]*/ + RTW_PRINT_SEL(sel, "[PHY SPEC] HT Steering Ant : %d\n", phy_spec->txbf_param & 0xFF); /*HT Steering Ant [7:0]*/ + #endif +} +#else +void rtw_dump_phy_cap_by_hal(void *sel, _adapter *adapter) +{ + u8 phy_cap = _FALSE; + + /* STBC */ + rtw_hal_get_def_var(adapter, HAL_DEF_TX_STBC, (u8 *)&phy_cap); + RTW_PRINT_SEL(sel, "[HAL] STBC Tx : %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + + phy_cap = _FALSE; + rtw_hal_get_def_var(adapter, HAL_DEF_RX_STBC, (u8 *)&phy_cap); + RTW_PRINT_SEL(sel, "[HAL] STBC Rx : %s\n\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + + /* LDPC support */ + phy_cap = _FALSE; + rtw_hal_get_def_var(adapter, HAL_DEF_TX_LDPC, (u8 *)&phy_cap); + RTW_PRINT_SEL(sel, "[HAL] LDPC Tx : %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + + phy_cap = _FALSE; + rtw_hal_get_def_var(adapter, HAL_DEF_RX_LDPC, (u8 *)&phy_cap); + RTW_PRINT_SEL(sel, "[HAL] LDPC Rx : %s\n\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + + #ifdef CONFIG_BEAMFORMING + phy_cap = _FALSE; + rtw_hal_get_def_var(adapter, HAL_DEF_EXPLICIT_BEAMFORMER, (u8 *)&phy_cap); + RTW_PRINT_SEL(sel, "[HAL] Beamformer: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + + phy_cap = _FALSE; + rtw_hal_get_def_var(adapter, HAL_DEF_EXPLICIT_BEAMFORMEE, (u8 *)&phy_cap); + RTW_PRINT_SEL(sel, "[HAL] Beamformee: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + + phy_cap = _FALSE; + rtw_hal_get_def_var(adapter, HAL_DEF_VHT_MU_BEAMFORMER, &phy_cap); + RTW_PRINT_SEL(sel, "[HAL] VHT MU Beamformer: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + + phy_cap = _FALSE; + rtw_hal_get_def_var(adapter, HAL_DEF_VHT_MU_BEAMFORMEE, &phy_cap); + RTW_PRINT_SEL(sel, "[HAL] VHT MU Beamformee: %s\n", (_TRUE == phy_cap) ? "Supported" : "N/A"); + #endif +} +#endif +void rtw_dump_phy_cap(void *sel, _adapter *adapter) +{ + RTW_PRINT_SEL(sel, "\n ======== PHY Capability ========\n"); +#ifdef CONFIG_PHY_CAPABILITY_QUERY + rtw_dump_phy_cap_by_phydmapi(sel, adapter); +#else + rtw_dump_phy_cap_by_hal(sel, adapter); +#endif +} + +inline s16 translate_dbm_to_percentage(s16 signal) +{ + if ((signal <= -100) || (signal >= 20)) + return 0; + else if (signal >= 0) + return 100; + else + return 100 + signal; +} + +#ifdef CONFIG_SWTIMER_BASED_TXBCN +#ifdef CONFIG_BCN_RECOVERY +#define REG_CPU_MGQ_INFO 0x041C +#define BIT_BCN_POLL BIT(28) +u8 rtw_ap_bcn_recovery(_adapter *padapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); + + if (hal_data->issue_bcn_fail >= 2) { + RTW_ERR("%s ISSUE BCN Fail\n", __func__); + rtw_write8(padapter, REG_CPU_MGQ_INFO + 3, 0x10); + hal_data->issue_bcn_fail = 0; + } + return _SUCCESS; +} +#endif /*CONFIG_BCN_RECOVERY*/ + +#ifdef CONFIG_BCN_XMIT_PROTECT +u8 rtw_ap_bcn_queue_empty_check(_adapter *padapter, u32 txbcn_timer_ms) +{ + u32 start_time = rtw_get_current_time(); + u8 bcn_queue_empty = _FALSE; + + do { + if (rtw_read16(padapter, REG_TXPKT_EMPTY) & BIT(11)) { + bcn_queue_empty = _TRUE; + break; + } + } while (rtw_get_passing_time_ms(start_time) <= (txbcn_timer_ms + 10)); + + if (bcn_queue_empty == _FALSE) + RTW_ERR("%s BCN queue not empty\n", __func__); + + return bcn_queue_empty; +} +#endif /*CONFIG_BCN_XMIT_PROTECT*/ +#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_c2h.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_c2h.h index de8aeefafa9b..4991fcced7ae 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_c2h.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_c2h.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __COMMON_C2H_H__ #define __COMMON_C2H_H__ @@ -57,10 +52,12 @@ typedef enum _C2H_EVT { C2H_LB = 0x01, C2H_TXBF = 0x02, C2H_CCX_TX_RPT = 0x03, + C2H_AP_REQ_TXRPT = 0x04, C2H_FW_SCAN_COMPLETE = 0x7, C2H_BT_INFO = 0x09, C2H_BT_MP_INFO = 0x0B, C2H_RA_RPT = 0x0C, + C2H_SPC_STAT = 0x0D, C2H_RA_PARA_RPT = 0x0E, C2H_FW_CHNL_SWITCH_COMPLETE = 0x10, C2H_IQK_FINISH = 0x11, @@ -73,6 +70,7 @@ typedef enum _C2H_EVT { C2H_DEFEATURE_DBG = 0x22, C2H_CUSTOMER_STR_RPT = 0x24, C2H_CUSTOMER_STR_RPT_2 = 0x25, + C2H_WLAN_INFO = 0x27, C2H_DEFEATURE_RSVD = 0xFD, C2H_EXTEND = 0xff, } C2H_EVT; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_phycfg.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_phycfg.c index eda712d3ea62..dafac278539c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_phycfg.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_com_phycfg.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_COM_PHYCFG_C_ #include @@ -57,7 +52,8 @@ const char *const _pg_txpwr_src_str[] = { #define DBG_PG_TXPWR_READ 0 #endif -void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) +#if DBG_PG_TXPWR_READ +static void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) { int path, group, tx_idx; @@ -141,7 +137,7 @@ void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, RTW_PRINT_SEL(sel, "\n"); } -void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) +static void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt) { int path, group, tx_idx; @@ -224,6 +220,7 @@ void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, } RTW_PRINT_SEL(sel, "\n"); } +#endif /* DBG_PG_TXPWR_READ */ const struct map_t pg_txpwr_def_info = MAP_ENT(0xB8, 1, 0xFF @@ -920,12 +917,12 @@ void hal_load_pg_txpwr_info( rtw_warn_on(1); exit: - if (DBG_PG_TXPWR_READ) { - if (pwr_info_2g) - dump_pg_txpwr_info_2g(RTW_DBGDUMP, pwr_info_2g, 4, 4); - if (pwr_info_5g) - dump_pg_txpwr_info_5g(RTW_DBGDUMP, pwr_info_5g, 4, 4); - } + #if DBG_PG_TXPWR_READ + if (pwr_info_2g) + dump_pg_txpwr_info_2g(RTW_DBGDUMP, pwr_info_2g, 4, 4); + if (pwr_info_5g) + dump_pg_txpwr_info_5g(RTW_DBGDUMP, pwr_info_5g, 4, 4); + #endif return; } @@ -1269,7 +1266,7 @@ bool rtw_regsty_chk_target_tx_power_valid(_adapter *adapter) for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); - if (tx_num >= hal_spec->nss_num) + if (tx_num >= hal_spec->tx_nss_num) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) @@ -1300,7 +1297,6 @@ PHY_GetTxPowerByRateBase( IN PADAPTER Adapter, IN u8 Band, IN u8 RfPath, - IN u8 TxNum, IN RATE_SECTION RateSection ) { @@ -1320,15 +1316,15 @@ PHY_GetTxPowerByRateBase( if (RateSection >= RATE_SECTION_NUM || (Band == BAND_ON_5G && RateSection == CCK) ) { - RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d, TxNum:%d\n", __func__ - , RateSection, Band, RfPath, TxNum); + RTW_PRINT("%s invalid RateSection:%d in Band:%d, RfPath:%d\n", __func__ + , RateSection, Band, RfPath); return 0; } if (Band == BAND_ON_2_4G) - value = pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][RateSection]; + value = pHalData->TxPwrByRateBase2_4G[RfPath][RateSection]; else /* BAND_ON_5G */ - value = pHalData->TxPwrByRateBase5G[RfPath][TxNum][RateSection - 1]; + value = pHalData->TxPwrByRateBase5G[RfPath][RateSection - 1]; return value; } @@ -1339,7 +1335,6 @@ phy_SetTxPowerByRateBase( IN u8 Band, IN u8 RfPath, IN RATE_SECTION RateSection, - IN u8 TxNum, IN u8 Value ) { @@ -1358,45 +1353,40 @@ phy_SetTxPowerByRateBase( if (RateSection >= RATE_SECTION_NUM || (Band == BAND_ON_5G && RateSection == CCK) ) { - RTW_PRINT("%s invalid RateSection:%d in %sG, RfPath:%d, TxNum:%d\n", __func__ - , RateSection, (Band == BAND_ON_2_4G) ? "2.4" : "5", RfPath, TxNum); + RTW_PRINT("%s invalid RateSection:%d in %sG, RfPath:%d\n", __func__ + , RateSection, (Band == BAND_ON_2_4G) ? "2.4" : "5", RfPath); return; } if (Band == BAND_ON_2_4G) - pHalData->TxPwrByRateBase2_4G[RfPath][TxNum][RateSection] = Value; + pHalData->TxPwrByRateBase2_4G[RfPath][RateSection] = Value; else /* BAND_ON_5G */ - pHalData->TxPwrByRateBase5G[RfPath][TxNum][RateSection - 1] = Value; + pHalData->TxPwrByRateBase5G[RfPath][RateSection - 1] = Value; } static inline BOOLEAN phy_is_txpwr_by_rate_undefined_of_band_path(_adapter *adapter, u8 band, u8 path) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - u8 tx_num = 0, rate_idx = 0; + u8 rate_idx = 0; - for (tx_num = 0; tx_num < TX_PWR_BY_RATE_NUM_RF; tx_num++) { - if (tx_num >= hal_spec->max_tx_cnt || tx_num >= hal_spec->nss_num) + for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) { + if (hal_data->TxPwrByRateOffset[band][path][rate_idx] != 0) goto exit; - for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) { - if (hal_data->TxPwrByRateOffset[band][path][tx_num][rate_idx] != 0) - goto exit; - } } exit: - return (tx_num >= hal_spec->max_tx_cnt || tx_num >= hal_spec->nss_num) ? _TRUE : _FALSE; + return rate_idx >= TX_PWR_BY_RATE_NUM_RATE ? _TRUE : _FALSE; } static inline void phy_txpwr_by_rate_duplicate_band_path(_adapter *adapter, u8 band, u8 s_path, u8 t_path) { struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - u8 tx_num = 0, rate_idx = 0; + u8 rate_idx = 0; - for (tx_num = 0; tx_num < TX_PWR_BY_RATE_NUM_RF; tx_num++) - for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) - hal_data->TxPwrByRateOffset[band][t_path][tx_num][rate_idx] = hal_data->TxPwrByRateOffset[band][s_path][tx_num][rate_idx]; + for (rate_idx = 0; rate_idx < TX_PWR_BY_RATE_NUM_RATE; rate_idx++) + hal_data->TxPwrByRateOffset[band][t_path][rate_idx] = hal_data->TxPwrByRateOffset[band][s_path][rate_idx]; } static void phy_txpwr_by_rate_chk_for_path_dup(_adapter *adapter) @@ -1489,7 +1479,7 @@ phy_StoreTxPowerByRateBase( for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); - if (tx_num >= hal_spec->nss_num) + if (tx_num >= hal_spec->tx_nss_num) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) @@ -1501,8 +1491,8 @@ phy_StoreTxPowerByRateBase( if (regsty->target_tx_pwr_valid == _TRUE) base = 2 * rtw_regsty_get_target_tx_power(pAdapter, band, path, rs); else - base = _PHY_GetTxPowerByRate(pAdapter, band, path, tx_num, rate_sec_base[rs]); - phy_SetTxPowerByRateBase(pAdapter, band, path, rs, tx_num, base); + base = _PHY_GetTxPowerByRate(pAdapter, band, path, rate_sec_base[rs]); + phy_SetTxPowerByRateBase(pAdapter, band, path, rs, base); } } } @@ -1520,7 +1510,7 @@ PHY_GetRateValuesOfTxPowerByRate( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; u8 index = 0, i = 0; switch (RegAddr) { @@ -1903,7 +1893,6 @@ PHY_StoreTxPowerByRateNew( IN PADAPTER pAdapter, IN u32 Band, IN u32 RfPath, - IN u32 TxNum, IN u32 RegAddr, IN u32 BitMask, IN u32 Data @@ -1920,29 +1909,15 @@ PHY_StoreTxPowerByRateNew( return; } - if (RfPath > ODM_RF_PATH_D) { + if (RfPath > RF_PATH_D) { RTW_PRINT("Invalid RfPath %d\n", RfPath); return; } - if (TxNum > ODM_RF_PATH_D) { - RTW_PRINT("Invalid TxNum %d\n", TxNum); - return; - } - for (i = 0; i < rateNum; ++i) { u8 rate_idx = PHY_GetRateIndexOfTxPowerByRate(rates[i]); - if (IS_1T_RATE(rates[i])) - pHalData->TxPwrByRateOffset[Band][RfPath][RF_1TX][rate_idx] = PwrByRateVal[i]; - else if (IS_2T_RATE(rates[i])) - pHalData->TxPwrByRateOffset[Band][RfPath][RF_2TX][rate_idx] = PwrByRateVal[i]; - else if (IS_3T_RATE(rates[i])) - pHalData->TxPwrByRateOffset[Band][RfPath][RF_3TX][rate_idx] = PwrByRateVal[i]; - else if (IS_4T_RATE(rates[i])) - pHalData->TxPwrByRateOffset[Band][RfPath][RF_4TX][rate_idx] = PwrByRateVal[i]; - else - rtw_warn_on(1); + pHalData->TxPwrByRateOffset[Band][RfPath][rate_idx] = PwrByRateVal[i]; } } @@ -1952,17 +1927,16 @@ PHY_InitTxPowerByRate( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u8 band = 0, rfPath = 0, TxNum = 0, rate = 0, i = 0, j = 0; + u8 band = 0, rfPath = 0, rate = 0, i = 0, j = 0; for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) for (rfPath = 0; rfPath < TX_PWR_BY_RATE_NUM_RF; ++rfPath) - for (TxNum = 0; TxNum < TX_PWR_BY_RATE_NUM_RF; ++TxNum) for (rate = 0; rate < TX_PWR_BY_RATE_NUM_RATE; ++rate) - pHalData->TxPwrByRateOffset[band][rfPath][TxNum][rate] = 0; + pHalData->TxPwrByRateOffset[band][rfPath][rate] = 0; } VOID -PHY_StoreTxPowerByRate( +phy_store_tx_power_by_rate( IN PADAPTER pAdapter, IN u32 Band, IN u32 RfPath, @@ -1973,12 +1947,12 @@ PHY_StoreTxPowerByRate( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - if (pDM_Odm->PhyRegPgVersion > 0) - PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, TxNum, RegAddr, BitMask, Data); + if (pDM_Odm->phy_reg_pg_version > 0) + PHY_StoreTxPowerByRateNew(pAdapter, Band, RfPath, RegAddr, BitMask, Data); else - RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->PhyRegPgVersion); + RTW_INFO("Invalid PHY_REG_PG.txt version %d\n", pDM_Odm->phy_reg_pg_version); } @@ -1989,7 +1963,7 @@ phy_ConvertTxPowerByRateInDbmToRelativeValues( { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); u8 base = 0, i = 0, value = 0, - band = 0, path = 0, txNum = 0, index = 0, + band = 0, path = 0, index = 0, startIndex = 0, endIndex = 0; u8 cckRates[4] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, ofdmRates[8] = {MGN_6M, MGN_9M, MGN_12M, MGN_18M, MGN_24M, MGN_36M, MGN_48M, MGN_54M}, @@ -2006,65 +1980,63 @@ phy_ConvertTxPowerByRateInDbmToRelativeValues( /* RTW_INFO("===>PHY_ConvertTxPowerByRateInDbmToRelativeValues()\n" ); */ for (band = BAND_ON_2_4G; band <= BAND_ON_5G; ++band) { - for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path) { - for (txNum = RF_1TX; txNum < RF_MAX_TX_NUM; ++txNum) { - /* CCK */ - if (band == BAND_ON_2_4G) { - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, CCK); - for (i = 0; i < sizeof(cckRates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, cckRates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, cckRates[i], value - base); - } + for (path = RF_PATH_A; path <= RF_PATH_D; ++path) { + /* CCK */ + if (band == BAND_ON_2_4G) { + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, CCK); + for (i = 0; i < sizeof(cckRates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, cckRates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, cckRates[i], value - base); } + } - /* OFDM */ - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, OFDM); - for (i = 0; i < sizeof(ofdmRates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, ofdmRates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, ofdmRates[i], value - base); - } + /* OFDM */ + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, OFDM); + for (i = 0; i < sizeof(ofdmRates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, ofdmRates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, ofdmRates[i], value - base); + } - /* HT MCS0~7 */ - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_1SS); - for (i = 0; i < sizeof(mcs0_7Rates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs0_7Rates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs0_7Rates[i], value - base); - } + /* HT MCS0~7 */ + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, HT_1SS); + for (i = 0; i < sizeof(mcs0_7Rates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs0_7Rates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, mcs0_7Rates[i], value - base); + } - /* HT MCS8~15 */ - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_2SS); - for (i = 0; i < sizeof(mcs8_15Rates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs8_15Rates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs8_15Rates[i], value - base); - } + /* HT MCS8~15 */ + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, HT_2SS); + for (i = 0; i < sizeof(mcs8_15Rates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs8_15Rates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, mcs8_15Rates[i], value - base); + } - /* HT MCS16~23 */ - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, HT_3SS); - for (i = 0; i < sizeof(mcs16_23Rates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, mcs16_23Rates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, mcs16_23Rates[i], value - base); - } + /* HT MCS16~23 */ + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, HT_3SS); + for (i = 0; i < sizeof(mcs16_23Rates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, mcs16_23Rates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, mcs16_23Rates[i], value - base); + } - /* VHT 1SS */ - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_1SS); - for (i = 0; i < sizeof(vht1ssRates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht1ssRates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht1ssRates[i], value - base); - } + /* VHT 1SS */ + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, VHT_1SS); + for (i = 0; i < sizeof(vht1ssRates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, vht1ssRates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, vht1ssRates[i], value - base); + } - /* VHT 2SS */ - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_2SS); - for (i = 0; i < sizeof(vht2ssRates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht2ssRates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht2ssRates[i], value - base); - } + /* VHT 2SS */ + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, VHT_2SS); + for (i = 0; i < sizeof(vht2ssRates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, vht2ssRates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, vht2ssRates[i], value - base); + } - /* VHT 3SS */ - base = PHY_GetTxPowerByRateBase(pAdapter, band, path, txNum, VHT_3SS); - for (i = 0; i < sizeof(vht3ssRates); ++i) { - value = PHY_GetTxPowerByRate(pAdapter, band, path, txNum, vht3ssRates[i]); - PHY_SetTxPowerByRate(pAdapter, band, path, txNum, vht3ssRates[i], value - base); - } + /* VHT 3SS */ + base = PHY_GetTxPowerByRateBase(pAdapter, band, path, VHT_3SS); + for (i = 0; i < sizeof(vht3ssRates); ++i) { + value = PHY_GetTxPowerByRate(pAdapter, band, path, vht3ssRates[i]); + PHY_SetTxPowerByRate(pAdapter, band, path, vht3ssRates[i], value - base); } } } @@ -2089,9 +2061,9 @@ PHY_TxPowerByRateConfiguration( } VOID -PHY_SetTxPowerIndexByRateSection( +phy_set_tx_power_index_by_rate_section( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Channel, IN u8 RateSection ) @@ -2104,10 +2076,10 @@ PHY_SetTxPowerIndexByRateSection( goto exit; } - if (RateSection == CCK && pHalData->CurrentBandType != BAND_ON_2_4G) + if (RateSection == CCK && pHalData->current_band_type != BAND_ON_2_4G) goto exit; - PHY_SetTxPowerIndexByRateArray(pAdapter, RFPath, pHalData->CurrentChannelBW, Channel, + PHY_SetTxPowerIndexByRateArray(pAdapter, RFPath, pHalData->current_channel_bw, Channel, rates_by_sections[RateSection].rates, rates_by_sections[RateSection].rate_num); exit: @@ -2143,15 +2115,16 @@ phy_GetChnlIndex( u8 PHY_GetTxPowerIndexBase( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, + u8 ntx_idx, + IN enum channel_width BandWidth, IN u8 Channel, OUT PBOOLEAN bIn24G ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; u8 i = 0; /* default set to 1S */ u8 txPower = 0; u8 chnlIdx = (Channel - 1); @@ -2163,163 +2136,179 @@ PHY_GetTxPowerIndexBase( *bIn24G = phy_GetChnlIndex(Channel, &chnlIdx); - /* RTW_INFO("[%s] Channel Index: %d\n", (*bIn24G?"2.4G":"5G"), chnlIdx); */ + if (0) + RTW_INFO("[%s] Channel Index: %d\n", (*bIn24G ? "2.4G" : "5G"), chnlIdx); - if (*bIn24G) { /* 3 ============================== 2.4 G ============================== */ - if (IS_CCK_RATE(Rate)) + if (*bIn24G) { + if (IS_CCK_RATE(Rate)) { + /* CCK-nTX */ txPower = pHalData->Index24G_CCK_Base[RFPath][chnlIdx]; - else if (MGN_6M <= Rate) - txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; - else - RTW_INFO("PHY_GetTxPowerIndexBase: INVALID Rate.\n"); - - /* RTW_INFO("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ - /* ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); */ - - /* OFDM-1T */ - if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { - txPower += pHalData->OFDM_24G_Diff[RFPath][TX_1S]; - /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_24G_Diff[RFPath][TX_1S]); */ + txPower += pHalData->CCK_24G_Diff[RFPath][RF_1TX]; + if (ntx_idx >= RF_2TX) + txPower += pHalData->CCK_24G_Diff[RFPath][RF_2TX]; + if (ntx_idx >= RF_3TX) + txPower += pHalData->CCK_24G_Diff[RFPath][RF_3TX]; + if (ntx_idx >= RF_4TX) + txPower += pHalData->CCK_24G_Diff[RFPath][RF_4TX]; + goto exit; } - /* BW20-1S, BW20-2S */ + + txPower = pHalData->Index24G_BW40_Base[RFPath][chnlIdx]; + + /* OFDM-nTX */ + if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { + txPower += pHalData->OFDM_24G_Diff[RFPath][RF_1TX]; + if (ntx_idx >= RF_2TX) + txPower += pHalData->OFDM_24G_Diff[RFPath][RF_2TX]; + if (ntx_idx >= RF_3TX) + txPower += pHalData->OFDM_24G_Diff[RFPath][RF_3TX]; + if (ntx_idx >= RF_4TX) + txPower += pHalData->OFDM_24G_Diff[RFPath][RF_4TX]; + goto exit; + } + + /* BW20-nS */ if (BandWidth == CHANNEL_WIDTH_20) { if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_24G_Diff[RFPath][TX_1S]; + txPower += pHalData->BW20_24G_Diff[RFPath][RF_1TX]; if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_24G_Diff[RFPath][TX_2S]; + txPower += pHalData->BW20_24G_Diff[RFPath][RF_2TX]; if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_24G_Diff[RFPath][TX_3S]; + txPower += pHalData->BW20_24G_Diff[RFPath][RF_3TX]; if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_24G_Diff[RFPath][TX_4S]; - - /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ - /* pHalData->BW20_24G_Diff[RFPath][TX_1S], pHalData->BW20_24G_Diff[RFPath][TX_2S], */ - /* pHalData->BW20_24G_Diff[RFPath][TX_3S], pHalData->BW20_24G_Diff[RFPath][TX_4S]); */ + txPower += pHalData->BW20_24G_Diff[RFPath][RF_4TX]; + goto exit; } - /* BW40-1S, BW40-2S */ - else if (BandWidth == CHANNEL_WIDTH_40) { + + /* BW40-nS */ + if (BandWidth == CHANNEL_WIDTH_40) { if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; + txPower += pHalData->BW40_24G_Diff[RFPath][RF_1TX]; if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; + txPower += pHalData->BW40_24G_Diff[RFPath][RF_2TX]; if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; + txPower += pHalData->BW40_24G_Diff[RFPath][RF_3TX]; if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; - - /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ - /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ - /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ + txPower += pHalData->BW40_24G_Diff[RFPath][RF_4TX]; + goto exit; } + /* Willis suggest adopt BW 40M power index while in BW 80 mode */ - else if (BandWidth == CHANNEL_WIDTH_80) { + if (BandWidth == CHANNEL_WIDTH_80) { if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_1S]; + txPower += pHalData->BW40_24G_Diff[RFPath][RF_1TX]; if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_2S]; + txPower += pHalData->BW40_24G_Diff[RFPath][RF_2TX]; if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_3S]; + txPower += pHalData->BW40_24G_Diff[RFPath][RF_3TX]; if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_24G_Diff[RFPath][TX_4S]; - - /* RTW_INFO("+PowerDiff 2.4G (RF-%c): (BW40-1S, BW40-2S, BW40-3S, BW40-4T) = (%d, %d, %d, %d) P.S. Current is in BW 80MHz\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ - /* pHalData->BW40_24G_Diff[RFPath][TX_1S], pHalData->BW40_24G_Diff[RFPath][TX_2S], */ - /* pHalData->BW40_24G_Diff[RFPath][TX_3S], pHalData->BW40_24G_Diff[RFPath][TX_4S]); */ + txPower += pHalData->BW40_24G_Diff[RFPath][RF_4TX]; + goto exit; } } #ifdef CONFIG_IEEE80211_BAND_5GHZ - else { /* 3 ============================== 5 G ============================== */ - if (MGN_6M <= Rate) + else { + if (Rate >= MGN_6M) txPower = pHalData->Index5G_BW40_Base[RFPath][chnlIdx]; - else - RTW_INFO("===> mpt_ProQueryCalTxPower_Jaguar: INVALID Rate.\n"); - - /* RTW_INFO("Base Tx power(RF-%c, Rate #%d, Channel Index %d) = 0x%X\n", */ - /* ((RFPath==0)?'A':'B'), Rate, chnlIdx, txPower); */ - - /* OFDM-1T */ - if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { - txPower += pHalData->OFDM_5G_Diff[RFPath][TX_1S]; - /* RTW_INFO("+PowerDiff 5G (RF-%c): (OFDM-1T) = (%d)\n", ((RFPath==0)?'A':'B'), pHalData->OFDM_5G_Diff[RFPath][TX_1S]); */ + else { + RTW_INFO("===>PHY_GetTxPowerIndexBase: INVALID Rate(0x%02x).\n", Rate); + goto exit; } - /* BW20-1S, BW20-2S */ + /* OFDM-nTX */ + if ((MGN_6M <= Rate && Rate <= MGN_54M) && !IS_CCK_RATE(Rate)) { + txPower += pHalData->OFDM_5G_Diff[RFPath][RF_1TX]; + if (ntx_idx >= RF_2TX) + txPower += pHalData->OFDM_5G_Diff[RFPath][RF_2TX]; + if (ntx_idx >= RF_3TX) + txPower += pHalData->OFDM_5G_Diff[RFPath][RF_3TX]; + if (ntx_idx >= RF_4TX) + txPower += pHalData->OFDM_5G_Diff[RFPath][RF_4TX]; + goto exit; + } + + /* BW20-nS */ if (BandWidth == CHANNEL_WIDTH_20) { if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_5G_Diff[RFPath][TX_1S]; + txPower += pHalData->BW20_5G_Diff[RFPath][RF_1TX]; if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_5G_Diff[RFPath][TX_2S]; + txPower += pHalData->BW20_5G_Diff[RFPath][RF_2TX]; if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_5G_Diff[RFPath][TX_3S]; + txPower += pHalData->BW20_5G_Diff[RFPath][RF_3TX]; if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW20_5G_Diff[RFPath][TX_4S]; - - /* RTW_INFO("+PowerDiff 5G (RF-%c): (BW20-1S, BW20-2S, BW20-3S, BW20-4S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ - /* pHalData->BW20_5G_Diff[RFPath][TX_1S], pHalData->BW20_5G_Diff[RFPath][TX_2S], */ - /* pHalData->BW20_5G_Diff[RFPath][TX_3S], pHalData->BW20_5G_Diff[RFPath][TX_4S]); */ + txPower += pHalData->BW20_5G_Diff[RFPath][RF_4TX]; + goto exit; } - /* BW40-1S, BW40-2S */ - else if (BandWidth == CHANNEL_WIDTH_40) { + + /* BW40-nS */ + if (BandWidth == CHANNEL_WIDTH_40) { if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_5G_Diff[RFPath][TX_1S]; + txPower += pHalData->BW40_5G_Diff[RFPath][RF_1TX]; if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_5G_Diff[RFPath][TX_2S]; + txPower += pHalData->BW40_5G_Diff[RFPath][RF_2TX]; if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_5G_Diff[RFPath][TX_3S]; + txPower += pHalData->BW40_5G_Diff[RFPath][RF_3TX]; if ((MGN_MCS24 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW40_5G_Diff[RFPath][TX_4S]; - - /* RTW_INFO("+PowerDiff 5G(RF-%c): (BW40-1S, BW40-2S) = (%d, %d, %d, %d)\n", ((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ - /* pHalData->BW40_5G_Diff[RFPath][TX_1S], pHalData->BW40_5G_Diff[RFPath][TX_2S], */ - /* pHalData->BW40_5G_Diff[RFPath][TX_3S], pHalData->BW40_5G_Diff[RFPath][TX_4S]); */ + txPower += pHalData->BW40_5G_Diff[RFPath][RF_4TX]; + goto exit; } - /* BW80-1S, BW80-2S */ - else if (BandWidth == CHANNEL_WIDTH_80) { - /* <20121220, Kordan> Get the index of array "Index5G_BW80_Base". */ - for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) - if (center_ch_5g_80m[i] == Channel) + + /* BW80-nS */ + if (BandWidth == CHANNEL_WIDTH_80) { + /* get 80MHz cch index */ + for (i = 0; i < CENTER_CH_5G_80M_NUM; ++i) { + if (center_ch_5g_80m[i] == Channel) { chnlIdx = i; + break; + } + } + if (i >= CENTER_CH_5G_80M_NUM) { + rtw_warn_on(1); + txPower = 0; + goto exit; + } txPower = pHalData->Index5G_BW80_Base[RFPath][chnlIdx]; if ((MGN_MCS0 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT1SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += + pHalData->BW80_5G_Diff[RFPath][TX_1S]; + txPower += + pHalData->BW80_5G_Diff[RFPath][RF_1TX]; if ((MGN_MCS8 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT2SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW80_5G_Diff[RFPath][TX_2S]; + txPower += pHalData->BW80_5G_Diff[RFPath][RF_2TX]; if ((MGN_MCS16 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT3SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW80_5G_Diff[RFPath][TX_3S]; + txPower += pHalData->BW80_5G_Diff[RFPath][RF_3TX]; if ((MGN_MCS23 <= Rate && Rate <= MGN_MCS31) || (MGN_VHT4SS_MCS0 <= Rate && Rate <= MGN_VHT4SS_MCS9)) - txPower += pHalData->BW80_5G_Diff[RFPath][TX_4S]; - - /* RTW_INFO("+PowerDiff 5G(RF-%c): (BW80-1S, BW80-2S, BW80-3S, BW80-4S) = (%d, %d, %d, %d)\n",((RFPath==0)?'A':(RFPath==1)?'B':(RFPath==2)?'C':'D'), */ - /* pHalData->BW80_5G_Diff[RFPath][TX_1S], pHalData->BW80_5G_Diff[RFPath][TX_2S], */ - /* pHalData->BW80_5G_Diff[RFPath][TX_3S], pHalData->BW80_5G_Diff[RFPath][TX_4S]); */ + txPower += pHalData->BW80_5G_Diff[RFPath][RF_4TX]; + goto exit; } + + /* TODO: BW160-nS */ + rtw_warn_on(1); } #endif /* CONFIG_IEEE80211_BAND_5GHZ */ +exit: return txPower; } s8 PHY_GetTxPowerTrackingOffset( PADAPTER pAdapter, - u8 RFPath, + enum rf_path RFPath, u8 Rate ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; s8 offset = 0; - if (pDM_Odm->RFCalibrateInfo.TxPowerTrackControl == _FALSE) + if (pDM_Odm->rf_calibrate_info.txpowertrack_control == _FALSE) return offset; if ((Rate == MGN_1M) || (Rate == MGN_2M) || (Rate == MGN_5_5M) || (Rate == MGN_11M)) { - offset = pDM_Odm->RFCalibrateInfo.Remnant_CCKSwingIdx; + offset = pDM_Odm->rf_calibrate_info.remnant_cck_swing_idx; /*RTW_INFO("+Remnant_CCKSwingIdx = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_CCKSwingIdx);*/ } else { - offset = pDM_Odm->RFCalibrateInfo.Remnant_OFDMSwingIdx[RFPath]; + offset = pDM_Odm->rf_calibrate_info.remnant_ofdm_swing_idx[RFPath]; /*RTW_INFO("+Remanant_OFDMSwingIdx[RFPath %u][Rate 0x%x] = 0x%x\n", RFPath, Rate, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath]); */ } @@ -2599,8 +2588,7 @@ s8 _PHY_GetTxPowerByRate( IN PADAPTER pAdapter, IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, + IN enum rf_path RFPath, IN u8 Rate ) { @@ -2612,20 +2600,16 @@ _PHY_GetTxPowerByRate( RTW_INFO("Invalid band %d in %s\n", Band, __func__); goto exit; } - if (RFPath > ODM_RF_PATH_D) { + if (RFPath > RF_PATH_D) { RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __func__); goto exit; } - if (TxNum >= RF_MAX_TX_NUM) { - RTW_INFO("Invalid TxNum %d in %s\n", TxNum, __func__); - goto exit; - } if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __func__); goto exit; } - value = pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex]; + value = pHalData->TxPwrByRateOffset[Band][RFPath][rateIndex]; exit: return value; @@ -2636,66 +2620,21 @@ s8 PHY_GetTxPowerByRate( IN PADAPTER pAdapter, IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, + IN enum rf_path RFPath, IN u8 Rate ) { if (!phy_is_tx_power_by_rate_needed(pAdapter)) return 0; - return _PHY_GetTxPowerByRate(pAdapter, Band, RFPath, TxNum, Rate); + return _PHY_GetTxPowerByRate(pAdapter, Band, RFPath, Rate); } -#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -s8 -PHY_GetTxPowerByRateOriginal( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 Rate -) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - s8 value = 0, limit = 0; - u8 rateIndex = PHY_GetRateIndexOfTxPowerByRate(Rate); - - if ((pAdapter->registrypriv.RegEnableTxPowerByRate == 2 && pHalData->EEPROMRegulatory == 2) || - pAdapter->registrypriv.RegEnableTxPowerByRate == 0) - return 0; - - if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { - DBG_871X("Invalid band %d in %s\n", Band, __func__); - return value; - } - if (RFPath > ODM_RF_PATH_D) { - DBG_871X("Invalid RfPath %d in %s\n", RFPath, __func__); - return value; - } - if (TxNum >= RF_MAX_TX_NUM) { - DBG_871X("Invalid TxNum %d in %s\n", TxNum, __func__); - return value; - } - if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { - DBG_871X("Invalid RateIndex %d in %s\n", rateIndex, __func__); - return value; - } - - value = pHalData->TxPwrByRate[Band][RFPath][TxNum][rateIndex]; - - return value; -} - -#endif - - VOID PHY_SetTxPowerByRate( IN PADAPTER pAdapter, IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, + IN enum rf_path RFPath, IN u8 Rate, IN s8 Value ) @@ -2707,52 +2646,48 @@ PHY_SetTxPowerByRate( RTW_INFO("Invalid band %d in %s\n", Band, __FUNCTION__); return; } - if (RFPath > ODM_RF_PATH_D) { + if (RFPath > RF_PATH_D) { RTW_INFO("Invalid RfPath %d in %s\n", RFPath, __FUNCTION__); return; } - if (TxNum >= RF_MAX_TX_NUM) { - RTW_INFO("Invalid TxNum %d in %s\n", TxNum, __FUNCTION__); - return; - } if (rateIndex >= TX_PWR_BY_RATE_NUM_RATE) { RTW_INFO("Invalid RateIndex %d in %s\n", rateIndex, __FUNCTION__); return; } - pHalData->TxPwrByRateOffset[Band][RFPath][TxNum][rateIndex] = Value; + pHalData->TxPwrByRateOffset[Band][RFPath][rateIndex] = Value; } VOID -PHY_SetTxPowerLevelByPath( +phy_set_tx_power_level_by_path( IN PADAPTER Adapter, IN u8 channel, IN u8 path ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - BOOLEAN bIsIn24G = (pHalData->CurrentBandType == BAND_ON_2_4G); + BOOLEAN bIsIn24G = (pHalData->current_band_type == BAND_ON_2_4G); /* if ( pMgntInfo->RegNByteAccess == 0 ) */ { if (bIsIn24G) - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, CCK); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, CCK); - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, OFDM); - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS0_MCS7); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, OFDM); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS0_MCS7); if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_1SSMCS0_1SSMCS9); if (pHalData->NumTotalRFPath >= 2) { - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS8_MCS15); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS8_MCS15); if (IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter)) - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_2SSMCS0_2SSMCS9); if (IS_HARDWARE_TYPE_8814A(Adapter)) { - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, HT_MCS16_MCS23); - PHY_SetTxPowerIndexByRateSection(Adapter, path, channel, VHT_3SSMCS0_3SSMCS9); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, HT_MCS16_MCS23); + phy_set_tx_power_index_by_rate_section(Adapter, path, channel, VHT_3SSMCS0_3SSMCS9); } } } @@ -2765,8 +2700,8 @@ PHY_SetTxPowerLevelByPath( VOID PHY_SetTxPowerIndexByRateArray( IN PADAPTER pAdapter, - IN u8 RFPath, - IN CHANNEL_WIDTH BandWidth, + IN enum rf_path RFPath, + IN enum channel_width BandWidth, IN u8 Channel, IN u8 *Rates, IN u8 RateArraySize @@ -2780,33 +2715,26 @@ PHY_SetTxPowerIndexByRateArray( struct txpwr_idx_comp tic; powerIndex = rtw_hal_get_tx_power_index(pAdapter, RFPath, Rates[i], BandWidth, Channel, &tic); - RTW_INFO("TXPWR: [%c][%s]ch:%u, %s, pwr_idx:%u = %u + (%d=%d:%d) + (%d) + (%d)\n" - , rf_path_char(RFPath), ch_width_str(BandWidth), Channel, MGN_RATE_STR(Rates[i]) + RTW_INFO("TXPWR: [%c][%s]ch:%u, %s %uT, pwr_idx:%u = %u + (%d=%d:%d) + (%d) + (%d)\n" + , rf_path_char(RFPath), ch_width_str(BandWidth), Channel, MGN_RATE_STR(Rates[i]), tic.ntx_idx + 1 , powerIndex, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); #else - powerIndex = PHY_GetTxPowerIndex(pAdapter, RFPath, Rates[i], BandWidth, Channel); + powerIndex = phy_get_tx_power_index(pAdapter, RFPath, Rates[i], BandWidth, Channel); #endif PHY_SetTxPowerIndex(pAdapter, powerIndex, RFPath, Rates[i]); } } -s8 -phy_GetWorldWideLimit( - s8 *LimitTable -) -{ - s8 min = LimitTable[0]; - u8 i = 0; +#ifdef CONFIG_TXPWR_LIMIT +const char *const _txpwr_lmt_rs_str[] = { + "CCK", + "OFDM", + "HT", + "VHT", + "UNKNOWN", +}; - for (i = 0; i < MAX_REGULATION_NUM; ++i) { - if (LimitTable[i] < min) - min = LimitTable[i]; - } - - return min; -} - -s8 +static s8 phy_GetChannelIndexOfTxPowerLimit( IN u8 Band, IN u8 Channel @@ -2831,104 +2759,203 @@ phy_GetChannelIndexOfTxPowerLimit( return channelIndex; } -static s8 _phy_get_txpwr_lmt( +/* return txpwr limit absolute value */ +s8 phy_get_txpwr_lmt_abs( IN PADAPTER Adapter, - IN u32 RegPwrTblSel, + IN const char *regd_name, IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel, - BOOLEAN no_sc + IN enum channel_width bw, + u8 tlrs, + u8 ntx_idx, + u8 cch, + u8 lock ) { struct dvobj_priv *dvobj = adapter_to_dvobj(Adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(Adapter); HAL_DATA_TYPE *hal_data = GET_HAL_DATA(Adapter); - s8 regulation = -1, bw = -1, rs = -1; - u8 cch = 0; - u8 bw_bmp = 0; - s8 min_lmt = MAX_POWER_INDEX; - s8 tmp_lmt; - u8 final_bw = Bandwidth, final_cch = Channel; + struct txpwr_lmt_ent *ent = NULL; + _irqL irqL; + _list *cur, *head; + s8 ch_idx; + u8 is_ww_regd = 0; + s8 lmt = MAX_POWER_INDEX; if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory != 1) || Adapter->registrypriv.RegEnableTxPowerLimit == 0) goto exit; - switch (RegPwrTblSel) { - case 1: - regulation = TXPWR_LMT_ETSI; - break; - case 2: - regulation = TXPWR_LMT_MKK; - break; - case 3: - regulation = TXPWR_LMT_FCC; - break; - case 4: - regulation = TXPWR_LMT_WW; - break; - default: - regulation = (Band == BAND_ON_2_4G) ? hal_data->Regulation2_4G : hal_data->Regulation5G; - break; - } - if (Band != BAND_ON_2_4G && Band != BAND_ON_5G) { RTW_ERR("%s invalid band:%u\n", __func__, Band); rtw_warn_on(1); goto exit; } - if (IS_CCK_RATE(DataRate)) - rs = CCK; - else if (IS_OFDM_RATE(DataRate)) - rs = OFDM; - else if (IS_HT1SS_RATE(DataRate)) - rs = HT_1SS; - else if (IS_HT2SS_RATE(DataRate)) - rs = HT_2SS; - else if (IS_HT3SS_RATE(DataRate)) - rs = HT_3SS; - else if (IS_HT4SS_RATE(DataRate)) - rs = HT_4SS; - else if (IS_VHT1SS_RATE(DataRate)) - rs = VHT_1SS; - else if (IS_VHT2SS_RATE(DataRate)) - rs = VHT_2SS; - else if (IS_VHT3SS_RATE(DataRate)) - rs = VHT_3SS; - else if (IS_VHT4SS_RATE(DataRate)) - rs = VHT_4SS; + if (Band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) { + RTW_ERR("5G has no CCK\n"); + goto exit; + } + + if (lock) + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + if (!regd_name) /* no regd_name specified, use currnet */ + regd_name = rfctl->regd_name; + + if (rfctl->txpwr_regd_num == 0 + || strcmp(regd_name, regd_str(TXPWR_LMT_NONE)) == 0) + goto release_lock; + + if (strcmp(regd_name, regd_str(TXPWR_LMT_WW)) == 0) + is_ww_regd = 1; + + if (!is_ww_regd) { + ent = _rtw_txpwr_lmt_get_by_name(rfctl, regd_name); + if (!ent) + goto release_lock; + } + + ch_idx = phy_GetChannelIndexOfTxPowerLimit(Band, cch); + if (ch_idx == -1) + goto release_lock; + + if (Band == BAND_ON_2_4G) { + if (is_ww_regd) { + lmt = MAX_POWER_INDEX; + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + lmt = rtw_min(lmt, ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]); + } + } else + lmt = ent->lmt_2g[bw][tlrs][ch_idx][ntx_idx]; + } + #ifdef CONFIG_IEEE80211_BAND_5GHZ + else if (Band == BAND_ON_5G) { + if (is_ww_regd) { + lmt = MAX_POWER_INDEX; + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + lmt = rtw_min(lmt, ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]); + } + } else + lmt = ent->lmt_5g[bw][tlrs - 1][ch_idx][ntx_idx]; + } + #endif + +release_lock: + if (lock) + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + +exit: + return lmt; +} + +/* return txpwr limit diff value */ +inline s8 phy_get_txpwr_lmt(_adapter *adapter + , const char *regd_name + , BAND_TYPE band, enum channel_width bw + , u8 rfpath, u8 rs, u8 ntx_idx, u8 cch, u8 lock +) +{ + u8 tlrs; + s8 lmt = MAX_POWER_INDEX; + + if (IS_CCK_RATE_SECTION(rs)) + tlrs = TXPWR_LMT_RS_CCK; + else if (IS_OFDM_RATE_SECTION(rs)) + tlrs = TXPWR_LMT_RS_OFDM; + else if (IS_HT_RATE_SECTION(rs)) + tlrs = TXPWR_LMT_RS_HT; + else if (IS_VHT_RATE_SECTION(rs)) + tlrs = TXPWR_LMT_RS_VHT; else { - RTW_ERR("%s invalid rate 0x%x\n", __func__, DataRate); + RTW_ERR("%s invalid rs %u\n", __func__, rs); rtw_warn_on(1); goto exit; } - if (Band == BAND_ON_5G && rs == CCK) { - RTW_ERR("Wrong rate No CCK(0x%x) in 5G Band\n", DataRate); + lmt = phy_get_txpwr_lmt_abs(adapter, regd_name, band, bw, tlrs, ntx_idx, cch, lock); + + if (lmt != MAX_POWER_INDEX) { + /* return diff value */ + lmt = lmt - PHY_GetTxPowerByRateBase(adapter, band, rfpath, rs); + } + +exit: + return lmt; +} + +/* +* May search for secondary channels for min limit +* return txpwr limit diff value +*/ +s8 +PHY_GetTxPowerLimit(_adapter *adapter + , const char *regd_name + , BAND_TYPE band, enum channel_width bw + , u8 rfpath, u8 rate, u8 ntx_idx, u8 cch) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + BOOLEAN no_sc = _FALSE; + s8 tlrs = -1, rs = -1; + s8 lmt = MAX_POWER_INDEX; + u8 tmp_cch = 0; + u8 tmp_bw; + u8 bw_bmp = 0; + s8 min_lmt = MAX_POWER_INDEX; + u8 final_bw = bw, final_cch = cch; + _irqL irqL; + +#ifdef CONFIG_MP_INCLUDED + /* MP mode channel don't use secondary channel */ + if (rtw_mp_mode_check(adapter) == _TRUE) + no_sc = _TRUE; +#endif + if (IS_CCK_RATE(rate)) { + tlrs = TXPWR_LMT_RS_CCK; + rs = CCK; + } else if (IS_OFDM_RATE(rate)) { + tlrs = TXPWR_LMT_RS_OFDM; + rs = OFDM; + } else if (IS_HT_RATE(rate)) { + tlrs = TXPWR_LMT_RS_HT; + rs = HT_1SS + (IS_HT1SS_RATE(rate) ? 0 : IS_HT2SS_RATE(rate) ? 1 : IS_HT3SS_RATE(rate) ? 2 : IS_HT4SS_RATE(rate) ? 3 : 0); + } else if (IS_VHT_RATE(rate)) { + tlrs = TXPWR_LMT_RS_VHT; + rs = VHT_1SS + (IS_VHT1SS_RATE(rate) ? 0 : IS_VHT2SS_RATE(rate) ? 1 : IS_VHT3SS_RATE(rate) ? 2 : IS_VHT4SS_RATE(rate) ? 3 : 0); + } else { + RTW_ERR("%s invalid rate 0x%x\n", __func__, rate); + rtw_warn_on(1); goto exit; } if (no_sc == _TRUE) { /* use the input center channel and bandwidth directly */ - cch = Channel; - bw_bmp = ch_width_to_bw_cap(Bandwidth); + tmp_cch = cch; + bw_bmp = ch_width_to_bw_cap(bw); } else { /* * find the possible tx bandwidth bmp for this rate, and then will get center channel for each bandwidth * if no possible tx bandwidth bmp, select valid bandwidth up to current RF bandwidth into bmp */ - if (rs == CCK || rs == OFDM) + if (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM) bw_bmp = BW_CAP_20M; /* CCK, OFDM only BW 20M */ - else if (IS_HT_RATE_SECTION(rs)) { - bw_bmp = rtw_get_tx_bw_bmp_of_ht_rate(dvobj, DataRate, Bandwidth); + else if (tlrs == TXPWR_LMT_RS_HT) { + bw_bmp = rtw_get_tx_bw_bmp_of_ht_rate(dvobj, rate, bw); if (bw_bmp == 0) - bw_bmp = ch_width_to_bw_cap(Bandwidth > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 : Bandwidth); - } else if (IS_VHT_RATE_SECTION(rs)) { - bw_bmp = rtw_get_tx_bw_bmp_of_vht_rate(dvobj, DataRate, Bandwidth); + bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_40 ? CHANNEL_WIDTH_40 : bw); + } else if (tlrs == TXPWR_LMT_RS_VHT) { + bw_bmp = rtw_get_tx_bw_bmp_of_vht_rate(dvobj, rate, bw); if (bw_bmp == 0) - bw_bmp = ch_width_to_bw_cap(Bandwidth > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 : Bandwidth); + bw_bmp = ch_width_to_bw_cap(bw > CHANNEL_WIDTH_160 ? CHANNEL_WIDTH_160 : bw); } else rtw_warn_on(1); } @@ -2936,431 +2963,189 @@ static s8 _phy_get_txpwr_lmt( if (bw_bmp == 0) goto exit; - /* loop for each possible tx bandwidth to find minimum limit */ - for (bw = CHANNEL_WIDTH_20; bw <= Bandwidth; bw++) { - s8 ch_idx; + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); - if (!(ch_width_to_bw_cap(bw) & bw_bmp)) + /* loop for each possible tx bandwidth to find minimum limit */ + for (tmp_bw = CHANNEL_WIDTH_20; tmp_bw <= bw; tmp_bw++) { + if (!(ch_width_to_bw_cap(tmp_bw) & bw_bmp)) continue; if (no_sc == _FALSE) { - if (bw == CHANNEL_WIDTH_20) - cch = hal_data->cch_20; - else if (bw == CHANNEL_WIDTH_40) - cch = hal_data->cch_40; - else if (bw == CHANNEL_WIDTH_80) - cch = hal_data->cch_80; + if (tmp_bw == CHANNEL_WIDTH_20) + tmp_cch = hal_data->cch_20; + else if (tmp_bw == CHANNEL_WIDTH_40) + tmp_cch = hal_data->cch_40; + else if (tmp_bw == CHANNEL_WIDTH_80) + tmp_cch = hal_data->cch_80; else { - cch = 0; + tmp_cch = 0; rtw_warn_on(1); } } - ch_idx = phy_GetChannelIndexOfTxPowerLimit(Band, cch); - if (ch_idx == -1) - continue; + lmt = phy_get_txpwr_lmt_abs(adapter, regd_name, band, tmp_bw, tlrs, ntx_idx, tmp_cch, 0); - if (Band == BAND_ON_2_4G) { - s8 limits[MAX_REGULATION_NUM] = {0}; - u8 i = 0; - - for (i = 0; i < MAX_REGULATION_NUM; ++i) - limits[i] = hal_data->TxPwrLimit_2_4G[i][bw][rs][ch_idx][RfPath]; - - tmp_lmt = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : - hal_data->TxPwrLimit_2_4G[regulation][bw][rs][ch_idx][RfPath]; - - } else if (Band == BAND_ON_5G) { - s8 limits[MAX_REGULATION_NUM] = {0}; - u8 i = 0; - - for (i = 0; i < MAX_REGULATION_NUM; ++i) - limits[i] = hal_data->TxPwrLimit_5G[i][bw][rs][ch_idx][RfPath]; - - tmp_lmt = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : - hal_data->TxPwrLimit_5G[regulation][bw][rs][ch_idx][RfPath]; - } else - continue; - - if (min_lmt >= tmp_lmt) { - min_lmt = tmp_lmt; - final_cch = cch; - final_bw = bw; + if (min_lmt >= lmt) { + min_lmt = lmt; + final_cch = tmp_cch; + final_bw = tmp_bw; } + + } + + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + + if (min_lmt != MAX_POWER_INDEX) { + /* return diff value */ + min_lmt = min_lmt - PHY_GetTxPowerByRateBase(adapter, band, rfpath, rs); } exit: + + if (0) { + if (final_bw != bw && (IS_HT_RATE(rate) || IS_VHT_RATE(rate))) + RTW_INFO("%s min_lmt: %s ch%u -> %s ch%u\n" + , MGN_RATE_STR(rate) + , ch_width_str(bw), cch + , ch_width_str(final_bw), final_cch); + } + return min_lmt; } -inline s8 -PHY_GetTxPowerLimit( - IN PADAPTER Adapter, - IN u32 RegPwrTblSel, - IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel -) +static void phy_txpwr_lmt_cck_ofdm_mt_chk(_adapter *adapter) { - BOOLEAN no_sc = _FALSE; + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + struct txpwr_lmt_ent *ent; + _list *cur, *head; + u8 channel, tlrs, ntx_idx; - /* MP mode channel don't use secondary channel */ - if (rtw_mi_mp_mode_check(Adapter) == _TRUE) - no_sc = _TRUE; - - return _phy_get_txpwr_lmt(Adapter, RegPwrTblSel, Band, Bandwidth, RfPath, DataRate, Channel, no_sc); -} - -inline s8 -PHY_GetTxPowerLimit_no_sc( - IN PADAPTER Adapter, - IN u32 RegPwrTblSel, - IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel -) -{ - return _phy_get_txpwr_lmt(Adapter, RegPwrTblSel, Band, Bandwidth, RfPath, DataRate, Channel, _TRUE); -} - -#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -s8 -PHY_GetTxPowerLimitOriginal( - IN PADAPTER Adapter, - IN u32 RegPwrTblSel, - IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel -) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - s16 band = -1, regulation = -1, bandwidth = -1, - rateSection = -1, channel = -1; - s8 powerLimit = MAX_POWER_INDEX; - - if ((Adapter->registrypriv.RegEnableTxPowerLimit == 2 && pHalData->EEPROMRegulatory != 1) || - Adapter->registrypriv.RegEnableTxPowerLimit == 0) - return MAX_POWER_INDEX; - - switch (Adapter->registrypriv.RegPwrTblSel) { - case 1: - regulation = TXPWR_LMT_ETSI; - break; - - case 2: - regulation = TXPWR_LMT_MKK; - break; - - case 3: - regulation = TXPWR_LMT_FCC; - break; - - case 4: - regulation = TXPWR_LMT_WW; - break; - - default: - regulation = (Band == BAND_ON_2_4G) ? pHalData->Regulation2_4G - : pHalData->Regulation5G; - break; - } - - /*DBG_871X("pMgntInfo->RegPwrTblSel %d, final regulation %d\n", Adapter->registrypriv.RegPwrTblSel, regulation );*/ - - - if (Band == BAND_ON_2_4G) - band = 0; - else if (Band == BAND_ON_5G) - band = 1; - - if (Bandwidth == CHANNEL_WIDTH_20) - bandwidth = 0; - else if (Bandwidth == CHANNEL_WIDTH_40) - bandwidth = 1; - else if (Bandwidth == CHANNEL_WIDTH_80) - bandwidth = 2; - else if (Bandwidth == CHANNEL_WIDTH_160) - bandwidth = 3; - - switch (DataRate) { - case MGN_1M: - case MGN_2M: - case MGN_5_5M: - case MGN_11M: - rateSection = 0; - break; - - case MGN_6M: - case MGN_9M: - case MGN_12M: - case MGN_18M: - case MGN_24M: - case MGN_36M: - case MGN_48M: - case MGN_54M: - rateSection = 1; - break; - - case MGN_MCS0: - case MGN_MCS1: - case MGN_MCS2: - case MGN_MCS3: - case MGN_MCS4: - case MGN_MCS5: - case MGN_MCS6: - case MGN_MCS7: - rateSection = 2; - break; - - case MGN_MCS8: - case MGN_MCS9: - case MGN_MCS10: - case MGN_MCS11: - case MGN_MCS12: - case MGN_MCS13: - case MGN_MCS14: - case MGN_MCS15: - rateSection = 3; - break; - - case MGN_MCS16: - case MGN_MCS17: - case MGN_MCS18: - case MGN_MCS19: - case MGN_MCS20: - case MGN_MCS21: - case MGN_MCS22: - case MGN_MCS23: - rateSection = 4; - break; - - case MGN_MCS24: - case MGN_MCS25: - case MGN_MCS26: - case MGN_MCS27: - case MGN_MCS28: - case MGN_MCS29: - case MGN_MCS30: - case MGN_MCS31: - rateSection = 5; - break; - - case MGN_VHT1SS_MCS0: - case MGN_VHT1SS_MCS1: - case MGN_VHT1SS_MCS2: - case MGN_VHT1SS_MCS3: - case MGN_VHT1SS_MCS4: - case MGN_VHT1SS_MCS5: - case MGN_VHT1SS_MCS6: - case MGN_VHT1SS_MCS7: - case MGN_VHT1SS_MCS8: - case MGN_VHT1SS_MCS9: - rateSection = 6; - break; - - case MGN_VHT2SS_MCS0: - case MGN_VHT2SS_MCS1: - case MGN_VHT2SS_MCS2: - case MGN_VHT2SS_MCS3: - case MGN_VHT2SS_MCS4: - case MGN_VHT2SS_MCS5: - case MGN_VHT2SS_MCS6: - case MGN_VHT2SS_MCS7: - case MGN_VHT2SS_MCS8: - case MGN_VHT2SS_MCS9: - rateSection = 7; - break; - - case MGN_VHT3SS_MCS0: - case MGN_VHT3SS_MCS1: - case MGN_VHT3SS_MCS2: - case MGN_VHT3SS_MCS3: - case MGN_VHT3SS_MCS4: - case MGN_VHT3SS_MCS5: - case MGN_VHT3SS_MCS6: - case MGN_VHT3SS_MCS7: - case MGN_VHT3SS_MCS8: - case MGN_VHT3SS_MCS9: - rateSection = 8; - break; - - case MGN_VHT4SS_MCS0: - case MGN_VHT4SS_MCS1: - case MGN_VHT4SS_MCS2: - case MGN_VHT4SS_MCS3: - case MGN_VHT4SS_MCS4: - case MGN_VHT4SS_MCS5: - case MGN_VHT4SS_MCS6: - case MGN_VHT4SS_MCS7: - case MGN_VHT4SS_MCS8: - case MGN_VHT4SS_MCS9: - rateSection = 9; - break; - - default: - DBG_871X("Wrong rate 0x%x\n", DataRate); - break; - } - - if (Band == BAND_ON_5G && rateSection == 0) - DBG_871X("Wrong rate 0x%x: No CCK in 5G Band\n", DataRate); - - /*workaround for wrong index combination to obtain tx power limit,*/ - /*OFDM only exists in BW 20M*/ - if (rateSection == 1) - bandwidth = 0; - - /*workaround for wrong index combination to obtain tx power limit,*/ - /*CCK table will only be given in BW 20M*/ - if (rateSection == 0) - bandwidth = 0; - - /*workaround for wrong indxe combination to obtain tx power limit,*/ - /*HT on 80M will reference to HT on 40M*/ - if ((rateSection == 2 || rateSection == 3) && Band == BAND_ON_5G && bandwidth == 2) - bandwidth = 1; - - if (Band == BAND_ON_2_4G) - channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, Channel); - else if (Band == BAND_ON_5G) - channel = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, Channel); - else if (Band == BAND_ON_BOTH) - /*BAND_ON_BOTH don't care temporarily*/ - - if (band == -1 || regulation == -1 || bandwidth == -1 || - rateSection == -1 || channel == -1) { - /*DBG_871X("Wrong index value to access power limit table [band %d][regulation %d][bandwidth %d][rf_path %d][rate_section %d][chnlGroup %d]\n",*/ - /* band, regulation, bandwidth, RfPath, rateSection, channelGroup );*/ - - return MAX_POWER_INDEX; - } - - if (Band == BAND_ON_2_4G) { - s8 limits[10] = {0}; - u8 i = 0; - - if (bandwidth >= MAX_2_4G_BANDWIDTH_NUM) - bandwidth = MAX_2_4G_BANDWIDTH_NUM - 1; - - for (i = 0; i < MAX_REGULATION_NUM; ++i) - limits[i] = pHalData->TxPwrLimit_2_4G_Original[i][bandwidth][rateSection][channel][RfPath]; - - powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : - pHalData->TxPwrLimit_2_4G_Original[regulation][bandwidth][rateSection][channel][RfPath]; - - } else if (Band == BAND_ON_5G) { - s8 limits[10] = {0}; - u8 i = 0; - - for (i = 0; i < MAX_REGULATION_NUM; ++i) - limits[i] = pHalData->TxPwrLimit_5G_Original[i][bandwidth][rateSection][channel][RfPath]; - - powerLimit = (regulation == TXPWR_LMT_WW) ? phy_GetWorldWideLimit(limits) : - pHalData->TxPwrLimit_5G_Original[regulation][bandwidth][rateSection][channel][RfPath]; - } else - DBG_871X("No power limit table of the specified band\n"); - - /*combine 5G VHT & HT rate*/ - /*5G 20M and 40M HT and VHT can cross reference*/ - /* - if (Band == BAND_ON_5G && powerLimit == MAX_POWER_INDEX) { - if (bandwidth == 0 || bandwidth == 1) { - if (rateSection == 2) - powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] - [bandwidth][4][channelGroup][RfPath]; - else if (rateSection == 4) - powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] - [bandwidth][2][channelGroup][RfPath]; - else if (rateSection == 3) - powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] - [bandwidth][5][channelGroup][RfPath]; - else if (rateSection == 5) - powerLimit = pHalData->TxPwrLimit_5G_Original[regulation] - [bandwidth][3][channelGroup][RfPath]; - } - } - */ - /*DBG_871X("TxPwrLmt[Regulation %d][Band %d][BW %d][RFPath %d][Rate 0x%x][Chnl %d] = %d\n",*/ - /* regulation, pHalData->CurrentBandType, Bandwidth, RfPath, DataRate, Channel, powerLimit);*/ - return powerLimit; -} + rfctl->txpwr_lmt_2g_cck_ofdm_state = 0; +#ifdef CONFIG_IEEE80211_BAND_5GHZ + rfctl->txpwr_lmt_5g_cck_ofdm_state = 0; #endif + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); -VOID -phy_CrossReferenceHTAndVHTTxPowerLimit( - IN PADAPTER pAdapter -) + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); + + /* check 2G CCK, OFDM state*/ + for (tlrs = TXPWR_LMT_RS_CCK; tlrs <= TXPWR_LMT_RS_OFDM; tlrs++) { + for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { + for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { + if (ent->lmt_2g[CHANNEL_WIDTH_20][tlrs][channel][ntx_idx] != MAX_POWER_INDEX) { + if (tlrs == TXPWR_LMT_RS_CCK) + rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_CCK_1T << ntx_idx; + else + rfctl->txpwr_lmt_2g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx; + break; + } + } + } + } + + /* if 2G OFDM multi-TX is not defined, reference HT20 */ + for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { + for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { + if (rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)) + continue; + ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM][channel][ntx_idx] = + ent->lmt_2g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT][channel][ntx_idx]; + } + } + +#ifdef CONFIG_IEEE80211_BAND_5GHZ + /* check 5G OFDM state*/ + for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { + for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { + if (ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] != MAX_POWER_INDEX) { + rfctl->txpwr_lmt_5g_cck_ofdm_state |= TXPWR_LMT_HAS_OFDM_1T << ntx_idx; + break; + } + } + } + + for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { + for (ntx_idx = RF_2TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { + if (rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx)) + continue; + /* if 5G OFDM multi-TX is not defined, reference HT20 */ + ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_OFDM - 1][channel][ntx_idx] = + ent->lmt_5g[CHANNEL_WIDTH_20][TXPWR_LMT_RS_HT - 1][channel][ntx_idx]; + } + } +#endif /* CONFIG_IEEE80211_BAND_5GHZ */ + } +} + +#ifdef CONFIG_IEEE80211_BAND_5GHZ +static void phy_txpwr_lmt_cross_ref_ht_vht(_adapter *adapter) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u8 regulation, bw, channel, rs, ref_rs; + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + struct txpwr_lmt_ent *ent; + _list *cur, *head; + u8 bw, channel, tlrs, ref_tlrs, ntx_idx; int ht_ref_vht_5g_20_40 = 0; int vht_ref_ht_5g_20_40 = 0; int ht_has_ref_5g_20_40 = 0; int vht_has_ref_5g_20_40 = 0; - pHalData->tx_pwr_lmt_5g_20_40_ref = 0; + rfctl->txpwr_lmt_5g_20_40_ref = 0; - for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { - for (rs = 0; rs < MAX_RATE_SECTION_NUM; ++rs) { + for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; ++tlrs) { /* 5G 20M 40M VHT and HT can cross reference */ if (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40) { - if (rs == HT_1SS) - ref_rs = VHT_1SS; - else if (rs == HT_2SS) - ref_rs = VHT_2SS; - else if (rs == HT_3SS) - ref_rs = VHT_3SS; - else if (rs == HT_4SS) - ref_rs = VHT_4SS; - else if (rs == VHT_1SS) - ref_rs = HT_1SS; - else if (rs == VHT_2SS) - ref_rs = HT_2SS; - else if (rs == VHT_3SS) - ref_rs = HT_3SS; - else if (rs == VHT_4SS) - ref_rs = HT_4SS; + if (tlrs == TXPWR_LMT_RS_HT) + ref_tlrs = TXPWR_LMT_RS_VHT; + else if (tlrs == TXPWR_LMT_RS_VHT) + ref_tlrs = TXPWR_LMT_RS_HT; else continue; - if (pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A] == MAX_POWER_INDEX) - continue; + for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { - if (IS_HT_RATE_SECTION(rs)) - ht_has_ref_5g_20_40++; - else if (IS_VHT_RATE_SECTION(rs)) - vht_has_ref_5g_20_40++; - else - continue; + if (ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx] == MAX_POWER_INDEX) + continue; - if (pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] != MAX_POWER_INDEX) - continue; + if (tlrs == TXPWR_LMT_RS_HT) + ht_has_ref_5g_20_40++; + else if (tlrs == TXPWR_LMT_RS_VHT) + vht_has_ref_5g_20_40++; + else + continue; - if (IS_HT_RATE_SECTION(rs) && IS_VHT_RATE_SECTION(ref_rs)) - ht_ref_vht_5g_20_40++; - else if (IS_VHT_RATE_SECTION(rs) && IS_HT_RATE_SECTION(ref_rs)) - vht_ref_ht_5g_20_40++; + if (ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] != MAX_POWER_INDEX) + continue; - if (0) - RTW_INFO("reg:%u, bw:%u, ch:%u, %s ref %s\n" - , regulation, bw, channel - , rate_section_str(rs), rate_section_str(ref_rs)); + if (tlrs == TXPWR_LMT_RS_HT && ref_tlrs == TXPWR_LMT_RS_VHT) + ht_ref_vht_5g_20_40++; + else if (tlrs == TXPWR_LMT_RS_VHT && ref_tlrs == TXPWR_LMT_RS_HT) + vht_ref_ht_5g_20_40++; - pHalData->TxPwrLimit_5G[regulation][bw][rs][channel][RF_PATH_A] = - pHalData->TxPwrLimit_5G[regulation][bw][ref_rs][channel][RF_PATH_A]; + if (0) + RTW_INFO("reg:%s, bw:%u, ch:%u, %s-%uT ref %s-%uT\n" + , ent->regd_name, bw, channel + , txpwr_lmt_rs_str(tlrs), ntx_idx + 1 + , txpwr_lmt_rs_str(ref_tlrs), ntx_idx + 1); + + ent->lmt_5g[bw][tlrs - 1][channel][ntx_idx] = + ent->lmt_5g[bw][ref_tlrs - 1][channel][ntx_idx]; + } } } @@ -3375,131 +3160,273 @@ phy_CrossReferenceHTAndVHTTxPowerLimit( /* 5G 20M&40M HT all come from VHT*/ if (ht_ref_vht_5g_20_40 && ht_has_ref_5g_20_40 == ht_ref_vht_5g_20_40) - pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_HT_FROM_VHT; + rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_LMT_REF_HT_FROM_VHT; /* 5G 20M&40M VHT all come from HT*/ if (vht_ref_ht_5g_20_40 && vht_has_ref_5g_20_40 == vht_ref_ht_5g_20_40) - pHalData->tx_pwr_lmt_5g_20_40_ref |= TX_PWR_LMT_REF_VHT_FROM_HT; + rfctl->txpwr_lmt_5g_20_40_ref |= TXPWR_LMT_REF_VHT_FROM_HT; } +#endif /* CONFIG_IEEE80211_BAND_5GHZ */ -VOID -PHY_ConvertTxPowerLimitToPowerIndex( - IN PADAPTER Adapter -) +#ifndef DBG_TXPWR_LMT_BAND_CHK +#define DBG_TXPWR_LMT_BAND_CHK 0 +#endif + +#if DBG_TXPWR_LMT_BAND_CHK +/* check if larger bandwidth limit is less than smaller bandwidth for HT & VHT rate */ +void phy_txpwr_limit_bandwidth_chk(_adapter *adapter) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u8 base; - u8 regulation, bw, channel, rateSection; - s8 tempValue = 0, tempPwrLmt = 0; - u8 rfPath = 0; + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); + u8 band, bw, path, tlrs, ntx_idx, cch, offset, scch; + u8 ch_num, n, i; - if (pHalData->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) { - rtw_warn_on(1); - return; - } + for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { + if (!hal_is_band_support(adapter, band)) + continue; - phy_CrossReferenceHTAndVHTTxPowerLimit(Adapter); + for (bw = CHANNEL_WIDTH_40; bw <= CHANNEL_WIDTH_80; bw++) { + if (bw >= CHANNEL_WIDTH_160) + continue; + if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) + continue; - for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { + if (band == BAND_ON_2_4G) + ch_num = center_chs_2g_num(bw); + else + ch_num = center_chs_5g_num(bw); - for (bw = 0; bw < MAX_2_4G_BANDWIDTH_NUM; ++bw) { + if (ch_num == 0) { + rtw_warn_on(1); + break; + } - for (channel = 0; channel < CENTER_CH_2G_NUM; ++channel) { + for (tlrs = TXPWR_LMT_RS_HT; tlrs < TXPWR_LMT_RS_NUM; tlrs++) { - for (rateSection = CCK; rateSection <= HT_4SS; ++rateSection) { - tempPwrLmt = pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][RF_PATH_A]; + if (band == BAND_ON_2_4G && tlrs == TXPWR_LMT_RS_VHT) + continue; + if (band == BAND_ON_5G && tlrs == TXPWR_LMT_RS_CCK) + continue; + if (bw > CHANNEL_WIDTH_20 && (tlrs == TXPWR_LMT_RS_CCK || tlrs == TXPWR_LMT_RS_OFDM)) + continue; + if (bw > CHANNEL_WIDTH_40 && tlrs == TXPWR_LMT_RS_HT) + continue; + if (tlrs == TXPWR_LMT_RS_VHT && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + continue; - if (tempPwrLmt != MAX_POWER_INDEX) { + for (ntx_idx = RF_1TX; ntx_idx < MAX_TX_COUNT; ntx_idx++) { + struct txpwr_lmt_ent *ent; + _list *cur, *head; - for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { - base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_2_4G, rfPath, rate_section_to_tx_num(rateSection), rateSection); - tempValue = tempPwrLmt - base; - pHalData->TxPwrLimit_2_4G[regulation][bw][rateSection][channel][rfPath] = tempValue; + if (ntx_idx >= hal_spec->tx_nss_num) + continue; + + /* bypass CCK multi-TX is not defined */ + if (tlrs == TXPWR_LMT_RS_CCK && ntx_idx > RF_1TX) { + if (band == BAND_ON_2_4G + && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_CCK_1T << ntx_idx))) + continue; + } + + /* bypass OFDM multi-TX is not defined */ + if (tlrs == TXPWR_LMT_RS_OFDM && ntx_idx > RF_1TX) { + if (band == BAND_ON_2_4G + && !(rfctl->txpwr_lmt_2g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) + continue; + #ifdef CONFIG_IEEE80211_BAND_5GHZ + if (band == BAND_ON_5G + && !(rfctl->txpwr_lmt_5g_cck_ofdm_state & (TXPWR_LMT_HAS_OFDM_1T << ntx_idx))) + continue; + #endif + } + + /* bypass 5G 20M, 40M pure reference */ + #ifdef CONFIG_IEEE80211_BAND_5GHZ + if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { + if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_HT_FROM_VHT) { + if (tlrs == TXPWR_LMT_RS_HT) + continue; + } else if (rfctl->txpwr_lmt_5g_20_40_ref == TXPWR_LMT_REF_VHT_FROM_HT) { + if (tlrs == TXPWR_LMT_RS_VHT && bw <= CHANNEL_WIDTH_40) + continue; } } - } - } - } - } + #endif - if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { + for (n = 0; n < ch_num; n++) { + u8 cch_by_bw[3]; + u8 offset_by_bw; /* bitmap, 0 for lower, 1 for upper */ + u8 bw_pos; + s8 lmt[3]; - for (regulation = 0; regulation < MAX_REGULATION_NUM; ++regulation) { + if (band == BAND_ON_2_4G) + cch = center_chs_2g(bw, n); + else + cch = center_chs_5g(bw, n); - for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; ++bw) { + if (cch == 0) { + rtw_warn_on(1); + break; + } - for (channel = 0; channel < CENTER_CH_5G_ALL_NUM; ++channel) { + _rtw_memset(cch_by_bw, 0, 3); + cch_by_bw[bw] = cch; + offset_by_bw = 0x01; - for (rateSection = OFDM; rateSection <= VHT_4SS; ++rateSection) { - tempPwrLmt = pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][RF_PATH_A]; + do { + for (bw_pos = bw; bw_pos >= CHANNEL_WIDTH_40; bw_pos--) + cch_by_bw[bw_pos - 1] = rtw_get_scch_by_cch_offset(cch_by_bw[bw_pos], bw_pos, offset_by_bw & BIT(bw_pos) ? HAL_PRIME_CHNL_OFFSET_UPPER : HAL_PRIME_CHNL_OFFSET_LOWER); - if (tempPwrLmt != MAX_POWER_INDEX) { + head = &rfctl->txpwr_lmt_list; + cur = get_next(head); + while ((rtw_end_of_queue_search(head, cur)) == _FALSE) { + ent = LIST_CONTAINOR(cur, struct txpwr_lmt_ent, list); + cur = get_next(cur); - for (rfPath = RF_PATH_A; rfPath < MAX_RF_PATH; ++rfPath) { - base = PHY_GetTxPowerByRateBase(Adapter, BAND_ON_5G, rfPath, rate_section_to_tx_num(rateSection), rateSection); - tempValue = tempPwrLmt - base; - pHalData->TxPwrLimit_5G[regulation][bw][rateSection][channel][rfPath] = tempValue; + for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) + lmt[bw_pos] = phy_get_txpwr_lmt_abs(adapter, ent->regd_name, band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0); + + for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--) + if (lmt[bw_pos] > lmt[bw_pos - 1]) + break; + if (bw_pos == CHANNEL_WIDTH_20) + continue; + + RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:" + , band_str(band) + , ch_width_str(bw) + , txpwr_lmt_rs_str(tlrs) + , ntx_idx + 1 + , ent->regd_name + ); + for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) + _RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]); + _RTW_PRINT_SEL(RTW_DBGDUMP, "limit:"); + for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) { + if (lmt[bw_pos] == MAX_POWER_INDEX) + _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); + else + _RTW_PRINT_SEL(RTW_DBGDUMP, "%2u%s ", lmt[bw_pos] / 2, lmt[bw_pos] % 2 ? ".5" : ""); + } + _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); } - } - } - } - } - } - } + for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) + lmt[bw_pos] = phy_get_txpwr_lmt_abs(adapter, regd_str(TXPWR_LMT_WW), band, bw_pos, tlrs, ntx_idx, cch_by_bw[bw_pos], 0); + + for (bw_pos = bw; bw_pos > CHANNEL_WIDTH_20; bw_pos--) + if (lmt[bw_pos] > lmt[bw_pos - 1]) + break; + if (bw_pos != CHANNEL_WIDTH_20) { + RTW_PRINT_SEL(RTW_DBGDUMP, "[%s][%s][%s][%uT][%-4s] cch:" + , band_str(band) + , ch_width_str(bw) + , txpwr_lmt_rs_str(tlrs) + , ntx_idx + 1 + , regd_str(TXPWR_LMT_WW) + ); + for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) + _RTW_PRINT_SEL(RTW_DBGDUMP, "%03u ", cch_by_bw[bw_pos]); + _RTW_PRINT_SEL(RTW_DBGDUMP, "limit:"); + for (bw_pos = bw; bw_pos < CHANNEL_WIDTH_160; bw_pos--) { + if (lmt[bw_pos] == MAX_POWER_INDEX) + _RTW_PRINT_SEL(RTW_DBGDUMP, "N/A "); + else + _RTW_PRINT_SEL(RTW_DBGDUMP, "%2u%s ", lmt[bw_pos] / 2, lmt[bw_pos] % 2 ? ".5" : ""); + } + _RTW_PRINT_SEL(RTW_DBGDUMP, "\n"); + } + + offset_by_bw += 2; + if (offset_by_bw & BIT(bw + 1)) + break; + } while (1); /* loop for all ch combinations */ + } /* loop for center channels */ + } /* loop fo each ntx_idx */ + } /* loop for tlrs */ + } /* loop for bandwidth */ + } /* loop for band */ +} +#endif /* DBG_TXPWR_LMT_BAND_CHK */ + +static void phy_txpwr_lmt_post_hdl(_adapter *adapter) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + _irqL irqL; + + _enter_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); + +#ifdef CONFIG_IEEE80211_BAND_5GHZ + if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + phy_txpwr_lmt_cross_ref_ht_vht(adapter); +#endif + phy_txpwr_lmt_cck_ofdm_mt_chk(adapter); + +#if DBG_TXPWR_LMT_BAND_CHK + phy_txpwr_limit_bandwidth_chk(adapter); +#endif + + _exit_critical_mutex(&rfctl->txpwr_lmt_mutex, &irqL); } -/* -* PHY_InitTxPowerLimit - Set all hal_data.TxPwrLimit_2_4G, TxPwrLimit_5G array to MAX_POWER_INDEX -*/ -VOID -PHY_InitTxPowerLimit( - IN PADAPTER Adapter +BOOLEAN +GetS1ByteIntegerFromStringInDecimal( + IN char *str, + IN OUT s8 *val ) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u8 i, j, k, l, m; + u8 negative = 0; + u16 i = 0; - for (i = 0; i < MAX_REGULATION_NUM; ++i) - for (j = 0; j < MAX_2_4G_BANDWIDTH_NUM; ++j) - for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) - for (m = 0; m < CENTER_CH_2G_NUM; ++m) - for (l = 0; l < MAX_RF_PATH; ++l) - pHalData->TxPwrLimit_2_4G[i][j][k][m][l] = MAX_POWER_INDEX; + *val = 0; - for (i = 0; i < MAX_REGULATION_NUM; ++i) - for (j = 0; j < MAX_5G_BANDWIDTH_NUM; ++j) - for (k = 0; k < MAX_RATE_SECTION_NUM; ++k) - for (m = 0; m < CENTER_CH_5G_ALL_NUM; ++m) - for (l = 0; l < MAX_RF_PATH; ++l) - pHalData->TxPwrLimit_5G[i][j][k][m][l] = MAX_POWER_INDEX; + while (str[i] != '\0') { + if (i == 0 && (str[i] == '+' || str[i] == '-')) { + if (str[i] == '-') + negative = 1; + } else if (str[i] >= '0' && str[i] <= '9') { + *val *= 10; + *val += (str[i] - '0'); + } else + return _FALSE; + ++i; + } + + if (negative) + *val = -*val; + + return _TRUE; } +#endif /* CONFIG_TXPWR_LIMIT */ /* -* PHY_SetTxPowerLimit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm +* phy_set_tx_power_limit - Parsing TX power limit from phydm array, called by odm_ConfigBB_TXPWR_LMT_XXX in phydm */ VOID -PHY_SetTxPowerLimit( - IN PDM_ODM_T pDM_Odm, +phy_set_tx_power_limit( + IN struct PHY_DM_STRUCT *pDM_Odm, IN u8 *Regulation, IN u8 *Band, IN u8 *Bandwidth, IN u8 *RateSection, - IN u8 *RfPath, + IN u8 *ntx, IN u8 *Channel, IN u8 *PowerLimit ) { - PADAPTER Adapter = pDM_Odm->Adapter; +#ifdef CONFIG_TXPWR_LIMIT + PADAPTER Adapter = pDM_Odm->adapter; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u8 regulation = 0, bandwidth = 0, rateSection = 0, channel; + u8 band = 0, bandwidth = 0, tlrs = 0, channel; + u8 ntx_idx; s8 powerLimit = 0, prevPowerLimit, channelIndex; if (0) - RTW_INFO("Index of power limit table [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s][val %s]\n" - , Band, Regulation, Bandwidth, RateSection, RfPath, Channel, PowerLimit); + RTW_INFO("Index of power limit table [regulation %s][band %s][bw %s][rate section %s][ntx %s][chnl %s][val %s]\n" + , Regulation, Band, Bandwidth, RateSection, ntx, Channel, PowerLimit); - if (GetU1ByteIntegerFromStringInDecimal((s8 *)Channel, &channel) == _FALSE - || GetU1ByteIntegerFromStringInDecimal((s8 *)PowerLimit, &powerLimit) == _FALSE + if (GetU1ByteIntegerFromStringInDecimal((char *)Channel, &channel) == _FALSE + || GetS1ByteIntegerFromStringInDecimal((char *)PowerLimit, &powerLimit) == _FALSE ) { RTW_PRINT("Illegal index of power limit table [ch %s][val %s]\n", Channel, PowerLimit); return; @@ -3507,41 +3434,29 @@ PHY_SetTxPowerLimit( powerLimit = powerLimit > MAX_POWER_INDEX ? MAX_POWER_INDEX : powerLimit; - if (eqNByte(Regulation, (u8 *)("FCC"), 3)) - regulation = TXPWR_LMT_FCC; - else if (eqNByte(Regulation, (u8 *)("MKK"), 3)) - regulation = TXPWR_LMT_MKK; - else if (eqNByte(Regulation, (u8 *)("ETSI"), 4)) - regulation = TXPWR_LMT_ETSI; - else if (eqNByte(Regulation, (u8 *)("WW13"), 4)) - regulation = TXPWR_LMT_WW; + if (eqNByte(RateSection, (u8 *)("CCK"), 3)) + tlrs = TXPWR_LMT_RS_CCK; + else if (eqNByte(RateSection, (u8 *)("OFDM"), 4)) + tlrs = TXPWR_LMT_RS_OFDM; + else if (eqNByte(RateSection, (u8 *)("HT"), 2)) + tlrs = TXPWR_LMT_RS_HT; + else if (eqNByte(RateSection, (u8 *)("VHT"), 3)) + tlrs = TXPWR_LMT_RS_VHT; else { - RTW_PRINT("unknown regulation:%s", Regulation); + RTW_PRINT("Wrong rate section:%s\n", RateSection); return; } - if (eqNByte(RateSection, (u8 *)("CCK"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) - rateSection = CCK; - else if (eqNByte(RateSection, (u8 *)("OFDM"), 4) && eqNByte(RfPath, (u8 *)("1T"), 2)) - rateSection = OFDM; - else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("1T"), 2)) - rateSection = HT_1SS; - else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("2T"), 2)) - rateSection = HT_2SS; - else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("3T"), 2)) - rateSection = HT_3SS; - else if (eqNByte(RateSection, (u8 *)("HT"), 2) && eqNByte(RfPath, (u8 *)("4T"), 2)) - rateSection = HT_4SS; - else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("1T"), 2)) - rateSection = VHT_1SS; - else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("2T"), 2)) - rateSection = VHT_2SS; - else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("3T"), 2)) - rateSection = VHT_3SS; - else if (eqNByte(RateSection, (u8 *)("VHT"), 3) && eqNByte(RfPath, (u8 *)("4T"), 2)) - rateSection = VHT_4SS; + if (eqNByte(ntx, (u8 *)("1T"), 2)) + ntx_idx = RF_1TX; + else if (eqNByte(ntx, (u8 *)("2T"), 2)) + ntx_idx = RF_2TX; + else if (eqNByte(ntx, (u8 *)("3T"), 2)) + ntx_idx = RF_3TX; + else if (eqNByte(ntx, (u8 *)("4T"), 2)) + ntx_idx = RF_4TX; else { - RTW_PRINT("Wrong rate section: (%s,%s)\n", RateSection, RfPath); + RTW_PRINT("Wrong tx num:%s\n", ntx); return; } @@ -3551,12 +3466,15 @@ PHY_SetTxPowerLimit( bandwidth = CHANNEL_WIDTH_40; else if (eqNByte(Bandwidth, (u8 *)("80M"), 3)) bandwidth = CHANNEL_WIDTH_80; + else if (eqNByte(Bandwidth, (u8 *)("160M"), 4)) + bandwidth = CHANNEL_WIDTH_160; else { RTW_PRINT("unknown bandwidth: %s\n", Bandwidth); return; } if (eqNByte(Band, (u8 *)("2.4G"), 4)) { + band = BAND_ON_2_4G; channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_2_4G, channel); if (channelIndex == -1) { @@ -3569,20 +3487,11 @@ PHY_SetTxPowerLimit( return; } - prevPowerLimit = pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]; - - if (prevPowerLimit != MAX_POWER_INDEX) - RTW_PRINT("duplicate tx power limit combination [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s]\n" - , Band, Regulation, Bandwidth, RateSection, RfPath, Channel); - - if (powerLimit < prevPowerLimit) - pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A] = powerLimit; - - if (0) - RTW_INFO("2.4G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n" - , regulation, bandwidth, rateSection, channelIndex, pHalData->TxPwrLimit_2_4G[regulation][bandwidth][rateSection][channelIndex][ODM_RF_PATH_A]); - } else if (eqNByte(Band, (u8 *)("5G"), 2)) { - + rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), Regulation, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); + } +#ifdef CONFIG_IEEE80211_BAND_5GHZ + else if (eqNByte(Band, (u8 *)("5G"), 2)) { + band = BAND_ON_5G; channelIndex = phy_GetChannelIndexOfTxPowerLimit(BAND_ON_5G, channel); if (channelIndex == -1) { @@ -3590,30 +3499,22 @@ PHY_SetTxPowerLimit( return; } - prevPowerLimit = pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]; - - if (prevPowerLimit != MAX_POWER_INDEX) - RTW_PRINT("duplicate tx power limit combination [band %s][regulation %s][bw %s][rate section %s][rf path %s][chnl %s]\n" - , Band, Regulation, Bandwidth, RateSection, RfPath, Channel); - - if (powerLimit < prevPowerLimit) - pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A] = powerLimit; - - if (0) - RTW_INFO("5G Band value : [regulation %d][bw %d][rate_section %d][chnl %d][val %d]\n" - , regulation, bandwidth, rateSection, channel, pHalData->TxPwrLimit_5G[regulation][bandwidth][rateSection][channelIndex][RF_PATH_A]); - } else { - RTW_PRINT("Cannot recognize the band info in %s\n", Band); + rtw_txpwr_lmt_add(adapter_to_rfctl(Adapter), Regulation, band, bandwidth, tlrs, ntx_idx, channelIndex, powerLimit); + } +#endif + else { + RTW_PRINT("unknown/unsupported band:%s\n", Band); return; } +#endif } u8 -PHY_GetTxPowerIndex( +phy_get_tx_power_index( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, + IN enum channel_width BandWidth, IN u8 Channel ) { @@ -3624,7 +3525,7 @@ VOID PHY_SetTxPowerIndex( IN PADAPTER pAdapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ) { @@ -3669,7 +3570,7 @@ PHY_SetTxPowerIndex( void dump_tx_power_idx_title(void *sel, _adapter *adapter) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - u8 bw = hal_data->CurrentChannelBW; + u8 bw = hal_data->current_channel_bw; RTW_PRINT_SEL(sel, "%s", ch_width_str(bw)); if (bw >= CHANNEL_WIDTH_80) @@ -3678,8 +3579,8 @@ void dump_tx_power_idx_title(void *sel, _adapter *adapter) _RTW_PRINT_SEL(sel, ", cch40:%u", hal_data->cch_40); _RTW_PRINT_SEL(sel, ", cch20:%u\n", hal_data->cch_20); - RTW_PRINT_SEL(sel, "%-4s %-9s %-3s %-4s %-3s %-4s %-4s %-3s %-5s\n" - , "path", "rate", "pwr", "base", "", "(byr", "lmt)", "tpt", "ebias"); + RTW_PRINT_SEL(sel, "%-4s %-9s %2s %-3s %-4s %-3s %-4s %-4s %-3s %-5s\n" + , "path", "rate", "", "pwr", "base", "", "(byr", "lmt)", "tpt", "ebias"); } void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs) @@ -3689,9 +3590,9 @@ void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs u8 power_idx; struct txpwr_idx_comp tic; u8 tx_num, i; - u8 band = hal_data->CurrentBandType; - u8 cch = hal_data->CurrentChannel; - u8 bw = hal_data->CurrentChannelBW; + u8 band = hal_data->current_band_type; + u8 cch = hal_data->current_channel; + u8 bw = hal_data->current_channel_bw; if (!HAL_SPEC_CHK_RF_PATH(hal_spec, band, rfpath)) return; @@ -3700,7 +3601,7 @@ void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs return; tx_num = rate_section_to_tx_num(rs); - if (tx_num >= hal_spec->nss_num || tx_num >= hal_spec->max_tx_cnt) + if (tx_num >= hal_spec->tx_nss_num || tx_num >= hal_spec->max_tx_cnt) return; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) @@ -3712,8 +3613,8 @@ void dump_tx_power_idx_by_path_rs(void *sel, _adapter *adapter, u8 rfpath, u8 rs for (i = 0; i < rates_by_sections[rs].rate_num; i++) { power_idx = rtw_hal_get_tx_power_index(adapter, rfpath, rates_by_sections[rs].rates[i], bw, cch, &tic); - RTW_PRINT_SEL(sel, "%4c %9s %3u %4u %3d (%3d %3d) %3d %5d\n" - , rf_path_char(rfpath), MGN_RATE_STR(rates_by_sections[rs].rates[i]) + RTW_PRINT_SEL(sel, "%4c %9s %uT %3u %4u %3d (%3d %3d) %3d %5d\n" + , rf_path_char(rfpath), MGN_RATE_STR(rates_by_sections[rs].rates[i]), tic.ntx_idx + 1 , power_idx, tic.base, (tic.by_rate > tic.limit ? tic.limit : tic.by_rate), tic.by_rate, tic.limit, tic.tpt, tic.ebias); } } @@ -3733,9 +3634,12 @@ bool phy_is_tx_power_limit_needed(_adapter *adapter) HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); +#ifdef CONFIG_TXPWR_LIMIT if (regsty->RegEnableTxPowerLimit == 1 || (regsty->RegEnableTxPowerLimit == 2 && hal_data->EEPROMRegulatory == 1)) return _TRUE; +#endif + return _FALSE; } @@ -3772,7 +3676,7 @@ int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file) #endif #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_SUCCESS == ODM_ConfigBBWithHeaderFile(&hal_data->odmpriv, CONFIG_BB_PHY_REG_PG)) { + if (HAL_STATUS_SUCCESS == odm_config_bb_with_header_file(&hal_data->odmpriv, CONFIG_BB_PHY_REG_PG)) { RTW_INFO("default power by rate loaded\n"); hal_data->txpwr_by_rate_from_file = 0; goto post_hdl; @@ -3783,7 +3687,7 @@ int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file) goto exit; post_hdl: - if (hal_data->odmpriv.PhyRegPgValueType != PHY_REG_PG_EXACT_VALUE) { + if (hal_data->odmpriv.phy_reg_pg_value_type != PHY_REG_PG_EXACT_VALUE) { rtw_warn_on(1); goto exit; } @@ -3797,14 +3701,17 @@ int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file) return ret; } +#ifdef CONFIG_TXPWR_LIMIT int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file) { HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); int ret = _FAIL; hal_data->txpwr_limit_loaded = 0; - PHY_InitTxPowerLimit(adapter); + rtw_regd_exc_list_free(rfctl); + rtw_txpwr_lmt_list_free(rfctl); if (!hal_data->txpwr_by_rate_loaded && regsty->target_tx_pwr_valid != _TRUE) { RTW_ERR("%s():Read Tx power limit before target tx power is specify\n", __func__); @@ -3821,7 +3728,7 @@ int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file) #endif #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_SUCCESS == ODM_ConfigRFWithHeaderFile(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, (ODM_RF_RADIO_PATH_E)0)) { + if (odm_config_rf_with_header_file(&hal_data->odmpriv, CONFIG_RF_TXPWR_LMT, RF_PATH_A) == HAL_STATUS_SUCCESS) { RTW_INFO("default power limit loaded\n"); hal_data->txpwr_limit_from_file = 0; goto post_hdl; @@ -3832,13 +3739,15 @@ int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file) goto exit; post_hdl: - PHY_ConvertTxPowerLimitToPowerIndex(adapter); + phy_txpwr_lmt_post_hdl(adapter); + rtw_txpwr_init_regd(rfctl); hal_data->txpwr_limit_loaded = 1; ret = _SUCCESS; exit: return ret; } +#endif /* CONFIG_TXPWR_LIMIT */ void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file) { @@ -3853,8 +3762,10 @@ void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file) ) phy_load_tx_power_by_rate(adapter, chk_file); +#ifdef CONFIG_TXPWR_LIMIT if (phy_is_tx_power_limit_needed(adapter)) phy_load_tx_power_limit(adapter, chk_file); +#endif } inline void phy_reload_tx_power_ext_info(_adapter *adapter) @@ -3913,7 +3824,7 @@ void dump_target_tx_power(void *sel, _adapter *adapter) for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); - if (tx_num >= hal_spec->nss_num) + if (tx_num >= hal_spec->tx_nss_num) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) @@ -3922,7 +3833,7 @@ void dump_target_tx_power(void *sel, _adapter *adapter) if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) continue; - target = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs); + target = PHY_GetTxPowerByRateBase(adapter, band, path, rs); if (target % 2) _RTW_PRINT_SEL(sel, "%7s: %2d.5\n", rate_section_str(rs), target / 2); @@ -3957,7 +3868,7 @@ void dump_tx_power_by_rate(void *sel, _adapter *adapter) for (rs = 0; rs < RATE_SECTION_NUM; rs++) { tx_num = rate_section_to_tx_num(rs); - if (tx_num >= hal_spec->nss_num) + if (tx_num >= hal_spec->tx_nss_num) continue; if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) @@ -3971,13 +3882,13 @@ void dump_tx_power_by_rate(void *sel, _adapter *adapter) else max_rate_num = 8; rate_num = rate_section_rate_num(rs); - base = PHY_GetTxPowerByRateBase(adapter, band, path, tx_num, rs); + base = PHY_GetTxPowerByRateBase(adapter, band, path, rs); RTW_PRINT_SEL(sel, "%7s: ", rate_section_str(rs)); /* dump power by rate in db */ for (n = rate_num - 1; n >= 0; n--) { - by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); + by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, rates_by_sections[rs].rates[n]); if ((base + by_rate_offset) % 2) _RTW_PRINT_SEL(sel, "%2d.5 ", (base + by_rate_offset) / 2); @@ -3991,7 +3902,7 @@ void dump_tx_power_by_rate(void *sel, _adapter *adapter) /* dump power by rate in offset */ for (n = rate_num - 1; n >= 0; n--) { - by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, tx_num, rates_by_sections[rs].rates[n]); + by_rate_offset = PHY_GetTxPowerByRate(adapter, band, path, rates_by_sections[rs].rates[n]); _RTW_PRINT_SEL(sel, "%3d ", by_rate_offset); } RTW_PRINT_SEL(sel, "\n"); @@ -4001,181 +3912,6 @@ void dump_tx_power_by_rate(void *sel, _adapter *adapter) } } -void dump_tx_power_limit(void *sel, _adapter *adapter) -{ - struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - struct registry_priv *regsty = dvobj_to_regsty(adapter_to_dvobj(adapter)); - - int bw, band, ch_num, rs, i, path; - u8 ch, n, rd, rfpath_num; - - if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) - RTW_PRINT_SEL(sel, "tx_pwr_lmt_5g_20_40_ref:0x%02x\n", hal_data->tx_pwr_lmt_5g_20_40_ref); - - for (band = BAND_ON_2_4G; band <= BAND_ON_5G; band++) { - if (!hal_is_band_support(adapter, band)) - continue; - - rd = (band == BAND_ON_2_4G ? hal_data->Regulation2_4G : hal_data->Regulation5G); - rfpath_num = (band == BAND_ON_2_4G ? hal_spec->rfpath_num_2g : hal_spec->rfpath_num_5g); - - for (bw = 0; bw < MAX_5G_BANDWIDTH_NUM; bw++) { - - if (bw >= CHANNEL_WIDTH_160) - break; - if (band == BAND_ON_2_4G && bw >= CHANNEL_WIDTH_80) - break; - - if (band == BAND_ON_2_4G) - ch_num = CENTER_CH_2G_NUM; - else - ch_num = center_chs_5g_num(bw); - - if (ch_num == 0) { - rtw_warn_on(1); - break; - } - - for (rs = 0; rs < RATE_SECTION_NUM; rs++) { - if (band == BAND_ON_2_4G && IS_VHT_RATE_SECTION(rs)) - continue; - if (band == BAND_ON_5G && IS_CCK_RATE_SECTION(rs)) - continue; - if (bw > CHANNEL_WIDTH_20 && (IS_CCK_RATE_SECTION(rs) || IS_OFDM_RATE_SECTION(rs))) - continue; - if (bw > CHANNEL_WIDTH_40 && IS_HT_RATE_SECTION(rs)) - continue; - - if (rate_section_to_tx_num(rs) >= hal_spec->nss_num) - continue; - - if (IS_VHT_RATE_SECTION(rs) && !IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) - continue; - - /* by pass 5G 20M, 40M pure reference */ - if (band == BAND_ON_5G && (bw == CHANNEL_WIDTH_20 || bw == CHANNEL_WIDTH_40)) { - if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_HT_FROM_VHT) { - if (IS_HT_RATE_SECTION(rs)) - continue; - } else if (hal_data->tx_pwr_lmt_5g_20_40_ref == TX_PWR_LMT_REF_VHT_FROM_HT) { - if (IS_VHT_RATE_SECTION(rs) && bw <= CHANNEL_WIDTH_40) - continue; - } - } - - RTW_PRINT_SEL(sel, "[%s][%s][%s]\n" - , band_str(band) - , ch_width_str(bw) - , rate_section_str(rs) - ); - - /* header for limit in db */ - RTW_PRINT_SEL(sel, "%3s %5s %5s %5s %5s " - , "ch" - , (rd == TXPWR_LMT_FCC ? "*FCC" : "FCC") - , (rd == TXPWR_LMT_ETSI ? "*ETSI" : "ETSI") - , (rd == TXPWR_LMT_MKK ? "*MKK" : "MKK") - , (rd == TXPWR_LMT_WW ? "*WW" : "WW") - ); - - /* header for limit offset */ - for (path = 0; path < RF_PATH_MAX; path++) { - if (path >= rfpath_num) - break; - _RTW_PRINT_SEL(sel, "|%3c %3c %3c %3c " - , (rd == TXPWR_LMT_FCC ? rf_path_char(path) : ' ') - , (rd == TXPWR_LMT_ETSI ? rf_path_char(path) : ' ') - , (rd == TXPWR_LMT_MKK ? rf_path_char(path) : ' ') - , (rd == TXPWR_LMT_WW ? rf_path_char(path) : ' ') - ); - } - _RTW_PRINT_SEL(sel, "\n"); - - for (n = 0; n < ch_num; n++) { - s8 limit_idx[RF_PATH_MAX][MAX_REGULATION_NUM]; - s8 limit_offset[MAX_REGULATION_NUM]; - u8 base; - - if (band == BAND_ON_2_4G) - ch = n + 1; - else - ch = center_chs_5g(bw, n); - - if (ch == 0) { - rtw_warn_on(1); - break; - } - - /* dump limit in db (calculate from path A) */ - limit_offset[0] = PHY_GetTxPowerLimit_no_sc(adapter, 3, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* FCC */ - limit_offset[1] = PHY_GetTxPowerLimit_no_sc(adapter, 1, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* ETSI */ - limit_offset[2] = PHY_GetTxPowerLimit_no_sc(adapter, 2, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* MKK */ - limit_offset[3] = PHY_GetTxPowerLimit_no_sc(adapter, 4, band, bw, RF_PATH_A, rates_by_sections[rs].rates[0], ch); /* WW */ - - base = PHY_GetTxPowerByRateBase(adapter, band, RF_PATH_A, rate_section_to_tx_num(rs), rs); - - RTW_PRINT_SEL(sel, "%3u ", ch); - for (i = 0; i < MAX_REGULATION_NUM; i++) { - if (limit_offset[i] == MAX_POWER_INDEX) { - limit_idx[0][i] = MAX_POWER_INDEX; - _RTW_PRINT_SEL(sel, "%5s ", "NA"); - } else { - limit_idx[0][i] = limit_offset[i] + base; - if ((limit_offset[i] + base) % 2) - _RTW_PRINT_SEL(sel, "%3d.5 ", (limit_offset[i] + base) / 2); - else - _RTW_PRINT_SEL(sel, "%5d ", (limit_offset[i] + base) / 2); - } - } - - /* dump limit offset of each path */ - for (path = 0; path < RF_PATH_MAX; path++) { - if (path >= rfpath_num) - break; - limit_offset[0] = PHY_GetTxPowerLimit_no_sc(adapter, 3, band, bw, path, rates_by_sections[rs].rates[0], ch); /* FCC */ - limit_offset[1] = PHY_GetTxPowerLimit_no_sc(adapter, 1, band, bw, path, rates_by_sections[rs].rates[0], ch); /* ETSI */ - limit_offset[2] = PHY_GetTxPowerLimit_no_sc(adapter, 2, band, bw, path, rates_by_sections[rs].rates[0], ch); /* MKK */ - limit_offset[3] = PHY_GetTxPowerLimit_no_sc(adapter, 4, band, bw, path, rates_by_sections[rs].rates[0], ch); /* WW */ - - base = PHY_GetTxPowerByRateBase(adapter, band, path, rate_section_to_tx_num(rs), rs); - - _RTW_PRINT_SEL(sel, "|"); - for (i = 0; i < MAX_REGULATION_NUM; i++) { - if (limit_offset[i] == MAX_POWER_INDEX) { - limit_idx[path][i] = MAX_POWER_INDEX; - _RTW_PRINT_SEL(sel, "%3s ", "NA"); - } else { - limit_idx[path][i] = limit_offset[i] + base; - _RTW_PRINT_SEL(sel, "%3d ", limit_offset[i]); - } - } - } - - /* compare limit_idx of each path, print 'x' when mismatch */ - if (rfpath_num > 1) { - for (i = 0; i < MAX_REGULATION_NUM; i++) { - for (path = 0; path < RF_PATH_MAX; path++) { - if (path >= rfpath_num) - break; - if (limit_idx[path][i] != limit_idx[(path + 1) % rfpath_num][i]) - break; - } - if (path >= rfpath_num) - _RTW_PRINT_SEL(sel, " "); - else - _RTW_PRINT_SEL(sel, "x"); - } - } - _RTW_PRINT_SEL(sel, "\n"); - - } - RTW_PRINT_SEL(sel, "\n"); - } /* loop for rate sections */ - } /* loop for bandwidths */ - } /* loop for bands */ -} - /* * phy file path is stored in global char array rtw_phy_para_file_path * need to care about racing @@ -4356,10 +4092,10 @@ phy_ConfigBBWithParaFile( szLine += u4bMove; if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { /* RTW_INFO("[BB-ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ - PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); + phy_set_bb_reg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); if (u4bRegOffset == 0xa24) - pHalData->odmpriv.RFCalibrateInfo.RegA24 = u4bRegValue; + pHalData->odmpriv.rf_calibrate_info.rega24 = u4bRegValue; /* Add 1us delay between BB/RF register setting. */ rtw_udelay_os(1); @@ -4441,10 +4177,10 @@ phy_ParseBBPgParaFile( if (firstLine) { if (eqNByte(szLine, (u8 *)("#[v1]"), 5)) { - pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; + pHalData->odmpriv.phy_reg_pg_version = szLine[3] - '0'; /* RTW_INFO("This is a new format PHY_REG_PG.txt\n"); */ } else if (eqNByte(szLine, (u8 *)("#[v0]"), 5)) { - pHalData->odmpriv.PhyRegPgVersion = szLine[3] - '0'; + pHalData->odmpriv.phy_reg_pg_version = szLine[3] - '0'; /* RTW_INFO("This is a old format PHY_REG_PG.txt ok\n"); */ } else { RTW_INFO("The format in PHY_REG_PG are invalid %s\n", szLine); @@ -4452,12 +4188,12 @@ phy_ParseBBPgParaFile( } if (eqNByte(szLine + 5, (u8 *)("[Exact]#"), 8)) { - pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; + pHalData->odmpriv.phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE; /* RTW_INFO("The values in PHY_REG_PG are exact values ok\n"); */ firstLine = _FALSE; continue; } else if (eqNByte(szLine + 5, (pu1Byte)("[Relative]#"), 11)) { - pHalData->odmpriv.PhyRegPgValueType = PHY_REG_PG_RELATIVE_VALUE; + pHalData->odmpriv.phy_reg_pg_value_type = PHY_REG_PG_RELATIVE_VALUE; /* RTW_INFO("The values in PHY_REG_PG are relative values ok\n"); */ firstLine = _FALSE; continue; @@ -4467,7 +4203,7 @@ phy_ParseBBPgParaFile( } } - if (pHalData->odmpriv.PhyRegPgVersion == 0) { + if (pHalData->odmpriv.phy_reg_pg_version == 0) { /* Get 1st hex value as register offset. */ if (GetHexValueFromString(szLine, &u4bRegOffset, &u4bMove)) { szLine += u4bMove; @@ -4482,14 +4218,14 @@ phy_ParseBBPgParaFile( else return _FAIL; - if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { + if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_RELATIVE_VALUE) { /* Get 3rd hex value as register value. */ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { - PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, u4bRegValue); + phy_store_tx_power_by_rate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, u4bRegValue); /* RTW_INFO("[ADDR] %03X=%08X Mask=%08x\n", u4bRegOffset, u4bRegValue, u4bRegMask); */ } else return _FAIL; - } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { + } else if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) { u32 combineValue = 0; u8 integer = 0, fraction = 0; @@ -4539,12 +4275,12 @@ phy_ParseBBPgParaFile( combineValue <<= 8; combineValue |= (((integer / 10) << 4) + (integer % 10)); /* RTW_INFO(" %d", integer ); */ - PHY_StoreTxPowerByRate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, combineValue); + phy_store_tx_power_by_rate(Adapter, 0, 0, 1, u4bRegOffset, u4bRegMask, combineValue); /* RTW_INFO("[ADDR] 0x%3x = 0x%4x\n", u4bRegOffset, combineValue ); */ } } - } else if (pHalData->odmpriv.PhyRegPgVersion > 0) { + } else if (pHalData->odmpriv.phy_reg_pg_version > 0) { u32 index = 0, cnt = 0; if (eqNByte(szLine, "0xffff", 6)) @@ -4598,14 +4334,14 @@ phy_ParseBBPgParaFile( else return _FAIL; - if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_RELATIVE_VALUE) { + if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_RELATIVE_VALUE) { /* Get 3rd hex value as register value. */ if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { - PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, u4bRegValue); + phy_store_tx_power_by_rate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, u4bRegValue); /* RTW_INFO("[ADDR] %03X (tx_num %d) =%08X Mask=%08x\n", u4bRegOffset, tx_num, u4bRegValue, u4bRegMask); */ } else return _FAIL; - } else if (pHalData->odmpriv.PhyRegPgValueType == PHY_REG_PG_EXACT_VALUE) { + } else if (pHalData->odmpriv.phy_reg_pg_value_type == PHY_REG_PG_EXACT_VALUE) { u32 combineValue = 0; u8 integer = 0, fraction = 0; @@ -4655,7 +4391,7 @@ phy_ParseBBPgParaFile( combineValue <<= 8; combineValue |= (((integer / 10) << 4) + (integer % 10)); /* RTW_INFO(" %d", integer ); */ - PHY_StoreTxPowerByRate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); + phy_store_tx_power_by_rate(Adapter, band, rf_path, tx_num, u4bRegOffset, u4bRegMask, combineValue); /* RTW_INFO("[ADDR] 0x%3x (tx_num %d) = 0x%4x\n", u4bRegOffset, tx_num, combineValue ); */ } @@ -4784,7 +4520,7 @@ phy_ConfigBBWithMpParaFile( szLine += u4bMove; if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { /* RTW_INFO("[ADDR]%03lX=%08lX\n", u4bRegOffset, u4bRegValue); */ - PHY_SetBBReg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); + phy_set_bb_reg(Adapter, u4bRegOffset, bMaskDWord, u4bRegValue); /* Add 1us delay between BB/RF register setting. */ rtw_udelay_os(1); @@ -4804,7 +4540,7 @@ int PHY_ConfigRFWithParaFile( IN PADAPTER Adapter, IN char *pFileName, - IN u8 eRFPath + IN enum rf_path eRFPath ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -4819,11 +4555,11 @@ PHY_ConfigRFWithParaFile( return rtStatus; switch (eRFPath) { - case ODM_RF_PATH_A: + case RF_PATH_A: pBuf = pHalData->rf_radio_a; pBufLen = &pHalData->rf_radio_a_len; break; - case ODM_RF_PATH_B: + case RF_PATH_B: pBuf = pHalData->rf_radio_b; pBufLen = &pHalData->rf_radio_b_len; break; @@ -4846,12 +4582,15 @@ PHY_ConfigRFWithParaFile( *pBufLen = rlen; switch (eRFPath) { - case ODM_RF_PATH_A: + case RF_PATH_A: pHalData->rf_radio_a = pBuf; break; - case ODM_RF_PATH_B: + case RF_PATH_B: pHalData->rf_radio_b = pBuf; break; + default: + RTW_INFO("Unknown RF path!! %d\r\n", eRFPath); + break; } } else RTW_INFO("%s(): eRFPath=%d alloc fail !\n", __FUNCTION__, eRFPath); @@ -4900,7 +4639,7 @@ PHY_ConfigRFWithParaFile( /* Get 2nd hex value as register value. */ szLine += u4bMove; if (GetHexValueFromString(szLine, &u4bRegValue, &u4bMove)) { - PHY_SetRFReg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue); + phy_set_rf_reg(Adapter, eRFPath, u4bRegOffset, bRFRegOffsetMask, u4bRegValue); /* Temp add, for frequency lock, if no delay, that may cause */ /* frequency shift, ex: 2412MHz => 2417MHz */ @@ -4949,8 +4688,8 @@ initDeltaSwingIndexTables( } } while (0)\ HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct odm_rf_calibration_structure *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); u32 j = 0; char *token; char delim[] = ","; @@ -4960,53 +4699,53 @@ initDeltaSwingIndexTables( /* Band, Path, Sign, Channel, Rate, Data); */ if (STR_EQUAL_2G("2G", "A", "+", "CCK")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p, j); else if (STR_EQUAL_2G("2G", "A", "-", "CCK")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n, j); else if (STR_EQUAL_2G("2G", "B", "+", "CCK")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p, j); else if (STR_EQUAL_2G("2G", "B", "-", "CCK")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n, j); else if (STR_EQUAL_2G("2G", "A", "+", "ALL")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_p, j); else if (STR_EQUAL_2G("2G", "A", "-", "ALL")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2ga_n, j); else if (STR_EQUAL_2G("2G", "B", "+", "ALL")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_p, j); else if (STR_EQUAL_2G("2G", "B", "-", "ALL")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_2gb_n, j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "0")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[0], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[0], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "0")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[0], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[0], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "0")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[0], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[0], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "0")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[0], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[0], j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "1")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[1], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[1], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "1")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[1], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[1], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "1")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[1], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[1], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "1")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[1], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[1], j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "2")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[2], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[2], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "2")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[2], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[2], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "2")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[2], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[2], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "2")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[2], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[2], j); else if (STR_EQUAL_5G("5G", "A", "+", "ALL", "3")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[3], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_p[3], j); else if (STR_EQUAL_5G("5G", "A", "-", "ALL", "3")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[3], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5ga_n[3], j); else if (STR_EQUAL_5G("5G", "B", "+", "ALL", "3")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[3], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_p[3], j); else if (STR_EQUAL_5G("5G", "B", "-", "ALL", "3")) - STORE_SWING_TABLE(pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[3], j); + STORE_SWING_TABLE(pRFCalibrateInfo->delta_swing_table_idx_5gb_n[3], j); else RTW_INFO("===>initDeltaSwingIndexTables(): The input is invalid!!\n"); } @@ -5018,8 +4757,8 @@ PHY_ConfigRFWithTxPwrTrackParaFile( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct odm_rf_calibration_structure *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); int rlen = 0, rtStatus = _FAIL; char *szLine, *ptmp; u32 i = 0, j = 0; @@ -5089,43 +4828,164 @@ PHY_ConfigRFWithTxPwrTrackParaFile( RTW_INFO("%s(): No File %s, Load from HWImg Array!\n", __FUNCTION__, pFileName); #if 0 for (i = 0; i < DELTA_SWINGIDX_SIZE; ++i) { - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P[i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N[i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P[i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N[i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P[i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N[i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P[i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[%d] = %d\n", i, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2ga_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_p[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2ga_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2ga_n[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_p[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2gb_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2gb_n[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_p[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_a_n[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_p[i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[%d] = %d\n", i, pRFCalibrateInfo->delta_swing_table_idx_2g_cck_b_n[i]); for (j = 0; j < 3; ++j) { - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P[j][i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N[j][i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P[j][i]); - RTW_INFO("pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[%d][%d] = %d\n", j, i, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N[j][i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_p[j][i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5ga_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5ga_n[j][i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_p[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_p[j][i]); + RTW_INFO("pRFCalibrateInfo->delta_swing_table_idx_5gb_n[%d][%d] = %d\n", j, i, pRFCalibrateInfo->delta_swing_table_idx_5gb_n[j][i]); } } #endif return rtStatus; } -int +#ifdef CONFIG_TXPWR_LIMIT + +#ifndef DBG_TXPWR_LMT_FILE_PARSE +#define DBG_TXPWR_LMT_FILE_PARSE 0 +#endif + +#define PARSE_RET_NO_HDL 0 +#define PARSE_RET_SUCCESS 1 +#define PARSE_RET_FAIL 2 + +/* +* @@Ver=2.0 +* or +* @@DomainCode=0x28, Regulation=C6 +* or +* @@CountryCode=GB, Regulation=C7 +*/ +static u8 parse_reg_exc_config(_adapter *adapter, char *szLine) +{ +#define VER_PREFIX "Ver=" +#define DOMAIN_PREFIX "DomainCode=0x" +#define COUNTRY_PREFIX "CountryCode=" +#define REG_PREFIX "Regulation=" + + const u8 ver_prefix_len = strlen(VER_PREFIX); + const u8 domain_prefix_len = strlen(DOMAIN_PREFIX); + const u8 country_prefix_len = strlen(COUNTRY_PREFIX); + const u8 reg_prefix_len = strlen(REG_PREFIX); + u32 i, i_val_s, i_val_e; + u32 j; + u8 domain = 0xFF; + char *country = NULL; + u8 parse_reg = 0; + + if (szLine[0] != '@' || szLine[1] != '@') + return PARSE_RET_NO_HDL; + + i = 2; + if (strncmp(szLine + i, VER_PREFIX, ver_prefix_len) == 0) + ; /* nothing to do */ + else if (strncmp(szLine + i, DOMAIN_PREFIX, domain_prefix_len) == 0) { + /* get string after domain prefix to ',' */ + i += domain_prefix_len; + i_val_s = i; + while (szLine[i] != ',') { + if (szLine[i] == '\0') + return PARSE_RET_FAIL; + i++; + } + i_val_e = i; + + /* check if all hex */ + for (j = i_val_s; j < i_val_e; j++) + if (IsHexDigit(szLine[j]) == _FALSE) + return PARSE_RET_FAIL; + + /* get value from hex string */ + if (sscanf(szLine + i_val_s, "%hhx", &domain) != 1) + return PARSE_RET_FAIL; + + parse_reg = 1; + } else if (strncmp(szLine + i, COUNTRY_PREFIX, country_prefix_len) == 0) { + /* get string after country prefix to ',' */ + i += country_prefix_len; + i_val_s = i; + while (szLine[i] != ',') { + if (szLine[i] == '\0') + return PARSE_RET_FAIL; + i++; + } + i_val_e = i; + + if (i_val_e - i_val_s != 2) + return PARSE_RET_FAIL; + + /* check if all alpha */ + for (j = i_val_s; j < i_val_e; j++) + if (is_alpha(szLine[j]) == _FALSE) + return PARSE_RET_FAIL; + + country = szLine + i_val_s; + + parse_reg = 1; + + } else + return PARSE_RET_FAIL; + + if (parse_reg) { + /* move to 'R' */ + while (szLine[i] != 'R') { + if (szLine[i] == '\0') + return PARSE_RET_FAIL; + i++; + } + + /* check if matching regulation prefix */ + if (strncmp(szLine + i, REG_PREFIX, reg_prefix_len) != 0) + return PARSE_RET_FAIL; + + /* get string after regulation prefix ending with space */ + i += reg_prefix_len; + i_val_s = i; + while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') + i++; + + if (i == i_val_s) + return PARSE_RET_FAIL; + + rtw_regd_exc_add_with_nlen(adapter_to_rfctl(adapter), country, domain, szLine + i_val_s, i - i_val_s); + } + + return PARSE_RET_SUCCESS; +} + +static int phy_ParsePowerLimitTableFile( PADAPTER Adapter, char *buffer ) { +#define LD_STAGE_EXC_MAPPING 0 +#define LD_STAGE_TAB_DEFINE 1 +#define LD_STAGE_TAB_START 2 +#define LD_STAGE_COLUMN_DEFINE 3 +#define LD_STAGE_CH_ROW 4 + + int rtStatus = _FAIL; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); + u8 loadingStage = LD_STAGE_EXC_MAPPING; u32 i = 0, forCnt = 0; - u8 loadingStage = 0, limitValue = 0, fraction = 0; + u8 limitValue = 0, fraction = 0, negative = 0; char *szLine, *ptmp; - int rtStatus = _SUCCESS; - char band[10], bandwidth[10], rateSection[10], - regulation[TXPWR_LMT_MAX_REGULATION_NUM][10], rfPath[10], colNumBuf[10]; + char band[10], bandwidth[10], rateSection[10], ntx[10], colNumBuf[10]; + char **regulation = NULL; u8 colNum = 0; - RTW_INFO("===>phy_ParsePowerLimitTableFile()\n"); + RTW_INFO("%s enter\n", __func__); if (Adapter->registrypriv.RegDecryptCustomFile == 1) phy_DecryptBBPgParaFile(Adapter, buffer); @@ -5134,20 +4994,25 @@ phy_ParsePowerLimitTableFile( for (szLine = GetLineFromBuffer(ptmp); szLine != NULL; szLine = GetLineFromBuffer(ptmp)) { if (isAllSpaceOrTab(szLine, sizeof(*szLine))) continue; - - /* skip comment */ if (IsCommentString(szLine)) continue; - if (loadingStage == 0) { - for (forCnt = 0; forCnt < TXPWR_LMT_MAX_REGULATION_NUM; ++forCnt) - _rtw_memset((PVOID) regulation[forCnt], 0, 10); - _rtw_memset((PVOID) band, 0, 10); - _rtw_memset((PVOID) bandwidth, 0, 10); - _rtw_memset((PVOID) rateSection, 0, 10); - _rtw_memset((PVOID) rfPath, 0, 10); - _rtw_memset((PVOID) colNumBuf, 0, 10); + if (loadingStage == LD_STAGE_EXC_MAPPING) { + if (szLine[0] == '#' || szLine[1] == '#') { + loadingStage = LD_STAGE_TAB_DEFINE; + if (DBG_TXPWR_LMT_FILE_PARSE) + dump_regd_exc_list(RTW_DBGDUMP, adapter_to_rfctl(Adapter)); + } else { + if (parse_reg_exc_config(Adapter, szLine) == PARSE_RET_FAIL) { + RTW_ERR("Fail to parse regulation exception ruls!\n"); + goto exit; + } + continue; + } + } + if (loadingStage == LD_STAGE_TAB_DEFINE) { + /* read "## 2.4G, 20M, 1T, CCK" */ if (szLine[0] != '#' || szLine[1] != '#') continue; @@ -5159,25 +5024,30 @@ phy_ParsePowerLimitTableFile( szLine[--i] = ' '; /* return the space in front of the regulation info */ /* Parse the label of the table */ + _rtw_memset((PVOID) band, 0, 10); + _rtw_memset((PVOID) bandwidth, 0, 10); + _rtw_memset((PVOID) ntx, 0, 10); + _rtw_memset((PVOID) rateSection, 0, 10); if (!ParseQualifiedString(szLine, &i, band, ' ', ',')) { - RTW_INFO("Fail to parse band!\n"); - return _FAIL; + RTW_ERR("Fail to parse band!\n"); + goto exit; } if (!ParseQualifiedString(szLine, &i, bandwidth, ' ', ',')) { - RTW_INFO("Fail to parse bandwidth!\n"); - return _FAIL; + RTW_ERR("Fail to parse bandwidth!\n"); + goto exit; } - if (!ParseQualifiedString(szLine, &i, rfPath, ' ', ',')) { - RTW_INFO("Fail to parse rf path!\n"); - return _FAIL; + if (!ParseQualifiedString(szLine, &i, ntx, ' ', ',')) { + RTW_ERR("Fail to parse ntx!\n"); + goto exit; } if (!ParseQualifiedString(szLine, &i, rateSection, ' ', ',')) { - RTW_INFO("Fail to parse rate!\n"); - return _FAIL; + RTW_ERR("Fail to parse rate!\n"); + goto exit; } - loadingStage = 1; - } else if (loadingStage == 1) { + loadingStage = LD_STAGE_TAB_START; + } else if (loadingStage == LD_STAGE_TAB_START) { + /* read "## START" */ if (szLine[0] != '#' || szLine[1] != '#') continue; @@ -5187,12 +5057,13 @@ phy_ParsePowerLimitTableFile( ++i; if (!eqNByte((u8 *)(szLine + i), (u8 *)("START"), 5)) { - RTW_INFO("Lost \"## START\" label\n"); - return _FAIL; + RTW_ERR("Missing \"## START\" label\n"); + goto exit; } - loadingStage = 2; - } else if (loadingStage == 2) { + loadingStage = LD_STAGE_COLUMN_DEFINE; + } else if (loadingStage == LD_STAGE_COLUMN_DEFINE) { + /* read "## #5# FCC ETSI MKK IC KCC" */ if (szLine[0] != '#' || szLine[1] != '#') continue; @@ -5201,39 +5072,59 @@ phy_ParsePowerLimitTableFile( while (szLine[i] == ' ' || szLine[i] == '\t') ++i; + _rtw_memset((PVOID) colNumBuf, 0, 10); if (!ParseQualifiedString(szLine, &i, colNumBuf, '#', '#')) { - RTW_INFO("Fail to parse column number!\n"); - return _FAIL; + RTW_ERR("Fail to parse column number!\n"); + goto exit; + } + if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) { + RTW_ERR("Column number \"%s\" is not unsigned decimal\n", colNumBuf); + goto exit; + } + if (colNum == 0) { + RTW_ERR("Column number is 0\n"); + goto exit; } - if (!GetU1ByteIntegerFromStringInDecimal(colNumBuf, &colNum)) - return _FAIL; + if (DBG_TXPWR_LMT_FILE_PARSE) + RTW_PRINT("[%s][%s][%s][%s] column num:%d\n", band, bandwidth, rateSection, ntx, colNum); - if (colNum > TXPWR_LMT_MAX_REGULATION_NUM) { - RTW_INFO("unvalid col number %d (greater than max %d)\n", - colNum, TXPWR_LMT_MAX_REGULATION_NUM); - return _FAIL; + regulation = (char **)rtw_zmalloc(sizeof(char *) * colNum); + if (!regulation) { + RTW_ERR("Regulation alloc fail\n"); + goto exit; } for (forCnt = 0; forCnt < colNum; ++forCnt) { - u8 regulation_name_cnt = 0; + u32 i_ns; /* skip the space */ while (szLine[i] == ' ' || szLine[i] == '\t') - ++i; + i++; + i_ns = i; while (szLine[i] != ' ' && szLine[i] != '\t' && szLine[i] != '\0') - regulation[forCnt][regulation_name_cnt++] = szLine[i++]; - /* RTW_INFO("regulation %s!\n", regulation[forCnt]); */ + i++; - if (regulation_name_cnt == 0) { - RTW_INFO("unvalid number of regulation!\n"); - return _FAIL; + regulation[forCnt] = (char *)rtw_malloc(i - i_ns + 1); + if (!regulation[forCnt]) { + RTW_ERR("Regulation alloc fail\n"); + goto exit; } + + _rtw_memcpy(regulation[forCnt], szLine + i_ns, i - i_ns); + regulation[forCnt][i - i_ns] = '\0'; } - loadingStage = 3; - } else if (loadingStage == 3) { + if (DBG_TXPWR_LMT_FILE_PARSE) { + RTW_PRINT("column name:"); + for (forCnt = 0; forCnt < colNum; ++forCnt) + _RTW_PRINT(" %s", regulation[forCnt]); + _RTW_PRINT("\n"); + } + + loadingStage = LD_STAGE_CH_ROW; + } else if (loadingStage == LD_STAGE_CH_ROW) { char channel[10] = {0}, powerLimit[10] = {0}; u8 cnt = 0; @@ -5244,18 +5135,29 @@ phy_ParsePowerLimitTableFile( ++i; if (eqNByte((u8 *)(szLine + i), (u8 *)("END"), 3)) { - loadingStage = 0; + loadingStage = LD_STAGE_TAB_DEFINE; + if (regulation) { + for (forCnt = 0; forCnt < colNum; ++forCnt) { + if (regulation[forCnt]) { + rtw_mfree(regulation[forCnt], strlen(regulation[forCnt]) + 1); + regulation[forCnt] = NULL; + } + } + rtw_mfree((u8 *)regulation, sizeof(char *) * colNum); + regulation = NULL; + } + colNum = 0; continue; } else { - RTW_INFO("Wrong format\n"); - RTW_INFO("<===== phy_ParsePowerLimitTableFile()\n"); - return _FAIL; + RTW_ERR("Missing \"## END\" label\n"); + goto exit; } } if ((szLine[0] != 'c' && szLine[0] != 'C') || - (szLine[1] != 'h' && szLine[1] != 'H')) { - RTW_INFO("Meet wrong channel => power limt pair '%c','%c'(%d,%d)\n", szLine[0], szLine[1], szLine[0], szLine[1]); + (szLine[1] != 'h' && szLine[1] != 'H') + ) { + RTW_WARN("Wrong channel prefix: '%c','%c'(%d,%d)\n", szLine[0], szLine[1], szLine[0], szLine[1]); continue; } i = 2;/* move to the location behind 'h' */ @@ -5277,15 +5179,29 @@ phy_ParsePowerLimitTableFile( /* load the power limit value */ cnt = 0; fraction = 0; + negative = 0; _rtw_memset((PVOID) powerLimit, 0, 10); - while ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.') { - if (szLine[i] == '.') { + while ((szLine[i] >= '0' && szLine[i] <= '9') || szLine[i] == '.' + || szLine[i] == '+' || szLine[i] == '-' + ) { + if (szLine[i] == '+' || szLine[i] == '-') { + if (cnt != 0) { + RTW_ERR("Wrong position for sign '%c'\n", szLine[i]); + goto exit; + } + if (szLine[i] == '-') { + negative = 1; + ++i; + continue; + } + + } else if (szLine[i] == '.') { if ((szLine[i + 1] >= '0' && szLine[i + 1] <= '9')) { fraction = szLine[i + 1]; i += 2; } else { - RTW_INFO("Wrong fraction in TXPWR_LMT.txt\n"); - return _FAIL; + RTW_ERR("Wrong fraction '%c'(%d)\n", szLine[i + 1], szLine[i + 1]); + goto exit; } break; @@ -5301,11 +5217,17 @@ phy_ParsePowerLimitTableFile( powerLimit[1] = '3'; i += 2; } else { - if (!GetU1ByteIntegerFromStringInDecimal(powerLimit, &limitValue)) - return _FAIL; + if (!GetU1ByteIntegerFromStringInDecimal(powerLimit, &limitValue)) { + RTW_ERR("Limit \"%s\" is not valid decimal\n", powerLimit); + goto exit; + } limitValue *= 2; cnt = 0; + + if (negative) + powerLimit[cnt++] = '-'; + if (fraction == '5') ++limitValue; @@ -5338,18 +5260,28 @@ phy_ParsePowerLimitTableFile( /* RTW_INFO("ch%s => %s\n", channel, powerLimit); */ /* store the power limit value */ - PHY_SetTxPowerLimit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band, - (u8 *)bandwidth, (u8 *)rateSection, (u8 *)rfPath, (u8 *)channel, (u8 *)powerLimit); + phy_set_tx_power_limit(pDM_Odm, (u8 *)regulation[forCnt], (u8 *)band, + (u8 *)bandwidth, (u8 *)rateSection, (u8 *)ntx, (u8 *)channel, (u8 *)powerLimit); } - } else { - RTW_INFO("Abnormal loading stage in phy_ParsePowerLimitTableFile()!\n"); - rtStatus = _FAIL; - break; } } - RTW_INFO("<===phy_ParsePowerLimitTableFile()\n"); + rtStatus = _SUCCESS; + +exit: + if (regulation) { + for (forCnt = 0; forCnt < colNum; ++forCnt) { + if (regulation[forCnt]) { + rtw_mfree(regulation[forCnt], strlen(regulation[forCnt]) + 1); + regulation[forCnt] = NULL; + } + } + rtw_mfree((u8 *)regulation, sizeof(char *) * colNum); + regulation = NULL; + } + + RTW_INFO("%s return %d\n", __func__, rtStatus); return rtStatus; } @@ -5397,6 +5329,7 @@ PHY_ConfigRFWithPowerLimitTableParaFile( return rtStatus; } +#endif /* CONFIG_TXPWR_LIMIT */ void phy_free_filebuf_mask(_adapter *padapter, u8 mask) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.c index 1436d47cded7..aa7aa4805a66 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2014 Realtek Corporation. All rights reserved. + * Copyright(c) 2014 - 2017 Realtek Corporation. * * 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 @@ -11,20 +11,15 @@ * 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 #include /* A mapping from HalData to ODM. */ -ODM_BOARD_TYPE_E boardType(u8 InterfaceSel) +enum odm_board_type_e boardType(u8 InterfaceSel) { - ODM_BOARD_TYPE_E board = ODM_BOARD_DEFAULT; + enum odm_board_type_e board = ODM_BOARD_DEFAULT; #ifdef CONFIG_PCI_HCI INTERFACE_SELECT_PCIE pcie = (INTERFACE_SELECT_PCIE)InterfaceSel; @@ -70,57 +65,159 @@ ODM_BOARD_TYPE_E boardType(u8 InterfaceSel) return board; } +void rtw_hal_update_iqk_fw_offload_cap(_adapter *adapter) +{ + PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(adapter); + + if (hal->RegIQKFWOffload) { + rtw_sctx_init(&hal->iqk_sctx, 0); + phydm_fwoffload_ability_init(p_dm_odm, PHYDM_RF_IQK_OFFLOAD); + } else + phydm_fwoffload_ability_clear(p_dm_odm, PHYDM_RF_IQK_OFFLOAD); + + RTW_INFO("IQK FW offload:%s\n", hal->RegIQKFWOffload ? "enable" : "disable"); +} + +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1)) +void rtw_phydm_iqk_trigger(_adapter *adapter) +{ + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(adapter); + u8 clear = _FALSE; + u8 segment = _FALSE; + u8 rfk_forbidden = _FALSE; + + /*segment = _rtw_phydm_iqk_segment_chk(adapter);*/ + halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); + halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_IQK_SEGMENT, segment); + halrf_segment_iqk_trigger(p_dm_odm, clear, segment); +} +#endif + +void rtw_phydm_iqk_trigger_dbg(_adapter *adapter, bool recovery, bool clear, bool segment) +{ + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(adapter); + +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1)) + halrf_segment_iqk_trigger(p_dm_odm, clear, segment); +#else + halrf_iqk_trigger(p_dm_odm, recovery); +#endif +} +void rtw_phydm_lck_trigger(_adapter *adapter) +{ + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(adapter); + + halrf_lck_trigger(p_dm_odm); +} +#ifdef CONFIG_DBG_RF_CAL +void rtw_hal_iqk_test(_adapter *adapter, bool recovery, bool clear, bool segment) +{ + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(adapter); + + rtw_ps_deny(adapter, PS_DENY_IOCTL); + LeaveAllPowerSaveModeDirect(adapter); + + rtw_phydm_ability_backup(adapter); + rtw_phydm_func_disable_all(adapter); + + halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_ABILITY, HAL_RF_IQK); + + rtw_phydm_iqk_trigger_dbg(adapter, recovery, clear, segment); + rtw_phydm_ability_restore(adapter); + + rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); +} + +void rtw_hal_lck_test(_adapter *adapter) +{ + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(adapter); + + rtw_ps_deny(adapter, PS_DENY_IOCTL); + LeaveAllPowerSaveModeDirect(adapter); + + rtw_phydm_ability_backup(adapter); + rtw_phydm_func_disable_all(adapter); + + halrf_cmn_info_set(p_dm_odm, HALRF_CMNINFO_ABILITY, HAL_RF_LCK); + + rtw_phydm_lck_trigger(adapter); + + rtw_phydm_ability_restore(adapter); + rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); +} +#endif + +#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT +void rtw_hal_update_param_init_fw_offload_cap(_adapter *adapter) +{ + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(adapter); + + if (adapter->registrypriv.fw_param_init) + phydm_fwoffload_ability_init(p_dm_odm, PHYDM_PHY_PARAM_OFFLOAD); + else + phydm_fwoffload_ability_clear(p_dm_odm, PHYDM_PHY_PARAM_OFFLOAD); + + RTW_INFO("Init-Parameter FW offload:%s\n", adapter->registrypriv.fw_param_init ? "enable" : "disable"); +} +#endif + +void record_ra_info(void *p_dm_void, u8 macid, struct cmn_sta_info *p_sta, u64 ra_mask) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + _adapter *adapter = p_dm->adapter; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); + + rtw_macid_ctl_set_bw(macid_ctl, macid, p_sta->ra_info.ra_bw_mode); + rtw_macid_ctl_set_vht_en(macid_ctl, macid, p_sta->ra_info.is_vht_enable); + rtw_macid_ctl_set_rate_bmp0(macid_ctl, macid, ra_mask); + rtw_macid_ctl_set_rate_bmp1(macid_ctl, macid, ra_mask >> 32); + + rtw_update_tx_rate_bmp(adapter_to_dvobj(adapter)); +} + +void rtw_phydm_ops_func_init(struct PHY_DM_STRUCT *p_phydm) +{ + struct _rate_adaptive_table_ *p_ra_t = &p_phydm->dm_ra_table; + + p_ra_t->record_ra_info = record_ra_info; +} + void Init_ODM_ComInfo(_adapter *adapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); - struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; - struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); int i; _rtw_memset(pDM_Odm, 0, sizeof(*pDM_Odm)); - pDM_Odm->Adapter = adapter; + pDM_Odm->adapter = adapter; - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PLATFORM, ODM_CE); + /*phydm_op_mode could be change for different scenarios: ex: SoftAP - PHYDM_BALANCE_MODE*/ + pHalData->phydm_op_mode = PHYDM_PERFORMANCE_MODE;/*Service one device*/ + + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_PLATFORM, ODM_CE); rtw_odm_init_ic_type(adapter); if (rtw_get_intf_type(adapter) == RTW_GSPI) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_INTERFACE, ODM_ITRF_SDIO); else - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_INTERFACE, rtw_get_intf_type(adapter)); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_INTERFACE, rtw_get_intf_type(adapter)); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->VersionID)); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_MP_TEST_CHIP, IS_NORMAL_CHIP(pHalData->version_id)); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_PATCH_ID, pHalData->CustomerID); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, adapter->registrypriv.wifi_spec); - - - if (pHalData->rf_type == RF_1T1R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T1R); - else if (pHalData->rf_type == RF_1T2R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_1T2R); - else if (pHalData->rf_type == RF_2T2R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R); - else if (pHalData->rf_type == RF_2T2R_GREEN) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T2R_GREEN); - else if (pHalData->rf_type == RF_2T3R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T3R); - else if (pHalData->rf_type == RF_2T4R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_2T4R); - else if (pHalData->rf_type == RF_3T3R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T3R); - else if (pHalData->rf_type == RF_3T4R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_3T4R); - else if (pHalData->rf_type == RF_4T4R) - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_4T4R); - else - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_TYPE, ODM_XTXR); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_BWIFI_TEST, adapter->registrypriv.wifi_spec); +#ifdef CONFIG_ADVANCE_OTA + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_ADVANCE_OTA, adapter->registrypriv.adv_ota); +#endif + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_TYPE, pHalData->rf_type); { /* 1 ======= BoardType: ODM_CMNINFO_BOARD_TYPE ======= */ @@ -128,90 +225,946 @@ void Init_ODM_ComInfo(_adapter *adapter) if (pHalData->ExternalLNA_2G != 0) { odm_board_type |= ODM_BOARD_EXT_LNA; - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EXT_LNA, 1); } - if (pHalData->ExternalLNA_5G != 0) { + if (pHalData->external_lna_5g != 0) { odm_board_type |= ODM_BOARD_EXT_LNA_5G; - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_5G_EXT_LNA, 1); } if (pHalData->ExternalPA_2G != 0) { odm_board_type |= ODM_BOARD_EXT_PA; - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EXT_PA, 1); } - if (pHalData->ExternalPA_5G != 0) { + if (pHalData->external_pa_5g != 0) { odm_board_type |= ODM_BOARD_EXT_PA_5G; - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_5G_EXT_PA, 1); } if (pHalData->EEPROMBluetoothCoexist) odm_board_type |= ODM_BOARD_BT; - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, odm_board_type); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_BOARD_TYPE, odm_board_type); /* 1 ============== End of BoardType ============== */ } - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_2G, pHalData->Regulation2_4G); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DOMAIN_CODE_5G, pHalData->Regulation5G); + rtw_hal_set_odm_var(adapter, HAL_ODM_REGULATION, NULL, _TRUE); #ifdef CONFIG_DFS_MASTER - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_DFS_REGION_DOMAIN, adapter->registrypriv.dfs_region_domain); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_DFS_MASTER_ENABLE, &(adapter_to_rfctl(adapter)->dfs_master_enabled)); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_DFS_REGION_DOMAIN, adapter->registrypriv.dfs_region_domain); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_DFS_MASTER_ENABLE, &(adapter_to_rfctl(adapter)->dfs_master_enabled)); #endif - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GPA, pHalData->TypeGPA); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_APA, pHalData->TypeAPA); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_GLNA, pHalData->TypeGLNA); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_ALNA, pHalData->TypeALNA); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_GPA, pHalData->TypeGPA); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_APA, pHalData->TypeAPA); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_GLNA, pHalData->TypeGLNA); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_ALNA, pHalData->TypeALNA); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->RFEType); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RFE_TYPE, pHalData->rfe_type); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EXT_TRSW, 0); /*Add by YuChen for kfree init*/ - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_REGRFKFREEENABLE, adapter->registrypriv.RegPwrTrimEnable); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RFKFREEENABLE, pHalData->RfKFreeEnable); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_REGRFKFREEENABLE, adapter->registrypriv.RegPwrTrimEnable); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RFKFREEENABLE, pHalData->RfKFreeEnable); - /*Antenna diversity relative parameters*/ - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_BE_FIX_TX_ANT, pHalData->b_fix_tx_ant); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, pHalData->with_extenal_ant_switch); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, pHalData->TRxAntDivType); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_BE_FIX_TX_ANT, pHalData->b_fix_tx_ant); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, pHalData->with_extenal_ant_switch); + + /* (8822B) efuse 0x3D7 & 0x3D8 for TX PA bias */ + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EFUSE0X3D7, pHalData->efuse0x3d7); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_EFUSE0X3D8, pHalData->efuse0x3d8); /*Add by YuChen for adaptivity init*/ - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, (adapter->registrypriv.adaptivity_mode != 0) ? TRUE : FALSE); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DCBACKOFF, adapter->registrypriv.adaptivity_dc_backoff); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, (adapter->registrypriv.adaptivity_dml != 0) ? TRUE : FALSE); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, adapter->registrypriv.adaptivity_th_l2h_ini); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, adapter->registrypriv.adaptivity_th_edcca_hl_diff); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ADAPTIVITY, &(adapter->registrypriv.adaptivity_en)); + phydm_adaptivity_info_init(pDM_Odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, (adapter->registrypriv.adaptivity_mode != 0) ? TRUE : FALSE); + phydm_adaptivity_info_init(pDM_Odm, PHYDM_ADAPINFO_DCBACKOFF, adapter->registrypriv.adaptivity_dc_backoff); + phydm_adaptivity_info_init(pDM_Odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, (adapter->registrypriv.adaptivity_dml != 0) ? TRUE : FALSE); + phydm_adaptivity_info_init(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, adapter->registrypriv.adaptivity_th_l2h_ini); + phydm_adaptivity_info_init(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, adapter->registrypriv.adaptivity_th_edcca_hl_diff); + /*halrf info init*/ + halrf_cmn_info_init(pDM_Odm, HALRF_CMNINFO_EEPROM_THERMAL_VALUE, pHalData->eeprom_thermal_meter); + halrf_cmn_info_init(pDM_Odm, HALRF_CMNINFO_FW_VER, + ((pHalData->firmware_version << 16) | pHalData->firmware_sub_version)); + + if (rtw_odm_adaptivity_needed(adapter) == _TRUE) + rtw_odm_adaptivity_config_msg(RTW_DBGDUMP, adapter); + +#ifdef CONFIG_IQK_PA_OFF + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_IQKPAOFF, 1); +#endif + rtw_hal_update_iqk_fw_offload_cap(adapter); + #ifdef CONFIG_FW_OFFLOAD_PARAM_INIT + rtw_hal_update_param_init_fw_offload_cap(adapter); + #endif /* Pointer reference */ - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_UNI, &(dvobj->traffic_stat.tx_bytes)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_UNI, &(dvobj->traffic_stat.rx_bytes)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_WM_MODE, &(pmlmeext->cur_wireless_mode)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BAND, &(pHalData->CurrentBandType)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_RATE, &(pHalData->ForcedDataRate)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); + /*Antenna diversity relative parameters*/ + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ANT_DIV, &(pHalData->AntDivCfg)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_MP_MODE, &(adapter->registrypriv.mp_mode)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(pHalData->nCur40MhzPrimeSC)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SEC_MODE, &(adapter->securitypriv.dot11PrivacyAlgrthm)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BW, &(pHalData->CurrentChannelBW)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_CHNL, &(pHalData->CurrentChannel)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_NET_CLOSED, &(adapter->net_closed)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_FORCED_IGI_LB, &(pHalData->u1ForcedIgiLb)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BB_OPERATION_MODE, &(pHalData->phydm_op_mode)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_TX_UNI, &(dvobj->traffic_stat.tx_bytes)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_RX_UNI, &(dvobj->traffic_stat.rx_bytes)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_SCAN, &(pmlmepriv->bScanInProcess)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_POWER_SAVING, &(pwrctl->bpower_saving)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BAND, &(pHalData->current_band_type)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_FORCED_RATE, &(pHalData->ForcedDataRate)); + + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_SEC_CHNL_OFFSET, &(pHalData->nCur40MhzPrimeSC)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_SEC_MODE, &(adapter->securitypriv.dot11PrivacyAlgrthm)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BW, &(pHalData->current_channel_bw)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_CHNL, &(pHalData->current_channel)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_NET_CLOSED, &(adapter->net_closed)); + + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_SCAN, &(pHalData->bScanInProcess)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_POWER_SAVING, &(pwrctl->bpower_saving)); /*Add by Yuchen for phydm beamforming*/ - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_TX_TP, &(dvobj->traffic_stat.cur_tx_tp)); - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_RX_TP, &(dvobj->traffic_stat.cur_rx_tp)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_TX_TP, &(dvobj->traffic_stat.cur_tx_tp)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_RX_TP, &(dvobj->traffic_stat.cur_rx_tp)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_ANT_TEST, &(pHalData->antenna_test)); +#ifdef CONFIG_RTL8723B + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_IS1ANTENNA, &pHalData->EEPROMBluetoothAntNum); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_RFDEFAULTPATH, &pHalData->ant_path); +#endif /*CONFIG_RTL8723B*/ #ifdef CONFIG_USB_HCI - ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_HUBUSBMODE, &(dvobj->usb_speed)); + odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_HUBUSBMODE, &(dvobj->usb_speed)); #endif + + /*halrf info hook*/ +#ifdef CONFIG_MP_INCLUDED + halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_CON_TX, &(adapter->mppriv.mpt_ctx.is_start_cont_tx)); + halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_SINGLE_TONE, &(adapter->mppriv.mpt_ctx.is_single_tone)); + halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_CARRIER_SUPPRESSION, &(adapter->mppriv.mpt_ctx.is_carrier_suppression)); + halrf_cmn_info_hook(pDM_Odm, HALRF_CMNINFO_MP_RATE_INDEX, &(adapter->mppriv.mpt_ctx.mpt_rate_index)); +#endif/*CONFIG_MP_INCLUDED*/ for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) - ODM_CmnInfoPtrArrayHook(pDM_Odm, ODM_CMNINFO_STA_STATUS, i, NULL); - - PHYDM_InitDebugSetting(pDM_Odm); + odm_cmn_info_ptr_array_hook(pDM_Odm, ODM_CMNINFO_STA_STATUS, i, NULL); + phydm_init_debug_setting(pDM_Odm); + rtw_phydm_ops_func_init(pDM_Odm); /* TODO */ - /* ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BT_OPERATION, _FALSE); */ - /* ODM_CmnInfoHook(pDM_Odm, ODM_CMNINFO_BT_DISABLE_EDCA, _FALSE); */ + /* odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BT_OPERATION, _FALSE); */ + /* odm_cmn_info_hook(pDM_Odm, ODM_CMNINFO_BT_DISABLE_EDCA, _FALSE); */ } + + +static u32 edca_setting_UL[HT_IOT_PEER_MAX] = +/*UNKNOWN, REALTEK_90, REALTEK_92SE, BROADCOM,*/ +/*RALINK, ATHEROS, CISCO, MERU, MARVELL, 92U_AP, SELF_AP(DownLink/Tx) */ +{ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; + +static u32 edca_setting_DL[HT_IOT_PEER_MAX] = +/*UNKNOWN, REALTEK_90, REALTEK_92SE, BROADCOM,*/ +/*RALINK, ATHEROS, CISCO, MERU, MARVELL, 92U_AP, SELF_AP(UpLink/Rx)*/ +{ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; + +static u32 edca_setting_dl_g_mode[HT_IOT_PEER_MAX] = +/*UNKNOWN, REALTEK_90, REALTEK_92SE, BROADCOM,*/ +/*RALINK, ATHEROS, CISCO, MERU, MARVELL, 92U_AP, SELF_AP */ +{ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b}; + +void rtw_hal_turbo_edca(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + struct recv_priv *precvpriv = &(adapter->recvpriv); + struct registry_priv *pregpriv = &adapter->registrypriv; + struct mlme_ext_priv *pmlmeext = &(adapter->mlmeextpriv); + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + /* Parameter suggested by Scott */ +#if 0 + u32 EDCA_BE_UL = edca_setting_UL[p_mgnt_info->iot_peer]; + u32 EDCA_BE_DL = edca_setting_DL[p_mgnt_info->iot_peer]; +#endif + u32 EDCA_BE_UL = 0x5ea42b; + u32 EDCA_BE_DL = 0x00a42b; + u8 ic_type = rtw_get_chip_type(adapter); + + u8 iot_peer = 0; + u8 wireless_mode = 0xFF; /* invalid value */ + u8 traffic_index; + u32 edca_param; + u64 cur_tx_bytes = 0; + u64 cur_rx_bytes = 0; + u8 bbtchange = _TRUE; + u8 is_bias_on_rx = _FALSE; + u8 is_linked = _FALSE; + u8 interface_type; + + if (hal_data->dis_turboedca) + return; + + if (rtw_mi_check_status(adapter, MI_ASSOC)) + is_linked = _TRUE; + + if (is_linked != _TRUE) { + precvpriv->is_any_non_be_pkts = _FALSE; + return; + } + + if ((pregpriv->wifi_spec == 1)) { /* || (pmlmeinfo->HT_enable == 0)) */ + precvpriv->is_any_non_be_pkts = _FALSE; + return; + } + + interface_type = rtw_get_intf_type(adapter); + wireless_mode = pmlmeext->cur_wireless_mode; + + iot_peer = pmlmeinfo->assoc_AP_vendor; + + if (iot_peer >= HT_IOT_PEER_MAX) { + precvpriv->is_any_non_be_pkts = _FALSE; + return; + } + + if (ic_type == RTL8188E) { + if ((iot_peer == HT_IOT_PEER_RALINK) || (iot_peer == HT_IOT_PEER_ATHEROS)) + is_bias_on_rx = _TRUE; + } + + /* Check if the status needs to be changed. */ + if ((bbtchange) || (!precvpriv->is_any_non_be_pkts)) { + cur_tx_bytes = dvobj->traffic_stat.cur_tx_bytes; + cur_rx_bytes = dvobj->traffic_stat.cur_rx_bytes; + + /* traffic, TX or RX */ + if (is_bias_on_rx) { + if (cur_tx_bytes > (cur_rx_bytes << 2)) { + /* Uplink TP is present. */ + traffic_index = UP_LINK; + } else { + /* Balance TP is present. */ + traffic_index = DOWN_LINK; + } + } else { + if (cur_rx_bytes > (cur_tx_bytes << 2)) { + /* Downlink TP is present. */ + traffic_index = DOWN_LINK; + } else { + /* Balance TP is present. */ + traffic_index = UP_LINK; + } + } +#if 0 + if ((p_dm_odm->dm_edca_table.prv_traffic_idx != traffic_index) + || (!p_dm_odm->dm_edca_table.is_current_turbo_edca)) +#endif + { + if (interface_type == RTW_PCIE) { + EDCA_BE_UL = 0x6ea42b; + EDCA_BE_DL = 0x6ea42b; + } + + /* 92D txop can't be set to 0x3e for cisco1250 */ + if ((iot_peer == HT_IOT_PEER_CISCO) && (wireless_mode == ODM_WM_N24G)) { + EDCA_BE_DL = edca_setting_DL[iot_peer]; + EDCA_BE_UL = edca_setting_UL[iot_peer]; + } + /* merge from 92s_92c_merge temp*/ + else if ((iot_peer == HT_IOT_PEER_CISCO) && ((wireless_mode == ODM_WM_G) || (wireless_mode == (ODM_WM_B | ODM_WM_G)) || (wireless_mode == ODM_WM_A) || (wireless_mode == ODM_WM_B))) + EDCA_BE_DL = edca_setting_dl_g_mode[iot_peer]; + else if ((iot_peer == HT_IOT_PEER_AIRGO) && ((wireless_mode == ODM_WM_G) || (wireless_mode == ODM_WM_A))) + EDCA_BE_DL = 0xa630; + else if (iot_peer == HT_IOT_PEER_MARVELL) { + EDCA_BE_DL = edca_setting_DL[iot_peer]; + EDCA_BE_UL = edca_setting_UL[iot_peer]; + } else if (iot_peer == HT_IOT_PEER_ATHEROS) { + /* Set DL EDCA for Atheros peer to 0x3ea42b.*/ + /* Suggested by SD3 Wilson for ASUS TP issue.*/ + EDCA_BE_DL = edca_setting_DL[iot_peer]; + } + + if ((ic_type == RTL8812) || (ic_type == RTL8821) || (ic_type == RTL8192E)) { /* add 8812AU/8812AE */ + EDCA_BE_UL = 0x5ea42b; + EDCA_BE_DL = 0x5ea42b; + + RTW_DBG("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x\n", EDCA_BE_UL, EDCA_BE_DL); + } + + if (interface_type == RTW_PCIE && + ((ic_type == RTL8822B) + || (ic_type == RTL8814A))) { + EDCA_BE_UL = 0x6ea42b; + EDCA_BE_DL = 0x6ea42b; + } + + if (traffic_index == DOWN_LINK) + edca_param = EDCA_BE_DL; + else + edca_param = EDCA_BE_UL; +#ifdef CONFIG_RTW_CUSTOMIZE_BEEDCA + edca_param = CONFIG_RTW_CUSTOMIZE_BEEDCA; +#endif + rtw_hal_set_hwreg(adapter, HW_VAR_AC_PARAM_BE, (u8 *)(&edca_param)); + + RTW_DBG("Turbo EDCA =0x%x\n", edca_param); + + hal_data->prv_traffic_idx = traffic_index; + } + + hal_data->is_turbo_edca = _TRUE; + } else { + /* */ + /* Turn Off EDCA turbo here. */ + /* Restore original EDCA according to the declaration of AP. */ + /* */ + if (hal_data->is_turbo_edca) { + edca_param = hal_data->ac_param_be; + rtw_hal_set_hwreg(adapter, HW_VAR_AC_PARAM_BE, (u8 *)(&edca_param)); + hal_data->is_turbo_edca = _FALSE; + } + } + +} + +s8 rtw_phydm_get_min_rssi(_adapter *adapter) +{ + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); + s8 rssi_min = 0; + + rssi_min = phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_RSSI_MIN); + return rssi_min; +} + +u8 rtw_phydm_get_cur_igi(_adapter *adapter) +{ + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); + u8 cur_igi = 0; + + cur_igi = phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CURR_IGI); + return cur_igi; +} + +u32 rtw_phydm_get_phy_cnt(_adapter *adapter, enum phy_cnt cnt) +{ + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); + + if (cnt == FA_OFDM) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_FA_OFDM); + else if (cnt == FA_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_FA_CCK); + else if (cnt == FA_TOTAL) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_FA_TOTAL); + else if (cnt == CCA_OFDM) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CCA_OFDM); + else if (cnt == CCA_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CCA_CCK); + else if (cnt == CCA_ALL) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CCA_ALL); + else if (cnt == CRC32_OK_VHT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_OK_VHT); + else if (cnt == CRC32_OK_HT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_OK_HT); + else if (cnt == CRC32_OK_LEGACY) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_OK_LEGACY); + else if (cnt == CRC32_OK_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_OK_CCK); + else if (cnt == CRC32_ERROR_VHT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_ERROR_VHT); + else if (cnt == CRC32_ERROR_HT) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_ERROR_HT); + else if (cnt == CRC32_ERROR_LEGACY) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_ERROR_LEGACY); + else if (cnt == CRC32_ERROR_CCK) + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CRC32_ERROR_CCK); + else + return 0; +} + +u8 rtw_phydm_is_iqk_in_progress(_adapter *adapter) +{ + u8 rts = _FALSE; + struct PHY_DM_STRUCT *podmpriv = adapter_to_phydm(adapter); + + odm_acquire_spin_lock(podmpriv, RT_IQK_SPINLOCK); + if (podmpriv->rf_calibrate_info.is_iqk_in_progress == _TRUE) { + RTW_ERR("IQK InProgress\n"); + rts = _TRUE; + } + odm_release_spin_lock(podmpriv, RT_IQK_SPINLOCK); + + return rts; +} + +void SetHalODMVar( + PADAPTER Adapter, + HAL_ODM_VARIABLE eVariable, + PVOID pValue1, + BOOLEAN bSet) +{ + struct PHY_DM_STRUCT *podmpriv = adapter_to_phydm(Adapter); + /* _irqL irqL; */ + switch (eVariable) { + case HAL_ODM_STA_INFO: { + struct sta_info *psta = (struct sta_info *)pValue1; + + if (bSet) { + RTW_INFO("### Set STA_(%d) info ###\n", psta->cmn.mac_id); + odm_cmn_info_ptr_array_hook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->cmn.mac_id, psta); + psta->cmn.dm_ctrl = STA_DM_CTRL_ACTIVE; + phydm_cmn_sta_info_hook(podmpriv, psta->cmn.mac_id, &(psta->cmn)); + } else { + RTW_INFO("### Clean STA_(%d) info ###\n", psta->cmn.mac_id); + /* _enter_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ + psta->cmn.dm_ctrl = 0; + odm_cmn_info_ptr_array_hook(podmpriv, ODM_CMNINFO_STA_STATUS, psta->cmn.mac_id, NULL); + phydm_cmn_sta_info_hook(podmpriv, psta->cmn.mac_id, NULL); + + /* _exit_critical_bh(&pHalData->odm_stainfo_lock, &irqL); */ + } + } + break; + case HAL_ODM_P2P_STATE: + odm_cmn_info_update(podmpriv, ODM_CMNINFO_WIFI_DIRECT, bSet); + break; + case HAL_ODM_WIFI_DISPLAY_STATE: + odm_cmn_info_update(podmpriv, ODM_CMNINFO_WIFI_DISPLAY, bSet); + break; + case HAL_ODM_REGULATION: + /* used to auto enable/disable adaptivity by SD7 */ + odm_cmn_info_init(podmpriv, ODM_CMNINFO_DOMAIN_CODE_2G, 0); + odm_cmn_info_init(podmpriv, ODM_CMNINFO_DOMAIN_CODE_5G, 0); + break; + case HAL_ODM_INITIAL_GAIN: { + u8 rx_gain = *((u8 *)(pValue1)); + /*printk("rx_gain:%x\n",rx_gain);*/ + if (rx_gain == 0xff) {/*restore rx gain*/ + /*odm_write_dig(podmpriv,pDigTable->backup_ig_value);*/ + odm_pause_dig(podmpriv, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, rx_gain); + } else { + /*pDigTable->backup_ig_value = pDigTable->cur_ig_value;*/ + /*odm_write_dig(podmpriv,rx_gain);*/ + odm_pause_dig(podmpriv, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, rx_gain); + } + } + break; + case HAL_ODM_RX_INFO_DUMP: { + u8 cur_igi = 0; + s8 rssi_min; + void *sel; + + sel = pValue1; + cur_igi = rtw_phydm_get_cur_igi(Adapter); + rssi_min = rtw_phydm_get_min_rssi(Adapter); + + _RTW_PRINT_SEL(sel, "============ Rx Info dump ===================\n"); + _RTW_PRINT_SEL(sel, "is_linked = %d, rssi_min = %d(%%), current_igi = 0x%x\n", podmpriv->is_linked, rssi_min, cur_igi); + _RTW_PRINT_SEL(sel, "cnt_cck_fail = %d, cnt_ofdm_fail = %d, Total False Alarm = %d\n", + rtw_phydm_get_phy_cnt(Adapter, FA_CCK), + rtw_phydm_get_phy_cnt(Adapter, FA_OFDM), + rtw_phydm_get_phy_cnt(Adapter, FA_TOTAL)); + + if (podmpriv->is_linked) { + _RTW_PRINT_SEL(sel, "rx_rate = %s", HDATA_RATE(podmpriv->rx_rate)); + if (IS_HARDWARE_TYPE_8814A(Adapter)) + _RTW_PRINT_SEL(sel, " RSSI_A = %d(%%), RSSI_B = %d(%%), RSSI_C = %d(%%), RSSI_D = %d(%%)\n", + podmpriv->RSSI_A, podmpriv->RSSI_B, podmpriv->RSSI_C, podmpriv->RSSI_D); + else + _RTW_PRINT_SEL(sel, " RSSI_A = %d(%%), RSSI_B = %d(%%)\n", podmpriv->RSSI_A, podmpriv->RSSI_B); +#ifdef DBG_RX_SIGNAL_DISPLAY_RAW_DATA + rtw_dump_raw_rssi_info(Adapter, sel); +#endif + } + } + break; + case HAL_ODM_RX_Dframe_INFO: { + void *sel; + + sel = pValue1; + + /*_RTW_PRINT_SEL(sel , "HAL_ODM_RX_Dframe_INFO\n");*/ +#ifdef DBG_RX_DFRAME_RAW_DATA + rtw_dump_rx_dframe_info(Adapter, sel); +#endif + } + break; + +#ifdef CONFIG_ANTENNA_DIVERSITY + case HAL_ODM_ANTDIV_SELECT: { + u8 antenna = (*(u8 *)pValue1); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); + /*switch antenna*/ + odm_update_rx_idle_ant(&pHalData->odmpriv, antenna); + /*RTW_INFO("==> HAL_ODM_ANTDIV_SELECT, Ant_(%s)\n", (antenna == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT");*/ + + } + break; +#endif + + default: + break; + } +} + +void GetHalODMVar( + PADAPTER Adapter, + HAL_ODM_VARIABLE eVariable, + PVOID pValue1, + PVOID pValue2) +{ + struct PHY_DM_STRUCT *podmpriv = adapter_to_phydm(Adapter); + + switch (eVariable) { +#ifdef CONFIG_ANTENNA_DIVERSITY + case HAL_ODM_ANTDIV_SELECT: { + struct phydm_fat_struct *pDM_FatTable = &podmpriv->dm_fat_table; + *((u8 *)pValue1) = pDM_FatTable->rx_idle_ant; + } + break; +#endif + case HAL_ODM_INITIAL_GAIN: + *((u8 *)pValue1) = rtw_phydm_get_cur_igi(Adapter); + break; + default: + break; + } +} + +#ifdef RTW_HALMAC +#include "../hal_halmac.h" +#endif + +enum hal_status +rtw_phydm_fw_iqk( + struct PHY_DM_STRUCT *p_dm_odm, + u8 clear, + u8 segment +) +{ + #ifdef RTW_HALMAC + struct _ADAPTER *adapter = p_dm_odm->adapter; + + if (rtw_halmac_iqk(adapter_to_dvobj(adapter), clear, segment) == 0) + return HAL_STATUS_SUCCESS; + #endif + return HAL_STATUS_FAILURE; +} + +enum hal_status +rtw_phydm_cfg_phy_para( + struct PHY_DM_STRUCT *p_dm_odm, + enum phydm_halmac_param config_type, + u32 offset, + u32 data, + u32 mask, + enum rf_path e_rf_path, + u32 delay_time) +{ + #ifdef RTW_HALMAC + struct _ADAPTER *adapter = p_dm_odm->adapter; + struct rtw_phy_parameter para; + + switch (config_type) { + case PHYDM_HALMAC_CMD_MAC_W8: + para.cmd = 0; /* MAC register */ + para.data.mac.offset = offset; + para.data.mac.value = data; + para.data.mac.msk = mask; + para.data.mac.msk_en = 1; + para.data.mac.size = 1; + break; + case PHYDM_HALMAC_CMD_MAC_W16: + para.cmd = 0; /* MAC register */ + para.data.mac.offset = offset; + para.data.mac.value = data; + para.data.mac.msk = mask; + para.data.mac.msk_en = 1; + para.data.mac.size = 2; + break; + case PHYDM_HALMAC_CMD_MAC_W32: + para.cmd = 0; /* MAC register */ + para.data.mac.offset = offset; + para.data.mac.value = data; + para.data.mac.msk = mask; + para.data.mac.msk_en = 1; + para.data.mac.size = 4; + break; + case PHYDM_HALMAC_CMD_BB_W8: + para.cmd = 1; /* BB register */ + para.data.bb.offset = offset; + para.data.bb.value = data; + para.data.bb.msk = mask; + para.data.bb.msk_en = 1; + para.data.bb.size = 1; + break; + case PHYDM_HALMAC_CMD_BB_W16: + para.cmd = 1; /* BB register */ + para.data.bb.offset = offset; + para.data.bb.value = data; + para.data.bb.msk = mask; + para.data.bb.msk_en = 1; + para.data.bb.size = 2; + break; + case PHYDM_HALMAC_CMD_BB_W32: + para.cmd = 1; /* BB register */ + para.data.bb.offset = offset; + para.data.bb.value = data; + para.data.bb.msk = mask; + para.data.bb.msk_en = 1; + para.data.bb.size = 4; + break; + case PHYDM_HALMAC_CMD_RF_W: + para.cmd = 2; /* RF register */ + para.data.rf.offset = offset; + para.data.rf.value = data; + para.data.rf.msk = mask; + para.data.rf.msk_en = 1; + if (e_rf_path == RF_PATH_A) + para.data.rf.path = 0; + else if (e_rf_path == RF_PATH_B) + para.data.rf.path = 1; + else if (e_rf_path == RF_PATH_C) + para.data.rf.path = 2; + else if (e_rf_path == RF_PATH_D) + para.data.rf.path = 3; + else + para.data.rf.path = 0; + break; + case PHYDM_HALMAC_CMD_DELAY_US: + para.cmd = 3; /* Delay */ + para.data.delay.unit = 0; /* microsecond */ + para.data.delay.value = delay_time; + break; + case PHYDM_HALMAC_CMD_DELAY_MS: + para.cmd = 3; /* Delay */ + para.data.delay.unit = 1; /* millisecond */ + para.data.delay.value = delay_time; + break; + case PHYDM_HALMAC_CMD_END: + para.cmd = 0xFF; /* End command */ + break; + default: + return HAL_STATUS_FAILURE; + } + + if (rtw_halmac_cfg_phy_para(adapter_to_dvobj(adapter), ¶)) + return HAL_STATUS_FAILURE; + #endif /*RTW_HALMAC*/ + return HAL_STATUS_SUCCESS; +} + + +#ifdef CONFIG_LPS_LCLK_WD_TIMER +void rtw_phydm_wd_lps_lclk_hdl(_adapter *adapter) +{ + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *podmpriv = &(pHalData->odmpriv); + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta = NULL; + u8 rssi_min = 0; + u32 rssi_rpt = 0; + bool is_linked = _FALSE; + + if (!rtw_is_hw_init_completed(adapter)) + return; + + if (rtw_mi_check_status(adapter, MI_ASSOC)) + is_linked = _TRUE; + + if (is_linked == _FALSE) + return; + + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + if (psta == NULL) + return; + + odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_LINK, is_linked); + + phydm_watchdog_lps_32k(&pHalData->odmpriv); +} + +void rtw_phydm_watchdog_in_lps_lclk(_adapter *adapter) +{ + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta = NULL; + u8 cur_igi = 0; + s8 min_rssi = 0; + + if (!rtw_is_hw_init_completed(adapter)) + return; + + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + if (psta == NULL) + return; + + cur_igi = rtw_phydm_get_cur_igi(adapter); + min_rssi = rtw_phydm_get_min_rssi(adapter); + if (min_rssi <= 0) + min_rssi = psta->cmn.rssi_stat.rssi; + /*RTW_INFO("%s "ADPT_FMT" cur_ig_value=%d, min_rssi = %d\n", __func__, ADPT_ARG(adapter), cur_igi, min_rssi);*/ + + if (min_rssi <= 0) + return; + + if ((cur_igi > min_rssi + 5) || + (cur_igi < min_rssi - 5)) { +#ifdef CONFIG_LPS + rtw_dm_in_lps_wk_cmd(adapter); +#endif + } +} +#endif /*CONFIG_LPS_LCLK_WD_TIMER*/ + +void dump_sta_traffic(void *sel, _adapter *adapter, struct sta_info *psta) +{ + struct ra_sta_info *ra_info; + u8 curr_sgi = _FALSE; + + if (!psta) + return; + RTW_PRINT_SEL(sel, "====== mac_id : %d ======\n", psta->cmn.mac_id); + + ra_info = &psta->cmn.ra_info; + curr_sgi = (ra_info->curr_tx_rate & 0x80) ? _TRUE : _FALSE; + RTW_PRINT_SEL(sel, "tx_rate : %s(%s) rx_rate : %s, rx_rate_bmc : %s, rssi : %d %%\n" + , HDATA_RATE((ra_info->curr_tx_rate & 0x7F)), (curr_sgi) ? "S" : "L" + , HDATA_RATE((psta->curr_rx_rate & 0x7F)), HDATA_RATE((psta->curr_rx_rate_bmc & 0x7F)), psta->cmn.rssi_stat.rssi + ); + + if (0) { + RTW_PRINT_SEL(sel, "tx_bytes:%llu(%llu - %llu)\n" + , psta->sta_stats.tx_bytes - psta->sta_stats.last_tx_bytes + , psta->sta_stats.tx_bytes, psta->sta_stats.last_tx_bytes + ); + RTW_PRINT_SEL(sel, "rx_uc_bytes:%llu(%llu - %llu)\n" + , sta_rx_uc_bytes(psta) - sta_last_rx_uc_bytes(psta) + , sta_rx_uc_bytes(psta), sta_last_rx_uc_bytes(psta) + ); + RTW_PRINT_SEL(sel, "rx_mc_bytes:%llu(%llu - %llu)\n" + , psta->sta_stats.rx_mc_bytes - psta->sta_stats.last_rx_mc_bytes + , psta->sta_stats.rx_mc_bytes, psta->sta_stats.last_rx_mc_bytes + ); + RTW_PRINT_SEL(sel, "rx_bc_bytes:%llu(%llu - %llu)\n" + , psta->sta_stats.rx_bc_bytes - psta->sta_stats.last_rx_bc_bytes + , psta->sta_stats.rx_bc_bytes, psta->sta_stats.last_rx_bc_bytes + ); + } + + RTW_PRINT_SEL(sel, "TP {Tx,Rx,Total} = { %d , %d , %d } Mbps\n", + (psta->sta_stats.tx_tp_mbytes << 3), (psta->sta_stats.rx_tp_mbytes << 3), + (psta->sta_stats.tx_tp_mbytes + psta->sta_stats.rx_tp_mbytes) << 3); + + RTW_PRINT_SEL(sel, "Moving-AVG TP {Tx,Rx,Total} = { %d , %d , %d } Mbps\n\n", + (psta->cmn.tx_moving_average_tp << 3), (psta->cmn.rx_moving_average_tp << 3), + (psta->cmn.tx_moving_average_tp + psta->cmn.rx_moving_average_tp) << 3); + +} + +void dump_sta_info(void *sel, struct sta_info *psta) +{ + struct ra_sta_info *ra_info; + u8 curr_tx_sgi = _FALSE; + u8 curr_tx_rate = 0; + + if (!psta) + return; + + ra_info = &psta->cmn.ra_info; + + RTW_PRINT_SEL(sel, "============ STA [" MAC_FMT "] ===================\n", + MAC_ARG(psta->cmn.mac_addr)); + RTW_PRINT_SEL(sel, "mac_id : %d\n", psta->cmn.mac_id); + RTW_PRINT_SEL(sel, "wireless_mode : 0x%02x\n", psta->wireless_mode); + RTW_PRINT_SEL(sel, "mimo_type : %d\n", psta->cmn.mimo_type); + RTW_PRINT_SEL(sel, "bw_mode : %s, ra_bw_mode : %s\n", + ch_width_str(psta->cmn.bw_mode), ch_width_str(ra_info->ra_bw_mode)); + RTW_PRINT_SEL(sel, "rate_id : %d\n", ra_info->rate_id); + RTW_PRINT_SEL(sel, "rssi : %d (%%), rssi_level : %d\n", psta->cmn.rssi_stat.rssi, ra_info->rssi_level); + RTW_PRINT_SEL(sel, "is_support_sgi : %s, is_vht_enable : %s\n", + (ra_info->is_support_sgi) ? "Y" : "N", (ra_info->is_vht_enable) ? "Y" : "N"); + RTW_PRINT_SEL(sel, "disable_ra : %s, disable_pt : %s\n", + (ra_info->disable_ra) ? "Y" : "N", (ra_info->disable_pt) ? "Y" : "N"); + RTW_PRINT_SEL(sel, "is_noisy : %s\n", (ra_info->is_noisy) ? "Y" : "N"); + RTW_PRINT_SEL(sel, "txrx_state : %d\n", ra_info->txrx_state);/*0: uplink, 1:downlink, 2:bi-direction*/ + + curr_tx_sgi = (ra_info->curr_tx_rate & 0x80) ? _TRUE : _FALSE; + curr_tx_rate = ra_info->curr_tx_rate & 0x7F; + RTW_PRINT_SEL(sel, "curr_tx_rate : %s (%s)\n", + HDATA_RATE(curr_tx_rate), (curr_tx_sgi) ? "S" : "L"); + RTW_PRINT_SEL(sel, "curr_tx_bw : %s\n", ch_width_str(ra_info->curr_tx_bw)); + RTW_PRINT_SEL(sel, "curr_retry_ratio : %d\n", ra_info->curr_retry_ratio); + RTW_PRINT_SEL(sel, "ra_mask : 0x%016llx\n\n", ra_info->ramask); +} + +void rtw_phydm_ra_registed(_adapter *adapter, struct sta_info *psta) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + + if (psta == NULL) { + RTW_ERR(FUNC_ADPT_FMT" sta is NULL\n", FUNC_ADPT_ARG(adapter)); + rtw_warn_on(1); + return; + } + + phydm_ra_registed(&hal_data->odmpriv, psta->cmn.mac_id, psta->cmn.rssi_stat.rssi); + if (_DRV_DEBUG_ <= rtw_drv_log_level) + dump_sta_info(RTW_DBGDUMP, psta); +} + +#ifdef CONFIG_LPS_PG +static void _lps_pg_state_update(_adapter *adapter) +{ + u8 is_in_lpspg = _FALSE; + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(adapter); + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); + struct mlme_priv *pmlmepriv = &adapter->mlmepriv; + struct sta_priv *pstapriv = &adapter->stapriv; + struct sta_info *psta = NULL; + + if ((pwrpriv->lps_level == LPS_PG) && (pwrpriv->pwr_mode != PS_MODE_ACTIVE) && (pwrpriv->rpwm <= PS_STATE_S2)) + is_in_lpspg = _TRUE; + psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); + + if (psta) + psta->cmn.ra_info.disable_ra = (is_in_lpspg) ? _TRUE : _FALSE; +} +#endif + +/*#define DBG_PHYDM_STATE_CHK*/ + + +static u8 _rtw_phydm_rfk_condition_check(_adapter *adapter) +{ + u8 rst = _FALSE; + + if (rtw_mi_stayin_union_ch_chk(adapter)) + rst = _TRUE; + + #ifdef CONFIG_MCC_MODE + /*not in MCC State*/ + if (MCC_EN(adapter)) + if (!rtw_hal_check_mcc_status(adapter, MCC_STATUS_DOING_MCC)) + rst = _TRUE; + #endif + + #if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) + + #endif + + return rst; +} +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1)) +static u8 _rtw_phydm_iqk_segment_chk(_adapter *adapter) +{ + u8 rst = _FALSE; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + +#if 0 + if (dvobj->traffic_stat.cur_tx_tp > 2 || dvobj->traffic_stat.cur_rx_tp > 2) + rst = _TRUE; +#else + rst = _TRUE; +#endif + return rst; +} +#endif + +/*check the tx low rate while unlinked to any AP;for pwr tracking */ +static u8 _rtw_phydm_pwr_tracking_rate_check(_adapter *adapter) +{ + int i; + _adapter *iface; + u8 if_tx_rate = 0xFF; + u8 tx_rate = 0xFF; + struct mlme_ext_priv *pmlmeext = NULL; + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + pmlmeext = &(iface->mlmeextpriv); + if ((iface) && rtw_is_adapter_up(iface)) { +#ifdef CONFIG_P2P + if (!rtw_p2p_chk_role(&(iface)->wdinfo, P2P_ROLE_DISABLE)) + if_tx_rate = IEEE80211_OFDM_RATE_6MB; + else +#endif + if_tx_rate = pmlmeext->tx_rate; + if(if_tx_rate < tx_rate) + tx_rate = if_tx_rate; + + RTW_DBG("%s i=%d tx_rate =0x%x\n", __func__, i, if_tx_rate); + } + } + RTW_DBG("%s tx_low_rate (unlinked to any AP)=0x%x\n", __func__, tx_rate); + return tx_rate; +} + +void rtw_phydm_watchdog(_adapter *adapter) +{ + u8 bLinked = _FALSE; + u8 bsta_state = _FALSE; + u8 bBtDisabled = _TRUE; + u8 rfk_forbidden = _TRUE; + u8 segment_iqk = _TRUE; + u8 tx_unlinked_low_rate = 0xFF; + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(adapter); + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(adapter); + + if (!rtw_is_hw_init_completed(adapter)) { + RTW_DBG("%s skip due to hw_init_completed == FALSE\n", __func__); + return; + } + if (rtw_mi_check_fwstate(adapter, _FW_UNDER_SURVEY)) + pHalData->bScanInProcess = _TRUE; + else + pHalData->bScanInProcess = _FALSE; + + if (rtw_mi_check_status(adapter, MI_ASSOC)) { + bLinked = _TRUE; + if (rtw_mi_check_status(adapter, MI_STA_LINKED)) + bsta_state = _TRUE; + } + + odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_LINK, bLinked); + odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_STATION_STATE, bsta_state); + +#ifdef CONFIG_BT_COEXIST + bBtDisabled = rtw_btcoex_IsBtDisabled(adapter); +#endif /* CONFIG_BT_COEXIST */ + odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, + (bBtDisabled == _TRUE) ? _FALSE : _TRUE); + odm_cmn_info_update(&pHalData->odmpriv, ODM_CMNINFO_POWER_TRAINING, + (pHalData->bDisableTXPowerTraining) ? _TRUE : _FALSE); +#ifdef CONFIG_LPS_PG + _lps_pg_state_update(adapter); +#endif + + if (bLinked == _TRUE) { + rfk_forbidden = (_rtw_phydm_rfk_condition_check(adapter) == _TRUE) ? _FALSE : _TRUE; + halrf_cmn_info_set(&pHalData->odmpriv, HALRF_CMNINFO_RFK_FORBIDDEN, rfk_forbidden); + + #if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1)) + segment_iqk = _rtw_phydm_iqk_segment_chk(adapter); + halrf_cmn_info_set(&pHalData->odmpriv, HALRF_CMNINFO_IQK_SEGMENT, segment_iqk); + #endif + } else { + tx_unlinked_low_rate = _rtw_phydm_pwr_tracking_rate_check(adapter); + halrf_cmn_info_set(&pHalData->odmpriv, HALRF_CMNINFO_RATE_INDEX, tx_unlinked_low_rate); + } +#ifdef DBG_PHYDM_STATE_CHK + RTW_INFO("%s rfk_forbidden = %s, segment_iqk = %s\n", + __func__, (rfk_forbidden) ? "Y" : "N", (segment_iqk) ? "Y" : "N"); +#endif + + /*if (!rtw_mi_stayin_union_band_chk(adapter)) { + #ifdef DBG_PHYDM_STATE_CHK + RTW_ERR("Not stay in union band, skip phydm\n"); + #endif + goto _exit; + }*/ + if (pwrctl->bpower_saving) + phydm_watchdog_lps(&pHalData->odmpriv); + else + phydm_watchdog(&pHalData->odmpriv); + + #ifdef CONFIG_RTW_ACS + rtw_acs_update_current_info(adapter); + #endif + +_exit: + return; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.h index 1232708fc49b..93ed020a136c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,15 +11,70 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_DM_H__ #define __HAL_DM_H__ +#define adapter_to_phydm(adapter) (&(GET_HAL_DATA(adapter)->odmpriv)) + void Init_ODM_ComInfo(_adapter *adapter); +void rtw_hal_turbo_edca(_adapter *adapter); +u8 rtw_phydm_is_iqk_in_progress(_adapter *adapter); + +void GetHalODMVar( + PADAPTER Adapter, + HAL_ODM_VARIABLE eVariable, + PVOID pValue1, + PVOID pValue2); +void SetHalODMVar( + PADAPTER Adapter, + HAL_ODM_VARIABLE eVariable, + PVOID pValue1, + BOOLEAN bSet); + +void rtw_phydm_ra_registed(_adapter *adapter, struct sta_info *psta); + +void rtw_phydm_watchdog(_adapter *adapter); + +void rtw_hal_update_iqk_fw_offload_cap(_adapter *adapter); +void dump_sta_info(void *sel, struct sta_info *psta); +void dump_sta_traffic(void *sel, _adapter *adapter, struct sta_info *psta); + +#ifdef CONFIG_DBG_RF_CAL +void rtw_hal_iqk_test(_adapter *adapter, bool recovery, bool clear, bool segment); +void rtw_hal_lck_test(_adapter *adapter); +#endif + +s8 rtw_phydm_get_min_rssi(_adapter *adapter); +u8 rtw_phydm_get_cur_igi(_adapter *adapter); + + +#ifdef CONFIG_LPS_LCLK_WD_TIMER +extern void phydm_rssi_monitor_check(void *p_dm_void); + +void rtw_phydm_wd_lps_lclk_hdl(_adapter *adapter); +void rtw_phydm_watchdog_in_lps_lclk(_adapter *adapter); +#endif + +enum phy_cnt { + FA_OFDM, + FA_CCK, + FA_TOTAL, + CCA_OFDM, + CCA_CCK, + CCA_ALL, + CRC32_OK_VHT, + CRC32_OK_HT, + CRC32_OK_LEGACY, + CRC32_OK_CCK, + CRC32_ERROR_VHT, + CRC32_ERROR_HT, + CRC32_ERROR_LEGACY, + CRC32_ERROR_CCK, +}; +u32 rtw_phydm_get_phy_cnt(_adapter *adapter, enum phy_cnt cnt); +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8814B_SUPPORT == 1)) +void rtw_phydm_iqk_trigger(_adapter *adapter); +#endif #endif /* __HAL_DM_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.c new file mode 100644 index 000000000000..465bd1a769cf --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.c @@ -0,0 +1,459 @@ +/****************************************************************************** + * + * Copyright(c) 2014 - 2017 Realtek Corporation. + * + * 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 +#include + + +#if defined(CONFIG_RTW_ACS) || defined(CONFIG_BACKGROUND_NOISE_MONITOR) +static void _rtw_bss_nums_count(_adapter *adapter, u8 *pbss_nums) +{ + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + _queue *queue = &(pmlmepriv->scanned_queue); + struct wlan_network *pnetwork = NULL; + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + + _list *plist, *phead; + _irqL irqL; + int chan_idx = -1; + + if (pbss_nums == NULL) { + RTW_ERR("%s pbss_nums is null pointer\n", __func__); + return; + } + _rtw_memset(pbss_nums, 0, MAX_CHANNEL_NUM); + + _enter_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); + phead = get_list_head(queue); + plist = get_next(phead); + while (1) { + if (rtw_end_of_queue_search(phead, plist) == _TRUE) + break; + + pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); + if (!pnetwork) + break; + chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), pnetwork->network.Configuration.DSConfig); + if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { + RTW_ERR("%s can't get chan_idx(CH:%d)\n", + __func__, pnetwork->network.Configuration.DSConfig); + chan_idx = 0; + } + /*if (pnetwork->network.Reserved[0] != BSS_TYPE_PROB_REQ)*/ + + pbss_nums[chan_idx]++; + + plist = get_next(plist); + } + _exit_critical_bh(&(pmlmepriv->scanned_queue.lock), &irqL); +} + +u8 rtw_get_ch_num_by_idx(_adapter *adapter, u8 idx) +{ + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + RT_CHANNEL_INFO *pch_set = rfctl->channel_set; + u8 max_chan_nums = rfctl->max_chan_nums; + + if (idx >= max_chan_nums) + return 0; + return pch_set[idx].ChannelNum; +} +#endif /*defined(CONFIG_RTW_ACS) || defined(CONFIG_BACKGROUND_NOISE_MONITOR)*/ + + +#ifdef CONFIG_RTW_ACS +void rtw_acs_version_dump(void *sel, _adapter *adapter) +{ + _RTW_PRINT_SEL(sel, "RTK_ACS VER_%d\n", RTK_ACS_VERSION); +} +u8 rtw_phydm_clm_ratio(_adapter *adapter) +{ + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); + + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_CLM_RATIO); +} +u8 rtw_phydm_nhm_ratio(_adapter *adapter) +{ + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); + + return phydm_cmn_info_query(phydm, (enum phydm_info_query_e) PHYDM_INFO_NHM_RATIO); +} +void rtw_acs_reset(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct auto_chan_sel *pacs = &hal_data->acs; + + _rtw_memset(pacs, 0, sizeof(struct auto_chan_sel)); +} + +void rtw_acs_trigger(_adapter *adapter, u16 scan_time_ms, u8 scan_chan) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); + u16 sample_times = 0; + + hal_data->acs.trigger_ch = scan_chan; + /*scan_time - ms ,1ms can sample 250 times*/ + sample_times = scan_time_ms * 250; + phydm_ccx_monitor_trigger(phydm, sample_times); + + #ifdef CONFIG_RTW_ACS_DBG + RTW_INFO("[ACS] Trigger CH:%d, Times:%d\n", hal_data->acs.trigger_ch, sample_times); + #endif +} +void rtw_acs_get_rst(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *phydm = adapter_to_phydm(adapter); + int chan_idx = -1; + u8 cur_chan = hal_data->acs.trigger_ch; + + if (cur_chan == 0) + return; + + chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), cur_chan); + if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { + RTW_ERR("[ACS] %s can't get chan_idx(CH:%d)\n", __func__, cur_chan); + return; + } + + phydm_ccx_monitor_result(phydm); + + hal_data->acs.clm_ratio[chan_idx] = rtw_phydm_clm_ratio(adapter); + hal_data->acs.nhm_ratio[chan_idx] = rtw_phydm_nhm_ratio(adapter); + + #ifdef CONFIG_RTW_ACS_DBG + RTW_INFO("[ACS] Result CH:%d, CLM:%d NHM:%d\n", + cur_chan, hal_data->acs.clm_ratio[chan_idx], hal_data->acs.nhm_ratio[chan_idx]); + #endif +} + +void _rtw_phydm_acs_select_best_chan(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + u8 ch_idx; + u8 ch_idx_24g = 0xFF, ch_idx_5g = 0xFF; + u8 min_itf_24g = 0xFF, min_itf_5g = 0xFF; + u8 *pbss_nums = hal_data->acs.bss_nums; + u8 *pclm_ratio = hal_data->acs.clm_ratio; + u8 *pnhm_ratio = hal_data->acs.nhm_ratio; + u8 *pinterference_time = hal_data->acs.interference_time; + u8 max_chan_nums = rfctl->max_chan_nums; + + for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { + if (pbss_nums[ch_idx]) + pinterference_time[ch_idx] = (pclm_ratio[ch_idx] / 2) + pnhm_ratio[ch_idx]; + else + pinterference_time[ch_idx] = pclm_ratio[ch_idx] + pnhm_ratio[ch_idx]; + + if (rtw_get_ch_num_by_idx(adapter, ch_idx) < 14) { + if (pinterference_time[ch_idx] < min_itf_24g) { + min_itf_24g = pinterference_time[ch_idx]; + ch_idx_24g = ch_idx; + } + } else { + if (pinterference_time[ch_idx] < min_itf_5g) { + min_itf_5g = pinterference_time[ch_idx]; + ch_idx_5g = ch_idx; + } + } + } + if (ch_idx_24g != 0xFF) + hal_data->acs.best_chan_24g = rtw_get_ch_num_by_idx(adapter, ch_idx_24g); + + if (ch_idx_5g != 0xFF) + hal_data->acs.best_chan_5g = rtw_get_ch_num_by_idx(adapter, ch_idx_5g); + + hal_data->acs.trigger_ch = 0; +} + +void rtw_acs_info_dump(void *sel, _adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + u8 max_chan_nums = rfctl->max_chan_nums; + u8 ch_idx, ch_num; + + _RTW_PRINT_SEL(sel, "========== ACS (VER-%d) ==========\n", RTK_ACS_VERSION); + _RTW_PRINT_SEL(sel, "Best 24G Channel:%d\n", hal_data->acs.best_chan_24g); + _RTW_PRINT_SEL(sel, "Best 5G Channel:%d\n\n", hal_data->acs.best_chan_5g); + + #ifdef CONFIG_RTW_ACS_DBG + _RTW_PRINT_SEL(sel, "BW 20MHz\n"); + _RTW_PRINT_SEL(sel, "%5s %3s %3s %3s(%%) %3s(%%) %3s\n", + "Index", "CH", "BSS", "CLM", "NHM", "ITF"); + + for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { + ch_num = rtw_get_ch_num_by_idx(adapter, ch_idx); + _RTW_PRINT_SEL(sel, "%5d %3d %3d %6d %6d %3d\n", + ch_idx, ch_num, hal_data->acs.bss_nums[ch_idx], + hal_data->acs.clm_ratio[ch_idx], + hal_data->acs.nhm_ratio[ch_idx], + hal_data->acs.interference_time[ch_idx]); + } + #endif +} +void rtw_acs_select_best_chan(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + + _rtw_bss_nums_count(adapter, hal_data->acs.bss_nums); + _rtw_phydm_acs_select_best_chan(adapter); + rtw_acs_info_dump(RTW_DBGDUMP, adapter); +} + +void rtw_acs_start(_adapter *adapter) +{ + rtw_acs_reset(adapter); + if (GET_ACS_STATE(adapter) != ACS_ENABLE) + SET_ACS_STATE(adapter, ACS_ENABLE); +} +void rtw_acs_stop(_adapter *adapter) +{ + SET_ACS_STATE(adapter, ACS_DISABLE); +} + + +u8 rtw_acs_get_clm_ratio_by_ch_num(_adapter *adapter, u8 chan) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + int chan_idx = -1; + + chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); + if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { + RTW_ERR("[ACS] Get CLM fail, can't get chan_idx(CH:%d)\n", chan); + return 0; + } + + return hal_data->acs.clm_ratio[chan_idx]; +} +u8 rtw_acs_get_clm_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + + if (ch_idx >= MAX_CHANNEL_NUM) { + RTW_ERR("%s [ACS] ch_idx(%d) is invalid\n", __func__, ch_idx); + return 0; + } + + return hal_data->acs.clm_ratio[ch_idx]; +} +u8 rtw_acs_get_nhm_ratio_by_ch_num(_adapter *adapter, u8 chan) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + int chan_idx = -1; + + chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); + if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { + RTW_ERR("[ACS] Get NHM fail, can't get chan_idx(CH:%d)\n", chan); + return 0; + } + + return hal_data->acs.nhm_ratio[chan_idx]; +} +u8 rtw_acs_get_num_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + + if (ch_idx >= MAX_CHANNEL_NUM) { + RTW_ERR("%s [ACS] ch_idx(%d) is invalid\n", __func__, ch_idx); + return 0; + } + + return hal_data->acs.nhm_ratio[ch_idx]; +} +void rtw_acs_chan_info_dump(void *sel, _adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + u8 max_chan_nums = rfctl->max_chan_nums; + u8 ch_idx, ch_num; + u8 utilization; + + _RTW_PRINT_SEL(sel, "BW 20MHz\n"); + _RTW_PRINT_SEL(sel, "%5s %3s %7s(%%) %12s(%%) %11s(%%) %9s(%%) %8s(%%)\n", + "Index", "CH", "Quality", "Availability", "Utilization", + "WIFI Util", "Interference Util"); + + for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { + ch_num = rtw_get_ch_num_by_idx(adapter, ch_idx); + utilization = hal_data->acs.clm_ratio[ch_idx] + hal_data->acs.nhm_ratio[ch_idx]; + _RTW_PRINT_SEL(sel, "%5d %3d %7d %12d %12d %12d %12d\n", + ch_idx, ch_num, + (100-hal_data->acs.interference_time[ch_idx]), + (100-utilization), + utilization, + hal_data->acs.clm_ratio[ch_idx], + hal_data->acs.nhm_ratio[ch_idx]); + } +} +void rtw_acs_current_info_dump(void *sel, _adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + u8 ch, cen_ch, bw, offset; + + _RTW_PRINT_SEL(sel, "========== ACS (VER-%d) ==========\n", RTK_ACS_VERSION); + + ch = rtw_get_oper_ch(adapter); + bw = rtw_get_oper_bw(adapter); + offset = rtw_get_oper_choffset(adapter); + + _RTW_PRINT_SEL(sel, "Current Channel:%d\n", ch); + if ((bw == CHANNEL_WIDTH_80) ||(bw == CHANNEL_WIDTH_40)) { + cen_ch = rtw_get_center_ch(ch, bw, offset); + _RTW_PRINT_SEL(sel, "Center Channel:%d\n", cen_ch); + } + + _RTW_PRINT_SEL(sel, "Current BW %s\n", ch_width_str(bw)); + if (0) + _RTW_PRINT_SEL(sel, "Current IGI 0x%02x\n", rtw_phydm_get_cur_igi(adapter)); + _RTW_PRINT_SEL(sel, "CLM:%d, NHM:%d\n\n", + hal_data->acs.cur_ch_clm_ratio, hal_data->acs.cur_ch_nhm_ratio); +} + +void rtw_acs_update_current_info(_adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + + hal_data->acs.cur_ch_clm_ratio = rtw_phydm_clm_ratio(adapter); + hal_data->acs.cur_ch_nhm_ratio = rtw_phydm_nhm_ratio(adapter); + + #ifdef CONFIG_RTW_ACS_DBG + rtw_acs_current_info_dump(RTW_DBGDUMP, adapter); + #endif +} +#endif /*CONFIG_RTW_ACS*/ + +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR +void rtw_noise_monitor_version_dump(void *sel, _adapter *adapter) +{ + _RTW_PRINT_SEL(sel, "RTK_NOISE_MONITOR VER_%d\n", RTK_NOISE_MONITOR_VERSION); +} +void rtw_nm_enable(_adapter *adapter) +{ + SET_NM_STATE(adapter, NM_ENABLE); +} +void rtw_nm_disable(_adapter *adapter) +{ + SET_NM_STATE(adapter, NM_DISABLE); +} +void rtw_noise_info_dump(void *sel, _adapter *adapter) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + u8 max_chan_nums = rfctl->max_chan_nums; + u8 ch_idx, ch_num; + + _RTW_PRINT_SEL(sel, "========== NM (VER-%d) ==========\n", RTK_NOISE_MONITOR_VERSION); + + _RTW_PRINT_SEL(sel, "%5s %3s %3s %10s", "Index", "CH", "BSS", "Noise(dBm)\n"); + + _rtw_bss_nums_count(adapter, hal_data->nm.bss_nums); + + for (ch_idx = 0; ch_idx < max_chan_nums; ch_idx++) { + ch_num = rtw_get_ch_num_by_idx(adapter, ch_idx); + _RTW_PRINT_SEL(sel, "%5d %3d %3d %10d\n", + ch_idx, ch_num, hal_data->nm.bss_nums[ch_idx], + hal_data->nm.noise[ch_idx]); + } +} + +void rtw_noise_measure(_adapter *adapter, u8 chan, u8 is_pause_dig, u8 igi_value, u32 max_time) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *phydm = &hal_data->odmpriv; + int chan_idx = -1; + s16 noise = 0; + + #ifdef DBG_NOISE_MONITOR + RTW_INFO("[NM] chan(%d)-PauseDIG:%s, IGIValue:0x%02x, max_time:%d (ms)\n", + chan, (is_pause_dig) ? "Y" : "N", igi_value, max_time); + #endif + + chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); + if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { + RTW_ERR("[NM] Get noise fail, can't get chan_idx(CH:%d)\n", chan); + return; + } + noise = odm_inband_noise_monitor(phydm, is_pause_dig, igi_value, max_time); /*dBm*/ + + hal_data->nm.noise[chan_idx] = noise; + + #ifdef DBG_NOISE_MONITOR + RTW_INFO("[NM] %s chan_%d, noise = %d (dBm)\n", __func__, chan, hal_data->nm.noise[chan_idx]); + + RTW_INFO("[NM] noise_a = %d, noise_b = %d noise_all:%d\n", + phydm->noise_level.noise[RF_PATH_A], + phydm->noise_level.noise[RF_PATH_B], + phydm->noise_level.noise_all); + #endif /*DBG_NOISE_MONITOR*/ +} + +s16 rtw_noise_query_by_chan_num(_adapter *adapter, u8 chan) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + s16 noise = 0; + int chan_idx = -1; + + chan_idx = rtw_chset_search_ch(adapter_to_chset(adapter), chan); + if ((chan_idx == -1) || (chan_idx >= MAX_CHANNEL_NUM)) { + RTW_ERR("[NM] Get noise fail, can't get chan_idx(CH:%d)\n", chan); + return noise; + } + noise = hal_data->nm.noise[chan_idx]; + + #ifdef DBG_NOISE_MONITOR + RTW_INFO("[NM] %s chan_%d, noise = %d (dBm)\n", __func__, chan, noise); + #endif/*DBG_NOISE_MONITOR*/ + return noise; +} +s16 rtw_noise_query_by_chan_idx(_adapter *adapter, u8 ch_idx) +{ + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); + s16 noise = 0; + + if (ch_idx >= MAX_CHANNEL_NUM) { + RTW_ERR("[NM] %s ch_idx(%d) is invalid\n", __func__, ch_idx); + return noise; + } + noise = hal_data->nm.noise[ch_idx]; + + #ifdef DBG_NOISE_MONITOR + RTW_INFO("[NM] %s ch_idx %d, noise = %d (dBm)\n", __func__, ch_idx, noise); + #endif/*DBG_NOISE_MONITOR*/ + return noise; +} + +s16 rtw_noise_measure_curchan(_adapter *padapter) +{ + s16 noise = 0; + u8 igi_value = 0x1E; + u32 max_time = 100;/* ms */ + u8 is_pause_dig = _TRUE; + u8 cur_chan = rtw_get_oper_ch(padapter); + + if (rtw_linked_check(padapter) == _FALSE) + return noise; + + rtw_ps_deny(padapter, PS_DENY_IOCTL); + LeaveAllPowerSaveModeDirect(padapter); + rtw_noise_measure(padapter, cur_chan, is_pause_dig, igi_value, max_time); + noise = rtw_noise_query_by_chan_num(padapter, cur_chan); + rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); + + return noise; +} +#endif /*CONFIG_BACKGROUND_NOISE_MONITOR*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.h new file mode 100644 index 000000000000..63370a80b53e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_dm_acs.h @@ -0,0 +1,91 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HAL_DM_ACS_H__ +#define __HAL_DM_ACS_H__ +#ifdef CONFIG_RTW_ACS +#define RTK_ACS_VERSION 1 +void rtw_acs_version_dump(void *sel, _adapter *adapter); +extern void phydm_ccx_monitor_trigger(void *p_dm_void, u16 monitor_time); +extern void phydm_ccx_monitor_result(void *p_dm_void); + +#define GET_ACS_STATE(padapter) (ATOMIC_READ(&GET_HAL_DATA(padapter)->acs.state)) +#define SET_ACS_STATE(padapter, set_state) (ATOMIC_SET(&GET_HAL_DATA(padapter)->acs.state, set_state)) +#define IS_ACS_ENABLE(padapter) ((GET_ACS_STATE(padapter) == ACS_ENABLE) ? _TRUE : _FALSE) + +enum ACS_STATE { + ACS_DISABLE, + ACS_ENABLE, +}; + +struct auto_chan_sel { + ATOMIC_T state; + u8 trigger_ch; + u8 clm_ratio[MAX_CHANNEL_NUM]; + u8 nhm_ratio[MAX_CHANNEL_NUM]; + u8 bss_nums[MAX_CHANNEL_NUM]; + u8 interference_time[MAX_CHANNEL_NUM]; + u8 cur_ch_clm_ratio; + u8 cur_ch_nhm_ratio; + u8 best_chan_5g; + u8 best_chan_24g; +}; + +#define rtw_acs_get_best_chan_24g(adapter) (GET_HAL_DATA(adapter)->acs.best_chan_24g) +#define rtw_acs_get_best_chan_5g(adapter) (GET_HAL_DATA(adapter)->acs.best_chan_5g) + +u8 rtw_acs_get_clm_ratio_by_ch_num(_adapter *adapter, u8 chan); +u8 rtw_acs_get_clm_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx); +u8 rtw_acs_get_nhm_ratio_by_ch_num(_adapter *adapter, u8 chan); +u8 rtw_acs_get_num_ratio_by_ch_idx(_adapter *adapter, u8 ch_idx); + +void rtw_acs_reset(_adapter *adapter); +void rtw_acs_trigger(_adapter *adapter, u16 scan_time_ms, u8 scan_chan); +void rtw_acs_get_rst(_adapter *adapter); +void rtw_acs_select_best_chan(_adapter *adapter); +void rtw_acs_info_dump(void *sel, _adapter *adapter); +void rtw_acs_update_current_info(_adapter *adapter); +void rtw_acs_chan_info_dump(void *sel, _adapter *adapter); +void rtw_acs_current_info_dump(void *sel, _adapter *adapter); + +void rtw_acs_start(_adapter *adapter); +void rtw_acs_stop(_adapter *adapter); + +#endif /*CONFIG_RTW_ACS*/ + +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR +#define RTK_NOISE_MONITOR_VERSION 3 +#define GET_NM_STATE(padapter) (ATOMIC_READ(&GET_HAL_DATA(padapter)->nm.state)) +#define SET_NM_STATE(padapter, set_state) (ATOMIC_SET(&GET_HAL_DATA(padapter)->nm.state, set_state)) +#define IS_NM_ENABLE(padapter) ((GET_NM_STATE(padapter) == NM_ENABLE) ? _TRUE : _FALSE) + +enum NM_STATE { + NM_DISABLE, + NM_ENABLE, +}; + +struct noise_monitor { + ATOMIC_T state; + s16 noise[MAX_CHANNEL_NUM]; + u8 bss_nums[MAX_CHANNEL_NUM]; +}; +void rtw_nm_enable(_adapter *adapter); +void rtw_nm_disable(_adapter *adapter); +void rtw_noise_measure(_adapter *adapter, u8 chan, u8 is_pause_dig, u8 igi_value, u32 max_time); +s16 rtw_noise_query_by_chan_num(_adapter *adapter, u8 chan); +s16 rtw_noise_query_by_chan_idx(_adapter *adapter, u8 ch_idx); +s16 rtw_noise_measure_curchan(_adapter *padapter); +void rtw_noise_info_dump(void *sel, _adapter *adapter); +#endif +#endif /* __HAL_DM_ACS_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.c index d20812b5da8b..21e2c863ceb6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,21 +11,17 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_HALMAC_C_ #include /* PADAPTER, struct dvobj_priv, SDIO_ERR_VAL8 and etc. */ #include /* efuse, PHAL_DATA_TYPE and etc. */ -#include "halmac/halmac_api.h" /* HALMAC_FW_SIZE_MAX_88XX and etc. */ #include "hal_halmac.h" /* dvobj_to_halmac() and ect. */ #define DEFAULT_INDICATOR_TIMELMT 1000 /* ms */ -#define FIRMWARE_MAX_SIZE HALMAC_FW_SIZE_MAX_88XX +#define MSG_PREFIX "[HALMAC]" + +/*#define RTW_HALMAC_DLFW_MEM_NO_STOP_TX*/ /* * Driver API for HALMAC operations @@ -33,6 +29,37 @@ #ifdef CONFIG_SDIO_HCI #include + +static u8 _halmac_mac_reg_page0_chk(const char *func, struct dvobj_priv *dvobj, u32 offset) +{ +#if defined(CONFIG_IO_CHECK_IN_ANA_LOW_CLK) && defined(CONFIG_LPS_LCLK) + struct pwrctrl_priv *pwrpriv = &dvobj->pwrctl_priv; + u32 mac_reg_offset = 0; + + if (pwrpriv->pwr_mode == PS_MODE_ACTIVE) + return _TRUE; + + if (pwrpriv->lps_level == LPS_NORMAL) + return _TRUE; + + if (pwrpriv->rpwm >= PS_STATE_S2) + return _TRUE; + + if (offset & (WLAN_IOREG_DEVICE_ID << 13)) { /*WLAN_IOREG_OFFSET*/ + mac_reg_offset = offset & HALMAC_WLAN_MAC_REG_MSK; + if (mac_reg_offset < 0x100) { + RTW_ERR(FUNC_ADPT_FMT + "access MAC REG -0x%04x in PS-mode:0x%02x (rpwm:0x%02x, lps_level:0x%02x)\n", + FUNC_ADPT_ARG(dvobj_get_primary_adapter(dvobj)), mac_reg_offset, + pwrpriv->pwr_mode, pwrpriv->rpwm, pwrpriv->lps_level); + rtw_warn_on(1); + return _FALSE; + } + } +#endif + return _TRUE; +} + static u8 _halmac_sdio_cmd52_read(void *p, u32 offset) { struct dvobj_priv *d; @@ -41,9 +68,10 @@ static u8 _halmac_sdio_cmd52_read(void *p, u32 offset) d = (struct dvobj_priv *)p; + _halmac_mac_reg_page0_chk(__func__, d, offset); ret = rtw_sdio_read_cmd52(d, offset, &val, 1); if (_FAIL == ret) { - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); return SDIO_ERR_VAL8; } @@ -57,9 +85,10 @@ static void _halmac_sdio_cmd52_write(void *p, u32 offset, u8 val) d = (struct dvobj_priv *)p; + _halmac_mac_reg_page0_chk(__func__, d, offset); ret = rtw_sdio_write_cmd52(d, offset, &val, 1); if (_FAIL == ret) - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); } static u8 _halmac_sdio_reg_read_8(void *p, u32 offset) @@ -67,18 +96,19 @@ static u8 _halmac_sdio_reg_read_8(void *p, u32 offset) struct dvobj_priv *d; u8 *pbuf; u8 val; - int err; + u8 ret; d = (struct dvobj_priv *)p; val = SDIO_ERR_VAL8; + _halmac_mac_reg_page0_chk(__func__, d, offset); pbuf = rtw_zmalloc(1); if (!pbuf) return val; - err = d->intf_ops->read(d, offset, pbuf, 1, 0); - if (err) { - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + ret = rtw_sdio_read_cmd53(d, offset, pbuf, 1); + if (ret == _FAIL) { + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); goto exit; } @@ -95,18 +125,19 @@ static u16 _halmac_sdio_reg_read_16(void *p, u32 offset) struct dvobj_priv *d; u8 *pbuf; u16 val; - int err; + u8 ret; d = (struct dvobj_priv *)p; val = SDIO_ERR_VAL16; + _halmac_mac_reg_page0_chk(__func__, d, offset); pbuf = rtw_zmalloc(2); if (!pbuf) return val; - err = d->intf_ops->read(d, offset, pbuf, 2, 0); - if (err) { - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + ret = rtw_sdio_read_cmd53(d, offset, pbuf, 2); + if (ret == _FAIL) { + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); goto exit; } @@ -123,18 +154,19 @@ static u32 _halmac_sdio_reg_read_32(void *p, u32 offset) struct dvobj_priv *d; u8 *pbuf; u32 val; - int err; + u8 ret; d = (struct dvobj_priv *)p; val = SDIO_ERR_VAL32; + _halmac_mac_reg_page0_chk(__func__, d, offset); pbuf = rtw_zmalloc(4); if (!pbuf) return val; - err = d->intf_ops->read(d, offset, pbuf, 4, 0); - if (err) { - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + ret = rtw_sdio_read_cmd53(d, offset, pbuf, 4); + if (ret == _FAIL) { + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); goto exit; } @@ -150,12 +182,12 @@ static u8 _halmac_sdio_reg_read_n(void *p, u32 offset, u32 size, u8 *data) { struct dvobj_priv *d = (struct dvobj_priv *)p; PSDIO_DATA psdio = &d->intf_data; - u8 *pbuf; - int err; + u8 ret; u8 rst = _FALSE; u32 sdio_read_size; + sdio_read_size = RND4(size); if (sdio_read_size > psdio->block_transfer_len) sdio_read_size = _RND(sdio_read_size, psdio->block_transfer_len); @@ -164,9 +196,9 @@ static u8 _halmac_sdio_reg_read_n(void *p, u32 offset, u32 size, u8 *data) if ((!pbuf) || (!data)) return rst; - err = d->intf_ops->read(d, offset, pbuf, sdio_read_size, 0); - if (err) { - RTW_ERR("%s: [ERROR] I/O FAIL!\n", __func__); + ret = rtw_sdio_read_cmd53(d, offset, pbuf, sdio_read_size); + if (ret == _FAIL) { + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); goto exit; } @@ -182,18 +214,19 @@ static void _halmac_sdio_reg_write_8(void *p, u32 offset, u8 val) { struct dvobj_priv *d; u8 *pbuf; - int err; + u8 ret; d = (struct dvobj_priv *)p; + _halmac_mac_reg_page0_chk(__func__, d, offset); pbuf = rtw_zmalloc(1); if (!pbuf) return; _rtw_memcpy(pbuf, &val, 1); - err = d->intf_ops->write(d, offset, pbuf, 1, 0); - if (err) - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + ret = rtw_sdio_write_cmd53(d, offset, pbuf, 1); + if (ret == _FAIL) + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); rtw_mfree(pbuf, 1); } @@ -202,19 +235,20 @@ static void _halmac_sdio_reg_write_16(void *p, u32 offset, u16 val) { struct dvobj_priv *d; u8 *pbuf; - int err; + u8 ret; d = (struct dvobj_priv *)p; + _halmac_mac_reg_page0_chk(__func__, d, offset); val = cpu_to_le16(val); pbuf = rtw_zmalloc(2); if (!pbuf) return; _rtw_memcpy(pbuf, &val, 2); - err = d->intf_ops->write(d, offset, pbuf, 2, 0); - if (err) - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + ret = rtw_sdio_write_cmd53(d, offset, pbuf, 2); + if (ret == _FAIL) + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); rtw_mfree(pbuf, 2); } @@ -223,19 +257,20 @@ static void _halmac_sdio_reg_write_32(void *p, u32 offset, u32 val) { struct dvobj_priv *d; u8 *pbuf; - int err; + u8 ret; d = (struct dvobj_priv *)p; + _halmac_mac_reg_page0_chk(__func__, d, offset); val = cpu_to_le32(val); pbuf = rtw_zmalloc(4); if (!pbuf) return; _rtw_memcpy(pbuf, &val, 4); - err = d->intf_ops->write(d, offset, pbuf, 4, 0); - if (err) - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + ret = rtw_sdio_write_cmd53(d, offset, pbuf, 4); + if (ret == _FAIL) + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); rtw_mfree(pbuf, 4); } @@ -249,7 +284,7 @@ static u8 _halmac_reg_read_8(void *p, u32 offset) d = (struct dvobj_priv *)p; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); return rtw_read8(adapter, offset); } @@ -261,7 +296,7 @@ static u16 _halmac_reg_read_16(void *p, u32 offset) d = (struct dvobj_priv *)p; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); return rtw_read16(adapter, offset); } @@ -273,7 +308,7 @@ static u32 _halmac_reg_read_32(void *p, u32 offset) d = (struct dvobj_priv *)p; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); return rtw_read32(adapter, offset); } @@ -286,11 +321,11 @@ static void _halmac_reg_write_8(void *p, u32 offset, u8 val) d = (struct dvobj_priv *)p; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); err = rtw_write8(adapter, offset, val); if (err == _FAIL) - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); } static void _halmac_reg_write_16(void *p, u32 offset, u16 val) @@ -301,11 +336,11 @@ static void _halmac_reg_write_16(void *p, u32 offset, u16 val) d = (struct dvobj_priv *)p; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); err = rtw_write16(adapter, offset, val); if (err == _FAIL) - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); } static void _halmac_reg_write_32(void *p, u32 offset, u32 val) @@ -316,11 +351,11 @@ static void _halmac_reg_write_32(void *p, u32 offset, u32 val) d = (struct dvobj_priv *)p; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); err = rtw_write32(adapter, offset, val); if (err == _FAIL) - RTW_INFO("%s: [ERROR] I/O FAIL!\n", __FUNCTION__); + RTW_ERR("%s: I/O FAIL!\n", __FUNCTION__); } #endif /* !CONFIG_SDIO_HCI */ @@ -384,60 +419,38 @@ static u8 _halmac_mutex_unlock(void *p, HALMAC_MUTEX *pMutex) static u8 _halmac_msg_print(void *p, u32 msg_type, u8 msg_level, s8 *fmt, ...) { #define MSG_LEN 100 -#define MSG_PREFIX "[HALMAC]" va_list args; u8 str[MSG_LEN] = {0}; - u32 type; - u8 level; + int err; + u8 ret = _TRUE; str[0] = '\n'; - type = 0xFFFFFFFF; - if (rtw_drv_log_level <= _DRV_ERR_) - level = HALMAC_DBG_ERR; - else if (rtw_drv_log_level <= _DRV_INFO_) - level = HALMAC_DBG_WARN; - else - level = HALMAC_DBG_TRACE; - - if (!(type & BIT(msg_type))) - return _TRUE; - if (level < msg_level) - return _TRUE; - va_start(args, fmt); - vsnprintf(str, MSG_LEN, fmt, args); + err = vsnprintf(str, MSG_LEN, fmt, args); va_end(args); - if (msg_level <= HALMAC_DBG_ERR) + /* An output error is encountered */ + if (err < 0) + return _FALSE; + /* Output may be truncated due to size limit */ + if ((err == (MSG_LEN - 1)) && (str[MSG_LEN - 2] != '\n')) + ret = _FALSE; + + if (msg_level == HALMAC_DBG_ALWAYS) + RTW_PRINT(MSG_PREFIX "%s", str); + else if (msg_level <= HALMAC_DBG_ERR) RTW_ERR(MSG_PREFIX "%s", str); else if (msg_level <= HALMAC_DBG_WARN) RTW_WARN(MSG_PREFIX "%s", str); else RTW_DBG(MSG_PREFIX "%s", str); - return _TRUE; + return ret; } static u8 _halmac_buff_print(void *p, u32 msg_type, u8 msg_level, s8 *buf, u32 size) { -#define MSG_PREFIX "[HALMAC]" - u32 type; - u8 level; - - type = 0xFFFFFFFF; - if (rtw_drv_log_level <= _DRV_ERR_) - level = HALMAC_DBG_ERR; - else if (rtw_drv_log_level <= _DRV_INFO_) - level = HALMAC_DBG_WARN; - else - level = HALMAC_DBG_TRACE; - - if (!(type & BIT(msg_type))) - return _TRUE; - if (level < msg_level) - return _TRUE; - if (msg_level <= HALMAC_DBG_WARN) RTW_INFO_DUMP(MSG_PREFIX, buf, size); else @@ -465,21 +478,19 @@ static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STA { switch (id) { case HALMAC_FEATURE_CFG_PARA: - RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); + RTW_DBG("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); break; case HALMAC_FEATURE_DUMP_PHYSICAL_EFUSE: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); - if (HALMAC_CMD_PROCESS_DONE != status) { - RTW_INFO("%s: id(%d) unspecified status(%d)!\n", + if (HALMAC_CMD_PROCESS_DONE != status) + RTW_INFO("%s: id(%d) unspecified status(%d)!\n", __FUNCTION__, id, status); - } break; case HALMAC_FEATURE_DUMP_LOGICAL_EFUSE: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); - if (HALMAC_CMD_PROCESS_DONE != status) { - RTW_INFO("%s: id(%d) unspecified status(%d)!\n", + if (HALMAC_CMD_PROCESS_DONE != status) + RTW_INFO("%s: id(%d) unspecified status(%d)!\n", __FUNCTION__, id, status); - } break; case HALMAC_FEATURE_UPDATE_PACKET: RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); @@ -506,7 +517,7 @@ static inline u8 is_valid_id_status(HALMAC_FEATURE_ID id, HALMAC_CMD_PROCESS_STA RTW_INFO("%s: %s\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[id]); break; default: - RTW_INFO("%s: unknown feature id(%d)\n", __FUNCTION__, id); + RTW_ERR("%s: unknown feature id(%d)\n", __FUNCTION__, id); return _FALSE; } @@ -523,7 +534,7 @@ static int init_halmac_event_with_waittime(struct dvobj_priv *d, HALMAC_FEATURE_ if (!sctx) return -1; } else { - RTW_INFO("%s: id(%d) sctx is not NULL!!\n", __FUNCTION__, id); + RTW_WARN("%s: id(%d) sctx is not NULL!!\n", __FUNCTION__, id); sctx = d->hmpriv.indicator[id].sctx; d->hmpriv.indicator[id].sctx = NULL; } @@ -559,6 +570,8 @@ static void free_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) static int wait_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) { + PHALMAC_ADAPTER mac; + PHALMAC_API api; struct submit_ctx *sctx; int ret; @@ -572,6 +585,13 @@ static int wait_halmac_event(struct dvobj_priv *d, HALMAC_FEATURE_ID id) if (_SUCCESS == ret) return 0; + /* timeout! We have to reset halmac state */ + RTW_ERR("%s: Wait id(%d, %s) TIMEOUT! Reset HALMAC state!\n", + __FUNCTION__, id, RTW_HALMAC_FEATURE_NAME[id]); + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + api->halmac_reset_feature(mac, id); + return -1; } @@ -591,10 +611,11 @@ static u8 _halmac_event_indication(void *p, HALMAC_FEATURE_ID feature_id, HALMAC d = (struct dvobj_priv *)p; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); hal = GET_HAL_DATA(adapter); tbl = d->hmpriv.indicator; + /* Filter(Skip) middle status indication */ ret = is_valid_id_status(feature_id, process_status); if (_FALSE == ret) goto exit; @@ -603,23 +624,24 @@ static u8 _halmac_event_indication(void *p, HALMAC_FEATURE_ID feature_id, HALMAC indicator->status = process_status; indicator->ret_size = size; if (!indicator->sctx) { - RTW_INFO("%s: No feature id(%d) waiting!!\n", __FUNCTION__, feature_id); + RTW_WARN("%s: No feature id(%d, %s) waiting!!\n", __FUNCTION__, feature_id, RTW_HALMAC_FEATURE_NAME[feature_id]); goto exit; } sctx = indicator->sctx; if (HALMAC_CMD_PROCESS_ERROR == process_status) { - RTW_INFO("%s: Something wrong id(%d)!!\n", __FUNCTION__, feature_id); + RTW_ERR("%s: Something wrong id(%d, %s)!!\n", __FUNCTION__, feature_id, RTW_HALMAC_FEATURE_NAME[feature_id]); rtw_sctx_done_err(&sctx, RTW_SCTX_DONE_UNKNOWN); goto exit; } if (size > indicator->buf_size) { - RTW_INFO("%s: id(%d) buffer is not enough(%d<%d), data will be truncated!\n", - __FUNCTION__, feature_id, indicator->buf_size, size); + RTW_WARN("%s: id(%d, %s) buffer is not enough(%d<%d), data will be truncated!\n", + __FUNCTION__, feature_id, RTW_HALMAC_FEATURE_NAME[feature_id], indicator->buf_size, size); cpsz = indicator->buf_size; - } else + } else { cpsz = size; + } if (cpsz && indicator->buffer) _rtw_memcpy(indicator->buffer, buf, cpsz); @@ -717,22 +739,112 @@ u32 rtw_halmac_read32(struct intf_hdl *pintfhdl, u32 addr) return api->halmac_reg_read_32(mac, addr); } +static void _read_register(struct dvobj_priv *d, u32 addr, u32 cnt, u8 *buf) +{ +#if 1 + struct _ADAPTER *a; + u32 i, n; + u16 val16; + u32 val32; + + + a = dvobj_get_primary_adapter(d); + + i = addr & 0x3; + /* Handle address not start from 4 bytes alignment case */ + if (i) { + val32 = cpu_to_le32(rtw_read32(a, addr & ~0x3)); + n = 4 - i; + _rtw_memcpy(buf, ((u8 *)&val32) + i, n); + i = n; + cnt -= n; + } + + while (cnt) { + if (cnt >= 4) + n = 4; + else if (cnt >= 2) + n = 2; + else + n = 1; + cnt -= n; + + switch (n) { + case 1: + buf[i] = rtw_read8(a, addr+i); + i++; + break; + case 2: + val16 = cpu_to_le16(rtw_read16(a, addr+i)); + _rtw_memcpy(&buf[i], &val16, 2); + i += 2; + break; + case 4: + val32 = cpu_to_le32(rtw_read32(a, addr+i)); + _rtw_memcpy(&buf[i], &val32, 4); + i += 4; + break; + } + } +#else + struct _ADAPTER *a; + u32 i; + + + a = dvobj_get_primary_adapter(d); + for (i = 0; i < cnt; i++) + buf[i] = rtw_read8(a, addr + i); +#endif +} + +#ifdef CONFIG_SDIO_HCI +static int _sdio_read_local(struct dvobj_priv *d, u32 addr, u32 cnt, u8 *buf) +{ + struct _HALMAC_ADAPTER *mac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + + + if (buf == NULL) + return -1; + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_reg_sdio_cmd53_read_n(mac, addr, cnt, buf); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: addr=0x%08x cnt=%d err=%d\n", + __FUNCTION__, addr, cnt, status); + return -1; + } + + return 0; +} +#endif /* CONFIG_SDIO_HCI */ + void rtw_halmac_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem) { -#if defined(CONFIG_SDIO_HCI) - PHALMAC_ADAPTER mac; - PHALMAC_API api; + struct dvobj_priv *d; + if (pmem == NULL) { RTW_ERR("pmem is NULL\n"); return; } - /* WARNING: pintf_dev should not be null! */ - mac = dvobj_to_halmac(pintfhdl->pintf_dev); - api = HALMAC_GET_API(mac); - api->halmac_reg_sdio_cmd53_read_n(mac, addr, cnt, pmem); -#endif + d = pintfhdl->pintf_dev; + +#ifdef CONFIG_SDIO_HCI + if (addr & 0xFFFF0000) { + int err = 0; + + err = _sdio_read_local(d, addr, cnt, pmem); + if (!err) + return; + } +#endif /* CONFIG_SDIO_HCI */ + + _read_register(d, addr, cnt, pmem); } #ifdef CONFIG_SDIO_INDIRECT_ACCESS @@ -775,7 +887,7 @@ u32 rtw_halmac_iread32(struct intf_hdl *pintfhdl, u32 addr) return api->halmac_reg_read_indirect_32(mac, addr); } -#endif +#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ int rtw_halmac_write8(struct intf_hdl *pintfhdl, u32 addr, u8 value) { @@ -834,15 +946,58 @@ int rtw_halmac_write32(struct intf_hdl *pintfhdl, u32 addr, u32 value) return -1; } +static int init_write_rsvd_page_size(struct dvobj_priv *d) +{ + struct _HALMAC_ADAPTER *mac; + struct _HALMAC_API *api; + u32 size = 0; + struct _HALMAC_OFLD_FUNC_INFO ofld_info; + enum _HALMAC_RET_STATUS status; + int err = 0; + + +#ifdef CONFIG_USB_HCI + /* for USB do not exceed MAX_CMDBUF_SZ */ + size = 0x1000; +#elif defined(CONFIG_PCIE_HCI) + size = MAX_CMDBUF_SZ - TXDESC_OFFSET; +#elif defined(CONFIG_SDIO_HCI) + size = 0x7000; /* 28KB */ +#endif + + /* If size==0, use HALMAC default setting and don't call any function */ + if (!size) + return 0; + + err = rtw_halmac_set_max_dl_fw_size(d, size); + if (err) { + RTW_ERR("%s: Fail to set max download fw size!\n", __FUNCTION__); + return -1; + } + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + _rtw_memset(&ofld_info, 0, sizeof(ofld_info)); + ofld_info.halmac_malloc_max_sz = 0xFFFFFFFF; + ofld_info.rsvd_pg_drv_buf_max_sz = size; + status = api->halmac_ofld_func_cfg(mac, &ofld_info); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: Fail to config offload parameters!\n", __FUNCTION__); + return -1; + } + + return 0; +} + static int init_priv(struct halmacpriv *priv) { struct halmac_indicator *indicator; u32 count, size; - size = sizeof(*priv); - _rtw_memset(priv, 0, size); - + if (priv->indicator) + RTW_WARN("%s: HALMAC private data is not CLEAR!\n", __FUNCTION__); count = HALMAC_FEATURE_ALL + 1; size = sizeof(*indicator) * count; indicator = (struct halmac_indicator *)rtw_zmalloc(size); @@ -873,7 +1028,7 @@ static void deinit_priv(struct halmacpriv *priv) if (!indicator[i].sctx) continue; - RTW_INFO("%s: %s id(%d) sctx still exist!!\n", + RTW_WARN("%s: %s id(%d) sctx still exist!!\n", __FUNCTION__, RTW_HALMAC_FEATURE_NAME[i], i); sctx = indicator[i].sctx; indicator[i].sctx = NULL; @@ -886,6 +1041,37 @@ static void deinit_priv(struct halmacpriv *priv) } } +#ifdef CONFIG_SDIO_HCI +static enum _HALMAC_SDIO_SPEC_VER _sdio_ver_drv2halmac(struct dvobj_priv *d) +{ + bool v3; + enum _HALMAC_SDIO_SPEC_VER ver; + + + v3 = rtw_is_sdio30(dvobj_get_primary_adapter(d)); + if (v3) + ver = HALMAC_SDIO_SPEC_VER_3_00; + else + ver = HALMAC_SDIO_SPEC_VER_2_00; + + return ver; +} +#endif /* CONFIG_SDIO_HCI */ + +void rtw_halmac_get_version(char *str, u32 len) +{ + HALMAC_RET_STATUS status; + HALMAC_VER ver; + + + status = halmac_get_version(&ver); + if (status != HALMAC_RET_SUCCESS) + return; + + rtw_sprintf(str, len, "V%d_%02d_%02d", + ver.major_ver, ver.prototype_ver, ver.minor_ver); +} + int rtw_halmac_init_adapter(struct dvobj_priv *d, PHALMAC_PLATFORM_API pf_api) { PHALMAC_ADAPTER halmac; @@ -893,6 +1079,9 @@ int rtw_halmac_init_adapter(struct dvobj_priv *d, PHALMAC_PLATFORM_API pf_api) HALMAC_INTERFACE intf; HALMAC_RET_STATUS status; int err = 0; +#ifdef CONFIG_SDIO_HCI + HALMAC_SDIO_HW_INFO info; +#endif /* CONFIG_SDIO_HCI */ halmac = dvobj_to_halmac(d); @@ -917,13 +1106,42 @@ int rtw_halmac_init_adapter(struct dvobj_priv *d, PHALMAC_PLATFORM_API pf_api) #endif status = halmac_init_adapter(d, pf_api, intf, &halmac, &api); if (HALMAC_RET_SUCCESS != status) { - RTW_INFO("%s: halmac_init_adapter fail!(status=%d)\n", __FUNCTION__, status); + RTW_ERR("%s: halmac_init_adapter fail!(status=%d)\n", __FUNCTION__, status); err = -1; goto out; } dvobj_set_halmac(d, halmac); + status = api->halmac_interface_integration_tuning(halmac); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: halmac_interface_integration_tuning fail!(status=%d)\n", __FUNCTION__, status); + err = -1; + goto out; + } + + status = api->halmac_phy_cfg(halmac, HALMAC_INTF_PHY_PLATFORM_ALL); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: halmac_phy_cfg fail!(status=%d)\n", __FUNCTION__, status); + err = -1; + goto out; + } + + init_write_rsvd_page_size(d); + +#ifdef CONFIG_SDIO_HCI + info.spec_ver = _sdio_ver_drv2halmac(d); + /* clock unit is MHz */ + info.clock_speed = RTW_DIV_ROUND_UP(rtw_sdio_get_clock(d), 1000000); + RTW_DBG("%s: SDIO clock=%uMHz ver=%u\n", __FUNCTION__, info.clock_speed, info.spec_ver+2); + status = api->halmac_sdio_hw_info(halmac, &info); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: halmac_sdio_hw_info fail!(status=%d)\n", __FUNCTION__, status); + err = -1; + goto out; + } +#endif /* CONFIG_SDIO_HCI */ + out: if (err) rtw_halmac_deinit_adapter(d); @@ -957,55 +1175,697 @@ int rtw_halmac_deinit_adapter(struct dvobj_priv *d) return err; } -int rtw_halmac_poweron(struct dvobj_priv *d) +static inline u8 _hw_port_drv2halmac(enum _hw_port hwport) { - PHALMAC_ADAPTER halmac; + u8 port = 0; + + + switch (hwport) { + case HW_PORT0: + port = 0; + break; + case HW_PORT1: + port = 1; + break; + case HW_PORT2: + port = 2; + break; + case HW_PORT3: + port = 3; + break; + case HW_PORT4: + port = 4; + break; + default: + port = hwport; + break; + } + + return port; +} + +static enum _HALMAC_NETWORK_TYPE_SELECT _network_type_drv2halmac(u8 type) +{ + enum _HALMAC_NETWORK_TYPE_SELECT network = HALMAC_NETWORK_UNDEFINE; + + + switch (type) { + case _HW_STATE_NOLINK_: + case _HW_STATE_MONITOR_: + network = HALMAC_NETWORK_NO_LINK; + break; + + case _HW_STATE_ADHOC_: + network = HALMAC_NETWORK_ADHOC; + break; + + case _HW_STATE_STATION_: + network = HALMAC_NETWORK_INFRASTRUCTURE; + break; + + case _HW_STATE_AP_: + network = HALMAC_NETWORK_AP; + break; + } + + return network; +} + +static u8 _network_type_halmac2drv(enum _HALMAC_NETWORK_TYPE_SELECT network) +{ + u8 type = _HW_STATE_NOLINK_; + + + switch (network) { + case HALMAC_NETWORK_NO_LINK: + case HALMAC_NETWORK_UNDEFINE: + type = _HW_STATE_NOLINK_; + break; + + case HALMAC_NETWORK_ADHOC: + type = _HW_STATE_ADHOC_; + break; + + case HALMAC_NETWORK_INFRASTRUCTURE: + type = _HW_STATE_STATION_; + break; + + case HALMAC_NETWORK_AP: + type = _HW_STATE_AP_; + break; + } + + return type; +} + +static void _beacon_ctrl_halmac2drv(struct HALMAC_BCN_CTRL *ctrl, + struct rtw_halmac_bcn_ctrl *drv_ctrl) +{ + drv_ctrl->rx_bssid_fit = ctrl->dis_rx_bssid_fit ? 0 : 1; + drv_ctrl->txbcn_rpt = ctrl->en_txbcn_rpt ? 1 : 0; + drv_ctrl->tsf_update = ctrl->dis_tsf_udt ? 0 : 1; + drv_ctrl->enable_bcn = ctrl->en_bcn ? 1 : 0; + drv_ctrl->rxbcn_rpt = ctrl->ex_rxbcn_rpt ? 1 : 0; + drv_ctrl->p2p_ctwin = ctrl->en_p2p_ctwin ? 1 : 0; + drv_ctrl->p2p_bcn_area = ctrl->en_p2p_bcn_area ? 1 : 0; +} + +static void _beacon_ctrl_drv2halmac(struct rtw_halmac_bcn_ctrl *drv_ctrl, + struct HALMAC_BCN_CTRL *ctrl) +{ + ctrl->dis_rx_bssid_fit = drv_ctrl->rx_bssid_fit ? 0 : 1; + ctrl->en_txbcn_rpt = drv_ctrl->txbcn_rpt ? 1 : 0; + ctrl->dis_tsf_udt = drv_ctrl->tsf_update ? 0 : 1; + ctrl->en_bcn = drv_ctrl->enable_bcn ? 1 : 0; + ctrl->ex_rxbcn_rpt = drv_ctrl->rxbcn_rpt ? 1 : 0; + ctrl->en_p2p_ctwin = drv_ctrl->p2p_ctwin ? 1 : 0; + ctrl->en_p2p_bcn_area = drv_ctrl->p2p_bcn_area ? 1 : 0; +} + +int rtw_halmac_get_hw_value(struct dvobj_priv *d, HALMAC_HW_ID hw_id, VOID *pvalue) +{ + PHALMAC_ADAPTER mac; PHALMAC_API api; HALMAC_RET_STATUS status; - int err = -1; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_get_hw_value(mac, hw_id, pvalue); + if (HALMAC_RET_SUCCESS != status) + return -1; + + return 0; +} + +/** + * rtw_halmac_get_tx_fifo_size() - TX FIFO size + * @d: struct dvobj_priv* + * @size: TX FIFO size, unit is byte. + * + * Get TX FIFO size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_tx_fifo_size(struct dvobj_priv *d, u32 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 val = 0; halmac = dvobj_to_halmac(d); - if (!halmac) - goto out; - api = HALMAC_GET_API(halmac); - status = api->halmac_pre_init_system_cfg(halmac); + status = api->halmac_get_hw_value(halmac, HALMAC_HW_TXFIFO_SIZE, &val); if (status != HALMAC_RET_SUCCESS) - goto out; + return -1; - status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_ON); - if (status != HALMAC_RET_SUCCESS) - goto out; + *size = val; - status = api->halmac_init_system_cfg(halmac); + return 0; +} + +/** + * rtw_halmac_get_rx_fifo_size() - RX FIFO size + * @d: struct dvobj_priv* + * @size: RX FIFO size, unit is byte + * + * Get RX FIFO size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_rx_fifo_size(struct dvobj_priv *d, u32 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_RXFIFO_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + +/** + * rtw_halmac_get_rsvd_drv_pg_bndy() - Reserve page boundary of driver + * @d: struct dvobj_priv* + * @size: Page size, unit is byte + * + * Get reserve page boundary of driver from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *d, u16 *bndy) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u16 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_RSVD_PG_BNDY, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *bndy = val; + + return 0; +} + +/** + * rtw_halmac_get_page_size() - Page size + * @d: struct dvobj_priv* + * @size: Page size, unit is byte + * + * Get TX/RX page size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_page_size(struct dvobj_priv *d, u32 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_PAGE_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + +/** + * rtw_halmac_get_tx_agg_align_size() - TX aggregation align size + * @d: struct dvobj_priv* + * @size: TX aggregation align size, unit is byte + * + * Get TX aggregation align size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_tx_agg_align_size(struct dvobj_priv *d, u16 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u16 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_TX_AGG_ALIGN_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + +/** + * rtw_halmac_get_rx_agg_align_size() - RX aggregation align size + * @d: struct dvobj_priv* + * @size: RX aggregation align size, unit is byte + * + * Get RX aggregation align size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_rx_agg_align_size(struct dvobj_priv *d, u8 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u8 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_RX_AGG_ALIGN_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + +/* + * Description: + * Get RX driver info size. RX driver info is a small memory space between + * scriptor and RX payload. + * + * +-------------------------+ + * | RX descriptor | + * | usually 24 bytes | + * +-------------------------+ + * | RX driver info | + * | depends on driver cfg | + * +-------------------------+ + * | RX paylad | + * | | + * +-------------------------+ + * + * Parameter: + * d pointer to struct dvobj_priv of driver + * sz rx driver info size in bytes. + * + * Rteurn: + * 0 Success + * other Fail + */ +int rtw_halmac_get_rx_drv_info_sz(struct dvobj_priv *d, u8 *sz) +{ + HALMAC_RET_STATUS status; + PHALMAC_ADAPTER halmac = dvobj_to_halmac(d); + PHALMAC_API api = HALMAC_GET_API(halmac); + u8 dw = 0; + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_DRV_INFO_SIZE, &dw); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *sz = dw * 8; + return 0; +} + +/** + * rtw_halmac_get_tx_desc_size() - TX descriptor size + * @d: struct dvobj_priv* + * @size: TX descriptor size, unit is byte. + * + * Get TX descriptor size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_tx_desc_size(struct dvobj_priv *d, u32 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_TX_DESC_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + +/** + * rtw_halmac_get_rx_desc_size() - RX descriptor size + * @d: struct dvobj_priv* + * @size: RX descriptor size, unit is byte. + * + * Get RX descriptor size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_rx_desc_size(struct dvobj_priv *d, u32 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_RX_DESC_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + + +/** + * rtw_halmac_get_fw_max_size() - Firmware MAX size + * @d: struct dvobj_priv* + * @size: MAX Firmware size, unit is byte. + * + * Get Firmware MAX size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +static int rtw_halmac_get_fw_max_size(struct dvobj_priv *d, u32 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_FW_MAX_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + +/** + * rtw_halmac_get_ori_h2c_size() - Original H2C MAX size + * @d: struct dvobj_priv* + * @size: H2C MAX size, unit is byte. + * + * Get original H2C MAX size(byte) from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_ori_h2c_size(struct dvobj_priv *d, u32 *size) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_ORI_H2C_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + + return 0; +} + +int rtw_halmac_get_oqt_size(struct dvobj_priv *d, u8 *size) +{ + enum _HALMAC_RET_STATUS status; + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 val; + + + if (!size) + return -1; + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_AC_OQT_SIZE, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *size = val; + return 0; +} + +int rtw_halmac_get_ac_queue_number(struct dvobj_priv *d, u8 *num) +{ + enum _HALMAC_RET_STATUS status; + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 val; + + + if (!num) + return -1; + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_AC_QUEUE_NUM, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *num = val; + return 0; +} + +/** + * rtw_halmac_get_mac_address() - Get MAC address of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @addr: buffer for storing MAC address + * + * Get MAC address of specific port from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) +{ +#if 0 + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; +#endif + u8 port; + union _HALMAC_WLAN_ADDR hwa; +#if 0 + enum _HALMAC_RET_STATUS status; +#endif + int err = -1; + + + if (!addr) + goto out; +#if 0 + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); +#endif + port = _hw_port_drv2halmac(hwport); + + _rtw_memset(&hwa, 0, sizeof(hwa)); + +#if 0 + status = api->halmac_get_mac_addr(halmac, port, &hwa); if (status != HALMAC_RET_SUCCESS) goto out; +#else + { + u32 offset; + + switch (port) { + case 0: + offset = REG_MACID; + break; + + case 1: + offset = REG_MACID1; + break; + + case 2: + offset = REG_MACID2; + break; + + case 3: + offset = REG_MACID3; + break; + + case 4: + offset = REG_MACID4; + break; + + default: + goto out; + } + + _read_register(d, offset, 6, hwa.Address); + } +#endif + _rtw_memcpy(addr, hwa.Address, 6); err = 0; out: return err; } -int rtw_halmac_poweroff(struct dvobj_priv *d) +/** + * rtw_halmac_get_network_type() - Get network type of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @type: buffer to put network type (_HW_STATE_*) + * + * Get network type of specific port from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 *type) { - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_RET_STATUS status; +#if 0 + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + enum _HALMAC_NETWORK_TYPE_SELECT network; + enum _HALMAC_RET_STATUS status; int err = -1; halmac = dvobj_to_halmac(d); - if (!halmac) - goto out; - api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + network = HALMAC_NETWORK_UNDEFINE; - status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_OFF); + status = api->halmac_get_net_type(halmac, port, &network); if (status != HALMAC_RET_SUCCESS) goto out; + *type = _network_type_halmac2drv(network); + + err = 0; +out: + return err; +#else + struct _ADAPTER *a; + u8 port; + enum _HALMAC_NETWORK_TYPE_SELECT network; + u32 val; + int err = -1; + + + a = dvobj_get_primary_adapter(d); + port = _hw_port_drv2halmac(hwport); + network = HALMAC_NETWORK_UNDEFINE; + + switch (port) { + case 0: + val = rtw_read32(a, REG_CR); + network = BIT_GET_NETYPE0(val); + break; + + case 1: + val = rtw_read32(a, REG_CR); + network = BIT_GET_NETYPE1(val); + break; + + case 2: + val = rtw_read32(a, REG_CR_EXT); + network = BIT_GET_NETYPE2(val); + break; + + case 3: + val = rtw_read32(a, REG_CR_EXT); + network = BIT_GET_NETYPE3(val); + break; + + case 4: + val = rtw_read32(a, REG_CR_EXT); + network = BIT_GET_NETYPE4(val); + break; + + default: + goto out; + } + + *type = _network_type_halmac2drv(network); + + err = 0; +out: + return err; +#endif +} + +/** + * rtw_halmac_get_bcn_ctrl() - Get beacon control setting of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @bcn_ctrl: setting of beacon control + * + * Get beacon control setting of specific port from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_get_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, + struct rtw_halmac_bcn_ctrl *bcn_ctrl) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + struct HALMAC_BCN_CTRL ctrl; + enum _HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + _rtw_memset(&ctrl, 0, sizeof(struct HALMAC_BCN_CTRL)); + + status = api->halmac_rw_bcn_ctrl(halmac, port, 0, &ctrl); + if (status != HALMAC_RET_SUCCESS) + goto out; + _beacon_ctrl_halmac2drv(&ctrl, bcn_ctrl); + err = 0; out: return err; @@ -1035,6 +1895,587 @@ int rtw_halmac_config_rx_info(struct dvobj_priv *d, HALMAC_DRV_INFO info) return err; } +/** + * rtw_halmac_set_max_dl_fw_size() - Set the MAX download firmware size + * @d: struct dvobj_priv* + * @size: the max download firmware size in one I/O + * + * Set the max download firmware size in one I/O. + * Please also consider the max size of the callback function "SEND_RSVD_PAGE" + * could accept, because download firmware would call "SEND_RSVD_PAGE" to send + * firmware to IC. + * + * If the value of "size" is not even, it would be rounded down to nearest + * even, and 0 and 1 are both invalid value. + * + * Return 0 for setting OK, otherwise fail. + */ +int rtw_halmac_set_max_dl_fw_size(struct dvobj_priv *d, u32 size) +{ + PHALMAC_ADAPTER mac; + PHALMAC_API api; + HALMAC_RET_STATUS status; + + + if (!size || (size == 1)) + return -1; + + mac = dvobj_to_halmac(d); + if (!mac) { + RTW_ERR("%s: HALMAC is not ready!!\n", __FUNCTION__); + return -1; + } + api = HALMAC_GET_API(mac); + + size &= ~1; /* round down to even */ + status = api->halmac_cfg_max_dl_size(mac, size); + if (status != HALMAC_RET_SUCCESS) { + RTW_WARN("%s: Fail to cfg_max_dl_size(%d), err=%d!!\n", + __FUNCTION__, size, status); + return -1; + } + + return 0; +} + +/** + * rtw_halmac_set_mac_address() - Set mac address of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @addr: mac address + * + * Set self mac address of specific port to HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_set_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) +{ + PHALMAC_ADAPTER halmac; + PHALMAC_API api; + u8 port; + HALMAC_WLAN_ADDR hwa; + HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + port = _hw_port_drv2halmac(hwport); + _rtw_memset(&hwa, 0, sizeof(hwa)); + _rtw_memcpy(hwa.Address, addr, 6); + + status = api->halmac_cfg_mac_addr(halmac, port, &hwa); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +} + +/** + * rtw_halmac_set_bssid() - Set BSSID of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @addr: BSSID, mac address of AP + * + * Set BSSID of specific port to HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) +{ + PHALMAC_ADAPTER halmac; + PHALMAC_API api; + u8 port; + HALMAC_WLAN_ADDR hwa; + HALMAC_RET_STATUS status; + int err = -1; + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + + _rtw_memset(&hwa, 0, sizeof(HALMAC_WLAN_ADDR)); + _rtw_memcpy(hwa.Address, addr, 6); + status = api->halmac_cfg_bssid(halmac, port, &hwa); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +} + +/** + * rtw_halmac_set_tx_address() - Set transmitter address of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @addr: transmitter address + * + * Set transmitter address of specific port to HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_set_tx_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + union _HALMAC_WLAN_ADDR hwa; + enum _HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + _rtw_memset(&hwa, 0, sizeof(union _HALMAC_WLAN_ADDR)); + _rtw_memcpy(hwa.Address, addr, 6); + + status = api->halmac_cfg_transmitter_addr(halmac, port, &hwa); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +} + +/** + * rtw_halmac_set_network_type() - Set network type of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @type: network type (_HW_STATE_*) + * + * Set network type of specific port to HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_set_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 type) +{ +#if 0 /* Fail to set AP mode for port0 */ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + enum _HALMAC_NETWORK_TYPE_SELECT network; + enum _HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + network = _network_type_drv2halmac(type); + + status = api->halmac_cfg_net_type(halmac, port, network); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +#else + struct _ADAPTER *a; + u8 port; + enum _HALMAC_NETWORK_TYPE_SELECT network; + u32 val; + int err = -1; + + + a = dvobj_get_primary_adapter(d); + port = _hw_port_drv2halmac(hwport); + network = _network_type_drv2halmac(type); + + if ((port > 0) && (network == HALMAC_NETWORK_AP)) + goto out; + + switch (port) { + case 0: + val = rtw_read32(a, REG_CR); + val = BIT_SET_NETYPE0(val, network); + rtw_write32(a, REG_CR, val); + break; + + case 1: + val = rtw_read32(a, REG_CR); + val = BIT_SET_NETYPE1(val, network); + rtw_write32(a, REG_CR, val); + break; + + case 2: + val = rtw_read32(a, REG_CR_EXT); + val = BIT_SET_NETYPE2(val, network); + rtw_write32(a, REG_CR_EXT, val); + break; + + case 3: + val = rtw_read32(a, REG_CR_EXT); + val = BIT_SET_NETYPE3(val, network); + rtw_write32(a, REG_CR_EXT, val); + break; + + case 4: + val = rtw_read32(a, REG_CR_EXT); + val = BIT_SET_NETYPE4(val, network); + rtw_write32(a, REG_CR_EXT, val); + break; + + default: + goto out; + } + + + err = 0; +out: + return err; +#endif +} + +/** + * rtw_halmac_reset_tsf() - Reset TSF timer of specific port + * @d: struct dvobj_priv* + * @hwport: port + * + * Notice HALMAC to reset timing synchronization function(TSF) timer of + * specific port. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_reset_tsf(struct dvobj_priv *d, enum _hw_port hwport) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + enum _HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + + status = api->halmac_cfg_tsf_rst(halmac, port); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +} + +/** + * rtw_halmac_set_bcn_interval() - Set beacon interval of each port + * @d: struct dvobj_priv* + * @hwport: port + * @space: beacon interval, unit is ms + * + * Set beacon interval of specific port to HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_set_bcn_interval(struct dvobj_priv *d, enum _hw_port hwport, + u32 interval) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + enum _HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + + status = api->halmac_cfg_bcn_space(halmac, port, interval); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +} + +/** + * rtw_halmac_set_bcn_ctrl() - Set beacon control setting of each port + * @d: struct dvobj_priv* + * @hwport: port + * @bcn_ctrl: setting of beacon control + * + * Set beacon control setting of specific port to HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_set_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, + struct rtw_halmac_bcn_ctrl *bcn_ctrl) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + struct HALMAC_BCN_CTRL ctrl; + enum _HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + _rtw_memset(&ctrl, 0, sizeof(struct HALMAC_BCN_CTRL)); + _beacon_ctrl_drv2halmac(bcn_ctrl, &ctrl); + + status = api->halmac_rw_bcn_ctrl(halmac, port, 1, &ctrl); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +} + +/** + * rtw_halmac_set_aid() - Set association identifier(AID) of specific port + * @d: struct dvobj_priv* + * @hwport: port + * @aid: Association identifier + * + * Set association identifier(AID) of specific port to HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_set_aid(struct dvobj_priv *d, enum _hw_port hwport, u16 aid) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + u8 port; + enum _HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + port = _hw_port_drv2halmac(hwport); + +#if 0 + status = api->halmac_cfg_aid(halmac, port, aid); + if (status != HALMAC_RET_SUCCESS) + goto out; +#else +{ + struct _ADAPTER *a; + u32 addr; + u16 val; + + a = dvobj_get_primary_adapter(d); + + switch (port) { + case 0: + addr = REG_BCN_PSR_RPT; + val = rtw_read16(a, addr); + val = BIT_SET_PS_AID_0(val, aid); + rtw_write16(a, addr, val); + break; + + case 1: + addr = REG_BCN_PSR_RPT1; + val = rtw_read16(a, addr); + val = BIT_SET_PS_AID_1(val, aid); + rtw_write16(a, addr, val); + break; + + case 2: + addr = REG_BCN_PSR_RPT2; + val = rtw_read16(a, addr); + val = BIT_SET_PS_AID_2(val, aid); + rtw_write16(a, addr, val); + break; + + case 3: + addr = REG_BCN_PSR_RPT3; + val = rtw_read16(a, addr); + val = BIT_SET_PS_AID_3(val, aid); + rtw_write16(a, addr, val); + break; + + case 4: + addr = REG_BCN_PSR_RPT4; + val = rtw_read16(a, addr); + val = BIT_SET_PS_AID_4(val, aid); + rtw_write16(a, addr, val); + break; + + default: + goto out; + } +} +#endif + + err = 0; +out: + return err; +} + +int rtw_halmac_set_bandwidth(struct dvobj_priv *d, u8 channel, u8 pri_ch_idx, u8 bw) +{ + PHALMAC_ADAPTER mac; + PHALMAC_API api; + HALMAC_RET_STATUS status; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_cfg_ch_bw(mac, channel, pri_ch_idx, bw); + if (HALMAC_RET_SUCCESS != status) + return -1; + + return 0; +} + +/** + * rtw_halmac_set_edca() - config edca parameter + * @d: struct dvobj_priv* + * @queue: XMIT_[VO/VI/BE/BK]_QUEUE + * @aifs: Arbitration inter-frame space(AIFS) + * @cw: Contention window(CW) + * @txop: MAX Transmit Opportunity(TXOP) + * + * Return: 0 if process OK, otherwise -1. + */ +int rtw_halmac_set_edca(struct dvobj_priv *d, u8 queue, u8 aifs, u8 cw, u16 txop) +{ + PHALMAC_ADAPTER mac; + PHALMAC_API api; + HALMAC_ACQ_ID ac; + HALMAC_EDCA_PARA edca; + HALMAC_RET_STATUS status; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + switch (queue) { + case XMIT_VO_QUEUE: + ac = HALMAC_ACQ_ID_VO; + break; + case XMIT_VI_QUEUE: + ac = HALMAC_ACQ_ID_VI; + break; + case XMIT_BE_QUEUE: + ac = HALMAC_ACQ_ID_BE; + break; + case XMIT_BK_QUEUE: + ac = HALMAC_ACQ_ID_BK; + break; + default: + return -1; + } + + edca.aifs = aifs; + edca.cw = cw; + edca.txop_limit = txop; + + status = api->halmac_cfg_edca_para(mac, ac, &edca); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; +} + +/* + * Description: + * Power on device hardware. + * [Notice!] If device's power state is on before, + * it would be power off first and turn on power again. + * + * Return: + * 0 power on success + * -1 power on fail + * -2 power state unchange + */ +int rtw_halmac_poweron(struct dvobj_priv *d) +{ + PHALMAC_ADAPTER halmac; + PHALMAC_API api; + HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + if (!halmac) + goto out; + + api = HALMAC_GET_API(halmac); + + status = api->halmac_pre_init_system_cfg(halmac); + if (status != HALMAC_RET_SUCCESS) + goto out; + +#ifdef CONFIG_SDIO_HCI + status = api->halmac_sdio_cmd53_4byte(halmac, HALMAC_SDIO_CMD53_4BYTE_MODE_RW); + if (status != HALMAC_RET_SUCCESS) + goto out; +#endif /* CONFIG_SDIO_HCI */ + + status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_ON); + if (HALMAC_RET_PWR_UNCHANGE == status) { + /* + * Work around for warm reboot but device not power off, + * but it would also fall into this case when auto power on is enabled. + */ + api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_OFF); + status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_ON); + RTW_WARN("%s: Power state abnormal, try to recover...%s\n", + __FUNCTION__, (HALMAC_RET_SUCCESS == status)?"OK":"FAIL!"); + } + if (HALMAC_RET_SUCCESS != status) { + if (HALMAC_RET_PWR_UNCHANGE == status) + err = -2; + goto out; + } + + status = api->halmac_init_system_cfg(halmac); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = 0; +out: + return err; +} + +/* + * Description: + * Power off device hardware. + * + * Return: + * 0 Power off success + * -1 Power off fail + */ +int rtw_halmac_poweroff(struct dvobj_priv *d) +{ + PHALMAC_ADAPTER halmac; + PHALMAC_API api; + HALMAC_RET_STATUS status; + int err = -1; + + + halmac = dvobj_to_halmac(d); + if (!halmac) + goto out; + + api = HALMAC_GET_API(halmac); + + status = api->halmac_mac_power_switch(halmac, HALMAC_MAC_POWER_OFF); + if ((HALMAC_RET_SUCCESS != status) + && (HALMAC_RET_PWR_UNCHANGE != status)) + goto out; + + err = 0; +out: + return err; +} + #ifdef CONFIG_SUPPORT_TRX_SHARED static inline HALMAC_RX_FIFO_EXPANDING_MODE _trx_share_mode_drv2halmac(u8 trx_share_mode) { @@ -1071,93 +2512,88 @@ void dump_trx_share_mode(void *sel, _adapter *adapter) } #endif -static HALMAC_RET_STATUS init_mac_flow(struct dvobj_priv *d) +static enum _HALMAC_DRV_RSVD_PG_NUM _rsvd_page_num_drv2halmac(u8 num) { - PADAPTER p; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_WLAN_ADDR hwa; - HALMAC_RET_STATUS status; - u8 wifi_test = 0; - u8 nettype; - int err; + if (num <= 8) + return HALMAC_RSVD_PG_NUM8; + if (num <= 16) + return HALMAC_RSVD_PG_NUM16; + if (num <= 24) + return HALMAC_RSVD_PG_NUM24; + if (num > 32) + RTW_WARN("%s: Fail to allocate RSVD page(%d)!!" + " The MAX RSVD page number is 32...\n", + __FUNCTION__, num); - p = d->padapters[IFACE_ID0]; - halmac = dvobj_to_halmac(d); - api = HALMAC_GET_API(halmac); - if (p->registrypriv.wifi_spec) - wifi_test = 1; - -#ifdef CONFIG_SUPPORT_TRX_SHARED - status = api->halmac_cfg_rx_fifo_expanding_mode(halmac, _rtw_get_trx_share_mode(p)); - if (status != HALMAC_RET_SUCCESS) - goto out; -#endif - -#if 0 - status = api->halmac_cfg_drv_rsvd_pg_num(halmac, HALMAC_RSVD_PG_NUM16);/*HALMAC_RSVD_PG_NUM24/HALMAC_RSVD_PG_NUM32*/ - if (status != HALMAC_RET_SUCCESS) - goto out; -#endif - -#ifdef CONFIG_USB_HCI - status = api->halmac_set_bulkout_num(halmac, d->RtNumOutPipes); - if (status != HALMAC_RET_SUCCESS) - goto out; -#endif /* CONFIG_USB_HCI */ - - if (wifi_test) - status = api->halmac_init_mac_cfg(halmac, HALMAC_TRX_MODE_WMM); - else - status = api->halmac_init_mac_cfg(halmac, HALMAC_TRX_MODE_NORMAL); - if (status != HALMAC_RET_SUCCESS) - goto out; - - err = rtw_halmac_rx_agg_switch(d, _TRUE); - if (err) - goto out; - - nettype = dvobj_to_regsty(d)->wireless_mode; - if (IsSupportedVHT(nettype) == _TRUE) - status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_AC); - else if (IsSupportedHT(nettype) == _TRUE) - status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_N); - else if (IsSupportedTxOFDM(nettype) == _TRUE) - status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_G); - else - status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_B); - if (status != HALMAC_RET_SUCCESS) - goto out; - -out: - return status; + return HALMAC_RSVD_PG_NUM32; } -static inline HALMAC_RF_TYPE _rf_type_drv2halmac(RT_RF_TYPE_DEF_E rf_drv) +static u8 _rsvd_page_num_halmac2drv(HALMAC_DRV_RSVD_PG_NUM rsvd_page_number) { - HALMAC_RF_TYPE rf_mac; + u8 num = 0; + + + switch (rsvd_page_number) { + case HALMAC_RSVD_PG_NUM8: + num = 8; + break; + + case HALMAC_RSVD_PG_NUM16: + num = 16; + break; + + case HALMAC_RSVD_PG_NUM24: + num = 24; + break; + + case HALMAC_RSVD_PG_NUM32: + num = 32; + break; + } + + return num; +} + +static HALMAC_TRX_MODE _choose_trx_mode(struct dvobj_priv *d) +{ + PADAPTER p; + + + p = dvobj_get_primary_adapter(d); + + if (p->registrypriv.wifi_spec) + return HALMAC_TRX_MODE_WMM; + +#ifdef CONFIG_SUPPORT_TRX_SHARED + if (_rtw_get_trx_share_mode(p)) + return HALMAC_TRX_MODE_TRXSHARE; +#endif + + return HALMAC_TRX_MODE_NORMAL; +} + +static inline enum _HALMAC_RF_TYPE _rf_type_drv2halmac(enum rf_type rf_drv) +{ + enum _HALMAC_RF_TYPE rf_mac; switch (rf_drv) { + case RF_1T1R: + rf_mac = HALMAC_RF_1T1R; + break; case RF_1T2R: rf_mac = HALMAC_RF_1T2R; break; - case RF_2T4R: - rf_mac = HALMAC_RF_2T4R; - break; case RF_2T2R: rf_mac = HALMAC_RF_2T2R; break; - case RF_1T1R: - rf_mac = HALMAC_RF_1T1R; - break; - case RF_2T2R_GREEN: - rf_mac = HALMAC_RF_2T2R_GREEN; - break; case RF_2T3R: rf_mac = HALMAC_RF_2T3R; break; + case RF_2T4R: + rf_mac = HALMAC_RF_2T4R; + break; case RF_3T3R: rf_mac = HALMAC_RF_3T3R; break; @@ -1168,25 +2604,70 @@ static inline HALMAC_RF_TYPE _rf_type_drv2halmac(RT_RF_TYPE_DEF_E rf_drv) rf_mac = HALMAC_RF_4T4R; break; default: - rf_mac = (HALMAC_RF_TYPE)rf_drv; + rf_mac = HALMAC_RF_MAX_TYPE; + RTW_ERR("%s: Invalid RF type(0x%x)!\n", __FUNCTION__, rf_drv); break; } return rf_mac; } +static void _ant_status_by_rf_type(enum rf_type rf, u8 *tx, u8 *rx) +{ + switch (rf) { + case RF_1T1R: + case RF_1T2R: + *tx = BB_PATH_A; + break; + case RF_2T2R: + case RF_2T3R: + case RF_2T4R: + *tx = BB_PATH_AB; + break; + case RF_3T3R: + case RF_3T4R: + *tx = BB_PATH_ABC; + break; + case RF_4T4R: + default: + *tx = BB_PATH_ABCD; + break; + } + + switch (rf) { + case RF_1T1R: + *rx = BB_PATH_A; + break; + case RF_1T2R: + case RF_2T2R: + *rx = BB_PATH_AB; + break; + case RF_2T3R: + case RF_3T3R: + *rx = BB_PATH_ABC; + break; + case RF_2T4R: + case RF_3T4R: + case RF_4T4R: + default: + *rx = BB_PATH_ABCD; + break; + } +} + static int _send_general_info(struct dvobj_priv *d) { - PADAPTER adapter; - PHAL_DATA_TYPE hal; - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - HALMAC_GENERAL_INFO info; - HALMAC_RET_STATUS status; + struct _ADAPTER *adapter; + struct hal_com_data *hal; + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + struct _HALMAC_GENERAL_INFO info; + enum _HALMAC_RET_STATUS status; + enum rf_type rf; u8 val8; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); hal = GET_HAL_DATA(adapter); halmac = dvobj_to_halmac(d); if (!halmac) @@ -1194,9 +2675,11 @@ static int _send_general_info(struct dvobj_priv *d) api = HALMAC_GET_API(halmac); _rtw_memset(&info, 0, sizeof(info)); - info.rfe_type = (u8)hal->RFEType; - rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, &val8); - info.rf_type = _rf_type_drv2halmac(val8); + info.rfe_type = (u8)hal->rfe_type; + rtw_hal_get_hwreg(adapter, HW_VAR_RF_TYPE, (u8 *)&val8); + rf = (enum rf_type)val8; + info.rf_type = _rf_type_drv2halmac(rf); + _ant_status_by_rf_type(rf, &info.tx_ant_status, &info.rx_ant_status); status = api->halmac_send_general_info(halmac, &info); switch (status) { @@ -1213,6 +2696,229 @@ static int _send_general_info(struct dvobj_priv *d) return 0; } +static int _cfg_drv_rsvd_pg_num(struct dvobj_priv *d) +{ + struct _ADAPTER *a; + struct hal_com_data *hal; + PHALMAC_ADAPTER halmac; + PHALMAC_API api; + enum _HALMAC_DRV_RSVD_PG_NUM rsvd_page_number; + HALMAC_RET_STATUS status; + u8 drv_rsvd_num; + + + a = dvobj_get_primary_adapter(d); + hal = GET_HAL_DATA(a); + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + drv_rsvd_num = rtw_hal_get_rsvd_page_num(a); + rsvd_page_number = _rsvd_page_num_drv2halmac(drv_rsvd_num); + status = api->halmac_cfg_drv_rsvd_pg_num(halmac, rsvd_page_number); + if (status != HALMAC_RET_SUCCESS) + return -1; + hal->drv_rsvd_page_number = _rsvd_page_num_halmac2drv(rsvd_page_number); + + if (drv_rsvd_num != hal->drv_rsvd_page_number) + RTW_INFO("%s: request %d pages, but allocate %d pages\n", + __FUNCTION__, drv_rsvd_num, hal->drv_rsvd_page_number); + + return 0; +} + +/* + * Description: + * Downlaod Firmware Flow + * + * Parameters: + * d pointer of struct dvobj_priv + * fw firmware array + * fwsize firmware size + * re_dl re-download firmware or not + * 0: run in init hal flow, not re-download + * 1: it is a stand alone operation, not in init hal flow + * + * Return: + * 0 Success + * others Fail + */ +static int download_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize, u8 re_dl) +{ + PHALMAC_ADAPTER mac; + PHALMAC_API api; + HALMAC_RET_STATUS status; + int err = 0; + PHAL_DATA_TYPE hal; + HALMAC_FW_VERSION fw_vesion; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + hal = GET_HAL_DATA(dvobj_get_primary_adapter(d)); + + if ((!fw) || (!fwsize)) + return -1; + + /* 1. Driver Stop Tx */ + /* ToDo */ + + /* 2. Driver Check Tx FIFO is empty */ + err = rtw_halmac_txfifo_wait_empty(d, 2000); /* wait 2s */ + if (err) { + err = -1; + goto resume_tx; + } + + /* 3. Config MAX download size */ + /* + * Already done in rtw_halmac_init_adapter() or + * somewhere calling rtw_halmac_set_max_dl_fw_size(). + */ + + /* 4. Download Firmware */ + status = api->halmac_download_firmware(mac, fw, fwsize); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: download firmware FAIL! status=0x%02x\n", + __FUNCTION__, status); + err = -1; + goto resume_tx; + } + +resume_tx: + /* 5. Driver resume TX if needed */ + /* ToDo */ + + if (err) + goto exit; + + if (re_dl) { + HALMAC_TRX_MODE mode; + + /* 6. Change reserved page size */ + err = _cfg_drv_rsvd_pg_num(d); + if (err) + return -1; + + /* 7. Init TRX Configuration */ + mode = _choose_trx_mode(d); + status = api->halmac_init_trx_cfg(mac, mode); + if (HALMAC_RET_SUCCESS != status) + return -1; + + /* 8. Config RX Aggregation */ + err = rtw_halmac_rx_agg_switch(d, _TRUE); + if (err) + return -1; + + /* 9. Send General Info */ + err = _send_general_info(d); + if (err) + return -1; + } + + /* 10. (Driver) Reset driver variables if needed */ + hal->LastHMEBoxNum = 0; + + /* 11. (Driver) Get FW version */ + status = api->halmac_get_fw_version(mac, &fw_vesion); + if (status == HALMAC_RET_SUCCESS) { + hal->firmware_version = fw_vesion.version; + hal->firmware_sub_version = fw_vesion.sub_version; + hal->firmware_size = fwsize; + } + +exit: + return err; +} + +static int init_mac_flow(struct dvobj_priv *d) +{ + PADAPTER p; + struct hal_com_data *hal; + PHALMAC_ADAPTER halmac; + PHALMAC_API api; + enum _HALMAC_DRV_RSVD_PG_NUM rsvd_page_number; + HALMAC_WLAN_ADDR hwa; + HALMAC_TRX_MODE trx_mode; + HALMAC_RET_STATUS status; + u8 drv_rsvd_num; + u8 nettype; + int err, err_ret = -1; + + + p = dvobj_get_primary_adapter(d); + hal = GET_HAL_DATA(p); + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + +#ifdef CONFIG_SUPPORT_TRX_SHARED + status = api->halmac_cfg_rx_fifo_expanding_mode(halmac, _rtw_get_trx_share_mode(p)); + if (status != HALMAC_RET_SUCCESS) + goto out; +#endif + +#if 0 /* It is not necessary to call this in normal driver */ + status = api->halmac_cfg_la_mode(halmac, HALMAC_LA_MODE_DISABLE); + if (status != HALMAC_RET_SUCCESS) + goto out; +#endif + + err = _cfg_drv_rsvd_pg_num(d); + if (err) + goto out; + +#ifdef CONFIG_USB_HCI + status = api->halmac_set_bulkout_num(halmac, d->RtNumOutPipes); + if (status != HALMAC_RET_SUCCESS) + goto out; +#endif /* CONFIG_USB_HCI */ + + trx_mode = _choose_trx_mode(d); + status = api->halmac_init_mac_cfg(halmac, trx_mode); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err = rtw_halmac_rx_agg_switch(d, _TRUE); + if (err) + goto out; + + nettype = dvobj_to_regsty(d)->wireless_mode; + if (is_supported_vht(nettype) == _TRUE) + status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_AC); + else if (is_supported_ht(nettype) == _TRUE) + status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_N); + else if (IsSupportedTxOFDM(nettype) == _TRUE) + status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_G); + else + status = api->halmac_cfg_operation_mode(halmac, HALMAC_WIRELESS_MODE_B); + if (status != HALMAC_RET_SUCCESS) + goto out; + + err_ret = 0; +out: + return err_ret; +} + +static int _drv_enable_trx(struct dvobj_priv *d) +{ + struct _ADAPTER *adapter; + u32 status; + + + adapter = dvobj_get_primary_adapter(d); + if (adapter->bup == _FALSE) { + status = rtw_start_drv_threads(adapter); + if (status == _FAIL) { + RTW_ERR("%s: Start threads Failed!\n", __FUNCTION__); + return -1; + } + } + + rtw_intf_start(adapter); + + return 0; +} + /* * Notices: * Make sure @@ -1231,7 +2937,7 @@ static int _halmac_init_hal(struct dvobj_priv *d, u8 *fw, u32 fwsize) int err, err_ret = -1; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); halmac = dvobj_to_halmac(d); if (!halmac) goto out; @@ -1245,33 +2951,35 @@ static int _halmac_init_hal(struct dvobj_priv *d, u8 *fw, u32 fwsize) /* halmac_mac_power_switch(on) */ /* halmac_Init_system_cfg */ ok = rtw_hal_power_on(adapter); - if (_FALSE == ok) + if (_FAIL == ok) goto out; /* StatePowerOn */ /* DownloadFW */ - d->hmpriv.send_general_info = 0; if (fw && fwsize) { - err = rtw_halmac_dlfw(d, fw, fwsize); + err = download_fw(d, fw, fwsize, 0); if (err) goto out; fw_ok = _TRUE; } /* InitMACFlow */ - status = init_mac_flow(d); - if (status != HALMAC_RET_SUCCESS) + err = init_mac_flow(d); + if (err) + goto out; + + /* Driver insert flow: Enable TR/RX */ + err = _drv_enable_trx(d); + if (err) goto out; /* halmac_send_general_info */ if (_TRUE == fw_ok) { - d->hmpriv.send_general_info = 0; err = _send_general_info(d); if (err) goto out; - } else - d->hmpriv.send_general_info = 1; + } /* Init Phy parameter-MAC */ ok = rtw_hal_init_mac_register(adapter); @@ -1332,11 +3040,16 @@ int rtw_halmac_init_hal_fw(struct dvobj_priv *d, u8 *fw, u32 fwsize) int rtw_halmac_init_hal_fw_file(struct dvobj_priv *d, u8 *fwpath) { u8 *fw = NULL; - u32 fwmaxsize, size = 0; + u32 fwmaxsize = 0, size = 0; int err = 0; - fwmaxsize = FIRMWARE_MAX_SIZE; + err = rtw_halmac_get_fw_max_size(d, &fwmaxsize); + if (err) { + RTW_ERR("%s: Fail to get Firmware MAX size(err=%d)\n", __FUNCTION__, err); + return -1; + } + fw = rtw_zmalloc(fwmaxsize); if (!fw) return -1; @@ -1365,7 +3078,7 @@ int rtw_halmac_deinit_hal(struct dvobj_priv *d) int err = -1; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); halmac = dvobj_to_halmac(d); if (!halmac) goto out; @@ -1406,73 +3119,253 @@ int rtw_halmac_self_verify(struct dvobj_priv *d) return err; } -int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) +static u8 rtw_halmac_txfifo_is_empty(struct dvobj_priv *d) { - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; - int err = 0; - PHAL_DATA_TYPE hal; - HALMAC_FW_VERSION fw_vesion; + struct _HALMAC_ADAPTER *mac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u32 chk_num = 10; + u8 rst = _FALSE; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_txfifo_is_empty(mac, chk_num); + if (status == HALMAC_RET_SUCCESS) + rst = _TRUE; + + return rst; +} + +/** + * rtw_halmac_txfifo_wait_empty() - Wait TX FIFO to be emtpy + * @d: struct dvobj_priv* + * @timeout: time limit of wait, unit is ms + * 0 for no limit + * + * Wait TX FIFO to be emtpy. + * + * Rteurn 0 for TX FIFO is empty, otherwise not empty. + */ +int rtw_halmac_txfifo_wait_empty(struct dvobj_priv *d, u32 timeout) +{ + struct _ADAPTER *a; + u8 empty = _FALSE; + u32 cnt = 0; + systime start_time = 0; + u32 pass_time; /* ms */ + + + a = dvobj_get_primary_adapter(d); + start_time = rtw_get_current_time(); + + do { + cnt++; + empty = rtw_halmac_txfifo_is_empty(d); + if (empty == _TRUE) + break; + + if (timeout) { + pass_time = rtw_get_passing_time_ms(start_time); + if (pass_time > timeout) + break; + } + if (RTW_CANNOT_IO(a)) { + RTW_WARN("%s: Interrupted by I/O forbiden!\n", __FUNCTION__); + break; + } + + rtw_msleep_os(2); + } while (1); + + if (empty == _FALSE) { +#ifdef CONFIG_RTW_DEBUG + u16 dbg_reg[] = {0x210, 0x230, 0x234, 0x238, 0x23C, 0x240, + 0x41A, 0x10FC, 0x10F8, 0x11F4, 0x11F8}; + u8 i; + u32 val; + + if (!RTW_CANNOT_IO(a)) { + for (i = 0; i < ARRAY_SIZE(dbg_reg); i++) { + val = rtw_read32(a, dbg_reg[i]); + RTW_ERR("REG_%X:0x%08x\n", dbg_reg[i], val); + } + } +#endif /* CONFIG_RTW_DEBUG */ + + RTW_ERR("%s: Fail to wait txfifo empty!(cnt=%d)\n", + __FUNCTION__, cnt); + return -1; + } + + return 0; +} + +static enum _HALMAC_DLFW_MEM _fw_mem_drv2halmac(enum fw_mem mem, u8 tx_stop) +{ + enum _HALMAC_DLFW_MEM mem_halmac = HALMAC_DLFW_MEM_UNDEFINE; + + + switch (mem) { + case FW_EMEM: + if (tx_stop == _FALSE) + mem_halmac = HALMAC_DLFW_MEM_EMEM_RSVD_PG; + else + mem_halmac = HALMAC_DLFW_MEM_EMEM; + break; + + case FW_IMEM: + case FW_DMEM: + mem_halmac = HALMAC_DLFW_MEM_UNDEFINE; + break; + } + + return mem_halmac; +} + +int rtw_halmac_dlfw_mem(struct dvobj_priv *d, u8 *fw, u32 fwsize, enum fw_mem mem) +{ + struct _HALMAC_ADAPTER *mac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + enum _HALMAC_DLFW_MEM dlfw_mem; + u8 tx_stop = _FALSE; + u32 chk_timeout = 2000; /* unit: ms */ + int err = 0; mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); - hal = GET_HAL_DATA(d->padapters[IFACE_ID0]); if ((!fw) || (!fwsize)) return -1; +#ifndef RTW_HALMAC_DLFW_MEM_NO_STOP_TX /* 1. Driver Stop Tx */ /* ToDo */ /* 2. Driver Check Tx FIFO is empty */ - /* ToDo */ + err = rtw_halmac_txfifo_wait_empty(d, chk_timeout); + if (err) + tx_stop = _FALSE; + else + tx_stop = _TRUE; +#endif /* !RTW_HALMAC_DLFW_MEM_NO_STOP_TX */ - /* 3. Config MAX download size */ -#ifdef CONFIG_USB_HCI - /* for USB do not exceed MAX_CMDBUF_SZ */ - api->halmac_cfg_max_dl_size(mac, 0x1000); -#elif defined CONFIG_PCIE_HCI - /* required a even length from u32 */ - api->halmac_cfg_max_dl_size(mac, (MAX_CMDBUF_SZ - TXDESC_OFFSET) & 0xFFFFFFFE); -#endif - - /* 4. Download Firmware */ - status = api->halmac_download_firmware(mac, fw, fwsize); - if (HALMAC_RET_SUCCESS != status) - return -1; - - if (d->hmpriv.send_general_info) { - d->hmpriv.send_general_info = 0; - err = _send_general_info(d); + /* 3. Download Firmware MEM */ + dlfw_mem = _fw_mem_drv2halmac(mem, tx_stop); + if (dlfw_mem == HALMAC_DLFW_MEM_UNDEFINE) { + err = -1; + goto resume_tx; + } + status = api->halmac_free_download_firmware(mac, dlfw_mem, fw, fwsize); + if (status != HALMAC_RET_SUCCESS) { + RTW_ERR("%s: halmac_free_download_firmware fail(err=0x%x)\n", + __FUNCTION__, status); + err = -1; + goto resume_tx; } - /* 5. Driver resume TX if needed */ +resume_tx: +#ifndef RTW_HALMAC_DLFW_MEM_NO_STOP_TX + /* 4. Driver resume TX if needed */ /* ToDo */ - - /* 6. Reset driver variables if needed */ - hal->LastHMEBoxNum = 0; - - - /* 7. Get FW version */ - status = api->halmac_get_fw_version(mac, &fw_vesion); - if (status == HALMAC_RET_SUCCESS) { - hal->FirmwareVersion = fw_vesion.version; - hal->FirmwareSubVersion = fw_vesion.sub_version; - } +#endif /* !RTW_HALMAC_DLFW_MEM_NO_STOP_TX */ return err; } +int rtw_halmac_dlfw_mem_from_file(struct dvobj_priv *d, u8 *fwpath, enum fw_mem mem) +{ + u8 *fw = NULL; + u32 fwmaxsize = 0, size = 0; + int err = 0; + + + err = rtw_halmac_get_fw_max_size(d, &fwmaxsize); + if (err) { + RTW_ERR("%s: Fail to get Firmware MAX size(err=%d)\n", __FUNCTION__, err); + return -1; + } + + fw = rtw_zmalloc(fwmaxsize); + if (!fw) + return -1; + + size = rtw_retrieve_from_file(fwpath, fw, fwmaxsize); + if (size) + err = rtw_halmac_dlfw_mem(d, fw, size, mem); + else + err = -1; + + rtw_mfree(fw, fwmaxsize); + fw = NULL; + + return err; +} + +/* + * Return: + * 0 Success + * -22 Invalid arguemnt + */ +int rtw_halmac_dlfw(struct dvobj_priv *d, u8 *fw, u32 fwsize) +{ + PADAPTER adapter; + HALMAC_RET_STATUS status; + u32 ok = _TRUE; + int err, err_ret = -1; + + + if (!fw || !fwsize) + return -22; + + adapter = dvobj_get_primary_adapter(d); + + /* re-download firmware */ + if (rtw_is_hw_init_completed(adapter)) + return download_fw(d, fw, fwsize, 1); + + /* Download firmware before hal init */ + /* Power on, download firmware and init mac */ + ok = rtw_hal_power_on(adapter); + if (_FAIL == ok) + goto out; + + err = download_fw(d, fw, fwsize, 0); + if (err) { + err_ret = err; + goto out; + } + + err = init_mac_flow(d); + if (err) + goto out; + + err = _send_general_info(d); + if (err) + goto out; + + err_ret = 0; + +out: + return err_ret; +} + int rtw_halmac_dlfw_from_file(struct dvobj_priv *d, u8 *fwpath) { u8 *fw = NULL; - u32 fwmaxsize, size = 0; + u32 fwmaxsize = 0, size = 0; int err = 0; - fwmaxsize = FIRMWARE_MAX_SIZE; + err = rtw_halmac_get_fw_max_size(d, &fwmaxsize); + if (err) { + RTW_ERR("%s: Fail to get Firmware MAX size(err=%d)\n", __FUNCTION__, err); + return -1; + } + fw = rtw_zmalloc(fwmaxsize); if (!fw) return -1; @@ -1508,7 +3401,7 @@ int rtw_halmac_phy_power_switch(struct dvobj_priv *d, u8 enable) HALMAC_RET_STATUS status; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); halmac = dvobj_to_halmac(d); if (!halmac) return -1; @@ -1527,8 +3420,6 @@ static u8 _is_fw_read_cmd_down(PADAPTER adapter, u8 msgbox_num) int retry_cnts = 100; u8 valid; - /* RTW_INFO("_is_fw_read_cmd_down, reg_1cc(%x), msg_box(%d)...\n", rtw_read8(adapter, REG_HMETFR), msgbox_num); */ - do { valid = rtw_read8(adapter, REG_HMETFR) & BIT(msgbox_num); if (0 == valid) @@ -1537,52 +3428,68 @@ static u8 _is_fw_read_cmd_down(PADAPTER adapter, u8 msgbox_num) rtw_msleep_os(1); } while ((!read_down) && (retry_cnts--)); + if (_FALSE == read_down) + RTW_WARN("%s, reg_1cc(%x), msg_box(%d)...\n", __func__, rtw_read8(adapter, REG_HMETFR), msgbox_num); + return read_down; } +/** + * rtw_halmac_send_h2c() - Send H2C to firmware + * @d: struct dvobj_priv* + * @h2c: H2C data buffer, suppose to be 8 bytes + * + * Send H2C to firmware by message box register(0x1D0~0x1D3 & 0x1F0~0x1F3). + * + * Return: 0 if process OK, otherwise fail to send this H2C. + */ int rtw_halmac_send_h2c(struct dvobj_priv *d, u8 *h2c) { - PADAPTER adapter = d->padapters[IFACE_ID0]; + PADAPTER adapter = dvobj_get_primary_adapter(d); PHAL_DATA_TYPE hal = GET_HAL_DATA(adapter); u8 h2c_box_num = 0; u32 msgbox_addr = 0; u32 msgbox_ex_addr = 0; u32 h2c_cmd = 0; u32 h2c_cmd_ex = 0; - s32 ret = _FAIL; + int err = -1; - if (adapter->bFWReady == _FALSE) { - RTW_INFO("%s: return H2C cmd because fw is not ready\n", __FUNCTION__); - return ret; + if (hal->bFWReady == _FALSE) { + RTW_WARN("%s: return H2C cmd because fw is not ready\n", __FUNCTION__); + return err; } if (!h2c) { - RTW_INFO("%s: pbuf is NULL\n", __FUNCTION__); - return ret; + RTW_WARN("%s: pbuf is NULL\n", __FUNCTION__); + return err; } if (rtw_is_surprise_removed(adapter)) { - RTW_INFO("%s: surprise removed\n", __FUNCTION__); - return ret; + RTW_WARN("%s: surprise removed\n", __FUNCTION__); + return err; } _enter_critical_mutex(&d->h2c_fwcmd_mutex, NULL); - /* pay attention to if race condition happened in H2C cmd setting */ + /* pay attention to if race condition happened in H2C cmd setting */ h2c_box_num = hal->LastHMEBoxNum; if (!_is_fw_read_cmd_down(adapter, h2c_box_num)) { - RTW_INFO(" fw read cmd failed...\n"); + RTW_WARN(" fw read cmd failed...\n"); +#ifdef DBG_CONFIG_ERROR_DETECT + hal->srestpriv.self_dect_fw = _TRUE; + hal->srestpriv.self_dect_fw_cnt++; +#endif /* DBG_CONFIG_ERROR_DETECT */ goto exit; } - /* Write Ext command(byte 4 -7) */ + /* Write Ext command (byte 4~7) */ msgbox_ex_addr = REG_HMEBOX_E0 + (h2c_box_num * EX_MESSAGE_BOX_SIZE); _rtw_memcpy((u8 *)(&h2c_cmd_ex), h2c + 4, EX_MESSAGE_BOX_SIZE); h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); rtw_write32(adapter, msgbox_ex_addr, h2c_cmd_ex); - /* Write command (byte 0 -3 ) */ + /* Write command (byte 0~3) */ msgbox_addr = REG_HMEBOX0 + (h2c_box_num * MESSAGE_BOX_SIZE); _rtw_memcpy((u8 *)(&h2c_cmd), h2c, 4); h2c_cmd = le32_to_cpu(h2c_cmd); @@ -1590,13 +3497,31 @@ int rtw_halmac_send_h2c(struct dvobj_priv *d, u8 *h2c) /* update last msg box number */ hal->LastHMEBoxNum = (h2c_box_num + 1) % MAX_H2C_BOX_NUMS; - ret = _SUCCESS; + err = 0; +#ifdef DBG_H2C_CONTENT + RTW_INFO_DUMP("[H2C] - ", h2c, RTW_HALMAC_H2C_MAX_SIZE); +#endif exit: _exit_critical_mutex(&d->h2c_fwcmd_mutex, NULL); - return ret; + return err; } +/** + * rtw_halmac_c2h_handle() - Handle C2H for HALMAC + * @d: struct dvobj_priv* + * @c2h: Full C2H packet, including RX description and payload + * @size: Size(byte) of c2h + * + * Send C2H packet to HALMAC to process C2H packets, and the expected C2H ID is + * 0xFF. This function won't have any I/O, so caller doesn't have to call it in + * I/O safe place(ex. command thread). + * + * Please sure doesn't call this function in the same thread as someone is + * waiting HALMAC C2H ack, otherwise there is a deadlock happen. + * + * Return: 0 if process OK, otherwise no action for this C2H. + */ int rtw_halmac_c2h_handle(struct dvobj_priv *d, u8 *c2h, u32 size) { PHALMAC_ADAPTER mac; @@ -1614,6 +3539,25 @@ int rtw_halmac_c2h_handle(struct dvobj_priv *d, u8 *c2h, u32 size) return 0; } +int rtw_halmac_get_available_efuse_size(struct dvobj_priv *d, u32 *size) +{ + PHALMAC_ADAPTER mac; + PHALMAC_API api; + HALMAC_RET_STATUS status; + u32 val; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + + status = api->halmac_get_efuse_available_size(mac, &val); + if (HALMAC_RET_SUCCESS != status) + return -1; + + *size = val; + return 0; +} + int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *d, u32 *size) { PHALMAC_ADAPTER mac; @@ -1650,7 +3594,7 @@ int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) if (ret) return -1; - status = api->halmac_dump_efuse_map(mac, HALMAC_EFUSE_R_AUTO); + status = api->halmac_dump_efuse_map(mac, HALMAC_EFUSE_R_DRV); if (HALMAC_RET_SUCCESS != status) { free_halmac_event(d, id); return -1; @@ -1670,19 +3614,40 @@ int rtw_halmac_read_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 HALMAC_RET_STATUS status; u8 v; u32 i; + u8 *efuse = NULL; + u32 size = 0; + int err = 0; mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); - for (i = 0; i < cnt; i++) { - status = api->halmac_read_efuse(mac, offset + i, &v); - if (HALMAC_RET_SUCCESS != status) + if (api->halmac_read_efuse) { + for (i = 0; i < cnt; i++) { + status = api->halmac_read_efuse(mac, offset + i, &v); + if (HALMAC_RET_SUCCESS != status) + return -1; + data[i] = v; + } + } else { + err = rtw_halmac_get_physical_efuse_size(d, &size); + if (err) return -1; - data[i] = v; + + efuse = rtw_zmalloc(size); + if (!efuse) + return -1; + + err = rtw_halmac_read_physical_efuse_map(d, efuse, size); + if (err) + err = -1; + else + _rtw_memcpy(data, efuse + offset, cnt); + + rtw_mfree(efuse, size); } - return 0; + return err; } int rtw_halmac_write_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u8 *data) @@ -1696,6 +3661,9 @@ int rtw_halmac_write_physical_efuse(struct dvobj_priv *d, u32 offset, u32 cnt, u mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); + if (api->halmac_write_efuse == NULL) + return -1; + for (i = 0; i < cnt; i++) { status = api->halmac_write_efuse(mac, offset + i, data[i]); if (HALMAC_RET_SUCCESS != status) @@ -1724,7 +3692,7 @@ int rtw_halmac_get_logical_efuse_size(struct dvobj_priv *d, u32 *size) return 0; } -int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) +int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size, u8 *maskmap, u32 masksize) { PHALMAC_ADAPTER mac; PHALMAC_API api; @@ -1741,7 +3709,7 @@ int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) if (ret) return -1; - status = api->halmac_dump_logical_efuse_map(mac, HALMAC_EFUSE_R_AUTO); + status = api->halmac_dump_logical_efuse_map(mac, HALMAC_EFUSE_R_DRV); if (HALMAC_RET_SUCCESS != status) { free_halmac_event(d, id); return -1; @@ -1751,6 +3719,19 @@ int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *d, u8 *map, u32 size) if (ret) return -1; + if (maskmap && masksize) { + struct _HALMAC_PG_EFUSE_INFO pginfo; + + pginfo.pEfuse_map = map; + pginfo.efuse_map_size = size; + pginfo.pEfuse_mask = maskmap; + pginfo.efuse_mask_size = masksize; + + status = api->halmac_mask_logical_efuse(mac, &pginfo); + if (status != HALMAC_RET_SUCCESS) + RTW_WARN("%s: mask logical efuse FAIL!\n", __FUNCTION__); + } + return 0; } @@ -1855,7 +3836,7 @@ int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 siz api = HALMAC_GET_API(mac); status = api->halmac_dump_efuse_map_bt(mac, bank, size, map); - if (HALMAC_RET_SUCCESS != status) { + if (HALMAC_RET_SUCCESS != status) { printk("%s: halmac_dump_efuse_map_bt fail!\n", __FUNCTION__); return -1; } @@ -1865,148 +3846,83 @@ int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *d, u8 *map, u32 siz return 0; } -static inline u8 _hw_port_drv2halmac(enum _hw_port hwport) +static enum _HAL_FIFO_SEL _fifo_sel_drv2halmac(u8 fifo_sel) { - u8 port = 0; - - - switch (hwport) { - case HW_PORT0: - port = 0; - break; - case HW_PORT1: - port = 1; - break; - case HW_PORT2: - port = 2; - break; - case HW_PORT3: - port = 3; - break; - case HW_PORT4: - port = 4; - break; - default: - port = hwport; - break; + switch (fifo_sel) { + case 0: + return HAL_FIFO_SEL_TX; + case 1: + return HAL_FIFO_SEL_RX; + case 2: + return HAL_FIFO_SEL_RSVD_PAGE; + case 3: + return HAL_FIFO_SEL_REPORT; + case 4: + return HAL_FIFO_SEL_LLT; + case 5: + return HAL_FIFO_SEL_RXBUF_FW; } - return port; + return HAL_FIFO_SEL_RSVD_PAGE; } -int rtw_halmac_set_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -{ - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - u8 port; - HALMAC_WLAN_ADDR hwa; - HALMAC_RET_STATUS status; - int err = -1; - - - halmac = dvobj_to_halmac(d); - api = HALMAC_GET_API(halmac); - - port = _hw_port_drv2halmac(hwport); - _rtw_memset(&hwa, 0, sizeof(hwa)); - _rtw_memcpy(hwa.Address, addr, 6); - - status = api->halmac_cfg_mac_addr(halmac, port, &hwa); - if (status != HALMAC_RET_SUCCESS) - goto out; - - err = 0; -out: - return err; -} - -int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr) -{ - PHALMAC_ADAPTER halmac; - PHALMAC_API api; - u8 port; - HALMAC_WLAN_ADDR hwa; - HALMAC_RET_STATUS status; - int err = -1; - - halmac = dvobj_to_halmac(d); - api = HALMAC_GET_API(halmac); - port = _hw_port_drv2halmac(hwport); - - _rtw_memset(&hwa, 0, sizeof(HALMAC_WLAN_ADDR)); - _rtw_memcpy(hwa.Address, addr, 6); - status = api->halmac_cfg_bssid(halmac, port, &hwa); - if (status != HALMAC_RET_SUCCESS) - goto out; - - err = 0; -out: - return err; -} - -int rtw_halmac_set_bandwidth(struct dvobj_priv *d, u8 channel, u8 pri_ch_idx, u8 bw) -{ - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; - - - mac = dvobj_to_halmac(d); - api = HALMAC_GET_API(mac); - - status = api->halmac_cfg_ch_bw(mac, channel, pri_ch_idx, bw); - if (HALMAC_RET_SUCCESS != status) - return -1; - - return 0; -} - -int rtw_halmac_get_hw_value(struct dvobj_priv *d, HALMAC_HW_ID hw_id, VOID *pvalue) -{ - PHALMAC_ADAPTER mac; - PHALMAC_API api; - HALMAC_RET_STATUS status; - - - mac = dvobj_to_halmac(d); - api = HALMAC_GET_API(mac); - - status = api->halmac_get_hw_value(mac, hw_id, pvalue); - if (HALMAC_RET_SUCCESS != status) - return -1; - - return 0; -} - -int rtw_halmac_dump_fifo(struct dvobj_priv *d, HAL_FIFO_SEL halmac_fifo_sel) +/*#define CONFIG_HALMAC_FIFO_DUMP*/ +int rtw_halmac_dump_fifo(struct dvobj_priv *d, u8 fifo_sel, u32 addr, u32 size, u8 *buffer) { PHALMAC_ADAPTER mac; PHALMAC_API api; HALMAC_RET_STATUS status; u8 *pfifo_map = NULL; u32 fifo_size = 0; - s8 ret = 0; + s8 ret = 0;/* 0:success, -1:error */ + u8 mem_created = _FALSE; + + HAL_FIFO_SEL halmac_fifo_sel; mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); - fifo_size = api->halmac_get_fifo_size(mac, halmac_fifo_sel); - if (fifo_size) - pfifo_map = rtw_vmalloc(fifo_size); - if (pfifo_map == NULL) + if ((size != 0) && (buffer == NULL)) return -1; - status = api->halmac_dump_fifo(mac, halmac_fifo_sel, pfifo_map, fifo_size); + halmac_fifo_sel = _fifo_sel_drv2halmac(fifo_sel); + + if ((size) && (buffer)) { + pfifo_map = buffer; + fifo_size = size; + } else { + fifo_size = api->halmac_get_fifo_size(mac, halmac_fifo_sel); + + if (fifo_size) + pfifo_map = rtw_zvmalloc(fifo_size); + if (pfifo_map == NULL) + return -1; + mem_created = _TRUE; + } + + status = api->halmac_dump_fifo(mac, halmac_fifo_sel, addr, fifo_size, pfifo_map); if (HALMAC_RET_SUCCESS != status) { ret = -1; goto _exit; } -_exit: - if (pfifo_map) - rtw_vmfree(pfifo_map, fifo_size); - return ret; +#ifdef CONFIG_HALMAC_FIFO_DUMP + { + static const char * const fifo_sel_str[] = { + "TX", "RX", "RSVD_PAGE", "REPORT", "LLT", "RXBUF_FW" + }; + RTW_INFO("%s FIFO DUMP [start_addr:0x%04x , size:%d]\n", fifo_sel_str[halmac_fifo_sel], addr, fifo_size); + RTW_INFO_DUMP("\n", pfifo_map, fifo_size); + RTW_INFO(" ==================================================\n"); + } +#endif /* CONFIG_HALMAC_FIFO_DUMP */ + +_exit: + if ((mem_created == _TRUE) && pfifo_map) + rtw_vmfree(pfifo_map, fifo_size); + + return ret; } int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) @@ -2020,7 +3936,7 @@ int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) int err = -1; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); hal = GET_HAL_DATA(adapter); halmac = dvobj_to_halmac(d); api = HALMAC_GET_API(halmac); @@ -2068,76 +3984,6 @@ int rtw_halmac_rx_agg_switch(struct dvobj_priv *d, u8 enable) return err; } -int rtw_halmac_get_wow_reason(struct dvobj_priv *d, u8 *reason) -{ - PADAPTER adapter; - u8 val8; - int err = -1; - - - adapter = d->padapters[IFACE_ID0]; - - val8 = rtw_read8(adapter, 0x1C7); - if (val8 == 0xEA) - goto out; - - *reason = val8; - err = 0; -out: - return err; -} - -/* - * Description: - * Get RX driver info size. RX driver info is a small memory space between - * scriptor and RX payload. - * - * +-------------------------+ - * | RX descriptor | - * | usually 24 bytes | - * +-------------------------+ - * | RX driver info | - * | depends on driver cfg | - * +-------------------------+ - * | RX paylad | - * | | - * +-------------------------+ - * - * Parameter: - * d pointer to struct dvobj_priv of driver - * sz rx driver info size in bytes. - * - * Rteurn: - * 0 Success - * other Fail - */ -int rtw_halmac_get_drv_info_sz(struct dvobj_priv *d, u8 *sz) -{ - HALMAC_RET_STATUS status; - PHALMAC_ADAPTER halmac = dvobj_to_halmac(d); - PHALMAC_API api = HALMAC_GET_API(halmac); - u8 dw = 0; - - status = api->halmac_get_hw_value(halmac, HALMAC_HW_DRV_INFO_SIZE, &dw); - if (status != HALMAC_RET_SUCCESS) - return -1; - - *sz = dw * 8; - return 0; -} -int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *dvobj, u16 *drv_pg) -{ - HALMAC_RET_STATUS status; - PHALMAC_ADAPTER halmac = dvobj_to_halmac(dvobj); - PHALMAC_API api = HALMAC_GET_API(halmac); - - status = api->halmac_get_hw_value(halmac, HALMAC_HW_RSVD_PG_BNDY, drv_pg); - if (status != HALMAC_RET_SUCCESS) - return -1; - - return 0; -} - int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size) { HALMAC_RET_STATUS status = HALMAC_RET_SUCCESS; @@ -2149,7 +3995,264 @@ int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pb return -1; return 0; +} +/* + * Description + * Fill following spec info from HALMAC API: + * sec_cam_ent_num + * + * Return + * 0 Success + * others Fail + */ +int rtw_halmac_fill_hal_spec(struct dvobj_priv *dvobj, struct hal_spec_t *spec) +{ + HALMAC_RET_STATUS status; + PHALMAC_ADAPTER halmac; + PHALMAC_API api; + u8 cam = 0; /* Security Cam Entry Number */ + + + halmac = dvobj_to_halmac(dvobj); + api = HALMAC_GET_API(halmac); + + /* Prepare data from HALMAC */ + status = api->halmac_get_hw_value(halmac, HALMAC_HW_CAM_ENTRY_NUM, &cam); + if (status != HALMAC_RET_SUCCESS) + return -1; + + /* Fill data to hal_spec_t */ + spec->sec_cam_ent_num = cam; + + return 0; +} + +int rtw_halmac_p2pps(struct dvobj_priv *dvobj, PHAL_P2P_PS_PARA pp2p_ps_para) +{ + HALMAC_RET_STATUS status = HALMAC_RET_SUCCESS; + PHALMAC_ADAPTER halmac = dvobj_to_halmac(dvobj); + PHALMAC_API api = HALMAC_GET_API(halmac); + HALMAC_P2PPS halmac_p2p_ps; + + (&halmac_p2p_ps)->offload_en = pp2p_ps_para->offload_en; + (&halmac_p2p_ps)->role = pp2p_ps_para->role; + (&halmac_p2p_ps)->ctwindow_en = pp2p_ps_para->ctwindow_en; + (&halmac_p2p_ps)->noa_en = pp2p_ps_para->noa_en; + (&halmac_p2p_ps)->noa_sel = pp2p_ps_para->noa_sel; + (&halmac_p2p_ps)->all_sta_sleep = pp2p_ps_para->all_sta_sleep; + (&halmac_p2p_ps)->discovery = pp2p_ps_para->discovery; + (&halmac_p2p_ps)->p2p_port_id = _hw_port_drv2halmac(pp2p_ps_para->p2p_port_id); + (&halmac_p2p_ps)->p2p_group = pp2p_ps_para->p2p_group; + (&halmac_p2p_ps)->p2p_macid = pp2p_ps_para->p2p_macid; + (&halmac_p2p_ps)->ctwindow_length = pp2p_ps_para->ctwindow_length; + (&halmac_p2p_ps)->noa_duration_para = pp2p_ps_para->noa_duration_para; + (&halmac_p2p_ps)->noa_interval_para = pp2p_ps_para->noa_interval_para; + (&halmac_p2p_ps)->noa_start_time_para = pp2p_ps_para->noa_start_time_para; + (&halmac_p2p_ps)->noa_count_para = pp2p_ps_para->noa_count_para; + + status = api->halmac_p2pps(halmac, (&halmac_p2p_ps)); + if (status != HALMAC_RET_SUCCESS) + return -1; + + return 0; + +} + +/** + * rtw_halmac_iqk() - Run IQ Calibration + * @d: struct dvobj_priv* + * @clear: IQK parameters + * @segment: IQK parameters + * + * Process IQ Calibration(IQK). + * + * Rteurn: 0 for OK, otherwise fail. + */ +int rtw_halmac_iqk(struct dvobj_priv *d, u8 clear, u8 segment) +{ + PHALMAC_ADAPTER mac; + PHALMAC_API api; + HALMAC_RET_STATUS status; + HALMAC_FEATURE_ID id; + HALMAC_IQK_PARA para; + int ret; + u8 retry = 3; + u8 delay = 1; /* ms */ + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + id = HALMAC_FEATURE_IQK; + + ret = init_halmac_event(d, id, NULL, 0); + if (ret) + return -1; + + para.clear = clear; + para.segment_iqk = segment; + + do { + status = api->halmac_start_iqk(mac, ¶); + if (status != HALMAC_RET_BUSY_STATE) + break; + RTW_WARN("%s: Fail to start IQK, status is BUSY! retry=%d\n", __FUNCTION__, retry); + if (!retry) + break; + retry--; + rtw_msleep_os(delay); + } while (1); + if (status != HALMAC_RET_SUCCESS) { + free_halmac_event(d, id); + return -1; + } + + ret = wait_halmac_event(d, id); + if (ret) + return -1; + + return 0; +} + +static int _phy_parameter_drv2halmac(struct rtw_phy_parameter *para, struct _HALMAC_PHY_PARAMETER_INFO *info) +{ + if (!para || !info) + return -1; + + _rtw_memset(info, 0, sizeof(*info)); + + switch (para->cmd) { + case 0: + /* MAC register */ + switch (para->data.mac.size) { + case 1: + info->cmd_id = HALMAC_PARAMETER_CMD_MAC_W8; + break; + case 2: + info->cmd_id = HALMAC_PARAMETER_CMD_MAC_W16; + break; + default: + info->cmd_id = HALMAC_PARAMETER_CMD_MAC_W32; + break; + } + info->content.MAC_REG_W.value = para->data.mac.value; + info->content.MAC_REG_W.msk = para->data.mac.msk; + info->content.MAC_REG_W.offset = para->data.mac.offset; + info->content.MAC_REG_W.msk_en = para->data.mac.msk_en; + break; + + case 1: + /* BB register */ + switch (para->data.bb.size) { + case 1: + info->cmd_id = HALMAC_PARAMETER_CMD_BB_W8; + break; + case 2: + info->cmd_id = HALMAC_PARAMETER_CMD_BB_W16; + break; + default: + info->cmd_id = HALMAC_PARAMETER_CMD_BB_W32; + break; + } + info->content.BB_REG_W.value = para->data.mac.value; + info->content.BB_REG_W.msk = para->data.mac.msk; + info->content.BB_REG_W.offset = para->data.mac.offset; + info->content.BB_REG_W.msk_en = para->data.mac.msk_en; + break; + + case 2: + /* RF register */ + info->cmd_id = HALMAC_PARAMETER_CMD_RF_W; + info->content.RF_REG_W.value = para->data.rf.value; + info->content.RF_REG_W.msk = para->data.rf.msk; + info->content.RF_REG_W.offset = para->data.rf.offset; + info->content.RF_REG_W.msk_en = para->data.rf.msk_en; + info->content.RF_REG_W.rf_path = para->data.rf.path; + break; + + case 3: + /* Delay register */ + if (para->data.delay.unit == 0) + info->cmd_id = HALMAC_PARAMETER_CMD_DELAY_US; + else + info->cmd_id = HALMAC_PARAMETER_CMD_DELAY_MS; + info->content.DELAY_TIME.delay_time = para->data.delay.value; + break; + + case 0xFF: + /* Latest(End) command */ + info->cmd_id = HALMAC_PARAMETER_CMD_END; + break; + + default: + return -1; + } + + return 0; +} + +/** + * rtw_halmac_cfg_phy_para() - Register(Phy parameter) configuration + * @d: struct dvobj_priv* + * @para: phy parameter + * + * Configure registers by firmware using H2C/C2H mechanism. + * The latest command should be para->cmd==0xFF(End command) to finish all + * processes. + * + * Return: 0 for OK, otherwise fail. + */ +int rtw_halmac_cfg_phy_para(struct dvobj_priv *d, struct rtw_phy_parameter *para) +{ + struct _HALMAC_ADAPTER *mac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + enum _HALMAC_FEATURE_ID id; + struct _HALMAC_PHY_PARAMETER_INFO info; + u8 full_fifo; + int err, ret; + + + mac = dvobj_to_halmac(d); + api = HALMAC_GET_API(mac); + id = HALMAC_FEATURE_CFG_PARA; + full_fifo = 1; /* ToDo: How to deciede? */ + ret = 0; + + err = _phy_parameter_drv2halmac(para, &info); + if (err) + return -1; + + err = init_halmac_event(d, id, NULL, 0); + if (err) + return -1; + + status = api->halmac_cfg_parameter(mac, &info, full_fifo); + if (info.cmd_id == HALMAC_PARAMETER_CMD_END) { + if (status == HALMAC_RET_SUCCESS) { + err = wait_halmac_event(d, id); + if (err) + ret = -1; + } else { + free_halmac_event(d, id); + ret = -1; + RTW_ERR("%s: Fail to send END of cfg parameter, status is 0x%x!\n", __FUNCTION__, status); + } + } else { + if (status == HALMAC_RET_PARA_SENDING) { + err = wait_halmac_event(d, id); + if (err) + ret = -1; + } else { + free_halmac_event(d, id); + if (status != HALMAC_RET_SUCCESS) { + ret = -1; + RTW_ERR("%s: Fail to cfg parameter, status is 0x%x!\n", __FUNCTION__, status); + } + } + } + + return ret; } #ifdef CONFIG_SDIO_HCI @@ -2178,7 +4281,7 @@ int rtw_halmac_query_tx_page_num(struct dvobj_priv *d) u8 i; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); hmpriv = &d->hmpriv; halmac = dvobj_to_halmac(d); api = HALMAC_GET_API(halmac); @@ -2338,6 +4441,35 @@ u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *d, u8 *buf, u32 size) return bulkout_id; } +/** + * rtw_halmac_usb_get_txagg_desc_num() - MAX descriptor number in one bulk for TX + * @d: struct dvobj_priv* + * @size: TX FIFO size, unit is byte. + * + * Get MAX descriptor number in one bulk out from HALMAC. + * + * Rteurn 0 for OK, otherwise fail. + */ +int rtw_halmac_usb_get_txagg_desc_num(struct dvobj_priv *d, u8 *num) +{ + struct _HALMAC_ADAPTER *halmac; + struct _HALMAC_API *api; + enum _HALMAC_RET_STATUS status; + u8 val = 0; + + + halmac = dvobj_to_halmac(d); + api = HALMAC_GET_API(halmac); + + status = api->halmac_get_hw_value(halmac, HALMAC_HW_USB_TXAGG_DESC_NUM, &val); + if (status != HALMAC_RET_SUCCESS) + return -1; + + *num = val; + + return 0; +} + static inline HALMAC_USB_MODE _usb_mode_drv2halmac(enum RTW_USB_SPEED usb_mode) { HALMAC_USB_MODE halmac_usb_mode = HALMAC_USB_MODE_U2; @@ -2365,7 +4497,7 @@ u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode) PADAPTER adapter; HALMAC_USB_MODE halmac_usb_mode; - adapter = d->padapters[IFACE_ID0]; + adapter = dvobj_get_primary_adapter(d); mac = dvobj_to_halmac(d); api = HALMAC_GET_API(mac); halmac_usb_mode = _usb_mode_drv2halmac(usb_mode); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.h index 2864011c8ef3..c08d7b6c0055 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_halmac.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,20 +11,16 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _HAL_HALMAC_H_ #define _HAL_HALMAC_H_ #include /* adapter_to_dvobj(), struct intf_hdl and etc. */ +#include /* struct hal_spec_t */ #include "halmac/halmac_api.h" /* PHALMAC_ADAPTER and etc. */ /* HALMAC Definition for Driver */ -#define RTW_HALMAC_H2C_MAX_SIZE HALMAC_H2C_CMD_ORIGINAL_SIZE_88XX +#define RTW_HALMAC_H2C_MAX_SIZE 8 #define RTW_HALMAC_BA_SSN_RPT_SIZE 4 #define dvobj_set_halmac(d, mac) ((d)->halmac = (mac)) @@ -41,6 +37,66 @@ typedef enum _RTW_HALMAC_MODE { RTW_HALMAC_MODE_WIFI_TEST, } RTW_HALMAC_MODE; +union rtw_phy_para_data { + struct _mac { + u32 value; + u32 msk; + u16 offset; + u8 msk_en; /* Enable bit mask(msk) or not */ + u8 size; /* Unit is bytes, and value should be 1/2/4 */ + } mac; + struct _bb { + u32 value; + u32 msk; + u16 offset; + u8 msk_en; + u8 size; + } bb; + struct _rf { + u32 value; + u32 msk; + u8 offset; + u8 msk_en; + /* + * 0: path A + * 1: path B + * 2: path C + * 3: path D + */ + u8 path; + } rf; + struct _delay { + /* + * 0: microsecond (us) + * 1: millisecond (ms) + */ + u8 unit; + u16 value; + } delay; +}; + +struct rtw_phy_parameter { + /* + * 0: MAC register + * 1: BB register + * 2: RF register + * 3: Delay + * 0xFF: Latest(End) command + */ + u8 cmd; + union rtw_phy_para_data data; +}; + +struct rtw_halmac_bcn_ctrl { + u8 rx_bssid_fit:1; /* 0:HW handle beacon, 1:ignore */ + u8 txbcn_rpt:1; /* Enable TXBCN report in ad hoc and AP mode */ + u8 tsf_update:1; /* Update TSF when beacon or probe response */ + u8 enable_bcn:1; /* Enable beacon related functions */ + u8 rxbcn_rpt:1; /* Enable RXBCNOK report */ + u8 p2p_ctwin:1; /* Enable P2P CTN WINDOWS function */ + u8 p2p_bcn_area:1; /* Enable P2P BCN area on function */ +}; + extern HALMAC_PLATFORM_API rtw_halmac_platform_api; /* HALMAC API for Driver(HAL) */ @@ -52,13 +108,52 @@ void rtw_halmac_read_mem(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem) u8 rtw_halmac_iread8(struct intf_hdl *pintfhdl, u32 addr); u16 rtw_halmac_iread16(struct intf_hdl *pintfhdl, u32 addr); u32 rtw_halmac_iread32(struct intf_hdl *pintfhdl, u32 addr); -#endif +#endif /* CONFIG_SDIO_INDIRECT_ACCESS */ int rtw_halmac_write8(struct intf_hdl *, u32 addr, u8 value); int rtw_halmac_write16(struct intf_hdl *, u32 addr, u16 value); int rtw_halmac_write32(struct intf_hdl *, u32 addr, u32 value); +/* Software Information */ +void rtw_halmac_get_version(char *str, u32 len); + +/* Software Initialization */ int rtw_halmac_init_adapter(struct dvobj_priv *, PHALMAC_PLATFORM_API); int rtw_halmac_deinit_adapter(struct dvobj_priv *); + +/* Get operations */ +int rtw_halmac_get_hw_value(struct dvobj_priv *, HALMAC_HW_ID hw_id, VOID *pvalue); +int rtw_halmac_get_tx_fifo_size(struct dvobj_priv *d, u32 *size); +int rtw_halmac_get_rx_fifo_size(struct dvobj_priv *d, u32 *size); +int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *d, u16 *bndy); +int rtw_halmac_get_page_size(struct dvobj_priv *d, u32 *size); +int rtw_halmac_get_tx_agg_align_size(struct dvobj_priv *d, u16 *size); +int rtw_halmac_get_rx_agg_align_size(struct dvobj_priv *d, u8 *size); +int rtw_halmac_get_rx_drv_info_sz(struct dvobj_priv *, u8 *sz); +int rtw_halmac_get_tx_desc_size(struct dvobj_priv *d, u32 *size); +int rtw_halmac_get_rx_desc_size(struct dvobj_priv *d, u32 *size); +int rtw_halmac_get_ori_h2c_size(struct dvobj_priv *d, u32 *size); +int rtw_halmac_get_oqt_size(struct dvobj_priv *d, u8 *size); +int rtw_halmac_get_ac_queue_number(struct dvobj_priv *d, u8 *num); +int rtw_halmac_get_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); +int rtw_halmac_get_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 *type); +int rtw_halmac_get_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, struct rtw_halmac_bcn_ctrl *bcn_ctrl); +/*int rtw_halmac_get_wow_reason(struct dvobj_priv *, u8 *reason);*/ + +/* Set operations */ +int rtw_halmac_config_rx_info(struct dvobj_priv *, HALMAC_DRV_INFO); +int rtw_halmac_set_max_dl_fw_size(struct dvobj_priv *d, u32 size); +int rtw_halmac_set_mac_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); +int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); +int rtw_halmac_set_tx_address(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); +int rtw_halmac_set_network_type(struct dvobj_priv *d, enum _hw_port hwport, u8 type); +int rtw_halmac_reset_tsf(struct dvobj_priv *d, enum _hw_port hwport); +int rtw_halmac_set_bcn_interval(struct dvobj_priv *d, enum _hw_port hwport, u32 space); +int rtw_halmac_set_bcn_ctrl(struct dvobj_priv *d, enum _hw_port hwport, struct rtw_halmac_bcn_ctrl *bcn_ctrl); +int rtw_halmac_set_aid(struct dvobj_priv *d, enum _hw_port hwport, u16 aid); +int rtw_halmac_set_bandwidth(struct dvobj_priv *d, u8 channel, u8 pri_ch_idx, u8 bw); +int rtw_halmac_set_edca(struct dvobj_priv *d, u8 queue, u8 aifs, u8 cw, u16 txop); + +/* Functions */ int rtw_halmac_poweron(struct dvobj_priv *); int rtw_halmac_poweroff(struct dvobj_priv *); int rtw_halmac_init_hal(struct dvobj_priv *); @@ -66,18 +161,23 @@ int rtw_halmac_init_hal_fw(struct dvobj_priv *, u8 *fw, u32 fwsize); int rtw_halmac_init_hal_fw_file(struct dvobj_priv *, u8 *fwpath); int rtw_halmac_deinit_hal(struct dvobj_priv *); int rtw_halmac_self_verify(struct dvobj_priv *); +int rtw_halmac_txfifo_wait_empty(struct dvobj_priv *d, u32 timeout); int rtw_halmac_dlfw(struct dvobj_priv *, u8 *fw, u32 fwsize); int rtw_halmac_dlfw_from_file(struct dvobj_priv *, u8 *fwpath); +int rtw_halmac_dlfw_mem(struct dvobj_priv *d, u8 *fw, u32 fwsize, enum fw_mem mem); +int rtw_halmac_dlfw_mem_from_file(struct dvobj_priv *d, u8 *fwpath, enum fw_mem mem); int rtw_halmac_phy_power_switch(struct dvobj_priv *, u8 enable); int rtw_halmac_send_h2c(struct dvobj_priv *, u8 *h2c); int rtw_halmac_c2h_handle(struct dvobj_priv *, u8 *c2h, u32 size); +/* eFuse */ +int rtw_halmac_get_available_efuse_size(struct dvobj_priv *d, u32 *size); int rtw_halmac_get_physical_efuse_size(struct dvobj_priv *, u32 *size); int rtw_halmac_read_physical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); int rtw_halmac_read_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); int rtw_halmac_write_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); int rtw_halmac_get_logical_efuse_size(struct dvobj_priv *, u32 *size); -int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); +int rtw_halmac_read_logical_efuse_map(struct dvobj_priv *, u8 *map, u32 size, u8 *maskmap, u32 masksize); int rtw_halmac_write_logical_efuse_map(struct dvobj_priv *, u8 *map, u32 size, u8 *maskmap, u32 masksize); int rtw_halmac_read_logical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); int rtw_halmac_write_logical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); @@ -85,19 +185,15 @@ int rtw_halmac_write_logical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 int rtw_halmac_write_bt_physical_efuse(struct dvobj_priv *, u32 offset, u32 cnt, u8 *data); int rtw_halmac_read_bt_physical_efuse_map(struct dvobj_priv *, u8 *map, u32 size); -int rtw_halmac_config_rx_info(struct dvobj_priv *, HALMAC_DRV_INFO); -int rtw_halmac_set_mac_address(struct dvobj_priv *, enum _hw_port, u8 *addr); -int rtw_halmac_set_bssid(struct dvobj_priv *d, enum _hw_port hwport, u8 *addr); - -int rtw_halmac_set_bandwidth(struct dvobj_priv *, u8 channel, u8 pri_ch_idx, u8 bw); +int rtw_halmac_dump_fifo(struct dvobj_priv *d, u8 fifo_sel, u32 addr, u32 size, u8 *buffer); int rtw_halmac_rx_agg_switch(struct dvobj_priv *, u8 enable); -int rtw_halmac_get_hw_value(struct dvobj_priv *d, HALMAC_HW_ID hw_id, VOID *pvalue); -int rtw_halmac_get_wow_reason(struct dvobj_priv *, u8 *reason); -int rtw_halmac_get_drv_info_sz(struct dvobj_priv *d, u8 *sz); - -int rtw_halmac_get_rsvd_drv_pg_bndy(struct dvobj_priv *dvobj, u16 *drv_pg); +/* Specific function APIs*/ int rtw_halmac_download_rsvd_page(struct dvobj_priv *dvobj, u8 pg_offset, u8 *pbuf, u32 size); +int rtw_halmac_fill_hal_spec(struct dvobj_priv *, struct hal_spec_t *); +int rtw_halmac_p2pps(struct dvobj_priv *dvobj, PHAL_P2P_PS_PARA pp2p_ps_para); +int rtw_halmac_iqk(struct dvobj_priv *d, u8 clear, u8 segment); +int rtw_halmac_cfg_phy_para(struct dvobj_priv *d, struct rtw_phy_parameter *para); #ifdef CONFIG_SDIO_HCI int rtw_halmac_query_tx_page_num(struct dvobj_priv *); @@ -109,6 +205,7 @@ u32 rtw_halmac_sdio_get_rx_addr(struct dvobj_priv *, u8 *seq); #ifdef CONFIG_USB_HCI u8 rtw_halmac_usb_get_bulkout_id(struct dvobj_priv *, u8 *buf, u32 size); +int rtw_halmac_usb_get_txagg_desc_num(struct dvobj_priv *d, u8 *num); u8 rtw_halmac_switch_usb_mode(struct dvobj_priv *d, enum RTW_USB_SPEED usb_mode); #endif /* CONFIG_USB_HCI */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_hci/hal_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_hci/hal_sdio.c index bce1cf94f75d..9bcd8cee3da9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_hci/hal_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_hci/hal_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,72 +11,13 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_SDIO_C_ #include #include #ifndef RTW_HALMAC -static void dump_sdio_f0(PADAPTER padapter) -{ - char str_out[128]; - char str_val[8]; - char *p = NULL; - int index = 0, i = 0; - u8 val8 = 0, len = 0; - - RTW_ERR("Dump SDIO function_0 register:\n"); - for (index = 0 ; index < 0x100 ; index += 16) { - p = &str_out[0]; - len = snprintf(str_val, sizeof(str_val), - "0x%02x: ", index); - strncpy(str_out, str_val, len); - p += len; - - for (i = 0 ; i < 16 ; i++) { - len = snprintf(str_val, sizeof(str_val), "%02x ", - rtw_sd_f0_read8(padapter, index + i)); - strncpy(p, str_val, len); - p += len; - } - RTW_INFO("%s\n", str_out); - _rtw_memset(&str_out, '\0', sizeof(str_out)); - } -} - -static void dump_sdio_local(PADAPTER padapter) -{ - char str_out[128]; - char str_val[8]; - char *p = NULL; - int index = 0, i = 0; - u8 val8 = 0, len = 0; - - RTW_ERR("Dump SDIO local register:\n"); - for (index = 0 ; index < 0x100 ; index += 16) { - p = &str_out[0]; - len = snprintf(str_val, sizeof(str_val), - "0x%02x: ", index); - strncpy(str_out, str_val, len); - p += len; - - for (i = 0 ; i < 16 ; i++) { - len = snprintf(str_val, sizeof(str_val), "%02x ", - rtw_read8(padapter, (0x1025 << 16) | (index + i))); - strncpy(p, str_val, len); - p += len; - } - RTW_INFO("%s\n", str_out); - _rtw_memset(&str_out, '\0', sizeof(str_out)); - } -} - static void dump_mac_page0(PADAPTER padapter) { char str_out[128]; @@ -127,7 +68,7 @@ bool sdio_power_on_check(PADAPTER padapter) { if (val_offset0 == 0xEA || val_offset1 == 0xEA || val_offset2 == 0xEA || val_offset3 == 0xEA) { RTW_INFO("%s: power on fail, do Power on again\n", __func__); - goto _exit; + return ret; } val_mix = val_offset3 << 24 | val_mix; @@ -170,12 +111,8 @@ bool sdio_power_on_check(PADAPTER padapter) { } else RTW_INFO("%s: fail at cmd52, cmd53.\n", __func__); -_exit: - if (ret == _FAIL) { - dump_sdio_f0(padapter); - dump_sdio_local(padapter); + if (ret == _FAIL) dump_mac_page0(padapter); - } return ret; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_intf.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_intf.c index bf7a65f7043b..b460341c0248 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_intf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_intf.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_INTF_C_ @@ -41,38 +36,49 @@ const u32 _chip_type_to_odm_ic_type[] = { void rtw_hal_chip_configure(_adapter *padapter) { - padapter->HalFunc.intf_chip_configure(padapter); + padapter->hal_func.intf_chip_configure(padapter); } -void rtw_hal_read_chip_info(_adapter *padapter) +/* + * Description: + * Read chip internal ROM data + * + * Return: + * _SUCCESS success + * _FAIL fail + */ +u8 rtw_hal_read_chip_info(_adapter *padapter) { + u8 rtn = _SUCCESS; u8 hci_type = rtw_get_intf_type(padapter); - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); /* before access eFuse, make sure card enable has been called */ if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) && !rtw_is_hw_init_completed(padapter)) rtw_hal_power_on(padapter); - padapter->HalFunc.read_adapter_info(padapter); + rtn = padapter->hal_func.read_adapter_info(padapter); if ((hci_type == RTW_SDIO || hci_type == RTW_GSPI) && !rtw_is_hw_init_completed(padapter)) rtw_hal_power_off(padapter); RTW_INFO("%s in %d ms\n", __func__, rtw_get_passing_time_ms(start)); + + return rtn; } void rtw_hal_read_chip_version(_adapter *padapter) { - padapter->HalFunc.read_chip_version(padapter); + padapter->hal_func.read_chip_version(padapter); rtw_odm_init_ic_type(padapter); } void rtw_hal_def_value_init(_adapter *padapter) { if (is_primary_adapter(padapter)) { - padapter->HalFunc.init_default_value(padapter); + padapter->hal_func.init_default_value(padapter); rtw_init_hal_com_default_value(padapter); @@ -126,7 +132,7 @@ void rtw_hal_dm_init(_adapter *padapter) if (is_primary_adapter(padapter)) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - padapter->HalFunc.dm_init(padapter); + padapter->hal_func.dm_init(padapter); _rtw_spinlock_init(&pHalData->IQKSpinLock); @@ -138,26 +144,38 @@ void rtw_hal_dm_deinit(_adapter *padapter) if (is_primary_adapter(padapter)) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - padapter->HalFunc.dm_deinit(padapter); + padapter->hal_func.dm_deinit(padapter); _rtw_spinlock_free(&pHalData->IQKSpinLock); } } +#ifdef CONFIG_RTW_SW_LED void rtw_hal_sw_led_init(_adapter *padapter) { - if (padapter->HalFunc.InitSwLeds) - padapter->HalFunc.InitSwLeds(padapter); + if (padapter->hal_func.InitSwLeds) + padapter->hal_func.InitSwLeds(padapter); } void rtw_hal_sw_led_deinit(_adapter *padapter) { - if (padapter->HalFunc.DeInitSwLeds) - padapter->HalFunc.DeInitSwLeds(padapter); + if (padapter->hal_func.DeInitSwLeds) + padapter->hal_func.DeInitSwLeds(padapter); } +#endif u32 rtw_hal_power_on(_adapter *padapter) { - return padapter->HalFunc.hal_power_on(padapter); + u32 ret = 0; + PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + + ret = padapter->hal_func.hal_power_on(padapter); + +#ifdef CONFIG_BT_COEXIST + if ((ret == _SUCCESS) && (pHalData->EEPROMBluetoothCoexist == _TRUE)) + rtw_btcoex_PowerOnSetting(padapter); +#endif + + return ret; } void rtw_hal_power_off(_adapter *padapter) { @@ -165,7 +183,11 @@ void rtw_hal_power_off(_adapter *padapter) _rtw_memset(macid_ctl->h2c_msr, 0, MACID_NUM_SW_LIMIT); - padapter->HalFunc.hal_power_off(padapter); +#ifdef CONFIG_BT_COEXIST + rtw_btcoex_PowerOffSetting(padapter); +#endif + + padapter->hal_func.hal_power_off(padapter); } @@ -181,8 +203,10 @@ void rtw_hal_init_opmode(_adapter *padapter) networkType = Ndis802_11IBSS; else if (fw_state & WIFI_STATION_STATE) networkType = Ndis802_11Infrastructure; +#ifdef CONFIG_AP_MODE else if (fw_state & WIFI_AP_STATE) networkType = Ndis802_11APMode; +#endif else return; @@ -196,12 +220,14 @@ uint rtw_hal_init(_adapter *padapter) PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); int i; - status = padapter->HalFunc.hal_init(padapter); + status = padapter->hal_func.hal_init(padapter); if (status == _SUCCESS) { pHalData->hw_init_completed = _TRUE; rtw_restore_mac_addr(padapter); - + #ifdef RTW_HALMAC + rtw_restore_hw_port_cfg(padapter); + #endif if (padapter->registrypriv.notch_filter == 1) rtw_hal_notch_filter(padapter, 1); @@ -220,7 +246,7 @@ uint rtw_hal_init(_adapter *padapter) } else { pHalData->hw_init_completed = _FALSE; - RTW_INFO("rtw_hal_init: hal__init fail\n"); + RTW_INFO("rtw_hal_init: hal_init fail\n"); } @@ -235,7 +261,7 @@ uint rtw_hal_deinit(_adapter *padapter) PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); int i; - status = padapter->HalFunc.hal_deinit(padapter); + status = padapter->hal_func.hal_deinit(padapter); if (status == _SUCCESS) { rtw_led_control(padapter, LED_CTL_POWER_OFF); @@ -247,39 +273,39 @@ uint rtw_hal_deinit(_adapter *padapter) return status; } -void rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) +u8 rtw_hal_set_hwreg(_adapter *padapter, u8 variable, u8 *val) { - padapter->HalFunc.SetHwRegHandler(padapter, variable, val); + return padapter->hal_func.set_hw_reg_handler(padapter, variable, val); } void rtw_hal_get_hwreg(_adapter *padapter, u8 variable, u8 *val) { - padapter->HalFunc.GetHwRegHandler(padapter, variable, val); + padapter->hal_func.GetHwRegHandler(padapter, variable, val); } u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) { - return padapter->HalFunc.SetHalDefVarHandler(padapter, eVariable, pValue); + return padapter->hal_func.SetHalDefVarHandler(padapter, eVariable, pValue); } u8 rtw_hal_get_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue) { - return padapter->HalFunc.GetHalDefVarHandler(padapter, eVariable, pValue); + return padapter->hal_func.get_hal_def_var_handler(padapter, eVariable, pValue); } void rtw_hal_set_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet) { - padapter->HalFunc.SetHalODMVarHandler(padapter, eVariable, pValue1, bSet); + padapter->hal_func.SetHalODMVarHandler(padapter, eVariable, pValue1, bSet); } void rtw_hal_get_odm_var(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2) { - padapter->HalFunc.GetHalODMVarHandler(padapter, eVariable, pValue1, pValue2); + padapter->hal_func.GetHalODMVarHandler(padapter, eVariable, pValue1, pValue2); } /* FOR SDIO & PCIE */ void rtw_hal_enable_interrupt(_adapter *padapter) { #if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) - padapter->HalFunc.enable_interrupt(padapter); + padapter->hal_func.enable_interrupt(padapter); #endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ } @@ -287,7 +313,7 @@ void rtw_hal_enable_interrupt(_adapter *padapter) void rtw_hal_disable_interrupt(_adapter *padapter) { #if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) - padapter->HalFunc.disable_interrupt(padapter); + padapter->hal_func.disable_interrupt(padapter); #endif /* #if defined(CONFIG_PCI_HCI) || defined (CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) */ } @@ -295,24 +321,43 @@ void rtw_hal_disable_interrupt(_adapter *padapter) u8 rtw_hal_check_ips_status(_adapter *padapter) { u8 val = _FALSE; - if (padapter->HalFunc.check_ips_status) - val = padapter->HalFunc.check_ips_status(padapter); + if (padapter->hal_func.check_ips_status) + val = padapter->hal_func.check_ips_status(padapter); else - RTW_INFO("%s: HalFunc.check_ips_status is NULL!\n", __FUNCTION__); + RTW_INFO("%s: hal_func.check_ips_status is NULL!\n", __FUNCTION__); return val; } s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan) { - return padapter->HalFunc.fw_dl(padapter, wowlan); + return padapter->hal_func.fw_dl(padapter, wowlan); } +#ifdef RTW_HALMAC +s32 rtw_hal_fw_mem_dl(_adapter *padapter, enum fw_mem mem) +{ + systime dlfw_start_time = rtw_get_current_time(); + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct debug_priv *pdbgpriv = &dvobj->drv_dbg; + s32 rst = _FALSE; + + rst = padapter->hal_func.fw_mem_dl(padapter, mem); + RTW_INFO("%s in %dms\n", __func__, rtw_get_passing_time_ms(dlfw_start_time)); + + if (rst == _FALSE) + pdbgpriv->dbg_fw_mem_dl_error_cnt++; + if (1) + RTW_INFO("%s dbg_fw_mem_dl_error_cnt:%d\n", __func__, pdbgpriv->dbg_fw_mem_dl_error_cnt); + return rst; +} +#endif + #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) void rtw_hal_clear_interrupt(_adapter *padapter) { #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - padapter->HalFunc.clear_interrupt(padapter); + padapter->hal_func.clear_interrupt(padapter); #endif } #endif @@ -321,14 +366,14 @@ void rtw_hal_clear_interrupt(_adapter *padapter) u32 rtw_hal_inirp_init(_adapter *padapter) { if (is_primary_adapter(padapter)) - return padapter->HalFunc.inirp_init(padapter); + return padapter->hal_func.inirp_init(padapter); return _SUCCESS; } u32 rtw_hal_inirp_deinit(_adapter *padapter) { if (is_primary_adapter(padapter)) - return padapter->HalFunc.inirp_deinit(padapter); + return padapter->hal_func.inirp_deinit(padapter); return _SUCCESS; } @@ -337,26 +382,78 @@ u32 rtw_hal_inirp_deinit(_adapter *padapter) #if defined(CONFIG_PCI_HCI) void rtw_hal_irp_reset(_adapter *padapter) { - padapter->HalFunc.irp_reset(GET_PRIMARY_ADAPTER(padapter)); + padapter->hal_func.irp_reset(GET_PRIMARY_ADAPTER(padapter)); } + +void rtw_hal_pci_dbi_write(_adapter *padapter, u16 addr, u8 data) +{ + u16 cmd[2]; + + cmd[0] = addr; + cmd[1] = data; + + padapter->hal_func.set_hw_reg_handler(padapter, HW_VAR_DBI, (u8 *) cmd); +} + +u8 rtw_hal_pci_dbi_read(_adapter *padapter, u16 addr) +{ + padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_DBI, (u8 *)(&addr)); + + return (u8)addr; +} + +void rtw_hal_pci_mdio_write(_adapter *padapter, u8 addr, u16 data) +{ + u16 cmd[2]; + + cmd[0] = (u16)addr; + cmd[1] = data; + + padapter->hal_func.set_hw_reg_handler(padapter, HW_VAR_MDIO, (u8 *) cmd); +} + +u16 rtw_hal_pci_mdio_read(_adapter *padapter, u8 addr) +{ + padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_MDIO, &addr); + + return (u8)addr; +} + +u8 rtw_hal_pci_l1off_nic_support(_adapter *padapter) +{ + u8 l1off; + + padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_L1OFF_NIC_SUPPORT, &l1off); + return l1off; +} + +u8 rtw_hal_pci_l1off_capability(_adapter *padapter) +{ + u8 l1off; + + padapter->hal_func.GetHwRegHandler(padapter, HW_VAR_L1OFF_CAPABILITY, &l1off); + return l1off; +} + + #endif /* #if defined(CONFIG_PCI_HCI) */ /* for USB Auto-suspend */ u8 rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val) { - if (padapter->HalFunc.interface_ps_func) - return padapter->HalFunc.interface_ps_func(padapter, efunc_id, val); + if (padapter->hal_func.interface_ps_func) + return padapter->hal_func.interface_ps_func(padapter, efunc_id, val); return _FAIL; } s32 rtw_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe) { - return padapter->HalFunc.hal_xmitframe_enqueue(padapter, pxmitframe); + return padapter->hal_func.hal_xmitframe_enqueue(padapter, pxmitframe); } s32 rtw_hal_xmit(_adapter *padapter, struct xmit_frame *pxmitframe) { - return padapter->HalFunc.hal_xmit(padapter, pxmitframe); + return padapter->hal_func.hal_xmit(padapter, pxmitframe); } /* @@ -372,7 +469,7 @@ s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) update_mgntframe_attrib_addr(padapter, pmgntframe); pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - subtype = GetFrameSubType(pframe); /* bit(7)~bit(2) */ + subtype = get_frame_sub_type(pframe); /* bit(7)~bit(2) */ /* pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; */ /* _rtw_memcpy(pmgntframe->attrib.ra, pwlanhdr->addr1, ETH_ALEN); */ @@ -398,49 +495,66 @@ s32 rtw_hal_mgnt_xmit(_adapter *padapter, struct xmit_frame *pmgntframe) } #endif /* CONFIG_IEEE80211W */ no_mgmt_coalesce: - ret = padapter->HalFunc.mgnt_xmit(padapter, pmgntframe); + ret = padapter->hal_func.mgnt_xmit(padapter, pmgntframe); return ret; } s32 rtw_hal_init_xmit_priv(_adapter *padapter) { - return padapter->HalFunc.init_xmit_priv(padapter); + return padapter->hal_func.init_xmit_priv(padapter); } void rtw_hal_free_xmit_priv(_adapter *padapter) { - padapter->HalFunc.free_xmit_priv(padapter); + padapter->hal_func.free_xmit_priv(padapter); } s32 rtw_hal_init_recv_priv(_adapter *padapter) { - return padapter->HalFunc.init_recv_priv(padapter); + return padapter->hal_func.init_recv_priv(padapter); } void rtw_hal_free_recv_priv(_adapter *padapter) { - padapter->HalFunc.free_recv_priv(padapter); + padapter->hal_func.free_recv_priv(padapter); } -void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level) + +void rtw_sta_ra_registed(_adapter *padapter, struct sta_info *psta) { - padapter->HalFunc.UpdateRAMaskHandler(padapter, psta, psta->mac_id, rssi_level); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); + + if (psta == NULL) { + RTW_ERR(FUNC_ADPT_FMT" sta is NULL\n", FUNC_ADPT_ARG(padapter)); + rtw_warn_on(1); + return; + } + +#ifdef CONFIG_AP_MODE + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { + if (psta->cmn.aid >= NUM_STA) { + RTW_ERR("station aid %d exceed the max number\n", psta->cmn.aid); + rtw_warn_on(1); + return; + } + rtw_ap_update_sta_ra_info(padapter, psta); + } +#endif + + psta->cmn.ra_info.ra_bw_mode = rtw_get_tx_bw_mode(padapter, psta); + /*set correct initial date rate for each mac_id */ + hal_data->INIDATA_RATE[psta->cmn.mac_id] = psta->init_rate; + + rtw_phydm_ra_registed(padapter, psta); } -void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level) + +void rtw_hal_update_ra_mask(struct sta_info *psta) { _adapter *padapter; - struct mlme_priv *pmlmepriv; if (!psta) return; padapter = psta->padapter; - - pmlmepriv = &(padapter->mlmepriv); - - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) - add_RATid(padapter, psta, rssi_level); - else { - psta->raid = rtw_hal_networktype_to_raid(padapter, psta); - rtw_update_ramask(padapter, psta, psta->mac_id, rssi_level); - } + rtw_sta_ra_registed(padapter, psta); } /* Start specifical interface thread */ @@ -448,7 +562,7 @@ void rtw_hal_start_thread(_adapter *padapter) { #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) #ifndef CONFIG_SDIO_TX_TASKLET - padapter->HalFunc.run_thread(padapter); + padapter->hal_func.run_thread(padapter); #endif #endif } @@ -458,7 +572,7 @@ void rtw_hal_stop_thread(_adapter *padapter) #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) #ifndef CONFIG_SDIO_TX_TASKLET - padapter->HalFunc.cancel_thread(padapter); + padapter->hal_func.cancel_thread(padapter); #endif #endif @@ -467,22 +581,22 @@ void rtw_hal_stop_thread(_adapter *padapter) u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask) { u32 data = 0; - if (padapter->HalFunc.read_bbreg) - data = padapter->HalFunc.read_bbreg(padapter, RegAddr, BitMask); + if (padapter->hal_func.read_bbreg) + data = padapter->hal_func.read_bbreg(padapter, RegAddr, BitMask); return data; } void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data) { - if (padapter->HalFunc.write_bbreg) - padapter->HalFunc.write_bbreg(padapter, RegAddr, BitMask, Data); + if (padapter->hal_func.write_bbreg) + padapter->hal_func.write_bbreg(padapter, RegAddr, BitMask, Data); } -u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask) +u32 rtw_hal_read_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask) { u32 data = 0; - if (padapter->HalFunc.read_rfreg) { - data = padapter->HalFunc.read_rfreg(padapter, eRFPath, RegAddr, BitMask); + if (padapter->hal_func.read_rfreg) { + data = padapter->hal_func.read_rfreg(padapter, eRFPath, RegAddr, BitMask); if (match_rf_read_sniff_ranges(eRFPath, RegAddr, BitMask)) { RTW_INFO("DBG_IO rtw_hal_read_rfreg(%u, 0x%04x, 0x%08x) read:0x%08x(0x%08x)\n" @@ -493,16 +607,16 @@ u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask return data; } -void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data) +void rtw_hal_write_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data) { - if (padapter->HalFunc.write_rfreg) { + if (padapter->hal_func.write_rfreg) { if (match_rf_write_sniff_ranges(eRFPath, RegAddr, BitMask)) { RTW_INFO("DBG_IO rtw_hal_write_rfreg(%u, 0x%04x, 0x%08x) write:0x%08x(0x%08x)\n" , eRFPath, RegAddr, BitMask, (Data << PHY_CalculateBitShift(BitMask)), Data); } - padapter->HalFunc.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); + padapter->hal_func.write_rfreg(padapter, eRFPath, RegAddr, BitMask, Data); #ifdef CONFIG_PCI_HCI if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(padapter)) /*For N-Series IC, suggest by Jenyu*/ @@ -515,33 +629,33 @@ void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMa s32 rtw_hal_interrupt_handler(_adapter *padapter) { s32 ret = _FAIL; - ret = padapter->HalFunc.interrupt_handler(padapter); + ret = padapter->hal_func.interrupt_handler(padapter); return ret; } #endif #if defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT) void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf) { - padapter->HalFunc.interrupt_handler(padapter, pkt_len, pbuf); + padapter->hal_func.interrupt_handler(padapter, pkt_len, pbuf); } #endif -void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80) +void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, enum channel_width Bandwidth, u8 Offset40, u8 Offset80) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); u8 cch_160 = Bandwidth == CHANNEL_WIDTH_160 ? channel : 0; u8 cch_80 = Bandwidth == CHANNEL_WIDTH_80 ? channel : 0; u8 cch_40 = Bandwidth == CHANNEL_WIDTH_40 ? channel : 0; u8 cch_20 = Bandwidth == CHANNEL_WIDTH_20 ? channel : 0; - ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); - if (pDM_Odm->RFCalibrateInfo.bIQKInProgress == _TRUE) + if (rtw_phydm_is_iqk_in_progress(padapter)) RTW_ERR("%s, %d, IQK may race condition\n", __func__, __LINE__); - ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); +#ifdef CONFIG_MP_INCLUDED /* MP mode channel don't use secondary channel */ - if (rtw_mi_mp_mode_check(padapter) == _FALSE) { + if (rtw_mp_mode_check(padapter) == _FALSE) +#endif + { #if 0 if (cch_160 != 0) cch_80 = rtw_get_scch_by_cch_offset(cch_160, CHANNEL_WIDTH_160, Offset80); @@ -561,19 +675,19 @@ void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth , channel, ch_width_str(Bandwidth), Offset40, Offset80 , pHalData->cch_80, pHalData->cch_40, pHalData->cch_20); - padapter->HalFunc.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); + padapter->hal_func.set_chnl_bw_handler(padapter, channel, Bandwidth, Offset40, Offset80); } void rtw_hal_set_tx_power_level(_adapter *padapter, u8 channel) { - if (padapter->HalFunc.set_tx_power_level_handler) - padapter->HalFunc.set_tx_power_level_handler(padapter, channel); + if (padapter->hal_func.set_tx_power_level_handler) + padapter->hal_func.set_tx_power_level_handler(padapter, channel); } void rtw_hal_get_tx_power_level(_adapter *padapter, s32 *powerlevel) { - if (padapter->HalFunc.get_tx_power_level_handler) - padapter->HalFunc.get_tx_power_level_handler(padapter, powerlevel); + if (padapter->hal_func.get_tx_power_level_handler) + padapter->hal_func.get_tx_power_level_handler(padapter, powerlevel); } void rtw_hal_dm_watchdog(_adapter *padapter) @@ -584,35 +698,39 @@ void rtw_hal_dm_watchdog(_adapter *padapter) return; } #endif /* CONFIG_MCC_MODE */ + rtw_hal_turbo_edca(padapter); + padapter->hal_func.hal_dm_watchdog(padapter); - padapter->HalFunc.hal_dm_watchdog(padapter); - +#ifdef CONFIG_PCI_DYNAMIC_ASPM + rtw_pci_aspm_config_dynamic_l1_ilde_time(padapter); +#endif } #ifdef CONFIG_LPS_LCLK_WD_TIMER void rtw_hal_dm_watchdog_in_lps(_adapter *padapter) { #if defined(CONFIG_CONCURRENT_MODE) +#ifndef CONFIG_FW_MULTI_PORT_SUPPORT if (padapter->hw_port != HW_PORT0) return; #endif - - if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) { - padapter->HalFunc.hal_dm_watchdog_in_lps(padapter);/* this fuction caller is in interrupt context */ - } -} #endif + if (adapter_to_pwrctl(padapter)->bFwCurrentInPSMode == _TRUE) + rtw_phydm_watchdog_in_lps_lclk(padapter);/* this function caller is in interrupt context */ +} +#endif /*CONFIG_LPS_LCLK_WD_TIMER*/ + void rtw_hal_bcn_related_reg_setting(_adapter *padapter) { - padapter->HalFunc.SetBeaconRelatedRegistersHandler(padapter); + padapter->hal_func.SetBeaconRelatedRegistersHandler(padapter); } #ifdef CONFIG_HOSTAPD_MLME s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) { - if (padapter->HalFunc.hostap_mgnt_xmit_entry) - return padapter->HalFunc.hostap_mgnt_xmit_entry(padapter, pkt); + if (padapter->hal_func.hostap_mgnt_xmit_entry) + return padapter->hal_func.hostap_mgnt_xmit_entry(padapter, pkt); return _FAIL; } #endif /* CONFIG_HOSTAPD_MLME */ @@ -620,44 +738,44 @@ s32 rtw_hal_hostap_mgnt_xmit_entry(_adapter *padapter, _pkt *pkt) #ifdef DBG_CONFIG_ERROR_DETECT void rtw_hal_sreset_init(_adapter *padapter) { - padapter->HalFunc.sreset_init_value(padapter); + padapter->hal_func.sreset_init_value(padapter); } void rtw_hal_sreset_reset(_adapter *padapter) { padapter = GET_PRIMARY_ADAPTER(padapter); - padapter->HalFunc.silentreset(padapter); + padapter->hal_func.silentreset(padapter); } void rtw_hal_sreset_reset_value(_adapter *padapter) { - padapter->HalFunc.sreset_reset_value(padapter); + padapter->hal_func.sreset_reset_value(padapter); } void rtw_hal_sreset_xmit_status_check(_adapter *padapter) { - padapter->HalFunc.sreset_xmit_status_check(padapter); + padapter->hal_func.sreset_xmit_status_check(padapter); } void rtw_hal_sreset_linked_status_check(_adapter *padapter) { - padapter->HalFunc.sreset_linked_status_check(padapter); + padapter->hal_func.sreset_linked_status_check(padapter); } u8 rtw_hal_sreset_get_wifi_status(_adapter *padapter) { - return padapter->HalFunc.sreset_get_wifi_status(padapter); + return padapter->hal_func.sreset_get_wifi_status(padapter); } bool rtw_hal_sreset_inprogress(_adapter *padapter) { padapter = GET_PRIMARY_ADAPTER(padapter); - return padapter->HalFunc.sreset_inprogress(padapter); + return padapter->hal_func.sreset_inprogress(padapter); } #endif /* DBG_CONFIG_ERROR_DETECT */ #ifdef CONFIG_IOL -int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wating_ms, u32 bndy_cnt) +int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_waiting_ms, u32 bndy_cnt) { - if (adapter->HalFunc.IOL_exec_cmds_sync) - return adapter->HalFunc.IOL_exec_cmds_sync(adapter, xmit_frame, max_wating_ms, bndy_cnt); + if (adapter->hal_func.IOL_exec_cmds_sync) + return adapter->hal_func.IOL_exec_cmds_sync(adapter, xmit_frame, max_waiting_ms, bndy_cnt); return _FAIL; } #endif @@ -665,21 +783,28 @@ int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wat #ifdef CONFIG_XMIT_THREAD_MODE s32 rtw_hal_xmit_thread_handler(_adapter *padapter) { - return padapter->HalFunc.xmit_thread_handler(padapter); + return padapter->hal_func.xmit_thread_handler(padapter); +} +#endif + +#ifdef CONFIG_RECV_THREAD_MODE +s32 rtw_hal_recv_hdl(_adapter *adapter) +{ + return adapter->hal_func.recv_hdl(adapter); } #endif void rtw_hal_notch_filter(_adapter *adapter, bool enable) { - if (adapter->HalFunc.hal_notch_filter) - adapter->HalFunc.hal_notch_filter(adapter, enable); + if (adapter->hal_func.hal_notch_filter) + adapter->hal_func.hal_notch_filter(adapter, enable); } #ifdef CONFIG_FW_C2H_REG inline bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf) { HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); - HAL_VERSION *hal_ver = &HalData->VersionID; + HAL_VERSION *hal_ver = &HalData->version_id; bool ret = _FAIL; ret = C2H_ID_88XX(buf) || C2H_PLEN_88XX(buf); @@ -690,7 +815,7 @@ inline bool rtw_hal_c2h_valid(_adapter *adapter, u8 *buf) inline s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf) { HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); - HAL_VERSION *hal_ver = &HalData->VersionID; + HAL_VERSION *hal_ver = &HalData->version_id; s32 ret = _FAIL; ret = c2h_evt_read_88xx(adapter, buf); @@ -701,7 +826,7 @@ inline s32 rtw_hal_c2h_evt_read(_adapter *adapter, u8 *buf) bool rtw_hal_c2h_reg_hdr_parse(_adapter *adapter, u8 *buf, u8 *id, u8 *seq, u8 *plen, u8 **payload) { HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); - HAL_VERSION *hal_ver = &HalData->VersionID; + HAL_VERSION *hal_ver = &HalData->version_id; bool ret = _FAIL; *id = C2H_ID_88XX(buf); @@ -718,7 +843,7 @@ bool rtw_hal_c2h_reg_hdr_parse(_adapter *adapter, u8 *buf, u8 *id, u8 *seq, u8 * bool rtw_hal_c2h_pkt_hdr_parse(_adapter *adapter, u8 *buf, u16 len, u8 *id, u8 *seq, u8 *plen, u8 **payload) { HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); - HAL_VERSION *hal_ver = &HalData->VersionID; + HAL_VERSION *hal_ver = &HalData->version_id; bool ret = _FAIL; if (!buf || len > 256 || len < 3) @@ -740,15 +865,10 @@ bool rtw_hal_c2h_pkt_hdr_parse(_adapter *adapter, u8 *buf, u16 len, u8 *id, u8 * #endif s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) { - HAL_DATA_TYPE *hal_data = GET_HAL_DATA(adapter); - DM_ODM_T *odm = &hal_data->odmpriv; u8 sub_id = 0; s32 ret = _SUCCESS; switch (id) { - case C2H_DBG: - RTW_INFO_DUMP("C2H_DBG: ", payload, plen); - break; case C2H_FW_SCAN_COMPLETE: RTW_INFO("[C2H], FW Scan Complete\n"); break; @@ -764,7 +884,10 @@ s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) rtw_btcoex_BtMpRptNotify(adapter, plen, payload); break; case C2H_MAILBOX_STATUS: - RTW_INFO_DUMP("C2H_MAILBOX_STATUS: ", payload, plen); + RTW_DBG_DUMP("C2H_MAILBOX_STATUS: ", payload, plen); + break; + case C2H_WLAN_INFO: + rtw_btcoex_WlFwDbgInfoNotify(adapter, payload, plen); break; #endif /* CONFIG_BT_COEXIST */ @@ -814,7 +937,7 @@ s32 c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) /* no handle, goto default */ default: - if (phydm_c2H_content_parsing(odm, id, plen, payload) != TRUE) + if (phydm_c2H_content_parsing(adapter_to_phydm(adapter), id, plen, payload) != TRUE) ret = _FAIL; break; } @@ -835,7 +958,7 @@ s32 rtw_hal_c2h_handler(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) { s32 ret = _FAIL; - ret = adapter->HalFunc.c2h_handler(adapter, id, seq, plen, payload); + ret = adapter->hal_func.c2h_handler(adapter, id, seq, plen, payload); if (ret != _SUCCESS) ret = c2h_handler(adapter, id, seq, plen, payload); @@ -851,6 +974,8 @@ s32 rtw_hal_c2h_id_handle_directly(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 case C2H_IQK_FINISH: case C2H_MCC: case C2H_BCN_EARLY_RPT: + case C2H_AP_REQ_TXRPT: + case C2H_SPC_STAT: return _TRUE; default: return _FALSE; @@ -863,56 +988,162 @@ s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter) return GET_HAL_DATA(padapter)->bDisableSWChannelPlan; } -s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid) +static s32 _rtw_hal_macid_sleep(_adapter *adapter, u8 macid, u8 sleep) { - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - u8 support; - - support = _FALSE; - rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); - if (_FALSE == support) - return _FAIL; + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); + u16 reg_sleep; + u8 bit_shift; + u32 val32; + s32 ret = _FAIL; if (macid >= macid_ctl->num) { - RTW_ERR(FUNC_ADPT_FMT": Invalid macid(%u)\n", - FUNC_ADPT_ARG(padapter), macid); - return _FAIL; + RTW_ERR(ADPT_FMT" %s invalid macid(%u)\n" + , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" , macid); + goto exit; } - rtw_hal_set_hwreg(padapter, HW_VAR_MACID_SLEEP, &macid); + if (macid < 32) { + reg_sleep = macid_ctl->reg_sleep_m0; + bit_shift = macid; + #if (MACID_NUM_SW_LIMIT > 32) + } else if (macid < 64) { + reg_sleep = macid_ctl->reg_sleep_m1; + bit_shift = macid - 32; + #endif + #if (MACID_NUM_SW_LIMIT > 64) + } else if (macid < 96) { + reg_sleep = macid_ctl->reg_sleep_m2; + bit_shift = macid - 64; + #endif + #if (MACID_NUM_SW_LIMIT > 96) + } else if (macid < 128) { + reg_sleep = macid_ctl->reg_sleep_m3; + bit_shift = macid - 96; + #endif + } else { + rtw_warn_on(1); + goto exit; + } + + if (!reg_sleep) { + rtw_warn_on(1); + goto exit; + } + + val32 = rtw_read32(adapter, reg_sleep); + RTW_INFO(ADPT_FMT" %s macid=%d, ori reg_0x%03x=0x%08x\n" + , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" + , macid, reg_sleep, val32); + + ret = _SUCCESS; + + if (sleep) { + if (val32 & BIT(bit_shift)) + goto exit; + val32 |= BIT(bit_shift); + } else { + if (!(val32 & BIT(bit_shift))) + goto exit; + val32 &= ~BIT(bit_shift); + } + + rtw_write32(adapter, reg_sleep, val32); + +exit: + return ret; +} + +inline s32 rtw_hal_macid_sleep(_adapter *adapter, u8 macid) +{ + return _rtw_hal_macid_sleep(adapter, macid, 1); +} + +inline s32 rtw_hal_macid_wakeup(_adapter *adapter, u8 macid) +{ + return _rtw_hal_macid_sleep(adapter, macid, 0); +} + +static s32 _rtw_hal_macid_bmp_sleep(_adapter *adapter, struct macid_bmp *bmp, u8 sleep) +{ + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); + u16 reg_sleep; + u32 *m = &bmp->m0; + u8 mid = 0; + u32 val32; + + do { + if (*m == 0) + goto move_next; + + if (mid == 0) + reg_sleep = macid_ctl->reg_sleep_m0; + #if (MACID_NUM_SW_LIMIT > 32) + else if (mid == 1) + reg_sleep = macid_ctl->reg_sleep_m1; + #endif + #if (MACID_NUM_SW_LIMIT > 64) + else if (mid == 2) + reg_sleep = macid_ctl->reg_sleep_m2; + #endif + #if (MACID_NUM_SW_LIMIT > 96) + else if (mid == 3) + reg_sleep = macid_ctl->reg_sleep_m3; + #endif + else { + rtw_warn_on(1); + break; + } + + if (!reg_sleep) { + rtw_warn_on(1); + break; + } + + val32 = rtw_read32(adapter, reg_sleep); + RTW_INFO(ADPT_FMT" %s m%u=0x%08x, ori reg_0x%03x=0x%08x\n" + , ADPT_ARG(adapter), sleep ? "sleep" : "wakeup" + , mid, *m, reg_sleep, val32); + + if (sleep) { + if ((val32 & *m) == *m) + goto move_next; + val32 |= *m; + } else { + if ((val32 & *m) == 0) + goto move_next; + val32 &= ~(*m); + } + + rtw_write32(adapter, reg_sleep, val32); + +move_next: + m++; + mid++; + } while (mid * 32 < MACID_NUM_SW_LIMIT); return _SUCCESS; } -s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid) +inline s32 rtw_hal_macid_sleep_all_used(_adapter *adapter) { - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - u8 support; + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); - support = _FALSE; - rtw_hal_get_def_var(padapter, HAL_DEF_MACID_SLEEP, &support); - if (_FALSE == support) - return _FAIL; + return _rtw_hal_macid_bmp_sleep(adapter, &macid_ctl->used, 1); +} - if (macid >= macid_ctl->num) { - RTW_ERR(FUNC_ADPT_FMT": Invalid macid(%u)\n", - FUNC_ADPT_ARG(padapter), macid); - return _FAIL; - } +inline s32 rtw_hal_macid_wakeup_all_used(_adapter *adapter) +{ + struct macid_ctl_t *macid_ctl = adapter_to_macidctl(adapter); - rtw_hal_set_hwreg(padapter, HW_VAR_MACID_WAKEUP, &macid); - - return _SUCCESS; + return _rtw_hal_macid_bmp_sleep(adapter, &macid_ctl->used, 0); } s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) { _adapter *pri_adapter = GET_PRIMARY_ADAPTER(padapter); - if (pri_adapter->bFWReady == _TRUE) - return padapter->HalFunc.fill_h2c_cmd(padapter, ElementID, CmdLen, pCmdBuffer); + if (GET_HAL_DATA(pri_adapter)->bFWReady == _TRUE) + return padapter->hal_func.fill_h2c_cmd(padapter, ElementID, CmdLen, pCmdBuffer); else if (padapter->registrypriv.mp_mode == 0) RTW_PRINT(FUNC_ADPT_FMT" FW doesn't exit when no MP mode, by pass H2C id:0x%02x\n" , FUNC_ADPT_ARG(padapter), ElementID); @@ -922,52 +1153,64 @@ s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBu void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame) { - padapter->HalFunc.fill_fake_txdesc(padapter, pDesc, BufferLen, IsPsPoll, IsBTQosNull, bDataFrame); + padapter->hal_func.fill_fake_txdesc(padapter, pDesc, BufferLen, IsPsPoll, IsBTQosNull, bDataFrame); } + u8 rtw_hal_get_txbuff_rsvd_page_num(_adapter *adapter, bool wowlan) { - return adapter->HalFunc.hal_get_tx_buff_rsvd_page_num(adapter, wowlan); + u8 num = 0; + + + if (adapter->hal_func.hal_get_tx_buff_rsvd_page_num) { + num = adapter->hal_func.hal_get_tx_buff_rsvd_page_num(adapter, wowlan); + } else { +#ifdef RTW_HALMAC + num = GET_HAL_DATA(adapter)->drv_rsvd_page_number; +#endif /* RTW_HALMAC */ + } + + return num; } #ifdef CONFIG_GPIO_API void rtw_hal_update_hisr_hsisr_ind(_adapter *padapter, u32 flag) { - if (padapter->HalFunc.update_hisr_hsisr_ind) - padapter->HalFunc.update_hisr_hsisr_ind(padapter, flag); + if (padapter->hal_func.update_hisr_hsisr_ind) + padapter->hal_func.update_hisr_hsisr_ind(padapter, flag); } int rtw_hal_gpio_func_check(_adapter *padapter, u8 gpio_num) { int ret = _SUCCESS; - if (padapter->HalFunc.hal_gpio_func_check) - ret = padapter->HalFunc.hal_gpio_func_check(padapter, gpio_num); + if (padapter->hal_func.hal_gpio_func_check) + ret = padapter->hal_func.hal_gpio_func_check(padapter, gpio_num); return ret; } void rtw_hal_gpio_multi_func_reset(_adapter *padapter, u8 gpio_num) { - if (padapter->HalFunc.hal_gpio_multi_func_reset) - padapter->HalFunc.hal_gpio_multi_func_reset(padapter, gpio_num); + if (padapter->hal_func.hal_gpio_multi_func_reset) + padapter->hal_func.hal_gpio_multi_func_reset(padapter, gpio_num); } #endif void rtw_hal_fw_correct_bcn(_adapter *padapter) { - if (padapter->HalFunc.fw_correct_bcn) - padapter->HalFunc.fw_correct_bcn(padapter); + if (padapter->hal_func.fw_correct_bcn) + padapter->hal_func.fw_correct_bcn(padapter); } -void rtw_hal_set_tx_power_index(PADAPTER padapter, u32 powerindex, u8 rfpath, u8 rate) +void rtw_hal_set_tx_power_index(PADAPTER padapter, u32 powerindex, enum rf_path rfpath, u8 rate) { - return padapter->HalFunc.set_tx_power_index_handler(padapter, powerindex, rfpath, rate); + return padapter->hal_func.set_tx_power_index_handler(padapter, powerindex, rfpath, rate); } -u8 rtw_hal_get_tx_power_index(PADAPTER padapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic) +u8 rtw_hal_get_tx_power_index(PADAPTER padapter, enum rf_path rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic) { - return padapter->HalFunc.get_tx_power_index_handler(padapter, rfpath, rate, bandwidth, channel, tic); + return padapter->hal_func.get_tx_power_index_handler(padapter, rfpath, rate, bandwidth, channel, tic); } #ifdef RTW_HALMAC @@ -981,7 +1224,7 @@ u8 rtw_hal_get_tx_power_index(PADAPTER padapter, u8 rfpath, u8 rate, u8 bandwidt */ u8 rtw_hal_init_mac_register(PADAPTER adapter) { - return adapter->HalFunc.init_mac_register(adapter); + return adapter->hal_func.init_mac_register(adapter); } /* @@ -994,87 +1237,102 @@ u8 rtw_hal_init_mac_register(PADAPTER adapter) */ u8 rtw_hal_init_phy(PADAPTER adapter) { - return adapter->HalFunc.init_phy(adapter); + return adapter->hal_func.init_phy(adapter); } #endif /* RTW_HALMAC */ +#ifdef CONFIG_RFKILL_POLL +bool rtw_hal_rfkill_poll(_adapter *adapter, u8 *valid) +{ + bool ret; + + if (adapter->hal_func.hal_radio_onoff_check) + ret = adapter->hal_func.hal_radio_onoff_check(adapter, valid); + else { + *valid = 0; + ret = _FALSE; + } + return ret; +} +#endif + #define rtw_hal_error_msg(ops_fun) \ - RTW_PRINT("### %s - Error : Please hook HalFunc.%s ###\n", __FUNCTION__, ops_fun) + RTW_PRINT("### %s - Error : Please hook hal_func.%s ###\n", __FUNCTION__, ops_fun) u8 rtw_hal_ops_check(_adapter *padapter) { u8 ret = _SUCCESS; #if 1 /*** initialize section ***/ - if (NULL == padapter->HalFunc.read_chip_version) { + if (NULL == padapter->hal_func.read_chip_version) { rtw_hal_error_msg("read_chip_version"); ret = _FAIL; } - if (NULL == padapter->HalFunc.init_default_value) { + if (NULL == padapter->hal_func.init_default_value) { rtw_hal_error_msg("init_default_value"); ret = _FAIL; } - if (NULL == padapter->HalFunc.intf_chip_configure) { + if (NULL == padapter->hal_func.intf_chip_configure) { rtw_hal_error_msg("intf_chip_configure"); ret = _FAIL; } - if (NULL == padapter->HalFunc.read_adapter_info) { + if (NULL == padapter->hal_func.read_adapter_info) { rtw_hal_error_msg("read_adapter_info"); ret = _FAIL; } - if (NULL == padapter->HalFunc.hal_power_on) { + if (NULL == padapter->hal_func.hal_power_on) { rtw_hal_error_msg("hal_power_on"); ret = _FAIL; } - if (NULL == padapter->HalFunc.hal_power_off) { + if (NULL == padapter->hal_func.hal_power_off) { rtw_hal_error_msg("hal_power_off"); ret = _FAIL; } - if (NULL == padapter->HalFunc.hal_init) { + if (NULL == padapter->hal_func.hal_init) { rtw_hal_error_msg("hal_init"); ret = _FAIL; } - if (NULL == padapter->HalFunc.hal_deinit) { + if (NULL == padapter->hal_func.hal_deinit) { rtw_hal_error_msg("hal_deinit"); ret = _FAIL; } /*** xmit section ***/ - if (NULL == padapter->HalFunc.init_xmit_priv) { + if (NULL == padapter->hal_func.init_xmit_priv) { rtw_hal_error_msg("init_xmit_priv"); ret = _FAIL; } - if (NULL == padapter->HalFunc.free_xmit_priv) { + if (NULL == padapter->hal_func.free_xmit_priv) { rtw_hal_error_msg("free_xmit_priv"); ret = _FAIL; } - if (NULL == padapter->HalFunc.hal_xmit) { + if (NULL == padapter->hal_func.hal_xmit) { rtw_hal_error_msg("hal_xmit"); ret = _FAIL; } - if (NULL == padapter->HalFunc.mgnt_xmit) { + if (NULL == padapter->hal_func.mgnt_xmit) { rtw_hal_error_msg("mgnt_xmit"); ret = _FAIL; } #ifdef CONFIG_XMIT_THREAD_MODE - if (NULL == padapter->HalFunc.xmit_thread_handler) { + if (NULL == padapter->hal_func.xmit_thread_handler) { rtw_hal_error_msg("xmit_thread_handler"); ret = _FAIL; } #endif - if (NULL == padapter->HalFunc.hal_xmitframe_enqueue) { + if (NULL == padapter->hal_func.hal_xmitframe_enqueue) { rtw_hal_error_msg("hal_xmitframe_enqueue"); ret = _FAIL; } #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) #ifndef CONFIG_SDIO_TX_TASKLET - if (NULL == padapter->HalFunc.run_thread) { + if (NULL == padapter->hal_func.run_thread) { rtw_hal_error_msg("run_thread"); ret = _FAIL; } - if (NULL == padapter->HalFunc.cancel_thread) { + if (NULL == padapter->hal_func.cancel_thread) { rtw_hal_error_msg("cancel_thread"); ret = _FAIL; } @@ -1082,20 +1340,26 @@ u8 rtw_hal_ops_check(_adapter *padapter) #endif /*** recv section ***/ - if (NULL == padapter->HalFunc.init_recv_priv) { + if (NULL == padapter->hal_func.init_recv_priv) { rtw_hal_error_msg("init_recv_priv"); ret = _FAIL; } - if (NULL == padapter->HalFunc.free_recv_priv) { + if (NULL == padapter->hal_func.free_recv_priv) { rtw_hal_error_msg("free_recv_priv"); ret = _FAIL; } +#ifdef CONFIG_RECV_THREAD_MODE + if (NULL == padapter->hal_func.recv_hdl) { + rtw_hal_error_msg("recv_hdl"); + ret = _FAIL; + } +#endif #if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) - if (NULL == padapter->HalFunc.inirp_init) { + if (NULL == padapter->hal_func.inirp_init) { rtw_hal_error_msg("inirp_init"); ret = _FAIL; } - if (NULL == padapter->HalFunc.inirp_deinit) { + if (NULL == padapter->hal_func.inirp_deinit) { rtw_hal_error_msg("inirp_deinit"); ret = _FAIL; } @@ -1104,24 +1368,24 @@ u8 rtw_hal_ops_check(_adapter *padapter) /*** interrupt hdl section ***/ #if defined(CONFIG_PCI_HCI) - if (NULL == padapter->HalFunc.irp_reset) { + if (NULL == padapter->hal_func.irp_reset) { rtw_hal_error_msg("irp_reset"); ret = _FAIL; } #endif/*#if defined(CONFIG_PCI_HCI)*/ #if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT)) - if (NULL == padapter->HalFunc.interrupt_handler) { + if (NULL == padapter->hal_func.interrupt_handler) { rtw_hal_error_msg("interrupt_handler"); ret = _FAIL; } #endif /*#if (defined(CONFIG_PCI_HCI)) || (defined(CONFIG_USB_HCI) && defined(CONFIG_SUPPORT_USB_INT))*/ #if defined(CONFIG_PCI_HCI) || defined(CONFIG_SDIO_HCI) || defined (CONFIG_GSPI_HCI) - if (NULL == padapter->HalFunc.enable_interrupt) { + if (NULL == padapter->hal_func.enable_interrupt) { rtw_hal_error_msg("enable_interrupt"); ret = _FAIL; } - if (NULL == padapter->HalFunc.disable_interrupt) { + if (NULL == padapter->hal_func.disable_interrupt) { rtw_hal_error_msg("disable_interrupt"); ret = _FAIL; } @@ -1129,168 +1393,175 @@ u8 rtw_hal_ops_check(_adapter *padapter) /*** DM section ***/ - if (NULL == padapter->HalFunc.dm_init) { + if (NULL == padapter->hal_func.dm_init) { rtw_hal_error_msg("dm_init"); ret = _FAIL; } - if (NULL == padapter->HalFunc.dm_deinit) { + if (NULL == padapter->hal_func.dm_deinit) { rtw_hal_error_msg("dm_deinit"); ret = _FAIL; } - if (NULL == padapter->HalFunc.hal_dm_watchdog) { + if (NULL == padapter->hal_func.hal_dm_watchdog) { rtw_hal_error_msg("hal_dm_watchdog"); ret = _FAIL; } -#ifdef CONFIG_LPS_LCLK_WD_TIMER - if (NULL == padapter->HalFunc.hal_dm_watchdog_in_lps) { - rtw_hal_error_msg("hal_dm_watchdog_in_lps"); - ret = _FAIL; - } -#endif /*** xxx section ***/ - if (NULL == padapter->HalFunc.set_chnl_bw_handler) { + if (NULL == padapter->hal_func.set_chnl_bw_handler) { rtw_hal_error_msg("set_chnl_bw_handler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.SetHwRegHandler) { - rtw_hal_error_msg("SetHwRegHandler"); + if (NULL == padapter->hal_func.set_hw_reg_handler) { + rtw_hal_error_msg("set_hw_reg_handler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.GetHwRegHandler) { + if (NULL == padapter->hal_func.GetHwRegHandler) { rtw_hal_error_msg("GetHwRegHandler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.GetHalDefVarHandler) { - rtw_hal_error_msg("GetHalDefVarHandler"); + if (NULL == padapter->hal_func.get_hal_def_var_handler) { + rtw_hal_error_msg("get_hal_def_var_handler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.SetHalDefVarHandler) { + if (NULL == padapter->hal_func.SetHalDefVarHandler) { rtw_hal_error_msg("SetHalDefVarHandler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.GetHalODMVarHandler) { + if (NULL == padapter->hal_func.GetHalODMVarHandler) { rtw_hal_error_msg("GetHalODMVarHandler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.SetHalODMVarHandler) { + if (NULL == padapter->hal_func.SetHalODMVarHandler) { rtw_hal_error_msg("SetHalODMVarHandler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.UpdateRAMaskHandler) { - rtw_hal_error_msg("UpdateRAMaskHandler"); - ret = _FAIL; - } - if (NULL == padapter->HalFunc.SetBeaconRelatedRegistersHandler) { + if (NULL == padapter->hal_func.SetBeaconRelatedRegistersHandler) { rtw_hal_error_msg("SetBeaconRelatedRegistersHandler"); ret = _FAIL; } - if (NULL == padapter->HalFunc.fill_h2c_cmd) { + if (NULL == padapter->hal_func.fill_h2c_cmd) { rtw_hal_error_msg("fill_h2c_cmd"); ret = _FAIL; } #ifdef RTW_HALMAC - if (NULL == padapter->HalFunc.hal_mac_c2h_handler) { + if (NULL == padapter->hal_func.hal_mac_c2h_handler) { rtw_hal_error_msg("hal_mac_c2h_handler"); ret = _FAIL; } #elif !defined(CONFIG_RTL8188E) - if (NULL == padapter->HalFunc.c2h_handler) { + if (NULL == padapter->hal_func.c2h_handler) { rtw_hal_error_msg("c2h_handler"); ret = _FAIL; } #endif #if defined(CONFIG_LPS) || defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) - if (NULL == padapter->HalFunc.fill_fake_txdesc) { + if (NULL == padapter->hal_func.fill_fake_txdesc) { rtw_hal_error_msg("fill_fake_txdesc"); ret = _FAIL; } #endif - if (NULL == padapter->HalFunc.hal_get_tx_buff_rsvd_page_num) { + +#ifndef RTW_HALMAC + if (NULL == padapter->hal_func.hal_get_tx_buff_rsvd_page_num) { rtw_hal_error_msg("hal_get_tx_buff_rsvd_page_num"); ret = _FAIL; } +#endif /* !RTW_HALMAC */ #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - if (NULL == padapter->HalFunc.clear_interrupt) { + if (NULL == padapter->hal_func.clear_interrupt) { rtw_hal_error_msg("clear_interrupt"); ret = _FAIL; } #endif #endif /* CONFIG_WOWLAN */ - if (NULL == padapter->HalFunc.fw_dl) { + if (NULL == padapter->hal_func.fw_dl) { rtw_hal_error_msg("fw_dl"); ret = _FAIL; } +#if defined(RTW_HALMAC) && defined(CONFIG_LPS_PG) + if (NULL == padapter->hal_func.fw_mem_dl) { + rtw_hal_error_msg("fw_mem_dl"); + ret = _FAIL; + } +#endif + if ((IS_HARDWARE_TYPE_8814A(padapter) || IS_HARDWARE_TYPE_8822BU(padapter) || IS_HARDWARE_TYPE_8822BS(padapter)) - && NULL == padapter->HalFunc.fw_correct_bcn) { + && NULL == padapter->hal_func.fw_correct_bcn) { rtw_hal_error_msg("fw_correct_bcn"); ret = _FAIL; } if (IS_HARDWARE_TYPE_8822B(padapter) || IS_HARDWARE_TYPE_8821C(padapter)) { - if (!padapter->HalFunc.set_tx_power_index_handler) { + if (!padapter->hal_func.set_tx_power_index_handler) { rtw_hal_error_msg("set_tx_power_index_handler"); ret = _FAIL; } } - if (!padapter->HalFunc.get_tx_power_index_handler) { + if (!padapter->hal_func.get_tx_power_index_handler) { rtw_hal_error_msg("get_tx_power_index_handler"); ret = _FAIL; } /*** SReset section ***/ #ifdef DBG_CONFIG_ERROR_DETECT - if (NULL == padapter->HalFunc.sreset_init_value) { + if (NULL == padapter->hal_func.sreset_init_value) { rtw_hal_error_msg("sreset_init_value"); ret = _FAIL; } - if (NULL == padapter->HalFunc.sreset_reset_value) { + if (NULL == padapter->hal_func.sreset_reset_value) { rtw_hal_error_msg("sreset_reset_value"); ret = _FAIL; } - if (NULL == padapter->HalFunc.silentreset) { + if (NULL == padapter->hal_func.silentreset) { rtw_hal_error_msg("silentreset"); ret = _FAIL; } - if (NULL == padapter->HalFunc.sreset_xmit_status_check) { + if (NULL == padapter->hal_func.sreset_xmit_status_check) { rtw_hal_error_msg("sreset_xmit_status_check"); ret = _FAIL; } - if (NULL == padapter->HalFunc.sreset_linked_status_check) { + if (NULL == padapter->hal_func.sreset_linked_status_check) { rtw_hal_error_msg("sreset_linked_status_check"); ret = _FAIL; } - if (NULL == padapter->HalFunc.sreset_get_wifi_status) { + if (NULL == padapter->hal_func.sreset_get_wifi_status) { rtw_hal_error_msg("sreset_get_wifi_status"); ret = _FAIL; } - if (NULL == padapter->HalFunc.sreset_inprogress) { + if (NULL == padapter->hal_func.sreset_inprogress) { rtw_hal_error_msg("sreset_inprogress"); ret = _FAIL; } #endif /* #ifdef DBG_CONFIG_ERROR_DETECT */ #ifdef RTW_HALMAC - if (NULL == padapter->HalFunc.init_mac_register) { + if (NULL == padapter->hal_func.init_mac_register) { rtw_hal_error_msg("init_mac_register"); ret = _FAIL; } - if (NULL == padapter->HalFunc.init_phy) { + if (NULL == padapter->hal_func.init_phy) { rtw_hal_error_msg("init_phy"); ret = _FAIL; } #endif /* RTW_HALMAC */ + +#ifdef CONFIG_RFKILL_POLL + if (padapter->hal_func.hal_radio_onoff_check == NULL) { + rtw_hal_error_msg("hal_radio_onoff_check"); + ret = _FAIL; + } +#endif #endif return ret; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mcc.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mcc.c index 71b869701f0b..2290cd773779 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mcc.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mcc.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - ******************************************************************************/ + *****************************************************************************/ #ifdef CONFIG_MCC_MODE #define _HAL_MCC_C_ @@ -24,14 +20,201 @@ #include /* HAL_DATA */ #include /* power control */ -/* backup IQK value */ -void rtw_hal_mcc_backup_IQK_val(PADAPTER padapter) +#define MCC_DURATION_IDX 0 +#define MCC_TSF_SYNC_OFFSET_IDX 1 +#define MCC_START_TIME_OFFSET_IDX 2 +#define MCC_INTERVAL_IDX 3 +#define MCC_GUARD_OFFSET0_IDX 4 +#define MCC_GUARD_OFFSET1_IDX 5 +#define TU 1024 /* 1 TU equals 1024 microseconds */ +/* port 1 druration, TSF sync offset, start time offset, interval (unit:TU (1024 microseconds))*/ +u8 mcc_switch_channel_policy_table[][6]={ + {35, 50, 30, 100, 0, 0}, + {19, 50, 40, 100, 2, 2}, + {25, 50, 30, 100, 5, 5}, +}; + +const int mcc_max_policy_num = sizeof(mcc_switch_channel_policy_table) /sizeof(u8) /6; + +static void dump_iqk_val_table(PADAPTER padapter) +{ + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct hal_iqk_reg_backup *iqk_reg_backup = pHalData->iqk_reg_backup; + u8 total_rf_path = pHalData->NumTotalRFPath; + u8 rf_path_idx = 0; + u8 backup_chan_idx = 0; + u8 backup_reg_idx = 0; + + RTW_INFO("=============dump IQK backup table================\n"); + for (backup_chan_idx = 0; backup_chan_idx < MAX_IQK_INFO_BACKUP_CHNL_NUM; backup_chan_idx++) { + for (rf_path_idx = 0; rf_path_idx < total_rf_path; rf_path_idx++) { + for(backup_reg_idx = 0; backup_reg_idx < MAX_IQK_INFO_BACKUP_REG_NUM; backup_reg_idx++) { + RTW_INFO("ch:%d. bw:%d. rf path:%d. reg[%d] = 0x%02x \n" + , iqk_reg_backup[backup_chan_idx].central_chnl + , iqk_reg_backup[backup_chan_idx].bw_mode + , rf_path_idx + , backup_reg_idx + , iqk_reg_backup[backup_chan_idx].reg_backup[rf_path_idx][backup_reg_idx] + ); + } + } + } + RTW_INFO("=============================================\n"); +} + +static void rtw_hal_mcc_build_p2p_noa_attr(PADAPTER padapter, u8 *ie, u32 *ie_len) +{ + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); + u8 p2p_noa_attr_ie[MAX_P2P_IE_LEN] = {0x00}; + u32 p2p_noa_attr_len = 0; + u8 noa_desc_num = 1; + u8 opp_ps = 0; /* Disable OppPS */ + u8 noa_count = 255; + u32 noa_duration = 0x20; + u32 noa_interval = 0x64; + u8 noa_index = 0; + u8 mcc_policy_idx = 0; + + mcc_policy_idx = pmccobjpriv->policy_index; + noa_duration = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_DURATION_IDX]; + noa_interval = mcc_switch_channel_policy_table[mcc_policy_idx][MCC_INTERVAL_IDX]; + + /* P2P OUI(4 bytes) */ + _rtw_memcpy(p2p_noa_attr_ie, P2P_OUI, 4); + p2p_noa_attr_len = p2p_noa_attr_len + 4; + + /* attrute ID(1 byte) */ + p2p_noa_attr_ie[p2p_noa_attr_len] = P2P_ATTR_NOA; + p2p_noa_attr_len = p2p_noa_attr_len + 1; + + /* attrute length(2 bytes) length = noa_desc_num*13 + 2 */ + RTW_PUT_LE16(p2p_noa_attr_ie + p2p_noa_attr_len, (noa_desc_num*13 + 2)); + p2p_noa_attr_len = p2p_noa_attr_len + 2; + + /* Index (1 byte) */ + p2p_noa_attr_ie[p2p_noa_attr_len] = noa_index; + p2p_noa_attr_len = p2p_noa_attr_len + 1; + + /* CTWindow and OppPS Parameters (1 byte) */ + p2p_noa_attr_ie[p2p_noa_attr_len] = opp_ps; + p2p_noa_attr_len = p2p_noa_attr_len+ 1; + + /* NoA Count (1 byte) */ + p2p_noa_attr_ie[p2p_noa_attr_len] = noa_count; + p2p_noa_attr_len = p2p_noa_attr_len + 1; + + /* NoA Duration (4 bytes) unit: microseconds */ + RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, (noa_duration * TU)); + p2p_noa_attr_len = p2p_noa_attr_len + 4; + + /* NoA Interval (4 bytes) unit: microseconds */ + RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, (noa_interval * TU)); + p2p_noa_attr_len = p2p_noa_attr_len + 4; + + /* NoA Start Time (4 bytes) unit: microseconds */ + RTW_PUT_LE32(p2p_noa_attr_ie + p2p_noa_attr_len, pmccadapriv->noa_start_time); + if (0) + RTW_INFO("indxe:%d, start_time=0x%02x:0x%02x:0x%02x:0x%02x\n" + , noa_index + , p2p_noa_attr_ie[p2p_noa_attr_len] + , p2p_noa_attr_ie[p2p_noa_attr_len + 1] + , p2p_noa_attr_ie[p2p_noa_attr_len + 2] + , p2p_noa_attr_ie[p2p_noa_attr_len + 3]); + + p2p_noa_attr_len = p2p_noa_attr_len + 4; + rtw_set_ie(ie, _VENDOR_SPECIFIC_IE_, p2p_noa_attr_len, (u8 *)p2p_noa_attr_ie, ie_len); +} + + +/** + * rtw_hal_mcc_update_go_p2p_ie - update go p2p ie(add NoA attribute) + * @padapter: the adapter to be update go p2p ie + */ +static void rtw_hal_mcc_update_go_p2p_ie(PADAPTER padapter) +{ + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + u8 *pos = NULL; + + + /* no noa attribute, build it */ + if (pmccadapriv->p2p_go_noa_ie_len == 0) + rtw_hal_mcc_build_p2p_noa_attr(padapter, pmccadapriv->p2p_go_noa_ie, &pmccadapriv->p2p_go_noa_ie_len); + else { + /* has noa attribut, modify it */ + /* update index */ + pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 15; + /* 0~255 */ + (*pos) = ((*pos) + 1) % 256; + if (1) + RTW_INFO("indxe:%d\n", (*pos)); + + /* update start time */ + pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len - 4; + RTW_PUT_LE32(pos, pmccadapriv->noa_start_time); + if (0) + RTW_INFO("start_time=0x%02x:0x%02x:0x%02x:0x%02x\n" + , ((u8*)(pos))[0] + , ((u8*)(pos))[1] + , ((u8*)(pos))[2] + , ((u8*)(pos))[3]); + + } + + if (0) { + u8 i = 0; + RTW_INFO("p2p_go_noa_ie_len:%d\n", pmccadapriv->p2p_go_noa_ie_len); + + for (i = 0;i < pmccadapriv->p2p_go_noa_ie_len; i++) { + if ((i+1)%8 != 0) + printk("0x%02x ", pmccadapriv->p2p_go_noa_ie[i]); + else + printk("0x%02x\n", pmccadapriv->p2p_go_noa_ie[i]); + } + printk("\n"); + } + update_beacon(padapter, _VENDOR_SPECIFIC_IE_, P2P_OUI, _TRUE); +} + +/** + * rtw_hal_mcc_remove_go_p2p_ie - remove go p2p ie(add NoA attribute) + * @padapter: the adapter to be update go p2p ie + */ +static void rtw_hal_mcc_remove_go_p2p_ie(PADAPTER padapter) +{ + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + + /* chech has noa ie or not */ + if (pmccadapriv->p2p_go_noa_ie_len == 0) + return; + + pmccadapriv->p2p_go_noa_ie_len = 0; + update_beacon(padapter, _VENDOR_SPECIFIC_IE_, P2P_OUI, _TRUE); +} + +/* restore IQK value for all interface */ +void rtw_hal_mcc_restore_iqk_val(PADAPTER padapter) { u8 take_care_iqk = _FALSE; + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + _adapter *iface = NULL; + u8 i = 0; rtw_hal_get_hwreg(padapter, HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, &take_care_iqk); - if (take_care_iqk == _TRUE && MCC_EN(padapter)) - rtw_hal_ch_sw_iqk_info_restore(padapter, CH_SW_USE_CASE_MCC); + if (take_care_iqk == _TRUE && MCC_EN(padapter)) { + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface == NULL) + continue; + + rtw_hal_ch_sw_iqk_info_restore(iface, CH_SW_USE_CASE_MCC); + } + } + + if (0) + dump_iqk_val_table(padapter); } u8 rtw_hal_check_mcc_status(PADAPTER padapter, u8 mcc_status) @@ -58,6 +241,73 @@ void rtw_hal_clear_mcc_status(PADAPTER padapter, u8 mcc_status) pmccobjpriv->mcc_status &= (~mcc_status); } +void rtw_hal_mcc_update_switch_channel_policy_table(PADAPTER padapter) +{ + struct registry_priv *registry_par = &padapter->registrypriv; + u8 idx = 0; + + if (registry_par->rtw_mcc_policy_table_idx < 0) + return; + + if (registry_par->rtw_mcc_policy_table_idx >= mcc_max_policy_num) { + RTW_INFO("[MCC] mcc_policy_table_idx error, do not update policy table\n"); + return; + } + + idx = registry_par->rtw_mcc_policy_table_idx; + + if (registry_par->rtw_mcc_duration > 0) + mcc_switch_channel_policy_table[idx][MCC_DURATION_IDX] = registry_par->rtw_mcc_duration; + + if (registry_par->rtw_mcc_tsf_sync_offset > 0) + mcc_switch_channel_policy_table[idx][MCC_TSF_SYNC_OFFSET_IDX] = registry_par->rtw_mcc_tsf_sync_offset; + + if (registry_par->rtw_mcc_start_time_offset > 0) + mcc_switch_channel_policy_table[idx][MCC_START_TIME_OFFSET_IDX] = registry_par->rtw_mcc_start_time_offset; + + if (registry_par->rtw_mcc_interval > 0) + mcc_switch_channel_policy_table[idx][MCC_INTERVAL_IDX] = registry_par->rtw_mcc_interval; + + if (registry_par->rtw_mcc_guard_offset0 >= 0) + mcc_switch_channel_policy_table[idx][MCC_GUARD_OFFSET0_IDX] = registry_par->rtw_mcc_guard_offset0; + + if (registry_par->rtw_mcc_guard_offset1 >= 0) + mcc_switch_channel_policy_table[idx][MCC_GUARD_OFFSET1_IDX] = registry_par->rtw_mcc_guard_offset1; + +} + +static void rtw_hal_config_mcc_switch_channel_setting(PADAPTER padapter) +{ + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); + struct registry_priv *registry_par = &padapter->registrypriv; + u8 interval = pmlmepriv->cur_network.network.Configuration.BeaconPeriod; + u8 i = 0; + s8 mcc_policy_idx = 0; + + rtw_hal_mcc_update_switch_channel_policy_table(padapter); + mcc_policy_idx = registry_par->rtw_mcc_policy_table_idx; + + if (mcc_policy_idx < 0 || mcc_policy_idx >= mcc_max_policy_num) { + pmccobjpriv->policy_index = 0; + RTW_INFO("[MCC] can't find table(%d,%d,%d), use default policy(%d)\n" + , pmccobjpriv->duration, interval, mcc_policy_idx, pmccobjpriv->policy_index); + } else + pmccobjpriv->policy_index = mcc_policy_idx; + + RTW_INFO("[MCC] policy(%d): %d,%d,%d,%d,%d,%d\n" + , pmccobjpriv->policy_index + , mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_DURATION_IDX] + , mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_TSF_SYNC_OFFSET_IDX] + , mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_START_TIME_OFFSET_IDX] + , mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_INTERVAL_IDX] + , mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_GUARD_OFFSET0_IDX] + , mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_GUARD_OFFSET1_IDX]); + +} + static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); @@ -69,13 +319,22 @@ static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) struct sta_priv *pstapriv = &padapter->stapriv; struct sta_info *psta = NULL; struct registry_priv *preg = &padapter->registrypriv; + u8 policy_index = 0; + u8 mcc_duration = 0; + u8 mcc_interval = 0; + + policy_index = pmccobjpriv->policy_index; + mcc_duration = mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_DURATION_IDX] + - mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_GUARD_OFFSET0_IDX] + - mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_GUARD_OFFSET1_IDX]; + mcc_interval = mcc_switch_channel_policy_table[pmccobjpriv->policy_index][MCC_INTERVAL_IDX]; /* GO/AP is 1nd order GC/STA is 2nd order */ switch (pmccadapriv->role) { case MCC_ROLE_STA: case MCC_ROLE_GC: pmccadapriv->order = 1; - pmccadapriv->mcc_duration = pmccobjpriv->duration; + pmccadapriv->mcc_duration = mcc_duration; switch (pmlmeext->cur_bwmode) { case CHANNEL_WIDTH_20: @@ -107,7 +366,7 @@ static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); if (psta) { /* combine AP/GO macid and mgmt queue macid to bitmap */ - pmccadapriv->mcc_macid_bitmap = BIT(psta->mac_id) | BIT(pmccadapriv->mgmt_queue_macid); + pmccadapriv->mcc_macid_bitmap = BIT(psta->cmn.mac_id) | BIT(pmccadapriv->mgmt_queue_macid); } else { RTW_INFO(FUNC_ADPT_FMT":AP/GO station info is NULL\n", FUNC_ADPT_ARG(padapter)); rtw_warn_on(1); @@ -116,7 +375,9 @@ static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) case MCC_ROLE_AP: case MCC_ROLE_GO: pmccadapriv->order = 0; - pmccadapriv->mcc_duration = 100 - pmccobjpriv->duration; /* 100 means beacon interval */ + /* total druation value equals interval */ + pmccadapriv->mcc_duration = mcc_interval - mcc_duration; + pmccadapriv->p2p_go_noa_ie_len = 0; /* not NoA attribute at init time */ switch (pmlmeext->cur_bwmode) { case CHANNEL_WIDTH_20: @@ -139,7 +400,7 @@ static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) psta = rtw_get_bcmc_stainfo(padapter); if (psta != NULL) - pmccadapriv->mgmt_queue_macid = psta->mac_id; + pmccadapriv->mgmt_queue_macid = psta->cmn.mac_id; else { pmccadapriv->mgmt_queue_macid = MCC_ROLE_SOFTAP_GO_MGMT_QUEUE_MACID; RTW_INFO(FUNC_ADPT_FMT":bcmc station is NULL, use macid %d\n" @@ -158,23 +419,21 @@ static void rtw_hal_config_mcc_role_setting(PADAPTER padapter) pmccobjpriv->iface[pmccadapriv->order] = padapter; RTW_INFO(FUNC_ADPT_FMT": order:%d, role:%d, mcc duration:%d, target tx bytes:%d, mgmt queue macid:%d, bitmap:0x%02x\n" , FUNC_ADPT_ARG(padapter), pmccadapriv->order, pmccadapriv->role, pmccadapriv->mcc_duration - , pmccadapriv->mcc_target_tx_bytes_to_port, pmccadapriv->mgmt_queue_macid, pmccadapriv->mcc_macid_bitmap); + , pmccadapriv->mcc_target_tx_bytes_to_port, pmccadapriv->mgmt_queue_macid, pmccadapriv->mcc_macid_bitmap); } static void rtw_hal_clear_mcc_macid(PADAPTER padapter) { + u16 media_status_rpt; struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; switch (pmccadapriv->role) { case MCC_ROLE_STA: case MCC_ROLE_GC: - /* release mgmt queue macid */ - rtw_hal_set_FwMediaStatusRpt_single_cmd(padapter - , 0, 0, 0, H2C_MSR_ROLE_AP, pmccadapriv->mgmt_queue_macid); break; case MCC_ROLE_AP: case MCC_ROLE_GO: - /* nothing to do */ + /* nothing to do */ break; default: RTW_INFO("Unknown role\n"); @@ -235,7 +494,7 @@ static void rtw_hal_construct_CTS(PADAPTER padapter, u8 *pframe, u32 *pLength) u8 broadcast_addr[ETH_ALEN] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; /* frame type, length = 1*/ - SetFrameSubType(pframe, WIFI_RTS); + set_frame_sub_type(pframe, WIFI_RTS); /* frame control flag, length = 1 */ *(pframe + 1) = 0; @@ -247,13 +506,13 @@ static void rtw_hal_construct_CTS(PADAPTER padapter, u8 *pframe, u32 *pLength) /* frame recvaddr, length = 6 */ _rtw_memcpy((pframe + 4), broadcast_addr, ETH_ALEN); _rtw_memcpy((pframe + 4 + ETH_ALEN), adapter_mac_addr(padapter), ETH_ALEN); - _rtw_memcpy((pframe + 4 + ETH_ALEN * 2), adapter_mac_addr(padapter), ETH_ALEN); + _rtw_memcpy((pframe + 4 + ETH_ALEN*2), adapter_mac_addr(padapter), ETH_ALEN); *pLength = 22; } u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, - u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, - RSVDPAGE_LOC *rsvd_page_loc) + u8 tx_desc, u32 page_size, u8 *page_num, u32 *total_pkt_len, + RSVDPAGE_LOC *rsvd_page_loc) { u32 len = 0; _adapter *iface = NULL; @@ -291,8 +550,8 @@ u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, _rtw_memcpy(bssid, get_my_bssid(&pmlmeinfo->network), ETH_ALEN); rtw_hal_construct_NullFunctionData(iface , &pframe[*index], &len, bssid, _FALSE, 0, 0, _FALSE); - rtw_hal_fill_fake_txdesc(iface, &pframe[*index - tx_desc], - len, _FALSE, _FALSE, _FALSE); + rtw_hal_fill_fake_txdesc(iface, &pframe[*index-tx_desc], + len, _FALSE, _FALSE, _FALSE); CurtPktPageNum = (u8)PageNum(tx_desc + len, page_size); *page_num += CurtPktPageNum; @@ -306,8 +565,8 @@ u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, len = 0; rtw_hal_construct_CTS(iface, &pframe[*index], &len); - rtw_hal_fill_fake_txdesc(iface, &pframe[*index - tx_desc], - len, _FALSE, _FALSE, _FALSE); + rtw_hal_fill_fake_txdesc(iface, &pframe[*index-tx_desc], + len, _FALSE, _FALSE, _FALSE); CurtPktPageNum = (u8)PageNum(tx_desc + len, page_size); *page_num += CurtPktPageNum; @@ -315,7 +574,7 @@ u8 rtw_hal_dl_mcc_fw_rsvd_page(_adapter *adapter, u8 *pframe, u16 *index, *total_pkt_len = *index + len; break; case MCC_ROLE_GO: - /* To DO */ + /* To DO */ break; } } @@ -346,7 +605,7 @@ static void rtw_hal_set_fw_mcc_rsvd_page(PADAPTER padapter) iface = pmccobjpriv->iface[i]; pmccadapriv = &iface->mcc_adapterpriv; if (pmccadapriv->role == MCC_ROLE_AP - || pmccadapriv->role == MCC_ROLE_GO) + || pmccadapriv->role == MCC_ROLE_GO) tx_beacon_hdl(iface, NULL); } } @@ -367,7 +626,7 @@ static void rtw_hal_set_mcc_rsvdpage_cmd(_adapter *padapter) order = iface->mcc_adapterpriv.order; if (order >= H2C_MCC_LOCATION_LEN) { RTW_INFO(FUNC_ADPT_FMT" only support 3 interface at most(%d)\n" - , FUNC_ADPT_ARG(padapter), order); + , FUNC_ADPT_ARG(padapter), order); continue; } @@ -390,11 +649,16 @@ static void rtw_hal_set_mcc_noa_cmd(PADAPTER padapter) { struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); u8 cmd[H2C_MCC_NOA_PARAM_LEN] = {0}; + u8 policy_idx = pmccobjpriv->policy_index; u8 noa_fw_eable = 1; - u8 noa_tsf_sync_offset = 50; - u8 noa_start_time = 30; - u8 noa_interval = pmlmepriv->cur_network.network.Configuration.BeaconPeriod; + u8 noa_tsf_sync_offset = mcc_switch_channel_policy_table[policy_idx][MCC_TSF_SYNC_OFFSET_IDX]; + u8 noa_start_time_offset = mcc_switch_channel_policy_table[policy_idx][MCC_START_TIME_OFFSET_IDX]; + u8 noa_interval = mcc_switch_channel_policy_table[policy_idx][MCC_INTERVAL_IDX]; + u8 guard_offset0 = mcc_switch_channel_policy_table[policy_idx][MCC_GUARD_OFFSET0_IDX]; + u8 guard_offset1 = mcc_switch_channel_policy_table[policy_idx][MCC_GUARD_OFFSET1_IDX]; u8 swchannel_early_time = MCC_SWCH_FW_EARLY_TIME; u8 i = 0; @@ -403,7 +667,7 @@ static void rtw_hal_set_mcc_noa_cmd(PADAPTER padapter) /* TSF Sync offset */ SET_H2CCMD_MCC_NOA_TSF_SYNC_OFFSET(cmd, noa_tsf_sync_offset); /* NoA start time offset */ - SET_H2CCMD_MCC_NOA_START_TIME(cmd, noa_start_time); + SET_H2CCMD_MCC_NOA_START_TIME(cmd, (noa_start_time_offset + guard_offset0)); /* NoA interval */ SET_H2CCMD_MCC_NOA_INTERVAL(cmd, noa_interval); /* Early time to inform driver by C2H before switch channel */ @@ -424,71 +688,79 @@ static void rtw_hal_set_mcc_noa_cmd(PADAPTER padapter) static void rtw_hal_set_mcc_IQK_offload_cmd(PADAPTER padapter) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); struct mcc_adapter_priv *pmccadapriv = NULL; _adapter *iface = NULL; u8 cmd[H2C_MCC_IQK_PARAM_LEN] = {0}, bready = 0, i = 0, order = 0; u16 TX_X = 0, TX_Y = 0, RX_X = 0, RX_Y = 0; + u8 total_rf_path = GET_HAL_DATA(padapter)->NumTotalRFPath; + u8 rf_path_idx = 0, last_order = MAX_MCC_NUM - 1, last_rf_path_index = total_rf_path - 1; + /* by order, last order & last_rf_path_index must set ready bit = 1 */ for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; + iface = pmccobjpriv->iface[i]; if (iface == NULL) continue; pmccadapriv = &iface->mcc_adapterpriv; order = pmccadapriv->order; - /* TO DO for multi-antenna(FW not support) */ - TX_X = pmccadapriv->mcc_iqk_arr[0].TX_X & 0x7ff;/* [10:0] */ - TX_Y = pmccadapriv->mcc_iqk_arr[0].TX_Y & 0x7ff;/* [10:0] */ - RX_X = pmccadapriv->mcc_iqk_arr[0].RX_X & 0x3ff;/* [9:0] */ - RX_Y = pmccadapriv->mcc_iqk_arr[0].RX_Y & 0x3ff;/* [9:0] */ - _rtw_memset(cmd, 0, H2C_MCC_IQK_PARAM_LEN); - /* ready or not */ - if (order == 1) - bready = 1; - else - bready = 0; + for (rf_path_idx = 0; rf_path_idx < total_rf_path; rf_path_idx ++) { - SET_H2CCMD_MCC_IQK_READY(cmd, bready); - SET_H2CCMD_MCC_IQK_ORDER(cmd, order); + _rtw_memset(cmd, 0, H2C_MCC_IQK_PARAM_LEN); + TX_X = pmccadapriv->mcc_iqk_arr[rf_path_idx].TX_X & 0x7ff;/* [10:0] */ + TX_Y = pmccadapriv->mcc_iqk_arr[rf_path_idx].TX_Y & 0x7ff;/* [10:0] */ + RX_X = pmccadapriv->mcc_iqk_arr[rf_path_idx].RX_X & 0x3ff;/* [9:0] */ + RX_Y = pmccadapriv->mcc_iqk_arr[rf_path_idx].RX_Y & 0x3ff;/* [9:0] */ - /* fill RX_X[7:0] to (cmd+1)[7:0] bitlen=8 */ - SET_H2CCMD_MCC_IQK_RX_L(cmd, (u8)(RX_X & 0xff)); - /* fill RX_X[9:8] to (cmd+2)[1:0] bitlen=2 */ - SET_H2CCMD_MCC_IQK_RX_M1(cmd, (u8)((RX_X >> 8) & 0x03)); - /* fill RX_Y[5:0] to (cmd+2)[7:2] bitlen=6 */ - SET_H2CCMD_MCC_IQK_RX_M2(cmd, (u8)(RX_Y & 0x3f)); - /* fill RX_Y[9:6] to (cmd+3)[3:0] bitlen=4 */ - SET_H2CCMD_MCC_IQK_RX_H(cmd, (u8)((RX_Y >> 6) & 0x0f)); + /* ready or not */ + if (order == last_order && rf_path_idx == last_rf_path_index) + bready = 1; + else + bready = 0; + + SET_H2CCMD_MCC_IQK_READY(cmd, bready); + SET_H2CCMD_MCC_IQK_ORDER(cmd, order); + SET_H2CCMD_MCC_IQK_PATH(cmd, rf_path_idx); + + /* fill RX_X[7:0] to (cmd+1)[7:0] bitlen=8 */ + SET_H2CCMD_MCC_IQK_RX_L(cmd, (u8)(RX_X & 0xff)); + /* fill RX_X[9:8] to (cmd+2)[1:0] bitlen=2 */ + SET_H2CCMD_MCC_IQK_RX_M1(cmd, (u8)((RX_X >> 8) & 0x03)); + /* fill RX_Y[5:0] to (cmd+2)[7:2] bitlen=6 */ + SET_H2CCMD_MCC_IQK_RX_M2(cmd, (u8)(RX_Y & 0x3f)); + /* fill RX_Y[9:6] to (cmd+3)[3:0] bitlen=4 */ + SET_H2CCMD_MCC_IQK_RX_H(cmd, (u8)((RX_Y >> 6) & 0x0f)); - /* fill TX_X[7:0] to (cmd+4)[7:0] bitlen=8 */ - SET_H2CCMD_MCC_IQK_TX_L(cmd, (u8)(TX_X & 0xff)); - /* fill TX_X[10:8] to (cmd+5)[2:0] bitlen=3 */ - SET_H2CCMD_MCC_IQK_TX_M1(cmd, (u8)((TX_X >> 8) & 0x07)); - /* fill TX_Y[4:0] to (cmd+5)[7:3] bitlen=5 */ - SET_H2CCMD_MCC_IQK_TX_M2(cmd, (u8)(TX_Y & 0x1f)); - /* fill TX_Y[10:5] to (cmd+6)[5:0] bitlen=6 */ - SET_H2CCMD_MCC_IQK_TX_H(cmd, (u8)((TX_Y >> 5) & 0x3f)); + /* fill TX_X[7:0] to (cmd+4)[7:0] bitlen=8 */ + SET_H2CCMD_MCC_IQK_TX_L(cmd, (u8)(TX_X & 0xff)); + /* fill TX_X[10:8] to (cmd+5)[2:0] bitlen=3 */ + SET_H2CCMD_MCC_IQK_TX_M1(cmd, (u8)((TX_X >> 8) & 0x07)); + /* fill TX_Y[4:0] to (cmd+5)[7:3] bitlen=5 */ + SET_H2CCMD_MCC_IQK_TX_M2(cmd, (u8)(TX_Y & 0x1f)); + /* fill TX_Y[10:5] to (cmd+6)[5:0] bitlen=6 */ + SET_H2CCMD_MCC_IQK_TX_H(cmd, (u8)((TX_Y >> 5) & 0x3f)); #ifdef CONFIG_MCC_MODE_DEBUG - RTW_INFO("=========================\n"); - RTW_INFO(FUNC_ADPT_FMT" IQK:\n", FUNC_ADPT_ARG(iface)); - RTW_INFO("TX_X: 0x%02x\n", TX_X); - RTW_INFO("TX_Y: 0x%02x\n", TX_Y); - RTW_INFO("RX_X: 0x%02x\n", RX_X); - RTW_INFO("RX_Y: 0x%02x\n", RX_Y); - RTW_INFO("cmd[0]:0x%02x\n", cmd[0]); - RTW_INFO("cmd[1]:0x%02x\n", cmd[1]); - RTW_INFO("cmd[2]:0x%02x\n", cmd[2]); - RTW_INFO("cmd[3]:0x%02x\n", cmd[3]); - RTW_INFO("cmd[4]:0x%02x\n", cmd[4]); - RTW_INFO("cmd[5]:0x%02x\n", cmd[5]); - RTW_INFO("cmd[6]:0x%02x\n", cmd[6]); - RTW_INFO("=========================\n"); + RTW_INFO("=========================\n"); + RTW_INFO(FUNC_ADPT_FMT" IQK:\n", FUNC_ADPT_ARG(iface)); + RTW_INFO("TX_X: 0x%02x\n", TX_X); + RTW_INFO("TX_Y: 0x%02x\n", TX_Y); + RTW_INFO("RX_X: 0x%02x\n", RX_X); + RTW_INFO("RX_Y: 0x%02x\n", RX_Y); + RTW_INFO("cmd[0]:0x%02x\n", cmd[0]); + RTW_INFO("cmd[1]:0x%02x\n", cmd[1]); + RTW_INFO("cmd[2]:0x%02x\n", cmd[2]); + RTW_INFO("cmd[3]:0x%02x\n", cmd[3]); + RTW_INFO("cmd[4]:0x%02x\n", cmd[4]); + RTW_INFO("cmd[5]:0x%02x\n", cmd[5]); + RTW_INFO("cmd[6]:0x%02x\n", cmd[6]); + RTW_INFO("=========================\n"); #endif /* CONFIG_MCC_MODE_DEBUG */ - rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_IQK_PARAM, H2C_MCC_IQK_PARAM_LEN, cmd); + rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_IQK_PARAM, H2C_MCC_IQK_PARAM_LEN, cmd); + } } } @@ -510,9 +782,9 @@ static void rtw_hal_set_mcc_macid_cmd(PADAPTER padapter) order = pmccadapriv->order; bitmap = pmccadapriv->mcc_macid_bitmap; - if (order >= (H2C_MCC_MACID_BITMAP_LEN / 2)) { + if (order >= (H2C_MCC_MACID_BITMAP_LEN/2)) { RTW_INFO(FUNC_ADPT_FMT" only support 3 interface at most(%d)\n" - , FUNC_ADPT_ARG(padapter), order); + , FUNC_ADPT_ARG(padapter), order); continue; } SET_H2CCMD_MCC_MACID_BITMAP_L((cmd + order * 2), (u8)(bitmap & 0xff)); @@ -530,9 +802,9 @@ static void rtw_hal_set_mcc_macid_cmd(PADAPTER padapter) rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_MACID_BITMAP, H2C_MCC_MACID_BITMAP_LEN, cmd); } -static void rtw_hal_set_mcc_parameter_cmd(PADAPTER padapter, u8 stop) +static void rtw_hal_set_mcc_ctrl_cmd(PADAPTER padapter, u8 stop) { - u8 cmd[H2C_MCC_INFO_LEN] = {0}, i = 0; + u8 cmd[H2C_MCC_CTRL_LEN] = {0}, i = 0; u8 order = 0, totalnum = 0, chidx = 0, bw = 0, bw40sc = 0, bw80sc = 0; u8 duration = 0, role = 0, incurch = 0, rfetype = 0, distxnull = 0, c2hrpt = 0, chscan = 0; struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); @@ -585,7 +857,7 @@ static void rtw_hal_set_mcc_parameter_cmd(PADAPTER padapter, u8 stop) incurch = _FALSE; if (IS_HARDWARE_TYPE_8812(padapter)) - rfetype = pHalData->RFEType; /* RFETYPE (only for 8812)*/ + rfetype = pHalData->rfe_type; /* RFETYPE (only for 8812)*/ else rfetype = 0; @@ -604,19 +876,19 @@ static void rtw_hal_set_mcc_parameter_cmd(PADAPTER padapter, u8 stop) c2hrpt = MCC_C2H_REPORT_ALL_STATUS; chscan = MCC_CHIDX; - SET_H2CCMD_MCC_INFO_ORDER(cmd, order); - SET_H2CCMD_MCC_INFO_TOTALNUM(cmd, totalnum); - SET_H2CCMD_MCC_INFO_CHIDX(cmd, chidx); - SET_H2CCMD_MCC_INFO_BW(cmd, bw); - SET_H2CCMD_MCC_INFO_BW40SC(cmd, bw40sc); - SET_H2CCMD_MCC_INFO_BW80SC(cmd, bw80sc); - SET_H2CCMD_MCC_INFO_DURATION(cmd, duration); - SET_H2CCMD_MCC_INFO_ROLE(cmd, role); - SET_H2CCMD_MCC_INFO_INCURCH(cmd, incurch); - SET_H2CCMD_MCC_INFO_RFETYPE(cmd, rfetype); - SET_H2CCMD_MCC_INFO_DISTXNULL(cmd, distxnull); - SET_H2CCMD_MCC_INFO_C2HRPT(cmd, c2hrpt); - SET_H2CCMD_MCC_INFO_CHSCAN(cmd, chscan); + SET_H2CCMD_MCC_CTRL_ORDER(cmd, order); + SET_H2CCMD_MCC_CTRL_TOTALNUM(cmd, totalnum); + SET_H2CCMD_MCC_CTRL_CHIDX(cmd, chidx); + SET_H2CCMD_MCC_CTRL_BW(cmd, bw); + SET_H2CCMD_MCC_CTRL_BW40SC(cmd, bw40sc); + SET_H2CCMD_MCC_CTRL_BW80SC(cmd, bw80sc); + SET_H2CCMD_MCC_CTRL_DURATION(cmd, duration); + SET_H2CCMD_MCC_CTRL_ROLE(cmd, role); + SET_H2CCMD_MCC_CTRL_INCURCH(cmd, incurch); + SET_H2CCMD_MCC_CTRL_RFETYPE(cmd, rfetype); + SET_H2CCMD_MCC_CTRL_DISTXNULL(cmd, distxnull); + SET_H2CCMD_MCC_CTRL_C2HRPT(cmd, c2hrpt); + SET_H2CCMD_MCC_CTRL_CHSCAN(cmd, chscan); #ifdef CONFIG_MCC_MODE_DEBUG RTW_INFO("=========================\n"); @@ -631,7 +903,7 @@ static void rtw_hal_set_mcc_parameter_cmd(PADAPTER padapter, u8 stop) RTW_INFO("=========================\n"); #endif /* CONFIG_MCC_MODE_DEBUG */ - rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_INFO, H2C_MCC_INFO_LEN, cmd); + rtw_hal_fill_h2c_cmd(padapter, H2C_MCC_CTRL, H2C_MCC_CTRL_LEN, cmd); } } @@ -653,6 +925,9 @@ static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) goto exit; } + /* configure mcc switch channel setting */ + rtw_hal_config_mcc_switch_channel_setting(padapter); + if (rtw_hal_decide_mcc_role(padapter) == _FAIL) { ret = _FAIL; goto exit; @@ -677,8 +952,8 @@ static u8 rtw_hal_set_mcc_start_setting(PADAPTER padapter, u8 status) /* set mac id to fw */ rtw_hal_set_mcc_macid_cmd(padapter); - /* set mcc parameter */ - rtw_hal_set_mcc_parameter_cmd(padapter, _FALSE); + /* set mcc parameter */ + rtw_hal_set_mcc_ctrl_cmd(padapter, _FALSE); exit: return ret; @@ -703,7 +978,7 @@ static void rtw_hal_set_mcc_stop_setting(PADAPTER padapter, u8 status) continue; /* use other interface to set cmd */ if (iface != padapter) { - rtw_hal_set_mcc_parameter_cmd(iface, _TRUE); + rtw_hal_set_mcc_ctrl_cmd(iface, _TRUE); break; } } @@ -747,6 +1022,9 @@ static void rtw_hal_mcc_stop_posthdl(PADAPTER padapter) iface->mcc_adapterpriv.mcc_tx_bytes_from_kernel = 0; iface->mcc_adapterpriv.mcc_last_tx_bytes_from_kernel = 0; iface->mcc_adapterpriv.mcc_tx_bytes_to_port = 0; + + if (iface->mcc_adapterpriv.role == MCC_ROLE_GO) + rtw_hal_mcc_remove_go_p2p_ie(iface); } } @@ -777,7 +1055,7 @@ static u8 rtw_hal_set_mcc_setting(PADAPTER padapter, u8 status) u8 ret = _FAIL; struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); u8 stop = (status < MCC_SETCMD_STATUS_START_CONNECT) ? _TRUE : _FALSE; - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); RTW_INFO("===> "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); @@ -785,8 +1063,6 @@ static u8 rtw_hal_set_mcc_setting(PADAPTER padapter, u8 status) pmccobjpriv->mcc_c2h_status = MCC_RPT_MAX; if (stop == _FALSE) { - pmccobjpriv->duration = MCC_DURATION; - /* handle mcc start */ if (rtw_hal_set_mcc_start_setting(padapter, status) == _FAIL) goto exit; @@ -854,7 +1130,7 @@ static void rtw_hal_mcc_check_case_not_limit_traffic(PADAPTER cur_iface, PADAPTE static void rtw_hal_mcc_sw_ch_fw_notify_hdl(PADAPTER padapter) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); - struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); + struct mcc_obj_priv *pmccobjpriv = &(pdvobjpriv->mcc_objpriv); struct mcc_adapter_priv *cur_mccadapriv = NULL, *next_mccadapriv = NULL; _adapter *iface = NULL, *cur_iface = NULL, *next_iface = NULL; struct registry_priv *preg = &padapter->registrypriv; @@ -937,6 +1213,48 @@ static void rtw_hal_mcc_sw_ch_fw_notify_hdl(PADAPTER padapter) } } +static void rtw_hal_mcc_update_noa_start_time_hdl(PADAPTER padapter, u8 buflen, u8 *tmpBuf) +{ + struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); + struct mcc_obj_priv *pmccobjpriv = &(pdvobjpriv->mcc_objpriv); + struct mcc_adapter_priv *pmccadapriv = NULL; + PADAPTER iface = NULL; + u8 i = 0; + u8 policy_idx = pmccobjpriv->policy_index; + u8 noa_tsf_sync_offset = mcc_switch_channel_policy_table[policy_idx][MCC_TSF_SYNC_OFFSET_IDX]; + u8 noa_start_time_offset = mcc_switch_channel_policy_table[policy_idx][MCC_START_TIME_OFFSET_IDX]; + + for (i = 0; i < pdvobjpriv->iface_nums; i++) { + iface = pdvobjpriv->padapters[i]; + if (iface == NULL) + continue; + + pmccadapriv = &iface->mcc_adapterpriv; + /* GO & channel match */ + if (pmccadapriv->role == MCC_ROLE_GO) { + /* convert GO TBTT from FW to noa_start_time(TU convert to mircosecond) */ + pmccadapriv->noa_start_time = RTW_GET_LE32(tmpBuf + 2) + noa_start_time_offset * TU; + + if (0) { + RTW_INFO("TBTT:0x%02x\n", RTW_GET_LE32(tmpBuf + 2)); + RTW_INFO("noa_tsf_sync_offset:%d, noa_start_time_offset:%d\n", noa_tsf_sync_offset, noa_start_time_offset); + RTW_INFO(FUNC_ADPT_FMT"buf=0x%02x:0x%02x:0x%02x:0x%02x, noa_start_time=0x%02x\n" + , FUNC_ADPT_ARG(iface) + , tmpBuf[2] + , tmpBuf[3] + , tmpBuf[4] + , tmpBuf[5] + ,pmccadapriv->noa_start_time); + } + + rtw_hal_mcc_update_go_p2p_ie(iface); + + break; + } + } + +} + /** * rtw_hal_mcc_c2h_handler - mcc c2h handler */ @@ -988,6 +1306,9 @@ void rtw_hal_mcc_c2h_handler(PADAPTER padapter, u8 buflen, u8 *tmpBuf) pdvobjpriv->oper_channel = tmpBuf[1]; rtw_hal_mcc_sw_ch_fw_notify_hdl(padapter); break; + case MCC_RPT_UPDATE_NOA_START_TIME: + rtw_hal_mcc_update_noa_start_time_hdl(padapter, buflen, tmpBuf); + break; default: /* RTW_INFO("[MCC] Other MCC status(%d)\n", pmccobjpriv->mcc_c2h_status); */ break; @@ -1007,7 +1328,7 @@ void rtw_hal_mcc_sw_status_check(PADAPTER padapter) u8 cur_cnt = 0, prev_cnt = 0, diff_cnt = 0, check_ret = _FAIL; _irqL irqL; - /* #define MCC_RESTART 1 */ +/* #define MCC_RESTART 1 */ if (!MCC_EN(padapter)) return; @@ -1049,10 +1370,10 @@ void rtw_hal_mcc_sw_status_check(PADAPTER padapter) if (check_ret != _SUCCESS) { RTW_INFO("============ MCC swich channel check fail (%d)=============\n", diff_cnt); /* restart MCC */ -#ifdef MCC_RESTART - rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_DISCONNECT); - rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); -#endif /* MCC_RESTART */ + #ifdef MCC_RESTART + rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_STOP_DISCONNECT); + rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); + #endif /* MCC_RESTART */ } } else { _enter_critical_bh(&pmccobjpriv->mcc_lock, &irqL); @@ -1090,7 +1411,7 @@ u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset) for (i = 0; i < dvobj->iface_nums; i++) { if (!dvobj->padapters[i]) - continue; + continue; pmlmeext = &dvobj->padapters[i]->mlmeextpriv; pmccadapriv = &dvobj->padapters[i]->mcc_adapterpriv; @@ -1160,11 +1481,11 @@ inline void rtw_hal_mcc_calc_tx_bytes_to_port(PADAPTER padapter, u32 len) if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) pmccadapriv->mcc_tx_bytes_to_port += len; - if (0) - RTW_INFO("%s(order:%d): mcc tx bytes to port:%d, mcc target tx bytes to port:%d\n" - , __func__, pmccadapriv->order, pmccadapriv->mcc_tx_bytes_to_port - , pmccadapriv->mcc_target_tx_bytes_to_port); - } + if (0) + RTW_INFO("%s(order:%d): mcc tx bytes to port:%d, mcc target tx bytes to port:%d\n" + , __func__, pmccadapriv->order, pmccadapriv->mcc_tx_bytes_to_port + , pmccadapriv->mcc_target_tx_bytes_to_port); + } } /** @@ -1232,7 +1553,7 @@ u8 rtw_hal_set_mcc_setting_scan_complete(PADAPTER padapter) _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_NEED_MCC)) - ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_SCAN_DONE); + ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_SCAN_DONE); _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); } @@ -1253,14 +1574,14 @@ u8 rtw_hal_set_mcc_setting_start_bss_network(PADAPTER padapter, u8 chbw_allow) if (MCC_EN(padapter)) { /* channel bw offset can not be allowed, start MCC */ if (chbw_allow == _FALSE) { - struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); + struct mcc_obj_priv *pmccobjpriv = &(adapter_to_dvobj(padapter)->mcc_objpriv); - rtw_hal_mcc_backup_IQK_val(padapter); - _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); - ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); - _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); + rtw_hal_mcc_restore_iqk_val(padapter); + _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); + ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); + _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); + } } - } return ret; } @@ -1310,22 +1631,23 @@ u8 rtw_hal_set_mcc_setting_join_done_chk_ch(PADAPTER padapter) dump_adapters_status(RTW_DBGDUMP , dvobj); rtw_warn_on(1); } + RTW_INFO(FUNC_ADPT_FMT" union no self: %u,%u,%u\n" , FUNC_ADPT_ARG(padapter), u_ch, u_bw, u_offset); /* chbw_allow? */ chbw_allow = rtw_is_chbw_grouped(cur_mlmeext->cur_channel , cur_mlmeext->cur_bwmode, cur_mlmeext->cur_ch_offset - , u_ch, u_bw, u_offset); + , u_ch, u_bw, u_offset); RTW_INFO(FUNC_ADPT_FMT" chbw_allow:%d\n" - , FUNC_ADPT_ARG(padapter), chbw_allow); + , FUNC_ADPT_ARG(padapter), chbw_allow); /* if chbw_allow = false, start MCC setting */ if (chbw_allow == _FALSE) { struct mcc_obj_priv *pmccobjpriv = &dvobj->mcc_objpriv; - rtw_hal_mcc_backup_IQK_val(padapter); + rtw_hal_mcc_restore_iqk_val(padapter); _enter_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); ret = rtw_hal_set_mcc_setting(padapter, MCC_SETCMD_STATUS_START_CONNECT); _exit_critical_mutex(&pmccobjpriv->mcc_mutex, NULL); @@ -1348,7 +1670,7 @@ u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw { u8 ret = _FAIL; - /* if chbw_allow = false under en_mcc = TRUE, we do not change channel related setting */ + /* if chbw_allow = false under en_mcc = TRUE, we do not change channel related setting */ if (MCC_EN(padapter)) { /* restore union channel related setting to current channel related setting */ if (chbw_allow == _FALSE) { @@ -1360,7 +1682,7 @@ u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw RTW_INFO(FUNC_ADPT_FMT" en_mcc:%d(%d,%d,%d,)\n" , FUNC_ADPT_ARG(padapter), padapter->registrypriv.en_mcc - , *ch, *bw, *offset); + , *ch, *bw, *offset); ret = _SUCCESS; } } @@ -1368,6 +1690,23 @@ u8 rtw_hal_set_mcc_setting_chk_start_clnt_join(PADAPTER padapter, u8 *ch, u8 *bw return ret; } +static void rtw_hal_mcc_dump_noa_content(void *sel, PADAPTER padapter) +{ + struct mcc_adapter_priv *pmccadapriv = NULL; + u8 *pos = NULL; + pmccadapriv = &padapter->mcc_adapterpriv; + /* last position for NoA attribute */ + pos = pmccadapriv->p2p_go_noa_ie + pmccadapriv->p2p_go_noa_ie_len; + + + RTW_PRINT_SEL(sel, "\nStart to dump NoA Content\n"); + RTW_PRINT_SEL(sel, "NoA Counts:%d\n", *(pos - 13)); + RTW_PRINT_SEL(sel, "NoA Duration(TU):%d\n", (RTW_GET_LE32(pos - 12))/TU); + RTW_PRINT_SEL(sel, "NoA Interval(TU):%d\n", (RTW_GET_LE32(pos - 8))/TU); + RTW_PRINT_SEL(sel, "NoA Start time(microseconds):0x%02x\n", RTW_GET_LE32(pos - 4)); + RTW_PRINT_SEL(sel, "End to dump NoA Content\n"); +} + void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj) { struct mcc_obj_priv *pmccobjpriv = &(dvobj->mcc_objpriv); @@ -1405,10 +1744,14 @@ void rtw_hal_dump_mcc_info(void *sel, struct dvobj_priv *dvobj) RTW_PRINT_SEL(sel, "sta target tx TP(BW:40M ):%d Mbps\n", regpriv->rtw_mcc_sta_bw40_target_tx_tp); RTW_PRINT_SEL(sel, "sta target tx TP(BW:80M):%d Mbps\n", regpriv->rtw_mcc_sta_bw80_target_tx_tp); RTW_PRINT_SEL(sel, "single tx criteria:%d Mbps\n", regpriv->rtw_mcc_single_tx_cri); + if (MLME_IS_GO(iface)) + rtw_hal_mcc_dump_noa_content(sel, iface); RTW_PRINT_SEL(sel, "**********************************************\n"); } } RTW_PRINT_SEL(sel, "------------------------------------------\n"); + RTW_PRINT_SEL(sel, "policy index:%d\n", pmccobjpriv->policy_index); + RTW_PRINT_SEL(sel, "------------------------------------------\n"); RTW_PRINT_SEL(sel, "define data:\n"); RTW_PRINT_SEL(sel, "ap target tx TP(BW:20M):%d Mbps\n", MCC_AP_BW20_TARGET_TX_TP); RTW_PRINT_SEL(sel, "ap target tx TP(BW:40M):%d Mbps\n", MCC_AP_BW40_TARGET_TX_TP); @@ -1446,9 +1789,9 @@ inline u8 rtw_hal_mcc_link_status_chk(_adapter *padapter, const char *msg) iface = dvobj->padapters[i]; mlmeext = &iface->mlmeextpriv; if (mlmeext_scan_state(mlmeext) != SCAN_DISABLE) { -#ifdef DBG_EXPIRATION_CHK - RTW_INFO(FUNC_ADPT_FMT" don't enter %s under scan for MCC mode\n", FUNC_ADPT_ARG(padapter), msg); -#endif + #ifdef DBG_EXPIRATION_CHK + RTW_INFO(FUNC_ADPT_FMT" don't enter %s under scan for MCC mode\n", FUNC_ADPT_ARG(padapter), msg); + #endif ret = _FALSE; goto exit; } @@ -1464,27 +1807,78 @@ void rtw_hal_mcc_issue_null_data(_adapter *padapter, u8 chbw_allow, u8 ps_mode) { struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); _adapter *iface = NULL; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); u8 i = 0; - if (MCC_EN(padapter)) { - if (chbw_allow == _FALSE) { - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - /* issue null data to inform ap station will leave */ - if (is_client_associated_to_ap(iface)) { - struct mlme_ext_priv *mlmeext = &iface->mlmeextpriv; - u8 ch = mlmeext->cur_channel; - u8 bw = mlmeext->cur_bwmode; - u8 offset = mlmeext->cur_ch_offset; + if (!MCC_EN(padapter)) + return; - set_channel_bwmode(iface, ch, bw, offset); - issue_nulldata(iface, NULL, ps_mode, 3, 50); - } - } - RTW_INFO("%s(%d ms)\n", __func__, rtw_get_passing_time_ms(start)); + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + return; + + if (chbw_allow == _TRUE) + return; + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + /* issue null data to inform ap station will leave */ + if (is_client_associated_to_ap(iface)) { + struct mlme_ext_priv *mlmeext = &iface->mlmeextpriv; + struct mlme_ext_info *mlmeextinfo = &mlmeext->mlmext_info; + u8 ch = mlmeext->cur_channel; + u8 bw = mlmeext->cur_bwmode; + u8 offset = mlmeext->cur_ch_offset; + struct sta_info *sta = rtw_get_stainfo(&iface->stapriv, get_my_bssid(&(mlmeextinfo->network))); + + if (!sta) + continue; + + set_channel_bwmode(iface, ch, bw, offset); + + if (ps_mode) + rtw_hal_macid_sleep(iface, sta->cmn.mac_id); + else + rtw_hal_macid_wakeup(iface, sta->cmn.mac_id); + + issue_nulldata(iface, NULL, ps_mode, 3, 50); } } + RTW_INFO("%s(%d ms)\n", __func__, rtw_get_passing_time_ms(start)); +} + +u8 *rtw_hal_mcc_append_go_p2p_ie(PADAPTER padapter, u8 *pframe, u32 *len) +{ + struct mcc_adapter_priv *pmccadapriv = &padapter->mcc_adapterpriv; + + if (!MCC_EN(padapter)) + return pframe; + + if (!rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + return pframe; + + if (pmccadapriv->p2p_go_noa_ie_len == 0) + return pframe; + + _rtw_memcpy(pframe, pmccadapriv->p2p_go_noa_ie, pmccadapriv->p2p_go_noa_ie_len); + *len = *len + pmccadapriv->p2p_go_noa_ie_len; + + return pframe + pmccadapriv->p2p_go_noa_ie_len; +} + +void rtw_hal_dump_mcc_policy_table(void *sel) +{ + u8 idx = 0; + RTW_PRINT_SEL(sel, "duration\t,tsf sync offset\t,start time offset\t,interval\t,guard offset0\t,guard offset1\n"); + + for (idx = 0; idx < mcc_max_policy_num; idx ++) { + RTW_PRINT_SEL(sel, "%d\t\t,%d\t\t\t,%d\t\t\t,%d\t\t,%d\t\t,%d\n" + , mcc_switch_channel_policy_table[idx][MCC_DURATION_IDX] + , mcc_switch_channel_policy_table[idx][MCC_TSF_SYNC_OFFSET_IDX] + , mcc_switch_channel_policy_table[idx][MCC_START_TIME_OFFSET_IDX] + , mcc_switch_channel_policy_table[idx][MCC_INTERVAL_IDX] + , mcc_switch_channel_policy_table[idx][MCC_GUARD_OFFSET0_IDX] + , mcc_switch_channel_policy_table[idx][MCC_GUARD_OFFSET1_IDX]); + } } #endif /* CONFIG_MCC_MODE */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mp.c index 9c730c89a71e..e352b69148fb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_mp.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_MP_C_ #include @@ -75,42 +70,42 @@ u8 MgntQuery_NssTxRate(u16 Rate) void hal_mpt_SwitchRfSetting(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); u8 ChannelToSw = pMptCtx->MptChannelToSw; - ULONG ulRateIdx = pMptCtx->MptRateIndex; + ULONG ulRateIdx = pMptCtx->mpt_rate_index; ULONG ulbandwidth = pMptCtx->MptBandWidth; /* <20120525, Kordan> Dynamic mechanism for APK, asked by Dennis.*/ if (IS_HARDWARE_TYPE_8188ES(pAdapter) && (1 <= ChannelToSw && ChannelToSw <= 11) && (ulRateIdx == MPT_RATE_MCS0 || ulRateIdx == MPT_RATE_1M || ulRateIdx == MPT_RATE_6M)) { - pMptCtx->backup0x52_RF_A = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0); - pMptCtx->backup0x52_RF_B = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0); + pMptCtx->backup0x52_RF_A = (u1Byte)phy_query_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0); + pMptCtx->backup0x52_RF_B = (u1Byte)phy_query_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0); if ((PlatformEFIORead4Byte(pAdapter, 0xF4) & BIT29) == BIT29) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xB); + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0xB); } else { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xD); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xD); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xD); + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0xD); } } else if (IS_HARDWARE_TYPE_8188EE(pAdapter)) { /* <20140903, VincentL> Asked by RF Eason and Edlu*/ if (ChannelToSw == 3 && ulbandwidth == MPT_BW_40MHZ) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0xB); /*RF 0x52 = 0x0007E4BD*/ } else { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, 0x9); /*RF 0x52 = 0x0007E49D*/ } } else if (IS_HARDWARE_TYPE_8188E(pAdapter)) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_A); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_B); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_A); + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_0x52, 0x000F0, pMptCtx->backup0x52_RF_B); } } s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); if (!netif_running(padapter->pnetdev)) { @@ -121,9 +116,9 @@ s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable) return _FAIL; } if (enable) - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; + pDM_Odm->rf_calibrate_info.txpowertrack_control = _TRUE; else - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _FALSE; + pDM_Odm->rf_calibrate_info.txpowertrack_control = _FALSE; return _SUCCESS; } @@ -131,10 +126,10 @@ s32 hal_mpt_SetPowerTracking(PADAPTER padapter, u8 enable) void hal_mpt_GetPowerTracking(PADAPTER padapter, u8 *enable) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); - *enable = pDM_Odm->RFCalibrateInfo.TxPowerTrackControl; + *enable = pDM_Odm->rf_calibrate_info.txpowertrack_control; } @@ -144,20 +139,16 @@ void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) u32 CurrCCKSwingVal = 0, CCKSwingIndex = 12; u8 i; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); - u1Byte u1Channel = pHalData->CurrentChannel; - ULONG ulRateIdx = pMptCtx->MptRateIndex; + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); + u1Byte u1Channel = pHalData->current_channel; + ULONG ulRateIdx = pMptCtx->mpt_rate_index; u1Byte DataRate = 0xFF; - /* Suggested by BB David. 2015.04.27*/ - if(IS_HARDWARE_TYPE_8188F(Adapter)) - return; - /* Do not modify CCK TX filter parameters for 8822B*/ if(IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter)) return; - DataRate = MptToMgntRate(ulRateIdx); + DataRate = mpt_to_mgnt_rate(ulRateIdx); if (u1Channel == 14 && IS_CCK_RATE(DataRate)) pHalData->bCCKinCH14 = TRUE; @@ -167,31 +158,89 @@ void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) if (IS_HARDWARE_TYPE_8703B(Adapter)) { if ((u1Channel == 14) && IS_CCK_RATE(DataRate)) { /* Channel 14 in CCK, need to set 0xA26~0xA29 to 0 for 8703B */ - PHY_SetBBReg(Adapter, rCCK0_TxFilter2, bMaskHWord, 0); - PHY_SetBBReg(Adapter, rCCK0_DebugPort, bMaskLWord, 0); + phy_set_bb_reg(Adapter, rCCK0_TxFilter2, bMaskHWord, 0); + phy_set_bb_reg(Adapter, rCCK0_DebugPort, bMaskLWord, 0); } else { /* Normal setting for 8703B, just recover to the default setting. */ /* This hardcore values reference from the parameter which BB team gave. */ for (i = 0 ; i < 2 ; ++i) - PHY_SetBBReg(Adapter, pHalData->RegForRecover[i].offset, bMaskDWord, pHalData->RegForRecover[i].value); + phy_set_bb_reg(Adapter, pHalData->RegForRecover[i].offset, bMaskDWord, pHalData->RegForRecover[i].value); } } else if (IS_HARDWARE_TYPE_8723D(Adapter)) { /* 2.4G CCK TX DFIR */ /* 2016.01.20 Suggest from RS BB mingzhi*/ if ((u1Channel == 14)) { - PHY_SetBBReg(Adapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); - PHY_SetBBReg(Adapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); - PHY_SetBBReg(Adapter, 0xAAC, bMaskDWord, 0x00003667); + phy_set_bb_reg(Adapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); + phy_set_bb_reg(Adapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); + phy_set_bb_reg(Adapter, 0xAAC, bMaskDWord, 0x00003667); } else { for (i = 0 ; i < 3 ; ++i) { - PHY_SetBBReg(Adapter, + phy_set_bb_reg(Adapter, pHalData->RegForRecover[i].offset, bMaskDWord, pHalData->RegForRecover[i].value); } } + } else if (IS_HARDWARE_TYPE_8188F(Adapter)) { + /* get current cck swing value and check 0xa22 & 0xa23 later to match the table.*/ + CurrCCKSwingVal = read_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord); + CCKSwingIndex = 20; /* default index */ + + if (!pHalData->bCCKinCH14) { + /* Readback the current bb cck swing value and compare with the table to */ + /* get the current swing index */ + for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { + if (((CurrCCKSwingVal & 0xff) == (u32)cck_swing_table_ch1_ch13_88f[i][0]) && + (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch1_ch13_88f[i][1])) { + CCKSwingIndex = i; + break; + } + } + write_bbreg(Adapter, 0xa22, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][0]); + write_bbreg(Adapter, 0xa23, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][1]); + write_bbreg(Adapter, 0xa24, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][2]); + write_bbreg(Adapter, 0xa25, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][3]); + write_bbreg(Adapter, 0xa26, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][4]); + write_bbreg(Adapter, 0xa27, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][5]); + write_bbreg(Adapter, 0xa28, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][6]); + write_bbreg(Adapter, 0xa29, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][7]); + write_bbreg(Adapter, 0xa9a, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][8]); + write_bbreg(Adapter, 0xa9b, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][9]); + write_bbreg(Adapter, 0xa9c, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][10]); + write_bbreg(Adapter, 0xa9d, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][11]); + write_bbreg(Adapter, 0xaa0, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][12]); + write_bbreg(Adapter, 0xaa1, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][13]); + write_bbreg(Adapter, 0xaa2, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][14]); + write_bbreg(Adapter, 0xaa3, bMaskByte0, cck_swing_table_ch1_ch13_88f[CCKSwingIndex][15]); + RTW_INFO("%s , cck_swing_table_ch1_ch13_88f[%d]\n", __func__, CCKSwingIndex); + } else { + for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { + if (((CurrCCKSwingVal & 0xff) == (u32)cck_swing_table_ch14_88f[i][0]) && + (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch14_88f[i][1])) { + CCKSwingIndex = i; + break; + } + } + write_bbreg(Adapter, 0xa22, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][0]); + write_bbreg(Adapter, 0xa23, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][1]); + write_bbreg(Adapter, 0xa24, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][2]); + write_bbreg(Adapter, 0xa25, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][3]); + write_bbreg(Adapter, 0xa26, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][4]); + write_bbreg(Adapter, 0xa27, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][5]); + write_bbreg(Adapter, 0xa28, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][6]); + write_bbreg(Adapter, 0xa29, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][7]); + write_bbreg(Adapter, 0xa9a, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][8]); + write_bbreg(Adapter, 0xa9b, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][9]); + write_bbreg(Adapter, 0xa9c, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][10]); + write_bbreg(Adapter, 0xa9d, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][11]); + write_bbreg(Adapter, 0xaa0, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][12]); + write_bbreg(Adapter, 0xaa1, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][13]); + write_bbreg(Adapter, 0xaa2, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][14]); + write_bbreg(Adapter, 0xaa3, bMaskByte0, cck_swing_table_ch14_88f[CCKSwingIndex][15]); + RTW_INFO("%s , cck_swing_table_ch14_88f[%d]\n", __func__, CCKSwingIndex); + } } else { /* get current cck swing value and check 0xa22 & 0xa23 later to match the table.*/ @@ -201,53 +250,53 @@ void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) /* Readback the current bb cck swing value and compare with the table to */ /* get the current swing index */ for (i = 0; i < CCK_TABLE_SIZE; i++) { - if (((CurrCCKSwingVal & 0xff) == (u32)CCKSwingTable_Ch1_Ch13[i][0]) && - (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)CCKSwingTable_Ch1_Ch13[i][1])) { + if (((CurrCCKSwingVal & 0xff) == (u32)cck_swing_table_ch1_ch13[i][0]) && + (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch1_ch13[i][1])) { CCKSwingIndex = i; break; } } /*Write 0xa22 0xa23*/ - TempVal = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][0] + - (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][1] << 8); + TempVal = cck_swing_table_ch1_ch13[CCKSwingIndex][0] + + (cck_swing_table_ch1_ch13[CCKSwingIndex][1] << 8); /*Write 0xa24 ~ 0xa27*/ TempVal2 = 0; - TempVal2 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][2] + - (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][3] << 8) + - (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][4] << 16) + - (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][5] << 24); + TempVal2 = cck_swing_table_ch1_ch13[CCKSwingIndex][2] + + (cck_swing_table_ch1_ch13[CCKSwingIndex][3] << 8) + + (cck_swing_table_ch1_ch13[CCKSwingIndex][4] << 16) + + (cck_swing_table_ch1_ch13[CCKSwingIndex][5] << 24); /*Write 0xa28 0xa29*/ TempVal3 = 0; - TempVal3 = CCKSwingTable_Ch1_Ch13[CCKSwingIndex][6] + - (CCKSwingTable_Ch1_Ch13[CCKSwingIndex][7] << 8); + TempVal3 = cck_swing_table_ch1_ch13[CCKSwingIndex][6] + + (cck_swing_table_ch1_ch13[CCKSwingIndex][7] << 8); } else { for (i = 0; i < CCK_TABLE_SIZE; i++) { - if (((CurrCCKSwingVal & 0xff) == (u32)CCKSwingTable_Ch14[i][0]) && - (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)CCKSwingTable_Ch14[i][1])) { + if (((CurrCCKSwingVal & 0xff) == (u32)cck_swing_table_ch14[i][0]) && + (((CurrCCKSwingVal & 0xff00) >> 8) == (u32)cck_swing_table_ch14[i][1])) { CCKSwingIndex = i; break; } } /*Write 0xa22 0xa23*/ - TempVal = CCKSwingTable_Ch14[CCKSwingIndex][0] + - (CCKSwingTable_Ch14[CCKSwingIndex][1] << 8); + TempVal = cck_swing_table_ch14[CCKSwingIndex][0] + + (cck_swing_table_ch14[CCKSwingIndex][1] << 8); /*Write 0xa24 ~ 0xa27*/ TempVal2 = 0; - TempVal2 = CCKSwingTable_Ch14[CCKSwingIndex][2] + - (CCKSwingTable_Ch14[CCKSwingIndex][3] << 8) + - (CCKSwingTable_Ch14[CCKSwingIndex][4] << 16) + - (CCKSwingTable_Ch14[CCKSwingIndex][5] << 24); + TempVal2 = cck_swing_table_ch14[CCKSwingIndex][2] + + (cck_swing_table_ch14[CCKSwingIndex][3] << 8) + + (cck_swing_table_ch14[CCKSwingIndex][4] << 16) + + (cck_swing_table_ch14[CCKSwingIndex][5] << 24); /*Write 0xa28 0xa29*/ TempVal3 = 0; - TempVal3 = CCKSwingTable_Ch14[CCKSwingIndex][6] + - (CCKSwingTable_Ch14[CCKSwingIndex][7] << 8); + TempVal3 = cck_swing_table_ch14[CCKSwingIndex][6] + + (cck_swing_table_ch14[CCKSwingIndex][7] << 8); } write_bbreg(Adapter, rCCK0_TxFilter1, bMaskHWord, TempVal); @@ -259,9 +308,9 @@ void hal_mpt_CCKTxPowerAdjust(PADAPTER Adapter, BOOLEAN bInCH14) void hal_mpt_SetChannel(PADAPTER pAdapter) { - u8 eRFPath; + enum rf_path eRFPath; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); struct mp_priv *pmp = &pAdapter->mppriv; u8 channel = pmp->channel; u8 bandwidth = pmp->bandwidth; @@ -302,17 +351,17 @@ void mpt_SetTxPower_Old(PADAPTER pAdapter, MPT_TXPWR_DEF Rate, u8 *pTxPower) u4Byte TxAGC = 0, pwr = 0; u1Byte rf; - pwr = pTxPower[ODM_RF_PATH_A]; + pwr = pTxPower[RF_PATH_A]; if (pwr < 0x3f) { TxAGC = (pwr << 16) | (pwr << 8) | (pwr); - PHY_SetBBReg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pTxPower[ODM_RF_PATH_A]); - PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pTxPower[RF_PATH_A]); + phy_set_bb_reg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); } - pwr = pTxPower[ODM_RF_PATH_B]; + pwr = pTxPower[RF_PATH_B]; if (pwr < 0x3f) { TxAGC = (pwr << 16) | (pwr << 8) | (pwr); - PHY_SetBBReg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, pTxPower[ODM_RF_PATH_B]); - PHY_SetBBReg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte0, pTxPower[RF_PATH_B]); + phy_set_bb_reg(pAdapter, rTxAGC_B_CCK1_55_Mcs32, 0xffffff00, TxAGC); } } break; @@ -325,24 +374,24 @@ void mpt_SetTxPower_Old(PADAPTER pAdapter, MPT_TXPWR_DEF Rate, u8 *pTxPower) if (pwr < 0x3f) { TxAGC |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); RTW_INFO("HT Tx-rf(A) Power = 0x%x\n", TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); } TxAGC = 0; pwr = pTxPower[1]; if (pwr < 0x3f) { TxAGC |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); RTW_INFO("HT Tx-rf(B) Power = 0x%x\n", TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); - PHY_SetBBReg(pAdapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); + phy_set_bb_reg(pAdapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); } } break; @@ -363,12 +412,12 @@ mpt_SetTxPower( HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); u1Byte path = 0 , i = 0, MaxRate = MGN_6M; - u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_B; + u1Byte StartPath = RF_PATH_A, EndPath = RF_PATH_B; if (IS_HARDWARE_TYPE_8814A(pAdapter)) - EndPath = ODM_RF_PATH_D; + EndPath = RF_PATH_D; else if (IS_HARDWARE_TYPE_8188F(pAdapter) || IS_HARDWARE_TYPE_8723D(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) - EndPath = ODM_RF_PATH_A; + EndPath = RF_PATH_A; switch (Rate) { case MPT_CCK: { @@ -451,16 +500,16 @@ mpt_SetTxPower( void hal_mpt_SetTxPower(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; - if (pHalData->rf_chip < RF_TYPE_MAX) { + if (pHalData->rf_chip < RF_CHIP_MAX) { if (IS_HARDWARE_TYPE_8188E(pAdapter) || IS_HARDWARE_TYPE_8723B(pAdapter) || IS_HARDWARE_TYPE_8192E(pAdapter) || IS_HARDWARE_TYPE_8703B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter)) { - u8 path = (pHalData->AntennaTxPath == ANTENNA_A) ? (ODM_RF_PATH_A) : (ODM_RF_PATH_B); + u8 path = (pHalData->antenna_tx_path == ANTENNA_A) ? (RF_PATH_A) : (RF_PATH_B); RTW_INFO("===> MPT_ProSetTxPower: Old\n"); @@ -476,18 +525,18 @@ void hal_mpt_SetTxPower(PADAPTER pAdapter) } } else - RTW_INFO("RFChipID < RF_TYPE_MAX, the RF chip is not supported - %d\n", pHalData->rf_chip); + RTW_INFO("RFChipID < RF_CHIP_MAX, the RF chip is not supported - %d\n", pHalData->rf_chip); - ODM_ClearTxPowerTrackingState(pDM_Odm); + odm_clear_txpowertracking_state(pDM_Odm); } void hal_mpt_SetDataRate(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); u32 DataRate; - DataRate = MptToMgntRate(pMptCtx->MptRateIndex); + DataRate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); hal_mpt_SwitchRfSetting(pAdapter); @@ -495,24 +544,24 @@ void hal_mpt_SetDataRate(PADAPTER pAdapter) #ifdef CONFIG_RTL8723B if (IS_HARDWARE_TYPE_8723B(pAdapter) || IS_HARDWARE_TYPE_8188F(pAdapter)) { if (IS_CCK_RATE(DataRate)) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0x6); + if (pMptCtx->mpt_rf_path == RF_PATH_A) + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, 0xF, 0x6); else - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0x6); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0x6); } else { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); + if (pMptCtx->mpt_rf_path == RF_PATH_A) + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, 0xF, 0xE); else - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0xE); } } if ((IS_HARDWARE_TYPE_8723BS(pAdapter) && ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)))) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, 0xF, 0xE); + if (pMptCtx->mpt_rf_path == RF_PATH_A) + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, 0xF, 0xE); else - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x71, 0xF, 0xE); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x71, 0xF, 0xE); } #endif } @@ -525,15 +574,15 @@ VOID mpt_ToggleIG_8814A(PADAPTER pAdapter) u1Byte Path = 0; u4Byte IGReg = rA_IGI_Jaguar, IGvalue = 0; - for (Path; Path <= ODM_RF_PATH_D; Path++) { + for (Path; Path <= RF_PATH_D; Path++) { switch (Path) { - case ODM_RF_PATH_B: + case RF_PATH_B: IGReg = rB_IGI_Jaguar; break; - case ODM_RF_PATH_C: + case RF_PATH_C: IGReg = rC_IGI_Jaguar2; break; - case ODM_RF_PATH_D: + case RF_PATH_D: IGReg = rD_IGI_Jaguar2; break; default: @@ -541,9 +590,9 @@ VOID mpt_ToggleIG_8814A(PADAPTER pAdapter) break; } - IGvalue = PHY_QueryBBReg(pAdapter, IGReg, bMaskByte0); - PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue + 2); - PHY_SetBBReg(pAdapter, IGReg, bMaskByte0, IGvalue); + IGvalue = phy_query_bb_reg(pAdapter, IGReg, bMaskByte0); + phy_set_bb_reg(pAdapter, IGReg, bMaskByte0, IGvalue + 2); + phy_set_bb_reg(pAdapter, IGReg, bMaskByte0, IGvalue); } } @@ -551,108 +600,85 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; + PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ R_ANTENNA_SELECT_CCK *p_cck_txrx; - u8 ForcedDataRate = MptToMgntRate(pMptCtx->MptRateIndex); + u8 ForcedDataRate = mpt_to_mgnt_rate(pMptCtx->mpt_rate_index); u8 HtStbcCap = pAdapter->registrypriv.stbc_cap; /*/PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo);*/ /*/PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo);*/ - u32 ulAntennaTx = pHalData->AntennaTxPath; + u32 ulAntennaTx = pHalData->antenna_tx_path; u32 ulAntennaRx = pHalData->AntennaRxPath; u8 NssforRate = MgntQuery_NssTxRate(ForcedDataRate); - if ((NssforRate == RF_2TX) || ((NssforRate == RF_1TX) && IS_HT_RATE(ForcedDataRate)) || ((NssforRate == RF_1TX) && IS_VHT_RATE(ForcedDataRate))) { - RTW_INFO("===> SetAntenna 2T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); - - switch (ulAntennaTx) { - case ANTENNA_BC: - pMptCtx->MptRfPath = ODM_RF_PATH_BC; - /*pHalData->ValidTxPath = 0x06; linux no use */ - PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x106); /*/ 0x940[15:4]=12'b0000_0100_0011*/ - break; - - case ANTENNA_CD: - pMptCtx->MptRfPath = ODM_RF_PATH_CD; - /*pHalData->ValidTxPath = 0x0C;*/ - PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x40c); /*/ 0x940[15:4]=12'b0000_0100_0011*/ - break; - case ANTENNA_AB: - default: - pMptCtx->MptRfPath = ODM_RF_PATH_AB; - /*pHalData->ValidTxPath = 0x03;*/ - PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0000fff0, 0x043); /*/ 0x940[15:4]=12'b0000_0100_0011*/ - break; - } - - } else if (NssforRate == RF_3TX) { - RTW_INFO("===> SetAntenna 3T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); + if (NssforRate == RF_3TX) { + RTW_INFO("===> SetAntenna 3T Rate ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); switch (ulAntennaTx) { case ANTENNA_BCD: - pMptCtx->MptRfPath = ODM_RF_PATH_BCD; + pMptCtx->mpt_rf_path = RF_PATH_BCD; /*pHalData->ValidTxPath = 0x0e;*/ - PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x90e); /*/ 0x940[27:16]=12'b0010_0100_0111*/ + phy_set_bb_reg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x90e); /*/ 0x940[27:16]=12'b0010_0100_0111*/ break; case ANTENNA_ABC: default: - pMptCtx->MptRfPath = ODM_RF_PATH_ABC; + pMptCtx->mpt_rf_path = RF_PATH_ABC; /*pHalData->ValidTxPath = 0x0d;*/ - PHY_SetBBReg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x247); /*/ 0x940[27:16]=12'b0010_0100_0111*/ + phy_set_bb_reg(pAdapter, rTxAnt_23Nsts_Jaguar2, 0x0fff0000, 0x247); /*/ 0x940[27:16]=12'b0010_0100_0111*/ break; } } else { /*/if(NssforRate == RF_1TX)*/ - RTW_INFO("===> SetAntenna 1T ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); + RTW_INFO("===> SetAntenna for 1T/2T Rate, ForcedDataRate %d NssforRate %d AntennaTx %d\n", ForcedDataRate, NssforRate, ulAntennaTx); switch (ulAntennaTx) { case ANTENNA_BCD: - pMptCtx->MptRfPath = ODM_RF_PATH_BCD; + pMptCtx->mpt_rf_path = RF_PATH_BCD; /*pHalData->ValidTxPath = 0x0e;*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x7); - PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0xe); - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0xe); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x7); + phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0xe); + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0xe); break; case ANTENNA_BC: - pMptCtx->MptRfPath = ODM_RF_PATH_BC; + pMptCtx->mpt_rf_path = RF_PATH_BC; /*pHalData->ValidTxPath = 0x06;*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x6); - PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0x6); - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x6); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x6); + phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0x000f00000, 0x6); + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x6); break; case ANTENNA_B: - pMptCtx->MptRfPath = ODM_RF_PATH_B; + pMptCtx->mpt_rf_path = RF_PATH_B; /*pHalData->ValidTxPath = 0x02;*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x4); /*/ 0xa07[7:4] = 4'b0100*/ - PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x002); /*/ 0x93C[31:20]=12'b0000_0000_0010*/ - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x2); /* 0x80C[7:4] = 4'b0010*/ + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x4); /*/ 0xa07[7:4] = 4'b0100*/ + phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x002); /*/ 0x93C[31:20]=12'b0000_0000_0010*/ + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x2); /* 0x80C[7:4] = 4'b0010*/ break; case ANTENNA_C: - pMptCtx->MptRfPath = ODM_RF_PATH_C; + pMptCtx->mpt_rf_path = RF_PATH_C; /*pHalData->ValidTxPath = 0x04;*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x2); /*/ 0xa07[7:4] = 4'b0010*/ - PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x004); /*/ 0x93C[31:20]=12'b0000_0000_0100*/ - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x4); /*/ 0x80C[7:4] = 4'b0100*/ + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x2); /*/ 0xa07[7:4] = 4'b0010*/ + phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x004); /*/ 0x93C[31:20]=12'b0000_0000_0100*/ + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x4); /*/ 0x80C[7:4] = 4'b0100*/ break; case ANTENNA_D: - pMptCtx->MptRfPath = ODM_RF_PATH_D; + pMptCtx->mpt_rf_path = RF_PATH_D; /*pHalData->ValidTxPath = 0x08;*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x1); /*/ 0xa07[7:4] = 4'b0001*/ - PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x008); /*/ 0x93C[31:20]=12'b0000_0000_1000*/ - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x8); /*/ 0x80C[7:4] = 4'b1000*/ + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x1); /*/ 0xa07[7:4] = 4'b0001*/ + phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x008); /*/ 0x93C[31:20]=12'b0000_0000_1000*/ + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x8); /*/ 0x80C[7:4] = 4'b1000*/ break; case ANTENNA_A: default: - pMptCtx->MptRfPath = ODM_RF_PATH_A; + pMptCtx->mpt_rf_path = RF_PATH_A; /*pHalData->ValidTxPath = 0x01;*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x8); /*/ 0xa07[7:4] = 4'b1000*/ - PHY_SetBBReg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x001); /*/ 0x93C[31:20]=12'b0000_0000_0001*/ - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, 0xf0, 0x1); /*/ 0x80C[7:4] = 4'b0001*/ + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0xf0000000, 0x8); /*/ 0xa07[7:4] = 4'b1000*/ + phy_set_bb_reg(pAdapter, rTxAnt_1Nsts_Jaguar2, 0xfff00000, 0x001); /*/ 0x93C[31:20]=12'b0000_0000_0001*/ + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, 0xf0, 0x1); /*/ 0x80C[7:4] = 4'b0001*/ break; } } @@ -660,122 +686,138 @@ VOID mpt_SetRFPath_8814A(PADAPTER pAdapter) switch (ulAntennaRx) { case ANTENNA_A: /*pHalData->ValidRxPath = 0x01;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x0); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x0); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); break; case ANTENNA_B: /*pHalData->ValidRxPath = 0x02;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x1); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x1); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); break; case ANTENNA_C: /*pHalData->ValidRxPath = 0x04;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x44); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x2); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x44); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x2); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); break; case ANTENNA_D: /*pHalData->ValidRxPath = 0x08;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x88); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x3); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x88); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0C000000, 0x3); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_C_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); break; case ANTENNA_BC: /*pHalData->ValidRxPath = 0x06;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x66); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x66); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_D_0x0[19:16] = 1, Standby mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); break; case ANTENNA_CD: /*pHalData->ValidRxPath = 0x0C;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xcc); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0xB); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xcc); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0xB); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, Rx mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x5); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0xA); break; case ANTENNA_BCD: /*pHalData->ValidRxPath = 0x0e;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xee); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, Rx mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xee); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x6); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_A_0x0[19:16] = 1, Standby mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, Rx mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); break; case ANTENNA_ABCD: /*pHalData->ValidRxPath = 0x0f;*/ - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x2); - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xff); - PHY_SetBBReg(pAdapter, 0x1000, bMaskByte2, 0x3); - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x1); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x2); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0xff); + phy_set_bb_reg(pAdapter, 0x1000, bMaskByte2, 0x3); + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, 0x0f000000, 0x1); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_A_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_C, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_C_0x0[19:16] = 3, RX mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_D, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_D_0x0[19:16] = 3, RX mode*/ /*/ CCA related PD_delay_th*/ - PHY_SetBBReg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); + phy_set_bb_reg(pAdapter, rAGC_table_Jaguar, 0x0F000000, 0x3); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, 0x0000000F, 0x8); break; default: @@ -795,100 +837,100 @@ mpt_SetSingleTone_8814A( IN BOOLEAN bEnPMacTx) { - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - u1Byte StartPath = ODM_RF_PATH_A, EndPath = ODM_RF_PATH_A; + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); + u1Byte StartPath = RF_PATH_A, EndPath = RF_PATH_A; static u4Byte regIG0 = 0, regIG1 = 0, regIG2 = 0, regIG3 = 0; if (bSingleTone) { - regIG0 = PHY_QueryBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord); /*/ 0xC1C[31:21]*/ - regIG1 = PHY_QueryBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord); /*/ 0xE1C[31:21]*/ - regIG2 = PHY_QueryBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord); /*/ 0x181C[31:21]*/ - regIG3 = PHY_QueryBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord); /*/ 0x1A1C[31:21]*/ + regIG0 = phy_query_bb_reg(pAdapter, rA_TxScale_Jaguar, bMaskDWord); /*/ 0xC1C[31:21]*/ + regIG1 = phy_query_bb_reg(pAdapter, rB_TxScale_Jaguar, bMaskDWord); /*/ 0xE1C[31:21]*/ + regIG2 = phy_query_bb_reg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord); /*/ 0x181C[31:21]*/ + regIG3 = phy_query_bb_reg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord); /*/ 0x1A1C[31:21]*/ - switch (pMptCtx->MptRfPath) { - case ODM_RF_PATH_A: - case ODM_RF_PATH_B: - case ODM_RF_PATH_C: - case ODM_RF_PATH_D: - StartPath = pMptCtx->MptRfPath; - EndPath = pMptCtx->MptRfPath; + switch (pMptCtx->mpt_rf_path) { + case RF_PATH_A: + case RF_PATH_B: + case RF_PATH_C: + case RF_PATH_D: + StartPath = pMptCtx->mpt_rf_path; + EndPath = pMptCtx->mpt_rf_path; break; - case ODM_RF_PATH_AB: - EndPath = ODM_RF_PATH_B; + case RF_PATH_AB: + EndPath = RF_PATH_B; break; - case ODM_RF_PATH_BC: - StartPath = ODM_RF_PATH_B; - EndPath = ODM_RF_PATH_C; + case RF_PATH_BC: + StartPath = RF_PATH_B; + EndPath = RF_PATH_C; break; - case ODM_RF_PATH_ABC: - EndPath = ODM_RF_PATH_C; + case RF_PATH_ABC: + EndPath = RF_PATH_C; break; - case ODM_RF_PATH_BCD: - StartPath = ODM_RF_PATH_B; - EndPath = ODM_RF_PATH_D; + case RF_PATH_BCD: + StartPath = RF_PATH_B; + EndPath = RF_PATH_D; break; - case ODM_RF_PATH_ABCD: - EndPath = ODM_RF_PATH_D; + case RF_PATH_ABCD: + EndPath = RF_PATH_D; break; } if (bEnPMacTx == FALSE) { - hal_mpt_SetOFDMContinuousTx(pAdapter, _TRUE); + hal_mpt_SetContinuousTx(pAdapter, _TRUE); issue_nulldata(pAdapter, NULL, 1, 3, 500); } - PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); /*/ Disable CCA*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x1); /*/ Disable CCA*/ for (StartPath; StartPath <= EndPath; StartPath++) { - PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ - PHY_SetRFReg(pAdapter, StartPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ + phy_set_rf_reg(pAdapter, StartPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ + phy_set_rf_reg(pAdapter, StartPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ - PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ + phy_set_rf_reg(pAdapter, StartPath, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ } - PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xC1C[31:21]*/ - PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xE1C[31:21]*/ - PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x181C[31:21]*/ - PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x1A1C[31:21]*/ + phy_set_bb_reg(pAdapter, rA_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xC1C[31:21]*/ + phy_set_bb_reg(pAdapter, rB_TxScale_Jaguar, 0xFFE00000, 0); /*/ 0xE1C[31:21]*/ + phy_set_bb_reg(pAdapter, rC_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x181C[31:21]*/ + phy_set_bb_reg(pAdapter, rD_TxScale_Jaguar2, 0xFFE00000, 0); /*/ 0x1A1C[31:21]*/ } else { - switch (pMptCtx->MptRfPath) { - case ODM_RF_PATH_A: - case ODM_RF_PATH_B: - case ODM_RF_PATH_C: - case ODM_RF_PATH_D: - StartPath = pMptCtx->MptRfPath; - EndPath = pMptCtx->MptRfPath; + switch (pMptCtx->mpt_rf_path) { + case RF_PATH_A: + case RF_PATH_B: + case RF_PATH_C: + case RF_PATH_D: + StartPath = pMptCtx->mpt_rf_path; + EndPath = pMptCtx->mpt_rf_path; break; - case ODM_RF_PATH_AB: - EndPath = ODM_RF_PATH_B; + case RF_PATH_AB: + EndPath = RF_PATH_B; break; - case ODM_RF_PATH_BC: - StartPath = ODM_RF_PATH_B; - EndPath = ODM_RF_PATH_C; + case RF_PATH_BC: + StartPath = RF_PATH_B; + EndPath = RF_PATH_C; break; - case ODM_RF_PATH_ABC: - EndPath = ODM_RF_PATH_C; + case RF_PATH_ABC: + EndPath = RF_PATH_C; break; - case ODM_RF_PATH_BCD: - StartPath = ODM_RF_PATH_B; - EndPath = ODM_RF_PATH_D; + case RF_PATH_BCD: + StartPath = RF_PATH_B; + EndPath = RF_PATH_D; break; - case ODM_RF_PATH_ABCD: - EndPath = ODM_RF_PATH_D; + case RF_PATH_ABCD: + EndPath = RF_PATH_D; break; } for (StartPath; StartPath <= EndPath; StartPath++) - PHY_SetRFReg(pAdapter, StartPath, LNA_Low_Gain_3, BIT1, 0x0); /* RF LO disabled */ + phy_set_rf_reg(pAdapter, StartPath, lna_low_gain_3, BIT1, 0x0); /* RF LO disabled */ - PHY_SetBBReg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); /* Enable CCA*/ + phy_set_bb_reg(pAdapter, rCCAonSec_Jaguar, BIT1, 0x0); /* Enable CCA*/ if (bEnPMacTx == FALSE) - hal_mpt_SetOFDMContinuousTx(pAdapter, _FALSE); + hal_mpt_SetContinuousTx(pAdapter, _FALSE); - PHY_SetBBReg(pAdapter, rA_TxScale_Jaguar, bMaskDWord, regIG0); /* 0xC1C[31:21]*/ - PHY_SetBBReg(pAdapter, rB_TxScale_Jaguar, bMaskDWord, regIG1); /* 0xE1C[31:21]*/ - PHY_SetBBReg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord, regIG2); /* 0x181C[31:21]*/ - PHY_SetBBReg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord, regIG3); /* 0x1A1C[31:21]*/ + phy_set_bb_reg(pAdapter, rA_TxScale_Jaguar, bMaskDWord, regIG0); /* 0xC1C[31:21]*/ + phy_set_bb_reg(pAdapter, rB_TxScale_Jaguar, bMaskDWord, regIG1); /* 0xE1C[31:21]*/ + phy_set_bb_reg(pAdapter, rC_TxScale_Jaguar2, bMaskDWord, regIG2); /* 0x181C[31:21]*/ + phy_set_bb_reg(pAdapter, rD_TxScale_Jaguar2, bMaskDWord, regIG3); /* 0x1A1C[31:21]*/ } } @@ -898,37 +940,37 @@ mpt_SetSingleTone_8814A( void mpt_SetRFPath_8812A(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.MptCtx; + PMPT_CONTEXT pMptCtx = &pAdapter->mppriv.mpt_ctx; struct mp_priv *pmp = &pAdapter->mppriv; u8 channel = pmp->channel; u8 bandwidth = pmp->bandwidth; u8 eLNA_2g = pHalData->ExternalLNA_2G; u32 ulAntennaTx, ulAntennaRx; - ulAntennaTx = pHalData->AntennaTxPath; + ulAntennaTx = pHalData->antenna_tx_path; ulAntennaRx = pHalData->AntennaRxPath; switch (ulAntennaTx) { case ANTENNA_A: - pMptCtx->MptRfPath = ODM_RF_PATH_A; - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); - if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) - PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); + pMptCtx->mpt_rf_path = RF_PATH_A; + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x1111); + if (pHalData->rfe_type == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) + phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); break; case ANTENNA_B: - pMptCtx->MptRfPath = ODM_RF_PATH_B; - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); - if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) - PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1); + pMptCtx->mpt_rf_path = RF_PATH_B; + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x2222); + if (pHalData->rfe_type == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) + phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x1); break; case ANTENNA_AB: - pMptCtx->MptRfPath = ODM_RF_PATH_AB; - PHY_SetBBReg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); - if (pHalData->RFEType == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) - PHY_SetBBReg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); + pMptCtx->mpt_rf_path = RF_PATH_AB; + phy_set_bb_reg(pAdapter, rTxPath_Jaguar, bMaskLWord, 0x3333); + if (pHalData->rfe_type == 3 && IS_HARDWARE_TYPE_8812(pAdapter)) + phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, bMask_AntselPathFollow_Jaguar, 0x0); break; default: - pMptCtx->MptRfPath = ODM_RF_PATH_AB; + pMptCtx->mpt_rf_path = RF_PATH_AB; RTW_INFO("Unknown Tx antenna.\n"); break; } @@ -936,15 +978,15 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) switch (ulAntennaRx) { u32 reg0xC50 = 0; case ANTENNA_A: - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x11); + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x1); /*/ RF_B_0x0[19:16] = 1, Standby mode*/ + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ - reg0xC50 = PHY_QueryBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0); - PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); - PHY_SetBBReg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50); + reg0xC50 = phy_query_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0); + phy_set_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); + phy_set_bb_reg(pAdapter, rA_IGI_Jaguar, bMaskByte0, reg0xC50); /* set PWED_TH for BB Yn user guide R29 */ if (IS_HARDWARE_TYPE_8812(pAdapter)) { @@ -952,25 +994,25 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) if (bandwidth == CHANNEL_WIDTH_20 && eLNA_2g == 0) { /* 0x830[3:1]=3'b010 */ - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); } else /* 0x830[3:1]=3'b100 */ - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); } else /* 0x830[3:1]=3'b100 for 5G */ - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); } break; case ANTENNA_B: - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1);/*/ RF_A_0x0[19:16] = 1, Standby mode */ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x22); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, 0xF0000, 0x1);/*/ RF_A_0x0[19:16] = 1, Standby mode */ + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x1); + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, BIT19 | BIT18 | BIT17 | BIT16, 0x3); /*/ <20121101, Kordan> To prevent gain table from not switched, asked by Ynlin.*/ - reg0xC50 = PHY_QueryBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0); - PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); - PHY_SetBBReg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50); + reg0xC50 = phy_query_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0); + phy_set_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50 + 2); + phy_set_bb_reg(pAdapter, rB_IGI_Jaguar, bMaskByte0, reg0xC50); /* set PWED_TH for BB Yn user guide R29 */ if (IS_HARDWARE_TYPE_8812(pAdapter)) { @@ -978,26 +1020,38 @@ void mpt_SetRFPath_8812A(PADAPTER pAdapter) if (bandwidth == CHANNEL_WIDTH_20 && eLNA_2g == 0) { /* 0x830[3:1]=3'b010 */ - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x02); } else /* 0x830[3:1]=3'b100 */ - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); } else /* 0x830[3:1]=3'b100 for 5G */ - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); } break; case ANTENNA_AB: - PHY_SetBBReg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, Rx mode*/ - PHY_SetBBReg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); + phy_set_bb_reg(pAdapter, rRxPath_Jaguar, bMaskByte0, 0x33); + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_AC_Jaguar, 0xF0000, 0x3); /*/ RF_B_0x0[19:16] = 3, Rx mode*/ + phy_set_bb_reg(pAdapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); /* set PWED_TH for BB Yn user guide R29 */ - PHY_SetBBReg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); + phy_set_bb_reg(pAdapter, rPwed_TH_Jaguar, BIT1 | BIT2 | BIT3, 0x04); break; default: RTW_INFO("Unknown Rx antenna.\n"); break; } + + if (pHalData->rfe_type == 5 || pHalData->rfe_type == 1) { + if (ulAntennaTx == ANTENNA_A || ulAntennaTx == ANTENNA_AB) { + /* WiFi */ + phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(1) | BIT(0), 0x2); + phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(9) | BIT(8), 0x3); + } else { + /* BT */ + phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(1) | BIT(0), 0x1); + phy_set_bb_reg(pAdapter, r_ANTSEL_SW_Jaguar, BIT(9) | BIT(8), 0x3); + } + } } #endif @@ -1006,14 +1060,14 @@ void mpt_SetRFPath_8723B(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); u32 ulAntennaTx, ulAntennaRx; - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct odm_rf_calibration_structure *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); - ulAntennaTx = pHalData->AntennaTxPath; + ulAntennaTx = pHalData->antenna_tx_path; ulAntennaRx = pHalData->AntennaRxPath; - if (pHalData->rf_chip >= RF_TYPE_MAX) { + if (pHalData->rf_chip >= RF_CHIP_MAX) { RTW_INFO("This RF chip ID is not supported\n"); return; } @@ -1021,31 +1075,31 @@ void mpt_SetRFPath_8723B(PADAPTER pAdapter) switch (pAdapter->mppriv.antenna_tx) { u8 p = 0, i = 0; case ANTENNA_A: { /*/ Actually path S1 (Wi-Fi)*/ - pMptCtx->MptRfPath = ODM_RF_PATH_A; - PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); - PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ + pMptCtx->mpt_rf_path = RF_PATH_A; + phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); + phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ /*/<20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); else - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); for (i = 0; i < 3; ++i) { - u4Byte offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; - u4Byte data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][1]; + u4Byte offset = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][0]; + u4Byte data = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][1]; if (offset != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); } } for (i = 0; i < 2; ++i) { - u4Byte offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; - u4Byte data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][1]; + u4Byte offset = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_A][i][0]; + u4Byte data = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_A][i][1]; if (offset != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); } } @@ -1055,37 +1109,37 @@ void mpt_SetRFPath_8723B(PADAPTER pAdapter) u4Byte offset; u4Byte data; - pMptCtx->MptRfPath = ODM_RF_PATH_B; - PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); - PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /*/ AGC Table Sel.*/ + pMptCtx->mpt_rf_path = RF_PATH_B; + phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); + phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x1); /*/ AGC Table Sel.*/ /* <20130522, Kordan> 0x51 and 0x71 should be set immediately after path switched, or they might be overwritten.*/ if ((pHalData->PackageType == PACKAGE_TFBGA79) || (pHalData->PackageType == PACKAGE_TFBGA90)) - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B10E); else - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x51, bRFRegOffsetMask, 0x6B04E); for (i = 0; i < 3; ++i) { /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ - offset = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_A][i][0]; - data = pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][1]; - if (pRFCalibrateInfo->TxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + offset = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_A][i][0]; + data = pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_B][i][1]; + if (pRFCalibrateInfo->tx_iqc_8723b[RF_PATH_B][i][0] != 0) { + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); } } /*/ <20130603, Kordan> Because BB suppors only 1T1R, we restore IQC to S1 instead of S0.*/ for (i = 0; i < 2; ++i) { - offset = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_A][i][0]; - data = pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][1]; - if (pRFCalibrateInfo->RxIQC_8723B[ODM_RF_PATH_B][i][0] != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + offset = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_A][i][0]; + data = pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_B][i][1]; + if (pRFCalibrateInfo->rx_iqc_8723b[RF_PATH_B][i][0] != 0) { + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); } } } break; default: - pMptCtx->MptRfPath = RF_PATH_AB; + pMptCtx->mpt_rf_path = RF_PATH_AB; break; } } @@ -1096,14 +1150,14 @@ void mpt_SetRFPath_8703B(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); u4Byte ulAntennaTx, ulAntennaRx; - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct odm_rf_calibration_structure *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); - ulAntennaTx = pHalData->AntennaTxPath; + ulAntennaTx = pHalData->antenna_tx_path; ulAntennaRx = pHalData->AntennaRxPath; - if (pHalData->rf_chip >= RF_TYPE_MAX) { + if (pHalData->rf_chip >= RF_CHIP_MAX) { RTW_INFO("This RF chip ID is not supported\n"); return; } @@ -1112,58 +1166,58 @@ void mpt_SetRFPath_8703B(PADAPTER pAdapter) u1Byte p = 0, i = 0; case ANTENNA_A: { /* Actually path S1 (Wi-Fi) */ - pMptCtx->MptRfPath = ODM_RF_PATH_A; - PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); - PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ + pMptCtx->mpt_rf_path = RF_PATH_A; + phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x0); + phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x0); /* AGC Table Sel*/ for (i = 0; i < 3; ++i) { - u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; - u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; + u4Byte offset = pRFCalibrateInfo->tx_iqc_8703b[i][0]; + u4Byte data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; if (offset != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S1 TxIQC(offset, data) = (0x%X, 0x%X)\n", offset, data); } } for (i = 0; i < 2; ++i) { - u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; - u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; + u4Byte offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; + u4Byte data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; if (offset != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S1 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); } } } break; case ANTENNA_B: { /* Actually path S0 (BT)*/ - pMptCtx->MptRfPath = ODM_RF_PATH_B; - PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); - PHY_SetBBReg(pAdapter, 0xB2C, BIT31, 0x1); /* AGC Table Sel */ + pMptCtx->mpt_rf_path = RF_PATH_B; + phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9 | BIT8 | BIT7, 0x5); + phy_set_bb_reg(pAdapter, 0xB2C, BIT31, 0x1); /* AGC Table Sel */ for (i = 0; i < 3; ++i) { - u4Byte offset = pRFCalibrateInfo->TxIQC_8703B[i][0]; - u4Byte data = pRFCalibrateInfo->TxIQC_8703B[i][1]; + u4Byte offset = pRFCalibrateInfo->tx_iqc_8703b[i][0]; + u4Byte data = pRFCalibrateInfo->tx_iqc_8703b[i][1]; - if (pRFCalibrateInfo->TxIQC_8703B[i][0] != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + if (pRFCalibrateInfo->tx_iqc_8703b[i][0] != 0) { + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S0 TxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); } } for (i = 0; i < 2; ++i) { - u4Byte offset = pRFCalibrateInfo->RxIQC_8703B[i][0]; - u4Byte data = pRFCalibrateInfo->RxIQC_8703B[i][1]; + u4Byte offset = pRFCalibrateInfo->rx_iqc_8703b[i][0]; + u4Byte data = pRFCalibrateInfo->rx_iqc_8703b[i][1]; - if (pRFCalibrateInfo->RxIQC_8703B[i][0] != 0) { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, data); + if (pRFCalibrateInfo->rx_iqc_8703b[i][0] != 0) { + phy_set_bb_reg(pAdapter, offset, bMaskDWord, data); RTW_INFO("Switch to S0 RxIQC (offset, data) = (0x%X, 0x%X)\n", offset, data); } } } break; default: - pMptCtx->MptRfPath = RF_PATH_AB; + pMptCtx->mpt_rf_path = RF_PATH_AB; break; } @@ -1176,14 +1230,14 @@ void mpt_SetRFPath_8723D(PADAPTER pAdapter) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); u1Byte p = 0, i = 0; u4Byte ulAntennaTx, ulAntennaRx, offset = 0, data = 0, val32 = 0; - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); + struct PHY_DM_STRUCT *pDM_Odm = &pHalData->odmpriv; + struct odm_rf_calibration_structure *pRFCalibrateInfo = &(pDM_Odm->rf_calibrate_info); - ulAntennaTx = pHalData->AntennaTxPath; + ulAntennaTx = pHalData->antenna_tx_path; ulAntennaRx = pHalData->AntennaRxPath; - if (pHalData->rf_chip >= RF_TYPE_MAX) { + if (pHalData->rf_chip >= RF_CHIP_MAX) { RTW_INFO("This RF chip ID is not supported\n"); return; } @@ -1191,19 +1245,19 @@ void mpt_SetRFPath_8723D(PADAPTER pAdapter) switch (pAdapter->mppriv.antenna_tx) { /* Actually path S1 (Wi-Fi) */ case ANTENNA_A: { - pMptCtx->MptRfPath = ODM_RF_PATH_A; - PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0); + pMptCtx->mpt_rf_path = RF_PATH_A; + phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0); } break; /* Actually path S0 (BT) */ case ANTENNA_B: { - pMptCtx->MptRfPath = ODM_RF_PATH_B; - PHY_SetBBReg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0xA); + pMptCtx->mpt_rf_path = RF_PATH_B; + phy_set_bb_reg(pAdapter, rS0S1_PathSwitch, BIT9|BIT8|BIT7|BIT6, 0xA); } break; default: - pMptCtx->MptRfPath = RF_PATH_AB; + pMptCtx->mpt_rf_path = RF_PATH_AB; break; } } @@ -1212,7 +1266,7 @@ void mpt_SetRFPath_8723D(PADAPTER pAdapter) VOID mpt_SetRFPath_819X(PADAPTER pAdapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); u4Byte ulAntennaTx, ulAntennaRx; R_ANTENNA_SELECT_OFDM *p_ofdm_tx; /* OFDM Tx register */ R_ANTENNA_SELECT_CCK *p_cck_txrx; @@ -1220,7 +1274,7 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) u1Byte chgTx = 0, chgRx = 0; u4Byte r_ant_sel_cck_val = 0, r_ant_select_ofdm_val = 0, r_ofdm_tx_en_val = 0; - ulAntennaTx = pHalData->AntennaTxPath; + ulAntennaTx = pHalData->antenna_tx_path; ulAntennaRx = pHalData->AntennaRxPath; p_ofdm_tx = (R_ANTENNA_SELECT_OFDM *)&r_ant_select_ofdm_val; @@ -1242,21 +1296,21 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) /*/ From SD3 Willis suggestion !!! Set RF A=TX and B as standby*/ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ { - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); - PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 1); r_ofdm_tx_en_val = 0x3; /*/ Power save*/ /*/cosa r_ant_select_ofdm_val = 0x11111111;*/ /*/ We need to close RFB by SW control*/ if (pHalData->rf_type == RF_2T2R) { - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 1); - PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 0); } } - pMptCtx->MptRfPath = ODM_RF_PATH_A; + pMptCtx->mpt_rf_path = RF_PATH_A; break; case ANTENNA_B: p_ofdm_tx->r_tx_antenna = 0x2; @@ -1269,21 +1323,21 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) /*/ From SD3 Willis suggestion !!! Set RF A as standby*/ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ { - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 1); - PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); /*/ 2008/10/31 MH From SD3 Willi's suggestion. We must read RF 1T table.*/ /*/ 2009/01/08 MH From Sd3 Willis. We need to close RFA by SW control*/ if (pHalData->rf_type == RF_2T2R || pHalData->rf_type == RF_1T2R) { - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 1); - PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); - /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 0); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); + /*/phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); } } - pMptCtx->MptRfPath = ODM_RF_PATH_B; + pMptCtx->mpt_rf_path = RF_PATH_B; break; case ANTENNA_AB:/*/ For 8192S*/ p_ofdm_tx->r_tx_antenna = 0x3; @@ -1296,21 +1350,21 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) /*/ From SD3Willis suggestion !!! Set RF B as standby*/ /*/if (IS_HARDWARE_TYPE_8192S(pAdapter))*/ { - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); - PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, 0xe, 2); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter2, 0xe, 2); /* Disable Power save*/ /*cosa r_ant_select_ofdm_val = 0x3321333;*/ /* 2009/01/08 MH From Sd3 Willis. We need to enable RFA/B by SW control*/ if (pHalData->rf_type == RF_2T2R) { - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); - /*/PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0); + /*/phy_set_bb_reg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0);*/ + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT1, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XAB_RFParameter, BIT17, 1); } } - pMptCtx->MptRfPath = ODM_RF_PATH_AB; + pMptCtx->mpt_rf_path = RF_PATH_AB; break; default: break; @@ -1350,15 +1404,15 @@ VOID mpt_SetRFPath_819X(PADAPTER pAdapter) case RF_8256: case RF_6052: /*/r_ant_sel_cck_val = r_ant_select_cck_val;*/ - PHY_SetBBReg(pAdapter, rFPGA1_TxInfo, 0x7fffffff, r_ant_select_ofdm_val); /*/OFDM Tx*/ - PHY_SetBBReg(pAdapter, rFPGA0_TxInfo, 0x0000000f, r_ofdm_tx_en_val); /*/OFDM Tx*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ - PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ + phy_set_bb_reg(pAdapter, rFPGA1_TxInfo, 0x7fffffff, r_ant_select_ofdm_val); /*/OFDM Tx*/ + phy_set_bb_reg(pAdapter, rFPGA0_TxInfo, 0x0000000f, r_ofdm_tx_en_val); /*/OFDM Tx*/ + phy_set_bb_reg(pAdapter, rOFDM0_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ + phy_set_bb_reg(pAdapter, rOFDM1_TRxPathEnable, 0x0000000f, r_rx_antenna_ofdm); /*/OFDM Rx*/ if (IS_HARDWARE_TYPE_8192E(pAdapter)) { - PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ - PHY_SetBBReg(pAdapter, rOFDM1_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ + phy_set_bb_reg(pAdapter, rOFDM0_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ + phy_set_bb_reg(pAdapter, rOFDM1_TRxPathEnable, 0x000000F0, r_rx_antenna_ofdm); /*/OFDM Rx*/ } - PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskByte3, r_ant_select_cck_val);/*/r_ant_sel_cck_val); /CCK TxRx*/ + phy_set_bb_reg(pAdapter, rCCK0_AFESetting, bMaskByte3, r_ant_select_cck_val);/*/r_ant_sel_cck_val); /CCK TxRx*/ break; default: @@ -1447,7 +1501,7 @@ s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) else if (target_ther > 0x1d) target_ther = 0x1d; - pHalData->EEPROMThermalMeter = target_ther; + pHalData->eeprom_thermal_meter = target_ther; return _SUCCESS; } @@ -1455,7 +1509,7 @@ s32 hal_mpt_SetThermalMeter(PADAPTER pAdapter, u8 target_ther) void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x42, BIT17 | BIT16, 0x03); } @@ -1463,11 +1517,24 @@ void hal_mpt_TriggerRFThermalMeter(PADAPTER pAdapter) u8 hal_mpt_ReadRFThermalMeter(PADAPTER pAdapter) { + struct PHY_DM_STRUCT *p_dm_odm = adapter_to_phydm(pAdapter); u32 ThermalValue = 0; + s32 thermal_value_temp = 0; + s8 thermal_offset = 0; + + ThermalValue = (u1Byte)phy_query_rf_reg(pAdapter, RF_PATH_A, 0x42, 0xfc00); /*0x42: RF Reg[15:10]*/ + thermal_offset = phydm_get_thermal_offset(p_dm_odm); + + thermal_value_temp = ThermalValue + thermal_offset; + + if (thermal_value_temp > 63) + ThermalValue = 63; + else if (thermal_value_temp < 0) + ThermalValue = 0; + else + ThermalValue = thermal_value_temp; - ThermalValue = (u1Byte)PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, 0x42, 0xfc00); /*0x42: RF Reg[15:10]*/ return (u8)ThermalValue; - } @@ -1491,27 +1558,27 @@ void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - pAdapter->mppriv.MptCtx.bSingleCarrier = bStart; + pAdapter->mppriv.mpt_ctx.bSingleCarrier = bStart; if (bStart) {/*/ Start Single Carrier.*/ /*/ Start Single Carrier.*/ /*/ 1. if OFDM block on?*/ - if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1); /*set OFDM block on*/ + if (!phy_query_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1); /*set OFDM block on*/ /*/ 2. set CCK test mode off, set to CCK normal mode*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0); /*/ 3. turn on scramble setting*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 1); /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) - PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_SingleCarrier); + phy_set_bb_reg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_SingleCarrier); else #endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleCarrier); + phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleCarrier); } else { /*/ Stop Single Carrier.*/ @@ -1519,15 +1586,15 @@ void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) /*/ Turn off all test modes.*/ #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) - PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); else #endif /* CONFIG_RTL8812A || CONFIG_RTL8821A || CONFIG_RTL8814A || CONFIG_RTL8822B || CONFIG_RTL8821C */ - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); rtw_msleep_os(10); /*/BB Reset*/ - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); + phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); + phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); } } @@ -1535,113 +1602,114 @@ void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart) void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - u4Byte ulAntennaTx = pHalData->AntennaTxPath; + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); + u4Byte ulAntennaTx = pHalData->antenna_tx_path; static u4Byte regRF = 0, regBB0 = 0, regBB1 = 0, regBB2 = 0, regBB3 = 0; u8 rfPath; switch (ulAntennaTx) { case ANTENNA_B: - rfPath = ODM_RF_PATH_B; + rfPath = RF_PATH_B; break; case ANTENNA_C: - rfPath = ODM_RF_PATH_C; + rfPath = RF_PATH_C; break; case ANTENNA_D: - rfPath = ODM_RF_PATH_D; + rfPath = RF_PATH_D; break; case ANTENNA_A: default: - rfPath = ODM_RF_PATH_A; + rfPath = RF_PATH_A; break; } - pAdapter->mppriv.MptCtx.bSingleTone = bStart; + pAdapter->mppriv.mpt_ctx.is_single_tone = bStart; if (bStart) { /*/ Start Single Tone.*/ /*/ <20120326, Kordan> To amplify the power of tone for Xtal calibration. (asked by Edlu)*/ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { - regRF = PHY_QueryRFReg(pAdapter, rfPath, LNA_Low_Gain_3, bRFRegOffsetMask); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x0); - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x0); + regRF = phy_query_rf_reg(pAdapter, rfPath, lna_low_gain_3, bRFRegOffsetMask); + phy_set_rf_reg(pAdapter, RF_PATH_A, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x0); + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x0); } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { /*/ USB need to do RF LO disable first, PCIE isn't required to follow this order.*/ /*/Set MAC REG 88C: Prevent SingleTone Fail*/ - PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0xF); - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO disabled*/ - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ + phy_set_mac_reg(pAdapter, 0x88C, 0xF00000, 0xF); + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x1); /*/ RF LO disabled*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x1); /*/ RF LO enabled*/ + if (pMptCtx->mpt_rf_path == RF_PATH_A) { + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x56, 0xF, 0x1); /*/ RF LO enabled*/ } else { /*/ S0/S1 both use PATH A to configure*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x1); /*/ RF LO enabled*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x2); /*/ Tx mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x76, 0xF, 0x1); /*/ RF LO enabled*/ } } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x2); /* Tx mode */ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x1); /* RF LO enabled */ + if (pMptCtx->mpt_rf_path == RF_PATH_A) { + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x2); /* Tx mode */ + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, 0xF000, 0x1); /* RF LO enabled */ } } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { /*Set BB REG 88C: Prevent SingleTone Fail*/ - PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xF); - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x2); + phy_set_bb_reg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xF); + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x1); + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x2); } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x1); + if (pMptCtx->mpt_rf_path == RF_PATH_A) { + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x0); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, BIT0, 0x1); } else {/* S0/S1 both use PATH A to configure */ - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x0); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x1); + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x0); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x63, BIT0, 0x1); } } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter)) { -#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) - u1Byte p = ODM_RF_PATH_A; +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) + u1Byte p = RF_PATH_A; - regRF = PHY_QueryRFReg(pAdapter, ODM_RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); - regBB0 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); - regBB1 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); - regBB2 = PHY_QueryBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord); - regBB3 = PHY_QueryBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord); + regRF = phy_query_rf_reg(pAdapter, RF_PATH_A, RF_AC_Jaguar, bRFRegOffsetMask); + regBB0 = phy_query_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord); + regBB1 = phy_query_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord); + regBB2 = phy_query_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord); + regBB3 = phy_query_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord); - PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x0); /*/ Disable CCK and OFDM*/ + phy_set_bb_reg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x0); /*/ Disable CCK and OFDM*/ - if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { - for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { - PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ - PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ - PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ + if (pMptCtx->mpt_rf_path == RF_PATH_AB) { + for (p = RF_PATH_A; p <= RF_PATH_B; ++p) { + phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ + phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ + phy_set_rf_reg(pAdapter, p, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ } } else { - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x1); /*/ RF LO enabled*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC_Jaguar, 0xF0000, 0x2); /*/ Tx mode: RF0x00[19:16]=4'b0010 */ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC_Jaguar, 0x1F, 0x0); /*/ Lowest RF gain index: RF_0x0[4:0] = 0*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x1); /*/ RF LO enabled*/ } - PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ - PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ + phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, 0xFF00F0, 0x77007); /*/ 0xCB0[[23:16, 7:4] = 0x77007*/ - if (pHalData->ExternalPA_5G) { - PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xCB4[23:16] = 0x12*/ - PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xEB4[23:16] = 0x12*/ + if (pHalData->external_pa_5g) { + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xCB4[23:16] = 0x12*/ + phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x12); /*/ 0xEB4[23:16] = 0x12*/ } else if (pHalData->ExternalPA_2G) { - PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xCB4[23:16] = 0x11*/ - PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xEB4[23:16] = 0x11*/ + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xCB4[23:16] = 0x11*/ + phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, 0xFF00000, 0x11); /*/ 0xEB4[23:16] = 0x11*/ } #endif } -#ifdef CONFIG_RTL8814A - else if (IS_HARDWARE_TYPE_8814A(pAdapter)) - mpt_SetSingleTone_8814A(pAdapter, TRUE, FALSE); +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821C) + else if (IS_HARDWARE_TYPE_8814A(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) + mpt_SetSingleTone_8814A(pAdapter, TRUE, FALSE); #endif + else /*/ Turn On SingleTone and turn off the other test modes.*/ - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleTone); + phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_SingleTone); write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); @@ -1649,71 +1717,71 @@ void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart) } else {/*/ Stop Single Ton e.*/ if (IS_HARDWARE_TYPE_8188E(pAdapter)) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, LNA_Low_Gain_3, bRFRegOffsetMask, regRF); - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); + phy_set_rf_reg(pAdapter, RF_PATH_A, lna_low_gain_3, bRFRegOffsetMask, regRF); + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn, 0x1); + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 0x1); } else if (IS_HARDWARE_TYPE_8192E(pAdapter)) { - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3);/*/ Tx mode*/ - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0);/*/ RF LO disabled */ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x3);/*/ Tx mode*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x0);/*/ RF LO disabled */ /*/ RESTORE MAC REG 88C: Enable RF Functions*/ - PHY_SetMacReg(pAdapter, 0x88C, 0xF00000, 0x0); + phy_set_mac_reg(pAdapter, 0x88C, 0xF00000, 0x0); } else if (IS_HARDWARE_TYPE_8723B(pAdapter)) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x56, 0xF, 0x0); /*/ RF LO disabled*/ + if (pMptCtx->mpt_rf_path == RF_PATH_A) { + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x56, 0xF, 0x0); /*/ RF LO disabled*/ } else { /*/ S0/S1 both use PATH A to configure*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x76, 0xF, 0x0); /*/ RF LO disabled*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x3); /*/ Rx mode*/ + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x76, 0xF, 0x0); /*/ RF LO disabled*/ } } else if (IS_HARDWARE_TYPE_8703B(pAdapter)) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, 0xF0000, 0x3); /* Rx mode */ - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, 0xF000, 0x0); /* RF LO disabled */ + if (pMptCtx->mpt_rf_path == RF_PATH_A) { + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, 0xF0000, 0x3); /* Rx mode */ + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, 0xF000, 0x0); /* RF LO disabled */ } } else if (IS_HARDWARE_TYPE_8188F(pAdapter)) { - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, RF_AC, 0xF0000, 0x3); /*Tx mode*/ - PHY_SetRFReg(pAdapter, pMptCtx->MptRfPath, LNA_Low_Gain_3, BIT1, 0x0); /*RF LO disabled*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, RF_AC, 0xF0000, 0x3); /*Tx mode*/ + phy_set_rf_reg(pAdapter, pMptCtx->mpt_rf_path, lna_low_gain_3, BIT1, 0x0); /*RF LO disabled*/ /*Set BB REG 88C: Prevent SingleTone Fail*/ - PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xc); + phy_set_bb_reg(pAdapter, rFPGA0_AnalogParameter4, 0xF00000, 0xc); } else if (IS_HARDWARE_TYPE_8723D(pAdapter)) { - if (pMptCtx->MptRfPath == ODM_RF_PATH_A) { - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x53, BIT0, 0x0); + if (pMptCtx->mpt_rf_path == RF_PATH_A) { + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x1); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x53, BIT0, 0x0); } else { /* S0/S1 both use PATH A to configure */ - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_AC, BIT16, 0x1); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, 0x63, BIT0, 0x0); + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn|bOFDMEn, 0x3); + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_AC, BIT16, 0x1); + phy_set_rf_reg(pAdapter, RF_PATH_A, 0x63, BIT0, 0x0); } } else if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8822B(pAdapter)) { -#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) - u1Byte p = ODM_RF_PATH_A; +#if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8822B) + u1Byte p = RF_PATH_A; - PHY_SetBBReg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x3); /*/ Disable CCK and OFDM*/ + phy_set_bb_reg(pAdapter, rOFDMCCKEN_Jaguar, BIT29 | BIT28, 0x3); /*/ Disable CCK and OFDM*/ - if (pMptCtx->MptRfPath == ODM_RF_PATH_AB) { - for (p = ODM_RF_PATH_A; p <= ODM_RF_PATH_B; ++p) { - PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); - PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ + if (pMptCtx->mpt_rf_path == RF_PATH_AB) { + for (p = RF_PATH_A; p <= RF_PATH_B; ++p) { + phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); + phy_set_rf_reg(pAdapter, p, lna_low_gain_3, BIT1, 0x0); /*/ RF LO disabled*/ } } else { - PHY_SetRFReg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); - PHY_SetRFReg(pAdapter, p, LNA_Low_Gain_3, BIT1, 0x0); /*/ RF LO disabled*/ + phy_set_rf_reg(pAdapter, p, RF_AC_Jaguar, bRFRegOffsetMask, regRF); + phy_set_rf_reg(pAdapter, p, lna_low_gain_3, BIT1, 0x0); /*/ RF LO disabled*/ } - PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, regBB0); - PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, regBB1); - PHY_SetBBReg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB2); - PHY_SetBBReg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB3); + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar, bMaskDWord, regBB0); + phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar, bMaskDWord, regBB1); + phy_set_bb_reg(pAdapter, rA_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB2); + phy_set_bb_reg(pAdapter, rB_RFE_Pinmux_Jaguar + 4, bMaskDWord, regBB3); #endif } #if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) - else if (IS_HARDWARE_TYPE_8814A(pAdapter)) + else if (IS_HARDWARE_TYPE_8814A(pAdapter) || IS_HARDWARE_TYPE_8821C(pAdapter)) mpt_SetSingleTone_8814A(pAdapter, FALSE, FALSE); else/*/ Turn off all test modes.*/ - PHY_SetBBReg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, rSingleTone_ContTx_Jaguar, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); #endif write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); @@ -1725,7 +1793,7 @@ void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) { u8 Rate; - pAdapter->mppriv.MptCtx.bCarrierSuppression = bStart; + pAdapter->mppriv.mpt_ctx.is_carrier_suppression = bStart; Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); if (bStart) {/* Start Carrier Suppression.*/ @@ -1736,9 +1804,9 @@ void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) /*/Turn Off All Test Mode*/ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) - PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /* rSingleTone_ContTx_Jaguar*/ + phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /* rSingleTone_ContTx_Jaguar*/ else - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ write_bbreg(pAdapter, rCCK0_System, bCCKScramble, 0x0); /*/turn off scramble setting*/ @@ -1768,140 +1836,16 @@ void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart) RTW_INFO("\n MPT_ProSetCarrierSupp() is finished.\n"); } -void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart) -{ - u32 cckrate; - - if (bStart) { - - /*/ 1. if CCK block on?*/ - if (!read_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn)) - write_bbreg(pAdapter, rFPGA0_RFMOD, bCCKEn, bEnable);/*set CCK block on*/ - - /*/Turn Off All Test Mode*/ - if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) - PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); /*rSingleTone_ContTx_Jaguar*/ - else - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); - - /*/Set CCK Tx Test Rate*/ - - cckrate = pAdapter->mppriv.rateidx; - - write_bbreg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); - write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*/transmit mode*/ - write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ - - if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 11 force cck rxiq = 0*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /*/ 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); - PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 1); - } - - write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); - write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); - - } else { - - write_bbreg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*/normal mode*/ - write_bbreg(pAdapter, rCCK0_System, bCCKScramble, bEnable); /*/turn on scramble setting*/ - - if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /* && !IS_HARDWARE_TYPE_8822B(pAdapter) */) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/* rCCK0_RxHP 0xa15[1:0] = 2b00*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /*/ 0xc08[16] = 0*/ - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); - PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 0); - } - - /*/BB Reset*/ - write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); - write_bbreg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); - - write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); - write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); - } - - pAdapter->mppriv.MptCtx.bCckContTx = bStart; - pAdapter->mppriv.MptCtx.bOfdmContTx = _FALSE; -} - -void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - if (bStart) { - if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*/set OFDM block on*/ - - /*/ 2. set CCK test mode off, set to CCK normal mode*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); - - /*/ 3. turn on scramble setting*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); - - if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&& !IS_HARDWARE_TYPE_8822B(pAdapter)*/) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* rCCK0_RxHP 0xa15[1:0] = 2b'11*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ - } - - /*/ 4. Turn On Continue Tx and turn off the other test modes.*/ - if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) - PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); /*rSingleTone_ContTx_Jaguar*/ - else - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); - - write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); - write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); - - } else { - if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_8814A(pAdapter) /*|| IS_HARDWARE_TYPE_8822B(pAdapter)*/) - PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); - else - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); - /*/Delay 10 ms*/ - rtw_msleep_os(10); - - if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_8814A(pAdapter) /*&&! IS_HARDWARE_TYPE_8822B(pAdapter)*/) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0);/*/ 0xa15[1:0] = 0*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0);/*/ 0xc08[16] = 0*/ - } - - /*/BB Reset*/ - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); - - write_bbreg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); - write_bbreg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); - } - - pAdapter->mppriv.MptCtx.bCckContTx = _FALSE; - pAdapter->mppriv.MptCtx.bOfdmContTx = bStart; -} - -void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart) -{ - u8 Rate; - - Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); - pAdapter->mppriv.MptCtx.bStartContTx = bStart; - - if (Rate <= MPT_RATE_11M) - hal_mpt_SetCCKContinuousTx(pAdapter, bStart); - else if (Rate >= MPT_RATE_6M) - hal_mpt_SetOFDMContinuousTx(pAdapter, bStart); -} - u32 hal_mpt_query_phytxok(PADAPTER pAdapter) { - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; u16 count = 0; if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) - count = PHY_QueryBBReg(pAdapter, 0xF50, bMaskLWord); /* [15:0]*/ + count = phy_query_bb_reg(pAdapter, 0xF50, bMaskLWord); /* [15:0]*/ else - count = PHY_QueryBBReg(pAdapter, 0xF50, bMaskHWord); /* [31:16]*/ + count = phy_query_bb_reg(pAdapter, 0xF50, bMaskHWord); /* [31:16]*/ if (count > 50000) { rtw_reset_phy_trx_ok_counters(pAdapter); @@ -1913,36 +1857,35 @@ u32 hal_mpt_query_phytxok(PADAPTER pAdapter) } -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) -/* for HW TX mode */ static VOID mpt_StopCckContTx( PADAPTER pAdapter ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); u1Byte u1bReg; pMptCtx->bCckContTx = FALSE; pMptCtx->bOfdmContTx = FALSE; - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0x0); /*normal mode*/ + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ - if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 2b00*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ + if (!IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { + phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 2b00*/ + phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); - PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 0); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter2, BIT14, 0); + phy_set_bb_reg(pAdapter, 0x0B34, BIT14, 0); } /*BB Reset*/ - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); + phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); + phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); - PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); } /* mpt_StopCckContTx */ @@ -1952,7 +1895,7 @@ static VOID mpt_StopOfdmContTx( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); u1Byte u1bReg; u4Byte data; @@ -1960,23 +1903,23 @@ static VOID mpt_StopOfdmContTx( pMptCtx->bOfdmContTx = FALSE; if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) - PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); else - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); rtw_mdelay_os(10); if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 0*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ + phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x0); /* 0xa15[1:0] = 0*/ + phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x0); /* 0xc08[16] = 0*/ } /*BB Reset*/ - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); - PHY_SetBBReg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); + phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x0); + phy_set_bb_reg(pAdapter, rPMAC_Reset, bBBResetB, 0x1); - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); - PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000100); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000100); } /* mpt_StopOfdmContTx */ @@ -1985,35 +1928,36 @@ static VOID mpt_StartCckContTx( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); u4Byte cckrate; /* 1. if CCK block on */ - if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn)) - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bCCKEn, 1);/*set CCK block on*/ + if (!phy_query_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn)) + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bCCKEn, 1);/*set CCK block on*/ /*Turn Off All Test Mode*/ if (IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) - PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ALL_OFF); else - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); + phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ALL_OFF); cckrate = pAdapter->mppriv.rateidx; - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKTxRate, cckrate); - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*transmit mode*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0x2); /*transmit mode*/ + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 0x1); /*turn on scramble setting*/ if (!IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(pAdapter)) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 11 force cck rxiq = 0*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); - PHY_SetBBReg(pAdapter, 0x0B34, BIT14, 1); + phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 11 force cck rxiq = 0*/ + phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1 force ofdm rxiq = ofdm txiq*/ + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter2, BIT14, 1); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter2, BIT14, 1); + phy_set_bb_reg(pAdapter, 0x0B34, BIT14, 1); } - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); - PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); pMptCtx->bCckContTx = TRUE; pMptCtx->bOfdmContTx = FALSE; @@ -2026,52 +1970,54 @@ static VOID mpt_StartOfdmContTx( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.mpt_ctx); /* 1. if OFDM block on?*/ - if (!PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) - PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*set OFDM block on*/ + if (!phy_query_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn)) + phy_set_bb_reg(pAdapter, rFPGA0_RFMOD, bOFDMEn, 1);/*set OFDM block on*/ /* 2. set CCK test mode off, set to CCK normal mode*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKBBMode, 0); + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKBBMode, 0); /* 3. turn on scramble setting*/ - PHY_SetBBReg(pAdapter, rCCK0_System, bCCKScramble, 1); + phy_set_bb_reg(pAdapter, rCCK0_System, bCCKScramble, 1); if (!IS_HARDWARE_TYPE_JAGUAR(pAdapter) && !IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) { - PHY_SetBBReg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 2b'11*/ - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ + phy_set_bb_reg(pAdapter, 0xa14, 0x300, 0x3); /* 0xa15[1:0] = 2b'11*/ + phy_set_bb_reg(pAdapter, rOFDM0_TRMuxPar, 0x10000, 0x1); /* 0xc08[16] = 1*/ } /* 4. Turn On Continue Tx and turn off the other test modes.*/ if (IS_HARDWARE_TYPE_JAGUAR(pAdapter) || IS_HARDWARE_TYPE_JAGUAR2(pAdapter)) - PHY_SetBBReg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); + phy_set_bb_reg(pAdapter, 0x914, BIT18 | BIT17 | BIT16, OFDM_ContinuousTx); else - PHY_SetBBReg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); + phy_set_bb_reg(pAdapter, rOFDM1_LSTF, BIT30 | BIT29 | BIT28, OFDM_ContinuousTx); - PHY_SetBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); - PHY_SetBBReg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); + phy_set_bb_reg(pAdapter, rFPGA0_XA_HSSIParameter1, bMaskDWord, 0x01000500); + phy_set_bb_reg(pAdapter, rFPGA0_XB_HSSIParameter1, bMaskDWord, 0x01000500); pMptCtx->bCckContTx = FALSE; pMptCtx->bOfdmContTx = TRUE; } /* mpt_StartOfdmContTx */ +#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +/* for HW TX mode */ void mpt_ProSetPMacTx(PADAPTER Adapter) { - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.mpt_ctx); RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; u32 u4bTmp; - DbgPrint("SGI %d bSPreamble %d bSTBC %d bLDPC %d NDP_sound %d\n", PMacTxInfo.bSGI, PMacTxInfo.bSPreamble, PMacTxInfo.bSTBC, PMacTxInfo.bLDPC, PMacTxInfo.NDP_sound); - DbgPrint("TXSC %d BandWidth %d PacketPeriod %d PacketCount %d PacketLength %d PacketPattern %d\n", PMacTxInfo.TX_SC, PMacTxInfo.BandWidth, PMacTxInfo.PacketPeriod, PMacTxInfo.PacketCount, + dbg_print("SGI %d bSPreamble %d bSTBC %d bLDPC %d NDP_sound %d\n", PMacTxInfo.bSGI, PMacTxInfo.bSPreamble, PMacTxInfo.bSTBC, PMacTxInfo.bLDPC, PMacTxInfo.NDP_sound); + dbg_print("TXSC %d BandWidth %d PacketPeriod %d PacketCount %d PacketLength %d PacketPattern %d\n", PMacTxInfo.TX_SC, PMacTxInfo.BandWidth, PMacTxInfo.PacketPeriod, PMacTxInfo.PacketCount, PMacTxInfo.PacketLength, PMacTxInfo.PacketPattern); #if 0 PRINT_DATA("LSIG ", PMacTxInfo.LSIG, 3); PRINT_DATA("HT_SIG", PMacTxInfo.HT_SIG, 6); PRINT_DATA("VHT_SIG_A", PMacTxInfo.VHT_SIG_A, 6); PRINT_DATA("VHT_SIG_B", PMacTxInfo.VHT_SIG_B, 4); - DbgPrint("VHT_SIG_B_CRC %x\n", PMacTxInfo.VHT_SIG_B_CRC); + dbg_print("VHT_SIG_B_CRC %x\n", PMacTxInfo.VHT_SIG_B_CRC); PRINT_DATA("VHT_Delimiter", PMacTxInfo.VHT_Delimiter, 4); PRINT_DATA("Src Address", Adapter->mac_addr, 6); @@ -2080,17 +2026,17 @@ void mpt_ProSetPMacTx(PADAPTER Adapter) if (PMacTxInfo.bEnPMacTx == FALSE) { if (PMacTxInfo.Mode == CONTINUOUS_TX) { - PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ + phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) mpt_StopCckContTx(Adapter); else mpt_StopOfdmContTx(Adapter); } else if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { - u4bTmp = PHY_QueryBBReg(Adapter, 0xf50, bMaskLWord); - PHY_SetBBReg(Adapter, 0xb1c, bMaskLWord, u4bTmp + 50); - PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /*TX Stop*/ + u4bTmp = phy_query_bb_reg(Adapter, 0xf50, bMaskLWord); + phy_set_bb_reg(Adapter, 0xb1c, bMaskLWord, u4bTmp + 50); + phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); /*TX Stop*/ } else - PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ + phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); /* TX Stop*/ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) { /* Stop HW TX -> Stop Continuous TX -> Stop RF Setting*/ @@ -2128,22 +2074,22 @@ void mpt_ProSetPMacTx(PADAPTER Adapter) if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { /* 0xb1c[0:15] TX packet count 0xb1C[31:16] SFD*/ u4bTmp = PMacTxInfo.PacketCount | (PMacTxInfo.SFD << 16); - PHY_SetBBReg(Adapter, 0xb1c, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb1c, bMaskDWord, u4bTmp); /* 0xb40 7:0 SIGNAL 15:8 SERVICE 31:16 LENGTH*/ u4bTmp = PMacTxInfo.SignalField | (PMacTxInfo.ServiceField << 8) | (PMacTxInfo.LENGTH << 16); - PHY_SetBBReg(Adapter, 0xb40, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb40, bMaskDWord, u4bTmp); u4bTmp = PMacTxInfo.CRC16[0] | (PMacTxInfo.CRC16[1] << 8); - PHY_SetBBReg(Adapter, 0xb44, bMaskLWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb44, bMaskLWord, u4bTmp); if (PMacTxInfo.bSPreamble) - PHY_SetBBReg(Adapter, 0xb0c, BIT27, 0); + phy_set_bb_reg(Adapter, 0xb0c, BIT27, 0); else - PHY_SetBBReg(Adapter, 0xb0c, BIT27, 1); + phy_set_bb_reg(Adapter, 0xb0c, BIT27, 1); } else { - PHY_SetBBReg(Adapter, 0xb18, 0xfffff, PMacTxInfo.PacketCount); + phy_set_bb_reg(Adapter, 0xb18, 0xfffff, PMacTxInfo.PacketCount); u4bTmp = PMacTxInfo.LSIG[0] | ((PMacTxInfo.LSIG[1]) << 8) | ((PMacTxInfo.LSIG[2]) << 16) | ((PMacTxInfo.PacketPattern) << 24); - PHY_SetBBReg(Adapter, 0xb08, bMaskDWord, u4bTmp); /* Set 0xb08[23:0] = LSIG, 0xb08[31:24] = Data init octet*/ + phy_set_bb_reg(Adapter, 0xb08, bMaskDWord, u4bTmp); /* Set 0xb08[23:0] = LSIG, 0xb08[31:24] = Data init octet*/ if (PMacTxInfo.PacketPattern == 0x12) u4bTmp = 0x3000000; @@ -2153,103 +2099,127 @@ void mpt_ProSetPMacTx(PADAPTER Adapter) if (IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) { u4bTmp |= PMacTxInfo.HT_SIG[0] | ((PMacTxInfo.HT_SIG[1]) << 8) | ((PMacTxInfo.HT_SIG[2]) << 16); - PHY_SetBBReg(Adapter, 0xb0c, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb0c, bMaskDWord, u4bTmp); u4bTmp = PMacTxInfo.HT_SIG[3] | ((PMacTxInfo.HT_SIG[4]) << 8) | ((PMacTxInfo.HT_SIG[5]) << 16); - PHY_SetBBReg(Adapter, 0xb10, 0xffffff, u4bTmp); + phy_set_bb_reg(Adapter, 0xb10, 0xffffff, u4bTmp); } else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) { u4bTmp |= PMacTxInfo.VHT_SIG_A[0] | ((PMacTxInfo.VHT_SIG_A[1]) << 8) | ((PMacTxInfo.VHT_SIG_A[2]) << 16); - PHY_SetBBReg(Adapter, 0xb0c, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb0c, bMaskDWord, u4bTmp); u4bTmp = PMacTxInfo.VHT_SIG_A[3] | ((PMacTxInfo.VHT_SIG_A[4]) << 8) | ((PMacTxInfo.VHT_SIG_A[5]) << 16); - PHY_SetBBReg(Adapter, 0xb10, 0xffffff, u4bTmp); + phy_set_bb_reg(Adapter, 0xb10, 0xffffff, u4bTmp); _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_SIG_B, 4); - PHY_SetBBReg(Adapter, 0xb14, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb14, bMaskDWord, u4bTmp); } if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) { u4bTmp = (PMacTxInfo.VHT_SIG_B_CRC << 24) | PMacTxInfo.PacketPeriod; /* for TX interval */ - PHY_SetBBReg(Adapter, 0xb20, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb20, bMaskDWord, u4bTmp); _rtw_memcpy(&u4bTmp, PMacTxInfo.VHT_Delimiter, 4); - PHY_SetBBReg(Adapter, 0xb24, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb24, bMaskDWord, u4bTmp); /* 0xb28 - 0xb34 24 byte Probe Request MAC Header*/ /*& Duration & Frame control*/ - PHY_SetBBReg(Adapter, 0xb28, bMaskDWord, 0x00000040); + phy_set_bb_reg(Adapter, 0xb28, bMaskDWord, 0x00000040); /* Address1 [0:3]*/ u4bTmp = PMacTxInfo.MacAddress[0] | (PMacTxInfo.MacAddress[1] << 8) | (PMacTxInfo.MacAddress[2] << 16) | (PMacTxInfo.MacAddress[3] << 24); - PHY_SetBBReg(Adapter, 0xb2C, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb2C, bMaskDWord, u4bTmp); /* Address3 [3:0]*/ - PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb38, bMaskDWord, u4bTmp); /* Address2[0:1] & Address1 [5:4]*/ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8) | (Adapter->mac_addr[0] << 16) | (Adapter->mac_addr[1] << 24); - PHY_SetBBReg(Adapter, 0xb30, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb30, bMaskDWord, u4bTmp); /* Address2 [5:2]*/ u4bTmp = Adapter->mac_addr[2] | (Adapter->mac_addr[3] << 8) | (Adapter->mac_addr[4] << 16) | (Adapter->mac_addr[5] << 24); - PHY_SetBBReg(Adapter, 0xb34, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb34, bMaskDWord, u4bTmp); /* Sequence Control & Address3 [5:4]*/ /*u4bTmp = PMacTxInfo.MacAddress[4]|(PMacTxInfo.MacAddress[5] << 8) ;*/ - /*PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp);*/ + /*phy_set_bb_reg(Adapter, 0xb38, bMaskDWord, u4bTmp);*/ } else { - PHY_SetBBReg(Adapter, 0xb20, bMaskDWord, PMacTxInfo.PacketPeriod); /* for TX interval*/ + phy_set_bb_reg(Adapter, 0xb20, bMaskDWord, PMacTxInfo.PacketPeriod); /* for TX interval*/ /* & Duration & Frame control */ - PHY_SetBBReg(Adapter, 0xb24, bMaskDWord, 0x00000040); + phy_set_bb_reg(Adapter, 0xb24, bMaskDWord, 0x00000040); /* 0xb24 - 0xb38 24 byte Probe Request MAC Header*/ /* Address1 [0:3]*/ u4bTmp = PMacTxInfo.MacAddress[0] | (PMacTxInfo.MacAddress[1] << 8) | (PMacTxInfo.MacAddress[2] << 16) | (PMacTxInfo.MacAddress[3] << 24); - PHY_SetBBReg(Adapter, 0xb28, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb28, bMaskDWord, u4bTmp); /* Address3 [3:0]*/ - PHY_SetBBReg(Adapter, 0xb34, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb34, bMaskDWord, u4bTmp); /* Address2[0:1] & Address1 [5:4]*/ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8) | (Adapter->mac_addr[0] << 16) | (Adapter->mac_addr[1] << 24); - PHY_SetBBReg(Adapter, 0xb2c, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb2c, bMaskDWord, u4bTmp); /* Address2 [5:2] */ u4bTmp = Adapter->mac_addr[2] | (Adapter->mac_addr[3] << 8) | (Adapter->mac_addr[4] << 16) | (Adapter->mac_addr[5] << 24); - PHY_SetBBReg(Adapter, 0xb30, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb30, bMaskDWord, u4bTmp); /* Sequence Control & Address3 [5:4]*/ u4bTmp = PMacTxInfo.MacAddress[4] | (PMacTxInfo.MacAddress[5] << 8); - PHY_SetBBReg(Adapter, 0xb38, bMaskDWord, u4bTmp); + phy_set_bb_reg(Adapter, 0xb38, bMaskDWord, u4bTmp); } - PHY_SetBBReg(Adapter, 0xb48, bMaskByte3, PMacTxInfo.TX_RATE_HEX); + phy_set_bb_reg(Adapter, 0xb48, bMaskByte3, PMacTxInfo.TX_RATE_HEX); /* 0xb4c 3:0 TXSC 5:4 BW 7:6 m_STBC 8 NDP_Sound*/ u4bTmp = (PMacTxInfo.TX_SC) | ((PMacTxInfo.BandWidth) << 4) | ((PMacTxInfo.m_STBC - 1) << 6) | ((PMacTxInfo.NDP_sound) << 8); - PHY_SetBBReg(Adapter, 0xb4c, 0x1ff, u4bTmp); + phy_set_bb_reg(Adapter, 0xb4c, 0x1ff, u4bTmp); if (IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8822B(Adapter)) { u4Byte offset = 0xb44; if (IS_MPT_OFDM_RATE(PMacTxInfo.TX_RATE)) - PHY_SetBBReg(Adapter, offset, 0xc0000000, 0); + phy_set_bb_reg(Adapter, offset, 0xc0000000, 0); else if (IS_MPT_HT_RATE(PMacTxInfo.TX_RATE)) - PHY_SetBBReg(Adapter, offset, 0xc0000000, 1); + phy_set_bb_reg(Adapter, offset, 0xc0000000, 1); else if (IS_MPT_VHT_RATE(PMacTxInfo.TX_RATE)) - PHY_SetBBReg(Adapter, offset, 0xc0000000, 2); + phy_set_bb_reg(Adapter, offset, 0xc0000000, 2); } - PHY_SetBBReg(Adapter, 0xb00, BIT8, 1); /* Turn on PMAC*/ - /* PHY_SetBBReg(Adapter, 0xb04, 0xf, 2); */ /* TX Stop */ + phy_set_bb_reg(Adapter, 0xb00, BIT8, 1); /* Turn on PMAC*/ + /* phy_set_bb_reg(Adapter, 0xb04, 0xf, 2); */ /* TX Stop */ if (IS_MPT_CCK_RATE(PMacTxInfo.TX_RATE)) { - PHY_SetBBReg(Adapter, 0xb04, 0xf, 8); /*TX CCK ON*/ - PHY_SetBBReg(Adapter, 0xA84, BIT31, 0); + phy_set_bb_reg(Adapter, 0xb04, 0xf, 8); /*TX CCK ON*/ + phy_set_bb_reg(Adapter, 0xA84, BIT31, 0); } else - PHY_SetBBReg(Adapter, 0xb04, 0xf, 4); /* TX Ofdm ON */ + phy_set_bb_reg(Adapter, 0xb04, 0xf, 4); /* TX Ofdm ON */ if (PMacTxInfo.Mode == OFDM_Single_Tone_TX) mpt_SetSingleTone_8814A(Adapter, TRUE, TRUE); } + #endif +void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart) +{ + u8 Rate; + + RT_TRACE(_module_mp_, _drv_info_, + ("SetContinuousTx: rate:%d\n", pAdapter->mppriv.rateidx)); + Rate = HwRateToMPTRate(pAdapter->mppriv.rateidx); + pAdapter->mppriv.mpt_ctx.is_start_cont_tx = bStart; + + if (Rate <= MPT_RATE_11M) { + if (bStart) + mpt_StartCckContTx(pAdapter); + else + mpt_StopCckContTx(pAdapter); + + } else if (Rate >= MPT_RATE_6M) { + if (bStart) + mpt_StartOfdmContTx(pAdapter); + else + mpt_StopOfdmContTx(pAdapter); + } +} + #endif /* CONFIG_MP_INCLUDE*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_phy.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_phy.c index 5c87dbb43c7c..84c571265f74 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_phy.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/hal_phy.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_PHY_C_ #include @@ -85,7 +80,7 @@ PHY_CalculateBitShift( u32 PHY_RFShadowRead( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset) { return RF_Shadow[eRFPath][Offset].Value; @@ -96,7 +91,7 @@ PHY_RFShadowRead( VOID PHY_RFShadowWrite( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u32 Data) { @@ -109,7 +104,7 @@ PHY_RFShadowWrite( BOOLEAN PHY_RFShadowCompare( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset) { u32 reg; @@ -130,7 +125,7 @@ PHY_RFShadowCompare( VOID PHY_RFShadowRecorver( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset) { /* Check if the address is error */ @@ -149,7 +144,7 @@ VOID PHY_RFShadowCompareAll( IN PADAPTER Adapter) { - u8 eRFPath = 0 ; + enum rf_path eRFPath = RF_PATH_A; u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { @@ -164,7 +159,7 @@ VOID PHY_RFShadowRecorverAll( IN PADAPTER Adapter) { - u8 eRFPath = 0; + enum rf_path eRFPath = RF_PATH_A; u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { @@ -178,7 +173,7 @@ PHY_RFShadowRecorverAll( VOID PHY_RFShadowCompareFlagSet( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u8 Type) { @@ -191,7 +186,7 @@ PHY_RFShadowCompareFlagSet( VOID PHY_RFShadowRecorverFlagSet( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u8 Type) { @@ -205,7 +200,7 @@ VOID PHY_RFShadowCompareFlagSetAll( IN PADAPTER Adapter) { - u8 eRFPath = 0; + enum rf_path eRFPath = RF_PATH_A; u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { @@ -225,7 +220,7 @@ VOID PHY_RFShadowRecorverFlagSetAll( IN PADAPTER Adapter) { - u8 eRFPath = 0; + enum rf_path eRFPath = RF_PATH_A; u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { @@ -244,7 +239,7 @@ VOID PHY_RFShadowRefresh( IN PADAPTER Adapter) { - u8 eRFPath = 0; + enum rf_path eRFPath = RF_PATH_A; u32 Offset = 0, maxReg = GET_RF6052_REAL_MAX_REG(Adapter); for (eRFPath = 0; eRFPath < RF6052_MAX_PATH; eRFPath++) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/led/hal_sdio_led.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/led/hal_sdio_led.c index 8465602d0da3..ffe004d96761 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/led/hal_sdio_led.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/led/hal_sdio_led.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,15 +11,11 @@ * 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 #include +#ifdef CONFIG_RTW_SW_LED /* * Description: @@ -838,7 +834,7 @@ void BlinkTimerCallback(void *data) return; } -#ifdef CONFIG_LED_HANDLED_BY_CMD_THREAD +#ifdef CONFIG_RTW_LED_HANDLED_BY_CMD_THREAD rtw_led_blink_cmd(padapter, pLed); #else _set_workitem(&(pLed->BlinkWorkItem)); @@ -1994,7 +1990,7 @@ InitLed( ResetLedStatus(pLed); - _init_timer(&(pLed->BlinkTimer), padapter->pnetdev, BlinkTimerCallback, pLed); + rtw_init_timer(&(pLed->BlinkTimer), padapter, BlinkTimerCallback, pLed); _init_workitem(&(pLed->BlinkWorkItem), BlinkWorkItemCallback, pLed); } @@ -2013,3 +2009,4 @@ DeInitLed( _cancel_timer_ex(&(pLed->BlinkTimer)); ResetLedStatus(pLed); } +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/ap_makefile.mk b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/ap_makefile.mk new file mode 100644 index 000000000000..566c74cdc7c0 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/ap_makefile.mk @@ -0,0 +1,119 @@ + +_PHYDM_FILES :=\ + phydm/phydm.o \ + phydm/phydm_dig.o\ + phydm/phydm_antdiv.o\ + phydm/phydm_soml.o\ + phydm/phydm_smt_ant.o\ + phydm/phydm_pathdiv.o\ + phydm/phydm_rainfo.o\ + phydm/phydm_dynamictxpower.o\ + phydm/phydm_adaptivity.o\ + phydm/phydm_debug.o\ + phydm/phydm_interface.o\ + phydm/phydm_phystatus.o\ + phydm/phydm_hwconfig.o\ + phydm/phydm_dfs.o\ + phydm/phydm_cfotracking.o\ + phydm/phydm_acs.o\ + phydm/phydm_adc_sampling.o\ + phydm/phydm_ccx.o\ + phydm/phydm_primary_cca.o\ + phydm/phydm_cck_pd.o\ + phydm/phydm_rssi_monitor.o\ + phydm/phydm_auto_dbg.o\ + phydm/phydm_math_lib.o\ + phydm/phydm_noisemonitor.o\ + phydm/phydm_api.o\ + phydm/phydm_pow_train.o\ + phydm/txbf/phydm_hal_txbf_api.o\ + EdcaTurboCheck.o\ + phydm/halrf/halrf.o\ + phydm/halrf/halphyrf_ap.o\ + phydm/halrf/halrf_powertracking_ap.o\ + phydm/halrf/halrf_powertracking.o\ + phydm/halrf/halrf_kfree.o + +ifeq ($(CONFIG_RTL_88E_SUPPORT),y) + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8188e/halhwimg8188e_bb.o\ + phydm/rtl8188e/halhwimg8188e_mac.o\ + phydm/rtl8188e/halhwimg8188e_rf.o\ + phydm/rtl8188e/phydm_regconfig8188e.o\ + phydm/rtl8188e/hal8188erateadaptive.o\ + phydm/rtl8188e/phydm_rtl8188e.o\ + phydm/halrf/rtl8188e/halrf_8188e_ap.o + endif +endif + +ifeq ($(CONFIG_RTL_8812_SUPPORT),y) + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += ./phydm/halrf/rtl8812a/halrf_8812a_ap.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8881A),y) + _PHYDM_FILES += phydm/halrf/rtl8821a/halrf_iqk_8821a_ap.o +endif + +ifeq ($(CONFIG_WLAN_HAL_8192EE),y) + _PHYDM_FILES += \ + phydm/halrf/rtl8192e/halrf_8192e_ap.o\ + phydm/rtl8192e/phydm_rtl8192e.o +endif + +ifeq ($(CONFIG_WLAN_HAL_8814AE),y) + rtl8192cd-objs += phydm/halrf/rtl8814a/halrf_8814a_ap.o + rtl8192cd-objs += phydm/halrf/rtl8814a/halrf_iqk_8814a.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + rtl8192cd-objs += \ + phydm/rtl8814a/halhwimg8814a_bb.o\ + phydm/rtl8814a/halhwimg8814a_mac.o\ + phydm/rtl8814a/halhwimg8814a_rf.o\ + phydm/rtl8814a/phydm_regconfig8814a.o\ + phydm/rtl8814a/phydm_rtl8814a.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8822BE),y) + _PHYDM_FILES += phydm/halrf/rtl8822b/halrf_8822b.o + _PHYDM_FILES += phydm/halrf/rtl8822b/halrf_iqk_8822b.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8822b/halhwimg8822b_bb.o\ + phydm/rtl8822b/halhwimg8822b_mac.o\ + phydm/rtl8822b/halhwimg8822b_rf.o\ + phydm/rtl8822b/phydm_regconfig8822b.o\ + phydm/rtl8822b/phydm_hal_api8822b.o\ + phydm/rtl8822b/phydm_rtl8822b.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8821CE),y) + _PHYDM_FILES += phydm/halrf/rtl8821c/halrf_8821c.o + _PHYDM_FILES += phydm/halrf/rtl8821c/halrf_iqk_8821c.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8821c/halhwimg8821c_bb.o\ + phydm/rtl8821c/halhwimg8821c_mac.o\ + phydm/rtl8821c/halhwimg8821c_rf.o\ + phydm/rtl8821c/phydm_regconfig8821c.o\ + phydm/rtl8821c/phydm_hal_api8821c.o + endif +endif + +ifeq ($(CONFIG_WLAN_HAL_8197F),y) + _PHYDM_FILES += phydm/halrf/rtl8197f/halrf_8197f.o + _PHYDM_FILES += phydm/halrf/rtl8197f/halrf_iqk_8197f.o + _PHYDM_FILES += efuse_97f/efuse.o + ifeq ($(CONFIG_RTL_ODM_WLAN_DRIVER),y) + _PHYDM_FILES += \ + phydm/rtl8197f/halhwimg8197f_bb.o\ + phydm/rtl8197f/halhwimg8197f_mac.o\ + phydm/rtl8197f/halhwimg8197f_rf.o\ + phydm/rtl8197f/phydm_hal_api8197f.o\ + phydm/rtl8197f/phydm_regconfig8197f.o\ + phydm/rtl8197f/phydm_rtl8197f.o + endif +endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halhwimg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halhwimg.h index 108f71509129..e8f580220543 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halhwimg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halhwimg.h @@ -1,123 +1,137 @@ -#pragma once -#ifndef __INC_HW_IMG_H -#define __INC_HW_IMG_H - -// -// 2011/03/15 MH Add for different IC HW image file selection. code size consideration. -// -#if RT_PLATFORM == PLATFORM_LINUX - - #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) - // For 92C - #define RTL8192CE_HWIMG_SUPPORT 1 - #define RTL8192CE_TEST_HWIMG_SUPPORT 0 - #define RTL8192CU_HWIMG_SUPPORT 0 - #define RTL8192CU_TEST_HWIMG_SUPPORT 0 - - // For 92D - #define RTL8192DE_HWIMG_SUPPORT 1 - #define RTL8192DE_TEST_HWIMG_SUPPORT 0 - #define RTL8192DU_HWIMG_SUPPORT 0 - #define RTL8192DU_TEST_HWIMG_SUPPORT 0 - - // For 8723 - #define RTL8723E_HWIMG_SUPPORT 1 - #define RTL8723U_HWIMG_SUPPORT 0 - #define RTL8723S_HWIMG_SUPPORT 0 - - //For 88E - #define RTL8188EE_HWIMG_SUPPORT 0 - #define RTL8188EU_HWIMG_SUPPORT 0 - #define RTL8188ES_HWIMG_SUPPORT 0 - - #elif (DEV_BUS_TYPE == RT_USB_INTERFACE) - // For 92C - #define RTL8192CE_HWIMG_SUPPORT 0 - #define RTL8192CE_TEST_HWIMG_SUPPORT 0 - #define RTL8192CU_HWIMG_SUPPORT 1 - #define RTL8192CU_TEST_HWIMG_SUPPORT 0 - - //For 92D - #define RTL8192DE_HWIMG_SUPPORT 0 - #define RTL8192DE_TEST_HWIMG_SUPPORT 0 - #define RTL8192DU_HWIMG_SUPPORT 1 - #define RTL8192DU_TEST_HWIMG_SUPPORT 0 - - // For 8723 - #define RTL8723E_HWIMG_SUPPORT 0 - #define RTL8723U_HWIMG_SUPPORT 1 - #define RTL8723S_HWIMG_SUPPORT 0 - - //For 88E - #define RTL8188EE_HWIMG_SUPPORT 0 - #define RTL8188EU_HWIMG_SUPPORT 0 - #define RTL8188ES_HWIMG_SUPPORT 0 - - #elif (DEV_BUS_TYPE == RT_SDIO_INTERFACE) - // For 92C - #define RTL8192CE_HWIMG_SUPPORT 0 - #define RTL8192CE_TEST_HWIMG_SUPPORT 0 - #define RTL8192CU_HWIMG_SUPPORT 1 - #define RTL8192CU_TEST_HWIMG_SUPPORT 0 - - //For 92D - #define RTL8192DE_HWIMG_SUPPORT 0 - #define RTL8192DE_TEST_HWIMG_SUPPORT 0 - #define RTL8192DU_HWIMG_SUPPORT 1 - #define RTL8192DU_TEST_HWIMG_SUPPORT 0 - - // For 8723 - #define RTL8723E_HWIMG_SUPPORT 0 - #define RTL8723U_HWIMG_SUPPORT 0 - #define RTL8723S_HWIMG_SUPPORT 1 - - //For 88E - #define RTL8188EE_HWIMG_SUPPORT 0 - #define RTL8188EU_HWIMG_SUPPORT 0 - #define RTL8188ES_HWIMG_SUPPORT 0 - #endif - -#else // PLATFORM_WINDOWS & MacOSX - -//For 92C -#define RTL8192CE_HWIMG_SUPPORT 1 -#define RTL8192CE_TEST_HWIMG_SUPPORT 1 -#define RTL8192CU_HWIMG_SUPPORT 1 -#define RTL8192CU_TEST_HWIMG_SUPPORT 1 - -// For 92D -#define RTL8192DE_HWIMG_SUPPORT 1 -#define RTL8192DE_TEST_HWIMG_SUPPORT 1 -#define RTL8192DU_HWIMG_SUPPORT 1 -#define RTL8192DU_TEST_HWIMG_SUPPORT 1 - - #if defined(UNDER_CE) - // For 8723 - #define RTL8723E_HWIMG_SUPPORT 0 - #define RTL8723U_HWIMG_SUPPORT 0 - #define RTL8723S_HWIMG_SUPPORT 1 - - // For 88E - #define RTL8188EE_HWIMG_SUPPORT 0 - #define RTL8188EU_HWIMG_SUPPORT 0 - #define RTL8188ES_HWIMG_SUPPORT 0 - - #else - - // For 8723 - #define RTL8723E_HWIMG_SUPPORT 1 - //#define RTL_8723E_TEST_HWIMG_SUPPORT 1 - #define RTL8723U_HWIMG_SUPPORT 1 - //#define RTL_8723U_TEST_HWIMG_SUPPORT 1 - #define RTL8723S_HWIMG_SUPPORT 1 - //#define RTL_8723S_TEST_HWIMG_SUPPORT 1 - - //For 88E - #define RTL8188EE_HWIMG_SUPPORT 1 - #define RTL8188EU_HWIMG_SUPPORT 1 - #define RTL8188ES_HWIMG_SUPPORT 1 - #endif - -#endif - -#endif //__INC_HW_IMG_H +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#pragma once +#ifndef __INC_HW_IMG_H +#define __INC_HW_IMG_H + +/* + * 2011/03/15 MH Add for different IC HW image file selection. code size consideration. + * */ +#if RT_PLATFORM == PLATFORM_LINUX + + #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + /* For 92C */ + #define RTL8192CE_HWIMG_SUPPORT 1 + #define RTL8192CE_TEST_HWIMG_SUPPORT 0 + #define RTL8192CU_HWIMG_SUPPORT 0 + #define RTL8192CU_TEST_HWIMG_SUPPORT 0 + + /* For 92D */ + #define RTL8192DE_HWIMG_SUPPORT 1 + #define RTL8192DE_TEST_HWIMG_SUPPORT 0 + #define RTL8192DU_HWIMG_SUPPORT 0 + #define RTL8192DU_TEST_HWIMG_SUPPORT 0 + + /* For 8723 */ + #define RTL8723E_HWIMG_SUPPORT 1 + #define RTL8723U_HWIMG_SUPPORT 0 + #define RTL8723S_HWIMG_SUPPORT 0 + + /* For 88E */ + #define RTL8188EE_HWIMG_SUPPORT 0 + #define RTL8188EU_HWIMG_SUPPORT 0 + #define RTL8188ES_HWIMG_SUPPORT 0 + + #elif (DEV_BUS_TYPE == RT_USB_INTERFACE) + /* For 92C */ + #define RTL8192CE_HWIMG_SUPPORT 0 + #define RTL8192CE_TEST_HWIMG_SUPPORT 0 + #define RTL8192CU_HWIMG_SUPPORT 1 + #define RTL8192CU_TEST_HWIMG_SUPPORT 0 + + /* For 92D */ + #define RTL8192DE_HWIMG_SUPPORT 0 + #define RTL8192DE_TEST_HWIMG_SUPPORT 0 + #define RTL8192DU_HWIMG_SUPPORT 1 + #define RTL8192DU_TEST_HWIMG_SUPPORT 0 + + /* For 8723 */ + #define RTL8723E_HWIMG_SUPPORT 0 + #define RTL8723U_HWIMG_SUPPORT 1 + #define RTL8723S_HWIMG_SUPPORT 0 + + /* For 88E */ + #define RTL8188EE_HWIMG_SUPPORT 0 + #define RTL8188EU_HWIMG_SUPPORT 0 + #define RTL8188ES_HWIMG_SUPPORT 0 + + #elif (DEV_BUS_TYPE == RT_SDIO_INTERFACE) + /* For 92C */ + #define RTL8192CE_HWIMG_SUPPORT 0 + #define RTL8192CE_TEST_HWIMG_SUPPORT 0 + #define RTL8192CU_HWIMG_SUPPORT 1 + #define RTL8192CU_TEST_HWIMG_SUPPORT 0 + + /* For 92D */ + #define RTL8192DE_HWIMG_SUPPORT 0 + #define RTL8192DE_TEST_HWIMG_SUPPORT 0 + #define RTL8192DU_HWIMG_SUPPORT 1 + #define RTL8192DU_TEST_HWIMG_SUPPORT 0 + + /* For 8723 */ + #define RTL8723E_HWIMG_SUPPORT 0 + #define RTL8723U_HWIMG_SUPPORT 0 + #define RTL8723S_HWIMG_SUPPORT 1 + + /* For 88E */ + #define RTL8188EE_HWIMG_SUPPORT 0 + #define RTL8188EU_HWIMG_SUPPORT 0 + #define RTL8188ES_HWIMG_SUPPORT 0 + #endif + +#else /* PLATFORM_WINDOWS & MacOSX */ + + /* For 92C */ + #define RTL8192CE_HWIMG_SUPPORT 1 + #define RTL8192CE_TEST_HWIMG_SUPPORT 1 + #define RTL8192CU_HWIMG_SUPPORT 1 + #define RTL8192CU_TEST_HWIMG_SUPPORT 1 + + /* For 92D */ + #define RTL8192DE_HWIMG_SUPPORT 1 + #define RTL8192DE_TEST_HWIMG_SUPPORT 1 + #define RTL8192DU_HWIMG_SUPPORT 1 + #define RTL8192DU_TEST_HWIMG_SUPPORT 1 + + #if defined(UNDER_CE) + /* For 8723 */ + #define RTL8723E_HWIMG_SUPPORT 0 + #define RTL8723U_HWIMG_SUPPORT 0 + #define RTL8723S_HWIMG_SUPPORT 1 + + /* For 88E */ + #define RTL8188EE_HWIMG_SUPPORT 0 + #define RTL8188EU_HWIMG_SUPPORT 0 + #define RTL8188ES_HWIMG_SUPPORT 0 + + #else + + /* For 8723 */ + #define RTL8723E_HWIMG_SUPPORT 1 + /* #define RTL_8723E_TEST_HWIMG_SUPPORT 1 */ + #define RTL8723U_HWIMG_SUPPORT 1 + /* #define RTL_8723U_TEST_HWIMG_SUPPORT 1 */ + #define RTL8723S_HWIMG_SUPPORT 1 + /* #define RTL_8723S_TEST_HWIMG_SUPPORT 1 */ + + /* For 88E */ + #define RTL8188EE_HWIMG_SUPPORT 1 + #define RTL8188EU_HWIMG_SUPPORT 1 + #define RTL8188ES_HWIMG_SUPPORT 1 + #endif + +#endif + +#endif /* __INC_HW_IMG_H */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.c deleted file mode 100644 index 5fc90d4874c0..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.c +++ /dev/null @@ -1,2790 +0,0 @@ -/****************************************************************************** - * - * 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 "mp_precomp.h" - #include "phydm_precomp.h" - -#ifndef index_mapping_NUM_88E - #define index_mapping_NUM_88E 15 -#endif - -//#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - -#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ - do {\ - for(_offset = 0; _offset < _size; _offset++)\ - {\ - if(_deltaThermal < thermalThreshold[_direction][_offset])\ - {\ - if(_offset != 0)\ - _offset--;\ - break;\ - }\ - } \ - if(_offset >= _size)\ - _offset = _size-1;\ - } while(0) - - -void ConfigureTxpowerTrack( - IN PVOID pDM_VOID, - OUT PTXPWRTRACK_CFG pConfig - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if RTL8812A_SUPPORT -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - //if (IS_HARDWARE_TYPE_8812(pDM_Odm->Adapter)) - if(pDM_Odm->SupportICType==ODM_RTL8812) - ConfigureTxpowerTrack_8812A(pConfig); - //else -#endif -#endif - -#if RTL8814A_SUPPORT - if(pDM_Odm->SupportICType== ODM_RTL8814A) - ConfigureTxpowerTrack_8814A(pConfig); -#endif - - -#if RTL8188E_SUPPORT - if(pDM_Odm->SupportICType==ODM_RTL8188E) - ConfigureTxpowerTrack_8188E(pConfig); -#endif - -#if RTL8197F_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8197F) - ConfigureTxpowerTrack_8197F(pConfig); -#endif - -#if RTL8822B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8822B) - ConfigureTxpowerTrack_8822B(pConfig); -#endif - - -} - -#if (RTL8192E_SUPPORT==1) -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_92E( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte ThermalValue = 0, delta, delta_IQK, delta_LCK, channel, is_decrease, rf_mimo_mode; - u1Byte ThermalValue_AVG_count = 0; - u1Byte OFDM_min_index = 10; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur - s1Byte OFDM_index[2], index ; - u4Byte ThermalValue_AVG = 0, Reg0x18; - u4Byte i = 0, j = 0, rf; - s4Byte value32, CCK_index = 0, ele_A, ele_D, ele_C, X, Y; - prtl8192cd_priv priv = pDM_Odm->priv; - - rf_mimo_mode = pDM_Odm->RFType; - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode)); - -#ifdef MP_TEST - if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { - channel = priv->pshare->working_channel; - if (priv->pshare->mp_txpwr_tracking == FALSE) - return; - } else -#endif - { - channel = (priv->pmib->dot11RFEntry.dot11channel); - } - - ThermalValue = (unsigned char)ODM_GetRFReg(pDM_Odm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); //0x42: RF Reg[15:10] 88E - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); - - - switch (rf_mimo_mode) { - case MIMO_1T1R: - rf = 1; - break; - case MIMO_2T2R: - rf = 2; - break; - default: - rf = 2; - break; - } - - //Query OFDM path A default setting Bit[31:21] - ele_D = PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskOFDM_D); - for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { - if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { - OFDM_index[0] = (unsigned char)i; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathA 0xC80[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[0])); - break; - } - } - - //Query OFDM path B default setting - if (rf_mimo_mode == MIMO_2T2R) { - ele_D = PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskOFDM_D); - for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { - if (ele_D == (OFDMSwingTable_92E[i] >> 22)) { - OFDM_index[1] = (unsigned char)i; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("PathB 0xC88[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[1])); - break; - } - } - } - - /* calculate average thermal meter */ - { - priv->pshare->ThermalValue_AVG_88XX[priv->pshare->ThermalValue_AVG_index_88XX] = ThermalValue; - priv->pshare->ThermalValue_AVG_index_88XX++; - if (priv->pshare->ThermalValue_AVG_index_88XX == AVG_THERMAL_NUM_88XX) - priv->pshare->ThermalValue_AVG_index_88XX = 0; - - for (i = 0; i < AVG_THERMAL_NUM_88XX; i++) { - if (priv->pshare->ThermalValue_AVG_88XX[i]) { - ThermalValue_AVG += priv->pshare->ThermalValue_AVG_88XX[i]; - ThermalValue_AVG_count++; - } - } - - if (ThermalValue_AVG_count) { - ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); - } - } - - /* Initialize */ - if (!priv->pshare->ThermalValue) { - priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; - priv->pshare->ThermalValue_IQK = ThermalValue; - priv->pshare->ThermalValue_LCK = ThermalValue; - } - - if (ThermalValue != priv->pshare->ThermalValue) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); - - delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); - delta_IQK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_IQK); - delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); - is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); - -#ifdef _TRACKING_TABLE_FILE - if (priv->pshare->rf_ft_var.pwr_track_file) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); - - if (is_decrease) { - for (i = 0; i < rf; i++) { - OFDM_index[i] = priv->pshare->OFDM_index0[i] + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); - OFDM_index[i] = ((OFDM_index[i] > (OFDM_TABLE_SIZE_92E- 1)) ? (OFDM_TABLE_SIZE_92E - 1) : OFDM_index[i]); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); - CCK_index = priv->pshare->CCK_index0 + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); - CCK_index = ((CCK_index > (CCK_TABLE_SIZE_92E - 1)) ? (CCK_TABLE_SIZE_92E - 1) : CCK_index); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Decrese power ---> new CCK_INDEX:%d (%d + %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); - } - } else { - for (i = 0; i < rf; i++) { - OFDM_index[i] = priv->pshare->OFDM_index0[i] - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); - OFDM_index[i] = ((OFDM_index[i] < OFDM_min_index) ? OFDM_min_index : OFDM_index[i]); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); - CCK_index = priv->pshare->CCK_index0 - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); - CCK_index = ((CCK_index < 0 )? 0 : CCK_index); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> Increse power ---> new CCK_INDEX:%d (%d - %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); - } - } - } -#endif //CFG_TRACKING_TABLE_FILE - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[0]])); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] = %x \n",OFDMSwingTable_92E[(unsigned int)OFDM_index[1]])); - - //Adujst OFDM Ant_A according to IQK result - ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[0]] & 0xFFC00000) >> 22; - X = priv->pshare->RegE94; - Y = priv->pshare->RegE9C; - - if (X != 0) { - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - ele_A = ((X * ele_D) >> 8) & 0x000003FF; - - //new element C = element D x Y - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - ele_C = ((Y * ele_D) >> 8) & 0x000003FF; - - //wirte new elements A, C, D to regC80 and regC94, element B is always 0 - value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; - PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, value32); - - value32 = (ele_C&0x000003C0)>>6; - PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, value32); - - value32 = ((X * ele_D)>>7)&0x01; - PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), value32); - } else { - PHY_SetBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[0]]); - PHY_SetBBReg(priv, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); - PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(24), 0x00); - } - - set_CCK_swing_index(priv, CCK_index); - - if (rf == 2) { - ele_D = (OFDMSwingTable_92E[(unsigned int)OFDM_index[1]] & 0xFFC00000) >> 22; - X = priv->pshare->RegEB4; - Y = priv->pshare->RegEBC; - - if (X != 0) { - if ((X & 0x00000200) != 0) //consider minus - X = X | 0xFFFFFC00; - ele_A = ((X * ele_D) >> 8) & 0x000003FF; - - //new element C = element D x Y - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - ele_C = ((Y * ele_D) >> 8) & 0x00003FF; - - //wirte new elements A, C, D to regC88 and regC9C, element B is always 0 - value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; - PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, value32); - - value32 = (ele_C & 0x000003C0) >> 6; - PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, value32); - - value32 = ((X * ele_D) >> 7) & 0x01; - PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), value32); - } else { - PHY_SetBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord, OFDMSwingTable_92E[(unsigned int)OFDM_index[1]]); - PHY_SetBBReg(priv, rOFDM0_XDTxAFE, bMaskH4Bits, 0x00); - PHY_SetBBReg(priv, rOFDM0_ECCAThreshold, BIT(28), 0x00); - } - - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc80 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskDWord))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc88 = 0x%x \n", PHY_QueryBBReg(priv, rOFDM0_XBTxIQImbalance, bMaskDWord))); - - if (delta_IQK > 3) { - priv->pshare->ThermalValue_IQK = ThermalValue; -#ifdef MP_TEST - if (!(priv->pshare->rf_ft_var.mp_specific && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) -#endif - PHY_IQCalibrate_8192E(pDM_Odm,false); - } - - if (delta_LCK > 8) { - RTL_W8(0x522, 0xff); - Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); - PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); - PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); - delay_ms(1); - PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); - PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); - RTL_W8(0x522, 0x0); - priv->pshare->ThermalValue_LCK = ThermalValue; - } - } - - //update thermal meter value - priv->pshare->ThermalValue = ThermalValue; - for (i = 0 ; i < rf ; i++) - priv->pshare->OFDM_index[i] = OFDM_index[i]; - priv->pshare->CCK_index = CCK_index; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); -} -#endif - - - -#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ) -{ -#if 1 - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, channel, is_increase; - u1Byte ThermalValue_AVG_count = 0, p = 0, i = 0; - u4Byte ThermalValue_AVG = 0; - prtl8192cd_priv priv = pDM_Odm->priv; - TXPWRTRACK_CFG c; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - /*4 1. The following TWO tables decide the final index of OFDM/CCK swing table.*/ - pu1Byte deltaSwingTableIdx_TUP_A = NULL, deltaSwingTableIdx_TDOWN_A = NULL; - pu1Byte deltaSwingTableIdx_TUP_B = NULL, deltaSwingTableIdx_TDOWN_B = NULL; - pu1Byte deltaSwingTableIdx_TUP_CCK_A = NULL, deltaSwingTableIdx_TDOWN_CCK_A = NULL; - pu1Byte deltaSwingTableIdx_TUP_CCK_B = NULL, deltaSwingTableIdx_TDOWN_CCK_B = NULL; - /*for 8814 add by Yu Chen*/ - pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; - pu1Byte deltaSwingTableIdx_TUP_D = NULL, deltaSwingTableIdx_TDOWN_D = NULL; - pu1Byte deltaSwingTableIdx_TUP_CCK_C = NULL, deltaSwingTableIdx_TDOWN_CCK_C = NULL; - pu1Byte deltaSwingTableIdx_TUP_CCK_D = NULL, deltaSwingTableIdx_TDOWN_CCK_D = NULL; - -#ifdef MP_TEST - if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { - channel = priv->pshare->working_channel; - if (priv->pshare->mp_txpwr_tracking == FALSE) - return; - } else -#endif - { - channel = (priv->pmib->dot11RFEntry.dot11channel); - } - - ConfigureTxpowerTrack(pDM_Odm, &c); - - (*c.GetDeltaAllSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, - (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B, - (pu1Byte *)&deltaSwingTableIdx_TUP_CCK_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_CCK_A, - (pu1Byte *)&deltaSwingTableIdx_TUP_CCK_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_CCK_B); - - ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); /*0x42: RF Reg[15:10] 88E*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Readback Thermal Meter = 0x%x(%d) EEPROMthermalmeter 0x%x(%d)\n" - , ThermalValue, ThermalValue, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); - - /* Initialize */ - if (!pDM_Odm->RFCalibrateInfo.ThermalValue) - pDM_Odm->RFCalibrateInfo.ThermalValue = priv->pmib->dot11RFEntry.ther; - - if (!pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = priv->pmib->dot11RFEntry.ther; - - if (!pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = priv->pmib->dot11RFEntry.ther; - - /* calculate average thermal meter */ - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; - - if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; - - for (i = 0; i < c.AverageThermalNum; i++) { - if (pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) { - ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; - ThermalValue_AVG_count++; - } - } - - if (ThermalValue_AVG_count) {/*Calculate Average ThermalValue after average enough times*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("ThermalValue_AVG=0x%x(%d) ThermalValue_AVG_count = %d\n" - , ThermalValue_AVG, ThermalValue_AVG, ThermalValue_AVG_count)); - - ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("AVG Thermal Meter = 0x%X(%d), EEPROMthermalmeter = 0x%X(%d)\n", ThermalValue, ThermalValue, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); - } - - /*4 Calculate delta, delta_LCK, delta_IQK.*/ - delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); - delta_LCK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_LCK); - delta_IQK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_IQK); - is_increase = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 0 : 1); - - if (delta > 29) { /* power track table index(thermal diff.) upper bound*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta(%d) > 29, set delta to 29\n", delta)); - delta = 29; - } - - - /*4 if necessary, do LCK.*/ - - if (delta_LCK > c.Threshold_IQK) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; - if (c.PHY_LCCalibrate) - (*c.PHY_LCCalibrate)(pDM_Odm); - } - - if (delta_IQK > c.Threshold_IQK) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; - if (c.DoIQK) - (*c.DoIQK)(pDM_Odm, TRUE, 0, 0); - } - - if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ - return; - - /*4 Do Power Tracking*/ - - if (ThermalValue != pDM_Odm->RFCalibrateInfo.ThermalValue) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Readback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", - ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); - -#ifdef _TRACKING_TABLE_FILE - if (priv->pshare->rf_ft_var.pwr_track_file) { - if (is_increase) { /*thermal is higher than base*/ - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_B[%d] = %d deltaSwingTableIdx_TUP_CCK_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta], delta, deltaSwingTableIdx_TUP_CCK_B[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_B[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_C[%d] = %d deltaSwingTableIdx_TUP_CCK_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta], delta, deltaSwingTableIdx_TUP_CCK_C[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_C[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_D[%d] = %d deltaSwingTableIdx_TUP_CCK_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta], delta, deltaSwingTableIdx_TUP_CCK_D[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_D[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_A[%d] = %d deltaSwingTableIdx_TUP_CCK_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta], delta, deltaSwingTableIdx_TUP_CCK_A[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = deltaSwingTableIdx_TUP_CCK_A[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - } - } - } else { /* thermal is lower than base*/ - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_B[%d] = %d deltaSwingTableIdx_TDOWN_CCK_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta], delta, deltaSwingTableIdx_TDOWN_CCK_B[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_B[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_C[%d] = %d deltaSwingTableIdx_TDOWN_CCK_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta], delta, deltaSwingTableIdx_TDOWN_CCK_C[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_C[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_D[%d] = %d deltaSwingTableIdx_TDOWN_CCK_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta], delta, deltaSwingTableIdx_TDOWN_CCK_D[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_D[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_A[%d] = %d deltaSwingTableIdx_TDOWN_CCK_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta], delta, deltaSwingTableIdx_TDOWN_CCK_A[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; - pRFCalibrateInfo->Absolute_CCKSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_CCK_A[delta]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRF->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d pRF->Absolute_CCKSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p], pRFCalibrateInfo->Absolute_CCKSwingIdx[p])); - break; - } - } - } - - if (is_increase) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> increse power --->\n")); - if (GET_CHIP_VER(priv) == VERSION_8197F) { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, 0); - } else if (GET_CHIP_VER(priv) == VERSION_8822B) { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power --->\n")); - if (GET_CHIP_VER(priv) == VERSION_8197F) { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, 0); - } else if (GET_CHIP_VER(priv) == VERSION_8822B) { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } - } - } -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n\n", __func__)); - /*update thermal meter value*/ - pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; - - } - -#endif -} -#endif - -/*#if (RTL8814A_SUPPORT == 1)*/ -#if (RTL8814A_SUPPORT == 1) - -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, channel, is_increase; - u1Byte ThermalValue_AVG_count = 0, p = 0, i = 0; - u4Byte ThermalValue_AVG = 0, Reg0x18; - u4Byte BBSwingReg[4] = {rA_TxScale_Jaguar,rB_TxScale_Jaguar,rC_TxScale_Jaguar2,rD_TxScale_Jaguar2}; - s4Byte ele_D; - u4Byte BBswingIdx; - prtl8192cd_priv priv = pDM_Odm->priv; - TXPWRTRACK_CFG c; - BOOLEAN bTSSIenable = FALSE; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. - pu1Byte deltaSwingTableIdx_TUP_A = NULL, deltaSwingTableIdx_TDOWN_A = NULL; - pu1Byte deltaSwingTableIdx_TUP_B = NULL, deltaSwingTableIdx_TDOWN_B = NULL; - //for 8814 add by Yu Chen - pu1Byte deltaSwingTableIdx_TUP_C = NULL, deltaSwingTableIdx_TDOWN_C = NULL; - pu1Byte deltaSwingTableIdx_TUP_D = NULL, deltaSwingTableIdx_TDOWN_D = NULL; - -#ifdef MP_TEST - if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { - channel = priv->pshare->working_channel; - if (priv->pshare->mp_txpwr_tracking == FALSE) - return; - } else -#endif - { - channel = (priv->pmib->dot11RFEntry.dot11channel); - } - - ConfigureTxpowerTrack(pDM_Odm, &c); - pRFCalibrateInfo->DefaultOfdmIndex = priv->pshare->OFDM_index0[ODM_RF_PATH_A]; - - (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_A, (pu1Byte*)&deltaSwingTableIdx_TDOWN_A, - (pu1Byte*)&deltaSwingTableIdx_TUP_B, (pu1Byte*)&deltaSwingTableIdx_TDOWN_B); - - if(pDM_Odm->SupportICType & ODM_RTL8814A) // for 8814 path C & D - (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte*)&deltaSwingTableIdx_TUP_C, (pu1Byte*)&deltaSwingTableIdx_TDOWN_C, - (pu1Byte*)&deltaSwingTableIdx_TUP_D, (pu1Byte*)&deltaSwingTableIdx_TDOWN_D); - - ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); - - /* Initialize */ - if (!pDM_Odm->RFCalibrateInfo.ThermalValue) { - pDM_Odm->RFCalibrateInfo.ThermalValue = priv->pmib->dot11RFEntry.ther; - } - - if (!pDM_Odm->RFCalibrateInfo.ThermalValue_LCK) { - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = priv->pmib->dot11RFEntry.ther; - } - - if (!pDM_Odm->RFCalibrateInfo.ThermalValue_IQK) { - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = priv->pmib->dot11RFEntry.ther; - } - - bTSSIenable = (BOOLEAN)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, rRF_TxGainOffset, BIT7); // check TSSI enable - - //4 Query OFDM BB swing default setting Bit[31:21] - for(p = ODM_RF_PATH_A ; p < c.RfPathCount ; p++) - { - ele_D = ODM_GetBBReg(pDM_Odm, BBSwingReg[p], 0xffe00000); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("0x%x:0x%x ([31:21] = 0x%x)\n", BBSwingReg[p], ODM_GetBBReg(pDM_Odm, BBSwingReg[p], bMaskDWord), ele_D)); - - for (BBswingIdx = 0; BBswingIdx < TXSCALE_TABLE_SIZE; BBswingIdx++) {//4 - if (ele_D == TxScalingTable_Jaguar[BBswingIdx]) { - pDM_Odm->RFCalibrateInfo.OFDM_index[p] = (u1Byte)BBswingIdx; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("OFDM_index[%d]=%d\n",p, pDM_Odm->RFCalibrateInfo.OFDM_index[p])); - break; - } - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("KfreeOffset[%d]=%d\n",p, pRFCalibrateInfo->KfreeOffset[p])); - - } - - /* calculate average thermal meter */ - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; - if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) //Average times = c.AverageThermalNum - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; - - for(i = 0; i < c.AverageThermalNum; i++) - { - if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) - { - ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; - ThermalValue_AVG_count++; - } - } - - if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times - { - ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("AVG Thermal Meter = 0x%X, EEPROMthermalmeter = 0x%X\n", ThermalValue, priv->pmib->dot11RFEntry.ther)); - } - - //4 Calculate delta, delta_LCK, delta_IQK. - delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); - delta_LCK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_LCK); - delta_IQK = RTL_ABS(ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue_IQK); - is_increase = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 0 : 1); - - //4 if necessary, do LCK. - if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { - if (delta_LCK > c.Threshold_IQK) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; - - /*Use RTLCK, so close power tracking driver LCK*/ - #if (RTL8814A_SUPPORT != 1) - if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { - if (c.PHY_LCCalibrate) - (*c.PHY_LCCalibrate)(pDM_Odm); - } - #endif - } - } - - if (delta_IQK > c.Threshold_IQK) - { - panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; - if(c.DoIQK) - (*c.DoIQK)(pDM_Odm, TRUE, 0, 0); - } - - if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ - return; - - //4 Do Power Tracking - - if(bTSSIenable == TRUE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("**********Enter PURE TSSI MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); - } - else if (ThermalValue != pDM_Odm->RFCalibrateInfo.ThermalValue) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue, priv->pmib->dot11RFEntry.ther)); - -#ifdef _TRACKING_TABLE_FILE - if (priv->pshare->rf_ft_var.pwr_track_file) - { - if (is_increase) // thermal is higher than base - { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - { - switch(p) - { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - } - } - } - else // thermal is lower than base - { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - { - switch(p) - { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; // Record delta swing for mix mode power tracking - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pDM_Odm->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - } - } - } - - if (is_increase) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> \n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power --->\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } - } -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); - //update thermal meter value - pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; - - } -} -#endif - -#if (RTL8812A_SUPPORT == 1 || RTL8881A_SUPPORT == 1) -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - unsigned char ThermalValue = 0, delta, delta_LCK, channel, is_decrease; - unsigned char ThermalValue_AVG_count = 0; - unsigned int ThermalValue_AVG = 0, Reg0x18; - unsigned int BBSwingReg[4]={0xc1c,0xe1c,0x181c,0x1a1c}; - int ele_D, value32; - char OFDM_index[2], index; - unsigned int i = 0, j = 0, rf_path, max_rf_path =2 ,rf; - prtl8192cd_priv priv = pDM_Odm->priv; - unsigned char OFDM_min_index = 7; //OFDM BB Swing should be less than +2.5dB, which is required by Arthur and Mimic - - - -#ifdef MP_TEST - if ((OPMODE & WIFI_MP_STATE) || priv->pshare->rf_ft_var.mp_specific) { - channel = priv->pshare->working_channel; - if (priv->pshare->mp_txpwr_tracking == FALSE) - return; - } else -#endif - { - channel = (priv->pmib->dot11RFEntry.dot11channel); - } - -#if RTL8881A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8881A) { - max_rf_path = 1; - if ((get_bonding_type_8881A() == BOND_8881AM ||get_bonding_type_8881A() == BOND_8881AN) - && priv->pshare->rf_ft_var.use_intpa8881A && (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G)) - OFDM_min_index = 6; // intPA - upper bond set to +3 dB (base: -2 dB)ot11RFEntry.phyBandSelect == PHY_BAND_2G)) - else - OFDM_min_index = 10; //OFDM BB Swing should be less than +1dB, which is required by Arthur and Mimic - } -#endif - - - ThermalValue = (unsigned char)PHY_QueryRFReg(priv, RF_PATH_A, 0x42, 0xfc00, 1); //0x42: RF Reg[15:10] 88E - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); - - - //4 Query OFDM BB swing default setting Bit[31:21] - for(rf_path = 0 ; rf_path < max_rf_path ; rf_path++){ - ele_D = PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0x%x:0x%x ([31:21] = 0x%x)\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], bMaskDWord),ele_D)); - for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 - if (ele_D == OFDMSwingTable_8812[i]) { - OFDM_index[rf_path] = (unsigned char)i; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[%d]=%d\n",rf_path, OFDM_index[rf_path])); - break; - } - } - } -#if 0 - //Query OFDM path A default setting Bit[31:21] - ele_D = PHY_QueryBBReg(priv, 0xc1c, 0xffe00000); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xc1c:0x%x ([31:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xc1c, bMaskDWord),ele_D)); - for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {//4 - if (ele_D == OFDMSwingTable_8812[i]) { - OFDM_index[0] = (unsigned char)i; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[0]=%d\n", OFDM_index[0])); - break; - } - } - //Query OFDM path B default setting - if (rf == 2) { - ele_D = PHY_QueryBBReg(priv, 0xe1c, 0xffe00000); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("0xe1c:0x%x ([32:21] = 0x%x)\n", PHY_QueryBBReg(priv, 0xe1c, bMaskDWord),ele_D)); - for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) { - if (ele_D == OFDMSwingTable_8812[i]) { - OFDM_index[1] = (unsigned char)i; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("OFDM_index[1]=%d\n", OFDM_index[1])); - break; - } - } - } -#endif - /* Initialize */ - if (!priv->pshare->ThermalValue) { - priv->pshare->ThermalValue = priv->pmib->dot11RFEntry.ther; - priv->pshare->ThermalValue_LCK = ThermalValue; - } - - /* calculate average thermal meter */ - { - priv->pshare->ThermalValue_AVG_8812[priv->pshare->ThermalValue_AVG_index_8812] = ThermalValue; - priv->pshare->ThermalValue_AVG_index_8812++; - if (priv->pshare->ThermalValue_AVG_index_8812 == AVG_THERMAL_NUM_8812) - priv->pshare->ThermalValue_AVG_index_8812 = 0; - - for (i = 0; i < AVG_THERMAL_NUM_8812; i++) { - if (priv->pshare->ThermalValue_AVG_8812[i]) { - ThermalValue_AVG += priv->pshare->ThermalValue_AVG_8812[i]; - ThermalValue_AVG_count++; - } - } - - if (ThermalValue_AVG_count) { - ThermalValue = (unsigned char)(ThermalValue_AVG / ThermalValue_AVG_count); - //printk("AVG Thermal Meter = 0x%x \n", ThermalValue); - } - } - - - //4 If necessary, do power tracking - - if(!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ - return; - - if (ThermalValue != priv->pshare->ThermalValue) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** START POWER TRACKING ********\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", ThermalValue, priv->pshare->ThermalValue, priv->pmib->dot11RFEntry.ther)); - delta = RTL_ABS(ThermalValue, priv->pmib->dot11RFEntry.ther); - delta_LCK = RTL_ABS(ThermalValue, priv->pshare->ThermalValue_LCK); - is_decrease = ((ThermalValue < priv->pmib->dot11RFEntry.ther) ? 1 : 0); - //if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) - { -#ifdef _TRACKING_TABLE_FILE - if (priv->pshare->rf_ft_var.pwr_track_file) { - for (rf_path = 0; rf_path < max_rf_path; rf_path++) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Diff: (%s)%d ==> get index from table : %d)\n", (is_decrease?"-":"+"), delta, get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); - if (is_decrease) { - OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] + get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); - OFDM_index[rf_path] = ((OFDM_index[rf_path] > (OFDM_TABLE_SIZE_8812 - 1)) ? (OFDM_TABLE_SIZE_8812 - 1) : OFDM_index[rf_path]); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); -#if 0// RTL8881A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8881A){ - if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ - if(priv->pshare->AddTxAGC){//TxAGC has been added - AddTxPower88XX_AC(priv,0); - priv->pshare->AddTxAGC = 0; - priv->pshare->AddTxAGC_index = 0; - } - } - } -#endif - } else { - - OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] - get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); -#if 0// RTL8881A_SUPPORT - if(pDM_Odm->SupportICType == ODM_RTL8881A){ - if(priv->pshare->rf_ft_var.pwrtrk_TxAGC_enable){ - if(OFDM_index[i] < OFDM_min_index){ - priv->pshare->AddTxAGC_index = (OFDM_min_index - OFDM_index[i])/2; // Calculate Remnant TxAGC Value, 2 index for 1 TxAGC - AddTxPower88XX_AC(priv,priv->pshare->AddTxAGC_index); - priv->pshare->AddTxAGC = 1; //AddTxAGC Flag = 1 - OFDM_index[i] = OFDM_min_index; - } - else{ - if(priv->pshare->AddTxAGC){// TxAGC been added - priv->pshare->AddTxAGC = 0; - priv->pshare->AddTxAGC_index = 0; - AddTxPower88XX_AC(priv,0); //minus the added TPI - } - } - } - } -#else - OFDM_index[rf_path] = ((OFDM_index[rf_path] < OFDM_min_index) ? OFDM_min_index : OFDM_index[rf_path]); -#endif - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,(">>> increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); - } - } - } -#endif - //4 Set new BB swing index - for (rf_path = 0; rf_path < max_rf_path; rf_path++) { - PHY_SetBBReg(priv, BBSwingReg[rf_path], 0xffe00000, OFDMSwingTable_8812[(unsigned int)OFDM_index[rf_path]]); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Readback 0x%x[31:21] = 0x%x, OFDM_index:%d\n",BBSwingReg[rf_path], PHY_QueryBBReg(priv, BBSwingReg[rf_path], 0xffe00000), OFDM_index[rf_path])); - } - - } - if (delta_LCK > 8) { - RTL_W8(0x522, 0xff); - Reg0x18 = PHY_QueryRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, 1); - PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 1); - PHY_SetRFReg(priv, RF_PATH_A, 0x18, BIT(15), 1); - delay_ms(200); // frequency deviation - PHY_SetRFReg(priv, RF_PATH_A, 0xB4, BIT(14), 0); - PHY_SetRFReg(priv, RF_PATH_A, 0x18, bMask20Bits, Reg0x18); - #ifdef CONFIG_RTL_8812_SUPPORT - if (GET_CHIP_VER(priv)== VERSION_8812E) - UpdateBBRFVal8812(priv, priv->pmib->dot11RFEntry.dot11channel); - #endif - RTL_W8(0x522, 0x0); - priv->pshare->ThermalValue_LCK = ThermalValue; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("\n******** END:%s() ********\n", __FUNCTION__)); - - //update thermal meter value - priv->pshare->ThermalValue = ThermalValue; - for (rf_path = 0; rf_path < max_rf_path; rf_path++) - priv->pshare->OFDM_index[rf_path] = OFDM_index[rf_path]; - } -} - -#endif - - -VOID -ODM_TXPowerTrackingCallback_ThermalMeter( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - -#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8197F || pDM_Odm->SupportICType == ODM_RTL8822B) { - ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3(pDM_Odm); - return; - } -#endif -#if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/ - if (pDM_Odm->SupportICType & ODM_RTL8814A) { - ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2(pDM_Odm); - return; - } -#endif -#if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8812 || pDM_Odm->SupportICType & ODM_RTL8881A) { - ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries(pDM_Odm); - return; - } -#endif - -#if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType==ODM_RTL8192E) { - ODM_TXPowerTrackingCallback_ThermalMeter_92E(pDM_Odm); - return; - } -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - //PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; -#endif - - - u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, offset; - u1Byte ThermalValue_AVG_count = 0; - u4Byte ThermalValue_AVG = 0; -// s4Byte ele_A=0, ele_D, TempCCk, X, value32; -// s4Byte Y, ele_C=0; -// s1Byte OFDM_index[2], CCK_index=0, OFDM_index_old[2]={0,0}, CCK_index_old=0, index; -// s1Byte deltaPowerIndex = 0; - u4Byte i = 0;//, j = 0; - BOOLEAN is2T = FALSE; -// BOOLEAN bInteralPA = FALSE; - - u1Byte OFDM_max_index = 34, rf = (is2T) ? 2 : 1; //OFDM BB Swing should be less than +3.0dB, which is required by Arthur - u1Byte Indexforchannel = 0;/*GetRightChnlPlaceforIQK(pHalData->CurrentChannel)*/ - enum _POWER_DEC_INC { POWER_DEC, POWER_INC }; - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif - - TXPWRTRACK_CFG c; - - - //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. - s1Byte deltaSwingTableIdx[2][index_mapping_NUM_88E] = { - // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} - {0,0,2,3,4,4,5,6,7,7,8,9,10,10,11}, {0,0,1,2,3,4,4,4,4,5,7,8,9,9,10} - }; - u1Byte thermalThreshold[2][index_mapping_NUM_88E]={ - // {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} - {0,2,4,6,8,10,12,14,16,18,20,22,24,26,27}, {0,2,4,6,8,10,12,14,16,18,20,22,25,25,25} - }; - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - prtl8192cd_priv priv = pDM_Odm->priv; -#endif - - //4 2. Initilization ( 7 steps in total ) - - ConfigureTxpowerTrack(pDM_Odm, &c); - - pDM_Odm->RFCalibrateInfo.TXPowerTrackingCallbackCnt++; //cosa add for debug - pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = TRUE; - -#if (MP_DRIVER == 1) - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = pHalData->TxPowerTrackControl; // We should keep updating the control variable according to HalData. - // RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. - pDM_Odm->RFCalibrateInfo.RegA24 = 0x090e1317; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) - if ((OPMODE & WIFI_MP_STATE) || pDM_Odm->priv->pshare->rf_ft_var.mp_specific) { - if(pDM_Odm->priv->pshare->mp_txpwr_tracking == FALSE) - return; - } -#endif - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>odm_TXPowerTrackingCallback_ThermalMeter_8188E, pDM_Odm->BbSwingIdxCckBase: %d, pDM_Odm->BbSwingIdxOfdmBase: %d \n", pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase)); -/* - if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { - ODM_SetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, BIT17 | BIT16, 0x3); - pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; - return; - } -*/ - ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if( ! ThermalValue || ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -#else - if( ! pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) -#endif - return; - - //4 3. Initialize ThermalValues of RFCalibrateInfo - - if( ! pDM_Odm->RFCalibrateInfo.ThermalValue) - { - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK = ThermalValue; - } - - if(pDM_Odm->RFCalibrateInfo.bReloadtxpowerindex) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); - } - - //4 4. Calculate average thermal meter - - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index] = ThermalValue; - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index++; - if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index == c.AverageThermalNum) - pDM_Odm->RFCalibrateInfo.ThermalValue_AVG_index = 0; - - for(i = 0; i < c.AverageThermalNum; i++) - { - if(pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]) - { - ThermalValue_AVG += pDM_Odm->RFCalibrateInfo.ThermalValue_AVG[i]; - ThermalValue_AVG_count++; - } - } - - if(ThermalValue_AVG_count) - { - // Give the new thermo value a weighting - ThermalValue_AVG += (ThermalValue*4); - - ThermalValue = (u1Byte)(ThermalValue_AVG / (ThermalValue_AVG_count+4)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("AVG Thermal Meter = 0x%x \n", ThermalValue)); - } - - //4 5. Calculate delta, delta_LCK, delta_IQK. - - delta = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue):(pDM_Odm->RFCalibrateInfo.ThermalValue - ThermalValue); - delta_LCK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_LCK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK):(pDM_Odm->RFCalibrateInfo.ThermalValue_LCK - ThermalValue); - delta_IQK = (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue_IQK)?(ThermalValue - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK):(pDM_Odm->RFCalibrateInfo.ThermalValue_IQK - ThermalValue); - - //4 6. If necessary, do LCK. - if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { - /*if((delta_LCK > pHalData->Delta_LCK) && (pHalData->Delta_LCK != 0))*/ - if (delta_LCK >= c.Threshold_IQK) { - /*Delta temperature is equal to or larger than 20 centigrade.*/ - pDM_Odm->RFCalibrateInfo.ThermalValue_LCK = ThermalValue; - (*c.PHY_LCCalibrate)(pDM_Odm); - } - } - - //3 7. If necessary, move the index of swing table to adjust Tx power. - - if (delta > 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) - { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -#else - delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -#endif - - - //4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(ThermalValue > pHalData->EEPROMThermalMeter) { -#else - if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -#endif - CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; - pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = deltaSwingTableIdx[POWER_INC][offset]; - - } else { - - CALCULATE_SWINGTALBE_OFFSET(offset, POWER_DEC, index_mapping_NUM_88E, delta); - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex; - pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = (-1)*deltaSwingTableIdx[POWER_DEC][offset]; - } - - if (pDM_Odm->RFCalibrateInfo.DeltaPowerIndex == pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast) - pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; - else - pDM_Odm->RFCalibrateInfo.PowerIndexOffset = pDM_Odm->RFCalibrateInfo.DeltaPowerIndex - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast; - - for(i = 0; i < rf; i++) - pDM_Odm->RFCalibrateInfo.OFDM_index[i] = pRFCalibrateInfo->BbSwingIdxOfdmBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; - pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pDM_Odm->RFCalibrateInfo.PowerIndexOffset; - - pRFCalibrateInfo->BbSwingIdxCck = pDM_Odm->RFCalibrateInfo.CCK_index; - pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A] = pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A]; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("The 'OFDM' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase, pDM_Odm->RFCalibrateInfo.PowerIndexOffset)); - - //4 7.1 Handle boundary conditions of index. - - - for(i = 0; i < rf; i++) - { - if(pDM_Odm->RFCalibrateInfo.OFDM_index[i] > OFDM_max_index) - { - pDM_Odm->RFCalibrateInfo.OFDM_index[i] = OFDM_max_index; - } - else if (pDM_Odm->RFCalibrateInfo.OFDM_index[i] < 0) - { - pDM_Odm->RFCalibrateInfo.OFDM_index[i] = 0; - } - } - - if(pDM_Odm->RFCalibrateInfo.CCK_index > c.SwingTableSize_CCK-1) - pDM_Odm->RFCalibrateInfo.CCK_index = c.SwingTableSize_CCK-1; - else if (pDM_Odm->RFCalibrateInfo.CCK_index < 0) - pDM_Odm->RFCalibrateInfo.CCK_index = 0; - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The thermal meter is unchanged or TxPowerTracking OFF: ThermalValue: %d , pDM_Odm->RFCalibrateInfo.ThermalValue: %d)\n", ThermalValue, pDM_Odm->RFCalibrateInfo.ThermalValue)); - pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index: %d\n", pDM_Odm->RFCalibrateInfo.OFDM_index[RF_PATH_A], pRFCalibrateInfo->BbSwingIdxOfdmBase)); - - if (pDM_Odm->RFCalibrateInfo.PowerIndexOffset != 0 && pDM_Odm->RFCalibrateInfo.TxPowerTrackControl) - { - //4 7.2 Configure the Swing Table to adjust Tx Power. - - pDM_Odm->RFCalibrateInfo.bTxPowerChanged = TRUE; // Always TRUE after Tx Power is adjusted by power tracking. - // - // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital - // to increase TX power. Otherwise, EVM will be bad. - // - // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. - if (ThermalValue > pDM_Odm->RFCalibrateInfo.ThermalValue) - { - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - // ("Temperature Increasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", - // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); - } - else if (ThermalValue < pDM_Odm->RFCalibrateInfo.ThermalValue)// Low temperature - { - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - // ("Temperature Decreasing: delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", - // pDM_Odm->RFCalibrateInfo.PowerIndexOffset, delta, ThermalValue, pHalData->EEPROMThermalMeter, pDM_Odm->RFCalibrateInfo.ThermalValue)); - } -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (ThermalValue > pHalData->EEPROMThermalMeter) -#else - if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -#endif - { -// ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) hugher than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TXAGC, 0, 0); - } - else - { - // ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) lower than PG value(%d), increases the power by TxAGC\n", ThermalValue, pHalData->EEPROMThermalMeter)); - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_A, Indexforchannel); - if(is2T) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, RF_PATH_B, Indexforchannel); - } - - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; - pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->BbSwingIdxOfdm[RF_PATH_A]; - pDM_Odm->RFCalibrateInfo.ThermalValue = ThermalValue; - - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - // if((delta_IQK > pHalData->Delta_IQK) && (pHalData->Delta_IQK != 0)) - if ((delta_IQK >= 8)) // Delta temperature is equal to or larger than 20 centigrade. - (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n")); - - pDM_Odm->RFCalibrateInfo.TXPowercount = 0; -} - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - -VOID -phy_PathAStandBy( - IN PADAPTER pAdapter - ) -{ - RTPRINT(FINIT, INIT_IQK, ("Path-A standby mode!\n")); - - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x0); - PHY_SetBBReg(pAdapter, 0x840, bMaskDWord, 0x00010000); - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); -} - -//1 7. IQK -//#define MAX_TOLERANCE 5 -//#define IQK_DELAY_TIME 1 //ms - -u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -phy_PathA_IQK_8192C( - IN PADAPTER pAdapter, - IN BOOLEAN configPathB - ) -{ - - u4Byte regEAC, regE94, regE9C, regEA4; - u1Byte result = 0x00; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - RTPRINT(FINIT, INIT_IQK, ("Path A IQK!\n")); - - //path-A IQK setting - RTPRINT(FINIT, INIT_IQK, ("Path-A IQK setting!\n")); - if(pAdapter->interfaceIndex == 0) - { - PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c1f); - PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); - } - else - { - PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x10008c22); - PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x10008c22); - } - - PHY_SetBBReg(pAdapter, rTx_IQK_PI_A, bMaskDWord, 0x82140102); - - PHY_SetBBReg(pAdapter, rRx_IQK_PI_A, bMaskDWord, configPathB ? 0x28160202 : - IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)?0x28160202:0x28160502); - - //path-B IQK setting - if(configPathB) - { - PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x10008c22); - PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x10008c22); - PHY_SetBBReg(pAdapter, rTx_IQK_PI_B, bMaskDWord, 0x82140102); - PHY_SetBBReg(pAdapter, rRx_IQK_PI_B, bMaskDWord, 0x28160202); - } - - //LO calibration setting - RTPRINT(FINIT, INIT_IQK, ("LO calibration setting!\n")); - PHY_SetBBReg(pAdapter, rIQK_AGC_Rsp, bMaskDWord, 0x001028d1); - - //One shot, path A LOK & IQK - RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); - PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); - PHY_SetBBReg(pAdapter, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - // delay x ms - RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path A LOK & IQK.\n", IQK_DELAY_TIME)); - PlatformStallExecution(IQK_DELAY_TIME*1000); - - // Check failed - regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); - regE94 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xe94 = 0x%x\n", regE94)); - regE9C= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xe9c = 0x%x\n", regE9C)); - regEA4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xea4 = 0x%x\n", regEA4)); - - if(!(regEAC & BIT28) && - (((regE94 & 0x03FF0000)>>16) != 0x142) && - (((regE9C & 0x03FF0000)>>16) != 0x42) ) - result |= 0x01; - else //if Tx not OK, ignore Rx - return result; - - if(!(regEAC & BIT27) && //if Tx is OK, check whether Rx is OK - (((regEA4 & 0x03FF0000)>>16) != 0x132) && - (((regEAC & 0x03FF0000)>>16) != 0x36)) - result |= 0x02; - else - RTPRINT(FINIT, INIT_IQK, ("Path A Rx IQK fail!!\n")); - - return result; - - -} - -u1Byte //bit0 = 1 => Tx OK, bit1 = 1 => Rx OK -phy_PathB_IQK_8192C( - IN PADAPTER pAdapter - ) -{ - u4Byte regEAC, regEB4, regEBC, regEC4, regECC; - u1Byte result = 0x00; - RTPRINT(FINIT, INIT_IQK, ("Path B IQK!\n")); - - //One shot, path B LOK & IQK - RTPRINT(FINIT, INIT_IQK, ("One shot, path A LOK & IQK!\n")); - PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000002); - PHY_SetBBReg(pAdapter, rIQK_AGC_Cont, bMaskDWord, 0x00000000); - - // delay x ms - RTPRINT(FINIT, INIT_IQK, ("Delay %d ms for One shot, path B LOK & IQK.\n", IQK_DELAY_TIME)); - PlatformStallExecution(IQK_DELAY_TIME*1000); - - // Check failed - regEAC = PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xeac = 0x%x\n", regEAC)); - regEB4 = PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xeb4 = 0x%x\n", regEB4)); - regEBC= PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xebc = 0x%x\n", regEBC)); - regEC4= PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xec4 = 0x%x\n", regEC4)); - regECC= PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord); - RTPRINT(FINIT, INIT_IQK, ("0xecc = 0x%x\n", regECC)); - - if(!(regEAC & BIT31) && - (((regEB4 & 0x03FF0000)>>16) != 0x142) && - (((regEBC & 0x03FF0000)>>16) != 0x42)) - result |= 0x01; - else - return result; - - if(!(regEAC & BIT30) && - (((regEC4 & 0x03FF0000)>>16) != 0x132) && - (((regECC & 0x03FF0000)>>16) != 0x36)) - result |= 0x02; - else - RTPRINT(FINIT, INIT_IQK, ("Path B Rx IQK fail!!\n")); - - - return result; - -} - -VOID -phy_PathAFillIQKMatrix( - IN PADAPTER pAdapter, - IN BOOLEAN bIQKOK, - IN s4Byte result[][8], - IN u1Byte final_candidate, - IN BOOLEAN bTxOnly - ) -{ - u4Byte Oldval_0, X, TX0_A, reg; - s4Byte Y, TX0_C; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - RTPRINT(FINIT, INIT_IQK, ("Path A IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); - - if(final_candidate == 0xFF) - return; - - else if(bIQKOK) - { - Oldval_0 = (PHY_QueryBBReg(pAdapter, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; - - X = result[final_candidate][0]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX0_A = (X * Oldval_0) >> 8; - RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); - PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x3FF, TX0_A); - PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(31), ((X * Oldval_0>>7) & 0x1)); - - Y = result[final_candidate][1]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - //path B IQK result + 3 - if(pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G) - Y += 3; - - TX0_C = (Y * Oldval_0) >> 8; - RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX = 0x%x\n", Y, TX0_C)); - PHY_SetBBReg(pAdapter, rOFDM0_XCTxAFE, 0xF0000000, ((TX0_C&0x3C0)>>6)); - PHY_SetBBReg(pAdapter, rOFDM0_XATxIQImbalance, 0x003F0000, (TX0_C&0x3F)); - PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(29), ((Y * Oldval_0>>7) & 0x1)); - - if(bTxOnly) - { - RTPRINT(FINIT, INIT_IQK, ("phy_PathAFillIQKMatrix only Tx OK\n")); - return; - } - - reg = result[final_candidate][2]; - PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0x3FF, reg); - - reg = result[final_candidate][3] & 0x3F; - PHY_SetBBReg(pAdapter, rOFDM0_XARxIQImbalance, 0xFC00, reg); - - reg = (result[final_candidate][3] >> 6) & 0xF; - PHY_SetBBReg(pAdapter, rOFDM0_RxIQExtAnta, 0xF0000000, reg); - } -} - -VOID -phy_PathBFillIQKMatrix( - IN PADAPTER pAdapter, - IN BOOLEAN bIQKOK, - IN s4Byte result[][8], - IN u1Byte final_candidate, - IN BOOLEAN bTxOnly //do Tx only - ) -{ - u4Byte Oldval_1, X, TX1_A, reg; - s4Byte Y, TX1_C; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - RTPRINT(FINIT, INIT_IQK, ("Path B IQ Calibration %s !\n",(bIQKOK)?"Success":"Failed")); - - if(final_candidate == 0xFF) - return; - - else if(bIQKOK) - { - Oldval_1 = (PHY_QueryBBReg(pAdapter, rOFDM0_XBTxIQImbalance, bMaskDWord) >> 22) & 0x3FF; - - X = result[final_candidate][4]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX1_A = (X * Oldval_1) >> 8; - RTPRINT(FINIT, INIT_IQK, ("X = 0x%x, TX1_A = 0x%x\n", X, TX1_A)); - PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x3FF, TX1_A); - PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(27), ((X * Oldval_1>>7) & 0x1)); - - Y = result[final_candidate][5]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - if(pHalData->CurrentBandType == BAND_ON_5G) - Y += 3; //temp modify for preformance - TX1_C = (Y * Oldval_1) >> 8; - RTPRINT(FINIT, INIT_IQK, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); - PHY_SetBBReg(pAdapter, rOFDM0_XDTxAFE, 0xF0000000, ((TX1_C&0x3C0)>>6)); - PHY_SetBBReg(pAdapter, rOFDM0_XBTxIQImbalance, 0x003F0000, (TX1_C&0x3F)); - PHY_SetBBReg(pAdapter, rOFDM0_ECCAThreshold, BIT(25), ((Y * Oldval_1>>7) & 0x1)); - - if(bTxOnly) - return; - - reg = result[final_candidate][6]; - PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0x3FF, reg); - - reg = result[final_candidate][7] & 0x3F; - PHY_SetBBReg(pAdapter, rOFDM0_XBRxIQImbalance, 0xFC00, reg); - - reg = (result[final_candidate][7] >> 6) & 0xF; - PHY_SetBBReg(pAdapter, rOFDM0_AGCRSSITable, 0x0000F000, reg); - } -} - - -BOOLEAN -phy_SimularityCompare_92C( - IN PADAPTER pAdapter, - IN s4Byte result[][8], - IN u1Byte c1, - IN u1Byte c2 - ) -{ - u4Byte i, j, diff, SimularityBitMap, bound = 0; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u1Byte final_candidate[2] = {0xFF, 0xFF}; //for path A and path B - BOOLEAN bResult = TRUE, is2T = IS_92C_SERIAL( pHalData->VersionID); - - if(is2T) - bound = 8; - else - bound = 4; - - SimularityBitMap = 0; - - for( i = 0; i < bound; i++ ) - { - diff = (result[c1][i] > result[c2][i]) ? (result[c1][i] - result[c2][i]) : (result[c2][i] - result[c1][i]); - if (diff > MAX_TOLERANCE) - { - if((i == 2 || i == 6) && !SimularityBitMap) - { - if(result[c1][i]+result[c1][i+1] == 0) - final_candidate[(i/4)] = c2; - else if (result[c2][i]+result[c2][i+1] == 0) - final_candidate[(i/4)] = c1; - else - SimularityBitMap = SimularityBitMap|(1< do IQK again -*/ -BOOLEAN -phy_SimularityCompare( - IN PADAPTER pAdapter, - IN s4Byte result[][8], - IN u1Byte c1, - IN u1Byte c2 - ) -{ - return phy_SimularityCompare_92C(pAdapter, result, c1, c2); - -} - -VOID -phy_IQCalibrate_8192C( - IN PADAPTER pAdapter, - IN s4Byte result[][8], - IN u1Byte t, - IN BOOLEAN is2T - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u4Byte i; - u1Byte PathAOK, PathBOK; - u4Byte ADDA_REG[IQK_ADDA_REG_NUM] = { - rFPGA0_XCD_SwitchControl, rBlue_Tooth, - rRx_Wait_CCA, rTx_CCK_RFON, - rTx_CCK_BBON, rTx_OFDM_RFON, - rTx_OFDM_BBON, rTx_To_Rx, - rTx_To_Tx, rRx_CCK, - rRx_OFDM, rRx_Wait_RIFS, - rRx_TO_Rx, rStandby, - rSleep, rPMPD_ANAEN }; - u4Byte IQK_MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; - - //since 92C & 92D have the different define in IQK_BB_REG - u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { - rOFDM0_TRxPathEnable, rOFDM0_TRMuxPar, - rFPGA0_XCD_RFInterfaceSW, rConfig_AntA, rConfig_AntB, - rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, - rFPGA0_XB_RFInterfaceOE, /*rFPGA0_RFMOD*/ rCCK0_AFESetting - }; - - u4Byte IQK_BB_REG_92D[IQK_BB_REG_NUM_92D] = { //for normal - rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, - rFPGA0_XB_RFInterfaceOE, rOFDM0_TRMuxPar, - rFPGA0_XCD_RFInterfaceSW, rOFDM0_TRxPathEnable, - /*rFPGA0_RFMOD*/ rCCK0_AFESetting, rFPGA0_AnalogParameter4, - rOFDM0_XAAGCCore1, rOFDM0_XBAGCCore1 - }; -#if MP_DRIVER - const u4Byte retryCount = 9; -#else - const u4Byte retryCount = 2; -#endif - //Neil Chen--2011--05--19-- - //3 Path Div - u1Byte rfPathSwitch=0x0; - - // Note: IQ calibration must be performed after loading - // PHY_REG.txt , and radio_a, radio_b.txt - - u4Byte bbvalue; - - if(t==0) - { - //bbvalue = PHY_QueryBBReg(pAdapter, rFPGA0_RFMOD, bMaskDWord); - // RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C()==>0x%08x\n",bbvalue)); - - RTPRINT(FINIT, INIT_IQK, ("IQ Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); - - // Save ADDA parameters, turn Path A ADDA on - phy_SaveADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); - phy_SaveMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); - phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); - } - - phy_PathADDAOn(pAdapter, ADDA_REG, TRUE, is2T); - - if(t==0) - { - pHalData->bRfPiEnable = (u1Byte)PHY_QueryBBReg(pAdapter, rFPGA0_XA_HSSIParameter1, BIT(8)); - } - - if(!pHalData->bRfPiEnable){ - // Switch BB to PI mode to do IQ Calibration. - phy_PIModeSwitch(pAdapter, TRUE); - } - - //MAC settings - phy_MACSettingCalibration(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); - - //PHY_SetBBReg(pAdapter, rFPGA0_RFMOD, BIT24, 0x00); - PHY_SetBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord, (0x0f000000 | (PHY_QueryBBReg(pAdapter, rCCK0_AFESetting, bMaskDWord))) ); - PHY_SetBBReg(pAdapter, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05600); - PHY_SetBBReg(pAdapter, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); - PHY_SetBBReg(pAdapter, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22204000); - { - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT10, 0x01); - PHY_SetBBReg(pAdapter, rFPGA0_XAB_RFInterfaceSW, BIT26, 0x01); - PHY_SetBBReg(pAdapter, rFPGA0_XA_RFInterfaceOE, BIT10, 0x00); - PHY_SetBBReg(pAdapter, rFPGA0_XB_RFInterfaceOE, BIT10, 0x00); - } - - if(is2T) - { - PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00010000); - PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00010000); - } - - { - //Page B init - PHY_SetBBReg(pAdapter, rConfig_AntA, bMaskDWord, 0x00080000); - - if(is2T) - { - PHY_SetBBReg(pAdapter, rConfig_AntB, bMaskDWord, 0x00080000); - } - } - // IQ calibration setting - RTPRINT(FINIT, INIT_IQK, ("IQK setting!\n")); - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x808000); - PHY_SetBBReg(pAdapter, rTx_IQK, bMaskDWord, 0x01007c00); - PHY_SetBBReg(pAdapter, rRx_IQK, bMaskDWord, 0x01004800); - - for(i = 0 ; i < retryCount ; i++){ - PathAOK = phy_PathA_IQK_8192C(pAdapter, is2T); - if(PathAOK == 0x03){ - RTPRINT(FINIT, INIT_IQK, ("Path A IQK Success!!\n")); - result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; - result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; - result[t][2] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; - result[t][3] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; - break; - } - else if (i == (retryCount-1) && PathAOK == 0x01) //Tx IQK OK - { - RTPRINT(FINIT, INIT_IQK, ("Path A IQK Only Tx Success!!\n")); - - result[t][0] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; - result[t][1] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; - } - } - - if(0x00 == PathAOK){ - RTPRINT(FINIT, INIT_IQK, ("Path A IQK failed!!\n")); - } - - if(is2T){ - phy_PathAStandBy(pAdapter); - - // Turn Path B ADDA on - phy_PathADDAOn(pAdapter, ADDA_REG, FALSE, is2T); - - for(i = 0 ; i < retryCount ; i++){ - PathBOK = phy_PathB_IQK_8192C(pAdapter); - if(PathBOK == 0x03){ - RTPRINT(FINIT, INIT_IQK, ("Path B IQK Success!!\n")); - result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; - result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; - result[t][6] = (PHY_QueryBBReg(pAdapter, rRx_Power_Before_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; - result[t][7] = (PHY_QueryBBReg(pAdapter, rRx_Power_After_IQK_B_2, bMaskDWord)&0x3FF0000)>>16; - break; - } - else if (i == (retryCount - 1) && PathBOK == 0x01) //Tx IQK OK - { - RTPRINT(FINIT, INIT_IQK, ("Path B Only Tx IQK Success!!\n")); - result[t][4] = (PHY_QueryBBReg(pAdapter, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; - result[t][5] = (PHY_QueryBBReg(pAdapter, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; - } - } - - if(0x00 == PathBOK){ - RTPRINT(FINIT, INIT_IQK, ("Path B IQK failed!!\n")); - } - } - - //Back to BB mode, load original value - RTPRINT(FINIT, INIT_IQK, ("IQK:Back to BB mode, load original value!\n")); - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); - - if(t!=0) - { - if(!pHalData->bRfPiEnable){ - // Switch back BB to SI mode after finish IQ Calibration. - phy_PIModeSwitch(pAdapter, FALSE); - } - - // Reload ADDA power saving parameters - phy_ReloadADDARegisters(pAdapter, ADDA_REG, pHalData->ADDA_backup, IQK_ADDA_REG_NUM); - - // Reload MAC parameters - phy_ReloadMACRegisters(pAdapter, IQK_MAC_REG, pHalData->IQK_MAC_backup); - - // Reload BB parameters - phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup, IQK_BB_REG_NUM); - - /*Restore RX initial gain*/ - PHY_SetBBReg(pAdapter, rFPGA0_XA_LSSIParameter, bMaskDWord, 0x00032ed3); - if (is2T) - PHY_SetBBReg(pAdapter, rFPGA0_XB_LSSIParameter, bMaskDWord, 0x00032ed3); - //load 0xe30 IQC default value - PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); - PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); - - } - RTPRINT(FINIT, INIT_IQK, ("phy_IQCalibrate_8192C() <==\n")); - -} - - -VOID -phy_LCCalibrate92C( - IN PADAPTER pAdapter, - IN BOOLEAN is2T - ) -{ - u1Byte tmpReg; - u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal; -// HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - //Check continuous TX and Packet TX - tmpReg = PlatformEFIORead1Byte(pAdapter, 0xd03); - - if((tmpReg&0x70) != 0) //Deal with contisuous TX case - PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg&0x8F); //disable all continuous TX - else // Deal with Packet TX case - PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0xFF); // block all queues - - if((tmpReg&0x70) != 0) - { - //1. Read original RF mode - //Path-A - RF_Amode = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits); - - //Path-B - if(is2T) - RF_Bmode = PHY_QueryRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits); - - //2. Set RF mode = standby mode - //Path-A - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, (RF_Amode&0x8FFFF)|0x10000); - - //Path-B - if(is2T) - PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, (RF_Bmode&0x8FFFF)|0x10000); - } - - //3. Read RF reg18 - LC_Cal = PHY_QueryRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits); - - //4. Set LC calibration begin bit15 - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_CHNLBW, bMask12Bits, LC_Cal|0x08000); - - delay_ms(100); - - - //Restore original situation - if((tmpReg&0x70) != 0) //Deal with contisuous TX case - { - //Path-A - PlatformEFIOWrite1Byte(pAdapter, 0xd03, tmpReg); - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bMask12Bits, RF_Amode); - - //Path-B - if(is2T) - PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bMask12Bits, RF_Bmode); - } - else // Deal with Packet TX case - { - PlatformEFIOWrite1Byte(pAdapter, REG_TXPAUSE, 0x00); - } -} - - -VOID -phy_LCCalibrate( - IN PADAPTER pAdapter, - IN BOOLEAN is2T - ) -{ - phy_LCCalibrate92C(pAdapter, is2T); -} - - - -//Analog Pre-distortion calibration -#define APK_BB_REG_NUM 8 -#define APK_CURVE_REG_NUM 4 -#define PATH_NUM 2 - -VOID -phy_APCalibrate_8192C( - IN PADAPTER pAdapter, - IN s1Byte delta, - IN BOOLEAN is2T - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - u4Byte regD[PATH_NUM]; - u4Byte tmpReg, index, offset, i, apkbound; - u1Byte path, pathbound = PATH_NUM; - u4Byte BB_backup[APK_BB_REG_NUM]; - u4Byte BB_REG[APK_BB_REG_NUM] = { - rFPGA1_TxBlock, rOFDM0_TRxPathEnable, - rFPGA0_RFMOD, rOFDM0_TRMuxPar, - rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, - rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; - u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x00204000 }; - u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x22204000 }; - - u4Byte AFE_backup[IQK_ADDA_REG_NUM]; - u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { - rFPGA0_XCD_SwitchControl, rBlue_Tooth, - rRx_Wait_CCA, rTx_CCK_RFON, - rTx_CCK_BBON, rTx_OFDM_RFON, - rTx_OFDM_BBON, rTx_To_Rx, - rTx_To_Tx, rRx_CCK, - rRx_OFDM, rRx_Wait_RIFS, - rRx_TO_Rx, rStandby, - rSleep, rPMPD_ANAEN }; - - u4Byte MAC_backup[IQK_MAC_REG_NUM]; - u4Byte MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; - - u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, - {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} - }; - - u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, //path settings equal to path b settings - {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} - }; - - u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, - {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} - }; - - u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, //path settings equal to path b settings - {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} - }; -#if 0 - u4Byte APK_RF_value_A[PATH_NUM][APK_BB_REG_NUM] = { - {0x1adb0, 0x1adb0, 0x1ada0, 0x1ad90, 0x1ad80}, - {0x00fb0, 0x00fb0, 0x00fa0, 0x00f90, 0x00f80} - }; -#endif - u4Byte AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4}; //path A on path B off / path A off path B on - - u4Byte APK_offset[PATH_NUM] = { - rConfig_AntA, rConfig_AntB}; - - u4Byte APK_normal_offset[PATH_NUM] = { - rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; - - u4Byte APK_value[PATH_NUM] = { - 0x92fc0000, 0x12fc0000}; - - u4Byte APK_normal_value[PATH_NUM] = { - 0x92680000, 0x12680000}; - - s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { - {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} - }; - - u4Byte APK_normal_setting_value_1[13] = { - 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, - 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, - 0x12680000, 0x00880000, 0x00880000 - }; - - u4Byte APK_normal_setting_value_2[16] = { - 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, - 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, - 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, - 0x00050006 - }; - - u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; //val_1_1a, val_1_2a, val_2a, val_3a, val_4a -// u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM]; - - s4Byte BB_offset, delta_V, delta_offset; - -#if MP_DRIVER == 1 - PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); - - pMptCtx->APK_bound[0] = 45; - pMptCtx->APK_bound[1] = 52; -#endif - - RTPRINT(FINIT, INIT_IQK, ("==>phy_APCalibrate_8192C() delta %d\n", delta)); - RTPRINT(FINIT, INIT_IQK, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); - if(!is2T) - pathbound = 1; - - //2 FOR NORMAL CHIP SETTINGS - -// Temporarily do not allow normal driver to do the following settings because these offset -// and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal -// will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the -// root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31. -#if MP_DRIVER != 1 - return; -#endif - //settings adjust for normal chip - for(index = 0; index < PATH_NUM; index ++) - { - APK_offset[index] = APK_normal_offset[index]; - APK_value[index] = APK_normal_value[index]; - AFE_on_off[index] = 0x6fdb25a4; - } - - for(index = 0; index < APK_BB_REG_NUM; index ++) - { - for(path = 0; path < pathbound; path++) - { - APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; - APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; - } - BB_AP_MODE[index] = BB_normal_AP_MODE[index]; - } - - apkbound = 6; - - //save BB default value - for(index = 0; index < APK_BB_REG_NUM ; index++) - { - if(index == 0) //skip - continue; - BB_backup[index] = PHY_QueryBBReg(pAdapter, BB_REG[index], bMaskDWord); - } - - //save MAC default value - phy_SaveMACRegisters(pAdapter, MAC_REG, MAC_backup); - - //save AFE default value - phy_SaveADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - for(path = 0; path < pathbound; path++) - { - - - if(path == RF_PATH_A) - { - //path A APK - //load APK setting - //path-A - offset = rPdp_AntA; - for(index = 0; index < 11; index ++) - { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); - - offset += 0x04; - } - - PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); - - offset = rConfig_AntA; - for(; index < 13; index ++) - { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); - - offset += 0x04; - } - - //page-B1 - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); - - //path A - offset = rPdp_AntA; - for(index = 0; index < 16; index++) - { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); - - offset += 0x04; - } - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); - } - else if(path == RF_PATH_B) - { - //path B APK - //load APK setting - //path-B - offset = rPdp_AntB; - for(index = 0; index < 10; index ++) - { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); - - offset += 0x04; - } - PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); - - PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); - - offset = rConfig_AntA; - index = 11; - for(; index < 13; index ++) //offset 0xb68, 0xb6c - { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_1[index]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); - - offset += 0x04; - } - - //page-B1 - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x400000); - - //path B - offset = 0xb60; - for(index = 0; index < 16; index++) - { - PHY_SetBBReg(pAdapter, offset, bMaskDWord, APK_normal_setting_value_2[index]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", offset, PHY_QueryBBReg(pAdapter, offset, bMaskDWord))); - - offset += 0x04; - } - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); - } - - //save RF default value - regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask); - - //Path A AFE all on, path B AFE All off or vise versa - for(index = 0; index < IQK_ADDA_REG_NUM ; index++) - PHY_SetBBReg(pAdapter, AFE_REG[index], bMaskDWord, AFE_on_off[path]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xe70 %x\n", PHY_QueryBBReg(pAdapter, rRx_Wait_CCA, bMaskDWord))); - - //BB to AP mode - if(path == 0) - { - for(index = 0; index < APK_BB_REG_NUM ; index++) - { - - if(index == 0) //skip - continue; - else if (index < 5) - PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); - else if (BB_REG[index] == 0x870) - PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); - else - PHY_SetBBReg(pAdapter, BB_REG[index], BIT10, 0x0); - } - - PHY_SetBBReg(pAdapter, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); - PHY_SetBBReg(pAdapter, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); - } - else //path B - { - PHY_SetBBReg(pAdapter, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); - PHY_SetBBReg(pAdapter, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); - - } - - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x800 %x\n", PHY_QueryBBReg(pAdapter, 0x800, bMaskDWord))); - - //MAC settings - phy_MACSettingCalibration(pAdapter, MAC_REG, MAC_backup); - - if(path == RF_PATH_A) //Path B to standby mode - { - PHY_SetRFReg(pAdapter, RF_PATH_B, RF_AC, bRFRegOffsetMask, 0x10000); - } - else //Path A to standby mode - { - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_AC, bRFRegOffsetMask, 0x10000); - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20103); - } - - delta_offset = ((delta+14)/2); - if(delta_offset < 0) - delta_offset = 0; - else if (delta_offset > 12) - delta_offset = 12; - - //AP calibration - for(index = 0; index < APK_BB_REG_NUM; index++) - { - if(index != 1) //only DO PA11+PAD01001, AP RF setting - continue; - - tmpReg = APK_RF_init_value[path][index]; -#if 1 - if(!pHalData->bAPKThermalMeterIgnore) - { - BB_offset = (tmpReg & 0xF0000) >> 16; - - if(!(tmpReg & BIT15)) //sign bit 0 - { - BB_offset = -BB_offset; - } - - delta_V = APK_delta_mapping[index][delta_offset]; - - BB_offset += delta_V; - - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, delta_V, delta_offset)); - - if(BB_offset < 0) - { - tmpReg = tmpReg & (~BIT15); - BB_offset = -BB_offset; - } - else - { - tmpReg = tmpReg | BIT15; - } - tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); - } -#endif - -#if DEV_BUS_TYPE==RT_PCI_INTERFACE - if(IS_81xxC_VENDOR_UMC_B_CUT(pHalData->VersionID)) - PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x894ae); - else -#endif - PHY_SetRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask, 0x8992e); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bRFRegOffsetMask))); - PHY_SetRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask, APK_RF_value_0[path][index]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bRFRegOffsetMask))); - PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, tmpReg); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask))); - - // PA11+PAD01111, one shot - i = 0; - do - { - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0x800000); - { - PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[0]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); - delay_ms(3); - PHY_SetBBReg(pAdapter, APK_offset[path], bMaskDWord, APK_value[1]); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0x%x value 0x%x\n", APK_offset[path], PHY_QueryBBReg(pAdapter, APK_offset[path], bMaskDWord))); - - delay_ms(20); - } - PHY_SetBBReg(pAdapter, rFPGA0_IQK, 0xffffff00, 0); - - if(path == RF_PATH_A) - tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0x03E00000); - else - tmpReg = PHY_QueryBBReg(pAdapter, rAPK, 0xF8000000); - RTPRINT(FINIT, INIT_IQK, ("phy_APCalibrate_8192C() offset 0xbd8[25:21] %x\n", tmpReg)); - - - i++; - } - while(tmpReg > apkbound && i < 4); - - APK_result[path][index] = tmpReg; - } - } - - //reload MAC default value - phy_ReloadMACRegisters(pAdapter, MAC_REG, MAC_backup); - - //reload BB default value - for(index = 0; index < APK_BB_REG_NUM ; index++) - { - - if(index == 0) //skip - continue; - PHY_SetBBReg(pAdapter, BB_REG[index], bMaskDWord, BB_backup[index]); - } - - //reload AFE default value - phy_ReloadADDARegisters(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - //reload RF path default value - for(path = 0; path < pathbound; path++) - { - PHY_SetRFReg(pAdapter, path, RF_TXBIAS_A, bRFRegOffsetMask, regD[path]); - if(path == RF_PATH_B) - { - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE1, bRFRegOffsetMask, 0x1000f); - PHY_SetRFReg(pAdapter, RF_PATH_A, RF_MODE2, bRFRegOffsetMask, 0x20101); - } - - //note no index == 0 - if (APK_result[path][1] > 6) - APK_result[path][1] = 6; - RTPRINT(FINIT, INIT_IQK, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); - } - - RTPRINT(FINIT, INIT_IQK, ("\n")); - - - for(path = 0; path < pathbound; path++) - { - PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G1_G4, bRFRegOffsetMask, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); - if(path == RF_PATH_A) - PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); - else - PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G5_G8, bRFRegOffsetMask, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); - - PHY_SetRFReg(pAdapter, path, RF_BS_PA_APSET_G9_G11, bRFRegOffsetMask, ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); - } - - pHalData->bAPKdone = TRUE; - - RTPRINT(FINIT, INIT_IQK, ("<==phy_APCalibrate_8192C()\n")); -} - - -VOID -PHY_IQCalibrate_8192C( - IN PADAPTER pAdapter, - IN BOOLEAN bReCovery - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - s4Byte result[4][8]; //last is final result - u1Byte i, final_candidate, Indexforchannel; - BOOLEAN bPathAOK, bPathBOK; - s4Byte RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC, RegTmp = 0; - BOOLEAN is12simular, is13simular, is23simular; - BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; - u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { - rOFDM0_XARxIQImbalance, rOFDM0_XBRxIQImbalance, - rOFDM0_ECCAThreshold, rOFDM0_AGCRSSITable, - rOFDM0_XATxIQImbalance, rOFDM0_XBTxIQImbalance, - rOFDM0_XCTxAFE, rOFDM0_XDTxAFE, - rOFDM0_RxIQExtAnta}; - - if (ODM_CheckPowerStatus(pAdapter) == FALSE) - return; - -#if MP_DRIVER == 1 - bStartContTx = pAdapter->MptCtx.bStartContTx; - bSingleTone = pAdapter->MptCtx.bSingleTone; - bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; -#endif - - //ignore IQK when continuous Tx - if(bStartContTx || bSingleTone || bCarrierSuppression) - return; - -#ifdef DISABLE_BB_RF - return; -#endif - if(pAdapter->bSlaveOfDMSP) - return; - - if (bReCovery) - { - phy_ReloadADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); - return; - - } - - RTPRINT(FINIT, INIT_IQK, ("IQK:Start!!!\n")); - - for(i = 0; i < 8; i++) - { - result[0][i] = 0; - result[1][i] = 0; - result[2][i] = 0; - result[3][i] = 0; - } - final_candidate = 0xff; - bPathAOK = FALSE; - bPathBOK = FALSE; - is12simular = FALSE; - is23simular = FALSE; - is13simular = FALSE; - - AcquireCCKAndRWPageAControl(pAdapter); - /*RT_TRACE(COMP_INIT,DBG_LOUD,("Acquire Mutex in IQCalibrate\n"));*/ - for (i=0; i<3; i++) - { - /*For 88C 1T1R*/ - phy_IQCalibrate_8192C(pAdapter, result, i, FALSE); - - if(i == 1) - { - is12simular = phy_SimularityCompare(pAdapter, result, 0, 1); - if(is12simular) - { - final_candidate = 0; - break; - } - } - - if(i == 2) - { - is13simular = phy_SimularityCompare(pAdapter, result, 0, 2); - if(is13simular) - { - final_candidate = 0; - break; - } - - is23simular = phy_SimularityCompare(pAdapter, result, 1, 2); - if(is23simular) - final_candidate = 1; - else - { - for(i = 0; i < 8; i++) - RegTmp += result[3][i]; - - if(RegTmp != 0) - final_candidate = 3; - else - final_candidate = 0xFF; - } - } - } -// RT_TRACE(COMP_INIT,DBG_LOUD,("Release Mutex in IQCalibrate \n")); - ReleaseCCKAndRWPageAControl(pAdapter); - - for (i=0; i<4; i++) - { - RegE94 = result[i][0]; - RegE9C = result[i][1]; - RegEA4 = result[i][2]; - RegEAC = result[i][3]; - RegEB4 = result[i][4]; - RegEBC = result[i][5]; - RegEC4 = result[i][6]; - RegECC = result[i][7]; - RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); - } - - if(final_candidate != 0xff) - { - pHalData->RegE94 = RegE94 = result[final_candidate][0]; - pHalData->RegE9C = RegE9C = result[final_candidate][1]; - RegEA4 = result[final_candidate][2]; - RegEAC = result[final_candidate][3]; - pHalData->RegEB4 = RegEB4 = result[final_candidate][4]; - pHalData->RegEBC = RegEBC = result[final_candidate][5]; - RegEC4 = result[final_candidate][6]; - RegECC = result[final_candidate][7]; - RTPRINT(FINIT, INIT_IQK, ("IQK: final_candidate is %x\n",final_candidate)); - RTPRINT(FINIT, INIT_IQK, ("IQK: RegE94=%x RegE9C=%x RegEA4=%x RegEAC=%x RegEB4=%x RegEBC=%x RegEC4=%x RegECC=%x\n ", RegE94, RegE9C, RegEA4, RegEAC, RegEB4, RegEBC, RegEC4, RegECC)); - bPathAOK = bPathBOK = TRUE; - } - else - { - RegE94 = RegEB4 = pHalData->RegE94 = pHalData->RegEB4 = 0x100; //X default value - RegE9C = RegEBC = pHalData->RegE9C = pHalData->RegEBC = 0x0; //Y default value - } - - if((RegE94 != 0)/*&&(RegEA4 != 0)*/) - { - if(pHalData->CurrentBandType == BAND_ON_5G) - phy_PathAFillIQKMatrix_5G_Normal(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); - else - phy_PathAFillIQKMatrix(pAdapter, bPathAOK, result, final_candidate, (RegEA4 == 0)); - - } - - if (IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) - { - if((RegEB4 != 0)/*&&(RegEC4 != 0)*/) - { - if(pHalData->CurrentBandType == BAND_ON_5G) - phy_PathBFillIQKMatrix_5G_Normal(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); - else - phy_PathBFillIQKMatrix(pAdapter, bPathBOK, result, final_candidate, (RegEC4 == 0)); - } - } - - phy_SaveADDARegisters(pAdapter, IQK_BB_REG_92C, pHalData->IQK_BB_backup_recover, 9); - -} - - -VOID -PHY_LCCalibrate_8192C( - IN PADAPTER pAdapter - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - BOOLEAN bStartContTx = FALSE, bSingleTone = FALSE, bCarrierSuppression = FALSE; - PMGNT_INFO pMgntInfo=&pAdapter->MgntInfo; - PMGNT_INFO pMgntInfoBuddyAdapter; - u4Byte timeout = 2000, timecount = 0; - PADAPTER BuddyAdapter = pAdapter->BuddyAdapter; - -#if MP_DRIVER == 1 - bStartContTx = pAdapter->MptCtx.bStartContTx; - bSingleTone = pAdapter->MptCtx.bSingleTone; - bCarrierSuppression = pAdapter->MptCtx.bCarrierSuppression; -#endif - -#ifdef DISABLE_BB_RF - return; -#endif - - //ignore LCK when continuous Tx - if(bStartContTx || bSingleTone || bCarrierSuppression) - return; - - if(BuddyAdapter != NULL && - ((pAdapter->interfaceIndex == 0 && pHalData->CurrentBandType == BAND_ON_2_4G) || - (pAdapter->interfaceIndex == 1 && pHalData->CurrentBandType == BAND_ON_5G))) - { - pMgntInfoBuddyAdapter=&BuddyAdapter->MgntInfo; - while(pMgntInfoBuddyAdapter->bScanInProgress && timecount < timeout) - { - delay_ms(50); - timecount += 50; - } - } - - while(pMgntInfo->bScanInProgress && timecount < timeout) - { - delay_ms(50); - timecount += 50; - } - - pHalData->bLCKInProgress = TRUE; - - RTPRINT(FINIT, INIT_IQK, ("LCK:Start!!!interface %d currentband %x delay %d ms\n", pAdapter->interfaceIndex, pHalData->CurrentBandType, timecount)); - - //if(IS_92C_SERIAL(pHalData->VersionID) || IS_92D_SINGLEPHY(pHalData->VersionID)) - if(IS_2T2R(pHalData->VersionID)) - { - phy_LCCalibrate(pAdapter, TRUE); - } - else{ - // For 88C 1T1R - phy_LCCalibrate(pAdapter, FALSE); - } - - pHalData->bLCKInProgress = FALSE; - - RTPRINT(FINIT, INIT_IQK, ("LCK:Finish!!!interface %d\n", pAdapter->interfaceIndex)); - - -} - -VOID -PHY_APCalibrate_8192C( - IN PADAPTER pAdapter, - IN s1Byte delta - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - //default disable APK, because Tx NG issue, suggest by Jenyu, 2011.11.25 - return; - -#ifdef DISABLE_BB_RF - return; -#endif - -#if FOR_BRAZIL_PRETEST != 1 - if(pHalData->bAPKdone) -#endif - return; - - if(IS_92C_SERIAL( pHalData->VersionID)){ - phy_APCalibrate_8192C(pAdapter, delta, TRUE); - } - else{ - // For 88C 1T1R - phy_APCalibrate_8192C(pAdapter, delta, FALSE); - } -} - - -#endif - - -//3============================================================ -//3 IQ Calibration -//3============================================================ - -VOID -ODM_ResetIQKResult( - IN PVOID pDM_VOID -) -{ - return; -} -#if 1//!(DM_ODM_SUPPORT_TYPE & ODM_AP) -u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -{ - u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = - {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; - u1Byte place = chnl; - - - if(chnl > 14) - { - for(place = 14; placeAdapter; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (*pDM_Odm->pIsFcsModeEnable) - return; -#endif - - - - if (pDM_Odm->bLinked) { - if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { - pDM_Odm->preChannel = *pDM_Odm->pChannel; - pDM_Odm->LinkedInterval = 0; - } - - if (pDM_Odm->LinkedInterval < 3) - pDM_Odm->LinkedInterval++; - - if (pDM_Odm->LinkedInterval == 2) { - - #if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8814A) - PHY_IQCalibrate_8814A(pDM_Odm, FALSE); - #endif - - #if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) - PHY_IQCalibrate_8822B(pDM_Odm, FALSE); - #endif - - #if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - PHY_IQCalibrate_8821C(pDM_Odm, FALSE); - #endif - - #if (RTL8821A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821) - PHY_IQCalibrate_8821A(pDM_Odm, FALSE); - #endif - - #if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812) - phy_IQCalibrate_8812A(pDM_Odm, FALSE); - #endif - } - } else - pDM_Odm->LinkedInterval = 0; - -} - -void phydm_rf_init(IN PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - odm_TXPowerTrackingInit(pDM_Odm); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - ODM_ClearTxPowerTrackingState(pDM_Odm); -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) - PHY_IQCalibrate_8814A_Init(pDM_Odm); -#endif -#endif - -} - -void phydm_rf_watchdog(IN PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - ODM_TXPowerTrackingCheck(pDM_Odm); - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - odm_IQCalibrate(pDM_Odm); -#endif -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.h deleted file mode 100644 index e4813cec273b..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ap.h +++ /dev/null @@ -1,179 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - #ifndef __HAL_PHY_RF_H__ - #define __HAL_PHY_RF_H__ - -#include "phydm_powertracking_ap.h" -#if (RTL8814A_SUPPORT == 1) -#include "rtl8814a/phydm_iqk_8814a.h" -#endif - -#if (RTL8822B_SUPPORT == 1) -#include "rtl8822b/phydm_iqk_8822b.h" -#endif - -#if (RTL8821C_SUPPORT == 1) -#include "rtl8822b/phydm_iqk_8821c.h" -#endif - -typedef enum _PWRTRACK_CONTROL_METHOD { - BBSWING, - TXAGC, - MIX_MODE, - TSSI_MODE -} PWRTRACK_METHOD; - -typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -typedef VOID (*FuncLCK)(PVOID); - //refine by YuChen for 8814A -typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -typedef VOID (*FuncAllSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); - - -typedef struct _TXPWRTRACK_CFG { - u1Byte SwingTableSize_CCK; - u1Byte SwingTableSize_OFDM; - u1Byte Threshold_IQK; - u1Byte Threshold_DPK; - u1Byte AverageThermalNum; - u1Byte RfPathCount; - u4Byte ThermalRegAddr; - FuncSetPwr ODM_TxPwrTrackSetPwr; - FuncIQK DoIQK; - FuncLCK PHY_LCCalibrate; - FuncSwing GetDeltaSwingTable; - FuncSwing8814only GetDeltaSwingTable8814only; - FuncAllSwing GetDeltaAllSwingTable; -} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; - -VOID -ConfigureTxpowerTrack( - IN PVOID pDM_VOID, - OUT PTXPWRTRACK_CFG pConfig - ); - - -VOID -ODM_TXPowerTrackingCallback_ThermalMeter( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ); - -#if (RTL8192E_SUPPORT==1) -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_92E( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ); -#endif - -#if (RTL8814A_SUPPORT == 1) -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries2( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ); - -#elif ODM_IC_11AC_SERIES_SUPPORT -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ); - -#elif (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -VOID -ODM_TXPowerTrackingCallback_ThermalMeter_JaguarSeries3( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ); - -#endif - -#define IS_CCK_RATE(_rate) (ODM_MGN_1M == _rate || _rate == ODM_MGN_2M || _rate == ODM_MGN_5_5M || _rate == ODM_MGN_11M ) - - -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -#define MAX_TOLERANCE 5 -#define IQK_DELAY_TIME 1 //ms - - // -// BB/MAC/RF other monitor API -// - -void PHY_SetMonitorMode8192C(IN PADAPTER pAdapter, - IN BOOLEAN bEnableMonitorMode ); - -// -// IQ calibrate -// -void -PHY_IQCalibrate_8192C( IN PADAPTER pAdapter, - IN BOOLEAN bReCovery); - -// -// LC calibrate -// -void -PHY_LCCalibrate_8192C( IN PADAPTER pAdapter); - -// -// AP calibrate -// -void -PHY_APCalibrate_8192C( IN PADAPTER pAdapter, - IN s1Byte delta); -#endif - -#define ODM_TARGET_CHNL_NUM_2G_5G 59 - - -VOID -ODM_ResetIQKResult( - IN PVOID pDM_VOID -); -u1Byte -ODM_GetRightChnlPlaceforIQK( - IN u1Byte chnl -); - -void phydm_rf_init(IN PVOID pDM_VOID); -void phydm_rf_watchdog(IN PVOID pDM_VOID); - -#endif // #ifndef __HAL_PHY_RF_H__ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.c deleted file mode 100644 index 3eb16843990b..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.c +++ /dev/null @@ -1,807 +0,0 @@ -/****************************************************************************** - * - * 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 "mp_precomp.h" -#include "phydm_precomp.h" - -#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ - do {\ - for(_offset = 0; _offset < _size; _offset++)\ - {\ - if(_deltaThermal < thermalThreshold[_direction][_offset])\ - {\ - if(_offset != 0)\ - _offset--;\ - break;\ - }\ - } \ - if(_offset >= _size)\ - _offset = _size-1;\ - } while(0) - -void ConfigureTxpowerTrack( - IN PVOID pDM_VOID, - OUT PTXPWRTRACK_CFG pConfig - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - -#if RTL8192E_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8192E) - ConfigureTxpowerTrack_8192E(pConfig); -#endif -#if RTL8821A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8821) - ConfigureTxpowerTrack_8821A(pConfig); -#endif -#if RTL8812A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8812) - ConfigureTxpowerTrack_8812A(pConfig); -#endif -#if RTL8188E_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8188E) - ConfigureTxpowerTrack_8188E(pConfig); -#endif - -#if RTL8723B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8723B) - ConfigureTxpowerTrack_8723B(pConfig); -#endif - -#if RTL8814A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8814A) - ConfigureTxpowerTrack_8814A(pConfig); -#endif - -#if RTL8703B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8703B) - ConfigureTxpowerTrack_8703B(pConfig); -#endif - -#if RTL8188F_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8188F) - ConfigureTxpowerTrack_8188F(pConfig); -#endif -#if RTL8723D_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8723D) - ConfigureTxpowerTrack_8723D(pConfig); -#endif -#if RTL8822B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8822B) - ConfigureTxpowerTrack_8822B(pConfig); -#endif -#if RTL8821C_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8821C) - ConfigureTxpowerTrack_8821C(pConfig); -#endif - -} - -//====================================================================== -// <20121113, Kordan> This function should be called when TxAGC changed. -// Otherwise the previous compensation is gone, because we record the -// delta of temperature between two TxPowerTracking watch dogs. -// -// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still -// need to call this function. -//====================================================================== -VOID -ODM_ClearTxPowerTrackingState( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); - u1Byte p = 0; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; - pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; - pDM_Odm->RFCalibrateInfo.CCK_index = 0; - - for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) - { - pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; - - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - pRFCalibrateInfo->DeltaPowerIndex[p] = 0; - pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; - - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; /* Initial Mix mode power tracking*/ - pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; - pRFCalibrateInfo->KfreeOffset[p] = 0; - } - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Modify_TxAGC_Flag_PathC = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Modify_TxAGC_Flag_PathD = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; - pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; - - pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo - -} - -VOID -ODM_TXPowerTrackingCallback_ThermalMeter( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER Adapter -#endif - ) -{ - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif -#endif - - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; - s1Byte diff_DPK[4] = {0}; - u1Byte ThermalValue_AVG_count = 0; - u4Byte ThermalValue_AVG = 0, RegC80, RegCd0, RegCd4, Regab4; - - u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur - u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) - u1Byte PowerTrackingType = pHalData->RfPowerTrackingType; - u1Byte XtalOffsetEanble = 0; - - TXPWRTRACK_CFG c; - - //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. - pu1Byte deltaSwingTableIdx_TUP_A = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_A = NULL; - pu1Byte deltaSwingTableIdx_TUP_B = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_B = NULL; - /*for 8814 add by Yu Chen*/ - pu1Byte deltaSwingTableIdx_TUP_C = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_C = NULL; - pu1Byte deltaSwingTableIdx_TUP_D = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_D = NULL; - /*for Xtal Offset by James.Tung*/ - ps1Byte deltaSwingTableXtal_UP = NULL; - ps1Byte deltaSwingTableXtal_DOWN = NULL; - - //4 2. Initilization ( 7 steps in total ) - - ConfigureTxpowerTrack(pDM_Odm, &c); - - (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, - (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B); - - if (pDM_Odm->SupportICType & ODM_RTL8814A) /*for 8814 path C & D*/ - (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_C, (pu1Byte *)&deltaSwingTableIdx_TDOWN_C, - (pu1Byte *)&deltaSwingTableIdx_TUP_D, (pu1Byte *)&deltaSwingTableIdx_TDOWN_D); - - if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ - (*c.GetDeltaSwingXtalTable)(pDM_Odm, (ps1Byte *)&deltaSwingTableXtal_UP, (ps1Byte *)&deltaSwingTableXtal_DOWN); - - pRFCalibrateInfo->TXPowerTrackingCallbackCnt++; /*cosa add for debug*/ - pRFCalibrateInfo->bTXPowerTrackingInit = TRUE; - - /*pRFCalibrateInfo->TxPowerTrackControl = pHalData->TxPowerTrackControl; - We should keep updating the control variable according to HalData. - RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. */ - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - #if (MP_DRIVER == 1) - pRFCalibrateInfo->RegA24 = 0x090e1317; - #endif - #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - if (pDM_Odm->mp_mode == TRUE) - pRFCalibrateInfo->RegA24 = 0x090e1317; - #endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("===>ODM_TXPowerTrackingCallback_ThermalMeter\n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", - pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("pRFCalibrateInfo->TxPowerTrackControl=%d, pHalData->EEPROMThermalMeter %d\n", pRFCalibrateInfo->TxPowerTrackControl, pHalData->EEPROMThermalMeter)); - ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E - - /*add log by zhao he, check c80/c94/c14/ca0 value*/ - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); - RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); - RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); - Regab4 = ODM_GetBBReg(pDM_Odm, 0xab4, 0x000007FF); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", RegC80, RegCd0, RegCd4, Regab4)); - } - - if (!pRFCalibrateInfo->TxPowerTrackControl) - return; - - - /*4 3. Initialize ThermalValues of RFCalibrateInfo*/ - - if (pRFCalibrateInfo->bReloadtxpowerindex) - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); - - /*4 4. Calculate average thermal meter*/ - - pRFCalibrateInfo->ThermalValue_AVG[pRFCalibrateInfo->ThermalValue_AVG_index] = ThermalValue; - pRFCalibrateInfo->ThermalValue_AVG_index++; - if (pRFCalibrateInfo->ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ - pRFCalibrateInfo->ThermalValue_AVG_index = 0; - - for(i = 0; i < c.AverageThermalNum; i++) - { - if (pRFCalibrateInfo->ThermalValue_AVG[i]) { - ThermalValue_AVG += pRFCalibrateInfo->ThermalValue_AVG[i]; - ThermalValue_AVG_count++; - } - } - - if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times - { - ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); - } - - //4 5. Calculate delta, delta_LCK, delta_IQK. - - //"delta" here is used to determine whether thermal value changes or not. - delta = (ThermalValue > pRFCalibrateInfo->ThermalValue)?(ThermalValue - pRFCalibrateInfo->ThermalValue):(pRFCalibrateInfo->ThermalValue - ThermalValue); - delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); - delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); - - if (pRFCalibrateInfo->ThermalValue_IQK == 0xff) { /*no PG, use thermal value for IQK*/ - pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; - delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); - } - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pRFCalibrateInfo->DpkThermal[p]; - - /*4 6. If necessary, do LCK.*/ - - if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { /*no PG , do LCK at initial status*/ - if (pRFCalibrateInfo->ThermalValue_LCK == 0xff) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); - pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; - - /*Use RTLCK, so close power tracking driver LCK*/ - if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { - if (c.PHY_LCCalibrate) - (*c.PHY_LCCalibrate)(pDM_Odm); - } - - delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); - - /* Delta temperature is equal to or larger than 20 centigrade.*/ - if (delta_LCK >= c.Threshold_IQK) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); - pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; - - /*Use RTLCK, so close power tracking driver LCK*/ - if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { - if (c.PHY_LCCalibrate) - (*c.PHY_LCCalibrate)(pDM_Odm); - } - } - } - - /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ - - if (delta > 0 && pRFCalibrateInfo->TxPowerTrackControl) - { - //"delta" here is used to record the absolute value of differrence. -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -#else - delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -#endif - if (delta >= TXPWR_TRACK_TABLE_SIZE) - delta = TXPWR_TRACK_TABLE_SIZE - 1; - - /*4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset*/ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(ThermalValue > pHalData->EEPROMThermalMeter) { -#else - if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -#endif - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - } - } - - if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { - /*Save XtalOffset from Xtal table*/ - pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("[Xtal] deltaSwingTableXtal_UP[%d] = %d\n", delta, deltaSwingTableXtal_UP[delta])); - pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_UP[delta]; - - if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) - XtalOffsetEanble = 0; - else - XtalOffsetEanble = 1; - } - - } else { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ - - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - } - } - - if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { - /*Save XtalOffset from Xtal table*/ - pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("[Xtal] deltaSwingTableXtal_DOWN[%d] = %d\n", delta, deltaSwingTableXtal_DOWN[delta])); - pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_DOWN[delta]; - - if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) - XtalOffsetEanble = 0; - else - XtalOffsetEanble = 1; - } - - } - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); - - if (pRFCalibrateInfo->DeltaPowerIndex[p] == pRFCalibrateInfo->DeltaPowerIndexLast[p]) /*If Thermal value changes but lookup table value still the same*/ - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - else - pRFCalibrateInfo->PowerIndexOffset[p] = pRFCalibrateInfo->DeltaPowerIndex[p] - pRFCalibrateInfo->DeltaPowerIndexLast[p]; /*Power Index Diff between 2 times Power Tracking*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pRFCalibrateInfo->PowerIndexOffset[p], pRFCalibrateInfo->DeltaPowerIndex[p], pRFCalibrateInfo->DeltaPowerIndexLast[p])); - - pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pRFCalibrateInfo->PowerIndexOffset[p]; - pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pRFCalibrateInfo->PowerIndexOffset[p]; - - pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->CCK_index; - pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->OFDM_index[p]; - - /*************Print BB Swing Base and Index Offset*************/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->PowerIndexOffset[p])); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pRFCalibrateInfo->PowerIndexOffset[p])); - - /*4 7.1 Handle boundary conditions of index.*/ - - if (pRFCalibrateInfo->OFDM_index[p] > c.SwingTableSize_OFDM-1) - pRFCalibrateInfo->OFDM_index[p] = c.SwingTableSize_OFDM-1; - else if (pRFCalibrateInfo->OFDM_index[p] <= OFDM_min_index) - pRFCalibrateInfo->OFDM_index[p] = OFDM_min_index; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n\n========================================================================================================\n")); - - if (pRFCalibrateInfo->CCK_index > c.SwingTableSize_CCK-1) - pRFCalibrateInfo->CCK_index = c.SwingTableSize_CCK-1; - else if (pRFCalibrateInfo->CCK_index <= 0) - pRFCalibrateInfo->CCK_index = 0; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pRFCalibrateInfo->ThermalValue: %d\n", - pRFCalibrateInfo->TxPowerTrackControl, ThermalValue, pRFCalibrateInfo->ThermalValue)); - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", - pRFCalibrateInfo->CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); /*Print Swing base & current*/ - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", - pRFCalibrateInfo->OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); - } - - if ((pDM_Odm->SupportICType & ODM_RTL8814A)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PowerTrackingType=%d\n", PowerTrackingType)); - - if (PowerTrackingType == 0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } else if (PowerTrackingType == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_2G_TSSI_5G_MODE, p, 0); - } else if (PowerTrackingType == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_5G_TSSI_2G_MODE, p, 0); - } else if (PowerTrackingType == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); - } - pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ - - } else if ((pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A] != 0 || - pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B] != 0 || - pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_C] != 0 || - pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_D] != 0) && - pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { - //4 7.2 Configure the Swing Table to adjust Tx Power. - - pRFCalibrateInfo->bTxPowerChanged = TRUE; /*Always TRUE after Tx Power is adjusted by power tracking.*/ - // - // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital - // to increase TX power. Otherwise, EVM will be bad. - // - // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. - if (ThermalValue > pRFCalibrateInfo->ThermalValue) { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", - p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); - } - } else if (ThermalValue < pRFCalibrateInfo->ThermalValue) { /*Low temperature*/ - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", - p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); - } - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (ThermalValue > pHalData->EEPROMThermalMeter) -#else - if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -#endif - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || - pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || - pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || - pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); - } - } - else - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || - pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || - pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || - pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); - } - - } - - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; /*Record last time Power Tracking result as base.*/ - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("pRFCalibrateInfo->ThermalValue = %d ThermalValue= %d\n", pRFCalibrateInfo->ThermalValue, ThermalValue)); - - pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ - - } - - - if (pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8723D) { - - if (XtalOffsetEanble != 0 && pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (ThermalValue > pHalData->EEPROMThermalMeter) { -#else - if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (!IS_HARDWARE_TYPE_8723B(Adapter)) { - /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ - if (delta_IQK >= c.Threshold_IQK) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); - if (!pRFCalibrateInfo->bIQKInProgress) - (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); - } - } - if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] != 0) { - if (diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK) { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { - s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); - - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } - } - if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] != 0) { - if (diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK) { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { - s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); - - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } - } - -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); - - pRFCalibrateInfo->TXPowercount = 0; -} - - - -//3============================================================ -//3 IQ Calibration -//3============================================================ - -VOID -ODM_ResetIQKResult( - IN PVOID pDM_VOID -) -{ - return; -} -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -{ - u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = - {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; - u1Byte place = chnl; - - - if(chnl > 14) - { - for(place = 14; placeAdapter; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (*pDM_Odm->pIsFcsModeEnable) - return; -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - if (IS_HARDWARE_TYPE_8812AU(Adapter)) - return; -#endif - - if (pDM_Odm->bLinked) { - if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { - pDM_Odm->preChannel = *pDM_Odm->pChannel; - pDM_Odm->LinkedInterval = 0; - } - - if (pDM_Odm->LinkedInterval < 3) - pDM_Odm->LinkedInterval++; - - if (pDM_Odm->LinkedInterval == 2) { - if (IS_HARDWARE_TYPE_8814A(Adapter)) { - #if (RTL8814A_SUPPORT == 1) - PHY_IQCalibrate_8814A(pDM_Odm, FALSE); - #endif - } - - #if (RTL8822B_SUPPORT == 1) - else if (IS_HARDWARE_TYPE_8822B(Adapter)) - PHY_IQCalibrate_8822B(pDM_Odm, FALSE); - #endif - - #if (RTL8821C_SUPPORT == 1) - else if (IS_HARDWARE_TYPE_8821C(Adapter)) - PHY_IQCalibrate_8821C(pDM_Odm, FALSE); - #endif - - #if (RTL8821A_SUPPORT == 1) - else if (IS_HARDWARE_TYPE_8821(Adapter)) - PHY_IQCalibrate_8821A(pDM_Odm, FALSE); - #endif - } - } else - pDM_Odm->LinkedInterval = 0; -} - -void phydm_rf_init(IN PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - odm_TXPowerTrackingInit(pDM_Odm); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - ODM_ClearTxPowerTrackingState(pDM_Odm); -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) - PHY_IQCalibrate_8814A_Init(pDM_Odm); -#endif -#endif - -} - -void phydm_rf_watchdog(IN PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - ODM_TXPowerTrackingCheck(pDM_Odm); - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - odm_IQCalibrate(pDM_Odm); -#endif -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.h deleted file mode 100644 index 2ed5764a8b9e..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_ce.h +++ /dev/null @@ -1,118 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - #ifndef __HAL_PHY_RF_H__ - #define __HAL_PHY_RF_H__ - -#include "phydm_kfree.h" -#if (RTL8814A_SUPPORT == 1) -#include "rtl8814a/phydm_iqk_8814a.h" -#endif - -#if (RTL8822B_SUPPORT == 1) -#include "rtl8822b/phydm_iqk_8822b.h" -#endif - -#if (RTL8821C_SUPPORT == 1) -#include "rtl8821c/phydm_iqk_8821c.h" -#endif - -#include "phydm_powertracking_ce.h" - - -typedef enum _SPUR_CAL_METHOD { - PLL_RESET, - AFE_PHASE_SEL -} SPUR_CAL_METHOD; - -typedef enum _PWRTRACK_CONTROL_METHOD { - BBSWING, - TXAGC, - MIX_MODE, - TSSI_MODE, - MIX_2G_TSSI_5G_MODE, - MIX_5G_TSSI_2G_MODE -} PWRTRACK_METHOD; - -typedef VOID (*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -typedef VOID (*FuncLCK)(PVOID); -typedef VOID (*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -typedef VOID (*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -typedef VOID(*FuncSwingXtal)(PVOID, ps1Byte*, ps1Byte*); -typedef VOID(*FuncSetXtal)(PVOID); - -typedef struct _TXPWRTRACK_CFG { - u1Byte SwingTableSize_CCK; - u1Byte SwingTableSize_OFDM; - u1Byte Threshold_IQK; - u1Byte Threshold_DPK; - u1Byte AverageThermalNum; - u1Byte RfPathCount; - u4Byte ThermalRegAddr; - FuncSetPwr ODM_TxPwrTrackSetPwr; - FuncIQK DoIQK; - FuncLCK PHY_LCCalibrate; - FuncSwing GetDeltaSwingTable; - FuncSwing8814only GetDeltaSwingTable8814only; - FuncSwingXtal GetDeltaSwingXtalTable; - FuncSetXtal ODM_TxXtalTrackSetXtal; -} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; - -VOID -ConfigureTxpowerTrack( - IN PVOID pDM_VOID, - OUT PTXPWRTRACK_CFG pConfig - ); - - -VOID -ODM_ClearTxPowerTrackingState( - IN PVOID pDM_VOID - ); - -VOID -ODM_TXPowerTrackingCallback_ThermalMeter( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PVOID pDM_VOID -#else - IN PADAPTER Adapter -#endif - ); - - - -#define ODM_TARGET_CHNL_NUM_2G_5G 59 - - -VOID -ODM_ResetIQKResult( - IN PVOID pDM_VOID -); -u1Byte -ODM_GetRightChnlPlaceforIQK( - IN u1Byte chnl -); - -void phydm_rf_init( IN PVOID pDM_VOID); -void phydm_rf_watchdog( IN PVOID pDM_VOID); - -#endif // #ifndef __HAL_PHY_RF_H__ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.c deleted file mode 100644 index 0f2c10befac7..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.c +++ /dev/null @@ -1,792 +0,0 @@ -/****************************************************************************** - * - * 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 "mp_precomp.h" -#include "phydm_precomp.h" - -#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _deltaThermal) \ - do {\ - for(_offset = 0; _offset < _size; _offset++)\ - {\ - if(_deltaThermal < thermalThreshold[_direction][_offset])\ - {\ - if(_offset != 0)\ - _offset--;\ - break;\ - }\ - } \ - if(_offset >= _size)\ - _offset = _size-1;\ - } while(0) - -void ConfigureTxpowerTrack( - IN PDM_ODM_T pDM_Odm, - OUT PTXPWRTRACK_CFG pConfig - ) -{ -#if RTL8192E_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8192E) - ConfigureTxpowerTrack_8192E(pConfig); -#endif -#if RTL8821A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8821) - ConfigureTxpowerTrack_8821A(pConfig); -#endif -#if RTL8812A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8812) - ConfigureTxpowerTrack_8812A(pConfig); -#endif -#if RTL8188E_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8188E) - ConfigureTxpowerTrack_8188E(pConfig); -#endif - -#if RTL8188F_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8188F) - ConfigureTxpowerTrack_8188F(pConfig); -#endif - -#if RTL8723B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8723B) - ConfigureTxpowerTrack_8723B(pConfig); -#endif - -#if RTL8814A_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8814A) - ConfigureTxpowerTrack_8814A(pConfig); -#endif - -#if RTL8703B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8703B) - ConfigureTxpowerTrack_8703B(pConfig); -#endif - -#if RTL8822B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8822B) - ConfigureTxpowerTrack_8822B(pConfig); -#endif - -#if RTL8723D_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8723D) - ConfigureTxpowerTrack_8723D(pConfig); -#endif - -#if RTL8821C_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8821C) - ConfigureTxpowerTrack_8821C(pConfig); -#endif - -} - -//====================================================================== -// <20121113, Kordan> This function should be called when TxAGC changed. -// Otherwise the previous compensation is gone, because we record the -// delta of temperature between two TxPowerTracking watch dogs. -// -// NOTE: If Tx BB swing or Tx scaling is varified during run-time, still -// need to call this function. -//====================================================================== -VOID -ODM_ClearTxPowerTrackingState( - IN PDM_ODM_T pDM_Odm - ) -{ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pDM_Odm->Adapter); - u1Byte p = 0; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; - pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; - pRFCalibrateInfo->CCK_index = 0; - - for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) - { - pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; - - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - pRFCalibrateInfo->DeltaPowerIndex[p] = 0; - pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; - - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = 0; /* Initial Mix mode power tracking*/ - pRFCalibrateInfo->Remnant_OFDMSwingIdx[p] = 0; - pRFCalibrateInfo->KfreeOffset[p] = 0; - } - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Modify_TxAGC_Flag_PathC = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Modify_TxAGC_Flag_PathD = FALSE; /*Initial at Modify Tx Scaling Mode*/ - pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; - pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; - - pRFCalibrateInfo->Modify_TxAGC_Value_CCK=0; //modify by Mingzhi.Guo - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM=0; //modify by Mingzhi.Guo - -} - -VOID -ODM_TXPowerTrackingCallback_ThermalMeter( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER Adapter -#endif - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -#endif -#endif - - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - u1Byte ThermalValue = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; - s1Byte diff_DPK[4] = {0}; - u1Byte ThermalValue_AVG_count = 0; - u4Byte ThermalValue_AVG = 0, RegC80, RegCd0, RegCd4, Regab4; - - u1Byte OFDM_min_index = 0; // OFDM BB Swing should be less than +3.0dB, which is required by Arthur - u1Byte Indexforchannel = 0; // GetRightChnlPlaceforIQK(pHalData->CurrentChannel) - u1Byte PowerTrackingType = pHalData->RfPowerTrackingType; - u1Byte XtalOffsetEanble = 0; - - TXPWRTRACK_CFG c; - - //4 1. The following TWO tables decide the final index of OFDM/CCK swing table. - pu1Byte deltaSwingTableIdx_TUP_A = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_A = NULL; - pu1Byte deltaSwingTableIdx_TUP_B = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_B = NULL; - /*for 8814 add by Yu Chen*/ - pu1Byte deltaSwingTableIdx_TUP_C = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_C = NULL; - pu1Byte deltaSwingTableIdx_TUP_D = NULL; - pu1Byte deltaSwingTableIdx_TDOWN_D = NULL; - /*for Xtal Offset by James.Tung*/ - ps1Byte deltaSwingTableXtal_UP = NULL; - ps1Byte deltaSwingTableXtal_DOWN = NULL; - - //4 2. Initilization ( 7 steps in total ) - - ConfigureTxpowerTrack(pDM_Odm, &c); - - (*c.GetDeltaSwingTable)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_A, (pu1Byte *)&deltaSwingTableIdx_TDOWN_A, - (pu1Byte *)&deltaSwingTableIdx_TUP_B, (pu1Byte *)&deltaSwingTableIdx_TDOWN_B); - - if (pDM_Odm->SupportICType & ODM_RTL8814A) /*for 8814 path C & D*/ - (*c.GetDeltaSwingTable8814only)(pDM_Odm, (pu1Byte *)&deltaSwingTableIdx_TUP_C, (pu1Byte *)&deltaSwingTableIdx_TDOWN_C, - (pu1Byte *)&deltaSwingTableIdx_TUP_D, (pu1Byte *)&deltaSwingTableIdx_TDOWN_D); - - if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) /*for Xtal Offset*/ - (*c.GetDeltaSwingXtalTable)(pDM_Odm, (ps1Byte *)&deltaSwingTableXtal_UP, (ps1Byte *)&deltaSwingTableXtal_DOWN); - - - pRFCalibrateInfo->TXPowerTrackingCallbackCnt++; /*cosa add for debug*/ - pRFCalibrateInfo->bTXPowerTrackingInit = TRUE; - - /*pRFCalibrateInfo->TxPowerTrackControl = pHalData->TxPowerTrackControl; - We should keep updating the control variable according to HalData. - RFCalibrateInfo.RegA24 will be initialized when ODM HW configuring, but MP configures with para files. */ - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - #if (MP_DRIVER == 1) - pRFCalibrateInfo->RegA24 = 0x090e1317; - #endif - #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - if (pDM_Odm->mp_mode == TRUE) - pRFCalibrateInfo->RegA24 = 0x090e1317; - #endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("===>ODM_TXPowerTrackingCallback_ThermalMeter\n pRFCalibrateInfo->BbSwingIdxCckBase: %d, pRFCalibrateInfo->BbSwingIdxOfdmBase[A]: %d, pRFCalibrateInfo->DefaultOfdmIndex: %d\n", - pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A], pRFCalibrateInfo->DefaultOfdmIndex)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("pRFCalibrateInfo->TxPowerTrackControl=%d, pHalData->EEPROMThermalMeter %d\n", pRFCalibrateInfo->TxPowerTrackControl, pHalData->EEPROMThermalMeter)); - ThermalValue = (u1Byte)ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, c.ThermalRegAddr, 0xfc00); //0x42: RF Reg[15:10] 88E - - /*add log by zhao he, check c80/c94/c14/ca0 value*/ - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); - RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); - RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); - Regab4 = ODM_GetBBReg(pDM_Odm, 0xab4, 0x000007FF); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", RegC80, RegCd0, RegCd4, Regab4)); - } - - if (!pRFCalibrateInfo->TxPowerTrackControl) - return; - - - /*4 3. Initialize ThermalValues of RFCalibrateInfo*/ - - if (pRFCalibrateInfo->bReloadtxpowerindex) - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("reload ofdm index for band switch\n")); - - /*4 4. Calculate average thermal meter*/ - - pRFCalibrateInfo->ThermalValue_AVG[pRFCalibrateInfo->ThermalValue_AVG_index] = ThermalValue; - pRFCalibrateInfo->ThermalValue_AVG_index++; - if (pRFCalibrateInfo->ThermalValue_AVG_index == c.AverageThermalNum) /*Average times = c.AverageThermalNum*/ - pRFCalibrateInfo->ThermalValue_AVG_index = 0; - - for(i = 0; i < c.AverageThermalNum; i++) - { - if (pRFCalibrateInfo->ThermalValue_AVG[i]) { - ThermalValue_AVG += pRFCalibrateInfo->ThermalValue_AVG[i]; - ThermalValue_AVG_count++; - } - } - - if(ThermalValue_AVG_count) //Calculate Average ThermalValue after average enough times - { - ThermalValue = (u1Byte)(ThermalValue_AVG / ThermalValue_AVG_count); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("AVG Thermal Meter = 0x%X, EFUSE Thermal Base = 0x%X\n", ThermalValue, pHalData->EEPROMThermalMeter)); - } - - //4 5. Calculate delta, delta_LCK, delta_IQK. - - //"delta" here is used to determine whether thermal value changes or not. - delta = (ThermalValue > pRFCalibrateInfo->ThermalValue)?(ThermalValue - pRFCalibrateInfo->ThermalValue):(pRFCalibrateInfo->ThermalValue - ThermalValue); - delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); - delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); - - if (pRFCalibrateInfo->ThermalValue_IQK == 0xff) { /*no PG, use thermal value for IQK*/ - pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; - delta_IQK = (ThermalValue > pRFCalibrateInfo->ThermalValue_IQK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_IQK):(pRFCalibrateInfo->ThermalValue_IQK - ThermalValue); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use ThermalValue for IQK\n")); - } - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - diff_DPK[p] = (s1Byte)ThermalValue - (s1Byte)pRFCalibrateInfo->DpkThermal[p]; - - /*4 6. If necessary, do LCK.*/ - - if (!(pDM_Odm->SupportICType & ODM_RTL8821)) { /*no PG , do LCK at initial status*/ - if (pRFCalibrateInfo->ThermalValue_LCK == 0xff) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); - pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; - - /*Use RTLCK, so close power tracking driver LCK*/ - if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { - if (c.PHY_LCCalibrate) - (*c.PHY_LCCalibrate)(pDM_Odm); - } - - delta_LCK = (ThermalValue > pRFCalibrateInfo->ThermalValue_LCK)?(ThermalValue - pRFCalibrateInfo->ThermalValue_LCK):(pRFCalibrateInfo->ThermalValue_LCK - ThermalValue); - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); - - /* Delta temperature is equal to or larger than 20 centigrade.*/ - if (delta_LCK >= c.Threshold_IQK) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= Threshold_IQK(%d)\n", delta_LCK, c.Threshold_IQK)); - pRFCalibrateInfo->ThermalValue_LCK = ThermalValue; - - /*Use RTLCK, so close power tracking driver LCK*/ - if (!(pDM_Odm->SupportICType & ODM_RTL8814A)) { - if (c.PHY_LCCalibrate) - (*c.PHY_LCCalibrate)(pDM_Odm); - } - } - } - - /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ - - if (delta > 0 && pRFCalibrateInfo->TxPowerTrackControl) - { - //"delta" here is used to record the absolute value of differrence. -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - delta = ThermalValue > pHalData->EEPROMThermalMeter?(ThermalValue - pHalData->EEPROMThermalMeter):(pHalData->EEPROMThermalMeter - ThermalValue); -#else - delta = (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther)?(ThermalValue - pDM_Odm->priv->pmib->dot11RFEntry.ther):(pDM_Odm->priv->pmib->dot11RFEntry.ther - ThermalValue); -#endif - if (delta >= TXPWR_TRACK_TABLE_SIZE) - delta = TXPWR_TRACK_TABLE_SIZE - 1; - - /*4 7.1 The Final Power Index = BaseIndex + PowerIndexOffset*/ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(ThermalValue > pHalData->EEPROMThermalMeter) { -#else - if(ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -#endif - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_B[%d] = %d\n", delta, deltaSwingTableIdx_TUP_B[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_B[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_B[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_C[%d] = %d\n", delta, deltaSwingTableIdx_TUP_C[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_C[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_C[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_D[%d] = %d\n", delta, deltaSwingTableIdx_TUP_D[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_D[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_D[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TUP_A[%d] = %d\n", delta, deltaSwingTableIdx_TUP_A[delta])); - - pRFCalibrateInfo->DeltaPowerIndex[p] = deltaSwingTableIdx_TUP_A[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = deltaSwingTableIdx_TUP_A[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is higher and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - } - } - - if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { - /*Save XtalOffset from Xtal table*/ - pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("[Xtal] deltaSwingTableXtal_UP[%d] = %d\n", delta, deltaSwingTableXtal_UP[delta])); - pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_UP[delta]; - - if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) - XtalOffsetEanble = 0; - else - XtalOffsetEanble = 1; - } - - } else { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - pRFCalibrateInfo->DeltaPowerIndexLast[p] = pRFCalibrateInfo->DeltaPowerIndex[p]; /*recording poer index offset*/ - - switch (p) { - case ODM_RF_PATH_B: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_B[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_B[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_B[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_B] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_C: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_C[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_C[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_C[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_C] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - case ODM_RF_PATH_D: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_D[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_D[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_D[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_D] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("deltaSwingTableIdx_TDOWN_A[%d] = %d\n", delta, deltaSwingTableIdx_TDOWN_A[delta])); - pRFCalibrateInfo->DeltaPowerIndex[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; - pRFCalibrateInfo->Absolute_OFDMSwingIdx[p] = -1 * deltaSwingTableIdx_TDOWN_A[delta]; /*Record delta swing for mix mode power tracking*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("******Temp is lower and pRFCalibrateInfo->Absolute_OFDMSwingIdx[ODM_RF_PATH_A] = %d\n", pRFCalibrateInfo->Absolute_OFDMSwingIdx[p])); - break; - } - } - - if (pDM_Odm->SupportICType & (ODM_RTL8703B | ODM_RTL8723D)) { - /*Save XtalOffset from Xtal table*/ - pRFCalibrateInfo->XtalOffsetLast = pRFCalibrateInfo->XtalOffset; /*recording last Xtal offset*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("[Xtal] deltaSwingTableXtal_DOWN[%d] = %d\n", delta, deltaSwingTableXtal_DOWN[delta])); - pRFCalibrateInfo->XtalOffset = deltaSwingTableXtal_DOWN[delta]; - - if (pRFCalibrateInfo->XtalOffsetLast == pRFCalibrateInfo->XtalOffset) - XtalOffsetEanble = 0; - else - XtalOffsetEanble = 1; - } - - } - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n\n=========================== [Path-%d] Calculating PowerIndexOffset===========================\n", p)); - - if (pRFCalibrateInfo->DeltaPowerIndex[p] == pRFCalibrateInfo->DeltaPowerIndexLast[p]) /*If Thermal value changes but lookup table value still the same*/ - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - else - pRFCalibrateInfo->PowerIndexOffset[p] = pRFCalibrateInfo->DeltaPowerIndex[p] - pRFCalibrateInfo->DeltaPowerIndexLast[p]; /*Power Index Diff between 2 times Power Tracking*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("[Path-%d] PowerIndexOffset(%d) = DeltaPowerIndex(%d) - DeltaPowerIndexLast(%d)\n", p, pRFCalibrateInfo->PowerIndexOffset[p], pRFCalibrateInfo->DeltaPowerIndex[p], pRFCalibrateInfo->DeltaPowerIndexLast[p])); - - pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->BbSwingIdxOfdmBase[p] + pRFCalibrateInfo->PowerIndexOffset[p]; - pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->BbSwingIdxCckBase + pRFCalibrateInfo->PowerIndexOffset[p]; - - pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->CCK_index; - pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->OFDM_index[p]; - - /*************Print BB Swing Base and Index Offset*************/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The 'CCK' final index(%d) = BaseIndex(%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxCck, pRFCalibrateInfo->BbSwingIdxCckBase, pRFCalibrateInfo->PowerIndexOffset[p])); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + PowerIndexOffset(%d)\n", pRFCalibrateInfo->BbSwingIdxOfdm[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p], pRFCalibrateInfo->PowerIndexOffset[p])); - - /*4 7.1 Handle boundary conditions of index.*/ - - if (pRFCalibrateInfo->OFDM_index[p] > c.SwingTableSize_OFDM-1) - pRFCalibrateInfo->OFDM_index[p] = c.SwingTableSize_OFDM-1; - else if (pRFCalibrateInfo->OFDM_index[p] <= OFDM_min_index) - pRFCalibrateInfo->OFDM_index[p] = OFDM_min_index; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("\n\n========================================================================================================\n")); - - if (pRFCalibrateInfo->CCK_index > c.SwingTableSize_CCK-1) - pRFCalibrateInfo->CCK_index = c.SwingTableSize_CCK-1; - else if (pRFCalibrateInfo->CCK_index <= 0) - pRFCalibrateInfo->CCK_index = 0; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("The thermal meter is unchanged or TxPowerTracking OFF(%d): ThermalValue: %d , pRFCalibrateInfo->ThermalValue: %d\n", - pRFCalibrateInfo->TxPowerTrackControl, ThermalValue, pRFCalibrateInfo->ThermalValue)); - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [CCK] Swing Current Index: %d, Swing Base Index: %d\n", - pRFCalibrateInfo->CCK_index, pRFCalibrateInfo->BbSwingIdxCckBase)); /*Print Swing base & current*/ - - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("TxPowerTracking: [OFDM] Swing Current Index: %d, Swing Base Index[%d]: %d\n", - pRFCalibrateInfo->OFDM_index[p], p, pRFCalibrateInfo->BbSwingIdxOfdmBase[p])); - } - - if ((pDM_Odm->SupportICType & ODM_RTL8814A)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PowerTrackingType=%d\n", PowerTrackingType)); - - if (PowerTrackingType == 0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } else if (PowerTrackingType == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_2G_TSSI_5G_MODE, p, 0); - } else if (PowerTrackingType == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_5G_TSSI_2G_MODE, p, 0); - } else if (PowerTrackingType == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, TSSI_MODE, p, 0); - } - pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ - - } else if ((pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A] != 0 || - pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B] != 0 || - pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_C] != 0 || - pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_D] != 0) && - pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { - //4 7.2 Configure the Swing Table to adjust Tx Power. - - pRFCalibrateInfo->bTxPowerChanged = TRUE; /*Always TRUE after Tx Power is adjusted by power tracking.*/ - // - // 2012/04/23 MH According to Luke's suggestion, we can not write BB digital - // to increase TX power. Otherwise, EVM will be bad. - // - // 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. - if (ThermalValue > pRFCalibrateInfo->ThermalValue) { - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature Increasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", - p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); - } - } else if (ThermalValue < pRFCalibrateInfo->ThermalValue) { /*Low temperature*/ - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature Decreasing(%d): delta_pi: %d , delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", - p, pRFCalibrateInfo->PowerIndexOffset[p], delta, ThermalValue, pHalData->EEPROMThermalMeter, pRFCalibrateInfo->ThermalValue)); - } - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (ThermalValue > pHalData->EEPROMThermalMeter) -#else - if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) -#endif - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || - pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || - pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || - pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, 0); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); - } - } - else - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8821 || - pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8814A || - pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8822B || - pDM_Odm->SupportICType == ODM_RTL8723D || pDM_Odm->SupportICType == ODM_RTL8821C) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, MIX_MODE, p, Indexforchannel); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - (*c.ODM_TxPwrTrackSetPwr)(pDM_Odm, BBSWING, p, Indexforchannel); - } - - } - - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->BbSwingIdxCck; /*Record last time Power Tracking result as base.*/ - for (p = ODM_RF_PATH_A; p < c.RfPathCount; p++) - pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->BbSwingIdxOfdm[p]; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("pRFCalibrateInfo->ThermalValue = %d ThermalValue= %d\n", pRFCalibrateInfo->ThermalValue, ThermalValue)); - - pRFCalibrateInfo->ThermalValue = ThermalValue; /*Record last Power Tracking Thermal Value*/ - - } - - - if (pDM_Odm->SupportICType == ODM_RTL8703B || pDM_Odm->SupportICType == ODM_RTL8723D) { - - if (XtalOffsetEanble != 0 && pRFCalibrateInfo->TxPowerTrackControl && (pHalData->EEPROMThermalMeter != 0xff)) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (ThermalValue > pHalData->EEPROMThermalMeter) { -#else - if (ThermalValue > pDM_Odm->priv->pmib->dot11RFEntry.ther) { -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) higher than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("Temperature(%d) lower than PG value(%d)\n", ThermalValue, pHalData->EEPROMThermalMeter)); - (*c.ODM_TxXtalTrackSetXtal)(pDM_Odm); - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); - } - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (!IS_HARDWARE_TYPE_8723B(Adapter)) { - /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ - if (delta_IQK >= c.Threshold_IQK) { - pRFCalibrateInfo->ThermalValue_IQK = ThermalValue; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= Threshold_IQK(%d)\n", delta_IQK, c.Threshold_IQK)); - if (!pRFCalibrateInfo->bIQKInProgress) - (*c.DoIQK)(pDM_Odm, delta_IQK, ThermalValue, 8); - } - } - if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_A] != 0) { - if (diff_DPK[ODM_RF_PATH_A] >= c.Threshold_DPK) { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK)); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_A] <= -1 * c.Threshold_DPK)) { - s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_A] / c.Threshold_DPK); - - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, value); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xcc4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } - } - if (pRFCalibrateInfo->DpkThermal[ODM_RF_PATH_B] != 0) { - if (diff_DPK[ODM_RF_PATH_B] >= c.Threshold_DPK) { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK)); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else if ((diff_DPK[ODM_RF_PATH_B] <= -1 * c.Threshold_DPK)) { - s4Byte value = 0x20 + (diff_DPK[ODM_RF_PATH_B] / c.Threshold_DPK); - - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, value); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } else { - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x1); - ODM_SetBBReg(pDM_Odm, 0xec4, BIT14|BIT13|BIT12|BIT11|BIT10, 0); - ODM_SetBBReg(pDM_Odm, 0x82c, BIT(31), 0x0); - } - } - -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===ODM_TXPowerTrackingCallback_ThermalMeter\n")); - - pRFCalibrateInfo->TXPowercount = 0; -} - - - -//3============================================================ -//3 IQ Calibration -//3============================================================ - -VOID -ODM_ResetIQKResult( - IN PDM_ODM_T pDM_Odm -) -{ - return; -} -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -u1Byte ODM_GetRightChnlPlaceforIQK(u1Byte chnl) -{ - u1Byte channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = - {1,2,3,4,5,6,7,8,9,10,11,12,13,14,36,38,40,42,44,46,48,50,52,54,56,58,60,62,64,100,102,104,106,108,110,112,114,116,118,120,122,124,126,128,130,132,134,136,138,140,149,151,153,155,157,159,161,163,165}; - u1Byte place = chnl; - - - if(chnl > 14) - { - for(place = 14; placeAdapter; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (*pDM_Odm->pIsFcsModeEnable) - return; -#endif - - if (pDM_Odm->bLinked) { - - if ((*pDM_Odm->pChannel != pDM_Odm->preChannel) && (!*pDM_Odm->pbScanInProcess)) { - pDM_Odm->preChannel = *pDM_Odm->pChannel; - pDM_Odm->LinkedInterval = 0; - } - - if (pDM_Odm->LinkedInterval < 3) - pDM_Odm->LinkedInterval++; - - if (pDM_Odm->LinkedInterval == 2) { - PHY_IQCalibrate(Adapter, FALSE); - } - } else - pDM_Odm->LinkedInterval = 0; - -} - -void phydm_rf_init(IN PDM_ODM_T pDM_Odm) -{ - - odm_TXPowerTrackingInit(pDM_Odm); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - ODM_ClearTxPowerTrackingState(pDM_Odm); -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) - PHY_IQCalibrate_8814A_Init(pDM_Odm); -#endif -#endif - -} - -void phydm_rf_watchdog(IN PDM_ODM_T pDM_Odm) -{ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - - if(!pMgntInfo->IQKBeforeConnection) - { - ODM_TXPowerTrackingCheck(pDM_Odm); - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - odm_IQCalibrate(pDM_Odm); - } -#endif -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.h deleted file mode 100644 index bf145920f21f..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halphyrf_win.h +++ /dev/null @@ -1,120 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - #ifndef __HAL_PHY_RF_H__ - #define __HAL_PHY_RF_H__ - -#include "phydm_kfree.h" -#if (RTL8814A_SUPPORT == 1) -#include "rtl8814a/phydm_iqk_8814a.h" -#endif - -#if (RTL8822B_SUPPORT == 1) -#include "rtl8822b/phydm_iqk_8822b.h" -#include "../mac/Halmac_type.h" -#endif -#include "phydm_powertracking_win.h" - -#if (RTL8821C_SUPPORT == 1) -#include "rtl8821c/phydm_iqk_8821c.h" -#endif - -typedef enum _SPUR_CAL_METHOD { - PLL_RESET, - AFE_PHASE_SEL -} SPUR_CAL_METHOD; - -typedef enum _PWRTRACK_CONTROL_METHOD { - BBSWING, - TXAGC, - MIX_MODE, - TSSI_MODE, - MIX_2G_TSSI_5G_MODE, - MIX_5G_TSSI_2G_MODE -} PWRTRACK_METHOD; - -typedef VOID(*FuncSetPwr)(PVOID, PWRTRACK_METHOD, u1Byte, u1Byte); -typedef VOID(*FuncIQK)(PVOID, u1Byte, u1Byte, u1Byte); -typedef VOID(*FuncLCK)(PVOID); -typedef VOID(*FuncSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -typedef VOID(*FuncSwing8814only)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); -typedef VOID (*FuncSwingXtal)(PVOID, ps1Byte*, ps1Byte*); -typedef VOID (*FuncSetXtal)(PVOID); -typedef VOID(*FuncAllSwing)(PVOID, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*, pu1Byte*); - -typedef struct _TXPWRTRACK_CFG { - u1Byte SwingTableSize_CCK; - u1Byte SwingTableSize_OFDM; - u1Byte Threshold_IQK; - u1Byte Threshold_DPK; - u1Byte AverageThermalNum; - u1Byte RfPathCount; - u4Byte ThermalRegAddr; - FuncSetPwr ODM_TxPwrTrackSetPwr; - FuncIQK DoIQK; - FuncLCK PHY_LCCalibrate; - FuncSwing GetDeltaSwingTable; - FuncSwing8814only GetDeltaSwingTable8814only; - FuncSwingXtal GetDeltaSwingXtalTable; - FuncSetXtal ODM_TxXtalTrackSetXtal; - FuncAllSwing GetDeltaAllSwingTable; -} TXPWRTRACK_CFG, *PTXPWRTRACK_CFG; - -VOID -ConfigureTxpowerTrack( - IN PDM_ODM_T pDM_Odm, - OUT PTXPWRTRACK_CFG pConfig - ); - - -VOID -ODM_ClearTxPowerTrackingState( - IN PDM_ODM_T pDM_Odm - ); - -VOID -ODM_TXPowerTrackingCallback_ThermalMeter( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER Adapter -#endif - ); - - - -#define ODM_TARGET_CHNL_NUM_2G_5G 59 - - -VOID -ODM_ResetIQKResult( - IN PDM_ODM_T pDM_Odm -); -u1Byte -ODM_GetRightChnlPlaceforIQK( - IN u1Byte chnl -); - -VOID odm_IQCalibrate(IN PDM_ODM_T pDM_Odm); -VOID phydm_rf_init( IN PDM_ODM_T pDM_Odm); -VOID phydm_rf_watchdog( IN PDM_ODM_T pDM_Odm); - -#endif // #ifndef __HAL_PHY_RF_H__ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.c new file mode 100644 index 000000000000..44fc908c858d --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.c @@ -0,0 +1,1353 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +#ifndef index_mapping_NUM_88E + #define index_mapping_NUM_88E 15 +#endif + +/* #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) */ + +#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal) \ + do {\ + for (_offset = 0; _offset < _size; _offset++) { \ + \ + if (_delta_thermal < thermal_threshold[_direction][_offset]) { \ + \ + if (_offset != 0)\ + _offset--;\ + break;\ + } \ + } \ + if (_offset >= _size)\ + _offset = _size-1;\ + } while (0) + + +void configure_txpower_track( + void *p_dm_void, + struct _TXPWRTRACK_CFG *p_config +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if RTL8812A_SUPPORT +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /* if (IS_HARDWARE_TYPE_8812(p_dm->adapter)) */ + if (p_dm->support_ic_type == ODM_RTL8812) + configure_txpower_track_8812a(p_config); + /* else */ +#endif +#endif + +#if RTL8814A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8814A) + configure_txpower_track_8814a(p_config); +#endif + + +#if RTL8188E_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8188E) + configure_txpower_track_8188e(p_config); +#endif + +#if RTL8197F_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8197F) + configure_txpower_track_8197f(p_config); +#endif + +#if RTL8822B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8822B) + configure_txpower_track_8822b(p_config); +#endif + + +} + +#if (RTL8192E_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_92e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u8 thermal_value = 0, delta, delta_IQK, delta_LCK, channel, is_decrease, rf_mimo_mode; + u8 thermal_value_avg_count = 0; + u8 OFDM_min_index = 10; /* OFDM BB Swing should be less than +2.5dB, which is required by Arthur */ + s8 OFDM_index[2], index ; + u32 thermal_value_avg = 0, reg0x18; + u32 i = 0, j = 0, rf; + s32 value32, CCK_index = 0, ele_A, ele_D, ele_C, X, Y; + struct rtl8192cd_priv *priv = p_dm->priv; + + rf_mimo_mode = p_dm->rf_type; + /* ODM_RT_TRACE(p_dm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("%s:%d rf_mimo_mode:%d\n", __FUNCTION__, __LINE__, rf_mimo_mode)); */ + +#ifdef MP_TEST + if ((OPMODE & WIFI_MP_STATE) || *(p_dm->p_mp_mode)) { + channel = priv->pshare->working_channel; + if (priv->pshare->mp_txpwr_tracking == false) + return; + } else +#endif + { + channel = (priv->pmib->dot11RFEntry.dot11channel); + } + + thermal_value = (unsigned char)odm_get_rf_reg(p_dm, RF_PATH_A, ODM_RF_T_METER_92E, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther)); + + + switch (rf_mimo_mode) { + case RF_1T1R: + rf = 1; + break; + case RF_2T2R: + rf = 2; + break; + default: + rf = 2; + break; + } + + /* Query OFDM path A default setting Bit[31:21] */ + ele_D = phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKOFDM_D); + for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { + if (ele_D == (ofdm_swing_table_92e[i] >> 22)) { + OFDM_index[0] = (unsigned char)i; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PathA 0xC80[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[0])); + break; + } + } + + /* Query OFDM path B default setting */ + if (rf_mimo_mode == RF_2T2R) { + ele_D = phy_query_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKOFDM_D); + for (i = 0; i < OFDM_TABLE_SIZE_92E; i++) { + if (ele_D == (ofdm_swing_table_92e[i] >> 22)) { + OFDM_index[1] = (unsigned char)i; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("PathB 0xC88[31:22] = 0x%x, OFDM_index=%d\n", ele_D, OFDM_index[1])); + break; + } + } + } + + /* calculate average thermal meter */ + { + priv->pshare->thermal_value_avg_88xx[priv->pshare->thermal_value_avg_index_88xx] = thermal_value; + priv->pshare->thermal_value_avg_index_88xx++; + if (priv->pshare->thermal_value_avg_index_88xx == AVG_THERMAL_NUM_88XX) + priv->pshare->thermal_value_avg_index_88xx = 0; + + for (i = 0; i < AVG_THERMAL_NUM_88XX; i++) { + if (priv->pshare->thermal_value_avg_88xx[i]) { + thermal_value_avg += priv->pshare->thermal_value_avg_88xx[i]; + thermal_value_avg_count++; + } + } + + if (thermal_value_avg_count) { + thermal_value = (unsigned char)(thermal_value_avg / thermal_value_avg_count); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("AVG Thermal Meter = 0x%x\n", thermal_value)); + } + } + + /* Initialize */ + if (!priv->pshare->thermal_value) { + priv->pshare->thermal_value = priv->pmib->dot11RFEntry.ther; + priv->pshare->thermal_value_iqk = thermal_value; + priv->pshare->thermal_value_lck = thermal_value; + } + + if (thermal_value != priv->pshare->thermal_value) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** START POWER TRACKING ********\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther)); + + delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); + delta_IQK = RTL_ABS(thermal_value, priv->pshare->thermal_value_iqk); + delta_LCK = RTL_ABS(thermal_value, priv->pshare->thermal_value_lck); + is_decrease = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 1 : 0); + +#ifdef _TRACKING_TABLE_FILE + if (priv->pshare->rf_ft_var.pwr_track_file) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("diff: (%s)%d ==> get index from table : %d)\n", (is_decrease ? "-" : "+"), delta, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); + + if (is_decrease) { + for (i = 0; i < rf; i++) { + OFDM_index[i] = priv->pshare->OFDM_index0[i] + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); + OFDM_index[i] = ((OFDM_index[i] > (OFDM_TABLE_SIZE_92E- 1)) ? (OFDM_TABLE_SIZE_92E - 1) : OFDM_index[i]); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); + CCK_index = priv->pshare->CCK_index0 + get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); + CCK_index = ((CCK_index > (CCK_TABLE_SIZE_92E - 1)) ? (CCK_TABLE_SIZE_92E - 1) : CCK_index); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> Decrese power ---> new CCK_INDEX:%d (%d + %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); + } + } else { + for (i = 0; i < rf; i++) { + OFDM_index[i] = priv->pshare->OFDM_index0[i] - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0); + OFDM_index[i] = ((OFDM_index[i] < OFDM_min_index) ? OFDM_min_index : OFDM_index[i]); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> Increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[i], priv->pshare->OFDM_index0[i], get_tx_tracking_index(priv, channel, i, delta, is_decrease, 0))); + CCK_index = priv->pshare->CCK_index0 - get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1); + CCK_index = ((CCK_index < 0) ? 0 : CCK_index); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> Increse power ---> new CCK_INDEX:%d (%d - %d)\n", CCK_index, priv->pshare->CCK_index0, get_tx_tracking_index(priv, channel, i, delta, is_decrease, 1))); + } + } + } +#endif /* CFG_TRACKING_TABLE_FILE */ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ofdm_swing_table_92e[(unsigned int)OFDM_index[0]] = %x\n", ofdm_swing_table_92e[(unsigned int)OFDM_index[0]])); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ofdm_swing_table_92e[(unsigned int)OFDM_index[1]] = %x\n", ofdm_swing_table_92e[(unsigned int)OFDM_index[1]])); + + /* Adujst OFDM Ant_A according to IQK result */ + ele_D = (ofdm_swing_table_92e[(unsigned int)OFDM_index[0]] & 0xFFC00000) >> 22; + X = priv->pshare->rege94; + Y = priv->pshare->rege9c; + + if (X != 0) { + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + ele_A = ((X * ele_D) >> 8) & 0x000003FF; + + /* new element C = element D x Y */ + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + ele_C = ((Y * ele_D) >> 8) & 0x000003FF; + + /* wirte new elements A, C, D to regC80 and regC94, element B is always 0 */ + value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; + phy_set_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + phy_set_bb_reg(priv, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); + + value32 = ((X * ele_D) >> 7) & 0x01; + phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), value32); + } else { + phy_set_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_92e[(unsigned int)OFDM_index[0]]); + phy_set_bb_reg(priv, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); + phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(24), 0x00); + } + + set_CCK_swing_index(priv, CCK_index); + + if (rf == 2) { + ele_D = (ofdm_swing_table_92e[(unsigned int)OFDM_index[1]] & 0xFFC00000) >> 22; + X = priv->pshare->regeb4; + Y = priv->pshare->regebc; + + if (X != 0) { + if ((X & 0x00000200) != 0) /* consider minus */ + X = X | 0xFFFFFC00; + ele_A = ((X * ele_D) >> 8) & 0x000003FF; + + /* new element C = element D x Y */ + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + ele_C = ((Y * ele_D) >> 8) & 0x00003FF; + + /* wirte new elements A, C, D to regC88 and regC9C, element B is always 0 */ + value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; + phy_set_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, value32); + + value32 = (ele_C & 0x000003C0) >> 6; + phy_set_bb_reg(priv, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, value32); + + value32 = ((X * ele_D) >> 7) & 0x01; + phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), value32); + } else { + phy_set_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_92e[(unsigned int)OFDM_index[1]]); + phy_set_bb_reg(priv, REG_OFDM_0_XD_TX_AFE, MASKH4BITS, 0x00); + phy_set_bb_reg(priv, REG_OFDM_0_ECCA_THRESHOLD, BIT(28), 0x00); + } + + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc80 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD))); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc88 = 0x%x\n", phy_query_bb_reg(priv, REG_OFDM_0_XB_TX_IQ_IMBALANCE, MASKDWORD))); + + if ((delta_IQK > 3) && (!p_iqk_info->rfk_forbidden)) { + priv->pshare->thermal_value_iqk = thermal_value; +#ifdef MP_TEST +#endif if (!(*(p_dm->p_mp_mode) && (OPMODE & (WIFI_MP_CTX_BACKGROUND | WIFI_MP_CTX_PACKET)))) + + halrf_iqk_trigger(p_dm, false); + } + + if ((delta_LCK > 8) && (!p_iqk_info->rfk_forbidden)) { + RTL_W8(0x522, 0xff); + reg0x18 = phy_query_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, 1); + phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 1); + phy_set_rf_reg(priv, RF_PATH_A, 0x18, BIT(15), 1); + delay_ms(1); + phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 0); + phy_set_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, reg0x18); + RTL_W8(0x522, 0x0); + priv->pshare->thermal_value_lck = thermal_value; + } + } + + /* update thermal meter value */ + priv->pshare->thermal_value = thermal_value; + for (i = 0 ; i < rf ; i++) + priv->pshare->OFDM_index[i] = OFDM_index[i]; + priv->pshare->CCK_index = CCK_index; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); +} +#endif + + + +#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_jaguar_series3( + void *p_dm_void +) +{ +#if 1 + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 thermal_value = 0, delta, delta_LCK, delta_IQK, channel, is_increase; + u8 thermal_value_avg_count = 0, p = 0, i = 0; + u32 thermal_value_avg = 0; + struct rtl8192cd_priv *priv = p_dm->priv; + struct _TXPWRTRACK_CFG c; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + /*4 1. The following TWO tables decide the final index of OFDM/CCK swing table.*/ + u8 *delta_swing_table_idx_tup_a = NULL, *delta_swing_table_idx_tdown_a = NULL; + u8 *delta_swing_table_idx_tup_b = NULL, *delta_swing_table_idx_tdown_b = NULL; + u8 *delta_swing_table_idx_tup_cck_a = NULL, *delta_swing_table_idx_tdown_cck_a = NULL; + u8 *delta_swing_table_idx_tup_cck_b = NULL, *delta_swing_table_idx_tdown_cck_b = NULL; + /*for 8814 add by Yu Chen*/ + u8 *delta_swing_table_idx_tup_c = NULL, *delta_swing_table_idx_tdown_c = NULL; + u8 *delta_swing_table_idx_tup_d = NULL, *delta_swing_table_idx_tdown_d = NULL; + u8 *delta_swing_table_idx_tup_cck_c = NULL, *delta_swing_table_idx_tdown_cck_c = NULL; + u8 *delta_swing_table_idx_tup_cck_d = NULL, *delta_swing_table_idx_tdown_cck_d = NULL; + +#ifdef MP_TEST + if ((OPMODE & WIFI_MP_STATE) || *(p_dm->p_mp_mode)) { + channel = priv->pshare->working_channel; + if (priv->pshare->mp_txpwr_tracking == false) + return; + } else +#endif + { + channel = (priv->pmib->dot11RFEntry.dot11channel); + } + + configure_txpower_track(p_dm, &c); + + (*c.get_delta_all_swing_table)(p_dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, + (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b, + (u8 **)&delta_swing_table_idx_tup_cck_a, (u8 **)&delta_swing_table_idx_tdown_cck_a, + (u8 **)&delta_swing_table_idx_tup_cck_b, (u8 **)&delta_swing_table_idx_tdown_cck_b); + + thermal_value = (u8)odm_get_rf_reg(p_dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /*0x42: RF Reg[15:10] 88E*/ +#ifdef THER_TRIM + if (GET_CHIP_VER(priv) == VERSION_8197F) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("orig thermal_value=%d, ther_trim_val=%d\n", thermal_value, priv->pshare->rf_ft_var.ther_trim_val)); + + thermal_value += priv->pshare->rf_ft_var.ther_trim_val; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("after thermal trim, thermal_value=%d\n", thermal_value)); + } +#endif + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Readback Thermal Meter = 0x%x(%d) EEPROMthermalmeter 0x%x(%d)\n" + , thermal_value, thermal_value, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); + + /* Initialize */ + if (!p_dm->rf_calibrate_info.thermal_value) + p_dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; + + if (!p_dm->rf_calibrate_info.thermal_value_lck) + p_dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; + + if (!p_dm->rf_calibrate_info.thermal_value_iqk) + p_dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; + + /* calculate average thermal meter */ + p_dm->rf_calibrate_info.thermal_value_avg[p_dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; + p_dm->rf_calibrate_info.thermal_value_avg_index++; + + if (p_dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + p_dm->rf_calibrate_info.thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (p_dm->rf_calibrate_info.thermal_value_avg[i]) { + thermal_value_avg += p_dm->rf_calibrate_info.thermal_value_avg[i]; + thermal_value_avg_count++; + } + } + + if (thermal_value_avg_count) {/*Calculate Average thermal_value after average enough times*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("thermal_value_avg=0x%x(%d) thermal_value_avg_count = %d\n" + , thermal_value_avg, thermal_value_avg, thermal_value_avg_count)); + + thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("AVG Thermal Meter = 0x%X(%d), EEPROMthermalmeter = 0x%X(%d)\n", thermal_value, thermal_value, priv->pmib->dot11RFEntry.ther, priv->pmib->dot11RFEntry.ther)); + } + + /*4 Calculate delta, delta_LCK, delta_IQK.*/ + delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); + delta_LCK = RTL_ABS(thermal_value, p_dm->rf_calibrate_info.thermal_value_lck); + delta_IQK = RTL_ABS(thermal_value, p_dm->rf_calibrate_info.thermal_value_iqk); + is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1); + + if (delta > 29) { /* power track table index(thermal diff.) upper bound*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta(%d) > 29, set delta to 29\n", delta)); + delta = 29; + } + + + /*4 if necessary, do LCK.*/ + if ((delta_LCK > c.threshold_iqk) && (!p_iqk_info->rfk_forbidden)) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk)); + p_dm->rf_calibrate_info.thermal_value_lck = thermal_value; +#if (RTL8822B_SUPPORT != 1) + if (!(p_dm->support_ic_type & ODM_RTL8822B)) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(p_dm); + } +#endif + } + + if ((delta_IQK > c.threshold_iqk) && (!p_iqk_info->rfk_forbidden)) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk)); + p_dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + if (c.do_iqk) + (*c.do_iqk)(p_dm, true, 0, 0); + } + + if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ + return; + + /*4 Do Power Tracking*/ + + if (thermal_value != p_dm->rf_calibrate_info.thermal_value) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\n\n******** START POWER TRACKING ********\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Readback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", + thermal_value, p_dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther)); + +#ifdef _TRACKING_TABLE_FILE + if (priv->pshare->rf_ft_var.pwr_track_file) { + if (is_increase) { /*thermal is higher than base*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_b[%d] = %d delta_swing_table_idx_tup_cck_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta], delta, delta_swing_table_idx_tup_cck_b[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_cck_b[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_c[%d] = %d delta_swing_table_idx_tup_cck_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta], delta, delta_swing_table_idx_tup_cck_c[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_cck_c[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_d[%d] = %d delta_swing_table_idx_tup_cck_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta], delta, delta_swing_table_idx_tup_cck_d[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_cck_d[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_a[%d] = %d delta_swing_table_idx_tup_cck_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta], delta, delta_swing_table_idx_tup_cck_a[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = delta_swing_table_idx_tup_cck_a[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + } + } + } else { /* thermal is lower than base*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_b[%d] = %d delta_swing_table_idx_tdown_cck_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta], delta, delta_swing_table_idx_tdown_cck_b[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_cck_b[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_B] = %d pRF->absolute_cck_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_c[%d] = %d delta_swing_table_idx_tdown_cck_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta], delta, delta_swing_table_idx_tdown_cck_c[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_cck_c[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_C] = %d pRF->absolute_cck_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_d[%d] = %d delta_swing_table_idx_tdown_cck_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta], delta, delta_swing_table_idx_tdown_cck_d[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_cck_d[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_D] = %d pRF->absolute_cck_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_a[%d] = %d delta_swing_table_idx_tdown_cck_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta], delta, delta_swing_table_idx_tdown_cck_a[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; + p_rf_calibrate_info->absolute_cck_swing_idx[p] = -1 * delta_swing_table_idx_tdown_cck_a[delta]; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and pRF->absolute_ofdm_swing_idx[RF_PATH_A] = %d pRF->absolute_cck_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p], p_rf_calibrate_info->absolute_cck_swing_idx[p])); + break; + } + } + } + + if (is_increase) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> increse power --->\n")); + if (GET_CHIP_VER(priv) == VERSION_8197F) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, p, 0); + } else if (GET_CHIP_VER(priv) == VERSION_8822B) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } else if (GET_CHIP_VER(priv) == VERSION_8821C) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power --->\n")); + if (GET_CHIP_VER(priv) == VERSION_8197F) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, p, 0); + } else if (GET_CHIP_VER(priv) == VERSION_8822B) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } else if (GET_CHIP_VER(priv) == VERSION_8821C) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } + } + } +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n\n", __func__)); + /*update thermal meter value*/ + p_dm->rf_calibrate_info.thermal_value = thermal_value; + + } + +#endif +} +#endif + +/*#if (RTL8814A_SUPPORT == 1)*/ +#if (RTL8814A_SUPPORT == 1) + +void +odm_txpowertracking_callback_thermal_meter_jaguar_series2( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 thermal_value = 0, delta, delta_LCK, delta_IQK, channel, is_increase; + u8 thermal_value_avg_count = 0, p = 0, i = 0; + u32 thermal_value_avg = 0, reg0x18; + u32 bb_swing_reg[4] = {REG_A_TX_SCALE_JAGUAR, REG_B_TX_SCALE_JAGUAR, REG_C_TX_SCALE_JAGUAR2, REG_D_TX_SCALE_JAGUAR2}; + s32 ele_D; + u32 bb_swing_idx; + struct rtl8192cd_priv *priv = p_dm->priv; + struct _TXPWRTRACK_CFG c; + boolean is_tssi_enable = false; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ + u8 *delta_swing_table_idx_tup_a = NULL, *delta_swing_table_idx_tdown_a = NULL; + u8 *delta_swing_table_idx_tup_b = NULL, *delta_swing_table_idx_tdown_b = NULL; + /* for 8814 add by Yu Chen */ + u8 *delta_swing_table_idx_tup_c = NULL, *delta_swing_table_idx_tdown_c = NULL; + u8 *delta_swing_table_idx_tup_d = NULL, *delta_swing_table_idx_tdown_d = NULL; + +#ifdef MP_TEST + if ((OPMODE & WIFI_MP_STATE) || *(p_dm->p_mp_mode)) { + channel = priv->pshare->working_channel; + if (priv->pshare->mp_txpwr_tracking == false) + return; + } else +#endif + { + channel = (priv->pmib->dot11RFEntry.dot11channel); + } + + configure_txpower_track(p_dm, &c); + p_rf_calibrate_info->default_ofdm_index = priv->pshare->OFDM_index0[RF_PATH_A]; + + (*c.get_delta_swing_table)(p_dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, + (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); + + if (p_dm->support_ic_type & ODM_RTL8814A) /* for 8814 path C & D */ + (*c.get_delta_swing_table8814only)(p_dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c, + (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d); + + thermal_value = (u8)odm_get_rf_reg(p_dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\nReadback Thermal Meter = 0x%x, pre thermal meter 0x%x, EEPROMthermalmeter 0x%x\n", thermal_value, p_dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther)); + + /* Initialize */ + if (!p_dm->rf_calibrate_info.thermal_value) + p_dm->rf_calibrate_info.thermal_value = priv->pmib->dot11RFEntry.ther; + + if (!p_dm->rf_calibrate_info.thermal_value_lck) + p_dm->rf_calibrate_info.thermal_value_lck = priv->pmib->dot11RFEntry.ther; + + if (!p_dm->rf_calibrate_info.thermal_value_iqk) + p_dm->rf_calibrate_info.thermal_value_iqk = priv->pmib->dot11RFEntry.ther; + + is_tssi_enable = (boolean)odm_get_rf_reg(p_dm, RF_PATH_A, REG_RF_TX_GAIN_OFFSET, BIT(7)); /* check TSSI enable */ + + /* 4 Query OFDM BB swing default setting Bit[31:21] */ + for (p = RF_PATH_A ; p < c.rf_path_count ; p++) { + ele_D = odm_get_bb_reg(p_dm, bb_swing_reg[p], 0xffe00000); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("0x%x:0x%x ([31:21] = 0x%x)\n", bb_swing_reg[p], odm_get_bb_reg(p_dm, bb_swing_reg[p], MASKDWORD), ele_D)); + + for (bb_swing_idx = 0; bb_swing_idx < TXSCALE_TABLE_SIZE; bb_swing_idx++) {/* 4 */ + if (ele_D == tx_scaling_table_jaguar[bb_swing_idx]) { + p_dm->rf_calibrate_info.OFDM_index[p] = (u8)bb_swing_idx; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("OFDM_index[%d]=%d\n", p, p_dm->rf_calibrate_info.OFDM_index[p])); + break; + } + } + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("kfree_offset[%d]=%d\n", p, p_rf_calibrate_info->kfree_offset[p])); + + } + + /* calculate average thermal meter */ + p_dm->rf_calibrate_info.thermal_value_avg[p_dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; + p_dm->rf_calibrate_info.thermal_value_avg_index++; + if (p_dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) /* Average times = c.average_thermal_num */ + p_dm->rf_calibrate_info.thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (p_dm->rf_calibrate_info.thermal_value_avg[i]) { + thermal_value_avg += p_dm->rf_calibrate_info.thermal_value_avg[i]; + thermal_value_avg_count++; + } + } + + if (thermal_value_avg_count) { /* Calculate Average thermal_value after average enough times */ + thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("AVG Thermal Meter = 0x%X, EEPROMthermalmeter = 0x%X\n", thermal_value, priv->pmib->dot11RFEntry.ther)); + } + + /* 4 Calculate delta, delta_LCK, delta_IQK. */ + delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); + delta_LCK = RTL_ABS(thermal_value, p_dm->rf_calibrate_info.thermal_value_lck); + delta_IQK = RTL_ABS(thermal_value, p_dm->rf_calibrate_info.thermal_value_iqk); + is_increase = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 0 : 1); + + /* 4 if necessary, do LCK. */ + if (!(p_dm->support_ic_type & ODM_RTL8821)) { + if ((delta_LCK > c.threshold_iqk) && (!p_iqk_info->rfk_forbidden)) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk)); + p_dm->rf_calibrate_info.thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ +#if (RTL8814A_SUPPORT != 1) + if (!(p_dm->support_ic_type & ODM_RTL8814A)) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(p_dm); + } +#endif + } + } + + if ((delta_IQK > c.threshold_iqk) && (!p_iqk_info->rfk_forbidden)) { + panic_printk("%s(%d)\n", __FUNCTION__, __LINE__); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk)); + p_dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + if (c.do_iqk) + (*c.do_iqk)(p_dm, true, 0, 0); + } + + if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ + return; + + /* 4 Do Power Tracking */ + + if (is_tssi_enable == true) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter PURE TSSI MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, TSSI_MODE, p, 0); + } else if (thermal_value != p_dm->rf_calibrate_info.thermal_value) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\n******** START POWER TRACKING ********\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, p_dm->rf_calibrate_info.thermal_value, priv->pmib->dot11RFEntry.ther)); + +#ifdef _TRACKING_TABLE_FILE + if (priv->pshare->rf_ft_var.pwr_track_file) { + if (is_increase) { /* thermal is higher than base */ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + } + } + } else { /* thermal is lower than base */ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_dm->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_dm->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_dm->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta])); + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /* Record delta swing for mix mode power tracking */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_dm->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + } + } + } + + if (is_increase) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> increse power --->\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power --->\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } + } +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); + /* update thermal meter value */ + p_dm->rf_calibrate_info.thermal_value = thermal_value; + + } +} +#endif + +#if (RTL8812A_SUPPORT == 1 || RTL8881A_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_jaguar_series( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + unsigned char thermal_value = 0, delta, delta_LCK, channel, is_decrease; + unsigned char thermal_value_avg_count = 0; + unsigned int thermal_value_avg = 0, reg0x18; + unsigned int bb_swing_reg[4] = {0xc1c, 0xe1c, 0x181c, 0x1a1c}; + int ele_D, value32; + char OFDM_index[2], index; + unsigned int i = 0, j = 0, rf_path, max_rf_path = 2, rf; + struct rtl8192cd_priv *priv = p_dm->priv; + unsigned char OFDM_min_index = 7; /* OFDM BB Swing should be less than +2.5dB, which is required by Arthur and Mimic */ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + +#ifdef MP_TEST + if ((OPMODE & WIFI_MP_STATE) || *(p_dm->p_mp_mode)) { + channel = priv->pshare->working_channel; + if (priv->pshare->mp_txpwr_tracking == false) + return; + } else +#endif + { + channel = (priv->pmib->dot11RFEntry.dot11channel); + } + +#if RTL8881A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8881A) { + max_rf_path = 1; + if ((get_bonding_type_8881A() == BOND_8881AM || get_bonding_type_8881A() == BOND_8881AN) + && priv->pshare->rf_ft_var.use_intpa8881A && (*p_dm->p_band_type == ODM_BAND_2_4G)) + OFDM_min_index = 6; /* intPA - upper bond set to +3 dB (base: -2 dB)ot11RFEntry.phy_band_select == PHY_BAND_2G)) */ + else + OFDM_min_index = 10; /* OFDM BB Swing should be less than +1dB, which is required by Arthur and Mimic */ + } +#endif + + + thermal_value = (unsigned char)phy_query_rf_reg(priv, RF_PATH_A, 0x42, 0xfc00, 1); /* 0x42: RF Reg[15:10] 88E */ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther)); + + + /* 4 Query OFDM BB swing default setting Bit[31:21] */ + for (rf_path = 0 ; rf_path < max_rf_path ; rf_path++) { + ele_D = phy_query_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0x%x:0x%x ([31:21] = 0x%x)\n", bb_swing_reg[rf_path], phy_query_bb_reg(priv, bb_swing_reg[rf_path], MASKDWORD), ele_D)); + for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {/* 4 */ + if (ele_D == ofdm_swing_table_8812[i]) { + OFDM_index[rf_path] = (unsigned char)i; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("OFDM_index[%d]=%d\n", rf_path, OFDM_index[rf_path])); + break; + } + } + } +#if 0 + /* Query OFDM path A default setting Bit[31:21] */ + ele_D = phy_query_bb_reg(priv, 0xc1c, 0xffe00000); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xc1c:0x%x ([31:21] = 0x%x)\n", phy_query_bb_reg(priv, 0xc1c, MASKDWORD), ele_D)); + for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) {/* 4 */ + if (ele_D == ofdm_swing_table_8812[i]) { + OFDM_index[0] = (unsigned char)i; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("OFDM_index[0]=%d\n", OFDM_index[0])); + break; + } + } + /* Query OFDM path B default setting */ + if (rf == 2) { + ele_D = phy_query_bb_reg(priv, 0xe1c, 0xffe00000); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("0xe1c:0x%x ([32:21] = 0x%x)\n", phy_query_bb_reg(priv, 0xe1c, MASKDWORD), ele_D)); + for (i = 0; i < OFDM_TABLE_SIZE_8812; i++) { + if (ele_D == ofdm_swing_table_8812[i]) { + OFDM_index[1] = (unsigned char)i; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("OFDM_index[1]=%d\n", OFDM_index[1])); + break; + } + } + } +#endif + /* Initialize */ + if (!priv->pshare->thermal_value) { + priv->pshare->thermal_value = priv->pmib->dot11RFEntry.ther; + priv->pshare->thermal_value_lck = thermal_value; + } + + /* calculate average thermal meter */ + { + priv->pshare->thermal_value_avg_8812[priv->pshare->thermal_value_avg_index_8812] = thermal_value; + priv->pshare->thermal_value_avg_index_8812++; + if (priv->pshare->thermal_value_avg_index_8812 == AVG_THERMAL_NUM_8812) + priv->pshare->thermal_value_avg_index_8812 = 0; + + for (i = 0; i < AVG_THERMAL_NUM_8812; i++) { + if (priv->pshare->thermal_value_avg_8812[i]) { + thermal_value_avg += priv->pshare->thermal_value_avg_8812[i]; + thermal_value_avg_count++; + } + } + + if (thermal_value_avg_count) { + thermal_value = (unsigned char)(thermal_value_avg / thermal_value_avg_count); + /* printk("AVG Thermal Meter = 0x%x\n", thermal_value); */ + } + } + + + /* 4 If necessary, do power tracking */ + + if (!priv->pmib->dot11RFEntry.ther) /*Don't do power tracking since no calibrated thermal value*/ + return; + + if (thermal_value != priv->pshare->thermal_value) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** START POWER TRACKING ********\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\nReadback Thermal Meter = 0x%x pre thermal meter 0x%x EEPROMthermalmeter 0x%x\n", thermal_value, priv->pshare->thermal_value, priv->pmib->dot11RFEntry.ther)); + delta = RTL_ABS(thermal_value, priv->pmib->dot11RFEntry.ther); + delta_LCK = RTL_ABS(thermal_value, priv->pshare->thermal_value_lck); + is_decrease = ((thermal_value < priv->pmib->dot11RFEntry.ther) ? 1 : 0); + /* if (*p_dm->p_band_type == ODM_BAND_5G) */ + { +#ifdef _TRACKING_TABLE_FILE + if (priv->pshare->rf_ft_var.pwr_track_file) { + for (rf_path = 0; rf_path < max_rf_path; rf_path++) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("diff: (%s)%d ==> get index from table : %d)\n", (is_decrease ? "-" : "+"), delta, get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); + if (is_decrease) { + OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] + get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); + OFDM_index[rf_path] = ((OFDM_index[rf_path] > (OFDM_TABLE_SIZE_8812 - 1)) ? (OFDM_TABLE_SIZE_8812 - 1) : OFDM_index[rf_path]); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> decrese power ---> new OFDM_INDEX:%d (%d + %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); +#if 0/* RTL8881A_SUPPORT */ + if (p_dm->support_ic_type == ODM_RTL8881A) { + if (priv->pshare->rf_ft_var.pwrtrk_tx_agc_enable) { + if (priv->pshare->add_tx_agc) { /* tx_agc has been added */ + add_tx_power88xx_ac(priv, 0); + priv->pshare->add_tx_agc = 0; + priv->pshare->add_tx_agc_index = 0; + } + } + } +#endif + } else { + + OFDM_index[rf_path] = priv->pshare->OFDM_index0[rf_path] - get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0); +#if 0/* RTL8881A_SUPPORT */ + if (p_dm->support_ic_type == ODM_RTL8881A) { + if (priv->pshare->rf_ft_var.pwrtrk_tx_agc_enable) { + if (OFDM_index[i] < OFDM_min_index) { + priv->pshare->add_tx_agc_index = (OFDM_min_index - OFDM_index[i]) / 2; /* Calculate Remnant tx_agc value, 2 index for 1 tx_agc */ + add_tx_power88xx_ac(priv, priv->pshare->add_tx_agc_index); + priv->pshare->add_tx_agc = 1; /* add_tx_agc Flag = 1 */ + OFDM_index[i] = OFDM_min_index; + } else { + if (priv->pshare->add_tx_agc) { /* tx_agc been added */ + priv->pshare->add_tx_agc = 0; + priv->pshare->add_tx_agc_index = 0; + add_tx_power88xx_ac(priv, 0); /* minus the added TPI */ + } + } + } + } +#else + OFDM_index[rf_path] = ((OFDM_index[rf_path] < OFDM_min_index) ? OFDM_min_index : OFDM_index[rf_path]); +#endif + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, (">>> increse power ---> new OFDM_INDEX:%d (%d - %d)\n", OFDM_index[rf_path], priv->pshare->OFDM_index0[rf_path], get_tx_tracking_index(priv, channel, rf_path, delta, is_decrease, 0))); + } + } + } +#endif + /* 4 Set new BB swing index */ + for (rf_path = 0; rf_path < max_rf_path; rf_path++) { + phy_set_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000, ofdm_swing_table_8812[(unsigned int)OFDM_index[rf_path]]); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Readback 0x%x[31:21] = 0x%x, OFDM_index:%d\n", bb_swing_reg[rf_path], phy_query_bb_reg(priv, bb_swing_reg[rf_path], 0xffe00000), OFDM_index[rf_path])); + } + + } + if ((delta_LCK > 8) && (!p_iqk_info->rfk_forbidden)) { + RTL_W8(0x522, 0xff); + reg0x18 = phy_query_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, 1); + phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 1); + phy_set_rf_reg(priv, RF_PATH_A, 0x18, BIT(15), 1); + delay_ms(200); /* frequency deviation */ + phy_set_rf_reg(priv, RF_PATH_A, 0xB4, BIT(14), 0); + phy_set_rf_reg(priv, RF_PATH_A, 0x18, MASK20BITS, reg0x18); +#ifdef CONFIG_RTL_8812_SUPPORT + if (GET_CHIP_VER(priv) == VERSION_8812E) + update_bbrf_val8812(priv, priv->pmib->dot11RFEntry.dot11channel); +#endif + RTL_W8(0x522, 0x0); + priv->pshare->thermal_value_lck = thermal_value; + } + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("\n******** END:%s() ********\n", __FUNCTION__)); + + /* update thermal meter value */ + priv->pshare->thermal_value = thermal_value; + for (rf_path = 0; rf_path < max_rf_path; rf_path++) + priv->pshare->OFDM_index[rf_path] = OFDM_index[rf_path]; + } +} + +#endif + + +void +odm_txpowertracking_callback_thermal_meter( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + +#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F || p_dm->support_ic_type == ODM_RTL8822B + || p_dm->support_ic_type == ODM_RTL8821C) { + odm_txpowertracking_callback_thermal_meter_jaguar_series3(p_dm); + return; + } +#endif +#if (RTL8814A_SUPPORT == 1) /*use this function to do power tracking after 8814 by YuChen*/ + if (p_dm->support_ic_type & ODM_RTL8814A) { + odm_txpowertracking_callback_thermal_meter_jaguar_series2(p_dm); + return; + } +#endif +#if (RTL8881A_SUPPORT || RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8812 || p_dm->support_ic_type & ODM_RTL8881A) { + odm_txpowertracking_callback_thermal_meter_jaguar_series(p_dm); + return; + } +#endif + +#if (RTL8192E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8192E) { + odm_txpowertracking_callback_thermal_meter_92e(p_dm); + return; + } +#endif + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + /* PMGNT_INFO p_mgnt_info = &adapter->mgnt_info; */ +#endif + + + u8 thermal_value = 0, delta, delta_LCK, delta_IQK, offset; + u8 thermal_value_avg_count = 0; + u32 thermal_value_avg = 0; + /* s32 ele_A=0, ele_D, TempCCk, X, value32; + * s32 Y, ele_C=0; + * s8 OFDM_index[2], CCK_index=0, OFDM_index_old[2]={0,0}, CCK_index_old=0, index; + * s8 deltaPowerIndex = 0; */ + u32 i = 0;/* , j = 0; */ + boolean is2T = false; + /* bool bInteralPA = false; */ + + u8 OFDM_max_index = 34, rf = (is2T) ? 2 : 1; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ + u8 indexforchannel = 0;/*get_right_chnl_place_for_iqk(p_hal_data->current_channel)*/ + enum _POWER_DEC_INC { POWER_DEC, POWER_INC }; + + struct _TXPWRTRACK_CFG c; + + + /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ + s8 delta_swing_table_idx[2][index_mapping_NUM_88E] = { + /* {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} */ + {0, 0, 2, 3, 4, 4, 5, 6, 7, 7, 8, 9, 10, 10, 11}, {0, 0, 1, 2, 3, 4, 4, 4, 4, 5, 7, 8, 9, 9, 10} + }; + u8 thermal_threshold[2][index_mapping_NUM_88E] = { + /* {{Power decreasing(lower temperature)}, {Power increasing(higher temperature)}} */ + {0, 2, 4, 6, 8, 10, 12, 14, 16, 18, 20, 22, 24, 26, 27}, {0, 2, 4, 6, 8, 10, 12, 14, 16, 18, 20, 22, 25, 25, 25} + }; + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct rtl8192cd_priv *priv = p_dm->priv; +#endif + + /* 4 2. Initilization ( 7 steps in total ) */ + + configure_txpower_track(p_dm, &c); + + p_dm->rf_calibrate_info.txpowertracking_callback_cnt++; /* cosa add for debug */ + p_dm->rf_calibrate_info.is_txpowertracking_init = true; + +#if (MP_DRIVER == 1) + p_dm->rf_calibrate_info.txpowertrack_control = p_hal_data->txpowertrack_control; /* We should keep updating the control variable according to HalData. + * rf_calibrate_info.rega24 will be initialized when ODM HW configuring, but MP configures with para files. */ + p_dm->rf_calibrate_info.rega24 = 0x090e1317; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && defined(MP_TEST) + if ((OPMODE & WIFI_MP_STATE) || *(p_dm->p_mp_mode)) { + if (p_dm->priv->pshare->mp_txpwr_tracking == false) + return; + } +#endif + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("===>odm_txpowertracking_callback_thermal_meter_8188e, p_dm->bb_swing_idx_cck_base: %d, p_dm->bb_swing_idx_ofdm_base: %d\n", p_rf_calibrate_info->bb_swing_idx_cck_base, p_rf_calibrate_info->bb_swing_idx_ofdm_base)); + /* + if (!p_dm->rf_calibrate_info.tm_trigger) { + odm_set_rf_reg(p_dm, RF_PATH_A, c.thermal_reg_addr, BIT(17) | BIT(16), 0x3); + p_dm->rf_calibrate_info.tm_trigger = 1; + return; + } + */ + thermal_value = (u8)odm_get_rf_reg(p_dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (!thermal_value || !p_dm->rf_calibrate_info.txpowertrack_control) +#else + if (!p_dm->rf_calibrate_info.txpowertrack_control) +#endif + return; + + /* 4 3. Initialize ThermalValues of rf_calibrate_info */ + + if (!p_dm->rf_calibrate_info.thermal_value) { + p_dm->rf_calibrate_info.thermal_value_lck = thermal_value; + p_dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + } + + if (p_dm->rf_calibrate_info.is_reloadtxpowerindex) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("reload ofdm index for band switch\n")); + + /* 4 4. Calculate average thermal meter */ + + p_dm->rf_calibrate_info.thermal_value_avg[p_dm->rf_calibrate_info.thermal_value_avg_index] = thermal_value; + p_dm->rf_calibrate_info.thermal_value_avg_index++; + if (p_dm->rf_calibrate_info.thermal_value_avg_index == c.average_thermal_num) + p_dm->rf_calibrate_info.thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (p_dm->rf_calibrate_info.thermal_value_avg[i]) { + thermal_value_avg += p_dm->rf_calibrate_info.thermal_value_avg[i]; + thermal_value_avg_count++; + } + } + + if (thermal_value_avg_count) { + /* Give the new thermo value a weighting */ + thermal_value_avg += (thermal_value * 4); + + thermal_value = (u8)(thermal_value_avg / (thermal_value_avg_count + 4)); + p_rf_calibrate_info->thermal_value_delta = thermal_value - priv->pmib->dot11RFEntry.ther; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("AVG Thermal Meter = 0x%x\n", thermal_value)); + } + + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + + delta = (thermal_value > p_dm->rf_calibrate_info.thermal_value) ? (thermal_value - p_dm->rf_calibrate_info.thermal_value) : (p_dm->rf_calibrate_info.thermal_value - thermal_value); + delta_LCK = (thermal_value > p_dm->rf_calibrate_info.thermal_value_lck) ? (thermal_value - p_dm->rf_calibrate_info.thermal_value_lck) : (p_dm->rf_calibrate_info.thermal_value_lck - thermal_value); + delta_IQK = (thermal_value > p_dm->rf_calibrate_info.thermal_value_iqk) ? (thermal_value - p_dm->rf_calibrate_info.thermal_value_iqk) : (p_dm->rf_calibrate_info.thermal_value_iqk - thermal_value); + + /* 4 6. If necessary, do LCK. */ + if (!(p_dm->support_ic_type & ODM_RTL8821)) { + /*if((delta_LCK > p_hal_data->delta_lck) && (p_hal_data->delta_lck != 0))*/ + if ((delta_LCK >= c.threshold_iqk) && (!p_iqk_info->rfk_forbidden)) { + /*Delta temperature is equal to or larger than 20 centigrade.*/ + p_dm->rf_calibrate_info.thermal_value_lck = thermal_value; + (*c.phy_lc_calibrate)(p_dm); + } + } + + /* 3 7. If necessary, move the index of swing table to adjust Tx power. */ + + if (delta > 0 && p_dm->rf_calibrate_info.txpowertrack_control) { + + delta = (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - p_dm->priv->pmib->dot11RFEntry.ther) : (p_dm->priv->pmib->dot11RFEntry.ther - thermal_value); + + /* 4 7.1 The Final Power index = BaseIndex + power_index_offset */ + + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) { + CALCULATE_SWINGTALBE_OFFSET(offset, POWER_INC, index_mapping_NUM_88E, delta); + p_dm->rf_calibrate_info.delta_power_index_last = p_dm->rf_calibrate_info.delta_power_index; + p_dm->rf_calibrate_info.delta_power_index = delta_swing_table_idx[POWER_INC][offset]; + + } else { + + CALCULATE_SWINGTALBE_OFFSET(offset, POWER_DEC, index_mapping_NUM_88E, delta); + p_dm->rf_calibrate_info.delta_power_index_last = p_dm->rf_calibrate_info.delta_power_index; + p_dm->rf_calibrate_info.delta_power_index = (-1) * delta_swing_table_idx[POWER_DEC][offset]; + } + + if (p_dm->rf_calibrate_info.delta_power_index == p_dm->rf_calibrate_info.delta_power_index_last) + p_dm->rf_calibrate_info.power_index_offset = 0; + else + p_dm->rf_calibrate_info.power_index_offset = p_dm->rf_calibrate_info.delta_power_index - p_dm->rf_calibrate_info.delta_power_index_last; + + for (i = 0; i < rf; i++) + p_dm->rf_calibrate_info.OFDM_index[i] = p_rf_calibrate_info->bb_swing_idx_ofdm_base + p_dm->rf_calibrate_info.power_index_offset; + p_dm->rf_calibrate_info.CCK_index = p_rf_calibrate_info->bb_swing_idx_cck_base + p_dm->rf_calibrate_info.power_index_offset; + + p_rf_calibrate_info->bb_swing_idx_cck = p_dm->rf_calibrate_info.CCK_index; + p_rf_calibrate_info->bb_swing_idx_ofdm[RF_PATH_A] = p_dm->rf_calibrate_info.OFDM_index[RF_PATH_A]; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", p_rf_calibrate_info->bb_swing_idx_cck, p_rf_calibrate_info->bb_swing_idx_cck_base, p_dm->rf_calibrate_info.power_index_offset)); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("The 'OFDM' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", p_rf_calibrate_info->bb_swing_idx_ofdm[RF_PATH_A], p_rf_calibrate_info->bb_swing_idx_ofdm_base, p_dm->rf_calibrate_info.power_index_offset)); + + /* 4 7.1 Handle boundary conditions of index. */ + + + for (i = 0; i < rf; i++) { + if (p_dm->rf_calibrate_info.OFDM_index[i] > OFDM_max_index) + p_dm->rf_calibrate_info.OFDM_index[i] = OFDM_max_index; + else if (p_dm->rf_calibrate_info.OFDM_index[i] < 0) + p_dm->rf_calibrate_info.OFDM_index[i] = 0; + } + + if (p_dm->rf_calibrate_info.CCK_index > c.swing_table_size_cck - 1) + p_dm->rf_calibrate_info.CCK_index = c.swing_table_size_cck - 1; + else if (p_dm->rf_calibrate_info.CCK_index < 0) + p_dm->rf_calibrate_info.CCK_index = 0; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("The thermal meter is unchanged or TxPowerTracking OFF: thermal_value: %d, p_dm->rf_calibrate_info.thermal_value: %d)\n", thermal_value, p_dm->rf_calibrate_info.thermal_value)); + p_dm->rf_calibrate_info.power_index_offset = 0; + } + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", p_dm->rf_calibrate_info.CCK_index, p_rf_calibrate_info->bb_swing_idx_cck_base)); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index: %d\n", p_dm->rf_calibrate_info.OFDM_index[RF_PATH_A], p_rf_calibrate_info->bb_swing_idx_ofdm_base)); + + if (p_dm->rf_calibrate_info.power_index_offset != 0 && p_dm->rf_calibrate_info.txpowertrack_control) { + /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ + + p_dm->rf_calibrate_info.is_tx_power_changed = true; /* Always true after Tx Power is adjusted by power tracking. */ + /* */ + /* 2012/04/23 MH According to Luke's suggestion, we can not write BB digital */ + /* to increase TX power. Otherwise, EVM will be bad. */ + /* */ + /* 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. */ + if (thermal_value > p_dm->rf_calibrate_info.thermal_value) { + /* ODM_RT_TRACE(p_dm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, */ + /* ("Temperature Increasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */ + /* p_dm->rf_calibrate_info.power_index_offset, delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_dm->rf_calibrate_info.thermal_value)); */ + } else if (thermal_value < p_dm->rf_calibrate_info.thermal_value) { /* Low temperature */ + /* ODM_RT_TRACE(p_dm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, */ + /* ("Temperature Decreasing: delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", */ + /* p_dm->rf_calibrate_info.power_index_offset, delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_dm->rf_calibrate_info.thermal_value)); */ + } + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) + { + /* ODM_RT_TRACE(p_dm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) hugher than PG value(%d), increases the power by tx_agc\n", thermal_value, p_hal_data->eeprom_thermal_meter)); */ + (*c.odm_tx_pwr_track_set_pwr)(p_dm, TXAGC, 0, 0); + } else { + /* ODM_RT_TRACE(p_dm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("Temperature(%d) lower than PG value(%d), increases the power by tx_agc\n", thermal_value, p_hal_data->eeprom_thermal_meter)); */ + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, RF_PATH_A, indexforchannel); + if (is2T) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, RF_PATH_B, indexforchannel); + } + + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->bb_swing_idx_cck; + p_rf_calibrate_info->bb_swing_idx_ofdm_base = p_rf_calibrate_info->bb_swing_idx_ofdm[RF_PATH_A]; + p_dm->rf_calibrate_info.thermal_value = thermal_value; + + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===dm_TXPowerTrackingCallback_ThermalMeter_8188E\n")); + + p_dm->rf_calibrate_info.tx_powercount = 0; +} + +/* 3============================================================ + * 3 IQ Calibration + * 3============================================================ */ + +void +odm_reset_iqk_result( + void *p_dm_void +) +{ + return; +} +#if 1/* !(DM_ODM_SUPPORT_TYPE & ODM_AP) */ +u8 odm_get_right_chnl_place_for_iqk(u8 chnl) +{ + u8 channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = { + 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165 + }; + u8 place = chnl; + + + if (chnl > 14) { + for (place = 14; place < sizeof(channel_all); place++) { + if (channel_all[place] == chnl) + return place - 13; + } + } + return 0; + +} +#endif + +void +odm_iq_calibrate( + struct PHY_DM_STRUCT *p_dm +) +{ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + if ((p_dm->is_linked) && (!p_iqk_info->rfk_forbidden)) { + if ((*p_dm->p_channel != p_dm->pre_channel) && (!*p_dm->p_is_scan_in_process)) { + p_dm->pre_channel = *p_dm->p_channel; + p_dm->linked_interval = 0; + } + + if (p_dm->linked_interval < 3) + p_dm->linked_interval++; + + if (p_dm->linked_interval == 2) + halrf_iqk_trigger(p_dm, false); + } else + p_dm->linked_interval = 0; + +} + +void phydm_rf_init(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + odm_txpowertracking_init(p_dm); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8814A) + phy_iq_calibrate_8814a_init(p_dm); +#endif +#endif + +} + +void phydm_rf_watchdog(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_txpowertracking_check(p_dm); + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_iq_calibrate(p_dm); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.h new file mode 100644 index 000000000000..ee34c2125d40 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ap.h @@ -0,0 +1,122 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __HAL_PHY_RF_H__ +#define __HAL_PHY_RF_H__ + +#include "halrf/halrf_powertracking_ap.h" +#include "halrf/halrf_kfree.h" + +#if (RTL8814A_SUPPORT == 1) + #include "halrf/rtl8814a/halrf_iqk_8814a.h" +#endif + +#if (RTL8822B_SUPPORT == 1) + #include "halrf/rtl8822b/halrf_iqk_8822b.h" +#endif + +#if (RTL8821C_SUPPORT == 1) + #include "halrf/rtl8821c/halrf_iqk_8821c.h" +#endif + +enum pwrtrack_method { + BBSWING, + TXAGC, + MIX_MODE, + TSSI_MODE +}; + +typedef void (*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); +typedef void(*func_iqk)(void *, u8, u8, u8); +typedef void (*func_lck)(void *); +/* refine by YuChen for 8814A */ +typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); +typedef void (*func_swing8814only)(void *, u8 **, u8 **, u8 **, u8 **); +typedef void (*func_all_swing)(void *, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **); + + +struct _TXPWRTRACK_CFG { + u8 swing_table_size_cck; + u8 swing_table_size_ofdm; + u8 threshold_iqk; + u8 threshold_dpk; + u8 average_thermal_num; + u8 rf_path_count; + u32 thermal_reg_addr; + func_set_pwr odm_tx_pwr_track_set_pwr; + func_iqk do_iqk; + func_lck phy_lc_calibrate; + func_swing get_delta_swing_table; + func_swing8814only get_delta_swing_table8814only; + func_all_swing get_delta_all_swing_table; +}; + +void +configure_txpower_track( + void *p_dm_void, + struct _TXPWRTRACK_CFG *p_config +); + + +void +odm_txpowertracking_callback_thermal_meter( + void *p_dm_void +); + +#if (RTL8192E_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_92e( + void *p_dm_void +); +#endif + +#if (RTL8814A_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_jaguar_series2( + void *p_dm_void +); + +#elif ODM_IC_11AC_SERIES_SUPPORT +void +odm_txpowertracking_callback_thermal_meter_jaguar_series( + void *p_dm_void +); + +#elif (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) +void +odm_txpowertracking_callback_thermal_meter_jaguar_series3( + void *p_dm_void +); + +#endif + +#define IS_CCK_RATE(_rate) (ODM_MGN_1M == _rate || _rate == ODM_MGN_2M || _rate == ODM_MGN_5_5M || _rate == ODM_MGN_11M) + +#define ODM_TARGET_CHNL_NUM_2G_5G 59 + + +void +odm_reset_iqk_result( + void *p_dm_void +); +u8 +odm_get_right_chnl_place_for_iqk( + u8 chnl +); + +void phydm_rf_init(void *p_dm_void); +void phydm_rf_watchdog(void *p_dm_void); + +#endif /* #ifndef __HAL_PHY_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.c new file mode 100644 index 000000000000..f9c031fdc791 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.c @@ -0,0 +1,898 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal) \ + do {\ + for (_offset = 0; _offset < _size; _offset++) { \ + \ + if (_delta_thermal < thermal_threshold[_direction][_offset]) { \ + \ + if (_offset != 0)\ + _offset--;\ + break;\ + } \ + } \ + if (_offset >= _size)\ + _offset = _size-1;\ + } while (0) + +void configure_txpower_track( + void *p_dm_void, + struct _TXPWRTRACK_CFG *p_config +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if RTL8192E_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8192E) + configure_txpower_track_8192e(p_config); +#endif +#if RTL8821A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8821) + configure_txpower_track_8821a(p_config); +#endif +#if RTL8812A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8812) + configure_txpower_track_8812a(p_config); +#endif +#if RTL8188E_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8188E) + configure_txpower_track_8188e(p_config); +#endif + +#if RTL8723B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8723B) + configure_txpower_track_8723b(p_config); +#endif + +#if RTL8814A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8814A) + configure_txpower_track_8814a(p_config); +#endif + +#if RTL8703B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8703B) + configure_txpower_track_8703b(p_config); +#endif + +#if RTL8188F_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8188F) + configure_txpower_track_8188f(p_config); +#endif +#if RTL8723D_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8723D) + configure_txpower_track_8723d(p_config); +#endif +/* JJ ADD 20161014 */ +#if RTL8710B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8710B) + configure_txpower_track_8710b(p_config); +#endif + +#if RTL8822B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8822B) + configure_txpower_track_8822b(p_config); +#endif +#if RTL8821C_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8821C) + configure_txpower_track_8821c(p_config); +#endif + +} + +/* ********************************************************************** + * <20121113, Kordan> This function should be called when tx_agc changed. + * Otherwise the previous compensation is gone, because we record the + * delta of temperature between two TxPowerTracking watch dogs. + * + * NOTE: If Tx BB swing or Tx scaling is varified during run-time, still + * need to call this function. + * ********************************************************************** */ +void +odm_clear_txpowertracking_state( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + struct rtl_efuse *rtlefu = rtl_efuse(rtlpriv); +#else + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(p_dm->adapter); +#endif + u8 p = 0; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->default_cck_index; + p_rf_calibrate_info->bb_swing_idx_cck = p_rf_calibrate_info->default_cck_index; + p_dm->rf_calibrate_info.CCK_index = 0; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->bb_swing_idx_ofdm[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->OFDM_index[p] = p_rf_calibrate_info->default_ofdm_index; + + p_rf_calibrate_info->power_index_offset[p] = 0; + p_rf_calibrate_info->delta_power_index[p] = 0; + p_rf_calibrate_info->delta_power_index_last[p] = 0; + + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = 0; /* Initial Mix mode power tracking*/ + p_rf_calibrate_info->remnant_ofdm_swing_idx[p] = 0; + p_rf_calibrate_info->kfree_offset[p] = 0; + } + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->modify_tx_agc_flag_path_b = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->modify_tx_agc_flag_path_c = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->modify_tx_agc_flag_path_d = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->remnant_cck_swing_idx = 0; +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + p_rf_calibrate_info->thermal_value = rtlefu->eeprom_thermalmeter; +#else + p_rf_calibrate_info->thermal_value = p_hal_data->eeprom_thermal_meter; +#endif + + p_rf_calibrate_info->modify_tx_agc_value_cck = 0; /* modify by Mingzhi.Guo */ + p_rf_calibrate_info->modify_tx_agc_value_ofdm = 0; /* modify by Mingzhi.Guo */ + +} + +void +odm_txpowertracking_callback_thermal_meter( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *p_dm_void +#else + struct _ADAPTER *adapter +#endif +) +{ + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + struct rtl_efuse *rtlefu = rtl_efuse(rtlpriv); + void *adapter = p_dm->adapter; +#elif !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->odmpriv; +#endif +#endif + + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + u8 thermal_value = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; + s8 diff_DPK[4] = {0}; + u8 thermal_value_avg_count = 0; + u32 thermal_value_avg = 0, regc80, regcd0, regcd4, regab4; + + u8 OFDM_min_index = 0; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ + u8 indexforchannel = 0; /* get_right_chnl_place_for_iqk(p_hal_data->current_channel) */ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + u8 power_tracking_type = 0; /* no specify type */ +#else + u8 power_tracking_type = p_hal_data->rf_power_tracking_type; +#endif + u8 xtal_offset_eanble = 0; + s8 thermal_value_temp = 0; + + struct _TXPWRTRACK_CFG c = {0}; + + /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ + u8 *delta_swing_table_idx_tup_a = NULL; + u8 *delta_swing_table_idx_tdown_a = NULL; + u8 *delta_swing_table_idx_tup_b = NULL; + u8 *delta_swing_table_idx_tdown_b = NULL; + /*for 8814 add by Yu Chen*/ + u8 *delta_swing_table_idx_tup_c = NULL; + u8 *delta_swing_table_idx_tdown_c = NULL; + u8 *delta_swing_table_idx_tup_d = NULL; + u8 *delta_swing_table_idx_tdown_d = NULL; + /*for Xtal Offset by James.Tung*/ + s8 *delta_swing_table_xtal_up = NULL; + s8 *delta_swing_table_xtal_down = NULL; + + /* 4 2. Initilization ( 7 steps in total ) */ + + configure_txpower_track(p_dm, &c); + + (*c.get_delta_swing_table)(p_dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, + (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); + + if (p_dm->support_ic_type & ODM_RTL8814A) /*for 8814 path C & D*/ + (*c.get_delta_swing_table8814only)(p_dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c, + (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d); + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) /*for Xtal Offset*/ + (*c.get_delta_swing_xtal_table)(p_dm, (s8 **)&delta_swing_table_xtal_up, (s8 **)&delta_swing_table_xtal_down); + + p_rf_calibrate_info->txpowertracking_callback_cnt++; /*cosa add for debug*/ + p_rf_calibrate_info->is_txpowertracking_init = true; + + /*p_rf_calibrate_info->txpowertrack_control = p_hal_data->txpowertrack_control; + We should keep updating the control variable according to HalData. + rf_calibrate_info.rega24 will be initialized when ODM HW configuring, but MP configures with para files. */ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#if (MP_DRIVER == 1) + p_rf_calibrate_info->rega24 = 0x090e1317; +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (*(p_dm->p_mp_mode) == true) + p_rf_calibrate_info->rega24 = 0x090e1317; +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("===>odm_txpowertracking_callback_thermal_meter\n p_rf_calibrate_info->bb_swing_idx_cck_base: %d, p_rf_calibrate_info->bb_swing_idx_ofdm_base[A]: %d, p_rf_calibrate_info->default_ofdm_index: %d\n", + p_rf_calibrate_info->bb_swing_idx_cck_base, p_rf_calibrate_info->bb_swing_idx_ofdm_base[RF_PATH_A], p_rf_calibrate_info->default_ofdm_index)); + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("p_rf_calibrate_info->txpowertrack_control=%d, rtlefu->eeprom_thermalmeter %d\n", p_rf_calibrate_info->txpowertrack_control, rtlefu->eeprom_thermalmeter)); +#else + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("p_rf_calibrate_info->txpowertrack_control=%d, p_hal_data->eeprom_thermal_meter %d\n", p_rf_calibrate_info->txpowertrack_control, p_hal_data->eeprom_thermal_meter)); +#endif + + thermal_value = (u8)odm_get_rf_reg(p_dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + + thermal_value_temp = thermal_value + phydm_get_thermal_offset(p_dm); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("thermal_value_temp(%d) = thermal_value(%d) + power_trim_thermal(%d)\n", thermal_value_temp, thermal_value, phydm_get_thermal_offset(p_dm))); + + if (thermal_value_temp > 63) + thermal_value = 63; + else if (thermal_value_temp < 0) + thermal_value = 0; + else + thermal_value = thermal_value_temp; + + /*add log by zhao he, check c80/c94/c14/ca0 value*/ + if (p_dm->support_ic_type == ODM_RTL8723D) { + regc80 = odm_get_bb_reg(p_dm, 0xc80, MASKDWORD); + regcd0 = odm_get_bb_reg(p_dm, 0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(p_dm, 0xcd4, MASKDWORD); + regab4 = odm_get_bb_reg(p_dm, 0xab4, 0x000007FF); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4)); + } + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type == ODM_RTL8710B) { + regc80 = odm_get_bb_reg(p_dm, 0xc80, MASKDWORD); + regcd0 = odm_get_bb_reg(p_dm, 0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(p_dm, 0xcd4, MASKDWORD); + regab4 = odm_get_bb_reg(p_dm, 0xab4, 0x000007FF); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4)); + } + + if (!p_rf_calibrate_info->txpowertrack_control) + return; + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + if (rtlefu->eeprom_thermalmeter == 0xff) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no pg, p_hal_data->eeprom_thermal_meter = 0x%x\n", rtlefu->eeprom_thermalmeter)); + return; + } +#else + if (p_hal_data->eeprom_thermal_meter == 0xff) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no pg, p_hal_data->eeprom_thermal_meter = 0x%x\n", p_hal_data->eeprom_thermal_meter)); + return; + } +#endif + + /*4 3. Initialize ThermalValues of rf_calibrate_info*/ + + if (p_rf_calibrate_info->is_reloadtxpowerindex) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("reload ofdm index for band switch\n")); + + /*4 4. Calculate average thermal meter*/ + + p_rf_calibrate_info->thermal_value_avg[p_rf_calibrate_info->thermal_value_avg_index] = thermal_value; + p_rf_calibrate_info->thermal_value_avg_index++; + if (p_rf_calibrate_info->thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + p_rf_calibrate_info->thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (p_rf_calibrate_info->thermal_value_avg[i]) { + thermal_value_avg += p_rf_calibrate_info->thermal_value_avg[i]; + thermal_value_avg_count++; + } + } + + if (thermal_value_avg_count) { /* Calculate Average thermal_value after average enough times */ + thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + p_rf_calibrate_info->thermal_value_delta = thermal_value - rtlefu->eeprom_thermalmeter; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", thermal_value, rtlefu->eeprom_thermalmeter)); +#else + p_rf_calibrate_info->thermal_value_delta = thermal_value - p_hal_data->eeprom_thermal_meter; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", thermal_value, p_hal_data->eeprom_thermal_meter)); +#endif + } + + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + + /* "delta" here is used to determine whether thermal value changes or not. */ + delta = (thermal_value > p_rf_calibrate_info->thermal_value) ? (thermal_value - p_rf_calibrate_info->thermal_value) : (p_rf_calibrate_info->thermal_value - thermal_value); + delta_LCK = (thermal_value > p_rf_calibrate_info->thermal_value_lck) ? (thermal_value - p_rf_calibrate_info->thermal_value_lck) : (p_rf_calibrate_info->thermal_value_lck - thermal_value); + delta_IQK = (thermal_value > p_rf_calibrate_info->thermal_value_iqk) ? (thermal_value - p_rf_calibrate_info->thermal_value_iqk) : (p_rf_calibrate_info->thermal_value_iqk - thermal_value); + + if (p_rf_calibrate_info->thermal_value_iqk == 0xff) { /*no PG, use thermal value for IQK*/ + p_rf_calibrate_info->thermal_value_iqk = thermal_value; + delta_IQK = (thermal_value > p_rf_calibrate_info->thermal_value_iqk) ? (thermal_value - p_rf_calibrate_info->thermal_value_iqk) : (p_rf_calibrate_info->thermal_value_iqk - thermal_value); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use thermal_value for IQK\n")); + } + + for (p = RF_PATH_A; p < c.rf_path_count; p++) + diff_DPK[p] = (s8)thermal_value - (s8)p_rf_calibrate_info->dpk_thermal[p]; + + /*4 6. If necessary, do LCK.*/ + + if (!(p_dm->support_ic_type & ODM_RTL8821)) { /*no PG, do LCK at initial status*/ + if (p_rf_calibrate_info->thermal_value_lck == 0xff) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); + p_rf_calibrate_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ + if (!(p_dm->support_ic_type & ODM_RTL8814A) && !(p_dm->support_ic_type & ODM_RTL8822B) && c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(p_dm); + + delta_LCK = (thermal_value > p_rf_calibrate_info->thermal_value_lck) ? (thermal_value - p_rf_calibrate_info->thermal_value_lck) : (p_rf_calibrate_info->thermal_value_lck - thermal_value); + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); + + /* Wait sacn to do LCK by RF Jenyu*/ + if ((*p_dm->p_is_scan_in_process == false) && (!p_iqk_info->rfk_forbidden)) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_LCK >= c.threshold_iqk) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk)); + p_rf_calibrate_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ + if (!(p_dm->support_ic_type & ODM_RTL8814A) && !(p_dm->support_ic_type & ODM_RTL8822B) && c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(p_dm); + } + } + } + + /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ + + if (delta > 0 && p_rf_calibrate_info->txpowertrack_control) { + /* "delta" here is used to record the absolute value of differrence. */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + delta = thermal_value > rtlefu->eeprom_thermalmeter ? (thermal_value - rtlefu->eeprom_thermalmeter) : (rtlefu->eeprom_thermalmeter - thermal_value); +#else + delta = thermal_value > p_hal_data->eeprom_thermal_meter ? (thermal_value - p_hal_data->eeprom_thermal_meter) : (p_hal_data->eeprom_thermal_meter - thermal_value); +#endif +#else + delta = (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - p_dm->priv->pmib->dot11RFEntry.ther) : (p_dm->priv->pmib->dot11RFEntry.ther - thermal_value); +#endif + if (delta >= TXPWR_TRACK_TABLE_SIZE) + delta = TXPWR_TRACK_TABLE_SIZE - 1; + + /*4 7.1 The Final Power index = BaseIndex + power_index_offset*/ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + if (thermal_value > rtlefu->eeprom_thermalmeter) { +#else + if (thermal_value > p_hal_data->eeprom_thermal_meter) { +#endif +#else + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) { +#endif + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + p_rf_calibrate_info->delta_power_index_last[p] = p_rf_calibrate_info->delta_power_index[p]; /*recording poer index offset*/ + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_b[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_c[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_d[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_a[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + } + } + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) { + /*Save xtal_offset from Xtal table*/ + p_rf_calibrate_info->xtal_offset_last = p_rf_calibrate_info->xtal_offset; /*recording last Xtal offset*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("[Xtal] delta_swing_table_xtal_up[%d] = %d\n", delta, delta_swing_table_xtal_up[delta])); + p_rf_calibrate_info->xtal_offset = delta_swing_table_xtal_up[delta]; + xtal_offset_eanble = (p_rf_calibrate_info->xtal_offset_last != p_rf_calibrate_info->xtal_offset); + } + + } else { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + p_rf_calibrate_info->delta_power_index_last[p] = p_rf_calibrate_info->delta_power_index[p]; /*recording poer index offset*/ + + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_b[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_c[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_d[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_a[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + } + } + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) { + /*Save xtal_offset from Xtal table*/ + p_rf_calibrate_info->xtal_offset_last = p_rf_calibrate_info->xtal_offset; /*recording last Xtal offset*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("[Xtal] delta_swing_table_xtal_down[%d] = %d\n", delta, delta_swing_table_xtal_down[delta])); + p_rf_calibrate_info->xtal_offset = delta_swing_table_xtal_down[delta]; + xtal_offset_eanble = (p_rf_calibrate_info->xtal_offset_last != p_rf_calibrate_info->xtal_offset); + } + + } + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\n\n=========================== [path-%d] Calculating power_index_offset===========================\n", p)); + + if (p_rf_calibrate_info->delta_power_index[p] == p_rf_calibrate_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ + p_rf_calibrate_info->power_index_offset[p] = 0; + else + p_rf_calibrate_info->power_index_offset[p] = p_rf_calibrate_info->delta_power_index[p] - p_rf_calibrate_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("[path-%d] power_index_offset(%d) = delta_power_index(%d) - delta_power_index_last(%d)\n", p, p_rf_calibrate_info->power_index_offset[p], p_rf_calibrate_info->delta_power_index[p], p_rf_calibrate_info->delta_power_index_last[p])); + + p_rf_calibrate_info->OFDM_index[p] = p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] + p_rf_calibrate_info->power_index_offset[p]; + p_rf_calibrate_info->CCK_index = p_rf_calibrate_info->bb_swing_idx_cck_base + p_rf_calibrate_info->power_index_offset[p]; + + p_rf_calibrate_info->bb_swing_idx_cck = p_rf_calibrate_info->CCK_index; + p_rf_calibrate_info->bb_swing_idx_ofdm[p] = p_rf_calibrate_info->OFDM_index[p]; + + /*************Print BB Swing base and index Offset*************/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", p_rf_calibrate_info->bb_swing_idx_cck, p_rf_calibrate_info->bb_swing_idx_cck_base, p_rf_calibrate_info->power_index_offset[p])); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", p_rf_calibrate_info->bb_swing_idx_ofdm[p], p, p_rf_calibrate_info->bb_swing_idx_ofdm_base[p], p_rf_calibrate_info->power_index_offset[p])); + + /*4 7.1 Handle boundary conditions of index.*/ + + if (p_rf_calibrate_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) + p_rf_calibrate_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; + else if (p_rf_calibrate_info->OFDM_index[p] <= OFDM_min_index) + p_rf_calibrate_info->OFDM_index[p] = OFDM_min_index; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\n\n========================================================================================================\n")); + + if (p_rf_calibrate_info->CCK_index > c.swing_table_size_cck - 1) + p_rf_calibrate_info->CCK_index = c.swing_table_size_cck - 1; + else if (p_rf_calibrate_info->CCK_index <= 0) + p_rf_calibrate_info->CCK_index = 0; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("The thermal meter is unchanged or TxPowerTracking OFF(%d): thermal_value: %d, p_rf_calibrate_info->thermal_value: %d\n", + p_rf_calibrate_info->txpowertrack_control, thermal_value, p_rf_calibrate_info->thermal_value)); + + for (p = RF_PATH_A; p < c.rf_path_count; p++) + p_rf_calibrate_info->power_index_offset[p] = 0; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", + p_rf_calibrate_info->CCK_index, p_rf_calibrate_info->bb_swing_idx_cck_base)); /*Print Swing base & current*/ + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", + p_rf_calibrate_info->OFDM_index[p], p, p_rf_calibrate_info->bb_swing_idx_ofdm_base[p])); + } + + if ((p_dm->support_ic_type & ODM_RTL8814A)) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("power_tracking_type=%d\n", power_tracking_type)); + + if (power_tracking_type == 0) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } else if (power_tracking_type == 1) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_2G_TSSI_5G_MODE, p, 0); + } else if (power_tracking_type == 2) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_5G_TSSI_2G_MODE, p, 0); + } else if (power_tracking_type == 3) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, TSSI_MODE, p, 0); + } + p_rf_calibrate_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ + + } else if ((p_rf_calibrate_info->power_index_offset[RF_PATH_A] != 0 || + p_rf_calibrate_info->power_index_offset[RF_PATH_B] != 0 || + p_rf_calibrate_info->power_index_offset[RF_PATH_C] != 0 || + p_rf_calibrate_info->power_index_offset[RF_PATH_D] != 0) && +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + p_rf_calibrate_info->txpowertrack_control && (rtlefu->eeprom_thermalmeter != 0xff)) { +#else + p_rf_calibrate_info->txpowertrack_control && (p_hal_data->eeprom_thermal_meter != 0xff)) { +#endif + /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ + + p_rf_calibrate_info->is_tx_power_changed = true; /*Always true after Tx Power is adjusted by power tracking.*/ + /* */ + /* 2012/04/23 MH According to Luke's suggestion, we can not write BB digital */ + /* to increase TX power. Otherwise, EVM will be bad. */ + /* */ + /* 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. */ + if (thermal_value > p_rf_calibrate_info->thermal_value) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature Increasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, p_rf_calibrate_info->power_index_offset[p], delta, thermal_value, rtlefu->eeprom_thermalmeter, p_rf_calibrate_info->thermal_value)); +#else + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature Increasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, p_rf_calibrate_info->power_index_offset[p], delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_rf_calibrate_info->thermal_value)); +#endif + } + } else if (thermal_value < p_rf_calibrate_info->thermal_value) { /*Low temperature*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature Decreasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, p_rf_calibrate_info->power_index_offset[p], delta, thermal_value, rtlefu->eeprom_thermalmeter, p_rf_calibrate_info->thermal_value)); +#else + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature Decreasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, p_rf_calibrate_info->power_index_offset[p], delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_rf_calibrate_info->thermal_value)); +#endif + } + } + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + if (thermal_value > rtlefu->eeprom_thermalmeter) +#else + if (thermal_value > p_hal_data->eeprom_thermal_meter) +#endif +#else + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) +#endif + { +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) higher than PG value(%d)\n", thermal_value, rtlefu->eeprom_thermalmeter)); +#else + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) higher than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); +#endif + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8821 || + p_dm->support_ic_type == ODM_RTL8812 || p_dm->support_ic_type == ODM_RTL8723B || p_dm->support_ic_type == ODM_RTL8814A || + p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8188F || p_dm->support_ic_type == ODM_RTL8822B || + p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8821C || p_dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, p, indexforchannel); + } + } else { +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) lower than PG value(%d)\n", thermal_value, rtlefu->eeprom_thermalmeter)); +#else + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) lower than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); +#endif + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8821 || + p_dm->support_ic_type == ODM_RTL8812 || p_dm->support_ic_type == ODM_RTL8723B || p_dm->support_ic_type == ODM_RTL8814A || + p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8188F || p_dm->support_ic_type == ODM_RTL8822B || + p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8821C || p_dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, indexforchannel); + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, p, indexforchannel); + } + + } + + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->bb_swing_idx_cck; /*Record last time Power Tracking result as base.*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) + p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] = p_rf_calibrate_info->bb_swing_idx_ofdm[p]; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("p_rf_calibrate_info->thermal_value = %d thermal_value= %d\n", p_rf_calibrate_info->thermal_value, thermal_value)); + + p_rf_calibrate_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ + + } + + + if (p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + if (xtal_offset_eanble != 0 && p_rf_calibrate_info->txpowertrack_control && (rtlefu->eeprom_thermalmeter != 0xff)) { +#else + if (xtal_offset_eanble != 0 && p_rf_calibrate_info->txpowertrack_control && (p_hal_data->eeprom_thermal_meter != 0xff)) { +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + if (thermal_value > rtlefu->eeprom_thermalmeter) { +#else + if (thermal_value > p_hal_data->eeprom_thermal_meter) { +#endif +#else + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) { +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) higher than PG value(%d)\n", thermal_value, rtlefu->eeprom_thermalmeter)); +#else + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) higher than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); +#endif + (*c.odm_txxtaltrack_set_xtal)(p_dm); + } else { +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) lower than PG value(%d)\n", thermal_value, rtlefu->eeprom_thermalmeter)); +#else + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) lower than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); +#endif + (*c.odm_txxtaltrack_set_xtal)(p_dm); + } + } + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); + } + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + + /* Wait sacn to do IQK by RF Jenyu*/ + if ((*p_dm->p_is_scan_in_process == false) && (!p_iqk_info->rfk_forbidden)) { + if (!IS_HARDWARE_TYPE_8723B(adapter)) { + /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ + if (delta_IQK >= c.threshold_iqk) { + p_rf_calibrate_info->thermal_value_iqk = thermal_value; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk)); + if (!p_rf_calibrate_info->is_iqk_in_progress) + (*c.do_iqk)(p_dm, delta_IQK, thermal_value, 8); + } + } + } + if (p_rf_calibrate_info->dpk_thermal[RF_PATH_A] != 0) { + if (diff_DPK[RF_PATH_A] >= c.threshold_dpk) { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_A] / c.threshold_dpk)); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else if ((diff_DPK[RF_PATH_A] <= -1 * c.threshold_dpk)) { + s32 value = 0x20 + (diff_DPK[RF_PATH_A] / c.threshold_dpk); + + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } + } + if (p_rf_calibrate_info->dpk_thermal[RF_PATH_B] != 0) { + if (diff_DPK[RF_PATH_B] >= c.threshold_dpk) { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_B] / c.threshold_dpk)); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else if ((diff_DPK[RF_PATH_B] <= -1 * c.threshold_dpk)) { + s32 value = 0x20 + (diff_DPK[RF_PATH_B] / c.threshold_dpk); + + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } + } + +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===odm_txpowertracking_callback_thermal_meter\n")); + + p_rf_calibrate_info->tx_powercount = 0; +} + + + +/* 3============================================================ + * 3 IQ Calibration + * 3============================================================ */ + +void +odm_reset_iqk_result( + void *p_dm_void +) +{ + return; +} +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) +u8 odm_get_right_chnl_place_for_iqk(u8 chnl) +{ + u8 channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = { + 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165 + }; + u8 place = chnl; + + + if (chnl > 14) { + for (place = 14; place < sizeof(channel_all); place++) { + if (channel_all[place] == chnl) + return place - 13; + } + } + return 0; + +} +#endif + +void +odm_iq_calibrate( + struct PHY_DM_STRUCT *p_dm +) +{ + struct _ADAPTER *adapter = p_dm->adapter; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (*p_dm->p_is_fcs_mode_enable) + return; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + if (IS_HARDWARE_TYPE_8812AU(adapter)) + return; +#endif + + if ((p_dm->is_linked) && (!p_iqk_info->rfk_forbidden)) { + if ((*p_dm->p_channel != p_dm->pre_channel) && (!*p_dm->p_is_scan_in_process)) { + p_dm->pre_channel = *p_dm->p_channel; + p_dm->linked_interval = 0; + } + + if (p_dm->linked_interval < 3) + p_dm->linked_interval++; + + if (p_dm->linked_interval == 2) + halrf_iqk_trigger(p_dm, false); + } else + p_dm->linked_interval = 0; +} + +void phydm_rf_init(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + odm_txpowertracking_init(p_dm); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_clear_txpowertracking_state(p_dm); +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8814A) + phy_iq_calibrate_8814a_init(p_dm); +#endif +#endif + +} + +void phydm_rf_watchdog(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_txpowertracking_check(p_dm); + /*if (p_dm->support_ic_type & ODM_IC_11AC_SERIES)*/ + /*odm_iq_calibrate(p_dm);*/ +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.h new file mode 100644 index 000000000000..f2afd2804147 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_ce.h @@ -0,0 +1,114 @@ +/****************************************************************************** + * + * 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. + * + *****************************************************************************/ + +#ifndef __HAL_PHY_RF_H__ +#define __HAL_PHY_RF_H__ + +#include "halrf/halrf_kfree.h" +#if (RTL8814A_SUPPORT == 1) + #include "halrf/rtl8814a/halrf_iqk_8814a.h" +#endif + +#if (RTL8822B_SUPPORT == 1) + #include "halrf/rtl8822b/halrf_iqk_8822b.h" +#endif + +#if (RTL8821C_SUPPORT == 1) + #include "halrf/rtl8821c/halrf_iqk_8821c.h" +#endif + +#include "halrf/halrf_powertracking_ce.h" + + +enum spur_cal_method { + PLL_RESET, + AFE_PHASE_SEL +}; + +enum pwrtrack_method { + BBSWING, + TXAGC, + MIX_MODE, + TSSI_MODE, + MIX_2G_TSSI_5G_MODE, + MIX_5G_TSSI_2G_MODE +}; + +typedef void (*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); +typedef void(*func_iqk)(void *, u8, u8, u8); +typedef void (*func_lck)(void *); +typedef void (*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); +typedef void (*func_swing8814only)(void *, u8 **, u8 **, u8 **, u8 **); +typedef void(*func_swing_xtal)(void *, s8 **, s8 **); +typedef void(*func_set_xtal)(void *); + +struct _TXPWRTRACK_CFG { + u8 swing_table_size_cck; + u8 swing_table_size_ofdm; + u8 threshold_iqk; + u8 threshold_dpk; + u8 average_thermal_num; + u8 rf_path_count; + u32 thermal_reg_addr; + func_set_pwr odm_tx_pwr_track_set_pwr; + func_iqk do_iqk; + func_lck phy_lc_calibrate; + func_swing get_delta_swing_table; + func_swing8814only get_delta_swing_table8814only; + func_swing_xtal get_delta_swing_xtal_table; + func_set_xtal odm_txxtaltrack_set_xtal; +}; + +void +configure_txpower_track( + void *p_dm_void, + struct _TXPWRTRACK_CFG *p_config +); + + +void +odm_clear_txpowertracking_state( + void *p_dm_void +); + +void +odm_txpowertracking_callback_thermal_meter( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + void *p_dm_void +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *p_dm +#else + struct _ADAPTER *adapter +#endif +); + + + +#define ODM_TARGET_CHNL_NUM_2G_5G 59 + + +void +odm_reset_iqk_result( + void *p_dm_void +); +u8 +odm_get_right_chnl_place_for_iqk( + u8 chnl +); + +void phydm_rf_init(void *p_dm_void); +void phydm_rf_watchdog(void *p_dm_void); + +#endif /* #ifndef __HAL_PHY_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.c new file mode 100644 index 000000000000..d5d0b402cdbe --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.c @@ -0,0 +1,817 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +#define CALCULATE_SWINGTALBE_OFFSET(_offset, _direction, _size, _delta_thermal) \ + do {\ + for (_offset = 0; _offset < _size; _offset++) { \ + \ + if (_delta_thermal < thermal_threshold[_direction][_offset]) { \ + \ + if (_offset != 0)\ + _offset--;\ + break;\ + } \ + } \ + if (_offset >= _size)\ + _offset = _size-1;\ + } while (0) + +void configure_txpower_track( + struct PHY_DM_STRUCT *p_dm, + struct _TXPWRTRACK_CFG *p_config +) +{ +#if RTL8192E_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8192E) + configure_txpower_track_8192e(p_config); +#endif +#if RTL8821A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8821) + configure_txpower_track_8821a(p_config); +#endif +#if RTL8812A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8812) + configure_txpower_track_8812a(p_config); +#endif +#if RTL8188E_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8188E) + configure_txpower_track_8188e(p_config); +#endif + +#if RTL8188F_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8188F) + configure_txpower_track_8188f(p_config); +#endif + +#if RTL8723B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8723B) + configure_txpower_track_8723b(p_config); +#endif + +#if RTL8814A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8814A) + configure_txpower_track_8814a(p_config); +#endif + +#if RTL8703B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8703B) + configure_txpower_track_8703b(p_config); +#endif + +#if RTL8822B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8822B) + configure_txpower_track_8822b(p_config); +#endif + +#if RTL8723D_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8723D) + configure_txpower_track_8723d(p_config); +#endif + +/* JJ ADD 20161014 */ +#if RTL8710B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8710B) + configure_txpower_track_8710b(p_config); +#endif + +#if RTL8821C_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8821C) + configure_txpower_track_8821c(p_config); +#endif + +} + +/* ********************************************************************** + * <20121113, Kordan> This function should be called when tx_agc changed. + * Otherwise the previous compensation is gone, because we record the + * delta of temperature between two TxPowerTracking watch dogs. + * + * NOTE: If Tx BB swing or Tx scaling is varified during run-time, still + * need to call this function. + * ********************************************************************** */ +void +odm_clear_txpowertracking_state( + struct PHY_DM_STRUCT *p_dm +) +{ + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(p_dm->adapter); + u8 p = 0; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->default_cck_index; + p_rf_calibrate_info->bb_swing_idx_cck = p_rf_calibrate_info->default_cck_index; + p_rf_calibrate_info->CCK_index = 0; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->bb_swing_idx_ofdm[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->OFDM_index[p] = p_rf_calibrate_info->default_ofdm_index; + + p_rf_calibrate_info->power_index_offset[p] = 0; + p_rf_calibrate_info->delta_power_index[p] = 0; + p_rf_calibrate_info->delta_power_index_last[p] = 0; + + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = 0; /* Initial Mix mode power tracking*/ + p_rf_calibrate_info->remnant_ofdm_swing_idx[p] = 0; + p_rf_calibrate_info->kfree_offset[p] = 0; + } + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->modify_tx_agc_flag_path_b = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->modify_tx_agc_flag_path_c = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->modify_tx_agc_flag_path_d = false; /*Initial at Modify Tx Scaling mode*/ + p_rf_calibrate_info->remnant_cck_swing_idx = 0; + p_rf_calibrate_info->thermal_value = p_hal_data->eeprom_thermal_meter; + + p_rf_calibrate_info->modify_tx_agc_value_cck = 0; /* modify by Mingzhi.Guo */ + p_rf_calibrate_info->modify_tx_agc_value_ofdm = 0; /* modify by Mingzhi.Guo */ + +} + +void +odm_txpowertracking_callback_thermal_meter( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm +#else + struct _ADAPTER *adapter +#endif +) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->odmpriv; +#endif +#endif + + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u8 thermal_value = 0, delta, delta_LCK, delta_IQK, p = 0, i = 0; + s8 diff_DPK[4] = {0}; + u8 thermal_value_avg_count = 0; + u32 thermal_value_avg = 0, regc80, regcd0, regcd4, regab4; + + u8 OFDM_min_index = 0; /* OFDM BB Swing should be less than +3.0dB, which is required by Arthur */ + u8 indexforchannel = 0; /* get_right_chnl_place_for_iqk(p_hal_data->current_channel) */ + u8 power_tracking_type = p_hal_data->RfPowerTrackingType; + u8 xtal_offset_eanble = 0; + s8 thermal_value_temp = 0; + + struct _TXPWRTRACK_CFG c; + + /* 4 1. The following TWO tables decide the final index of OFDM/CCK swing table. */ + u8 *delta_swing_table_idx_tup_a = NULL; + u8 *delta_swing_table_idx_tdown_a = NULL; + u8 *delta_swing_table_idx_tup_b = NULL; + u8 *delta_swing_table_idx_tdown_b = NULL; + /*for 8814 add by Yu Chen*/ + u8 *delta_swing_table_idx_tup_c = NULL; + u8 *delta_swing_table_idx_tdown_c = NULL; + u8 *delta_swing_table_idx_tup_d = NULL; + u8 *delta_swing_table_idx_tdown_d = NULL; + /*for Xtal Offset by James.Tung*/ + s8 *delta_swing_table_xtal_up = NULL; + s8 *delta_swing_table_xtal_down = NULL; + + /* 4 2. Initilization ( 7 steps in total ) */ + + configure_txpower_track(p_dm, &c); + + (*c.get_delta_swing_table)(p_dm, (u8 **)&delta_swing_table_idx_tup_a, (u8 **)&delta_swing_table_idx_tdown_a, + (u8 **)&delta_swing_table_idx_tup_b, (u8 **)&delta_swing_table_idx_tdown_b); + + if (p_dm->support_ic_type & ODM_RTL8814A) /*for 8814 path C & D*/ + (*c.get_delta_swing_table8814only)(p_dm, (u8 **)&delta_swing_table_idx_tup_c, (u8 **)&delta_swing_table_idx_tdown_c, + (u8 **)&delta_swing_table_idx_tup_d, (u8 **)&delta_swing_table_idx_tdown_d); + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) /*for Xtal Offset*/ + (*c.get_delta_swing_xtal_table)(p_dm, (s8 **)&delta_swing_table_xtal_up, (s8 **)&delta_swing_table_xtal_down); + + + p_rf_calibrate_info->txpowertracking_callback_cnt++; /*cosa add for debug*/ + p_rf_calibrate_info->is_txpowertracking_init = true; + + /*p_rf_calibrate_info->txpowertrack_control = p_hal_data->txpowertrack_control; + We should keep updating the control variable according to HalData. + rf_calibrate_info.rega24 will be initialized when ODM HW configuring, but MP configures with para files. */ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#if (MP_DRIVER == 1) + p_rf_calibrate_info->rega24 = 0x090e1317; +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (*(p_dm->p_mp_mode) == true) + p_rf_calibrate_info->rega24 = 0x090e1317; +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("===>odm_txpowertracking_callback_thermal_meter\n p_rf_calibrate_info->bb_swing_idx_cck_base: %d, p_rf_calibrate_info->bb_swing_idx_ofdm_base[A]: %d, p_rf_calibrate_info->default_ofdm_index: %d\n", + p_rf_calibrate_info->bb_swing_idx_cck_base, p_rf_calibrate_info->bb_swing_idx_ofdm_base[RF_PATH_A], p_rf_calibrate_info->default_ofdm_index)); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("p_rf_calibrate_info->txpowertrack_control=%d, p_hal_data->eeprom_thermal_meter %d\n", p_rf_calibrate_info->txpowertrack_control, p_hal_data->eeprom_thermal_meter)); + thermal_value = (u8)odm_get_rf_reg(p_dm, RF_PATH_A, c.thermal_reg_addr, 0xfc00); /* 0x42: RF Reg[15:10] 88E */ + + thermal_value_temp = thermal_value + phydm_get_thermal_offset(p_dm); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("thermal_value_temp(%d) = thermal_value(%d) + power_time_thermal(%d)\n", thermal_value_temp, thermal_value, phydm_get_thermal_offset(p_dm))); + + if (thermal_value_temp > 63) + thermal_value = 63; + else if (thermal_value_temp < 0) + thermal_value = 0; + else + thermal_value = thermal_value_temp; + + /*add log by zhao he, check c80/c94/c14/ca0 value*/ + if (p_dm->support_ic_type == ODM_RTL8723D) { + regc80 = odm_get_bb_reg(p_dm, 0xc80, MASKDWORD); + regcd0 = odm_get_bb_reg(p_dm, 0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(p_dm, 0xcd4, MASKDWORD); + regab4 = odm_get_bb_reg(p_dm, 0xab4, 0x000007FF); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4)); + } + + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type == ODM_RTL8710B) { + regc80 = odm_get_bb_reg(p_dm, 0xc80, MASKDWORD); + regcd0 = odm_get_bb_reg(p_dm, 0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(p_dm, 0xcd4, MASKDWORD); + regab4 = odm_get_bb_reg(p_dm, 0xab4, 0x000007FF); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("0xc80 = 0x%x 0xcd0 = 0x%x 0xcd4 = 0x%x 0xab4 = 0x%x\n", regc80, regcd0, regcd4, regab4)); + } + + if (!p_rf_calibrate_info->txpowertrack_control) + return; + + if (p_hal_data->eeprom_thermal_meter == 0xff) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no pg, p_hal_data->eeprom_thermal_meter = 0x%x\n", p_hal_data->eeprom_thermal_meter)); + return; + } + + /*4 3. Initialize ThermalValues of rf_calibrate_info*/ + + if (p_rf_calibrate_info->is_reloadtxpowerindex) + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("reload ofdm index for band switch\n")); + + /*4 4. Calculate average thermal meter*/ + + p_rf_calibrate_info->thermal_value_avg[p_rf_calibrate_info->thermal_value_avg_index] = thermal_value; + p_rf_calibrate_info->thermal_value_avg_index++; + if (p_rf_calibrate_info->thermal_value_avg_index == c.average_thermal_num) /*Average times = c.average_thermal_num*/ + p_rf_calibrate_info->thermal_value_avg_index = 0; + + for (i = 0; i < c.average_thermal_num; i++) { + if (p_rf_calibrate_info->thermal_value_avg[i]) { + thermal_value_avg += p_rf_calibrate_info->thermal_value_avg[i]; + thermal_value_avg_count++; + } + } + + if (thermal_value_avg_count) { /* Calculate Average thermal_value after average enough times */ + thermal_value = (u8)(thermal_value_avg / thermal_value_avg_count); + p_rf_calibrate_info->thermal_value_delta = thermal_value - p_hal_data->eeprom_thermal_meter; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("AVG Thermal Meter = 0x%X, EFUSE Thermal base = 0x%X\n", thermal_value, p_hal_data->eeprom_thermal_meter)); + } + + /* 4 5. Calculate delta, delta_LCK, delta_IQK. */ + + /* "delta" here is used to determine whether thermal value changes or not. */ + delta = (thermal_value > p_rf_calibrate_info->thermal_value) ? (thermal_value - p_rf_calibrate_info->thermal_value) : (p_rf_calibrate_info->thermal_value - thermal_value); + delta_LCK = (thermal_value > p_rf_calibrate_info->thermal_value_lck) ? (thermal_value - p_rf_calibrate_info->thermal_value_lck) : (p_rf_calibrate_info->thermal_value_lck - thermal_value); + delta_IQK = (thermal_value > p_rf_calibrate_info->thermal_value_iqk) ? (thermal_value - p_rf_calibrate_info->thermal_value_iqk) : (p_rf_calibrate_info->thermal_value_iqk - thermal_value); + + if (p_rf_calibrate_info->thermal_value_iqk == 0xff) { /*no PG, use thermal value for IQK*/ + p_rf_calibrate_info->thermal_value_iqk = thermal_value; + delta_IQK = (thermal_value > p_rf_calibrate_info->thermal_value_iqk) ? (thermal_value - p_rf_calibrate_info->thermal_value_iqk) : (p_rf_calibrate_info->thermal_value_iqk - thermal_value); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, use thermal_value for IQK\n")); + } + + for (p = RF_PATH_A; p < c.rf_path_count; p++) + diff_DPK[p] = (s8)thermal_value - (s8)p_rf_calibrate_info->dpk_thermal[p]; + + /*4 6. If necessary, do LCK.*/ + + if (!(p_dm->support_ic_type & ODM_RTL8821)) { /*no PG, do LCK at initial status*/ + if (p_rf_calibrate_info->thermal_value_lck == 0xff) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("no PG, do LCK\n")); + p_rf_calibrate_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ + if ((!(p_dm->support_ic_type & ODM_RTL8814A)) && (!(p_dm->support_ic_type & ODM_RTL8822B))) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(p_dm); + } + + delta_LCK = (thermal_value > p_rf_calibrate_info->thermal_value_lck) ? (thermal_value - p_rf_calibrate_info->thermal_value_lck) : (p_rf_calibrate_info->thermal_value_lck - thermal_value); + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("(delta, delta_LCK, delta_IQK) = (%d, %d, %d)\n", delta, delta_LCK, delta_IQK)); + + /* Wait sacn to do LCK by RF Jenyu*/ + if( (*p_dm->p_is_scan_in_process == false) && (!p_iqk_info->rfk_forbidden)) { + /* Delta temperature is equal to or larger than 20 centigrade.*/ + if (delta_LCK >= c.threshold_iqk) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_LCK(%d) >= threshold_iqk(%d)\n", delta_LCK, c.threshold_iqk)); + p_rf_calibrate_info->thermal_value_lck = thermal_value; + + /*Use RTLCK, so close power tracking driver LCK*/ + if ((!(p_dm->support_ic_type & ODM_RTL8814A)) && (!(p_dm->support_ic_type & ODM_RTL8822B))) { + if (c.phy_lc_calibrate) + (*c.phy_lc_calibrate)(p_dm); + } + } + } + } + + /*3 7. If necessary, move the index of swing table to adjust Tx power.*/ + + if (delta > 0 && p_rf_calibrate_info->txpowertrack_control) { + /* "delta" here is used to record the absolute value of differrence. */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + delta = thermal_value > p_hal_data->eeprom_thermal_meter ? (thermal_value - p_hal_data->eeprom_thermal_meter) : (p_hal_data->eeprom_thermal_meter - thermal_value); +#else + delta = (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) ? (thermal_value - p_dm->priv->pmib->dot11RFEntry.ther) : (p_dm->priv->pmib->dot11RFEntry.ther - thermal_value); +#endif + if (delta >= TXPWR_TRACK_TABLE_SIZE) + delta = TXPWR_TRACK_TABLE_SIZE - 1; + + /*4 7.1 The Final Power index = BaseIndex + power_index_offset*/ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (thermal_value > p_hal_data->eeprom_thermal_meter) { +#else + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) { +#endif + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + p_rf_calibrate_info->delta_power_index_last[p] = p_rf_calibrate_info->delta_power_index[p]; /*recording poer index offset*/ + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_b[%d] = %d\n", delta, delta_swing_table_idx_tup_b[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_b[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_b[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_c[%d] = %d\n", delta, delta_swing_table_idx_tup_c[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_c[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_c[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_d[%d] = %d\n", delta, delta_swing_table_idx_tup_d[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_d[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_d[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tup_a[%d] = %d\n", delta, delta_swing_table_idx_tup_a[delta])); + + p_rf_calibrate_info->delta_power_index[p] = delta_swing_table_idx_tup_a[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = delta_swing_table_idx_tup_a[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is higher and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + } + } + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) { + /*Save xtal_offset from Xtal table*/ + p_rf_calibrate_info->xtal_offset_last = p_rf_calibrate_info->xtal_offset; /*recording last Xtal offset*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("[Xtal] delta_swing_table_xtal_up[%d] = %d\n", delta, delta_swing_table_xtal_up[delta])); + p_rf_calibrate_info->xtal_offset = delta_swing_table_xtal_up[delta]; + + if (p_rf_calibrate_info->xtal_offset_last == p_rf_calibrate_info->xtal_offset) + xtal_offset_eanble = 0; + else + xtal_offset_eanble = 1; + } + + } else { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + p_rf_calibrate_info->delta_power_index_last[p] = p_rf_calibrate_info->delta_power_index[p]; /*recording poer index offset*/ + + switch (p) { + case RF_PATH_B: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_b[%d] = %d\n", delta, delta_swing_table_idx_tdown_b[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_b[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_b[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_B] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_C: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_c[%d] = %d\n", delta, delta_swing_table_idx_tdown_c[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_c[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_c[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_C] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + case RF_PATH_D: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_d[%d] = %d\n", delta, delta_swing_table_idx_tdown_d[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_d[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_d[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_D] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + + default: + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("delta_swing_table_idx_tdown_a[%d] = %d\n", delta, delta_swing_table_idx_tdown_a[delta])); + p_rf_calibrate_info->delta_power_index[p] = -1 * delta_swing_table_idx_tdown_a[delta]; + p_rf_calibrate_info->absolute_ofdm_swing_idx[p] = -1 * delta_swing_table_idx_tdown_a[delta]; /*Record delta swing for mix mode power tracking*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("******Temp is lower and p_rf_calibrate_info->absolute_ofdm_swing_idx[RF_PATH_A] = %d\n", p_rf_calibrate_info->absolute_ofdm_swing_idx[p])); + break; + } + } + /* JJ ADD 20161014 */ + if (p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) { + /*Save xtal_offset from Xtal table*/ + p_rf_calibrate_info->xtal_offset_last = p_rf_calibrate_info->xtal_offset; /*recording last Xtal offset*/ + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("[Xtal] delta_swing_table_xtal_down[%d] = %d\n", delta, delta_swing_table_xtal_down[delta])); + p_rf_calibrate_info->xtal_offset = delta_swing_table_xtal_down[delta]; + + if (p_rf_calibrate_info->xtal_offset_last == p_rf_calibrate_info->xtal_offset) + xtal_offset_eanble = 0; + else + xtal_offset_eanble = 1; + } + + } + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\n\n=========================== [path-%d] Calculating power_index_offset===========================\n", p)); + + if (p_rf_calibrate_info->delta_power_index[p] == p_rf_calibrate_info->delta_power_index_last[p]) /*If Thermal value changes but lookup table value still the same*/ + p_rf_calibrate_info->power_index_offset[p] = 0; + else + p_rf_calibrate_info->power_index_offset[p] = p_rf_calibrate_info->delta_power_index[p] - p_rf_calibrate_info->delta_power_index_last[p]; /*Power index diff between 2 times Power Tracking*/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("[path-%d] power_index_offset(%d) = delta_power_index(%d) - delta_power_index_last(%d)\n", p, p_rf_calibrate_info->power_index_offset[p], p_rf_calibrate_info->delta_power_index[p], p_rf_calibrate_info->delta_power_index_last[p])); + + p_rf_calibrate_info->OFDM_index[p] = p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] + p_rf_calibrate_info->power_index_offset[p]; + p_rf_calibrate_info->CCK_index = p_rf_calibrate_info->bb_swing_idx_cck_base + p_rf_calibrate_info->power_index_offset[p]; + + p_rf_calibrate_info->bb_swing_idx_cck = p_rf_calibrate_info->CCK_index; + p_rf_calibrate_info->bb_swing_idx_ofdm[p] = p_rf_calibrate_info->OFDM_index[p]; + + /*************Print BB Swing base and index Offset*************/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("The 'CCK' final index(%d) = BaseIndex(%d) + power_index_offset(%d)\n", p_rf_calibrate_info->bb_swing_idx_cck, p_rf_calibrate_info->bb_swing_idx_cck_base, p_rf_calibrate_info->power_index_offset[p])); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("The 'OFDM' final index(%d) = BaseIndex[%d](%d) + power_index_offset(%d)\n", p_rf_calibrate_info->bb_swing_idx_ofdm[p], p, p_rf_calibrate_info->bb_swing_idx_ofdm_base[p], p_rf_calibrate_info->power_index_offset[p])); + + /*4 7.1 Handle boundary conditions of index.*/ + + if (p_rf_calibrate_info->OFDM_index[p] > c.swing_table_size_ofdm - 1) + p_rf_calibrate_info->OFDM_index[p] = c.swing_table_size_ofdm - 1; + else if (p_rf_calibrate_info->OFDM_index[p] <= OFDM_min_index) + p_rf_calibrate_info->OFDM_index[p] = OFDM_min_index; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("\n\n========================================================================================================\n")); + + if (p_rf_calibrate_info->CCK_index > c.swing_table_size_cck - 1) + p_rf_calibrate_info->CCK_index = c.swing_table_size_cck - 1; + else if (p_rf_calibrate_info->CCK_index <= 0) + p_rf_calibrate_info->CCK_index = 0; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("The thermal meter is unchanged or TxPowerTracking OFF(%d): thermal_value: %d, p_rf_calibrate_info->thermal_value: %d\n", + p_rf_calibrate_info->txpowertrack_control, thermal_value, p_rf_calibrate_info->thermal_value)); + + for (p = RF_PATH_A; p < c.rf_path_count; p++) + p_rf_calibrate_info->power_index_offset[p] = 0; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("TxPowerTracking: [CCK] Swing Current index: %d, Swing base index: %d\n", + p_rf_calibrate_info->CCK_index, p_rf_calibrate_info->bb_swing_idx_cck_base)); /*Print Swing base & current*/ + + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("TxPowerTracking: [OFDM] Swing Current index: %d, Swing base index[%d]: %d\n", + p_rf_calibrate_info->OFDM_index[p], p, p_rf_calibrate_info->bb_swing_idx_ofdm_base[p])); + } + + if ((p_dm->support_ic_type & ODM_RTL8814A)) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("power_tracking_type=%d\n", power_tracking_type)); + + if (power_tracking_type == 0) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } else if (power_tracking_type == 1) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(2G) TSSI(5G) MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_2G_TSSI_5G_MODE, p, 0); + } else if (power_tracking_type == 2) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX(5G) TSSI(2G)MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_5G_TSSI_2G_MODE, p, 0); + } else if (power_tracking_type == 3) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking TSSI MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, TSSI_MODE, p, 0); + } + p_rf_calibrate_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ + + } else if ((p_rf_calibrate_info->power_index_offset[RF_PATH_A] != 0 || + p_rf_calibrate_info->power_index_offset[RF_PATH_B] != 0 || + p_rf_calibrate_info->power_index_offset[RF_PATH_C] != 0 || + p_rf_calibrate_info->power_index_offset[RF_PATH_D] != 0) && + p_rf_calibrate_info->txpowertrack_control && (p_hal_data->eeprom_thermal_meter != 0xff)) { + /* 4 7.2 Configure the Swing Table to adjust Tx Power. */ + + p_rf_calibrate_info->is_tx_power_changed = true; /*Always true after Tx Power is adjusted by power tracking.*/ + /* */ + /* 2012/04/23 MH According to Luke's suggestion, we can not write BB digital */ + /* to increase TX power. Otherwise, EVM will be bad. */ + /* */ + /* 2012/04/25 MH Add for tx power tracking to set tx power in tx agc for 88E. */ + if (thermal_value > p_rf_calibrate_info->thermal_value) { + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature Increasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, p_rf_calibrate_info->power_index_offset[p], delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_rf_calibrate_info->thermal_value)); + } + } else if (thermal_value < p_rf_calibrate_info->thermal_value) { /*Low temperature*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature Decreasing(%d): delta_pi: %d, delta_t: %d, Now_t: %d, EFUSE_t: %d, Last_t: %d\n", + p, p_rf_calibrate_info->power_index_offset[p], delta, thermal_value, p_hal_data->eeprom_thermal_meter, p_rf_calibrate_info->thermal_value)); + } + } + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (thermal_value > p_hal_data->eeprom_thermal_meter) +#else + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) +#endif + { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) higher than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8821 || + p_dm->support_ic_type == ODM_RTL8812 || p_dm->support_ic_type == ODM_RTL8723B || p_dm->support_ic_type == ODM_RTL8814A || + p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8188F || p_dm->support_ic_type == ODM_RTL8822B || + p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8821C || p_dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, 0); + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, p, indexforchannel); + } + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) lower than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8821 || + p_dm->support_ic_type == ODM_RTL8812 || p_dm->support_ic_type == ODM_RTL8723B || p_dm->support_ic_type == ODM_RTL8814A || + p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8188F || p_dm->support_ic_type == ODM_RTL8822B || + p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8821C || p_dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking MIX_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, MIX_MODE, p, indexforchannel); + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter POWER Tracking BBSWING_MODE**********\n")); + for (p = RF_PATH_A; p < c.rf_path_count; p++) + (*c.odm_tx_pwr_track_set_pwr)(p_dm, BBSWING, p, indexforchannel); + } + + } + + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->bb_swing_idx_cck; /*Record last time Power Tracking result as base.*/ + for (p = RF_PATH_A; p < c.rf_path_count; p++) + p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] = p_rf_calibrate_info->bb_swing_idx_ofdm[p]; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("p_rf_calibrate_info->thermal_value = %d thermal_value= %d\n", p_rf_calibrate_info->thermal_value, thermal_value)); + + p_rf_calibrate_info->thermal_value = thermal_value; /*Record last Power Tracking Thermal value*/ + + } + + + if (p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8710B) {/* JJ ADD 20161014 */ + + if (xtal_offset_eanble != 0 && p_rf_calibrate_info->txpowertrack_control && (p_hal_data->eeprom_thermal_meter != 0xff)) { + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********Enter Xtal Tracking**********\n")); + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + if (thermal_value > p_hal_data->eeprom_thermal_meter) { +#else + if (thermal_value > p_dm->priv->pmib->dot11RFEntry.ther) { +#endif + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) higher than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); + (*c.odm_txxtaltrack_set_xtal)(p_dm); + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("Temperature(%d) lower than PG value(%d)\n", thermal_value, p_hal_data->eeprom_thermal_meter)); + (*c.odm_txxtaltrack_set_xtal)(p_dm); + } + } + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("**********End Xtal Tracking**********\n")); + } + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + + /* Wait sacn to do IQK by RF Jenyu*/ + if ((*p_dm->p_is_scan_in_process == false) && (!p_iqk_info->rfk_forbidden)) { + if (!IS_HARDWARE_TYPE_8723B(adapter)) { + /*Delta temperature is equal to or larger than 20 centigrade (When threshold is 8).*/ + if (delta_IQK >= c.threshold_iqk) { + p_rf_calibrate_info->thermal_value_iqk = thermal_value; + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("delta_IQK(%d) >= threshold_iqk(%d)\n", delta_IQK, c.threshold_iqk)); + if (!p_rf_calibrate_info->is_iqk_in_progress) + (*c.do_iqk)(p_dm, delta_IQK, thermal_value, 8); + } + } + } + if (p_rf_calibrate_info->dpk_thermal[RF_PATH_A] != 0) { + if (diff_DPK[RF_PATH_A] >= c.threshold_dpk) { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_A] / c.threshold_dpk)); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else if ((diff_DPK[RF_PATH_A] <= -1 * c.threshold_dpk)) { + s32 value = 0x20 + (diff_DPK[RF_PATH_A] / c.threshold_dpk); + + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xcc4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } + } + if (p_rf_calibrate_info->dpk_thermal[RF_PATH_B] != 0) { + if (diff_DPK[RF_PATH_B] >= c.threshold_dpk) { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), (diff_DPK[RF_PATH_B] / c.threshold_dpk)); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else if ((diff_DPK[RF_PATH_B] <= -1 * c.threshold_dpk)) { + s32 value = 0x20 + (diff_DPK[RF_PATH_B] / c.threshold_dpk); + + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), value); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } else { + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x1); + odm_set_bb_reg(p_dm, 0xec4, BIT(14) | BIT(13) | BIT(12) | BIT(11) | BIT(10), 0); + odm_set_bb_reg(p_dm, 0x82c, BIT(31), 0x0); + } + } + +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("<===odm_txpowertracking_callback_thermal_meter\n")); + + p_rf_calibrate_info->tx_powercount = 0; +} + + + +/* 3============================================================ + * 3 IQ Calibration + * 3============================================================ */ + +void +odm_reset_iqk_result( + struct PHY_DM_STRUCT *p_dm +) +{ + return; +} +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) +u8 odm_get_right_chnl_place_for_iqk(u8 chnl) +{ + u8 channel_all[ODM_TARGET_CHNL_NUM_2G_5G] = { + 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165 + }; + u8 place = chnl; + + + if (chnl > 14) { + for (place = 14; place < sizeof(channel_all); place++) { + if (channel_all[place] == chnl) + return place - 13; + } + } + return 0; + +} +#endif + +void +odm_iq_calibrate( + struct PHY_DM_STRUCT *p_dm +) +{ + struct _ADAPTER *adapter = p_dm->adapter; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + RT_TRACE(COMP_SCAN, ODM_DBG_LOUD, ("=>%s\n" , __FUNCTION__)); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (*p_dm->p_is_fcs_mode_enable) + return; +#endif + + if ((p_dm->is_linked) && (!p_iqk_info->rfk_forbidden)) { + RT_TRACE(COMP_SCAN, ODM_DBG_LOUD, ("interval=%d ch=%d prech=%d scan=%s\n", p_dm->linked_interval, + *p_dm->p_channel, p_dm->pre_channel, *p_dm->p_is_scan_in_process == TRUE ? "TRUE":"FALSE")); + + if (*p_dm->p_channel != p_dm->pre_channel) { + p_dm->pre_channel = *p_dm->p_channel; + p_dm->linked_interval = 0; + } + + if ((p_dm->linked_interval < 3) && (!*p_dm->p_is_scan_in_process)) + p_dm->linked_interval++; + + if (p_dm->linked_interval == 2) + PHY_IQCalibrate(adapter, false); + } else + p_dm->linked_interval = 0; + + RT_TRACE(COMP_SCAN, ODM_DBG_LOUD, ("<=%s interval=%d ch=%d prech=%d scan=%s\n", __FUNCTION__, p_dm->linked_interval, + *p_dm->p_channel, p_dm->pre_channel, *p_dm->p_is_scan_in_process == TRUE?"TRUE":"FALSE")); +} + +void phydm_rf_init(struct PHY_DM_STRUCT *p_dm) +{ + + odm_txpowertracking_init(p_dm); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_clear_txpowertracking_state(p_dm); +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8814A) + phy_iq_calibrate_8814a_init(p_dm); +#endif +#endif + +} + +void phydm_rf_watchdog(struct PHY_DM_STRUCT *p_dm) +{ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_txpowertracking_check(p_dm); + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_iq_calibrate(p_dm); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.h new file mode 100644 index 000000000000..bb6f2555a481 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halphyrf_win.h @@ -0,0 +1,114 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __HAL_PHY_RF_H__ +#define __HAL_PHY_RF_H__ + +#if (RTL8814A_SUPPORT == 1) + #include "halrf/rtl8814a/halrf_iqk_8814a.h" +#endif + +#if (RTL8822B_SUPPORT == 1) + #include "halrf/rtl8822b/halrf_iqk_8822b.h" + #include "../mac/Halmac_type.h" +#endif +#include "halrf/halrf_powertracking_win.h" +#include "halrf/halrf_kfree.h" +#include "halrf/halrf_txgapcal.h" +#if (RTL8821C_SUPPORT == 1) + #include "halrf/rtl8821c/halrf_iqk_8821c.h" +#endif + +enum spur_cal_method { + PLL_RESET, + AFE_PHASE_SEL +}; + +enum pwrtrack_method { + BBSWING, + TXAGC, + MIX_MODE, + TSSI_MODE, + MIX_2G_TSSI_5G_MODE, + MIX_5G_TSSI_2G_MODE +}; + +typedef void(*func_set_pwr)(void *, enum pwrtrack_method, u8, u8); +typedef void(*func_iqk)(void *, u8, u8, u8); +typedef void(*func_lck)(void *); +typedef void(*func_swing)(void *, u8 **, u8 **, u8 **, u8 **); +typedef void(*func_swing8814only)(void *, u8 **, u8 **, u8 **, u8 **); +typedef void (*func_swing_xtal)(void *, s8 **, s8 **); +typedef void (*func_set_xtal)(void *); +typedef void(*func_all_swing)(void *, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **, u8 **); + +struct _TXPWRTRACK_CFG { + u8 swing_table_size_cck; + u8 swing_table_size_ofdm; + u8 threshold_iqk; + u8 threshold_dpk; + u8 average_thermal_num; + u8 rf_path_count; + u32 thermal_reg_addr; + func_set_pwr odm_tx_pwr_track_set_pwr; + func_iqk do_iqk; + func_lck phy_lc_calibrate; + func_swing get_delta_swing_table; + func_swing8814only get_delta_swing_table8814only; + func_swing_xtal get_delta_swing_xtal_table; + func_set_xtal odm_txxtaltrack_set_xtal; + func_all_swing get_delta_all_swing_table; +}; + +void +configure_txpower_track( + struct PHY_DM_STRUCT *p_dm, + struct _TXPWRTRACK_CFG *p_config +); + + +void +odm_clear_txpowertracking_state( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_txpowertracking_callback_thermal_meter( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm +#else + struct _ADAPTER *adapter +#endif +); + + + +#define ODM_TARGET_CHNL_NUM_2G_5G 59 + + +void +odm_reset_iqk_result( + struct PHY_DM_STRUCT *p_dm +); +u8 +odm_get_right_chnl_place_for_iqk( + u8 chnl +); + +void odm_iq_calibrate(struct PHY_DM_STRUCT *p_dm); +void phydm_rf_init(struct PHY_DM_STRUCT *p_dm); +void phydm_rf_watchdog(struct PHY_DM_STRUCT *p_dm); + +#endif /* #ifndef __HAL_PHY_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.c new file mode 100644 index 000000000000..33cdaf442fbd --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.c @@ -0,0 +1,1471 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void halrf_basic_profile( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + /* HAL RF version List */ + PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% HAL RF version %")); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Power Tracking", HALRF_POWRTRACKING_VER)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "IQK", HALRF_IQK_VER)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "LCK", HALRF_LCK_VER)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "DPK", HALRF_DPK_VER)); + + *_used = used; + *_out_len = out_len; +#endif +} + +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) +void +_iqk_page_switch( + void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + if (p_dm->support_ic_type == ODM_RTL8821C) + odm_write_4byte(p_dm, 0x1b00, 0xf8000008); + else + odm_write_4byte(p_dm, 0x1b00, 0xf800000a); +} + +u32 halrf_psd_log2base(IN u32 val) +{ + u8 j; + u32 tmp, tmp2, val_integerd_b = 0, tindex, shiftcount = 0; + u32 result, val_fractiond_b = 0, table_fraction[21] = {0, 432, 332, 274, 232, 200, + 174, 151, 132, 115, 100, 86, 74, 62, 51, 42, + 32, 23, 15, 7, 0 + }; + + if (val == 0) + return 0; + + tmp = val; + + while (1) { + if (tmp == 1) + break; + + tmp = (tmp >> 1); + shiftcount++; + } + + + val_integerd_b = shiftcount + 1; + + tmp2 = 1; + for (j = 1; j <= val_integerd_b; j++) + tmp2 = tmp2 * 2; + + tmp = (val * 100) / tmp2; + tindex = tmp / 5; + + if (tindex > 20) + tindex = 20; + + val_fractiond_b = table_fraction[tindex]; + + result = val_integerd_b * 100 - val_fractiond_b; + + return result; + + +} + +void phydm_get_iqk_cfir( + void *p_dm_void, + u8 idx, + u8 path, + boolean debug +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + u8 i, ch; + u32 tmp; + + if (debug) + ch = 2; + else + ch = 0; + + odm_set_bb_reg(p_dm, 0x1b00, MASKDWORD, 0xf8000008 | path << 1); + if (idx == 0) + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x3); + else + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x1); + odm_set_bb_reg(p_dm, 0x1bd4, BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16), 0x10); + for (i = 0; i < 8; i++) { + odm_set_bb_reg(p_dm, 0x1bd8, MASKDWORD, 0xe0000001 + (i * 4)); + tmp = odm_get_bb_reg(p_dm, 0x1bfc, MASKDWORD); + p_iqk_info->IQK_CFIR_real[ch][path][idx][i] = (tmp & 0x0fff0000) >> 16; + p_iqk_info->IQK_CFIR_imag[ch][path][idx][i] = tmp & 0xfff; + } + odm_set_bb_reg(p_dm, 0x1bd8, MASKDWORD, 0x0); + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x0); +} + +void +halrf_iqk_xym_enable( + struct PHY_DM_STRUCT *p_dm, + u8 xym_enable + ) +{ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + if (xym_enable == 0) + p_iqk_info->xym_read = false; + else + p_iqk_info->xym_read = true; + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s %s\n", "xym_read = ", (p_iqk_info->xym_read ? "true": "false"))); +} + +void +halrf_iqk_xym_read( + void *p_dm_void, + u8 path, + u8 xym_type /*0: rx_sym; 1: tx_xym; 2:gs1_xym; 3:gs2_sym; 4: rxk1_xym*/ + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u8 i, start, num; + u32 tmp1, tmp2; + + if (!p_iqk_info->xym_read) + return; + + if (*p_dm->p_band_width == 0) { + start = 3; + num = 4; + }else if (*p_dm->p_band_width == 1) { + start = 2; + num = 6; + }else { + start = 0; + num = 10; + } + + odm_write_4byte(p_dm, 0x1b00, 0xf8000008); + tmp1 = odm_read_4byte(p_dm, 0x1b1c); + odm_write_4byte(p_dm, 0x1b1c, 0xa2193c32); + + odm_write_4byte(p_dm, 0x1b00, 0xf800000a); + tmp2 = odm_read_4byte(p_dm, 0x1b1c); + odm_write_4byte(p_dm, 0x1b1c, 0xa2193c32); + + for (path = 0; path < 2; path ++) { + odm_write_4byte(p_dm, 0x1b00, 0xf8000008 | path << 1); + switch(xym_type){ + case 0: + for (i = 0; i < num ;i++) { + odm_write_4byte(p_dm, 0x1b14, 0xe6+start+i); + odm_write_4byte(p_dm, 0x1b14, 0x0); + p_iqk_info->rx_xym[path][i] = odm_read_4byte(p_dm, 0x1b38); + } + break; + case 1: + for (i = 0; i < num ;i++) { + odm_write_4byte(p_dm, 0x1b14, 0xe6+start+i); + odm_write_4byte(p_dm, 0x1b14, 0x0); + p_iqk_info->tx_xym[path][i] = odm_read_4byte(p_dm, 0x1b38); + } + break; + case 2: + for (i = 0; i < 6 ;i++) { + odm_write_4byte(p_dm, 0x1b14, 0xe0+i); + odm_write_4byte(p_dm, 0x1b14, 0x0); + p_iqk_info->gs1_xym[path][i] = odm_read_4byte(p_dm, 0x1b38); + } + break; + case 3: + for (i = 0; i < 6 ;i++) { + odm_write_4byte(p_dm, 0x1b14, 0xe0+i); + odm_write_4byte(p_dm, 0x1b14, 0x0); + p_iqk_info->gs2_xym[path][i] = odm_read_4byte(p_dm, 0x1b38); + } + break; + case 4: + for (i = 0; i < 6 ;i++) { + odm_write_4byte(p_dm, 0x1b14, 0xe0+i); + odm_write_4byte(p_dm, 0x1b14, 0x0); + p_iqk_info->rxk1_xym[path][i] = odm_read_4byte(p_dm, 0x1b38); + } + break; + + } + odm_write_4byte(p_dm, 0x1b38, 0x20000000); + odm_write_4byte(p_dm, 0x1b00, 0xf8000008); + odm_write_4byte(p_dm, 0x1b1c, tmp1); + odm_write_4byte(p_dm, 0x1b00, 0xf800000a); + odm_write_4byte(p_dm, 0x1b1c, tmp2); + _iqk_page_switch(p_dm); + } +} + +void halrf_iqk_xym_show( + struct PHY_DM_STRUCT *p_dm, + u8 xym_type /*0: rx_sym; 1: tx_xym; 2:gs1_xym; 3:gs2_sym; 4: rxk1_xym*/ + ) +{ + u8 num, path, path_num, i; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + if (p_dm->rf_type ==RF_1T1R) + path_num = 0x1; + else if (p_dm->rf_type ==RF_2T2R) + path_num = 0x2; + else + path_num = 0x4; + + if (*p_dm->p_band_width == CHANNEL_WIDTH_20) + num = 4; + else if (*p_dm->p_band_width == CHANNEL_WIDTH_40) + num = 6; + else + num = 10; + + for (path = 0; path < path_num; path ++) { + switch (xym_type){ + case 0: + for (i = 0 ; i < num; i ++) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A RX-XYM ": "PATH B RX-XYM", i, p_iqk_info->rx_xym[path][i])); + break; + case 1: + for (i = 0 ; i < num; i ++) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A TX-XYM ": "PATH B TX-XYM", i, p_iqk_info->tx_xym[path][i])); + break; + case 2: + for (i = 0 ; i < 6; i ++) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A GS1-XYM ": "PATH B GS1-XYM", i, p_iqk_info->gs1_xym[path][i])); + break; + case 3: + for (i = 0 ; i < 6; i ++) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A GS2-XYM ": "PATH B GS2-XYM", i, p_iqk_info->gs2_xym[path][i])); + break; + case 4: + for (i = 0 ; i < 6; i ++) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s %-2d: 0x%x\n", + (path == 0) ? "PATH A RXK1-XYM ": "PATH B RXK1-XYM", i, p_iqk_info->rxk1_xym[path][i])); + break; + } + } +} + + +void +halrf_iqk_xym_dump( + void *p_dm_void + ) +{ + u32 tmp1, tmp2; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + odm_write_4byte(p_dm, 0x1b00, 0xf8000008); + tmp1 = odm_read_4byte(p_dm, 0x1b1c); + odm_write_4byte(p_dm, 0x1b00, 0xf800000a); + tmp2 = odm_read_4byte(p_dm, 0x1b1c); + /*halrf_iqk_xym_read(p_dm, xym_type);*/ + odm_write_4byte(p_dm, 0x1b00, 0xf8000008); + odm_write_4byte(p_dm, 0x1b1c, tmp1); + odm_write_4byte(p_dm, 0x1b00, 0xf800000a); + odm_write_4byte(p_dm, 0x1b1c, tmp2); + _iqk_page_switch(p_dm); +} + +void halrf_iqk_info_dump( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u8 path, num, i; + + u8 rf_path, j, reload_iqk = 0; + u32 tmp; + boolean iqk_result[2][NUM][2]; /*two channel, PATH, TX/RX, 0:pass 1 :fail*/ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + /* IQK INFO */ + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s\n", "% IQK Info %")); + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s\n", + (p_dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW-IQK" : "Driver-IQK")); + + reload_iqk = (u8)odm_get_bb_reg(p_dm, 0x1bf0, BIT(16)); + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "reload", (reload_iqk) ? "True" : "False")); + + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "rfk_forbidden", (p_iqk_info->rfk_forbidden) ? "True" : "False")); +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "segment_iqk", (p_iqk_info->segment_iqk) ? "True" : "False")); +#endif + + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s:%d %d\n", + "iqk count / fail count", p_dm->n_iqk_cnt, p_dm->n_iqk_fail_cnt)); + + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %d\n", + "channel", *p_dm->p_channel)); + + if (*p_dm->p_band_width == CHANNEL_WIDTH_20) + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "bandwidth", "BW_20")); + else if (*p_dm->p_band_width == CHANNEL_WIDTH_40) + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "bandwidth", "BW_40")); + else if (*p_dm->p_band_width == CHANNEL_WIDTH_80) + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "bandwidth", "BW_80")); + else if (*p_dm->p_band_width == CHANNEL_WIDTH_160) + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "bandwidth", "BW_160")); + else + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "bandwidth", "BW_UNKNOW")); + + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %llu %s\n", + "progressing_time", p_dm->rf_calibrate_info.iqk_total_progressing_time, "(ms)")); + + tmp = odm_read_4byte(p_dm, 0x1bf0); + for(rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) + for(j = 0; j < 2; j++) + iqk_result[0][rf_path][j] = (boolean)(tmp & BIT(rf_path + (j * 4)) >> (rf_path + (j * 4))); + + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: 0x%08x\n","Reg0x1bf0", tmp)); + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "PATH_A-Tx result", (iqk_result[0][RF_PATH_A][0]) ? "Fail" : "Pass")); + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "PATH_A-Rx result", (iqk_result[0][RF_PATH_A][1]) ? "Fail" : "Pass")); +#if (RTL8822B_SUPPORT == 1) + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "PATH_B-Tx result", (iqk_result[0][RF_PATH_B][0]) ? "Fail" : "Pass")); + PHYDM_SNPRINTF((output + used, out_len - used, "%-20s: %s\n", + "PATH_B-Rx result", (iqk_result[0][RF_PATH_B][1]) ? "Fail" : "Pass")); +#endif + *_used = used; + *_out_len = out_len; + +} + +void halrf_get_fw_version(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + { + struct _ADAPTER *adapter = p_dm->adapter; + + p_rf->fw_ver = (adapter->MgntInfo.FirmwareVersion << 16) | adapter->MgntInfo.FirmwareSubVersion; + } +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + { + struct rtl8192cd_priv *priv = p_dm->priv; + + p_rf->fw_ver = (priv->pshare->fw_version << 16) | priv->pshare->fw_sub_version; + } +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + { + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + struct rtl_hal *rtlhal = rtl_hal(rtlpriv); + + p_rf->fw_ver = (rtlhal->fw_version << 16) | rtlhal->fw_subversion; + } +#else + { + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + p_rf->fw_ver = (p_hal_data->firmware_version << 16) | p_hal_data->firmware_sub_version; + } +#endif +} + + +void halrf_iqk_dbg(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 rf_path, j, reload_iqk = 0; + u8 path, num, i; + u32 tmp; + boolean iqk_result[2][NUM][2]; /*two channel, PATH, TX/RX, 0:pass 1 :fail*/ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + /* IQK INFO */ + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s\n", "====== IQK Info ======")); + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s\n", + (p_dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "FW-IQK" : "Driver-IQK")); + + if (p_dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) { + halrf_get_fw_version(p_dm); + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: 0x%x\n", + "FW_VER", p_rf->fw_ver)); + } else + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "IQK_VER", HALRF_IQK_VER)); + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION,( "%-20s: %s\n", + "reload", (p_iqk_info->is_reload) ? "True" : "False")); + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %d %d\n", + "iqk count / fail count", p_dm->n_iqk_cnt, p_dm->n_iqk_fail_cnt)); + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %d\n", + "channel", *p_dm->p_channel)); + + if (*p_dm->p_band_width == CHANNEL_WIDTH_20) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "bandwidth", "BW_20")); + else if (*p_dm->p_band_width == CHANNEL_WIDTH_40) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "bandwidth", "BW_40")); + else if (*p_dm->p_band_width == CHANNEL_WIDTH_80) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "bandwidth", "BW_80")); + else if (*p_dm->p_band_width == CHANNEL_WIDTH_160) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "bandwidth", "BW_160")); + else + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "bandwidth", "BW_UNKNOW")); +/* + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %llu %s\n", + "progressing_time", p_dm->rf_calibrate_info.iqk_total_progressing_time, "(ms)")); +*/ + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "rfk_forbidden", (p_iqk_info->rfk_forbidden) ? "True" : "False")); +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "segment_iqk", (p_iqk_info->segment_iqk) ? "True" : "False")); +#endif + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %llu %s\n", + "progressing_time", p_dm->rf_calibrate_info.iqk_progressing_time, "(ms)")); + + + + + tmp = odm_read_4byte(p_dm, 0x1bf0); + for(rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) + for(j = 0; j < 2; j++) + iqk_result[0][rf_path][j] = (boolean)(tmp & BIT(rf_path + (j * 4)) >> (rf_path + (j * 4))); + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: 0x%08x\n", "Reg0x1bf0", tmp)); + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: 0x%08x\n", "Reg0x1be8", odm_read_4byte(p_dm, 0x1be8))); + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "PATH_A-Tx result", (iqk_result[0][RF_PATH_A][0]) ? "Fail" : "Pass")); + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "PATH_A-Rx result", (iqk_result[0][RF_PATH_A][1]) ? "Fail" : "Pass")); +#if (RTL8822B_SUPPORT == 1) + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "PATH_B-Tx result", (iqk_result[0][RF_PATH_B][0]) ? "Fail" : "Pass")); + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %s\n", + "PATH_B-Rx result", (iqk_result[0][RF_PATH_B][1]) ? "Fail" : "Pass")); +#endif + + +} +void halrf_lck_dbg(struct PHY_DM_STRUCT *p_dm) +{ + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s\n", "====== LCK Info ======")); + /*PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, "%-20s\n", + (p_dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? "LCK" : "RTK"));*/ + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("%-20s: %llu %s\n", + "progressing_time", p_dm->rf_calibrate_info.lck_progressing_time, "(ms)")); +} + +void +halrf_iqk_dbg_cfir_backup(struct PHY_DM_STRUCT *p_dm) +{ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u8 path, idx, i; + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s\n", "backup TX/RX CFIR")); + + for (path = 0; path < 2; path ++) { + for (idx = 0; idx < 2; idx++) { + phydm_get_iqk_cfir(p_dm, idx, path, true); + } + } + + for (path = 0; path < 2; path ++) { + for (idx = 0; idx < 2; idx++) { + for(i = 0; i < 8; i++) { + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-7s %-3s CFIR_real: %-2d: 0x%x\n", + (path == 0) ? "PATH A": "PATH B", (idx == 0) ? "TX": "RX", i, p_iqk_info->IQK_CFIR_real[2][path][idx][i])); + } + for(i = 0; i < 8; i++) { + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-7s %-3s CFIR_img:%-2d: 0x%x\n", + (path == 0) ? "PATH A": "PATH B", (idx == 0) ? "TX": "RX", i, p_iqk_info->IQK_CFIR_imag[2][path][idx][i])); + } + } + } +} + + +void +halrf_iqk_dbg_cfir_backup_update( + struct PHY_DM_STRUCT *p_dm +) +{ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u8 i, path, idx; + + if(p_iqk_info->IQK_CFIR_real[2][0][0][0] == 0) { + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s\n", "CFIR is invalid")); + return; + } + for (path = 0; path < 2; path++) { + for (idx = 0; idx < 2; idx++) { + odm_set_bb_reg(p_dm, 0x1b00, MASKDWORD, 0xf8000008 | path << 1); + odm_set_bb_reg(p_dm, 0x1b2c, MASKDWORD, 0x7); + odm_set_bb_reg(p_dm, 0x1b38, MASKDWORD, 0x20000000); + odm_set_bb_reg(p_dm, 0x1b3c, MASKDWORD, 0x20000000); + odm_set_bb_reg(p_dm, 0x1bcc, MASKDWORD, 0x00000000); + if (idx == 0) + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x3); + else + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x1); + odm_set_bb_reg(p_dm, 0x1bd4, BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16), 0x10); + for (i = 0; i < 8; i++) { + odm_write_4byte(p_dm, 0x1bd8, ((0xc0000000 >> idx) + 0x3) + (i * 4) + (p_iqk_info->IQK_CFIR_real[2][path][idx][i] << 9)); + odm_write_4byte(p_dm, 0x1bd8, ((0xc0000000 >> idx) + 0x1) + (i * 4) + (p_iqk_info->IQK_CFIR_imag[2][path][idx][i] << 9)); + /*odm_write_4byte(p_dm, 0x1bd8, p_iqk_info->IQK_CFIR_real[2][path][idx][i]);*/ + /*odm_write_4byte(p_dm, 0x1bd8, p_iqk_info->IQK_CFIR_imag[2][path][idx][i]);*/ + } + } + odm_set_bb_reg(p_dm, 0x1bd8, MASKDWORD, 0x0); + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x0); + } + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s\n", "update new CFIR")); +} + + +void +halrf_iqk_dbg_cfir_reload( + struct PHY_DM_STRUCT *p_dm +) +{ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u8 i, path, idx; + + if(p_iqk_info->IQK_CFIR_real[0][0][0][0] == 0) { + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s\n", "CFIR is invalid")); + return; + } + for (path = 0; path < 2; path++) { + for (idx = 0; idx < 2; idx++) { + odm_set_bb_reg(p_dm, 0x1b00, MASKDWORD, 0xf8000008 | path << 1); + odm_set_bb_reg(p_dm, 0x1b2c, MASKDWORD, 0x7); + odm_set_bb_reg(p_dm, 0x1b38, MASKDWORD, 0x20000000); + odm_set_bb_reg(p_dm, 0x1b3c, MASKDWORD, 0x20000000); + odm_set_bb_reg(p_dm, 0x1bcc, MASKDWORD, 0x00000000); + if (idx == 0) + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x3); + else + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x1); + odm_set_bb_reg(p_dm, 0x1bd4, BIT(20) | BIT(19) | BIT(18) | BIT(17) | BIT(16), 0x10); + for (i = 0; i < 8; i++) { + /*odm_write_4byte(p_dm, 0x1bd8, p_iqk_info->IQK_CFIR_real[0][path][idx][i]);*/ + /*odm_write_4byte(p_dm, 0x1bd8, p_iqk_info->IQK_CFIR_imag[0][path][idx][i]);*/ + odm_write_4byte(p_dm, 0x1bd8, ((0xc0000000 >> idx) + 0x3) + (i * 4) + (p_iqk_info->IQK_CFIR_real[0][path][idx][i] << 9)); + odm_write_4byte(p_dm, 0x1bd8, ((0xc0000000 >> idx) + 0x1) + (i * 4) + (p_iqk_info->IQK_CFIR_imag[0][path][idx][i] << 9)); + } + } + odm_set_bb_reg(p_dm, 0x1bd8, MASKDWORD, 0x0); + odm_set_bb_reg(p_dm, 0x1b0c, BIT(13) | BIT(12), 0x0); + } + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s\n", "write CFIR with default value")); +} + +void +halrf_iqk_dbg_cfir_write( + struct PHY_DM_STRUCT *p_dm, + u8 type, + u32 path, + u32 idx, + u32 i, + u32 data +) +{ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + if (type == 0) + p_iqk_info->IQK_CFIR_real[2][path][idx][i] = data; + else + p_iqk_info->IQK_CFIR_imag[2][path][idx][i] = data; +} + +void +halrf_iqk_dbg_cfir_backup_show(struct PHY_DM_STRUCT *p_dm) +{ + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u8 path, idx, i; + + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-20s\n", "backup TX/RX CFIR")); + + for (path = 0; path < 2; path ++) { + for (idx = 0; idx < 2; idx++) { + for(i = 0; i < 8; i++) { + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-10s %-3s CFIR_real: %-2d: 0x%x\n", + (path == 0) ? "PATH A": "PATH B", (idx == 0) ? "TX": "RX", i, p_iqk_info->IQK_CFIR_real[2][path][idx][i])); + } + for(i = 0; i < 8; i++) { + PHYDM_DBG(p_dm, ODM_COMP_CALIBRATION, ("[IQK]%-10s %-3s CFIR_img:%-2d: 0x%x\n", + (path == 0) ? "PATH A": "PATH B", (idx == 0) ? "TX": "RX", i, p_iqk_info->IQK_CFIR_imag[2][path][idx][i])); + } + } + } +} + +void +halrf_do_imr_test( + void *p_dm_void, + u8 flag_imr_test +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (flag_imr_test != 0x0) + switch (p_dm->support_ic_type) { +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + do_imr_test_8821c(p_dm); + break; +#endif + default: + break; + } +} + +void halrf_iqk_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + + /*dm_value[0]=0x0: backup from SRAM & show*/ + /*dm_value[0]=0x1: write backup CFIR to SRAM*/ + /*dm_value[0]=0x2: reload default CFIR to SRAM*/ + /*dm_value[0]=0x3: show backup*/ + /*dm_value[0]=0x10: write backup CFIR real part*/ + /*--> dm_value[1]:path, dm_value[2]:tx/rx, dm_value[3]:index, dm_value[4]:data*/ + /*dm_value[0]=0x11: write backup CFIR imag*/ + /*--> dm_value[1]:path, dm_value[2]:tx/rx, dm_value[3]:index, dm_value[4]:data*/ + /*dm_value[0]=0x20 :xym_read enable*/ + /*--> dm_value[1]:0:disable, 1:enable*/ + /*if dm_value[0]=0x20 = enable, */ + /*0x1:show rx_sym; 0x2: tx_xym; 0x3:gs1_xym; 0x4:gs2_sym; 0x5:rxk1_xym*/ + + if (dm_value[0] == 0x0) + halrf_iqk_dbg_cfir_backup(p_dm); + else if (dm_value[0] == 0x1) + halrf_iqk_dbg_cfir_backup_update(p_dm); + else if (dm_value[0] == 0x2) + halrf_iqk_dbg_cfir_reload(p_dm); + else if (dm_value[0] == 0x3) + halrf_iqk_dbg_cfir_backup_show(p_dm); + else if (dm_value[0] == 0x10) + halrf_iqk_dbg_cfir_write(p_dm, 0, dm_value[1], dm_value[2], dm_value[3], dm_value[4]); + else if (dm_value[0] == 0x11) + halrf_iqk_dbg_cfir_write(p_dm, 1, dm_value[1], dm_value[2], dm_value[3], dm_value[4]); + else if (dm_value[0] == 0x20) + halrf_iqk_xym_enable(p_dm, (u8)dm_value[1]); + else if (dm_value[0] == 0x21) + halrf_iqk_xym_show(p_dm,(u8)dm_value[1]); + else if (dm_value[0] == 0x30) + halrf_do_imr_test(p_dm, (u8)dm_value[1]); +} + +void +halrf_iqk_hwtx_check( + void *p_dm_void, + boolean is_check +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + u32 tmp_b04; + + if (is_check) + p_iqk_info->is_hwtx = (boolean)odm_get_bb_reg(p_dm, 0xb00, BIT(8)); + else { + if (p_iqk_info->is_hwtx) { + tmp_b04 = odm_read_4byte(p_dm, 0xb04); + odm_set_bb_reg(p_dm, 0xb04, BIT(3) | BIT (2), 0x0); + odm_write_4byte(p_dm, 0xb04, tmp_b04); + } + } +} + +void +halrf_segment_iqk_trigger( + void *p_dm_void, + boolean clear, + boolean segment_iqk +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + u64 start_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (odm_check_power_status(p_dm) == false) + return; +#endif + + if ((p_dm->p_mp_mode != NULL) && (p_rf->p_is_con_tx != NULL) && (p_rf->p_is_single_tone != NULL) && (p_rf->p_is_carrier_suppresion != NULL)) + if (*(p_dm->p_mp_mode) && ((*(p_rf->p_is_con_tx) || *(p_rf->p_is_single_tone) || *(p_rf->p_is_carrier_suppresion)))) + return; + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + if (!(p_rf->rf_supportability & HAL_RF_IQK)) + return; +#endif + +#if DISABLE_BB_RF + return; +#endif + if (p_iqk_info->rfk_forbidden) + return; + + if (!p_dm->rf_calibrate_info.is_iqk_in_progress) { + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_iqk_in_progress = true; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + start_time = odm_get_current_time(p_dm); + p_dm->IQK_info.segment_iqk = segment_iqk; + + switch (p_dm->support_ic_type) { +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + phy_iq_calibrate_8822b(p_dm, clear, segment_iqk); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + phy_iq_calibrate_8821c(p_dm, clear, segment_iqk); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + break; +#endif + default: + break; + } + p_dm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(p_dm, start_time); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]IQK progressing_time = %lld ms\n", p_dm->rf_calibrate_info.iqk_progressing_time)); + + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_iqk_in_progress = false; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + } else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because RFKs in Progress ==\n")); +} + + + +#endif + + +void +halrf_rf_lna_setting( + void *p_dm_void, + enum phydm_lna_set type +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + switch (p_dm->support_ic_type) { +#if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + halrf_rf_lna_setting_8188e(p_dm, type); + break; +#endif +#if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + halrf_rf_lna_setting_8192e(p_dm, type); + break; +#endif +#if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + halrf_rf_lna_setting_8723b(p_dm, type); + break; +#endif +#if (RTL8812A_SUPPORT == 1) + case ODM_RTL8812: + halrf_rf_lna_setting_8812a(p_dm, type); + break; +#endif +#if ((RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1)) + case ODM_RTL8881A: + case ODM_RTL8821: + halrf_rf_lna_setting_8821a(p_dm, type); + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + halrf_rf_lna_setting_8822b(p_dm_void, type); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + halrf_rf_lna_setting_8821c(p_dm_void, type); + break; +#endif + default: + break; + } + + } + + +void +halrf_support_ability_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + u32 dm_value[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &dm_value[i]); + } + } + + PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); + if (dm_value[0] == 100) { + PHYDM_SNPRINTF((output + used, out_len - used, "[RF Supportability]\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))Power Tracking\n", ((p_rf->rf_supportability & HAL_RF_TX_PWR_TRACK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))IQK\n", ((p_rf->rf_supportability & HAL_RF_IQK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))LCK\n", ((p_rf->rf_supportability & HAL_RF_LCK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))DPK\n", ((p_rf->rf_supportability & HAL_RF_DPK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))HAL_RF_TXGAPK\n", ((p_rf->rf_supportability & HAL_RF_TXGAPK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + } + else { + + if (dm_value[1] == 1) { /* enable */ + p_rf->rf_supportability |= BIT(dm_value[0]) ; + } else if (dm_value[1] == 2) /* disable */ + p_rf->rf_supportability &= ~(BIT(dm_value[0])) ; + else { + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); + } + } + PHYDM_SNPRINTF((output + used, out_len - used, "Curr-RF_supportability = 0x%x\n", p_rf->rf_supportability)); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + + *_used = used; + *_out_len = out_len; +} + +void +halrf_cmn_info_init( + void *p_dm_void, +enum halrf_cmninfo_init_e cmn_info, + u32 value +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + switch (cmn_info) { + case HALRF_CMNINFO_EEPROM_THERMAL_VALUE: + p_rf->eeprom_thermal = (u8)value; + break; + case HALRF_CMNINFO_FW_VER: + p_rf->fw_ver = (u32)value; + break; + default: + break; + } +} + + +void +halrf_cmn_info_hook( + void *p_dm_void, +enum halrf_cmninfo_hook_e cmn_info, + void *p_value +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + switch (cmn_info) { + case HALRF_CMNINFO_CON_TX: + p_rf->p_is_con_tx = (boolean *)p_value; + break; + case HALRF_CMNINFO_SINGLE_TONE: + p_rf->p_is_single_tone = (boolean *)p_value; + break; + case HALRF_CMNINFO_CARRIER_SUPPRESSION: + p_rf->p_is_carrier_suppresion = (boolean *)p_value; + break; + case HALRF_CMNINFO_MP_RATE_INDEX: + p_rf->p_mp_rate_index = (u8 *)p_value; + break; + default: + /*do nothing*/ + break; + } +} + +void +halrf_cmn_info_set( + void *p_dm_void, + u32 cmn_info, + u64 value +) +{ + /* */ + /* This init variable may be changed in run time. */ + /* */ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + switch (cmn_info) { + + case HALRF_CMNINFO_ABILITY: + p_rf->rf_supportability = (u32)value; + break; + + case HALRF_CMNINFO_DPK_EN: + p_rf->dpk_en = (u8)value; + break; + case HALRF_CMNINFO_RFK_FORBIDDEN : + p_dm->IQK_info.rfk_forbidden = (boolean)value; + break; + #if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + case HALRF_CMNINFO_IQK_SEGMENT: + p_dm->IQK_info.segment_iqk = (boolean)value; + break; + #endif + case HALRF_CMNINFO_RATE_INDEX: + p_rf->p_rate_index = (u32)value; + break; + default: + /* do nothing */ + break; + } +} + +u64 +halrf_cmn_info_get( + void *p_dm_void, + u32 cmn_info +) +{ + /* */ + /* This init variable may be changed in run time. */ + /* */ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + u64 return_value = 0; + + switch (cmn_info) { + + case HALRF_CMNINFO_ABILITY: + return_value = (u32)p_rf->rf_supportability; + break; + case HALRF_CMNINFO_RFK_FORBIDDEN : + return_value = p_dm->IQK_info.rfk_forbidden; + break; + #if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + case HALRF_CMNINFO_IQK_SEGMENT: + return_value = p_dm->IQK_info.segment_iqk; + break; + #endif + default: + /* do nothing */ + break; + } + + return return_value; +} + +void +halrf_supportability_init_mp( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + switch (p_dm->support_ic_type) { + + case ODM_RTL8814B: + #if (RTL8814B_SUPPORT == 1) + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + 0; + #endif + break; + #if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + 0; + break; + #endif + + #if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + /*HAL_RF_TXGAPK |*/ + 0; + break; + #endif + + default: + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + /*HAL_RF_TXGAPK |*/ + 0; + break; + + } + + ODM_RT_TRACE(p_dm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IC = ((0x%x)), RF_Supportability Init MP = ((0x%x))\n", p_dm->support_ic_type, p_rf->rf_supportability)); +} + +void +halrf_supportability_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + switch (p_dm->support_ic_type) { + + case ODM_RTL8814B: + #if (RTL8814B_SUPPORT == 1) + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + 0; + #endif + break; + #if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + 0; + break; + #endif + + #if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + /*HAL_RF_TXGAPK |*/ + 0; + break; + #endif + + default: + p_rf->rf_supportability = + HAL_RF_TX_PWR_TRACK | + HAL_RF_IQK | + HAL_RF_LCK | + /*HAL_RF_DPK |*/ + 0; + break; + + } + + ODM_RT_TRACE(p_dm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IC = ((0x%x)), RF_Supportability Init = ((0x%x))\n", p_dm->support_ic_type, p_rf->rf_supportability)); +} + +void +halrf_watchdog( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + phydm_rf_watchdog(p_dm); +} +#if 0 +void +halrf_iqk_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + switch (p_dm->support_ic_type) { + + #if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + break; + #endif + #if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + _iq_calibrate_8822b_init(p_dm); + break; + #endif + #if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + break; + #endif + + default: + break; + } +} +#endif + + +void +halrf_iqk_trigger( + void *p_dm_void, + boolean is_recovery +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + u64 start_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (odm_check_power_status(p_dm) == false) + return; +#endif + + if ((p_dm->p_mp_mode != NULL) && (p_rf->p_is_con_tx != NULL) && (p_rf->p_is_single_tone != NULL) && (p_rf->p_is_carrier_suppresion != NULL)) + if (*(p_dm->p_mp_mode) && ((*(p_rf->p_is_con_tx) || *(p_rf->p_is_single_tone) || *(p_rf->p_is_carrier_suppresion)))) + return; + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + if (!(p_rf->rf_supportability & HAL_RF_IQK)) + return; +#endif + +#if DISABLE_BB_RF + return; +#endif + + if (p_iqk_info->rfk_forbidden) + return; + + if (!p_dm->rf_calibrate_info.is_iqk_in_progress) { + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_iqk_in_progress = true; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + start_time = odm_get_current_time(p_dm); + switch (p_dm->support_ic_type) { +#if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + phy_iq_calibrate_8188e(p_dm, is_recovery); + break; +#endif +#if (RTL8188F_SUPPORT == 1) + case ODM_RTL8188F: + phy_iq_calibrate_8188f(p_dm, is_recovery); + break; +#endif +#if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + phy_iq_calibrate_8192e(p_dm, is_recovery); + break; +#endif +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + phy_iq_calibrate_8197f(p_dm, is_recovery); + break; +#endif +#if (RTL8703B_SUPPORT == 1) + case ODM_RTL8703B: + phy_iq_calibrate_8703b(p_dm, is_recovery); + break; +#endif +#if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + phy_iq_calibrate_8710b(p_dm, is_recovery); + break; +#endif +#if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + phy_iq_calibrate_8723b(p_dm, is_recovery); + break; +#endif +#if (RTL8723D_SUPPORT == 1) + case ODM_RTL8723D: + phy_iq_calibrate_8723d(p_dm, is_recovery); + break; +#endif +#if (RTL8812A_SUPPORT == 1) + case ODM_RTL8812: + phy_iq_calibrate_8812a(p_dm, is_recovery); + break; +#endif +#if (RTL8821A_SUPPORT == 1) + case ODM_RTL8821: + phy_iq_calibrate_8821a(p_dm, is_recovery); + break; +#endif +#if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + phy_iq_calibrate_8814a(p_dm, is_recovery); + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + phy_iq_calibrate_8822b(p_dm, false, false); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + phy_iq_calibrate_8821c(p_dm, false, false); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + break; +#endif + default: + break; + } + p_dm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(p_dm, start_time); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]IQK progressing_time = %lld ms\n", p_dm->rf_calibrate_info.iqk_progressing_time)); + + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_iqk_in_progress = false; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + } else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the IQK CMD, because RFKs in Progress ==\n")); +} + + + +void +halrf_lck_trigger( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _IQK_INFORMATION *p_iqk_info = &p_dm->IQK_info; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + u64 start_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (odm_check_power_status(p_dm) == false) + return; +#endif + + if ((p_dm->p_mp_mode != NULL) && (p_rf->p_is_con_tx != NULL) && (p_rf->p_is_single_tone != NULL) && (p_rf->p_is_carrier_suppresion != NULL)) + if (*(p_dm->p_mp_mode) && ((*(p_rf->p_is_con_tx) || *(p_rf->p_is_single_tone) || *(p_rf->p_is_carrier_suppresion)))) + return; + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + if (!(p_rf->rf_supportability & HAL_RF_LCK)) + return; +#endif + +#if DISABLE_BB_RF + return; +#endif + if (p_iqk_info->rfk_forbidden) + return; + while (*(p_dm->p_is_scan_in_process)) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[LCK]scan is in process, bypass LCK\n")); + return; + } + + if (!p_dm->rf_calibrate_info.is_lck_in_progress) { + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_lck_in_progress = true; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + start_time = odm_get_current_time(p_dm); + switch (p_dm->support_ic_type) { +#if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + phy_lc_calibrate_8188e(p_dm); + break; +#endif +#if (RTL8188F_SUPPORT == 1) + case ODM_RTL8188F: + phy_lc_calibrate_8188f(p_dm); + break; +#endif +#if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + phy_lc_calibrate_8192e(p_dm); + break; +#endif +#if (RTL8197F_SUPPORT == 1) + case ODM_RTL8197F: + phy_lc_calibrate_8197f(p_dm); + break; +#endif +#if (RTL8703B_SUPPORT == 1) + case ODM_RTL8703B: + phy_lc_calibrate_8703b(p_dm); + break; +#endif +#if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + phy_lc_calibrate_8710b(p_dm); + break; +#endif +#if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + phy_lc_calibrate_8723b(p_dm); + break; +#endif +#if (RTL8723D_SUPPORT == 1) + case ODM_RTL8723D: + phy_lc_calibrate_8723d(p_dm); + break; +#endif +#if (RTL8812A_SUPPORT == 1) + case ODM_RTL8812: + phy_lc_calibrate_8812a(p_dm); + break; +#endif +#if (RTL8821A_SUPPORT == 1) + case ODM_RTL8821: + phy_lc_calibrate_8821a(p_dm); + break; +#endif +#if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + phy_lc_calibrate_8814a(p_dm); + break; +#endif +#if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + phy_lc_calibrate_8822b(p_dm); + break; +#endif +#if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + phy_lc_calibrate_8821c(p_dm); + break; +#endif +#if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + break; +#endif + default: + break; + } + p_dm->rf_calibrate_info.lck_progressing_time = odm_get_progressing_time(p_dm, start_time); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]LCK progressing_time = %lld ms\n", p_dm->rf_calibrate_info.lck_progressing_time)); +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + halrf_lck_dbg(p_dm); +#endif + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_lck_in_progress = false; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + }else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("== Return the LCK CMD, because RFK is in Progress ==\n")); +} + +void +halrf_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + ODM_RT_TRACE(p_dm, ODM_COMP_INIT, ODM_DBG_LOUD, ("HALRF_Init\n")); + + if (*(p_dm->p_mp_mode) == true) + halrf_supportability_init_mp(p_dm); + else + halrf_supportability_init(p_dm); + + /*Init all RF funciton*/ + /*iqk_init();*/ + /*dpk_init();*/ +} + + + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.h new file mode 100644 index 000000000000..8ff339370ea0 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf.h @@ -0,0 +1,308 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef _HALRF_H__ +#define _HALRF_H__ + +/*============================================================*/ +/*include files*/ +/*============================================================*/ + + + +/*============================================================*/ +/*Definition */ +/*============================================================*/ +/*IQK version*/ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) +#define IQK_VERSION_8188E "0x14" +#define IQK_VERSION_8192E "0x01" +#define IQK_VERSION_8723B "0x1d" +#define IQK_VERSION_8812A "0x01" +#define IQK_VERSION_8821A "0x01" +#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) +#define IQK_VERSION_8188E "0x01" +#define IQK_VERSION_8192E "0x01" +#define IQK_VERSION_8723B "0x19" +#define IQK_VERSION_8812A "0x01" +#define IQK_VERSION_8821A "0x01" +#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#define IQK_VERSION_8188E "0x01" +#define IQK_VERSION_8192E "0x01" +#define IQK_VERSION_8723B "0x01" +#define IQK_VERSION_8812A "0x01" +#define IQK_VERSION_8821A "0x01" +#endif +#define IQK_VERSION_8814A "0x0f" +#define IQK_VERSION_8188F "0x01" +#define IQK_VERSION_8197F "0x01" +#define IQK_VERSION_8703B "0x04" +#define IQK_VERSION_8710B "0x01" +#define IQK_VERSION_8723D "0x01" +#define IQK_VERSION_8822B "0x2e" +#define IQK_VERSION_8821C "0x23" + +/*LCK version*/ +#define LCK_VERSION_8188E "0x01" +#define LCK_VERSION_8192E "0x01" +#define LCK_VERSION_8723B "0x01" +#define LCK_VERSION_8812A "0x01" +#define LCK_VERSION_8821A "0x01" +#define LCK_VERSION_8814A "0x01" +#define LCK_VERSION_8188F "0x01" +#define LCK_VERSION_8197F "0x01" +#define LCK_VERSION_8703B "0x01" +#define LCK_VERSION_8710B "0x01" +#define LCK_VERSION_8723D "0x01" +#define LCK_VERSION_8822B "0x01" +#define LCK_VERSION_8821C "0x01" + + +#define HALRF_IQK_VER (p_dm->support_ic_type == ODM_RTL8188E)? IQK_VERSION_8188E :\ + (p_dm->support_ic_type == ODM_RTL8192E)? IQK_VERSION_8192E :\ + (p_dm->support_ic_type == ODM_RTL8723B)? IQK_VERSION_8723B :\ + (p_dm->support_ic_type == ODM_RTL8812)? IQK_VERSION_8812A :\ + (p_dm->support_ic_type == ODM_RTL8821)? IQK_VERSION_8821A :\ + (p_dm->support_ic_type == ODM_RTL8814A)? IQK_VERSION_8814A :\ + (p_dm->support_ic_type == ODM_RTL8188F)? IQK_VERSION_8188F :\ + (p_dm->support_ic_type == ODM_RTL8197F)? IQK_VERSION_8197F :\ + (p_dm->support_ic_type == ODM_RTL8703B)? IQK_VERSION_8703B :\ + (p_dm->support_ic_type == ODM_RTL8710B)? IQK_VERSION_8710B :\ + (p_dm->support_ic_type == ODM_RTL8723D)? IQK_VERSION_8723D :\ + (p_dm->support_ic_type == ODM_RTL8822B)? IQK_VERSION_8822B :\ + (p_dm->support_ic_type == ODM_RTL8821C)? IQK_VERSION_8821C :"unknown" + + +#define HALRF_LCK_VER (p_dm->support_ic_type == ODM_RTL8188E)? LCK_VERSION_8188E :\ + (p_dm->support_ic_type == ODM_RTL8192E)? LCK_VERSION_8192E :\ + (p_dm->support_ic_type == ODM_RTL8723B)? LCK_VERSION_8723B :\ + (p_dm->support_ic_type == ODM_RTL8812)? LCK_VERSION_8812A :\ + (p_dm->support_ic_type == ODM_RTL8821)? LCK_VERSION_8821A :\ + (p_dm->support_ic_type == ODM_RTL8814A)? LCK_VERSION_8814A :\ + (p_dm->support_ic_type == ODM_RTL8188F)? LCK_VERSION_8188F :\ + (p_dm->support_ic_type == ODM_RTL8197F)? LCK_VERSION_8197F :\ + (p_dm->support_ic_type == ODM_RTL8703B)? LCK_VERSION_8703B :\ + (p_dm->support_ic_type == ODM_RTL8710B)? LCK_VERSION_8710B :\ + (p_dm->support_ic_type == ODM_RTL8723D)? LCK_VERSION_8723D :\ + (p_dm->support_ic_type == ODM_RTL8822B)? LCK_VERSION_8822B :\ + (p_dm->support_ic_type == ODM_RTL8821C)? LCK_VERSION_8821C :"unknown" +#define HALRF_DPK_VER "0x02" + +#define IQK_THRESHOLD 8 +#define DPK_THRESHOLD 4 + +/*============================================================*/ +/* enumeration */ +/*============================================================*/ +enum halrf_ability_e { + + HAL_RF_TX_PWR_TRACK = BIT(0), + HAL_RF_IQK = BIT(1), + HAL_RF_LCK = BIT(2), + HAL_RF_DPK = BIT(3), + HAL_RF_TXGAPK = BIT(4) +}; + +enum halrf_cmninfo_init_e { + HALRF_CMNINFO_ABILITY = 0, + HALRF_CMNINFO_DPK_EN = 1, + HALRF_CMNINFO_EEPROM_THERMAL_VALUE, + HALRF_CMNINFO_FW_VER, + HALRF_CMNINFO_RFK_FORBIDDEN, + HALRF_CMNINFO_IQK_SEGMENT, + HALRF_CMNINFO_RATE_INDEX +}; + +enum halrf_cmninfo_hook_e { + HALRF_CMNINFO_CON_TX, + HALRF_CMNINFO_SINGLE_TONE, + HALRF_CMNINFO_CARRIER_SUPPRESSION, + HALRF_CMNINFO_MP_RATE_INDEX +}; + +enum phydm_lna_set { + phydm_lna_disable = 0, + phydm_lna_enable = 1, +}; + + +/*============================================================*/ +/* structure */ +/*============================================================*/ + +struct _hal_rf_ { + /*hook*/ + u8 *test1; + + /*update*/ + u32 rf_supportability; + + u8 eeprom_thermal; + u8 dpk_en; /*Enable Function DPK OFF/ON = 0/1*/ + boolean dpk_done; + u32 fw_ver; + + boolean *p_is_con_tx; + boolean *p_is_single_tone; + boolean *p_is_carrier_suppresion; + + u8 *p_mp_rate_index; + u32 p_rate_index; +}; + +/*============================================================*/ +/* function prototype */ +/*============================================================*/ + +void halrf_basic_profile( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +); +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) +void halrf_iqk_info_dump( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +); + +void +halrf_iqk_hwtx_check( + void *p_dm_void, + boolean is_check +); +#endif + +void +halrf_support_ability_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len +); + +void +halrf_cmn_info_init( + void *p_dm_void, + enum halrf_cmninfo_init_e cmn_info, + u32 value +); + +void +halrf_cmn_info_hook( + void *p_dm_void, + u32 cmn_info, + void *p_value +); + +void +halrf_cmn_info_set( + void *p_dm_void, + u32 cmn_info, + u64 value +); + +u64 +halrf_cmn_info_get( + void *p_dm_void, + u32 cmn_info +); + +void +halrf_watchdog( + void *p_dm_void +); + +void +halrf_supportability_init( + void *p_dm_void +); + +void +halrf_init( + void *p_dm_void +); + +void +halrf_iqk_trigger( + void *p_dm_void, + boolean is_recovery +); + +void +halrf_segment_iqk_trigger( + void *p_dm_void, + boolean clear, + boolean segment_iqk +); + +void +halrf_lck_trigger( + void *p_dm_void +); + +void +halrf_iqk_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_get_iqk_cfir( + void *p_dm_void, + u8 idx, + u8 path, + boolean debug +); + +void +halrf_iqk_xym_read( + void *p_dm_void, + u8 path, + u8 xym_type + ); + +void +halrf_rf_lna_setting( + void *p_dm_void, + enum phydm_lna_set type +); + + +void +halrf_do_imr_test( + void *p_dm_void, + u8 data +); + +u32 +halrf_psd_log2base( + IN u32 val +); + + +#if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) +void halrf_iqk_dbg(void *p_dm_void); +#endif +#endif + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_features.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_features.h new file mode 100644 index 000000000000..e119adcd6acb --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_features.h @@ -0,0 +1,33 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __HALRF_FEATURES_H__ +#define __HALRF_FEATURES + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + + #define CONFIG_HALRF_POWERTRACKING 1 + +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + + #define CONFIG_HALRF_POWERTRACKING 1 + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + + #define CONFIG_HALRF_POWERTRACKING 1 + +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_iqk.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_iqk.h new file mode 100644 index 000000000000..93ec3c454902 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_iqk.h @@ -0,0 +1,75 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMIQK_H__ +#define __PHYDMIQK_H__ + +/*--------------------------Define Parameters-------------------------------*/ +#define LOK_delay 1 +#define WBIQK_delay 10 +#define TX_IQK 0 +#define RX_IQK 1 +#define TXIQK 0 +#define RXIQK1 1 +#define RXIQK2 2 +#define kcount_limit_80m 2 +#define kcount_limit_others 4 +#define rxiqk_gs_limit 4 + +#define NUM 4 +/*---------------------------End Define Parameters-------------------------------*/ + +struct _IQK_INFORMATION { + boolean LOK_fail[NUM]; + boolean IQK_fail[2][NUM]; + u32 iqc_matrix[2][NUM]; + u8 iqk_times; + u32 rf_reg18; + u32 lna_idx; + u8 rxiqk_step; + u8 tmp1bcc; + u8 kcount; + u8 rfk_ing; /*bit0:IQKing, bit1:LCKing, bit2:DPKing*/ + boolean rfk_forbidden; +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + u32 iqk_channel[2]; + boolean IQK_fail_report[2][4][2]; /*channel/path/TRX(TX:0, RX:1) */ + u32 IQK_CFIR_real[3][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_real*/ /*channel index = 2 is just for debug*/ + u32 IQK_CFIR_imag[3][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ /*channel index = 2 is just for debug*/ + u8 retry_count[2][4][3]; /* channel / path / (TXK:0, RXK1:1, RXK2:2) */ + u8 gs_retry_count[2][4][2]; /* channel / path / (GSRXK1:0, GSRXK2:1) */ + u8 RXIQK_fail_code[2][4]; /* channel / path 0:SRXK1 fail, 1:RXK1 fail 2:RXK2 fail */ + u32 LOK_IDAC[2][4]; /*channel / path*/ + u16 RXIQK_AGC[2][4]; /*channel / path*/ + u32 bypass_iqk[2][4]; /*channel / 0xc94/0xe94*/ + u32 txgap_result[8]; /*txagpK result */ + u32 tmp_GNTWL; + boolean is_BTG; + boolean isbnd; + boolean is_reload; + boolean segment_iqk; + boolean is_hwtx; + + boolean xym_read; + boolean trximr_enable; + u32 rx_xym[2][10]; + u32 tx_xym[2][10]; + u32 gs1_xym[2][6]; + u32 gs2_xym[2][6]; + u32 rxk1_xym[2][6]; +#endif +}; + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.c new file mode 100644 index 000000000000..1a127cf8d176 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.c @@ -0,0 +1,770 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files*/ +/*============================================================*/ +#include "mp_precomp.h" +#include "phydm_precomp.h" + + +/* Add for KFree Feature Requested by RF David.*/ +/*This is a phydm API*/ + +void +phydm_set_kfree_to_rf_8814a( + void *p_dm_void, + u8 e_rf_path, + u8 data +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + boolean is_odd; + + if ((data % 2) != 0) { /*odd->positive*/ + data = data - 1; + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(19), 1); + is_odd = true; + } else { /*even->negative*/ + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(19), 0); + is_odd = false; + } + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RF_0x55[19]= %d\n", is_odd)); + switch (data) { + case 0: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 0); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 0; + break; + case 2: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 0); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 0; + break; + case 4: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 1); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 1; + break; + case 6: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 1); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 1; + break; + case 8: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 2); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 2; + break; + case 10: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 2); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 2; + break; + case 12: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 3); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 3; + break; + case 14: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 3); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 3; + break; + case 16: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 4); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 4; + break; + case 18: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 1); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 4); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 4; + break; + case 20: + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(14), 0); + odm_set_rf_reg(p_dm, e_rf_path, REG_RF_TX_GAIN_OFFSET, BIT(17) | BIT(16) | BIT(15), 5); + p_rf_calibrate_info->kfree_offset[e_rf_path] = 5; + break; + + default: + break; + } + + if (is_odd == false) { + /*that means Kfree offset is negative, we need to record it.*/ + p_rf_calibrate_info->kfree_offset[e_rf_path] = (-1) * p_rf_calibrate_info->kfree_offset[e_rf_path]; + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): kfree_offset = %d\n", p_rf_calibrate_info->kfree_offset[e_rf_path])); + } else + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): kfree_offset = %d\n", p_rf_calibrate_info->kfree_offset[e_rf_path])); + +} + + + +// +// +// +void +phydm_get_thermal_trim_offset_8821c( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_power_trim_data *p_power_trim_info = &(p_dm->power_trim_data); + + u8 pg_therm = 0xff; + + odm_efuse_one_byte_read(p_dm, PPG_THERMAL_OFFSET_8821C, &pg_therm, false); + + if (pg_therm != 0xff) { + pg_therm = pg_therm & 0x1f; + if ((pg_therm & BIT(0)) == 0) + p_power_trim_info->thermal = (-1 * (pg_therm >> 1)); + else + p_power_trim_info->thermal = (pg_therm >> 1); + + p_power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8821c thermal trim flag:0x%02x\n", p_power_trim_info->flag)); + + if (p_power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8821c thermal:%d\n", p_power_trim_info->thermal)); +} + + + +void +phydm_get_power_trim_offset_8821c( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_power_trim_data *p_power_trim_info = &(p_dm->power_trim_data); + + u8 pg_power = 0xff, i; + + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_2G_TXAB_OFFSET_8821C, &pg_power, false); + + if (pg_power != 0xff) { + p_power_trim_info->bb_gain[0][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GL1_TXA_OFFSET_8821C, &pg_power, false); + p_power_trim_info->bb_gain[1][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GL2_TXA_OFFSET_8821C, &pg_power, false); + p_power_trim_info->bb_gain[2][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GM1_TXA_OFFSET_8821C, &pg_power, false); + p_power_trim_info->bb_gain[3][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GM2_TXA_OFFSET_8821C, &pg_power, false); + p_power_trim_info->bb_gain[4][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GH1_TXA_OFFSET_8821C, &pg_power, false); + p_power_trim_info->bb_gain[5][0] = pg_power; + p_power_trim_info->flag = p_power_trim_info->flag | KFREE_FLAG_ON | KFREE_FLAG_ON_2G | KFREE_FLAG_ON_5G; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8821c power trim flag:0x%02x\n", p_power_trim_info->flag)); + + if (p_power_trim_info->flag & KFREE_FLAG_ON) { + for (i = 0; i < KFREE_BAND_NUM; i++) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8821c power_trim_data->bb_gain[%d][0]=0x%X\n", i, p_power_trim_info->bb_gain[i][0])); + } +} + + + +void +phydm_set_kfree_to_rf_8821c( + void *p_dm_void, + u8 e_rf_path, + boolean wlg_btg, + u8 data +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + u8 wlg, btg; + + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(0), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(5), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(6), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, BIT(6), 1); + + if (wlg_btg == true) { + wlg = data & 0xf; + btg = (data & 0xf0) >> 4; + + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(19), (wlg & BIT(0))); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), (wlg >> 1)); + + odm_set_rf_reg(p_dm, e_rf_path, 0x65, BIT(19), (btg & BIT(0))); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), (btg >> 1)); + } else { + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), ((data & 0x1f) >> 1)); + } + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_TRACE, + ("[kfree] 8821c 0x55[19:14]=0x%X 0x65[19:14]=0x%X\n", + odm_get_rf_reg(p_dm, e_rf_path, 0x55, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))), + odm_get_rf_reg(p_dm, e_rf_path, 0x65, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))) + )); +} + + + +void +phydm_clear_kfree_to_rf_8821c( + void *p_dm_void, + u8 e_rf_path, + u8 data +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(0), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(5), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(6), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, BIT(6), 1); + + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), (data >> 1)); + + odm_set_rf_reg(p_dm, e_rf_path, 0x65, BIT(19), (data & BIT(0))); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), (data >> 1)); + + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(0), 0); + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(5), 0); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(6), 0); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, BIT(6), 0); + + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_TRACE, + ("[kfree] 8821c 0x55[19:14]=0x%X 0x65[19:14]=0x%X\n", + odm_get_rf_reg(p_dm, e_rf_path, 0x55, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))), + odm_get_rf_reg(p_dm, e_rf_path, 0x65, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))) + )); +} + + + +void +phydm_get_thermal_trim_offset_8822b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_power_trim_data *p_power_trim_info = &(p_dm->power_trim_data); + + u8 pg_therm = 0xff; + +#if 0 + u32 thermal_trim_enable = 0xff; + + odm_efuse_logical_map_read(p_dm, 1, 0xc8, &thermal_trim_enable); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b 0xc8:0x%2x\n", thermal_trim_enable)); + + thermal_trim_enable = (thermal_trim_enable & BIT(5)) >> 5; + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b thermal trim Enable:%d\n", thermal_trim_enable)); + + if ((p_rf_calibrate_info->reg_rf_kfree_enable == 0 && thermal_trim_enable == 1) || + p_rf_calibrate_info->reg_rf_kfree_enable == 1) { +#endif + + odm_efuse_one_byte_read(p_dm, PPG_THERMAL_OFFSET, &pg_therm, false); + + if (pg_therm != 0xff) { + pg_therm = pg_therm & 0x1f; + if ((pg_therm & BIT(0)) == 0) + p_power_trim_info->thermal = (-1 * (pg_therm >> 1)); + else + p_power_trim_info->thermal = (pg_therm >> 1); + + p_power_trim_info->flag |= KFREE_FLAG_THERMAL_K_ON; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b thermal trim flag:0x%02x\n", p_power_trim_info->flag)); + + if (p_power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b thermal:%d\n", p_power_trim_info->thermal)); +#if 0 + } else + return; +#endif + +} + + + +void +phydm_get_power_trim_offset_8822b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_power_trim_data *p_power_trim_info = &(p_dm->power_trim_data); + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + u8 pg_power = 0xff, i, j; + +#if 0 + u32 power_trim_enable = 0xff; + + odm_efuse_logical_map_read(p_dm, 1, 0xc8, &power_trim_enable); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b 0xc8:0x%2x\n", power_trim_enable)); + + power_trim_enable = (power_trim_enable & BIT(4)) >> 4; + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b power trim Enable:%d\n", power_trim_enable)); + + if ((p_rf_calibrate_info->reg_rf_kfree_enable == 0 && power_trim_enable == 1) || + p_rf_calibrate_info->reg_rf_kfree_enable == 1) { +#endif + + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_2G_TXAB_OFFSET, &pg_power, false); + + if (pg_power != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_2G_TXAB_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[0][0] = (pg_power & 0xf); + + /*Path B*/ + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_2G_TXAB_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[0][1] = ((pg_power & 0xf0) >> 4); + + p_power_trim_info->flag |= KFREE_FLAG_ON_2G; + p_power_trim_info->flag |= KFREE_FLAG_ON; + } + + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GL1_TXA_OFFSET, &pg_power, false); + + if (pg_power != 0xff) { + /*Path A*/ + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GL1_TXA_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[1][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GL2_TXA_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[2][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GM1_TXA_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[3][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GM2_TXA_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[4][0] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GH1_TXA_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[5][0] = pg_power; + + /*Path B*/ + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GL1_TXB_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[1][1] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GL2_TXB_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[2][1] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GM1_TXB_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[3][1] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GM2_TXB_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[4][1] = pg_power; + odm_efuse_one_byte_read(p_dm, PPG_BB_GAIN_5GH1_TXB_OFFSET, &pg_power, false); + p_power_trim_info->bb_gain[5][1] = pg_power; + + p_power_trim_info->flag |= KFREE_FLAG_ON_5G; + p_power_trim_info->flag |= KFREE_FLAG_ON; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b power trim flag:0x%02x\n", p_power_trim_info->flag)); + + if (p_power_trim_info->flag & KFREE_FLAG_ON) { + for (i = 0; i < KFREE_BAND_NUM; i++) { + for (j = 0; j < 2; j++) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b power_trim_data->bb_gain[%d][%d]=0x%X\n", i, j, p_power_trim_info->bb_gain[i][j])); + } + } +#if 0 + } else + return; +#endif +} + + + +void +phydm_set_pa_bias_to_rf_8822b( + void *p_dm_void, + u8 e_rf_path, + s8 tx_pa_bias +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + u32 rf_reg_51 = 0, rf_reg_52 = 0, rf_reg_3f = 0; + + rf_reg_51 = odm_get_rf_reg(p_dm, e_rf_path, 0x51, RFREGOFFSETMASK); + rf_reg_52 = odm_get_rf_reg(p_dm, e_rf_path, 0x52, RFREGOFFSETMASK); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b 2g rf(0x51)=0x%X rf(0x52)=0x%X path=%d\n", + rf_reg_51, rf_reg_52, e_rf_path)); + + /*rf3f => rf52[19:17] = rf3f[2:0] rf52[16:15] = rf3f[4:3] rf52[3:0] = rf3f[8:5]*/ + /*rf3f => rf51[6:3] = rf3f[12:9] rf52[13] = rf3f[13]*/ + rf_reg_3f = ((rf_reg_52 & 0xe0000) >> 17) | + (((rf_reg_52 & 0x18000) >> 15) << 3) | + ((rf_reg_52 & 0xf) << 5) | + (((rf_reg_51 & 0x78) >> 3) << 9) | + (((rf_reg_52 & 0x2000) >> 13) << 13); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, + ("[kfree] 8822b 2g original tx_pa_bias=%d rf_reg_3f=0x%X path=%d\n", + tx_pa_bias, rf_reg_3f, e_rf_path)); + + tx_pa_bias = (s8)((rf_reg_3f & (BIT(12) | BIT(11) | BIT(10) | BIT(9))) >> 9) + tx_pa_bias; + + if (tx_pa_bias < 0) + tx_pa_bias = 0; + else if (tx_pa_bias > 7) + tx_pa_bias = 7; + + rf_reg_3f = ((rf_reg_3f & 0xfe1ff) | (tx_pa_bias << 9)); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, + ("[kfree] 8822b 2g offset efuse 0x3d5 0x3d6 tx_pa_bias=%d rf_reg_3f=0x%X path=%d\n", + tx_pa_bias, rf_reg_3f, e_rf_path)); + + odm_set_rf_reg(p_dm, e_rf_path, 0xef, BIT(10), 0x1); + odm_set_rf_reg(p_dm, e_rf_path, 0x33, RFREGOFFSETMASK, 0x0); + odm_set_rf_reg(p_dm, e_rf_path, 0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(p_dm, e_rf_path, 0x33, BIT(0), 0x1); + odm_set_rf_reg(p_dm, e_rf_path, 0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(p_dm, e_rf_path, 0x33, BIT(1), 0x1); + odm_set_rf_reg(p_dm, e_rf_path, 0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(p_dm, e_rf_path, 0x33, (BIT(1) | BIT(0)), 0x3); + odm_set_rf_reg(p_dm, e_rf_path, 0x3f, RFREGOFFSETMASK, rf_reg_3f); + odm_set_rf_reg(p_dm, e_rf_path, 0xef, BIT(10), 0x0); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, + ("[kfree] 8822b 2g tx pa bias rf_0x3f(0x%X) path=%d\n", + odm_get_rf_reg(p_dm, e_rf_path, 0x3f, (BIT(12) | BIT(11) | BIT(10) | BIT(9))), e_rf_path)); +} + + + +void +phydm_get_pa_bias_offset_8822b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_power_trim_data *p_power_trim_info = &(p_dm->power_trim_data); + + u8 pg_pa_bias = 0xff, e_rf_path = 0; + s8 tx_pa_bias[2] = {0}; + + odm_efuse_one_byte_read(p_dm, PPG_PA_BIAS_2G_TXA_OFFSET, &pg_pa_bias, false); + + if (pg_pa_bias != 0xff) { + /*paht a*/ + odm_efuse_one_byte_read(p_dm, PPG_PA_BIAS_2G_TXA_OFFSET, &pg_pa_bias, false); + pg_pa_bias = pg_pa_bias & 0xf; + + if ((pg_pa_bias & BIT(0)) == 0) + tx_pa_bias[0] = (-1 * (pg_pa_bias >> 1)); + else + tx_pa_bias[0] = (pg_pa_bias >> 1); + + /*paht b*/ + odm_efuse_one_byte_read(p_dm, PPG_PA_BIAS_2G_TXB_OFFSET, &pg_pa_bias, false); + pg_pa_bias = pg_pa_bias & 0xf; + + if ((pg_pa_bias & BIT(0)) == 0) + tx_pa_bias[1] = (-1 * (pg_pa_bias >> 1)); + else + tx_pa_bias[1] = (pg_pa_bias >> 1); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b 2g tx_patha_pa_bias:%d tx_pathb_pa_bias:%d\n", tx_pa_bias[0], tx_pa_bias[1])); + + for (e_rf_path = RF_PATH_A; e_rf_path < 2; e_rf_path++) + phydm_set_pa_bias_to_rf_8822b(p_dm, e_rf_path, tx_pa_bias[e_rf_path]); + } + else + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] 8822b 2g tx pa bias no pg\n")); +} + + + +void +phydm_set_kfree_to_rf_8822b( + void *p_dm_void, + u8 e_rf_path, + u8 data +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(0), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(4), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, MASKLWORD, 0x9000); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(5), 1); + + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), ((data & 0x1f) >> 1)); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, + ("[kfree] 8822b 0x55[19:14]=0x%X path=%d\n", + odm_get_rf_reg(p_dm, e_rf_path, 0x55, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))), + e_rf_path + )); +} + + + +void +phydm_clear_kfree_to_rf_8822b( + void *p_dm_void, + u8 e_rf_path, + u8 data +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(0), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(4), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, MASKLWORD, 0x9000); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(5), 1); + + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(19), (data & BIT(0))); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, (BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14)), ((data & 0x1f) >> 1)); + + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(0), 0); + odm_set_rf_reg(p_dm, e_rf_path, 0xde, BIT(4), 1); + odm_set_rf_reg(p_dm, e_rf_path, 0x65, MASKLWORD, 0x9000); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(5), 0); + odm_set_rf_reg(p_dm, e_rf_path, 0x55, BIT(7), 0); + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, + ("[kfree] 8822b clear power trim 0x55[19:14]=0x%X path=%d\n", + odm_get_rf_reg(p_dm, e_rf_path, 0x55, (BIT(19) | BIT(18) | BIT(17) | BIT(16) | BIT(15) | BIT(14))), + e_rf_path + )); +} + + + +void +phydm_set_kfree_to_rf( + void *p_dm_void, + u8 e_rf_path, + u8 data +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_RTL8814A) + phydm_set_kfree_to_rf_8814a(p_dm, e_rf_path, data); + + if ((p_dm->support_ic_type & ODM_RTL8821C) && (*p_dm->p_band_type == ODM_BAND_2_4G)) + phydm_set_kfree_to_rf_8821c(p_dm, e_rf_path, true, data); + else if (p_dm->support_ic_type & ODM_RTL8821C) + phydm_set_kfree_to_rf_8821c(p_dm, e_rf_path, false, data); + + if (p_dm->support_ic_type & ODM_RTL8822B) + phydm_set_kfree_to_rf_8822b(p_dm, e_rf_path, data); +} + + + +void +phydm_clear_kfree_to_rf( + void *p_dm_void, + u8 e_rf_path, + u8 data +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_RTL8822B) + phydm_clear_kfree_to_rf_8822b(p_dm, e_rf_path, 1); + + if (p_dm->support_ic_type & ODM_RTL8821C) + phydm_clear_kfree_to_rf_8821c(p_dm, e_rf_path, 1); +} + + + + +void +phydm_get_thermal_trim_offset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + PEFUSE_HAL pEfuseHal = &(p_hal_data->EfuseHal); + u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; + + if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO(adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] dump efuse fail !!!\n")); +#endif + + if (p_dm->support_ic_type & ODM_RTL8821C) + phydm_get_thermal_trim_offset_8821c(p_dm_void); + else if (p_dm->support_ic_type & ODM_RTL8822B) + phydm_get_thermal_trim_offset_8822b(p_dm_void); +} + + + +void +phydm_get_power_trim_offset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + PEFUSE_HAL pEfuseHal = &(p_hal_data->EfuseHal); + u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; + + if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO(adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] dump efuse fail !!!\n")); +#endif + + if (p_dm->support_ic_type & ODM_RTL8821C) + phydm_get_power_trim_offset_8821c(p_dm_void); + else if (p_dm->support_ic_type & ODM_RTL8822B) + phydm_get_power_trim_offset_8822b(p_dm_void); +} + + + +void +phydm_get_pa_bias_offset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + PEFUSE_HAL pEfuseHal = &(p_hal_data->EfuseHal); + u1Byte eFuseContent[DCMD_EFUSE_MAX_SECTION_NUM * EFUSE_MAX_WORD_UNIT * 2]; + + if (HAL_MAC_Dump_EFUSE(&GET_HAL_MAC_INFO(adapter), EFUSE_WIFI, eFuseContent, pEfuseHal->PhysicalLen_WiFi, HAL_MAC_EFUSE_PHYSICAL, HAL_MAC_EFUSE_PARSE_DRV) != RT_STATUS_SUCCESS) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] dump efuse fail !!!\n")); +#endif + + if (p_dm->support_ic_type & ODM_RTL8822B) + phydm_get_pa_bias_offset_8822b(p_dm_void); +} + + + +s8 +phydm_get_thermal_offset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_power_trim_data *p_power_trim_info = &(p_dm->power_trim_data); + + if (p_power_trim_info->flag & KFREE_FLAG_THERMAL_K_ON) + return p_power_trim_info->thermal; + else + return 0; +} + + + +void +phydm_config_kfree( + void *p_dm_void, + u8 channel_to_sw +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct odm_power_trim_data *p_power_trim_info = &(p_dm->power_trim_data); + + u8 rfpath = 0, max_rf_path = 0; + u8 channel_idx = 0, i, j; + + if (p_dm->support_ic_type & ODM_RTL8814A) + max_rf_path = 4; /*0~3*/ + else if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E | ODM_RTL8822B)) + max_rf_path = 2; /*0~1*/ + else if (p_dm->support_ic_type & ODM_RTL8821C) + max_rf_path = 1; + + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("===>[kfree] phy_ConfigKFree()\n")); + + if (p_rf_calibrate_info->reg_rf_kfree_enable == 2) { + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] phy_ConfigKFree(): reg_rf_kfree_enable == 2, Disable\n")); + return; + } else if (p_rf_calibrate_info->reg_rf_kfree_enable == 1 || p_rf_calibrate_info->reg_rf_kfree_enable == 0) { + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] phy_ConfigKFree(): reg_rf_kfree_enable == true\n")); + /*Make sure the targetval is defined*/ + if (p_power_trim_info->flag & KFREE_FLAG_ON) { + /*if kfree_table[0] == 0xff, means no Kfree*/ + + for (i = 0; i < KFREE_BAND_NUM; i++) { + for (j = 0; j < max_rf_path; j++) + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] power_trim_data->bb_gain[%d][%d]=0x%X\n", i, j, p_power_trim_info->bb_gain[i][j])); + } + + if (*p_dm->p_band_type == ODM_BAND_2_4G && p_power_trim_info->flag & KFREE_FLAG_ON_2G) { + + if (channel_to_sw >= 1 && channel_to_sw <= 14) + channel_idx = PHYDM_2G; + + for (rfpath = RF_PATH_A; rfpath < max_rf_path; rfpath++) { + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] phydm_kfree(): channel_to_sw=%d PATH_%d bb_gain:0x%X\n", channel_to_sw, rfpath, p_power_trim_info->bb_gain[channel_idx][rfpath])); + phydm_set_kfree_to_rf(p_dm, rfpath, p_power_trim_info->bb_gain[channel_idx][rfpath]); + } + + } else if (*p_dm->p_band_type == ODM_BAND_5G && p_power_trim_info->flag & KFREE_FLAG_ON_5G) { + + if (channel_to_sw >= 36 && channel_to_sw <= 48) + channel_idx = PHYDM_5GLB1; + if (channel_to_sw >= 52 && channel_to_sw <= 64) + channel_idx = PHYDM_5GLB2; + if (channel_to_sw >= 100 && channel_to_sw <= 120) + channel_idx = PHYDM_5GMB1; + if (channel_to_sw >= 122 && channel_to_sw <= 144) + channel_idx = PHYDM_5GMB2; + if (channel_to_sw >= 149 && channel_to_sw <= 177) + channel_idx = PHYDM_5GHB; + + for (rfpath = RF_PATH_A; rfpath < max_rf_path; rfpath++) { + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] phydm_kfree(): channel_to_sw=%d PATH_%d bb_gain:0x%X\n", channel_to_sw, rfpath, p_power_trim_info->bb_gain[channel_idx][rfpath])); + phydm_set_kfree_to_rf(p_dm, rfpath, p_power_trim_info->bb_gain[channel_idx][rfpath]); + } + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] Set default Register\n")); + for (rfpath = RF_PATH_A; rfpath < max_rf_path; rfpath++) + phydm_clear_kfree_to_rf(p_dm, rfpath, p_power_trim_info->bb_gain[channel_idx][rfpath]); + } + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("[kfree] phy_ConfigKFree(): targetval not defined, Don't execute KFree Process.\n")); + return; + } + } + ODM_RT_TRACE(p_dm, ODM_COMP_MP, ODM_DBG_LOUD, ("<===[kfree] phy_ConfigKFree()\n")); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.h new file mode 100644 index 000000000000..f6772e0d0e1d --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_kfree.h @@ -0,0 +1,133 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDMKFREE_H__ +#define __PHYDKFREE_H__ + +#define KFREE_VERSION "1.0" + +#define KFREE_BAND_NUM 6 + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_AP)) + +#define BB_GAIN_NUM 6 +#define KFREE_FLAG_ON BIT(0) +#define KFREE_FLAG_THERMAL_K_ON BIT(1) + +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) +#define KFREE_FLAG_ON BIT(0) +#define KFREE_FLAG_THERMAL_K_ON BIT(1) +#endif + +#define KFREE_FLAG_ON_2G BIT(2) +#define KFREE_FLAG_ON_5G BIT(3) + +#define PPG_THERMAL_OFFSET_8821C 0x1EF +#define PPG_BB_GAIN_2G_TXAB_OFFSET_8821C 0x1EE +#define PPG_BB_GAIN_5GL1_TXA_OFFSET_8821C 0x1EC +#define PPG_BB_GAIN_5GL2_TXA_OFFSET_8821C 0x1E8 +#define PPG_BB_GAIN_5GM1_TXA_OFFSET_8821C 0x1E4 +#define PPG_BB_GAIN_5GM2_TXA_OFFSET_8821C 0x1E0 +#define PPG_BB_GAIN_5GH1_TXA_OFFSET_8821C 0x1DC + + + +#define PPG_THERMAL_OFFSET 0x3EF +#define PPG_BB_GAIN_2G_TXAB_OFFSET 0x3EE +#define PPG_BB_GAIN_2G_TXCD_OFFSET 0x3ED +#define PPG_BB_GAIN_5GL1_TXA_OFFSET 0x3EC +#define PPG_BB_GAIN_5GL1_TXB_OFFSET 0x3EB +#define PPG_BB_GAIN_5GL1_TXC_OFFSET 0x3EA +#define PPG_BB_GAIN_5GL1_TXD_OFFSET 0x3E9 +#define PPG_BB_GAIN_5GL2_TXA_OFFSET 0x3E8 +#define PPG_BB_GAIN_5GL2_TXB_OFFSET 0x3E7 +#define PPG_BB_GAIN_5GL2_TXC_OFFSET 0x3E6 +#define PPG_BB_GAIN_5GL2_TXD_OFFSET 0x3E5 +#define PPG_BB_GAIN_5GM1_TXA_OFFSET 0x3E4 +#define PPG_BB_GAIN_5GM1_TXB_OFFSET 0x3E3 +#define PPG_BB_GAIN_5GM1_TXC_OFFSET 0x3E2 +#define PPG_BB_GAIN_5GM1_TXD_OFFSET 0x3E1 +#define PPG_BB_GAIN_5GM2_TXA_OFFSET 0x3E0 +#define PPG_BB_GAIN_5GM2_TXB_OFFSET 0x3DF +#define PPG_BB_GAIN_5GM2_TXC_OFFSET 0x3DE +#define PPG_BB_GAIN_5GM2_TXD_OFFSET 0x3DD +#define PPG_BB_GAIN_5GH1_TXA_OFFSET 0x3DC +#define PPG_BB_GAIN_5GH1_TXB_OFFSET 0x3DB +#define PPG_BB_GAIN_5GH1_TXC_OFFSET 0x3DA +#define PPG_BB_GAIN_5GH1_TXD_OFFSET 0x3D9 + +#define PPG_PA_BIAS_2G_TXA_OFFSET 0x3D5 +#define PPG_PA_BIAS_2G_TXB_OFFSET 0x3D6 + + + +struct odm_power_trim_data { + u8 flag; + s8 bb_gain[KFREE_BAND_NUM][MAX_RF_PATH]; + s8 thermal; +}; + + + +enum phydm_kfree_channeltosw { + PHYDM_2G = 0, + PHYDM_5GLB1 = 1, + PHYDM_5GLB2 = 2, + PHYDM_5GMB1 = 3, + PHYDM_5GMB2 = 4, + PHYDM_5GHB = 5, +}; + + + +void +phydm_get_thermal_trim_offset( + void *p_dm_void +); + +void +phydm_get_power_trim_offset( + void *p_dm_void +); + +void +phydm_get_pa_bias_offset( + void *p_dm_void +); + +s8 +phydm_get_thermal_offset( + void *p_dm_void +); + +void +phydm_clear_kfree_to_rf( + void *p_dm_void, + u8 e_rf_path, + u8 data +); + + +void +phydm_config_kfree( + void *p_dm_void, + u8 channel_to_sw +); + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.c new file mode 100644 index 000000000000..dc43998a5f66 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.c @@ -0,0 +1,149 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + + +boolean +odm_check_power_status( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *p_adapter = p_dm->adapter; + + RT_RF_POWER_STATE rt_state; + PMGNT_INFO p_mgnt_info = &(p_adapter->MgntInfo); + + /* 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. */ + if (p_mgnt_info->init_adpt_in_progress == true) { + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("check_pow_status Return true, due to initadapter\n")); + return true; + } + + /* */ + /* 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. */ + /* */ + p_adapter->HalFunc.GetHwRegHandler(p_adapter, HW_VAR_RF_STATE, (u8 *)(&rt_state)); + if (p_adapter->bDriverStopped || p_adapter->bDriverIsGoingToPnpSetPowerSleep || rt_state == eRfOff) { + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("check_pow_status Return false, due to %d/%d/%d\n", + p_adapter->bDriverStopped, p_adapter->bDriverIsGoingToPnpSetPowerSleep, rt_state)); + return false; + } +#endif + return true; + +} + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void +halrf_update_pwr_track( + void *p_dm_void, + u8 rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + u8 path_idx = 0; +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Pwr Track Get rate=0x%x\n", rate)); + + p_dm->tx_rate = rate; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if DEV_BUS_TYPE == RT_PCI_INTERFACE +#if USE_WORKITEM + odm_schedule_work_item(&p_dm->ra_rpt_workitem); +#else + if (p_dm->support_ic_type == ODM_RTL8821) { +#if (RTL8821A_SUPPORT == 1) + odm_tx_pwr_track_set_pwr8821a(p_dm, MIX_MODE, RF_PATH_A, 0); +#endif + } else if (p_dm->support_ic_type == ODM_RTL8812) { + for (path_idx = RF_PATH_A; path_idx < MAX_PATH_NUM_8812A; path_idx++) { +#if (RTL8812A_SUPPORT == 1) + odm_tx_pwr_track_set_pwr8812a(p_dm, MIX_MODE, path_idx, 0); +#endif + } + } else if (p_dm->support_ic_type == ODM_RTL8723B) { +#if (RTL8723B_SUPPORT == 1) + odm_tx_pwr_track_set_pwr_8723b(p_dm, MIX_MODE, RF_PATH_A, 0); +#endif + } else if (p_dm->support_ic_type == ODM_RTL8192E) { + for (path_idx = RF_PATH_A; path_idx < MAX_PATH_NUM_8192E; path_idx++) { +#if (RTL8192E_SUPPORT == 1) + odm_tx_pwr_track_set_pwr92_e(p_dm, MIX_MODE, path_idx, 0); +#endif + } + } else if (p_dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT == 1) + odm_tx_pwr_track_set_pwr88_e(p_dm, MIX_MODE, RF_PATH_A, 0); +#endif + } +#endif +#else + odm_schedule_work_item(&p_dm->ra_rpt_workitem); +#endif +#endif + +} + +#endif + + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +halrf_update_init_rate_work_item_callback( + void *p_context +) +{ + struct _ADAPTER *adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + u8 p = 0; + + if (p_dm->support_ic_type == ODM_RTL8821) { + odm_tx_pwr_track_set_pwr8821a(p_dm, MIX_MODE, RF_PATH_A, 0); + /**/ + } else if (p_dm->support_ic_type == ODM_RTL8812) { + for (p = RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) { /*DOn't know how to include &c*/ + + odm_tx_pwr_track_set_pwr8812a(p_dm, MIX_MODE, p, 0); + /**/ + } + } else if (p_dm->support_ic_type == ODM_RTL8723B) { + odm_tx_pwr_track_set_pwr_8723b(p_dm, MIX_MODE, RF_PATH_A, 0); + /**/ + } else if (p_dm->support_ic_type == ODM_RTL8192E) { + for (p = RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) { /*DOn't know how to include &c*/ + odm_tx_pwr_track_set_pwr92_e(p_dm, MIX_MODE, p, 0); + /**/ + } + } else if (p_dm->support_ic_type == ODM_RTL8188E) { + odm_tx_pwr_track_set_pwr88_e(p_dm, MIX_MODE, RF_PATH_A, 0); + /**/ + } +} +#endif + + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.h new file mode 100644 index 000000000000..05abae37c7a4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking.h @@ -0,0 +1,41 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __HALRF_POWER_TRACKING_H__ +#define __HALRF_POWER_TRACKING_H__ + +#define HALRF_POWRTRACKING_ALL_VER "1.0" + +boolean +odm_check_power_status( + void *p_dm_void +); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void +halrf_update_pwr_track( + void *p_dm_void, + u8 rate +); +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +halrf_update_init_rate_work_item_callback( + void *p_context +); +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.c new file mode 100644 index 000000000000..7319c40ab108 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.c @@ -0,0 +1,1161 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#if !defined(_OUTSRC_COEXIST) +/* ************************************************************ + * Global var + * ************************************************************ */ + + +u32 ofdm_swing_table_new[OFDM_TABLE_SIZE_92D] = { + 0x0b40002d, /* 0, -15.0dB */ + 0x0c000030, /* 1, -14.5dB */ + 0x0cc00033, /* 2, -14.0dB */ + 0x0d800036, /* 3, -13.5dB */ + 0x0e400039, /* 4, -13.0dB */ + 0x0f00003c, /* 5, -12.5dB */ + 0x10000040, /* 6, -12.0dB */ + 0x11000044, /* 7, -11.5dB */ + 0x12000048, /* 8, -11.0dB */ + 0x1300004c, /* 9, -10.5dB */ + 0x14400051, /* 10, -10.0dB */ + 0x15800056, /* 11, -9.5dB */ + 0x16c0005b, /* 12, -9.0dB */ + 0x18000060, /* 13, -8.5dB */ + 0x19800066, /* 14, -8.0dB */ + 0x1b00006c, /* 15, -7.5dB */ + 0x1c800072, /* 16, -7.0dB */ + 0x1e400079, /* 17, -6.5dB */ + 0x20000080, /* 18, -6.0dB */ + 0x22000088, /* 19, -5.5dB */ + 0x24000090, /* 20, -5.0dB */ + 0x26000098, /* 21, -4.5dB */ + 0x288000a2, /* 22, -4.0dB */ + 0x2ac000ab, /* 23, -3.5dB */ + 0x2d4000b5, /* 24, -3.0dB */ + 0x300000c0, /* 25, -2.5dB */ + 0x32c000cb, /* 26, -2.0dB */ + 0x35c000d7, /* 27, -1.5dB */ + 0x390000e4, /* 28, -1.0dB */ + 0x3c8000f2, /* 29, -0.5dB */ + 0x40000100, /* 30, +0dB */ + 0x43c0010f, /* 31, +0.5dB */ + 0x47c0011f, /* 32, +1.0dB */ + 0x4c000130, /* 33, +1.5dB */ + 0x50800142, /* 34, +2.0dB */ + 0x55400155, /* 35, +2.5dB */ + 0x5a400169, /* 36, +3.0dB */ + 0x5fc0017f, /* 37, +3.5dB */ + 0x65400195, /* 38, +4.0dB */ + 0x6b8001ae, /* 39, +4.5dB */ + 0x71c001c7, /* 40, +5.0dB */ + 0x788001e2, /* 41, +5.5dB */ + 0x7f8001fe /* 42, +6.0dB */ +}; + +u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB */ + {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB */ + {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB */ + {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB */ + {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB */ + {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB */ + {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB */ + {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB */ + {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB */ + {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB */ + {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB */ + {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB */ + {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB */ + {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB */ + {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB */ + {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB */ + {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB */ + {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, /* 20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB */ + {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB */ + {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB */ + {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB */ + {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB */ + {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB */ + {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB */ + {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB */ + {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB */ +}; + + +u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB */ + {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB */ + {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB */ + {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB */ + {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB */ + {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 5, -13.5dB */ + {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB */ + {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB */ + {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB */ + {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB */ + {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB */ + {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 11, -10.5dB */ + {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB */ + {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB */ + {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB */ + {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB */ + {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ + {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB */ + {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 23, -4.5dB */ + {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ + {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ + {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 27, -2.5dB */ + {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 29, -1.5dB */ + {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ + {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ + {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ +}; + +u32 ofdm_swing_table[OFDM_TABLE_SIZE_92D] = { + 0x0b40002d, /* 0, -15.0dB */ + 0x0c000030, /* 1, -14.5dB */ + 0x0cc00033, /* 2, -14.0dB */ + 0x0d800036, /* 3, -13.5dB */ + 0x0e400039, /* 4, -13.0dB */ + 0x0f00003c, /* 5, -12.5dB */ + 0x10000040, /* 6, -12.0dB */ + 0x11000044, /* 7, -11.5dB */ + 0x12000048, /* 8, -11.0dB */ + 0x1300004c, /* 9, -10.5dB */ + 0x14400051, /* 10, -10.0dB */ + 0x15800056, /* 11, -9.5dB */ + 0x16c0005b, /* 12, -9.0dB */ + 0x18000060, /* 13, -8.5dB */ + 0x19800066, /* 14, -8.0dB */ + 0x1b00006c, /* 15, -7.5dB */ + 0x1c800072, /* 16, -7.0dB */ + 0x1e400079, /* 17, -6.5dB */ + 0x20000080, /* 18, -6.0dB */ + 0x22000088, /* 19, -5.5dB */ + 0x24000090, /* 20, -5.0dB */ + 0x26000098, /* 21, -4.5dB */ + 0x288000a2, /* 22, -4.0dB */ + 0x2ac000ab, /* 23, -3.5dB */ + 0x2d4000b5, /* 24, -3.0dB */ + 0x300000c0, /* 25, -2.5dB */ + 0x32c000cb, /* 26, -2.0dB */ + 0x35c000d7, /* 27, -1.5dB */ + 0x390000e4, /* 28, -1.0dB */ + 0x3c8000f2, /* 29, -0.5dB */ + 0x40000100, /* 30, +0dB */ + 0x43c0010f, /* 31, +0.5dB */ + 0x47c0011f, /* 32, +1.0dB */ + 0x4c000130, /* 33, +1.5dB */ + 0x50800142, /* 34, +2.0dB */ + 0x55400155, /* 35, +2.5dB */ + 0x5a400169, /* 36, +3.0dB */ + 0x5fc0017f, /* 37, +3.5dB */ + 0x65400195, /* 38, +4.0dB */ + 0x6b8001ae, /* 39, +4.5dB */ + 0x71c001c7, /* 40, +5.0dB */ + 0x788001e2, /* 41, +5.5dB */ + 0x7f8001fe /* 42, +6.0dB */ +}; + + +u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB */ + {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB */ + {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB */ + {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB */ + {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB */ + {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB */ + {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB */ + {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB */ + {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB */ + {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB */ + {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB */ + {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB */ + {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB */ + {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB */ + {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB */ + {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB */ + {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB */ + {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, /* 20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB */ + {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB */ + {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB */ + {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB */ + {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB */ + {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB */ + {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB */ + {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB */ + {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB */ +}; + + +u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB */ + {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB */ + {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB */ + {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB */ + {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB */ + {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 5, -13.5dB */ + {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB */ + {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB */ + {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB */ + {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB */ + {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB */ + {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 11, -10.5dB */ + {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB */ + {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB */ + {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB */ + {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB */ + {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ + {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB */ + {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 23, -4.5dB */ + {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ + {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ + {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 27, -2.5dB */ + {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 29, -1.5dB */ + {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ + {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ + {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ +}; + +u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16] = { + {0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ + {0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ + {0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ + {0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ + {0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ + {0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ + {0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ + {0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ + {0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ + {0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ + {0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ + {0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ + {0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ + {0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ + {0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ + {0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ + {0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ + {0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ + {0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ + {0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ + {0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ +}; + + +u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16] = { + {0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ + {0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ + {0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ + {0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ + {0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ + {0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ + {0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ + {0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ + {0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ + {0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ + {0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ + {0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ + {0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ + {0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ + {0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ + {0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ + {0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ + {0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ + {0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ + {0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ + {0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ +}; + + +u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16] = { + {0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ + {0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ + {0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ + {0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ + {0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ + {0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ + {0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ + {0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ + {0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ + {0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ + {0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ + {0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ + {0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ + {0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ + {0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ + {0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ + {0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ + {0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ + {0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ + {0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ + {0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ +}; + + + +#if 0 +u32 ofdm_swing_table_92e[OFDM_TABLE_SIZE_92E] = { + /* Index0 6 dB */ 0x7fc001ff, + /* Index1 5.7dB */ 0x7b4001ed, + /* Index2 5.4dB */ 0x774001dd, + /* Index3 5.1dB */ 0x734001cd, + /* Index4 4.8dB */ 0x6f4001bd, + /* Index5 4.5dB */ 0x6b8001ae, + /* Index6 4.2dB */ 0x67c0019f, + /* Index7 3.9dB */ 0x64400191, + /* Index8 3.6dB */ 0x60c00183, + /* Index9 3.3dB */ 0x5d800176, + /* Index10 3 dB */ 0x5a80016a, + /* Index11 2.7dB */ 0x5740015d, + /* Index12 2.4dB */ 0x54400151, + /* Index13 2.1dB */ 0x51800146, + /* Index14 1.8dB */ 0x4ec0013b, + /* Index15 1.5dB */ 0x4c000130, + /* Index16 1.2dB */ 0x49800126, + /* Index17 0.9dB */ 0x4700011c, + /* Index18 0.6dB */ 0x44800112, + /* Index19 0.3dB */ 0x42000108, + /* Index20 0 dB */ 0x40000100, /* 20 This is OFDM base index */ + /* Index21 -0.3dB */ 0x3dc000f7, + /* Index22 -0.6dB */ 0x3bc000ef, + /* Index23 -0.9dB */ 0x39c000e7, + /* Index24 -1.2dB */ 0x37c000df, + /* Index25 -1.5dB */ 0x35c000d7, + /* Index26 -1.8dB */ 0x340000d0, + /* Index27 -2.1dB */ 0x324000c9, + /* Index28 -2.4dB */ 0x308000c2, + /* Index29 -2.7dB */ 0x2f0000bc, + /* Index30 -3 dB */ 0x2d4000b5, + /* Index31 -3.3dB */ 0x2bc000af, + /* Index32 -3.6dB */ 0x2a4000a9, + /* Index33 -3.9dB */ 0x28c000a3, + /* Index34 -4.2dB */ 0x2780009e, + /* Index35 -4.5dB */ 0x26000098, + /* Index36 -4.8dB */ 0x24c00093, + /* Index37 -5.1dB */ 0x2380008e, + /* Index38 -5.4dB */ 0x22400089, + /* Index39 -5.7dB */ 0x21400085, + /* Index40 -6 dB */ 0x20000080, + /* Index41 -6.3dB */ 0x1f00007c, + /* Index42 -6.6dB */ 0x1e000078, + /* Index43 -6.9dB */ 0x1d000074, + /* Index44 -7.2dB */ 0x1c000070, + /* Index45 -7.5dB */ 0x1b00006c, + /* Index46 -7.8dB */ 0x1a000068, + /* Index47 -8.1dB */ 0x19400065, + /* Index48 -8.4dB */ 0x18400061, + /* Index49 -8.7dB */ 0x1780005e, + /* Index50 -9 dB */ 0x16c0005b, + /* Index51 -9.3dB */ 0x16000058, + /* Index52 -9.6dB */ 0x15400055, + /* Index53 -9.9dB */ 0x14800052 +}; +u8 cck_swing_table_ch1_ch13_92e[CCK_TABLE_SIZE_92E][8] = { + /* Index0 0 dB */ {0x36, 0x34, 0x2E, 0x26, 0x1C, 0x12, 0x08, 0x04}, + /* Index1 -0.3dB */ {0x34, 0x32, 0x2C, 0x25, 0x1B, 0x11, 0x08, 0x04}, + /* Index2 -0.6dB */ {0x32, 0x30, 0x2B, 0x23, 0x1A, 0x11, 0x07, 0x04}, + /* Index3 -0.9dB */ {0x31, 0x2F, 0x29, 0x22, 0x19, 0x10, 0x07, 0x04}, + /* Index4 -1.2dB */ {0x2F, 0x2D, 0x28, 0x21, 0x18, 0x10, 0x07, 0x03}, + /* Index5 -1.5dB */ {0x2D, 0x2C, 0x27, 0x20, 0x18, 0x0F, 0x07, 0x03}, + /* Index6 -1.8dB */ {0x2C, 0x2A, 0x25, 0x1F, 0x17, 0x0F, 0x06, 0x03}, + /* Index7 -2.1dB */ {0x2A, 0x29, 0x24, 0x1E, 0x16, 0x0E, 0x06, 0x03}, + /* Index8 -2.4dB */ {0x29, 0x27, 0x23, 0x1D, 0x15, 0x0E, 0x06, 0x03}, + /* Index9 -2.7dB */ {0x27, 0x26, 0x22, 0x1C, 0x14, 0x0D, 0x06, 0x03}, + /* Index10 -3 dB */ {0x26, 0x25, 0x20, 0x1B, 0x14, 0x0D, 0x06, 0x03}, + /* Index11 -3.3dB */ {0x25, 0x23, 0x1F, 0x1A, 0x13, 0x0C, 0x05, 0x03}, + /* Index12 -3.6dB */ {0x24, 0x22, 0x1E, 0x19, 0x12, 0x0C, 0x05, 0x03}, + /* Index13 -3.9dB */ {0x22, 0x21, 0x1D, 0x18, 0x12, 0x0B, 0x05, 0x03}, + /* Index14 -4.2dB */ {0x21, 0x20, 0x1C, 0x17, 0x11, 0x0B, 0x05, 0x02}, + /* Index15 -4.5dB */ {0x20, 0x1F, 0x1B, 0x17, 0x11, 0x0B, 0x05, 0x02}, + /* Index16 -4.8dB */ {0x1F, 0x1E, 0x1A, 0x16, 0x10, 0x0A, 0x05, 0x02}, + /* Index17 -5.1dB */ {0x1E, 0x1D, 0x1A, 0x15, 0x10, 0x0A, 0x04, 0x02}, + /* Index18 -5.4dB */ {0x1D, 0x1C, 0x19, 0x14, 0x0F, 0x0A, 0x04, 0x02}, + /* Index19 -5.7dB */ {0x1C, 0x1B, 0x18, 0x14, 0x0E, 0x09, 0x04, 0x02}, + /* Index20 -6.0dB */ {0x1B, 0x1A, 0x17, 0x13, 0x0E, 0x09, 0x04, 0x02}, /* 20 This is CCK base index */ + /* Index21 -6.3dB */ {0x1A, 0x19, 0x16, 0x12, 0x0E, 0x09, 0x04, 0x02}, + /* Index22 -6.6dB */ {0x19, 0x18, 0x15, 0x12, 0x0D, 0x08, 0x04, 0x02}, + /* Index23 -6.9dB */ {0x18, 0x17, 0x15, 0x11, 0x0D, 0x08, 0x04, 0x02}, + /* Index24 -7.2dB */ {0x18, 0x17, 0x14, 0x11, 0x0C, 0x08, 0x03, 0x02}, + /* Index25 -7.5dB */ {0x17, 0x16, 0x13, 0x10, 0x0C, 0x08, 0x03, 0x02}, + /* Index26 -7.8dB */ {0x16, 0x15, 0x13, 0x0F, 0x0B, 0x07, 0x03, 0x02}, + /* Index27 -8.1dB */ {0x15, 0x14, 0x12, 0x0F, 0x0B, 0x07, 0x03, 0x02}, + /* Index28 -8.4dB */ {0x14, 0x14, 0x11, 0x0E, 0x0B, 0x07, 0x03, 0x02}, + /* Index29 -8.7dB */ {0x14, 0x13, 0x11, 0x0E, 0x0A, 0x07, 0x03, 0x01}, + /* Index30 -9.0dB */ {0x13, 0x12, 0x10, 0x0D, 0x0A, 0x06, 0x03, 0x01}, /* 30 This is hp CCK base index */ + /* Index31 -9.3dB */ {0x12, 0x12, 0x0F, 0x0D, 0x0A, 0x06, 0x03, 0x01}, + /* Index32 -9.6dB */ {0x12, 0x11, 0x0F, 0x0D, 0x09, 0x06, 0x03, 0x01}, + /* Index33 -9.9dB */ {0x11, 0x11, 0x0F, 0x0C, 0x09, 0x06, 0x03, 0x01}, + /* Index34 -10.2dB */ {0x11, 0x11, 0x0E, 0x0C, 0x09, 0x06, 0x02, 0x01}, + /* Index35 -10.5dB */ {0x10, 0x0F, 0x0E, 0x0B, 0x08, 0x05, 0x02, 0x01}, + /* Index36 -10.8dB */ {0x10, 0x0F, 0x0D, 0x0B, 0x08, 0x05, 0x02, 0x01}, + /* Index37 -11.1dB */ {0x0F, 0x0E, 0x0D, 0x0A, 0x08, 0x05, 0x02, 0x01}, + /* Index38 -11.4dB */ {0x0E, 0x0E, 0x0C, 0x0A, 0x07, 0x05, 0x02, 0x01}, + /* Index39 -11.7dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x07, 0x05, 0x02, 0x01}, + /* Index40 -12 dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x07, 0x05, 0x02, 0x01}, + /* Index41 -12.3dB */ {0x0D, 0x0D, 0x0B, 0x09, 0x07, 0x04, 0x02, 0x01}, + /* Index42 -12.6dB */ {0x0D, 0x0C, 0x0B, 0x09, 0x07, 0x04, 0x02, 0x01}, + /* Index43 -12.9dB */ {0x0C, 0x0C, 0x0A, 0x09, 0x06, 0x04, 0x02, 0x01}, + /* Index44 -13.2dB */ {0x0C, 0x0B, 0x0A, 0x08, 0x06, 0x04, 0x02, 0x01}, + /* Index45 -13.5dB */ {0x0B, 0x0B, 0x0A, 0x08, 0x06, 0x04, 0x02, 0x01}, + /* Index46 -13.8dB */ {0x0B, 0x0B, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, + /* Index47 -14.1dB */ {0x0B, 0x0A, 0x09, 0x07, 0x06, 0x04, 0x02, 0x01}, + /* Index48 -14.4dB */ {0x0A, 0x0A, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, + /* Index49 -14.7dB */ {0x0A, 0x0A, 0x08, 0x07, 0x05, 0x03, 0x01, 0x01}, + /* Index50 -15 dB */ {0x0A, 0x09, 0x08, 0x07, 0x05, 0x03, 0x01, 0x01}, + /* Index51 -15.3dB */ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, + /* Index52 -15.6dB */ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, + /* Index53 -15.9dB */ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} +}; +u8 cck_swing_table_ch14_92e[CCK_TABLE_SIZE_92E][8] = { + /* Index0 0 dB */ {0x36, 0x34, 0x2E, 0x26, 0x00, 0x00, 0x00, 0x00}, + /* Index1 -0.3dB */ {0x34, 0x32, 0x2C, 0x25, 0x00, 0x00, 0x00, 0x00}, + /* Index2 -0.6dB */ {0x32, 0x30, 0x2B, 0x23, 0x00, 0x00, 0x00, 0x00}, + /* Index3 -0.9dB */ {0x31, 0x2F, 0x29, 0x22, 0x00, 0x00, 0x00, 0x00}, + /* Index4 -1.2dB */ {0x2F, 0x2D, 0x28, 0x21, 0x00, 0x00, 0x00, 0x00}, + /* Index5 -1.5dB */ {0x2D, 0x2C, 0x27, 0x20, 0x00, 0x00, 0x00, 0x00}, + /* Index6 -1.8dB */ {0x2C, 0x2A, 0x25, 0x1F, 0x00, 0x00, 0x00, 0x00}, + /* Index7 -2.1dB */ {0x2A, 0x29, 0x24, 0x1E, 0x00, 0x00, 0x00, 0x00}, + /* Index8 -2.4dB */ {0x29, 0x27, 0x23, 0x1D, 0x00, 0x00, 0x00, 0x00}, + /* Index9 -2.7dB */ {0x27, 0x26, 0x22, 0x1C, 0x00, 0x00, 0x00, 0x00}, + /* Index10 -3 dB */ {0x26, 0x25, 0x20, 0x1B, 0x00, 0x00, 0x00, 0x00}, + /* Index11 -3.3dB */ {0x25, 0x23, 0x1F, 0x1A, 0x00, 0x00, 0x00, 0x00}, + /* Index12 -3.6dB */ {0x24, 0x22, 0x1E, 0x19, 0x00, 0x00, 0x00, 0x00}, + /* Index13 -3.9dB */ {0x22, 0x21, 0x1D, 0x18, 0x00, 0x00, 0x00, 0x00}, + /* Index14 -4.2dB */ {0x21, 0x20, 0x1C, 0x17, 0x00, 0x00, 0x00, 0x00}, + /* Index15 -4.5dB */ {0x20, 0x1F, 0x1B, 0x17, 0x00, 0x00, 0x00, 0x00}, + /* Index16 -4.8dB */ {0x1F, 0x1E, 0x1A, 0x16, 0x00, 0x00, 0x00, 0x00}, + /* Index17 -5.1dB */ {0x1E, 0x1D, 0x1A, 0x15, 0x00, 0x00, 0x00, 0x00}, + /* Index18 -5.4dB */ {0x1D, 0x1C, 0x19, 0x14, 0x00, 0x00, 0x00, 0x00}, + /* Index19 -5.7dB */ {0x1C, 0x1B, 0x18, 0x14, 0x00, 0x00, 0x00, 0x00}, + /* Index20 -6 dB */ {0x1B, 0x1A, 0x17, 0x13, 0x00, 0x00, 0x00, 0x00}, + /* Index21 -6.3dB */ {0x1A, 0x19, 0x16, 0x12, 0x00, 0x00, 0x00, 0x00}, + /* Index22 -6.6dB */ {0x19, 0x18, 0x15, 0x12, 0x00, 0x00, 0x00, 0x00}, + /* Index23 -6.9dB */ {0x18, 0x17, 0x15, 0x11, 0x00, 0x00, 0x00, 0x00}, + /* Index24 -7.2dB */ {0x18, 0x17, 0x14, 0x11, 0x00, 0x00, 0x00, 0x00}, + /* Index25 -7.5dB */ {0x17, 0x16, 0x13, 0x10, 0x00, 0x00, 0x00, 0x00}, + /* Index26 -7.8dB */ {0x16, 0x15, 0x13, 0x0F, 0x00, 0x00, 0x00, 0x00}, + /* Index27 -8.1dB */ {0x15, 0x14, 0x12, 0x0F, 0x00, 0x00, 0x00, 0x00}, + /* Index28 -8.4dB */ {0x14, 0x14, 0x11, 0x0E, 0x00, 0x00, 0x00, 0x00}, + /* Index29 -8.7dB */ {0x14, 0x13, 0x11, 0x0E, 0x00, 0x00, 0x00, 0x00}, + /* Index30 -9 dB */ {0x13, 0x12, 0x10, 0x0D, 0x00, 0x00, 0x00, 0x00}, + /* Index31 -9.3dB */ {0x12, 0x12, 0x0F, 0x0D, 0x00, 0x00, 0x00, 0x00}, + /* Index32 -9.6dB */ {0x12, 0x11, 0x0F, 0x0D, 0x00, 0x00, 0x00, 0x00}, + /* Index33 -9.9dB */ {0x11, 0x11, 0x0F, 0x0C, 0x00, 0x00, 0x00, 0x00}, + /* Index34 -10.2dB */ {0x11, 0x11, 0x0E, 0x0C, 0x00, 0x00, 0x00, 0x00}, + /* Index35 -10.5dB */ {0x10, 0x0F, 0x0E, 0x0B, 0x00, 0x00, 0x00, 0x00}, + /* Index36 -10.8dB */ {0x10, 0x0F, 0x0D, 0x0B, 0x00, 0x00, 0x00, 0x00}, + /* Index37 -11.1dB */ {0x0F, 0x0E, 0x0D, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index38 -11.4dB */ {0x0E, 0x0E, 0x0C, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index39 -11.7dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index40 -12 dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index41 -12.3dB */ {0x0D, 0x0D, 0x0B, 0x09, 0x00, 0x00, 0x00, 0x00}, + /* Index42 -12.6dB */ {0x0D, 0x0C, 0x0B, 0x09, 0x00, 0x00, 0x00, 0x00}, + /* Index43 -12.9dB */ {0x0C, 0x0C, 0x0A, 0x09, 0x00, 0x00, 0x00, 0x00}, + /* Index44 -13.2dB */ {0x0C, 0x0B, 0x0A, 0x08, 0x00, 0x00, 0x00, 0x00}, + /* Index45 -13.5dB */ {0x0B, 0x0B, 0x0A, 0x08, 0x00, 0x00, 0x00, 0x00}, + /* Index46 -13.8dB */ {0x0B, 0x0B, 0x09, 0x08, 0x00, 0x00, 0x00, 0x00}, + /* Index47 -14.1dB */ {0x0B, 0x0A, 0x09, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index48 -14.4dB */ {0x0A, 0x0A, 0x09, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index49 -14.7dB */ {0x0A, 0x0A, 0x08, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index50 -15 dB */ {0x0A, 0x09, 0x08, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index51 -15.3dB */ {0x09, 0x09, 0x08, 0x06, 0x00, 0x00, 0x00, 0x00}, + /* Index52 -15.6dB */ {0x09, 0x09, 0x08, 0x06, 0x00, 0x00, 0x00, 0x00}, + /* Index53 -15.9dB */ {0x09, 0x08, 0x07, 0x06, 0x00, 0x00, 0x00, 0x00} +}; +#endif +#endif + + +u8 delta_swing_table_idx_2ga_p_default[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3 + , 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9 + }; +u8 delta_swing_table_idx_2ga_n_default[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4 + , 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11 + }; + + +#ifdef CONFIG_WLAN_HAL_8192EE +u32 ofdm_swing_table_92e[OFDM_TABLE_SIZE_92E] = { + /* Index0 6 dB */ 0x7fc001ff, + /* Index1 5.7dB */ 0x7b4001ed, + /* Index2 5.4dB */ 0x774001dd, + /* Index3 5.1dB */ 0x734001cd, + /* Index4 4.8dB */ 0x6f4001bd, + /* Index5 4.5dB */ 0x6b8001ae, + /* Index6 4.2dB */ 0x67c0019f, + /* Index7 3.9dB */ 0x64400191, + /* Index8 3.6dB */ 0x60c00183, + /* Index9 3.3dB */ 0x5d800176, + /* Index10 3 dB */ 0x5a80016a, + /* Index11 2.7dB */ 0x5740015d, + /* Index12 2.4dB */ 0x54400151, + /* Index13 2.1dB */ 0x51800146, + /* Index14 1.8dB */ 0x4ec0013b, + /* Index15 1.5dB */ 0x4c000130, + /* Index16 1.2dB */ 0x49800126, + /* Index17 0.9dB */ 0x4700011c, + /* Index18 0.6dB */ 0x44800112, + /* Index19 0.3dB */ 0x42000108, + /* Index20 0 dB */ 0x40000100, /* 20 This is OFDM base index */ + /* Index21 -0.3dB */ 0x3dc000f7, + /* Index22 -0.6dB */ 0x3bc000ef, + /* Index23 -0.9dB */ 0x39c000e7, + /* Index24 -1.2dB */ 0x37c000df, + /* Index25 -1.5dB */ 0x35c000d7, + /* Index26 -1.8dB */ 0x340000d0, + /* Index27 -2.1dB */ 0x324000c9, + /* Index28 -2.4dB */ 0x308000c2, + /* Index29 -2.7dB */ 0x2f0000bc, + /* Index30 -3 dB */ 0x2d4000b5, + /* Index31 -3.3dB */ 0x2bc000af, + /* Index32 -3.6dB */ 0x2a4000a9, + /* Index33 -3.9dB */ 0x28c000a3, + /* Index34 -4.2dB */ 0x2780009e, + /* Index35 -4.5dB */ 0x26000098, + /* Index36 -4.8dB */ 0x24c00093, + /* Index37 -5.1dB */ 0x2380008e, + /* Index38 -5.4dB */ 0x22400089, + /* Index39 -5.7dB */ 0x21400085, + /* Index40 -6 dB */ 0x20000080, + /* Index41 -6.3dB */ 0x1f00007c, + /* Index42 -6.6dB */ 0x1e000078, + /* Index43 -6.9dB */ 0x1d000074, + /* Index44 -7.2dB */ 0x1c000070, + /* Index45 -7.5dB */ 0x1b00006c, + /* Index46 -7.8dB */ 0x1a000068, + /* Index47 -8.1dB */ 0x19400065, + /* Index48 -8.4dB */ 0x18400061, + /* Index49 -8.7dB */ 0x1780005e, + /* Index50 -9 dB */ 0x16c0005b, + /* Index51 -9.3dB */ 0x16000058, + /* Index52 -9.6dB */ 0x15400055, + /* Index53 -9.9dB */ 0x14800052 +}; +u8 cck_swing_table_ch1_ch13_92e[CCK_TABLE_SIZE_92E][8] = { + /* Index0 0 dB */ {0x36, 0x34, 0x2E, 0x26, 0x1C, 0x12, 0x08, 0x04}, + /* Index1 -0.3dB */ {0x34, 0x32, 0x2C, 0x25, 0x1B, 0x11, 0x08, 0x04}, + /* Index2 -0.6dB */ {0x32, 0x30, 0x2B, 0x23, 0x1A, 0x11, 0x07, 0x04}, + /* Index3 -0.9dB */ {0x31, 0x2F, 0x29, 0x22, 0x19, 0x10, 0x07, 0x04}, + /* Index4 -1.2dB */ {0x2F, 0x2D, 0x28, 0x21, 0x18, 0x10, 0x07, 0x03}, + /* Index5 -1.5dB */ {0x2D, 0x2C, 0x27, 0x20, 0x18, 0x0F, 0x07, 0x03}, + /* Index6 -1.8dB */ {0x2C, 0x2A, 0x25, 0x1F, 0x17, 0x0F, 0x06, 0x03}, + /* Index7 -2.1dB */ {0x2A, 0x29, 0x24, 0x1E, 0x16, 0x0E, 0x06, 0x03}, + /* Index8 -2.4dB */ {0x29, 0x27, 0x23, 0x1D, 0x15, 0x0E, 0x06, 0x03}, + /* Index9 -2.7dB */ {0x27, 0x26, 0x22, 0x1C, 0x14, 0x0D, 0x06, 0x03}, + /* Index10 -3 dB */ {0x26, 0x25, 0x20, 0x1B, 0x14, 0x0D, 0x06, 0x03}, + /* Index11 -3.3dB */ {0x25, 0x23, 0x1F, 0x1A, 0x13, 0x0C, 0x05, 0x03}, + /* Index12 -3.6dB */ {0x24, 0x22, 0x1E, 0x19, 0x12, 0x0C, 0x05, 0x03}, + /* Index13 -3.9dB */ {0x22, 0x21, 0x1D, 0x18, 0x12, 0x0B, 0x05, 0x03}, + /* Index14 -4.2dB */ {0x21, 0x20, 0x1C, 0x17, 0x11, 0x0B, 0x05, 0x02}, + /* Index15 -4.5dB */ {0x20, 0x1F, 0x1B, 0x17, 0x11, 0x0B, 0x05, 0x02}, + /* Index16 -4.8dB */ {0x1F, 0x1E, 0x1A, 0x16, 0x10, 0x0A, 0x05, 0x02}, + /* Index17 -5.1dB */ {0x1E, 0x1D, 0x1A, 0x15, 0x10, 0x0A, 0x04, 0x02}, + /* Index18 -5.4dB */ {0x1D, 0x1C, 0x19, 0x14, 0x0F, 0x0A, 0x04, 0x02}, + /* Index19 -5.7dB */ {0x1C, 0x1B, 0x18, 0x14, 0x0E, 0x09, 0x04, 0x02}, + /* Index20 -6.0dB */ {0x1B, 0x1A, 0x17, 0x13, 0x0E, 0x09, 0x04, 0x02}, /* 20 This is CCK base index */ + /* Index21 -6.3dB */ {0x1A, 0x19, 0x16, 0x12, 0x0E, 0x09, 0x04, 0x02}, + /* Index22 -6.6dB */ {0x19, 0x18, 0x15, 0x12, 0x0D, 0x08, 0x04, 0x02}, + /* Index23 -6.9dB */ {0x18, 0x17, 0x15, 0x11, 0x0D, 0x08, 0x04, 0x02}, + /* Index24 -7.2dB */ {0x18, 0x17, 0x14, 0x11, 0x0C, 0x08, 0x03, 0x02}, + /* Index25 -7.5dB */ {0x17, 0x16, 0x13, 0x10, 0x0C, 0x08, 0x03, 0x02}, + /* Index26 -7.8dB */ {0x16, 0x15, 0x13, 0x0F, 0x0B, 0x07, 0x03, 0x02}, + /* Index27 -8.1dB */ {0x15, 0x14, 0x12, 0x0F, 0x0B, 0x07, 0x03, 0x02}, + /* Index28 -8.4dB */ {0x14, 0x14, 0x11, 0x0E, 0x0B, 0x07, 0x03, 0x02}, + /* Index29 -8.7dB */ {0x14, 0x13, 0x11, 0x0E, 0x0A, 0x07, 0x03, 0x01}, + /* Index30 -9.0dB */ {0x13, 0x12, 0x10, 0x0D, 0x0A, 0x06, 0x03, 0x01}, /* 30 This is hp CCK base index */ + /* Index31 -9.3dB */ {0x12, 0x12, 0x0F, 0x0D, 0x0A, 0x06, 0x03, 0x01}, + /* Index32 -9.6dB */ {0x12, 0x11, 0x0F, 0x0D, 0x09, 0x06, 0x03, 0x01}, + /* Index33 -9.9dB */ {0x11, 0x11, 0x0F, 0x0C, 0x09, 0x06, 0x03, 0x01}, + /* Index34 -10.2dB */ {0x11, 0x11, 0x0E, 0x0C, 0x09, 0x06, 0x02, 0x01}, + /* Index35 -10.5dB */ {0x10, 0x0F, 0x0E, 0x0B, 0x08, 0x05, 0x02, 0x01}, + /* Index36 -10.8dB */ {0x10, 0x0F, 0x0D, 0x0B, 0x08, 0x05, 0x02, 0x01}, + /* Index37 -11.1dB */ {0x0F, 0x0E, 0x0D, 0x0A, 0x08, 0x05, 0x02, 0x01}, + /* Index38 -11.4dB */ {0x0E, 0x0E, 0x0C, 0x0A, 0x07, 0x05, 0x02, 0x01}, + /* Index39 -11.7dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x07, 0x05, 0x02, 0x01}, + /* Index40 -12 dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x07, 0x05, 0x02, 0x01}, + /* Index41 -12.3dB */ {0x0D, 0x0D, 0x0B, 0x09, 0x07, 0x04, 0x02, 0x01}, + /* Index42 -12.6dB */ {0x0D, 0x0C, 0x0B, 0x09, 0x07, 0x04, 0x02, 0x01}, + /* Index43 -12.9dB */ {0x0C, 0x0C, 0x0A, 0x09, 0x06, 0x04, 0x02, 0x01}, + /* Index44 -13.2dB */ {0x0C, 0x0B, 0x0A, 0x08, 0x06, 0x04, 0x02, 0x01}, + /* Index45 -13.5dB */ {0x0B, 0x0B, 0x0A, 0x08, 0x06, 0x04, 0x02, 0x01}, + /* Index46 -13.8dB */ {0x0B, 0x0B, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, + /* Index47 -14.1dB */ {0x0B, 0x0A, 0x09, 0x07, 0x06, 0x04, 0x02, 0x01}, + /* Index48 -14.4dB */ {0x0A, 0x0A, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, + /* Index49 -14.7dB */ {0x0A, 0x0A, 0x08, 0x07, 0x05, 0x03, 0x01, 0x01}, + /* Index50 -15 dB */ {0x0A, 0x09, 0x08, 0x07, 0x05, 0x03, 0x01, 0x01}, + /* Index51 -15.3dB */ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, + /* Index52 -15.6dB */ {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, + /* Index53 -15.9dB */ {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} +}; +u8 cck_swing_table_ch14_92e[CCK_TABLE_SIZE_92E][8] = { + /* Index0 0 dB */ {0x36, 0x34, 0x2E, 0x26, 0x00, 0x00, 0x00, 0x00}, + /* Index1 -0.3dB */ {0x34, 0x32, 0x2C, 0x25, 0x00, 0x00, 0x00, 0x00}, + /* Index2 -0.6dB */ {0x32, 0x30, 0x2B, 0x23, 0x00, 0x00, 0x00, 0x00}, + /* Index3 -0.9dB */ {0x31, 0x2F, 0x29, 0x22, 0x00, 0x00, 0x00, 0x00}, + /* Index4 -1.2dB */ {0x2F, 0x2D, 0x28, 0x21, 0x00, 0x00, 0x00, 0x00}, + /* Index5 -1.5dB */ {0x2D, 0x2C, 0x27, 0x20, 0x00, 0x00, 0x00, 0x00}, + /* Index6 -1.8dB */ {0x2C, 0x2A, 0x25, 0x1F, 0x00, 0x00, 0x00, 0x00}, + /* Index7 -2.1dB */ {0x2A, 0x29, 0x24, 0x1E, 0x00, 0x00, 0x00, 0x00}, + /* Index8 -2.4dB */ {0x29, 0x27, 0x23, 0x1D, 0x00, 0x00, 0x00, 0x00}, + /* Index9 -2.7dB */ {0x27, 0x26, 0x22, 0x1C, 0x00, 0x00, 0x00, 0x00}, + /* Index10 -3 dB */ {0x26, 0x25, 0x20, 0x1B, 0x00, 0x00, 0x00, 0x00}, + /* Index11 -3.3dB */ {0x25, 0x23, 0x1F, 0x1A, 0x00, 0x00, 0x00, 0x00}, + /* Index12 -3.6dB */ {0x24, 0x22, 0x1E, 0x19, 0x00, 0x00, 0x00, 0x00}, + /* Index13 -3.9dB */ {0x22, 0x21, 0x1D, 0x18, 0x00, 0x00, 0x00, 0x00}, + /* Index14 -4.2dB */ {0x21, 0x20, 0x1C, 0x17, 0x00, 0x00, 0x00, 0x00}, + /* Index15 -4.5dB */ {0x20, 0x1F, 0x1B, 0x17, 0x00, 0x00, 0x00, 0x00}, + /* Index16 -4.8dB */ {0x1F, 0x1E, 0x1A, 0x16, 0x00, 0x00, 0x00, 0x00}, + /* Index17 -5.1dB */ {0x1E, 0x1D, 0x1A, 0x15, 0x00, 0x00, 0x00, 0x00}, + /* Index18 -5.4dB */ {0x1D, 0x1C, 0x19, 0x14, 0x00, 0x00, 0x00, 0x00}, + /* Index19 -5.7dB */ {0x1C, 0x1B, 0x18, 0x14, 0x00, 0x00, 0x00, 0x00}, + /* Index20 -6 dB */ {0x1B, 0x1A, 0x17, 0x13, 0x00, 0x00, 0x00, 0x00}, + /* Index21 -6.3dB */ {0x1A, 0x19, 0x16, 0x12, 0x00, 0x00, 0x00, 0x00}, + /* Index22 -6.6dB */ {0x19, 0x18, 0x15, 0x12, 0x00, 0x00, 0x00, 0x00}, + /* Index23 -6.9dB */ {0x18, 0x17, 0x15, 0x11, 0x00, 0x00, 0x00, 0x00}, + /* Index24 -7.2dB */ {0x18, 0x17, 0x14, 0x11, 0x00, 0x00, 0x00, 0x00}, + /* Index25 -7.5dB */ {0x17, 0x16, 0x13, 0x10, 0x00, 0x00, 0x00, 0x00}, + /* Index26 -7.8dB */ {0x16, 0x15, 0x13, 0x0F, 0x00, 0x00, 0x00, 0x00}, + /* Index27 -8.1dB */ {0x15, 0x14, 0x12, 0x0F, 0x00, 0x00, 0x00, 0x00}, + /* Index28 -8.4dB */ {0x14, 0x14, 0x11, 0x0E, 0x00, 0x00, 0x00, 0x00}, + /* Index29 -8.7dB */ {0x14, 0x13, 0x11, 0x0E, 0x00, 0x00, 0x00, 0x00}, + /* Index30 -9 dB */ {0x13, 0x12, 0x10, 0x0D, 0x00, 0x00, 0x00, 0x00}, + /* Index31 -9.3dB */ {0x12, 0x12, 0x0F, 0x0D, 0x00, 0x00, 0x00, 0x00}, + /* Index32 -9.6dB */ {0x12, 0x11, 0x0F, 0x0D, 0x00, 0x00, 0x00, 0x00}, + /* Index33 -9.9dB */ {0x11, 0x11, 0x0F, 0x0C, 0x00, 0x00, 0x00, 0x00}, + /* Index34 -10.2dB */ {0x11, 0x11, 0x0E, 0x0C, 0x00, 0x00, 0x00, 0x00}, + /* Index35 -10.5dB */ {0x10, 0x0F, 0x0E, 0x0B, 0x00, 0x00, 0x00, 0x00}, + /* Index36 -10.8dB */ {0x10, 0x0F, 0x0D, 0x0B, 0x00, 0x00, 0x00, 0x00}, + /* Index37 -11.1dB */ {0x0F, 0x0E, 0x0D, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index38 -11.4dB */ {0x0E, 0x0E, 0x0C, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index39 -11.7dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index40 -12 dB */ {0x0E, 0x0D, 0x0C, 0x0A, 0x00, 0x00, 0x00, 0x00}, + /* Index41 -12.3dB */ {0x0D, 0x0D, 0x0B, 0x09, 0x00, 0x00, 0x00, 0x00}, + /* Index42 -12.6dB */ {0x0D, 0x0C, 0x0B, 0x09, 0x00, 0x00, 0x00, 0x00}, + /* Index43 -12.9dB */ {0x0C, 0x0C, 0x0A, 0x09, 0x00, 0x00, 0x00, 0x00}, + /* Index44 -13.2dB */ {0x0C, 0x0B, 0x0A, 0x08, 0x00, 0x00, 0x00, 0x00}, + /* Index45 -13.5dB */ {0x0B, 0x0B, 0x0A, 0x08, 0x00, 0x00, 0x00, 0x00}, + /* Index46 -13.8dB */ {0x0B, 0x0B, 0x09, 0x08, 0x00, 0x00, 0x00, 0x00}, + /* Index47 -14.1dB */ {0x0B, 0x0A, 0x09, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index48 -14.4dB */ {0x0A, 0x0A, 0x09, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index49 -14.7dB */ {0x0A, 0x0A, 0x08, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index50 -15 dB */ {0x0A, 0x09, 0x08, 0x07, 0x00, 0x00, 0x00, 0x00}, + /* Index51 -15.3dB */ {0x09, 0x09, 0x08, 0x06, 0x00, 0x00, 0x00, 0x00}, + /* Index52 -15.6dB */ {0x09, 0x09, 0x08, 0x06, 0x00, 0x00, 0x00, 0x00}, + /* Index53 -15.9dB */ {0x09, 0x08, 0x07, 0x06, 0x00, 0x00, 0x00, 0x00} +}; +#endif + +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) +u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE] = { + 0x081, /* 0, -12.0dB */ + 0x088, /* 1, -11.5dB */ + 0x090, /* 2, -11.0dB */ + 0x099, /* 3, -10.5dB */ + 0x0A2, /* 4, -10.0dB */ + 0x0AC, /* 5, -9.5dB */ + 0x0B6, /* 6, -9.0dB */ + 0x0C0, /* 7, -8.5dB */ + 0x0CC, /* 8, -8.0dB */ + 0x0D8, /* 9, -7.5dB */ + 0x0E5, /* 10, -7.0dB */ + 0x0F2, /* 11, -6.5dB */ + 0x101, /* 12, -6.0dB */ + 0x110, /* 13, -5.5dB */ + 0x120, /* 14, -5.0dB */ + 0x131, /* 15, -4.5dB */ + 0x143, /* 16, -4.0dB */ + 0x156, /* 17, -3.5dB */ + 0x16A, /* 18, -3.0dB */ + 0x180, /* 19, -2.5dB */ + 0x197, /* 20, -2.0dB */ + 0x1AF, /* 21, -1.5dB */ + 0x1C8, /* 22, -1.0dB */ + 0x1E3, /* 23, -0.5dB */ + 0x200, /* 24, +0 dB */ + 0x21E, /* 25, +0.5dB */ + 0x23E, /* 26, +1.0dB */ + 0x261, /* 27, +1.5dB */ + 0x285, /* 28, +2.0dB */ + 0x2AB, /* 29, +2.5dB */ + 0x2D3, /* 30, +3.0dB */ + 0x2FE, /* 31, +3.5dB */ + 0x32B, /* 32, +4.0dB */ + 0x35C, /* 33, +4.5dB */ + 0x38E, /* 34, +5.0dB */ + 0x3C4, /* 35, +5.5dB */ + 0x3FE /* 36, +6.0dB */ +}; +#elif(ODM_IC_11AC_SERIES_SUPPORT) +u32 ofdm_swing_table_8812[OFDM_TABLE_SIZE_8812] = { + 0x3FE, /* 0, (6dB) */ + 0x3C4, /* 1, (5.5dB) */ + 0x38E, /* 2, (5dB) */ + 0x35C, /* 3, (4.5dB) */ + 0x32B, /* 4, (4dB) */ + 0x2FE, /* 5, (3.5dB) */ + 0x2D3, /* 6, (3dB) */ + 0x2AB, /* 7, (2.5dB) */ + 0x285, /* 8, (2dB) */ + 0x261, /* 9, (1.5dB */ + 0x23E, /* 10, (1dB) */ + 0x21E, /* 11, (0.5dB) */ + 0x200, /* 12, (0dB) 8814 int PA 2G default */ + 0x1E3, /* 13, (-0.5dB) */ + 0x1C8, /* 14, (-1dB) */ + 0x1AF, /* 15, (-1.5dB) */ + 0x197, /* 16, (-2dB) */ + 0x180, /* 17, (-2.5dB) */ + 0x16A, /* 18, (-3dB) 8812 / 8814 int PA 5G / 8814 ext PA 2G5G default */ + 0x156, /* 19, (-3.5dB) */ + 0x143, /* 20, (-4dB) 8812 HP default */ + 0x131, /* 21, (-4.5dB) */ + 0x120, /* 22, (-5dB) */ + 0x110, /* 23, (-5.5dB) */ + 0x101, /* 24, (-6dB) */ + 0x0F2, /* 25, (-6.5dB) */ + 0x0E5, /* 26, (-7dB) */ + 0x0D8, /* 27, (-7.5dB) */ + 0x0CC, /* 28, (-8dB) */ + 0x0C0, /* 29, (-8.5dB) */ + 0x0B6, /* 30, (-9dB) */ + 0x0AC, /* 31, (-9.5dB) */ + 0x0A2, /* 32, (-10dB) */ + 0x099, /* 33, (-10.5dB) */ + 0x090, /* 34, (-11dB) */ + 0x088, /* 35, (-11.5dB) */ + 0x081, /* 36, (-12dB) */ + 0x079, /* 37, (-12.5dB) */ + 0x072, /* 38, (-13dB) */ + 0x06c, /* 39, (-13.5dB) */ + 0x066, /* 40, (-14dB) */ + 0x060, /* 41, (-14.5dB) */ + 0x05B /* 42, (-15dB) */ +}; +#endif + +u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D] = { + 0x0CD, + 0x0D9, + 0x0E6, + 0x0F3, + 0x102, + 0x111, + 0x121, + 0x132, + 0x144, + 0x158, + 0x16C, + 0x182, + 0x198, + 0x1B1, + 0x1CA, + 0x1E5, + 0x202, + 0x221, + 0x241, + 0x263, + 0x287, + 0x2AE, + 0x2D6, + 0x301, + 0x32F, + 0x35F, + 0x392, + 0x3C9, + 0x402, + 0x43F, + 0x47F, + 0x4C3, + 0x50C, + 0x558, + 0x5A9, + 0x5FF, + 0x65A, + 0x6BA, + 0x720, + 0x78C, + 0x7FF, +}; +/* JJ ADD 20161014 */ +u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B] = { + 0x0CD, + 0x0D9, + 0x0E6, + 0x0F3, + 0x102, + 0x111, + 0x121, + 0x132, + 0x144, + 0x158, + 0x16C, + 0x182, + 0x198, + 0x1B1, + 0x1CA, + 0x1E5, + 0x202, + 0x221, + 0x241, + 0x263, + 0x287, + 0x2AE, + 0x2D6, + 0x301, + 0x32F, + 0x35F, + 0x392, + 0x3C9, + 0x402, + 0x43F, + 0x47F, + 0x4C3, + 0x50C, + 0x558, + 0x5A9, + 0x5FF, + 0x65A, + 0x6BA, + 0x720, + 0x78C, + 0x7FF, +}; + + +/* #endif */ +/* 3============================================================ + * 3 Tx Power Tracking + * 3============================================================ */ + +void +odm_txpowertracking_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + if (!(p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_IC_11N_SERIES))) + return; +#endif + + odm_txpowertracking_thermal_meter_init(p_dm); +} + + +u8 +get_swing_index( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0, bb_swing_mask = 0; + u32 bb_swing = 0; + u32 swing_table_size = 0; + u32 *p_swing_table = 0; + struct rtl8192cd_priv *priv = p_dm->priv; + +#if (RTL8197F_SUPPORT == 1) + if (GET_CHIP_VER(priv) == VERSION_8197F) { + bb_swing = phy_query_bb_reg(priv, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKOFDM_D); + p_swing_table = ofdm_swing_table_new; + swing_table_size = OFDM_TABLE_SIZE_92D; + bb_swing_mask = 22; + } +#endif + +#if (RTL8822B_SUPPORT == 1) + if (GET_CHIP_VER(priv) == VERSION_8822B) { + bb_swing = phy_query_bb_reg(priv, REG_A_TX_SCALE_JAGUAR, 0xFFE00000); + p_swing_table = tx_scaling_table_jaguar; + swing_table_size = TXSCALE_TABLE_SIZE; + bb_swing_mask = 0; + } +#endif + + for (i = 0; i < swing_table_size - 1; i++) { + u32 table_value = p_swing_table[i] >> bb_swing_mask; + + if (bb_swing == table_value) + break; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("bb_swing=0x%x bbswing_index=%d\n", bb_swing, i)); + + + return i; +} + + +void +odm_txpowertracking_thermal_meter_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct rtl8192cd_priv *priv = p_dm->priv; + u8 p; + u8 default_swing_index; +#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) + if ((GET_CHIP_VER(priv) == VERSION_8197F) || (GET_CHIP_VER(priv) == VERSION_8822B)) + default_swing_index = get_swing_index(p_dm); +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + p_mgnt_info->is_txpowertracking = true; + p_hal_data->tx_powercount = 0; + p_hal_data->is_txpowertracking_init = false; + + if (*(p_dm->p_mp_mode) == false) + p_hal_data->txpowertrack_control = true; + ODM_RT_TRACE(p_dm, COMP_POWER_TRACKING, DBG_LOUD, ("p_mgnt_info->is_txpowertracking = %d\n", p_mgnt_info->is_txpowertracking)); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +#ifdef CONFIG_RTL8188E + { + p_dm->rf_calibrate_info.is_txpowertracking = true; + p_dm->rf_calibrate_info.tx_powercount = 0; + p_dm->rf_calibrate_info.is_txpowertracking_init = false; + + if (*(p_dm->p_mp_mode) == false) + p_dm->rf_calibrate_info.txpowertrack_control = true; + + MSG_8192C("p_dm txpowertrack_control = %d\n", p_dm->rf_calibrate_info.txpowertrack_control); + } +#else + { + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct dm_priv *pdmpriv = &p_hal_data->dmpriv; + + /* if(IS_HARDWARE_TYPE_8192C(p_hal_data)) */ + { + pdmpriv->is_txpowertracking = true; + pdmpriv->tx_powercount = 0; + pdmpriv->is_txpowertracking_init = false; + + if (*(p_dm->p_mp_mode) == false) /* for mp driver, turn off txpwrtracking as default */ + pdmpriv->txpowertrack_control = true; + + } + MSG_8192C("pdmpriv->txpowertrack_control = %d\n", pdmpriv->txpowertrack_control); + + } +#endif/* endif (CONFIG_RTL8188E==1) */ +#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#ifdef RTL8188E_SUPPORT + { + p_dm->rf_calibrate_info.is_txpowertracking = true; + p_dm->rf_calibrate_info.tx_powercount = 0; + p_dm->rf_calibrate_info.is_txpowertracking_init = false; + p_dm->rf_calibrate_info.txpowertrack_control = true; + p_dm->rf_calibrate_info.tm_trigger = 0; + } +#endif +#endif + + p_dm->rf_calibrate_info.txpowertrack_control = true; + p_dm->rf_calibrate_info.delta_power_index = 0; + p_dm->rf_calibrate_info.delta_power_index_last = 0; + p_dm->rf_calibrate_info.power_index_offset = 0; + p_dm->rf_calibrate_info.thermal_value = 0; + p_rf_calibrate_info->default_ofdm_index = 28; + +#if (RTL8197F_SUPPORT == 1) + if (GET_CHIP_VER(priv) == VERSION_8197F) { + p_rf_calibrate_info->default_ofdm_index = (default_swing_index >= (OFDM_TABLE_SIZE_92D - 1)) ? 30 : default_swing_index; + p_rf_calibrate_info->default_cck_index = 28; + } +#endif + +#if (RTL8822B_SUPPORT == 1) + if (GET_CHIP_VER(priv) == VERSION_8822B) { + p_rf_calibrate_info->default_ofdm_index = (default_swing_index >= (TXSCALE_TABLE_SIZE - 1)) ? 24 : default_swing_index; + p_rf_calibrate_info->default_cck_index = 20; + } +#endif + + +#if RTL8188E_SUPPORT + p_rf_calibrate_info->default_cck_index = 20; /* -6 dB */ +#elif RTL8192E_SUPPORT + p_rf_calibrate_info->default_cck_index = 8; /* -12 dB */ +#endif + p_rf_calibrate_info->bb_swing_idx_ofdm_base = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->default_cck_index; + p_dm->rf_calibrate_info.CCK_index = p_rf_calibrate_info->default_cck_index; + + for (p = 0; p < MAX_RF_PATH; p++) { + p_dm->rf_calibrate_info.OFDM_index[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->bb_swing_idx_ofdm[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->kfree_offset[p] = 0; /* for 8814 kfree*/ + } + p_rf_calibrate_info->bb_swing_idx_cck = p_rf_calibrate_info->default_cck_index; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("p_rf_calibrate_info->default_ofdm_index=%d p_rf_calibrate_info->default_cck_index=%d\n", p_rf_calibrate_info->default_ofdm_index, p_rf_calibrate_info->default_cck_index)); + + +} + + +void +odm_txpowertracking_check( + void *p_dm_void +) +{ + /* */ + /* For AP/ADSL use struct rtl8192cd_priv* */ + /* For CE/NIC use struct _ADAPTER* */ + /* */ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + + if (!(p_rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) + return; + + /* */ + /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate */ + /* at the same time. In the stage2/3, we need to prive universal interface and merge all */ + /* HW dynamic mechanism. */ + /* */ + switch (p_dm->support_platform) { + case ODM_WIN: + odm_txpowertracking_check_mp(p_dm); + break; + + case ODM_CE: + odm_txpowertracking_check_ce(p_dm); + break; + + case ODM_AP: + odm_txpowertracking_check_ap(p_dm); + break; + } + +} + +void +odm_txpowertracking_check_ce( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + +#if (RTL8188E_SUPPORT == 1) + + /* if(!p_mgnt_info->is_txpowertracking || (!pdmpriv->txpowertrack_control && pdmpriv->is_ap_kdone)) */ + + if (!(p_rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) + return; + + if (!p_dm->rf_calibrate_info.tm_trigger) { /* at least delay 1 sec */ + /* p_hal_data->TxPowerCheckCnt++; */ /* cosa add for debug */ + odm_set_rf_reg(p_dm, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); + /* DBG_8192C("Trigger 92C Thermal Meter!!\n"); */ + + p_dm->rf_calibrate_info.tm_trigger = 1; + return; + + } else { + /* DBG_8192C("Schedule TxPowerTracking direct call!!\n"); */ + odm_txpowertracking_callback_thermal_meter_8188e(adapter); + p_dm->rf_calibrate_info.tm_trigger = 0; + } +#endif + +#endif +} + +void +odm_txpowertracking_check_mp( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + + if (odm_check_power_status(adapter) == false) + return; + + if (!adapter->is_slave_of_dmsp || adapter->dual_mac_smart_concurrent == false) + odm_txpowertracking_thermal_meter_check(adapter); +#endif + +} + + +void +odm_txpowertracking_check_ap( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + struct rtl8192cd_priv *priv = p_dm->priv; + +#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) + if (p_dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A | ODM_RTL8197F | ODM_RTL8822B | ODM_RTL8821C)) + odm_txpowertracking_callback_thermal_meter(p_dm); + else +#endif + { + } +#endif + +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.h new file mode 100644 index 000000000000..20d504b072a4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ap.h @@ -0,0 +1,351 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMPOWERTRACKING_H__ +#define __PHYDMPOWERTRACKING_H__ + +#define HALRF_POWRTRACKING_VER "1.1" + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #ifdef RTK_AC_SUPPORT + #define ODM_IC_11AC_SERIES_SUPPORT 1 + #else + #define ODM_IC_11AC_SERIES_SUPPORT 0 + #endif +#else + #define ODM_IC_11AC_SERIES_SUPPORT 1 +#endif + +#define DPK_DELTA_MAPPING_NUM 13 +#define index_mapping_HP_NUM 15 +#define DELTA_SWINGIDX_SIZE 30 +#define DELTA_SWINTSSI_SIZE 61 +#define BAND_NUM 3 +#define MAX_RF_PATH 4 +#define TXSCALE_TABLE_SIZE 37 +#define CCK_TABLE_SIZE_8723D 41 +/* JJ ADD 20161014 */ +#define CCK_TABLE_SIZE_8710B 41 + +#define IQK_MAC_REG_NUM 4 +#define IQK_ADDA_REG_NUM 16 +#define IQK_BB_REG_NUM_MAX 10 + +#define IQK_BB_REG_NUM 9 + +#define HP_THERMAL_NUM 8 + +#define AVG_THERMAL_NUM 8 +#define iqk_matrix_reg_num 8 +/* #define IQK_MATRIX_SETTINGS_NUM 1+24+21 */ +#define IQK_MATRIX_SETTINGS_NUM (14+24+21) /* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ + +#if !defined(_OUTSRC_COEXIST) + #define OFDM_TABLE_SIZE_92D 43 + #define OFDM_TABLE_SIZE 37 + #define CCK_TABLE_SIZE 33 + #define CCK_TABLE_SIZE_88F 21 + + + + /* #define OFDM_TABLE_SIZE_92E 54 */ + /* #define CCK_TABLE_SIZE_92E 54 */ + extern u32 ofdm_swing_table[OFDM_TABLE_SIZE_92D]; + extern u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8]; + extern u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8]; + + + extern u32 ofdm_swing_table_new[OFDM_TABLE_SIZE_92D]; + extern u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8]; + extern u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8]; + extern u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16]; + extern u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16]; + extern u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16]; + +#endif + +#define ODM_OFDM_TABLE_SIZE 37 +#define ODM_CCK_TABLE_SIZE 33 +/* <20140613, YuChen> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. */ +extern u8 delta_swing_table_idx_2ga_p_default[DELTA_SWINGIDX_SIZE]; +extern u8 delta_swing_table_idx_2ga_n_default[DELTA_SWINGIDX_SIZE]; + +static u8 delta_swing_table_idx_2ga_p_8188e[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; +static u8 delta_swing_table_idx_2ga_n_8188e[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; + +/* extern u32 ofdm_swing_table_92e[OFDM_TABLE_SIZE_92E]; + * extern u8 cck_swing_table_ch1_ch13_92e[CCK_TABLE_SIZE_92E][8]; + * extern u8 cck_swing_table_ch14_92e[CCK_TABLE_SIZE_92E][8]; */ + +#ifdef CONFIG_WLAN_HAL_8192EE + #define OFDM_TABLE_SIZE_92E 54 + #define CCK_TABLE_SIZE_92E 54 + extern u32 ofdm_swing_table_92e[OFDM_TABLE_SIZE_92E]; + extern u8 cck_swing_table_ch1_ch13_92e[CCK_TABLE_SIZE_92E][8]; + extern u8 cck_swing_table_ch14_92e[CCK_TABLE_SIZE_92E][8]; +#endif + +#define OFDM_TABLE_SIZE_8812 43 +#define AVG_THERMAL_NUM_8812 4 + +#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + extern u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; + #elif(ODM_IC_11AC_SERIES_SUPPORT) + extern unsigned int ofdm_swing_table_8812[OFDM_TABLE_SIZE_8812]; +#endif + +extern u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D]; +/* JJ ADD 20161014 */ +extern u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B]; + +#define dm_check_txpowertracking odm_txpowertracking_check + +struct _IQK_MATRIX_REGS_SETTING { + boolean is_iqk_done; + s32 value[1][iqk_matrix_reg_num]; +}; + +struct odm_rf_calibration_structure { + /* for tx power tracking */ + + u32 rega24; /* for TempCCK */ + s32 rege94; + s32 rege9c; + s32 regeb4; + s32 regebc; + + /* u8 is_txpowertracking; */ + u8 tx_powercount; + boolean is_txpowertracking_init; + boolean is_txpowertracking; + u8 txpowertrack_control; /* for mp mode, turn off txpwrtracking as default */ + u8 tm_trigger; + u8 internal_pa_5g[2]; /* pathA / pathB */ + + u8 thermal_meter[2]; /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ + u8 thermal_value; + u8 thermal_value_lck; + u8 thermal_value_iqk; + s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ + u8 thermal_value_dpk; + u8 thermal_value_avg[AVG_THERMAL_NUM]; + u8 thermal_value_avg_index; + u8 thermal_value_rx_gain; + u8 thermal_value_crystal; + u8 thermal_value_dpk_store; + u8 thermal_value_dpk_track; + boolean txpowertracking_in_progress; + boolean is_dpk_enable; + + boolean is_reloadtxpowerindex; + u8 is_rf_pi_enable; + u32 txpowertracking_callback_cnt; /* cosa add for debug */ + + u8 is_cck_in_ch14; + u8 CCK_index; + u8 OFDM_index[MAX_RF_PATH]; + s8 power_index_offset; + s8 delta_power_index; + s8 delta_power_index_last; + boolean is_tx_power_changed; + + u8 thermal_value_hp[HP_THERMAL_NUM]; + u8 thermal_value_hp_index; + struct _IQK_MATRIX_REGS_SETTING iqk_matrix_reg_setting[IQK_MATRIX_SETTINGS_NUM]; + u8 delta_lck; + u8 delta_swing_table_idx_2g_cck_a_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_a_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_b_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_b_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_c_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_c_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_d_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_d_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gb_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gb_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gc_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gc_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gd_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gd_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5ga_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5ga_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gb_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gb_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gc_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gc_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gd_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gd_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_tssi_table_2g_cck_a[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_b[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_c[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_d[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2ga[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gb[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gc[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gd[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5ga[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gb[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gc[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gd[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_table_idx_2ga_p_8188e[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_n_8188e[DELTA_SWINGIDX_SIZE]; + + u8 bb_swing_idx_ofdm[MAX_RF_PATH]; + u8 bb_swing_idx_ofdm_current; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; +#else + u8 bb_swing_idx_ofdm_base; +#endif + boolean bb_swing_flag_ofdm; + u8 bb_swing_idx_cck; + u8 bb_swing_idx_cck_current; + u8 bb_swing_idx_cck_base; + u8 default_ofdm_index; + u8 default_cck_index; + boolean bb_swing_flag_cck; + + s8 absolute_ofdm_swing_idx[MAX_RF_PATH]; + s8 remnant_ofdm_swing_idx[MAX_RF_PATH]; + s8 absolute_cck_swing_idx[MAX_RF_PATH]; + s8 remnant_cck_swing_idx; + s8 modify_tx_agc_value; /*Remnat compensate value at tx_agc */ + boolean modify_tx_agc_flag_path_a; + boolean modify_tx_agc_flag_path_b; + boolean modify_tx_agc_flag_path_c; + boolean modify_tx_agc_flag_path_d; + boolean modify_tx_agc_flag_path_a_cck; + + s8 kfree_offset[MAX_RF_PATH]; + + /* -------------------------------------------------------------------- */ + + /* for IQK */ + u32 regc04; + u32 reg874; + u32 regc08; + u32 regb68; + u32 regb6c; + u32 reg870; + u32 reg860; + u32 reg864; + + boolean is_iqk_initialized; + boolean is_lck_in_progress; + boolean is_antenna_detected; + boolean is_need_iqk; + boolean is_iqk_in_progress; + boolean is_iqk_pa_off; + u8 delta_iqk; + u32 ADDA_backup[IQK_ADDA_REG_NUM]; + u32 IQK_MAC_backup[IQK_MAC_REG_NUM]; + u32 IQK_BB_backup_recover[9]; + u32 IQK_BB_backup[IQK_BB_REG_NUM]; + u32 tx_iqc_8723b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ + u32 rx_iqc_8723b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ + u32 tx_iqc_8703b[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ + u32 rx_iqc_8703b[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ + + u64 iqk_start_time; + u64 iqk_total_progressing_time; + u64 iqk_progressing_time; + u64 lck_progressing_time; + u32 lok_result; + u8 iqk_step; + u8 kcount; + u8 retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ + boolean is_mp_mode; + + /* for APK */ + u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ + u8 is_ap_kdone; + u8 is_apk_thermal_meter_ignore; + u8 is_dp_done; + u8 is_dp_path_aok; + u8 is_dp_path_bok; + + /*Add by Yuchen for Kfree Phydm*/ + u8 reg_rf_kfree_enable; /*for registry*/ + u8 rf_kfree_enable; /*for efuse enable check*/ + u32 tx_lok[2]; +}; + +void +odm_txpowertracking_check_ap( + void *p_dm_void +); + +void +odm_txpowertracking_check( + void *p_dm_void +); + + +void +odm_txpowertracking_thermal_meter_init( + void *p_dm_void +); + +void +odm_txpowertracking_init( + void *p_dm_void +); + +void +odm_txpowertracking_check_mp( + void *p_dm_void +); + + +void +odm_txpowertracking_check_ce( + void *p_dm_void +); + + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + +void +odm_txpowertracking_callback_thermal_meter92c( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_callback_rx_gain_thermal_meter92d( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_callback_thermal_meter92d( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_direct_call92c( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_thermal_meter_check( + struct _ADAPTER *adapter +); + +#endif + + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.c new file mode 100644 index 000000000000..cb40caf644cc --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.c @@ -0,0 +1,757 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files */ +/*============================================================ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +/* ************************************************************ + * Global var + * ************************************************************ */ + +u32 ofdm_swing_table[OFDM_TABLE_SIZE] = { + 0x7f8001fe, /* 0, +6.0dB */ + 0x788001e2, /* 1, +5.5dB */ + 0x71c001c7, /* 2, +5.0dB*/ + 0x6b8001ae, /* 3, +4.5dB*/ + 0x65400195, /* 4, +4.0dB*/ + 0x5fc0017f, /* 5, +3.5dB*/ + 0x5a400169, /* 6, +3.0dB*/ + 0x55400155, /* 7, +2.5dB*/ + 0x50800142, /* 8, +2.0dB*/ + 0x4c000130, /* 9, +1.5dB*/ + 0x47c0011f, /* 10, +1.0dB*/ + 0x43c0010f, /* 11, +0.5dB*/ + 0x40000100, /* 12, +0dB*/ + 0x3c8000f2, /* 13, -0.5dB*/ + 0x390000e4, /* 14, -1.0dB*/ + 0x35c000d7, /* 15, -1.5dB*/ + 0x32c000cb, /* 16, -2.0dB*/ + 0x300000c0, /* 17, -2.5dB*/ + 0x2d4000b5, /* 18, -3.0dB*/ + 0x2ac000ab, /* 19, -3.5dB*/ + 0x288000a2, /* 20, -4.0dB*/ + 0x26000098, /* 21, -4.5dB*/ + 0x24000090, /* 22, -5.0dB*/ + 0x22000088, /* 23, -5.5dB*/ + 0x20000080, /* 24, -6.0dB*/ + 0x1e400079, /* 25, -6.5dB*/ + 0x1c800072, /* 26, -7.0dB*/ + 0x1b00006c, /* 27. -7.5dB*/ + 0x19800066, /* 28, -8.0dB*/ + 0x18000060, /* 29, -8.5dB*/ + 0x16c0005b, /* 30, -9.0dB*/ + 0x15800056, /* 31, -9.5dB*/ + 0x14400051, /* 32, -10.0dB*/ + 0x1300004c, /* 33, -10.5dB*/ + 0x12000048, /* 34, -11.0dB*/ + 0x11000044, /* 35, -11.5dB*/ + 0x10000040, /* 36, -12.0dB*/ +}; + +u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8] = { + {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, /* 0, +0dB */ + {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 1, -0.5dB */ + {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 2, -1.0dB*/ + {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 3, -1.5dB*/ + {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 4, -2.0dB */ + {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 5, -2.5dB*/ + {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 6, -3.0dB*/ + {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 7, -3.5dB*/ + {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 8, -4.0dB */ + {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 9, -4.5dB*/ + {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 10, -5.0dB */ + {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 11, -5.5dB*/ + {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 12, -6.0dB <== default */ + {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 13, -6.5dB*/ + {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 14, -7.0dB */ + {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 15, -7.5dB*/ + {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ + {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 17, -8.5dB*/ + {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 18, -9.0dB */ + {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 19, -9.5dB*/ + {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 20, -10.0dB*/ + {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 21, -10.5dB*/ + {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 22, -11.0dB*/ + {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 23, -11.5dB*/ + {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 24, -12.0dB*/ + {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 25, -12.5dB*/ + {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 26, -13.0dB*/ + {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 27, -13.5dB*/ + {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 28, -14.0dB*/ + {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 29, -14.5dB*/ + {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 30, -15.0dB*/ + {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 31, -15.5dB*/ + {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} /* 32, -16.0dB*/ +}; + + +u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8] = { + {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, /* 0, +0dB */ + {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 1, -0.5dB */ + {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 2, -1.0dB */ + {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 3, -1.5dB*/ + {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 4, -2.0dB */ + {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 5, -2.5dB*/ + {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 6, -3.0dB */ + {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 7, -3.5dB */ + {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 8, -4.0dB */ + {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 9, -4.5dB*/ + {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 10, -5.0dB */ + {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 11, -5.5dB*/ + {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 12, -6.0dB <== default*/ + {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 13, -6.5dB */ + {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 14, -7.0dB */ + {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 15, -7.5dB*/ + {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ + {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 17, -8.5dB*/ + {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 18, -9.0dB */ + {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 19, -9.5dB*/ + {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 20, -10.0dB*/ + {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 21, -10.5dB*/ + {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 22, -11.0dB*/ + {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 23, -11.5dB*/ + {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 24, -12.0dB*/ + {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 25, -12.5dB*/ + {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 26, -13.0dB*/ + {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 27, -13.5dB*/ + {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 28, -14.0dB*/ + {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 29, -14.5dB*/ + {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 30, -15.0dB*/ + {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 31, -15.5dB*/ + {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} /* 32, -16.0dB*/ +}; + + +u32 ofdm_swing_table_new[OFDM_TABLE_SIZE] = { + 0x0b40002d, /* 0, -15.0dB */ + 0x0c000030, /* 1, -14.5dB*/ + 0x0cc00033, /* 2, -14.0dB*/ + 0x0d800036, /* 3, -13.5dB*/ + 0x0e400039, /* 4, -13.0dB */ + 0x0f00003c, /* 5, -12.5dB*/ + 0x10000040, /* 6, -12.0dB*/ + 0x11000044, /* 7, -11.5dB*/ + 0x12000048, /* 8, -11.0dB*/ + 0x1300004c, /* 9, -10.5dB*/ + 0x14400051, /* 10, -10.0dB*/ + 0x15800056, /* 11, -9.5dB*/ + 0x16c0005b, /* 12, -9.0dB*/ + 0x18000060, /* 13, -8.5dB*/ + 0x19800066, /* 14, -8.0dB*/ + 0x1b00006c, /* 15, -7.5dB*/ + 0x1c800072, /* 16, -7.0dB*/ + 0x1e400079, /* 17, -6.5dB*/ + 0x20000080, /* 18, -6.0dB*/ + 0x22000088, /* 19, -5.5dB*/ + 0x24000090, /* 20, -5.0dB*/ + 0x26000098, /* 21, -4.5dB*/ + 0x288000a2, /* 22, -4.0dB*/ + 0x2ac000ab, /* 23, -3.5dB*/ + 0x2d4000b5, /* 24, -3.0dB*/ + 0x300000c0, /* 25, -2.5dB*/ + 0x32c000cb, /* 26, -2.0dB*/ + 0x35c000d7, /* 27, -1.5dB*/ + 0x390000e4, /* 28, -1.0dB*/ + 0x3c8000f2, /* 29, -0.5dB*/ + 0x40000100, /* 30, +0dB*/ + 0x43c0010f, /* 31, +0.5dB*/ + 0x47c0011f, /* 32, +1.0dB*/ + 0x4c000130, /* 33, +1.5dB*/ + 0x50800142, /* 34, +2.0dB*/ + 0x55400155, /* 35, +2.5dB*/ + 0x5a400169, /* 36, +3.0dB*/ + 0x5fc0017f, /* 37, +3.5dB*/ + 0x65400195, /* 38, +4.0dB*/ + 0x6b8001ae, /* 39, +4.5dB*/ + 0x71c001c7, /* 40, +5.0dB*/ + 0x788001e2, /* 41, +5.5dB*/ + 0x7f8001fe /* 42, +6.0dB*/ +}; + + +u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16] = { + {0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ + {0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ + {0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ + {0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ + {0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ + {0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ + {0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ + {0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ + {0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ + {0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ + {0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ + {0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ + {0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ + {0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ + {0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ + {0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ + {0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ + {0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ + {0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ + {0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ + {0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ +}; + + +u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16] = { + {0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ + {0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ + {0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ + {0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ + {0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ + {0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ + {0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ + {0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ + {0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ + {0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ + {0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ + {0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ + {0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ + {0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ + {0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ + {0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ + {0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ + {0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ + {0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ + {0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ + {0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ +}; + + +u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16] = { + {0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ + {0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ + {0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ + {0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ + {0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ + {0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ + {0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ + {0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ + {0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ + {0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ + {0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ + {0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ + {0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ + {0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ + {0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ + {0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ + {0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ + {0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ + {0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ + {0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ + {0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ +}; + + +u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB*/ + {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB*/ + {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB*/ + {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB*/ + {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB*/ + {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB*/ + {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB*/ + {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB*/ + {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB*/ + {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB*/ + {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB*/ + {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB*/ + {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB*/ + {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB*/ + {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB*/ + {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB*/ + {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB*/ + {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /*20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB*/ + {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB*/ + {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB*/ + {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB*/ + {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB*/ + {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB*/ + {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB*/ + {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB*/ + {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB*/ +}; + + +u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB*/ + {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB*/ + {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB*/ + {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB*/ + {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB*/ + {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*5, -13.5dB*/ + {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB*/ + {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB*/ + {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB*/ + {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB*/ + {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB*/ + {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /*11, -10.5dB*/ + {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB*/ + {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB*/ + {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB*/ + {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB*/ + {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ + {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB*/ + {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /*23, -4.5dB*/ + {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ + {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ + {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /*27, -2.5dB*/ + {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /*29, -1.5dB*/ + {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ + {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ + {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ +}; +u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D] = { + 0x0CD, /*0 , -20dB*/ + 0x0D9, + 0x0E6, + 0x0F3, + 0x102, + 0x111, + 0x121, + 0x132, + 0x144, + 0x158, + 0x16C, + 0x182, + 0x198, + 0x1B1, + 0x1CA, + 0x1E5, + 0x202, + 0x221, + 0x241, + 0x263, + 0x287, + 0x2AE, + 0x2D6, + 0x301, + 0x32F, + 0x35F, + 0x392, + 0x3C9, + 0x402, + 0x43F, + 0x47F, + 0x4C3, + 0x50C, + 0x558, + 0x5A9, + 0x5FF, + 0x65A, + 0x6BA, + 0x720, + 0x78C, + 0x7FF, +}; +/* JJ ADD 20161014 */ +u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B] = { + 0x0CD, /*0 , -20dB*/ + 0x0D9, + 0x0E6, + 0x0F3, + 0x102, + 0x111, + 0x121, + 0x132, + 0x144, + 0x158, + 0x16C, + 0x182, + 0x198, + 0x1B1, + 0x1CA, + 0x1E5, + 0x202, + 0x221, + 0x241, + 0x263, + 0x287, + 0x2AE, + 0x2D6, + 0x301, + 0x32F, + 0x35F, + 0x392, + 0x3C9, + 0x402, + 0x43F, + 0x47F, + 0x4C3, + 0x50C, + 0x558, + 0x5A9, + 0x5FF, + 0x65A, + 0x6BA, + 0x720, + 0x78C, + 0x7FF, +}; + + +u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE] = { + 0x081, /* 0, -12.0dB*/ + 0x088, /* 1, -11.5dB*/ + 0x090, /* 2, -11.0dB*/ + 0x099, /* 3, -10.5dB*/ + 0x0A2, /* 4, -10.0dB*/ + 0x0AC, /* 5, -9.5dB*/ + 0x0B6, /* 6, -9.0dB*/ + 0x0C0, /*7, -8.5dB*/ + 0x0CC, /* 8, -8.0dB*/ + 0x0D8, /* 9, -7.5dB*/ + 0x0E5, /* 10, -7.0dB*/ + 0x0F2, /* 11, -6.5dB*/ + 0x101, /* 12, -6.0dB*/ + 0x110, /* 13, -5.5dB*/ + 0x120, /* 14, -5.0dB*/ + 0x131, /* 15, -4.5dB*/ + 0x143, /* 16, -4.0dB*/ + 0x156, /* 17, -3.5dB*/ + 0x16A, /* 18, -3.0dB*/ + 0x180, /* 19, -2.5dB*/ + 0x197, /* 20, -2.0dB*/ + 0x1AF, /* 21, -1.5dB*/ + 0x1C8, /* 22, -1.0dB*/ + 0x1E3, /* 23, -0.5dB*/ + 0x200, /* 24, +0 dB*/ + 0x21E, /* 25, +0.5dB*/ + 0x23E, /* 26, +1.0dB*/ + 0x261, /* 27, +1.5dB*/ + 0x285,/* 28, +2.0dB*/ + 0x2AB, /* 29, +2.5dB*/ + 0x2D3, /*30, +3.0dB*/ + 0x2FE, /* 31, +3.5dB*/ + 0x32B, /* 32, +4.0dB*/ + 0x35C, /* 33, +4.5dB*/ + 0x38E, /* 34, +5.0dB*/ + 0x3C4, /* 35, +5.5dB*/ + 0x3FE /* 36, +6.0dB */ +}; + +void +odm_txpowertracking_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + if (!(p_dm->support_ic_type & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) + return; +#endif + + odm_txpowertracking_thermal_meter_init(p_dm); +} + +u8 +get_swing_index( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); +#endif + u8 i = 0; + u32 bb_swing; + u32 swing_table_size; + u32 *p_swing_table; + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8723B + || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8188F || p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8710B + ) { + bb_swing = odm_get_bb_reg(p_dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0xFFC00000); + + p_swing_table = ofdm_swing_table_new; + swing_table_size = OFDM_TABLE_SIZE; + } else { +#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + if (p_dm->support_ic_type == ODM_RTL8812 || p_dm->support_ic_type == ODM_RTL8821) { + bb_swing = phy_get_tx_bb_swing_8812a(adapter, p_hal_data->current_band_type, RF_PATH_A); + p_swing_table = tx_scaling_table_jaguar; + swing_table_size = TXSCALE_TABLE_SIZE; + } else +#endif + { + bb_swing = 0; + p_swing_table = ofdm_swing_table; + swing_table_size = OFDM_TABLE_SIZE; + } + } + + for (i = 0; i < swing_table_size; ++i) { + u32 table_value = p_swing_table[i]; + + if (table_value >= 0x100000) + table_value >>= 22; + if (bb_swing == table_value) + break; + } + return i; +} + +u8 +get_cck_swing_index( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + u8 i = 0; + u32 bb_cck_swing; + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8723B || + p_dm->support_ic_type == ODM_RTL8192E) { + bb_cck_swing = odm_read_1byte(p_dm, 0xa22); + + for (i = 0; i < CCK_TABLE_SIZE; i++) { + if (bb_cck_swing == cck_swing_table_ch1_ch13_new[i][0]) + break; + } + } else if (p_dm->support_ic_type == ODM_RTL8703B) { + bb_cck_swing = odm_read_1byte(p_dm, 0xa22); + + for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { + if (bb_cck_swing == cck_swing_table_ch1_ch14_88f[i][0]) + break; + } + } + + return i; +} + + +void +odm_txpowertracking_thermal_meter_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 default_swing_index = get_swing_index(p_dm); + u8 default_cck_swing_index = get_cck_swing_index(p_dm); + u8 p = 0; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + if (*(p_dm->p_mp_mode) == false) + p_hal_data->txpowertrack_control = true; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +#ifdef DM_ODM_CE_MAC80211 + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + struct rtl_efuse *rtlefu = rtl_efuse(rtlpriv); +#else + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); +#endif + + p_rf_calibrate_info->is_txpowertracking = true; + p_rf_calibrate_info->tx_powercount = 0; + p_rf_calibrate_info->is_txpowertracking_init = false; + + if (*(p_dm->p_mp_mode) == false) + p_rf_calibrate_info->txpowertrack_control = true; + else + p_rf_calibrate_info->txpowertrack_control = false; + + if (*(p_dm->p_mp_mode) == false) + p_rf_calibrate_info->txpowertrack_control = true; + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("p_dm txpowertrack_control = %d\n", p_rf_calibrate_info->txpowertrack_control)); + +#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#ifdef RTL8188E_SUPPORT + { + p_rf_calibrate_info->is_txpowertracking = true; + p_rf_calibrate_info->tx_powercount = 0; + p_rf_calibrate_info->is_txpowertracking_init = false; + p_rf_calibrate_info->txpowertrack_control = true; + } +#endif +#endif + + /* p_dm->rf_calibrate_info.txpowertrack_control = true; */ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + p_rf_calibrate_info->thermal_value = rtlefu->eeprom_thermalmeter; + p_rf_calibrate_info->thermal_value_iqk = rtlefu->eeprom_thermalmeter; + p_rf_calibrate_info->thermal_value_lck = rtlefu->eeprom_thermalmeter; +#else + p_rf_calibrate_info->thermal_value = p_hal_data->eeprom_thermal_meter; + p_rf_calibrate_info->thermal_value_iqk = p_hal_data->eeprom_thermal_meter; + p_rf_calibrate_info->thermal_value_lck = p_hal_data->eeprom_thermal_meter; +#endif + + if (p_rf_calibrate_info->default_bb_swing_index_flag != true) { + /*The index of "0 dB" in SwingTable.*/ + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8723B || + p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8703B) { + p_rf_calibrate_info->default_ofdm_index = (default_swing_index >= OFDM_TABLE_SIZE) ? 30 : default_swing_index; + p_rf_calibrate_info->default_cck_index = (default_cck_swing_index >= CCK_TABLE_SIZE) ? 20 : default_cck_swing_index; + } else if (p_dm->support_ic_type == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ + p_rf_calibrate_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + p_rf_calibrate_info->default_cck_index = 20; /*CCK:-6dB*/ + } else if (p_dm->support_ic_type == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ + p_rf_calibrate_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + p_rf_calibrate_info->default_cck_index = 28; /*CCK: -6dB*/ + } else if (p_dm->support_ic_type == ODM_RTL8710B) { /* JJ ADD 20161014 */ + p_rf_calibrate_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + p_rf_calibrate_info->default_cck_index = 28; /*CCK: -6dB*/ + } else { + p_rf_calibrate_info->default_ofdm_index = (default_swing_index >= TXSCALE_TABLE_SIZE) ? 24 : default_swing_index; + p_rf_calibrate_info->default_cck_index = 24; + } + p_rf_calibrate_info->default_bb_swing_index_flag = true; + } + + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->default_cck_index; + p_rf_calibrate_info->CCK_index = p_rf_calibrate_info->default_cck_index; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->OFDM_index[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->delta_power_index[p] = 0; + p_rf_calibrate_info->delta_power_index_last[p] = 0; + p_rf_calibrate_info->power_index_offset[p] = 0; + } + p_rf_calibrate_info->modify_tx_agc_value_ofdm = 0; + p_rf_calibrate_info->modify_tx_agc_value_cck = 0; + +} + + +void +odm_txpowertracking_check( + void *p_dm_void +) +{ + /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate + at the same time. In the stage2/3, we need to prive universal interface and merge all + HW dynamic mechanism. */ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + switch (p_dm->support_platform) { + case ODM_WIN: + odm_txpowertracking_check_mp(p_dm); + break; + + case ODM_CE: + odm_txpowertracking_check_ce(p_dm); + break; + + case ODM_AP: + odm_txpowertracking_check_ap(p_dm); + break; + + default: + break; + } + +} + +void +odm_txpowertracking_check_ce( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + + + if (!(p_rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) + return; + + if (!p_dm->rf_calibrate_info.tm_trigger) { + + if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_8188F(adapter) || IS_HARDWARE_TYPE_8192E(adapter) + || IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_JAGUAR(adapter) || IS_HARDWARE_TYPE_8814A(adapter) + || IS_HARDWARE_TYPE_8703B(adapter) || IS_HARDWARE_TYPE_8723D(adapter) || IS_HARDWARE_TYPE_8822B(adapter) + || IS_HARDWARE_TYPE_8821C(adapter) || (p_dm->support_ic_type == ODM_RTL8710B) + )/* JJ ADD 20161014 */ + odm_set_rf_reg(p_dm, RF_PATH_A, RF_T_METER_NEW, (BIT(17) | BIT(16)), 0x03); + else + odm_set_rf_reg(p_dm, RF_PATH_A, RF_T_METER_OLD, RFREGOFFSETMASK, 0x60); + + + + p_dm->rf_calibrate_info.tm_trigger = 1; + return; + } else { + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + odm_txpowertracking_callback_thermal_meter(p_dm); +#else + odm_txpowertracking_callback_thermal_meter(adapter); +#endif + p_dm->rf_calibrate_info.tm_trigger = 0; + } + +#endif +} + +void +odm_txpowertracking_check_mp( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + + if (odm_check_power_status(adapter) == false) { + RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("check_pow_status, return false\n")); + return; + } + + odm_txpowertracking_thermal_meter_check(adapter); +#endif + +} + + +void +odm_txpowertracking_check_ap( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct rtl8192cd_priv *priv = p_dm->priv; + + return; + +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.h new file mode 100644 index 000000000000..18e7eb69e838 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_ce.h @@ -0,0 +1,343 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMPOWERTRACKING_H__ +#define __PHYDMPOWERTRACKING_H__ + +#define HALRF_POWRTRACKING_VER "1.1" + +#define DPK_DELTA_MAPPING_NUM 13 +#define index_mapping_HP_NUM 15 +#define OFDM_TABLE_SIZE 43 +#define CCK_TABLE_SIZE 33 +#define CCK_TABLE_SIZE_88F 21 +#define TXSCALE_TABLE_SIZE 37 +#define CCK_TABLE_SIZE_8723D 41 +/* JJ ADD 20161014 */ +#define CCK_TABLE_SIZE_8710B 41 + +#define TXPWR_TRACK_TABLE_SIZE 30 +#define DELTA_SWINGIDX_SIZE 30 +#define DELTA_SWINTSSI_SIZE 61 +#define BAND_NUM 4 + +#define AVG_THERMAL_NUM 8 +#define HP_THERMAL_NUM 8 +#define IQK_MAC_REG_NUM 4 +#define IQK_ADDA_REG_NUM 16 +#define IQK_BB_REG_NUM_MAX 10 + +#define IQK_BB_REG_NUM 9 + + + +#define iqk_matrix_reg_num 8 +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) +#else +#define IQK_MATRIX_SETTINGS_NUM (14+24+21) /* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ +#endif + +extern u32 ofdm_swing_table[OFDM_TABLE_SIZE]; +extern u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8]; +extern u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8]; + +extern u32 ofdm_swing_table_new[OFDM_TABLE_SIZE]; +extern u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8]; +extern u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8]; +extern u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16]; +extern u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16]; +extern u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16]; +extern u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D]; +/* JJ ADD 20161014 */ +extern u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B]; + +extern u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; + +/* <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. */ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) +#else +static u8 delta_swing_table_idx_2ga_p_8188e[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; +static u8 delta_swing_table_idx_2ga_n_8188e[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; +#endif + +#define dm_check_txpowertracking odm_txpowertracking_check + +struct _IQK_MATRIX_REGS_SETTING { + boolean is_iqk_done; + s32 value[3][iqk_matrix_reg_num]; + boolean is_bw_iqk_result_saved[3]; +}; + +struct odm_rf_calibration_structure { + /* for tx power tracking */ + + u32 rega24; /* for TempCCK */ + s32 rege94; + s32 rege9c; + s32 regeb4; + s32 regebc; + + u8 tx_powercount; + boolean is_txpowertracking_init; + boolean is_txpowertracking; + u8 txpowertrack_control; /* for mp mode, turn off txpwrtracking as default */ + u8 tm_trigger; + u8 internal_pa_5g[2]; /* pathA / pathB */ + + u8 thermal_meter[2]; /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ + u8 thermal_value; + u8 thermal_value_lck; + u8 thermal_value_iqk; + s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ + u8 thermal_value_dpk; + u8 thermal_value_avg[AVG_THERMAL_NUM]; + u8 thermal_value_avg_index; + u8 thermal_value_rx_gain; + u8 thermal_value_crystal; + u8 thermal_value_dpk_store; + u8 thermal_value_dpk_track; + boolean txpowertracking_in_progress; + + boolean is_reloadtxpowerindex; + u8 is_rf_pi_enable; + u32 txpowertracking_callback_cnt; /* cosa add for debug */ + + + /* ------------------------- Tx power Tracking ------------------------- */ + u8 is_cck_in_ch14; + u8 CCK_index; + u8 OFDM_index[MAX_RF_PATH]; + s8 power_index_offset[MAX_RF_PATH]; + s8 delta_power_index[MAX_RF_PATH]; + s8 delta_power_index_last[MAX_RF_PATH]; + boolean is_tx_power_changed; + s8 xtal_offset; + s8 xtal_offset_last; + + u8 thermal_value_hp[HP_THERMAL_NUM]; + u8 thermal_value_hp_index; + struct _IQK_MATRIX_REGS_SETTING iqk_matrix_reg_setting[IQK_MATRIX_SETTINGS_NUM]; + u8 delta_lck; + s8 bb_swing_diff_2g, bb_swing_diff_5g; /* Unit: dB */ + u8 delta_swing_table_idx_2g_cck_a_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_a_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_b_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_b_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_c_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_c_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_d_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_d_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gb_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gb_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gc_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gc_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gd_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gd_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5ga_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5ga_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gb_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gb_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gc_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gc_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gd_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gd_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_tssi_table_2g_cck_a[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_b[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_c[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_d[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2ga[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gb[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gc[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gd[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5ga[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gb[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gc[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gd[BAND_NUM][DELTA_SWINTSSI_SIZE]; + s8 delta_swing_table_xtal_p[DELTA_SWINGIDX_SIZE]; + s8 delta_swing_table_xtal_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_p_8188e[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_n_8188e[DELTA_SWINGIDX_SIZE]; + + u8 bb_swing_idx_ofdm[MAX_RF_PATH]; + u8 bb_swing_idx_ofdm_current; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; +#else + u8 bb_swing_idx_ofdm_base; +#endif + boolean default_bb_swing_index_flag; + boolean bb_swing_flag_ofdm; + u8 bb_swing_idx_cck; + u8 bb_swing_idx_cck_current; + u8 bb_swing_idx_cck_base; + u8 default_ofdm_index; + u8 default_cck_index; + boolean bb_swing_flag_cck; + + s8 absolute_ofdm_swing_idx[MAX_RF_PATH]; + s8 remnant_ofdm_swing_idx[MAX_RF_PATH]; + s8 absolute_cck_swing_idx[MAX_RF_PATH]; + s8 remnant_cck_swing_idx; + s8 modify_tx_agc_value; /*Remnat compensate value at tx_agc */ + boolean modify_tx_agc_flag_path_a; + boolean modify_tx_agc_flag_path_b; + boolean modify_tx_agc_flag_path_c; + boolean modify_tx_agc_flag_path_d; + boolean modify_tx_agc_flag_path_a_cck; + + s8 kfree_offset[MAX_RF_PATH]; + + /* -------------------------------------------------------------------- */ + + /* for IQK */ + u32 regc04; + u32 reg874; + u32 regc08; + u32 regb68; + u32 regb6c; + u32 reg870; + u32 reg860; + u32 reg864; + + boolean is_iqk_initialized; + boolean is_lck_in_progress; + boolean is_antenna_detected; + boolean is_need_iqk; + boolean is_iqk_in_progress; + boolean is_iqk_pa_off; + u8 delta_iqk; + u32 ADDA_backup[IQK_ADDA_REG_NUM]; + u32 IQK_MAC_backup[IQK_MAC_REG_NUM]; + u32 IQK_BB_backup_recover[9]; + u32 IQK_BB_backup[IQK_BB_REG_NUM]; + u32 tx_iqc_8723b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ + u32 rx_iqc_8723b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ + u32 tx_iqc_8703b[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ + u32 rx_iqc_8703b[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ + u32 tx_iqc_8723d[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ + u32 rx_iqc_8723d[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ + /* JJ ADD 20161014 */ + u32 tx_iqc_8710b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ + u32 rx_iqc_8710b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ + + u8 iqk_step; + u8 kcount; + u8 retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ + boolean is_mp_mode; + + + + /* IQK time measurement */ + u64 iqk_start_time; + u64 iqk_progressing_time; + u64 iqk_total_progressing_time; + u64 lck_progressing_time; + + u32 lok_result; + + /* for APK */ + u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ + u8 is_ap_kdone; + u8 is_apk_thermal_meter_ignore; + + /* DPK */ + boolean is_dpk_fail; + u8 is_dp_done; + u8 is_dp_path_aok; + u8 is_dp_path_bok; + + u32 tx_lok[2]; + u32 dpk_tx_agc; + s32 dpk_gain; + u32 dpk_thermal[4]; + s8 modify_tx_agc_value_ofdm; + s8 modify_tx_agc_value_cck; + + /*Add by Yuchen for Kfree Phydm*/ + u8 reg_rf_kfree_enable; /*for registry*/ + u8 rf_kfree_enable; /*for efuse enable check*/ + +}; + + +void +odm_txpowertracking_check( + void *p_dm_void +); + + +void +odm_txpowertracking_init( + void *p_dm_void +); + +void +odm_txpowertracking_check_ap( + void *p_dm_void +); + +void +odm_txpowertracking_thermal_meter_init( + void *p_dm_void +); + +void +odm_txpowertracking_init( + void *p_dm_void +); + +void +odm_txpowertracking_check_mp( + void *p_dm_void +); + + +void +odm_txpowertracking_check_ce( + void *p_dm_void +); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + +void +odm_txpowertracking_callback_thermal_meter92c( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_callback_rx_gain_thermal_meter92d( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_callback_thermal_meter92d( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_direct_call92c( + struct _ADAPTER *adapter +); + +void +odm_txpowertracking_thermal_meter_check( + struct _ADAPTER *adapter +); + +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.c new file mode 100644 index 000000000000..c89d446c790d --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.c @@ -0,0 +1,806 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files */ +/*============================================================ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +/* ************************************************************ + * Global var + * ************************************************************ */ + +u32 ofdm_swing_table[OFDM_TABLE_SIZE] = { + 0x7f8001fe, /* 0, +6.0dB */ + 0x788001e2, /* 1, +5.5dB */ + 0x71c001c7, /* 2, +5.0dB */ + 0x6b8001ae, /* 3, +4.5dB */ + 0x65400195, /* 4, +4.0dB */ + 0x5fc0017f, /* 5, +3.5dB */ + 0x5a400169, /* 6, +3.0dB */ + 0x55400155, /* 7, +2.5dB */ + 0x50800142, /* 8, +2.0dB */ + 0x4c000130, /* 9, +1.5dB */ + 0x47c0011f, /* 10, +1.0dB */ + 0x43c0010f, /* 11, +0.5dB */ + 0x40000100, /* 12, +0dB */ + 0x3c8000f2, /* 13, -0.5dB */ + 0x390000e4, /* 14, -1.0dB */ + 0x35c000d7, /* 15, -1.5dB */ + 0x32c000cb, /* 16, -2.0dB */ + 0x300000c0, /* 17, -2.5dB */ + 0x2d4000b5, /* 18, -3.0dB */ + 0x2ac000ab, /* 19, -3.5dB */ + 0x288000a2, /* 20, -4.0dB */ + 0x26000098, /* 21, -4.5dB */ + 0x24000090, /* 22, -5.0dB */ + 0x22000088, /* 23, -5.5dB */ + 0x20000080, /* 24, -6.0dB */ + 0x1e400079, /* 25, -6.5dB */ + 0x1c800072, /* 26, -7.0dB */ + 0x1b00006c, /* 27. -7.5dB */ + 0x19800066, /* 28, -8.0dB */ + 0x18000060, /* 29, -8.5dB */ + 0x16c0005b, /* 30, -9.0dB */ + 0x15800056, /* 31, -9.5dB */ + 0x14400051, /* 32, -10.0dB */ + 0x1300004c, /* 33, -10.5dB */ + 0x12000048, /* 34, -11.0dB */ + 0x11000044, /* 35, -11.5dB */ + 0x10000040, /* 36, -12.0dB */ +}; + +u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8] = { + {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, /* 0, +0dB */ + {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 1, -0.5dB */ + {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 2, -1.0dB */ + {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 3, -1.5dB */ + {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 4, -2.0dB */ + {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 5, -2.5dB */ + {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 6, -3.0dB */ + {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 7, -3.5dB */ + {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 8, -4.0dB */ + {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 9, -4.5dB */ + {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 10, -5.0dB */ + {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 11, -5.5dB */ + {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 12, -6.0dB <== default */ + {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 13, -6.5dB */ + {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 14, -7.0dB */ + {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 15, -7.5dB */ + {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ + {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 17, -8.5dB */ + {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 18, -9.0dB */ + {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 19, -9.5dB */ + {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 20, -10.0dB */ + {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 21, -10.5dB */ + {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 22, -11.0dB */ + {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 23, -11.5dB */ + {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 24, -12.0dB */ + {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 25, -12.5dB */ + {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 26, -13.0dB */ + {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 27, -13.5dB */ + {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 28, -14.0dB */ + {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 29, -14.5dB */ + {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 30, -15.0dB */ + {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 31, -15.5dB */ + {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} /* 32, -16.0dB */ +}; + + +u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8] = { + {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, /* 0, +0dB */ + {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 1, -0.5dB */ + {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 2, -1.0dB */ + {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 3, -1.5dB */ + {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 4, -2.0dB */ + {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 5, -2.5dB */ + {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 6, -3.0dB */ + {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 7, -3.5dB */ + {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 8, -4.0dB */ + {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 9, -4.5dB */ + {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 10, -5.0dB */ + {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 11, -5.5dB */ + {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 12, -6.0dB <== default */ + {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 13, -6.5dB */ + {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 14, -7.0dB */ + {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 15, -7.5dB */ + {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ + {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 17, -8.5dB */ + {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 18, -9.0dB */ + {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 19, -9.5dB */ + {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 20, -10.0dB */ + {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 21, -10.5dB */ + {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 22, -11.0dB */ + {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 23, -11.5dB */ + {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 24, -12.0dB */ + {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 25, -12.5dB */ + {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 26, -13.0dB */ + {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 27, -13.5dB */ + {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 28, -14.0dB */ + {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 29, -14.5dB */ + {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 30, -15.0dB */ + {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 31, -15.5dB */ + {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} /* 32, -16.0dB */ +}; + + +u32 ofdm_swing_table_new[OFDM_TABLE_SIZE] = { + 0x0b40002d, /* 0, -15.0dB */ + 0x0c000030, /* 1, -14.5dB */ + 0x0cc00033, /* 2, -14.0dB */ + 0x0d800036, /* 3, -13.5dB */ + 0x0e400039, /* 4, -13.0dB */ + 0x0f00003c, /* 5, -12.5dB */ + 0x10000040, /* 6, -12.0dB */ + 0x11000044, /* 7, -11.5dB */ + 0x12000048, /* 8, -11.0dB */ + 0x1300004c, /* 9, -10.5dB */ + 0x14400051, /* 10, -10.0dB */ + 0x15800056, /* 11, -9.5dB */ + 0x16c0005b, /* 12, -9.0dB */ + 0x18000060, /* 13, -8.5dB */ + 0x19800066, /* 14, -8.0dB */ + 0x1b00006c, /* 15, -7.5dB */ + 0x1c800072, /* 16, -7.0dB */ + 0x1e400079, /* 17, -6.5dB */ + 0x20000080, /* 18, -6.0dB */ + 0x22000088, /* 19, -5.5dB */ + 0x24000090, /* 20, -5.0dB */ + 0x26000098, /* 21, -4.5dB */ + 0x288000a2, /* 22, -4.0dB */ + 0x2ac000ab, /* 23, -3.5dB */ + 0x2d4000b5, /* 24, -3.0dB */ + 0x300000c0, /* 25, -2.5dB */ + 0x32c000cb, /* 26, -2.0dB */ + 0x35c000d7, /* 27, -1.5dB */ + 0x390000e4, /* 28, -1.0dB */ + 0x3c8000f2, /* 29, -0.5dB */ + 0x40000100, /* 30, +0dB */ + 0x43c0010f, /* 31, +0.5dB */ + 0x47c0011f, /* 32, +1.0dB */ + 0x4c000130, /* 33, +1.5dB */ + 0x50800142, /* 34, +2.0dB */ + 0x55400155, /* 35, +2.5dB */ + 0x5a400169, /* 36, +3.0dB */ + 0x5fc0017f, /* 37, +3.5dB */ + 0x65400195, /* 38, +4.0dB */ + 0x6b8001ae, /* 39, +4.5dB */ + 0x71c001c7, /* 40, +5.0dB */ + 0x788001e2, /* 41, +5.5dB */ + 0x7f8001fe /* 42, +6.0dB */ +}; + + +u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16] = { + {0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ + {0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ + {0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ + {0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ + {0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ + {0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ + {0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ + {0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ + {0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ + {0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ + {0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ + {0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ + {0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ + {0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ + {0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ + {0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ + {0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ + {0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ + {0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ + {0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ + {0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ +}; + + +u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16] = { + {0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ + {0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ + {0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ + {0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ + {0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ + {0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ + {0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ + {0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ + {0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ + {0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ + {0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ + {0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ + {0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ + {0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ + {0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ + {0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ + {0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ + {0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ + {0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ + {0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ + {0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ +}; + + +u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16] = { + {0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ + {0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ + {0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ + {0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ + {0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ + {0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ + {0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ + {0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ + {0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ + {0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ + {0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ + {0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ + {0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ + {0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ + {0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ + {0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ + {0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ + {0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ + {0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ + {0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ + {0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ +}; + + +u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB */ + {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB */ + {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB */ + {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB */ + {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB */ + {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB */ + {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB */ + {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB */ + {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB */ + {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB */ + {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB */ + {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB */ + {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB */ + {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB */ + {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB */ + {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB */ + {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB */ + {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB */ + {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB */ + {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB */ + {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB */ + {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB */ + {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB */ + {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB */ + {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB */ + {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB */ +}; + + +u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8] = { + {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB */ + {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB */ + {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB */ + {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB */ + {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB */ + {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 5, -13.5dB */ + {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB */ + {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB */ + {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB */ + {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB */ + {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB */ + {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 11, -10.5dB */ + {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB */ + {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB */ + {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 14, -9.0dB */ + {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB */ + {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ + {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB */ + {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ + {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ + {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ + {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB */ + {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ + {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 23, -4.5dB */ + {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ + {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ + {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ + {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 27, -2.5dB */ + {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ + {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 29, -1.5dB */ + {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ + {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ + {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ +}; +u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D] = { + 0x0CD, + 0x0D9, + 0x0E6, + 0x0F3, + 0x102, + 0x111, + 0x121, + 0x132, + 0x144, + 0x158, + 0x16C, + 0x182, + 0x198, + 0x1B1, + 0x1CA, + 0x1E5, + 0x202, + 0x221, + 0x241, + 0x263, + 0x287, + 0x2AE, + 0x2D6, + 0x301, + 0x32F, + 0x35F, + 0x392, + 0x3C9, + 0x402, + 0x43F, + 0x47F, + 0x4C3, + 0x50C, + 0x558, + 0x5A9, + 0x5FF, + 0x65A, + 0x6BA, + 0x720, + 0x78C, + 0x7FF, +}; +/* JJ ADD 20161014 */ +u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B] = { + 0x0CD, /*0 , -20dB*/ + 0x0D9, + 0x0E6, + 0x0F3, + 0x102, + 0x111, + 0x121, + 0x132, + 0x144, + 0x158, + 0x16C, + 0x182, + 0x198, + 0x1B1, + 0x1CA, + 0x1E5, + 0x202, + 0x221, + 0x241, + 0x263, /*19*/ + 0x287, /*20*/ + 0x2AE, /*21*/ + 0x2D6, /*22*/ + 0x301, /*23*/ + 0x32F, /*24*/ + 0x35F, /*25*/ + 0x392, /*26*/ + 0x3C9, /*27*/ + 0x402, /*28*/ + 0x43F, /*29*/ + 0x47F, /*30*/ + 0x4C3, /*31*/ + 0x50C, /*32*/ + 0x558, /*33*/ + 0x5A9, /*34*/ + 0x5FF, /*35*/ + 0x65A, /*36*/ + 0x6BA, + 0x720, + 0x78C, + 0x7FF, +}; + + +u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE] = { + 0x081, /* 0, -12.0dB */ + 0x088, /* 1, -11.5dB */ + 0x090, /* 2, -11.0dB */ + 0x099, /* 3, -10.5dB */ + 0x0A2, /* 4, -10.0dB */ + 0x0AC, /* 5, -9.5dB */ + 0x0B6, /* 6, -9.0dB */ + 0x0C0, /* 7, -8.5dB */ + 0x0CC, /* 8, -8.0dB */ + 0x0D8, /* 9, -7.5dB */ + 0x0E5, /* 10, -7.0dB */ + 0x0F2, /* 11, -6.5dB */ + 0x101, /* 12, -6.0dB */ + 0x110, /* 13, -5.5dB */ + 0x120, /* 14, -5.0dB */ + 0x131, /* 15, -4.5dB */ + 0x143, /* 16, -4.0dB */ + 0x156, /* 17, -3.5dB */ + 0x16A, /* 18, -3.0dB */ + 0x180, /* 19, -2.5dB */ + 0x197, /* 20, -2.0dB */ + 0x1AF, /* 21, -1.5dB */ + 0x1C8, /* 22, -1.0dB */ + 0x1E3, /* 23, -0.5dB */ + 0x200, /* 24, +0 dB */ + 0x21E, /* 25, +0.5dB */ + 0x23E, /* 26, +1.0dB */ + 0x261, /* 27, +1.5dB */ + 0x285, /* 28, +2.0dB */ + 0x2AB, /* 29, +2.5dB */ + 0x2D3, /* 30, +3.0dB */ + 0x2FE, /* 31, +3.5dB */ + 0x32B, /* 32, +4.0dB */ + 0x35C, /* 33, +4.5dB */ + 0x38E, /* 34, +5.0dB */ + 0x3C4, /* 35, +5.5dB */ + 0x3FE /* 36, +6.0dB */ +}; + +void +odm_txpowertracking_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + if (!(p_dm->support_ic_type & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) + return; +#endif + + odm_txpowertracking_thermal_meter_init(p_dm); +} + +u8 +get_swing_index( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + u8 i = 0; + u32 bb_swing; + u32 swing_table_size; + u32 *p_swing_table; + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8723B || + p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8188F || p_dm->support_ic_type == ODM_RTL8703B || p_dm->support_ic_type == ODM_RTL8723D || p_dm->support_ic_type == ODM_RTL8710B) { + bb_swing = odm_get_bb_reg(p_dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0xFFC00000); + + p_swing_table = ofdm_swing_table_new; + swing_table_size = OFDM_TABLE_SIZE; + } else { + bb_swing = PHY_GetTxBBSwing_8812A(adapter, p_hal_data->CurrentBandType, RF_PATH_A); + p_swing_table = tx_scaling_table_jaguar; + swing_table_size = TXSCALE_TABLE_SIZE; + } + + for (i = 0; i < swing_table_size; ++i) { + u32 table_value = p_swing_table[i]; + + if (table_value >= 0x100000) + table_value >>= 22; + if (bb_swing == table_value) + break; + } + return i; +} + +u8 +get_cck_swing_index( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + u8 i = 0; + u32 bb_cck_swing; + + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8723B || + p_dm->support_ic_type == ODM_RTL8192E) { + bb_cck_swing = odm_read_1byte(p_dm, 0xa22); + + for (i = 0; i < CCK_TABLE_SIZE; i++) { + if (bb_cck_swing == cck_swing_table_ch1_ch13_new[i][0]) + break; + } + } else if (p_dm->support_ic_type == ODM_RTL8703B) { + bb_cck_swing = odm_read_1byte(p_dm, 0xa22); + + for (i = 0; i < CCK_TABLE_SIZE_88F; i++) { + if (bb_cck_swing == cck_swing_table_ch1_ch14_88f[i][0]) + break; + } + } + + return i; +} + + +void +odm_txpowertracking_thermal_meter_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 default_swing_index = get_swing_index(p_dm); + u8 default_cck_swing_index = get_cck_swing_index(p_dm); + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + u8 p = 0; + + if (*(p_dm->p_mp_mode) == false) + p_rf_calibrate_info->txpowertrack_control = true; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +#ifdef CONFIG_RTL8188E + { + p_rf_calibrate_info->is_txpowertracking = true; + p_rf_calibrate_info->tx_powercount = 0; + p_rf_calibrate_info->is_txpowertracking_init = false; + + if (*(p_dm->p_mp_mode) == false) + p_rf_calibrate_info->txpowertrack_control = true; + + MSG_8192C("p_dm txpowertrack_control = %d\n", p_rf_calibrate_info->txpowertrack_control); + } +#else + { + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct dm_priv *pdmpriv = &p_hal_data->dmpriv; + + pdmpriv->is_txpowertracking = true; + pdmpriv->tx_powercount = 0; + pdmpriv->is_txpowertracking_init = false; + + if (*(p_dm->p_mp_mode) == false) + pdmpriv->txpowertrack_control = true; + + MSG_8192C("pdmpriv->txpowertrack_control = %d\n", pdmpriv->txpowertrack_control); + + } +#endif +#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#ifdef RTL8188E_SUPPORT + { + p_rf_calibrate_info->is_txpowertracking = true; + p_rf_calibrate_info->tx_powercount = 0; + p_rf_calibrate_info->is_txpowertracking_init = false; + p_rf_calibrate_info->txpowertrack_control = true; + } +#endif +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if (MP_DRIVER == 1) + p_rf_calibrate_info->txpowertrack_control = false; +#else + p_rf_calibrate_info->txpowertrack_control = true; +#endif +#else + p_rf_calibrate_info->txpowertrack_control = true; +#endif + + p_rf_calibrate_info->thermal_value = p_hal_data->eeprom_thermal_meter; + p_rf_calibrate_info->thermal_value_iqk = p_hal_data->eeprom_thermal_meter; + p_rf_calibrate_info->thermal_value_lck = p_hal_data->eeprom_thermal_meter; + + if (p_rf_calibrate_info->default_bb_swing_index_flag != true) { + /*The index of "0 dB" in SwingTable.*/ + if (p_dm->support_ic_type == ODM_RTL8188E || p_dm->support_ic_type == ODM_RTL8723B || + p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type == ODM_RTL8703B) { + p_rf_calibrate_info->default_ofdm_index = (default_swing_index >= OFDM_TABLE_SIZE) ? 30 : default_swing_index; + p_rf_calibrate_info->default_cck_index = (default_cck_swing_index >= CCK_TABLE_SIZE) ? 20 : default_cck_swing_index; + } else if (p_dm->support_ic_type == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ + p_rf_calibrate_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + p_rf_calibrate_info->default_cck_index = 20; /*CCK:-6dB*/ + } else if (p_dm->support_ic_type == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ + p_rf_calibrate_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + p_rf_calibrate_info->default_cck_index = 28; /*CCK: -6dB*/ + /* JJ ADD 20161014 */ + } else if (p_dm->support_ic_type == ODM_RTL8710B) { + p_rf_calibrate_info->default_ofdm_index = 28; /*OFDM: -1dB*/ + p_rf_calibrate_info->default_cck_index = 28; /*CCK: -6dB*/ + } else { + p_rf_calibrate_info->default_ofdm_index = (default_swing_index >= TXSCALE_TABLE_SIZE) ? 24 : default_swing_index; + p_rf_calibrate_info->default_cck_index = 24; + } + p_rf_calibrate_info->default_bb_swing_index_flag = true; + } + + p_rf_calibrate_info->bb_swing_idx_cck_base = p_rf_calibrate_info->default_cck_index; + p_rf_calibrate_info->CCK_index = p_rf_calibrate_info->default_cck_index; + + for (p = RF_PATH_A; p < MAX_RF_PATH; ++p) { + p_rf_calibrate_info->bb_swing_idx_ofdm_base[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->OFDM_index[p] = p_rf_calibrate_info->default_ofdm_index; + p_rf_calibrate_info->delta_power_index[p] = 0; + p_rf_calibrate_info->delta_power_index_last[p] = 0; + p_rf_calibrate_info->power_index_offset[p] = 0; + p_rf_calibrate_info->kfree_offset[p] = 0; + } + p_rf_calibrate_info->modify_tx_agc_value_ofdm = 0; + p_rf_calibrate_info->modify_tx_agc_value_cck = 0; + +} + + +void +odm_txpowertracking_check( + void *p_dm_void +) +{ + +#if 0 + /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate */ + /* at the same time. In the stage2/3, we need to prive universal interface and merge all */ + /* HW dynamic mechanism. */ +#endif + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + switch (p_dm->support_platform) { + case ODM_WIN: + odm_txpowertracking_check_mp(p_dm); + break; + + case ODM_CE: + odm_txpowertracking_check_ce(p_dm); + break; + + case ODM_AP: + odm_txpowertracking_check_ap(p_dm); + break; + + default: + break; + } + +} + +void +odm_txpowertracking_check_ce( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; +#if ((RTL8188F_SUPPORT == 1)) + rtl8192c_odm_check_txpowertracking(adapter); +#endif + +#if (RTL8188E_SUPPORT == 1) + + if (!(p_rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) + return; + + if (!p_rf_calibrate_info->tm_trigger) { + odm_set_rf_reg(p_dm, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); + /*DBG_8192C("Trigger 92C Thermal Meter!!\n");*/ + + p_rf_calibrate_info->tm_trigger = 1; + return; + + } else { + /*DBG_8192C("Schedule TxPowerTracking direct call!!\n");*/ + odm_txpowertracking_callback_thermal_meter_8188e(adapter); + p_rf_calibrate_info->tm_trigger = 0; + } +#endif +#endif +} + +void +odm_txpowertracking_check_mp( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + + if (*p_dm->p_is_fcs_mode_enable) + return; + + if (odm_check_power_status(p_dm) == false) { + RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("check_pow_status return false\n")); + return; + } + + if (IS_HARDWARE_TYPE_8821B(adapter)) /* TODO: Don't Do PowerTracking*/ + return; + + odm_txpowertracking_thermal_meter_check(adapter); + + +#endif + +} + + +void +odm_txpowertracking_check_ap( + void *p_dm_void +) +{ + return; + +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +odm_txpowertracking_direct_call( + struct _ADAPTER *adapter +) +{ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + odm_txpowertracking_callback_thermal_meter(adapter); +} + +void +odm_txpowertracking_thermal_meter_check( + struct _ADAPTER *adapter +) +{ + static u8 tm_trigger = 0; + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &(pHalData->DM_OutSrc); + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + + if (!(p_rf->rf_supportability & HAL_RF_TX_PWR_TRACK)) { + RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, + ("===>odm_txpowertracking_thermal_meter_check(),p_mgnt_info->is_txpowertracking is false, return!!\n")); + return; + } + + if (!tm_trigger) { + if (IS_HARDWARE_TYPE_8188E(adapter) || IS_HARDWARE_TYPE_JAGUAR(adapter) || IS_HARDWARE_TYPE_8192E(adapter) || + IS_HARDWARE_TYPE_8723B(adapter) || IS_HARDWARE_TYPE_8814A(adapter) || IS_HARDWARE_TYPE_8188F(adapter) || IS_HARDWARE_TYPE_8703B(adapter) + || IS_HARDWARE_TYPE_8822B(adapter) || IS_HARDWARE_TYPE_8723D(adapter) || IS_HARDWARE_TYPE_8821C(adapter) || IS_HARDWARE_TYPE_8710B(adapter))/* JJ ADD 20161014 */ + PHY_SetRFReg(adapter, RF_PATH_A, RF_T_METER_88E, BIT(17) | BIT(16), 0x03); + else + PHY_SetRFReg(adapter, RF_PATH_A, RF_T_METER, RFREGOFFSETMASK, 0x60); + + RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("Trigger Thermal Meter!!\n")); + + tm_trigger = 1; + return; + } else { + RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("Schedule TxPowerTracking direct call!!\n")); + odm_txpowertracking_direct_call(adapter); + tm_trigger = 0; + } +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.h new file mode 100644 index 000000000000..89816b19049a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_powertracking_win.h @@ -0,0 +1,306 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMPOWERTRACKING_H__ +#define __PHYDMPOWERTRACKING_H__ + +#define HALRF_POWRTRACKING_VER "1.1" + +#define DPK_DELTA_MAPPING_NUM 13 +#define index_mapping_HP_NUM 15 +#define TXSCALE_TABLE_SIZE 37 +#define OFDM_TABLE_SIZE 43 +#define CCK_TABLE_SIZE 33 +#define CCK_TABLE_SIZE_8723D 41 +#define TXPWR_TRACK_TABLE_SIZE 30 +#define DELTA_SWINGIDX_SIZE 30 +#define DELTA_SWINTSSI_SIZE 61 +#define BAND_NUM 3 +#define MAX_RF_PATH 4 +#define CCK_TABLE_SIZE_88F 21 +/* JJ ADD 20161014 */ +#define CCK_TABLE_SIZE_8710B 41 + + +#define dm_check_txpowertracking odm_txpowertracking_check + +#define IQK_MATRIX_SETTINGS_NUM (14+24+21) /* Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G */ +#define AVG_THERMAL_NUM 8 +#define HP_THERMAL_NUM 8 +#define iqk_matrix_reg_num 8 +#define IQK_MAC_REG_NUM 4 +#define IQK_ADDA_REG_NUM 16 + +#define IQK_BB_REG_NUM 9 + + +extern u32 ofdm_swing_table[OFDM_TABLE_SIZE]; +extern u8 cck_swing_table_ch1_ch13[CCK_TABLE_SIZE][8]; +extern u8 cck_swing_table_ch14[CCK_TABLE_SIZE][8]; + +extern u32 ofdm_swing_table_new[OFDM_TABLE_SIZE]; +extern u8 cck_swing_table_ch1_ch13_new[CCK_TABLE_SIZE][8]; +extern u8 cck_swing_table_ch14_new[CCK_TABLE_SIZE][8]; +extern u8 cck_swing_table_ch1_ch14_88f[CCK_TABLE_SIZE_88F][16]; +extern u8 cck_swing_table_ch1_ch13_88f[CCK_TABLE_SIZE_88F][16]; +extern u8 cck_swing_table_ch14_88f[CCK_TABLE_SIZE_88F][16]; +extern u32 cck_swing_table_ch1_ch14_8723d[CCK_TABLE_SIZE_8723D]; +/* JJ ADD 20161014 */ +extern u32 cck_swing_table_ch1_ch14_8710b[CCK_TABLE_SIZE_8710B]; + +extern u32 tx_scaling_table_jaguar[TXSCALE_TABLE_SIZE]; + +/* <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. */ +static u8 delta_swing_table_idx_2ga_p_8188e[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; +static u8 delta_swing_table_idx_2ga_n_8188e[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; + +void +odm_txpowertracking_check( + void *p_dm_void +); + +void +odm_txpowertracking_check_ap( + void *p_dm_void +); + +void +odm_txpowertracking_thermal_meter_init( + void *p_dm_void +); + +void +odm_txpowertracking_init( + void *p_dm_void +); + +void +odm_txpowertracking_check_mp( + void *p_dm_void +); + + +void +odm_txpowertracking_check_ce( + void *p_dm_void +); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + + +void +odm_txpowertracking_thermal_meter_check( + struct _ADAPTER *adapter +); + +#endif + +struct _IQK_MATRIX_REGS_SETTING { + boolean is_iqk_done; + s32 value[3][iqk_matrix_reg_num]; + boolean is_bw_iqk_result_saved[3]; +}; + +struct odm_rf_calibration_structure { + /* for tx power tracking */ + + u32 rega24; /* for TempCCK */ + s32 rege94; + s32 rege9c; + s32 regeb4; + s32 regebc; + /* u8 is_txpowertracking; */ + u8 tx_powercount; + boolean is_txpowertracking_init; + boolean is_txpowertracking; + u8 txpowertrack_control; /* for mp mode, turn off txpwrtracking as default */ + u8 tm_trigger; + u8 internal_pa_5g[2]; /* pathA / pathB */ + + u8 thermal_meter[2]; /* thermal_meter, index 0 for RFIC0, and 1 for RFIC1 */ + u8 thermal_value; + u8 thermal_value_lck; + u8 thermal_value_iqk; + u8 thermal_value_dpk; + s8 thermal_value_delta; /* delta of thermal_value and efuse thermal */ + u8 thermal_value_avg[AVG_THERMAL_NUM]; + u8 thermal_value_avg_index; + u8 thermal_value_rx_gain; + + + boolean is_reloadtxpowerindex; + u8 is_rf_pi_enable; + u32 txpowertracking_callback_cnt; /* cosa add for debug */ + + + /* ------------------------- Tx power Tracking ------------------------- */ + u8 is_cck_in_ch14; + u8 CCK_index; + u8 OFDM_index[MAX_RF_PATH]; + s8 power_index_offset[MAX_RF_PATH]; + s8 delta_power_index[MAX_RF_PATH]; + s8 delta_power_index_last[MAX_RF_PATH]; + boolean is_tx_power_changed; + s8 xtal_offset; + s8 xtal_offset_last; + + u8 thermal_value_hp[HP_THERMAL_NUM]; + u8 thermal_value_hp_index; + struct _IQK_MATRIX_REGS_SETTING iqk_matrix_reg_setting[IQK_MATRIX_SETTINGS_NUM]; + u8 delta_lck; + s8 bb_swing_diff_2g, bb_swing_diff_5g; /* Unit: dB */ + u8 delta_swing_table_idx_2g_cck_a_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_a_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_b_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_b_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_c_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_c_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_d_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2g_cck_d_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gb_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gb_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gc_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gc_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gd_p[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2gd_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5ga_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5ga_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gb_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gb_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gc_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gc_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gd_p[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_5gd_n[BAND_NUM][DELTA_SWINGIDX_SIZE]; + u8 delta_swing_tssi_table_2g_cck_a[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_b[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_c[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2g_cck_d[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2ga[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gb[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gc[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_2gd[DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5ga[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gb[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gc[BAND_NUM][DELTA_SWINTSSI_SIZE]; + u8 delta_swing_tssi_table_5gd[BAND_NUM][DELTA_SWINTSSI_SIZE]; + s8 delta_swing_table_xtal_p[DELTA_SWINGIDX_SIZE]; + s8 delta_swing_table_xtal_n[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_p_8188e[DELTA_SWINGIDX_SIZE]; + u8 delta_swing_table_idx_2ga_n_8188e[DELTA_SWINGIDX_SIZE]; + + u8 bb_swing_idx_ofdm[MAX_RF_PATH]; + u8 bb_swing_idx_ofdm_current; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + u8 bb_swing_idx_ofdm_base[MAX_RF_PATH]; +#else + u8 bb_swing_idx_ofdm_base; +#endif + boolean default_bb_swing_index_flag; + boolean bb_swing_flag_ofdm; + u8 bb_swing_idx_cck; + u8 bb_swing_idx_cck_current; + u8 bb_swing_idx_cck_base; + u8 default_ofdm_index; + u8 default_cck_index; + boolean bb_swing_flag_cck; + + s8 absolute_ofdm_swing_idx[MAX_RF_PATH]; + s8 remnant_ofdm_swing_idx[MAX_RF_PATH]; + s8 absolute_cck_swing_idx[MAX_RF_PATH]; + s8 remnant_cck_swing_idx; + s8 modify_tx_agc_value; /*Remnat compensate value at tx_agc */ + boolean modify_tx_agc_flag_path_a; + boolean modify_tx_agc_flag_path_b; + boolean modify_tx_agc_flag_path_c; + boolean modify_tx_agc_flag_path_d; + boolean modify_tx_agc_flag_path_a_cck; + + s8 kfree_offset[MAX_RF_PATH]; + + /* -------------------------------------------------------------------- */ + + /* for IQK */ + u32 regc04; + u32 reg874; + u32 regc08; + u32 regb68; + u32 regb6c; + u32 reg870; + u32 reg860; + u32 reg864; + + boolean is_iqk_initialized; + boolean is_lck_in_progress; + boolean is_antenna_detected; + boolean is_need_iqk; + boolean is_iqk_in_progress; + boolean is_iqk_pa_off; + u8 delta_iqk; + u32 ADDA_backup[IQK_ADDA_REG_NUM]; + u32 IQK_MAC_backup[IQK_MAC_REG_NUM]; + u32 IQK_BB_backup_recover[9]; + u32 IQK_BB_backup[IQK_BB_REG_NUM]; + u32 tx_iqc_8723b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ + u32 rx_iqc_8723b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ + u32 tx_iqc_8703b[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ + u32 rx_iqc_8703b[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ + u32 tx_iqc_8723d[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ + u32 rx_iqc_8723d[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ + /* JJ ADD 20161014 */ + u32 tx_iqc_8710b[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ + u32 rx_iqc_8710b[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ + + u64 iqk_start_time; + u64 iqk_total_progressing_time; + u64 iqk_progressing_time; + u64 lck_progressing_time; + u32 lok_result; + u8 iqk_step; + u8 kcount; + u8 retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ + boolean is_mp_mode; + + /* for APK */ + u32 ap_koutput[2][2]; /* path A/B; output1_1a/output1_2a */ + u8 is_ap_kdone; + u8 is_apk_thermal_meter_ignore; + + /* DPK */ + boolean is_dpk_fail; + u8 is_dp_done; + u8 is_dp_path_aok; + u8 is_dp_path_bok; + + u32 tx_lok[2]; + u32 dpk_tx_agc; + s32 dpk_gain; + u32 dpk_thermal[4]; + + s8 modify_tx_agc_value_ofdm; + s8 modify_tx_agc_value_cck; + + /*Add by Yuchen for Kfree Phydm*/ + u8 reg_rf_kfree_enable; /*for registry*/ + u8 rf_kfree_enable; /*for efuse enable check*/ + + HALMAC_PWR_TRACKING_OPTION HALMAC_PWR_TRACKING_INFO; +}; + + + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.c new file mode 100644 index 000000000000..3ab8189c496e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.c @@ -0,0 +1,291 @@ +#include "mp_precomp.h" +#include "phydm_precomp.h" + + + +void odm_bub_sort(pu4Byte data, u4Byte n) +{ + int i, j, temp, sp; + + for (i = n - 1;i >= 0;i--) { + sp = 1; + for (j = 0;j < i;j++) { + if (data[j] < data[j + 1]) { + temp = data[j]; + data[j] = data[j + 1]; + data[j + 1] = temp; + sp = 0; + } + } + if (sp == 1) + break; + } +} + + +#if (RTL8197F_SUPPORT == 1) + +u4Byte +odm_tx_gain_gap_psd_8197f( + void *p_dm_void, + u1Byte rf_path, + u4Byte rf56 +) +{ + PDM_ODM_T p_dm_odm = (PDM_ODM_T)p_dm_void; + + u1Byte i, j; + u4Byte psd_vaule[5], psd_avg_time = 5, psd_vaule_temp; + + u4Byte iqk_ctl_addr[2][6] = {{0xe30, 0xe34, 0xe50, 0xe54, 0xe38, 0xe3c}, + {0xe50, 0xe54, 0xe30, 0xe34, 0xe58, 0xe5c}}; + + u4Byte psd_finish_bit[2] = {0x04000000, 0x20000000}; + u4Byte psd_fail_bit[2] = {0x08000000, 0x40000000}; + + u4Byte psd_cntl_value[2][2] = {{0x38008c1c, 0x10008c1c}, + {0x38008c2c, 0x10008c2c}}; + + u4Byte psd_report_addr[2] = {0xea0, 0xec0}; + + odm_set_rf_reg(p_dm_odm, rf_path, 0xdf, bRFRegOffsetMask, 0x00e02); + + ODM_delay_us(100); + + odm_set_bb_reg(p_dm_odm, 0xe28, 0xffffffff, 0x0); + + odm_set_rf_reg(p_dm_odm, rf_path, 0x56, 0xfff, rf56); + while(rf56 != (odm_get_rf_reg(p_dm_odm, rf_path, 0x56, 0xfff))) + odm_set_rf_reg(p_dm_odm, rf_path, 0x56, 0xfff, rf56); + + odm_set_bb_reg(p_dm_odm, 0xd94, 0xffffffff, 0x44FFBB44); + odm_set_bb_reg(p_dm_odm, 0xe70, 0xffffffff, 0x00400040); + odm_set_bb_reg(p_dm_odm, 0xc04, 0xffffffff, 0x6f005403); + odm_set_bb_reg(p_dm_odm, 0xc08, 0xffffffff, 0x000804e4); + odm_set_bb_reg(p_dm_odm, 0x874, 0xffffffff, 0x04203400); + odm_set_bb_reg(p_dm_odm, 0xe28, 0xffffffff, 0x80800000); + + odm_set_bb_reg(p_dm_odm, iqk_ctl_addr[rf_path][0], 0xffffffff, psd_cntl_value[rf_path][0]); + odm_set_bb_reg(p_dm_odm, iqk_ctl_addr[rf_path][1], 0xffffffff, psd_cntl_value[rf_path][1]); + odm_set_bb_reg(p_dm_odm, iqk_ctl_addr[rf_path][2], 0xffffffff, psd_cntl_value[rf_path][0]); + odm_set_bb_reg(p_dm_odm, iqk_ctl_addr[rf_path][3], 0xffffffff, psd_cntl_value[rf_path][0]); + odm_set_bb_reg(p_dm_odm, iqk_ctl_addr[rf_path][4], 0xffffffff, 0x8215001F); + odm_set_bb_reg(p_dm_odm, iqk_ctl_addr[rf_path][5], 0xffffffff, 0x2805001F); + + odm_set_bb_reg(p_dm_odm, 0xe40, 0xffffffff, 0x81007C00); + odm_set_bb_reg(p_dm_odm, 0xe44, 0xffffffff, 0x81004800); + odm_set_bb_reg(p_dm_odm, 0xe4c, 0xffffffff, 0x0046a8d0); + + + for (i = 0; i < psd_avg_time; i++) { + + for(j = 0; j < 1000 ; j++) { + odm_set_bb_reg(p_dm_odm, 0xe48, 0xffffffff, 0xfa005800); + odm_set_bb_reg(p_dm_odm, 0xe48, 0xffffffff, 0xf8005800); + + while(!odm_get_bb_reg(p_dm_odm, 0xeac, psd_finish_bit[rf_path])); /*wait finish bit*/ + + if (!odm_get_bb_reg(p_dm_odm, 0xeac, psd_fail_bit[rf_path])) { /*check fail bit*/ + + psd_vaule[i] = odm_get_bb_reg(p_dm_odm, psd_report_addr[rf_path], 0xffffffff); + + if (psd_vaule[i] > 0xffff) + break; + } + } + + + + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] rf0=0x%x rf56=0x%x rf56_reg=0x%x time=%d psd_vaule=0x%x\n", + odm_get_rf_reg(p_dm_odm, rf_path, 0x0, 0xff), + rf56, odm_get_rf_reg(p_dm_odm, rf_path, 0x56, 0xfff), j, psd_vaule[i])); + } + + odm_bub_sort(psd_vaule, psd_avg_time); + + psd_vaule_temp = psd_vaule[(UINT)(psd_avg_time / 2)]; + + odm_set_bb_reg(p_dm_odm, 0xd94, 0xffffffff, 0x44BBBB44); + odm_set_bb_reg(p_dm_odm, 0xe70, 0xffffffff, 0x80408040); + odm_set_bb_reg(p_dm_odm, 0xc04, 0xffffffff, 0x6f005433); + odm_set_bb_reg(p_dm_odm, 0xc08, 0xffffffff, 0x000004e4); + odm_set_bb_reg(p_dm_odm, 0x874, 0xffffffff, 0x04003400); + odm_set_bb_reg(p_dm_odm, 0xe28, 0xffffffff, 0x00000000); + + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] rf0=0x%x rf56=0x%x rf56_reg=0x%x psd_vaule_temp=0x%x\n", + odm_get_rf_reg(p_dm_odm, rf_path, 0x0, 0xff), + rf56, odm_get_rf_reg(p_dm_odm, rf_path, 0x56, 0xfff), psd_vaule_temp)); + + odm_set_rf_reg(p_dm_odm, rf_path, 0xdf, bRFRegOffsetMask, 0x00602); + + return psd_vaule_temp; + +} + + + +void +odm_tx_gain_gap_calibration_8197f( + void *p_dm_void +) +{ + PDM_ODM_T p_dm_odm = (PDM_ODM_T)p_dm_void; + + u1Byte rf_path, rf0_idx, rf0_idx_current, rf0_idx_next, i, delta_gain_retry = 3; + + s1Byte delta_gain_gap_pre, delta_gain_gap[2][11]; + u4Byte rf56_current, rf56_next, psd_value_current, psd_value_next; + u4Byte psd_gap, rf56_current_temp[2][11]; + s4Byte rf33[2][11]; + + memset(rf33, 0x0, sizeof(rf33)); + + for (rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) { + + if (rf_path == RF_PATH_A) + odm_set_bb_reg(p_dm_odm, 0x88c, (BIT(21) | BIT(20)), 0x3); /*disable 3-wire*/ + else if (rf_path == RF_PATH_B) + odm_set_bb_reg(p_dm_odm, 0x88c, (BIT(23) | BIT(22)), 0x3); /*disable 3-wire*/ + + ODM_delay_us(100); + + for (rf0_idx = 1; rf0_idx <= 10; rf0_idx++) { + + rf0_idx_current = 3 * (rf0_idx - 1) + 1; + odm_set_rf_reg(p_dm_odm, rf_path, 0x0, 0xff, rf0_idx_current); + ODM_delay_us(100); + rf56_current_temp[rf_path][rf0_idx] = odm_get_rf_reg(p_dm_odm, rf_path, 0x56, 0xfff); + rf56_current = rf56_current_temp[rf_path][rf0_idx]; + + rf0_idx_next = 3 * rf0_idx + 1; + odm_set_rf_reg(p_dm_odm, rf_path, 0x0, 0xff, rf0_idx_next); + ODM_delay_us(100); + rf56_next= odm_get_rf_reg(p_dm_odm, rf_path, 0x56, 0xfff); + + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] rf56_current[%d][%d]=0x%x rf56_next[%d][%d]=0x%x\n", + rf_path, rf0_idx, rf56_current, rf_path, rf0_idx, rf56_next)); + + if ((rf56_current >> 5) == (rf56_next >> 5)) { + delta_gain_gap[rf_path][rf0_idx] = 0; + + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] rf56_current[11:5] == rf56_next[%d][%d][11:5]=0x%x delta_gain_gap[%d][%d]=%d\n", + rf_path, rf0_idx, (rf56_next >> 5), rf_path, rf0_idx, delta_gain_gap[rf_path][rf0_idx])); + } else { + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] rf56_current[%d][%d][11:5]=0x%x != rf56_next[%d][%d][11:5]=0x%x\n", + rf_path, rf0_idx, (rf56_current >> 5), rf_path, rf0_idx, (rf56_next >> 5))); + + + for (i = 0; i < delta_gain_retry; i++) { + psd_value_current = odm_tx_gain_gap_psd_8197f(p_dm_odm, rf_path, rf56_current); + + psd_value_next = odm_tx_gain_gap_psd_8197f(p_dm_odm, rf_path, rf56_next - 2); + + psd_gap = psd_value_next / (psd_value_current / 1000); + +#if 0 + if (psd_gap > 1413) + delta_gain_gap[rf_path][rf0_idx] = 1; + else if (psd_gap > 1122) + delta_gain_gap[rf_path][rf0_idx] = 0; + else + delta_gain_gap[rf_path][rf0_idx] = -1; +#endif + + if (psd_gap > 1445) + delta_gain_gap[rf_path][rf0_idx] = 1; + else if (psd_gap > 1096) + delta_gain_gap[rf_path][rf0_idx] = 0; + else + delta_gain_gap[rf_path][rf0_idx] = -1; + + if (i == 0) + delta_gain_gap_pre = delta_gain_gap[rf_path][rf0_idx]; + + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] psd_value_current=0x%x psd_value_next=0x%x psd_value_next/psd_value_current=%d delta_gain_gap[%d][%d]=%d\n", + psd_value_current, psd_value_next, psd_gap, rf_path, rf0_idx, delta_gain_gap[rf_path][rf0_idx])); + + if ((i == 0) && (delta_gain_gap[rf_path][rf0_idx] == 0)) { + break; + } + else { + if (delta_gain_gap_pre != delta_gain_gap[rf_path][rf0_idx]) { + delta_gain_gap[rf_path][rf0_idx] = 0; + + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] delta_gain_gap_pre(%d) != delta_gain_gap[%d][%d](%d) time=%d\n", + delta_gain_gap_pre, rf_path, rf0_idx, delta_gain_gap[rf_path][rf0_idx], i)); + + break; + } else { + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] delta_gain_gap_pre(%d) == delta_gain_gap[%d][%d](%d) time=%d\n", + delta_gain_gap_pre, rf_path, rf0_idx, delta_gain_gap[rf_path][rf0_idx], i)); + } + } + } + + } + + } + + if (rf_path == RF_PATH_A) + odm_set_bb_reg(p_dm_odm, 0x88c, (BIT(21) | BIT(20)), 0x0); /*enable 3-wire*/ + else if (rf_path == RF_PATH_B) + odm_set_bb_reg(p_dm_odm, 0x88c, (BIT(23) | BIT(22)), 0x0); /*enable 3-wire*/ + + ODM_delay_us(100); + + } + + /*odm_set_bb_reg(p_dm_odm, 0x88c, (BIT(23) | BIT(22) | BIT(21) | BIT(20)), 0x0);*/ /*enable 3-wire*/ + + for (rf_path = RF_PATH_A; rf_path <= RF_PATH_B; rf_path++) { + + odm_set_rf_reg(p_dm_odm, rf_path, 0xef, bRFRegOffsetMask, 0x00100); + + for (rf0_idx = 1; rf0_idx <= 10; rf0_idx++) { + + rf33[rf_path][rf0_idx] = rf33[rf_path][rf0_idx] + (rf56_current_temp[rf_path][rf0_idx] & 0x1f); + + for (i = rf0_idx; i <= 10; i++) + rf33[rf_path][rf0_idx] = rf33[rf_path][rf0_idx] + delta_gain_gap[rf_path][i]; + + if (rf33[rf_path][rf0_idx] >= 0x1d) + rf33[rf_path][rf0_idx] = 0x1d; + else if (rf33[rf_path][rf0_idx] <= 0x2) + rf33[rf_path][rf0_idx] = 0x2; + + rf33[rf_path][rf0_idx] = rf33[rf_path][rf0_idx] + ((rf0_idx - 1) * 0x4000) + (rf56_current_temp[rf_path][rf0_idx] & 0xfffe0); + + ODM_RT_TRACE(p_dm_odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, + ("[TGGC] rf56[%d][%d]=0x%05x rf33[%d][%d]=0x%05x\n", rf_path, rf0_idx, rf56_current_temp[rf_path][rf0_idx], rf_path, rf0_idx, rf33[rf_path][rf0_idx])); + + odm_set_rf_reg(p_dm_odm, rf_path, 0x33, bRFRegOffsetMask, rf33[rf_path][rf0_idx]); + } + + odm_set_rf_reg(p_dm_odm, rf_path, 0xef, bRFRegOffsetMask, 0x00000); + } + +} +#endif + + +void +odm_tx_gain_gap_calibration( + void *p_dm_void +) +{ + PDM_ODM_T p_dm_odm = (PDM_ODM_T)p_dm_void; + + #if (RTL8197F_SUPPORT == 1) + if (p_dm_odm->SupportICType & ODM_RTL8197F) + odm_tx_gain_gap_calibration_8197f(p_dm_void); + #endif + +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.h new file mode 100644 index 000000000000..d7016dfdc647 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/halrf_txgapcal.h @@ -0,0 +1,5 @@ +void +odm_tx_gain_gap_calibration( + void *p_dm_void +); + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.c new file mode 100644 index 000000000000..8440ade94eb1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.c @@ -0,0 +1,2511 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #if RT_PLATFORM==PLATFORM_MACOSX + #include "phydm_precomp.h" + #else + #include "../phydm_precomp.h" + #endif +#else +#include "../../phydm_precomp.h" +#endif + + +#if (RTL8723D_SUPPORT == 1) + +/*---------------------------Define Local Constant---------------------------*/ +/*IQK*/ +#define IQK_DELAY_TIME_8723D 10 + +/* 2010/04/25 MH Define the max tx power tracking tx agc power.*/ +#define ODM_TXPWRTRACK_MAX_IDX_8723D 6 + +#define PATH_S1 0 +#define idx_0xc94 0 +#define idx_0xc80 1 +#define idx_0xc4c 2 + +#define idx_0xc14 0 +#define idx_0xca0 1 + + +#define PATH_S0 1 +#define idx_0xcd0 0 +#define idx_0xcd4 1 + +#define idx_0xcd8 0 +#define idx_0xcdc 1 + +#define KEY 0 +#define VAL 1 + + + +/*---------------------------Define Local Constant---------------------------*/ + + +/* Tx Power Tracking*/ + + +void set_iqk_matrix_8723d( + struct PHY_DM_STRUCT *p_dm, + u8 OFDM_index, + u8 rf_path, + s32 iqk_result_x, + s32 iqk_result_y +) +{ + s32 ele_A = 0, ele_D = 0, ele_C = 0, value32; + s32 ele_A_ext = 0, ele_C_ext = 0, ele_D_ext = 0; + + if (OFDM_index >= OFDM_TABLE_SIZE) + OFDM_index = OFDM_TABLE_SIZE - 1; + else if (OFDM_index < 0) + OFDM_index = 0; + + if ((iqk_result_x != 0) && (*(p_dm->p_band_type) == ODM_BAND_2_4G)) { + + /* new element D */ + ele_D = (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22; + ele_D_ext = (((iqk_result_x * ele_D) >> 7) & 0x01); + /* new element A */ + if ((iqk_result_x & 0x00000200) != 0) /* consider minus */ + iqk_result_x = iqk_result_x | 0xFFFFFC00; + ele_A = ((iqk_result_x * ele_D) >> 8) & 0x000003FF; + ele_A_ext = ((iqk_result_x * ele_D) >> 7) & 0x1; + /* new element C */ + if ((iqk_result_y & 0x00000200) != 0) + iqk_result_y = iqk_result_y | 0xFFFFFC00; + ele_C = ((iqk_result_y * ele_D) >> 8) & 0x000003FF; + ele_C_ext = ((iqk_result_y * ele_D) >> 7) & 0x1; + + switch (rf_path) { + case RF_PATH_A: + /* write new elements A, C, D to regC80, regC94, reg0xc4c, and element B is always 0 */ + /* write 0xc80 */ + value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, value32); + /* write 0xc94 */ + value32 = (ele_C & 0x000003C0) >> 6; + odm_set_bb_reg(p_dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, value32); + /* write 0xc4c */ + value32 = (ele_D_ext << 28) | (ele_A_ext << 31) | (ele_C_ext << 29); + value32 = (odm_get_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, MASKDWORD) & (~(BIT(31) | BIT(29) | BIT(28)))) | value32; + odm_set_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, MASKDWORD, value32); + break; + + case RF_PATH_B: + /*wirte new elements A, C, D to regCd0 and regCd4, element B is always 0*/ + value32 = ele_D; + odm_set_bb_reg(p_dm, 0xCd4, 0x007FE000, value32); + + value32 = ele_C; + odm_set_bb_reg(p_dm, 0xCd4, 0x000007FE, value32); + + value32 = ele_A; + odm_set_bb_reg(p_dm, 0xCd0, 0x000007FE, value32); + + odm_set_bb_reg(p_dm, 0xCd4, BIT(12), ele_D_ext); + odm_set_bb_reg(p_dm, 0xCd0, BIT(0), ele_A_ext); + odm_set_bb_reg(p_dm, 0xCd4, BIT(0), ele_C_ext); + break; + default: + break; + } + } else { + switch (rf_path) { + case RF_PATH_A: + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD, ofdm_swing_table_new[OFDM_index]); + odm_set_bb_reg(p_dm, REG_OFDM_0_XC_TX_AFE, MASKH4BITS, 0x00); + value32 = odm_get_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, MASKDWORD) & (~(BIT(31) | BIT(29) | BIT(28))); + odm_set_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, MASKDWORD, value32); + break; + + case RF_PATH_B: + /*image S1:c80 to S0:Cd0 and Cd4*/ + odm_set_bb_reg(p_dm, 0xcd0, 0x000007FE, ofdm_swing_table_new[OFDM_index] & 0x000003FF); + odm_set_bb_reg(p_dm, 0xcd0, 0x0007E000, (ofdm_swing_table_new[OFDM_index] & 0x0000FC00) >> 10); + odm_set_bb_reg(p_dm, 0xcd4, 0x0000007E, (ofdm_swing_table_new[OFDM_index] & 0x003F0000) >> 16); + odm_set_bb_reg(p_dm, 0xcd4, 0x007FE000, (ofdm_swing_table_new[OFDM_index] & 0xFFC00000) >> 22); + + odm_set_bb_reg(p_dm, 0xcd4, 0x00000780, 0x00); + + odm_set_bb_reg(p_dm, 0xcd4, BIT(12), 0x0); + odm_set_bb_reg(p_dm, 0xcd4, BIT(0), 0x0); + odm_set_bb_reg(p_dm, 0xcd0, BIT(0), 0x0); + break; + default: + break; + } + } + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path %c: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x ele_A_ext = 0x%x ele_C_ext = 0x%x ele_D_ext = 0x%x\n", + (rf_path == RF_PATH_A ? 'A' : 'B'), (u32)iqk_result_x, (u32)iqk_result_y, (u32)ele_A, (u32)ele_C, (u32)ele_D, (u32)ele_A_ext, (u32)ele_C_ext, (u32)ele_D_ext)); +} + +void +set_cck_filter_coefficient_8723d( + struct PHY_DM_STRUCT *p_dm, + u8 cck_swing_index +) +{ + odm_set_bb_reg(p_dm, 0xab4, 0x000007FF, cck_swing_table_ch1_ch14_8723d[cck_swing_index]); +} + +void do_iqk_8723d( + void *p_dm_void, + u8 delta_thermal_index, + u8 thermal_value, + u8 threshold +) +{ + u32 is_bt_enable = 0; + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (*(p_dm->p_mp_mode) == false) + is_bt_enable = odm_get_mac_reg(p_dm, 0xa8, MASKDWORD) & BIT(17); + + if (is_bt_enable) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Skip IQK because BT is enable\n")); + return; + } else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Do IQK because BT is disable\n")); + + odm_reset_iqk_result(p_dm); + + p_dm->rf_calibrate_info.thermal_value_iqk = thermal_value; + + halrf_iqk_trigger(p_dm, false); +} + +/*----------------------------------------------------------------------------- + * Function: odm_tx_pwr_track_set_pwr_8723d() + * + * Overview: 8723D change all channel tx power accordign to flag. + * OFDM & CCK are all different. + * + * Input: NONE + * + * Output: NONE + * + * Return: NONE + * + * Revised History: + * When Who Remark + * 04/23/2012 MHC Create version 0. + * + *---------------------------------------------------------------------------*/ +void +odm_tx_pwr_track_set_pwr_8723d( + void *p_dm_void, + enum pwrtrack_method method, + u8 rf_path, + u8 channel_mapped_index +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + //PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + u8 pwr_tracking_limit_ofdm = 30; + u8 pwr_tracking_limit_cck = 40; + u8 tx_rate = 0xFF; + u8 final_ofdm_swing_index = 0; + u8 final_cck_swing_index = 0; + u8 i = 0; + +if (*(p_dm->p_mp_mode) == true) { +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#if (MP_DRIVER == 1) + PMPT_CONTEXT p_mpt_ctx = &(adapter->MptCtx); + + tx_rate = MptToMgntRate(p_mpt_ctx->MptRateIndex); +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +#ifdef CONFIG_MP_INCLUDED + PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); + + tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); +#endif +#endif +#endif + } else { + u16 rate = *(p_dm->p_forced_data_rate); + + if (!rate) { /*auto rate*/ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm->tx_rate); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (p_dm->number_linked_client != 0) + tx_rate = hw_rate_to_m_rate(p_dm->tx_rate); + else + tx_rate = p_rf->p_rate_index; +#endif + } else /*force rate*/ + tx_rate = (u8)rate; + } + + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("===>ODM_TxPwrTrackSetPwr8723DA\n")); + + if (tx_rate != 0xFF) { + /*CCK*/ + if (((tx_rate >= MGN_1M) && (tx_rate <= MGN_5_5M)) || tx_rate == MGN_11M) + pwr_tracking_limit_cck = 40; + /*OFDM*/ + else if ((tx_rate >= MGN_6M) && (tx_rate <= MGN_48M)) + pwr_tracking_limit_ofdm = 36; + else if (tx_rate == MGN_54M) + pwr_tracking_limit_ofdm = 34; + + /* HT*/ + else if ((tx_rate >= MGN_MCS0) && (tx_rate <= MGN_MCS2)) + pwr_tracking_limit_ofdm = 38; + else if ((tx_rate >= MGN_MCS3) && (tx_rate <= MGN_MCS4)) + pwr_tracking_limit_ofdm = 36; + else if ((tx_rate >= MGN_MCS5) && (tx_rate <= MGN_MCS7)) + pwr_tracking_limit_ofdm = 34; + + else if ((tx_rate >= MGN_MCS8) && (tx_rate <= MGN_MCS10)) + pwr_tracking_limit_ofdm = 38; + else if ((tx_rate >= MGN_MCS11) && (tx_rate <= MGN_MCS12)) + pwr_tracking_limit_ofdm = 36; + else if ((tx_rate >= MGN_MCS13) && (tx_rate <= MGN_MCS15)) + pwr_tracking_limit_ofdm = 34; + + else + pwr_tracking_limit_ofdm = p_rf_calibrate_info->default_ofdm_index; /*Default OFDM index = 30 */ + } + + if (method == TXAGC) { + u8 rf = 0; + u32 pwr = 0, tx_agc = 0; + //struct _ADAPTER *adapter = p_dm->adapter; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr_8723D CH=%d\n", *(p_dm->p_channel))); + + p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; /* Remnant index equal to aboslute compensate value. */ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + +#if (MP_DRIVER != 1) +#if 0 + PHY_SetTxPowerLevelByPath8723D(adapter, *p_dm->p_channel, rf_path); /* Using new set power function */ + /* PHY_SetTxPowerLevel8723D(p_dm->adapter, *p_dm->p_channel); */ +#endif + p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; + p_rf_calibrate_info->modify_tx_agc_flag_path_b = true; + p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; + if (rf_path == RF_PATH_A) { + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, CCK); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, HT_MCS0_MCS7); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, HT_MCS8_MCS15); + } else { + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, *p_dm->p_channel, CCK); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, *p_dm->p_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, *p_dm->p_channel, HT_MCS0_MCS7); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, *p_dm->p_channel, HT_MCS8_MCS15); + } +#else + + if (rf_path == RF_PATH_A) { + /*CCK path S1*/ + pwr = odm_get_bb_reg(p_dm, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += p_rf_calibrate_info->power_index_offset[RF_PATH_A]; + odm_set_bb_reg(p_dm, REG_TX_AGC_A_CCK_1_MCS32, MASKBYTE1, pwr); + tx_agc = (pwr << 16) | (pwr << 8) | (pwr); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_CCK_11_A_CCK_2_11, 0x00ffffff, tx_agc); + RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr_8723d: CCK Tx-rf(A) Power = 0x%x\n", tx_agc)); + + /*OFDM path S1*/ + pwr = odm_get_bb_reg(p_dm, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += (p_rf_calibrate_info->bb_swing_idx_ofdm[RF_PATH_A] - p_rf_calibrate_info->bb_swing_idx_ofdm_base[RF_PATH_A]); + tx_agc = ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS11_MCS08, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS15_MCS12, MASKDWORD, tx_agc); + RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr_8723d: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); + } else if (rf_path == RF_PATH_B) { + + pwr = odm_get_bb_reg(p_dm, REG_TX_AGC_B_RATE18_06, 0xFF); + pwr += p_rf_calibrate_info->power_index_offset[RF_PATH_B]; + odm_set_bb_reg(p_dm, REG_TX_AGC_B_CCK_1_55_MCS32, MASKBYTE3, pwr); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_CCK_11_A_CCK_2_11, 0xff000000, pwr); + RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr_8723d: CCK Tx-rf(B) Power = 0x%x\n", pwr)); + + + pwr = odm_get_bb_reg(p_dm, REG_TX_AGC_B_RATE18_06, 0xFF); + pwr += (p_rf_calibrate_info->bb_swing_idx_ofdm[RF_PATH_B] - p_rf_calibrate_info->bb_swing_idx_ofdm_base[RF_PATH_B]); + tx_agc = ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_RATE18_06, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_RATE54_24, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_MCS03_MCS00, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_MCS07_MCS04, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_MCS11_MCS08, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_MCS15_MCS12, MASKDWORD, tx_agc); + RT_DISP(FPHY, PHY_TXPWR, ("odm_tx_pwr_track_set_pwr_8723d: OFDM Tx-rf(B) Power = 0x%x\n", tx_agc)); + } +#endif + +#endif +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + /*phy_rf6052_set_cck_tx_power(p_dm->priv, *(p_dm->p_channel)); + phy_rf6052_set_ofdm_tx_power(p_dm->priv, *(p_dm->p_channel));*/ +#endif + + } else if (method == BBSWING) { + final_ofdm_swing_index = p_rf_calibrate_info->default_ofdm_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; + final_cck_swing_index = p_rf_calibrate_info->default_cck_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + (" p_rf_calibrate_info->default_ofdm_index=%d, p_rf_calibrate_info->DefaultCCKIndex=%d, p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]=%d, p_rf_calibrate_info->remnant_cck_swing_idx=%d rf_path = %d\n", + p_rf_calibrate_info->default_ofdm_index, p_rf_calibrate_info->default_cck_index, p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path], p_rf_calibrate_info->remnant_cck_swing_idx, rf_path)); + + /* Adjust BB swing by OFDM IQ matrix */ + if (final_ofdm_swing_index >= pwr_tracking_limit_ofdm) + final_ofdm_swing_index = pwr_tracking_limit_ofdm; + else if (final_ofdm_swing_index < 0) + final_ofdm_swing_index = 0; + + if (final_cck_swing_index >= CCK_TABLE_SIZE_8723D) + final_cck_swing_index = CCK_TABLE_SIZE_8723D - 1; + else if (p_rf_calibrate_info->bb_swing_idx_cck < 0) + final_cck_swing_index = 0; + + set_iqk_matrix_8723d(p_dm, final_ofdm_swing_index, RF_PATH_A, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + + set_iqk_matrix_8723d(p_dm, final_ofdm_swing_index, RF_PATH_B, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + + set_cck_filter_coefficient_8723d(p_dm, final_cck_swing_index); + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; + + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, CCK); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, HT_MCS0_MCS7); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("final_cck_swing_index=%d\n", final_cck_swing_index)); + + } else if (method == MIX_MODE) { +#if (MP_DRIVER == 1) + u32 tx_agc = 0; /*add by Mingzhi.Guo 2015-04-10*/ + s32 pwr = 0; +#endif + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("p_dm->default_ofdm_index=%d, p_dm->DefaultCCKIndex=%d, p_dm->absolute_ofdm_swing_idx[rf_path]=%d, rf_path = %d\n", + p_rf_calibrate_info->default_ofdm_index, p_rf_calibrate_info->default_cck_index, p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path], rf_path)); + + final_ofdm_swing_index = p_rf_calibrate_info->default_ofdm_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; + + if (rf_path == RF_PATH_A) { + final_cck_swing_index = p_rf_calibrate_info->default_cck_index + p_rf_calibrate_info->absolute_ofdm_swing_idx[rf_path]; /*CCK Follow path-A and lower CCK index means higher power.*/ + + if (final_ofdm_swing_index > pwr_tracking_limit_ofdm) { + p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index - pwr_tracking_limit_ofdm; + + set_iqk_matrix_8723d(p_dm, pwr_tracking_limit_ofdm, RF_PATH_A, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + set_iqk_matrix_8723d(p_dm, pwr_tracking_limit_ofdm, RF_PATH_B, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; + + /*Set tx_agc Page C{};*/ + /*odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, OFDM);*/ + /* odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, HT_MCS0_MCS7);*/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Over BBSwing Limit, pwr_tracking_limit = %d, Remnant tx_agc value = %d\n", pwr_tracking_limit_ofdm, p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path])); + } else if (final_ofdm_swing_index < 0) { + p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index ; + + set_iqk_matrix_8723d(p_dm, 0, RF_PATH_A, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + set_iqk_matrix_8723d(p_dm, 0, RF_PATH_B, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; + + /*Set tx_agc Page C{};*/ + /*odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, OFDM);*/ + /* odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, HT_MCS0_MCS7);*/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Lower then BBSwing lower bound 0, Remnant tx_agc value = %d\n", p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path])); + } else { + set_iqk_matrix_8723d(p_dm, final_ofdm_swing_index, RF_PATH_A, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][0], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][1]); + set_iqk_matrix_8723d(p_dm, final_ofdm_swing_index, RF_PATH_B, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Compensate with BBSwing, final_ofdm_swing_index = %d\n", final_ofdm_swing_index)); + + if (p_rf_calibrate_info->modify_tx_agc_flag_path_a) { + p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = 0; + + /*Set tx_agc Page C{};*/ + /* odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, OFDM ); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, HT_MCS0_MCS7 ); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, HT_MCS8_MCS15 );*/ + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = false; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A p_dm->Modify_TxAGC_Flag = false\n")); + } + } +#if (MP_DRIVER == 1) + if ((*(p_dm->p_mp_mode)) == 1) { + pwr = odm_get_bb_reg(p_dm, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += (p_rf_calibrate_info->remnant_ofdm_swing_idx[RF_PATH_A] - p_rf_calibrate_info->modify_tx_agc_value_ofdm); + + if (pwr > 0x3F) + pwr = 0x3F; + else if (pwr < 0) + pwr = 0; + + tx_agc |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8188F: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); + + } else +#endif + { + + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, HT_MCS0_MCS7); + } + p_rf_calibrate_info->modify_tx_agc_value_ofdm = p_rf_calibrate_info->remnant_ofdm_swing_idx[RF_PATH_A] ; + + if (final_cck_swing_index > pwr_tracking_limit_cck) { + p_rf_calibrate_info->remnant_cck_swing_idx = final_cck_swing_index - pwr_tracking_limit_cck; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Over Limit, pwr_tracking_limit_cck = %d, p_dm->remnant_cck_swing_idx = %d\n", pwr_tracking_limit_cck, p_rf_calibrate_info->remnant_cck_swing_idx)); + + /* Adjust BB swing by CCK filter coefficient*/ + odm_set_bb_reg(p_dm, 0xab4, 0x000007FF, cck_swing_table_ch1_ch14_8723d[pwr_tracking_limit_cck]); + + p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; + + /*Set tx_agc Page C{};*/ + /* odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, CCK); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, CCK);*/ + + } else if (final_cck_swing_index < 0) { + p_rf_calibrate_info->remnant_cck_swing_idx = final_cck_swing_index; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Under Limit, pwr_tracking_limit_cck = %d, p_dm->remnant_cck_swing_idx = %d\n", 0, p_rf_calibrate_info->remnant_cck_swing_idx)); + + odm_set_bb_reg(p_dm, 0xab4, 0x000007FF, cck_swing_table_ch1_ch14_8723d[0]); + + p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = true; + + + /*odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, CCK); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, CCK);*/ + + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Compensate with BBSwing, final_cck_swing_index = %d\n", final_cck_swing_index)); + + odm_set_bb_reg(p_dm, 0xab4, 0x000007FF, cck_swing_table_ch1_ch14_8723d[final_cck_swing_index]); + + /* if (p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck) {*/ + p_rf_calibrate_info->remnant_cck_swing_idx = 0; + + + /*odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, p_hal_data->current_channel, CCK ); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, CCK );*/ + + p_rf_calibrate_info->modify_tx_agc_flag_path_a_cck = false; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A p_dm->Modify_TxAGC_Flag_CCK = false\n")); + } +#if (MP_DRIVER == 1) + if ((*(p_dm->p_mp_mode)) == 1) { + pwr = odm_get_bb_reg(p_dm, REG_TX_AGC_B_CCK_11_A_CCK_2_11, MASKBYTE1); + pwr += p_rf_calibrate_info->remnant_cck_swing_idx - p_rf_calibrate_info->modify_tx_agc_value_cck; + + if (pwr > 0x3F) + pwr = 0x3F; + else if (pwr < 0) + pwr = 0; + + odm_set_bb_reg(p_dm, REG_TX_AGC_A_CCK_1_MCS32, MASKBYTE1, pwr); + tx_agc = (pwr << 16) | (pwr << 8) | (pwr); + odm_set_bb_reg(p_dm, REG_TX_AGC_B_CCK_11_A_CCK_2_11, 0xffffff00, tx_agc); + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: CCK Tx-rf(A) Power = 0x%x\n", tx_agc)); + } else +#endif + + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_A, *p_dm->p_channel, CCK); + + p_rf_calibrate_info->modify_tx_agc_value_cck = p_rf_calibrate_info->remnant_cck_swing_idx; + } +#if 0 + if (rf_path == RF_PATH_B) { + if (final_ofdm_swing_index > pwr_tracking_limit_ofdm) { + p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index - pwr_tracking_limit_ofdm; + + set_iqk_matrix_8723d(p_dm, pwr_tracking_limit_ofdm, RF_PATH_B, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; + + + /*odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, HT_MCS0_MCS7);*/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Over BBSwing Limit, pwr_tracking_limit = %d, Remnant tx_agc value = %d\n", pwr_tracking_limit_ofdm, p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path])); + } else if (final_ofdm_swing_index < 0) { + p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = final_ofdm_swing_index ; + + set_iqk_matrix_8723d(p_dm, 0, RF_PATH_B, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = true; + + + /*odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, HT_MCS0_MCS7);*/ + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Lower then BBSwing lower bound 0, Remnant tx_agc value = %d\n", p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path])); + } else { + set_iqk_matrix_8723d(p_dm, final_ofdm_swing_index, RF_PATH_B, + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][4], + p_rf_calibrate_info->iqk_matrix_reg_setting[channel_mapped_index].value[0][5]); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Compensate with BBSwing, final_ofdm_swing_index = %d\n", final_ofdm_swing_index)); + + if (p_rf_calibrate_info->modify_tx_agc_flag_path_b) { + p_rf_calibrate_info->remnant_ofdm_swing_idx[rf_path] = 0; + + /*odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, p_hal_data->current_channel, HT_MCS0_MCS7);*/ + + p_rf_calibrate_info->modify_tx_agc_flag_path_a = false; + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B p_dm->Modify_TxAGC_Flag = false\n")); + } + } +#if (MP_DRIVER == 1) + if ((*(p_dm->p_mp_mode)) == 1) { + pwr = odm_get_bb_reg(p_dm, REG_TX_AGC_A_RATE18_06, 0xFF); + pwr += (p_rf_calibrate_info->remnant_ofdm_swing_idx[RF_PATH_B] - p_rf_calibrate_info->modify_tx_agc_value_ofdm); + + if (pwr > 0x3F) + pwr = 0x3F; + else if (pwr < 0) + pwr = 0; + + tx_agc |= ((pwr << 24) | (pwr << 16) | (pwr << 8) | pwr); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_RATE18_06, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_RATE54_24, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS03_MCS00, MASKDWORD, tx_agc); + odm_set_bb_reg(p_dm, REG_TX_AGC_A_MCS07_MCS04, MASKDWORD, tx_agc); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: OFDM Tx-rf(A) Power = 0x%x\n", tx_agc)); + + } else +#endif + { + + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, *p_dm->p_channel, OFDM); + odm_set_tx_power_index_by_rate_section(p_dm, RF_PATH_B, *p_dm->p_channel, HT_MCS0_MCS7); + } + p_rf_calibrate_info->modify_tx_agc_value_ofdm = p_rf_calibrate_info->remnant_ofdm_swing_idx[RF_PATH_B] ; + } +#endif + } else + return; +} + +void +get_delta_swing_table_8723d( + void *p_dm_void, + u8 **temperature_up_a, + u8 **temperature_down_a, + u8 **temperature_up_b, + u8 **temperature_down_b +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + struct _hal_rf_ *p_rf = &(p_dm->rf_table); + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + u8 tx_rate = 0xFF; + u8 channel = *p_dm->p_channel; + + if (*(p_dm->p_mp_mode) == true) { +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#if (MP_DRIVER == 1) + PMPT_CONTEXT p_mpt_ctx = &(adapter->MptCtx); + + tx_rate = MptToMgntRate(p_mpt_ctx->MptRateIndex); +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +#ifdef CONFIG_MP_INCLUDED + PMPT_CONTEXT p_mpt_ctx = &(adapter->mppriv.mpt_ctx); + + tx_rate = mpt_to_mgnt_rate(p_mpt_ctx->mpt_rate_index); +#endif +#endif +#endif + } else { + u16 rate = *(p_dm->p_forced_data_rate); + + if (!rate) { /*auto rate*/ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + tx_rate = adapter->HalFunc.GetHwRateFromMRateHandler(p_dm->tx_rate); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + if (p_dm->number_linked_client != 0) + tx_rate = hw_rate_to_m_rate(p_dm->tx_rate); + else + tx_rate = p_rf->p_rate_index; +#endif + } else /*force rate*/ + tx_rate = (u8)rate; + } + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking tx_rate=0x%X\n", tx_rate)); + + if (1 <= channel && channel <= 14) { + if (IS_CCK_RATE(tx_rate)) { + *temperature_up_a = p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p; + *temperature_down_a = p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n; + *temperature_up_b = p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p; + *temperature_down_b = p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n; + } else { + *temperature_up_a = p_rf_calibrate_info->delta_swing_table_idx_2ga_p; + *temperature_down_a = p_rf_calibrate_info->delta_swing_table_idx_2ga_n; + *temperature_up_b = p_rf_calibrate_info->delta_swing_table_idx_2gb_p; + *temperature_down_b = p_rf_calibrate_info->delta_swing_table_idx_2gb_n; + } + } else { + *temperature_up_a = (u8 *)delta_swing_table_idx_2ga_p_8188e; + *temperature_down_a = (u8 *)delta_swing_table_idx_2ga_n_8188e; + *temperature_up_b = (u8 *)delta_swing_table_idx_2ga_p_8188e; + *temperature_down_b = (u8 *)delta_swing_table_idx_2ga_n_8188e; + } + + return; +} + +void +get_delta_swing_xtal_table_8723d( + void *p_dm_void, + s8 **temperature_up_xtal, + s8 **temperature_down_xtal +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + *temperature_up_xtal = p_rf_calibrate_info->delta_swing_table_xtal_p; + *temperature_down_xtal = p_rf_calibrate_info->delta_swing_table_xtal_n; +} + + + +void +odm_txxtaltrack_set_xtal_8723d( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + s8 crystal_cap; + + + crystal_cap = p_hal_data->crystal_cap & 0x3F; + crystal_cap = crystal_cap + p_rf_calibrate_info->xtal_offset; + + if (crystal_cap < 0) + crystal_cap = 0; + else if (crystal_cap > 63) + crystal_cap = 63; + + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("crystal_cap(%d)= p_hal_data->crystal_cap(%d) + p_rf_calibrate_info->xtal_offset(%d)\n", crystal_cap, p_hal_data->crystal_cap, p_rf_calibrate_info->xtal_offset)); + + odm_set_bb_reg(p_dm, REG_MAC_PHY_CTRL, 0xFFF000, (crystal_cap | (crystal_cap << 6))); + + ODM_RT_TRACE(p_dm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, + ("crystal_cap(0x2c) 0x%X\n", odm_get_bb_reg(p_dm, REG_MAC_PHY_CTRL, 0xFFF000))); + +} + +void configure_txpower_track_8723d( + struct _TXPWRTRACK_CFG *p_config +) +{ + p_config->swing_table_size_cck = CCK_TABLE_SIZE_8723D; + p_config->swing_table_size_ofdm = OFDM_TABLE_SIZE; + p_config->threshold_iqk = IQK_THRESHOLD; + p_config->average_thermal_num = AVG_THERMAL_NUM_8723D; + p_config->rf_path_count = MAX_PATH_NUM_8723D; + p_config->thermal_reg_addr = RF_T_METER_88E; + + p_config->odm_tx_pwr_track_set_pwr = odm_tx_pwr_track_set_pwr_8723d; + p_config->do_iqk = do_iqk_8723d; + p_config->phy_lc_calibrate = halrf_lck_trigger; + p_config->get_delta_swing_table = get_delta_swing_table_8723d; + p_config->get_delta_swing_xtal_table = get_delta_swing_xtal_table_8723d; + p_config->odm_txxtaltrack_set_xtal = odm_txxtaltrack_set_xtal_8723d; +} + + +#define MAX_TOLERANCE 5 +#define IQK_DELAY_TIME 1 + +u8 +phy_path_s1_iqk_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean config_path_s0 +) +{ + u32 reg_eac, reg_e94, reg_e9c, path_sel_bb; + u8 result = 0x00, ktime; + u32 original_path, original_gnt; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]path S1 TXIQK!!\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 TXIQK = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); + /*save RF path*/ + path_sel_bb = odm_get_bb_reg(p_dm, 0x948, MASKDWORD); + /*ODM_RT_TRACE(p_dm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 TXIQK = 0x%x\n", platform_efio_read_1byte(p_adapter, 0x1e6)));*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, 0x99000000); + + /*IQK setting*/ + /*leave IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + /* --- \A7\EF\BCgTXIQK mode table ---//*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, RFREGOFFSETMASK, 0x80000); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x33, RFREGOFFSETMASK, 0x00004); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3e, RFREGOFFSETMASK, 0x0005d); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3f, RFREGOFFSETMASK, 0xBFFE0); + + /*path-A IQK setting*/ + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x08008c0c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_TX_IQK_PI_A, MASKDWORD, 0x8214019f); + odm_set_bb_reg(p_dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160200); + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + /*LO calibration setting*/ + odm_set_bb_reg(p_dm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); + + /*PA, PAD setting*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xdf, 0x800, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x56, 0x600, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x56, 0x1E0, 0x3); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x8d, 0x1F, 0xf); + + /*LOK setting added for 8723D*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x10, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x54, 0x1, 0x1); +#if 1 + + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK, 0xe0d); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK, 0x60d); +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 TXIQK = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 TXIQK = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK))); + + /*enter IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + +#if 1 + /*backup path & GNT value */ + original_path = odm_get_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, MASKDWORD); /*save 0x70*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0038); + ODM_delay_ms(1); + original_gnt = odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD); /*save 0x38*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", original_gnt)); + + /*set GNT_WL=1/GNT_BT=1 and path owner to WiFi for pause BT traffic*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, 0x0000ff00); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc0020038); /*0x38[15:8] = 0x77*/ + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, BIT(26), 0x1); +#endif + + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0054); + ODM_delay_ms(1); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 TXIQK = 0x%x\n", odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 TXIQK = 0x%x\n", odm_get_bb_reg(p_dm, 0x948, MASKDWORD))); + + /*One shot, path S1 LOK & IQK*/ + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xfa000000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /* delay x ms */ + /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ + + ktime = 0; + while ((!odm_get_bb_reg(p_dm, 0xeac, BIT(26))) && ktime < 10) { + ODM_delay_ms(1); + ktime++; + } + +#if 1 + /*Restore GNT_WL/GNT_BT and path owner*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, original_gnt); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc00f0038); + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, original_path); +#endif + + /*reload RF path*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, path_sel_bb); + + /*leave IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + /*PA/PAD controlled by 0x0*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xdf, 0x800, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, BIT(0), 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, BIT(0), 0x0); + + /* Check failed*/ + reg_eac = odm_get_bb_reg(p_dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + reg_e94 = odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + reg_e9c = odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", reg_eac)); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", reg_e94, reg_e9c)); + /*monitor image power before & after IQK*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", + odm_get_bb_reg(p_dm, 0xe90, MASKDWORD), odm_get_bb_reg(p_dm, 0xe98, MASKDWORD))); + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + + result |= 0x01; + else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 TXIQK FAIL\n")); + return result; +} + +u8 +phy_path_s1_rx_iqk_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean config_path_s0 +) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_ea4, u4tmp, tmp, path_sel_bb; + u8 result = 0x00, ktime; + u32 original_path, original_gnt; + + path_sel_bb = odm_get_bb_reg(p_dm, 0x948, MASKDWORD); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]path S1 RXIQK Step1!!\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK1 = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, 0x99000000); + /*ODM_RT_TRACE(p_dm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK1 = 0x%x\n", platform_efio_read_1byte(p_adapter, 0x1e6))); */ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + + /*IQK setting*/ + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + /*path-A IQK setting*/ + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x18008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + + odm_set_bb_reg(p_dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160000); + odm_set_bb_reg(p_dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + /*LO calibration setting*/ + odm_set_bb_reg(p_dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + /*modify RXIQK mode table*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, RFREGOFFSETMASK, 0x80000); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x33, RFREGOFFSETMASK, 0x00006); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3e, RFREGOFFSETMASK, 0x0005f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3f, RFREGOFFSETMASK, 0xa7ffb); + + /*---------PA/PAD=0----------*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xdf, 0x800, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x56, 0x600, 0x0); +#if 1 + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK, 0xe0d); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK, 0x60d); +#endif + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1@ path S1 RXIQK1 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2@ path S1 RXIQK1 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK))); + + /*enter IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); +#if 1 + /*backup path & GNT value */ + original_path = odm_get_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, MASKDWORD); /*save 0x70*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0038); + ODM_delay_ms(1); + original_gnt = odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD); /*save 0x38*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", original_gnt)); + + /*set GNT_WL=1/GNT_BT=1 and path owner to WiFi for pause BT traffic*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, 0x0000ff00); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc0020038); /*0x38[15:8] = 0x77*/ + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, BIT(26), 0x1); +#endif + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0054); + ODM_delay_ms(1); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK1 = 0x%x\n", odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK1 = 0x%x\n", odm_get_bb_reg(p_dm, 0x948, MASKDWORD))); + + /*One shot, path S1 LOK & IQK*/ + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /*delay x ms*/ + /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ + + ktime = 0; + while ((!odm_get_bb_reg(p_dm, 0xeac, BIT(26))) && ktime < 10) { + ODM_delay_ms(1); + ktime++; + } + reg_eac = odm_get_bb_reg(p_dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + reg_e94 = odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + reg_e9c = odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", reg_eac)); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", reg_e94, reg_e9c)); + /*monitor image power before & after IQK*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", + odm_get_bb_reg(p_dm, 0xe90, MASKDWORD), odm_get_bb_reg(p_dm, 0xe98, MASKDWORD))); + tmp = (reg_e9c & 0x03FF0000) >> 16; + if ((tmp & 0x200) > 0) + tmp = 0x400 - tmp; + + if (!(reg_eac & BIT(28)) && + (((reg_e94 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c & 0x03FF0000) >> 16) != 0x42)) + + result |= 0x01; + else { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP1 FAIL\n")); +#if 1 + /*Restore GNT_WL/GNT_BT and path owner*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, original_gnt); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc00f0038); + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, original_path); +#endif + /*reload RF path*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, path_sel_bb); + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(p_dm, RF_PATH_A, 0xdf, 0x800, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, BIT(0), 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, BIT(0), 0x0); + return result; + } + + u4tmp = 0x80007C00 | (reg_e94 & 0x3FF0000) | ((reg_e9c & 0x3FF0000) >> 16); + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, u4tmp); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40 = 0x%x u4tmp = 0x%x\n", odm_get_bb_reg(p_dm, REG_TX_IQK, MASKDWORD), u4tmp)); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]path S1 RXIQK STEP2!!\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK2 = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); + /*ODM_RT_TRACE(p_dm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK2 = 0x%x\n", platform_efio_read_1byte(p_adapter, 0x1e6))); */ + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x18008c1c); + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + + odm_set_bb_reg(p_dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82170000); + odm_set_bb_reg(p_dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28171400); + + /*LO calibration setting*/ + odm_set_bb_reg(p_dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a8d1); + + + /*modify RXIQK mode table*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(p_dm, RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x33, RFREGOFFSETMASK, 0x00007); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3e, RFREGOFFSETMASK, 0x0005f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3f, RFREGOFFSETMASK, 0xb3fdb); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 RXIQK2 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 RXIQK2 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK))); + + /*enter IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + +#if 1 + /*backup path & GNT value */ + original_path = odm_get_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, MASKDWORD); /*save 0x70*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0038); + ODM_delay_ms(1); + original_gnt = odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD); /*save 0x38*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", original_gnt)); + + /*set GNT_WL=1/GNT_BT=1 and path owner to WiFi for pause BT traffic*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, 0x0000ff00); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc0020038); /*0x38[15:8] = 0x77*/ + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, BIT(26), 0x1); +#endif + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0054); + ODM_delay_ms(1); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK2 = 0x%x\n", odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK2 = 0x%x\n", odm_get_bb_reg(p_dm, 0x948, MASKDWORD))); + + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + + /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ + + ktime = 0; + while ((!odm_get_bb_reg(p_dm, 0xeac, BIT(26))) && ktime < 10) { + ODM_delay_ms(1); + ktime++; + } + +#if 1 + /*Restore GNT_WL/GNT_BT and path owner*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, original_gnt); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc00f0038); + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, original_path); +#endif + /*reload RF path*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, path_sel_bb); + + /*leave IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + /* PA/PAD controlled by 0x0*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xdf, 0x800, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, BIT(0), 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, BIT(0), 0x0); + + reg_eac = odm_get_bb_reg(p_dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + reg_ea4 = odm_get_bb_reg(p_dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", reg_eac)); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4 = 0x%x, 0xeac = 0x%x\n", reg_ea4, reg_eac)); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0(before IQK)= 0x%x, 0xea8(afer IQK) = 0x%x\n", + odm_get_bb_reg(p_dm, 0xea0, MASKDWORD), odm_get_bb_reg(p_dm, 0xea8, MASKDWORD))); + + tmp = (reg_eac & 0x03FF0000) >> 16; + if ((tmp & 0x200) > 0) + tmp = 0x400 - tmp; + + if (!(reg_eac & BIT(27)) && /*if Tx is OK, check whether Rx is OK*/ + (((reg_ea4 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac & 0x03FF0000) >> 16) != 0x36) && + (((reg_ea4 & 0x03FF0000) >> 16) < 0x11a) && + (((reg_ea4 & 0x03FF0000) >> 16) > 0xe6) && + (tmp < 0x1a)) + result |= 0x02; + else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP2 FAIL\n")); + return result; +} + + +u8 +phy_path_s0_iqk_8723d( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 reg_eac, reg_e94, reg_e9c, reg_e94_s0, reg_e9c_s0, reg_ea4_s0, reg_eac_s0, tmp, path_sel_bb; + u8 result = 0x00, ktime; + u32 original_path, original_gnt; + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 TXIQK!\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 TXIQK = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); + path_sel_bb = odm_get_bb_reg(p_dm, 0x948, MASKDWORD); + + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, 0x99000280); /*10 od 0x948 0x1 [7] ; WL:S1 to S0;BT:S0 to S1;*/ + /*ODM_RT_TRACE(p_dm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 TXIQK = 0x%x\n", platform_efio_read_1byte(p_adapter, 0x1e6)));*/ + + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + /*modify TXIQK mode table*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xee, RFREGOFFSETMASK, 0x80000); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x33, RFREGOFFSETMASK, 0x00004); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3e, RFREGOFFSETMASK, 0x0005d); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3f, RFREGOFFSETMASK, 0xBFFE0); + + /*path-A IQK setting*/ + odm_set_bb_reg(p_dm, 0xe30, MASKDWORD, 0x08008c0c); + odm_set_bb_reg(p_dm, 0xe34, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, 0xe38, MASKDWORD, 0x8214018a); + odm_set_bb_reg(p_dm, 0xe3c, MASKDWORD, 0x28160200); + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + /*LO calibration setting*/ + odm_set_bb_reg(p_dm, REG_IQK_AGC_RSP, MASKDWORD, 0x00462911); + + /*PA, PAD setting*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xde, 0x800, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x66, 0x600, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x66, 0x1E0, 0x3); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x8d, 0x1F, 0xf); + + /*LOK setting added for 8723D*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xee, 0x10, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x64, 0x1, 0x1); + +#if 1 + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK, 0xe6d); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK, 0x66d); +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 TXIQK = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 TXIQK = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK))); + /*enter IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); +#if 1 + /*backup path & GNT value */ + original_path = odm_get_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, MASKDWORD); /*save 0x70*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0038); + ODM_delay_ms(1); + original_gnt = odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD); /*save 0x38*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", original_gnt)); + + /*set GNT_WL=1/GNT_BT=1 and path owner to WiFi for pause BT traffic*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, 0x0000ff00); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc0020038); /*0x38[15:8] = 0x77*/ + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, BIT(26), 0x1); +#endif + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0054); + ODM_delay_ms(1); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 TXIQK = 0x%x\n", odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 TXIQK = 0x%x\n", odm_get_bb_reg(p_dm, 0x948, MASKDWORD))); + + /*One shot, path S1 LOK & IQK*/ + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /*delay x ms*/ + /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ + + ktime = 0; + while ((!odm_get_bb_reg(p_dm, 0xeac, BIT(26))) && ktime < 10) { + ODM_delay_ms(1); + ktime++; + } +#if 1 + /*Restore GNT_WL/GNT_BT and path owner*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, original_gnt); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc00f0038); + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, original_path); +#endif + /*reload RF path*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, path_sel_bb); + /*leave IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + /*PA/PAD controlled by 0x0*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xde, 0x800, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, BIT(0), 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, BIT(0), 0x0); + /* Check failed*/ + reg_eac_s0 = odm_get_bb_reg(p_dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + reg_e94_s0 = odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + reg_e9c_s0 = odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", reg_eac_s0)); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", reg_e94_s0, reg_e9c_s0)); + /*monitor image power before & after IQK*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", + odm_get_bb_reg(p_dm, 0xe90, MASKDWORD), odm_get_bb_reg(p_dm, 0xe98, MASKDWORD))); + if (!(reg_eac_s0 & BIT(28)) && + (((reg_e94_s0 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c_s0 & 0x03FF0000) >> 16) != 0x42)) + + result |= 0x01; + else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 TXIQK FAIL\n")); + + return result; +} + + +u8 +phy_path_s0_rx_iqk_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean config_path_s0 +) +{ + u32 reg_e94, reg_e9c, reg_ea4, reg_eac, reg_e94_s0, reg_e9c_s0, reg_ea4_s0, reg_eac_s0, tmp, u4tmp, path_sel_bb; + u8 result = 0x00, ktime; + u32 original_path, original_gnt; + + path_sel_bb = odm_get_bb_reg(p_dm, 0x948, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 RxIQK Step1!!\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK1 = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, 0x99000280); + /*ODM_RT_TRACE(p_dm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK1 = 0x%x\n", platform_efio_read_1byte(p_adapter, 0x1e6)));*/ + + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x18008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + + odm_set_bb_reg(p_dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82160000); + odm_set_bb_reg(p_dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28160000); + + odm_set_bb_reg(p_dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a911); + + odm_set_rf_reg(p_dm, RF_PATH_A, 0xee, RFREGOFFSETMASK, 0x80000); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x33, RFREGOFFSETMASK, 0x00006); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3e, RFREGOFFSETMASK, 0x0005f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3f, RFREGOFFSETMASK, 0xa7ffb); + + odm_set_rf_reg(p_dm, RF_PATH_A, 0xde, 0x800, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x66, 0x600, 0x0); + +#if 1 + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK, 0xe6d); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK, 0x66d); +#endif + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK1 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK1 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK))); + + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + +#if 1 + /*backup path & GNT value */ + original_path = odm_get_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, MASKDWORD); /*save 0x70*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0038); + ODM_delay_ms(1); + original_gnt = odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD); /*save 0x38*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", original_gnt)); + + /*set GNT_WL=1/GNT_BT=1 and path owner to WiFi for pause BT traffic*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, 0x0000ff00); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc0020038); /*0x38[15:8] = 0x77*/ + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, BIT(26), 0x1); +#endif + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0054); + ODM_delay_ms(1); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK1 = 0x%x\n", odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK1 = 0x%x\n", odm_get_bb_reg(p_dm, 0x948, MASKDWORD))); + + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ + ktime = 0; + while ((!odm_get_bb_reg(p_dm, 0xeac, BIT(26))) && ktime < 10) { + ODM_delay_ms(1); + ktime++; + } + reg_eac_s0 = odm_get_bb_reg(p_dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + reg_e94_s0 = odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD); + reg_e9c_s0 = odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", reg_eac_s0)); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", reg_e94_s0, reg_e9c_s0)); + /*monitor image power before & after IQK*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", + odm_get_bb_reg(p_dm, 0xe90, MASKDWORD), odm_get_bb_reg(p_dm, 0xe98, MASKDWORD))); + + tmp = (reg_e9c_s0 & 0x03FF0000) >> 16; + if ((tmp & 0x200) > 0) + tmp = 0x400 - tmp; + + if (!(reg_eac_s0 & BIT(28)) && + (((reg_e94_s0 & 0x03FF0000) >> 16) != 0x142) && + (((reg_e9c_s0 & 0x03FF0000) >> 16) != 0x42)) + + result |= 0x01; + else { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP1 FAIL\n")); +#if 1 + /*Restore GNT_WL/GNT_BT and path owner*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, original_gnt); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc00f0038); + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, original_path); +#endif + /*reload RF path*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, path_sel_bb); + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(p_dm, RF_PATH_A, 0xde, 0x800, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, BIT(0), 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, BIT(0), 0x0); + return result; + } + + u4tmp = 0x80007C00 | (reg_e94_s0 & 0x3FF0000) | ((reg_e9c_s0 & 0x3FF0000) >> 16); + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, u4tmp); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40_s0 = 0x%x u4tmp = 0x%x\n", odm_get_bb_reg(p_dm, REG_TX_IQK, MASKDWORD), u4tmp)); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]path S0 RXIQK STEP2!!\n\n")); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK2 = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); + /*ODM_RT_TRACE(p_dm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK2 = 0x%x\n", platform_efio_read_1byte(p_adapter, 0x1e6)));*/ + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x18008c1c); + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_B, MASKDWORD, 0x38008c1c); + + odm_set_bb_reg(p_dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82170000); + odm_set_bb_reg(p_dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28171400); + + odm_set_bb_reg(p_dm, REG_IQK_AGC_RSP, MASKDWORD, 0x0046a8d1); + + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(p_dm, RF_PATH_A, 0xee, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x33, RFREGOFFSETMASK, 0x00007); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3e, RFREGOFFSETMASK, 0x0005f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x3f, RFREGOFFSETMASK, 0xb3fdb); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK2 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x1, RFREGOFFSETMASK))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK2 = 0x%x\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x2, RFREGOFFSETMASK))); + /*enter IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); +#if 1 + /*backup path & GNT value */ + original_path = odm_get_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, MASKDWORD); /*save 0x70*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0038); + ODM_delay_ms(1); + original_gnt = odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD); /*save 0x38*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", original_gnt)); + + /*set GNT_WL=1/GNT_BT=1 and path owner to WiFi for pause BT traffic*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, 0x0000ff00); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc0020038); /*0x38[15:8] = 0x77*/ + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, BIT(26), 0x1); +#endif + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0054); + ODM_delay_ms(1); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK2 = 0x%x\n", odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD))); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK2 = 0x%x\n", odm_get_bb_reg(p_dm, 0x948, MASKDWORD))); + + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ + ktime = 0; + while ((!odm_get_bb_reg(p_dm, 0xeac, BIT(26))) && ktime < 10) { + ODM_delay_ms(1); + ktime++; + } +#if 1 + /*Restore GNT_WL/GNT_BT and path owner*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, original_gnt); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc00f0038); + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, original_path); +#endif + /*reload RF path*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, path_sel_bb); + + /*leave IQK mode*/ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + + odm_set_rf_reg(p_dm, RF_PATH_A, 0xde, 0x800, 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x2, BIT(0), 0x0); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x1, BIT(0), 0x0); + + reg_eac_s0 = odm_get_bb_reg(p_dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD); + reg_ea4_s0 = odm_get_bb_reg(p_dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", reg_eac_s0)); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4_s0 = 0x%x, 0xeac_s0 = 0x%x\n", reg_ea4_s0, reg_eac_s0)); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0_s0(before IQK)= 0x%x, 0xea8_s0(afer IQK) = 0x%x\n", + odm_get_bb_reg(p_dm, 0xea0, MASKDWORD), odm_get_bb_reg(p_dm, 0xea8, MASKDWORD))); + + tmp = (reg_eac_s0 & 0x03FF0000) >> 16; + if ((tmp & 0x200) > 0) + tmp = 0x400 - tmp; + + if (!(reg_eac_s0 & BIT(27)) && /*if Tx is OK, check whether Rx is OK*/ + (((reg_ea4_s0 & 0x03FF0000) >> 16) != 0x132) && + (((reg_eac_s0 & 0x03FF0000) >> 16) != 0x36) && + (((reg_ea4_s0 & 0x03FF0000) >> 16) < 0x11a) && + (((reg_ea4_s0 & 0x03FF0000) >> 16) > 0xe6) && + (tmp < 0x1a)) + result |= 0x02; + else + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP2 FAIL\n")); + return result; +} + + +void +_phy_path_s1_fill_iqk_matrix_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean is_iqk_ok, + s32 result[][8], + u8 final_candidate, + boolean is_tx_only +) +{ + u32 oldval_1, X, TX1_A, reg; + s32 Y, TX1_C; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S1 IQ Calibration %s !\n", (is_iqk_ok) ? "Success" : "Failed")); + + if (final_candidate == 0xFF) + return; + + else if (is_iqk_ok) { + oldval_1 = (odm_get_bb_reg(p_dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, MASKDWORD) >> 22) & 0x3FF; + + X = result[final_candidate][0]; + + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX1_A = (X * oldval_1) >> 8; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x, oldval_1 0x%x\n", X, TX1_A, oldval_1)); + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x3FF, TX1_A); + + odm_set_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(31), ((X * oldval_1 >> 7) & 0x1)); + + Y = result[final_candidate][1]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + TX1_C = (Y * oldval_1) >> 8; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); + odm_set_bb_reg(p_dm, REG_OFDM_0_XC_TX_AFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_TX_IQ_IMBALANCE, 0x003F0000, (TX1_C & 0x3F)); + + odm_set_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, BIT(29), ((Y * oldval_1 >> 7) & 0x1)); + + if (is_tx_only) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_path_s1_fill_iqk_matrix_8723d only Tx OK\n")); + return; + } + reg = result[final_candidate][2]; +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (RTL_ABS(reg, 0x100) >= 16) + reg = 0x100; +#endif + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0x3FF, reg); + + reg = result[final_candidate][3] & 0x3F; + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_RX_IQ_IMBALANCE, 0xFC00, reg); + + reg = (result[final_candidate][3] >> 6) & 0xF; + odm_set_bb_reg(p_dm, REG_OFDM_0_RX_IQ_EXT_ANTA, 0xF0000000, reg); + /* + 10 os 7201 10 + 10 id ea4 [25:16] p + 10 os 7202 10 + 10 od c14 VarFromTmp [9:0] p + + 10 os 7201 11 + 10 id eac [25:22] p + 10 os 7202 11 + 10 od ca0 VarFromTmp [31:28] p + + 10 os 7201 12 + 10 id eac [21:16] p + 10 os 7202 12 + 10 od c14 VarFromTmp [15:10] p + */ + } +} + +void +_phy_path_s0_fill_iqk_matrix_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean is_iqk_ok, + s32 result[][8], + u8 final_candidate, + boolean is_tx_only +) +{ + u32 oldval_0, X, TX0_A, reg; + s32 Y, TX0_C; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 IQ Calibration %s !\n", (is_iqk_ok) ? "Success" : "Failed")); + + if (final_candidate == 0xFF) + return; + + else if (is_iqk_ok) { + oldval_0 = (odm_get_bb_reg(p_dm, 0xcd4, MASKDWORD) >> 13) & 0x3FF; + + X = result[final_candidate][4]; + if ((X & 0x00000200) != 0) + X = X | 0xFFFFFC00; + TX0_A = (X * oldval_0) >> 8; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX0_A = 0x%x, oldval_0 0x%x\n", X, TX0_A, oldval_0)); + odm_set_bb_reg(p_dm, 0xcd0, 0x7FE, TX0_A); + + odm_set_bb_reg(p_dm, 0xcd0, BIT(0), ((X * oldval_0 >> 7) & 0x1)); + + Y = result[final_candidate][5]; + if ((Y & 0x00000200) != 0) + Y = Y | 0xFFFFFC00; + + TX0_C = (Y * oldval_0) >> 8; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX0_C = 0x%x\n", Y, TX0_C)); + odm_set_bb_reg(p_dm, 0xcd4, 0x7FE, (TX0_C & 0x3FF)); + + odm_set_bb_reg(p_dm, 0xcd4, BIT(0), ((Y * oldval_0 >> 7) & 0x1)); + + if (is_tx_only) + return; + + reg = result[final_candidate][6]; + odm_set_bb_reg(p_dm, 0xcd8, 0x3FF, reg); + + reg = result[final_candidate][7]; + odm_set_bb_reg(p_dm, 0xcd8, 0x003FF000, reg); + /* + 10 os 7201 10 + 10 id ea4 [25:16] p + 10 os 7202 10 + 10 od cd8 VarFromTmp [9:0] p + + 10 os 7201 11 + 10 id eac [25:16] p + 10 os 7202 11 + 10 od cd8 VarFromTmp [21:12] p + rege94_s1 = result[i][0]; + rege9c_s1 = result[i][1]; + regea4_s1 = result[i][2]; + regeac_s1 = result[i][3]; + rege94_s0 = result[i][4]; + rege9c_s0 = result[i][5]; + regea4_s0 = result[i][6]; + regeac_s0 = result[i][7]; + */ + } +} + +void +_phy_save_adda_registers_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *adda_reg, + u32 *adda_backup, + u32 register_num +) +{ + u32 i; + + for (i = 0 ; i < register_num ; i++) + adda_backup[i] = odm_get_bb_reg(p_dm, adda_reg[i], MASKDWORD); +} + + +void +_phy_save_mac_registers_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i; + + for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) + mac_backup[i] = odm_read_1byte(p_dm, mac_reg[i]); + mac_backup[i] = odm_read_4byte(p_dm, mac_reg[i]); +} + + +void +_phy_reload_adda_registers_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *adda_reg, + u32 *adda_backup, + u32 regiester_num +) +{ + u32 i; + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload ADDA power saving parameters !\n")); + for (i = 0 ; i < regiester_num; i++) + odm_set_bb_reg(p_dm, adda_reg[i], MASKDWORD, adda_backup[i]); +} + +void +_phy_reload_mac_registers_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + u32 i; + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload MAC parameters !\n")); + for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) + odm_write_1byte(p_dm, mac_reg[i], (u8)mac_backup[i]); + odm_write_4byte(p_dm, mac_reg[i], mac_backup[i]); +} + + +void +_phy_path_adda_on_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *adda_reg, + boolean is_path_a_on, + boolean is2T +) +{ + u32 path_on; + u32 i; + + path_on = is_path_a_on ? 0x03c00016 : 0x03c00016; + + if (false == is2T) { + path_on = 0x03c00016; + odm_set_bb_reg(p_dm, adda_reg[0], MASKDWORD, 0x03c00016); + } else + odm_set_bb_reg(p_dm, adda_reg[0], MASKDWORD, path_on); + + for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) + odm_set_bb_reg(p_dm, adda_reg[i], MASKDWORD, path_on); + +} + +void +_phy_mac_setting_calibration_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *mac_reg, + u32 *mac_backup +) +{ + /* + odm_write_1byte(p_dm, mac_reg[i], 0x3F); + + for(i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++){ + odm_write_1byte(p_dm, mac_reg[i], (u8)(mac_backup[i]&(~BIT(3)))); + } + odm_write_1byte(p_dm, mac_reg[i], (u8)(mac_backup[i]&(~BIT(5)))); + */ + + /*odm_set_bb_reg(p_dm, 0x522, MASKBYTE0, 0x7f);*/ + /*odm_set_bb_reg(p_dm, 0x550, MASKBYTE0, 0x15);*/ + /*odm_set_bb_reg(p_dm, 0x551, MASKBYTE0, 0x00);*/ + odm_set_bb_reg(p_dm, 0x520, 0x00ff0000, 0xff); +} + +void +_phy_path_a_stand_by_8723d( + struct PHY_DM_STRUCT *p_dm +) +{ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-S1 standby mode!\n")); + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + /* odm_set_bb_reg(p_dm, 0x840, MASKDWORD, 0x00010000);*/ + odm_set_rf_reg(p_dm, (enum rf_path)0x0, 0x0, RFREGOFFSETMASK, 0x10000); + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); +} + +void +_phy_path_b_stand_by_8723d( + struct PHY_DM_STRUCT *p_dm +) +{ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path-S0 standby mode!\n")); + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + odm_set_rf_reg(p_dm, (enum rf_path)0x1, 0x0, RFREGOFFSETMASK, 0x10000); + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); +} + + +void +_phy_pi_mode_switch_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean pi_mode +) +{ + u32 mode; + + mode = pi_mode ? 0x01000100 : 0x01000000; + odm_set_bb_reg(p_dm, REG_FPGA0_XA_HSSI_PARAMETER1, MASKDWORD, mode); + odm_set_bb_reg(p_dm, REG_FPGA0_XB_HSSI_PARAMETER1, MASKDWORD, mode); +} + +boolean +phy_simularity_compare_8723d( + struct PHY_DM_STRUCT *p_dm, + s32 result[][8], + u8 c1, + u8 c2 +) +{ + u32 i, j, diff, simularity_bit_map, bound = 0; + u8 final_candidate[2] = {0xFF, 0xFF}; + boolean is_result = true; + /*#if !(DM_ODM_SUPPORT_TYPE & ODM_AP)*/ + /* bool is2T = IS_92C_SERIAL( p_hal_data->version_id);*/ + /*#else*/ + boolean is2T = true; + /*#endif*/ + + s32 tmp1 = 0, tmp2 = 0; + + if (is2T) + bound = 8; + else + bound = 4; + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_simularity_compare_8723d c1 %d c2 %d!!!\n", c1, c2)); + + + simularity_bit_map = 0; + + for (i = 0; i < bound; i++) { + + if ((i == 1) || (i == 3) || (i == 5) || (i == 7)) { + if ((result[c1][i] & 0x00000200) != 0) + tmp1 = result[c1][i] | 0xFFFFFC00; + else + tmp1 = result[c1][i]; + + if ((result[c2][i] & 0x00000200) != 0) + tmp2 = result[c2][i] | 0xFFFFFC00; + else + tmp2 = result[c2][i]; + } else { + tmp1 = result[c1][i]; + tmp2 = result[c2][i]; + } + + diff = (tmp1 > tmp2) ? (tmp1 - tmp2) : (tmp2 - tmp1); + + if (diff > MAX_TOLERANCE) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:differnece overflow %d index %d compare1 0x%x compare2 0x%x!!!\n", diff, i, result[c1][i], result[c2][i])); + + if ((i == 2 || i == 6) && !simularity_bit_map) { + if (result[c1][i] + result[c1][i + 1] == 0) + final_candidate[(i / 4)] = c2; + else if (result[c2][i] + result[c2][i + 1] == 0) + final_candidate[(i / 4)] = c1; + else + simularity_bit_map = simularity_bit_map | (1 << i); + } else + simularity_bit_map = simularity_bit_map | (1 << i); + } + } + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:phy_simularity_compare_8723d simularity_bit_map %x !!!\n", simularity_bit_map)); + + if (simularity_bit_map == 0) { + for (i = 0; i < (bound / 4); i++) { + if (final_candidate[i] != 0xFF) { + for (j = i * 4; j < (i + 1) * 4 - 2; j++) + result[3][j] = result[final_candidate[i]][j]; + is_result = false; + } + } + return is_result; + } else { + + if (!(simularity_bit_map & 0x03)) { + for (i = 0; i < 2; i++) + result[3][i] = result[c1][i]; + } + + if (!(simularity_bit_map & 0x0c)) { + for (i = 2; i < 4; i++) + result[3][i] = result[c1][i]; + } + + if (!(simularity_bit_map & 0x30)) { + for (i = 4; i < 6; i++) + result[3][i] = result[c1][i]; + + } + + if (!(simularity_bit_map & 0xc0)) { + for (i = 6; i < 8; i++) + result[3][i] = result[c1][i]; + } + + return false; + } + + + +} + + +void +_phy_check_coex_status_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean beforek +) +{ + u8 u1b_tmp; + u16 count = 0; + u8 h2c_parameter; + +#if MP_DRIVER != 1 + if (beforek) { + /* Set H2C cmd to inform FW (enable). */ + h2c_parameter = 1; + odm_fill_h2c_cmd(p_dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); + /* Check 0x1e6 */ + count = 0; + u1b_tmp = odm_read_1byte(p_dm, 0x1e6); + while (u1b_tmp != 0x1 && count < 1000) { + ODM_delay_ms(1); + u1b_tmp = odm_read_1byte(p_dm, 0x1e6); + count++; + } + + if (count >= 1000) + RT_TRACE(COMP_INIT, DBG_LOUD, ("[IQK]Polling 0x1e6 to 1 for WiFi calibration H2C cmd FAIL! count(%d)", count)); + + /* Wait BT IQK finished. */ + /* polling 0x1e7[0]=1 or 300ms timeout */ + u1b_tmp = odm_read_1byte(p_dm, 0x1e7); + while ((!(u1b_tmp & BIT(0))) && count < 6000) { + ODM_delay_ms(50); + u1b_tmp = odm_read_1byte(p_dm, 0x1e7); + count++; + } + } else { + /* Set H2C cmd to inform FW (disable). */ + h2c_parameter = 0; + odm_fill_h2c_cmd(p_dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); + /* Check 0x1e6 */ + count = 0; + u1b_tmp = odm_read_1byte(p_dm, 0x1e6); + while (u1b_tmp != 0 && count < 1000) { + ODM_delay_us(10); + u1b_tmp = odm_read_1byte(p_dm, 0x1e6); + count++; + } + + if (count >= 1000) + RT_TRACE(COMP_INIT, DBG_LOUD, ("[IQK]Polling 0x1e6 to 0 for WiFi calibration H2C cmd FAIL! count(%d)", count)); + } +#endif +} + + + +void +_phy_iq_calibrate_8723d( + struct PHY_DM_STRUCT *p_dm, + s32 result[][8], + u8 t, + boolean is2T +) +{ + u32 i; + u8 path_s1_ok = 0x0, path_s0_ok = 0x0; + u8 tmp0xc50 = (u8)odm_get_bb_reg(p_dm, 0xC50, MASKBYTE0); + u8 tmp0xc58 = (u8)odm_get_bb_reg(p_dm, 0xC58, MASKBYTE0); + u32 ADDA_REG[IQK_ADDA_REG_NUM] = { + REG_FPGA0_XCD_SWITCH_CONTROL, REG_BLUE_TOOTH, + REG_RX_WAIT_CCA, REG_TX_CCK_RFON, + REG_TX_CCK_BBON, REG_TX_OFDM_RFON, + REG_TX_OFDM_BBON, REG_TX_TO_RX, + REG_TX_TO_TX, REG_RX_CCK, + REG_RX_OFDM, REG_RX_WAIT_RIFS, + REG_RX_TO_RX, REG_STANDBY, + REG_SLEEP, REG_PMPD_ANAEN + }; + u32 IQK_MAC_REG[IQK_MAC_REG_NUM] = { + REG_TXPAUSE, REG_BCN_CTRL, + REG_BCN_CTRL_1, REG_GPIO_MUXCFG + }; + + + u32 IQK_BB_REG_92C[IQK_BB_REG_NUM] = { + REG_OFDM_0_TRX_PATH_ENABLE, REG_OFDM_0_TR_MUX_PAR, + REG_FPGA0_XCD_RF_INTERFACE_SW, REG_CONFIG_ANT_A, REG_CONFIG_ANT_B, + REG_FPGA0_XAB_RF_INTERFACE_SW, REG_FPGA0_XA_RF_INTERFACE_OE, + REG_FPGA0_XB_RF_INTERFACE_OE, REG_CCK_0_AFE_SETTING + }; + u32 cnt_iqk_fail = 0; + u32 retry_count; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + retry_count = 2; +#elif (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) +#if MP_DRIVER + retry_count = 9; +#else + retry_count = 2; +#endif +#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + if (*(p_dm->p_mp_mode)) + retry_count = 9; + else + retry_count = 2; +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#ifdef MP_TEST + if (*(p_dm->p_mp_mode)) + retry_count = 9; +#endif +#endif + + if (t == 0) { + _phy_save_adda_registers_8723d(p_dm, ADDA_REG, p_dm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); + _phy_save_mac_registers_8723d(p_dm, IQK_MAC_REG, p_dm->rf_calibrate_info.IQK_MAC_backup); + _phy_save_adda_registers_8723d(p_dm, IQK_BB_REG_92C, p_dm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); + } + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for 1T1R_S0/S1 for %d times\n", t)); + + _phy_path_adda_on_8723d(p_dm, ADDA_REG, true, is2T); +#if 0 + if (t == 0) + p_dm->rf_calibrate_info.is_rf_pi_enable = (u8)odm_get_bb_reg(p_dm, REG_FPGA0_XA_HSSI_PARAMETER1, BIT(8)); + + if (!p_dm->rf_calibrate_info.is_rf_pi_enable) { + /* Switch BB to PI mode to do IQ Calibration. */ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + _phy_pi_mode_switch_8723d(p_adapter, true); +#else + _phy_pi_mode_switch_8723d(p_dm, true); +#endif + } +#endif + _phy_mac_setting_calibration_8723d(p_dm, IQK_MAC_REG, p_dm->rf_calibrate_info.IQK_MAC_backup); + /*BB setting*/ + /*odm_set_bb_reg(p_dm, REG_FPGA0_RFMOD, BIT24, 0x00);*/ + odm_set_bb_reg(p_dm, REG_CCK_0_AFE_SETTING, 0x0f000000, 0xf); + odm_set_bb_reg(p_dm, REG_OFDM_0_TRX_PATH_ENABLE, MASKDWORD, 0x03a05611); + odm_set_bb_reg(p_dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800e4); + odm_set_bb_reg(p_dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x25204200); + + /*IQ calibration setting*/ + /*ODM_RT_TRACE(p_dm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK setting!\n")); */ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + if (is2T) { + _phy_path_b_stand_by_8723d(p_dm); + _phy_path_adda_on_8723d(p_dm, ADDA_REG, false, is2T); + } + +#if 1 + for (i = 0 ; i < retry_count ; i++) { + path_s1_ok = phy_path_s1_iqk_8723d(p_dm, is2T); + if (path_s1_ok == 0x01) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S1 Tx IQK Success!!\n")); + result[t][0] = (odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S1 Tx IQK Fail!!\n")); + result[t][0] = 0x100; + result[t][1] = 0x0; + cnt_iqk_fail++; + } +#if 0 + else if (i == (retry_count - 1) && path_s1_ok == 0x01) { + RT_DISP(FINIT, INIT_IQK, ("path S1 IQK Only Tx Success!!\n")); + + result[t][0] = (odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD) & 0x3FF0000) >> 16; + } +#endif + } +#endif +#if 1 + for (i = 0 ; i < retry_count ; i++) { + path_s1_ok = phy_path_s1_rx_iqk_8723d(p_dm, is2T); + if (path_s1_ok == 0x03) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S1 Rx IQK Success!!\n")); + result[t][2] = (odm_get_bb_reg(p_dm, REG_RX_POWER_BEFORE_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + result[t][3] = (odm_get_bb_reg(p_dm, REG_RX_POWER_AFTER_IQK_A_2, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S1 Rx IQK Fail!!\n")); + result[t][2] = 0x100; + result[t][3] = 0x0; + cnt_iqk_fail++; + } + } + if (0x00 == path_s1_ok) + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S1 IQK failed!!\n")); +#endif + if (is2T) { + _phy_path_a_stand_by_8723d(p_dm); + _phy_path_adda_on_8723d(p_dm, ADDA_REG, false, is2T); + + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + + +#if 1 + for (i = 0 ; i < retry_count ; i++) { + path_s0_ok = phy_path_s0_iqk_8723d(p_dm); + if (path_s0_ok == 0x01) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 Tx IQK Success!!\n")); + result[t][4] = (odm_get_bb_reg(p_dm, 0xe94, MASKDWORD) & 0x3FF0000) >> 16; + result[t][5] = (odm_get_bb_reg(p_dm, 0xe9c, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 Tx IQK Fail!!\n")); + result[t][4] = 0x100; + result[t][5] = 0x0; + cnt_iqk_fail++; + } +#if 0 + else if (i == (retry_count - 1) && path_s1_ok == 0x01) { + RT_DISP(FINIT, INIT_IQK, ("path S0 IQK Only Tx Success!!\n")); + + result[t][0] = (odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + result[t][1] = (odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_B, MASKDWORD) & 0x3FF0000) >> 16; + } +#endif + } +#endif + +#if 1 + for (i = 0 ; i < retry_count ; i++) { + path_s0_ok = phy_path_s0_rx_iqk_8723d(p_dm, is2T); + if (path_s0_ok == 0x03) { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 Rx IQK Success!!\n")); + /* result[t][0] = (odm_get_bb_reg(p_dm, REG_TX_POWER_BEFORE_IQK_A, MASKDWORD)&0x3FF0000)>>16;*/ + /* result[t][1] = (odm_get_bb_reg(p_dm, REG_TX_POWER_AFTER_IQK_A, MASKDWORD)&0x3FF0000)>>16;*/ + result[t][6] = (odm_get_bb_reg(p_dm, 0xea4, MASKDWORD) & 0x3FF0000) >> 16; + result[t][7] = (odm_get_bb_reg(p_dm, 0xeac, MASKDWORD) & 0x3FF0000) >> 16; + break; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 Rx IQK Fail!!\n")); + result[t][6] = 0x100; + result[t][7] = 0x0; + cnt_iqk_fail++; + } + } + + if (0x00 == path_s0_ok) + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path S0 IQK failed!!\n")); +#endif + } + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + + if (t != 0) { + _phy_reload_adda_registers_8723d(p_dm, ADDA_REG, p_dm->rf_calibrate_info.ADDA_backup, IQK_ADDA_REG_NUM); + /* Reload MAC parameters*/ + _phy_reload_mac_registers_8723d(p_dm, IQK_MAC_REG, p_dm->rf_calibrate_info.IQK_MAC_backup); + _phy_reload_adda_registers_8723d(p_dm, IQK_BB_REG_92C, p_dm->rf_calibrate_info.IQK_BB_backup, IQK_BB_REG_NUM); + + odm_set_bb_reg(p_dm, 0xc50, MASKBYTE0, 0x50); + odm_set_bb_reg(p_dm, 0xc50, MASKBYTE0, tmp0xc50); + if (is2T) { + odm_set_bb_reg(p_dm, 0xc58, MASKBYTE0, 0x50); + odm_set_bb_reg(p_dm, 0xc58, MASKBYTE0, tmp0xc58); + } + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x01008c00); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x01008c00); + } + p_dm->n_iqk_cnt++; + if (cnt_iqk_fail == 0) + p_dm->n_iqk_ok_cnt++; + else + p_dm->n_iqk_fail_cnt = p_dm->n_iqk_fail_cnt + cnt_iqk_fail; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_phy_iq_calibrate_8723d() <==\n")); +} + + +void +_phy_lc_calibrate_8723d( + struct PHY_DM_STRUCT *p_dm, + boolean is2T +) +{ + u8 tmp_reg; + u32 rf_bmode = 0, lc_cal, cnt; + + tmp_reg = odm_read_1byte(p_dm, 0xd03); + if ((tmp_reg & 0x70) != 0) + odm_write_1byte(p_dm, 0xd03, tmp_reg & 0x8F); + else + odm_write_1byte(p_dm, REG_TXPAUSE, 0xFF); + /*backup RF0x18*/ + lc_cal = odm_get_rf_reg(p_dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK); + /*Start LCK*/ + odm_set_rf_reg(p_dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, lc_cal | 0x08000); + for (cnt = 0; cnt < 100; cnt++) { + if (odm_get_rf_reg(p_dm, RF_PATH_A, RF_CHNLBW, 0x8000) != 0x1) + break; + ODM_delay_ms(10); + } + /* Recover channel number*/ + odm_set_rf_reg(p_dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, lc_cal); + /*Restore original situation*/ + if ((tmp_reg & 0x70) != 0) + odm_write_1byte(p_dm, 0xd03, tmp_reg); + else + odm_write_1byte(p_dm, REG_TXPAUSE, 0x00); +} + + +void +phy_iq_calibrate_8723d( + void *p_dm_void, + boolean is_recovery +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 count = 0; + s32 result[4][8]; + u8 i, final_candidate, indexforchannel; + boolean is_path_s1_ok, is_path_s0_ok; + s32 rege94_s1, rege9c_s1, regea4_s1, regeac_s1, rege94_s0, rege9c_s0, regea4_s0, regeac_s0, reg_tmp = 0; + s32 regc80, regc94, regc14, regca0, regcd0, regcd4, regcd8; + boolean is12simular, is13simular, is23simular; + u32 IQK_BB_REG_92C[IQK_BB_REG_NUM] = { + REG_OFDM_0_XA_RX_IQ_IMBALANCE, REG_OFDM_0_XB_RX_IQ_IMBALANCE, + REG_OFDM_0_ECCA_THRESHOLD, REG_OFDM_0_AGC_RSSI_TABLE, + REG_OFDM_0_XA_TX_IQ_IMBALANCE, REG_OFDM_0_XB_TX_IQ_IMBALANCE, + REG_OFDM_0_XC_TX_AFE, REG_OFDM_0_XD_TX_AFE, + REG_OFDM_0_RX_IQ_EXT_ANTA + }; + u32 path_sel_bb_phy_iqk; + u32 original_path, original_gnt, ori_path_ctrl; + u32 iqk_fail_b, iqk_fail_a; + +#if 1 + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("================ IQK Start ===================\n")); + + iqk_fail_b = p_dm->n_iqk_fail_cnt; + + ODM_RT_TRACE(p_dm, ODM_COMP_INIT, ODM_DBG_LOUD, ("=====>phy_iq_calibrate_8723d\n")); + + path_sel_bb_phy_iqk = odm_get_bb_reg(p_dm, 0x948, MASKDWORD); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) + if (is_recovery) +#else + if (is_recovery && (!p_dm->is_in_hct_test)) +#endif + { + ODM_RT_TRACE(p_dm, ODM_COMP_INIT, ODM_DBG_LOUD, ("phy_iq_calibrate_8723d: Return due to is_recovery!\n")); + _phy_reload_adda_registers_8723d(p_dm, IQK_BB_REG_92C, p_dm->rf_calibrate_info.IQK_BB_backup_recover, 9); + return; + } + /*Check & wait if BT is doing IQK*/ + if (*(p_dm->p_mp_mode) == false) + _phy_check_coex_status_8723d(p_dm, true); + + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Start!!!\n")); + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_iqk_in_progress = true; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + + for (i = 0; i < 8; i++) { + result[0][i] = 0; + result[1][i] = 0; + result[2][i] = 0; + result[3][i] = 0; + } + + final_candidate = 0xff; + is_path_s1_ok = false; + is_path_s0_ok = false; + is12simular = false; + is23simular = false; + is13simular = false; + + for (i = 0; i < 3; i++) { +#if 1 + /*set path control to WL*/ + ori_path_ctrl = odm_get_mac_reg(p_dm, 0x64, MASKBYTE3); /*save 0x67*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]original 0x67 = 0x%x\n", ori_path_ctrl)); + odm_set_mac_reg(p_dm, 0x64, BIT(31), 0x1); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]set 0x67 = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); + /*backup path & GNT value */ + original_path = odm_get_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, MASKDWORD); /*save 0x70*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0x800f0038); + ODM_delay_ms(1); + original_gnt = odm_get_bb_reg(p_dm, REG_LTECOEX_READ_DATA, MASKDWORD); /*save 0x38*/ + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", original_gnt)); + /*set GNT_WL=1/GNT_BT=1 and path owner to WiFi for pause BT traffic*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, 0x0000ff00); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc0020038); /*0x38[15:8] = 0x77*/ + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, BIT(26), 0x1); +#endif + _phy_iq_calibrate_8723d(p_dm, result, i, true); +#if 1 + /*Restore GNT_WL/GNT_BT and path owner*/ + odm_set_bb_reg(p_dm, REG_LTECOEX_WRITE_DATA, MASKDWORD, original_gnt); + odm_set_bb_reg(p_dm, REG_LTECOEX_CTRL, MASKDWORD, 0xc00f0038); + odm_set_mac_reg(p_dm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, original_path); + /*Restore path control owner*/ + odm_set_mac_reg(p_dm, 0x64, MASKBYTE3, ori_path_ctrl); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]restore 0x67 = 0x%x\n", odm_get_mac_reg(p_dm, 0x64, MASKBYTE3))); +#endif + if (i == 1) { + is12simular = phy_simularity_compare_8723d(p_dm, result, 0, 1); + if (is12simular) { + final_candidate = 0; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is12simular final_candidate is %x\n", final_candidate)); + break; + } + } + + if (i == 2) { + is13simular = phy_simularity_compare_8723d(p_dm, result, 0, 2); + if (is13simular) { + final_candidate = 0; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is13simular final_candidate is %x\n", final_candidate)); + + break; + } + is23simular = phy_simularity_compare_8723d(p_dm, result, 1, 2); + if (is23simular) { + final_candidate = 1; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is23simular final_candidate is %x\n", final_candidate)); + } else { + for (i = 0; i < 8; i++) + reg_tmp += result[3][i]; + + if (reg_tmp != 0) + final_candidate = 3; + else + final_candidate = 0xFF; + } + } + } + + for (i = 0; i < 4; i++) { + rege94_s1 = result[i][0]; + rege9c_s1 = result[i][1]; + regea4_s1 = result[i][2]; + regeac_s1 = result[i][3]; + rege94_s0 = result[i][4]; + rege9c_s0 = result[i][5]; + regea4_s0 = result[i][6]; + regeac_s0 = result[i][7]; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] rege94_s1=%x rege9c_s1=%x regea4_s1=%x regeac_s1=%x rege94_s0=%x rege9c_s0=%x regea4_s0=%x regeac_s0=%x\n ", rege94_s1, rege9c_s1, regea4_s1, regeac_s1, rege94_s0, rege9c_s0, regea4_s0, regeac_s0)); + } + + if (final_candidate != 0xff) { + p_dm->rf_calibrate_info.rege94 = rege94_s1 = result[final_candidate][0]; + p_dm->rf_calibrate_info.rege9c = rege9c_s1 = result[final_candidate][1]; + regea4_s1 = result[final_candidate][2]; + regeac_s1 = result[final_candidate][3]; + p_dm->rf_calibrate_info.regeb4 = rege94_s0 = result[final_candidate][4]; + p_dm->rf_calibrate_info.regebc = rege9c_s0 = result[final_candidate][5]; + regea4_s0 = result[final_candidate][6]; + regeac_s0 = result[final_candidate][7]; + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] final_candidate is %x\n", final_candidate)); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] TX1_X=%x TX1_Y=%x RX1_X=%x RX1_Y=%x TX0_X=%x TX0_Y=%x RX0_X=%x RX0_Y=%x\n ", rege94_s1, rege9c_s1, regea4_s1, regeac_s1, rege94_s0, rege9c_s0, regea4_s0, regeac_s0)); + is_path_s1_ok = is_path_s0_ok = true; + } else { + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] FAIL use default value\n")); + p_dm->rf_calibrate_info.rege94 = p_dm->rf_calibrate_info.regeb4 = 0x100; + p_dm->rf_calibrate_info.rege9c = p_dm->rf_calibrate_info.regebc = 0x0; + } + + if (rege94_s1 != 0) + _phy_path_s1_fill_iqk_matrix_8723d(p_dm, is_path_s1_ok, result, final_candidate, (regea4_s1 == 0)); + if (rege94_s0 != 0) + _phy_path_s0_fill_iqk_matrix_8723d(p_dm, is_path_s0_ok, result, final_candidate, (regea4_s0 == 0)); + + iqk_fail_a= p_dm->n_iqk_fail_cnt; + if( iqk_fail_a - iqk_fail_b > 0 ) + RT_TRACE(COMP_INIT, DBG_LOUD, ("[8723dIQK]n_iqk_fail_cnt+,IQK restore to default value !\n")); + + regc80 = odm_get_bb_reg(p_dm, 0xc80, MASKDWORD); + regc94 = odm_get_bb_reg(p_dm, 0xc94, MASKDWORD); + regc14 = odm_get_bb_reg(p_dm, 0xc14, MASKDWORD); + regca0 = odm_get_bb_reg(p_dm, 0xca0, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xc80 = 0x%x 0xc94 = 0x%x 0xc14 = 0x%x 0xca0 = 0x%x\n", regc80, regc94, regc14, regca0)); + + regcd0 = odm_get_bb_reg(p_dm, 0xcd0, MASKDWORD); + regcd4 = odm_get_bb_reg(p_dm, 0xcd4, MASKDWORD); + regcd8 = odm_get_bb_reg(p_dm, 0xcd8, MASKDWORD); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xcd0 = 0x%x 0xcd4 = 0x%x 0xcd8 = 0x%x\n", regcd0, regcd4, regcd8)); +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + indexforchannel = odm_get_right_chnl_place_for_iqk(*p_dm->p_channel); +#else + indexforchannel = 0; +#endif + + if (final_candidate < 4) { + for (i = 0; i < iqk_matrix_reg_num; i++) + p_dm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].value[0][i] = result[final_candidate][i]; + p_dm->rf_calibrate_info.iqk_matrix_reg_setting[indexforchannel].is_iqk_done = true; + } + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK indexforchannel %d.\n", indexforchannel)); + _phy_save_adda_registers_8723d(p_dm, IQK_BB_REG_92C, p_dm->rf_calibrate_info.IQK_BB_backup_recover, IQK_BB_REG_NUM); + + if (*(p_dm->p_mp_mode) == false) + _phy_check_coex_status_8723d(p_dm, false); + + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, path_sel_bb_phy_iqk); + ODM_RT_TRACE(p_dm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); +#endif +} + + +void +phy_lc_calibrate_8723d( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + _phy_lc_calibrate_8723d(p_dm, false); +} + +void _phy_set_rf_path_switch_8723d( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm, +#else + struct _ADAPTER *p_adapter, +#endif + boolean is_main, + boolean is2T +) +{ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->odmpriv; +#endif +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#endif + + if (is_main) + odm_set_mac_reg(p_dm, 0x7C4, MASKLWORD, 0x7700); + else + odm_set_mac_reg(p_dm, 0x7C4, MASKLWORD, 0xDD00); + + odm_set_mac_reg(p_dm, 0x7C0, MASKDWORD, 0xC00F0038); + odm_set_mac_reg(p_dm, 0x70, BIT(26), 1); + odm_set_mac_reg(p_dm, 0x64, BIT(31), 1); +} + +void phy_set_rf_path_switch_8723d( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm, +#else + struct _ADAPTER *p_adapter, +#endif + boolean is_main +) +{ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->odmpriv; +#endif + +#if DISABLE_BB_RF + return; +#endif + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + _phy_set_rf_path_switch_8723d(p_adapter, is_main, true); +#endif + +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +boolean _phy_query_rf_path_switch_8723d( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm, +#else + struct _ADAPTER *p_adapter, +#endif + boolean is2T +) +{ +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->odmpriv; +#endif +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#endif +#endif + + + if (odm_get_bb_reg(p_dm, 0x7C4, MASKLWORD) == 0x7700) + return true; + else + return false; + +} + + + + +boolean phy_query_rf_path_switch_8723d( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm +#else + struct _ADAPTER *p_adapter +#endif +) +{ + +#if DISABLE_BB_RF + return true; +#endif + +#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) + return _phy_query_rf_path_switch_8723d(p_adapter, false); +#else + return _phy_query_rf_path_switch_8723d(p_dm, false); +#endif + +} +#endif + + + +#else + +void +phy_iq_calibrate_8723d( + void *p_dm_void, + boolean is_recovery +) {} +void +phy_lc_calibrate_8723d( + void *p_dm_void +) {} + +void +odm_tx_pwr_track_set_pwr_8723d( + struct PHY_DM_STRUCT *p_dm, + enum pwrtrack_method method, + u8 rf_path, + u8 channel_mapped_index +) {} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.h new file mode 100644 index 000000000000..614004d370a2 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/halrf/rtl8723d/halrf_8723d.h @@ -0,0 +1,130 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __HAL_PHY_RF_8723D_H__ +#define __HAL_PHY_RF_8723D_H__ + +/*--------------------------Define Parameters-------------------------------*/ +#define IQK_DELAY_TIME_8723D 10 /* ms */ +#define index_mapping_NUM_8723D 15 +#define AVG_THERMAL_NUM_8723D 4 +#define RF_T_METER_8723D 0x42 + +void configure_txpower_track_8723d( + struct _TXPWRTRACK_CFG *p_config +); + +void +get_delta_swing_table_8723d( + void *p_dm_void, + u8 **temperature_up_a, + u8 **temperature_down_a, + u8 **temperature_up_b, + u8 **temperature_down_b +); + +void +set_cck_filter_coefficient_8723d( + struct PHY_DM_STRUCT *p_dm, + u8 cck_swing_index +); + +void do_iqk_8723d( + void *p_dm_void, + u8 delta_thermal_index, + u8 thermal_value, + u8 threshold +); + +void +odm_tx_pwr_track_set_pwr_8723d( + void *p_dm_void, + enum pwrtrack_method method, + u8 rf_path, + u8 channel_mapped_index +); + +void +odm_txxtaltrack_set_xtal_8723d( + void *p_dm_void +); + +/* 1 7. IQK */ + +void +phy_iq_calibrate_8723d( + void *p_dm_void, + boolean is_recovery); + + +/* + * LC calibrate + * */ +void +phy_lc_calibrate_8723d( + void *p_dm_void +); + + +void phy_set_rf_path_switch_8723d( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm, +#else + struct _ADAPTER *p_adapter, +#endif + boolean is_main +); + +#if 0 +/* + * AP calibrate + * */ +void +phy_ap_calibrate_8723d( +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct PHY_DM_STRUCT *p_dm, +#else + struct _ADAPTER *p_adapter, +#endif + s8 delta); +void +phy_digital_predistortion_8723d(struct _ADAPTER *p_adapter); +#endif + +void +_phy_save_adda_registers_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *adda_reg, + u32 *adda_backup, + u32 register_num +); + +void +_phy_path_adda_on_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *adda_reg, + boolean is_path_a_on, + boolean is2T +); + +void +_phy_mac_setting_calibration_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 *mac_reg, + u32 *mac_backup +); + + +#endif /* #ifndef __HAL_PHY_RF_8723D_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/mp_precomp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/mp_precomp.h index 2ae81105aaa6..99ca5f4e1a76 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/mp_precomp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/mp_precomp.h @@ -1,20 +1,14 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.c index 72338999fc53..63a1194fae38 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.c @@ -1,3340 +1,3066 @@ -/****************************************************************************** - * - * 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 files -//============================================================ - -#include "mp_precomp.h" -#include "phydm_precomp.h" - -const u2Byte dB_Invert_Table[12][8] = { - { 1, 1, 1, 2, 2, 2, 2, 3}, - { 3, 3, 4, 4, 4, 5, 6, 6}, - { 7, 8, 9, 10, 11, 13, 14, 16}, - { 18, 20, 22, 25, 28, 32, 35, 40}, - { 45, 50, 56, 63, 71, 79, 89, 100}, - { 112, 126, 141, 158, 178, 200, 224, 251}, - { 282, 316, 355, 398, 447, 501, 562, 631}, - { 708, 794, 891, 1000, 1122, 1259, 1413, 1585}, - { 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, - { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000}, - { 11220, 12589, 14125, 15849, 17783, 19953, 22387, 25119}, - { 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535} -}; - - -//============================================================ -// Local Function predefine. -//============================================================ - -/* START------------COMMON INFO RELATED--------------- */ - -VOID -odm_GlobalAdapterCheck( - IN VOID - ); - -//move to odm_PowerTacking.h by YuChen - - - -VOID -odm_UpdatePowerTrainingState( - IN PDM_ODM_T pDM_Odm -); - -//============================================================ -//3 Export Interface -//============================================================ - -/*Y = 10*log(X)*/ -s4Byte -ODM_PWdB_Conversion( - IN s4Byte X, - IN u4Byte TotalBit, - IN u4Byte DecimalBit - ) -{ - s4Byte Y, integer = 0, decimal = 0; - u4Byte i; - - if(X == 0) - X = 1; // log2(x), x can't be 0 - - for(i = (TotalBit-1); i > 0; i--) - { - if(X & BIT(i)) - { - integer = i; - if(i > 0) - decimal = (X & BIT(i-1))?2:0; //decimal is 0.5dB*3=1.5dB~=2dB - break; - } - } - - Y = 3*(integer-DecimalBit)+decimal; //10*log(x)=3*log2(x), - - return Y; -} - -s4Byte -ODM_SignConversion( - IN s4Byte value, - IN u4Byte TotalBit - ) -{ - if(value&BIT(TotalBit-1)) - value -= BIT(TotalBit); - return value; -} - -void -phydm_seq_sorting( - IN PVOID pDM_VOID, - IN OUT u4Byte *p_value, - IN OUT u4Byte *rank_idx, - IN OUT u4Byte *p_idx_out, - IN u1Byte seq_length -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0 , j = 0; - u4Byte tmp_a, tmp_b; - u4Byte tmp_idx_a, tmp_idx_b; - - for (i = 0; i < seq_length; i++) { - rank_idx[i] = i; - /**/ - } - - for (i = 0; i < (seq_length - 1); i++) { - - for (j = 0; j < (seq_length - 1 - i); j++) { - - tmp_a = p_value[j]; - tmp_b = p_value[j+1]; - - tmp_idx_a = rank_idx[j]; - tmp_idx_b = rank_idx[j+1]; - - if (tmp_a < tmp_b) { - p_value[j] = tmp_b; - p_value[j+1] = tmp_a; - - rank_idx[j] = tmp_idx_b; - rank_idx[j+1] = tmp_idx_a; - } - } - } - - for (i = 0; i < seq_length; i++) { - p_idx_out[rank_idx[i]] = i+1; - /**/ - } - - - -} - -VOID -ODM_InitMpDriverStatus( - IN PDM_ODM_T pDM_Odm -) -{ -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - - // Decide when compile time - #if(MP_DRIVER == 1) - pDM_Odm->mp_mode = TRUE; - #else - pDM_Odm->mp_mode = FALSE; - #endif - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - - PADAPTER Adapter = pDM_Odm->Adapter; - - // Update information every period - pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; - -#else - - prtl8192cd_priv priv = pDM_Odm->priv; - - pDM_Odm->mp_mode = (BOOLEAN)priv->pshare->rf_ft_var.mp_specific; - -#endif -} - -VOID -ODM_UpdateMpDriverStatus( - IN PDM_ODM_T pDM_Odm -) -{ -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - - // Do nothing. - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - - // Update information erery period - pDM_Odm->mp_mode = (BOOLEAN)Adapter->registrypriv.mp_mode; - -#else - - // Do nothing. - -#endif -} - -VOID -PHYDM_InitTRXAntennaSetting( - IN PDM_ODM_T pDM_Odm -) -{ -/*#if (RTL8814A_SUPPORT == 1)*/ - - if (pDM_Odm->SupportICType & (ODM_RTL8814A)) { - u1Byte RxAnt = 0, TxAnt = 0; - - RxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH, pDM_Odm), ODM_BIT(BB_RX_PATH, pDM_Odm)); - TxAnt = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_TX_PATH, pDM_Odm), ODM_BIT(BB_TX_PATH, pDM_Odm)); - pDM_Odm->TXAntStatus = (TxAnt & 0xf); - pDM_Odm->RXAntStatus = (RxAnt & 0xf); - } else if (pDM_Odm->SupportICType & (ODM_RTL8723D | ODM_RTL8821C)) { - pDM_Odm->TXAntStatus = 0x1; - pDM_Odm->RXAntStatus = 0x1; - - } -/*#endif*/ -} - -void -phydm_traffic_load_decision( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - - /*---TP & Trafic-load calculation---*/ - - if (pDM_Odm->lastTxOkCnt > (*(pDM_Odm->pNumTxBytesUnicast))) - pDM_Odm->lastTxOkCnt = (*(pDM_Odm->pNumTxBytesUnicast)); - - if (pDM_Odm->lastRxOkCnt > (*(pDM_Odm->pNumRxBytesUnicast))) - pDM_Odm->lastRxOkCnt = (*(pDM_Odm->pNumRxBytesUnicast)); - - pDM_Odm->curTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast) - pDM_Odm->lastTxOkCnt; - pDM_Odm->curRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast) - pDM_Odm->lastRxOkCnt; - pDM_Odm->lastTxOkCnt = *(pDM_Odm->pNumTxBytesUnicast); - pDM_Odm->lastRxOkCnt = *(pDM_Odm->pNumRxBytesUnicast); - - #if (DM_ODM_SUPPORT_TYPE & ODM_AP) - pDM_Odm->tx_tp = ((pDM_Odm->tx_tp)>>1) + (u4Byte)(((pDM_Odm->curTxOkCnt)>>17)>>1); /* <<3(8bit), >>20(10^6,M)*/ - pDM_Odm->rx_tp = ((pDM_Odm->rx_tp)>>1) + (u4Byte)(((pDM_Odm->curRxOkCnt)>>17)>>1); /* <<3(8bit), >>20(10^6,M)*/ - #else - pDM_Odm->tx_tp = ((pDM_Odm->tx_tp)>>1) + (u4Byte)(((pDM_Odm->curTxOkCnt)>>18)>>1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ - pDM_Odm->rx_tp = ((pDM_Odm->rx_tp)>>1) + (u4Byte)(((pDM_Odm->curRxOkCnt)>>18)>>1); /* <<3(8bit), >>20(10^6,M), >>1(2sec)*/ - #endif - pDM_Odm->total_tp = pDM_Odm->tx_tp + pDM_Odm->rx_tp; - - /* - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("curTxOkCnt = %d, curRxOkCnt = %d, lastTxOkCnt = %d, lastRxOkCnt = %d\n", - pDM_Odm->curTxOkCnt, pDM_Odm->curRxOkCnt, pDM_Odm->lastTxOkCnt, pDM_Odm->lastRxOkCnt)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("tx_tp = %d, rx_tp = %d\n", - pDM_Odm->tx_tp, pDM_Odm->rx_tp)); - */ - - pDM_Odm->pre_TrafficLoad = pDM_Odm->TrafficLoad; - - if (pDM_Odm->curTxOkCnt > 1875000 || pDM_Odm->curRxOkCnt > 1875000) { /* ( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/ - - pDM_Odm->TrafficLoad = TRAFFIC_HIGH; - /**/ - } else if (pDM_Odm->curTxOkCnt > 500000 || pDM_Odm->curRxOkCnt > 500000) { /*( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/ - - pDM_Odm->TrafficLoad = TRAFFIC_MID; - /**/ - } else if (pDM_Odm->curTxOkCnt > 100000 || pDM_Odm->curRxOkCnt > 100000) { /*( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/ - - pDM_Odm->TrafficLoad = TRAFFIC_LOW; - /**/ - } else { - - pDM_Odm->TrafficLoad = TRAFFIC_ULTRA_LOW; - /**/ - } -} - -VOID -phydm_config_ofdm_tx_path( - IN PDM_ODM_T pDM_Odm, - IN u4Byte path -) -{ - u1Byte ofdm_rx_path; - - #if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { - - if (path == PHYDM_A) { - ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x81121111); - /**/ - } else if (path == PHYDM_B) { - ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x82221222); - /**/ - } else if (path == PHYDM_AB) { - ODM_SetBBReg(pDM_Odm, 0x90c , bMaskDWord, 0x83321333); - /**/ - } - - - } - #endif -} - -VOID -phydm_config_ofdm_rx_path( - IN PDM_ODM_T pDM_Odm, - IN u4Byte path -) -{ - u1Byte ofdm_rx_path = 0; - - #if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { - - if (path == PHYDM_A) { - ofdm_rx_path = 1; - /**/ - } else if (path == PHYDM_B) { - ofdm_rx_path = 2; - /**/ - } else if (path == PHYDM_AB) { - ofdm_rx_path = 3; - /**/ - } - - ODM_SetBBReg(pDM_Odm, 0xC04 , 0xff, (((ofdm_rx_path)<<4)|ofdm_rx_path)); - ODM_SetBBReg(pDM_Odm, 0xD04 , 0xf, ofdm_rx_path); - } - #endif -} - -VOID -phydm_config_cck_rx_antenna_init( - IN PDM_ODM_T pDM_Odm -) -{ - #if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { - - /*CCK 2R CCA parameters*/ - ODM_SetBBReg(pDM_Odm, 0xa2c , BIT18, 1); /*enable 2R Rx path*/ - ODM_SetBBReg(pDM_Odm, 0xa2c , BIT22, 1); /*enable 2R MRC*/ - ODM_SetBBReg(pDM_Odm, 0xa84 , BIT28, 1); /*1. pdx1[5:0] > 2*PD_lim 2. RXIQ_3 = 0 ( signed )*/ - ODM_SetBBReg(pDM_Odm, 0xa70 , BIT7, 0); /*Concurrent CCA at LSB & USB*/ - ODM_SetBBReg(pDM_Odm, 0xa74 , BIT8, 0); /*RX path diversity enable*/ - ODM_SetBBReg(pDM_Odm, 0xa08 , BIT28, 1); /* r_cck_2nd_sel_eco*/ - ODM_SetBBReg(pDM_Odm, 0xa14 , BIT7, 0); /* r_en_mrc_antsel*/ - } - #endif -} - -VOID -phydm_config_cck_rx_path( - IN PDM_ODM_T pDM_Odm, - IN u1Byte path, - IN u1Byte path_div_en -) -{ - u1Byte path_div_select = 0; - u1Byte cck_1_path = 0, cck_2_path = 0; - - #if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { - - if (path == PHYDM_A) { - path_div_select = 0; - cck_1_path = 0; - cck_2_path = 0; - } else if (path == PHYDM_B) { - path_div_select = 0; - cck_1_path = 1; - cck_2_path = 1; - } else if (path == PHYDM_AB) { - - if (path_div_en == CCA_PATHDIV_ENABLE) - path_div_select = 1; - - cck_1_path = 0; - cck_2_path = 1; - - } - - ODM_SetBBReg(pDM_Odm, 0xa04 , (BIT27|BIT26), cck_1_path); - ODM_SetBBReg(pDM_Odm, 0xa04 , (BIT25|BIT24), cck_2_path); - ODM_SetBBReg(pDM_Odm, 0xa74 , BIT8, path_div_select); - - } - #endif -} - -VOID -phydm_config_trx_path( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte pre_support_ability; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - /* CCK */ - if (dm_value[0] == 0) { - - if (dm_value[1] == 1) { /*TX*/ - if (dm_value[2] == 1) - ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0x8); - else if (dm_value[2] == 2) - ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0x4); - else if (dm_value[2] == 3) - ODM_SetBBReg(pDM_Odm, 0xa04, 0xf0000000, 0xc); - } else if (dm_value[1] == 2) { /*RX*/ - - phydm_config_cck_rx_antenna_init(pDM_Odm); - - if (dm_value[2] == 1) { - phydm_config_cck_rx_path(pDM_Odm, PHYDM_A, CCA_PATHDIV_DISABLE); - } else if (dm_value[2] == 2) { - phydm_config_cck_rx_path(pDM_Odm, PHYDM_B, CCA_PATHDIV_DISABLE); - } else if (dm_value[2] == 3) { - if (dm_value[3] == 1) /*enable path diversity*/ - phydm_config_cck_rx_path(pDM_Odm, PHYDM_AB, CCA_PATHDIV_ENABLE); - else - phydm_config_cck_rx_path(pDM_Odm, PHYDM_B, CCA_PATHDIV_DISABLE); - } - } - } - /* OFDM */ - else if (dm_value[0] == 1) { - - if (dm_value[1] == 1) { /*TX*/ - phydm_config_ofdm_tx_path(pDM_Odm, dm_value[2]); - /**/ - } else if (dm_value[1] == 2) { /*RX*/ - phydm_config_ofdm_rx_path(pDM_Odm, dm_value[2]); - /**/ - } - } - - PHYDM_SNPRINTF((output+used, out_len-used, "PHYDM Set Path [%s] [%s] = [%s%s%s%s]\n", - (dm_value[0] == 1) ? "OFDM" : "CCK", - (dm_value[1] == 1) ? "TX" : "RX", - (dm_value[2] & 0x1)?"A":"", - (dm_value[2] & 0x2)?"B":"", - (dm_value[2] & 0x4)?"C":"", - (dm_value[2] & 0x8)?"D":"" - )); - -} - -VOID -phydm_Init_cck_setting( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte value_824,value_82c; - - pDM_Odm->bCckHighPower = (BOOLEAN) ODM_GetBBReg(pDM_Odm, ODM_REG(CCK_RPT_FORMAT,pDM_Odm), ODM_BIT(CCK_RPT_FORMAT,pDM_Odm)); - - #if (RTL8192E_SUPPORT == 1) - if(pDM_Odm->SupportICType & (ODM_RTL8192E)) - { - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - phydm_config_cck_rx_antenna_init(pDM_Odm); - phydm_config_cck_rx_path(pDM_Odm, PHYDM_A, CCA_PATHDIV_DISABLE); - #endif - - /* 0x824[9] = 0x82C[9] = 0xA80[7] those registers setting should be equal or CCK RSSI report may be incorrect */ - value_824 = ODM_GetBBReg(pDM_Odm, 0x824, BIT9); - value_82c = ODM_GetBBReg(pDM_Odm, 0x82c, BIT9); - - if(value_824 != value_82c) - { - ODM_SetBBReg(pDM_Odm, 0x82c , BIT9, value_824); - } - ODM_SetBBReg(pDM_Odm, 0xa80 , BIT7, value_824); - pDM_Odm->cck_agc_report_type = (BOOLEAN)value_824; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("cck_agc_report_type = (( %d )), ExtLNAGain = (( %d ))\n", pDM_Odm->cck_agc_report_type, pDM_Odm->ExtLNAGain)); - } - #endif - -#if ((RTL8703B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1)) - if (pDM_Odm->SupportICType & (ODM_RTL8703B|ODM_RTL8723D)) { - - pDM_Odm->cck_agc_report_type = ODM_GetBBReg(pDM_Odm, 0x950, BIT11) ? 1 : 0; /*1: 4bit LNA , 0: 3bit LNA */ - - if (pDM_Odm->cck_agc_report_type != 1) { - DbgPrint("[Warning] 8703B/8723D CCK should be 4bit LNA, ie. 0x950[11] = 1\n"); - /**/ - } - } -#endif - -#if ((RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) - - if (pDM_Odm->SupportICType & (ODM_RTL8723D|ODM_RTL8822B|ODM_RTL8197F)) { - pDM_Odm->cck_new_agc = ODM_GetBBReg(pDM_Odm, 0xa9c, BIT17)?TRUE:FALSE; /*1: new agc 0: old agc*/ - } else -#endif - pDM_Odm->cck_new_agc = FALSE; - -} - -VOID -PHYDM_InitSoftMLSetting( - IN PDM_ODM_T pDM_Odm -) -{ -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->mp_mode == FALSE) { - if (pDM_Odm->SupportICType & ODM_RTL8822B) - ODM_SetBBReg(pDM_Odm, 0x19a8, bMaskDWord, 0xc10a0000); - } -#endif -} - -VOID -PHYDM_InitHwInfoByRfe( - IN PDM_ODM_T pDM_Odm -) -{ -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8822B) - phydm_init_hw_info_by_rfe_type_8822b(pDM_Odm); -#endif -} - -VOID -odm_CommonInfoSelfInit( - IN PDM_ODM_T pDM_Odm - ) -{ - phydm_Init_cck_setting(pDM_Odm); - pDM_Odm->RFPathRxEnable = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(BB_RX_PATH,pDM_Odm), ODM_BIT(BB_RX_PATH,pDM_Odm)); -#if (DM_ODM_SUPPORT_TYPE != ODM_CE) - pDM_Odm->pbNet_closed = &pDM_Odm->BOOLEAN_temp; - - PHYDM_InitDebugSetting(pDM_Odm); -#endif - ODM_InitMpDriverStatus(pDM_Odm); - PHYDM_InitTRXAntennaSetting(pDM_Odm); - PHYDM_InitSoftMLSetting(pDM_Odm); - - pDM_Odm->phydm_period = PHYDM_WATCH_DOG_PERIOD; - pDM_Odm->phydm_sys_up_time = 0; - - if (pDM_Odm->SupportICType & ODM_IC_1SS) - pDM_Odm->num_rf_path = 1; - else if (pDM_Odm->SupportICType & ODM_IC_2SS) - pDM_Odm->num_rf_path = 2; - else if(pDM_Odm->SupportICType & ODM_IC_3SS ) - pDM_Odm->num_rf_path = 3; - else if(pDM_Odm->SupportICType & ODM_IC_4SS ) - pDM_Odm->num_rf_path = 4; - - pDM_Odm->TxRate = 0xFF; - - pDM_Odm->number_linked_client = 0; - pDM_Odm->pre_number_linked_client = 0; - pDM_Odm->number_active_client = 0; - pDM_Odm->pre_number_active_client = 0; - - pDM_Odm->lastTxOkCnt = 0; - pDM_Odm->lastRxOkCnt = 0; - pDM_Odm->tx_tp = 0; - pDM_Odm->rx_tp = 0; - pDM_Odm->total_tp = 0; - pDM_Odm->TrafficLoad = TRAFFIC_LOW; - - pDM_Odm->nbi_set_result = 0; - -} - -VOID -odm_CommonInfoSelfUpdate( - IN PDM_ODM_T pDM_Odm - ) -{ - u1Byte EntryCnt = 0, num_active_client = 0; - u4Byte i, OneEntry_MACID = 0, ma_rx_tp = 0; - PSTA_INFO_T pEntry; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - - pEntry = pDM_Odm->pODM_StaInfo[0]; - if (pMgntInfo->mAssoc) { - pEntry->bUsed = TRUE; - for (i = 0; i < 6; i++) - pEntry->MacAddr[i] = pMgntInfo->Bssid[i]; - } else if (GetFirstClientPort(Adapter)) { - PADAPTER pClientAdapter = GetFirstClientPort(Adapter); - - pEntry->bUsed = TRUE; - for (i = 0; i < 6; i++) - pEntry->MacAddr[i] = pClientAdapter->MgntInfo.Bssid[i]; - } else { - pEntry->bUsed = FALSE; - for (i = 0; i < 6; i++) - pEntry->MacAddr[i] = 0; - } - - //STA mode is linked to AP - if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[0]) && !ACTING_AS_AP(Adapter)) - pDM_Odm->bsta_state = TRUE; - else - pDM_Odm->bsta_state = FALSE; -#endif - -/* THis variable cannot be used because it is wrong*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - if (*(pDM_Odm->pBandWidth) == ODM_BW40M) - { - if (*(pDM_Odm->pSecChOffset) == 1) - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; - else if (*(pDM_Odm->pSecChOffset) == 2) - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; - } else if (*(pDM_Odm->pBandWidth) == ODM_BW80M) { - if (*(pDM_Odm->pSecChOffset) == 1) - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 6; - else if (*(pDM_Odm->pSecChOffset) == 2) - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 6; - } else - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -#else - if (*(pDM_Odm->pBandWidth) == ODM_BW40M) { - if (*(pDM_Odm->pSecChOffset) == 1) - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) - 2; - else if (*(pDM_Odm->pSecChOffset) == 2) - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel) + 2; - } else - pDM_Odm->ControlChannel = *(pDM_Odm->pChannel); -#endif - - for (i=0; ipODM_StaInfo[i]; - if(IS_STA_VALID(pEntry)) - { - EntryCnt++; - if(EntryCnt==1) - { - OneEntry_MACID=i; - } - - #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - ma_rx_tp = (pEntry->rx_byte_cnt_LowMAW)<<3; /* low moving average RX TP ( bit /sec)*/ - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("ClientTP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp)); - - if (ma_rx_tp > ACTIVE_TP_THRESHOLD) - num_active_client++; - #endif - } - } - - if(EntryCnt == 1) - { - pDM_Odm->bOneEntryOnly = TRUE; - pDM_Odm->OneEntry_MACID=OneEntry_MACID; - } - else - pDM_Odm->bOneEntryOnly = FALSE; - - pDM_Odm->pre_number_linked_client = pDM_Odm->number_linked_client; - pDM_Odm->pre_number_active_client = pDM_Odm->number_active_client; - - pDM_Odm->number_linked_client = EntryCnt; - pDM_Odm->number_active_client = num_active_client; - - /* Update MP driver status*/ - ODM_UpdateMpDriverStatus(pDM_Odm); - - /*Traffic load information update*/ - phydm_traffic_load_decision(pDM_Odm); - - pDM_Odm->phydm_sys_up_time += pDM_Odm->phydm_period; -} - -VOID -odm_CommonInfoSelfReset( - IN PDM_ODM_T pDM_Odm - ) -{ -#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pDM_Odm->PhyDbgInfo.NumQryBeaconPkt = 0; -#endif -} - -PVOID -PhyDM_Get_Structure( - IN PDM_ODM_T pDM_Odm, - IN u1Byte Structure_Type -) - -{ - PVOID pStruct = NULL; -#if RTL8195A_SUPPORT - switch (Structure_Type){ - case PHYDM_FALSEALMCNT: - pStruct = &FalseAlmCnt; - break; - - case PHYDM_CFOTRACK: - pStruct = &DM_CfoTrack; - break; - - case PHYDM_ADAPTIVITY: - pStruct = &(pDM_Odm->Adaptivity); - break; - - default: - break; - } - -#else - switch (Structure_Type){ - case PHYDM_FALSEALMCNT: - pStruct = &(pDM_Odm->FalseAlmCnt); - break; - - case PHYDM_CFOTRACK: - pStruct = &(pDM_Odm->DM_CfoTrack); - break; - - case PHYDM_ADAPTIVITY: - pStruct = &(pDM_Odm->Adaptivity); - break; - - default: - break; - } - -#endif - return pStruct; -} - -VOID -odm_HWSetting( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (RTL8821A_SUPPORT == 1) - if(pDM_Odm->SupportICType & ODM_RTL8821) - odm_HWSetting_8821A(pDM_Odm); -#endif - -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) - phydm_hwsetting_8814a(pDM_Odm); -#endif -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8822B) - phydm_hwsetting_8822b(pDM_Odm); -#endif -} -#if SUPPORTABLITY_PHYDMLIZE -VOID -phydm_supportability_Init( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte support_ability = 0; - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - #endif - - if (pDM_Odm->SupportICType != ODM_RTL8821C) - return; - - switch (pDM_Odm->SupportICType) - { - - /*---------------N Series--------------------*/ - case ODM_RTL8188E: - support_ability |= - ODM_BB_DIG | - ODM_BB_RA_MASK | - ODM_BB_DYNAMIC_TXPWR | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_CCK_PD | - ODM_RF_TX_PWR_TRACK | - ODM_RF_RX_GAIN_TRACK | - ODM_RF_CALIBRATION | - ODM_MAC_EDCA_TURBO | - ODM_MAC_EARLY_MODE | - ODM_BB_CFO_TRACKING | - ODM_BB_NHM_CNT | - ODM_BB_PRIMARY_CCA; - break; - - case ODM_RTL8192E: - support_ability |= - ODM_BB_DIG | - ODM_RF_TX_PWR_TRACK | - ODM_BB_RA_MASK | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_MAC_EDCA_TURBO | - ODM_BB_CFO_TRACKING | -/* ODM_BB_PWR_TRAIN |*/ - ODM_BB_NHM_CNT | - ODM_BB_PRIMARY_CCA; - break; - - case ODM_RTL8723B: - support_ability |= - ODM_BB_DIG | - ODM_BB_RA_MASK | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_CCK_PD | - ODM_RF_TX_PWR_TRACK | - ODM_RF_RX_GAIN_TRACK | - ODM_RF_CALIBRATION | - ODM_MAC_EDCA_TURBO | - ODM_BB_CFO_TRACKING | -/* ODM_BB_PWR_TRAIN |*/ - ODM_BB_NHM_CNT; - break; - - case ODM_RTL8703B: - support_ability |= - ODM_BB_DIG | - ODM_BB_RA_MASK | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_CCK_PD | - ODM_BB_CFO_TRACKING | - //ODM_BB_PWR_TRAIN | - ODM_BB_NHM_CNT | - ODM_RF_TX_PWR_TRACK | - //ODM_RF_RX_GAIN_TRACK | - ODM_RF_CALIBRATION | - ODM_MAC_EDCA_TURBO; - break; - - case ODM_RTL8723D: - support_ability |= - ODM_BB_DIG | - ODM_BB_RA_MASK | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_CCK_PD | - ODM_BB_CFO_TRACKING | - //ODM_BB_PWR_TRAIN | - ODM_BB_NHM_CNT | - ODM_RF_TX_PWR_TRACK | - //ODM_RF_RX_GAIN_TRACK | - //ODM_RF_CALIBRATION | - ODM_MAC_EDCA_TURBO; - break; - - case ODM_RTL8188F: - support_ability |= - ODM_BB_DIG | - ODM_BB_RA_MASK | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_CCK_PD | - ODM_MAC_EDCA_TURBO | - ODM_BB_CFO_TRACKING | - ODM_BB_NHM_CNT | - ODM_RF_TX_PWR_TRACK | - ODM_RF_CALIBRATION; - break; - /*---------------AC Series-------------------*/ - - case ODM_RTL8812: - case ODM_RTL8821: - support_ability |= - ODM_BB_DIG | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_RA_MASK | - ODM_RF_TX_PWR_TRACK | - ODM_MAC_EDCA_TURBO | - ODM_BB_CFO_TRACKING | -/* ODM_BB_PWR_TRAIN |*/ - ODM_BB_DYNAMIC_TXPWR | - ODM_BB_NHM_CNT; - break; - - case ODM_RTL8814A: - support_ability |= - ODM_BB_DIG | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_RA_MASK | - ODM_RF_TX_PWR_TRACK | - ODM_BB_CCK_PD | - ODM_MAC_EDCA_TURBO | - ODM_BB_CFO_TRACKING | - ODM_BB_DYNAMIC_TXPWR | - ODM_BB_NHM_CNT; - break; - - case ODM_RTL8822B: - support_ability |= - ODM_BB_DIG | - ODM_BB_FA_CNT | - ODM_BB_CCK_PD | - ODM_BB_CFO_TRACKING | - ODM_BB_RATE_ADAPTIVE | - ODM_BB_RSSI_MONITOR | - ODM_BB_RA_MASK | - ODM_RF_TX_PWR_TRACK | - ODM_MAC_EDCA_TURBO; - break; - - case ODM_RTL8821C: - support_ability |= - ODM_BB_DIG | - ODM_BB_RA_MASK | - ODM_BB_CCK_PD | - ODM_BB_FA_CNT | - ODM_BB_RSSI_MONITOR | - ODM_BB_RATE_ADAPTIVE | - ODM_RF_TX_PWR_TRACK | - ODM_MAC_EDCA_TURBO | - ODM_BB_CFO_TRACKING; //| -/* ODM_BB_DYNAMIC_TXPWR |*/ -/* ODM_BB_NHM_CNT;*/ - break; - default: - DbgPrint("[Warning] Supportability Init error !!!\n"); - break; - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + + +const u16 phy_rate_table[] = { /*20M*/ + 1, 2, 5, 11, + 6, 9, 12, 18, 24, 36, 48, 54, + 6, 13, 19, 26, 39, 52, 58, 65, /*MCS0~7*/ + 13, 26, 39, 52, 78, 104, 117, 130 /*MCS8~15*/ +}; + +void +phydm_traffic_load_decision( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 bit_shift_num = 0; + + /*---TP & Trafic-load calculation---*/ + + if (p_dm->last_tx_ok_cnt > (*(p_dm->p_num_tx_bytes_unicast))) + p_dm->last_tx_ok_cnt = (*(p_dm->p_num_tx_bytes_unicast)); + + if (p_dm->last_rx_ok_cnt > (*(p_dm->p_num_rx_bytes_unicast))) + p_dm->last_rx_ok_cnt = (*(p_dm->p_num_rx_bytes_unicast)); + + p_dm->cur_tx_ok_cnt = *(p_dm->p_num_tx_bytes_unicast) - p_dm->last_tx_ok_cnt; + p_dm->cur_rx_ok_cnt = *(p_dm->p_num_rx_bytes_unicast) - p_dm->last_rx_ok_cnt; + p_dm->last_tx_ok_cnt = *(p_dm->p_num_tx_bytes_unicast); + p_dm->last_rx_ok_cnt = *(p_dm->p_num_rx_bytes_unicast); + + bit_shift_num = 17 + (PHYDM_WATCH_DOG_PERIOD - 1); /*AP: <<3(8bit), >>20(10^6,M), >>0(1sec)*/ + /*WIN&CE: <<3(8bit), >>20(10^6,M), >>1(2sec)*/ + + p_dm->tx_tp = ((p_dm->tx_tp) >> 1) + (u32)(((p_dm->cur_tx_ok_cnt) >> bit_shift_num) >> 1); + p_dm->rx_tp = ((p_dm->rx_tp) >> 1) + (u32)(((p_dm->cur_rx_ok_cnt) >> bit_shift_num) >> 1); + + p_dm->total_tp = p_dm->tx_tp + p_dm->rx_tp; + + /*[Calculate TX/RX state]*/ + if (p_dm->tx_tp > (p_dm->rx_tp << 1)) + p_dm->txrx_state_all = TX_STATE; + else if (p_dm->rx_tp > (p_dm->tx_tp << 1)) + p_dm->txrx_state_all = RX_STATE; + else + p_dm->txrx_state_all = BI_DIRECTION_STATE; + + /*[Calculate consecutive idlel time]*/ + if (p_dm->total_tp == 0) + p_dm->consecutive_idlel_time += PHYDM_WATCH_DOG_PERIOD; + else + p_dm->consecutive_idlel_time = 0; + + /*[Traffic load decision]*/ + p_dm->pre_traffic_load = p_dm->traffic_load; + + if (p_dm->cur_tx_ok_cnt > 1875000 || p_dm->cur_rx_ok_cnt > 1875000) { /* ( 1.875M * 8bit ) / 2sec= 7.5M bits /sec )*/ + + p_dm->traffic_load = TRAFFIC_HIGH; + /**/ + } else if (p_dm->cur_tx_ok_cnt > 500000 || p_dm->cur_rx_ok_cnt > 500000) { /*( 0.5M * 8bit ) / 2sec = 2M bits /sec )*/ + + p_dm->traffic_load = TRAFFIC_MID; + /**/ + } else if (p_dm->cur_tx_ok_cnt > 100000 || p_dm->cur_rx_ok_cnt > 100000) { /*( 0.1M * 8bit ) / 2sec = 0.4M bits /sec )*/ + + p_dm->traffic_load = TRAFFIC_LOW; + /**/ + } else { + + p_dm->traffic_load = TRAFFIC_ULTRA_LOW; + /**/ } - - if(*(pDM_Odm->p_enable_antdiv)) - support_ability |= ODM_BB_ANT_DIV; - - if (*(pDM_Odm->p_enable_adaptivity)) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM Adaptivity is set to Enabled!!!\n")); - - support_ability |= ODM_BB_ADAPTIVITY; - - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE, pMgntInfo->RegEnableCarrierSense); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DCBACKOFF, pMgntInfo->RegDCbackoff); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, pMgntInfo->RegDmLinkAdaptivity); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_AP_NUM_TH, pMgntInfo->RegAPNumTH); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_L2H_INI, pMgntInfo->RegL2HForAdaptivity); - phydm_adaptivityInfoInit(pDM_Odm, PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, pMgntInfo->RegHLDiffForAdaptivity); - #endif - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM Adaptivity is set to disnabled!!!\n")); - /**/ + + /* + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("cur_tx_ok_cnt = %d, cur_rx_ok_cnt = %d, last_tx_ok_cnt = %d, last_rx_ok_cnt = %d\n", + p_dm->cur_tx_ok_cnt, p_dm->cur_rx_ok_cnt, p_dm->last_tx_ok_cnt, p_dm->last_rx_ok_cnt)); + + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("tx_tp = %d, rx_tp = %d\n", + p_dm->tx_tp, p_dm->rx_tp)); + */ + +} + +void +phydm_init_cck_setting( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (RTL8192E_SUPPORT == 1) + u32 value_824, value_82c; +#endif + + p_dm->is_cck_high_power = (boolean) odm_get_bb_reg(p_dm, ODM_REG(CCK_RPT_FORMAT, p_dm), ODM_BIT(CCK_RPT_FORMAT, p_dm)); + + phydm_config_cck_rx_antenna_init(p_dm); + phydm_config_cck_rx_path(p_dm, BB_PATH_A); + +#if (RTL8192E_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8192E)) { + + /* 0x824[9] = 0x82C[9] = 0xA80[7] those registers setting should be equal or CCK RSSI report may be incorrect */ + value_824 = odm_get_bb_reg(p_dm, 0x824, BIT(9)); + value_82c = odm_get_bb_reg(p_dm, 0x82c, BIT(9)); + + if (value_824 != value_82c) + odm_set_bb_reg(p_dm, 0x82c, BIT(9), value_824); + odm_set_bb_reg(p_dm, 0xa80, BIT(7), value_824); + p_dm->cck_agc_report_type = (boolean)value_824; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("cck_agc_report_type = (( %d )), ext_lna_gain = (( %d ))\n", p_dm->cck_agc_report_type, p_dm->ext_lna_gain)); } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHYDM support_ability = ((0x%x))\n", support_ability)); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_ABILITY, support_ability); -} -#endif - -// -// 2011/09/21 MH Add to describe different team necessary resource allocate?? -// -VOID -ODM_DMInit( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); -#endif - - #if SUPPORTABLITY_PHYDMLIZE - phydm_supportability_Init(pDM_Odm); - #endif - odm_CommonInfoSelfInit(pDM_Odm); - odm_DIGInit(pDM_Odm); - Phydm_NHMCounterStatisticsInit(pDM_Odm); - Phydm_AdaptivityInit(pDM_Odm); - phydm_ra_info_init(pDM_Odm); - odm_RateAdaptiveMaskInit(pDM_Odm); - ODM_CfoTrackingInit(pDM_Odm); - ODM_EdcaTurboInit(pDM_Odm); - odm_RSSIMonitorInit(pDM_Odm); - phydm_rf_init(pDM_Odm); - odm_TXPowerTrackingInit(pDM_Odm); - odm_AntennaDiversityInit(pDM_Odm); - odm_AutoChannelSelectInit(pDM_Odm); - odm_PathDiversityInit(pDM_Odm); - odm_DynamicTxPowerInit(pDM_Odm); - phydm_initRaInfo(pDM_Odm); -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if (PHYDM_LA_MODE_SUPPORT == 1) - ADCSmp_Init(pDM_Odm); -#endif -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#ifdef BEAMFORMING_VERSION_1 - if (pHalData->BeamformingVersion == BEAMFORMING_VERSION_1) -#endif - { - phydm_Beamforming_Init(pDM_Odm); - } -#endif - - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { -#if (defined(CONFIG_BB_POWER_SAVING)) - odm_DynamicBBPowerSavingInit(pDM_Odm); -#endif - -#if (RTL8188E_SUPPORT == 1) - if(pDM_Odm->SupportICType==ODM_RTL8188E) - { - ODM_PrimaryCCA_Init(pDM_Odm); - ODM_RAInfo_Init_all(pDM_Odm); - } -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - - #if (RTL8723B_SUPPORT == 1) - if(pDM_Odm->SupportICType == ODM_RTL8723B) - odm_SwAntDetectInit(pDM_Odm); - #endif - - #if (RTL8192E_SUPPORT == 1) - if(pDM_Odm->SupportICType==ODM_RTL8192E) - odm_PrimaryCCA_Check_Init(pDM_Odm); - #endif - -#endif - - } - -} - -VOID -ODM_DMReset( - IN PDM_ODM_T pDM_Odm - ) -{ - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - ODM_AntDivReset(pDM_Odm); - phydm_setEDCCAThresholdAPI(pDM_Odm, pDM_DigTable->CurIGValue); -} - - -VOID -phydm_support_ability_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte pre_support_ability; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - pre_support_ability = pDM_Odm->SupportAbility ; - PHYDM_SNPRINTF((output+used, out_len-used,"\n%s\n", "================================")); - if(dm_value[0] == 100) - { - PHYDM_SNPRINTF((output+used, out_len-used, "[Supportability] PhyDM Selection\n")); - PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); - PHYDM_SNPRINTF((output+used, out_len-used, "00. (( %s ))DIG\n", ((pDM_Odm->SupportAbility & ODM_BB_DIG)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "01. (( %s ))RA_MASK\n", ((pDM_Odm->SupportAbility & ODM_BB_RA_MASK)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "02. (( %s ))DYNAMIC_TXPWR\n", ((pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "03. (( %s ))FA_CNT\n", ((pDM_Odm->SupportAbility & ODM_BB_FA_CNT)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "04. (( %s ))RSSI_MONITOR\n", ((pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "05. (( %s ))CCK_PD\n", ((pDM_Odm->SupportAbility & ODM_BB_CCK_PD)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "06. (( %s ))ANT_DIV\n", ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "08. (( %s ))PWR_TRAIN\n", ((pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "09. (( %s ))RATE_ADAPTIVE\n", ((pDM_Odm->SupportAbility & ODM_BB_RATE_ADAPTIVE)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "10. (( %s ))PATH_DIV\n", ((pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "13. (( %s ))ADAPTIVITY\n", ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "14. (( %s ))CFO_TRACKING\n", ((pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "15. (( %s ))NHM_CNT\n", ((pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "16. (( %s ))PRIMARY_CCA\n", ((pDM_Odm->SupportAbility & ODM_BB_PRIMARY_CCA)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "17. (( %s ))TXBF\n", ((pDM_Odm->SupportAbility & ODM_BB_TXBF)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "18. (( %s ))DYNAMIC_ARFR\n", ((pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ARFR)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "20. (( %s ))EDCA_TURBO\n", ((pDM_Odm->SupportAbility & ODM_MAC_EDCA_TURBO)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "21. (( %s ))EARLY_MODE\n", ((pDM_Odm->SupportAbility & ODM_MAC_EARLY_MODE)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "24. (( %s ))TX_PWR_TRACK\n", ((pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "25. (( %s ))RX_GAIN_TRACK\n", ((pDM_Odm->SupportAbility & ODM_RF_RX_GAIN_TRACK)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used, "26. (( %s ))RF_CALIBRATION\n", ((pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)?("V"):(".")))); - PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); - } - /* - else if(dm_value[0] == 101) - { - pDM_Odm->SupportAbility = 0 ; - DbgPrint("Disable all SupportAbility components \n"); - PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "Disable all SupportAbility components")); - } - */ - else - { - - if(dm_value[1] == 1) //enable - { - pDM_Odm->SupportAbility |= BIT(dm_value[0]) ; - if(BIT(dm_value[0]) & ODM_BB_PATH_DIV) - { - odm_PathDiversityInit(pDM_Odm); - } - } - else if(dm_value[1] == 2) //disable - { - pDM_Odm->SupportAbility &= ~(BIT(dm_value[0])) ; - } - else - { - //DbgPrint("\n[Warning!!!] 1:enable, 2:disable \n\n"); - PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "[Warning!!!] 1:enable, 2:disable")); - } - } - PHYDM_SNPRINTF((output+used, out_len-used,"pre-SupportAbility = 0x%x\n", pre_support_ability )); - PHYDM_SNPRINTF((output+used, out_len-used,"Curr-SupportAbility = 0x%x\n", pDM_Odm->SupportAbility )); - PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "================================")); -} - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -// -//tmp modify for LC Only -// -VOID -ODM_DMWatchdog_LPS( - IN PDM_ODM_T pDM_Odm - ) -{ - odm_CommonInfoSelfUpdate(pDM_Odm); - odm_FalseAlarmCounterStatistics(pDM_Odm); - odm_RSSIMonitorCheck(pDM_Odm); - odm_DIGbyRSSI_LPS(pDM_Odm); - odm_CCKPacketDetectionThresh(pDM_Odm); - odm_CommonInfoSelfReset(pDM_Odm); - - if(*(pDM_Odm->pbPowerSaving)==TRUE) - return; -} -#endif -// -// 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. -// You can not add any dummy function here, be care, you can only use DM structure -// to perform any new ODM_DM. -// -VOID -ODM_DMWatchdog( - IN PDM_ODM_T pDM_Odm - ) -{ - odm_CommonInfoSelfUpdate(pDM_Odm); - phydm_BasicDbgMessage(pDM_Odm); - odm_HWSetting(pDM_Odm); - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - { - prtl8192cd_priv priv = pDM_Odm->priv; - if( (priv->auto_channel != 0) && (priv->auto_channel != 2) )//if ACS running, do not do FA/CCA counter read - return; - } -#endif - odm_FalseAlarmCounterStatistics(pDM_Odm); - phydm_NoisyDetection(pDM_Odm); - - odm_RSSIMonitorCheck(pDM_Odm); - - if(*(pDM_Odm->pbPowerSaving) == TRUE) - { - odm_DIGbyRSSI_LPS(pDM_Odm); - { - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); - } - #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - odm_AntennaDiversity(pDM_Odm); /*enable AntDiv in PS mode, request from SD4 Jeff*/ - #endif - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("DMWatchdog in power saving mode\n")); - return; - } - - Phydm_CheckAdaptivity(pDM_Odm); - odm_UpdatePowerTrainingState(pDM_Odm); - odm_DIG(pDM_Odm); - { - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - Phydm_Adaptivity(pDM_Odm, pDM_DigTable->CurIGValue); - } - odm_CCKPacketDetectionThresh(pDM_Odm); - - phydm_ra_info_watchdog(pDM_Odm); - odm_EdcaTurboCheck(pDM_Odm); - odm_PathDiversity(pDM_Odm); - ODM_CfoTracking(pDM_Odm); - odm_DynamicTxPower(pDM_Odm); - odm_AntennaDiversity(pDM_Odm); -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - phydm_Beamforming_Watchdog(pDM_Odm); -#endif - - phydm_rf_watchdog(pDM_Odm); - - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { - -#if (RTL8188E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188E) - ODM_DynamicPrimaryCCA(pDM_Odm); -#endif - -#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - - #if (RTL8192E_SUPPORT == 1) - if(pDM_Odm->SupportICType==ODM_RTL8192E) - odm_DynamicPrimaryCCA_Check(pDM_Odm); - #endif -#endif - } - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - odm_dtc(pDM_Odm); -#endif - - odm_CommonInfoSelfReset(pDM_Odm); - -} - - -// -// Init /.. Fixed HW value. Only init time. -// -VOID -ODM_CmnInfoInit( - IN PDM_ODM_T pDM_Odm, - IN ODM_CMNINFO_E CmnInfo, - IN u4Byte Value - ) -{ - // - // This section is used for init value - // - switch (CmnInfo) - { - // - // Fixed ODM value. - // - case ODM_CMNINFO_ABILITY: - pDM_Odm->SupportAbility = (u4Byte)Value; - break; - - case ODM_CMNINFO_RF_TYPE: - pDM_Odm->RFType = (u1Byte)Value; - break; - - case ODM_CMNINFO_PLATFORM: - pDM_Odm->SupportPlatform = (u1Byte)Value; - break; - - case ODM_CMNINFO_INTERFACE: - pDM_Odm->SupportInterface = (u1Byte)Value; - break; - - case ODM_CMNINFO_MP_TEST_CHIP: - pDM_Odm->bIsMPChip= (u1Byte)Value; - break; - - case ODM_CMNINFO_IC_TYPE: - pDM_Odm->SupportICType = Value; - break; - - case ODM_CMNINFO_CUT_VER: - pDM_Odm->CutVersion = (u1Byte)Value; - break; - - case ODM_CMNINFO_FAB_VER: - pDM_Odm->FabVersion = (u1Byte)Value; - break; - - case ODM_CMNINFO_RFE_TYPE: - pDM_Odm->RFEType = (u1Byte)Value; - PHYDM_InitHwInfoByRfe(pDM_Odm); - break; - - case ODM_CMNINFO_RF_ANTENNA_TYPE: - pDM_Odm->AntDivType= (u1Byte)Value; - break; - - case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH: - pDM_Odm->with_extenal_ant_switch = (u1Byte)Value; - break; - - case ODM_CMNINFO_BE_FIX_TX_ANT: - pDM_Odm->DM_FatTable.b_fix_tx_ant = (u1Byte)Value; - break; - - case ODM_CMNINFO_BOARD_TYPE: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->BoardType = (u1Byte)Value; - break; - - case ODM_CMNINFO_PACKAGE_TYPE: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->PackageType = (u1Byte)Value; - break; - - case ODM_CMNINFO_EXT_LNA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->ExtLNA = (u1Byte)Value; - break; - - case ODM_CMNINFO_5G_EXT_LNA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->ExtLNA5G = (u1Byte)Value; - break; - - case ODM_CMNINFO_EXT_PA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->ExtPA = (u1Byte)Value; - break; - - case ODM_CMNINFO_5G_EXT_PA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->ExtPA5G = (u1Byte)Value; - break; - - case ODM_CMNINFO_GPA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->TypeGPA = (u2Byte)Value; - break; - - case ODM_CMNINFO_APA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->TypeAPA = (u2Byte)Value; - break; - - case ODM_CMNINFO_GLNA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->TypeGLNA = (u2Byte)Value; - break; - - case ODM_CMNINFO_ALNA: - if (!pDM_Odm->bInitHwInfoByRfe) - pDM_Odm->TypeALNA = (u2Byte)Value; - break; - - case ODM_CMNINFO_EXT_TRSW: - pDM_Odm->ExtTRSW = (u1Byte)Value; - break; - case ODM_CMNINFO_EXT_LNA_GAIN: - pDM_Odm->ExtLNAGain = (u1Byte)Value; - break; - case ODM_CMNINFO_PATCH_ID: - pDM_Odm->PatchID = (u1Byte)Value; - break; - case ODM_CMNINFO_BINHCT_TEST: - pDM_Odm->bInHctTest = (BOOLEAN)Value; - break; - case ODM_CMNINFO_BWIFI_TEST: - pDM_Odm->WIFITest = (u1Byte)Value; - break; - case ODM_CMNINFO_SMART_CONCURRENT: - pDM_Odm->bDualMacSmartConcurrent = (BOOLEAN )Value; - break; - case ODM_CMNINFO_DOMAIN_CODE_2G: - pDM_Odm->odm_Regulation2_4G = (u1Byte)Value; - break; - case ODM_CMNINFO_DOMAIN_CODE_5G: - pDM_Odm->odm_Regulation5G = (u1Byte)Value; - break; - case ODM_CMNINFO_CONFIG_BB_RF: - pDM_Odm->ConfigBBRF = (BOOLEAN)Value; - break; - case ODM_CMNINFO_IQKFWOFFLOAD: - pDM_Odm->IQKFWOffload = (u1Byte)Value; - break; - case ODM_CMNINFO_IQKPAOFF: - pDM_Odm->RFCalibrateInfo.bIQKPAoff = (BOOLEAN )Value; - break; - case ODM_CMNINFO_REGRFKFREEENABLE: - pDM_Odm->RFCalibrateInfo.RegRfKFreeEnable = (u1Byte)Value; - break; - case ODM_CMNINFO_RFKFREEENABLE: - pDM_Odm->RFCalibrateInfo.RfKFreeEnable = (u1Byte)Value; - break; - case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE: - pDM_Odm->Normalrxpath = (u1Byte)Value; - break; -#ifdef CONFIG_PHYDM_DFS_MASTER - case ODM_CMNINFO_DFS_REGION_DOMAIN: - pDM_Odm->DFS_RegionDomain = (u1Byte)Value; - break; -#endif - //To remove the compiler warning, must add an empty default statement to handle the other values. - default: - //do nothing - break; - - } - -} - - -VOID -ODM_CmnInfoHook( - IN PDM_ODM_T pDM_Odm, - IN ODM_CMNINFO_E CmnInfo, - IN PVOID pValue - ) -{ - // - // Hook call by reference pointer. - // - switch (CmnInfo) - { - // - // Dynamic call by reference pointer. - // - case ODM_CMNINFO_MAC_PHY_MODE: - pDM_Odm->pMacPhyMode = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_TX_UNI: - pDM_Odm->pNumTxBytesUnicast = (u8Byte *)pValue; - break; - - case ODM_CMNINFO_RX_UNI: - pDM_Odm->pNumRxBytesUnicast = (u8Byte *)pValue; - break; - - case ODM_CMNINFO_WM_MODE: - pDM_Odm->pWirelessMode = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_BAND: - pDM_Odm->pBandType = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_SEC_CHNL_OFFSET: - pDM_Odm->pSecChOffset = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_SEC_MODE: - pDM_Odm->pSecurity = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_BW: - pDM_Odm->pBandWidth = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_CHNL: - pDM_Odm->pChannel = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_DMSP_GET_VALUE: - pDM_Odm->pbGetValueFromOtherMac = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_BUDDY_ADAPTOR: - pDM_Odm->pBuddyAdapter = (PADAPTER *)pValue; - break; - - case ODM_CMNINFO_DMSP_IS_MASTER: - pDM_Odm->pbMasterOfDMSP = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_SCAN: - pDM_Odm->pbScanInProcess = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_POWER_SAVING: - pDM_Odm->pbPowerSaving = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_ONE_PATH_CCA: - pDM_Odm->pOnePathCCA = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_DRV_STOP: - pDM_Odm->pbDriverStopped = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_PNP_IN: - pDM_Odm->pbDriverIsGoingToPnpSetPowerSleep = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_INIT_ON: - pDM_Odm->pinit_adpt_in_progress = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_ANT_TEST: - pDM_Odm->pAntennaTest = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_NET_CLOSED: - pDM_Odm->pbNet_closed = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_FORCED_RATE: - pDM_Odm->pForcedDataRate = (pu2Byte)pValue; - break; - case ODM_CMNINFO_ANT_DIV: - pDM_Odm->p_enable_antdiv = (pu1Byte)pValue; - break; - case ODM_CMNINFO_ADAPTIVITY: - pDM_Odm->p_enable_adaptivity = (pu1Byte)pValue; - break; - case ODM_CMNINFO_FORCED_IGI_LB: - pDM_Odm->pu1ForcedIgiLb = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_P2P_LINK: - pDM_Odm->DM_DigTable.bP2PInProcess = (u1Byte *)pValue; - break; - - case ODM_CMNINFO_IS1ANTENNA: - pDM_Odm->pIs1Antenna = (BOOLEAN *)pValue; - break; - - case ODM_CMNINFO_RFDEFAULTPATH: - pDM_Odm->pRFDefaultPath= (u1Byte *)pValue; - break; - - case ODM_CMNINFO_FCS_MODE: - pDM_Odm->pIsFcsModeEnable = (BOOLEAN *)pValue; - break; - /*add by YuChen for beamforming PhyDM*/ - case ODM_CMNINFO_HUBUSBMODE: - pDM_Odm->HubUsbMode = (u1Byte *)pValue; - break; - case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: - pDM_Odm->pbFwDwRsvdPageInProgress = (BOOLEAN *)pValue; - break; - case ODM_CMNINFO_TX_TP: - pDM_Odm->pCurrentTxTP = (u4Byte *)pValue; - break; - case ODM_CMNINFO_RX_TP: - pDM_Odm->pCurrentRxTP = (u4Byte *)pValue; - break; - case ODM_CMNINFO_SOUNDING_SEQ: - pDM_Odm->pSoundingSeq = (u1Byte *)pValue; - break; -#ifdef CONFIG_PHYDM_DFS_MASTER - case ODM_CMNINFO_DFS_MASTER_ENABLE: - pDM_Odm->dfs_master_enabled = (u1Byte *)pValue; - break; -#endif - case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC: - pDM_Odm->DM_FatTable.pForceTxAntByDesc = (u1Byte *)pValue; - break; - case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA: - pDM_Odm->DM_FatTable.pDefaultS0S1 = (u1Byte *)pValue; - break; - - default: - /*do nothing*/ - break; - - } - -} - - -VOID -ODM_CmnInfoPtrArrayHook( - IN PDM_ODM_T pDM_Odm, - IN ODM_CMNINFO_E CmnInfo, - IN u2Byte Index, - IN PVOID pValue - ) -{ - /*Hook call by reference pointer.*/ - switch (CmnInfo) - { - /*Dynamic call by reference pointer. */ - case ODM_CMNINFO_STA_STATUS: - pDM_Odm->pODM_StaInfo[Index] = (PSTA_INFO_T)pValue; - - if (IS_STA_VALID(pDM_Odm->pODM_StaInfo[Index])) - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->AssociatedMacId] = Index; /*AssociatedMacId are unique bttween different Adapter*/ - #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->aid] = Index; - #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - pDM_Odm->platform2phydm_macid_table[((PSTA_INFO_T)pValue)->mac_id] = Index; - #endif - - break; - //To remove the compiler warning, must add an empty default statement to handle the other values. - default: - //do nothing - break; - } - -} - - -// -// Update Band/CHannel/.. The values are dynamic but non-per-packet. -// -VOID -ODM_CmnInfoUpdate( - IN PDM_ODM_T pDM_Odm, - IN u4Byte CmnInfo, - IN u8Byte Value - ) -{ - // - // This init variable may be changed in run time. - // - switch (CmnInfo) - { - case ODM_CMNINFO_LINK_IN_PROGRESS: - pDM_Odm->bLinkInProcess = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_ABILITY: - pDM_Odm->SupportAbility = (u4Byte)Value; - break; - - case ODM_CMNINFO_RF_TYPE: - pDM_Odm->RFType = (u1Byte)Value; - break; - - case ODM_CMNINFO_WIFI_DIRECT: - pDM_Odm->bWIFI_Direct = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_WIFI_DISPLAY: - pDM_Odm->bWIFI_Display = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_LINK: - pDM_Odm->bLinked = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_STATION_STATE: - pDM_Odm->bsta_state = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_RSSI_MIN: - pDM_Odm->RSSI_Min= (u1Byte)Value; - break; - - case ODM_CMNINFO_DBG_COMP: - pDM_Odm->DebugComponents = (u4Byte)Value; - break; - - case ODM_CMNINFO_DBG_LEVEL: - pDM_Odm->DebugLevel = (u4Byte)Value; - break; - case ODM_CMNINFO_RA_THRESHOLD_HIGH: - pDM_Odm->RateAdaptive.HighRSSIThresh = (u1Byte)Value; - break; - - case ODM_CMNINFO_RA_THRESHOLD_LOW: - pDM_Odm->RateAdaptive.LowRSSIThresh = (u1Byte)Value; - break; -#if defined(BT_SUPPORT) && (BT_SUPPORT == 1) - // The following is for BT HS mode and BT coexist mechanism. - case ODM_CMNINFO_BT_ENABLED: - pDM_Odm->bBtEnabled = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: - pDM_Odm->bBtConnectProcess = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_BT_HS_RSSI: - pDM_Odm->btHsRssi = (u1Byte)Value; - break; - - case ODM_CMNINFO_BT_OPERATION: - pDM_Odm->bBtHsOperation = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_BT_LIMITED_DIG: - pDM_Odm->bBtLimitedDig = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_BT_DIG: - pDM_Odm->btHsDigVal = (u1Byte)Value; - break; - - case ODM_CMNINFO_BT_BUSY: - pDM_Odm->bBtBusy = (BOOLEAN)Value; - break; - - case ODM_CMNINFO_BT_DISABLE_EDCA: - pDM_Odm->bBtDisableEdcaTurbo = (BOOLEAN)Value; - break; -#endif - -#if(DM_ODM_SUPPORT_TYPE & ODM_AP) // for repeater mode add by YuChen 2014.06.23 -#ifdef UNIVERSAL_REPEATER - case ODM_CMNINFO_VXD_LINK: - pDM_Odm->VXD_bLinked= (BOOLEAN)Value; - break; -#endif -#endif - - case ODM_CMNINFO_AP_TOTAL_NUM: - pDM_Odm->APTotalNum = (u1Byte)Value; - break; - - case ODM_CMNINFO_POWER_TRAINING: - pDM_Odm->bDisablePowerTraining = (BOOLEAN)Value; - break; - -#ifdef CONFIG_PHYDM_DFS_MASTER - case ODM_CMNINFO_DFS_REGION_DOMAIN: - pDM_Odm->DFS_RegionDomain = (u1Byte)Value; - break; -#endif - -/* - case ODM_CMNINFO_OP_MODE: - pDM_Odm->OPMode = (u1Byte)Value; - break; - - case ODM_CMNINFO_WM_MODE: - pDM_Odm->WirelessMode = (u1Byte)Value; - break; - - case ODM_CMNINFO_BAND: - pDM_Odm->BandType = (u1Byte)Value; - break; - - case ODM_CMNINFO_SEC_CHNL_OFFSET: - pDM_Odm->SecChOffset = (u1Byte)Value; - break; - - case ODM_CMNINFO_SEC_MODE: - pDM_Odm->Security = (u1Byte)Value; - break; - - case ODM_CMNINFO_BW: - pDM_Odm->BandWidth = (u1Byte)Value; - break; - - case ODM_CMNINFO_CHNL: - pDM_Odm->Channel = (u1Byte)Value; - break; -*/ - default: - //do nothing - break; - } - - -} - -u4Byte -PHYDM_CmnInfoQuery( - IN PDM_ODM_T pDM_Odm, - IN PHYDM_INFO_QUERY_E info_type - ) -{ - PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_FALSEALMCNT); - - switch (info_type) { - case PHYDM_INFO_FA_OFDM: - return FalseAlmCnt->Cnt_Ofdm_fail; - - case PHYDM_INFO_FA_CCK: - return FalseAlmCnt->Cnt_Cck_fail; - - case PHYDM_INFO_FA_TOTAL: - return FalseAlmCnt->Cnt_all; - - case PHYDM_INFO_CCA_OFDM: - return FalseAlmCnt->Cnt_OFDM_CCA; - - case PHYDM_INFO_CCA_CCK: - return FalseAlmCnt->Cnt_CCK_CCA; - - case PHYDM_INFO_CCA_ALL: - return FalseAlmCnt->Cnt_CCA_all; - - case PHYDM_INFO_CRC32_OK_VHT: - return FalseAlmCnt->cnt_vht_crc32_ok; - - case PHYDM_INFO_CRC32_OK_HT: - return FalseAlmCnt->cnt_ht_crc32_ok; - - case PHYDM_INFO_CRC32_OK_LEGACY: - return FalseAlmCnt->cnt_ofdm_crc32_ok; - - case PHYDM_INFO_CRC32_OK_CCK: - return FalseAlmCnt->cnt_cck_crc32_ok; - - case PHYDM_INFO_CRC32_ERROR_VHT: - return FalseAlmCnt->cnt_vht_crc32_error; - - case PHYDM_INFO_CRC32_ERROR_HT: - return FalseAlmCnt->cnt_ht_crc32_error; - - case PHYDM_INFO_CRC32_ERROR_LEGACY: - return FalseAlmCnt->cnt_ofdm_crc32_error; - - case PHYDM_INFO_CRC32_ERROR_CCK: - return FalseAlmCnt->cnt_cck_crc32_error; - - case PHYDM_INFO_EDCCA_FLAG: - return FalseAlmCnt->edcca_flag; - - case PHYDM_INFO_OFDM_ENABLE: - return FalseAlmCnt->ofdm_block_enable; - - case PHYDM_INFO_CCK_ENABLE: - return FalseAlmCnt->cck_block_enable; - - case PHYDM_INFO_DBG_PORT_0: - return FalseAlmCnt->dbg_port0; - - default: - return 0xffffffff; - - } -} - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ) -{ - - PADAPTER pAdapter = pDM_Odm->Adapter; -#if USE_WORKITEM - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - ODM_InitializeWorkItem( pDM_Odm, - &pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchWorkitem, - (RT_WORKITEM_CALL_BACK)ODM_SW_AntDiv_WorkitemCallback, - (PVOID)pAdapter, - "AntennaSwitchWorkitem"); - #endif - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - ODM_InitializeWorkItem(pDM_Odm, - &pDM_Odm->dm_sat_table.hl_smart_antenna_workitem, - (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, - (PVOID)pAdapter, - "hl_smart_ant_workitem"); - - ODM_InitializeWorkItem(pDM_Odm, - &pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem, - (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, - (PVOID)pAdapter, - "hl_smart_ant_decision_workitem"); - #endif - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->PathDivSwitchWorkitem), - (RT_WORKITEM_CALL_BACK)odm_PathDivChkAntSwitchWorkitemCallback, - (PVOID)pAdapter, - "SWAS_WorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->CCKPathDiversityWorkitem), - (RT_WORKITEM_CALL_BACK)odm_CCKTXPathDiversityWorkItemCallback, - (PVOID)pAdapter, - "CCKTXPathDiversityWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->MPT_DIGWorkitem), - (RT_WORKITEM_CALL_BACK)odm_MPT_DIGWorkItemCallback, - (PVOID)pAdapter, - "MPT_DIGWorkitem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->RaRptWorkitem), - (RT_WORKITEM_CALL_BACK)ODM_UpdateInitRateWorkItemCallback, - (PVOID)pAdapter, - "RaRptWorkitem"); - -#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->FastAntTrainingWorkitem), - (RT_WORKITEM_CALL_BACK)odm_FastAntTrainingWorkItemCallback, - (PVOID)pAdapter, - "FastAntTrainingWorkitem"); -#endif - -#endif /*#if USE_WORKITEM*/ - -#if (BEAMFORMING_SUPPORT == 1) - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_EnterWorkItemCallback, - (PVOID)pAdapter, - "Txbf_EnterWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_LeaveWorkItemCallback, - (PVOID)pAdapter, - "Txbf_LeaveWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_FwNdpaWorkItemCallback, - (PVOID)pAdapter, - "Txbf_FwNdpaWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_ClkWorkItemCallback, - (PVOID)pAdapter, - "Txbf_ClkWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_RateWorkItemCallback, - (PVOID)pAdapter, - "Txbf_RateWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_StatusWorkItemCallback, - (PVOID)pAdapter, - "Txbf_StatusWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_ResetTxPathWorkItemCallback, - (PVOID)pAdapter, - "Txbf_ResetTxPathWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem), - (RT_WORKITEM_CALL_BACK)halComTxbf_GetTxRateWorkItemCallback, - (PVOID)pAdapter, - "Txbf_GetTxRateWorkItem"); -#endif - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->Adaptivity.phydm_pauseEDCCAWorkItem), - (RT_WORKITEM_CALL_BACK)phydm_pauseEDCCA_WorkItemCallback, - (PVOID)pAdapter, - "phydm_pauseEDCCAWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->Adaptivity.phydm_resumeEDCCAWorkItem), - (RT_WORKITEM_CALL_BACK)phydm_resumeEDCCA_WorkItemCallback, - (PVOID)pAdapter, - "phydm_resumeEDCCAWorkItem"); - - ODM_InitializeWorkItem( - pDM_Odm, - &(pDM_Odm->adcsmp.ADCSmpWorkItem), - (RT_WORKITEM_CALL_BACK)ADCSmpWorkItemCallback, - (PVOID)pAdapter, - "ADCSmpWorkItem"); - -} - -VOID -ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ) -{ -#if USE_WORKITEM - -#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - ODM_FreeWorkItem(&(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchWorkitem)); -#endif - -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_workitem)); - ODM_FreeWorkItem(&(pDM_Odm->dm_sat_table.hl_smart_antenna_decision_workitem)); -#endif - - ODM_FreeWorkItem(&(pDM_Odm->PathDivSwitchWorkitem)); - ODM_FreeWorkItem(&(pDM_Odm->CCKPathDiversityWorkitem)); -#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - ODM_FreeWorkItem(&(pDM_Odm->FastAntTrainingWorkitem)); -#endif - ODM_FreeWorkItem(&(pDM_Odm->MPT_DIGWorkitem)); - ODM_FreeWorkItem(&(pDM_Odm->RaRptWorkitem)); - /*ODM_FreeWorkItem((&pDM_Odm->sbdcnt_workitem));*/ -#endif - -#if (BEAMFORMING_SUPPORT == 1) - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_EnterWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_LeaveWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ClkWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_RateWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_StatusWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_ResetTxPathWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_GetTxRateWorkItem)); -#endif - - ODM_FreeWorkItem((&pDM_Odm->Adaptivity.phydm_pauseEDCCAWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->Adaptivity.phydm_resumeEDCCAWorkItem)); - ODM_FreeWorkItem((&pDM_Odm->adcsmp.ADCSmpWorkItem)); - -} -#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ - -/* -VOID -odm_FindMinimumRSSI( - IN PDM_ODM_T pDM_Odm - ) -{ - u4Byte i; - u1Byte RSSI_Min = 0xFF; - - for(i=0; ipODM_StaInfo[i] != NULL) - if(IS_STA_VALID(pDM_Odm->pODM_StaInfo[i]) ) - { - if(pDM_Odm->pODM_StaInfo[i]->RSSI_Ave < RSSI_Min) - { - RSSI_Min = pDM_Odm->pODM_StaInfo[i]->RSSI_Ave; - } - } - } - - pDM_Odm->RSSI_Min = RSSI_Min; - -} - -VOID -odm_IsLinked( - IN PDM_ODM_T pDM_Odm - ) -{ - u4Byte i; - BOOLEAN Linked = FALSE; - - for(i=0; ipODM_StaInfo[i]) ) - { - Linked = TRUE; - break; - } - - } - - pDM_Odm->bLinked = Linked; -} -*/ - -VOID -ODM_InitAllTimers( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - ODM_AntDivTimers(pDM_Odm,INIT_ANTDIV_TIMMER); -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#ifdef MP_TEST - if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) - ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, - (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); -#endif -#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) - ODM_InitializeTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, - (RT_TIMER_CALL_BACK)odm_MPT_DIGCallback, NULL, "MPT_DIGTimer"); -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - ODM_InitializeTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer, - (RT_TIMER_CALL_BACK)odm_PathDivChkAntSwitchCallback, NULL, "PathDivTimer"); - ODM_InitializeTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer, - (RT_TIMER_CALL_BACK)odm_CCKTXPathDiversityCallback, NULL, "CCKPathDiversityTimer"); - ODM_InitializeTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, - (RT_TIMER_CALL_BACK)phydm_sbd_callback, NULL, "SbdTimer"); -#if (BEAMFORMING_SUPPORT == 1) - ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer, - (RT_TIMER_CALL_BACK)halComTxbf_FwNdpaTimerCallback, NULL, "Txbf_FwNdpaTimer"); -#endif -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if (BEAMFORMING_SUPPORT == 1) - ODM_InitializeTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer, - (RT_TIMER_CALL_BACK)Beamforming_SWTimerCallback, NULL, "BeamformingTimer"); -#endif -#endif -} - -VOID -ODM_CancelAllTimers( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - // - // 2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in - // win7 platform. - // - HAL_ADAPTER_STS_CHK(pDM_Odm) -#endif - -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - ODM_AntDivTimers(pDM_Odm,CANCEL_ANTDIV_TIMMER); -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#ifdef MP_TEST - if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) - ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -#endif -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - ODM_CancelTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); - ODM_CancelTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); - ODM_CancelTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); - ODM_CancelTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); -#if (BEAMFORMING_SUPPORT == 1) - ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); -#endif -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if (BEAMFORMING_SUPPORT == 1) - ODM_CancelTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); -#endif -#endif - -} - - -VOID -ODM_ReleaseAllTimers( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - ODM_AntDivTimers(pDM_Odm,RELEASE_ANTDIV_TIMMER); -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - #ifdef MP_TEST - if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) - ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); - #endif -#elif(DM_ODM_SUPPORT_TYPE == ODM_WIN) -ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->PathDivSwitchTimer); - ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->CCKPathDiversityTimer); - ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer); - ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer); -#if (BEAMFORMING_SUPPORT == 1) - ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.TxbfInfo.Txbf_FwNdpaTimer); -#endif -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if (BEAMFORMING_SUPPORT == 1) - ODM_ReleaseTimer(pDM_Odm, &pDM_Odm->BeamformingInfo.BeamformingTimer); -#endif -#endif -} - - -//3============================================================ -//3 Tx Power Tracking -//3============================================================ - - - - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -VOID -ODM_InitAllThreads( - IN PDM_ODM_T pDM_Odm - ) -{ - #ifdef TPT_THREAD - kTPT_task_init(pDM_Odm->priv); - #endif -} - -VOID -ODM_StopAllThreads( - IN PDM_ODM_T pDM_Odm - ) -{ - #ifdef TPT_THREAD - kTPT_task_stop(pDM_Odm->priv); - #endif -} -#endif - - -#if( DM_ODM_SUPPORT_TYPE == ODM_WIN) -// -// 2011/07/26 MH Add an API for testing IQK fail case. -// -BOOLEAN -ODM_CheckPowerStatus( - IN PADAPTER Adapter) -{ - - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - RT_RF_POWER_STATE rtState; - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - - // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. - if (pMgntInfo->init_adpt_in_progress == TRUE) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter\n")); - return TRUE; - } - - // - // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. - // - Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); - if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", - Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); - return FALSE; - } - return TRUE; -} -#elif( DM_ODM_SUPPORT_TYPE == ODM_AP) -BOOLEAN -ODM_CheckPowerStatus( - IN PADAPTER Adapter) -{ - /* - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - RT_RF_POWER_STATE rtState; - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - - // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. - if (pMgntInfo->init_adpt_in_progress == TRUE) - { - ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); - return TRUE; - } - - // - // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. - // - Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); - if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) - { - ODM_RT_TRACE(pDM_Odm,COMP_INIT, DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", - Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); - return FALSE; - } - */ - return TRUE; -} -#endif - -// need to ODM CE Platform -//move to here for ANT detection mechanism using - -#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)||(DM_ODM_SUPPORT_TYPE == ODM_CE)) -u4Byte -GetPSDData( - IN PDM_ODM_T pDM_Odm, - unsigned int point, - u1Byte initial_gain_psd) -{ - //unsigned int val, rfval; - //int psd_report; - u4Byte psd_report; - - //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - //Debug Message - //val = PHY_QueryBBReg(Adapter,0x908, bMaskDWord); - //DbgPrint("Reg908 = 0x%x\n",val); - //val = PHY_QueryBBReg(Adapter,0xDF4, bMaskDWord); - //rfval = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); - //DbgPrint("RegDF4 = 0x%x, RFReg00 = 0x%x\n",val, rfval); - //DbgPrint("PHYTXON = %x, OFDMCCA_PP = %x, CCKCCA_PP = %x, RFReg00 = %x\n", - //(val&BIT25)>>25, (val&BIT14)>>14, (val&BIT15)>>15, rfval); - - //Set DCO frequency index, offset=(40MHz/SamplePts)*point - ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); - - //Start PSD calculation, Reg808[22]=0->1 - ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); - //Need to wait for HW PSD report - ODM_StallExecution(1000); - ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0); - //Read PSD report, Reg8B4[15:0] - psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF; - -#if 1//(DEV_BUS_TYPE == RT_PCI_INTERFACE) && ( (RT_PLATFORM == PLATFORM_LINUX) || (RT_PLATFORM == PLATFORM_MACOSX)) - psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report))+(u4Byte)(initial_gain_psd-0x1c); -#else - psd_report = (int) (20*log10((double)psd_report))+(int)(initial_gain_psd-0x1c); -#endif - - return psd_report; - -} -#endif - -u4Byte -odm_ConvertTo_dB( - u4Byte Value) -{ - u1Byte i; - u1Byte j; - u4Byte dB; - - Value = Value & 0xFFFF; - - for (i = 0; i < 12; i++) - { - if (Value <= dB_Invert_Table[i][7]) - { - break; - } - } - - if (i >= 12) - { - return (96); // maximum 96 dB - } - - for (j = 0; j < 8; j++) - { - if (Value <= dB_Invert_Table[i][j]) - { - break; - } - } - - dB = (i << 3) + j + 1; - - return (dB); -} - -u4Byte -odm_ConvertTo_linear( - u4Byte Value) -{ - u1Byte i; - u1Byte j; - u4Byte linear; - - /* 1dB~96dB */ - - Value = Value & 0xFF; - - i = (u1Byte)((Value - 1) >> 3); - j = (u1Byte)(Value - 1) - (i << 3); - - linear = dB_Invert_Table[i][j]; - - return (linear); -} - -// -// ODM multi-port consideration, added by Roger, 2013.10.01. -// -VOID -ODM_AsocEntry_Init( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER pLoopAdapter = GetDefaultAdapter(pDM_Odm->Adapter); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pLoopAdapter); - PDM_ODM_T pDM_OutSrc = &pHalData->DM_OutSrc; - u1Byte TotalAssocEntryNum = 0; - u1Byte index = 0; - u1Byte adaptercount = 0; - - ODM_CmnInfoPtrArrayHook(pDM_OutSrc, ODM_CMNINFO_STA_STATUS, 0, &pLoopAdapter->MgntInfo.DefaultPort[0]); - pLoopAdapter->MgntInfo.DefaultPort[0].MultiPortStationIdx = TotalAssocEntryNum; - - adaptercount += 1; - RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); - pLoopAdapter = GetNextExtAdapter(pLoopAdapter); - TotalAssocEntryNum +=1; - - while(pLoopAdapter) - { - for (index = 0; index MgntInfo.AsocEntry[index]); - pLoopAdapter->MgntInfo.AsocEntry[index].MultiPortStationIdx = TotalAssocEntryNum+index; - } - - TotalAssocEntryNum+= index; - if(IS_HARDWARE_TYPE_8188E((pDM_Odm->Adapter))) - pLoopAdapter->RASupport = TRUE; - adaptercount += 1; - RT_TRACE(COMP_INIT, DBG_LOUD, ("adaptercount=%d\n", adaptercount)); - pLoopAdapter = GetNextExtAdapter(pLoopAdapter); - } - - RT_TRACE(COMP_INIT, DBG_LOUD, ("TotalAssocEntryNum = %d\n", TotalAssocEntryNum)); - if (TotalAssocEntryNum < (ODM_ASSOCIATE_ENTRY_NUM-1)) { - - RT_TRACE(COMP_INIT, DBG_LOUD, ("In hook null\n")); - for (index = TotalAssocEntryNum; index < ODM_ASSOCIATE_ENTRY_NUM; index++) - ODM_CmnInfoPtrArrayHook(pDM_OutSrc, ODM_CMNINFO_STA_STATUS, index, NULL); - } -#endif -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -/* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */ -void odm_dtc(PDM_ODM_T pDM_Odm) -{ -#ifdef CONFIG_DM_RESP_TXAGC - #define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */ - #define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */ - - /* RSSI vs TX power step mapping: decade TX power */ - static const u8 dtc_table_down[]={ - DTC_BASE, - (DTC_BASE+5), - (DTC_BASE+10), - (DTC_BASE+15), - (DTC_BASE+20), - (DTC_BASE+25) - }; - - /* RSSI vs TX power step mapping: increase TX power */ - static const u8 dtc_table_up[]={ - DTC_DWN_BASE, - (DTC_DWN_BASE-5), - (DTC_DWN_BASE-10), - (DTC_DWN_BASE-15), - (DTC_DWN_BASE-15), - (DTC_DWN_BASE-20), - (DTC_DWN_BASE-20), - (DTC_DWN_BASE-25), - (DTC_DWN_BASE-25), - (DTC_DWN_BASE-30), - (DTC_DWN_BASE-35) - }; - - u8 i; - u8 dtc_steps=0; - u8 sign; - u8 resp_txagc=0; - - #if 0 - /* As DIG is disabled, DTC is also disable */ - if(!(pDM_Odm->SupportAbility & ODM_XXXXXX)) - return; - #endif - - if (DTC_BASE < pDM_Odm->RSSI_Min) { - /* need to decade the CTS TX power */ - sign = 1; - for (i=0;i= pDM_Odm->RSSI_Min) || (dtc_steps >= 6)) - break; - else - dtc_steps++; - } - } -#if 0 - else if (DTC_DWN_BASE > pDM_Odm->RSSI_Min) - { - /* needs to increase the CTS TX power */ - sign = 0; - dtc_steps = 1; - for (i=0;iRSSI_Min) || (dtc_steps>=10)) - break; - else - dtc_steps++; - } - } -#endif - else - { - sign = 0; - dtc_steps = 0; - } - - resp_txagc = dtc_steps | (sign << 4); - resp_txagc = resp_txagc | (resp_txagc << 5); - ODM_Write1Byte(pDM_Odm, 0x06d9, resp_txagc); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PWR_TRAIN, ODM_DBG_LOUD, ("%s RSSI_Min:%u, set RESP_TXAGC to %s %u\n", - __func__, pDM_Odm->RSSI_Min, sign ? "minus" : "plus", dtc_steps)); -#endif /* CONFIG_RESP_TXAGC_ADJUST */ -} - -#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - -VOID -odm_UpdatePowerTrainingState( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm , PHYDM_FALSEALMCNT); - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - u4Byte score = 0; - - if(!(pDM_Odm->SupportAbility & ODM_BB_PWR_TRAIN)) - return; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState()============>\n")); - pDM_Odm->bChangeState = FALSE; - - // Debug command - if(pDM_Odm->ForcePowerTrainingState) - { - if(pDM_Odm->ForcePowerTrainingState == 1 && !pDM_Odm->bDisablePowerTraining) - { - pDM_Odm->bChangeState = TRUE; - pDM_Odm->bDisablePowerTraining = TRUE; - } - else if(pDM_Odm->ForcePowerTrainingState == 2 && pDM_Odm->bDisablePowerTraining) - { - pDM_Odm->bChangeState = TRUE; - pDM_Odm->bDisablePowerTraining = FALSE; - } - - pDM_Odm->PT_score = 0; - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; - pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): ForcePowerTrainingState = %d\n", - pDM_Odm->ForcePowerTrainingState)); - return; - } - - if(!pDM_Odm->bLinked) - return; - - // First connect - if((pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE)) - { - pDM_Odm->PT_score = 0; - pDM_Odm->bChangeState = TRUE; - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; - pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): First Connect\n")); - return; - } - - // Compute score - if(pDM_Odm->NHM_cnt_0 >= 215) - score = 2; - else if(pDM_Odm->NHM_cnt_0 >= 190) - score = 1; // unknow state - else - { - u4Byte RX_Pkt_Cnt; - - RX_Pkt_Cnt = (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM) + (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK); - - if((FalseAlmCnt->Cnt_CCA_all > 31 && RX_Pkt_Cnt > 31) && (FalseAlmCnt->Cnt_CCA_all >= RX_Pkt_Cnt)) - { - if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 1)) <= FalseAlmCnt->Cnt_CCA_all) - score = 0; - else if((RX_Pkt_Cnt + (RX_Pkt_Cnt >> 2)) <= FalseAlmCnt->Cnt_CCA_all) - score = 1; - else - score = 2; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): RX_Pkt_Cnt = %d, Cnt_CCA_all = %d\n", - RX_Pkt_Cnt, FalseAlmCnt->Cnt_CCA_all)); - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NumQryPhyStatusOFDM = %d, NumQryPhyStatusCCK = %d\n", - (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM), (u4Byte)(pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): NHM_cnt_0 = %d, score = %d\n", - pDM_Odm->NHM_cnt_0, score)); - - // smoothing - pDM_Odm->PT_score = (score << 4) + (pDM_Odm->PT_score>>1) + (pDM_Odm->PT_score>>2); - score = (pDM_Odm->PT_score + 32) >> 6; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): PT_score = %d, score after smoothing = %d\n", - pDM_Odm->PT_score, score)); - - // Mode decision - if(score == 2) - { - if(pDM_Odm->bDisablePowerTraining) - { - pDM_Odm->bChangeState = TRUE; - pDM_Odm->bDisablePowerTraining = FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Enable Power Training\n")); - } - else if(score == 0) - { - if(!pDM_Odm->bDisablePowerTraining) - { - pDM_Odm->bChangeState = TRUE; - pDM_Odm->bDisablePowerTraining = TRUE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Change state\n")); - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_RA_MASK, ODM_DBG_LOUD,("odm_UpdatePowerTrainingState(): Disable Power Training\n")); - } - - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; - pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; -#endif -} - - - -/*===========================================================*/ -/* The following is for compile only*/ -/*===========================================================*/ -/*#define TARGET_CHNL_NUM_2G_5G 59*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -u1Byte GetRightChnlPlaceforIQK(u1Byte chnl) -{ - u1Byte channel_all[TARGET_CHNL_NUM_2G_5G] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 38, 40, 42, 44, 46, 48, 50, 52, 54, 56, 58, 60, 62, 64, 100, - 102, 104, 106, 108, 110, 112, 114, 116, 118, 120, 122, 124, 126, 128, 130, 132, 134, 136, 138, 140, 149, 151, 153, 155, 157, 159, 161, 163, 165}; - u1Byte place = chnl; - - - if (chnl > 14) { - for (place = 14; place < sizeof(channel_all); place++) { - if (channel_all[place] == chnl) - return place-13; - } - } - - return 0; -} - -#endif -/*===========================================================*/ - -VOID -phydm_NoisyDetection( - IN PDM_ODM_T pDM_Odm - ) -{ - u4Byte Total_FA_Cnt, Total_CCA_Cnt; - u4Byte Score = 0, i, Score_Smooth; - - Total_CCA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_CCA_all; - Total_FA_Cnt = pDM_Odm->FalseAlmCnt.Cnt_all; - -/* - if( Total_FA_Cnt*16>=Total_CCA_Cnt*14 ) // 87.5 - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*12 ) // 75 - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*10 ) // 56.25 - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*8 ) // 50 - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*7 ) // 43.75 - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*6 ) // 37.5 - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*5 ) // 31.25% - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*4 ) // 25% - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*3 ) // 18.75% - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*2 ) // 12.5% - - else if( Total_FA_Cnt*16>=Total_CCA_Cnt*1 ) // 6.25% -*/ - for(i=0;i<=16;i++) - { - if( Total_FA_Cnt*16>=Total_CCA_Cnt*(16-i) ) - { - Score = 16-i; - break; - } - } - - // NoisyDecision_Smooth = NoisyDecision_Smooth>>1 + (Score<<3)>>1; - pDM_Odm->NoisyDecision_Smooth = (pDM_Odm->NoisyDecision_Smooth>>1) + (Score<<2); - - // Round the NoisyDecision_Smooth: +"3" comes from (2^3)/2-1 - Score_Smooth = (Total_CCA_Cnt>=300)?((pDM_Odm->NoisyDecision_Smooth+3)>>3):0; - - pDM_Odm->NoisyDecision = (Score_Smooth>=3)?1:0; -/* - switch(Score_Smooth) - { - case 0: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=0%%\n")); - break; - case 1: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=6.25%%\n")); - break; - case 2: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=12.5%%\n")); - break; - case 3: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=18.75%%\n")); - break; - case 4: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=25%%\n")); - break; - case 5: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=31.25%%\n")); - break; - case 6: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=37.5%%\n")); - break; - case 7: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=43.75%%\n")); - break; - case 8: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=50%%\n")); - break; - case 9: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=56.25%%\n")); - break; - case 10: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=62.5%%\n")); - break; - case 11: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=68.75%%\n")); - break; - case 12: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=75%%\n")); - break; - case 13: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=81.25%%\n")); - break; - case 14: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=87.5%%\n")); - break; - case 15: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=93.75%%\n")); - break; - case 16: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Total_FA_Cnt/Total_CCA_Cnt=100%%\n")); - break; - default: - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, - ("[NoisyDetection] Unknown Value!! Need Check!!\n")); - } -*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, - ("[NoisyDetection] Total_CCA_Cnt=%d, Total_FA_Cnt=%d, NoisyDecision_Smooth=%d, Score=%d, Score_Smooth=%d, pDM_Odm->NoisyDecision=%d\n", - Total_CCA_Cnt, Total_FA_Cnt, pDM_Odm->NoisyDecision_Smooth, Score, Score_Smooth, pDM_Odm->NoisyDecision)); - -} - -VOID -phydm_set_ext_switch( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - u4Byte ext_ant_switch = dm_value[0]; - - if (pDM_Odm->SupportICType & (ODM_RTL8821|ODM_RTL8881A)) { - - /*Output Pin Settings*/ - ODM_SetMACReg(pDM_Odm, 0x4C, BIT23, 0); /*select DPDT_P and DPDT_N as output pin*/ - ODM_SetMACReg(pDM_Odm, 0x4C, BIT24, 1); /*by WLAN control*/ - - ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF, 7); /*DPDT_P = 1b'0*/ - ODM_SetBBReg(pDM_Odm, 0xCB4, 0xF0, 7); /*DPDT_N = 1b'0*/ - - if (ext_ant_switch == MAIN_ANT) { - ODM_SetBBReg(pDM_Odm, 0xCB4, (BIT29|BIT28), 1); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set Ant switch = 2b'01 (Main)\n")); - } else if (ext_ant_switch == AUX_ANT){ - ODM_SetBBReg(pDM_Odm, 0xCB4, BIT29|BIT28, 2); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("***8821A set Ant switch = 2b'10 (Aux)\n")); - } - } -} - -VOID -phydm_csi_mask_enable( - IN PVOID pDM_VOID, - IN u4Byte enable -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte reg_value = 0; - - reg_value = (enable == CSI_MASK_ENABLE) ? 1 : 0; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - ODM_SetBBReg(pDM_Odm, 0xD2C, BIT28, reg_value); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", reg_value)); - - } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - ODM_SetBBReg(pDM_Odm, 0x874, BIT0, reg_value); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable CSI Mask: Reg 0x874[0] = ((0x%x))\n", reg_value)); - } - -} - -VOID -phydm_clean_all_csi_mask( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0xD4c, bMaskDWord, 0); - - } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - ODM_SetBBReg(pDM_Odm, 0x880, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0x884, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0x888, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0x88c, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0x890, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0x894, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0x898, bMaskDWord, 0); - ODM_SetBBReg(pDM_Odm, 0x89c, bMaskDWord, 0); - } -} - -VOID -phydm_set_csi_mask_reg( - IN PVOID pDM_VOID, - IN u4Byte tone_idx_tmp, - IN u1Byte tone_direction -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte byte_offset, bit_offset; - u4Byte target_reg; - u1Byte reg_tmp_value; - u4Byte tone_num = 64; - u4Byte tone_num_shift = 0; - u4Byte csi_mask_reg_p = 0, csi_mask_reg_n = 0; - - /* calculate real tone idx*/ - if ((tone_idx_tmp % 10) >= 5) - tone_idx_tmp += 10; - - tone_idx_tmp = (tone_idx_tmp/10); - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - tone_num = 64; - csi_mask_reg_p = 0xD40; - csi_mask_reg_n = 0xD48; - - } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - tone_num = 128; - csi_mask_reg_p = 0x880; - csi_mask_reg_n = 0x890; - } - - if (tone_direction == FREQ_POSITIVE) { - - if (tone_idx_tmp >= (tone_num - 1)) - tone_idx_tmp = (tone_num - 1); - - byte_offset = (u1Byte)(tone_idx_tmp >> 3); - bit_offset = (u1Byte)(tone_idx_tmp & 0x7); - target_reg = csi_mask_reg_p + byte_offset; - - } else { - tone_num_shift = tone_num; - - if (tone_idx_tmp >= tone_num) - tone_idx_tmp = tone_num; - - tone_idx_tmp = tone_num - tone_idx_tmp; - - byte_offset = (u1Byte)(tone_idx_tmp >> 3); - bit_offset = (u1Byte)(tone_idx_tmp & 0x7); - target_reg = csi_mask_reg_n + byte_offset; - } - - reg_tmp_value = ODM_Read1Byte(pDM_Odm, target_reg); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Pre Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); - reg_tmp_value |= BIT(bit_offset); - ODM_Write1Byte(pDM_Odm, target_reg, reg_tmp_value); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("New Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); -} - -VOID -phydm_set_nbi_reg( - IN PVOID pDM_VOID, - IN u4Byte tone_idx_tmp, - IN u4Byte bw -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte nbi_table_128[NBI_TABLE_SIZE_128] = {25, 55, 85, 115, 135, 155, 185, 205, 225, 245, /*1~10*/ /*tone_idx X 10*/ - 265, 285, 305, 335, 355, 375, 395, 415, 435, 455, /*11~20*/ - 485, 505, 525, 555, 585, 615, 635}; /*21~27*/ - - u4Byte nbi_table_256[NBI_TABLE_SIZE_256] = { 25, 55, 85, 115, 135, 155, 175, 195, 225, 245, /*1~10*/ - 265, 285, 305, 325, 345, 365, 385, 405, 425, 445, /*11~20*/ - 465, 485, 505, 525, 545, 565, 585, 605, 625, 645, /*21~30*/ - 665, 695, 715, 735, 755, 775, 795, 815, 835, 855, /*31~40*/ - 875, 895, 915, 935, 955, 975, 995, 1015, 1035, 1055, /*41~50*/ - 1085, 1105, 1125, 1145, 1175, 1195, 1225, 1255, 1275}; /*51~59*/ - - u4Byte reg_idx = 0; - u4Byte i; - u1Byte nbi_table_idx = FFT_128_TYPE; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - nbi_table_idx = FFT_128_TYPE; - } else if (pDM_Odm->SupportICType & ODM_IC_11AC_1_SERIES) { - - nbi_table_idx = FFT_256_TYPE; - } else if (pDM_Odm->SupportICType & ODM_IC_11AC_2_SERIES) { - - if (bw == 80) - nbi_table_idx = FFT_256_TYPE; - else /*20M, 40M*/ - nbi_table_idx = FFT_128_TYPE; - } - - if (nbi_table_idx == FFT_128_TYPE) { - - for (i = 0; i < NBI_TABLE_SIZE_128; i++) { - if (tone_idx_tmp < nbi_table_128[i]) { - reg_idx = i+1; - break; - } - } - - } else if (nbi_table_idx == FFT_256_TYPE) { - - for (i = 0; i < NBI_TABLE_SIZE_256; i++) { - if (tone_idx_tmp < nbi_table_256[i]) { - reg_idx = i+1; - break; - } - } - } - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - ODM_SetBBReg(pDM_Odm, 0xc40, 0x1f000000, reg_idx); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", reg_idx)); - /**/ - } else { - ODM_SetBBReg(pDM_Odm, 0x87c, 0xfc000, reg_idx); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Set tone idx: Reg0x87C[19:14] = ((0x%x))\n", reg_idx)); - /**/ - } -} - - -VOID -phydm_nbi_enable( - IN PVOID pDM_VOID, - IN u4Byte enable -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte reg_value = 0; - - reg_value = (enable == NBI_ENABLE) ? 1 : 0; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - ODM_SetBBReg(pDM_Odm, 0xc40, BIT9, reg_value); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0xC40[9] = ((0x%x))\n", reg_value)); - - } else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - ODM_SetBBReg(pDM_Odm, 0x87c, BIT13, reg_value); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Enable NBI Reg0x87C[13] = ((0x%x))\n", reg_value)); - } -} - -u1Byte -phydm_calculate_fc( - IN PVOID pDM_VOID, - IN u4Byte channel, - IN u4Byte bw, - IN u4Byte Second_ch, - IN OUT u4Byte *fc_in -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte fc = *fc_in; - u4Byte start_ch_per_40m[NUM_START_CH_40M] = {36, 44, 52, 60, 100, 108, 116, 124, 132, 140, 149, 157, 165, 173}; - u4Byte start_ch_per_80m[NUM_START_CH_80M] = {36, 52, 100, 116, 132, 149, 165}; - pu4Byte p_start_ch = &(start_ch_per_40m[0]); - u4Byte num_start_channel = NUM_START_CH_40M; - u4Byte channel_offset = 0; - u4Byte i; - - /*2.4G*/ - if (channel <= 14 && channel > 0) { - - if (bw == 80) { - return SET_ERROR; - } - - fc = 2412 + (channel - 1)*5; - - if (bw == 40 && (Second_ch == PHYDM_ABOVE)) { - - if (channel >= 10) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error Setting\n", channel, Second_ch)); - return SET_ERROR; - } - fc += 10; - } else if (bw == 40 && (Second_ch == PHYDM_BELOW)) { - - if (channel <= 2) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)), Scnd_CH = ((%d)) Error Setting\n", channel, Second_ch)); - return SET_ERROR; - } - fc -= 10; - } - } - /*5G*/ - else if (channel >= 36 && channel <= 177) { - - if (bw != 20) { - - if (bw == 40) { - num_start_channel = NUM_START_CH_40M; - p_start_ch = &(start_ch_per_40m[0]); - channel_offset = CH_OFFSET_40M; - } else if (bw == 80) { - num_start_channel = NUM_START_CH_80M; - p_start_ch = &(start_ch_per_80m[0]); - channel_offset = CH_OFFSET_80M; - } - - for (i = 0; i < num_start_channel; i++) { - - if (channel < p_start_ch[i+1]) { - channel = p_start_ch[i] + channel_offset; - break; - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("Mod_CH = ((%d))\n", channel)); - } - - fc = 5180 + (channel-36)*5; - - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("CH = ((%d)) Error Setting\n", channel)); - return SET_ERROR; - } - - *fc_in = fc; - - return SET_SUCCESS; -} - - -u1Byte -phydm_calculate_intf_distance( - IN PVOID pDM_VOID, - IN u4Byte bw, - IN u4Byte fc, - IN u4Byte f_interference, - IN OUT u4Byte *p_tone_idx_tmp_in -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte bw_up, bw_low; - u4Byte int_distance; - u4Byte tone_idx_tmp; - u1Byte set_result = SET_NO_NEED; - - bw_up = fc + bw/2; - bw_low = fc - bw/2; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[f_l, fc, fh] = [ %d, %d, %d ], f_int = ((%d))\n", bw_low, fc, bw_up, f_interference)); - - if ((f_interference >= bw_low) && (f_interference <= bw_up)) { - - int_distance = (fc >= f_interference) ? (fc - f_interference) : (f_interference - fc); - tone_idx_tmp = (int_distance<<5); /* =10*(int_distance /0.3125) */ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("int_distance = ((%d MHz)) Mhz, tone_idx_tmp = ((%d.%d))\n", int_distance, (tone_idx_tmp/10), (tone_idx_tmp%10))); - *p_tone_idx_tmp_in = tone_idx_tmp; - set_result = SET_SUCCESS; - } - - return set_result; - -} - - -u1Byte -phydm_csi_mask_setting( - IN PVOID pDM_VOID, - IN u4Byte enable, - IN u4Byte channel, - IN u4Byte bw, - IN u4Byte f_interference, - IN u4Byte Second_ch -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte fc; - u4Byte int_distance; - u1Byte tone_direction; - u4Byte tone_idx_tmp; - u1Byte set_result = SET_SUCCESS; - - if (enable == CSI_MASK_DISABLE) { - set_result = SET_SUCCESS; - phydm_clean_all_csi_mask(pDM_Odm); - - } else { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set CSI MASK_] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", - channel, bw, f_interference, (((bw == 20) || (channel > 14)) ? "Don't care" : (Second_ch == PHYDM_ABOVE) ? "H" : "L"))); - - /*calculate fc*/ - if (phydm_calculate_fc(pDM_Odm, channel, bw, Second_ch, &fc) == SET_ERROR) - set_result = SET_ERROR; - - else { - /*calculate interference distance*/ - if (phydm_calculate_intf_distance(pDM_Odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { - - tone_direction = (f_interference >= fc) ? FREQ_POSITIVE : FREQ_NEGATIVE; - phydm_set_csi_mask_reg(pDM_Odm, tone_idx_tmp, tone_direction); - set_result = SET_SUCCESS; - } else - set_result = SET_NO_NEED; - } - } - - if (set_result == SET_SUCCESS) - phydm_csi_mask_enable(pDM_Odm, enable); - else - phydm_csi_mask_enable(pDM_Odm, CSI_MASK_DISABLE); - - return set_result; -} - -u1Byte -phydm_nbi_setting( - IN PVOID pDM_VOID, - IN u4Byte enable, - IN u4Byte channel, - IN u4Byte bw, - IN u4Byte f_interference, - IN u4Byte Second_ch -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte fc; - u4Byte int_distance; - u4Byte tone_idx_tmp; - u1Byte set_result = SET_SUCCESS; - u4Byte bw_max = 40; - - if (enable == NBI_DISABLE) - set_result = SET_SUCCESS; - - else { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_API, ODM_DBG_LOUD, ("[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", - channel, bw, f_interference, (((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : (Second_ch == PHYDM_ABOVE) ? "H" : "L"))); - - /*calculate fc*/ - if (phydm_calculate_fc(pDM_Odm, channel, bw, Second_ch, &fc) == SET_ERROR) - set_result = SET_ERROR; - - else { - /*calculate interference distance*/ - if (phydm_calculate_intf_distance(pDM_Odm, bw, fc, f_interference, &tone_idx_tmp) == SET_SUCCESS) { - - phydm_set_nbi_reg(pDM_Odm, tone_idx_tmp, bw); - set_result = SET_SUCCESS; - } else - set_result = SET_NO_NEED; - } - } - - if (set_result == SET_SUCCESS) - phydm_nbi_enable(pDM_Odm, enable); - else - phydm_nbi_enable(pDM_Odm, NBI_DISABLE); - - return set_result; -} - -VOID -phydm_api_debug( - IN PVOID pDM_VOID, - IN u4Byte function_map, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - u4Byte channel = dm_value[1]; - u4Byte bw = dm_value[2]; - u4Byte f_interference = dm_value[3]; - u4Byte Second_ch = dm_value[4]; - u1Byte set_result = 0; - - /*PHYDM_API_NBI*/ - /*-------------------------------------------------------------------------------------------------------------------------------*/ - if (function_map == PHYDM_API_NBI) { - - if (dm_value[0] == 100) { - - PHYDM_SNPRINTF((output+used, out_len-used, "[HELP-NBI] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); - return; - - } else if (dm_value[0] == NBI_ENABLE) { - - PHYDM_SNPRINTF((output+used, out_len-used, "[Enable NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", - channel, bw, f_interference, ((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : ((Second_ch == PHYDM_ABOVE) ? "H" : "L"))); - set_result = phydm_nbi_setting(pDM_Odm, NBI_ENABLE, channel, bw, f_interference, Second_ch); - - } else if (dm_value[0] == NBI_DISABLE) { - - PHYDM_SNPRINTF((output+used, out_len-used, "[Disable NBI]\n")); - set_result = phydm_nbi_setting(pDM_Odm, NBI_DISABLE, channel, bw, f_interference, Second_ch); - - } else { - - set_result = SET_ERROR; - } - PHYDM_SNPRINTF((output+used, out_len-used, "[NBI set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error"))); - - } - - /*PHYDM_CSI_MASK*/ - /*-------------------------------------------------------------------------------------------------------------------------------*/ - else if (function_map == PHYDM_API_CSI_MASK) { - - if (dm_value[0] == 100) { - - PHYDM_SNPRINTF((output+used, out_len-used, "[HELP-CSI MASK] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); - return; - - } else if (dm_value[0] == CSI_MASK_ENABLE) { - - PHYDM_SNPRINTF((output+used, out_len-used, "[Enable CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", - channel, bw, f_interference, (channel > 14)?"Don't care":(((Second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "H" : "L"))); - set_result = phydm_csi_mask_setting(pDM_Odm, CSI_MASK_ENABLE, channel, bw, f_interference, Second_ch); - - } else if (dm_value[0] == CSI_MASK_DISABLE) { - - PHYDM_SNPRINTF((output+used, out_len-used, "[Disable CSI MASK]\n")); - set_result = phydm_csi_mask_setting(pDM_Odm, CSI_MASK_DISABLE, channel, bw, f_interference, Second_ch); - - } else { - - set_result = SET_ERROR; - } - PHYDM_SNPRINTF((output+used, out_len-used, "[CSI MASK set result: %s]\n", (set_result == SET_SUCCESS) ? "Success" : ((set_result == SET_NO_NEED) ? "No need" : "Error"))); - } -} - - +#endif + +#if ((RTL8703B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8710B_SUPPORT == 1)) + if (p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8710B)) { + + p_dm->cck_agc_report_type = odm_get_bb_reg(p_dm, 0x950, BIT(11)) ? 1 : 0; /*1: 4bit LNA, 0: 3bit LNA */ + + if (p_dm->cck_agc_report_type != 1) { + dbg_print("[Warning] 8703B/8723D/8710B CCK should be 4bit LNA, ie. 0x950[11] = 1\n"); + /**/ + } + } +#endif + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8821C) { + p_dm->cck_new_agc = odm_get_bb_reg(p_dm, 0xa9c, BIT(17)) ? true : false; /*1: new agc 0: old agc*/ + if (p_dm->cck_new_agc == 0 && p_dm->default_rf_set_8821c == SWITCH_TO_BTG) + p_dm->cck_agc_report_type = 1; + } +#endif + +#if ((RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8710B_SUPPORT == 1)) + if (p_dm->support_ic_type & (ODM_RTL8723D | ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8710B)) + p_dm->cck_new_agc = odm_get_bb_reg(p_dm, 0xa9c, BIT(17)) ? true : false; /*1: new agc 0: old agc*/ + else +#endif + { + p_dm->cck_new_agc = false; + /**/ + } + + phydm_get_cck_rssi_table_from_reg(p_dm); + +} + +void +phydm_init_hw_info_by_rfe( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8822B) + phydm_init_hw_info_by_rfe_type_8822b(p_dm); +#endif +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8821C) + phydm_init_hw_info_by_rfe_type_8821c(p_dm); +#endif +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + phydm_init_hw_info_by_rfe_type_8197f(p_dm); +#endif +} + +void +phydm_common_info_self_init( + struct PHY_DM_STRUCT *p_dm +) +{ + phydm_init_cck_setting(p_dm); + p_dm->rf_path_rx_enable = (u8) odm_get_bb_reg(p_dm, ODM_REG(BB_RX_PATH, p_dm), ODM_BIT(BB_RX_PATH, p_dm)); +#if (DM_ODM_SUPPORT_TYPE != ODM_CE) + p_dm->p_is_net_closed = &p_dm->BOOLEAN_temp; + + phydm_init_debug_setting(p_dm); +#endif + phydm_init_trx_antenna_setting(p_dm); + phydm_init_soft_ml_setting(p_dm); + + p_dm->phydm_period = PHYDM_WATCH_DOG_PERIOD; + p_dm->phydm_sys_up_time = 0; + + if (p_dm->support_ic_type & ODM_IC_1SS) + p_dm->num_rf_path = 1; + else if (p_dm->support_ic_type & ODM_IC_2SS) + p_dm->num_rf_path = 2; + else if (p_dm->support_ic_type & ODM_IC_3SS) + p_dm->num_rf_path = 3; + else if (p_dm->support_ic_type & ODM_IC_4SS) + p_dm->num_rf_path = 4; + + p_dm->tx_rate = 0xFF; + p_dm->rssi_min_by_path = 0xFF; + + p_dm->number_linked_client = 0; + p_dm->pre_number_linked_client = 0; + p_dm->number_active_client = 0; + p_dm->pre_number_active_client = 0; + + p_dm->last_tx_ok_cnt = 0; + p_dm->last_rx_ok_cnt = 0; + p_dm->tx_tp = 0; + p_dm->rx_tp = 0; + p_dm->total_tp = 0; + p_dm->traffic_load = TRAFFIC_LOW; + + p_dm->nbi_set_result = 0; + p_dm->is_init_hw_info_by_rfe = false; + p_dm->pre_dbg_priority = BB_DBGPORT_RELEASE; + p_dm->tp_active_th = 5; + p_dm->disable_phydm_watchdog = 0; + + p_dm->u8_dummy = 0xf; + p_dm->u16_dummy = 0xffff; + p_dm->u32_dummy = 0xffffffff; + + /*odm_memory_set(p_dm, &(p_dm->pause_lv_table.lv_dig), 0, sizeof(struct phydm_pause_lv));*/ + p_dm->pause_lv_table.lv_cckpd = PHYDM_PAUSE_RELEASE; + p_dm->pause_lv_table.lv_dig = PHYDM_PAUSE_RELEASE; + +} + +void +phydm_cmn_sta_info_update( + void *p_dm_void, + u8 macid +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + struct ra_sta_info *p_ra = NULL; + + if (is_sta_active(p_sta)) { + p_ra = &(p_sta->ra_info); + } else { + PHYDM_DBG(p_dm, DBG_RA_MASK, ("[Warning] %s invalid sta_info\n", __func__)); + return; + } + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_RA_MASK, ("MACID=%d\n", p_sta->mac_id)); + + /*[Calculate TX/RX state]*/ + if (p_sta->tx_moving_average_tp > (p_sta->rx_moving_average_tp << 1)) + p_ra->txrx_state= TX_STATE; + else if (p_sta->rx_moving_average_tp > (p_sta->tx_moving_average_tp << 1)) + p_ra->txrx_state = RX_STATE; + else + p_ra->txrx_state = BI_DIRECTION_STATE; + +} + +void +phydm_common_info_self_update( + struct PHY_DM_STRUCT *p_dm +) +{ + u8 sta_cnt = 0, num_active_client = 0; + u32 i, one_entry_macid = 0; + u32 ma_rx_tp = 0; + struct cmn_sta_info *p_sta; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + + struct _ADAPTER *adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; + + p_sta = p_dm->p_phydm_sta_info[0]; + if (p_mgnt_info->mAssoc) { + p_sta->dm_ctrl |= STA_DM_CTRL_ACTIVE; + for (i = 0; i < 6; i++) + p_sta->mac_addr[i] = p_mgnt_info->Bssid[i]; + } else if (GetFirstClientPort(adapter)) { + struct _ADAPTER *p_client_adapter = GetFirstClientPort(adapter); + + p_sta->dm_ctrl |= STA_DM_CTRL_ACTIVE; + for (i = 0; i < 6; i++) + p_sta->mac_addr[i] = p_client_adapter->MgntInfo.Bssid[i]; + } else { + p_sta->dm_ctrl = p_sta->dm_ctrl & (~STA_DM_CTRL_ACTIVE); + for (i = 0; i < 6; i++) + p_sta->mac_addr[i] = 0; + } + + /* STA mode is linked to AP */ + if (is_sta_active(p_sta) && !ACTING_AS_AP(adapter)) + p_dm->bsta_state = true; + else + p_dm->bsta_state = false; +#endif + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + p_sta = p_dm->p_phydm_sta_info[i]; + if (is_sta_active(p_sta)) { + sta_cnt++; + + if (sta_cnt == 1) + one_entry_macid = i; + + phydm_cmn_sta_info_update(p_dm, (u8)i); + + ma_rx_tp = p_sta->rx_moving_average_tp + p_sta->tx_moving_average_tp; + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("TP[%d]: ((%d )) bit/sec\n", i, ma_rx_tp)); + + if (ma_rx_tp > ACTIVE_TP_THRESHOLD) + num_active_client++; + } + } + + if (sta_cnt == 1) { + p_dm->is_one_entry_only = true; + p_dm->one_entry_macid = one_entry_macid; + p_dm->one_entry_tp = ma_rx_tp; + + p_dm->tp_active_occur = 0; + + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("one_entry_tp=((%d)), pre_one_entry_tp=((%d))\n", + p_dm->one_entry_tp, p_dm->pre_one_entry_tp)); + + if ((p_dm->one_entry_tp > p_dm->pre_one_entry_tp) && (p_dm->pre_one_entry_tp <= 2)) { + if ((p_dm->one_entry_tp - p_dm->pre_one_entry_tp) > p_dm->tp_active_th) + p_dm->tp_active_occur = 1; + } + p_dm->pre_one_entry_tp = p_dm->one_entry_tp; + } else + p_dm->is_one_entry_only = false; + + p_dm->pre_number_linked_client = p_dm->number_linked_client; + p_dm->pre_number_active_client = p_dm->number_active_client; + + p_dm->number_linked_client = sta_cnt; + p_dm->number_active_client = num_active_client; + + /*Traffic load information update*/ + phydm_traffic_load_decision(p_dm); + + p_dm->phydm_sys_up_time += p_dm->phydm_period; + + p_dm->is_dfs_band = phydm_is_dfs_band(p_dm); + +} + +void +phydm_common_info_self_reset( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + p_dm->phy_dbg_info.num_qry_beacon_pkt = 0; +#endif +} + +void * +phydm_get_structure( + struct PHY_DM_STRUCT *p_dm, + u8 structure_type +) + +{ + void *p_struct = NULL; +#if RTL8195A_SUPPORT + switch (structure_type) { + case PHYDM_FALSEALMCNT: + p_struct = &false_alm_cnt; + break; + + case PHYDM_CFOTRACK: + p_struct = &dm_cfo_track; + break; + + case PHYDM_ADAPTIVITY: + p_struct = &(p_dm->adaptivity); + break; + + default: + break; + } + +#else + switch (structure_type) { + case PHYDM_FALSEALMCNT: + p_struct = &(p_dm->false_alm_cnt); + break; + + case PHYDM_CFOTRACK: + p_struct = &(p_dm->dm_cfo_track); + break; + + case PHYDM_ADAPTIVITY: + p_struct = &(p_dm->adaptivity); + break; + + case PHYDM_DFS: + p_struct = &(p_dm->dfs); + break; + + default: + break; + } + +#endif + return p_struct; +} + +void +phydm_hw_setting( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (RTL8821A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8821) + odm_hw_setting_8821a(p_dm); +#endif + +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8814A) + phydm_hwsetting_8814a(p_dm); +#endif + +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8822B) + phydm_hwsetting_8822b(p_dm); +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + phydm_hwsetting_8197f(p_dm); +#endif +} + + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) +u64 +phydm_supportability_init_win( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u64 support_ability = 0; + + switch (p_dm->support_ic_type) { + + /*---------------N Series--------------------*/ + #if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8703B_SUPPORT == 1) + case ODM_RTL8703B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8723D_SUPPORT == 1) + case ODM_RTL8723D: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /* ODM_BB_PWR_TRAIN | */ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8188F_SUPPORT == 1) + case ODM_RTL8188F: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + /*---------------AC Series-------------------*/ + + #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + case ODM_RTL8812: + case ODM_RTL8821: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_DYNAMIC_TXPWR | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_DYNAMIC_TXPWR | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_ADAPTIVE_SOML; + break; + #endif + + #if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + default: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + + dbg_print("[Warning] Supportability Init Warning !!!\n"); + break; + + } + + /*[Config Antenna Diveristy]*/ + if (*(p_dm->p_enable_antdiv)) + support_ability |= ODM_BB_ANT_DIV; + + /*[Config Adaptivity]*/ + if (*(p_dm->p_enable_adaptivity)) + support_ability |= ODM_BB_ADAPTIVITY; + + return support_ability; +} +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) +u64 +phydm_supportability_init_ce( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u64 support_ability = 0; + + switch (p_dm->support_ic_type) { + + /*---------------N Series--------------------*/ + #if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8703B_SUPPORT == 1) + case ODM_RTL8703B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8723D_SUPPORT == 1) + case ODM_RTL8723D: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /* ODM_BB_PWR_TRAIN | */ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8188F_SUPPORT == 1) + case ODM_RTL8188F: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + /*---------------AC Series-------------------*/ + + #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + case ODM_RTL8812: + case ODM_RTL8821: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + default: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + + dbg_print("[Warning] Supportability Init Warning !!!\n"); + break; + + } + + /*[Config Antenna Diveristy]*/ + if (*(p_dm->p_enable_antdiv)) + support_ability |= ODM_BB_ANT_DIV; + + /*[Config Adaptivity]*/ + if (*(p_dm->p_enable_adaptivity)) + support_ability |= ODM_BB_ADAPTIVITY; + + return support_ability; +} +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +u64 +phydm_supportability_init_ap( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u64 support_ability = 0; + + switch (p_dm->support_ic_type) { + + /*---------------N Series--------------------*/ + #if (RTL8188E_SUPPORT == 1) + case ODM_RTL8188E: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8192E_SUPPORT == 1) + case ODM_RTL8192E: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_PRIMARY_CCA; + break; + #endif + + #if (RTL8723B_SUPPORT == 1) + case ODM_RTL8723B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if ((RTL8198F_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) + case ODM_RTL8198F: + case ODM_RTL8197F: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ADAPTIVE_SOML | + ODM_BB_ENV_MONITOR | + ODM_BB_LNA_SAT_CHK | + ODM_BB_PRIMARY_CCA; + break; + #endif + + /*---------------AC Series-------------------*/ + + #if (RTL8881A_SUPPORT == 1) + case ODM_RTL8881A: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8814A_SUPPORT == 1) + case ODM_RTL8814A: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8814B_SUPPORT == 1) + case ODM_RTL8814B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8822B_SUPPORT == 1) + case ODM_RTL8822B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR | + ODM_BB_ADAPTIVE_SOML; + break; + #endif + + #if (RTL8821C_SUPPORT == 1) + case ODM_RTL8821C: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + + break; + #endif + + default: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + + dbg_print("[Warning] Supportability Init Warning !!!\n"); + break; + + } + + #if 0 + /*[Config Antenna Diveristy]*/ + if (*(p_dm->p_enable_antdiv)) + support_ability |= ODM_BB_ANT_DIV; + + /*[Config Adaptivity]*/ + if (*(p_dm->p_enable_adaptivity)) + support_ability |= ODM_BB_ADAPTIVITY; + #endif + + return support_ability; +} +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_IOT)) +u64 +phydm_supportability_init_iot( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u64 support_ability = 0; + + switch (p_dm->support_ic_type) { + + #if (RTL8710B_SUPPORT == 1) + case ODM_RTL8710B: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + #if (RTL8195A_SUPPORT == 1) + case ODM_RTL8195A: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + break; + #endif + + default: + support_ability |= + ODM_BB_DIG | + ODM_BB_RA_MASK | + /*ODM_BB_DYNAMIC_TXPWR |*/ + ODM_BB_FA_CNT | + ODM_BB_RSSI_MONITOR | + ODM_BB_CCK_PD | + /*ODM_BB_PWR_TRAIN |*/ + ODM_BB_RATE_ADAPTIVE | + ODM_BB_CFO_TRACKING | + ODM_BB_ENV_MONITOR; + + dbg_print("[Warning] Supportability Init Warning !!!\n"); + break; + + } + + /*[Config Antenna Diveristy]*/ + if (*(p_dm->p_enable_antdiv)) + support_ability |= ODM_BB_ANT_DIV; + + /*[Config Adaptivity]*/ + if (*(p_dm->p_enable_adaptivity)) + support_ability |= ODM_BB_ADAPTIVITY; + + return support_ability; +} +#endif + +void +phydm_fwoffload_ability_init( + struct PHY_DM_STRUCT *p_dm, + enum phydm_offload_ability offload_ability +) +{ + + switch (offload_ability) { + + case PHYDM_PHY_PARAM_OFFLOAD: + if (p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + p_dm->fw_offload_ability |= PHYDM_PHY_PARAM_OFFLOAD; + break; + + case PHYDM_RF_IQK_OFFLOAD: + p_dm->fw_offload_ability |= PHYDM_RF_IQK_OFFLOAD; + break; + + default: + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("fwofflad, wrong init type!!\n")); + break; + + } + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("fw_offload_ability = %x\n", p_dm->fw_offload_ability)); + +} +void +phydm_fwoffload_ability_clear( + struct PHY_DM_STRUCT *p_dm, + enum phydm_offload_ability offload_ability +) +{ + + switch (offload_ability) { + + case PHYDM_PHY_PARAM_OFFLOAD: + if (p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) + p_dm->fw_offload_ability &= (~PHYDM_PHY_PARAM_OFFLOAD); + break; + + case PHYDM_RF_IQK_OFFLOAD: + p_dm->fw_offload_ability &= (~PHYDM_RF_IQK_OFFLOAD); + break; + + default: + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("fwofflad, wrong init type!!\n")); + break; + + } + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("fw_offload_ability = %x\n", p_dm->fw_offload_ability)); + +} + +void +phydm_supportability_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u64 support_ability; + + if (*(p_dm->p_mp_mode) == true) { + support_ability = 0; + + /**/ + } else { + + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + support_ability = phydm_supportability_init_win(p_dm); + #elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + support_ability = phydm_supportability_init_ap(p_dm); + #elif(DM_ODM_SUPPORT_TYPE & (ODM_CE)) + support_ability = phydm_supportability_init_ce(p_dm); + #elif(DM_ODM_SUPPORT_TYPE & (ODM_IOT)) + support_ability = phydm_supportability_init_iot(p_dm); + #endif + } + odm_cmn_info_init(p_dm, ODM_CMNINFO_ABILITY, support_ability); + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("IC = ((0x%x)), Supportability Init = ((0x%llx))\n", p_dm->support_ic_type, p_dm->support_ability)); +} + +void +phydm_rfe_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("RFE_Init\n")); +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + phydm_rfe_8822b_init(p_dm); + /**/ + } +#endif +} + +void +phydm_dm_early_init( + struct PHY_DM_STRUCT *p_dm +) +{ + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + halrf_init(p_dm); + #endif +} + +void +odm_dm_init( + struct PHY_DM_STRUCT *p_dm +) +{ + halrf_init(p_dm); + phydm_supportability_init(p_dm); + phydm_rfe_init(p_dm); + phydm_common_info_self_init(p_dm); + phydm_rx_phy_status_init(p_dm); + phydm_auto_dbg_engine_init(p_dm); + phydm_dig_init(p_dm); + phydm_cck_pd_init(p_dm); + phydm_env_monitor_init(p_dm); + phydm_adaptivity_init(p_dm); + phydm_ra_info_init(p_dm); + phydm_rssi_monitor_init(p_dm); + phydm_cfo_tracking_init(p_dm); + phydm_rf_init(p_dm); + odm_txpowertracking_init(p_dm); + phydm_dc_cancellation(p_dm); +#ifdef PHYDM_TXA_CALIBRATION + phydm_txcurrentcalibration(p_dm); + phydm_get_pa_bias_offset(p_dm); +#endif + odm_antenna_diversity_init(p_dm); + phydm_adaptive_soml_init(p_dm); +#ifdef CONFIG_DYNAMIC_RX_PATH + phydm_dynamic_rx_path_init(p_dm); +#endif + odm_auto_channel_select_init(p_dm); + phydm_path_diversity_init(p_dm); + phydm_dynamic_tx_power_init(p_dm); +#if (PHYDM_LA_MODE_SUPPORT == 1) + adc_smp_init(p_dm); +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + phydm_beamforming_init(p_dm); +#endif +#if (RTL8188E_SUPPORT == 1) + odm_ra_info_init_all(p_dm); +#endif + + phydm_primary_cca_init(p_dm); + + #ifdef CONFIG_PSD_TOOL + phydm_psd_init(p_dm); + #endif + + #ifdef CONFIG_SMART_ANTENNA + phydm_smt_ant_init(p_dm); + #endif + +} + +void +odm_dm_reset( + struct PHY_DM_STRUCT *p_dm +) +{ + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + + odm_ant_div_reset(p_dm); + phydm_set_edcca_threshold_api(p_dm, p_dig_t->cur_ig_value); +} + +void +phydm_support_ability_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u64 pre_support_ability, one = 1; + u32 used = *_used; + u32 out_len = *_out_len; + + pre_support_ability = p_dm->support_ability; + + PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); + if (dm_value[0] == 100) { + PHYDM_SNPRINTF((output + used, out_len - used, "[Supportability] PhyDM Selection\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))DIG\n", ((p_dm->support_ability & ODM_BB_DIG) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((p_dm->support_ability & ODM_BB_RA_MASK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYN_TXPWR\n", ((p_dm->support_ability & ODM_BB_DYNAMIC_TXPWR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((p_dm->support_ability & ODM_BB_FA_CNT) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MNTR\n", ((p_dm->support_ability & ODM_BB_RSSI_MONITOR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))CCK_PD\n", ((p_dm->support_ability & ODM_BB_CCK_PD) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((p_dm->support_ability & ODM_BB_ANT_DIV) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "07. (( %s ))SMT_ANT\n", ((p_dm->support_ability & ODM_BB_SMT_ANT) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))PWR_TRAIN\n", ((p_dm->support_ability & ODM_BB_PWR_TRAIN) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RA\n", ((p_dm->support_ability & ODM_BB_RATE_ADAPTIVE) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((p_dm->support_ability & ODM_BB_PATH_DIV) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "11. (( %s ))DFS\n", ((p_dm->support_ability & ODM_BB_DFS) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "12. (( %s ))DYN_ARFR\n", ((p_dm->support_ability & ODM_BB_DYNAMIC_ARFR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "13. (( %s ))ADAPTIVITY\n", ((p_dm->support_ability & ODM_BB_ADAPTIVITY) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))CFO_TRACK\n", ((p_dm->support_ability & ODM_BB_CFO_TRACKING) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))ENV_MONITOR\n", ((p_dm->support_ability & ODM_BB_ENV_MONITOR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))PRI_CCA\n", ((p_dm->support_ability & ODM_BB_PRIMARY_CCA) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))ADPTV_SOML\n", ((p_dm->support_ability & ODM_BB_ADAPTIVE_SOML) ? ("V") : (".")))); + /*PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))TBD\n", ((p_dm->support_ability & ODM_BB_TBD) ? ("V") : ("."))));*/ + /*PHYDM_SNPRINTF((output + used, out_len - used, "19. (( %s ))TBD\n", ((p_dm->support_ability & ODM_BB_TBD) ? ("V") : ("."))));*/ + PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))DYN_RX_PATH\n", ((p_dm->support_ability & ODM_BB_DYNAMIC_RX_PATH) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + PHYDM_SNPRINTF((output + used, out_len - used, "[Supportability] PhyDM offload ability\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))PHY PARAM OFFLOAD\n", ((p_dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RF IQK OFFLOAD\n", ((p_dm->fw_offload_ability & PHYDM_RF_IQK_OFFLOAD) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + + } + /* + else if(dm_value[0] == 101) + { + p_dm->support_ability = 0 ; + dbg_print("Disable all support_ability components\n"); + PHYDM_SNPRINTF((output+used, out_len-used,"%s\n", "Disable all support_ability components")); + } + */ + else { + + if (dm_value[1] == 1) { /* enable */ + p_dm->support_ability |= (one << dm_value[0]); + if (BIT(dm_value[0]) & ODM_BB_PATH_DIV) + phydm_path_diversity_init(p_dm); + } else if (dm_value[1] == 2) /* disable */ + p_dm->support_ability &= ~(one << dm_value[0]); + else + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); + } + PHYDM_SNPRINTF((output + used, out_len - used, "pre-support_ability = 0x%llx\n", pre_support_ability)); + PHYDM_SNPRINTF((output + used, out_len - used, "Curr-support_ability = 0x%llx\n", p_dm->support_ability)); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + + *_used = used; + *_out_len = out_len; +} + +void +phydm_watchdog_lps_32k( + struct PHY_DM_STRUCT *p_dm +) +{ + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("%s ======>\n", __func__)); + + phydm_common_info_self_update(p_dm); + phydm_rssi_monitor_check(p_dm); + phydm_dig_lps_32k(p_dm); + phydm_common_info_self_reset(p_dm); +} + +void +phydm_watchdog_lps( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("%s ======>\n", __func__)); + + phydm_common_info_self_update(p_dm); + phydm_rssi_monitor_check(p_dm); + phydm_basic_dbg_message(p_dm); + phydm_receiver_blocking(p_dm); + odm_false_alarm_counter_statistics(p_dm); + phydm_dig_by_rssi_lps(p_dm); + phydm_cck_pd_th(p_dm); + phydm_adaptivity(p_dm); + #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + odm_antenna_diversity(p_dm); /*enable AntDiv in PS mode, request from SD4 Jeff*/ + #endif + phydm_common_info_self_reset(p_dm); +#endif +} + +void +phydm_watchdog_mp( + struct PHY_DM_STRUCT *p_dm +) +{ +#ifdef CONFIG_DYNAMIC_RX_PATH + phydm_dynamic_rx_path_caller(p_dm); +#endif +} + +void +phydm_pause_dm_watchdog( + void *p_dm_void, + enum phydm_pause_type pause_type +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (pause_type == PHYDM_PAUSE) { + p_dm->disable_phydm_watchdog = 1; + PHYDM_DBG(p_dm, ODM_COMP_API, ("PHYDM Stop\n")); + } else { + p_dm->disable_phydm_watchdog = 0; + PHYDM_DBG(p_dm, ODM_COMP_API, ("PHYDM Start\n")); + } +} + +u8 +phydm_pause_func( + void *p_dm_void, + enum phydm_func_idx_e pause_func, + enum phydm_pause_type pause_type, + enum phydm_pause_level pause_lv, + u8 val_lehgth, + u32 *val_buf +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + s8 *pause_lv_pre = &(p_dm->s8_dummy); + u32 *bkp_val = &(p_dm->u32_dummy); + u32 ori_val[5] = {0}; + u64 pause_func_bitmap = (u64)BIT(pause_func); + u8 i; + + + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[%s][%s] LV=%d, Len=%d\n", __func__, + ((pause_type == PHYDM_PAUSE) ? "Pause" : "Resume"), pause_lv, val_lehgth)); + + if (pause_lv >= PHYDM_PAUSE_MAX_NUM) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[WARNING] Wrong LV=%d\n", pause_lv)); + return PAUSE_FAIL; + } + + if (pause_func == F00_DIG) { + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[DIG]\n")); + + if (val_lehgth != 1) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[WARNING] val_length != 1\n")); + return PAUSE_FAIL; + } + + ori_val[0] = (u32)(p_dm->dm_dig_table.cur_ig_value); /*0xc50*/ + pause_lv_pre = &(p_dm->pause_lv_table.lv_dig); + bkp_val = (u32*)(&(p_dm->dm_dig_table.rvrt_val)); + p_dm->phydm_func_handler.pause_phydm_handler = phydm_set_dig_val; /*function pointer hook*/ + + } else + +#ifdef PHYDM_SUPPORT_CCKPD + if (pause_func == F05_CCK_PD) { + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[CCK_PD]\n")); + + if (val_lehgth != 2) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[WARNING] val_length != 2\n")); + return PAUSE_FAIL; + } + + ori_val[0] = p_dm->dm_cckpd_table.cur_cck_cca_thres; /*0xa0a*/ + ori_val[1] = p_dm->dm_cckpd_table.cck_cca_th_aaa; /*0xaaa*/ + pause_lv_pre = &(p_dm->pause_lv_table.lv_cckpd); + bkp_val = &(p_dm->dm_cckpd_table.rvrt_val[0]); + p_dm->phydm_func_handler.pause_phydm_handler = phydm_set_cckpd_val; /*function pointer hook*/ + + } else +#endif + +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + if (pause_func == F06_ANT_DIV) { + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[AntDiv]\n")); + + if (val_lehgth != 1) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[WARNING] val_length != 1\n")); + return PAUSE_FAIL; + } + + ori_val[0] = (u32)(p_dm->dm_fat_table.rx_idle_ant); /*default antenna*/ + pause_lv_pre = &(p_dm->pause_lv_table.lv_antdiv); + bkp_val = (u32*)(&(p_dm->dm_fat_table.rvrt_val)); + p_dm->phydm_func_handler.pause_phydm_handler = phydm_set_antdiv_val; /*function pointer hook*/ + + } else +#endif + + if (pause_func == F13_ADPTVTY) { + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[Adaptivity]\n")); + + if (val_lehgth != 2) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[WARNING] val_length != 2\n")); + return PAUSE_FAIL; + } + + ori_val[0] = (u32)(p_dm->adaptivity.th_l2h); /*th_l2h*/ + ori_val[1] = (u32)(p_dm->adaptivity.th_h2l); /*th_h2l*/ + pause_lv_pre = &(p_dm->pause_lv_table.lv_adapt); + bkp_val = (u32 *)(&(p_dm->adaptivity.rvrt_val)); + p_dm->phydm_func_handler.pause_phydm_handler = phydm_set_edcca_val; /*function pointer hook*/ + + } else + + { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[WARNING] error func idx\n")); + return PAUSE_FAIL; + } + + PHYDM_DBG(p_dm, ODM_COMP_API, ("Pause_LV{new , pre} = {%d ,%d}\n", pause_lv, *pause_lv_pre)); + + if ((pause_type == PHYDM_PAUSE) || (pause_type == PHYDM_PAUSE_NO_SET)) { + + if (pause_lv > *pause_lv_pre) { + + if (!(p_dm->pause_ability & pause_func_bitmap)) { + + for (i = 0; i < val_lehgth; i ++) + bkp_val[i] = ori_val[i]; + } + + p_dm->pause_ability |= pause_func_bitmap; + PHYDM_DBG(p_dm, ODM_COMP_API, ("pause_ability=0x%llx\n", p_dm->pause_ability)); + + if (pause_type == PHYDM_PAUSE) { + + for (i = 0; i < val_lehgth; i ++) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[PAUSE SUCCESS] val_idx[%d]{New, Ori}={0x%x, 0x%x}\n",i, val_buf[i], bkp_val[i])); + /**/ + } + p_dm->phydm_func_handler.pause_phydm_handler(p_dm, val_buf, val_lehgth); + } else { + + for (i = 0; i < val_lehgth; i ++) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[PAUSE NO Set: SUCCESS] val_idx[%d]{Ori}={0x%x}\n",i, bkp_val[i])); + /**/ + } + } + + *pause_lv_pre = pause_lv; + return PAUSE_SUCCESS; + + } else { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[PAUSE FAIL] Pre_LV >= Curr_LV\n")); + return PAUSE_FAIL; + } + + } else if (pause_type == PHYDM_RESUME) { + p_dm->pause_ability &= ~pause_func_bitmap; + PHYDM_DBG(p_dm, ODM_COMP_API, ("pause_ability=0x%llx\n", p_dm->pause_ability)); + + *pause_lv_pre = PHYDM_PAUSE_RELEASE; + + for (i = 0; i < val_lehgth; i ++) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[RESUME] val_idx[%d]={0x%x}\n", i, bkp_val[i])); + } + + p_dm->phydm_func_handler.pause_phydm_handler(p_dm, bkp_val, val_lehgth); + + return PAUSE_SUCCESS; + } else { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[WARNING] error pause_type\n")); + return PAUSE_FAIL; + } + +} + +void +phydm_pause_func_console( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i; + u8 val_length = 0; + u32 val_buf[5] = {0}; + u8 set_result = 0; + enum phydm_func_idx_e func = 0; + enum phydm_pause_type pause_type = 0; + enum phydm_pause_level pause_lv = 0; + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "{Func} {1:pause, 2:Resume} {lv} Val[5:0]\n")); + + } else { + + for (i = 0; i < 10; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + } + } + + func = (enum phydm_func_idx_e)var1[0]; + pause_type = (enum phydm_pause_type)var1[1]; + pause_lv = (enum phydm_pause_level)var1[2]; + + + for (i = 0; i < 5; i++) { + val_buf[i] = var1[3 + i]; + } + + if (func == F00_DIG) { + PHYDM_SNPRINTF((output + used, out_len - used, "[DIG]\n")); + val_length = 1; + + } else if (func == F05_CCK_PD) { + PHYDM_SNPRINTF((output + used, out_len - used, "[CCK_PD]\n")); + val_length = 2; + } else if (func == F06_ANT_DIV) { + PHYDM_SNPRINTF((output + used, out_len - used, "[Ant_Div]\n")); + val_length = 1; + } else if (func == F13_ADPTVTY) { + PHYDM_SNPRINTF((output + used, out_len - used, "[Adaptivity]\n")); + val_length = 2; + } else { + PHYDM_SNPRINTF((output + used, out_len - used, "[Set Function Error]\n")); + val_length = 0; + } + + if (val_length != 0) { + + PHYDM_SNPRINTF((output + used, out_len - used, "{%s, lv=%d} val = %d, %d}\n", + ((pause_type == PHYDM_PAUSE) ? "Pause" : "Resume"), pause_lv, var1[3], var1[4])); + + set_result= phydm_pause_func(p_dm, func, pause_type, pause_lv, val_length, val_buf); + } + + PHYDM_SNPRINTF((output + used, out_len - used, "set_result = %d\n", set_result)); + } + + + *_used = used; + *_out_len = out_len; +} + +u8 +phydm_stop_dm_watchdog_check( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->disable_phydm_watchdog == 1) { + + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("Disable phydm\n")); + return true; + + } else if (phydm_acs_check(p_dm) == true) { + + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("Disable phydm by ACS\n")); + return true; + + } else + return false; + +} + +/* + * 2011/09/20 MH This is the entry pointer for all team to execute HW out source DM. + * You can not add any dummy function here, be care, you can only use DM structure + * to perform any new ODM_DM. + * */ +void +phydm_watchdog( + struct PHY_DM_STRUCT *p_dm +) +{ + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("%s ======>\n", __func__)); + + phydm_common_info_self_update(p_dm); + phydm_rssi_monitor_check(p_dm); + phydm_basic_dbg_message(p_dm); + phydm_auto_dbg_engine(p_dm); + phydm_receiver_blocking(p_dm); + + if (phydm_stop_dm_watchdog_check(p_dm) == true) + return; + + phydm_hw_setting(p_dm); + + #if 0 /*(DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))*/ + if (*(p_dm->p_is_power_saving) == true) { + + PHYDM_DBG(p_dm, DBG_COMMON_FLOW, ("PHYDM power saving mode\n")); + phydm_dig_by_rssi_lps(p_dm); + phydm_adaptivity(p_dm); + + #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + odm_antenna_diversity(p_dm); /*enable AntDiv in PS mode, request from SD4 Jeff*/ + #endif + return; + } + #endif + + #ifdef PHYDM_TDMA_DIG_SUPPORT + if (p_dm->original_dig_restore == 0) + phydm_tdma_dig_timer_check(p_dm); + else + #endif + { + odm_false_alarm_counter_statistics(p_dm); + phydm_noisy_detection(p_dm); + phydm_dig(p_dm); + phydm_cck_pd_th(p_dm); + } +#ifdef PHYDM_POWER_TRAINING_SUPPORT + phydm_update_power_training_state(p_dm); +#endif + phydm_adaptivity(p_dm); + phydm_ra_info_watchdog(p_dm); + odm_path_diversity(p_dm); + odm_cfo_tracking(p_dm); + odm_dynamic_tx_power(p_dm); + odm_antenna_diversity(p_dm); + phydm_adaptive_soml(p_dm); +#ifdef CONFIG_DYNAMIC_RX_PATH + phydm_dynamic_rx_path(p_dm); +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + phydm_beamforming_watchdog(p_dm); +#endif + + halrf_watchdog(p_dm); + phydm_primary_cca(p_dm); + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + odm_dtc(p_dm); +#endif + + phydm_ccx_monitor(p_dm); + +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + phydm_lna_sat_chk_watchdog(p_dm); +#endif + + phydm_common_info_self_reset(p_dm); + +} + + +/* + * Init /.. Fixed HW value. Only init time. + * */ +void +odm_cmn_info_init( + struct PHY_DM_STRUCT *p_dm, + enum odm_cmninfo_e cmn_info, + u64 value +) +{ + /* */ + /* This section is used for init value */ + /* */ + switch (cmn_info) { + /* */ + /* Fixed ODM value. */ + /* */ + case ODM_CMNINFO_ABILITY: + p_dm->support_ability = (u64)value; + break; + + case ODM_CMNINFO_RF_TYPE: + p_dm->rf_type = (u8)value; + break; + + case ODM_CMNINFO_PLATFORM: + p_dm->support_platform = (u8)value; + break; + + case ODM_CMNINFO_INTERFACE: + p_dm->support_interface = (u8)value; + break; + + case ODM_CMNINFO_MP_TEST_CHIP: + p_dm->is_mp_chip = (u8)value; + break; + + case ODM_CMNINFO_IC_TYPE: + p_dm->support_ic_type = (u32)value; + break; + + case ODM_CMNINFO_CUT_VER: + p_dm->cut_version = (u8)value; + break; + + case ODM_CMNINFO_FAB_VER: + p_dm->fab_version = (u8)value; + break; + + case ODM_CMNINFO_RFE_TYPE: + p_dm->rfe_type = (u8)value; + phydm_init_hw_info_by_rfe(p_dm); + break; + + case ODM_CMNINFO_RF_ANTENNA_TYPE: + p_dm->ant_div_type = (u8)value; + break; + + case ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH: + p_dm->with_extenal_ant_switch = (u8)value; + break; + + case ODM_CMNINFO_BE_FIX_TX_ANT: + p_dm->dm_fat_table.b_fix_tx_ant = (u8)value; + break; + + case ODM_CMNINFO_BOARD_TYPE: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->board_type = (u8)value; + break; + + case ODM_CMNINFO_PACKAGE_TYPE: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->package_type = (u8)value; + break; + + case ODM_CMNINFO_EXT_LNA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->ext_lna = (u8)value; + break; + + case ODM_CMNINFO_5G_EXT_LNA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->ext_lna_5g = (u8)value; + break; + + case ODM_CMNINFO_EXT_PA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->ext_pa = (u8)value; + break; + + case ODM_CMNINFO_5G_EXT_PA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->ext_pa_5g = (u8)value; + break; + + case ODM_CMNINFO_GPA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->type_gpa = (u16)value; + break; + + case ODM_CMNINFO_APA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->type_apa = (u16)value; + break; + + case ODM_CMNINFO_GLNA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->type_glna = (u16)value; + break; + + case ODM_CMNINFO_ALNA: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->type_alna = (u16)value; + break; + + case ODM_CMNINFO_EXT_TRSW: + if (!p_dm->is_init_hw_info_by_rfe) + p_dm->ext_trsw = (u8)value; + break; + case ODM_CMNINFO_EXT_LNA_GAIN: + p_dm->ext_lna_gain = (u8)value; + break; + case ODM_CMNINFO_PATCH_ID: + p_dm->iot_table.win_patch_id = (u8)value; + break; + case ODM_CMNINFO_BINHCT_TEST: + p_dm->is_in_hct_test = (boolean)value; + break; + case ODM_CMNINFO_BWIFI_TEST: + p_dm->wifi_test = (u8)value; + break; + case ODM_CMNINFO_SMART_CONCURRENT: + p_dm->is_dual_mac_smart_concurrent = (boolean)value; + break; + case ODM_CMNINFO_DOMAIN_CODE_2G: + p_dm->odm_regulation_2_4g = (u8)value; + break; + case ODM_CMNINFO_DOMAIN_CODE_5G: + p_dm->odm_regulation_5g = (u8)value; + break; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + case ODM_CMNINFO_CONFIG_BB_RF: + p_dm->config_bbrf = (boolean)value; + break; +#endif + case ODM_CMNINFO_IQKPAOFF: + p_dm->rf_calibrate_info.is_iqk_pa_off = (boolean)value; + break; + case ODM_CMNINFO_REGRFKFREEENABLE: + p_dm->rf_calibrate_info.reg_rf_kfree_enable = (u8)value; + break; + case ODM_CMNINFO_RFKFREEENABLE: + p_dm->rf_calibrate_info.rf_kfree_enable = (u8)value; + break; + case ODM_CMNINFO_NORMAL_RX_PATH_CHANGE: + p_dm->normal_rx_path = (u8)value; + break; + case ODM_CMNINFO_EFUSE0X3D8: + p_dm->efuse0x3d8 = (u8)value; + break; + case ODM_CMNINFO_EFUSE0X3D7: + p_dm->efuse0x3d7 = (u8)value; + break; + case ODM_CMNINFO_ADVANCE_OTA: + p_dm->p_advance_ota = (u8)value; + break; + +#ifdef CONFIG_PHYDM_DFS_MASTER + case ODM_CMNINFO_DFS_REGION_DOMAIN: + p_dm->dfs_region_domain = (u8)value; + break; +#endif + case ODM_CMNINFO_SOFT_AP_SPECIAL_SETTING: + p_dm->soft_ap_special_setting = (u32)value; + break; + + case ODM_CMNINFO_DPK_EN: + /*p_dm->dpk_en = (u1Byte)value;*/ + halrf_cmn_info_set(p_dm, HALRF_CMNINFO_DPK_EN, (u64)value); + break; + + case ODM_CMNINFO_HP_HWID: + p_dm->hp_hw_id = (boolean)value; + break; + /* To remove the compiler warning, must add an empty default statement to handle the other values. */ + default: + /* do nothing */ + break; + + } + +} + + +void +odm_cmn_info_hook( + struct PHY_DM_STRUCT *p_dm, + enum odm_cmninfo_e cmn_info, + void *p_value +) +{ + /* */ + /* Hook call by reference pointer. */ + /* */ + switch (cmn_info) { + /* */ + /* Dynamic call by reference pointer. */ + /* */ + case ODM_CMNINFO_TX_UNI: + p_dm->p_num_tx_bytes_unicast = (u64 *)p_value; + break; + + case ODM_CMNINFO_RX_UNI: + p_dm->p_num_rx_bytes_unicast = (u64 *)p_value; + break; + + case ODM_CMNINFO_BAND: + p_dm->p_band_type = (u8 *)p_value; + break; + + case ODM_CMNINFO_SEC_CHNL_OFFSET: + p_dm->p_sec_ch_offset = (u8 *)p_value; + break; + + case ODM_CMNINFO_SEC_MODE: + p_dm->p_security = (u8 *)p_value; + break; + + case ODM_CMNINFO_BW: + p_dm->p_band_width = (u8 *)p_value; + break; + + case ODM_CMNINFO_CHNL: + p_dm->p_channel = (u8 *)p_value; + break; + + case ODM_CMNINFO_SCAN: + p_dm->p_is_scan_in_process = (boolean *)p_value; + break; + + case ODM_CMNINFO_POWER_SAVING: + p_dm->p_is_power_saving = (boolean *)p_value; + break; + + case ODM_CMNINFO_ONE_PATH_CCA: + p_dm->p_one_path_cca = (u8 *)p_value; + break; + + case ODM_CMNINFO_DRV_STOP: + p_dm->p_is_driver_stopped = (boolean *)p_value; + break; + + case ODM_CMNINFO_PNP_IN: + p_dm->p_is_driver_is_going_to_pnp_set_power_sleep = (boolean *)p_value; + break; + + case ODM_CMNINFO_INIT_ON: + p_dm->pinit_adpt_in_progress = (boolean *)p_value; + break; + + case ODM_CMNINFO_ANT_TEST: + p_dm->p_antenna_test = (u8 *)p_value; + break; + + case ODM_CMNINFO_NET_CLOSED: + p_dm->p_is_net_closed = (boolean *)p_value; + break; + + case ODM_CMNINFO_FORCED_RATE: + p_dm->p_forced_data_rate = (u16 *)p_value; + break; + case ODM_CMNINFO_ANT_DIV: + p_dm->p_enable_antdiv = (u8 *)p_value; + break; + case ODM_CMNINFO_ADAPTIVITY: + p_dm->p_enable_adaptivity = (u8 *)p_value; + break; + + case ODM_CMNINFO_P2P_LINK: + p_dm->dm_dig_table.is_p2p_in_process = (u8 *)p_value; + break; + + case ODM_CMNINFO_IS1ANTENNA: + p_dm->p_is_1_antenna = (boolean *)p_value; + break; + + case ODM_CMNINFO_RFDEFAULTPATH: + p_dm->p_rf_default_path = (u8 *)p_value; + break; + + case ODM_CMNINFO_FCS_MODE: + p_dm->p_is_fcs_mode_enable = (boolean *)p_value; + break; + /*add by YuChen for beamforming PhyDM*/ + case ODM_CMNINFO_HUBUSBMODE: + p_dm->hub_usb_mode = (u8 *)p_value; + break; + case ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS: + p_dm->p_is_fw_dw_rsvd_page_in_progress = (boolean *)p_value; + break; + case ODM_CMNINFO_TX_TP: + p_dm->p_current_tx_tp = (u32 *)p_value; + break; + case ODM_CMNINFO_RX_TP: + p_dm->p_current_rx_tp = (u32 *)p_value; + break; + case ODM_CMNINFO_SOUNDING_SEQ: + p_dm->p_sounding_seq = (u8 *)p_value; + break; +#ifdef CONFIG_PHYDM_DFS_MASTER + case ODM_CMNINFO_DFS_MASTER_ENABLE: + p_dm->dfs_master_enabled = (u8 *)p_value; + break; +#endif + case ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC: + p_dm->dm_fat_table.p_force_tx_ant_by_desc = (u8 *)p_value; + break; + case ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA: + p_dm->dm_fat_table.p_default_s0_s1 = (u8 *)p_value; + break; + case ODM_CMNINFO_SOFT_AP_MODE: + p_dm->p_soft_ap_mode = (u32 *)p_value; + break; + case ODM_CMNINFO_MP_MODE: + p_dm->p_mp_mode = (u8 *)p_value; + break; + case ODM_CMNINFO_INTERRUPT_MASK: + p_dm->p_interrupt_mask = (u32 *)p_value; + break; + case ODM_CMNINFO_BB_OPERATION_MODE: + p_dm->p_bb_op_mode = (u8 *)p_value; + break; + case ODM_CMNINFO_BF_ANTDIV_DECISION: + p_dm->dm_fat_table.is_no_csi_feedback = (boolean *)p_value; + break; + + default: + /*do nothing*/ + break; + + } + +} +/* + * Update band/CHannel/.. The values are dynamic but non-per-packet. + * */ +void +odm_cmn_info_update( + struct PHY_DM_STRUCT *p_dm, + u32 cmn_info, + u64 value +) +{ + /* */ + /* This init variable may be changed in run time. */ + /* */ + switch (cmn_info) { + case ODM_CMNINFO_LINK_IN_PROGRESS: + p_dm->is_link_in_process = (boolean)value; + break; + + case ODM_CMNINFO_ABILITY: + p_dm->support_ability = (u64)value; + break; + + case ODM_CMNINFO_RF_TYPE: + p_dm->rf_type = (u8)value; + break; + + case ODM_CMNINFO_WIFI_DIRECT: + p_dm->is_wifi_direct = (boolean)value; + break; + + case ODM_CMNINFO_WIFI_DISPLAY: + p_dm->is_wifi_display = (boolean)value; + break; + + case ODM_CMNINFO_LINK: + p_dm->is_linked = (boolean)value; + break; + + case ODM_CMNINFO_CMW500LINK: + p_dm->iot_table.is_linked_cmw500 = (boolean)value; + break; + + case ODM_CMNINFO_STATION_STATE: + p_dm->bsta_state = (boolean)value; + break; + + case ODM_CMNINFO_RSSI_MIN: + p_dm->rssi_min = (u8)value; + break; + + case ODM_CMNINFO_RSSI_MIN_BY_PATH: + p_dm->rssi_min_by_path = (u8)value; + break; + + case ODM_CMNINFO_DBG_COMP: + p_dm->debug_components = (u64)value; + break; + + case ODM_CMNINFO_DBG_LEVEL: + p_dm->debug_level = (u32)value; + break; + +#ifdef ODM_CONFIG_BT_COEXIST + /* The following is for BT HS mode and BT coexist mechanism. */ + case ODM_CMNINFO_BT_ENABLED: + p_dm->bt_info_table.is_bt_enabled = (boolean)value; + break; + + case ODM_CMNINFO_BT_HS_CONNECT_PROCESS: + p_dm->bt_info_table.is_bt_connect_process = (boolean)value; + break; + + case ODM_CMNINFO_BT_HS_RSSI: + p_dm->bt_info_table.bt_hs_rssi = (u8)value; + break; + + case ODM_CMNINFO_BT_OPERATION: + p_dm->bt_info_table.is_bt_hs_operation = (boolean)value; + break; + + case ODM_CMNINFO_BT_LIMITED_DIG: + p_dm->bt_info_table.is_bt_limited_dig = (boolean)value; + break; +#endif + + case ODM_CMNINFO_AP_TOTAL_NUM: + p_dm->ap_total_num = (u8)value; + break; + + case ODM_CMNINFO_POWER_TRAINING: + p_dm->is_disable_power_training = (boolean)value; + break; + +#ifdef CONFIG_PHYDM_DFS_MASTER + case ODM_CMNINFO_DFS_REGION_DOMAIN: + p_dm->dfs_region_domain = (u8)value; + break; +#endif + + case ODM_CMNINFO_BT_CONTINUOUS_TURN: + p_dm->is_bt_continuous_turn = (boolean)value; + break; + +#if 0 + case ODM_CMNINFO_OP_MODE: + p_dm->op_mode = (u8)value; + break; + + case ODM_CMNINFO_BAND: + p_dm->band_type = (u8)value; + break; + + case ODM_CMNINFO_SEC_CHNL_OFFSET: + p_dm->sec_ch_offset = (u8)value; + break; + + case ODM_CMNINFO_SEC_MODE: + p_dm->security = (u8)value; + break; + + case ODM_CMNINFO_BW: + p_dm->band_width = (u8)value; + break; + + case ODM_CMNINFO_CHNL: + p_dm->channel = (u8)value; + break; +#endif + default: + /* do nothing */ + break; + } + + +} + +u32 +phydm_cmn_info_query( + struct PHY_DM_STRUCT *p_dm, + enum phydm_info_query_e info_type +) +{ + struct phydm_fa_struct *p_fa_t = &(p_dm->false_alm_cnt); + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + switch (info_type) { + + /*=== [FA Relative] ===========================================*/ + case PHYDM_INFO_FA_OFDM: + return p_fa_t->cnt_ofdm_fail; + + case PHYDM_INFO_FA_CCK: + return p_fa_t->cnt_cck_fail; + + case PHYDM_INFO_FA_TOTAL: + return p_fa_t->cnt_all; + + case PHYDM_INFO_CCA_OFDM: + return p_fa_t->cnt_ofdm_cca; + + case PHYDM_INFO_CCA_CCK: + return p_fa_t->cnt_cck_cca; + + case PHYDM_INFO_CCA_ALL: + return p_fa_t->cnt_cca_all; + + case PHYDM_INFO_CRC32_OK_VHT: + return p_fa_t->cnt_vht_crc32_ok; + + case PHYDM_INFO_CRC32_OK_HT: + return p_fa_t->cnt_ht_crc32_ok; + + case PHYDM_INFO_CRC32_OK_LEGACY: + return p_fa_t->cnt_ofdm_crc32_ok; + + case PHYDM_INFO_CRC32_OK_CCK: + return p_fa_t->cnt_cck_crc32_ok; + + case PHYDM_INFO_CRC32_ERROR_VHT: + return p_fa_t->cnt_vht_crc32_error; + + case PHYDM_INFO_CRC32_ERROR_HT: + return p_fa_t->cnt_ht_crc32_error; + + case PHYDM_INFO_CRC32_ERROR_LEGACY: + return p_fa_t->cnt_ofdm_crc32_error; + + case PHYDM_INFO_CRC32_ERROR_CCK: + return p_fa_t->cnt_cck_crc32_error; + + case PHYDM_INFO_EDCCA_FLAG: + return p_fa_t->edcca_flag; + + case PHYDM_INFO_OFDM_ENABLE: + return p_fa_t->ofdm_block_enable; + + case PHYDM_INFO_CCK_ENABLE: + return p_fa_t->cck_block_enable; + + case PHYDM_INFO_DBG_PORT_0: + return p_fa_t->dbg_port0; + + case PHYDM_INFO_CRC32_OK_HT_AGG: + return p_fa_t->cnt_ht_crc32_ok_agg; + + case PHYDM_INFO_CRC32_ERROR_HT_AGG: + return p_fa_t->cnt_ht_crc32_error_agg; + + /*=== [DIG] ================================================*/ + + case PHYDM_INFO_CURR_IGI: + return p_dig_t->cur_ig_value; + + /*=== [RSSI] ===============================================*/ + case PHYDM_INFO_RSSI_MIN: + return (u32)p_dm->rssi_min; + + case PHYDM_INFO_RSSI_MAX: + return (u32)p_dm->rssi_max; + + case PHYDM_INFO_CLM_RATIO : + return (u32)ccx_info->clm_ratio; + case PHYDM_INFO_NHM_RATIO : + return (u32)ccx_info->nhm_ratio; + default: + return 0xffffffff; + + } +} + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +odm_init_all_work_items(struct PHY_DM_STRUCT *p_dm) +{ + + struct _ADAPTER *p_adapter = p_dm->adapter; +#if USE_WORKITEM + +#ifdef CONFIG_DYNAMIC_RX_PATH + odm_initialize_work_item(p_dm, + &p_dm->dm_drp_table.phydm_dynamic_rx_path_workitem, + (RT_WORKITEM_CALL_BACK)phydm_dynamic_rx_path_workitem_callback, + (void *)p_adapter, + "DynamicRxPathWorkitem"); + +#endif + +#ifdef CONFIG_ADAPTIVE_SOML + odm_initialize_work_item(p_dm, + &p_dm->dm_soml_table.phydm_adaptive_soml_workitem, + (RT_WORKITEM_CALL_BACK)phydm_adaptive_soml_workitem_callback, + (void *)p_adapter, + "AdaptiveSOMLWorkitem"); +#endif + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_initialize_work_item(p_dm, + &p_dm->dm_swat_table.phydm_sw_antenna_switch_workitem, + (RT_WORKITEM_CALL_BACK)odm_sw_antdiv_workitem_callback, + (void *)p_adapter, + "AntennaSwitchWorkitem"); +#endif +#if (defined(CONFIG_HL_SMART_ANTENNA)) + odm_initialize_work_item(p_dm, + &p_dm->dm_sat_table.hl_smart_antenna_workitem, + (RT_WORKITEM_CALL_BACK)phydm_beam_switch_workitem_callback, + (void *)p_adapter, + "hl_smart_ant_workitem"); + + odm_initialize_work_item(p_dm, + &p_dm->dm_sat_table.hl_smart_antenna_decision_workitem, + (RT_WORKITEM_CALL_BACK)phydm_beam_decision_workitem_callback, + (void *)p_adapter, + "hl_smart_ant_decision_workitem"); +#endif + + odm_initialize_work_item( + p_dm, + &(p_dm->path_div_switch_workitem), + (RT_WORKITEM_CALL_BACK)odm_path_div_chk_ant_switch_workitem_callback, + (void *)p_adapter, + "SWAS_WorkItem"); + + odm_initialize_work_item( + p_dm, + &(p_dm->cck_path_diversity_workitem), + (RT_WORKITEM_CALL_BACK)odm_cck_tx_path_diversity_work_item_callback, + (void *)p_adapter, + "CCKTXPathDiversityWorkItem"); + + odm_initialize_work_item( + p_dm, + &(p_dm->ra_rpt_workitem), + (RT_WORKITEM_CALL_BACK)halrf_update_init_rate_work_item_callback, + (void *)p_adapter, + "ra_rpt_workitem"); + +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_initialize_work_item( + p_dm, + &(p_dm->fast_ant_training_workitem), + (RT_WORKITEM_CALL_BACK)odm_fast_ant_training_work_item_callback, + (void *)p_adapter, + "fast_ant_training_workitem"); +#endif + +#endif /*#if USE_WORKITEM*/ + +#if (BEAMFORMING_SUPPORT == 1) + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_enter_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_enter_work_item_callback, + (void *)p_adapter, + "txbf_enter_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_leave_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_leave_work_item_callback, + (void *)p_adapter, + "txbf_leave_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_fw_ndpa_work_item_callback, + (void *)p_adapter, + "txbf_fw_ndpa_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_clk_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_clk_work_item_callback, + (void *)p_adapter, + "txbf_clk_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_rate_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_rate_work_item_callback, + (void *)p_adapter, + "txbf_rate_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_status_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_status_work_item_callback, + (void *)p_adapter, + "txbf_status_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_reset_tx_path_work_item_callback, + (void *)p_adapter, + "txbf_reset_tx_path_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item), + (RT_WORKITEM_CALL_BACK)hal_com_txbf_get_tx_rate_work_item_callback, + (void *)p_adapter, + "txbf_get_tx_rate_work_item"); +#endif + + odm_initialize_work_item( + p_dm, + &(p_dm->adaptivity.phydm_pause_edcca_work_item), + (RT_WORKITEM_CALL_BACK)phydm_pause_edcca_work_item_callback, + (void *)p_adapter, + "phydm_pause_edcca_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->adaptivity.phydm_resume_edcca_work_item), + (RT_WORKITEM_CALL_BACK)phydm_resume_edcca_work_item_callback, + (void *)p_adapter, + "phydm_resume_edcca_work_item"); + +#if (PHYDM_LA_MODE_SUPPORT == 1) + odm_initialize_work_item( + p_dm, + &(p_dm->adcsmp.adc_smp_work_item), + (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback, + (void *)p_adapter, + "adc_smp_work_item"); + + odm_initialize_work_item( + p_dm, + &(p_dm->adcsmp.adc_smp_work_item_1), + (RT_WORKITEM_CALL_BACK)adc_smp_work_item_callback, + (void *)p_adapter, + "adc_smp_work_item_1"); +#endif + +} + +void +odm_free_all_work_items(struct PHY_DM_STRUCT *p_dm) +{ +#if USE_WORKITEM + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_free_work_item(&(p_dm->dm_swat_table.phydm_sw_antenna_switch_workitem)); +#endif + +#ifdef CONFIG_DYNAMIC_RX_PATH + odm_free_work_item(&(p_dm->dm_drp_table.phydm_dynamic_rx_path_workitem)); +#endif + +#ifdef CONFIG_ADAPTIVE_SOML + odm_free_work_item(&(p_dm->dm_soml_table.phydm_adaptive_soml_workitem)); +#endif + + +#if (defined(CONFIG_HL_SMART_ANTENNA)) + odm_free_work_item(&(p_dm->dm_sat_table.hl_smart_antenna_workitem)); + odm_free_work_item(&(p_dm->dm_sat_table.hl_smart_antenna_decision_workitem)); +#endif + + odm_free_work_item(&(p_dm->path_div_switch_workitem)); + odm_free_work_item(&(p_dm->cck_path_diversity_workitem)); +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_free_work_item(&(p_dm->fast_ant_training_workitem)); +#endif + odm_free_work_item(&(p_dm->ra_rpt_workitem)); + /*odm_free_work_item((&p_dm->sbdcnt_workitem));*/ +#endif + +#if (BEAMFORMING_SUPPORT == 1) + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_enter_work_item)); + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_leave_work_item)); + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_fw_ndpa_work_item)); + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_clk_work_item)); + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_rate_work_item)); + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_status_work_item)); + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_reset_tx_path_work_item)); + odm_free_work_item((&p_dm->beamforming_info.txbf_info.txbf_get_tx_rate_work_item)); +#endif + + odm_free_work_item((&p_dm->adaptivity.phydm_pause_edcca_work_item)); + odm_free_work_item((&p_dm->adaptivity.phydm_resume_edcca_work_item)); + +#if (PHYDM_LA_MODE_SUPPORT == 1) + odm_free_work_item((&p_dm->adcsmp.adc_smp_work_item)); + odm_free_work_item((&p_dm->adcsmp.adc_smp_work_item_1)); +#endif + +} +#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + +void +odm_init_all_timers( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + odm_ant_div_timers(p_dm, INIT_ANTDIV_TIMMER); +#endif + + phydm_adaptive_soml_timers(p_dm, INIT_SOML_TIMMER); + +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + phydm_lna_sat_chk_timers(p_dm, INIT_LNA_SAT_CHK_TIMMER); +#endif + +#ifdef CONFIG_DYNAMIC_RX_PATH + phydm_dynamic_rx_path_timers(p_dm, INIT_DRP_TIMMER); +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + odm_initialize_timer(p_dm, &p_dm->path_div_switch_timer, + (void *)odm_path_div_chk_ant_switch_callback, NULL, "PathDivTimer"); + odm_initialize_timer(p_dm, &p_dm->cck_path_diversity_timer, + (void *)odm_cck_tx_path_diversity_callback, NULL, "cck_path_diversity_timer"); + odm_initialize_timer(p_dm, &p_dm->sbdcnt_timer, + (void *)phydm_sbd_callback, NULL, "SbdTimer"); +#if (BEAMFORMING_SUPPORT == 1) + odm_initialize_timer(p_dm, &p_dm->beamforming_info.txbf_info.txbf_fw_ndpa_timer, + (void *)hal_com_txbf_fw_ndpa_timer_callback, NULL, "txbf_fw_ndpa_timer"); +#endif +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (BEAMFORMING_SUPPORT == 1) + odm_initialize_timer(p_dm, &p_dm->beamforming_info.beamforming_timer, + (void *)beamforming_sw_timer_callback, NULL, "beamforming_timer"); +#endif +#endif +} + +void +odm_cancel_all_timers( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /* */ + /* 2012/01/12 MH Temp BSOD fix. We need to find NIC allocate mem fail reason in */ + /* win7 platform. */ + /* */ + HAL_ADAPTER_STS_CHK(p_dm); +#endif + +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + odm_ant_div_timers(p_dm, CANCEL_ANTDIV_TIMMER); +#endif + + phydm_adaptive_soml_timers(p_dm, CANCEL_SOML_TIMMER); + +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + phydm_lna_sat_chk_timers(p_dm, CANCEL_LNA_SAT_CHK_TIMMER); +#endif + + +#ifdef CONFIG_DYNAMIC_RX_PATH + phydm_dynamic_rx_path_timers(p_dm, CANCEL_DRP_TIMMER); +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + odm_cancel_timer(p_dm, &p_dm->path_div_switch_timer); + odm_cancel_timer(p_dm, &p_dm->cck_path_diversity_timer); + odm_cancel_timer(p_dm, &p_dm->sbdcnt_timer); +#if (BEAMFORMING_SUPPORT == 1) + odm_cancel_timer(p_dm, &p_dm->beamforming_info.txbf_info.txbf_fw_ndpa_timer); +#endif +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (BEAMFORMING_SUPPORT == 1) + odm_cancel_timer(p_dm, &p_dm->beamforming_info.beamforming_timer); +#endif +#endif + +} + + +void +odm_release_all_timers( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + odm_ant_div_timers(p_dm, RELEASE_ANTDIV_TIMMER); +#endif + phydm_adaptive_soml_timers(p_dm, RELEASE_SOML_TIMMER); + +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT + phydm_lna_sat_chk_timers(p_dm, RELEASE_LNA_SAT_CHK_TIMMER); +#endif + +#ifdef CONFIG_DYNAMIC_RX_PATH + phydm_dynamic_rx_path_timers(p_dm, RELEASE_DRP_TIMMER); +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + odm_release_timer(p_dm, &p_dm->path_div_switch_timer); + odm_release_timer(p_dm, &p_dm->cck_path_diversity_timer); + odm_release_timer(p_dm, &p_dm->sbdcnt_timer); +#if (BEAMFORMING_SUPPORT == 1) + odm_release_timer(p_dm, &p_dm->beamforming_info.txbf_info.txbf_fw_ndpa_timer); +#endif +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (BEAMFORMING_SUPPORT == 1) + odm_release_timer(p_dm, &p_dm->beamforming_info.beamforming_timer); +#endif +#endif +} + + +/* 3============================================================ + * 3 Tx Power Tracking + * 3============================================================ */ + + + + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) +void +odm_init_all_threads( + struct PHY_DM_STRUCT *p_dm +) +{ +#ifdef TPT_THREAD + k_tpt_task_init(p_dm->priv); +#endif +} + +void +odm_stop_all_threads( + struct PHY_DM_STRUCT *p_dm +) +{ +#ifdef TPT_THREAD + k_tpt_task_stop(p_dm->priv); +#endif +} +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) +/* Justin: According to the current RRSI to adjust Response Frame TX power, 2012/11/05 */ +void odm_dtc(struct PHY_DM_STRUCT *p_dm) +{ +#ifdef CONFIG_DM_RESP_TXAGC +#define DTC_BASE 35 /* RSSI higher than this value, start to decade TX power */ +#define DTC_DWN_BASE (DTC_BASE-5) /* RSSI lower than this value, start to increase TX power */ + + /* RSSI vs TX power step mapping: decade TX power */ + static const u8 dtc_table_down[] = { + DTC_BASE, + (DTC_BASE + 5), + (DTC_BASE + 10), + (DTC_BASE + 15), + (DTC_BASE + 20), + (DTC_BASE + 25) + }; + + /* RSSI vs TX power step mapping: increase TX power */ + static const u8 dtc_table_up[] = { + DTC_DWN_BASE, + (DTC_DWN_BASE - 5), + (DTC_DWN_BASE - 10), + (DTC_DWN_BASE - 15), + (DTC_DWN_BASE - 15), + (DTC_DWN_BASE - 20), + (DTC_DWN_BASE - 20), + (DTC_DWN_BASE - 25), + (DTC_DWN_BASE - 25), + (DTC_DWN_BASE - 30), + (DTC_DWN_BASE - 35) + }; + + u8 i; + u8 dtc_steps = 0; + u8 sign; + u8 resp_txagc = 0; + +#if 0 + /* As DIG is disabled, DTC is also disable */ + if (!(p_dm->support_ability & ODM_XXXXXX)) + return; +#endif + + if (p_dm->rssi_min > DTC_BASE) { + /* need to decade the CTS TX power */ + sign = 1; + for (i = 0; i < ARRAY_SIZE(dtc_table_down); i++) { + if ((dtc_table_down[i] >= p_dm->rssi_min) || (dtc_steps >= 6)) + break; + else + dtc_steps++; + } + } +#if 0 + else if (p_dm->rssi_min > DTC_DWN_BASE) { + /* needs to increase the CTS TX power */ + sign = 0; + dtc_steps = 1; + for (i = 0; i < ARRAY_SIZE(dtc_table_up); i++) { + if ((dtc_table_up[i] <= p_dm->rssi_min) || (dtc_steps >= 10)) + break; + else + dtc_steps++; + } + } +#endif + else { + sign = 0; + dtc_steps = 0; + } + + resp_txagc = dtc_steps | (sign << 4); + resp_txagc = resp_txagc | (resp_txagc << 5); + odm_write_1byte(p_dm, 0x06d9, resp_txagc); + + PHYDM_DBG(p_dm, ODM_COMP_PWR_TRAIN, ("%s rssi_min:%u, set RESP_TXAGC to %s %u\n", + __func__, p_dm->rssi_min, sign ? "minus" : "plus", dtc_steps)); +#endif /* CONFIG_RESP_TXAGC_ADJUST */ +} + +#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ + + +/*<20170126, BB-Kevin>8188F D-CUT DC cancellation and 8821C*/ +void +phydm_dc_cancellation( + struct PHY_DM_STRUCT *p_dm + +) +{ +#ifdef PHYDM_DC_CANCELLATION + u32 offset_i_hex[ODM_RF_PATH_MAX] = {0}; + u32 offset_q_hex[ODM_RF_PATH_MAX] = {0}; + u32 reg_value32[ODM_RF_PATH_MAX] = {0}; + u8 path = RF_PATH_A; + + if (!(p_dm->support_ic_type & ODM_DC_CANCELLATION_SUPPORT)) + return; + + if ((p_dm->support_ic_type & ODM_RTL8188F) && (p_dm->cut_version < ODM_CUT_D)) + return; + + /*DC_Estimation (only for 2x2 ic now) */ + + for (path = RF_PATH_A; path < ODM_RF_PATH_MAX; path++) { + if (p_dm->support_ic_type & (ODM_RTL8188F | ODM_RTL8710B)) { + if (!phydm_set_bb_dbg_port(p_dm, + BB_DBGPORT_PRIORITY_2, 0x235)) {/*set debug port to 0x235*/ + PHYDM_DBG(p_dm, ODM_COMP_API, + ("[DC Cancellation] Set Debug port Fail")); + return; + } + } else if (p_dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B)) { + if (!phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_2, 0x200)) { + /*set debug port to 0x200*/ + PHYDM_DBG(p_dm, ODM_COMP_API, + ("[DC Cancellation] Set Debug port Fail")); + return; + } + phydm_bb_dbg_port_header_sel(p_dm, 0x0); + if (p_dm->rf_type > RF_1T1R) { + if (!phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_2, 0x202)) { + /*set debug port to 0x200*/ + PHYDM_DBG(p_dm, ODM_COMP_API, + ("[DC Cancellation] Set Debug port Fail")); + return; + } + phydm_bb_dbg_port_header_sel(p_dm, 0x0); + } + } + + odm_write_dig(p_dm, 0x7E); + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + odm_set_bb_reg(p_dm, 0x88c, BIT(21)|BIT(20), 0x3); + else { + odm_set_bb_reg(p_dm, 0xc00, BIT(1)|BIT(0), 0x0); + if (p_dm->rf_type > RF_1T1R) + odm_set_bb_reg(p_dm, 0xe00, BIT(1)|BIT(0), 0x0); + } + odm_set_bb_reg(p_dm, 0xa78, MASKBYTE1, 0x0); /*disable CCK DCNF*/ + + PHYDM_DBG(p_dm, ODM_COMP_API, ("DC cancellation Begin!!!")); + + phydm_stop_ck320(p_dm, true); /*stop ck320*/ + + /* the same debug port both for path-a and path-b*/ + reg_value32[path] = phydm_get_bb_dbg_port_value(p_dm); + + phydm_stop_ck320(p_dm, false); /*start ck320*/ + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(p_dm, 0x88c, BIT(21)|BIT(20), 0x0); + } else { + odm_set_bb_reg(p_dm, 0xc00, BIT(1)|BIT(0), 0x3); + odm_set_bb_reg(p_dm, 0xe00, BIT(1)|BIT(0), 0x3); + } + odm_write_dig(p_dm, 0x20); + phydm_release_bb_dbg_port(p_dm); + + PHYDM_DBG(p_dm, ODM_COMP_API, ("DC cancellation OK!!!")); + } + + /*DC_Cancellation*/ + odm_set_bb_reg(p_dm, 0xa9c, BIT(20), 0x1); /*DC compensation to CCK data path*/ + if (p_dm->support_ic_type & (ODM_RTL8188F | ODM_RTL8710B)) { + offset_i_hex[0] = (reg_value32[0] & 0xffc0000) >> 18; + offset_q_hex[0] = (reg_value32[0] & 0x3ff00) >> 8; + + /*Before filling into registers, offset should be multiplexed (-1)*/ + offset_i_hex[0] = (offset_i_hex[0] >= 0x200) ? (0x400 - offset_i_hex[1]) : (0x1ff - offset_i_hex[1]); + offset_q_hex[0] = (offset_q_hex[0] >= 0x200) ? (0x400 - offset_q_hex[1]) : (0x1ff - offset_q_hex[1]); + + odm_set_bb_reg(p_dm, 0x950, 0x1ff, offset_i_hex[1]); + odm_set_bb_reg(p_dm, 0x950, 0x1ff0000, offset_q_hex[1]); + } else if (p_dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B)) { + + /* Path-a */ + offset_i_hex[0] = (reg_value32[0] & 0xffc00) >> 10; + offset_q_hex[0] = reg_value32[0] & 0x3ff; + + /*Before filling into registers, offset should be multiplexed (-1)*/ + offset_i_hex[0] = 0x400 - offset_i_hex[0]; + offset_q_hex[0] = 0x400 - offset_q_hex[0]; + + odm_set_bb_reg(p_dm, 0xc10, 0x3c000000, ((0x3c0 & offset_i_hex[0]) >> 6)); + odm_set_bb_reg(p_dm, 0xc10, 0xfc00, (0x3f & offset_i_hex[0])); + odm_set_bb_reg(p_dm, 0xc14, 0x3c000000, ((0x3c0 & offset_q_hex[0]) >> 6)); + odm_set_bb_reg(p_dm, 0xc14, 0xfc00, (0x3f & offset_q_hex[0])); + + /* Path-b */ + if (p_dm->rf_type > RF_1T1R) { + + offset_i_hex[1] = (reg_value32[1] & 0xffc00) >> 10; + offset_q_hex[1] = reg_value32[1] & 0x3ff; + + /*Before filling into registers, offset should be multiplexed (-1)*/ + offset_i_hex[1] = 0x400 - offset_i_hex[1]; + offset_q_hex[1] = 0x400 - offset_q_hex[1]; + + odm_set_bb_reg(p_dm, 0xe10, 0x3c000000, ((0x3c0 & offset_i_hex[1]) >> 6)); + odm_set_bb_reg(p_dm, 0xe10, 0xfc00, (0x3f & offset_i_hex[1])); + odm_set_bb_reg(p_dm, 0xe14, 0x3c000000, ((0x3c0 & offset_q_hex[1]) >> 6)); + odm_set_bb_reg(p_dm, 0xe14, 0xfc00, (0x3f & offset_q_hex[1])); + } + } +#endif +} + +void +phydm_receiver_blocking( + void *p_dm_void +) +{ +#ifdef CONFIG_RECEIVER_BLOCKING + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 channel = *p_dm->p_channel; + u8 bw = *p_dm->p_band_width; + u32 bb_regf0 = odm_get_bb_reg(p_dm, 0xf0, MASKDWORD); + + if (!(p_dm->support_ic_type & ODM_RECEIVER_BLOCKING_SUPPORT)) + return; + + if ((p_dm->support_ic_type & ODM_RTL8188E && ((bb_regf0 & 0xf000) >> 12) < 8) || + p_dm->support_ic_type & ODM_RTL8192E) { /*8188E_T version*/ + if (p_dm->consecutive_idlel_time > 10 && *p_dm->p_mp_mode == false && p_dm->adaptivity_enable == true) { + if ((bw == CHANNEL_WIDTH_20) && (channel == 1)) { + phydm_nbi_setting(p_dm, FUNC_ENABLE, channel, 20, 2410, PHYDM_DONT_CARE); + p_dm->is_receiver_blocking_en = true; + } else if ((bw == CHANNEL_WIDTH_20) && (channel == 13)) { + phydm_nbi_setting(p_dm, FUNC_ENABLE, channel, 20, 2473, PHYDM_DONT_CARE); + p_dm->is_receiver_blocking_en = true; + } else if (p_dm->is_receiver_blocking_en && channel != 1 && channel != 13) { + phydm_nbi_enable(p_dm, FUNC_DISABLE); + odm_set_bb_reg(p_dm, 0xc40, 0x1f000000, 0x1f); + p_dm->is_receiver_blocking_en = false; + } + return; + } + } else if ((p_dm->support_ic_type & ODM_RTL8188E && ((bb_regf0 & 0xf000) >> 12) >= 8)) { /*8188E_S version*/ + if (p_dm->consecutive_idlel_time > 10 && *p_dm->p_mp_mode == false && p_dm->adaptivity_enable == true) { + if ((bw == CHANNEL_WIDTH_20) && (channel == 13)) { + phydm_nbi_setting(p_dm, FUNC_ENABLE, channel, 20, 2473, PHYDM_DONT_CARE); + p_dm->is_receiver_blocking_en = true; + } else if (p_dm->is_receiver_blocking_en && channel != 13) { + phydm_nbi_enable(p_dm, FUNC_DISABLE); + odm_set_bb_reg(p_dm, 0xc40, 0x1f000000, 0x1f); + p_dm->is_receiver_blocking_en = false; + } + return; + } + } + + if (p_dm->is_receiver_blocking_en) { + phydm_nbi_enable(p_dm, FUNC_DISABLE); + odm_set_bb_reg(p_dm, 0xc40, 0x1f000000, 0x1f); + p_dm->is_receiver_blocking_en = false; + } + +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.h index 09d761943297..e7abfb326310 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.h @@ -1,1299 +1,1266 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - -#ifndef __HALDMOUTSRC_H__ -#define __HALDMOUTSRC_H__ - -/*============================================================*/ -/*include files*/ -/*============================================================*/ -#include "phydm_pre_define.h" -#include "phydm_dig.h" -#include "phydm_edcaturbocheck.h" -#include "phydm_pathdiv.h" -#include "phydm_antdiv.h" -#include "phydm_antdect.h" -#include "phydm_dynamicbbpowersaving.h" -#include "phydm_rainfo.h" -#include "phydm_dynamictxpower.h" -#include "phydm_cfotracking.h" -#include "phydm_acs.h" -#include "phydm_adaptivity.h" -#include "phydm_iqk.h" -#include "phydm_dfs.h" -#include "phydm_ccx.h" -#include "txbf/phydm_hal_txbf_api.h" - -#include "phydm_adc_sampling.h" - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -#include "phydm_beamforming.h" -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#include "halphyrf_ap.h" -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -#include "phydm_noisemonitor.h" -#include "halphyrf_ce.h" -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -#include "halphyrf_win.h" -#include "phydm_noisemonitor.h" -#endif - -/*============================================================*/ -/*Definition */ -/*============================================================*/ - -/* Traffic load decision */ -#define TRAFFIC_ULTRA_LOW 1 -#define TRAFFIC_LOW 2 -#define TRAFFIC_MID 3 -#define TRAFFIC_HIGH 4 - -#define NONE 0 - -/*NBI API------------------------------------*/ -#define NBI_ENABLE 1 -#define NBI_DISABLE 2 - -#define NBI_TABLE_SIZE_128 27 -#define NBI_TABLE_SIZE_256 59 - -#define NUM_START_CH_80M 7 -#define NUM_START_CH_40M 14 - -#define CH_OFFSET_40M 2 -#define CH_OFFSET_80M 6 - -/*CSI MASK API------------------------------------*/ -#define CSI_MASK_ENABLE 1 -#define CSI_MASK_DISABLE 2 - -/*------------------------------------------------*/ - -#define FFT_128_TYPE 1 -#define FFT_256_TYPE 2 - -#define SET_SUCCESS 1 -#define SET_ERROR 2 -#define SET_NO_NEED 3 - -#define FREQ_POSITIVE 1 -#define FREQ_NEGATIVE 2 - - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#define PHYDM_WATCH_DOG_PERIOD 1 -#else -#define PHYDM_WATCH_DOG_PERIOD 2 -#endif - -/*============================================================*/ -/*structure and define*/ -/*============================================================*/ - -/*2011/09/20 MH Add for AP/ADSLpseudo DM structuer requirement.*/ -/*We need to remove to other position???*/ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) -typedef struct rtl8192cd_priv { - u1Byte temp; - -} rtl8192cd_priv, *prtl8192cd_priv; -#endif - - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -typedef struct _ADAPTER { - u1Byte temp; - #ifdef AP_BUILD_WORKAROUND - HAL_DATA_TYPE* temp2; - prtl8192cd_priv priv; - #endif -} ADAPTER, *PADAPTER; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - -typedef struct _WLAN_STA { - u1Byte temp; -} WLAN_STA, *PRT_WLAN_STA; - -#endif - -typedef struct _Dynamic_Primary_CCA { - u1Byte PriCCA_flag; - u1Byte intf_flag; - u1Byte intf_type; - u1Byte DupRTS_flag; - u1Byte Monitor_flag; - u1Byte CH_offset; - u1Byte MF_state; -} Pri_CCA_T, *pPri_CCA_T; - - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - #ifdef ADSL_AP_BUILD_WORKAROUND - #define MAX_TOLERANCE 5 - #define IQK_DELAY_TIME 1 /*ms*/ - #endif -#endif /*#if(DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ - -#define DM_Type_ByFW 0 -#define DM_Type_ByDriver 1 - -/*Declare for common info*/ - -#define IQK_THRESHOLD 8 -#define DPK_THRESHOLD 4 - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -__PACK typedef struct _ODM_Phy_Status_Info_ -{ - u1Byte RxPWDBAll; - u1Byte SignalQuality; /* in 0-100 index. */ - u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ - s1Byte RxMIMOSignalQuality[4]; /* EVM */ - s1Byte RxSNR[4]; /* per-path's SNR */ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u1Byte RxCount:2; /* RX path counter---*/ - u1Byte BandWidth:2; - u1Byte rxsc:4; /* sub-channel---*/ -#else - u1Byte BandWidth; -#endif -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u1Byte channel; /* channel number---*/ - BOOLEAN bMuPacket; /* is MU packet or not---*/ - BOOLEAN bBeamformed; /* BF packet---*/ -#endif -} __WLAN_ATTRIB_PACK__ ODM_PHY_INFO_T, *PODM_PHY_INFO_T; - -typedef struct _ODM_Phy_Status_Info_Append_ { - u1Byte MAC_CRC32; - -}ODM_PHY_INFO_Append_T,*PODM_PHY_INFO_Append_T; - -#else - -typedef struct _ODM_Phy_Status_Info_ { - // - // Be care, if you want to add any element please insert between - // RxPWDBAll & SignalStrength. - // -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - u4Byte RxPWDBAll; -#else - u1Byte RxPWDBAll; -#endif - u1Byte SignalQuality; /* in 0-100 index. */ - s1Byte RxMIMOSignalQuality[4]; /* per-path's EVM */ - u1Byte RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ - u1Byte RxMIMOSignalStrength[4]; /* in 0~100 index */ - s2Byte Cfo_short[4]; /* per-path's Cfo_short */ - s2Byte Cfo_tail[4]; /* per-path's Cfo_tail */ - s1Byte RxPower; /* in dBm Translate from PWdB */ - s1Byte RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ - u1Byte BTRxRSSIPercentage; - u1Byte SignalStrength; /* in 0-100 index. */ - s1Byte RxPwr[4]; /* per-path's pwdb */ - s1Byte RxSNR[4]; /* per-path's SNR */ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u1Byte RxCount:2; /* RX path counter---*/ - u1Byte BandWidth:2; - u1Byte rxsc:4; /* sub-channel---*/ -#else - u1Byte BandWidth; -#endif -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - u1Byte btCoexPwrAdjust; -#endif -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u1Byte channel; /* channel number---*/ - BOOLEAN bMuPacket; /* is MU packet or not---*/ - BOOLEAN bBeamformed; /* BF packet---*/ -#endif -} ODM_PHY_INFO_T, *PODM_PHY_INFO_T; -#endif - -typedef struct _ODM_Per_Pkt_Info_ { - u1Byte DataRate; - u1Byte StationID; - BOOLEAN bPacketMatchBSSID; - BOOLEAN bPacketToSelf; - BOOLEAN bPacketBeacon; - BOOLEAN bToSelf; -} ODM_PACKET_INFO_T, *PODM_PACKET_INFO_T; - - -typedef struct _ODM_Phy_Dbg_Info_ { - /*ODM Write,debug info*/ - s1Byte RxSNRdB[4]; - u4Byte NumQryPhyStatus; - u4Byte NumQryPhyStatusCCK; - u4Byte NumQryPhyStatusOFDM; -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - u4Byte NumQryMuPkt; - u4Byte NumQryBfPkt; - u4Byte NumQryMuVhtPkt[40]; - u4Byte NumQryVhtPkt[40]; - BOOLEAN bLdpcPkt; - BOOLEAN bStbcPkt; -#endif - u1Byte NumQryBeaconPkt; - //Others - s4Byte RxEVM[4]; - -} ODM_PHY_DBG_INFO_T; - - -/*2011/20/20 MH For MP driver RT_WLAN_STA = STA_INFO_T*/ -/*Please declare below ODM relative info in your STA info structure.*/ - -#if 1 -typedef struct _ODM_STA_INFO { - /*Driver Write*/ - BOOLEAN bUsed; /*record the sta status link or not?*/ - u1Byte IOTPeer; /*Enum value. HT_IOT_PEER_E*/ - - /*ODM Write*/ - /*PHY_STATUS_INFO*/ - u1Byte RSSI_Path[4]; - u1Byte RSSI_Ave; - u1Byte RXEVM[4]; - u1Byte RXSNR[4]; - -} ODM_STA_INFO_T, *PODM_STA_INFO_T; -#endif - -typedef enum _ODM_Common_Info_Definition { - /*Fixed value*/ - /*-----------HOOK BEFORE REG INIT-----------*/ - ODM_CMNINFO_PLATFORM = 0, - ODM_CMNINFO_ABILITY, - ODM_CMNINFO_INTERFACE, - ODM_CMNINFO_MP_TEST_CHIP, - ODM_CMNINFO_IC_TYPE, - ODM_CMNINFO_CUT_VER, - ODM_CMNINFO_FAB_VER, - ODM_CMNINFO_RF_TYPE, - ODM_CMNINFO_RFE_TYPE, - ODM_CMNINFO_BOARD_TYPE, - ODM_CMNINFO_PACKAGE_TYPE, - ODM_CMNINFO_EXT_LNA, - ODM_CMNINFO_5G_EXT_LNA, - ODM_CMNINFO_EXT_PA, - ODM_CMNINFO_5G_EXT_PA, - ODM_CMNINFO_GPA, - ODM_CMNINFO_APA, - ODM_CMNINFO_GLNA, - ODM_CMNINFO_ALNA, - ODM_CMNINFO_EXT_TRSW, - ODM_CMNINFO_EXT_LNA_GAIN, - ODM_CMNINFO_PATCH_ID, - ODM_CMNINFO_BINHCT_TEST, - ODM_CMNINFO_BWIFI_TEST, - ODM_CMNINFO_SMART_CONCURRENT, - ODM_CMNINFO_CONFIG_BB_RF, - ODM_CMNINFO_DOMAIN_CODE_2G, - ODM_CMNINFO_DOMAIN_CODE_5G, - ODM_CMNINFO_IQKFWOFFLOAD, - ODM_CMNINFO_IQKPAOFF, - ODM_CMNINFO_HUBUSBMODE, - ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS, - ODM_CMNINFO_TX_TP, - ODM_CMNINFO_RX_TP, - ODM_CMNINFO_SOUNDING_SEQ, - ODM_CMNINFO_REGRFKFREEENABLE, - ODM_CMNINFO_RFKFREEENABLE, - ODM_CMNINFO_NORMAL_RX_PATH_CHANGE, - /*-----------HOOK BEFORE REG INIT-----------*/ - - /*Dynamic value:*/ - - /*--------- POINTER REFERENCE-----------*/ - ODM_CMNINFO_MAC_PHY_MODE, - ODM_CMNINFO_TX_UNI, - ODM_CMNINFO_RX_UNI, - ODM_CMNINFO_WM_MODE, - ODM_CMNINFO_BAND, - ODM_CMNINFO_SEC_CHNL_OFFSET, - ODM_CMNINFO_SEC_MODE, - ODM_CMNINFO_BW, - ODM_CMNINFO_CHNL, - ODM_CMNINFO_FORCED_RATE, - ODM_CMNINFO_ANT_DIV, - ODM_CMNINFO_ADAPTIVITY, - ODM_CMNINFO_DMSP_GET_VALUE, - ODM_CMNINFO_BUDDY_ADAPTOR, - ODM_CMNINFO_DMSP_IS_MASTER, - ODM_CMNINFO_SCAN, - ODM_CMNINFO_POWER_SAVING, - ODM_CMNINFO_ONE_PATH_CCA, - ODM_CMNINFO_DRV_STOP, - ODM_CMNINFO_PNP_IN, - ODM_CMNINFO_INIT_ON, - ODM_CMNINFO_ANT_TEST, - ODM_CMNINFO_NET_CLOSED, - ODM_CMNINFO_FORCED_IGI_LB, - ODM_CMNINFO_P2P_LINK, - ODM_CMNINFO_FCS_MODE, - ODM_CMNINFO_IS1ANTENNA, - ODM_CMNINFO_RFDEFAULTPATH, - ODM_CMNINFO_DFS_MASTER_ENABLE, - ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC, - ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA, - /*--------- POINTER REFERENCE-----------*/ - - /*------------CALL BY VALUE-------------*/ - ODM_CMNINFO_WIFI_DIRECT, - ODM_CMNINFO_WIFI_DISPLAY, - ODM_CMNINFO_LINK_IN_PROGRESS, - ODM_CMNINFO_LINK, - ODM_CMNINFO_STATION_STATE, - ODM_CMNINFO_RSSI_MIN, - ODM_CMNINFO_DBG_COMP, - ODM_CMNINFO_DBG_LEVEL, - ODM_CMNINFO_RA_THRESHOLD_HIGH, - ODM_CMNINFO_RA_THRESHOLD_LOW, - ODM_CMNINFO_RF_ANTENNA_TYPE, - ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, - ODM_CMNINFO_BE_FIX_TX_ANT, - ODM_CMNINFO_BT_ENABLED, - ODM_CMNINFO_BT_HS_CONNECT_PROCESS, - ODM_CMNINFO_BT_HS_RSSI, - ODM_CMNINFO_BT_OPERATION, - ODM_CMNINFO_BT_LIMITED_DIG, - ODM_CMNINFO_BT_DIG, - ODM_CMNINFO_BT_BUSY, - ODM_CMNINFO_BT_DISABLE_EDCA, -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) /*for repeater mode add by YuChen 2014.06.23*/ -#ifdef UNIVERSAL_REPEATER - ODM_CMNINFO_VXD_LINK, -#endif -#endif - ODM_CMNINFO_AP_TOTAL_NUM, - ODM_CMNINFO_POWER_TRAINING, - ODM_CMNINFO_DFS_REGION_DOMAIN, - /*------------CALL BY VALUE-------------*/ - - /*Dynamic ptr array hook itms.*/ - ODM_CMNINFO_STA_STATUS, - ODM_CMNINFO_MAX, - -}ODM_CMNINFO_E; - - -typedef enum _PHYDM_Info_query_type { - PHYDM_INFO_FA_OFDM, - PHYDM_INFO_FA_CCK, - PHYDM_INFO_FA_TOTAL, - PHYDM_INFO_CCA_OFDM, - PHYDM_INFO_CCA_CCK, - PHYDM_INFO_CCA_ALL, - PHYDM_INFO_CRC32_OK_VHT, - PHYDM_INFO_CRC32_OK_HT, - PHYDM_INFO_CRC32_OK_LEGACY, - PHYDM_INFO_CRC32_OK_CCK, - PHYDM_INFO_CRC32_ERROR_VHT, - PHYDM_INFO_CRC32_ERROR_HT, - PHYDM_INFO_CRC32_ERROR_LEGACY, - PHYDM_INFO_CRC32_ERROR_CCK, - PHYDM_INFO_EDCCA_FLAG, - PHYDM_INFO_OFDM_ENABLE, - PHYDM_INFO_CCK_ENABLE, - PHYDM_INFO_DBG_PORT_0 -} PHYDM_INFO_QUERY_E; - -typedef enum _PHYDM_API_Definition { - - PHYDM_API_NBI = 1, - PHYDM_API_CSI_MASK, - -} PHYDM_API_E; - - -/*2011/10/20 MH Define ODM support ability. ODM_CMNINFO_ABILITY*/ -typedef enum _ODM_Support_Ability_Definition { - - /*BB ODM section BIT 0-19*/ - ODM_BB_DIG = BIT0, - ODM_BB_RA_MASK = BIT1, - ODM_BB_DYNAMIC_TXPWR = BIT2, - ODM_BB_FA_CNT = BIT3, - ODM_BB_RSSI_MONITOR = BIT4, - ODM_BB_CCK_PD = BIT5, - ODM_BB_ANT_DIV = BIT6, - ODM_BB_PWR_TRAIN = BIT8, - ODM_BB_RATE_ADAPTIVE = BIT9, - ODM_BB_PATH_DIV = BIT10, - ODM_BB_ADAPTIVITY = BIT13, - ODM_BB_CFO_TRACKING = BIT14, - ODM_BB_NHM_CNT = BIT15, - ODM_BB_PRIMARY_CCA = BIT16, - ODM_BB_TXBF = BIT17, - ODM_BB_DYNAMIC_ARFR = BIT18, - - /*MAC DM section BIT 20-23*/ - ODM_MAC_EDCA_TURBO = BIT20, - ODM_MAC_EARLY_MODE = BIT21, - - /*RF ODM section BIT 24-31*/ - ODM_RF_TX_PWR_TRACK = BIT24, - ODM_RF_RX_GAIN_TRACK = BIT25, - ODM_RF_CALIBRATION = BIT26, - -}ODM_ABILITY_E; - - -/*ODM_CMNINFO_ONE_PATH_CCA*/ -typedef enum tag_CCA_Path { - ODM_CCA_2R = 0, - ODM_CCA_1R_A = 1, - ODM_CCA_1R_B = 2, -} ODM_CCA_PATH_E; - -typedef enum CCA_PATHDIV_EN { - CCA_PATHDIV_DISABLE = 0, - CCA_PATHDIV_ENABLE = 1, - -} CCA_PATHDIV_EN_E; - - -typedef enum _BASEBAND_CONFIG_PHY_REG_PG_VALUE_TYPE { - PHY_REG_PG_RELATIVE_VALUE = 0, - PHY_REG_PG_EXACT_VALUE = 1 -} PHY_REG_PG_TYPE; - -/*2011/09/22 MH Copy from SD4 defined structure. We use to support PHY DM integration.*/ - -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) -#if (RT_PLATFORM != PLATFORM_LINUX) -typedef -#endif - -struct DM_Out_Source_Dynamic_Mechanism_Structure -#else/*for AP,ADSL,CE Team*/ -typedef struct DM_Out_Source_Dynamic_Mechanism_Structure -#endif -{ - /*Add for different team use temporarily*/ - PADAPTER Adapter; /*For CE/NIC team*/ - prtl8192cd_priv priv; /*For AP/ADSL team*/ - /*WHen you use Adapter or priv pointer, you must make sure the pointer is ready.*/ - BOOLEAN odm_ready; - -#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - rtl8192cd_priv fake_priv; -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - // ADSL_AP_BUILD_WORKAROUND - ADAPTER fake_adapter; -#endif - - PHY_REG_PG_TYPE PhyRegPgValueType; - u1Byte PhyRegPgVersion; - - u4Byte DebugComponents; - u4Byte fw_DebugComponents; - u4Byte DebugLevel; - - u4Byte NumQryPhyStatusAll; /*CCK + OFDM*/ - u4Byte LastNumQryPhyStatusAll; - u4Byte RxPWDBAve; - BOOLEAN MPDIG_2G; /*off MPDIG*/ - u1Byte Times_2G; - BOOLEAN bInitHwInfoByRfe; - -/*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ - BOOLEAN bCckHighPower; - u1Byte RFPathRxEnable; - u1Byte ControlChannel; -/*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ - - -//1 COMMON INFORMATION - - /*Init Value*/ - /*-----------HOOK BEFORE REG INIT-----------*/ - /*ODM Platform info AP/ADSL/CE/MP = 1/2/3/4*/ - u1Byte SupportPlatform; - // ODM Platform info WIN/AP/CE = 1/2/3 - u1Byte Normalrxpath; - // ODM Support Ability DIG/RATR/TX_PWR_TRACK/ ¡K¡K = 1/2/3/¡K - u4Byte SupportAbility; - /*ODM PCIE/USB/SDIO = 1/2/3*/ - u1Byte SupportInterface; - /*ODM composite or independent. Bit oriented/ 92C+92D+ .... or any other type = 1/2/3/...*/ - u4Byte SupportICType; - /*Cut Version TestChip/A-cut/B-cut... = 0/1/2/3/...*/ - u1Byte CutVersion; - /*Fab Version TSMC/UMC = 0/1*/ - u1Byte FabVersion; - /*RF Type 4T4R/3T3R/2T2R/1T2R/1T1R/...*/ - u1Byte RFType; - u1Byte RFEType; - /*Board Type Normal/HighPower/MiniCard/SLIM/Combo/... = 0/1/2/3/4/...*/ - u1Byte BoardType; - u1Byte PackageType; - u2Byte TypeGLNA; - u2Byte TypeGPA; - u2Byte TypeALNA; - u2Byte TypeAPA; - /*with external LNA NO/Yes = 0/1*/ - u1Byte ExtLNA; /*2G*/ - u1Byte ExtLNA5G; /*5G*/ - /*with external PA NO/Yes = 0/1*/ - u1Byte ExtPA; /*2G*/ - u1Byte ExtPA5G; /*5G*/ - /*with external TRSW NO/Yes = 0/1*/ - u1Byte ExtTRSW; - u1Byte ExtLNAGain; /*2G*/ - u1Byte PatchID; /*Customer ID*/ - BOOLEAN bInHctTest; - u1Byte WIFITest; - - BOOLEAN bDualMacSmartConcurrent; - u4Byte BK_SupportAbility; - u1Byte AntDivType; - u1Byte with_extenal_ant_switch; - BOOLEAN ConfigBBRF; - u1Byte odm_Regulation2_4G; - u1Byte odm_Regulation5G; - u1Byte IQKFWOffload; - BOOLEAN cck_new_agc; - u1Byte phydm_period; - u4Byte phydm_sys_up_time; - u1Byte num_rf_path; - /*-----------HOOK BEFORE REG INIT-----------*/ - - /*Dynamic Value*/ - - /*--------- POINTER REFERENCE-----------*/ - - u1Byte u1Byte_temp; - BOOLEAN BOOLEAN_temp; - PADAPTER PADAPTER_temp; - - /*MAC PHY Mode SMSP/DMSP/DMDP = 0/1/2*/ - u1Byte *pMacPhyMode; - /*TX Unicast byte count*/ - u8Byte *pNumTxBytesUnicast; - /*RX Unicast byte count*/ - u8Byte *pNumRxBytesUnicast; - /*Wireless mode B/G/A/N = BIT0/BIT1/BIT2/BIT3*/ - u1Byte *pWirelessMode; - /*Frequence band 2.4G/5G = 0/1*/ - u1Byte *pBandType; - /*Secondary channel offset don't_care/below/above = 0/1/2*/ - u1Byte *pSecChOffset; - /*Security mode Open/WEP/AES/TKIP = 0/1/2/3*/ - u1Byte *pSecurity; - /*BW info 20M/40M/80M = 0/1/2*/ - u1Byte *pBandWidth; - /*Central channel location Ch1/Ch2/....*/ - u1Byte *pChannel; /*central channel number*/ - BOOLEAN DPK_Done; - /*Common info for 92D DMSP*/ - - BOOLEAN *pbGetValueFromOtherMac; - PADAPTER *pBuddyAdapter; - BOOLEAN *pbMasterOfDMSP; //MAC0: master, MAC1: slave - /*Common info for Status*/ - BOOLEAN *pbScanInProcess; - BOOLEAN *pbPowerSaving; - /*CCA Path 2-path/path-A/path-B = 0/1/2; using ODM_CCA_PATH_E.*/ - u1Byte *pOnePathCCA; - u1Byte *pAntennaTest; - BOOLEAN *pbNet_closed; - u1Byte *pu1ForcedIgiLb; - BOOLEAN *pIsFcsModeEnable; - /*--------- For 8723B IQK-----------*/ - BOOLEAN *pIs1Antenna; - u1Byte *pRFDefaultPath; - // 0:S1, 1:S0 - - /*--------- POINTER REFERENCE-----------*/ - pu2Byte pForcedDataRate; - pu1Byte p_enable_antdiv; - pu1Byte p_enable_adaptivity; - pu1Byte HubUsbMode; - BOOLEAN *pbFwDwRsvdPageInProgress; - u4Byte *pCurrentTxTP; - u4Byte *pCurrentRxTP; - u1Byte *pSoundingSeq; - /*------------CALL BY VALUE-------------*/ - BOOLEAN bLinkInProcess; - BOOLEAN bWIFI_Direct; - BOOLEAN bWIFI_Display; - BOOLEAN bLinked; - BOOLEAN bsta_state; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) /*for repeater mode add by YuChen 2014.06.23*/ -#ifdef UNIVERSAL_REPEATER - BOOLEAN VXD_bLinked; -#endif -#endif - u1Byte RSSI_Min; - u1Byte InterfaceIndex; /*Add for 92D dual MAC: 0--Mac0 1--Mac1*/ - BOOLEAN bIsMPChip; - BOOLEAN bOneEntryOnly; - BOOLEAN mp_mode; - u4Byte OneEntry_MACID; - u1Byte pre_number_linked_client; - u1Byte number_linked_client; - u1Byte pre_number_active_client; - u1Byte number_active_client; - /*Common info for BTDM*/ - BOOLEAN bBtEnabled; /*BT is enabled*/ - BOOLEAN bBtConnectProcess; /*BT HS is under connection progress.*/ - u1Byte btHsRssi; /*BT HS mode wifi rssi value.*/ - BOOLEAN bBtHsOperation; /*BT HS mode is under progress*/ - u1Byte btHsDigVal; /*use BT rssi to decide the DIG value*/ - BOOLEAN bBtDisableEdcaTurbo; /*Under some condition, don't enable the EDCA Turbo*/ - BOOLEAN bBtBusy; /*BT is busy.*/ - BOOLEAN bBtLimitedDig; /*BT is busy.*/ - BOOLEAN bDisablePhyApi; - /*------------CALL BY VALUE-------------*/ - u1Byte RSSI_A; - u1Byte RSSI_B; - u1Byte RSSI_C; - u1Byte RSSI_D; - u8Byte RSSI_TRSW; - u8Byte RSSI_TRSW_H; - u8Byte RSSI_TRSW_L; - u8Byte RSSI_TRSW_iso; - u1Byte TXAntStatus; - u1Byte RXAntStatus; - u1Byte cck_lna_idx; - u1Byte cck_vga_idx; - u1Byte curr_station_id; - u1Byte ofdm_agc_idx[4]; - - u1Byte RxRate; - BOOLEAN bNoisyState; - u1Byte TxRate; - u1Byte LinkedInterval; - u1Byte preChannel; - u4Byte TxagcOffsetValueA; - BOOLEAN IsTxagcOffsetPositiveA; - u4Byte TxagcOffsetValueB; - BOOLEAN IsTxagcOffsetPositiveB; - u4Byte tx_tp; - u4Byte rx_tp; - u4Byte total_tp; - u8Byte curTxOkCnt; - u8Byte curRxOkCnt; - u8Byte lastTxOkCnt; - u8Byte lastRxOkCnt; - u4Byte BbSwingOffsetA; - BOOLEAN IsBbSwingOffsetPositiveA; - u4Byte BbSwingOffsetB; - BOOLEAN IsBbSwingOffsetPositiveB; - u1Byte IGI_LowerBound; - u1Byte IGI_UpperBound; - u1Byte antdiv_rssi; - u1Byte fat_comb_a; - u1Byte fat_comb_b; - u1Byte antdiv_intvl; - u1Byte AntType; - u1Byte pre_AntType; - u1Byte antdiv_period; - u1Byte evm_antdiv_period; - u1Byte antdiv_select; - u1Byte path_select; - u1Byte antdiv_evm_en; - u1Byte bdc_holdstate; - u1Byte NdpaPeriod; - BOOLEAN H2C_RARpt_connect; - BOOLEAN cck_agc_report_type; - - u1Byte dm_dig_max_TH; - u1Byte dm_dig_min_TH; - u1Byte print_agc; - u1Byte TrafficLoad; - u1Byte pre_TrafficLoad; - - /*For Adaptivtiy*/ - u2Byte NHM_cnt_0; - u2Byte NHM_cnt_1; - s1Byte TH_L2H_default; - s1Byte TH_EDCCA_HL_diff_default; - s1Byte TH_L2H_ini; - s1Byte TH_EDCCA_HL_diff; - s1Byte TH_L2H_ini_mode2; - s1Byte TH_EDCCA_HL_diff_mode2; - BOOLEAN Carrier_Sense_enable; - u1Byte Adaptivity_IGI_upper; - BOOLEAN adaptivity_flag; - u1Byte DCbackoff; - BOOLEAN Adaptivity_enable; - u1Byte APTotalNum; - BOOLEAN EDCCA_enable; - ADAPTIVITY_STATISTICS Adaptivity; - /*For Adaptivtiy*/ - u1Byte LastUSBHub; - u1Byte TxBfDataRate; - - u1Byte nbi_set_result; - - u1Byte c2h_cmd_start; - u1Byte fw_debug_trace[60]; - u1Byte pre_c2h_seq; - BOOLEAN fw_buff_is_enpty; - u4Byte data_frame_num; - u4Byte ADCSmp_count; - u4Byte ADCSmp_dbg_port; - BOOLEAN ADCSmp_trigger_edge; - u1Byte ADCsmp_smp_rate; - u4Byte ADCsmp_time_unit; - - /*for noise detection*/ - BOOLEAN NoisyDecision; /*b_noisy*/ - BOOLEAN pre_b_noisy; - u4Byte NoisyDecision_Smooth; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - ODM_NOISE_MONITOR noise_level; -#endif - /*Define STA info.*/ - /*_ODM_STA_INFO*/ - /*2012/01/12 MH For MP, we need to reduce one array pointer for default port.??*/ - PSTA_INFO_T pODM_StaInfo[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte platform2phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM]; - /* platform_macid_table[platform_macid] = phydm_macid */ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - s4Byte AccumulatePWDB[ODM_ASSOCIATE_ENTRY_NUM]; -#endif - -#if (RATE_ADAPTIVE_SUPPORT == 1) - u2Byte CurrminRptTime; - ODM_RA_INFO_T RAInfo[ODM_ASSOCIATE_ENTRY_NUM]; - /*Use MacID as array index. STA MacID=0, VWiFi Client MacID={1, ODM_ASSOCIATE_ENTRY_NUM-1} //YJ,add,120119*/ -#endif - - /*2012/02/14 MH Add to share 88E ra with other SW team.*/ - /*We need to colelct all support abilit to a proper area.*/ - - BOOLEAN RaSupport88E; - - ODM_PHY_DBG_INFO_T PhyDbgInfo; - - /*ODM Structure*/ -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - BDC_T DM_BdcTable; - #endif - - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - SAT_T dm_sat_table; - #endif - -#endif - FAT_T DM_FatTable; - DIG_T DM_DigTable; -#if (defined(CONFIG_BB_POWER_SAVING)) - PS_T DM_PSTable; -#endif - Pri_CCA_T DM_PriCCA; - RA_T DM_RA_Table; - FALSE_ALARM_STATISTICS FalseAlmCnt; - FALSE_ALARM_STATISTICS FlaseAlmCntBuddyAdapter; - SWAT_T DM_SWAT_Table; - CFO_TRACKING DM_CfoTrack; - ACS DM_ACS; - CCX_INFO DM_CCX_INFO; - - RT_ADCSMP adcsmp; - -#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) - IQK_INFO IQK_info; -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - /*Path Div Struct*/ - PATHDIV_PARA pathIQK; -#endif -#if(defined(CONFIG_PATH_DIVERSITY)) - PATHDIV_T DM_PathDiv; -#endif - - EDCA_T DM_EDCA_Table; - u4Byte WMMEDCA_BE; - - BOOLEAN *pbDriverStopped; - BOOLEAN *pbDriverIsGoingToPnpSetPowerSleep; - BOOLEAN *pinit_adpt_in_progress; - - /*PSD*/ - BOOLEAN bUserAssignLevel; - u1Byte RSSI_BT; /*come from BT*/ - BOOLEAN bPSDinProcess; - BOOLEAN bPSDactive; - BOOLEAN bDMInitialGainEnable; - - /*MPT DIG*/ - RT_TIMER MPT_DIGTimer; - - /*for rate adaptive, in fact, 88c/92c fw will handle this*/ - u1Byte bUseRAMask; - - ODM_RATE_ADAPTIVE RateAdaptive; - #if (defined(CONFIG_ANT_DETECTION)) - ANT_DETECTED_INFO AntDetectedInfo; /* Antenna detected information for RSSI tool*/ - #endif - ODM_RF_CAL_T RFCalibrateInfo; - u4Byte nIQK_Cnt; - u4Byte nIQK_OK_Cnt; - u4Byte nIQK_Fail_Cnt; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - /*Power Training*/ - u1Byte ForcePowerTrainingState; - BOOLEAN bChangeState; - u4Byte PT_score; - u8Byte OFDM_RX_Cnt; - u8Byte CCK_RX_Cnt; -#endif - BOOLEAN bDisablePowerTraining; - u1Byte DynamicTxHighPowerLvl; - u1Byte LastDTPLvl; - u4Byte tx_agc_ofdm_18_6; - u1Byte rx_pkt_type; - - /*ODM relative time.*/ - RT_TIMER PathDivSwitchTimer; - /*2011.09.27 add for Path Diversity*/ - RT_TIMER CCKPathDiversityTimer; - RT_TIMER FastAntTrainingTimer; - #ifdef ODM_EVM_ENHANCE_ANTDIV - RT_TIMER EVM_FastAntTrainingTimer; - #endif - RT_TIMER sbdcnt_timer; - - /*ODM relative workitem.*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#if USE_WORKITEM - RT_WORK_ITEM PathDivSwitchWorkitem; - RT_WORK_ITEM CCKPathDiversityWorkitem; - RT_WORK_ITEM FastAntTrainingWorkitem; - RT_WORK_ITEM MPT_DIGWorkitem; - RT_WORK_ITEM RaRptWorkitem; - RT_WORK_ITEM sbdcnt_workitem; -#endif -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -#if (BEAMFORMING_SUPPORT == 1) - RT_BEAMFORMING_INFO BeamformingInfo; -#endif -#endif - -#ifdef CONFIG_PHYDM_DFS_MASTER - u1Byte DFS_RegionDomain; - pu1Byte dfs_master_enabled; - - /*====== phydm_radar_detect_with_dbg_parm start ======*/ - u1Byte radar_detect_dbg_parm_en; - u4Byte radar_detect_reg_918; - u4Byte radar_detect_reg_91c; - u4Byte radar_detect_reg_920; - u4Byte radar_detect_reg_924; - /*====== phydm_radar_detect_with_dbg_parm end ======*/ -#endif - -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - -#if (RT_PLATFORM != PLATFORM_LINUX) -} DM_ODM_T, *PDM_ODM_T; /*DM_Dynamic_Mechanism_Structure*/ -#else -}; -#endif - -#else /*for AP,ADSL,CE Team*/ -} DM_ODM_T, *PDM_ODM_T; /*DM_Dynamic_Mechanism_Structure*/ -#endif - - -typedef enum _PHYDM_STRUCTURE_TYPE{ - PHYDM_FALSEALMCNT, - PHYDM_CFOTRACK, - PHYDM_ADAPTIVITY, - PHYDM_ROMINFO, - -}PHYDM_STRUCTURE_TYPE; - - - - typedef enum _ODM_RF_CONTENT{ - odm_radioa_txt = 0x1000, - odm_radiob_txt = 0x1001, - odm_radioc_txt = 0x1002, - odm_radiod_txt = 0x1003 -} ODM_RF_CONTENT; - -typedef enum _ODM_BB_Config_Type{ - CONFIG_BB_PHY_REG, - CONFIG_BB_AGC_TAB, - CONFIG_BB_AGC_TAB_2G, - CONFIG_BB_AGC_TAB_5G, - CONFIG_BB_PHY_REG_PG, - CONFIG_BB_PHY_REG_MP, - CONFIG_BB_AGC_TAB_DIFF, -} ODM_BB_Config_Type, *PODM_BB_Config_Type; - -typedef enum _ODM_RF_Config_Type { - CONFIG_RF_RADIO, - CONFIG_RF_TXPWR_LMT, -} ODM_RF_Config_Type, *PODM_RF_Config_Type; - -typedef enum _ODM_FW_Config_Type { - CONFIG_FW_NIC, - CONFIG_FW_NIC_2, - CONFIG_FW_AP, - CONFIG_FW_AP_2, - CONFIG_FW_MP, - CONFIG_FW_WoWLAN, - CONFIG_FW_WoWLAN_2, - CONFIG_FW_AP_WoWLAN, - CONFIG_FW_BT, -} ODM_FW_Config_Type; - -/*Status code*/ -#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -typedef enum _RT_STATUS{ - RT_STATUS_SUCCESS, - RT_STATUS_FAILURE, - RT_STATUS_PENDING, - RT_STATUS_RESOURCE, - RT_STATUS_INVALID_CONTEXT, - RT_STATUS_INVALID_PARAMETER, - RT_STATUS_NOT_SUPPORT, - RT_STATUS_OS_API_FAILED, -}RT_STATUS,*PRT_STATUS; -#endif /*end of RT_STATUS definition*/ - -#ifdef REMOVE_PACK -#pragma pack() -#endif - -/*===========================================================*/ -/*AGC RX High Power Mode*/ -/*===========================================================*/ -#define LNA_Low_Gain_1 0x64 -#define LNA_Low_Gain_2 0x5A -#define LNA_Low_Gain_3 0x58 - -#define FA_RXHP_TH1 5000 -#define FA_RXHP_TH2 1500 -#define FA_RXHP_TH3 800 -#define FA_RXHP_TH4 600 -#define FA_RXHP_TH5 500 - -typedef enum tag_1R_CCA_Type_Definition { - CCA_1R =0, - CCA_2R = 1, - CCA_MAX = 2, -} DM_1R_CCA_E; - -typedef enum tag_RF_Type_Definition { - RF_Save =0, - RF_Normal = 1, - RF_MAX = 2, -} DM_RF_E; - -/*check Sta pointer valid or not*/ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#define IS_STA_VALID(pSta) (pSta && pSta->expire_to) -#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) -#define IS_STA_VALID(pSta) (pSta && pSta->bUsed) -#else -#define IS_STA_VALID(pSta) (pSta) -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_AP)) - -BOOLEAN -ODM_CheckPowerStatus( - IN PADAPTER Adapter - ); - -#endif - -u4Byte odm_ConvertTo_dB(u4Byte Value); - -u4Byte odm_ConvertTo_linear(u4Byte Value); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - -u4Byte -GetPSDData( - PDM_ODM_T pDM_Odm, - unsigned int point, - u1Byte initial_gain_psd); - -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -VOID -ODM_DMWatchdog_LPS( - IN PDM_ODM_T pDM_Odm -); -#endif - - -s4Byte -ODM_PWdB_Conversion( - IN s4Byte X, - IN u4Byte TotalBit, - IN u4Byte DecimalBit - ); - -s4Byte -ODM_SignConversion( - IN s4Byte value, - IN u4Byte TotalBit - ); - -VOID -ODM_InitMpDriverStatus( - IN PDM_ODM_T pDM_Odm - ); - -void -phydm_seq_sorting( - IN PVOID pDM_VOID, - IN OUT u4Byte *p_value, - IN OUT u4Byte *rank_idx, - IN OUT u4Byte *p_idx_out, - IN u1Byte seq_length -); - -VOID -ODM_DMInit( - IN PDM_ODM_T pDM_Odm -); - -VOID -ODM_DMReset( - IN PDM_ODM_T pDM_Odm - ); - -VOID -phydm_support_ability_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ); - -VOID -phydm_config_trx_path( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ); - -VOID -ODM_DMWatchdog( - IN PDM_ODM_T pDM_Odm - ); - -VOID -ODM_CmnInfoInit( - IN PDM_ODM_T pDM_Odm, - IN ODM_CMNINFO_E CmnInfo, - IN u4Byte Value - ); - -VOID -ODM_CmnInfoHook( - IN PDM_ODM_T pDM_Odm, - IN ODM_CMNINFO_E CmnInfo, - IN PVOID pValue - ); - -VOID -ODM_CmnInfoPtrArrayHook( - IN PDM_ODM_T pDM_Odm, - IN ODM_CMNINFO_E CmnInfo, - IN u2Byte Index, - IN PVOID pValue - ); - -VOID -ODM_CmnInfoUpdate( - IN PDM_ODM_T pDM_Odm, - IN u4Byte CmnInfo, - IN u8Byte Value - ); - -u4Byte -PHYDM_CmnInfoQuery( - IN PDM_ODM_T pDM_Odm, - IN PHYDM_INFO_QUERY_E info_type - ); - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -VOID -ODM_InitAllThreads( - IN PDM_ODM_T pDM_Odm - ); - -VOID -ODM_StopAllThreads( - IN PDM_ODM_T pDM_Odm - ); -#endif - -VOID -ODM_InitAllTimers( - IN PDM_ODM_T pDM_Odm - ); - -VOID -ODM_CancelAllTimers( - IN PDM_ODM_T pDM_Odm - ); - -VOID -ODM_ReleaseAllTimers( - IN PDM_ODM_T pDM_Odm - ); - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID ODM_InitAllWorkItems(IN PDM_ODM_T pDM_Odm ); -VOID ODM_FreeAllWorkItems(IN PDM_ODM_T pDM_Odm ); - -u8Byte -PlatformDivision64( - IN u8Byte x, - IN u8Byte y -); - -#define DM_ChangeDynamicInitGainThresh ODM_ChangeDynamicInitGainThresh - -typedef enum tag_DIG_Connect_Definition -{ - DIG_STA_DISCONNECT = 0, - DIG_STA_CONNECT = 1, - DIG_STA_BEFORE_CONNECT = 2, - DIG_MultiSTA_DISCONNECT = 3, - DIG_MultiSTA_CONNECT = 4, - DIG_CONNECT_MAX -} DM_DIG_CONNECT_E; - -/*2012/01/12 MH Check afapter status. Temp fix BSOD.*/ - -#define HAL_ADAPTER_STS_CHK(pDM_Odm)\ - if (pDM_Odm->Adapter == NULL)\ - {\ - return;\ - }\ - -#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ - -VOID -ODM_AsocEntry_Init( - IN PDM_ODM_T pDM_Odm - ); - - -PVOID -PhyDM_Get_Structure( - IN PDM_ODM_T pDM_Odm, - IN u1Byte Structure_Type -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) ||(DM_ODM_SUPPORT_TYPE == ODM_CE) -/*===========================================================*/ -/* The following is for compile only*/ -/*===========================================================*/ - -#define IS_HARDWARE_TYPE_8723A(_Adapter) FALSE -#define IS_HARDWARE_TYPE_8723AE(_Adapter) FALSE -#define IS_HARDWARE_TYPE_8192C(_Adapter) FALSE -#define IS_HARDWARE_TYPE_8192D(_Adapter) FALSE -#define RF_T_METER_92D 0x42 - - -#define GET_RX_STATUS_DESC_RX_MCS(__pRxStatusDesc) LE_BITS_TO_1BYTE(__pRxStatusDesc+12, 0, 6) - -#define rConfig_ram64x16 0xb2c - -#define TARGET_CHNL_NUM_2G_5G 59 - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -u1Byte GetRightChnlPlaceforIQK(u1Byte chnl); -#endif - -//=========================================================== -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -void odm_dtc(PDM_ODM_T pDM_Odm); -#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_CE) */ - - -VOID phydm_NoisyDetection(IN PDM_ODM_T pDM_Odm ); - - -#endif - -VOID -phydm_set_ext_switch( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -); - -VOID -phydm_api_debug( - IN PVOID pDM_VOID, - IN u4Byte function_map, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -); - -u1Byte -phydm_nbi_setting( - IN PVOID pDM_VOID, - IN u4Byte enable, - IN u4Byte channel, - IN u4Byte bw, - IN u4Byte f_interference, - IN u4Byte Second_ch -); - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __HALDMOUTSRC_H__ +#define __HALDMOUTSRC_H__ + +/*============================================================*/ +/*include files*/ +/*============================================================*/ +/*PHYDM header*/ +#include "phydm_pre_define.h" +#include "phydm_dig.h" +#include "phydm_pathdiv.h" +#include "phydm_antdiv.h" +#include "phydm_soml.h" +#include "phydm_smt_ant.h" +#include "phydm_antdect.h" +#include "phydm_rainfo.h" +#include "phydm_dynamictxpower.h" +#include "phydm_cfotracking.h" +#include "phydm_acs.h" +#include "phydm_adaptivity.h" +#include "phydm_dfs.h" +#include "phydm_ccx.h" +#include "txbf/phydm_hal_txbf_api.h" +#include "phydm_adc_sampling.h" +#include "phydm_dynamic_rx_path.h" +#include "phydm_psd.h" +#include "phydm_primary_cca.h" +#include "phydm_cck_pd.h" +#include "phydm_rssi_monitor.h" +#include "phydm_auto_dbg.h" +#include "phydm_math_lib.h" +#include "phydm_noisemonitor.h" +#include "phydm_api.h" +#include "phydm_pow_train.h" +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) + #include "phydm_beamforming.h" +#endif + +/*HALRF header*/ +#include "halrf/halrf_iqk.h" +#include "halrf/halrf.h" +#include "halrf/halrf_powertracking.h" +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + #include "halrf/halphyrf_ap.h" +#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE)) + #include "halrf/halphyrf_ce.h" +#elif (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + #include "halrf/halphyrf_win.h" +#endif + +extern const u16 phy_rate_table[28]; + +/*============================================================*/ +/*Definition */ +/*============================================================*/ + +/* Traffic load decision */ +#define TRAFFIC_ULTRA_LOW 1 +#define TRAFFIC_LOW 2 +#define TRAFFIC_MID 3 +#define TRAFFIC_HIGH 4 + +#define NONE 0 + +#define MAX_2(_x_, _y_) (((_x_)>(_y_))? (_x_) : (_y_)) +#define MIN_2(_x_, _y_) (((_x_)<(_y_))? (_x_) : (_y_)) + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #define PHYDM_WATCH_DOG_PERIOD 1 /*second*/ +#else + #define PHYDM_WATCH_DOG_PERIOD 2 /*second*/ +#endif + +/*============================================================*/ +/*structure and define*/ +/*============================================================*/ + +#define dm_type_by_fw 0 +#define dm_type_by_driver 1 + +struct phydm_phystatus_statistic { + + /*[CCK]*/ + u32 rssi_cck_sum; + u32 rssi_cck_cnt; + /*[OFDM]*/ + u32 rssi_ofdm_sum; + u32 rssi_ofdm_cnt; + u32 evm_ofdm_sum; + u32 snr_ofdm_sum; + /*[1SS]*/ + u32 rssi_1ss_cnt; + u32 rssi_1ss_sum; + u32 evm_1ss_sum; + u32 snr_1ss_sum; + /*[2SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + u32 rssi_2ss_cnt; + u32 rssi_2ss_sum[2]; + u32 evm_2ss_sum[2]; + u32 snr_2ss_sum[2]; + #endif + /*[3SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + u32 rssi_3ss_cnt; + u32 rssi_3ss_sum[3]; + u32 evm_3ss_sum[3]; + u32 snr_3ss_sum[3]; + #endif + /*[4SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + u32 rssi_4ss_cnt; + u32 rssi_4ss_sum[4]; + u32 evm_4ss_sum[4]; + u32 snr_4ss_sum[4]; + #endif +}; + +struct phydm_phystatus_avg { + + /*[CCK]*/ + u8 rssi_cck_avg; + /*[OFDM]*/ + u8 rssi_ofdm_avg; + u8 evm_ofdm_avg; + u8 snr_ofdm_avg; + /*[1SS]*/ + u8 rssi_1ss_avg; + u8 evm_1ss_avg; + u8 snr_1ss_avg; + /*[2SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + u8 rssi_2ss_avg[2]; + u8 evm_2ss_avg[2]; + u8 snr_2ss_avg[2]; + #endif + /*[3SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + u8 rssi_3ss_avg[3]; + u8 evm_3ss_avg[3]; + u8 snr_3ss_avg[3]; + #endif + /*[4SS]*/ + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + u8 rssi_4ss_avg[4]; + u8 evm_4ss_avg[4]; + u8 snr_4ss_avg[4]; + #endif +}; + +struct _odm_phy_dbg_info_ { + /*ODM Write,debug info*/ + s8 rx_snr_db[4]; + u32 num_qry_phy_status; + u32 num_qry_phy_status_cck; + u32 num_qry_phy_status_ofdm; +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + u32 num_qry_mu_pkt; + u32 num_qry_bf_pkt; + u32 num_qry_mu_vht_pkt[40]; + boolean is_ldpc_pkt; + boolean is_stbc_pkt; + u8 num_of_ppdu[4]; + u8 gid_num[4]; +#endif + u8 num_qry_beacon_pkt; + /* Others */ + s32 rx_evm[4]; + + u16 num_qry_legacy_pkt[LEGACY_RATE_NUM]; + u16 num_qry_ht_pkt[HT_RATE_NUM]; + u8 ht_pkt_not_zero; + #if ODM_IC_11AC_SERIES_SUPPORT + u16 num_qry_vht_pkt[VHT_RATE_NUM]; + u8 vht_pkt_not_zero; + #endif + struct phydm_phystatus_statistic phystatus_statistic_info; + struct phydm_phystatus_avg phystatus_statistic_avg; +}; + +enum odm_cmninfo_e { + /*Fixed value*/ + /*-----------HOOK BEFORE REG INIT-----------*/ + ODM_CMNINFO_PLATFORM = 0, + ODM_CMNINFO_ABILITY, + ODM_CMNINFO_INTERFACE, + ODM_CMNINFO_MP_TEST_CHIP, + ODM_CMNINFO_IC_TYPE, + ODM_CMNINFO_CUT_VER, + ODM_CMNINFO_FAB_VER, + ODM_CMNINFO_RF_TYPE, + ODM_CMNINFO_RFE_TYPE, + ODM_CMNINFO_DPK_EN, + ODM_CMNINFO_BOARD_TYPE, + ODM_CMNINFO_PACKAGE_TYPE, + ODM_CMNINFO_EXT_LNA, + ODM_CMNINFO_5G_EXT_LNA, + ODM_CMNINFO_EXT_PA, + ODM_CMNINFO_5G_EXT_PA, + ODM_CMNINFO_GPA, + ODM_CMNINFO_APA, + ODM_CMNINFO_GLNA, + ODM_CMNINFO_ALNA, + ODM_CMNINFO_EXT_TRSW, + ODM_CMNINFO_EXT_LNA_GAIN, + ODM_CMNINFO_PATCH_ID, + ODM_CMNINFO_BINHCT_TEST, + ODM_CMNINFO_BWIFI_TEST, + ODM_CMNINFO_SMART_CONCURRENT, + ODM_CMNINFO_CONFIG_BB_RF, + ODM_CMNINFO_DOMAIN_CODE_2G, + ODM_CMNINFO_DOMAIN_CODE_5G, + ODM_CMNINFO_IQKPAOFF, + ODM_CMNINFO_HUBUSBMODE, + ODM_CMNINFO_FWDWRSVDPAGEINPROGRESS, + ODM_CMNINFO_TX_TP, + ODM_CMNINFO_RX_TP, + ODM_CMNINFO_SOUNDING_SEQ, + ODM_CMNINFO_REGRFKFREEENABLE, + ODM_CMNINFO_RFKFREEENABLE, + ODM_CMNINFO_NORMAL_RX_PATH_CHANGE, + ODM_CMNINFO_EFUSE0X3D8, + ODM_CMNINFO_EFUSE0X3D7, + ODM_CMNINFO_SOFT_AP_SPECIAL_SETTING, + ODM_CMNINFO_ADVANCE_OTA, + ODM_CMNINFO_HP_HWID, + /*-----------HOOK BEFORE REG INIT-----------*/ + + /*Dynamic value:*/ + + /*--------- POINTER REFERENCE-----------*/ + ODM_CMNINFO_TX_UNI, + ODM_CMNINFO_RX_UNI, + ODM_CMNINFO_BAND, + ODM_CMNINFO_SEC_CHNL_OFFSET, + ODM_CMNINFO_SEC_MODE, + ODM_CMNINFO_BW, + ODM_CMNINFO_CHNL, + ODM_CMNINFO_FORCED_RATE, + ODM_CMNINFO_ANT_DIV, + ODM_CMNINFO_ADAPTIVITY, + ODM_CMNINFO_SCAN, + ODM_CMNINFO_POWER_SAVING, + ODM_CMNINFO_ONE_PATH_CCA, + ODM_CMNINFO_DRV_STOP, + ODM_CMNINFO_PNP_IN, + ODM_CMNINFO_INIT_ON, + ODM_CMNINFO_ANT_TEST, + ODM_CMNINFO_NET_CLOSED, + ODM_CMNINFO_P2P_LINK, + ODM_CMNINFO_FCS_MODE, + ODM_CMNINFO_IS1ANTENNA, + ODM_CMNINFO_RFDEFAULTPATH, + ODM_CMNINFO_DFS_MASTER_ENABLE, + ODM_CMNINFO_FORCE_TX_ANT_BY_TXDESC, + ODM_CMNINFO_SET_S0S1_DEFAULT_ANTENNA, + ODM_CMNINFO_SOFT_AP_MODE, + ODM_CMNINFO_MP_MODE, + ODM_CMNINFO_INTERRUPT_MASK, + ODM_CMNINFO_BB_OPERATION_MODE, + ODM_CMNINFO_BF_ANTDIV_DECISION, + /*--------- POINTER REFERENCE-----------*/ + + /*------------CALL BY VALUE-------------*/ + ODM_CMNINFO_WIFI_DIRECT, + ODM_CMNINFO_WIFI_DISPLAY, + ODM_CMNINFO_LINK_IN_PROGRESS, + ODM_CMNINFO_LINK, + ODM_CMNINFO_CMW500LINK, + ODM_CMNINFO_STATION_STATE, + ODM_CMNINFO_RSSI_MIN, + ODM_CMNINFO_RSSI_MIN_BY_PATH, + ODM_CMNINFO_DBG_COMP, + ODM_CMNINFO_DBG_LEVEL, + ODM_CMNINFO_RA_THRESHOLD_HIGH, /*to be removed*/ + ODM_CMNINFO_RA_THRESHOLD_LOW, /*to be removed*/ + ODM_CMNINFO_RF_ANTENNA_TYPE, + ODM_CMNINFO_WITH_EXT_ANTENNA_SWITCH, + ODM_CMNINFO_BE_FIX_TX_ANT, + ODM_CMNINFO_BT_ENABLED, + ODM_CMNINFO_BT_HS_CONNECT_PROCESS, + ODM_CMNINFO_BT_HS_RSSI, + ODM_CMNINFO_BT_OPERATION, + ODM_CMNINFO_BT_LIMITED_DIG, + ODM_CMNINFO_AP_TOTAL_NUM, + ODM_CMNINFO_POWER_TRAINING, + ODM_CMNINFO_DFS_REGION_DOMAIN, + ODM_CMNINFO_BT_CONTINUOUS_TURN, + /*------------CALL BY VALUE-------------*/ + + /*Dynamic ptr array hook itms.*/ + ODM_CMNINFO_STA_STATUS, + ODM_CMNINFO_MAX, + +}; + +enum phydm_rfe_bb_source_sel { + PAPE_2G = 0, + PAPE_5G = 1, + LNA0N_2G = 2, + LNAON_5G = 3, + TRSW = 4, + TRSW_B = 5, + GNT_BT = 6, + ZERO = 7, + ANTSEL_0 = 8, + ANTSEL_1 = 9, + ANTSEL_2 = 0xa, + ANTSEL_3 = 0xb, + ANTSEL_4 = 0xc, + ANTSEL_5 = 0xd, + ANTSEL_6 = 0xe, + ANTSEL_7 = 0xf +}; + +enum phydm_info_query_e { + PHYDM_INFO_FA_OFDM, + PHYDM_INFO_FA_CCK, + PHYDM_INFO_FA_TOTAL, + PHYDM_INFO_CCA_OFDM, + PHYDM_INFO_CCA_CCK, + PHYDM_INFO_CCA_ALL, + PHYDM_INFO_CRC32_OK_VHT, + PHYDM_INFO_CRC32_OK_HT, + PHYDM_INFO_CRC32_OK_LEGACY, + PHYDM_INFO_CRC32_OK_CCK, + PHYDM_INFO_CRC32_ERROR_VHT, + PHYDM_INFO_CRC32_ERROR_HT, + PHYDM_INFO_CRC32_ERROR_LEGACY, + PHYDM_INFO_CRC32_ERROR_CCK, + PHYDM_INFO_EDCCA_FLAG, + PHYDM_INFO_OFDM_ENABLE, + PHYDM_INFO_CCK_ENABLE, + PHYDM_INFO_CRC32_OK_HT_AGG, + PHYDM_INFO_CRC32_ERROR_HT_AGG, + PHYDM_INFO_DBG_PORT_0, + PHYDM_INFO_CURR_IGI, + PHYDM_INFO_RSSI_MIN, + PHYDM_INFO_RSSI_MAX, + PHYDM_INFO_CLM_RATIO, + PHYDM_INFO_NHM_RATIO, +}; + +enum phydm_api_e { + + PHYDM_API_NBI = 1, + PHYDM_API_CSI_MASK, + +}; + +enum phydm_func_idx_e { /*F_XXX = PHYDM XXX function*/ + + F00_DIG = 0, + F01_RA_MASK = 1, + F02_DYN_TXPWR = 2, + F03_FA_CNT = 3, + F04_RSSI_MNTR = 4, + F05_CCK_PD = 5, + F06_ANT_DIV = 6, + F07_SMT_ANT = 7, + F08_PWR_TRAIN = 8, + F09_RA = 9, + F10_PATH_DIV = 10, + F11_DFS = 11, + F12_DYN_ARFR = 12, + F13_ADPTVTY = 13, + F14_CFO_TRK = 14, + F15_ENV_MNTR = 15, + F16_PRI_CCA = 16, + F17_ADPTV_SOML = 17, + F18_LNA_SAT_CHK = 18, + /*BIT18*/ + /*BIT19*/ + F20_DYN_RX_PATH = 20 +}; + +/*=[PHYDM supportability]==========================================*/ +enum odm_ability_e { + + ODM_BB_DIG = BIT(F00_DIG), + ODM_BB_RA_MASK = BIT(F01_RA_MASK), + ODM_BB_DYNAMIC_TXPWR = BIT(F02_DYN_TXPWR), + ODM_BB_FA_CNT = BIT(F03_FA_CNT), + ODM_BB_RSSI_MONITOR = BIT(F04_RSSI_MNTR), + ODM_BB_CCK_PD = BIT(F05_CCK_PD), + ODM_BB_ANT_DIV = BIT(F06_ANT_DIV), + ODM_BB_SMT_ANT = BIT(F07_SMT_ANT), + ODM_BB_PWR_TRAIN = BIT(F08_PWR_TRAIN), + ODM_BB_RATE_ADAPTIVE = BIT(F09_RA), + ODM_BB_PATH_DIV = BIT(F10_PATH_DIV), + ODM_BB_DFS = BIT(F11_DFS), + ODM_BB_DYNAMIC_ARFR = BIT(F12_DYN_ARFR), + ODM_BB_ADAPTIVITY = BIT(F13_ADPTVTY), + ODM_BB_CFO_TRACKING = BIT(F14_CFO_TRK), + ODM_BB_ENV_MONITOR = BIT(F15_ENV_MNTR), + ODM_BB_PRIMARY_CCA = BIT(F16_PRI_CCA), + ODM_BB_ADAPTIVE_SOML = BIT(F17_ADPTV_SOML), + ODM_BB_LNA_SAT_CHK = BIT(F18_LNA_SAT_CHK), + /*BIT19*/ + ODM_BB_DYNAMIC_RX_PATH = BIT(F20_DYN_RX_PATH) +}; + +/*=[PHYDM Debug Component]=====================================*/ +enum phydm_dbg_comp { + /*BB Driver Functions*/ + DBG_DIG = BIT(F00_DIG), + DBG_RA_MASK = BIT(F01_RA_MASK), + DBG_DYN_TXPWR = BIT(F02_DYN_TXPWR), + DBG_FA_CNT = BIT(F03_FA_CNT), + DBG_RSSI_MNTR = BIT(F04_RSSI_MNTR), + DBG_CCKPD = BIT(F05_CCK_PD), + DBG_ANT_DIV = BIT(F06_ANT_DIV), + DBG_SMT_ANT = BIT(F07_SMT_ANT), + DBG_PWR_TRAIN = BIT(F08_PWR_TRAIN), + DBG_RA = BIT(F09_RA), + DBG_PATH_DIV = BIT(F10_PATH_DIV), + DBG_DFS = BIT(F11_DFS), + DBG_DYN_ARFR = BIT(F12_DYN_ARFR), + DBG_ADPTVTY = BIT(F13_ADPTVTY), + DBG_CFO_TRK = BIT(F14_CFO_TRK), + DBG_ENV_MNTR = BIT(F15_ENV_MNTR), + DBG_PRI_CCA = BIT(F16_PRI_CCA), + DBG_ADPTV_SOML = BIT(F17_ADPTV_SOML), + DBG_LNA_SAT_CHK = BIT(F18_LNA_SAT_CHK), + /*BIT19*/ + DBG_DYN_RX_PATH = BIT(F20_DYN_RX_PATH), + /*Neet to re-arrange*/ + DBG_TMP = BIT(21), + DBG_FW_TRACE = BIT(22), + DBG_TXBF = BIT(23), + DBG_COMMON_FLOW = BIT(24), + ODM_COMP_TX_PWR_TRACK = BIT(25), + ODM_COMP_CALIBRATION = BIT(26), + ODM_COMP_MP = BIT(27), + ODM_PHY_CONFIG = BIT(28), + ODM_COMP_INIT = BIT(29), + ODM_COMP_COMMON = BIT(30), + ODM_COMP_API = BIT(31) +}; + +/*=========================================================*/ + +/*ODM_CMNINFO_ONE_PATH_CCA*/ +enum odm_cca_path_e { + ODM_CCA_2R = 0, + ODM_CCA_1R_A = 1, + ODM_CCA_1R_B = 2, +}; + +enum phy_reg_pg_type { + PHY_REG_PG_RELATIVE_VALUE = 0, + PHY_REG_PG_EXACT_VALUE = 1 +}; + +enum phydm_offload_ability { + PHYDM_PHY_PARAM_OFFLOAD = BIT(0), + PHYDM_RF_IQK_OFFLOAD = BIT(1), +}; + +struct phydm_pause_lv { + s8 lv_dig; + s8 lv_cckpd; + s8 lv_antdiv; + s8 lv_adapt; +}; + +struct phydm_func_poiner { + void (*pause_phydm_handler)(void *p_dm_void, u32 *val_buf, u8 val_len); +}; + +struct pkt_process_info { + u8 phystatus_smp_mode_en; /*send phystatus every sampling time*/ + u8 pre_ppdu_cnt; + u8 lna_idx; + u8 vga_idx; +}; + +#ifdef ODM_CONFIG_BT_COEXIST +struct phydm_bt_info { + boolean is_bt_enabled; /*BT is enabled*/ + boolean is_bt_connect_process; /*BT HS is under connection progress.*/ + u8 bt_hs_rssi; /*BT HS mode wifi rssi value.*/ + boolean is_bt_hs_operation; /*BT HS mode is under progress*/ + boolean is_bt_limited_dig; /*BT is busy.*/ +}; +#endif + +struct phydm_iot_center { + boolean is_linked_cmw500; + u8 win_patch_id; /*Customer ID*/ + u32 phydm_patch_id; + +}; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + #if (RT_PLATFORM != PLATFORM_LINUX) + typedef + #endif + + struct PHY_DM_STRUCT +#else/*for AP, CE Team*/ + struct PHY_DM_STRUCT +#endif +{ + /*Add for different team use temporarily*/ + struct _ADAPTER *adapter; /*For CE/NIC team*/ + struct rtl8192cd_priv *priv; /*For AP team*/ + /*WHen you use adapter or priv pointer, you must make sure the pointer is ready.*/ + boolean odm_ready; + enum phy_reg_pg_type phy_reg_pg_value_type; + u8 phy_reg_pg_version; + u64 support_ability; /*PHYDM function Supportability*/ + u64 pause_ability; /*PHYDM function pause Supportability*/ + u64 debug_components; + u32 fw_debug_components; + u32 debug_level; + u32 num_qry_phy_status_all; /*CCK + OFDM*/ + u32 last_num_qry_phy_status_all; + u32 rx_pwdb_ave; + boolean is_init_hw_info_by_rfe; + + /*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ + boolean is_cck_high_power; + u8 rf_path_rx_enable; + /*------ ODM HANDLE, DRIVER NEEDS NOT TO HOOK------*/ + + /* COMMON INFORMATION */ + + /*Init value*/ + /*-----------HOOK BEFORE REG INIT-----------*/ + + u8 support_platform;/*PHYDM Platform info WIN/AP/CE = 1/2/3 */ + u8 normal_rx_path; + boolean brxagcswitch; /* for rx AGC table switch in Microsoft case */ + u8 support_interface;/*PHYDM PCIE/USB/SDIO = 1/2/3*/ + u32 support_ic_type; /*PHYDM supported IC*/ + u8 cut_version; /*cut version TestChip/A-cut/B-cut... = 0/1/2/3/...*/ + u8 fab_version; /*Fab version TSMC/UMC = 0/1*/ + u8 rf_type; /*RF type 4T4R/3T3R/2T2R/1T2R/1T1R/...*/ + u8 rfe_type; + u8 board_type; + u8 package_type; + u16 type_glna; + u16 type_gpa; + u16 type_alna; + u16 type_apa; + u8 ext_lna; /*with 2G external LNA NO/Yes = 0/1*/ + u8 ext_lna_5g; /*with 5G external LNA NO/Yes = 0/1*/ + u8 ext_pa; /*with 2G external PNA NO/Yes = 0/1*/ + u8 ext_pa_5g; /*with 5G external PNA NO/Yes = 0/1*/ + u8 efuse0x3d7; /*with Efuse number*/ + u8 efuse0x3d8; + u8 ext_trsw; /*with external TRSW NO/Yes = 0/1*/ + u8 ext_lna_gain; /*gain of external lna*/ + boolean is_in_hct_test; + u8 wifi_test; + boolean is_dual_mac_smart_concurrent; + u32 bk_support_ability; /*SD4 only*/ + u8 with_extenal_ant_switch; + /*cck agc relative*/ + boolean cck_new_agc; + s8 cck_lna_gain_table[8]; + /*-------------------------------------*/ + u8 phydm_period; + u32 phydm_sys_up_time; + u8 num_rf_path; /*ex: 8821C=1, 8192E=2, 8814B=4*/ + u32 soft_ap_special_setting; + s8 s8_dummy; + u8 u8_dummy; + u16 u16_dummy; + u32 u32_dummy; + u8 rfe_hwsetting_band; + u8 p_advance_ota; + boolean hp_hw_id; + boolean BOOLEAN_temp; + boolean is_dfs_band; + u8 is_receiver_blocking_en; + u16 fw_offload_ability; +/*-----------HOOK BEFORE REG INIT-----------*/ +/*===========================================================*/ +/*====[ CALL BY Reference ]=========================================*/ +/*===========================================================*/ + + u64 *p_num_tx_bytes_unicast; /*TX Unicast byte count*/ + u64 *p_num_rx_bytes_unicast; /*RX Unicast byte count*/ + u8 *p_band_type; /*Frequence band 2.4G/5G = 0/1*/ + u8 *p_sec_ch_offset; /*Secondary channel offset don't_care/below/above = 0/1/2*/ + u8 *p_security; /*security mode Open/WEP/AES/TKIP = 0/1/2/3*/ + u8 *p_band_width; /*BW info 20M/40M/80M = 0/1/2*/ + u8 *p_channel; /*central channel number*/ + boolean *p_is_scan_in_process; /*Common info for status*/ + boolean *p_is_power_saving; + u8 *p_one_path_cca; /*CCA path 2-path/path-A/path-B = 0/1/2; using enum odm_cca_path_e.*/ + u8 *p_antenna_test; + boolean *p_is_net_closed; + boolean *p_is_fcs_mode_enable; + /*--------- For 8723B IQK-------------------------------------*/ + boolean *p_is_1_antenna; + u8 *p_rf_default_path; /* 0:S1, 1:S0 */ + /*-----------------------------------------------------------*/ + + u16 *p_forced_data_rate; + u8 *p_enable_antdiv; + u8 *p_enable_adaptivity; + u8 *hub_usb_mode; /*1: USB 2.0, 2: USB 3.0*/ + boolean *p_is_fw_dw_rsvd_page_in_progress; + u32 *p_current_tx_tp; + u32 *p_current_rx_tp; + u8 *p_sounding_seq; + u32 *p_soft_ap_mode; + u8 *p_mp_mode; + u32 *p_interrupt_mask; + u8 *p_bb_op_mode; +/*===========================================================*/ +/*====[ CALL BY VALUE ]===========================================*/ +/*===========================================================*/ + + u8 disable_phydm_watchdog; + boolean is_link_in_process; + boolean is_wifi_direct; + boolean is_wifi_display; + boolean is_linked; + boolean bsta_state; + u8 rssi_min; + u8 pre_rssi_min; + u8 rssi_max; + u8 rssi_min_by_path; + boolean is_mp_chip; + boolean is_one_entry_only; + u32 one_entry_macid; + u32 one_entry_tp; + u32 pre_one_entry_tp; + u8 pre_number_linked_client; + u8 number_linked_client; + u8 pre_number_active_client; + u8 number_active_client; + boolean is_disable_phy_api; + u8 RSSI_A; + u8 RSSI_B; + u8 RSSI_C; + u8 RSSI_D; + u64 RSSI_TRSW; + u64 RSSI_TRSW_H; + u64 RSSI_TRSW_L; + u64 RSSI_TRSW_iso; + u8 tx_ant_status; + u8 rx_ant_status; + u8 cck_lna_idx; + u8 cck_vga_idx; + u8 curr_station_id; + u8 ofdm_agc_idx[4]; + u8 rx_rate; + u8 rate_ss; + u8 tx_rate; + u8 linked_interval; + u8 pre_channel; + u32 txagc_offset_value_a; + boolean is_txagc_offset_positive_a; + u32 txagc_offset_value_b; + boolean is_txagc_offset_positive_b; + /*[traffic]*/ + u8 traffic_load; + u8 pre_traffic_load; + u32 tx_tp; /*Mbps*/ + u32 rx_tp; /*Mbps*/ + u32 total_tp;/*Mbps*/ + u8 txrx_state_all; /*0: tx, 1:rx, 2:bi-direction*/ + u64 cur_tx_ok_cnt; + u64 cur_rx_ok_cnt; + u64 last_tx_ok_cnt; + u64 last_rx_ok_cnt; + u16 consecutive_idlel_time; /*unit: second*/ + /*---------------------------*/ + boolean is_bb_swing_offset_positive_a; + boolean is_bb_swing_offset_positive_b; + + /*[DIG]*/ + boolean MPDIG_2G; /*off MPDIG*/ + u8 times_2g; /*for MP DIG*/ + + /*[TDMA-DIG]*/ + u8 tdma_dig_timer_ms; + u8 tdma_dig_state_number; + u8 tdma_dig_low_upper_bond; + u8 fix_expire_to_zero; + boolean original_dig_restore; + /*---------------------------*/ + + /*[AntDiv]*/ + u8 ant_div_type; + u8 antdiv_rssi; + u8 fat_comb_a; + u8 fat_comb_b; + u8 antdiv_intvl; + u8 ant_type; + u8 pre_ant_type; + u8 antdiv_period; + u8 evm_antdiv_period; + u8 antdiv_select; + u8 antdiv_train_num;/*training time for each antenna in EVM method*/ + u8 stop_antdiv_rssi_th; + u16 stop_antdiv_tp_diff_th; + u16 stop_antdiv_tp_th; + u8 antdiv_tp_period; + u16 tp_active_th; + u8 tp_active_occur; + u8 path_select; + u8 antdiv_evm_en; + u8 bdc_holdstate; + /*---------------------------*/ + + u8 ndpa_period; + boolean h2c_rarpt_connect; + boolean cck_agc_report_type; + u8 print_agc; + u8 la_mode; + /*---8821C Antenna and RF Set BTG/WLG/WLA Select---------------*/ + u8 current_rf_set_8821c; + u8 default_rf_set_8821c; + u8 current_ant_num_8821c; + u8 default_ant_num_8821c; + u8 rfe_type_21c; + /*-----------------------------------------------------------*/ + /*---For Adaptivtiy---------------------------------------------*/ + s8 TH_L2H_default; + s8 th_edcca_hl_diff_default; + s8 th_l2h_ini; + s8 th_edcca_hl_diff; + s8 th_l2h_ini_mode2; + s8 th_edcca_hl_diff_mode2; + boolean carrier_sense_enable; + boolean adaptivity_flag; /*Limit IGI upper bound for Adaptivity*/ + u8 dc_backoff; + boolean adaptivity_enable; + u8 ap_total_num; + boolean edcca_enable; + u8 odm_regulation_2_4g; + u8 odm_regulation_5g; + /*-----------------------------------------------------------*/ + + u8 pre_dbg_priority; + u8 nbi_set_result; + u8 c2h_cmd_start; + u8 fw_debug_trace[60]; + u8 pre_c2h_seq; + boolean fw_buff_is_enpty; + u32 data_frame_num; + + /*--- for noise detection ---------------------------------------*/ + boolean is_noisy_state; + boolean noisy_decision; /*b_noisy*/ + boolean pre_b_noisy; + u32 noisy_decision_smooth; + u8 lna_sat_chk_cnt; + u8 lna_sat_chk_duty_cycle; + u32 lna_sat_chk_period_ms; + boolean is_disable_lna_sat_chk; + boolean is_disable_gain_table_switch; + /*-----------------------------------------------------------*/ + + boolean is_disable_dym_ecs; + boolean is_disable_dym_ant_weighting; + struct sta_info *p_odm_sta_info[ODM_ASSOCIATE_ENTRY_NUM];/*_ODM_STA_INFO, 2012/01/12 MH For MP, we need to reduce one array pointer for default port.??*/ + struct cmn_sta_info *p_phydm_sta_info[ODM_ASSOCIATE_ENTRY_NUM]; + u8 phydm_macid_table[ODM_ASSOCIATE_ENTRY_NUM]; + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + s32 accumulate_pwdb[ODM_ASSOCIATE_ENTRY_NUM]; +#endif + +#if (RATE_ADAPTIVE_SUPPORT == 1) + u16 currmin_rpt_time; + struct _odm_ra_info_ ra_info[ODM_ASSOCIATE_ENTRY_NUM]; + /*Use mac_id as array index. STA mac_id=0, VWiFi Client mac_id={1, ODM_ASSOCIATE_ENTRY_NUM-1} //YJ,add,120119*/ +#endif + boolean ra_support88e; /*2012/02/14 MH Add to share 88E ra with other SW team.We need to colelct all support abilit to a proper area.*/ + boolean *p_is_driver_stopped; + boolean *p_is_driver_is_going_to_pnp_set_power_sleep; + boolean *pinit_adpt_in_progress; + boolean is_user_assign_level; + u8 RSSI_BT; /*come from BT*/ + + /*---PSD Relative ---------------------------------------------*/ + boolean is_psd_in_process; + boolean is_psd_active; + /*-----------------------------------------------------------*/ + + boolean bsomlenabled; /* for dynamic SoML control */ + boolean bhtstfdisabled; /* for dynamic HTSTF gain control */ + boolean disrxhpsoml; /* for dynamic RxHP control with SoML on/off */ + u32 n_iqk_cnt; + u32 n_iqk_ok_cnt; + u32 n_iqk_fail_cnt; + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + boolean config_bbrf; +#endif + boolean is_disable_power_training; + boolean is_bt_continuous_turn; + u8 dynamic_tx_high_power_lvl; + u8 last_dtp_lvl; + u32 tx_agc_ofdm_18_6; + u8 rx_pkt_type; + +#ifdef CONFIG_PHYDM_DFS_MASTER + u8 dfs_region_domain; + u8 *dfs_master_enabled; + /*---phydm_radar_detect_with_dbg_parm start --------------------*/ + u8 radar_detect_dbg_parm_en; + u32 radar_detect_reg_918; + u32 radar_detect_reg_91c; + u32 radar_detect_reg_920; + u32 radar_detect_reg_924; + /*-----------------------------------------------------------*/ +#endif + +/*=== PHYDM Timer ========================================== (start)*/ + + struct timer_list mpt_dig_timer; /*MPT DIG timer*/ + struct timer_list path_div_switch_timer; + struct timer_list cck_path_diversity_timer; /*2011.09.27 add for path Diversity*/ + struct timer_list fast_ant_training_timer; +#ifdef ODM_EVM_ENHANCE_ANTDIV + struct timer_list evm_fast_ant_training_timer; +#endif + struct timer_list sbdcnt_timer; + + +/*=== PHYDM Workitem ======================================= (start)*/ + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if USE_WORKITEM + RT_WORK_ITEM path_div_switch_workitem; + RT_WORK_ITEM cck_path_diversity_workitem; + RT_WORK_ITEM fast_ant_training_workitem; + RT_WORK_ITEM ra_rpt_workitem; + RT_WORK_ITEM sbdcnt_workitem; +#endif +#endif + + +/*=== PHYDM Structure ======================================== (start)*/ + struct phydm_func_poiner phydm_func_handler; + struct phydm_iot_center iot_table; + +#ifdef ODM_CONFIG_BT_COEXIST + struct phydm_bt_info bt_info_table; +#endif + + struct pkt_process_info pkt_proc_struct; + struct phydm_adaptivity_struct adaptivity; + struct _DFS_STATISTICS dfs; + + struct _ODM_NOISE_MONITOR_ noise_level; + + struct _odm_phy_dbg_info_ phy_dbg_info; + +#ifdef CONFIG_ADAPTIVE_SOML + struct adaptive_soml dm_soml_table; +#endif + +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct _BF_DIV_COEX_ dm_bdc_table; + #endif + + #if (defined(CONFIG_HL_SMART_ANTENNA)) + struct smt_ant_honbo dm_sat_table; + #endif +#endif + +#if (defined(CONFIG_SMART_ANTENNA)) + struct smt_ant smtant_table; +#endif + + struct phydm_fat_struct dm_fat_table; + struct phydm_dig_struct dm_dig_table; + struct phydm_lna_sat_info_struct dm_lna_sat_info; + +#ifdef PHYDM_SUPPORT_CCKPD + struct phydm_cckpd_struct dm_cckpd_table; +#endif + +#ifdef PHYDM_PRIMARY_CCA + struct phydm_pricca_struct dm_pri_cca; +#endif + + struct _rate_adaptive_table_ dm_ra_table; + struct phydm_fa_struct false_alm_cnt; +#ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_fa_acc_struct false_alm_cnt_acc; +#endif + struct _sw_antenna_switch_ dm_swat_table; + struct phydm_cfo_track_struct dm_cfo_track; + struct _ACS_ dm_acs; + struct _CCX_INFO dm_ccx_info; + struct _hal_rf_ rf_table; /*for HALRF function*/ + struct odm_rf_calibration_structure rf_calibrate_info; + struct odm_power_trim_data power_trim_data; +#if (RTL8822B_SUPPORT == 1) + struct drp_rtl8822b_struct phydm_rtl8822b; +#endif + +#ifdef CONFIG_PSD_TOOL + struct _PHYDM_PSD_ dm_psd_table; +#endif + +#if (PHYDM_LA_MODE_SUPPORT == 1) + struct _RT_ADCSMP adcsmp; +#endif + +#ifdef CONFIG_DYNAMIC_RX_PATH + struct _DYNAMIC_RX_PATH_ dm_drp_table; +#endif + + struct _IQK_INFORMATION IQK_info; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _path_div_parameter_define_ path_iqk; +#endif + +#if (defined(CONFIG_PATH_DIVERSITY)) + struct _ODM_PATH_DIVERSITY_ dm_path_div; +#endif + +#if (defined(CONFIG_ANT_DETECTION)) + struct _ANT_DETECTED_INFO ant_detected_info; /* Antenna detected information for RSSI tool*/ +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (BEAMFORMING_SUPPORT == 1) + struct _RT_BEAMFORMING_INFO beamforming_info; +#endif +#endif +#ifdef PHYDM_AUTO_DEGBUG + struct phydm_auto_dbg_struc auto_dbg_table; +#endif + + struct phydm_pause_lv pause_lv_table; + struct phydm_api_stuc api_table; +#ifdef PHYDM_POWER_TRAINING_SUPPORT + struct phydm_pow_train_stuc pow_train_table; +#endif +/*==========================================================*/ + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + +#if (RT_PLATFORM != PLATFORM_LINUX) +}PHY_DM_STRUCT; /*DM_Dynamic_Mechanism_Structure*/ +#else +}; +#endif + +#else /*for AP,CE Team*/ +}; +#endif + +enum phydm_adv_ota { + PHYDM_PATHB_1RCCA = BIT(0), + PHYDM_HP_OTA_SETTING_A = BIT(1), + PHYDM_HP_OTA_SETTING_B = BIT(2), + PHYDM_ASUS_OTA_SETTING = BIT(3), + PHYDM_ASUS_OTA_SETTING_CCK_PATH = BIT(4), + PHYDM_HP_OTA_SETTING_CCK_PATH = BIT(5), + +}; + +enum phydm_bb_op_mode { + PHYDM_PERFORMANCE_MODE = 0, /*Service one device*/ + PHYDM_BALANCE_MODE = 1, /*Service more than one device*/ +}; + +enum phydm_structure_type { + PHYDM_FALSEALMCNT, + PHYDM_CFOTRACK, + PHYDM_ADAPTIVITY, + PHYDM_DFS, + PHYDM_ROMINFO, + +}; + +enum odm_bb_config_type { + CONFIG_BB_PHY_REG, + CONFIG_BB_AGC_TAB, + CONFIG_BB_AGC_TAB_2G, + CONFIG_BB_AGC_TAB_5G, + CONFIG_BB_PHY_REG_PG, + CONFIG_BB_PHY_REG_MP, + CONFIG_BB_AGC_TAB_DIFF, +}; + +enum odm_rf_config_type { + CONFIG_RF_RADIO, + CONFIG_RF_TXPWR_LMT, +}; + +enum odm_fw_config_type { + CONFIG_FW_NIC, + CONFIG_FW_NIC_2, + CONFIG_FW_AP, + CONFIG_FW_AP_2, + CONFIG_FW_MP, + CONFIG_FW_WOWLAN, + CONFIG_FW_WOWLAN_2, + CONFIG_FW_AP_WOWLAN, + CONFIG_FW_BT, +}; + +/*status code*/ +#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) +enum rt_status { + RT_STATUS_SUCCESS, + RT_STATUS_FAILURE, + RT_STATUS_PENDING, + RT_STATUS_RESOURCE, + RT_STATUS_INVALID_CONTEXT, + RT_STATUS_INVALID_PARAMETER, + RT_STATUS_NOT_SUPPORT, + RT_STATUS_OS_API_FAILED, +}; +#endif /*end of enum rt_status definition*/ + + +/*===========================================================*/ +/*AGC RX High Power mode*/ +/*===========================================================*/ +#define lna_low_gain_1 0x64 +#define lna_low_gain_2 0x5A +#define lna_low_gain_3 0x58 + +/*Add for cmn sta info*/ + +#define is_sta_active(p_sta) ((p_sta) && (p_sta->dm_ctrl & STA_DM_CTRL_ACTIVE)) + +void +phydm_watchdog_lps( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_watchdog_lps_32k( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_txcurrentcalibration( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_dm_early_init( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_dm_init( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_dm_reset( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_fwoffload_ability_init( + struct PHY_DM_STRUCT *p_dm, + enum phydm_offload_ability offload_ability +); + +void +phydm_fwoffload_ability_clear( + struct PHY_DM_STRUCT *p_dm, + enum phydm_offload_ability offload_ability +); + + +void +phydm_support_ability_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_pause_dm_watchdog( + void *p_dm_void, + enum phydm_pause_type pause_type +); + +void +phydm_watchdog( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_watchdog_mp( + struct PHY_DM_STRUCT *p_dm +); + +u8 +phydm_pause_func( + void *p_dm_void, + enum phydm_func_idx_e pause_func, + enum phydm_pause_type pause_type, + enum phydm_pause_level pause_lv, + u8 val_lehgth, + u32 *val_buf + +); + +void +phydm_pause_func_console( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +void +odm_cmn_info_init( + struct PHY_DM_STRUCT *p_dm, + enum odm_cmninfo_e cmn_info, + u64 value +); + +void +odm_cmn_info_hook( + struct PHY_DM_STRUCT *p_dm, + enum odm_cmninfo_e cmn_info, + void *p_value +); + +void +odm_cmn_info_update( + struct PHY_DM_STRUCT *p_dm, + u32 cmn_info, + u64 value +); + +u32 +phydm_cmn_info_query( + struct PHY_DM_STRUCT *p_dm, + enum phydm_info_query_e info_type +); + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) +void +odm_init_all_threads( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_stop_all_threads( + struct PHY_DM_STRUCT *p_dm +); +#endif + +void +odm_init_all_timers( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_cancel_all_timers( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_release_all_timers( + struct PHY_DM_STRUCT *p_dm +); + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void odm_init_all_work_items(struct PHY_DM_STRUCT *p_dm); +void odm_free_all_work_items(struct PHY_DM_STRUCT *p_dm); + +/*2012/01/12 MH Check afapter status. Temp fix BSOD.*/ + +#define HAL_ADAPTER_STS_CHK(p_dm) do {\ + if (p_dm->adapter == NULL) { \ + \ + return;\ + } \ + } while (0) + +#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + +void * +phydm_get_structure( + struct PHY_DM_STRUCT *p_dm, + u8 structure_type +); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) || (DM_ODM_SUPPORT_TYPE == ODM_CE) + /*===========================================================*/ + /* The following is for compile only*/ + /*===========================================================*/ + + #if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + #define IS_HARDWARE_TYPE_8188E(_adapter) false + #define IS_HARDWARE_TYPE_8188F(_adapter) false + #define IS_HARDWARE_TYPE_8703B(_adapter) false + #define IS_HARDWARE_TYPE_8723D(_adapter) false + #define IS_HARDWARE_TYPE_8821C(_adapter) false + #define IS_HARDWARE_TYPE_8812AU(_adapter) false + #define IS_HARDWARE_TYPE_8814A(_adapter) false + #define IS_HARDWARE_TYPE_8814AU(_adapter) false + #define IS_HARDWARE_TYPE_8814AE(_adapter) false + #define IS_HARDWARE_TYPE_8814AS(_adapter) false + #define IS_HARDWARE_TYPE_8723BU(_adapter) false + #define IS_HARDWARE_TYPE_8822BU(_adapter) false + #define IS_HARDWARE_TYPE_8822BS(_adapter) false + #define IS_HARDWARE_TYPE_JAGUAR(_Adapter) \ + (IS_HARDWARE_TYPE_8812(_Adapter) || IS_HARDWARE_TYPE_8821(_Adapter)) + #else + #define IS_HARDWARE_TYPE_8723A(_adapter) false + #endif + #define IS_HARDWARE_TYPE_8723AE(_adapter) false + #define IS_HARDWARE_TYPE_8192C(_adapter) false + #define IS_HARDWARE_TYPE_8192D(_adapter) false + #define RF_T_METER_92D 0x42 + + + #define GET_RX_STATUS_DESC_RX_MCS(__prx_status_desc) LE_BITS_TO_1BYTE(__prx_status_desc+12, 0, 6) + + #define REG_CONFIG_RAM64X16 0xb2c + + + /* *********************************************************** */ +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + void odm_dtc(struct PHY_DM_STRUCT *p_dm); +#endif + +void +phydm_dc_cancellation( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_receiver_blocking( + void *p_dm_void +); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.mk b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.mk new file mode 100644 index 000000000000..15bdad8e5bc8 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm.mk @@ -0,0 +1,167 @@ +EXTRA_CFLAGS += -I$(src)/hal/phydm + +_PHYDM_FILES := hal/phydm/phydm_debug.o \ + hal/phydm/phydm_antdiv.o\ + hal/phydm/phydm_soml.o\ + hal/phydm/phydm_smt_ant.o\ + hal/phydm/phydm_antdect.o\ + hal/phydm/phydm_interface.o\ + hal/phydm/phydm_phystatus.o\ + hal/phydm/phydm_hwconfig.o\ + hal/phydm/phydm.o\ + hal/phydm/phydm_dig.o\ + hal/phydm/phydm_pathdiv.o\ + hal/phydm/phydm_rainfo.o\ + hal/phydm/phydm_dynamictxpower.o\ + hal/phydm/phydm_adaptivity.o\ + hal/phydm/phydm_cfotracking.o\ + hal/phydm/phydm_noisemonitor.o\ + hal/phydm/phydm_acs.o\ + hal/phydm/phydm_beamforming.o\ + hal/phydm/phydm_dfs.o\ + hal/phydm/txbf/halcomtxbf.o\ + hal/phydm/txbf/haltxbfinterface.o\ + hal/phydm/txbf/phydm_hal_txbf_api.o\ + hal/phydm/phydm_adc_sampling.o\ + hal/phydm/phydm_ccx.o\ + hal/phydm/phydm_psd.o\ + hal/phydm/phydm_primary_cca.o\ + hal/phydm/phydm_cck_pd.o\ + hal/phydm/phydm_rssi_monitor.o\ + hal/phydm/phydm_auto_dbg.o\ + hal/phydm/phydm_math_lib.o\ + hal/phydm/phydm_api.o\ + hal/phydm/phydm_pow_train.o\ + hal/phydm/halrf/halrf.o\ + hal/phydm/halrf/halphyrf_ce.o\ + hal/phydm/halrf/halrf_powertracking_ce.o\ + hal/phydm/halrf/halrf_powertracking.o\ + hal/phydm/halrf/halrf_kfree.o + +ifeq ($(CONFIG_RTL8188E), y) +RTL871X = rtl8188e +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8188e_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8188e_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8188e_rf.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8188e_ce.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8188e.o\ + hal/phydm/$(RTL871X)/hal8188erateadaptive.o\ + hal/phydm/$(RTL871X)/phydm_rtl8188e.o +endif + +ifeq ($(CONFIG_RTL8192E), y) +RTL871X = rtl8192e +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8192e_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8192e_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8192e_rf.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8192e_ce.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8192e.o\ + hal/phydm/$(RTL871X)/phydm_rtl8192e.o +endif + + +ifeq ($(CONFIG_RTL8812A), y) +RTL871X = rtl8812a +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8812a_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8812a_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8812a_rf.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8812a_ce.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8812a.o\ + hal/phydm/$(RTL871X)/phydm_rtl8812a.o\ + hal/phydm/txbf/haltxbfjaguar.o +endif + +ifeq ($(CONFIG_RTL8821A), y) +RTL871X = rtl8821a +_PHYDM_FILES += hal/phydm/rtl8821a/halhwimg8821a_mac.o\ + hal/phydm/rtl8821a/halhwimg8821a_bb.o\ + hal/phydm/rtl8821a/halhwimg8821a_rf.o\ + hal/phydm/halrf/rtl8812a/halrf_8812a_ce.o\ + hal/phydm/halrf/rtl8821a/halrf_8821a_ce.o\ + hal/phydm/rtl8821a/phydm_regconfig8821a.o\ + hal/phydm/rtl8821a/phydm_rtl8821a.o\ + hal/phydm/halrf/rtl8821a/halrf_iqk_8821a_ce.o\ + hal/phydm/txbf/haltxbfjaguar.o +endif + + +ifeq ($(CONFIG_RTL8723B), y) +RTL871X = rtl8723b +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8723b_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8723b_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8723b_rf.o\ + hal/phydm/$(RTL871X)/halhwimg8723b_mp.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8723b.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8723b_ce.o\ + hal/phydm/$(RTL871X)/phydm_rtl8723b.o +endif + + +ifeq ($(CONFIG_RTL8814A), y) +RTL871X = rtl8814a +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8814a_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8814a_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8814a_rf.o\ + hal/phydm/halrf/$(RTL871X)/halrf_iqk_8814a.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8814a.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8814a_ce.o\ + hal/phydm/$(RTL871X)/phydm_rtl8814a.o\ + hal/phydm/txbf/haltxbf8814a.o +endif + + +ifeq ($(CONFIG_RTL8723C), y) +RTL871X = rtl8703b +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8703b_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8703b_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8703b_rf.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8703b.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8703b.o +endif + +ifeq ($(CONFIG_RTL8723D), y) +RTL871X = rtl8723d +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8723d_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8723d_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8723d_rf.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8723d.o\ + hal/phydm/$(RTL871X)/phydm_rtl8723d.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8723d.o +endif + + +ifeq ($(CONFIG_RTL8188F), y) +RTL871X = rtl8188f +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8188f_bb.o\ + hal/phydm/$(RTL871X)/halhwimg8188f_mac.o\ + hal/phydm/$(RTL871X)/halhwimg8188f_rf.o\ + hal/phydm/$(RTL871X)/phydm_regconfig8188f.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8188f.o \ + hal/phydm/$(RTL871X)/phydm_rtl8188f.o +endif + +ifeq ($(CONFIG_RTL8822B), y) +RTL871X = rtl8822b +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8822b_bb.o \ + hal/phydm/$(RTL871X)/halhwimg8822b_mac.o \ + hal/phydm/$(RTL871X)/halhwimg8822b_rf.o \ + hal/phydm/halrf/$(RTL871X)/halrf_8822b.o \ + hal/phydm/$(RTL871X)/phydm_hal_api8822b.o \ + hal/phydm/halrf/$(RTL871X)/halrf_iqk_8822b.o \ + hal/phydm/$(RTL871X)/phydm_regconfig8822b.o \ + hal/phydm/$(RTL871X)/phydm_rtl8822b.o + +_PHYDM_FILES += hal/phydm/txbf/haltxbf8822b.o +endif + + +ifeq ($(CONFIG_RTL8821C), y) +RTL871X = rtl8821c +_PHYDM_FILES += hal/phydm/$(RTL871X)/halhwimg8821c_bb.o \ + hal/phydm/$(RTL871X)/halhwimg8821c_mac.o \ + hal/phydm/$(RTL871X)/halhwimg8821c_rf.o \ + hal/phydm/$(RTL871X)/phydm_hal_api8821c.o \ + hal/phydm/$(RTL871X)/phydm_regconfig8821c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_8821c.o\ + hal/phydm/halrf/$(RTL871X)/halrf_iqk_8821c.o +endif \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.c index 5227a3adfb79..053ecfcb45b4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.c @@ -1,1226 +1,1151 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - - -u1Byte -ODM_GetAutoChannelSelectResult( - IN PVOID pDM_VOID, - IN u1Byte Band -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PACS pACS = &pDM_Odm->DM_ACS; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(Band == ODM_BAND_2_4G) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_2G(%d)\n", pACS->CleanChannel_2G)); - return (u1Byte)pACS->CleanChannel_2G; - } - else - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("[ACS] ODM_GetAutoChannelSelectResult(): CleanChannel_5G(%d)\n", pACS->CleanChannel_5G)); - return (u1Byte)pACS->CleanChannel_5G; - } -#else - return (u1Byte)pACS->CleanChannel_2G; -#endif - -} - -VOID -odm_AutoChannelSelectSetting( - IN PVOID pDM_VOID, - IN BOOLEAN IsEnable -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u2Byte period = 0x2710;// 40ms in default - u2Byte NHMType = 0x7; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSetting()=========> \n")); - - if(IsEnable) - {//20 ms - period = 0x1388; - NHMType = 0x1; - } - - if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - { - //PHY parameters initialize for ac series - ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); //0x990[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms - //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8|BIT9|BIT10, NHMType); //0x994[9:8]=3 enable CCX - } - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { - //PHY parameters initialize for n series - ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N+2, period); //0x894[31:16]=0x2710 Time duration for NHM unit: 4us, 0x2710=40ms - //ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10|BIT9|BIT8, NHMType); //0x890[9:8]=3 enable CCX - } -#endif -} - -VOID -odm_AutoChannelSelectInit( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PACS pACS = &pDM_Odm->DM_ACS; - u1Byte i; - - if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) - return; - - if(pACS->bForceACSResult) - return; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectInit()=========> \n")); - - pACS->CleanChannel_2G = 1; - pACS->CleanChannel_5G = 36; - - for (i = 0; i < ODM_MAX_CHANNEL_2G; ++i) - { - pACS->Channel_Info_2G[0][i] = 0; - pACS->Channel_Info_2G[1][i] = 0; - } - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - { - for (i = 0; i < ODM_MAX_CHANNEL_5G; ++i) - { - pACS->Channel_Info_5G[0][i] = 0; - pACS->Channel_Info_5G[1][i] = 0; - } - } -#endif -} - -VOID -odm_AutoChannelSelectReset( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PACS pACS = &pDM_Odm->DM_ACS; - - if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) - return; - - if(pACS->bForceACSResult) - return; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectReset()=========> \n")); - - odm_AutoChannelSelectSetting(pDM_Odm,TRUE);// for 20ms measurement - Phydm_NHMCounterStatisticsReset(pDM_Odm); -#endif -} - -VOID -odm_AutoChannelSelect( - IN PVOID pDM_VOID, - IN u1Byte Channel -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PACS pACS = &pDM_Odm->DM_ACS; - u1Byte ChannelIDX = 0, SearchIDX = 0; - u2Byte MaxScore=0; - - if(!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Return: SupportAbility ODM_BB_NHM_CNT is disabled\n")); - return; - } - - if(pACS->bForceACSResult) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Force 2G clean channel = %d, 5G clean channel = %d\n", - pACS->CleanChannel_2G, pACS->CleanChannel_5G)); - return; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel = %d=========> \n", Channel)); - - Phydm_GetNHMCounterStatistics(pDM_Odm); - odm_AutoChannelSelectSetting(pDM_Odm,FALSE); - - if(Channel >=1 && Channel <=14) - { - ChannelIDX = Channel - 1; - pACS->Channel_Info_2G[1][ChannelIDX]++; - - if(pACS->Channel_Info_2G[1][ChannelIDX] >= 2) - pACS->Channel_Info_2G[0][ChannelIDX] = (pACS->Channel_Info_2G[0][ChannelIDX] >> 1) + - (pACS->Channel_Info_2G[0][ChannelIDX] >> 2) + (pDM_Odm->NHM_cnt_0>>2); - else - pACS->Channel_Info_2G[0][ChannelIDX] = pDM_Odm->NHM_cnt_0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): NHM_cnt_0 = %d \n", pDM_Odm->NHM_cnt_0)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelect(): Channel_Info[0][%d] = %d, Channel_Info[1][%d] = %d\n", ChannelIDX, pACS->Channel_Info_2G[0][ChannelIDX], ChannelIDX, pACS->Channel_Info_2G[1][ChannelIDX])); - - for(SearchIDX = 0; SearchIDX < ODM_MAX_CHANNEL_2G; SearchIDX++) - { - if(pACS->Channel_Info_2G[1][SearchIDX] != 0) - { - if(pACS->Channel_Info_2G[0][SearchIDX] >= MaxScore) - { - MaxScore = pACS->Channel_Info_2G[0][SearchIDX]; - pACS->CleanChannel_2G = SearchIDX+1; - } - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("(1)odm_AutoChannelSelect(): 2G: CleanChannel_2G = %d, MaxScore = %d \n", - pACS->CleanChannel_2G, MaxScore)); - - } - else if(Channel >= 36) - { - // Need to do - pACS->CleanChannel_5G = Channel; - } -#endif -} - -#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) - -VOID -phydm_AutoChannelSelectSettingAP( - IN PVOID pDM_VOID, - IN u4Byte setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING - IN u4Byte acs_step -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - prtl8192cd_priv priv = pDM_Odm->priv; - PACS pACS = &pDM_Odm->DM_ACS; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("odm_AutoChannelSelectSettingAP()=========> \n")); - - //3 Store Default Setting - if(setting == STORE_DEFAULT_NHM_SETTING) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("STORE_DEFAULT_NHM_SETTING\n")); - - if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 - { - pACS->Reg0x990 = ODM_Read4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC); // Reg0x990 - pACS->Reg0x994 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC); // Reg0x994 - pACS->Reg0x998 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC); // Reg0x998 - pACS->Reg0x99C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC); // Reg0x99c - pACS->Reg0x9A0 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC); // Reg0x9a0, u1Byte - } - else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { - pACS->Reg0x890 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N); // Reg0x890 - pACS->Reg0x894 = ODM_Read4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N); // Reg0x894 - pACS->Reg0x898 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N); // Reg0x898 - pACS->Reg0x89C = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N); // Reg0x89c - pACS->Reg0xE28 = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N); // Reg0xe28, u1Byte - } - } - - //3 Restore Default Setting - else if(setting == RESTORE_DEFAULT_NHM_SETTING) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("RESTORE_DEFAULT_NHM_SETTING\n")); - - if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) // store Reg0x990, Reg0x994, Reg0x998, Reg0x99C, Reg0x9a0 - { - ODM_Write4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, pACS->Reg0x990); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, pACS->Reg0x994); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, pACS->Reg0x998); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, pACS->Reg0x99C); - ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, pACS->Reg0x9A0); - } - else if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, pACS->Reg0x890); - ODM_Write4Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, pACS->Reg0x894); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, pACS->Reg0x898); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, pACS->Reg0x89C); - ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, pACS->Reg0xE28); - } - } - - //3 ACS Setting - else if(setting == ACS_NHM_SETTING) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ACS, ODM_DBG_LOUD, ("ACS_NHM_SETTING\n")); - u2Byte period; - period = 0x61a8; - pACS->ACS_Step = acs_step; - - if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - { - //4 Set NHM period, 0x990[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms - ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); - //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC,BIT8|BIT9|BIT10, 3); - - if(pACS->ACS_Step == 0) - { - //4 Set IGI - ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); - - //4 Set ACS NHM threshold - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x82786e64); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff8c); - ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11AC, 0xff); - ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC+2, 0xffff); - - } - else if(pACS->ACS_Step == 1) - { - //4 Set IGI - ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - ODM_SetBBReg(pDM_Odm,0xe50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); - - //4 Set ACS NHM threshold - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x5a50463c); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff64); - - } - - } - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { - //4 Set NHM period, 0x894[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms - ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+2, period); - //4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N,BIT8|BIT9|BIT10, 3); - - if(pACS->ACS_Step == 0) - { - //4 Set IGI - ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x3E); - - //4 Set ACS NHM threshold - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x82786e64); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff8c); - ODM_Write1Byte(pDM_Odm, ODM_REG_NHM_TH8_11N, 0xff); - ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N+2, 0xffff); - - } - else if(pACS->ACS_Step == 1) - { - //4 Set IGI - ODM_SetBBReg(pDM_Odm,0xc50,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); - if (get_rf_mimo_mode(priv) != MIMO_1T1R) - ODM_SetBBReg(pDM_Odm,0xc58,BIT0|BIT1|BIT2|BIT3|BIT4|BIT5|BIT6,0x2A); - - //4 Set ACS NHM threshold - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x5a50463c); - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff64); - - } - } - } - -} - -VOID -phydm_GetNHMStatisticsAP( - IN PVOID pDM_VOID, - IN u4Byte idx, // @ 2G, Real channel number = idx+1 - IN u4Byte acs_step -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - prtl8192cd_priv priv = pDM_Odm->priv; - PACS pACS = &pDM_Odm->DM_ACS; - u4Byte value32 = 0; - u1Byte i; - - pACS->ACS_Step = acs_step; - - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { - //4 Check if NHM result is ready - for (i=0; i<20; i++) { - - ODM_delay_ms(1); - if ( ODM_GetBBReg(pDM_Odm,rFPGA0_PSDReport,BIT17) ) - break; - } - - //4 Get NHM Statistics - if ( pACS->ACS_Step==1 ) { - - value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11N); - - pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; - pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); - - value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N - - pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; - pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; - pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; - - } else if (pACS->ACS_Step==2) { - - value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11N); // ODM_REG_NHM_CNT3_TO_CNT0_11N - - pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11N); - pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; - pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; - pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; - pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); - } - } - else if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - { - //4 Check if NHM result is ready - for (i=0; i<20; i++) { - - ODM_delay_ms(1); - if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT16)) - break; - } - - if ( pACS->ACS_Step==1 ) { - - value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT7_TO_CNT4_11AC); - - pACS->NHM_Cnt[idx][9] = (value32 & bMaskByte1) >> 8; - pACS->NHM_Cnt[idx][8] = (value32 & bMaskByte0); - - value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC - - pACS->NHM_Cnt[idx][7] = (value32 & bMaskByte3) >> 24; - pACS->NHM_Cnt[idx][6] = (value32 & bMaskByte2) >> 16; - pACS->NHM_Cnt[idx][5] = (value32 & bMaskByte1) >> 8; - - } else if (pACS->ACS_Step==2) { - - value32 = ODM_Read4Byte(pDM_Odm,ODM_REG_NHM_CNT_11AC); // ODM_REG_NHM_CNT3_TO_CNT0_11AC - - pACS->NHM_Cnt[idx][4] = ODM_Read1Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); - pACS->NHM_Cnt[idx][3] = (value32 & bMaskByte3) >> 24; - pACS->NHM_Cnt[idx][2] = (value32 & bMaskByte2) >> 16; - pACS->NHM_Cnt[idx][1] = (value32 & bMaskByte1) >> 8; - pACS->NHM_Cnt[idx][0] = (value32 & bMaskByte0); - } - } - -} - - -//#define ACS_DEBUG_INFO //acs debug default off -/* -int phydm_AutoChannelSelectAP( - IN PVOID pDM_VOID, - IN u4Byte ACS_Type, // 0: RXCount_Type, 1:NHM_Type - IN u4Byte available_chnl_num // amount of all channels - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PACS pACS = &pDM_Odm->DM_ACS; - prtl8192cd_priv priv = pDM_Odm->priv; - - static u4Byte score2G[MAX_2G_CHANNEL_NUM], score5G[MAX_5G_CHANNEL_NUM]; - u4Byte score[MAX_BSS_NUM], use_nhm = 0; - u4Byte minScore=0xffffffff; - u4Byte tmpScore, tmpIdx=0; - u4Byte traffic_check = 0; - u4Byte fa_count_weighting = 1; - int i, j, idx=0, idx_2G_end=-1, idx_5G_begin=-1, minChan=0; - struct bss_desc *pBss=NULL; - -#ifdef _DEBUG_RTL8192CD_ - char tmpbuf[400]; - int len=0; -#endif - - memset(score2G, '\0', sizeof(score2G)); - memset(score5G, '\0', sizeof(score5G)); - - for (i=0; iavailable_chnl_num; i++) { - if (priv->available_chnl[i] <= 14) - idx_2G_end = i; - else - break; - } - - for (i=0; iavailable_chnl_num; i++) { - if (priv->available_chnl[i] > 14) { - idx_5G_begin = i; - break; - } - } - -// DELETE -#ifndef CONFIG_RTL_NEW_AUTOCH - for (i=0; isite_survey->count; i++) { - pBss = &priv->site_survey->bss[i]; - for (idx=0; idxavailable_chnl_num; idx++) { - if (pBss->channel == priv->available_chnl[idx]) { - if (pBss->channel <= 14) - setChannelScore(idx, score2G, 0, MAX_2G_CHANNEL_NUM-1); - else - score5G[idx - idx_5G_begin] += 5; - break; - } - } - } -#endif - - if (idx_2G_end >= 0) - for (i=0; i<=idx_2G_end; i++) - score[i] = score2G[i]; - if (idx_5G_begin >= 0) - for (i=idx_5G_begin; iavailable_chnl_num; i++) - score[i] = score5G[i - idx_5G_begin]; - -#ifdef CONFIG_RTL_NEW_AUTOCH - { - u4Byte y, ch_begin=0, ch_end= priv->available_chnl_num; - - u4Byte do_ap_check = 1, ap_ratio = 0; - - if (idx_2G_end >= 0) - ch_end = idx_2G_end+1; - if (idx_5G_begin >= 0) - ch_begin = idx_5G_begin; - -#ifdef ACS_DEBUG_INFO//for debug - printk("\n"); - for (y=ch_begin; yavailable_chnl[y], - priv->chnl_ss_mac_rx_count[y], - priv->chnl_ss_mac_rx_count_40M[y], - priv->chnl_ss_fa_count[y], - score[y]); - printk("\n"); -#endif - -#if defined(CONFIG_RTL_88E_SUPPORT) || defined(CONFIG_WLAN_HAL_8192EE) - if( pDM_Odm->SupportICType&(ODM_RTL8188E|ODM_RTL8192E)&& priv->pmib->dot11RFEntry.acs_type ) - { - u4Byte tmp_score[MAX_BSS_NUM]; - memcpy(tmp_score, score, sizeof(score)); - if (find_clean_channel(priv, ch_begin, ch_end, tmp_score)) { - //memcpy(score, tmp_score, sizeof(score)); -#ifdef _DEBUG_RTL8192CD_ - printk("!! Found clean channel, select minimum FA channel\n"); -#endif - goto USE_CLN_CH; - } -#ifdef _DEBUG_RTL8192CD_ - printk("!! Not found clean channel, use NHM algorithm\n"); -#endif - use_nhm = 1; -USE_CLN_CH: - for (y=ch_begin; ynhm_cnt[y][i]; - for (j=0; jL, score: %d\n", - y+1, priv->nhm_cnt[y][9], priv->nhm_cnt[y][8], priv->nhm_cnt[y][7], - priv->nhm_cnt[y][6], priv->nhm_cnt[y][5], priv->nhm_cnt[y][4], - priv->nhm_cnt[y][3], priv->nhm_cnt[y][2], priv->nhm_cnt[y][1], - priv->nhm_cnt[y][0], score[y]); -#endif - } - - if (!use_nhm) - memcpy(score, tmp_score, sizeof(score)); - - goto choose_ch; - } -#endif - - // For each channel, weighting behind channels with MAC RX counter - //For each channel, weighting the channel with FA counter - - for (y=ch_begin; ychnl_ss_mac_rx_count[y]; - if (priv->chnl_ss_mac_rx_count[y] > 30) - do_ap_check = 0; - if( priv->chnl_ss_mac_rx_count[y] > MAC_RX_COUNT_THRESHOLD ) - traffic_check = 1; - -#ifdef RTK_5G_SUPPORT - if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -#endif - { - if ((int)(y-4) >= (int)ch_begin) - score[y-4] += 2 * priv->chnl_ss_mac_rx_count[y]; - if ((int)(y-3) >= (int)ch_begin) - score[y-3] += 8 * priv->chnl_ss_mac_rx_count[y]; - if ((int)(y-2) >= (int)ch_begin) - score[y-2] += 8 * priv->chnl_ss_mac_rx_count[y]; - if ((int)(y-1) >= (int)ch_begin) - score[y-1] += 10 * priv->chnl_ss_mac_rx_count[y]; - if ((int)(y+1) < (int)ch_end) - score[y+1] += 10 * priv->chnl_ss_mac_rx_count[y]; - if ((int)(y+2) < (int)ch_end) - score[y+2] += 8 * priv->chnl_ss_mac_rx_count[y]; - if ((int)(y+3) < (int)ch_end) - score[y+3] += 8 * priv->chnl_ss_mac_rx_count[y]; - if ((int)(y+4) < (int)ch_end) - score[y+4] += 2 * priv->chnl_ss_mac_rx_count[y]; - } - - //this is for CH_LOAD caculation - if( priv->chnl_ss_cca_count[y] > priv->chnl_ss_fa_count[y]) - priv->chnl_ss_cca_count[y]-= priv->chnl_ss_fa_count[y]; - else - priv->chnl_ss_cca_count[y] = 0; - } - -#ifdef ACS_DEBUG_INFO//for debug - printk("\n"); - for (y=ch_begin; yavailable_chnl[y], score[y]); - printk("\n"); -#endif - - for (y=ch_begin; ychnl_ss_mac_rx_count_40M[y]) { - score[y] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; - if (priv->chnl_ss_mac_rx_count_40M[y] > 30) - do_ap_check = 0; - if( priv->chnl_ss_mac_rx_count_40M[y] > MAC_RX_COUNT_THRESHOLD ) - traffic_check = 1; - -#ifdef RTK_5G_SUPPORT - if (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) -#endif - { - if ((int)(y-6) >= (int)ch_begin) - score[y-6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y-5) >= (int)ch_begin) - score[y-5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y-4) >= (int)ch_begin) - score[y-4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y-3) >= (int)ch_begin) - score[y-3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y-2) >= (int)ch_begin) - score[y-2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; - if ((int)(y-1) >= (int)ch_begin) - score[y-1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y+1) < (int)ch_end) - score[y+1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y+2) < (int)ch_end) - score[y+2] += (5 * priv->chnl_ss_mac_rx_count_40M[y])/2; - if ((int)(y+3) < (int)ch_end) - score[y+3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y+4) < (int)ch_end) - score[y+4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y+5) < (int)ch_end) - score[y+5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; - if ((int)(y+6) < (int)ch_end) - score[y+6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; - } - } - } - -#ifdef ACS_DEBUG_INFO//for debug - printk("\n"); - for (y=ch_begin; yavailable_chnl[y], score[y]); - printk("\n"); - printk("4. do_ap_check=%d traffic_check=%d\n", do_ap_check, traffic_check); - printk("\n"); -#endif - - if( traffic_check == 0) - fa_count_weighting = 5; - else - fa_count_weighting = 1; - - for (y=ch_begin; ychnl_ss_fa_count[y]; - } - -#ifdef ACS_DEBUG_INFO//for debug - printk("\n"); - for (y=ch_begin; yavailable_chnl[y], score[y]); - printk("\n"); -#endif - - if (do_ap_check) { - for (i=0; isite_survey->count; i++) { - pBss = &priv->site_survey->bss[i]; - for (y=ch_begin; ychannel == priv->available_chnl[y]) { - if (pBss->channel <= 14) { -#ifdef ACS_DEBUG_INFO//for debug - printk("\n"); - printk("chnl[%d] has ap rssi=%d bw[0x%02x]\n", - pBss->channel, pBss->rssi, pBss->t_stamp[1]); - printk("\n"); -#endif - if (pBss->rssi > 60) - ap_ratio = 4; - else if (pBss->rssi > 35) - ap_ratio = 2; - else - ap_ratio = 1; - - if ((pBss->t_stamp[1] & 0x6) == 0) { - score[y] += 50 * ap_ratio; - if ((int)(y-4) >= (int)ch_begin) - score[y-4] += 10 * ap_ratio; - if ((int)(y-3) >= (int)ch_begin) - score[y-3] += 20 * ap_ratio; - if ((int)(y-2) >= (int)ch_begin) - score[y-2] += 30 * ap_ratio; - if ((int)(y-1) >= (int)ch_begin) - score[y-1] += 40 * ap_ratio; - if ((int)(y+1) < (int)ch_end) - score[y+1] += 40 * ap_ratio; - if ((int)(y+2) < (int)ch_end) - score[y+2] += 30 * ap_ratio; - if ((int)(y+3) < (int)ch_end) - score[y+3] += 20 * ap_ratio; - if ((int)(y+4) < (int)ch_end) - score[y+4] += 10 * ap_ratio; - } - else if ((pBss->t_stamp[1] & 0x4) == 0) { - score[y] += 50 * ap_ratio; - if ((int)(y-3) >= (int)ch_begin) - score[y-3] += 20 * ap_ratio; - if ((int)(y-2) >= (int)ch_begin) - score[y-2] += 30 * ap_ratio; - if ((int)(y-1) >= (int)ch_begin) - score[y-1] += 40 * ap_ratio; - if ((int)(y+1) < (int)ch_end) - score[y+1] += 50 * ap_ratio; - if ((int)(y+2) < (int)ch_end) - score[y+2] += 50 * ap_ratio; - if ((int)(y+3) < (int)ch_end) - score[y+3] += 50 * ap_ratio; - if ((int)(y+4) < (int)ch_end) - score[y+4] += 50 * ap_ratio; - if ((int)(y+5) < (int)ch_end) - score[y+5] += 40 * ap_ratio; - if ((int)(y+6) < (int)ch_end) - score[y+6] += 30 * ap_ratio; - if ((int)(y+7) < (int)ch_end) - score[y+7] += 20 * ap_ratio; - } - else { - score[y] += 50 * ap_ratio; - if ((int)(y-7) >= (int)ch_begin) - score[y-7] += 20 * ap_ratio; - if ((int)(y-6) >= (int)ch_begin) - score[y-6] += 30 * ap_ratio; - if ((int)(y-5) >= (int)ch_begin) - score[y-5] += 40 * ap_ratio; - if ((int)(y-4) >= (int)ch_begin) - score[y-4] += 50 * ap_ratio; - if ((int)(y-3) >= (int)ch_begin) - score[y-3] += 50 * ap_ratio; - if ((int)(y-2) >= (int)ch_begin) - score[y-2] += 50 * ap_ratio; - if ((int)(y-1) >= (int)ch_begin) - score[y-1] += 50 * ap_ratio; - if ((int)(y+1) < (int)ch_end) - score[y+1] += 40 * ap_ratio; - if ((int)(y+2) < (int)ch_end) - score[y+2] += 30 * ap_ratio; - if ((int)(y+3) < (int)ch_end) - score[y+3] += 20 * ap_ratio; - } - } - else { - if ((pBss->t_stamp[1] & 0x6) == 0) { - score[y] += 500; - } - else if ((pBss->t_stamp[1] & 0x4) == 0) { - score[y] += 500; - if ((int)(y+1) < (int)ch_end) - score[y+1] += 500; - } - else { - score[y] += 500; - if ((int)(y-1) >= (int)ch_begin) - score[y-1] += 500; - } - } - break; - } - } - } - } - -#ifdef ACS_DEBUG_INFO//for debug - printk("\n"); - for (y=ch_begin; yavailable_chnl[y],score[y]); - printk("\n"); -#endif - -#ifdef SS_CH_LOAD_PROC - - // caculate noise level -- suggested by wilson - for (y=ch_begin; ychnl_ss_fa_count[y]>1000) { - fa_lv = 100; - } else if (priv->chnl_ss_fa_count[y]>500) { - fa_lv = 34 * (priv->chnl_ss_fa_count[y]-500) / 500 + 66; - } else if (priv->chnl_ss_fa_count[y]>200) { - fa_lv = 33 * (priv->chnl_ss_fa_count[y] - 200) / 300 + 33; - } else if (priv->chnl_ss_fa_count[y]>100) { - fa_lv = 18 * (priv->chnl_ss_fa_count[y] - 100) / 100 + 15; - } else { - fa_lv = 15 * priv->chnl_ss_fa_count[y] / 100; - } - if (priv->chnl_ss_cca_count[y]>400) { - cca_lv = 100; - } else if (priv->chnl_ss_cca_count[y]>200) { - cca_lv = 34 * (priv->chnl_ss_cca_count[y] - 200) / 200 + 66; - } else if (priv->chnl_ss_cca_count[y]>80) { - cca_lv = 33 * (priv->chnl_ss_cca_count[y] - 80) / 120 + 33; - } else if (priv->chnl_ss_cca_count[y]>40) { - cca_lv = 18 * (priv->chnl_ss_cca_count[y] - 40) / 40 + 15; - } else { - cca_lv = 15 * priv->chnl_ss_cca_count[y] / 40; - } - - priv->chnl_ss_load[y] = (((fa_lv > cca_lv)? fa_lv : cca_lv)*75+((score[y]>100)?100:score[y])*25)/100; - - DEBUG_INFO("ch:%d f=%d (%d), c=%d (%d), fl=%d, cl=%d, sc=%d, cu=%d\n", - priv->available_chnl[y], - priv->chnl_ss_fa_count[y], fa_thd, - priv->chnl_ss_cca_count[y], cca_thd, - fa_lv, - cca_lv, - score[y], - priv->chnl_ss_load[y]); - - } -#endif - } -#endif - -choose_ch: - -#ifdef DFS - // heavy weighted DFS channel - if (idx_5G_begin >= 0){ - for (i=idx_5G_begin; iavailable_chnl_num; i++) { - if (!priv->pmib->dot11DFSEntry.disable_DFS && is_DFS_channel(priv->available_chnl[i]) - && (score[i]!= 0xffffffff)){ - score[i] += 1600; - } - } - } -#endif - - -//prevent Auto Channel selecting wrong channel in 40M mode----------------- - if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) - && priv->pshare->is_40m_bw) { -#if 0 - if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 1) { - //Upper Primary Channel, cannot select the two lowest channels - if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { - score[0] = 0xffffffff; - score[1] = 0xffffffff; - score[2] = 0xffffffff; - score[3] = 0xffffffff; - score[4] = 0xffffffff; - - score[13] = 0xffffffff; - score[12] = 0xffffffff; - score[11] = 0xffffffff; - } - -// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { -// score[idx_5G_begin] = 0xffffffff; -// score[idx_5G_begin + 1] = 0xffffffff; -// } - } - else if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 2) { - //Lower Primary Channel, cannot select the two highest channels - if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { - score[0] = 0xffffffff; - score[1] = 0xffffffff; - score[2] = 0xffffffff; - - score[13] = 0xffffffff; - score[12] = 0xffffffff; - score[11] = 0xffffffff; - score[10] = 0xffffffff; - score[9] = 0xffffffff; - } - -// if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { -// score[priv->available_chnl_num - 2] = 0xffffffff; -// score[priv->available_chnl_num - 1] = 0xffffffff; -// } - } -#endif - for (i=0; i<=idx_2G_end; ++i) - if (priv->available_chnl[i] == 14) - score[i] = 0xffffffff; // mask chan14 - -#ifdef RTK_5G_SUPPORT - if (idx_5G_begin >= 0) { - for (i=idx_5G_begin; iavailable_chnl_num; i++) { - int ch = priv->available_chnl[i]; - if(priv->available_chnl[i] > 144) - --ch; - if((ch%4) || ch==140 || ch == 164 ) //mask ch 140, ch 165, ch 184... - score[i] = 0xffffffff; - } - } -#endif - - - } - - if (priv->pmib->dot11RFEntry.disable_ch1213) { - for (i=0; i<=idx_2G_end; ++i) { - int ch = priv->available_chnl[i]; - if ((ch == 12) || (ch == 13)) - score[i] = 0xffffffff; - } - } - - if (((priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_GLOBAL) || - (priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_WORLD_WIDE)) && - (idx_2G_end >= 11) && (idx_2G_end < 14)) { - score[13] = 0xffffffff; // mask chan14 - score[12] = 0xffffffff; // mask chan13 - score[11] = 0xffffffff; // mask chan12 - } - -//------------------------------------------------------------------ - -#ifdef _DEBUG_RTL8192CD_ - for (i=0; iavailable_chnl_num; i++) { - len += sprintf(tmpbuf+len, "ch%d:%u ", priv->available_chnl[i], score[i]); - } - strcat(tmpbuf, "\n"); - panic_printk("%s", tmpbuf); - -#endif - - if ( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) - && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) - { - for (i=0; iavailable_chnl_num; i++) { - if (is80MChannel(priv->available_chnl, priv->available_chnl_num, priv->available_chnl[i])) { - tmpScore = 0; - for (j=0; j<4; j++) { - if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) - tmpScore += score[i+j]; - else - tmpScore = 0xffffffff; - } - tmpScore = tmpScore / 4; - if (minScore > tmpScore) { - minScore = tmpScore; - - tmpScore = 0xffffffff; - for (j=0; j<4; j++) { - if (score[i+j] < tmpScore) { - tmpScore = score[i+j]; - tmpIdx = i+j; - } - } - - idx = tmpIdx; - } - i += 3; - } - } - if (minScore == 0xffffffff) { - // there is no 80M channels - priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; - for (i=0; iavailable_chnl_num; i++) { - if (score[i] < minScore) { - minScore = score[i]; - idx = i; - } - } - } - } - else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) - && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40)) - { - for (i=0; iavailable_chnl_num; i++) { - if(is40MChannel(priv->available_chnl,priv->available_chnl_num,priv->available_chnl[i])) { - tmpScore = 0; - for(j=0;j<2;j++) { - if ((tmpScore != 0xffffffff) && (score[i+j] != 0xffffffff)) - tmpScore += score[i+j]; - else - tmpScore = 0xffffffff; - } - tmpScore = tmpScore / 2; - if(minScore > tmpScore) { - minScore = tmpScore; - - tmpScore = 0xffffffff; - for (j=0; j<2; j++) { - if (score[i+j] < tmpScore) { - tmpScore = score[i+j]; - tmpIdx = i+j; - } - } - - idx = tmpIdx; - } - i += 1; - } - } - if (minScore == 0xffffffff) { - // there is no 40M channels - priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; - for (i=0; iavailable_chnl_num; i++) { - if (score[i] < minScore) { - minScore = score[i]; - idx = i; - } - } - } - } - else if( (priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_2G) - && (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) - && (priv->available_chnl_num >= 8) ) - { - u4Byte groupScore[14]; - - memset(groupScore, 0xff , sizeof(groupScore)); - for (i=0; iavailable_chnl_num-4; i++) { - if (score[i] != 0xffffffff && score[i+4] != 0xffffffff) { - groupScore[i] = score[i] + score[i+4]; - DEBUG_INFO("groupScore, ch %d,%d: %d\n", i+1, i+5, groupScore[i]); - if (groupScore[i] < minScore) { -#ifdef AUTOCH_SS_SPEEDUP - if(priv->pmib->miscEntry.autoch_1611_enable) - { - if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) - { - minScore = groupScore[i]; - idx = i; - } - } - else -#endif - { - minScore = groupScore[i]; - idx = i; - } - } - } - } - - if (score[idx] < score[idx+4]) { - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; - } else { - idx = idx + 4; - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; - } - } - else - { - for (i=0; iavailable_chnl_num; i++) { - if (score[i] < minScore) { -#ifdef AUTOCH_SS_SPEEDUP - if(priv->pmib->miscEntry.autoch_1611_enable) - { - if(priv->available_chnl[i]==1 || priv->available_chnl[i]==6 || priv->available_chnl[i]==11) - { - minScore = score[i]; - idx = i; - } - } - else -#endif - { - minScore = score[i]; - idx = i; - } - } - } - } - - if (IS_A_CUT_8881A(priv) && - (priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80)) { - if ((priv->available_chnl[idx] == 36) || - (priv->available_chnl[idx] == 52) || - (priv->available_chnl[idx] == 100) || - (priv->available_chnl[idx] == 116) || - (priv->available_chnl[idx] == 132) || - (priv->available_chnl[idx] == 149) || - (priv->available_chnl[idx] == 165)) - idx++; - else if ((priv->available_chnl[idx] == 48) || - (priv->available_chnl[idx] == 64) || - (priv->available_chnl[idx] == 112) || - (priv->available_chnl[idx] == 128) || - (priv->available_chnl[idx] == 144) || - (priv->available_chnl[idx] == 161) || - (priv->available_chnl[idx] == 177)) - idx--; - } - - minChan = priv->available_chnl[idx]; - - // skip channel 14 if don't support ofdm - if ((priv->pmib->dot11RFEntry.disable_ch14_ofdm) && - (minChan == 14)) { - score[idx] = 0xffffffff; - - minScore = 0xffffffff; - for (i=0; iavailable_chnl_num; i++) { - if (score[i] < minScore) { - minScore = score[i]; - idx = i; - } - } - minChan = priv->available_chnl[idx]; - } - -#if 0 - //Check if selected channel available for 80M/40M BW or NOT ? - if(priv->pmib->dot11RFEntry.phyBandSelect == PHY_BAND_5G) - { - if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_80) - { - if(!is80MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) - { - //printk("BW=80M, selected channel = %d is unavaliable! reduce to 40M\n", minChan); - //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20_40; - priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20_40; - } - } - - if(priv->pmib->dot11nConfigEntry.dot11nUse40M == HT_CHANNEL_WIDTH_20_40) - { - if(!is40MChannel(priv->available_chnl,priv->available_chnl_num,minChan)) - { - //printk("BW=40M, selected channel = %d is unavaliable! reduce to 20M\n", minChan); - //priv->pmib->dot11nConfigEntry.dot11nUse40M = HT_CHANNEL_WIDTH_20; - priv->pshare->is_40m_bw = HT_CHANNEL_WIDTH_20; - } - } - } -#endif - -#ifdef CONFIG_RTL_NEW_AUTOCH - RTL_W32(RXERR_RPT, RXERR_RPT_RST); -#endif - -// auto adjust contro-sideband - if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) - && (priv->pshare->is_40m_bw ==1 || priv->pshare->is_40m_bw ==2)) { - -#ifdef RTK_5G_SUPPORT - if (priv->pmib->dot11RFEntry.phyBandSelect & PHY_BAND_5G) { - if( (minChan>144) ? ((minChan-1)%8) : (minChan%8)) { - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; - } else { - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; - } - - } else -#endif - { -#if 0 -#ifdef CONFIG_RTL_NEW_AUTOCH - unsigned int ch_max; - - if (priv->available_chnl[idx_2G_end] >= 13) - ch_max = 13; - else - ch_max = priv->available_chnl[idx_2G_end]; - - if ((minChan >= 5) && (minChan <= (ch_max-5))) { - if (score[minChan+4] > score[minChan-4]) { // what if some channels were cancelled? - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; - } else { - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; - } - } else -#endif - { - if (minChan < 5) { - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; - } - else if (minChan > 7) { - GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; - priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; - } - } -#endif - } - } -//----------------------- - -#if defined(__ECOS) && defined(CONFIG_SDIO_HCI) - panic_printk("Auto channel choose ch:%d\n", minChan); -#else -#ifdef _DEBUG_RTL8192CD_ - panic_printk("Auto channel choose ch:%d\n", minChan); -#endif -#endif -#ifdef ACS_DEBUG_INFO//for debug - printk("7. minChan:%d 2nd_offset:%d\n", minChan, priv->pshare->offset_2nd_chan); -#endif - - return minChan; -} -*/ - -#endif - - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + + +u8 +odm_get_auto_channel_select_result( + void *p_dm_void, + u8 band +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ACS_ *p_acs = &p_dm->dm_acs; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("%s ======>\n", __func__)); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (band == ODM_BAND_2_4G) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("clean_CH_2g=%d\n", p_acs->clean_channel_2g)); + return (u8)p_acs->clean_channel_2g; + } else { + PHYDM_DBG(p_dm, ODM_COMP_API, ("clean_CH_5g=%d\n", p_acs->clean_channel_5g)); + return (u8)p_acs->clean_channel_5g; + } +#else + return (u8)p_acs->clean_channel_2g; +#endif + +} + +void +odm_auto_channel_select_init( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ACS_ *p_acs = &p_dm->dm_acs; + u8 i; + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + if (p_acs->is_force_acs_result) + return; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("%s ======>\n", __func__)); + + p_acs->clean_channel_2g = 1; + p_acs->clean_channel_5g = 36; + + for (i = 0; i < ODM_MAX_CHANNEL_2G; ++i) { + p_acs->channel_info_2g[0][i] = 0; + p_acs->channel_info_2g[1][i] = 0; + } + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + for (i = 0; i < ODM_MAX_CHANNEL_5G; ++i) { + p_acs->channel_info_5g[0][i] = 0; + p_acs->channel_info_5g[1][i] = 0; + } + } +#endif +} + +void +odm_auto_channel_select_reset( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ACS_ *p_acs = &p_dm->dm_acs; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + if (p_acs->is_force_acs_result) + return; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("%s ======>\n", __func__)); + + ccx_info->nhm_period = 0x1388; /*20ms*/ + phydm_nhm_setting(p_dm, SET_NHM_SETTING); + phydm_nhm_trigger(p_dm); +#endif +} + +void +odm_auto_channel_select( + void *p_dm_void, + u8 channel +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ACS_ *p_acs = &p_dm->dm_acs; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u8 channel_idx = 0, search_idx = 0; + u8 noisy_nhm_th = 0x52; + u8 i, noisy_nhm_th_index, low_pwr_cnt = 0; + u16 max_score = 0; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("%s ======>\n", __func__)); + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) { + PHYDM_DBG(p_dm, DBG_DIG, ("Return: Not support\n")); + return; + } + + if (p_acs->is_force_acs_result) { + PHYDM_DBG(p_dm, DBG_DIG, ("Force clean CH{2G,5G}={%d,%d}\n", + p_acs->clean_channel_2g, p_acs->clean_channel_5g)); + return; + } + + PHYDM_DBG(p_dm, ODM_COMP_API, ("CH=%d\n", channel)); + + phydm_get_nhm_result(p_dm); + noisy_nhm_th_index = (noisy_nhm_th - ccx_info->nhm_th[0]) << 2; + + for (i = 0; i <= 11; i++) { + if (i <= noisy_nhm_th_index) + low_pwr_cnt += ccx_info->nhm_result[i]; + } + + ccx_info->nhm_period = 0x2710; + phydm_nhm_setting(p_dm, SET_NHM_SETTING); + + if (channel >= 1 && channel <= 14) { + channel_idx = channel - 1; + p_acs->channel_info_2g[1][channel_idx]++; + + if (p_acs->channel_info_2g[1][channel_idx] >= 2) + p_acs->channel_info_2g[0][channel_idx] = (p_acs->channel_info_2g[0][channel_idx] >> 1) + + (p_acs->channel_info_2g[0][channel_idx] >> 2) + (low_pwr_cnt >> 2); + else + p_acs->channel_info_2g[0][channel_idx] = low_pwr_cnt; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("low_pwr_cnt = %d\n", low_pwr_cnt)); + PHYDM_DBG(p_dm, ODM_COMP_API, ("CH_Info[0][%d]=%d, CH_Info[1][%d]=%d\n", channel_idx, p_acs->channel_info_2g[0][channel_idx], channel_idx, p_acs->channel_info_2g[1][channel_idx])); + + for (search_idx = 0; search_idx < ODM_MAX_CHANNEL_2G; search_idx++) { + if (p_acs->channel_info_2g[1][search_idx] != 0 && p_acs->channel_info_2g[0][search_idx] >= max_score) { + max_score = p_acs->channel_info_2g[0][search_idx]; + p_acs->clean_channel_2g = search_idx + 1; + } + } + PHYDM_DBG(p_dm, ODM_COMP_API, ("clean_CH_2g=%d, max_score=%d\n", + p_acs->clean_channel_2g, max_score)); + + } else if (channel >= 36) { + /* Need to do */ + p_acs->clean_channel_5g = channel; + } +#endif +} + +boolean +phydm_acs_check( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct rtl8192cd_priv *priv = p_dm->priv; + + if ((priv->auto_channel != 0) && (priv->auto_channel != 2)) /* if struct _ACS_ running, do not do FA/CCA counter read */ + return true; + else + return false; +#else + return false; +#endif +} + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + +void +phydm_auto_channel_select_setting_ap( + void *p_dm_void, + u32 setting, /* 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING */ + u32 acs_step +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct rtl8192cd_priv *priv = p_dm->priv; + struct _ACS_ *p_acs = &p_dm->dm_acs; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("%s ======>\n", __func__)); + + /* 3 Store Default setting */ + if (setting == STORE_DEFAULT_NHM_SETTING) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("STORE_DEFAULT_NHM_SETTING\n")); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { /* store reg0x990, reg0x994, reg0x998, reg0x99c, Reg0x9a0 */ + p_acs->reg0x990 = odm_read_4byte(p_dm, ODM_REG_CCX_PERIOD_11AC); /* reg0x990 */ + p_acs->reg0x994 = odm_read_4byte(p_dm, ODM_REG_NHM_TH9_TH10_11AC); /* reg0x994 */ + p_acs->reg0x998 = odm_read_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC); /* reg0x998 */ + p_acs->reg0x99c = odm_read_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC); /* Reg0x99c */ + p_acs->reg0x9a0 = odm_read_1byte(p_dm, ODM_REG_NHM_TH8_11AC); /* Reg0x9a0, u8 */ + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + p_acs->reg0x890 = odm_read_4byte(p_dm, ODM_REG_NHM_TH9_TH10_11N); /* reg0x890 */ + p_acs->reg0x894 = odm_read_4byte(p_dm, ODM_REG_CCX_PERIOD_11N); /* reg0x894 */ + p_acs->reg0x898 = odm_read_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N); /* reg0x898 */ + p_acs->reg0x89c = odm_read_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N); /* Reg0x89c */ + p_acs->reg0xe28 = odm_read_1byte(p_dm, ODM_REG_NHM_TH8_11N); /* Reg0xe28, u8 */ + } + } + + /* 3 Restore Default setting */ + else if (setting == RESTORE_DEFAULT_NHM_SETTING) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("RESTORE_DEFAULT_NHM_SETTING\n")); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { /* store reg0x990, reg0x994, reg0x998, reg0x99c, Reg0x9a0 */ + odm_write_4byte(p_dm, ODM_REG_CCX_PERIOD_11AC, p_acs->reg0x990); + odm_write_4byte(p_dm, ODM_REG_NHM_TH9_TH10_11AC, p_acs->reg0x994); + odm_write_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, p_acs->reg0x998); + odm_write_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, p_acs->reg0x99c); + odm_write_1byte(p_dm, ODM_REG_NHM_TH8_11AC, p_acs->reg0x9a0); + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_write_4byte(p_dm, ODM_REG_NHM_TH9_TH10_11N, p_acs->reg0x890); + odm_write_4byte(p_dm, ODM_REG_CCX_PERIOD_11AC, p_acs->reg0x894); + odm_write_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, p_acs->reg0x898); + odm_write_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, p_acs->reg0x89c); + odm_write_1byte(p_dm, ODM_REG_NHM_TH8_11N, p_acs->reg0xe28); + } + } + + /* 3 struct _ACS_ setting */ + else if (setting == ACS_NHM_SETTING) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("ACS_NHM_SETTING\n")); + u16 period; + period = 0x61a8; + p_acs->acs_step = acs_step; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + /* 4 Set NHM period, 0x990[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms */ + odm_write_2byte(p_dm, ODM_REG_CCX_PERIOD_11AC + 2, period); + /* 4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 */ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(8) | BIT(9) | BIT(10), 3); + + if (p_acs->acs_step == 0) { + /* 4 Set IGI */ + odm_set_bb_reg(p_dm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x3E); + if (get_rf_mimo_mode(priv) != RF_1T1R) + odm_set_bb_reg(p_dm, 0xe50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x3E); + + /* 4 Set struct _ACS_ NHM threshold */ + odm_write_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x82786e64); + odm_write_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff8c); + odm_write_1byte(p_dm, ODM_REG_NHM_TH8_11AC, 0xff); + odm_write_2byte(p_dm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); + + } else if (p_acs->acs_step == 1) { + /* 4 Set IGI */ + odm_set_bb_reg(p_dm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x2A); + if (get_rf_mimo_mode(priv) != RF_1T1R) + odm_set_bb_reg(p_dm, 0xe50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x2A); + + /* 4 Set struct _ACS_ NHM threshold */ + odm_write_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0x5a50463c); + odm_write_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffff64); + + } + + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + /* 4 Set NHM period, 0x894[31:16]=0x61a8, Time duration for NHM unit: 4us, 0x61a8=100ms */ + odm_write_2byte(p_dm, ODM_REG_CCX_PERIOD_11AC + 2, period); + /* 4 Set NHM ignore_cca=1, ignore_txon=1, ccx_en=0 */ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(8) | BIT(9) | BIT(10), 3); + + if (p_acs->acs_step == 0) { + /* 4 Set IGI */ + odm_set_bb_reg(p_dm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x3E); + if (get_rf_mimo_mode(priv) != RF_1T1R) + odm_set_bb_reg(p_dm, 0xc58, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x3E); + + /* 4 Set struct _ACS_ NHM threshold */ + odm_write_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x82786e64); + odm_write_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff8c); + odm_write_1byte(p_dm, ODM_REG_NHM_TH8_11N, 0xff); + odm_write_2byte(p_dm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); + + } else if (p_acs->acs_step == 1) { + /* 4 Set IGI */ + odm_set_bb_reg(p_dm, 0xc50, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x2A); + if (get_rf_mimo_mode(priv) != RF_1T1R) + odm_set_bb_reg(p_dm, 0xc58, BIT(0) | BIT(1) | BIT(2) | BIT(3) | BIT(4) | BIT(5) | BIT(6), 0x2A); + + /* 4 Set struct _ACS_ NHM threshold */ + odm_write_4byte(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, 0x5a50463c); + odm_write_4byte(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffff64); + + } + } + } + +} + +void +phydm_get_nhm_statistics_ap( + void *p_dm_void, + u32 idx, /* @ 2G, Real channel number = idx+1 */ + u32 acs_step +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct rtl8192cd_priv *priv = p_dm->priv; + struct _ACS_ *p_acs = &p_dm->dm_acs; + u32 value32 = 0; + u8 i; + + p_acs->acs_step = acs_step; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + /* 4 Check if NHM result is ready */ + for (i = 0; i < 20; i++) { + + ODM_delay_ms(1); + if (odm_get_bb_reg(p_dm, REG_FPGA0_PSD_REPORT, BIT(17))) + break; + } + + /* 4 Get NHM Statistics */ + if (p_acs->acs_step == 1) { + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT7_TO_CNT4_11N); + + p_acs->nhm_cnt[idx][9] = (value32 & MASKBYTE1) >> 8; + p_acs->nhm_cnt[idx][8] = (value32 & MASKBYTE0); + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT_11N); /* ODM_REG_NHM_CNT3_TO_CNT0_11N */ + + p_acs->nhm_cnt[idx][7] = (value32 & MASKBYTE3) >> 24; + p_acs->nhm_cnt[idx][6] = (value32 & MASKBYTE2) >> 16; + p_acs->nhm_cnt[idx][5] = (value32 & MASKBYTE1) >> 8; + + } else if (p_acs->acs_step == 2) { + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT_11N); /* ODM_REG_NHM_CNT3_TO_CNT0_11N */ + + p_acs->nhm_cnt[idx][4] = odm_read_1byte(p_dm, ODM_REG_NHM_CNT7_TO_CNT4_11N); + p_acs->nhm_cnt[idx][3] = (value32 & MASKBYTE3) >> 24; + p_acs->nhm_cnt[idx][2] = (value32 & MASKBYTE2) >> 16; + p_acs->nhm_cnt[idx][1] = (value32 & MASKBYTE1) >> 8; + p_acs->nhm_cnt[idx][0] = (value32 & MASKBYTE0); + } + } else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + /* 4 Check if NHM result is ready */ + for (i = 0; i < 20; i++) { + + ODM_delay_ms(1); + if (odm_get_bb_reg(p_dm, ODM_REG_NHM_DUR_READY_11AC, BIT(16))) + break; + } + + if (p_acs->acs_step == 1) { + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); + + p_acs->nhm_cnt[idx][9] = (value32 & MASKBYTE1) >> 8; + p_acs->nhm_cnt[idx][8] = (value32 & MASKBYTE0); + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT_11AC); /* ODM_REG_NHM_CNT3_TO_CNT0_11AC */ + + p_acs->nhm_cnt[idx][7] = (value32 & MASKBYTE3) >> 24; + p_acs->nhm_cnt[idx][6] = (value32 & MASKBYTE2) >> 16; + p_acs->nhm_cnt[idx][5] = (value32 & MASKBYTE1) >> 8; + + } else if (p_acs->acs_step == 2) { + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT_11AC); /* ODM_REG_NHM_CNT3_TO_CNT0_11AC */ + + p_acs->nhm_cnt[idx][4] = odm_read_1byte(p_dm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); + p_acs->nhm_cnt[idx][3] = (value32 & MASKBYTE3) >> 24; + p_acs->nhm_cnt[idx][2] = (value32 & MASKBYTE2) >> 16; + p_acs->nhm_cnt[idx][1] = (value32 & MASKBYTE1) >> 8; + p_acs->nhm_cnt[idx][0] = (value32 & MASKBYTE0); + } + } + +} + + +/* #define ACS_DEBUG_INFO */ /* acs debug default off */ +#if 0 +int phydm_AutoChannelSelectAP( + void *p_dm_void, + u32 ACS_Type, /* 0: RXCount_Type, 1:NHM_Type */ + u32 available_chnl_num /* amount of all channels */ +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ACS_ *p_acs = &p_dm->dm_acs; + struct rtl8192cd_priv *priv = p_dm->priv; + + static u32 score2G[MAX_2G_CHANNEL_NUM], score5G[MAX_5G_CHANNEL_NUM]; + u32 score[MAX_BSS_NUM], use_nhm = 0; + u32 minScore = 0xffffffff; + u32 tmpScore, tmpIdx = 0; + u32 traffic_check = 0; + u32 fa_count_weighting = 1; + int i, j, idx = 0, idx_2G_end = -1, idx_5G_begin = -1, minChan = 0; + struct bss_desc *pBss = NULL; + +#ifdef _DEBUG_RTL8192CD_ + char tmpbuf[400]; + int len = 0; +#endif + + memset(score2G, '\0', sizeof(score2G)); + memset(score5G, '\0', sizeof(score5G)); + + for (i = 0; i < priv->available_chnl_num; i++) { + if (priv->available_chnl[i] <= 14) + idx_2G_end = i; + else + break; + } + + for (i = 0; i < priv->available_chnl_num; i++) { + if (priv->available_chnl[i] > 14) { + idx_5G_begin = i; + break; + } + } + + /* DELETE */ +#ifndef CONFIG_RTL_NEW_AUTOCH + for (i = 0; i < priv->site_survey->count; i++) { + pBss = &priv->site_survey->bss[i]; + for (idx = 0; idx < priv->available_chnl_num; idx++) { + if (pBss->channel == priv->available_chnl[idx]) { + if (pBss->channel <= 14) + setChannelScore(idx, score2G, 0, MAX_2G_CHANNEL_NUM - 1); + else + score5G[idx - idx_5G_begin] += 5; + break; + } + } + } +#endif + + if (idx_2G_end >= 0) + for (i = 0; i <= idx_2G_end; i++) + score[i] = score2G[i]; + if (idx_5G_begin >= 0) + for (i = idx_5G_begin; i < priv->available_chnl_num; i++) + score[i] = score5G[i - idx_5G_begin]; + +#ifdef CONFIG_RTL_NEW_AUTOCH + { + u32 y, ch_begin = 0, ch_end = priv->available_chnl_num; + + u32 do_ap_check = 1, ap_ratio = 0; + + if (idx_2G_end >= 0) + ch_end = idx_2G_end + 1; + if (idx_5G_begin >= 0) + ch_begin = idx_5G_begin; + +#ifdef ACS_DEBUG_INFO/* for debug */ + printk("\n"); + for (y = ch_begin; y < ch_end; y++) + printk("1. init: chnl[%d] 20M_rx[%d] 40M_rx[%d] fa_cnt[%d] score[%d]\n", + priv->available_chnl[y], + priv->chnl_ss_mac_rx_count[y], + priv->chnl_ss_mac_rx_count_40M[y], + priv->chnl_ss_fa_count[y], + score[y]); + printk("\n"); +#endif + +#if defined(CONFIG_RTL_88E_SUPPORT) || defined(CONFIG_WLAN_HAL_8192EE) + if (p_dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8192E) && priv->pmib->dot11RFEntry.acs_type) { + u32 tmp_score[MAX_BSS_NUM]; + memcpy(tmp_score, score, sizeof(score)); + if (find_clean_channel(priv, ch_begin, ch_end, tmp_score)) { + /* memcpy(score, tmp_score, sizeof(score)); */ +#ifdef _DEBUG_RTL8192CD_ + printk("!! Found clean channel, select minimum FA channel\n"); +#endif + goto USE_CLN_CH; + } +#ifdef _DEBUG_RTL8192CD_ + printk("!! Not found clean channel, use NHM algorithm\n"); +#endif + use_nhm = 1; +USE_CLN_CH: + for (y = ch_begin; y < ch_end; y++) { + for (i = 0; i <= 9; i++) { + u32 val32 = priv->nhm_cnt[y][i]; + for (j = 0; j < i; j++) + val32 *= 3; + score[y] += val32; + } + +#ifdef _DEBUG_RTL8192CD_ + printk("nhm_cnt_%d: H<-[ %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d]->L, score: %d\n", + y + 1, priv->nhm_cnt[y][9], priv->nhm_cnt[y][8], priv->nhm_cnt[y][7], + priv->nhm_cnt[y][6], priv->nhm_cnt[y][5], priv->nhm_cnt[y][4], + priv->nhm_cnt[y][3], priv->nhm_cnt[y][2], priv->nhm_cnt[y][1], + priv->nhm_cnt[y][0], score[y]); +#endif + } + + if (!use_nhm) + memcpy(score, tmp_score, sizeof(score)); + + goto choose_ch; + } +#endif + + /* For each channel, weighting behind channels with MAC RX counter */ + /* For each channel, weighting the channel with FA counter */ + + for (y = ch_begin; y < ch_end; y++) { + score[y] += 8 * priv->chnl_ss_mac_rx_count[y]; + if (priv->chnl_ss_mac_rx_count[y] > 30) + do_ap_check = 0; + if (priv->chnl_ss_mac_rx_count[y] > MAC_RX_COUNT_THRESHOLD) + traffic_check = 1; + +#ifdef RTK_5G_SUPPORT + if (*p_dm->p_band_type == ODM_BAND_2_4G) +#endif + { + if ((int)(y - 4) >= (int)ch_begin) + score[y - 4] += 2 * priv->chnl_ss_mac_rx_count[y]; + if ((int)(y - 3) >= (int)ch_begin) + score[y - 3] += 8 * priv->chnl_ss_mac_rx_count[y]; + if ((int)(y - 2) >= (int)ch_begin) + score[y - 2] += 8 * priv->chnl_ss_mac_rx_count[y]; + if ((int)(y - 1) >= (int)ch_begin) + score[y - 1] += 10 * priv->chnl_ss_mac_rx_count[y]; + if ((int)(y + 1) < (int)ch_end) + score[y + 1] += 10 * priv->chnl_ss_mac_rx_count[y]; + if ((int)(y + 2) < (int)ch_end) + score[y + 2] += 8 * priv->chnl_ss_mac_rx_count[y]; + if ((int)(y + 3) < (int)ch_end) + score[y + 3] += 8 * priv->chnl_ss_mac_rx_count[y]; + if ((int)(y + 4) < (int)ch_end) + score[y + 4] += 2 * priv->chnl_ss_mac_rx_count[y]; + } + + /* this is for CH_LOAD caculation */ + if (priv->chnl_ss_cca_count[y] > priv->chnl_ss_fa_count[y]) + priv->chnl_ss_cca_count[y] -= priv->chnl_ss_fa_count[y]; + else + priv->chnl_ss_cca_count[y] = 0; + } + +#ifdef ACS_DEBUG_INFO/* for debug */ + printk("\n"); + for (y = ch_begin; y < ch_end; y++) + printk("2. after 20M check: chnl[%d] score[%d]\n", priv->available_chnl[y], score[y]); + printk("\n"); +#endif + + for (y = ch_begin; y < ch_end; y++) { + if (priv->chnl_ss_mac_rx_count_40M[y]) { + score[y] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; + if (priv->chnl_ss_mac_rx_count_40M[y] > 30) + do_ap_check = 0; + if (priv->chnl_ss_mac_rx_count_40M[y] > MAC_RX_COUNT_THRESHOLD) + traffic_check = 1; + +#ifdef RTK_5G_SUPPORT + if (*p_dm->p_band_type == ODM_BAND_2_4G) +#endif + { + if ((int)(y - 6) >= (int)ch_begin) + score[y - 6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y - 5) >= (int)ch_begin) + score[y - 5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y - 4) >= (int)ch_begin) + score[y - 4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y - 3) >= (int)ch_begin) + score[y - 3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y - 2) >= (int)ch_begin) + score[y - 2] += (5 * priv->chnl_ss_mac_rx_count_40M[y]) / 2; + if ((int)(y - 1) >= (int)ch_begin) + score[y - 1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y + 1) < (int)ch_end) + score[y + 1] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y + 2) < (int)ch_end) + score[y + 2] += (5 * priv->chnl_ss_mac_rx_count_40M[y]) / 2; + if ((int)(y + 3) < (int)ch_end) + score[y + 3] += 5 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y + 4) < (int)ch_end) + score[y + 4] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y + 5) < (int)ch_end) + score[y + 5] += 4 * priv->chnl_ss_mac_rx_count_40M[y]; + if ((int)(y + 6) < (int)ch_end) + score[y + 6] += 1 * priv->chnl_ss_mac_rx_count_40M[y]; + } + } + } + +#ifdef ACS_DEBUG_INFO/* for debug */ + printk("\n"); + for (y = ch_begin; y < ch_end; y++) + printk("3. after 40M check: chnl[%d] score[%d]\n", priv->available_chnl[y], score[y]); + printk("\n"); + printk("4. do_ap_check=%d traffic_check=%d\n", do_ap_check, traffic_check); + printk("\n"); +#endif + + if (traffic_check == 0) + fa_count_weighting = 5; + else + fa_count_weighting = 1; + + for (y = ch_begin; y < ch_end; y++) + score[y] += fa_count_weighting * priv->chnl_ss_fa_count[y]; + +#ifdef ACS_DEBUG_INFO/* for debug */ + printk("\n"); + for (y = ch_begin; y < ch_end; y++) + printk("5. after fa check: chnl[%d] score[%d]\n", priv->available_chnl[y], score[y]); + printk("\n"); +#endif + + if (do_ap_check) { + for (i = 0; i < priv->site_survey->count; i++) { + pBss = &priv->site_survey->bss[i]; + for (y = ch_begin; y < ch_end; y++) { + if (pBss->channel == priv->available_chnl[y]) { + if (pBss->channel <= 14) { +#ifdef ACS_DEBUG_INFO/* for debug */ + printk("\n"); + printk("chnl[%d] has ap rssi=%d bw[0x%02x]\n", + pBss->channel, pBss->rssi, pBss->t_stamp[1]); + printk("\n"); +#endif + if (pBss->rssi > 60) + ap_ratio = 4; + else if (pBss->rssi > 35) + ap_ratio = 2; + else + ap_ratio = 1; + + if ((pBss->t_stamp[1] & 0x6) == 0) { + score[y] += 50 * ap_ratio; + if ((int)(y - 4) >= (int)ch_begin) + score[y - 4] += 10 * ap_ratio; + if ((int)(y - 3) >= (int)ch_begin) + score[y - 3] += 20 * ap_ratio; + if ((int)(y - 2) >= (int)ch_begin) + score[y - 2] += 30 * ap_ratio; + if ((int)(y - 1) >= (int)ch_begin) + score[y - 1] += 40 * ap_ratio; + if ((int)(y + 1) < (int)ch_end) + score[y + 1] += 40 * ap_ratio; + if ((int)(y + 2) < (int)ch_end) + score[y + 2] += 30 * ap_ratio; + if ((int)(y + 3) < (int)ch_end) + score[y + 3] += 20 * ap_ratio; + if ((int)(y + 4) < (int)ch_end) + score[y + 4] += 10 * ap_ratio; + } else if ((pBss->t_stamp[1] & 0x4) == 0) { + score[y] += 50 * ap_ratio; + if ((int)(y - 3) >= (int)ch_begin) + score[y - 3] += 20 * ap_ratio; + if ((int)(y - 2) >= (int)ch_begin) + score[y - 2] += 30 * ap_ratio; + if ((int)(y - 1) >= (int)ch_begin) + score[y - 1] += 40 * ap_ratio; + if ((int)(y + 1) < (int)ch_end) + score[y + 1] += 50 * ap_ratio; + if ((int)(y + 2) < (int)ch_end) + score[y + 2] += 50 * ap_ratio; + if ((int)(y + 3) < (int)ch_end) + score[y + 3] += 50 * ap_ratio; + if ((int)(y + 4) < (int)ch_end) + score[y + 4] += 50 * ap_ratio; + if ((int)(y + 5) < (int)ch_end) + score[y + 5] += 40 * ap_ratio; + if ((int)(y + 6) < (int)ch_end) + score[y + 6] += 30 * ap_ratio; + if ((int)(y + 7) < (int)ch_end) + score[y + 7] += 20 * ap_ratio; + } else { + score[y] += 50 * ap_ratio; + if ((int)(y - 7) >= (int)ch_begin) + score[y - 7] += 20 * ap_ratio; + if ((int)(y - 6) >= (int)ch_begin) + score[y - 6] += 30 * ap_ratio; + if ((int)(y - 5) >= (int)ch_begin) + score[y - 5] += 40 * ap_ratio; + if ((int)(y - 4) >= (int)ch_begin) + score[y - 4] += 50 * ap_ratio; + if ((int)(y - 3) >= (int)ch_begin) + score[y - 3] += 50 * ap_ratio; + if ((int)(y - 2) >= (int)ch_begin) + score[y - 2] += 50 * ap_ratio; + if ((int)(y - 1) >= (int)ch_begin) + score[y - 1] += 50 * ap_ratio; + if ((int)(y + 1) < (int)ch_end) + score[y + 1] += 40 * ap_ratio; + if ((int)(y + 2) < (int)ch_end) + score[y + 2] += 30 * ap_ratio; + if ((int)(y + 3) < (int)ch_end) + score[y + 3] += 20 * ap_ratio; + } + } else { + if ((pBss->t_stamp[1] & 0x6) == 0) + score[y] += 500; + else if ((pBss->t_stamp[1] & 0x4) == 0) { + score[y] += 500; + if ((int)(y + 1) < (int)ch_end) + score[y + 1] += 500; + } else { + score[y] += 500; + if ((int)(y - 1) >= (int)ch_begin) + score[y - 1] += 500; + } + } + break; + } + } + } + } + +#ifdef ACS_DEBUG_INFO/* for debug */ + printk("\n"); + for (y = ch_begin; y < ch_end; y++) + printk("6. after ap check: chnl[%d]:%d\n", priv->available_chnl[y], score[y]); + printk("\n"); +#endif + +#ifdef SS_CH_LOAD_PROC + + /* caculate noise level -- suggested by wilson */ + for (y = ch_begin; y < ch_end; y++) { + int fa_lv = 0, cca_lv = 0; + if (priv->chnl_ss_fa_count[y] > 1000) + fa_lv = 100; + else if (priv->chnl_ss_fa_count[y] > 500) + fa_lv = 34 * (priv->chnl_ss_fa_count[y] - 500) / 500 + 66; + else if (priv->chnl_ss_fa_count[y] > 200) + fa_lv = 33 * (priv->chnl_ss_fa_count[y] - 200) / 300 + 33; + else if (priv->chnl_ss_fa_count[y] > 100) + fa_lv = 18 * (priv->chnl_ss_fa_count[y] - 100) / 100 + 15; + else + fa_lv = 15 * priv->chnl_ss_fa_count[y] / 100; + if (priv->chnl_ss_cca_count[y] > 400) + cca_lv = 100; + else if (priv->chnl_ss_cca_count[y] > 200) + cca_lv = 34 * (priv->chnl_ss_cca_count[y] - 200) / 200 + 66; + else if (priv->chnl_ss_cca_count[y] > 80) + cca_lv = 33 * (priv->chnl_ss_cca_count[y] - 80) / 120 + 33; + else if (priv->chnl_ss_cca_count[y] > 40) + cca_lv = 18 * (priv->chnl_ss_cca_count[y] - 40) / 40 + 15; + else + cca_lv = 15 * priv->chnl_ss_cca_count[y] / 40; + + priv->chnl_ss_load[y] = (((fa_lv > cca_lv) ? fa_lv : cca_lv) * 75 + ((score[y] > 100) ? 100 : score[y]) * 25) / 100; + + DEBUG_INFO("ch:%d f=%d (%d), c=%d (%d), fl=%d, cl=%d, sc=%d, cu=%d\n", + priv->available_chnl[y], + priv->chnl_ss_fa_count[y], fa_thd, + priv->chnl_ss_cca_count[y], cca_thd, + fa_lv, + cca_lv, + score[y], + priv->chnl_ss_load[y]); + + } +#endif + } +#endif + +choose_ch: + +#ifdef DFS + /* heavy weighted DFS channel */ + if (idx_5G_begin >= 0) { + for (i = idx_5G_begin; i < priv->available_chnl_num; i++) { + if (!priv->pmib->dot11DFSEntry.disable_DFS && is_DFS_channel(priv->available_chnl[i]) + && (score[i] != 0xffffffff)) + score[i] += 1600; + } + } +#endif + + + /* prevent Auto channel selecting wrong channel in 40M mode----------------- */ + if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) + && priv->pshare->is_40m_bw) { +#if 0 + if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 1) { + /* Upper Primary channel, cannot select the two lowest channels */ + if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { + score[0] = 0xffffffff; + score[1] = 0xffffffff; + score[2] = 0xffffffff; + score[3] = 0xffffffff; + score[4] = 0xffffffff; + + score[13] = 0xffffffff; + score[12] = 0xffffffff; + score[11] = 0xffffffff; + } + + /* if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { */ + /* score[idx_5G_begin] = 0xffffffff; */ + /* score[idx_5G_begin + 1] = 0xffffffff; */ + /* } */ + } else if (GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset == 2) { + /* Lower Primary channel, cannot select the two highest channels */ + if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11G) { + score[0] = 0xffffffff; + score[1] = 0xffffffff; + score[2] = 0xffffffff; + + score[13] = 0xffffffff; + score[12] = 0xffffffff; + score[11] = 0xffffffff; + score[10] = 0xffffffff; + score[9] = 0xffffffff; + } + + /* if (priv->pmib->dot11BssType.net_work_type & WIRELESS_11A) { */ + /* score[priv->available_chnl_num - 2] = 0xffffffff; */ + /* score[priv->available_chnl_num - 1] = 0xffffffff; */ + /* } */ + } +#endif + for (i = 0; i <= idx_2G_end; ++i) + if (priv->available_chnl[i] == 14) + score[i] = 0xffffffff; /* mask chan14 */ + +#ifdef RTK_5G_SUPPORT + if (idx_5G_begin >= 0) { + for (i = idx_5G_begin; i < priv->available_chnl_num; i++) { + int ch = priv->available_chnl[i]; + if (priv->available_chnl[i] > 144) + --ch; + if ((ch % 4) || ch == 140 || ch == 164) /* mask ch 140, ch 165, ch 184... */ + score[i] = 0xffffffff; + } + } +#endif + + + } + + if (priv->pmib->dot11RFEntry.disable_ch1213) { + for (i = 0; i <= idx_2G_end; ++i) { + int ch = priv->available_chnl[i]; + if ((ch == 12) || (ch == 13)) + score[i] = 0xffffffff; + } + } + + if (((priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_GLOBAL) || + (priv->pmib->dot11StationConfigEntry.dot11RegDomain == DOMAIN_WORLD_WIDE)) && + (idx_2G_end >= 11) && (idx_2G_end < 14)) { + score[13] = 0xffffffff; /* mask chan14 */ + score[12] = 0xffffffff; /* mask chan13 */ + score[11] = 0xffffffff; /* mask chan12 */ + } + + /* ------------------------------------------------------------------ */ + +#ifdef _DEBUG_RTL8192CD_ + for (i = 0; i < priv->available_chnl_num; i++) + len += sprintf(tmpbuf + len, "ch%d:%u ", priv->available_chnl[i], score[i]); + strcat(tmpbuf, "\n"); + panic_printk("%s", tmpbuf); + +#endif + + if ((*p_dm->p_band_type == ODM_BAND_5G) + && (priv->pmib->dot11nConfigEntry.dot11nUse40M == CHANNEL_WIDTH_80)) { + for (i = 0; i < priv->available_chnl_num; i++) { + if (is80MChannel(priv->available_chnl, priv->available_chnl_num, priv->available_chnl[i])) { + tmpScore = 0; + for (j = 0; j < 4; j++) { + if ((tmpScore != 0xffffffff) && (score[i + j] != 0xffffffff)) + tmpScore += score[i + j]; + else + tmpScore = 0xffffffff; + } + tmpScore = tmpScore / 4; + if (minScore > tmpScore) { + minScore = tmpScore; + + tmpScore = 0xffffffff; + for (j = 0; j < 4; j++) { + if (score[i + j] < tmpScore) { + tmpScore = score[i + j]; + tmpIdx = i + j; + } + } + + idx = tmpIdx; + } + i += 3; + } + } + if (minScore == 0xffffffff) { + /* there is no 80M channels */ + priv->pshare->is_40m_bw = CHANNEL_WIDTH_20; + for (i = 0; i < priv->available_chnl_num; i++) { + if (score[i] < minScore) { + minScore = score[i]; + idx = i; + } + } + } + } else if ((*p_dm->p_band_type == ODM_BAND_5G) + && (priv->pmib->dot11nConfigEntry.dot11nUse40M == CHANNEL_WIDTH_40)) { + for (i = 0; i < priv->available_chnl_num; i++) { + if (is40MChannel(priv->available_chnl, priv->available_chnl_num, priv->available_chnl[i])) { + tmpScore = 0; + for (j = 0; j < 2; j++) { + if ((tmpScore != 0xffffffff) && (score[i + j] != 0xffffffff)) + tmpScore += score[i + j]; + else + tmpScore = 0xffffffff; + } + tmpScore = tmpScore / 2; + if (minScore > tmpScore) { + minScore = tmpScore; + + tmpScore = 0xffffffff; + for (j = 0; j < 2; j++) { + if (score[i + j] < tmpScore) { + tmpScore = score[i + j]; + tmpIdx = i + j; + } + } + + idx = tmpIdx; + } + i += 1; + } + } + if (minScore == 0xffffffff) { + /* there is no 40M channels */ + priv->pshare->is_40m_bw = CHANNEL_WIDTH_20; + for (i = 0; i < priv->available_chnl_num; i++) { + if (score[i] < minScore) { + minScore = score[i]; + idx = i; + } + } + } + } else if ((*p_dm->p_band_type == ODM_BAND_2_4G) + && (priv->pmib->dot11nConfigEntry.dot11nUse40M == CHANNEL_WIDTH_40) + && (priv->available_chnl_num >= 8)) { + u32 groupScore[14]; + + memset(groupScore, 0xff, sizeof(groupScore)); + for (i = 0; i < priv->available_chnl_num - 4; i++) { + if (score[i] != 0xffffffff && score[i + 4] != 0xffffffff) { + groupScore[i] = score[i] + score[i + 4]; + DEBUG_INFO("groupScore, ch %d,%d: %d\n", i + 1, i + 5, groupScore[i]); + if (groupScore[i] < minScore) { +#ifdef AUTOCH_SS_SPEEDUP + if (priv->pmib->miscEntry.autoch_1611_enable) { + if (priv->available_chnl[i] == 1 || priv->available_chnl[i] == 6 || priv->available_chnl[i] == 11) { + minScore = groupScore[i]; + idx = i; + } + } else +#endif + { + minScore = groupScore[i]; + idx = i; + } + } + } + } + + if (score[idx] < score[idx + 4]) { + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; + } else { + idx = idx + 4; + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; + } + } else { + for (i = 0; i < priv->available_chnl_num; i++) { + if (score[i] < minScore) { +#ifdef AUTOCH_SS_SPEEDUP + if (priv->pmib->miscEntry.autoch_1611_enable) { + if (priv->available_chnl[i] == 1 || priv->available_chnl[i] == 6 || priv->available_chnl[i] == 11) { + minScore = score[i]; + idx = i; + } + } else +#endif + { + minScore = score[i]; + idx = i; + } + } + } + } + + if (IS_A_CUT_8881A(priv) && + (priv->pmib->dot11nConfigEntry.dot11nUse40M == CHANNEL_WIDTH_80)) { + if ((priv->available_chnl[idx] == 36) || + (priv->available_chnl[idx] == 52) || + (priv->available_chnl[idx] == 100) || + (priv->available_chnl[idx] == 116) || + (priv->available_chnl[idx] == 132) || + (priv->available_chnl[idx] == 149) || + (priv->available_chnl[idx] == 165)) + idx++; + else if ((priv->available_chnl[idx] == 48) || + (priv->available_chnl[idx] == 64) || + (priv->available_chnl[idx] == 112) || + (priv->available_chnl[idx] == 128) || + (priv->available_chnl[idx] == 144) || + (priv->available_chnl[idx] == 161) || + (priv->available_chnl[idx] == 177)) + idx--; + } + + minChan = priv->available_chnl[idx]; + + /* skip channel 14 if don't support ofdm */ + if ((priv->pmib->dot11RFEntry.disable_ch14_ofdm) && + (minChan == 14)) { + score[idx] = 0xffffffff; + + minScore = 0xffffffff; + for (i = 0; i < priv->available_chnl_num; i++) { + if (score[i] < minScore) { + minScore = score[i]; + idx = i; + } + } + minChan = priv->available_chnl[idx]; + } + +#if 0 + /* Check if selected channel available for 80M/40M BW or NOT ? */ + if (*p_dm->p_band_type == ODM_BAND_5G) { + if (priv->pmib->dot11nConfigEntry.dot11nUse40M == CHANNEL_WIDTH_80) { + if (!is80MChannel(priv->available_chnl, priv->available_chnl_num, minChan)) { + + /* priv->pmib->dot11n_config_entry.dot11nUse40M = CHANNEL_WIDTH_40; */ + priv->pshare->is_40m_bw = CHANNEL_WIDTH_40; + } + } + + if (priv->pmib->dot11nConfigEntry.dot11nUse40M == CHANNEL_WIDTH_40) { + if (!is40MChannel(priv->available_chnl, priv->available_chnl_num, minChan)) { + + /* priv->pmib->dot11n_config_entry.dot11nUse40M = CHANNEL_WIDTH_20; */ + priv->pshare->is_40m_bw = CHANNEL_WIDTH_20; + } + } + } +#endif + +#ifdef CONFIG_RTL_NEW_AUTOCH + RTL_W32(RXERR_RPT, RXERR_RPT_RST); +#endif + + /* auto adjust contro-sideband */ + if ((priv->pmib->dot11BssType.net_work_type & WIRELESS_11N) + && (priv->pshare->is_40m_bw == 1 || priv->pshare->is_40m_bw == 2)) { + +#ifdef RTK_5G_SUPPORT + if (*p_dm->p_band_type == ODM_BAND_5G) { + if ((minChan > 144) ? ((minChan - 1) % 8) : (minChan % 8)) { + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; + } else { + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; + } + + } else +#endif + { +#if 0 +#ifdef CONFIG_RTL_NEW_AUTOCH + unsigned int ch_max; + + if (priv->available_chnl[idx_2G_end] >= 13) + ch_max = 13; + else + ch_max = priv->available_chnl[idx_2G_end]; + + if ((minChan >= 5) && (minChan <= (ch_max - 5))) { + if (score[minChan + 4] > score[minChan - 4]) { /* what if some channels were cancelled? */ + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; + } else { + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; + } + } else +#endif + { + if (minChan < 5) { + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_ABOVE; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_ABOVE; + } else if (minChan > 7) { + GET_MIB(priv)->dot11nConfigEntry.dot11n2ndChOffset = HT_2NDCH_OFFSET_BELOW; + priv->pshare->offset_2nd_chan = HT_2NDCH_OFFSET_BELOW; + } + } +#endif + } + } + /* ----------------------- */ + +#if defined(__ECOS) && defined(CONFIG_SDIO_HCI) + panic_printk("Auto channel choose ch:%d\n", minChan); +#else +#ifdef _DEBUG_RTL8192CD_ + panic_printk("Auto channel choose ch:%d\n", minChan); +#endif +#endif +#ifdef ACS_DEBUG_INFO/* for debug */ + printk("7. minChan:%d 2nd_offset:%d\n", minChan, priv->pshare->offset_2nd_chan); +#endif + + return minChan; +} +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.h index 92efdf3cb09c..192a24fc403a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_acs.h @@ -1,106 +1,105 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMACS_H__ -#define __PHYDMACS_H__ - -#define ACS_VERSION "1.1" /*20150729 by YuChen*/ -#define CLM_VERSION "1.0" - -#define ODM_MAX_CHANNEL_2G 14 -#define ODM_MAX_CHANNEL_5G 24 - -// For phydm_AutoChannelSelectSettingAP() -#define STORE_DEFAULT_NHM_SETTING 0 -#define RESTORE_DEFAULT_NHM_SETTING 1 -#define ACS_NHM_SETTING 2 - -typedef struct _ACS_ -{ - BOOLEAN bForceACSResult; - u1Byte CleanChannel_2G; - u1Byte CleanChannel_5G; - u2Byte Channel_Info_2G[2][ODM_MAX_CHANNEL_2G]; //Channel_Info[1]: Channel Score, Channel_Info[2]:Channel_Scan_Times - u2Byte Channel_Info_5G[2][ODM_MAX_CHANNEL_5G]; - -#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) - u1Byte ACS_Step; - // NHM Count 0-11 - u1Byte NHM_Cnt[14][11]; - - // AC-Series, for storing previous setting - u4Byte Reg0x990; - u4Byte Reg0x994; - u4Byte Reg0x998; - u4Byte Reg0x99C; - u1Byte Reg0x9A0; // u1Byte - - // N-Series, for storing previous setting - u4Byte Reg0x890; - u4Byte Reg0x894; - u4Byte Reg0x898; - u4Byte Reg0x89C; - u1Byte Reg0xE28; // u1Byte -#endif - -}ACS, *PACS; - - -VOID -odm_AutoChannelSelectInit( - IN PVOID pDM_VOID -); - -VOID -odm_AutoChannelSelectReset( - IN PVOID pDM_VOID -); - -VOID -odm_AutoChannelSelect( - IN PVOID pDM_VOID, - IN u1Byte Channel -); - -u1Byte -ODM_GetAutoChannelSelectResult( - IN PVOID pDM_VOID, - IN u1Byte Band -); - -#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) - -VOID -phydm_AutoChannelSelectSettingAP( - IN PVOID pDM_VOID, - IN u4Byte Setting, // 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING - IN u4Byte acs_step -); - -VOID -phydm_GetNHMStatisticsAP( - IN PVOID pDM_VOID, - IN u4Byte idx, // @ 2G, Real channel number = idx+1 - IN u4Byte acs_step -); - -#endif //#if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) - -#endif //#ifndef __PHYDMACS_H__ \ No newline at end of file +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMACS_H__ +#define __PHYDMACS_H__ + +#define ACS_VERSION "1.1" /*20150729 by YuChen*/ +#define CLM_VERSION "1.0" + +#define ODM_MAX_CHANNEL_2G 14 +#define ODM_MAX_CHANNEL_5G 24 + +/* For phydm_auto_channel_select_setting_ap() */ +#define STORE_DEFAULT_NHM_SETTING 0 +#define RESTORE_DEFAULT_NHM_SETTING 1 +#define ACS_NHM_SETTING 2 + +struct _ACS_ { + boolean is_force_acs_result; + u8 clean_channel_2g; + u8 clean_channel_5g; + u16 channel_info_2g[2][ODM_MAX_CHANNEL_2G]; /* Channel_Info[1]: channel score, Channel_Info[2]:Channel_Scan_Times */ + u16 channel_info_5g[2][ODM_MAX_CHANNEL_5G]; + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + u8 acs_step; + /* NHM count 0-11 */ + u8 nhm_cnt[14][11]; + + /* AC-Series, for storing previous setting */ + u32 reg0x990; + u32 reg0x994; + u32 reg0x998; + u32 reg0x99c; + u8 reg0x9a0; /* u8 */ + + /* N-Series, for storing previous setting */ + u32 reg0x890; + u32 reg0x894; + u32 reg0x898; + u32 reg0x89c; + u8 reg0xe28; /* u8 */ +#endif + +}; + + +void +odm_auto_channel_select_init( + void *p_dm_void +); + +void +odm_auto_channel_select_reset( + void *p_dm_void +); + +void +odm_auto_channel_select( + void *p_dm_void, + u8 channel +); + +u8 +odm_get_auto_channel_select_result( + void *p_dm_void, + u8 band +); + +boolean +phydm_acs_check( + void *p_dm_void +); + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + +void +phydm_auto_channel_select_setting_ap( + void *p_dm_void, + u32 setting, /* 0: STORE_DEFAULT_NHM_SETTING; 1: RESTORE_DEFAULT_NHM_SETTING, 2: ACS_NHM_SETTING */ + u32 acs_step +); + +void +phydm_get_nhm_statistics_ap( + void *p_dm_void, + u32 idx, /* @ 2G, Real channel number = idx+1 */ + u32 acs_step +); + +#endif /* #if ( DM_ODM_SUPPORT_TYPE & ODM_AP ) */ + +#endif /* #ifndef __PHYDMACS_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.c index c226f85b06ba..d67d21f90440 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.c @@ -1,1101 +1,1012 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -#if WPP_SOFTWARE_TRACE -#include "PhyDM_Adaptivity.tmh" -#endif -#endif - - -VOID -Phydm_CheckAdaptivity( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - - if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (pDM_Odm->APTotalNum > Adaptivity->APNumTH) { - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("AP total num > %d!!, disable adaptivity\n", Adaptivity->APNumTH)); - } else -#endif - { - if (Adaptivity->DynamicLinkAdaptivity || Adaptivity->AcsForAdaptivity) { - if (pDM_Odm->bLinked && Adaptivity->bCheck == FALSE) { - Phydm_NHMCounterStatistics(pDM_Odm); - Phydm_CheckEnvironment(pDM_Odm); - } else if (!pDM_Odm->bLinked) - Adaptivity->bCheck = FALSE; - } else { - pDM_Odm->Adaptivity_enable = TRUE; - - if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) - pDM_Odm->adaptivity_flag = FALSE; - else - pDM_Odm->adaptivity_flag = TRUE; - } - } - } else { - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - } - - - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -BOOLEAN -Phydm_CheckChannelPlan( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER pAdapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); - - if (pMgntInfo->RegEnableAdaptivity == 2) { - if (pDM_Odm->Carrier_Sense_enable == FALSE) { /*check domain Code for Adaptivity or CarrierSense*/ - if ((*pDM_Odm->pBandType == ODM_BAND_5G) && - !(pDM_Odm->odm_Regulation5G == REGULATION_ETSI || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - return TRUE; - } else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && - !(pDM_Odm->odm_Regulation2_4G == REGULATION_ETSI || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - return TRUE; - - } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity neither 2G nor 5G band, return\n")); - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - return TRUE; - } - } else { - if ((*pDM_Odm->pBandType == ODM_BAND_5G) && - !(pDM_Odm->odm_Regulation5G == REGULATION_MKK || pDM_Odm->odm_Regulation5G == REGULATION_WW)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 5G domain code : %d\n", pDM_Odm->odm_Regulation5G)); - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - return TRUE; - } - - else if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && - !(pDM_Odm->odm_Regulation2_4G == REGULATION_MKK || pDM_Odm->odm_Regulation2_4G == REGULATION_WW)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense skip 2.4G domain code : %d\n", pDM_Odm->odm_Regulation2_4G)); - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - return TRUE; - - } else if ((*pDM_Odm->pBandType != ODM_BAND_2_4G) && (*pDM_Odm->pBandType != ODM_BAND_5G)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("CarrierSense neither 2G nor 5G band, return\n")); - pDM_Odm->Adaptivity_enable = FALSE; - pDM_Odm->adaptivity_flag = FALSE; - return TRUE; - } - } - } - - return FALSE; - -} -#endif - -VOID -Phydm_NHMCounterStatisticsInit( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - /*PHY parameters initialize for n series*/ - ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11N+ 2, 0xC350); /*0x894[31:16]=0x0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ - ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N + 2, 0xffff); /*0x890[31:16]=0xffff th_9, th_10*/ - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, 0xffffff50); /*0x898=0xffffff52 th_3, th_2, th_1, th_0*/ - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, 0xffffffff); /*0x89c=0xffffffff th_7, th_6, th_5, th_4*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_FPGA0_IQK_11N, bMaskByte0, 0xff); /*0xe28[7:0]=0xff th_8*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10 | BIT9 | BIT8, 0x1); /*0x890[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT7, 0x1); /*0xc0c[7]=1 max power among all RX ants*/ - } -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - /*PHY parameters initialize for ac series*/ - ODM_Write2Byte(pDM_Odm, ODM_REG_CCX_PERIOD_11AC+ 2, 0xC350); /*0x990[31:16]=0xC350 Time duration for NHM unit: us, 0xc350=200ms*/ - ODM_Write2Byte(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC + 2, 0xffff); /*0x994[31:16]=0xffff th_9, th_10*/ - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, 0xffffff50); /*0x998=0xffffff52 th_3, th_2, th_1, th_0*/ - ODM_Write4Byte(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, 0xffffffff); /*0x99c=0xffffffff th_7, th_6, th_5, th_4*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, 0xff); /*0x9a0[7:0]=0xff th_8*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8 | BIT9 | BIT10, 0x1); /*0x994[10:8]=1 ignoreCCA ignore PHYTXON enable CCX*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_9E8_11AC, BIT0, 0x1); /*0x9e8[7]=1 max power among all RX ants*/ - - } -#endif -} - -VOID -Phydm_NHMCounterStatistics( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (!(pDM_Odm->SupportAbility & ODM_BB_NHM_CNT)) - return; - - /*Get NHM report*/ - Phydm_GetNHMCounterStatistics(pDM_Odm); - - /*Reset NHM counter*/ - Phydm_NHMCounterStatisticsReset(pDM_Odm); -} - -VOID -Phydm_GetNHMCounterStatistics( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte value32 = 0; -#if (RTL8195A_SUPPORT == 0) - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11AC, bMaskDWord); - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) -#endif - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_CNT_11N, bMaskDWord); - - pDM_Odm->NHM_cnt_0 = (u1Byte)(value32 & bMaskByte0); - pDM_Odm->NHM_cnt_1 = (u1Byte)((value32 & bMaskByte1) >> 8); - -} - -VOID -Phydm_NHMCounterStatisticsReset( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); - } -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1); - } - -#endif - -} - -VOID -Phydm_SetEDCCAThreshold( - IN PVOID pDM_VOID, - IN s1Byte H2L, - IN s1Byte L2H -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)((u1Byte)L2H|(u1Byte)H2L<<16)); -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)((u1Byte)L2H|(u1Byte)H2L<<8)); -#endif - -} - -VOID -Phydm_SetLNA( - IN PVOID pDM_VOID, - IN PhyDM_set_LNA type -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E)) { - if (type == PhyDM_disable_LNA) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x37f82); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (pDM_Odm->RFType > ODM_1T1R) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x37f82); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } else if (type == PhyDM_enable_LNA) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0000f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*back to normal*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (pDM_Odm->RFType > ODM_1T1R) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x0000f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0x77f82); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } - } else if (pDM_Odm->SupportICType & ODM_RTL8723B) { - if (type == PhyDM_disable_LNA) { - /*S0*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6137); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - /*S1*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x3008d); /*select Rx mode and disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); - } else if (type == PhyDM_enable_LNA) { - /*S0*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0001f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xe6177); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - /*S1*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x43, 0xfffff, 0x300bd); /*select Rx mode and disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xed, 0x00020, 0x0); - } - - } else if (pDM_Odm->SupportICType & ODM_RTL8812) { - if (type == PhyDM_disable_LNA) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (pDM_Odm->RFType > ODM_1T1R) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } else if (type == PhyDM_enable_LNA) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - if (pDM_Odm->RFType > ODM_1T1R) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0xef, 0x80000, 0x0); - } - } - } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { - if (type == PhyDM_disable_LNA) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb09b); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - } else if (type == PhyDM_enable_LNA) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x31, 0xfffff, 0x0002f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x32, 0xfffff, 0xfb0bb); /*disable LNA*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x80000, 0x0); - } - } -} - - - -VOID -Phydm_SetTRxMux( - IN PVOID pDM_VOID, - IN PhyDM_Trx_MUX_Type txMode, - IN PhyDM_Trx_MUX_Type rxMode -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ - if (pDM_Odm->RFType > ODM_1T1R) { - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT3 | BIT2 | BIT1, txMode); /*set TXmod to standby mode to remove outside noise affect*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT22 | BIT21 | BIT20, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ - } - } -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ - if (pDM_Odm->RFType > ODM_1T1R) { - ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT11 | BIT10 | BIT9 | BIT8, txMode); /*set TXmod to standby mode to remove outside noise affect*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC_B, BIT7 | BIT6 | BIT5 | BIT4, rxMode); /*set RXmod to standby mode to remove outside noise affect*/ - } - } -#endif - -} - -VOID -Phydm_MACEDCCAState( - IN PVOID pDM_VOID, - IN PhyDM_MACEDCCA_Type State -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if (State == PhyDM_IGNORE_EDCCA) { - ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 1); /*ignore EDCCA reg520[15]=1*/ -/* ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 0); *//*reg524[11]=0*/ - } else { /*don't set MAC ignore EDCCA signal*/ - ODM_SetMACReg(pDM_Odm, REG_TX_PTCL_CTRL, BIT15, 0); /*don't ignore EDCCA reg520[15]=0*/ -/* ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); *//*reg524[11]=1 */ - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("EDCCA enable State = %d\n", State)); - -} - -BOOLEAN -Phydm_CalNHMcnt( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u2Byte Base = 0; - - Base = pDM_Odm->NHM_cnt_0 + pDM_Odm->NHM_cnt_1; - - if (Base != 0) { - pDM_Odm->NHM_cnt_0 = ((pDM_Odm->NHM_cnt_0) << 8) / Base; - pDM_Odm->NHM_cnt_1 = ((pDM_Odm->NHM_cnt_1) << 8) / Base; - } - if ((pDM_Odm->NHM_cnt_0 - pDM_Odm->NHM_cnt_1) >= 100) - return TRUE; /*clean environment*/ - else - return FALSE; /*noisy environment*/ - -} - - -VOID -Phydm_CheckEnvironment( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - BOOLEAN isCleanEnvironment = FALSE; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - prtl8192cd_priv priv = pDM_Odm->priv; -#endif - - if (Adaptivity->bFirstLink == TRUE) { - if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) - pDM_Odm->adaptivity_flag = FALSE; - else - pDM_Odm->adaptivity_flag = TRUE; - - Adaptivity->bFirstLink = FALSE; - return; - } else { - if (Adaptivity->NHMWait < 3) { /*Start enter NHM after 4 NHMWait*/ - Adaptivity->NHMWait++; - Phydm_NHMCounterStatistics(pDM_Odm); - return; - } else { - Phydm_NHMCounterStatistics(pDM_Odm); - isCleanEnvironment = Phydm_CalNHMcnt(pDM_Odm); - if (isCleanEnvironment == TRUE) { - pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; /*adaptivity mode*/ - pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup; - - pDM_Odm->Adaptivity_enable = TRUE; - - if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) - pDM_Odm->adaptivity_flag = FALSE; - else - pDM_Odm->adaptivity_flag = TRUE; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - priv->pshare->rf_ft_var.isCleanEnvironment = TRUE; -#endif - } else { - if (!Adaptivity->AcsForAdaptivity) { - pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; /*mode2*/ - pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; - - pDM_Odm->adaptivity_flag = FALSE; - pDM_Odm->Adaptivity_enable = FALSE; - } -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - priv->pshare->rf_ft_var.isCleanEnvironment = FALSE; -#endif - } - Adaptivity->NHMWait = 0; - Adaptivity->bFirstLink = TRUE; - Adaptivity->bCheck = TRUE; - } - - } - - -} - -VOID -Phydm_SearchPwdBLowerBound( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - u4Byte value32 = 0; - u1Byte cnt; - u1Byte txEdcca1 = 0, txEdcca0 = 0; - BOOLEAN bAdjust = TRUE; - s1Byte TH_L2H_dmc, TH_H2L_dmc, IGI_target = 0x32; - s1Byte Diff; - u1Byte IGI = Adaptivity->IGI_Base + 30 + (u1Byte)pDM_Odm->TH_L2H_ini - (u1Byte)pDM_Odm->TH_EDCCA_HL_diff; - - if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) - Phydm_SetLNA(pDM_Odm, PhyDM_disable_LNA); - else { - Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); - odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_0, 0x7e); - } - - Diff = IGI_target - (s1Byte)IGI; - TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; - if (TH_L2H_dmc > 10) - TH_L2H_dmc = 10; - TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; - - Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); - ODM_delay_ms(5); - - while (bAdjust) { - for (cnt = 0; cnt < 20; cnt++) { - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord); -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord); -#endif - if (value32 & BIT30 && (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E))) - txEdcca1 = txEdcca1 + 1; - else if (value32 & BIT29) - txEdcca1 = txEdcca1 + 1; - else - txEdcca0 = txEdcca0 + 1; - } - - if (txEdcca1 > 1) { - IGI = IGI - 1; - TH_L2H_dmc = TH_L2H_dmc + 1; - if (TH_L2H_dmc > 10) - TH_L2H_dmc = 10; - TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; - - Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); - if (TH_L2H_dmc == 10) { - bAdjust = FALSE; - Adaptivity->H2L_lb = TH_H2L_dmc; - Adaptivity->L2H_lb = TH_L2H_dmc; - pDM_Odm->Adaptivity_IGI_upper = IGI; - } - - txEdcca1 = 0; - txEdcca0 = 0; - - } else { - bAdjust = FALSE; - Adaptivity->H2L_lb = TH_H2L_dmc; - Adaptivity->L2H_lb = TH_L2H_dmc; - pDM_Odm->Adaptivity_IGI_upper = IGI; - txEdcca1 = 0; - txEdcca0 = 0; - } - } - - pDM_Odm->Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper - pDM_Odm->DCbackoff; - Adaptivity->H2L_lb = Adaptivity->H2L_lb + pDM_Odm->DCbackoff; - Adaptivity->L2H_lb = Adaptivity->L2H_lb + pDM_Odm->DCbackoff; - - if (pDM_Odm->SupportICType & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) - Phydm_SetLNA(pDM_Odm, PhyDM_enable_LNA); - else { - Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); - odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_0, NONE); - } - - Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); /*resume to no link state*/ -} - -BOOLEAN -phydm_reSearchCondition( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - /*PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY);*/ - u1Byte Adaptivity_IGI_upper; - /*s1Byte TH_L2H_dmc, IGI_target = 0x32;*/ - /*s1Byte Diff;*/ - - Adaptivity_IGI_upper = pDM_Odm->Adaptivity_IGI_upper + pDM_Odm->DCbackoff; - - /*TH_L2H_dmc = 10;*/ - - /*Diff = TH_L2H_dmc - pDM_Odm->TH_L2H_ini;*/ - /*lowest_IGI_upper = IGI_target - Diff;*/ - - /*if ((Adaptivity_IGI_upper - lowest_IGI_upper) <= 5)*/ - if (Adaptivity_IGI_upper <= 0x26) - return TRUE; - else - return FALSE; - -} - -VOID -phydm_adaptivityInfoInit( - IN PVOID pDM_VOID, - IN PHYDM_ADAPINFO_E CmnInfo, - IN u4Byte Value - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - - switch (CmnInfo) { - case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE: - pDM_Odm->Carrier_Sense_enable = (BOOLEAN)Value; - break; - - case PHYDM_ADAPINFO_DCBACKOFF: - pDM_Odm->DCbackoff = (u1Byte)Value; - break; - - case PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY: - Adaptivity->DynamicLinkAdaptivity = (BOOLEAN)Value; - break; - - case PHYDM_ADAPINFO_TH_L2H_INI: - pDM_Odm->TH_L2H_ini = (s1Byte)Value; - break; - - case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF: - pDM_Odm->TH_EDCCA_HL_diff = (s1Byte)Value; - break; - - case PHYDM_ADAPINFO_AP_NUM_TH: - Adaptivity->APNumTH = (u1Byte)Value; - break; - - default: - break; - - } - -} - - - -VOID -Phydm_AdaptivityInit( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - s1Byte IGItarget = 0x32; - /*pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable;*/ - -#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - - if (pDM_Odm->Carrier_Sense_enable == FALSE) { - if (pDM_Odm->TH_L2H_ini == 0) - pDM_Odm->TH_L2H_ini = 0xf5; - } else - pDM_Odm->TH_L2H_ini = 0xa; - - if (pDM_Odm->TH_EDCCA_HL_diff == 0) - pDM_Odm->TH_EDCCA_HL_diff = 7; -#if(DM_ODM_SUPPORT_TYPE & (ODM_CE)) - if (pDM_Odm->WIFITest == TRUE || pDM_Odm->mp_mode == TRUE) -#else - if ((pDM_Odm->WIFITest & RT_WIFI_LOGO) == TRUE) -#endif - pDM_Odm->EDCCA_enable = FALSE; /*even no adaptivity, we still enable EDCCA, AP side use mib control*/ - else - pDM_Odm->EDCCA_enable = TRUE; - -#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) - prtl8192cd_priv priv = pDM_Odm->priv; - - if (pDM_Odm->Carrier_Sense_enable) { - pDM_Odm->TH_L2H_ini = 0xa; - pDM_Odm->TH_EDCCA_HL_diff = 7; - } else { - pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_default; /*set by mib*/ - pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_default; - } - - if (priv->pshare->rf_ft_var.adaptivity_enable == 3) - Adaptivity->AcsForAdaptivity = TRUE; - else - Adaptivity->AcsForAdaptivity = FALSE; - - if (priv->pshare->rf_ft_var.adaptivity_enable == 2) - Adaptivity->DynamicLinkAdaptivity = TRUE; - else - Adaptivity->DynamicLinkAdaptivity = FALSE; - - priv->pshare->rf_ft_var.isCleanEnvironment = FALSE; - -#endif - - pDM_Odm->Adaptivity_IGI_upper = 0; - pDM_Odm->Adaptivity_enable = FALSE; /*use this flag to decide enable or disable*/ - - pDM_Odm->TH_L2H_ini_mode2 = 20; - pDM_Odm->TH_EDCCA_HL_diff_mode2 = 8; - Adaptivity->TH_L2H_ini_backup = pDM_Odm->TH_L2H_ini; - Adaptivity->TH_EDCCA_HL_diff_backup = pDM_Odm->TH_EDCCA_HL_diff; - - Adaptivity->IGI_Base = 0x32; - Adaptivity->IGI_target = 0x1c; - Adaptivity->H2L_lb = 0; - Adaptivity->L2H_lb = 0; - Adaptivity->NHMWait = 0; - Adaptivity->bCheck = FALSE; - Adaptivity->bFirstLink = TRUE; - Adaptivity->AdajustIGILevel = 0; - Adaptivity->bStopEDCCA = FALSE; - Adaptivity->backupH2L = 0; - Adaptivity->backupL2H = 0; - - Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); - - /*Search pwdB lower bound*/ - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209); -#endif - - if (pDM_Odm->SupportICType & ODM_IC_11N_GAIN_IDX_EDCCA) { - /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT_11N, BIT12 | BIT11 | BIT10, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ - if (pDM_Odm->SupportICType & ODM_RTL8197F) { - ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_B1_97F, BIT30, 0x1); /*set to page B1*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_97F, BIT27 | BIT26, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_B1_97F, BIT30, 0x0); -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - if (priv->pshare->rf_ft_var.adaptivity_enable == 1) - ODM_SetBBReg(pDM_Odm, 0xce8, BIT13, 0x1); /*0: mean, 1:max pwdB*/ -#endif - } else - ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DCNF_11N, BIT21 | BIT20, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ - } -#if (RTL8195A_SUPPORT == 0) - if (pDM_Odm->SupportICType & ODM_IC_11AC_GAIN_IDX_EDCCA) { /*8814a no need to find pwdB lower bound, maybe*/ - /*ODM_SetBBReg(pDM_Odm, ODM_REG_EDCCA_DOWN_OPT, BIT30 | BIT29 | BIT28, 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_ACBB_EDCCA_ENHANCE, BIT29 | BIT28, 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ - } - - if (!(pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))) { - Phydm_SearchPwdBLowerBound(pDM_Odm); - if (phydm_reSearchCondition(pDM_Odm)) - Phydm_SearchPwdBLowerBound(pDM_Odm); - } -#endif - -/*we need to consider PwdB upper bound for 8814 later IC*/ - Adaptivity->AdajustIGILevel = (u1Byte)((pDM_Odm->TH_L2H_ini + IGItarget) - PwdBUpperBound + DFIRloss); /*IGI = L2H - PwdB - DFIRloss*/ - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("TH_L2H_ini = 0x%x, TH_EDCCA_HL_diff = 0x%x, Adaptivity->AdajustIGILevel = 0x%x\n", pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff, Adaptivity->AdajustIGILevel)); - - /*Check this later on Windows*/ - /*phydm_setEDCCAThresholdAPI(pDM_Odm, pDM_DigTable->CurIGValue);*/ - -} - - -VOID -Phydm_Adaptivity( - IN PVOID pDM_VOID, - IN u1Byte IGI -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - s1Byte TH_L2H_dmc, TH_H2L_dmc; - s1Byte Diff = 0, IGI_target; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER pAdapter = pDM_Odm->Adapter; - BOOLEAN bFwCurrentInPSMode = FALSE; - - pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_FW_PSMODE_STATUS, (pu1Byte)(&bFwCurrentInPSMode)); - - /*Disable EDCCA mode while under LPS mode, added by Roger, 2012.09.14.*/ - if (bFwCurrentInPSMode) - return; -#endif - - if ((pDM_Odm->EDCCA_enable == FALSE) || (Adaptivity->bStopEDCCA == TRUE)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Disable EDCCA!!!\n")); - return; - } - - if (!(pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("adaptivity disable, enable EDCCA mode!!!\n")); - pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; - pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; - } -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - else{ - if (Phydm_CheckChannelPlan(pDM_Odm) || (pDM_Odm->APTotalNum > Adaptivity->APNumTH)) { - pDM_Odm->TH_L2H_ini = pDM_Odm->TH_L2H_ini_mode2; - pDM_Odm->TH_EDCCA_HL_diff = pDM_Odm->TH_EDCCA_HL_diff_mode2; - } else { - pDM_Odm->TH_L2H_ini = Adaptivity->TH_L2H_ini_backup; - pDM_Odm->TH_EDCCA_HL_diff = Adaptivity->TH_EDCCA_HL_diff_backup; - } - } -#endif - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("odm_Adaptivity() =====>\n")); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI_Base=0x%x, TH_L2H_ini = %d, TH_EDCCA_HL_diff = %d\n", - Adaptivity->IGI_Base, pDM_Odm->TH_L2H_ini, pDM_Odm->TH_EDCCA_HL_diff)); -#if (RTL8195A_SUPPORT == 0) - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - /*fix AC series when enable EDCCA hang issue*/ - ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 1); /*ADC_mask disable*/ - ODM_SetBBReg(pDM_Odm, 0x800, BIT10, 0); /*ADC_mask enable*/ - } -#endif - if (*pDM_Odm->pBandWidth == ODM_BW20M) /*CHANNEL_WIDTH_20*/ - IGI_target = Adaptivity->IGI_Base; - else if (*pDM_Odm->pBandWidth == ODM_BW40M) - IGI_target = Adaptivity->IGI_Base + 2; -#if (RTL8195A_SUPPORT == 0) - else if (*pDM_Odm->pBandWidth == ODM_BW80M) - IGI_target = Adaptivity->IGI_Base + 2; -#endif - else - IGI_target = Adaptivity->IGI_Base; - Adaptivity->IGI_target = (u1Byte) IGI_target; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("BandWidth=%s, IGI_target=0x%x, DynamicLinkAdaptivity = %d, AcsForAdaptivity = %d\n", - (*pDM_Odm->pBandWidth == ODM_BW80M) ? "80M" : ((*pDM_Odm->pBandWidth == ODM_BW40M) ? "40M" : "20M"), IGI_target, Adaptivity->DynamicLinkAdaptivity, Adaptivity->AcsForAdaptivity)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("RSSI_min = %d, Adaptivity->AdajustIGILevel= 0x%x, adaptivity_flag = %d, Adaptivity_enable = %d\n", - pDM_Odm->RSSI_Min, Adaptivity->AdajustIGILevel, pDM_Odm->adaptivity_flag, pDM_Odm->Adaptivity_enable)); - - if ((Adaptivity->DynamicLinkAdaptivity == TRUE) && (!pDM_Odm->bLinked) && (pDM_Odm->Adaptivity_enable == FALSE)) { - Phydm_SetEDCCAThreshold(pDM_Odm, 0x7f, 0x7f); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("In DynamicLink mode(noisy) and No link, Turn off EDCCA!!\n")); - return; - } - - if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { - if ((Adaptivity->AdajustIGILevel > IGI) && (pDM_Odm->Adaptivity_enable == TRUE)) - Diff = Adaptivity->AdajustIGILevel - IGI; - - TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; - TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; - } -#if (RTL8195A_SUPPORT == 0) - else { - Diff = IGI_target - (s1Byte)IGI; - TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; - if (TH_L2H_dmc > 10 && (pDM_Odm->Adaptivity_enable == TRUE)) - TH_L2H_dmc = 10; - - TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; - - /*replace lower bound to prevent EDCCA always equal 1*/ - if (TH_H2L_dmc < Adaptivity->H2L_lb) - TH_H2L_dmc = Adaptivity->H2L_lb; - if (TH_L2H_dmc < Adaptivity->L2H_lb) - TH_L2H_dmc = Adaptivity->L2H_lb; - } -#endif - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); - - Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); - - if (pDM_Odm->Adaptivity_enable == TRUE) - ODM_SetMACReg(pDM_Odm, REG_RD_CTRL, BIT11, 1); - - return; -} - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -VOID -Phydm_AdaptivityBSOD( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER pAdapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); - u1Byte count = 0; - u4Byte u4Value; - - /* - 1. turn off RF (TRX Mux in standby mode) - 2. H2C mac id drop - 3. ignore EDCCA - 4. wait for clear FIFO - 5. don't ignore EDCCA - 6. turn on RF (TRX Mux in TRx mdoe) - 7. H2C mac id resume - */ - - RT_TRACE(COMP_MLME, DBG_WARNING, ("MAC id drop packet!!!!!\n")); - - pAdapter->dropPktByMacIdCnt++; - pMgntInfo->bDropPktInProgress = TRUE; - - pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_MAX_Q_PAGE_NUM, (pu1Byte)(&u4Value)); - RT_TRACE(COMP_INIT, DBG_LOUD, ("Queue Reserved Page Number = 0x%08x\n", u4Value)); - pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); - RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); - - /*Standby mode*/ - Phydm_SetTRxMux(pDM_Odm, PhyDM_STANDBY_MODE, PhyDM_STANDBY_MODE); - ODM_Write_DIG(pDM_Odm, 0x20); - - /*H2C mac id drop*/ - MacIdIndicateDisconnect(pAdapter); - - /*Ignore EDCCA*/ - Phydm_MACEDCCAState(pDM_Odm, PhyDM_IGNORE_EDCCA); - - delay_ms(50); - count = 5; - - /*Resume EDCCA*/ - Phydm_MACEDCCAState(pDM_Odm, PhyDM_DONT_IGNORE_EDCCA); - - /*Turn on TRx mode*/ - Phydm_SetTRxMux(pDM_Odm, PhyDM_TX_MODE, PhyDM_RX_MODE); - ODM_Write_DIG(pDM_Odm, 0x20); - - /*Resume H2C macid*/ - MacIdRecoverMediaStatus(pAdapter); - - pAdapter->HalFunc.GetHwRegHandler(pAdapter, HW_VAR_AVBL_Q_PAGE_NUM, (pu1Byte)(&u4Value)); - RT_TRACE(COMP_INIT, DBG_LOUD, ("Available Queue Page Number = 0x%08x\n", u4Value)); - - pMgntInfo->bDropPktInProgress = FALSE; - RT_TRACE(COMP_MLME, DBG_WARNING, ("End of MAC id drop packet, spent %dms\n", count * 10)); - -} - -#endif - -/*This API is for solving USB can't Tx problem due to USB3.0 interference in 2.4G*/ -VOID -phydm_pauseEDCCA( - IN PVOID pDM_VOID, - IN BOOLEAN bPasueEDCCA -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - u1Byte IGI = pDM_DigTable->CurIGValue; - s1Byte Diff = 0; - - if (bPasueEDCCA) { - Adaptivity->bStopEDCCA = TRUE; - - if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { - if (Adaptivity->AdajustIGILevel > IGI) - Diff = Adaptivity->AdajustIGILevel - IGI; - - Adaptivity->backupL2H = pDM_Odm->TH_L2H_ini - Diff + Adaptivity->IGI_target; - Adaptivity->backupH2L = Adaptivity->backupL2H - pDM_Odm->TH_EDCCA_HL_diff; - } -#if (RTL8195A_SUPPORT == 0) - else { - Diff = Adaptivity->IGI_target - (s1Byte)IGI; - Adaptivity->backupL2H = pDM_Odm->TH_L2H_ini + Diff; - if (Adaptivity->backupL2H > 10) - Adaptivity->backupL2H = 10; - - Adaptivity->backupH2L = Adaptivity->backupL2H - pDM_Odm->TH_EDCCA_HL_diff; - - /*replace lower bound to prevent EDCCA always equal 1*/ - if (Adaptivity->backupH2L < Adaptivity->H2L_lb) - Adaptivity->backupH2L = Adaptivity->H2L_lb; - if (Adaptivity->backupL2H < Adaptivity->L2H_lb) - Adaptivity->backupL2H = Adaptivity->L2H_lb; - } -#endif - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("pauseEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", Adaptivity->backupL2H, Adaptivity->backupH2L, IGI)); - - /*Disable EDCCA*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (PlatformIsWorkItemScheduled(&(Adaptivity->phydm_pauseEDCCAWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(Adaptivity->phydm_pauseEDCCAWorkItem)); -#else - phydm_pauseEDCCA_WorkItemCallback(pDM_Odm); -#endif - - } else { - - Adaptivity->bStopEDCCA = FALSE; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("resumeEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", Adaptivity->backupL2H, Adaptivity->backupH2L, IGI)); - /*Resume EDCCA*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (PlatformIsWorkItemScheduled(&(Adaptivity->phydm_resumeEDCCAWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(Adaptivity->phydm_resumeEDCCAWorkItem)); -#else - phydm_resumeEDCCA_WorkItemCallback(pDM_Odm); -#endif - - } - -} - - -VOID -phydm_pauseEDCCA_WorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)(0x7f|0x7f<<16)); -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)(0x7f|0x7f<<8)); -#endif - -} - -VOID -phydm_resumeEDCCA_WorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskByte2|bMaskByte0, (u4Byte)((u1Byte)Adaptivity->backupL2H|(u1Byte)Adaptivity->backupH2L<<16)); -#if (RTL8195A_SUPPORT == 0) - else if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - ODM_SetBBReg(pDM_Odm, rFPGA0_XB_LSSIReadBack, bMaskLWord, (u2Byte)((u1Byte)Adaptivity->backupL2H|(u1Byte)Adaptivity->backupH2L<<8)); -#endif - -} - - -VOID -phydm_setEDCCAThresholdAPI( - IN PVOID pDM_VOID, - IN u1Byte IGI -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTIVITY_STATISTICS Adaptivity = (PADAPTIVITY_STATISTICS)PhyDM_Get_Structure(pDM_Odm, PHYDM_ADAPTIVITY); - s1Byte TH_L2H_dmc, TH_H2L_dmc; - s1Byte Diff = 0, IGI_target = 0x32; - - if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) { - if (pDM_Odm->SupportICType & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { - if (Adaptivity->AdajustIGILevel > IGI) - Diff = Adaptivity->AdajustIGILevel - IGI; - - TH_L2H_dmc = pDM_Odm->TH_L2H_ini - Diff + IGI_target; - TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; - } -#if (RTL8195A_SUPPORT == 0) - else { - Diff = IGI_target - (s1Byte)IGI; - TH_L2H_dmc = pDM_Odm->TH_L2H_ini + Diff; - if (TH_L2H_dmc > 10) - TH_L2H_dmc = 10; - - TH_H2L_dmc = TH_L2H_dmc - pDM_Odm->TH_EDCCA_HL_diff; - - /*replace lower bound to prevent EDCCA always equal 1*/ - if (TH_H2L_dmc < Adaptivity->H2L_lb) - TH_H2L_dmc = Adaptivity->H2L_lb; - if (TH_L2H_dmc < Adaptivity->L2H_lb) - TH_L2H_dmc = Adaptivity->L2H_lb; - } -#endif - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :IGI=0x%x, TH_L2H_dmc = %d, TH_H2L_dmc = %d\n", IGI, TH_L2H_dmc, TH_H2L_dmc)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_ADAPTIVITY, ODM_DBG_LOUD, ("API :Adaptivity_IGI_upper=0x%x, H2L_lb = 0x%x, L2H_lb = 0x%x\n", pDM_Odm->Adaptivity_IGI_upper, Adaptivity->H2L_lb, Adaptivity->L2H_lb)); - - Phydm_SetEDCCAThreshold(pDM_Odm, TH_H2L_dmc, TH_L2H_dmc); - } - -} - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + #if WPP_SOFTWARE_TRACE + #include "PhyDM_Adaptivity.tmh" + #endif +#endif + +void +phydm_dig_up_bound_lmt_en( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *p_adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + + if (!(p_dm->support_ability & ODM_BB_ADAPTIVITY) || + (p_dm->adaptivity_flag == false) || + (!p_dm->is_linked) || + (p_dm->adaptivity_enable == false) + ) { + p_adaptivity->igi_up_bound_lmt_cnt = 0; + p_adaptivity->igi_lmt_en = false; + return; + } + + if (p_dm->total_tp > 1) { + p_adaptivity->igi_lmt_en = true; + p_adaptivity->igi_up_bound_lmt_cnt = p_adaptivity->igi_up_bound_lmt_val; + PHYDM_DBG(p_dm, DBG_ADPTVTY, + ("TP >1, Start limit IGI upper bound\n")); + } else { + if (p_adaptivity->igi_up_bound_lmt_cnt == 0) + p_adaptivity->igi_lmt_en = false; + else + p_adaptivity->igi_up_bound_lmt_cnt--; + } + + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("IGI_lmt_cnt = %d\n", p_adaptivity->igi_up_bound_lmt_cnt)); +} + +void +phydm_check_adaptivity( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + + if (!(p_dm->support_ability & ODM_BB_ADAPTIVITY)) { + p_dm->adaptivity_enable = false; + return; + } + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (p_dm->ap_total_num > adaptivity->ap_num_th) { + p_dm->adaptivity_enable = false; + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("AP total num > %d!!, disable adaptivity\n", adaptivity->ap_num_th)); + return; + } +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (adaptivity->dynamic_link_adaptivity) { + if (p_dm->is_linked && adaptivity->is_check == false) { + phydm_check_environment(p_dm); + } else if (!p_dm->is_linked) + adaptivity->is_check = false; + + return; + } +#endif + + p_dm->adaptivity_enable = true; +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +boolean +phydm_check_channel_plan( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *p_adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = &(p_adapter->MgntInfo); + + if (p_mgnt_info->RegEnableAdaptivity == 2) { + if (p_dm->carrier_sense_enable == false) { /*check domain Code for adaptivity or CarrierSense*/ + if ((*p_dm->p_band_type == ODM_BAND_5G) && + !(p_dm->odm_regulation_5g == REGULATION_ETSI || p_dm->odm_regulation_5g == REGULATION_WW)) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("adaptivity skip 5G domain code : %d\n", p_dm->odm_regulation_5g)); + p_dm->adaptivity_enable = false; + return true; + } else if ((*p_dm->p_band_type == ODM_BAND_2_4G) && + !(p_dm->odm_regulation_2_4g == REGULATION_ETSI || p_dm->odm_regulation_2_4g == REGULATION_WW)) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("adaptivity skip 2.4G domain code : %d\n", p_dm->odm_regulation_2_4g)); + p_dm->adaptivity_enable = false; + return true; + + } else if ((*p_dm->p_band_type != ODM_BAND_2_4G) && (*p_dm->p_band_type != ODM_BAND_5G)) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("adaptivity neither 2G nor 5G band, return\n")); + p_dm->adaptivity_enable = false; + return true; + } + } else { + if ((*p_dm->p_band_type == ODM_BAND_5G) && + !(p_dm->odm_regulation_5g == REGULATION_MKK || p_dm->odm_regulation_5g == REGULATION_WW)) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("CarrierSense skip 5G domain code : %d\n", p_dm->odm_regulation_5g)); + p_dm->adaptivity_enable = false; + return true; + } + + else if ((*p_dm->p_band_type == ODM_BAND_2_4G) && + !(p_dm->odm_regulation_2_4g == REGULATION_MKK || p_dm->odm_regulation_2_4g == REGULATION_WW)) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("CarrierSense skip 2.4G domain code : %d\n", p_dm->odm_regulation_2_4g)); + p_dm->adaptivity_enable = false; + return true; + + } else if ((*p_dm->p_band_type != ODM_BAND_2_4G) && (*p_dm->p_band_type != ODM_BAND_5G)) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("CarrierSense neither 2G nor 5G band, return\n")); + p_dm->adaptivity_enable = false; + return true; + } + } + } + + return false; + +} +#endif + +void +phydm_set_edcca_threshold( + void *p_dm_void, + s8 H2L, + s8 L2H +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + odm_set_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, MASKBYTE2 | MASKBYTE0, (u32)((u8)L2H | (u8)H2L << 16)); +#if (RTL8195A_SUPPORT == 0) + else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_set_bb_reg(p_dm, REG_FPGA0_XB_LSSI_READ_BACK, MASKLWORD, (u16)((u8)L2H | (u8)H2L << 8)); +#endif + +} + +void +phydm_set_lna( + void *p_dm_void, + enum phydm_set_lna type +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8192E)) { + if (type == phydm_disable_lna) { + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0x37f82); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + if (p_dm->rf_type > RF_1T1R) { + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0xfffff, 0x18000); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0x37f82); + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x0); + } + } else if (type == phydm_enable_lna) { + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*back to normal*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + if (p_dm->rf_type > RF_1T1R) { + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0xfffff, 0x18000); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x0000f); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0x77f82); + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x0); + } + } + } else if (p_dm->support_ic_type & ODM_RTL8723B) { + if (type == phydm_disable_lna) { + /*S0*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0001f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xe6137); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + /*S1*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xed, 0x00020, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x43, 0xfffff, 0x3008d); /*select Rx mode and disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xed, 0x00020, 0x0); + } else if (type == phydm_enable_lna) { + /*S0*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0001f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xe6177); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + /*S1*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xed, 0x00020, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x43, 0xfffff, 0x300bd); /*select Rx mode and disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xed, 0x00020, 0x0); + } + + } else if (p_dm->support_ic_type & ODM_RTL8812) { + if (type == phydm_disable_lna) { + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + if (p_dm->rf_type > RF_1T1R) { + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0xc22bf); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x0); + } + } else if (type == phydm_enable_lna) { + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x3f7ff); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + if (p_dm->rf_type > RF_1T1R) { + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x3f7ff); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0xc26bf); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x0); + } + } + } else if (p_dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A)) { + if (type == phydm_disable_lna) { + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0002f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xfb09b); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + } else if (type == phydm_enable_lna) { + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*select Rx mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0002f); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xfb0bb); /*disable LNA*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); + } + } +} + + + +void +phydm_set_trx_mux( + void *p_dm_void, + enum phydm_trx_mux_type tx_mode, + enum phydm_trx_mux_type rx_mode +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(p_dm, ODM_REG_CCK_RPT_FORMAT_11N, BIT(3) | BIT(2) | BIT(1), tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ + odm_set_bb_reg(p_dm, ODM_REG_CCK_RPT_FORMAT_11N, BIT(22) | BIT(21) | BIT(20), rx_mode); /*set RXmod to standby mode to remove outside noise affect*/ + if (p_dm->rf_type > RF_1T1R) { + odm_set_bb_reg(p_dm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT(3) | BIT(2) | BIT(1), tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ + odm_set_bb_reg(p_dm, ODM_REG_CCK_RPT_FORMAT_11N_B, BIT(22) | BIT(21) | BIT(20), rx_mode); /*set RXmod to standby mode to remove outside noise affect*/ + } + } +#if (RTL8195A_SUPPORT == 0) + else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(p_dm, ODM_REG_TRMUX_11AC, BIT(11) | BIT(10) | BIT(9) | BIT(8), tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ + odm_set_bb_reg(p_dm, ODM_REG_TRMUX_11AC, BIT(7) | BIT(6) | BIT(5) | BIT(4), rx_mode); /*set RXmod to standby mode to remove outside noise affect*/ + if (p_dm->rf_type > RF_1T1R) { + odm_set_bb_reg(p_dm, ODM_REG_TRMUX_11AC_B, BIT(11) | BIT(10) | BIT(9) | BIT(8), tx_mode); /*set TXmod to standby mode to remove outside noise affect*/ + odm_set_bb_reg(p_dm, ODM_REG_TRMUX_11AC_B, BIT(7) | BIT(6) | BIT(5) | BIT(4), rx_mode); /*set RXmod to standby mode to remove outside noise affect*/ + } + } +#endif + +} + +void +phydm_mac_edcca_state( + void *p_dm_void, + enum phydm_mac_edcca_type state +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + if (state == phydm_ignore_edcca) { + odm_set_mac_reg(p_dm, REG_TX_PTCL_CTRL, BIT(15), 1); /*ignore EDCCA reg520[15]=1*/ + /* odm_set_mac_reg(p_dm, REG_RD_CTRL, BIT(11), 0); */ /*reg524[11]=0*/ + } else { /*don't set MAC ignore EDCCA signal*/ + odm_set_mac_reg(p_dm, REG_TX_PTCL_CTRL, BIT(15), 0); /*don't ignore EDCCA reg520[15]=0*/ + /* odm_set_mac_reg(p_dm, REG_RD_CTRL, BIT(11), 1); */ /*reg524[11]=1 */ + } + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("EDCCA enable state = %d\n", state)); + +} + +void +phydm_check_environment( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + boolean is_clean_environment = false; + + is_clean_environment = phydm_cal_nhm_cnt(p_dm); + + if (is_clean_environment == true) { + p_dm->th_l2h_ini = adaptivity->th_l2h_ini_backup; /*adaptivity mode*/ + p_dm->th_edcca_hl_diff = adaptivity->th_edcca_hl_diff_backup; + + p_dm->adaptivity_enable = true; + } else { + p_dm->th_l2h_ini = p_dm->th_l2h_ini_mode2; /*mode2*/ + p_dm->th_edcca_hl_diff = p_dm->th_edcca_hl_diff_mode2; + + p_dm->adaptivity_enable = false; + } + + adaptivity->is_check = true; + +} + +void +phydm_search_pwdb_lower_bound( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + u32 value32 = 0, reg_value32 = 0; + u8 cnt, try_count = 0; + u8 tx_edcca1 = 0; + boolean is_adjust = true; + s8 th_l2h_dmc, th_h2l_dmc, igi_target = 0x32; + s8 diff; + u8 IGI = adaptivity->igi_base + 30 + (u8)p_dm->th_l2h_ini - (u8)p_dm->th_edcca_hl_diff; + + if (p_dm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) + phydm_set_lna(p_dm, phydm_disable_lna); + + diff = igi_target - (s8)IGI; + th_l2h_dmc = p_dm->th_l2h_ini + diff; + if (th_l2h_dmc > 10) + th_l2h_dmc = 10; + + th_h2l_dmc = th_l2h_dmc - p_dm->th_edcca_hl_diff; + phydm_set_edcca_threshold(p_dm, th_h2l_dmc, th_l2h_dmc); + ODM_delay_ms(30); + + while (is_adjust) { + + /*check CCA status*/ + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_1, 0x0)) {/*set debug port to 0x0*/ + reg_value32 = phydm_get_bb_dbg_port_value(p_dm); + + while (reg_value32 & BIT(3) && try_count < 3) { + ODM_delay_ms(3); + try_count = try_count + 1; + reg_value32 = phydm_get_bb_dbg_port_value(p_dm); + } + phydm_release_bb_dbg_port(p_dm); + try_count = 0; + } + + /*count EDCCA signal = 1 times*/ + for (cnt = 0; cnt < 20; cnt++) { + + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_1, adaptivity->adaptivity_dbg_port)) { + value32 = phydm_get_bb_dbg_port_value(p_dm); + phydm_release_bb_dbg_port(p_dm); + } + + if (value32 & BIT(30) && (p_dm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E))) + tx_edcca1 = tx_edcca1 + 1; + else if (value32 & BIT(29)) + tx_edcca1 = tx_edcca1 + 1; + } + + if (tx_edcca1 > 1) { + IGI = IGI - 1; + th_l2h_dmc = th_l2h_dmc + 1; + if (th_l2h_dmc > 10) + th_l2h_dmc = 10; + + th_h2l_dmc = th_l2h_dmc - p_dm->th_edcca_hl_diff; + phydm_set_edcca_threshold(p_dm, th_h2l_dmc, th_l2h_dmc); + tx_edcca1 = 0; + if (th_l2h_dmc == 10) + is_adjust = false; + + } else + is_adjust = false; + + } + + adaptivity->adapt_igi_up = IGI - p_dm->dc_backoff; + adaptivity->h2l_lb = th_h2l_dmc + p_dm->dc_backoff; + adaptivity->l2h_lb = th_l2h_dmc + p_dm->dc_backoff; + + if (p_dm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) + phydm_set_lna(p_dm, phydm_enable_lna); + + phydm_set_edcca_threshold(p_dm, 0x7f, 0x7f); /*resume to no link state*/ +} + +boolean +phydm_re_search_condition( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + u8 adaptivity_igi_upper = adaptivity->adapt_igi_up + p_dm->dc_backoff; + /*s8 TH_L2H_dmc, IGI_target = 0x32;*/ + /*s8 diff;*/ + + /*TH_L2H_dmc = 10;*/ + + /*diff = TH_L2H_dmc - p_dm->TH_L2H_ini;*/ + /*lowest_IGI_upper = IGI_target - diff;*/ + /*if ((adaptivity_igi_upper - lowest_IGI_upper) <= 5)*/ + + if (adaptivity_igi_upper <= 0x26) + return true; + else + return false; +} + +void +phydm_adaptivity_info_init( + void *p_dm_void, + enum phydm_adapinfo_e cmn_info, + u32 value +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + + switch (cmn_info) { + case PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE: + p_dm->carrier_sense_enable = (boolean)value; + break; + + case PHYDM_ADAPINFO_DCBACKOFF: + p_dm->dc_backoff = (u8)value; + break; + + case PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY: + adaptivity->dynamic_link_adaptivity = (boolean)value; + break; + + case PHYDM_ADAPINFO_TH_L2H_INI: + p_dm->th_l2h_ini = (s8)value; + break; + + case PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF: + p_dm->th_edcca_hl_diff = (s8)value; + break; + + case PHYDM_ADAPINFO_AP_NUM_TH: + adaptivity->ap_num_th = (u8)value; + break; + + default: + break; + + } + +} + +void +phydm_adaptivity_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + s8 igi_target = 0x32; + /*struct phydm_dig_struct* p_dig_t = &p_dm->dm_dig_table;*/ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN)) + + if (p_dm->carrier_sense_enable == false) { + if (p_dm->th_l2h_ini == 0) + phydm_set_l2h_th_ini(p_dm); + } else + p_dm->th_l2h_ini = 0xa; + + if (p_dm->th_edcca_hl_diff == 0) + p_dm->th_edcca_hl_diff = 7; +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + if (p_dm->wifi_test == true || *(p_dm->p_mp_mode) == true) +#else + if ((p_dm->wifi_test & RT_WIFI_LOGO) == true) +#endif + p_dm->edcca_enable = false; /*even no adaptivity, we still enable EDCCA, AP side use mib control*/ + else + p_dm->edcca_enable = true; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + struct rtl8192cd_priv *priv = p_dm->priv; + + if (p_dm->carrier_sense_enable) { + p_dm->th_l2h_ini = 0xa; + p_dm->th_edcca_hl_diff = 7; + } else { + p_dm->th_l2h_ini = p_dm->TH_L2H_default; /*set by mib*/ + p_dm->th_edcca_hl_diff = p_dm->th_edcca_hl_diff_default; + } + + if (priv->pshare->rf_ft_var.adaptivity_enable == 2) + adaptivity->dynamic_link_adaptivity = true; + else + adaptivity->dynamic_link_adaptivity = false; + +#endif + + adaptivity->adapt_igi_up = 0; + p_dm->adaptivity_enable = false; /*use this flag to decide enable or disable*/ + + p_dm->th_l2h_ini_mode2 = 20; + p_dm->th_edcca_hl_diff_mode2 = 8; + adaptivity->debug_mode = false; + adaptivity->th_l2h_ini_backup = p_dm->th_l2h_ini; + adaptivity->th_edcca_hl_diff_backup = p_dm->th_edcca_hl_diff; + + adaptivity->igi_base = 0x32; + adaptivity->igi_target = 0x1c; + adaptivity->h2l_lb = 0; + adaptivity->l2h_lb = 0; + adaptivity->is_check = false; + adaptivity->adajust_igi_level = 0; + adaptivity->is_stop_edcca = false; + adaptivity->backup_h2l = 0; + adaptivity->backup_l2h = 0; + adaptivity->adaptivity_dbg_port = (p_dm->support_ic_type & ODM_IC_11N_SERIES) ? 0x208 : 0x209; + + phydm_mac_edcca_state(p_dm, phydm_dont_ignore_edcca); + + if (p_dm->support_ic_type & ODM_IC_11N_GAIN_IDX_EDCCA) { + /*odm_set_bb_reg(p_dm, ODM_REG_EDCCA_DOWN_OPT_11N, BIT(12) | BIT(11) | BIT(10), 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ + if (p_dm->support_ic_type & ODM_RTL8197F) { + odm_set_bb_reg(p_dm, ODM_REG_PAGE_B1_97F, BIT(30), 0x1); /*set to page B1*/ + odm_set_bb_reg(p_dm, ODM_REG_EDCCA_DCNF_97F, BIT(27) | BIT(26), 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ + odm_set_bb_reg(p_dm, ODM_REG_PAGE_B1_97F, BIT(30), 0x0); + } else + odm_set_bb_reg(p_dm, ODM_REG_EDCCA_DCNF_11N, BIT(21) | BIT(20), 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ + } +#if (RTL8195A_SUPPORT == 0) + if (p_dm->support_ic_type & ODM_IC_11AC_GAIN_IDX_EDCCA) { /*8814a no need to find pwdB lower bound, maybe*/ + /*odm_set_bb_reg(p_dm, ODM_REG_EDCCA_DOWN_OPT, BIT(30) | BIT(29) | BIT(28), 0x7);*/ /*interfernce need > 2^x us, and then EDCCA will be 1*/ + odm_set_bb_reg(p_dm, ODM_REG_ACBB_EDCCA_ENHANCE, BIT(29) | BIT(28), 0x1); /*0:rx_dfir, 1: dcnf_out, 2 :rx_iq, 3: rx_nbi_nf_out*/ + } + + if (!(p_dm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA))) { + phydm_search_pwdb_lower_bound(p_dm); + if (phydm_re_search_condition(p_dm)) + phydm_search_pwdb_lower_bound(p_dm); + } else + phydm_set_edcca_threshold(p_dm, 0x7f, 0x7f); /*resume to no link state*/ +#endif + /*forgetting factor setting*/ + phydm_set_forgetting_factor(p_dm); + + /*pwdb mode setting with 0: mean, 1:max*/ + phydm_set_pwdb_mode(p_dm); + + /*we need to consider PwdB upper bound for 8814 later IC*/ + adaptivity->adajust_igi_level = (u8)((p_dm->th_l2h_ini + igi_target) - pwdb_upper_bound + dfir_loss); /*IGI = L2H - PwdB - dfir_loss*/ + + /*Check this later on Windows*/ + /*phydm_set_edcca_threshold_api(p_dm, p_dig_t->cur_ig_value);*/ + + p_dm->adaptivity_flag = (p_dm->support_ic_type & ODM_IC_GAIN_IDX_EDCCA) ? false : true; + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + adaptivity->igi_up_bound_lmt_val = 180; +#else + adaptivity->igi_up_bound_lmt_val = 90; +#endif + adaptivity->igi_up_bound_lmt_cnt = 0; + adaptivity->igi_lmt_en = false; + +} + + +void +phydm_adaptivity( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u8 igi = p_dig_t->cur_ig_value; + s8 th_l2h_dmc, th_h2l_dmc; + s8 diff = 0, igi_target = 0x32; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *p_adapter = p_dm->adapter; + u32 is_fw_current_in_ps_mode = false; + u8 disable_ap_adapt_setting; + + p_adapter->HalFunc.GetHwRegHandler(p_adapter, HW_VAR_FW_PSMODE_STATUS, (u8 *)(&is_fw_current_in_ps_mode)); + + /*Disable EDCCA mode while under LPS mode, added by Roger, 2012.09.14.*/ + if (is_fw_current_in_ps_mode) + return; +#endif + + if ((p_dm->edcca_enable == false) || (adaptivity->is_stop_edcca == true)) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("Disable EDCCA!!!\n")); + return; + } + + phydm_check_adaptivity(p_dm); /*Check adaptivity enable*/ + phydm_dig_up_bound_lmt_en(p_dm); + + if ((!(p_dm->support_ability & ODM_BB_ADAPTIVITY)) && adaptivity->debug_mode == false) { + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("adaptivity disable, enable EDCCA mode!!!\n")); + p_dm->th_l2h_ini = p_dm->th_l2h_ini_mode2; + p_dm->th_edcca_hl_diff = p_dm->th_edcca_hl_diff_mode2; + } +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + else if (adaptivity->debug_mode == false) { + disable_ap_adapt_setting = false; + if (p_dm->p_soft_ap_mode != NULL) { + if (*(p_dm->p_soft_ap_mode) != 0 && (p_dm->soft_ap_special_setting & BIT(0))) + disable_ap_adapt_setting = true; + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("p_dm->soft_ap_special_setting = %x, *(p_dm->p_soft_ap_mode) = %d, disable_ap_adapt_setting = %d\n", p_dm->soft_ap_special_setting, *(p_dm->p_soft_ap_mode), disable_ap_adapt_setting)); + } + if (phydm_check_channel_plan(p_dm) || (p_dm->ap_total_num > adaptivity->ap_num_th) || disable_ap_adapt_setting) { + p_dm->th_l2h_ini = p_dm->th_l2h_ini_mode2; + p_dm->th_edcca_hl_diff = p_dm->th_edcca_hl_diff_mode2; + } else { + p_dm->th_l2h_ini = adaptivity->th_l2h_ini_backup; + p_dm->th_edcca_hl_diff = adaptivity->th_edcca_hl_diff_backup; + } + } +#endif + else if (adaptivity->debug_mode == true) { + p_dm->th_l2h_ini = adaptivity->th_l2h_ini_debug; + p_dm->th_edcca_hl_diff = 7; + adaptivity->adajust_igi_level = (u8)((p_dm->th_l2h_ini + igi_target) - pwdb_upper_bound + dfir_loss); /*IGI = L2H - PwdB - dfir_loss*/ + } + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("odm_Adaptivity() =====>\n")); + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("igi_base=0x%x, th_l2h_ini = %d, th_edcca_hl_diff = %d\n", + adaptivity->igi_base, p_dm->th_l2h_ini, p_dm->th_edcca_hl_diff)); +#if (RTL8195A_SUPPORT == 0) + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + /*fix AC series when enable EDCCA hang issue*/ + odm_set_bb_reg(p_dm, 0x800, BIT(10), 1); /*ADC_mask disable*/ + odm_set_bb_reg(p_dm, 0x800, BIT(10), 0); /*ADC_mask enable*/ + } +#endif + + igi_target = adaptivity->igi_base; + adaptivity->igi_target = (u8) igi_target; + + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("band_width=%s, igi_target=0x%x, dynamic_link_adaptivity = %d\n", + (*p_dm->p_band_width == CHANNEL_WIDTH_80) ? "80M" : ((*p_dm->p_band_width == CHANNEL_WIDTH_40) ? "40M" : "20M"), igi_target, adaptivity->dynamic_link_adaptivity)); + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("adajust_igi_level= 0x%x, adaptivity_flag = %d, adaptivity_enable = %d\n", + adaptivity->adajust_igi_level, p_dm->adaptivity_flag, p_dm->adaptivity_enable)); + + if ((adaptivity->dynamic_link_adaptivity == true) && (!p_dm->is_linked) && (p_dm->adaptivity_enable == false)) { + phydm_set_edcca_threshold(p_dm, 0x7f, 0x7f); + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("In DynamicLink mode(noisy) and No link, Turn off EDCCA!!\n")); + return; + } + + if (p_dm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { + if ((adaptivity->adajust_igi_level > igi) && (p_dm->adaptivity_enable == true)) + diff = adaptivity->adajust_igi_level - igi; + else if (p_dm->adaptivity_enable == false) + diff = 0x3e - igi; + + th_l2h_dmc = p_dm->th_l2h_ini - diff + igi_target; + th_h2l_dmc = th_l2h_dmc - p_dm->th_edcca_hl_diff; + } +#if (RTL8195A_SUPPORT == 0) + else { + diff = igi_target - (s8)igi; + th_l2h_dmc = p_dm->th_l2h_ini + diff; + if (th_l2h_dmc > 10 && (p_dm->adaptivity_enable == true)) + th_l2h_dmc = 10; + + th_h2l_dmc = th_l2h_dmc - p_dm->th_edcca_hl_diff; + + /*replace lower bound to prevent EDCCA always equal 1*/ + if (th_h2l_dmc < adaptivity->h2l_lb) + th_h2l_dmc = adaptivity->h2l_lb; + if (th_l2h_dmc < adaptivity->l2h_lb) + th_l2h_dmc = adaptivity->l2h_lb; + } +#endif + adaptivity->th_l2h = th_l2h_dmc; + adaptivity->th_h2l = th_h2l_dmc; + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("IGI=0x%x, th_l2h_dmc = %d, th_h2l_dmc = %d\n", igi, th_l2h_dmc, th_h2l_dmc)); + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("adapt_igi_up=0x%x, h2l_lb = 0x%x, l2h_lb = 0x%x\n", adaptivity->adapt_igi_up, adaptivity->h2l_lb, adaptivity->l2h_lb)); + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("debug_mode = %d\n", adaptivity->debug_mode)); + phydm_set_edcca_threshold(p_dm, th_h2l_dmc, th_l2h_dmc); + + if (p_dm->adaptivity_enable == true) + odm_set_mac_reg(p_dm, REG_RD_CTRL, BIT(11), 1); + + return; +} + +/*This API is for solving USB can't Tx problem due to USB3.0 interference in 2.4G*/ +void +phydm_pause_edcca( + void *p_dm_void, + boolean is_pasue_edcca +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u8 IGI = p_dig_t->cur_ig_value; + s8 diff = 0; + + if (is_pasue_edcca) { + adaptivity->is_stop_edcca = true; + + if (p_dm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { + if (adaptivity->adajust_igi_level > IGI) + diff = adaptivity->adajust_igi_level - IGI; + + adaptivity->backup_l2h = p_dm->th_l2h_ini - diff + adaptivity->igi_target; + adaptivity->backup_h2l = adaptivity->backup_l2h - p_dm->th_edcca_hl_diff; + } +#if (RTL8195A_SUPPORT == 0) + else { + diff = adaptivity->igi_target - (s8)IGI; + adaptivity->backup_l2h = p_dm->th_l2h_ini + diff; + if (adaptivity->backup_l2h > 10) + adaptivity->backup_l2h = 10; + + adaptivity->backup_h2l = adaptivity->backup_l2h - p_dm->th_edcca_hl_diff; + + /*replace lower bound to prevent EDCCA always equal 1*/ + if (adaptivity->backup_h2l < adaptivity->h2l_lb) + adaptivity->backup_h2l = adaptivity->h2l_lb; + if (adaptivity->backup_l2h < adaptivity->l2h_lb) + adaptivity->backup_l2h = adaptivity->l2h_lb; + } +#endif + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("pauseEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", adaptivity->backup_l2h, adaptivity->backup_h2l, IGI)); + + /*Disable EDCCA*/ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (odm_is_work_item_scheduled(&(adaptivity->phydm_pause_edcca_work_item)) == false) + odm_schedule_work_item(&(adaptivity->phydm_pause_edcca_work_item)); +#else + phydm_pause_edcca_work_item_callback(p_dm); +#endif + + } else { + + adaptivity->is_stop_edcca = false; + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("resumeEDCCA : L2Hbak = 0x%x, H2Lbak = 0x%x, IGI = 0x%x\n", adaptivity->backup_l2h, adaptivity->backup_h2l, IGI)); + /*Resume EDCCA*/ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (odm_is_work_item_scheduled(&(adaptivity->phydm_resume_edcca_work_item)) == false) + odm_schedule_work_item(&(adaptivity->phydm_resume_edcca_work_item)); +#else + phydm_resume_edcca_work_item_callback(p_dm); +#endif + + } + +} + + +void +phydm_pause_edcca_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + odm_set_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, MASKBYTE2 | MASKBYTE0, (u32)(0x7f | 0x7f << 16)); +#if (RTL8195A_SUPPORT == 0) + else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_set_bb_reg(p_dm, REG_FPGA0_XB_LSSI_READ_BACK, MASKLWORD, (u16)(0x7f | 0x7f << 8)); +#endif + +} + +void +phydm_resume_edcca_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + odm_set_bb_reg(p_dm, REG_OFDM_0_ECCA_THRESHOLD, MASKBYTE2 | MASKBYTE0, (u32)((u8)adaptivity->backup_l2h | (u8)adaptivity->backup_h2l << 16)); +#if (RTL8195A_SUPPORT == 0) + else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + odm_set_bb_reg(p_dm, REG_FPGA0_XB_LSSI_READ_BACK, MASKLWORD, (u16)((u8)adaptivity->backup_l2h | (u8)adaptivity->backup_h2l << 8)); +#endif + +} + + +void +phydm_set_edcca_threshold_api( + void *p_dm_void, + u8 IGI +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + s8 th_l2h_dmc, th_h2l_dmc; + s8 diff = 0, igi_target = 0x32; + + if (p_dm->support_ability & ODM_BB_ADAPTIVITY) { + if (p_dm->support_ic_type & (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { + if (adaptivity->adajust_igi_level > IGI) + diff = adaptivity->adajust_igi_level - IGI; + + th_l2h_dmc = p_dm->th_l2h_ini - diff + igi_target; + th_h2l_dmc = th_l2h_dmc - p_dm->th_edcca_hl_diff; + } +#if (RTL8195A_SUPPORT == 0) + else { + diff = igi_target - (s8)IGI; + th_l2h_dmc = p_dm->th_l2h_ini + diff; + if (th_l2h_dmc > 10) + th_l2h_dmc = 10; + + th_h2l_dmc = th_l2h_dmc - p_dm->th_edcca_hl_diff; + + /*replace lower bound to prevent EDCCA always equal 1*/ + if (th_h2l_dmc < adaptivity->h2l_lb) + th_h2l_dmc = adaptivity->h2l_lb; + if (th_l2h_dmc < adaptivity->l2h_lb) + th_l2h_dmc = adaptivity->l2h_lb; + } +#endif + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("API :IGI=0x%x, th_l2h_dmc = %d, th_h2l_dmc = %d\n", IGI, th_l2h_dmc, th_h2l_dmc)); + PHYDM_DBG(p_dm, DBG_ADPTVTY, ("API :adapt_igi_up=0x%x, h2l_lb = 0x%x, l2h_lb = 0x%x\n", adaptivity->adapt_igi_up, adaptivity->h2l_lb, adaptivity->l2h_lb)); + + phydm_set_edcca_threshold(p_dm, th_h2l_dmc, th_l2h_dmc); + } +} + +void +phydm_adaptivity_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + u32 used = *_used; + u32 out_len = *_out_len; + u32 reg_value32; + s8 h2l_diff = 0; + + if (dm_value[0] == PHYDM_ADAPT_DEBUG) { + PHYDM_SNPRINTF((output + used, out_len - used, "Adaptivity Debug Mode ===>\n")); + adaptivity->debug_mode = true; + adaptivity->th_l2h_ini_debug = (s8)dm_value[1]; + PHYDM_SNPRINTF((output + used, out_len - used, "th_l2h_ini_debug = %d\n", adaptivity->th_l2h_ini_debug)); + } else if (dm_value[0] == PHYDM_ADAPT_RESUME) { + PHYDM_SNPRINTF((output + used, out_len - used, "===> Adaptivity Resume\n")); + adaptivity->debug_mode = false; + } else if (dm_value[0] == PHYDM_EDCCA_TH_PAUSE) { + PHYDM_SNPRINTF((output + used, out_len - used, "EDCCA Threshold Pause\n")); + p_dm->edcca_enable = false; + } else if (dm_value[0] == PHYDM_EDCCA_RESUME) { + PHYDM_SNPRINTF((output + used, out_len - used, "EDCCA Resume\n")); + p_dm->edcca_enable = true; + } else if (dm_value[0] == PHYDM_ADAPT_MSG) { + PHYDM_SNPRINTF((output + used, out_len - used, "debug_mode = %s, th_l2h_ini = %d\n", (adaptivity->debug_mode ? "TRUE" : "FALSE"), p_dm->th_l2h_ini)); + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + reg_value32 = odm_get_bb_reg(p_dm, 0xc4c, MASKDWORD); + h2l_diff = (s8)(0x000000ff & reg_value32) - (s8)((0x00ff0000 & reg_value32)>>16); + } +#if (RTL8195A_SUPPORT == 0) + else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg_value32 = odm_get_bb_reg(p_dm, 0x8a4, MASKDWORD); + h2l_diff = (s8)(0x000000ff & reg_value32) - (s8)((0x0000ff00 & reg_value32)>>8); + } +#endif + if (h2l_diff == 7) + PHYDM_SNPRINTF((output + used, out_len - used, "adaptivity is enabled\n")); + else + PHYDM_SNPRINTF((output + used, out_len - used, "adaptivity is disabled\n")); + } + *_used = used; + *_out_len = out_len; +} + +void +phydm_set_l2h_th_ini( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + if (p_dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814A)) + p_dm->th_l2h_ini = 0xf2; + else + p_dm->th_l2h_ini = 0xef; + } else + p_dm->th_l2h_ini = 0xf5; +} + +void +phydm_set_forgetting_factor( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814A)) + odm_set_bb_reg(p_dm, 0x8a0, BIT(1) | BIT(0), 0); +} + +void +phydm_set_pwdb_mode( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ability & ODM_BB_ADAPTIVITY) { + if (p_dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(p_dm, 0x8dc, BIT(5), 0x1); + else if (p_dm->support_ic_type & ODM_RTL8197F) + odm_set_bb_reg(p_dm, 0xce8, BIT(13), 0x1); + } else { + if (p_dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(p_dm, 0x8dc, BIT(5), 0x0); + else if (p_dm->support_ic_type & ODM_RTL8197F) + odm_set_bb_reg(p_dm, 0xce8, BIT(13), 0x0); + } +} + +void +phydm_set_edcca_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (val_len != 2) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[Error][adaptivity]Need val_len = 2\n")); + return; + } + if (p_dm->pause_ability & BIT(F13_ADPTVTY)) + p_dm->adaptivity.is_stop_edcca = true; + else + p_dm->adaptivity.is_stop_edcca = false; + + phydm_set_edcca_threshold(p_dm, (s8)val_buf[1], (s8)val_buf[0]); +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.h index 246fb58af41f..3c58943f020c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adaptivity.h @@ -1,222 +1,207 @@ - -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMADAPTIVITY_H__ -#define __PHYDMADAPTIVITY_H__ - -#define ADAPTIVITY_VERSION "9.3.4" /*20160512 changed by Kevin, modify 0xce8[13]=1 for 8197F when adaptivity is enabled*/ - -#define PwdBUpperBound 7 -#define DFIRloss 5 - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -typedef enum _tag_PhyDM_REGULATION_Type { - REGULATION_FCC = 0, - REGULATION_MKK = 1, - REGULATION_ETSI = 2, - REGULATION_WW = 3, - - MAX_REGULATION_NUM = 4 -} PhyDM_REGULATION_TYPE; -#endif - -typedef enum _PHYDM_ADAPTIVITY_Info_Definition { - PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE = 0, - PHYDM_ADAPINFO_DCBACKOFF, - PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, - PHYDM_ADAPINFO_TH_L2H_INI, - PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, - PHYDM_ADAPINFO_AP_NUM_TH - -} PHYDM_ADAPINFO_E; - - - -typedef enum tag_PhyDM_set_LNA { - PhyDM_disable_LNA = 0, - PhyDM_enable_LNA = 1, -} PhyDM_set_LNA; - - -typedef enum tag_PhyDM_TRx_MUX_Type -{ - PhyDM_SHUTDOWN = 0, - PhyDM_STANDBY_MODE = 1, - PhyDM_TX_MODE = 2, - PhyDM_RX_MODE = 3 -}PhyDM_Trx_MUX_Type; - -typedef enum tag_PhyDM_MACEDCCA_Type -{ - PhyDM_IGNORE_EDCCA = 0, - PhyDM_DONT_IGNORE_EDCCA = 1 -}PhyDM_MACEDCCA_Type; - -typedef struct _ADAPTIVITY_STATISTICS { - s1Byte TH_L2H_ini_backup; - s1Byte TH_EDCCA_HL_diff_backup; - s1Byte IGI_Base; - u1Byte IGI_target; - u1Byte NHMWait; - s1Byte H2L_lb; - s1Byte L2H_lb; - BOOLEAN bFirstLink; - BOOLEAN bCheck; - BOOLEAN DynamicLinkAdaptivity; - u1Byte APNumTH; - u1Byte AdajustIGILevel; - BOOLEAN AcsForAdaptivity; - s1Byte backupL2H; - s1Byte backupH2L; - BOOLEAN bStopEDCCA; -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - RT_WORK_ITEM phydm_pauseEDCCAWorkItem; - RT_WORK_ITEM phydm_resumeEDCCAWorkItem; -#endif -} ADAPTIVITY_STATISTICS, *PADAPTIVITY_STATISTICS; - -VOID -phydm_pauseEDCCA( - IN PVOID pDM_VOID, - IN BOOLEAN bPasueEDCCA -); - -VOID -Phydm_CheckAdaptivity( - IN PVOID pDM_VOID - ); - -VOID -Phydm_CheckEnvironment( - IN PVOID pDM_VOID - ); - -VOID -Phydm_NHMCounterStatisticsInit( - IN PVOID pDM_VOID - ); - -VOID -Phydm_NHMCounterStatistics( - IN PVOID pDM_VOID - ); - -VOID -Phydm_NHMCounterStatisticsReset( - IN PVOID pDM_VOID -); - -VOID -Phydm_GetNHMCounterStatistics( - IN PVOID pDM_VOID -); - -VOID -Phydm_MACEDCCAState( - IN PVOID pDM_VOID, - IN PhyDM_MACEDCCA_Type State -); - -VOID -Phydm_SetEDCCAThreshold( - IN PVOID pDM_VOID, - IN s1Byte H2L, - IN s1Byte L2H -); - -VOID -Phydm_SetTRxMux( - IN PVOID pDM_VOID, - IN PhyDM_Trx_MUX_Type txMode, - IN PhyDM_Trx_MUX_Type rxMode -); - -BOOLEAN -Phydm_CalNHMcnt( - IN PVOID pDM_VOID -); - -VOID -Phydm_SearchPwdBLowerBound( - IN PVOID pDM_VOID -); - -VOID -phydm_adaptivityInfoInit( - IN PVOID pDM_VOID, - IN PHYDM_ADAPINFO_E CmnInfo, - IN u4Byte Value - ); - -VOID -Phydm_AdaptivityInit( - IN PVOID pDM_VOID - ); - -VOID -Phydm_Adaptivity( - IN PVOID pDM_VOID, - IN u1Byte IGI - ); - -VOID -phydm_setEDCCAThresholdAPI( - IN PVOID pDM_VOID, - IN u1Byte IGI -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -Phydm_DisableEDCCA( - IN PVOID pDM_VOID -); - -VOID -Phydm_DynamicEDCCA( - IN PVOID pDM_VOID -); - -VOID -Phydm_AdaptivityBSOD( - IN PVOID pDM_VOID -); - -#endif - -VOID -phydm_pauseEDCCA_WorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -phydm_resumeEDCCA_WorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDMADAPTIVITY_H__ +#define __PHYDMADAPTIVITY_H__ + +#define ADAPTIVITY_VERSION "9.5.7" /*20170627 changed by Kevin, move adapt_igi_up from phydm.h to phydm_adaptivity.h*/ + +#define pwdb_upper_bound 7 +#define dfir_loss 7 + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) +enum phydm_regulation_type { + REGULATION_FCC = 0, + REGULATION_MKK = 1, + REGULATION_ETSI = 2, + REGULATION_WW = 3, + MAX_REGULATION_NUM = 4 +}; +#endif + +enum phydm_adapinfo_e { + PHYDM_ADAPINFO_CARRIER_SENSE_ENABLE = 0, + PHYDM_ADAPINFO_DCBACKOFF, + PHYDM_ADAPINFO_DYNAMICLINKADAPTIVITY, + PHYDM_ADAPINFO_TH_L2H_INI, + PHYDM_ADAPINFO_TH_EDCCA_HL_DIFF, + PHYDM_ADAPINFO_AP_NUM_TH +}; + +enum phydm_set_lna { + phydm_disable_lna = 0, + phydm_enable_lna = 1, +}; + +enum phydm_trx_mux_type { + phydm_shutdown = 0, + phydm_standby_mode = 1, + phydm_tx_mode = 2, + phydm_rx_mode = 3 +}; + +enum phydm_mac_edcca_type { + phydm_ignore_edcca = 0, + phydm_dont_ignore_edcca = 1 +}; + +enum phydm_adaptivity_mode { + PHYDM_ADAPT_MSG = 0, + PHYDM_ADAPT_DEBUG = 1, + PHYDM_ADAPT_RESUME = 2, + PHYDM_EDCCA_TH_PAUSE = 3, + PHYDM_EDCCA_RESUME = 4 +}; + +struct phydm_adaptivity_struct { + s8 th_l2h_ini_backup; + s8 th_edcca_hl_diff_backup; + s8 igi_base; + u8 igi_target; + s8 h2l_lb; + s8 l2h_lb; + boolean is_check; + boolean dynamic_link_adaptivity; + u8 ap_num_th; + u8 adajust_igi_level; + s8 backup_l2h; + s8 backup_h2l; + boolean is_stop_edcca; +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_WORK_ITEM phydm_pause_edcca_work_item; + RT_WORK_ITEM phydm_resume_edcca_work_item; +#endif + u32 adaptivity_dbg_port; /*N:0x208, AC:0x209*/ + u8 debug_mode; + s8 th_l2h_ini_debug; + u16 igi_up_bound_lmt_cnt; /*When igi_up_bound_lmt_cnt !=0, limit IGI upper bound to "adapt_igi_up"*/ + u16 igi_up_bound_lmt_val; /*max value of igi_up_bound_lmt_cnt*/ + boolean igi_lmt_en; + u8 adapt_igi_up; + s8 rvrt_val[2]; + s8 th_l2h; + s8 th_h2l; +}; + +void +phydm_pause_edcca( + void *p_dm_void, + boolean is_pasue_edcca +); + +void +phydm_check_environment( + void *p_dm_void +); + +void +phydm_mac_edcca_state( + void *p_dm_void, + enum phydm_mac_edcca_type state +); + +void +phydm_set_edcca_threshold( + void *p_dm_void, + s8 H2L, + s8 L2H +); + +void +phydm_set_trx_mux( + void *p_dm_void, + enum phydm_trx_mux_type tx_mode, + enum phydm_trx_mux_type rx_mode +); + +void +phydm_search_pwdb_lower_bound( + void *p_dm_void +); + +void +phydm_adaptivity_info_init( + void *p_dm_void, + enum phydm_adapinfo_e cmn_info, + u32 value +); + +void +phydm_adaptivity_init( + void *p_dm_void +); + +void +phydm_adaptivity( + void *p_dm_void +); + +void +phydm_set_edcca_threshold_api( + void *p_dm_void, + u8 IGI +); + +void +phydm_pause_edcca_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +phydm_resume_edcca_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +phydm_adaptivity_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_set_l2h_th_ini( + void *p_dm_void +); + +void +phydm_set_forgetting_factor( + void *p_dm_void +); + +void +phydm_set_pwdb_mode( + void *p_dm_void +); + +void +phydm_set_edcca_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.c index eb31ef924e20..9ce6f1150131 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.c @@ -1,374 +1,767 @@ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -#if ((RTL8197F_SUPPORT == 1)||(RTL8822B_SUPPORT == 1)) -#include "rtl8197f/Hal8197FPhyReg.h" -#include "WlanHAL/HalMac88XX/halmac_reg2.h" -#else -#include "WlanHAL/HalHeader/HalComReg.h" -#endif -#endif - -#if (PHYDM_LA_MODE_SUPPORT == 1) - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -BOOLEAN -ADCSmp_BufferAllocate( - IN PADAPTER Adapter, - IN PRT_ADCSMP AdcSmp - ) -{ - PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); - - if (ADCSmpBuf->Length == 0) { - if (PlatformAllocateMemoryWithZero(Adapter, (void **)&(ADCSmpBuf->Octet), ADCSmpBuf->buffer_size) == RT_STATUS_SUCCESS) - ADCSmpBuf->Length = ADCSmpBuf->buffer_size; - else - return FALSE; - } - - return TRUE; -} -#endif - -VOID -ADCSmp_GetTxPktBuf( - IN PVOID pDM_VOID, - IN PRT_ADCSMP_STRING ADCSmpBuf - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte i = 0, value32, DataL = 0, DataH = 0; - u4Byte Addr, Finish_Addr; - u4Byte End_Addr = (ADCSmpBuf->start_pos + ADCSmpBuf->buffer_size)-1; /*End_Addr = 0x3ffff;*/ - BOOLEAN bRoundUp; - static u4Byte page = 0xFF; - u4Byte while_cnt = 0; - - ODM_Memory_Set(pDM_Odm, ADCSmpBuf->Octet, 0, ADCSmpBuf->Length); - ODM_Write1Byte(pDM_Odm, 0x0106, 0x69); - - DbgPrint("%s\n", __func__); - - value32 = ODM_Read4Byte(pDM_Odm, 0x7c0); - bRoundUp = (BOOLEAN)((value32 & BIT31) >> 31); - Finish_Addr = (value32 & 0x7FFF0000) >> 16; /*Reg7C0[30:16]: finish addr (unit: 8byte)*/ - - if (bRoundUp) - Addr = (Finish_Addr+1)<<3; - else - Addr = ADCSmpBuf->start_pos; - - DbgPrint("bRoundUp = %d, Finish_Addr=0x%x, value32=0x%x\n", bRoundUp, Finish_Addr, value32); - DbgPrint("End_Addr = %x, ADCSmpBuf->start_pos = 0x%x, ADCSmpBuf->buffer_size = 0x%x\n", End_Addr, ADCSmpBuf->start_pos, ADCSmpBuf->buffer_size); - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_stop(pDM_Odm->priv); -#endif - - if (pDM_Odm->SupportICType & ODM_RTL8197F) { - for (Addr = 0x0, i = 0; Addr < End_Addr; Addr += 8, i += 2) { /*64K byte*/ - if ((Addr&0xfff) == 0) - ODM_SetBBReg(pDM_Odm, 0x0140, bMaskLWord, 0x780+(Addr >> 12)); - DataL = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff), bMaskDWord); - DataH = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff)+4, bMaskDWord); - - DbgPrint("%08x%08x\n", DataH, DataL); - } - } else { - while (Addr != (Finish_Addr<<3)) { - if (page != (Addr >> 12)) { - /*Reg140=0x780+(Addr>>12), Addr=0x30~0x3F, total 16 pages*/ - page = (Addr >> 12); - } - ODM_SetBBReg(pDM_Odm, 0x0140, bMaskLWord, 0x780+page); - - /*pDataL = 0x8000+(Addr&0xfff);*/ - DataL = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff), bMaskDWord); - DataH = ODM_GetBBReg(pDM_Odm, 0x8000+(Addr&0xfff)+4, bMaskDWord); - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - ADCSmpBuf->Octet[i] = DataH; - ADCSmpBuf->Octet[i+1] = DataL; -#endif - DbgPrint("%08x%08x\n", DataH, DataL); - i = i + 2; - - if ((Addr+8) >= End_Addr) - Addr = ADCSmpBuf->start_pos; - else - Addr = Addr + 8; - - while_cnt = while_cnt + 1; - if (while_cnt > ((ADCSmpBuf->buffer_size)>>3)) - break; - } - } - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_resume(pDM_Odm->priv); -#endif -} - - -VOID -ADCSmp_Start( - IN PVOID pDM_VOID, - IN PRT_ADCSMP AdcSmp - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte tmpU1b; - PRT_ADCSMP_STRING Buffer = &(AdcSmp->ADCSmpBuf); - RT_ADCSMP_TRIG_SIG_SEL TrigSigSel = AdcSmp->ADCSmpTrigSigSel; - u1Byte backup_DMA, while_cnt = 0; - - DbgPrint("%s\n", __func__); - - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ODM_SetBBReg(pDM_Odm, 0x9a0, 0xf00, AdcSmp->ADCSmpDmaDataSigSel); /*0x9A0[11:8]*/ - else - ODM_SetBBReg(pDM_Odm , ODM_ADC_TRIGGER_Jaguar2, 0xf00, AdcSmp->ADCSmpDmaDataSigSel); /*0x95C[11:8]*/ - - ODM_Write1Byte(pDM_Odm, 0x7c0+1, AdcSmp->ADCSmpTriggerTime); - - - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ODM_SetBBReg(pDM_Odm, 0xd00, BIT26, 0x1); - else { /*for 8814A and 8822B?*/ - ODM_Write1Byte(pDM_Odm, 0x198c, 0x7); - ODM_Write1Byte(pDM_Odm, 0x8b4, 0x80); - } - - if (AdcSmp->ADCSmpTrigSel == ADCSMP_MAC_TRIG) { /* trigger by MAC*/ - if (TrigSigSel == ADCSMP_TRIG_REG) { /* manual trigger 0x7C0[5] = 0 -> 1*/ - ODM_Write1Byte(pDM_Odm, 0x7c0, 0xCB); /*0x7C0[7:0]=8'b1100_1011*/ - ODM_Write1Byte(pDM_Odm, 0x7c0, 0xEB); /*0x7C0[7:0]=8'b1110_1011*/ - } else if (TrigSigSel == ADCSMP_TRIG_CCA) - ODM_Write1Byte(pDM_Odm, 0x7c0, 0x8B); /*0x7C0[7:0]=8'b1000_1011*/ - else if (TrigSigSel == ADCSMP_TRIG_CRCFAIL) - ODM_Write1Byte(pDM_Odm, 0x7c0, 0x4B); /*0x7C0[7:0]=8'b0100_1011*/ - else if (TrigSigSel == ADCSMP_TRIG_CRCOK) - ODM_Write1Byte(pDM_Odm, 0x7c0, 0x0B); /*0x7C0[7:0]=8'b0000_1011*/ - } else { /*trigger by BB*/ - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ODM_SetBBReg(pDM_Odm, 0x9a0, 0x1f, TrigSigSel); /*0x9A0[4:0]*/ - else - ODM_SetBBReg(pDM_Odm , ODM_ADC_TRIGGER_Jaguar2, 0x1f, TrigSigSel); /*0x95C[4:0], 0x1F: trigger by CCA*/ - ODM_Write1Byte(pDM_Odm, 0x7c0, 0x03); /*0x7C0[7:0]=8'b0000_0011*/ - } - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_stop(pDM_Odm->priv); -#endif - - /*Polling time always use 100ms, when it exceed 2s, break while loop*/ - do { - tmpU1b = ODM_Read1Byte(pDM_Odm, 0x7c0); - - if (AdcSmp->ADCSmpState != ADCSMP_STATE_SET) { - DbgPrint("ADCSmpState != ADCSMP_STATE_SET\n"); - break; - - } else if (tmpU1b & BIT1) { - ODM_delay_ms(100); - while_cnt = while_cnt + 1; - continue; - } else { - DbgPrint("%s Query OK\n", __func__); - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ODM_SetBBReg(pDM_Odm, 0x7c0, BIT0, 0x0); - break; - } - } while (while_cnt < 20); - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - watchdog_resume(pDM_Odm->priv); -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) { - /*Stop DMA*/ - backup_DMA = ODM_GetMACReg(pDM_Odm, 0x300, bMaskLWord); - ODM_SetMACReg(pDM_Odm, 0x300, 0x7fff, backup_DMA|0x7fff); - - /*move LA mode content from IMEM to TxPktBuffer - Src : OCPBASE_IMEM 0x00000000 - Dest : OCPBASE_TXBUF 0x18780000 - Len : 64K*/ - GET_HAL_INTERFACE(pDM_Odm->priv)->InitDDMAHandler(pDM_Odm->priv, OCPBASE_IMEM, OCPBASE_TXBUF, 0x10000); - } -#endif -#endif - - if (AdcSmp->ADCSmpState == ADCSMP_STATE_SET) - ADCSmp_GetTxPktBuf(pDM_Odm, Buffer); - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ODM_SetMACReg(pDM_Odm, 0x300, 0x7fff, backup_DMA); /*Resume DMA*/ -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (AdcSmp->ADCSmpState == ADCSMP_STATE_SET) - AdcSmp->ADCSmpState = ADCSMP_STATE_QUERY; -#endif - - DbgPrint("%s Status %d\n", __func__, AdcSmp->ADCSmpState); -} - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -VOID -ADCSmpWorkItemCallback( - IN PVOID pContext - ) -{ - PADAPTER Adapter = (PADAPTER)pContext; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); - - ADCSmp_Start(pDM_Odm, AdcSmp); - ADCSmp_Stop(pDM_Odm); -} -#endif - -VOID -ADCSmp_Set( - IN PVOID pDM_VOID, - IN RT_ADCSMP_TRIG_SEL TrigSel, - IN RT_ADCSMP_TRIG_SIG_SEL TrigSigSel, - IN u1Byte DmaDataSigSel, - IN u1Byte TriggerTime, - IN u2Byte PollingTime - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - BOOLEAN retValue = TRUE; - PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); - - AdcSmp->ADCSmpTrigSel = TrigSel; - AdcSmp->ADCSmpTrigSigSel = TrigSigSel; - AdcSmp->ADCSmpDmaDataSigSel = DmaDataSigSel; - AdcSmp->ADCSmpTriggerTime = TriggerTime; - AdcSmp->ADCSmpPollingTime = PollingTime; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (AdcSmp->ADCSmpState != ADCSMP_STATE_IDLE) - retValue = FALSE; - else if (AdcSmp->ADCSmpBuf.Length == 0) - retValue = ADCSmp_BufferAllocate(pDM_Odm->Adapter, AdcSmp); -#endif - - if (retValue) { - AdcSmp->ADCSmpState = ADCSMP_STATE_SET; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - ODM_ScheduleWorkItem(&(AdcSmp->ADCSmpWorkItem)); -#else - ADCSmp_Start(pDM_Odm, AdcSmp); -#endif - } - - DbgPrint("ADCSmpState %d Return Status %d\n", AdcSmp->ADCSmpState, retValue); -} - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -RT_STATUS -ADCSmp_Query( - IN PVOID pDM_VOID, - IN ULONG InformationBufferLength, - OUT PVOID InformationBuffer, - OUT PULONG BytesWritten - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); - RT_STATUS retStatus = RT_STATUS_SUCCESS; - PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); - - DbgPrint("%s ADCSmpState %d", __func__, AdcSmp->ADCSmpState); - - if (InformationBufferLength != ADCSmpBuf->buffer_size) { - *BytesWritten = 0; - retStatus = RT_STATUS_RESOURCE; - } else if (ADCSmpBuf->Length != ADCSmpBuf->buffer_size) { - *BytesWritten = 0; - retStatus = RT_STATUS_RESOURCE; - } else if (AdcSmp->ADCSmpState != ADCSMP_STATE_QUERY) { - *BytesWritten = 0; - retStatus = RT_STATUS_PENDING; - } else { - ODM_MoveMemory(pDM_Odm, InformationBuffer, ADCSmpBuf->Octet, ADCSmpBuf->buffer_size); - *BytesWritten = ADCSmpBuf->buffer_size; - - AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; - } - - DbgPrint("Return Status %d\n", retStatus); - - return retStatus; -} -#endif - -VOID -ADCSmp_Stop( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); - - AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; - - DbgPrint("%s status %d\n", __func__, AdcSmp->ADCSmpState); -} - -VOID -ADCSmp_Init( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); - PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); - - AdcSmp->ADCSmpState = ADCSMP_STATE_IDLE; - - if (pDM_Odm->SupportICType & ODM_RTL8814A) { - ADCSmpBuf->start_pos = 0x30000; - ADCSmpBuf->buffer_size = 0x10000; - } else if (pDM_Odm->SupportICType & ODM_RTL8822B) { - ADCSmpBuf->start_pos = 0x20000; - ADCSmpBuf->buffer_size = 0x20000; - } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { - ADCSmpBuf->start_pos = 0x00000; - ADCSmpBuf->buffer_size = 0x10000; - } else if (pDM_Odm->SupportICType & ODM_RTL8821C) { - ADCSmpBuf->start_pos = 0x8000; - ADCSmpBuf->buffer_size = 0x8000; - } - -} - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -VOID -ADCSmp_DeInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_ADCSMP AdcSmp = &(pDM_Odm->adcsmp); - PRT_ADCSMP_STRING ADCSmpBuf = &(AdcSmp->ADCSmpBuf); - - ADCSmp_Stop(pDM_Odm); - - if (ADCSmpBuf->Length != 0x0) { - ODM_FreeMemory(pDM_Odm, ADCSmpBuf->Octet, ADCSmpBuf->Length); - ADCSmpBuf->Length = 0x0; - } -} - -#endif - -#endif - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + #if ((RTL8197F_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) + #include "rtl8197f/Hal8197FPhyReg.h" + #include "WlanHAL/HalMac88XX/halmac_reg2.h" + #else + #include "WlanHAL/HalHeader/HalComReg.h" + #endif +#endif + +#if (PHYDM_LA_MODE_SUPPORT == 1) + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + +#if WPP_SOFTWARE_TRACE + #include "phydm_adc_sampling.tmh" +#endif + +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +boolean +phydm_la_buffer_allocate( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; +#endif + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + boolean ret = false; + + dbg_print("[LA mode BufferAllocate]\n"); + + if (adc_smp_buf->length == 0) { + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (PlatformAllocateMemoryWithZero(adapter, (void **)&(adc_smp_buf->octet), adc_smp_buf->buffer_size) != RT_STATUS_SUCCESS) { +#else + odm_allocate_memory(p_dm, (void **)&adc_smp_buf->octet, adc_smp_buf->buffer_size); + if (!adc_smp_buf->octet) { +#endif + ret = false; + } else + adc_smp_buf->length = adc_smp_buf->buffer_size; + ret = true; + } + + return ret; +} +#endif + +void +phydm_la_get_tx_pkt_buf( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + u32 i = 0, value32, data_l = 0, data_h = 0; + u32 addr, finish_addr; + u32 end_addr = (adc_smp_buf->start_pos + adc_smp_buf->buffer_size) - 1; /*end_addr = 0x3ffff;*/ + boolean is_round_up; + static u32 page = 0xFF; + u32 smp_cnt = 0, smp_number = 0, addr_8byte = 0; + u8 backup_dma = 0; + + odm_memory_set(p_dm, adc_smp_buf->octet, 0, adc_smp_buf->length); + odm_write_1byte(p_dm, 0x0106, 0x69); + + dbg_print("GetTxPktBuf\n"); + + value32 = odm_read_4byte(p_dm, 0x7c0); + is_round_up = (boolean)((value32 & BIT(31)) >> 31); + finish_addr = (value32 & 0x7FFF0000) >> 16; /*Reg7C0[30:16]: finish addr (unit: 8byte)*/ + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + #if (RTL8197F_SUPPORT) + if (p_dm->support_ic_type & ODM_RTL8197F) { + odm_set_bb_reg(p_dm, 0x7c0, BIT(0), 0x0); + + /*Stop DMA*/ + backup_dma = odm_get_mac_reg(p_dm, 0x300, MASKLWORD); + odm_set_mac_reg(p_dm, 0x300, 0x7fff, 0x7fff); + + /*move LA mode content from IMEM to TxPktBuffer + Source : OCPBASE_IMEM 0x00000000 + Destination : OCPBASE_TXBUF 0x18780000 + Length : 64K*/ + GET_HAL_INTERFACE(p_dm->priv)->init_ddma_handler(p_dm->priv, OCPBASE_IMEM, OCPBASE_TXBUF, 0x10000); + } + #endif + #endif + + if (is_round_up) { + addr = (finish_addr + 1) << 3; + dbg_print("is_round_up = ((%d)), finish_addr=((0x%x)), 0x7c0=((0x%x))\n", is_round_up, finish_addr, value32); + smp_number = ((adc_smp_buf->buffer_size) >> 3); /*Byte to 8Byte (64bit)*/ + } else { + addr = adc_smp_buf->start_pos; + addr_8byte = addr >> 3; + + if (addr_8byte > finish_addr) + smp_number = addr_8byte - finish_addr; + else + smp_number = finish_addr - addr_8byte; + + dbg_print("is_round_up = ((%d)), finish_addr=((0x%x * 8Byte)), Start_Addr = ((0x%x * 8Byte)), smp_number = ((%d))\n", is_round_up, finish_addr, addr_8byte, smp_number); + + } + /* + dbg_print("is_round_up = %d, finish_addr=0x%x, value32=0x%x\n", is_round_up, finish_addr, value32); + dbg_print("end_addr = %x, adc_smp_buf->start_pos = 0x%x, adc_smp_buf->buffer_size = 0x%x\n", end_addr, adc_smp_buf->start_pos, adc_smp_buf->buffer_size); + */ + + if (p_dm->support_ic_type & ODM_RTL8197F) { + for (addr = 0x0, i = 0; addr < end_addr; addr += 8, i += 2) { /*64K byte*/ + if ((addr & 0xfff) == 0) + odm_set_bb_reg(p_dm, 0x0140, MASKLWORD, 0x780 + (addr >> 12)); + data_l = odm_get_bb_reg(p_dm, 0x8000 + (addr & 0xfff), MASKDWORD); + data_h = odm_get_bb_reg(p_dm, 0x8000 + (addr & 0xfff) + 4, MASKDWORD); + + dbg_print("%08x%08x\n", data_h, data_l); + } + } else { + + i = 0; + while (addr != (finish_addr << 3)) { + if (page != (addr >> 12)) { + /*Reg140=0x780+(addr>>12), addr=0x30~0x3F, total 16 pages*/ + page = (addr >> 12); + } + odm_set_bb_reg(p_dm, 0x0140, MASKLWORD, 0x780 + page); + + /*pDataL = 0x8000+(addr&0xfff);*/ + data_l = odm_get_bb_reg(p_dm, 0x8000 + (addr & 0xfff), MASKDWORD); + data_h = odm_get_bb_reg(p_dm, 0x8000 + (addr & 0xfff) + 4, MASKDWORD); + + #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + adc_smp_buf->octet[i] = data_h; + adc_smp_buf->octet[i + 1] = data_l; + #endif + + #if DBG /*WIN driver check build*/ + dbg_print("%08x%08x\n", data_h, data_l); + #else /*WIN driver free build*/ + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("%08x%08x\n", adc_smp_buf->octet[i], adc_smp_buf->octet[i + 1])); + #endif + #endif + + i = i + 2; + + if ((addr + 8) >= end_addr) + addr = adc_smp_buf->start_pos; + else + addr = addr + 8; + + smp_cnt++; + if (smp_cnt >= (smp_number - 1)) + break; + } + dbg_print("smp_cnt = ((%d))\n", smp_cnt); + + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("smp_cnt = ((%d))\n", smp_cnt)); + #endif + } + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + #if (RTL8197F_SUPPORT) + if (p_dm->support_ic_type & ODM_RTL8197F) + odm_set_mac_reg(p_dm, 0x300, 0x7fff, backup_dma); /*Resume DMA*/ + #endif + #endif +} + +void +phydm_la_mode_set_mac_iq_dump( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + u32 reg_value; + + odm_write_1byte(p_dm, 0x7c0, 0); /*clear all 0x7c0*/ + odm_set_mac_reg(p_dm, 0x7c0, BIT(0), 1); /*Enable LA mode HW block*/ + + if (adc_smp->la_trig_mode == PHYDM_MAC_TRIG) { + + adc_smp->is_bb_trigger = 0; + odm_set_mac_reg(p_dm, 0x7c0, BIT(2), 1); /*polling bit for MAC mode*/ + odm_set_mac_reg(p_dm, 0x7c0, BIT(4) | BIT(3), adc_smp->la_trigger_edge); /*trigger mode for MAC*/ + + dbg_print("[MAC_trig] ref_mask = ((0x%x)), ref_value = ((0x%x)), dbg_port = ((0x%x))\n", adc_smp->la_mac_mask_or_hdr_sel, adc_smp->la_trig_sig_sel, adc_smp->la_dbg_port); + /*[Set MAC Debug Port]*/ + odm_set_mac_reg(p_dm, 0xF4, BIT(16), 1); + odm_set_mac_reg(p_dm, 0x38, 0xff0000, adc_smp->la_dbg_port); + odm_set_mac_reg(p_dm, 0x7c4, MASKDWORD, adc_smp->la_mac_mask_or_hdr_sel); + odm_set_mac_reg(p_dm, 0x7c8, MASKDWORD, adc_smp->la_trig_sig_sel); + + } else { + + adc_smp->is_bb_trigger = 1; + odm_set_mac_reg(p_dm, 0x7c0, BIT(1), 1); /*polling bit for BB ADC mode*/ + + if (adc_smp->la_trig_mode == PHYDM_ADC_MAC_TRIG) { + + odm_set_mac_reg(p_dm, 0x7c0, BIT(3), 1); /*polling bit for MAC trigger event*/ + odm_set_mac_reg(p_dm, 0x7c0, BIT(7) | BIT(6), adc_smp->la_trig_sig_sel); + + if (adc_smp->la_trig_sig_sel == ADCSMP_TRIG_REG) + odm_set_mac_reg(p_dm, 0x7c0, BIT(5), 1); /* manual trigger 0x7C0[5] = 0->1*/ + } + } + + reg_value = odm_get_bb_reg(p_dm, 0x7c0, 0xff); + dbg_print("4. [Set MAC IQ dump] 0x7c0[7:0] = ((0x%x))\n", reg_value); +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("4. [Set MAC IQ dump] 0x7c0[7:0] = ((0x%x))\n", reg_value)); +#endif + +} + +void +phydm_adc_smp_start( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + u8 tmp_u1b; + u8 while_cnt = 0; + u8 polling_ok = false, target_polling_bit; + + phydm_la_mode_bb_setting(p_dm); + phydm_la_mode_set_trigger_time(p_dm, adc_smp->la_trigger_time); + + if (p_dm->support_ic_type & ODM_RTL8197F) + odm_set_bb_reg(p_dm, 0xd00, BIT(26), 0x1); + else { /*for 8814A and 8822B?*/ + odm_write_1byte(p_dm, 0x8b4, 0x80); + /* odm_set_bb_reg(p_dm, 0x8b4, BIT(7), 1); */ + } + + phydm_la_mode_set_mac_iq_dump(p_dm); + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + watchdog_stop(p_dm->priv); + #endif + + target_polling_bit = (adc_smp->is_bb_trigger) ? BIT(1) : BIT(2); + do { /*Polling time always use 100ms, when it exceed 2s, break while loop*/ + tmp_u1b = odm_read_1byte(p_dm, 0x7c0); + + if (adc_smp->adc_smp_state != ADCSMP_STATE_SET) { + dbg_print("[state Error] adc_smp_state != ADCSMP_STATE_SET\n"); + break; + + } else if (tmp_u1b & target_polling_bit) { + ODM_delay_ms(100); + while_cnt = while_cnt + 1; + continue; + } else { + dbg_print("[LA Query OK] polling_bit=((0x%x))\n", target_polling_bit); + polling_ok = true; + break; + } + } while (while_cnt < 20); + + if (adc_smp->adc_smp_state == ADCSMP_STATE_SET) { + + if (polling_ok) + phydm_la_get_tx_pkt_buf(p_dm); + else + dbg_print("[Polling timeout]\n"); + } + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + watchdog_resume(p_dm->priv); + #endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (adc_smp->adc_smp_state == ADCSMP_STATE_SET) + adc_smp->adc_smp_state = ADCSMP_STATE_QUERY; +#endif + + dbg_print("[LA mode] LA_pattern_count = ((%d))\n", adc_smp->la_count); +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("[LA mode] la_count = ((%d))\n", adc_smp->la_count)); +#endif + + + adc_smp_stop(p_dm); + + if (adc_smp->la_count == 0) { + dbg_print("LA Dump finished ---------->\n\n\n"); + phydm_release_bb_dbg_port(p_dm); + + if ((p_dm->support_ic_type & ODM_RTL8821C) && (p_dm->cut_version >= ODM_CUT_B)) + odm_set_bb_reg(p_dm, 0x95c, BIT(23), 0); + + } else { + adc_smp->la_count--; + dbg_print("LA Dump more ---------->\n\n\n"); + adc_smp_set(p_dm, adc_smp->la_trig_mode, adc_smp->la_trig_sig_sel, adc_smp->la_dma_type, adc_smp->la_trigger_time, 0); + } + +} + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +void +adc_smp_work_item_callback( + void *p_context +) +{ + struct _ADAPTER *adapter = (struct _ADAPTER *)p_context; + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + + dbg_print("[WorkItem Call back] LA_State=((%d))\n", adc_smp->adc_smp_state); + phydm_adc_smp_start(p_dm); +} +#endif + +void +adc_smp_set( + void *p_dm_void, + u8 trig_mode, + u32 trig_sig_sel, + u8 dma_data_sig_sel, + u32 trigger_time, + u16 polling_time +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean is_set_success = true; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + + adc_smp->la_trig_mode = trig_mode; + adc_smp->la_trig_sig_sel = trig_sig_sel; + adc_smp->la_dma_type = dma_data_sig_sel; + adc_smp->la_trigger_time = trigger_time; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (adc_smp->adc_smp_state != ADCSMP_STATE_IDLE) + is_set_success = false; + else if (adc_smp->adc_smp_buf.length == 0) + is_set_success = phydm_la_buffer_allocate(p_dm); +#endif + + if (is_set_success) { + adc_smp->adc_smp_state = ADCSMP_STATE_SET; + + dbg_print("[LA Set Success] LA_State=((%d))\n", adc_smp->adc_smp_state); + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + + dbg_print("ADCSmp_work_item_index = ((%d))\n", adc_smp->la_work_item_index); + if (adc_smp->la_work_item_index != 0) { + odm_schedule_work_item(&(adc_smp->adc_smp_work_item_1)); + adc_smp->la_work_item_index = 0; + } else { + odm_schedule_work_item(&(adc_smp->adc_smp_work_item)); + adc_smp->la_work_item_index = 1; + } +#else + phydm_adc_smp_start(p_dm); +#endif + } else + dbg_print("[LA Set Fail] LA_State=((%d))\n", adc_smp->adc_smp_state); + + +} + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +enum rt_status +adc_smp_query( + void *p_dm_void, + ULONG information_buffer_length, + void *information_buffer, + PULONG bytes_written +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + enum rt_status ret_status = RT_STATUS_SUCCESS; + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + + dbg_print("[%s] LA_State=((%d))", __func__, adc_smp->adc_smp_state); + + if (information_buffer_length != adc_smp_buf->buffer_size) { + *bytes_written = 0; + ret_status = RT_STATUS_RESOURCE; + } else if (adc_smp_buf->length != adc_smp_buf->buffer_size) { + *bytes_written = 0; + ret_status = RT_STATUS_RESOURCE; + } else if (adc_smp->adc_smp_state != ADCSMP_STATE_QUERY) { + *bytes_written = 0; + ret_status = RT_STATUS_PENDING; + } else { + odm_move_memory(p_dm, information_buffer, adc_smp_buf->octet, adc_smp_buf->buffer_size); + *bytes_written = adc_smp_buf->buffer_size; + + adc_smp->adc_smp_state = ADCSMP_STATE_IDLE; + } + + dbg_print("Return status %d\n", ret_status); + + return ret_status; +} +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +void +adc_smp_query( + void *p_dm_void, + void *output, + u32 out_len, + u32 *pused +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + u32 used = *pused; + u32 i; + /* struct timespec t; */ + /* rtw_get_current_timespec(&t); */ + + dbg_print("%s adc_smp_state %d", __func__, adc_smp->adc_smp_state); + + for (i = 0; i < (adc_smp_buf->length >> 2) - 2; i += 2) { + PHYDM_SNPRINTF((output + used, out_len - used, + "%08x%08x\n", adc_smp_buf->octet[i], adc_smp_buf->octet[i + 1])); + } + + PHYDM_SNPRINTF((output + used, out_len - used, "\n")); + /* PHYDM_SNPRINTF((output+used, out_len-used, "\n[%lu.%06lu]\n", t.tv_sec, t.tv_nsec)); */ + *pused = used; +} + +s32 +adc_smp_get_sample_counts( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + + return (adc_smp_buf->length >> 2) - 2; +} + +s32 +adc_smp_query_single_data( + void *p_dm_void, + void *output, + u32 out_len, + u32 index +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + u32 used = 0; + + /* dbg_print("%s adc_smp_state %d\n", __func__, adc_smp->adc_smp_state); */ + if (adc_smp->adc_smp_state != ADCSMP_STATE_QUERY) { + PHYDM_SNPRINTF((output + used, out_len - used, + "Error: la data is not ready yet ...\n")); + return -1; + } + + if (index < ((adc_smp_buf->length >> 2) - 2)) { + PHYDM_SNPRINTF((output + used, out_len - used, "%08x%08x\n", + adc_smp_buf->octet[index], adc_smp_buf->octet[index + 1])); + } + return 0; +} + +#endif + +void +adc_smp_stop( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + + adc_smp->adc_smp_state = ADCSMP_STATE_IDLE; + dbg_print("[LA_Stop] LA_state = ((%d))\n", adc_smp->adc_smp_state); +} + +void +adc_smp_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + + adc_smp->adc_smp_state = ADCSMP_STATE_IDLE; + + if (p_dm->support_ic_type & ODM_RTL8814A) { + adc_smp_buf->start_pos = 0x30000; + adc_smp_buf->buffer_size = 0x10000; + } else if (p_dm->support_ic_type & ODM_RTL8822B) { + adc_smp_buf->start_pos = 0x20000; + adc_smp_buf->buffer_size = 0x20000; + } else if (p_dm->support_ic_type & ODM_RTL8197F) { + adc_smp_buf->start_pos = 0x00000; + adc_smp_buf->buffer_size = 0x10000; + } else if (p_dm->support_ic_type & ODM_RTL8821C) { + adc_smp_buf->start_pos = 0x8000; + adc_smp_buf->buffer_size = 0x8000; + } + +} + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void +adc_smp_de_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + struct _RT_ADCSMP_STRING *adc_smp_buf = &(adc_smp->adc_smp_buf); + + adc_smp_stop(p_dm); + + if (adc_smp_buf->length != 0x0) { + odm_free_memory(p_dm, adc_smp_buf->octet, adc_smp_buf->length); + adc_smp_buf->length = 0x0; + } +} + +#endif + + +void +phydm_la_mode_bb_setting( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + + u8 trig_mode = adc_smp->la_trig_mode; + u32 trig_sig_sel = adc_smp->la_trig_sig_sel; + u32 dbg_port = adc_smp->la_dbg_port; + u8 is_trigger_edge = adc_smp->la_trigger_edge; + u8 sampling_rate = adc_smp->la_smp_rate; + u8 la_dma_type = adc_smp->la_dma_type; + u32 dbg_port_header_sel = 0; + + dbg_print("1. [BB Setting] trig_mode = ((%d)), dbg_port = ((0x%x)), Trig_Edge = ((%d)), smp_rate = ((%d)), Trig_Sel = ((0x%x)), Dma_type = ((%d))\n", + trig_mode, dbg_port, is_trigger_edge, sampling_rate, trig_sig_sel, la_dma_type); + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("1. [LA mode bb_setting]trig_mode = ((%d)), dbg_port = ((0x%x)), Trig_Edge = ((%d)), smp_rate = ((%d)), Trig_Sel = ((0x%x)), Dma_type = ((%d))\n", + trig_mode, dbg_port, is_trigger_edge, sampling_rate, trig_sig_sel, la_dma_type)); +#endif + + if (trig_mode == PHYDM_MAC_TRIG) + trig_sig_sel = 0; /*ignore this setting*/ + + /*set BB debug port*/ + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_3, dbg_port)) { + dbg_print("Set dbg_port((0x%x)) success\n", dbg_port); + } + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + if (trig_mode == PHYDM_ADC_RF0_TRIG) + dbg_port_header_sel = 9; /*DBGOUT_RFC_a[31:0]*/ + else if (trig_mode == PHYDM_ADC_RF1_TRIG) + dbg_port_header_sel = 8; /*DBGOUT_RFC_b[31:0]*/ + else if ((trig_mode == PHYDM_ADC_BB_TRIG) || (trig_mode == PHYDM_ADC_MAC_TRIG)) { + + if (adc_smp->la_mac_mask_or_hdr_sel <= 0xf) { + dbg_port_header_sel = adc_smp->la_mac_mask_or_hdr_sel; + } else { + dbg_port_header_sel = 0; + } + } + + phydm_bb_dbg_port_header_sel(p_dm, dbg_port_header_sel); + + odm_set_bb_reg(p_dm, 0x95c, 0xf00, la_dma_type); /*0x95C[11:8]*/ + odm_set_bb_reg(p_dm, 0x95C, 0x1f, trig_sig_sel); /*0x95C[4:0], BB debug port bit*/ + odm_set_bb_reg(p_dm, 0x95C, BIT(31), is_trigger_edge); /*0: posedge, 1: negedge*/ + odm_set_bb_reg(p_dm, 0x95c, 0xe0, sampling_rate); + /* (0:) '80MHz' + (1:) '40MHz' + (2:) '20MHz' + (3:) '10MHz' + (4:) '5MHz' + (5:) '2.5MHz' + (6:) '1.25MHz' + (7:) '160MHz (for BW160 ic)' + */ + if ((p_dm->support_ic_type & ODM_RTL8821C) && (p_dm->cut_version >= ODM_CUT_B)) { + odm_set_bb_reg(p_dm, 0x95c, BIT(23), 1); + } + } else { + + odm_set_bb_reg(p_dm, 0x9a0, 0xf00, la_dma_type); /*0x9A0[11:8]*/ + odm_set_bb_reg(p_dm, 0x9a0, 0x1f, trig_sig_sel); /*0x9A0[4:0], BB debug port bit*/ + odm_set_bb_reg(p_dm, 0x9A0, BIT(31), is_trigger_edge); /*0: posedge, 1: negedge*/ + odm_set_bb_reg(p_dm, 0x9A0, 0xe0, sampling_rate); + /* (0:) '80MHz' + (1:) '40MHz' + (2:) '20MHz' + (3:) '10MHz' + (4:) '5MHz' + (5:) '2.5MHz' + (6:) '1.25MHz' + (7:) '160MHz (for BW160 ic)' + */ + } +} + +void +phydm_la_mode_set_trigger_time( + void *p_dm_void, + u32 trigger_time_mu_sec +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 trigger_time_unit_num; + u32 time_unit = 0; + + if (trigger_time_mu_sec < 128) { + time_unit = 0; /*unit: 1mu sec*/ + } else if (trigger_time_mu_sec < 256) { + time_unit = 1; /*unit: 2mu sec*/ + } else if (trigger_time_mu_sec < 512) { + time_unit = 2; /*unit: 4mu sec*/ + } else if (trigger_time_mu_sec < 1024) { + time_unit = 3; /*unit: 8mu sec*/ + } else if (trigger_time_mu_sec < 2048) { + time_unit = 4; /*unit: 16mu sec*/ + } else if (trigger_time_mu_sec < 4096) { + time_unit = 5; /*unit: 32mu sec*/ + } else if (trigger_time_mu_sec < 8192) { + time_unit = 6; /*unit: 64mu sec*/ + } + + trigger_time_unit_num = (u8)(trigger_time_mu_sec >> time_unit); + + dbg_print("2. [Set Trigger Time] Trig_Time = ((%d)) * unit = ((2^%d us))\n", trigger_time_unit_num, time_unit); +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("3. [Set Trigger Time] Trig_Time = ((%d)) * unit = ((2^%d us))\n", trigger_time_unit_num, time_unit)); +#endif + + odm_set_mac_reg(p_dm, 0x7cc, BIT(20) | BIT(19) | BIT(18), time_unit); + odm_set_mac_reg(p_dm, 0x7c0, 0x7f00, (trigger_time_unit_num & 0x7f)); + +} + + +void +phydm_lamode_trigger_setting( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_ADCSMP *adc_smp = &(p_dm->adcsmp); + u8 trig_mode, dma_data_sig_sel; + u32 trig_sig_sel; + boolean is_enable_la_mode; + u32 trigger_time_mu_sec; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + + if (p_dm->support_ic_type & PHYDM_IC_SUPPORT_LA_MODE) { + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + is_enable_la_mode = (boolean)var1[0]; + /*dbg_print("echo cmd input_num = %d\n", input_num);*/ + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "{En} {0:BB,1:BB_MAC,2:RF0,3:RF1,4:MAC} \n {BB:dbg_port[bit],BB_MAC:0-ok/1-fail/2-cca,MAC:ref} {DMA type} {TrigTime} \n {DbgPort_head/ref_mask} {dbg_port} {0:P_Edge, 1:N_Edge} {SpRate:0-80M,1-40M,2-20M} {Capture num}\n")); + /**/ + } else if ((is_enable_la_mode == 1)) { + + PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); + + trig_mode = (u8)var1[1]; + + if (trig_mode == PHYDM_MAC_TRIG) + PHYDM_SSCANF(input[3], DCMD_HEX, &var1[2]); + else + PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); + trig_sig_sel = var1[2]; + + PHYDM_SSCANF(input[4], DCMD_DECIMAL, &var1[3]); + PHYDM_SSCANF(input[5], DCMD_DECIMAL, &var1[4]); + PHYDM_SSCANF(input[6], DCMD_HEX, &var1[5]); + PHYDM_SSCANF(input[7], DCMD_HEX, &var1[6]); + PHYDM_SSCANF(input[8], DCMD_DECIMAL, &var1[7]); + PHYDM_SSCANF(input[9], DCMD_DECIMAL, &var1[8]); + PHYDM_SSCANF(input[10], DCMD_DECIMAL, &var1[9]); + + dma_data_sig_sel = (u8)var1[3]; + trigger_time_mu_sec = var1[4]; /*unit: us*/ + + adc_smp->la_mac_mask_or_hdr_sel = var1[5]; + adc_smp->la_dbg_port = var1[6]; + adc_smp->la_trigger_edge = (u8) var1[7]; + adc_smp->la_smp_rate = (u8)(var1[8] & 0x7); + adc_smp->la_count = var1[9]; + + + dbg_print("echo lamode %d %d %d %d %d %d %x %d %d %d\n", var1[0], var1[1], var1[2], var1[3], var1[4], var1[5], var1[6], var1[7], var1[8], var1[9]); +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + RT_TRACE_EX(COMP_LA_MODE, DBG_LOUD, ("echo lamode %d %d %d %d %d %d %x %d %d %d\n", var1[0], var1[1], var1[2], var1[3], var1[4], var1[5], var1[6], var1[7], var1[8], var1[9])); +#endif + + PHYDM_SNPRINTF((output + used, out_len - used, "a.En= ((1)), b.mode = ((%d)), c.Trig_Sel = ((0x%x)), d.Dma_type = ((%d))\n", trig_mode, trig_sig_sel, dma_data_sig_sel)); + PHYDM_SNPRINTF((output + used, out_len - used, "e.Trig_Time = ((%dus)), f.Dbg_head/mac_ref_mask = ((0x%x)), g.dbg_port = ((0x%x))\n", trigger_time_mu_sec, adc_smp->la_mac_mask_or_hdr_sel, adc_smp->la_dbg_port)); + PHYDM_SNPRINTF((output + used, out_len - used, "h.Trig_edge = ((%d)), i.smp rate = ((%d MHz)), j.Cap_num = ((%d))\n", adc_smp->la_trigger_edge, (80 >> adc_smp->la_smp_rate), adc_smp->la_count)); + + adc_smp_set(p_dm, trig_mode, trig_sig_sel, dma_data_sig_sel, trigger_time_mu_sec, 0); + + } else { + adc_smp_stop(p_dm); + PHYDM_SNPRINTF((output + used, out_len - used, "Disable LA mode\n")); + } + } + *_used = used; + *_out_len = out_len; +} + +#endif /*endif PHYDM_LA_MODE_SUPPORT == 1*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.h index 616ee74a1340..06f66fde94ac 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_adc_sampling.h @@ -1,91 +1,162 @@ -#ifndef __INC_ADCSMP_H -#define __INC_ADCSMP_H - -typedef struct _RT_ADCSMP_STRING { - pu4Byte Octet; - u4Byte Length; - u4Byte buffer_size; - u4Byte start_pos; -} RT_ADCSMP_STRING, *PRT_ADCSMP_STRING; - - -typedef enum _RT_ADCSMP_TRIG_SEL { - ADCSMP_BB_TRIG, - ADCSMP_MAC_TRIG, -} RT_ADCSMP_TRIG_SEL, *PRT_ADCSMP_TRIG_SEL; - - -typedef enum _RT_ADCSMP_TRIG_SIG_SEL { - ADCSMP_TRIG_CRCOK, - ADCSMP_TRIG_CRCFAIL, - ADCSMP_TRIG_CCA, - ADCSMP_TRIG_REG, -} RT_ADCSMP_TRIG_SIG_SEL, *PRT_ADCSMP_TRIG_SIG_SEL; - - -typedef enum _RT_ADCSMP_STATE { - ADCSMP_STATE_IDLE, - ADCSMP_STATE_SET, - ADCSMP_STATE_QUERY, -} RT_ADCSMP_STATE, *PRT_ADCSMP_STATE; - - -typedef struct _RT_ADCSMP { - RT_ADCSMP_STRING ADCSmpBuf; - RT_ADCSMP_STATE ADCSmpState; - RT_ADCSMP_TRIG_SEL ADCSmpTrigSel; - RT_ADCSMP_TRIG_SIG_SEL ADCSmpTrigSigSel; - u1Byte ADCSmpDmaDataSigSel; - u1Byte ADCSmpTriggerTime; - u2Byte ADCSmpPollingTime; - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_WORK_ITEM ADCSmpWorkItem; - #endif -} RT_ADCSMP, *PRT_ADCSMP; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -VOID -ADCSmpWorkItemCallback( - IN PVOID pContext -); -#endif - -VOID -ADCSmp_Set( - IN PVOID pDM_VOID, - IN RT_ADCSMP_TRIG_SEL TrigSel, - IN RT_ADCSMP_TRIG_SIG_SEL TrigSigSel, - IN u1Byte DmaDataSigSel, - IN u1Byte TriggerTime, - IN u2Byte PollingTime -); - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -RT_STATUS -ADCSmp_Query( - IN PVOID pDM_VOID, - IN ULONG InformationBufferLength, - OUT PVOID InformationBuffer, - OUT PULONG BytesWritten -); -#endif -VOID -ADCSmp_Stop( - IN PVOID pDM_VOID -); - -VOID -ADCSmp_Init( - IN PVOID pDM_VOID -); - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -VOID -ADCSmp_DeInit( - IN PVOID pDM_VOID -); - -#endif -#endif - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __INC_ADCSMP_H +#define __INC_ADCSMP_H + +#define DYNAMIC_LA_MODE "2.0" /*2017.02.06 Dino */ + +#if (PHYDM_LA_MODE_SUPPORT == 1) + +struct _RT_ADCSMP_STRING { + u32 *octet; + u32 length; + u32 buffer_size; + u32 start_pos; +}; + + +enum rt_adcsmp_trig_sel { + PHYDM_ADC_BB_TRIG = 0, + PHYDM_ADC_MAC_TRIG = 1, + PHYDM_ADC_RF0_TRIG = 2, + PHYDM_ADC_RF1_TRIG = 3, + PHYDM_MAC_TRIG = 4 +}; + + +enum rt_adcsmp_trig_sig_sel { + ADCSMP_TRIG_CRCOK = 0, + ADCSMP_TRIG_CRCFAIL = 1, + ADCSMP_TRIG_CCA = 2, + ADCSMP_TRIG_REG = 3 +}; + + +enum rt_adcsmp_state { + ADCSMP_STATE_IDLE = 0, + ADCSMP_STATE_SET = 1, + ADCSMP_STATE_QUERY = 2 +}; + + +struct _RT_ADCSMP { + struct _RT_ADCSMP_STRING adc_smp_buf; + enum rt_adcsmp_state adc_smp_state; + u8 la_trig_mode; + u32 la_trig_sig_sel; + u8 la_dma_type; + u32 la_trigger_time; + u32 la_mac_mask_or_hdr_sel; /*1.BB mode: for debug port header sel; 2.MAC mode: for reference mask*/ + u32 la_dbg_port; + u8 la_trigger_edge; + u8 la_smp_rate; + u32 la_count; + u8 is_bb_trigger; + u8 la_work_item_index; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + RT_WORK_ITEM adc_smp_work_item; + RT_WORK_ITEM adc_smp_work_item_1; +#endif +}; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +void +adc_smp_work_item_callback( + void *p_context +); +#endif + +void +adc_smp_set( + void *p_dm_void, + u8 trig_mode, + u32 trig_sig_sel, + u8 dma_data_sig_sel, + u32 trigger_time, + u16 polling_time +); + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +enum rt_status +adc_smp_query( + void *p_dm_void, + ULONG information_buffer_length, + void *information_buffer, + PULONG bytes_written +); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +void +adc_smp_query( + void *p_dm_void, + void *output, + u32 out_len, + u32 *pused +); + +s32 +adc_smp_get_sample_counts( + void *p_dm_void +); + +s32 +adc_smp_query_single_data( + void *p_dm_void, + void *output, + u32 out_len, + u32 index +); + +#endif +void +adc_smp_stop( + void *p_dm_void +); + +void +adc_smp_init( + void *p_dm_void +); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void +adc_smp_de_init( + void *p_dm_void +); +#endif + +void +phydm_la_mode_bb_setting( + void *p_dm_void +); + +void +phydm_la_mode_set_trigger_time( + void *p_dm_void, + u32 trigger_time_mu_sec +); + +void +phydm_lamode_trigger_setting( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.c index 862c5971fae9..1518968f62ba 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.c @@ -1,964 +1,833 @@ -/****************************************************************************** - * - * 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 files -//============================================================ - -#include "mp_precomp.h" -#include "phydm_precomp.h" - -//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) -#if(defined(CONFIG_ANT_DETECTION)) - -//IS_ANT_DETECT_SUPPORT_SINGLE_TONE(Adapter) -//IS_ANT_DETECT_SUPPORT_RSSI(Adapter) -//IS_ANT_DETECT_SUPPORT_PSD(Adapter) - -//1 [1. Single Tone Method] =================================================== - -// -// Description: -// Set Single/Dual Antenna default setting for products that do not do detection in advance. -// -// Added by Joseph, 2012.03.22 -// -VOID -ODM_SingleDualAntennaDefaultSetting( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - PADAPTER pAdapter = pDM_Odm->Adapter; - - u1Byte btAntNum=BT_GetPgAntNum(pAdapter); - // Set default antenna A and B status - if(btAntNum == 2) - { - pDM_SWAT_Table->ANTA_ON=TRUE; - pDM_SWAT_Table->ANTB_ON=TRUE; - - } - else if(btAntNum == 1) - {// Set antenna A as default - pDM_SWAT_Table->ANTA_ON=TRUE; - pDM_SWAT_Table->ANTB_ON=FALSE; - - } - else - { - RT_ASSERT(FALSE, ("Incorrect antenna number!!\n")); - } -} - - -//2 8723A ANT DETECT -// -// Description: -// Implement IQK single tone for RF DPK loopback and BB PSD scanning. -// This function is cooperated with BB team Neil. -// -// Added by Roger, 2011.12.15 -// -BOOLEAN -ODM_SingleDualAntennaDetection( - IN PVOID pDM_VOID, - IN u1Byte mode - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER pAdapter = pDM_Odm->Adapter; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - u4Byte CurrentChannel,RfLoopReg; - u1Byte n; - u4Byte Reg88c, Regc08, Reg874, Regc50, Reg948, Regb2c, Reg92c, Reg930, Reg064, AFE_rRx_Wait_CCA; - u1Byte initial_gain = 0x5a; - u4Byte PSD_report_tmp; - u4Byte AntA_report = 0x0, AntB_report = 0x0, AntO_report = 0x0; - BOOLEAN bResult = TRUE; - u4Byte AFE_Backup[16]; - u4Byte AFE_REG_8723A[16] = { - rRx_Wait_CCA, rTx_CCK_RFON, - rTx_CCK_BBON, rTx_OFDM_RFON, - rTx_OFDM_BBON, rTx_To_Rx, - rTx_To_Tx, rRx_CCK, - rRx_OFDM, rRx_Wait_RIFS, - rRx_TO_Rx, rStandby, - rSleep, rPMPD_ANAEN, - rFPGA0_XCD_SwitchControl, rBlue_Tooth}; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection()============>\n")); - - - if (!(pDM_Odm->SupportICType & ODM_RTL8723B)) - return bResult; - - // Retrieve antenna detection registry info, added by Roger, 2012.11.27. - if(!IS_ANT_DETECT_SUPPORT_SINGLE_TONE(pAdapter)) - return bResult; - - //1 Backup Current RF/BB Settings - - CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); - RfLoopReg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask); - if (pDM_Odm->SupportICType & ODM_RTL8723B) { - Reg92c = ODM_GetBBReg(pDM_Odm, rDPDT_control, bMaskDWord); - Reg930 = ODM_GetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord); - Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); - Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); - Reg064 = ODM_GetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29); - ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x1); - ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, 0xff, 0x77); - ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, 0x1); //dbg 7 - ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0x3c0, 0x0);//dbg 8 - ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x0); - } - - ODM_StallExecution(10); - - //Store A Path Register 88c, c08, 874, c50 - Reg88c = ODM_GetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord); - Regc08 = ODM_GetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord); - Reg874 = ODM_GetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord); - Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); - - // Store AFE Registers - if (pDM_Odm->SupportICType & ODM_RTL8723B) - AFE_rRx_Wait_CCA = ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA,bMaskDWord); - - //Set PSD 128 pts - ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pts - - // To SET CH1 to do - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask, 0x7401); //Channel 1 - - // AFE all on step - if (pDM_Odm->SupportICType & ODM_RTL8723B) - ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, 0x01c00016); - - // 3 wire Disable - ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, 0xCCF000C0); - - //BB IQK Setting - ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800E4); - ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x22208000); - - //IQK setting tone@ 4.34Mhz - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x10008C1C); - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); - - //Page B init - ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00080000); - ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x0f600000); - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x10008c1f); - if (pDM_Odm->SupportICType & ODM_RTL8723B) { - ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82150016); - ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28150016); - } - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x001028d0); - ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7f, initial_gain); - - //IQK Single tone start - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - ODM_StallExecution(10000); - - // PSD report of antenna A - PSD_report_tmp=0x0; - for (n=0;n<2;n++) - { - PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); - if(PSD_report_tmp >AntA_report) - AntA_report=PSD_report_tmp; - } - - // change to Antenna B - if (pDM_Odm->SupportICType & ODM_RTL8723B) { - //ODM_SetBBReg(pDM_Odm, rDPDT_control, 0x3, 0x2); - ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); - ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); - } - - ODM_StallExecution(10); - - // PSD report of antenna B - PSD_report_tmp=0x0; - for (n=0;n<2;n++) - { - PSD_report_tmp = GetPSDData(pDM_Odm, 14, initial_gain); - if(PSD_report_tmp > AntB_report) - AntB_report=PSD_report_tmp; - } - - //Close IQK Single Tone function - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - //1 Return to antanna A - if (pDM_Odm->SupportICType & ODM_RTL8723B) { - // external DPDT - ODM_SetBBReg(pDM_Odm, rDPDT_control, bMaskDWord, Reg92c); - - //internal S0/S1 - ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); - ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); - ODM_SetBBReg(pDM_Odm, rfe_ctrl_anta_src, bMaskDWord, Reg930); - ODM_SetMACReg(pDM_Odm, rSYM_WLBT_PAPE_SEL, BIT29, Reg064); - } - - ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, bMaskDWord, Reg88c); - ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, Regc08); - ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, Reg874); - ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, 0x7F, 0x40); - ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord, Regc50); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,CurrentChannel); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bRFRegOffsetMask,RfLoopReg); - - //Reload AFE Registers - if (pDM_Odm->SupportICType & ODM_RTL8723B) - ODM_SetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord, AFE_rRx_Wait_CCA); - - if (pDM_Odm->SupportICType & ODM_RTL8723B) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_A[%d]= %d\n", 2416, AntA_report)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("psd_report_B[%d]= %d\n", 2416, AntB_report)); - - //2 Test Ant B based on Ant A is ON - if((AntA_report >= 100) && (AntB_report >= 100) && (AntA_report <= 135) && (AntB_report <= 135)) - { - u1Byte TH1=2, TH2=6; - - if((AntA_report - AntB_report < TH1) || (AntB_report - AntA_report < TH1)) - { - pDM_SWAT_Table->ANTA_ON=TRUE; - pDM_SWAT_Table->ANTB_ON=TRUE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Dual Antenna\n")); - } - else if(((AntA_report - AntB_report >= TH1) && (AntA_report - AntB_report <= TH2)) || - ((AntB_report - AntA_report >= TH1) && (AntB_report - AntA_report <= TH2))) - { - pDM_SWAT_Table->ANTA_ON=FALSE; - pDM_SWAT_Table->ANTB_ON=FALSE; - bResult = FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection(): Need to check again\n")); - } - else - { - pDM_SWAT_Table->ANTA_ON = TRUE; - pDM_SWAT_Table->ANTB_ON=FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SingleDualAntennaDetection(): Single Antenna\n")); - } - pDM_Odm->AntDetectedInfo.bAntDetected= TRUE; - pDM_Odm->AntDetectedInfo.dBForAntA = AntA_report; - pDM_Odm->AntDetectedInfo.dBForAntB = AntB_report; - pDM_Odm->AntDetectedInfo.dBForAntO = AntO_report; - - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("return FALSE!!\n")); - bResult = FALSE; - } - } - return bResult; - -} - - - -//1 [2. Scan AP RSSI Method] ================================================== - - - - -BOOLEAN -ODM_SwAntDivCheckBeforeLink( - IN PVOID pDM_VOID - ) -{ - -#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE* pHalData = GET_HAL_DATA(Adapter); - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - s1Byte Score = 0; - PRT_WLAN_BSS pTmpBssDesc, pTestBssDesc; - u1Byte power_target_L = 9, power_target_H = 16; - u1Byte tmp_power_diff = 0,power_diff = 0,avg_power_diff = 0,max_power_diff = 0,min_power_diff = 0xff; - u2Byte index, counter = 0; - static u1Byte ScanChannel; - u4Byte tmp_SWAS_NoLink_BK_Reg948; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ANTA_ON = (( %d )) , ANTB_ON = (( %d ))\n", pDM_Odm->DM_SWAT_Table.ANTA_ON, pDM_Odm->DM_SWAT_Table.ANTB_ON)); - - //if(HP id) - { - if(pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult==TRUE && pDM_Odm->SupportICType == ODM_RTL8723B) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B RSSI-based Antenna Detection is done\n")); - return FALSE; - } - - if(pDM_Odm->SupportICType == ODM_RTL8723B) - { - if(pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 == 0xff) - pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch ); - } - } - - if (pDM_Odm->Adapter == NULL) //For BSOD when plug/unplug fast. //By YJ,120413 - { // The ODM structure is not initialized. - return FALSE; - } - - // Retrieve antenna detection registry info, added by Roger, 2012.11.27. - if(!IS_ANT_DETECT_SUPPORT_RSSI(Adapter)) - { - return FALSE; - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Antenna Detection: RSSI Method\n")); - } - - // Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF. - PlatformAcquireSpinLock(Adapter, RT_RF_STATE_SPINLOCK); - if(pHalData->eRFPowerState!=eRfOn || pMgntInfo->RFChangeInProgress || pMgntInfo->bMediaConnect) - { - PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("ODM_SwAntDivCheckBeforeLink(): RFChangeInProgress(%x), eRFPowerState(%x)\n", - pMgntInfo->RFChangeInProgress, pHalData->eRFPowerState)); - - pDM_SWAT_Table->SWAS_NoLink_State = 0; - - return FALSE; - } - else - { - PlatformReleaseSpinLock(Adapter, RT_RF_STATE_SPINLOCK); - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("pDM_SWAT_Table->SWAS_NoLink_State = %d\n", pDM_SWAT_Table->SWAS_NoLink_State)); - //1 Run AntDiv mechanism "Before Link" part. - if(pDM_SWAT_Table->SWAS_NoLink_State == 0) - { - //1 Prepare to do Scan again to check current antenna state. - - // Set check state to next step. - pDM_SWAT_Table->SWAS_NoLink_State = 1; - - // Copy Current Scan list. - pMgntInfo->tmpNumBssDesc = pMgntInfo->NumBssDesc; - PlatformMoveMemory((PVOID)Adapter->MgntInfo.tmpbssDesc, (PVOID)pMgntInfo->bssDesc, sizeof(RT_WLAN_BSS)*MAX_BSS_DESC); - - // Go back to scan function again. - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Scan one more time\n")); - pMgntInfo->ScanStep=0; - pMgntInfo->bScanAntDetect = TRUE; - ScanChannel = odm_SwAntDivSelectScanChnl(Adapter); - - - if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) - { - if(pDM_FatTable->RxIdleAnt == MAIN_ANT) - ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); - else - ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); - if(ScanChannel == 0) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("ODM_SwAntDivCheckBeforeLink(): No AP List Avaiable, Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); - - if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) - { - pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - } - else - { - pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - } - return FALSE; - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("ODM_SwAntDivCheckBeforeLink: Change to %s for testing.\n", ((pDM_FatTable->RxIdleAnt == MAIN_ANT)?"MAIN_ANT":"AUX_ANT"))); - } else if (pDM_Odm->SupportICType & (ODM_RTL8723B)) { - /*Switch Antenna to another one.*/ - - tmp_SWAS_NoLink_BK_Reg948 = ODM_Read4Byte(pDM_Odm, rS0S1_PathSwitch); - - if ((pDM_SWAT_Table->CurAntenna == MAIN_ANT) && (tmp_SWAS_NoLink_BK_Reg948 == 0x200)) { - ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, 0x280); - ODM_SetBBReg(pDM_Odm, rAGC_table_select, BIT31, 0x1); - pDM_SWAT_Table->CurAntenna = AUX_ANT; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Reg[948]= (( %x )) was in wrong state\n", tmp_SWAS_NoLink_BK_Reg948)); - return FALSE; - } - ODM_StallExecution(10); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Change to (( %s-ant)) for testing.\n", (pDM_SWAT_Table->CurAntenna == MAIN_ANT)?"MAIN":"AUX")); - } - - odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); - PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); - - return TRUE; - } - else //pDM_SWAT_Table->SWAS_NoLink_State == 1 - { - //1 ScanComple() is called after antenna swiched. - //1 Check scan result and determine which antenna is going - //1 to be used. - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,(" tmpNumBssDesc= (( %d )) \n",pMgntInfo->tmpNumBssDesc));// debug for Dino - - for(index = 0; index < pMgntInfo->tmpNumBssDesc; index++) - { - pTmpBssDesc = &(pMgntInfo->tmpbssDesc[index]); // Antenna 1 - pTestBssDesc = &(pMgntInfo->bssDesc[index]); // Antenna 2 - - if(PlatformCompareMemory(pTestBssDesc->bdBssIdBuf, pTmpBssDesc->bdBssIdBuf, 6)!=0) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): ERROR!! This shall not happen.\n")); - continue; - } - - if(pDM_Odm->SupportICType != ODM_RTL8723B) - { - if(pTmpBssDesc->ChannelNumber == ScanChannel) - { - if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score++\n")); - RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); - - Score++; - PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); - } - else if(pTmpBssDesc->RecvSignalPower < pTestBssDesc->RecvSignalPower) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink: Compare scan entry: Score--\n")); - RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); - Score--; - } - else - { - if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp < 5000) - { - RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", pTmpBssDesc->bdSsIdBuf, pTmpBssDesc->bdSsIdLen); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("at ch %d, Original: %d, Test: %d\n", pTmpBssDesc->ChannelNumber, pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("The 2nd Antenna didn't get this AP\n\n")); - } - } - } - } - else // 8723B - { - if(pTmpBssDesc->ChannelNumber == ScanChannel) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ChannelNumber == ScanChannel -> (( %d )) \n", pTmpBssDesc->ChannelNumber )); - - if(pTmpBssDesc->RecvSignalPower > pTestBssDesc->RecvSignalPower) // Pow(Ant1) > Pow(Ant2) - { - counter++; - tmp_power_diff=(u1Byte)(pTmpBssDesc->RecvSignalPower - pTestBssDesc->RecvSignalPower); - power_diff = power_diff + tmp_power_diff; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); - ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); - ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); - - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("tmp_power_diff: (( %d)),max_power_diff: (( %d)),min_power_diff: (( %d)) \n", tmp_power_diff,max_power_diff,min_power_diff)); - if(tmp_power_diff > max_power_diff) - max_power_diff=tmp_power_diff; - if(tmp_power_diff < min_power_diff) - min_power_diff=tmp_power_diff; - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("max_power_diff: (( %d)),min_power_diff: (( %d)) \n",max_power_diff,min_power_diff)); - - PlatformMoveMemory(pTestBssDesc, pTmpBssDesc, sizeof(RT_WLAN_BSS)); - } - else if(pTestBssDesc->RecvSignalPower > pTmpBssDesc->RecvSignalPower) // Pow(Ant1) < Pow(Ant2) - { - counter++; - tmp_power_diff=(u1Byte)(pTestBssDesc->RecvSignalPower - pTmpBssDesc->RecvSignalPower); - power_diff = power_diff + tmp_power_diff; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); - ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); - ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); - if(tmp_power_diff > max_power_diff) - max_power_diff=tmp_power_diff; - if(tmp_power_diff < min_power_diff) - min_power_diff=tmp_power_diff; - } - else // Pow(Ant1) = Pow(Ant2) - { - if(pTestBssDesc->bdTstamp > pTmpBssDesc->bdTstamp) // Stamp(Ant1) < Stamp(Ant2) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); - if(pTestBssDesc->bdTstamp - pTmpBssDesc->bdTstamp > 5000) - { - counter++; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Original: %d, Test: %d\n", pTmpBssDesc->RecvSignalPower, pTestBssDesc->RecvSignalPower)); - ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("SSID:"), pTmpBssDesc->bdSsIdBuf); - ODM_PRINT_ADDR(pDM_Odm,ODM_COMP_ANT_DIV, DBG_LOUD, ("BSSID:"), pTmpBssDesc->bdBssIdBuf); - min_power_diff = 0; - } - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Error !!!]: Time_diff: %lld\n", (pTestBssDesc->bdTstamp-pTmpBssDesc->bdTstamp)/1000)); - } - } - } - } - } - - if(pDM_Odm->SupportICType & (ODM_RTL8188E|ODM_RTL8821)) - { - if(pMgntInfo->NumBssDesc!=0 && Score<0) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("ODM_SwAntDivCheckBeforeLink(): Using Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - ("ODM_SwAntDivCheckBeforeLink(): Remain Ant(%s)\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"AUX_ANT":"MAIN_ANT")); - - if(pDM_FatTable->RxIdleAnt == MAIN_ANT) - ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); - else - ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); - } - - if(IS_5G_WIRELESS_MODE(pMgntInfo->dot11CurrentWirelessMode)) - { - pDM_SWAT_Table->Ant5G = pDM_FatTable->RxIdleAnt; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant5G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - } - else - { - pDM_SWAT_Table->Ant2G = pDM_FatTable->RxIdleAnt; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_SWAT_Table->Ant2G=%s\n", (pDM_FatTable->RxIdleAnt==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - } - } - else if(pDM_Odm->SupportICType == ODM_RTL8723B) - { - if(counter == 0) - { - if(pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec == FALSE) - { - pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = TRUE; - pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again \n")); - - //3 [ Scan again ] - odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); - PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); - return TRUE; - } - else// Pre_Aux_FailDetec == TRUE - { - //2 [ Single Antenna ] - pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; - pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Counter=(( 0 )) , [[ Still cannot find any AP ]] \n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); - } - pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter++; - } - else - { - pDM_Odm->DM_SWAT_Table.Pre_Aux_FailDetec = FALSE; - - if(counter==3) - { - avg_power_diff = ((power_diff-max_power_diff - min_power_diff)>>1)+ ((max_power_diff + min_power_diff)>>2); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter==3 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); - } - else if(counter>=4) - { - avg_power_diff=(power_diff-max_power_diff - min_power_diff) / (counter - 2); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("counter: (( %d )) , power_diff: (( %d )) \n", counter, power_diff)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ counter>=4 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d )) \n", avg_power_diff,max_power_diff, min_power_diff)); - - } - else//counter==1,2 - { - avg_power_diff=power_diff/counter; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("avg_power_diff: (( %d )) , counter: (( %d )) , power_diff: (( %d )) \n", avg_power_diff,counter, power_diff)); - } - - //2 [ Retry ] - if( (avg_power_diff >=power_target_L) && (avg_power_diff <=power_target_H) ) - { - pDM_Odm->DM_SWAT_Table.Retry_Counter++; - - if(pDM_Odm->DM_SWAT_Table.Retry_Counter<=3) - { - pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]] \n", avg_power_diff)); - - //3 [ Scan again ] - odm_SwAntDivConstructScanChnl(Adapter, ScanChannel); - PlatformSetTimer(Adapter, &pMgntInfo->ScanTimer, 5); - return TRUE; - } - else - { - pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[[ Still Low confidence result ]] (( Retry_Counter > 3 )) \n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); - } - - } - //2 [ Dual Antenna ] - else if( (pMgntInfo->NumBssDesc != 0) && (avg_power_diff < power_target_L) ) - { - pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; - if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) - { - pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; - pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); - pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter++; - - // set bt coexDM from 1ant coexDM to 2ant coexDM - BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 2); - - //3 [ Init antenna diversity ] - pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; - ODM_AntDivInit(pDM_Odm); - } - //2 [ Single Antenna ] - else if(avg_power_diff > power_target_H) - { - pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult=TRUE; - if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) - { - pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; - pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; - //BT_SetBtCoexAntNum(Adapter, BT_COEX_ANT_TYPE_DETECTED, 1); - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); - pDM_Odm->DM_SWAT_Table.Single_Ant_Counter++; - } - } - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("bResult=(( %d ))\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Dual_Ant_Counter = (( %d )), Single_Ant_Counter = (( %d )) , Retry_Counter = (( %d )) , Aux_FailDetec_Counter = (( %d ))\n\n\n", - pDM_Odm->DM_SWAT_Table.Dual_Ant_Counter,pDM_Odm->DM_SWAT_Table.Single_Ant_Counter,pDM_Odm->DM_SWAT_Table.Retry_Counter,pDM_Odm->DM_SWAT_Table.Aux_FailDetec_Counter)); - - //2 recover the antenna setting - - if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) - ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, 0xfff, (pDM_SWAT_Table->SWAS_NoLink_BK_Reg948)); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bResult=(( %d )), Recover Reg[948]= (( %x )) \n\n",pDM_Odm->DM_SWAT_Table.RSSI_AntDect_bResult, pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 )); - - - } - - // Check state reset to default and wait for next time. - pDM_SWAT_Table->SWAS_NoLink_State = 0; - pMgntInfo->bScanAntDetect = FALSE; - - return FALSE; - } - -#else - return FALSE; -#endif - -return FALSE; -} - - - - - - -//1 [3. PSD Method] ========================================================== - - - - -u4Byte -odm_GetPSDData( - IN PVOID pDM_VOID, - IN u2Byte point, - IN u1Byte initial_gain) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte psd_report; - - ODM_SetBBReg(pDM_Odm, 0x808, 0x3FF, point); - ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 1); //Start PSD calculation, Reg808[22]=0->1 - ODM_StallExecution(150);//Wait for HW PSD report - ODM_SetBBReg(pDM_Odm, 0x808, BIT22, 0);//Stop PSD calculation, Reg808[22]=1->0 - psd_report = ODM_GetBBReg(pDM_Odm,0x8B4, bMaskDWord) & 0x0000FFFF;//Read PSD report, Reg8B4[15:0] - - psd_report = (u4Byte) (odm_ConvertTo_dB(psd_report));//+(u4Byte)(initial_gain); - return psd_report; -} - - - -VOID -ODM_SingleDualAntennaDetection_PSD( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte Channel_ori; - u1Byte initial_gain = 0x36; - u1Byte tone_idx; - u1Byte Tone_lenth_1=7, Tone_lenth_2=4; - u2Byte Tone_idx_1[7]={88, 104, 120, 8, 24, 40, 56}; - u2Byte Tone_idx_2[4]={8, 24, 40, 56}; - u4Byte PSD_report_Main[11]={0}, PSD_report_Aux[11]={0}; - //u1Byte Tone_lenth_1=4, Tone_lenth_2=2; - //u2Byte Tone_idx_1[4]={88, 120, 24, 56}; - //u2Byte Tone_idx_2[2]={ 24, 56}; - //u4Byte PSD_report_Main[6]={0}, PSD_report_Aux[6]={0}; - - u4Byte PSD_report_temp,MAX_PSD_report_Main=0,MAX_PSD_report_Aux=0; - u4Byte PSD_power_threshold; - u4Byte Main_psd_result=0, Aux_psd_result=0; - u4Byte Regc50, Reg948, Regb2c,Regc14,Reg908; - u4Byte i=0,test_num=8; - - - if(pDM_Odm->SupportICType != ODM_RTL8723B) - return; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SingleDualAntennaDetection_PSD()============> \n")); - - //2 [ Backup Current RF/BB Settings ] - - Channel_ori = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, bRFRegOffsetMask); - Reg948 = ODM_GetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord); - Regb2c = ODM_GetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord); - Regc50 = ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskDWord); - Regc14 = ODM_GetBBReg(pDM_Odm, 0xc14, bMaskDWord); - Reg908 = ODM_GetBBReg(pDM_Odm, 0x908, bMaskDWord); - - //2 [ Setting for doing PSD function (CH4)] - ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0); //disable whole CCK block - ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); // Turn off TX -> Pause TX Queue - ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, 0x0); // [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] - - // PHYTXON while loop - ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, 0x803); - while (ODM_GetBBReg(pDM_Odm, 0xdf4, BIT6)) - { - i++; - if (i > 1000000) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Wait in %s() more than %d times!\n", __FUNCTION__, i)); - break; - } - } - - ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH4 & 40M - ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf - ODM_SetBBReg(pDM_Odm, rFPGA0_PSDFunction, BIT14|BIT15, 0x0); //128 pt //Set PSD 128 ptss - ODM_StallExecution(3000); - - - //2 [ Doing PSD Function in (CH4)] - - //Antenna A - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH4)\n")); - ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); - ODM_StallExecution(10); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("dbg\n")); - for (i=0;iPSD_report_Main[tone_idx] ) - PSD_report_Main[tone_idx]+=PSD_report_temp; - } - } - //Antenna B - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH4)\n")); - ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); - ODM_StallExecution(10); - for (i=0;iPSD_report_Aux[tone_idx] ) - PSD_report_Aux[tone_idx]+=PSD_report_temp; - } - } - //2 [ Doing PSD Function in (CH8)] - - ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 - ODM_StallExecution(3000); - - ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, initial_gain); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); // Set RF to CH8 & 40M - - ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0xf); // 3 wire Disable 88c[23:20]=0xf - ODM_StallExecution(3000); - - //Antenna A - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Main-ant (CH8)\n")); - ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x200); - ODM_StallExecution(10); - - for (i=0;iPSD_report_Main[tone_idx] ) - PSD_report_Main[Tone_lenth_1+tone_idx]+=PSD_report_temp; - } - } - - //Antenna B - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Switch to Aux-ant (CH8)\n")); - ODM_SetBBReg(pDM_Odm, 0x948, 0xfff, 0x280); - ODM_StallExecution(10); - - for (i=0;iPSD_report_Aux[tone_idx] ) - PSD_report_Aux[Tone_lenth_1+tone_idx]+=PSD_report_temp; - } - } - - //2 [ Calculate Result ] - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nMain PSD Result: (ALL) \n")); - for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Main[tone_idx] )); - Main_psd_result+= PSD_report_Main[tone_idx]; - if(PSD_report_Main[tone_idx]>MAX_PSD_report_Main) - MAX_PSD_report_Main=PSD_report_Main[tone_idx]; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Main= (( %d ))\n", Main_psd_result)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Main = (( %d ))\n", MAX_PSD_report_Main)); - - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\nAux PSD Result: (ALL) \n")); - for (tone_idx=0;tone_idx<(Tone_lenth_1+Tone_lenth_2);tone_idx++) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Tone-%d]: %d, \n",(tone_idx+1), PSD_report_Aux[tone_idx] )); - Aux_psd_result+= PSD_report_Aux[tone_idx]; - if(PSD_report_Aux[tone_idx]>MAX_PSD_report_Aux) - MAX_PSD_report_Aux=PSD_report_Aux[tone_idx]; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("--------------------------- \nTotal_Aux= (( %d ))\n", Aux_psd_result)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MAX_Aux = (( %d ))\n\n", MAX_PSD_report_Aux)); - - //Main_psd_result=Main_psd_result-MAX_PSD_report_Main; - //Aux_psd_result=Aux_psd_result-MAX_PSD_report_Aux; - PSD_power_threshold=(Main_psd_result*7)>>3; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Main_result , Aux_result ] = [ %d , %d ], PSD_power_threshold=(( %d ))\n", Main_psd_result, Aux_psd_result,PSD_power_threshold)); - - //3 [ Dual Antenna ] - if(Aux_psd_result >= PSD_power_threshold ) - { - if(pDM_Odm->DM_SWAT_Table.ANTB_ON == FALSE) - { - pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; - pDM_Odm->DM_SWAT_Table.ANTB_ON = TRUE; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("ODM_SwAntDivCheckBeforeLink(): Dual antenna\n")); - - // set bt coexDM from 1ant coexDM to 2ant coexDM - //BT_SetBtCoexAntNum(pAdapter, BT_COEX_ANT_TYPE_DETECTED, 2); - - // Init antenna diversity - pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; - ODM_AntDivInit(pDM_Odm); - } - //3 [ Single Antenna ] - else - { - if(pDM_Odm->DM_SWAT_Table.ANTB_ON == TRUE) - { - pDM_Odm->DM_SWAT_Table.ANTA_ON = TRUE; - pDM_Odm->DM_SWAT_Table.ANTB_ON = FALSE; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ODM_SwAntDivCheckBeforeLink(): Single antenna\n")); - } - - //2 [ Recover all parameters ] - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask,Channel_ori); - ODM_SetBBReg(pDM_Odm, rFPGA0_AnalogParameter4, 0xf00000, 0x0); // 3 wire enable 88c[23:20]=0x0 - ODM_SetBBReg(pDM_Odm, 0xc50, 0x7f, Regc50); - - ODM_SetBBReg(pDM_Odm, rS0S1_PathSwitch, bMaskDWord, Reg948); - ODM_SetBBReg(pDM_Odm, rAGC_table_select, bMaskDWord, Regb2c); - - ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 1); //enable whole CCK block - ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x0); //Turn on TX // Resume TX Queue - ODM_SetBBReg(pDM_Odm, 0xC14, bMaskDWord, Regc14); // [ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] - ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, Reg908); - - return; - -} - -#endif -void -odm_SwAntDetectInit( - IN PVOID pDM_VOID - ) -{ -#if(defined(CONFIG_ANT_DETECTION)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - - //pDM_SWAT_Table->PreAntenna = MAIN_ANT; - //pDM_SWAT_Table->CurAntenna = MAIN_ANT; - pDM_SWAT_Table->SWAS_NoLink_State = 0; - pDM_SWAT_Table->Pre_Aux_FailDetec = FALSE; - pDM_SWAT_Table->SWAS_NoLink_BK_Reg948 = 0xff; -#endif -} - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +/* #if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) */ +#if (defined(CONFIG_ANT_DETECTION)) + +/* IS_ANT_DETECT_SUPPORT_SINGLE_TONE(adapter) + * IS_ANT_DETECT_SUPPORT_RSSI(adapter) + * IS_ANT_DETECT_SUPPORT_PSD(adapter) */ + +/* 1 [1. Single Tone method] =================================================== */ + +/* + * Description: + * Set Single/Dual Antenna default setting for products that do not do detection in advance. + * + * Added by Joseph, 2012.03.22 + * */ +void +odm_single_dual_antenna_default_setting( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct _ADAPTER *p_adapter = p_dm->adapter; + + u8 bt_ant_num = BT_GetPgAntNum(p_adapter); + /* Set default antenna A and B status */ + if (bt_ant_num == 2) { + p_dm_swat_table->ANTA_ON = true; + p_dm_swat_table->ANTB_ON = true; + + } else if (bt_ant_num == 1) { + /* Set antenna A as default */ + p_dm_swat_table->ANTA_ON = true; + p_dm_swat_table->ANTB_ON = false; + + } else + RT_ASSERT(false, ("Incorrect antenna number!!\n")); +} + + +/* 2 8723A ANT DETECT + * + * Description: + * Implement IQK single tone for RF DPK loopback and BB PSD scanning. + * This function is cooperated with BB team Neil. + * + * Added by Roger, 2011.12.15 + * */ +boolean +odm_single_dual_antenna_detection( + void *p_dm_void, + u8 mode +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *p_adapter = p_dm->adapter; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + u32 current_channel, rf_loop_reg; + u8 n; + u32 reg88c, regc08, reg874, regc50, reg948, regb2c, reg92c, reg930, reg064, afe_rrx_wait_cca; + u8 initial_gain = 0x5a; + u32 PSD_report_tmp; + u32 ant_a_report = 0x0, ant_b_report = 0x0, ant_0_report = 0x0; + boolean is_result = true; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_single_dual_antenna_detection()============>\n")); + + + if (!(p_dm->support_ic_type & ODM_RTL8723B)) + return is_result; + + /* Retrieve antenna detection registry info, added by Roger, 2012.11.27. */ + if (!IS_ANT_DETECT_SUPPORT_SINGLE_TONE(p_adapter)) + return is_result; + + /* 1 Backup Current RF/BB Settings */ + + current_channel = odm_get_rf_reg(p_dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); + rf_loop_reg = odm_get_rf_reg(p_dm, RF_PATH_A, 0x00, RFREGOFFSETMASK); + if (p_dm->support_ic_type & ODM_RTL8723B) { + reg92c = odm_get_bb_reg(p_dm, REG_DPDT_CONTROL, MASKDWORD); + reg930 = odm_get_bb_reg(p_dm, rfe_ctrl_anta_src, MASKDWORD); + reg948 = odm_get_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, MASKDWORD); + regb2c = odm_get_bb_reg(p_dm, REG_AGC_TABLE_SELECT, MASKDWORD); + reg064 = odm_get_mac_reg(p_dm, REG_SYM_WLBT_PAPE_SEL, BIT(29)); + odm_set_bb_reg(p_dm, REG_DPDT_CONTROL, 0x3, 0x1); + odm_set_bb_reg(p_dm, rfe_ctrl_anta_src, 0xff, 0x77); + odm_set_mac_reg(p_dm, REG_SYM_WLBT_PAPE_SEL, BIT(29), 0x1); /* dbg 7 */ + odm_set_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, 0x3c0, 0x0);/* dbg 8 */ + odm_set_bb_reg(p_dm, REG_AGC_TABLE_SELECT, BIT(31), 0x0); + } + + ODM_delay_us(10); + + /* Store A path Register 88c, c08, 874, c50 */ + reg88c = odm_get_bb_reg(p_dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD); + regc08 = odm_get_bb_reg(p_dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD); + reg874 = odm_get_bb_reg(p_dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD); + regc50 = odm_get_bb_reg(p_dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); + + /* Store AFE Registers */ + if (p_dm->support_ic_type & ODM_RTL8723B) + afe_rrx_wait_cca = odm_get_bb_reg(p_dm, REG_RX_WAIT_CCA, MASKDWORD); + + /* Set PSD 128 pts */ + odm_set_bb_reg(p_dm, REG_FPGA0_PSD_FUNCTION, BIT(14) | BIT15, 0x0); /* 128 pts */ + + /* To SET CH1 to do */ + odm_set_rf_reg(p_dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK, 0x7401); /* channel 1 */ + + /* AFE all on step */ + if (p_dm->support_ic_type & ODM_RTL8723B) + odm_set_bb_reg(p_dm, REG_RX_WAIT_CCA, MASKDWORD, 0x01c00016); + + /* 3 wire Disable */ + odm_set_bb_reg(p_dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, 0xCCF000C0); + + /* BB IQK setting */ + odm_set_bb_reg(p_dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, 0x000800E4); + odm_set_bb_reg(p_dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, 0x22208000); + + /* IQK setting tone@ 4.34Mhz */ + odm_set_bb_reg(p_dm, REG_TX_IQK_TONE_A, MASKDWORD, 0x10008C1C); + odm_set_bb_reg(p_dm, REG_TX_IQK, MASKDWORD, 0x01007c00); + + /* Page B init */ + odm_set_bb_reg(p_dm, REG_CONFIG_ANT_A, MASKDWORD, 0x00080000); + odm_set_bb_reg(p_dm, REG_CONFIG_ANT_A, MASKDWORD, 0x0f600000); + odm_set_bb_reg(p_dm, REG_RX_IQK, MASKDWORD, 0x01004800); + odm_set_bb_reg(p_dm, REG_RX_IQK_TONE_A, MASKDWORD, 0x10008c1f); + if (p_dm->support_ic_type & ODM_RTL8723B) { + odm_set_bb_reg(p_dm, REG_TX_IQK_PI_A, MASKDWORD, 0x82150016); + odm_set_bb_reg(p_dm, REG_RX_IQK_PI_A, MASKDWORD, 0x28150016); + } + odm_set_bb_reg(p_dm, REG_IQK_AGC_RSP, MASKDWORD, 0x001028d0); + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_AGC_CORE1, 0x7f, initial_gain); + + /* IQK Single tone start */ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x808000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf9000000); + odm_set_bb_reg(p_dm, REG_IQK_AGC_PTS, MASKDWORD, 0xf8000000); + + ODM_delay_us(10000); + + /* PSD report of antenna A */ + PSD_report_tmp = 0x0; + for (n = 0; n < 2; n++) { + PSD_report_tmp = phydm_get_psd_data(p_dm, 14, initial_gain); + if (PSD_report_tmp > ant_a_report) + ant_a_report = PSD_report_tmp; + } + + /* change to Antenna B */ + if (p_dm->support_ic_type & ODM_RTL8723B) { + /* odm_set_bb_reg(p_dm, REG_DPDT_CONTROL, 0x3, 0x2); */ + odm_set_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); + odm_set_bb_reg(p_dm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); + } + + ODM_delay_us(10); + + /* PSD report of antenna B */ + PSD_report_tmp = 0x0; + for (n = 0; n < 2; n++) { + PSD_report_tmp = phydm_get_psd_data(p_dm, 14, initial_gain); + if (PSD_report_tmp > ant_b_report) + ant_b_report = PSD_report_tmp; + } + + /* Close IQK Single Tone function */ + odm_set_bb_reg(p_dm, REG_FPGA0_IQK, 0xffffff00, 0x000000); + + /* 1 Return to antanna A */ + if (p_dm->support_ic_type & ODM_RTL8723B) { + /* external DPDT */ + odm_set_bb_reg(p_dm, REG_DPDT_CONTROL, MASKDWORD, reg92c); + + /* internal S0/S1 */ + odm_set_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); + odm_set_bb_reg(p_dm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); + odm_set_bb_reg(p_dm, rfe_ctrl_anta_src, MASKDWORD, reg930); + odm_set_mac_reg(p_dm, REG_SYM_WLBT_PAPE_SEL, BIT(29), reg064); + } + + odm_set_bb_reg(p_dm, REG_FPGA0_ANALOG_PARAMETER4, MASKDWORD, reg88c); + odm_set_bb_reg(p_dm, REG_OFDM_0_TR_MUX_PAR, MASKDWORD, regc08); + odm_set_bb_reg(p_dm, REG_FPGA0_XCD_RF_INTERFACE_SW, MASKDWORD, reg874); + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_AGC_CORE1, 0x7F, 0x40); + odm_set_bb_reg(p_dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD, regc50); + odm_set_rf_reg(p_dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, current_channel); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x00, RFREGOFFSETMASK, rf_loop_reg); + + /* Reload AFE Registers */ + if (p_dm->support_ic_type & ODM_RTL8723B) + odm_set_bb_reg(p_dm, REG_RX_WAIT_CCA, MASKDWORD, afe_rrx_wait_cca); + + if (p_dm->support_ic_type & ODM_RTL8723B) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("psd_report_A[%d]= %d\n", 2416, ant_a_report)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("psd_report_B[%d]= %d\n", 2416, ant_b_report)); + + /* 2 Test ant B based on ant A is ON */ + if ((ant_a_report >= 100) && (ant_b_report >= 100) && (ant_a_report <= 135) && (ant_b_report <= 135)) { + u8 TH1 = 2, TH2 = 6; + + if ((ant_a_report - ant_b_report < TH1) || (ant_b_report - ant_a_report < TH1)) { + p_dm_swat_table->ANTA_ON = true; + p_dm_swat_table->ANTB_ON = true; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_single_dual_antenna_detection(): Dual Antenna\n")); + } else if (((ant_a_report - ant_b_report >= TH1) && (ant_a_report - ant_b_report <= TH2)) || + ((ant_b_report - ant_a_report >= TH1) && (ant_b_report - ant_a_report <= TH2))) { + p_dm_swat_table->ANTA_ON = false; + p_dm_swat_table->ANTB_ON = false; + is_result = false; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_single_dual_antenna_detection(): Need to check again\n")); + } else { + p_dm_swat_table->ANTA_ON = true; + p_dm_swat_table->ANTB_ON = false; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_single_dual_antenna_detection(): Single Antenna\n")); + } + p_dm->ant_detected_info.is_ant_detected = true; + p_dm->ant_detected_info.db_for_ant_a = ant_a_report; + p_dm->ant_detected_info.db_for_ant_b = ant_b_report; + p_dm->ant_detected_info.db_for_ant_o = ant_0_report; + + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("return false!!\n")); + is_result = false; + } + } + return is_result; + +} + + + +/* 1 [2. Scan AP RSSI method] ================================================== */ + + + + +boolean +odm_sw_ant_div_check_before_link( + void *p_dm_void +) +{ + +#if (RT_MEM_SIZE_LEVEL != RT_MEM_SIZE_MINIMUM) + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + s8 score = 0; + PRT_WLAN_BSS p_tmp_bss_desc, p_test_bss_desc; + u8 power_target_L = 9, power_target_H = 16; + u8 tmp_power_diff = 0, power_diff = 0, avg_power_diff = 0, max_power_diff = 0, min_power_diff = 0xff; + u16 index, counter = 0; + static u8 scan_channel; + u32 tmp_swas_no_link_bk_reg948; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("ANTA_ON = (( %d )) , ANTB_ON = (( %d ))\n", p_dm->dm_swat_table.ANTA_ON, p_dm->dm_swat_table.ANTB_ON)); + + /* if(HP id) */ + { + if (p_dm->dm_swat_table.rssi_ant_dect_result == true && p_dm->support_ic_type == ODM_RTL8723B) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("8723B RSSI-based Antenna Detection is done\n")); + return false; + } + + if (p_dm->support_ic_type == ODM_RTL8723B) { + if (p_dm_swat_table->swas_no_link_bk_reg948 == 0xff) + p_dm_swat_table->swas_no_link_bk_reg948 = odm_read_4byte(p_dm, REG_S0_S1_PATH_SWITCH); + } + } + + if (p_dm->adapter == NULL) { /* For BSOD when plug/unplug fast. //By YJ,120413 */ + /* The ODM structure is not initialized. */ + return false; + } + + /* Retrieve antenna detection registry info, added by Roger, 2012.11.27. */ + if (!IS_ANT_DETECT_SUPPORT_RSSI(adapter)) + return false; + else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Antenna Detection: RSSI method\n")); + + /* Since driver is going to set BB register, it shall check if there is another thread controlling BB/RF. */ + odm_acquire_spin_lock(p_dm, RT_RF_STATE_SPINLOCK); + if (p_hal_data->eRFPowerState != eRfOn || p_mgnt_info->RFChangeInProgress || p_mgnt_info->bMediaConnect) { + odm_release_spin_lock(p_dm, RT_RF_STATE_SPINLOCK); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, + ("odm_sw_ant_div_check_before_link(): rf_change_in_progress(%x), e_rf_power_state(%x)\n", + p_mgnt_info->RFChangeInProgress, p_hal_data->eRFPowerState)); + + p_dm_swat_table->swas_no_link_state = 0; + + return false; + } else + odm_release_spin_lock(p_dm, RT_RF_STATE_SPINLOCK); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("p_dm_swat_table->swas_no_link_state = %d\n", p_dm_swat_table->swas_no_link_state)); + /* 1 Run AntDiv mechanism "Before Link" part. */ + if (p_dm_swat_table->swas_no_link_state == 0) { + /* 1 Prepare to do Scan again to check current antenna state. */ + + /* Set check state to next step. */ + p_dm_swat_table->swas_no_link_state = 1; + + /* Copy Current Scan list. */ + p_mgnt_info->tmpNumBssDesc = p_mgnt_info->NumBssDesc; + PlatformMoveMemory((void *)adapter->MgntInfo.tmpbssDesc, (void *)p_mgnt_info->bssDesc, sizeof(RT_WLAN_BSS) * MAX_BSS_DESC); + + /* Go back to scan function again. */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link: Scan one more time\n")); + p_mgnt_info->ScanStep = 0; + p_mgnt_info->bScanAntDetect = true; + scan_channel = odm_sw_ant_div_select_scan_chnl(adapter); + + + if (p_dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { + if (p_dm_fat_table->rx_idle_ant == MAIN_ANT) + odm_update_rx_idle_ant(p_dm, AUX_ANT); + else + odm_update_rx_idle_ant(p_dm, MAIN_ANT); + if (scan_channel == 0) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, + ("odm_sw_ant_div_check_before_link(): No AP List Avaiable, Using ant(%s)\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "AUX_ANT" : "MAIN_ANT")); + + if (IS_5G_WIRELESS_MODE(p_mgnt_info->dot11CurrentWirelessMode)) { + p_dm_swat_table->ant_5g = p_dm_fat_table->rx_idle_ant; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("p_dm_swat_table->ant_5g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + } else { + p_dm_swat_table->ant_2g = p_dm_fat_table->rx_idle_ant; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("p_dm_swat_table->ant_2g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + } + return false; + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, + ("odm_sw_ant_div_check_before_link: Change to %s for testing.\n", ((p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT"))); + } else if (p_dm->support_ic_type & (ODM_RTL8723B)) { + /*Switch Antenna to another one.*/ + + tmp_swas_no_link_bk_reg948 = odm_read_4byte(p_dm, REG_S0_S1_PATH_SWITCH); + + if ((p_dm_swat_table->cur_antenna == MAIN_ANT) && (tmp_swas_no_link_bk_reg948 == 0x200)) { + odm_set_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, 0xfff, 0x280); + odm_set_bb_reg(p_dm, REG_AGC_TABLE_SELECT, BIT(31), 0x1); + p_dm_swat_table->cur_antenna = AUX_ANT; + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Reg[948]= (( %x )) was in wrong state\n", tmp_swas_no_link_bk_reg948)); + return false; + } + ODM_delay_us(10); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link: Change to (( %s-ant)) for testing.\n", (p_dm_swat_table->cur_antenna == MAIN_ANT) ? "MAIN" : "AUX")); + } + + odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); + PlatformSetTimer(adapter, &p_mgnt_info->ScanTimer, 5); + + return true; + } else { /* p_dm_swat_table->swas_no_link_state == 1 */ + /* 1 ScanComple() is called after antenna swiched. */ + /* 1 Check scan result and determine which antenna is going */ + /* 1 to be used. */ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" tmp_num_bss_desc= (( %d ))\n", p_mgnt_info->tmpNumBssDesc)); /* debug for Dino */ + + for (index = 0; index < p_mgnt_info->tmpNumBssDesc; index++) { + p_tmp_bss_desc = &(p_mgnt_info->tmpbssDesc[index]); /* Antenna 1 */ + p_test_bss_desc = &(p_mgnt_info->bssDesc[index]); /* Antenna 2 */ + + if (PlatformCompareMemory(p_test_bss_desc->bdBssIdBuf, p_tmp_bss_desc->bdBssIdBuf, 6) != 0) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link(): ERROR!! This shall not happen.\n")); + continue; + } + + if (p_dm->support_ic_type != ODM_RTL8723B) { + if (p_tmp_bss_desc->ChannelNumber == scan_channel) { + if (p_tmp_bss_desc->RecvSignalPower > p_test_bss_desc->RecvSignalPower) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link: Compare scan entry: score++\n")); + RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("at ch %d, Original: %d, Test: %d\n\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + + score++; + PlatformMoveMemory(p_test_bss_desc, p_tmp_bss_desc, sizeof(RT_WLAN_BSS)); + } else if (p_tmp_bss_desc->RecvSignalPower < p_test_bss_desc->RecvSignalPower) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link: Compare scan entry: score--\n")); + RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("at ch %d, Original: %d, Test: %d\n\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + score--; + } else { + if (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp < 5000) { + RT_PRINT_STR(COMP_SCAN, DBG_WARNING, "GetScanInfo(): new Bss SSID:", p_tmp_bss_desc->bdSsIdBuf, p_tmp_bss_desc->bdSsIdLen); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("at ch %d, Original: %d, Test: %d\n", p_tmp_bss_desc->ChannelNumber, p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("The 2nd Antenna didn't get this AP\n\n")); + } + } + } + } else { /* 8723B */ + if (p_tmp_bss_desc->ChannelNumber == scan_channel) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("channel_number == scan_channel->(( %d ))\n", p_tmp_bss_desc->ChannelNumber)); + + if (p_tmp_bss_desc->RecvSignalPower > p_test_bss_desc->RecvSignalPower) { /* Pow(Ant1) > Pow(Ant2) */ + counter++; + tmp_power_diff = (u8)(p_tmp_bss_desc->RecvSignalPower - p_test_bss_desc->RecvSignalPower); + power_diff = power_diff + tmp_power_diff; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + PHYDM_PRINT_ADDR(p_dm, DBG_ANT_DIV, ("SSID:"), p_tmp_bss_desc->bdSsIdBuf); + PHYDM_PRINT_ADDR(p_dm, DBG_ANT_DIV, ("BSSID:"), p_tmp_bss_desc->bdSsIdBuf); + + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("tmp_power_diff: (( %d)),max_power_diff: (( %d)),min_power_diff: (( %d))\n", tmp_power_diff,max_power_diff,min_power_diff)); */ + if (tmp_power_diff > max_power_diff) + max_power_diff = tmp_power_diff; + if (tmp_power_diff < min_power_diff) + min_power_diff = tmp_power_diff; + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("max_power_diff: (( %d)),min_power_diff: (( %d))\n",max_power_diff,min_power_diff)); */ + + PlatformMoveMemory(p_test_bss_desc, p_tmp_bss_desc, sizeof(RT_WLAN_BSS)); + } else if (p_test_bss_desc->RecvSignalPower > p_tmp_bss_desc->RecvSignalPower) { /* Pow(Ant1) < Pow(Ant2) */ + counter++; + tmp_power_diff = (u8)(p_test_bss_desc->RecvSignalPower - p_tmp_bss_desc->RecvSignalPower); + power_diff = power_diff + tmp_power_diff; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + PHYDM_PRINT_ADDR(p_dm, DBG_ANT_DIV, ("SSID:"), p_tmp_bss_desc->bdSsIdBuf); + PHYDM_PRINT_ADDR(p_dm, DBG_ANT_DIV, ("BSSID:"), p_tmp_bss_desc->bdSsIdBuf); + if (tmp_power_diff > max_power_diff) + max_power_diff = tmp_power_diff; + if (tmp_power_diff < min_power_diff) + min_power_diff = tmp_power_diff; + } else { /* Pow(Ant1) = Pow(Ant2) */ + if (p_test_bss_desc->bdTstamp > p_tmp_bss_desc->bdTstamp) { /* Stamp(Ant1) < Stamp(Ant2) */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("time_diff: %lld\n", (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp) / 1000)); + if (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp > 5000) { + counter++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Original: %d, Test: %d\n", p_tmp_bss_desc->RecvSignalPower, p_test_bss_desc->RecvSignalPower)); + PHYDM_PRINT_ADDR(p_dm, DBG_ANT_DIV, ("SSID:"), p_tmp_bss_desc->bdSsIdBuf); + PHYDM_PRINT_ADDR(p_dm, DBG_ANT_DIV, ("BSSID:"), p_tmp_bss_desc->bdSsIdBuf); + min_power_diff = 0; + } + } else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Error !!!]: Time_diff: %lld\n", (p_test_bss_desc->bdTstamp - p_tmp_bss_desc->bdTstamp) / 1000)); + } + } + } + } + + if (p_dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8821)) { + if (p_mgnt_info->NumBssDesc != 0 && score < 0) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, + ("odm_sw_ant_div_check_before_link(): Using ant(%s)\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, + ("odm_sw_ant_div_check_before_link(): Remain ant(%s)\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "AUX_ANT" : "MAIN_ANT")); + + if (p_dm_fat_table->rx_idle_ant == MAIN_ANT) + odm_update_rx_idle_ant(p_dm, AUX_ANT); + else + odm_update_rx_idle_ant(p_dm, MAIN_ANT); + } + + if (IS_5G_WIRELESS_MODE(p_mgnt_info->dot11CurrentWirelessMode)) { + p_dm_swat_table->ant_5g = p_dm_fat_table->rx_idle_ant; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("p_dm_swat_table->ant_5g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + } else { + p_dm_swat_table->ant_2g = p_dm_fat_table->rx_idle_ant; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("p_dm_swat_table->ant_2g=%s\n", (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + } + } else if (p_dm->support_ic_type == ODM_RTL8723B) { + if (counter == 0) { + if (p_dm->dm_swat_table.pre_aux_fail_detec == false) { + p_dm->dm_swat_table.pre_aux_fail_detec = true; + p_dm->dm_swat_table.rssi_ant_dect_result = false; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("counter=(( 0 )) , [[ Cannot find any AP with Aux-ant ]] -> Scan Target-channel again\n")); + + /* 3 [ Scan again ] */ + odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); + PlatformSetTimer(adapter, &p_mgnt_info->ScanTimer, 5); + return true; + } else { /* pre_aux_fail_detec == true */ + /* 2 [ Single Antenna ] */ + p_dm->dm_swat_table.pre_aux_fail_detec = false; + p_dm->dm_swat_table.rssi_ant_dect_result = true; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("counter=(( 0 )) , [[ Still cannot find any AP ]]\n")); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); + } + p_dm->dm_swat_table.aux_fail_detec_counter++; + } else { + p_dm->dm_swat_table.pre_aux_fail_detec = false; + + if (counter == 3) { + avg_power_diff = ((power_diff - max_power_diff - min_power_diff) >> 1) + ((max_power_diff + min_power_diff) >> 2); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ counter==3 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d ))\n", avg_power_diff, max_power_diff, min_power_diff)); + } else if (counter >= 4) { + avg_power_diff = (power_diff - max_power_diff - min_power_diff) / (counter - 2); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("counter: (( %d )) , power_diff: (( %d ))\n", counter, power_diff)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ counter>=4 ] Modified avg_power_diff: (( %d )) , max_power_diff: (( %d )) , min_power_diff: (( %d ))\n", avg_power_diff, max_power_diff, min_power_diff)); + + } else { /* counter==1,2 */ + avg_power_diff = power_diff / counter; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("avg_power_diff: (( %d )) , counter: (( %d )) , power_diff: (( %d ))\n", avg_power_diff, counter, power_diff)); + } + + /* 2 [ Retry ] */ + if ((avg_power_diff >= power_target_L) && (avg_power_diff <= power_target_H)) { + p_dm->dm_swat_table.retry_counter++; + + if (p_dm->dm_swat_table.retry_counter <= 3) { + p_dm->dm_swat_table.rssi_ant_dect_result = false; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[[ Low confidence result ]] avg_power_diff= (( %d )) -> Scan Target-channel again ]]\n", avg_power_diff)); + + /* 3 [ Scan again ] */ + odm_sw_ant_div_construct_scan_chnl(adapter, scan_channel); + PlatformSetTimer(adapter, &p_mgnt_info->ScanTimer, 5); + return true; + } else { + p_dm->dm_swat_table.rssi_ant_dect_result = true; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[[ Still Low confidence result ]] (( retry_counter > 3 ))\n")); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); + } + + } + /* 2 [ Dual Antenna ] */ + else if ((p_mgnt_info->NumBssDesc != 0) && (avg_power_diff < power_target_L)) { + p_dm->dm_swat_table.rssi_ant_dect_result = true; + if (p_dm->dm_swat_table.ANTB_ON == false) { + p_dm->dm_swat_table.ANTA_ON = true; + p_dm->dm_swat_table.ANTB_ON = true; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link(): Dual antenna\n")); + p_dm->dm_swat_table.dual_ant_counter++; + + /* set bt coexDM from 1ant coexDM to 2ant coexDM */ + BT_SetBtCoexAntNum(adapter, BT_COEX_ANT_TYPE_DETECTED, 2); + + /* 3 [ Init antenna diversity ] */ + p_dm->support_ability |= ODM_BB_ANT_DIV; + odm_ant_div_init(p_dm); + } + /* 2 [ Single Antenna ] */ + else if (avg_power_diff > power_target_H) { + p_dm->dm_swat_table.rssi_ant_dect_result = true; + if (p_dm->dm_swat_table.ANTB_ON == true) { + p_dm->dm_swat_table.ANTA_ON = true; + p_dm->dm_swat_table.ANTB_ON = false; + /* bt_set_bt_coex_ant_num(adapter, BT_COEX_ANT_TYPE_DETECTED, 1); */ + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); + p_dm->dm_swat_table.single_ant_counter++; + } + } + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("is_result=(( %d ))\n",p_dm->dm_swat_table.rssi_ant_dect_result)); */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("dual_ant_counter = (( %d )), single_ant_counter = (( %d )) , retry_counter = (( %d )) , aux_fail_detec_counter = (( %d ))\n\n\n", + p_dm->dm_swat_table.dual_ant_counter, p_dm->dm_swat_table.single_ant_counter, p_dm->dm_swat_table.retry_counter, p_dm->dm_swat_table.aux_fail_detec_counter)); + + /* 2 recover the antenna setting */ + + if (p_dm->dm_swat_table.ANTB_ON == false) + odm_set_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, 0xfff, (p_dm_swat_table->swas_no_link_bk_reg948)); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("is_result=(( %d )), Recover Reg[948]= (( %x ))\n\n", p_dm->dm_swat_table.rssi_ant_dect_result, p_dm_swat_table->swas_no_link_bk_reg948)); + + + } + + /* Check state reset to default and wait for next time. */ + p_dm_swat_table->swas_no_link_state = 0; + p_mgnt_info->bScanAntDetect = false; + + return false; + } + +#else + return false; +#endif + + return false; +} + + + + + + +/* 1 [3. PSD method] ========================================================== */ +void +odm_single_dual_antenna_detection_psd( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 channel_ori; + u8 initial_gain = 0x36; + u8 tone_idx; + u8 tone_lenth_1 = 7, tone_lenth_2 = 4; + u16 tone_idx_1[7] = {88, 104, 120, 8, 24, 40, 56}; + u16 tone_idx_2[4] = {8, 24, 40, 56}; + u32 psd_report_main[11] = {0}, psd_report_aux[11] = {0}; + /* u8 tone_lenth_1=4, tone_lenth_2=2; */ + /* u16 tone_idx_1[4]={88, 120, 24, 56}; */ + /* u16 tone_idx_2[2]={ 24, 56}; */ + /* u32 psd_report_main[6]={0}, psd_report_aux[6]={0}; */ + + u32 PSD_report_temp, max_psd_report_main = 0, max_psd_report_aux = 0; + u32 PSD_power_threshold; + u32 main_psd_result = 0, aux_psd_result = 0; + u32 regc50, reg948, regb2c, regc14, reg908; + u32 i = 0, test_num = 8; + + + if (p_dm->support_ic_type != ODM_RTL8723B) + return; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_single_dual_antenna_detection_psd()============>\n")); + + /* 2 [ Backup Current RF/BB Settings ] */ + + channel_ori = odm_get_rf_reg(p_dm, RF_PATH_A, ODM_CHANNEL, RFREGOFFSETMASK); + reg948 = odm_get_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, MASKDWORD); + regb2c = odm_get_bb_reg(p_dm, REG_AGC_TABLE_SELECT, MASKDWORD); + regc50 = odm_get_bb_reg(p_dm, REG_OFDM_0_XA_AGC_CORE1, MASKDWORD); + regc14 = odm_get_bb_reg(p_dm, 0xc14, MASKDWORD); + reg908 = odm_get_bb_reg(p_dm, 0x908, MASKDWORD); + + /* 2 [ setting for doing PSD function (CH4)] */ + odm_set_bb_reg(p_dm, REG_FPGA0_RFMOD, BIT(24), 0); /* disable whole CCK block */ + odm_write_1byte(p_dm, REG_TXPAUSE, 0xFF); /* Turn off TX -> Pause TX Queue */ + odm_set_bb_reg(p_dm, 0xC14, MASKDWORD, 0x0); /* [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] */ + + /* PHYTXON while loop */ + odm_set_bb_reg(p_dm, 0x908, MASKDWORD, 0x803); + while (odm_get_bb_reg(p_dm, 0xdf4, BIT(6))) { + i++; + if (i > 1000000) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Wait in %s() more than %d times!\n", __FUNCTION__, i)); + break; + } + } + + odm_set_bb_reg(p_dm, 0xc50, 0x7f, initial_gain); + odm_set_rf_reg(p_dm, RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH4 & 40M */ + odm_set_bb_reg(p_dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* 3 wire Disable 88c[23:20]=0xf */ + odm_set_bb_reg(p_dm, REG_FPGA0_PSD_FUNCTION, BIT(14) | BIT15, 0x0); /* 128 pt */ /* Set PSD 128 ptss */ + ODM_delay_us(3000); + + + /* 2 [ Doing PSD Function in (CH4)] */ + + /* Antenna A */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Switch to Main-ant (CH4)\n")); + odm_set_bb_reg(p_dm, 0x948, 0xfff, 0x200); + ODM_delay_us(10); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("dbg\n")); + for (i = 0; i < test_num; i++) { + for (tone_idx = 0; tone_idx < tone_lenth_1; tone_idx++) { + PSD_report_temp = phydm_get_psd_data(p_dm, tone_idx_1[tone_idx], initial_gain); + /* if( PSD_report_temp>psd_report_main[tone_idx] ) */ + psd_report_main[tone_idx] += PSD_report_temp; + } + } + /* Antenna B */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Switch to Aux-ant (CH4)\n")); + odm_set_bb_reg(p_dm, 0x948, 0xfff, 0x280); + ODM_delay_us(10); + for (i = 0; i < test_num; i++) { + for (tone_idx = 0; tone_idx < tone_lenth_1; tone_idx++) { + PSD_report_temp = phydm_get_psd_data(p_dm, tone_idx_1[tone_idx], initial_gain); + /* if( PSD_report_temp>psd_report_aux[tone_idx] ) */ + psd_report_aux[tone_idx] += PSD_report_temp; + } + } + /* 2 [ Doing PSD Function in (CH8)] */ + + odm_set_bb_reg(p_dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* 3 wire enable 88c[23:20]=0x0 */ + ODM_delay_us(3000); + + odm_set_bb_reg(p_dm, 0xc50, 0x7f, initial_gain); + odm_set_rf_reg(p_dm, RF_PATH_A, ODM_CHANNEL, 0x7ff, 0x04); /* Set RF to CH8 & 40M */ + + odm_set_bb_reg(p_dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0xf); /* 3 wire Disable 88c[23:20]=0xf */ + ODM_delay_us(3000); + + /* Antenna A */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Switch to Main-ant (CH8)\n")); + odm_set_bb_reg(p_dm, 0x948, 0xfff, 0x200); + ODM_delay_us(10); + + for (i = 0; i < test_num; i++) { + for (tone_idx = 0; tone_idx < tone_lenth_2; tone_idx++) { + PSD_report_temp = phydm_get_psd_data(p_dm, tone_idx_2[tone_idx], initial_gain); + /* if( PSD_report_temp>psd_report_main[tone_idx] ) */ + psd_report_main[tone_lenth_1 + tone_idx] += PSD_report_temp; + } + } + + /* Antenna B */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Switch to Aux-ant (CH8)\n")); + odm_set_bb_reg(p_dm, 0x948, 0xfff, 0x280); + ODM_delay_us(10); + + for (i = 0; i < test_num; i++) { + for (tone_idx = 0; tone_idx < tone_lenth_2; tone_idx++) { + PSD_report_temp = phydm_get_psd_data(p_dm, tone_idx_2[tone_idx], initial_gain); + /* if( PSD_report_temp>psd_report_aux[tone_idx] ) */ + psd_report_aux[tone_lenth_1 + tone_idx] += PSD_report_temp; + } + } + + /* 2 [ Calculate Result ] */ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\nMain PSD Result: (ALL)\n")); + for (tone_idx = 0; tone_idx < (tone_lenth_1 + tone_lenth_2); tone_idx++) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Tone-%d]: %d,\n", (tone_idx + 1), psd_report_main[tone_idx])); + main_psd_result += psd_report_main[tone_idx]; + if (psd_report_main[tone_idx] > max_psd_report_main) + max_psd_report_main = psd_report_main[tone_idx]; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("--------------------------- \nTotal_Main= (( %d ))\n", main_psd_result)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("MAX_Main = (( %d ))\n", max_psd_report_main)); + + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\nAux PSD Result: (ALL)\n")); + for (tone_idx = 0; tone_idx < (tone_lenth_1 + tone_lenth_2); tone_idx++) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Tone-%d]: %d,\n", (tone_idx + 1), psd_report_aux[tone_idx])); + aux_psd_result += psd_report_aux[tone_idx]; + if (psd_report_aux[tone_idx] > max_psd_report_aux) + max_psd_report_aux = psd_report_aux[tone_idx]; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("--------------------------- \nTotal_Aux= (( %d ))\n", aux_psd_result)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("MAX_Aux = (( %d ))\n\n", max_psd_report_aux)); + + /* main_psd_result=main_psd_result-max_psd_report_main; */ + /* aux_psd_result=aux_psd_result-max_psd_report_aux; */ + PSD_power_threshold = (main_psd_result * 7) >> 3; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Main_result, Aux_result ] = [ %d , %d ], PSD_power_threshold=(( %d ))\n", main_psd_result, aux_psd_result, PSD_power_threshold)); + + /* 3 [ Dual Antenna ] */ + if (aux_psd_result >= PSD_power_threshold) { + if (p_dm->dm_swat_table.ANTB_ON == false) { + p_dm->dm_swat_table.ANTA_ON = true; + p_dm->dm_swat_table.ANTB_ON = true; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link(): Dual antenna\n")); + + /* set bt coexDM from 1ant coexDM to 2ant coexDM */ + /* bt_set_bt_coex_ant_num(p_adapter, BT_COEX_ANT_TYPE_DETECTED, 2); */ + + /* Init antenna diversity */ + p_dm->support_ability |= ODM_BB_ANT_DIV; + odm_ant_div_init(p_dm); + } + /* 3 [ Single Antenna ] */ + else { + if (p_dm->dm_swat_table.ANTB_ON == true) { + p_dm->dm_swat_table.ANTA_ON = true; + p_dm->dm_swat_table.ANTB_ON = false; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_sw_ant_div_check_before_link(): Single antenna\n")); + } + + /* 2 [ Recover all parameters ] */ + + odm_set_rf_reg(p_dm, RF_PATH_A, RF_CHNLBW, RFREGOFFSETMASK, channel_ori); + odm_set_bb_reg(p_dm, REG_FPGA0_ANALOG_PARAMETER4, 0xf00000, 0x0); /* 3 wire enable 88c[23:20]=0x0 */ + odm_set_bb_reg(p_dm, 0xc50, 0x7f, regc50); + + odm_set_bb_reg(p_dm, REG_S0_S1_PATH_SWITCH, MASKDWORD, reg948); + odm_set_bb_reg(p_dm, REG_AGC_TABLE_SELECT, MASKDWORD, regb2c); + + odm_set_bb_reg(p_dm, REG_FPGA0_RFMOD, BIT(24), 1); /* enable whole CCK block */ + odm_write_1byte(p_dm, REG_TXPAUSE, 0x0); /* Turn on TX */ /* Resume TX Queue */ + odm_set_bb_reg(p_dm, 0xC14, MASKDWORD, regc14); /* [ Set IQK Matrix = 0 ] equivalent to [ Turn on CCA] */ + odm_set_bb_reg(p_dm, 0x908, MASKDWORD, reg908); + + return; + +} + +#endif +void +odm_sw_ant_detect_init( + void *p_dm_void +) +{ +#if (defined(CONFIG_ANT_DETECTION)) +#if (RTL8723B_SUPPORT == 1) + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + + if (p_dm->support_ic_type != ODM_RTL8723B) + return; + + /* p_dm_swat_table->pre_antenna = MAIN_ANT; */ + /* p_dm_swat_table->cur_antenna = MAIN_ANT; */ + p_dm_swat_table->swas_no_link_state = 0; + p_dm_swat_table->pre_aux_fail_detec = false; + p_dm_swat_table->swas_no_link_bk_reg948 = 0xff; + + #ifdef CONFIG_PSD_TOOL + phydm_psd_init(p_dm); + #endif +#endif +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.h index 419d9ea956c2..74627fc57ead 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdect.h @@ -1,98 +1,90 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMANTDECT_H__ -#define __PHYDMANTDECT_H__ - -#define ANTDECT_VERSION "2.1" /*2015.07.29 by YuChen*/ - -#if(defined(CONFIG_ANT_DETECTION)) -//#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) -//ANT Test -#define ANTTESTALL 0x00 /*Ant A or B will be Testing*/ -#define ANTTESTA 0x01 /*Ant A will be Testing*/ -#define ANTTESTB 0x02 /*Ant B will be testing*/ - -#define MAX_ANTENNA_DETECTION_CNT 10 - - -typedef struct _ANT_DETECTED_INFO{ - BOOLEAN bAntDetected; - u4Byte dBForAntA; - u4Byte dBForAntB; - u4Byte dBForAntO; -}ANT_DETECTED_INFO, *PANT_DETECTED_INFO; - - -typedef enum tag_SW_Antenna_Switch_Definition -{ - Antenna_A = 1, - Antenna_B = 2, - Antenna_MAX = 3, -}DM_SWAS_E; - - - -//1 [1. Single Tone Method] =================================================== - - - -VOID -ODM_SingleDualAntennaDefaultSetting( - IN PVOID pDM_VOID - ); - -BOOLEAN -ODM_SingleDualAntennaDetection( - IN PVOID pDM_VOID, - IN u1Byte mode - ); - -//1 [2. Scan AP RSSI Method] ================================================== - -#define SwAntDivCheckBeforeLink ODM_SwAntDivCheckBeforeLink - -BOOLEAN -ODM_SwAntDivCheckBeforeLink( - IN PVOID pDM_VOID - ); - - - - -//1 [3. PSD Method] ========================================================== - - -VOID -ODM_SingleDualAntennaDetection_PSD( - IN PVOID pDM_VOID -); - -#endif - -VOID -odm_SwAntDetectInit( - IN PVOID pDM_VOID - ); - - -#endif - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMANTDECT_H__ +#define __PHYDMANTDECT_H__ + +#define ANTDECT_VERSION "2.1" /*2015.07.29 by YuChen*/ + +#if (defined(CONFIG_ANT_DETECTION)) +/* #if( DM_ODM_SUPPORT_TYPE & (ODM_WIN |ODM_CE)) */ +/* ANT Test */ +#define ANTTESTALL 0x00 /*ant A or B will be Testing*/ +#define ANTTESTA 0x01 /*ant A will be Testing*/ +#define ANTTESTB 0x02 /*ant B will be testing*/ + +#define MAX_ANTENNA_DETECTION_CNT 10 + + +struct _ANT_DETECTED_INFO { + boolean is_ant_detected; + u32 db_for_ant_a; + u32 db_for_ant_b; + u32 db_for_ant_o; +}; + + +enum dm_swas_e { + antenna_a = 1, + antenna_b = 2, + antenna_max = 3, +}; + + + +/* 1 [1. Single Tone method] =================================================== */ + + + +void +odm_single_dual_antenna_default_setting( + void *p_dm_void +); + +boolean +odm_single_dual_antenna_detection( + void *p_dm_void, + u8 mode +); + +/* 1 [2. Scan AP RSSI method] ================================================== */ + +#define sw_ant_div_check_before_link odm_sw_ant_div_check_before_link + +boolean +odm_sw_ant_div_check_before_link( + void *p_dm_void +); + + + + +/* 1 [3. PSD method] ========================================================== */ + + +void +odm_single_dual_antenna_detection_psd( + void *p_dm_void +); + +#endif + +void +odm_sw_ant_detect_init( + void *p_dm_void +); + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.c index dcd0c5f7afc3..b11390b54a1a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.c @@ -1,5431 +1,4726 @@ -/****************************************************************************** - * - * 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 files -//============================================================ - -#include "mp_precomp.h" -#include "phydm_precomp.h" - -//====================================================== -// when antenna test utility is on or some testing need to disable antenna diversity -// call this function to disable all ODM related mechanisms which will switch antenna. -//====================================================== -VOID -ODM_StopAntennaSwitchDm( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - // disable ODM antenna diversity - pDM_Odm->SupportAbility &= ~ODM_BB_ANT_DIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("STOP Antenna Diversity \n")); -} - -VOID -phydm_enable_antenna_diversity( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AntDiv is enabled & Re-Init AntDiv\n")); - odm_AntennaDiversityInit(pDM_Odm); -} - -VOID -ODM_SetAntConfig( - IN PVOID pDM_VOID, - IN u1Byte antSetting // 0=A, 1=B, 2=C, .... - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if (pDM_Odm->SupportICType == ODM_RTL8723B) { - if (antSetting == 0) /* ant A*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000000); - else if (antSetting == 1) - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x00000280); - } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { - if (antSetting == 0) /* ant A*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskLWord, 0x0000); - else if (antSetting == 1) - ODM_SetBBReg(pDM_Odm, 0x948, bMaskLWord, 0x0280); - } -} - -//====================================================== - - -VOID -ODM_SwAntDivRestAfterLink( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u4Byte i; - - if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { - - pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; - pDM_SWAT_Table->RSSI_Trying = 0; - pDM_SWAT_Table->Double_chk_flag= 0; - - pDM_FatTable->RxIdleAnt=MAIN_ANT; - - for (i=0; iMainAnt_Sum[i] = 0; - pDM_FatTable->AuxAnt_Sum[i] = 0; - pDM_FatTable->MainAnt_Cnt[i] = 0; - pDM_FatTable->AuxAnt_Cnt[i] = 0; - } - - } -} - - -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -VOID -odm_AntDiv_on_off( - IN PVOID pDM_VOID , - IN u1Byte swch - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - if(pDM_FatTable->AntDiv_OnOff != swch) - { - if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) - return; - - if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) N-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); - ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); - - } - else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) AC-Series HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); - if (pDM_Odm->SupportICType == ODM_RTL8812) { - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT7, swch); //OFDM AntDiv function block enable - ODM_SetBBReg(pDM_Odm, 0xa00 , BIT15, swch); //CCK AntDiv function block enable - } else { - ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, swch); //OFDM AntDiv function block enable - - if( (pDM_Odm->CutVersion >= ODM_CUT_C) && (pDM_Odm->SupportICType == ODM_RTL8821) && ( pDM_Odm->AntDivType != S0S1_SW_ANTDIV)) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); - ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, swch); - ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, swch); //CCK AntDiv function block enable - } else if (pDM_Odm->SupportICType == ODM_RTL8821C) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("(( Turn %s )) CCK HW-AntDiv block\n",(swch==ANTDIV_ON)?"ON" : "OFF")); - ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, swch); - ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, swch); //CCK AntDiv function block enable - } - } - } - } - pDM_FatTable->AntDiv_OnOff =swch; - -} - -VOID -phydm_FastTraining_enable( - IN PVOID pDM_VOID, - IN u1Byte swch - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte enable; - - if (swch == FAT_ON) - enable=1; - else - enable=0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fast Ant Training_en = ((%d))\n", enable)); - - if (pDM_Odm->SupportICType == ODM_RTL8188E) { - ODM_SetBBReg(pDM_Odm, 0xe08 , BIT16, enable); /*enable fast training*/ - /**/ - } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { - ODM_SetBBReg(pDM_Odm, 0xB34 , BIT28, enable); /*enable fast training (path-A)*/ - /*ODM_SetBBReg(pDM_Odm, 0xB34 , BIT29, enable);*/ /*enable fast training (path-B)*/ - } else if (pDM_Odm->SupportICType == ODM_RTL8821) { - ODM_SetBBReg(pDM_Odm, 0x900 , BIT19, enable); /*enable fast training */ - /**/ - } -} - -phydm_keep_RxAckAnt_By_TxAnt_time( - IN PVOID pDM_VOID, - IN u4Byte time - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - /* Timming issue: keep Rx ant after tx for ACK ( time x 3.2 mu sec)*/ - if (pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) { - - ODM_SetBBReg(pDM_Odm, 0xE20, BIT23|BIT22|BIT21|BIT20, time); - /**/ - } else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) { - - ODM_SetBBReg(pDM_Odm, 0x818, BIT23|BIT22|BIT21|BIT20, time); - /**/ - } -} - -VOID -odm_Tx_By_TxDesc_or_Reg( - IN PVOID pDM_VOID, - IN u1Byte swch - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u1Byte enable; - - if (pDM_FatTable->b_fix_tx_ant == NO_FIX_TX_ANT) - enable = (swch == TX_BY_DESC) ? 1 : 0; - else - enable = 0;/*Force TX by Reg*/ - - if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) - { - if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) - { - ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, enable); - } - else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) - { - ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, enable); - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv] TX_Ant_BY (( %s ))\n", (enable == TX_BY_DESC) ? "DESC":"REG")); - } -} - -VOID -ODM_UpdateRxIdleAnt( - IN PVOID pDM_VOID, - IN u1Byte Ant - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u4Byte DefaultAnt, OptionalAnt, value32, Default_tx_Ant; - - if(pDM_FatTable->RxIdleAnt != Ant) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - - if(!(pDM_Odm->SupportICType & ODM_RTL8723B)) - pDM_FatTable->RxIdleAnt = Ant; - - if(Ant == MAIN_ANT) - { - DefaultAnt = ANT1_2G; - OptionalAnt = ANT2_2G; - } - else - { - DefaultAnt = ANT2_2G; - OptionalAnt = ANT1_2G; - } - - if (pDM_FatTable->b_fix_tx_ant != NO_FIX_TX_ANT) - Default_tx_Ant = (pDM_FatTable->b_fix_tx_ant == FIX_TX_AT_MAIN) ? 0 : 1; - else - Default_tx_Ant = DefaultAnt; - - if(pDM_Odm->SupportICType & ODM_N_ANTDIV_SUPPORT) - { - if(pDM_Odm->SupportICType==ODM_RTL8192E) - { - ODM_SetBBReg(pDM_Odm, 0xB38 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX - ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, OptionalAnt);//Optional RX - ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt);//Default TX - } - #if (RTL8723B_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8723B) { - - value32 = ODM_GetBBReg(pDM_Odm, 0x948, 0xFFF); - - if(value32 !=0x280) - ODM_UpdateRxIdleAnt_8723B(pDM_Odm, Ant, DefaultAnt, OptionalAnt); - else - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to 0x948 = 0x280\n")); - } - #endif - else { /*8188E & 8188F*/ - - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - #if (RTL8723D_SUPPORT == 1) - phydm_set_tx_ant_pwr_8723d(pDM_Odm, Ant); - #endif - } - #if (RTL8188F_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8188F) { - phydm_update_rx_idle_antenna_8188F(pDM_Odm, DefaultAnt); - /**/ - } - #endif - - ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); /*Default RX*/ - ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); /*Optional RX*/ - ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, Default_tx_Ant); /*Default TX*/ - } - } - else if(pDM_Odm->SupportICType & ODM_AC_ANTDIV_SUPPORT) - { - u2Byte value16 = ODM_Read2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2); - // - // 2014/01/14 MH/Luke.Lee Add direct write for register 0xc0a to prevnt - // incorrect 0xc08 bit0-15 .We still not know why it is changed. - // - value16 &= ~(BIT11|BIT10|BIT9|BIT8|BIT7|BIT6|BIT5|BIT4|BIT3); - value16 |= ((u2Byte)DefaultAnt <<3); - value16 |= ((u2Byte)OptionalAnt <<6); - value16 |= ((u2Byte)DefaultAnt <<9); - ODM_Write2Byte(pDM_Odm, ODM_REG_TRMUX_11AC+2, value16); - /* - ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT21|BIT20|BIT19, DefaultAnt); //Default RX - ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT24|BIT23|BIT22, OptionalAnt);//Optional RX - ODM_SetBBReg(pDM_Odm, ODM_REG_TRMUX_11AC , BIT27|BIT26|BIT25, DefaultAnt); //Default TX - */ - } - - if (pDM_Odm->SupportICType == ODM_RTL8188E) - { - ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT7|BIT6, Default_tx_Ant); /*PathA Resp Tx*/ - /**/ - } - else - { - ODM_SetMACReg(pDM_Odm, 0x6D8 , BIT10|BIT9|BIT8, Default_tx_Ant); /*PathA Resp Tx*/ - /**/ - } - - } - else// pDM_FatTable->RxIdleAnt == Ant - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Stay in Ori-Ant ] RxIdleAnt =%s\n",(Ant==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - pDM_FatTable->RxIdleAnt = Ant; - } -} - -VOID -odm_UpdateTxAnt( - IN PVOID pDM_VOID, - IN u1Byte Ant, - IN u4Byte MacId - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u1Byte TxAnt; - - if (pDM_FatTable->b_fix_tx_ant != NO_FIX_TX_ANT) - Ant = (pDM_FatTable->b_fix_tx_ant == FIX_TX_AT_MAIN) ? MAIN_ANT : AUX_ANT; - - if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) - { - TxAnt=Ant; - } - else - { - if(Ant == MAIN_ANT) - TxAnt = ANT1_2G; - else - TxAnt = ANT2_2G; - } - - pDM_FatTable->antsel_a[MacId] = TxAnt&BIT0; - pDM_FatTable->antsel_b[MacId] = (TxAnt&BIT1)>>1; - pDM_FatTable->antsel_c[MacId] = (TxAnt&BIT2)>>2; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Set TX-DESC value]: MacID:(( %d )), TxAnt = (( %s ))\n", MacId, (Ant == MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=(( 3'b%d%d%d ))\n",pDM_FatTable->antsel_c[MacId] , pDM_FatTable->antsel_b[MacId] , pDM_FatTable->antsel_a[MacId] )); - -} - -#ifdef BEAMFORMING_SUPPORT -#if(DM_ODM_SUPPORT_TYPE == ODM_AP) - -VOID -odm_BDC_Init( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[ BDC Initialization......] \n")); - pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; - pDM_BdcTable->BDC_Mode=BDC_MODE_NULL; - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDCcoexType_wBfer=0; - pDM_Odm->bdc_holdstate=0xff; - - if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - ODM_SetBBReg(pDM_Odm, 0xd7c , 0x0FFFFFFF, 0x1081008); - ODM_SetBBReg(pDM_Odm, 0xd80 , 0x0FFFFFFF, 0); - } - else if(pDM_Odm->SupportICType == ODM_RTL8812) - { - ODM_SetBBReg(pDM_Odm, 0x9b0 , 0x0FFFFFFF, 0x1081008); //0x9b0[30:0] = 01081008 - ODM_SetBBReg(pDM_Odm, 0x9b4 , 0x0FFFFFFF, 0); //0x9b4[31:0] = 00000000 - } - -} - - -VOID -odm_CSI_on_off( - IN PVOID pDM_VOID, - IN u1Byte CSI_en - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if(CSI_en==CSI_ON) - { - if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 1); //0xd84[11]=1 - } - else if(pDM_Odm->SupportICType == ODM_RTL8812) - { - ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 1); //0x9b0[31]=1 - } - - } - else if(CSI_en==CSI_OFF) - { - if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - ODM_SetMACReg(pDM_Odm, 0xd84 , BIT11, 0); //0xd84[11]=0 - } - else if(pDM_Odm->SupportICType == ODM_RTL8812) - { - ODM_SetMACReg(pDM_Odm, 0x9b0 , BIT31, 0); //0x9b0[31]=0 - } - } -} - -VOID -odm_BDCcoexType_withBferClient( - IN PVOID pDM_VOID, - IN u1Byte swch - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; - u1Byte BDCcoexType_wBfer; - - if(swch==DIVON_CSIOFF) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 1] {DIV,CSI} ={1,0} \n")); - BDCcoexType_wBfer=1; - - if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); - odm_CSI_on_off(pDM_Odm,CSI_OFF); - pDM_BdcTable->BDCcoexType_wBfer=1; - } - } - else if(swch==DIVOFF_CSION) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BDCcoexType: 2] {DIV,CSI} ={0,1}\n")); - BDCcoexType_wBfer=2; - - if(BDCcoexType_wBfer != pDM_BdcTable->BDCcoexType_wBfer) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - odm_CSI_on_off(pDM_Odm,CSI_ON); - pDM_BdcTable->BDCcoexType_wBfer=2; - } - } -} - -VOID -odm_BF_AntDiv_ModeArbitration( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; - u1Byte current_BDC_Mode; - - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n")); - - //2 Mode 1 - if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client == 0)) - { - current_BDC_Mode=BDC_MODE_1; - - if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) - { - pDM_BdcTable->BDC_Mode=BDC_MODE_1; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - pDM_BdcTable->BDC_RxIdleUpdate_counter=1; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode1 ))\n")); - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode1 ))\n")); - } - //2 Mode 2 - else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client != 0)) - { - current_BDC_Mode=BDC_MODE_2; - - if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) - { - pDM_BdcTable->BDC_Mode=BDC_MODE_2; - pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; - pDM_BdcTable->BDC_Try_flag=0; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode2 ))\n")); - - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode2 ))\n")); - } - //2 Mode 3 - else if((pDM_BdcTable->num_Txbfee_Client !=0) && (pDM_BdcTable->num_Txbfer_Client != 0)) - { - current_BDC_Mode=BDC_MODE_3; - - if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) - { - pDM_BdcTable->BDC_Mode=BDC_MODE_3; - pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDC_RxIdleUpdate_counter=1; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode3 ))\n")); - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode3 ))\n")); - } - //2 Mode 4 - else if((pDM_BdcTable->num_Txbfee_Client ==0) && (pDM_BdcTable->num_Txbfer_Client == 0)) - { - current_BDC_Mode=BDC_MODE_4; - - if(current_BDC_Mode != pDM_BdcTable->BDC_Mode) - { - pDM_BdcTable->BDC_Mode=BDC_MODE_4; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to (( Mode4 ))\n")); - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Antdiv + BF coextance Mode] : (( Mode4 ))\n")); - } - #endif - -} - -VOID -odm_DivTrainState_setting( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pBDC_T pDM_BdcTable=&pDM_Odm->DM_BdcTable; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n*****[S T A R T ]***** [2-0. DIV_TRAIN_STATE] \n")); - pDM_BdcTable->BDC_Try_counter =2; - pDM_BdcTable->BDC_Try_flag=1; - pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); -} - -VOID -odm_BDCcoex_BFeeRxDiv_Arbitration( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; - BOOLEAN StopBF_flag; - u1Byte BDC_active_Mode; - - - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BFee, num_BFer , num_Client} = (( %d , %d , %d)) \n",pDM_BdcTable->num_Txbfee_Client,pDM_BdcTable->num_Txbfer_Client,pDM_BdcTable->num_Client)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{ num_BF_tars, num_DIV_tars } = (( %d , %d )) \n",pDM_BdcTable->num_BfTar , pDM_BdcTable->num_DivTar )); - - //2 [ MIB control ] - if (pDM_Odm->bdc_holdstate==2) - { - odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); - pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ BF STATE] \n")); - return; - } - else if (pDM_Odm->bdc_holdstate==1) - { - pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); - return; - } - - //------------------------------------------------------------ - - - - //2 Mode 2 & 3 - if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) - { - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n{ Try_flag , Try_counter } = { %d , %d } \n",pDM_BdcTable->BDC_Try_flag,pDM_BdcTable->BDC_Try_counter)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDCcoexType = (( %d )) \n\n", pDM_BdcTable->BDCcoexType_wBfer)); - - // All Client have Bfer-Cap------------------------------- - if(pDM_BdcTable->num_Txbfer_Client == pDM_BdcTable->num_Client) //BFer STA Only?: yes - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( Yes ))\n")); - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); - return; - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BFer STA only? (( No ))\n")); - } - // - if(pDM_BdcTable->bAll_BFSta_Idle==FALSE && pDM_BdcTable->bAll_DivSta_Idle==TRUE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All DIV-STA are idle, but BF-STA not\n")); - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); - return; - } - else if(pDM_BdcTable->bAll_BFSta_Idle==TRUE && pDM_BdcTable->bAll_DivSta_Idle==FALSE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("All BF-STA are idle, but DIV-STA not\n")); - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - return; - } - - //Select active mode-------------------------------------- - if(pDM_BdcTable->num_BfTar ==0) // Selsect_1, Selsect_2 - { - if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 1 )) \n")); - pDM_BdcTable->BDC_active_Mode=1; - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 2 ))\n")); - pDM_BdcTable->BDC_active_Mode=2; - } - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - return; - } - else // num_BfTar > 0 - { - if(pDM_BdcTable->num_DivTar ==0) // Selsect_3 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 3 ))\n")); - pDM_BdcTable->BDC_active_Mode=3; - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDC_state=BDC_BFer_TRAIN_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); - return; - } - else // Selsect_4 - { - BDC_active_Mode=4; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Select active mode (( 4 ))\n")); - - if(BDC_active_Mode!=pDM_BdcTable->BDC_active_Mode) - { - pDM_BdcTable->BDC_active_Mode=4; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Change to active mode (( 4 )) & return!!! \n")); - return; - } - } - } - -#if 1 - if (pDM_Odm->bdc_holdstate==0xff) - { - pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Force in [ DIV STATE] \n")); - return; - } -#endif - - // Does Client number changed ? ------------------------------- - if(pDM_BdcTable->num_Client !=pDM_BdcTable->pre_num_Client) - { - pDM_BdcTable->BDC_Try_flag=0; - pDM_BdcTable->BDC_state=BDC_DIV_TRAIN_STATE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ The number of client has been changed !!!] return to (( BDC_DIV_TRAIN_STATE )) \n")); - } - pDM_BdcTable->pre_num_Client=pDM_BdcTable->num_Client; - - if( pDM_BdcTable->BDC_Try_flag==0) - { - //2 DIV_TRAIN_STATE (Mode 2-0) - if(pDM_BdcTable->BDC_state==BDC_DIV_TRAIN_STATE) - { - odm_DivTrainState_setting( pDM_Odm); - } - //2 BFer_TRAIN_STATE (Mode 2-1) - else if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-1. BFer_TRAIN_STATE ]***** \n")); - - //if(pDM_BdcTable->num_BfTar==0) - //{ - // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); - // odm_DivTrainState_setting( pDM_Odm); - //} - //else //num_BfTar != 0 - //{ - pDM_BdcTable->BDC_Try_counter=2; - pDM_BdcTable->BDC_Try_flag=1; - pDM_BdcTable->BDC_state=BDC_DECISION_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), [ BDC_BFer_TRAIN_STATE ] >> [BDC_DECISION_STATE] \n")); - //} - } - //2 DECISION_STATE (Mode 2-2) - else if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-2. DECISION_STATE]***** \n")); - //if(pDM_BdcTable->num_BfTar==0) - //{ - // ODM_AntDiv_Printk(("BF_tars exist? : (( No )), [ DECISION_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); - // odm_DivTrainState_setting( pDM_Odm); - //} - //else //num_BfTar != 0 - //{ - if(pDM_BdcTable->BF_pass==FALSE || pDM_BdcTable->DIV_pass == FALSE) - StopBF_flag=TRUE; - else - StopBF_flag=FALSE; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes )), {BF_pass, DIV_pass, StopBF_flag } = { %d, %d, %d } \n" ,pDM_BdcTable->BF_pass,pDM_BdcTable->DIV_pass,StopBF_flag)); - - if(StopBF_flag==TRUE) //DIV_en - { - pDM_BdcTable->BDC_Hold_counter=10; //20 - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ StopBF_flag= ((TRUE)), BDC_DECISION_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); - } - else //BF_en - { - pDM_BdcTable->BDC_Hold_counter=10; //20 - odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); - pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[StopBF_flag= ((FALSE)), BDC_DECISION_STATE ] >> [BDC_BF_HOLD_STATE] \n")); - } - //} - } - //2 BF-HOLD_STATE (Mode 2-3) - else if(pDM_BdcTable->BDC_state==BDC_BF_HOLD_STATE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-3. BF_HOLD_STATE ]*****\n")); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); - - if(pDM_BdcTable->BDC_Hold_counter==1) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); - odm_DivTrainState_setting( pDM_Odm); - } - else - { - pDM_BdcTable->BDC_Hold_counter--; - - //if(pDM_BdcTable->num_BfTar==0) - //{ - // ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); - // odm_DivTrainState_setting( pDM_Odm); - //} - //else //num_BfTar != 0 - //{ - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BF_tars exist? : (( Yes ))\n")); - pDM_BdcTable->BDC_state=BDC_BF_HOLD_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVOFF_CSION); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_BF_HOLD_STATE ] >> [BDC_BF_HOLD_STATE] \n")); - //} - } - - } - //2 DIV-HOLD_STATE (Mode 2-4) - else if(pDM_BdcTable->BDC_state==BDC_DIV_HOLD_STATE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*****[2-4. DIV_HOLD_STATE ]*****\n")); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("BDC_Hold_counter = (( %d )) \n",pDM_BdcTable->BDC_Hold_counter )); - - if(pDM_BdcTable->BDC_Hold_counter==1) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE] \n")); - odm_DivTrainState_setting( pDM_Odm); - } - else - { - pDM_BdcTable->BDC_Hold_counter--; - pDM_BdcTable->BDC_state=BDC_DIV_HOLD_STATE; - odm_BDCcoexType_withBferClient( pDM_Odm, DIVON_CSIOFF); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_HOLD_STATE] \n")); - } - - } - - } - else if( pDM_BdcTable->BDC_Try_flag==1) - { - //2 Set Training Counter - if(pDM_BdcTable->BDC_Try_counter >1) - { - pDM_BdcTable->BDC_Try_counter--; - if(pDM_BdcTable->BDC_Try_counter ==1) - pDM_BdcTable->BDC_Try_flag=0; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training !!\n")); - //return ; - } - - } - - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n[end]\n")); - - #endif //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) - - - - - - -} - -#endif -#endif //#ifdef BEAMFORMING_SUPPORT - - -#if (RTL8188E_SUPPORT == 1) - - -VOID -odm_RX_HWAntDiv_Init_88E( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte value32; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - #if 0 - if(pDM_Odm->mp_mode == TRUE) - { - ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv - ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); // 1:CG, 0:CS - return; - } - #endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); - - //MAC Setting - value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); - ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output - //Pin Settings - ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW - ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW - ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 1); //Regb2c[22]=1'b0 //disable CS/CG switch - ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only - //OFDM Settings - ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); - //CCK Settings - ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples - - ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , 0xFFFF, 0x0001); //antenna mapping table - - pDM_FatTable->enable_ctrl_frame_antdiv = 1; -} - -VOID -odm_TRX_HWAntDiv_Init_88E( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte value32; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - #if 0 - if(pDM_Odm->mp_mode == TRUE) - { - ODM_SetBBReg(pDM_Odm, ODM_REG_IGI_A_11N , BIT7, 0); // disable HW AntDiv - ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT5|BIT4|BIT3, 0); //Default RX (0/1) - return; - } - #endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV (SPDT)]\n")); - - //MAC Setting - value32 = ODM_GetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord); - ODM_SetMACReg(pDM_Odm, ODM_REG_ANTSEL_PIN_11N, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output - //Pin Settings - ODM_SetBBReg(pDM_Odm, ODM_REG_PIN_CTRL_11N , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW - ODM_SetBBReg(pDM_Odm, ODM_REG_RX_ANT_CTRL_11N , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW - ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch - ODM_SetBBReg(pDM_Odm, ODM_REG_LNA_SWITCH_11N , BIT31, 1); //Regb2c[31]=1'b1 //output at CG only - //OFDM Settings - ODM_SetBBReg(pDM_Odm, ODM_REG_ANTDIV_PARA1_11N , bMaskDWord, 0x000000a0); - //CCK Settings - ODM_SetBBReg(pDM_Odm, ODM_REG_BB_PWR_SAV4_11N , BIT7, 1); //Fix CCK PHY status report issue - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_ANTDIV_PARA2_11N , BIT4, 1); //CCK complete HW AntDiv within 64 samples - - //antenna mapping table - if(!pDM_Odm->bIsMPChip) //testchip - { - ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 - ODM_SetBBReg(pDM_Odm, ODM_REG_RX_DEFUALT_A_11N , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 - } - else //MPchip - ODM_SetBBReg(pDM_Odm, ODM_REG_ANT_MAPPING1_11N , bMaskDWord, 0x0201); /*Reg914=3'b010, Reg915=3'b001*/ - - pDM_FatTable->enable_ctrl_frame_antdiv = 1; -} - - -#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -VOID -odm_Smart_HWAntDiv_Init_88E( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte value32, i; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); - - #if 0 - if(pDM_Odm->mp_mode == TRUE) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("pDM_Odm->AntDivType: %d\n", pDM_Odm->AntDivType)); - return; - } - #endif - - pDM_FatTable->TrainIdx = 0; - pDM_FatTable->FAT_State = FAT_PREPARE_STATE; - - pDM_Odm->fat_comb_a=5; - pDM_Odm->antdiv_intvl = 0x64; // 100ms - - for(i=0; i<6; i++) - { - pDM_FatTable->Bssid[i] = 0; - } - for(i=0; i< (pDM_Odm->fat_comb_a) ; i++) - { - pDM_FatTable->antSumRSSI[i] = 0; - pDM_FatTable->antRSSIcnt[i] = 0; - pDM_FatTable->antAveRSSI[i] = 0; - } - - //MAC Setting - value32 = ODM_GetMACReg(pDM_Odm, 0x4c, bMaskDWord); - ODM_SetMACReg(pDM_Odm, 0x4c, bMaskDWord, value32|(BIT23|BIT25)); //Reg4C[25]=1, Reg4C[23]=1 for pin output - value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); - ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); //Reg7B4[16]=1 enable antenna training, Reg7B4[17]=1 enable A2 match - //value32 = PlatformEFIORead4Byte(Adapter, 0x7B4); - //PlatformEFIOWrite4Byte(Adapter, 0x7b4, value32|BIT18); //append MACID in reponse packet - - //Match MAC ADDR - ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0); - ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); - - ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0);//Reg870[8]=1'b0, Reg870[9]=1'b0 //antsel antselb by HW - ODM_SetBBReg(pDM_Odm, 0x864 , BIT10, 0); //Reg864[10]=1'b0 //antsel2 by HW - ODM_SetBBReg(pDM_Odm, 0xb2c , BIT22, 0); //Regb2c[22]=1'b0 //disable CS/CG switch - ODM_SetBBReg(pDM_Odm, 0xb2c , BIT31, 0); //Regb2c[31]=1'b1 //output at CS only - ODM_SetBBReg(pDM_Odm, 0xca4 , bMaskDWord, 0x000000a0); - - //antenna mapping table - if(pDM_Odm->fat_comb_a == 2) - { - if(!pDM_Odm->bIsMPChip) //testchip - { - ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 1); //Reg858[10:8]=3'b001 - ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 2); //Reg858[13:11]=3'b010 - } - else //MPchip - { - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 1); - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); - } - } - else - { - if(!pDM_Odm->bIsMPChip) //testchip - { - ODM_SetBBReg(pDM_Odm, 0x858 , BIT10|BIT9|BIT8, 0); //Reg858[10:8]=3'b000 - ODM_SetBBReg(pDM_Odm, 0x858 , BIT13|BIT12|BIT11, 1); //Reg858[13:11]=3'b001 - ODM_SetBBReg(pDM_Odm, 0x878 , BIT16, 0); - ODM_SetBBReg(pDM_Odm, 0x858 , BIT15|BIT14, 2); //(Reg878[0],Reg858[14:15])=3'b010 - ODM_SetBBReg(pDM_Odm, 0x878 , BIT19|BIT18|BIT17, 3);//Reg878[3:1]=3b'011 - ODM_SetBBReg(pDM_Odm, 0x878 , BIT22|BIT21|BIT20, 4);//Reg878[6:4]=3b'100 - ODM_SetBBReg(pDM_Odm, 0x878 , BIT25|BIT24|BIT23, 5);//Reg878[9:7]=3b'101 - ODM_SetBBReg(pDM_Odm, 0x878 , BIT28|BIT27|BIT26, 6);//Reg878[12:10]=3b'110 - ODM_SetBBReg(pDM_Odm, 0x878 , BIT31|BIT30|BIT29, 7);//Reg878[15:13]=3b'111 - } - else //MPchip - { - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 4); // 0: 3b'000 - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 2); // 1: 3b'001 - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte2, 0); // 2: 3b'010 - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte3, 1); // 3: 3b'011 - ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte0, 3); // 4: 3b'100 - ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte1, 5); // 5: 3b'101 - ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte2, 6); // 6: 3b'110 - ODM_SetBBReg(pDM_Odm, 0x918 , bMaskByte3, 255); // 7: 3b'111 - } - } - - //Default Ant Setting when no fast training - ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, 0); //Default RX - ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, 1); //Optional RX - ODM_SetBBReg(pDM_Odm, 0x860 , BIT14|BIT13|BIT12, 0);//Default TX - - //Enter Traing state - ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, (pDM_Odm->fat_comb_a-1)); //Reg864[2:0]=3'd6 //ant combination=reg864[2:0]+1 - - //SW Control - //PHY_SetBBReg(Adapter, 0x864 , BIT10, 1); - //PHY_SetBBReg(Adapter, 0x870 , BIT9, 1); - //PHY_SetBBReg(Adapter, 0x870 , BIT8, 1); - //PHY_SetBBReg(Adapter, 0x864 , BIT11, 1); - //PHY_SetBBReg(Adapter, 0x860 , BIT9, 0); - //PHY_SetBBReg(Adapter, 0x860 , BIT8, 0); -} -#endif - -#endif //#if (RTL8188E_SUPPORT == 1) - - -#if (RTL8192E_SUPPORT == 1) -VOID -odm_RX_HWAntDiv_Init_92E( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - #if 0 - if(pDM_Odm->mp_mode == TRUE) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS - return; - } - #endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CGCS_RX_HW_ANTDIV]\n")); - - //Pin Settings - ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0);//Reg870[8]=1'b0, // "antsel" is controled by HWs - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 1); //Regc50[8]=1'b1 //" CS/CG switching" is controled by HWs - - //Mapping table - ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table - - //OFDM Settings - ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold - ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias - - //CCK Settings - ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 - ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 - ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue - ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples - - #ifdef ODM_EVM_ENHANCE_ANTDIV - //EVM enhance AntDiv method init---------------------------------------------------------------------- - pDM_FatTable->EVM_method_enable=0; - pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; - pDM_Odm->antdiv_intvl = 0x64; - ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); - pDM_Odm->antdiv_evm_en=1; - //pDM_Odm->antdiv_period=1; - pDM_Odm->evm_antdiv_period = 3; - - #endif - -} - -VOID -odm_TRX_HWAntDiv_Init_92E( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - #if 0 - if(pDM_Odm->mp_mode == TRUE) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); //r_rxdiv_enable_anta Regc50[8]=1'b0 0: control by c50[9] - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT9, 1); // 1:CG, 0:CS - return; - } - #endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[ Only for DIR605, CG_TRX_HW_ANTDIV]\n")); - - //3 --RFE pin setting--------- - //[MAC] - ODM_SetMACReg(pDM_Odm, 0x38, BIT11, 1); //DBG PAD Driving control (GPIO 8) - ODM_SetMACReg(pDM_Odm, 0x4c, BIT23, 0); //path-A , RFE_CTRL_3 - ODM_SetMACReg(pDM_Odm, 0x4c, BIT29, 1); //path-A , RFE_CTRL_8 - //[BB] - ODM_SetBBReg(pDM_Odm, 0x944 , BIT3, 1); //RFE_buffer - ODM_SetBBReg(pDM_Odm, 0x944 , BIT8, 1); - ODM_SetBBReg(pDM_Odm, 0x940 , BIT7|BIT6, 0x0); // r_rfe_path_sel_ (RFE_CTRL_3) - ODM_SetBBReg(pDM_Odm, 0x940 , BIT17|BIT16, 0x0); // r_rfe_path_sel_ (RFE_CTRL_8) - ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); //RFE_buffer - ODM_SetBBReg(pDM_Odm, 0x92C , BIT3, 0); //rfe_inv (RFE_CTRL_3) - ODM_SetBBReg(pDM_Odm, 0x92C , BIT8, 1); //rfe_inv (RFE_CTRL_8) - ODM_SetBBReg(pDM_Odm, 0x930 , 0xF000, 0x8); //path-A , RFE_CTRL_3 - ODM_SetBBReg(pDM_Odm, 0x934 , 0xF, 0x8); //path-A , RFE_CTRL_8 - //3 ------------------------- - - //Pin Settings - ODM_SetBBReg(pDM_Odm, 0xC50 , BIT8, 0); //path-A //disable CS/CG switch - -/* Let it follows PHY_REG for bit9 setting - if(pDM_Odm->priv->pshare->rf_ft_var.use_ext_pa || pDM_Odm->priv->pshare->rf_ft_var.use_ext_lna) - ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 1);//path-A //output at CS - else - ODM_SetBBReg(pDM_Odm, 0xC50 , BIT9, 0); //path-A //output at CG ->normal power -*/ - - ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); //path-A //antsel antselb by HW - ODM_SetBBReg(pDM_Odm, 0xB38 , BIT10, 0); //path-A //antsel2 by HW - - //Mapping table - ODM_SetBBReg(pDM_Odm, 0x914 , 0xFFFF, 0x0100); //antenna mapping table - - //OFDM Settings - ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF, 0xA0); //thershold - ODM_SetBBReg(pDM_Odm, 0xca4 , 0x7FF000, 0x0); //bias - - //CCK Settings - ODM_SetBBReg(pDM_Odm, 0xa04 , 0xF000000, 0); //Select which path to receive for CCK_1 & CCK_2 - ODM_SetBBReg(pDM_Odm, 0xb34 , BIT30, 0); //(92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 - ODM_SetBBReg(pDM_Odm, 0xa74 , BIT7, 1); //Fix CCK PHY status report issue - ODM_SetBBReg(pDM_Odm, 0xa0c , BIT4, 1); //CCK complete HW AntDiv within 64 samples - - #ifdef ODM_EVM_ENHANCE_ANTDIV - //EVM enhance AntDiv method init---------------------------------------------------------------------- - pDM_FatTable->EVM_method_enable=0; - pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; - pDM_Odm->antdiv_intvl = 0x64; - ODM_SetBBReg(pDM_Odm, 0x910 , 0x3f, 0xf ); - pDM_Odm->antdiv_evm_en=1; - //pDM_Odm->antdiv_period=1; - pDM_Odm->evm_antdiv_period = 3; - #endif -} - -#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -VOID -odm_Smart_HWAntDiv_Init_92E( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8192E AntDiv_Init => AntDivType=[CG_TRX_SMART_ANTDIV]\n")); -} -#endif - -#endif //#if (RTL8192E_SUPPORT == 1) - -#if (RTL8723D_SUPPORT == 1) -VOID -odm_TRX_HWAntDiv_Init_8723D( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723D] AntDiv_Init => AntDivType=[S0S1_HW_TRX_AntDiv]\n")); - - /*BT Coexistence*/ - /*keep antsel_map when GNT_BT = 1*/ - ODM_SetBBReg(pDM_Odm, 0x864, BIT12, 1); - /* //Disable hw antsw & fast_train.antsw when GNT_BT=1*/ - ODM_SetBBReg(pDM_Odm, 0x874 , BIT23, 0); - /*//Disable hw antsw & fast_train.antsw when BT TX/RX*/ - ODM_SetBBReg(pDM_Odm, 0xE64 , 0xFFFF0000, 0x000c); - - - ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); - /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ - /*ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0);*/ - /*ODM_SetBBReg(pDM_Odm, 0x948 , BIT8, 0);*/ - /*GNT_WL tx*/ - ODM_SetBBReg(pDM_Odm, 0x950 , BIT29, 0); - - - /*Mapping Table*/ - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 3); - /*ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, 0);*/ - /*ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, 1);*/ - - /* //Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0]*/ - ODM_SetBBReg(pDM_Odm, 0xCcc, BIT12, 0); - /* //Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable*/ - ODM_SetBBReg(pDM_Odm, 0xCcc , 0x0F, 0x01); - /*//High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable*/ - ODM_SetBBReg(pDM_Odm, 0xCcc , 0xF0, 0x0); - /* //b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK )*/ - ODM_SetBBReg(pDM_Odm, 0xAbc , 0xFF, 0x06); - /* //High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK )*/ - ODM_SetBBReg(pDM_Odm, 0xAbc , 0xFF00, 0x00); - - - /*OFDM HW AntDiv Parameters*/ - ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF, 0xa0); - ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF000, 0x00); - ODM_SetBBReg(pDM_Odm, 0xC5C , BIT20|BIT19|BIT18, 0x04); - - /*CCK HW AntDiv Parameters*/ - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); - ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); - ODM_SetBBReg(pDM_Odm, 0xAA8 , BIT8, 0); - - ODM_SetBBReg(pDM_Odm, 0xA0C , 0x0F, 0xf); - ODM_SetBBReg(pDM_Odm, 0xA14 , 0x1F, 0x8); - ODM_SetBBReg(pDM_Odm, 0xA10 , BIT13, 0x1); - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT8, 0x0); - ODM_SetBBReg(pDM_Odm, 0xB34 , BIT30, 0x1); - - /*disable antenna training */ - ODM_SetBBReg(pDM_Odm, 0xE08 , BIT16, 0); - ODM_SetBBReg(pDM_Odm, 0xc50 , BIT8, 0); - -} - -VOID -phydm_set_tx_ant_pwr_8723d( - IN PVOID pDM_VOID, - IN u1Byte Ant -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - PADAPTER pAdapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - pDM_FatTable->RxIdleAnt = Ant; - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); - #elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); - #endif - -} -#endif - -#if (RTL8723B_SUPPORT == 1) -VOID -odm_TRX_HWAntDiv_Init_8723B( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[CG_TRX_HW_ANTDIV(DPDT)]\n")); - - //Mapping Table - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); - - //OFDM HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF, 0xa0); //thershold - ODM_SetBBReg(pDM_Odm, 0xCA4 , 0x7FF000, 0x00); //bias - - //CCK HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M - ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples - - //BT Coexistence - ODM_SetBBReg(pDM_Odm, 0x864, BIT12, 0); //keep antsel_map when GNT_BT = 1 - ODM_SetBBReg(pDM_Odm, 0x874 , BIT23, 0); //Disable hw antsw & fast_train.antsw when GNT_BT=1 - - //Output Pin Settings - ODM_SetBBReg(pDM_Odm, 0x870 , BIT8, 0); // - - ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0); //WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) - ODM_SetBBReg(pDM_Odm, 0x948 , BIT7, 0); - - ODM_SetMACReg(pDM_Odm, 0x40 , BIT3, 1); - ODM_SetMACReg(pDM_Odm, 0x38 , BIT11, 1); - ODM_SetMACReg(pDM_Odm, 0x4C , BIT24|BIT23, 2); //select DPDT_P and DPDT_N as output pin - - ODM_SetBBReg(pDM_Odm, 0x944 , BIT0|BIT1, 3); //in/out - ODM_SetBBReg(pDM_Odm, 0x944 , BIT31, 0); // - - ODM_SetBBReg(pDM_Odm, 0x92C , BIT1, 0); //DPDT_P non-inverse - ODM_SetBBReg(pDM_Odm, 0x92C , BIT0, 1); //DPDT_N inverse - - ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] - - //2 [--For HW Bug Setting] - if(pDM_Odm->AntType == ODM_AUTO_ANT) - ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable - -} - - - -VOID -odm_S0S1_SWAntDiv_Init_8723B( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8723B AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv] \n")); - - //Mapping Table - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0x914 , bMaskByte1, 1); - - //Output Pin Settings - //ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); - ODM_SetBBReg(pDM_Odm, 0x870 , BIT9|BIT8, 0); - - pDM_FatTable->bBecomeLinked =FALSE; - pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; - pDM_SWAT_Table->Double_chk_flag = 0; - - //2 [--For HW Bug Setting] - ODM_SetBBReg(pDM_Odm, 0x80C , BIT21, 0); //TX Ant by Reg - -} - -VOID -ODM_UpdateRxIdleAnt_8723B( - IN PVOID pDM_VOID, - IN u1Byte Ant, - IN u4Byte DefaultAnt, - IN u4Byte OptionalAnt -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - PADAPTER pAdapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u1Byte count=0; - u1Byte u1Temp; - u1Byte H2C_Parameter; - - if ((!pDM_Odm->bLinked) && (pDM_Odm->AntType == ODM_AUTO_ANT)) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to no link\n")); - return; - } - -#if 0 - // Send H2C command to FW - // Enable wifi calibration - H2C_Parameter = TRUE; - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); - - // Check if H2C command sucess or not (0x1e6) - u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); - while((u1Temp != 0x1) && (count < 100)) - { - ODM_delay_us(10); - u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e6); - count++; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: H2C command status = %d, count = %d\n", u1Temp, count)); - - if(u1Temp == 0x1) - { - // Check if BT is doing IQK (0x1e7) - count = 0; - u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); - while((!(u1Temp & BIT0)) && (count < 100)) - { - ODM_delay_us(50); - u1Temp = ODM_Read1Byte(pDM_Odm, 0x1e7); - count++; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: BT IQK status = %d, count = %d\n", u1Temp, count)); - - if(u1Temp & BIT0) - { - ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); - ODM_SetBBReg(pDM_Odm, 0x948 , BIT9, DefaultAnt); - ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); //Default RX - ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); //Optional RX - ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); //Default TX - pDM_FatTable->RxIdleAnt = Ant; - - // Set TX AGC by S0/S1 - // Need to consider Linux driver -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); -#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); -#endif - - // Set IQC by S0/S1 - ODM_SetIQCbyRFpath(pDM_Odm,DefaultAnt); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Sucess to set RX antenna\n")); - } - else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to BT IQK\n")); - } - else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Fail to set RX antenna due to H2C command fail\n")); - - // Send H2C command to FW - // Disable wifi calibration - H2C_Parameter = FALSE; - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_WIFI_CALIBRATION, 1, &H2C_Parameter); -#else - - ODM_SetBBReg(pDM_Odm, 0x948 , BIT6, 0x1); - ODM_SetBBReg(pDM_Odm, 0x948 , BIT9, DefaultAnt); - ODM_SetBBReg(pDM_Odm, 0x864 , BIT5|BIT4|BIT3, DefaultAnt); /*Default RX*/ - ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, OptionalAnt); /*Optional RX*/ - ODM_SetBBReg(pDM_Odm, 0x860, BIT14|BIT13|BIT12, DefaultAnt); /*Default TX*/ - pDM_FatTable->RxIdleAnt = Ant; - - /* Set TX AGC by S0/S1 */ - /* Need to consider Linux driver */ - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pAdapter->HalFunc.SetTxPowerLevelHandler(pAdapter, pHalData->CurrentChannel); - #elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - rtw_hal_set_tx_power_level(pAdapter, pHalData->CurrentChannel); - #endif - - /* Set IQC by S0/S1 */ - ODM_SetIQCbyRFpath(pDM_Odm, DefaultAnt); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Ant ] 8723B: Success to set RX antenna\n")); - -#endif -} - -BOOLEAN -phydm_IsBtEnable_8723b( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte bt_state; - /*u4Byte reg75;*/ - - /*reg75 = ODM_GetBBReg(pDM_Odm, 0x74 , BIT8);*/ - /*ODM_SetBBReg(pDM_Odm, 0x74 , BIT8, 0x0);*/ - ODM_SetBBReg(pDM_Odm, 0xa0 , BIT24|BIT25|BIT26, 0x5); - bt_state = ODM_GetBBReg(pDM_Odm, 0xa0 , (BIT3|BIT2|BIT1|BIT0)); - /*ODM_SetBBReg(pDM_Odm, 0x74 , BIT8, reg75);*/ - - if ((bt_state == 4) || (bt_state == 7) || (bt_state == 9) || (bt_state == 13)) - return TRUE; - else - return FALSE; -} -#endif //#if (RTL8723B_SUPPORT == 1) - -#if (RTL8821A_SUPPORT == 1) -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -VOID -phydm_hl_smart_ant_type1_init_8821a( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u4Byte value32; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A SmartAnt_Init => AntDivType=[Hong-Lin Smart Ant Type1]\n")); - - /*---------------------------------------- - GPIO 2-3 for Beam control - reg0x66[2]=0 - reg0x44[27:26] = 0 - reg0x44[23:16] //enable_output for P_GPIO[7:0] - reg0x44[15:8] //output_value for P_GPIO[7:0] - reg0x40[1:0] = 0 //GPIO function - ------------------------------------------*/ - - /*GPIO Setting*/ - ODM_SetMACReg(pDM_Odm, 0x64 , BIT18, 0); - ODM_SetMACReg(pDM_Odm, 0x44 , BIT27|BIT26, 0); - ODM_SetMACReg(pDM_Odm, 0x44 , BIT19|BIT18, 0x3); /*enable_output for P_GPIO[3:2]*/ - /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, 0);*/ /*output value*/ - ODM_SetMACReg(pDM_Odm, 0x40 , BIT1|BIT0, 0); /*GPIO function*/ - - /*Hong_lin smart antenna HW Setting*/ - pdm_sat_table->data_codeword_bit_num = 24;/*max=32*/ - pdm_sat_table->beam_patten_num_each_ant = 4; - - #if DEV_BUS_TYPE == RT_SDIO_INTERFACE - pdm_sat_table->latch_time = 100; /*mu sec*/ - #elif DEV_BUS_TYPE == RT_USB_INTERFACE - pdm_sat_table->latch_time = 100; /*mu sec*/ - #endif - pdm_sat_table->pkt_skip_statistic_en = 0; - - pdm_sat_table->ant_num = 1;/*max=8*/ - pdm_sat_table->ant_num_total = NUM_ANTENNA_8821A; - pdm_sat_table->first_train_ant = MAIN_ANT; - - pdm_sat_table->rfu_codeword_table[0] = 0x0; - pdm_sat_table->rfu_codeword_table[1] = 0x4; - pdm_sat_table->rfu_codeword_table[2] = 0x8; - pdm_sat_table->rfu_codeword_table[3] = 0xc; - - pdm_sat_table->rfu_codeword_table_5g[0] = 0x1; - pdm_sat_table->rfu_codeword_table_5g[1] = 0x2; - pdm_sat_table->rfu_codeword_table_5g[2] = 0x4; - pdm_sat_table->rfu_codeword_table_5g[3] = 0x8; - - pdm_sat_table->fix_beam_pattern_en = 0; - pdm_sat_table->decision_holding_period = 0; - - /*beam training setting*/ - pdm_sat_table->pkt_counter = 0; - pdm_sat_table->per_beam_training_pkt_num = 10; - - /*set default beam*/ - pdm_sat_table->fast_training_beam_num = 0; - pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; - phydm_set_all_ant_same_beam_num(pDM_Odm); - - pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; - - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskDWord, 0x01000100); - ODM_SetBBReg(pDM_Odm, 0xCA8 , bMaskDWord, 0x01000100); - - /*[BB] FAT Setting*/ - ODM_SetBBReg(pDM_Odm, 0xc08 , BIT18|BIT17|BIT16, pdm_sat_table->ant_num); - ODM_SetBBReg(pDM_Odm, 0xc08 , BIT31, 0); /*increase ant num every FAT period 0:+1, 1+2*/ - ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT2|BIT1, 1); /*change cca antenna timming threshold if no CCA occurred: 0:200ms / 1:100ms / 2:no use / 3: 300*/ - ODM_SetBBReg(pDM_Odm, 0x8c4 , BIT0, 1); /*FAT_watchdog_en*/ - - value32 = ODM_GetMACReg(pDM_Odm, 0x7B4, bMaskDWord); - ODM_SetMACReg(pDM_Odm, 0x7b4, bMaskDWord, value32|(BIT16|BIT17)); /*Reg7B4[16]=1 enable antenna training */ - /*Reg7B4[17]=1 enable match MAC Addr*/ - ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, 0);/*Match MAC ADDR*/ - ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, 0); - -} -#endif - -VOID -odm_TRX_HWAntDiv_Init_8821A( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (DPDT)] \n")); - - //Output Pin Settings - ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); - - ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control - ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control - - ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); - ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); - - ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin - ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control - ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse - - //Mapping Table - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); - - //OFDM HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias - - //CCK HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M - ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples - - ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit - ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable - - //BT Coexistence - ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 - ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 - - ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns - - //response TX ant by RX ant - ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); - -} - -VOID -odm_S0S1_SWAntDiv_Init_8821A( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821A AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv]\n")); - - //Output Pin Settings - ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); - - ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control - ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control - - ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); - ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); - - ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin - ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control - ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse - - //Mapping Table - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); - - //OFDM HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias - - //CCK HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M - ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples - - ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit - ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable - - //BT Coexistence - ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 - ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 - - ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns - - //response TX ant by RX ant - ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); - - - ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); - - pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; - pDM_SWAT_Table->Double_chk_flag = 0; - pDM_SWAT_Table->CurAntenna = MAIN_ANT; - pDM_SWAT_Table->PreAntenna = MAIN_ANT; - pDM_SWAT_Table->SWAS_NoLink_State = 0; - -} -#endif //#if (RTL8821A_SUPPORT == 1) - -#if (RTL8821C_SUPPORT == 1) -VOID -odm_TRX_HWAntDiv_Init_8821C( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8821C AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (DPDT)] \n")); - //Output Pin Settings - ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); - - ODM_SetMACReg(pDM_Odm, 0x64 , BIT29, 1); //PAPE by WLAN control - ODM_SetMACReg(pDM_Odm, 0x64 , BIT28, 1); //LNAON by WLAN control - - ODM_SetBBReg(pDM_Odm, 0xCB0 , bMaskDWord, 0x77775745); - ODM_SetBBReg(pDM_Odm, 0xCB8 , BIT16, 0); - - ODM_SetMACReg(pDM_Odm, 0x4C , BIT23, 0); //select DPDT_P and DPDT_N as output pin - ODM_SetMACReg(pDM_Odm, 0x4C , BIT24, 1); //by WLAN control - ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF, 8); // DPDT_P = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB4 , 0xF0, 8); // DPDT_N = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT29, 0); //DPDT_P non-inverse - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT28, 1); //DPDT_N inverse - - //Mapping Table - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); - - //OFDM HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x10); //bias - - //CCK HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M - ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples - - ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //ANTSEL_CCK sent to the smart_antenna circuit - ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function block enable - - //BT Coexistence - ODM_SetBBReg(pDM_Odm, 0xCAC , BIT9, 1); //keep antsel_map when GNT_BT = 1 - ODM_SetBBReg(pDM_Odm, 0x804 , BIT4, 1); //Disable hw antsw & fast_train.antsw when GNT_BT=1 - - //Timming issue - ODM_SetBBReg(pDM_Odm, 0x818 , BIT23|BIT22|BIT21|BIT20, 8); /*keep antidx after tx for ACK ( unit x 3.2 mu sec)*/ - ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns - - //response TX ant by RX ant - ODM_SetMACReg(pDM_Odm, 0x668 , BIT3, 1); - -} -#endif //#if (RTL8821C_SUPPORT == 1) - - -#if (RTL8881A_SUPPORT == 1) -VOID -odm_TRX_HWAntDiv_Init_8881A( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8881A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); - - //Output Pin Settings - // [SPDT related] - ODM_SetMACReg(pDM_Odm, 0x4C , BIT25, 0); - ODM_SetMACReg(pDM_Odm, 0x4C , BIT26, 0); - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT22, 0); - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT24, 1); - ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF00, 8); // DPDT_P = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000, 8); // DPDT_N = ANTSEL[0] - - //Mapping Table - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); - - //OFDM HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias - ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns - - //CCK HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M - ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples - - //2 [--For HW Bug Setting] - - ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug -} - -#endif //#if (RTL8881A_SUPPORT == 1) - - -#if (RTL8812A_SUPPORT == 1) -VOID -odm_TRX_HWAntDiv_Init_8812A( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8812A AntDiv_Init => AntDivType=[ CG_TRX_HW_ANTDIV (SPDT)] \n")); - - //3 //3 --RFE pin setting--------- - //[BB] - ODM_SetBBReg(pDM_Odm, 0x900 , BIT10|BIT9|BIT8, 0x0); //disable SW switch - ODM_SetBBReg(pDM_Odm, 0x900 , BIT17|BIT16, 0x0); - ODM_SetBBReg(pDM_Odm, 0x974 , BIT7|BIT6, 0x3); // in/out - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT31, 0); //delay buffer - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT26, 0); - ODM_SetBBReg(pDM_Odm, 0xCB4 , BIT27, 1); - ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF000000, 8); // DPDT_P = ANTSEL[0] - ODM_SetBBReg(pDM_Odm, 0xCB0 , 0xF0000000, 8); // DPDT_N = ANTSEL[0] - //3 ------------------------- - - //Mapping Table - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte0, 0); - ODM_SetBBReg(pDM_Odm, 0xCA4 , bMaskByte1, 1); - - //OFDM HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF, 0xA0); //thershold - ODM_SetBBReg(pDM_Odm, 0x8D4 , 0x7FF000, 0x0); //bias - ODM_SetBBReg(pDM_Odm, 0x8CC , BIT20|BIT19|BIT18, 3); //settling time of antdiv by RF LNA = 100ns - - //CCK HW AntDiv Parameters - ODM_SetBBReg(pDM_Odm, 0xA74 , BIT7, 1); //patch for clk from 88M to 80M - ODM_SetBBReg(pDM_Odm, 0xA0C , BIT4, 1); //do 64 samples - - //2 [--For HW Bug Setting] - - ODM_SetBBReg(pDM_Odm, 0x900 , BIT18, 0); //TX Ant by Reg // A-cut bug - -} - -#endif //#if (RTL8812A_SUPPORT == 1) - -#if (RTL8188F_SUPPORT == 1) -VOID -odm_S0S1_SWAntDiv_Init_8188F( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***8188F AntDiv_Init => AntDivType=[ S0S1_SW_AntDiv]\n")); - - - /*GPIO Setting*/ - /*ODM_SetMACReg(pDM_Odm, 0x64 , BIT18, 0); */ - /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT28|BIT27, 0);*/ - ODM_SetMACReg(pDM_Odm, 0x44 , BIT20|BIT19, 0x3); /*enable_output for P_GPIO[4:3]*/ - /*ODM_SetMACReg(pDM_Odm, 0x44 , BIT12|BIT11, 0);*/ /*output value*/ - /*ODM_SetMACReg(pDM_Odm, 0x40 , BIT1|BIT0, 0);*/ /*GPIO function*/ - - pDM_FatTable->bBecomeLinked = FALSE; - pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; - pDM_SWAT_Table->Double_chk_flag = 0; -} - -VOID -phydm_update_rx_idle_antenna_8188F( - IN PVOID pDM_VOID, - IN u4Byte default_ant -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte codeword; - - if (default_ant == ANT1_2G) - codeword = 1; /*2'b01*/ - else - codeword = 2;/*2'b10*/ - - ODM_SetMACReg(pDM_Odm, 0x44 , (BIT12|BIT11), codeword); /*GPIO[4:3] output value*/ -} - -#endif - - - -#ifdef ODM_EVM_ENHANCE_ANTDIV - -VOID -odm_EVM_FastAnt_Reset( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - pDM_FatTable->EVM_method_enable=0; - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); - pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; - pDM_Odm->antdiv_period=0; - ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0); -} - - -VOID -odm_EVM_Enhance_AntDiv( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte Main_RSSI, Aux_RSSI ; - u4Byte Main_CRC_utility=0,Aux_CRC_utility=0,utility_ratio=1; - u4Byte Main_EVM, Aux_EVM,Diff_RSSI=0,diff_EVM=0; - u1Byte score_EVM=0,score_CRC=0; - u1Byte rssi_larger_ant = 0; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u4Byte value32, i; - BOOLEAN Main_above1=FALSE,Aux_above1=FALSE; - BOOLEAN Force_antenna=FALSE; - PSTA_INFO_T pEntry; - pDM_FatTable->TargetAnt_enhance=0xFF; - - - if((pDM_Odm->SupportICType & ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC)) - { - if(pDM_Odm->bOneEntryOnly) - { - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[One Client only] \n")); - i = pDM_Odm->OneEntry_MACID; - - Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; - Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; - - if((Main_RSSI==0 && Aux_RSSI !=0 && Aux_RSSI>=FORCE_RSSI_DIFF) || (Main_RSSI!=0 && Aux_RSSI==0 && Main_RSSI>=FORCE_RSSI_DIFF)) - { - Diff_RSSI=FORCE_RSSI_DIFF; - } - else if(Main_RSSI!=0 && Aux_RSSI !=0) - { - Diff_RSSI = (Main_RSSI>=Aux_RSSI)?(Main_RSSI-Aux_RSSI):(Aux_RSSI-Main_RSSI); - } - - if (Main_RSSI >= Aux_RSSI) - rssi_larger_ant = MAIN_ANT; - else - rssi_larger_ant = AUX_ANT; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Main_Cnt = (( %d )) , Main_RSSI= (( %d ))\n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Aux_Cnt = (( %d )) , Aux_RSSI = (( %d ))\n", pDM_FatTable->AuxAnt_Cnt[i], Aux_RSSI)); - - if( ((Main_RSSI>=Evm_RSSI_TH_High||Aux_RSSI>=Evm_RSSI_TH_High )|| (pDM_FatTable->EVM_method_enable==1) ) - //&& (Diff_RSSI <= FORCE_RSSI_DIFF + 1) - ) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_H || EVM_method_enable==1] && ")); - - if(((Main_RSSI>=Evm_RSSI_TH_Low)||(Aux_RSSI>=Evm_RSSI_TH_Low) )) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[> TH_L ] \n")); - - //2 [ Normal state Main] - if(pDM_FatTable->FAT_State == NORMAL_STATE_MIAN) - { - - pDM_FatTable->EVM_method_enable=1; - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - pDM_Odm->antdiv_period = pDM_Odm->evm_antdiv_period; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: MIAN] \n")); - pDM_FatTable->MainAntEVM_Sum[i] = 0; - pDM_FatTable->AuxAntEVM_Sum[i] = 0; - pDM_FatTable->MainAntEVM_Cnt[i] = 0; - pDM_FatTable->AuxAntEVM_Cnt[i] = 0; - - pDM_FatTable->FAT_State = NORMAL_STATE_AUX; - ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 1); //Accept CRC32 Error packets. - ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); - - pDM_FatTable->CRC32_Ok_Cnt=0; - pDM_FatTable->CRC32_Fail_Cnt=0; - ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //m - } - //2 [ Normal state Aux ] - else if(pDM_FatTable->FAT_State == NORMAL_STATE_AUX) - { - pDM_FatTable->MainCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; - pDM_FatTable->MainCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ start training: AUX] \n")); - pDM_FatTable->FAT_State = TRAINING_STATE; - ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); - - pDM_FatTable->CRC32_Ok_Cnt=0; - pDM_FatTable->CRC32_Fail_Cnt=0; - ODM_SetTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms - } - else if(pDM_FatTable->FAT_State == TRAINING_STATE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Training state ] \n")); - pDM_FatTable->FAT_State = NORMAL_STATE_MIAN; - - //3 [CRC32 statistic] - pDM_FatTable->AuxCRC32_Ok_Cnt=pDM_FatTable->CRC32_Ok_Cnt; - pDM_FatTable->AuxCRC32_Fail_Cnt=pDM_FatTable->CRC32_Fail_Cnt; - - if ((pDM_FatTable->MainCRC32_Ok_Cnt > ((pDM_FatTable->AuxCRC32_Ok_Cnt)<<1)) || ((Diff_RSSI >= 20) && (rssi_larger_ant == MAIN_ANT))) { - pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; - Force_antenna=TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Main\n")); - } else if ((pDM_FatTable->AuxCRC32_Ok_Cnt > ((pDM_FatTable->MainCRC32_Ok_Cnt)<<1)) || ((Diff_RSSI >= 20) && (rssi_larger_ant == AUX_ANT))) { - pDM_FatTable->TargetAnt_CRC32=AUX_ANT; - Force_antenna=TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CRC32 Force Aux\n")); - } - else - { - if(pDM_FatTable->MainCRC32_Fail_Cnt<=5) - pDM_FatTable->MainCRC32_Fail_Cnt=5; - - if(pDM_FatTable->AuxCRC32_Fail_Cnt<=5) - pDM_FatTable->AuxCRC32_Fail_Cnt=5; - - if(pDM_FatTable->MainCRC32_Ok_Cnt >pDM_FatTable->MainCRC32_Fail_Cnt ) - Main_above1=TRUE; - - if(pDM_FatTable->AuxCRC32_Ok_Cnt >pDM_FatTable->AuxCRC32_Fail_Cnt ) - Aux_above1=TRUE; - - if(Main_above1==TRUE && Aux_above1==FALSE) - { - Force_antenna=TRUE; - pDM_FatTable->TargetAnt_CRC32=MAIN_ANT; - } - else if(Main_above1==FALSE && Aux_above1==TRUE) - { - Force_antenna=TRUE; - pDM_FatTable->TargetAnt_CRC32=AUX_ANT; - } - else if(Main_above1==TRUE && Aux_above1==TRUE) - { - Main_CRC_utility=((pDM_FatTable->MainCRC32_Ok_Cnt)<<7)/pDM_FatTable->MainCRC32_Fail_Cnt; - Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Ok_Cnt)<<7)/pDM_FatTable->AuxCRC32_Fail_Cnt; - pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility>=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); - - if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) - { - if(Main_CRC_utility>=Aux_CRC_utility) - utility_ratio=(Main_CRC_utility<<1)/Aux_CRC_utility; - else - utility_ratio=(Aux_CRC_utility<<1)/Main_CRC_utility; - } - } - else if(Main_above1==FALSE && Aux_above1==FALSE) - { - if(pDM_FatTable->MainCRC32_Ok_Cnt==0) - pDM_FatTable->MainCRC32_Ok_Cnt=1; - if(pDM_FatTable->AuxCRC32_Ok_Cnt==0) - pDM_FatTable->AuxCRC32_Ok_Cnt=1; - - Main_CRC_utility=((pDM_FatTable->MainCRC32_Fail_Cnt)<<7)/pDM_FatTable->MainCRC32_Ok_Cnt; - Aux_CRC_utility=((pDM_FatTable->AuxCRC32_Fail_Cnt)<<7)/pDM_FatTable->AuxCRC32_Ok_Cnt; - pDM_FatTable->TargetAnt_CRC32 = (Main_CRC_utility==Aux_CRC_utility)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_CRC_utility<=Aux_CRC_utility)?MAIN_ANT:AUX_ANT); - - if(Main_CRC_utility!=0 && Aux_CRC_utility!=0) - { - if(Main_CRC_utility>=Aux_CRC_utility) - utility_ratio=(Main_CRC_utility<<1)/(Aux_CRC_utility); - else - utility_ratio=(Aux_CRC_utility<<1)/(Main_CRC_utility); - } - } - } - ODM_SetMACReg(pDM_Odm, 0x608, BIT8, 0);//NOT Accept CRC32 Error packets. - - //3 [EVM statistic] - Main_EVM = (pDM_FatTable->MainAntEVM_Cnt[i]!=0)?(pDM_FatTable->MainAntEVM_Sum[i]/pDM_FatTable->MainAntEVM_Cnt[i]):0; - Aux_EVM = (pDM_FatTable->AuxAntEVM_Cnt[i]!=0)?(pDM_FatTable->AuxAntEVM_Sum[i]/pDM_FatTable->AuxAntEVM_Cnt[i]):0; - pDM_FatTable->TargetAnt_EVM = (Main_EVM==Aux_EVM)?(pDM_FatTable->pre_TargetAnt_enhance):((Main_EVM>=Aux_EVM)?MAIN_ANT:AUX_ANT); - - if((Main_EVM==0 || Aux_EVM==0)) - diff_EVM=0; - else if(Main_EVM>=Aux_EVM) - diff_EVM=Main_EVM-Aux_EVM; - else - diff_EVM=Aux_EVM-Main_EVM; - - //2 [ Decision state ] - if (pDM_FatTable->TargetAnt_EVM == pDM_FatTable->TargetAnt_CRC32) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 1, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); - - if ((utility_ratio < 2 && Force_antenna == FALSE) && diff_EVM <= 30) - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->pre_TargetAnt_enhance; - else - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; - } else if ((diff_EVM <= 50 && (utility_ratio > 4 && Force_antenna == FALSE)) || (Force_antenna == TRUE)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 2, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; - } else if (diff_EVM >= 100) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 3, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; - } else if (utility_ratio >= 6 && Force_antenna == FALSE) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 4, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; - } else { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Decision Type 5, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); - - if (Force_antenna == TRUE) - score_CRC = 3; - else if (utility_ratio >= 3) /*>0.5*/ - score_CRC = 2; - else if (utility_ratio >= 2) /*>1*/ - score_CRC = 1; - else - score_CRC = 0; - - if (diff_EVM >= 100) - score_EVM = 2; - else if (diff_EVM >= 50) - score_EVM = 1; - else - score_EVM = 0; - - if (score_CRC > score_EVM) - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_CRC32; - else if (score_CRC < score_EVM) - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->TargetAnt_EVM; - else - pDM_FatTable->TargetAnt_enhance = pDM_FatTable->pre_TargetAnt_enhance; - } - pDM_FatTable->pre_TargetAnt_enhance=pDM_FatTable->TargetAnt_enhance; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MainEVM_Cnt = (( %d )) , Main_EVM= (( %d )) \n",i, pDM_FatTable->MainAntEVM_Cnt[i], Main_EVM)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : AuxEVM_Cnt = (( %d )) , Aux_EVM = (( %d )) \n" ,i, pDM_FatTable->AuxAntEVM_Cnt[i] , Aux_EVM)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_EVM = (( %s ))\n", ( pDM_FatTable->TargetAnt_EVM ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("M_CRC_Ok = (( %d )) , M_CRC_Fail = (( %d )), Main_CRC_utility = (( %d )) \n" , pDM_FatTable->MainCRC32_Ok_Cnt, pDM_FatTable->MainCRC32_Fail_Cnt,Main_CRC_utility)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("A_CRC_Ok = (( %d )) , A_CRC_Fail = (( %d )), Aux_CRC_utility = (( %d )) \n" , pDM_FatTable->AuxCRC32_Ok_Cnt, pDM_FatTable->AuxCRC32_Fail_Cnt,Aux_CRC_utility)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** TargetAnt_CRC32 = (( %s ))\n", ( pDM_FatTable->TargetAnt_CRC32 ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("****** TargetAnt_enhance = (( %s ))******\n", ( pDM_FatTable->TargetAnt_enhance ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - - - } - } - else // RSSI< = Evm_RSSI_TH_Low - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ TH_L ] \n")); - odm_EVM_FastAnt_Reset(pDM_Odm); - } - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[escape from> TH_H || EVM_method_enable==1] \n")); - odm_EVM_FastAnt_Reset(pDM_Odm); - } - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[multi-Client] \n")); - odm_EVM_FastAnt_Reset(pDM_Odm); - } - } -} - -VOID -odm_EVM_FastAntTrainingCallback( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_EVM_FastAntTrainingCallback****** \n")); - odm_HW_AntDiv(pDM_Odm); -} -#endif - -VOID -odm_HW_AntDiv( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte i,MinMaxRSSI=0xFF, AntDivMaxRSSI=0, MaxRSSI=0, LocalMaxRSSI; - u4Byte Main_RSSI, Aux_RSSI, mian_cnt, aux_cnt; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u1Byte RxIdleAnt = pDM_FatTable->RxIdleAnt, TargetAnt = 7; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - PSTA_INFO_T pEntry; - - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; - u4Byte TH1=500000; - u4Byte TH2=10000000; - u4Byte MA_rx_Temp, degrade_TP_temp, improve_TP_temp; - u1Byte Monitor_RSSI_threshold=30; - - pDM_BdcTable->BF_pass=TRUE; - pDM_BdcTable->DIV_pass=TRUE; - pDM_BdcTable->bAll_DivSta_Idle=TRUE; - pDM_BdcTable->bAll_BFSta_Idle=TRUE; - pDM_BdcTable->num_BfTar=0 ; - pDM_BdcTable->num_DivTar=0; - pDM_BdcTable->num_Client=0; - #endif - #endif - - if(!pDM_Odm->bLinked) //bLinked==False - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); - - if(pDM_FatTable->bBecomeLinked == TRUE) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - pDM_Odm->antdiv_period=0; - - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - } - return; - } - else - { - if(pDM_FatTable->bBecomeLinked ==FALSE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); - /*odm_Tx_By_TxDesc_or_Reg(pDM_Odm , TX_BY_DESC);*/ - - //if(pDM_Odm->SupportICType == ODM_RTL8821 ) - //ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable - - //#if(DM_ODM_SUPPORT_TYPE == ODM_AP) - //else if(pDM_Odm->SupportICType == ODM_RTL8881A) - // ODM_SetBBReg(pDM_Odm, 0x800 , BIT25, 0); //CCK AntDiv function disable - //#endif - - //else if(pDM_Odm->SupportICType == ODM_RTL8723B ||pDM_Odm->SupportICType == ODM_RTL8812) - //ODM_SetBBReg(pDM_Odm, 0xA00 , BIT15, 0); //CCK AntDiv function disable - - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - - if(pDM_Odm->SupportICType==ODM_RTL8723B && pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) - { - ODM_SetBBReg(pDM_Odm, 0x930 , 0xF0, 8); // DPDT_P = ANTSEL[0] // for 8723B AntDiv function patch. BB Dino 130412 - ODM_SetBBReg(pDM_Odm, 0x930 , 0xF, 8); // DPDT_N = ANTSEL[0] - } - - //2 BDC Init - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - odm_BDC_Init(pDM_Odm); - #endif - #endif - - #ifdef ODM_EVM_ENHANCE_ANTDIV - odm_EVM_FastAnt_Reset(pDM_Odm); - #endif - } - } - - if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { - if (pDM_Odm->bOneEntryOnly == TRUE) - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - else - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); - } - - #ifdef ODM_EVM_ENHANCE_ANTDIV - if(pDM_Odm->antdiv_evm_en==1) - { - odm_EVM_Enhance_AntDiv(pDM_Odm); - if(pDM_FatTable->FAT_State !=NORMAL_STATE_MIAN) - return; - } - else - { - odm_EVM_FastAnt_Reset(pDM_Odm); - } - #endif - - //2 BDC Mode Arbitration - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - if(pDM_Odm->antdiv_evm_en == 0 ||pDM_FatTable->EVM_method_enable==0) - { - odm_BF_AntDiv_ModeArbitration(pDM_Odm); - } - #endif - #endif - - for (i=0; ipODM_StaInfo[i]; - if(IS_STA_VALID(pEntry)) - { - //2 Caculate RSSI per Antenna - if ((pDM_FatTable->MainAnt_Cnt[i] != 0) || (pDM_FatTable->AuxAnt_Cnt[i] != 0)) { - mian_cnt = pDM_FatTable->MainAnt_Cnt[i]; - aux_cnt = pDM_FatTable->AuxAnt_Cnt[i]; - Main_RSSI = (mian_cnt != 0) ? (pDM_FatTable->MainAnt_Sum[i] / mian_cnt) : 0; - Aux_RSSI = (aux_cnt != 0) ? (pDM_FatTable->AuxAnt_Sum[i] / aux_cnt) : 0; - TargetAnt = (mian_cnt == aux_cnt) ? pDM_FatTable->RxIdleAnt : ((mian_cnt >= aux_cnt) ? MAIN_ANT : AUX_ANT); /*Use counter number for OFDM*/ - - } else { /*CCK only case*/ - mian_cnt = pDM_FatTable->MainAnt_Cnt_cck[i]; - aux_cnt = pDM_FatTable->AuxAnt_Cnt_cck[i]; - Main_RSSI = (mian_cnt != 0) ? (pDM_FatTable->MainAnt_Sum_cck[i] / mian_cnt) : 0; - Aux_RSSI = (aux_cnt != 0) ? (pDM_FatTable->AuxAnt_Sum_cck[i] / aux_cnt) : 0; - TargetAnt = (Main_RSSI == Aux_RSSI) ? pDM_FatTable->RxIdleAnt : ((Main_RSSI >= Aux_RSSI) ? MAIN_ANT : AUX_ANT); /*Use RSSI for CCK only case*/ - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Main_Cnt = (( %d )) , CCK_Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n",i, pDM_FatTable->MainAnt_Cnt[i], pDM_FatTable->MainAnt_Cnt_cck[i], Main_RSSI)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : Aux_Cnt = (( %d )) , CCK_Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n" ,i, pDM_FatTable->AuxAnt_Cnt[i] ,pDM_FatTable->AuxAnt_Cnt_cck[i], Aux_RSSI)); - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - - LocalMaxRSSI = (Main_RSSI>Aux_RSSI)?Main_RSSI:Aux_RSSI; - //2 Select MaxRSSI for DIG - if((LocalMaxRSSI > AntDivMaxRSSI) && (LocalMaxRSSI < 40)) - AntDivMaxRSSI = LocalMaxRSSI; - if(LocalMaxRSSI > MaxRSSI) - MaxRSSI = LocalMaxRSSI; - - //2 Select RX Idle Antenna - if ( (LocalMaxRSSI != 0) && (LocalMaxRSSI < MinMaxRSSI) ) - { - RxIdleAnt = TargetAnt; - MinMaxRSSI = LocalMaxRSSI; - } - - #ifdef ODM_EVM_ENHANCE_ANTDIV - if(pDM_Odm->antdiv_evm_en==1) - { - if(pDM_FatTable->TargetAnt_enhance!=0xFF) - { - TargetAnt=pDM_FatTable->TargetAnt_enhance; - RxIdleAnt = pDM_FatTable->TargetAnt_enhance; - } - } - #endif - - //2 Select TX Antenna - if(pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) - { - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - if(pDM_BdcTable->w_BFee_Client[i]==0) - #endif - #endif - { - odm_UpdateTxAnt(pDM_Odm, TargetAnt, i); - } - } - - //------------------------------------------------------------ - - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - - pDM_BdcTable->num_Client++; - - if(pDM_BdcTable->BDC_Mode==BDC_MODE_2 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) - { - //2 Byte Counter - - MA_rx_Temp= (pEntry->rx_byte_cnt_LowMAW)<<3 ; // RX TP ( bit /sec) - - if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) - { - pDM_BdcTable->MA_rx_TP_DIV[i]= MA_rx_Temp ; - } - else - { - pDM_BdcTable->MA_rx_TP[i] =MA_rx_Temp ; - } - - if( (MA_rx_Temp < TH2) && (MA_rx_Temp > TH1) && (LocalMaxRSSI<=Monitor_RSSI_threshold)) - { - if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target - { - pDM_BdcTable->num_BfTar++; - - if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) - { - improve_TP_temp = (pDM_BdcTable->MA_rx_TP_DIV[i] * 9)>>3 ; //* 1.125 - pDM_BdcTable->BF_pass = (pDM_BdcTable->MA_rx_TP[i] > improve_TP_temp)?TRUE:FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP,improve_TP_temp , MA_rx_TP_DIV, BF_pass}={ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],improve_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->BF_pass )); - } - } - else// DIV_Target - { - pDM_BdcTable->num_DivTar++; - - if(pDM_BdcTable->BDC_state==BDC_DECISION_STATE && pDM_BdcTable->BDC_Try_flag==0) - { - degrade_TP_temp=(pDM_BdcTable->MA_rx_TP_DIV[i]*5)>>3;//* 0.625 - pDM_BdcTable->DIV_pass = (pDM_BdcTable->MA_rx_TP[i] >degrade_TP_temp)?TRUE:FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { MA_rx_TP, degrade_TP_temp , MA_rx_TP_DIV, DIV_pass}=\n{ %d, %d, %d , %d } \n" ,i,pDM_BdcTable->MA_rx_TP[i],degrade_TP_temp,pDM_BdcTable->MA_rx_TP_DIV[i], pDM_BdcTable->DIV_pass )); - } - } - } - - if(MA_rx_Temp > TH1) - { - if(pDM_BdcTable->w_BFer_Client[i]==1) // Bfer_Target - { - pDM_BdcTable->bAll_BFSta_Idle=FALSE; - } - else// DIV_Target - { - pDM_BdcTable->bAll_DivSta_Idle=FALSE; - } - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : { BFmeeCap , BFmerCap} = { %d , %d } \n" ,i, pDM_BdcTable->w_BFee_Client[i] , pDM_BdcTable->w_BFer_Client[i])); - - if(pDM_BdcTable->BDC_state==BDC_BFer_TRAIN_STATE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP_DIV = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP_DIV[i] )); - - } - else - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Client[ %d ] : MA_rx_TP = (( %d )) \n",i,pDM_BdcTable->MA_rx_TP[i] )); - } - - } - #endif - #endif - - } - - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - if(pDM_BdcTable->BDC_Try_flag==0) - #endif - #endif - { - pDM_FatTable->MainAnt_Sum[i] = 0; - pDM_FatTable->AuxAnt_Sum[i] = 0; - pDM_FatTable->MainAnt_Cnt[i] = 0; - pDM_FatTable->AuxAnt_Cnt[i] = 0; - pDM_FatTable->MainAnt_Cnt_cck[i]= 0; - pDM_FatTable->AuxAnt_Cnt_cck[i]= 0; - } - } - - - - //2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP ) - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** RxIdleAnt = (( %s ))\n\n", ( RxIdleAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - if(pDM_BdcTable->BDC_Mode==BDC_MODE_1 ||pDM_BdcTable->BDC_Mode==BDC_MODE_3) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** BDC_RxIdleUpdate_counter = (( %d ))\n", pDM_BdcTable->BDC_RxIdleUpdate_counter)); - - if(pDM_BdcTable->BDC_RxIdleUpdate_counter==1) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***Update RxIdle Antenna!!! \n")); - pDM_BdcTable->BDC_RxIdleUpdate_counter=30; - ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); - } - else - { - pDM_BdcTable->BDC_RxIdleUpdate_counter--; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***NOT update RxIdle Antenna because of BF ( need to fix TX-ant)\n")); - } - } - else - #endif - #endif - ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); - #else - - ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); - - #endif//#if(DM_ODM_SUPPORT_TYPE == ODM_AP) - - - - //2 BDC Main Algorithm - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - if(pDM_Odm->antdiv_evm_en ==0 ||pDM_FatTable->EVM_method_enable==0) - { - odm_BDCcoex_BFeeRxDiv_Arbitration(pDM_Odm); - } - #endif - #endif - - if(AntDivMaxRSSI == 0) - pDM_DigTable->AntDiv_RSSI_max = pDM_Odm->RSSI_Min; - else - pDM_DigTable->AntDiv_RSSI_max = AntDivMaxRSSI; - - pDM_DigTable->RSSI_max = MaxRSSI; -} - - - -#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - -VOID -odm_S0S1_SWAntDiv_Reset( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - pDM_FatTable->bBecomeLinked = FALSE; - pDM_SWAT_Table->try_flag = SWAW_STEP_INIT; - pDM_SWAT_Table->Double_chk_flag = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SWAntDiv_Reset(): pDM_FatTable->bBecomeLinked = %d\n", pDM_FatTable->bBecomeLinked)); -} - -VOID -odm_S0S1_SwAntDiv( - IN PVOID pDM_VOID, - IN u1Byte Step - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u4Byte i, MinMaxRSSI = 0xFF, LocalMaxRSSI, LocalMinRSSI; - u4Byte Main_RSSI, Aux_RSSI; - u1Byte HighTraffic_TrainTime_U = 0x32, HighTraffic_TrainTime_L = 0, Train_time_temp; - u1Byte LowTraffic_TrainTime_U = 200, LowTraffic_TrainTime_L = 0; - u1Byte RxIdleAnt = pDM_SWAT_Table->PreAntenna, TargetAnt, nextAnt = 0; - PSTA_INFO_T pEntry = NULL; - u4Byte value32; - - - if(!pDM_Odm->bLinked) //bLinked==False - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); - if(pDM_FatTable->bBecomeLinked == TRUE) - { - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - if (pDM_Odm->SupportICType == ODM_RTL8723B) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); - ODM_SetBBReg(pDM_Odm, 0x948 , (BIT9|BIT8|BIT7|BIT6), 0x0); - } - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - } - return; - } - else - { - if(pDM_FatTable->bBecomeLinked ==FALSE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); - - if(pDM_Odm->SupportICType == ODM_RTL8723B) - { - value32 = ODM_GetBBReg(pDM_Odm, 0x864, BIT5|BIT4|BIT3); - - #if (RTL8723B_SUPPORT == 1) - if (value32 == 0x0) - ODM_UpdateRxIdleAnt_8723B(pDM_Odm, MAIN_ANT, ANT1_2G, ANT2_2G); - else if (value32 == 0x1) - ODM_UpdateRxIdleAnt_8723B(pDM_Odm, AUX_ANT, ANT2_2G, ANT1_2G); - #endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("8723B: First link! Force antenna to %s\n",(value32 == 0x0?"MAIN":"AUX") )); - } - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - } - } - - if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { - if (pDM_Odm->bOneEntryOnly == TRUE) - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - else - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[%d] { try_flag=(( %d )), Step=(( %d )), Double_chk_flag = (( %d )) }\n", - __LINE__,pDM_SWAT_Table->try_flag,Step,pDM_SWAT_Table->Double_chk_flag)); - - // Handling step mismatch condition. - // Peak step is not finished at last time. Recover the variable and check again. - if( Step != pDM_SWAT_Table->try_flag ) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Step != try_flag] Need to Reset After Link\n")); - ODM_SwAntDivRestAfterLink(pDM_Odm); - } - - if (pDM_SWAT_Table->try_flag == SWAW_STEP_INIT) { - - pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; - pDM_SWAT_Table->Train_time_flag=0; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag = 0] Prepare for peek!\n\n")); - return; - - } else { - - //1 Normal State (Begin Trying) - if (pDM_SWAT_Table->try_flag == SWAW_STEP_PEEK) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("TxOkCnt=(( %llu )), RxOkCnt=(( %llu )), TrafficLoad = (%d))\n", pDM_Odm->curTxOkCnt, pDM_Odm->curRxOkCnt, pDM_Odm->TrafficLoad)); - - if (pDM_Odm->TrafficLoad == TRAFFIC_HIGH) - { - Train_time_temp = pDM_SWAT_Table->Train_time ; - - if(pDM_SWAT_Table->Train_time_flag==3) - { - HighTraffic_TrainTime_L=0xa; - - if(Train_time_temp<=16) - Train_time_temp=HighTraffic_TrainTime_L; - else - Train_time_temp-=16; - - } - else if(pDM_SWAT_Table->Train_time_flag==2) - { - Train_time_temp-=8; - HighTraffic_TrainTime_L=0xf; - } - else if(pDM_SWAT_Table->Train_time_flag==1) - { - Train_time_temp-=4; - HighTraffic_TrainTime_L=0x1e; - } - else if(pDM_SWAT_Table->Train_time_flag==0) - { - Train_time_temp+=8; - HighTraffic_TrainTime_L=0x28; - } - - - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Train_time_temp = ((%d))\n",Train_time_temp)); - - //-- - if(Train_time_temp > HighTraffic_TrainTime_U) - Train_time_temp=HighTraffic_TrainTime_U; - - else if(Train_time_temp < HighTraffic_TrainTime_L) - Train_time_temp=HighTraffic_TrainTime_L; - - pDM_SWAT_Table->Train_time = Train_time_temp; /*10ms~200ms*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Train_time_flag=((%d)), Train_time=((%d))\n", pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); - - } else if ((pDM_Odm->TrafficLoad == TRAFFIC_MID) || (pDM_Odm->TrafficLoad == TRAFFIC_LOW)) { - - Train_time_temp=pDM_SWAT_Table->Train_time ; - - if(pDM_SWAT_Table->Train_time_flag==3) - { - LowTraffic_TrainTime_L=10; - if(Train_time_temp<50) - Train_time_temp=LowTraffic_TrainTime_L; - else - Train_time_temp-=50; - } - else if(pDM_SWAT_Table->Train_time_flag==2) - { - Train_time_temp-=30; - LowTraffic_TrainTime_L=36; - } - else if(pDM_SWAT_Table->Train_time_flag==1) - { - Train_time_temp-=10; - LowTraffic_TrainTime_L=40; - } else { - - Train_time_temp += 10; - LowTraffic_TrainTime_L = 50; - } - - //-- - if(Train_time_temp >= LowTraffic_TrainTime_U) - Train_time_temp=LowTraffic_TrainTime_U; - - else if(Train_time_temp <= LowTraffic_TrainTime_L) - Train_time_temp=LowTraffic_TrainTime_L; - - pDM_SWAT_Table->Train_time = Train_time_temp; /*10ms~200ms*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Train_time_flag=((%d)) , Train_time=((%d))\n", pDM_SWAT_Table->Train_time_flag, pDM_SWAT_Table->Train_time)); - - } else { - pDM_SWAT_Table->Train_time = 0xc8; /*200ms*/ - - } - - //----------------- - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Current MinMaxRSSI is ((%d))\n", pDM_FatTable->MinMaxRSSI)); - - //---reset index--- - if (pDM_SWAT_Table->reset_idx >= RSSI_CHECK_RESET_PERIOD) { - - pDM_FatTable->MinMaxRSSI = 0; - pDM_SWAT_Table->reset_idx = 0; - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reset_idx = (( %d ))\n", pDM_SWAT_Table->reset_idx)); - - pDM_SWAT_Table->reset_idx++; - - //---double check flag--- - if ((pDM_FatTable->MinMaxRSSI > RSSI_CHECK_THRESHOLD) && (pDM_SWAT_Table->Double_chk_flag == 0)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" MinMaxRSSI is ((%d)), and > %d\n", - pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); - - pDM_SWAT_Table->Double_chk_flag =1; - pDM_SWAT_Table->try_flag = SWAW_STEP_DETERMINE; - pDM_SWAT_Table->RSSI_Trying = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Test the current Ant for (( %d )) ms again\n", pDM_SWAT_Table->Train_time)); - ODM_UpdateRxIdleAnt(pDM_Odm, pDM_FatTable->RxIdleAnt); - ODM_SetTimer(pDM_Odm, &(pDM_SWAT_Table->phydm_SwAntennaSwitchTimer), pDM_SWAT_Table->Train_time); /*ms*/ - return; - } - - nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; - - pDM_SWAT_Table->try_flag = SWAW_STEP_DETERMINE; - - if(pDM_SWAT_Table->reset_idx<=1) - pDM_SWAT_Table->RSSI_Trying = 2; - else - pDM_SWAT_Table->RSSI_Trying = 1; - - odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_PEEK); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag=1] Normal State: Begin Trying!!\n")); - - } else if ((pDM_SWAT_Table->try_flag == SWAW_STEP_DETERMINE) && (pDM_SWAT_Table->Double_chk_flag == 0)) { - - nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; - pDM_SWAT_Table->RSSI_Trying--; - } - - //1 Decision State - if ((pDM_SWAT_Table->try_flag == SWAW_STEP_DETERMINE) && (pDM_SWAT_Table->RSSI_Trying == 0)) { - - BOOLEAN bByCtrlFrame = FALSE; - u8Byte pkt_cnt_total = 0; - - for (i=0; ipODM_StaInfo[i]; - if(IS_STA_VALID(pEntry)) - { - //2 Caculate RSSI per Antenna - Main_RSSI = (pDM_FatTable->MainAnt_Cnt[i]!=0)?(pDM_FatTable->MainAnt_Sum[i]/pDM_FatTable->MainAnt_Cnt[i]):0; - Aux_RSSI = (pDM_FatTable->AuxAnt_Cnt[i]!=0)?(pDM_FatTable->AuxAnt_Sum[i]/pDM_FatTable->AuxAnt_Cnt[i]):0; - - if(pDM_FatTable->MainAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_main>=1) - Main_RSSI=0; - - if(pDM_FatTable->AuxAnt_Cnt[i]<=1 && pDM_FatTable->CCK_counter_aux>=1) - Aux_RSSI=0; - - TargetAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); - LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; - LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** CCK_counter_main = (( %d )) , CCK_counter_aux= (( %d )) \n", pDM_FatTable->CCK_counter_main, pDM_FatTable->CCK_counter_aux)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** OFDM_counter_main = (( %d )) , OFDM_counter_aux= (( %d )) \n", pDM_FatTable->OFDM_counter_main, pDM_FatTable->OFDM_counter_aux)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Main_Cnt = (( %d )) , Main_RSSI= (( %d )) \n", pDM_FatTable->MainAnt_Cnt[i], Main_RSSI)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** Aux_Cnt = (( %d )) , Aux_RSSI = (( %d )) \n", pDM_FatTable->AuxAnt_Cnt[i] , Aux_RSSI )); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** MAC ID:[ %d ] , TargetAnt = (( %s )) \n", i ,( TargetAnt ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); - - //2 Select RX Idle Antenna - - if (LocalMaxRSSI != 0 && LocalMaxRSSI < MinMaxRSSI) - { - RxIdleAnt = TargetAnt; - MinMaxRSSI = LocalMaxRSSI; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** LocalMaxRSSI-LocalMinRSSI = ((%d))\n",(LocalMaxRSSI-LocalMinRSSI))); - - if((LocalMaxRSSI-LocalMinRSSI)>8) - { - if(LocalMinRSSI != 0) - pDM_SWAT_Table->Train_time_flag=3; - else - { - if (MinMaxRSSI > RSSI_CHECK_THRESHOLD) - pDM_SWAT_Table->Train_time_flag=0; - else - pDM_SWAT_Table->Train_time_flag=3; - } - } - else if((LocalMaxRSSI-LocalMinRSSI)>5) - pDM_SWAT_Table->Train_time_flag=2; - else if((LocalMaxRSSI-LocalMinRSSI)>2) - pDM_SWAT_Table->Train_time_flag=1; - else - pDM_SWAT_Table->Train_time_flag=0; - - } - - //2 Select TX Antenna - if(TargetAnt == MAIN_ANT) - pDM_FatTable->antsel_a[i] = ANT1_2G; - else - pDM_FatTable->antsel_a[i] = ANT2_2G; - - } - pDM_FatTable->MainAnt_Sum[i] = 0; - pDM_FatTable->AuxAnt_Sum[i] = 0; - pDM_FatTable->MainAnt_Cnt[i] = 0; - pDM_FatTable->AuxAnt_Cnt[i] = 0; - } - - if(pDM_SWAT_Table->bSWAntDivByCtrlFrame) - { - odm_S0S1_SwAntDivByCtrlFrame(pDM_Odm, SWAW_STEP_DETERMINE); - bByCtrlFrame = TRUE; - } - - pkt_cnt_total = pDM_FatTable->CCK_counter_main + pDM_FatTable->CCK_counter_aux + - pDM_FatTable->OFDM_counter_main + pDM_FatTable->OFDM_counter_aux; - pDM_FatTable->CCK_counter_main=0; - pDM_FatTable->CCK_counter_aux=0; - pDM_FatTable->OFDM_counter_main=0; - pDM_FatTable->OFDM_counter_aux=0; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame packet counter = %d, Data frame packet counter = %llu\n", - pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame, pkt_cnt_total)); - - if(MinMaxRSSI == 0xff || ((pkt_cnt_total < (pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame >> 1)) && pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 2)) - { - MinMaxRSSI = 0; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Check RSSI of control frame because MinMaxRSSI == 0xff\n")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("bByCtrlFrame = %d\n", bByCtrlFrame)); - - if(bByCtrlFrame) - { - Main_RSSI = (pDM_FatTable->MainAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->MainAnt_CtrlFrame_Sum/pDM_FatTable->MainAnt_CtrlFrame_Cnt):0; - Aux_RSSI = (pDM_FatTable->AuxAnt_CtrlFrame_Cnt!=0)?(pDM_FatTable->AuxAnt_CtrlFrame_Sum/pDM_FatTable->AuxAnt_CtrlFrame_Cnt):0; - - if(pDM_FatTable->MainAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_main>=1) - Main_RSSI=0; - - if(pDM_FatTable->AuxAnt_CtrlFrame_Cnt<=1 && pDM_FatTable->CCK_CtrlFrame_Cnt_aux>=1) - Aux_RSSI=0; - - if (Main_RSSI != 0 || Aux_RSSI != 0) - { - RxIdleAnt = (Main_RSSI==Aux_RSSI)?pDM_SWAT_Table->PreAntenna:((Main_RSSI>=Aux_RSSI)?MAIN_ANT:AUX_ANT); - LocalMaxRSSI = (Main_RSSI>=Aux_RSSI) ? Main_RSSI : Aux_RSSI; - LocalMinRSSI = (Main_RSSI>=Aux_RSSI) ? Aux_RSSI : Main_RSSI; - - if((LocalMaxRSSI-LocalMinRSSI)>8) - pDM_SWAT_Table->Train_time_flag=3; - else if((LocalMaxRSSI-LocalMinRSSI)>5) - pDM_SWAT_Table->Train_time_flag=2; - else if((LocalMaxRSSI-LocalMinRSSI)>2) - pDM_SWAT_Table->Train_time_flag=1; - else - pDM_SWAT_Table->Train_time_flag=0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Control frame: Main_RSSI = %d, Aux_RSSI = %d\n", Main_RSSI, Aux_RSSI)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("RxIdleAnt decided by control frame = %s\n", (RxIdleAnt == MAIN_ANT?"MAIN":"AUX"))); - } - } - } - - pDM_FatTable->MinMaxRSSI = MinMaxRSSI; - pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; - - if( pDM_SWAT_Table->Double_chk_flag==1) - { - pDM_SWAT_Table->Double_chk_flag=0; - - if (pDM_FatTable->MinMaxRSSI > RSSI_CHECK_THRESHOLD) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [Double check] MinMaxRSSI ((%d)) > %d again!!\n", - pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); - - ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[reset try_flag = 0] Training accomplished !!!]\n\n\n")); - return; - } - else - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [Double check] MinMaxRSSI ((%d)) <= %d !!\n", - pDM_FatTable->MinMaxRSSI, RSSI_CHECK_THRESHOLD)); - - nextAnt = (pDM_FatTable->RxIdleAnt == MAIN_ANT)? AUX_ANT : MAIN_ANT; - pDM_SWAT_Table->try_flag = SWAW_STEP_PEEK; - pDM_SWAT_Table->reset_idx = RSSI_CHECK_RESET_PERIOD; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[set try_flag=0] Normal State: Need to tryg again!!\n\n\n")); - return; - } - } - else - { - if (pDM_FatTable->MinMaxRSSI < RSSI_CHECK_THRESHOLD) - pDM_SWAT_Table->reset_idx = RSSI_CHECK_RESET_PERIOD; - - pDM_SWAT_Table->PreAntenna =RxIdleAnt; - ODM_UpdateRxIdleAnt(pDM_Odm, RxIdleAnt ); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("[reset try_flag = 0] Training accomplished !!!] \n\n\n")); - return; - } - - } - - } - - //1 4.Change TRX antenna - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("RSSI_Trying = (( %d )), Ant: (( %s )) >>> (( %s )) \n", - pDM_SWAT_Table->RSSI_Trying, (pDM_FatTable->RxIdleAnt == MAIN_ANT?"MAIN":"AUX"),(nextAnt == MAIN_ANT?"MAIN":"AUX"))); - - ODM_UpdateRxIdleAnt(pDM_Odm, nextAnt); - - //1 5.Reset Statistics - - pDM_FatTable->RxIdleAnt = nextAnt; - - //1 6.Set next timer (Trying State) - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" Test ((%s)) Ant for (( %d )) ms\n", (nextAnt == MAIN_ANT?"MAIN":"AUX"), pDM_SWAT_Table->Train_time)); - ODM_SetTimer(pDM_Odm, &(pDM_SWAT_Table->phydm_SwAntennaSwitchTimer), pDM_SWAT_Table->Train_time); /*ms*/ -} - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -ODM_SW_AntDiv_Callback( - PRT_TIMER pTimer -) -{ - PADAPTER Adapter = (PADAPTER)pTimer->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - pSWAT_T pDM_SWAT_Table = &pHalData->DM_OutSrc.DM_SWAT_Table; - - #if DEV_BUS_TYPE==RT_PCI_INTERFACE - #if USE_WORKITEM - ODM_ScheduleWorkItem(&pDM_SWAT_Table->phydm_SwAntennaSwitchWorkitem); - #else - { - //DbgPrint("SW_antdiv_Callback"); - odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); - } - #endif - #else - ODM_ScheduleWorkItem(&pDM_SWAT_Table->phydm_SwAntennaSwitchWorkitem); - #endif -} -VOID -ODM_SW_AntDiv_WorkitemCallback( - IN PVOID pContext - ) -{ - PADAPTER pAdapter = (PADAPTER)pContext; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - //DbgPrint("SW_antdiv_Workitem_Callback"); - odm_S0S1_SwAntDiv(&pHalData->DM_OutSrc, SWAW_STEP_DETERMINE); -} - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - -VOID -ODM_SW_AntDiv_WorkitemCallback( - IN PVOID pContext -) -{ - PADAPTER - pAdapter = (PADAPTER)pContext; - HAL_DATA_TYPE - *pHalData = GET_HAL_DATA(pAdapter); - - /*DbgPrint("SW_antdiv_Workitem_Callback");*/ - odm_S0S1_SwAntDiv(&pHalData->odmpriv, SWAW_STEP_DETERMINE); -} - -VOID -ODM_SW_AntDiv_Callback(void *FunctionContext) -{ - PDM_ODM_T pDM_Odm= (PDM_ODM_T)FunctionContext; - PADAPTER padapter = pDM_Odm->Adapter; - if(padapter->net_closed == _TRUE) - return; - - #if 0 /* Can't do I/O in timer callback*/ - odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_DETERMINE); - #else - rtw_run_in_thread_cmd(padapter, ODM_SW_AntDiv_WorkitemCallback, padapter); - #endif -} - - -#endif - -VOID -odm_S0S1_SwAntDivByCtrlFrame( - IN PVOID pDM_VOID, - IN u1Byte Step - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - switch(Step) - { - case SWAW_STEP_PEEK: - pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame = 0; - pDM_SWAT_Table->bSWAntDivByCtrlFrame = TRUE; - pDM_FatTable->MainAnt_CtrlFrame_Cnt = 0; - pDM_FatTable->AuxAnt_CtrlFrame_Cnt = 0; - pDM_FatTable->MainAnt_CtrlFrame_Sum = 0; - pDM_FatTable->AuxAnt_CtrlFrame_Sum = 0; - pDM_FatTable->CCK_CtrlFrame_Cnt_main = 0; - pDM_FatTable->CCK_CtrlFrame_Cnt_aux = 0; - pDM_FatTable->OFDM_CtrlFrame_Cnt_main = 0; - pDM_FatTable->OFDM_CtrlFrame_Cnt_aux = 0; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Start peek and reset counter\n")); - break; - case SWAW_STEP_DETERMINE: - pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_S0S1_SwAntDivForAPMode(): Stop peek\n")); - break; - default: - pDM_SWAT_Table->bSWAntDivByCtrlFrame = FALSE; - break; - } -} - -VOID -odm_AntselStatisticsOfCtrlFrame( - IN PVOID pDM_VOID, - IN u1Byte antsel_tr_mux, - IN u4Byte RxPWDBAll - - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - if(antsel_tr_mux == ANT1_2G) - { - pDM_FatTable->MainAnt_CtrlFrame_Sum+=RxPWDBAll; - pDM_FatTable->MainAnt_CtrlFrame_Cnt++; - } - else - { - pDM_FatTable->AuxAnt_CtrlFrame_Sum+=RxPWDBAll; - pDM_FatTable->AuxAnt_CtrlFrame_Cnt++; - } -} - -VOID -odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( - IN PVOID pDM_VOID, - IN PVOID p_phy_info_void, - IN PVOID p_pkt_info_void - //IN PODM_PHY_INFO_T pPhyInfo, - //IN PODM_PACKET_INFO_T pPktinfo - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; - PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - BOOLEAN isCCKrate; - - if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) - return; - - if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV) - return; - - // In try state - if(!pDM_SWAT_Table->bSWAntDivByCtrlFrame) - return; - - // No HW error and match receiver address - if(!pPktinfo->bToSelf) - return; - - pDM_SWAT_Table->PktCnt_SWAntDivByCtrlFrame++; - isCCKrate = ((pPktinfo->DataRate >= DESC_RATE1M ) && (pPktinfo->DataRate <= DESC_RATE11M ))?TRUE :FALSE; - - if(isCCKrate) - { - pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; - - if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) - pDM_FatTable->CCK_CtrlFrame_Cnt_main++; - else - pDM_FatTable->CCK_CtrlFrame_Cnt_aux++; - - odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); - } - else - { - if(pDM_FatTable->antsel_rx_keep_0==ANT1_2G) - pDM_FatTable->OFDM_CtrlFrame_Cnt_main++; - else - pDM_FatTable->OFDM_CtrlFrame_Cnt_aux++; - - odm_AntselStatisticsOfCtrlFrame(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPhyInfo->RxPWDBAll); - } -} - -#endif //#if (RTL8723B_SUPPORT == 1)||(RTL8821A_SUPPORT == 1) - - - - -VOID -odm_SetNextMACAddrTarget( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - PSTA_INFO_T pEntry; - u4Byte value32, i; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("odm_SetNextMACAddrTarget() ==>\n")); - - if (pDM_Odm->bLinked) - { - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - - if ((pDM_FatTable->TrainIdx+1) == ODM_ASSOCIATE_ENTRY_NUM) - pDM_FatTable->TrainIdx = 0; - else - pDM_FatTable->TrainIdx++; - - pEntry = pDM_Odm->pODM_StaInfo[pDM_FatTable->TrainIdx]; - - if (IS_STA_VALID(pEntry)) { - - /*Match MAC ADDR*/ - #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - value32 = (pEntry->hwaddr[5]<<8)|pEntry->hwaddr[4]; - #else - value32 = (pEntry->MacAddr[5]<<8)|pEntry->MacAddr[4]; - #endif - - ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32);/*0x7b4~0x7b5*/ - - #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - value32 = (pEntry->hwaddr[3]<<24)|(pEntry->hwaddr[2]<<16) |(pEntry->hwaddr[1]<<8) |pEntry->hwaddr[0]; - #else - value32 = (pEntry->MacAddr[3]<<24)|(pEntry->MacAddr[2]<<16) |(pEntry->MacAddr[1]<<8) |pEntry->MacAddr[0]; - #endif - ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32);/*0x7b0~0x7b3*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pDM_FatTable->TrainIdx=%d\n", pDM_FatTable->TrainIdx)); - - #if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", - pEntry->hwaddr[5], pEntry->hwaddr[4], pEntry->hwaddr[3], pEntry->hwaddr[2], pEntry->hwaddr[1], pEntry->hwaddr[0])); - #else - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Training MAC Addr = %x:%x:%x:%x:%x:%x\n", - pEntry->MacAddr[5], pEntry->MacAddr[4], pEntry->MacAddr[3], pEntry->MacAddr[2], pEntry->MacAddr[1], pEntry->MacAddr[0])); - #endif - - break; - } - } - } - -#if 0 - // - //2012.03.26 LukeLee: This should be removed later, the MAC address is changed according to MACID in turn - // - #if( DM_ODM_SUPPORT_TYPE & ODM_WIN) - { - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - - for (i=0; i<6; i++) - { - Bssid[i] = pMgntInfo->Bssid[i]; - //DbgPrint("Bssid[%d]=%x\n", i, Bssid[i]); - } - } - #endif - - //odm_SetNextMACAddrTarget(pDM_Odm); - - //1 Select MAC Address Filter - for (i=0; i<6; i++) - { - if(Bssid[i] != pDM_FatTable->Bssid[i]) - { - bMatchBSSID = FALSE; - break; - } - } - if(bMatchBSSID == FALSE) - { - //Match MAC ADDR - value32 = (Bssid[5]<<8)|Bssid[4]; - ODM_SetMACReg(pDM_Odm, 0x7b4, 0xFFFF, value32); - value32 = (Bssid[3]<<24)|(Bssid[2]<<16) |(Bssid[1]<<8) |Bssid[0]; - ODM_SetMACReg(pDM_Odm, 0x7b0, bMaskDWord, value32); - } - - return bMatchBSSID; -#endif - -} - -#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - -VOID -odm_FastAntTraining( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - u4Byte MaxRSSI_pathA=0, Pckcnt_pathA=0; - u1Byte i,TargetAnt_pathA=0; - BOOLEAN bPktFilterMacth_pathA = FALSE; - #if(RTL8192E_SUPPORT == 1) - u4Byte MaxRSSI_pathB=0, Pckcnt_pathB=0; - u1Byte TargetAnt_pathB=0; - BOOLEAN bPktFilterMacth_pathB = FALSE; - #endif - - - if(!pDM_Odm->bLinked) //bLinked==False - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); - - if(pDM_FatTable->bBecomeLinked == TRUE) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - phydm_FastTraining_enable(pDM_Odm , FAT_OFF); - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - } - return; - } - else - { - if(pDM_FatTable->bBecomeLinked ==FALSE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked!!!]\n")); - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - } - } - - if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { - if (pDM_Odm->bOneEntryOnly == TRUE) - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - else - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); - } - - - if(pDM_Odm->SupportICType == ODM_RTL8188E) - { - ODM_SetBBReg(pDM_Odm, 0x864 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1)); - } - #if(RTL8192E_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - ODM_SetBBReg(pDM_Odm, 0xB38 , BIT2|BIT1|BIT0, ((pDM_Odm->fat_comb_a)-1) ); //path-A // ant combination=regB38[2:0]+1 - ODM_SetBBReg(pDM_Odm, 0xB38 , BIT18|BIT17|BIT16, ((pDM_Odm->fat_comb_b)-1) ); //path-B // ant combination=regB38[18:16]+1 - } - #endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("==>odm_FastAntTraining()\n")); - - //1 TRAINING STATE - if(pDM_FatTable->FAT_State == FAT_TRAINING_STATE) - { - //2 Caculate RSSI per Antenna - - //3 [path-A]--------------------------- - for (i=0; i<(pDM_Odm->fat_comb_a); i++) // i : antenna index - { - if(pDM_FatTable->antRSSIcnt[i] == 0) - pDM_FatTable->antAveRSSI[i] = 0; - else - { - pDM_FatTable->antAveRSSI[i] = pDM_FatTable->antSumRSSI[i] /pDM_FatTable->antRSSIcnt[i]; - bPktFilterMacth_pathA = TRUE; - } - - if(pDM_FatTable->antAveRSSI[i] > MaxRSSI_pathA) - { - MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; - Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; - TargetAnt_pathA = i ; - } - else if(pDM_FatTable->antAveRSSI[i] == MaxRSSI_pathA) - { - if( (pDM_FatTable->antRSSIcnt[i] ) > Pckcnt_pathA) - { - MaxRSSI_pathA = pDM_FatTable->antAveRSSI[i]; - Pckcnt_pathA = pDM_FatTable ->antRSSIcnt[i]; - TargetAnt_pathA = i ; - } - } - - ODM_RT_TRACE("*** Ant-Index : [ %d ], Counter = (( %d )), Avg RSSI = (( %d )) \n", i, pDM_FatTable->antRSSIcnt[i], pDM_FatTable->antAveRSSI[i] ); - } - - - /* - #if(RTL8192E_SUPPORT == 1) - //3 [path-B]--------------------------- - for (i=0; i<(pDM_Odm->fat_comb_b); i++) - { - if(pDM_FatTable->antRSSIcnt_pathB[i] == 0) - pDM_FatTable->antAveRSSI_pathB[i] = 0; - else // (antRSSIcnt[i] != 0) - { - pDM_FatTable->antAveRSSI_pathB[i] = pDM_FatTable->antSumRSSI_pathB[i] /pDM_FatTable->antRSSIcnt_pathB[i]; - bPktFilterMacth_pathB = TRUE; - } - if(pDM_FatTable->antAveRSSI_pathB[i] > MaxRSSI_pathB) - { - MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; - Pckcnt_pathB = pDM_FatTable ->antRSSIcnt_pathB[i]; - TargetAnt_pathB = (u1Byte) i; - } - if(pDM_FatTable->antAveRSSI_pathB[i] == MaxRSSI_pathB) - { - if(pDM_FatTable ->antRSSIcnt_pathB > Pckcnt_pathB) - { - MaxRSSI_pathB = pDM_FatTable->antAveRSSI_pathB[i]; - TargetAnt_pathB = (u1Byte) i; - } - } - if (pDM_Odm->fat_print_rssi==1) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***{Path-B}: Sum RSSI[%d] = (( %d )), cnt RSSI [%d] = (( %d )), Avg RSSI[%d] = (( %d )) \n", - i, pDM_FatTable->antSumRSSI_pathB[i], i, pDM_FatTable->antRSSIcnt_pathB[i], i, pDM_FatTable->antAveRSSI_pathB[i])); - } - } - #endif - */ - - //1 DECISION STATE - - //2 Select TRX Antenna - - phydm_FastTraining_enable(pDM_Odm, FAT_OFF); - - //3 [path-A]--------------------------- - if(bPktFilterMacth_pathA == FALSE) - { - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("{Path-A}: None Packet is matched\n")); - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - } - else - { - ODM_RT_TRACE("TargetAnt_pathA = (( %d )) , MaxRSSI_pathA = (( %d )) \n",TargetAnt_pathA,MaxRSSI_pathA); - - //3 [ update RX-optional ant ] Default RX is Omni, Optional RX is the best decision by FAT - if(pDM_Odm->SupportICType == ODM_RTL8188E) - { - ODM_SetBBReg(pDM_Odm, 0x864 , BIT8|BIT7|BIT6, TargetAnt_pathA); - } - else if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - ODM_SetBBReg(pDM_Odm, 0xB38 , BIT8|BIT7|BIT6, TargetAnt_pathA);//Optional RX [pth-A] - } - //3 [ update TX ant ] - odm_UpdateTxAnt(pDM_Odm, TargetAnt_pathA, (pDM_FatTable->TrainIdx)); - - if(TargetAnt_pathA == 0) - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - } - /* - #if(RTL8192E_SUPPORT == 1) - //3 [path-B]--------------------------- - if(bPktFilterMacth_pathB == FALSE) - { - if (pDM_Odm->fat_print_rssi==1) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("***[%d]{Path-B}: None Packet is matched\n\n\n",__LINE__)); - } - } - else - { - if (pDM_Odm->fat_print_rssi==1) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, - (" ***TargetAnt_pathB = (( %d )) *** MaxRSSI = (( %d ))***\n\n\n",TargetAnt_pathB,MaxRSSI_pathB)); - } - ODM_SetBBReg(pDM_Odm, 0xB38 , BIT21|BIT20|BIT19, TargetAnt_pathB); //Default RX is Omni, Optional RX is the best decision by FAT - ODM_SetBBReg(pDM_Odm, 0x80c , BIT21, 1); //Reg80c[21]=1'b1 //from TX Info - - pDM_FatTable->antsel_pathB[pDM_FatTable->TrainIdx] = TargetAnt_pathB; - } - #endif - */ - - //2 Reset Counter - for(i=0; i<(pDM_Odm->fat_comb_a); i++) - { - pDM_FatTable->antSumRSSI[i] = 0; - pDM_FatTable->antRSSIcnt[i] = 0; - } - /* - #if(RTL8192E_SUPPORT == 1) - for(i=0; i<=(pDM_Odm->fat_comb_b); i++) - { - pDM_FatTable->antSumRSSI_pathB[i] = 0; - pDM_FatTable->antRSSIcnt_pathB[i] = 0; - } - #endif - */ - - pDM_FatTable->FAT_State = FAT_PREPARE_STATE; - return; - } - - //1 NORMAL STATE - if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Start Prepare State ]\n")); - - odm_SetNextMACAddrTarget(pDM_Odm); - - //2 Prepare Training - pDM_FatTable->FAT_State = FAT_TRAINING_STATE; - phydm_FastTraining_enable(pDM_Odm , FAT_ON); - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); //enable HW AntDiv - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Start Training State]\n")); - - ODM_SetTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, pDM_Odm->antdiv_intvl ); //ms - } - -} - -VOID -odm_FastAntTrainingCallback( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PADAPTER padapter = pDM_Odm->Adapter; - if(padapter->net_closed == _TRUE) - return; - //if(*pDM_Odm->pbNet_closed == TRUE) - // return; -#endif - -#if USE_WORKITEM - ODM_ScheduleWorkItem(&pDM_Odm->FastAntTrainingWorkitem); -#else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingCallback****** \n")); - odm_FastAntTraining(pDM_Odm); -#endif -} - -VOID -odm_FastAntTrainingWorkItemCallback( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("******odm_FastAntTrainingWorkItemCallback****** \n")); - odm_FastAntTraining(pDM_Odm); -} - -#endif - -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - -u4Byte -phydm_construct_hl_beam_codeword( - IN PVOID pDM_VOID, - IN u4Byte *beam_pattern_idx, - IN u4Byte ant_num - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - u4Byte codeword = 0; - u4Byte data_tmp; - u4Byte i; - u4Byte break_counter = 0; - - if (ant_num < 8) { - for (i = 0; i < (pdm_sat_table->ant_num_total); i++) { - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("beam_pattern_num[%x] = %x\n",i,beam_pattern_num[i] ));*/ - if ((i < (pdm_sat_table->first_train_ant-1)) || (break_counter >= (pdm_sat_table->ant_num))) { - data_tmp = 0; - /**/ - } else { - - break_counter++; - - if (beam_pattern_idx[i] == 0) { - - if (*pDM_Odm->pBandType == ODM_BAND_5G) - data_tmp = pdm_sat_table->rfu_codeword_table_5g[0]; - else - data_tmp = pdm_sat_table->rfu_codeword_table[0]; - - } else if (beam_pattern_idx[i] == 1) { - - - if (*pDM_Odm->pBandType == ODM_BAND_5G) - data_tmp = pdm_sat_table->rfu_codeword_table_5g[1]; - else - data_tmp = pdm_sat_table->rfu_codeword_table[1]; - - } else if (beam_pattern_idx[i] == 2) { - - if (*pDM_Odm->pBandType == ODM_BAND_5G) - data_tmp = pdm_sat_table->rfu_codeword_table_5g[2]; - else - data_tmp = pdm_sat_table->rfu_codeword_table[2]; - - } else if (beam_pattern_idx[i] == 3) { - - if (*pDM_Odm->pBandType == ODM_BAND_5G) - data_tmp = pdm_sat_table->rfu_codeword_table_5g[3]; - else - data_tmp = pdm_sat_table->rfu_codeword_table[3]; - } - } - - - codeword |= (data_tmp<<(i*4)); - - } - } - - return codeword; -} - -VOID -phydm_update_beam_pattern( - IN PVOID pDM_VOID, - IN u4Byte codeword, - IN u4Byte codeword_length - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - u1Byte i; - BOOLEAN beam_ctrl_signal; - u4Byte one = 0x1; - u4Byte reg44_tmp_p, reg44_tmp_n, reg44_ori; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set Beam Pattern =0x%x\n", codeword)); - - reg44_ori = ODM_GetMACReg(pDM_Odm, 0x44, bMaskDWord); - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_ori =0x%x\n", reg44_ori));*/ - - for (i = 0; i <= (codeword_length-1); i++) { - beam_ctrl_signal = (BOOLEAN)((codeword&BIT(i)) >> i); - - if (pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) { - - if (i == (codeword_length-1)) { - DbgPrint("%d ]\n", beam_ctrl_signal); - /**/ - } else if (i == 0) { - DbgPrint("Send codeword[1:24] ---> [ %d ", beam_ctrl_signal); - /**/ - } else if ((i % 4) == 3) { - DbgPrint("%d | ", beam_ctrl_signal); - /**/ - } else { - DbgPrint("%d ", beam_ctrl_signal); - /**/ - } - } - - #if 1 - reg44_tmp_p = reg44_ori & (~(BIT11|BIT10)); /*clean bit 10 & 11*/ - reg44_tmp_p |= ((1<<11) | (beam_ctrl_signal<<10)); - reg44_tmp_n = reg44_ori & (~(BIT11|BIT10)); - - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n));*/ - ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_p); - ODM_SetMACReg(pDM_Odm, 0x44 , bMaskDWord, reg44_tmp_n); - #else - ODM_SetMACReg(pDM_Odm, 0x44 , BIT11|BIT10, ((1<<1) | beam_ctrl_signal)); - ODM_SetMACReg(pDM_Odm, 0x44 , BIT11, 0); - #endif - - } -} - -VOID -phydm_update_rx_idle_beam( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - u4Byte i; - - pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set target beam_pattern codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); - - for (i = 0; i < (pdm_sat_table->ant_num); i++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Update Rx-Idle-Beam ] RxIdleBeam[%d] =%d\n", i, pdm_sat_table->rx_idle_beam[i])); - /**/ - } - - #if DEV_BUS_TYPE == RT_PCI_INTERFACE - phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); - #else - ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); - /*ODM_StallExecution(1);*/ - #endif - - pdm_sat_table->pre_codeword = pdm_sat_table->update_beam_codeword; -} - -VOID -phydm_hl_smart_ant_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - u4Byte used = *_used; - u4Byte out_len = *_out_len; - u4Byte one = 0x1; - u4Byte codeword_length = pdm_sat_table->data_codeword_bit_num; - u4Byte beam_ctrl_signal, i; - - if (dm_value[0] == 1) { /*fix beam pattern*/ - - pdm_sat_table->fix_beam_pattern_en = dm_value[1]; - - if (pdm_sat_table->fix_beam_pattern_en == 1) { - - pdm_sat_table->fix_beam_pattern_codeword = dm_value[2]; - - if (pdm_sat_table->fix_beam_pattern_codeword > (one<fix_beam_pattern_codeword, codeword_length)); - (pdm_sat_table->fix_beam_pattern_codeword) &= 0xffffff; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Auto modify to (0x%x)\n", pdm_sat_table->fix_beam_pattern_codeword)); - } - - pdm_sat_table->update_beam_codeword = pdm_sat_table->fix_beam_pattern_codeword; - - /*---------------------------------------------------------*/ - PHYDM_SNPRINTF((output+used, out_len-used, "Fix Beam Pattern\n")); - for (i = 0; i <= (codeword_length-1); i++) { - beam_ctrl_signal = (BOOLEAN)((pdm_sat_table->update_beam_codeword&BIT(i)) >> i); - - if (i == (codeword_length-1)) { - PHYDM_SNPRINTF((output+used, out_len-used, "%d]\n", beam_ctrl_signal)); - /**/ - } else if (i == 0) { - PHYDM_SNPRINTF((output+used, out_len-used, "Send Codeword[1:24] to RFU -> [%d", beam_ctrl_signal)); - /**/ - } else if ((i % 4) == 3) { - PHYDM_SNPRINTF((output+used, out_len-used, "%d|", beam_ctrl_signal)); - /**/ - } else { - PHYDM_SNPRINTF((output+used, out_len-used, "%d", beam_ctrl_signal)); - /**/ - } - } - /*---------------------------------------------------------*/ - - - #if DEV_BUS_TYPE == RT_PCI_INTERFACE - phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); - #else - ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); - /*ODM_StallExecution(1);*/ - #endif - } else if (pdm_sat_table->fix_beam_pattern_en == 0) { - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Smart Antenna: Enable\n")); - } - - } else if (dm_value[0] == 2) { /*set latch time*/ - - pdm_sat_table->latch_time = dm_value[1]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] latch_time =0x%x\n", pdm_sat_table->latch_time)); - } else if (dm_value[0] == 3) { - - pdm_sat_table->fix_training_num_en = dm_value[1]; - - if (pdm_sat_table->fix_training_num_en == 1) { - pdm_sat_table->per_beam_training_pkt_num = (u1Byte)dm_value[2]; - pdm_sat_table->decision_holding_period = (u1Byte)dm_value[3]; - - PHYDM_SNPRINTF((output+used, out_len-used, "[SmartAnt][Dbg] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", - pdm_sat_table->fix_training_num_en, pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); - - } else if (pdm_sat_table->fix_training_num_en == 0) { - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] AUTO per_beam_training_pkt_num\n")); - /**/ - } - } else if (dm_value[0] == 4) { - - if (dm_value[1] == 1) { - pdm_sat_table->ant_num = 1; - pdm_sat_table->first_train_ant = MAIN_ANT; - - } else if (dm_value[1] == 2) { - pdm_sat_table->ant_num = 1; - pdm_sat_table->first_train_ant = AUX_ANT; - - } else if (dm_value[1] == 3) { - pdm_sat_table->ant_num = 2; - pdm_sat_table->first_train_ant = MAIN_ANT; - } - - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Ant Num = (( %d )), first_train_ant = (( %d ))\n", - pdm_sat_table->ant_num, (pdm_sat_table->first_train_ant-1))); - } else if (dm_value[0] == 5) { - - if (dm_value[1] <= 3) { - pdm_sat_table->rfu_codeword_table[dm_value[1]] = dm_value[2]; - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", - dm_value[1], dm_value[2])); - } else { - for (i = 0; i < 4; i++) { - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", - i, pdm_sat_table->rfu_codeword_table[i])); - } - } - } else if (dm_value[0] == 6) { - - if (dm_value[1] <= 3) { - pdm_sat_table->rfu_codeword_table_5g[dm_value[1]] = dm_value[2]; - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", - dm_value[1], dm_value[2])); - } else { - for (i = 0; i < 4; i++) { - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", - i, pdm_sat_table->rfu_codeword_table_5g[i])); - } - } - } else if (dm_value[0] == 7) { - - if (dm_value[1] <= 4) { - - pdm_sat_table->beam_patten_num_each_ant = dm_value[1]; - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Set Beam number = (( %d ))\n", - pdm_sat_table->beam_patten_num_each_ant)); - } else { - - PHYDM_SNPRINTF((output+used, out_len-used, "[ SmartAnt ] Show Beam number = (( %d ))\n", - pdm_sat_table->beam_patten_num_each_ant)); - } - } - -} - - -void -phydm_set_all_ant_same_beam_num( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - - if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { /*2Ant for 8821A*/ - - pdm_sat_table->rx_idle_beam[0] = pdm_sat_table->fast_training_beam_num; - pdm_sat_table->rx_idle_beam[1] = pdm_sat_table->fast_training_beam_num; - } - - pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(pDM_Odm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Set all ant beam_pattern: codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); - - #if DEV_BUS_TYPE == RT_PCI_INTERFACE - phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); - #else - ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_workitem); - /*ODM_StallExecution(1);*/ - #endif -} - -VOID -odm_FastAntTraining_hl_smart_antenna_type1( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - pFAT_T pDM_FatTable = &(pDM_Odm->DM_FatTable); - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - u4Byte codeword = 0, i, j; - u4Byte TargetAnt; - u4Byte avg_rssi_tmp, avg_rssi_tmp_ma; - u4Byte target_ant_beam_max_rssi[SUPPORT_RF_PATH_NUM] = {0}; - u4Byte max_beam_ant_rssi = 0; - u4Byte target_ant_beam[SUPPORT_RF_PATH_NUM] = {0}; - u4Byte beam_tmp; - u1Byte next_ant; - u4Byte rssi_sorting_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; - u4Byte rank_idx_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; - u4Byte rank_idx_out[SUPPORT_BEAM_PATTERN_NUM] = {0}; - u1Byte per_beam_rssi_diff_tmp = 0, training_pkt_num_offset; - u4Byte break_counter = 0; - u4Byte used_ant; - - - if (!pDM_Odm->bLinked) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[No Link!!!]\n")); - - if (pDM_FatTable->bBecomeLinked == TRUE) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Link -> no Link\n")); - pDM_FatTable->FAT_State = FAT_BEFORE_LINK_STATE; - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); - - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - } - return; - - } else { - if (pDM_FatTable->bBecomeLinked == FALSE) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Linked !!!]\n")); - - pDM_FatTable->FAT_State = FAT_PREPARE_STATE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("change to (( %d )) FAT_state\n", pDM_FatTable->FAT_State)); - - /*pdm_sat_table->fast_training_beam_num = 0;*/ - /*phydm_set_all_ant_same_beam_num(pDM_Odm);*/ - - pDM_FatTable->bBecomeLinked = pDM_Odm->bLinked; - } - } - - if (*(pDM_FatTable->pForceTxAntByDesc) == FALSE) { - if (pDM_Odm->bOneEntryOnly == TRUE) - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - else - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); - } - - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("HL Smart Ant Training: State (( %d ))\n", pDM_FatTable->FAT_State));*/ - - /* [DECISION STATE] */ - /*=======================================================================================*/ - if (pDM_FatTable->FAT_State == FAT_DECISION_STATE) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 3. In Decision State]\n")); - phydm_FastTraining_enable(pDM_Odm , FAT_OFF); - - break_counter = 0; - /*compute target beam in each antenna*/ - for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { - for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { - - if (pdm_sat_table->pkt_rssi_cnt[i][j] == 0) { - avg_rssi_tmp = pdm_sat_table->pkt_rssi_pre[i][j]; - avg_rssi_tmp = (avg_rssi_tmp >= 2) ? (avg_rssi_tmp - 2) : avg_rssi_tmp; - avg_rssi_tmp_ma = avg_rssi_tmp; - } else { - avg_rssi_tmp = (pdm_sat_table->pkt_rssi_sum[i][j]) / (pdm_sat_table->pkt_rssi_cnt[i][j]); - avg_rssi_tmp_ma = (avg_rssi_tmp + pdm_sat_table->pkt_rssi_pre[i][j])>>1; - } - - rssi_sorting_seq[j] = avg_rssi_tmp; - pdm_sat_table->pkt_rssi_pre[i][j] = avg_rssi_tmp; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d], Beam[%d]: pkt_cnt=(( %d )), avg_rssi_MA=(( %d )), avg_rssi=(( %d ))\n", - i, j, pdm_sat_table->pkt_rssi_cnt[i][j], avg_rssi_tmp_ma, avg_rssi_tmp)); - - if (avg_rssi_tmp > target_ant_beam_max_rssi[i]) { - target_ant_beam[i] = j; - target_ant_beam_max_rssi[i] = avg_rssi_tmp; - } - - /*reset counter value*/ - pdm_sat_table->pkt_rssi_sum[i][j] = 0; - pdm_sat_table->pkt_rssi_cnt[i][j] = 0; - - } - pdm_sat_table->rx_idle_beam[i] = target_ant_beam[i]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("---------> Target of Ant[%d]: Beam_num-(( %d )) RSSI= ((%d))\n", - i, target_ant_beam[i], target_ant_beam_max_rssi[i])); - - /*sorting*/ - /* - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Pre]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); - */ - - /*phydm_seq_sorting(pDM_Odm, &rssi_sorting_seq[0], &rank_idx_seq[0], &rank_idx_out[0], SUPPORT_BEAM_PATTERN_NUM);*/ - - /* - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rank_idx_seq = [%d, %d, %d, %d]\n", rank_idx_seq[0], rank_idx_seq[1], rank_idx_seq[2], rank_idx_seq[3])); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Post]rank_idx_out = [%d, %d, %d, %d]\n", rank_idx_out[0], rank_idx_out[1], rank_idx_out[2], rank_idx_out[3])); - */ - - if (target_ant_beam_max_rssi[i] > max_beam_ant_rssi) { - TargetAnt = i; - max_beam_ant_rssi = target_ant_beam_max_rssi[i]; - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Target of Ant = (( %d )) max_beam_ant_rssi = (( %d ))\n", - TargetAnt, max_beam_ant_rssi));*/ - } - break_counter++; - if (break_counter >= (pdm_sat_table->ant_num)) - break; - } - - #ifdef CONFIG_FAT_PATCH - break_counter = 0; - for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { - for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { - - per_beam_rssi_diff_tmp = (u1Byte)(max_beam_ant_rssi - pdm_sat_table->pkt_rssi_pre[i][j]); - pdm_sat_table->beam_train_rssi_diff[i][j] = per_beam_rssi_diff_tmp; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d], Beam[%d]: RSSI_diff= ((%d))\n", - i, j, per_beam_rssi_diff_tmp)); - } - break_counter++; - if (break_counter >= (pdm_sat_table->ant_num)) - break; - } - #endif - - if (TargetAnt == 0) - TargetAnt = MAIN_ANT; - else if (TargetAnt == 1) - TargetAnt = AUX_ANT; - - if (pdm_sat_table->ant_num > 1) { - /* [ update RX ant ]*/ - ODM_UpdateRxIdleAnt(pDM_Odm, (u1Byte)TargetAnt); - - /* [ update TX ant ]*/ - odm_UpdateTxAnt(pDM_Odm, (u1Byte)TargetAnt, (pDM_FatTable->TrainIdx)); - } - - /*set beam in each antenna*/ - phydm_update_rx_idle_beam(pDM_Odm); - - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); - pDM_FatTable->FAT_State = FAT_PREPARE_STATE; - - } - /* [TRAINING STATE] */ - else if (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2. In Training State]\n")); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("fat_beam_n = (( %d )), pre_fat_beam_n = (( %d ))\n", - pdm_sat_table->fast_training_beam_num, pdm_sat_table->pre_fast_training_beam_num)); - - if (pdm_sat_table->fast_training_beam_num > pdm_sat_table->pre_fast_training_beam_num) { - - pdm_sat_table->force_update_beam_en = 0; - - } else { - - pdm_sat_table->force_update_beam_en = 1; - - pdm_sat_table->pkt_counter = 0; - beam_tmp = pdm_sat_table->fast_training_beam_num; - if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", pdm_sat_table->fast_training_beam_num)); - pDM_FatTable->FAT_State = FAT_DECISION_STATE; - odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); - - } else { - pdm_sat_table->fast_training_beam_num++; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); - phydm_set_all_ant_same_beam_num(pDM_Odm); - pDM_FatTable->FAT_State = FAT_TRAINING_STATE; - - } - } - pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Pre_Beam =(( %d ))\n", pdm_sat_table->pre_fast_training_beam_num)); - } - /* [Prepare State] */ - /*=======================================================================================*/ - else if (pDM_FatTable->FAT_State == FAT_PREPARE_STATE) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("\n\n[ 1. In Prepare State]\n")); - - if (pDM_Odm->pre_TrafficLoad == (pDM_Odm->TrafficLoad)) { - if (pdm_sat_table->decision_holding_period != 0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Holding_period = (( %d )), return!!!\n", pdm_sat_table->decision_holding_period)); - pdm_sat_table->decision_holding_period--; - return; - } - } - - - /* Set training packet number*/ - if (pdm_sat_table->fix_training_num_en == 0) { - - switch (pDM_Odm->TrafficLoad) { - - case TRAFFIC_HIGH: - pdm_sat_table->per_beam_training_pkt_num = 8; - pdm_sat_table->decision_holding_period = 2; - break; - case TRAFFIC_MID: - pdm_sat_table->per_beam_training_pkt_num = 6; - pdm_sat_table->decision_holding_period = 3; - break; - case TRAFFIC_LOW: - pdm_sat_table->per_beam_training_pkt_num = 3; /*ping 60000*/ - pdm_sat_table->decision_holding_period = 4; - break; - case TRAFFIC_ULTRA_LOW: - pdm_sat_table->per_beam_training_pkt_num = 1; - pdm_sat_table->decision_holding_period = 6; - break; - default: - break; - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix_training_en = (( %d )), training_pkt_num_base = (( %d )), holding_period = ((%d))\n", - pdm_sat_table->fix_training_num_en , pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); - - - #ifdef CONFIG_FAT_PATCH - break_counter = 0; - for (i = (pdm_sat_table->first_train_ant-1); i < pdm_sat_table->ant_num_total; i++) { - for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { - - per_beam_rssi_diff_tmp = pdm_sat_table->beam_train_rssi_diff[i][j]; - training_pkt_num_offset = per_beam_rssi_diff_tmp; - - if ((pdm_sat_table->per_beam_training_pkt_num) > training_pkt_num_offset) - pdm_sat_table->beam_train_cnt[i][j] = pdm_sat_table->per_beam_training_pkt_num - training_pkt_num_offset; - else - pdm_sat_table->beam_train_cnt[i][j] = 1; - - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Ant[%d]: Beam_num-(( %d )) training_pkt_num = ((%d))\n", - i, j, pdm_sat_table->beam_train_cnt[i][j])); - } - break_counter++; - if (break_counter >= (pdm_sat_table->ant_num)) - break; - } - - - phydm_FastTraining_enable(pDM_Odm , FAT_OFF); - pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; - pdm_sat_table->update_beam_idx = 0; - - if (*pDM_Odm->pBandType == ODM_BAND_5G) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set 5G ant\n")); - /*used_ant = (pdm_sat_table->first_train_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT;*/ - used_ant = pdm_sat_table->first_train_ant; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set 2.4G ant\n")); - used_ant = pdm_sat_table->first_train_ant; - } - - ODM_UpdateRxIdleAnt(pDM_Odm, (u1Byte)used_ant); - - #else - /* Set training MAC Addr. of target */ - odm_SetNextMACAddrTarget(pDM_Odm); - phydm_FastTraining_enable(pDM_Odm , FAT_ON); - #endif - - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - pdm_sat_table->pkt_counter = 0; - pdm_sat_table->fast_training_beam_num = 0; - phydm_set_all_ant_same_beam_num(pDM_Odm); - pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; - pDM_FatTable->FAT_State = FAT_TRAINING_STATE; - } - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -VOID -phydm_beam_switch_workitem_callback( - IN PVOID pContext - ) -{ - PADAPTER pAdapter = (PADAPTER)pContext; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - - #if DEV_BUS_TYPE != RT_PCI_INTERFACE - pdm_sat_table->pkt_skip_statistic_en = 1; - #endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en)); - - phydm_update_beam_pattern(pDM_Odm, pdm_sat_table->update_beam_codeword, pdm_sat_table->data_codeword_bit_num); - - #if DEV_BUS_TYPE != RT_PCI_INTERFACE - /*ODM_StallExecution(pdm_sat_table->latch_time);*/ - pdm_sat_table->pkt_skip_statistic_en = 0; - #endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en, pdm_sat_table->latch_time)); -} - -VOID -phydm_beam_decision_workitem_callback( - IN PVOID pContext - ) -{ - PADAPTER pAdapter = (PADAPTER)pContext; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] Beam decision Workitem Callback\n")); - odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); -} -#endif - -#endif /*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ - -VOID -ODM_AntDivInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - pSWAT_T pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - - - if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); - return; - } - //--- -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n")); - if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) - return; - } - else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n")); - if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) - return; - } - else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n")); - } - -#endif - //--- - - //2 [--General---] - pDM_Odm->antdiv_period=0; - - pDM_FatTable->bBecomeLinked =FALSE; - pDM_FatTable->AntDiv_OnOff =0xff; - - //3 - AP - - #if (DM_ODM_SUPPORT_TYPE == ODM_AP) - - #if (BEAMFORMING_SUPPORT == 1) - #if(DM_ODM_SUPPORT_TYPE == ODM_AP) - odm_BDC_Init(pDM_Odm); - #endif - #endif - - //3 - WIN - - #elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pDM_SWAT_Table->Ant5G = MAIN_ANT; - pDM_SWAT_Table->Ant2G = MAIN_ANT; - pDM_FatTable->CCK_counter_main=0; - pDM_FatTable->CCK_counter_aux=0; - pDM_FatTable->OFDM_counter_main=0; - pDM_FatTable->OFDM_counter_aux=0; - #endif - - //2 [---Set MAIN_ANT as default antenna if Auto-Ant enable---] - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - - pDM_Odm->AntType = ODM_AUTO_ANT; - - pDM_FatTable->RxIdleAnt = 0xff; /*to make RX-idle-antenna will be updated absolutly*/ - ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); - phydm_keep_RxAckAnt_By_TxAnt_time( pDM_Odm, 5); /* Timming issue: keep Rx ant after tx for ACK ( 5 x 3.2 mu = 16mu sec)*/ - - //2 [---Set TX Antenna---] - pDM_FatTable->ForceTxAntByDesc = 0; - pDM_FatTable->pForceTxAntByDesc = &(pDM_FatTable->ForceTxAntByDesc); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("pForceTxAntByDesc = %d\n", *pDM_FatTable->pForceTxAntByDesc)); - - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - - - //2 [--88E---] - if(pDM_Odm->SupportICType == ODM_RTL8188E) - { - #if (RTL8188E_SUPPORT == 1) - //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; - //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; - - if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 88E Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - - if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) - odm_RX_HWAntDiv_Init_88E(pDM_Odm); - else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) - odm_TRX_HWAntDiv_Init_88E(pDM_Odm); - #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) - odm_Smart_HWAntDiv_Init_88E(pDM_Odm); - #endif - #endif - } - - //2 [--92E---] - #if (RTL8192E_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; - //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - //pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; - - if( (pDM_Odm->AntDivType != CGCS_RX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) && (pDM_Odm->AntDivType != CG_TRX_SMART_ANTDIV)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8192E Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - - if(pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) - odm_RX_HWAntDiv_Init_92E(pDM_Odm); - else if(pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) - odm_TRX_HWAntDiv_Init_92E(pDM_Odm); - #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - else if(pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) - odm_Smart_HWAntDiv_Init_92E(pDM_Odm); - #endif - - } - #endif - - //2 [--8723B---] - #if (RTL8723B_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8723B) - { - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - - if(pDM_Odm->AntDivType != S0S1_SW_ANTDIV && pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8723B Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - - if( pDM_Odm->AntDivType==S0S1_SW_ANTDIV) - odm_S0S1_SWAntDiv_Init_8723B(pDM_Odm); - else if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) - odm_TRX_HWAntDiv_Init_8723B(pDM_Odm); - } - #endif - /*2 [--8723D---]*/ - #if (RTL8723D_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8723D) { - if (pDM_FatTable->pDefaultS0S1 == NULL) { - pDM_FatTable->DefaultS0S1 = 1; - pDM_FatTable->pDefaultS0S1 = &(pDM_FatTable->DefaultS0S1); - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("DefaultS0S1 = %d\n", *pDM_FatTable->pDefaultS0S1)); - - if (*(pDM_FatTable->pDefaultS0S1) == TRUE) - ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); - else - ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); - - if (pDM_Odm->AntDivType == S0S1_TRX_HW_ANTDIV) - odm_TRX_HWAntDiv_Init_8723D(pDM_Odm); - else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8723D Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - - } - #endif - //2 [--8811A 8821A---] - #if (RTL8821A_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8821) - { - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - pDM_Odm->AntDivType = HL_SW_SMART_ANT_TYPE1; - - if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { - - odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); - phydm_hl_smart_ant_type1_init_8821a(pDM_Odm); - } else - #endif - { - /*pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV;*/ - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - - if (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV && pDM_Odm->AntDivType != S0S1_SW_ANTDIV) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821A & 8811A Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) - odm_TRX_HWAntDiv_Init_8821A(pDM_Odm); - else if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) - odm_S0S1_SWAntDiv_Init_8821A(pDM_Odm); - } - } - #endif - - //2 [--8821C---] - #if (RTL8821C_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8821C) - { - pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - if (pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV ) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[Return!!!] 8821C Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - odm_TRX_HWAntDiv_Init_8821C(pDM_Odm); - } - #endif - - //2 [--8881A---] - #if (RTL8881A_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8881A) - { - //pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; - //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - - if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) { - - odm_TRX_HWAntDiv_Init_8881A(pDM_Odm); - /**/ - } else { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8881A Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - - odm_TRX_HWAntDiv_Init_8881A(pDM_Odm); - } - #endif - - //2 [--8812---] - #if (RTL8812A_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8812) - { - //pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - - if( pDM_Odm->AntDivType != CG_TRX_HW_ANTDIV) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] 8812A Not Supprrt This AntDiv Type\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - return; - } - odm_TRX_HWAntDiv_Init_8812A(pDM_Odm); - } - #endif - - /*[--8188F---]*/ - #if (RTL8188F_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8188F) { - - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - odm_S0S1_SWAntDiv_Init_8188F(pDM_Odm); - } - #endif - /* - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** SupportICType=[%lu]\n",pDM_Odm->SupportICType)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv SupportAbility=[%lu]\n",(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)>>6)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("*** AntDiv Type=[%d]\n",pDM_Odm->AntDivType)); - */ -} - -VOID -ODM_AntDiv( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER pAdapter = pDM_Odm->Adapter; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - #endif - - if(*pDM_Odm->pBandType == ODM_BAND_5G ) - { - if(pDM_FatTable->idx_AntDiv_counter_5G < pDM_Odm->antdiv_period ) - { - pDM_FatTable->idx_AntDiv_counter_5G++; - return; - } - else - pDM_FatTable->idx_AntDiv_counter_5G=0; - } - else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) - { - if(pDM_FatTable->idx_AntDiv_counter_2G < pDM_Odm->antdiv_period ) - { - pDM_FatTable->idx_AntDiv_counter_2G++; - return; - } - else - pDM_FatTable->idx_AntDiv_counter_2G=0; - } - - //---------- - if(!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[Return!!!] Not Support Antenna Diversity Function\n")); - return; - } - - //---------- -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - if (pDM_FatTable->enable_ctrl_frame_antdiv) { - - if ((pDM_Odm->data_frame_num <= 10) && (pDM_Odm->bLinked)) - pDM_FatTable->use_ctrl_frame_antdiv = 1; - else - pDM_FatTable->use_ctrl_frame_antdiv = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", pDM_FatTable->use_ctrl_frame_antdiv, pDM_Odm->data_frame_num)); - pDM_Odm->data_frame_num = 0; - } - - if(pAdapter->MgntInfo.AntennaTest) - return; - - { - #if (BEAMFORMING_SUPPORT == 1) - BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); - - if( BeamformCap & BEAMFORMEE_CAP ) // BFmee On && Div On -> Div Off - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ AntDiv : OFF ] BFmee ==1 \n")); - if(pDM_FatTable->fix_ant_bfee == 0) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - pDM_FatTable->fix_ant_bfee = 1; - } - return; - } - else // BFmee Off && Div Off -> Div On - { - if((pDM_FatTable->fix_ant_bfee == 1) && pDM_Odm->bLinked) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ AntDiv : ON ] BFmee ==0\n")); - if((pDM_Odm->AntDivType!=S0S1_SW_ANTDIV) ) - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); - - pDM_FatTable->fix_ant_bfee = 0; - } - } - #endif - } -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - //----------just for fool proof - - if(pDM_Odm->antdiv_rssi) - pDM_Odm->DebugComponents |= ODM_COMP_ANT_DIV; - else - pDM_Odm->DebugComponents &= ~ODM_COMP_ANT_DIV; - - if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_2G) - { - //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G AntDiv Running ]\n")); - if(!(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC)) - return; - } - else if(pDM_FatTable->AntDiv_2G_5G == ODM_ANTDIV_5G) - { - //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 5G AntDiv Running ]\n")); - if(!(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC)) - return; - } - //else if(pDM_FatTable->AntDiv_2G_5G == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) - //{ - //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("[ 2G & 5G AntDiv Running ]\n")); - //} -#endif - - //---------- - - if (pDM_Odm->antdiv_select==1) - pDM_Odm->AntType = ODM_FIX_MAIN_ANT; - else if (pDM_Odm->antdiv_select==2) - pDM_Odm->AntType = ODM_FIX_AUX_ANT; - else //if (pDM_Odm->antdiv_select==0) - pDM_Odm->AntType = ODM_AUTO_ANT; - - //ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV,ODM_DBG_LOUD,("AntType= (( %d )) , pre_AntType= (( %d )) \n",pDM_Odm->AntType,pDM_Odm->pre_AntType)); - - if(pDM_Odm->AntType != ODM_AUTO_ANT) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Fix Antenna at (( %s ))\n",(pDM_Odm->AntType == ODM_FIX_MAIN_ANT)?"MAIN":"AUX")); - - if(pDM_Odm->AntType != pDM_Odm->pre_AntType) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_REG); - - if(pDM_Odm->AntType == ODM_FIX_MAIN_ANT) - ODM_UpdateRxIdleAnt(pDM_Odm, MAIN_ANT); - else if(pDM_Odm->AntType == ODM_FIX_AUX_ANT) - ODM_UpdateRxIdleAnt(pDM_Odm, AUX_ANT); - } - pDM_Odm->pre_AntType=pDM_Odm->AntType; - return; - } - else - { - if(pDM_Odm->AntType != pDM_Odm->pre_AntType) - { - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); - odm_Tx_By_TxDesc_or_Reg(pDM_Odm, TX_BY_DESC); - } - pDM_Odm->pre_AntType=pDM_Odm->AntType; - } - - - //3 ----------------------------------------------------------------------------------------------------------- - //2 [--88E---] - if(pDM_Odm->SupportICType == ODM_RTL8188E) - { - #if (RTL8188E_SUPPORT == 1) - if(pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV ||pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV) - odm_HW_AntDiv(pDM_Odm); - - #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) - odm_FastAntTraining(pDM_Odm); - #endif - - #endif - - } - //2 [--92E---] - #if (RTL8192E_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - if(pDM_Odm->AntDivType==CGCS_RX_HW_ANTDIV || pDM_Odm->AntDivType==CG_TRX_HW_ANTDIV) - odm_HW_AntDiv(pDM_Odm); - - #if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - else if (pDM_Odm->AntDivType==CG_TRX_SMART_ANTDIV) - odm_FastAntTraining(pDM_Odm); - #endif - - } - #endif - - #if (RTL8723B_SUPPORT == 1) - //2 [--8723B---] - else if(pDM_Odm->SupportICType == ODM_RTL8723B) - { - if (phydm_IsBtEnable_8723b(pDM_Odm)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[BT is enable!!!]\n")); - if (pDM_FatTable->bBecomeLinked == TRUE) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Set REG 948[9:6]=0x0\n")); - if (pDM_Odm->SupportICType == ODM_RTL8723B) - ODM_SetBBReg(pDM_Odm, 0x948 , BIT9|BIT8|BIT7|BIT6, 0x0); - - pDM_FatTable->bBecomeLinked = FALSE; - } - } else { - if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { - - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); - #endif - } else if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) - odm_HW_AntDiv(pDM_Odm); - } - } - #endif - /*8723D*/ - #if (RTL8723D_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8723D) { - - odm_HW_AntDiv(pDM_Odm); - /**/ - } - #endif - - //2 [--8821A---] - #if (RTL8821A_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8821) - { - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) { - - if (pdm_sat_table->fix_beam_pattern_en != 0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); - /*return;*/ - } else { - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ SmartAnt ] AntDivType = HL_SW_SMART_ANT_TYPE1\n"));*/ - odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); - } - - } else - #endif - { - - if (!pDM_Odm->bBtEnabled) /*BT disabled*/ - { - if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { - pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n")); - /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 1); */ - if (pDM_FatTable->bBecomeLinked == TRUE) - odm_AntDiv_on_off(pDM_Odm, ANTDIV_ON); - } - - } else { /*BT enabled*/ - - if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) { - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, (" [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n")); - /*ODM_SetBBReg(pDM_Odm, 0x8D4 , BIT24, 0);*/ - odm_AntDiv_on_off(pDM_Odm, ANTDIV_OFF); - } - } - - if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { - - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); - #endif - } else if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV) - odm_HW_AntDiv(pDM_Odm); - } - } - #endif - - //2 [--8821C---] - #if (RTL8821C_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8821C) - { - odm_HW_AntDiv(pDM_Odm); - } - #endif - - //2 [--8881A---] - #if (RTL8881A_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8881A) - odm_HW_AntDiv(pDM_Odm); - #endif - - //2 [--8812A---] - #if (RTL8812A_SUPPORT == 1) - else if(pDM_Odm->SupportICType == ODM_RTL8812) - odm_HW_AntDiv(pDM_Odm); - #endif - - #if (RTL8188F_SUPPORT == 1) - /* [--8188F---]*/ - else if (pDM_Odm->SupportICType == ODM_RTL8188F) { - - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_S0S1_SwAntDiv(pDM_Odm, SWAW_STEP_PEEK); - #endif - } - #endif - -} - - -VOID -odm_AntselStatistics( - IN PVOID pDM_VOID, - IN u1Byte antsel_tr_mux, - IN u4Byte MacId, - IN u4Byte utility, - IN u1Byte method, - IN u1Byte isCCKrate - - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - if (method == RSSI_METHOD) { - - if (isCCKrate) { - if (antsel_tr_mux == ANT1_2G) { - if (pDM_FatTable->MainAnt_Sum_cck[MacId] > 65435) /*to prevent u2Byte overflow, max(RSSI)=100, 65435+100 = 65535 (u2Byte)*/ - return; - - pDM_FatTable->MainAnt_Sum_cck[MacId] += (u2Byte)utility; - pDM_FatTable->MainAnt_Cnt_cck[MacId]++; - } else { - if (pDM_FatTable->AuxAnt_Sum_cck[MacId] > 65435) - return; - - pDM_FatTable->AuxAnt_Sum_cck[MacId] += (u2Byte)utility; - pDM_FatTable->AuxAnt_Cnt_cck[MacId]++; - } - - } else { /*ofdm rate*/ - - if (antsel_tr_mux == ANT1_2G) { - if (pDM_FatTable->MainAnt_Sum[MacId] > 65435) - return; - - pDM_FatTable->MainAnt_Sum[MacId] += (u2Byte)utility; - pDM_FatTable->MainAnt_Cnt[MacId]++; - } else { - if (pDM_FatTable->AuxAnt_Sum[MacId] > 65435) - return; - - pDM_FatTable->AuxAnt_Sum[MacId] += (u2Byte)utility; - pDM_FatTable->AuxAnt_Cnt[MacId]++; - } - } - } - #ifdef ODM_EVM_ENHANCE_ANTDIV - else if(method==EVM_METHOD) - { - if(antsel_tr_mux == ANT1_2G) - { - pDM_FatTable->MainAntEVM_Sum[MacId]+=(utility<<5); - pDM_FatTable->MainAntEVM_Cnt[MacId]++; - } - else - { - pDM_FatTable->AuxAntEVM_Sum[MacId]+=(utility<<5); - pDM_FatTable->AuxAntEVM_Cnt[MacId]++; - } - } - else if(method==CRC32_METHOD) - { - if(utility==0) - pDM_FatTable->CRC32_Fail_Cnt++; - else - pDM_FatTable->CRC32_Ok_Cnt+=utility; - } - #endif -} - - -VOID -ODM_Process_RSSIForAntDiv( - IN OUT PVOID pDM_VOID, - IN PVOID p_phy_info_void, - IN PVOID p_pkt_info_void - //IN PODM_PHY_INFO_T pPhyInfo, - //IN PODM_PACKET_INFO_T pPktinfo - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; - PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; - u1Byte isCCKrate=0,CCKMaxRate=ODM_RATE11M; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - pSAT_T pdm_sat_table = &(pDM_Odm->dm_sat_table); - u4Byte beam_tmp; - u1Byte next_ant; - u1Byte train_pkt_number; - #endif - - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - u4Byte RxPower_Ant0, RxPower_Ant1; - u4Byte RxEVM_Ant0, RxEVM_Ant1; - #else - u1Byte RxPower_Ant0, RxPower_Ant1; - u1Byte RxEVM_Ant0, RxEVM_Ant1; - #endif - - CCKMaxRate=ODM_RATE11M; - isCCKrate = (pPktinfo->DataRate <= CCKMaxRate)?TRUE:FALSE; - - if ((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8812)) && (pPktinfo->DataRate > CCKMaxRate)) - { - RxPower_Ant0 = pPhyInfo->RxMIMOSignalStrength[0]; - RxPower_Ant1= pPhyInfo->RxMIMOSignalStrength[1]; - - RxEVM_Ant0 =pPhyInfo->RxMIMOSignalQuality[0]; - RxEVM_Ant1 =pPhyInfo->RxMIMOSignalQuality[1]; - } - else - RxPower_Ant0=pPhyInfo->RxPWDBAll; - - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - #ifdef CONFIG_FAT_PATCH - if ((pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) && (pDM_FatTable->FAT_State == FAT_TRAINING_STATE)) { - - /*[Beacon]*/ - if (pPktinfo->bPacketBeacon) { - - pdm_sat_table->beacon_counter++; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("MatchBSSID_beacon_counter = ((%d))\n", pdm_sat_table->beacon_counter)); - - if (pdm_sat_table->beacon_counter >= pdm_sat_table->pre_beacon_counter + 2) { - - if (pdm_sat_table->ant_num > 1) { - next_ant = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? AUX_ANT : MAIN_ANT; - ODM_UpdateRxIdleAnt(pDM_Odm, next_ant); - } - - pdm_sat_table->update_beam_idx++; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", - pdm_sat_table->pre_beacon_counter, pdm_sat_table->pkt_counter, pdm_sat_table->update_beam_idx)); - - pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; - pdm_sat_table->pkt_counter = 0; - } - } - /*[Data]*/ - else if (pPktinfo->bPacketToSelf) { - - if (pdm_sat_table->pkt_skip_statistic_en == 0) { - /* - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", - pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pDM_FatTable->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); - */ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("ID[%d][pkt_cnt = %d]: {ANT, Beam} = {%d, %d}, RSSI = ((%d))\n", - pPktinfo->StationID, pdm_sat_table->pkt_counter, pDM_FatTable->antsel_rx_keep_0, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); - - pdm_sat_table->pkt_rssi_sum[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += RxPower_Ant0; - pdm_sat_table->pkt_rssi_cnt[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; - pdm_sat_table->pkt_counter++; - - #if 1 - train_pkt_number = pdm_sat_table->beam_train_cnt[pDM_FatTable->RxIdleAnt-1][pdm_sat_table->fast_training_beam_num]; - #else - train_pkt_number = pdm_sat_table->per_beam_training_pkt_num; - #endif - - /*Swich Antenna erery N pkts*/ - if (pdm_sat_table->pkt_counter == train_pkt_number) { - - if (pdm_sat_table->ant_num > 1) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("packet enugh ((%d ))pkts ---> Switch antenna\n", train_pkt_number)); - next_ant = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? AUX_ANT : MAIN_ANT; - ODM_UpdateRxIdleAnt(pDM_Odm, next_ant); - } - - pdm_sat_table->update_beam_idx++; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("pre_beacon_counter = ((%d)), update_beam_idx_counter = ((%d))\n", - pdm_sat_table->pre_beacon_counter, pdm_sat_table->update_beam_idx)); - - pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; - pdm_sat_table->pkt_counter = 0; - } - } - } - - /*Swich Beam after switch "pdm_sat_table->ant_num" antennas*/ - if (pdm_sat_table->update_beam_idx == pdm_sat_table->ant_num) { - - pdm_sat_table->update_beam_idx = 0; - pdm_sat_table->pkt_counter = 0; - beam_tmp = pdm_sat_table->fast_training_beam_num; - - if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { - - pDM_FatTable->FAT_State = FAT_DECISION_STATE; - - #if DEV_BUS_TYPE == RT_PCI_INTERFACE - odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); - #else - ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_decision_workitem); - #endif - - - } else { - pdm_sat_table->fast_training_beam_num++; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); - phydm_set_all_ant_same_beam_num(pDM_Odm); - - pDM_FatTable->FAT_State = FAT_TRAINING_STATE; - } - } - - } - #else - - if (pDM_Odm->AntDivType == HL_SW_SMART_ANT_TYPE1) - { - if ((pDM_Odm->SupportICType & ODM_HL_SMART_ANT_TYPE1_SUPPORT) && - (pPktinfo->bPacketToSelf) && - (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) - ) { - - if (pdm_sat_table->pkt_skip_statistic_en == 0) { - /* - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", - pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pDM_FatTable->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); - */ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antsel_pathA = ((%d)), bPacketToSelf = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", - pPktinfo->StationID, pDM_FatTable->antsel_rx_keep_0, pPktinfo->bPacketToSelf, pdm_sat_table->fast_training_beam_num, RxPower_Ant0)); - - - pdm_sat_table->pkt_rssi_sum[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += RxPower_Ant0; - pdm_sat_table->pkt_rssi_cnt[pDM_FatTable->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; - pdm_sat_table->pkt_counter++; - - /*swich beam every N pkt*/ - if ((pdm_sat_table->pkt_counter) >= (pdm_sat_table->per_beam_training_pkt_num)) { - - pdm_sat_table->pkt_counter = 0; - beam_tmp = pdm_sat_table->fast_training_beam_num; - - if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant-1)) { - - pDM_FatTable->FAT_State = FAT_DECISION_STATE; - - #if DEV_BUS_TYPE == RT_PCI_INTERFACE - odm_FastAntTraining_hl_smart_antenna_type1(pDM_Odm); - #else - ODM_ScheduleWorkItem(&pdm_sat_table->hl_smart_antenna_decision_workitem); - #endif - - - } else { - pdm_sat_table->fast_training_beam_num++; - phydm_set_all_ant_same_beam_num(pDM_Odm); - - pDM_FatTable->FAT_State = FAT_TRAINING_STATE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); - } - } - } - } - } - #endif - else - #endif - if (pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { - if( (pDM_Odm->SupportICType & ODM_SMART_ANT_SUPPORT) && (pPktinfo->bPacketToSelf) && (pDM_FatTable->FAT_State == FAT_TRAINING_STATE) )//(pPktinfo->bPacketMatchBSSID && (!pPktinfo->bPacketBeacon)) - { - u1Byte antsel_tr_mux; - antsel_tr_mux = (pDM_FatTable->antsel_rx_keep_2<<2) |(pDM_FatTable->antsel_rx_keep_1 <<1) |pDM_FatTable->antsel_rx_keep_0; - pDM_FatTable->antSumRSSI[antsel_tr_mux] += RxPower_Ant0; - pDM_FatTable->antRSSIcnt[antsel_tr_mux]++; - } - } - else //AntDivType != CG_TRX_SMART_ANTDIV - { - if ((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pPktinfo->bPacketToSelf || pDM_FatTable->use_ctrl_frame_antdiv)) { - - if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) { - - if (isCCKrate) { - - pDM_FatTable->antsel_rx_keep_0 = (pDM_FatTable->RxIdleAnt == MAIN_ANT) ? ANT1_2G : ANT2_2G; - - if (pDM_FatTable->antsel_rx_keep_0 == ANT1_2G) - pDM_FatTable->CCK_counter_main++; - else - pDM_FatTable->CCK_counter_aux++; - - odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); - - } else { - - if (pDM_FatTable->antsel_rx_keep_0 == ANT1_2G) - pDM_FatTable->OFDM_counter_main++; - else - pDM_FatTable->OFDM_counter_aux++; - - odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); - } - } else { - - odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxPower_Ant0, RSSI_METHOD, isCCKrate); - - #ifdef ODM_EVM_ENHANCE_ANTDIV - if (pDM_Odm->SupportICType == ODM_RTL8192E) { - if (!isCCKrate) - odm_AntselStatistics(pDM_Odm, pDM_FatTable->antsel_rx_keep_0, pPktinfo->StationID, RxEVM_Ant0, EVM_METHOD, isCCKrate); - - } - #endif - } - } - } - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("isCCKrate=%d, PWDB_ALL=%d\n",isCCKrate, pPhyInfo->RxPWDBAll)); - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("antsel_tr_mux=3'b%d%d%d\n",pDM_FatTable->antsel_rx_keep_2, pDM_FatTable->antsel_rx_keep_1, pDM_FatTable->antsel_rx_keep_0)); -} - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -VOID -ODM_SetTxAntByTxInfo( - IN PVOID pDM_VOID, - IN pu1Byte pDesc, - IN u1Byte macId - - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) - return; - - if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) - return; - - - if (pDM_Odm->SupportICType == ODM_RTL8723B) { -#if (RTL8723B_SUPPORT == 1) - SET_TX_DESC_ANTSEL_A_8723B(pDesc, pDM_FatTable->antsel_a[macId]); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8723B] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", - macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -#endif - } else if (pDM_Odm->SupportICType == ODM_RTL8821) { -#if (RTL8821A_SUPPORT == 1) - SET_TX_DESC_ANTSEL_A_8812(pDesc, pDM_FatTable->antsel_a[macId]); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8821A] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", - macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -#endif - } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { -#if (RTL8188E_SUPPORT == 1) - SET_TX_DESC_ANTSEL_A_88E(pDesc, pDM_FatTable->antsel_a[macId]); - SET_TX_DESC_ANTSEL_B_88E(pDesc, pDM_FatTable->antsel_b[macId]); - SET_TX_DESC_ANTSEL_C_88E(pDesc, pDM_FatTable->antsel_c[macId]); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8188E] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", - macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -#endif - } else if (pDM_Odm->SupportICType == ODM_RTL8821C) { -#if (RTL8821C_SUPPORT == 1) - SET_TX_DESC_ANTSEL_A_8821C(pDesc, pDM_FatTable->antsel_a[macId]); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[8821C] SetTxAntByTxInfo_WIN: MacID=%d, antsel_tr_mux=3'b%d%d%d\n", - macId, pDM_FatTable->antsel_c[macId], pDM_FatTable->antsel_b[macId], pDM_FatTable->antsel_a[macId]));*/ -#endif - } -} -#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) - -VOID -ODM_SetTxAntByTxInfo( - struct rtl8192cd_priv *priv, - struct tx_desc *pdesc, - unsigned short aid -) -{ - PDM_ODM_T pDM_Odm = &(priv->pshare->_dmODM); - pFAT_T pDM_FatTable = &priv->pshare->_dmODM.DM_FatTable; - u4Byte SupportICType = priv->pshare->_dmODM.SupportICType; - - if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) - return; - - if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) - return; - - if (SupportICType == ODM_RTL8881A) { - /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__); */ - pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); - pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); - } else if (SupportICType == ODM_RTL8192E) { - /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ - pdesc->Dword6 &= set_desc(~(BIT(18)|BIT(17)|BIT(16))); - pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); - } else if (SupportICType == ODM_RTL8188E) { - /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8188E******\n",__FUNCTION__,__LINE__);*/ - pdesc->Dword2 &= set_desc(~BIT(24)); - pdesc->Dword2 &= set_desc(~BIT(25)); - pdesc->Dword7 &= set_desc(~BIT(29)); - - pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_a[aid]<<24); - pdesc->Dword2 |= set_desc(pDM_FatTable->antsel_b[aid]<<25); - pdesc->Dword7 |= set_desc(pDM_FatTable->antsel_c[aid]<<29); - - - } else if (SupportICType == ODM_RTL8812) { - /*[path-A]*/ - /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__);*/ - - pdesc->Dword6 &= set_desc(~BIT(16)); - pdesc->Dword6 &= set_desc(~BIT(17)); - pdesc->Dword6 &= set_desc(~BIT(18)); - - pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_a[aid]<<16); - pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_b[aid]<<17); - pdesc->Dword6 |= set_desc(pDM_FatTable->antsel_c[aid]<<18); - - } -} - - -#if 1 /*def CONFIG_WLAN_HAL*/ -VOID -ODM_SetTxAntByTxInfo_HAL( - struct rtl8192cd_priv *priv, - PVOID pdesc_data, - u2Byte aid -) -{ - PDM_ODM_T pDM_Odm = &(priv->pshare->_dmODM); - pFAT_T pDM_FatTable = &priv->pshare->_dmODM.DM_FatTable; - u4Byte SupportICType = priv->pshare->_dmODM.SupportICType; - PTX_DESC_DATA_88XX pdescdata = (PTX_DESC_DATA_88XX)pdesc_data; - - if (!(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) - return; - - if (pDM_Odm->AntDivType == CGCS_RX_HW_ANTDIV) - return; - - if (SupportICType == ODM_RTL8881A || SupportICType == ODM_RTL8192E || SupportICType == ODM_RTL8814A) { - /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_HAL******\n",__FUNCTION__,__LINE__);*/ - pdescdata->antSel = 1; - pdescdata->antSel_A = pDM_FatTable->antsel_a[aid]; - } -} -#endif /*#ifdef CONFIG_WLAN_HAL*/ - -#endif - - -VOID -ODM_AntDiv_Config( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - ODM_RT_TRACE (pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("WIN Config Antenna Diversity\n")); - /* - if(pDM_Odm->SupportICType==ODM_RTL8723B) - { - if((!pDM_Odm->DM_SWAT_Table.ANTA_ON || !pDM_Odm->DM_SWAT_Table.ANTB_ON)) - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - } - */ - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - - pDM_Odm->AntDivType = S0S1_TRX_HW_ANTDIV; - /**/ - } -#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("CE Config Antenna Diversity\n")); - - if(pDM_Odm->SupportICType==ODM_RTL8723B) - { - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - - - } - -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("AP Config Antenna Diversity\n")); - - //2 [ NOT_SUPPORT_ANTDIV ] - #if(defined(CONFIG_NOT_SUPPORT_ANTDIV)) - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n")); - - //2 [ 2G&5G_SUPPORT_ANTDIV ] - #elif(defined(CONFIG_2G5G_SUPPORT_ANTDIV)) - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : 2.4G & 5G Support Antenna Diversity Simultaneously \n")); - pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G|ODM_ANTDIV_5G); - - if(pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) - pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; - if(*pDM_Odm->pBandType == ODM_BAND_5G ) - { - #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) - pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); - panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); - #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY)||defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) - pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); - panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); - #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); - #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); - #endif - } - else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) - { - #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) - pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); - #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) - pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); - #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); - #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); - #endif - } - - //2 [ 5G_SUPPORT_ANTDIV ] - #elif(defined(CONFIG_5G_SUPPORT_ANTDIV)) - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n")); - panic_printk("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n"); - pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_5G); - if(*pDM_Odm->pBandType == ODM_BAND_5G ) - { - if(pDM_Odm->SupportICType & ODM_ANTDIV_5G_SUPPORT_IC) - pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; - #if ( defined(CONFIG_5G_CGCS_RX_DIVERSITY) ) - pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); - panic_printk("[ 5G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n"); - #elif( defined(CONFIG_5G_CG_TRX_DIVERSITY) ) - pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - panic_printk("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n"); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); - #elif( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = CG_SMART_ANTDIV\n")); - #elif( defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 5G] : AntDiv Type = S0S1_SW_ANTDIV\n")); - #endif - } - else if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 2G AntDivType\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - } - - //2 [ 2G_SUPPORT_ANTDIV ] - #elif(defined(CONFIG_2G_SUPPORT_ANTDIV)) - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n")); - pDM_FatTable->AntDiv_2G_5G = (ODM_ANTDIV_2G); - if(*pDM_Odm->pBandType == ODM_BAND_2_4G ) - { - if(pDM_Odm->SupportICType & ODM_ANTDIV_2G_SUPPORT_IC) - pDM_Odm->SupportAbility |= ODM_BB_ANT_DIV; - #if ( defined(CONFIG_2G_CGCS_RX_DIVERSITY) ) - pDM_Odm->AntDivType = CGCS_RX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CGCS_RX_HW_ANTDIV\n")); - #elif( defined(CONFIG_2G_CG_TRX_DIVERSITY) ) - pDM_Odm->AntDivType = CG_TRX_HW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_TRX_HW_ANTDIV\n")); - #elif( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = CG_TRX_SMART_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = CG_SMART_ANTDIV\n")); - #elif( defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY) ) - pDM_Odm->AntDivType = S0S1_SW_ANTDIV; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[ 2.4G] : AntDiv Type = S0S1_SW_ANTDIV\n")); - #endif - } - else if(*pDM_Odm->pBandType == ODM_BAND_5G ) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_ANT_DIV, ODM_DBG_LOUD,("Not Support 5G AntDivType\n")); - pDM_Odm->SupportAbility &= ~(ODM_BB_ANT_DIV); - } - #endif -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] AntDiv_SupportAbility = (( %x ))\n", ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) ? 1 : 0))); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("[AntDiv Config Info] be_fix_tx_ant = ((%d))\n", pDM_Odm->DM_FatTable.b_fix_tx_ant)); - -} - - -VOID -ODM_AntDivTimers( - IN PVOID pDM_VOID, - IN u1Byte state - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if(state==INIT_ANTDIV_TIMMER) - { - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - ODM_InitializeTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer), - (RT_TIMER_CALL_BACK)ODM_SW_AntDiv_Callback, NULL, "phydm_SwAntennaSwitchTimer"); - #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - ODM_InitializeTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer, - (RT_TIMER_CALL_BACK)odm_FastAntTrainingCallback, NULL, "FastAntTrainingTimer"); - #endif - - #ifdef ODM_EVM_ENHANCE_ANTDIV - ODM_InitializeTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer, - (RT_TIMER_CALL_BACK)odm_EVM_FastAntTrainingCallback, NULL, "EVM_FastAntTrainingTimer"); - #endif - } - else if(state==CANCEL_ANTDIV_TIMMER) - { - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - ODM_CancelTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer)); - #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - ODM_CancelTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); - #endif - - #ifdef ODM_EVM_ENHANCE_ANTDIV - ODM_CancelTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); - #endif - } - else if(state==RELEASE_ANTDIV_TIMMER) - { - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - ODM_ReleaseTimer(pDM_Odm, &(pDM_Odm->DM_SWAT_Table.phydm_SwAntennaSwitchTimer)); - #elif ( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) - ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->FastAntTrainingTimer); - #endif - - #ifdef ODM_EVM_ENHANCE_ANTDIV - ODM_ReleaseTimer(pDM_Odm,&pDM_Odm->EVM_FastAntTrainingTimer); - #endif - } - -} - -VOID -phydm_antdiv_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - /*pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable;*/ - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - if (dm_value[0] == 1) { /*fixed or auto antenna*/ - - if (dm_value[1] == 0) { - pDM_Odm->antdiv_select = 0; - PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Auto\n")); - } else if (dm_value[1] == 1) { - pDM_Odm->antdiv_select = 1; - PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Fix MAin\n")); - } else if (dm_value[1] == 2) { - pDM_Odm->antdiv_select = 2; - PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv: Fix Aux\n")); - } - } else if (dm_value[0] == 2) { /*dynamic period for AntDiv*/ - - pDM_Odm->antdiv_period = (u1Byte)dm_value[1]; - PHYDM_SNPRINTF((output+used, out_len-used, "AntDiv_period = ((%d))\n", pDM_Odm->antdiv_period)); - } -} - -#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ - -VOID -ODM_AntDivReset( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->AntDivType == S0S1_SW_ANTDIV) - { - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_S0S1_SWAntDiv_Reset(pDM_Odm); - #endif - } - -} - -VOID -odm_AntennaDiversityInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - #if 0 - if(pDM_Odm->mp_mode == TRUE) - return; - #endif - - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - ODM_AntDiv_Config(pDM_Odm); - ODM_AntDivInit(pDM_Odm); - #endif -} - -VOID -odm_AntennaDiversity( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if(pDM_Odm->mp_mode == TRUE) - return; - - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - ODM_AntDiv(pDM_Odm); - #endif -} - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +/* ****************************************************** + * when antenna test utility is on or some testing need to disable antenna diversity + * call this function to disable all ODM related mechanisms which will switch antenna. + * ****************************************************** */ +void +odm_stop_antenna_switch_dm( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + /* disable ODM antenna diversity */ + p_dm->support_ability &= ~ODM_BB_ANT_DIV; + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("STOP Antenna Diversity\n")); +} + +void +phydm_enable_antenna_diversity( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + p_dm->support_ability |= ODM_BB_ANT_DIV; + p_dm->antdiv_select = 0; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("AntDiv is enabled & Re-Init AntDiv\n")); + odm_antenna_diversity_init(p_dm); +} + +void +odm_set_ant_config( + void *p_dm_void, + u8 ant_setting /* 0=A, 1=B, 2=C, .... */ +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + if (p_dm->support_ic_type == ODM_RTL8723B) { + if (ant_setting == 0) /* ant A*/ + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, 0x00000000); + else if (ant_setting == 1) + odm_set_bb_reg(p_dm, 0x948, MASKDWORD, 0x00000280); + } else if (p_dm->support_ic_type == ODM_RTL8723D) { + if (ant_setting == 0) /* ant A*/ + odm_set_bb_reg(p_dm, 0x948, MASKLWORD, 0x0000); + else if (ant_setting == 1) + odm_set_bb_reg(p_dm, 0x948, MASKLWORD, 0x0280); + } +} + +/* ****************************************************** */ + + +void +odm_sw_ant_div_rest_after_link( + void *p_dm_void +) +{ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u32 i; + + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) { + + p_dm_swat_table->try_flag = SWAW_STEP_INIT; + p_dm_swat_table->rssi_trying = 0; + p_dm_swat_table->double_chk_flag = 0; + p_dm_fat_table->rx_idle_ant = MAIN_ANT; + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) + phydm_antdiv_reset_statistic(p_dm, i); + } + +#endif +} + +void +odm_ant_div_on_off( + void *p_dm_void, + u8 swch +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + if (p_dm_fat_table->ant_div_on_off != swch) { + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) + return; + + if (p_dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("(( Turn %s )) N-Series HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); + odm_set_bb_reg(p_dm, 0xc50, BIT(7), swch); + odm_set_bb_reg(p_dm, 0xa00, BIT(15), swch); + +#if (RTL8723D_SUPPORT == 1) + /*Mingzhi 2017-05-08*/ + if (p_dm->support_ic_type == ODM_RTL8723D) { + if (swch == ANTDIV_ON) { + odm_set_bb_reg(p_dm, 0xce0, BIT(1), 1); + odm_set_bb_reg(p_dm, 0x948, BIT(6), 1); /*1:HW ctrl 0:SW ctrl*/ + } + else{ + odm_set_bb_reg(p_dm, 0xce0, BIT(1), 0); + odm_set_bb_reg(p_dm, 0x948, BIT(6), 0); /*1:HW ctrl 0:SW ctrl*/ + } + } +#endif + + } else if (p_dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("(( Turn %s )) AC-Series HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); + if (p_dm->support_ic_type & ODM_RTL8812) { + odm_set_bb_reg(p_dm, 0xc50, BIT(7), swch); /* OFDM AntDiv function block enable */ + odm_set_bb_reg(p_dm, 0xa00, BIT(15), swch); /* CCK AntDiv function block enable */ + } else { + odm_set_bb_reg(p_dm, 0x8D4, BIT(24), swch); /* OFDM AntDiv function block enable */ + + if ((p_dm->cut_version >= ODM_CUT_C) && (p_dm->support_ic_type == ODM_RTL8821) && (p_dm->ant_div_type != S0S1_SW_ANTDIV)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("(( Turn %s )) CCK HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); + odm_set_bb_reg(p_dm, 0x800, BIT(25), swch); + odm_set_bb_reg(p_dm, 0xA00, BIT(15), swch); /* CCK AntDiv function block enable */ + } else if (p_dm->support_ic_type == ODM_RTL8821C) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("(( Turn %s )) CCK HW-AntDiv block\n", (swch == ANTDIV_ON) ? "ON" : "OFF")); + odm_set_bb_reg(p_dm, 0x800, BIT(25), swch); + odm_set_bb_reg(p_dm, 0xA00, BIT(15), swch); /* CCK AntDiv function block enable */ + } + } + } + } + p_dm_fat_table->ant_div_on_off = swch; + +} + +void +odm_tx_by_tx_desc_or_reg( + void *p_dm_void, + u8 swch +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u8 enable; + + if (p_dm_fat_table->b_fix_tx_ant == NO_FIX_TX_ANT) + enable = (swch == TX_BY_DESC) ? 1 : 0; + else + enable = 0;/*Force TX by Reg*/ + + if (p_dm->ant_div_type != CGCS_RX_HW_ANTDIV) { + if (p_dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) + odm_set_bb_reg(p_dm, 0x80c, BIT(21), enable); + else if (p_dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) + odm_set_bb_reg(p_dm, 0x900, BIT(18), enable); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[AntDiv] TX_Ant_BY (( %s ))\n", (enable == TX_BY_DESC) ? "DESC" : "REG")); + } +} + +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) +void +phydm_antdiv_reset_statistic( + void *p_dm_void, + u32 macid +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + p_dm_fat_table->main_ant_sum[macid] = 0; + p_dm_fat_table->aux_ant_sum[macid] = 0; + p_dm_fat_table->main_ant_cnt[macid] = 0; + p_dm_fat_table->aux_ant_cnt[macid] = 0; + p_dm_fat_table->main_ant_sum_cck[macid] = 0; + p_dm_fat_table->aux_ant_sum_cck[macid] = 0; + p_dm_fat_table->main_ant_cnt_cck[macid] = 0; + p_dm_fat_table->aux_ant_cnt_cck[macid] = 0; +} + +void +phydm_fast_training_enable( + void *p_dm_void, + u8 swch +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 enable; + + if (swch == FAT_ON) + enable = 1; + else + enable = 0; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Fast ant Training_en = ((%d))\n", enable)); + + if (p_dm->support_ic_type == ODM_RTL8188E) { + odm_set_bb_reg(p_dm, 0xe08, BIT(16), enable); /*enable fast training*/ + /**/ + } else if (p_dm->support_ic_type == ODM_RTL8192E) { + odm_set_bb_reg(p_dm, 0xB34, BIT(28), enable); /*enable fast training (path-A)*/ + /*odm_set_bb_reg(p_dm, 0xB34, BIT(29), enable);*/ /*enable fast training (path-B)*/ + } else if (p_dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8822B)) { + odm_set_bb_reg(p_dm, 0x900, BIT(19), enable); /*enable fast training */ + /**/ + } +} + +void +phydm_keep_rx_ack_ant_by_tx_ant_time( + void *p_dm_void, + u32 time +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + /* Timming issue: keep Rx ant after tx for ACK ( time x 3.2 mu sec)*/ + if (p_dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { + + odm_set_bb_reg(p_dm, 0xE20, BIT(23) | BIT(22) | BIT(21) | BIT(20), time); + /**/ + } else if (p_dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { + + odm_set_bb_reg(p_dm, 0x818, BIT(23) | BIT(22) | BIT(21) | BIT(20), time); + /**/ + } +} + +void +odm_update_rx_idle_ant( + void *p_dm_void, + u8 ant +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u32 default_ant, optional_ant, value32, default_tx_ant; + + if (p_dm_fat_table->rx_idle_ant != ant) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] rx_idle_ant =%s\n", (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + + if (!(p_dm->support_ic_type & ODM_RTL8723B)) + p_dm_fat_table->rx_idle_ant = ant; + + if (ant == MAIN_ANT) { + default_ant = ANT1_2G; + optional_ant = ANT2_2G; + } else { + default_ant = ANT2_2G; + optional_ant = ANT1_2G; + } + + if (p_dm_fat_table->b_fix_tx_ant != NO_FIX_TX_ANT) + default_tx_ant = (p_dm_fat_table->b_fix_tx_ant == FIX_TX_AT_MAIN) ? 0 : 1; + else + default_tx_ant = default_ant; + + if (p_dm->support_ic_type & ODM_N_ANTDIV_SUPPORT) { + if (p_dm->support_ic_type == ODM_RTL8192E) { + odm_set_bb_reg(p_dm, 0xB38, BIT(5) | BIT(4) | BIT(3), default_ant); /* Default RX */ + odm_set_bb_reg(p_dm, 0xB38, BIT(8) | BIT(7) | BIT(6), optional_ant); /* Optional RX */ + odm_set_bb_reg(p_dm, 0x860, BIT(14) | BIT(13) | BIT(12), default_ant); /* Default TX */ + } +#if (RTL8723B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8723B) { + + value32 = odm_get_bb_reg(p_dm, 0x948, 0xFFF); + + if (value32 != 0x280) + odm_update_rx_idle_ant_8723b(p_dm, ant, default_ant, optional_ant); + else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to 0x948 = 0x280\n")); + } +#endif + +#if (RTL8723D_SUPPORT == 1) /*Mingzhi 2017-05-08*/ + else if (p_dm->support_ic_type == ODM_RTL8723D) { + phydm_set_tx_ant_pwr_8723d(p_dm, ant); + odm_update_rx_idle_ant_8723d(p_dm, ant, default_ant, optional_ant); + + } +#endif + + else { /*8188E & 8188F*/ +/* + if (p_dm->support_ic_type == ODM_RTL8723D) { +#if (RTL8723D_SUPPORT == 1) + phydm_set_tx_ant_pwr_8723d(p_dm, ant); +#endif + } +*/ +#if (RTL8188F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188F) { + phydm_update_rx_idle_antenna_8188F(p_dm, default_ant); + /**/ + } +#endif + + odm_set_bb_reg(p_dm, 0x864, BIT(5) | BIT(4) | BIT(3), default_ant); /*Default RX*/ + odm_set_bb_reg(p_dm, 0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); /*Optional RX*/ + odm_set_bb_reg(p_dm, 0x860, BIT(14) | BIT(13) | BIT(12), default_tx_ant); /*Default TX*/ + } + } else if (p_dm->support_ic_type & ODM_AC_ANTDIV_SUPPORT) { + u16 value16 = odm_read_2byte(p_dm, ODM_REG_TRMUX_11AC + 2); + /* */ + /* 2014/01/14 MH/Luke.Lee Add direct write for register 0xc0a to prevnt */ + /* incorrect 0xc08 bit0-15 .We still not know why it is changed. */ + /* */ + value16 &= ~(BIT(11) | BIT(10) | BIT(9) | BIT(8) | BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3)); + value16 |= ((u16)default_ant << 3); + value16 |= ((u16)optional_ant << 6); + value16 |= ((u16)default_ant << 9); + odm_write_2byte(p_dm, ODM_REG_TRMUX_11AC + 2, value16); +#if 0 + odm_set_bb_reg(p_dm, ODM_REG_TRMUX_11AC, BIT(21) | BIT20 | BIT19, default_ant); /* Default RX */ + odm_set_bb_reg(p_dm, ODM_REG_TRMUX_11AC, BIT(24) | BIT23 | BIT22, optional_ant); /* Optional RX */ + odm_set_bb_reg(p_dm, ODM_REG_TRMUX_11AC, BIT(27) | BIT26 | BIT25, default_ant); /* Default TX */ +#endif + } + + if (p_dm->support_ic_type & (ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814A)) { + odm_set_mac_reg(p_dm, 0x6D8, 0x7, default_tx_ant); /*PathA Resp Tx*/ + /**/ + } else if (p_dm->support_ic_type == ODM_RTL8188E) { + odm_set_mac_reg(p_dm, 0x6D8, BIT(7) | BIT(6), default_tx_ant); /*PathA Resp Tx*/ + /**/ + } else { + odm_set_mac_reg(p_dm, 0x6D8, BIT(10) | BIT(9) | BIT(8), default_tx_ant); /*PathA Resp Tx*/ + /**/ + } + + } else { /* p_dm_fat_table->rx_idle_ant == ant */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Stay in Ori-ant ] rx_idle_ant =%s\n", (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + p_dm_fat_table->rx_idle_ant = ant; + } +} + +void +phydm_set_antdiv_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (val_len != 1) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[Error][antdiv]Need val_len=1\n")); + return; + } + + odm_update_rx_idle_ant(p_dm, (u8)(*val_buf)); +} + +void +odm_update_tx_ant( + void *p_dm_void, + u8 ant, + u32 mac_id +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u8 tx_ant; + + if (p_dm_fat_table->b_fix_tx_ant != NO_FIX_TX_ANT) + ant = (p_dm_fat_table->b_fix_tx_ant == FIX_TX_AT_MAIN) ? MAIN_ANT : AUX_ANT; + + if (p_dm->ant_div_type == CG_TRX_SMART_ANTDIV) + tx_ant = ant; + else { + if (ant == MAIN_ANT) + tx_ant = ANT1_2G; + else + tx_ant = ANT2_2G; + } + + p_dm_fat_table->antsel_a[mac_id] = tx_ant & BIT(0); + p_dm_fat_table->antsel_b[mac_id] = (tx_ant & BIT(1)) >> 1; + p_dm_fat_table->antsel_c[mac_id] = (tx_ant & BIT(2)) >> 2; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Set TX-DESC value]: mac_id:(( %d )), tx_ant = (( %s ))\n", mac_id, (ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + /* PHYDM_DBG(p_dm,DBG_ANT_DIV,("antsel_tr_mux=(( 3'b%d%d%d ))\n",p_dm_fat_table->antsel_c[mac_id] , p_dm_fat_table->antsel_b[mac_id] , p_dm_fat_table->antsel_a[mac_id] )); */ + +} + +#ifdef BEAMFORMING_SUPPORT +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + +void +odm_bdc_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm->dm_bdc_table; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\n[ BDC Initialization......]\n")); + p_dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + p_dm_bdc_table->bdc_mode = BDC_MODE_NULL; + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->bd_ccoex_type_wbfer = 0; + p_dm->bdc_holdstate = 0xff; + + if (p_dm->support_ic_type == ODM_RTL8192E) { + odm_set_bb_reg(p_dm, 0xd7c, 0x0FFFFFFF, 0x1081008); + odm_set_bb_reg(p_dm, 0xd80, 0x0FFFFFFF, 0); + } else if (p_dm->support_ic_type == ODM_RTL8812) { + odm_set_bb_reg(p_dm, 0x9b0, 0x0FFFFFFF, 0x1081008); /* 0x9b0[30:0] = 01081008 */ + odm_set_bb_reg(p_dm, 0x9b4, 0x0FFFFFFF, 0); /* 0x9b4[31:0] = 00000000 */ + } + +} + + +void +odm_CSI_on_off( + void *p_dm_void, + u8 CSI_en +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + if (CSI_en == CSI_ON) { + if (p_dm->support_ic_type == ODM_RTL8192E) + odm_set_mac_reg(p_dm, 0xd84, BIT(11), 1); /* 0xd84[11]=1 */ + else if (p_dm->support_ic_type == ODM_RTL8812) + odm_set_mac_reg(p_dm, 0x9b0, BIT(31), 1); /* 0x9b0[31]=1 */ + + } else if (CSI_en == CSI_OFF) { + if (p_dm->support_ic_type == ODM_RTL8192E) + odm_set_mac_reg(p_dm, 0xd84, BIT(11), 0); /* 0xd84[11]=0 */ + else if (p_dm->support_ic_type == ODM_RTL8812) + odm_set_mac_reg(p_dm, 0x9b0, BIT(31), 0); /* 0x9b0[31]=0 */ + } +} + +void +odm_bd_ccoex_type_with_bfer_client( + void *p_dm_void, + u8 swch +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm->dm_bdc_table; + u8 bd_ccoex_type_wbfer; + + if (swch == DIVON_CSIOFF) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[BDCcoexType: 1] {DIV,CSI} ={1,0}\n")); + bd_ccoex_type_wbfer = 1; + + if (bd_ccoex_type_wbfer != p_dm_bdc_table->bd_ccoex_type_wbfer) { + odm_ant_div_on_off(p_dm, ANTDIV_ON); + odm_CSI_on_off(p_dm, CSI_OFF); + p_dm_bdc_table->bd_ccoex_type_wbfer = 1; + } + } else if (swch == DIVOFF_CSION) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[BDCcoexType: 2] {DIV,CSI} ={0,1}\n")); + bd_ccoex_type_wbfer = 2; + + if (bd_ccoex_type_wbfer != p_dm_bdc_table->bd_ccoex_type_wbfer) { + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + odm_CSI_on_off(p_dm, CSI_ON); + p_dm_bdc_table->bd_ccoex_type_wbfer = 2; + } + } +} + +void +odm_bf_ant_div_mode_arbitration( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm->dm_bdc_table; + u8 current_bdc_mode; + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\n")); + + /* 2 mode 1 */ + if ((p_dm_bdc_table->num_txbfee_client != 0) && (p_dm_bdc_table->num_txbfer_client == 0)) { + current_bdc_mode = BDC_MODE_1; + + if (current_bdc_mode != p_dm_bdc_table->bdc_mode) { + p_dm_bdc_table->bdc_mode = BDC_MODE_1; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + p_dm_bdc_table->bdc_rx_idle_update_counter = 1; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Change to (( Mode1 ))\n")); + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Antdiv + BF coextance mode] : (( Mode1 ))\n")); + } + /* 2 mode 2 */ + else if ((p_dm_bdc_table->num_txbfee_client == 0) && (p_dm_bdc_table->num_txbfer_client != 0)) { + current_bdc_mode = BDC_MODE_2; + + if (current_bdc_mode != p_dm_bdc_table->bdc_mode) { + p_dm_bdc_table->bdc_mode = BDC_MODE_2; + p_dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + p_dm_bdc_table->bdc_try_flag = 0; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Change to (( Mode2 ))\n")); + + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Antdiv + BF coextance mode] : (( Mode2 ))\n")); + } + /* 2 mode 3 */ + else if ((p_dm_bdc_table->num_txbfee_client != 0) && (p_dm_bdc_table->num_txbfer_client != 0)) { + current_bdc_mode = BDC_MODE_3; + + if (current_bdc_mode != p_dm_bdc_table->bdc_mode) { + p_dm_bdc_table->bdc_mode = BDC_MODE_3; + p_dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->bdc_rx_idle_update_counter = 1; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Change to (( Mode3 ))\n")); + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Antdiv + BF coextance mode] : (( Mode3 ))\n")); + } + /* 2 mode 4 */ + else if ((p_dm_bdc_table->num_txbfee_client == 0) && (p_dm_bdc_table->num_txbfer_client == 0)) { + current_bdc_mode = BDC_MODE_4; + + if (current_bdc_mode != p_dm_bdc_table->bdc_mode) { + p_dm_bdc_table->bdc_mode = BDC_MODE_4; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Change to (( Mode4 ))\n")); + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Antdiv + BF coextance mode] : (( Mode4 ))\n")); + } +#endif + +} + +void +odm_div_train_state_setting( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm->dm_bdc_table; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\n*****[S T A R T ]***** [2-0. DIV_TRAIN_STATE]\n")); + p_dm_bdc_table->bdc_try_counter = 2; + p_dm_bdc_table->bdc_try_flag = 1; + p_dm_bdc_table->BDC_state = bdc_bfer_train_state; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); +} + +void +odm_bd_ccoex_bfee_rx_div_arbitration( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm->dm_bdc_table; + boolean stop_bf_flag; + u8 bdc_active_mode; + + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***{ num_BFee, num_BFer, num_client} = (( %d , %d , %d))\n", p_dm_bdc_table->num_txbfee_client, p_dm_bdc_table->num_txbfer_client, p_dm_bdc_table->num_client)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***{ num_BF_tars, num_DIV_tars } = (( %d , %d ))\n", p_dm_bdc_table->num_bf_tar, p_dm_bdc_table->num_div_tar)); + + /* 2 [ MIB control ] */ + if (p_dm->bdc_holdstate == 2) { + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVOFF_CSION); + p_dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Force in [ BF STATE]\n")); + return; + } else if (p_dm->bdc_holdstate == 1) { + p_dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Force in [ DIV STATE]\n")); + return; + } + + /* ------------------------------------------------------------ */ + + + + /* 2 mode 2 & 3 */ + if (p_dm_bdc_table->bdc_mode == BDC_MODE_2 || p_dm_bdc_table->bdc_mode == BDC_MODE_3) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\n{ Try_flag, Try_counter } = { %d , %d }\n", p_dm_bdc_table->bdc_try_flag, p_dm_bdc_table->bdc_try_counter)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("BDCcoexType = (( %d ))\n\n", p_dm_bdc_table->bd_ccoex_type_wbfer)); + + /* All Client have Bfer-Cap------------------------------- */ + if (p_dm_bdc_table->num_txbfer_client == p_dm_bdc_table->num_client) { /* BFer STA Only?: yes */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("BFer STA only? (( Yes ))\n")); + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVOFF_CSION); + return; + } else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("BFer STA only? (( No ))\n")); + /* */ + if (p_dm_bdc_table->is_all_bf_sta_idle == false && p_dm_bdc_table->is_all_div_sta_idle == true) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("All DIV-STA are idle, but BF-STA not\n")); + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->BDC_state = bdc_bfer_train_state; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVOFF_CSION); + return; + } else if (p_dm_bdc_table->is_all_bf_sta_idle == true && p_dm_bdc_table->is_all_div_sta_idle == false) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("All BF-STA are idle, but DIV-STA not\n")); + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + return; + } + + /* Select active mode-------------------------------------- */ + if (p_dm_bdc_table->num_bf_tar == 0) { /* Selsect_1, Selsect_2 */ + if (p_dm_bdc_table->num_div_tar == 0) { /* Selsect_3 */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Select active mode (( 1 ))\n")); + p_dm_bdc_table->bdc_active_mode = 1; + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Select active mode (( 2 ))\n")); + p_dm_bdc_table->bdc_active_mode = 2; + } + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + return; + } else { /* num_bf_tar > 0 */ + if (p_dm_bdc_table->num_div_tar == 0) { /* Selsect_3 */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Select active mode (( 3 ))\n")); + p_dm_bdc_table->bdc_active_mode = 3; + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->BDC_state = bdc_bfer_train_state; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVOFF_CSION); + return; + } else { /* Selsect_4 */ + bdc_active_mode = 4; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Select active mode (( 4 ))\n")); + + if (bdc_active_mode != p_dm_bdc_table->bdc_active_mode) { + p_dm_bdc_table->bdc_active_mode = 4; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Change to active mode (( 4 )) & return!!!\n")); + return; + } + } + } + +#if 1 + if (p_dm->bdc_holdstate == 0xff) { + p_dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Force in [ DIV STATE]\n")); + return; + } +#endif + + /* Does Client number changed ? ------------------------------- */ + if (p_dm_bdc_table->num_client != p_dm_bdc_table->pre_num_client) { + p_dm_bdc_table->bdc_try_flag = 0; + p_dm_bdc_table->BDC_state = BDC_DIV_TRAIN_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ The number of client has been changed !!!] return to (( BDC_DIV_TRAIN_STATE ))\n")); + } + p_dm_bdc_table->pre_num_client = p_dm_bdc_table->num_client; + + if (p_dm_bdc_table->bdc_try_flag == 0) { + /* 2 DIV_TRAIN_STATE (mode 2-0) */ + if (p_dm_bdc_table->BDC_state == BDC_DIV_TRAIN_STATE) + odm_div_train_state_setting(p_dm); + /* 2 BFer_TRAIN_STATE (mode 2-1) */ + else if (p_dm_bdc_table->BDC_state == bdc_bfer_train_state) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*****[2-1. BFer_TRAIN_STATE ]*****\n")); + + /* if(p_dm_bdc_table->num_bf_tar==0) */ + /* { */ + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("BF_tars exist? : (( No )), [ bdc_bfer_train_state ] >> [BDC_DIV_TRAIN_STATE]\n")); */ + /* odm_div_train_state_setting( p_dm); */ + /* } */ + /* else */ /* num_bf_tar != 0 */ + /* { */ + p_dm_bdc_table->bdc_try_counter = 2; + p_dm_bdc_table->bdc_try_flag = 1; + p_dm_bdc_table->BDC_state = BDC_DECISION_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVOFF_CSION); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("BF_tars exist? : (( Yes )), [ bdc_bfer_train_state ] >> [BDC_DECISION_STATE]\n")); + /* } */ + } + /* 2 DECISION_STATE (mode 2-2) */ + else if (p_dm_bdc_table->BDC_state == BDC_DECISION_STATE) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*****[2-2. DECISION_STATE]*****\n")); + /* if(p_dm_bdc_table->num_bf_tar==0) */ + /* { */ + /* ODM_AntDiv_Printk(("BF_tars exist? : (( No )), [ DECISION_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); */ + /* odm_div_train_state_setting( p_dm); */ + /* } */ + /* else */ /* num_bf_tar != 0 */ + /* { */ + if (p_dm_bdc_table->BF_pass == false || p_dm_bdc_table->DIV_pass == false) + stop_bf_flag = true; + else + stop_bf_flag = false; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("BF_tars exist? : (( Yes )), {BF_pass, DIV_pass, stop_bf_flag } = { %d, %d, %d }\n", p_dm_bdc_table->BF_pass, p_dm_bdc_table->DIV_pass, stop_bf_flag)); + + if (stop_bf_flag == true) { /* DIV_en */ + p_dm_bdc_table->bdc_hold_counter = 10; /* 20 */ + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + p_dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ stop_bf_flag= ((true)), BDC_DECISION_STATE ] >> [BDC_DIV_HOLD_STATE]\n")); + } else { /* BF_en */ + p_dm_bdc_table->bdc_hold_counter = 10; /* 20 */ + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVOFF_CSION); + p_dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[stop_bf_flag= ((false)), BDC_DECISION_STATE ] >> [BDC_BF_HOLD_STATE]\n")); + } + /* } */ + } + /* 2 BF-HOLD_STATE (mode 2-3) */ + else if (p_dm_bdc_table->BDC_state == BDC_BF_HOLD_STATE) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*****[2-3. BF_HOLD_STATE ]*****\n")); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("bdc_hold_counter = (( %d ))\n", p_dm_bdc_table->bdc_hold_counter)); + + if (p_dm_bdc_table->bdc_hold_counter == 1) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); + odm_div_train_state_setting(p_dm); + } else { + p_dm_bdc_table->bdc_hold_counter--; + + /* if(p_dm_bdc_table->num_bf_tar==0) */ + /* { */ + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("BF_tars exist? : (( No )), [ BDC_BF_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); */ + /* odm_div_train_state_setting( p_dm); */ + /* } */ + /* else */ /* num_bf_tar != 0 */ + /* { */ + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("BF_tars exist? : (( Yes ))\n")); */ + p_dm_bdc_table->BDC_state = BDC_BF_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVOFF_CSION); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ BDC_BF_HOLD_STATE ] >> [BDC_BF_HOLD_STATE]\n")); + /* } */ + } + + } + /* 2 DIV-HOLD_STATE (mode 2-4) */ + else if (p_dm_bdc_table->BDC_state == BDC_DIV_HOLD_STATE) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*****[2-4. DIV_HOLD_STATE ]*****\n")); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("bdc_hold_counter = (( %d ))\n", p_dm_bdc_table->bdc_hold_counter)); + + if (p_dm_bdc_table->bdc_hold_counter == 1) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_TRAIN_STATE]\n")); + odm_div_train_state_setting(p_dm); + } else { + p_dm_bdc_table->bdc_hold_counter--; + p_dm_bdc_table->BDC_state = BDC_DIV_HOLD_STATE; + odm_bd_ccoex_type_with_bfer_client(p_dm, DIVON_CSIOFF); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ BDC_DIV_HOLD_STATE ] >> [BDC_DIV_HOLD_STATE]\n")); + } + + } + + } else if (p_dm_bdc_table->bdc_try_flag == 1) { + /* 2 Set Training counter */ + if (p_dm_bdc_table->bdc_try_counter > 1) { + p_dm_bdc_table->bdc_try_counter--; + if (p_dm_bdc_table->bdc_try_counter == 1) + p_dm_bdc_table->bdc_try_flag = 0; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Training !!\n")); + /* return ; */ + } + + } + + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\n[end]\n")); + +#endif /* #if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ + + + + + + +} + +#endif +#endif /* #ifdef BEAMFORMING_SUPPORT */ + + +#if (RTL8188E_SUPPORT == 1) + + +void +odm_rx_hw_ant_div_init_88e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 value32; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + +#if 0 + if (*(p_dm->p_mp_mode) == true) { + odm_set_bb_reg(p_dm, ODM_REG_IGI_A_11N, BIT(7), 0); /* disable HW AntDiv */ + odm_set_bb_reg(p_dm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); /* 1:CG, 0:CS */ + return; + } +#endif + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8188E AntDiv_Init => ant_div_type=[CGCS_RX_HW_ANTDIV]\n")); + + /* MAC setting */ + value32 = odm_get_mac_reg(p_dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); + odm_set_mac_reg(p_dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD, value32 | (BIT(23) | BIT(25))); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ + /* Pin Settings */ + odm_set_bb_reg(p_dm, ODM_REG_PIN_CTRL_11N, BIT(9) | BIT(8), 0);/* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ + odm_set_bb_reg(p_dm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ + odm_set_bb_reg(p_dm, ODM_REG_LNA_SWITCH_11N, BIT(22), 1); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ + odm_set_bb_reg(p_dm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); /* regb2c[31]=1'b1 */ /* output at CG only */ + /* OFDM Settings */ + odm_set_bb_reg(p_dm, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); + /* CCK Settings */ + odm_set_bb_reg(p_dm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); /* Fix CCK PHY status report issue */ + odm_set_bb_reg(p_dm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + + odm_set_bb_reg(p_dm, ODM_REG_ANT_MAPPING1_11N, 0xFFFF, 0x0001); /* antenna mapping table */ + + p_dm_fat_table->enable_ctrl_frame_antdiv = 1; +} + +void +odm_trx_hw_ant_div_init_88e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 value32; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + +#if 0 + if (*(p_dm->p_mp_mode) == true) { + odm_set_bb_reg(p_dm, ODM_REG_IGI_A_11N, BIT(7), 0); /* disable HW AntDiv */ + odm_set_bb_reg(p_dm, ODM_REG_RX_ANT_CTRL_11N, BIT(5) | BIT4 | BIT3, 0); /* Default RX (0/1) */ + return; + } +#endif + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8188E AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV (SPDT)]\n")); + + /* MAC setting */ + value32 = odm_get_mac_reg(p_dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD); + odm_set_mac_reg(p_dm, ODM_REG_ANTSEL_PIN_11N, MASKDWORD, value32 | (BIT(23) | BIT(25))); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ + /* Pin Settings */ + odm_set_bb_reg(p_dm, ODM_REG_PIN_CTRL_11N, BIT(9) | BIT(8), 0);/* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ + odm_set_bb_reg(p_dm, ODM_REG_RX_ANT_CTRL_11N, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ + odm_set_bb_reg(p_dm, ODM_REG_LNA_SWITCH_11N, BIT(22), 0); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ + odm_set_bb_reg(p_dm, ODM_REG_LNA_SWITCH_11N, BIT(31), 1); /* regb2c[31]=1'b1 */ /* output at CG only */ + /* OFDM Settings */ + odm_set_bb_reg(p_dm, ODM_REG_ANTDIV_PARA1_11N, MASKDWORD, 0x000000a0); + /* CCK Settings */ + odm_set_bb_reg(p_dm, ODM_REG_BB_PWR_SAV4_11N, BIT(7), 1); /* Fix CCK PHY status report issue */ + odm_set_bb_reg(p_dm, ODM_REG_CCK_ANTDIV_PARA2_11N, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + + /* antenna mapping table */ + if (!p_dm->is_mp_chip) { /* testchip */ + odm_set_bb_reg(p_dm, ODM_REG_RX_DEFUALT_A_11N, BIT(10) | BIT(9) | BIT(8), 1); /* Reg858[10:8]=3'b001 */ + odm_set_bb_reg(p_dm, ODM_REG_RX_DEFUALT_A_11N, BIT(13) | BIT(12) | BIT(11), 2); /* Reg858[13:11]=3'b010 */ + } else /* MPchip */ + odm_set_bb_reg(p_dm, ODM_REG_ANT_MAPPING1_11N, MASKDWORD, 0x0201); /*Reg914=3'b010, Reg915=3'b001*/ + + p_dm_fat_table->enable_ctrl_frame_antdiv = 1; +} + + +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) +void +odm_smart_hw_ant_div_init_88e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 value32, i; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8188E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n")); + +#if 0 + if (*(p_dm->p_mp_mode) == true) { + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("p_dm->ant_div_type: %d\n", p_dm->ant_div_type)); + return; + } +#endif + + p_dm_fat_table->train_idx = 0; + p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + + p_dm->fat_comb_a = 5; + p_dm->antdiv_intvl = 0x64; /* 100ms */ + + for (i = 0; i < 6; i++) + p_dm_fat_table->bssid[i] = 0; + for (i = 0; i < (p_dm->fat_comb_a) ; i++) { + p_dm_fat_table->ant_sum_rssi[i] = 0; + p_dm_fat_table->ant_rssi_cnt[i] = 0; + p_dm_fat_table->ant_ave_rssi[i] = 0; + } + + /* MAC setting */ + value32 = odm_get_mac_reg(p_dm, 0x4c, MASKDWORD); + odm_set_mac_reg(p_dm, 0x4c, MASKDWORD, value32 | (BIT(23) | BIT(25))); /* Reg4C[25]=1, Reg4C[23]=1 for pin output */ + value32 = odm_get_mac_reg(p_dm, 0x7B4, MASKDWORD); + odm_set_mac_reg(p_dm, 0x7b4, MASKDWORD, value32 | (BIT(16) | BIT(17))); /* Reg7B4[16]=1 enable antenna training, Reg7B4[17]=1 enable A2 match */ + /* value32 = platform_efio_read_4byte(adapter, 0x7B4); */ + /* platform_efio_write_4byte(adapter, 0x7b4, value32|BIT(18)); */ /* append MACID in reponse packet */ + + /* Match MAC ADDR */ + odm_set_mac_reg(p_dm, 0x7b4, 0xFFFF, 0); + odm_set_mac_reg(p_dm, 0x7b0, MASKDWORD, 0); + + odm_set_bb_reg(p_dm, 0x870, BIT(9) | BIT(8), 0);/* reg870[8]=1'b0, reg870[9]=1'b0 */ /* antsel antselb by HW */ + odm_set_bb_reg(p_dm, 0x864, BIT(10), 0); /* reg864[10]=1'b0 */ /* antsel2 by HW */ + odm_set_bb_reg(p_dm, 0xb2c, BIT(22), 0); /* regb2c[22]=1'b0 */ /* disable CS/CG switch */ + odm_set_bb_reg(p_dm, 0xb2c, BIT(31), 0); /* regb2c[31]=1'b1 */ /* output at CS only */ + odm_set_bb_reg(p_dm, 0xca4, MASKDWORD, 0x000000a0); + + /* antenna mapping table */ + if (p_dm->fat_comb_a == 2) { + if (!p_dm->is_mp_chip) { /* testchip */ + odm_set_bb_reg(p_dm, 0x858, BIT(10) | BIT(9) | BIT(8), 1); /* Reg858[10:8]=3'b001 */ + odm_set_bb_reg(p_dm, 0x858, BIT(13) | BIT(12) | BIT(11), 2); /* Reg858[13:11]=3'b010 */ + } else { /* MPchip */ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE0, 1); + odm_set_bb_reg(p_dm, 0x914, MASKBYTE1, 2); + } + } else { + if (!p_dm->is_mp_chip) { /* testchip */ + odm_set_bb_reg(p_dm, 0x858, BIT(10) | BIT(9) | BIT(8), 0); /* Reg858[10:8]=3'b000 */ + odm_set_bb_reg(p_dm, 0x858, BIT(13) | BIT(12) | BIT(11), 1); /* Reg858[13:11]=3'b001 */ + odm_set_bb_reg(p_dm, 0x878, BIT(16), 0); + odm_set_bb_reg(p_dm, 0x858, BIT(15) | BIT(14), 2); /* (Reg878[0],Reg858[14:15])=3'b010 */ + odm_set_bb_reg(p_dm, 0x878, BIT(19) | BIT(18) | BIT(17), 3); /* Reg878[3:1]=3b'011 */ + odm_set_bb_reg(p_dm, 0x878, BIT(22) | BIT(21) | BIT(20), 4); /* Reg878[6:4]=3b'100 */ + odm_set_bb_reg(p_dm, 0x878, BIT(25) | BIT(24) | BIT(23), 5); /* Reg878[9:7]=3b'101 */ + odm_set_bb_reg(p_dm, 0x878, BIT(28) | BIT(27) | BIT(26), 6); /* Reg878[12:10]=3b'110 */ + odm_set_bb_reg(p_dm, 0x878, BIT(31) | BIT(30) | BIT(29), 7); /* Reg878[15:13]=3b'111 */ + } else { /* MPchip */ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE0, 4); /* 0: 3b'000 */ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE1, 2); /* 1: 3b'001 */ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE2, 0); /* 2: 3b'010 */ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE3, 1); /* 3: 3b'011 */ + odm_set_bb_reg(p_dm, 0x918, MASKBYTE0, 3); /* 4: 3b'100 */ + odm_set_bb_reg(p_dm, 0x918, MASKBYTE1, 5); /* 5: 3b'101 */ + odm_set_bb_reg(p_dm, 0x918, MASKBYTE2, 6); /* 6: 3b'110 */ + odm_set_bb_reg(p_dm, 0x918, MASKBYTE3, 255); /* 7: 3b'111 */ + } + } + + /* Default ant setting when no fast training */ + odm_set_bb_reg(p_dm, 0x864, BIT(5) | BIT(4) | BIT(3), 0); /* Default RX */ + odm_set_bb_reg(p_dm, 0x864, BIT(8) | BIT(7) | BIT(6), 1); /* Optional RX */ + odm_set_bb_reg(p_dm, 0x860, BIT(14) | BIT(13) | BIT(12), 0); /* Default TX */ + + /* Enter Traing state */ + odm_set_bb_reg(p_dm, 0x864, BIT(2) | BIT(1) | BIT(0), (p_dm->fat_comb_a - 1)); /* reg864[2:0]=3'd6 */ /* ant combination=reg864[2:0]+1 */ + + /* SW Control */ + /* phy_set_bb_reg(adapter, 0x864, BIT10, 1); */ + /* phy_set_bb_reg(adapter, 0x870, BIT9, 1); */ + /* phy_set_bb_reg(adapter, 0x870, BIT8, 1); */ + /* phy_set_bb_reg(adapter, 0x864, BIT11, 1); */ + /* phy_set_bb_reg(adapter, 0x860, BIT9, 0); */ + /* phy_set_bb_reg(adapter, 0x860, BIT8, 0); */ +} +#endif + +#endif /* #if (RTL8188E_SUPPORT == 1) */ + + +#if (RTL8192E_SUPPORT == 1) +void +odm_rx_hw_ant_div_init_92e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + +#if 0 + if (*(p_dm->p_mp_mode) == true) { + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + odm_set_bb_reg(p_dm, 0xc50, BIT(8), 0); /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ + odm_set_bb_reg(p_dm, 0xc50, BIT(9), 1); /* 1:CG, 0:CS */ + return; + } +#endif + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8192E AntDiv_Init => ant_div_type=[CGCS_RX_HW_ANTDIV]\n")); + + /* Pin Settings */ + odm_set_bb_reg(p_dm, 0x870, BIT(8), 0);/* reg870[8]=1'b0, */ /* "antsel" is controled by HWs */ + odm_set_bb_reg(p_dm, 0xc50, BIT(8), 1); /* regc50[8]=1'b1 */ /* " CS/CG switching" is controled by HWs */ + + /* Mapping table */ + odm_set_bb_reg(p_dm, 0x914, 0xFFFF, 0x0100); /* antenna mapping table */ + + /* OFDM Settings */ + odm_set_bb_reg(p_dm, 0xca4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0xca4, 0x7FF000, 0x0); /* bias */ + + /* CCK Settings */ + odm_set_bb_reg(p_dm, 0xa04, 0xF000000, 0); /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(p_dm, 0xb34, BIT(30), 0); /* (92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ + odm_set_bb_reg(p_dm, 0xa74, BIT(7), 1); /* Fix CCK PHY status report issue */ + odm_set_bb_reg(p_dm, 0xa0c, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + +#ifdef ODM_EVM_ENHANCE_ANTDIV + phydm_evm_sw_antdiv_init(p_dm); +#endif + +} + +void +odm_trx_hw_ant_div_init_92e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if 0 + if (*(p_dm->p_mp_mode) == true) { + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + odm_set_bb_reg(p_dm, 0xc50, BIT(8), 0); /* r_rxdiv_enable_anta regc50[8]=1'b0 0: control by c50[9] */ + odm_set_bb_reg(p_dm, 0xc50, BIT(9), 1); /* 1:CG, 0:CS */ + return; + } +#endif + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8192E AntDiv_Init => ant_div_type=[ Only for DIR605, CG_TRX_HW_ANTDIV]\n")); + + /* 3 --RFE pin setting--------- */ + /* [MAC] */ + odm_set_mac_reg(p_dm, 0x38, BIT(11), 1); /* DBG PAD Driving control (GPIO 8) */ + odm_set_mac_reg(p_dm, 0x4c, BIT(23), 0); /* path-A, RFE_CTRL_3 */ + odm_set_mac_reg(p_dm, 0x4c, BIT(29), 1); /* path-A, RFE_CTRL_8 */ + /* [BB] */ + odm_set_bb_reg(p_dm, 0x944, BIT(3), 1); /* RFE_buffer */ + odm_set_bb_reg(p_dm, 0x944, BIT(8), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(7) | BIT(6), 0x0); /* r_rfe_path_sel_ (RFE_CTRL_3) */ + odm_set_bb_reg(p_dm, 0x940, BIT(17) | BIT(16), 0x0); /* r_rfe_path_sel_ (RFE_CTRL_8) */ + odm_set_bb_reg(p_dm, 0x944, BIT(31), 0); /* RFE_buffer */ + odm_set_bb_reg(p_dm, 0x92C, BIT(3), 0); /* rfe_inv (RFE_CTRL_3) */ + odm_set_bb_reg(p_dm, 0x92C, BIT(8), 1); /* rfe_inv (RFE_CTRL_8) */ + odm_set_bb_reg(p_dm, 0x930, 0xF000, 0x8); /* path-A, RFE_CTRL_3 */ + odm_set_bb_reg(p_dm, 0x934, 0xF, 0x8); /* path-A, RFE_CTRL_8 */ + /* 3 ------------------------- */ + + /* Pin Settings */ + odm_set_bb_reg(p_dm, 0xC50, BIT(8), 0); /* path-A */ /* disable CS/CG switch */ + +#if 0 + /* Let it follows PHY_REG for bit9 setting */ + if (p_dm->priv->pshare->rf_ft_var.use_ext_pa || p_dm->priv->pshare->rf_ft_var.use_ext_lna) + odm_set_bb_reg(p_dm, 0xC50, BIT(9), 1); /* path-A output at CS */ + else + odm_set_bb_reg(p_dm, 0xC50, BIT(9), 0); /* path-A output at CG ->normal power */ +#endif + + odm_set_bb_reg(p_dm, 0x870, BIT(9) | BIT(8), 0); /* path-A*/ /* antsel antselb by HW */ + odm_set_bb_reg(p_dm, 0xB38, BIT(10), 0); /* path-A */ /* antsel2 by HW */ + + /* Mapping table */ + odm_set_bb_reg(p_dm, 0x914, 0xFFFF, 0x0100); /* antenna mapping table */ + + /* OFDM Settings */ + odm_set_bb_reg(p_dm, 0xca4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0xca4, 0x7FF000, 0x0); /* bias */ + + /* CCK Settings */ + odm_set_bb_reg(p_dm, 0xa04, 0xF000000, 0); /* Select which path to receive for CCK_1 & CCK_2 */ + odm_set_bb_reg(p_dm, 0xb34, BIT(30), 0); /* (92E) ANTSEL_CCK_opt = r_en_antsel_cck? ANTSEL_CCK: 1'b0 */ + odm_set_bb_reg(p_dm, 0xa74, BIT(7), 1); /* Fix CCK PHY status report issue */ + odm_set_bb_reg(p_dm, 0xa0c, BIT(4), 1); /* CCK complete HW AntDiv within 64 samples */ + +#ifdef ODM_EVM_ENHANCE_ANTDIV + phydm_evm_sw_antdiv_init(p_dm); +#endif +} + +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) +void +odm_smart_hw_ant_div_init_92e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8192E AntDiv_Init => ant_div_type=[CG_TRX_SMART_ANTDIV]\n")); +} +#endif + +#endif /* #if (RTL8192E_SUPPORT == 1) */ + +#if (RTL8723D_SUPPORT == 1) +void +odm_trx_hw_ant_div_init_8723d( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[8723D] AntDiv_Init => ant_div_type=[S0S1_HW_TRX_AntDiv]\n")); + + /*BT Coexistence*/ + /*keep antsel_map when GNT_BT = 1*/ + odm_set_bb_reg(p_dm, 0x864, BIT(12), 1); + /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + odm_set_bb_reg(p_dm, 0x874, BIT(23), 0); + /* Disable hw antsw & fast_train.antsw when BT TX/RX */ + odm_set_bb_reg(p_dm, 0xE64, 0xFFFF0000, 0x000c); + + + odm_set_bb_reg(p_dm, 0x870, BIT(9) | BIT(8), 0); + /*PTA setting: WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL)*/ + /*odm_set_bb_reg(p_dm, 0x948, BIT6, 0);*/ + /*odm_set_bb_reg(p_dm, 0x948, BIT8, 0);*/ + /*GNT_WL tx*/ + odm_set_bb_reg(p_dm, 0x950, BIT(29), 0); + + + /*Mapping Table*/ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0x914, MASKBYTE1, 3); + /* odm_set_bb_reg(p_dm, 0x864, BIT5|BIT4|BIT3, 0); */ + /* odm_set_bb_reg(p_dm, 0x864, BIT8|BIT7|BIT6, 1); */ + + /* Set WLBB_SEL_RF_ON 1 if RXFIR_PWDB > 0xCcc[3:0] */ + odm_set_bb_reg(p_dm, 0xCcc, BIT(12), 0); + /* Low-to-High threshold for WLBB_SEL_RF_ON when OFDM enable */ + odm_set_bb_reg(p_dm, 0xCcc, 0x0F, 0x01); + /* High-to-Low threshold for WLBB_SEL_RF_ON when OFDM enable */ + odm_set_bb_reg(p_dm, 0xCcc, 0xF0, 0x0); + /* b Low-to-High threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK ) */ + odm_set_bb_reg(p_dm, 0xAbc, 0xFF, 0x06); + /* High-to-Low threshold for WLBB_SEL_RF_ON when OFDM disable ( only CCK ) */ + odm_set_bb_reg(p_dm, 0xAbc, 0xFF00, 0x00); + + + /*OFDM HW AntDiv Parameters*/ + odm_set_bb_reg(p_dm, 0xCA4, 0x7FF, 0xa0); + odm_set_bb_reg(p_dm, 0xCA4, 0x7FF000, 0x00); + odm_set_bb_reg(p_dm, 0xC5C, BIT(20) | BIT(19) | BIT(18), 0x04); + + /*CCK HW AntDiv Parameters*/ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); + odm_set_bb_reg(p_dm, 0xAA8, BIT(8), 0); + + odm_set_bb_reg(p_dm, 0xA0C, 0x0F, 0xf); + odm_set_bb_reg(p_dm, 0xA14, 0x1F, 0x8); + odm_set_bb_reg(p_dm, 0xA10, BIT(13), 0x1); + odm_set_bb_reg(p_dm, 0xA74, BIT(8), 0x0); + odm_set_bb_reg(p_dm, 0xB34, BIT(30), 0x1); + + /*disable antenna training */ + odm_set_bb_reg(p_dm, 0xE08, BIT(16), 0); + odm_set_bb_reg(p_dm, 0xc50, BIT(8), 0); + +} +/*Mingzhi 2017-05-08*/ + +void +odm_update_rx_idle_ant_8723d( + void *p_dm_void, + u8 ant, + u32 default_ant, + u32 optional_ant +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct _ADAPTER *p_adapter = p_dm->adapter; + u8 count = 0; + + +/* odm_set_bb_reg(p_dm, 0x948, BIT(6), 0x1); */ + odm_set_bb_reg(p_dm, 0x948, BIT(7), default_ant); + odm_set_bb_reg(p_dm, 0x864, BIT(5) | BIT(4) | BIT(3), default_ant); /*Default RX*/ + odm_set_bb_reg(p_dm, 0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); /*Optional RX*/ + odm_set_bb_reg(p_dm, 0x860, BIT(14) | BIT(13) | BIT(12), default_ant); /*Default TX*/ + p_dm_fat_table->rx_idle_ant = ant; + +} + +void +phydm_set_tx_ant_pwr_8723d( + void *p_dm_void, + u8 ant +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct _ADAPTER *p_adapter = p_dm->adapter; + + p_dm_fat_table->rx_idle_ant = ant; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + p_adapter->HalFunc.SetTxPowerLevelHandler(p_adapter, *p_dm->p_channel); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + rtw_hal_set_tx_power_level(p_adapter, *p_dm->p_channel); +#endif + +} +#endif + +#if (RTL8723B_SUPPORT == 1) +void +odm_trx_hw_ant_div_init_8723b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8723B AntDiv_Init => ant_div_type=[CG_TRX_HW_ANTDIV(DPDT)]\n")); + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0x914, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xCA4, 0x7FF, 0xa0); /* thershold */ + odm_set_bb_reg(p_dm, 0xCA4, 0x7FF000, 0x00); /* bias */ + + /* CCK HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); /* do 64 samples */ + + /* BT Coexistence */ + odm_set_bb_reg(p_dm, 0x864, BIT(12), 0); /* keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(p_dm, 0x874, BIT(23), 0); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + + /* Output Pin Settings */ + odm_set_bb_reg(p_dm, 0x870, BIT(8), 0); + + odm_set_bb_reg(p_dm, 0x948, BIT(6), 0); /* WL_BB_SEL_BTG_TRXG_anta, (1: HW CTRL 0: SW CTRL) */ + odm_set_bb_reg(p_dm, 0x948, BIT(7), 0); + + odm_set_mac_reg(p_dm, 0x40, BIT(3), 1); + odm_set_mac_reg(p_dm, 0x38, BIT(11), 1); + odm_set_mac_reg(p_dm, 0x4C, BIT(24) | BIT(23), 2); /* select DPDT_P and DPDT_N as output pin */ + + odm_set_bb_reg(p_dm, 0x944, BIT(0) | BIT(1), 3); /* in/out */ + odm_set_bb_reg(p_dm, 0x944, BIT(31), 0); + + odm_set_bb_reg(p_dm, 0x92C, BIT(1), 0); /* DPDT_P non-inverse */ + odm_set_bb_reg(p_dm, 0x92C, BIT(0), 1); /* DPDT_N inverse */ + + odm_set_bb_reg(p_dm, 0x930, 0xF0, 8); /* DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0x930, 0xF, 8); /* DPDT_N = ANTSEL[0] */ + + /* 2 [--For HW Bug setting] */ + if (p_dm->ant_type == ODM_AUTO_ANT) + odm_set_bb_reg(p_dm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + +} + + + +void +odm_s0s1_sw_ant_div_init_8723b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8723B AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n")); + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0x914, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0x914, MASKBYTE1, 1); + + /* Output Pin Settings */ + /* odm_set_bb_reg(p_dm, 0x948, BIT6, 0x1); */ + odm_set_bb_reg(p_dm, 0x870, BIT(9) | BIT(8), 0); + + p_dm_fat_table->is_become_linked = false; + p_dm_swat_table->try_flag = SWAW_STEP_INIT; + p_dm_swat_table->double_chk_flag = 0; + + /* 2 [--For HW Bug setting] */ + odm_set_bb_reg(p_dm, 0x80C, BIT(21), 0); /* TX ant by Reg */ + +} + +void +odm_update_rx_idle_ant_8723b( + void *p_dm_void, + u8 ant, + u32 default_ant, + u32 optional_ant +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct _ADAPTER *p_adapter = p_dm->adapter; + u8 count = 0; + /*u8 u1_temp;*/ + /*u8 h2c_parameter;*/ + + if ((!p_dm->is_linked) && (p_dm->ant_type == ODM_AUTO_ANT)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to no link\n")); + return; + } + +#if 0 + /* Send H2C command to FW */ + /* Enable wifi calibration */ + h2c_parameter = true; + odm_fill_h2c_cmd(p_dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); + + /* Check if H2C command sucess or not (0x1e6) */ + u1_temp = odm_read_1byte(p_dm, 0x1e6); + while ((u1_temp != 0x1) && (count < 100)) { + ODM_delay_us(10); + u1_temp = odm_read_1byte(p_dm, 0x1e6); + count++; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: H2C command status = %d, count = %d\n", u1_temp, count)); + + if (u1_temp == 0x1) { + /* Check if BT is doing IQK (0x1e7) */ + count = 0; + u1_temp = odm_read_1byte(p_dm, 0x1e7); + while ((!(u1_temp & BIT(0))) && (count < 100)) { + ODM_delay_us(50); + u1_temp = odm_read_1byte(p_dm, 0x1e7); + count++; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: BT IQK status = %d, count = %d\n", u1_temp, count)); + + if (u1_temp & BIT(0)) { + odm_set_bb_reg(p_dm, 0x948, BIT(6), 0x1); + odm_set_bb_reg(p_dm, 0x948, BIT(9), default_ant); + odm_set_bb_reg(p_dm, 0x864, BIT(5) | BIT4 | BIT3, default_ant); /* Default RX */ + odm_set_bb_reg(p_dm, 0x864, BIT(8) | BIT7 | BIT6, optional_ant); /* Optional RX */ + odm_set_bb_reg(p_dm, 0x860, BIT(14) | BIT13 | BIT12, default_ant); /* Default TX */ + p_dm_fat_table->rx_idle_ant = ant; + + /* Set TX AGC by S0/S1 */ + /* Need to consider Linux driver */ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + p_adapter->hal_func.set_tx_power_level_handler(p_adapter, *p_dm->p_channel); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + rtw_hal_set_tx_power_level(p_adapter, *p_dm->p_channel); +#endif + + /* Set IQC by S0/S1 */ + odm_set_iqc_by_rfpath(p_dm, default_ant); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: Success to set RX antenna\n")); + } else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to BT IQK\n")); + } else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: Fail to set RX antenna due to H2C command fail\n")); + + /* Send H2C command to FW */ + /* Disable wifi calibration */ + h2c_parameter = false; + odm_fill_h2c_cmd(p_dm, ODM_H2C_WIFI_CALIBRATION, 1, &h2c_parameter); +#else + + odm_set_bb_reg(p_dm, 0x948, BIT(6), 0x1); + odm_set_bb_reg(p_dm, 0x948, BIT(9), default_ant); + odm_set_bb_reg(p_dm, 0x864, BIT(5) | BIT(4) | BIT(3), default_ant); /*Default RX*/ + odm_set_bb_reg(p_dm, 0x864, BIT(8) | BIT(7) | BIT(6), optional_ant); /*Optional RX*/ + odm_set_bb_reg(p_dm, 0x860, BIT(14) | BIT(13) | BIT(12), default_ant); /*Default TX*/ + p_dm_fat_table->rx_idle_ant = ant; + + /* Set TX AGC by S0/S1 */ + /* Need to consider Linux driver */ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + p_adapter->HalFunc.SetTxPowerLevelHandler(p_adapter, *p_dm->p_channel); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + rtw_hal_set_tx_power_level(p_adapter, *p_dm->p_channel); +#endif + + /* Set IQC by S0/S1 */ + odm_set_iqc_by_rfpath(p_dm, default_ant); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-ant ] 8723B: Success to set RX antenna\n")); + +#endif +} + +boolean +phydm_is_bt_enable_8723b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 bt_state; + /*u32 reg75;*/ + + /*reg75 = odm_get_bb_reg(p_dm, 0x74, BIT8);*/ + /*odm_set_bb_reg(p_dm, 0x74, BIT8, 0x0);*/ + odm_set_bb_reg(p_dm, 0xa0, BIT(24) | BIT(25) | BIT(26), 0x5); + bt_state = odm_get_bb_reg(p_dm, 0xa0, (BIT(3) | BIT(2) | BIT(1) | BIT(0))); + /*odm_set_bb_reg(p_dm, 0x74, BIT8, reg75);*/ + + if ((bt_state == 4) || (bt_state == 7) || (bt_state == 9) || (bt_state == 13)) + return true; + else + return false; +} +#endif /* #if (RTL8723B_SUPPORT == 1) */ + +#if (RTL8821A_SUPPORT == 1) + +void +odm_trx_hw_ant_div_init_8821a( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8821A AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (DPDT)]\n")); + + /* Output Pin Settings */ + odm_set_mac_reg(p_dm, 0x4C, BIT(25), 0); + + odm_set_mac_reg(p_dm, 0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(p_dm, 0x64, BIT(28), 1); /* LNAON by WLAN control */ + + odm_set_bb_reg(p_dm, 0xCB8, BIT(16), 0); + + odm_set_mac_reg(p_dm, 0x4C, BIT(23), 0); /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(p_dm, 0x4C, BIT(24), 1); /* by WLAN control */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF, 8); /* DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF0, 8); /* DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(29), 0); /* DPDT_P non-inverse */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(28), 1); /* DPDT_N inverse */ + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF000, 0x10); /* bias */ + + /* CCK HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); /* do 64 samples */ + + odm_set_bb_reg(p_dm, 0x800, BIT(25), 0); /* ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(p_dm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + + /* BT Coexistence */ + odm_set_bb_reg(p_dm, 0xCAC, BIT(9), 1); /* keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(p_dm, 0x804, BIT(4), 1); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + + odm_set_bb_reg(p_dm, 0x8CC, BIT(20) | BIT(19) | BIT(18), 3); /* settling time of antdiv by RF LNA = 100ns */ + + /* response TX ant by RX ant */ + odm_set_mac_reg(p_dm, 0x668, BIT(3), 1); + +} + +void +odm_s0s1_sw_ant_div_init_8821a( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8821A AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n")); + + /* Output Pin Settings */ + odm_set_mac_reg(p_dm, 0x4C, BIT(25), 0); + + odm_set_mac_reg(p_dm, 0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(p_dm, 0x64, BIT(28), 1); /* LNAON by WLAN control */ + + odm_set_bb_reg(p_dm, 0xCB8, BIT(16), 0); + + odm_set_mac_reg(p_dm, 0x4C, BIT(23), 0); /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(p_dm, 0x4C, BIT(24), 1); /* by WLAN control */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF, 8); /* DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF0, 8); /* DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(29), 0); /* DPDT_P non-inverse */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(28), 1); /* DPDT_N inverse */ + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF000, 0x10); /* bias */ + + /* CCK HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); /* do 64 samples */ + + odm_set_bb_reg(p_dm, 0x800, BIT(25), 0); /* ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(p_dm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + + /* BT Coexistence */ + odm_set_bb_reg(p_dm, 0xCAC, BIT(9), 1); /* keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(p_dm, 0x804, BIT(4), 1); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + + odm_set_bb_reg(p_dm, 0x8CC, BIT(20) | BIT(19) | BIT(18), 3); /* settling time of antdiv by RF LNA = 100ns */ + + /* response TX ant by RX ant */ + odm_set_mac_reg(p_dm, 0x668, BIT(3), 1); + + + odm_set_bb_reg(p_dm, 0x900, BIT(18), 0); + + p_dm_swat_table->try_flag = SWAW_STEP_INIT; + p_dm_swat_table->double_chk_flag = 0; + p_dm_swat_table->cur_antenna = MAIN_ANT; + p_dm_swat_table->pre_antenna = MAIN_ANT; + p_dm_swat_table->swas_no_link_state = 0; + +} +#endif /* #if (RTL8821A_SUPPORT == 1) */ + +#if (RTL8821C_SUPPORT == 1) +void +odm_trx_hw_ant_div_init_8821c( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8821C AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (DPDT)]\n")); + /* Output Pin Settings */ + odm_set_mac_reg(p_dm, 0x4C, BIT(25), 0); + + odm_set_mac_reg(p_dm, 0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(p_dm, 0x64, BIT(28), 1); /* LNAON by WLAN control */ + + odm_set_bb_reg(p_dm, 0xCB8, BIT(16), 0); + + odm_set_mac_reg(p_dm, 0x4C, BIT(23), 0); /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(p_dm, 0x4C, BIT(24), 1); /* by WLAN control */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF, 8); /* DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF0, 8); /* DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(29), 0); /* DPDT_P non-inverse */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(28), 1); /* DPDT_N inverse */ + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF000, 0x10); /* bias */ + + /* CCK HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); /* do 64 samples */ + + odm_set_bb_reg(p_dm, 0x800, BIT(25), 0); /* ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(p_dm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + + /* BT Coexistence */ + odm_set_bb_reg(p_dm, 0xCAC, BIT(9), 1); /* keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(p_dm, 0x804, BIT(4), 1); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + + /* Timming issue */ + odm_set_bb_reg(p_dm, 0x818, BIT(23) | BIT(22) | BIT(21) | BIT(20), 0); /*keep antidx after tx for ACK ( unit x 3.2 mu sec)*/ + odm_set_bb_reg(p_dm, 0x8CC, BIT(20) | BIT(19) | BIT(18), 3); /* settling time of antdiv by RF LNA = 100ns */ + + /* response TX ant by RX ant */ + odm_set_mac_reg(p_dm, 0x668, BIT(3), 1); + +} + +void +phydm_s0s1_sw_ant_div_init_8821c( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8821C AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n")); + + /* Output Pin Settings */ + odm_set_mac_reg(p_dm, 0x4C, BIT(25), 0); + + odm_set_mac_reg(p_dm, 0x64, BIT(29), 1); /* PAPE by WLAN control */ + odm_set_mac_reg(p_dm, 0x64, BIT(28), 1); /* LNAON by WLAN control */ + + odm_set_bb_reg(p_dm, 0xCB8, BIT(16), 0); + + odm_set_mac_reg(p_dm, 0x4C, BIT(23), 0); /* select DPDT_P and DPDT_N as output pin */ + odm_set_mac_reg(p_dm, 0x4C, BIT(24), 1); /* by WLAN control */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF, 8); /* DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, 0xF0, 8); /* DPDT_N = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(29), 0); /* DPDT_P non-inverse */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(28), 1); /* DPDT_N inverse */ + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF000, 0x00); /* bias */ + + /* CCK HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); /* do 64 samples */ + + odm_set_bb_reg(p_dm, 0x800, BIT(25), 0); /* ANTSEL_CCK sent to the smart_antenna circuit */ + odm_set_bb_reg(p_dm, 0xA00, BIT(15), 0); /* CCK AntDiv function block enable */ + + /* BT Coexistence */ + odm_set_bb_reg(p_dm, 0xCAC, BIT(9), 1); /* keep antsel_map when GNT_BT = 1 */ + odm_set_bb_reg(p_dm, 0x804, BIT(4), 1); /* Disable hw antsw & fast_train.antsw when GNT_BT=1 */ + + odm_set_bb_reg(p_dm, 0x8CC, BIT(20) | BIT(19) | BIT(18), 3); /* settling time of antdiv by RF LNA = 100ns */ + + /* response TX ant by RX ant */ + odm_set_mac_reg(p_dm, 0x668, BIT(3), 1); + + + odm_set_bb_reg(p_dm, 0x900, BIT(18), 0); + + p_dm_swat_table->try_flag = SWAW_STEP_INIT; + p_dm_swat_table->double_chk_flag = 0; + p_dm_swat_table->cur_antenna = MAIN_ANT; + p_dm_swat_table->pre_antenna = MAIN_ANT; + p_dm_swat_table->swas_no_link_state = 0; + +} +#endif /* #if (RTL8821C_SUPPORT == 1) */ + + +#if (RTL8881A_SUPPORT == 1) +void +odm_trx_hw_ant_div_init_8881a( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8881A AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (SPDT)]\n")); + + /* Output Pin Settings */ + /* [SPDT related] */ + odm_set_mac_reg(p_dm, 0x4C, BIT(25), 0); + odm_set_mac_reg(p_dm, 0x4C, BIT(26), 0); + odm_set_bb_reg(p_dm, 0xCB4, BIT(31), 0); /* delay buffer */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(22), 0); + odm_set_bb_reg(p_dm, 0xCB4, BIT(24), 1); + odm_set_bb_reg(p_dm, 0xCB0, 0xF00, 8); /* DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB0, 0xF0000, 8); /* DPDT_N = ANTSEL[0] */ + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF000, 0x0); /* bias */ + odm_set_bb_reg(p_dm, 0x8CC, BIT(20) | BIT(19) | BIT(18), 3); /* settling time of antdiv by RF LNA = 100ns */ + + /* CCK HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); /* do 64 samples */ + + /* 2 [--For HW Bug setting] */ + + odm_set_bb_reg(p_dm, 0x900, BIT(18), 0); /* TX ant by Reg */ /* A-cut bug */ +} + +#endif /* #if (RTL8881A_SUPPORT == 1) */ + + +#if (RTL8812A_SUPPORT == 1) +void +odm_trx_hw_ant_div_init_8812a( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8812A AntDiv_Init => ant_div_type=[ CG_TRX_HW_ANTDIV (SPDT)]\n")); + + /* 3 */ /* 3 --RFE pin setting--------- */ + /* [BB] */ + odm_set_bb_reg(p_dm, 0x900, BIT(10) | BIT(9) | BIT(8), 0x0); /* disable SW switch */ + odm_set_bb_reg(p_dm, 0x900, BIT(17) | BIT(16), 0x0); + odm_set_bb_reg(p_dm, 0x974, BIT(7) | BIT(6), 0x3); /* in/out */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(31), 0); /* delay buffer */ + odm_set_bb_reg(p_dm, 0xCB4, BIT(26), 0); + odm_set_bb_reg(p_dm, 0xCB4, BIT(27), 1); + odm_set_bb_reg(p_dm, 0xCB0, 0xF000000, 8); /* DPDT_P = ANTSEL[0] */ + odm_set_bb_reg(p_dm, 0xCB0, 0xF0000000, 8); /* DPDT_N = ANTSEL[0] */ + /* 3 ------------------------- */ + + /* Mapping Table */ + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE0, 0); + odm_set_bb_reg(p_dm, 0xCA4, MASKBYTE1, 1); + + /* OFDM HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF, 0xA0); /* thershold */ + odm_set_bb_reg(p_dm, 0x8D4, 0x7FF000, 0x0); /* bias */ + odm_set_bb_reg(p_dm, 0x8CC, BIT(20) | BIT(19) | BIT(18), 3); /* settling time of antdiv by RF LNA = 100ns */ + + /* CCK HW AntDiv Parameters */ + odm_set_bb_reg(p_dm, 0xA74, BIT(7), 1); /* patch for clk from 88M to 80M */ + odm_set_bb_reg(p_dm, 0xA0C, BIT(4), 1); /* do 64 samples */ + + /* 2 [--For HW Bug setting] */ + + odm_set_bb_reg(p_dm, 0x900, BIT(18), 0); /* TX ant by Reg */ /* A-cut bug */ + +} + +#endif /* #if (RTL8812A_SUPPORT == 1) */ + +#if (RTL8188F_SUPPORT == 1) +void +odm_s0s1_sw_ant_div_init_8188f( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8188F AntDiv_Init => ant_div_type=[ S0S1_SW_AntDiv]\n")); + + + /*GPIO setting*/ + /*odm_set_mac_reg(p_dm, 0x64, BIT(18), 0); */ + /*odm_set_mac_reg(p_dm, 0x44, BIT(28)|BIT(27), 0);*/ + /*odm_set_mac_reg(p_dm, 0x44, BIT(20) | BIT(19), 0x3);*/ /*enable_output for P_GPIO[4:3]*/ + /*odm_set_mac_reg(p_dm, 0x44, BIT(12)|BIT(11), 0);*/ /*output value*/ + /*odm_set_mac_reg(p_dm, 0x40, BIT(1)|BIT(0), 0);*/ /*GPIO function*/ + + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (p_dm->support_interface == ODM_ITRF_USB) + odm_set_mac_reg(p_dm, 0x44, BIT(20) | BIT(19), 0x3); /*enable_output for P_GPIO[4:3]*/ + else if (p_dm->support_interface == ODM_ITRF_SDIO) + odm_set_mac_reg(p_dm, 0x44, BIT(18), 0x1); /*enable_output for P_GPIO[2]*/ + } + + p_dm_fat_table->is_become_linked = false; + p_dm_swat_table->try_flag = SWAW_STEP_INIT; + p_dm_swat_table->double_chk_flag = 0; +} + +void +phydm_update_rx_idle_antenna_8188F( + void *p_dm_void, + u32 default_ant +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 codeword; + + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (p_dm->support_interface == ODM_ITRF_USB) { + if (default_ant == ANT1_2G) + codeword = 1; /*2'b01*/ + else + codeword = 2;/*2'b10*/ + odm_set_mac_reg(p_dm, 0x44, (BIT(12) | BIT(11)), codeword); /*GPIO[4:3] output value*/ + } else if (p_dm->support_interface == ODM_ITRF_SDIO) { + if (default_ant == ANT1_2G) { + codeword = 0; /*1'b0*/ + odm_set_bb_reg(p_dm, 0x870, BIT(9)|BIT(8), 0x3); + odm_set_bb_reg(p_dm, 0x860, BIT(9)|BIT(8), 0x1); + } else { + codeword = 1;/*1'b1*/ + odm_set_bb_reg(p_dm, 0x870, BIT(9)|BIT(8), 0x3); + odm_set_bb_reg(p_dm, 0x860, BIT(9)|BIT(8), 0x2); + } + odm_set_mac_reg(p_dm, 0x44, BIT(10), codeword); /*GPIO[2] output value*/ + } + } +} +#endif + + + +#ifdef ODM_EVM_ENHANCE_ANTDIV +void +phydm_evm_sw_antdiv_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + /*EVM enhance AntDiv method init----------------------------------------------------------------------*/ + p_dm_fat_table->EVM_method_enable = 0; + p_dm_fat_table->fat_state = NORMAL_STATE_MIAN; + p_dm_fat_table->fat_state_cnt = 0; + p_dm_fat_table->pre_antdiv_rssi = 0; + + p_dm->antdiv_intvl = 30; + p_dm->antdiv_train_num = 2; + odm_set_bb_reg(p_dm, 0x910, 0x3f, 0xf); + p_dm->antdiv_evm_en = 1; + /*p_dm->antdiv_period=1;*/ + p_dm->evm_antdiv_period = 3; + p_dm->stop_antdiv_rssi_th = 3; + p_dm->stop_antdiv_tp_th = 80; + p_dm->antdiv_tp_period = 3; + p_dm->stop_antdiv_tp_diff_th = 5; +} + +void +odm_evm_fast_ant_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + p_dm_fat_table->EVM_method_enable = 0; + odm_ant_div_on_off(p_dm, ANTDIV_ON); + p_dm_fat_table->fat_state = NORMAL_STATE_MIAN; + p_dm_fat_table->fat_state_cnt = 0; + p_dm->antdiv_period = 0; + odm_set_mac_reg(p_dm, 0x608, BIT(8), 0); +} + + +void +odm_evm_enhance_ant_div( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 main_rssi, aux_rssi ; + u32 main_crc_utility = 0, aux_crc_utility = 0, utility_ratio = 1; + u32 main_evm, aux_evm, diff_rssi = 0, diff_EVM = 0; + u32 main_2ss_evm[2], aux_2ss_evm[2]; + u32 main_1ss_evm, aux_1ss_evm; + u32 main_2ss_evm_sum, aux_2ss_evm_sum; + u8 score_EVM = 0, score_CRC = 0; + u8 rssi_larger_ant = 0; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u32 value32, i; + boolean main_above1 = false, aux_above1 = false; + boolean force_antenna = false; + struct cmn_sta_info *p_sta; + u32 antdiv_tp_main_avg, antdiv_tp_aux_avg; + u8 curr_rssi, rssi_diff; + u32 tp_diff; + u8 tp_diff_return = 0, tp_return = 0, rssi_return = 0; + u8 target_ant_evm_1ss, target_ant_evm_2ss; + u8 decision_evm_ss; + u8 next_ant; + + p_dm_fat_table->target_ant_enhance = 0xFF; + + if ((p_dm->support_ic_type & ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC)) { + if (p_dm->is_one_entry_only) { + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("[One Client only]\n")); */ + i = p_dm->one_entry_macid; + p_sta = p_dm->p_phydm_sta_info[i]; + + main_rssi = (p_dm_fat_table->main_ant_cnt[i] != 0) ? (p_dm_fat_table->main_ant_sum[i] / p_dm_fat_table->main_ant_cnt[i]) : 0; + aux_rssi = (p_dm_fat_table->aux_ant_cnt[i] != 0) ? (p_dm_fat_table->aux_ant_sum[i] / p_dm_fat_table->aux_ant_cnt[i]) : 0; + + if ((main_rssi == 0 && aux_rssi != 0 && aux_rssi >= FORCE_RSSI_DIFF) || (main_rssi != 0 && aux_rssi == 0 && main_rssi >= FORCE_RSSI_DIFF)) + diff_rssi = FORCE_RSSI_DIFF; + else if (main_rssi != 0 && aux_rssi != 0) + diff_rssi = (main_rssi >= aux_rssi) ? (main_rssi - aux_rssi) : (aux_rssi - main_rssi); + + if (main_rssi >= aux_rssi) + rssi_larger_ant = MAIN_ANT; + else + rssi_larger_ant = AUX_ANT; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Main_Cnt=(( %d )), main_rssi=(( %d ))\n", p_dm_fat_table->main_ant_cnt[i], main_rssi)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Aux_Cnt=(( %d )), aux_rssi=(( %d ))\n", p_dm_fat_table->aux_ant_cnt[i], aux_rssi)); + + if (((main_rssi >= evm_rssi_th_high || aux_rssi >= evm_rssi_th_high) || (p_dm_fat_table->EVM_method_enable == 1)) + /* && (diff_rssi <= FORCE_RSSI_DIFF + 1) */ + ) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("> TH_H || EVM_method_enable==1\n")); + + if (((main_rssi >= evm_rssi_th_low) || (aux_rssi >= evm_rssi_th_low))) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("> TH_L, fat_state_cnt =((%d))\n", p_dm_fat_table->fat_state_cnt)); + + /*Traning state: 0(alt) 1(ori) 2(alt) 3(ori)============================================================*/ + if (p_dm_fat_table->fat_state_cnt < ((p_dm->antdiv_train_num)<<1)) { + + if (p_dm_fat_table->fat_state_cnt == 0) { + /*Reset EVM 1SS Method */ + p_dm_fat_table->main_ant_evm_sum[i] = 0; + p_dm_fat_table->aux_ant_evm_sum[i] = 0; + p_dm_fat_table->main_ant_evm_cnt[i] = 0; + p_dm_fat_table->aux_ant_evm_cnt[i] = 0; + /*Reset EVM 2SS Method */ + p_dm_fat_table->main_ant_evm_2ss_sum[i][0] = 0; + p_dm_fat_table->main_ant_evm_2ss_sum[i][1] = 0; + p_dm_fat_table->aux_ant_evm_2ss_sum[i][0] = 0; + p_dm_fat_table->aux_ant_evm_2ss_sum[i][1] = 0; + p_dm_fat_table->main_ant_evm_2ss_cnt[i] = 0; + p_dm_fat_table->aux_ant_evm_2ss_cnt[i] = 0; + #if 0 + /*Reset TP Method */ + p_dm_fat_table->antdiv_tp_main = 0; + p_dm_fat_table->antdiv_tp_aux = 0; + p_dm_fat_table->antdiv_tp_main_cnt = 0; + p_dm_fat_table->antdiv_tp_aux_cnt = 0; + #endif + /*Reset CRC Method */ + p_dm_fat_table->main_crc32_ok_cnt = 0; + p_dm_fat_table->main_crc32_fail_cnt = 0; + p_dm_fat_table->aux_crc32_ok_cnt = 0; + p_dm_fat_table->aux_crc32_fail_cnt = 0; + + #ifdef SKIP_EVM_ANTDIV_TRAINING_PATCH + if ((*p_dm->p_band_width == CHANNEL_WIDTH_20) && (p_sta->mimo_type == RF_2T2R)) { + /*1. Skip training: RSSI*/ + /*PHYDM_DBG(pDM_Odm,DBG_ANT_DIV, ("TargetAnt_enhance=((%d)), RxIdleAnt=((%d))\n", pDM_FatTable->TargetAnt_enhance, pDM_FatTable->RxIdleAnt));*/ + curr_rssi = (u8)((p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? main_rssi : aux_rssi); + rssi_diff = (curr_rssi > p_dm_fat_table->pre_antdiv_rssi) ? (curr_rssi - p_dm_fat_table->pre_antdiv_rssi) : (p_dm_fat_table->pre_antdiv_rssi - curr_rssi); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[1] rssi_return, curr_rssi=((%d)), pre_rssi=((%d))\n", curr_rssi, p_dm_fat_table->pre_antdiv_rssi)); + + p_dm_fat_table->pre_antdiv_rssi = curr_rssi; + if ((rssi_diff < (p_dm->stop_antdiv_rssi_th)) && (curr_rssi != 0)) + rssi_return = 1; + + /*2. Skip training: TP Diff*/ + tp_diff = (p_dm->rx_tp > p_dm_fat_table->pre_antdiv_tp) ? (p_dm->rx_tp - p_dm_fat_table->pre_antdiv_tp) : (p_dm_fat_table->pre_antdiv_tp - p_dm->rx_tp); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[2] tp_diff_return, curr_tp=((%d)), pre_tp=((%d))\n", p_dm->rx_tp, p_dm_fat_table->pre_antdiv_tp)); + p_dm_fat_table->pre_antdiv_tp = p_dm->rx_tp; + if ((tp_diff < (u32)(p_dm->stop_antdiv_tp_diff_th) && (p_dm->rx_tp != 0))) + tp_diff_return = 1; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[3] tp_return, curr_rx_tp=((%d))\n", p_dm->rx_tp)); + /*3. Skip training: TP*/ + if (p_dm->rx_tp >= (u32)(p_dm->stop_antdiv_tp_th)) + tp_return = 1; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[4] Return {rssi, tp_diff, tp} = {%d, %d, %d}\n", rssi_return, tp_diff_return, tp_return)); + /*4. Joint Return Decision*/ + if (tp_return) { + if (tp_diff_return || rssi_diff) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***Return EVM SW AntDiv\n")); + return; + } + } + } + #endif + + p_dm_fat_table->EVM_method_enable = 1; + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + p_dm->antdiv_period = p_dm->evm_antdiv_period; + odm_set_mac_reg(p_dm, 0x608, BIT(8), 1); /*RCR accepts CRC32-Error packets*/ + + } + + + p_dm_fat_table->fat_state_cnt++; + next_ant = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + odm_update_rx_idle_ant(p_dm, next_ant); + odm_set_timer(p_dm, &p_dm->evm_fast_ant_training_timer, p_dm->antdiv_intvl); //ms + + } + /*Decision state: 4==============================================================*/ + else { + + p_dm_fat_table->fat_state_cnt = 0; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Decisoin state ]\n")); + + /* 3 [CRC32 statistic] */ + #if 0 + if ((p_dm_fat_table->main_crc32_ok_cnt > ((p_dm_fat_table->aux_crc32_ok_cnt) << 1)) || ((diff_rssi >= 40) && (rssi_larger_ant == MAIN_ANT))) { + p_dm_fat_table->target_ant_crc32 = MAIN_ANT; + force_antenna = true; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("CRC32 Force Main\n")); + } else if ((p_dm_fat_table->aux_crc32_ok_cnt > ((p_dm_fat_table->main_crc32_ok_cnt) << 1)) || ((diff_rssi >= 40) && (rssi_larger_ant == AUX_ANT))) { + p_dm_fat_table->target_ant_crc32 = AUX_ANT; + force_antenna = true; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("CRC32 Force Aux\n")); + } else + #endif + { + if (p_dm_fat_table->main_crc32_fail_cnt <= 5) + p_dm_fat_table->main_crc32_fail_cnt = 5; + + if (p_dm_fat_table->aux_crc32_fail_cnt <= 5) + p_dm_fat_table->aux_crc32_fail_cnt = 5; + + if (p_dm_fat_table->main_crc32_ok_cnt > p_dm_fat_table->main_crc32_fail_cnt) + main_above1 = true; + + if (p_dm_fat_table->aux_crc32_ok_cnt > p_dm_fat_table->aux_crc32_fail_cnt) + aux_above1 = true; + + if (main_above1 == true && aux_above1 == false) { + force_antenna = true; + p_dm_fat_table->target_ant_crc32 = MAIN_ANT; + } else if (main_above1 == false && aux_above1 == true) { + force_antenna = true; + p_dm_fat_table->target_ant_crc32 = AUX_ANT; + } else if (main_above1 == true && aux_above1 == true) { + main_crc_utility = ((p_dm_fat_table->main_crc32_ok_cnt) << 7) / p_dm_fat_table->main_crc32_fail_cnt; + aux_crc_utility = ((p_dm_fat_table->aux_crc32_ok_cnt) << 7) / p_dm_fat_table->aux_crc32_fail_cnt; + p_dm_fat_table->target_ant_crc32 = (main_crc_utility == aux_crc_utility) ? (p_dm_fat_table->pre_target_ant_enhance) : ((main_crc_utility >= aux_crc_utility) ? MAIN_ANT : AUX_ANT); + + if (main_crc_utility != 0 && aux_crc_utility != 0) { + if (main_crc_utility >= aux_crc_utility) + utility_ratio = (main_crc_utility << 1) / aux_crc_utility; + else + utility_ratio = (aux_crc_utility << 1) / main_crc_utility; + } + } else if (main_above1 == false && aux_above1 == false) { + if (p_dm_fat_table->main_crc32_ok_cnt == 0) + p_dm_fat_table->main_crc32_ok_cnt = 1; + if (p_dm_fat_table->aux_crc32_ok_cnt == 0) + p_dm_fat_table->aux_crc32_ok_cnt = 1; + + main_crc_utility = ((p_dm_fat_table->main_crc32_fail_cnt) << 7) / p_dm_fat_table->main_crc32_ok_cnt; + aux_crc_utility = ((p_dm_fat_table->aux_crc32_fail_cnt) << 7) / p_dm_fat_table->aux_crc32_ok_cnt; + p_dm_fat_table->target_ant_crc32 = (main_crc_utility == aux_crc_utility) ? (p_dm_fat_table->pre_target_ant_enhance) : ((main_crc_utility <= aux_crc_utility) ? MAIN_ANT : AUX_ANT); + + if (main_crc_utility != 0 && aux_crc_utility != 0) { + if (main_crc_utility >= aux_crc_utility) + utility_ratio = (main_crc_utility << 1) / (aux_crc_utility); + else + utility_ratio = (aux_crc_utility << 1) / (main_crc_utility); + } + } + } + odm_set_mac_reg(p_dm, 0x608, BIT(8), 0);/* NOT Accept CRC32 Error packets. */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("MAIN_CRC: Ok=((%d)), Fail = ((%d)), Utility = ((%d))\n", p_dm_fat_table->main_crc32_ok_cnt, p_dm_fat_table->main_crc32_fail_cnt, main_crc_utility)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("AUX__CRC: Ok=((%d)), Fail = ((%d)), Utility = ((%d))\n", p_dm_fat_table->aux_crc32_ok_cnt, p_dm_fat_table->aux_crc32_fail_cnt, aux_crc_utility)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***1.TargetAnt_CRC32 = ((%s))\n", (p_dm_fat_table->target_ant_crc32 == MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); + + /* 3 [EVM statistic] */ + /*1SS EVM*/ + main_1ss_evm = (p_dm_fat_table->main_ant_evm_cnt[i] != 0) ? (p_dm_fat_table->main_ant_evm_sum[i] / p_dm_fat_table->main_ant_evm_cnt[i]) : 0; + aux_1ss_evm = (p_dm_fat_table->aux_ant_evm_cnt[i] != 0) ? (p_dm_fat_table->aux_ant_evm_sum[i] / p_dm_fat_table->aux_ant_evm_cnt[i]) : 0; + target_ant_evm_1ss = (main_1ss_evm == aux_1ss_evm) ? (p_dm_fat_table->pre_target_ant_enhance) : ((main_1ss_evm >= aux_1ss_evm) ? MAIN_ANT : AUX_ANT); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Cnt = ((%d)), Main1ss_EVM= (( %d ))\n", p_dm_fat_table->main_ant_evm_cnt[i], main_1ss_evm)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Cnt = ((%d)), Aux_1ss_EVM = (( %d ))\n", p_dm_fat_table->main_ant_evm_cnt[i], aux_1ss_evm)); + + /*2SS EVM*/ + main_2ss_evm[0] = (p_dm_fat_table->main_ant_evm_2ss_cnt[i] != 0) ? (p_dm_fat_table->main_ant_evm_2ss_sum[i][0] / p_dm_fat_table->main_ant_evm_2ss_cnt[i]) : 0; + main_2ss_evm[1] = (p_dm_fat_table->main_ant_evm_2ss_cnt[i] != 0) ? (p_dm_fat_table->main_ant_evm_2ss_sum[i][1] / p_dm_fat_table->main_ant_evm_2ss_cnt[i]) : 0; + main_2ss_evm_sum = main_2ss_evm[0] + main_2ss_evm[1]; + + aux_2ss_evm[0] = (p_dm_fat_table->aux_ant_evm_2ss_cnt[i] != 0) ? (p_dm_fat_table->aux_ant_evm_2ss_sum[i][0] / p_dm_fat_table->aux_ant_evm_2ss_cnt[i]) : 0; + aux_2ss_evm[1] = (p_dm_fat_table->aux_ant_evm_2ss_cnt[i] != 0) ? (p_dm_fat_table->aux_ant_evm_2ss_sum[i][1] / p_dm_fat_table->aux_ant_evm_2ss_cnt[i]) : 0; + aux_2ss_evm_sum = aux_2ss_evm[0] + aux_2ss_evm[1]; + + target_ant_evm_2ss = (main_2ss_evm_sum == aux_2ss_evm_sum) ? (p_dm_fat_table->pre_target_ant_enhance) : ((main_2ss_evm_sum >= aux_2ss_evm_sum) ? MAIN_ANT : AUX_ANT); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Cnt = ((%d)), Main2ss_EVM{A,B,Sum} = {%d, %d, %d}\n", + p_dm_fat_table->main_ant_evm_2ss_cnt[i], main_2ss_evm[0], main_2ss_evm[1], main_2ss_evm_sum)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Cnt = ((%d)), Aux_2ss_EVM{A,B,Sum} = {%d, %d, %d}\n", + p_dm_fat_table->aux_ant_evm_2ss_cnt[i], aux_2ss_evm[0], aux_2ss_evm[1], aux_2ss_evm_sum)); + + if ((main_2ss_evm_sum + aux_2ss_evm_sum) != 0) { + decision_evm_ss = 2; + main_evm = main_2ss_evm_sum; + aux_evm = aux_2ss_evm_sum; + p_dm_fat_table->target_ant_evm = target_ant_evm_2ss; + } else { + decision_evm_ss = 1; + main_evm = main_1ss_evm; + aux_evm = aux_1ss_evm; + p_dm_fat_table->target_ant_evm = target_ant_evm_1ss; + } + + if ((main_evm == 0 || aux_evm == 0)) + diff_EVM = 100; + else if (main_evm >= aux_evm) + diff_EVM = main_evm - aux_evm; + else + diff_EVM = aux_evm - main_evm; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***2.TargetAnt_EVM((%d-ss)) = ((%s))\n", decision_evm_ss, (p_dm_fat_table->target_ant_evm == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + + + //3 [TP statistic] + antdiv_tp_main_avg = (p_dm_fat_table->antdiv_tp_main_cnt != 0) ? (p_dm_fat_table->antdiv_tp_main / p_dm_fat_table->antdiv_tp_main_cnt) : 0; + antdiv_tp_aux_avg = (p_dm_fat_table->antdiv_tp_aux_cnt != 0) ? (p_dm_fat_table->antdiv_tp_aux / p_dm_fat_table->antdiv_tp_aux_cnt) : 0; + p_dm_fat_table->target_ant_tp = (antdiv_tp_main_avg == antdiv_tp_aux_avg) ? (p_dm_fat_table->pre_target_ant_enhance) : ((antdiv_tp_main_avg >= antdiv_tp_aux_avg) ? MAIN_ANT : AUX_ANT); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Cnt = ((%d)), Main_TP = ((%d))\n", p_dm_fat_table->antdiv_tp_main_cnt, antdiv_tp_main_avg)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Cnt = ((%d)), Aux_TP = ((%d))\n", p_dm_fat_table->antdiv_tp_aux_cnt, antdiv_tp_aux_avg)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***3.TargetAnt_TP = ((%s))\n", (p_dm_fat_table->target_ant_tp == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + + /*Reset TP Method */ + p_dm_fat_table->antdiv_tp_main = 0; + p_dm_fat_table->antdiv_tp_aux = 0; + p_dm_fat_table->antdiv_tp_main_cnt = 0; + p_dm_fat_table->antdiv_tp_aux_cnt = 0; + + /* 2 [ Decision state ] */ + if (p_dm_fat_table->target_ant_evm == p_dm_fat_table->target_ant_crc32) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Decision type 1, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); + + if ((utility_ratio < 2 && force_antenna == false) && diff_EVM <= 30) + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->pre_target_ant_enhance; + else + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_evm; + } + #if 0 + else if ((diff_EVM <= 50 && (utility_ratio > 4 && force_antenna == false)) || (force_antenna == true)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Decision type 2, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_crc32; + } + #endif + else if (diff_EVM >= 20) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Decision type 3, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_evm; + } else if (utility_ratio >= 6 && force_antenna == false) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Decision type 4, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_crc32; + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Decision type 5, CRC_utility = ((%d)), EVM_diff = ((%d))\n", utility_ratio, diff_EVM)); + + if (force_antenna == true) + score_CRC = 2; + else if (utility_ratio >= 5) /*>2.5*/ + score_CRC = 2; + else if (utility_ratio >= 4) /*>2*/ + score_CRC = 1; + else + score_CRC = 0; + + if (diff_EVM >= 15) + score_EVM = 3; + else if (diff_EVM >= 10) + score_EVM = 2; + else if (diff_EVM >= 5) + score_EVM = 1; + else + score_EVM = 0; + + if (score_CRC > score_EVM) + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_crc32; + else if (score_CRC < score_EVM) + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->target_ant_evm; + else + p_dm_fat_table->target_ant_enhance = p_dm_fat_table->pre_target_ant_enhance; + } + p_dm_fat_table->pre_target_ant_enhance = p_dm_fat_table->target_ant_enhance; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** 4.TargetAnt_enhance = (( %s ))******\n", (p_dm_fat_table->target_ant_enhance == MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); + + + } + } else { /* RSSI< = evm_rssi_th_low */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ TH_L ]\n")); + odm_evm_fast_ant_reset(p_dm); + } + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[escape from> TH_H || EVM_method_enable==1]\n")); + odm_evm_fast_ant_reset(p_dm); + } + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[multi-Client]\n")); + odm_evm_fast_ant_reset(p_dm); + } + } +} + +void +odm_evm_fast_ant_training_callback( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("******AntDiv_Callback******\n")); + odm_hw_ant_div(p_dm); +} +#endif + +void +odm_hw_ant_div( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 i, min_max_rssi = 0xFF, ant_div_max_rssi = 0, max_rssi = 0, local_max_rssi; + u32 main_rssi, aux_rssi, mian_cnt, aux_cnt; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u8 rx_idle_ant = p_dm_fat_table->rx_idle_ant, target_ant = 7; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct cmn_sta_info *p_sta; + +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm->dm_bdc_table; + u32 TH1 = 500000; + u32 TH2 = 10000000; + u32 ma_rx_temp, degrade_TP_temp, improve_TP_temp; + u8 monitor_rssi_threshold = 30; + + p_dm_bdc_table->BF_pass = true; + p_dm_bdc_table->DIV_pass = true; + p_dm_bdc_table->is_all_div_sta_idle = true; + p_dm_bdc_table->is_all_bf_sta_idle = true; + p_dm_bdc_table->num_bf_tar = 0 ; + p_dm_bdc_table->num_div_tar = 0; + p_dm_bdc_table->num_client = 0; +#endif +#endif + + if (!p_dm->is_linked) { /* is_linked==False */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[No Link!!!]\n")); + + if (p_dm_fat_table->is_become_linked == true) { + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + odm_update_rx_idle_ant(p_dm, MAIN_ANT); + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + p_dm->antdiv_period = 0; + + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + return; + } else { + if (p_dm_fat_table->is_become_linked == false) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Linked !!!]\n")); + odm_ant_div_on_off(p_dm, ANTDIV_ON); + /*odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_DESC);*/ + + /* if(p_dm->support_ic_type == ODM_RTL8821 ) */ + /* odm_set_bb_reg(p_dm, 0x800, BIT(25), 0); */ /* CCK AntDiv function disable */ + + /* #if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ + /* else if(p_dm->support_ic_type == ODM_RTL8881A) */ + /* odm_set_bb_reg(p_dm, 0x800, BIT(25), 0); */ /* CCK AntDiv function disable */ + /* #endif */ + + /* else if(p_dm->support_ic_type == ODM_RTL8723B ||p_dm->support_ic_type == ODM_RTL8812) */ + /* odm_set_bb_reg(p_dm, 0xA00, BIT(15), 0); */ /* CCK AntDiv function disable */ + + p_dm_fat_table->is_become_linked = p_dm->is_linked; + + if (p_dm->support_ic_type == ODM_RTL8723B && p_dm->ant_div_type == CG_TRX_HW_ANTDIV) { + odm_set_bb_reg(p_dm, 0x930, 0xF0, 8); /* DPDT_P = ANTSEL[0] */ /* for 8723B AntDiv function patch. BB Dino 130412 */ + odm_set_bb_reg(p_dm, 0x930, 0xF, 8); /* DPDT_N = ANTSEL[0] */ + } + + /* 2 BDC Init */ +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + odm_bdc_init(p_dm); +#endif +#endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV + odm_evm_fast_ant_reset(p_dm); +#endif + } + } + + if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { + if (p_dm->is_one_entry_only == true) + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + else + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_DESC); + } + +#ifdef ODM_EVM_ENHANCE_ANTDIV + if (p_dm->antdiv_evm_en == 1) { + odm_evm_enhance_ant_div(p_dm); + if (p_dm_fat_table->fat_state_cnt != 0) + return; + } else + odm_evm_fast_ant_reset(p_dm); +#endif + + /* 2 BDC mode Arbitration */ +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (p_dm->antdiv_evm_en == 0 || p_dm_fat_table->EVM_method_enable == 0) + odm_bf_ant_div_mode_arbitration(p_dm); +#endif +#endif + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + p_sta = p_dm->p_phydm_sta_info[i]; + if (is_sta_active(p_sta)) { + /* 2 Caculate RSSI per Antenna */ + if ((p_dm_fat_table->main_ant_cnt[i] != 0) || (p_dm_fat_table->aux_ant_cnt[i] != 0)) { + mian_cnt = p_dm_fat_table->main_ant_cnt[i]; + aux_cnt = p_dm_fat_table->aux_ant_cnt[i]; + main_rssi = (mian_cnt != 0) ? (p_dm_fat_table->main_ant_sum[i] / mian_cnt) : 0; + aux_rssi = (aux_cnt != 0) ? (p_dm_fat_table->aux_ant_sum[i] / aux_cnt) : 0; + target_ant = (mian_cnt == aux_cnt) ? p_dm_fat_table->rx_idle_ant : ((mian_cnt >= aux_cnt) ? MAIN_ANT : AUX_ANT); /*Use counter number for OFDM*/ + + } else { /*CCK only case*/ + mian_cnt = p_dm_fat_table->main_ant_cnt_cck[i]; + aux_cnt = p_dm_fat_table->aux_ant_cnt_cck[i]; + main_rssi = (mian_cnt != 0) ? (p_dm_fat_table->main_ant_sum_cck[i] / mian_cnt) : 0; + aux_rssi = (aux_cnt != 0) ? (p_dm_fat_table->aux_ant_sum_cck[i] / aux_cnt) : 0; + target_ant = (main_rssi == aux_rssi) ? p_dm_fat_table->rx_idle_ant : ((main_rssi >= aux_rssi) ? MAIN_ANT : AUX_ANT); /*Use RSSI for CCK only case*/ + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Client[ %d ] : Main_Cnt = (( %d )) , CCK_Main_Cnt = (( %d )) , main_rssi= (( %d ))\n", i, p_dm_fat_table->main_ant_cnt[i], p_dm_fat_table->main_ant_cnt_cck[i], main_rssi)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Client[ %d ] : Aux_Cnt = (( %d )) , CCK_Aux_Cnt = (( %d )) , aux_rssi = (( %d ))\n", i, p_dm_fat_table->aux_ant_cnt[i], p_dm_fat_table->aux_ant_cnt_cck[i], aux_rssi)); + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("*** MAC ID:[ %d ] , target_ant = (( %s ))\n", i ,( target_ant ==MAIN_ANT)?"MAIN_ANT":"AUX_ANT")); */ + + local_max_rssi = (main_rssi > aux_rssi) ? main_rssi : aux_rssi; + /* 2 Select max_rssi for DIG */ + if ((local_max_rssi > ant_div_max_rssi) && (local_max_rssi < 40)) + ant_div_max_rssi = local_max_rssi; + if (local_max_rssi > max_rssi) + max_rssi = local_max_rssi; + + /* 2 Select RX Idle Antenna */ + if ((local_max_rssi != 0) && (local_max_rssi < min_max_rssi)) { + rx_idle_ant = target_ant; + min_max_rssi = local_max_rssi; + } + +#ifdef ODM_EVM_ENHANCE_ANTDIV + if (p_dm->antdiv_evm_en == 1) { + if (p_dm_fat_table->target_ant_enhance != 0xFF) { + target_ant = p_dm_fat_table->target_ant_enhance; + rx_idle_ant = p_dm_fat_table->target_ant_enhance; + } + } +#endif + + /* 2 Select TX Antenna */ + if (p_dm->ant_div_type != CGCS_RX_HW_ANTDIV) { +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (p_dm_bdc_table->w_bfee_client[i] == 0) +#endif +#endif + { + odm_update_tx_ant(p_dm, target_ant, i); + } + } + + /* ------------------------------------------------------------ */ + +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + + p_dm_bdc_table->num_client++; + + if (p_dm_bdc_table->bdc_mode == BDC_MODE_2 || p_dm_bdc_table->bdc_mode == BDC_MODE_3) { + /* 2 Byte counter */ + + ma_rx_temp = p_sta->rx_moving_average_tp; /* RX TP ( bit /sec) */ + + if (p_dm_bdc_table->BDC_state == bdc_bfer_train_state) + p_dm_bdc_table->MA_rx_TP_DIV[i] = ma_rx_temp ; + else + p_dm_bdc_table->MA_rx_TP[i] = ma_rx_temp ; + + if ((ma_rx_temp < TH2) && (ma_rx_temp > TH1) && (local_max_rssi <= monitor_rssi_threshold)) { + if (p_dm_bdc_table->w_bfer_client[i] == 1) { /* Bfer_Target */ + p_dm_bdc_table->num_bf_tar++; + + if (p_dm_bdc_table->BDC_state == BDC_DECISION_STATE && p_dm_bdc_table->bdc_try_flag == 0) { + improve_TP_temp = (p_dm_bdc_table->MA_rx_TP_DIV[i] * 9) >> 3 ; /* * 1.125 */ + p_dm_bdc_table->BF_pass = (p_dm_bdc_table->MA_rx_TP[i] > improve_TP_temp) ? true : false; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Client[ %d ] : { MA_rx_TP,improve_TP_temp, MA_rx_TP_DIV, BF_pass}={ %d, %d, %d , %d }\n", i, p_dm_bdc_table->MA_rx_TP[i], improve_TP_temp, p_dm_bdc_table->MA_rx_TP_DIV[i], p_dm_bdc_table->BF_pass)); + } + } else { /* DIV_Target */ + p_dm_bdc_table->num_div_tar++; + + if (p_dm_bdc_table->BDC_state == BDC_DECISION_STATE && p_dm_bdc_table->bdc_try_flag == 0) { + degrade_TP_temp = (p_dm_bdc_table->MA_rx_TP_DIV[i] * 5) >> 3; /* * 0.625 */ + p_dm_bdc_table->DIV_pass = (p_dm_bdc_table->MA_rx_TP[i] > degrade_TP_temp) ? true : false; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Client[ %d ] : { MA_rx_TP, degrade_TP_temp, MA_rx_TP_DIV, DIV_pass}=\n{ %d, %d, %d , %d }\n", i, p_dm_bdc_table->MA_rx_TP[i], degrade_TP_temp, p_dm_bdc_table->MA_rx_TP_DIV[i], p_dm_bdc_table->DIV_pass)); + } + } + } + + if (ma_rx_temp > TH1) { + if (p_dm_bdc_table->w_bfer_client[i] == 1) /* Bfer_Target */ + p_dm_bdc_table->is_all_bf_sta_idle = false; + else/* DIV_Target */ + p_dm_bdc_table->is_all_div_sta_idle = false; + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Client[ %d ] : { BFmeeCap, BFmerCap} = { %d , %d }\n", i, p_dm_bdc_table->w_bfee_client[i], p_dm_bdc_table->w_bfer_client[i])); + + if (p_dm_bdc_table->BDC_state == bdc_bfer_train_state) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Client[ %d ] : MA_rx_TP_DIV = (( %d ))\n", i, p_dm_bdc_table->MA_rx_TP_DIV[i])); + + else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Client[ %d ] : MA_rx_TP = (( %d ))\n", i, p_dm_bdc_table->MA_rx_TP[i])); + + } +#endif +#endif + + } + +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (p_dm_bdc_table->bdc_try_flag == 0) +#endif +#endif + { + phydm_antdiv_reset_statistic(p_dm, i); + } + } + + + + /* 2 Set RX Idle Antenna & TX Antenna(Because of HW Bug ) */ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** rx_idle_ant = (( %s ))\n", (rx_idle_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (p_dm_bdc_table->bdc_mode == BDC_MODE_1 || p_dm_bdc_table->bdc_mode == BDC_MODE_3) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** bdc_rx_idle_update_counter = (( %d ))\n", p_dm_bdc_table->bdc_rx_idle_update_counter)); + + if (p_dm_bdc_table->bdc_rx_idle_update_counter == 1) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***Update RxIdle Antenna!!!\n")); + p_dm_bdc_table->bdc_rx_idle_update_counter = 30; + odm_update_rx_idle_ant(p_dm, rx_idle_ant); + } else { + p_dm_bdc_table->bdc_rx_idle_update_counter--; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***NOT update RxIdle Antenna because of BF ( need to fix TX-ant)\n")); + } + } else +#endif +#endif + odm_update_rx_idle_ant(p_dm, rx_idle_ant); +#else + + odm_update_rx_idle_ant(p_dm, rx_idle_ant); + +#endif/* #if(DM_ODM_SUPPORT_TYPE == ODM_AP) */ + + + + /* 2 BDC Main Algorithm */ +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (p_dm->antdiv_evm_en == 0 || p_dm_fat_table->EVM_method_enable == 0) + odm_bd_ccoex_bfee_rx_div_arbitration(p_dm); +#endif +#endif + + if (ant_div_max_rssi == 0) + p_dig_t->ant_div_rssi_max = p_dm->rssi_min; + else + p_dig_t->ant_div_rssi_max = ant_div_max_rssi; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***AntDiv End***\n\n")); +} + + + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + +void +odm_s0s1_sw_ant_div_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + p_dm_fat_table->is_become_linked = false; + p_dm_swat_table->try_flag = SWAW_STEP_INIT; + p_dm_swat_table->double_chk_flag = 0; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_s0s1_sw_ant_div_reset(): p_dm_fat_table->is_become_linked = %d\n", p_dm_fat_table->is_become_linked)); +} + +void +odm_s0s1_sw_ant_div( + void *p_dm_void, + u8 step +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u32 i, min_max_rssi = 0xFF, local_max_rssi, local_min_rssi; + u32 main_rssi, aux_rssi; + u8 high_traffic_train_time_u = 0x32, high_traffic_train_time_l = 0, train_time_temp; + u8 low_traffic_train_time_u = 200, low_traffic_train_time_l = 0; + u8 rx_idle_ant = p_dm_swat_table->pre_antenna, target_ant, next_ant = 0; + struct cmn_sta_info *p_entry = NULL; + u32 value32; + u32 main_ant_sum = 0; + u32 aux_ant_sum = 0; + u32 main_ant_cnt = 0; + u32 aux_ant_cnt = 0; + + + if (!p_dm->is_linked) { /* is_linked==False */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[No Link!!!]\n")); + if (p_dm_fat_table->is_become_linked == true) { + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + if (p_dm->support_ic_type == ODM_RTL8723B) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Set REG 948[9:6]=0x0\n")); + odm_set_bb_reg(p_dm, 0x948, (BIT(9) | BIT(8) | BIT(7) | BIT(6)), 0x0); + } + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + return; + } else { + if (p_dm_fat_table->is_become_linked == false) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Linked !!!]\n")); + + if (p_dm->support_ic_type == ODM_RTL8723B) { + value32 = odm_get_bb_reg(p_dm, 0x864, BIT(5) | BIT(4) | BIT(3)); + +#if (RTL8723B_SUPPORT == 1) + if (value32 == 0x0) + odm_update_rx_idle_ant_8723b(p_dm, MAIN_ANT, ANT1_2G, ANT2_2G); + else if (value32 == 0x1) + odm_update_rx_idle_ant_8723b(p_dm, AUX_ANT, ANT2_2G, ANT1_2G); +#endif + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("8723B: First link! Force antenna to %s\n", (value32 == 0x0 ? "MAIN" : "AUX"))); + } + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + } + + if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { + if (p_dm->is_one_entry_only == true) + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + else + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_DESC); + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[%d] { try_flag=(( %d )), step=(( %d )), double_chk_flag = (( %d )) }\n", + __LINE__, p_dm_swat_table->try_flag, step, p_dm_swat_table->double_chk_flag)); + + /* Handling step mismatch condition. */ + /* Peak step is not finished at last time. Recover the variable and check again. */ + if (step != p_dm_swat_table->try_flag) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[step != try_flag] Need to Reset After Link\n")); + odm_sw_ant_div_rest_after_link(p_dm); + } + + if (p_dm_swat_table->try_flag == SWAW_STEP_INIT) { + + p_dm_swat_table->try_flag = SWAW_STEP_PEEK; + p_dm_swat_table->train_time_flag = 0; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[set try_flag = 0] Prepare for peek!\n\n")); + return; + + } else { + + /* 1 Normal state (Begin Trying) */ + if (p_dm_swat_table->try_flag == SWAW_STEP_PEEK) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("TxOkCnt=(( %llu )), RxOkCnt=(( %llu )), traffic_load = (%d))\n", p_dm->cur_tx_ok_cnt, p_dm->cur_rx_ok_cnt, p_dm->traffic_load)); + + if (p_dm->traffic_load == TRAFFIC_HIGH) { + train_time_temp = p_dm_swat_table->train_time ; + + if (p_dm_swat_table->train_time_flag == 3) { + high_traffic_train_time_l = 0xa; + + if (train_time_temp <= 16) + train_time_temp = high_traffic_train_time_l; + else + train_time_temp -= 16; + + } else if (p_dm_swat_table->train_time_flag == 2) { + train_time_temp -= 8; + high_traffic_train_time_l = 0xf; + } else if (p_dm_swat_table->train_time_flag == 1) { + train_time_temp -= 4; + high_traffic_train_time_l = 0x1e; + } else if (p_dm_swat_table->train_time_flag == 0) { + train_time_temp += 8; + high_traffic_train_time_l = 0x28; + } + + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (p_dm->support_interface == ODM_ITRF_SDIO) + high_traffic_train_time_l += 0xa; + } + + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("*** train_time_temp = ((%d))\n",train_time_temp)); */ + + /* -- */ + if (train_time_temp > high_traffic_train_time_u) + train_time_temp = high_traffic_train_time_u; + + else if (train_time_temp < high_traffic_train_time_l) + train_time_temp = high_traffic_train_time_l; + + p_dm_swat_table->train_time = train_time_temp; /*10ms~200ms*/ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("train_time_flag=((%d)), train_time=((%d))\n", p_dm_swat_table->train_time_flag, p_dm_swat_table->train_time)); + + } else if ((p_dm->traffic_load == TRAFFIC_MID) || (p_dm->traffic_load == TRAFFIC_LOW)) { + + train_time_temp = p_dm_swat_table->train_time ; + + if (p_dm_swat_table->train_time_flag == 3) { + low_traffic_train_time_l = 10; + if (train_time_temp < 50) + train_time_temp = low_traffic_train_time_l; + else + train_time_temp -= 50; + } else if (p_dm_swat_table->train_time_flag == 2) { + train_time_temp -= 30; + low_traffic_train_time_l = 36; + } else if (p_dm_swat_table->train_time_flag == 1) { + train_time_temp -= 10; + low_traffic_train_time_l = 40; + } else { + + train_time_temp += 10; + low_traffic_train_time_l = 50; + } + + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (p_dm->support_interface == ODM_ITRF_SDIO) + low_traffic_train_time_l += 10; + } + + /* -- */ + if (train_time_temp >= low_traffic_train_time_u) + train_time_temp = low_traffic_train_time_u; + + else if (train_time_temp <= low_traffic_train_time_l) + train_time_temp = low_traffic_train_time_l; + + p_dm_swat_table->train_time = train_time_temp; /*10ms~200ms*/ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("train_time_flag=((%d)) , train_time=((%d))\n", p_dm_swat_table->train_time_flag, p_dm_swat_table->train_time)); + + } else { + p_dm_swat_table->train_time = 0xc8; /*200ms*/ + + } + + /* ----------------- */ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Current min_max_rssi is ((%d))\n", p_dm_fat_table->min_max_rssi)); + + /* ---reset index--- */ + if (p_dm_swat_table->reset_idx >= RSSI_CHECK_RESET_PERIOD) { + + p_dm_fat_table->min_max_rssi = 0; + p_dm_swat_table->reset_idx = 0; + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reset_idx = (( %d ))\n", p_dm_swat_table->reset_idx)); + + p_dm_swat_table->reset_idx++; + + /* ---double check flag--- */ + if ((p_dm_fat_table->min_max_rssi > RSSI_CHECK_THRESHOLD) && (p_dm_swat_table->double_chk_flag == 0)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" min_max_rssi is ((%d)), and > %d\n", + p_dm_fat_table->min_max_rssi, RSSI_CHECK_THRESHOLD)); + + p_dm_swat_table->double_chk_flag = 1; + p_dm_swat_table->try_flag = SWAW_STEP_DETERMINE; + p_dm_swat_table->rssi_trying = 0; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Test the current ant for (( %d )) ms again\n", p_dm_swat_table->train_time)); + odm_update_rx_idle_ant(p_dm, p_dm_fat_table->rx_idle_ant); + odm_set_timer(p_dm, &(p_dm_swat_table->phydm_sw_antenna_switch_timer), p_dm_swat_table->train_time); /*ms*/ + return; + } + + next_ant = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + + p_dm_swat_table->try_flag = SWAW_STEP_DETERMINE; + + if (p_dm_swat_table->reset_idx <= 1) + p_dm_swat_table->rssi_trying = 2; + else + p_dm_swat_table->rssi_trying = 1; + + odm_s0s1_sw_ant_div_by_ctrl_frame(p_dm, SWAW_STEP_PEEK); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[set try_flag=1] Normal state: Begin Trying!!\n")); + + } else if ((p_dm_swat_table->try_flag == SWAW_STEP_DETERMINE) && (p_dm_swat_table->double_chk_flag == 0)) { + + next_ant = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + p_dm_swat_table->rssi_trying--; + } + + /* 1 Decision state */ + if ((p_dm_swat_table->try_flag == SWAW_STEP_DETERMINE) && (p_dm_swat_table->rssi_trying == 0)) { + + boolean is_by_ctrl_frame = false; + u64 pkt_cnt_total = 0; + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + p_entry = p_dm->p_phydm_sta_info[i]; + if (is_sta_active(p_entry)) { + /* 2 Caculate RSSI per Antenna */ + + main_ant_sum = (u32)p_dm_fat_table->main_ant_sum[i] + (u32)p_dm_fat_table->main_ant_sum_cck[i]; + aux_ant_sum = (u32)p_dm_fat_table->aux_ant_sum[i] + (u32)p_dm_fat_table->aux_ant_sum_cck[i]; + main_ant_cnt = (u32)p_dm_fat_table->main_ant_cnt[i] + (u32)p_dm_fat_table->main_ant_cnt_cck[i]; + aux_ant_cnt = (u32)p_dm_fat_table->aux_ant_cnt[i] + (u32)p_dm_fat_table->aux_ant_cnt_cck[i]; + + main_rssi = (main_ant_cnt != 0) ? (main_ant_sum / main_ant_cnt) : 0; + aux_rssi = (aux_ant_cnt != 0) ? (aux_ant_sum / aux_ant_cnt) : 0; + + if (p_dm_fat_table->main_ant_cnt[i] <= 1 && p_dm_fat_table->main_ant_cnt_cck[i] >= 1) + main_rssi = 0; + + if (p_dm_fat_table->aux_ant_cnt[i] <= 1 && p_dm_fat_table->aux_ant_cnt_cck[i] >= 1) + aux_rssi = 0; + + target_ant = (main_rssi == aux_rssi) ? p_dm_swat_table->pre_antenna : ((main_rssi >= aux_rssi) ? MAIN_ANT : AUX_ANT); + local_max_rssi = (main_rssi >= aux_rssi) ? main_rssi : aux_rssi; + local_min_rssi = (main_rssi >= aux_rssi) ? aux_rssi : main_rssi; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** CCK_counter_main = (( %d )) , CCK_counter_aux= (( %d ))\n", p_dm_fat_table->main_ant_cnt_cck[i], p_dm_fat_table->aux_ant_cnt_cck[i])); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** OFDM_counter_main = (( %d )) , OFDM_counter_aux= (( %d ))\n", p_dm_fat_table->main_ant_cnt[i], p_dm_fat_table->aux_ant_cnt[i])); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Main_Cnt = (( %d )) , main_rssi= (( %d ))\n", main_ant_cnt, main_rssi)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** Aux_Cnt = (( %d )) , aux_rssi = (( %d ))\n", aux_ant_cnt, aux_rssi)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** MAC ID:[ %d ] , target_ant = (( %s ))\n", i, (target_ant == MAIN_ANT) ? "MAIN_ANT" : "AUX_ANT")); + + /* 2 Select RX Idle Antenna */ + + if (local_max_rssi != 0 && local_max_rssi < min_max_rssi) { + rx_idle_ant = target_ant; + min_max_rssi = local_max_rssi; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** local_max_rssi-local_min_rssi = ((%d))\n", (local_max_rssi - local_min_rssi))); + + if ((local_max_rssi - local_min_rssi) > 8) { + if (local_min_rssi != 0) + p_dm_swat_table->train_time_flag = 3; + else { + if (min_max_rssi > RSSI_CHECK_THRESHOLD) + p_dm_swat_table->train_time_flag = 0; + else + p_dm_swat_table->train_time_flag = 3; + } + } else if ((local_max_rssi - local_min_rssi) > 5) + p_dm_swat_table->train_time_flag = 2; + else if ((local_max_rssi - local_min_rssi) > 2) + p_dm_swat_table->train_time_flag = 1; + else + p_dm_swat_table->train_time_flag = 0; + + } + + /* 2 Select TX Antenna */ + if (target_ant == MAIN_ANT) + p_dm_fat_table->antsel_a[i] = ANT1_2G; + else + p_dm_fat_table->antsel_a[i] = ANT2_2G; + + } + phydm_antdiv_reset_statistic(p_dm, i); + pkt_cnt_total += (main_ant_cnt + aux_ant_cnt); + } + + if (p_dm_swat_table->is_sw_ant_div_by_ctrl_frame) { + odm_s0s1_sw_ant_div_by_ctrl_frame(p_dm, SWAW_STEP_DETERMINE); + is_by_ctrl_frame = true; + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Control frame packet counter = %d, data frame packet counter = %llu\n", + p_dm_swat_table->pkt_cnt_sw_ant_div_by_ctrl_frame, pkt_cnt_total)); + + if (min_max_rssi == 0xff || ((pkt_cnt_total < (p_dm_swat_table->pkt_cnt_sw_ant_div_by_ctrl_frame >> 1)) && p_dm->phy_dbg_info.num_qry_beacon_pkt < 2)) { + min_max_rssi = 0; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Check RSSI of control frame because min_max_rssi == 0xff\n")); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("is_by_ctrl_frame = %d\n", is_by_ctrl_frame)); + + if (is_by_ctrl_frame) { + main_rssi = (p_dm_fat_table->main_ant_ctrl_frame_cnt != 0) ? (p_dm_fat_table->main_ant_ctrl_frame_sum / p_dm_fat_table->main_ant_ctrl_frame_cnt) : 0; + aux_rssi = (p_dm_fat_table->aux_ant_ctrl_frame_cnt != 0) ? (p_dm_fat_table->aux_ant_ctrl_frame_sum / p_dm_fat_table->aux_ant_ctrl_frame_cnt) : 0; + + if (p_dm_fat_table->main_ant_ctrl_frame_cnt <= 1 && p_dm_fat_table->cck_ctrl_frame_cnt_main >= 1) + main_rssi = 0; + + if (p_dm_fat_table->aux_ant_ctrl_frame_cnt <= 1 && p_dm_fat_table->cck_ctrl_frame_cnt_aux >= 1) + aux_rssi = 0; + + if (main_rssi != 0 || aux_rssi != 0) { + rx_idle_ant = (main_rssi == aux_rssi) ? p_dm_swat_table->pre_antenna : ((main_rssi >= aux_rssi) ? MAIN_ANT : AUX_ANT); + local_max_rssi = (main_rssi >= aux_rssi) ? main_rssi : aux_rssi; + local_min_rssi = (main_rssi >= aux_rssi) ? aux_rssi : main_rssi; + + if ((local_max_rssi - local_min_rssi) > 8) + p_dm_swat_table->train_time_flag = 3; + else if ((local_max_rssi - local_min_rssi) > 5) + p_dm_swat_table->train_time_flag = 2; + else if ((local_max_rssi - local_min_rssi) > 2) + p_dm_swat_table->train_time_flag = 1; + else + p_dm_swat_table->train_time_flag = 0; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Control frame: main_rssi = %d, aux_rssi = %d\n", main_rssi, aux_rssi)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("rx_idle_ant decided by control frame = %s\n", (rx_idle_ant == MAIN_ANT ? "MAIN" : "AUX"))); + } + } + } + + p_dm_fat_table->min_max_rssi = min_max_rssi; + p_dm_swat_table->try_flag = SWAW_STEP_PEEK; + + if (p_dm_swat_table->double_chk_flag == 1) { + p_dm_swat_table->double_chk_flag = 0; + + if (p_dm_fat_table->min_max_rssi > RSSI_CHECK_THRESHOLD) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" [Double check] min_max_rssi ((%d)) > %d again!!\n", + p_dm_fat_table->min_max_rssi, RSSI_CHECK_THRESHOLD)); + + odm_update_rx_idle_ant(p_dm, rx_idle_ant); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[reset try_flag = 0] Training accomplished !!!]\n\n\n")); + return; + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" [Double check] min_max_rssi ((%d)) <= %d !!\n", + p_dm_fat_table->min_max_rssi, RSSI_CHECK_THRESHOLD)); + + next_ant = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + p_dm_swat_table->try_flag = SWAW_STEP_PEEK; + p_dm_swat_table->reset_idx = RSSI_CHECK_RESET_PERIOD; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[set try_flag=0] Normal state: Need to tryg again!!\n\n\n")); + return; + } + } else { + if (p_dm_fat_table->min_max_rssi < RSSI_CHECK_THRESHOLD) + p_dm_swat_table->reset_idx = RSSI_CHECK_RESET_PERIOD; + + p_dm_swat_table->pre_antenna = rx_idle_ant; + odm_update_rx_idle_ant(p_dm, rx_idle_ant); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[reset try_flag = 0] Training accomplished !!!]\n\n\n")); + return; + } + + } + + } + + /* 1 4.Change TRX antenna */ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("rssi_trying = (( %d )), ant: (( %s )) >>> (( %s ))\n", + p_dm_swat_table->rssi_trying, (p_dm_fat_table->rx_idle_ant == MAIN_ANT ? "MAIN" : "AUX"), (next_ant == MAIN_ANT ? "MAIN" : "AUX"))); + + odm_update_rx_idle_ant(p_dm, next_ant); + + /* 1 5.Reset Statistics */ + + p_dm_fat_table->rx_idle_ant = next_ant; + + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (p_dm->support_interface == ODM_ITRF_SDIO) { + + ODM_delay_us(200); + + if (p_dm_fat_table->rx_idle_ant == MAIN_ANT) { + p_dm_fat_table->main_ant_sum[0] = 0; + p_dm_fat_table->main_ant_cnt[0] = 0; + p_dm_fat_table->main_ant_sum_cck[0] = 0; + p_dm_fat_table->main_ant_cnt_cck[0] = 0; + } else { + p_dm_fat_table->aux_ant_sum[0] = 0; + p_dm_fat_table->aux_ant_cnt[0] = 0; + p_dm_fat_table->aux_ant_sum_cck[0] = 0; + p_dm_fat_table->aux_ant_cnt_cck[0] = 0; + } + } + } + + /* 1 6.Set next timer (Trying state) */ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" Test ((%s)) ant for (( %d )) ms\n", (next_ant == MAIN_ANT ? "MAIN" : "AUX"), p_dm_swat_table->train_time)); + odm_set_timer(p_dm, &(p_dm_swat_table->phydm_sw_antenna_switch_timer), p_dm_swat_table->train_time); /*ms*/ +} + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +odm_sw_antdiv_callback( + struct timer_list *p_timer +) +{ + struct _ADAPTER *adapter = (struct _ADAPTER *)p_timer->Adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct _sw_antenna_switch_ *p_dm_swat_table = &p_hal_data->DM_OutSrc.dm_swat_table; + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE +#if USE_WORKITEM + odm_schedule_work_item(&p_dm_swat_table->phydm_sw_antenna_switch_workitem); +#else + { + /* dbg_print("SW_antdiv_Callback"); */ + odm_s0s1_sw_ant_div(&p_hal_data->DM_OutSrc, SWAW_STEP_DETERMINE); + } +#endif +#else + odm_schedule_work_item(&p_dm_swat_table->phydm_sw_antenna_switch_workitem); +#endif +} +void +odm_sw_antdiv_workitem_callback( + void *p_context +) +{ + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + + /* dbg_print("SW_antdiv_Workitem_Callback"); */ + odm_s0s1_sw_ant_div(&p_hal_data->DM_OutSrc, SWAW_STEP_DETERMINE); +} + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + +void +odm_sw_antdiv_workitem_callback( + void *p_context +) +{ + struct _ADAPTER * + p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE + *p_hal_data = GET_HAL_DATA(p_adapter); + + /*dbg_print("SW_antdiv_Workitem_Callback");*/ + odm_s0s1_sw_ant_div(&p_hal_data->odmpriv, SWAW_STEP_DETERMINE); +} + +void +odm_sw_antdiv_callback(void *function_context) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)function_context; + struct _ADAPTER *padapter = p_dm->adapter; + if (padapter->net_closed == true) + return; + +#if 0 /* Can't do I/O in timer callback*/ + odm_s0s1_sw_ant_div(p_dm, SWAW_STEP_DETERMINE); +#else + rtw_run_in_thread_cmd(padapter, odm_sw_antdiv_workitem_callback, padapter); +#endif +} + + +#endif + +void +odm_s0s1_sw_ant_div_by_ctrl_frame( + void *p_dm_void, + u8 step +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + switch (step) { + case SWAW_STEP_PEEK: + p_dm_swat_table->pkt_cnt_sw_ant_div_by_ctrl_frame = 0; + p_dm_swat_table->is_sw_ant_div_by_ctrl_frame = true; + p_dm_fat_table->main_ant_ctrl_frame_cnt = 0; + p_dm_fat_table->aux_ant_ctrl_frame_cnt = 0; + p_dm_fat_table->main_ant_ctrl_frame_sum = 0; + p_dm_fat_table->aux_ant_ctrl_frame_sum = 0; + p_dm_fat_table->cck_ctrl_frame_cnt_main = 0; + p_dm_fat_table->cck_ctrl_frame_cnt_aux = 0; + p_dm_fat_table->ofdm_ctrl_frame_cnt_main = 0; + p_dm_fat_table->ofdm_ctrl_frame_cnt_aux = 0; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_S0S1_SwAntDivForAPMode(): Start peek and reset counter\n")); + break; + case SWAW_STEP_DETERMINE: + p_dm_swat_table->is_sw_ant_div_by_ctrl_frame = false; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_S0S1_SwAntDivForAPMode(): Stop peek\n")); + break; + default: + p_dm_swat_table->is_sw_ant_div_by_ctrl_frame = false; + break; + } +} + +void +odm_antsel_statistics_of_ctrl_frame( + void *p_dm_void, + u8 antsel_tr_mux, + u32 rx_pwdb_all + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + if (antsel_tr_mux == ANT1_2G) { + p_dm_fat_table->main_ant_ctrl_frame_sum += rx_pwdb_all; + p_dm_fat_table->main_ant_ctrl_frame_cnt++; + } else { + p_dm_fat_table->aux_ant_ctrl_frame_sum += rx_pwdb_all; + p_dm_fat_table->aux_ant_ctrl_frame_cnt++; + } +} + +void +odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void + /* struct phydm_phyinfo_struct* p_phy_info, */ + /* struct phydm_perpkt_info_struct* p_pktinfo */ +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_phyinfo_struct *p_phy_info = (struct phydm_phyinfo_struct *)p_phy_info_void; + struct phydm_perpkt_info_struct *p_pktinfo = (struct phydm_perpkt_info_struct *)p_pkt_info_void; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + boolean is_cck_rate; + + if (!(p_dm->support_ability & ODM_BB_ANT_DIV)) + return; + + if (p_dm->ant_div_type != S0S1_SW_ANTDIV) + return; + + /* In try state */ + if (!p_dm_swat_table->is_sw_ant_div_by_ctrl_frame) + return; + + /* No HW error and match receiver address */ + if (!p_pktinfo->is_to_self) + return; + + p_dm_swat_table->pkt_cnt_sw_ant_div_by_ctrl_frame++; + is_cck_rate = ((p_pktinfo->data_rate >= DESC_RATE1M) && (p_pktinfo->data_rate <= DESC_RATE11M)) ? true : false; + + if (is_cck_rate) { + p_dm_fat_table->antsel_rx_keep_0 = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? ANT1_2G : ANT2_2G; + + if (p_dm_fat_table->antsel_rx_keep_0 == ANT1_2G) + p_dm_fat_table->cck_ctrl_frame_cnt_main++; + else + p_dm_fat_table->cck_ctrl_frame_cnt_aux++; + + odm_antsel_statistics_of_ctrl_frame(p_dm, p_dm_fat_table->antsel_rx_keep_0, p_phy_info->rx_mimo_signal_strength[RF_PATH_A]); + } else { + p_dm_fat_table->antsel_rx_keep_0 = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? ANT1_2G : ANT2_2G; + + if (p_dm_fat_table->antsel_rx_keep_0 == ANT1_2G) + p_dm_fat_table->ofdm_ctrl_frame_cnt_main++; + else + p_dm_fat_table->ofdm_ctrl_frame_cnt_aux++; + + odm_antsel_statistics_of_ctrl_frame(p_dm, p_dm_fat_table->antsel_rx_keep_0, p_phy_info->rx_pwdb_all); + } +} + +#endif /* #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) */ + + + + +void +odm_set_next_mac_addr_target( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct cmn_sta_info *p_entry; + u32 value32, i; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("odm_set_next_mac_addr_target() ==>\n")); + + if (p_dm->is_linked) { + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + + if ((p_dm_fat_table->train_idx + 1) == ODM_ASSOCIATE_ENTRY_NUM) + p_dm_fat_table->train_idx = 0; + else + p_dm_fat_table->train_idx++; + + p_entry = p_dm->p_phydm_sta_info[p_dm_fat_table->train_idx]; + + if (is_sta_active(p_entry)) { + + /*Match MAC ADDR*/ + value32 = (p_entry->mac_addr[5] << 8) | p_entry->mac_addr[4]; + + odm_set_mac_reg(p_dm, 0x7b4, 0xFFFF, value32);/*0x7b4~0x7b5*/ + + value32 = (p_entry->mac_addr[3] << 24) | (p_entry->mac_addr[2] << 16) | (p_entry->mac_addr[1] << 8) | p_entry->mac_addr[0]; + + odm_set_mac_reg(p_dm, 0x7b0, MASKDWORD, value32);/*0x7b0~0x7b3*/ + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("p_dm_fat_table->train_idx=%d\n", p_dm_fat_table->train_idx)); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Training MAC addr = %x:%x:%x:%x:%x:%x\n", + p_entry->mac_addr[5], p_entry->mac_addr[4], p_entry->mac_addr[3], p_entry->mac_addr[2], p_entry->mac_addr[1], p_entry->mac_addr[0])); + + break; + } + } + } + +} + +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + +void +odm_fast_ant_training( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + u32 max_rssi_path_a = 0, pckcnt_path_a = 0; + u8 i, target_ant_path_a = 0; + boolean is_pkt_filter_macth_path_a = false; +#if (RTL8192E_SUPPORT == 1) + u32 max_rssi_path_b = 0, pckcnt_path_b = 0; + u8 target_ant_path_b = 0; + boolean is_pkt_filter_macth_path_b = false; +#endif + + + if (!p_dm->is_linked) { /* is_linked==False */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[No Link!!!]\n")); + + if (p_dm_fat_table->is_become_linked == true) { + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + phydm_fast_training_enable(p_dm, FAT_OFF); + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + return; + } else { + if (p_dm_fat_table->is_become_linked == false) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Linked!!!]\n")); + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + } + + if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { + if (p_dm->is_one_entry_only == true) + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + else + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_DESC); + } + + + if (p_dm->support_ic_type == ODM_RTL8188E) + odm_set_bb_reg(p_dm, 0x864, BIT(2) | BIT(1) | BIT(0), ((p_dm->fat_comb_a) - 1)); +#if (RTL8192E_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8192E) { + odm_set_bb_reg(p_dm, 0xB38, BIT(2) | BIT(1) | BIT(0), ((p_dm->fat_comb_a) - 1)); /* path-A */ /* ant combination=regB38[2:0]+1 */ + odm_set_bb_reg(p_dm, 0xB38, BIT(18) | BIT(17) | BIT(16), ((p_dm->fat_comb_b) - 1)); /* path-B */ /* ant combination=regB38[18:16]+1 */ + } +#endif + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("==>odm_fast_ant_training()\n")); + + /* 1 TRAINING STATE */ + if (p_dm_fat_table->fat_state == FAT_TRAINING_STATE) { + /* 2 Caculate RSSI per Antenna */ + + /* 3 [path-A]--------------------------- */ + for (i = 0; i < (p_dm->fat_comb_a); i++) { /* i : antenna index */ + if (p_dm_fat_table->ant_rssi_cnt[i] == 0) + p_dm_fat_table->ant_ave_rssi[i] = 0; + else { + p_dm_fat_table->ant_ave_rssi[i] = p_dm_fat_table->ant_sum_rssi[i] / p_dm_fat_table->ant_rssi_cnt[i]; + is_pkt_filter_macth_path_a = true; + } + + if (p_dm_fat_table->ant_ave_rssi[i] > max_rssi_path_a) { + max_rssi_path_a = p_dm_fat_table->ant_ave_rssi[i]; + pckcnt_path_a = p_dm_fat_table->ant_rssi_cnt[i]; + target_ant_path_a = i ; + } else if (p_dm_fat_table->ant_ave_rssi[i] == max_rssi_path_a) { + if ((p_dm_fat_table->ant_rssi_cnt[i]) > pckcnt_path_a) { + max_rssi_path_a = p_dm_fat_table->ant_ave_rssi[i]; + pckcnt_path_a = p_dm_fat_table->ant_rssi_cnt[i]; + target_ant_path_a = i ; + } + } + + PHYDM_DBG("*** ant-index : [ %d ], counter = (( %d )), Avg RSSI = (( %d ))\n", i, p_dm_fat_table->ant_rssi_cnt[i], p_dm_fat_table->ant_ave_rssi[i]); + } + + +#if 0 +#if (RTL8192E_SUPPORT == 1) + /* 3 [path-B]--------------------------- */ + for (i = 0; i < (p_dm->fat_comb_b); i++) { + if (p_dm_fat_table->antRSSIcnt_pathB[i] == 0) + p_dm_fat_table->antAveRSSI_pathB[i] = 0; + else { /* (ant_rssi_cnt[i] != 0) */ + p_dm_fat_table->antAveRSSI_pathB[i] = p_dm_fat_table->antSumRSSI_pathB[i] / p_dm_fat_table->antRSSIcnt_pathB[i]; + is_pkt_filter_macth_path_b = true; + } + if (p_dm_fat_table->antAveRSSI_pathB[i] > max_rssi_path_b) { + max_rssi_path_b = p_dm_fat_table->antAveRSSI_pathB[i]; + pckcnt_path_b = p_dm_fat_table->antRSSIcnt_pathB[i]; + target_ant_path_b = (u8) i; + } + if (p_dm_fat_table->antAveRSSI_pathB[i] == max_rssi_path_b) { + if (p_dm_fat_table->antRSSIcnt_pathB > pckcnt_path_b) { + max_rssi_path_b = p_dm_fat_table->antAveRSSI_pathB[i]; + target_ant_path_b = (u8) i; + } + } + if (p_dm->fat_print_rssi == 1) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***{path-B}: Sum RSSI[%d] = (( %d )), cnt RSSI [%d] = (( %d )), Avg RSSI[%d] = (( %d ))\n", + i, p_dm_fat_table->antSumRSSI_pathB[i], i, p_dm_fat_table->antRSSIcnt_pathB[i], i, p_dm_fat_table->antAveRSSI_pathB[i])); + } + } +#endif +#endif + + /* 1 DECISION STATE */ + + /* 2 Select TRX Antenna */ + + phydm_fast_training_enable(p_dm, FAT_OFF); + + /* 3 [path-A]--------------------------- */ + if (is_pkt_filter_macth_path_a == false) { + /* PHYDM_DBG(p_dm,DBG_ANT_DIV, ("{path-A}: None Packet is matched\n")); */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("{path-A}: None Packet is matched\n")); + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + } else { + PHYDM_DBG("target_ant_path_a = (( %d )) , max_rssi_path_a = (( %d ))\n", target_ant_path_a, max_rssi_path_a); + + /* 3 [ update RX-optional ant ] Default RX is Omni, Optional RX is the best decision by FAT */ + if (p_dm->support_ic_type == ODM_RTL8188E) + odm_set_bb_reg(p_dm, 0x864, BIT(8) | BIT(7) | BIT(6), target_ant_path_a); + else if (p_dm->support_ic_type == ODM_RTL8192E) + odm_set_bb_reg(p_dm, 0xB38, BIT(8) | BIT(7) | BIT(6), target_ant_path_a); /* Optional RX [pth-A] */ + + /* 3 [ update TX ant ] */ + odm_update_tx_ant(p_dm, target_ant_path_a, (p_dm_fat_table->train_idx)); + + if (target_ant_path_a == 0) + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + } +#if 0 +#if (RTL8192E_SUPPORT == 1) + /* 3 [path-B]--------------------------- */ + if (is_pkt_filter_macth_path_b == false) { + if (p_dm->fat_print_rssi == 1) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***[%d]{path-B}: None Packet is matched\n\n\n", __LINE__)); + } else { + if (p_dm->fat_print_rssi == 1) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, + (" ***target_ant_path_b = (( %d )) *** max_rssi = (( %d ))***\n\n\n", target_ant_path_b, max_rssi_path_b)); + } + odm_set_bb_reg(p_dm, 0xB38, BIT(21) | BIT20 | BIT19, target_ant_path_b); /* Default RX is Omni, Optional RX is the best decision by FAT */ + odm_set_bb_reg(p_dm, 0x80c, BIT(21), 1); /* Reg80c[21]=1'b1 //from TX Info */ + + p_dm_fat_table->antsel_pathB[p_dm_fat_table->train_idx] = target_ant_path_b; + } +#endif +#endif + + /* 2 Reset counter */ + for (i = 0; i < (p_dm->fat_comb_a); i++) { + p_dm_fat_table->ant_sum_rssi[i] = 0; + p_dm_fat_table->ant_rssi_cnt[i] = 0; + } + /* + #if (RTL8192E_SUPPORT == 1) + for(i=0; i<=(p_dm->fat_comb_b); i++) + { + p_dm_fat_table->antSumRSSI_pathB[i] = 0; + p_dm_fat_table->antRSSIcnt_pathB[i] = 0; + } + #endif + */ + + p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + return; + } + + /* 1 NORMAL STATE */ + if (p_dm_fat_table->fat_state == FAT_PREPARE_STATE) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Start Prepare state ]\n")); + + odm_set_next_mac_addr_target(p_dm); + + /* 2 Prepare Training */ + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + phydm_fast_training_enable(p_dm, FAT_ON); + odm_ant_div_on_off(p_dm, ANTDIV_ON); /* enable HW AntDiv */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Start Training state]\n")); + + odm_set_timer(p_dm, &p_dm->fast_ant_training_timer, p_dm->antdiv_intvl); /* ms */ + } + +} + +void +odm_fast_ant_training_callback( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct _ADAPTER *padapter = p_dm->adapter; + if (padapter->net_closed == true) + return; + /* if(*p_dm->p_is_net_closed == true) */ + /* return; */ +#endif + +#if USE_WORKITEM + odm_schedule_work_item(&p_dm->fast_ant_training_workitem); +#else + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("******odm_fast_ant_training_callback******\n")); + odm_fast_ant_training(p_dm); +#endif +} + +void +odm_fast_ant_training_work_item_callback( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("******odm_fast_ant_training_work_item_callback******\n")); + odm_fast_ant_training(p_dm); +} + +#endif + +void +odm_ant_div_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + + + if (!(p_dm->support_ability & ODM_BB_ANT_DIV)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] Not Support Antenna Diversity Function\n")); + return; + } + /* --- */ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + if (p_dm_fat_table->ant_div_2g_5g == ODM_ANTDIV_2G) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[2G AntDiv Init]: Only Support 2G Antenna Diversity Function\n")); + if (!(p_dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) + return; + } else if (p_dm_fat_table->ant_div_2g_5g == ODM_ANTDIV_5G) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[5G AntDiv Init]: Only Support 5G Antenna Diversity Function\n")); + if (!(p_dm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC)) + return; + } else if (p_dm_fat_table->ant_div_2g_5g == (ODM_ANTDIV_2G | ODM_ANTDIV_5G)) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[2G & 5G AntDiv Init]:Support Both 2G & 5G Antenna Diversity Function\n")); + +#endif + /* --- */ + + /* 2 [--General---] */ + p_dm->antdiv_period = 0; + + p_dm_fat_table->is_become_linked = false; + p_dm_fat_table->ant_div_on_off = 0xff; + + /* 3 - AP - */ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + odm_bdc_init(p_dm); +#endif +#endif + + /* 3 - WIN - */ +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + p_dm_swat_table->ant_5g = MAIN_ANT; + p_dm_swat_table->ant_2g = MAIN_ANT; +#endif + + /* 2 [---Set MAIN_ANT as default antenna if Auto-ant enable---] */ + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + + p_dm->ant_type = ODM_AUTO_ANT; + + p_dm_fat_table->rx_idle_ant = 0xff; /*to make RX-idle-antenna will be updated absolutly*/ + odm_update_rx_idle_ant(p_dm, MAIN_ANT); + phydm_keep_rx_ack_ant_by_tx_ant_time(p_dm, 0); /* Timming issue: keep Rx ant after tx for ACK ( 5 x 3.2 mu = 16mu sec)*/ + + /* 2 [---Set TX Antenna---] */ + if (p_dm_fat_table->p_force_tx_ant_by_desc == NULL) { + p_dm_fat_table->force_tx_ant_by_desc = 0; + p_dm_fat_table->p_force_tx_ant_by_desc = &(p_dm_fat_table->force_tx_ant_by_desc); + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("p_force_tx_ant_by_desc = %d\n", *p_dm_fat_table->p_force_tx_ant_by_desc)); + + if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == true) + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_DESC); + else + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + + + /* 2 [--88E---] */ + if (p_dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT == 1) + /* p_dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ + /* p_dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + /* p_dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ + + if ((p_dm->ant_div_type != CGCS_RX_HW_ANTDIV) && (p_dm->ant_div_type != CG_TRX_HW_ANTDIV) && (p_dm->ant_div_type != CG_TRX_SMART_ANTDIV)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 88E Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + + if (p_dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_rx_hw_ant_div_init_88e(p_dm); + else if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_88e(p_dm); +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + else if (p_dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_smart_hw_ant_div_init_88e(p_dm); +#endif +#endif + } + + /* 2 [--92E---] */ +#if (RTL8192E_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8192E) { + /* p_dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ + /* p_dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + /* p_dm->ant_div_type = CG_TRX_SMART_ANTDIV; */ + + if ((p_dm->ant_div_type != CGCS_RX_HW_ANTDIV) && (p_dm->ant_div_type != CG_TRX_HW_ANTDIV) && (p_dm->ant_div_type != CG_TRX_SMART_ANTDIV)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 8192E Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + + if (p_dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_rx_hw_ant_div_init_92e(p_dm); + else if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_92e(p_dm); +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + else if (p_dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_smart_hw_ant_div_init_92e(p_dm); +#endif + + } +#endif + + /* 2 [--8723B---] */ +#if (RTL8723B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8723B) { + p_dm->ant_div_type = S0S1_SW_ANTDIV; + /* p_dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + + if (p_dm->ant_div_type != S0S1_SW_ANTDIV && p_dm->ant_div_type != CG_TRX_HW_ANTDIV) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 8723B Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) + odm_s0s1_sw_ant_div_init_8723b(p_dm); + else if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_8723b(p_dm); + } +#endif + /*2 [--8723D---]*/ +#if (RTL8723D_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8723D) { + if (p_dm_fat_table->p_default_s0_s1 == NULL) { + p_dm_fat_table->default_s0_s1 = 1; + p_dm_fat_table->p_default_s0_s1 = &(p_dm_fat_table->default_s0_s1); + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("default_s0_s1 = %d\n", *p_dm_fat_table->p_default_s0_s1)); + + if (*(p_dm_fat_table->p_default_s0_s1) == true) + odm_update_rx_idle_ant(p_dm, MAIN_ANT); + else + odm_update_rx_idle_ant(p_dm, AUX_ANT); + + if (p_dm->ant_div_type == S0S1_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_8723d(p_dm); + else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 8723D Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + + } +#endif + /* 2 [--8811A 8821A---] */ +#if (RTL8821A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8821) { + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + p_dm->ant_div_type = HL_SW_SMART_ANT_TYPE1; + + if (p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { + + odm_trx_hw_ant_div_init_8821a(p_dm); + phydm_hl_smart_ant_type1_init_8821a(p_dm); + } else + #endif + { + #ifdef ODM_CONFIG_BT_COEXIST + p_dm->ant_div_type = S0S1_SW_ANTDIV; + #else + p_dm->ant_div_type = CG_TRX_HW_ANTDIV; + #endif + + if (p_dm->ant_div_type != CG_TRX_HW_ANTDIV && p_dm->ant_div_type != S0S1_SW_ANTDIV) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 8821A & 8811A Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_trx_hw_ant_div_init_8821a(p_dm); + else if (p_dm->ant_div_type == S0S1_SW_ANTDIV) + odm_s0s1_sw_ant_div_init_8821a(p_dm); + } + } +#endif + + /* 2 [--8821C---] */ +#if (RTL8821C_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8821C) { + p_dm->ant_div_type = S0S1_SW_ANTDIV; + if (p_dm->ant_div_type != S0S1_SW_ANTDIV) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 8821C Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + phydm_s0s1_sw_ant_div_init_8821c(p_dm); + odm_trx_hw_ant_div_init_8821c(p_dm); + } +#endif + + /* 2 [--8881A---] */ +#if (RTL8881A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8881A) { + /* p_dm->ant_div_type = CGCS_RX_HW_ANTDIV; */ + /* p_dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + + if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) { + + odm_trx_hw_ant_div_init_8881a(p_dm); + /**/ + } else { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 8881A Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + + odm_trx_hw_ant_div_init_8881a(p_dm); + } +#endif + + /* 2 [--8812---] */ +#if (RTL8812A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8812) { + /* p_dm->ant_div_type = CG_TRX_HW_ANTDIV; */ + + if (p_dm->ant_div_type != CG_TRX_HW_ANTDIV) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] 8812A Not Supprrt This AntDiv type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + return; + } + odm_trx_hw_ant_div_init_8812a(p_dm); + } +#endif + + /*[--8188F---]*/ +#if (RTL8188F_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8188F) { + + p_dm->ant_div_type = S0S1_SW_ANTDIV; + odm_s0s1_sw_ant_div_init_8188f(p_dm); + } +#endif + + /*[--8822B---]*/ +#if (RTL8822B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8822B) { + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + p_dm->ant_div_type = HL_SW_SMART_ANT_TYPE2; + + if (p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) + phydm_hl_smart_ant_type2_init_8822b(p_dm); + #endif + } +#endif + + /* + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** support_ic_type=[%lu]\n",p_dm->support_ic_type)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** AntDiv support_ability=[%lu]\n",(p_dm->support_ability & ODM_BB_ANT_DIV)>>6)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("*** AntDiv type=[%d]\n",p_dm->ant_div_type)); + */ +} + +void +odm_ant_div( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *p_adapter = p_dm->adapter; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; +#if (defined(CONFIG_HL_SMART_ANTENNA)) + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); +#endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV + + if (p_dm->is_linked) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("tp_active_occur=((%d)), EVM_method_enable=((%d))\n", + p_dm->tp_active_occur, p_dm_fat_table->EVM_method_enable)); + + if ((p_dm->tp_active_occur == 1) && (p_dm_fat_table->EVM_method_enable == 1)) { + + p_dm_fat_table->idx_ant_div_counter_5g = p_dm->antdiv_period; + p_dm_fat_table->idx_ant_div_counter_2g = p_dm->antdiv_period; + } + } +#endif + + if (*p_dm->p_band_type == ODM_BAND_5G) { + if (p_dm_fat_table->idx_ant_div_counter_5g < p_dm->antdiv_period) { + p_dm_fat_table->idx_ant_div_counter_5g++; + return; + } else + p_dm_fat_table->idx_ant_div_counter_5g = 0; + } else if (*p_dm->p_band_type == ODM_BAND_2_4G) { + if (p_dm_fat_table->idx_ant_div_counter_2g < p_dm->antdiv_period) { + p_dm_fat_table->idx_ant_div_counter_2g++; + return; + } else + p_dm_fat_table->idx_ant_div_counter_2g = 0; + } + + /* ---------- */ + + /* ---------- */ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN || DM_ODM_SUPPORT_TYPE == ODM_CE) + + if (p_dm_fat_table->enable_ctrl_frame_antdiv) { + + if ((p_dm->data_frame_num <= 10) && (p_dm->is_linked)) + p_dm_fat_table->use_ctrl_frame_antdiv = 1; + else + p_dm_fat_table->use_ctrl_frame_antdiv = 0; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("use_ctrl_frame_antdiv = (( %d )), data_frame_num = (( %d ))\n", p_dm_fat_table->use_ctrl_frame_antdiv, p_dm->data_frame_num)); + p_dm->data_frame_num = 0; + } + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (p_adapter->MgntInfo.AntennaTest) + return; + #endif + + { +#if (BEAMFORMING_SUPPORT == 1) + + enum beamforming_cap beamform_cap = phydm_get_beamform_cap(p_dm); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("is_bt_continuous_turn = ((%d))\n", p_dm->is_bt_continuous_turn)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ AntDiv Beam Cap ] cap= ((%d))\n", beamform_cap)); + if (!p_dm->is_bt_continuous_turn) { + if ((beamform_cap & BEAMFORMEE_CAP) && (!(*p_dm_fat_table->is_no_csi_feedback))) { /* BFmee On && Div On->Div Off */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ AntDiv : OFF ] BFmee ==1; cap= ((%d))\n", beamform_cap)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ AntDiv BF] is_no_csi_feedback= ((%d))\n", *(p_dm_fat_table->is_no_csi_feedback))); + if (p_dm_fat_table->fix_ant_bfee == 0) { + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + p_dm_fat_table->fix_ant_bfee = 1; + } + return; + } else { /* BFmee Off && Div Off->Div On */ + if ((p_dm_fat_table->fix_ant_bfee == 1) && p_dm->is_linked) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ AntDiv : ON ] BFmee ==0; cap=((%d))\n", beamform_cap)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ AntDiv BF] is_no_csi_feedback= ((%d))\n", *(p_dm_fat_table->is_no_csi_feedback))); + if (p_dm->ant_div_type != S0S1_SW_ANTDIV) + odm_ant_div_on_off(p_dm, ANTDIV_ON); + + p_dm_fat_table->fix_ant_bfee = 0; + } + } + } +#endif + } +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + /* ----------just for fool proof */ + + if (p_dm->antdiv_rssi) + p_dm->debug_components |= DBG_ANT_DIV; + else + p_dm->debug_components &= ~DBG_ANT_DIV; + + if (p_dm_fat_table->ant_div_2g_5g == ODM_ANTDIV_2G) { + /* PHYDM_DBG(p_dm, DBG_ANT_DIV,("[ 2G AntDiv Running ]\n")); */ + if (!(p_dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC)) + return; + } else if (p_dm_fat_table->ant_div_2g_5g == ODM_ANTDIV_5G) { + /* PHYDM_DBG(p_dm, DBG_ANT_DIV,("[ 5G AntDiv Running ]\n")); */ + if (!(p_dm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC)) + return; + } + /* else if(p_dm_fat_table->ant_div_2g_5g == (ODM_ANTDIV_2G|ODM_ANTDIV_5G)) */ + /* { */ + /* PHYDM_DBG(p_dm, DBG_ANT_DIV,("[ 2G & 5G AntDiv Running ]\n")); */ + /* } */ +#endif + + /* ---------- */ + + if (p_dm->antdiv_select == 1) + p_dm->ant_type = ODM_FIX_MAIN_ANT; + else if (p_dm->antdiv_select == 2) + p_dm->ant_type = ODM_FIX_AUX_ANT; + else { /* if (p_dm->antdiv_select==0) */ + p_dm->ant_type = ODM_AUTO_ANT; + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /*Stop Antenna diversity for CMW500 testing case*/ + if (p_dm->consecutive_idlel_time >= 10) { + p_dm->ant_type = ODM_FIX_MAIN_ANT; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[AntDiv: OFF] No TP case, consecutive_idlel_time=((%d))\n", p_dm->consecutive_idlel_time)); + } + #endif + } + + /* PHYDM_DBG(p_dm, DBG_ANT_DIV,("ant_type= (( %d )) , pre_ant_type= (( %d ))\n",p_dm->ant_type,p_dm->pre_ant_type)); */ + + if (p_dm->ant_type != ODM_AUTO_ANT) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Fix Antenna at (( %s ))\n", (p_dm->ant_type == ODM_FIX_MAIN_ANT) ? "MAIN" : "AUX")); + + if (p_dm->ant_type != p_dm->pre_ant_type) { + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + + if (p_dm->ant_type == ODM_FIX_MAIN_ANT) + odm_update_rx_idle_ant(p_dm, MAIN_ANT); + else if (p_dm->ant_type == ODM_FIX_AUX_ANT) + odm_update_rx_idle_ant(p_dm, AUX_ANT); + } + p_dm->pre_ant_type = p_dm->ant_type; + return; + } else { + if (p_dm->ant_type != p_dm->pre_ant_type) { + odm_ant_div_on_off(p_dm, ANTDIV_ON); + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_DESC); + } + p_dm->pre_ant_type = p_dm->ant_type; + } + + + /* 3 ----------------------------------------------------------------------------------------------------------- */ + /* 2 [--88E---] */ + if (p_dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT == 1) + if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV || p_dm->ant_div_type == CGCS_RX_HW_ANTDIV) + odm_hw_ant_div(p_dm); + +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + else if (p_dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_fast_ant_training(p_dm); +#endif + +#endif + + } + /* 2 [--92E---] */ +#if (RTL8192E_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8192E) { + if (p_dm->ant_div_type == CGCS_RX_HW_ANTDIV || p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_hw_ant_div(p_dm); + +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + else if (p_dm->ant_div_type == CG_TRX_SMART_ANTDIV) + odm_fast_ant_training(p_dm); +#endif + + } +#endif + +#if (RTL8723B_SUPPORT == 1) + /* 2 [--8723B---] */ + else if (p_dm->support_ic_type == ODM_RTL8723B) { + if (phydm_is_bt_enable_8723b(p_dm)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[BT is enable!!!]\n")); + if (p_dm_fat_table->is_become_linked == true) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Set REG 948[9:6]=0x0\n")); + if (p_dm->support_ic_type == ODM_RTL8723B) + odm_set_bb_reg(p_dm, 0x948, BIT(9) | BIT(8) | BIT(7) | BIT(6), 0x0); + + p_dm_fat_table->is_become_linked = false; + } + } else { + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) { + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(p_dm, SWAW_STEP_PEEK); +#endif + } else if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_hw_ant_div(p_dm); + } + } +#endif + /*8723D*/ +#if (RTL8723D_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8723D) { + + odm_hw_ant_div(p_dm); + /**/ + } +#endif + + /* 2 [--8821A---] */ +#if (RTL8821A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8821) { + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + if (p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { + + if (pdm_sat_table->fix_beam_pattern_en != 0) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); + /*return;*/ + } else { + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] ant_div_type = HL_SW_SMART_ANT_TYPE1\n"));*/ + odm_fast_ant_training_hl_smart_antenna_type1(p_dm); + } + + } else + #endif + { + + #ifdef ODM_CONFIG_BT_COEXIST + if (!p_dm->bt_info_table.is_bt_enabled) { /*BT disabled*/ + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) { + p_dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" [S0S1_SW_ANTDIV] -> [CG_TRX_HW_ANTDIV]\n")); + /*odm_set_bb_reg(p_dm, 0x8D4, BIT24, 1); */ + if (p_dm_fat_table->is_become_linked == true) + odm_ant_div_on_off(p_dm, ANTDIV_ON); + } + + } else { /*BT enabled*/ + + if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) { + p_dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" [CG_TRX_HW_ANTDIV] -> [S0S1_SW_ANTDIV]\n")); + /*odm_set_bb_reg(p_dm, 0x8D4, BIT24, 0);*/ + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + } + } + #endif + + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) { + + #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(p_dm, SWAW_STEP_PEEK); + #endif + } else if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_hw_ant_div(p_dm); + } + } +#endif + + /* 2 [--8821C---] */ +#if (RTL8821C_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8821C) { + if (!p_dm->is_bt_continuous_turn) { + p_dm->ant_div_type = S0S1_SW_ANTDIV; + ODM_RT_TRACE(p_dm, DBG_ANT_DIV, ODM_DBG_LOUD, ("is_bt_continuous_turn = ((%d)) ==> SW AntDiv\n", p_dm->is_bt_continuous_turn)); + + } else { + p_dm->ant_div_type = CG_TRX_HW_ANTDIV; + ODM_RT_TRACE(p_dm, DBG_ANT_DIV, ODM_DBG_LOUD, ("is_bt_continuous_turn = ((%d)) ==> HW AntDiv\n", p_dm->is_bt_continuous_turn)); + } + + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) { + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(p_dm, SWAW_STEP_PEEK); +#endif + } else if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV) + odm_hw_ant_div(p_dm); + } +#endif + + /* 2 [--8881A---] */ +#if (RTL8881A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8881A) + odm_hw_ant_div(p_dm); +#endif + + /* 2 [--8812A---] */ +#if (RTL8812A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8812) + odm_hw_ant_div(p_dm); +#endif + +#if (RTL8188F_SUPPORT == 1) + /* [--8188F---]*/ + else if (p_dm->support_ic_type == ODM_RTL8188F) { + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div(p_dm, SWAW_STEP_PEEK); +#endif + } +#endif + + /* [--8822B---]*/ +#if (RTL8822B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8822B) { + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + if (p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) { + + if (pdm_sat_table->fix_beam_pattern_en != 0) + PHYDM_DBG(p_dm, DBG_ANT_DIV, (" [ SmartAnt ] Fix SmartAnt Pattern = 0x%x\n", pdm_sat_table->fix_beam_pattern_codeword)); + else + phydm_fast_ant_training_hl_smart_antenna_type2(p_dm); + } + #endif + } +#endif + + +} + + +void +odm_antsel_statistics( + void *p_dm_void, + void *p_phy_info_void, + u8 antsel_tr_mux, + u32 mac_id, + u32 utility, + u8 method, + u8 is_cck_rate + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct phydm_phyinfo_struct *p_phy_info = (struct phydm_phyinfo_struct *)p_phy_info_void; + + if (method == RSSI_METHOD) { + + if (is_cck_rate) { + if (antsel_tr_mux == ANT1_2G) { + if (p_dm_fat_table->main_ant_sum_cck[mac_id] > 65435) /*to prevent u16 overflow, max(RSSI)=100, 65435+100 = 65535 (u16)*/ + return; + + p_dm_fat_table->main_ant_sum_cck[mac_id] += (u16)utility; + p_dm_fat_table->main_ant_cnt_cck[mac_id]++; + } else { + if (p_dm_fat_table->aux_ant_sum_cck[mac_id] > 65435) + return; + + p_dm_fat_table->aux_ant_sum_cck[mac_id] += (u16)utility; + p_dm_fat_table->aux_ant_cnt_cck[mac_id]++; + } + + } else { /*ofdm rate*/ + + if (antsel_tr_mux == ANT1_2G) { + if (p_dm_fat_table->main_ant_sum[mac_id] > 65435) + return; + + p_dm_fat_table->main_ant_sum[mac_id] += (u16)utility; + p_dm_fat_table->main_ant_cnt[mac_id]++; + } else { + if (p_dm_fat_table->aux_ant_sum[mac_id] > 65435) + return; + + p_dm_fat_table->aux_ant_sum[mac_id] += (u16)utility; + p_dm_fat_table->aux_ant_cnt[mac_id]++; + } + } + } +#ifdef ODM_EVM_ENHANCE_ANTDIV + else if (method == EVM_METHOD) { + if (p_dm->rate_ss == 1) { + + if (antsel_tr_mux == ANT1_2G) { + p_dm_fat_table->main_ant_evm_sum[mac_id] += ((p_phy_info->rx_mimo_evm_dbm[0])<<5); + p_dm_fat_table->main_ant_evm_cnt[mac_id]++; + } else { + p_dm_fat_table->aux_ant_evm_sum[mac_id] += ((p_phy_info->rx_mimo_evm_dbm[0])<<5); + p_dm_fat_table->aux_ant_evm_cnt[mac_id]++; + } + + } else {/*>= 2SS*/ + + if (antsel_tr_mux == ANT1_2G) { + + p_dm_fat_table->main_ant_evm_2ss_sum[mac_id][0] += (p_phy_info->rx_mimo_evm_dbm[0]<<5); + p_dm_fat_table->main_ant_evm_2ss_sum[mac_id][1] += (p_phy_info->rx_mimo_evm_dbm[1]<<5); + p_dm_fat_table->main_ant_evm_2ss_cnt[mac_id]++; + + } else { + + p_dm_fat_table->aux_ant_evm_2ss_sum[mac_id][0] += (p_phy_info->rx_mimo_evm_dbm[0]<<5); + p_dm_fat_table->aux_ant_evm_2ss_sum[mac_id][1] += (p_phy_info->rx_mimo_evm_dbm[1]<<5); + p_dm_fat_table->aux_ant_evm_2ss_cnt[mac_id]++; + } + } + + } else if (method == CRC32_METHOD) { + + if (antsel_tr_mux == ANT1_2G) { + p_dm_fat_table->main_crc32_ok_cnt += utility; + p_dm_fat_table->main_crc32_fail_cnt++; + } else { + p_dm_fat_table->aux_crc32_ok_cnt += utility; + p_dm_fat_table->aux_crc32_fail_cnt++; + } + + } else if (method == TP_METHOD) { + if (((utility <= ODM_RATEMCS15) && (utility >= ODM_RATEMCS0)) && + (p_dm_fat_table->fat_state_cnt <= p_dm->antdiv_tp_period) + ) { + + if (antsel_tr_mux == ANT1_2G) { + p_dm_fat_table->antdiv_tp_main += (phy_rate_table[utility])<<5; + p_dm_fat_table->antdiv_tp_main_cnt++; + } else { + p_dm_fat_table->antdiv_tp_aux += (phy_rate_table[utility])<<5; + p_dm_fat_table->antdiv_tp_aux_cnt++; + } + } + } +#endif +} + +void +odm_process_rssi_for_ant_div( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_phyinfo_struct *p_phy_info = (struct phydm_phyinfo_struct *)p_phy_info_void; + struct phydm_perpkt_info_struct *p_pktinfo = (struct phydm_perpkt_info_struct *)p_pkt_info_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; +#if (defined(CONFIG_HL_SMART_ANTENNA)) + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u32 beam_tmp; + u8 next_ant; + u8 train_pkt_number; +#endif + u8 is_cck_rate = FALSE; + u8 rx_power_ant0 = p_phy_info->rx_mimo_signal_strength[0]; + u8 rx_power_ant1 = p_phy_info->rx_mimo_signal_strength[1]; + u8 rx_evm_ant0 = p_phy_info->rx_mimo_signal_quality[0]; + u8 rx_evm_ant1 = p_phy_info->rx_mimo_signal_quality[1]; + u8 rssi_avg; + + is_cck_rate = (p_pktinfo->data_rate <= ODM_RATE11M) ? true : false; + + if ((p_dm->support_ic_type & ODM_IC_2SS) && (!is_cck_rate)) { + + if (rx_power_ant1 < 100) + rssi_avg = (u8)odm_convert_to_db((odm_convert_to_linear(rx_power_ant0) + odm_convert_to_linear(rx_power_ant1))>>1); /*averaged PWDB*/ + + } else { + rx_power_ant0 = (u8)p_phy_info->rx_pwdb_all; + rssi_avg = rx_power_ant0; + } + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + if ((p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE2) && (p_dm_fat_table->fat_state == FAT_TRAINING_STATE)) + phydm_process_rssi_for_hb_smtant_type2(p_dm, p_phy_info, p_pktinfo, rssi_avg); /*for 8822B*/ + else +#endif + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 +#ifdef CONFIG_FAT_PATCH + if ((p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) && (p_dm_fat_table->fat_state == FAT_TRAINING_STATE)) { + + /*[Beacon]*/ + if (p_pktinfo->is_packet_beacon) { + + pdm_sat_table->beacon_counter++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("MatchBSSID_beacon_counter = ((%d))\n", pdm_sat_table->beacon_counter)); + + if (pdm_sat_table->beacon_counter >= pdm_sat_table->pre_beacon_counter + 2) { + + if (pdm_sat_table->ant_num > 1) { + next_ant = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + odm_update_rx_idle_ant(p_dm, next_ant); + } + + pdm_sat_table->update_beam_idx++; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", + pdm_sat_table->pre_beacon_counter, pdm_sat_table->pkt_counter, pdm_sat_table->update_beam_idx)); + + pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; + pdm_sat_table->pkt_counter = 0; + } + } + /*[data]*/ + else if (p_pktinfo->is_packet_to_self) { + + if (pdm_sat_table->pkt_skip_statistic_en == 0) { + /* + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", + p_pktinfo->station_id, p_dm_fat_table->antsel_rx_keep_0, p_dm_fat_table->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, rx_power_ant0)); + */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("ID[%d][pkt_cnt = %d]: {ANT, Beam} = {%d, %d}, RSSI = ((%d))\n", + p_pktinfo->station_id, pdm_sat_table->pkt_counter, p_dm_fat_table->antsel_rx_keep_0, pdm_sat_table->fast_training_beam_num, rx_power_ant0)); + + pdm_sat_table->pkt_rssi_sum[p_dm_fat_table->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += rx_power_ant0; + pdm_sat_table->pkt_rssi_cnt[p_dm_fat_table->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; + pdm_sat_table->pkt_counter++; + + #if 1 + train_pkt_number = pdm_sat_table->beam_train_cnt[p_dm_fat_table->rx_idle_ant - 1][pdm_sat_table->fast_training_beam_num]; + #else + train_pkt_number = pdm_sat_table->per_beam_training_pkt_num; + #endif + + /*Swich Antenna erery N pkts*/ + if (pdm_sat_table->pkt_counter == train_pkt_number) { + + if (pdm_sat_table->ant_num > 1) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("packet enugh ((%d ))pkts ---> Switch antenna\n", train_pkt_number)); + next_ant = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT; + odm_update_rx_idle_ant(p_dm, next_ant); + } + + pdm_sat_table->update_beam_idx++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("pre_beacon_counter = ((%d)), update_beam_idx_counter = ((%d))\n", + pdm_sat_table->pre_beacon_counter, pdm_sat_table->update_beam_idx)); + + pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; + pdm_sat_table->pkt_counter = 0; + } + } + } + + /*Swich Beam after switch "pdm_sat_table->ant_num" antennas*/ + if (pdm_sat_table->update_beam_idx == pdm_sat_table->ant_num) { + + pdm_sat_table->update_beam_idx = 0; + pdm_sat_table->pkt_counter = 0; + beam_tmp = pdm_sat_table->fast_training_beam_num; + + if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant - 1)) { + + p_dm_fat_table->fat_state = FAT_DECISION_STATE; + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + odm_fast_ant_training_hl_smart_antenna_type1(p_dm); + #else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_decision_workitem); + #endif + + + } else { + pdm_sat_table->fast_training_beam_num++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); + phydm_set_all_ant_same_beam_num(p_dm); + + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + } + } + + } +#else + + if (p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { + if ((p_dm->support_ic_type & ODM_HL_SMART_ANT_TYPE1_SUPPORT) && + (p_pktinfo->is_packet_to_self) && + (p_dm_fat_table->fat_state == FAT_TRAINING_STATE) + ) { + + if (pdm_sat_table->pkt_skip_statistic_en == 0) { + /* + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("StaID[%d]: antsel_pathA = ((%d)), hw_antsw_occur = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", + p_pktinfo->station_id, p_dm_fat_table->antsel_rx_keep_0, p_dm_fat_table->hw_antsw_occur, pdm_sat_table->fast_training_beam_num, rx_power_ant0)); + */ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("StaID[%d]: antsel_pathA = ((%d)), is_packet_to_self = ((%d)), Beam_num = ((%d)), RSSI = ((%d))\n", + p_pktinfo->station_id, p_dm_fat_table->antsel_rx_keep_0, p_pktinfo->is_packet_to_self, pdm_sat_table->fast_training_beam_num, rx_power_ant0)); + + + pdm_sat_table->pkt_rssi_sum[p_dm_fat_table->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num] += rx_power_ant0; + pdm_sat_table->pkt_rssi_cnt[p_dm_fat_table->antsel_rx_keep_0][pdm_sat_table->fast_training_beam_num]++; + pdm_sat_table->pkt_counter++; + + /*swich beam every N pkt*/ + if ((pdm_sat_table->pkt_counter) >= (pdm_sat_table->per_beam_training_pkt_num)) { + + pdm_sat_table->pkt_counter = 0; + beam_tmp = pdm_sat_table->fast_training_beam_num; + + if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant - 1)) { + + p_dm_fat_table->fat_state = FAT_DECISION_STATE; + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + odm_fast_ant_training_hl_smart_antenna_type1(p_dm); + #else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_decision_workitem); + #endif + + + } else { + pdm_sat_table->fast_training_beam_num++; + phydm_set_all_ant_same_beam_num(p_dm); + + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); + } + } + } + } + } +#endif + else +#endif + if (p_dm->ant_div_type == CG_TRX_SMART_ANTDIV) { + if ((p_dm->support_ic_type & ODM_SMART_ANT_SUPPORT) && (p_pktinfo->is_packet_to_self) && (p_dm_fat_table->fat_state == FAT_TRAINING_STATE)) { /* (p_pktinfo->is_packet_match_bssid && (!p_pktinfo->is_packet_beacon)) */ + u8 antsel_tr_mux; + antsel_tr_mux = (p_dm_fat_table->antsel_rx_keep_2 << 2) | (p_dm_fat_table->antsel_rx_keep_1 << 1) | p_dm_fat_table->antsel_rx_keep_0; + p_dm_fat_table->ant_sum_rssi[antsel_tr_mux] += rx_power_ant0; + p_dm_fat_table->ant_rssi_cnt[antsel_tr_mux]++; + } + } else { /* ant_div_type != CG_TRX_SMART_ANTDIV */ + if ((p_dm->support_ic_type & ODM_ANTDIV_SUPPORT) && (p_pktinfo->is_packet_to_self || p_dm_fat_table->use_ctrl_frame_antdiv)) { + + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) { + + if (is_cck_rate || (p_dm->support_ic_type == ODM_RTL8188F)) + p_dm_fat_table->antsel_rx_keep_0 = (p_dm_fat_table->rx_idle_ant == MAIN_ANT) ? ANT1_2G : ANT2_2G; + + odm_antsel_statistics(p_dm, p_phy_info, p_dm_fat_table->antsel_rx_keep_0, p_pktinfo->station_id, rx_power_ant0, RSSI_METHOD, is_cck_rate); + + } else { + + odm_antsel_statistics(p_dm, p_phy_info, p_dm_fat_table->antsel_rx_keep_0, p_pktinfo->station_id, rx_power_ant0, RSSI_METHOD, is_cck_rate); + + #ifdef ODM_EVM_ENHANCE_ANTDIV + if (p_dm->support_ic_type == ODM_RTL8192E) { + if (!is_cck_rate) { + odm_antsel_statistics(p_dm, p_phy_info, p_dm_fat_table->antsel_rx_keep_0, p_pktinfo->station_id, rx_evm_ant0, EVM_METHOD, is_cck_rate); + odm_antsel_statistics(p_dm, p_phy_info, p_dm_fat_table->antsel_rx_keep_0, p_pktinfo->station_id, rx_evm_ant0, TP_METHOD, is_cck_rate); + } + + } + #endif + } + } + } + /* PHYDM_DBG(p_dm,DBG_ANT_DIV,("is_cck_rate=%d, PWDB_ALL=%d\n",is_cck_rate, p_phy_info->rx_pwdb_all)); */ + /* PHYDM_DBG(p_dm,DBG_ANT_DIV,("antsel_tr_mux=3'b%d%d%d\n",p_dm_fat_table->antsel_rx_keep_2, p_dm_fat_table->antsel_rx_keep_1, p_dm_fat_table->antsel_rx_keep_0)); */ +} + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void +odm_set_tx_ant_by_tx_info( + void *p_dm_void, + u8 *p_desc, + u8 mac_id + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + if (!(p_dm->support_ability & ODM_BB_ANT_DIV)) + return; + + if (p_dm->ant_div_type == CGCS_RX_HW_ANTDIV) + return; + + + if (p_dm->support_ic_type == ODM_RTL8723B) { +#if (RTL8723B_SUPPORT == 1) + SET_TX_DESC_ANTSEL_A_8723B(p_desc, p_dm_fat_table->antsel_a[mac_id]); + /*PHYDM_DBG(p_dm,DBG_ANT_DIV, ("[8723B] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + mac_id, p_dm_fat_table->antsel_c[mac_id], p_dm_fat_table->antsel_b[mac_id], p_dm_fat_table->antsel_a[mac_id]));*/ +#endif + } else if (p_dm->support_ic_type == ODM_RTL8821) { +#if (RTL8821A_SUPPORT == 1) + SET_TX_DESC_ANTSEL_A_8812(p_desc, p_dm_fat_table->antsel_a[mac_id]); + /*PHYDM_DBG(p_dm,DBG_ANT_DIV, ("[8821A] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + mac_id, p_dm_fat_table->antsel_c[mac_id], p_dm_fat_table->antsel_b[mac_id], p_dm_fat_table->antsel_a[mac_id]));*/ +#endif + } else if (p_dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT == 1) + SET_TX_DESC_ANTSEL_A_88E(p_desc, p_dm_fat_table->antsel_a[mac_id]); + SET_TX_DESC_ANTSEL_B_88E(p_desc, p_dm_fat_table->antsel_b[mac_id]); + SET_TX_DESC_ANTSEL_C_88E(p_desc, p_dm_fat_table->antsel_c[mac_id]); + /*PHYDM_DBG(p_dm,DBG_ANT_DIV, ("[8188E] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + mac_id, p_dm_fat_table->antsel_c[mac_id], p_dm_fat_table->antsel_b[mac_id], p_dm_fat_table->antsel_a[mac_id]));*/ +#endif + } else if (p_dm->support_ic_type == ODM_RTL8821C) { +#if (RTL8821C_SUPPORT == 1) + SET_TX_DESC_ANTSEL_A_8821C(p_desc, p_dm_fat_table->antsel_a[mac_id]); + /*PHYDM_DBG(p_dm,DBG_ANT_DIV, ("[8821C] SetTxAntByTxInfo_WIN: mac_id=%d, antsel_tr_mux=3'b%d%d%d\n", + mac_id, p_dm_fat_table->antsel_c[mac_id], p_dm_fat_table->antsel_b[mac_id], p_dm_fat_table->antsel_a[mac_id]));*/ +#endif + } +} +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + +void +odm_set_tx_ant_by_tx_info( + struct rtl8192cd_priv *priv, + struct tx_desc *pdesc, + unsigned short aid +) +{ + struct PHY_DM_STRUCT *p_dm = GET_PDM_ODM(priv);/*&(priv->pshare->_dmODM);*/ + struct phydm_fat_struct *p_dm_fat_table = &(p_dm->dm_fat_table); + + if (!(p_dm->support_ability & ODM_BB_ANT_DIV)) + return; + + if (p_dm->ant_div_type == CGCS_RX_HW_ANTDIV) + return; + + if (p_dm->support_ic_type == ODM_RTL8881A) { + /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__); */ + pdesc->Dword6 &= set_desc(~(BIT(18) | BIT(17) | BIT(16))); + pdesc->Dword6 |= set_desc(p_dm_fat_table->antsel_a[aid] << 16); + } else if (p_dm->support_ic_type == ODM_RTL8192E) { + /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8192E******\n",__FUNCTION__,__LINE__); */ + pdesc->Dword6 &= set_desc(~(BIT(18) | BIT(17) | BIT(16))); + pdesc->Dword6 |= set_desc(p_dm_fat_table->antsel_a[aid] << 16); + } else if (p_dm->support_ic_type == ODM_RTL8188E) { + /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8188E******\n",__FUNCTION__,__LINE__);*/ + pdesc->Dword2 &= set_desc(~BIT(24)); + pdesc->Dword2 &= set_desc(~BIT(25)); + pdesc->Dword7 &= set_desc(~BIT(29)); + + pdesc->Dword2 |= set_desc(p_dm_fat_table->antsel_a[aid] << 24); + pdesc->Dword2 |= set_desc(p_dm_fat_table->antsel_b[aid] << 25); + pdesc->Dword7 |= set_desc(p_dm_fat_table->antsel_c[aid] << 29); + + + } else if (p_dm->support_ic_type == ODM_RTL8812) { + /*[path-A]*/ + /*panic_printk("[%s] [%d] ******ODM_SetTxAntByTxInfo_8881E******\n",__FUNCTION__,__LINE__);*/ + + pdesc->Dword6 &= set_desc(~BIT(16)); + pdesc->Dword6 &= set_desc(~BIT(17)); + pdesc->Dword6 &= set_desc(~BIT(18)); + + pdesc->Dword6 |= set_desc(p_dm_fat_table->antsel_a[aid] << 16); + pdesc->Dword6 |= set_desc(p_dm_fat_table->antsel_b[aid] << 17); + pdesc->Dword6 |= set_desc(p_dm_fat_table->antsel_c[aid] << 18); + + } +} + + +#if 1 /*def CONFIG_WLAN_HAL*/ +void +odm_set_tx_ant_by_tx_info_hal( + struct rtl8192cd_priv *priv, + void *pdesc_data, + u16 aid +) +{ + struct PHY_DM_STRUCT *p_dm = GET_PDM_ODM(priv);/*&(priv->pshare->_dmODM);*/ + struct phydm_fat_struct *p_dm_fat_table = &(p_dm->dm_fat_table); + PTX_DESC_DATA_88XX pdescdata = (PTX_DESC_DATA_88XX)pdesc_data; + + if (!(p_dm->support_ability & ODM_BB_ANT_DIV)) + return; + + if (p_dm->ant_div_type == CGCS_RX_HW_ANTDIV) + return; + + if (p_dm->support_ic_type & (ODM_RTL8881A | ODM_RTL8192E | ODM_RTL8814A)) { + /*panic_printk("[%s] [%d] ******odm_set_tx_ant_by_tx_info_hal******\n",__FUNCTION__,__LINE__);*/ + pdescdata->ant_sel = 1; + pdescdata->ant_sel_a = p_dm_fat_table->antsel_a[aid]; + } +} +#endif /*#ifdef CONFIG_WLAN_HAL*/ + +#endif + + +void +odm_ant_div_config( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("WIN Config Antenna Diversity\n")); + /* + if(p_dm->support_ic_type==ODM_RTL8723B) + { + if((!p_dm->dm_swat_table.ANTA_ON || !p_dm->dm_swat_table.ANTB_ON)) + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + } + */ + if (p_dm->support_ic_type == ODM_RTL8723D) { + + p_dm->ant_div_type = S0S1_TRX_HW_ANTDIV; + /**/ + } +#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("CE Config Antenna Diversity\n")); + + if (p_dm->support_ic_type == ODM_RTL8723B) + p_dm->ant_div_type = S0S1_SW_ANTDIV; + + + +#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("AP Config Antenna Diversity\n")); + + /* 2 [ NOT_SUPPORT_ANTDIV ] */ +#if (defined(CONFIG_NOT_SUPPORT_ANTDIV)) + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Disable AntDiv function] : Not Support 2.4G & 5G Antenna Diversity\n")); + + /* 2 [ 2G&5G_SUPPORT_ANTDIV ] */ +#elif (defined(CONFIG_2G5G_SUPPORT_ANTDIV)) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Enable AntDiv function] : 2.4G & 5G Support Antenna Diversity Simultaneously\n")); + p_dm_fat_table->ant_div_2g_5g = (ODM_ANTDIV_2G | ODM_ANTDIV_5G); + + if (p_dm->support_ic_type & ODM_ANTDIV_SUPPORT) + p_dm->support_ability |= ODM_BB_ANT_DIV; + if (*p_dm->p_band_type == ODM_BAND_5G) { +#if (defined(CONFIG_5G_CGCS_RX_DIVERSITY)) + p_dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = CGCS_RX_HW_ANTDIV\n")); + panic_printk("[ 5G] : AntDiv type = CGCS_RX_HW_ANTDIV\n"); +#elif (defined(CONFIG_5G_CG_TRX_DIVERSITY) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) + p_dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); + panic_printk("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) + p_dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = CG_SMART_ANTDIV\n")); +#elif (defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY)) + p_dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n")); +#endif + } else if (*p_dm->p_band_type == ODM_BAND_2_4G) { +#if (defined(CONFIG_2G_CGCS_RX_DIVERSITY)) + p_dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = CGCS_RX_HW_ANTDIV\n")); +#elif (defined(CONFIG_2G_CG_TRX_DIVERSITY) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A)) + p_dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); +#elif (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + p_dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n")); +#elif (defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY)) + p_dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n")); +#endif + } + + /* 2 [ 5G_SUPPORT_ANTDIV ] */ +#elif (defined(CONFIG_5G_SUPPORT_ANTDIV)) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n")); + panic_printk("[ Enable AntDiv function] : Only 5G Support Antenna Diversity\n"); + p_dm_fat_table->ant_div_2g_5g = (ODM_ANTDIV_5G); + if (*p_dm->p_band_type == ODM_BAND_5G) { + if (p_dm->support_ic_type & ODM_ANTDIV_5G_SUPPORT_IC) + p_dm->support_ability |= ODM_BB_ANT_DIV; +#if (defined(CONFIG_5G_CGCS_RX_DIVERSITY)) + p_dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = CGCS_RX_HW_ANTDIV\n")); + panic_printk("[ 5G] : AntDiv type = CGCS_RX_HW_ANTDIV\n"); +#elif (defined(CONFIG_5G_CG_TRX_DIVERSITY)) + p_dm->ant_div_type = CG_TRX_HW_ANTDIV; + panic_printk("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n"); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) + p_dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = CG_SMART_ANTDIV\n")); +#elif (defined(CONFIG_5G_S0S1_SW_ANT_DIVERSITY)) + p_dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 5G] : AntDiv type = S0S1_SW_ANTDIV\n")); +#endif + } else if (*p_dm->p_band_type == ODM_BAND_2_4G) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Not Support 2G ant_div_type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + } + + /* 2 [ 2G_SUPPORT_ANTDIV ] */ +#elif (defined(CONFIG_2G_SUPPORT_ANTDIV)) + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Enable AntDiv function] : Only 2.4G Support Antenna Diversity\n")); + p_dm_fat_table->ant_div_2g_5g = (ODM_ANTDIV_2G); + if (*p_dm->p_band_type == ODM_BAND_2_4G) { + if (p_dm->support_ic_type & ODM_ANTDIV_2G_SUPPORT_IC) + p_dm->support_ability |= ODM_BB_ANT_DIV; +#if (defined(CONFIG_2G_CGCS_RX_DIVERSITY)) + p_dm->ant_div_type = CGCS_RX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = CGCS_RX_HW_ANTDIV\n")); +#elif (defined(CONFIG_2G_CG_TRX_DIVERSITY)) + p_dm->ant_div_type = CG_TRX_HW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = CG_TRX_HW_ANTDIV\n")); +#elif (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + p_dm->ant_div_type = CG_TRX_SMART_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = CG_SMART_ANTDIV\n")); +#elif (defined(CONFIG_2G_S0S1_SW_ANT_DIVERSITY)) + p_dm->ant_div_type = S0S1_SW_ANTDIV; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2.4G] : AntDiv type = S0S1_SW_ANTDIV\n")); +#endif + } else if (*p_dm->p_band_type == ODM_BAND_5G) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Not Support 5G ant_div_type\n")); + p_dm->support_ability &= ~(ODM_BB_ANT_DIV); + } +#endif +#endif + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[AntDiv Config Info] AntDiv_SupportAbility = (( %x ))\n", ((p_dm->support_ability & ODM_BB_ANT_DIV) ? 1 : 0))); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[AntDiv Config Info] be_fix_tx_ant = ((%d))\n", p_dm->dm_fat_table.b_fix_tx_ant)); + +} + + +void +odm_ant_div_timers( + void *p_dm_void, + u8 state +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + if (state == INIT_ANTDIV_TIMMER) { +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_initialize_timer(p_dm, &(p_dm->dm_swat_table.phydm_sw_antenna_switch_timer), + (void *)odm_sw_antdiv_callback, NULL, "phydm_sw_antenna_switch_timer"); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_initialize_timer(p_dm, &p_dm->fast_ant_training_timer, + (void *)odm_fast_ant_training_callback, NULL, "fast_ant_training_timer"); +#endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV + odm_initialize_timer(p_dm, &p_dm->evm_fast_ant_training_timer, + (void *)odm_evm_fast_ant_training_callback, NULL, "evm_fast_ant_training_timer"); +#endif + } else if (state == CANCEL_ANTDIV_TIMMER) { +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_cancel_timer(p_dm, &(p_dm->dm_swat_table.phydm_sw_antenna_switch_timer)); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_cancel_timer(p_dm, &p_dm->fast_ant_training_timer); +#endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV + odm_cancel_timer(p_dm, &p_dm->evm_fast_ant_training_timer); +#endif + } else if (state == RELEASE_ANTDIV_TIMMER) { +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_release_timer(p_dm, &(p_dm->dm_swat_table.phydm_sw_antenna_switch_timer)); +#elif (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + odm_release_timer(p_dm, &p_dm->fast_ant_training_timer); +#endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV + odm_release_timer(p_dm, &p_dm->evm_fast_ant_training_timer); +#endif + } + +} + +void +phydm_antdiv_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + /*struct phydm_fat_struct* p_dm_fat_table = &p_dm->dm_fat_table;*/ + u32 used = *_used; + u32 out_len = *_out_len; + + if (dm_value[0] == 1) { /*fixed or auto antenna*/ + + if (dm_value[1] == 0) { + p_dm->ant_type = ODM_AUTO_ANT; + PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv: Auto\n")); + } else if (dm_value[1] == 1) { + p_dm->ant_type = ODM_FIX_MAIN_ANT; + PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv: Fix Main\n")); + } else if (dm_value[1] == 2) { + p_dm->ant_type = ODM_FIX_AUX_ANT; + PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv: Fix Aux\n")); + } + + if (p_dm->ant_type != ODM_AUTO_ANT) { + + odm_stop_antenna_switch_dm(p_dm); + if (p_dm->ant_type == ODM_FIX_MAIN_ANT) + odm_update_rx_idle_ant(p_dm, MAIN_ANT); + else if (p_dm->ant_type == ODM_FIX_AUX_ANT) + odm_update_rx_idle_ant(p_dm, AUX_ANT); + } else { + phydm_enable_antenna_diversity(p_dm); + } + p_dm->pre_ant_type = p_dm->ant_type; + } else if (dm_value[0] == 2) { /*dynamic period for AntDiv*/ + + p_dm->antdiv_period = (u8)dm_value[1]; + PHYDM_SNPRINTF((output + used, out_len - used, "AntDiv_period = ((%d))\n", p_dm->antdiv_period)); + } + *_used = used; + *_out_len = out_len; +} + +#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ + +void +odm_ant_div_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->ant_div_type == S0S1_SW_ANTDIV) { +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div_reset(p_dm); +#endif + } + +} + +void +odm_antenna_diversity_init( + void *p_dm_void +) +{ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if 0 + if (*(p_dm->p_mp_mode) == true) + return; +#endif + + odm_ant_div_config(p_dm); + odm_ant_div_init(p_dm); +#endif +} + +void +odm_antenna_diversity( + void *p_dm_void +) +{ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (*(p_dm->p_mp_mode) == true) + return; + + if (!(p_dm->support_ability & ODM_BB_ANT_DIV)) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Return!!!] Not Support Antenna Diversity Function\n")); + return; + } + + if (p_dm->pause_ability & ODM_BB_ANT_DIV) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Return: Pause AntDIv in LV=%d\n", p_dm->pause_lv_table.lv_antdiv)); + return; + } + + odm_ant_div(p_dm); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.h index b6b089f6c988..9eb11e85fe87 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_antdiv.h @@ -1,634 +1,607 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMANTDIV_H__ -#define __PHYDMANTDIV_H__ - -/*#define ANTDIV_VERSION "2.0" //2014.11.04*/ -/*#define ANTDIV_VERSION "2.1" //2015.01.13 Dino*/ -/*#define ANTDIV_VERSION "2.2" 2015.01.16 Dino*/ -/*#define ANTDIV_VERSION "3.1" 2015.07.29 YuChen, remove 92c 92d 8723a*/ -/*#define ANTDIV_VERSION "3.2" 2015.08.11 Stanley, disable antenna diversity when BT is enable for 8723B*/ -/*#define ANTDIV_VERSION "3.3" 2015.08.12 Stanley. 8723B does not need to check the antenna is control by BT, - because antenna diversity only works when BT is disable or radio off*/ -/*#define ANTDIV_VERSION "3.4" 2015.08.28 Dino 1.Add 8821A Smart Antenna 2. Add 8188F SW S0S1 Antenna Diversity*/ -/*#define ANTDIV_VERSION "3.5" 2015.10.07 Stanley Always check antenna detection result from BT-coex. for 8723B, not from PHYDM*/ -/*#define ANTDIV_VERSION "3.6"*/ /*2015.11.16 Stanley */ -/*#define ANTDIV_VERSION "3.7"*/ /*2015.11.20 Dino Add SmartAnt FAT Patch */ -/*#define ANTDIV_VERSION "3.8" 2015.12.21 Dino, Add SmartAnt dynamic training packet num */ -#define ANTDIV_VERSION "3.9" /*2016.01.05 Dino, Add SmartAnt cmd for converting single & two smtant, and add cmd for adjust truth table */ - -//1 ============================================================ -//1 Definition -//1 ============================================================ - -#define ANTDIV_INIT 0xff -#define MAIN_ANT 1 /*Ant A or Ant Main or S1*/ -#define AUX_ANT 2 /*AntB or Ant Aux or S0*/ -#define MAX_ANT 3 /* 3 for AP using*/ - -#define ANT1_2G 0 /* = ANT2_5G for 8723D BTG S1 RX S0S1 diversity for 8723D, TX fixed at S1 */ -#define ANT2_2G 1 /* = ANT1_5G for 8723D BTG S0 RX S0S1 diversity for 8723D, TX fixed at S1 */ -/*smart antenna*/ -#define SUPPORT_RF_PATH_NUM 4 -#define SUPPORT_BEAM_PATTERN_NUM 4 -#define NUM_ANTENNA_8821A 2 - -#define NO_FIX_TX_ANT 0 -#define FIX_TX_AT_MAIN 1 -#define FIX_AUX_AT_MAIN 2 - -//Antenna Diversty Control Type -#define ODM_AUTO_ANT 0 -#define ODM_FIX_MAIN_ANT 1 -#define ODM_FIX_AUX_ANT 2 - -#define ODM_N_ANTDIV_SUPPORT (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8195A) -#define ODM_AC_ANTDIV_SUPPORT (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821C) -#define ODM_ANTDIV_SUPPORT (ODM_N_ANTDIV_SUPPORT|ODM_AC_ANTDIV_SUPPORT) -#define ODM_SMART_ANT_SUPPORT (ODM_RTL8188E|ODM_RTL8192E) -#define ODM_HL_SMART_ANT_TYPE1_SUPPORT (ODM_RTL8821) - -#define ODM_ANTDIV_2G_SUPPORT_IC (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8881A|ODM_RTL8188F|ODM_RTL8723D) -#define ODM_ANTDIV_5G_SUPPORT_IC (ODM_RTL8821|ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821C) - -#define ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC (ODM_RTL8192E) - -#define ODM_ANTDIV_2G BIT0 -#define ODM_ANTDIV_5G BIT1 - -#define ANTDIV_ON 1 -#define ANTDIV_OFF 0 - -#define FAT_ON 1 -#define FAT_OFF 0 - -#define TX_BY_DESC 1 -#define TX_BY_REG 0 - -#define RSSI_METHOD 0 -#define EVM_METHOD 1 -#define CRC32_METHOD 2 - -#define INIT_ANTDIV_TIMMER 0 -#define CANCEL_ANTDIV_TIMMER 1 -#define RELEASE_ANTDIV_TIMMER 2 - -#define CRC32_FAIL 1 -#define CRC32_OK 0 - -#define Evm_RSSI_TH_High 25 -#define Evm_RSSI_TH_Low 20 - -#define NORMAL_STATE_MIAN 1 -#define NORMAL_STATE_AUX 2 -#define TRAINING_STATE 3 - -#define FORCE_RSSI_DIFF 10 - -#define CSI_ON 1 -#define CSI_OFF 0 - -#define DIVON_CSIOFF 1 -#define DIVOFF_CSION 2 - -#define BDC_DIV_TRAIN_STATE 0 -#define BDC_BFer_TRAIN_STATE 1 -#define BDC_DECISION_STATE 2 -#define BDC_BF_HOLD_STATE 3 -#define BDC_DIV_HOLD_STATE 4 - -#define BDC_MODE_1 1 -#define BDC_MODE_2 2 -#define BDC_MODE_3 3 -#define BDC_MODE_4 4 -#define BDC_MODE_NULL 0xff - -/*SW S0S1 antenna diversity*/ -#define SWAW_STEP_INIT 0xff -#define SWAW_STEP_PEEK 0 -#define SWAW_STEP_DETERMINE 1 - -#define RSSI_CHECK_RESET_PERIOD 10 -#define RSSI_CHECK_THRESHOLD 50 - -/*Hong Lin Smart antenna*/ -#define HL_SMTANT_2WIRE_DATA_LEN 24 - -//1 ============================================================ -//1 structure -//1 ============================================================ - - -typedef struct _SW_Antenna_Switch_ -{ - u1Byte Double_chk_flag; /*If current antenna RSSI > "RSSI_CHECK_THRESHOLD", than check this antenna again*/ - u1Byte try_flag; - s4Byte PreRSSI; - u1Byte CurAntenna; - u1Byte PreAntenna; - u1Byte RSSI_Trying; - u1Byte reset_idx; - u1Byte Train_time; - u1Byte Train_time_flag; /*base on RSSI difference between two antennas*/ - RT_TIMER phydm_SwAntennaSwitchTimer; - u4Byte PktCnt_SWAntDivByCtrlFrame; - BOOLEAN bSWAntDivByCtrlFrame; - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #if USE_WORKITEM - RT_WORK_ITEM phydm_SwAntennaSwitchWorkitem; - #endif - #endif - - /* AntDect (Before link Antenna Switch check) need to be moved*/ - u2Byte Single_Ant_Counter; - u2Byte Dual_Ant_Counter; - u2Byte Aux_FailDetec_Counter; - u2Byte Retry_Counter; - u1Byte SWAS_NoLink_State; - u4Byte SWAS_NoLink_BK_Reg948; - BOOLEAN ANTA_ON; /*To indicate Ant A is or not*/ - BOOLEAN ANTB_ON; /*To indicate Ant B is on or not*/ - BOOLEAN Pre_Aux_FailDetec; - BOOLEAN RSSI_AntDect_bResult; - u1Byte Ant5G; - u1Byte Ant2G; - - -}SWAT_T, *pSWAT_T; - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) -typedef struct _BF_DIV_COEX_ -{ - BOOLEAN w_BFer_Client[ODM_ASSOCIATE_ENTRY_NUM]; - BOOLEAN w_BFee_Client[ODM_ASSOCIATE_ENTRY_NUM]; - u4Byte MA_rx_TP[ODM_ASSOCIATE_ENTRY_NUM]; - u4Byte MA_rx_TP_DIV[ODM_ASSOCIATE_ENTRY_NUM]; - - u1Byte BDCcoexType_wBfer; - u1Byte num_Txbfee_Client; - u1Byte num_Txbfer_Client; - u1Byte BDC_Try_counter; - u1Byte BDC_Hold_counter; - u1Byte BDC_Mode; - u1Byte BDC_active_Mode; - u1Byte BDC_state; - u1Byte BDC_RxIdleUpdate_counter; - u1Byte num_Client; - u1Byte pre_num_Client; - u1Byte num_BfTar; - u1Byte num_DivTar; - - BOOLEAN bAll_DivSta_Idle; - BOOLEAN bAll_BFSta_Idle; - BOOLEAN BDC_Try_flag; - BOOLEAN BF_pass; - BOOLEAN DIV_pass; -}BDC_T,*pBDC_T; -#endif -#endif - -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 -typedef struct _SMART_ANTENNA_TRAINNING_ { - u4Byte latch_time; - BOOLEAN pkt_skip_statistic_en; - u4Byte fix_beam_pattern_en; - u4Byte fix_training_num_en; - u4Byte fix_beam_pattern_codeword; - u4Byte update_beam_codeword; - u4Byte ant_num; /*number of used smart beam antenna*/ - u4Byte ant_num_total;/*number of total smart beam antenna*/ - u4Byte first_train_ant; /*decide witch antenna to train first*/ - u4Byte rfu_codeword_table[4]; /*2G beam truth table*/ - u4Byte rfu_codeword_table_5g[4]; /*5G beam truth table*/ - u4Byte beam_patten_num_each_ant;/*number of beam can be switched in each antenna*/ - u4Byte data_codeword_bit_num; - u1Byte per_beam_training_pkt_num; - u1Byte decision_holding_period; - u1Byte pkt_counter; - u4Byte fast_training_beam_num; - u4Byte pre_fast_training_beam_num; - u4Byte pkt_rssi_pre[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; - u1Byte beam_train_cnt[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; - u1Byte beam_train_rssi_diff[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; - u4Byte pkt_rssi_sum[8][SUPPORT_BEAM_PATTERN_NUM]; - u4Byte pkt_rssi_cnt[8][SUPPORT_BEAM_PATTERN_NUM]; - u4Byte rx_idle_beam[SUPPORT_RF_PATH_NUM]; - u4Byte pre_codeword; - BOOLEAN force_update_beam_en; - u4Byte beacon_counter; - u4Byte pre_beacon_counter; - u1Byte update_beam_idx; - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_WORK_ITEM hl_smart_antenna_workitem; - RT_WORK_ITEM hl_smart_antenna_decision_workitem; - #endif - -} SAT_T, *pSAT_T; -#endif - -typedef struct _FAST_ANTENNA_TRAINNING_ -{ - u1Byte Bssid[6]; - u1Byte antsel_rx_keep_0; - u1Byte antsel_rx_keep_1; - u1Byte antsel_rx_keep_2; - u1Byte antsel_rx_keep_3; - u4Byte antSumRSSI[7]; - u4Byte antRSSIcnt[7]; - u4Byte antAveRSSI[7]; - u1Byte FAT_State; - u4Byte TrainIdx; - u1Byte antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; - u1Byte antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; - u1Byte antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte MainAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte AuxAnt_Sum[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte MainAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte AuxAnt_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte MainAnt_Sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte AuxAnt_Sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte MainAnt_Cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte AuxAnt_Cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; - u1Byte RxIdleAnt; - u1Byte AntDiv_OnOff; - BOOLEAN bBecomeLinked; - u4Byte MinMaxRSSI; - u1Byte idx_AntDiv_counter_2G; - u1Byte idx_AntDiv_counter_5G; - u1Byte AntDiv_2G_5G; - u4Byte CCK_counter_main; - u4Byte CCK_counter_aux; - u4Byte OFDM_counter_main; - u4Byte OFDM_counter_aux; - - #ifdef ODM_EVM_ENHANCE_ANTDIV - u4Byte MainAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; - u4Byte AuxAntEVM_Sum[ODM_ASSOCIATE_ENTRY_NUM]; - u4Byte MainAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; - u4Byte AuxAntEVM_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; - BOOLEAN EVM_method_enable; - u1Byte TargetAnt_EVM; - u1Byte TargetAnt_CRC32; - u1Byte TargetAnt_enhance; - u1Byte pre_TargetAnt_enhance; - u2Byte Main_MPDU_OK_cnt; - u2Byte Aux_MPDU_OK_cnt; - - u4Byte CRC32_Ok_Cnt; - u4Byte CRC32_Fail_Cnt; - u4Byte MainCRC32_Ok_Cnt; - u4Byte AuxCRC32_Ok_Cnt; - u4Byte MainCRC32_Fail_Cnt; - u4Byte AuxCRC32_Fail_Cnt; - #endif - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - u4Byte CCK_CtrlFrame_Cnt_main; - u4Byte CCK_CtrlFrame_Cnt_aux; - u4Byte OFDM_CtrlFrame_Cnt_main; - u4Byte OFDM_CtrlFrame_Cnt_aux; - u4Byte MainAnt_CtrlFrame_Sum; - u4Byte AuxAnt_CtrlFrame_Sum; - u4Byte MainAnt_CtrlFrame_Cnt; - u4Byte AuxAnt_CtrlFrame_Cnt; - #endif - u1Byte b_fix_tx_ant; - BOOLEAN fix_ant_bfee; - BOOLEAN enable_ctrl_frame_antdiv; - BOOLEAN use_ctrl_frame_antdiv; - u1Byte hw_antsw_occur; - u1Byte *pForceTxAntByDesc; - u1Byte ForceTxAntByDesc; /*A temp value, will hook to driver team's outer parameter later*/ - u1Byte *pDefaultS0S1; - u1Byte DefaultS0S1; -}FAT_T,*pFAT_T; - - -//1 ============================================================ -//1 enumeration -//1 ============================================================ - - - -typedef enum _FAT_STATE /*Fast antenna training*/ -{ - FAT_BEFORE_LINK_STATE = 0, - FAT_PREPARE_STATE = 1, - FAT_TRAINING_STATE = 2, - FAT_DECISION_STATE = 3 -}FAT_STATE_E, *PFAT_STATE_E; - -typedef enum _ANT_DIV_TYPE -{ - NO_ANTDIV = 0xFF, - CG_TRX_HW_ANTDIV = 0x01, - CGCS_RX_HW_ANTDIV = 0x02, - FIXED_HW_ANTDIV = 0x03, - CG_TRX_SMART_ANTDIV = 0x04, - CGCS_RX_SW_ANTDIV = 0x05, - S0S1_SW_ANTDIV = 0x06, /*8723B intrnal switch S0 S1*/ - S0S1_TRX_HW_ANTDIV = 0x07, /*TRX S0S1 diversity for 8723D*/ - HL_SW_SMART_ANT_TYPE1 = 0x10 /*Hong-Lin Smart antenna use for 8821AE which is a 2 Ant. entitys, and each Ant. is equipped with 4 antenna patterns*/ -}ANT_DIV_TYPE_E, *PANT_DIV_TYPE_E; - - -//1 ============================================================ -//1 function prototype -//1 ============================================================ - - -VOID -ODM_StopAntennaSwitchDm( - IN PVOID pDM_VOID - ); - -VOID -phydm_enable_antenna_diversity( - IN PVOID pDM_VOID - ); - -VOID -ODM_SetAntConfig( - IN PVOID pDM_VOID, - IN u1Byte antSetting // 0=A, 1=B, 2=C, .... - ); - - -#define SwAntDivRestAfterLink ODM_SwAntDivRestAfterLink - -VOID ODM_SwAntDivRestAfterLink( - IN PVOID pDM_VOID - ); - -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - -VOID -ODM_UpdateRxIdleAnt( - IN PVOID pDM_VOID, - IN u1Byte Ant -); - -#if (RTL8723B_SUPPORT == 1) -VOID -ODM_UpdateRxIdleAnt_8723B( - IN PVOID pDM_VOID, - IN u1Byte Ant, - IN u4Byte DefaultAnt, - IN u4Byte OptionalAnt -); -#endif - -#if (RTL8188F_SUPPORT == 1) -VOID -phydm_update_rx_idle_antenna_8188F( - IN PVOID pDM_VOID, - IN u4Byte default_ant -); -#endif - -#if (RTL8723D_SUPPORT == 1) - -VOID -phydm_set_tx_ant_pwr_8723d( - IN PVOID pDM_VOID, - IN u1Byte Ant -); - -#endif - -#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -ODM_SW_AntDiv_Callback( - IN PRT_TIMER pTimer - ); - -VOID -ODM_SW_AntDiv_WorkitemCallback( - IN PVOID pContext - ); - - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - -VOID -ODM_SW_AntDiv_WorkitemCallback( - IN PVOID pContext -); - -VOID -ODM_SW_AntDiv_Callback( - void *FunctionContext - ); - -#endif - -VOID -odm_S0S1_SwAntDivByCtrlFrame( - IN PVOID pDM_VOID, - IN u1Byte Step -); - -VOID -odm_AntselStatisticsOfCtrlFrame( - IN PVOID pDM_VOID, - IN u1Byte antsel_tr_mux, - IN u4Byte RxPWDBAll -); - -VOID -odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI( - IN PVOID pDM_VOID, - IN PVOID p_phy_info_void, - IN PVOID p_pkt_info_void -); - -#endif - -#ifdef ODM_EVM_ENHANCE_ANTDIV -VOID -odm_EVM_FastAntTrainingCallback( - IN PVOID pDM_VOID -); -#endif - -VOID -odm_HW_AntDiv( - IN PVOID pDM_VOID -); - -#if( defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY) ) ||( defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY) ) -VOID -odm_FastAntTraining( - IN PVOID pDM_VOID -); - -VOID -odm_FastAntTrainingCallback( - IN PVOID pDM_VOID -); - -VOID -odm_FastAntTrainingWorkItemCallback( - IN PVOID pDM_VOID -); -#endif - - -#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -phydm_beam_switch_workitem_callback( - IN PVOID pContext - ); - -VOID -phydm_beam_decision_workitem_callback( - IN PVOID pContext - ); - -#endif - -VOID -phydm_update_beam_pattern( - IN PVOID pDM_VOID, - IN u4Byte codeword, - IN u4Byte codeword_length - ); - -void -phydm_set_all_ant_same_beam_num( - IN PVOID pDM_VOID - ); - -VOID -phydm_hl_smart_ant_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -); - -#endif/*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ - -VOID -ODM_AntDivInit( - IN PVOID pDM_VOID -); - -VOID -ODM_AntDiv( - IN PVOID pDM_VOID -); - -VOID -odm_AntselStatistics( - IN PVOID pDM_VOID, - IN u1Byte antsel_tr_mux, - IN u4Byte MacId, - IN u4Byte utility, - IN u1Byte method, - IN u1Byte isCCKrate -); - -VOID -ODM_Process_RSSIForAntDiv( - IN OUT PVOID pDM_VOID, - IN PVOID p_phy_info_void, - IN PVOID p_pkt_info_void -); - - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -VOID -ODM_SetTxAntByTxInfo( - IN PVOID pDM_VOID, - IN pu1Byte pDesc, - IN u1Byte macId -); - -#elif(DM_ODM_SUPPORT_TYPE == ODM_AP) - -struct tx_desc; /*declared tx_desc here or compile error happened when enabled 8822B*/ - -VOID -ODM_SetTxAntByTxInfo( - struct rtl8192cd_priv *priv, - struct tx_desc *pdesc, - unsigned short aid -); - -#if 1/*def def CONFIG_WLAN_HAL*/ -VOID -ODM_SetTxAntByTxInfo_HAL( - struct rtl8192cd_priv *priv, - PVOID pdesc_data, - u2Byte aid -); -#endif /*#ifdef CONFIG_WLAN_HAL*/ -#endif - - -VOID -ODM_AntDiv_Config( - IN PVOID pDM_VOID -); - -VOID -ODM_AntDivTimers( - IN PVOID pDM_VOID, - IN u1Byte state -); - -VOID -phydm_antdiv_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -); - -#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ - -VOID -ODM_AntDivReset( - IN PVOID pDM_VOID -); - -VOID -odm_AntennaDiversityInit( - IN PVOID pDM_VOID -); - -VOID -odm_AntennaDiversity( - IN PVOID pDM_VOID -); - -#endif /*#ifndef __ODMANTDIV_H__*/ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMANTDIV_H__ +#define __PHYDMANTDIV_H__ + +/*#define ANTDIV_VERSION "2.0" //2014.11.04*/ +/*#define ANTDIV_VERSION "2.1" //2015.01.13 Dino*/ +/*#define ANTDIV_VERSION "2.2" 2015.01.16 Dino*/ +/*#define ANTDIV_VERSION "3.1" 2015.07.29 YuChen, remove 92c 92d 8723a*/ +/*#define ANTDIV_VERSION "3.2" 2015.08.11 Stanley, disable antenna diversity when BT is enable for 8723B*/ +/*#define ANTDIV_VERSION "3.3" 2015.08.12 Stanley. 8723B does not need to check the antenna is control by BT, + because antenna diversity only works when BT is disable or radio off*/ +/*#define ANTDIV_VERSION "3.4" 2015.08.28 Dino 1.Add 8821A Smart Antenna 2. Add 8188F SW S0S1 Antenna Diversity*/ +/*#define ANTDIV_VERSION "3.5" 2015.10.07 Stanley Always check antenna detection result from BT-coex. for 8723B, not from PHYDM*/ +/*#define ANTDIV_VERSION "3.6"*/ /*2015.11.16 Stanley */ +/*#define ANTDIV_VERSION "3.7"*/ /*2015.11.20 Dino Add SmartAnt FAT Patch */ +/*#define ANTDIV_VERSION "3.8" 2015.12.21 Dino, Add SmartAnt dynamic training packet num */ +/*#define ANTDIV_VERSION "3.9" 2016.01.05 Dino, Add SmartAnt cmd for converting single & two smtant, and add cmd for adjust truth table */ +#define ANTDIV_VERSION "4.0" /*2017.05.25 Mark, Add SW antenna diversity for 8821c because HW transient issue */ + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + +#define ANTDIV_INIT 0xff +#define MAIN_ANT 1 /*ant A or ant Main or S1*/ +#define AUX_ANT 2 /*AntB or ant Aux or S0*/ +#define MAX_ANT 3 /* 3 for AP using*/ + +#define ANT1_2G 0 /* = ANT2_5G for 8723D BTG S1 RX S0S1 diversity for 8723D, TX fixed at S1 */ +#define ANT2_2G 1 /* = ANT1_5G for 8723D BTG S0 RX S0S1 diversity for 8723D, TX fixed at S1 */ +/*smart antenna*/ +#define SUPPORT_RF_PATH_NUM 4 +#define SUPPORT_BEAM_PATTERN_NUM 4 +#define NUM_ANTENNA_8821A 2 + +#define SUPPORT_BEAM_SET_PATTERN_NUM 16 + +#define NO_FIX_TX_ANT 0 +#define FIX_TX_AT_MAIN 1 +#define FIX_AUX_AT_MAIN 2 + +/* Antenna Diversty Control type */ +#define ODM_AUTO_ANT 0 +#define ODM_FIX_MAIN_ANT 1 +#define ODM_FIX_AUX_ANT 2 + +#define ODM_N_ANTDIV_SUPPORT (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8188F | ODM_RTL8723D | ODM_RTL8195A) +#define ODM_AC_ANTDIV_SUPPORT (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8812 | ODM_RTL8821C | ODM_RTL8822B | ODM_RTL8814B) +#define ODM_ANTDIV_SUPPORT (ODM_N_ANTDIV_SUPPORT | ODM_AC_ANTDIV_SUPPORT) +#define ODM_SMART_ANT_SUPPORT (ODM_RTL8188E | ODM_RTL8192E) +#define ODM_HL_SMART_ANT_TYPE1_SUPPORT (ODM_RTL8821 | ODM_RTL8822B) + +#define ODM_ANTDIV_2G_SUPPORT_IC (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8881A | ODM_RTL8188F | ODM_RTL8723D) +#define ODM_ANTDIV_5G_SUPPORT_IC (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8812 | ODM_RTL8821C) + +#define ODM_EVM_ENHANCE_ANTDIV_SUPPORT_IC (ODM_RTL8192E) + +#define ODM_ANTDIV_2G BIT(0) +#define ODM_ANTDIV_5G BIT(1) + +#define ANTDIV_ON 1 +#define ANTDIV_OFF 0 + +#define FAT_ON 1 +#define FAT_OFF 0 + +#define TX_BY_DESC 1 +#define TX_BY_REG 0 + +#define RSSI_METHOD 0 +#define EVM_METHOD 1 +#define CRC32_METHOD 2 +#define TP_METHOD 3 + +#define INIT_ANTDIV_TIMMER 0 +#define CANCEL_ANTDIV_TIMMER 1 +#define RELEASE_ANTDIV_TIMMER 2 + +#define CRC32_FAIL 1 +#define CRC32_OK 0 + +#define evm_rssi_th_high 25 +#define evm_rssi_th_low 20 + +#define NORMAL_STATE_MIAN 1 +#define NORMAL_STATE_AUX 2 +#define TRAINING_STATE 3 + +#define FORCE_RSSI_DIFF 10 + +#define CSI_ON 1 +#define CSI_OFF 0 + +#define DIVON_CSIOFF 1 +#define DIVOFF_CSION 2 + +#define BDC_DIV_TRAIN_STATE 0 +#define bdc_bfer_train_state 1 +#define BDC_DECISION_STATE 2 +#define BDC_BF_HOLD_STATE 3 +#define BDC_DIV_HOLD_STATE 4 + +#define BDC_MODE_1 1 +#define BDC_MODE_2 2 +#define BDC_MODE_3 3 +#define BDC_MODE_4 4 +#define BDC_MODE_NULL 0xff + +/*SW S0S1 antenna diversity*/ +#define SWAW_STEP_INIT 0xff +#define SWAW_STEP_PEEK 0 +#define SWAW_STEP_DETERMINE 1 + +#define RSSI_CHECK_RESET_PERIOD 10 +#define RSSI_CHECK_THRESHOLD 50 + +/*Hong Lin Smart antenna*/ +#define HL_SMTANT_2WIRE_DATA_LEN 24 + +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + + +struct _sw_antenna_switch_ { + u8 double_chk_flag; /*If current antenna RSSI > "RSSI_CHECK_THRESHOLD", than check this antenna again*/ + u8 try_flag; + s32 pre_rssi; + u8 cur_antenna; + u8 pre_antenna; + u8 rssi_trying; + u8 reset_idx; + u8 train_time; + u8 train_time_flag; /*base on RSSI difference between two antennas*/ + struct timer_list phydm_sw_antenna_switch_timer; + u32 pkt_cnt_sw_ant_div_by_ctrl_frame; + boolean is_sw_ant_div_by_ctrl_frame; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if USE_WORKITEM + RT_WORK_ITEM phydm_sw_antenna_switch_workitem; +#endif +#endif + + /* AntDect (Before link Antenna Switch check) need to be moved*/ + u16 single_ant_counter; + u16 dual_ant_counter; + u16 aux_fail_detec_counter; + u16 retry_counter; + u8 swas_no_link_state; + u32 swas_no_link_bk_reg948; + boolean ANTA_ON; /*To indicate ant A is or not*/ + boolean ANTB_ON; /*To indicate ant B is on or not*/ + boolean pre_aux_fail_detec; + boolean rssi_ant_dect_result; + u8 ant_5g; + u8 ant_2g; + + +}; + + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) +struct _BF_DIV_COEX_ { + boolean w_bfer_client[ODM_ASSOCIATE_ENTRY_NUM]; + boolean w_bfee_client[ODM_ASSOCIATE_ENTRY_NUM]; + u32 MA_rx_TP[ODM_ASSOCIATE_ENTRY_NUM]; + u32 MA_rx_TP_DIV[ODM_ASSOCIATE_ENTRY_NUM]; + + u8 bd_ccoex_type_wbfer; + u8 num_txbfee_client; + u8 num_txbfer_client; + u8 bdc_try_counter; + u8 bdc_hold_counter; + u8 bdc_mode; + u8 bdc_active_mode; + u8 BDC_state; + u8 bdc_rx_idle_update_counter; + u8 num_client; + u8 pre_num_client; + u8 num_bf_tar; + u8 num_div_tar; + + boolean is_all_div_sta_idle; + boolean is_all_bf_sta_idle; + boolean bdc_try_flag; + boolean BF_pass; + boolean DIV_pass; +}; +#endif +#endif + + +struct phydm_fat_struct { + u8 bssid[6]; + u8 antsel_rx_keep_0; + u8 antsel_rx_keep_1; + u8 antsel_rx_keep_2; + u8 antsel_rx_keep_3; + u32 ant_sum_rssi[7]; + u32 ant_rssi_cnt[7]; + u32 ant_ave_rssi[7]; + u8 fat_state; + u8 fat_state_cnt; + u32 train_idx; + u8 antsel_a[ODM_ASSOCIATE_ENTRY_NUM]; + u8 antsel_b[ODM_ASSOCIATE_ENTRY_NUM]; + u8 antsel_c[ODM_ASSOCIATE_ENTRY_NUM]; + u16 main_ant_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_ant_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u16 main_ant_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_ant_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u16 main_ant_sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_ant_sum_cck[ODM_ASSOCIATE_ENTRY_NUM]; + u16 main_ant_cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; + u16 aux_ant_cnt_cck[ODM_ASSOCIATE_ENTRY_NUM]; + u8 rx_idle_ant; + u8 rvrt_val; + u8 ant_div_on_off; + boolean is_become_linked; + u32 min_max_rssi; + u8 idx_ant_div_counter_2g; + u8 idx_ant_div_counter_5g; + u8 ant_div_2g_5g; + +#ifdef ODM_EVM_ENHANCE_ANTDIV + /*For 1SS RX phy rate*/ + u32 main_ant_evm_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u32 aux_ant_evm_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u32 main_ant_evm_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u32 aux_ant_evm_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + + /*For 2SS RX phy rate*/ + u32 main_ant_evm_2ss_sum[ODM_ASSOCIATE_ENTRY_NUM][2]; /*2SS with A1+B*/ + u32 aux_ant_evm_2ss_sum[ODM_ASSOCIATE_ENTRY_NUM][2]; /*2SS with A2+B*/ + u32 main_ant_evm_2ss_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u32 aux_ant_evm_2ss_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + + boolean EVM_method_enable; + u8 target_ant_evm; + u8 target_ant_crc32; + u8 target_ant_tp; + u8 target_ant_enhance; + u8 pre_target_ant_enhance; + u16 main_mpdu_ok_cnt; + u16 aux_mpdu_ok_cnt; + + u32 crc32_ok_cnt; + u32 crc32_fail_cnt; + u32 main_crc32_ok_cnt; + u32 aux_crc32_ok_cnt; + u32 main_crc32_fail_cnt; + u32 aux_crc32_fail_cnt; + + u32 antdiv_tp_main; + u32 antdiv_tp_aux; + u32 antdiv_tp_main_cnt; + u32 antdiv_tp_aux_cnt; + + u8 pre_antdiv_rssi; + u8 pre_antdiv_tp; +#endif +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + u32 cck_ctrl_frame_cnt_main; + u32 cck_ctrl_frame_cnt_aux; + u32 ofdm_ctrl_frame_cnt_main; + u32 ofdm_ctrl_frame_cnt_aux; + u32 main_ant_ctrl_frame_sum; + u32 aux_ant_ctrl_frame_sum; + u32 main_ant_ctrl_frame_cnt; + u32 aux_ant_ctrl_frame_cnt; +#endif + u8 b_fix_tx_ant; + boolean fix_ant_bfee; + boolean enable_ctrl_frame_antdiv; + boolean use_ctrl_frame_antdiv; + boolean *is_no_csi_feedback; + u8 hw_antsw_occur; + u8 *p_force_tx_ant_by_desc; + u8 force_tx_ant_by_desc; /*A temp value, will hook to driver team's outer parameter later*/ + u8 *p_default_s0_s1; + u8 default_s0_s1; +}; + + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + + + +enum fat_state_e /*Fast antenna training*/ +{ + FAT_BEFORE_LINK_STATE = 0, + FAT_PREPARE_STATE = 1, + FAT_TRAINING_STATE = 2, + FAT_DECISION_STATE = 3 +}; + +enum ant_div_type_e { + NO_ANTDIV = 0xFF, + CG_TRX_HW_ANTDIV = 0x01, + CGCS_RX_HW_ANTDIV = 0x02, + FIXED_HW_ANTDIV = 0x03, + CG_TRX_SMART_ANTDIV = 0x04, + CGCS_RX_SW_ANTDIV = 0x05, + S0S1_SW_ANTDIV = 0x06, /*8723B intrnal switch S0 S1*/ + S0S1_TRX_HW_ANTDIV = 0x07, /*TRX S0S1 diversity for 8723D*/ + HL_SW_SMART_ANT_TYPE1 = 0x10, /*Hong-Lin Smart antenna use for 8821AE which is a 2 ant. entitys, and each ant. is equipped with 4 antenna patterns*/ + HL_SW_SMART_ANT_TYPE2 = 0x11 /*Hong-Bo Smart antenna use for 8822B which is a 2 ant. entitys*/ +}; + + +/* 1 ============================================================ + * 1 function prototype + * 1 ============================================================ */ + + +void +odm_stop_antenna_switch_dm( + void *p_dm_void +); + +void +phydm_enable_antenna_diversity( + void *p_dm_void +); + +void +odm_set_ant_config( + void *p_dm_void, + u8 ant_setting /* 0=A, 1=B, 2=C, .... */ +); + + +#define sw_ant_div_rest_after_link odm_sw_ant_div_rest_after_link + +void odm_sw_ant_div_rest_after_link( + void *p_dm_void +); + +void +odm_ant_div_on_off( + void *p_dm_void, + u8 swch +); + +void +odm_tx_by_tx_desc_or_reg( + void *p_dm_void, + u8 swch +); + +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + +void +phydm_antdiv_reset_statistic( + void *p_dm_void, + u32 macid +); + +void +odm_update_rx_idle_ant( + void *p_dm_void, + u8 ant +); + +void +phydm_set_antdiv_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +); + +#if (RTL8723B_SUPPORT == 1) +void +odm_update_rx_idle_ant_8723b( + void *p_dm_void, + u8 ant, + u32 default_ant, + u32 optional_ant +); +#endif + +#if (RTL8188F_SUPPORT == 1) +void +phydm_update_rx_idle_antenna_8188F( + void *p_dm_void, + u32 default_ant +); +#endif + +#if (RTL8723D_SUPPORT == 1) + +void +phydm_set_tx_ant_pwr_8723d( + void *p_dm_void, + u8 ant +); + +void +odm_update_rx_idle_ant_8723d( + void *p_dm_void, + u8 ant, + u32 default_ant, + u32 optional_ant +); + +#endif + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +odm_sw_antdiv_callback( + struct timer_list *p_timer +); + +void +odm_sw_antdiv_workitem_callback( + void *p_context +); + + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + +void +odm_sw_antdiv_workitem_callback( + void *p_context +); + +void +odm_sw_antdiv_callback( + void *function_context +); + +#endif + +void +odm_s0s1_sw_ant_div_by_ctrl_frame( + void *p_dm_void, + u8 step +); + +void +odm_antsel_statistics_of_ctrl_frame( + void *p_dm_void, + u8 antsel_tr_mux, + u32 rx_pwdb_all +); + +void +odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void +); + +#endif + +#ifdef ODM_EVM_ENHANCE_ANTDIV +VOID +phydm_evm_sw_antdiv_init( + void *p_dm_void +); + +void +odm_evm_fast_ant_training_callback( + void *p_dm_void +); +#endif + +void +odm_hw_ant_div( + void *p_dm_void +); + +#if (defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) || (defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) +void +odm_fast_ant_training( + void *p_dm_void +); + +void +odm_fast_ant_training_callback( + void *p_dm_void +); + +void +odm_fast_ant_training_work_item_callback( + void *p_dm_void +); +#endif + +void +odm_ant_div_init( + void *p_dm_void +); + +void +odm_ant_div( + void *p_dm_void +); + +void +odm_antsel_statistics( + void *p_dm_void, + void *p_phy_info_void, + u8 antsel_tr_mux, + u32 mac_id, + u32 utility, + u8 method, + u8 is_cck_rate +); + +void +odm_process_rssi_for_ant_div( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void +); + + + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void +odm_set_tx_ant_by_tx_info( + void *p_dm_void, + u8 *p_desc, + u8 mac_id +); + +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + +struct tx_desc; /*declared tx_desc here or compile error happened when enabled 8822B*/ + +void +odm_set_tx_ant_by_tx_info( + struct rtl8192cd_priv *priv, + struct tx_desc *pdesc, + unsigned short aid +); + +#if 1/*def def CONFIG_WLAN_HAL*/ +void +odm_set_tx_ant_by_tx_info_hal( + struct rtl8192cd_priv *priv, + void *pdesc_data, + u16 aid +); +#endif /*#ifdef CONFIG_WLAN_HAL*/ +#endif + + +void +odm_ant_div_config( + void *p_dm_void +); + +void +odm_ant_div_timers( + void *p_dm_void, + u8 state +); + +void +phydm_antdiv_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +#endif /*#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY))*/ + +void +odm_ant_div_reset( + void *p_dm_void +); + +void +odm_antenna_diversity_init( + void *p_dm_void +); + +void +odm_antenna_diversity( + void *p_dm_void +); + +#endif /*#ifndef __ODMANTDIV_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.c new file mode 100644 index 000000000000..b23a0ccf445e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.c @@ -0,0 +1,1185 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + + +void +phydm_init_trx_antenna_setting( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & (ODM_RTL8814A)) { + u8 rx_ant = 0, tx_ant = 0; + + rx_ant = (u8)odm_get_bb_reg(p_dm, ODM_REG(BB_RX_PATH, p_dm), ODM_BIT(BB_RX_PATH, p_dm)); + tx_ant = (u8)odm_get_bb_reg(p_dm, ODM_REG(BB_TX_PATH, p_dm), ODM_BIT(BB_TX_PATH, p_dm)); + p_dm->tx_ant_status = (tx_ant & 0xf); + p_dm->rx_ant_status = (rx_ant & 0xf); + } else if (p_dm->support_ic_type & (ODM_RTL8723D | ODM_RTL8821C | ODM_RTL8710B)) {/* JJ ADD 20161014 */ + p_dm->tx_ant_status = 0x1; + p_dm->rx_ant_status = 0x1; + + } +} + +void +phydm_config_ofdm_tx_path( + void *p_dm_void, + u32 path +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) + u8 ofdm_tx_path = 0x33; +#endif + +#if (RTL8192E_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8192E)) { + + if (path == BB_PATH_A) { + odm_set_bb_reg(p_dm, 0x90c, MASKDWORD, 0x81121111); + /**/ + } else if (path == BB_PATH_B) { + odm_set_bb_reg(p_dm, 0x90c, MASKDWORD, 0x82221222); + /**/ + } else if (path == BB_PATH_AB) { + odm_set_bb_reg(p_dm, 0x90c, MASKDWORD, 0x83321333); + /**/ + } + + + } +#endif + +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8812)) { + + if (path == BB_PATH_A) { + ofdm_tx_path = 0x11; + /**/ + } else if (path == BB_PATH_B) { + ofdm_tx_path = 0x22; + /**/ + } else if (path == BB_PATH_AB) { + ofdm_tx_path = 0x33; + /**/ + } + + odm_set_bb_reg(p_dm, 0x80c, 0xff00, ofdm_tx_path); + } +#endif +} + +void +phydm_config_ofdm_rx_path( + void *p_dm_void, + u32 path +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 ofdm_rx_path = 0; + + + if (p_dm->support_ic_type & (ODM_RTL8192E)) { +#if (RTL8192E_SUPPORT == 1) + if (path == BB_PATH_A) { + ofdm_rx_path = 1; + /**/ + } else if (path == BB_PATH_B) { + ofdm_rx_path = 2; + /**/ + } else if (path == BB_PATH_AB) { + ofdm_rx_path = 3; + /**/ + } + + odm_set_bb_reg(p_dm, 0xC04, 0xff, (((ofdm_rx_path) << 4) | ofdm_rx_path)); + odm_set_bb_reg(p_dm, 0xD04, 0xf, ofdm_rx_path); +#endif + } +#if (RTL8812A_SUPPORT || RTL8822B_SUPPORT) + else if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) { + + if (path == BB_PATH_A) { + ofdm_rx_path = 1; + /**/ + } else if (path == BB_PATH_B) { + ofdm_rx_path = 2; + /**/ + } else if (path == BB_PATH_AB) { + ofdm_rx_path = 3; + /**/ + } + + odm_set_bb_reg(p_dm, 0x808, MASKBYTE0, ((ofdm_rx_path << 4) | ofdm_rx_path)); + } +#endif +} + +void +phydm_config_cck_rx_antenna_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if (defined(PHYDM_COMPILE_ABOVE_2SS)) + /*CCK 2R CCA parameters*/ + odm_set_bb_reg(p_dm, 0xa00, BIT(15), 0x0); /*Disable antenna diversity*/ + odm_set_bb_reg(p_dm, 0xa70, BIT(7), 0); /*Concurrent CCA at LSB & USB*/ + odm_set_bb_reg(p_dm, 0xa74, BIT(8), 0); /*RX path diversity enable*/ + odm_set_bb_reg(p_dm, 0xa14, BIT(7), 0); /*r_en_mrc_antsel*/ + odm_set_bb_reg(p_dm, 0xa20, (BIT(5) | BIT(4)), 1); /*MBC weighting*/ + + if (p_dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8197F)) { + odm_set_bb_reg(p_dm, 0xa08, BIT(28), 1); /*r_cck_2nd_sel_eco*/ + /**/ + } else if (p_dm->support_ic_type & ODM_RTL8814A) { + odm_set_bb_reg(p_dm, 0xa84, BIT(28), 1); /*2R CCA only*/ + /**/ + } +#endif +} + +void +phydm_config_cck_rx_path( + void *p_dm_void, + enum bb_path path +) +{ +#if (defined(PHYDM_COMPILE_ABOVE_2SS)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 path_div_select = 0; + u8 cck_path[2] = {0}; + u8 en_2R_path = 0; + u8 en_2R_mrc = 0; + u8 i = 0, j =0; + u8 num_enable_path = 0; + u8 cck_mrc_max_path = 2; + + for (i = 0; i < 4; i++) { + if (path & BIT(i)) { /*ex: PHYDM_ABCD*/ + num_enable_path++; + cck_path[j] = i; + j++; + } + if (num_enable_path >= cck_mrc_max_path) + break; + } + + if (num_enable_path > 1) { + path_div_select = 1; + en_2R_path = 1; + en_2R_mrc = 1; + } else { + path_div_select = 0; + en_2R_path = 0; + en_2R_mrc = 0; + } + + odm_set_bb_reg(p_dm, 0xa04, (BIT(27) | BIT(26)), cck_path[0]); /*CCK_1 input signal path*/ + odm_set_bb_reg(p_dm, 0xa04, (BIT(25) | BIT(24)), cck_path[1]); /*CCK_2 input signal path*/ + odm_set_bb_reg(p_dm, 0xa74, BIT(8), path_div_select); /*enable Rx path diversity*/ + odm_set_bb_reg(p_dm, 0xa2c, BIT(18), en_2R_path); /*enable 2R Rx path*/ + odm_set_bb_reg(p_dm, 0xa2c, BIT(22), en_2R_mrc); /*enable 2R MRC*/ + +#endif +} + +void +phydm_config_trx_path( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + /* CCK */ + if (dm_value[0] == 0) { + + if (dm_value[1] == 1) { /*TX*/ + if (dm_value[2] == 1) + odm_set_bb_reg(p_dm, 0xa04, 0xf0000000, 0x8); + else if (dm_value[2] == 2) + odm_set_bb_reg(p_dm, 0xa04, 0xf0000000, 0x4); + else if (dm_value[2] == 3) + odm_set_bb_reg(p_dm, 0xa04, 0xf0000000, 0xc); + } else if (dm_value[1] == 2) { /*RX*/ + + phydm_config_cck_rx_antenna_init(p_dm); + + if (dm_value[2] == 1) + phydm_config_cck_rx_path(p_dm, BB_PATH_A); + else if (dm_value[2] == 2) + phydm_config_cck_rx_path(p_dm, BB_PATH_B); + else if (dm_value[2] == 3) { + phydm_config_cck_rx_path(p_dm, BB_PATH_AB); + } + } + } + /* OFDM */ + else if (dm_value[0] == 1) { + + if (dm_value[1] == 1) { /*TX*/ + phydm_config_ofdm_tx_path(p_dm, dm_value[2]); + /**/ + } else if (dm_value[1] == 2) { /*RX*/ + phydm_config_ofdm_rx_path(p_dm, dm_value[2]); + /**/ + } + } + + PHYDM_SNPRINTF((output + used, out_len - used, "PHYDM Set path [%s] [%s] = [%s%s%s%s]\n", + (dm_value[0] == 1) ? "OFDM" : "CCK", + (dm_value[1] == 1) ? "TX" : "RX", + (dm_value[2] & 0x1) ? "A" : "", + (dm_value[2] & 0x2) ? "B" : "", + (dm_value[2] & 0x4) ? "C" : "", + (dm_value[2] & 0x8) ? "D" : "" + )); + +} + +void +phydm_stop_3_wire( + void *p_dm_void, + u8 set_type +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (set_type == PHYDM_SET) { + + /*[Stop 3-wires]*/ + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(p_dm, 0xc00, 0xf, 0x4);/* hardware 3-wire off */ + odm_set_bb_reg(p_dm, 0xe00, 0xf, 0x4);/* hardware 3-wire off */ + } else { + odm_set_bb_reg(p_dm, 0x88c, 0xf00000, 0xf); /* 3 wire Disable 88c[23:20]=0xf */ + } + + } else { /*if (set_type == PHYDM_REVERT)*/ + + /*[Start 3-wires]*/ + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(p_dm, 0xc00, 0xf, 0x7);/* hardware 3-wire on */ + odm_set_bb_reg(p_dm, 0xe00, 0xf, 0x7);/* hardware 3-wire on */ + } else { + odm_set_bb_reg(p_dm, 0x88c, 0xf00000, 0x0); /* 3 wire enable 88c[23:20]=0x0 */ + } + } +} + +u8 +phydm_stop_ic_trx( + void *p_dm_void, + u8 set_type + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_api_stuc *p_api = &(p_dm->api_table); + u32 i; + u8 trx_idle_success = false; + u32 dbg_port_value = 0; + + if (set_type == PHYDM_SET) { + /*[Stop TRX]---------------------------------------------------------------------*/ + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_3, 0x0) == false) /*set debug port to 0x0*/ + return PHYDM_SET_FAIL; + + for (i = 0; i<10000; i++) { + dbg_port_value = phydm_get_bb_dbg_port_value(p_dm); + if ((dbg_port_value & (BIT(17) | BIT(3))) == 0) /* PHYTXON && CCA_all */ { + PHYDM_DBG(p_dm, ODM_COMP_API, ("PSD wait for ((%d)) times\n", i)); + + trx_idle_success = true; + break; + } + } + phydm_release_bb_dbg_port(p_dm); + + if (trx_idle_success) { + + p_api->tx_queue_bitmap = (u8)odm_get_bb_reg(p_dm, 0x520, 0xff0000); + + odm_set_bb_reg(p_dm, 0x520, 0xff0000, 0xff); /*pause all TX queue*/ + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(p_dm, 0x808, BIT(28), 0); /*disable CCK block*/ + odm_set_bb_reg(p_dm, 0x838, BIT(1), 1); /*disable OFDM RX CCA*/ + } else { + /*TBD*/ + odm_set_bb_reg(p_dm, 0x800, BIT(24), 0); /* disable whole CCK block */ + + + p_api->rx_iqc_reg_1 = odm_get_bb_reg(p_dm, 0xc14, MASKDWORD); + p_api->rx_iqc_reg_2 = odm_get_bb_reg(p_dm, 0xc1c, MASKDWORD); + + odm_set_bb_reg(p_dm, 0xc14, MASKDWORD, 0x0); /* [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] */ + odm_set_bb_reg(p_dm, 0xc1c, MASKDWORD, 0x0); + } + + } else { + return PHYDM_SET_FAIL; + } + + return PHYDM_SET_SUCCESS; + + } else { /*if (set_type == PHYDM_REVERT)*/ + + odm_set_bb_reg(p_dm, 0x520, 0xff0000, (u32)(p_api->tx_queue_bitmap)); /*Release all TX queue*/ + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(p_dm, 0x808, BIT(28), 1); /*enable CCK block*/ + odm_set_bb_reg(p_dm, 0x838, BIT(1), 0); /*enable OFDM RX CCA*/ + } else { + /*TBD*/ + odm_set_bb_reg(p_dm, 0x800, BIT(24), 1); /* enable whole CCK block */ + + odm_set_bb_reg(p_dm, 0xc14, MASKDWORD, p_api->rx_iqc_reg_1); /* [ Set IQK Matrix = 0 ] equivalent to [ Turn off CCA] */ + odm_set_bb_reg(p_dm, 0xc1c, MASKDWORD, p_api->rx_iqc_reg_2); + } + + return PHYDM_SET_SUCCESS; + } + +} + +void +phydm_set_ext_switch( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 ext_ant_switch = dm_value[0]; + +#if (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A)) { + + /*Output Pin Settings*/ + odm_set_mac_reg(p_dm, 0x4C, BIT(23), 0); /*select DPDT_P and DPDT_N as output pin*/ + odm_set_mac_reg(p_dm, 0x4C, BIT(24), 1); /*by WLAN control*/ + + odm_set_bb_reg(p_dm, 0xCB4, 0xFF, 77); /*DPDT_N = 1b'0*/ /*DPDT_P = 1b'0*/ + + if (ext_ant_switch == MAIN_ANT) { + odm_set_bb_reg(p_dm, 0xCB4, (BIT(29) | BIT(28)), 1); + PHYDM_DBG(p_dm, ODM_COMP_API, ("***8821A set ant switch = 2b'01 (Main)\n")); + } else if (ext_ant_switch == AUX_ANT) { + odm_set_bb_reg(p_dm, 0xCB4, BIT(29) | BIT(28), 2); + PHYDM_DBG(p_dm, ODM_COMP_API, ("***8821A set ant switch = 2b'10 (Aux)\n")); + } + } +#endif +} + +void +phydm_csi_mask_enable( + void *p_dm_void, + u32 enable +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 reg_value = 0; + + reg_value = (enable == FUNC_ENABLE) ? 1 : 0; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + odm_set_bb_reg(p_dm, 0xD2C, BIT(28), reg_value); + PHYDM_DBG(p_dm, ODM_COMP_API, ("Enable CSI Mask: Reg 0xD2C[28] = ((0x%x))\n", reg_value)); + + } else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, 0x874, BIT(0), reg_value); + PHYDM_DBG(p_dm, ODM_COMP_API, ("Enable CSI Mask: Reg 0x874[0] = ((0x%x))\n", reg_value)); + } + +} + +void +phydm_clean_all_csi_mask( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + odm_set_bb_reg(p_dm, 0xD40, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0xD44, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0xD48, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0xD4c, MASKDWORD, 0); + + } else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, 0x880, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0x884, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0x888, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0x88c, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0x890, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0x894, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0x898, MASKDWORD, 0); + odm_set_bb_reg(p_dm, 0x89c, MASKDWORD, 0); + } +} + +void +phydm_set_csi_mask_reg( + void *p_dm_void, + u32 tone_idx_tmp, + u8 tone_direction +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 byte_offset, bit_offset; + u32 target_reg; + u8 reg_tmp_value; + u32 tone_num = 64; + u32 tone_num_shift = 0; + u32 csi_mask_reg_p = 0, csi_mask_reg_n = 0; + + /* calculate real tone idx*/ + if ((tone_idx_tmp % 10) >= 5) + tone_idx_tmp += 10; + + tone_idx_tmp = (tone_idx_tmp / 10); + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + tone_num = 64; + csi_mask_reg_p = 0xD40; + csi_mask_reg_n = 0xD48; + + } else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + tone_num = 128; + csi_mask_reg_p = 0x880; + csi_mask_reg_n = 0x890; + } + + if (tone_direction == FREQ_POSITIVE) { + + if (tone_idx_tmp >= (tone_num - 1)) + tone_idx_tmp = (tone_num - 1); + + byte_offset = (u8)(tone_idx_tmp >> 3); + bit_offset = (u8)(tone_idx_tmp & 0x7); + target_reg = csi_mask_reg_p + byte_offset; + + } else { + tone_num_shift = tone_num; + + if (tone_idx_tmp >= tone_num) + tone_idx_tmp = tone_num; + + tone_idx_tmp = tone_num - tone_idx_tmp; + + byte_offset = (u8)(tone_idx_tmp >> 3); + bit_offset = (u8)(tone_idx_tmp & 0x7); + target_reg = csi_mask_reg_n + byte_offset; + } + + reg_tmp_value = odm_read_1byte(p_dm, target_reg); + PHYDM_DBG(p_dm, ODM_COMP_API, ("Pre Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); + reg_tmp_value |= BIT(bit_offset); + odm_write_1byte(p_dm, target_reg, reg_tmp_value); + PHYDM_DBG(p_dm, ODM_COMP_API, ("New Mask tone idx[%d]: Reg0x%x = ((0x%x))\n", (tone_idx_tmp + tone_num_shift), target_reg, reg_tmp_value)); +} + +void +phydm_set_nbi_reg( + void *p_dm_void, + u32 tone_idx_tmp, + u32 bw +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 nbi_table_128[NBI_TABLE_SIZE_128] = {25, 55, 85, 115, 135, 155, 185, 205, 225, 245, /*1~10*/ /*tone_idx X 10*/ + 265, 285, 305, 335, 355, 375, 395, 415, 435, 455, /*11~20*/ + 485, 505, 525, 555, 585, 615, 635 + }; /*21~27*/ + + u32 nbi_table_256[NBI_TABLE_SIZE_256] = { 25, 55, 85, 115, 135, 155, 175, 195, 225, 245, /*1~10*/ + 265, 285, 305, 325, 345, 365, 385, 405, 425, 445, /*11~20*/ + 465, 485, 505, 525, 545, 565, 585, 605, 625, 645, /*21~30*/ + 665, 695, 715, 735, 755, 775, 795, 815, 835, 855, /*31~40*/ + 875, 895, 915, 935, 955, 975, 995, 1015, 1035, 1055, /*41~50*/ + 1085, 1105, 1125, 1145, 1175, 1195, 1225, 1255, 1275 + }; /*51~59*/ + + u32 reg_idx = 0; + u32 i; + u8 nbi_table_idx = FFT_128_TYPE; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + + nbi_table_idx = FFT_128_TYPE; + else if (p_dm->support_ic_type & ODM_IC_11AC_1_SERIES) + + nbi_table_idx = FFT_256_TYPE; + else if (p_dm->support_ic_type & ODM_IC_11AC_2_SERIES) { + + if (bw == 80) + nbi_table_idx = FFT_256_TYPE; + else /*20M, 40M*/ + nbi_table_idx = FFT_128_TYPE; + } + + if (nbi_table_idx == FFT_128_TYPE) { + + for (i = 0; i < NBI_TABLE_SIZE_128; i++) { + if (tone_idx_tmp < nbi_table_128[i]) { + reg_idx = i + 1; + break; + } + } + + } else if (nbi_table_idx == FFT_256_TYPE) { + + for (i = 0; i < NBI_TABLE_SIZE_256; i++) { + if (tone_idx_tmp < nbi_table_256[i]) { + reg_idx = i + 1; + break; + } + } + } + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(p_dm, 0xc40, 0x1f000000, reg_idx); + PHYDM_DBG(p_dm, ODM_COMP_API, ("Set tone idx: Reg0xC40[28:24] = ((0x%x))\n", reg_idx)); + /**/ + } else { + odm_set_bb_reg(p_dm, 0x87c, 0xfc000, reg_idx); + PHYDM_DBG(p_dm, ODM_COMP_API, ("Set tone idx: Reg0x87C[19:14] = ((0x%x))\n", reg_idx)); + /**/ + } +} + + +void +phydm_nbi_enable( + void *p_dm_void, + u32 enable +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 reg_value = 0; + + reg_value = (enable == FUNC_ENABLE) ? 1 : 0; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + odm_set_bb_reg(p_dm, 0xc40, BIT(9), reg_value); + PHYDM_DBG(p_dm, ODM_COMP_API, ("Enable NBI Reg0xC40[9] = ((0x%x))\n", reg_value)); + + } else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + if (p_dm->support_ic_type & (ODM_RTL8822B|ODM_RTL8821C)) { + odm_set_bb_reg(p_dm, 0x87c, BIT(13), reg_value); + odm_set_bb_reg(p_dm, 0xc20, BIT(28), reg_value); + if (p_dm->rf_type > RF_1T1R) + odm_set_bb_reg(p_dm, 0xe20, BIT(28), reg_value); + } else + odm_set_bb_reg(p_dm, 0x87c, BIT(13), reg_value); + PHYDM_DBG(p_dm, ODM_COMP_API, ("Enable NBI Reg0x87C[13] = ((0x%x))\n", reg_value)); + } +} + +u8 +phydm_calculate_fc( + void *p_dm_void, + u32 channel, + u32 bw, + u32 second_ch, + u32 *fc_in +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 fc = *fc_in; + u32 start_ch_per_40m[NUM_START_CH_40M] = {36, 44, 52, 60, 100, 108, 116, 124, 132, 140, 149, 157, 165, 173}; + u32 start_ch_per_80m[NUM_START_CH_80M] = {36, 52, 100, 116, 132, 149, 165}; + u32 *p_start_ch = &(start_ch_per_40m[0]); + u32 num_start_channel = NUM_START_CH_40M; + u32 channel_offset = 0; + u32 i; + + /*2.4G*/ + if (channel <= 14 && channel > 0) { + + if (bw == 80) + return PHYDM_SET_FAIL; + + fc = 2412 + (channel - 1) * 5; + + if (bw == 40 && (second_ch == PHYDM_ABOVE)) { + + if (channel >= 10) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("CH = ((%d)), Scnd_CH = ((%d)) Error setting\n", channel, second_ch)); + return PHYDM_SET_FAIL; + } + fc += 10; + } else if (bw == 40 && (second_ch == PHYDM_BELOW)) { + + if (channel <= 2) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("CH = ((%d)), Scnd_CH = ((%d)) Error setting\n", channel, second_ch)); + return PHYDM_SET_FAIL; + } + fc -= 10; + } + } + /*5G*/ + else if (channel >= 36 && channel <= 177) { + + if (bw != 20) { + + if (bw == 40) { + num_start_channel = NUM_START_CH_40M; + p_start_ch = &(start_ch_per_40m[0]); + channel_offset = CH_OFFSET_40M; + } else if (bw == 80) { + num_start_channel = NUM_START_CH_80M; + p_start_ch = &(start_ch_per_80m[0]); + channel_offset = CH_OFFSET_80M; + } + + for (i = 0; i < (num_start_channel - 1); i++) { + + if (channel < p_start_ch[i + 1]) { + channel = p_start_ch[i] + channel_offset; + break; + } + } + PHYDM_DBG(p_dm, ODM_COMP_API, ("Mod_CH = ((%d))\n", channel)); + } + + fc = 5180 + (channel - 36) * 5; + + } else { + PHYDM_DBG(p_dm, ODM_COMP_API, ("CH = ((%d)) Error setting\n", channel)); + return PHYDM_SET_FAIL; + } + + *fc_in = fc; + + return PHYDM_SET_SUCCESS; +} + + +u8 +phydm_calculate_intf_distance( + void *p_dm_void, + u32 bw, + u32 fc, + u32 f_interference, + u32 *p_tone_idx_tmp_in +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 bw_up, bw_low; + u32 int_distance; + u32 tone_idx_tmp; + u8 set_result = PHYDM_SET_NO_NEED; + + bw_up = fc + bw / 2; + bw_low = fc - bw / 2; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[f_l, fc, fh] = [ %d, %d, %d ], f_int = ((%d))\n", bw_low, fc, bw_up, f_interference)); + + if ((f_interference >= bw_low) && (f_interference <= bw_up)) { + + int_distance = (fc >= f_interference) ? (fc - f_interference) : (f_interference - fc); + tone_idx_tmp = (int_distance << 5); /* =10*(int_distance /0.3125) */ + PHYDM_DBG(p_dm, ODM_COMP_API, ("int_distance = ((%d MHz)) Mhz, tone_idx_tmp = ((%d.%d))\n", int_distance, (tone_idx_tmp / 10), (tone_idx_tmp % 10))); + *p_tone_idx_tmp_in = tone_idx_tmp; + set_result = PHYDM_SET_SUCCESS; + } + + return set_result; + +} + + +u8 +phydm_csi_mask_setting( + void *p_dm_void, + u32 enable, + u32 channel, + u32 bw, + u32 f_interference, + u32 second_ch +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 fc = 2412; + u8 tone_direction; + u32 tone_idx_tmp; + u8 set_result = PHYDM_SET_SUCCESS; + + if (enable == FUNC_DISABLE) { + set_result = PHYDM_SET_SUCCESS; + phydm_clean_all_csi_mask(p_dm); + + } else { + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[Set CSI MASK_] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + channel, bw, f_interference, (((bw == 20) || (channel > 14)) ? "Don't care" : (second_ch == PHYDM_ABOVE) ? "H" : "L"))); + + /*calculate fc*/ + if (phydm_calculate_fc(p_dm, channel, bw, second_ch, &fc) == PHYDM_SET_FAIL) + set_result = PHYDM_SET_FAIL; + + else { + /*calculate interference distance*/ + if (phydm_calculate_intf_distance(p_dm, bw, fc, f_interference, &tone_idx_tmp) == PHYDM_SET_SUCCESS) { + + tone_direction = (f_interference >= fc) ? FREQ_POSITIVE : FREQ_NEGATIVE; + phydm_set_csi_mask_reg(p_dm, tone_idx_tmp, tone_direction); + set_result = PHYDM_SET_SUCCESS; + } else + set_result = PHYDM_SET_NO_NEED; + } + } + + if (set_result == PHYDM_SET_SUCCESS) + phydm_csi_mask_enable(p_dm, enable); + else + phydm_csi_mask_enable(p_dm, FUNC_DISABLE); + + return set_result; +} + +u8 +phydm_nbi_setting( + void *p_dm_void, + u32 enable, + u32 channel, + u32 bw, + u32 f_interference, + u32 second_ch +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 fc = 2412; + u32 tone_idx_tmp; + u8 set_result = PHYDM_SET_SUCCESS; + + if (enable == FUNC_DISABLE) + set_result = PHYDM_SET_SUCCESS; + + else { + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[Set NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + channel, bw, f_interference, (((second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : (second_ch == PHYDM_ABOVE) ? "H" : "L"))); + + /*calculate fc*/ + if (phydm_calculate_fc(p_dm, channel, bw, second_ch, &fc) == PHYDM_SET_FAIL) + set_result = PHYDM_SET_FAIL; + + else { + /*calculate interference distance*/ + if (phydm_calculate_intf_distance(p_dm, bw, fc, f_interference, &tone_idx_tmp) == PHYDM_SET_SUCCESS) { + + phydm_set_nbi_reg(p_dm, tone_idx_tmp, bw); + set_result = PHYDM_SET_SUCCESS; + } else + set_result = PHYDM_SET_NO_NEED; + } + } + + if (set_result == PHYDM_SET_SUCCESS) + phydm_nbi_enable(p_dm, enable); + else + phydm_nbi_enable(p_dm, FUNC_DISABLE); + + return set_result; +} + +void +phydm_api_debug( + void *p_dm_void, + u32 function_map, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + u32 channel = dm_value[1]; + u32 bw = dm_value[2]; + u32 f_interference = dm_value[3]; + u32 second_ch = dm_value[4]; + u8 set_result = 0; + + /*PHYDM_API_NBI*/ + /*-------------------------------------------------------------------------------------------------------------------------------*/ + if (function_map == PHYDM_API_NBI) { + + if (dm_value[0] == 100) { + + PHYDM_SNPRINTF((output + used, out_len - used, "[HELP-NBI] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); + return; + + } else if (dm_value[0] == FUNC_ENABLE) { + + PHYDM_SNPRINTF((output + used, out_len - used, "[Enable NBI] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + channel, bw, f_interference, ((second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "Don't care" : ((second_ch == PHYDM_ABOVE) ? "H" : "L"))); + set_result = phydm_nbi_setting(p_dm, FUNC_ENABLE, channel, bw, f_interference, second_ch); + + } else if (dm_value[0] == FUNC_DISABLE) { + + PHYDM_SNPRINTF((output + used, out_len - used, "[Disable NBI]\n")); + set_result = phydm_nbi_setting(p_dm, FUNC_DISABLE, channel, bw, f_interference, second_ch); + + } else + + set_result = PHYDM_SET_FAIL; + PHYDM_SNPRINTF((output + used, out_len - used, "[NBI set result: %s]\n", (set_result == PHYDM_SET_SUCCESS) ? "Success" : ((set_result == PHYDM_SET_NO_NEED) ? "No need" : "Error"))); + + } + + /*PHYDM_CSI_MASK*/ + /*-------------------------------------------------------------------------------------------------------------------------------*/ + else if (function_map == PHYDM_API_CSI_MASK) { + + if (dm_value[0] == 100) { + + PHYDM_SNPRINTF((output + used, out_len - used, "[HELP-CSI MASK] EN(on=1, off=2) CH BW(20/40/80) f_intf(Mhz) Scnd_CH(L=1, H=2)\n")); + return; + + } else if (dm_value[0] == FUNC_ENABLE) { + + PHYDM_SNPRINTF((output + used, out_len - used, "[Enable CSI MASK] CH = ((%d)), BW = ((%d)), f_intf = ((%d)), Scnd_CH = ((%s))\n", + channel, bw, f_interference, (channel > 14) ? "Don't care" : (((second_ch == PHYDM_DONT_CARE) || (bw == 20) || (channel > 14)) ? "H" : "L"))); + set_result = phydm_csi_mask_setting(p_dm, FUNC_ENABLE, channel, bw, f_interference, second_ch); + + } else if (dm_value[0] == FUNC_DISABLE) { + + PHYDM_SNPRINTF((output + used, out_len - used, "[Disable CSI MASK]\n")); + set_result = phydm_csi_mask_setting(p_dm, FUNC_DISABLE, channel, bw, f_interference, second_ch); + + } else + + set_result = PHYDM_SET_FAIL; + PHYDM_SNPRINTF((output + used, out_len - used, "[CSI MASK set result: %s]\n", (set_result == PHYDM_SET_SUCCESS) ? "Success" : ((set_result == PHYDM_SET_NO_NEED) ? "No need" : "Error"))); + } + *_used = used; + *_out_len = out_len; +} + +void +phydm_stop_ck320( + void *p_dm_void, + u8 enable +) { + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 reg_value = (enable == true) ? 1 : 0; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(p_dm, 0x8b4, BIT(6), reg_value); + /**/ + } else { + + if (p_dm->support_ic_type & ODM_IC_N_2SS) { /*N-2SS*/ + odm_set_bb_reg(p_dm, 0x87c, BIT(29), reg_value); + /**/ + } else { /*N-1SS*/ + odm_set_bb_reg(p_dm, 0x87c, BIT(31), reg_value); + /**/ + } + } +} + +#ifdef PHYDM_COMMON_API_SUPPORT +boolean +phydm_api_set_txagc( + void *p_dm_void, + u32 power_index, + enum rf_path path, + u8 hw_rate, + boolean is_single_rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean ret = false; + u8 i; + +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { + if (is_single_rate) { + + #if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) + ret = phydm_write_txagc_1byte_8822b(p_dm, power_index, path, hw_rate); + #endif + + #if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + ret = phydm_write_txagc_1byte_8821c(p_dm, power_index, path, hw_rate); + #endif + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + set_current_tx_agc(p_dm->priv, path, hw_rate, (u8)power_index); + #endif + + } else { + + #if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) + ret = config_phydm_write_txagc_8822b(p_dm, power_index, path, hw_rate); + #endif + + #if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + ret = config_phydm_write_txagc_8821c(p_dm, power_index, path, hw_rate); + #endif + + #if (DM_ODM_SUPPORT_TYPE & ODM_AP) + for (i = 0; i < 4; i++) + set_current_tx_agc(p_dm->priv, path, (hw_rate + i), (u8)power_index); + #endif + } + } +#endif + + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + ret = config_phydm_write_txagc_8197f(p_dm, power_index, path, hw_rate); +#endif + + return ret; +} + +u8 +phydm_api_get_txagc( + void *p_dm_void, + enum rf_path path, + u8 hw_rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 ret = 0; + +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8822B) + ret = config_phydm_read_txagc_8822b(p_dm, path, hw_rate); +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + ret = config_phydm_read_txagc_8197f(p_dm, path, hw_rate); +#endif + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8821C) + ret = config_phydm_read_txagc_8821c(p_dm, path, hw_rate); +#endif + + return ret; +} + + +boolean +phydm_api_switch_bw_channel( + void *p_dm_void, + u8 central_ch, + u8 primary_ch_idx, + enum channel_width bandwidth +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean ret = false; + +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8822B) + ret = config_phydm_switch_channel_bw_8822b(p_dm, central_ch, primary_ch_idx, bandwidth); +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + ret = config_phydm_switch_channel_bw_8197f(p_dm, central_ch, primary_ch_idx, bandwidth); +#endif + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8821C) + ret = config_phydm_switch_channel_bw_8821c(p_dm, central_ch, primary_ch_idx, bandwidth); +#endif + + return ret; +} + +boolean +phydm_api_trx_mode( + void *p_dm_void, + enum bb_path tx_path, + enum bb_path rx_path, + boolean is_tx2_path +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean ret = false; + +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8822B) + ret = config_phydm_trx_mode_8822b(p_dm, tx_path, rx_path, is_tx2_path); +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + ret = config_phydm_trx_mode_8197f(p_dm, tx_path, rx_path, is_tx2_path); +#endif + + return ret; +} +#endif + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +phydm_normal_driver_rx_sniffer( + struct PHY_DM_STRUCT *p_dm, + u8 *p_desc, + PRT_RFD_STATUS p_rt_rfd_status, + u8 *p_drv_info, + u8 phy_status +) +{ +#if (defined(CONFIG_PHYDM_RX_SNIFFER_PARSING)) + u32 *p_msg; + u16 seq_num; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + + if (p_rt_rfd_status->packet_report_type != NORMAL_RX) + return; + + if (!p_dm->is_linked) { + if (p_rt_rfd_status->is_hw_error) + return; + } + + if (!(p_dm_fat_table->fat_state == FAT_TRAINING_STATE)) + return; + + if (phy_status == true) { + + if ((p_dm->rx_pkt_type == type_block_ack) || (p_dm->rx_pkt_type == type_rts) || (p_dm->rx_pkt_type == type_cts)) + seq_num = 0; + else + seq_num = p_rt_rfd_status->seq_num; + + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, ("%04d , %01s, rate=0x%02x, L=%04d , %s , %s", + seq_num, + /*p_rt_rfd_status->mac_id,*/ + ((p_rt_rfd_status->is_crc) ? "C" : (p_rt_rfd_status->is_ampdu) ? "A" : "_"), + p_rt_rfd_status->data_rate, + p_rt_rfd_status->length, + ((p_rt_rfd_status->band_width == 0) ? "20M" : ((p_rt_rfd_status->band_width == 1) ? "40M" : "80M")), + ((p_rt_rfd_status->is_ldpc) ? "LDP" : "BCC"))); + + if (p_dm->rx_pkt_type == type_asoc_req) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "AS_REQ")); + /**/ + } else if (p_dm->rx_pkt_type == type_asoc_rsp) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "AS_RSP")); + /**/ + } else if (p_dm->rx_pkt_type == type_probe_req) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "PR_REQ")); + /**/ + } else if (p_dm->rx_pkt_type == type_probe_rsp) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "PR_RSP")); + /**/ + } else if (p_dm->rx_pkt_type == type_deauth) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "DEAUTH")); + /**/ + } else if (p_dm->rx_pkt_type == type_beacon) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "BEACON")); + /**/ + } else if (p_dm->rx_pkt_type == type_block_ack_req) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "BA_REQ")); + /**/ + } else if (p_dm->rx_pkt_type == type_rts) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "__RTS_")); + /**/ + } else if (p_dm->rx_pkt_type == type_cts) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "__CTS_")); + /**/ + } else if (p_dm->rx_pkt_type == type_ack) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "__ACK_")); + /**/ + } else if (p_dm->rx_pkt_type == type_block_ack) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "__BA__")); + /**/ + } else if (p_dm->rx_pkt_type == type_data) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "_DATA_")); + /**/ + } else if (p_dm->rx_pkt_type == type_data_ack) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "Data_Ack")); + /**/ + } else if (p_dm->rx_pkt_type == type_qos_data) { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [%s]", "QoS_Data")); + /**/ + } else { + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [0x%x]", p_dm->rx_pkt_type)); + /**/ + } + + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , [RSSI=%d,%d,%d,%d ]", + p_dm->RSSI_A, + p_dm->RSSI_B, + p_dm->RSSI_C, + p_dm->RSSI_D)); + + p_msg = (u32 *)p_drv_info; + + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, (" , P-STS[28:0]=%08x-%08x-%08x-%08x-%08x-%08x-%08x\n", + p_msg[6], p_msg[5], p_msg[4], p_msg[3], p_msg[2], p_msg[1], p_msg[1])); + } else { + + PHYDM_DBG_F(p_dm, ODM_COMP_SNIFFER, ("%04d , %01s, rate=0x%02x, L=%04d , %s , %s\n", + p_rt_rfd_status->seq_num, + /*p_rt_rfd_status->mac_id,*/ + ((p_rt_rfd_status->is_crc) ? "C" : (p_rt_rfd_status->is_ampdu) ? "A" : "_"), + p_rt_rfd_status->data_rate, + p_rt_rfd_status->length, + ((p_rt_rfd_status->band_width == 0) ? "20M" : ((p_rt_rfd_status->band_width == 1) ? "40M" : "80M")), + ((p_rt_rfd_status->is_ldpc) ? "LDP" : "BCC"))); + } + + +#endif +} +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.h new file mode 100644 index 000000000000..446350e75b7a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_api.h @@ -0,0 +1,201 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDM_API_H__ +#define __PHYDM_API_H__ + +#define PHYDM_API_VERSION "1.0" /* 2017.07.10 Dino, Add phydm_api.h*/ + + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + + +#define FUNC_ENABLE 1 +#define FUNC_DISABLE 2 + +/*NBI API------------------------------------*/ +#define NBI_TABLE_SIZE_128 27 +#define NBI_TABLE_SIZE_256 59 + +#define NUM_START_CH_80M 7 +#define NUM_START_CH_40M 14 + +#define CH_OFFSET_40M 2 +#define CH_OFFSET_80M 6 + +#define FFT_128_TYPE 1 +#define FFT_256_TYPE 2 + +#define FREQ_POSITIVE 1 +#define FREQ_NEGATIVE 2 +/*------------------------------------------------*/ + +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + +struct phydm_api_stuc { + + u32 rx_iqc_reg_1; /*N-mode: for pathA REG0xc14*/ + u32 rx_iqc_reg_2; /*N-mode: for pathB REG0xc1c*/ + u8 tx_queue_bitmap;/*REG0x520[23:16]*/ + +}; + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + + + +/* 1 ============================================================ + * 1 function prototype + * 1 ============================================================ */ + +void +phydm_init_trx_antenna_setting( + void *p_dm_void +); + +void +phydm_config_ofdm_rx_path( + void *p_dm_void, + u32 path +); + +void +phydm_config_cck_rx_path( + void *p_dm_void, + enum bb_path path +); + +void +phydm_config_cck_rx_antenna_init( + void *p_dm_void +); + +void +phydm_config_trx_path( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_stop_3_wire( + void *p_dm_void, + u8 set_type +); + +u8 +phydm_stop_ic_trx( + void *p_dm_void, + u8 set_type +); + +void +phydm_set_ext_switch( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_nbi_enable( + void *p_dm_void, + u32 enable +); + +u8 +phydm_csi_mask_setting( + void *p_dm_void, + u32 enable, + u32 channel, + u32 bw, + u32 f_interference, + u32 Second_ch +); + +u8 +phydm_nbi_setting( + void *p_dm_void, + u32 enable, + u32 channel, + u32 bw, + u32 f_interference, + u32 second_ch +); + + +void +phydm_api_debug( + void *p_dm_void, + u32 function_map, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_stop_ck320( + void *p_dm_void, + u8 enable +); + +#ifdef PHYDM_COMMON_API_SUPPORT + +boolean +phydm_api_set_txagc( + void *p_dm_void, + u32 power_index, + enum rf_path path, + u8 hw_rate, + boolean is_single_rate +); + +u8 +phydm_api_get_txagc( + void *p_dm_void, + enum rf_path path, + u8 hw_rate +); + +boolean +phydm_api_switch_bw_channel( + void *p_dm_void, + u8 central_ch, + u8 primary_ch_idx, + enum channel_width bandwidth +); + +boolean +phydm_api_trx_mode( + void *p_dm_void, + enum bb_path tx_path, + enum bb_path rx_path, + boolean is_tx2_path +); + +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.c new file mode 100644 index 000000000000..e396a2f9514c --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.c @@ -0,0 +1,635 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_AUTO_DEGBUG + +void +phydm_check_hang_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_auto_dbg_struc *p_atd_t = &(p_dm->auto_dbg_table); + + dbg_print("%s ======>\n", __func__); + + p_atd_t->dbg_step = 0; + p_atd_t->auto_dbg_type = AUTO_DBG_STOP; + phydm_pause_dm_watchdog(p_dm, PHYDM_RESUME); + p_dm->debug_components &= (~ODM_COMP_API); +} + +#if (ODM_IC_11N_SERIES_SUPPORT == 1) +void +phydm_auto_check_hang_engine_n( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_auto_dbg_struc *p_atd_t = &(p_dm->auto_dbg_table); + struct n_dbgport_803 dbgport_803 = {0}; + u32 value32_tmp = 0, value32_tmp_2 = 0; + u8 i; + u32 curr_dbg_port_val[DBGPORT_CHK_NUM]; + u16 curr_ofdm_t_cnt; + u16 curr_ofdm_r_cnt; + u16 curr_cck_t_cnt; + u16 curr_cck_r_cnt; + u16 curr_ofdm_crc_error_cnt; + u16 curr_cck_crc_error_cnt; + u16 diff_ofdm_t_cnt; + u16 diff_ofdm_r_cnt; + u16 diff_cck_t_cnt; + u16 diff_cck_r_cnt; + u16 diff_ofdm_crc_error_cnt; + u16 diff_cck_crc_error_cnt; + u8 rf_mode; + + + if (p_atd_t->auto_dbg_type == AUTO_DBG_STOP) + return; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + phydm_check_hang_reset(p_dm); + return; + } + + if (p_atd_t->dbg_step == 0) { + + dbg_print("dbg_step=0\n\n"); + + /*Reset all packet counter*/ + odm_set_bb_reg(p_dm, 0xf14, BIT(16), 1); + odm_set_bb_reg(p_dm, 0xf14, BIT(16), 0); + + + + } else if (p_atd_t->dbg_step == 1) { + + dbg_print("dbg_step=1\n\n"); + + /*Check packet counter Register*/ + p_atd_t->ofdm_t_cnt = (u16)odm_get_bb_reg(p_dm, 0x9cc, MASKHWORD); + p_atd_t->ofdm_r_cnt = (u16)odm_get_bb_reg(p_dm, 0xf94, MASKLWORD); + p_atd_t->ofdm_crc_error_cnt = (u16)odm_get_bb_reg(p_dm, 0xf94, MASKHWORD); + + p_atd_t->cck_t_cnt = (u16)odm_get_bb_reg(p_dm, 0x9d0, MASKHWORD);; + p_atd_t->cck_r_cnt = (u16)odm_get_bb_reg(p_dm, 0xfa0, MASKHWORD); + p_atd_t->cck_crc_error_cnt = (u16)odm_get_bb_reg(p_dm, 0xf84, 0x3fff); + + + /*Check Debug Port*/ + for (i = 0; i < DBGPORT_CHK_NUM; i++) { + + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_3, (u32)p_atd_t->dbg_port_table[i])) { + p_atd_t->dbg_port_val[i] = phydm_get_bb_dbg_port_value(p_dm); + phydm_release_bb_dbg_port(p_dm); + } + } + + } else if (p_atd_t->dbg_step == 2) { + + dbg_print("dbg_step=2\n\n"); + + /*Check packet counter Register*/ + curr_ofdm_t_cnt = (u16)odm_get_bb_reg(p_dm, 0x9cc, MASKHWORD); + curr_ofdm_r_cnt = (u16)odm_get_bb_reg(p_dm, 0xf94, MASKLWORD); + curr_ofdm_crc_error_cnt = (u16)odm_get_bb_reg(p_dm, 0xf94, MASKHWORD); + + curr_cck_t_cnt = (u16)odm_get_bb_reg(p_dm, 0x9d0, MASKHWORD);; + curr_cck_r_cnt = (u16)odm_get_bb_reg(p_dm, 0xfa0, MASKHWORD); + curr_cck_crc_error_cnt = (u16)odm_get_bb_reg(p_dm, 0xf84, 0x3fff); + + /*Check Debug Port*/ + for (i = 0; i < DBGPORT_CHK_NUM; i++) { + + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_3, (u32)p_atd_t->dbg_port_table[i])) { + curr_dbg_port_val[i] = phydm_get_bb_dbg_port_value(p_dm); + phydm_release_bb_dbg_port(p_dm); + } + } + + /*=== Make check hang decision ================================*/ + dbg_print("Check Hang Decision\n\n"); + + /* ----- Check RF Register -----------------------------------*/ + for (i = 0; i < p_dm->num_rf_path; i++) { + + rf_mode = (u8)odm_get_rf_reg(p_dm, i, 0x0, 0xf0000); + + dbg_print("RF0x0[%d] = 0x%x\n", i, rf_mode); + + if (rf_mode > 3) { + dbg_print("Incorrect RF mode\n"); + dbg_print("ReasonCode:RHN-1\n"); + + + } + } + + value32_tmp = odm_get_rf_reg(p_dm, 0, 0xb0, 0xf0000); + + if (p_dm->support_ic_type == ODM_RTL8188E) { + if (value32_tmp != 0xff8c8) { + dbg_print("ReasonCode:RHN-3\n"); + } + } + + /* ----- Check BB Register -----------------------------------*/ + + /*BB mode table*/ + value32_tmp = odm_get_bb_reg(p_dm, 0x824, 0xe); + value32_tmp_2 = odm_get_bb_reg(p_dm, 0x82c, 0xe); + dbg_print("BB TX mode table {A, B}= {%d, %d}\n", value32_tmp, value32_tmp_2); + + if ((value32_tmp > 3) || (value32_tmp_2 > 3)) { + + dbg_print("ReasonCode:RHN-2\n"); + } + + value32_tmp = odm_get_bb_reg(p_dm, 0x824, 0x700000); + value32_tmp_2 = odm_get_bb_reg(p_dm, 0x82c, 0x700000); + dbg_print("BB RX mode table {A, B}= {%d, %d}\n", value32_tmp, value32_tmp_2); + + if ((value32_tmp > 3) || (value32_tmp_2 > 3)) { + + dbg_print("ReasonCode:RHN-2\n"); + } + + + /*BB HW Block*/ + value32_tmp = odm_get_bb_reg(p_dm, 0x800, MASKDWORD); + + if (!(value32_tmp & BIT(24))) { + dbg_print("Reg0x800[24] = 0, CCK BLK is disabled\n"); + dbg_print("ReasonCode: THN-3\n"); + } + + if (!(value32_tmp & BIT(25))) { + dbg_print("Reg0x800[24] = 0, OFDM BLK is disabled\n"); + dbg_print("ReasonCode:THN-3\n"); + } + + /*BB Continue TX*/ + value32_tmp = odm_get_bb_reg(p_dm, 0xd00, 0x70000000); + dbg_print("Continue TX=%d\n", value32_tmp); + if (value32_tmp != 0) { + dbg_print("ReasonCode: THN-4\n"); + } + + + /* ----- Check Packet Counter --------------------------------*/ + diff_ofdm_t_cnt = curr_ofdm_t_cnt - p_atd_t->ofdm_t_cnt; + diff_ofdm_r_cnt = curr_ofdm_r_cnt - p_atd_t->ofdm_r_cnt; + diff_ofdm_crc_error_cnt = curr_ofdm_crc_error_cnt - p_atd_t->ofdm_crc_error_cnt; + + diff_cck_t_cnt = curr_cck_t_cnt - p_atd_t->cck_t_cnt; + diff_cck_r_cnt = curr_cck_r_cnt - p_atd_t->cck_r_cnt; + diff_cck_crc_error_cnt = curr_cck_crc_error_cnt - p_atd_t->cck_crc_error_cnt; + + dbg_print("OFDM[t=0~1] {TX, RX, CRC_error} = {%d, %d, %d}\n", + p_atd_t->ofdm_t_cnt, p_atd_t->ofdm_r_cnt, p_atd_t->ofdm_crc_error_cnt); + dbg_print("OFDM[t=1~2] {TX, RX, CRC_error} = {%d, %d, %d}\n", + curr_ofdm_t_cnt, curr_ofdm_r_cnt, curr_ofdm_crc_error_cnt); + dbg_print("OFDM_diff {TX, RX, CRC_error} = {%d, %d, %d}\n", + diff_ofdm_t_cnt, diff_ofdm_r_cnt, diff_ofdm_crc_error_cnt); + + dbg_print("CCK[t=0~1] {TX, RX, CRC_error} = {%d, %d, %d}\n", + p_atd_t->cck_t_cnt, p_atd_t->cck_r_cnt, p_atd_t->cck_crc_error_cnt); + dbg_print("CCK[t=1~2] {TX, RX, CRC_error} = {%d, %d, %d}\n", + curr_cck_t_cnt, curr_cck_r_cnt, curr_cck_crc_error_cnt); + dbg_print("CCK_diff {TX, RX, CRC_error} = {%d, %d, %d}\n", + diff_cck_t_cnt, diff_cck_r_cnt, diff_cck_crc_error_cnt); + + /* ----- Check Dbg Port --------------------------------*/ + + for (i = 0; i < DBGPORT_CHK_NUM; i++) { + + dbg_print("Dbg_port=((0x%x))\n", p_atd_t->dbg_port_table[i]); + dbg_print("Val{pre, curr}={0x%x, 0x%x}\n", p_atd_t->dbg_port_val[i], curr_dbg_port_val[i]); + + if ((p_atd_t->dbg_port_table[i]) == 0) { + + if (p_atd_t->dbg_port_val[i] == curr_dbg_port_val[i]) { + + dbg_print("BB state hang\n"); + dbg_print("ReasonCode:\n"); + } + + } else if (p_atd_t->dbg_port_table[i] == 0x803) { + + if (p_atd_t->dbg_port_val[i] == curr_dbg_port_val[i]) { + + //dbgport_803 = (struct n_dbgport_803 )(p_atd_t->dbg_port_val[i]); + + odm_move_memory(p_dm, &(dbgport_803), &(p_atd_t->dbg_port_val[i]), sizeof(struct n_dbgport_803)); + + dbg_print("RSTB{BB, GLB, OFDM}={%d, %d, %d}\n", dbgport_803.bb_rst_b, dbgport_803.glb_rst_b, dbgport_803.ofdm_rst_b); + dbg_print("{ofdm_tx_en, cck_tx_en, phy_tx_on}={%d, %d, %d}\n", dbgport_803.ofdm_tx_en, dbgport_803.cck_tx_en, dbgport_803.phy_tx_on); + dbg_print("CCA_PP{OFDM, CCK}={%d, %d}\n", dbgport_803.ofdm_cca_pp, dbgport_803.cck_cca_pp); + + if (dbgport_803.phy_tx_on) + dbg_print("Maybe TX Hang\n"); + else if (dbgport_803.ofdm_cca_pp || dbgport_803.cck_cca_pp) + dbg_print("Maybe RX Hang\n"); + } + + } else if (p_atd_t->dbg_port_table[i] == 0x208) { + + if ((p_atd_t->dbg_port_val[i] & BIT(30)) && (curr_dbg_port_val[i] & BIT(30))) { + + dbg_print("EDCCA Pause TX\n"); + dbg_print("ReasonCode: THN-2\n"); + } + + } else if (p_atd_t->dbg_port_table[i] == 0xab0) { + + if (((p_atd_t->dbg_port_val[i] & 0xffffff) == 0) || + ((curr_dbg_port_val[i] & 0xffffff) == 0)) { + + dbg_print("Wrong L-SIG formate\n"); + dbg_print("ReasonCode: THN-1\n"); + } + } + } + + phydm_check_hang_reset(p_dm); + } + + p_atd_t->dbg_step++; + +} + +void +phydm_bb_auto_check_hang_start_n( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + u32 value32 = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_auto_dbg_struc *p_atd_t = &(p_dm->auto_dbg_table); + u32 used = *_used; + u32 out_len = *_out_len; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + return; + + PHYDM_SNPRINTF((output + used, out_len - used, + "PHYDM auto check hang (N-series) is started, Please check the system log\n")); + + p_dm->debug_components |= ODM_COMP_API; + p_atd_t->auto_dbg_type = AUTO_DBG_CHECK_HANG; + p_atd_t->dbg_step = 0; + + + phydm_pause_dm_watchdog(p_dm, PHYDM_PAUSE); + + + + *_used = used; + *_out_len = out_len; +} + +void +phydm_bb_rx_hang_info_n( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + u32 value32 = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + return; + + PHYDM_SNPRINTF((output + used, out_len - used, "not support now\n")); + + *_used = used; + *_out_len = out_len; +} + +#endif + +#if (ODM_IC_11AC_SERIES_SUPPORT == 1) +void +phydm_bb_rx_hang_info_ac( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + u32 value32 = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + return; + + value32 = odm_get_bb_reg(p_dm, 0xF80, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32)); + + if (p_dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(p_dm, 0x198c, BIT(2) | BIT(1) | BIT(0), 7); + + /* dbg_port = basic state machine */ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x000); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "basic state machine", value32)); + } + + /* dbg_port = state machine */ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x007); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "state machine", value32)); + } + + /* dbg_port = CCA-related*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x204); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "CCA-related", value32)); + } + + + /* dbg_port = edcca/rxd*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x278); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "edcca/rxd", value32)); + } + + /* dbg_port = rx_state/mux_state/ADC_MASK_OFDM*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x290); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx_state/mux_state/ADC_MASK_OFDM", value32)); + } + + /* dbg_port = bf-related*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B2); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); + } + + /* dbg_port = bf-related*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0x2B8); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); + } + + /* dbg_port = txon/rxd*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA03); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "txon/rxd", value32)); + } + + /* dbg_port = l_rate/l_length*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0B); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "l_rate/l_length", value32)); + } + + /* dbg_port = rxd/rxd_hit*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xA0D); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rxd/rxd_hit", value32)); + } + + /* dbg_port = dis_cca*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAA0); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "dis_cca", value32)); + } + + + /* dbg_port = tx*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAB0); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "tx", value32)); + } + + /* dbg_port = rx plcp*/ + { + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD0); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); + + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD1); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); + + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD2); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); + + odm_set_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD, 0xAD3); + value32 = odm_get_bb_reg(p_dm, ODM_REG_DBG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); + + value32 = odm_get_bb_reg(p_dm, ODM_REG_RPT_11AC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); + } + *_used = used; + *_out_len = out_len; +} +#endif + +void +phydm_auto_dbg_console( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "Show dbg port: {1} {1}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "Auto check hang: {1} {2}\n")); + return; + } else if (var1[0] == 1) { + + PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); + + if (var1[1] == 1) { + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + #if (ODM_IC_11AC_SERIES_SUPPORT == 1) + phydm_bb_rx_hang_info_ac(p_dm, &used, output, &out_len); + #else + PHYDM_SNPRINTF((output + used, out_len - used, "Not support\n")); + #endif + } else { + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + phydm_bb_rx_hang_info_n(p_dm, &used, output, &out_len); + #else + PHYDM_SNPRINTF((output + used, out_len - used, "Not support\n")); + #endif + } + } else if (var1[1] == 2) { + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + PHYDM_SNPRINTF((output + used, out_len - used, "Not support\n")); + } else { + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + phydm_bb_auto_check_hang_start_n(p_dm, &used, output, &out_len); + #else + PHYDM_SNPRINTF((output + used, out_len - used, "Not support\n")); + #endif + } + } + } + + *_used = used; + *_out_len = out_len; +} + + +#endif + +void +phydm_auto_dbg_engine( + void *p_dm_void +) +{ +#ifdef PHYDM_AUTO_DEGBUG + u32 value32 = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_auto_dbg_struc *p_atd_t = &(p_dm->auto_dbg_table); + + if (p_atd_t->auto_dbg_type == AUTO_DBG_STOP) + return; + + dbg_print("%s ======>\n", __func__); + + if (p_atd_t->auto_dbg_type == AUTO_DBG_CHECK_HANG) { + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + dbg_print("Not Support\n"); + } else { + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + phydm_auto_check_hang_engine_n(p_dm); + #else + dbg_print("Not Support\n"); + #endif + } + + } else if (p_atd_t->auto_dbg_type == AUTO_DBG_CHECK_RA) { + + dbg_print("Not Support\n"); + + } +#endif +} + +void +phydm_auto_dbg_engine_init( + void *p_dm_void +) +{ +#ifdef PHYDM_AUTO_DEGBUG + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_auto_dbg_struc *p_atd_t = &(p_dm->auto_dbg_table); + u16 dbg_port_table[DBGPORT_CHK_NUM] = {0x0, 0x803, 0x208, 0xab0, 0xab1, 0xab2}; + + PHYDM_DBG(p_dm, ODM_COMP_API, ("%s ======>n", __func__)); + + odm_move_memory(p_dm, &(p_atd_t->dbg_port_table[0]), &(dbg_port_table[0]), (DBGPORT_CHK_NUM * 2)); + + phydm_check_hang_reset(p_dm); +#endif +} + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.h new file mode 100644 index 000000000000..784c5d12f4c5 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_auto_dbg.h @@ -0,0 +1,115 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDM_AUTO_DBG_H__ +#define __PHYDM_AUTO_DBG_H__ + +#define AUTO_DBG_VERSION "1.0" /* 2017.05.015 Dino, Add phydm_auto_dbg.h*/ + + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + +#define AUTO_CHK_HANG_STEP_MAX 3 +#define DBGPORT_CHK_NUM 6 + +#ifdef PHYDM_AUTO_DEGBUG + + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + +enum auto_dbg_type_e{ + AUTO_DBG_STOP = 0, + AUTO_DBG_CHECK_HANG = 1, + AUTO_DBG_CHECK_RA = 2, + AUTO_DBG_CHECK_DIG = 3 +}; + +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + +struct n_dbgport_803 { + /*BYTE 3*/ + u8 bb_rst_b: 1; + u8 glb_rst_b: 1; + u8 zero_1bit_1:1; + u8 ofdm_rst_b: 1; + u8 cck_txpe: 1; + u8 ofdm_txpe: 1; + u8 phy_tx_on: 1; + u8 tdrdy: 1; + /*BYTE 2*/ + u8 txd:8; + /*BYTE 1*/ + u8 cck_cca_pp: 1; + u8 ofdm_cca_pp: 1; + u8 rx_rst: 1; + u8 rdrdy: 1; + u8 rxd_7_4: 4; + /*BYTE 0*/ + u8 rxd_3_0: 4; + u8 ofdm_tx_en: 1; + u8 cck_tx_en: 1; + u8 zero_1bit_2:1; + u8 clk_80m: 1; +}; + +struct phydm_auto_dbg_struc { + + enum auto_dbg_type_e auto_dbg_type; + u8 dbg_step; + u16 dbg_port_table[DBGPORT_CHK_NUM]; + u32 dbg_port_val[DBGPORT_CHK_NUM]; + u16 ofdm_t_cnt; + u16 ofdm_r_cnt; + u16 cck_t_cnt; + u16 cck_r_cnt; + u16 ofdm_crc_error_cnt; + u16 cck_crc_error_cnt; + +}; + + +/* 1 ============================================================ + * 1 function prototype + * 1 ============================================================ */ + + +void +phydm_auto_dbg_console( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); +#endif + +void +phydm_auto_dbg_engine( + void *p_dm_void +); + +void +phydm_auto_dbg_engine_init( + void *p_dm_void +); +#endif \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.c index c70514e38e3f..c2a9af56952b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.c @@ -1,1882 +1,1985 @@ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#if WPP_SOFTWARE_TRACE -#include "phydm_beamforming.tmh" -#endif -#endif - -#if (BEAMFORMING_SUPPORT == 1) - -PRT_BEAMFORM_STAINFO -phydm_staInfoInit( - IN PDM_ODM_T pDM_Odm, - IN u2Byte staIdx - ) -{ - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORM_STAINFO pEntry = &(pBeamInfo->BeamformSTAinfo); - PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; - PADAPTER Adapter = pDM_Odm->Adapter; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pMgntInfo); - PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pMgntInfo); - - ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, Adapter->CurrentAddress, 6); - - pEntry->HtBeamformCap = pHTInfo->HtBeamformCap; - pEntry->VhtBeamformCap = pVHTInfo->VhtBeamformCap; - - /*IBSS, AP mode*/ - if (staIdx != 0) { - pEntry->AID = pSTA->AID; - pEntry->RA = pSTA->MacAddr; - pEntry->MacID = pSTA->AssociatedMacId; - pEntry->WirelessMode = pSTA->WirelessMode; - pEntry->BW = pSTA->BandWidth; - pEntry->CurBeamform = pSTA->HTInfo.HtCurBeamform; - } else {/*client mode*/ - pEntry->AID = pMgntInfo->mAId; - pEntry->RA = pMgntInfo->Bssid; - pEntry->MacID = pMgntInfo->mMacId; - pEntry->WirelessMode = pMgntInfo->dot11CurrentWirelessMode; - pEntry->BW = pMgntInfo->dot11CurrentChannelBandWidth; - pEntry->CurBeamform = pHTInfo->HtCurBeamform; - } - - if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { - if (staIdx != 0) - pEntry->CurBeamformVHT = pSTA->VHTInfo.VhtCurBeamform; - else - pEntry->CurBeamformVHT = pVHTInfo->VhtCurBeamform; - } - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->WirelessMode, staIdx)); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - if (!IS_STA_VALID(pSTA)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s => sta_info(mac_id:%d) failed\n", __func__, staIdx)); - rtw_warn_on(1); - return pEntry; - } - - ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, adapter_mac_addr(pSTA->padapter), 6); - pEntry->HtBeamformCap = pSTA->htpriv.beamform_cap; - - pEntry->AID = pSTA->aid; - pEntry->RA = pSTA->hwaddr; - pEntry->MacID = pSTA->mac_id; - pEntry->WirelessMode = pSTA->wireless_mode; - pEntry->BW = pSTA->bw_mode; - - pEntry->CurBeamform = pSTA->htpriv.beamform_cap; -#if ODM_IC_11AC_SERIES_SUPPORT - if ((pEntry->WirelessMode & WIRELESS_MODE_AC_5G) || (pEntry->WirelessMode & WIRELESS_MODE_AC_24G)) { - pEntry->CurBeamformVHT = pSTA->vhtpriv.beamform_cap; - pEntry->VhtBeamformCap = pSTA->vhtpriv.beamform_cap; - } -#endif - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pSTA->wireless_mode = 0x%x, staidx = %d\n", pSTA->wireless_mode, staIdx)); -#endif - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("pEntry->CurBeamform = 0x%x, pEntry->CurBeamformVHT = 0x%x\n", pEntry->CurBeamform, pEntry->CurBeamformVHT)); - return pEntry; - -} -void phydm_staInfoUpdate( - IN PDM_ODM_T pDM_Odm, - IN u2Byte staIdx, - PRT_BEAMFORMEE_ENTRY pBeamformEntry - ) -{ - PSTA_INFO_T pSTA = pDM_Odm->pODM_StaInfo[staIdx]; - - if (!IS_STA_VALID(pSTA)) - return; - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - pSTA->txbf_paid = pBeamformEntry->P_AID; - pSTA->txbf_gid = pBeamformEntry->G_ID; -#endif -} - -PRT_BEAMFORMEE_ENTRY -phydm_Beamforming_GetBFeeEntryByAddr( - IN PVOID pDM_VOID, - IN pu1Byte RA, - OUT pu1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - if (pBeamInfo->BeamformeeEntry[i].bUsed && (eqMacAddr(RA, pBeamInfo->BeamformeeEntry[i].MacAddr))) { - *Idx = i; - return &(pBeamInfo->BeamformeeEntry[i]); - } - } - - return NULL; -} - -PRT_BEAMFORMER_ENTRY -phydm_Beamforming_GetBFerEntryByAddr( - IN PVOID pDM_VOID, - IN pu1Byte TA, - OUT pu1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { - if (pBeamInfo->BeamformerEntry[i].bUsed && (eqMacAddr(TA, pBeamInfo->BeamformerEntry[i].MacAddr))) { - *Idx = i; - return &(pBeamInfo->BeamformerEntry[i]); - } - } - - return NULL; -} - - -PRT_BEAMFORMEE_ENTRY -phydm_Beamforming_GetEntryByMacId( - IN PVOID pDM_VOID, - IN u1Byte MacId, - OUT pu1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { - *Idx = i; - return &(pBeamInfo->BeamformeeEntry[i]); - } - } - - return NULL; -} - - -BEAMFORMING_CAP -phydm_Beamforming_GetEntryBeamCapByMacId( - IN PVOID pDM_VOID, - IN u1Byte MacId - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - BEAMFORMING_CAP BeamformEntryCap = BEAMFORMING_CAP_NONE; - - for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - if (pBeamInfo->BeamformeeEntry[i].bUsed && (MacId == pBeamInfo->BeamformeeEntry[i].MacId)) { - BeamformEntryCap = pBeamInfo->BeamformeeEntry[i].BeamformEntryCap; - i = BEAMFORMEE_ENTRY_NUM; - } - } - - return BeamformEntryCap; -} - - -PRT_BEAMFORMEE_ENTRY -phydm_Beamforming_GetFreeBFeeEntry( - IN PVOID pDM_VOID, - OUT pu1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - if (pBeamInfo->BeamformeeEntry[i].bUsed == FALSE) { - *Idx = i; - return &(pBeamInfo->BeamformeeEntry[i]); - } - } - return NULL; -} - -PRT_BEAMFORMER_ENTRY -phydm_Beamforming_GetFreeBFerEntry( - IN PVOID pDM_VOID, - OUT pu1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s ===>\n", __func__)); - - for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { - if (pBeamInfo->BeamformerEntry[i].bUsed == FALSE) { - *Idx = i; - return &(pBeamInfo->BeamformerEntry[i]); - } - } - return NULL; -} - -/* -// Description: Get the first entry index of MU Beamformee. -// -// Return Value: Index of the first MU sta. -// -// 2015.05.25. Created by tynli. -// -*/ -u1Byte -phydm_Beamforming_GetFirstMUBFeeEntryIdx( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte idx = 0xFF; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - BOOLEAN bFound = FALSE; - - for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { - if (pBeamInfo->BeamformeeEntry[idx].bUsed && pBeamInfo->BeamformeeEntry[idx].is_mu_sta) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d!\n", __func__, idx)); - bFound = TRUE; - break; - } - } - - if (!bFound) - idx = 0xFF; - - return idx; -} - - -/*Add SU BFee and MU BFee*/ -PRT_BEAMFORMEE_ENTRY -Beamforming_AddBFeeEntry( - IN PVOID pDM_VOID, - IN PRT_BEAMFORM_STAINFO pSTA, - IN BEAMFORMING_CAP BeamformCap, - IN u1Byte NumofSoundingDim, - IN u1Byte CompSteeringNumofBFer, - OUT pu1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetFreeBFeeEntry(pDM_Odm, Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (pEntry != NULL) { - pEntry->bUsed = TRUE; - pEntry->AID = pSTA->AID; - pEntry->MacId = pSTA->MacID; - pEntry->SoundBW = pSTA->BW; - ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { - /*BSSID[44:47] xor BSSID[40:43]*/ - u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); - /*(dec(A) + dec(B)*32) mod 512*/ - pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; - pEntry->G_ID = 63; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to STA=%d\n", __func__, pEntry->P_AID)); - } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { - /*ad hoc mode*/ - pEntry->P_AID = 0; - pEntry->G_ID = 63; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID as IBSS=%d\n", __func__, pEntry->P_AID)); - } else { - /*client mode*/ - pEntry->P_AID = pSTA->RA[5]; - /*BSSID[39:47]*/ - pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); - pEntry->G_ID = 0; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BFee P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); - } - cpMacAddr(pEntry->MacAddr, pSTA->RA); - pEntry->bTxBF = FALSE; - pEntry->bSound = FALSE; - pEntry->SoundPeriod = 400; - pEntry->BeamformEntryCap = BeamformCap; - pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; - -/* pEntry->LogSeq = 0xff; Move to Beamforming_AddBFerEntry*/ -/* pEntry->LogRetryCnt = 0; Move to Beamforming_AddBFerEntry*/ -/* pEntry->LogSuccessCnt = 0; Move to Beamforming_AddBFerEntry*/ - - pEntry->LogStatusFailCnt = 0; - - pEntry->NumofSoundingDim = NumofSoundingDim; - pEntry->CompSteeringNumofBFer = CompSteeringNumofBFer; - - if (BeamformCap & BEAMFORMER_CAP_VHT_MU) { - pDM_Odm->BeamformingInfo.beamformee_mu_cnt += 1; - pEntry->is_mu_sta = TRUE; - pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); - } else if (BeamformCap & (BEAMFORMER_CAP_VHT_SU|BEAMFORMER_CAP_HT_EXPLICIT)) { - pDM_Odm->BeamformingInfo.beamformee_su_cnt += 1; - pEntry->is_mu_sta = FALSE; - } - - return pEntry; - } - else - return NULL; -} - -/*Add SU BFee and MU BFer*/ -PRT_BEAMFORMER_ENTRY -Beamforming_AddBFerEntry( - IN PVOID pDM_VOID, - IN PRT_BEAMFORM_STAINFO pSTA, - IN BEAMFORMING_CAP BeamformCap, - IN u1Byte NumofSoundingDim, - OUT pu1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMER_ENTRY pEntry = phydm_Beamforming_GetFreeBFerEntry(pDM_Odm, Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (pEntry != NULL) { - pEntry->bUsed = TRUE; - ODM_MoveMemory(pDM_Odm, pEntry->MyMacAddr, pSTA->MyMacAddr, 6); - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { - /*BSSID[44:47] xor BSSID[40:43]*/ - u2Byte BSSID = ((pSTA->MyMacAddr[5] & 0xf0) >> 4) ^ (pSTA->MyMacAddr[5] & 0xf); - - pEntry->P_AID = (pSTA->AID + BSSID * 32) & 0x1ff; - pEntry->G_ID = 63; - /*(dec(A) + dec(B)*32) mod 512*/ - } else if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) { - pEntry->P_AID = 0; - pEntry->G_ID = 63; - } else { - pEntry->P_AID = pSTA->RA[5]; - /*BSSID[39:47]*/ - pEntry->P_AID = (pEntry->P_AID << 1) | (pSTA->RA[4] >> 7); - pEntry->G_ID = 0; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: P_AID addressed to AP=0x%X\n", __func__, pEntry->P_AID)); - } - - cpMacAddr(pEntry->MacAddr, pSTA->RA); - pEntry->BeamformEntryCap = BeamformCap; - - pEntry->PreLogSeq = 0; /*Modified by Jeffery @2015-04-13*/ - pEntry->LogSeq = 0; /*Modified by Jeffery @2014-10-29*/ - pEntry->LogRetryCnt = 0; /*Modified by Jeffery @2014-10-29*/ - pEntry->LogSuccess = 0; /*LogSuccess is NOT needed to be accumulated, so LogSuccessCnt->LogSuccess, 2015-04-13, Jeffery*/ - pEntry->ClockResetTimes = 0; /*Modified by Jeffery @2015-04-13*/ - - pEntry->NumofSoundingDim = NumofSoundingDim; - - if (BeamformCap & BEAMFORMEE_CAP_VHT_MU) { - pDM_Odm->BeamformingInfo.beamformer_mu_cnt += 1; - pEntry->is_mu_ap = TRUE; - pEntry->AID = pSTA->AID; - } else if (BeamformCap & (BEAMFORMEE_CAP_VHT_SU|BEAMFORMEE_CAP_HT_EXPLICIT)) { - pDM_Odm->BeamformingInfo.beamformer_su_cnt += 1; - pEntry->is_mu_ap = FALSE; - } - - return pEntry; - } - else - return NULL; -} - -#if 0 -BOOLEAN -Beamforming_RemoveEntry( - IN PADAPTER Adapter, - IN pu1Byte RA, - OUT pu1Byte Idx - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, Idx); - PRT_BEAMFORMEE_ENTRY pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, Idx); - BOOLEAN ret = FALSE; - - RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s Start!\n", __func__)); - RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pBFerEntry=0x%x\n", __func__, pBFerEntry)); - RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, pEntry=0x%x\n", __func__, pEntry)); - - if (pEntry != NULL) { - pEntry->bUsed = FALSE; - pEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; - /*pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE;*/ - pEntry->bBeamformingInProgress = FALSE; - ret = TRUE; - } - if (pBFerEntry != NULL) { - pBFerEntry->bUsed = FALSE; - pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; - ret = TRUE; - } - return ret; - -} -#endif - -/* Used for BeamformingStart_V1 */ -VOID -phydm_Beamforming_NDPARate( - IN PVOID pDM_VOID, - CHANNEL_WIDTH BW, - u1Byte Rate -) -{ - u2Byte NDPARate = Rate; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (NDPARate == 0) { - if(pDM_Odm->RSSI_Min > 30) // link RSSI > 30% - NDPARate = ODM_RATE24M; - else - NDPARate = ODM_RATE6M; - } - - if (NDPARate < ODM_RATEMCS0) - BW = (CHANNEL_WIDTH)ODM_BW20M; - - NDPARate = (NDPARate << 8) | BW; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); - -} - - -/* Used for BeamformingStart_SW and BeamformingStart_FW */ -VOID -phydm_Beamforming_DymNDPARate( - IN PVOID pDM_VOID -) -{ - u2Byte NDPARate = ODM_RATE6M, BW; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (pDM_Odm->RSSI_Min > 30) /*link RSSI > 30%*/ - NDPARate = ODM_RATE24M; - else - NDPARate = ODM_RATE6M; - - BW = ODM_BW20M; - NDPARate = NDPARate << 8 | BW; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_RATE, (pu1Byte)&NDPARate); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, NDPA Rate = 0x%X\n", __func__, NDPARate)); -} - -/* -* SW Sounding : SW Timer unit 1ms -* HW Timer unit (1/32000) s 32k is clock. -* FW Sounding : FW Timer unit 10ms -*/ -VOID -Beamforming_DymPeriod( - IN PVOID pDM_VOID, - IN u8 status -) -{ - u1Byte Idx; - BOOLEAN bChangePeriod = FALSE; - u2Byte SoundPeriod_SW, SoundPeriod_FW; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - PRT_BEAMFORMEE_ENTRY pBeamformEntry; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); - - PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - //3 TODO per-client throughput caculation. - - if ((*(pDM_Odm->pCurrentTxTP) + *(pDM_Odm->pCurrentRxTP) > 2) && ((pEntry->LogStatusFailCnt <= 20) || status)) { - SoundPeriod_SW = 40; /* 40ms */ - SoundPeriod_FW = 40; /* From H2C cmd, unit = 10ms */ - } else { - SoundPeriod_SW = 4000;/* 4s */ - SoundPeriod_FW = 400; - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]SoundPeriod_SW=%d, SoundPeriod_FW=%d\n", __func__, SoundPeriod_SW, SoundPeriod_FW)); - - for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { - pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; - - if (pBeamformEntry->DefaultCSICnt > 20) { - /*Modified by David*/ - SoundPeriod_SW = 4000; - SoundPeriod_FW = 400; - } - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Period = %d\n", __func__, SoundPeriod_SW)); - if (pBeamformEntry->BeamformEntryCap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { - if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) { - if (pBeamformEntry->SoundPeriod != SoundPeriod_FW) { - pBeamformEntry->SoundPeriod = SoundPeriod_FW; - bChangePeriod = TRUE; /*Only FW sounding need to send H2C packet to change sound period. */ - } - } else if (pBeamformEntry->SoundPeriod != SoundPeriod_SW) { - pBeamformEntry->SoundPeriod = SoundPeriod_SW; - } - } - } - - if (bChangePeriod) - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); -} - - - - -BOOLEAN -Beamforming_SendHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW, - IN u1Byte QIdx - ) -{ - BOOLEAN ret = TRUE; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (QIdx == BEACON_QUEUE) - ret = SendFWHTNDPAPacket(pDM_Odm, RA, BW); - else - ret = SendSWHTNDPAPacket(pDM_Odm, RA, BW); - - return ret; -} - - - -BOOLEAN -Beamforming_SendVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW, - IN u1Byte QIdx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - BOOLEAN ret = TRUE; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - - HalComTxbf_Set(pDM_Odm, TXBF_SET_GET_TX_RATE, NULL); - - if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9) && (pBeamInfo->snding3SS == FALSE)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: 3SS VHT 789 don't sounding\n", __func__)); - - } else { - if (QIdx == BEACON_QUEUE) /* Send to reserved page => FW NDPA */ - ret = SendFWVHTNDPAPacket(pDM_Odm, RA, AID, BW); - else { -#ifdef SUPPORT_MU_BF - #if (SUPPORT_MU_BF == 1) - pBeamInfo->is_mu_sounding = TRUE; - ret = SendSWVHTMUNDPAPacket(pDM_Odm, BW); - #else - pBeamInfo->is_mu_sounding = FALSE; - ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); - #endif -#else - pBeamInfo->is_mu_sounding = FALSE; - ret = SendSWVHTNDPAPacket(pDM_Odm, RA, AID, BW); -#endif - } - } - return ret; -} - - -BEAMFORMING_NOTIFY_STATE -phydm_beamfomring_bSounding( - IN PVOID pDM_VOID, - PRT_BEAMFORMING_INFO pBeamInfo, - pu1Byte Idx - ) -{ - BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; - RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - /*if(( Beamforming_GetBeamCap(pBeamInfo) & BEAMFORMER_CAP) == 0)*/ - /*bSounding = BEAMFORMING_NOTIFY_RESET;*/ - if (BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER) - bSounding = BEAMFORMING_NOTIFY_RESET; - else { - u1Byte i; - - for (i = 0 ; i < BEAMFORMEE_ENTRY_NUM ; i++) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s: BFee Entry %d bUsed=%d, bSound=%d\n", __func__, i, pBeamInfo->BeamformeeEntry[i].bUsed, pBeamInfo->BeamformeeEntry[i].bSound)); - if (pBeamInfo->BeamformeeEntry[i].bUsed && (!pBeamInfo->BeamformeeEntry[i].bSound)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Add BFee entry %d\n", __func__, i)); - *Idx = i; - if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) - bSounding = BEAMFORMEE_NOTIFY_ADD_MU; - else - bSounding = BEAMFORMEE_NOTIFY_ADD_SU; - } - - if ((!pBeamInfo->BeamformeeEntry[i].bUsed) && pBeamInfo->BeamformeeEntry[i].bSound) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Delete BFee entry %d\n", __func__, i)); - *Idx = i; - if (pBeamInfo->BeamformeeEntry[i].is_mu_sta) - bSounding = BEAMFORMEE_NOTIFY_DELETE_MU; - else - bSounding = BEAMFORMEE_NOTIFY_DELETE_SU; - } - } - } - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, bSounding = %d\n", __func__, bSounding)); - return bSounding; -} - - -//This function is unused -u1Byte -phydm_beamforming_SoundingIdx( - IN PVOID pDM_VOID, - PRT_BEAMFORMING_INFO pBeamInfo - ) -{ - u1Byte Idx = 0; - RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || - BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) - Idx = BeamOidInfo.SoundOidIdx; - else { - u1Byte i; - for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - if (pBeamInfo->BeamformeeEntry[i].bUsed && (FALSE == pBeamInfo->BeamformeeEntry[i].bSound)) { - Idx = i; - break; - } - } - } - - return Idx; -} - - -SOUNDING_MODE -phydm_beamforming_SoundingMode( - IN PVOID pDM_VOID, - PRT_BEAMFORMING_INFO pBeamInfo, - u1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte SupportInterface = pDM_Odm->SupportInterface; - - RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; - RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; - SOUNDING_MODE Mode = BeamOidInfo.SoundOidMode; - - if (BeamOidInfo.SoundOidMode == SOUNDING_SW_VHT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_VHT_TIMER) { - if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) - Mode = BeamOidInfo.SoundOidMode; - else - Mode = SOUNDING_STOP_All_TIMER; - } else if (BeamOidInfo.SoundOidMode == SOUNDING_SW_HT_TIMER || BeamOidInfo.SoundOidMode == SOUNDING_HW_HT_TIMER) { - if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) - Mode = BeamOidInfo.SoundOidMode; - else - Mode = SOUNDING_STOP_All_TIMER; - } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) { - if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) - Mode = SOUNDING_FW_VHT_TIMER; - else - Mode = SOUNDING_SW_VHT_TIMER; - } else if (BeamEntry.BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) { - if ((SupportInterface == ODM_ITRF_USB) && !(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B))) - Mode = SOUNDING_FW_HT_TIMER; - else - Mode = SOUNDING_SW_HT_TIMER; - } else - Mode = SOUNDING_STOP_All_TIMER; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SupportInterface=%d, Mode=%d\n", __func__, SupportInterface, Mode)); - - return Mode; -} - - -u2Byte -phydm_beamforming_SoundingTime( - IN PVOID pDM_VOID, - PRT_BEAMFORMING_INFO pBeamInfo, - SOUNDING_MODE Mode, - u1Byte Idx - ) -{ - u2Byte SoundingTime = 0xffff; - RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; - RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) - SoundingTime = BeamOidInfo.SoundOidPeriod * 32; - else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) - /*Modified by David*/ - SoundingTime = BeamEntry.SoundPeriod; /*BeamOidInfo.SoundOidPeriod;*/ - else - SoundingTime = BeamEntry.SoundPeriod; - - return SoundingTime; -} - - -CHANNEL_WIDTH -phydm_beamforming_SoundingBW( - IN PVOID pDM_VOID, - PRT_BEAMFORMING_INFO pBeamInfo, - SOUNDING_MODE Mode, - u1Byte Idx - ) -{ - CHANNEL_WIDTH SoundingBW = CHANNEL_WIDTH_20; - RT_BEAMFORMEE_ENTRY BeamEntry = pBeamInfo->BeamformeeEntry[Idx]; - RT_BEAMFORMING_OID_INFO BeamOidInfo = pBeamInfo->BeamformingOidInfo; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_HW_VHT_TIMER) - SoundingBW = BeamOidInfo.SoundOidBW; - else if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_SW_VHT_TIMER) - /*Modified by David*/ - SoundingBW = BeamEntry.SoundBW; /*BeamOidInfo.SoundOidBW;*/ - else - SoundingBW = BeamEntry.SoundBW; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, SoundingBW=0x%X\n", __func__, SoundingBW)); - - return SoundingBW; -} - - -BOOLEAN -phydm_Beamforming_SelectBeamEntry( - IN PVOID pDM_VOID, - PRT_BEAMFORMING_INFO pBeamInfo - ) -{ - PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - /*pEntry.bSound is different between first and latter NDPA, and should not be used as BFee entry selection*/ - /*BTW, latter modification should sync to the selection mechanism of AP/ADSL instead of the fixed SoundIdx.*/ - pSoundInfo->SoundIdx = phydm_beamforming_SoundingIdx(pDM_Odm, pBeamInfo); - /*pSoundInfo->SoundIdx = 0;*/ - - if (pSoundInfo->SoundIdx < BEAMFORMEE_ENTRY_NUM) - pSoundInfo->SoundMode = phydm_beamforming_SoundingMode(pDM_Odm, pBeamInfo, pSoundInfo->SoundIdx); - else - pSoundInfo->SoundMode = SOUNDING_STOP_All_TIMER; - - if (SOUNDING_STOP_All_TIMER == pSoundInfo->SoundMode) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Return because of SOUNDING_STOP_All_TIMER\n", __func__)); - return FALSE; - } else { - pSoundInfo->SoundBW = phydm_beamforming_SoundingBW(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); - pSoundInfo->SoundPeriod = phydm_beamforming_SoundingTime(pDM_Odm, pBeamInfo, pSoundInfo->SoundMode, pSoundInfo->SoundIdx ); - return TRUE; - } -} - -/*SU BFee Entry Only*/ -BOOLEAN -phydm_beamforming_StartPeriod( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - BOOLEAN Ret = TRUE; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); - - phydm_Beamforming_DymNDPARate(pDM_Odm); - - phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); // Modified - - if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) - ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); - else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || - pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) { - HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; - u4Byte val = (pSoundInfo->SoundPeriod | (TimerType<<16)); - - //HW timer stop: All IC has the same setting - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); - //ODM_Write1Byte(pDM_Odm, 0x15F, 0); - //HW timer init: All IC has the same setting, but 92E & 8812A only write 2 bytes - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_INIT, (pu1Byte)(&val)); - //ODM_Write1Byte(pDM_Odm, 0x164, 1); - //ODM_Write4Byte(pDM_Odm, 0x15C, val); - //HW timer start: All IC has the same setting - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_START, (pu1Byte)(&TimerType)); - //ODM_Write1Byte(pDM_Odm, 0x15F, 0x5); - } else if (pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER) - Ret = BeamformingStart_FW(pDM_Odm, pSoundInfo->SoundIdx); - else - Ret = FALSE; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SoundIdx=%d, SoundMode=%d, SoundBW=%d, SoundPeriod=%d\n", __func__, - pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW, pSoundInfo->SoundPeriod)); - - return Ret; -} - -// Used after Beamforming_Leave, and will clear the setting of the "already deleted" entry -/*SU BFee Entry Only*/ -VOID -phydm_beamforming_EndPeriod_SW( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); - - HAL_HW_TIMER_TYPE TimerType = HAL_TIMER_TXBF; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) - ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); - else if (pSoundInfo->SoundMode == SOUNDING_HW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_HW_HT_TIMER || - pSoundInfo->SoundMode == SOUNDING_AUTO_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_AUTO_HT_TIMER) - /*HW timer stop: All IC has the same setting*/ - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_STOP, (pu1Byte)(&TimerType)); - /*ODM_Write1Byte(pDM_Odm, 0x15F, 0);*/ -} - -VOID -phydm_beamforming_EndPeriod_FW( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Idx = 0; - - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]\n", __func__)); -} - - -/*SU BFee Entry Only*/ -VOID -phydm_beamforming_ClearEntry_SW( - IN PVOID pDM_VOID, - BOOLEAN IsDelete, - u1Byte DeleteIdx - ) -{ - u1Byte Idx = 0; - PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - if (IsDelete) { - if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { - pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; - if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW DeleteIdx is wrong!!!!!\n", __func__)); - return; - } - } - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW delete BFee entry %d\n", __func__, DeleteIdx)); - if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) { - pBeamformEntry->bBeamformingInProgress = FALSE; - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; - } else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&DeleteIdx); - } - pBeamformEntry->bSound = FALSE; - } else { - for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { - pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; - - /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ - /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ - /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ - - if (pBeamformEntry->bSound) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] SW reset BFee entry %d\n", __func__, Idx)); - /* - * If End procedure is - * 1. Between (Send NDPA, C2H packet return), reset state to initialized. - * After C2H packet return , status bit will be set to zero. - * - * 2. After C2H packet, then reset state to initialized and clear status bit. - */ - - if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) - phydm_Beamforming_End_SW(pDM_Odm, 0); - else if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); - } - - pBeamformEntry->bSound = FALSE; - } - } - } -} - -VOID -phydm_beamforming_ClearEntry_FW( - IN PVOID pDM_VOID, - BOOLEAN IsDelete, - u1Byte DeleteIdx - ) -{ - u1Byte Idx = 0; - PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - if (IsDelete) { - if (DeleteIdx < BEAMFORMEE_ENTRY_NUM) { - pBeamformEntry = pBeamInfo->BeamformeeEntry + DeleteIdx; - - if (!((!pBeamformEntry->bUsed) && pBeamformEntry->bSound)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] FW DeleteIdx is wrong!!!!!\n", __func__)); - return; - } - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: FW delete BFee entry %d\n", __func__, DeleteIdx)); - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; - pBeamformEntry->bSound = FALSE; - } else { - for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { - pBeamformEntry = pBeamInfo->BeamformeeEntry+Idx; - - /*Used after bSounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ - /*This function is mainly used in case "BeamOidInfo.SoundOidMode == SOUNDING_STOP_All_TIMER".*/ - /*However, setting oid doesn't delete entries (bUsed is still TRUE), new entries may fail to be added in.*/ - - if (pBeamformEntry->bSound) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]FW reset BFee entry %d\n", __func__, Idx)); - /* - * If End procedure is - * 1. Between (Send NDPA, C2H packet return), reset state to initialized. - * After C2H packet return , status bit will be set to zero. - * - * 2. After C2H packet, then reset state to initialized and clear status bit. - */ - - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; - pBeamformEntry->bSound = FALSE; - } - } - } -} - -/* -* Called : -* 1. Add and delete entry : Beamforming_Enter/Beamforming_Leave -* 2. FW trigger : Beamforming_SetTxBFen -* 3. Set OID_RT_BEAMFORMING_PERIOD : BeamformingControl_V2 -*/ -VOID -phydm_Beamforming_Notify( - IN PVOID pDM_VOID - ) -{ - u1Byte Idx=BEAMFORMEE_ENTRY_NUM; - BEAMFORMING_NOTIFY_STATE bSounding = BEAMFORMING_NOTIFY_NONE; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - bSounding = phydm_beamfomring_bSounding(pDM_Odm, pBeamInfo, &Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Before notify, bSounding=%d, Idx=%d\n", __func__, bSounding, Idx)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: pBeamInfo->beamformee_su_cnt = %d\n", __func__, pBeamInfo->beamformee_su_cnt)); - - - switch (bSounding) { - case BEAMFORMEE_NOTIFY_ADD_SU: - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_SU\n", __func__)); - phydm_beamforming_StartPeriod(pDM_Odm); - break; - - case BEAMFORMEE_NOTIFY_DELETE_SU: - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_SU\n", __func__)); - if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { - phydm_beamforming_ClearEntry_FW(pDM_Odm, TRUE, Idx); - if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ - phydm_beamforming_EndPeriod_FW(pDM_Odm); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); - } - } else { - phydm_beamforming_ClearEntry_SW(pDM_Odm, TRUE, Idx); - if (pBeamInfo->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ - phydm_beamforming_EndPeriod_SW(pDM_Odm); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: No BFee left\n", __func__)); - } - } - break; - - case BEAMFORMEE_NOTIFY_ADD_MU: - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_ADD_MU\n", __func__)); - if (pBeamInfo->beamformee_mu_cnt == 2) { - /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) - ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod);*/ - ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, 1000); /*Do MU sounding every 1sec*/ - } else - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less or larger than 2 MU STAs, not to set timer\n", __func__)); - break; - - case BEAMFORMEE_NOTIFY_DELETE_MU: - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: BEAMFORMEE_NOTIFY_DELETE_MU\n", __func__)); - if (pBeamInfo->beamformee_mu_cnt == 1) { - /*if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER)*/{ - ODM_CancelTimer(pDM_Odm, &pBeamInfo->BeamformingTimer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Less than 2 MU STAs, stop sounding\n", __func__)); - } - } - break; - - case BEAMFORMING_NOTIFY_RESET: - if (pSoundInfo->SoundMode == SOUNDING_FW_HT_TIMER || pSoundInfo->SoundMode == SOUNDING_FW_VHT_TIMER) { - phydm_beamforming_ClearEntry_FW(pDM_Odm, FALSE, Idx); - phydm_beamforming_EndPeriod_FW(pDM_Odm); - } else { - phydm_beamforming_ClearEntry_SW(pDM_Odm, FALSE, Idx); - phydm_beamforming_EndPeriod_SW(pDM_Odm); - } - - break; - - default: - break; - } - -} - - - -BOOLEAN -Beamforming_InitEntry( - IN PVOID pDM_VOID, - IN u2Byte staIdx, - pu1Byte BFerBFeeIdx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; - PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; - PRT_BEAMFORM_STAINFO pSTA = NULL; - BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; - u1Byte BFerIdx=0xF, BFeeIdx=0xF; - u1Byte NumofSoundingDim = 0, CompSteeringNumofBFer = 0; - - pSTA = phydm_staInfoInit(pDM_Odm, staIdx); - - /*The current setting does not support Beaforming*/ - if (BEAMFORMING_CAP_NONE == pSTA->HtBeamformCap && BEAMFORMING_CAP_NONE == pSTA->VhtBeamformCap) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("The configuration disabled Beamforming! Skip...\n")); - return FALSE; - } - - if (pSTA->WirelessMode < WIRELESS_MODE_N_24G) - return FALSE; - else { - if (pSTA->WirelessMode & WIRELESS_MODE_N_5G || pSTA->WirelessMode & WIRELESS_MODE_N_24G) {/*HT*/ - if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) {/*We are Beamformee because the STA is Beamformer*/ - BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP_HT_EXPLICIT); - NumofSoundingDim = (pSTA->CurBeamform&BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP)>>6; - } - /*We are Beamformer because the STA is Beamformee*/ - if (TEST_FLAG(pSTA->CurBeamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE) || - TEST_FLAG(pSTA->HtBeamformCap, BEAMFORMING_HT_BEAMFORMER_TEST)) { - BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_HT_EXPLICIT); - CompSteeringNumofBFer = (pSTA->CurBeamform & BEAMFORMING_HT_BEAMFORMER_STEER_NUM)>>4; - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT CurBeamform=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamform, BeamformCap)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] HT NumofSoundingDim=%d, CompSteeringNumofBFer=%d\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); - } -#if (ODM_IC_11AC_SERIES_SUPPORT == 1) - if (pSTA->WirelessMode & WIRELESS_MODE_AC_5G || pSTA->WirelessMode & WIRELESS_MODE_AC_24G) { /*VHT*/ - - /* We are Beamformee because the STA is SU Beamformer*/ - if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { - BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMEE_CAP_VHT_SU); - NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; - } - /* We are Beamformer because the STA is SU Beamformee*/ - if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) || - TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { - BeamformCap =(BEAMFORMING_CAP)(BeamformCap |BEAMFORMER_CAP_VHT_SU); - CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; - } - /* We are Beamformee because the STA is MU Beamformer*/ - if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { - BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP_VHT_MU); - NumofSoundingDim = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM)>>12; - } - /* We are Beamformer because the STA is MU Beamformee*/ - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) { /* Only AP mode supports to act an MU beamformer */ - if (TEST_FLAG(pSTA->CurBeamformVHT, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) || - TEST_FLAG(pSTA->VhtBeamformCap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { - BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP_VHT_MU); - CompSteeringNumofBFer = (pSTA->CurBeamformVHT & BEAMFORMING_VHT_BEAMFORMER_STS_CAP)>>8; - } - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT CurBeamformVHT=0x%X, BeamformCap=0x%X\n", __func__, pSTA->CurBeamformVHT, BeamformCap)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]VHT NumofSoundingDim=0x%X, CompSteeringNumofBFer=0x%X\n", __func__, NumofSoundingDim, CompSteeringNumofBFer)); - - } -#endif - } - - - if(BeamformCap == BEAMFORMING_CAP_NONE) - return FALSE; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Self BF Entry Cap = 0x%02X\n", __func__, BeamformCap)); - - /*We are BFee, so the entry is BFer*/ - if (BeamformCap & (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { - pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, pSTA->RA, &BFerIdx); - - if (pBeamformerEntry == NULL) { - pBeamformerEntry = Beamforming_AddBFerEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim , &BFerIdx); - if (pBeamformerEntry == NULL) - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Not enough BFer entry!!!!!\n", __func__)); - } - } - - /*We are BFer, so the entry is BFee*/ - if (BeamformCap & (BEAMFORMER_CAP_VHT_MU | BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { - pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, pSTA->RA, &BFeeIdx); - - /*¦pªGBFeeIdx = 0xF «h¥Nªí¥Ø«eentry·í¤¤¨S¦³¬Û¦PªºMACID¦b¤º*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BFee entry 0x%X by address\n", __func__, BFeeIdx)); - if (pBeamformEntry == NULL) { - pBeamformEntry = Beamforming_AddBFeeEntry(pDM_Odm, pSTA, BeamformCap, NumofSoundingDim, CompSteeringNumofBFer, &BFeeIdx); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: pSTA->AID=%d, pSTA->MacID=%d\n", __func__, pSTA->AID, pSTA->MacID)); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: Add BFee entry %d\n", __func__, BFeeIdx)); - - if (pBeamformEntry == NULL) - return FALSE; - else - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; - } else { - /*Entry has been created. If entry is initialing or progressing then errors occur.*/ - if (pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && - pBeamformEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { - return FALSE; - } else - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZEING; - } - pBeamformEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; - phydm_staInfoUpdate(pDM_Odm, staIdx, pBeamformEntry); - } - - *BFerBFeeIdx = (BFerIdx<<4) | BFeeIdx; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End: BFerIdx=0x%X, BFeeIdx=0x%X, BFerBFeeIdx=0x%X\n", __func__, BFerIdx, BFeeIdx, *BFerBFeeIdx)); - - return TRUE; -} - - -VOID -Beamforming_DeInitEntry( - IN PVOID pDM_VOID, - pu1Byte RA - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Idx = 0; - - PRT_BEAMFORMER_ENTRY pBFerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, RA, &Idx); - PRT_BEAMFORMEE_ENTRY pBFeeEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - BOOLEAN ret = FALSE; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (pBFeeEntry != NULL) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFeeEntry\n", __func__)); - pBFeeEntry->bUsed = FALSE; - pBFeeEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; - pBFeeEntry->bBeamformingInProgress = FALSE; - if (pBFeeEntry->is_mu_sta) { - pDM_Odm->BeamformingInfo.beamformee_mu_cnt -= 1; - pDM_Odm->BeamformingInfo.FirstMUBFeeIndex = phydm_Beamforming_GetFirstMUBFeeEntryIdx(pDM_Odm); - } else { - pDM_Odm->BeamformingInfo.beamformee_su_cnt -= 1; - } - ret = TRUE; - } - - if (pBFerEntry != NULL) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, pBFerEntry\n", __func__)); - pBFerEntry->bUsed = FALSE; - pBFerEntry->BeamformEntryCap = BEAMFORMING_CAP_NONE; - if (pBFerEntry->is_mu_ap) - pDM_Odm->BeamformingInfo.beamformer_mu_cnt -= 1; - else - pDM_Odm->BeamformingInfo.beamformer_su_cnt -= 1; - ret = TRUE; - } - - if (ret == TRUE) - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_LEAVE, (pu1Byte)&Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s End, Idx = 0x%X\n", __func__, Idx)); -} - - -BOOLEAN -BeamformingStart_V1( - IN PVOID pDM_VOID, - pu1Byte RA, - BOOLEAN Mode, - CHANNEL_WIDTH BW, - u1Byte Rate - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Idx = 0; - PRT_BEAMFORMEE_ENTRY pEntry; - BOOLEAN ret = TRUE; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - - pEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - if (pEntry->bUsed == FALSE) { - pEntry->bBeamformingInProgress = FALSE; - return FALSE; - } else { - if (pEntry->bBeamformingInProgress) - return FALSE; - - pEntry->bBeamformingInProgress = TRUE; - - if (Mode == 1) { - if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { - pEntry->bBeamformingInProgress = FALSE; - return FALSE; - } - } else if (Mode == 0) { - if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { - pEntry->bBeamformingInProgress = FALSE; - return FALSE; - } - } - - if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { - pEntry->bBeamformingInProgress = FALSE; - return FALSE; - } else { - pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; - pEntry->bSound = TRUE; - } - } - - pEntry->SoundBW = BW; - pBeamInfo->BeamformeeCurIdx = Idx; - phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx); - - if (Mode == 1) - ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); - else - ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, pEntry->AID, BW, NORMAL_QUEUE); - - if (ret == FALSE) { - Beamforming_Leave(pDM_Odm, RA); - pEntry->bBeamformingInProgress = FALSE; - return FALSE; - } - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Idx %d\n", __func__, Idx)); - return TRUE; -} - - -BOOLEAN -BeamformingStart_SW( - IN PVOID pDM_VOID, - u1Byte Idx, - u1Byte Mode, - CHANNEL_WIDTH BW - ) -{ - pu1Byte RA = NULL; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMEE_ENTRY pEntry; - BOOLEAN ret = TRUE; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - - if (pBeamInfo->is_mu_sounding) { - pBeamInfo->is_mu_sounding_in_progress = TRUE; - pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); - RA = pEntry->MacAddr; - - } else { - pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); - - if (pEntry->bUsed == FALSE) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); - pEntry->bBeamformingInProgress = FALSE; - return FALSE; - } else { - if (pEntry->bBeamformingInProgress) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, skip...\n")); - return FALSE; - } - - pEntry->bBeamformingInProgress = TRUE; - RA = pEntry->MacAddr; - - if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) { - if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT)) { - pEntry->bBeamformingInProgress = FALSE; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_HT_EXPLICIT <==\n", __func__)); - return FALSE; - } - } else if (Mode == SOUNDING_SW_VHT_TIMER || Mode == SOUNDING_HW_VHT_TIMER || Mode == SOUNDING_AUTO_VHT_TIMER) { - if (!(pEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU)) { - pEntry->bBeamformingInProgress = FALSE; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by not support BEAMFORMER_CAP_VHT_SU <==\n", __func__)); - return FALSE; - } - } - if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_INITIALIZED && pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSED) { - pEntry->bBeamformingInProgress = FALSE; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Return by incorrect BeamformEntryState(%d) <==\n", __func__, pEntry->BeamformEntryState)); - return FALSE; - } else { - pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; - pEntry->bSound = TRUE; - } - } - - pBeamInfo->BeamformeeCurIdx = Idx; - } - - /*2014.12.22 Luke: Need to be checked*/ - /*GET_TXBF_INFO(Adapter)->fTxbfSet(Adapter, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&Idx);*/ - - if (Mode == SOUNDING_SW_HT_TIMER || Mode == SOUNDING_HW_HT_TIMER || Mode == SOUNDING_AUTO_HT_TIMER) - ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA , BW, NORMAL_QUEUE); - else - ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA , pEntry->AID, BW, NORMAL_QUEUE); - - if (ret == FALSE) { - Beamforming_Leave(pDM_Odm, RA); - pEntry->bBeamformingInProgress = FALSE; - return FALSE; - } - - - /*-------------------------- - // Send BF Report Poll for MU BF - --------------------------*/ -#ifdef SUPPORT_MU_BF -#if (SUPPORT_MU_BF == 1) -{ - u1Byte idx, PollSTACnt = 0; - BOOLEAN bGetFirstBFee = FALSE; - - if (pBeamInfo->beamformee_mu_cnt > 1) { /* More than 1 MU STA*/ - - for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { - pEntry = &(pBeamInfo->BeamformeeEntry[idx]); - if (pEntry->is_mu_sta) { - if (bGetFirstBFee) { - PollSTACnt++; - if (PollSTACnt == (pBeamInfo->beamformee_mu_cnt - 1))/* The last STA*/ - SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, TRUE); - else - SendSWVHTBFReportPoll(pDM_Odm, pEntry->MacAddr, FALSE); - } else { - bGetFirstBFee = TRUE; - } - } - } - } -} -#endif -#endif - return TRUE; -} - - -BOOLEAN -BeamformingStart_FW( - IN PVOID pDM_VOID, - u1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMEE_ENTRY pEntry; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - - pEntry = &(pBeamInfo->BeamformeeEntry[Idx]); - if (pEntry->bUsed == FALSE) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Skip Beamforming, no entry for Idx =%d\n", Idx)); - return FALSE; - } - - pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSING; - pEntry->bSound = TRUE; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_FW_NDPA, (pu1Byte)&Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, Idx=0x%X\n", __func__, Idx)); - return TRUE; -} - -VOID -Beamforming_CheckSoundingSuccess( - IN PVOID pDM_VOID, - BOOLEAN Status -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[David]@%s Start!\n", __func__)); - - if (Status == 1) { - if (pEntry->LogStatusFailCnt == 21) - Beamforming_DymPeriod(pDM_Odm, Status); - pEntry->LogStatusFailCnt = 0; - } else if (pEntry->LogStatusFailCnt <= 20) { - pEntry->LogStatusFailCnt++; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); - } - if (pEntry->LogStatusFailCnt > 20) { - pEntry->LogStatusFailCnt = 21; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 20, Stop SOUNDING\n", __func__)); - Beamforming_DymPeriod(pDM_Odm, Status); - } -} - -VOID -phydm_Beamforming_End_SW( - IN PVOID pDM_VOID, - BOOLEAN Status - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); - - if (pBeamInfo->is_mu_sounding) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: MU sounding done\n", __func__)); - pBeamInfo->is_mu_sounding_in_progress = FALSE; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); - } else { - if (pEntry->BeamformEntryState != BEAMFORMING_ENTRY_STATE_PROGRESSING) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamformStatus %d\n", __func__, pEntry->BeamformEntryState)); - return; - } - - if ((pDM_Odm->TxBfDataRate >= ODM_RATEVHTSS3MCS7) && (pDM_Odm->TxBfDataRate <= ODM_RATEVHTSS3MCS9) && (pBeamInfo->snding3SS == FALSE)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] VHT3SS 7,8,9, do not apply V matrix.\n", __func__)); - pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); - } else if (Status == 1) { - pEntry->LogStatusFailCnt = 0; - pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_STATUS, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); - } else { - pEntry->LogStatusFailCnt++; - pEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_INITIALIZED; - HalComTxbf_Set(pDM_Odm, TXBF_SET_TX_PATH_RESET, (pu1Byte)&(pBeamInfo->BeamformeeCurIdx)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogStatusFailCnt %d\n", __func__, pEntry->LogStatusFailCnt)); - } - - if (pEntry->LogStatusFailCnt > 50) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s LogStatusFailCnt > 50, Stop SOUNDING\n", __func__)); - pEntry->bSound = FALSE; - Beamforming_DeInitEntry(pDM_Odm, pEntry->MacAddr); - - /*Modified by David - Every action of deleting entry should follow by Notify*/ - phydm_Beamforming_Notify(pDM_Odm); - } - - pEntry->bBeamformingInProgress = FALSE; - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: Status=%d\n", __func__, Status)); -} - - -VOID -Beamforming_TimerCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PVOID pDM_VOID -#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - IN PVOID pContext -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; -#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - PADAPTER Adapter = (PADAPTER)pContext; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -#endif - BOOLEAN ret = FALSE; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); - PRT_SOUNDING_INFO pSoundInfo = &(pBeamInfo->SoundingInfo); - BOOLEAN bBeamformingInProgress; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - if (pBeamInfo->is_mu_sounding) - bBeamformingInProgress = pBeamInfo->is_mu_sounding_in_progress; - else - bBeamformingInProgress = pEntry->bBeamformingInProgress; - - if (bBeamformingInProgress) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("bBeamformingInProgress, reset it\n")); - phydm_Beamforming_End_SW(pDM_Odm, 0); - } - - ret = phydm_Beamforming_SelectBeamEntry(pDM_Odm, pBeamInfo); -#if (SUPPORT_MU_BF == 1) - if (ret && pBeamInfo->beamformee_mu_cnt > 1) - ret = 1; - else - ret = 0; -#endif - if (ret) - ret = BeamformingStart_SW(pDM_Odm, pSoundInfo->SoundIdx, pSoundInfo->SoundMode, pSoundInfo->SoundBW); - else - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, Error value return from BeamformingStart_V2\n", __func__)); - - if ((pBeamInfo->beamformee_su_cnt != 0) || (pBeamInfo->beamformee_mu_cnt > 1)) { - if (pSoundInfo->SoundMode == SOUNDING_SW_VHT_TIMER || pSoundInfo->SoundMode == SOUNDING_SW_HT_TIMER) - ODM_SetTimer(pDM_Odm, &pBeamInfo->BeamformingTimer, pSoundInfo->SoundPeriod); - else { - u4Byte val = (pSoundInfo->SoundPeriod << 16) | HAL_TIMER_TXBF; - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_HW_REG_TIMER_RESTART, (pu1Byte)(&val)); - } - } -} - - -VOID -Beamforming_SWTimerCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PRT_TIMER pTimer -#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - void *FunctionContext -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = (PADAPTER)pTimer->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - Beamforming_TimerCallback(pDM_Odm); -#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)FunctionContext; - PADAPTER Adapter = pDM_Odm->Adapter; - - if (Adapter->net_closed == TRUE) - return; - rtw_run_in_thread_cmd(Adapter, Beamforming_TimerCallback, Adapter); -#endif - -} - - -VOID -phydm_Beamforming_Init( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); - - pBeamOidInfo->SoundOidMode = SOUNDING_STOP_OID_TIMER; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Mode (%d)\n", __func__, pBeamOidInfo->SoundOidMode)); - - pBeamInfo->beamformee_su_cnt = 0; - pBeamInfo->beamformer_su_cnt = 0; - pBeamInfo->beamformee_mu_cnt = 0; - pBeamInfo->beamformer_mu_cnt = 0; - pBeamInfo->beamformee_mu_reg_maping = 0; - pBeamInfo->mu_ap_index = 0; - pBeamInfo->is_mu_sounding = FALSE; - pBeamInfo->FirstMUBFeeIndex = 0xFF; - pBeamInfo->applyVmatrix = TRUE; - pBeamInfo->snding3SS = FALSE; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pBeamInfo->SourceAdapter = pDM_Odm->Adapter; -#endif - halComTxbf_beamformInit(pDM_Odm); -} - - -BOOLEAN -phydm_actingDetermine( - IN PVOID pDM_VOID, - IN PHYDM_ACTING_TYPE type - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - BOOLEAN ret = FALSE; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->BeamformingInfo.SourceAdapter; -#else - PADAPTER Adapter = pDM_Odm->Adapter; -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (type == PhyDM_ACTING_AS_AP) - ret = ACTING_AS_AP(Adapter); - else if (type == PhyDM_ACTING_AS_IBSS) - ret = ACTING_AS_IBSS(Adapter); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); - - if (type == PhyDM_ACTING_AS_AP) - ret = check_fwstate(pmlmepriv, WIFI_AP_STATE); - else if (type == PhyDM_ACTING_AS_IBSS) - ret = check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); -#endif - - return ret; - -} - -VOID -Beamforming_Enter( - IN PVOID pDM_VOID, - IN u2Byte staIdx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte BFerBFeeIdx = 0xff; - - if (Beamforming_InitEntry(pDM_Odm, staIdx, &BFerBFeeIdx)) - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_ENTER, (pu1Byte)&BFerBFeeIdx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!\n", __func__)); -} - - -VOID -Beamforming_Leave( - IN PVOID pDM_VOID, - pu1Byte RA - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (RA != NULL) { - Beamforming_DeInitEntry(pDM_Odm, RA); - phydm_Beamforming_Notify(pDM_Odm); - } - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End!!\n", __func__)); -} - -#if 0 -//Nobody calls this function -VOID -phydm_Beamforming_SetTxBFen( - IN PVOID pDM_VOID, - u1Byte MacId, - BOOLEAN bTxBF - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Idx = 0; - PRT_BEAMFORMEE_ENTRY pEntry; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - pEntry = phydm_Beamforming_GetEntryByMacId(pDM_Odm, MacId, &Idx); - - if(pEntry == NULL) - return; - else - pEntry->bTxBF = bTxBF; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s MacId %d TxBF %d\n", __func__, pEntry->MacId, pEntry->bTxBF)); - - phydm_Beamforming_Notify(pDM_Odm); -} -#endif - -BEAMFORMING_CAP -phydm_Beamforming_GetBeamCap( - IN PVOID pDM_VOID, - IN PRT_BEAMFORMING_INFO pBeamInfo - ) -{ - u1Byte i; - BOOLEAN bSelfBeamformer = FALSE; - BOOLEAN bSelfBeamformee = FALSE; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - RT_BEAMFORMER_ENTRY BeamformerEntry; - BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - BeamformeeEntry = pBeamInfo->BeamformeeEntry[i]; - - if (BeamformeeEntry.bUsed) { - bSelfBeamformer = TRUE; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFee entry %d bUsed=TRUE\n", __func__, i)); - break; - } - } - - for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { - BeamformerEntry = pBeamInfo->BeamformerEntry[i]; - - if (BeamformerEntry.bUsed) { - bSelfBeamformee = TRUE; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]: BFer entry %d bUsed=TRUE\n", __func__, i)); - break; - } - } - - if (bSelfBeamformer) - BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMER_CAP); - if (bSelfBeamformee) - BeamformCap = (BEAMFORMING_CAP)(BeamformCap | BEAMFORMEE_CAP); - - return BeamformCap; -} - - -BOOLEAN -BeamformingControl_V1( - IN PVOID pDM_VOID, - pu1Byte RA, - u1Byte AID, - u1Byte Mode, - CHANNEL_WIDTH BW, - u1Byte Rate - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - BOOLEAN ret = TRUE; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("AID (%d), Mode (%d), BW (%d)\n", AID, Mode, BW)); - - switch (Mode) { - case 0: - ret = BeamformingStart_V1(pDM_Odm, RA, 0, BW, Rate); - break; - case 1: - ret = BeamformingStart_V1(pDM_Odm, RA, 1, BW, Rate); - break; - case 2: - phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); - ret = Beamforming_SendVHTNDPAPacket(pDM_Odm, RA, AID, BW, NORMAL_QUEUE); - break; - case 3: - phydm_Beamforming_NDPARate(pDM_Odm, BW, Rate); - ret = Beamforming_SendHTNDPAPacket(pDM_Odm, RA, BW, NORMAL_QUEUE); - break; - } - return ret; -} - -/*Only OID uses this function*/ -BOOLEAN -phydm_BeamformingControl_V2( - IN PVOID pDM_VOID, - u1Byte Idx, - u1Byte Mode, - CHANNEL_WIDTH BW, - u2Byte Period - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMING_OID_INFO pBeamOidInfo = &(pBeamInfo->BeamformingOidInfo); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Start!\n", __func__)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Idx (%d), Mode (%d), BW (%d), Period (%d)\n", Idx, Mode, BW, Period)); - - pBeamOidInfo->SoundOidIdx = Idx; - pBeamOidInfo->SoundOidMode = (SOUNDING_MODE) Mode; - pBeamOidInfo->SoundOidBW = BW; - pBeamOidInfo->SoundOidPeriod = Period; - - phydm_Beamforming_Notify(pDM_Odm); - - return TRUE; -} - - -VOID -phydm_Beamforming_Watchdog( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("%s Start!\n", __func__)); - - if (pBeamInfo->beamformee_su_cnt == 0) - return; - - Beamforming_DymPeriod(pDM_Odm,0); - phydm_Beamforming_DymNDPARate(pDM_Odm); - -} - - -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #if WPP_SOFTWARE_TRACE + #include "phydm_beamforming.tmh" + #endif +#endif + +#if (BEAMFORMING_SUPPORT == 1) + +struct _RT_BEAMFORM_STAINFO * +phydm_sta_info_init( + struct PHY_DM_STRUCT *p_dm, + u16 sta_idx +) +{ + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORM_STAINFO *p_entry = &(p_beam_info->beamform_sta_info); + struct sta_info *p_sta = p_dm->p_odm_sta_info[sta_idx]; + struct cmn_sta_info *p_cmn_sta = p_dm->p_phydm_sta_info[sta_idx]; + struct _ADAPTER *adapter = p_dm->adapter; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PMGNT_INFO p_MgntInfo = &adapter->MgntInfo; + PRT_HIGH_THROUGHPUT p_ht_info = GET_HT_INFO(p_MgntInfo); + PRT_VERY_HIGH_THROUGHPUT p_vht_info = GET_VHT_INFO(p_MgntInfo); + u1Byte iotpeer = 0; + + iotpeer = p_MgntInfo->IOTPeer; + odm_move_memory(p_dm, p_entry->my_mac_addr, adapter->CurrentAddress, 6); + + p_entry->ht_beamform_cap = p_ht_info->HtBeamformCap; + p_entry->vht_beamform_cap = p_vht_info->VhtBeamformCap; + + /*IBSS, AP mode*/ + if (sta_idx != 0) { + p_entry->aid = p_cmn_sta->aid; + p_entry->ra = p_cmn_sta->mac_addr; + p_entry->mac_id = p_cmn_sta->mac_id; + p_entry->wireless_mode = p_sta->WirelessMode; + p_entry->bw = p_cmn_sta->bw_mode; + p_entry->cur_beamform = p_cmn_sta->bf_info.ht_beamform_cap; + } else {/*client mode*/ + p_entry->aid = p_MgntInfo->mAId; + p_entry->ra = p_MgntInfo->Bssid; + p_entry->mac_id = p_MgntInfo->mMacId; + p_entry->wireless_mode = p_MgntInfo->dot11CurrentWirelessMode; + p_entry->bw = p_MgntInfo->dot11CurrentChannelBandWidth; + p_entry->cur_beamform = p_ht_info->HtCurBeamform; + } + + if ((p_entry->wireless_mode & WIRELESS_MODE_AC_5G) || (p_entry->wireless_mode & WIRELESS_MODE_AC_24G)) { + if (sta_idx != 0) + p_entry->cur_beamform_vht = p_cmn_sta->bf_info.vht_beamform_cap; + else + p_entry->cur_beamform_vht = p_vht_info->VhtCurBeamform; + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("p_sta->wireless_mode = 0x%x, staidx = %d\n", p_sta->WirelessMode, sta_idx)); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + + if (!is_sta_active(p_cmn_sta)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s => sta_info(mac_id:%d) failed\n", __func__, sta_idx)); + rtw_warn_on(1); + return p_entry; + } + + odm_move_memory(p_dm, p_entry->my_mac_addr, adapter_mac_addr(p_sta->padapter), 6); + #ifdef CONFIG_80211N_HT + p_entry->ht_beamform_cap = p_cmn_sta->bf_info.ht_beamform_cap; + #endif + + p_entry->aid = p_cmn_sta->aid; + p_entry->ra = p_cmn_sta->mac_addr; + p_entry->mac_id = p_cmn_sta->mac_id; + p_entry->wireless_mode = p_sta->wireless_mode; + p_entry->bw = p_cmn_sta->bw_mode; + #ifdef CONFIG_80211N_HT + p_entry->cur_beamform = p_cmn_sta->bf_info.ht_beamform_cap; + #endif +#if ODM_IC_11AC_SERIES_SUPPORT + if ((p_entry->wireless_mode & WIRELESS_MODE_AC_5G) || (p_entry->wireless_mode & WIRELESS_MODE_AC_24G)) { + p_entry->cur_beamform_vht = p_cmn_sta->bf_info.vht_beamform_cap; + p_entry->vht_beamform_cap = p_cmn_sta->bf_info.vht_beamform_cap; + } +#endif + PHYDM_DBG(p_dm, DBG_TXBF, ("p_sta->wireless_mode = 0x%x, staidx = %d\n", p_sta->wireless_mode, sta_idx)); +#endif + PHYDM_DBG(p_dm, DBG_TXBF, ("p_entry->cur_beamform = 0x%x, p_entry->cur_beamform_vht = 0x%x\n", p_entry->cur_beamform, p_entry->cur_beamform_vht)); + return p_entry; + +} +void phydm_sta_info_update( + struct PHY_DM_STRUCT *p_dm, + u16 sta_idx, + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry +) +{ + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[sta_idx]; + + if (!is_sta_active(p_sta)) + return; + + p_sta->bf_info.p_aid = p_beamform_entry->p_aid; + p_sta->bf_info.g_id = p_beamform_entry->g_id; +} + +struct _RT_BEAMFORMEE_ENTRY * +phydm_beamforming_get_bfee_entry_by_addr( + void *p_dm_void, + u8 *RA, + u8 *idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + if (p_beam_info->beamformee_entry[i].is_used && (eq_mac_addr(RA, p_beam_info->beamformee_entry[i].mac_addr))) { + *idx = i; + return &(p_beam_info->beamformee_entry[i]); + } + } + + return NULL; +} + +struct _RT_BEAMFORMER_ENTRY * +phydm_beamforming_get_bfer_entry_by_addr( + void *p_dm_void, + u8 *TA, + u8 *idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { + if (p_beam_info->beamformer_entry[i].is_used && (eq_mac_addr(TA, p_beam_info->beamformer_entry[i].mac_addr))) { + *idx = i; + return &(p_beam_info->beamformer_entry[i]); + } + } + + return NULL; +} + + +struct _RT_BEAMFORMEE_ENTRY * +phydm_beamforming_get_entry_by_mac_id( + void *p_dm_void, + u8 mac_id, + u8 *idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + if (p_beam_info->beamformee_entry[i].is_used && (mac_id == p_beam_info->beamformee_entry[i].mac_id)) { + *idx = i; + return &(p_beam_info->beamformee_entry[i]); + } + } + + return NULL; +} + + +enum beamforming_cap +phydm_beamforming_get_entry_beam_cap_by_mac_id( + void *p_dm_void, + u8 mac_id +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + enum beamforming_cap beamform_entry_cap = BEAMFORMING_CAP_NONE; + + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + if (p_beam_info->beamformee_entry[i].is_used && (mac_id == p_beam_info->beamformee_entry[i].mac_id)) { + beamform_entry_cap = p_beam_info->beamformee_entry[i].beamform_entry_cap; + i = BEAMFORMEE_ENTRY_NUM; + } + } + + return beamform_entry_cap; +} + + +struct _RT_BEAMFORMEE_ENTRY * +phydm_beamforming_get_free_bfee_entry( + void *p_dm_void, + u8 *idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + if (p_beam_info->beamformee_entry[i].is_used == false) { + *idx = i; + return &(p_beam_info->beamformee_entry[i]); + } + } + return NULL; +} + +struct _RT_BEAMFORMER_ENTRY * +phydm_beamforming_get_free_bfer_entry( + void *p_dm_void, + u8 *idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s ===>\n", __func__)); + + for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { + if (p_beam_info->beamformer_entry[i].is_used == false) { + *idx = i; + return &(p_beam_info->beamformer_entry[i]); + } + } + return NULL; +} + +/* + * Description: Get the first entry index of MU Beamformee. + * + * Return value: index of the first MU sta. + * + * 2015.05.25. Created by tynli. + * + */ +u8 +phydm_beamforming_get_first_mu_bfee_entry_idx( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx = 0xFF; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + boolean is_found = false; + + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + if (p_beam_info->beamformee_entry[idx].is_used && p_beam_info->beamformee_entry[idx].is_mu_sta) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] idx=%d!\n", __func__, idx)); + is_found = true; + break; + } + } + + if (!is_found) + idx = 0xFF; + + return idx; +} + + +/*Add SU BFee and MU BFee*/ +struct _RT_BEAMFORMEE_ENTRY * +beamforming_add_bfee_entry( + void *p_dm_void, + struct _RT_BEAMFORM_STAINFO *p_sta, + enum beamforming_cap beamform_cap, + u8 num_of_sounding_dim, + u8 comp_steering_num_of_bfer, + u8 *idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMEE_ENTRY *p_entry = phydm_beamforming_get_free_bfee_entry(p_dm, idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (p_entry != NULL) { + p_entry->is_used = true; + p_entry->aid = p_sta->aid; + p_entry->mac_id = p_sta->mac_id; + p_entry->sound_bw = p_sta->bw; + odm_move_memory(p_dm, p_entry->my_mac_addr, p_sta->my_mac_addr, 6); + + if (phydm_acting_determine(p_dm, phydm_acting_as_ap)) { + /*BSSID[44:47] xor BSSID[40:43]*/ + u16 bssid = ((p_sta->my_mac_addr[5] & 0xf0) >> 4) ^ (p_sta->my_mac_addr[5] & 0xf); + /*(dec(A) + dec(B)*32) mod 512*/ + p_entry->p_aid = (p_sta->aid + bssid * 32) & 0x1ff; + p_entry->g_id = 63; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: BFee P_AID addressed to STA=%d\n", __func__, p_entry->p_aid)); + } else if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) { + /*ad hoc mode*/ + p_entry->p_aid = 0; + p_entry->g_id = 63; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: BFee P_AID as IBSS=%d\n", __func__, p_entry->p_aid)); + } else { + /*client mode*/ + p_entry->p_aid = p_sta->ra[5]; + /*BSSID[39:47]*/ + p_entry->p_aid = (p_entry->p_aid << 1) | (p_sta->ra[4] >> 7); + p_entry->g_id = 0; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: BFee P_AID addressed to AP=0x%X\n", __func__, p_entry->p_aid)); + } + cp_mac_addr(p_entry->mac_addr, p_sta->ra); + p_entry->is_txbf = false; + p_entry->is_sound = false; + p_entry->sound_period = 400; + p_entry->beamform_entry_cap = beamform_cap; + p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; + + /* p_entry->log_seq = 0xff; Move to beamforming_add_bfer_entry*/ + /* p_entry->log_retry_cnt = 0; Move to beamforming_add_bfer_entry*/ + /* p_entry->LogSuccessCnt = 0; Move to beamforming_add_bfer_entry*/ + + p_entry->log_status_fail_cnt = 0; + + p_entry->num_of_sounding_dim = num_of_sounding_dim; + p_entry->comp_steering_num_of_bfer = comp_steering_num_of_bfer; + + if (beamform_cap & BEAMFORMER_CAP_VHT_MU) { + p_dm->beamforming_info.beamformee_mu_cnt += 1; + p_entry->is_mu_sta = true; + p_dm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(p_dm); + } else if (beamform_cap & (BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { + p_dm->beamforming_info.beamformee_su_cnt += 1; + p_entry->is_mu_sta = false; + } + + return p_entry; + } else + return NULL; +} + +/*Add SU BFee and MU BFer*/ +struct _RT_BEAMFORMER_ENTRY * +beamforming_add_bfer_entry( + void *p_dm_void, + struct _RT_BEAMFORM_STAINFO *p_sta, + enum beamforming_cap beamform_cap, + u8 num_of_sounding_dim, + u8 *idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMER_ENTRY *p_entry = phydm_beamforming_get_free_bfer_entry(p_dm, idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (p_entry != NULL) { + p_entry->is_used = true; + odm_move_memory(p_dm, p_entry->my_mac_addr, p_sta->my_mac_addr, 6); + if (phydm_acting_determine(p_dm, phydm_acting_as_ap)) { + /*BSSID[44:47] xor BSSID[40:43]*/ + u16 bssid = ((p_sta->my_mac_addr[5] & 0xf0) >> 4) ^ (p_sta->my_mac_addr[5] & 0xf); + + p_entry->p_aid = (p_sta->aid + bssid * 32) & 0x1ff; + p_entry->g_id = 63; + /*(dec(A) + dec(B)*32) mod 512*/ + } else if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) { + p_entry->p_aid = 0; + p_entry->g_id = 63; + } else { + p_entry->p_aid = p_sta->ra[5]; + /*BSSID[39:47]*/ + p_entry->p_aid = (p_entry->p_aid << 1) | (p_sta->ra[4] >> 7); + p_entry->g_id = 0; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: P_AID addressed to AP=0x%X\n", __func__, p_entry->p_aid)); + } + + cp_mac_addr(p_entry->mac_addr, p_sta->ra); + p_entry->beamform_entry_cap = beamform_cap; + + p_entry->pre_log_seq = 0; /*Modified by Jeffery @2015-04-13*/ + p_entry->log_seq = 0; /*Modified by Jeffery @2014-10-29*/ + p_entry->log_retry_cnt = 0; /*Modified by Jeffery @2014-10-29*/ + p_entry->log_success = 0; /*log_success is NOT needed to be accumulated, so LogSuccessCnt->log_success, 2015-04-13, Jeffery*/ + p_entry->clock_reset_times = 0; /*Modified by Jeffery @2015-04-13*/ + + p_entry->num_of_sounding_dim = num_of_sounding_dim; + + if (beamform_cap & BEAMFORMEE_CAP_VHT_MU) { + p_dm->beamforming_info.beamformer_mu_cnt += 1; + p_entry->is_mu_ap = true; + p_entry->aid = p_sta->aid; + } else if (beamform_cap & (BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { + p_dm->beamforming_info.beamformer_su_cnt += 1; + p_entry->is_mu_ap = false; + } + + return p_entry; + } else + return NULL; +} + +#if 0 +boolean +beamforming_remove_entry( + struct _ADAPTER *adapter, + u8 *RA, + u8 *idx +) +{ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + struct _RT_BEAMFORMER_ENTRY *p_bfer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm, RA, idx); + struct _RT_BEAMFORMEE_ENTRY *p_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, idx); + boolean ret = false; + + RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s Start!\n", __func__)); + RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, p_bfer_entry=0x%x\n", __func__, p_bfer_entry)); + RT_DISP(FBEAM, FBEAM_FUN, ("[Beamforming]@%s, p_entry=0x%x\n", __func__, p_entry)); + + if (p_entry != NULL) { + p_entry->is_used = false; + p_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; + /*p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE;*/ + p_entry->is_beamforming_in_progress = false; + ret = true; + } + if (p_bfer_entry != NULL) { + p_bfer_entry->is_used = false; + p_bfer_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; + ret = true; + } + return ret; + +} +#endif + +/* Used for beamforming_start_v1 */ +void +phydm_beamforming_ndpa_rate( + void *p_dm_void, + enum channel_width BW, + u8 rate +) +{ + u16 ndpa_rate = rate; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (ndpa_rate == 0) { + if (p_dm->rssi_min > 30) /* link RSSI > 30% */ + ndpa_rate = ODM_RATE24M; + else + ndpa_rate = ODM_RATE6M; + } + + if (ndpa_rate < ODM_RATEMCS0) + BW = (enum channel_width)CHANNEL_WIDTH_20; + + ndpa_rate = (ndpa_rate << 8) | BW; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_RATE, (u8 *)&ndpa_rate); + +} + + +/* Used for beamforming_start_sw and beamforming_start_fw */ +void +phydm_beamforming_dym_ndpa_rate( + void *p_dm_void +) +{ + u16 ndpa_rate = ODM_RATE6M, BW; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + ndpa_rate = ODM_RATE6M; + BW = CHANNEL_WIDTH_20; + + ndpa_rate = ndpa_rate << 8 | BW; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_RATE, (u8 *)&ndpa_rate); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s End, NDPA rate = 0x%X\n", __func__, ndpa_rate)); +} + +/* +* SW Sounding : SW Timer unit 1ms +* HW Timer unit (1/32000) s 32k is clock. +* FW Sounding : FW Timer unit 10ms +*/ +void +beamforming_dym_period( + void *p_dm_void, + u8 status +) +{ + u8 idx; + boolean is_change_period = false; + u16 sound_period_sw, sound_period_fw; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + + struct _RT_BEAMFORMEE_ENTRY *p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + /* 3 TODO per-client throughput caculation. */ + + if ((*(p_dm->p_current_tx_tp) + *(p_dm->p_current_rx_tp) > 2) && ((p_entry->log_status_fail_cnt <= 20) || status)) { + sound_period_sw = 40; /* 40ms */ + sound_period_fw = 40; /* From H2C cmd, unit = 10ms */ + } else { + sound_period_sw = 4000;/* 4s */ + sound_period_fw = 400; + } + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]sound_period_sw=%d, sound_period_fw=%d\n", __func__, sound_period_sw, sound_period_fw)); + + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + p_beamform_entry = p_beam_info->beamformee_entry + idx; + + if (p_beamform_entry->default_csi_cnt > 20) { + /*Modified by David*/ + sound_period_sw = 4000; + sound_period_fw = 400; + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] period = %d\n", __func__, sound_period_sw)); + if (p_beamform_entry->beamform_entry_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { + if (p_sound_info->sound_mode == SOUNDING_FW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_FW_HT_TIMER) { + if (p_beamform_entry->sound_period != sound_period_fw) { + p_beamform_entry->sound_period = sound_period_fw; + is_change_period = true; /*Only FW sounding need to send H2C packet to change sound period. */ + } + } else if (p_beamform_entry->sound_period != sound_period_sw) + p_beamform_entry->sound_period = sound_period_sw; + } + } + + if (is_change_period) + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); +} + + + + +boolean +beamforming_send_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW, + u8 q_idx +) +{ + boolean ret = true; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (q_idx == BEACON_QUEUE) + ret = send_fw_ht_ndpa_packet(p_dm, RA, BW); + else + ret = send_sw_ht_ndpa_packet(p_dm, RA, BW); + + return ret; +} + + + +boolean +beamforming_send_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW, + u8 q_idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + boolean ret = true; + + hal_com_txbf_set(p_dm, TXBF_SET_GET_TX_RATE, NULL); + + if ((p_beam_info->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7) && (p_beam_info->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9) && (p_beam_info->snding3ss == false)) + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s: 3SS VHT 789 don't sounding\n", __func__)); + + else { + if (q_idx == BEACON_QUEUE) /* Send to reserved page => FW NDPA */ + ret = send_fw_vht_ndpa_packet(p_dm, RA, AID, BW); + else { +#ifdef SUPPORT_MU_BF +#if (SUPPORT_MU_BF == 1) + p_beam_info->is_mu_sounding = true; + ret = send_sw_vht_mu_ndpa_packet(p_dm, BW); +#else + p_beam_info->is_mu_sounding = false; + ret = send_sw_vht_ndpa_packet(p_dm, RA, AID, BW); +#endif +#else + p_beam_info->is_mu_sounding = false; + ret = send_sw_vht_ndpa_packet(p_dm, RA, AID, BW); +#endif + } + } + return ret; +} + + +enum beamforming_notify_state +phydm_beamfomring_is_sounding( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info, + u8 *idx +) +{ + enum beamforming_notify_state is_sounding = BEAMFORMING_NOTIFY_NONE; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = p_beam_info->beamforming_oid_info; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + /*if(( Beamforming_GetBeamCap(p_beam_info) & BEAMFORMER_CAP) == 0)*/ + /*is_sounding = BEAMFORMING_NOTIFY_RESET;*/ + if (beam_oid_info.sound_oid_mode == sounding_stop_all_timer) + is_sounding = BEAMFORMING_NOTIFY_RESET; + else { + u8 i; + + for (i = 0 ; i < BEAMFORMEE_ENTRY_NUM ; i++) { + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s: BFee Entry %d is_used=%d, is_sound=%d\n", __func__, i, p_beam_info->beamformee_entry[i].is_used, p_beam_info->beamformee_entry[i].is_sound)); + if (p_beam_info->beamformee_entry[i].is_used && (!p_beam_info->beamformee_entry[i].is_sound)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: Add BFee entry %d\n", __func__, i)); + *idx = i; + if (p_beam_info->beamformee_entry[i].is_mu_sta) + is_sounding = BEAMFORMEE_NOTIFY_ADD_MU; + else + is_sounding = BEAMFORMEE_NOTIFY_ADD_SU; + } + + if ((!p_beam_info->beamformee_entry[i].is_used) && p_beam_info->beamformee_entry[i].is_sound) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: Delete BFee entry %d\n", __func__, i)); + *idx = i; + if (p_beam_info->beamformee_entry[i].is_mu_sta) + is_sounding = BEAMFORMEE_NOTIFY_DELETE_MU; + else + is_sounding = BEAMFORMEE_NOTIFY_DELETE_SU; + } + } + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s End, is_sounding = %d\n", __func__, is_sounding)); + return is_sounding; +} + + +/* This function is unused */ +u8 +phydm_beamforming_sounding_idx( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info +) +{ + u8 idx = 0; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = p_beam_info->beamforming_oid_info; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (beam_oid_info.sound_oid_mode == SOUNDING_SW_HT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_SW_VHT_TIMER || + beam_oid_info.sound_oid_mode == SOUNDING_HW_HT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_HW_VHT_TIMER) + idx = beam_oid_info.sound_oid_idx; + else { + u8 i; + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + if (p_beam_info->beamformee_entry[i].is_used && (false == p_beam_info->beamformee_entry[i].is_sound)) { + idx = i; + break; + } + } + } + + return idx; +} + + +enum sounding_mode +phydm_beamforming_sounding_mode( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 support_interface = p_dm->support_interface; + + struct _RT_BEAMFORMEE_ENTRY beam_entry = p_beam_info->beamformee_entry[idx]; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = p_beam_info->beamforming_oid_info; + enum sounding_mode mode = beam_oid_info.sound_oid_mode; + + if (beam_oid_info.sound_oid_mode == SOUNDING_SW_VHT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_HW_VHT_TIMER) { + if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) + mode = beam_oid_info.sound_oid_mode; + else + mode = sounding_stop_all_timer; + } else if (beam_oid_info.sound_oid_mode == SOUNDING_SW_HT_TIMER || beam_oid_info.sound_oid_mode == SOUNDING_HW_HT_TIMER) { + if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) + mode = beam_oid_info.sound_oid_mode; + else + mode = sounding_stop_all_timer; + } else if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) { + if ((support_interface == ODM_ITRF_USB) && !(p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) + mode = SOUNDING_FW_VHT_TIMER; + else + mode = SOUNDING_SW_VHT_TIMER; + } else if (beam_entry.beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) { + if ((support_interface == ODM_ITRF_USB) && !(p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B))) + mode = SOUNDING_FW_HT_TIMER; + else + mode = SOUNDING_SW_HT_TIMER; + } else + mode = sounding_stop_all_timer; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] support_interface=%d, mode=%d\n", __func__, support_interface, mode)); + + return mode; +} + + +u16 +phydm_beamforming_sounding_time( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info, + enum sounding_mode mode, + u8 idx +) +{ + u16 sounding_time = 0xffff; + struct _RT_BEAMFORMEE_ENTRY beam_entry = p_beam_info->beamformee_entry[idx]; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = p_beam_info->beamforming_oid_info; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_HW_VHT_TIMER) + sounding_time = beam_oid_info.sound_oid_period * 32; + else if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_SW_VHT_TIMER) + /*Modified by David*/ + sounding_time = beam_entry.sound_period; /*beam_oid_info.sound_oid_period;*/ + else + sounding_time = beam_entry.sound_period; + + return sounding_time; +} + + +enum channel_width +phydm_beamforming_sounding_bw( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info, + enum sounding_mode mode, + u8 idx +) +{ + enum channel_width sounding_bw = CHANNEL_WIDTH_20; + struct _RT_BEAMFORMEE_ENTRY beam_entry = p_beam_info->beamformee_entry[idx]; + struct _RT_BEAMFORMING_OID_INFO beam_oid_info = p_beam_info->beamforming_oid_info; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_HW_VHT_TIMER) + sounding_bw = beam_oid_info.sound_oid_bw; + else if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_SW_VHT_TIMER) + /*Modified by David*/ + sounding_bw = beam_entry.sound_bw; /*beam_oid_info.sound_oid_bw;*/ + else + sounding_bw = beam_entry.sound_bw; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, sounding_bw=0x%X\n", __func__, sounding_bw)); + + return sounding_bw; +} + + +boolean +phydm_beamforming_select_beam_entry( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info +) +{ + struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + /*p_entry.is_sound is different between first and latter NDPA, and should not be used as BFee entry selection*/ + /*BTW, latter modification should sync to the selection mechanism of AP/ADSL instead of the fixed sound_idx.*/ + p_sound_info->sound_idx = phydm_beamforming_sounding_idx(p_dm, p_beam_info); + /*p_sound_info->sound_idx = 0;*/ + + if (p_sound_info->sound_idx < BEAMFORMEE_ENTRY_NUM) + p_sound_info->sound_mode = phydm_beamforming_sounding_mode(p_dm, p_beam_info, p_sound_info->sound_idx); + else + p_sound_info->sound_mode = sounding_stop_all_timer; + + if (sounding_stop_all_timer == p_sound_info->sound_mode) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Return because of sounding_stop_all_timer\n", __func__)); + return false; + } else { + p_sound_info->sound_bw = phydm_beamforming_sounding_bw(p_dm, p_beam_info, p_sound_info->sound_mode, p_sound_info->sound_idx); + p_sound_info->sound_period = phydm_beamforming_sounding_time(p_dm, p_beam_info, p_sound_info->sound_mode, p_sound_info->sound_idx); + return true; + } +} + +/*SU BFee Entry Only*/ +boolean +phydm_beamforming_start_period( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean ret = true; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + + phydm_beamforming_dym_ndpa_rate(p_dm); + + phydm_beamforming_select_beam_entry(p_dm, p_beam_info); /* Modified */ + + if (p_sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_set_timer(p_dm, &p_beam_info->beamforming_timer, p_sound_info->sound_period); + else if (p_sound_info->sound_mode == SOUNDING_HW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_HW_HT_TIMER || + p_sound_info->sound_mode == SOUNDING_AUTO_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_AUTO_HT_TIMER) { + HAL_HW_TIMER_TYPE timer_type = HAL_TIMER_TXBF; + u32 val = (p_sound_info->sound_period | (timer_type << 16)); + + /* HW timer stop: All IC has the same setting */ + phydm_set_hw_reg_handler_interface(p_dm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); + /* odm_write_1byte(p_dm, 0x15F, 0); */ + /* HW timer init: All IC has the same setting, but 92E & 8812A only write 2 bytes */ + phydm_set_hw_reg_handler_interface(p_dm, HW_VAR_HW_REG_TIMER_INIT, (u8 *)(&val)); + /* odm_write_1byte(p_dm, 0x164, 1); */ + /* odm_write_4byte(p_dm, 0x15C, val); */ + /* HW timer start: All IC has the same setting */ + phydm_set_hw_reg_handler_interface(p_dm, HW_VAR_HW_REG_TIMER_START, (u8 *)(&timer_type)); + /* odm_write_1byte(p_dm, 0x15F, 0x5); */ + } else if (p_sound_info->sound_mode == SOUNDING_FW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_FW_HT_TIMER) + ret = beamforming_start_fw(p_dm, p_sound_info->sound_idx); + else + ret = false; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] sound_idx=%d, sound_mode=%d, sound_bw=%d, sound_period=%d\n", __func__, + p_sound_info->sound_idx, p_sound_info->sound_mode, p_sound_info->sound_bw, p_sound_info->sound_period)); + + return ret; +} + +/* Used after beamforming_leave, and will clear the setting of the "already deleted" entry + *SU BFee Entry Only*/ +void +phydm_beamforming_end_period_sw( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + /*struct _ADAPTER *adapter = p_dm->adapter;*/ + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + + HAL_HW_TIMER_TYPE timer_type = HAL_TIMER_TXBF; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (p_sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_cancel_timer(p_dm, &p_beam_info->beamforming_timer); + else if (p_sound_info->sound_mode == SOUNDING_HW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_HW_HT_TIMER || + p_sound_info->sound_mode == SOUNDING_AUTO_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_AUTO_HT_TIMER) + /*HW timer stop: All IC has the same setting*/ + phydm_set_hw_reg_handler_interface(p_dm, HW_VAR_HW_REG_TIMER_STOP, (u8 *)(&timer_type)); + /*odm_write_1byte(p_dm, 0x15F, 0);*/ +} + +void +phydm_beamforming_end_period_fw( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx = 0; + + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]\n", __func__)); +} + + +/*SU BFee Entry Only*/ +void +phydm_beamforming_clear_entry_sw( + void *p_dm_void, + boolean is_delete, + u8 delete_idx +) +{ + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + if (is_delete) { + if (delete_idx < BEAMFORMEE_ENTRY_NUM) { + p_beamform_entry = p_beam_info->beamformee_entry + delete_idx; + if (!((!p_beamform_entry->is_used) && p_beamform_entry->is_sound)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] SW delete_idx is wrong!!!!!\n", __func__)); + return; + } + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] SW delete BFee entry %d\n", __func__, delete_idx)); + if (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) { + p_beamform_entry->is_beamforming_in_progress = false; + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; + } else if (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&delete_idx); + } + p_beamform_entry->is_sound = false; + } else { + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + p_beamform_entry = p_beam_info->beamformee_entry + idx; + + /*Used after is_sounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ + /*This function is mainly used in case "beam_oid_info.sound_oid_mode == sounding_stop_all_timer".*/ + /*However, setting oid doesn't delete entries (is_used is still true), new entries may fail to be added in.*/ + + if (p_beamform_entry->is_sound) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] SW reset BFee entry %d\n", __func__, idx)); + /* + * If End procedure is + * 1. Between (Send NDPA, C2H packet return), reset state to initialized. + * After C2H packet return , status bit will be set to zero. + * + * 2. After C2H packet, then reset state to initialized and clear status bit. + */ + + if (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) + phydm_beamforming_end_sw(p_dm, 0); + else if (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); + } + + p_beamform_entry->is_sound = false; + } + } + } +} + +void +phydm_beamforming_clear_entry_fw( + void *p_dm_void, + boolean is_delete, + u8 delete_idx +) +{ + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + if (is_delete) { + if (delete_idx < BEAMFORMEE_ENTRY_NUM) { + p_beamform_entry = p_beam_info->beamformee_entry + delete_idx; + + if (!((!p_beamform_entry->is_used) && p_beamform_entry->is_sound)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] FW delete_idx is wrong!!!!!\n", __func__)); + return; + } + } + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: FW delete BFee entry %d\n", __func__, delete_idx)); + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_UNINITIALIZE; + p_beamform_entry->is_sound = false; + } else { + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + p_beamform_entry = p_beam_info->beamformee_entry + idx; + + /*Used after is_sounding=RESET, and will clear the setting of "ever sounded" entry, which is not necessarily be deleted.*/ + /*This function is mainly used in case "beam_oid_info.sound_oid_mode == sounding_stop_all_timer".*/ + /*However, setting oid doesn't delete entries (is_used is still true), new entries may fail to be added in.*/ + + if (p_beamform_entry->is_sound) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]FW reset BFee entry %d\n", __func__, idx)); + /* + * If End procedure is + * 1. Between (Send NDPA, C2H packet return), reset state to initialized. + * After C2H packet return , status bit will be set to zero. + * + * 2. After C2H packet, then reset state to initialized and clear status bit. + */ + + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + p_beamform_entry->is_sound = false; + } + } + } +} + +/* +* Called : +* 1. Add and delete entry : beamforming_enter/beamforming_leave +* 2. FW trigger : Beamforming_SetTxBFen +* 3. Set OID_RT_BEAMFORMING_PERIOD : beamforming_control_v2 +*/ +void +phydm_beamforming_notify( + void *p_dm_void +) +{ + u8 idx = BEAMFORMEE_ENTRY_NUM; + enum beamforming_notify_state is_sounding = BEAMFORMING_NOTIFY_NONE; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + is_sounding = phydm_beamfomring_is_sounding(p_dm, p_beam_info, &idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, Before notify, is_sounding=%d, idx=%d\n", __func__, is_sounding, idx)); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: p_beam_info->beamformee_su_cnt = %d\n", __func__, p_beam_info->beamformee_su_cnt)); + + + switch (is_sounding) { + case BEAMFORMEE_NOTIFY_ADD_SU: + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: BEAMFORMEE_NOTIFY_ADD_SU\n", __func__)); + phydm_beamforming_start_period(p_dm); + break; + + case BEAMFORMEE_NOTIFY_DELETE_SU: + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: BEAMFORMEE_NOTIFY_DELETE_SU\n", __func__)); + if (p_sound_info->sound_mode == SOUNDING_FW_HT_TIMER || p_sound_info->sound_mode == SOUNDING_FW_VHT_TIMER) { + phydm_beamforming_clear_entry_fw(p_dm, true, idx); + if (p_beam_info->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ + phydm_beamforming_end_period_fw(p_dm); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: No BFee left\n", __func__)); + } + } else { + phydm_beamforming_clear_entry_sw(p_dm, true, idx); + if (p_beam_info->beamformee_su_cnt == 0) { /* For 2->1 entry, we should not cancel SW timer */ + phydm_beamforming_end_period_sw(p_dm); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: No BFee left\n", __func__)); + } + } + break; + + case BEAMFORMEE_NOTIFY_ADD_MU: + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: BEAMFORMEE_NOTIFY_ADD_MU\n", __func__)); + if (p_beam_info->beamformee_mu_cnt == 2) { + /*if (p_sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_set_timer(p_dm, &p_beam_info->beamforming_timer, p_sound_info->sound_period);*/ + odm_set_timer(p_dm, &p_beam_info->beamforming_timer, 1000); /*Do MU sounding every 1sec*/ + } else + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: Less or larger than 2 MU STAs, not to set timer\n", __func__)); + break; + + case BEAMFORMEE_NOTIFY_DELETE_MU: + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: BEAMFORMEE_NOTIFY_DELETE_MU\n", __func__)); + if (p_beam_info->beamformee_mu_cnt == 1) { + /*if (p_sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_SW_HT_TIMER)*/{ + odm_cancel_timer(p_dm, &p_beam_info->beamforming_timer); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: Less than 2 MU STAs, stop sounding\n", __func__)); + } + } + break; + + case BEAMFORMING_NOTIFY_RESET: + if (p_sound_info->sound_mode == SOUNDING_FW_HT_TIMER || p_sound_info->sound_mode == SOUNDING_FW_VHT_TIMER) { + phydm_beamforming_clear_entry_fw(p_dm, false, idx); + phydm_beamforming_end_period_fw(p_dm); + } else { + phydm_beamforming_clear_entry_sw(p_dm, false, idx); + phydm_beamforming_end_period_sw(p_dm); + } + + break; + + default: + break; + } + +} + + + +boolean +beamforming_init_entry( + void *p_dm_void, + u16 sta_idx, + u8 *bfer_bfee_idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL; + struct _RT_BEAMFORMER_ENTRY *p_beamformer_entry = NULL; + struct _RT_BEAMFORM_STAINFO *p_sta = NULL; + enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; + u8 bfer_idx = 0xF, bfee_idx = 0xF; + u8 num_of_sounding_dim = 0, comp_steering_num_of_bfer = 0; + + p_sta = phydm_sta_info_init(p_dm, sta_idx); + + /*The current setting does not support Beaforming*/ + if (BEAMFORMING_CAP_NONE == p_sta->ht_beamform_cap && BEAMFORMING_CAP_NONE == p_sta->vht_beamform_cap) { + PHYDM_DBG(p_dm, DBG_TXBF, ("The configuration disabled Beamforming! Skip...\n")); + return false; + } + + if (p_sta->wireless_mode < WIRELESS_MODE_N_24G) + return false; + else { + if (p_sta->wireless_mode & WIRELESS_MODE_N_5G || p_sta->wireless_mode & WIRELESS_MODE_N_24G) {/*HT*/ + if (TEST_FLAG(p_sta->cur_beamform, BEAMFORMING_HT_BEAMFORMER_ENABLE)) {/*We are Beamformee because the STA is Beamformer*/ + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP_HT_EXPLICIT); + num_of_sounding_dim = (p_sta->cur_beamform & BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP) >> 6; + } + /*We are Beamformer because the STA is Beamformee*/ + if (TEST_FLAG(p_sta->cur_beamform, BEAMFORMING_HT_BEAMFORMEE_ENABLE) || + TEST_FLAG(p_sta->ht_beamform_cap, BEAMFORMING_HT_BEAMFORMER_TEST)) { + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP_HT_EXPLICIT); + comp_steering_num_of_bfer = (p_sta->cur_beamform & BEAMFORMING_HT_BEAMFORMER_STEER_NUM) >> 4; + } + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] HT cur_beamform=0x%X, beamform_cap=0x%X\n", __func__, p_sta->cur_beamform, beamform_cap)); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] HT num_of_sounding_dim=%d, comp_steering_num_of_bfer=%d\n", __func__, num_of_sounding_dim, comp_steering_num_of_bfer)); + } +#if (ODM_IC_11AC_SERIES_SUPPORT == 1) + if (p_sta->wireless_mode & WIRELESS_MODE_AC_5G || p_sta->wireless_mode & WIRELESS_MODE_AC_24G) { /*VHT*/ + + /* We are Beamformee because the STA is SU Beamformer*/ + if (TEST_FLAG(p_sta->cur_beamform_vht, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) { + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP_VHT_SU); + num_of_sounding_dim = (p_sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; + } + /* We are Beamformer because the STA is SU Beamformee*/ + if (TEST_FLAG(p_sta->cur_beamform_vht, BEAMFORMING_VHT_BEAMFORMEE_ENABLE) || + TEST_FLAG(p_sta->vht_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP_VHT_SU); + comp_steering_num_of_bfer = (p_sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; + } + /* We are Beamformee because the STA is MU Beamformer*/ + if (TEST_FLAG(p_sta->cur_beamform_vht, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) { + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP_VHT_MU); + num_of_sounding_dim = (p_sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM) >> 12; + } + /* We are Beamformer because the STA is MU Beamformee*/ + if (phydm_acting_determine(p_dm, phydm_acting_as_ap)) { /* Only AP mode supports to act an MU beamformer */ + if (TEST_FLAG(p_sta->cur_beamform_vht, BEAMFORMING_VHT_MU_MIMO_STA_ENABLE) || + TEST_FLAG(p_sta->vht_beamform_cap, BEAMFORMING_VHT_BEAMFORMER_TEST)) { + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP_VHT_MU); + comp_steering_num_of_bfer = (p_sta->cur_beamform_vht & BEAMFORMING_VHT_BEAMFORMER_STS_CAP) >> 8; + } + } + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]VHT cur_beamform_vht=0x%X, beamform_cap=0x%X\n", __func__, p_sta->cur_beamform_vht, beamform_cap)); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]VHT num_of_sounding_dim=0x%X, comp_steering_num_of_bfer=0x%X\n", __func__, num_of_sounding_dim, comp_steering_num_of_bfer)); + + } +#endif + } + + + if (beamform_cap == BEAMFORMING_CAP_NONE) + return false; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Self BF Entry Cap = 0x%02X\n", __func__, beamform_cap)); + + /*We are BFee, so the entry is BFer*/ + if (beamform_cap & (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP_HT_EXPLICIT)) { + p_beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm, p_sta->ra, &bfer_idx); + + if (p_beamformer_entry == NULL) { + p_beamformer_entry = beamforming_add_bfer_entry(p_dm, p_sta, beamform_cap, num_of_sounding_dim, &bfer_idx); + if (p_beamformer_entry == NULL) + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]Not enough BFer entry!!!!!\n", __func__)); + } + } + + /*We are BFer, so the entry is BFee*/ + if (beamform_cap & (BEAMFORMER_CAP_VHT_MU | BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP_HT_EXPLICIT)) { + p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, p_sta->ra, &bfee_idx); + + /*¦pªGBFeeIdx = 0xF «h¥Nªí¥Ø«eentry·í¤¤¨S¦³¬Û¦PªºMACID¦b¤º*/ + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Get BFee entry 0x%X by address\n", __func__, bfee_idx)); + if (p_beamform_entry == NULL) { + p_beamform_entry = beamforming_add_bfee_entry(p_dm, p_sta, beamform_cap, num_of_sounding_dim, comp_steering_num_of_bfer, &bfee_idx); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]: p_sta->AID=%d, p_sta->mac_id=%d\n", __func__, p_sta->aid, p_sta->mac_id)); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]: Add BFee entry %d\n", __func__, bfee_idx)); + + if (p_beamform_entry == NULL) + return false; + else + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; + } else { + /*Entry has been created. If entry is initialing or progressing then errors occur.*/ + if (p_beamform_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && + p_beamform_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) + return false; + else + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZEING; + } + p_beamform_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + phydm_sta_info_update(p_dm, sta_idx, p_beamform_entry); + } + + *bfer_bfee_idx = (bfer_idx << 4) | bfee_idx; + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] End: bfer_idx=0x%X, bfee_idx=0x%X, bfer_bfee_idx=0x%X\n", __func__, bfer_idx, bfee_idx, *bfer_bfee_idx)); + + return true; +} + + +void +beamforming_deinit_entry( + void *p_dm_void, + u8 *RA +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx = 0; + + struct _RT_BEAMFORMER_ENTRY *p_bfer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm, RA, &idx); + struct _RT_BEAMFORMEE_ENTRY *p_bfee_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + boolean ret = false; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (p_bfee_entry != NULL) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, p_bfee_entry\n", __func__)); + p_bfee_entry->is_used = false; + p_bfee_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; + p_bfee_entry->is_beamforming_in_progress = false; + if (p_bfee_entry->is_mu_sta) { + p_dm->beamforming_info.beamformee_mu_cnt -= 1; + p_dm->beamforming_info.first_mu_bfee_index = phydm_beamforming_get_first_mu_bfee_entry_idx(p_dm); + } else + p_dm->beamforming_info.beamformee_su_cnt -= 1; + ret = true; + } + + if (p_bfer_entry != NULL) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, p_bfer_entry\n", __func__)); + p_bfer_entry->is_used = false; + p_bfer_entry->beamform_entry_cap = BEAMFORMING_CAP_NONE; + if (p_bfer_entry->is_mu_ap) + p_dm->beamforming_info.beamformer_mu_cnt -= 1; + else + p_dm->beamforming_info.beamformer_su_cnt -= 1; + ret = true; + } + + if (ret == true) + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_LEAVE, (u8 *)&idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s End, idx = 0x%X\n", __func__, idx)); +} + + +boolean +beamforming_start_v1( + void *p_dm_void, + u8 *RA, + boolean mode, + enum channel_width BW, + u8 rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *p_entry; + boolean ret = true; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + + p_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + if (p_entry->is_used == false) { + p_entry->is_beamforming_in_progress = false; + return false; + } else { + if (p_entry->is_beamforming_in_progress) + return false; + + p_entry->is_beamforming_in_progress = true; + + if (mode == 1) { + if (!(p_entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) { + p_entry->is_beamforming_in_progress = false; + return false; + } + } else if (mode == 0) { + if (!(p_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)) { + p_entry->is_beamforming_in_progress = false; + return false; + } + } + + if (p_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && p_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { + p_entry->is_beamforming_in_progress = false; + return false; + } else { + p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; + p_entry->is_sound = true; + } + } + + p_entry->sound_bw = BW; + p_beam_info->beamformee_cur_idx = idx; + phydm_beamforming_ndpa_rate(p_dm, BW, rate); + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&idx); + + if (mode == 1) + ret = beamforming_send_ht_ndpa_packet(p_dm, RA, BW, NORMAL_QUEUE); + else + ret = beamforming_send_vht_ndpa_packet(p_dm, RA, p_entry->aid, BW, NORMAL_QUEUE); + + if (ret == false) { + beamforming_leave(p_dm, RA); + p_entry->is_beamforming_in_progress = false; + return false; + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s idx %d\n", __func__, idx)); + return true; +} + + +boolean +beamforming_start_sw( + void *p_dm_void, + u8 idx, + u8 mode, + enum channel_width BW +) +{ + u8 *ra = NULL; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMEE_ENTRY *p_entry; + boolean ret = true; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + + if (p_beam_info->is_mu_sounding) { + p_beam_info->is_mu_sounding_in_progress = true; + p_entry = &(p_beam_info->beamformee_entry[idx]); + ra = p_entry->mac_addr; + + } else { + p_entry = &(p_beam_info->beamformee_entry[idx]); + + if (p_entry->is_used == false) { + PHYDM_DBG(p_dm, DBG_TXBF, ("Skip Beamforming, no entry for idx =%d\n", idx)); + p_entry->is_beamforming_in_progress = false; + return false; + } else { + if (p_entry->is_beamforming_in_progress) { + PHYDM_DBG(p_dm, DBG_TXBF, ("is_beamforming_in_progress, skip...\n")); + return false; + } + + p_entry->is_beamforming_in_progress = true; + ra = p_entry->mac_addr; + + if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_AUTO_HT_TIMER) { + if (!(p_entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT)) { + p_entry->is_beamforming_in_progress = false; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Return by not support BEAMFORMER_CAP_HT_EXPLICIT <==\n", __func__)); + return false; + } + } else if (mode == SOUNDING_SW_VHT_TIMER || mode == SOUNDING_HW_VHT_TIMER || mode == SOUNDING_AUTO_VHT_TIMER) { + if (!(p_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU)) { + p_entry->is_beamforming_in_progress = false; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Return by not support BEAMFORMER_CAP_VHT_SU <==\n", __func__)); + return false; + } + } + if (p_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_INITIALIZED && p_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSED) { + p_entry->is_beamforming_in_progress = false; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Return by incorrect beamform_entry_state(%d) <==\n", __func__, p_entry->beamform_entry_state)); + return false; + } else { + p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; + p_entry->is_sound = true; + } + } + + p_beam_info->beamformee_cur_idx = idx; + } + + /*2014.12.22 Luke: Need to be checked*/ + /*GET_TXBF_INFO(adapter)->fTxbfSet(adapter, TXBF_SET_SOUNDING_STATUS, (u8*)&idx);*/ + + if (mode == SOUNDING_SW_HT_TIMER || mode == SOUNDING_HW_HT_TIMER || mode == SOUNDING_AUTO_HT_TIMER) + ret = beamforming_send_ht_ndpa_packet(p_dm, ra, BW, NORMAL_QUEUE); + else + ret = beamforming_send_vht_ndpa_packet(p_dm, ra, p_entry->aid, BW, NORMAL_QUEUE); + + if (ret == false) { + beamforming_leave(p_dm, ra); + p_entry->is_beamforming_in_progress = false; + return false; + } + + + /*-------------------------- + * Send BF Report Poll for MU BF + --------------------------*/ +#ifdef SUPPORT_MU_BF +#if (SUPPORT_MU_BF == 1) + { + u8 idx, poll_sta_cnt = 0; + boolean is_get_first_bfee = false; + + if (p_beam_info->beamformee_mu_cnt > 1) { /* More than 1 MU STA*/ + + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + p_entry = &(p_beam_info->beamformee_entry[idx]); + if (p_entry->is_mu_sta) { + if (is_get_first_bfee) { + poll_sta_cnt++; + if (poll_sta_cnt == (p_beam_info->beamformee_mu_cnt - 1))/* The last STA*/ + send_sw_vht_bf_report_poll(p_dm, p_entry->mac_addr, true); + else + send_sw_vht_bf_report_poll(p_dm, p_entry->mac_addr, false); + } else + is_get_first_bfee = true; + } + } + } + } +#endif +#endif + return true; +} + + +boolean +beamforming_start_fw( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMEE_ENTRY *p_entry; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + + p_entry = &(p_beam_info->beamformee_entry[idx]); + if (p_entry->is_used == false) { + PHYDM_DBG(p_dm, DBG_TXBF, ("Skip Beamforming, no entry for idx =%d\n", idx)); + return false; + } + + p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSING; + p_entry->is_sound = true; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_FW_NDPA, (u8 *)&idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] End, idx=0x%X\n", __func__, idx)); + return true; +} + +void +beamforming_check_sounding_success( + void *p_dm_void, + boolean status +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[David]@%s Start!\n", __func__)); + + if (status == 1) { + if (p_entry->log_status_fail_cnt == 21) + beamforming_dym_period(p_dm, status); + p_entry->log_status_fail_cnt = 0; + } else if (p_entry->log_status_fail_cnt <= 20) { + p_entry->log_status_fail_cnt++; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s log_status_fail_cnt %d\n", __func__, p_entry->log_status_fail_cnt)); + } + if (p_entry->log_status_fail_cnt > 20) { + p_entry->log_status_fail_cnt = 21; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s log_status_fail_cnt > 20, Stop SOUNDING\n", __func__)); + beamforming_dym_period(p_dm, status); + } +} + +void +phydm_beamforming_end_sw( + void *p_dm_void, + boolean status +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + + if (p_beam_info->is_mu_sounding) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: MU sounding done\n", __func__)); + p_beam_info->is_mu_sounding_in_progress = false; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&(p_beam_info->beamformee_cur_idx)); + } else { + if (p_entry->beamform_entry_state != BEAMFORMING_ENTRY_STATE_PROGRESSING) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] BeamformStatus %d\n", __func__, p_entry->beamform_entry_state)); + return; + } + + if ((p_beam_info->tx_bf_data_rate >= ODM_RATEVHTSS3MCS7) && (p_beam_info->tx_bf_data_rate <= ODM_RATEVHTSS3MCS9) && (p_beam_info->snding3ss == false)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] VHT3SS 7,8,9, do not apply V matrix.\n", __func__)); + p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&(p_beam_info->beamformee_cur_idx)); + } else if (status == 1) { + p_entry->log_status_fail_cnt = 0; + p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_STATUS, (u8 *)&(p_beam_info->beamformee_cur_idx)); + } else { + p_entry->log_status_fail_cnt++; + p_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_INITIALIZED; + hal_com_txbf_set(p_dm, TXBF_SET_TX_PATH_RESET, (u8 *)&(p_beam_info->beamformee_cur_idx)); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] log_status_fail_cnt %d\n", __func__, p_entry->log_status_fail_cnt)); + } + + if (p_entry->log_status_fail_cnt > 50) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s log_status_fail_cnt > 50, Stop SOUNDING\n", __func__)); + p_entry->is_sound = false; + beamforming_deinit_entry(p_dm, p_entry->mac_addr); + + /*Modified by David - Every action of deleting entry should follow by Notify*/ + phydm_beamforming_notify(p_dm); + } + + p_entry->is_beamforming_in_progress = false; + } + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: status=%d\n", __func__, status)); +} + + +void +beamforming_timer_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + void *p_dm_void +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + void *p_context +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct _ADAPTER *adapter = (struct _ADAPTER *)p_context; + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->odmpriv; +#endif + boolean ret = false; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + struct _RT_SOUNDING_INFO *p_sound_info = &(p_beam_info->sounding_info); + boolean is_beamforming_in_progress; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (p_beam_info->is_mu_sounding) + is_beamforming_in_progress = p_beam_info->is_mu_sounding_in_progress; + else + is_beamforming_in_progress = p_entry->is_beamforming_in_progress; + + if (is_beamforming_in_progress) { + PHYDM_DBG(p_dm, DBG_TXBF, ("is_beamforming_in_progress, reset it\n")); + phydm_beamforming_end_sw(p_dm, 0); + } + + ret = phydm_beamforming_select_beam_entry(p_dm, p_beam_info); +#if (SUPPORT_MU_BF == 1) + if (ret && p_beam_info->beamformee_mu_cnt > 1) + ret = 1; + else + ret = 0; +#endif + if (ret) + ret = beamforming_start_sw(p_dm, p_sound_info->sound_idx, p_sound_info->sound_mode, p_sound_info->sound_bw); + else + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, Error value return from BeamformingStart_V2\n", __func__)); + + if ((p_beam_info->beamformee_su_cnt != 0) || (p_beam_info->beamformee_mu_cnt > 1)) { + if (p_sound_info->sound_mode == SOUNDING_SW_VHT_TIMER || p_sound_info->sound_mode == SOUNDING_SW_HT_TIMER) + odm_set_timer(p_dm, &p_beam_info->beamforming_timer, p_sound_info->sound_period); + else { + u32 val = (p_sound_info->sound_period << 16) | HAL_TIMER_TXBF; + phydm_set_hw_reg_handler_interface(p_dm, HW_VAR_HW_REG_TIMER_RESTART, (u8 *)(&val)); + } + } +} + + +void +beamforming_sw_timer_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct timer_list *p_timer +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + void *function_context +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = (struct _ADAPTER *)p_timer->Adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + beamforming_timer_callback(p_dm); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)function_context; + struct _ADAPTER *adapter = p_dm->adapter; + + if (adapter->net_closed == true) + return; + rtw_run_in_thread_cmd(adapter, beamforming_timer_callback, adapter); +#endif + +} + + +void +phydm_beamforming_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMING_OID_INFO *p_beam_oid_info = &(p_beam_info->beamforming_oid_info); + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + #ifdef BEAMFORMING_VERSION_1 + if (p_hal_data->beamforming_version != BEAMFORMING_VERSION_1) { + return; + } + #endif + #endif + + p_beam_oid_info->sound_oid_mode = SOUNDING_STOP_OID_TIMER; + PHYDM_DBG(p_dm, DBG_TXBF, ("%s mode (%d)\n", __func__, p_beam_oid_info->sound_oid_mode)); + + p_beam_info->beamformee_su_cnt = 0; + p_beam_info->beamformer_su_cnt = 0; + p_beam_info->beamformee_mu_cnt = 0; + p_beam_info->beamformer_mu_cnt = 0; + p_beam_info->beamformee_mu_reg_maping = 0; + p_beam_info->mu_ap_index = 0; + p_beam_info->is_mu_sounding = false; + p_beam_info->first_mu_bfee_index = 0xFF; + p_beam_info->apply_v_matrix = true; + p_beam_info->snding3ss = false; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + p_beam_info->source_adapter = p_dm->adapter; +#endif + hal_com_txbf_beamform_init(p_dm); +} + + +boolean +phydm_acting_determine( + void *p_dm_void, + enum phydm_acting_type type +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean ret = false; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->beamforming_info.source_adapter; +#else + struct _ADAPTER *adapter = p_dm->adapter; +#endif + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (type == phydm_acting_as_ap) + ret = ACTING_AS_AP(adapter); + else if (type == phydm_acting_as_ibss) + ret = ACTING_AS_IBSS(adapter); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + + if (type == phydm_acting_as_ap) + ret = check_fwstate(pmlmepriv, WIFI_AP_STATE); + else if (type == phydm_acting_as_ibss) + ret = check_fwstate(pmlmepriv, WIFI_ADHOC_STATE) || check_fwstate(pmlmepriv, WIFI_ADHOC_MASTER_STATE); +#endif + + return ret; + +} + +void +beamforming_enter( + void *p_dm_void, + u16 sta_idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 bfer_bfee_idx = 0xff; + + if (beamforming_init_entry(p_dm, sta_idx, &bfer_bfee_idx)) + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_ENTER, (u8 *)&bfer_bfee_idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] End!\n", __func__)); +} + + +void +beamforming_leave( + void *p_dm_void, + u8 *RA +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (RA != NULL) { + beamforming_deinit_entry(p_dm, RA); + phydm_beamforming_notify(p_dm); + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] End!!\n", __func__)); +} + +#if 0 +/* Nobody calls this function */ +void +phydm_beamforming_set_txbf_en( + void *p_dm_void, + u8 mac_id, + boolean is_txbf +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *p_entry; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + p_entry = phydm_beamforming_get_entry_by_mac_id(p_dm, mac_id, &idx); + + if (p_entry == NULL) + return; + else + p_entry->is_txbf = is_txbf; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s mac_id %d TxBF %d\n", __func__, p_entry->mac_id, p_entry->is_txbf)); + + phydm_beamforming_notify(p_dm); +} +#endif + +enum beamforming_cap +phydm_beamforming_get_beam_cap( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info +) +{ + u8 i; + boolean is_self_beamformer = false; + boolean is_self_beamformee = false; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { + beamformee_entry = p_beam_info->beamformee_entry[i]; + + if (beamformee_entry.is_used) { + is_self_beamformer = true; + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] BFee entry %d is_used=true\n", __func__, i)); + break; + } + } + + for (i = 0; i < BEAMFORMER_ENTRY_NUM; i++) { + beamformer_entry = p_beam_info->beamformer_entry[i]; + + if (beamformer_entry.is_used) { + is_self_beamformee = true; + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]: BFer entry %d is_used=true\n", __func__, i)); + break; + } + } + + if (is_self_beamformer) + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMER_CAP); + if (is_self_beamformee) + beamform_cap = (enum beamforming_cap)(beamform_cap | BEAMFORMEE_CAP); + + return beamform_cap; +} + + +boolean +beamforming_control_v1( + void *p_dm_void, + u8 *RA, + u8 AID, + u8 mode, + enum channel_width BW, + u8 rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean ret = true; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + PHYDM_DBG(p_dm, DBG_TXBF, ("AID (%d), mode (%d), BW (%d)\n", AID, mode, BW)); + + switch (mode) { + case 0: + ret = beamforming_start_v1(p_dm, RA, 0, BW, rate); + break; + case 1: + ret = beamforming_start_v1(p_dm, RA, 1, BW, rate); + break; + case 2: + phydm_beamforming_ndpa_rate(p_dm, BW, rate); + ret = beamforming_send_vht_ndpa_packet(p_dm, RA, AID, BW, NORMAL_QUEUE); + break; + case 3: + phydm_beamforming_ndpa_rate(p_dm, BW, rate); + ret = beamforming_send_ht_ndpa_packet(p_dm, RA, BW, NORMAL_QUEUE); + break; + } + return ret; +} + +/*Only OID uses this function*/ +boolean +phydm_beamforming_control_v2( + void *p_dm_void, + u8 idx, + u8 mode, + enum channel_width BW, + u16 period +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMING_OID_INFO *p_beam_oid_info = &(p_beam_info->beamforming_oid_info); + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + PHYDM_DBG(p_dm, DBG_TXBF, ("idx (%d), mode (%d), BW (%d), period (%d)\n", idx, mode, BW, period)); + + p_beam_oid_info->sound_oid_idx = idx; + p_beam_oid_info->sound_oid_mode = (enum sounding_mode) mode; + p_beam_oid_info->sound_oid_bw = BW; + p_beam_oid_info->sound_oid_period = period; + + phydm_beamforming_notify(p_dm); + + return true; +} + + +void +phydm_beamforming_watchdog( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Start!\n", __func__)); + + if (p_beam_info->beamformee_su_cnt == 0) + return; + + beamforming_dym_period(p_dm, 0); +} +enum beamforming_cap +phydm_get_beamform_cap( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_sta = NULL; + struct bf_cmn_info *p_bf_info = NULL; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _ADAPTER *adapter = p_dm->adapter; + enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; + u8 macid; + u8 ht_curbeamformcap = 0; + u16 vht_curbeamformcap = 0; + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PMGNT_INFO p_MgntInfo = &adapter->MgntInfo; + PRT_VERY_HIGH_THROUGHPUT p_vht_info = GET_VHT_INFO(p_MgntInfo); + PRT_HIGH_THROUGHPUT p_ht_info = GET_HT_INFO(p_MgntInfo); + + ht_curbeamformcap = p_ht_info->HtCurBeamform; + vht_curbeamformcap = p_vht_info->VhtCurBeamform; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[%s] WIN ht_curcap = %d ; vht_curcap = %d\n", __func__, ht_curbeamformcap, vht_curbeamformcap)); + + if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) /*We are Beamformee because the STA is Beamformer*/ + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_HT_EXPLICIT | BEAMFORMEE_CAP)); + + /*We are Beamformer because the STA is Beamformee*/ + if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP)); + + #if (ODM_IC_11AC_SERIES_SUPPORT == 1) + + /* We are Beamformee because the STA is SU Beamformer*/ + if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP)); + + /* We are Beamformer because the STA is SU Beamformee*/ + if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP)); + + /* We are Beamformee because the STA is MU Beamformer*/ + if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP)); + #endif +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + + + for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + + p_sta = p_dm->p_phydm_sta_info[macid]; + + if (!is_sta_active(p_sta)) + continue; + + p_bf_info = &(p_sta->bf_info); + vht_curbeamformcap = p_bf_info->vht_beamform_cap; + ht_curbeamformcap = p_bf_info->ht_beamform_cap; + + if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMER_ENABLE)) /*We are Beamformee because the STA is Beamformer*/ + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_HT_EXPLICIT | BEAMFORMEE_CAP)); + + /*We are Beamformer because the STA is Beamformee*/ + if (TEST_FLAG(ht_curbeamformcap, BEAMFORMING_HT_BEAMFORMEE_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP)); + + #if (ODM_IC_11AC_SERIES_SUPPORT == 1) + /* We are Beamformee because the STA is SU Beamformer*/ + if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMER_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_SU | BEAMFORMEE_CAP)); + + /* We are Beamformer because the STA is SU Beamformee*/ + if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMER_CAP_VHT_SU | BEAMFORMER_CAP)); + + /* We are Beamformee because the STA is MU Beamformer*/ + if (TEST_FLAG(vht_curbeamformcap, BEAMFORMING_VHT_MU_MIMO_AP_ENABLE)) + beamform_cap = (enum beamforming_cap)(beamform_cap | (BEAMFORMEE_CAP_VHT_MU | BEAMFORMEE_CAP)); + #endif +} + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[%s] CE ht_curcap = %d ; vht_curcap = %d\n", __func__, ht_curbeamformcap, vht_curbeamformcap)); + +#endif + +return beamform_cap; + +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.h index 079fced69f11..4b8d22157f8f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_beamforming.h @@ -1,367 +1,395 @@ -#ifndef __INC_PHYDM_BEAMFORMING_H -#define __INC_PHYDM_BEAMFORMING_H - -#ifndef BEAMFORMING_SUPPORT -#define BEAMFORMING_SUPPORT 0 -#endif - -/*Beamforming Related*/ -#include "txbf/halcomtxbf.h" -#include "txbf/haltxbfjaguar.h" -#include "txbf/haltxbf8192e.h" -#include "txbf/haltxbf8814a.h" -#include "txbf/haltxbf8822b.h" -#include "txbf/haltxbfinterface.h" - -#if (BEAMFORMING_SUPPORT == 1) - -#define MAX_BEAMFORMEE_SU 2 -#define MAX_BEAMFORMER_SU 2 -#if (RTL8822B_SUPPORT == 1) -#define MAX_BEAMFORMEE_MU 6 -#define MAX_BEAMFORMER_MU 1 -#else -#define MAX_BEAMFORMEE_MU 0 -#define MAX_BEAMFORMER_MU 0 -#endif - -#define BEAMFORMEE_ENTRY_NUM (MAX_BEAMFORMEE_SU + MAX_BEAMFORMEE_MU) -#define BEAMFORMER_ENTRY_NUM (MAX_BEAMFORMER_SU + MAX_BEAMFORMER_MU) - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -/*for different naming between WIN and CE*/ -#define BEACON_QUEUE BCN_QUEUE_INX -#define NORMAL_QUEUE MGT_QUEUE_INX -#define RT_DISABLE_FUNC RTW_DISABLE_FUNC -#define RT_ENABLE_FUNC RTW_ENABLE_FUNC -#endif - -typedef enum _BEAMFORMING_ENTRY_STATE { - BEAMFORMING_ENTRY_STATE_UNINITIALIZE, - BEAMFORMING_ENTRY_STATE_INITIALIZEING, - BEAMFORMING_ENTRY_STATE_INITIALIZED, - BEAMFORMING_ENTRY_STATE_PROGRESSING, - BEAMFORMING_ENTRY_STATE_PROGRESSED -} BEAMFORMING_ENTRY_STATE, *PBEAMFORMING_ENTRY_STATE; - - -typedef enum _BEAMFORMING_NOTIFY_STATE { - BEAMFORMING_NOTIFY_NONE, - BEAMFORMING_NOTIFY_ADD, - BEAMFORMING_NOTIFY_DELETE, - BEAMFORMEE_NOTIFY_ADD_SU, - BEAMFORMEE_NOTIFY_DELETE_SU, - BEAMFORMEE_NOTIFY_ADD_MU, - BEAMFORMEE_NOTIFY_DELETE_MU, - BEAMFORMING_NOTIFY_RESET -} BEAMFORMING_NOTIFY_STATE, *PBEAMFORMING_NOTIFY_STATE; - -typedef enum _BEAMFORMING_CAP { - BEAMFORMING_CAP_NONE = 0x0, - BEAMFORMER_CAP_HT_EXPLICIT = BIT1, - BEAMFORMEE_CAP_HT_EXPLICIT = BIT2, - BEAMFORMER_CAP_VHT_SU = BIT5, /* Self has er Cap, because Reg er & peer ee */ - BEAMFORMEE_CAP_VHT_SU = BIT6, /* Self has ee Cap, because Reg ee & peer er */ - BEAMFORMER_CAP_VHT_MU = BIT7, /* Self has er Cap, because Reg er & peer ee */ - BEAMFORMEE_CAP_VHT_MU = BIT8, /* Self has ee Cap, because Reg ee & peer er */ - BEAMFORMER_CAP = BIT9, - BEAMFORMEE_CAP = BIT10, -}BEAMFORMING_CAP, *PBEAMFORMING_CAP; - - -typedef enum _SOUNDING_MODE { - SOUNDING_SW_VHT_TIMER = 0x0, - SOUNDING_SW_HT_TIMER = 0x1, - SOUNDING_STOP_All_TIMER = 0x2, - SOUNDING_HW_VHT_TIMER = 0x3, - SOUNDING_HW_HT_TIMER = 0x4, - SOUNDING_STOP_OID_TIMER = 0x5, - SOUNDING_AUTO_VHT_TIMER = 0x6, - SOUNDING_AUTO_HT_TIMER = 0x7, - SOUNDING_FW_VHT_TIMER = 0x8, - SOUNDING_FW_HT_TIMER = 0x9, -}SOUNDING_MODE, *PSOUNDING_MODE; - -typedef struct _RT_BEAMFORM_STAINFO { - pu1Byte RA; - u2Byte AID; - u2Byte MacID; - u1Byte MyMacAddr[6]; - WIRELESS_MODE WirelessMode; - CHANNEL_WIDTH BW; - BEAMFORMING_CAP BeamformCap; - u1Byte HtBeamformCap; - u2Byte VhtBeamformCap; - u1Byte CurBeamform; - u2Byte CurBeamformVHT; -} RT_BEAMFORM_STAINFO, *PRT_BEAMFORM_STAINFO; - - -typedef struct _RT_BEAMFORMEE_ENTRY { - BOOLEAN bUsed; - BOOLEAN bTxBF; - BOOLEAN bSound; - u2Byte AID; /*Used to construct AID field of NDPA packet.*/ - u2Byte MacId; /*Used to Set Reg42C in IBSS mode. */ - u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ - u2Byte G_ID; /*Used to fill Tx DESC*/ - u1Byte MyMacAddr[6]; - u1Byte MacAddr[6]; /*Used to fill Reg6E4 to fill Mac address of CSI report frame.*/ - CHANNEL_WIDTH SoundBW; /*Sounding BandWidth*/ - u2Byte SoundPeriod; - BEAMFORMING_CAP BeamformEntryCap; - BEAMFORMING_ENTRY_STATE BeamformEntryState; - BOOLEAN bBeamformingInProgress; - /*u1Byte LogSeq; // Move to _RT_BEAMFORMER_ENTRY*/ - /*u2Byte LogRetryCnt:3; // 0~4 // Move to _RT_BEAMFORMER_ENTRY*/ - /*u2Byte LogSuccessCnt:2; // 0~2 // Move to _RT_BEAMFORMER_ENTRY*/ - u2Byte LogStatusFailCnt:5; // 0~21 - u2Byte DefaultCSICnt:5; // 0~21 - u1Byte CSIMatrix[327]; - u2Byte CSIMatrixLen; - u1Byte NumofSoundingDim; - u1Byte CompSteeringNumofBFer; - u1Byte su_reg_index; - /*For MU-MIMO*/ - BOOLEAN is_mu_sta; - u1Byte mu_reg_index; - u1Byte gid_valid[8]; - u1Byte user_position[16]; -} RT_BEAMFORMEE_ENTRY, *PRT_BEAMFORMEE_ENTRY; - -typedef struct _RT_BEAMFORMER_ENTRY { - BOOLEAN bUsed; - /*P_AID of BFer entry is probably not used*/ - u2Byte P_AID; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ - u2Byte G_ID; - u1Byte MyMacAddr[6]; - u1Byte MacAddr[6]; - BEAMFORMING_CAP BeamformEntryCap; - u1Byte NumofSoundingDim; - u1Byte ClockResetTimes; /*Modified by Jeffery @2015-04-10*/ - u1Byte PreLogSeq; /*Modified by Jeffery @2015-03-30*/ - u1Byte LogSeq; /*Modified by Jeffery @2014-10-29*/ - u2Byte LogRetryCnt:3; /*Modified by Jeffery @2014-10-29*/ - u2Byte LogSuccess:2; /*Modified by Jeffery @2014-10-29*/ - u1Byte su_reg_index; - /*For MU-MIMO*/ - BOOLEAN is_mu_ap; - u1Byte gid_valid[8]; - u1Byte user_position[16]; - u2Byte AID; -} RT_BEAMFORMER_ENTRY, *PRT_BEAMFORMER_ENTRY; - -typedef struct _RT_SOUNDING_INFO { - u1Byte SoundIdx; - CHANNEL_WIDTH SoundBW; - SOUNDING_MODE SoundMode; - u2Byte SoundPeriod; -} RT_SOUNDING_INFO, *PRT_SOUNDING_INFO; - - - -typedef struct _RT_BEAMFORMING_OID_INFO { - u1Byte SoundOidIdx; - CHANNEL_WIDTH SoundOidBW; - SOUNDING_MODE SoundOidMode; - u2Byte SoundOidPeriod; -} RT_BEAMFORMING_OID_INFO, *PRT_BEAMFORMING_OID_INFO; - - -typedef struct _RT_BEAMFORMING_INFO { - BEAMFORMING_CAP BeamformCap; - RT_BEAMFORMEE_ENTRY BeamformeeEntry[BEAMFORMEE_ENTRY_NUM]; - RT_BEAMFORMER_ENTRY BeamformerEntry[BEAMFORMER_ENTRY_NUM]; - RT_BEAMFORM_STAINFO BeamformSTAinfo; - u1Byte BeamformeeCurIdx; - RT_TIMER BeamformingTimer; - RT_TIMER mu_timer; - RT_SOUNDING_INFO SoundingInfo; - RT_BEAMFORMING_OID_INFO BeamformingOidInfo; - HAL_TXBF_INFO TxbfInfo; - u1Byte SoundingSequence; - u1Byte beamformee_su_cnt; - u1Byte beamformer_su_cnt; - u4Byte beamformee_su_reg_maping; - u4Byte beamformer_su_reg_maping; - /*For MU-MINO*/ - u1Byte beamformee_mu_cnt; - u1Byte beamformer_mu_cnt; - u4Byte beamformee_mu_reg_maping; - u1Byte mu_ap_index; - BOOLEAN is_mu_sounding; - u1Byte FirstMUBFeeIndex; - BOOLEAN is_mu_sounding_in_progress; - BOOLEAN dbg_disable_mu_tx; - BOOLEAN applyVmatrix; - BOOLEAN snding3SS; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER SourceAdapter; -#endif - /* Control register */ - u4Byte RegMUTxCtrl; /* For USB/SDIO interfaces aync I/O */ -} RT_BEAMFORMING_INFO, *PRT_BEAMFORMING_INFO; - - -typedef struct _RT_NDPA_STA_INFO { - u2Byte AID:12; - u2Byte FeedbackType:1; - u2Byte NcIndex:3; -} RT_NDPA_STA_INFO, *PRT_NDPA_STA_INFO; - -typedef enum _PHYDM_ACTING_TYPE { - PhyDM_ACTING_AS_IBSS = 0, - PhyDM_ACTING_AS_AP = 1 -} PHYDM_ACTING_TYPE; - - -BEAMFORMING_CAP -phydm_Beamforming_GetEntryBeamCapByMacId( - IN PVOID pDM_VOID, - IN u1Byte MacId - ); - -PRT_BEAMFORMEE_ENTRY -phydm_Beamforming_GetBFeeEntryByAddr( - IN PVOID pDM_VOID, - IN pu1Byte RA, - OUT pu1Byte Idx - ); - -PRT_BEAMFORMER_ENTRY -phydm_Beamforming_GetBFerEntryByAddr( - IN PVOID pDM_VOID, - IN pu1Byte TA, - OUT pu1Byte Idx - ); - -VOID -phydm_Beamforming_Notify( - IN PVOID pDM_VOID - ); - -BOOLEAN -phydm_actingDetermine( - IN PVOID pDM_VOID, - IN PHYDM_ACTING_TYPE type - ); - -VOID -Beamforming_Enter( - IN PVOID pDM_VOID, - IN u2Byte staIdx - ); - -VOID -Beamforming_Leave( - IN PVOID pDM_VOID, - pu1Byte RA - ); - -BOOLEAN -BeamformingStart_FW( - IN PVOID pDM_VOID, - u1Byte Idx - ); - -VOID -Beamforming_CheckSoundingSuccess( - IN PVOID pDM_VOID, - BOOLEAN Status -); - -VOID -phydm_Beamforming_End_SW( - IN PVOID pDM_VOID, - BOOLEAN Status - ); - -VOID -Beamforming_TimerCallback( - IN PVOID pDM_VOID - ); - -VOID -phydm_Beamforming_Init( - IN PVOID pDM_VOID - ); - - - -BEAMFORMING_CAP -phydm_Beamforming_GetBeamCap( - IN PVOID pDM_VOID, - IN PRT_BEAMFORMING_INFO pBeamInfo - ); - - -BOOLEAN -BeamformingControl_V1( - IN PVOID pDM_VOID, - pu1Byte RA, - u1Byte AID, - u1Byte Mode, - CHANNEL_WIDTH BW, - u1Byte Rate - ); - - -BOOLEAN -phydm_BeamformingControl_V2( - IN PVOID pDM_VOID, - u1Byte Idx, - u1Byte Mode, - CHANNEL_WIDTH BW, - u2Byte Period - ); - -VOID -phydm_Beamforming_Watchdog( - IN PVOID pDM_VOID - ); - -VOID -Beamforming_SWTimerCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PRT_TIMER pTimer -#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - void *FunctionContext -#endif - ); - -BOOLEAN -Beamforming_SendHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW, - IN u1Byte QIdx - ); - - -BOOLEAN -Beamforming_SendVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW, - IN u1Byte QIdx - ); - -#else -#define Beamforming_GidPAid(Adapter, pTcb) -#define phydm_actingDetermine(pDM_Odm, type) FALSE -#define Beamforming_Enter(pDM_Odm, staIdx) -#define Beamforming_Leave(pDM_Odm, RA) -#define Beamforming_End_FW(pDMOdm) -#define BeamformingControl_V1(pDM_Odm, RA, AID, Mode, BW, Rate) TRUE -#define BeamformingControl_V2(pDM_Odm, Idx, Mode, BW, Period) TRUE -#define phydm_Beamforming_End_SW(pDM_Odm, _Status) -#define Beamforming_TimerCallback(pDM_Odm) -#define phydm_Beamforming_Init(pDM_Odm) -#define phydm_BeamformingControl_V2(pDM_Odm, _Idx, _Mode, _BW, _Period) FALSE -#define Beamforming_Watchdog(pDM_Odm) -#define phydm_Beamforming_Watchdog(pDM_Odm) - - -#endif -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __INC_PHYDM_BEAMFORMING_H +#define __INC_PHYDM_BEAMFORMING_H + +#ifndef BEAMFORMING_SUPPORT + #define BEAMFORMING_SUPPORT 0 +#endif + +/*Beamforming Related*/ +#include "txbf/halcomtxbf.h" +#include "txbf/haltxbfjaguar.h" +#include "txbf/haltxbf8192e.h" +#include "txbf/haltxbf8814a.h" +#include "txbf/haltxbf8822b.h" +#include "txbf/haltxbfinterface.h" + +#if (BEAMFORMING_SUPPORT == 1) + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +#define eq_mac_addr(a,b) ( ((a)[0]==(b)[0] && (a)[1]==(b)[1] && (a)[2]==(b)[2] && (a)[3]==(b)[3] && (a)[4]==(b)[4] && (a)[5]==(b)[5]) ? 1:0 ) +#define cp_mac_addr(des,src) ((des)[0]=(src)[0],(des)[1]=(src)[1],(des)[2]=(src)[2],(des)[3]=(src)[3],(des)[4]=(src)[4],(des)[5]=(src)[5]) + +#endif + +#define MAX_BEAMFORMEE_SU 2 +#define MAX_BEAMFORMER_SU 2 +#if (RTL8822B_SUPPORT == 1) + #define MAX_BEAMFORMEE_MU 6 + #define MAX_BEAMFORMER_MU 1 +#else + #define MAX_BEAMFORMEE_MU 0 + #define MAX_BEAMFORMER_MU 0 +#endif + +#define BEAMFORMEE_ENTRY_NUM (MAX_BEAMFORMEE_SU + MAX_BEAMFORMEE_MU) +#define BEAMFORMER_ENTRY_NUM (MAX_BEAMFORMER_SU + MAX_BEAMFORMER_MU) + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + /*for different naming between WIN and CE*/ + #define BEACON_QUEUE BCN_QUEUE_INX + #define NORMAL_QUEUE MGT_QUEUE_INX + #define RT_DISABLE_FUNC RTW_DISABLE_FUNC + #define RT_ENABLE_FUNC RTW_ENABLE_FUNC +#endif + +enum beamforming_entry_state { + BEAMFORMING_ENTRY_STATE_UNINITIALIZE, + BEAMFORMING_ENTRY_STATE_INITIALIZEING, + BEAMFORMING_ENTRY_STATE_INITIALIZED, + BEAMFORMING_ENTRY_STATE_PROGRESSING, + BEAMFORMING_ENTRY_STATE_PROGRESSED +}; + + +enum beamforming_notify_state { + BEAMFORMING_NOTIFY_NONE, + BEAMFORMING_NOTIFY_ADD, + BEAMFORMING_NOTIFY_DELETE, + BEAMFORMEE_NOTIFY_ADD_SU, + BEAMFORMEE_NOTIFY_DELETE_SU, + BEAMFORMEE_NOTIFY_ADD_MU, + BEAMFORMEE_NOTIFY_DELETE_MU, + BEAMFORMING_NOTIFY_RESET +}; + +enum beamforming_cap { + BEAMFORMING_CAP_NONE = 0x0, + BEAMFORMER_CAP_HT_EXPLICIT = BIT(1), + BEAMFORMEE_CAP_HT_EXPLICIT = BIT(2), + BEAMFORMER_CAP_VHT_SU = BIT(5), /* Self has er Cap, because Reg er & peer ee */ + BEAMFORMEE_CAP_VHT_SU = BIT(6), /* Self has ee Cap, because Reg ee & peer er */ + BEAMFORMER_CAP_VHT_MU = BIT(7), /* Self has er Cap, because Reg er & peer ee */ + BEAMFORMEE_CAP_VHT_MU = BIT(8), /* Self has ee Cap, because Reg ee & peer er */ + BEAMFORMER_CAP = BIT(9), + BEAMFORMEE_CAP = BIT(10), +}; + + +enum sounding_mode { + SOUNDING_SW_VHT_TIMER = 0x0, + SOUNDING_SW_HT_TIMER = 0x1, + sounding_stop_all_timer = 0x2, + SOUNDING_HW_VHT_TIMER = 0x3, + SOUNDING_HW_HT_TIMER = 0x4, + SOUNDING_STOP_OID_TIMER = 0x5, + SOUNDING_AUTO_VHT_TIMER = 0x6, + SOUNDING_AUTO_HT_TIMER = 0x7, + SOUNDING_FW_VHT_TIMER = 0x8, + SOUNDING_FW_HT_TIMER = 0x9, +}; + +struct _RT_BEAMFORM_STAINFO { + u8 *ra; + u16 aid; + u16 mac_id; + u8 my_mac_addr[6]; + WIRELESS_MODE wireless_mode; + enum channel_width bw; + enum beamforming_cap beamform_cap; + u8 ht_beamform_cap; + u16 vht_beamform_cap; + u8 cur_beamform; + u16 cur_beamform_vht; +}; + + +struct _RT_BEAMFORMEE_ENTRY { + boolean is_used; + boolean is_txbf; + boolean is_sound; + u16 aid; /*Used to construct AID field of NDPA packet.*/ + u16 mac_id; /*Used to Set Reg42C in IBSS mode. */ + u16 p_aid; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ + u8 g_id; /*Used to fill Tx DESC*/ + u8 my_mac_addr[6]; + u8 mac_addr[6]; /*Used to fill Reg6E4 to fill Mac address of CSI report frame.*/ + enum channel_width sound_bw; /*Sounding band_width*/ + u16 sound_period; + enum beamforming_cap beamform_entry_cap; + enum beamforming_entry_state beamform_entry_state; + boolean is_beamforming_in_progress; + /*u8 log_seq; // Move to _RT_BEAMFORMER_ENTRY*/ + /*u16 log_retry_cnt:3; // 0~4 // Move to _RT_BEAMFORMER_ENTRY*/ + /*u16 LogSuccessCnt:2; // 0~2 // Move to _RT_BEAMFORMER_ENTRY*/ + u16 log_status_fail_cnt:5; /* 0~21 */ + u16 default_csi_cnt:5; /* 0~21 */ + u8 csi_matrix[327]; + u16 csi_matrix_len; + u8 num_of_sounding_dim; + u8 comp_steering_num_of_bfer; + u8 su_reg_index; + /*For MU-MIMO*/ + boolean is_mu_sta; + u8 mu_reg_index; + u8 gid_valid[8]; + u8 user_position[16]; +}; + +struct _RT_BEAMFORMER_ENTRY { + boolean is_used; + /*P_AID of BFer entry is probably not used*/ + u16 p_aid; /*Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ + u8 g_id; + u8 my_mac_addr[6]; + u8 mac_addr[6]; + enum beamforming_cap beamform_entry_cap; + u8 num_of_sounding_dim; + u8 clock_reset_times; /*Modified by Jeffery @2015-04-10*/ + u8 pre_log_seq; /*Modified by Jeffery @2015-03-30*/ + u8 log_seq; /*Modified by Jeffery @2014-10-29*/ + u16 log_retry_cnt:3; /*Modified by Jeffery @2014-10-29*/ + u16 log_success:2; /*Modified by Jeffery @2014-10-29*/ + u8 su_reg_index; + /*For MU-MIMO*/ + boolean is_mu_ap; + u8 gid_valid[8]; + u8 user_position[16]; + u16 aid; +}; + +struct _RT_SOUNDING_INFO { + u8 sound_idx; + enum channel_width sound_bw; + enum sounding_mode sound_mode; + u16 sound_period; +}; + + + +struct _RT_BEAMFORMING_OID_INFO { + u8 sound_oid_idx; + enum channel_width sound_oid_bw; + enum sounding_mode sound_oid_mode; + u16 sound_oid_period; +}; + + +struct _RT_BEAMFORMING_INFO { + enum beamforming_cap beamform_cap; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry[BEAMFORMEE_ENTRY_NUM]; + struct _RT_BEAMFORMER_ENTRY beamformer_entry[BEAMFORMER_ENTRY_NUM]; + struct _RT_BEAMFORM_STAINFO beamform_sta_info; + u8 beamformee_cur_idx; + struct timer_list beamforming_timer; + struct timer_list mu_timer; + struct _RT_SOUNDING_INFO sounding_info; + struct _RT_BEAMFORMING_OID_INFO beamforming_oid_info; + struct _HAL_TXBF_INFO txbf_info; + u8 sounding_sequence; + u8 beamformee_su_cnt; + u8 beamformer_su_cnt; + u32 beamformee_su_reg_maping; + u32 beamformer_su_reg_maping; + /*For MU-MINO*/ + u8 beamformee_mu_cnt; + u8 beamformer_mu_cnt; + u32 beamformee_mu_reg_maping; + u8 mu_ap_index; + boolean is_mu_sounding; + u8 first_mu_bfee_index; + boolean is_mu_sounding_in_progress; + boolean dbg_disable_mu_tx; + boolean apply_v_matrix; + boolean snding3ss; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *source_adapter; +#endif + /* Control register */ + u32 reg_mu_tx_ctrl; /* For USB/SDIO interfaces aync I/O */ + u8 tx_bf_data_rate; + u8 last_usb_hub; +}; + + +struct _RT_NDPA_STA_INFO { + u16 aid:12; + u16 feedback_type:1; + u16 nc_index:3; +}; + +enum phydm_acting_type { + phydm_acting_as_ibss = 0, + phydm_acting_as_ap = 1 +}; + + +enum beamforming_cap +phydm_beamforming_get_entry_beam_cap_by_mac_id( + void *p_dm_void, + u8 mac_id +); + +struct _RT_BEAMFORMEE_ENTRY * +phydm_beamforming_get_bfee_entry_by_addr( + void *p_dm_void, + u8 *RA, + u8 *idx +); + +struct _RT_BEAMFORMER_ENTRY * +phydm_beamforming_get_bfer_entry_by_addr( + void *p_dm_void, + u8 *TA, + u8 *idx +); + +void +phydm_beamforming_notify( + void *p_dm_void +); + +boolean +phydm_acting_determine( + void *p_dm_void, + enum phydm_acting_type type +); + +void +beamforming_enter( + void *p_dm_void, + u16 sta_idx +); + +void +beamforming_leave( + void *p_dm_void, + u8 *RA +); + +boolean +beamforming_start_fw( + void *p_dm_void, + u8 idx +); + +void +beamforming_check_sounding_success( + void *p_dm_void, + boolean status +); + +void +phydm_beamforming_end_sw( + void *p_dm_void, + boolean status +); + +void +beamforming_timer_callback( + void *p_dm_void +); + +void +phydm_beamforming_init( + void *p_dm_void +); + + + +enum beamforming_cap +phydm_beamforming_get_beam_cap( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info +); + +enum beamforming_cap +phydm_get_beamform_cap( + void *p_dm_void +); + +boolean +beamforming_control_v1( + void *p_dm_void, + u8 *RA, + u8 AID, + u8 mode, + enum channel_width BW, + u8 rate +); + + +boolean +phydm_beamforming_control_v2( + void *p_dm_void, + u8 idx, + u8 mode, + enum channel_width BW, + u16 period +); + +void +phydm_beamforming_watchdog( + void *p_dm_void +); + +void +beamforming_sw_timer_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct timer_list *p_timer +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + void *function_context +#endif +); + +boolean +beamforming_send_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW, + u8 q_idx +); + + +boolean +beamforming_send_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW, + u8 q_idx +); + +#else +#define beamforming_gid_paid(adapter, p_tcb) +#define phydm_acting_determine(p_dm, type) false +#define beamforming_enter(p_dm, sta_idx) +#define beamforming_leave(p_dm, RA) +#define beamforming_end_fw(p_dm) +#define beamforming_control_v1(p_dm, RA, AID, mode, BW, rate) true +#define beamforming_control_v2(p_dm, idx, mode, BW, period) true +#define phydm_beamforming_end_sw(p_dm, _status) +#define beamforming_timer_callback(p_dm) +#define phydm_beamforming_init(p_dm) +#define phydm_beamforming_control_v2(p_dm, _idx, _mode, _BW, _period) false +#define beamforming_watchdog(p_dm) +#define phydm_beamforming_watchdog(p_dm) + + +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.c new file mode 100644 index 000000000000..1f1eba95cb8d --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.c @@ -0,0 +1,455 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_SUPPORT_CCKPD + +void +phydm_write_cck_cca_th_new_cs_ratio( + void *p_dm_void, + u8 cca_th, + u8 cca_th_aaa +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cckpd_struct *p_cckpd_t = &p_dm->dm_cckpd_table; + + PHYDM_DBG(p_dm, DBG_CCKPD, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_CCKPD, ("[New] pd_th=0x%x, cs_ratio=0x%x\n\n", cca_th, cca_th_aaa)); + + if (p_cckpd_t->cur_cck_cca_thres != cca_th) { + + p_cckpd_t->cur_cck_cca_thres = cca_th; + odm_set_bb_reg(p_dm, 0xa08, 0xf0000, cca_th); + p_cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; + + } + + if (p_cckpd_t->cck_cca_th_aaa != cca_th_aaa) { + + p_cckpd_t->cck_cca_th_aaa = cca_th_aaa; + odm_set_bb_reg(p_dm, 0xaa8, 0x1f0000, cca_th_aaa); + p_cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; + } + +} + +void +phydm_write_cck_cca_th( + void *p_dm_void, + u8 cca_th +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cckpd_struct *p_cckpd_t = &p_dm->dm_cckpd_table; + + PHYDM_DBG(p_dm, DBG_CCKPD, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_CCKPD, ("New cck_cca_th=((0x%x))\n\n", cca_th)); + + if (p_cckpd_t->cur_cck_cca_thres != cca_th) { + + odm_write_1byte(p_dm, ODM_REG(CCK_CCA, p_dm), cca_th); + p_cckpd_t->cck_fa_ma = CCK_FA_MA_RESET; + } + p_cckpd_t->cur_cck_cca_thres = cca_th; +} + +void +phydm_set_cckpd_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + + if (val_len != 2) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[Error][CCKPD]Need val_len=2\n")); + return; + } + + /*val_buf[0]: 0xa0a*/ + /*val_buf[1]: 0xaaa*/ + + if (p_dm->support_ic_type & EXTEND_CCK_CCATH_AAA_IC) { + phydm_write_cck_cca_th_new_cs_ratio(p_dm, (u8)val_buf[0], (u8)val_buf[1]); + } else { + phydm_write_cck_cca_th(p_dm, (u8)val_buf[0]); + } + +} + +boolean +phydm_stop_cck_pd_th( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & (ODM_BB_CCK_PD | ODM_BB_FA_CNT))) { + + PHYDM_DBG(p_dm, DBG_CCKPD, ("Not Support\n")); + + #if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + #ifdef MCR_WIRELESS_EXTEND + phydm_write_cck_cca_th(p_dm, 0x43); + #endif + #endif + + return true; + } + + if (p_dm->pause_ability & ODM_BB_CCK_PD) { + + PHYDM_DBG(p_dm, DBG_CCKPD, ("Return: Pause CCKPD in LV=%d\n", p_dm->pause_lv_table.lv_cckpd)); + return true; + } + + #if 0/*(DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE))*/ + if (p_dm->ext_lna) + return true; + #endif + + return false; + +} + +void +phydm_cckpd( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct phydm_cckpd_struct *p_cckpd_t = &p_dm->dm_cckpd_table; + u8 cur_cck_cca_th= p_cckpd_t->cur_cck_cca_thres; + + if (p_dm->is_linked) { +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + + /*Add hp_hw_id condition due to 22B LPS power consumption issue and [PCIE-1596]*/ + if (p_dm->hp_hw_id && (p_dm->traffic_load == TRAFFIC_ULTRA_LOW)) + cur_cck_cca_th = 0x40; + else if (p_dm->rssi_min > 35) + cur_cck_cca_th = 0xcd; + else if (p_dm->rssi_min > 20) { + + if (p_cckpd_t->cck_fa_ma > 500) + cur_cck_cca_th = 0xcd; + else if (p_cckpd_t->cck_fa_ma < 250) + cur_cck_cca_th = 0x83; + + } else { + + if((p_dm->p_advance_ota & PHYDM_ASUS_OTA_SETTING) && (p_cckpd_t->cck_fa_ma > 200)) + cur_cck_cca_th = 0xc3; /*for ASUS OTA test*/ + else + cur_cck_cca_th = 0x83; + } + +#else /*ODM_AP*/ + if (p_dig_t->cur_ig_value > 0x32) + cur_cck_cca_th = 0xed; + else if (p_dig_t->cur_ig_value > 0x2a) + cur_cck_cca_th = 0xdd; + else if (p_dig_t->cur_ig_value > 0x24) + cur_cck_cca_th = 0xcd; + else + cur_cck_cca_th = 0x83; + +#endif + } else { + + if (p_cckpd_t->cck_fa_ma > 1000) + cur_cck_cca_th = 0x83; + else if (p_cckpd_t->cck_fa_ma < 500) + cur_cck_cca_th = 0x40; + } + + phydm_write_cck_cca_th(p_dm, cur_cck_cca_th); + /*PHYDM_DBG(p_dm, DBG_CCKPD, ("New cck_cca_th=((0x%x))\n\n", cur_cck_cca_th));*/ + +} + +void +phydm_cckpd_new_cs_ratio( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct phydm_cckpd_struct *p_cckpd_t = &p_dm->dm_cckpd_table; + u8 pd_th = 0, cs_ration = 0, cs_2r_offset = 0; + u8 igi_curr = p_dig_t->cur_ig_value; + u8 en_2rcca; + + PHYDM_DBG(p_dm, DBG_CCKPD, ("%s ======>\n", __func__)); + + en_2rcca = (u8)(odm_get_bb_reg(p_dm, 0xa2c, BIT(18)) && odm_get_bb_reg(p_dm, 0xa2c, BIT(22))); + + if (p_dm->is_linked) { + + if ((igi_curr > 0x38) && (p_dm->rssi_min > 32)) { + cs_ration = p_dig_t->aaa_default + AAA_BASE + AAA_STEP * 2; + cs_2r_offset = 5; + pd_th = 0xd; + } else if ((igi_curr > 0x2a) && (p_dm->rssi_min > 32)) { + cs_ration = p_dig_t->aaa_default + AAA_BASE + AAA_STEP; + cs_2r_offset = 4; + pd_th = 0xd; + } else if ((igi_curr > 0x24) || (p_dm->rssi_min > 24 && p_dm->rssi_min <= 30)) { + cs_ration = p_dig_t->aaa_default + AAA_BASE; + cs_2r_offset = 3; + pd_th = 0xd; + } else if ((igi_curr <= 0x24) || (p_dm->rssi_min < 22)) { + + if (p_cckpd_t->cck_fa_ma > 1000) { + cs_ration = p_dig_t->aaa_default + AAA_STEP; + cs_2r_offset = 1; + pd_th = 0x7; + } else if (p_cckpd_t->cck_fa_ma < 500) { + cs_ration = p_dig_t->aaa_default; + pd_th = 0x3; + } else { + cs_ration = p_cckpd_t->cck_cca_th_aaa; + pd_th = p_cckpd_t->cur_cck_cca_thres; + } + } + } else { + + if (p_cckpd_t->cck_fa_ma > 1000) { + cs_ration = p_dig_t->aaa_default + AAA_STEP; + cs_2r_offset = 1; + pd_th = 0x7; + } else if (p_cckpd_t->cck_fa_ma < 500) { + cs_ration = p_dig_t->aaa_default; + pd_th = 0x3; + } else { + cs_ration = p_cckpd_t->cck_cca_th_aaa; + pd_th = p_cckpd_t->cur_cck_cca_thres; + } + } + + if (en_2rcca) + cs_ration = (cs_ration >= cs_2r_offset) ? (cs_ration - cs_2r_offset) : 0; + + p_cckpd_t->cur_cck_cca_thres = pd_th; + p_cckpd_t->cck_cca_th_aaa = cs_ration; + + PHYDM_DBG(p_dm, DBG_CCKPD, + ("[New] cs_ratio=0x%x, pd_th=0x%x\n", cs_ration, pd_th)); + + odm_set_bb_reg(p_dm, 0xa08, 0xf0000, pd_th); + odm_set_bb_reg(p_dm, 0xaa8, 0x1f0000, cs_ration); + + /*phydm_write_cck_cca_th_new_cs_ratio(p_dm, pd_th, cs_ration);*/ +} + +#endif + +void +phydm_cck_pd_th( + void *p_dm_void +) +{ +#ifdef PHYDM_SUPPORT_CCKPD + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_struct *p_fa_t= &p_dm->false_alm_cnt; + struct phydm_cckpd_struct *p_cckpd_t = &p_dm->dm_cckpd_table; + u32 cnt_cck_fail_tmp = p_fa_t->cnt_cck_fail; + #ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_fa_acc_struct *p_fa_acc_t = &p_dm->false_alm_cnt_acc; + #endif + + PHYDM_DBG(p_dm, DBG_CCKPD, ("%s ======>\n", __func__)); + + if (phydm_stop_cck_pd_th(p_dm) == true) + return; + +#ifdef PHYDM_TDMA_DIG_SUPPORT + cnt_cck_fail_tmp = (p_dm->original_dig_restore) ? (p_fa_t->cnt_cck_fail) : (p_fa_acc_t->cnt_cck_fail_1sec); +#endif + + if (p_cckpd_t->cck_fa_ma == CCK_FA_MA_RESET) + p_cckpd_t->cck_fa_ma = cnt_cck_fail_tmp; + else { + p_cckpd_t->cck_fa_ma = ((p_cckpd_t->cck_fa_ma << 1) + + p_cckpd_t->cck_fa_ma + cnt_cck_fail_tmp) >> 2; + } + + PHYDM_DBG(p_dm, DBG_CCKPD, ("CCK FA=%d\n", p_cckpd_t->cck_fa_ma)); + + if (p_dm->support_ic_type & EXTEND_CCK_CCATH_AAA_IC) + phydm_cckpd_new_cs_ratio(p_dm); + else + phydm_cckpd(p_dm); + +#endif +} + +void +odm_pause_cck_packet_detection( + void *p_dm_void, + enum phydm_pause_type pause_type, + enum phydm_pause_level pause_lv, + u8 cck_pd_th +) +{ +#ifdef PHYDM_SUPPORT_CCKPD + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cckpd_struct *p_cckpd_t = &p_dm->dm_cckpd_table; + s8 max_level; + u8 i; + + PHYDM_DBG(p_dm, DBG_CCKPD, ("%s ======>\n", __func__)); + + if ((p_cckpd_t->pause_bitmap == 0) && + (!(p_dm->support_ability & (ODM_BB_CCK_PD | ODM_BB_FA_CNT)))) { + + PHYDM_DBG(p_dm, DBG_CCKPD, ("Return: not support\n")); + return; + } + + if (pause_lv >= PHYDM_PAUSE_MAX_NUM) { + PHYDM_DBG(p_dm, DBG_CCKPD, ("Return: Wrong LV !\n")); + return; + } + PHYDM_DBG(p_dm, DBG_CCKPD, ("Set pause{Type, LV, val} = {%d, %d, 0x%x}\n", + pause_type, pause_lv, cck_pd_th)); + + PHYDM_DBG(p_dm, DBG_CCKPD, ("pause LV=0x%x\n", p_cckpd_t->pause_bitmap)); + + for (i = 0; i < PHYDM_PAUSE_MAX_NUM; i ++) { + PHYDM_DBG(p_dm, DBG_CCKPD, ("pause val[%d]=0x%x\n", + i, p_cckpd_t->pause_cckpd_value[i])); + } + + switch (pause_type) { + + case PHYDM_PAUSE: + { + /* Disable CCK PD */ + p_dm->support_ability &= ~ODM_BB_CCK_PD; + + PHYDM_DBG(p_dm, DBG_CCKPD, ("Pause CCK PD th\n")); + + /* Backup original CCK PD threshold decided by CCK PD mechanism */ + if (p_cckpd_t->pause_bitmap == 0) { + + p_cckpd_t->cckpd_bkp = p_cckpd_t->cur_cck_cca_thres; + + PHYDM_DBG(p_dm, DBG_CCKPD, ("cckpd_bkp=0x%x\n", + p_cckpd_t->cckpd_bkp)); + } + + p_cckpd_t->pause_bitmap |= BIT(pause_lv); /* Update pause level */ + p_cckpd_t->pause_cckpd_value[pause_lv] = cck_pd_th; + + /* Write new CCK PD threshold */ + if (BIT(pause_lv + 1) > p_cckpd_t->pause_bitmap) { + + PHYDM_DBG(p_dm, DBG_CCKPD, ("> ori pause LV=0x%x\n", + p_cckpd_t->pause_bitmap)); + + phydm_write_cck_cca_th(p_dm, cck_pd_th); + } + break; + } + case PHYDM_RESUME: + { + /* check if the level is illegal or not */ + if ((p_cckpd_t->pause_bitmap & (BIT(pause_lv))) != 0) { + + p_cckpd_t->pause_bitmap &= (~(BIT(pause_lv))); + p_cckpd_t->pause_cckpd_value[pause_lv] = 0; + PHYDM_DBG(p_dm, DBG_CCKPD, ("Resume CCK PD\n")); + } else { + + PHYDM_DBG(p_dm, DBG_CCKPD, ("Wrong resume LV\n")); + break; + } + + /* Resume CCKPD */ + if (p_cckpd_t->pause_bitmap == 0) { + + PHYDM_DBG(p_dm, DBG_CCKPD,("Revert bkp_CCKPD=0x%x\n", + p_cckpd_t->cckpd_bkp)); + + phydm_write_cck_cca_th(p_dm, p_cckpd_t->cckpd_bkp); + p_dm->support_ability |= ODM_BB_CCK_PD;/* Enable CCKPD */ + break; + } + + if (BIT(pause_lv) > p_cckpd_t->pause_bitmap) { + + /* Calculate the maximum level now */ + for (max_level = (pause_lv - 1); max_level >= 0; max_level--) { + if (p_cckpd_t->pause_bitmap & BIT(max_level)) + break; + } + + /* write CCKPD of lower level */ + phydm_write_cck_cca_th(p_dm, p_cckpd_t->pause_cckpd_value[max_level]); + PHYDM_DBG(p_dm, DBG_CCKPD, ("Write CCKPD=0x%x for max_LV=%d\n", + p_cckpd_t->pause_cckpd_value[max_level], max_level)); + break; + } + break; + } + default: + PHYDM_DBG(p_dm, DBG_CCKPD,("Wrong type\n")); + break; + } + + PHYDM_DBG(p_dm, DBG_CCKPD, ("New pause bitmap=0x%x\n", + p_cckpd_t->pause_bitmap)); + + for (i = 0; i < PHYDM_PAUSE_MAX_NUM; i ++) { + PHYDM_DBG(p_dm, DBG_CCKPD, ("pause val[%d]=0x%x\n", + i, p_cckpd_t->pause_cckpd_value[i])); + } +#endif +} + +void +phydm_cck_pd_init( + void *p_dm_void +) +{ +#ifdef PHYDM_SUPPORT_CCKPD + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cckpd_struct *p_cckpd_t = &p_dm->dm_cckpd_table; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + + p_cckpd_t->cur_cck_cca_thres = 0; + p_cckpd_t->cck_cca_th_aaa = 0; + + p_cckpd_t->pause_bitmap = 0; + + if (p_dm->support_ic_type & EXTEND_CCK_CCATH_AAA_IC) + p_dig_t->aaa_default = odm_read_1byte(p_dm, 0xaaa) & 0x1f; + + odm_memory_set(p_dm, p_cckpd_t->pause_cckpd_value, 0, PHYDM_PAUSE_MAX_NUM); +#endif +} + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.h new file mode 100644 index 000000000000..9337b7660f37 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cck_pd.h @@ -0,0 +1,85 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDM_CCK_PD_H__ +#define __PHYDM_CCK_PD_H__ + +#define CCK_PD_VERSION "1.0" /* 2017.05.09 Dino, Add phydm_cck_pd.h*/ + + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + + +#define AAA_BASE 4 +#define AAA_STEP 2 + +#define CCK_FA_MA_RESET 0xffffffff + +#define EXTEND_CCK_CCATH_AAA_IC (ODM_RTL8197F | ODM_RTL8821C | ODM_RTL8723D |ODM_RTL8710B) +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + +#ifdef PHYDM_SUPPORT_CCKPD +struct phydm_cckpd_struct { + + u8 cur_cck_cca_thres; /*0xA0A*/ + u8 cck_cca_th_aaa; /*0xAAA*/ + u32 cck_fa_ma; + u8 cckpd_bkp; + u32 rvrt_val[2]; + u8 pause_bitmap;/*will be removed*/ + u8 pause_lv; + u8 pause_cckpd_value[PHYDM_PAUSE_MAX_NUM]; /*will be removed*/ +}; +#endif + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + +/* 1 ============================================================ + * 1 function prototype + * 1 ============================================================ */ + +void +phydm_set_cckpd_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +); + +void +phydm_cck_pd_th( + void *p_dm_void +); + +void +odm_pause_cck_packet_detection( + void *p_dm_void, + enum phydm_pause_type pause_type, + enum phydm_pause_level pause_level, + u8 cck_pd_threshold +); + +void +phydm_cck_pd_init( + void *p_dm_void +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.c index 7d81f229e99c..183dd2481df7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.c @@ -1,400 +1,1163 @@ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -/*Set NHM period, threshold, disable ignore cca or not, disable ignore txon or not*/ -VOID -phydm_NHMsetting( - IN PVOID pDM_VOID, - u1Byte NHMsetting -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - if (NHMsetting == SET_NHM_SETTING){ - - /*Set inexclude_cca, inexclude_txon*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9, CCX_INFO->NHM_inexclude_cca); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10, CCX_INFO->NHM_inexclude_txon); - - /*Set NHM period*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord, CCX_INFO->NHM_period); - - /*Set NHM threshold*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0, CCX_INFO->NHM_th[0]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1, CCX_INFO->NHM_th[1]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2, CCX_INFO->NHM_th[2]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3, CCX_INFO->NHM_th[3]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0, CCX_INFO->NHM_th[4]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1, CCX_INFO->NHM_th[5]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2, CCX_INFO->NHM_th[6]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3, CCX_INFO->NHM_th[7]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, CCX_INFO->NHM_th[8]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2, CCX_INFO->NHM_th[9]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3, CCX_INFO->NHM_th[10]); - - /*CCX EN*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT8, CCX_EN); - - } - else if (NHMsetting == STORE_NHM_SETTING) { - - /*Store pervious disable_ignore_cca, disable_ignore_txon*/ - CCX_INFO->NHM_inexclude_cca_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9); - CCX_INFO->NHM_inexclude_txon_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10); - - /*Store pervious NHM period*/ - CCX_INFO->NHM_period_restore = (u2Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord); - - /*Store NHM threshold*/ - CCX_INFO->NHM_th_restore[0] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0); - CCX_INFO->NHM_th_restore[1] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1); - CCX_INFO->NHM_th_restore[2] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2); - CCX_INFO->NHM_th_restore[3] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3); - CCX_INFO->NHM_th_restore[4] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0); - CCX_INFO->NHM_th_restore[5] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1); - CCX_INFO->NHM_th_restore[6] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2); - CCX_INFO->NHM_th_restore[7] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3); - CCX_INFO->NHM_th_restore[8] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0); - CCX_INFO->NHM_th_restore[9] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2); - CCX_INFO->NHM_th_restore[10] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3); - } - else if (NHMsetting == RESTORE_NHM_SETTING) { - - /*Set disable_ignore_cca, disable_ignore_txon*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT9, CCX_INFO->NHM_inexclude_cca_restore); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT10, CCX_INFO->NHM_inexclude_txon_restore); - - /*Set NHM period*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskHWord, CCX_INFO->NHM_period); - - /*Set NHM threshold*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[0]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte1, CCX_INFO->NHM_th_restore[1]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[2]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[3]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[4]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte1, CCX_INFO->NHM_th_restore[5]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[6]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[7]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11AC, bMaskByte0, CCX_INFO->NHM_th_restore[8]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte2, CCX_INFO->NHM_th_restore[9]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, bMaskByte3, CCX_INFO->NHM_th_restore[10]); - } - else - return; - } - - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - if (NHMsetting == SET_NHM_SETTING){ - - /*Set disable_ignore_cca, disable_ignore_txon*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9, CCX_INFO->NHM_inexclude_cca); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10, CCX_INFO->NHM_inexclude_txon); - - /*Set NHM period*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord, CCX_INFO->NHM_period); - - /*Set NHM threshold*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0, CCX_INFO->NHM_th[0]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1, CCX_INFO->NHM_th[1]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2, CCX_INFO->NHM_th[2]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3, CCX_INFO->NHM_th[3]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0, CCX_INFO->NHM_th[4]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1, CCX_INFO->NHM_th[5]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2, CCX_INFO->NHM_th[6]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3, CCX_INFO->NHM_th[7]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0, CCX_INFO->NHM_th[8]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2, CCX_INFO->NHM_th[9]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3, CCX_INFO->NHM_th[10]); - - /*CCX EN*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT8, CCX_EN); - } - else if (NHMsetting == STORE_NHM_SETTING) { - - /*Store pervious disable_ignore_cca, disable_ignore_txon*/ - CCX_INFO->NHM_inexclude_cca_restore = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9); - CCX_INFO->NHM_inexclude_txon_restore= (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10); - - /*Store pervious NHM period*/ - CCX_INFO->NHM_period_restore= (u2Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord); - - /*Store NHM threshold*/ - CCX_INFO->NHM_th_restore[0] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0); - CCX_INFO->NHM_th_restore[1] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1); - CCX_INFO->NHM_th_restore[2] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2); - CCX_INFO->NHM_th_restore[3] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3); - CCX_INFO->NHM_th_restore[4] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0); - CCX_INFO->NHM_th_restore[5] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1); - CCX_INFO->NHM_th_restore[6] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2); - CCX_INFO->NHM_th_restore[7] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3); - CCX_INFO->NHM_th_restore[8] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0); - CCX_INFO->NHM_th_restore[9] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2); - CCX_INFO->NHM_th_restore[10] = (u1Byte)ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3); - - } - else if (NHMsetting == RESTORE_NHM_SETTING) { - - /*Set disable_ignore_cca, disable_ignore_txon*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT9, CCX_INFO->NHM_inexclude_cca_restore); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT10, CCX_INFO->NHM_inexclude_txon_restore); - - /*Set NHM period*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskHWord, CCX_INFO->NHM_period_restore); - - /*Set NHM threshold*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte0, CCX_INFO->NHM_th_restore[0]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte1, CCX_INFO->NHM_th_restore[1]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte2, CCX_INFO->NHM_th_restore[2]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH3_TO_TH0_11N, bMaskByte3, CCX_INFO->NHM_th_restore[3]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte0, CCX_INFO->NHM_th_restore[4]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte1, CCX_INFO->NHM_th_restore[5]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte2, CCX_INFO->NHM_th_restore[6]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH7_TO_TH4_11N, bMaskByte3, CCX_INFO->NHM_th_restore[7]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH8_11N, bMaskByte0, CCX_INFO->NHM_th_restore[8]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte2, CCX_INFO->NHM_th_restore[9]); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, bMaskByte3, CCX_INFO->NHM_th_restore[10]); - } - else - return; - - } -} - -VOID -phydm_NHMtrigger( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - /*Trigger NHM*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11AC, BIT1, 1); - } - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - /*Trigger NHM*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_NHM_TH9_TH10_11N, BIT1, 1); - } -} - -VOID -phydm_getNHMresult( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte value32; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT_11AC); - CCX_INFO->NHM_result[0] = (u1Byte)(value32 & bMaskByte0); - CCX_INFO->NHM_result[1] = (u1Byte)((value32 & bMaskByte1) >> 8); - CCX_INFO->NHM_result[2] = (u1Byte)((value32 & bMaskByte2) >> 16); - CCX_INFO->NHM_result[3] = (u1Byte)((value32 & bMaskByte3) >> 24); - - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); - CCX_INFO->NHM_result[4] = (u1Byte)(value32 & bMaskByte0); - CCX_INFO->NHM_result[5] = (u1Byte)((value32 & bMaskByte1) >> 8); - CCX_INFO->NHM_result[6] = (u1Byte)((value32 & bMaskByte2) >> 16); - CCX_INFO->NHM_result[7] = (u1Byte)((value32 & bMaskByte3) >> 24); - - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT11_TO_CNT8_11AC); - CCX_INFO->NHM_result[8] = (u1Byte)(value32 & bMaskByte0); - CCX_INFO->NHM_result[9] = (u1Byte)((value32 & bMaskByte1) >> 8); - CCX_INFO->NHM_result[10] = (u1Byte)((value32 & bMaskByte2) >> 16); - CCX_INFO->NHM_result[11] = (u1Byte)((value32 & bMaskByte3) >> 24); - - /*Get NHM duration*/ - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC); - CCX_INFO->NHM_duration = (u2Byte)(value32 & bMaskLWord); - - } - - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT_11N); - CCX_INFO->NHM_result[0] = (u1Byte)(value32 & bMaskByte0); - CCX_INFO->NHM_result[1] = (u1Byte)((value32 & bMaskByte1) >> 8); - CCX_INFO->NHM_result[2] = (u1Byte)((value32 & bMaskByte2) >> 16); - CCX_INFO->NHM_result[3] = (u1Byte)((value32 & bMaskByte3) >> 24); - - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT7_TO_CNT4_11N); - CCX_INFO->NHM_result[4] = (u1Byte)(value32 & bMaskByte0); - CCX_INFO->NHM_result[5] = (u1Byte)((value32 & bMaskByte1) >> 8); - CCX_INFO->NHM_result[6] = (u1Byte)((value32 & bMaskByte2) >> 16); - CCX_INFO->NHM_result[7] = (u1Byte)((value32 & bMaskByte3) >> 24); - - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT9_TO_CNT8_11N); - CCX_INFO->NHM_result[8] = (u1Byte)((value32 & bMaskByte2) >> 16); - CCX_INFO->NHM_result[9] = (u1Byte)((value32 & bMaskByte3) >> 24); - - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT10_TO_CNT11_11N); - CCX_INFO->NHM_result[10] = (u1Byte)((value32 & bMaskByte2) >> 16); - CCX_INFO->NHM_result[11] = (u1Byte)((value32 & bMaskByte3) >> 24); - - /*Get NHM duration*/ - value32 = ODM_Read4Byte(pDM_Odm, ODM_REG_NHM_CNT10_TO_CNT11_11N); - CCX_INFO->NHM_duration = (u2Byte)(value32 & bMaskLWord); - - } - -} - -BOOLEAN -phydm_checkNHMready( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte value32 = 0; - u1Byte i; - BOOLEAN ret = FALSE; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); - - for (i = 0; i < 200; i ++) { - - ODM_delay_ms(1); - if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT17)) { - ret = 1; - break; - } - } - } - - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_READY_11N, bMaskDWord); - - for (i = 0; i < 200; i ++) { - - ODM_delay_ms(1); - if (ODM_GetBBReg(pDM_Odm, ODM_REG_NHM_DUR_READY_11AC, BIT17) ) { - ret = 1; - break; - } - } - } - return ret; -} - -VOID -phydm_storeNHMsetting( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - - } - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - - - } -} - -VOID -phydm_CLMsetting( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - - ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11AC, bMaskLWord, CCX_INFO->CLM_period); /*4us sample 1 time*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT8, 0x1); /*Enable CCX for CLM*/ - - } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - - ODM_SetBBReg(pDM_Odm, ODM_REG_CCX_PERIOD_11N, bMaskLWord, CCX_INFO->CLM_period); /*4us sample 1 time*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT8, 0x1); /*Enable CCX for CLM*/ - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM period = %dus\n", __func__, CCX_INFO->CLM_period*4)); - -} - -VOID -phydm_CLMtrigger( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x0); /*Trigger CLM*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11AC, BIT0, 0x1); - } else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x0); /*Trigger CLM*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CLM_11N, BIT0, 0x1); - } -} - -BOOLEAN -phydm_checkCLMready( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte value32 = 0; - BOOLEAN ret = FALSE; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*make sure CLM calc is ready*/ - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_READY_11N, bMaskDWord); /*make sure CLM calc is ready*/ - - if ((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (value32 & BIT16)) - ret = TRUE; - else if ((pDM_Odm->SupportICType & ODM_IC_11N_SERIES) && (value32 & BIT17)) - ret = TRUE; - else - ret = FALSE; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM ready = %d\n", __func__, ret)); - - return ret; -} - -void -phydm_getCLMresult( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - - u4Byte value32 = 0; - u2Byte results = 0; - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11AC, bMaskDWord); /*read CLM calc result*/ - else if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_CLM_RESULT_11N, bMaskDWord); /*read CLM calc result*/ - - CCX_INFO->CLM_result = (u2Byte)(value32 & bMaskLWord); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CCX, ODM_DBG_LOUD, ("[%s] : CLM result = %dus\n", __func__, CCX_INFO->CLM_result*4)); - -} +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef FAHM_SUPPORT + +u16 +phydm_hw_divider( + void *p_dm_void, + u16 numerator, + u16 denumerator +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 result = DEVIDER_ERROR; + u32 tmp_u32 = ((numerator << 16) | denumerator); + u32 reg_devider_input; + u32 reg_devider_rpt; + u8 i; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg_devider_input = 0x1cbc; + reg_devider_rpt = 0x1f98; + } else { + reg_devider_input = 0x980; + reg_devider_rpt = 0x9f0; + } + + odm_set_bb_reg(p_dm, reg_devider_input, MASKDWORD, tmp_u32); + + for (i = 0; i < 10; i++) { + ODM_delay_ms(1); + if (odm_get_bb_reg(p_dm, reg_devider_rpt, BIT(24))) { /*Chk HW rpt is ready*/ + + result = (u16)odm_get_bb_reg(p_dm, reg_devider_rpt, MASKBYTE2); + break; + } + } + return result; +} + +void +phydm_fahm_trigger( + void *p_dm_void, + u16 trigger_period /*unit (4us)*/ +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u32 fahm_reg1; + u32 fahm_reg2; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, 0x1cf8, 0xffff00, trigger_period); + + fahm_reg1 = 0x994; + } else { + + odm_set_bb_reg(p_dm, 0x978, 0xff000000, (trigger_period & 0xff)); + odm_set_bb_reg(p_dm, 0x97c, 0xff, (trigger_period & 0xff00)>>8); + + fahm_reg1 = 0x890; + } + + odm_set_bb_reg(p_dm, fahm_reg1, BIT(2), 0); + odm_set_bb_reg(p_dm, fahm_reg1, BIT(2), 1); +} + +void +phydm_fahm_set_valid_cnt( + void *p_dm_void, + u8 numerator_sel, + u8 denumerator_sel +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u32 fahm_reg1; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if ((ccx_info->fahm_nume_sel == numerator_sel) && + (ccx_info->fahm_denum_sel == denumerator_sel)) { + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("no need to update\n", __FUNCTION__)); + return; + } + + ccx_info->fahm_nume_sel = numerator_sel; + ccx_info->fahm_denum_sel = denumerator_sel; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + fahm_reg1 = 0x994; + } else { + fahm_reg1 = 0x890; + } + + odm_set_bb_reg(p_dm, fahm_reg1, 0xe0, numerator_sel); + odm_set_bb_reg(p_dm, fahm_reg1, 0x7000, denumerator_sel); +} + +void +phydm_get_fahm_result( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u16 fahm_rpt_cnt[12]; /*packet count*/ + u16 fahm_rpt[12]; /*percentage*/ + u16 fahm_denumerator; /*packet count*/ + u32 reg_rpt, reg_rpt_2; + u32 reg_val_tmp; + boolean is_ready = false; + u8 i; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + reg_rpt = 0x1f80; + reg_rpt_2 = 0x1f98; + } else { + reg_rpt = 0x9d8; + reg_rpt_2 = 0x9f0; + } + + for (i = 0; i < 10; i++) { + + if (odm_get_bb_reg(p_dm, reg_rpt_2, BIT(31))) { /*Chk HW rpt is ready*/ + + is_ready = true; + break; + } + ODM_delay_ms(1); + } + + if (is_ready == false) + return; + + /*Get Denumerator*/ + fahm_denumerator = (u16)odm_get_bb_reg(p_dm, reg_rpt_2, MASKLWORD); + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Reg[0x%x] fahm_denmrtr = %d\n", reg_rpt_2, fahm_denumerator)); + + + /*Get nemerator*/ + for (i = 0; i<6; i++) { + reg_val_tmp = odm_get_bb_reg(p_dm, reg_rpt + (i<<2), MASKDWORD); + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Reg[0x%x] fahm_denmrtr = %d\n", (p_dm, reg_rpt + (i*4), reg_val_tmp))); + + fahm_rpt_cnt[i*2] = (u16)(reg_val_tmp & MASKLWORD); + fahm_rpt_cnt[i*2 +1] = (u16)((reg_val_tmp & MASKHWORD)>>16); + } + + for (i = 0; i<12; i++) { + fahm_rpt[i] = phydm_hw_divider(p_dm, fahm_rpt_cnt[i], fahm_denumerator); + } + + PHYDM_DBG(p_dm, DBG_ENV_MNTR,("FAHM_RPT_cnt[10:0]=[%d, %d, %d, %d, %d(IGI), %d, %d, %d, %d, %d, %d, %d]\n", + fahm_rpt_cnt[11], fahm_rpt_cnt[10], fahm_rpt_cnt[9], fahm_rpt_cnt[8], fahm_rpt_cnt[7], fahm_rpt_cnt[6], + fahm_rpt_cnt[5], fahm_rpt_cnt[4], fahm_rpt_cnt[3], fahm_rpt_cnt[2], fahm_rpt_cnt[1], fahm_rpt_cnt[0])); + + PHYDM_DBG(p_dm, DBG_ENV_MNTR,("FAHM_RPT_%[10:0]=[%d, %d, %d, %d, %d(IGI), %d, %d, %d, %d, %d, %d, %d]\n", + fahm_rpt[11], fahm_rpt[10], fahm_rpt[9], fahm_rpt[8], fahm_rpt[7], fahm_rpt[6], + fahm_rpt[5], fahm_rpt[4], fahm_rpt[3], fahm_rpt[2], fahm_rpt[1], fahm_rpt[0])); + +} + +void +phydm_set_fahm_th_by_igi( + void *p_dm_void, + u8 igi +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u8 fahm_th[11]; + u8 rssi_th[11]; /*in RSSI scale*/ + u8 th_gap = 2 * IGI_TO_NHM_TH_MULTIPLIER; /*beacuse unit is 0.5dB for FAHM*/ + u8 i; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (ccx_info->env_mntr_igi == igi) { + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("No need to update FAHM_th, IGI=0x%x\n", ccx_info->env_mntr_igi)); + return; + } + + ccx_info->env_mntr_igi = igi; /*bkp IGI*/ + + if (igi >= CCA_CAP) + fahm_th[0] = (igi - CCA_CAP) * IGI_TO_NHM_TH_MULTIPLIER; + else + fahm_th[0] = 0; + + rssi_th[0] = igi -10 - CCA_CAP; + + for (i = 1; i <= 10; i++) { + fahm_th[i] = fahm_th[0] + th_gap * i; + rssi_th[i] = rssi_th[0] + (i<<1); + } + + PHYDM_DBG(p_dm, DBG_ENV_MNTR,("FAHM_RSSI_th[10:0]=[%d, %d, %d, (IGI)%d, %d, %d, %d, %d, %d, %d, %d]\n", + rssi_th[10], rssi_th[9], rssi_th[8], rssi_th[7], rssi_th[6], rssi_th[5], rssi_th[4], rssi_th[3], rssi_th[2], rssi_th[1], rssi_th[0])); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, 0x1c38, 0xffffff00, ((fahm_th[2]<<24) |(fahm_th[1]<<16) | (fahm_th[0]<<8))); + odm_set_bb_reg(p_dm, 0x1c78, 0xffffff00, ((fahm_th[5]<<24) |(fahm_th[4]<<16) | (fahm_th[3]<<8))); + odm_set_bb_reg(p_dm, 0x1c7c, 0xffffff00, ((fahm_th[7]<<24) |(fahm_th[6]<<16))); + odm_set_bb_reg(p_dm, 0x1cb8, 0xffffff00, ((fahm_th[10]<<24) |(fahm_th[9]<<16) | (fahm_th[8]<<8))); + } else { + + odm_set_bb_reg(p_dm, 0x970, MASKDWORD, ((fahm_th[3]<<24) |(fahm_th[2]<<16) | (fahm_th[1]<<8) | fahm_th[0])); + odm_set_bb_reg(p_dm, 0x974, MASKDWORD, ((fahm_th[7]<<24) |(fahm_th[6]<<16) | (fahm_th[5]<<8) | fahm_th[4])); + odm_set_bb_reg(p_dm, 0x978, MASKDWORD, ((fahm_th[10]<<16) | (fahm_th[9]<<8) | fahm_th[8])); + } +} + +void +phydm_fahm_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u32 fahm_reg1; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("IGI=0x%x\n", p_dm->dm_dig_table.cur_ig_value)); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + fahm_reg1 = 0x994; + } else { + fahm_reg1 = 0x890; + } + + ccx_info->fahm_period = 65535; + + odm_set_bb_reg(p_dm, fahm_reg1, 0x6, 3); /*FAHM HW block enable*/ + + phydm_fahm_set_valid_cnt(p_dm, FAHM_INCLD_FA, (FAHM_INCLD_FA| FAHM_INCLD_CRC_OK |FAHM_INCLD_CRC_ER)); + phydm_set_fahm_th_by_igi(p_dm, p_dm->dm_dig_table.cur_ig_value); +} + +void +phydm_fahm_dbg( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i; + + for (i = 0; i < 2; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + } + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "{1: trigger, 2:get result}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{3: MNTR mode sel} {1: driver, 2. FW}\n")); + return; + } else if (var1[0] == 1) { /* Set & trigger CLM */ + + phydm_set_fahm_th_by_igi(p_dm, p_dm->dm_dig_table.cur_ig_value); + phydm_fahm_trigger(p_dm, ccx_info->fahm_period); + PHYDM_SNPRINTF((output + used, out_len - used, "Monitor FAHM for %d * 4us\n", ccx_info->fahm_period)); + + } else if (var1[0] == 2) { /* Get CLM results */ + + phydm_get_fahm_result(p_dm); + PHYDM_SNPRINTF((output + used, out_len - used, "FAHM_result=%d us\n", (ccx_info->clm_result<<2))); + + } /*else if (var1[0] == 3) { + + if (var1[1] == 1) + ccx_info->clm_mntr_mode = CLM_DRIVER_MNTR; + else if (var1[1] == 2) + ccx_info->clm_mntr_mode = CLM_FW_MNTR; + + }*/ else { + + PHYDM_SNPRINTF((output + used, out_len - used, "Error\n")); + } + + *_used = used; + *_out_len = out_len; +} + + +#endif + +void +phydm_c2h_clm_report_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u8 clm_report = cmd_buf[0]; + u8 clm_report_idx = cmd_buf[1]; + + if (cmd_len >=12) + return; + + ccx_info->clm_fw_result_acc += clm_report; + ccx_info->clm_fw_result_cnt++; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%d] clm_report= %d\n", ccx_info->clm_fw_result_cnt, clm_report)); + +} + +void +phydm_clm_h2c( + void *p_dm_void, + u16 obs_time, + u8 fw_clm_en +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 h2c_val[H2C_MAX_LENGTH] = {0}; + u8 i = 0; + u8 obs_time_idx = 0; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("obs_time_index=%d *4 ms\n", obs_time)); + + for (i =1; i<=16; i++) { + if (obs_time & BIT(16 -i)) { + obs_time_idx = 16-i; + break; + } + } + + /* + obs_time =(2^16 -1) ~ (2^15) => obs_time_idx = 15 (65535 ~ 32768) + obs_time =(2^15 -1) ~ (2^14) => obs_time_idx = 14 + ... + ... + ... + obs_time =(2^1 -1) ~ (2^0) => obs_time_idx = 0 + + */ + + h2c_val[0] = obs_time_idx | (((fw_clm_en) ? 1 : 0)<< 7); + h2c_val[1] = CLM_MAX_REPORT_TIME; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("PHYDM h2c[0x4d]=0x%x %x %x %x %x %x %x\n", + h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2], h2c_val[1], h2c_val[0])); + + odm_fill_h2c_cmd(p_dm, PHYDM_H2C_FW_CLM_MNTR, H2C_MAX_LENGTH, h2c_val); + +} + +boolean +phydm_cal_nhm_cnt( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u8 noisy_nhm_th_index, low_pwr_cnt = 0, high_pwr_cnt = 0; + u8 noisy_nhm_th = 0x52; + u8 i; + boolean noisy = false, clean = true; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) + return noisy; + + /*nhm_th = 0x52 means 0x52/2-110 = -69dbm*/ + /* IGI < 0x14 */ + if (ccx_info->nhm_th[10] < noisy_nhm_th) + return clean; + else if (ccx_info->nhm_th[0] > noisy_nhm_th) + return (p_dm->noisy_decision) ? noisy : clean; + /* 0x14 <= IGI <= 0x37*/ + else { + /* search index */ + noisy_nhm_th_index = (noisy_nhm_th - ccx_info->nhm_th[0]) << 2; + + for (i = 0; i <= 11; i++) { + if (i <= noisy_nhm_th_index) + low_pwr_cnt += ccx_info->nhm_result[i]; + else + high_pwr_cnt += ccx_info->nhm_result[i]; + } + + if (low_pwr_cnt + high_pwr_cnt == 0) + return noisy; /* noisy environment */ + else if (low_pwr_cnt - high_pwr_cnt >= 100) + return clean; /* clean environment */ + else + return noisy; /* noisy environment */ + } +} + +void +phydm_nhm_setting( + void *p_dm_void, + u8 nhm_setting +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("IGI=0x%x\n", ccx_info->echo_igi)); + + if (nhm_setting == SET_NHM_SETTING) { + PHYDM_DBG(p_dm, DBG_ENV_MNTR, + ("NHM_th[H->L]=[0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x]\n", + ccx_info->nhm_th[10], ccx_info->nhm_th[9], ccx_info->nhm_th[8], + ccx_info->nhm_th[7], ccx_info->nhm_th[6], ccx_info->nhm_th[5], + ccx_info->nhm_th[4], ccx_info->nhm_th[3], ccx_info->nhm_th[2], + ccx_info->nhm_th[1], ccx_info->nhm_th[0])); + } + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + if (nhm_setting == SET_NHM_SETTING) { + + /*Set inexclude_cca, inexclude_txon*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(9), ccx_info->nhm_inexclude_cca); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(10), ccx_info->nhm_inexclude_txon); + + /*Set NHM period*/ + odm_set_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11AC, MASKHWORD, ccx_info->nhm_period); + + /*Set NHM threshold*/ /*Unit: PWdB U(8,1)*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE0, ccx_info->nhm_th[0]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE1, ccx_info->nhm_th[1]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE2, ccx_info->nhm_th[2]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE3, ccx_info->nhm_th[3]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE0, ccx_info->nhm_th[4]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE1, ccx_info->nhm_th[5]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE2, ccx_info->nhm_th[6]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE3, ccx_info->nhm_th[7]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH8_11AC, MASKBYTE0, ccx_info->nhm_th[8]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE2, ccx_info->nhm_th[9]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE3, ccx_info->nhm_th[10]); + + /*CCX EN*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(8), CCX_EN); + + } else if (nhm_setting == STORE_NHM_SETTING) { + + /*Store pervious disable_ignore_cca, disable_ignore_txon*/ + ccx_info->nhm_inexclude_cca_restore = (enum nhm_inexclude_cca)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(9)); + ccx_info->nhm_inexclude_txon_restore = (enum nhm_inexclude_txon)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(10)); + + /*Store pervious NHM period*/ + ccx_info->nhm_period_restore = (u16)odm_get_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11AC, MASKHWORD); + + /*Store NHM threshold*/ + ccx_info->nhm_th_restore[0] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE0); + ccx_info->nhm_th_restore[1] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE1); + ccx_info->nhm_th_restore[2] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE2); + ccx_info->nhm_th_restore[3] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE3); + ccx_info->nhm_th_restore[4] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE0); + ccx_info->nhm_th_restore[5] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE1); + ccx_info->nhm_th_restore[6] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE2); + ccx_info->nhm_th_restore[7] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE3); + ccx_info->nhm_th_restore[8] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH8_11AC, MASKBYTE0); + ccx_info->nhm_th_restore[9] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE2); + ccx_info->nhm_th_restore[10] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE3); + } else if (nhm_setting == RESTORE_NHM_SETTING) { + + /*Set disable_ignore_cca, disable_ignore_txon*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(9), ccx_info->nhm_inexclude_cca_restore); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(10), ccx_info->nhm_inexclude_txon_restore); + + /*Set NHM period*/ + odm_set_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11AC, MASKHWORD, ccx_info->nhm_period); + + /*Set NHM threshold*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE0, ccx_info->nhm_th_restore[0]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE1, ccx_info->nhm_th_restore[1]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE2, ccx_info->nhm_th_restore[2]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE3, ccx_info->nhm_th_restore[3]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE0, ccx_info->nhm_th_restore[4]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE1, ccx_info->nhm_th_restore[5]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE2, ccx_info->nhm_th_restore[6]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE3, ccx_info->nhm_th_restore[7]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH8_11AC, MASKBYTE0, ccx_info->nhm_th_restore[8]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE2, ccx_info->nhm_th_restore[9]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE3, ccx_info->nhm_th_restore[10]); + } else + return; + } + + else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + if (nhm_setting == SET_NHM_SETTING) { + + /*Set disable_ignore_cca, disable_ignore_txon*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(9), ccx_info->nhm_inexclude_cca); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(10), ccx_info->nhm_inexclude_txon); + + /*Set NHM period*/ + odm_set_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11N, MASKHWORD, ccx_info->nhm_period); + + /*Set NHM threshold*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE0, ccx_info->nhm_th[0]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE1, ccx_info->nhm_th[1]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE2, ccx_info->nhm_th[2]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE3, ccx_info->nhm_th[3]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE0, ccx_info->nhm_th[4]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE1, ccx_info->nhm_th[5]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE2, ccx_info->nhm_th[6]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE3, ccx_info->nhm_th[7]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH8_11N, MASKBYTE0, ccx_info->nhm_th[8]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE2, ccx_info->nhm_th[9]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE3, ccx_info->nhm_th[10]); + + /*CCX EN*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(8), CCX_EN); + } else if (nhm_setting == STORE_NHM_SETTING) { + + /*Store pervious disable_ignore_cca, disable_ignore_txon*/ + ccx_info->nhm_inexclude_cca_restore = (enum nhm_inexclude_cca)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(9)); + ccx_info->nhm_inexclude_txon_restore = (enum nhm_inexclude_txon)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(10)); + + /*Store pervious NHM period*/ + ccx_info->nhm_period_restore = (u16)odm_get_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11N, MASKHWORD); + + /*Store NHM threshold*/ + ccx_info->nhm_th_restore[0] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE0); + ccx_info->nhm_th_restore[1] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE1); + ccx_info->nhm_th_restore[2] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE2); + ccx_info->nhm_th_restore[3] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE3); + ccx_info->nhm_th_restore[4] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE0); + ccx_info->nhm_th_restore[5] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE1); + ccx_info->nhm_th_restore[6] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE2); + ccx_info->nhm_th_restore[7] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE3); + ccx_info->nhm_th_restore[8] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH8_11N, MASKBYTE0); + ccx_info->nhm_th_restore[9] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE2); + ccx_info->nhm_th_restore[10] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE3); + + } else if (nhm_setting == RESTORE_NHM_SETTING) { + + /*Set disable_ignore_cca, disable_ignore_txon*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(9), ccx_info->nhm_inexclude_cca_restore); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(10), ccx_info->nhm_inexclude_txon_restore); + + /*Set NHM period*/ + odm_set_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11N, MASKHWORD, ccx_info->nhm_period_restore); + + /*Set NHM threshold*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE0, ccx_info->nhm_th_restore[0]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE1, ccx_info->nhm_th_restore[1]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE2, ccx_info->nhm_th_restore[2]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE3, ccx_info->nhm_th_restore[3]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE0, ccx_info->nhm_th_restore[4]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE1, ccx_info->nhm_th_restore[5]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE2, ccx_info->nhm_th_restore[6]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE3, ccx_info->nhm_th_restore[7]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH8_11N, MASKBYTE0, ccx_info->nhm_th_restore[8]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE2, ccx_info->nhm_th_restore[9]); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE3, ccx_info->nhm_th_restore[10]); + } else + return; + + } +} + +void +phydm_nhm_trigger( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + /*Trigger NHM*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(1), 0); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, BIT(1), 1); + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + /*Trigger NHM*/ + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(1), 0); + odm_set_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, BIT(1), 1); + } +} + +void +phydm_get_nhm_result( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u32 value32; + u8 i; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT_11AC); + ccx_info->nhm_result[0] = (u8)(value32 & MASKBYTE0); + ccx_info->nhm_result[1] = (u8)((value32 & MASKBYTE1) >> 8); + ccx_info->nhm_result[2] = (u8)((value32 & MASKBYTE2) >> 16); + ccx_info->nhm_result[3] = (u8)((value32 & MASKBYTE3) >> 24); + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT7_TO_CNT4_11AC); + ccx_info->nhm_result[4] = (u8)(value32 & MASKBYTE0); + ccx_info->nhm_result[5] = (u8)((value32 & MASKBYTE1) >> 8); + ccx_info->nhm_result[6] = (u8)((value32 & MASKBYTE2) >> 16); + ccx_info->nhm_result[7] = (u8)((value32 & MASKBYTE3) >> 24); + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT11_TO_CNT8_11AC); + ccx_info->nhm_result[8] = (u8)(value32 & MASKBYTE0); + ccx_info->nhm_result[9] = (u8)((value32 & MASKBYTE1) >> 8); + ccx_info->nhm_result[10] = (u8)((value32 & MASKBYTE2) >> 16); + ccx_info->nhm_result[11] = (u8)((value32 & MASKBYTE3) >> 24); + + /*Get NHM duration*/ + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_DUR_READY_11AC); + ccx_info->nhm_duration = (u16)(value32 & MASKLWORD); + + } + + else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT_11N); + ccx_info->nhm_result[0] = (u8)(value32 & MASKBYTE0); + ccx_info->nhm_result[1] = (u8)((value32 & MASKBYTE1) >> 8); + ccx_info->nhm_result[2] = (u8)((value32 & MASKBYTE2) >> 16); + ccx_info->nhm_result[3] = (u8)((value32 & MASKBYTE3) >> 24); + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT7_TO_CNT4_11N); + ccx_info->nhm_result[4] = (u8)(value32 & MASKBYTE0); + ccx_info->nhm_result[5] = (u8)((value32 & MASKBYTE1) >> 8); + ccx_info->nhm_result[6] = (u8)((value32 & MASKBYTE2) >> 16); + ccx_info->nhm_result[7] = (u8)((value32 & MASKBYTE3) >> 24); + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT9_TO_CNT8_11N); + ccx_info->nhm_result[8] = (u8)((value32 & MASKBYTE2) >> 16); + ccx_info->nhm_result[9] = (u8)((value32 & MASKBYTE3) >> 24); + + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT10_TO_CNT11_11N); + ccx_info->nhm_result[10] = (u8)((value32 & MASKBYTE2) >> 16); + ccx_info->nhm_result[11] = (u8)((value32 & MASKBYTE3) >> 24); + + /*Get NHM duration*/ + value32 = odm_read_4byte(p_dm, ODM_REG_NHM_CNT10_TO_CNT11_11N); + ccx_info->nhm_duration = (u16)(value32 & MASKLWORD); + + } + + /* sum all nhm_result */ + ccx_info->nhm_result_total = 0; + for (i = 0; i <= 11; i++) + ccx_info->nhm_result_total += ccx_info->nhm_result[i]; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, + ("NHM_result=(H->L)[%d %d %d %d (igi) %d %d %d %d %d %d %d %d]\n", + ccx_info->nhm_result[11], ccx_info->nhm_result[10], ccx_info->nhm_result[9], + ccx_info->nhm_result[8], ccx_info->nhm_result[7], ccx_info->nhm_result[6], + ccx_info->nhm_result[5], ccx_info->nhm_result[4], ccx_info->nhm_result[3], + ccx_info->nhm_result[2], ccx_info->nhm_result[1], ccx_info->nhm_result[0])); +} + +boolean +phydm_check_nhm_rdy( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i; + boolean is_ready = false; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + for (i = 0; i < 200; i++) { + ODM_delay_ms(1); + if (odm_get_bb_reg(p_dm, ODM_REG_NHM_DUR_READY_11AC, BIT(16))) { + is_ready = 1; + break; + } + } + } + + else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + for (i = 0; i < 200; i++) { + ODM_delay_ms(1); + if (odm_get_bb_reg(p_dm, 0x8b4, BIT(17))) { + is_ready = 1; + break; + } + } + } + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("NHM rdy=%d\n", is_ready)); + return is_ready; +} + +void +phydm_store_nhm_setting( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + + + } +} + +void +phydm_clm_setting( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11AC, MASKLWORD, ccx_info->clm_period); /*4us sample 1 time*/ + /**/ + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + odm_set_bb_reg(p_dm, ODM_REG_CCX_PERIOD_11N, MASKLWORD, ccx_info->clm_period); + /**/ + } + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Set CLM period=%d * 4us\n", ccx_info->clm_period)); + +} + +void +phydm_clm_hw_restart( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, ODM_REG_CLM_11AC, BIT(8), 0x0); /*Enable CCX for CLM*/ + odm_set_bb_reg(p_dm, ODM_REG_CLM_11AC, BIT(8), 0x1); /*Enable CCX for CLM*/ + + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + odm_set_bb_reg(p_dm, ODM_REG_CLM_11AC, BIT(8), 0x0); /*Enable CCX for CLM*/ + odm_set_bb_reg(p_dm, ODM_REG_CLM_11N, BIT(8), 0x1); /*Enable CCX for CLM*/ + } + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Set CLM period=%d * 4us\n", ccx_info->clm_period)); + +} + +void +phydm_clm_trigger( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + odm_set_bb_reg(p_dm, ODM_REG_CLM_11AC, BIT(0), 0x0); /*Trigger CLM*/ + odm_set_bb_reg(p_dm, ODM_REG_CLM_11AC, BIT(0), 0x1); + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + odm_set_bb_reg(p_dm, ODM_REG_CLM_11N, BIT(0), 0x0); /*Trigger CLM*/ + odm_set_bb_reg(p_dm, ODM_REG_CLM_11N, BIT(0), 0x1); + } +} + +boolean +phydm_check_clm_rdy( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean is_ready = false; + u8 i; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + for (i = 0; i < 200; i++) { + ODM_delay_ms(1); + if (odm_get_bb_reg(p_dm, ODM_REG_CLM_RESULT_11AC, BIT(16))) { + is_ready = 1; + break; + } + } + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + for (i = 0; i < 200; i++) { + ODM_delay_ms(1); + if (odm_get_bb_reg(p_dm, ODM_REG_CLM_READY_11N, BIT(16))) { + is_ready = 1; + break; + } + } + } + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("CLM rdy=%d\n", is_ready)); + return is_ready; +} + +void +phydm_get_clm_result( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + ccx_info->clm_result = (u16)odm_get_bb_reg(p_dm, ODM_REG_CLM_RESULT_11AC, MASKDWORD); + else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + ccx_info->clm_result = (u16)odm_get_bb_reg(p_dm, ODM_REG_CLM_RESULT_11N, MASKDWORD); + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("CLM result = %d *4 us\n", ccx_info->clm_result)); +} + +void +phydm_set_nhm_th_by_igi( + void *p_dm_void, + u8 igi +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u8 th_gap = 2 * IGI_TO_NHM_TH_MULTIPLIER; + u8 i; + + ccx_info->echo_igi = igi; + ccx_info->nhm_th[0] = (ccx_info->echo_igi - CCA_CAP) * IGI_TO_NHM_TH_MULTIPLIER; + for (i = 1; i <= 10; i++) + ccx_info->nhm_th[i] = ccx_info->nhm_th[0] + th_gap * i; +} + +void +phydm_set_clm_mntr_mode( + void *p_dm_void, + enum clm_monitor_mode_e mode +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + if (ccx_info->clm_mntr_mode != mode) { + ccx_info->clm_mntr_mode = mode; + phydm_clm_hw_restart(p_dm); + + if (mode == CLM_DRIVER_MNTR) { + phydm_clm_h2c(p_dm,0, 0); + } + } +} + +void +phydm_ccx_monitor_trigger( + void *p_dm_void, + u16 monitor_time /*unit ms*/ +) +{ + u8 nhm_th[11], i, igi; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u16 monitor_time_4us = 0; + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + if (monitor_time == 0) + return; + + if (monitor_time >= 262) + monitor_time_4us = 65534; + else + monitor_time_4us = monitor_time * MS_TO_4US_RATIO; + + /* check if NHM threshold is changed */ + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + nhm_th[0] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE0); + nhm_th[1] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE1); + nhm_th[2] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE2); + nhm_th[3] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11AC, MASKBYTE3); + nhm_th[4] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE0); + nhm_th[5] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE1); + nhm_th[6] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE2); + nhm_th[7] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11AC, MASKBYTE3); + nhm_th[8] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH8_11AC, MASKBYTE0); + nhm_th[9] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE2); + nhm_th[10] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11AC, MASKBYTE3); + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + nhm_th[0] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE0); + nhm_th[1] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE1); + nhm_th[2] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE2); + nhm_th[3] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH3_TO_TH0_11N, MASKBYTE3); + nhm_th[4] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE0); + nhm_th[5] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE1); + nhm_th[6] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE2); + nhm_th[7] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH7_TO_TH4_11N, MASKBYTE3); + nhm_th[8] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH8_11N, MASKBYTE0); + nhm_th[9] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE2); + nhm_th[10] = (u8)odm_get_bb_reg(p_dm, ODM_REG_NHM_TH9_TH10_11N, MASKBYTE3); + } + + for (i = 0; i <= 10; i++) { + + if (nhm_th[i] != ccx_info->nhm_th[i]) { + PHYDM_DBG(p_dm, DBG_ENV_MNTR, + ("nhm_th[%d] != ccx_info->nhm_th[%d]!!\n", i, i)); + } + } + /*[NHM]*/ + igi = (u8)odm_get_bb_reg(p_dm, 0xC50, MASKBYTE0); + phydm_set_nhm_th_by_igi(p_dm, igi); + + ccx_info->nhm_period = monitor_time_4us; + ccx_info->nhm_inexclude_cca = NHM_EXCLUDE_CCA; + ccx_info->nhm_inexclude_txon = NHM_EXCLUDE_TXON; + + phydm_nhm_setting(p_dm, SET_NHM_SETTING); + phydm_nhm_trigger(p_dm); + + /*[CLM]*/ + ccx_info->clm_period = monitor_time_4us; + + if (ccx_info->clm_mntr_mode == CLM_DRIVER_MNTR) { + phydm_clm_setting(p_dm); + phydm_clm_trigger(p_dm); + } else if (ccx_info->clm_mntr_mode == CLM_FW_MNTR){ + phydm_clm_h2c(p_dm, monitor_time_4us, TRUE); + } else { + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("CLM_ECHO_DBG_MODE\n")); + } + +} + +void +phydm_ccx_monitor_result( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + u32 clm_result_tmp = 0; + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("%s ======>\n", __func__)); + + if (phydm_check_nhm_rdy(p_dm)) { + phydm_get_nhm_result(p_dm); + + if (ccx_info->nhm_result_total != 0) + ccx_info->nhm_ratio = (u8)(((ccx_info->nhm_result_total - ccx_info->nhm_result[0])*100) >> 8); + } + + if (ccx_info->clm_mntr_mode == CLM_DRIVER_MNTR) { + + if (phydm_check_clm_rdy(p_dm)) { + phydm_get_clm_result(p_dm); + + if (ccx_info->clm_period != 0) { + + if (ccx_info->clm_period == 64000) + ccx_info->clm_ratio = (u8)(((ccx_info->clm_result >> 6) + 5) /10); + else if (ccx_info->clm_period == 65535) { + + clm_result_tmp = (u32)(ccx_info->clm_result * 100); + ccx_info->clm_ratio = (u8)((clm_result_tmp + (1<<15)) >> 16); + } else + ccx_info->clm_ratio = (u8)((ccx_info->clm_result*100) / ccx_info->clm_period); + } + } + + } else { + if (ccx_info->clm_fw_result_cnt != 0) + ccx_info->clm_ratio = (u8)(ccx_info->clm_fw_result_acc /ccx_info->clm_fw_result_cnt); + else + ccx_info->clm_ratio = 0; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("clm_fw_result_acc=%d, clm_fw_result_cnt=%d\n", + ccx_info->clm_fw_result_acc, ccx_info->clm_fw_result_cnt)); + + ccx_info->clm_fw_result_acc = 0; + ccx_info->clm_fw_result_cnt = 0; + } + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("IGI=0x%x, nhm_ratio=%d, clm_ratio=%d\n\n", + ccx_info->echo_igi, ccx_info->nhm_ratio, ccx_info->clm_ratio)); + +} + +void +phydm_ccx_monitor( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + phydm_ccx_monitor_result(p_dm); + phydm_ccx_monitor_trigger(p_dm, 262); /*monitor 262ms*/ +} + +void +phydm_nhm_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("cur_ig_value=0x%x\n", p_dm->dm_dig_table.cur_ig_value)); + + phydm_set_nhm_th_by_igi(p_dm, p_dm->dm_dig_table.cur_ig_value); + + ccx_info->nhm_period = 64000; + ccx_info->nhm_inexclude_cca = NHM_EXCLUDE_CCA; + ccx_info->nhm_inexclude_txon = NHM_EXCLUDE_TXON; + + phydm_nhm_setting(p_dm, SET_NHM_SETTING); +} + +void +phydm_clm_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + ccx_info->clm_mntr_mode = CLM_DRIVER_MNTR; + ccx_info->clm_period = 65535; + phydm_clm_setting(p_dm); + phydm_clm_hw_restart(p_dm); +} + +void +phydm_env_monitor_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & ODM_BB_ENV_MONITOR)) + return; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("[%s]===>\n", __FUNCTION__)); + + phydm_nhm_init(p_dm); + phydm_clm_init(p_dm); +} + +void +phydm_clm_dbg( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i; + + for (i = 0; i < 2; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + } + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "{1: trigger, 2:get result}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{3: MNTR mode sel} {1: driver, 2. FW}\n")); + return; + } else if (var1[0] == 1) { /* Set & trigger CLM */ + + ccx_info->clm_period = 65535; /* 65535*4us = 262.14ms*/ + phydm_clm_setting(p_dm); + phydm_clm_hw_restart(p_dm); + phydm_clm_trigger(p_dm); + PHYDM_SNPRINTF((output + used, out_len - used, "Monitor CLM for 262ms\n")); + + } else if (var1[0] == 2) { /* Get CLM results */ + + phydm_get_clm_result(p_dm); + PHYDM_SNPRINTF((output + used, out_len - used, "CLM_result=%d us\n", (ccx_info->clm_result<<2))); + + } else if (var1[0] == 3) { + + if (var1[1] == 1) + ccx_info->clm_mntr_mode = CLM_DRIVER_MNTR; + else if (var1[1] == 2) + ccx_info->clm_mntr_mode = CLM_FW_MNTR; + + } else { + + PHYDM_SNPRINTF((output + used, out_len - used, "Error\n")); + } + + *_used = used; + *_out_len = out_len; +} \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.h index 18b0dd2e892c..3719fede256f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_ccx.h @@ -1,102 +1,209 @@ -#ifndef __PHYDMCCX_H__ -#define __PHYDMCCX_H__ - -#define CCX_EN 1 - -#define SET_NHM_SETTING 0 -#define STORE_NHM_SETTING 1 -#define RESTORE_NHM_SETTING 2 - -/* -#define NHM_EXCLUDE_CCA 0 -#define NHM_INCLUDE_CCA 1 -#define NHM_EXCLUDE_TXON 0 -#define NHM_INCLUDE_TXON 1 -*/ - -typedef enum NHM_inexclude_cca { - NHM_EXCLUDE_CCA, - NHM_INCLUDE_CCA -}NHM_INEXCLUDE_CCA; - -typedef enum NHM_inexclude_txon { - NHM_EXCLUDE_TXON, - NHM_INCLUDE_TXON -}NHM_INEXCLUDE_TXON; - - -typedef struct _CCX_INFO{ - - /*Settings*/ - u1Byte NHM_th[11]; - u2Byte NHM_period; /* 4us per unit */ - u2Byte CLM_period; /* 4us per unit */ - NHM_INEXCLUDE_TXON NHM_inexclude_txon; - NHM_INEXCLUDE_CCA NHM_inexclude_cca; - - /*Previous Settings*/ - u1Byte NHM_th_restore[11]; - u2Byte NHM_period_restore; /* 4us per unit */ - u2Byte CLM_period_restore; /* 4us per unit */ - NHM_INEXCLUDE_TXON NHM_inexclude_txon_restore; - NHM_INEXCLUDE_CCA NHM_inexclude_cca_restore; - - /*Report*/ - u1Byte NHM_result[12]; - u2Byte NHM_duration; - u2Byte CLM_result; - - - BOOLEAN echo_NHM_en; - BOOLEAN echo_CLM_en; - u1Byte echo_IGI; - -}CCX_INFO, *PCCX_INFO; - -/*NHM*/ - -VOID -phydm_NHMsetting( - IN PVOID pDM_VOID, - u1Byte NHMsetting -); - -VOID -phydm_NHMtrigger( - IN PVOID pDM_VOID -); - -VOID -phydm_getNHMresult( - IN PVOID pDM_VOID -); - -BOOLEAN -phydm_checkNHMready( - IN PVOID pDM_VOID -); - -/*CLM*/ - -VOID -phydm_CLMsetting( - IN PVOID pDM_VOID -); - -VOID -phydm_CLMtrigger( - IN PVOID pDM_VOID -); - -BOOLEAN -phydm_checkCLMready( - IN PVOID pDM_VOID -); - -VOID -phydm_getCLMresult( - IN PVOID pDM_VOID -); - - -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMCCX_H__ +#define __PHYDMCCX_H__ + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + +#define CCX_EN 1 + +#define IGI_TO_NHM_TH_MULTIPLIER 2 +#define MS_TO_4US_RATIO 250 +#define CCA_CAP 14 +#define CLM_MAX_REPORT_TIME 10 +#define DEVIDER_ERROR 0xffff + +/*FAHM*/ +#define FAHM_INCLD_FA BIT(0) +#define FAHM_INCLD_CRC_OK BIT(1) +#define FAHM_INCLD_CRC_ER BIT(2) + + +/* 1 ============================================================ + * 1 enumrate + * 1 ============================================================ */ + +enum nhm_setting { + SET_NHM_SETTING, + STORE_NHM_SETTING, + RESTORE_NHM_SETTING +}; + +enum nhm_inexclude_cca { + NHM_EXCLUDE_CCA, + NHM_INCLUDE_CCA +}; + +enum nhm_inexclude_txon { + NHM_EXCLUDE_TXON, + NHM_INCLUDE_TXON +}; + +enum clm_monitor_mode_e { + CLM_ECHO_DBG_MODE = 0, + CLM_DRIVER_MNTR = 1, + CLM_FW_MNTR = 2 +}; + +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + +struct _CCX_INFO { + + /*Settings*/ + u8 nhm_th[11]; + u16 nhm_period; /* 4us per unit */ + u16 clm_period; /* 4us per unit */ + enum nhm_inexclude_txon nhm_inexclude_txon; + enum nhm_inexclude_cca nhm_inexclude_cca; + + /*Previous Settings*/ + u8 nhm_th_restore[11]; + u16 nhm_period_restore; /* 4us per unit */ + u16 clm_period_restore; /* 4us per unit */ + enum nhm_inexclude_txon nhm_inexclude_txon_restore; + enum nhm_inexclude_cca nhm_inexclude_cca_restore; + + /*Report*/ + u8 nhm_result[12]; + u8 nhm_ratio; /*1% per nuit, it means the interference igi can't overcome.*/ + u8 nhm_result_total; + u16 nhm_duration; + u16 clm_result; + u8 clm_ratio; + u8 echo_igi; /* nhm_result comes from this igi */ + u32 clm_fw_result_acc; + u8 clm_fw_result_cnt; + enum clm_monitor_mode_e clm_mntr_mode; + u8 env_mntr_igi; +#ifdef FAHM_SUPPORT + u8 fahm_nume_sel; /*fahm_numerator_sel: select {FA, CRCOK, CRC_fail} */ + u8 fahm_denum_sel; /*fahm_denumerator_sel: select {FA, CRCOK, CRC_fail} */ + u16 fahm_period; /*unit: 4us*/ +#endif + +}; + +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + +#ifdef FAHM_SUPPORT + +void +phydm_fahm_init( + void *p_dm_void +); + +void +phydm_fahm_dbg( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +#endif + +void +phydm_c2h_clm_report_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +); +/*NHM*/ + +boolean +phydm_cal_nhm_cnt( + void *p_dm_void +); + +void +phydm_nhm_setting( + void *p_dm_void, + u8 nhm_setting +); + +void +phydm_nhm_trigger( + void *p_dm_void +); + +void +phydm_get_nhm_result( + void *p_dm_void +); + +/*CLM*/ + +void +phydm_clm_setting( + void *p_dm_void +); + +void +phydm_clm_trigger( + void *p_dm_void +); + +void +phydm_get_clm_result( + void *p_dm_void +); + +void +phydm_ccx_monitor( + void *p_dm_void +); + +void +phydm_ccx_monitor_trigger( + void *p_dm_void, + u16 monitor_time +); + +void +phydm_ccx_monitor_result( + void *p_dm_void +); + +void +phydm_set_clm_mntr_mode( + void *p_dm_void, + enum clm_monitor_mode_e mode +); + +void +phydm_env_monitor_init( + void *p_dm_void +); + +void +phydm_clm_dbg( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.c index a5317963371f..161fafd3b8d5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.c @@ -1,381 +1,381 @@ -/****************************************************************************** - * - * 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 "mp_precomp.h" -#include "phydm_precomp.h" - -VOID -odm_SetCrystalCap( - IN PVOID pDM_VOID, - IN u1Byte CrystalCap -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); - - if(pCfoTrack->CrystalCap == CrystalCap) - return; - - pCfoTrack->CrystalCap = CrystalCap; - - if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8188F)) { - /* write 0x24[22:17] = 0x24[16:11] = CrystalCap */ - CrystalCap = CrystalCap & 0x3F; - ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x007ff800, (CrystalCap|(CrystalCap << 6))); - } else if (pDM_Odm->SupportICType & ODM_RTL8812) { - /* write 0x2C[30:25] = 0x2C[24:19] = CrystalCap */ - CrystalCap = CrystalCap & 0x3F; - ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x7FF80000, (CrystalCap|(CrystalCap << 6))); - } else if ((pDM_Odm->SupportICType & (ODM_RTL8703B|ODM_RTL8723B|ODM_RTL8192E|ODM_RTL8821))) { - /* 0x2C[23:18] = 0x2C[17:12] = CrystalCap */ - CrystalCap = CrystalCap & 0x3F; - ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x00FFF000, (CrystalCap|(CrystalCap << 6))); - } else if (pDM_Odm->SupportICType & ODM_RTL8814A) { - /* write 0x2C[26:21] = 0x2C[20:15] = CrystalCap */ - CrystalCap = CrystalCap & 0x3F; - ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0x07FF8000, (CrystalCap|(CrystalCap << 6))); - } else if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { - /* write 0x24[30:25] = 0x28[6:1] = CrystalCap */ - CrystalCap = CrystalCap & 0x3F; - ODM_SetBBReg(pDM_Odm, REG_AFE_XTAL_CTRL, 0x7e000000, CrystalCap); - ODM_SetBBReg(pDM_Odm, REG_AFE_PLL_CTRL, 0x7e, CrystalCap); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): Use default setting.\n")); - ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap|(CrystalCap << 6))); - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("odm_SetCrystalCap(): CrystalCap = 0x%x\n", CrystalCap)); -#endif -} - -u1Byte -odm_GetDefaultCrytaltalCap( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte CrystalCap = 0x20; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - CrystalCap = pHalData->CrystalCap; -#else - prtl8192cd_priv priv = pDM_Odm->priv; - - if(priv->pmib->dot11RFEntry.xcap > 0) - CrystalCap = priv->pmib->dot11RFEntry.xcap; -#endif - - CrystalCap = CrystalCap & 0x3f; - - return CrystalCap; -} - -VOID -odm_SetATCStatus( - IN PVOID pDM_VOID, - IN BOOLEAN ATCStatus -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); - - if(pCfoTrack->bATCStatus == ATCStatus) - return; - - ODM_SetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm), ATCStatus); - pCfoTrack->bATCStatus = ATCStatus; -} - -BOOLEAN -odm_GetATCStatus( - IN PVOID pDM_VOID -) -{ - BOOLEAN ATCStatus; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ATCStatus = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG(BB_ATC,pDM_Odm), ODM_BIT(BB_ATC,pDM_Odm)); - return ATCStatus; -} - -VOID -ODM_CfoTrackingReset( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); - - pCfoTrack->DefXCap = odm_GetDefaultCrytaltalCap(pDM_Odm); - pCfoTrack->bAdjust = TRUE; - - if(pCfoTrack->CrystalCap > pCfoTrack->DefXCap) - { - odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap - 1); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, - ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); - } else if (pCfoTrack->CrystalCap < pCfoTrack->DefXCap) - { - odm_SetCrystalCap(pDM_Odm, pCfoTrack->CrystalCap + 1); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, - ("ODM_CfoTrackingReset(): approch default value (0x%x)\n", pCfoTrack->CrystalCap)); - } - - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - odm_SetATCStatus(pDM_Odm, TRUE); - #endif -} - -VOID -ODM_CfoTrackingInit( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); - - pCfoTrack->DefXCap = pCfoTrack->CrystalCap = odm_GetDefaultCrytaltalCap(pDM_Odm); - pCfoTrack->bATCStatus = odm_GetATCStatus(pDM_Odm); - pCfoTrack->bAdjust = TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init()=========>\n")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking_init(): bATCStatus = %d, CrystalCap = 0x%x\n", pCfoTrack->bATCStatus, pCfoTrack->DefXCap)); - -#if RTL8822B_SUPPORT - /* Crystal cap. control by WiFi */ - if (pDM_Odm->SupportICType & ODM_RTL8822B) - ODM_SetBBReg(pDM_Odm, 0x10, 0x40, 0x1); -#endif - -#if RTL8821C_SUPPORT - /* Crystal cap. control by WiFi */ - if (pDM_Odm->SupportICType & ODM_RTL8821C) - ODM_SetBBReg(pDM_Odm, 0x10, 0x40, 0x1); -#endif -} - -VOID -ODM_CfoTracking( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); - s4Byte CFO_ave = 0; - u4Byte CFO_rpt_sum, CFO_kHz_avg[4] = {0}; - s4Byte CFO_ave_diff; - s1Byte CrystalCap = pCfoTrack->CrystalCap; - u1Byte Adjust_Xtal = 1, i, valid_path_cnt = 0; - - //4 Support ability - if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Return: SupportAbility ODM_BB_CFO_TRACKING is disabled\n")); - return; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking()=========> \n")); - - if(!pDM_Odm->bLinked || !pDM_Odm->bOneEntryOnly) - { - //4 No link or more than one entry - ODM_CfoTrackingReset(pDM_Odm); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Reset: bLinked = %d, bOneEntryOnly = %d\n", - pDM_Odm->bLinked, pDM_Odm->bOneEntryOnly)); - } - else - { - //3 1. CFO Tracking - //4 1.1 No new packet - if(pCfoTrack->packetCount == pCfoTrack->packetCount_pre) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): packet counter doesn't change\n")); - return; - } - pCfoTrack->packetCount_pre = pCfoTrack->packetCount; - - //4 1.2 Calculate CFO - for (i = 0; i < pDM_Odm->num_rf_path; i++) { - - if (pCfoTrack->CFO_cnt[i] == 0) - continue; - - valid_path_cnt++; - CFO_rpt_sum = (u4Byte)((pCfoTrack->CFO_tail[i] < 0) ? (0 - pCfoTrack->CFO_tail[i]) : pCfoTrack->CFO_tail[i]); - CFO_kHz_avg[i] = CFO_HW_RPT_2_MHZ(CFO_rpt_sum) / pCfoTrack->CFO_cnt[i]; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("[Path %d] CFO_rpt_sum = (( %d )), CFO_cnt = (( %d )) , CFO_avg= (( %s%d )) kHz\n", - i, CFO_rpt_sum, pCfoTrack->CFO_cnt[i],((pCfoTrack->CFO_tail[i] < 0) ? "-" : " ") ,CFO_kHz_avg[i])); - } - - for (i = 0; i < valid_path_cnt; i++) { - - //ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("path [%d], pCfoTrack->CFO_tail = %d\n", i, pCfoTrack->CFO_tail[i])); - if (pCfoTrack->CFO_tail[i] < 0) { - CFO_ave += (0-(s4Byte)CFO_kHz_avg[i]); - //ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("CFO_ave = %d\n", CFO_ave)); - } - else - CFO_ave += (s4Byte)CFO_kHz_avg[i]; - } - - if (valid_path_cnt >= 2) - CFO_ave = CFO_ave / valid_path_cnt; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("valid_path_cnt = ((%d)), CFO_ave = ((%d kHz))\n", valid_path_cnt, CFO_ave)); - - /*reset counter*/ - for (i = 0; i < pDM_Odm->num_rf_path; i++) { - pCfoTrack->CFO_tail[i] = 0; - pCfoTrack->CFO_cnt[i] = 0; - } - - //4 1.3 Avoid abnormal large CFO - CFO_ave_diff = (pCfoTrack->CFO_ave_pre >= CFO_ave)?(pCfoTrack->CFO_ave_pre - CFO_ave):(CFO_ave - pCfoTrack->CFO_ave_pre); - if(CFO_ave_diff > 20 && pCfoTrack->largeCFOHit == 0 && !pCfoTrack->bAdjust) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): first large CFO hit\n")); - pCfoTrack->largeCFOHit = 1; - return; - } - else - pCfoTrack->largeCFOHit = 0; - pCfoTrack->CFO_ave_pre = CFO_ave; - - //4 1.4 Dynamic Xtal threshold - if(pCfoTrack->bAdjust == FALSE) - { - if(CFO_ave > CFO_TH_XTAL_HIGH || CFO_ave < (-CFO_TH_XTAL_HIGH)) - pCfoTrack->bAdjust = TRUE; - } - else - { - if(CFO_ave < CFO_TH_XTAL_LOW && CFO_ave > (-CFO_TH_XTAL_LOW)) - pCfoTrack->bAdjust = FALSE; - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - //4 1.5 BT case: Disable CFO tracking - if(pDM_Odm->bBtEnabled) - { - pCfoTrack->bAdjust = FALSE; - odm_SetCrystalCap(pDM_Odm, pCfoTrack->DefXCap); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable CFO tracking for BT!!\n")); - } -/* - //4 1.6 Big jump - if(pCfoTrack->bAdjust) - { - if(CFO_ave > CFO_TH_XTAL_LOW) - Adjust_Xtal = Adjust_Xtal + ((CFO_ave - CFO_TH_XTAL_LOW) >> 2); - else if(CFO_ave < (-CFO_TH_XTAL_LOW)) - Adjust_Xtal = Adjust_Xtal + ((CFO_TH_XTAL_LOW - CFO_ave) >> 2); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap offset = %d\n", Adjust_Xtal)); - } -*/ -#endif - - //4 1.7 Adjust Crystal Cap. - if(pCfoTrack->bAdjust) - { - if(CFO_ave > CFO_TH_XTAL_LOW) - CrystalCap = CrystalCap + Adjust_Xtal; - else if(CFO_ave < (-CFO_TH_XTAL_LOW)) - CrystalCap = CrystalCap - Adjust_Xtal; - - if(CrystalCap > 0x3f) - CrystalCap = 0x3f; - else if (CrystalCap < 0) - CrystalCap = 0; - - odm_SetCrystalCap(pDM_Odm, (u1Byte)CrystalCap); - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Crystal cap = 0x%x, Default Crystal cap = 0x%x\n", - pCfoTrack->CrystalCap, pCfoTrack->DefXCap)); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - return; - - //3 2. Dynamic ATC switch - if(CFO_ave < CFO_TH_ATC && CFO_ave > -CFO_TH_ATC) - { - odm_SetATCStatus(pDM_Odm, FALSE); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Disable ATC!!\n")); - } - else - { - odm_SetATCStatus(pDM_Odm, TRUE); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("ODM_CfoTracking(): Enable ATC!!\n")); - } -#endif - } -} - -VOID -ODM_ParsingCFO( - IN PVOID pDM_VOID, - IN PVOID pPktinfo_VOID, - IN s1Byte* pcfotail, - IN u1Byte num_ss - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_PACKET_INFO_T pPktinfo = (PODM_PACKET_INFO_T)pPktinfo_VOID; - PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); - u1Byte i; - - if(!(pDM_Odm->SupportAbility & ODM_BB_CFO_TRACKING)) - return; - -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(pPktinfo->bPacketMatchBSSID) -#else - if(pPktinfo->StationID != 0) -#endif - { - if (num_ss > pDM_Odm->num_rf_path) /*For fool proof*/ - num_ss = pDM_Odm->num_rf_path; - - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("num_ss = ((%d)), pDM_Odm->num_rf_path = ((%d))\n", num_ss, pDM_Odm->num_rf_path));*/ - - - //3 Update CFO report for path-A & path-B - // Only paht-A and path-B have CFO tail and short CFO - for(i = 0; i < num_ss; i++) - { - pCfoTrack->CFO_tail[i] += pcfotail[i]; - pCfoTrack->CFO_cnt[i] ++; - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_CFO_TRACKING, ODM_DBG_LOUD, ("[ID %d][path %d][Rate 0x%x] CFO_tail = ((%d)), CFO_tail_sum = ((%d)), CFO_cnt = ((%d))\n", - pPktinfo->StationID, i, pPktinfo->DataRate, pcfotail[i], pCfoTrack->CFO_tail[i], pCfoTrack->CFO_cnt[i])); - */ - } - - //3 Update packet counter - if(pCfoTrack->packetCount == 0xffffffff) - pCfoTrack->packetCount = 0; - else - pCfoTrack->packetCount++; - } -} - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +void +phydm_set_crystal_cap( + void *p_dm_void, + u8 crystal_cap +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + + if (p_cfo_track->crystal_cap == crystal_cap) + return; + + crystal_cap = crystal_cap & 0x3F; + p_cfo_track->crystal_cap = crystal_cap; + + if (p_dm->support_ic_type & (ODM_RTL8188E | ODM_RTL8188F)) { + #if (RTL8188E_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) + /* write 0x24[22:17] = 0x24[16:11] = crystal_cap */ + odm_set_bb_reg(p_dm, REG_AFE_XTAL_CTRL, 0x007ff800, (crystal_cap | (crystal_cap << 6))); + #endif + } + #if (RTL8812A_SUPPORT == 1) + else if (p_dm->support_ic_type & ODM_RTL8812) { + + /* write 0x2C[30:25] = 0x2C[24:19] = crystal_cap */ + odm_set_bb_reg(p_dm, REG_MAC_PHY_CTRL, 0x7FF80000, (crystal_cap | (crystal_cap << 6))); + + } + #endif + #if (RTL8703B_SUPPORT == 1) || (RTL8723B_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) + else if ((p_dm->support_ic_type & (ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8192E | ODM_RTL8821 | ODM_RTL8723D))) { + + /* 0x2C[23:18] = 0x2C[17:12] = crystal_cap */ + odm_set_bb_reg(p_dm, REG_MAC_PHY_CTRL, 0x00FFF000, (crystal_cap | (crystal_cap << 6))); + + } + #endif + #if (RTL8814A_SUPPORT == 1) + else if (p_dm->support_ic_type & ODM_RTL8814A) { + + /* write 0x2C[26:21] = 0x2C[20:15] = crystal_cap */ + odm_set_bb_reg(p_dm, REG_MAC_PHY_CTRL, 0x07FF8000, (crystal_cap | (crystal_cap << 6))); + + } + #endif + #if (RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) + else if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8197F)) { + + /* write 0x24[30:25] = 0x28[6:1] = crystal_cap */ + odm_set_bb_reg(p_dm, REG_AFE_XTAL_CTRL, 0x7e000000, crystal_cap); + odm_set_bb_reg(p_dm, REG_AFE_PLL_CTRL, 0x7e, crystal_cap); + + } + #endif + #if (RTL8710B_SUPPORT == 1) + else if (p_dm->support_ic_type & (ODM_RTL8710B)) { + + #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + /* write 0x60[29:24] = 0x60[23:18] = crystal_cap */ + HAL_SetSYSOnReg(p_dm->adapter, REG_SYS_XTAL_CTRL0, 0x3FFC0000, (crystal_cap | (crystal_cap << 6))); + #endif + } + #endif + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("Set rystal_cap = 0x%x\n", p_cfo_track->crystal_cap)); + +} + +u8 +odm_get_default_crytaltal_cap( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 crystal_cap = 0x20; + +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + struct rtl_efuse *rtlefuse = rtl_efuse(rtlpriv); + + crystal_cap = rtlefuse->crystalcap; +#elif (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + crystal_cap = p_hal_data->crystal_cap; +#else + struct rtl8192cd_priv *priv = p_dm->priv; + + if (priv->pmib->dot11RFEntry.xcap > 0) + crystal_cap = priv->pmib->dot11RFEntry.xcap; +#endif + + crystal_cap = crystal_cap & 0x3f; + + return crystal_cap; +} + +void +odm_set_atc_status( + void *p_dm_void, + boolean atc_status +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + + if (p_cfo_track->is_atc_status == atc_status) + return; + + odm_set_bb_reg(p_dm, ODM_REG(BB_ATC, p_dm), ODM_BIT(BB_ATC, p_dm), atc_status); + p_cfo_track->is_atc_status = atc_status; +} + +boolean +odm_get_atc_status( + void *p_dm_void +) +{ + boolean atc_status; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + atc_status = (boolean)odm_get_bb_reg(p_dm, ODM_REG(BB_ATC, p_dm), ODM_BIT(BB_ATC, p_dm)); + return atc_status; +} + +void +odm_cfo_tracking_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + + p_cfo_track->def_x_cap = odm_get_default_crytaltal_cap(p_dm); + p_cfo_track->is_adjust = true; + + if (p_cfo_track->crystal_cap > p_cfo_track->def_x_cap) { + phydm_set_crystal_cap(p_dm, p_cfo_track->crystal_cap - 1); + PHYDM_DBG(p_dm, DBG_CFO_TRK, + ("odm_cfo_tracking_reset(): approch default value (0x%x)\n", p_cfo_track->crystal_cap)); + } else if (p_cfo_track->crystal_cap < p_cfo_track->def_x_cap) { + phydm_set_crystal_cap(p_dm, p_cfo_track->crystal_cap + 1); + PHYDM_DBG(p_dm, DBG_CFO_TRK, + ("odm_cfo_tracking_reset(): approch default value (0x%x)\n", p_cfo_track->crystal_cap)); + } + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + odm_set_atc_status(p_dm, true); +#endif +} + +void +phydm_cfo_tracking_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + + p_cfo_track->def_x_cap = p_cfo_track->crystal_cap = odm_get_default_crytaltal_cap(p_dm); + p_cfo_track->is_atc_status = odm_get_atc_status(p_dm); + p_cfo_track->is_adjust = true; + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("ODM_CfoTracking_init()=========>\n")); + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("ODM_CfoTracking_init(): is_atc_status = %d, crystal_cap = 0x%x\n", p_cfo_track->is_atc_status, p_cfo_track->def_x_cap)); + +#if RTL8822B_SUPPORT + /* Crystal cap. control by WiFi */ + if (p_dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(p_dm, 0x10, 0x40, 0x1); +#endif + +#if RTL8821C_SUPPORT + /* Crystal cap. control by WiFi */ + if (p_dm->support_ic_type & ODM_RTL8821C) + odm_set_bb_reg(p_dm, 0x10, 0x40, 0x1); +#endif +} + +void +odm_cfo_tracking( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + s32 CFO_ave = 0; + u32 CFO_rpt_sum, cfo_khz_avg[4] = {0}; + s32 CFO_ave_diff; + s8 crystal_cap = p_cfo_track->crystal_cap; + u8 adjust_xtal = 1, i, valid_path_cnt = 0; + + /* 4 Support ability */ + if (!(p_dm->support_ability & ODM_BB_CFO_TRACKING)) { + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): Return: support_ability ODM_BB_CFO_TRACKING is disabled\n")); + return; + } + + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking()=========>\n")); + + if (!p_dm->is_linked || !p_dm->is_one_entry_only) { + /* 4 No link or more than one entry */ + odm_cfo_tracking_reset(p_dm); + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): Reset: is_linked = %d, is_one_entry_only = %d\n", + p_dm->is_linked, p_dm->is_one_entry_only)); + } else { + /* 3 1. CFO Tracking */ + /* 4 1.1 No new packet */ + if (p_cfo_track->packet_count == p_cfo_track->packet_count_pre) { + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): packet counter doesn't change\n")); + return; + } + p_cfo_track->packet_count_pre = p_cfo_track->packet_count; + + /* 4 1.2 Calculate CFO */ + for (i = 0; i < p_dm->num_rf_path; i++) { + + if (p_cfo_track->CFO_cnt[i] == 0) + continue; + + valid_path_cnt++; + CFO_rpt_sum = (u32)((p_cfo_track->CFO_tail[i] < 0) ? (0 - p_cfo_track->CFO_tail[i]) : p_cfo_track->CFO_tail[i]); + cfo_khz_avg[i] = CFO_HW_RPT_2_MHZ(CFO_rpt_sum) / p_cfo_track->CFO_cnt[i]; + + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("[path %d] CFO_rpt_sum = (( %d )), CFO_cnt = (( %d )) , CFO_avg= (( %s%d )) kHz\n", + i, CFO_rpt_sum, p_cfo_track->CFO_cnt[i], ((p_cfo_track->CFO_tail[i] < 0) ? "-" : " "), cfo_khz_avg[i])); + } + + for (i = 0; i < valid_path_cnt; i++) { + + /* PHYDM_DBG(p_dm, DBG_CFO_TRK, ("path [%d], p_cfo_track->CFO_tail = %d\n", i, p_cfo_track->CFO_tail[i])); */ + if (p_cfo_track->CFO_tail[i] < 0) { + CFO_ave += (0 - (s32)cfo_khz_avg[i]); + /* PHYDM_DBG(p_dm, DBG_CFO_TRK, ("CFO_ave = %d\n", CFO_ave)); */ + } else + CFO_ave += (s32)cfo_khz_avg[i]; + } + + if (valid_path_cnt >= 2) + CFO_ave = CFO_ave / valid_path_cnt; + + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("valid_path_cnt = ((%d)), CFO_ave = ((%d kHz))\n", valid_path_cnt, CFO_ave)); + + /*reset counter*/ + for (i = 0; i < p_dm->num_rf_path; i++) { + p_cfo_track->CFO_tail[i] = 0; + p_cfo_track->CFO_cnt[i] = 0; + } + + /* 4 1.3 Avoid abnormal large CFO */ + CFO_ave_diff = (p_cfo_track->CFO_ave_pre >= CFO_ave) ? (p_cfo_track->CFO_ave_pre - CFO_ave) : (CFO_ave - p_cfo_track->CFO_ave_pre); + if (CFO_ave_diff > 20 && p_cfo_track->large_cfo_hit == 0 && !p_cfo_track->is_adjust) { + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): first large CFO hit\n")); + p_cfo_track->large_cfo_hit = 1; + return; + } else + p_cfo_track->large_cfo_hit = 0; + p_cfo_track->CFO_ave_pre = CFO_ave; + + /* 4 1.4 Dynamic Xtal threshold */ + if (p_cfo_track->is_adjust == false) { + if (CFO_ave > CFO_TH_XTAL_HIGH || CFO_ave < (-CFO_TH_XTAL_HIGH)) + p_cfo_track->is_adjust = true; + } else { + if (CFO_ave < CFO_TH_XTAL_LOW && CFO_ave > (-CFO_TH_XTAL_LOW)) + p_cfo_track->is_adjust = false; + } + +#ifdef ODM_CONFIG_BT_COEXIST + /* 4 1.5 BT case: Disable CFO tracking */ + if (p_dm->bt_info_table.is_bt_enabled) { + p_cfo_track->is_adjust = false; + phydm_set_crystal_cap(p_dm, p_cfo_track->def_x_cap); + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): Disable CFO tracking for BT!!\n")); + } +#if 0 + /* 4 1.6 Big jump */ + if (p_cfo_track->is_adjust) { + if (CFO_ave > CFO_TH_XTAL_LOW) + adjust_xtal = adjust_xtal + ((CFO_ave - CFO_TH_XTAL_LOW) >> 2); + else if (CFO_ave < (-CFO_TH_XTAL_LOW)) + adjust_xtal = adjust_xtal + ((CFO_TH_XTAL_LOW - CFO_ave) >> 2); + + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): Crystal cap offset = %d\n", adjust_xtal)); + } +#endif +#endif + /* 4 1.7 Adjust Crystal Cap. */ + if (p_cfo_track->is_adjust) { + if (CFO_ave > CFO_TH_XTAL_LOW) + crystal_cap = crystal_cap + adjust_xtal; + else if (CFO_ave < (-CFO_TH_XTAL_LOW)) + crystal_cap = crystal_cap - adjust_xtal; + + if (crystal_cap > 0x3f) + crystal_cap = 0x3f; + else if (crystal_cap < 0) + crystal_cap = 0; + + phydm_set_crystal_cap(p_dm, (u8)crystal_cap); + } + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): Crystal cap = 0x%x, Default Crystal cap = 0x%x\n", + p_cfo_track->crystal_cap, p_cfo_track->def_x_cap)); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + return; + + /* 3 2. Dynamic ATC switch */ + if (CFO_ave < CFO_TH_ATC && CFO_ave > -CFO_TH_ATC) { + odm_set_atc_status(p_dm, false); + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): Disable ATC!!\n")); + } else { + odm_set_atc_status(p_dm, true); + PHYDM_DBG(p_dm, DBG_CFO_TRK, ("odm_cfo_tracking(): Enable ATC!!\n")); + } +#endif + } +} + +void +odm_parsing_cfo( + void *p_dm_void, + void *p_pktinfo_void, + s8 *pcfotail, + u8 num_ss +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_perpkt_info_struct *p_pktinfo = (struct phydm_perpkt_info_struct *)p_pktinfo_void; + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + u8 i; + + if (!(p_dm->support_ability & ODM_BB_CFO_TRACKING)) + return; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if (p_pktinfo->is_packet_match_bssid) +#else + if (p_pktinfo->station_id != 0) +#endif + { + if (num_ss > p_dm->num_rf_path) /*For fool proof*/ + num_ss = p_dm->num_rf_path; + + /*PHYDM_DBG(p_dm, DBG_CFO_TRK, ("num_ss = ((%d)), p_dm->num_rf_path = ((%d))\n", num_ss, p_dm->num_rf_path));*/ + + + /* 3 Update CFO report for path-A & path-B */ + /* Only paht-A and path-B have CFO tail and short CFO */ + for (i = 0; i < num_ss; i++) { + p_cfo_track->CFO_tail[i] += pcfotail[i]; + p_cfo_track->CFO_cnt[i]++; + /*PHYDM_DBG(p_dm, DBG_CFO_TRK, ("[ID %d][path %d][rate 0x%x] CFO_tail = ((%d)), CFO_tail_sum = ((%d)), CFO_cnt = ((%d))\n", + p_pktinfo->station_id, i, p_pktinfo->data_rate, pcfotail[i], p_cfo_track->CFO_tail[i], p_cfo_track->CFO_cnt[i])); + */ + } + + /* 3 Update packet counter */ + if (p_cfo_track->packet_count == 0xffffffff) + p_cfo_track->packet_count = 0; + else + p_cfo_track->packet_count++; + } +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.h index d5235307efb9..43815f21a6a0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_cfotracking.h @@ -1,70 +1,70 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMCFOTRACK_H__ -#define __PHYDMCFOTRACK_H__ - -#define CFO_TRACKING_VERSION "1.4" /*2015.10.01 Stanley, Modify for 8822B*/ - -#define CFO_TH_XTAL_HIGH 20 // kHz -#define CFO_TH_XTAL_LOW 10 // kHz -#define CFO_TH_ATC 80 // kHz - -typedef struct _CFO_TRACKING_ -{ - BOOLEAN bATCStatus; - BOOLEAN largeCFOHit; - BOOLEAN bAdjust; - u1Byte CrystalCap; - u1Byte DefXCap; - s4Byte CFO_tail[4]; - u4Byte CFO_cnt[4]; - s4Byte CFO_ave_pre; - u4Byte packetCount; - u4Byte packetCount_pre; - - BOOLEAN bForceXtalCap; - BOOLEAN bReset; -}CFO_TRACKING, *PCFO_TRACKING; - -VOID -ODM_CfoTrackingReset( - IN PVOID pDM_VOID -); - -VOID -ODM_CfoTrackingInit( - IN PVOID pDM_VOID -); - -VOID -ODM_CfoTracking( - IN PVOID pDM_VOID -); - -VOID -ODM_ParsingCFO( - IN PVOID pDM_VOID, - IN PVOID pPktinfo_VOID, - IN s1Byte* pcfotail, - IN u1Byte num_ss -); - -#endif \ No newline at end of file +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMCFOTRACK_H__ +#define __PHYDMCFOTRACK_H__ + +#define CFO_TRACKING_VERSION "1.4" /*2015.10.01 Stanley, Modify for 8822B*/ + +#define CFO_TH_XTAL_HIGH 20 /* kHz */ +#define CFO_TH_XTAL_LOW 10 /* kHz */ +#define CFO_TH_ATC 80 /* kHz */ + +struct phydm_cfo_track_struct { + boolean is_atc_status; + boolean large_cfo_hit; + boolean is_adjust; + u8 crystal_cap; + u8 def_x_cap; + s32 CFO_tail[4]; + u32 CFO_cnt[4]; + s32 CFO_ave_pre; + u32 packet_count; + u32 packet_count_pre; + + boolean is_force_xtal_cap; + boolean is_reset; +}; + +void +phydm_set_crystal_cap( + void *p_dm_void, + u8 crystal_cap +); + +void +odm_cfo_tracking_reset( + void *p_dm_void +); + +void +phydm_cfo_tracking_init( + void *p_dm_void +); + +void +odm_cfo_tracking( + void *p_dm_void +); + +void +odm_parsing_cfo( + void *p_dm_void, + void *p_pktinfo_void, + s8 *pcfotail, + u8 num_ss +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.c index 5c265f2df963..8bb4faf40b50 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.c @@ -1,3015 +1,3265 @@ -/****************************************************************************** - * - * 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 files -//============================================================ - -#include "mp_precomp.h" -#include "phydm_precomp.h" - -VOID -PHYDM_InitDebugSetting( - IN PDM_ODM_T pDM_Odm -) -{ - pDM_Odm->DebugLevel = ODM_DBG_TRACE; - - pDM_Odm->fw_DebugComponents = 0; - pDM_Odm->DebugComponents = - \ -#if DBG -/*BB Functions*/ -/* ODM_COMP_DIG |*/ -/* ODM_COMP_RA_MASK |*/ -/* ODM_COMP_DYNAMIC_TXPWR |*/ -/* ODM_COMP_FA_CNT |*/ -/* ODM_COMP_RSSI_MONITOR |*/ -/* ODM_COMP_SNIFFER |*/ -/* ODM_COMP_ANT_DIV |*/ -/* ODM_COMP_NOISY_DETECT |*/ -/* ODM_COMP_RATE_ADAPTIVE |*/ -/* ODM_COMP_PATH_DIV |*/ -/* ODM_COMP_DYNAMIC_PRICCA |*/ -/* ODM_COMP_MP |*/ -/* ODM_COMP_CFO_TRACKING |*/ -/* ODM_COMP_ACS |*/ -/* PHYDM_COMP_ADAPTIVITY |*/ -/* PHYDM_COMP_RA_DBG |*/ -/* PHYDM_COMP_TXBF |*/ - -/*MAC Functions*/ -/* ODM_COMP_EDCA_TURBO |*/ -/* ODM_FW_DEBUG_TRACE |*/ - -/*RF Functions*/ -/* ODM_COMP_TX_PWR_TRACK |*/ -/* ODM_COMP_CALIBRATION |*/ - -/*Common*/ -/* ODM_PHY_CONFIG |*/ -/* ODM_COMP_INIT |*/ -/* ODM_COMP_COMMON |*/ -/* ODM_COMP_API |*/ - - -#endif - 0; - - pDM_Odm->fw_buff_is_enpty = TRUE; - pDM_Odm->pre_c2h_seq = 0; -} - -VOID -phydm_BB_RxHang_Info( - IN PVOID pDM_VOID, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - u4Byte value32 = 0; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - return; - - value32 = ODM_GetBBReg(pDM_Odm, 0xF80 , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rptreg of sc/bw/ht/...", value32)); - - if (pDM_Odm->SupportICType & ODM_RTL8822B) - ODM_SetBBReg(pDM_Odm, 0x198c , BIT2|BIT1|BIT0, 7); - - /* dbg_port = basic state machine */ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x000); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "basic state machine", value32)); - } - - /* dbg_port = state machine */ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x007); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "state machine", value32)); - } - - /* dbg_port = CCA-related*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x204); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "CCA-related", value32)); - } - - - /* dbg_port = edcca/rxd*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x278); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "edcca/rxd", value32)); - } - - /* dbg_port = rx_state/mux_state/ADC_MASK_OFDM*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x290); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx_state/mux_state/ADC_MASK_OFDM", value32)); - } - - /* dbg_port = bf-related*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B2); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); - } - - /* dbg_port = bf-related*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0x2B8); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "bf-related", value32)); - } - - /* dbg_port = txon/rxd*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA03); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "txon/rxd", value32)); - } - - /* dbg_port = l_rate/l_length*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0B); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "l_rate/l_length", value32)); - } - - /* dbg_port = rxd/rxd_hit*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xA0D); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rxd/rxd_hit", value32)); - } - - /* dbg_port = dis_cca*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAA0); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "dis_cca", value32)); - } - - - /* dbg_port = tx*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAB0); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "tx", value32)); - } - - /* dbg_port = rx plcp*/ - { - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD0); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); - - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD1); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); - - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD2); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); - - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord, 0xAD3); - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "0x8fc", value32)); - - value32 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = 0x%x", "rx plcp", value32)); - } - -} - -VOID -phydm_BB_Debug_Info( - IN PVOID pDM_VOID, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - char *tmp_string = NULL; - - u1Byte RX_HT_BW, RX_VHT_BW, RXSC, RX_HT, RX_BW; - static u1Byte vRX_BW ; - u4Byte value32, value32_1, value32_2, value32_3; - s4Byte SFO_A, SFO_B, SFO_C, SFO_D; - s4Byte LFO_A, LFO_B, LFO_C, LFO_D; - static u1Byte MCSS, Tail, Parity, rsv, vrsv, idx, smooth, htsound, agg, stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, vNsts, vtxops, vrsv2, vbrsv, bf, vbcrc; - static u2Byte HLength, htcrc8, Length; - static u2Byte vpaid; - static u2Byte vLength, vhtcrc8, vMCSS, vTail, vbTail; - static u1Byte HMCSS, HRX_BW; - - u1Byte pwDB; - s1Byte RXEVM_0, RXEVM_1, RXEVM_2 ; - u1Byte RF_gain_pathA, RF_gain_pathB, RF_gain_pathC, RF_gain_pathD; - u1Byte RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD; - s4Byte sig_power; - - const char *L_rate[8] = {"6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M"}; - - /* - const double evm_comp_20M = 0.579919469776867; //10*log10(64.0/56.0) - const double evm_comp_40M = 0.503051183113957; //10*log10(128.0/114.0) - const double evm_comp_80M = 0.244245993314183; //10*log10(256.0/242.0) - const double evm_comp_160M = 0.244245993314183; //10*log10(512.0/484.0) - */ - - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - return; - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s\n", "BB Report Info")); - - /*BW & Mode Detection*/ - - value32 = ODM_GetBBReg(pDM_Odm, 0xf80 , bMaskDWord); - value32_2 = value32; - RX_HT_BW = (u1Byte)(value32 & 0x1); - RX_VHT_BW = (u1Byte)((value32 >> 1) & 0x3); - RXSC = (u1Byte)(value32 & 0x78); - value32_1 = (value32 & 0x180) >> 7; - RX_HT = (u1Byte)(value32_1); - - RX_BW = 0; - - if (RX_HT == 2) { - if (RX_VHT_BW == 0) { - tmp_string = "20M"; - } else if (RX_VHT_BW == 1) { - tmp_string = "40M"; - } else { - tmp_string = "80M"; - } - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "Mode", "VHT", tmp_string)); - RX_BW = RX_VHT_BW; - } else if (RX_HT == 1) { - if (RX_HT_BW == 0) { - tmp_string = "20M"; - } else if (RX_HT_BW == 1) { - tmp_string = "40M"; - } - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "Mode", "HT", tmp_string)); - RX_BW = RX_HT_BW; - } else { - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s", "Mode", "Legacy")); - } - - if (RX_HT != 0) { - if (RXSC == 0) - tmp_string = "duplicate/full bw"; - else if (RXSC == 1) - tmp_string = "usc20-1"; - else if (RXSC == 2) - tmp_string = "lsc20-1"; - else if (RXSC == 3) - tmp_string = "usc20-2"; - else if (RXSC == 4) - tmp_string = "lsc20-2"; - else if (RXSC == 9) - tmp_string = "usc40"; - else if (RXSC == 10) - tmp_string = "lsc40"; - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s", tmp_string)); - } - - /* RX signal power and AGC related info*/ - - value32 = ODM_GetBBReg(pDM_Odm, 0xF90 , bMaskDWord); - pwDB = (u1Byte)((value32 & bMaskByte1) >> 8); - pwDB = pwDB >> 1; - sig_power = -110 + pwDB; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM RX Signal Power(dB)", sig_power)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); - RX_SNR_pathA = (u1Byte)(value32 & 0xFF) >> 1; - RF_gain_pathA = (s1Byte)((value32 & bMaskByte1) >> 8); - RF_gain_pathA *= 2; - value32 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); - RX_SNR_pathB = (u1Byte)(value32 & 0xFF) >> 1; - RF_gain_pathB = (s1Byte)((value32 & bMaskByte1) >> 8); - RF_gain_pathB *= 2; - value32 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); - RX_SNR_pathC = (u1Byte)(value32 & 0xFF) >> 1; - RF_gain_pathC = (s1Byte)((value32 & bMaskByte1) >> 8); - RF_gain_pathC *= 2; - value32 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); - RX_SNR_pathD = (u1Byte)(value32 & 0xFF) >> 1; - RF_gain_pathD = (s1Byte)((value32 & bMaskByte1) >> 8); - RF_gain_pathD *= 2; - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", RF_gain_pathA, RF_gain_pathB, RF_gain_pathC, RF_gain_pathD)); - - - /* RX Counter related info*/ - - value32 = ODM_GetBBReg(pDM_Odm, 0xF08, bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM CCA Counter", ((value32&0xFFFF0000)>>16))); - - value32 = ODM_GetBBReg(pDM_Odm, 0xFD0, bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM SBD Fail Counter", value32&0xFFFF)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xFC4, bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); - - value32 = ODM_GetBBReg(pDM_Odm, 0xFCC, bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "CCK CCA Counter", value32&0xFFFF)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xFBC, bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "LSIG (Parity Fail/Rate Illegal) Counter", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); - - value32_1 = ODM_GetBBReg(pDM_Odm, 0xFC8, bMaskDWord); - value32_2 = ODM_GetBBReg(pDM_Odm, 0xFC0, bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT counter", ((value32_2&0xFFFF0000)>>16), value32_1&0xFFFF)); - - /* PostFFT related info*/ - value32 = ODM_GetBBReg(pDM_Odm, 0xF8c , bMaskDWord); - RXEVM_0 = (s1Byte)((value32 & bMaskByte2) >> 16); - RXEVM_0 /= 2; - if (RXEVM_0 < -63) - RXEVM_0 = 0; - - RXEVM_1 = (s1Byte)((value32 & bMaskByte3) >> 24); - RXEVM_1 /= 2; - value32 = ODM_GetBBReg(pDM_Odm, 0xF88 , bMaskDWord); - RXEVM_2 = (s1Byte)((value32 & bMaskByte2) >> 16); - RXEVM_2 /= 2; - - if (RXEVM_1 < -63) - RXEVM_1 = 0; - if (RXEVM_2 < -63) - RXEVM_2 = 0; - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d", "RXEVM (1ss/2ss/3ss)", RXEVM_0, RXEVM_1, RXEVM_2)); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D, dB)", RX_SNR_pathA, RX_SNR_pathB, RX_SNR_pathC, RX_SNR_pathD)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xF8C , bMaskDWord); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "CSI_1st /CSI_2nd", value32&0xFFFF, ((value32&0xFFFF0000)>>16))); - - /*BW & Mode Detection*/ - - /*Reset Page F Counter*/ - ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 1); - ODM_SetBBReg(pDM_Odm, 0xB58 , BIT0, 0); - - /*CFO Report Info*/ - /*Short CFO*/ - value32 = ODM_GetBBReg(pDM_Odm, 0xd0c , bMaskDWord); - value32_1 = ODM_GetBBReg(pDM_Odm, 0xd4c , bMaskDWord); - value32_2 = ODM_GetBBReg(pDM_Odm, 0xd8c , bMaskDWord); - value32_3 = ODM_GetBBReg(pDM_Odm, 0xdcc , bMaskDWord); - - SFO_A = (s4Byte)(value32 & 0xfff); - SFO_B = (s4Byte)(value32_1 & 0xfff); - SFO_C = (s4Byte)(value32_2 & 0xfff); - SFO_D = (s4Byte)(value32_3 & 0xfff); - - LFO_A = (s4Byte)(value32 >> 16); - LFO_B = (s4Byte)(value32_1 >> 16); - LFO_C = (s4Byte)(value32_2 >> 16); - LFO_D = (s4Byte)(value32_3 >> 16); - - /*SFO 2's to dec*/ - if (SFO_A > 2047) - SFO_A = SFO_A - 4096; - SFO_A = (SFO_A * 312500) / 2048; - if (SFO_B > 2047) - SFO_B = SFO_B - 4096; - SFO_B = (SFO_B * 312500) / 2048; - if (SFO_C > 2047) - SFO_C = SFO_C - 4096; - SFO_C = (SFO_C * 312500) / 2048; - if (SFO_D > 2047) - SFO_D = SFO_D - 4096; - SFO_D = (SFO_D * 312500) / 2048; - - /*LFO 2's to dec*/ - - if (LFO_A > 4095) - LFO_A = LFO_A - 8192; - - if (LFO_B > 4095) - LFO_B = LFO_B - 8192; - - if (LFO_C > 4095) - LFO_C = LFO_C - 8192; - - if (LFO_D > 4095) - LFO_D = LFO_D - 8192; - LFO_A = LFO_A * 312500 / 4096; - LFO_B = LFO_B * 312500 / 4096; - LFO_C = LFO_C * 312500 / 4096; - LFO_D = LFO_D * 312500 / 4096; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "CFO Report Info")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Short CFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Long CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); - - /*SCFO*/ - value32 = ODM_GetBBReg(pDM_Odm, 0xd10 , bMaskDWord); - value32_1 = ODM_GetBBReg(pDM_Odm, 0xd50 , bMaskDWord); - value32_2 = ODM_GetBBReg(pDM_Odm, 0xd90 , bMaskDWord); - value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd0 , bMaskDWord); - - SFO_A = (s4Byte)(value32 & 0x7ff); - SFO_B = (s4Byte)(value32_1 & 0x7ff); - SFO_C = (s4Byte)(value32_2 & 0x7ff); - SFO_D = (s4Byte)(value32_3 & 0x7ff); - - if (SFO_A > 1023) - SFO_A = SFO_A - 2048; - - if (SFO_B > 2047) - SFO_B = SFO_B - 4096; - - if (SFO_C > 2047) - SFO_C = SFO_C - 4096; - - if (SFO_D > 2047) - SFO_D = SFO_D - 4096; - - SFO_A = SFO_A * 312500 / 1024; - SFO_B = SFO_B * 312500 / 1024; - SFO_C = SFO_C * 312500 / 1024; - SFO_D = SFO_D * 312500 / 1024; - - LFO_A = (s4Byte)(value32 >> 16); - LFO_B = (s4Byte)(value32_1 >> 16); - LFO_C = (s4Byte)(value32_2 >> 16); - LFO_D = (s4Byte)(value32_3 >> 16); - - if (LFO_A > 4095) - LFO_A = LFO_A - 8192; - - if (LFO_B > 4095) - LFO_B = LFO_B - 8192; - - if (LFO_C > 4095) - LFO_C = LFO_C - 8192; - - if (LFO_D > 4095) - LFO_D = LFO_D - 8192; - LFO_A = LFO_A * 312500 / 4096; - LFO_B = LFO_B * 312500 / 4096; - LFO_C = LFO_C * 312500 / 4096; - LFO_D = LFO_D * 312500 / 4096; - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Value SCFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "ACQ CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xd14 , bMaskDWord); - value32_1 = ODM_GetBBReg(pDM_Odm, 0xd54 , bMaskDWord); - value32_2 = ODM_GetBBReg(pDM_Odm, 0xd94 , bMaskDWord); - value32_3 = ODM_GetBBReg(pDM_Odm, 0xdd4 , bMaskDWord); - - LFO_A = (s4Byte)(value32 >> 16); - LFO_B = (s4Byte)(value32_1 >> 16); - LFO_C = (s4Byte)(value32_2 >> 16); - LFO_D = (s4Byte)(value32_3 >> 16); - - if (LFO_A > 4095) - LFO_A = LFO_A - 8192; - - if (LFO_B > 4095) - LFO_B = LFO_B - 8192; - - if (LFO_C > 4095) - LFO_C = LFO_C - 8192; - - if (LFO_D > 4095) - LFO_D = LFO_D - 8192; - - LFO_A = LFO_A * 312500 / 4096; - LFO_B = LFO_B * 312500 / 4096; - LFO_C = LFO_C * 312500 / 4096; - LFO_D = LFO_D * 312500 / 4096; - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "End CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xf20 , bMaskDWord); /*L SIG*/ - - Tail = (u1Byte)((value32 & 0xfc0000) >> 16); - Parity = (u1Byte)((value32 & 0x20000) >> 16); - Length = (u2Byte)((value32 & 0x1ffe00) >> 8); - rsv = (u1Byte)(value32 & 0x10); - MCSS = (u1Byte)(value32 & 0x0f); - - switch (MCSS) { - case 0x0b: - idx = 0; - break; - case 0x0f: - idx = 1; - break; - case 0x0a: - idx = 2; - break; - case 0x0e: - idx = 3; - break; - case 0x09: - idx = 4; - break; - case 0x08: - idx = 5; - break; - case 0x0c: - idx = 6; - break; - default: - idx = 6; - break; - - } - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "L-SIG")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s : %s", "Rate", L_rate[idx])); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "Rsv/Length/Parity", rsv, RX_BW, Length)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*HT SIG*/ - if (RX_HT == 1) { - - HMCSS = (u1Byte)(value32 & 0x7F); - HRX_BW = (u1Byte)(value32 & 0x80); - HLength = (u2Byte)((value32 >> 8) & 0xffff); - } - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG1")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "MCS/BW/Length", HMCSS, HRX_BW, HLength)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*HT SIG*/ - - if (RX_HT == 1) { - smooth = (u1Byte)(value32 & 0x01); - htsound = (u1Byte)(value32 & 0x02); - rsv = (u1Byte)(value32 & 0x04); - agg = (u1Byte)(value32 & 0x08); - stbc = (u1Byte)(value32 & 0x30); - fec = (u1Byte)(value32 & 0x40); - sgi = (u1Byte)(value32 & 0x80); - htltf = (u1Byte)((value32 & 0x300) >> 8); - htcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); - Tail = (u1Byte)((value32 & 0xfc0000) >> 16); - } - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG2")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x", "Smooth/NoSound/Rsv/Aggregate/STBC/LDPC", smooth, htsound, rsv, agg, stbc, fec)); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "SGI/E-HT-LTFs/CRC/Tail", sgi, htltf, htcrc8, Tail)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xf2c , bMaskDWord); /*VHT SIG A1*/ - if (RX_HT == 2) { - /* value32 = ODM_GetBBReg(pDM_Odm, 0xf2c ,bMaskDWord);*/ - vRX_BW = (u1Byte)(value32 & 0x03); - vrsv = (u1Byte)(value32 & 0x04); - vstbc = (u1Byte)(value32 & 0x08); - vgid = (u1Byte)((value32 & 0x3f0) >> 4); - vNsts = (u1Byte)(((value32 & 0x1c00) >> 8) + 1); - vpaid = (u2Byte)(value32 & 0x3fe); - vtxops = (u1Byte)((value32 & 0x400000) >> 20); - vrsv2 = (u1Byte)((value32 & 0x800000) >> 20); - } - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A1")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x / %x", "BW/Rsv1/STBC/GID/Nsts/PAID/TXOPPS/Rsv2", vRX_BW, vrsv, vstbc, vgid, vNsts, vpaid, vtxops, vrsv2)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xf30 , bMaskDWord); /*VHT SIG*/ - - if (RX_HT == 2) { - /*value32 = ODM_GetBBReg(pDM_Odm, 0xf30 ,bMaskDWord); */ /*VHT SIG*/ - - //sgi=(u1Byte)(value32&0x01); - sgiext = (u1Byte)(value32 & 0x03); - //fec = (u1Byte)(value32&0x04); - fecext = (u1Byte)(value32 & 0x0C); - - vMCSS = (u1Byte)(value32 & 0xf0); - bf = (u1Byte)((value32 & 0x100) >> 8); - vrsv = (u1Byte)((value32 & 0x200) >> 8); - vhtcrc8 = (u2Byte)((value32 & 0x3fc00) >> 8); - vTail = (u1Byte)((value32 & 0xfc0000) >> 16); - } - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A2")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x", "SGI/FEC/MCS/BF/Rsv/CRC/Tail", sgiext, fecext, vMCSS, bf, vrsv, vhtcrc8, vTail)); - - value32 = ODM_GetBBReg(pDM_Odm, 0xf34 , bMaskDWord); /*VHT SIG*/ - { - vLength = (u2Byte)(value32 & 0x1fffff); - vbrsv = (u1Byte)((value32 & 0x600000) >> 20); - vbTail = (u2Byte)((value32 & 0x1f800000) >> 20); - vbcrc = (u1Byte)((value32 & 0x80000000) >> 28); - - } - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-B")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "Length/Rsv/Tail/CRC", vLength, vbrsv, vbTail, vbcrc)); - - /*for Condition number*/ - if (pDM_Odm->SupportICType & ODM_RTL8822B) { - s4Byte condition_num = 0; - char *factor = NULL; - - ODM_SetBBReg(pDM_Odm, 0x1988 , BIT22, 0x1); /*enable report condition number*/ - - condition_num = ODM_GetBBReg(pDM_Odm, 0xf84, bMaskDWord); - condition_num = (condition_num & 0x3ffff) >> 4; - - if (*pDM_Odm->pBandWidth == ODM_BW80M) - factor = "256/234"; - else if (*pDM_Odm->pBandWidth == ODM_BW40M) - factor = "128/108"; - else if (*pDM_Odm->pBandWidth == ODM_BW20M) { - if (RX_HT != 2 || RX_HT != 1) - factor = "64/52"; /*HT or VHT*/ - else - factor = "64/48"; /*legacy*/ - } - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d (factor = %s)", "Condition Number", condition_num, factor)); - - } - -} -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) -void phydm_sbd_check( - IN PDM_ODM_T pDM_Odm -) -{ - static u4Byte pkt_cnt = 0; - static BOOLEAN sbd_state = 0; - u4Byte sym_count, count, value32; - - if (sbd_state == 0) { - pkt_cnt++; - if (pkt_cnt % 5 == 0) { /*read SBD conter once every 5 packets*/ - ODM_SetTimer(pDM_Odm, &pDM_Odm->sbdcnt_timer, 0); /*ms*/ - sbd_state = 1; - } - } else { /*read counter*/ - value32 = ODM_GetBBReg(pDM_Odm, 0xF98, bMaskDWord); - sym_count = (value32 & 0x7C000000) >> 26; - count = (value32 & 0x3F00000) >> 20; - DbgPrint("#SBD# sym_count %d count %d\n", sym_count, count); - sbd_state = 0; - } -} - -void phydm_sbd_callback( - PRT_TIMER pTimer -) -{ - PADAPTER Adapter = (PADAPTER)pTimer->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - -#if USE_WORKITEM - ODM_ScheduleWorkItem(&pDM_Odm->sbdcnt_workitem); -#else - phydm_sbd_check(pDM_Odm); -#endif -} - -void phydm_sbd_workitem_callback( - IN PVOID pContext -) -{ - PADAPTER pAdapter = (PADAPTER)pContext; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - phydm_sbd_check(pDM_Odm); -} -#endif -VOID -phydm_BasicDbgMessage -( - IN PVOID pDM_VOID -) -{ -#if( DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure(pDM_Odm , PHYDM_FALSEALMCNT); - PCFO_TRACKING pCfoTrack = (PCFO_TRACKING)PhyDM_Get_Structure( pDM_Odm, PHYDM_CFOTRACK); - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u2Byte macid, phydm_macid, client_cnt = 0; - PSTA_INFO_T pEntry; - s4Byte tmp_val = 0; - u1Byte tmp_val_u1 = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[PHYDM Common MSG] System up time: ((%d sec))----->\n", pDM_Odm->phydm_sys_up_time)); - - if (pDM_Odm->bLinked) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Curr_STA_ID = 0x%x\n", pDM_Odm->curr_station_id)); - - /*Print RX Rate*/ - if (pDM_Odm->RxRate <= ODM_RATE11M) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCK AGC Report] LNA_idx = 0x%x, VGA_idx = 0x%x\n", - pDM_Odm->cck_lna_idx, pDM_Odm->cck_vga_idx)); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM AGC Report] { 0x%x, 0x%x, 0x%x, 0x%x }\n", - pDM_Odm->ofdm_agc_idx[0], pDM_Odm->ofdm_agc_idx[1], pDM_Odm->ofdm_agc_idx[2], pDM_Odm->ofdm_agc_idx[3])); - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("RSSI: { %d, %d, %d, %d }, RxRate:", - (pDM_Odm->RSSI_A == 0xff) ? 0 : pDM_Odm->RSSI_A , - (pDM_Odm->RSSI_B == 0xff) ? 0 : pDM_Odm->RSSI_B , - (pDM_Odm->RSSI_C == 0xff) ? 0 : pDM_Odm->RSSI_C, - (pDM_Odm->RSSI_D == 0xff) ? 0 : pDM_Odm->RSSI_D)); - - phydm_print_rate(pDM_Odm, pDM_Odm->RxRate, ODM_COMP_COMMON); - - /*Print TX Rate*/ - for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { - - pEntry = pDM_Odm->pODM_StaInfo[macid]; - if (IS_STA_VALID(pEntry)) { - - phydm_macid = (pDM_Odm->platform2phydm_macid_table[macid]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TXRate [%d]:", macid)); - phydm_print_rate(pDM_Odm, pRA_Table->link_tx_rate[macid], ODM_COMP_COMMON); - - client_cnt++; - - if (client_cnt == pDM_Odm->number_linked_client) - break; - } - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("TP { TX, RX, total} = {%d, %d, %d }Mbps, TrafficLoad = (%d))\n", - pDM_Odm->tx_tp, pDM_Odm->rx_tp, pDM_Odm->total_tp, pDM_Odm->TrafficLoad)); - - tmp_val_u1 = (pCfoTrack->CrystalCap > pCfoTrack->DefXCap) ? (pCfoTrack->CrystalCap - pCfoTrack->DefXCap) : (pCfoTrack->DefXCap - pCfoTrack->CrystalCap); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("CFO_avg = ((%d kHz)) , CrystalCap_tracking = ((%s%d))\n", - pCfoTrack->CFO_ave_pre, ((pCfoTrack->CrystalCap > pCfoTrack->DefXCap)?"+":"-"),tmp_val_u1)); - - /* Condition number */ -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) { - tmp_val = phydm_get_condition_number_8822B(pDM_Odm); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Condition number = ((%d))\n", tmp_val)); - } -#endif - -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - /*STBC or LDPC pkt*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("LDPC = %s, STBC = %s\n", (pDM_Odm->PhyDbgInfo.bLdpcPkt)?"Y":"N", (pDM_Odm->PhyDbgInfo.bStbcPkt)?"Y":"N")); -#endif - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("No Link !!!\n")); - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", - FalseAlmCnt->Cnt_CCK_CCA, FalseAlmCnt->Cnt_OFDM_CCA, FalseAlmCnt->Cnt_CCA_all)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", - FalseAlmCnt->Cnt_Cck_fail, FalseAlmCnt->Cnt_Ofdm_fail, FalseAlmCnt->Cnt_all)); - - #if (ODM_IC_11N_SERIES_SUPPORT == 1) - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("[OFDM FA Detail] Parity_Fail = (( %d )), Rate_Illegal = (( %d )), CRC8_fail = (( %d )), Mcs_fail = (( %d )), Fast_Fsync = (( %d )), SB_Search_fail = (( %d ))\n", - FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal, FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail, FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); - } - #endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("bLinked = %d, Num_client = %d, RSSI_Min = %d, CurrentIGI = 0x%x, bNoisy=%d\n\n", - pDM_Odm->bLinked, pDM_Odm->number_linked_client, pDM_Odm->RSSI_Min, pDM_DigTable->CurIGValue, pDM_Odm->NoisyDecision)); - -/* - temp_reg = ODM_GetBBReg(pDM_Odm, 0xDD0, bMaskByte0); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDD0 = 0x%x\n",temp_reg)); - - temp_reg = ODM_GetBBReg(pDM_Odm, 0xDDc, bMaskByte1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xDDD = 0x%x\n",temp_reg)); - - temp_reg = ODM_GetBBReg(pDM_Odm, 0xc50, bMaskByte0); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("0xC50 = 0x%x\n",temp_reg)); - - temp_reg = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0, 0x3fe0); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("RF 0x0[13:5] = 0x%x\n\n",temp_reg)); -*/ - -#endif -} - - -VOID phydm_BasicProfile( - IN PVOID pDM_VOID, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - char *Cut = NULL; - char *ICType = NULL; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - u4Byte commit_ver = 0; - u4Byte date = 0; - char *commit_by = NULL; - u4Byte release_ver = 0; - - PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% Basic Profile %")); - - if (pDM_Odm->SupportICType == ODM_RTL8188E) { - #if (RTL8188E_SUPPORT == 1) - ICType = "RTL8188E"; - date = RELEASE_DATE_8188E; - commit_by = COMMIT_BY_8188E; - release_ver = RELEASE_VERSION_8188E; - #endif - } - #if (RTL8812A_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8812) { - ICType = "RTL8812A"; - date = RELEASE_DATE_8812A; - commit_by = COMMIT_BY_8812A; - release_ver = RELEASE_VERSION_8812A; - } - #endif - #if (RTL8821A_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8821) { - ICType = "RTL8821A"; - date = RELEASE_DATE_8821A; - commit_by = COMMIT_BY_8821A; - release_ver = RELEASE_VERSION_8821A; - } - #endif - #if (RTL8192E_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8192E) { - ICType = "RTL8192E"; - date = RELEASE_DATE_8192E; - commit_by = COMMIT_BY_8192E; - release_ver = RELEASE_VERSION_8192E; - } - #endif - #if (RTL8723B_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8723B) { - ICType = "RTL8723B"; - date = RELEASE_DATE_8723B; - commit_by = COMMIT_BY_8723B; - release_ver = RELEASE_VERSION_8723B; - } - #endif - #if (RTL8814A_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8814A) { - ICType = "RTL8814A"; - date = RELEASE_DATE_8814A; - commit_by = COMMIT_BY_8814A; - release_ver = RELEASE_VERSION_8814A; - } - #endif - #if (RTL8881A_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8881A) { - ICType = "RTL8881A"; - /**/ - } - #endif - #if (RTL8822B_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8822B) { - ICType = "RTL8822B"; - date = RELEASE_DATE_8822B; - commit_by = COMMIT_BY_8822B; - release_ver = RELEASE_VERSION_8822B; - } - #endif - #if (RTL8197F_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8197F) { - ICType = "RTL8197F"; - date = RELEASE_DATE_8197F; - commit_by = COMMIT_BY_8197F; - release_ver = RELEASE_VERSION_8197F; - } - #endif - - #if (RTL8703B_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8703B) { - - ICType = "RTL8703B"; - date = RELEASE_DATE_8703B; - commit_by = COMMIT_BY_8703B; - release_ver = RELEASE_VERSION_8703B; - - } - #endif - #if (RTL8195A_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8195A) { - ICType = "RTL8195A"; - /**/ - } - #endif - #if (RTL8188F_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8188F) { - ICType = "RTL8188F"; - date = RELEASE_DATE_8188F; - commit_by = COMMIT_BY_8188F; - release_ver = RELEASE_VERSION_8188F; - } - #endif - #if (RTL8723D_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8723D) { - ICType = "RTL8723D"; - date = RELEASE_DATE_8723D; - commit_by = COMMIT_BY_8723D; - release_ver = RELEASE_VERSION_8723D; - /**/ - } - #endif - #if (RTL8821C_SUPPORT == 1) - else if (pDM_Odm->SupportICType == ODM_RTL8821C) { - ICType = "RTL8821C"; - date = RELEASE_DATE_8821C; - commit_by = COMMIT_BY_8821C; - release_ver = RELEASE_VERSION_8821C; - } - #endif - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s (MP Chip: %s)\n", "IC Type", ICType, pDM_Odm->bIsMPChip ? "Yes" : "No")); - - if (pDM_Odm->CutVersion == ODM_CUT_A) - Cut = "A"; - else if (pDM_Odm->CutVersion == ODM_CUT_B) - Cut = "B"; - else if (pDM_Odm->CutVersion == ODM_CUT_C) - Cut = "C"; - else if (pDM_Odm->CutVersion == ODM_CUT_D) - Cut = "D"; - else if (pDM_Odm->CutVersion == ODM_CUT_E) - Cut = "E"; - else if (pDM_Odm->CutVersion == ODM_CUT_F) - Cut = "F"; - else if (pDM_Odm->CutVersion == ODM_CUT_I) - Cut = "I"; - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Cut Version", Cut)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Version", ODM_GetHWImgVersion(pDM_Odm))); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Commit date", date)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY Parameter Commit by", commit_by)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Parameter Release Version", release_ver)); - -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - { - PADAPTER Adapter = pDM_Odm->Adapter; - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", Adapter->MgntInfo.FirmwareVersion, Adapter->MgntInfo.FirmwareSubVersion)); - } -#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) - { - struct rtl8192cd_priv *priv = pDM_Odm->priv; - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", priv->pshare->fw_version, priv->pshare->fw_sub_version)); - } -#else - { - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Version", pHalData->FirmwareVersion, pHalData->FirmwareSubVersion)); - } -#endif - //1 PHY DM Version List - PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% PHYDM Version %")); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Code Base", PHYDM_CODE_BASE)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Release Date", PHYDM_RELEASE_DATE)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Adaptivity", ADAPTIVITY_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "DIG", DIG_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic BB PowerSaving", DYNAMIC_BBPWRSAV_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "CFO Tracking", CFO_TRACKING_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Diversity", ANTDIV_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Power Tracking", POWRTRACKING_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic TxPower", DYNAMIC_TXPWR_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "RA Info", RAINFO_VERSION)); -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Antenna Detection", ANTDECT_VERSION)); -#endif - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Auto Channel Selection", ACS_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "EDCA Turbo", EDCATURBO_VERSION)); - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Path Diversity", PATHDIV_VERSION)); - -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8822B) - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8822B", PHY_CONFIG_VERSION_8822B)); - -#endif -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8197F", PHY_CONFIG_VERSION_8197F)); -#endif - *_used = used; - *_out_len = out_len; - -} - -VOID -phydm_fw_trace_en_h2c( - IN PVOID pDM_VOID, - IN BOOLEAN enable, - IN u4Byte fw_debug_component, - IN u4Byte monitor_mode, - IN u4Byte macid -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte H2C_Parameter[7] = {0}; - u1Byte cmd_length; - - if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES){ - - H2C_Parameter[0] = enable; - H2C_Parameter[1] = (u1Byte)(fw_debug_component & bMaskByte0); - H2C_Parameter[2] = (u1Byte)((fw_debug_component & bMaskByte1)>>8); - H2C_Parameter[3] = (u1Byte)((fw_debug_component & bMaskByte2)>>16); - H2C_Parameter[4] = (u1Byte)((fw_debug_component & bMaskByte3)>>24); - H2C_Parameter[5] = (u1Byte)monitor_mode; - H2C_Parameter[6] = (u1Byte)macid; - cmd_length = 7; - - } else { - - H2C_Parameter[0] = enable; - H2C_Parameter[1] = (u1Byte)monitor_mode; - H2C_Parameter[2] = (u1Byte)macid; - cmd_length = 3; - } - - - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("---->\n")); - if (monitor_mode == 0){ - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d ))\n", enable)); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", enable, monitor_mode, macid)); - } - ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_FW_TRACE_EN, cmd_length, H2C_Parameter); -} - - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) -BOOLEAN -phydm_api_set_txagc( - IN PDM_ODM_T pDM_Odm, - IN u4Byte PowerIndex, - IN ODM_RF_RADIO_PATH_E Path, - IN u1Byte HwRate, - IN BOOLEAN bSingleRate - ) -{ - BOOLEAN ret = FALSE; - -#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) - if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { - if (bSingleRate) { -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) - ret = phydm_write_txagc_1byte_8822b(pDM_Odm, PowerIndex, Path, HwRate); -#endif -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - ret = phydm_write_txagc_1byte_8821c(pDM_Odm, PowerIndex, Path, HwRate); -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - SetCurrentTxAGC(pDM_Odm->priv, Path, HwRate, (u1Byte)PowerIndex); -#endif - - } else { - u1Byte i; -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) - ret = config_phydm_write_txagc_8822b(pDM_Odm, PowerIndex, Path, HwRate); -#endif -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - ret = config_phydm_write_txagc_8821c(pDM_Odm, PowerIndex, Path, HwRate); -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - for (i = 0; i < 4; i++) - SetCurrentTxAGC(pDM_Odm->priv, Path, (HwRate + i), (u1Byte)PowerIndex); -#endif - } - } -#endif - - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ret = config_phydm_write_txagc_8197f(pDM_Odm, PowerIndex, Path, HwRate); -#endif - - return ret; -} - -u1Byte -phydm_api_get_txagc( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_RADIO_PATH_E Path, - IN u1Byte HwRate - ) -{ - u1Byte ret = 0; - -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8822B) - ret = config_phydm_read_txagc_8822b(pDM_Odm, Path, HwRate); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ret = config_phydm_read_txagc_8197f(pDM_Odm, Path, HwRate); -#endif - -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8821C) - ret = config_phydm_read_txagc_8821c(pDM_Odm, Path, HwRate); -#endif - - return ret; -} - - -BOOLEAN -phydm_api_switch_bw_channel( - IN PDM_ODM_T pDM_Odm, - IN u1Byte central_ch, - IN u1Byte primary_ch_idx, - IN ODM_BW_E bandwidth - ) -{ - BOOLEAN ret = FALSE; - -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8822B) - ret = config_phydm_switch_channel_bw_8822b(pDM_Odm, central_ch, primary_ch_idx, bandwidth); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ret = config_phydm_switch_channel_bw_8197f(pDM_Odm, central_ch, primary_ch_idx, bandwidth); -#endif - -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8821C) - ret = config_phydm_switch_channel_bw_8821c(pDM_Odm, central_ch, primary_ch_idx, bandwidth); -#endif - - return ret; -} - -BOOLEAN -phydm_api_trx_mode( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_PATH_E TxPath, - IN ODM_RF_PATH_E RxPath, - IN BOOLEAN bTx2Path - ) -{ - BOOLEAN ret = FALSE; - -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8822B) - ret = config_phydm_trx_mode_8822b(pDM_Odm, TxPath, RxPath, bTx2Path); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - ret = config_phydm_trx_mode_8197f(pDM_Odm, TxPath, RxPath, bTx2Path); -#endif - - return ret; -} -#endif - -VOID -phydm_get_per_path_txagc( - IN PVOID pDM_VOID, - IN u1Byte path, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte rate_idx; - u1Byte txagc; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - -#if ((RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) - if (((pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) && (path <= ODM_RF_PATH_B)) || - ((pDM_Odm->SupportICType & (ODM_RTL8821C)) && (path <= ODM_RF_PATH_A))) { - for (rate_idx = 0; rate_idx <= 0x53; rate_idx++) { - if (rate_idx == ODM_RATE1M) - PHYDM_SNPRINTF((output + used, out_len - used, " %-35s\n", "CCK====>")); - else if (rate_idx == ODM_RATE6M) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "OFDM====>")); - else if (rate_idx == ODM_RATEMCS0) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 1ss====>")); - else if (rate_idx == ODM_RATEMCS8) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 2ss====>")); - else if (rate_idx == ODM_RATEMCS16) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 3ss====>")); - else if (rate_idx == ODM_RATEMCS24) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 4ss====>")); - else if (rate_idx == ODM_RATEVHTSS1MCS0) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 1ss====>")); - else if (rate_idx == ODM_RATEVHTSS2MCS0) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 2ss====>")); - else if (rate_idx == ODM_RATEVHTSS3MCS0) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 3ss====>")); - else if (rate_idx == ODM_RATEVHTSS4MCS0) - PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 4ss====>")); - - txagc = phydm_api_get_txagc(pDM_Odm, (ODM_RF_RADIO_PATH_E) path, rate_idx); - if (config_phydm_read_txagc_check(txagc)) - PHYDM_SNPRINTF((output + used, out_len - used, " 0x%02x ", txagc)); - else - PHYDM_SNPRINTF((output + used, out_len - used, " 0x%s ", "xx")); - } - } -#endif -} - - -VOID -phydm_get_txagc( - IN PVOID pDM_VOID, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - /* Path-A */ - PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "Path-A====================")); - phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_A, _used, output, _out_len); - - /* Path-B */ - PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-B====================")); - phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_B, _used, output, _out_len); - - /* Path-C */ - PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-C====================")); - phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_C, _used, output, _out_len); - - /* Path-D */ - PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "Path-D====================")); - phydm_get_per_path_txagc(pDM_Odm, ODM_RF_PATH_D, _used, output, _out_len); - -} - -VOID -phydm_set_txagc( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - -/*dm_value[1] = Path*/ -/*dm_value[2] = HwRate*/ -/*dm_value[3] = PowerIndex*/ - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C)) { - if (dm_value[1] <= 1) { - if ((u1Byte)dm_value[2] != 0xff) { - if (phydm_api_set_txagc(pDM_Odm, dm_value[3], (ODM_RF_RADIO_PATH_E) dm_value[1], (u1Byte)dm_value[2], TRUE)) - PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s%x\n", "Write path-", dm_value[1], "rate index-0x", dm_value[2], " = 0x", dm_value[3])); - else - PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); - } else { - u1Byte i; - u4Byte power_index; - BOOLEAN status = TRUE; - - power_index = (dm_value[3] & 0x3f); - - if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8821C)) { - power_index = (power_index << 24)|(power_index << 16)|(power_index << 8)|(power_index); - - for (i = 0; i < ODM_RATEVHTSS2MCS9; i += 4) - status = (status & phydm_api_set_txagc(pDM_Odm, power_index, (ODM_RF_RADIO_PATH_E) dm_value[1], i, FALSE)); - } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { - for (i = 0; i <= ODM_RATEMCS15; i++) - status = (status & phydm_api_set_txagc(pDM_Odm, power_index, (ODM_RF_RADIO_PATH_E) dm_value[1], i, FALSE)); - } - - if (status) - PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x\n", "Write all TXAGC of path-", dm_value[1], " = 0x", dm_value[3])); - else - PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s\n", "Write all TXAGC of path-", dm_value[1], " fail")); - } - } else { - PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); - } - } -#endif -} - -VOID -phydm_debug_trace( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte pre_debug_components, one = 1; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - pre_debug_components = pDM_Odm->DebugComponents; - - PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); - if (dm_value[0] == 100) { - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Debug Message] PhyDM Selection")); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); - PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))DIG\n", ((pDM_Odm->DebugComponents & ODM_COMP_DIG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((pDM_Odm->DebugComponents & ODM_COMP_RA_MASK) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_TXPWR) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((pDM_Odm->DebugComponents & ODM_COMP_FA_CNT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((pDM_Odm->DebugComponents & ODM_COMP_RSSI_MONITOR) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))SNIFFER\n", ((pDM_Odm->DebugComponents & ODM_COMP_SNIFFER) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_ANT_DIV) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "07. (( %s ))DFS\n", ((pDM_Odm->DebugComponents & ODM_COMP_DFS) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))NOISY_DETECT\n", ((pDM_Odm->DebugComponents & ODM_COMP_NOISY_DETECT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RATE_ADAPTIVE\n", ((pDM_Odm->DebugComponents & ODM_COMP_RATE_ADAPTIVE) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((pDM_Odm->DebugComponents & ODM_COMP_PATH_DIV) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "12. (( %s ))DYNAMIC_PRICCA\n", ((pDM_Odm->DebugComponents & ODM_COMP_DYNAMIC_PRICCA) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))MP\n", ((pDM_Odm->DebugComponents & ODM_COMP_MP) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))CFO_TRACKING\n", ((pDM_Odm->DebugComponents & ODM_COMP_CFO_TRACKING) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))ACS\n", ((pDM_Odm->DebugComponents & ODM_COMP_ACS) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))ADAPTIVITY\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_ADAPTIVITY) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))RA_DBG\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_RA_DBG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "19. (( %s ))TXBF\n", ((pDM_Odm->DebugComponents & PHYDM_COMP_TXBF) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))EDCA_TURBO\n", ((pDM_Odm->DebugComponents & ODM_COMP_EDCA_TURBO) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "22. (( %s ))FW_DEBUG_TRACE\n", ((pDM_Odm->DebugComponents & ODM_FW_DEBUG_TRACE) ? ("V") : (".")))); - - PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))TX_PWR_TRACK\n", ((pDM_Odm->DebugComponents & ODM_COMP_TX_PWR_TRACK) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))CALIBRATION\n", ((pDM_Odm->DebugComponents & ODM_COMP_CALIBRATION) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "28. (( %s ))PHY_CONFIG\n", ((pDM_Odm->DebugComponents & ODM_PHY_CONFIG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "29. (( %s ))INIT\n", ((pDM_Odm->DebugComponents & ODM_COMP_INIT) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "30. (( %s ))COMMON\n", ((pDM_Odm->DebugComponents & ODM_COMP_COMMON) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "31. (( %s ))API\n", ((pDM_Odm->DebugComponents & ODM_COMP_API) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); - - } else if (dm_value[0] == 101) { - pDM_Odm->DebugComponents = 0; - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Disable all debug components")); - } else { - if (dm_value[1] == 1) { /*enable*/ - pDM_Odm->DebugComponents |= (one << dm_value[0]); - } else if (dm_value[1] == 2) { /*disable*/ - pDM_Odm->DebugComponents &= ~(one << dm_value[0]); - } else - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); - } - PHYDM_SNPRINTF((output + used, out_len - used, "pre-DbgComponents = 0x%x\n", pre_debug_components)); - PHYDM_SNPRINTF((output + used, out_len - used, "Curr-DbgComponents = 0x%x\n", pDM_Odm->DebugComponents)); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); -} - -VOID -phydm_fw_debug_trace( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte pre_fw_debug_components, one = 1; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - pre_fw_debug_components = pDM_Odm->fw_DebugComponents; - - PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); - if (dm_value[0] == 100) { - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[FW Debug Component]")); - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); - PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))RA\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_RA) ? ("V") : (".")))); - - if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES){ - PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))MU\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_MU) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))Path Div\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); - PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))Phy Config\n", ((pDM_Odm->fw_DebugComponents & PHYDM_FW_COMP_PHY_CONFIG) ? ("V") : (".")))); - } - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); - - } else { - if (dm_value[0] == 101) { - pDM_Odm->fw_DebugComponents = 0; - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Clear all fw debug components")); - } else { - if (dm_value[1] == 1) { /*enable*/ - pDM_Odm->fw_DebugComponents |= (one << dm_value[0]); - } else if (dm_value[1] == 2) { /*disable*/ - pDM_Odm->fw_DebugComponents &= ~(one << dm_value[0]); - } else - PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); - } - - if (pDM_Odm->fw_DebugComponents == 0) { - pDM_Odm->DebugComponents &= ~ODM_FW_DEBUG_TRACE; - phydm_fw_trace_en_h2c(pDM_Odm, FALSE, pDM_Odm->fw_DebugComponents, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ - } else { - pDM_Odm->DebugComponents |= ODM_FW_DEBUG_TRACE; - phydm_fw_trace_en_h2c(pDM_Odm, TRUE, pDM_Odm->fw_DebugComponents, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ - } - } -} - -VOID -phydm_DumpBbReg( - IN PVOID pDM_VOID, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte Addr = 0; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - - /* BB Reg, For Nseries IC we only need to dump page8 to pageF using 3 digits*/ - for (Addr = 0x800; Addr < 0xfff; Addr += 4) { - if (pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%03x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - else - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - } - - if (pDM_Odm->SupportICType & (ODM_RTL8822B | ODM_RTL8814A | ODM_RTL8821C)) { - - if (pDM_Odm->RFType > ODM_2T2R) { - for (Addr = 0x1800; Addr < 0x18ff; Addr += 4) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - } - - if (pDM_Odm->RFType > ODM_3T3R) { - for (Addr = 0x1a00; Addr < 0x1aff; Addr += 4) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - } - - for (Addr = 0x1900; Addr < 0x19ff; Addr += 4) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - - for (Addr = 0x1c00; Addr < 0x1cff; Addr += 4) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - - for (Addr = 0x1f00; Addr < 0x1fff; Addr += 4) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - } -} - -VOID -phydm_DumpAllReg( - IN PVOID pDM_VOID, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte Addr = 0; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - /* dump MAC register */ - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "MAC==========\n")); - for (Addr = 0; Addr < 0x7ff; Addr += 4) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - - for (Addr = 0x1000; Addr < 0x17ff; Addr += 4) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%04x 0x%08x,\n", Addr, ODM_GetBBReg(pDM_Odm, Addr, bMaskDWord))); - - /* dump BB register */ - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "BB==========\n")); - phydm_DumpBbReg(pDM_Odm, &used, output, &out_len); - - /* dump RF register */ - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-A==========\n")); - for (Addr = 0; Addr < 0xFF; Addr++) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, Addr, bRFRegOffsetMask))); - - if (pDM_Odm->RFType > ODM_1T1R) { - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-B==========\n")); - for (Addr = 0; Addr < 0xFF; Addr++) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_B, Addr, bRFRegOffsetMask))); - } - - if (pDM_Odm->RFType > ODM_2T2R) { - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-C==========\n")); - for (Addr = 0; Addr < 0xFF; Addr++) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_C, Addr, bRFRegOffsetMask))); - } - - if (pDM_Odm->RFType > ODM_3T3R) { - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "RF-D==========\n")); - for (Addr = 0; Addr < 0xFF; Addr++) - PHYDM_VAST_INFO_SNPRINTF((output+used, out_len-used, "0x%02x 0x%05x,\n", Addr, ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_D, Addr, bRFRegOffsetMask))); - } -} - -VOID -phydm_EnableBigJump( - IN PDM_ODM_T pDM_Odm, - IN BOOLEAN state - ) -{ -#if (RTL8822B_SUPPORT == 1) - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - if (state == FALSE) { - pDM_Odm->DM_DigTable.enableAdjustBigJump = FALSE; - ODM_SetBBReg(pDM_Odm, 0x8c8, 0xfe, ((pDM_DigTable->bigJumpStep3<<5)|(pDM_DigTable->bigJumpStep2<<3)|pDM_DigTable->bigJumpStep1)); - } else - pDM_Odm->DM_DigTable.enableAdjustBigJump = TRUE; -#endif -} - -#if (RTL8822B_SUPPORT == 1) - -VOID -phydm_showRxRate( - IN PDM_ODM_T pDM_Odm, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - PHYDM_SNPRINTF((output+used, out_len-used, "=====Rx SU Rate Statistics=====\n")); - PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[0], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[1], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[2], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[3])); - PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[4], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[5], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[6], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[7])); - PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[8], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[9])); - PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[10], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[11], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[12], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[13])); - PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[14], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[15], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[16], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[17])); - PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[18], pDM_Odm->PhyDbgInfo.NumQryVhtPkt[19])); - - PHYDM_SNPRINTF((output+used, out_len-used, "=====Rx MU Rate Statistics=====\n")); - PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[0], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[1], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[2], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[3])); - PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[4], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[5], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[6], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[7])); - PHYDM_SNPRINTF((output+used, out_len-used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[8], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[9])); - PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[10], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[11], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[12], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[13])); - PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[14], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[15], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[16], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[17])); - PHYDM_SNPRINTF((output+used, out_len-used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[18], pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[19])); - -} - -#endif - - -struct _PHYDM_COMMAND { - char name[16]; - u1Byte id; -}; - -enum PHYDM_CMD_ID { - PHYDM_HELP, - PHYDM_DEMO, - PHYDM_RA, - PHYDM_PROFILE, - PHYDM_ANTDIV, - PHYDM_PATHDIV, - PHYDM_DEBUG, - PHYDM_FW_DEBUG, - PHYDM_SUPPORT_ABILITY, - PHYDM_GET_TXAGC, - PHYDM_SET_TXAGC, - PHYDM_SMART_ANT, - PHYDM_API, - PHYDM_TRX_PATH, - PHYDM_LA_MODE, - PHYDM_DUMP_REG, - PHYDM_MU_MIMO, - PHYDM_HANG, - PHYDM_BIG_JUMP, - PHYDM_SHOW_RXRATE, - PHYDM_NBI_EN, - PHYDM_CSI_MASK_EN, - PHYDM_DFS, - PHYDM_IQK, - PHYDM_NHM, - PHYDM_CLM, - PHYDM_BB_INFO, - PHYDM_TXBF, - PHYDM_PAUSE_DIG_EN, - PHYDM_H2C, - PHYDM_ANT_SWITCH -}; - -struct _PHYDM_COMMAND phy_dm_ary[] = { - {"-h", PHYDM_HELP}, /*do not move this element to other position*/ - {"demo", PHYDM_DEMO}, /*do not move this element to other position*/ - {"ra", PHYDM_RA}, - {"profile", PHYDM_PROFILE}, - {"antdiv", PHYDM_ANTDIV}, - {"pathdiv", PHYDM_PATHDIV}, - {"dbg", PHYDM_DEBUG}, - {"fw_dbg", PHYDM_FW_DEBUG}, - {"ability", PHYDM_SUPPORT_ABILITY}, - {"get_txagc", PHYDM_GET_TXAGC}, - {"set_txagc", PHYDM_SET_TXAGC}, - {"smtant", PHYDM_SMART_ANT}, - {"api", PHYDM_API}, - {"trxpath", PHYDM_TRX_PATH}, - {"lamode", PHYDM_LA_MODE}, - {"dumpreg", PHYDM_DUMP_REG}, - {"mu", PHYDM_MU_MIMO}, - {"hang", PHYDM_HANG}, - {"bigjump", PHYDM_BIG_JUMP}, - {"rxrate", PHYDM_SHOW_RXRATE}, - {"nbi", PHYDM_NBI_EN}, - {"csi_mask", PHYDM_CSI_MASK_EN}, - {"dfs", PHYDM_DFS}, - {"iqk", PHYDM_IQK}, - {"nhm", PHYDM_NHM}, - {"clm", PHYDM_CLM}, - {"bbinfo", PHYDM_BB_INFO}, - {"txbf", PHYDM_TXBF}, - {"pause_dig", PHYDM_PAUSE_DIG_EN}, - {"h2c", PHYDM_H2C}, - {"ant_switch", PHYDM_ANT_SWITCH} -}; - -VOID -phydm_cmd_parser( - IN PDM_ODM_T pDM_Odm, - IN char input[][MAX_ARGV], - IN u4Byte input_num, - IN u1Byte flag, - OUT char *output, - IN u4Byte out_len -) -{ - u4Byte used = 0; - u1Byte id = 0; - int var1[10] = {0}; - int i, input_idx = 0, phydm_ary_size; - char help[] = "-h"; - - if (flag == 0) { - PHYDM_SNPRINTF((output + used, out_len - used, "GET, nothing to print\n")); - return; - } - - PHYDM_SNPRINTF((output + used, out_len - used, "\n")); - - //Parsing Cmd ID - if (input_num) { - - phydm_ary_size = sizeof(phy_dm_ary) / sizeof(struct _PHYDM_COMMAND); - for (i = 0; i < phydm_ary_size; i++) { - if (strcmp(phy_dm_ary[i].name, input[0]) == 0) { - id = phy_dm_ary[i].id; - break; - } - } - if (i == phydm_ary_size) { - PHYDM_SNPRINTF((output + used, out_len - used, "SET, command not found!\n")); - return; - } - } - - switch (id) { - - case PHYDM_HELP: - { - PHYDM_SNPRINTF((output + used, out_len - used, "BB cmd ==>\n")); - for (i=0; i < phydm_ary_size-2; i++) { - - PHYDM_SNPRINTF((output + used, out_len - used, " %-5d: %s\n", i, phy_dm_ary[i+2].name)); - /**/ - } - } - break; - - case PHYDM_DEMO: /*echo demo 10 0x3a z abcde >cmd*/ - { - u4Byte directory = 0; - - #if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) - char char_temp; - #else - u4Byte char_temp = ' '; - #endif - - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &directory); - PHYDM_SNPRINTF((output + used, out_len - used, "Decimal Value = %d\n", directory)); - PHYDM_SSCANF(input[2], DCMD_HEX, &directory); - PHYDM_SNPRINTF((output + used, out_len - used, "Hex Value = 0x%x\n", directory)); - PHYDM_SSCANF(input[3], DCMD_CHAR, &char_temp); - PHYDM_SNPRINTF((output + used, out_len - used, "Char = %c\n", char_temp)); - PHYDM_SNPRINTF((output + used, out_len - used, "String = %s\n", input[4])); - } - break; - - case PHYDM_RA: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - - /*PHYDM_SNPRINTF((output + used, out_len - used, "new SET, RA_var[%d]= (( %d ))\n", i , var1[i]));*/ - input_idx++; - } - } - - if (input_idx >= 1) { - /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_RA_debug\n"));*/ - #if (defined(CONFIG_RA_DBG_CMD)) - odm_RA_debug((PVOID)pDM_Odm, (pu4Byte) var1); - #else - phydm_RA_debug_PCR(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - #endif - } - - - break; - - case PHYDM_ANTDIV: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - - /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i , var1[i]));*/ - input_idx++; - } - } - - if (input_idx >= 1) { - /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - phydm_antdiv_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - #endif - } - - break; - - case PHYDM_PATHDIV: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - - /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i , var1[i]));*/ - input_idx++; - } - } - - if (input_idx >= 1) { - /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ -#if (defined(CONFIG_PATH_DIVERSITY)) - odm_pathdiv_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); -#endif - } - - break; - - case PHYDM_DEBUG: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - - /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, Debug_var[%d]= (( %d ))\n", i , var1[i]));*/ - input_idx++; - } - } - - if (input_idx >= 1) { - /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_debug_comp\n"));*/ - phydm_debug_trace(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - } - - - break; - - case PHYDM_FW_DEBUG: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - input_idx++; - } - } - - if (input_idx >= 1) - phydm_fw_debug_trace(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - - break; - - case PHYDM_SUPPORT_ABILITY: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - - /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, support ablity_var[%d]= (( %d ))\n", i , var1[i]));*/ - input_idx++; - } - } - - if (input_idx >= 1) { - /*PHYDM_SNPRINTF((output+used, out_len-used, "support ablity\n"));*/ - phydm_support_ability_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - } - - break; - - case PHYDM_SMART_ANT: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - input_idx++; - } - } - - if (input_idx >= 1) { - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 - phydm_hl_smart_ant_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - #endif - #endif - } - - break; - - case PHYDM_API: -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) - { - if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F | ODM_RTL8821C)) { - BOOLEAN bEnableDbgMode; - u1Byte central_ch, primary_ch_idx, bandwidth; - - for (i = 0; i < 4; i++) { - if (input[i + 1]) - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - } - - bEnableDbgMode = (BOOLEAN)var1[0]; - central_ch = (u1Byte) var1[1]; - primary_ch_idx = (u1Byte) var1[2]; - bandwidth = (ODM_BW_E) var1[3]; - - if (bEnableDbgMode) { - pDM_Odm->bDisablePhyApi = FALSE; - phydm_api_switch_bw_channel(pDM_Odm, central_ch, primary_ch_idx, (ODM_BW_E) bandwidth); - pDM_Odm->bDisablePhyApi = TRUE; - PHYDM_SNPRINTF((output+used, out_len-used, "central_ch = %d, primary_ch_idx = %d, bandwidth = %d\n", central_ch, primary_ch_idx, bandwidth)); - } else { - pDM_Odm->bDisablePhyApi = FALSE; - PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); - } - } else - PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); - } -#else - PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support PHYDM API function\n")); -#endif - break; - - case PHYDM_PROFILE: /*echo profile, >cmd*/ - phydm_BasicProfile(pDM_Odm, &used, output, &out_len); - break; - - case PHYDM_GET_TXAGC: - phydm_get_txagc(pDM_Odm, &used, output, &out_len); - break; - - case PHYDM_SET_TXAGC: - { - BOOLEAN bEnableDbgMode; - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - input_idx++; - } - } - - if ((strcmp(input[1], help) == 0)) { - PHYDM_SNPRINTF((output+used, out_len-used, "{En} {pathA~D(0~3)} {rate_idx(Hex), All_rate:0xff} {txagc_idx (Hex)}\n")); - /**/ - - } else { - - bEnableDbgMode = (BOOLEAN)var1[0]; - if (bEnableDbgMode) { - pDM_Odm->bDisablePhyApi = FALSE; - phydm_set_txagc(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - pDM_Odm->bDisablePhyApi = TRUE; - } else { - pDM_Odm->bDisablePhyApi = FALSE; - PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); - } - } - } - break; - - case PHYDM_TRX_PATH: - - for (i = 0; i < 4; i++) { - if (input[i + 1]) - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - } - #if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) { - u1Byte TxPath, RxPath; - BOOLEAN bEnableDbgMode, bTx2Path; - - bEnableDbgMode = (BOOLEAN)var1[0]; - TxPath = (u1Byte) var1[1]; - RxPath = (u1Byte) var1[2]; - bTx2Path = (BOOLEAN) var1[3]; - - if (bEnableDbgMode) { - pDM_Odm->bDisablePhyApi = FALSE; - phydm_api_trx_mode(pDM_Odm, (ODM_RF_PATH_E) TxPath, (ODM_RF_PATH_E) RxPath, bTx2Path); - pDM_Odm->bDisablePhyApi = TRUE; - PHYDM_SNPRINTF((output+used, out_len-used, "TxPath = 0x%x, RxPath = 0x%x, bTx2Path = %d\n", TxPath, RxPath, bTx2Path)); - } else { - pDM_Odm->bDisablePhyApi = FALSE; - PHYDM_SNPRINTF((output+used, out_len-used, "Disable API debug mode\n")); - } - } else - #endif - phydm_config_trx_path(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - - break; - - case PHYDM_LA_MODE: -#if (PHYDM_LA_MODE_SUPPORT == 1) - - if (pDM_Odm->SupportICType & PHYDM_IC_SUPPORT_LA_MODE) { - u2Byte PollingTime; - u1Byte TrigSel, TrigSigSel, DmaDataSigSel, TriggerTime_unit_num; - BOOLEAN bEnableLaMode, bTriggerEdge; - u4Byte DbgPort, TriggerTime_mu_sec; - u1Byte sampling_rate = 0; - - for (i = 0; i < 6; i++) { - if (input[i + 1]) - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - } - - bEnableLaMode = (BOOLEAN)var1[0]; - DbgPrint("echo cmd input_num = %d\n", input_num); - /* if ((strcmp(input[1], help) == 0) && (input_num == 2)) {*/ - if ((strcmp(input[1], help) == 0)) { - PHYDM_SNPRINTF((output+used, out_len-used, "{En} {0:BB,1:MAC} {BB:DbgPort[bit],MAC:0-ok/1-fail/2-cca} {RptFormat} {TrigTime} \n {PollingTime} {DbgPort} {0:P_Edge, 1:N_Edge} {SpRate:0-80M,1-40M,2-20M} {Capture num}\n")); - /**/ - /*} else if ((bEnableLaMode == 1) && (input_num == 10)) {*/ - } else if ((bEnableLaMode == 1)) { - TrigSel = (u1Byte)var1[1]; /*0: BB, 1: MAC*/ - TrigSigSel = (u1Byte)var1[2]; - DmaDataSigSel = (u1Byte)var1[3]; - TriggerTime_mu_sec = var1[4]; /*unit: us*/ - PollingTime = (((u1Byte)var1[5]) << 6); /*unit: ms*/ - - PHYDM_SSCANF(input[7], DCMD_HEX, &var1[6]); - PHYDM_SSCANF(input[8], DCMD_DECIMAL, &var1[7]); - PHYDM_SSCANF(input[9], DCMD_DECIMAL, &var1[8]); - PHYDM_SSCANF(input[10], DCMD_DECIMAL, &var1[9]); - - DbgPort = (u4Byte)var1[6]; - bTriggerEdge = (BOOLEAN) var1[7]; - sampling_rate = var1[8] & 0x7; - - #if 1 - TriggerTime_unit_num = phydm_la_mode_mac_setting(pDM_Odm, TriggerTime_mu_sec); - phydm_la_mode_bb_setting(pDM_Odm, DbgPort, bTriggerEdge, sampling_rate); - #else - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - ODM_SetBBReg(pDM_Odm, 0x198C , BIT2|BIT1|BIT0, 7); /*disable dbg clk gating*/ - ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, DbgPort); - ODM_SetBBReg(pDM_Odm, 0x95C , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ - ODM_SetBBReg(pDM_Odm, 0x95c, 0xe0, sampling_rate); - } else { - ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, DbgPort); - ODM_SetBBReg(pDM_Odm, 0x9A0 , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ - ODM_SetBBReg(pDM_Odm, 0x9A0, 0xe0, sampling_rate); - } - #endif - - pDM_Odm->ADCSmp_dbg_port = DbgPort; - pDM_Odm->ADCSmp_trigger_edge = bTriggerEdge; - pDM_Odm->ADCsmp_smp_rate = sampling_rate; - pDM_Odm->ADCSmp_count = var1[9]; - - DbgPrint("echo lamode %d %d %d %d %d %d %x %d %d %d\n", var1[0], var1[1], var1[2], var1[3], var1[4], var1[5], var1[6], var1[7], var1[8], var1[9]); - - ADCSmp_Set(pDM_Odm, (RT_ADCSMP_TRIG_SEL) TrigSel, (RT_ADCSMP_TRIG_SIG_SEL) TrigSigSel, DmaDataSigSel, TriggerTime_unit_num, PollingTime); - - PHYDM_SNPRINTF((output+used, out_len-used, "TrigSel = ((%s)), TrigSigSel = ((%d)), DmaDataSigSel = ((%d))\n", ((TrigSel)?"MAC":"BB"), TrigSigSel, DmaDataSigSel)); - PHYDM_SNPRINTF((output+used, out_len-used, "TriggerTime = ((%d * %d us)), PollingTime = ((%d)), sampling rate = ((%d MHz))\n", - TriggerTime_unit_num, ((pDM_Odm->ADCsmp_time_unit == 0) ? 1 : (2<<(pDM_Odm->ADCsmp_time_unit-1))), PollingTime, (80>>sampling_rate))); - } else { - ADCSmp_Stop(pDM_Odm); - PHYDM_SNPRINTF((output+used, out_len-used, "Disable LA mode\n")); - } - } else - #endif - PHYDM_SNPRINTF((output+used, out_len-used, "This IC doesn't support LA mode\n")); - break; - - case PHYDM_DUMP_REG: - { - u1Byte type = 0; - - if (input[1]) { - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - type = (u1Byte)var1[0]; - } - - if (type == 0) - phydm_DumpBbReg(pDM_Odm, &used, output, &out_len); - else if (type == 1) - phydm_DumpAllReg(pDM_Odm, &used, output, &out_len); - } - break; - - case PHYDM_MU_MIMO: -#if (RTL8822B_SUPPORT == 1) - - if (input[1]) - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - else - var1[0] = 0; - - if (var1[0] == 1) { - int index, ptr; - u4Byte Dword_H, Dword_L; - - PHYDM_SNPRINTF((output+used, out_len-used, "Get MU BFee CSI\n")); - ODM_SetBBReg(pDM_Odm, 0x9e8, BIT17|BIT16, 2); /*Read BFee*/ - ODM_SetBBReg(pDM_Odm, 0x1910, BIT15, 1); /*Select BFee's CSI report*/ - ODM_SetBBReg(pDM_Odm, 0x19b8, BIT6, 1); /*set as CSI report*/ - ODM_SetBBReg(pDM_Odm, 0x19a8, 0xFFFF, 0xFFFF); /*disable gated_clk*/ - - for (index = 0; index < 80; index++) { - ptr = index + 256; - if (ptr > 311) - ptr -= 312; - ODM_SetBBReg(pDM_Odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ - Dword_H = ODM_GetBBReg(pDM_Odm, 0xF74, bMaskDWord); - Dword_L = ODM_GetBBReg(pDM_Odm, 0xF5C, bMaskDWord); - if (index % 2 == 0) - PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, - Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); - else - PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, - Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); - } - } else if (var1[0] == 2) { - int index, ptr; - u4Byte Dword_H, Dword_L; - - PHYDM_SSCANF(input[2], DCMD_DECIMAL, &var1[1]); - PHYDM_SNPRINTF((output+used, out_len-used, "Get MU BFer's STA%d CSI\n", var1[1])); - ODM_SetBBReg(pDM_Odm, 0x9e8, BIT24, 0); /*Read BFer*/ - ODM_SetBBReg(pDM_Odm, 0x9e8, BIT25, 1); /*enable Read/Write RAM*/ - ODM_SetBBReg(pDM_Odm, 0x9e8, BIT30|BIT29|BIT28, var1[1]); /*read which STA's CSI report*/ - ODM_SetBBReg(pDM_Odm, 0x1910, BIT15, 0); /*select BFer's CSI*/ - ODM_SetBBReg(pDM_Odm, 0x19e0, 0x00003FC0, 0xFF); /*disable gated_clk*/ - - for (index = 0; index < 80; index++) { - ptr = index + 256; - if (ptr > 311) - ptr -= 312; - ODM_SetBBReg(pDM_Odm, 0x1910, 0x03FF0000, ptr); /*Select Address*/ - Dword_H = ODM_GetBBReg(pDM_Odm, 0xF74, bMaskDWord); - Dword_L = ODM_GetBBReg(pDM_Odm, 0xF5C, bMaskDWord); - if (index % 2 == 0) - PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, - Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); - else - PHYDM_SNPRINTF((output+used, out_len-used, "%02x %02x %02x %02x %02x %02x %02x %02x\n", - Dword_L & bMaskByte0, (Dword_L & bMaskByte1) >> 8, (Dword_L & bMaskByte2) >> 16, (Dword_L & bMaskByte3) >> 24, - Dword_H & bMaskByte0, (Dword_H & bMaskByte1) >> 8, (Dword_H & bMaskByte2) >> 16, (Dword_H & bMaskByte3) >> 24)); - - PHYDM_SNPRINTF((output+used, out_len-used, "ptr=%d : 0x%8x %8x\n", ptr, Dword_H, Dword_L)); - } - - } -#endif - break; - - case PHYDM_BIG_JUMP: - { -#if (RTL8822B_SUPPORT == 1) - if (input[1]) { - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - phydm_EnableBigJump(pDM_Odm, (BOOLEAN)(var1[0])); - } else - PHYDM_SNPRINTF((output + used, out_len - used, "unknown command!\n")); -#else - PHYDM_SNPRINTF((output + used, out_len - used, "The command is only for 8822B!\n")); -#endif - break; - } - - case PHYDM_HANG: - phydm_BB_RxHang_Info(pDM_Odm, &used, output, &out_len); - break; - - case PHYDM_SHOW_RXRATE: -#if (RTL8822B_SUPPORT == 1) - { - u1Byte rate_idx; - - if (input[1]) - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - - if (var1[0] == 1) - phydm_showRxRate(pDM_Odm, &used, output, &out_len); - else { - PHYDM_SNPRINTF((output+used, out_len-used, "Reset Rx rate counter\n")); - - for (rate_idx = 0; rate_idx < 40; rate_idx++) { - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[rate_idx] = 0; - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[rate_idx] = 0; - } - } - } -#endif - break; - - case PHYDM_NBI_EN: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - input_idx++; - } - } - - if (input_idx >= 1) { - - phydm_api_debug(pDM_Odm, PHYDM_API_NBI, (u4Byte *)var1, &used, output, &out_len); - /**/ - } - - - break; - - case PHYDM_CSI_MASK_EN: - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - input_idx++; - } - } - - if (input_idx >= 1) { - - phydm_api_debug(pDM_Odm, PHYDM_API_CSI_MASK, (u4Byte *)var1, &used, output, &out_len); - /**/ - } - - - break; - - case PHYDM_DFS: -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - { - u4Byte var[6] = {0}; - - for (i = 0; i < 6; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var[i]); - input_idx++; - } - } - - if (input_idx >= 1) - phydm_dfs_debug(pDM_Odm, var, &used, output, &out_len); - } -#endif - break; - - case PHYDM_IQK: -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - PHY_IQCalibrate(pDM_Odm->priv); - PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); -#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PHY_IQCalibrate(pDM_Odm->Adapter, FALSE); - PHYDM_SNPRINTF((output + used, out_len - used, "IQK !!\n")); -#endif - break; - - case PHYDM_NHM: - { - u1Byte target_rssi; - u4Byte value32; - u2Byte nhm_period = 0xC350; //200ms - u1Byte IGI; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - - if(input_num == 1) { - - CCX_INFO->echo_NHM_en = FALSE; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); - - return; - } - - /* NMH trigger */ - if ((var1[0] <= 2) && (var1[0] != 0)) { - - CCX_INFO->echo_NHM_en = TRUE; - CCX_INFO->echo_IGI = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); - - target_rssi = CCX_INFO->echo_IGI - 10; - - CCX_INFO->NHM_th[0] = (target_rssi -15 + 10) * 2; - - for(i = 1; i <= 10; i ++) { - CCX_INFO->NHM_th[i] = CCX_INFO->NHM_th[0] + 6 * i; - } - - //4 1. store previous NHM setting - phydm_NHMsetting(pDM_Odm, STORE_NHM_SETTING); - - //4 2. Set NHM period, 0x990[31:16]=0xC350, Time duration for NHM unit: 4us, 0xC350=200ms - CCX_INFO->NHM_period = nhm_period; - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Monitor NHM for %d us", nhm_period*4)); - - //4 3. Set NHM inexclude_txon, inexclude_cca, ccx_en - - - CCX_INFO->NHM_inexclude_cca = (var1[0] == 1) ? NHM_EXCLUDE_CCA : NHM_INCLUDE_CCA; - CCX_INFO->NHM_inexclude_txon = NHM_EXCLUDE_TXON; - - phydm_NHMsetting(pDM_Odm, SET_NHM_SETTING); - - for(i = 0; i <= 10; i ++) { - - if (i == 5) { - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x, echo_IGI = 0x%x", i, CCX_INFO->NHM_th[i], CCX_INFO->echo_IGI)); - } - else if (i == 10) - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x\n", i, CCX_INFO->NHM_th[i])); - else - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x", i, CCX_INFO->NHM_th[i])); - } - - //4 4. Trigger NHM - phydm_NHMtrigger(pDM_Odm); - - } - - /*Get NHM results*/ - else if (var1[0] == 3) { - - IGI = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); - - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Cur_IGI = 0x%x", IGI)); - - phydm_getNHMresult(pDM_Odm); - - //4 Resotre NHM setting - phydm_NHMsetting(pDM_Odm, RESTORE_NHM_SETTING); - - for(i = 0; i <= 11; i++) { - - if (i == 5) - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d, echo_IGI = 0x%x", i, CCX_INFO->NHM_result[i], CCX_INFO->echo_IGI)); - else if (i == 11) - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d\n", i, CCX_INFO->NHM_result[i])); - else - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d", i, CCX_INFO->NHM_result[i])); - } - - CCX_INFO->echo_NHM_en = FALSE; - } - else { - - CCX_INFO->echo_NHM_en = FALSE; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); - - return; - } - } - break; - - case PHYDM_CLM: - { - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - - //PHYDM_SNPRINTF((output + used, out_len - used, "\r\n input_num = %d\n", input_num)); - - if (input_num == 1) { - - CCX_INFO->echo_CLM_en = FALSE; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger CLM: echo clm 1\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r Get CLM results: echo clm 2\n")); - return; - } - - /* Set & trigger CLM */ - if (var1[0] == 1) { - - CCX_INFO->echo_CLM_en = TRUE; - CCX_INFO->CLM_period = 0xC350; /*100ms*/ - phydm_CLMsetting(pDM_Odm); - phydm_CLMtrigger(pDM_Odm); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Monitor CLM for 200ms\n")); - } - - /* Get CLM results */ - else if (var1[0] == 2) { - - CCX_INFO->echo_CLM_en = FALSE; - phydm_getCLMresult(pDM_Odm); - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n CLM_result = %d us\n", CCX_INFO->CLM_result*4)); - - } else { - - CCX_INFO->echo_CLM_en = FALSE; - PHYDM_SNPRINTF((output + used, out_len - used, "\n\r Error command !\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger CLM: echo clm 1\n")); - PHYDM_SNPRINTF((output + used, out_len - used, "\r Get CLM results: echo clm 2\n")); - } - } - break; - - case PHYDM_BB_INFO: - { - s4Byte value32 = 0; - - phydm_BB_Debug_Info(pDM_Odm, &used, output, &out_len); - - if (pDM_Odm->SupportICType & ODM_RTL8822B && input[1]) { - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - ODM_SetBBReg(pDM_Odm, 0x1988, 0x003fff00, var1[0]); - value32 = ODM_GetBBReg(pDM_Odm, 0xf84, bMaskDWord); - value32 = (value32 & 0xff000000)>>24; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = condition num = %d, subcarriers = %d\n", "Over condition num subcarrier", var1[0], value32)); - ODM_SetBBReg(pDM_Odm, 0x1988 , BIT22, 0x0); /*disable report condition number*/ - } - } - break; - - case PHYDM_TXBF: - { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -#if (BEAMFORMING_SUPPORT == 1) - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - - PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); - if (var1[0] == 1) { - pBeamformingInfo->applyVmatrix = TRUE; - pBeamformingInfo->snding3SS = FALSE; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n apply V matrix and 3SS 789 dont snding\n")); - } else if (var1[0] == 0) { - pBeamformingInfo->applyVmatrix = FALSE; - pBeamformingInfo->snding3SS = TRUE; - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n dont apply V matrix and 3SS 789 snding\n")); - } else - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n unknown cmd!!\n")); -#else - PHYDM_SNPRINTF((output + used, out_len - used, "\r\n no TxBF !!\n")); -#endif -#endif - } - break; - - case PHYDM_PAUSE_DIG_EN: - - - for (i = 0; i < 5; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - input_idx++; - } - } - - if (input_idx >= 1) { - if (var1[0] == 0) { - odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_7, (u1Byte)var1[1]); - PHYDM_SNPRINTF((output + used, out_len - used, "Set IGI_value = ((%x))\n", var1[1])); - } else if (var1[0] == 1) { - odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_7, (u1Byte)var1[1]); - PHYDM_SNPRINTF((output + used, out_len - used, "Resume IGI_value\n")); - } else - PHYDM_SNPRINTF((output + used, out_len - used, "echo (1:pause, 2resume) (IGI_value)\n")); - } - - break; - - case PHYDM_H2C: - - for (i = 0; i < 8; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); - input_idx++; - } - } - - if (input_idx >= 1) - phydm_h2C_debug(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - - - break; - - case PHYDM_ANT_SWITCH: - - for (i = 0; i < 8; i++) { - if (input[i + 1]) { - PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); - input_idx++; - } - } - - if (input_idx >= 1) { - - #if (RTL8821A_SUPPORT == 1) - phydm_set_ext_switch(pDM_Odm, (u4Byte *)var1, &used, output, &out_len); - #else - PHYDM_SNPRINTF((output + used, out_len - used, "Not Support IC")); - #endif - } - - - break; - - default: - PHYDM_SNPRINTF((output + used, out_len - used, "SET, unknown command!\n")); - break; - - } -} - - -VOID -phydm_la_mode_bb_setting( - IN PVOID pDM_VOID, - IN u4Byte DbgPort, - IN BOOLEAN bTriggerEdge, - IN u1Byte sampling_rate -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - /*u4Byte dword;*/ - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - ODM_SetBBReg(pDM_Odm, 0x198C , BIT2|BIT1|BIT0, 7); /*disable dbg clk gating*/ - - /*dword= ODM_GetBBReg(pDM_Odm, 0x8FC, bMaskDWord);*/ - /*DbgPrint("dbg_port = ((0x%x))\n", dword);*/ - ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, DbgPort); - ODM_SetBBReg(pDM_Odm, 0x95C , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ - ODM_SetBBReg(pDM_Odm, 0x95c, 0xe0, sampling_rate); - /* (0:) '80MHz' - (1:) '40MHz' - (2:) '20MHz' - (3:) '10MHz' - (4:) '5MHz' - (5:) '2.5MHz' - (6:) '1.25MHz' - (7:) '160MHz (for BW160 ic)' - */ - } else { - ODM_SetBBReg(pDM_Odm, 0x908, bMaskDWord, DbgPort); - ODM_SetBBReg(pDM_Odm, 0x9A0 , BIT31, bTriggerEdge); /*0: posedge, 1: negedge*/ - ODM_SetBBReg(pDM_Odm, 0x9A0, 0xe0, sampling_rate); - /* (0:) '80MHz' - (1:) '40MHz' - (2:) '20MHz' - (3:) '10MHz' - (4:) '5MHz' - (5:) '2.5MHz' - (6:) '1.25MHz' - (7:) '160MHz (for BW160 ic)' - */ - } -} - -u1Byte -phydm_la_mode_mac_setting( - IN PVOID pDM_VOID, - IN u4Byte TriggerTime_mu_sec -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte TriggerTime_unit_num; - u4Byte time_unit = 0; - - if (TriggerTime_mu_sec < 128) { - time_unit = 0; /*unit: 1mu sec*/ - } else if (TriggerTime_mu_sec < 256) { - time_unit = 1; /*unit: 2mu sec*/ - } else if (TriggerTime_mu_sec < 512) { - time_unit = 2; /*unit: 4mu sec*/ - } else if (TriggerTime_mu_sec < 1024) { - time_unit = 3; /*unit: 8mu sec*/ - } else if (TriggerTime_mu_sec < 2048) { - time_unit = 4; /*unit: 16mu sec*/ - } else if (TriggerTime_mu_sec < 4096) { - time_unit = 5; /*unit: 32mu sec*/ - } else if (TriggerTime_mu_sec < 8192) { - time_unit = 6; /*unit: 64mu sec*/ - } - - TriggerTime_unit_num = (u1Byte)(TriggerTime_mu_sec>>time_unit); - pDM_Odm->ADCsmp_time_unit = time_unit; - DbgPrint("time_unit = ((0x%x))\n", time_unit); - - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) { - ODM_SetMACReg(pDM_Odm, 0x7cc , BIT20|BIT19|BIT18, time_unit); - } else { - - } - return (TriggerTime_unit_num & 0x7f); - -} - -#ifdef __ECOS -char *strsep(char **s, const char *ct) -{ - char *sbegin = *s; - char *end; - - if (sbegin == NULL) - return NULL; - - end = strpbrk(sbegin, ct); - if (end) - *end++ = '\0'; - *s = end; - return sbegin; -} -#endif - -#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -s4Byte -phydm_cmd( - IN PDM_ODM_T pDM_Odm, - IN char *input, - IN u4Byte in_len, - IN u1Byte flag, - OUT char *output, - IN u4Byte out_len -) -{ - char *token; - u4Byte Argc = 0; - char Argv[MAX_ARGC][MAX_ARGV]; - - do { - token = strsep(&input, ", "); - if (token) { - strcpy(Argv[Argc], token); - Argc++; - } else - break; - } while (Argc < MAX_ARGC); - - if (Argc == 1) - Argv[0][strlen(Argv[0]) - 1] = '\0'; - - phydm_cmd_parser(pDM_Odm, Argv, Argc, flag, output, out_len); - - return 0; -} -#endif - - -VOID -phydm_fw_trace_handler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - /*u1Byte debug_trace_11byte[60];*/ - u1Byte freg_num, c2h_seq, buf_0 = 0; - - if (!(pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES)) - return; - - if (CmdLen > 12) - return; - - buf_0 = CmdBuf[0]; - freg_num = (buf_0 & 0xf); - c2h_seq = (buf_0 & 0xf0) >> 4; - /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] freg_num = (( %d )), c2h_seq = (( %d ))\n", freg_num,c2h_seq ));*/ - - /*strncpy(debug_trace_11byte,&CmdBuf[1],(CmdLen-1));*/ - /*debug_trace_11byte[CmdLen-1] = '\0';*/ - /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] %s\n", debug_trace_11byte));*/ - /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] CmdLen = (( %d ))\n", CmdLen));*/ - /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW debug message] c2h_cmd_start = (( %d ))\n", pDM_Odm->c2h_cmd_start));*/ - - - - /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("pre_seq = (( %d )), current_seq = (( %d ))\n", pDM_Odm->pre_c2h_seq, c2h_seq));*/ - /*ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("fw_buff_is_enpty = (( %d ))\n", pDM_Odm->fw_buff_is_enpty));*/ - - if ((c2h_seq != pDM_Odm->pre_c2h_seq) && pDM_Odm->fw_buff_is_enpty == FALSE) { - pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue Overflow] %s\n", pDM_Odm->fw_debug_trace)); - pDM_Odm->c2h_cmd_start = 0; - } - - if ((CmdLen - 1) > (60 - pDM_Odm->c2h_cmd_start)) { - pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW Dbg Queue error: wrong C2H length] %s\n", pDM_Odm->fw_debug_trace)); - pDM_Odm->c2h_cmd_start = 0; - return; - } - - strncpy((char *)&(pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start]), (char *)&CmdBuf[1], (CmdLen-1)); - pDM_Odm->c2h_cmd_start += (CmdLen - 1); - pDM_Odm->fw_buff_is_enpty = FALSE; - - if (freg_num == 0 || pDM_Odm->c2h_cmd_start >= 60) { - if (pDM_Odm->c2h_cmd_start < 60) - pDM_Odm->fw_debug_trace[pDM_Odm->c2h_cmd_start] = '\0'; - else - pDM_Odm->fw_debug_trace[59] = '\0'; - - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace)); - /*DbgPrint("[FW DBG Msg] %s\n", pDM_Odm->fw_debug_trace);*/ - pDM_Odm->c2h_cmd_start = 0; - pDM_Odm->fw_buff_is_enpty = TRUE; - } - - pDM_Odm->pre_c2h_seq = c2h_seq; -} - -VOID -phydm_fw_trace_handler_code( - IN PVOID pDM_VOID, - IN pu1Byte Buffer, - IN u1Byte CmdLen -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte function = Buffer[0]; - u1Byte dbg_num = Buffer[1]; - u2Byte content_0 = (((u2Byte)Buffer[3])<<8)|((u2Byte)Buffer[2]); - u2Byte content_1 = (((u2Byte)Buffer[5])<<8)|((u2Byte)Buffer[4]); - u2Byte content_2 = (((u2Byte)Buffer[7])<<8)|((u2Byte)Buffer[6]); - u2Byte content_3 = (((u2Byte)Buffer[9])<<8)|((u2Byte)Buffer[8]); - u2Byte content_4 = (((u2Byte)Buffer[11])<<8)|((u2Byte)Buffer[10]); - - if(CmdLen >12) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Invalid cmd length (( %d )) >12 \n", CmdLen)); - } - - //ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE,ODM_DBG_LOUD,("[FW Msg] Func=((%d)), num=((%d)), ct_0=((%d)), ct_1=((%d)), ct_2=((%d)), ct_3=((%d)), ct_4=((%d))\n", - // function, dbg_num, content_0, content_1, content_2, content_3, content_4)); - - /*--------------------------------------------*/ -#if (CONFIG_RA_FW_DBG_CODE) - if(function == RATE_DECISION) { - if(dbg_num == 0) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", content_1, content_2)); - } else if(content_0 == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Check RA macid= ((%d)), MediaStatus=((%d)), Dis_RA=((%d)), try_bit=((0x%x))\n", content_1, content_2, content_3, content_4)); - } else if(content_0 == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Check RA total=((%d)), drop=((0x%x)), TXRPT_TRY_bit=((%x)), bNoisy=((%x))\n", content_1, content_2, content_3, content_4)); - } - } else if(dbg_num == 1) { - if (content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RTY[0,1,2,3]=[ %d , %d , %d , %d ]\n", content_1, content_2, content_3, content_4)); - } else if (content_0 == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RTY[4]=[ %d ], drop=(( %d )), total=(( %d )), current_rate=((0x %x ))", content_1, content_2, content_3, content_4)); - phydm_print_rate(pDM_Odm, (u1Byte)content_4, ODM_FW_DEBUG_TRACE); - } else if (content_0 == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] penality_idx=(( %d ))\n", content_1)); - } else if (content_0 == 4) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RSSI=(( %d )), ra_stage = (( %d ))\n", content_1, content_2)); - } - } - - else if(dbg_num == 3) { - if (content_0 == 1) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( DOWN )) total=((%d)), total>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); - else if (content_0 == 2) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) total_acc=((%d)), total_acc>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); - else if (content_0 == 3) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((Rate Down Hold)) RA_CNT=((%d))\n", content_1)); - else if (content_0 == 4) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", content_1)); - else if (content_0 == 8) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] Fast_RA (( Reset Tx Rpt )) RA_CNT=((%d))\n", content_1)); - } - - else if (dbg_num == 4) { - if (content_0 == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] RER_CNT PCR_ori =(( %d )), ratio_ori =(( %d )), pcr_updown_bitmap =(( 0x%x )), pcr_var_diff =(( %d ))\n", content_1, content_2, content_3, content_4)); - /**/ - } else if (content_0 == 4) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] pcr_shift_value =(( %s%d )), rate_down_threshold =(( %d )), rate_up_threshold =(( %d ))\n", ((content_1) ? "+" : "-"), content_2, content_3, content_4)); - /**/ - } else if (content_0 == 5) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] pcr_mean =(( %d )), PCR_VAR =(( %d )), offset =(( %d )), decision_offset_p =(( %d ))\n", content_1, content_2, content_3, content_4)); - /**/ - } - } - - else if(dbg_num == 5) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] (( UP)) Nsc=(( %d )), N_High=(( %d )), RateUp_Waiting=(( %d )), RateUp_Fail=(( %d ))\n", content_1, content_2, content_3, content_4)); - } else if(content_0 == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((DOWN)) Nsc=(( %d )), N_Low=(( %d ))\n", content_1, content_2)); - } else if(content_0 == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((HOLD)) Nsc=((%d)), N_High=((%d)), N_Low=((%d)), Reset_CNT=((%d))\n", content_1, content_2, content_3, content_4)); - } - } - else if(dbg_num == 0x60) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", content_1, content_2)); - } else if(content_0 == 4) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) pass=((%d)), rty_num=((%d)), drop=((%d)), total=((%d))\n", content_1, content_2, content_3, content_4)); - } else if(content_0 == 5) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW] ((AP RPT)) PASS=((%d)), RTY_NUM=((%d)), DROP=((%d)), TOTAL=((%d))\n", content_1, content_2, content_3, content_4)); - } - } - } - /*--------------------------------------------*/ - else if (function == INIT_RA_TABLE){ - if(dbg_num == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][INIT_RA_INFO] Ra_init, RA_SKIP_CNT = (( %d ))\n", content_0)); - } - - } - /*--------------------------------------------*/ - else if (function == RATE_UP) { - if(dbg_num == 2) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Highest rate -> return)), macid=((%d)) Nsc=((%d))\n", content_1, content_2)); - } - } else if(dbg_num == 5) { - if (content_0 == 0) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), up_rate_tmp=((0x%x)), rate_idx=((0x%x)), SGI_en=((%d)), SGI=((%d))\n", content_1, content_2, content_3, content_4)); - else if (content_0 == 1) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateUp] ((Rate UP)), rate_1=((0x%x)), rate_2=((0x%x)), BW=((%d)), Try_Bit=((%d))\n", content_1, content_2, content_3, content_4)); - } - - } - /*--------------------------------------------*/ - else if (function == RATE_DOWN) { - if(dbg_num == 5) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][RateDownStep] ((Rate Down)), macid=((%d)), rate1=((0x%x)), rate2=((0x%x)), BW=((%d))\n", content_1, content_2, content_3, content_4)); - } - } - } else if (function == TRY_DONE) { - if (dbg_num == 1) { - if (content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try succsess )) macid=((%d)), Try_Done_cnt=((%d))\n", content_1, content_2)); - /**/ - } - } else if (dbg_num == 2) { - if (content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][Try Done] ((try)) macid=((%d)), Try_Done_cnt=((%d)), rate_2=((%d)), try_succes=((%d))\n", content_1, content_2, content_3, content_4)); - /**/ - } - } - } - /*--------------------------------------------*/ - else if (function == RA_H2C) { - if (dbg_num == 1) { - if (content_0 == 0) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x49] fw_trace_en=((%d)), mode =((%d)), macid=((%d))\n", content_1, content_2, content_3)); - /**/ - /*C2H_RA_Dbg_code(F_RA_H2C,1,0, SysMib.ODM.DEBUG.fw_trace_en, mode, macid , 0); //RA MASK*/ - } - #if 0 - else if (dbg_num == 2) { - - if (content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] MACID=((%d)), Rate ID=((%d)), SGI=((%d)), BW=((%d))\n", content_1, content_2, content_3, content_4)); - /**/ - } else if (content_0 == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] VHT_en=((%d)), Disable_PowerTraining=((%d)), Disable_RA=((%d)), No_Update=((%d))\n", content_1, content_2, content_3, content_4)); - /**/ - } else if (content_0 == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][H2C=0x40] RA_MSK=[%x | %x | %x | %x ]\n", content_1, content_2, content_3, content_4)); - /**/ - } - } - #endif - } - } - /*--------------------------------------------*/ - else if (function == F_RATE_AP_RPT) { - if(dbg_num == 1) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] ((1)), SPE_STATIS=((0x%x))---------->\n", content_3)); - } - } else if(dbg_num == 2) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] RTY_all=((%d))\n", content_1)); - } - } else if(dbg_num == 3) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); - } - } else if(dbg_num == 4) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); - } - } else if(dbg_num == 5) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID1[%d], PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); - } - } else if(dbg_num == 6) { - if(content_0 == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); - } - } - } else { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); - /**/ - } -#else - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); -#endif - /*--------------------------------------------*/ - - -} - -VOID -phydm_fw_trace_handler_8051( - IN PVOID pDM_VOID, - IN pu1Byte Buffer, - IN u1Byte CmdLen -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if 0 - if (CmdLen >= 3) - CmdBuf[CmdLen - 1] = '\0'; - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s\n", &(CmdBuf[3]))); -#else - - int i = 0; - u1Byte Extend_c2hSubID = 0, Extend_c2hDbgLen = 0, Extend_c2hDbgSeq = 0; - u1Byte fw_debug_trace[128]; - pu1Byte Extend_c2hDbgContent = 0; - - if (CmdLen > 127) - return; - - Extend_c2hSubID = Buffer[0]; - Extend_c2hDbgLen = Buffer[1]; - Extend_c2hDbgContent = Buffer + 2; /*DbgSeq+DbgContent for show HEX*/ - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_DISP(FC2H, C2H_Summary, ("[Extend C2H packet], Extend_c2hSubId=0x%x, Extend_c2hDbgLen=%d\n", - Extend_c2hSubID, Extend_c2hDbgLen)); - - RT_DISP_DATA(FC2H, C2H_Summary, "[Extend C2H packet], Content Hex:", Extend_c2hDbgContent, CmdLen-2); - #endif - -GoBackforAggreDbgPkt: - i = 0; - Extend_c2hDbgSeq = Buffer[2]; - Extend_c2hDbgContent = Buffer + 3; - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_DISP(FC2H, C2H_Summary, ("[RTKFW, SEQ= %d] :", Extend_c2hDbgSeq)); - #endif - - for (; ; i++) { - fw_debug_trace[i] = Extend_c2hDbgContent[i]; - if (Extend_c2hDbgContent[i + 1] == '\0') { - fw_debug_trace[i + 1] = '\0'; - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); - break; - } else if (Extend_c2hDbgContent[i] == '\n') { - fw_debug_trace[i + 1] = '\0'; - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); - Buffer = Extend_c2hDbgContent + i + 3; - goto GoBackforAggreDbgPkt; - } - } - - -#endif -} - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void +phydm_init_debug_setting( + struct PHY_DM_STRUCT *p_dm +) +{ + p_dm->debug_level = ODM_DBG_TRACE; + + p_dm->fw_debug_components = 0; + p_dm->debug_components = + \ +#if DBG + /*BB Functions*/ + /* DBG_DIG |*/ + /* DBG_RA_MASK |*/ + /* DBG_DYN_TXPWR |*/ + /* DBG_FA_CNT |*/ + /* DBG_RSSI_MNTR |*/ + /* DBG_CCKPD |*/ + /* DBG_ANT_DIV |*/ + /* DBG_SMT_ANT |*/ + /* DBG_PWR_TRAIN |*/ + /* DBG_RA |*/ + /* DBG_PATH_DIV |*/ + /* DBG_DFS |*/ + /* DBG_DYN_ARFR |*/ + /* DBG_ADPTVTY |*/ + /* DBG_CFO_TRK |*/ + /* DBG_ENV_MNTR |*/ + /* DBG_PRI_CCA |*/ + /* DBG_ADPTV_SOML |*/ + + + /* DBG_DYN_RX_PATH |*/ + /* DBG_TMP |*/ + /* DBG_FW_TRACE |*/ + /* DBG_TXBF |*/ + /* DBG_COMMON_FLOW |*/ + /* ODM_COMP_TX_PWR_TRACK |*/ + /* ODM_COMP_CALIBRATION |*/ + /* ODM_COMP_MP |*/ + /* ODM_PHY_CONFIG |*/ + /* ODM_COMP_INIT |*/ + /* ODM_COMP_COMMON |*/ + /* ODM_COMP_API |*/ + + +#endif + 0; + + p_dm->fw_buff_is_enpty = true; + p_dm->pre_c2h_seq = 0; + p_dm->c2h_cmd_start = 0; +} + +void +phydm_bb_dbg_port_header_sel( + void *p_dm_void, + u32 header_idx +) { + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, 0x8f8, (BIT(25) | BIT(24) | BIT(23) | BIT(22)), header_idx); + + /* + header_idx: + (0:) '{ofdm_dbg[31:0]}' + (1:) '{cca,crc32_fail,dbg_ofdm[29:0]}' + (2:) '{vbon,crc32_fail,dbg_ofdm[29:0]}' + (3:) '{cca,crc32_ok,dbg_ofdm[29:0]}' + (4:) '{vbon,crc32_ok,dbg_ofdm[29:0]}' + (5:) '{dbg_iqk_anta}' + (6:) '{cca,ofdm_crc_ok,dbg_dp_anta[29:0]}' + (7:) '{dbg_iqk_antb}' + (8:) '{DBGOUT_RFC_b[31:0]}' + (9:) '{DBGOUT_RFC_a[31:0]}' + (a:) '{dbg_ofdm}' + (b:) '{dbg_cck}' + */ + } +} + +void +phydm_bb_dbg_port_clock_en( + void *p_dm_void, + u8 enable +) { + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 reg_value = 0; + + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8814A | ODM_RTL8814B)) { + + reg_value = (enable == true) ? 0x7 : 0; + odm_set_bb_reg(p_dm, 0x198c, 0x7, reg_value); /*enable/disable debug port clock, for power saving*/ + } +} + +u8 +phydm_set_bb_dbg_port( + void *p_dm_void, + u8 curr_dbg_priority, + u32 debug_port +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 dbg_port_result = false; + + if (curr_dbg_priority > p_dm->pre_dbg_priority) { + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + phydm_bb_dbg_port_clock_en(p_dm, true); + + odm_set_bb_reg(p_dm, 0x8fc, MASKDWORD, debug_port); + /**/ + } else /*if (p_dm->support_ic_type & ODM_IC_11N_SERIES)*/ { + odm_set_bb_reg(p_dm, 0x908, MASKDWORD, debug_port); + /**/ + } + PHYDM_DBG(p_dm, ODM_COMP_API, ("DbgPort ((0x%x)) set success, Cur_priority=((%d)), Pre_priority=((%d))\n", debug_port, curr_dbg_priority, p_dm->pre_dbg_priority)); + p_dm->pre_dbg_priority = curr_dbg_priority; + dbg_port_result = true; + } + + return dbg_port_result; +} + +void +phydm_release_bb_dbg_port( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + phydm_bb_dbg_port_clock_en(p_dm, false); + phydm_bb_dbg_port_header_sel(p_dm, 0); + + p_dm->pre_dbg_priority = BB_DBGPORT_RELEASE; + PHYDM_DBG(p_dm, ODM_COMP_API, ("Release BB dbg_port\n")); +} + +u32 +phydm_get_bb_dbg_port_value( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 dbg_port_value = 0; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + dbg_port_value = odm_get_bb_reg(p_dm, 0xfa0, MASKDWORD); + /**/ + } else /*if (p_dm->support_ic_type & ODM_IC_11N_SERIES)*/ { + dbg_port_value = odm_get_bb_reg(p_dm, 0xdf4, MASKDWORD); + /**/ + } + PHYDM_DBG(p_dm, ODM_COMP_API, ("dbg_port_value = 0x%x\n", dbg_port_value)); + return dbg_port_value; +} + +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + +void +phydm_bb_debug_info_n_series( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + u32 value32 = 0, value32_1 = 0; + u8 rf_gain_a = 0, rf_gain_b = 0, rf_gain_c = 0, rf_gain_d = 0; + u8 rx_snr_a = 0, rx_snr_b = 0, rx_snr_c = 0, rx_snr_d = 0; + + s8 rxevm_0 = 0, rxevm_1 = 0; + s32 short_cfo_a = 0, short_cfo_b = 0, long_cfo_a = 0, long_cfo_b = 0; + s32 scfo_a = 0, scfo_b = 0, avg_cfo_a = 0, avg_cfo_b = 0; + s32 cfo_end_a = 0, cfo_end_b = 0, acq_cfo_a = 0, acq_cfo_b = 0; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s\n", "BB Report Info")); + + /*AGC result*/ + value32 = odm_get_bb_reg(p_dm, 0xdd0, MASKDWORD); + rf_gain_a = (u8)(value32 & 0x3f); + rf_gain_a = rf_gain_a << 1; + + rf_gain_b = (u8)((value32 >> 8) & 0x3f); + rf_gain_b = rf_gain_b << 1; + + rf_gain_c = (u8)((value32 >> 16) & 0x3f); + rf_gain_c = rf_gain_c << 1; + + rf_gain_d = (u8)((value32 >> 24) & 0x3f); + rf_gain_d = rf_gain_d << 1; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", rf_gain_a, rf_gain_b, rf_gain_c, rf_gain_d)); + + /*SNR report*/ + value32 = odm_get_bb_reg(p_dm, 0xdd4, MASKDWORD); + rx_snr_a = (u8)(value32 & 0xff); + rx_snr_a = rx_snr_a >> 1; + + rx_snr_b = (u8)((value32 >> 8) & 0xff); + rx_snr_b = rx_snr_b >> 1; + + rx_snr_c = (u8)((value32 >> 16) & 0xff); + rx_snr_c = rx_snr_c >> 1; + + rx_snr_d = (u8)((value32 >> 24) & 0xff); + rx_snr_d = rx_snr_d >> 1; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D, dB)", rx_snr_a, rx_snr_b, rx_snr_c, rx_snr_d)); + + /* PostFFT related info*/ + value32 = odm_get_bb_reg(p_dm, 0xdd8, MASKDWORD); + + rxevm_0 = (s8)((value32 & MASKBYTE2) >> 16); + rxevm_0 /= 2; + if (rxevm_0 < -63) + rxevm_0 = 0; + + rxevm_1 = (s8)((value32 & MASKBYTE3) >> 24); + rxevm_1 /= 2; + if (rxevm_1 < -63) + rxevm_1 = 0; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "RXEVM (1ss/2ss)", rxevm_0, rxevm_1)); + + /*CFO Report Info*/ + odm_set_bb_reg(p_dm, 0xd00, BIT(26), 1); + + /*Short CFO*/ + value32 = odm_get_bb_reg(p_dm, 0xdac, MASKDWORD); + value32_1 = odm_get_bb_reg(p_dm, 0xdb0, MASKDWORD); + + short_cfo_b = (s32)(value32 & 0xfff); /*S(12,11)*/ + short_cfo_a = (s32)((value32 & 0x0fff0000) >> 16); + + long_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ + long_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); + + /*SFO 2's to dec*/ + if (short_cfo_a > 2047) + short_cfo_a = short_cfo_a - 4096; + if (short_cfo_b > 2047) + short_cfo_b = short_cfo_b - 4096; + + short_cfo_a = (short_cfo_a * 312500) / 2048; + short_cfo_b = (short_cfo_b * 312500) / 2048; + + /*LFO 2's to dec*/ + + if (long_cfo_a > 4095) + long_cfo_a = long_cfo_a - 8192; + + if (long_cfo_b > 4095) + long_cfo_b = long_cfo_b - 8192; + + long_cfo_a = long_cfo_a * 312500 / 4096; + long_cfo_b = long_cfo_b * 312500 / 4096; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "CFO Report Info")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "Short CFO(Hz) ", short_cfo_a, short_cfo_b)); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "Long CFO(Hz) ", long_cfo_a, long_cfo_b)); + + /*SCFO*/ + value32 = odm_get_bb_reg(p_dm, 0xdb8, MASKDWORD); + value32_1 = odm_get_bb_reg(p_dm, 0xdb4, MASKDWORD); + + scfo_b = (s32)(value32 & 0x7ff); /*S(11,10)*/ + scfo_a = (s32)((value32 & 0x07ff0000) >> 16); + + if (scfo_a > 1023) + scfo_a = scfo_a - 2048; + + if (scfo_b > 1023) + scfo_b = scfo_b - 2048; + + scfo_a = scfo_a * 312500 / 1024; + scfo_b = scfo_b * 312500 / 1024; + + avg_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ + avg_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); + + if (avg_cfo_a > 4095) + avg_cfo_a = avg_cfo_a - 8192; + + if (avg_cfo_b > 4095) + avg_cfo_b = avg_cfo_b - 8192; + + avg_cfo_a = avg_cfo_a * 312500 / 4096; + avg_cfo_b = avg_cfo_b * 312500 / 4096; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "value SCFO(Hz) ", scfo_a, scfo_b)); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "Avg CFO(Hz) ", avg_cfo_a, avg_cfo_b)); + + value32 = odm_get_bb_reg(p_dm, 0xdbc, MASKDWORD); + value32_1 = odm_get_bb_reg(p_dm, 0xde0, MASKDWORD); + + cfo_end_b = (s32)(value32 & 0x1fff); /*S(13,12)*/ + cfo_end_a = (s32)((value32 & 0x1fff0000) >> 16); + + if (cfo_end_a > 4095) + cfo_end_a = cfo_end_a - 8192; + + if (cfo_end_b > 4095) + cfo_end_b = cfo_end_b - 8192; + + cfo_end_a = cfo_end_a * 312500 / 4096; + cfo_end_b = cfo_end_b * 312500 / 4096; + + acq_cfo_b = (s32)(value32_1 & 0x1fff); /*S(13,12)*/ + acq_cfo_a = (s32)((value32_1 & 0x1fff0000) >> 16); + + if (acq_cfo_a > 4095) + acq_cfo_a = acq_cfo_a - 8192; + + if (acq_cfo_b > 4095) + acq_cfo_b = acq_cfo_b - 8192; + + acq_cfo_a = acq_cfo_a * 312500 / 4096; + acq_cfo_b = acq_cfo_b * 312500 / 4096; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "End CFO(Hz) ", cfo_end_a, cfo_end_b)); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "ACQ CFO(Hz) ", acq_cfo_a, acq_cfo_b)); + +} + + +void +phydm_bb_debug_info( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + char *tmp_string = NULL; + + u8 RX_HT_BW, RX_VHT_BW, RXSC, RX_HT, RX_BW; + static u8 v_rx_bw ; + u32 value32, value32_1, value32_2, value32_3; + s32 SFO_A, SFO_B, SFO_C, SFO_D; + s32 LFO_A, LFO_B, LFO_C, LFO_D; + static u8 MCSS, tail, parity, rsv, vrsv, idx, smooth, htsound, agg, stbc, vstbc, fec, fecext, sgi, sgiext, htltf, vgid, v_nsts, vtxops, vrsv2, vbrsv, bf, vbcrc; + static u16 h_length, htcrc8, length; + static u16 vpaid; + static u16 v_length, vhtcrc8, v_mcss, v_tail, vb_tail; + static u8 HMCSS, HRX_BW; + + u8 pwdb; + s8 RXEVM_0, RXEVM_1, RXEVM_2 ; + u8 rf_gain_path_a, rf_gain_path_b, rf_gain_path_c, rf_gain_path_d; + u8 rx_snr_path_a, rx_snr_path_b, rx_snr_path_c, rx_snr_path_d; + s32 sig_power; + + const char *L_rate[8] = {"6M", "9M", "12M", "18M", "24M", "36M", "48M", "54M"}; + +#if 0 + const double evm_comp_20M = 0.579919469776867; /* 10*log10(64.0/56.0) */ + const double evm_comp_40M = 0.503051183113957; /* 10*log10(128.0/114.0) */ + const double evm_comp_80M = 0.244245993314183; /* 10*log10(256.0/242.0) */ + const double evm_comp_160M = 0.244245993314183; /* 10*log10(512.0/484.0) */ +#endif + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + phydm_bb_debug_info_n_series(p_dm, &used, output, &out_len); + return; + } + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s\n", "BB Report Info")); + + /*BW & mode Detection*/ + + value32 = odm_get_bb_reg(p_dm, 0xf80, MASKDWORD); + value32_2 = value32; + RX_HT_BW = (u8)(value32 & 0x1); + RX_VHT_BW = (u8)((value32 >> 1) & 0x3); + RXSC = (u8)(value32 & 0x78); + value32_1 = (value32 & 0x180) >> 7; + RX_HT = (u8)(value32_1); + + RX_BW = 0; + + if (RX_HT == 2) { + if (RX_VHT_BW == 0) + tmp_string = "20M"; + else if (RX_VHT_BW == 1) + tmp_string = "40M"; + else + tmp_string = "80M"; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "mode", "VHT", tmp_string)); + RX_BW = RX_VHT_BW; + } else if (RX_HT == 1) { + if (RX_HT_BW == 0) + tmp_string = "20M"; + else if (RX_HT_BW == 1) + tmp_string = "40M"; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s %s", "mode", "HT", tmp_string)); + RX_BW = RX_HT_BW; + } else + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s %s", "mode", "Legacy")); + + if (RX_HT != 0) { + if (RXSC == 0) + tmp_string = "duplicate/full bw"; + else if (RXSC == 1) + tmp_string = "usc20-1"; + else if (RXSC == 2) + tmp_string = "lsc20-1"; + else if (RXSC == 3) + tmp_string = "usc20-2"; + else if (RXSC == 4) + tmp_string = "lsc20-2"; + else if (RXSC == 9) + tmp_string = "usc40"; + else if (RXSC == 10) + tmp_string = "lsc40"; + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s", tmp_string)); + } + + /* RX signal power and AGC related info*/ + + value32 = odm_get_bb_reg(p_dm, 0xF90, MASKDWORD); + pwdb = (u8)((value32 & MASKBYTE1) >> 8); + pwdb = pwdb >> 1; + sig_power = -110 + pwdb; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM RX Signal Power(dB)", sig_power)); + + value32 = odm_get_bb_reg(p_dm, 0xd14, MASKDWORD); + rx_snr_path_a = (u8)(value32 & 0xFF) >> 1; + rf_gain_path_a = (s8)((value32 & MASKBYTE1) >> 8); + rf_gain_path_a *= 2; + value32 = odm_get_bb_reg(p_dm, 0xd54, MASKDWORD); + rx_snr_path_b = (u8)(value32 & 0xFF) >> 1; + rf_gain_path_b = (s8)((value32 & MASKBYTE1) >> 8); + rf_gain_path_b *= 2; + value32 = odm_get_bb_reg(p_dm, 0xd94, MASKDWORD); + rx_snr_path_c = (u8)(value32 & 0xFF) >> 1; + rf_gain_path_c = (s8)((value32 & MASKBYTE1) >> 8); + rf_gain_path_c *= 2; + value32 = odm_get_bb_reg(p_dm, 0xdd4, MASKDWORD); + rx_snr_path_d = (u8)(value32 & 0xFF) >> 1; + rf_gain_path_d = (s8)((value32 & MASKBYTE1) >> 8); + rf_gain_path_d *= 2; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "OFDM RX RF Gain(A/B/C/D)", rf_gain_path_a, rf_gain_path_b, rf_gain_path_c, rf_gain_path_d)); + + + /* RX counter related info*/ + + value32 = odm_get_bb_reg(p_dm, 0xF08, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM CCA counter", ((value32 & 0xFFFF0000) >> 16))); + + value32 = odm_get_bb_reg(p_dm, 0xFD0, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "OFDM SBD Fail counter", value32 & 0xFFFF)); + + value32 = odm_get_bb_reg(p_dm, 0xFC4, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "VHT SIGA/SIGB CRC8 Fail counter", value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16))); + + value32 = odm_get_bb_reg(p_dm, 0xFCC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d", "CCK CCA counter", value32 & 0xFFFF)); + + value32 = odm_get_bb_reg(p_dm, 0xFBC, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "LSIG (parity Fail/rate Illegal) counter", value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16))); + + value32_1 = odm_get_bb_reg(p_dm, 0xFC8, MASKDWORD); + value32_2 = odm_get_bb_reg(p_dm, 0xFC0, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "HT/VHT MCS NOT SUPPORT counter", ((value32_2 & 0xFFFF0000) >> 16), value32_1 & 0xFFFF)); + + /* PostFFT related info*/ + value32 = odm_get_bb_reg(p_dm, 0xF8c, MASKDWORD); + RXEVM_0 = (s8)((value32 & MASKBYTE2) >> 16); + RXEVM_0 /= 2; + if (RXEVM_0 < -63) + RXEVM_0 = 0; + + RXEVM_1 = (s8)((value32 & MASKBYTE3) >> 24); + RXEVM_1 /= 2; + value32 = odm_get_bb_reg(p_dm, 0xF88, MASKDWORD); + RXEVM_2 = (s8)((value32 & MASKBYTE2) >> 16); + RXEVM_2 /= 2; + + if (RXEVM_1 < -63) + RXEVM_1 = 0; + if (RXEVM_2 < -63) + RXEVM_2 = 0; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d", "RXEVM (1ss/2ss/3ss)", RXEVM_0, RXEVM_1, RXEVM_2)); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d / %d", "RXSNR(A/B/C/D, dB)", rx_snr_path_a, rx_snr_path_b, rx_snr_path_c, rx_snr_path_d)); + + value32 = odm_get_bb_reg(p_dm, 0xF8C, MASKDWORD); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d", "CSI_1st /CSI_2nd", value32 & 0xFFFF, ((value32 & 0xFFFF0000) >> 16))); + + /*BW & mode Detection*/ + + /*Reset Page F counter*/ + odm_set_bb_reg(p_dm, 0xB58, BIT(0), 1); + odm_set_bb_reg(p_dm, 0xB58, BIT(0), 0); + + /*CFO Report Info*/ + /*Short CFO*/ + value32 = odm_get_bb_reg(p_dm, 0xd0c, MASKDWORD); + value32_1 = odm_get_bb_reg(p_dm, 0xd4c, MASKDWORD); + value32_2 = odm_get_bb_reg(p_dm, 0xd8c, MASKDWORD); + value32_3 = odm_get_bb_reg(p_dm, 0xdcc, MASKDWORD); + + SFO_A = (s32)(value32 & 0xfff); + SFO_B = (s32)(value32_1 & 0xfff); + SFO_C = (s32)(value32_2 & 0xfff); + SFO_D = (s32)(value32_3 & 0xfff); + + LFO_A = (s32)(value32 >> 16); + LFO_B = (s32)(value32_1 >> 16); + LFO_C = (s32)(value32_2 >> 16); + LFO_D = (s32)(value32_3 >> 16); + + /*SFO 2's to dec*/ + if (SFO_A > 2047) + SFO_A = SFO_A - 4096; + SFO_A = (SFO_A * 312500) / 2048; + if (SFO_B > 2047) + SFO_B = SFO_B - 4096; + SFO_B = (SFO_B * 312500) / 2048; + if (SFO_C > 2047) + SFO_C = SFO_C - 4096; + SFO_C = (SFO_C * 312500) / 2048; + if (SFO_D > 2047) + SFO_D = SFO_D - 4096; + SFO_D = (SFO_D * 312500) / 2048; + + /*LFO 2's to dec*/ + + if (LFO_A > 4095) + LFO_A = LFO_A - 8192; + + if (LFO_B > 4095) + LFO_B = LFO_B - 8192; + + if (LFO_C > 4095) + LFO_C = LFO_C - 8192; + + if (LFO_D > 4095) + LFO_D = LFO_D - 8192; + LFO_A = LFO_A * 312500 / 4096; + LFO_B = LFO_B * 312500 / 4096; + LFO_C = LFO_C * 312500 / 4096; + LFO_D = LFO_D * 312500 / 4096; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "CFO Report Info")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Short CFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "Long CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); + + /*SCFO*/ + value32 = odm_get_bb_reg(p_dm, 0xd10, MASKDWORD); + value32_1 = odm_get_bb_reg(p_dm, 0xd50, MASKDWORD); + value32_2 = odm_get_bb_reg(p_dm, 0xd90, MASKDWORD); + value32_3 = odm_get_bb_reg(p_dm, 0xdd0, MASKDWORD); + + SFO_A = (s32)(value32 & 0x7ff); + SFO_B = (s32)(value32_1 & 0x7ff); + SFO_C = (s32)(value32_2 & 0x7ff); + SFO_D = (s32)(value32_3 & 0x7ff); + + if (SFO_A > 1023) + SFO_A = SFO_A - 2048; + + if (SFO_B > 2047) + SFO_B = SFO_B - 4096; + + if (SFO_C > 2047) + SFO_C = SFO_C - 4096; + + if (SFO_D > 2047) + SFO_D = SFO_D - 4096; + + SFO_A = SFO_A * 312500 / 1024; + SFO_B = SFO_B * 312500 / 1024; + SFO_C = SFO_C * 312500 / 1024; + SFO_D = SFO_D * 312500 / 1024; + + LFO_A = (s32)(value32 >> 16); + LFO_B = (s32)(value32_1 >> 16); + LFO_C = (s32)(value32_2 >> 16); + LFO_D = (s32)(value32_3 >> 16); + + if (LFO_A > 4095) + LFO_A = LFO_A - 8192; + + if (LFO_B > 4095) + LFO_B = LFO_B - 8192; + + if (LFO_C > 4095) + LFO_C = LFO_C - 8192; + + if (LFO_D > 4095) + LFO_D = LFO_D - 8192; + LFO_A = LFO_A * 312500 / 4096; + LFO_B = LFO_B * 312500 / 4096; + LFO_C = LFO_C * 312500 / 4096; + LFO_D = LFO_D * 312500 / 4096; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "value SCFO(Hz) ", SFO_A, SFO_B, SFO_C, SFO_D)); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "ACQ CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); + + value32 = odm_get_bb_reg(p_dm, 0xd14, MASKDWORD); + value32_1 = odm_get_bb_reg(p_dm, 0xd54, MASKDWORD); + value32_2 = odm_get_bb_reg(p_dm, 0xd94, MASKDWORD); + value32_3 = odm_get_bb_reg(p_dm, 0xdd4, MASKDWORD); + + LFO_A = (s32)(value32 >> 16); + LFO_B = (s32)(value32_1 >> 16); + LFO_C = (s32)(value32_2 >> 16); + LFO_D = (s32)(value32_3 >> 16); + + if (LFO_A > 4095) + LFO_A = LFO_A - 8192; + + if (LFO_B > 4095) + LFO_B = LFO_B - 8192; + + if (LFO_C > 4095) + LFO_C = LFO_C - 8192; + + if (LFO_D > 4095) + LFO_D = LFO_D - 8192; + + LFO_A = LFO_A * 312500 / 4096; + LFO_B = LFO_B * 312500 / 4096; + LFO_C = LFO_C * 312500 / 4096; + LFO_D = LFO_D * 312500 / 4096; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d / %d / %d /%d", "End CFO(Hz) ", LFO_A, LFO_B, LFO_C, LFO_D)); + + value32 = odm_get_bb_reg(p_dm, 0xf20, MASKDWORD); /*L SIG*/ + + tail = (u8)((value32 & 0xfc0000) >> 16); + parity = (u8)((value32 & 0x20000) >> 16); + length = (u16)((value32 & 0x1ffe00) >> 8); + rsv = (u8)(value32 & 0x10); + MCSS = (u8)(value32 & 0x0f); + + switch (MCSS) { + case 0x0b: + idx = 0; + break; + case 0x0f: + idx = 1; + break; + case 0x0a: + idx = 2; + break; + case 0x0e: + idx = 3; + break; + case 0x09: + idx = 4; + break; + case 0x08: + idx = 5; + break; + case 0x0c: + idx = 6; + break; + default: + idx = 6; + break; + + } + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "L-SIG")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s : %s", "rate", L_rate[idx])); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "Rsv/length/parity", rsv, RX_BW, length)); + + value32 = odm_get_bb_reg(p_dm, 0xf2c, MASKDWORD); /*HT SIG*/ + if (RX_HT == 1) { + + HMCSS = (u8)(value32 & 0x7F); + HRX_BW = (u8)(value32 & 0x80); + h_length = (u16)((value32 >> 8) & 0xffff); + } + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG1")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x", "MCS/BW/length", HMCSS, HRX_BW, h_length)); + + value32 = odm_get_bb_reg(p_dm, 0xf30, MASKDWORD); /*HT SIG*/ + + if (RX_HT == 1) { + smooth = (u8)(value32 & 0x01); + htsound = (u8)(value32 & 0x02); + rsv = (u8)(value32 & 0x04); + agg = (u8)(value32 & 0x08); + stbc = (u8)(value32 & 0x30); + fec = (u8)(value32 & 0x40); + sgi = (u8)(value32 & 0x80); + htltf = (u8)((value32 & 0x300) >> 8); + htcrc8 = (u16)((value32 & 0x3fc00) >> 8); + tail = (u8)((value32 & 0xfc0000) >> 16); + } + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "HT-SIG2")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x", "Smooth/NoSound/Rsv/Aggregate/STBC/LDPC", smooth, htsound, rsv, agg, stbc, fec)); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "SGI/E-HT-LTFs/CRC/tail", sgi, htltf, htcrc8, tail)); + + value32 = odm_get_bb_reg(p_dm, 0xf2c, MASKDWORD); /*VHT SIG A1*/ + if (RX_HT == 2) { + /* value32 = odm_get_bb_reg(p_dm, 0xf2c,MASKDWORD);*/ + v_rx_bw = (u8)(value32 & 0x03); + vrsv = (u8)(value32 & 0x04); + vstbc = (u8)(value32 & 0x08); + vgid = (u8)((value32 & 0x3f0) >> 4); + v_nsts = (u8)(((value32 & 0x1c00) >> 8) + 1); + vpaid = (u16)(value32 & 0x3fe); + vtxops = (u8)((value32 & 0x400000) >> 20); + vrsv2 = (u8)((value32 & 0x800000) >> 20); + } + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A1")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x / %x", "BW/Rsv1/STBC/GID/Nsts/PAID/TXOPPS/Rsv2", v_rx_bw, vrsv, vstbc, vgid, v_nsts, vpaid, vtxops, vrsv2)); + + value32 = odm_get_bb_reg(p_dm, 0xf30, MASKDWORD); /*VHT SIG*/ + + if (RX_HT == 2) { + /*value32 = odm_get_bb_reg(p_dm, 0xf30,MASKDWORD); */ /*VHT SIG*/ + + /* sgi=(u8)(value32&0x01); */ + sgiext = (u8)(value32 & 0x03); + /* fec = (u8)(value32&0x04); */ + fecext = (u8)(value32 & 0x0C); + + v_mcss = (u8)(value32 & 0xf0); + bf = (u8)((value32 & 0x100) >> 8); + vrsv = (u8)((value32 & 0x200) >> 8); + vhtcrc8 = (u16)((value32 & 0x3fc00) >> 8); + v_tail = (u8)((value32 & 0xfc0000) >> 16); + } + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-A2")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x / %x / %x / %x", "SGI/FEC/MCS/BF/Rsv/CRC/tail", sgiext, fecext, v_mcss, bf, vrsv, vhtcrc8, v_tail)); + + value32 = odm_get_bb_reg(p_dm, 0xf34, MASKDWORD); /*VHT SIG*/ + { + v_length = (u16)(value32 & 0x1fffff); + vbrsv = (u8)((value32 & 0x600000) >> 20); + vb_tail = (u16)((value32 & 0x1f800000) >> 20); + vbcrc = (u8)((value32 & 0x80000000) >> 28); + + } + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s", "VHT-SIG-B")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %x / %x / %x / %x", "length/Rsv/tail/CRC", v_length, vbrsv, vb_tail, vbcrc)); + + /*for Condition number*/ + if (p_dm->support_ic_type & ODM_RTL8822B) { + s32 condition_num = 0; + char *factor = NULL; + + odm_set_bb_reg(p_dm, 0x1988, BIT(22), 0x1); /*enable report condition number*/ + + condition_num = odm_get_bb_reg(p_dm, 0xf84, MASKDWORD); + condition_num = (condition_num & 0x3ffff) >> 4; + + if (*p_dm->p_band_width == CHANNEL_WIDTH_80) + factor = "256/234"; + else if (*p_dm->p_band_width == CHANNEL_WIDTH_40) + factor = "128/108"; + else if (*p_dm->p_band_width == CHANNEL_WIDTH_20) { + if (RX_HT != 2 || RX_HT != 1) + factor = "64/52"; /*HT or VHT*/ + else + factor = "64/48"; /*legacy*/ + } + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = %d (factor = %s)", "Condition number", condition_num, factor)); + + } + *_used = used; + *_out_len = out_len; + +} +#endif /*#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION +void phydm_sbd_check( + struct PHY_DM_STRUCT *p_dm +) +{ + static u32 pkt_cnt = 0; + static boolean sbd_state = 0; + u32 sym_count, count, value32; + + if (sbd_state == 0) { + pkt_cnt++; + if (pkt_cnt % 5 == 0) { /*read SBD conter once every 5 packets*/ + odm_set_timer(p_dm, &p_dm->sbdcnt_timer, 0); /*ms*/ + sbd_state = 1; + } + } else { /*read counter*/ + value32 = odm_get_bb_reg(p_dm, 0xF98, MASKDWORD); + sym_count = (value32 & 0x7C000000) >> 26; + count = (value32 & 0x3F00000) >> 20; + dbg_print("#SBD# sym_count %d count %d\n", sym_count, count); + sbd_state = 0; + } +} +#endif + +void phydm_sbd_callback( + struct timer_list *p_timer +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct _ADAPTER *adapter = (struct _ADAPTER *)p_timer->Adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + #if USE_WORKITEM + odm_schedule_work_item(&p_dm->sbdcnt_workitem); + #else + phydm_sbd_check(p_dm); + #endif +#endif +} + +void phydm_sbd_workitem_callback( + void *p_context +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + phydm_sbd_check(p_dm); +#endif +} +#endif + +void +phydm_reset_rx_rate_distribution( + struct PHY_DM_STRUCT *p_dm_odm +) +{ + struct _odm_phy_dbg_info_ *p_dbg = &(p_dm_odm->phy_dbg_info); + + odm_memory_set(p_dm_odm, &(p_dbg->num_qry_legacy_pkt[0]), 0, (LEGACY_RATE_NUM * 2)); + odm_memory_set(p_dm_odm, &(p_dbg->num_qry_ht_pkt[0]), 0, (HT_RATE_NUM * 2)); + p_dbg->ht_pkt_not_zero = false; + +#if ODM_IC_11AC_SERIES_SUPPORT + odm_memory_set(p_dm_odm, &(p_dbg->num_qry_vht_pkt[0]), 0, (VHT_RATE_NUM * 2)); + p_dbg->vht_pkt_not_zero = false; +#endif +} + +void +phydm_rx_rate_distribution +( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _odm_phy_dbg_info_ *p_dbg = &(p_dm->phy_dbg_info); + u8 i = 0, j = 0; + u8 rate_num = 1, rate_ss_shift = 0; + + if (p_dm->support_ic_type & ODM_IC_4SS) + rate_num = 4; + else if (p_dm->support_ic_type & ODM_IC_3SS) + rate_num = 3; + else if (p_dm->support_ic_type & ODM_IC_2SS) + rate_num = 2; + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[RxRate Cnt] =============>\n")); + + /*======CCK=============================================================*/ + if (*(p_dm->p_channel) <= 14) { + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* CCK = {%d, %d, %d, %d}\n", + p_dbg->num_qry_legacy_pkt[0], + p_dbg->num_qry_legacy_pkt[1], + p_dbg->num_qry_legacy_pkt[2], + p_dbg->num_qry_legacy_pkt[3] + )); + } + /*======OFDM============================================================*/ + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* OFDM = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + p_dbg->num_qry_legacy_pkt[4], p_dbg->num_qry_legacy_pkt[5], + p_dbg->num_qry_legacy_pkt[6], p_dbg->num_qry_legacy_pkt[7], + p_dbg->num_qry_legacy_pkt[8], p_dbg->num_qry_legacy_pkt[9], + p_dbg->num_qry_legacy_pkt[10], p_dbg->num_qry_legacy_pkt[11])); + + /*======HT==============================================================*/ + if (p_dbg->ht_pkt_not_zero) { + + for (i = 0; i < rate_num; i++) { + + rate_ss_shift = (i << 3); + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (rate_ss_shift), (rate_ss_shift+7), + p_dbg->num_qry_ht_pkt[rate_ss_shift + 0], p_dbg->num_qry_ht_pkt[rate_ss_shift + 1], + p_dbg->num_qry_ht_pkt[rate_ss_shift + 2], p_dbg->num_qry_ht_pkt[rate_ss_shift + 3], + p_dbg->num_qry_ht_pkt[rate_ss_shift + 4], p_dbg->num_qry_ht_pkt[rate_ss_shift + 5], + p_dbg->num_qry_ht_pkt[rate_ss_shift + 6], p_dbg->num_qry_ht_pkt[rate_ss_shift + 7])); + + } + } + +#if ODM_IC_11AC_SERIES_SUPPORT + /*======VHT=============================================================*/ + if (p_dbg->vht_pkt_not_zero){ + + for (i = 0; i < rate_num; i++) { + + rate_ss_shift = 10 * i; + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + p_dbg->num_qry_vht_pkt[rate_ss_shift + 0], p_dbg->num_qry_vht_pkt[rate_ss_shift + 1], + p_dbg->num_qry_vht_pkt[rate_ss_shift + 2], p_dbg->num_qry_vht_pkt[rate_ss_shift + 3], + p_dbg->num_qry_vht_pkt[rate_ss_shift + 4], p_dbg->num_qry_vht_pkt[rate_ss_shift + 5], + p_dbg->num_qry_vht_pkt[rate_ss_shift + 6], p_dbg->num_qry_vht_pkt[rate_ss_shift + 7], + p_dbg->num_qry_vht_pkt[rate_ss_shift + 8], p_dbg->num_qry_vht_pkt[rate_ss_shift + 9])); + + } + } +#endif + +} + +void +phydm_get_avg_phystatus_val +( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_phystatus_statistic *p_dbg_statistic = &(p_dm->phy_dbg_info.phystatus_statistic_info); + struct phydm_phystatus_avg *p_dbg_avg = &(p_dm->phy_dbg_info.phystatus_statistic_avg); + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[Avg PHY Statistic] ==============>\n")); + + phydm_reset_phystatus_avg(p_dm); + + /*CCK*/ + p_dbg_avg->rssi_cck_avg = (u8)((p_dbg_statistic->rssi_cck_cnt != 0) ? (p_dbg_statistic->rssi_cck_sum/p_dbg_statistic->rssi_cck_cnt) : 0); + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* cck Cnt= ((%d)) RSSI:{%d}\n", p_dbg_statistic->rssi_cck_cnt, p_dbg_avg->rssi_cck_avg)); + + /*OFDM*/ + if (p_dbg_statistic->rssi_ofdm_cnt != 0) { + p_dbg_avg->rssi_ofdm_avg = (u8)(p_dbg_statistic->rssi_ofdm_sum/p_dbg_statistic->rssi_ofdm_cnt); + p_dbg_avg->evm_ofdm_avg = (u8)(p_dbg_statistic->evm_ofdm_sum/p_dbg_statistic->rssi_ofdm_cnt); + p_dbg_avg->snr_ofdm_avg = (u8)(p_dbg_statistic->snr_ofdm_sum/p_dbg_statistic->rssi_ofdm_cnt); + } + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* ofdm Cnt= ((%d)) RSSI:{%d} EVM:{%d} SNR:{%d}\n", + p_dbg_statistic->rssi_ofdm_cnt, p_dbg_avg->rssi_ofdm_avg, p_dbg_avg->evm_ofdm_avg, p_dbg_avg->snr_ofdm_avg)); + + if (p_dbg_statistic->rssi_1ss_cnt != 0) { + p_dbg_avg->rssi_1ss_avg = (u8)(p_dbg_statistic->rssi_1ss_sum/p_dbg_statistic->rssi_1ss_cnt); + p_dbg_avg->evm_1ss_avg = (u8)(p_dbg_statistic->evm_1ss_sum/p_dbg_statistic->rssi_1ss_cnt); + p_dbg_avg->snr_1ss_avg = (u8)(p_dbg_statistic->snr_1ss_sum/p_dbg_statistic->rssi_1ss_cnt); + } + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* 1-ss Cnt= ((%d)) RSSI:{%d} EVM:{%d} SNR:{%d}\n", + p_dbg_statistic->rssi_1ss_cnt, p_dbg_avg->rssi_1ss_avg, p_dbg_avg->evm_1ss_avg, p_dbg_avg->snr_1ss_avg)); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (p_dm->support_ic_type & (PHYDM_IC_ABOVE_2SS)) { + + if (p_dbg_statistic->rssi_2ss_cnt != 0) { + p_dbg_avg->rssi_2ss_avg[0] = (u8)(p_dbg_statistic->rssi_2ss_sum[0] /p_dbg_statistic->rssi_2ss_cnt); + p_dbg_avg->rssi_2ss_avg[1] = (u8)(p_dbg_statistic->rssi_2ss_sum[1] /p_dbg_statistic->rssi_2ss_cnt); + + p_dbg_avg->evm_2ss_avg[0] = (u8)(p_dbg_statistic->evm_2ss_sum[0] /p_dbg_statistic->rssi_2ss_cnt); + p_dbg_avg->evm_2ss_avg[1] = (u8)(p_dbg_statistic->evm_2ss_sum[1] /p_dbg_statistic->rssi_2ss_cnt); + + p_dbg_avg->snr_2ss_avg[0] = (u8)(p_dbg_statistic->snr_2ss_sum[0] /p_dbg_statistic->rssi_2ss_cnt); + p_dbg_avg->snr_2ss_avg[1] = (u8)(p_dbg_statistic->snr_2ss_sum[1] /p_dbg_statistic->rssi_2ss_cnt); + } + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* 2-ss Cnt= ((%d)) RSSI:{%d, %d}, EVM:{%d, %d}, SNR:{%d, %d}\n", + p_dbg_statistic->rssi_2ss_cnt, + p_dbg_avg->rssi_2ss_avg[0], p_dbg_avg->rssi_2ss_avg[1], + p_dbg_avg->evm_2ss_avg[0], p_dbg_avg->evm_2ss_avg[1], + p_dbg_avg->snr_2ss_avg[0], p_dbg_avg->snr_2ss_avg[1])); + } + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (p_dm->support_ic_type & (PHYDM_IC_ABOVE_3SS)) { + + if (p_dbg_statistic->rssi_3ss_cnt != 0) { + p_dbg_avg->rssi_3ss_avg[0] = (u8)(p_dbg_statistic->rssi_3ss_sum[0] /p_dbg_statistic->rssi_3ss_cnt); + p_dbg_avg->rssi_3ss_avg[1] = (u8)(p_dbg_statistic->rssi_3ss_sum[1] /p_dbg_statistic->rssi_3ss_cnt); + p_dbg_avg->rssi_3ss_avg[2] = (u8)(p_dbg_statistic->rssi_3ss_sum[2] /p_dbg_statistic->rssi_3ss_cnt); + + p_dbg_avg->evm_3ss_avg[0] = (u8)(p_dbg_statistic->evm_3ss_sum[0] /p_dbg_statistic->rssi_3ss_cnt); + p_dbg_avg->evm_3ss_avg[1] = (u8)(p_dbg_statistic->evm_3ss_sum[1] /p_dbg_statistic->rssi_3ss_cnt); + p_dbg_avg->evm_3ss_avg[2] = (u8)(p_dbg_statistic->evm_3ss_sum[2] /p_dbg_statistic->rssi_3ss_cnt); + + p_dbg_avg->snr_3ss_avg[0] = (u8)(p_dbg_statistic->snr_3ss_sum[0] /p_dbg_statistic->rssi_3ss_cnt); + p_dbg_avg->snr_3ss_avg[1] = (u8)(p_dbg_statistic->snr_3ss_sum[1] /p_dbg_statistic->rssi_3ss_cnt); + p_dbg_avg->snr_3ss_avg[2] = (u8)(p_dbg_statistic->snr_3ss_sum[2] /p_dbg_statistic->rssi_3ss_cnt); + } + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* 3-ss Cnt= ((%d)) RSSI:{%d, %d, %d} EVM:{%d, %d, %d} SNR:{%d, %d, %d}\n", + p_dbg_statistic->rssi_3ss_cnt, + p_dbg_avg->rssi_3ss_avg[0], p_dbg_avg->rssi_3ss_avg[1], p_dbg_avg->rssi_3ss_avg[2], + p_dbg_avg->evm_3ss_avg[0], p_dbg_avg->evm_3ss_avg[1], p_dbg_avg->evm_3ss_avg[2], + p_dbg_avg->snr_3ss_avg[0], p_dbg_avg->snr_3ss_avg[1], p_dbg_avg->snr_3ss_avg[2])); + } + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (p_dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + + if (p_dbg_statistic->rssi_4ss_cnt != 0) { + p_dbg_avg->rssi_4ss_avg[0] = (u8)(p_dbg_statistic->rssi_4ss_sum[0] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->rssi_4ss_avg[1] = (u8)(p_dbg_statistic->rssi_4ss_sum[1] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->rssi_4ss_avg[2] = (u8)(p_dbg_statistic->rssi_4ss_sum[2] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->rssi_4ss_avg[3] = (u8)(p_dbg_statistic->rssi_4ss_sum[3] /p_dbg_statistic->rssi_4ss_cnt); + + p_dbg_avg->evm_4ss_avg[0] = (u8)(p_dbg_statistic->evm_4ss_sum[0] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->evm_4ss_avg[1] = (u8)(p_dbg_statistic->evm_4ss_sum[1] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->evm_4ss_avg[2] = (u8)(p_dbg_statistic->evm_4ss_sum[2] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->evm_4ss_avg[3] = (u8)(p_dbg_statistic->evm_4ss_sum[3] /p_dbg_statistic->rssi_4ss_cnt); + + p_dbg_avg->snr_4ss_avg[0] = (u8)(p_dbg_statistic->snr_4ss_sum[0] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->snr_4ss_avg[1] = (u8)(p_dbg_statistic->snr_4ss_sum[1] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->snr_4ss_avg[2] = (u8)(p_dbg_statistic->snr_4ss_sum[2] /p_dbg_statistic->rssi_4ss_cnt); + p_dbg_avg->snr_4ss_avg[3] = (u8)(p_dbg_statistic->snr_4ss_sum[3] /p_dbg_statistic->rssi_4ss_cnt); + } + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("* 4-ss Cnt= ((%d)) RSSI:{%d, %d, %d, %d} EVM:{%d, %d, %d, %d} SNR:{%d, %d, %d, %d}\n", + p_dbg_statistic->rssi_4ss_cnt, + p_dbg_avg->rssi_4ss_avg[0], p_dbg_avg->rssi_4ss_avg[1], p_dbg_avg->rssi_4ss_avg[2], p_dbg_avg->rssi_4ss_avg[3], + p_dbg_avg->evm_4ss_avg[0], p_dbg_avg->evm_4ss_avg[1], p_dbg_avg->evm_4ss_avg[2], p_dbg_avg->evm_4ss_avg[3], + p_dbg_avg->snr_4ss_avg[0], p_dbg_avg->snr_4ss_avg[1], p_dbg_avg->snr_4ss_avg[2], p_dbg_avg->snr_4ss_avg[3])); + } + #endif + + + +} + +void +phydm_get_phy_statistic( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + phydm_rx_rate_distribution(p_dm); + phydm_reset_rx_rate_distribution(p_dm); + + phydm_get_avg_phystatus_val(p_dm); + phydm_reset_phystatus_statistic(p_dm); +}; + +void +phydm_basic_dbg_message +( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_struct *false_alm_cnt = (struct phydm_fa_struct *)phydm_get_structure(p_dm, PHYDM_FALSEALMCNT); + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u16 macid, phydm_macid, client_cnt = 0; + struct cmn_sta_info *p_entry = NULL; + s32 tmp_val = 0; + u8 tmp_val_u1 = 0; + + if (!(p_dm->debug_components & ODM_COMP_COMMON)) + return; + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[PHYDM Common MSG] System up time: ((%d sec))----->\n", p_dm->phydm_sys_up_time)); + + if (p_dm->is_linked) { + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("ID=((%d)), BW=((%d)), fc=((CH-%d))\n", p_dm->curr_station_id, 20<<(*(p_dm->p_band_width)), *(p_dm->p_channel))); + + if ((*(p_dm->p_channel) <= 14) && (*(p_dm->p_band_width) == CHANNEL_WIDTH_40)) { + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("Primary CCA at ((%s SB))\n", + (((*(p_dm->p_sec_ch_offset)) == SECOND_CH_AT_LSB)?"U":"L"))); + } + + if ((p_dm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) || p_dm->rx_rate > ODM_RATE11M) { + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[AGC Idx] {0x%x, 0x%x, 0x%x, 0x%x}\n", + p_dm->ofdm_agc_idx[0], p_dm->ofdm_agc_idx[1], p_dm->ofdm_agc_idx[2], p_dm->ofdm_agc_idx[3])); + } else { + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[CCK AGC Idx] {LNA, VGA}={0x%x, 0x%x}\n", + p_dm->cck_lna_idx, p_dm->cck_vga_idx)); + } + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("RSSI:{%d, %d, %d, %d}, RxRate:", + (p_dm->RSSI_A == 0xff) ? 0 : p_dm->RSSI_A, + (p_dm->RSSI_B == 0xff) ? 0 : p_dm->RSSI_B, + (p_dm->RSSI_C == 0xff) ? 0 : p_dm->RSSI_C, + (p_dm->RSSI_D == 0xff) ? 0 : p_dm->RSSI_D)); + + phydm_print_rate(p_dm, p_dm->rx_rate, ODM_COMP_COMMON); + + phydm_get_phy_statistic(p_dm); + + /*Print TX rate*/ + for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + + p_entry = p_dm->p_phydm_sta_info[macid]; + if (!is_sta_active(p_entry)) { + continue; + } + + phydm_macid = (p_dm->phydm_macid_table[macid]); + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("TxRate[%d]:", macid)); + phydm_print_rate(p_dm, p_entry->ra_info.curr_tx_rate, ODM_COMP_COMMON); + + client_cnt++; + + if (client_cnt >= p_dm->number_linked_client) + break; + } + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("TP {Tx, Rx, Total} = {%d, %d, %d}Mbps, Traffic_Load=(%d))\n", + p_dm->tx_tp, p_dm->rx_tp, p_dm->total_tp, p_dm->traffic_load)); + + tmp_val_u1 = (p_cfo_track->crystal_cap > p_cfo_track->def_x_cap) ? (p_cfo_track->crystal_cap - p_cfo_track->def_x_cap) : (p_cfo_track->def_x_cap - p_cfo_track->crystal_cap); + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("CFO_avg = ((%d kHz)) , CFO_tracking = ((%s%d))\n", + p_cfo_track->CFO_ave_pre, ((p_cfo_track->crystal_cap > p_cfo_track->def_x_cap) ? "+" : "-"), tmp_val_u1)); + + /* Condition number */ + #if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + tmp_val = phydm_get_condition_number_8822B(p_dm); + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("Condi_Num=((%d))\n", tmp_val)); + } + #endif + + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + /*STBC or LDPC pkt*/ + if (p_dm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("Coding: LDPC=((%s)), STBC=((%s))\n", (p_dm->phy_dbg_info.is_ldpc_pkt) ? "Y" : "N", (p_dm->phy_dbg_info.is_stbc_pkt) ? "Y" : "N")); + #endif + } else + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("No Link !!!\n")); + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + false_alm_cnt->cnt_cck_cca, false_alm_cnt->cnt_ofdm_cca, false_alm_cnt->cnt_cca_all)); + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + false_alm_cnt->cnt_cck_fail, false_alm_cnt->cnt_ofdm_fail, false_alm_cnt->cnt_all)); + + #if (ODM_IC_11N_SERIES_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("[OFDM FA Detail] Parity_Fail = (( %d )), Rate_Illegal = (( %d )), CRC8_fail = (( %d )), Mcs_fail = (( %d )), Fast_Fsync = (( %d )), SB_Search_fail = (( %d ))\n", + false_alm_cnt->cnt_parity_fail, false_alm_cnt->cnt_rate_illegal, false_alm_cnt->cnt_crc8_fail, false_alm_cnt->cnt_mcs_fail, false_alm_cnt->cnt_fast_fsync, false_alm_cnt->cnt_sb_search_fail)); + } + #endif + + PHYDM_DBG(p_dm, ODM_COMP_COMMON, ("is_linked = %d, Num_client = %d, rssi_min = %d, IGI = 0x%x, bNoisy=%d\n\n", + p_dm->is_linked, p_dm->number_linked_client, p_dm->rssi_min, p_dig_t->cur_ig_value, p_dm->noisy_decision)); + +#endif +} + + +void phydm_basic_profile( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + char *cut = NULL; + char *ic_type = NULL; + u32 used = *_used; + u32 out_len = *_out_len; + u32 date = 0; + char *commit_by = NULL; + u32 release_ver = 0; + + PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% Basic Profile %")); + + if (p_dm->support_ic_type == ODM_RTL8188E) { +#if (RTL8188E_SUPPORT == 1) + ic_type = "RTL8188E"; + date = RELEASE_DATE_8188E; + commit_by = COMMIT_BY_8188E; + release_ver = RELEASE_VERSION_8188E; +#endif + } +#if (RTL8812A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8812) { + ic_type = "RTL8812A"; + date = RELEASE_DATE_8812A; + commit_by = COMMIT_BY_8812A; + release_ver = RELEASE_VERSION_8812A; + } +#endif +#if (RTL8821A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8821) { + ic_type = "RTL8821A"; + date = RELEASE_DATE_8821A; + commit_by = COMMIT_BY_8821A; + release_ver = RELEASE_VERSION_8821A; + } +#endif +#if (RTL8192E_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8192E) { + ic_type = "RTL8192E"; + date = RELEASE_DATE_8192E; + commit_by = COMMIT_BY_8192E; + release_ver = RELEASE_VERSION_8192E; + } +#endif +#if (RTL8723B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8723B) { + ic_type = "RTL8723B"; + date = RELEASE_DATE_8723B; + commit_by = COMMIT_BY_8723B; + release_ver = RELEASE_VERSION_8723B; + } +#endif +#if (RTL8814A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8814A) { + ic_type = "RTL8814A"; + date = RELEASE_DATE_8814A; + commit_by = COMMIT_BY_8814A; + release_ver = RELEASE_VERSION_8814A; + } +#endif +#if (RTL8881A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8881A) { + ic_type = "RTL8881A"; + /**/ + } +#endif +#if (RTL8822B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8822B) { + ic_type = "RTL8822B"; + date = RELEASE_DATE_8822B; + commit_by = COMMIT_BY_8822B; + release_ver = RELEASE_VERSION_8822B; + } +#endif +#if (RTL8197F_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8197F) { + ic_type = "RTL8197F"; + date = RELEASE_DATE_8197F; + commit_by = COMMIT_BY_8197F; + release_ver = RELEASE_VERSION_8197F; + } +#endif + +#if (RTL8703B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8703B) { + + ic_type = "RTL8703B"; + date = RELEASE_DATE_8703B; + commit_by = COMMIT_BY_8703B; + release_ver = RELEASE_VERSION_8703B; + + } +#endif +#if (RTL8195A_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8195A) { + ic_type = "RTL8195A"; + /**/ + } +#endif +#if (RTL8188F_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8188F) { + ic_type = "RTL8188F"; + date = RELEASE_DATE_8188F; + commit_by = COMMIT_BY_8188F; + release_ver = RELEASE_VERSION_8188F; + } +#endif +#if (RTL8723D_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8723D) { + ic_type = "RTL8723D"; + date = RELEASE_DATE_8723D; + commit_by = COMMIT_BY_8723D; + release_ver = RELEASE_VERSION_8723D; + /**/ + } +#endif + +/* JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8710B) { + ic_type = "RTL8710B"; + date = RELEASE_DATE_8710B; + commit_by = COMMIT_BY_8710B; + release_ver = RELEASE_VERSION_8710B; + /**/ + } +#endif + +#if (RTL8821C_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8821C) { + ic_type = "RTL8821C"; + date = RELEASE_DATE_8821C; + commit_by = COMMIT_BY_8821C; + release_ver = RELEASE_VERSION_8821C; + } +#endif + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s (MP Chip: %s)\n", "IC type", ic_type, p_dm->is_mp_chip ? "Yes" : "No")); + + if (p_dm->cut_version == ODM_CUT_A) + cut = "A"; + else if (p_dm->cut_version == ODM_CUT_B) + cut = "B"; + else if (p_dm->cut_version == ODM_CUT_C) + cut = "C"; + else if (p_dm->cut_version == ODM_CUT_D) + cut = "D"; + else if (p_dm->cut_version == ODM_CUT_E) + cut = "E"; + else if (p_dm->cut_version == ODM_CUT_F) + cut = "F"; + else if (p_dm->cut_version == ODM_CUT_I) + cut = "I"; + + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "RFE type", p_dm->rfe_type)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Cut Ver", cut)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Para Ver", odm_get_hw_img_version(p_dm))); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Para Commit date", date)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY Para Commit by", commit_by)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d\n", "PHY Para Release Ver", release_ver)); + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + { + struct _ADAPTER *adapter = p_dm->adapter; + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Ver", adapter->MgntInfo.FirmwareVersion, adapter->MgntInfo.FirmwareSubVersion)); + } +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + { + struct rtl8192cd_priv *priv = p_dm->priv; + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Ver", priv->pshare->fw_version, priv->pshare->fw_sub_version)); + } +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + { + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + struct rtl_hal *rtlhal = rtl_hal(rtlpriv); + + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Ver", rtlhal->fw_version, rtlhal->fw_subversion)); + } +#else + { + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %d (Subversion: %d)\n", "FW Ver", p_hal_data->firmware_version, p_hal_data->firmware_sub_version)); + } +#endif + /* 1 PHY DM version List */ + PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "% PHYDM version %")); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Code base", PHYDM_CODE_BASE)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Release Date", PHYDM_RELEASE_DATE)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Adaptivity", ADAPTIVITY_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "DIG", DIG_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "CFO Tracking", CFO_TRACKING_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "AntDiv", ANTDIV_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Dynamic TxPower", DYNAMIC_TXPWR_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "RA Info", RAINFO_VERSION)); +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "AntDetect", ANTDECT_VERSION)); +#endif + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "ACS", ACS_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PathDiv", PATHDIV_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "LA mode", DYNAMIC_LA_MODE)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "Primary CCA", PRIMARYCCA_VERSION)); + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "DFS", DFS_VERSION)); + +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8822B) + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8822B", PHY_CONFIG_VERSION_8822B)); + +#endif +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s: %s\n", "PHY config 8197F", PHY_CONFIG_VERSION_8197F)); +#endif + *_used = used; + *_out_len = out_len; +#endif /*#if CONFIG_PHYDM_DEBUG_FUNCTION*/ +} + +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION +void +phydm_fw_trace_en_h2c( + void *p_dm_void, + boolean enable, + u32 fw_debug_component, + u32 monitor_mode, + u32 macid +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 h2c_parameter[7] = {0}; + u8 cmd_length; + + if (p_dm->support_ic_type & PHYDM_IC_3081_SERIES) { + + h2c_parameter[0] = enable; + h2c_parameter[1] = (u8)(fw_debug_component & MASKBYTE0); + h2c_parameter[2] = (u8)((fw_debug_component & MASKBYTE1) >> 8); + h2c_parameter[3] = (u8)((fw_debug_component & MASKBYTE2) >> 16); + h2c_parameter[4] = (u8)((fw_debug_component & MASKBYTE3) >> 24); + h2c_parameter[5] = (u8)monitor_mode; + h2c_parameter[6] = (u8)macid; + cmd_length = 7; + + } else { + + h2c_parameter[0] = enable; + h2c_parameter[1] = (u8)monitor_mode; + h2c_parameter[2] = (u8)macid; + cmd_length = 3; + } + + + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("---->\n")); + if (monitor_mode == 0) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[H2C] FW_debug_en: (( %d ))\n", enable)); + else + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[H2C] FW_debug_en: (( %d )), mode: (( %d )), macid: (( %d ))\n", enable, monitor_mode, macid)); + odm_fill_h2c_cmd(p_dm, PHYDM_H2C_FW_TRACE_EN, cmd_length, h2c_parameter); +} + +void +phydm_get_per_path_txagc( + void *p_dm_void, + u8 path, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 rate_idx; + u8 txagc; + u32 used = *_used; + u32 out_len = *_out_len; + +#ifdef PHYDM_COMMON_API_SUPPORT + if (((p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) && (path <= RF_PATH_B)) || + ((p_dm->support_ic_type & (ODM_RTL8821C)) && (path <= RF_PATH_A))) { + for (rate_idx = 0; rate_idx <= 0x53; rate_idx++) { + if (rate_idx == ODM_RATE1M) + PHYDM_SNPRINTF((output + used, out_len - used, " %-35s\n", "CCK====>")); + else if (rate_idx == ODM_RATE6M) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "OFDM====>")); + else if (rate_idx == ODM_RATEMCS0) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 1ss====>")); + else if (rate_idx == ODM_RATEMCS8) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 2ss====>")); + else if (rate_idx == ODM_RATEMCS16) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 3ss====>")); + else if (rate_idx == ODM_RATEMCS24) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "HT 4ss====>")); + else if (rate_idx == ODM_RATEVHTSS1MCS0) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 1ss====>")); + else if (rate_idx == ODM_RATEVHTSS2MCS0) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 2ss====>")); + else if (rate_idx == ODM_RATEVHTSS3MCS0) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 3ss====>")); + else if (rate_idx == ODM_RATEVHTSS4MCS0) + PHYDM_SNPRINTF((output + used, out_len - used, "\n %-35s\n", "VHT 4ss====>")); + + txagc = phydm_api_get_txagc(p_dm, (enum rf_path) path, rate_idx); + if (config_phydm_read_txagc_check(txagc)) + PHYDM_SNPRINTF((output + used, out_len - used, " 0x%02x ", txagc)); + else + PHYDM_SNPRINTF((output + used, out_len - used, " 0x%s ", "xx")); + } + } +#endif + + *_used = used; + *_out_len = out_len; + +} + + +void +phydm_get_txagc( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + /* path-A */ + PHYDM_SNPRINTF((output + used, out_len - used, "%-35s\n", "path-A====================")); + phydm_get_per_path_txagc(p_dm, RF_PATH_A, &used, output, &out_len); + + /* path-B */ + PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "path-B====================")); + phydm_get_per_path_txagc(p_dm, RF_PATH_B, &used, output, &out_len); + + /* path-C */ + PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "path-C====================")); + phydm_get_per_path_txagc(p_dm, RF_PATH_C, &used, output, &out_len); + + /* path-D */ + PHYDM_SNPRINTF((output + used, out_len - used, "\n%-35s\n", "path-D====================")); + phydm_get_per_path_txagc(p_dm, RF_PATH_D, &used, output, &out_len); + + *_used = used; + *_out_len = out_len; + +} + +void +phydm_set_txagc( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + + /*dm_value[1] = path*/ + /*dm_value[2] = hw_rate*/ + /*dm_value[3] = power_index*/ + +#ifdef PHYDM_COMMON_API_SUPPORT + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C)) { + if (dm_value[1] <= 1) { + if ((u8)dm_value[2] != 0xff) { + if (phydm_api_set_txagc(p_dm, dm_value[3], (enum rf_path) dm_value[1], (u8)dm_value[2], true)) + PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s%x\n", "Write path-", dm_value[1], "rate index-0x", dm_value[2], " = 0x", dm_value[3])); + else + PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); + } else { + u8 i; + u32 power_index; + boolean status = true; + + power_index = (dm_value[3] & 0x3f); + + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { + power_index = (power_index << 24) | (power_index << 16) | (power_index << 8) | (power_index); + + for (i = 0; i < ODM_RATEVHTSS2MCS9; i += 4) + status = (status & phydm_api_set_txagc(p_dm, power_index, (enum rf_path) dm_value[1], i, false)); + } else if (p_dm->support_ic_type & ODM_RTL8197F) { + for (i = 0; i <= ODM_RATEMCS15; i++) + status = (status & phydm_api_set_txagc(p_dm, power_index, (enum rf_path) dm_value[1], i, false)); + } + + if (status) + PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x\n", "Write all TXAGC of path-", dm_value[1], " = 0x", dm_value[3])); + else + PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s\n", "Write all TXAGC of path-", dm_value[1], " fail")); + } + } else + PHYDM_SNPRINTF((output + used, out_len - used, " %s%d %s%x%s\n", "Write path-", (dm_value[1] & 0x1), "rate index-0x", (dm_value[2] & 0x7f), " fail")); + } +#endif + *_used = used; + *_out_len = out_len; +} + +void +phydm_debug_trace( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u64 pre_debug_components, one = 1; + u32 used = *_used; + u32 out_len = *_out_len; + + pre_debug_components = p_dm->debug_components; + + PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); + if (dm_value[0] == 100) { + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Debug Message] PhyDM Selection")); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))DIG\n", ((p_dm->debug_components & DBG_DIG) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))RA_MASK\n", ((p_dm->debug_components & DBG_RA_MASK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))DYNAMIC_TXPWR\n", ((p_dm->debug_components & DBG_DYN_TXPWR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))FA_CNT\n", ((p_dm->debug_components & DBG_FA_CNT) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "04. (( %s ))RSSI_MONITOR\n", ((p_dm->debug_components & DBG_RSSI_MNTR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "05. (( %s ))CCKPD\n", ((p_dm->debug_components & DBG_CCKPD) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "06. (( %s ))ANT_DIV\n", ((p_dm->debug_components & DBG_ANT_DIV) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "07. (( %s ))SMT_ANT\n", ((p_dm->debug_components & DBG_SMT_ANT) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "08. (( %s ))PWR_TRAIN\n", ((p_dm->debug_components & F08_PWR_TRAIN) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "09. (( %s ))RA\n", ((p_dm->debug_components & DBG_RA) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "10. (( %s ))PATH_DIV\n", ((p_dm->debug_components & DBG_PATH_DIV) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "11. (( %s ))DFS\n", ((p_dm->debug_components & DBG_DFS) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "12. (( %s ))DYN_ARFR\n", ((p_dm->debug_components & DBG_DYN_ARFR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "13. (( %s ))ADAPTIVITY\n", ((p_dm->debug_components & DBG_ADPTVTY) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "14. (( %s ))CFO_TRK\n", ((p_dm->debug_components & DBG_CFO_TRK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "15. (( %s ))ENV_MNTR\n", ((p_dm->debug_components & DBG_ENV_MNTR) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "16. (( %s ))PRI_CCA\n", ((p_dm->debug_components & DBG_PRI_CCA) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "17. (( %s ))ADPTV_SOML\n", ((p_dm->debug_components & DBG_ADPTV_SOML) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "18. (( %s ))LNA_SAT_CHK\n", ((p_dm->debug_components & DBG_LNA_SAT_CHK) ? ("V") : (".")))); + /*PHYDM_SNPRINTF((output + used, out_len - used, "19. (( %s ))TBD1\n", ((p_dm->debug_components & DBG_TBD1) ? ("V") : ("."))));*/ + PHYDM_SNPRINTF((output + used, out_len - used, "20. (( %s ))DRP\n", ((p_dm->debug_components & DBG_DYN_RX_PATH) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "21. (( %s ))TMP\n", ((p_dm->debug_components & DBG_TMP) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "22. (( %s ))FW_DEBUG_TRACE\n", ((p_dm->debug_components & DBG_FW_TRACE) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "23. (( %s ))TXBF\n", ((p_dm->debug_components & DBG_TXBF) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "24. (( %s ))COMMON_FLOW\n", ((p_dm->debug_components & DBG_COMMON_FLOW) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "25. (( %s ))TX_PWR_TRK\n", ((p_dm->debug_components & ODM_COMP_TX_PWR_TRACK) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "26. (( %s ))CALIBRATION\n", ((p_dm->debug_components & ODM_COMP_CALIBRATION) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "27. (( %s ))MP\n", ((p_dm->debug_components & ODM_COMP_MP) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "28. (( %s ))PHY_CONFIG\n", ((p_dm->debug_components & ODM_PHY_CONFIG) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "29. (( %s ))INIT\n", ((p_dm->debug_components & ODM_COMP_INIT) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "30. (( %s ))COMMON\n", ((p_dm->debug_components & ODM_COMP_COMMON) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "31. (( %s ))API\n", ((p_dm->debug_components & ODM_COMP_API) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + + } else if (dm_value[0] == 101) { + p_dm->debug_components = 0; + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Disable all debug components")); + } else { + if (dm_value[1] == 1) /*enable*/ + p_dm->debug_components |= (one << dm_value[0]); + else if (dm_value[1] == 2) /*disable*/ + p_dm->debug_components &= ~(one << dm_value[0]); + else + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); + } + PHYDM_SNPRINTF((output + used, out_len - used, "pre-DbgComponents = 0x%llx\n", pre_debug_components)); + PHYDM_SNPRINTF((output + used, out_len - used, "Curr-DbgComponents = 0x%llx\n", p_dm->debug_components)); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + + *_used = used; + *_out_len = out_len; +} + +void +phydm_fw_debug_trace( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 pre_fw_debug_components, one = 1; + u32 used = *_used; + u32 out_len = *_out_len; + + pre_fw_debug_components = p_dm->fw_debug_components; + + PHYDM_SNPRINTF((output + used, out_len - used, "\n%s\n", "================================")); + if (dm_value[0] == 100) { + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[FW Debug Component]")); + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + PHYDM_SNPRINTF((output + used, out_len - used, "00. (( %s ))RA\n", ((p_dm->fw_debug_components & PHYDM_FW_COMP_RA) ? ("V") : (".")))); + + if (p_dm->support_ic_type & PHYDM_IC_3081_SERIES) { + PHYDM_SNPRINTF((output + used, out_len - used, "01. (( %s ))MU\n", ((p_dm->fw_debug_components & PHYDM_FW_COMP_MU) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "02. (( %s ))path Div\n", ((p_dm->fw_debug_components & PHYDM_FW_COMP_PATH_DIV) ? ("V") : (".")))); + PHYDM_SNPRINTF((output + used, out_len - used, "03. (( %s ))Power training\n", ((p_dm->fw_debug_components & PHYDM_FW_COMP_PT) ? ("V") : (".")))); + } + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "================================")); + + } else { + if (dm_value[0] == 101) { + p_dm->fw_debug_components = 0; + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Clear all fw debug components")); + } else { + if (dm_value[1] == 1) /*enable*/ + p_dm->fw_debug_components |= (one << dm_value[0]); + else if (dm_value[1] == 2) /*disable*/ + p_dm->fw_debug_components &= ~(one << dm_value[0]); + else + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "[Warning!!!] 1:enable, 2:disable")); + } + + if (p_dm->fw_debug_components == 0) { + p_dm->debug_components &= ~DBG_FW_TRACE; + phydm_fw_trace_en_h2c(p_dm, false, p_dm->fw_debug_components, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ + } else { + p_dm->debug_components |= DBG_FW_TRACE; + phydm_fw_trace_en_h2c(p_dm, true, p_dm->fw_debug_components, dm_value[2], dm_value[3]); /*H2C to enable C2H Msg*/ + } + } +} + +void +phydm_dump_bb_reg( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + + + /* BB Reg, For Nseries IC we only need to dump page8 to pageF using 3 digits*/ + for (addr = 0x800; addr < 0xfff; addr += 4) { + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%03x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + else + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + } + + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8814A | ODM_RTL8821C)) { + + if (p_dm->rf_type > RF_2T2R) { + for (addr = 0x1800; addr < 0x18ff; addr += 4) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + } + + if (p_dm->rf_type > RF_3T3R) { + for (addr = 0x1a00; addr < 0x1aff; addr += 4) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + } + + for (addr = 0x1900; addr < 0x19ff; addr += 4) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + + for (addr = 0x1c00; addr < 0x1cff; addr += 4) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + + for (addr = 0x1f00; addr < 0x1fff; addr += 4) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + } + + *_used = used; + *_out_len = out_len; +} + +void +phydm_dump_all_reg( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 addr = 0; + u32 used = *_used; + u32 out_len = *_out_len; + + /* dump MAC register */ + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "MAC==========\n")); + for (addr = 0; addr < 0x7ff; addr += 4) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + + for (addr = 0x1000; addr < 0x17ff; addr += 4) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%04x 0x%08x\n", addr, odm_get_bb_reg(p_dm, addr, MASKDWORD))); + + /* dump BB register */ + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "BB==========\n")); + phydm_dump_bb_reg(p_dm, &used, output, &out_len); + + /* dump RF register */ + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "RF-A==========\n")); + for (addr = 0; addr < 0xFF; addr++) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%02x 0x%05x\n", addr, odm_get_rf_reg(p_dm, RF_PATH_A, addr, RFREGOFFSETMASK))); + + if (p_dm->rf_type > RF_1T1R) { + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "RF-B==========\n")); + for (addr = 0; addr < 0xFF; addr++) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%02x 0x%05x\n", addr, odm_get_rf_reg(p_dm, RF_PATH_B, addr, RFREGOFFSETMASK))); + } + + if (p_dm->rf_type > RF_2T2R) { + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "RF-C==========\n")); + for (addr = 0; addr < 0xFF; addr++) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%02x 0x%05x\n", addr, odm_get_rf_reg(p_dm, RF_PATH_C, addr, RFREGOFFSETMASK))); + } + + if (p_dm->rf_type > RF_3T3R) { + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "RF-D==========\n")); + for (addr = 0; addr < 0xFF; addr++) + PHYDM_VAST_INFO_SNPRINTF((output + used, out_len - used, "0x%02x 0x%05x\n", addr, odm_get_rf_reg(p_dm, RF_PATH_D, addr, RFREGOFFSETMASK))); + } + + *_used = used; + *_out_len = out_len; +} + +void +phydm_enable_big_jump( + struct PHY_DM_STRUCT *p_dm, + boolean state +) +{ +#if (RTL8822B_SUPPORT == 1) + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + + if (state == false) { + p_dm->dm_dig_table.enable_adjust_big_jump = false; + odm_set_bb_reg(p_dm, 0x8c8, 0xfe, ((p_dig_t->big_jump_step3 << 5) | (p_dig_t->big_jump_step2 << 3) | p_dig_t->big_jump_step1)); + } else + p_dm->dm_dig_table.enable_adjust_big_jump = true; +#endif +} + +#if (RTL8822B_SUPPORT == 1 | RTL8821C_SUPPORT == 1 | RTL8814B_SUPPORT == 1) + +void +phydm_show_rx_rate( + struct PHY_DM_STRUCT *p_dm, + u32 *_used, + char *output, + u32 *_out_len +) +{ + u32 used = *_used; + u32 out_len = *_out_len; + + PHYDM_SNPRINTF((output + used, out_len - used, "=====Rx SU rate Statistics=====\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", + p_dm->phy_dbg_info.num_qry_vht_pkt[0], p_dm->phy_dbg_info.num_qry_vht_pkt[1], p_dm->phy_dbg_info.num_qry_vht_pkt[2], p_dm->phy_dbg_info.num_qry_vht_pkt[3])); + PHYDM_SNPRINTF((output + used, out_len - used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", + p_dm->phy_dbg_info.num_qry_vht_pkt[4], p_dm->phy_dbg_info.num_qry_vht_pkt[5], p_dm->phy_dbg_info.num_qry_vht_pkt[6], p_dm->phy_dbg_info.num_qry_vht_pkt[7])); + PHYDM_SNPRINTF((output + used, out_len - used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", + p_dm->phy_dbg_info.num_qry_vht_pkt[8], p_dm->phy_dbg_info.num_qry_vht_pkt[9])); + PHYDM_SNPRINTF((output + used, out_len - used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", + p_dm->phy_dbg_info.num_qry_vht_pkt[10], p_dm->phy_dbg_info.num_qry_vht_pkt[11], p_dm->phy_dbg_info.num_qry_vht_pkt[12], p_dm->phy_dbg_info.num_qry_vht_pkt[13])); + PHYDM_SNPRINTF((output + used, out_len - used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", + p_dm->phy_dbg_info.num_qry_vht_pkt[14], p_dm->phy_dbg_info.num_qry_vht_pkt[15], p_dm->phy_dbg_info.num_qry_vht_pkt[16], p_dm->phy_dbg_info.num_qry_vht_pkt[17])); + PHYDM_SNPRINTF((output + used, out_len - used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", + p_dm->phy_dbg_info.num_qry_vht_pkt[18], p_dm->phy_dbg_info.num_qry_vht_pkt[19])); + + PHYDM_SNPRINTF((output + used, out_len - used, "=====Rx MU rate Statistics=====\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "1SS MCS0 = %d, 1SS MCS1 = %d, 1SS MCS2 = %d, 1SS MCS 3 = %d\n", + p_dm->phy_dbg_info.num_qry_mu_vht_pkt[0], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[1], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[2], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[3])); + PHYDM_SNPRINTF((output + used, out_len - used, "1SS MCS4 = %d, 1SS MCS5 = %d, 1SS MCS6 = %d, 1SS MCS 7 = %d\n", + p_dm->phy_dbg_info.num_qry_mu_vht_pkt[4], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[5], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[6], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[7])); + PHYDM_SNPRINTF((output + used, out_len - used, "1SS MCS8 = %d, 1SS MCS9 = %d\n", + p_dm->phy_dbg_info.num_qry_mu_vht_pkt[8], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[9])); + PHYDM_SNPRINTF((output + used, out_len - used, "2SS MCS0 = %d, 2SS MCS1 = %d, 2SS MCS2 = %d, 2SS MCS 3 = %d\n", + p_dm->phy_dbg_info.num_qry_mu_vht_pkt[10], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[11], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[12], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[13])); + PHYDM_SNPRINTF((output + used, out_len - used, "2SS MCS4 = %d, 2SS MCS5 = %d, 2SS MCS6 = %d, 2SS MCS 7 = %d\n", + p_dm->phy_dbg_info.num_qry_mu_vht_pkt[14], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[15], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[16], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[17])); + PHYDM_SNPRINTF((output + used, out_len - used, "2SS MCS8 = %d, 2SS MCS9 = %d\n", + p_dm->phy_dbg_info.num_qry_mu_vht_pkt[18], p_dm->phy_dbg_info.num_qry_mu_vht_pkt[19])); + + *_used = used; + *_out_len = out_len; +} + +#endif + +void +phydm_api_adjust( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i; + boolean is_enable_dbg_mode; + u8 central_ch, primary_ch_idx; + enum channel_width bandwidth; + +#ifdef PHYDM_COMMON_API_SUPPORT + + if ((strcmp(input[1], help) == 0)) { + + PHYDM_SNPRINTF((output + used, out_len - used, "{en} {ch_num} {prm_ch 1/2/3/4/9/10} {0:20M, 1:40M, 2:80M}\n")); + + } else { + + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C)) { + + for (i = 0; i < 4; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + + is_enable_dbg_mode = (boolean)var1[0]; + central_ch = (u8) var1[1]; + primary_ch_idx = (u8) var1[2]; + bandwidth = (enum channel_width)var1[3]; + + if (is_enable_dbg_mode) { + p_dm->is_disable_phy_api = false; + phydm_api_switch_bw_channel(p_dm, central_ch, primary_ch_idx, bandwidth); + p_dm->is_disable_phy_api = true; + PHYDM_SNPRINTF((output + used, out_len - used, "central_ch = %d, primary_ch_idx = %d, bandwidth = %d\n", central_ch, primary_ch_idx, bandwidth)); + } else { + p_dm->is_disable_phy_api = false; + PHYDM_SNPRINTF((output + used, out_len - used, "Disable API debug mode\n")); + } + } else { + PHYDM_SNPRINTF((output + used, out_len - used, "This IC doesn't support PHYDM API function\n")); + /**/ + } + } + +#else + PHYDM_SNPRINTF((output + used, out_len - used, "This IC doesn't support PHYDM API function\n")); +#endif + + *_used = used; + *_out_len = out_len; +} + +void +phydm_parameter_adjust( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_cfo_track_struct *p_cfo_track = (struct phydm_cfo_track_struct *)phydm_get_structure(p_dm, PHYDM_CFOTRACK); + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i; + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "1. X_cap = ((0x%x))\n", p_cfo_track->crystal_cap)); + + } else { + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (var1[0] == 0) { + + PHYDM_SSCANF(input[2], DCMD_HEX, &var1[1]); + phydm_set_crystal_cap(p_dm, (u8)var1[1]); + PHYDM_SNPRINTF((output + used, out_len - used, "X_cap = ((0x%x))\n", p_cfo_track->crystal_cap)); + } + } + *_used = used; + *_out_len = out_len; +} + +struct _PHYDM_COMMAND { + char name[16]; + u8 id; +}; + +enum PHYDM_CMD_ID { + PHYDM_HELP, + PHYDM_DEMO, + PHYDM_DIG, + PHYDM_RA, + PHYDM_PROFILE, + PHYDM_ANTDIV, + PHYDM_PATHDIV, + PHYDM_DEBUG, + PHYDM_FW_DEBUG, + PHYDM_SUPPORT_ABILITY, + PHYDM_RF_SUPPORTABILITY, + PHYDM_RF_PROFILE, + PHYDM_RF_IQK_INFO, + PHYDM_IQK, + PHYDM_IQK_DEBUG, + PHYDM_GET_TXAGC, + PHYDM_SET_TXAGC, + PHYDM_SMART_ANT, + PHYDM_API, + PHYDM_TRX_PATH, + PHYDM_LA_MODE, + PHYDM_DUMP_REG, + PHYDM_AUTO_DBG, + PHYDM_BIG_JUMP, + PHYDM_SHOW_RXRATE, + PHYDM_NBI_EN, + PHYDM_CSI_MASK_EN, + PHYDM_DFS_DEBUG, + PHYDM_NHM, + PHYDM_CLM, + PHYDM_BB_INFO, + PHYDM_TXBF, + PHYDM_H2C, + PHYDM_ANT_SWITCH, + PHYDM_DYNAMIC_RA_PATH, + PHYDM_ADAPTIVE_SOML, + PHYDM_PSD, + PHYDM_DEBUG_PORT, + PHYDM_DIS_HTSTF_CONTROL, + PHYDM_TUNE_PARAMETER, + PHYDM_ADAPTIVITY_DEBUG, + PHYDM_DIS_DYM_ANT_WEIGHTING, + PHYDM_FORECE_PT_STATE, + PHYDM_DIS_RXHP_CTR, + PHYDM_STA_INFO, + PHYDM_PAUSE_FUNC +}; + +struct _PHYDM_COMMAND phy_dm_ary[] = { + {"-h", PHYDM_HELP}, /*do not move this element to other position*/ + {"demo", PHYDM_DEMO}, /*do not move this element to other position*/ + {"dig", PHYDM_DIG}, + {"ra", PHYDM_RA}, + {"profile", PHYDM_PROFILE}, + {"antdiv", PHYDM_ANTDIV}, + {"pathdiv", PHYDM_PATHDIV}, + {"dbg", PHYDM_DEBUG}, + {"fw_dbg", PHYDM_FW_DEBUG}, + {"ability", PHYDM_SUPPORT_ABILITY}, + {"rf_ability", PHYDM_RF_SUPPORTABILITY}, + {"rf_profile", PHYDM_RF_PROFILE}, + {"iqk_info", PHYDM_RF_IQK_INFO}, + {"iqk", PHYDM_IQK}, + {"iqk_dbg", PHYDM_IQK_DEBUG}, + {"get_txagc", PHYDM_GET_TXAGC}, + {"set_txagc", PHYDM_SET_TXAGC}, + {"smtant", PHYDM_SMART_ANT}, + {"api", PHYDM_API}, + {"trxpath", PHYDM_TRX_PATH}, + {"lamode", PHYDM_LA_MODE}, + {"dumpreg", PHYDM_DUMP_REG}, + {"auto_dbg", PHYDM_AUTO_DBG}, + {"bigjump", PHYDM_BIG_JUMP}, + {"rxrate", PHYDM_SHOW_RXRATE}, + {"nbi", PHYDM_NBI_EN}, + {"csi_mask", PHYDM_CSI_MASK_EN}, + {"dfs", PHYDM_DFS_DEBUG}, + {"nhm", PHYDM_NHM}, + {"clm", PHYDM_CLM}, + {"bbinfo", PHYDM_BB_INFO}, + {"txbf", PHYDM_TXBF}, + {"h2c", PHYDM_H2C}, + {"ant_switch", PHYDM_ANT_SWITCH}, + {"drp", PHYDM_DYNAMIC_RA_PATH}, + {"soml", PHYDM_ADAPTIVE_SOML}, + {"psd", PHYDM_PSD}, + {"dbgport", PHYDM_DEBUG_PORT}, + {"dis_htstf", PHYDM_DIS_HTSTF_CONTROL}, + {"tune_para", PHYDM_TUNE_PARAMETER}, + {"adapt_debug", PHYDM_ADAPTIVITY_DEBUG}, + {"dis_dym_ant_wgt", PHYDM_DIS_DYM_ANT_WEIGHTING}, + {"force_pt_state", PHYDM_FORECE_PT_STATE}, + {"dis_drxhp", PHYDM_DIS_RXHP_CTR}, + {"sta_info", PHYDM_STA_INFO}, + {"pause", PHYDM_PAUSE_FUNC} +}; + +#endif /*#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ + +void +phydm_cmd_parser( + struct PHY_DM_STRUCT *p_dm, + char input[][MAX_ARGV], + u32 input_num, + u8 flag, + char *output, + u32 out_len +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + u32 used = 0; + u8 id = 0; + int var1[10] = {0}; + int i, input_idx = 0, phydm_ary_size = sizeof(phy_dm_ary) / sizeof(struct _PHYDM_COMMAND); + char help[] = "-h"; + + if (flag == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "GET, nothing to print\n")); + return; + } + + PHYDM_SNPRINTF((output + used, out_len - used, "\n")); + + /* Parsing Cmd ID */ + if (input_num) { + + for (i = 0; i < phydm_ary_size; i++) { + if (strcmp(phy_dm_ary[i].name, input[0]) == 0) { + id = phy_dm_ary[i].id; + break; + } + } + if (i == phydm_ary_size) { + PHYDM_SNPRINTF((output + used, out_len - used, "SET, command not found!\n")); + return; + } + } + + switch (id) { + + case PHYDM_HELP: + { + PHYDM_SNPRINTF((output + used, out_len - used, "BB cmd ==>\n")); + for (i = 0; i < phydm_ary_size - 2; i++) { + + PHYDM_SNPRINTF((output + used, out_len - used, " %-5d: %s\n", i, phy_dm_ary[i + 2].name)); + /**/ + } + } + break; + + case PHYDM_DEMO: { /*echo demo 10 0x3a z abcde >cmd*/ + u32 directory = 0; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) + char char_temp; +#else + u32 char_temp = ' '; +#endif + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &directory); + PHYDM_SNPRINTF((output + used, out_len - used, "Decimal value = %d\n", directory)); + PHYDM_SSCANF(input[2], DCMD_HEX, &directory); + PHYDM_SNPRINTF((output + used, out_len - used, "Hex value = 0x%x\n", directory)); + PHYDM_SSCANF(input[3], DCMD_CHAR, &char_temp); + PHYDM_SNPRINTF((output + used, out_len - used, "Char = %c\n", char_temp)); + PHYDM_SNPRINTF((output + used, out_len - used, "String = %s\n", input[4])); + } + break; + + case PHYDM_DIG: + + phydm_dig_debug(p_dm, &input[0], &used, output, &out_len, input_num); + break; + + case PHYDM_RA: + phydm_ra_debug(p_dm, &input[0], &used, output, &out_len); + break; + + case PHYDM_ANTDIV: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + + /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i, var1[i]));*/ + input_idx++; + } + } + + if (input_idx >= 1) { + /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + phydm_antdiv_debug(p_dm, (u32 *)var1, &used, output, &out_len); +#endif + } + + break; + + case PHYDM_PATHDIV: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + + /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, PATHDIV_var[%d]= (( %d ))\n", i, var1[i]));*/ + input_idx++; + } + } + + if (input_idx >= 1) { + /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_PATHDIV_debug\n"));*/ +#if (defined(CONFIG_PATH_DIVERSITY)) + odm_pathdiv_debug(p_dm, (u32 *)var1, &used, output, &out_len); +#endif + } + + break; + + case PHYDM_DEBUG: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + + /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, Debug_var[%d]= (( %d ))\n", i, var1[i]));*/ + input_idx++; + } + } + + if (input_idx >= 1) { + /*PHYDM_SNPRINTF((output+used, out_len-used, "odm_debug_comp\n"));*/ + phydm_debug_trace(p_dm, (u32 *)var1, &used, output, &out_len); + } + + + break; + + case PHYDM_FW_DEBUG: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) + phydm_fw_debug_trace(p_dm, (u32 *)var1, &used, output, &out_len); + + break; + + case PHYDM_SUPPORT_ABILITY: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + + /*PHYDM_SNPRINTF((output+used, out_len-used, "new SET, support ablity_var[%d]= (( %d ))\n", i, var1[i]));*/ + input_idx++; + } + } + + if (input_idx >= 1) { + /*PHYDM_SNPRINTF((output+used, out_len-used, "support ablity\n"));*/ + phydm_support_ability_debug(p_dm, (u32 *)var1, &used, output, &out_len); + } + + break; + + case PHYDM_RF_SUPPORTABILITY: + halrf_support_ability_debug(p_dm, &input[0], &used, output, &out_len); + break; + + case PHYDM_RF_PROFILE: + halrf_basic_profile(p_dm, &used, output, &out_len); + break; + + case PHYDM_RF_IQK_INFO: + #if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) + halrf_iqk_info_dump(p_dm, &used, output, &out_len); + #endif + break; + + case PHYDM_IQK: + + PHYDM_SNPRINTF((output + used, out_len - used, "TRX IQK Trigger\n")); + halrf_iqk_trigger(p_dm, false); + + #if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) + halrf_iqk_info_dump(p_dm, &used, output, &out_len); + #endif + + break; + + case PHYDM_IQK_DEBUG: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) { + #if (RTL8822B_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) + halrf_iqk_debug(p_dm, (u32 *)var1, &used, output, &out_len); + #endif + } + break; + + case PHYDM_SMART_ANT: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) { + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + phydm_hl_smart_ant_debug_type2(p_dm, &input[0], &used, output, &out_len, input_num); + #elif (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) + phydm_hl_smart_ant_debug(p_dm, &input[0], &used, output, &out_len, input_num); + #endif + + #endif + + #if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) + phydm_cumitek_smt_ant_debug(p_dm, &input[0], &used, output, &out_len, input_num); + #endif + } + + break; + + case PHYDM_API: + phydm_api_adjust(p_dm, &input[0], &used, output, &out_len, input_num); + break; + + case PHYDM_PROFILE: + phydm_basic_profile(p_dm, &used, output, &out_len); + break; + + case PHYDM_GET_TXAGC: + phydm_get_txagc(p_dm, &used, output, &out_len); + break; + + case PHYDM_SET_TXAGC: + { + boolean is_enable_dbg_mode; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + input_idx++; + } + } + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "{En} {pathA~D(0~3)} {rate_idx(Hex), All_rate:0xff} {txagc_idx (Hex)}\n")); + /**/ + + } else { + + is_enable_dbg_mode = (boolean)var1[0]; + if (is_enable_dbg_mode) { + p_dm->is_disable_phy_api = false; + phydm_set_txagc(p_dm, (u32 *)var1, &used, output, &out_len); + p_dm->is_disable_phy_api = true; + } else { + p_dm->is_disable_phy_api = false; + PHYDM_SNPRINTF((output + used, out_len - used, "Disable API debug mode\n")); + } + } + } + break; + + case PHYDM_TRX_PATH: + + for (i = 0; i < 4; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } +#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) { + u8 tx_path, rx_path; + boolean is_enable_dbg_mode, is_tx2_path; + + is_enable_dbg_mode = (boolean)var1[0]; + tx_path = (u8) var1[1]; + rx_path = (u8) var1[2]; + is_tx2_path = (boolean) var1[3]; + + if (is_enable_dbg_mode) { + p_dm->is_disable_phy_api = false; + phydm_api_trx_mode(p_dm, (enum bb_path) tx_path, (enum bb_path) rx_path, is_tx2_path); + p_dm->is_disable_phy_api = true; + PHYDM_SNPRINTF((output + used, out_len - used, "tx_path = 0x%x, rx_path = 0x%x, is_tx2_path = %d\n", tx_path, rx_path, is_tx2_path)); + } else { + p_dm->is_disable_phy_api = false; + PHYDM_SNPRINTF((output + used, out_len - used, "Disable API debug mode\n")); + } + } else +#endif + phydm_config_trx_path(p_dm, (u32 *)var1, &used, output, &out_len); + + break; + + case PHYDM_LA_MODE: + + #if (PHYDM_LA_MODE_SUPPORT == 1) + phydm_lamode_trigger_setting(p_dm, &input[0], &used, output, &out_len, input_num); + #else + PHYDM_SNPRINTF((output + used, out_len - used, "This IC doesn't support LA mode\n")); + #endif + + break; + + case PHYDM_DUMP_REG: + { + u8 type = 0; + + if (input[1]) { + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + type = (u8)var1[0]; + } + + if (type == 0) + phydm_dump_bb_reg(p_dm, &used, output, &out_len); + else if (type == 1) + phydm_dump_all_reg(p_dm, &used, output, &out_len); + } + break; + + case PHYDM_BIG_JUMP: + { +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8822B) { + if (input[1]) { + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + phydm_enable_big_jump(p_dm, (boolean)(var1[0])); + } else + PHYDM_SNPRINTF((output + used, out_len - used, "unknown command!\n")); + } else + PHYDM_SNPRINTF((output + used, out_len - used, "The command is only for 8822B!\n")); +#endif + break; + } + + case PHYDM_AUTO_DBG: + #ifdef PHYDM_AUTO_DEGBUG + phydm_auto_dbg_console(p_dm, &input[0], &used, output, &out_len, input_num); + #endif + break; + + case PHYDM_SHOW_RXRATE: +#if (RTL8822B_SUPPORT == 1 | RTL8821C_SUPPORT == 1 | RTL8814B_SUPPORT == 1) + if (p_dm->support_ic_type & PHYDM_IC_SUPPORT_MU_BFEE) { + u8 rate_idx; + + if (input[1]) + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (var1[0] == 1) + phydm_show_rx_rate(p_dm, &used, output, &out_len); + else { + PHYDM_SNPRINTF((output + used, out_len - used, "Reset Rx rate counter\n")); + + for (rate_idx = 0; rate_idx < 40; rate_idx++) { + p_dm->phy_dbg_info.num_qry_vht_pkt[rate_idx] = 0; + p_dm->phy_dbg_info.num_qry_mu_vht_pkt[rate_idx] = 0; + } + } + } +#endif + break; + + case PHYDM_NBI_EN: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) { + + phydm_api_debug(p_dm, PHYDM_API_NBI, (u32 *)var1, &used, output, &out_len); + /**/ + } + + + break; + + case PHYDM_CSI_MASK_EN: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) { + + phydm_api_debug(p_dm, PHYDM_API_CSI_MASK, (u32 *)var1, &used, output, &out_len); + /**/ + } + + + break; + + case PHYDM_DFS_DEBUG: +#ifdef CONFIG_PHYDM_DFS_MASTER + { + u32 var[4] = {0}; + + for (i = 0; i < 4; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var[i]); + input_idx++; + } + } + + if (input_idx >= 1) + phydm_dfs_debug(p_dm, var, &used, output, &out_len); + } +#endif + break; + + case PHYDM_NHM: + { + u8 target_rssi; + u16 nhm_period = 0xC350; /* 200ms */ + u8 IGI; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (input_num == 1) { + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); + + return; + } + + /* NMH trigger */ + if ((var1[0] <= 2) && (var1[0] != 0)) { + + ccx_info->echo_igi = (u8)odm_get_bb_reg(p_dm, 0xC50, MASKBYTE0); + + target_rssi = ccx_info->echo_igi - 10; + + ccx_info->nhm_th[0] = (target_rssi - 15 + 10) * 2; /*Unit: PWdB U(8,1)*/ + + for (i = 1; i <= 10; i++) + ccx_info->nhm_th[i] = ccx_info->nhm_th[0] + 6 * i; + + /* 4 1. store previous NHM setting */ + phydm_nhm_setting(p_dm, STORE_NHM_SETTING); + + /* 4 2. Set NHM period, 0x990[31:16]=0xC350, Time duration for NHM unit: 4us, 0xC350=200ms */ + ccx_info->nhm_period = nhm_period; + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Monitor NHM for %d us", nhm_period * 4)); + + /* 4 3. Set NHM inexclude_txon, inexclude_cca, ccx_en */ + + + ccx_info->nhm_inexclude_cca = (var1[0] == 1) ? NHM_EXCLUDE_CCA : NHM_INCLUDE_CCA; + ccx_info->nhm_inexclude_txon = NHM_EXCLUDE_TXON; + + phydm_nhm_setting(p_dm, SET_NHM_SETTING); + + for (i = 0; i <= 10; i++) { + + if (i == 5) + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x, echo_igi = 0x%x", i, ccx_info->nhm_th[i], ccx_info->echo_igi)); + else if (i == 10) + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x\n", i, ccx_info->nhm_th[i])); + else + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n NHM_th[%d] = 0x%x", i, ccx_info->nhm_th[i])); + } + + /* 4 4. Trigger NHM */ + phydm_nhm_trigger(p_dm); + + } + + /*Get NHM results*/ + else if (var1[0] == 3) { + + IGI = (u8)odm_get_bb_reg(p_dm, 0xC50, MASKBYTE0); + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Cur_IGI = 0x%x", IGI)); + + phydm_get_nhm_result(p_dm); + + /* 4 Resotre NHM setting */ + phydm_nhm_setting(p_dm, RESTORE_NHM_SETTING); + + for (i = 0; i <= 11; i++) { + + if (i == 5) + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d, echo_igi = 0x%x", i, ccx_info->nhm_result[i], ccx_info->echo_igi)); + else if (i == 11) + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d\n", i, ccx_info->nhm_result[i])); + else + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n nhm_result[%d] = %d", i, ccx_info->nhm_result[i])); + } + + } else { + + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Trigger NHM: echo nhm 1\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r (Exclude CCA)\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r Trigger NHM: echo nhm 2\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r (Include CCA)\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r Get NHM results: echo nhm 3\n")); + + return; + } + } + break; + + case PHYDM_CLM: + phydm_clm_dbg(p_dm, &input[0], &used, output, &out_len, input_num); + break; + + #ifdef FAHM_SUPPORT + case PHYDM_FAHM: + phydm_fahm_dbg(p_dm, &input[0], &used, output, &out_len, input_num); + break; + #endif + + case PHYDM_BB_INFO: + { + s32 value32 = 0; + + phydm_bb_debug_info(p_dm, &used, output, &out_len); + + if (p_dm->support_ic_type & ODM_RTL8822B && input[1]) { + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + odm_set_bb_reg(p_dm, 0x1988, 0x003fff00, var1[0]); + value32 = odm_get_bb_reg(p_dm, 0xf84, MASKDWORD); + value32 = (value32 & 0xff000000) >> 24; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n %-35s = condition num = %d, subcarriers = %d\n", "Over condition num subcarrier", var1[0], value32)); + odm_set_bb_reg(p_dm, 0x1988, BIT(22), 0x0); /*disable report condition number*/ + } + } + break; + + case PHYDM_TXBF: + { +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (BEAMFORMING_SUPPORT == 1) + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + if (var1[0] == 0) { + p_beamforming_info->apply_v_matrix = false; + p_beamforming_info->snding3ss = true; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n dont apply V matrix and 3SS 789 snding\n")); + } else if (var1[0] == 1) { + p_beamforming_info->apply_v_matrix = true; + p_beamforming_info->snding3ss = true; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n apply V matrix and 3SS 789 snding\n")); + } else if (var1[0] == 2) { + p_beamforming_info->apply_v_matrix = true; + p_beamforming_info->snding3ss = false; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n default txbf setting\n")); + } else + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n unknown cmd!!\n")); +#else + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n no TxBF !!\n")); +#endif +#endif + } + break; + + case PHYDM_H2C: + + for (i = 0; i < 8; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) + phydm_h2C_debug(p_dm, (u32 *)var1, &used, output, &out_len); + + + break; + + case PHYDM_ANT_SWITCH: + + for (i = 0; i < 8; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) { + +#if (RTL8821A_SUPPORT == 1) + phydm_set_ext_switch(p_dm, (u32 *)var1, &used, output, &out_len); +#else + PHYDM_SNPRINTF((output + used, out_len - used, "Not Support IC")); +#endif + } + + + break; + + case PHYDM_DYNAMIC_RA_PATH: + +#ifdef CONFIG_DYNAMIC_RX_PATH + for (i = 0; i < 8; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) + phydm_drp_debug(p_dm, (u32 *)var1, &used, output, &out_len); + +#else + PHYDM_SNPRINTF((output + used, out_len - used, "Not Support IC")); +#endif + + break; + + case PHYDM_ADAPTIVE_SOML: + +#ifdef CONFIG_ADAPTIVE_SOML + for (i = 0; i < 8; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) + phydm_soml_debug(p_dm, (u32 *)var1, &used, output, &out_len); + +#else + PHYDM_SNPRINTF((output + used, out_len - used, "Not Support IC")); +#endif + + break; + + case PHYDM_PSD: + + #ifdef CONFIG_PSD_TOOL + phydm_psd_debug(p_dm, &input[0], &used, output, &out_len, input_num); + #endif + + break; + + case PHYDM_DEBUG_PORT: + { + u32 dbg_port_value; + + PHYDM_SSCANF(input[1], DCMD_HEX, &var1[0]); + + p_dm->debug_components |= ODM_COMP_API; + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_3, var1[0])) {/*set debug port to 0x0*/ + + dbg_port_value = phydm_get_bb_dbg_port_value(p_dm); + phydm_release_bb_dbg_port(p_dm); + + PHYDM_SNPRINTF((output + used, out_len - used, "Dbg Port[0x%x] = ((0x%x))\n", var1[0], dbg_port_value)); + } + p_dm->debug_components &= (~ODM_COMP_API); + } + break; + + case PHYDM_DIS_HTSTF_CONTROL: + { + if (input[1]) + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (var1[0] == 1) { + + /* setting being false is for debug */ + p_dm->bhtstfdisabled = true; + PHYDM_SNPRINTF((output + used, out_len - used, "Dynamic HT-STF Gain Control is Disable\n")); + } + else { + + /* default setting should be true, always be dynamic control*/ + p_dm->bhtstfdisabled = false; + PHYDM_SNPRINTF((output + used, out_len - used, "Dynamic HT-STF Gain Control is Enable\n")); + } + } + break; + + case PHYDM_TUNE_PARAMETER: + phydm_parameter_adjust(p_dm, &input[0], &used, output, &out_len, input_num); + break; + + case PHYDM_ADAPTIVITY_DEBUG: + + for (i = 0; i < 5; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + input_idx++; + } + } + + if (input_idx >= 1) + phydm_adaptivity_debug(p_dm, (u32 *)var1, &used, output, &out_len); + + break; + + case PHYDM_DIS_DYM_ANT_WEIGHTING: + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + if (input_num == 1) { + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Disable dynamic antenna weighting: echo dis_dym_ant_weighting 1\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Enable dynamic antenna weighting: echo dis_dym_ant_weighting 0\n")); + return; + } + + if (var1[0] == 1) { + p_dm->is_disable_dym_ant_weighting = 1; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Disable dynmic antenna weighting !\n")); + } else if(var1[0] == 0) { + p_dm->is_disable_dym_ant_weighting = 0; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Enable dynmic antenna weighting !\n")); + } else { + p_dm->is_disable_dym_ant_weighting = 0; + PHYDM_SNPRINTF((output + used, out_len - used, "\r\n Enable dynmic antenna weighting !\n")); + } + break; + + case PHYDM_FORECE_PT_STATE: + { + + #ifdef PHYDM_POWER_TRAINING_SUPPORT + phydm_pow_train_debug(p_dm, &input[0], &used, output, &out_len, input_num); + #else + PHYDM_SNPRINTF((output + used, out_len - used, "Pow training: Not Support\n")); + #endif + + break; + } + + case PHYDM_DIS_RXHP_CTR: + { + if (input[1]) + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (var1[0] == 1) { + /* the setting being on is at debug mode to disconnect RxHP seeting with SoML on/odd */ + p_dm->disrxhpsoml = true; + PHYDM_SNPRINTF((output + used, out_len - used, "Dynamic RxHP Control with SoML on/off is Disable\n")); + } + else if (var1[0] == 0) { + /* default setting, RxHP setting will follow SoML on/off setting */ + p_dm->disrxhpsoml = false; + PHYDM_SNPRINTF((output + used, out_len - used, "Dynamic RxHP Control with SoML on/off is Enable\n")); + } + else { + p_dm->disrxhpsoml = false; + PHYDM_SNPRINTF((output + used, out_len - used, "Default Setting, Dynamic RxHP Control with SoML on/off is Enable\n")); + } + } + break; + + case PHYDM_STA_INFO: + phydm_show_sta_info(p_dm, &input[0], &used, output, &out_len, input_num); + break; + + case PHYDM_PAUSE_FUNC: + phydm_pause_func_console(p_dm, &input[0], &used, output, &out_len, input_num); + break; + + default: + PHYDM_SNPRINTF((output + used, out_len - used, "SET, unknown command!\n")); + break; + + } +#endif /*#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ +} + +#ifdef __ECOS +char *strsep(char **s, const char *ct) +{ + char *sbegin = *s; + char *end; + + if (sbegin == NULL) + return NULL; + + end = strpbrk(sbegin, ct); + if (end) + *end++ = '\0'; + *s = end; + return sbegin; +} +#endif + +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) +s32 +phydm_cmd( + struct PHY_DM_STRUCT *p_dm, + char *input, + u32 in_len, + u8 flag, + char *output, + u32 out_len +) +{ + char *token; + u32 argc = 0; + char argv[MAX_ARGC][MAX_ARGV]; + + do { + token = strsep(&input, ", "); + if (token) { + strcpy(argv[argc], token); + argc++; + } else + break; + } while (argc < MAX_ARGC); + + if (argc == 1) + argv[0][strlen(argv[0]) - 1] = '\0'; + + phydm_cmd_parser(p_dm, argv, argc, flag, output, out_len); + + return 0; +} +#endif + + +void +phydm_fw_trace_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + /*u8 debug_trace_11byte[60];*/ + u8 freg_num, c2h_seq, buf_0 = 0; + + + if (!(p_dm->support_ic_type & PHYDM_IC_3081_SERIES)) + return; + + if ((cmd_len > 12) || (cmd_len == 0)) { + dbg_print("[Warning] Error C2H cmd_len=%d\n", cmd_len); + return; + } + + buf_0 = cmd_buf[0]; + freg_num = (buf_0 & 0xf); + c2h_seq = (buf_0 & 0xf0) >> 4; + /*PHYDM_DBG(p_dm, DBG_FW_TRACE,("[FW debug message] freg_num = (( %d )), c2h_seq = (( %d ))\n", freg_num,c2h_seq ));*/ + + /*strncpy(debug_trace_11byte,&cmd_buf[1],(cmd_len-1));*/ + /*debug_trace_11byte[cmd_len-1] = '\0';*/ + /*PHYDM_DBG(p_dm, DBG_FW_TRACE,("[FW debug message] %s\n", debug_trace_11byte));*/ + /*PHYDM_DBG(p_dm, DBG_FW_TRACE,("[FW debug message] cmd_len = (( %d ))\n", cmd_len));*/ + /*PHYDM_DBG(p_dm, DBG_FW_TRACE,("[FW debug message] c2h_cmd_start = (( %d ))\n", p_dm->c2h_cmd_start));*/ + + + + /*PHYDM_DBG(p_dm, DBG_FW_TRACE,("pre_seq = (( %d )), current_seq = (( %d ))\n", p_dm->pre_c2h_seq, c2h_seq));*/ + /*PHYDM_DBG(p_dm, DBG_FW_TRACE,("fw_buff_is_enpty = (( %d ))\n", p_dm->fw_buff_is_enpty));*/ + + if ((c2h_seq != p_dm->pre_c2h_seq) && p_dm->fw_buff_is_enpty == false) { + p_dm->fw_debug_trace[p_dm->c2h_cmd_start] = '\0'; + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW Dbg Queue Overflow] %s\n", p_dm->fw_debug_trace)); + p_dm->c2h_cmd_start = 0; + } + + if ((cmd_len - 1) > (60 - p_dm->c2h_cmd_start)) { + p_dm->fw_debug_trace[p_dm->c2h_cmd_start] = '\0'; + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW Dbg Queue error: wrong C2H length] %s\n", p_dm->fw_debug_trace)); + p_dm->c2h_cmd_start = 0; + return; + } + + strncpy((char *)&(p_dm->fw_debug_trace[p_dm->c2h_cmd_start]), (char *)&cmd_buf[1], (cmd_len - 1)); + p_dm->c2h_cmd_start += (cmd_len - 1); + p_dm->fw_buff_is_enpty = false; + + if (freg_num == 0 || p_dm->c2h_cmd_start >= 60) { + if (p_dm->c2h_cmd_start < 60) + p_dm->fw_debug_trace[p_dm->c2h_cmd_start] = '\0'; + else + p_dm->fw_debug_trace[59] = '\0'; + + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW DBG Msg] %s\n", p_dm->fw_debug_trace)); + /*dbg_print("[FW DBG Msg] %s\n", p_dm->fw_debug_trace);*/ + p_dm->c2h_cmd_start = 0; + p_dm->fw_buff_is_enpty = true; + } + + p_dm->pre_c2h_seq = c2h_seq; +#endif /*#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ +} + +void +phydm_fw_trace_handler_code( + void *p_dm_void, + u8 *buffer, + u8 cmd_len +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 function = buffer[0]; + u8 dbg_num = buffer[1]; + u16 content_0 = (((u16)buffer[3]) << 8) | ((u16)buffer[2]); + u16 content_1 = (((u16)buffer[5]) << 8) | ((u16)buffer[4]); + u16 content_2 = (((u16)buffer[7]) << 8) | ((u16)buffer[6]); + u16 content_3 = (((u16)buffer[9]) << 8) | ((u16)buffer[8]); + u16 content_4 = (((u16)buffer[11]) << 8) | ((u16)buffer[10]); + + if (cmd_len > 12) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW Msg] Invalid cmd length (( %d )) >12\n", cmd_len)); + + /* PHYDM_DBG(p_dm, DBG_FW_TRACE,("[FW Msg] Func=((%d)), num=((%d)), ct_0=((%d)), ct_1=((%d)), ct_2=((%d)), ct_3=((%d)), ct_4=((%d))\n", */ + /* function, dbg_num, content_0, content_1, content_2, content_3, content_4)); */ + + /*--------------------------------------------*/ +#ifdef CONFIG_RA_FW_DBG_CODE + if (function == RATE_DECISION) { + if (dbg_num == 0) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] RA_CNT=((%d)) Max_device=((%d))--------------------------->\n", content_1, content_2)); + else if (content_0 == 2) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] Check RA macid= ((%d)), MediaStatus=((%d)), Dis_RA=((%d)), try_bit=((0x%x))\n", content_1, content_2, content_3, content_4)); + else if (content_0 == 3) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] Check RA total=((%d)), drop=((0x%x)), TXRPT_TRY_bit=((%x)), bNoisy=((%x))\n", content_1, content_2, content_3, content_4)); + } else if (dbg_num == 1) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] RTY[0,1,2,3]=[ %d , %d , %d , %d ]\n", content_1, content_2, content_3, content_4)); + else if (content_0 == 2) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] RTY[4]=[ %d ], drop=(( %d )), total=(( %d )), current_rate=((0x %x ))", content_1, content_2, content_3, content_4)); + phydm_print_rate(p_dm, (u8)content_4, DBG_FW_TRACE); + } else if (content_0 == 3) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] penality_idx=(( %d ))\n", content_1)); + else if (content_0 == 4) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] RSSI=(( %d )), ra_stage = (( %d ))\n", content_1, content_2)); + } + + else if (dbg_num == 3) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] Fast_RA (( DOWN )) total=((%d)), total>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); + else if (content_0 == 2) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] Fast_RA (( UP )) total_acc=((%d)), total_acc>>1=((%d)), R4+R3+R2 = ((%d)), RateDownHold = ((%d))\n", content_1, content_2, content_3, content_4)); + else if (content_0 == 3) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] Fast_RA (( UP )) ((rate Down Hold)) RA_CNT=((%d))\n", content_1)); + else if (content_0 == 4) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] Fast_RA (( UP )) ((tota_accl<5 skip)) RA_CNT=((%d))\n", content_1)); + else if (content_0 == 8) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] Fast_RA (( Reset Tx Rpt )) RA_CNT=((%d))\n", content_1)); + } + + else if (dbg_num == 4) { + if (content_0 == 3) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] RER_CNT PCR_ori =(( %d )), ratio_ori =(( %d )), pcr_updown_bitmap =(( 0x%x )), pcr_var_diff =(( %d ))\n", content_1, content_2, content_3, content_4)); + /**/ + } else if (content_0 == 4) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] pcr_shift_value =(( %s%d )), rate_down_threshold =(( %d )), rate_up_threshold =(( %d ))\n", ((content_1) ? "+" : "-"), content_2, content_3, content_4)); + /**/ + } else if (content_0 == 5) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] pcr_mean =(( %d )), PCR_VAR =(( %d )), offset =(( %d )), decision_offset_p =(( %d ))\n", content_1, content_2, content_3, content_4)); + /**/ + } + } + + else if (dbg_num == 5) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] (( UP)) Nsc=(( %d )), N_High=(( %d )), RateUp_Waiting=(( %d )), RateUp_Fail=(( %d ))\n", content_1, content_2, content_3, content_4)); + else if (content_0 == 2) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] ((DOWN)) Nsc=(( %d )), N_Low=(( %d ))\n", content_1, content_2)); + else if (content_0 == 3) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] ((HOLD)) Nsc=((%d)), N_High=((%d)), N_Low=((%d)), Reset_CNT=((%d))\n", content_1, content_2, content_3, content_4)); + } else if (dbg_num == 0x60) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] ((AP RPT)) macid=((%d)), BUPDATE[macid]=((%d))\n", content_1, content_2)); + else if (content_0 == 4) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] ((AP RPT)) pass=((%d)), rty_num=((%d)), drop=((%d)), total=((%d))\n", content_1, content_2, content_3, content_4)); + else if (content_0 == 5) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW] ((AP RPT)) PASS=((%d)), RTY_NUM=((%d)), DROP=((%d)), TOTAL=((%d))\n", content_1, content_2, content_3, content_4)); + } + } + /*--------------------------------------------*/ + else if (function == INIT_RA_TABLE) { + if (dbg_num == 3) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][INIT_RA_INFO] Ra_init, RA_SKIP_CNT = (( %d ))\n", content_0)); + + } + /*--------------------------------------------*/ + else if (function == RATE_UP) { + if (dbg_num == 2) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][RateUp] ((Highest rate->return)), macid=((%d)) Nsc=((%d))\n", content_1, content_2)); + } else if (dbg_num == 5) { + if (content_0 == 0) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][RateUp] ((rate UP)), up_rate_tmp=((0x%x)), rate_idx=((0x%x)), SGI_en=((%d)), SGI=((%d))\n", content_1, content_2, content_3, content_4)); + else if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][RateUp] ((rate UP)), rate_1=((0x%x)), rate_2=((0x%x)), BW=((%d)), Try_Bit=((%d))\n", content_1, content_2, content_3, content_4)); + } + + } + /*--------------------------------------------*/ + else if (function == RATE_DOWN) { + if (dbg_num == 5) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][RateDownStep] ((rate Down)), macid=((%d)), rate1=((0x%x)), rate2=((0x%x)), BW=((%d))\n", content_1, content_2, content_3, content_4)); + } + } else if (function == TRY_DONE) { + if (dbg_num == 1) { + if (content_0 == 1) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][Try Done] ((try succsess )) macid=((%d)), Try_Done_cnt=((%d))\n", content_1, content_2)); + /**/ + } + } else if (dbg_num == 2) { + if (content_0 == 1) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][Try Done] ((try)) macid=((%d)), Try_Done_cnt=((%d)), rate_2=((%d)), try_succes=((%d))\n", content_1, content_2, content_3, content_4)); + /**/ + } + } + } + /*--------------------------------------------*/ + else if (function == RA_H2C) { + if (dbg_num == 1) { + if (content_0 == 0) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][H2C=0x49] fw_trace_en=((%d)), mode =((%d)), macid=((%d))\n", content_1, content_2, content_3)); + /**/ + /*C2H_RA_Dbg_code(F_RA_H2C,1,0, SysMib.ODM.DEBUG.fw_trace_en, mode, macid, 0); //RA MASK*/ + } +#if 0 + else if (dbg_num == 2) { + + if (content_0 == 1) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][H2C=0x40] MACID=((%d)), rate ID=((%d)), SGI=((%d)), BW=((%d))\n", content_1, content_2, content_3, content_4)); + /**/ + } else if (content_0 == 2) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][H2C=0x40] VHT_en=((%d)), Disable_PowerTraining=((%d)), Disable_RA=((%d)), No_Update=((%d))\n", content_1, content_2, content_3, content_4)); + /**/ + } else if (content_0 == 3) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][H2C=0x40] RA_MSK=[%x | %x | %x | %x ]\n", content_1, content_2, content_3, content_4)); + /**/ + } + } +#endif + } + } + /*--------------------------------------------*/ + else if (function == F_RATE_AP_RPT) { + if (dbg_num == 1) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][AP RPT] ((1)), SPE_STATIS=((0x%x))---------->\n", content_3)); + } else if (dbg_num == 2) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][AP RPT] RTY_all=((%d))\n", content_1)); + } else if (dbg_num == 3) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][AP RPT] MACID1[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); + } else if (dbg_num == 4) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][AP RPT] MACID2[%d], TOTAL=((%d)), RTY=((%d))\n", content_3, content_1, content_2)); + } else if (dbg_num == 5) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][AP RPT] MACID1[%d], PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); + } else if (dbg_num == 6) { + if (content_0 == 1) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][AP RPT] MACID2[%d],, PASS=((%d)), DROP=((%d))\n", content_3, content_1, content_2)); + } + } else { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); + /**/ + } +#else + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW][general][%d, %d, %d] = {%d, %d, %d, %d}\n", function, dbg_num, content_0, content_1, content_2, content_3, content_4)); +#endif + /*--------------------------------------------*/ + +#endif /*#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ +} + +void +phydm_fw_trace_handler_8051( + void *p_dm_void, + u8 *buffer, + u8 cmd_len +) +{ +#ifdef CONFIG_PHYDM_DEBUG_FUNCTION + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if 0 + if (cmd_len >= 3) + cmd_buf[cmd_len - 1] = '\0'; + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW DBG Msg] %s\n", &(cmd_buf[3]))); +#else + + int i = 0; + u8 extend_c2h_sub_id = 0, extend_c2h_dbg_len = 0, extend_c2h_dbg_seq = 0; + u8 fw_debug_trace[128]; + u8 *extend_c2h_dbg_content = 0; + + if (cmd_len > 127) + return; + + extend_c2h_sub_id = buffer[0]; + extend_c2h_dbg_len = buffer[1]; + extend_c2h_dbg_content = buffer + 2; /*DbgSeq+DbgContent for show HEX*/ + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + RT_DISP(FC2H, C2H_Summary, ("[Extend C2H packet], Extend_c2hSubId=0x%x, extend_c2h_dbg_len=%d\n", + extend_c2h_sub_id, extend_c2h_dbg_len)); + + RT_DISP_DATA(FC2H, C2H_Summary, "[Extend C2H packet], Content Hex:", extend_c2h_dbg_content, cmd_len - 2); +#endif + +go_backfor_aggre_dbg_pkt: + i = 0; + extend_c2h_dbg_seq = buffer[2]; + extend_c2h_dbg_content = buffer + 3; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + RT_DISP(FC2H, C2H_Summary, ("[RTKFW, SEQ= %d] :", extend_c2h_dbg_seq)); +#endif + + for (; ; i++) { + fw_debug_trace[i] = extend_c2h_dbg_content[i]; + if (extend_c2h_dbg_content[i + 1] == '\0') { + fw_debug_trace[i + 1] = '\0'; + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); + break; + } else if (extend_c2h_dbg_content[i] == '\n') { + fw_debug_trace[i + 1] = '\0'; + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("[FW DBG Msg] %s", &(fw_debug_trace[0]))); + buffer = extend_c2h_dbg_content + i + 3; + goto go_backfor_aggre_dbg_pkt; + } + } + + +#endif +#endif /*#ifdef CONFIG_PHYDM_DEBUG_FUNCTION*/ +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.h index 1e2b7c514ac6..dbe86a2a1534 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_debug.h @@ -1,357 +1,365 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - -#ifndef __ODM_DBG_H__ -#define __ODM_DBG_H__ - -/*#define DEBUG_VERSION "1.1"*/ /*2015.07.29 YuChen*/ -/*#define DEBUG_VERSION "1.2"*/ /*2015.08.28 Dino*/ -#define DEBUG_VERSION "1.3" /*2016.04.28 YuChen*/ -//----------------------------------------------------------------------------- -// Define the debug levels -// -// 1. DBG_TRACE and DBG_LOUD are used for normal cases. -// So that, they can help SW engineer to develope or trace states changed -// and also help HW enginner to trace every operation to and from HW, -// e.g IO, Tx, Rx. -// -// 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, -// which help us to debug SW or HW. -// -//----------------------------------------------------------------------------- -// -// Never used in a call to ODM_RT_TRACE()! -// -#define ODM_DBG_OFF 1 - -// -// Fatal bug. -// For example, Tx/Rx/IO locked up, OS hangs, memory access violation, -// resource allocation failed, unexpected HW behavior, HW BUG and so on. -// -#define ODM_DBG_SERIOUS 2 - -// -// Abnormal, rare, or unexpeted cases. -// For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. -// -#define ODM_DBG_WARNING 3 - -// -// Normal case with useful information about current SW or HW state. -// For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, -// SW protocol state change, dynamic mechanism state change and so on. -// -#define ODM_DBG_LOUD 4 - -// -// Normal case with detail execution flow or information. -// -#define ODM_DBG_TRACE 5 - -/*FW DBG MSG*/ -#define RATE_DECISION BIT0 -#define INIT_RA_TABLE BIT1 -#define RATE_UP BIT2 -#define RATE_DOWN BIT3 -#define TRY_DONE BIT4 -#define RA_H2C BIT5 -#define F_RATE_AP_RPT BIT7 - -//----------------------------------------------------------------------------- -// Define the tracing components -// -//----------------------------------------------------------------------------- -/*BB FW Functions*/ -#define PHYDM_FW_COMP_RA BIT0 -#define PHYDM_FW_COMP_MU BIT1 -#define PHYDM_FW_COMP_PATH_DIV BIT2 -#define PHYDM_FW_COMP_PHY_CONFIG BIT3 - - -/*BB Driver Functions*/ -#define ODM_COMP_DIG BIT0 -#define ODM_COMP_RA_MASK BIT1 -#define ODM_COMP_DYNAMIC_TXPWR BIT2 -#define ODM_COMP_FA_CNT BIT3 -#define ODM_COMP_RSSI_MONITOR BIT4 -#define ODM_COMP_SNIFFER BIT5 -#define ODM_COMP_ANT_DIV BIT6 -#define ODM_COMP_DFS BIT7 -#define ODM_COMP_NOISY_DETECT BIT8 -#define ODM_COMP_RATE_ADAPTIVE BIT9 -#define ODM_COMP_PATH_DIV BIT10 -#define ODM_COMP_CCX BIT11 - -#define ODM_COMP_DYNAMIC_PRICCA BIT12 - /*BIT13 TBD*/ -#define ODM_COMP_MP BIT14 -#define ODM_COMP_CFO_TRACKING BIT15 -#define ODM_COMP_ACS BIT16 -#define PHYDM_COMP_ADAPTIVITY BIT17 -#define PHYDM_COMP_RA_DBG BIT18 -#define PHYDM_COMP_TXBF BIT19 -//MAC Functions -#define ODM_COMP_EDCA_TURBO BIT20 - /*BIT21 TBD*/ -#define ODM_FW_DEBUG_TRACE BIT22 -//RF Functions - /*BIT23 TBD*/ -#define ODM_COMP_TX_PWR_TRACK BIT24 - /*BIT25 TBD*/ -#define ODM_COMP_CALIBRATION BIT26 -//Common Functions - /*BIT27 TBD*/ -#define ODM_PHY_CONFIG BIT28 -#define ODM_COMP_INIT BIT29 -#define ODM_COMP_COMMON BIT30 -#define ODM_COMP_API BIT31 - - -/*------------------------Export Marco Definition---------------------------*/ - -#define config_phydm_read_txagc_check(data) (data != INVALID_TXAGC_DATA) - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #define RT_PRINTK DbgPrint -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #define DbgPrint printk - #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); - #define RT_DISP(dbgtype, dbgflag, printstr) -#else - #define DbgPrint panic_printk - #define RT_PRINTK(fmt, args...) DbgPrint( "%s(): " fmt, __FUNCTION__, ## args); -#endif - -#ifndef ASSERT - #define ASSERT(expr) -#endif - -#if DBG -#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) \ - do { \ - if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel || level == ODM_DBG_SERIOUS)) \ - { \ - if (pDM_Odm->SupportICType == ODM_RTL8188E) \ - DbgPrint("[PhyDM-8188E] "); \ - else if(pDM_Odm->SupportICType == ODM_RTL8192E) \ - DbgPrint("[PhyDM-8192E] "); \ - else if(pDM_Odm->SupportICType == ODM_RTL8812) \ - DbgPrint("[PhyDM-8812A] "); \ - else if(pDM_Odm->SupportICType == ODM_RTL8821) \ - DbgPrint("[PhyDM-8821A] "); \ - else if(pDM_Odm->SupportICType == ODM_RTL8814A) \ - DbgPrint("[PhyDM-8814A] "); \ - else if(pDM_Odm->SupportICType == ODM_RTL8703B) \ - DbgPrint("[PhyDM-8703B] "); \ - else if(pDM_Odm->SupportICType == ODM_RTL8822B) \ - DbgPrint("[PhyDM-8822B] "); \ - else if (pDM_Odm->SupportICType == ODM_RTL8188F) \ - DbgPrint("[PhyDM-8188F] "); \ - RT_PRINTK fmt; \ - } \ - } while (0) - -#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) \ - if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ - { \ - RT_PRINTK fmt; \ - } - -#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) \ - if(!(expr)) { \ - DbgPrint( "Assertion failed! %s at ......\n", #expr); \ - DbgPrint( " ......%s,%s,line=%d\n",__FILE__,__FUNCTION__,__LINE__); \ - RT_PRINTK fmt; \ - ASSERT(FALSE); \ - } -#define ODM_dbg_enter() { DbgPrint("==> %s\n", __FUNCTION__); } -#define ODM_dbg_exit() { DbgPrint("<== %s\n", __FUNCTION__); } -#define ODM_dbg_trace(str) { DbgPrint("%s:%s\n", __FUNCTION__, str); } - -#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) \ - if(((comp) & pDM_Odm->DebugComponents) && (level <= pDM_Odm->DebugLevel)) \ - { \ - int __i; \ - pu1Byte __ptr = (pu1Byte)ptr; \ - DbgPrint("[ODM] "); \ - DbgPrint(title_str); \ - DbgPrint(" "); \ - for( __i=0; __i<6; __i++ ) \ - DbgPrint("%02X%s", __ptr[__i], (__i==5)?"":"-"); \ - DbgPrint("\n"); \ - } -#else -#define ODM_RT_TRACE(pDM_Odm, comp, level, fmt) -#define ODM_RT_TRACE_F(pDM_Odm, comp, level, fmt) -#define ODM_RT_ASSERT(pDM_Odm, expr, fmt) -#define ODM_dbg_enter() -#define ODM_dbg_exit() -#define ODM_dbg_trace(str) -#define ODM_PRINT_ADDR(pDM_Odm, comp, level, title_str, ptr) -#endif - - -VOID -PHYDM_InitDebugSetting(IN PDM_ODM_T pDM_Odm); - -VOID phydm_BasicDbgMessage( IN PVOID pDM_VOID); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#define PHYDM_DBGPRINT 0 -#define PHYDM_SSCANF(x, y, z) DCMD_Scanf(x, y, z) -#define PHYDM_VAST_INFO_SNPRINTF PHYDM_SNPRINTF -#if (PHYDM_DBGPRINT == 1) -#define PHYDM_SNPRINTF(msg) \ - do {\ - rsprintf msg;\ - DbgPrint(output);\ - } while (0) -#else -#define PHYDM_SNPRINTF(msg) \ - do {\ - rsprintf msg;\ - DCMD_Printf(output);\ - } while (0) -#endif -#else -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) || defined(__OSK__) -#define PHYDM_DBGPRINT 0 -#else -#define PHYDM_DBGPRINT 1 -#endif -#define MAX_ARGC 20 -#define MAX_ARGV 16 -#define DCMD_DECIMAL "%d" -#define DCMD_CHAR "%c" -#define DCMD_HEX "%x" - -#define PHYDM_SSCANF(x, y, z) sscanf(x, y, z) - -#define PHYDM_VAST_INFO_SNPRINTF(msg)\ - do {\ - snprintf msg;\ - DbgPrint(output);\ - } while (0) - -#if (PHYDM_DBGPRINT == 1) -#define PHYDM_SNPRINTF(msg)\ - do {\ - snprintf msg;\ - DbgPrint(output);\ - } while (0) -#else -#define PHYDM_SNPRINTF(msg)\ - do {\ - if(out_len > used)\ - used+=snprintf msg;\ - } while (0) -#endif -#endif - - -VOID phydm_BasicProfile( - IN PVOID pDM_VOID, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ); -#if(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) -s4Byte -phydm_cmd( - IN PDM_ODM_T pDM_Odm, - IN char *input, - IN u4Byte in_len, - IN u1Byte flag, - OUT char *output, - IN u4Byte out_len -); -#endif -VOID -phydm_cmd_parser( - IN PDM_ODM_T pDM_Odm, - IN char input[][16], - IN u4Byte input_num, - IN u1Byte flag, - OUT char *output, - IN u4Byte out_len -); - -VOID -phydm_la_mode_bb_setting( - IN PVOID pDM_VOID, - IN u4Byte DbgPort, - IN BOOLEAN bTriggerEdge, - IN u1Byte sampling_rate -); - -u1Byte -phydm_la_mode_mac_setting( - IN PVOID pDM_VOID, - IN u4Byte TriggerTime_mu_sec -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -void phydm_sbd_check( - IN PDM_ODM_T pDM_Odm - ); - -void phydm_sbd_callback( - PRT_TIMER pTimer - ); - -void phydm_sbd_workitem_callback( - IN PVOID pContext - ); -#endif - -VOID -phydm_fw_trace_en_h2c( - IN PVOID pDM_VOID, - IN BOOLEAN enable, - IN u4Byte fw_debug_component, - IN u4Byte monitor_mode, - IN u4Byte macid -); - -VOID -phydm_fw_trace_handler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -); - -VOID -phydm_fw_trace_handler_code( - IN PVOID pDM_VOID, - IN pu1Byte Buffer, - IN u1Byte CmdLen -); - -VOID -phydm_fw_trace_handler_8051( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -); - -#endif // __ODM_DBG_H__ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __ODM_DBG_H__ +#define __ODM_DBG_H__ + +/*#define DEBUG_VERSION "1.1"*/ /*2015.07.29 YuChen*/ +/*#define DEBUG_VERSION "1.2"*/ /*2015.08.28 Dino*/ +/*#define DEBUG_VERSION "1.3"*/ /*2016.04.28 YuChen*/ +#define DEBUG_VERSION "1.4" /*2017.03.13 Dino*/ + +/* ----------------------------------------------------------------------------- + * Define the debug levels + * + * 1. DBG_TRACE and DBG_LOUD are used for normal cases. + * So that, they can help SW engineer to develope or trace states changed + * and also help HW enginner to trace every operation to and from HW, + * e.g IO, Tx, Rx. + * + * 2. DBG_WARNNING and DBG_SERIOUS are used for unusual or error cases, + * which help us to debug SW or HW. + * + * ----------------------------------------------------------------------------- + * + * Never used in a call to ODM_RT_TRACE()! + * */ +#define ODM_DBG_OFF 1 + +/* + * Fatal bug. + * For example, Tx/Rx/IO locked up, OS hangs, memory access violation, + * resource allocation failed, unexpected HW behavior, HW BUG and so on. + * */ +#define ODM_DBG_SERIOUS 2 + +/* + * Abnormal, rare, or unexpeted cases. + * For example, IRP/Packet/OID canceled, device suprisely unremoved and so on. + * */ +#define ODM_DBG_WARNING 3 + +/* + * Normal case with useful information about current SW or HW state. + * For example, Tx/Rx descriptor to fill, Tx/Rx descriptor completed status, + * SW protocol state change, dynamic mechanism state change and so on. + * */ +#define ODM_DBG_LOUD 4 + +/* + * Normal case with detail execution flow or information. + * */ +#define ODM_DBG_TRACE 5 + +/*FW DBG MSG*/ +#define RATE_DECISION BIT(0) +#define INIT_RA_TABLE BIT(1) +#define RATE_UP BIT(2) +#define RATE_DOWN BIT(3) +#define TRY_DONE BIT(4) +#define RA_H2C BIT(5) +#define F_RATE_AP_RPT BIT(7) + +/* ----------------------------------------------------------------------------- + * Define the tracing components + * + * ----------------------------------------------------------------------------- + *BB FW Functions*/ +#define PHYDM_FW_COMP_RA BIT(0) +#define PHYDM_FW_COMP_MU BIT(1) +#define PHYDM_FW_COMP_PATH_DIV BIT(2) +#define PHYDM_FW_COMP_PT BIT(3) + + + + +/*------------------------Export Marco Definition---------------------------*/ + +#define config_phydm_read_txagc_check(data) (data != INVALID_TXAGC_DATA) + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define dbg_print DbgPrint + #define dcmd_printf DCMD_Printf + #define dcmd_scanf DCMD_Scanf + #define RT_PRINTK dbg_print +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + #define dbg_print(args...) + #define RT_PRINTK(fmt, args...) \ + RT_TRACE(((struct rtl_priv *)p_dm->adapter), \ + COMP_PHYDM, DBG_DMESG, fmt, ## args) + #define RT_DISP(dbgtype, dbgflag, printstr) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #define dbg_print printk + #define RT_PRINTK(fmt, args...) dbg_print(fmt, ## args) + #define RT_DISP(dbgtype, dbgflag, printstr) +#else + #define dbg_print panic_printk + /*#define RT_PRINTK(fmt, args...) dbg_print("%s(): " fmt, __FUNCTION__, ## args);*/ + #define RT_PRINTK(args...) dbg_print(args) +#endif + +#ifndef ASSERT + #define ASSERT(expr) +#endif + +#if DBG +#define PHYDM_DBG(p_dm, comp, fmt) \ + do { \ + if ((comp) & (p_dm->debug_components)) { \ + \ + dbg_print("[PHYDM] "); \ + RT_PRINTK fmt; \ + } \ + } while (0) + +#define PHYDM_DBG_F(p_dm, comp, fmt) do {\ + if ((comp) & p_dm->debug_components) { \ + \ + RT_PRINTK fmt; \ + } \ + } while (0) + +#define PHYDM_PRINT_ADDR(p_dm, comp, title_str, ptr) do {\ + if ((comp) & p_dm->debug_components) { \ + \ + int __i; \ + u8 *__ptr = (u8 *)ptr; \ + dbg_print("[PHYDM] "); \ + dbg_print(title_str); \ + dbg_print(" "); \ + for (__i = 0; __i < 6; __i++) \ + dbg_print("%02X%s", __ptr[__i], (__i == 5) ? "" : "-"); \ + dbg_print("\n"); \ + } \ + } while (0) + +#define ODM_RT_TRACE(p_dm, comp, level, fmt) \ + do { \ + if (((comp) & p_dm->debug_components) && (level <= p_dm->debug_level || level == ODM_DBG_SERIOUS)) { \ + \ + if (p_dm->support_ic_type == ODM_RTL8188E) \ + dbg_print("[PhyDM-8188E] "); \ + else if (p_dm->support_ic_type == ODM_RTL8192E) \ + dbg_print("[PhyDM-8192E] "); \ + else if (p_dm->support_ic_type == ODM_RTL8812) \ + dbg_print("[PhyDM-8812A] "); \ + else if (p_dm->support_ic_type == ODM_RTL8821) \ + dbg_print("[PhyDM-8821A] "); \ + else if (p_dm->support_ic_type == ODM_RTL8814A) \ + dbg_print("[PhyDM-8814A] "); \ + else if (p_dm->support_ic_type == ODM_RTL8703B) \ + dbg_print("[PhyDM-8703B] "); \ + else if (p_dm->support_ic_type == ODM_RTL8822B) \ + dbg_print("[PhyDM-8822B] "); \ + else if (p_dm->support_ic_type == ODM_RTL8188F) \ + dbg_print("[PhyDM-8188F] "); \ + RT_PRINTK fmt; \ + } \ + } while (0) + +#else +#define PHYDM_DBG(p_dm, comp, fmt) +#define PHYDM_DBG_F(p_dm, comp, fmt) +#define PHYDM_PRINT_ADDR(p_dm, comp, title_str, ptr) + +#define ODM_RT_TRACE(p_dm, comp, level, fmt) +#endif + +#define BB_DBGPORT_PRIORITY_3 3 /*Debug function (the highest priority)*/ +#define BB_DBGPORT_PRIORITY_2 2 /*Check hang function & Strong function*/ +#define BB_DBGPORT_PRIORITY_1 1 /*Watch dog function*/ +#define BB_DBGPORT_RELEASE 0 /*Init value (the lowest priority)*/ + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#define PHYDM_DBGPRINT 0 +#define PHYDM_SSCANF(x, y, z) dcmd_scanf(x, y, z) +#define PHYDM_VAST_INFO_SNPRINTF PHYDM_SNPRINTF +#if (PHYDM_DBGPRINT == 1) +#define PHYDM_SNPRINTF(msg) \ + do {\ + rsprintf msg;\ + dbg_print(output);\ + } while (0) +#else +#define PHYDM_SNPRINTF(msg) \ + do {\ + rsprintf msg;\ + dcmd_printf(output);\ + } while (0) +#endif +#else +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) || defined(__OSK__) + #define PHYDM_DBGPRINT 0 +#else + #define PHYDM_DBGPRINT 1 +#endif +#define MAX_ARGC 20 +#define MAX_ARGV 16 +#define DCMD_DECIMAL "%d" +#define DCMD_CHAR "%c" +#define DCMD_HEX "%x" + +#define PHYDM_SSCANF(x, y, z) sscanf(x, y, z) + +#define PHYDM_VAST_INFO_SNPRINTF(msg)\ + do {\ + snprintf msg;\ + dbg_print(output);\ + } while (0) + +#if (PHYDM_DBGPRINT == 1) +#define PHYDM_SNPRINTF(msg)\ + do {\ + snprintf msg;\ + dbg_print(output);\ + } while (0) +#else +#define PHYDM_SNPRINTF(msg)\ + do {\ + if (out_len > used)\ + used += snprintf msg;\ + } while (0) +#endif +#endif + +void +phydm_init_debug_setting( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_bb_dbg_port_header_sel( + void *p_dm_void, + u32 header_idx +); + +u8 +phydm_set_bb_dbg_port( + void *p_dm_void, + u8 curr_dbg_priority, + u32 debug_port +); + +void +phydm_release_bb_dbg_port( + void *p_dm_void +); + +u32 +phydm_get_bb_dbg_port_value( + void *p_dm_void +); + +void +phydm_reset_rx_rate_distribution( + struct PHY_DM_STRUCT *p_dm_odm +); + +void +phydm_rx_rate_distribution +( + void *p_dm_void +); + +void +phydm_get_avg_phystatus_val +( + void *p_dm_void +); + +void +phydm_get_phy_statistic( + void *p_dm_void +); + +void +phydm_basic_dbg_message( + void *p_dm_void +); + +void +phydm_basic_profile( + void *p_dm_void, + u32 *_used, + char *output, + u32 *_out_len +); +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_AP)) +s32 +phydm_cmd( + struct PHY_DM_STRUCT *p_dm, + char *input, + u32 in_len, + u8 flag, + char *output, + u32 out_len +); +#endif +void +phydm_cmd_parser( + struct PHY_DM_STRUCT *p_dm, + char input[][16], + u32 input_num, + u8 flag, + char *output, + u32 out_len +); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void phydm_sbd_check( + struct PHY_DM_STRUCT *p_dm +); + +void phydm_sbd_callback( + struct timer_list *p_timer +); + +void phydm_sbd_workitem_callback( + void *p_context +); +#endif + +void +phydm_fw_trace_en_h2c( + void *p_dm_void, + boolean enable, + u32 fw_debug_component, + u32 monitor_mode, + u32 macid +); + +void +phydm_fw_trace_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +); + +void +phydm_fw_trace_handler_code( + void *p_dm_void, + u8 *buffer, + u8 cmd_len +); + +void +phydm_fw_trace_handler_8051( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +); + +#endif /* __ODM_DBG_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.c index 12f7e6fdd2a0..53f00801f1b1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.c @@ -1,258 +1,680 @@ -/****************************************************************************** - * - * 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 files -============================================================ -*/ - -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if defined(CONFIG_PHYDM_DFS_MASTER) -VOID phydm_radar_detect_reset(PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ - ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); - ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 1); +/* +============================================================ + include files +============================================================ +*/ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#if defined(CONFIG_PHYDM_DFS_MASTER) + +boolean phydm_dfs_is_meteorology_channel(void *p_dm_void){ + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + u8 c_channel = *(p_dm->p_channel); + u8 band_width = *(p_dm->p_band_width); + + return ( (band_width == CHANNEL_WIDTH_80 && (c_channel) >= 116 && (c_channel) <= 128) || + (band_width == CHANNEL_WIDTH_40 && (c_channel) >= 116 && (c_channel) <= 128) || + (band_width == CHANNEL_WIDTH_20 && (c_channel) >= 120 && (c_channel) <= 128) ); } -VOID phydm_radar_detect_disable(PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_SetBBReg(pDM_Odm, 0x924 , BIT15, 0); -} - -static VOID phydm_radar_detect_with_dbg_parm(PVOID pDM_VOID) +void phydm_radar_detect_reset(void *p_dm_void) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, pDM_Odm->radar_detect_reg_918); - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, pDM_Odm->radar_detect_reg_91c); - ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, pDM_Odm->radar_detect_reg_920); - ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, pDM_Odm->radar_detect_reg_924); + odm_set_bb_reg(p_dm, 0x924, BIT(15), 0); + odm_set_bb_reg(p_dm, 0x924, BIT(15), 1); } -/* Init radar detection parameters, called after ch, bw is set */ -VOID phydm_radar_detect_enable(PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte region_domain = pDM_Odm->DFS_RegionDomain; - u1Byte c_channel = *(pDM_Odm->pChannel); +void phydm_radar_detect_disable(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + odm_set_bb_reg(p_dm, 0x924, BIT(15), 0); + PHYDM_DBG(p_dm, DBG_DFS, ("\n")); +} + +static void phydm_radar_detect_with_dbg_parm(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, p_dm->radar_detect_reg_918); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, p_dm->radar_detect_reg_91c); + odm_set_bb_reg(p_dm, 0x920, MASKDWORD, p_dm->radar_detect_reg_920); + odm_set_bb_reg(p_dm, 0x924, MASKDWORD, p_dm->radar_detect_reg_924); +} + +/* Init radar detection parameters, called after ch, bw is set */ +void phydm_radar_detect_enable(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DFS_STATISTICS *p_dfs = (struct _DFS_STATISTICS *)phydm_get_structure(p_dm, PHYDM_DFS); + u8 region_domain = p_dm->dfs_region_domain; + u8 c_channel = *(p_dm->p_channel); + u8 band_width = *(p_dm->p_band_width); + u8 enable = 0; + + PHYDM_DBG(p_dm, DBG_DFS, ("test, region_domain = %d\n", region_domain)); if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); - return; + PHYDM_DBG(p_dm, DBG_DFS, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); + goto exit; } - if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8812 | ODM_RTL8881A)) { - - ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10); - ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06); + if (p_dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8812 | ODM_RTL8881A)) { - if (pDM_Odm->radar_detect_dbg_parm_en) { - phydm_radar_detect_with_dbg_parm(pDM_Odm); + odm_set_bb_reg(p_dm, 0x814, 0x3fffffff, 0x04cc4d10); + odm_set_bb_reg(p_dm, 0x834, MASKBYTE0, 0x06); + + if (p_dm->radar_detect_dbg_parm_en) { + phydm_radar_detect_with_dbg_parm(p_dm); + enable = 1; goto exit; } if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c17ecdf); - ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20); - ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f69204); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c17ecdf); + odm_set_bb_reg(p_dm, 0x924, MASKDWORD, 0x01528500); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x0fa21a20); + odm_set_bb_reg(p_dm, 0x920, MASKDWORD, 0xe0f69204); } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { - ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); - ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67234); + odm_set_bb_reg(p_dm, 0x924, MASKDWORD, 0x01528500); + odm_set_bb_reg(p_dm, 0x920, MASKDWORD, 0xe0d67234); if (c_channel >= 52 && c_channel <= 64) { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf); - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0f141a20); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c16ecdf); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x0f141a20); } else { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); - if (pDM_Odm->pBandWidth == ODM_BW20M) - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64721a20); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c16acdf); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x64721a20); else - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68721a20); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x68721a20); } } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); - ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x01528500); - ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67231); - if (pDM_Odm->pBandWidth == ODM_BW20M) - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64741a20); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c16acdf); + odm_set_bb_reg(p_dm, 0x924, MASKDWORD, 0x01528500); + odm_set_bb_reg(p_dm, 0x920, MASKDWORD, 0xe0d67231); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x64741a20); else - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68741a20); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x68741a20); + } else { /* not supported */ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported DFS_RegionDomain:%d\n", region_domain)); + PHYDM_DBG(p_dm, DBG_DFS, ("Unsupported dfs_region_domain:%d\n", region_domain)); + goto exit; } - } else if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) { - - ODM_SetBBReg(pDM_Odm, 0x814, 0x3fffffff, 0x04cc4d10); - ODM_SetBBReg(pDM_Odm, 0x834, bMaskByte0, 0x06); - - /* 8822B only, when BW = 20M, DFIR output is 40Mhz, but DFS input is 80MMHz, so it need to upgrade to 80MHz */ - if (pDM_Odm->SupportICType & ODM_RTL8822B) { - if (pDM_Odm->pBandWidth == ODM_BW20M) - ODM_SetBBReg(pDM_Odm, 0x1984, BIT26, 1); + } else if (p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C)) { + + odm_set_bb_reg(p_dm, 0x814, 0x3fffffff, 0x04cc4d10); + odm_set_bb_reg(p_dm, 0x834, MASKBYTE0, 0x06); + + /* 8822B only, when BW = 20M, DFIR output is 40Mhz, but DFS input is 80MMHz, so it need to upgrade to 80MHz */ + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) { + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(p_dm, 0x1984, BIT(26), 1); else - ODM_SetBBReg(pDM_Odm, 0x1984, BIT26, 0); + odm_set_bb_reg(p_dm, 0x1984, BIT(26), 0); } - if (pDM_Odm->radar_detect_dbg_parm_en) { - phydm_radar_detect_with_dbg_parm(pDM_Odm); + if (p_dm->radar_detect_dbg_parm_en) { + phydm_radar_detect_with_dbg_parm(p_dm); + enable = 1; goto exit; } if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16acdf); - ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0fa21a20); - ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0f57204); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c16acdf); + odm_set_bb_reg(p_dm, 0x924, MASKDWORD, 0x095a8500); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x0fa21a20); + odm_set_bb_reg(p_dm, 0x920, MASKDWORD, 0xe0f57204); } else if (region_domain == PHYDM_DFS_DOMAIN_MKK) { - ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); - ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67234); + odm_set_bb_reg(p_dm, 0x924, MASKDWORD, 0x095a8500); + odm_set_bb_reg(p_dm, 0x920, MASKDWORD, 0xe0d67234); if (c_channel >= 52 && c_channel <= 64) { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c16ecdf); - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x0f141a20); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c16ecdf); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x0f141a20); } else { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c166cdf); - if (pDM_Odm->pBandWidth == ODM_BW20M) - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64721a20); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c166cdf); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x64721a20); else - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68721a20); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x68721a20); } + } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { - ODM_SetBBReg(pDM_Odm, 0x918, bMaskDWord, 0x1c166cdf); - ODM_SetBBReg(pDM_Odm, 0x924, bMaskDWord, 0x095a8500); - ODM_SetBBReg(pDM_Odm, 0x920, bMaskDWord, 0xe0d67231); - if (pDM_Odm->pBandWidth == ODM_BW20M) - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x64741a20); + odm_set_bb_reg(p_dm, 0x918, MASKDWORD, 0x1c166cdf); + odm_set_bb_reg(p_dm, 0x924, MASKDWORD, 0x095a8500); + odm_set_bb_reg(p_dm, 0x920, MASKDWORD, 0xe0d67231); + if (band_width == CHANNEL_WIDTH_20) + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x64741a20); else - ODM_SetBBReg(pDM_Odm, 0x91c, bMaskDWord, 0x68741a20); + odm_set_bb_reg(p_dm, 0x91c, MASKDWORD, 0x68741a20); + } else { /* not supported */ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported DFS_RegionDomain:%d\n", region_domain)); + PHYDM_DBG(p_dm, DBG_DFS, ("Unsupported dfs_region_domain:%d\n", region_domain)); + goto exit; } } else { /* not supported IC type*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("Unsupported IC Type:%d\n", pDM_Odm->SupportICType)); + PHYDM_DBG(p_dm, DBG_DFS, ("Unsupported IC type:%d\n", p_dm->support_ic_type)); + goto exit; } + enable = 1; + + p_dfs->st_l2h_cur = (u8)odm_get_bb_reg(p_dm, 0x91c, 0x000000ff); + p_dfs->pwdb_th = (u8)odm_get_bb_reg(p_dm, 0x918, 0x00001f00); + p_dfs->peak_th = (u8)odm_get_bb_reg(p_dm, 0x918, 0x00030000); + p_dfs->short_pulse_cnt_th = (u8)odm_get_bb_reg(p_dm, 0x920, 0x000f0000); + p_dfs->long_pulse_cnt_th = (u8)odm_get_bb_reg(p_dm, 0x920, 0x00f00000); + p_dfs->peak_window = (u8)odm_get_bb_reg(p_dm, 0x920, 0x00000300); + p_dfs->nb2wb_th = (u8)odm_get_bb_reg(p_dm, 0x920, 0x0000e000); + + phydm_dfs_parameter_init(p_dm); + exit: - phydm_radar_detect_reset(pDM_Odm); + if (enable) { + phydm_radar_detect_reset(p_dm); + PHYDM_DBG(p_dm, DBG_DFS, ("on cch:%u, bw:%u\n", c_channel, band_width)); + } else + phydm_radar_detect_disable(p_dm); } -BOOLEAN phydm_radar_detect(PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - BOOLEAN enable_DFS = FALSE; - BOOLEAN radar_detected = FALSE; - u1Byte region_domain = pDM_Odm->DFS_RegionDomain; - - if (region_domain == PHYDM_DFS_DOMAIN_UNKNOWN) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD, ("PHYDM_DFS_DOMAIN_UNKNOWN\n")); - return FALSE; - } - - if (ODM_GetBBReg(pDM_Odm , 0x924, BIT15)) - enable_DFS = TRUE; +void phydm_dfs_parameter_init(void *p_dm_void) +{ - if ((ODM_GetBBReg(pDM_Odm , 0xf98, BIT17)) - || (!(region_domain == PHYDM_DFS_DOMAIN_ETSI) && (ODM_GetBBReg(pDM_Odm , 0xf98, BIT19)))) - radar_detected = TRUE; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DFS_STATISTICS *p_dfs = (struct _DFS_STATISTICS *)phydm_get_structure(p_dm, PHYDM_DFS); + + u8 i; + + p_dfs->fa_mask_th = 30; + p_dfs->det_print = 1; + p_dfs->det_print2 = 0; + p_dfs->st_l2h_min = 0x20; + p_dfs->st_l2h_max = 0x4e; + p_dfs->pwdb_scalar_factor = 12; + p_dfs->pwdb_th = 8; + for (i = 0 ; i < 5 ; i++) { + p_dfs->pulse_flag_hist[i] = 0; + p_dfs->radar_det_mask_hist[i] = 0; + p_dfs->fa_inc_hist[i] = 0; + } + +} + +void phydm_dfs_dynamic_setting( + void *p_dm_void +){ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DFS_STATISTICS *p_dfs = (struct _DFS_STATISTICS *)phydm_get_structure(p_dm, PHYDM_DFS); + + u8 peak_th_cur=0, short_pulse_cnt_th_cur=0, long_pulse_cnt_th_cur=0, three_peak_opt_cur=0, three_peak_th2_cur=0; + u8 peak_window_cur=0, nb2wb_th_cur=0; + u8 region_domain = p_dm->dfs_region_domain; + u8 c_channel = *(p_dm->p_channel); + + if (p_dm->rx_tp <= 2) { + p_dfs->idle_mode = 1; + if(p_dfs->force_TP_mode) + p_dfs->idle_mode = 0; + } else{ + p_dfs->idle_mode = 0; + } + + if ((p_dfs->idle_mode == 1)) { /*idle (no traffic)*/ + peak_th_cur = 3; + short_pulse_cnt_th_cur = 6; + long_pulse_cnt_th_cur = 13; + peak_window_cur = 2; + nb2wb_th_cur = 6; + three_peak_opt_cur = 1; + three_peak_th2_cur = 2; + if (region_domain == PHYDM_DFS_DOMAIN_MKK) { + if ((c_channel >= 52) && (c_channel <= 64)) { + short_pulse_cnt_th_cur = 14; + long_pulse_cnt_th_cur = 15; + nb2wb_th_cur = 3; + three_peak_th2_cur = 0; + } else { + short_pulse_cnt_th_cur = 6; + nb2wb_th_cur = 3; + three_peak_th2_cur = 0; + long_pulse_cnt_th_cur = 10; + } + } else if (region_domain == PHYDM_DFS_DOMAIN_FCC) { + three_peak_th2_cur = 0; + } else if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { + long_pulse_cnt_th_cur = 15; + if (phydm_dfs_is_meteorology_channel(p_dm)) {/*need to add check cac end condition*/ + peak_th_cur = 2; + nb2wb_th_cur = 3; + three_peak_opt_cur = 1; + three_peak_th2_cur = 0; + short_pulse_cnt_th_cur = 7; + } else { + three_peak_opt_cur = 1; + three_peak_th2_cur = 0; + short_pulse_cnt_th_cur = 7; + nb2wb_th_cur = 3; + } + } else /*default: FCC*/ + three_peak_th2_cur = 0; + + } else { /*in service (with TP)*/ + peak_th_cur = 2; + short_pulse_cnt_th_cur = 6; + long_pulse_cnt_th_cur = 9; + peak_window_cur = 2; + nb2wb_th_cur = 3; + three_peak_opt_cur = 1; + three_peak_th2_cur = 2; + if(region_domain == PHYDM_DFS_DOMAIN_MKK){ + if ((c_channel >= 52) && (c_channel <= 64)) { + long_pulse_cnt_th_cur = 15; + short_pulse_cnt_th_cur = 5; /*for high duty cycle*/ + three_peak_th2_cur = 0; + } + else { + three_peak_opt_cur = 0; + three_peak_th2_cur = 0; + long_pulse_cnt_th_cur = 8; + } + } + else if(region_domain == PHYDM_DFS_DOMAIN_FCC){ + } + else if(region_domain == PHYDM_DFS_DOMAIN_ETSI){ + long_pulse_cnt_th_cur = 15; + short_pulse_cnt_th_cur = 5; + three_peak_opt_cur = 0; + } + else{ + } + } + +} + + +boolean +phydm_radar_detect_dm_check( + void *p_dm_void +){ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DFS_STATISTICS *p_dfs = (struct _DFS_STATISTICS *)phydm_get_structure(p_dm, PHYDM_DFS); + u8 region_domain = p_dm->dfs_region_domain, index = 0; + + u16 i = 0, k = 0, fa_count_cur = 0, fa_count_inc = 0, total_fa_in_hist = 0, pre_post_now_acc_fa_in_hist = 0, max_fa_in_hist = 0, vht_crc_ok_cnt_cur = 0; + u16 vht_crc_ok_cnt_inc = 0, ht_crc_ok_cnt_cur = 0, ht_crc_ok_cnt_inc = 0, leg_crc_ok_cnt_cur = 0, leg_crc_ok_cnt_inc = 0; + u16 total_crc_ok_cnt_inc = 0, short_pulse_cnt_cur = 0, short_pulse_cnt_inc = 0, long_pulse_cnt_cur = 0, long_pulse_cnt_inc = 0, total_pulse_count_inc = 0; + u32 regf98_value = 0, reg918_value = 0, reg91c_value = 0, reg920_value = 0, reg924_value = 0; + boolean tri_short_pulse = 0, tri_long_pulse = 0, radar_type = 0, fault_flag_det = 0, fault_flag_psd = 0, fa_flag = 0, radar_detected = 0; + u8 st_l2h_new = 0, fa_mask_th = 0, sum = 0; + u8 c_channel = *(p_dm->p_channel); + + /*Get FA count during past 100ms*/ + fa_count_cur = (u16)odm_get_bb_reg(p_dm, 0xf48, 0x0000ffff); + + if (p_dfs->fa_count_pre == 0) + fa_count_inc = 0; + else if (fa_count_cur >= p_dfs->fa_count_pre) + fa_count_inc = fa_count_cur - p_dfs->fa_count_pre; + else + fa_count_inc = fa_count_cur; + p_dfs->fa_count_pre = fa_count_cur; + + p_dfs->fa_inc_hist[p_dfs->mask_idx] = fa_count_inc; + + for (i=0; i<5; i++) { + total_fa_in_hist = total_fa_in_hist + p_dfs->fa_inc_hist[i]; + if (p_dfs->fa_inc_hist[i] > max_fa_in_hist) + max_fa_in_hist = p_dfs->fa_inc_hist[i]; + } + if (p_dfs->mask_idx >= 2) + index = p_dfs->mask_idx - 2; + else + index = 5 + p_dfs->mask_idx - 2; + if (index == 0) + pre_post_now_acc_fa_in_hist = p_dfs->fa_inc_hist[index] + p_dfs->fa_inc_hist[index+1] + p_dfs->fa_inc_hist[4]; + else if (index == 4) + pre_post_now_acc_fa_in_hist = p_dfs->fa_inc_hist[index] + p_dfs->fa_inc_hist[0] + p_dfs->fa_inc_hist[index-1]; + else + pre_post_now_acc_fa_in_hist = p_dfs->fa_inc_hist[index] + p_dfs->fa_inc_hist[index+1] + p_dfs->fa_inc_hist[index-1]; + + /*Get VHT CRC32 ok count during past 100ms*/ + vht_crc_ok_cnt_cur = (u16)odm_get_bb_reg(p_dm, 0xf0c, 0x00003fff); + if (vht_crc_ok_cnt_cur >= p_dfs->vht_crc_ok_cnt_pre) + vht_crc_ok_cnt_inc = vht_crc_ok_cnt_cur - p_dfs->vht_crc_ok_cnt_pre; + else + vht_crc_ok_cnt_inc = vht_crc_ok_cnt_cur; + p_dfs->vht_crc_ok_cnt_pre = vht_crc_ok_cnt_cur; + + /*Get HT CRC32 ok count during past 100ms*/ + ht_crc_ok_cnt_cur = (u16)odm_get_bb_reg(p_dm, 0xf10, 0x00003fff); + if (ht_crc_ok_cnt_cur >= p_dfs->ht_crc_ok_cnt_pre) + ht_crc_ok_cnt_inc = ht_crc_ok_cnt_cur - p_dfs->ht_crc_ok_cnt_pre; + else + ht_crc_ok_cnt_inc = ht_crc_ok_cnt_cur; + p_dfs->ht_crc_ok_cnt_pre = ht_crc_ok_cnt_cur; + + /*Get Legacy CRC32 ok count during past 100ms*/ + leg_crc_ok_cnt_cur = (u16)odm_get_bb_reg(p_dm, 0xf14, 0x00003fff); + if (leg_crc_ok_cnt_cur >= p_dfs->leg_crc_ok_cnt_pre) + leg_crc_ok_cnt_inc = leg_crc_ok_cnt_cur - p_dfs->leg_crc_ok_cnt_pre; + else + leg_crc_ok_cnt_inc = leg_crc_ok_cnt_cur; + p_dfs->leg_crc_ok_cnt_pre = leg_crc_ok_cnt_cur; + + if ((vht_crc_ok_cnt_cur == 0x3fff) || + (ht_crc_ok_cnt_cur == 0x3fff) || + (leg_crc_ok_cnt_cur == 0x3fff)) { + odm_set_bb_reg(p_dm, 0xb58, BIT(0), 1); + odm_set_bb_reg(p_dm, 0xb58, BIT(0), 0); + } + + total_crc_ok_cnt_inc = vht_crc_ok_cnt_inc + ht_crc_ok_cnt_inc + leg_crc_ok_cnt_inc; + + /*Get short pulse count, need carefully handle the counter overflow*/ + regf98_value = odm_get_bb_reg(p_dm, 0xf98, 0xffffffff); + short_pulse_cnt_cur = (u16)(regf98_value & 0x000000ff); + if (short_pulse_cnt_cur >= p_dfs->short_pulse_cnt_pre) + short_pulse_cnt_inc = short_pulse_cnt_cur - p_dfs->short_pulse_cnt_pre; + else + short_pulse_cnt_inc = short_pulse_cnt_cur; + p_dfs->short_pulse_cnt_pre = short_pulse_cnt_cur; + + /*Get long pulse count, need carefully handle the counter overflow*/ + long_pulse_cnt_cur = (u16)((regf98_value & 0x0000ff00) >> 8); + if (long_pulse_cnt_cur >= p_dfs->long_pulse_cnt_pre) + long_pulse_cnt_inc = long_pulse_cnt_cur - p_dfs->long_pulse_cnt_pre; + else + long_pulse_cnt_inc = long_pulse_cnt_cur; + p_dfs->long_pulse_cnt_pre = long_pulse_cnt_cur; + + total_pulse_count_inc = short_pulse_cnt_inc + long_pulse_cnt_inc; + + if (p_dfs->det_print){ + PHYDM_DBG(p_dm, DBG_DFS, ("=====================================================================\n")); + PHYDM_DBG(p_dm, DBG_DFS, ("Total_CRC_OK_cnt_inc[%d] VHT_CRC_ok_cnt_inc[%d] HT_CRC_ok_cnt_inc[%d] LEG_CRC_ok_cnt_inc[%d] FA_count_inc[%d]\n", + total_crc_ok_cnt_inc, vht_crc_ok_cnt_inc, ht_crc_ok_cnt_inc, leg_crc_ok_cnt_inc, fa_count_inc)); + PHYDM_DBG(p_dm, DBG_DFS, ("Init_Gain[%x] 0x91c[%x] 0xf98[%08x] short_pulse_cnt_inc[%d] long_pulse_cnt_inc[%d]\n", + p_dfs->igi_cur, p_dfs->st_l2h_cur, regf98_value, short_pulse_cnt_inc, long_pulse_cnt_inc)); + PHYDM_DBG(p_dm, DBG_DFS, ("Throughput: %dMbps\n", p_dm->rx_tp)); + reg918_value = odm_get_bb_reg(p_dm, 0x918, 0xffffffff); + reg91c_value = odm_get_bb_reg(p_dm, 0x91c, 0xffffffff); + reg920_value = odm_get_bb_reg(p_dm, 0x920, 0xffffffff); + reg924_value = odm_get_bb_reg(p_dm, 0x924, 0xffffffff); + PHYDM_DBG(p_dm, DBG_DFS, ("0x918[%08x] 0x91c[%08x] 0x920[%08x] 0x924[%08x]\n", reg918_value, reg91c_value, reg920_value, reg924_value)); + PHYDM_DBG(p_dm, DBG_DFS, ("dfs_regdomain = %d, dbg_mode = %d, idle_mode = %d\n", region_domain, p_dfs->dbg_mode, p_dfs->idle_mode)); + } + tri_short_pulse = (regf98_value & BIT(17))? 1 : 0; + tri_long_pulse = (regf98_value & BIT(19))? 1 : 0; + + if(tri_short_pulse) + radar_type = 0; + else if(tri_long_pulse) + radar_type = 1; + + if (tri_short_pulse) { + odm_set_bb_reg(p_dm, 0x924, BIT(15), 0); + odm_set_bb_reg(p_dm, 0x924, BIT(15), 1); + } + if (tri_long_pulse) { + odm_set_bb_reg(p_dm, 0x924, BIT(15), 0); + odm_set_bb_reg(p_dm, 0x924, BIT(15), 1); + if (region_domain == PHYDM_DFS_DOMAIN_MKK) { + if ((c_channel >= 52) && (c_channel <= 64)) { + tri_long_pulse = 0; + } + } + if (region_domain == PHYDM_DFS_DOMAIN_ETSI) { + tri_long_pulse = 0; + } + } + + st_l2h_new = p_dfs->st_l2h_cur; + p_dfs->pulse_flag_hist[p_dfs->mask_idx] = tri_short_pulse | tri_long_pulse; + + /* PSD(not ready) */ + + fault_flag_det = 0; + fault_flag_psd = 0; + fa_flag = 0; + if(region_domain == PHYDM_DFS_DOMAIN_ETSI){ + fa_mask_th = p_dfs->fa_mask_th + 20; + } + else{ + fa_mask_th = p_dfs->fa_mask_th; + } + if (max_fa_in_hist >= fa_mask_th || total_fa_in_hist >= fa_mask_th || pre_post_now_acc_fa_in_hist >= fa_mask_th || (p_dfs->igi_cur >= 0x30)){ + st_l2h_new = p_dfs->st_l2h_max; + p_dfs->radar_det_mask_hist[index] = 1; + if (p_dfs->pulse_flag_hist[index] == 1){ + p_dfs->pulse_flag_hist[index] = 0; + if (p_dfs->det_print2){ + PHYDM_DBG(p_dm, DBG_DFS, ("Radar is masked : FA mask\n")); + } + } + fa_flag = 1; + } + + if (p_dfs->det_print) { + PHYDM_DBG(p_dm, DBG_DFS, ("mask_idx: %d\n", p_dfs->mask_idx)); + PHYDM_DBG(p_dm, DBG_DFS, ("radar_det_mask_hist: ")); + for (i=0; i<5; i++) + PHYDM_DBG(p_dm, DBG_DFS, ("%d ", p_dfs->radar_det_mask_hist[i])); + PHYDM_DBG(p_dm, DBG_DFS, ("pulse_flag_hist: ")); + for (i=0; i<5; i++) + PHYDM_DBG(p_dm, DBG_DFS, ("%d ", p_dfs->pulse_flag_hist[i])); + PHYDM_DBG(p_dm, DBG_DFS, ("fa_inc_hist: ")); + for (i=0; i<5; i++) + PHYDM_DBG(p_dm, DBG_DFS, ("%d ", p_dfs->fa_inc_hist[i])); + PHYDM_DBG(p_dm, DBG_DFS, + ("\nmax_fa_in_hist: %d pre_post_now_acc_fa_in_hist: %d ", max_fa_in_hist, pre_post_now_acc_fa_in_hist)); + } + + sum = 0; + for (k=0; k<5; k++) { + if (p_dfs->radar_det_mask_hist[k] == 1) + sum++; + } + + if (p_dfs->mask_hist_checked <= 5) + p_dfs->mask_hist_checked++; + + if ((p_dfs->mask_hist_checked >= 5) && p_dfs->pulse_flag_hist[index]) + { + if (sum <= 2) + { + radar_detected = 1 ; + PHYDM_DBG(p_dm, DBG_DFS, ("Detected type %d radar signal!\n", radar_type)); + } + else { + fault_flag_det = 1; + if (p_dfs->det_print2){ + PHYDM_DBG(p_dm, DBG_DFS, ("Radar is masked : mask_hist large than thd\n")); + } + } + } + + p_dfs->mask_idx++; + if (p_dfs->mask_idx == 5) + p_dfs->mask_idx = 0; + + if ((fault_flag_det == 0) && (fault_flag_psd == 0) && (fa_flag ==0)) { + if (p_dfs->igi_cur < 0x30) { + st_l2h_new = p_dfs->st_l2h_min; + } + } + + if ((st_l2h_new != p_dfs->st_l2h_cur)) { + if (st_l2h_new < p_dfs->st_l2h_min) { + p_dfs->st_l2h_cur = p_dfs->st_l2h_min; + } + else if (st_l2h_new > p_dfs->st_l2h_max) + p_dfs->st_l2h_cur = p_dfs->st_l2h_max; + else + p_dfs->st_l2h_cur = st_l2h_new; + odm_set_bb_reg(p_dm, 0x91c, 0xff, p_dfs->st_l2h_cur); + + p_dfs->pwdb_th = ((int)p_dfs->st_l2h_cur - (int)p_dfs->igi_cur)/2 + p_dfs->pwdb_scalar_factor; + p_dfs->pwdb_th = MAX_2(p_dfs->pwdb_th, (int)p_dfs->pwdb_th); /*limit the pwdb value to absoulte lower bound 8*/ + p_dfs->pwdb_th = MIN_2(p_dfs->pwdb_th, 0x1f); /*limit the pwdb value to absoulte upper bound 0x1f*/ + odm_set_bb_reg(p_dm, 0x918, 0x00001f00, p_dfs->pwdb_th); + } + + if (p_dfs->det_print2) { + PHYDM_DBG(p_dm, DBG_DFS, + ("fault_flag_det[%d], fault_flag_psd[%d], DFS_detected [%d]\n", fault_flag_det, fault_flag_psd, radar_detected)); + } + + return radar_detected; + +} + +boolean phydm_radar_detect(void *p_dm_void) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DFS_STATISTICS *p_dfs = (struct _DFS_STATISTICS *)phydm_get_structure(p_dm, PHYDM_DFS); + boolean enable_DFS = false; + boolean radar_detected = false; + + p_dfs->igi_cur = (u8)odm_get_bb_reg(p_dm, 0xc50, 0x0000007f); + + p_dfs->st_l2h_cur = (u8)odm_get_bb_reg(p_dm, 0x91c, 0x000000ff); + + /* dynamic pwdb calibration */ + if (p_dfs->igi_pre != p_dfs->igi_cur) { + p_dfs->pwdb_th = ((int)p_dfs->st_l2h_cur - (int)p_dfs->igi_cur)/2 + p_dfs->pwdb_scalar_factor; + p_dfs->pwdb_th = MAX_2(p_dfs->pwdb_th_cur, (int)p_dfs->pwdb_th); /* limit the pwdb value to absoulte lower bound 0xa */ + p_dfs->pwdb_th = MIN_2(p_dfs->pwdb_th_cur, 0x1f); /* limit the pwdb value to absoulte upper bound 0x1f */ + odm_set_bb_reg(p_dm, 0x918, 0x00001f00, p_dfs->pwdb_th); + } + + p_dfs->igi_pre = p_dfs->igi_cur; + + phydm_dfs_dynamic_setting(p_dm); + radar_detected = phydm_radar_detect_dm_check(p_dm); + + if (odm_get_bb_reg(p_dm, 0x924, BIT(15))) + enable_DFS = true; if (enable_DFS && radar_detected) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DFS, ODM_DBG_LOUD - , ("Radar detect: enable_DFS:%d, radar_detected:%d\n" - , enable_DFS, radar_detected)); - - phydm_radar_detect_reset(pDM_Odm); + PHYDM_DBG(p_dm, DBG_DFS, ("Radar detect: enable_DFS:%d, radar_detected:%d\n", enable_DFS, radar_detected)); + phydm_radar_detect_reset(p_dm); + if (p_dfs->dbg_mode == 1){ + PHYDM_DBG(p_dm, DBG_DFS, ("Radar is detected in DFS dbg mode.\n")); + radar_detected = 0; + } } -exit: - return (enable_DFS && radar_detected); -} -#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ - -BOOLEAN -phydm_dfs_master_enabled( - IN PVOID pDM_VOID - ) -{ -#ifdef CONFIG_PHYDM_DFS_MASTER - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - return *pDM_Odm->dfs_master_enabled ? TRUE : FALSE; -#else - return FALSE; -#endif + return enable_DFS && radar_detected; } -VOID + +void phydm_dfs_debug( - IN PVOID pDM_VOID, - IN u4Byte *const argv, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) + void *p_dm_void, + u32 *const argv, + u32 *_used, + char *output, + u32 *_out_len +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte used = *_used; - u4Byte out_len = *_out_len; + struct PHY_DM_STRUCT *p_dm_odm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DFS_STATISTICS *p_dfs = (struct _DFS_STATISTICS *)phydm_get_structure(p_dm_odm, PHYDM_DFS); + u32 used = *_used; + u32 out_len = *_out_len; - switch (argv[0]) { + p_dfs->dbg_mode = (boolean)argv[0]; + p_dfs->force_TP_mode = (boolean)argv[1]; + p_dfs->det_print = (boolean)argv[2]; + p_dfs->det_print2 = (boolean)argv[3]; + + PHYDM_SNPRINTF((output + used, out_len - used, "dbg_mode: %d, force_TP_mode: %d, det_print: %d, det_print2: %d\n", p_dfs->dbg_mode, p_dfs->force_TP_mode, p_dfs->det_print, p_dfs->det_print2)); + + /*switch (argv[0]) { case 1: - #if defined(CONFIG_PHYDM_DFS_MASTER) - /* set dbg parameters for radar detection instead of the default value */ +#if defined(CONFIG_PHYDM_DFS_MASTER) + set dbg parameters for radar detection instead of the default value if (argv[1] == 1) { - pDM_Odm->radar_detect_reg_918 = argv[2]; - pDM_Odm->radar_detect_reg_91c = argv[3]; - pDM_Odm->radar_detect_reg_920 = argv[4]; - pDM_Odm->radar_detect_reg_924 = argv[5]; - pDM_Odm->radar_detect_dbg_parm_en = 1; + p_dm_odm->radar_detect_reg_918 = argv[2]; + p_dm_odm->radar_detect_reg_91c = argv[3]; + p_dm_odm->radar_detect_reg_920 = argv[4]; + p_dm_odm->radar_detect_reg_924 = argv[5]; + p_dm_odm->radar_detect_dbg_parm_en = 1; - PHYDM_SNPRINTF((output+used, out_len-used, "Radar detection with dbg parameter\n")); - PHYDM_SNPRINTF((output+used, out_len-used, "reg918:0x%08X\n", pDM_Odm->radar_detect_reg_918)); - PHYDM_SNPRINTF((output+used, out_len-used, "reg91c:0x%08X\n", pDM_Odm->radar_detect_reg_91c)); - PHYDM_SNPRINTF((output+used, out_len-used, "reg920:0x%08X\n", pDM_Odm->radar_detect_reg_920)); - PHYDM_SNPRINTF((output+used, out_len-used, "reg924:0x%08X\n", pDM_Odm->radar_detect_reg_924)); + PHYDM_SNPRINTF((output + used, out_len - used, "Radar detection with dbg parameter\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "reg918:0x%08X\n", p_dm_odm->radar_detect_reg_918)); + PHYDM_SNPRINTF((output + used, out_len - used, "reg91c:0x%08X\n", p_dm_odm->radar_detect_reg_91c)); + PHYDM_SNPRINTF((output + used, out_len - used, "reg920:0x%08X\n", p_dm_odm->radar_detect_reg_920)); + PHYDM_SNPRINTF((output + used, out_len - used, "reg924:0x%08X\n", p_dm_odm->radar_detect_reg_924)); } else { - pDM_Odm->radar_detect_dbg_parm_en = 0; - PHYDM_SNPRINTF((output+used, out_len-used, "Radar detection with default parameter\n")); + p_dm_odm->radar_detect_dbg_parm_en = 0; + PHYDM_SNPRINTF((output + used, out_len - used, "Radar detection with default parameter\n")); } - phydm_radar_detect_enable(pDM_Odm); - #endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ + phydm_radar_detect_enable(p_dm_odm); +#endif defined(CONFIG_PHYDM_DFS_MASTER) break; default: break; - } + }*/ +} + + + +#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ + +boolean +phydm_is_dfs_band( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (((*p_dm->p_channel >= 52) && (*p_dm->p_channel <= 64)) || + ((*p_dm->p_channel >= 100) && (*p_dm->p_channel <= 140))) + return true; + else + return false; +} + +boolean +phydm_dfs_master_enabled( + void *p_dm_void +) +{ +#ifdef CONFIG_PHYDM_DFS_MASTER + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + return *p_dm->dfs_master_enabled ? true : false; +#else + return false; +#endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.h index bc55a439088b..761a403fe048 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dfs.h @@ -1,76 +1,108 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDM_DFS_H__ -#define __PHYDM_DFS_H__ - -#define DFS_VERSION "0.0" - -/* ============================================================ - Definition - ============================================================ -*/ - -/* -============================================================ -1 structure - ============================================================ -*/ - -/* ============================================================ - enumeration - ============================================================ -*/ - -typedef enum _tag_PhyDM_DFS_REGION_DOMAIN { - PHYDM_DFS_DOMAIN_UNKNOWN = 0, - PHYDM_DFS_DOMAIN_FCC = 1, - PHYDM_DFS_DOMAIN_MKK = 2, - PHYDM_DFS_DOMAIN_ETSI = 3, -} PHYDM_DFS_REGION_DOMAIN; - -/* -============================================================ - function prototype -============================================================ -*/ -#if defined(CONFIG_PHYDM_DFS_MASTER) -VOID phydm_radar_detect_reset(PVOID pDM_VOID); -VOID phydm_radar_detect_disable(PVOID pDM_VOID); -VOID phydm_radar_detect_enable(PVOID pDM_VOID); -BOOLEAN phydm_radar_detect(PVOID pDM_VOID); -#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ - -BOOLEAN -phydm_dfs_master_enabled( - IN PVOID pDM_VOID - ); - -VOID -phydm_dfs_debug( - IN PVOID pDM_VOID, - IN u4Byte *const argv, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ); - -#endif /*#ifndef __PHYDM_DFS_H__ */ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDM_DFS_H__ +#define __PHYDM_DFS_H__ + +#define DFS_VERSION "1.1" + +/* ============================================================ + Definition + ============================================================ +*/ + +/* +============================================================ +1 structure + ============================================================ +*/ + +struct _DFS_STATISTICS { + u8 mask_idx; + u8 igi_cur; + u8 igi_pre; + u8 st_l2h_cur; + u16 fa_count_pre; + u16 fa_inc_hist[5]; + u16 vht_crc_ok_cnt_pre; + u16 ht_crc_ok_cnt_pre; + u16 leg_crc_ok_cnt_pre; + u16 short_pulse_cnt_pre; + u16 long_pulse_cnt_pre; + u8 pwdb_th; + u8 pwdb_th_cur; + u8 pwdb_scalar_factor; + u8 peak_th; + u8 short_pulse_cnt_th; + u8 long_pulse_cnt_th; + u8 peak_window; + u8 nb2wb_th; + u8 fa_mask_th; + u8 det_flag_offset; + u8 st_l2h_max; + u8 st_l2h_min; + u8 mask_hist_checked; + boolean pulse_flag_hist[5]; + boolean radar_det_mask_hist[5]; + boolean idle_mode; + boolean force_TP_mode; + boolean dbg_mode; + boolean det_print; + boolean det_print2; +}; + + +/* ============================================================ + enumeration + ============================================================ +*/ + +enum phydm_dfs_region_domain { + PHYDM_DFS_DOMAIN_UNKNOWN = 0, + PHYDM_DFS_DOMAIN_FCC = 1, + PHYDM_DFS_DOMAIN_MKK = 2, + PHYDM_DFS_DOMAIN_ETSI = 3, +}; + +/* +============================================================ + function prototype +============================================================ +*/ +#if defined(CONFIG_PHYDM_DFS_MASTER) +void phydm_radar_detect_reset(void *p_dm_void); +void phydm_radar_detect_disable(void *p_dm_void); +void phydm_radar_detect_enable(void *p_dm_void); +boolean phydm_radar_detect(void *p_dm_void); +void phydm_dfs_parameter_init(void *p_dm_void); +void phydm_dfs_debug(void *p_dm_void, u32 *const argv, u32 *_used, char *output, u32 *_out_len); +#endif /* defined(CONFIG_PHYDM_DFS_MASTER) */ + +boolean +phydm_dfs_is_meteorology_channel( + void *p_dm_void +); + +boolean +phydm_is_dfs_band( + void *p_dm_void +); + +boolean +phydm_dfs_master_enabled( + void *p_dm_void +); + +#endif /*#ifndef __PHYDM_DFS_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.c index 879b56bb179c..90165ace4e02 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.c @@ -1,2285 +1,1896 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - - -VOID -ODM_ChangeDynamicInitGainThresh( - IN PVOID pDM_VOID, - IN u4Byte DM_Type, - IN u4Byte DM_Value - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - if (DM_Type == DIG_TYPE_THRESH_HIGH) - { - pDM_DigTable->RssiHighThresh = DM_Value; - } - else if (DM_Type == DIG_TYPE_THRESH_LOW) - { - pDM_DigTable->RssiLowThresh = DM_Value; - } - else if (DM_Type == DIG_TYPE_ENABLE) - { - pDM_DigTable->Dig_Enable_Flag = TRUE; - } - else if (DM_Type == DIG_TYPE_DISABLE) - { - pDM_DigTable->Dig_Enable_Flag = FALSE; - } - else if (DM_Type == DIG_TYPE_BACKOFF) - { - if(DM_Value > 30) - DM_Value = 30; - pDM_DigTable->BackoffVal = (u1Byte)DM_Value; - } - else if(DM_Type == DIG_TYPE_RX_GAIN_MIN) - { - if(DM_Value == 0) - DM_Value = 0x1; - pDM_DigTable->rx_gain_range_min = (u1Byte)DM_Value; - } - else if(DM_Type == DIG_TYPE_RX_GAIN_MAX) - { - if(DM_Value > 0x50) - DM_Value = 0x50; - pDM_DigTable->rx_gain_range_max = (u1Byte)DM_Value; - } -} // DM_ChangeDynamicInitGainThresh // - -int -getIGIForDiff(int value_IGI) -{ - #define ONERCCA_LOW_TH 0x30 - #define ONERCCA_LOW_DIFF 8 - - if (value_IGI < ONERCCA_LOW_TH) { - if ((ONERCCA_LOW_TH - value_IGI) < ONERCCA_LOW_DIFF) - return ONERCCA_LOW_TH; - else - return value_IGI + ONERCCA_LOW_DIFF; - } else { - return value_IGI; - } -} - -VOID -odm_FAThresholdCheck( - IN PVOID pDM_VOID, - IN BOOLEAN bDFSBand, - IN BOOLEAN bPerformance, - IN u4Byte RxTp, - IN u4Byte TxTp, - OUT u4Byte* dm_FA_thres - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if(pDM_Odm->bLinked && (bPerformance||bDFSBand)) - { -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - /*For AP*/ - if ((RxTp>>2) > TxTp && RxTp < 10000 && RxTp > 500) { /*10Mbps & 0.5Mbps*/ - dm_FA_thres[0] = 0x080; - dm_FA_thres[1] = 0x100; - dm_FA_thres[2] = 0x200; - } else { - dm_FA_thres[0] = 0x100; - dm_FA_thres[1] = 0x200; - dm_FA_thres[2] = 0x300; - } -#else - /*For NIC*/ - dm_FA_thres[0] = DM_DIG_FA_TH0; - dm_FA_thres[1] = DM_DIG_FA_TH1; - dm_FA_thres[2] = DM_DIG_FA_TH2; -#endif - } else { -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) - if(bDFSBand) - { - // For DFS band and no link - dm_FA_thres[0] = 250; - dm_FA_thres[1] = 1000; - dm_FA_thres[2] = 2000; - } - else -#endif - { - dm_FA_thres[0] = 2000; - dm_FA_thres[1] = 4000; - dm_FA_thres[2] = 5000; - } - } - return; -} - -u1Byte -odm_ForbiddenIGICheck( - IN PVOID pDM_VOID, - IN u1Byte DIG_Dynamic_MIN, - IN u1Byte CurrentIGI - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); - u1Byte rx_gain_range_min = pDM_DigTable->rx_gain_range_min; - - if (pDM_DigTable->LargeFA_Timeout) { - if (--pDM_DigTable->LargeFA_Timeout == 0) - pDM_DigTable->LargeFAHit = 0; - } - - if (pFalseAlmCnt->Cnt_all > 10000) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case.\n")); - - if(pDM_DigTable->LargeFAHit != 3) - pDM_DigTable->LargeFAHit++; - - if(pDM_DigTable->ForbiddenIGI < CurrentIGI)//if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue) - { - pDM_DigTable->ForbiddenIGI = CurrentIGI;//pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue; - pDM_DigTable->LargeFAHit = 1; - pDM_DigTable->LargeFA_Timeout = LARGE_FA_TIMEOUT; - } - - if(pDM_DigTable->LargeFAHit >= 3) - { - if((pDM_DigTable->ForbiddenIGI + 2) > pDM_DigTable->rx_gain_range_max) - rx_gain_range_min = pDM_DigTable->rx_gain_range_max; - else - rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); - pDM_DigTable->Recover_cnt = 1800; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormally false alarm case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); - } - } - - else if (pFalseAlmCnt->Cnt_all > 2000) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case.\n")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Cnt_all=%d, Cnt_all_pre=%d, CurrentIGI=0x%x, PreIGValue=0x%x\n", - pFalseAlmCnt->Cnt_all, pFalseAlmCnt->Cnt_all_pre, CurrentIGI, pDM_DigTable->PreIGValue)); - - /* pFalseAlmCnt->Cnt_all = 1.1875*pFalseAlmCnt->Cnt_all_pre */ - if ((pFalseAlmCnt->Cnt_all > (pFalseAlmCnt->Cnt_all_pre + (pFalseAlmCnt->Cnt_all_pre >> 3) + (pFalseAlmCnt->Cnt_all_pre >> 4))) && (CurrentIGI < pDM_DigTable->PreIGValue)) { - if (pDM_DigTable->LargeFAHit != 3) - pDM_DigTable->LargeFAHit++; - - if (pDM_DigTable->ForbiddenIGI < CurrentIGI) { /*if(pDM_DigTable->ForbiddenIGI < pDM_DigTable->CurIGValue)*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Updating ForbiddenIGI by CurrentIGI, ForbiddenIGI=0x%x, CurrentIGI=0x%x\n", - pDM_DigTable->ForbiddenIGI, CurrentIGI)); - - pDM_DigTable->ForbiddenIGI = CurrentIGI; /*pDM_DigTable->ForbiddenIGI = pDM_DigTable->CurIGValue;*/ - pDM_DigTable->LargeFAHit = 1; - pDM_DigTable->LargeFA_Timeout = LARGE_FA_TIMEOUT; - } - - } - - if (pDM_DigTable->LargeFAHit >= 3) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("FaHit is greater than 3, rx_gain_range_max=0x%x, rx_gain_range_min=0x%x, ForbiddenIGI=0x%x\n", - pDM_DigTable->rx_gain_range_max, rx_gain_range_min, pDM_DigTable->ForbiddenIGI)); - - if ((pDM_DigTable->ForbiddenIGI + 1) > pDM_DigTable->rx_gain_range_max) - rx_gain_range_min = pDM_DigTable->rx_gain_range_max; - else - rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 1); - - pDM_DigTable->Recover_cnt = 1200; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Abnormally false alarm case: Recover_cnt = %d, rx_gain_range_min = 0x%x\n", pDM_DigTable->Recover_cnt, rx_gain_range_min)); - } - } - - else - { - if (pDM_DigTable->Recover_cnt != 0) { - - pDM_DigTable->Recover_cnt --; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Recover_cnt = %d\n", pDM_DigTable->Recover_cnt)); - } - else - { - if(pDM_DigTable->LargeFAHit < 3) - { - if((pDM_DigTable->ForbiddenIGI - 2) < DIG_Dynamic_MIN) //DM_DIG_MIN) - { - pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; //DM_DIG_MIN; - rx_gain_range_min = DIG_Dynamic_MIN; //DM_DIG_MIN; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: At Lower Bound\n")); - } - else - { - if (pDM_DigTable->LargeFAHit == 0) { - pDM_DigTable->ForbiddenIGI -= 2; - rx_gain_range_min = (pDM_DigTable->ForbiddenIGI + 2); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Normal Case: Approach Lower Bound\n")); - } - } - } - else - { - pDM_DigTable->LargeFAHit = 0; - } - } - } - - return rx_gain_range_min; - -} - -VOID -odm_InbandNoiseCalculate ( - IN PVOID pDM_VOID - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - u1Byte IGIBackup, TimeCnt = 0, ValidCnt = 0; - BOOLEAN bTimeout = TRUE; - s1Byte sNoise_A, sNoise_B; - s4Byte NoiseRpt_A = 0,NoiseRpt_B = 0; - u4Byte tmp = 0; - static u1Byte failCnt = 0; - - if(!(pDM_Odm->SupportICType & (ODM_RTL8192E))) - return; - - if(pDM_Odm->RFType == ODM_1T1R || *(pDM_Odm->pOnePathCCA) != ODM_CCA_2R) - return; - - if(!pDM_DigTable->bNoiseEst) - return; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_InbandNoiseEstimate()========>\n")); - - //1 Set initial gain. - IGIBackup = pDM_DigTable->CurIGValue; - pDM_DigTable->IGIOffset_A = 0; - pDM_DigTable->IGIOffset_B = 0; - ODM_Write_DIG(pDM_Odm, 0x24); - - //1 Update idle time power report - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x0); - - delay_ms(2); - - //1 Get noise power level - while(1) - { - //2 Read Noise Floor Report - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - tmp = ODM_GetBBReg(pDM_Odm, 0x8f8, bMaskLWord); - - sNoise_A = (s1Byte)(tmp & 0xff); - sNoise_B = (s1Byte)((tmp & 0xff00)>>8); - - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); - - if((sNoise_A < 20 && sNoise_A >= -70) && (sNoise_B < 20 && sNoise_B >= -70)) - { - ValidCnt++; - NoiseRpt_A += sNoise_A; - NoiseRpt_B += sNoise_B; - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("sNoise_A = %d, sNoise_B = %d\n",sNoise_A, sNoise_B)); - } - - TimeCnt++; - bTimeout = (TimeCnt >= 150)?TRUE:FALSE; - - if(ValidCnt == 20 || bTimeout) - break; - - delay_ms(2); - - } - - //1 Keep idle time power report - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - ODM_SetBBReg(pDM_Odm, ODM_REG_TX_ANT_CTRL_11N, BIT25, 0x1); - - //1 Recover IGI - ODM_Write_DIG(pDM_Odm, IGIBackup); - - //1 Calculate Noise Floor - if(ValidCnt != 0) - { - NoiseRpt_A /= (ValidCnt<<1); - NoiseRpt_B /= (ValidCnt<<1); - } - - if(bTimeout) - { - NoiseRpt_A = 0; - NoiseRpt_B = 0; - - failCnt ++; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("Noise estimate fail time = %d\n", failCnt)); - - if(failCnt == 3) - { - failCnt = 0; - pDM_DigTable->bNoiseEst = FALSE; - } - } - else - { - NoiseRpt_A = -110 + 0x24 + NoiseRpt_A -6; - NoiseRpt_B = -110 + 0x24 + NoiseRpt_B -6; - pDM_DigTable->bNoiseEst = FALSE; - failCnt = 0; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("NoiseRpt_A = %d, NoiseRpt_B = %d\n", NoiseRpt_A, NoiseRpt_B)); - } - - //1 Calculate IGI Offset - if(NoiseRpt_A > NoiseRpt_B) - { - pDM_DigTable->IGIOffset_A = NoiseRpt_A - NoiseRpt_B; - pDM_DigTable->IGIOffset_B = 0; - } - else - { - pDM_DigTable->IGIOffset_A = 0; - pDM_DigTable->IGIOffset_B = NoiseRpt_B - NoiseRpt_A; - } - -#endif - return; -} - -VOID -odm_DigForBtHsMode( - IN PVOID pDM_VOID - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable=&pDM_Odm->DM_DigTable; - u1Byte digForBtHs=0; - u1Byte digUpBound=0x5a; - - if (pDM_Odm->bBtConnectProcess) { - digForBtHs = 0x22; - } else { - // - // Decide DIG value by BT HS RSSI. - // - digForBtHs = pDM_Odm->btHsRssi+4; - - //DIG Bound - if(digForBtHs > digUpBound) - digForBtHs = digUpBound; - if(digForBtHs < 0x1c) - digForBtHs = 0x1c; - - // update Current IGI - pDM_DigTable->BT30_CurIGI = digForBtHs; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DigForBtHsMode() : set DigValue=0x%x\n", digForBtHs)); -#endif -} - -VOID -phydm_setBigJumpStep( - IN PVOID pDM_VOID, - IN u1Byte CurrentIGI -) -{ -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - u1Byte step1[8] = {24, 30, 40, 50, 60, 70, 80, 90}; - u1Byte i; - - if (pDM_DigTable->enableAdjustBigJump == 0) - return; - - for (i = 0; i <= pDM_DigTable->bigJumpStep1; i++) { - if ((CurrentIGI + step1[i]) > pDM_DigTable->bigJumpLmt[pDM_DigTable->agcTableIdx]) { - if (i != 0) - i = i - 1; - break; - } else if (i == pDM_DigTable->bigJumpStep1) - break; - } - if (pDM_Odm->SupportICType & ODM_RTL8822B) - ODM_SetBBReg(pDM_Odm, 0x8c8, 0xe, i); - else if (pDM_Odm->SupportICType & ODM_RTL8197F) - ODM_SetBBReg(pDM_Odm, ODM_REG_BB_AGC_SET_2_11N, 0xe, i); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_setBigJumpStep(): bigjump = %d (ori = 0x%d), LMT=0x%x\n", i, pDM_DigTable->bigJumpStep1, pDM_DigTable->bigJumpLmt[pDM_DigTable->agcTableIdx])); -#endif -} - -VOID -ODM_Write_DIG( - IN PVOID pDM_VOID, - IN u1Byte CurrentIGI - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - if (pDM_DigTable->bStopDIG) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Stop Writing IGI\n")); - return; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): ODM_REG(IGI_A,pDM_Odm)=0x%x, ODM_BIT(IGI,pDM_Odm)=0x%x\n", - ODM_REG(IGI_A,pDM_Odm),ODM_BIT(IGI,pDM_Odm))); - - //1 Check initial gain by upper bound - if ((!pDM_DigTable->bPSDInProgress) && pDM_Odm->bLinked) - { - if (CurrentIGI > pDM_DigTable->rx_gain_range_max) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x) is larger than upper bound !!\n", CurrentIGI)); - CurrentIGI = pDM_DigTable->rx_gain_range_max; - } - if (pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY && pDM_Odm->adaptivity_flag == TRUE) - { - if(CurrentIGI > pDM_Odm->Adaptivity_IGI_upper) - CurrentIGI = pDM_Odm->Adaptivity_IGI_upper; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("ODM_Write_DIG(): Adaptivity case: Force upper bound to 0x%x !!!!!!\n", CurrentIGI)); - } - } - - if(pDM_DigTable->CurIGValue != CurrentIGI) - { - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) - /* Modify big jump step for 8822B and 8197F */ - if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) - phydm_setBigJumpStep(pDM_Odm, CurrentIGI); -#endif - -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - /* Set IGI value of CCK for new CCK AGC */ - if (pDM_Odm->cck_new_agc) { - if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) - ODM_SetBBReg(pDM_Odm, 0xa0c, 0x00003f00, (CurrentIGI>>1)); - } -#endif - - /*Add by YuChen for USB IO too slow issue*/ - if ((pDM_Odm->SupportAbility & ODM_BB_ADAPTIVITY) && (CurrentIGI > pDM_DigTable->CurIGValue)) - Phydm_Adaptivity(pDM_Odm, CurrentIGI); - - //1 Set IGI value - if (pDM_Odm->SupportPlatform & (ODM_WIN|ODM_CE)) { - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - - if(pDM_Odm->RFType > ODM_1T1R) - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) { - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - } -#endif - } else if (pDM_Odm->SupportPlatform & (ODM_AP)) { - switch(*(pDM_Odm->pOnePathCCA)) - { - case ODM_CCA_2R: - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - - if(pDM_Odm->RFType > ODM_1T1R) - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) { - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_C,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_D,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - } -#endif - break; - case ODM_CCA_1R_A: - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm), CurrentIGI); - if(pDM_Odm->RFType != ODM_1T1R) - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B,pDM_Odm), ODM_BIT(IGI,pDM_Odm), getIGIForDiff(CurrentIGI)); - break; - case ODM_CCA_1R_B: - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_B, pDM_Odm), ODM_BIT(IGI, pDM_Odm), getIGIForDiff(CurrentIGI)); - if (pDM_Odm->RFType != ODM_1T1R) - ODM_SetBBReg(pDM_Odm, ODM_REG(IGI_A, pDM_Odm), ODM_BIT(IGI, pDM_Odm), CurrentIGI); - break; - } - } - - pDM_DigTable->CurIGValue = CurrentIGI; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_TRACE, ("ODM_Write_DIG(): CurrentIGI(0x%02x).\n", CurrentIGI)); - -} - -VOID -odm_PauseDIG( - IN PVOID pDM_VOID, - IN PHYDM_PAUSE_TYPE PauseType, - IN PHYDM_PAUSE_LEVEL pause_level, - IN u1Byte IGIValue -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG()=========> level = %d\n", pause_level)); - - if ((pDM_DigTable->pause_dig_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_DIG) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_PauseDIG(): Return: SupportAbility DIG or FA is disabled !!\n")); - return; - } - - if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_PauseDIG(): Return: Wrong pause level !!\n")); - return; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], - pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); - - switch (PauseType) { - /* Pause DIG */ - case PHYDM_PAUSE: - { - /* Disable DIG */ - ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_DIG)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Pause DIG !!\n")); - - /* Backup IGI value */ - if (pDM_DigTable->pause_dig_level == 0) { - pDM_DigTable->IGIBackup = pDM_DigTable->CurIGValue; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Backup IGI = 0x%x, new IGI = 0x%x\n", pDM_DigTable->IGIBackup, IGIValue)); - } - - /* Record IGI value */ - pDM_DigTable->pause_dig_value[pause_level] = IGIValue; - - /* Update pause level */ - pDM_DigTable->pause_dig_level = (pDM_DigTable->pause_dig_level | BIT(pause_level)); - - /* Write new IGI value */ - if (BIT(pause_level + 1) > pDM_DigTable->pause_dig_level) { - ODM_Write_DIG(pDM_Odm, IGIValue); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): IGI of higher level = 0x%x\n", IGIValue)); - } - break; - } - /* Resume DIG */ - case PHYDM_RESUME: - { - /* check if the level is illegal or not */ - if ((pDM_DigTable->pause_dig_level & (BIT(pause_level))) != 0) { - pDM_DigTable->pause_dig_level = pDM_DigTable->pause_dig_level & (~(BIT(pause_level))); - pDM_DigTable->pause_dig_value[pause_level] = 0; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Resume DIG !!\n")); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong resume level !!\n")); - break; - } - - /* Resume DIG */ - if (pDM_DigTable->pause_dig_level == 0) { - /* Write backup IGI value */ - ODM_Write_DIG(pDM_Odm, pDM_DigTable->IGIBackup); - pDM_DigTable->bIgnoreDIG = TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write original IGI = 0x%x\n", pDM_DigTable->IGIBackup)); - - /* Enable DIG */ - ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_DIG); - break; - } - - if (BIT(pause_level) > pDM_DigTable->pause_dig_level) { - s1Byte max_level; - - /* Calculate the maximum level now */ - for (max_level = (pause_level - 1); max_level >= 0; max_level--) { - if ((pDM_DigTable->pause_dig_level & BIT(max_level)) > 0) - break; - } - - /* write IGI of lower level */ - ODM_Write_DIG(pDM_Odm, pDM_DigTable->pause_dig_value[max_level]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Write IGI (0x%x) of level (%d)\n", - pDM_DigTable->pause_dig_value[max_level], max_level)); - break; - } - break; - } - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): Wrong type !!\n")); - break; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_dig_level, IGIValue)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseDIG(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - pDM_DigTable->pause_dig_value[7], pDM_DigTable->pause_dig_value[6], pDM_DigTable->pause_dig_value[5], pDM_DigTable->pause_dig_value[4], - pDM_DigTable->pause_dig_value[3], pDM_DigTable->pause_dig_value[2], pDM_DigTable->pause_dig_value[1], pDM_DigTable->pause_dig_value[0])); - -} - -BOOLEAN -odm_DigAbort( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER pAdapter = pDM_Odm->Adapter; -#endif - - //SupportAbility - if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_FA_CNT is disabled\n")); - return TRUE; - } - - //SupportAbility - if(!(pDM_Odm->SupportAbility & ODM_BB_DIG)) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: SupportAbility ODM_BB_DIG is disabled\n")); - return TRUE; - } - - //ScanInProcess - if(*(pDM_Odm->pbScanInProcess)) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: In Scan Progress \n")); - return TRUE; - } - - if(pDM_DigTable->bIgnoreDIG) - { - pDM_DigTable->bIgnoreDIG = FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Ignore DIG \n")); - return TRUE; - } - - //add by Neil Chen to avoid PSD is processing - if(pDM_Odm->bDMInitialGainEnable == FALSE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: PSD is Processing \n")); - return TRUE; - } - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #if OS_WIN_FROM_WIN7(OS_VERSION) - if(IsAPModeExist( pAdapter) && pAdapter->bInHctTest) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Is AP mode or In HCT Test \n")); - return TRUE; - } - #endif - - if(pDM_Odm->bBtHsOperation) - { - odm_DigForBtHsMode(pDM_Odm); - } - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV - if((pDM_Odm->bLinked) && (pDM_Odm->Adapter->registrypriv.force_igi !=0)) - { - printk("pDM_Odm->RSSI_Min=%d \n",pDM_Odm->RSSI_Min); - ODM_Write_DIG(pDM_Odm,pDM_Odm->Adapter->registrypriv.force_igi); - return TRUE; - } - #endif -#else - if (!(priv->up_time > 5)) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Return: Not In DIG Operation Period \n")); - return TRUE; - } -#endif - - return FALSE; -} - -VOID -odm_DIGInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); -#endif - u4Byte ret_value; - u1Byte i; - - pDM_DigTable->bStopDIG = FALSE; - pDM_DigTable->bIgnoreDIG = FALSE; - pDM_DigTable->bPSDInProgress = FALSE; - pDM_DigTable->CurIGValue = (u1Byte) ODM_GetBBReg(pDM_Odm, ODM_REG(IGI_A,pDM_Odm), ODM_BIT(IGI,pDM_Odm)); - pDM_DigTable->PreIGValue = 0; - pDM_DigTable->RssiLowThresh = DM_DIG_THRESH_LOW; - pDM_DigTable->RssiHighThresh = DM_DIG_THRESH_HIGH; - pDM_DigTable->FALowThresh = DM_FALSEALARM_THRESH_LOW; - pDM_DigTable->FAHighThresh = DM_FALSEALARM_THRESH_HIGH; - pDM_DigTable->BackoffVal = DM_DIG_BACKOFF_DEFAULT; - pDM_DigTable->BackoffVal_range_max = DM_DIG_BACKOFF_MAX; - pDM_DigTable->BackoffVal_range_min = DM_DIG_BACKOFF_MIN; - pDM_DigTable->PreCCK_CCAThres = 0xFF; - pDM_DigTable->CurCCK_CCAThres = 0x83; - pDM_DigTable->ForbiddenIGI = DM_DIG_MIN_NIC; - pDM_DigTable->LargeFAHit = 0; - pDM_DigTable->LargeFA_Timeout = 0; - pDM_DigTable->Recover_cnt = 0; - pDM_DigTable->bMediaConnect_0 = FALSE; - pDM_DigTable->bMediaConnect_1 = FALSE; - - //To Initialize pDM_Odm->bDMInitialGainEnable == FALSE to avoid DIG error - pDM_Odm->bDMInitialGainEnable = TRUE; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - pDM_DigTable->DIG_Dynamic_MIN_0 = 0x25; - pDM_DigTable->DIG_Dynamic_MIN_1 = 0x25; - - // For AP\ ADSL modified DIG - pDM_DigTable->bTpTarget = FALSE; - pDM_DigTable->bNoiseEst = TRUE; - pDM_DigTable->IGIOffset_A = 0; - pDM_DigTable->IGIOffset_B = 0; - pDM_DigTable->TpTrainTH_min = 0; - - // For RTL8881A - FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; - - //Dyanmic EDCCA - if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - { - ODM_SetBBReg(pDM_Odm, 0xC50, 0xFFFF0000, 0xfafd); - } -#else - pDM_DigTable->DIG_Dynamic_MIN_0 = DM_DIG_MIN_NIC; - pDM_DigTable->DIG_Dynamic_MIN_1 = DM_DIG_MIN_NIC; - - //To Initi BT30 IGI - pDM_DigTable->BT30_CurIGI=0x32; - - ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_dig_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); - pDM_DigTable->pause_dig_level = 0; - ODM_Memory_Set(pDM_Odm, pDM_DigTable->pause_cckpd_value, 0, (DM_DIG_MAX_PAUSE_TYPE + 1)); - pDM_DigTable->pause_cckpd_level = 0; -#endif - - if(pDM_Odm->BoardType & (ODM_BOARD_EXT_PA|ODM_BOARD_EXT_LNA)) - { - pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; - pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; - } - else - { - pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_NIC; - pDM_DigTable->rx_gain_range_min = DM_DIG_MIN_NIC; - } - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) - pDM_DigTable->enableAdjustBigJump = 1; - if (pDM_Odm->SupportICType & ODM_RTL8822B) { - ret_value = ODM_GetBBReg(pDM_Odm, 0x8c8, bMaskLWord); - pDM_DigTable->bigJumpStep1 = (u1Byte)(ret_value & 0xe) >> 1; - pDM_DigTable->bigJumpStep2 = (u1Byte)(ret_value & 0x30)>>4; - pDM_DigTable->bigJumpStep3 = (u1Byte)(ret_value & 0xc0)>>6; - - } else if (pDM_Odm->SupportICType & ODM_RTL8197F) { - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_AGC_SET_2_11N, bMaskLWord); - pDM_DigTable->bigJumpStep1 = (u1Byte)(ret_value & 0xe) >> 1; - pDM_DigTable->bigJumpStep2 = (u1Byte)(ret_value & 0x30)>>4; - pDM_DigTable->bigJumpStep3 = (u1Byte)(ret_value & 0xc0)>>6; - } - if (pDM_Odm->SupportICType & (ODM_RTL8822B|ODM_RTL8197F)) { - for (i = 0; i < sizeof(pDM_DigTable->bigJumpLmt); i++) { - if (pDM_DigTable->bigJumpLmt[i] == 0) - pDM_DigTable->bigJumpLmt[i] = 0x64; /* Set -10dBm as default value */ - } - } -#endif -} - - -VOID -odm_DIG( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER pAdapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - PSTA_INFO_T pEntry; -#endif - - // Common parameters - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); - BOOLEAN FirstConnect,FirstDisConnect; - u1Byte DIG_MaxOfMin, DIG_Dynamic_MIN; - u1Byte dm_dig_max, dm_dig_min; - u1Byte CurrentIGI = pDM_DigTable->CurIGValue; - u1Byte offset; - u4Byte dm_FA_thres[3]; - u4Byte TxTp = 0, RxTp = 0; - BOOLEAN DIG_GoUpCheck = TRUE; - BOOLEAN bDFSBand = FALSE; - BOOLEAN bPerformance = TRUE, bFirstTpTarget = FALSE, bFirstCoverage = FALSE; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - u4Byte TpTrainTH_MIN = DM_DIG_TP_Target_TH0; - static u1Byte TimeCnt = 0; - u1Byte i; -#endif - - if(odm_DigAbort(pDM_Odm) == TRUE) - return; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG()===========================>\n\n")); - - - //1 Update status - { - DIG_Dynamic_MIN = pDM_DigTable->DIG_Dynamic_MIN_0; - FirstConnect = (pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == FALSE); - FirstDisConnect = (!pDM_Odm->bLinked) && (pDM_DigTable->bMediaConnect_0 == TRUE); - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - //1 Noise Floor Estimate - //pDM_DigTable->bNoiseEst = (FirstConnect)?TRUE:pDM_DigTable->bNoiseEst; - //odm_InbandNoiseCalculate (pDM_Odm); - - //1 Mode decision - if(pDM_Odm->bLinked) - { - //2 Calculate total TP - for (i=0; ipODM_StaInfo[i]; - if(IS_STA_VALID(pEntry)) - { - RxTp += (u4Byte)(pEntry->rx_byte_cnt_LowMAW>>7); - TxTp += (u4Byte)(pEntry->tx_byte_cnt_LowMAW>>7); //Kbps - } - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TX TP = %dkbps, RX TP = %dkbps\n", TxTp, RxTp)); - } - - switch(pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable) - { - case 0: - { - bPerformance = TRUE; - break; - } - case 1: - { - bPerformance = FALSE; - break; - } - case 2: - { - if(pDM_Odm->bLinked) - { - if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH0) - TpTrainTH_MIN = pDM_DigTable->TpTrainTH_min; - - if(pDM_DigTable->TpTrainTH_min > DM_DIG_TP_Target_TH1) - TpTrainTH_MIN = DM_DIG_TP_Target_TH1; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): TP training mode lower bound = %dkbps\n", TpTrainTH_MIN)); - - //2 Decide DIG mode by total TP - if((TxTp + RxTp) > DM_DIG_TP_Target_TH1) // change to performance mode - { - bFirstTpTarget = (!pDM_DigTable->bTpTarget)?TRUE:FALSE; - pDM_DigTable->bTpTarget = TRUE; - bPerformance = TRUE; - } - else if((TxTp + RxTp) < TpTrainTH_MIN) // change to coverage mode - { - bFirstCoverage = (pDM_DigTable->bTpTarget)?TRUE:FALSE; - - if(TimeCnt < DM_DIG_TP_Training_Period) - { - pDM_DigTable->bTpTarget = FALSE; - bPerformance = FALSE; - TimeCnt++; - } - else - { - pDM_DigTable->bTpTarget = TRUE; - bPerformance = TRUE; - bFirstTpTarget = TRUE; - TimeCnt = 0; - } - } - else // remain previous mode - { - bPerformance = pDM_DigTable->bTpTarget; - - if(!bPerformance) - { - if(TimeCnt < DM_DIG_TP_Training_Period) - TimeCnt++; - else - { - pDM_DigTable->bTpTarget = TRUE; - bPerformance = TRUE; - bFirstTpTarget = TRUE; - TimeCnt = 0; - } - } - } - - if(!bPerformance) - pDM_DigTable->TpTrainTH_min = RxTp + TxTp; - - } - else - { - bPerformance = FALSE; - pDM_DigTable->TpTrainTH_min = 0; - } - break; - } - default: - bPerformance = TRUE; - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== DIG mode = %d ======\n", pDM_Odm->priv->pshare->rf_ft_var.dig_cov_enable)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("====== bPerformance = %d ======\n", bPerformance)); -#endif - - //1 Boundary Decision - { -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - //2 For AP\ADSL - if(!bPerformance) - { - dm_dig_max = DM_DIG_MAX_AP_COVERAGR; - dm_dig_min = DM_DIG_MIN_AP_COVERAGE; - DIG_MaxOfMin = DM_DIG_MAX_OF_MIN_COVERAGE; - } - else - { - if (pDM_Odm->RFType == ODM_1T1R) - dm_dig_max = DM_DIG_MAX_AP - 6; - else - dm_dig_max = DM_DIG_MAX_AP; - - if ((*pDM_Odm->pBandType == ODM_BAND_2_4G) && (pDM_Odm->SupportICType & ODM_RTL8814A)) /* for 2G 8814 */ - dm_dig_min = 0x1c; - else - dm_dig_min = DM_DIG_MIN_AP; - DIG_MaxOfMin = DM_DIG_MAX_OF_MIN; - } - - //4 TX2path - if (priv->pmib->dot11RFEntry.tx2path && !bDFSBand && (*(pDM_Odm->pWirelessMode) == ODM_WM_B)) - dm_dig_max = 0x2A; - -#if RTL8192E_SUPPORT -#ifdef HIGH_POWER_EXT_LNA - if ((pDM_Odm->SupportICType & (ODM_RTL8192E)) && (pDM_Odm->ExtLNA)) - dm_dig_max = 0x42; -#endif -#endif - if (pDM_Odm->IGI_LowerBound) { - if (dm_dig_min < pDM_Odm->IGI_LowerBound) - dm_dig_min = pDM_Odm->IGI_LowerBound; - if (DIG_MaxOfMin < pDM_Odm->IGI_LowerBound) - DIG_MaxOfMin = pDM_Odm->IGI_LowerBound; - } - if (pDM_Odm->IGI_UpperBound) { - if (dm_dig_max > pDM_Odm->IGI_UpperBound) - dm_dig_max = pDM_Odm->IGI_UpperBound; - if (DIG_MaxOfMin > pDM_Odm->IGI_UpperBound) - DIG_MaxOfMin = pDM_Odm->IGI_UpperBound; - } -#else - //2 For WIN\CE - if(pDM_Odm->SupportICType >= ODM_RTL8188E) - dm_dig_max = 0x5A; - else - dm_dig_max = DM_DIG_MAX_NIC; - - if(pDM_Odm->SupportICType != ODM_RTL8821) - dm_dig_min = DM_DIG_MIN_NIC; - else - dm_dig_min = 0x1C; - - DIG_MaxOfMin = DM_DIG_MAX_AP; -#endif - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) - /* Modify lower bound for DFS band */ - if ((((*pDM_Odm->pChannel >= 52) && (*pDM_Odm->pChannel <= 64)) || - ((*pDM_Odm->pChannel >= 100) && (*pDM_Odm->pChannel <= 140))) - #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - && phydm_dfs_master_enabled(pDM_Odm) == TRUE - #endif - ) { - bDFSBand = TRUE; - if (*pDM_Odm->pBandWidth == ODM_BW20M) - dm_dig_min = DM_DIG_MIN_AP_DFS+2; - else - dm_dig_min = DM_DIG_MIN_AP_DFS; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): ====== In DFS band ======\n")); - } -#endif - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Absolutly upper bound = 0x%x, lower bound = 0x%x\n",dm_dig_max, dm_dig_min)); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if (pDM_Odm->pu1ForcedIgiLb && (0 < *pDM_Odm->pu1ForcedIgiLb)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Force IGI lb to: 0x%02x !!!!!!\n", *pDM_Odm->pu1ForcedIgiLb)); - dm_dig_min = *pDM_Odm->pu1ForcedIgiLb; - dm_dig_max = (dm_dig_min <= dm_dig_max) ? (dm_dig_max) : (dm_dig_min + 1); - } -#endif - - //1 Adjust boundary by RSSI - if(pDM_Odm->bLinked && bPerformance) - { - //2 Modify DIG upper bound -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - offset = 15; -#else - //4 Modify DIG upper bound for 92E, 8723A\B, 8821 & 8812 BT - if ((pDM_Odm->SupportICType & (ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8812|ODM_RTL8821)) && (pDM_Odm->bBtLimitedDig == 1)) - { - offset = 10; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Coex. case: Force upper bound to RSSI + %d !!!!!!\n", offset)); - } - else - offset = 15; -#endif - - if((pDM_Odm->RSSI_Min + offset) > dm_dig_max ) - pDM_DigTable->rx_gain_range_max = dm_dig_max; - else if((pDM_Odm->RSSI_Min + offset) < dm_dig_min ) - pDM_DigTable->rx_gain_range_max = dm_dig_min; - else - pDM_DigTable->rx_gain_range_max = pDM_Odm->RSSI_Min + offset; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - //2 Modify DIG lower bound - //if(pDM_Odm->bOneEntryOnly) - { - if(pDM_Odm->RSSI_Min < dm_dig_min) - DIG_Dynamic_MIN = dm_dig_min; - else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) - DIG_Dynamic_MIN = DIG_MaxOfMin; - else - DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; - -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - if (bDFSBand) { - DIG_Dynamic_MIN = dm_dig_min; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force lower bound to 0x%x after link !!!!!!\n", dm_dig_min)); - } -#endif - } -#else - { - //4 For AP -#ifdef __ECOS - HAL_REORDER_BARRIER(); -#else - rmb(); -#endif - if (bDFSBand) - { - DIG_Dynamic_MIN = dm_dig_min; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force lower bound to 0x%x after link !!!!!!\n", dm_dig_min)); - } - else - { - if(pDM_Odm->RSSI_Min < dm_dig_min) - DIG_Dynamic_MIN = dm_dig_min; - else if (pDM_Odm->RSSI_Min > DIG_MaxOfMin) - DIG_Dynamic_MIN = DIG_MaxOfMin; - else - DIG_Dynamic_MIN = pDM_Odm->RSSI_Min; - } - } -#endif - } - else - { -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) - if(bPerformance && bDFSBand) - { - pDM_DigTable->rx_gain_range_max = 0x28; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: Force upper bound to 0x%x before link !!!!!!\n", pDM_DigTable->rx_gain_range_max)); - } - else -#endif - { - if (bPerformance) - pDM_DigTable->rx_gain_range_max = DM_DIG_MAX_OF_MIN; - else - pDM_DigTable->rx_gain_range_max = dm_dig_max; - } - DIG_Dynamic_MIN = dm_dig_min; - } - - //1 Force Lower Bound for AntDiv - if(pDM_Odm->bLinked && !pDM_Odm->bOneEntryOnly) - { - if((pDM_Odm->SupportICType & ODM_ANTDIV_SUPPORT) && (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV)) - { - if (pDM_Odm->AntDivType == CG_TRX_HW_ANTDIV || pDM_Odm->AntDivType == CG_TRX_SMART_ANTDIV) { - if (pDM_DigTable->AntDiv_RSSI_max > DIG_MaxOfMin) - DIG_Dynamic_MIN = DIG_MaxOfMin; - else - DIG_Dynamic_MIN = (u1Byte) pDM_DigTable->AntDiv_RSSI_max; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: Force lower bound to 0x%x !!!!!!\n", DIG_Dynamic_MIN)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Antenna diversity case: RSSI_max = 0x%x !!!!!!\n", pDM_DigTable->AntDiv_RSSI_max)); - } - } - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust boundary by RSSI Upper bound = 0x%x, Lower bound = 0x%x\n", - pDM_DigTable->rx_gain_range_max, DIG_Dynamic_MIN)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Link status: bLinked = %d, RSSI = %d, bFirstConnect = %d, bFirsrDisConnect = %d\n\n", - pDM_Odm->bLinked, pDM_Odm->RSSI_Min, FirstConnect, FirstDisConnect)); - - //1 Modify DIG lower bound, deal with abnormal case - //2 Abnormal false alarm case -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) - if(bDFSBand) - { - pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; - } - else -#endif - { - if(!pDM_Odm->bLinked) - { - pDM_DigTable->rx_gain_range_min = DIG_Dynamic_MIN; - - if (FirstDisConnect) - pDM_DigTable->ForbiddenIGI = DIG_Dynamic_MIN; - } - else - pDM_DigTable->rx_gain_range_min = odm_ForbiddenIGICheck(pDM_Odm, DIG_Dynamic_MIN, CurrentIGI); - } - - //2 Abnormal # beacon case -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(pDM_Odm->bLinked && !FirstConnect) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Beacon Num (%d)\n", pDM_Odm->PhyDbgInfo.NumQryBeaconPkt)); - if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pDM_Odm->bsta_state)) - { - pDM_DigTable->rx_gain_range_min = 0x1c; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal #beacon (%d) case in STA mode: Force lower bound to 0x%x !!!!!!\n\n", - pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, pDM_DigTable->rx_gain_range_min)); - } - } -#endif - - //2 Abnormal lower bound case - if(pDM_DigTable->rx_gain_range_min > pDM_DigTable->rx_gain_range_max) - { - pDM_DigTable->rx_gain_range_min = pDM_DigTable->rx_gain_range_max; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnrormal lower bound case: Force lower bound to 0x%x !!!!!!\n\n",pDM_DigTable->rx_gain_range_min)); - } - - - //1 False alarm threshold decision - odm_FAThresholdCheck(pDM_Odm, bDFSBand, bPerformance, RxTp, TxTp, dm_FA_thres); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): False alarm threshold = %d, %d, %d \n\n", dm_FA_thres[0], dm_FA_thres[1], dm_FA_thres[2])); - - //1 Adjust initial gain by false alarm - if(pDM_Odm->bLinked && bPerformance) - { - //2 After link - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI after link\n")); - - if(bFirstTpTarget || (FirstConnect && bPerformance)) - { - pDM_DigTable->LargeFAHit = 0; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_CE)) - if(bDFSBand) - { - if(pDM_Odm->RSSI_Min > 0x28) - CurrentIGI = 0x28; - else - CurrentIGI = pDM_Odm->RSSI_Min; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): DFS band: One-shot to 0x28 upmost!!!!!!\n")); - } - else -#endif - { - if(pDM_Odm->RSSI_Min < DIG_MaxOfMin) - { - if(CurrentIGI < pDM_Odm->RSSI_Min) - CurrentIGI = pDM_Odm->RSSI_Min; - } - else - { - if(CurrentIGI < DIG_MaxOfMin) - CurrentIGI = DIG_MaxOfMin; - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -#if (RTL8812A_SUPPORT==1) - if(pDM_Odm->SupportICType == ODM_RTL8812) - ODM_ConfigBBWithHeaderFile(pDM_Odm, CONFIG_BB_AGC_TAB_DIFF); -#endif -#endif - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First connect case: IGI does on-shot to 0x%x\n", CurrentIGI)); - - } - else - { - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - - if (priv->pshare->rf_ft_var.dig_upcheck_enable) - DIG_GoUpCheck = phydm_DIG_GoUpCheck(pDM_Odm); -#endif - - if((pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) && DIG_GoUpCheck) - CurrentIGI = CurrentIGI + 4; - else if ((pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) && DIG_GoUpCheck) - CurrentIGI = CurrentIGI + 2; - else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) - CurrentIGI = CurrentIGI - 2; - - //4 Abnormal # beacon case -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if((pDM_Odm->PhyDbgInfo.NumQryBeaconPkt < 5) && (pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH1) && (pDM_Odm->bsta_state)) - { - CurrentIGI = pDM_DigTable->rx_gain_range_min; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Abnormal #beacon (%d) case: IGI does one-shot to 0x%x\n", - pDM_Odm->PhyDbgInfo.NumQryBeaconPkt, CurrentIGI)); - } -#endif - } - } - else - { - //2 Before link - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): Adjust IGI before link\n")); - - if(FirstDisConnect || bFirstCoverage) - { - CurrentIGI = dm_dig_min; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): First disconnect case: IGI does on-shot to lower bound\n")); - } - else - { - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - if (priv->pshare->rf_ft_var.dig_upcheck_enable) - DIG_GoUpCheck = phydm_DIG_GoUpCheck(pDM_Odm); -#endif - - if((pFalseAlmCnt->Cnt_all > dm_FA_thres[2]) && DIG_GoUpCheck) - CurrentIGI = CurrentIGI + 4; - else if ((pFalseAlmCnt->Cnt_all > dm_FA_thres[1]) && DIG_GoUpCheck) - CurrentIGI = CurrentIGI + 2; - else if(pFalseAlmCnt->Cnt_all < dm_FA_thres[0]) - CurrentIGI = CurrentIGI - 2; - } - } - - //1 Check initial gain by upper/lower bound - if(CurrentIGI < pDM_DigTable->rx_gain_range_min) - CurrentIGI = pDM_DigTable->rx_gain_range_min; - - if(CurrentIGI > pDM_DigTable->rx_gain_range_max) - CurrentIGI = pDM_DigTable->rx_gain_range_max; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIG(): CurIGValue=0x%x, TotalFA = %d\n\n", CurrentIGI, pFalseAlmCnt->Cnt_all)); - - //1 Update status - { -#if ((DM_ODM_SUPPORT_TYPE & ODM_WIN) || ((DM_ODM_SUPPORT_TYPE & ODM_CE) && (ODM_CONFIG_BT_COEXIST == 1))) - if(pDM_Odm->bBtHsOperation) - { - if(pDM_Odm->bLinked) - { - if(pDM_DigTable->BT30_CurIGI > (CurrentIGI)) - ODM_Write_DIG(pDM_Odm, CurrentIGI); - else - ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI); - - pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; - pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; - } - else - { - if(pDM_Odm->bLinkInProcess) - ODM_Write_DIG(pDM_Odm, 0x1c); - else if(pDM_Odm->bBtConnectProcess) - ODM_Write_DIG(pDM_Odm, 0x28); - else - ODM_Write_DIG(pDM_Odm, pDM_DigTable->BT30_CurIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); - } - } - else // BT is not using -#endif - { - ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); - pDM_DigTable->bMediaConnect_0 = pDM_Odm->bLinked; - pDM_DigTable->DIG_Dynamic_MIN_0 = DIG_Dynamic_MIN; - } - } -} - -VOID -odm_DIGbyRSSI_LPS( - IN PVOID pDM_VOID - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); - - u1Byte RSSI_Lower=DM_DIG_MIN_NIC; //0x1E or 0x1C - u1Byte CurrentIGI=pDM_Odm->RSSI_Min; - - if(odm_DigAbort(pDM_Odm) == TRUE) - return; - - CurrentIGI=CurrentIGI+RSSI_OFFSET_DIG; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS()==>\n")); - - // Using FW PS mode to make IGI - //Adjust by FA in LPS MODE - if(pFalseAlmCnt->Cnt_all> DM_DIG_FA_TH2_LPS) - CurrentIGI = CurrentIGI+4; - else if (pFalseAlmCnt->Cnt_all > DM_DIG_FA_TH1_LPS) - CurrentIGI = CurrentIGI+2; - else if(pFalseAlmCnt->Cnt_all < DM_DIG_FA_TH0_LPS) - CurrentIGI = CurrentIGI-2; - - - //Lower bound checking - - //RSSI Lower bound check - if((pDM_Odm->RSSI_Min-10) > DM_DIG_MIN_NIC) - RSSI_Lower =(pDM_Odm->RSSI_Min-10); - else - RSSI_Lower =DM_DIG_MIN_NIC; - - //Upper and Lower Bound checking - if(CurrentIGI > DM_DIG_MAX_NIC) - CurrentIGI = DM_DIG_MAX_NIC; - else if(CurrentIGI < RSSI_Lower) - CurrentIGI = RSSI_Lower; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pFalseAlmCnt->Cnt_all = %d\n",pFalseAlmCnt->Cnt_all)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): pDM_Odm->RSSI_Min = %d\n",pDM_Odm->RSSI_Min)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_DIGbyRSSI_LPS(): CurrentIGI = 0x%x\n",CurrentIGI)); - - ODM_Write_DIG(pDM_Odm, CurrentIGI);//ODM_Write_DIG(pDM_Odm, pDM_DigTable->CurIGValue); -#endif -} - -//3============================================================ -//3 FASLE ALARM CHECK -//3============================================================ - -VOID -odm_FalseAlarmCounterStatistics( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); - u4Byte ret_value; - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -//Mark there, and check this in odm_DMWatchDog -#if 0 //(DM_ODM_SUPPORT_TYPE == ODM_AP) - prtl8192cd_priv priv = pDM_Odm->priv; - if( (priv->auto_channel != 0) && (priv->auto_channel != 2) ) - return; -#endif -#endif - - if(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT)) - return; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics()======>\n")); - -#if (ODM_IC_11N_SERIES_SUPPORT == 1) - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES) - { - - //hold ofdm counter - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 1); //hold page C counter - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 1); //hold page D counter - - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE1_11N, bMaskDWord); - FalseAlmCnt->Cnt_Fast_Fsync = (ret_value&0xffff); - FalseAlmCnt->Cnt_SB_Search_fail = ((ret_value&0xffff0000)>>16); - - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE2_11N, bMaskDWord); - FalseAlmCnt->Cnt_OFDM_CCA = (ret_value&0xffff); - FalseAlmCnt->Cnt_Parity_Fail = ((ret_value&0xffff0000)>>16); - - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE3_11N, bMaskDWord); - FalseAlmCnt->Cnt_Rate_Illegal = (ret_value&0xffff); - FalseAlmCnt->Cnt_Crc8_fail = ((ret_value&0xffff0000)>>16); - - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_TYPE4_11N, bMaskDWord); - FalseAlmCnt->Cnt_Mcs_fail = (ret_value&0xffff); - - FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Parity_Fail + FalseAlmCnt->Cnt_Rate_Illegal + - FalseAlmCnt->Cnt_Crc8_fail + FalseAlmCnt->Cnt_Mcs_fail + - FalseAlmCnt->Cnt_Fast_Fsync + FalseAlmCnt->Cnt_SB_Search_fail; - - /* read CCK CRC32 counter */ - FalseAlmCnt->cnt_cck_crc32_error = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_ERROR_CNT_11N, bMaskDWord); - FalseAlmCnt->cnt_cck_crc32_ok= ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_OK_CNT_11N, bMaskDWord); - - /* read OFDM CRC32 counter */ - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_CRC32_CNT_11N, bMaskDWord); - FalseAlmCnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; - FalseAlmCnt->cnt_ofdm_crc32_ok= ret_value & 0xffff; - - /* read HT CRC32 counter */ - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_HT_CRC32_CNT_11N, bMaskDWord); - FalseAlmCnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; - FalseAlmCnt->cnt_ht_crc32_ok= ret_value & 0xffff; - - /* read VHT CRC32 counter */ - FalseAlmCnt->cnt_vht_crc32_error = 0; - FalseAlmCnt->cnt_vht_crc32_ok= 0; - -#if (RTL8188E_SUPPORT==1) - if(pDM_Odm->SupportICType == ODM_RTL8188E) - { - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_SC_CNT_11N, bMaskDWord); - FalseAlmCnt->Cnt_BW_LSC = (ret_value&0xffff); - FalseAlmCnt->Cnt_BW_USC = ((ret_value&0xffff0000)>>16); - } -#endif - - { - //hold cck counter - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT12, 1); - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT14, 1); - - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_LSB_11N, bMaskByte0); - FalseAlmCnt->Cnt_Cck_fail = ret_value; - - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_MSB_11N, bMaskByte3); - FalseAlmCnt->Cnt_Cck_fail += (ret_value& 0xff)<<8; - - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11N, bMaskDWord); - FalseAlmCnt->Cnt_CCK_CCA = ((ret_value&0xFF)<<8) |((ret_value&0xFF00)>>8); - } - - FalseAlmCnt->Cnt_all_pre = FalseAlmCnt->Cnt_all; - - FalseAlmCnt->Cnt_all = ( FalseAlmCnt->Cnt_Fast_Fsync + - FalseAlmCnt->Cnt_SB_Search_fail + - FalseAlmCnt->Cnt_Parity_Fail + - FalseAlmCnt->Cnt_Rate_Illegal + - FalseAlmCnt->Cnt_Crc8_fail + - FalseAlmCnt->Cnt_Mcs_fail + - FalseAlmCnt->Cnt_Cck_fail); - - FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA + FalseAlmCnt->Cnt_CCK_CCA; - - if (pDM_Odm->SupportICType >= ODM_RTL8188E) { - /*reset false alarm counter registers*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 1); - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTC_11N, BIT31, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 1); - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT27, 0); - - /*update ofdm counter*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_HOLDC_11N, BIT31, 0); /*update page C counter*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RSTD_11N, BIT31, 0); /*update page D counter*/ - - /*reset CCK CCA counter*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT13|BIT12, 2); - - /*reset CCK FA counter*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11N, BIT15|BIT14, 2); - - /*reset CRC32 counter*/ - ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_F_RST_11N, BIT16, 1); - ODM_SetBBReg(pDM_Odm, ODM_REG_PAGE_F_RST_11N, BIT16, 0); - } - - /* Get debug port 0 */ - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x0); - FalseAlmCnt->dbg_port0 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, bMaskDWord); - - /* Get EDCCA flag */ - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11N, bMaskDWord, 0x208); - FalseAlmCnt->edcca_flag = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11N, BIT30); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Fast_Fsync=%d, Cnt_SB_Search_fail=%d\n", - FalseAlmCnt->Cnt_Fast_Fsync, FalseAlmCnt->Cnt_SB_Search_fail)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Parity_Fail=%d, Cnt_Rate_Illegal=%d\n", - FalseAlmCnt->Cnt_Parity_Fail, FalseAlmCnt->Cnt_Rate_Illegal)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Crc8_fail=%d, Cnt_Mcs_fail=%d\n", - FalseAlmCnt->Cnt_Crc8_fail, FalseAlmCnt->Cnt_Mcs_fail)); - } -#endif - -#if (ODM_IC_11AC_SERIES_SUPPORT == 1) - if(pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - { - u4Byte CCKenable; - - /* read OFDM FA counter */ - FalseAlmCnt->Cnt_Ofdm_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_FA_11AC, bMaskLWord); - - /* Read CCK FA counter */ - FalseAlmCnt->Cnt_Cck_fail = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_FA_11AC, bMaskLWord); - - /* read CCK/OFDM CCA counter */ - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CCA_CNT_11AC, bMaskDWord); - FalseAlmCnt->Cnt_OFDM_CCA = (ret_value & 0xffff0000) >> 16; - FalseAlmCnt->Cnt_CCK_CCA = ret_value & 0xffff; - - /* read CCK CRC32 counter */ - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_CCK_CRC32_CNT_11AC, bMaskDWord); - FalseAlmCnt->cnt_cck_crc32_error = (ret_value & 0xffff0000) >> 16; - FalseAlmCnt->cnt_cck_crc32_ok= ret_value & 0xffff; - - /* read OFDM CRC32 counter */ - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_OFDM_CRC32_CNT_11AC, bMaskDWord); - FalseAlmCnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; - FalseAlmCnt->cnt_ofdm_crc32_ok= ret_value & 0xffff; - - /* read HT CRC32 counter */ - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_HT_CRC32_CNT_11AC, bMaskDWord); - FalseAlmCnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; - FalseAlmCnt->cnt_ht_crc32_ok= ret_value & 0xffff; - - /* read VHT CRC32 counter */ - ret_value = ODM_GetBBReg(pDM_Odm, ODM_REG_VHT_CRC32_CNT_11AC, bMaskDWord); - FalseAlmCnt->cnt_vht_crc32_error = (ret_value & 0xffff0000) >> 16; - FalseAlmCnt->cnt_vht_crc32_ok= ret_value & 0xffff; - -#if (RTL8881A_SUPPORT==1) - /* For 8881A */ - if(pDM_Odm->SupportICType == ODM_RTL8881A) - { - u4Byte Cnt_Ofdm_fail_temp = 0; - - if(FalseAlmCnt->Cnt_Ofdm_fail >= FalseAlmCnt->Cnt_Ofdm_fail_pre) - { - Cnt_Ofdm_fail_temp = FalseAlmCnt->Cnt_Ofdm_fail_pre; - FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; - FalseAlmCnt->Cnt_Ofdm_fail = FalseAlmCnt->Cnt_Ofdm_fail - Cnt_Ofdm_fail_temp; - } - else - FalseAlmCnt->Cnt_Ofdm_fail_pre = FalseAlmCnt->Cnt_Ofdm_fail; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail_pre)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail_pre=%d\n", Cnt_Ofdm_fail_temp)); - - /* Reset FA counter by enable/disable OFDM */ - if(FalseAlmCnt->Cnt_Ofdm_fail_pre >= 0x7fff) - { - // reset OFDM - ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,0); - ODM_SetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT29,1); - FalseAlmCnt->Cnt_Ofdm_fail_pre = 0; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Reset false alarm counter\n")); - } - } -#endif - - /* reset OFDM FA coutner */ - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 1); - ODM_SetBBReg(pDM_Odm, ODM_REG_OFDM_FA_RST_11AC, BIT17, 0); - - /* reset CCK FA counter */ - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 0); - ODM_SetBBReg(pDM_Odm, ODM_REG_CCK_FA_RST_11AC, BIT15, 1); - - /* reset CCA counter */ - ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 1); - ODM_SetBBReg(pDM_Odm, ODM_REG_RST_RPT_11AC, BIT0, 0); - - CCKenable = ODM_GetBBReg(pDM_Odm, ODM_REG_BB_RX_PATH_11AC, BIT28); - if(CCKenable)//if(*pDM_Odm->pBandType == ODM_BAND_2_4G) - { - FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail + FalseAlmCnt->Cnt_Cck_fail; - FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_CCK_CCA + FalseAlmCnt->Cnt_OFDM_CCA; - } - else - { - FalseAlmCnt->Cnt_all = FalseAlmCnt->Cnt_Ofdm_fail; - FalseAlmCnt->Cnt_CCA_all = FalseAlmCnt->Cnt_OFDM_CCA; - } - if (pDM_Odm->ADCSmp_count == 0) { - /* Get debug port 0 */ - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x0); - FalseAlmCnt->dbg_port0 = ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, bMaskDWord); - - /* Get EDCCA flag */ - ODM_SetBBReg(pDM_Odm, ODM_REG_DBG_RPT_11AC, bMaskDWord, 0x209); - FalseAlmCnt->edcca_flag = (BOOLEAN)ODM_GetBBReg(pDM_Odm, ODM_REG_RPT_11AC, BIT30); - } - - } -#endif - - - FalseAlmCnt->cnt_crc32_error_all = FalseAlmCnt->cnt_vht_crc32_error + FalseAlmCnt->cnt_ht_crc32_error + FalseAlmCnt->cnt_ofdm_crc32_error + FalseAlmCnt->cnt_cck_crc32_error; - FalseAlmCnt->cnt_crc32_ok_all = FalseAlmCnt->cnt_vht_crc32_ok + FalseAlmCnt->cnt_ht_crc32_ok + FalseAlmCnt->cnt_ofdm_crc32_ok + FalseAlmCnt->cnt_cck_crc32_ok; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_OFDM_CCA=%d\n", FalseAlmCnt->Cnt_OFDM_CCA)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCK_CCA=%d\n", FalseAlmCnt->Cnt_CCK_CCA)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_CCA_all=%d\n", FalseAlmCnt->Cnt_CCA_all)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Cck_fail=%d\n", FalseAlmCnt->Cnt_Cck_fail)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Cnt_Ofdm_fail=%d\n", FalseAlmCnt->Cnt_Ofdm_fail)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Total False Alarm=%d\n", FalseAlmCnt->Cnt_all)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): CCK CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_cck_crc32_error, FalseAlmCnt->cnt_cck_crc32_ok)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): OFDM CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_ofdm_crc32_error, FalseAlmCnt->cnt_ofdm_crc32_ok)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): HT CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_ht_crc32_error, FalseAlmCnt->cnt_ht_crc32_ok)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): VHT CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_vht_crc32_error, FalseAlmCnt->cnt_vht_crc32_ok)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): Total CRC32 fail: %d, ok: %d\n", FalseAlmCnt->cnt_crc32_error_all, FalseAlmCnt->cnt_crc32_ok_all)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_FA_CNT, ODM_DBG_LOUD, ("odm_FalseAlarmCounterStatistics(): dbg port 0x0 = 0x%x, EDCCA = %d\n\n", FalseAlmCnt->dbg_port0, FalseAlmCnt->edcca_flag)); -} - -//3============================================================ -//3 CCK Packet Detect Threshold -//3============================================================ - -VOID -odm_PauseCCKPacketDetection( - IN PVOID pDM_VOID, - IN PHYDM_PAUSE_TYPE PauseType, - IN PHYDM_PAUSE_LEVEL pause_level, - IN u1Byte CCKPDThreshold -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection()=========> level = %d\n", pause_level)); - - if ((pDM_DigTable->pause_cckpd_level == 0) && (!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD) || !(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("Return: SupportAbility ODM_BB_CCK_PD or ODM_BB_FA_CNT is disabled\n")); - return; - } - - if (pause_level > DM_DIG_MAX_PAUSE_TYPE) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_PauseCCKPacketDetection(): Return: Wrong pause level !!\n")); - return; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], - pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); - - switch (PauseType) { - /* Pause CCK Packet Detection Threshold */ - case PHYDM_PAUSE: - { - /* Disable CCK PD */ - ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility & (~ODM_BB_CCK_PD)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Pause CCK packet detection threshold !!\n")); - - /* Backup original CCK PD threshold decided by CCK PD mechanism */ - if (pDM_DigTable->pause_cckpd_level == 0) { - pDM_DigTable->CCKPDBackup = pDM_DigTable->CurCCK_CCAThres; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, - ("odm_PauseCCKPacketDetection(): Backup CCKPD = 0x%x, new CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup, CCKPDThreshold)); - } - - /* Update pause level */ - pDM_DigTable->pause_cckpd_level = (pDM_DigTable->pause_cckpd_level | BIT(pause_level)); - - /* Record CCK PD threshold */ - pDM_DigTable->pause_cckpd_value[pause_level] = CCKPDThreshold; - - /* Write new CCK PD threshold */ - if (BIT(pause_level + 1) > pDM_DigTable->pause_cckpd_level) { - ODM_Write_CCK_CCA_Thres(pDM_Odm, CCKPDThreshold); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): CCKPD of higher level = 0x%x\n", CCKPDThreshold)); - } - break; - } - /* Resume CCK Packet Detection Threshold */ - case PHYDM_RESUME: - { - /* check if the level is illegal or not */ - if ((pDM_DigTable->pause_cckpd_level & (BIT(pause_level))) != 0) { - pDM_DigTable->pause_cckpd_level = pDM_DigTable->pause_cckpd_level & (~(BIT(pause_level))); - pDM_DigTable->pause_cckpd_value[pause_level] = 0; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Resume CCK PD !!\n")); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong resume level !!\n")); - break; - } - - /* Resume DIG */ - if (pDM_DigTable->pause_cckpd_level == 0) { - /* Write backup IGI value */ - ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->CCKPDBackup); - /* pDM_DigTable->bIgnoreDIG = TRUE; */ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write original CCKPD = 0x%x\n", pDM_DigTable->CCKPDBackup)); - - /* Enable DIG */ - ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, pDM_Odm->SupportAbility | ODM_BB_CCK_PD); - break; - } - - if (BIT(pause_level) > pDM_DigTable->pause_cckpd_level) { - s1Byte max_level; - - /* Calculate the maximum level now */ - for (max_level = (pause_level - 1); max_level >= 0; max_level--) { - if ((pDM_DigTable->pause_cckpd_level & BIT(max_level)) > 0) - break; - } - - /* write CCKPD of lower level */ - ODM_Write_CCK_CCA_Thres(pDM_Odm, pDM_DigTable->pause_cckpd_value[max_level]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Write CCKPD (0x%x) of level (%d)\n", - pDM_DigTable->pause_cckpd_value[max_level], max_level)); - break; - } - break; - } - default: - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): Wrong type !!\n")); - break; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause level = 0x%x, Current value = 0x%x\n", pDM_DigTable->pause_cckpd_level, CCKPDThreshold)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_PauseCCKPacketDetection(): pause value = 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x\n", - pDM_DigTable->pause_cckpd_value[7], pDM_DigTable->pause_cckpd_value[6], pDM_DigTable->pause_cckpd_value[5], pDM_DigTable->pause_cckpd_value[4], - pDM_DigTable->pause_cckpd_value[3], pDM_DigTable->pause_cckpd_value[2], pDM_DigTable->pause_cckpd_value[1], pDM_DigTable->pause_cckpd_value[0])); -} - - -VOID -odm_CCKPacketDetectionThresh( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - PFALSE_ALARM_STATISTICS FalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); - u1Byte CurCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres, RSSI_thd = 35; - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -//modify by Guo.Mingzhi 2011-12-29 - if (pDM_Odm->bDualMacSmartConcurrent == TRUE) -// if (pDM_Odm->bDualMacSmartConcurrent == FALSE) - return; - if(pDM_Odm->bBtHsOperation) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() write 0xcd for BT HS mode!!\n")); - ODM_Write_CCK_CCA_Thres(pDM_Odm, 0xcd); - return; - } -#endif - - if((!(pDM_Odm->SupportAbility & ODM_BB_CCK_PD)) ||(!(pDM_Odm->SupportAbility & ODM_BB_FA_CNT))) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() return==========\n")); -#ifdef MCR_WIRELESS_EXTEND - ODM_Write_CCK_CCA_Thres(pDM_Odm, 0x43); -#endif - return; - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - if(pDM_Odm->ExtLNA) - return; -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() ==========>\n")); - - if (pDM_DigTable->cckFaMa == 0xffffffff) - pDM_DigTable->cckFaMa = FalseAlmCnt->Cnt_Cck_fail; - else - pDM_DigTable->cckFaMa = ((pDM_DigTable->cckFaMa<<1) + pDM_DigTable->cckFaMa + FalseAlmCnt->Cnt_Cck_fail) >> 2; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh(): CCK FA moving average = %d\n", pDM_DigTable->cckFaMa)); - - if (pDM_Odm->bLinked) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - #if 0 /*for [PCIE-1596]*/ - if (pDM_Odm->RSSI_Min > (RSSI_thd + 14)) - CurCCK_CCAThres = 0xed; - else if (pDM_Odm->RSSI_Min > (RSSI_thd + 6)) - CurCCK_CCAThres = 0xdd; - else - #endif - if (pDM_Odm->RSSI_Min > RSSI_thd) - CurCCK_CCAThres = 0xcd; - else if (pDM_Odm->RSSI_Min > 20) { - if (pDM_DigTable->cckFaMa > ((DM_DIG_FA_TH1>>1) + (DM_DIG_FA_TH1>>3))) - CurCCK_CCAThres = 0xcd; - else if (pDM_DigTable->cckFaMa < (DM_DIG_FA_TH0>>1)) - CurCCK_CCAThres = 0x83; - } else if (pDM_Odm->RSSI_Min > 7) - CurCCK_CCAThres = 0x83; - else - CurCCK_CCAThres = 0x40; -#else - if (pDM_DigTable->CurIGValue > (0x24 + 14)) - CurCCK_CCAThres = 0xed; - else if (pDM_DigTable->CurIGValue > (0x24 + 6)) - CurCCK_CCAThres = 0xdd; - else if (pDM_DigTable->CurIGValue > 0x24) - CurCCK_CCAThres = 0xcd; - else { - if (pDM_DigTable->cckFaMa > 0x400) - CurCCK_CCAThres = 0x83; - else if (pDM_DigTable->cckFaMa < 0x200) - CurCCK_CCAThres = 0x40; - } - -#endif - } else { - if (pDM_DigTable->cckFaMa > 0x400) - CurCCK_CCAThres = 0x83; - else if (pDM_DigTable->cckFaMa < 0x200) - CurCCK_CCAThres = 0x40; - } - - ODM_Write_CCK_CCA_Thres(pDM_Odm, CurCCK_CCAThres); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("odm_CCKPacketDetectionThresh() CurCCK_CCAThres = 0x%x\n", CurCCK_CCAThres)); -} - -VOID -ODM_Write_CCK_CCA_Thres( - IN PVOID pDM_VOID, - IN u1Byte CurCCK_CCAThres - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - if(pDM_DigTable->CurCCK_CCAThres!=CurCCK_CCAThres) //modify by Guo.Mingzhi 2012-01-03 - { - ODM_Write1Byte(pDM_Odm, ODM_REG(CCK_CCA,pDM_Odm), CurCCK_CCAThres); - pDM_DigTable->cckFaMa = 0xffffffff; - } - pDM_DigTable->PreCCK_CCAThres = pDM_DigTable->CurCCK_CCAThres; - pDM_DigTable->CurCCK_CCAThres = CurCCK_CCAThres; -} - -BOOLEAN -phydm_DIG_GoUpCheck( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PCCX_INFO CCX_INFO = &pDM_Odm->DM_CCX_INFO; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - u1Byte CurIGValue = pDM_DigTable->CurIGValue; - u1Byte max_DIG_cover_bond; - u1Byte current_IGI_MaxUp_resolution; - u1Byte rx_gain_range_max; - u1Byte i = 0; - - u4Byte total_NHM_cnt; - u4Byte DIG_cover_cnt; - u4Byte over_DIG_cover_cnt; - BOOLEAN ret = TRUE; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - - max_DIG_cover_bond = DM_DIG_MAX_AP - priv->pshare->rf_ft_var.dig_upcheck_initial_value; - current_IGI_MaxUp_resolution = CurIGValue + 6; - rx_gain_range_max = pDM_DigTable->rx_gain_range_max; - - phydm_getNHMresult(pDM_Odm); - - total_NHM_cnt = CCX_INFO->NHM_result[0] + CCX_INFO->NHM_result[1]; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): *****Get NHM results*****\n")); - - if (total_NHM_cnt != 0) { - - /* CurIGValue < max_DIG_cover_bond - 6 */ - if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_0) { - DIG_cover_cnt = CCX_INFO->NHM_result[1]; - ret = ((priv->pshare->rf_ft_var.dig_level0_ratio_reciprocal * DIG_cover_cnt) >= total_NHM_cnt) ? TRUE : FALSE; - } - - /* (max_DIG_cover_bond - 6) <= CurIGValue < DM_DIG_MAX_AP */ - else if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_1) { - over_DIG_cover_cnt = CCX_INFO->NHM_result[1]; - ret = (priv->pshare->rf_ft_var.dig_level1_ratio_reciprocal * over_DIG_cover_cnt < total_NHM_cnt) ? TRUE : FALSE; - - if (!ret) { - /* update pDM_DigTable->rx_gain_range_max */ - pDM_DigTable->rx_gain_range_max = (rx_gain_range_max >= max_DIG_cover_bond - 6) ? (max_DIG_cover_bond - 6) : rx_gain_range_max; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): Noise power is beyond DIG can filter, lock rx_gain_range_max to 0x%x\n", - pDM_DigTable->rx_gain_range_max)); - } - } - - /* CurIGValue > DM_DIG_MAX_AP, foolproof */ - else if (pDM_DigTable->DIG_GoUpCheck_Level == DIG_GOUPCHECK_LEVEL_2) { - ret = TRUE; - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): DIG_GoUpCheck_level = %d\n, current_IGI_MaxUp_resolution = 0x%x\n, max_DIG_cover_bond = 0x%x\n, rx_gain_range_max = 0x%x, ret = %d\n", - pDM_DigTable->DIG_GoUpCheck_Level, - current_IGI_MaxUp_resolution, - max_DIG_cover_bond, - pDM_DigTable->rx_gain_range_max, - ret)); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): NHM_result = %d, %d, %d, %d\n", - CCX_INFO->NHM_result[0], CCX_INFO->NHM_result[1], CCX_INFO->NHM_result[2], CCX_INFO->NHM_result[3])); - - } - else - ret = TRUE; - - for (i = 0 ; i <= 10 ; i ++) { - CCX_INFO->NHM_th[i] = 0xFF; - } - - if (CurIGValue < max_DIG_cover_bond - 6){ - CCX_INFO->NHM_th[0] = 2 * (CurIGValue - priv->pshare->rf_ft_var.dig_upcheck_initial_value); - pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_0; - } - else if (CurIGValue <= DM_DIG_MAX_AP) { - CCX_INFO->NHM_th[0] = 2 * max_DIG_cover_bond; - pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_1; - } - /* CurIGValue > DM_DIG_MAX_AP, foolproof */ - else { - pDM_DigTable->DIG_GoUpCheck_Level = DIG_GOUPCHECK_LEVEL_2; - ret = TRUE; - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): *****Set NHM settings*****\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): DIG_GoUpCheck_level = %d\n", - pDM_DigTable->DIG_GoUpCheck_Level)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("phydm_DIG_GoUpCheck(): NHM_th = 0x%x, 0x%x, 0x%x\n", - CCX_INFO->NHM_th[0], CCX_INFO->NHM_th[1], CCX_INFO->NHM_th[2])); - - CCX_INFO->NHM_inexclude_cca = NHM_EXCLUDE_CCA; - CCX_INFO->NHM_inexclude_txon = NHM_EXCLUDE_TXON; - CCX_INFO->NHM_period = 0xC350; - - phydm_NHMsetting(pDM_Odm, SET_NHM_SETTING); - phydm_NHMtrigger(pDM_Odm); -#endif - - return ret; -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -// <20130108, Kordan> E.g., With LNA used, we make the Rx power smaller to have a better EVM. (Asked by Willis) -VOID -odm_RFEControl( - IN PDM_ODM_T pDM_Odm, - IN u8Byte RSSIVal - ) -{ - PADAPTER Adapter = (PADAPTER)pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - static u1Byte TRSW_HighPwr = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("===> odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X, pHalData->RFEType = %d\n", - RSSIVal, TRSW_HighPwr, pHalData->RFEType )); - - if (pHalData->RFEType == 3) { - - pDM_Odm->RSSI_TRSW = RSSIVal; - - if (pDM_Odm->RSSI_TRSW >= pDM_Odm->RSSI_TRSW_H) - { - TRSW_HighPwr = 1; // Switch to - PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control - PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x3); // Set ANTSW=1/ANTSWB=0 for SW control - - } - else if (pDM_Odm->RSSI_TRSW <= pDM_Odm->RSSI_TRSW_L) - { - TRSW_HighPwr = 0; // Switched back - PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT1|BIT0, 0x1); // Set ANTSW=1/ANTSWB=0 for SW control - PHY_SetBBReg(Adapter, r_ANTSEL_SW_Jaguar, BIT9|BIT8, 0x0); // Set ANTSW=1/ANTSWB=0 for SW control - - } - } - - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L) = (%d, %d)\n", pDM_Odm->RSSI_TRSW_H, pDM_Odm->RSSI_TRSW_L)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("(RSSIVal, RSSIVal, pDM_Odm->RSSI_TRSW_iso) = (%d, %d, %d)\n", - RSSIVal, pDM_Odm->RSSI_TRSW_iso, pDM_Odm->RSSI_TRSW)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DIG, ODM_DBG_LOUD, ("<=== odm_RFEControl, RSSI = %d, TRSW_HighPwr = 0x%X\n", RSSIVal, TRSW_HighPwr)); -} - -VOID -odm_MPT_DIGWorkItemCallback( - IN PVOID pContext - ) -{ - PADAPTER Adapter = (PADAPTER)pContext; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - ODM_MPT_DIG(pDM_Odm); -} - -VOID -odm_MPT_DIGCallback( - PRT_TIMER pTimer -) -{ - PADAPTER Adapter = (PADAPTER)pTimer->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - - #if DEV_BUS_TYPE==RT_PCI_INTERFACE - #if USE_WORKITEM - PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); - #else - ODM_MPT_DIG(pDM_Odm); - #endif - #else - PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); - #endif - -} - -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -VOID -odm_MPT_DIGCallback( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if USE_WORKITEM - PlatformScheduleWorkItem(&pDM_Odm->MPT_DIGWorkitem); -#else - ODM_MPT_DIG(pDM_Odm); -#endif -} -#endif - -#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -VOID -odm_MPT_Write_DIG( - IN PVOID pDM_VOID, - IN u1Byte CurIGValue -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - - ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), CurIGValue); - -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - /* Set IGI value of CCK for new CCK AGC */ - if (pDM_Odm->cck_new_agc) { - if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) - ODM_SetBBReg(pDM_Odm, 0xa0c, 0x00003f00, (CurIGValue>>1)); - } - -#endif - - if(pDM_Odm->RFType > ODM_1T1R) - ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), CurIGValue); - - if((pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) && (pDM_Odm->RFType > ODM_2T2R)) - { - ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_C,pDM_Odm), CurIGValue); - ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_D,pDM_Odm), CurIGValue); - } - - pDM_DigTable->CurIGValue = CurIGValue; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("CurIGValue = 0x%x\n", CurIGValue)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("pDM_Odm->RFType = 0x%x\n", pDM_Odm->RFType)); -} - -VOID -ODM_MPT_DIG( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - PFALSE_ALARM_STATISTICS pFalseAlmCnt = (PFALSE_ALARM_STATISTICS)PhyDM_Get_Structure( pDM_Odm, PHYDM_FALSEALMCNT); - u1Byte CurrentIGI = pDM_DigTable->CurIGValue; - u1Byte DIG_Upper = 0x40, DIG_Lower = 0x20; - u4Byte RXOK_cal; - u4Byte RxPWDBAve_final; - u1Byte IGI_A = 0x20, IGI_B = 0x20; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - #if ODM_FIX_2G_DIG - IGI_A = 0x22; - IGI_B = 0x24; - #endif - -#else - if (!(pDM_Odm->priv->pshare->rf_ft_var.mp_specific && pDM_Odm->priv->pshare->mp_dig_on)) - return; - - if (*pDM_Odm->pBandType == ODM_BAND_5G) - DIG_Lower = 0x22; -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> ODM_MPT_DIG, pBandType = %d\n", *pDM_Odm->pBandType)); - -#if (ODM_FIX_2G_DIG || (DM_ODM_SUPPORT_TYPE & ODM_AP)) - if (*pDM_Odm->pBandType == ODM_BAND_5G || (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) // for 5G or 8814 -#else - if (1) // for both 2G/5G -#endif - { - odm_FalseAlarmCounterStatistics(pDM_Odm); - - RXOK_cal = pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK + pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM; - RxPWDBAve_final = (RXOK_cal != 0)?pDM_Odm->RxPWDBAve/RXOK_cal:0; - - pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK = 0; - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM = 0; - pDM_Odm->RxPWDBAve = 0; - pDM_Odm->MPDIG_2G = FALSE; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pDM_Odm->Times_2G = 0; -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RX OK = %d\n", RXOK_cal)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("RSSI = %d\n", RxPWDBAve_final)); - - if (RXOK_cal >= 70 && RxPWDBAve_final <= 40) - { - if (CurrentIGI > 0x24) - odm_MPT_Write_DIG(pDM_Odm, 0x24); - } - else - { - if(pFalseAlmCnt->Cnt_all > 1000){ - CurrentIGI = CurrentIGI + 8; - } - else if(pFalseAlmCnt->Cnt_all > 200){ - CurrentIGI = CurrentIGI + 4; - } - else if (pFalseAlmCnt->Cnt_all > 50){ - CurrentIGI = CurrentIGI + 2; - } - else if (pFalseAlmCnt->Cnt_all < 2){ - CurrentIGI = CurrentIGI - 2; - } - - if (CurrentIGI < DIG_Lower ){ - CurrentIGI = DIG_Lower; - } - - if(CurrentIGI > DIG_Upper){ - CurrentIGI = DIG_Upper; - } - - odm_MPT_Write_DIG(pDM_Odm, CurrentIGI); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("DIG = 0x%x, Cnt_all = %d, Cnt_Ofdm_fail = %d, Cnt_Cck_fail = %d\n", - CurrentIGI, pFalseAlmCnt->Cnt_all, pFalseAlmCnt->Cnt_Ofdm_fail, pFalseAlmCnt->Cnt_Cck_fail)); - } - } - else - { - if(pDM_Odm->MPDIG_2G == FALSE) - { - if((pDM_Odm->SupportPlatform & ODM_WIN) && !(pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B))) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_DIG, ODM_DBG_LOUD, ("===> Fix IGI\n")); - ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_A,pDM_Odm), IGI_A); - ODM_Write1Byte( pDM_Odm, ODM_REG(IGI_B,pDM_Odm), IGI_B); - pDM_DigTable->CurIGValue = IGI_B; - } - else - odm_MPT_Write_DIG(pDM_Odm, IGI_A); - } - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pDM_Odm->Times_2G++; - - if (pDM_Odm->Times_2G == 3) -#endif - { - pDM_Odm->MPDIG_2G = TRUE; - } - } - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (pDM_Odm->SupportICType == ODM_RTL8812) - odm_RFEControl(pDM_Odm, RxPWDBAve_final); -#endif - - ODM_SetTimer(pDM_Odm, &pDM_Odm->MPT_DIGTimer, 700); -} -#endif - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + + +boolean +phydm_dig_go_up_check( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _CCX_INFO *ccx_info = &p_dm->dm_ccx_info; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u8 cur_ig_value = p_dig_t->cur_ig_value; + u8 max_cover_bond; + u8 rx_gain_range_max = p_dig_t->rx_gain_range_max; + u8 i = 0, j = 0; + u8 total_nhm_cnt = ccx_info->nhm_result_total; + u32 dig_cover_cnt = 0; + u32 over_dig_cover_cnt = 0; + boolean ret = true; + + if (*p_dm->p_bb_op_mode == PHYDM_PERFORMANCE_MODE) + return ret; + + max_cover_bond = DIG_MAX_BALANCE_MODE - p_dig_t->dig_upcheck_initial_value; + + if (cur_ig_value < max_cover_bond - 6) + p_dig_t->dig_go_up_check_level = DIG_GOUPCHECK_LEVEL_0; + else if (cur_ig_value <= DIG_MAX_BALANCE_MODE) + p_dig_t->dig_go_up_check_level = DIG_GOUPCHECK_LEVEL_1; + else /* cur_ig_value > DM_DIG_MAX_AP, foolproof */ + p_dig_t->dig_go_up_check_level = DIG_GOUPCHECK_LEVEL_2; + + + PHYDM_DBG(p_dm, DBG_DIG, ("check_lv = %d, max_cover_bond = 0x%x\n", + p_dig_t->dig_go_up_check_level, + max_cover_bond)); + + if (total_nhm_cnt != 0) { + if (p_dig_t->dig_go_up_check_level == DIG_GOUPCHECK_LEVEL_0) { + for (i = 3; i<=11; i++) + dig_cover_cnt += ccx_info->nhm_result[i]; + ret = ((p_dig_t->dig_level0_ratio_reciprocal * dig_cover_cnt) >= total_nhm_cnt) ? true : false; + } else if (p_dig_t->dig_go_up_check_level == DIG_GOUPCHECK_LEVEL_1) { + + /* search index */ + for (i = 0; i<=10; i++) { + if ((max_cover_bond * 2) == ccx_info->nhm_th[i]) { + for(j =(i+1); j <= 11; j++) + over_dig_cover_cnt += ccx_info->nhm_result[j]; + break; + } + } + ret = (p_dig_t->dig_level1_ratio_reciprocal * over_dig_cover_cnt < total_nhm_cnt) ? true : false; + + if (!ret) { + /* update p_dig_t->rx_gain_range_max */ + p_dig_t->rx_gain_range_max = (rx_gain_range_max >= max_cover_bond - 6) ? (max_cover_bond - 6) : rx_gain_range_max; + + PHYDM_DBG(p_dm, DBG_DIG, + ("Noise pwr over DIG can filter, lock rx_gain_range_max to 0x%x\n", + p_dig_t->rx_gain_range_max)); + } + } else if (p_dig_t->dig_go_up_check_level == DIG_GOUPCHECK_LEVEL_2) { + /* cur_ig_value > DM_DIG_MAX_AP, foolproof */ + ret = true; + } + } else + ret = true; + + return ret; +} + +void +odm_fa_threshold_check( + void *p_dm_void, + boolean is_dfs_band, + boolean is_performance +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + + if (p_dig_t->is_dbg_fa_th == true) + return; + + if (p_dm->is_linked && (is_performance || is_dfs_band)) { + if ((p_dm->rx_tp >> 2) > p_dm->tx_tp && p_dm->rx_tp < 10 && p_dm->rx_tp > 1) { /*10Mbps & 1Mbps*/ + p_dig_t->fa_th[0] = 125; + p_dig_t->fa_th[1] = 250; + p_dig_t->fa_th[2] = 500; + } else { + p_dig_t->fa_th[0] = 250; + p_dig_t->fa_th[1] = 500; + p_dig_t->fa_th[2] = 750; + } + } else { + + if (is_dfs_band) { /* For DFS band and no link */ + + p_dig_t->fa_th[0] = 250; + p_dig_t->fa_th[1] = 1000; + p_dig_t->fa_th[2] = 2000; + } else { + p_dig_t->fa_th[0] = 2000; + p_dig_t->fa_th[1] = 4000; + p_dig_t->fa_th[2] = 5000; + } + } + + PHYDM_DBG(p_dm, DBG_DIG, + ("FA_th={%d,%d,%d}\n", + p_dig_t->fa_th[0], + p_dig_t->fa_th[1], + p_dig_t->fa_th[2])); + +} + +void +phydm_set_big_jump_step( + void *p_dm_void, + u8 current_igi +) +{ +#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u8 step1[8] = {24, 30, 40, 50, 60, 70, 80, 90}; + u8 i; + + if (p_dig_t->enable_adjust_big_jump == 0) + return; + + for (i = 0; i <= p_dig_t->big_jump_step1; i++) { + if ((current_igi + step1[i]) > p_dig_t->big_jump_lmt[p_dig_t->agc_table_idx]) { + if (i != 0) + i = i - 1; + break; + } else if (i == p_dig_t->big_jump_step1) + break; + } + if (p_dm->support_ic_type & ODM_RTL8822B) + odm_set_bb_reg(p_dm, 0x8c8, 0xe, i); + else if (p_dm->support_ic_type & ODM_RTL8197F) + odm_set_bb_reg(p_dm, ODM_REG_BB_AGC_SET_2_11N, 0xe, i); + + PHYDM_DBG(p_dm, DBG_DIG, + ("phydm_set_big_jump_step(): bigjump = %d (ori = 0x%x), LMT=0x%x\n", + i, p_dig_t->big_jump_step1, p_dig_t->big_jump_lmt[p_dig_t->agc_table_idx])); +#endif +} + +void +odm_write_dig( + void *p_dm_void, + u8 current_igi +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct phydm_adaptivity_struct *p_adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + + PHYDM_DBG(p_dm, DBG_DIG, ("odm_write_dig===>\n")); + + /* 1 Check IGI by upper bound */ + if (p_adaptivity->igi_lmt_en && + (current_igi > p_adaptivity->adapt_igi_up) && p_dm->is_linked) { + + current_igi = p_adaptivity->adapt_igi_up; + + PHYDM_DBG(p_dm, DBG_DIG, + ("Force to Adaptivity Upper bound=((0x%x))\n", current_igi)); + } + + if (p_dig_t->cur_ig_value != current_igi) { + + #if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) + /* Modify big jump step for 8822B and 8197F */ + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) + phydm_set_big_jump_step(p_dm, current_igi); + #endif + + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + /* Set IGI value of CCK for new CCK AGC */ + if (p_dm->cck_new_agc && (p_dm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE)) + odm_set_bb_reg(p_dm, 0xa0c, 0x3f00, (current_igi >> 1)); + #endif + + /*Add by YuChen for USB IO too slow issue*/ + if (p_dm->support_ic_type & + (ODM_IC_11AC_GAIN_IDX_EDCCA | ODM_IC_11N_GAIN_IDX_EDCCA)) { + if ((p_dm->support_ability & ODM_BB_ADAPTIVITY) && + (current_igi < p_dig_t->cur_ig_value)) { + p_dig_t->cur_ig_value = current_igi; + phydm_adaptivity(p_dm); + } + } else { + if ((p_dm->support_ability & ODM_BB_ADAPTIVITY) && + (current_igi > p_dig_t->cur_ig_value)) { + p_dig_t->cur_ig_value = current_igi; + phydm_adaptivity(p_dm); + } + } + + /* Set IGI value */ + odm_set_bb_reg(p_dm, ODM_REG(IGI_A, p_dm), ODM_BIT(IGI, p_dm), current_igi); + + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + if (p_dm->support_ic_type & PHYDM_IC_ABOVE_2SS) + odm_set_bb_reg(p_dm, ODM_REG(IGI_B, p_dm), ODM_BIT(IGI, p_dm), current_igi); + #endif + + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + if (p_dm->support_ic_type & PHYDM_IC_ABOVE_4SS) { + odm_set_bb_reg(p_dm, ODM_REG(IGI_C, p_dm), ODM_BIT(IGI, p_dm), current_igi); + odm_set_bb_reg(p_dm, ODM_REG(IGI_D, p_dm), ODM_BIT(IGI, p_dm), current_igi); + } + #endif + + p_dig_t->cur_ig_value = current_igi; + } + + PHYDM_DBG(p_dm, DBG_DIG, ("New_igi=((0x%x))\n\n", current_igi)); +} + +void +phydm_set_dig_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (val_len != 1) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("[Error][DIG]Need val_len=1\n")); + return; + } + + odm_write_dig(p_dm, (u8)(*val_buf)); +} + +void +odm_pause_dig( + void *p_dm_void, + enum phydm_pause_type pause_type, + enum phydm_pause_level pause_level, + u8 igi_value +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u8 i = 0; + s8 max_level; + + PHYDM_DBG(p_dm, DBG_DIG, ("%s ======>\n", __func__)); + + if ((p_dig_t->pause_lv_bitmap == 0) && + (!(p_dm->support_ability & (ODM_BB_DIG | ODM_BB_FA_CNT)))) { + + PHYDM_DBG(p_dm, DBG_DIG, ("Return: DIG or FA is disabled\n")); + return; + } + + if (pause_level >= PHYDM_PAUSE_MAX_NUM) { + PHYDM_DBG(p_dm, DBG_DIG, ("Return: Wrong Lv\n")); + return; + } + + PHYDM_DBG(p_dm, DBG_DIG, ("Set pause {type, lv, IGI}={%d, %d, 0x%x}\n", + pause_type, pause_level, igi_value)); + + for (i = 0; i < PHYDM_PAUSE_MAX_NUM; i ++) { + PHYDM_DBG(p_dm, DBG_DIG, ("pause val[%d]=0x%x\n", + i, p_dig_t->pause_dig_value[i])); + } + + switch (pause_type) { + + case PHYDM_PAUSE: + { + PHYDM_DBG(p_dm, DBG_DIG, ("Pause DIG\n")); + + p_dm->support_ability &= ~ODM_BB_DIG; + + if (p_dig_t->pause_lv_bitmap == 0) { + p_dig_t->igi_backup = p_dig_t->cur_ig_value; /* Backup IGI value */ + PHYDM_DBG(p_dm, DBG_DIG, ("Backup IGI=0x%x\n", + p_dig_t->igi_backup)); + } + + p_dig_t->pause_dig_value[pause_level] = igi_value; /* Record IGI value */ + p_dig_t->pause_lv_bitmap |= BIT(pause_level); /* Update pause level bit-map*/ + + if (BIT(pause_level + 1) > p_dig_t->pause_lv_bitmap) { + PHYDM_DBG(p_dm, DBG_DIG, ("[SUCCESS ]Pause DIG\n")); + odm_write_dig(p_dm, igi_value); + } else { + PHYDM_DBG(p_dm, DBG_DIG, + ("[FAIL] Pause DIG, pause_bitmap=0x%x\n", p_dig_t->pause_lv_bitmap)); + } + break; + } + + case PHYDM_RESUME: + { + PHYDM_DBG(p_dm, DBG_DIG, ("Resume DIG\n")); + + /* check if the level is illegal or not */ + if ((p_dig_t->pause_lv_bitmap & (BIT(pause_level))) != 0) { + + p_dig_t->pause_lv_bitmap &= ~(BIT(pause_level)); + p_dig_t->pause_dig_value[pause_level] = 0; + } else { + + PHYDM_DBG(p_dm, DBG_DIG, ("Wrong resume Lv\n")); + break; + } + + PHYDM_DBG(p_dm, DBG_DIG, ("Pause_bitmap =0x%x\n", + p_dig_t->pause_lv_bitmap)); + + /* Resume DIG */ + if (p_dig_t->pause_lv_bitmap == 0) { + + PHYDM_DBG(p_dm, DBG_DIG, ("Revert ori_IGI\n")); + odm_write_dig(p_dm, p_dig_t->igi_backup); /* Revert IGI*/ + p_dig_t->is_ignore_dig = true; + p_dm->support_ability |= ODM_BB_DIG;/* Enable DIG */ + break; + } + + if (BIT(pause_level) > p_dig_t->pause_lv_bitmap) { + + /* Calculate the maximum level now */ + for (max_level = (pause_level - 1); max_level >= 0; max_level--) { + if (p_dig_t->pause_lv_bitmap & BIT(max_level)) + break; + } + + /* write IGI to lower level */ + PHYDM_DBG(p_dm, DBG_DIG, ("Pause @ IGI{Lv=0x%x}=%d)\n", + max_level, p_dig_t->pause_dig_value[max_level])); + + odm_write_dig(p_dm, p_dig_t->pause_dig_value[max_level]); + + break; + } + break; + } + default: + PHYDM_DBG(p_dm, DBG_DIG, ("Wrong pause type\n")); + break; + } + + PHYDM_DBG(p_dm, DBG_DIG, ("New pause bitmap = 0x%x\n", + p_dig_t->pause_lv_bitmap)); + + for (i = 0; i < PHYDM_PAUSE_MAX_NUM; i ++) { + PHYDM_DBG(p_dm, DBG_DIG, ("pause val[%d]=0x%x\n", + i, p_dig_t->pause_dig_value[i])); + } + +} + +boolean +odm_dig_abort( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *p_adapter = p_dm->adapter; +#endif + + /* support_ability */ + if ((!(p_dm->support_ability & ODM_BB_FA_CNT)) || + (!(p_dm->support_ability & ODM_BB_DIG)) || + (*(p_dm->p_is_scan_in_process))) { + PHYDM_DBG(p_dm, DBG_DIG, ("Not Support\n")); + return true; + } + + if (p_dm->pause_ability & ODM_BB_DIG) { + + PHYDM_DBG(p_dm, DBG_DIG, ("Return: Pause DIG in LV=%d\n", p_dm->pause_lv_table.lv_dig)); + return true; + } + + if (p_dig_t->is_ignore_dig) { + p_dig_t->is_ignore_dig = false; + PHYDM_DBG(p_dm, DBG_DIG, ("Return: Ignore DIG\n")); + return true; + } + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if OS_WIN_FROM_WIN7(OS_VERSION) + if (IsAPModeExist(p_adapter) && p_adapter->bInHctTest) { + PHYDM_DBG(p_dm, DBG_DIG, (" Return: Is AP mode or In HCT Test\n")); + return true; + } +#endif +#endif + + return false; +} + +void +phydm_dig_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct phydm_fa_struct *false_alm_cnt = (struct phydm_fa_struct *)phydm_get_structure(p_dm, PHYDM_FALSEALMCNT); +#endif + u32 ret_value = 0; + u8 i; + + p_dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + p_dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; + p_dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + + p_dig_t->is_ignore_dig = false; + p_dig_t->cur_ig_value = (u8) odm_get_bb_reg(p_dm, ODM_REG(IGI_A, p_dm), ODM_BIT(IGI, p_dm)); + p_dig_t->is_media_connect = false; + + p_dig_t->fa_th[0] = 250; + p_dig_t->fa_th[1] = 500; + p_dig_t->fa_th[2] = 750; + p_dig_t->is_dbg_fa_th = false; +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + /* For RTL8881A */ + false_alm_cnt->cnt_ofdm_fail_pre = 0; +#endif + + odm_memory_set(p_dm, p_dig_t->pause_dig_value, 0, PHYDM_PAUSE_MAX_NUM); + p_dig_t->pause_lv_bitmap = 0; + + p_dig_t->rx_gain_range_max = DIG_MAX_BALANCE_MODE; + p_dig_t->rx_gain_range_min = p_dig_t->cur_ig_value; + +#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) + p_dig_t->enable_adjust_big_jump = 1; + if (p_dm->support_ic_type & ODM_RTL8822B) + ret_value = odm_get_bb_reg(p_dm, 0x8c8, MASKLWORD); + else if (p_dm->support_ic_type & ODM_RTL8197F) + ret_value = odm_get_bb_reg(p_dm, 0xc74, MASKLWORD); + + p_dig_t->big_jump_step1 = (u8)(ret_value & 0xe) >> 1; + p_dig_t->big_jump_step2 = (u8)(ret_value & 0x30) >> 4; + p_dig_t->big_jump_step3 = (u8)(ret_value & 0xc0) >> 6; + + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8197F)) { + for (i = 0; i < sizeof(p_dig_t->big_jump_lmt); i++) { + if (p_dig_t->big_jump_lmt[i] == 0) + p_dig_t->big_jump_lmt[i] = 0x64; /* Set -10dBm as default value */ + } + } +#endif + + p_dm->pre_rssi_min = 0; + +#ifdef PHYDM_TDMA_DIG_SUPPORT + p_dm->original_dig_restore = 1; +#endif +} + +boolean +phydm_dig_performance_mode_decision( + struct PHY_DM_STRUCT *p_dm +) +{ + boolean is_performance = true; + +#ifdef PHYDM_DIG_MODE_DECISION_SUPPORT + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + + switch (p_dig_t->dig_mode_decision) { + case PHYDM_DIG_PERFORAMNCE_MODE: + is_performance = true; + break; + case PHYDM_DIG_COVERAGE_MODE: + is_performance = false; + break; + default: + is_performance = true; + break; + } +#endif + + return is_performance; +} + +void +phydm_dig_abs_boundary_decision( + struct PHY_DM_STRUCT *p_dm, + boolean is_performance, + boolean is_dfs_band +) +{ + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + + if (!p_dm->is_linked) { + p_dig_t->dm_dig_max = DIG_MAX_COVERAGR; + p_dig_t->dm_dig_min = DIG_MIN_COVERAGE; + } else if (is_dfs_band == true) { + if (*p_dm->p_band_width == CHANNEL_WIDTH_20) + p_dig_t->dm_dig_min = DIG_MIN_DFS + 2; + else + p_dig_t->dm_dig_min = DIG_MIN_DFS; + + p_dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + p_dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + + } else if (!is_performance) { + p_dig_t->dm_dig_max = DIG_MAX_COVERAGR; + p_dig_t->dm_dig_min = DIG_MIN_COVERAGE; + #if (DIG_HW == 1) + p_dig_t->dig_max_of_min = DIG_MIN_COVERAGE; + #else + p_dig_t->dig_max_of_min = DIG_MAX_OF_MIN_COVERAGE; + #endif + } else { + if (*p_dm->p_bb_op_mode == PHYDM_BALANCE_MODE) { /*service > 2 devices*/ + p_dig_t->dm_dig_max = DIG_MAX_BALANCE_MODE; + #if (DIG_HW == 1) + p_dig_t->dig_max_of_min = DIG_MIN_COVERAGE; + #else + p_dig_t->dig_max_of_min = DIG_MAX_OF_MIN_BALANCE_MODE; + #endif + } else if (*p_dm->p_bb_op_mode == PHYDM_PERFORMANCE_MODE) { /*service 1 devices*/ + p_dig_t->dm_dig_max = DIG_MAX_PERFORMANCE_MODE; + p_dig_t->dig_max_of_min = DIG_MAX_OF_MIN_PERFORMANCE_MODE; + } + + if (p_dm->support_ic_type & + (ODM_RTL8814A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8822B)) + p_dig_t->dm_dig_min = 0x1c; + else if (p_dm->support_ic_type & ODM_RTL8197F) + p_dig_t->dm_dig_min = 0x1e; /*For HW setting*/ + else + p_dig_t->dm_dig_min = DIG_MIN_PERFORMANCE; + } + + PHYDM_DBG(p_dm, DBG_DIG, + ("Abs-bound{Max, Min}={0x%x, 0x%x}, Max_of_min = 0x%x\n", + p_dig_t->dm_dig_max, + p_dig_t->dm_dig_min, + p_dig_t->dig_max_of_min)); + +} + +void +phydm_dig_dym_boundary_decision( + struct PHY_DM_STRUCT *p_dm, + boolean is_performance +) +{ + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u8 offset = 15, tmp_max = 0; + + PHYDM_DBG(p_dm, DBG_DIG, + ("Offset=((%d))\n", offset)); + + /* DIG lower bound */ + if (p_dm->rssi_min > p_dig_t->dig_max_of_min) + p_dig_t->rx_gain_range_min = p_dig_t->dig_max_of_min; + else if (p_dm->rssi_min < p_dig_t->dm_dig_min) + p_dig_t->rx_gain_range_min = p_dig_t->dm_dig_min; + else + p_dig_t->rx_gain_range_min = p_dm->rssi_min; + + /* DIG upper bound */ + tmp_max = p_dig_t->rx_gain_range_min + offset; + + if (tmp_max > p_dig_t->dm_dig_max) + p_dig_t->rx_gain_range_max = p_dig_t->dm_dig_max; + else + p_dig_t->rx_gain_range_max = tmp_max; + + /* 1 Force Lower Bound for AntDiv */ + if (!p_dm->is_one_entry_only) { + if ((p_dm->support_ic_type & ODM_ANTDIV_SUPPORT) && (p_dm->support_ability & ODM_BB_ANT_DIV)) { + if (p_dm->ant_div_type == CG_TRX_HW_ANTDIV || p_dm->ant_div_type == CG_TRX_SMART_ANTDIV) { + if (p_dig_t->ant_div_rssi_max > p_dig_t->dig_max_of_min) + p_dig_t->rx_gain_range_min = p_dig_t->dig_max_of_min; + else + p_dig_t->rx_gain_range_min = (u8)p_dig_t->ant_div_rssi_max; + + PHYDM_DBG(p_dm, DBG_DIG, + ("AntDiv: Force Dyn-Min = 0x%x, RSSI_max = 0x%x\n", + p_dig_t->rx_gain_range_min, p_dig_t->ant_div_rssi_max)); + } + } + } + PHYDM_DBG(p_dm, DBG_DIG, + ("Dym-bound{Max, Min}={0x%x, 0x%x}\n", + p_dig_t->rx_gain_range_max, p_dig_t->rx_gain_range_min)); +} + +void +phydm_dig_abnormal_case( + struct PHY_DM_STRUCT *p_dm, + u8 current_igi, + boolean is_performance, + boolean is_dfs_band +) +{ + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + boolean first_connect = false, first_dis_connect = false; + + first_connect = (p_dm->is_linked) && (p_dig_t->is_media_connect == false); + first_dis_connect = (!p_dm->is_linked) && (p_dig_t->is_media_connect == true); + + /* Modify DIG lower bound, deal with abnormal case */ + if (!p_dm->is_linked && is_dfs_band && is_performance) { + p_dig_t->rx_gain_range_max = DIG_MAX_DFS; + PHYDM_DBG(p_dm, DBG_DIG, + ("DFS band: Force max to 0x%x before link\n", p_dig_t->rx_gain_range_max)); + } + + if (is_dfs_band) + p_dig_t->rx_gain_range_min = p_dig_t->dm_dig_min; + + /* Abnormal lower bound case */ + if (p_dig_t->rx_gain_range_min > p_dig_t->rx_gain_range_max) + p_dig_t->rx_gain_range_min = p_dig_t->rx_gain_range_max; + + PHYDM_DBG(p_dm, DBG_DIG, + ("Abnoraml checked {Max, Min}={0x%x, 0x%x}\n", + p_dig_t->rx_gain_range_max, p_dig_t->rx_gain_range_min)); + +} + +u8 +phydm_dig_current_igi_by_fa_th( + struct PHY_DM_STRUCT *p_dm, + u8 current_igi, + u32 false_alm_cnt, + u8 *step_size +) +{ + boolean dig_go_up_check = true; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + + dig_go_up_check = phydm_dig_go_up_check(p_dm); + + if ((false_alm_cnt > p_dig_t->fa_th[2]) && dig_go_up_check) + current_igi = current_igi + step_size[0]; + else if ((false_alm_cnt > p_dig_t->fa_th[1]) && dig_go_up_check) + current_igi = current_igi + step_size[1]; + else if (false_alm_cnt < p_dig_t->fa_th[0]) + current_igi = current_igi - step_size[2]; + + return current_igi; + +} + +u8 +phydm_dig_igi_start_value( + struct PHY_DM_STRUCT *p_dm, + boolean is_performance, + u8 current_igi, + u32 false_alm_cnt, + boolean is_dfs_band +) +{ + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u8 step_size[3] = {0}; + boolean first_connect = false, first_dis_connect = false; + + first_connect = (p_dm->is_linked) && (p_dig_t->is_media_connect == false); + first_dis_connect = (!p_dm->is_linked) && (p_dig_t->is_media_connect == true); + + if (p_dm->is_linked) { + if (p_dm->pre_rssi_min <= p_dm->rssi_min) { + step_size[0] = 2; + step_size[1] = 1; + step_size[2] = 2; + } else { + step_size[0] = 4; + step_size[1] = 2; + step_size[2] = 2; + } + p_dm->pre_rssi_min = p_dm->rssi_min; + } else { + step_size[0] = 2; + step_size[1] = 1; + step_size[2] = 2; + } + + PHYDM_DBG(p_dm, DBG_DIG, + ("step_size = {-%d, +%d, +%d}\n", step_size[2], step_size[1], step_size[0])); + + PHYDM_DBG(p_dm, DBG_DIG, + ("rssi_min = %d, pre_rssi_min = %d\n", p_dm->rssi_min, p_dm->pre_rssi_min)); + + if (p_dm->is_linked && is_performance) { + /* 2 After link */ + PHYDM_DBG(p_dm, DBG_DIG, ("Adjust IGI after link\n")); + + if (first_connect && is_performance) { + + if (is_dfs_band) { + if (p_dm->rssi_min > DIG_MAX_DFS) + current_igi = DIG_MAX_DFS; + else + current_igi = p_dm->rssi_min; + PHYDM_DBG(p_dm, DBG_DIG, + ("DFS band: one shot IGI to 0x%x most\n", p_dig_t->rx_gain_range_max)); + } else + current_igi = p_dig_t->rx_gain_range_min; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) + odm_config_bb_with_header_file(p_dm, CONFIG_BB_AGC_TAB_DIFF); +#endif +#endif + PHYDM_DBG(p_dm, DBG_DIG, + ("First connect case: IGI does on-shot to 0x%x\n", current_igi)); + } else { + + /* 4 Abnormal # beacon case */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + if ((p_dm->phy_dbg_info.num_qry_beacon_pkt < 5) && + (false_alm_cnt < DM_DIG_FA_TH1) && (p_dm->bsta_state)) { + if (p_dm->support_ic_type != ODM_RTL8723D) { + p_dig_t->rx_gain_range_min = 0x1c; + current_igi = p_dig_t->rx_gain_range_min; + PHYDM_DBG(p_dm, DBG_DIG, + ("Abnormal #beacon (%d) case: IGI does one-shot to 0x%x\n", + p_dm->phy_dbg_info.num_qry_beacon_pkt, current_igi)); + } + } else +#endif + current_igi = phydm_dig_current_igi_by_fa_th(p_dm, + current_igi, false_alm_cnt, step_size); + } + } else { + /* 2 Before link */ + PHYDM_DBG(p_dm, DBG_DIG, ("Adjust IGI before link\n")); + + if (first_dis_connect) { + current_igi = p_dig_t->dm_dig_min; + PHYDM_DBG(p_dm, DBG_DIG, ("First disconnect case: IGI does on-shot to lower bound\n")); + } else { + PHYDM_DBG(p_dm, DBG_DIG, + ("Pre_IGI=((0x%x)), FA=((%d))\n", current_igi, false_alm_cnt)); + + current_igi = phydm_dig_current_igi_by_fa_th(p_dm, + current_igi, false_alm_cnt, step_size); + } + } + + return current_igi; + +} + +void +phydm_dig( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct phydm_fa_struct *p_falm_cnt = &p_dm->false_alm_cnt; +#ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_fa_acc_struct *p_falm_cnt_acc = &p_dm->false_alm_cnt_acc; +#endif + boolean first_connect, first_dis_connect; + u8 current_igi = p_dig_t->cur_ig_value; + u32 false_alm_cnt= p_falm_cnt->cnt_all; + boolean is_dfs_band = false, is_performance = true; + +#ifdef PHYDM_TDMA_DIG_SUPPORT + if (p_dm->original_dig_restore == 0) { + if (p_dig_t->cur_ig_value_tdma == 0) + p_dig_t->cur_ig_value_tdma = p_dig_t->cur_ig_value; + + current_igi = p_dig_t->cur_ig_value_tdma; + false_alm_cnt = p_falm_cnt_acc->cnt_all_1sec; + } +#endif + + if (odm_dig_abort(p_dm) == true) + return; + + PHYDM_DBG(p_dm, DBG_DIG, ("%s Start===>\n", __func__)); + + /* 1 Update status */ + first_connect = (p_dm->is_linked) && (p_dig_t->is_media_connect == false); + first_dis_connect = (!p_dm->is_linked) && (p_dig_t->is_media_connect == true); + + PHYDM_DBG(p_dm, DBG_DIG, + ("is_linked = %d, RSSI = %d, 1stConnect = %d, 1stDisconnect = %d\n", + p_dm->is_linked, p_dm->rssi_min, first_connect, first_dis_connect)); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP | ODM_CE)) + /* Modify lower bound for DFS band */ + if (p_dm->is_dfs_band) { + #if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + if (phydm_dfs_master_enabled(p_dm)) + #endif + is_dfs_band = true; + + PHYDM_DBG(p_dm, DBG_DIG, ("In DFS band\n")); + } +#endif + + is_performance = phydm_dig_performance_mode_decision(p_dm); + PHYDM_DBG(p_dm, DBG_DIG, + ("DIG ((%s)) mode\n", (is_performance ? "Performance" : "Coverage"))); + + /* Boundary Decision */ + phydm_dig_abs_boundary_decision(p_dm, is_performance, is_dfs_band); + + /*init dym boundary*/ + p_dig_t->rx_gain_range_max = p_dig_t->dig_max_of_min; /*if no link, always stay at lower bound*/ + p_dig_t->rx_gain_range_min = p_dig_t->dm_dig_min; + + /* Adjust boundary by RSSI */ + if (p_dm->is_linked) + phydm_dig_dym_boundary_decision(p_dm, is_performance); + + /*Abnormal case check*/ + phydm_dig_abnormal_case(p_dm, current_igi, is_performance, is_dfs_band); + + /* False alarm threshold decision */ + odm_fa_threshold_check(p_dm, is_dfs_band, is_performance); + + /* 1 Adjust initial gain by false alarm */ + current_igi = phydm_dig_igi_start_value(p_dm, + is_performance, current_igi, false_alm_cnt, is_dfs_band); + + /* 1 Check initial gain by upper/lower bound */ + if (current_igi < p_dig_t->rx_gain_range_min) + current_igi = p_dig_t->rx_gain_range_min; + + if (current_igi > p_dig_t->rx_gain_range_max) + current_igi = p_dig_t->rx_gain_range_max; + + PHYDM_DBG(p_dm, DBG_DIG, ("New_IGI=((0x%x))\n", current_igi)); + + /* 1 Update status */ +#ifdef PHYDM_TDMA_DIG_SUPPORT + if (p_dm->original_dig_restore == 0) { + + p_dig_t->cur_ig_value_tdma = current_igi; + /*It is possible fa_acc_1sec_tsf >= */ + /*1sec while tdma_dig_state == 0*/ + if (p_dig_t->tdma_dig_state != 0) + odm_write_dig(p_dm, p_dig_t->cur_ig_value_tdma); + } else +#endif + odm_write_dig(p_dm, current_igi); + + p_dig_t->is_media_connect = p_dm->is_linked; + + PHYDM_DBG(p_dm, DBG_DIG, ("DIG end\n")); +} + +void +phydm_dig_lps_32k( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 current_igi = p_dm->rssi_min; + + + odm_write_dig(p_dm, current_igi); +} + +void +phydm_dig_by_rssi_lps( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_struct *p_falm_cnt; + + u8 rssi_lower = DIG_MIN_LPS; /* 0x1E or 0x1C */ + u8 current_igi = p_dm->rssi_min; + + p_falm_cnt = &p_dm->false_alm_cnt; + if (odm_dig_abort(p_dm) == true) + return; + + current_igi = current_igi + RSSI_OFFSET_DIG_LPS; + PHYDM_DBG(p_dm, DBG_DIG, ("%s==>\n", __func__)); + + /* Using FW PS mode to make IGI */ + /* Adjust by FA in LPS MODE */ + if (p_falm_cnt->cnt_all > DM_DIG_FA_TH2_LPS) + current_igi = current_igi + 4; + else if (p_falm_cnt->cnt_all > DM_DIG_FA_TH1_LPS) + current_igi = current_igi + 2; + else if (p_falm_cnt->cnt_all < DM_DIG_FA_TH0_LPS) + current_igi = current_igi - 2; + + + /* Lower bound checking */ + + /* RSSI Lower bound check */ + if ((p_dm->rssi_min - 10) > DIG_MIN_LPS) + rssi_lower = (p_dm->rssi_min - 10); + else + rssi_lower = DIG_MIN_LPS; + + /* Upper and Lower Bound checking */ + if (current_igi > DIG_MAX_LPS) + current_igi = DIG_MAX_LPS; + else if (current_igi < rssi_lower) + current_igi = rssi_lower; + + PHYDM_DBG(p_dm, DBG_DIG, + ("%s p_falm_cnt->cnt_all = %d\n", __func__, + p_falm_cnt->cnt_all)); + PHYDM_DBG(p_dm, DBG_DIG, + ("%s p_dm->rssi_min = %d\n", __func__, + p_dm->rssi_min)); + PHYDM_DBG(p_dm, DBG_DIG, + ("%s current_igi = 0x%x\n", __func__, + current_igi)); + + /* odm_write_dig(p_dm, p_dig_t->cur_ig_value); */ + odm_write_dig(p_dm, current_igi); +#endif +} + +/* 3============================================================ + * 3 FASLE ALARM CHECK + * 3============================================================ */ +void +phydm_false_alarm_counter_reg_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct phydm_fa_struct *p_falm_cnt = &p_dm->false_alm_cnt; +#ifdef PHYDM_TDMA_DIG_SUPPORT + struct phydm_fa_acc_struct *p_falm_cnt_acc = &p_dm->false_alm_cnt_acc; +#endif + u32 false_alm_cnt; + +#ifdef PHYDM_TDMA_DIG_SUPPORT + if (p_dm->original_dig_restore == 0) { + + if (p_dig_t->cur_ig_value_tdma == 0) + p_dig_t->cur_ig_value_tdma = p_dig_t->cur_ig_value; + + false_alm_cnt = p_falm_cnt_acc->cnt_all_1sec; + } else +#endif + { + false_alm_cnt = p_falm_cnt->cnt_all; + } + +#if (ODM_IC_11N_SERIES_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + /*reset false alarm counter registers*/ + odm_set_bb_reg(p_dm, 0xC0C, BIT(31), 1); + odm_set_bb_reg(p_dm, 0xC0C, BIT(31), 0); + odm_set_bb_reg(p_dm, 0xD00, BIT(27), 1); + odm_set_bb_reg(p_dm, 0xD00, BIT(27), 0); + + /*update ofdm counter*/ + /*update page C counter*/ + odm_set_bb_reg(p_dm, 0xD00, BIT(31), 0); + /*update page D counter*/ + odm_set_bb_reg(p_dm, 0xD00, BIT(31), 0); + + /*reset CCK CCA counter*/ + odm_set_bb_reg(p_dm, 0xA2C, BIT(13) | BIT(12), 0); + odm_set_bb_reg(p_dm, 0xA2C, BIT(13) | BIT(12), 2); + + /*reset CCK FA counter*/ + odm_set_bb_reg(p_dm, 0xA2C, BIT(15) | BIT(14), 0); + odm_set_bb_reg(p_dm, 0xA2C, BIT(15) | BIT(14), 2); + + /*reset CRC32 counter*/ + odm_set_bb_reg(p_dm, 0xF14, BIT(16), 1); + odm_set_bb_reg(p_dm, 0xF14, BIT(16), 0); + } +#endif /* #if (ODM_IC_11N_SERIES_SUPPORT == 1) */ + +#if (ODM_IC_11AC_SERIES_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + #if (RTL8881A_SUPPORT == 1) + /* Reset FA counter by enable/disable OFDM */ + if (false_alm_cnt->cnt_ofdm_fail_pre >= 0x7fff) { + /* reset OFDM */ + odm_set_bb_reg(p_dm, 0x808, BIT(29), 0); + odm_set_bb_reg(p_dm, 0x808, BIT(29), 1); + false_alm_cnt->cnt_ofdm_fail_pre = 0; + PHYDM_DBG(p_dm, DBG_FA_CNT, ("Reset FA_cnt\n")); + } + #endif /* #if (RTL8881A_SUPPORT == 1) */ + /* reset OFDM FA countner */ + odm_set_bb_reg(p_dm, 0x9A4, BIT(17), 1); + odm_set_bb_reg(p_dm, 0x9A4, BIT(17), 0); + + /* reset CCK FA counter */ + odm_set_bb_reg(p_dm, 0xA2C, BIT(15), 0); + odm_set_bb_reg(p_dm, 0xA2C, BIT(15), 1); + + /* reset CCA counter */ + odm_set_bb_reg(p_dm, 0xB58, BIT(0), 1); + odm_set_bb_reg(p_dm, 0xB58, BIT(0), 0); + } +#endif /* #if (ODM_IC_11AC_SERIES_SUPPORT == 1) */ +} + +void +phydm_false_alarm_counter_reg_hold( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + /*hold ofdm counter*/ + /*hold page C counter*/ + odm_set_bb_reg(p_dm, 0xC00, BIT(31), 1); + /*hold page D counter*/ + odm_set_bb_reg(p_dm, 0xD00, BIT(31), 1); + + //hold cck counter + odm_set_bb_reg(p_dm, 0xA2C, BIT(12), 1); + odm_set_bb_reg(p_dm, 0xA2C, BIT(14), 1); + } +} + +void +odm_false_alarm_counter_statistics( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_struct *false_alm_cnt = (struct phydm_fa_struct *)phydm_get_structure(p_dm, PHYDM_FALSEALMCNT); + struct phydm_adaptivity_struct *adaptivity = (struct phydm_adaptivity_struct *)phydm_get_structure(p_dm, PHYDM_ADAPTIVITY); + u32 ret_value; + + if (!(p_dm->support_ability & ODM_BB_FA_CNT)) + return; + + PHYDM_DBG(p_dm, DBG_FA_CNT, ("FA_Counter()======>\n")); + +#if (ODM_IC_11N_SERIES_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + /* hold ofdm & cck counter */ + phydm_false_alarm_counter_reg_hold(p_dm); + + ret_value = odm_get_bb_reg(p_dm, ODM_REG_OFDM_FA_TYPE1_11N, MASKDWORD); + false_alm_cnt->cnt_fast_fsync = (ret_value & 0xffff); + false_alm_cnt->cnt_sb_search_fail = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(p_dm, ODM_REG_OFDM_FA_TYPE2_11N, MASKDWORD); + false_alm_cnt->cnt_ofdm_cca = (ret_value & 0xffff); + false_alm_cnt->cnt_parity_fail = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(p_dm, ODM_REG_OFDM_FA_TYPE3_11N, MASKDWORD); + false_alm_cnt->cnt_rate_illegal = (ret_value & 0xffff); + false_alm_cnt->cnt_crc8_fail = ((ret_value & 0xffff0000) >> 16); + + ret_value = odm_get_bb_reg(p_dm, ODM_REG_OFDM_FA_TYPE4_11N, MASKDWORD); + false_alm_cnt->cnt_mcs_fail = (ret_value & 0xffff); + + false_alm_cnt->cnt_ofdm_fail = + false_alm_cnt->cnt_parity_fail + false_alm_cnt->cnt_rate_illegal + + false_alm_cnt->cnt_crc8_fail + false_alm_cnt->cnt_mcs_fail + + false_alm_cnt->cnt_fast_fsync + false_alm_cnt->cnt_sb_search_fail; + + /* read CCK CRC32 counter */ + false_alm_cnt->cnt_cck_crc32_error = odm_get_bb_reg(p_dm, ODM_REG_CCK_CRC32_ERROR_CNT_11N, MASKDWORD); + false_alm_cnt->cnt_cck_crc32_ok = odm_get_bb_reg(p_dm, ODM_REG_CCK_CRC32_OK_CNT_11N, MASKDWORD); + + /* read OFDM CRC32 counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_OFDM_CRC32_CNT_11N, MASKDWORD); + false_alm_cnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_ofdm_crc32_ok = ret_value & 0xffff; + + /* read HT CRC32 counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_HT_CRC32_CNT_11N, MASKDWORD); + false_alm_cnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_ht_crc32_ok = ret_value & 0xffff; + + /* read VHT CRC32 counter */ + false_alm_cnt->cnt_vht_crc32_error = 0; + false_alm_cnt->cnt_vht_crc32_ok = 0; + +#if (RTL8723D_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723D) { + /* read HT CRC32 agg counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_HT_CRC32_CNT_11N_AGG, MASKDWORD); + false_alm_cnt->cnt_ht_crc32_error_agg = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_ht_crc32_ok_agg= ret_value & 0xffff; + } +#endif + +#if (RTL8188E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) { + ret_value = odm_get_bb_reg(p_dm, ODM_REG_SC_CNT_11N, MASKDWORD); + false_alm_cnt->cnt_bw_lsc = (ret_value & 0xffff); + false_alm_cnt->cnt_bw_usc = ((ret_value & 0xffff0000) >> 16); + } +#endif + + { + ret_value = odm_get_bb_reg(p_dm, ODM_REG_CCK_FA_LSB_11N, MASKBYTE0); + false_alm_cnt->cnt_cck_fail = ret_value; + + ret_value = odm_get_bb_reg(p_dm, ODM_REG_CCK_FA_MSB_11N, MASKBYTE3); + false_alm_cnt->cnt_cck_fail += (ret_value & 0xff) << 8; + + ret_value = odm_get_bb_reg(p_dm, ODM_REG_CCK_CCA_CNT_11N, MASKDWORD); + false_alm_cnt->cnt_cck_cca = ((ret_value & 0xFF) << 8) | ((ret_value & 0xFF00) >> 8); + } + + false_alm_cnt->cnt_all_pre = false_alm_cnt->cnt_all; + + false_alm_cnt->cnt_all = (false_alm_cnt->cnt_fast_fsync + + false_alm_cnt->cnt_sb_search_fail + + false_alm_cnt->cnt_parity_fail + + false_alm_cnt->cnt_rate_illegal + + false_alm_cnt->cnt_crc8_fail + + false_alm_cnt->cnt_mcs_fail + + false_alm_cnt->cnt_cck_fail); + + false_alm_cnt->cnt_cca_all = false_alm_cnt->cnt_ofdm_cca + false_alm_cnt->cnt_cck_cca; + + PHYDM_DBG(p_dm, DBG_FA_CNT, + ("[OFDM FA Detail] Parity_Fail = (( %d )), Rate_Illegal = (( %d )), CRC8_fail = (( %d )), Mcs_fail = (( %d )), Fast_Fsync = (( %d )), SB_Search_fail = (( %d ))\n", + false_alm_cnt->cnt_parity_fail, false_alm_cnt->cnt_rate_illegal, false_alm_cnt->cnt_crc8_fail, false_alm_cnt->cnt_mcs_fail, false_alm_cnt->cnt_fast_fsync, false_alm_cnt->cnt_sb_search_fail)); + + } +#endif + +#if (ODM_IC_11AC_SERIES_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + u32 cck_enable; + + /* read OFDM FA counter */ + false_alm_cnt->cnt_ofdm_fail = odm_get_bb_reg(p_dm, ODM_REG_OFDM_FA_11AC, MASKLWORD); + + /* Read CCK FA counter */ + false_alm_cnt->cnt_cck_fail = odm_get_bb_reg(p_dm, ODM_REG_CCK_FA_11AC, MASKLWORD); + + /* read CCK/OFDM CCA counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_CCK_CCA_CNT_11AC, MASKDWORD); + false_alm_cnt->cnt_ofdm_cca = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_cck_cca = ret_value & 0xffff; + + /* read CCK CRC32 counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_CCK_CRC32_CNT_11AC, MASKDWORD); + false_alm_cnt->cnt_cck_crc32_error = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_cck_crc32_ok = ret_value & 0xffff; + + /* read OFDM CRC32 counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_OFDM_CRC32_CNT_11AC, MASKDWORD); + false_alm_cnt->cnt_ofdm_crc32_error = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_ofdm_crc32_ok = ret_value & 0xffff; + + /* read HT CRC32 counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_HT_CRC32_CNT_11AC, MASKDWORD); + false_alm_cnt->cnt_ht_crc32_error = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_ht_crc32_ok = ret_value & 0xffff; + + /* read VHT CRC32 counter */ + ret_value = odm_get_bb_reg(p_dm, ODM_REG_VHT_CRC32_CNT_11AC, MASKDWORD); + false_alm_cnt->cnt_vht_crc32_error = (ret_value & 0xffff0000) >> 16; + false_alm_cnt->cnt_vht_crc32_ok = ret_value & 0xffff; + +#if (RTL8881A_SUPPORT == 1) + /* For 8881A */ + if (p_dm->support_ic_type == ODM_RTL8881A) { + u32 cnt_ofdm_fail_temp = 0; + + if (false_alm_cnt->cnt_ofdm_fail >= false_alm_cnt->cnt_ofdm_fail_pre) { + cnt_ofdm_fail_temp = false_alm_cnt->cnt_ofdm_fail_pre; + false_alm_cnt->cnt_ofdm_fail_pre = false_alm_cnt->cnt_ofdm_fail; + false_alm_cnt->cnt_ofdm_fail = false_alm_cnt->cnt_ofdm_fail - cnt_ofdm_fail_temp; + } else + false_alm_cnt->cnt_ofdm_fail_pre = false_alm_cnt->cnt_ofdm_fail; + PHYDM_DBG(p_dm, DBG_FA_CNT, ("odm_false_alarm_counter_statistics(): cnt_ofdm_fail=%d\n", false_alm_cnt->cnt_ofdm_fail_pre)); + PHYDM_DBG(p_dm, DBG_FA_CNT, ("odm_false_alarm_counter_statistics(): cnt_ofdm_fail_pre=%d\n", cnt_ofdm_fail_temp)); + } +#endif + cck_enable = odm_get_bb_reg(p_dm, ODM_REG_BB_RX_PATH_11AC, BIT(28)); + if (cck_enable) { /* if(*p_dm->p_band_type == ODM_BAND_2_4G) */ + false_alm_cnt->cnt_all = false_alm_cnt->cnt_ofdm_fail + false_alm_cnt->cnt_cck_fail; + false_alm_cnt->cnt_cca_all = false_alm_cnt->cnt_cck_cca + false_alm_cnt->cnt_ofdm_cca; + } else { + false_alm_cnt->cnt_all = false_alm_cnt->cnt_ofdm_fail; + false_alm_cnt->cnt_cca_all = false_alm_cnt->cnt_ofdm_cca; + } + } +#endif + + if (p_dm->support_ic_type != ODM_RTL8723D) { + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_1, 0x0)) {/*set debug port to 0x0*/ + false_alm_cnt->dbg_port0 = phydm_get_bb_dbg_port_value(p_dm); + phydm_release_bb_dbg_port(p_dm); + } + + if (phydm_set_bb_dbg_port(p_dm, BB_DBGPORT_PRIORITY_1, adaptivity->adaptivity_dbg_port)) { + if (p_dm->support_ic_type & (ODM_RTL8723B | ODM_RTL8188E)) + false_alm_cnt->edcca_flag = (boolean)((phydm_get_bb_dbg_port_value(p_dm) & BIT(30)) >> 30); + else + false_alm_cnt->edcca_flag = (boolean)((phydm_get_bb_dbg_port_value(p_dm) & BIT(29)) >> 29); + phydm_release_bb_dbg_port(p_dm); + } + } else { + false_alm_cnt->edcca_flag = (boolean)(odm_get_bb_reg(p_dm, 0x9a0, BIT(29))); + } + + + phydm_false_alarm_counter_reg_reset(p_dm_void); + + false_alm_cnt->cnt_crc32_error_all = false_alm_cnt->cnt_vht_crc32_error + false_alm_cnt->cnt_ht_crc32_error + false_alm_cnt->cnt_ofdm_crc32_error + false_alm_cnt->cnt_cck_crc32_error; + false_alm_cnt->cnt_crc32_ok_all = false_alm_cnt->cnt_vht_crc32_ok + false_alm_cnt->cnt_ht_crc32_ok + false_alm_cnt->cnt_ofdm_crc32_ok + false_alm_cnt->cnt_cck_crc32_ok; + + PHYDM_DBG(p_dm, DBG_FA_CNT, ("[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + false_alm_cnt->cnt_cck_cca, false_alm_cnt->cnt_ofdm_cca, false_alm_cnt->cnt_cca_all)); + + PHYDM_DBG(p_dm, DBG_FA_CNT, ("[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + false_alm_cnt->cnt_cck_fail, false_alm_cnt->cnt_ofdm_fail, false_alm_cnt->cnt_all)); + + PHYDM_DBG(p_dm, DBG_FA_CNT, ("[CCK] CRC32 {error, ok}= {%d, %d}\n", false_alm_cnt->cnt_cck_crc32_error, false_alm_cnt->cnt_cck_crc32_ok)); + PHYDM_DBG(p_dm, DBG_FA_CNT, ("[OFDM]CRC32 {error, ok}= {%d, %d}\n", false_alm_cnt->cnt_ofdm_crc32_error, false_alm_cnt->cnt_ofdm_crc32_ok)); + PHYDM_DBG(p_dm, DBG_FA_CNT, ("[ HT ] CRC32 {error, ok}= {%d, %d}\n", false_alm_cnt->cnt_ht_crc32_error, false_alm_cnt->cnt_ht_crc32_ok)); + PHYDM_DBG(p_dm, DBG_FA_CNT, ("[VHT] CRC32 {error, ok}= {%d, %d}\n", false_alm_cnt->cnt_vht_crc32_error, false_alm_cnt->cnt_vht_crc32_ok)); + PHYDM_DBG(p_dm, DBG_FA_CNT, ("[VHT] CRC32 {error, ok}= {%d, %d}\n", false_alm_cnt->cnt_crc32_error_all, false_alm_cnt->cnt_crc32_ok_all)); + PHYDM_DBG(p_dm, DBG_FA_CNT, ("FA_Cnt: Dbg port 0x0 = 0x%x, EDCCA = %d\n\n", false_alm_cnt->dbg_port0, false_alm_cnt->edcca_flag)); +} + +#ifdef PHYDM_TDMA_DIG_SUPPORT +void +phydm_set_tdma_dig_timer( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 delta_time_us = p_dm->tdma_dig_timer_ms * 1000; + struct phydm_dig_struct *p_dig_t; + u32 timeout; + u32 current_time_stamp, diff_time_stamp, regb0; + + p_dig_t = &p_dm->dm_dig_table; + /*some IC has no FREERUN_CUNT register, like 92E*/ + if (p_dm->support_ic_type & ODM_RTL8197F) + current_time_stamp = odm_get_bb_reg(p_dm, 0x568, bMaskDWord); + else + return; + + timeout = current_time_stamp + delta_time_us; + + diff_time_stamp = current_time_stamp - p_dig_t->cur_timestamp; + p_dig_t->pre_timestamp = p_dig_t->cur_timestamp; + p_dig_t->cur_timestamp = current_time_stamp; + + /*HIMR0, it shows HW interrupt mask*/ + regb0 = odm_get_bb_reg(p_dm, 0xb0, bMaskDWord); + + PHYDM_DBG(p_dm, DBG_DIG, + ("Set next tdma_dig_timer\n")); + PHYDM_DBG(p_dm, DBG_DIG, + ("current_time_stamp=%d, delta_time_us=%d, timeout=%d, diff_time_stamp=%d, Reg0xb0 = 0x%x\n", + current_time_stamp, + delta_time_us, + timeout, + diff_time_stamp, + regb0)); + + if (p_dm->support_ic_type & ODM_RTL8197F) /*REG_PS_TIMER2*/ + odm_set_bb_reg(p_dm, 0x588, bMaskDWord, timeout); + else { + PHYDM_DBG(p_dm, DBG_DIG, + ("NOT 97F, TDMA-DIG timer does NOT start!\n")); + return; + } +} + +void +phydm_tdma_dig_timer_check( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t; + + p_dig_t = &p_dm->dm_dig_table; + + PHYDM_DBG(p_dm, DBG_DIG, + ("tdma_dig_cnt=%d, pre_tdma_dig_cnt=%d\n", + p_dig_t->tdma_dig_cnt, + p_dig_t->pre_tdma_dig_cnt)); + + if ((p_dig_t->tdma_dig_cnt == 0) || + (p_dig_t->tdma_dig_cnt == p_dig_t->pre_tdma_dig_cnt)) { + + if (p_dm->support_ability & ODM_BB_DIG) { + /*if interrupt mask info is got.*/ + /*Reg0xb0 is no longer needed*/ + /*regb0 = odm_get_bb_reg(p_dm, 0xb0, bMaskDWord);*/ + PHYDM_DBG(p_dm, DBG_DIG, + ("Check fail, IntMask[0]=0x%x, restart tdma_dig_timer !!!\n", + *p_dm->p_interrupt_mask)); + + phydm_tdma_dig_add_interrupt_mask_handler(p_dm); + phydm_enable_rx_related_interrupt_handler(p_dm); + phydm_set_tdma_dig_timer(p_dm); + } + } else + PHYDM_DBG(p_dm, DBG_DIG, + ("Check pass, update pre_tdma_dig_cnt\n")); + + p_dig_t->pre_tdma_dig_cnt = p_dig_t->tdma_dig_cnt; +} + +/*different IC/team may use different timer for tdma-dig*/ +void +phydm_tdma_dig_add_interrupt_mask_handler( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if (DM_ODM_SUPPORT_TYPE == (ODM_AP)) + if (p_dm->support_ic_type & ODM_RTL8197F) + phydm_add_interrupt_mask_handler(p_dm, HAL_INT_TYPE_PSTIMEOUT2); /*HAL_INT_TYPE_PSTIMEOUT2*/ +#elif (DM_ODM_SUPPORT_TYPE == (ODM_WIN)) +#elif (DM_ODM_SUPPORT_TYPE == (ODM_CE)) +#endif +} + +void +phydm_tdma_dig( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm; + struct phydm_dig_struct *p_dig_t; + struct phydm_fa_struct *p_falm_cnt; + u32 reg_c50; + + p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + p_dig_t = &p_dm->dm_dig_table; + p_falm_cnt = &p_dm->false_alm_cnt; + reg_c50 = odm_get_bb_reg(p_dm, 0xc50, MASKBYTE0); + + p_dig_t->tdma_dig_state = + p_dig_t->tdma_dig_cnt % p_dm->tdma_dig_state_number; + + PHYDM_DBG(p_dm, DBG_DIG, + ("tdma_dig_state=%d, regc50=0x%x\n", + p_dig_t->tdma_dig_state, + reg_c50)); + + p_dig_t->tdma_dig_cnt++; + + if (p_dig_t->tdma_dig_state == 1) { + // update IGI from tdma_dig_state == 0 + if (p_dig_t->cur_ig_value_tdma == 0) + p_dig_t->cur_ig_value_tdma = p_dig_t->cur_ig_value; + + odm_write_dig(p_dm, p_dig_t->cur_ig_value_tdma); + phydm_tdma_false_alarm_counter_check(p_dm); + PHYDM_DBG(p_dm, DBG_DIG, + ("tdma_dig_state=%d, reset FA counter !!!\n", + p_dig_t->tdma_dig_state)); + + } else if (p_dig_t->tdma_dig_state == 0) { + /* update p_dig_t->CurIGValue,*/ + /* it may different from p_dig_t->cur_ig_value_tdma */ + /* TDMA IGI upperbond @ L-state = */ + /* rf_ft_var.tdma_dig_low_upper_bond = 0x26 */ + + if (p_dig_t->cur_ig_value >= p_dm->tdma_dig_low_upper_bond) + p_dig_t->low_ig_value = p_dm->tdma_dig_low_upper_bond; + else + p_dig_t->low_ig_value = p_dig_t->cur_ig_value; + + odm_write_dig(p_dm, p_dig_t->low_ig_value); + phydm_tdma_false_alarm_counter_check(p_dm); + } else + phydm_tdma_false_alarm_counter_check(p_dm); +} + +/*============================================================*/ +/*FASLE ALARM CHECK*/ +/*============================================================*/ + +void +phydm_tdma_false_alarm_counter_check( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm; + struct phydm_fa_struct *p_falm_cnt; + struct phydm_fa_acc_struct *p_falm_cnt_acc; + struct phydm_dig_struct *p_dig_t; + boolean rssi_dump_en = 0; + u32 timestamp; + u8 tdma_dig_state_number; + + p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + p_falm_cnt = &p_dm->false_alm_cnt; + p_falm_cnt_acc = &p_dm->false_alm_cnt_acc; + p_dig_t = &p_dm->dm_dig_table; + + if (p_dig_t->tdma_dig_state == 1) + phydm_false_alarm_counter_reset(p_dm); + /* Reset FalseAlarmCounterStatistics */ + /* fa_acc_1sec_tsf = fa_acc_1sec_tsf, keep */ + /* fa_end_tsf = fa_start_tsf = TSF */ + else { + odm_false_alarm_counter_statistics(p_dm); + if (p_dm->support_ic_type & ODM_RTL8197F) /*REG_FREERUN_CNT*/ + timestamp = odm_get_bb_reg(p_dm, 0x568, bMaskDWord); + else { + PHYDM_DBG(p_dm, DBG_DIG, + ("Caution! NOT 97F! TDMA-DIG timer does NOT start!!!\n")); + return; + } + p_dig_t->fa_end_timestamp = timestamp; + p_dig_t->fa_acc_1sec_timestamp += + (p_dig_t->fa_end_timestamp - p_dig_t->fa_start_timestamp); + + /*prevent dumb*/ + if (p_dm->tdma_dig_state_number == 1) + p_dm->tdma_dig_state_number = 2; + + tdma_dig_state_number = p_dm->tdma_dig_state_number; + p_dig_t->sec_factor = + tdma_dig_state_number / (tdma_dig_state_number - 1); + + /*1sec = 1000000us*/ + if (p_dig_t->fa_acc_1sec_timestamp >= (u32)(1000000 / p_dig_t->sec_factor)) { + rssi_dump_en = 1; + phydm_false_alarm_counter_acc(p_dm, rssi_dump_en); + PHYDM_DBG(p_dm, DBG_DIG, + ("sec_factor = %u, total FA = %u, is_linked=%u\n", + p_dig_t->sec_factor, + p_falm_cnt_acc->cnt_all, + p_dm->is_linked)); + + phydm_noisy_detection(p_dm); + phydm_cck_pd_th(p_dm); + phydm_dig(p_dm); + phydm_false_alarm_counter_acc_reset(p_dm); + + /* Reset FalseAlarmCounterStatistics */ + /* fa_end_tsf = fa_start_tsf = TSF, keep */ + /* fa_acc_1sec_tsf = 0 */ + phydm_false_alarm_counter_reset(p_dm); + } else + phydm_false_alarm_counter_acc(p_dm, rssi_dump_en); + } +} + +void +phydm_false_alarm_counter_acc( + void *p_dm_void, + boolean rssi_dump_en + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_struct *p_falm_cnt; + struct phydm_fa_acc_struct *p_falm_cnt_acc; + struct phydm_dig_struct *p_dig_t; + + p_falm_cnt = &p_dm->false_alm_cnt; + p_falm_cnt_acc = &p_dm->false_alm_cnt_acc; + p_dig_t = &p_dm->dm_dig_table; + + p_falm_cnt_acc->cnt_parity_fail += p_falm_cnt->cnt_parity_fail; + p_falm_cnt_acc->cnt_rate_illegal += p_falm_cnt->cnt_rate_illegal; + p_falm_cnt_acc->cnt_crc8_fail += p_falm_cnt->cnt_crc8_fail; + p_falm_cnt_acc->cnt_mcs_fail += p_falm_cnt->cnt_mcs_fail; + p_falm_cnt_acc->cnt_ofdm_fail += p_falm_cnt->cnt_ofdm_fail; + p_falm_cnt_acc->cnt_cck_fail += p_falm_cnt->cnt_cck_fail; + p_falm_cnt_acc->cnt_all += p_falm_cnt->cnt_all; + p_falm_cnt_acc->cnt_fast_fsync += p_falm_cnt->cnt_fast_fsync; + p_falm_cnt_acc->cnt_sb_search_fail += p_falm_cnt->cnt_sb_search_fail; + p_falm_cnt_acc->cnt_ofdm_cca += p_falm_cnt->cnt_ofdm_cca; + p_falm_cnt_acc->cnt_cck_cca += p_falm_cnt->cnt_cck_cca; + p_falm_cnt_acc->cnt_cca_all += p_falm_cnt->cnt_cca_all; + p_falm_cnt_acc->cnt_cck_crc32_error += p_falm_cnt->cnt_cck_crc32_error; + p_falm_cnt_acc->cnt_cck_crc32_ok += p_falm_cnt->cnt_cck_crc32_ok; + p_falm_cnt_acc->cnt_ofdm_crc32_error += p_falm_cnt->cnt_ofdm_crc32_error; + p_falm_cnt_acc->cnt_ofdm_crc32_ok += p_falm_cnt->cnt_ofdm_crc32_ok; + p_falm_cnt_acc->cnt_ht_crc32_error += p_falm_cnt->cnt_ht_crc32_error; + p_falm_cnt_acc->cnt_ht_crc32_ok += p_falm_cnt->cnt_ht_crc32_ok; + p_falm_cnt_acc->cnt_vht_crc32_error += p_falm_cnt->cnt_vht_crc32_error; + p_falm_cnt_acc->cnt_vht_crc32_ok += p_falm_cnt->cnt_vht_crc32_ok; + p_falm_cnt_acc->cnt_crc32_error_all += p_falm_cnt->cnt_crc32_error_all; + p_falm_cnt_acc->cnt_crc32_ok_all += p_falm_cnt->cnt_crc32_ok_all; + + if (rssi_dump_en == 1) { + p_falm_cnt_acc->cnt_all_1sec = + p_falm_cnt_acc->cnt_all * p_dig_t->sec_factor; + p_falm_cnt_acc->cnt_cca_all_1sec = + p_falm_cnt_acc->cnt_cca_all * p_dig_t->sec_factor; + p_falm_cnt_acc->cnt_cck_fail_1sec = + p_falm_cnt_acc->cnt_cck_fail * p_dig_t->sec_factor; + } +} + +void +phydm_false_alarm_counter_acc_reset( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_acc_struct *p_falm_cnt_acc; + + p_falm_cnt_acc = &p_dm->false_alm_cnt_acc; + + /* Cnt_all_for_rssi_dump & Cnt_CCA_all_for_rssi_dump */ + /* do NOT need to be reset */ + odm_memory_set(p_dm, p_falm_cnt_acc, 0, sizeof(p_falm_cnt_acc)); +} + +void +phydm_false_alarm_counter_reset( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_struct *p_falm_cnt; + struct phydm_dig_struct *p_dig_t; + u32 timestamp; + + p_falm_cnt = &p_dm->false_alm_cnt; + p_dig_t = &p_dm->dm_dig_table; + + memset(p_falm_cnt, 0, sizeof(p_dm->false_alm_cnt)); + phydm_false_alarm_counter_reg_reset(p_dm); + + if (p_dig_t->tdma_dig_state != 1) + p_dig_t->fa_acc_1sec_timestamp = 0; + else + p_dig_t->fa_acc_1sec_timestamp = p_dig_t->fa_acc_1sec_timestamp; + + /*REG_FREERUN_CNT*/ + timestamp = odm_get_bb_reg(p_dm, 0x568, bMaskDWord); + p_dig_t->fa_start_timestamp = timestamp; + p_dig_t->fa_end_timestamp = timestamp; +} + +#endif /*#ifdef PHYDM_TDMA_DIG_SUPPORT*/ + +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT +void +phydm_lna_sat_chk_init( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + struct phydm_lna_sat_info_struct *p_lna_info = &p_dm->dm_lna_sat_info; + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("%s ==>\n", __FUNCTION__)); + + p_lna_info->check_time = 0; + p_lna_info->sat_cnt_acc_patha = 0; + p_lna_info->sat_cnt_acc_pathb = 0; + p_lna_info->cur_sat_status = 0; + p_lna_info->pre_sat_status = 0; + p_lna_info->cur_timer_check_cnt = 0; + p_lna_info->pre_timer_check_cnt = 0; +} + +void +phydm_set_ofdm_agc_tab( + void *p_dm_void, + u8 tab_sel +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + /* table sel:0/2, 1 is used for CCK */ + if (tab_sel == OFDM_AGC_TAB_0) + odm_set_bb_reg(p_dm, 0xc70, 0x1e00, OFDM_AGC_TAB_0); + else if (tab_sel == OFDM_AGC_TAB_2) + odm_set_bb_reg(p_dm, 0xc70, 0x1e00, OFDM_AGC_TAB_2); + else + odm_set_bb_reg(p_dm, 0xc70, 0x1e00, OFDM_AGC_TAB_0); +} + +u8 +phydm_get_ofdm_agc_tab( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + return (u1Byte)odm_get_bb_reg(p_dm, 0xc70, 0x1e00); +} + +void +phydm_lna_sat_chk( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + struct phydm_lna_sat_info_struct *p_lna_info = &p_dm->dm_lna_sat_info; + + u1Byte igi_rssi_min, rssi_min = p_dm->rssi_min; + u4Byte sat_status_patha, sat_status_pathb; + u1Byte igi_restore = p_dig_t->cur_ig_value; + u1Byte i, lna_sat_chk_cnt = p_dm->lna_sat_chk_cnt; + u4Byte lna_sat_cnt_thd = 0; + u1Byte agc_tab; + u4Byte max_check_time = 0; + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("\n%s ==>\n", __FUNCTION__)); + + if (!(p_dm->support_ability & ODM_BB_LNA_SAT_CHK)) { + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("support ability is disabled, return.\n")); + return; + } + + if (p_dm->is_disable_lna_sat_chk) { + phydm_lna_sat_chk_init(p_dm); + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("is_disable_lna_sat_chk=%d, return.\n", p_dm->is_disable_lna_sat_chk)); + return; + } + + //func_start = ODM_GetBBReg(pDM_Odm, 0x560, bMaskDWord); + + // move igi to target pin of rssi_min + if ((rssi_min == 0) || (rssi_min == 0xff)) { + // adapt agc table 0 + phydm_set_ofdm_agc_tab(p_dm, OFDM_AGC_TAB_0); + phydm_lna_sat_chk_init(p_dm); + return; + } else if (rssi_min % 2 != 0) + igi_rssi_min = rssi_min + DIFF_RSSI_TO_IGI - 1; + else + igi_rssi_min = rssi_min + DIFF_RSSI_TO_IGI; + + if ((p_dm->lna_sat_chk_period_ms > 0) && (p_dm->lna_sat_chk_period_ms <= ONE_SEC_MS)) + max_check_time = lna_sat_chk_cnt*(ONE_SEC_MS/(p_dm->lna_sat_chk_period_ms))*5; + else + max_check_time = lna_sat_chk_cnt * 5; + + lna_sat_cnt_thd = (max_check_time * p_dm->lna_sat_chk_duty_cycle)/100; + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("check_time=%d, rssi_min=%d, igi_rssi_min=0x%x\nlna_sat_chk_cnt=%d, lna_sat_chk_period_ms=%d, max_check_time=%d, lna_sat_cnt_thd=%d\n", + p_lna_info->check_time, + rssi_min, + igi_rssi_min, + lna_sat_chk_cnt, + p_dm->lna_sat_chk_period_ms, + max_check_time, + lna_sat_cnt_thd)); + + odm_write_dig(p_dm, igi_rssi_min); + + // adapt agc table 0 check saturation status + phydm_set_ofdm_agc_tab(p_dm, OFDM_AGC_TAB_0); + // open rf power detection ckt & set detection range + odm_set_rf_reg(p_dm, RF_PATH_A, 0x86, 0x1f, 0x10); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x86, 0x1f, 0x10); + + // check saturation status + for (i = 0; i < lna_sat_chk_cnt; i++) { + sat_status_patha = odm_get_rf_reg(p_dm, RF_PATH_A, 0xae, 0xc0000); + sat_status_pathb = odm_get_rf_reg(p_dm, RF_PATH_B, 0xae, 0xc0000); + if (sat_status_patha != 0) + p_lna_info->sat_cnt_acc_patha++; + if (sat_status_pathb != 0) + p_lna_info->sat_cnt_acc_pathb++; + + if ((p_lna_info->sat_cnt_acc_patha >= lna_sat_cnt_thd) || + (p_lna_info->sat_cnt_acc_pathb >= lna_sat_cnt_thd)) { + p_lna_info->cur_sat_status = 1; + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("cur_sat_status=%d, check_time=%d\n", + p_lna_info->cur_sat_status, + p_lna_info->check_time)); + break; + } else + p_lna_info->cur_sat_status = 0; + } + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("cur_sat_status=%d, pre_sat_status=%d, sat_cnt_acc_patha=%d, sat_cnt_acc_pathb=%d\n", + p_lna_info->cur_sat_status, + p_lna_info->pre_sat_status, + p_lna_info->sat_cnt_acc_patha, + p_lna_info->sat_cnt_acc_pathb)); + + // agc table decision + if (p_lna_info->cur_sat_status) { + if (!p_dm->is_disable_gain_table_switch) + phydm_set_ofdm_agc_tab(p_dm, OFDM_AGC_TAB_2); + p_lna_info->check_time = 0; + p_lna_info->sat_cnt_acc_patha = 0; + p_lna_info->sat_cnt_acc_pathb = 0; + p_lna_info->pre_sat_status = p_lna_info->cur_sat_status; + + } else if (p_lna_info->check_time <= (max_check_time - 1)) { + if (p_lna_info->pre_sat_status && (!p_dm->is_disable_gain_table_switch)) + phydm_set_ofdm_agc_tab(p_dm, OFDM_AGC_TAB_2); + p_lna_info->check_time++; + + } else if (p_lna_info->check_time == max_check_time) { + if (!p_dm->is_disable_gain_table_switch && (p_lna_info->pre_sat_status == 1)) + phydm_set_ofdm_agc_tab(p_dm, OFDM_AGC_TAB_0); + p_lna_info->check_time = 0; + p_lna_info->sat_cnt_acc_patha = 0; + p_lna_info->sat_cnt_acc_pathb = 0; + p_lna_info->pre_sat_status = p_lna_info->cur_sat_status; + } + + agc_tab = phydm_get_ofdm_agc_tab(p_dm); + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("use AGC tab %d\n", agc_tab)); + //func_end = ODM_GetBBReg(pDM_Odm, 0x560, bMaskDWord); + + //PHYDM_DBG(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("function process time=%d\n", + // func_end - func_start)); + + // restore previous igi + odm_write_dig(p_dm, igi_restore); + p_lna_info->cur_timer_check_cnt++; + odm_set_timer(p_dm, &p_lna_info->phydm_lna_sat_chk_timer, p_dm->lna_sat_chk_period_ms); +} + +void +phydm_lna_sat_chk_callback( + void *p_dm_void + + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("\n%s ==>\n", __FUNCTION__)); + phydm_lna_sat_chk(p_dm); +} + +void +phydm_lna_sat_chk_timers( + void *p_dm_void, + u8 state + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_lna_sat_info_struct *p_lna_info = &p_dm->dm_lna_sat_info; + + if (state == INIT_LNA_SAT_CHK_TIMMER) { + odm_initialize_timer(p_dm, &(p_lna_info->phydm_lna_sat_chk_timer), + (void *)phydm_lna_sat_chk_callback, NULL, "phydm_lna_sat_chk_timer"); + } else if (state == CANCEL_LNA_SAT_CHK_TIMMER) { + odm_cancel_timer(p_dm, &(p_lna_info->phydm_lna_sat_chk_timer)); + } else if (state == RELEASE_LNA_SAT_CHK_TIMMER) { + odm_release_timer(p_dm, &(p_lna_info->phydm_lna_sat_chk_timer)); + } +} + +void +phydm_lna_sat_chk_watchdog( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_lna_sat_info_struct *p_lna_info = &p_dm->dm_lna_sat_info; + + u1Byte rssi_min = p_dm->rssi_min; + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("\n%s ==>\n", __FUNCTION__)); + + if (!(p_dm->support_ability & ODM_BB_LNA_SAT_CHK)) { + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("support ability is disabled, return.\n")); + return; + } + + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("pre_timer_check_cnt=%d, cur_timer_check_cnt=%d\n", + p_lna_info->pre_timer_check_cnt, + p_lna_info->cur_timer_check_cnt)); + + if (p_dm->is_disable_lna_sat_chk) { + phydm_lna_sat_chk_init(p_dm); + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("is_disable_lna_sat_chk=%d, return.\n", p_dm->is_disable_lna_sat_chk)); + return; + } + + if ((p_dm->support_ic_type & ODM_RTL8197F) == 0) { + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("SupportICType != ODM_RTL8197F, return.\n")); + return; + } + + if ((rssi_min == 0) || (rssi_min == 0xff)) { + // adapt agc table 0 + phydm_set_ofdm_agc_tab(p_dm, OFDM_AGC_TAB_0); + phydm_lna_sat_chk_init(p_dm); + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, + ("rssi_min=%d, return.\n", rssi_min)); + return; + } + + if (p_lna_info->cur_timer_check_cnt == p_lna_info->pre_timer_check_cnt) { + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("Timer check fail, restart timer.\n")); + phydm_lna_sat_chk(p_dm); + } else { + PHYDM_DBG(p_dm, DBG_LNA_SAT_CHK, ("Timer check pass.\n")); + } + p_lna_info->pre_timer_check_cnt = p_lna_info->cur_timer_check_cnt; +} +#endif /*#if (PHYDM_LNA_SAT_CHK_SUPPORT == 1)*/ + +void +phydm_dig_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + char help[] = "-h"; + char monitor[] = "-m"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i; + + if ((strcmp(input[1], help) == 0)) + PHYDM_SNPRINTF((output + used, out_len - used, "{0} fa[0] fa[1] fa[2]\n")); + else if ((strcmp(input[1], monitor) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, + "Read DIG fa_th[0:2]= {%d, %d, %d}\n", + p_dig_t->fa_th[0], p_dig_t->fa_th[1], p_dig_t->fa_th[2])); + + } else { + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + for (i = 1; i < 10; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + + if (var1[0] == 0) { + p_dig_t->is_dbg_fa_th = true; + p_dig_t->fa_th[0] = (u16)var1[1]; + p_dig_t->fa_th[1] = (u16)var1[2]; + p_dig_t->fa_th[2] = (u16)var1[3]; + + PHYDM_SNPRINTF((output + used, out_len - used, + "Set DIG fa_th[0:2]= {%d, %d, %d}\n", + p_dig_t->fa_th[0], p_dig_t->fa_th[1], p_dig_t->fa_th[2])); + } else + p_dig_t->is_dbg_fa_th = false; + } + *_used = used; + *_out_len = out_len; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.h index 90f70c11daed..17e25da02615 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dig.h @@ -1,370 +1,350 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMDIG_H__ -#define __PHYDMDIG_H__ - -#define DIG_VERSION "1.24" /* 2016.06.01 Stanley. Modify IGI setting for 1R-CCA path-B */ - -/* Pause DIG & CCKPD */ -#define DM_DIG_MAX_PAUSE_TYPE 0x7 - -typedef enum tag_DIG_GoUpCheck_Level { - - DIG_GOUPCHECK_LEVEL_0, - DIG_GOUPCHECK_LEVEL_1, - DIG_GOUPCHECK_LEVEL_2 - -} DIG_GOUPCHECK_LEVEL; - -typedef struct _Dynamic_Initial_Gain_Threshold_ -{ - BOOLEAN bStopDIG; // for debug - BOOLEAN bIgnoreDIG; - BOOLEAN bPSDInProgress; - - u1Byte Dig_Enable_Flag; - u1Byte Dig_Ext_Port_Stage; - - int RssiLowThresh; - int RssiHighThresh; - - u4Byte FALowThresh; - u4Byte FAHighThresh; - - u1Byte CurSTAConnectState; - u1Byte PreSTAConnectState; - u1Byte CurMultiSTAConnectState; - - u1Byte PreIGValue; - u1Byte CurIGValue; - u1Byte BackupIGValue; //MP DIG - u1Byte BT30_CurIGI; - u1Byte IGIBackup; - - s1Byte BackoffVal; - s1Byte BackoffVal_range_max; - s1Byte BackoffVal_range_min; - u1Byte rx_gain_range_max; - u1Byte rx_gain_range_min; - u1Byte Rssi_val_min; - - u1Byte PreCCK_CCAThres; - u1Byte CurCCK_CCAThres; - u1Byte PreCCKPDState; - u1Byte CurCCKPDState; - u1Byte CCKPDBackup; - u1Byte pause_cckpd_level; - u1Byte pause_cckpd_value[DM_DIG_MAX_PAUSE_TYPE + 1]; - - u1Byte LargeFAHit; - u1Byte LargeFA_Timeout; /*if (LargeFAHit), monitor "LargeFA_Timeout" sec, if timeout, LargeFAHit=0*/ - u1Byte ForbiddenIGI; - u4Byte Recover_cnt; - - u1Byte DIG_Dynamic_MIN_0; - u1Byte DIG_Dynamic_MIN_1; - BOOLEAN bMediaConnect_0; - BOOLEAN bMediaConnect_1; - - u4Byte AntDiv_RSSI_max; - u4Byte RSSI_max; - - u1Byte *bP2PInProcess; - - u1Byte pause_dig_level; - u1Byte pause_dig_value[DM_DIG_MAX_PAUSE_TYPE + 1]; - - u4Byte cckFaMa; - DIG_GOUPCHECK_LEVEL DIG_GoUpCheck_Level; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - BOOLEAN bTpTarget; - BOOLEAN bNoiseEst; - u4Byte TpTrainTH_min; - u1Byte IGIOffset_A; - u1Byte IGIOffset_B; -#endif - -#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) - u1Byte rfGainIdx; - u1Byte agcTableIdx; - u1Byte bigJumpLmt[16]; - u1Byte enableAdjustBigJump:1; - u1Byte bigJumpStep1:3; - u1Byte bigJumpStep2:2; - u1Byte bigJumpStep3:2; -#endif -}DIG_T,*pDIG_T; - -typedef struct _FALSE_ALARM_STATISTICS{ - u4Byte Cnt_Parity_Fail; - u4Byte Cnt_Rate_Illegal; - u4Byte Cnt_Crc8_fail; - u4Byte Cnt_Mcs_fail; - u4Byte Cnt_Ofdm_fail; - u4Byte Cnt_Ofdm_fail_pre; //For RTL8881A - u4Byte Cnt_Cck_fail; - u4Byte Cnt_all; - u4Byte Cnt_all_pre; - u4Byte Cnt_Fast_Fsync; - u4Byte Cnt_SB_Search_fail; - u4Byte Cnt_OFDM_CCA; - u4Byte Cnt_CCK_CCA; - u4Byte Cnt_CCA_all; - u4Byte Cnt_BW_USC; //Gary - u4Byte Cnt_BW_LSC; //Gary - u4Byte cnt_cck_crc32_error; - u4Byte cnt_cck_crc32_ok; - u4Byte cnt_ofdm_crc32_error; - u4Byte cnt_ofdm_crc32_ok; - u4Byte cnt_ht_crc32_error; - u4Byte cnt_ht_crc32_ok; - u4Byte cnt_vht_crc32_error; - u4Byte cnt_vht_crc32_ok; - u4Byte cnt_crc32_error_all; - u4Byte cnt_crc32_ok_all; - BOOLEAN cck_block_enable; - BOOLEAN ofdm_block_enable; - u4Byte dbg_port0; - BOOLEAN edcca_flag; -}FALSE_ALARM_STATISTICS, *PFALSE_ALARM_STATISTICS; - -typedef enum tag_Dynamic_Init_Gain_Operation_Type_Definition -{ - DIG_TYPE_THRESH_HIGH = 0, - DIG_TYPE_THRESH_LOW = 1, - DIG_TYPE_BACKOFF = 2, - DIG_TYPE_RX_GAIN_MIN = 3, - DIG_TYPE_RX_GAIN_MAX = 4, - DIG_TYPE_ENABLE = 5, - DIG_TYPE_DISABLE = 6, - DIG_OP_TYPE_MAX -}DM_DIG_OP_E; - -/* -typedef enum tag_CCK_Packet_Detection_Threshold_Type_Definition -{ - CCK_PD_STAGE_LowRssi = 0, - CCK_PD_STAGE_HighRssi = 1, - CCK_PD_STAGE_MAX = 3, -}DM_CCK_PDTH_E; - -typedef enum tag_DIG_EXT_PORT_ALGO_Definition -{ - DIG_EXT_PORT_STAGE_0 = 0, - DIG_EXT_PORT_STAGE_1 = 1, - DIG_EXT_PORT_STAGE_2 = 2, - DIG_EXT_PORT_STAGE_3 = 3, - DIG_EXT_PORT_STAGE_MAX = 4, -}DM_DIG_EXT_PORT_ALG_E; - -typedef enum tag_DIG_Connect_Definition -{ - DIG_STA_DISCONNECT = 0, - DIG_STA_CONNECT = 1, - DIG_STA_BEFORE_CONNECT = 2, - DIG_MultiSTA_DISCONNECT = 3, - DIG_MultiSTA_CONNECT = 4, - DIG_CONNECT_MAX -}DM_DIG_CONNECT_E; - - -#define DM_MultiSTA_InitGainChangeNotify(Event) {DM_DigTable.CurMultiSTAConnectState = Event;} - -#define DM_MultiSTA_InitGainChangeNotify_CONNECT(_ADAPTER) \ - DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_CONNECT) - -#define DM_MultiSTA_InitGainChangeNotify_DISCONNECT(_ADAPTER) \ - DM_MultiSTA_InitGainChangeNotify(DIG_MultiSTA_DISCONNECT) -*/ - -typedef enum tag_PHYDM_Pause_Type { - PHYDM_PAUSE = BIT0, - PHYDM_RESUME = BIT1 -} PHYDM_PAUSE_TYPE; - -typedef enum tag_PHYDM_Pause_Level { -/* number of pause level can't exceed DM_DIG_MAX_PAUSE_TYPE */ - PHYDM_PAUSE_LEVEL_0 = 0, - PHYDM_PAUSE_LEVEL_1 = 1, - PHYDM_PAUSE_LEVEL_2 = 2, - PHYDM_PAUSE_LEVEL_3 = 3, - PHYDM_PAUSE_LEVEL_4 = 4, - PHYDM_PAUSE_LEVEL_5 = 5, - PHYDM_PAUSE_LEVEL_6 = 6, - PHYDM_PAUSE_LEVEL_7 = DM_DIG_MAX_PAUSE_TYPE /* maximum level */ -} PHYDM_PAUSE_LEVEL; - -#define DM_DIG_THRESH_HIGH 40 -#define DM_DIG_THRESH_LOW 35 - -#define DM_FALSEALARM_THRESH_LOW 400 -#define DM_FALSEALARM_THRESH_HIGH 1000 - -#define DM_DIG_MAX_NIC 0x3e -#define DM_DIG_MIN_NIC 0x20 -#define DM_DIG_MAX_OF_MIN_NIC 0x3e - -#define DM_DIG_MAX_AP 0x3e -#define DM_DIG_MIN_AP 0x20 -#define DM_DIG_MAX_OF_MIN 0x2A //0x32 -#define DM_DIG_MIN_AP_DFS 0x20 - -#define DM_DIG_MAX_NIC_HP 0x46 -#define DM_DIG_MIN_NIC_HP 0x2e - -#define DM_DIG_MAX_AP_HP 0x42 -#define DM_DIG_MIN_AP_HP 0x30 - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -#define DM_DIG_MAX_AP_COVERAGR 0x26 -#define DM_DIG_MIN_AP_COVERAGE 0x1c -#define DM_DIG_MAX_OF_MIN_COVERAGE 0x22 - -#define DM_DIG_TP_Target_TH0 500 -#define DM_DIG_TP_Target_TH1 1000 -#define DM_DIG_TP_Training_Period 10 -#endif - -//vivi 92c&92d has different definition, 20110504 -//this is for 92c -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - #ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV - #define DM_DIG_FA_TH0 0x80//0x20 - #else - #define DM_DIG_FA_TH0 0x200//0x20 - #endif -#else - #define DM_DIG_FA_TH0 0x200//0x20 -#endif - -#define DM_DIG_FA_TH1 0x300 -#define DM_DIG_FA_TH2 0x400 -//this is for 92d -#define DM_DIG_FA_TH0_92D 0x100 -#define DM_DIG_FA_TH1_92D 0x400 -#define DM_DIG_FA_TH2_92D 0x600 - -#define DM_DIG_BACKOFF_MAX 12 -#define DM_DIG_BACKOFF_MIN -4 -#define DM_DIG_BACKOFF_DEFAULT 10 - -#define DM_DIG_FA_TH0_LPS 4 //-> 4 in lps -#define DM_DIG_FA_TH1_LPS 15 //-> 15 lps -#define DM_DIG_FA_TH2_LPS 30 //-> 30 lps -#define RSSI_OFFSET_DIG 0x05 -#define LARGE_FA_TIMEOUT 60 - - -VOID -ODM_ChangeDynamicInitGainThresh( - IN PVOID pDM_VOID, - IN u4Byte DM_Type, - IN u4Byte DM_Value - ); - -VOID -ODM_Write_DIG( - IN PVOID pDM_VOID, - IN u1Byte CurrentIGI - ); - -VOID -odm_PauseDIG( - IN PVOID pDM_VOID, - IN PHYDM_PAUSE_TYPE PauseType, - IN PHYDM_PAUSE_LEVEL pause_level, - IN u1Byte IGIValue - ); - -VOID -odm_DIGInit( - IN PVOID pDM_VOID - ); - -VOID -odm_DIG( - IN PVOID pDM_VOID - ); - -VOID -odm_DIGbyRSSI_LPS( - IN PVOID pDM_VOID - ); - -VOID -odm_FalseAlarmCounterStatistics( - IN PVOID pDM_VOID - ); - -VOID -odm_PauseCCKPacketDetection( - IN PVOID pDM_VOID, - IN PHYDM_PAUSE_TYPE PauseType, - IN PHYDM_PAUSE_LEVEL pause_level, - IN u1Byte CCKPDThreshold - ); - -VOID -odm_CCKPacketDetectionThresh( - IN PVOID pDM_VOID - ); - -VOID -ODM_Write_CCK_CCA_Thres( - IN PVOID pDM_VOID, - IN u1Byte CurCCK_CCAThres - ); - -BOOLEAN -phydm_DIG_GoUpCheck( - IN PVOID pDM_VOID - ); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -odm_MPT_DIGCallback( - PRT_TIMER pTimer -); - -VOID -odm_MPT_DIGWorkItemCallback( - IN PVOID pContext - ); - -#endif - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) -VOID -odm_MPT_DIGCallback( - IN PVOID pDM_VOID -); -#endif - -#if (DM_ODM_SUPPORT_TYPE != ODM_CE) -VOID -ODM_MPT_DIG( - IN PVOID pDM_VOID -); -#endif - - -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMDIG_H__ +#define __PHYDMDIG_H__ + +/*#define DIG_VERSION "1.4"*/ /* 2017.04.18 YuChen. refine DIG code structure*/ +/*#define DIG_VERSION "2.0"*/ /* 2017.05.09 Dino. Move CCKPD to new files*/ +/*#define DIG_VERSION "2.1"*/ /* 2017.06.01 YuChen. Refine DFS condition*/ +#define DIG_VERSION "2.2" /* 2017.06.13 YuChen. Remove MP dig*/ + +#define DIG_HW 0 + +/*--------------------Define ---------------------------------------*/ + +/*=== [DIG Boundary] ========================================*/ +/*DIG coverage mode*/ +#define DIG_MAX_COVERAGR 0x26 +#define DIG_MIN_COVERAGE 0x1c +#define DIG_MAX_OF_MIN_COVERAGE 0x22 +/*DIG performance mode*/ +#if (DIG_HW == 1) +#define DIG_MAX_BALANCE_MODE 0x32 +#else +#define DIG_MAX_BALANCE_MODE 0x3e +#endif +#define DIG_MAX_OF_MIN_BALANCE_MODE 0x2a + +#define DIG_MAX_PERFORMANCE_MODE 0x5a +#define DIG_MAX_OF_MIN_PERFORMANCE_MODE 0x2a /*from 3E -> 2A, refine by YuChen 2017/04/18*/ + +#define DIG_MIN_PERFORMANCE 0x20 + +/*DIG DFS function*/ +#define DIG_MAX_DFS 0x28 +#define DIG_MIN_DFS 0x20 + +/*DIG LPS function*/ +#define DIG_MAX_LPS 0x3e +#define DIG_MIN_LPS 0x20 + +/*=== [DIG FA Threshold] ======================================*/ + +/*Normal*/ +#define DM_DIG_FA_TH0 500 +#define DM_DIG_FA_TH1 750 + +/*LPS*/ +#define DM_DIG_FA_TH0_LPS 4 /* -> 4 lps */ +#define DM_DIG_FA_TH1_LPS 15 /* -> 15 lps */ +#define DM_DIG_FA_TH2_LPS 30 /* -> 30 lps */ + +#define RSSI_OFFSET_DIG_LPS 5 + +/*LNA saturation check*/ +#define OFDM_AGC_TAB_0 0 +#define OFDM_AGC_TAB_2 2 +#define DIFF_RSSI_TO_IGI 10 +#define ONE_SEC_MS 1000 + +/*--------------------Enum-----------------------------------*/ +enum dig_goupcheck_level { + DIG_GOUPCHECK_LEVEL_0, + DIG_GOUPCHECK_LEVEL_1, + DIG_GOUPCHECK_LEVEL_2 +}; + +enum phydm_dig_mode { + PHYDM_DIG_PERFORAMNCE_MODE = 0, + PHYDM_DIG_COVERAGE_MODE = 1, +}; + +enum lna_sat_timer_state { + INIT_LNA_SAT_CHK_TIMMER, + CANCEL_LNA_SAT_CHK_TIMMER, + RELEASE_LNA_SAT_CHK_TIMMER +}; +/*--------------------Define Struct-----------------------------------*/ + +struct phydm_dig_struct { + + boolean is_ignore_dig; /*for old pause function*/ + boolean is_dbg_fa_th; + u8 dig_mode_decision; + u8 cur_ig_value; + u8 rvrt_val; + u8 igi_backup; + u8 rx_gain_range_max; /*dig_dynamic_max*/ + u8 rx_gain_range_min; /*dig_dynamic_min*/ + u8 dm_dig_max; /*Absolutly upper bound*/ + u8 dm_dig_min; /*Absolutly lower bound*/ + u8 dig_max_of_min; /*Absolutly max of min*/ + boolean is_media_connect; + u32 ant_div_rssi_max; + u8 *is_p2p_in_process; + u8 pause_lv_bitmap; /*bit-map of pause level*/ + u8 pause_dig_value[PHYDM_PAUSE_MAX_NUM]; + enum dig_goupcheck_level dig_go_up_check_level; + u8 aaa_default; + u16 fa_th[3]; +#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1 || RTL8821C_SUPPORT == 1) + u8 rf_gain_idx; + u8 agc_table_idx; + u8 big_jump_lmt[16]; + u8 enable_adjust_big_jump:1; + u8 big_jump_step1:3; + u8 big_jump_step2:2; + u8 big_jump_step3:2; +#endif + u8 dig_upcheck_initial_value; + u8 dig_level0_ratio_reciprocal; + u8 dig_level1_ratio_reciprocal; +#ifdef PHYDM_TDMA_DIG_SUPPORT + u8 cur_ig_value_tdma; + u8 low_ig_value; + u8 tdma_dig_state; /*To distinguish which state is now.(L-sate or H-state)*/ + u8 tdma_dig_cnt; /*for phydm_tdma_dig_timer_check use*/ + u8 pre_tdma_dig_cnt; + u8 sec_factor; + u32 cur_timestamp; + u32 pre_timestamp; + u32 fa_start_timestamp; + u32 fa_end_timestamp; + u32 fa_acc_1sec_timestamp; +#endif +}; + +struct phydm_fa_struct { + u32 cnt_parity_fail; + u32 cnt_rate_illegal; + u32 cnt_crc8_fail; + u32 cnt_mcs_fail; + u32 cnt_ofdm_fail; + u32 cnt_ofdm_fail_pre; /* For RTL8881A */ + u32 cnt_cck_fail; + u32 cnt_all; + u32 cnt_all_pre; + u32 cnt_fast_fsync; + u32 cnt_sb_search_fail; + u32 cnt_ofdm_cca; + u32 cnt_cck_cca; + u32 cnt_cca_all; + u32 cnt_bw_usc; + u32 cnt_bw_lsc; + u32 cnt_cck_crc32_error; + u32 cnt_cck_crc32_ok; + u32 cnt_ofdm_crc32_error; + u32 cnt_ofdm_crc32_ok; + u32 cnt_ht_crc32_error; + u32 cnt_ht_crc32_ok; + u32 cnt_ht_crc32_error_agg; + u32 cnt_ht_crc32_ok_agg; + u32 cnt_vht_crc32_error; + u32 cnt_vht_crc32_ok; + u32 cnt_crc32_error_all; + u32 cnt_crc32_ok_all; + boolean cck_block_enable; + boolean ofdm_block_enable; + u32 dbg_port0; + boolean edcca_flag; +}; + +#ifdef PHYDM_TDMA_DIG_SUPPORT +struct phydm_fa_acc_struct { + u32 cnt_parity_fail; + u32 cnt_rate_illegal; + u32 cnt_crc8_fail; + u32 cnt_mcs_fail; + u32 cnt_ofdm_fail; + u32 cnt_ofdm_fail_pre; /*For RTL8881A*/ + u32 cnt_cck_fail; + u32 cnt_all; + u32 cnt_all_pre; + u32 cnt_fast_fsync; + u32 cnt_sb_search_fail; + u32 cnt_ofdm_cca; + u32 cnt_cck_cca; + u32 cnt_cca_all; + u32 cnt_cck_crc32_error; + u32 cnt_cck_crc32_ok; + u32 cnt_ofdm_crc32_error; + u32 cnt_ofdm_crc32_ok; + u32 cnt_ht_crc32_error; + u32 cnt_ht_crc32_ok; + u32 cnt_vht_crc32_error; + u32 cnt_vht_crc32_ok; + u32 cnt_crc32_error_all; + u32 cnt_crc32_ok_all; + u32 cnt_all_1sec; + u32 cnt_cca_all_1sec; + u32 cnt_cck_fail_1sec; +}; + +#endif /*#ifdef PHYDM_TDMA_DIG_SUPPORT*/ + +struct phydm_lna_sat_info_struct { + u32 sat_cnt_acc_patha; + u32 sat_cnt_acc_pathb; + u32 check_time; + boolean pre_sat_status; + boolean cur_sat_status; + struct timer_list phydm_lna_sat_chk_timer; + u32 cur_timer_check_cnt; + u32 pre_timer_check_cnt; +}; + +/*--------------------Function declaration-----------------------------*/ +void +odm_write_dig( + void *p_dm_void, + u8 current_igi +); + +void +phydm_set_dig_val( + void *p_dm_void, + u32 *val_buf, + u8 val_len +); + +void +odm_pause_dig( + void *p_dm_void, + enum phydm_pause_type pause_type, + enum phydm_pause_level pause_level, + u8 igi_value +); + +void +phydm_dig_init( + void *p_dm_void +); + +void +phydm_dig( + void *p_dm_void +); + +void +phydm_dig_lps_32k( + void *p_dm_void +); + +void +phydm_dig_by_rssi_lps( + void *p_dm_void +); + +void +odm_false_alarm_counter_statistics( + void *p_dm_void +); + +#ifdef PHYDM_TDMA_DIG_SUPPORT +void +phydm_set_tdma_dig_timer( + void *p_dm_void +); + +void +phydm_tdma_dig_timer_check( + void *p_dm_void +); + +void +phydm_tdma_dig( + void *p_dm_void +); + +void +phydm_tdma_false_alarm_counter_check( + void *p_dm_void +); + +void +phydm_tdma_dig_add_interrupt_mask_handler( + void *p_dm_void +); + +void +phydm_false_alarm_counter_reset( + void *p_dm_void +); + +void +phydm_false_alarm_counter_acc( + void *p_dm_void, + boolean rssi_dump_en + ); + +void +phydm_false_alarm_counter_acc_reset( + void *p_dm_void + ); + +#endif /*#ifdef PHYDM_TDMA_DIG_SUPPORT*/ + +void +phydm_set_ofdm_agc_tab( + void *p_dm_void, + u8 tab_sel +); + +#ifdef PHYDM_LNA_SAT_CHK_SUPPORT +u8 +phydm_get_ofdm_agc_tab( + void *p_dm_void +); + +void +phydm_lna_sat_chk( + void *p_dm_void +); + +void +phydm_lna_sat_chk_timers( + void *p_dm_void, + u8 state +); + +void +phydm_lna_sat_chk_watchdog( + void *p_dm_void +); + +#endif /*#if (PHYDM_LNA_SAT_CHK_SUPPORT == 1)*/ + +void +phydm_dig_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.c new file mode 100644 index 000000000000..84b6db9846d9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.c @@ -0,0 +1,355 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef CONFIG_DYNAMIC_RX_PATH + +void +phydm_process_phy_status_for_dynamic_rx_path( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_phyinfo_struct *p_phy_info = (struct phydm_phyinfo_struct *)p_phy_info_void; + struct phydm_perpkt_info_struct *p_pktinfo = (struct phydm_perpkt_info_struct *)p_pkt_info_void; + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + /*u8 is_cck_rate=0;*/ + + + +} + +void +phydm_drp_get_statistic( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + struct phydm_fa_struct *false_alm_cnt = (struct phydm_fa_struct *)phydm_get_structure(p_dm, PHYDM_FALSEALMCNT); + + odm_false_alarm_counter_statistics(p_dm); + + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[CCA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + false_alm_cnt->cnt_cck_cca, false_alm_cnt->cnt_ofdm_cca, false_alm_cnt->cnt_cca_all)); + + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[FA Cnt] {CCK, OFDM, Total} = {%d, %d, %d}\n", + false_alm_cnt->cnt_cck_fail, false_alm_cnt->cnt_ofdm_fail, false_alm_cnt->cnt_all)); +} + +void +phydm_dynamic_rx_path( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + u8 training_set_timmer_en; + u8 curr_drp_state; + u32 rx_ok_cal; + u32 RSSI = 0; + struct phydm_fa_struct *false_alm_cnt = (struct phydm_fa_struct *)phydm_get_structure(p_dm, PHYDM_FALSEALMCNT); + + if (!(p_dm->support_ability & ODM_BB_DYNAMIC_RX_PATH)) { + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[Return Init] Not Support Dynamic RX PAth\n")); + return; + } + + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("Current drp_state = ((%d))\n", p_dm_drp_table->drp_state)); + + curr_drp_state = p_dm_drp_table->drp_state; + + if (p_dm_drp_table->drp_state == DRP_INIT_STATE) { + + phydm_drp_get_statistic(p_dm); + + if (false_alm_cnt->cnt_crc32_ok_all > 20) { + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[Stop DRP Training] cnt_crc32_ok_all = ((%d))\n", false_alm_cnt->cnt_crc32_ok_all)); + p_dm_drp_table->drp_state = DRP_INIT_STATE; + training_set_timmer_en = false; + } else { + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[Start DRP Training] cnt_crc32_ok_all = ((%d))\n", false_alm_cnt->cnt_crc32_ok_all)); + p_dm_drp_table->drp_state = DRP_TRAINING_STATE_0; + p_dm_drp_table->curr_rx_path = BB_PATH_AB; + training_set_timmer_en = true; + } + + } else if (p_dm_drp_table->drp_state == DRP_TRAINING_STATE_0) { + + phydm_drp_get_statistic(p_dm); + + p_dm_drp_table->curr_cca_all_cnt_0 = false_alm_cnt->cnt_cca_all; + p_dm_drp_table->curr_fa_all_cnt_0 = false_alm_cnt->cnt_all; + + p_dm_drp_table->drp_state = DRP_TRAINING_STATE_1; + p_dm_drp_table->curr_rx_path = BB_PATH_B; + training_set_timmer_en = true; + + } else if (p_dm_drp_table->drp_state == DRP_TRAINING_STATE_1) { + + phydm_drp_get_statistic(p_dm); + + p_dm_drp_table->curr_cca_all_cnt_1 = false_alm_cnt->cnt_cca_all; + p_dm_drp_table->curr_fa_all_cnt_1 = false_alm_cnt->cnt_all; + +#if 1 + p_dm_drp_table->drp_state = DRP_DECISION_STATE; +#else + + if (*(p_dm->p_mp_mode)) { + rx_ok_cal = p_dm->phy_dbg_info.num_qry_phy_status_cck + p_dm->phy_dbg_info.num_qry_phy_status_ofdm; + RSSI = (rx_ok_cal != 0) ? p_dm->rx_pwdb_ave / rx_ok_cal : 0; + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("MP RSSI = ((%d))\n", RSSI)); + } + + if (RSSI > p_dm_drp_table->rssi_threshold) + + p_dm_drp_table->drp_state = DRP_DECISION_STATE; + + else { + + p_dm_drp_table->drp_state = DRP_TRAINING_STATE_2; + p_dm_drp_table->curr_rx_path = BB_PATH_A; + training_set_timmer_en = true; + } +#endif + } else if (p_dm_drp_table->drp_state == DRP_TRAINING_STATE_2) { + + phydm_drp_get_statistic(p_dm); + + p_dm_drp_table->curr_cca_all_cnt_2 = false_alm_cnt->cnt_cca_all; + p_dm_drp_table->curr_fa_all_cnt_2 = false_alm_cnt->cnt_all; + p_dm_drp_table->drp_state = DRP_DECISION_STATE; + } + + if (p_dm_drp_table->drp_state == DRP_DECISION_STATE) { + + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("Current drp_state = ((%d))\n", p_dm_drp_table->drp_state)); + + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[0] {CCA, FA} = {%d, %d}\n", p_dm_drp_table->curr_cca_all_cnt_0, p_dm_drp_table->curr_fa_all_cnt_0)); + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[1] {CCA, FA} = {%d, %d}\n", p_dm_drp_table->curr_cca_all_cnt_1, p_dm_drp_table->curr_fa_all_cnt_1)); + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[2] {CCA, FA} = {%d, %d}\n", p_dm_drp_table->curr_cca_all_cnt_2, p_dm_drp_table->curr_fa_all_cnt_2)); + + if (p_dm_drp_table->curr_fa_all_cnt_1 < p_dm_drp_table->curr_fa_all_cnt_0) { + + if ((p_dm_drp_table->curr_fa_all_cnt_0 - p_dm_drp_table->curr_fa_all_cnt_1) > p_dm_drp_table->fa_diff_threshold) + p_dm_drp_table->curr_rx_path = BB_PATH_B; + else + p_dm_drp_table->curr_rx_path = BB_PATH_AB; + } else + p_dm_drp_table->curr_rx_path = BB_PATH_AB; + + phydm_config_ofdm_rx_path(p_dm, p_dm_drp_table->curr_rx_path); + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[Training Result] curr_rx_path = ((%s%s)),\n", + ((p_dm_drp_table->curr_rx_path & BB_PATH_A) ? "A" : " "), ((p_dm_drp_table->curr_rx_path & BB_PATH_B) ? "B" : " "))); + + p_dm_drp_table->drp_state = DRP_INIT_STATE; + training_set_timmer_en = false; + } + + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("DRP_state: ((%d)) -> ((%d))\n", curr_drp_state, p_dm_drp_table->drp_state)); + + if (training_set_timmer_en) { + + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[Training en] curr_rx_path = ((%s%s)), training_time = ((%d ms))\n", + ((p_dm_drp_table->curr_rx_path & BB_PATH_A) ? "A" : " "), ((p_dm_drp_table->curr_rx_path & BB_PATH_B) ? "B" : " "), p_dm_drp_table->training_time)); + + phydm_config_ofdm_rx_path(p_dm, p_dm_drp_table->curr_rx_path); + odm_set_timer(p_dm, &(p_dm_drp_table->phydm_dynamic_rx_path_timer), p_dm_drp_table->training_time); /*ms*/ + } else + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("DRP period end\n\n", curr_drp_state, p_dm_drp_table->drp_state)); + +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +phydm_dynamic_rx_path_callback( + struct timer_list *p_timer +) +{ + struct _ADAPTER *adapter = (struct _ADAPTER *)p_timer->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &(p_hal_data->DM_OutSrc); + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE +#if USE_WORKITEM + odm_schedule_work_item(&(p_dm_drp_table->phydm_dynamic_rx_path_workitem)); +#else + { + /* dbg_print("phydm_dynamic_rx_path\n"); */ + phydm_dynamic_rx_path(p_dm); + } +#endif +#else + odm_schedule_work_item(&(p_dm_drp_table->phydm_dynamic_rx_path_workitem)); +#endif +} + +void +phydm_dynamic_rx_path_workitem_callback( + void *p_context +) +{ + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct PHY_DM_STRUCT *p_dm = &(p_hal_data->DM_OutSrc); + + /* dbg_print("phydm_dynamic_rx_path\n"); */ + phydm_dynamic_rx_path(p_dm); +} +#else if (DM_ODM_SUPPORT_TYPE == ODM_CE) + +void +phydm_dynamic_rx_path_callback( + void *function_context +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)function_context; + struct _ADAPTER *padapter = p_dm->adapter; + + if (padapter->net_closed == true) + return; + +#if 0 /* Can't do I/O in timer callback*/ + odm_s0s1_sw_ant_div(p_dm, SWAW_STEP_DETERMINE); +#else + /*rtw_run_in_thread_cmd(padapter, odm_sw_antdiv_workitem_callback, padapter);*/ +#endif +} + +#endif + +void +phydm_dynamic_rx_path_timers( + void *p_dm_void, + u8 state +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + + if (state == INIT_DRP_TIMMER) { + + odm_initialize_timer(p_dm, &(p_dm_drp_table->phydm_dynamic_rx_path_timer), + (void *)phydm_dynamic_rx_path_callback, NULL, "phydm_sw_antenna_switch_timer"); + } else if (state == CANCEL_DRP_TIMMER) + + odm_cancel_timer(p_dm, &(p_dm_drp_table->phydm_dynamic_rx_path_timer)); + + else if (state == RELEASE_DRP_TIMMER) + + odm_release_timer(p_dm, &(p_dm_drp_table->phydm_dynamic_rx_path_timer)); + +} + +void +phydm_dynamic_rx_path_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + boolean ret_value; + + if (!(p_dm->support_ability & ODM_BB_DYNAMIC_RX_PATH)) { + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("[Return] Not Support Dynamic RX PAth\n")); + return; + } + PHYDM_DBG(p_dm, DBG_DYN_RX_PATH, ("phydm_dynamic_rx_path_init\n")); + + p_dm_drp_table->drp_state = DRP_INIT_STATE; + p_dm_drp_table->rssi_threshold = DRP_RSSI_TH; + p_dm_drp_table->fa_count_thresold = 50; + p_dm_drp_table->fa_diff_threshold = 50; + p_dm_drp_table->training_time = 100; /*ms*/ + p_dm_drp_table->drp_skip_counter = 0; + p_dm_drp_table->drp_period = 0; + p_dm_drp_table->drp_init_finished = true; + + ret_value = phydm_api_trx_mode(p_dm, (enum bb_path)BB_PATH_AB, (enum bb_path)BB_PATH_AB, true); + +} + +void +phydm_drp_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 used = *_used; + u32 out_len = *_out_len; + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + + switch (dm_value[0]) { + + case DRP_TRAINING_TIME: + p_dm_drp_table->training_time = (u16)dm_value[1]; + break; + case DRP_TRAINING_PERIOD: + p_dm_drp_table->drp_period = (u8)dm_value[1]; + break; + case DRP_RSSI_THRESHOLD: + p_dm_drp_table->rssi_threshold = (u8)dm_value[1]; + break; + case DRP_FA_THRESHOLD: + p_dm_drp_table->fa_count_thresold = dm_value[1]; + break; + case DRP_FA_DIFF_THRESHOLD: + p_dm_drp_table->fa_diff_threshold = dm_value[1]; + break; + default: + PHYDM_SNPRINTF((output + used, out_len - used, "[DRP] unknown command\n")); + break; + } + + *_used = used; + *_out_len = out_len; +} + +void +phydm_dynamic_rx_path_caller( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _DYNAMIC_RX_PATH_ *p_dm_drp_table = &(p_dm->dm_drp_table); + + if (p_dm_drp_table->drp_skip_counter < p_dm_drp_table->drp_period) + p_dm_drp_table->drp_skip_counter++; + else + p_dm_drp_table->drp_skip_counter = 0; + + if (p_dm_drp_table->drp_skip_counter != 0) + return; + + if (p_dm_drp_table->drp_init_finished != true) + return; + + phydm_dynamic_rx_path(p_dm); + +} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.h new file mode 100644 index 000000000000..2b1a82d15805 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamic_rx_path.h @@ -0,0 +1,141 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMDYMICRXPATH_H__ +#define __PHYDMDYMICRXPATH_H__ + +#define DYNAMIC_RX_PATH_VERSION "1.0" /*2016.07.15 Dino */ + + +#define DRP_RSSI_TH 35 + +#define INIT_DRP_TIMMER 0 +#define CANCEL_DRP_TIMMER 1 +#define RELEASE_DRP_TIMMER 2 + +#if (RTL8822B_SUPPORT == 1) +struct drp_rtl8822b_struct { + enum bb_path path_judge; + u16 path_a_cck_fa; + u16 path_b_cck_fa; + +}; +#endif + +#ifdef CONFIG_DYNAMIC_RX_PATH + +enum drp_state_e { + DRP_INIT_STATE = 0, + DRP_TRAINING_STATE_0 = 1, + DRP_TRAINING_STATE_1 = 2, + DRP_TRAINING_STATE_2 = 3, + DRP_DECISION_STATE = 4 +}; + +enum adjustable_value_e { + DRP_TRAINING_TIME = 0, + DRP_TRAINING_PERIOD = 1, + DRP_RSSI_THRESHOLD = 2, + DRP_FA_THRESHOLD = 3, + DRP_FA_DIFF_THRESHOLD = 4 +}; + +struct _DYNAMIC_RX_PATH_ { + u8 curr_rx_path; + u8 drp_state; + u16 training_time; + u8 rssi_threshold; + u32 fa_count_thresold; + u32 fa_diff_threshold; + u32 curr_cca_all_cnt_0; + u32 curr_fa_all_cnt_0; + u32 curr_cca_all_cnt_1; + u32 curr_fa_all_cnt_1; + u32 curr_cca_all_cnt_2; + u32 curr_fa_all_cnt_2; + u8 drp_skip_counter; + u8 drp_period; + u8 drp_init_finished; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if USE_WORKITEM + RT_WORK_ITEM phydm_dynamic_rx_path_workitem; +#endif +#endif + struct timer_list phydm_dynamic_rx_path_timer; + +}; + + + +void +phydm_process_phy_status_for_dynamic_rx_path( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void +); + +void +phydm_dynamic_rx_path( + void *p_dm_void +); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +phydm_dynamic_rx_path_callback( + struct timer_list *p_timer +); + +void +phydm_dynamic_rx_path_workitem_callback( + void *p_context +); + +#else if (DM_ODM_SUPPORT_TYPE == ODM_CE) + +void +phydm_dynamic_rx_path_callback( + void *function_context +); + +#endif + +void +phydm_dynamic_rx_path_timers( + void *p_dm_void, + u8 state +); + +void +phydm_dynamic_rx_path_init( + void *p_dm_void +); + +void +phydm_drp_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_dynamic_rx_path_caller( + void *p_dm_void +); + +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.c deleted file mode 100644 index 1b38560ff925..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.c +++ /dev/null @@ -1,124 +0,0 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if (defined(CONFIG_BB_POWER_SAVING)) - -VOID -odm_DynamicBBPowerSavingInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; - - pDM_PSTable->PreCCAState = CCA_MAX; - pDM_PSTable->CurCCAState = CCA_MAX; - pDM_PSTable->PreRFState = RF_MAX; - pDM_PSTable->CurRFState = RF_MAX; - pDM_PSTable->Rssi_val_min = 0; - pDM_PSTable->initialize = 0; -} - -void -ODM_RF_Saving( - IN PVOID pDM_VOID, - IN u1Byte bForceInNormal - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) - pPS_T pDM_PSTable = &pDM_Odm->DM_PSTable; - u1Byte Rssi_Up_bound = 30 ; - u1Byte Rssi_Low_bound = 25; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if(pDM_Odm->PatchID == 40 ) //RT_CID_819x_FUNAI_TV - { - Rssi_Up_bound = 50 ; - Rssi_Low_bound = 45; - } -#endif - if(pDM_PSTable->initialize == 0){ - - pDM_PSTable->Reg874 = (ODM_GetBBReg(pDM_Odm, 0x874, bMaskDWord)&0x1CC000)>>14; - pDM_PSTable->RegC70 = (ODM_GetBBReg(pDM_Odm, 0xc70, bMaskDWord)&BIT3)>>3; - pDM_PSTable->Reg85C = (ODM_GetBBReg(pDM_Odm, 0x85c, bMaskDWord)&0xFF000000)>>24; - pDM_PSTable->RegA74 = (ODM_GetBBReg(pDM_Odm, 0xa74, bMaskDWord)&0xF000)>>12; - //Reg818 = PHY_QueryBBReg(pAdapter, 0x818, bMaskDWord); - pDM_PSTable->initialize = 1; - } - - if(!bForceInNormal) - { - if(pDM_Odm->RSSI_Min != 0xFF) - { - if(pDM_PSTable->PreRFState == RF_Normal) - { - if(pDM_Odm->RSSI_Min >= Rssi_Up_bound) - pDM_PSTable->CurRFState = RF_Save; - else - pDM_PSTable->CurRFState = RF_Normal; - } - else{ - if(pDM_Odm->RSSI_Min <= Rssi_Low_bound) - pDM_PSTable->CurRFState = RF_Normal; - else - pDM_PSTable->CurRFState = RF_Save; - } - } - else - pDM_PSTable->CurRFState=RF_MAX; - } - else - { - pDM_PSTable->CurRFState = RF_Normal; - } - - if(pDM_PSTable->PreRFState != pDM_PSTable->CurRFState) - { - if(pDM_PSTable->CurRFState == RF_Save) - { - ODM_SetBBReg(pDM_Odm, 0x874 , 0x1C0000, 0x2); //Reg874[20:18]=3'b010 - ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, 0); //RegC70[3]=1'b0 - ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, 0x63); //Reg85C[31:24]=0x63 - ODM_SetBBReg(pDM_Odm, 0x874, 0xC000, 0x2); //Reg874[15:14]=2'b10 - ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, 0x3); //RegA75[7:4]=0x3 - ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x0); //Reg818[28]=1'b0 - ODM_SetBBReg(pDM_Odm, 0x818, BIT28, 0x1); //Reg818[28]=1'b1 - } - else - { - ODM_SetBBReg(pDM_Odm, 0x874 , 0x1CC000, pDM_PSTable->Reg874); - ODM_SetBBReg(pDM_Odm, 0xc70, BIT3, pDM_PSTable->RegC70); - ODM_SetBBReg(pDM_Odm, 0x85c, 0xFF000000, pDM_PSTable->Reg85C); - ODM_SetBBReg(pDM_Odm, 0xa74, 0xF000, pDM_PSTable->RegA74); - ODM_SetBBReg(pDM_Odm,0x818, BIT28, 0x0); - } - pDM_PSTable->PreRFState =pDM_PSTable->CurRFState; - } -#endif -} - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.h deleted file mode 100644 index aa0b9b3ed927..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamicbbpowersaving.h +++ /dev/null @@ -1,58 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMDYNAMICBBPOWERSAVING_H__ -#define __PHYDMDYNAMICBBPOWERSAVING_H__ - -#define DYNAMIC_BBPWRSAV_VERSION "1.1" - -#if (defined(CONFIG_BB_POWER_SAVING)) - -typedef struct _Dynamic_Power_Saving_ -{ - u1Byte PreCCAState; - u1Byte CurCCAState; - - u1Byte PreRFState; - u1Byte CurRFState; - - int Rssi_val_min; - - u1Byte initialize; - u4Byte Reg874,RegC70,Reg85C,RegA74; - -}PS_T,*pPS_T; - -#define dm_RF_Saving ODM_RF_Saving - -void ODM_RF_Saving( - IN PVOID pDM_VOID, - IN u1Byte bForceInNormal -); - -VOID -odm_DynamicBBPowerSavingInit( - IN PVOID pDM_VOID - ); -#else -#define dm_RF_Saving(pDM_VOID, bForceInNormal) -#endif - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.c index 79c1729f3df5..cc3a149222fb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.c @@ -1,542 +1,456 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -VOID -odm_DynamicTxPowerInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - /*if (!IS_HARDWARE_TYPE_8814A(Adapter)) {*/ - /* ODM_RT_TRACE(pDM_Odm,ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, */ - /* ("odm_DynamicTxPowerInit DynamicTxPowerEnable=%d\n", pMgntInfo->bDynamicTxPowerEnable));*/ - /* return;*/ - /*} else*/ - { - pMgntInfo->bDynamicTxPowerEnable = TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, - ("odm_DynamicTxPowerInit DynamicTxPowerEnable=%d\n", pMgntInfo->bDynamicTxPowerEnable)); - } - - #if DEV_BUS_TYPE==RT_USB_INTERFACE - if(RT_GetInterfaceSelection(Adapter) == INTF_SEL1_USB_High_Power) - { - odm_DynamicTxPowerSavePowerIndex(pDM_Odm); - pMgntInfo->bDynamicTxPowerEnable = TRUE; - } - else - #else - //so 92c pci do not need dynamic tx power? vivi check it later - pMgntInfo->bDynamicTxPowerEnable = FALSE; - #endif - - - pHalData->LastDTPLvl = TxHighPwrLevel_Normal; - pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - pDM_Odm->LastDTPLvl = TxHighPwrLevel_Normal; - pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; - pDM_Odm->tx_agc_ofdm_18_6 = ODM_GetBBReg(pDM_Odm, 0xC24, bMaskDWord); /*TXAGC {18M 12M 9M 6M}*/ - -#endif - -} - -VOID -odm_DynamicTxPowerSavePowerIndex( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - u1Byte index; - u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - for(index = 0; index< 6; index++) - pHalData->PowerIndex_backup[index] = PlatformEFIORead1Byte(Adapter, Power_Index_REG[index]); - - -#endif -#endif -} - -VOID -odm_DynamicTxPowerRestorePowerIndex( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - u1Byte index; - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - for(index = 0; index< 6; index++) - PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], pHalData->PowerIndex_backup[index]); - - -#endif -#endif -} - -VOID -odm_DynamicTxPowerWritePowerIndex( - IN PVOID pDM_VOID, - IN u1Byte Value) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte index; - u4Byte Power_Index_REG[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; - - for(index = 0; index< 6; index++) - //PlatformEFIOWrite1Byte(Adapter, Power_Index_REG[index], Value); - ODM_Write1Byte(pDM_Odm, Power_Index_REG[index], Value); - -} - -VOID -odm_DynamicTxPowerNIC_CE( - IN PVOID pDM_VOID - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -#if (RTL8821A_SUPPORT == 1) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte val; - u1Byte rssi_tmp = pDM_Odm->RSSI_Min; - - if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) - return; - - if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { - pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; - /**/ - } else if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL1) { - pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; - /**/ - } else if (rssi_tmp < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) { - pDM_Odm->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; - /**/ - } - - if (pDM_Odm->LastDTPLvl != pDM_Odm->DynamicTxHighPowerLvl) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("update_DTP_lv: ((%d)) -> ((%d))\n", pDM_Odm->LastDTPLvl, pDM_Odm->DynamicTxHighPowerLvl)); - - pDM_Odm->LastDTPLvl = pDM_Odm->DynamicTxHighPowerLvl; - - if (pDM_Odm->SupportICType & (ODM_RTL8821)) { - - if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Level2) { - - ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 1); /* Resp TXAGC offset = -3dB*/ - - val = pDM_Odm->tx_agc_ofdm_18_6 & 0xff; - if (val >= 0x20) - val -= 0x16; - - ODM_SetBBReg(pDM_Odm, 0xC24, 0xff, val); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 2\n")); - } else if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Level1) { - - ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 1); /* Resp TXAGC offset = -3dB*/ - - val = pDM_Odm->tx_agc_ofdm_18_6 & 0xff; - if (val >= 0x20) - val -= 0x10; - - ODM_SetBBReg(pDM_Odm, 0xC24, 0xff, val); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: level 1\n")); - } else if (pDM_Odm->DynamicTxHighPowerLvl == TxHighPwrLevel_Normal) { - - ODM_SetMACReg(pDM_Odm, 0x6D8, BIT20|BIT19|BIT18, 0); /* Resp TXAGC offset = 0dB*/ - ODM_SetBBReg(pDM_Odm, 0xC24, bMaskDWord, pDM_Odm->tx_agc_ofdm_18_6); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, ODM_DBG_LOUD, ("Set TX power: normal\n")); - } - } - } - -#endif -#endif -} - - -VOID -odm_DynamicTxPower( - IN PVOID pDM_VOID - ) -{ - // - // For AP/ADSL use prtl8192cd_priv - // For CE/NIC use PADAPTER - // - //PADAPTER pAdapter = pDM_Odm->Adapter; -// prtl8192cd_priv priv = pDM_Odm->priv; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) - return; - // - // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate - // at the same time. In the stage2/3, we need to prive universal interface and merge all - // HW dynamic mechanism. - // - switch (pDM_Odm->SupportPlatform) - { - case ODM_WIN: - odm_DynamicTxPowerNIC(pDM_Odm); - break; - case ODM_CE: - odm_DynamicTxPowerNIC_CE(pDM_Odm); - break; - case ODM_AP: - odm_DynamicTxPowerAP(pDM_Odm); - break; - default: - break; - } - - -} - - -VOID -odm_DynamicTxPowerNIC( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_TXPWR)) - return; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - if (pDM_Odm->SupportICType == ODM_RTL8814A) { - odm_DynamicTxPower_8814A(pDM_Odm); - } else if (pDM_Odm->SupportICType & ODM_RTL8821) { - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); - - if (pMgntInfo->RegRspPwr == 1) { - if (pDM_Odm->RSSI_Min > 60) - ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 1); /*Resp TXAGC offset = -3dB*/ - else if (pDM_Odm->RSSI_Min < 55) - ODM_SetMACReg(pDM_Odm, ODM_REG_RESP_TX_11AC, BIT20|BIT19|BIT18, 0); /*Resp TXAGC offset = 0dB*/ - } - } -#endif -} - -VOID -odm_DynamicTxPowerAP( - IN PVOID pDM_VOID - - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - -//#if ((RTL8192C_SUPPORT==1) || (RTL8192D_SUPPORT==1) || (RTL8188E_SUPPORT==1) || (RTL8812E_SUPPORT==1)) - - - prtl8192cd_priv priv = pDM_Odm->priv; - s4Byte i; - s2Byte pwr_thd = 63; - - if(!priv->pshare->rf_ft_var.tx_pwr_ctrl) - return; - -#if ((RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1)) - if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A)) - pwr_thd = TX_POWER_NEAR_FIELD_THRESH_LVL1; -#endif - - /* - * Check if station is near by to use lower tx power - */ - - if ((priv->up_time % 3) == 0 ) { - int disable_pwr_ctrl = ((pDM_Odm->FalseAlmCnt.Cnt_all > 1000 ) || ((pDM_Odm->FalseAlmCnt.Cnt_all > 300 ) && ((RTL_R8(0xc50) & 0x7f) >= 0x32))) ? 1 : 0; - - for(i=0; ipODM_StaInfo[i]; - if(IS_STA_VALID(pstat) ) { - if(disable_pwr_ctrl) - pstat->hp_level = 0; - else if ((pstat->hp_level == 0) && (pstat->rssi > pwr_thd)) - pstat->hp_level = 1; - else if ((pstat->hp_level == 1) && (pstat->rssi < (pwr_thd-8))) - pstat->hp_level = 0; - } - } - -#if defined(CONFIG_WLAN_HAL_8192EE) - if (GET_CHIP_VER(priv) == VERSION_8192E) { - if( !disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff) ) { - if(pDM_Odm->RSSI_Min > pwr_thd) - RRSR_power_control_11n(priv, 1 ); - else if(pDM_Odm->RSSI_Min < (pwr_thd-8)) - RRSR_power_control_11n(priv, 0 ); - } else { - RRSR_power_control_11n(priv, 0 ); - } - } -#endif - -#ifdef CONFIG_WLAN_HAL_8814AE - if (GET_CHIP_VER(priv) == VERSION_8814A) { - if (!disable_pwr_ctrl && (pDM_Odm->RSSI_Min != 0xff)) { - if (pDM_Odm->RSSI_Min > pwr_thd) - RRSR_power_control_14(priv, 1); - else if (pDM_Odm->RSSI_Min < (pwr_thd-8)) - RRSR_power_control_14(priv, 0); - } else { - RRSR_power_control_14(priv, 0); - } - } -#endif - - } -//#endif - -#endif -} - -VOID -odm_DynamicTxPower_8821( - IN PVOID pDM_VOID, - IN pu1Byte pDesc, - IN u1Byte macId - ) -{ -#if (RTL8821A_SUPPORT == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PSTA_INFO_T pEntry; - u1Byte reg0xc56_byte; - u1Byte txpwr_offset = 0; - - pEntry = pDM_Odm->pODM_StaInfo[macId]; - - reg0xc56_byte = ODM_Read1Byte(pDM_Odm, 0xc56); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("reg0xc56_byte=%d\n", reg0xc56_byte)); - - if (pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB > 85) { - - /* Avoid TXAGC error after TX power offset is applied. - For example: Reg0xc56=0x6, if txpwr_offset=3( reduce 11dB ) - Total power = 6-11= -5( overflow!! ), PA may be burned ! - so txpwr_offset should be adjusted by Reg0xc56*/ - - if (reg0xc56_byte < 7) - txpwr_offset = 1; - else if (reg0xc56_byte < 11) - txpwr_offset = 2; - else - txpwr_offset = 3; - - SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); - - } else{ - SET_TX_DESC_TX_POWER_OFFSET_8812(pDesc, txpwr_offset); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8821: RSSI=%d, txpwr_offset=%d\n", pEntry[macId].rssi_stat.UndecoratedSmoothedPWDB, txpwr_offset)); - - } -#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ -#endif /*#if (RTL8821A_SUPPORT==1)*/ -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -odm_DynamicTxPower_8814A( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - s4Byte UndecoratedSmoothedPWDB; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, - ("TxLevel=%d pMgntInfo->IOTAction=%x pMgntInfo->bDynamicTxPowerEnable=%d\n", - pHalData->DynamicTxHighPowerLvl, pMgntInfo->IOTAction, pMgntInfo->bDynamicTxPowerEnable)); - - /*STA not connected and AP not connected*/ - if ((!pMgntInfo->bMediaConnect) && (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("Not connected to any reset power lvl\n")); - pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; - return; - } - - - if ((pMgntInfo->bDynamicTxPowerEnable != TRUE) || pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER) { - pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; - } else { - if (pMgntInfo->bMediaConnect) { /*Default port*/ - if (ACTING_AS_AP(Adapter) || ACTING_AS_IBSS(Adapter)) { - UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Client PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); - } else { - UndecoratedSmoothedPWDB = pHalData->UndecoratedSmoothedPWDB; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("STA Default Port PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); - } - } else {/*associated entry pwdb*/ - UndecoratedSmoothedPWDB = pHalData->EntryMinUndecoratedSmoothedPWDB; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("AP Ext Port PWDB = 0x%x\n", UndecoratedSmoothedPWDB)); - } - - /*Should we separate as 2.4G/5G band?*/ - - if (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { - pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level2; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x0)\n")); - } else if ((UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL2-3)) && - (UndecoratedSmoothedPWDB >= TX_POWER_NEAR_FIELD_THRESH_LVL1)) { - pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Level1; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Level1 (TxPwr=0x10)\n")); - } else if (UndecoratedSmoothedPWDB < (TX_POWER_NEAR_FIELD_THRESH_LVL1-5)) { - pHalData->DynamicTxHighPowerLvl = TxHighPwrLevel_Normal; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("TxHighPwrLevel_Normal\n")); - } - } - - - if (pHalData->DynamicTxHighPowerLvl != pHalData->LastDTPLvl) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, ("odm_DynamicTxPower_8814A() Channel = %d\n" , pHalData->CurrentChannel)); - odm_SetTxPowerLevel8814(Adapter, pHalData->CurrentChannel, pHalData->DynamicTxHighPowerLvl); - } - - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_DYNAMIC_TXPWR, DBG_LOUD, - ("odm_DynamicTxPower_8814A() Channel = %d TXpower lvl=%d/%d\n" , - pHalData->CurrentChannel, pHalData->LastDTPLvl, pHalData->DynamicTxHighPowerLvl)); - - pHalData->LastDTPLvl = pHalData->DynamicTxHighPowerLvl; - -} - - - -/**/ -/*For normal driver we always use the FW method to configure TX power index to reduce I/O transaction.*/ -/**/ -/**/ -VOID -odm_SetTxPowerLevel8814( - IN PADAPTER Adapter, - IN u1Byte Channel, - IN u1Byte PwrLvl - ) -{ -#if (DEV_BUS_TYPE == RT_USB_INTERFACE) - u4Byte i, j, k = 0; - u4Byte value[264] = {0}; - u4Byte path = 0, PowerIndex, txagc_table_wd = 0x00801000; - - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - u1Byte jaguar2Rates[][4] = { {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, - {MGN_6M, MGN_9M, MGN_12M, MGN_18M}, - {MGN_24M, MGN_36M, MGN_48M, MGN_54M}, - {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3}, - {MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}, - {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11}, - {MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}, - {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19}, - {MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}, - {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3}, - {MGN_VHT1SS_MCS4, MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7}, - {MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9, MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1}, - {MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, MGN_VHT2SS_MCS5}, - {MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}, - {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3}, - {MGN_VHT3SS_MCS4, MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7}, - {MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9, 0, 0} }; - - for (path = ODM_RF_PATH_A; path <= ODM_RF_PATH_D; ++path) { - - u1Byte usb_host = UsbModeQueryHubUsbType(Adapter); - u1Byte usb_rfset = UsbModeQueryRfSet(Adapter); - u1Byte usb_rf_type = RT_GetRFType(Adapter); - - for (i = 0; i <= 16; i++) { - for (j = 0; j <= 3; j++) { - if (jaguar2Rates[i][j] == 0) - continue; - - txagc_table_wd = 0x00801000; - PowerIndex = (u4Byte) PHY_GetTxPowerIndex(Adapter, (u1Byte)path, jaguar2Rates[i][j], pHalData->CurrentChannelBW, Channel); - - /*for Query bus type to recude tx power.*/ - if (usb_host != USB_MODE_U3 && usb_rfset == 1 && IS_HARDWARE_TYPE_8814AU(Adapter) && usb_rf_type == RF_3T3R) { - if (Channel <= 14) { - if (PowerIndex >= 16) - PowerIndex -= 16; - else - PowerIndex = 0; - } else - PowerIndex = 0; - } - - if (PwrLvl == TxHighPwrLevel_Level1) { - if (PowerIndex >= 0x10) - PowerIndex -= 0x10; - else - PowerIndex = 0; - } else if (PwrLvl == TxHighPwrLevel_Level2) { - PowerIndex = 0; - } - - txagc_table_wd |= (path << 8) | MRateToHwRate(jaguar2Rates[i][j]) | (PowerIndex << 24); - - PHY_SetTxPowerIndexShadow(Adapter, (u1Byte)PowerIndex, (u1Byte)path, jaguar2Rates[i][j]); - - value[k++] = txagc_table_wd; - } - } - } - - if (Adapter->MgntInfo.bScanInProgress == FALSE && Adapter->MgntInfo.RegFWOffload == 2) - HalDownloadTxPowerLevel8814(Adapter, value); -#endif -} -#endif - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void +phydm_dynamic_tx_power_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + /*if (!IS_HARDWARE_TYPE_8814A(adapter)) {*/ + /* PHYDM_DBG(p_dm,DBG_DYN_TXPWR, */ + /* ("phydm_dynamic_tx_power_init DynamicTxPowerEnable=%d\n", p_mgnt_info->is_dynamic_tx_power_enable));*/ + /* return;*/ + /*} else*/ + { + p_mgnt_info->bDynamicTxPowerEnable = true; + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, + ("phydm_dynamic_tx_power_init DynamicTxPowerEnable=%d\n", p_mgnt_info->bDynamicTxPowerEnable)); + } + +#if DEV_BUS_TYPE == RT_USB_INTERFACE + if (RT_GetInterfaceSelection(adapter) == INTF_SEL1_USB_High_Power) { + odm_dynamic_tx_power_save_power_index(p_dm); + p_mgnt_info->bDynamicTxPowerEnable = true; + } else +#else + /* so 92c pci do not need dynamic tx power? vivi check it later */ + p_mgnt_info->bDynamicTxPowerEnable = false; +#endif + + + p_hal_data->LastDTPLvl = tx_high_pwr_level_normal; + p_hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_normal; + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + + p_dm->last_dtp_lvl = tx_high_pwr_level_normal; + p_dm->dynamic_tx_high_power_lvl = tx_high_pwr_level_normal; + p_dm->tx_agc_ofdm_18_6 = odm_get_bb_reg(p_dm, 0xC24, MASKDWORD); /*TXAGC {18M 12M 9M 6M}*/ + +#endif + +} + +void +odm_dynamic_tx_power_save_power_index( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 index; + u32 power_index_reg[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + for (index = 0; index < 6; index++) + p_hal_data->PowerIndex_backup[index] = PlatformEFIORead1Byte(adapter, power_index_reg[index]); + + +#endif +#endif +} + +void +odm_dynamic_tx_power_restore_power_index( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 index; + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + u32 power_index_reg[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; + + for (index = 0; index < 6; index++) + PlatformEFIOWrite1Byte(adapter, power_index_reg[index], p_hal_data->PowerIndex_backup[index]); + + + +#endif +} + +void +odm_dynamic_tx_power_write_power_index( + void *p_dm_void, + u8 value) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 index; + u32 power_index_reg[6] = {0xc90, 0xc91, 0xc92, 0xc98, 0xc99, 0xc9a}; + + for (index = 0; index < 6; index++) + /* platform_efio_write_1byte(adapter, power_index_reg[index], value); */ + odm_write_1byte(p_dm, power_index_reg[index], value); + +} + +void +odm_dynamic_tx_power_nic_ce( + void *p_dm_void +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) +#if (RTL8821A_SUPPORT == 1) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 val; + u8 rssi_tmp = p_dm->rssi_min; + + if (!(p_dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + + if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { + p_dm->dynamic_tx_high_power_lvl = tx_high_pwr_level_level2; + /**/ + } else if (rssi_tmp >= TX_POWER_NEAR_FIELD_THRESH_LVL1) { + p_dm->dynamic_tx_high_power_lvl = tx_high_pwr_level_level1; + /**/ + } else if (rssi_tmp < (TX_POWER_NEAR_FIELD_THRESH_LVL1 - 5)) { + p_dm->dynamic_tx_high_power_lvl = tx_high_pwr_level_normal; + /**/ + } + + if (p_dm->last_dtp_lvl != p_dm->dynamic_tx_high_power_lvl) { + + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("update_DTP_lv: ((%d)) -> ((%d))\n", p_dm->last_dtp_lvl, p_dm->dynamic_tx_high_power_lvl)); + + p_dm->last_dtp_lvl = p_dm->dynamic_tx_high_power_lvl; + + if (p_dm->support_ic_type & (ODM_RTL8821)) { + + if (p_dm->dynamic_tx_high_power_lvl == tx_high_pwr_level_level2) { + + odm_set_mac_reg(p_dm, 0x6D8, BIT(20) | BIT19 | BIT18, 1); /* Resp TXAGC offset = -3dB*/ + + val = p_dm->tx_agc_ofdm_18_6 & 0xff; + if (val >= 0x20) + val -= 0x16; + + odm_set_bb_reg(p_dm, 0xC24, 0xff, val); + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("Set TX power: level 2\n")); + } else if (p_dm->dynamic_tx_high_power_lvl == tx_high_pwr_level_level1) { + + odm_set_mac_reg(p_dm, 0x6D8, BIT(20) | BIT19 | BIT18, 1); /* Resp TXAGC offset = -3dB*/ + + val = p_dm->tx_agc_ofdm_18_6 & 0xff; + if (val >= 0x20) + val -= 0x10; + + odm_set_bb_reg(p_dm, 0xC24, 0xff, val); + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("Set TX power: level 1\n")); + } else if (p_dm->dynamic_tx_high_power_lvl == tx_high_pwr_level_normal) { + + odm_set_mac_reg(p_dm, 0x6D8, BIT(20) | BIT19 | BIT18, 0); /* Resp TXAGC offset = 0dB*/ + odm_set_bb_reg(p_dm, 0xC24, MASKDWORD, p_dm->tx_agc_ofdm_18_6); + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("Set TX power: normal\n")); + } + } + } + +#endif +#endif +} + + +void +odm_dynamic_tx_power( + void *p_dm_void +) +{ + /* */ + /* For AP/ADSL use struct rtl8192cd_priv* */ + /* For CE/NIC use struct _ADAPTER* */ + /* */ + /* struct _ADAPTER* p_adapter = p_dm->adapter; + * struct rtl8192cd_priv* priv = p_dm->priv; */ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + /* */ + /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate */ + /* at the same time. In the stage2/3, we need to prive universal interface and merge all */ + /* HW dynamic mechanism. */ + /* */ + switch (p_dm->support_platform) { + case ODM_WIN: + odm_dynamic_tx_power_nic(p_dm); + break; + case ODM_CE: + odm_dynamic_tx_power_nic_ce(p_dm); + break; + default: + break; + } + + +} + + +void +odm_dynamic_tx_power_nic( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & ODM_BB_DYNAMIC_TXPWR)) + return; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + + if (p_dm->support_ic_type == ODM_RTL8814A) + odm_dynamic_tx_power_8814a(p_dm); + else if (p_dm->support_ic_type & ODM_RTL8821) { + struct _ADAPTER *adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = GetDefaultMgntInfo(adapter); + + if (p_mgnt_info->RegRspPwr == 1) { + if (p_dm->rssi_min > 60) + odm_set_mac_reg(p_dm, ODM_REG_RESP_TX_11AC, BIT(20) | BIT19 | BIT18, 1); /*Resp TXAGC offset = -3dB*/ + else if (p_dm->rssi_min < 55) + odm_set_mac_reg(p_dm, ODM_REG_RESP_TX_11AC, BIT(20) | BIT19 | BIT18, 0); /*Resp TXAGC offset = 0dB*/ + } + } +#endif +} + + +void +odm_dynamic_tx_power_8821( + void *p_dm_void, + u8 *p_desc, + u8 mac_id +) +{ +#if (RTL8821A_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_entry; + u8 reg0xc56_byte; + u8 txpwr_offset = 0; + + p_entry = p_dm->p_phydm_sta_info[mac_id]; + + reg0xc56_byte = odm_read_1byte(p_dm, 0xc56); + + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("reg0xc56_byte=%d\n", reg0xc56_byte)); + + if (p_entry[mac_id].rssi_stat.rssi > 85) { + + /* Avoid TXAGC error after TX power offset is applied. + For example: Reg0xc56=0x6, if txpwr_offset=3( reduce 11dB ) + Total power = 6-11= -5( overflow!! ), PA may be burned ! + so txpwr_offset should be adjusted by Reg0xc56*/ + + if (reg0xc56_byte < 7) + txpwr_offset = 1; + else if (reg0xc56_byte < 11) + txpwr_offset = 2; + else + txpwr_offset = 3; + + SET_TX_DESC_TX_POWER_OFFSET_8812(p_desc, txpwr_offset); + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("odm_dynamic_tx_power_8821: RSSI=%d, txpwr_offset=%d\n", p_entry[mac_id].rssi_stat.rssi, txpwr_offset)); + + } else { + SET_TX_DESC_TX_POWER_OFFSET_8812(p_desc, txpwr_offset); + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("odm_dynamic_tx_power_8821: RSSI=%d, txpwr_offset=%d\n", p_entry[mac_id].rssi_stat.rssi, txpwr_offset)); + + } +#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ +#endif /*#if (RTL8821A_SUPPORT==1)*/ +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +odm_dynamic_tx_power_8814a( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + s32 undecorated_smoothed_pwdb; + + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, + ("TxLevel=%d p_mgnt_info->iot_action=%x p_mgnt_info->is_dynamic_tx_power_enable=%d\n", + p_hal_data->DynamicTxHighPowerLvl, p_mgnt_info->IOTAction, p_mgnt_info->bDynamicTxPowerEnable)); + + /*STA not connected and AP not connected*/ + if ((!p_mgnt_info->bMediaConnect) && (p_hal_data->EntryMinUndecoratedSmoothedPWDB == 0)) { + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("Not connected to any reset power lvl\n")); + p_hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_normal; + return; + } + + + if ((p_mgnt_info->bDynamicTxPowerEnable != true) || p_mgnt_info->IOTAction & HT_IOT_ACT_DISABLE_HIGH_POWER) + p_hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_normal; + else { + if (p_mgnt_info->bMediaConnect) { /*Default port*/ + if (ACTING_AS_AP(adapter) || ACTING_AS_IBSS(adapter)) { + undecorated_smoothed_pwdb = p_hal_data->EntryMinUndecoratedSmoothedPWDB; + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("AP Client PWDB = 0x%x\n", undecorated_smoothed_pwdb)); + } else { + undecorated_smoothed_pwdb = p_hal_data->UndecoratedSmoothedPWDB; + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("STA Default Port PWDB = 0x%x\n", undecorated_smoothed_pwdb)); + } + } else {/*associated entry pwdb*/ + undecorated_smoothed_pwdb = p_hal_data->EntryMinUndecoratedSmoothedPWDB; + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("AP Ext Port PWDB = 0x%x\n", undecorated_smoothed_pwdb)); + } + + /*Should we separate as 2.4G/5G band?*/ + + if (undecorated_smoothed_pwdb >= TX_POWER_NEAR_FIELD_THRESH_LVL2) { + p_hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_level2; + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("tx_high_pwr_level_level1 (TxPwr=0x0)\n")); + } else if ((undecorated_smoothed_pwdb < (TX_POWER_NEAR_FIELD_THRESH_LVL2 - 3)) && + (undecorated_smoothed_pwdb >= TX_POWER_NEAR_FIELD_THRESH_LVL1)) { + p_hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_level1; + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("tx_high_pwr_level_level1 (TxPwr=0x10)\n")); + } else if (undecorated_smoothed_pwdb < (TX_POWER_NEAR_FIELD_THRESH_LVL1 - 5)) { + p_hal_data->DynamicTxHighPowerLvl = tx_high_pwr_level_normal; + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("tx_high_pwr_level_normal\n")); + } + } + + + if (p_hal_data->DynamicTxHighPowerLvl != p_hal_data->LastDTPLvl) { + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, ("odm_dynamic_tx_power_8814a() channel = %d\n", p_hal_data->CurrentChannel)); + odm_set_tx_power_level8814(adapter, p_hal_data->CurrentChannel, p_hal_data->DynamicTxHighPowerLvl); + } + + + PHYDM_DBG(p_dm, DBG_DYN_TXPWR, + ("odm_dynamic_tx_power_8814a() channel = %d TXpower lvl=%d/%d\n", + p_hal_data->CurrentChannel, p_hal_data->LastDTPLvl, p_hal_data->DynamicTxHighPowerLvl)); + + p_hal_data->LastDTPLvl = p_hal_data->DynamicTxHighPowerLvl; + +} + + + +/**/ +/*For normal driver we always use the FW method to configure TX power index to reduce I/O transaction.*/ +/**/ +/**/ +void +odm_set_tx_power_level8814( + struct _ADAPTER *adapter, + u8 channel, + u8 pwr_lvl +) +{ +#if (DEV_BUS_TYPE == RT_USB_INTERFACE) + u32 i, j, k = 0; + u32 value[264] = {0}; + u32 path = 0, power_index, txagc_table_wd = 0x00801000; + + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + u8 jaguar2_rates[][4] = { {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M}, + {MGN_6M, MGN_9M, MGN_12M, MGN_18M}, + {MGN_24M, MGN_36M, MGN_48M, MGN_54M}, + {MGN_MCS0, MGN_MCS1, MGN_MCS2, MGN_MCS3}, + {MGN_MCS4, MGN_MCS5, MGN_MCS6, MGN_MCS7}, + {MGN_MCS8, MGN_MCS9, MGN_MCS10, MGN_MCS11}, + {MGN_MCS12, MGN_MCS13, MGN_MCS14, MGN_MCS15}, + {MGN_MCS16, MGN_MCS17, MGN_MCS18, MGN_MCS19}, + {MGN_MCS20, MGN_MCS21, MGN_MCS22, MGN_MCS23}, + {MGN_VHT1SS_MCS0, MGN_VHT1SS_MCS1, MGN_VHT1SS_MCS2, MGN_VHT1SS_MCS3}, + {MGN_VHT1SS_MCS4, MGN_VHT1SS_MCS5, MGN_VHT1SS_MCS6, MGN_VHT1SS_MCS7}, + {MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9, MGN_VHT2SS_MCS0, MGN_VHT2SS_MCS1}, + {MGN_VHT2SS_MCS2, MGN_VHT2SS_MCS3, MGN_VHT2SS_MCS4, MGN_VHT2SS_MCS5}, + {MGN_VHT2SS_MCS6, MGN_VHT2SS_MCS7, MGN_VHT2SS_MCS8, MGN_VHT2SS_MCS9}, + {MGN_VHT3SS_MCS0, MGN_VHT3SS_MCS1, MGN_VHT3SS_MCS2, MGN_VHT3SS_MCS3}, + {MGN_VHT3SS_MCS4, MGN_VHT3SS_MCS5, MGN_VHT3SS_MCS6, MGN_VHT3SS_MCS7}, + {MGN_VHT3SS_MCS8, MGN_VHT3SS_MCS9, 0, 0} + }; + + for (path = RF_PATH_A; path <= RF_PATH_D; ++path) { + + u8 usb_host = UsbModeQueryHubUsbType(adapter); + u8 usb_rfset = UsbModeQueryRfSet(adapter); + u8 usb_rf_type = RT_GetRFType(adapter); + + for (i = 0; i <= 16; i++) { + for (j = 0; j <= 3; j++) { + if (jaguar2_rates[i][j] == 0) + continue; + + txagc_table_wd = 0x00801000; + power_index = (u32) PHY_GetTxPowerIndex(adapter, (u8)path, jaguar2_rates[i][j], p_hal_data->CurrentChannelBW, channel); + + /*for Query bus type to recude tx power.*/ + if (usb_host != USB_MODE_U3 && usb_rfset == 1 && IS_HARDWARE_TYPE_8814AU(adapter) && usb_rf_type == RF_3T3R) { + if (channel <= 14) { + if (power_index >= 16) + power_index -= 16; + else + power_index = 0; + } else + power_index = 0; + } + + if (pwr_lvl == tx_high_pwr_level_level1) { + if (power_index >= 0x10) + power_index -= 0x10; + else + power_index = 0; + } else if (pwr_lvl == tx_high_pwr_level_level2) + power_index = 0; + + txagc_table_wd |= (path << 8) | MRateToHwRate(jaguar2_rates[i][j]) | (power_index << 24); + + PHY_SetTxPowerIndexShadow(adapter, (u8)power_index, (u8)path, jaguar2_rates[i][j]); + + value[k++] = txagc_table_wd; + } + } + } + + if (adapter->MgntInfo.bScanInProgress == false && adapter->MgntInfo.RegFWOffload == 2) + HalDownloadTxPowerLevel8814(adapter, value); +#endif +} +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.h index 9d1c7f52a4a6..c79f88c39f83 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_dynamictxpower.h @@ -1,110 +1,100 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMDYNAMICTXPOWER_H__ -#define __PHYDMDYNAMICTXPOWER_H__ - -/*#define DYNAMIC_TXPWR_VERSION "1.0"*/ -/*#define DYNAMIC_TXPWR_VERSION "1.3" */ /*2015.08.26, Add 8814 Dynamic TX power*/ -#define DYNAMIC_TXPWR_VERSION "1.4" /*2015.11.06, Add CE 8821A Dynamic TX power*/ - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 - #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 - #define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 - #define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 - #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 -#endif - -#define TxHighPwrLevel_Normal 0 -#define TxHighPwrLevel_Level1 1 -#define TxHighPwrLevel_Level2 2 - -#define TxHighPwrLevel_BT1 3 -#define TxHighPwrLevel_BT2 4 -#define TxHighPwrLevel_15 5 -#define TxHighPwrLevel_35 6 -#define TxHighPwrLevel_50 7 -#define TxHighPwrLevel_70 8 -#define TxHighPwrLevel_100 9 - -VOID -odm_DynamicTxPowerInit( - IN PVOID pDM_VOID - ); - -VOID -odm_DynamicTxPowerRestorePowerIndex( - IN PVOID pDM_VOID - ); - -VOID -odm_DynamicTxPowerNIC( - IN PVOID pDM_VOID - ); - -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -VOID -odm_DynamicTxPowerSavePowerIndex( - IN PVOID pDM_VOID - ); - -VOID -odm_DynamicTxPowerWritePowerIndex( - IN PVOID pDM_VOID, - IN u1Byte Value); - -VOID -odm_DynamicTxPower_8821( - IN PVOID pDM_VOID, - IN pu1Byte pDesc, - IN u1Byte macId - ); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -odm_DynamicTxPower_8814A( - IN PVOID pDM_VOID - ); - - -VOID -odm_SetTxPowerLevel8814( - IN PADAPTER Adapter, - IN u1Byte Channel, - IN u1Byte PwrLvl - ); -#endif -#endif - -VOID -odm_DynamicTxPower( - IN PVOID pDM_VOID - ); - -VOID -odm_DynamicTxPowerAP( - IN PVOID pDM_VOID - ); - -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMDYNAMICTXPOWER_H__ +#define __PHYDMDYNAMICTXPOWER_H__ + +/*#define DYNAMIC_TXPWR_VERSION "1.0"*/ +/*#define DYNAMIC_TXPWR_VERSION "1.3" */ /*2015.08.26, Add 8814 Dynamic TX power*/ +#define DYNAMIC_TXPWR_VERSION "1.4" /*2015.11.06, Add CE 8821A Dynamic TX power*/ + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 + #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 + #define TX_POWER_NEAR_FIELD_THRESH_AP 0x3F +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 + #define TX_POWER_NEAR_FIELD_THRESH_LVL1 67 +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #define TX_POWER_NEAR_FIELD_THRESH_LVL2 74 + #define TX_POWER_NEAR_FIELD_THRESH_LVL1 60 +#endif + +#define tx_high_pwr_level_normal 0 +#define tx_high_pwr_level_level1 1 +#define tx_high_pwr_level_level2 2 + +#define tx_high_pwr_level_bt1 3 +#define tx_high_pwr_level_bt2 4 +#define tx_high_pwr_level_15 5 +#define tx_high_pwr_level_35 6 +#define tx_high_pwr_level_50 7 +#define tx_high_pwr_level_70 8 +#define tx_high_pwr_level_100 9 + +void +phydm_dynamic_tx_power_init( + void *p_dm_void +); + +void +odm_dynamic_tx_power_restore_power_index( + void *p_dm_void +); + +void +odm_dynamic_tx_power_nic( + void *p_dm_void +); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) +void +odm_dynamic_tx_power_save_power_index( + void *p_dm_void +); + +void +odm_dynamic_tx_power_write_power_index( + void *p_dm_void, + u8 value); + +void +odm_dynamic_tx_power_8821( + void *p_dm_void, + u8 *p_desc, + u8 mac_id +); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +odm_dynamic_tx_power_8814a( + void *p_dm_void +); + + +void +odm_set_tx_power_level8814( + struct _ADAPTER *adapter, + u8 channel, + u8 pwr_lvl +); +#endif +#endif + +void +odm_dynamic_tx_power( + void *p_dm_void +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.c deleted file mode 100644 index 05223454a2f9..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.c +++ /dev/null @@ -1,766 +0,0 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -VOID -ODM_EdcaTurboInit( - IN PVOID pDM_VOID) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - -#if (DM_ODM_SUPPORT_TYPE==ODM_WIN) - PADAPTER Adapter = NULL; - HAL_DATA_TYPE *pHalData = NULL; - - if(pDM_Odm->Adapter==NULL) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EdcaTurboInit fail!!!\n")); - return; - } - - Adapter=pDM_Odm->Adapter; - pHalData=GET_HAL_DATA(Adapter); - - pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; - pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; - pHalData->bIsAnyNonBEPkts = FALSE; - -#elif(DM_ODM_SUPPORT_TYPE==ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; - pDM_Odm->DM_EDCA_Table.bIsCurRDLState = FALSE; - Adapter->recvpriv.bIsAnyNonBEPkts =FALSE; - -#endif - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VO PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VO_PARAM))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial VI PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_VI_PARAM))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BK PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BK_PARAM))); - - -} // ODM_InitEdcaTurbo - -VOID -odm_EdcaTurboCheck( - IN PVOID pDM_VOID - ) -{ - // - // For AP/ADSL use prtl8192cd_priv - // For CE/NIC use PADAPTER - // - - // - // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate - // at the same time. In the stage2/3, we need to prive universal interface and merge all - // HW dynamic mechanism. - // - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheck========================>\n")); - - if(!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO )) - return; - - switch (pDM_Odm->SupportPlatform) - { - case ODM_WIN: - -#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) - odm_EdcaTurboCheckMP(pDM_Odm); -#endif - break; - - case ODM_CE: -#if(DM_ODM_SUPPORT_TYPE==ODM_CE) - odm_EdcaTurboCheckCE(pDM_Odm); -#endif - break; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("<========================odm_EdcaTurboCheck\n")); - -} // odm_CheckEdcaTurbo - -#if(DM_ODM_SUPPORT_TYPE==ODM_CE) - - -VOID -odm_EdcaTurboCheckCE( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - u32 EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; - u32 EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; - u32 ICType=pDM_Odm->SupportICType; - u32 IOTPeer=0; - u8 WirelessMode=0xFF; //invalid value - u32 trafficIndex; - u32 edca_param; - u64 cur_tx_bytes = 0; - u64 cur_rx_bytes = 0; - u8 bbtchange = _FALSE; - u8 bBiasOnRx = _FALSE; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); - struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); - struct recv_priv *precvpriv = &(Adapter->recvpriv); - struct registry_priv *pregpriv = &Adapter->registrypriv; - struct mlme_ext_priv *pmlmeext = &(Adapter->mlmeextpriv); - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - - if(pDM_Odm->bLinked != _TRUE) - { - precvpriv->bIsAnyNonBEPkts = _FALSE; - return; - } - - if ((pregpriv->wifi_spec == 1) )//|| (pmlmeinfo->HT_enable == 0)) - { - precvpriv->bIsAnyNonBEPkts = _FALSE; - return; - } - - if(pDM_Odm->pWirelessMode!=NULL) - WirelessMode=*(pDM_Odm->pWirelessMode); - - IOTPeer = pmlmeinfo->assoc_AP_vendor; - - if (IOTPeer >= HT_IOT_PEER_MAX) - { - precvpriv->bIsAnyNonBEPkts = _FALSE; - return; - } - - if (pDM_Odm->SupportICType & ODM_RTL8188E) { - if((IOTPeer == HT_IOT_PEER_RALINK)||(IOTPeer == HT_IOT_PEER_ATHEROS)) - bBiasOnRx = _TRUE; - } - - // Check if the status needs to be changed. - if((bbtchange) || (!precvpriv->bIsAnyNonBEPkts) ) - { - cur_tx_bytes = pdvobjpriv->traffic_stat.cur_tx_bytes; - cur_rx_bytes = pdvobjpriv->traffic_stat.cur_rx_bytes; - - //traffic, TX or RX - if(bBiasOnRx) - { - if (cur_tx_bytes > (cur_rx_bytes << 2)) - { // Uplink TP is present. - trafficIndex = UP_LINK; - } - else - { // Balance TP is present. - trafficIndex = DOWN_LINK; - } - } - else - { - if (cur_rx_bytes > (cur_tx_bytes << 2)) - { // Downlink TP is present. - trafficIndex = DOWN_LINK; - } - else - { // Balance TP is present. - trafficIndex = UP_LINK; - } - } - - //if ((pDM_Odm->DM_EDCA_Table.prv_traffic_idx != trafficIndex) || (!pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA)) - { - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) { - EDCA_BE_UL = 0x6ea42b; - EDCA_BE_DL = 0x6ea42b; - } - - //92D txop can't be set to 0x3e for cisco1250 - if ((IOTPeer == HT_IOT_PEER_CISCO) && (WirelessMode == ODM_WM_N24G)) - { - EDCA_BE_DL = edca_setting_DL[IOTPeer]; - EDCA_BE_UL = edca_setting_UL[IOTPeer]; - } - //merge from 92s_92c_merge temp brunch v2445 20120215 - else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) - { - EDCA_BE_DL = edca_setting_DL_GMode[IOTPeer]; - } - else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) - { - EDCA_BE_DL = 0xa630; - } - else if(IOTPeer == HT_IOT_PEER_MARVELL) - { - EDCA_BE_DL = edca_setting_DL[IOTPeer]; - EDCA_BE_UL = edca_setting_UL[IOTPeer]; - } - else if(IOTPeer == HT_IOT_PEER_ATHEROS) - { - // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. - EDCA_BE_DL = edca_setting_DL[IOTPeer]; - } - - if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8821)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE - { - EDCA_BE_UL = 0x5ea42b; - EDCA_BE_DL = 0x5ea42b; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%x EDCA_BE_DL =0x%x",EDCA_BE_UL,EDCA_BE_DL)); - } - - if (trafficIndex == DOWN_LINK) - edca_param = EDCA_BE_DL; - else - edca_param = EDCA_BE_UL; - - rtw_write32(Adapter, REG_EDCA_BE_PARAM, edca_param); - - pDM_Odm->DM_EDCA_Table.prv_traffic_idx = trafficIndex; - } - - pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _TRUE; - } - else - { - // - // Turn Off EDCA turbo here. - // Restore original EDCA according to the declaration of AP. - // - if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) - { - rtw_write32(Adapter, REG_EDCA_BE_PARAM, pHalData->AcParam_BE); - pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = _FALSE; - } - } - -} - - -#elif(DM_ODM_SUPPORT_TYPE==ODM_WIN) -VOID -odm_EdcaTurboCheckMP( - IN PVOID pDM_VOID - ) -{ - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - PADAPTER pDefaultAdapter = GetDefaultAdapter(Adapter); - PADAPTER pExtAdapter = GetFirstExtAdapter(Adapter);//NULL; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - PSTA_QOS pStaQos = Adapter->MgntInfo.pStaQos; - //[Win7 Count Tx/Rx statistic for Extension Port] odm_CheckEdcaTurbo's Adapter is always Default. 2009.08.20, by Bohn - u8Byte Ext_curTxOkCnt = 0; - u8Byte Ext_curRxOkCnt = 0; - //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. - u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; - - // Keep past Tx/Rx packet count for RT-to-RT EDCA turbo. - u8Byte curTxOkCnt = 0; - u8Byte curRxOkCnt = 0; - u4Byte EDCA_BE_UL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[pMgntInfo->IOTPeer]; - u4Byte EDCA_BE_DL = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[pMgntInfo->IOTPeer]; - u4Byte EDCA_BE = 0x5ea42b; - u1Byte IOTPeer=0; - BOOLEAN *pbIsCurRDLState=NULL; - BOOLEAN bLastIsCurRDLState=FALSE; - BOOLEAN bBiasOnRx=FALSE; - BOOLEAN bEdcaTurboOn=FALSE; - u1Byte TxRate = 0xFF; - u8Byte value64; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("odm_EdcaTurboCheckMP========================>")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Orginial BE PARAM: 0x%x\n",ODM_Read4Byte(pDM_Odm,ODM_EDCA_BE_PARAM))); - -////=============================== -////list paramter for different platform -////=============================== - bLastIsCurRDLState=pDM_Odm->DM_EDCA_Table.bIsCurRDLState; - pbIsCurRDLState=&(pDM_Odm->DM_EDCA_Table.bIsCurRDLState); - - //2012/09/14 MH Add - if (pMgntInfo->NumNonBePkt > pMgntInfo->RegEdcaThresh && !(Adapter->MgntInfo.bWiFiConfg & RT_WIFI_LOGO)) - pHalData->bIsAnyNonBEPkts = TRUE; - - pMgntInfo->NumNonBePkt = 0; - - // Caculate TX/RX TP: - curTxOkCnt = pDM_Odm->curTxOkCnt; - curRxOkCnt = pDM_Odm->curRxOkCnt; - - - if(pExtAdapter == NULL) - pExtAdapter = pDefaultAdapter; - - Ext_curTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->Ext_lastTxOkCnt; - Ext_curRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->Ext_lastRxOkCnt; - GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); - //For future Win7 Enable Default Port to modify AMPDU size dynamically, 2009.08.20, Bohn. - if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) - { - curTxOkCnt = Ext_curTxOkCnt ; - curRxOkCnt = Ext_curRxOkCnt ; - } - // - IOTPeer=pMgntInfo->IOTPeer; - bBiasOnRx=(pMgntInfo->IOTAction & HT_IOT_ACT_EDCA_BIAS_ON_RX)?TRUE:FALSE; - bEdcaTurboOn=((!pHalData->bIsAnyNonBEPkts))?TRUE:FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bIsAnyNonBEPkts : 0x%lx \n",pHalData->bIsAnyNonBEPkts)); - - -////=============================== -////check if edca turbo is disabled -////=============================== - if(odm_IsEdcaTurboDisable(pDM_Odm)) - { - pHalData->bIsAnyNonBEPkts = FALSE; - pMgntInfo->lastTxOkCnt = Adapter->TxStats.NumTxBytesUnicast; - pMgntInfo->lastRxOkCnt = Adapter->RxStats.NumRxBytesUnicast; - pMgntInfo->Ext_lastTxOkCnt = pExtAdapter->TxStats.NumTxBytesUnicast; - pMgntInfo->Ext_lastRxOkCnt = pExtAdapter->RxStats.NumRxBytesUnicast; - - } - -////=============================== -////remove iot case out -////=============================== - ODM_EdcaParaSelByIot(pDM_Odm, &EDCA_BE_UL, &EDCA_BE_DL); - - -////=============================== -////Check if the status needs to be changed. -////=============================== - if(bEdcaTurboOn) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("bEdcaTurboOn : 0x%x bBiasOnRx : 0x%x\n",bEdcaTurboOn,bBiasOnRx)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curTxOkCnt : 0x%lx \n",curTxOkCnt)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("curRxOkCnt : 0x%lx \n",curRxOkCnt)); - if(bBiasOnRx) - odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, TRUE, pbIsCurRDLState); - else - odm_EdcaChooseTrafficIdx(pDM_Odm,curTxOkCnt, curRxOkCnt, FALSE, pbIsCurRDLState); - -//modify by Guo.Mingzhi 2011-12-29 - if( Adapter->AP_EDCA_PARAM[0] != EDCA_BE ) - EDCA_BE = Adapter->AP_EDCA_PARAM[0]; - else - EDCA_BE=((*pbIsCurRDLState)==TRUE)?EDCA_BE_DL:EDCA_BE_UL; - if(IS_HARDWARE_TYPE_8821U(Adapter)) - { - if(pMgntInfo->RegTxDutyEnable) - { - //2013.01.23 LukeLee: debug for 8811AU thermal issue (reduce Tx duty cycle) - if(!pMgntInfo->ForcedDataRate) //auto rate - { - if(pDM_Odm->TxRate != 0xFF) - TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); - } - else //force rate - { - TxRate = (u1Byte) pMgntInfo->ForcedDataRate; - } - - value64 = (curRxOkCnt<<2); - if(curTxOkCnt < value64) //Downlink - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - else //Uplink - { - /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ - /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ - if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - else - { - switch (TxRate) - { - case MGN_VHT1SS_MCS6: - case MGN_VHT1SS_MCS5: - case MGN_MCS6: - case MGN_MCS5: - case MGN_48M: - case MGN_54M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea42b); - break; - case MGN_VHT1SS_MCS4: - case MGN_MCS4: - case MGN_36M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa42b); - break; - case MGN_VHT1SS_MCS3: - case MGN_MCS3: - case MGN_24M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa47f); - break; - case MGN_VHT1SS_MCS2: - case MGN_MCS2: - case MGN_18M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa57f); - break; - case MGN_VHT1SS_MCS1: - case MGN_MCS1: - case MGN_9M: - case MGN_12M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa77f); - break; - case MGN_VHT1SS_MCS0: - case MGN_MCS0: - case MGN_6M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); - break; - default: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - break; - } - } - } - } - else - { - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - } - - } - else if (IS_HARDWARE_TYPE_8812AU(Adapter)){ - if(pMgntInfo->RegTxDutyEnable) - { - //2013.07.26 Wilson: debug for 8812AU thermal issue (reduce Tx duty cycle) - // it;s the same issue as 8811AU - if(!pMgntInfo->ForcedDataRate) //auto rate - { - if(pDM_Odm->TxRate != 0xFF) - TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); - } - else //force rate - { - TxRate = (u1Byte) pMgntInfo->ForcedDataRate; - } - - value64 = (curRxOkCnt<<2); - if(curTxOkCnt < value64) //Downlink - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - else //Uplink - { - /*DbgPrint("pRFCalibrateInfo->ThermalValue = 0x%X\n", pRFCalibrateInfo->ThermalValue);*/ - /*if(pRFCalibrateInfo->ThermalValue < pHalData->EEPROMThermalMeter)*/ - if((pDM_Odm->RFCalibrateInfo.ThermalValue < 0x2c) || (*pDM_Odm->pBandType == BAND_ON_2_4G)) - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - else - { - switch (TxRate) - { - case MGN_VHT2SS_MCS9: - case MGN_VHT1SS_MCS9: - case MGN_VHT1SS_MCS8: - case MGN_MCS15: - case MGN_MCS7: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0x1ea44f); - case MGN_VHT2SS_MCS8: - case MGN_VHT1SS_MCS7: - case MGN_MCS14: - case MGN_MCS6: - case MGN_54M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa44f); - case MGN_VHT2SS_MCS7: - case MGN_VHT2SS_MCS6: - case MGN_VHT1SS_MCS6: - case MGN_VHT1SS_MCS5: - case MGN_MCS13: - case MGN_MCS5: - case MGN_48M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa630); - break; - case MGN_VHT2SS_MCS5: - case MGN_VHT2SS_MCS4: - case MGN_VHT1SS_MCS4: - case MGN_VHT1SS_MCS3: - case MGN_MCS12: - case MGN_MCS4: - case MGN_MCS3: - case MGN_36M: - case MGN_24M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa730); - break; - case MGN_VHT2SS_MCS3: - case MGN_VHT2SS_MCS2: - case MGN_VHT2SS_MCS1: - case MGN_VHT1SS_MCS2: - case MGN_VHT1SS_MCS1: - case MGN_MCS11: - case MGN_MCS10: - case MGN_MCS9: - case MGN_MCS2: - case MGN_MCS1: - case MGN_18M: - case MGN_12M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa830); - break; - case MGN_VHT2SS_MCS0: - case MGN_VHT1SS_MCS0: - case MGN_MCS0: - case MGN_MCS8: - case MGN_9M: - case MGN_6M: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,0xa87f); - break; - default: - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - break; - } - } - } - } - else - { - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - } - } - else - ODM_Write4Byte(pDM_Odm,ODM_EDCA_BE_PARAM,EDCA_BE); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA Turbo on: EDCA_BE:0x%lx\n",EDCA_BE)); - - pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = TRUE; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("EDCA_BE_DL : 0x%lx EDCA_BE_UL : 0x%lx EDCA_BE : 0x%lx \n",EDCA_BE_DL,EDCA_BE_UL,EDCA_BE)); - - } - else - { - // Turn Off EDCA turbo here. - // Restore original EDCA according to the declaration of AP. - if(pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA) - { - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_AC_PARAM, GET_WMM_PARAM_ELE_SINGLE_AC_PARAM(pStaQos->WMMParamEle, AC0_BE) ); - - pDM_Odm->DM_EDCA_Table.bCurrentTurboEDCA = FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Restore EDCA BE: 0x%lx \n",pDM_Odm->WMMEDCA_BE)); - - } - } - -} - - -//check if edca turbo is disabled -BOOLEAN -odm_IsEdcaTurboDisable( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - u4Byte IOTPeer=pMgntInfo->IOTPeer; - - if(pDM_Odm->bBtDisableEdcaTurbo) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable for BT!!\n")); - return TRUE; - } - - if((!(pDM_Odm->SupportAbility& ODM_MAC_EDCA_TURBO ))|| - (pDM_Odm->WIFITest & RT_WIFI_LOGO)|| - (IOTPeer>= HT_IOT_PEER_MAX)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("EdcaTurboDisable\n")); - return TRUE; - } - - - // 1. We do not turn on EDCA turbo mode for some AP that has IOT issue - // 2. User may disable EDCA Turbo mode with OID settings. - if(pMgntInfo->IOTAction & HT_IOT_ACT_DISABLE_EDCA_TURBO){ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD, ("IOTAction:EdcaTurboDisable\n")); - return TRUE; - } - - return FALSE; - - -} - -//add iot case here: for MP/CE -VOID -ODM_EdcaParaSelByIot( - IN PVOID pDM_VOID, - OUT u4Byte *EDCA_BE_UL, - OUT u4Byte *EDCA_BE_DL - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - u4Byte IOTPeer=0; - u4Byte ICType=pDM_Odm->SupportICType; - u1Byte WirelessMode=0xFF; //invalid value - u4Byte IOTPeerSubType = 0; - - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - u1Byte TwoPortStatus = (u1Byte)TWO_PORT_STATUS__WITHOUT_ANY_ASSOCIATE; - - if(pDM_Odm->pWirelessMode!=NULL) - WirelessMode=*(pDM_Odm->pWirelessMode); - -/////////////////////////////////////////////////////////// -////list paramter for different platform - - IOTPeer=pMgntInfo->IOTPeer; - IOTPeerSubType=pMgntInfo->IOTPeerSubtype; - GetTwoPortSharedResource(Adapter,TWO_PORT_SHARED_OBJECT__STATUS,NULL,&TwoPortStatus); - -////============================ -/// IOT case for MP -////============================ - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) { - (*EDCA_BE_UL) = 0x6ea42b; - (*EDCA_BE_DL) = 0x6ea42b; - } - - if(TwoPortStatus == TWO_PORT_STATUS__EXTENSION_ONLY) - { - (*EDCA_BE_UL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_UL[ExtAdapter->MgntInfo.IOTPeer]; - (*EDCA_BE_DL) = 0x5ea42b;//Parameter suggested by Scott //edca_setting_DL[ExtAdapter->MgntInfo.IOTPeer]; - } - - #if (INTEL_PROXIMITY_SUPPORT == 1) - if(pMgntInfo->IntelClassModeInfo.bEnableCA == TRUE) - { - (*EDCA_BE_UL) = (*EDCA_BE_DL) = 0xa44f; - } - else - #endif - { - if((pMgntInfo->IOTAction & (HT_IOT_ACT_FORCED_ENABLE_BE_TXOP|HT_IOT_ACT_AMSDU_ENABLE))) - {// To check whether we shall force turn on TXOP configuration. - if(!((*EDCA_BE_UL) & 0xffff0000)) - (*EDCA_BE_UL) |= 0x005e0000; // Force TxOP limit to 0x005e for UL. - if(!((*EDCA_BE_DL) & 0xffff0000)) - (*EDCA_BE_DL) |= 0x005e0000; // Force TxOP limit to 0x005e for DL. - } - - //92D txop can't be set to 0x3e for cisco1250 - if ((IOTPeer == HT_IOT_PEER_CISCO) && (WirelessMode == ODM_WM_N24G)) - { - (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; - (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; - } - //merge from 92s_92c_merge temp brunch v2445 20120215 - else if((IOTPeer == HT_IOT_PEER_CISCO) &&((WirelessMode==ODM_WM_G)||(WirelessMode==(ODM_WM_B|ODM_WM_G))||(WirelessMode==ODM_WM_A)||(WirelessMode==ODM_WM_B))) - { - (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; - } - else if((IOTPeer== HT_IOT_PEER_AIRGO )&& ((WirelessMode==ODM_WM_G)||(WirelessMode==ODM_WM_A))) - { - (*EDCA_BE_DL) = 0xa630; - } - - else if(IOTPeer == HT_IOT_PEER_MARVELL) - { - (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; - (*EDCA_BE_UL) = edca_setting_UL[IOTPeer]; - } - else if(IOTPeer == HT_IOT_PEER_ATHEROS && IOTPeerSubType != HT_IOT_PEER_TPLINK_AC1750) - { - // Set DL EDCA for Atheros peer to 0x3ea42b. Suggested by SD3 Wilson for ASUS TP issue. - if(WirelessMode==ODM_WM_G) - (*EDCA_BE_DL) = edca_setting_DL_GMode[IOTPeer]; - else - (*EDCA_BE_DL) = edca_setting_DL[IOTPeer]; - - if(ICType == ODM_RTL8821) - (*EDCA_BE_DL) = 0x5ea630; - - } - } - - if((ICType==ODM_RTL8812)||(ICType==ODM_RTL8192E)) //add 8812AU/8812AE - { - (*EDCA_BE_UL) = 0x5ea42b; - (*EDCA_BE_DL) = 0x5ea42b; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8812A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); - } - - if((ICType==ODM_RTL8814A) && (IOTPeer == HT_IOT_PEER_REALTEK)) /*8814AU and 8814AR*/ - { - (*EDCA_BE_UL) = 0x5ea42b; - (*EDCA_BE_DL) = 0xa42b; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("8814A: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx\n",(*EDCA_BE_UL),(*EDCA_BE_DL))); - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Special: EDCA_BE_UL=0x%lx EDCA_BE_DL =0x%lx, IOTPeer = %d\n",(*EDCA_BE_UL),(*EDCA_BE_DL), IOTPeer)); - -} - - -VOID -odm_EdcaChooseTrafficIdx( - IN PVOID pDM_VOID, - IN u8Byte cur_tx_bytes, - IN u8Byte cur_rx_bytes, - IN BOOLEAN bBiasOnRx, - OUT BOOLEAN *pbIsCurRDLState - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if(bBiasOnRx) - { - - if(cur_tx_bytes>(cur_rx_bytes*4)) - { - *pbIsCurRDLState=FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Uplink Traffic\n ")); - - } - else - { - *pbIsCurRDLState=TRUE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); - - } - } - else - { - if(cur_rx_bytes>(cur_tx_bytes*4)) - { - *pbIsCurRDLState=TRUE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Downlink Traffic\n")); - - } - else - { - *pbIsCurRDLState=FALSE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_EDCA_TURBO,ODM_DBG_LOUD,("Balance Traffic\n")); - } - } - - return ; -} - -#endif - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.h deleted file mode 100644 index 2671f863eef6..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_edcaturbocheck.h +++ /dev/null @@ -1,100 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMEDCATURBOCHECK_H__ -#define __PHYDMEDCATURBOCHECK_H__ - -/*#define EDCATURBO_VERSION "2.1"*/ -#define EDCATURBO_VERSION "2.3" /*2015.07.29 by YuChen*/ - -typedef struct _EDCA_TURBO_ -{ - BOOLEAN bCurrentTurboEDCA; - BOOLEAN bIsCurRDLState; - - #if(DM_ODM_SUPPORT_TYPE == ODM_CE ) - u4Byte prv_traffic_idx; // edca turbo - #endif - -}EDCA_T,*pEDCA_T; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) -static u4Byte edca_setting_UL[HT_IOT_PEER_MAX] = -// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU MARVELL 92U_AP SELF_AP(DownLink/Tx) -{ 0x5e4322, 0xa44f, 0x5e4322, 0x5ea32b, 0x5ea422, 0x5ea322, 0x3ea430, 0x5ea42b, 0x5ea44f, 0x5e4322, 0x5e4322}; - - -static u4Byte edca_setting_DL[HT_IOT_PEER_MAX] = -// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP(UpLink/Rx) -{ 0xa44f, 0x5ea44f, 0x5e4322, 0x5ea42b, 0xa44f, 0xa630, 0x5ea630, 0x5ea42b, 0xa44f, 0xa42b, 0xa42b}; - -static u4Byte edca_setting_DL_GMode[HT_IOT_PEER_MAX] = -// UNKNOWN REALTEK_90 REALTEK_92SE BROADCOM RALINK ATHEROS CISCO MERU, MARVELL 92U_AP SELF_AP -{ 0x4322, 0xa44f, 0x5e4322, 0xa42b, 0x5e4322, 0x4322, 0xa42b, 0x5ea42b, 0xa44f, 0x5e4322, 0x5ea42b}; - -#endif - - - -VOID -odm_EdcaTurboCheck( - IN PVOID pDM_VOID - ); -VOID -ODM_EdcaTurboInit( - IN PVOID pDM_VOID -); - -#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) -VOID -odm_EdcaTurboCheckMP( - IN PVOID pDM_VOID - ); - -//check if edca turbo is disabled -BOOLEAN -odm_IsEdcaTurboDisable( - IN PVOID pDM_VOID -); -//choose edca paramter for special IOT case -VOID -ODM_EdcaParaSelByIot( - IN PVOID pDM_VOID, - OUT u4Byte *EDCA_BE_UL, - OUT u4Byte *EDCA_BE_DL - ); -//check if it is UL or DL -VOID -odm_EdcaChooseTrafficIdx( - IN PVOID pDM_VOID, - IN u8Byte cur_tx_bytes, - IN u8Byte cur_rx_bytes, - IN BOOLEAN bBiasOnRx, - OUT BOOLEAN *pbIsCurRDLState - ); - -#elif (DM_ODM_SUPPORT_TYPE==ODM_CE) -VOID -odm_EdcaTurboCheckCE( - IN PVOID pDM_VOID - ); -#endif - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features.h index 2e0b81b76fa9..2932582586ee 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features.h @@ -1,142 +1,42 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDM_FEATURES_H__ -#define __PHYDM_FEATURES - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /*Antenna Diversity*/ - #define CONFIG_PHYDM_ANTENNA_DIVERSITY - #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY - - #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) - #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY - #endif - - #if (RTL8821A_SUPPORT == 1) - /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ - #define CONFIG_FAT_PATCH - #endif - #endif - - #define SUPPORTABLITY_PHYDMLIZE 1 - #define RA_MASK_PHYDMLIZE_WIN 1 - /*#define CONFIG_PATH_DIVERSITY*/ - /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ - #define CONFIG_ANT_DETECTION - /*#define CONFIG_RA_DBG_CMD*/ - #define CONFIG_RA_FW_DBG_CODE 1 - /*#define CONFIG_PHYDM_RX_SNIFFER_PARSING*/ - #define CONFIG_BB_POWER_SAVING - #define CONFIG_BB_TXBF_API - -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - - #define SUPPORTABLITY_PHYDMLIZE 0 - #define RA_MASK_PHYDMLIZE_AP 1 - - /* #define CONFIG_RA_DBG_CMD*/ - #define CONFIG_RA_FW_DBG_CODE 0 - - /*#define CONFIG_PATH_DIVERSITY*/ - /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ - #define CONFIG_RA_DYNAMIC_RATE_ID - /*#define CONFIG_BB_POWER_SAVING*/ - #define CONFIG_BB_TXBF_API - - /* [ Configure Antenna Diversity ] */ - #if defined(CONFIG_RTL_8881A_ANT_SWITCH) || defined(CONFIG_SLOT_0_ANT_SWITCH) || defined(CONFIG_SLOT_1_ANT_SWITCH) - #define CONFIG_PHYDM_ANTENNA_DIVERSITY - #define ODM_EVM_ENHANCE_ANTDIV - - /*----------*/ - - #if (!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) && !defined(CONFIG_2G_CGCS_RX_DIVERSITY) && !defined(CONFIG_2G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) - #define CONFIG_NO_2G_DIVERSITY - #endif - - #ifdef CONFIG_NO_5G_DIVERSITY_8881A - #define CONFIG_NO_5G_DIVERSITY - #elif defined(CONFIG_5G_CGCS_RX_DIVERSITY_8881A) - #define CONFIG_5G_CGCS_RX_DIVERSITY - #elif defined(CONFIG_5G_CG_TRX_DIVERSITY_8881A) - #define CONFIG_5G_CG_TRX_DIVERSITY - #elif defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) - #define CONFIG_2G5G_CG_TRX_DIVERSITY - #endif - #if (!defined(CONFIG_NO_5G_DIVERSITY) && !defined(CONFIG_5G_CGCS_RX_DIVERSITY) && !defined(CONFIG_5G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY) && !defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) - #define CONFIG_NO_5G_DIVERSITY - #endif - /*----------*/ - #if (defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) - #define CONFIG_NOT_SUPPORT_ANTDIV - #elif (!defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) - #define CONFIG_2G_SUPPORT_ANTDIV - #elif (defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) - #define CONFIG_5G_SUPPORT_ANTDIV - #elif ((!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY)) - #define CONFIG_2G5G_SUPPORT_ANTDIV - #endif - /*----------*/ - #endif - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - #define SUPPORTABLITY_PHYDMLIZE 0 - #define RA_MASK_PHYDMLIZE_CE 1 - - /*Antenna Diversity*/ - #ifdef CONFIG_ANTENNA_DIVERSITY - #define CONFIG_PHYDM_ANTENNA_DIVERSITY - - #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY - - #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) - #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY - #endif - - #if (RTL8821A_SUPPORT == 1) - /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ - #endif - #endif - #endif - - #ifdef CONFIG_DFS_MASTER - #define CONFIG_PHYDM_DFS_MASTER - #endif - - /*#define CONFIG_RA_DBG_CMD*/ - #define CONFIG_RA_FW_DBG_CODE 0 - /*#define CONFIG_ANT_DETECTION*/ - /*#define CONFIG_PATH_DIVERSITY*/ - /*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ - #define CONFIG_BB_POWER_SAVING - #define CONFIG_BB_TXBF_API - - #ifdef CONFIG_BT_COEXIST - #define BT_SUPPORT 1 - #endif - - -#endif - - -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDM_FEATURES_H__ +#define __PHYDM_FEATURES + +#define ODM_DC_CANCELLATION_SUPPORT (ODM_RTL8188F | ODM_RTL8710B) +#define ODM_RECEIVER_BLOCKING_SUPPORT (ODM_RTL8188E | ODM_RTL8192E) + +#if ((RTL8814A_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) + #define PHYDM_LA_MODE_SUPPORT 1 +#else + #define PHYDM_LA_MODE_SUPPORT 0 +#endif + +/*20170103 YuChen add for FW API*/ +#define PHYDM_FW_API_ENABLE_8822B 1 +#define PHYDM_FW_API_FUNC_ENABLE_8822B 1 +#define PHYDM_FW_API_ENABLE_8821C 1 +#define PHYDM_FW_API_FUNC_ENABLE_8821C 1 + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "phydm_features_win.h" +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "phydm_features_ce.h" +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "phydm_features_ap.h" +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ap.h new file mode 100644 index 000000000000..ac13c4edce7a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ap.h @@ -0,0 +1,118 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDM_FEATURES_AP_H__ +#define __PHYDM_FEATURES_AP + +#if (RTL8822B_SUPPORT == 1) + /*#define PHYDM_PHYSTAUS_SMP_MODE*/ +#endif + +#if (RTL8197F_SUPPORT == 1) + /*#define PHYDM_TDMA_DIG_SUPPORT*/ +#endif + +#if (RTL8197F_SUPPORT == 1) + #define PHYDM_LNA_SAT_CHK_SUPPORT +#endif + +#if (RTL8822B_SUPPORT == 1) + /*#define PHYDM_POWER_TRAINING_SUPPORT*/ +#endif + +#if (RTL8822B_SUPPORT == 1) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188E_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) + #define PHYDM_PRIMARY_CCA +#endif + +#if (RTL8188F_SUPPORT == 1 || RTL8710B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8822B_SUPPORT == 1) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8822B_SUPPORT == 1) + /*#define CONFIG_DYNAMIC_RX_PATH*/ +#endif + +#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) + /*#define CONFIG_ADAPTIVE_SOML*/ +#endif + +#define PHYDM_DIG_MODE_DECISION_SUPPORT +/*#define CONFIG_PSD_TOOL*/ +#define PHYDM_SUPPORT_CCKPD +#define RA_MASK_PHYDMLIZE_AP +/* #define CONFIG_RA_DBG_CMD*/ +/*#define CONFIG_RA_FW_DBG_CODE*/ + +/*#define CONFIG_PATH_DIVERSITY*/ +/*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ +#define CONFIG_RA_DYNAMIC_RATE_ID +#define CONFIG_BB_TXBF_API +/*#define ODM_CONFIG_BT_COEXIST*/ +/*#define PHYDM_3RD_REFORM_RA_MASK*/ +#define PHYDM_3RD_REFORM_RSSI_MONOTOR +#define PHYDM_SUPPORT_RSSI_MONITOR +#if !defined(CONFIG_DISABLE_PHYDM_DEBUG_FUNCTION) + #define CONFIG_PHYDM_DEBUG_FUNCTION +#endif + +/* [ Configure Antenna Diversity ] */ +#if defined(CONFIG_RTL_8881A_ANT_SWITCH) || defined(CONFIG_SLOT_0_ANT_SWITCH) || defined(CONFIG_SLOT_1_ANT_SWITCH) + #define CONFIG_PHYDM_ANTENNA_DIVERSITY + #define ODM_EVM_ENHANCE_ANTDIV + #define SKIP_EVM_ANTDIV_TRAINING_PATCH + + /*----------*/ + + #if (!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) && !defined(CONFIG_2G_CGCS_RX_DIVERSITY) && !defined(CONFIG_2G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G_CG_SMART_ANT_DIVERSITY)) + #define CONFIG_NO_2G_DIVERSITY + #endif + + #ifdef CONFIG_NO_5G_DIVERSITY_8881A + #define CONFIG_NO_5G_DIVERSITY + #elif defined(CONFIG_5G_CGCS_RX_DIVERSITY_8881A) + #define CONFIG_5G_CGCS_RX_DIVERSITY + #elif defined(CONFIG_5G_CG_TRX_DIVERSITY_8881A) + #define CONFIG_5G_CG_TRX_DIVERSITY + #elif defined(CONFIG_2G5G_CG_TRX_DIVERSITY_8881A) + #define CONFIG_2G5G_CG_TRX_DIVERSITY + #endif + #if (!defined(CONFIG_NO_5G_DIVERSITY) && !defined(CONFIG_5G_CGCS_RX_DIVERSITY) && !defined(CONFIG_5G_CG_TRX_DIVERSITY) && !defined(CONFIG_2G5G_CG_TRX_DIVERSITY) && !defined(CONFIG_5G_CG_SMART_ANT_DIVERSITY)) + #define CONFIG_NO_5G_DIVERSITY + #endif + /*----------*/ + #if (defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) + #define CONFIG_NOT_SUPPORT_ANTDIV + #elif (!defined(CONFIG_NO_2G_DIVERSITY) && defined(CONFIG_NO_5G_DIVERSITY)) + #define CONFIG_2G_SUPPORT_ANTDIV + #elif (defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) + #define CONFIG_5G_SUPPORT_ANTDIV + #elif ((!defined(CONFIG_NO_2G_DIVERSITY) && !defined(CONFIG_NO_5G_DIVERSITY)) || defined(CONFIG_2G5G_CG_TRX_DIVERSITY)) + #define CONFIG_2G5G_SUPPORT_ANTDIV + #endif + /*----------*/ +#endif /*Antenna Diveristy*/ + +/*[SmartAntenna]*/ +/*#define CONFIG_SMART_ANTENNA*/ +#ifdef CONFIG_SMART_ANTENNA + /*#define CONFIG_CUMITEK_SMART_ANTENNA*/ +#endif +/* --------------------------------------------------*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ce.h new file mode 100644 index 000000000000..befed451388a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_ce.h @@ -0,0 +1,107 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDM_FEATURES_CE_H__ +#define __PHYDM_FEATURES_CE + +#if (RTL8822B_SUPPORT == 1) + /*#define PHYDM_PHYSTAUS_SMP_MODE*/ +#endif + +/*#define PHYDM_TDMA_DIG_SUPPORT*/ +/*#define PHYDM_LNA_SAT_CHK_SUPPORT*/ + +#if (RTL8822B_SUPPORT == 1) + #define PHYDM_POWER_TRAINING_SUPPORT +#endif + +#if (RTL8822B_SUPPORT == 1) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188E_SUPPORT == 1) + #define PHYDM_PRIMARY_CCA +#endif + +#if (RTL8188F_SUPPORT == 1 || RTL8710B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8822B_SUPPORT == 1) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) + /*#define CONFIG_ADAPTIVE_SOML*/ +#endif + + + +#if (RTL8822B_SUPPORT == 1) + /*#define CONFIG_DYNAMIC_RX_PATH*/ +#endif + +#if (RTL8188E_SUPPORT == 1 || RTL8192E_SUPPORT == 1) + #define CONFIG_RECEIVER_BLOCKING +#endif +#define PHYDM_SUPPORT_CCKPD +#define RA_MASK_PHYDMLIZE_CE + +/*Antenna Diversity*/ +#ifdef CONFIG_ANTENNA_DIVERSITY + #define CONFIG_PHYDM_ANTENNA_DIVERSITY + + #ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + + #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) + #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY + #endif + + #if (RTL8821A_SUPPORT == 1) + /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ + #endif + + #if (RTL8822B_SUPPORT == 1) + /*#define CONFIG_HL_SMART_ANTENNA_TYPE2*/ + #endif + #endif +#endif + +/*[SmartAntenna]*/ +/*#define CONFIG_SMART_ANTENNA*/ +#ifdef CONFIG_SMART_ANTENNA + /*#define CONFIG_CUMITEK_SMART_ANTENNA*/ +#endif +/* --------------------------------------------------*/ + +#ifdef CONFIG_DFS_MASTER + #define CONFIG_PHYDM_DFS_MASTER +#endif + +/*#define PHYDM_DIG_MODE_DECISION_SUPPORT*/ +#define CONFIG_PSD_TOOL +/*#define CONFIG_RA_DBG_CMD*/ +/*#define CONFIG_RA_FW_DBG_CODE*/ +/*#define CONFIG_ANT_DETECTION*/ +/*#define CONFIG_PATH_DIVERSITY*/ +/*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ +#define CONFIG_BB_TXBF_API +#define CONFIG_PHYDM_DEBUG_FUNCTION + +#ifdef CONFIG_BT_COEXIST + #define ODM_CONFIG_BT_COEXIST +#endif +#define PHYDM_3RD_REFORM_RA_MASK +#define PHYDM_3RD_REFORM_RSSI_MONOTOR +#define PHYDM_SUPPORT_RSSI_MONITOR +/*#define PHYDM_AUTO_DEGBUG*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_win.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_win.h new file mode 100644 index 000000000000..f2141b59e3ca --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_features_win.h @@ -0,0 +1,106 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDM_FEATURES_WIN_H__ +#define __PHYDM_FEATURES_WIN + +#if (RTL8822B_SUPPORT == 1) + /*#define PHYDM_PHYSTAUS_SMP_MODE*/ +#endif + +/*#define PHYDM_TDMA_DIG_SUPPORT*/ +/*#define PHYDM_LNA_SAT_CHK_SUPPORT*/ + +#if (RTL8822B_SUPPORT == 1) + #define PHYDM_POWER_TRAINING_SUPPORT +#endif + +#if (RTL8822B_SUPPORT == 1) + #define PHYDM_TXA_CALIBRATION +#endif + +#if (RTL8188E_SUPPORT == 1 || RTL8192E_SUPPORT == 1) + #define PHYDM_PRIMARY_CCA +#endif + +#if (RTL8188F_SUPPORT == 1 || RTL8710B_SUPPORT == 1 || RTL8821C_SUPPORT == 1 || RTL8822B_SUPPORT == 1) + #define PHYDM_DC_CANCELLATION +#endif + +#if (RTL8822B_SUPPORT == 1 || RTL8197F_SUPPORT == 1) + /*#define CONFIG_ADAPTIVE_SOML*/ +#endif + + +/*Antenna Diversity*/ +#define CONFIG_PHYDM_ANTENNA_DIVERSITY +#ifdef CONFIG_PHYDM_ANTENNA_DIVERSITY + + #if (RTL8723B_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) + #define CONFIG_S0S1_SW_ANTENNA_DIVERSITY + #endif + + /* --[SmtAnt]-----------------------------------------*/ + #if (RTL8821A_SUPPORT == 1) + /*#define CONFIG_HL_SMART_ANTENNA_TYPE1*/ + #define CONFIG_FAT_PATCH + #endif + + #if (RTL8822B_SUPPORT == 1) + /*#define CONFIG_HL_SMART_ANTENNA_TYPE2*/ + #endif + + #if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1) || defined(CONFIG_HL_SMART_ANTENNA_TYPE2)) + #define CONFIG_HL_SMART_ANTENNA + #endif + + /* --------------------------------------------------*/ + +#endif + +/*[SmartAntenna]*/ +#define CONFIG_SMART_ANTENNA +#ifdef CONFIG_SMART_ANTENNA + /*#define CONFIG_CUMITEK_SMART_ANTENNA*/ +#endif + /* --------------------------------------------------*/ + +#if (RTL8822B_SUPPORT == 1) + /*#define CONFIG_DYNAMIC_RX_PATH*/ +#endif + +#if (RTL8188E_SUPPORT == 1 || RTL8192E_SUPPORT == 1) + #define CONFIG_RECEIVER_BLOCKING +#endif + +/*#define PHYDM_DIG_MODE_DECISION_SUPPORT */ +#define CONFIG_PSD_TOOL +#define PHYDM_SUPPORT_CCKPD +#define RA_MASK_PHYDMLIZE_WIN +/*#define CONFIG_PATH_DIVERSITY*/ +/*#define CONFIG_RA_DYNAMIC_RTY_LIMIT*/ +#define CONFIG_ANT_DETECTION +/*#define CONFIG_RA_DBG_CMD*/ +#define CONFIG_RA_FW_DBG_CODE +#define CONFIG_BB_TXBF_API +#define ODM_CONFIG_BT_COEXIST +#define PHYDM_3RD_REFORM_RA_MASK +/*#define PHYDM_3RD_REFORM_RSSI_MONOTOR*/ +#define CONFIG_PHYDM_DFS_MASTER +#define PHYDM_SUPPORT_RSSI_MONITOR +#define PHYDM_AUTO_DEGBUG +#define CONFIG_PHYDM_DEBUG_FUNCTION + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.c index fa53423489b4..09cd218a96d7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.c @@ -1,3652 +1,1020 @@ -/****************************************************************************** - * - * 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 files -//============================================================ - -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#define READ_AND_CONFIG_MP(ic, txt) (ODM_ReadAndConfig_MP_##ic##txt(pDM_Odm)) -#define READ_AND_CONFIG_TC(ic, txt) (ODM_ReadAndConfig_TC_##ic##txt(pDM_Odm)) - - -#if (PHYDM_TESTCHIP_SUPPORT == 1) -#define READ_AND_CONFIG(ic, txt) do {\ - if (pDM_Odm->bIsMPChip)\ - READ_AND_CONFIG_MP(ic,txt);\ - else\ - READ_AND_CONFIG_TC(ic,txt);\ - } while(0) -#else - #define READ_AND_CONFIG READ_AND_CONFIG_MP -#endif - - -#define READ_FIRMWARE_MP(ic, txt) (ODM_ReadFirmware_MP_##ic##txt(pDM_Odm, pFirmware, pSize)) -#define READ_FIRMWARE_TC(ic, txt) (ODM_ReadFirmware_TC_##ic##txt(pDM_Odm, pFirmware, pSize)) - -#if (PHYDM_TESTCHIP_SUPPORT == 1) -#define READ_FIRMWARE(ic, txt) do {\ - if (pDM_Odm->bIsMPChip)\ - READ_FIRMWARE_MP(ic,txt);\ - else\ - READ_FIRMWARE_TC(ic,txt);\ - } while(0) -#else -#define READ_FIRMWARE READ_FIRMWARE_MP -#endif - -#define GET_VERSION_MP(ic, txt) (ODM_GetVersion_MP_##ic##txt()) -#define GET_VERSION_TC(ic, txt) (ODM_GetVersion_TC_##ic##txt()) - -#if (PHYDM_TESTCHIP_SUPPORT == 1) -#define GET_VERSION(ic, txt) (pDM_Odm->bIsMPChip?GET_VERSION_MP(ic,txt):GET_VERSION_TC(ic,txt)) -#else -#define GET_VERSION(ic, txt) GET_VERSION_MP(ic, txt) -#endif - -u1Byte -odm_QueryRxPwrPercentage( - IN s1Byte AntPower - ) -{ - if ((AntPower <= -100) || (AntPower >= 20)) - return 0; - else if (AntPower >= 0) - return 100; - else - return (100 + AntPower); -} - - -// -// 2012/01/12 MH MOve some signal strength smooth method to MP HAL layer. -// IF other SW team do not support the feature, remove this section.?? -// -s4Byte -odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo( - IN OUT PDM_ODM_T pDM_Odm, - s4Byte CurrSig -) -{ - s4Byte RetSig = 0; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - //if(pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - { - // Step 1. Scale mapping. - // 20100611 Joseph: Re-tunning RSSI presentation for Lenovo. - // 20100426 Joseph: Modify Signal strength mapping. - // This modification makes the RSSI indication similar to Intel solution. - // 20100414 Joseph: Tunning RSSI for Lenovo according to RTL8191SE. - if (CurrSig >= 54 && CurrSig <= 100) - RetSig = 100; - else if (CurrSig >= 42 && CurrSig <= 53) - RetSig = 95; - else if (CurrSig >= 36 && CurrSig <= 41) - RetSig = 74 + ((CurrSig - 36) * 20) / 6; - else if (CurrSig >= 33 && CurrSig <= 35) - RetSig = 65 + ((CurrSig - 33) * 8) / 2; - else if (CurrSig >= 18 && CurrSig <= 32) - RetSig = 62 + ((CurrSig - 18) * 2) / 15; - else if (CurrSig >= 15 && CurrSig <= 17) - RetSig = 33 + ((CurrSig - 15) * 28) / 2; - else if (CurrSig >= 10 && CurrSig <= 14) - RetSig = 39; - else if (CurrSig >= 8 && CurrSig <= 9) - RetSig = 33; - else if (CurrSig <= 8) - RetSig = 19; - } -#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) - return RetSig; -} - -s4Byte -odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore( - IN OUT PDM_ODM_T pDM_Odm, - s4Byte CurrSig -) -{ - s4Byte RetSig = 0; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - //if(pDM_Odm->SupportInterface == ODM_ITRF_USB) - { - // Netcore request this modification because 2009.04.13 SU driver use it. - if (CurrSig >= 31 && CurrSig <= 100) - RetSig = 100; - else if (CurrSig >= 21 && CurrSig <= 30) - RetSig = 90 + ((CurrSig - 20) / 1); - else if (CurrSig >= 11 && CurrSig <= 20) - RetSig = 80 + ((CurrSig - 10) / 1); - else if (CurrSig >= 7 && CurrSig <= 10) - RetSig = 69 + (CurrSig - 7); - else if (CurrSig == 6) - RetSig = 54; - else if (CurrSig == 5) - RetSig = 45; - else if (CurrSig == 4) - RetSig = 36; - else if (CurrSig == 3) - RetSig = 27; - else if (CurrSig == 2) - RetSig = 18; - else if (CurrSig == 1) - RetSig = 9; - else - RetSig = CurrSig; - } -#endif //ENDIF (DM_ODM_SUPPORT_TYPE == ODM_WIN) - return RetSig; -} - - -s4Byte -odm_SignalScaleMapping_92CSeries( - IN OUT PDM_ODM_T pDM_Odm, - IN s4Byte CurrSig -) -{ - s4Byte RetSig = 0; -#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - { - // Step 1. Scale mapping. - if(CurrSig >= 61 && CurrSig <= 100) - { - RetSig = 90 + ((CurrSig - 60) / 4); - } - else if(CurrSig >= 41 && CurrSig <= 60) - { - RetSig = 78 + ((CurrSig - 40) / 2); - } - else if(CurrSig >= 31 && CurrSig <= 40) - { - RetSig = 66 + (CurrSig - 30); - } - else if(CurrSig >= 21 && CurrSig <= 30) - { - RetSig = 54 + (CurrSig - 20); - } - else if(CurrSig >= 5 && CurrSig <= 20) - { - RetSig = 42 + (((CurrSig - 5) * 2) / 3); - } - else if(CurrSig == 4) - { - RetSig = 36; - } - else if(CurrSig == 3) - { - RetSig = 27; - } - else if(CurrSig == 2) - { - RetSig = 18; - } - else if(CurrSig == 1) - { - RetSig = 9; - } - else - { - RetSig = CurrSig; - } - } -#endif - -#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) ||(DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - if((pDM_Odm->SupportInterface == ODM_ITRF_USB) || (pDM_Odm->SupportInterface == ODM_ITRF_SDIO)) - { - if(CurrSig >= 51 && CurrSig <= 100) - { - RetSig = 100; - } - else if(CurrSig >= 41 && CurrSig <= 50) - { - RetSig = 80 + ((CurrSig - 40)*2); - } - else if(CurrSig >= 31 && CurrSig <= 40) - { - RetSig = 66 + (CurrSig - 30); - } - else if(CurrSig >= 21 && CurrSig <= 30) - { - RetSig = 54 + (CurrSig - 20); - } - else if(CurrSig >= 10 && CurrSig <= 20) - { - RetSig = 42 + (((CurrSig - 10) * 2) / 3); - } - else if(CurrSig >= 5 && CurrSig <= 9) - { - RetSig = 22 + (((CurrSig - 5) * 3) / 2); - } - else if(CurrSig >= 1 && CurrSig <= 4) - { - RetSig = 6 + (((CurrSig - 1) * 3) / 2); - } - else - { - RetSig = CurrSig; - } - } - -#endif - return RetSig; -} -s4Byte -odm_SignalScaleMapping( - IN OUT PDM_ODM_T pDM_Odm, - IN s4Byte CurrSig -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if( (pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->SupportInterface != ODM_ITRF_PCIE) && //USB & SDIO - (pDM_Odm->PatchID==10))//pMgntInfo->CustomerID == RT_CID_819x_Netcore - { - return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Netcore(pDM_Odm,CurrSig); - } - else if( (pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) && - (pDM_Odm->PatchID==19))//pMgntInfo->CustomerID == RT_CID_819x_Lenovo) - { - return odm_SignalScaleMapping_92CSeries_patch_RT_CID_819x_Lenovo(pDM_Odm, CurrSig); - }else -#endif - { -#ifdef CONFIG_SIGNAL_SCALE_MAPPING - return odm_SignalScaleMapping_92CSeries(pDM_Odm,CurrSig); -#else - return CurrSig; -#endif - } - -} - - - -static u1Byte odm_SQ_process_patch_RT_CID_819x_Lenovo( - IN PDM_ODM_T pDM_Odm, - IN u1Byte isCCKrate, - IN u1Byte PWDB_ALL, - IN u1Byte path, - IN u1Byte RSSI -) -{ - u1Byte SQ = 0; -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - if(isCCKrate){ - - if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { - - // - // Expected signal strength and bars indication at Lenovo lab. 2013.04.11 - // 802.11n, 802.11b, 802.11g only at channel 6 - // - // Attenuation (dB) OS Signal Bars RSSI by Xirrus (dBm) - // 50 5 -49 - // 55 5 -49 - // 60 5 -50 - // 65 5 -51 - // 70 5 -52 - // 75 5 -54 - // 80 5 -55 - // 85 4 -60 - // 90 3 -63 - // 95 3 -65 - // 100 2 -67 - // 102 2 -67 - // 104 1 -70 - // - - if(PWDB_ALL >= 50) - SQ = 100; - else if(PWDB_ALL >= 35 && PWDB_ALL < 50) - SQ = 80; - else if(PWDB_ALL >= 31 && PWDB_ALL < 35) - SQ = 60; - else if(PWDB_ALL >= 22 && PWDB_ALL < 31) - SQ = 40; - else if(PWDB_ALL >= 18 && PWDB_ALL < 22) - SQ = 20; - else - SQ = 10; - } else { - if (PWDB_ALL >= 50) - SQ = 100; - else if (PWDB_ALL >= 35 && PWDB_ALL < 50) - SQ = 80; - else if (PWDB_ALL >= 22 && PWDB_ALL < 35) - SQ = 60; - else if (PWDB_ALL >= 18 && PWDB_ALL < 22) - SQ = 40; - else - SQ = 10; - } - - } - else - {//OFDM rate - - if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { - if(RSSI >= 45) - SQ = 100; - else if(RSSI >= 22 && RSSI < 45) - SQ = 80; - else if(RSSI >= 18 && RSSI < 22) - SQ = 40; - else - SQ = 20; - } else { - if(RSSI >= 45) - SQ = 100; - else if(RSSI >= 22 && RSSI < 45) - SQ = 80; - else if(RSSI >= 18 && RSSI < 22) - SQ = 40; - else - SQ = 20; - } - } - - RT_TRACE(COMP_DBG, DBG_TRACE, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); - -#endif - return SQ; -} - -static u1Byte odm_SQ_process_patch_RT_CID_819x_Acer( - IN PDM_ODM_T pDM_Odm, - IN u1Byte isCCKrate, - IN u1Byte PWDB_ALL, - IN u1Byte path, - IN u1Byte RSSI -) -{ - u1Byte SQ = 0; - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - - if(isCCKrate){ - - RT_TRACE(COMP_DBG, DBG_WARNING, ("odm_SQ_process_patch_RT_Acer\n")); - -#if OS_WIN_FROM_WIN8(OS_VERSION) - - if(PWDB_ALL >= 50) - SQ = 100; - else if(PWDB_ALL >= 35 && PWDB_ALL < 50) - SQ = 80; - else if(PWDB_ALL >= 30 && PWDB_ALL < 35) - SQ = 60; - else if(PWDB_ALL >= 25 && PWDB_ALL < 30) - SQ = 40; - else if(PWDB_ALL >= 20 && PWDB_ALL < 25) - SQ = 20; - else - SQ = 10; -#else - if(PWDB_ALL >= 50) - SQ = 100; - else if(PWDB_ALL >= 35 && PWDB_ALL < 50) - SQ = 80; - else if(PWDB_ALL >= 30 && PWDB_ALL < 35) - SQ = 60; - else if(PWDB_ALL >= 25 && PWDB_ALL < 30) - SQ = 40; - else if(PWDB_ALL >= 20 && PWDB_ALL < 25) - SQ = 20; - else - SQ = 10; - - if(PWDB_ALL == 0)// Abnormal case, do not indicate the value above 20 on Win7 - SQ = 20; -#endif - - - - } - else - {//OFDM rate - - if (IS_HARDWARE_TYPE_8192E(pDM_Odm->Adapter)) { - if(RSSI >= 45) - SQ = 100; - else if(RSSI >= 22 && RSSI < 45) - SQ = 80; - else if(RSSI >= 18 && RSSI < 22) - SQ = 40; - else - SQ = 20; - } - else - { - if(RSSI >= 35) - SQ = 100; - else if(RSSI >= 30 && RSSI < 35) - SQ = 80; - else if(RSSI >= 25 && RSSI < 30) - SQ = 40; - else - SQ = 20; - } - } - - RT_TRACE(COMP_DBG, DBG_LOUD, ("isCCKrate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", isCCKrate, PWDB_ALL, RSSI, SQ)); - -#endif - return SQ; -} - -static u1Byte -odm_EVMdbToPercentage( - IN s1Byte Value - ) -{ - // - // -33dB~0dB to 0%~99% - // - s1Byte ret_val; - - ret_val = Value; - ret_val /= 2; - - /*DbgPrint("Value=%d\n", Value);*/ - /*ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C Value=%d / %x\n", ret_val, ret_val));*/ -#ifdef ODM_EVM_ENHANCE_ANTDIV - if (ret_val >= 0) - ret_val = 0; - - if (ret_val <= -40) - ret_val = -40; - - ret_val = 0 - ret_val; - ret_val *= 3; -#else - if (ret_val >= 0) - ret_val = 0; - - if (ret_val <= -33) - ret_val = -33; - - ret_val = 0 - ret_val; - ret_val *= 3; - - if (ret_val == 99) - ret_val = 100; -#endif - - return (u1Byte)ret_val; -} - -static u1Byte -odm_EVMdbm_JaguarSeries( - IN s1Byte Value - ) -{ - s1Byte ret_val = Value; - - // -33dB~0dB to 33dB ~ 0dB - if(ret_val == -128) - ret_val = 127; - else if (ret_val < 0) - ret_val = 0 - ret_val; - - ret_val = ret_val >> 1; - return (u1Byte)ret_val; -} - -static s2Byte -odm_Cfo( - IN s1Byte Value -) -{ - s2Byte ret_val; - - if (Value < 0) - { - ret_val = 0 - Value; - ret_val = (ret_val << 1) + (ret_val >> 1) ; // *2.5~=312.5/2^7 - ret_val = ret_val | BIT12; // set bit12 as 1 for negative cfo - } - else - { - ret_val = Value; - ret_val = (ret_val << 1) + (ret_val>>1) ; // *2.5~=312.5/2^7 - } - return ret_val; -} - -u1Byte -phydm_rate_to_num_ss( - IN OUT PDM_ODM_T pDM_Odm, - IN u1Byte DataRate -) -{ - u1Byte num_ss = 1; - - if (DataRate <= ODM_RATE54M) - num_ss = 1; - else if (DataRate <= ODM_RATEMCS31) - num_ss = ((DataRate - ODM_RATEMCS0) >> 3)+1; - else if (DataRate <= ODM_RATEVHTSS1MCS9) - num_ss = 1; - else if (DataRate <= ODM_RATEVHTSS2MCS9) - num_ss = 2; - else if (DataRate <= ODM_RATEVHTSS3MCS9) - num_ss = 3; - else if (DataRate <= ODM_RATEVHTSS4MCS9) - num_ss = 4; - - return num_ss; -} - -#if(ODM_IC_11N_SERIES_SUPPORT == 1) - -#if (RTL8703B_SUPPORT == 1) -s1Byte -odm_CCKRSSI_8703B( - IN u2Byte LNA_idx, - IN u1Byte VGA_idx - ) -{ - s1Byte rx_pwr_all = 0x00; - - switch (LNA_idx) { - case 0xf: - rx_pwr_all = -48 - (2 * VGA_idx); - break; - case 0xb: - rx_pwr_all = -42 - (2 * VGA_idx); /*TBD*/ - break; - case 0xa: - rx_pwr_all = -36 - (2 * VGA_idx); - break; - case 8: - rx_pwr_all = -32 - (2 * VGA_idx); - break; - case 7: - rx_pwr_all = -19 - (2 * VGA_idx); - break; - case 4: - rx_pwr_all = -6 - (2 * VGA_idx); - break; - case 0: - rx_pwr_all = -2 - (2 * VGA_idx); - break; - default: - /*rx_pwr_all = -53+(2*(31-VGA_idx));*/ - /*DbgPrint("wrong LNA index\n");*/ - break; - - } - return rx_pwr_all; -} -#endif - -#if (RTL8195A_SUPPORT == 1) -s1Byte -odm_CCKRSSI_8195A( - IN OUT PDM_ODM_T pDM_Odm, - IN u2Byte LNA_idx, - IN u1Byte VGA_idx - ) -{ - s1Byte rx_pwr_all = 0; - s1Byte lna_gain = 0; - s1Byte lna_gain_table_0[8] = {0, -8, -15, -22, -29, -36, -45, -54}; - s1Byte lna_gain_table_1[8] = {0, -8, -15, -22, -29, -36, -45, -54};/*use 8195A to calibrate this table. 2016.06.24, Dino*/ - - if (pDM_Odm->cck_agc_report_type == 0) - lna_gain = lna_gain_table_0[LNA_idx]; - else - lna_gain = lna_gain_table_1[LNA_idx]; - - rx_pwr_all = lna_gain - (2 * VGA_idx); - - return rx_pwr_all; -} -#endif - -#if (RTL8192E_SUPPORT == 1) -s1Byte -odm_CCKRSSI_8192E( - IN OUT PDM_ODM_T pDM_Odm, - IN u2Byte LNA_idx, - IN u1Byte VGA_idx - ) -{ - s1Byte rx_pwr_all = 0; - s1Byte lna_gain = 0; - s1Byte lna_gain_table_0[8] = {15, 9, -10, -21, -23, -27, -43, -44}; - s1Byte lna_gain_table_1[8] = {24, 18, 13, -4, -11, -18, -31, -36};/*use 8192EU to calibrate this table. 2015.12.15, Dino*/ - - if (pDM_Odm->cck_agc_report_type == 0) - lna_gain = lna_gain_table_0[LNA_idx]; - else - lna_gain = lna_gain_table_1[LNA_idx]; - - rx_pwr_all = lna_gain - (2 * VGA_idx); - - return rx_pwr_all; -} -#endif - -#if (RTL8188E_SUPPORT == 1) -s1Byte -odm_CCKRSSI_8188E( - IN OUT PDM_ODM_T pDM_Odm, - IN u2Byte LNA_idx, - IN u1Byte VGA_idx - ) -{ - s1Byte rx_pwr_all = 0; - s1Byte lna_gain = 0; - s1Byte lna_gain_table_0[8] = {17, -1, -13, -29, -32, -35, -38, -41};/*only use lna0/1/2/3/7*/ - s1Byte lna_gain_table_1[8] = {29, 20, 12, 3, -6, -15, -24, -33}; /*only use lna3 /7*/ - - if (pDM_Odm->CutVersion >= ODM_CUT_I) /*SMIC*/ - lna_gain = lna_gain_table_0[LNA_idx]; - else /*TSMC*/ - lna_gain = lna_gain_table_1[LNA_idx]; - - rx_pwr_all = lna_gain - (2 * VGA_idx); - - return rx_pwr_all; -} -#endif - -VOID -odm_RxPhyStatus92CSeries_Parsing( - IN OUT PDM_ODM_T pDM_Odm, - OUT PODM_PHY_INFO_T pPhyInfo, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo - ) -{ - SWAT_T *pDM_SWAT_Table = &pDM_Odm->DM_SWAT_Table; - u1Byte i, Max_spatial_stream; - s1Byte rx_pwr[4], rx_pwr_all=0; - u1Byte EVM, PWDB_ALL = 0, PWDB_ALL_BT; - u1Byte RSSI, total_rssi=0; - BOOLEAN isCCKrate=FALSE; - u1Byte rf_rx_num = 0; - u1Byte cck_highpwr = 0; - u1Byte LNA_idx = 0; - u1Byte VGA_idx = 0; - u1Byte cck_agc_rpt; - u1Byte num_ss; - PPHY_STATUS_RPT_8192CD_T pPhyStaRpt = (PPHY_STATUS_RPT_8192CD_T)pPhyStatus; - - isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M) ? TRUE : FALSE; - - if (pPktinfo->bToSelf) - pDM_Odm->curr_station_id = pPktinfo->StationID; - - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; - - - if(isCCKrate) - { - pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; - cck_agc_rpt = pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a ; - - if (pDM_Odm->SupportICType & (ODM_RTL8703B)) { - - #if (RTL8703B_SUPPORT == 1) - if (pDM_Odm->cck_agc_report_type == 1) { /*4 bit LNA*/ - - u1Byte cck_agc_rpt_b = (pPhyStaRpt->cck_rpt_b_ofdm_cfosho_b & BIT7) ? 1 : 0; - - LNA_idx = (cck_agc_rpt_b << 3) | ((cck_agc_rpt & 0xE0) >> 5); - VGA_idx = (cck_agc_rpt & 0x1F); - - rx_pwr_all = odm_CCKRSSI_8703B(LNA_idx, VGA_idx); - } - #endif - } else { /*3 bit LNA*/ - - LNA_idx = ((cck_agc_rpt & 0xE0) >>5); - VGA_idx = (cck_agc_rpt & 0x1F); - - if (pDM_Odm->SupportICType & (ODM_RTL8188E)) { - - #if (RTL8188E_SUPPORT == 1) - rx_pwr_all = odm_CCKRSSI_8188E(pDM_Odm, LNA_idx, VGA_idx); - /**/ - #endif - } - #if (RTL8192E_SUPPORT == 1) - else if (pDM_Odm->SupportICType & (ODM_RTL8192E)) { - - rx_pwr_all = odm_CCKRSSI_8192E(pDM_Odm, LNA_idx, VGA_idx); - /**/ - } - #endif - #if (RTL8723B_SUPPORT == 1) - else if (pDM_Odm->SupportICType & (ODM_RTL8723B)) { - - rx_pwr_all = odm_CCKRSSI_8723B(LNA_idx,VGA_idx); - /**/ - } - #endif - #if (RTL8188F_SUPPORT == 1) - else if (pDM_Odm->SupportICType & (ODM_RTL8188F)) { - - rx_pwr_all = odm_CCKRSSI_8188F(LNA_idx, VGA_idx); - /**/ - } - #endif - #if (RTL8195A_SUPPORT == 1) - else if (pDM_Odm->SupportICType & (ODM_RTL8195A)) { - - rx_pwr_all = odm_CCKRSSI_8195A(LNA_idx, VGA_idx); - /**/ - } - #endif - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ExtLNAGain (( %d )), LNA_idx: (( 0x%x )), VGA_idx: (( 0x%x )), rx_pwr_all: (( %d ))\n", - pDM_Odm->ExtLNAGain, LNA_idx, VGA_idx, rx_pwr_all)); - - if (pDM_Odm->BoardType & ODM_BOARD_EXT_LNA) - rx_pwr_all -= pDM_Odm->ExtLNAGain; - - PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); - - if (pPktinfo->bToSelf) { - pDM_Odm->cck_lna_idx = LNA_idx; - pDM_Odm->cck_vga_idx = VGA_idx; - } - pPhyInfo->RxPWDBAll = PWDB_ALL; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; - pPhyInfo->RecvSignalPower = rx_pwr_all; -#endif - // - // (3) Get Signal Quality (EVM) - // - //if(pPktinfo->bPacketMatchBSSID) - { - u1Byte SQ,SQ_rpt; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if((pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->PatchID==RT_CID_819x_Lenovo)){ - SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,0,0); - }else if((pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->PatchID==RT_CID_819x_Acer)) - { - SQ = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,0); - }else -#endif - if(pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest){ - SQ = 100; - } - else{ - SQ_rpt = pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all; - - if(SQ_rpt > 64) - SQ = 0; - else if (SQ_rpt < 20) - SQ = 100; - else - SQ = ((64-SQ_rpt) * 100) / 44; - - } - - //DbgPrint("cck SQ = %d\n", SQ); - pPhyInfo->SignalQuality = SQ; - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; - } - - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { - if (i == 0) - pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; - else - pPhyInfo->RxMIMOSignalStrength[1] = 0; - } - } - else //2 is OFDM rate - { - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; - - // - // (1)Get RSSI for HT rate - // - - for(i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX; i++) - { - // 2008/01/30 MH we will judge RF RX path now. - if (pDM_Odm->RFPathRxEnable & BIT(i)) - rf_rx_num++; - //else - //continue; - - rx_pwr[i] = ((pPhyStaRpt->path_agc[i].gain& 0x3F)*2) - 110; - - if (pPktinfo->bToSelf) { - pDM_Odm->ofdm_agc_idx[i] = (pPhyStaRpt->path_agc[i].gain & 0x3F); - /**/ - } - - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->RxPwr[i] = rx_pwr[i]; - #endif - - /* Translate DBM to percentage. */ - RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); - total_rssi += RSSI; - //RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI)); - - pPhyInfo->RxMIMOSignalStrength[i] =(u1Byte) RSSI; - - #if (DM_ODM_SUPPORT_TYPE & (/*ODM_WIN|*/ODM_CE|ODM_AP)) - //Get Rx snr value in DB - pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = (s4Byte)(pPhyStaRpt->path_rxsnr[i]/2); - #endif - - /* Record Signal Strength for next packet */ - //if(pPktinfo->bPacketMatchBSSID) - { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if((pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->PatchID==RT_CID_819x_Lenovo)) - { - if(i==ODM_RF_PATH_A) - pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm,isCCKrate,PWDB_ALL,i,RSSI); - - } - else if((pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->PatchID==RT_CID_819x_Acer)) - { - pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Acer(pDM_Odm,isCCKrate,PWDB_ALL,0,RSSI); - } -#endif - } - } - - - // - // (2)PWDB, Average PWDB cacluated by hardware (for rate adaptive) - // - rx_pwr_all = (((pPhyStaRpt->cck_sig_qual_ofdm_pwdb_all) >> 1 )& 0x7f) -110; - - PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); - - - pPhyInfo->RxPWDBAll = PWDB_ALL; - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll)); - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; - pPhyInfo->RxPower = rx_pwr_all; - pPhyInfo->RecvSignalPower = rx_pwr_all; - #endif - - if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==19)){ - //do nothing - }else if((pDM_Odm->SupportPlatform == ODM_WIN) &&(pDM_Odm->PatchID==25)){ - //do nothing - } - else{//pMgntInfo->CustomerID != RT_CID_819x_Lenovo - // - // (3)EVM of HT rate - // - if(pPktinfo->DataRate >=ODM_RATEMCS8 && pPktinfo->DataRate <=ODM_RATEMCS15) - Max_spatial_stream = 2; //both spatial stream make sense - else - Max_spatial_stream = 1; //only spatial stream 1 makes sense - - for(i=0; i>= 1" because the compilor of free build environment - // fill most significant bit to "zero" when doing shifting operation which may change a negative - // value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. - EVM = odm_EVMdbToPercentage( (pPhyStaRpt->stream_rxevm[i] )); //dbm - - //GET_RX_STATUS_DESC_RX_MCS(pDesc), pDrvInfo->rxevm[i], "%", EVM)); - - //if(pPktinfo->bPacketMatchBSSID) - { - if(i==ODM_RF_PATH_A) // Fill value in RFD, Get the first spatial stream only - { - pPhyInfo->SignalQuality = (u1Byte)(EVM & 0xff); - } - pPhyInfo->RxMIMOSignalQuality[i] = (u1Byte)(EVM & 0xff); - } - } - } - - num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); - ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->path_cfotail, num_ss); - - } -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - //UI BSS List signal strength(in percentage), make it good looking, from 0~100. - //It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). - if(isCCKrate) - { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ - pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, TRUE, TRUE); -#else - pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ -#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ - } - else - { - if (rf_rx_num != 0) - { - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - // 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ - pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, (total_rssi /= rf_rx_num), TRUE, FALSE); - #else - pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, total_rssi /= rf_rx_num)); - #endif - } - } -#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE))*/ - - //DbgPrint("isCCKrate = %d, pPhyInfo->RxPWDBAll = %d, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a = 0x%x\n", - //isCCKrate, pPhyInfo->RxPWDBAll, pPhyStaRpt->cck_agc_rpt_ofdm_cfosho_a); - - //For 92C/92D HW (Hybrid) Antenna Diversity -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - //For 88E HW Antenna Diversity - pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->ant_sel; - pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->ant_sel_b; - pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antsel_rx_keep_2; -#endif -} -#endif - -#if ODM_IC_11AC_SERIES_SUPPORT - -VOID -odm_RxPhyBWJaguarSeries_Parsing( - OUT PODM_PHY_INFO_T pPhyInfo, - IN PODM_PACKET_INFO_T pPktinfo, - IN PPHY_STATUS_RPT_8812_T pPhyStaRpt -) -{ - - if(pPktinfo->DataRate <= ODM_RATE54M) { - switch (pPhyStaRpt->r_RFMOD) { - case 1: - if (pPhyStaRpt->sub_chnl == 0) - pPhyInfo->BandWidth = 1; - else - pPhyInfo->BandWidth = 0; - break; - - case 2: - if (pPhyStaRpt->sub_chnl == 0) - pPhyInfo->BandWidth = 2; - else if (pPhyStaRpt->sub_chnl == 9 || pPhyStaRpt->sub_chnl == 10) - pPhyInfo->BandWidth = 1; - else - pPhyInfo->BandWidth = 0; - break; - - default: - case 0: - pPhyInfo->BandWidth = 0; - break; - } - } - -} - -VOID -odm_RxPhyStatusJaguarSeries_Parsing( - IN OUT PDM_ODM_T pDM_Odm, - OUT PODM_PHY_INFO_T pPhyInfo, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo -) -{ - u1Byte i, Max_spatial_stream; - s1Byte rx_pwr[4], rx_pwr_all = 0; - u1Byte EVM, EVMdbm, PWDB_ALL = 0, PWDB_ALL_BT; - u1Byte RSSI, avg_rssi = 0, best_rssi = 0, second_rssi = 0; - u1Byte isCCKrate = 0; - u1Byte rf_rx_num = 0; - u1Byte cck_highpwr = 0; - u1Byte LNA_idx, VGA_idx; - PPHY_STATUS_RPT_8812_T pPhyStaRpt = (PPHY_STATUS_RPT_8812_T)pPhyStatus; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - u1Byte num_ss; - - odm_RxPhyBWJaguarSeries_Parsing(pPhyInfo, pPktinfo, pPhyStaRpt); - - if (pPktinfo->DataRate <= ODM_RATE11M) - isCCKrate = TRUE; - else - isCCKrate = FALSE; - - if (pPktinfo->bToSelf) - pDM_Odm->curr_station_id = pPktinfo->StationID; - else - pDM_Odm->curr_station_id = 0xff; - - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = -1; - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_B] = -1; - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_C] = -1; - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_D] = -1; - - if (isCCKrate) { - u1Byte cck_agc_rpt; - pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; - - /*(1)Hardware does not provide RSSI for CCK*/ - /*(2)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ - - /*if(pHalData->eRFPowerState == eRfOn)*/ - cck_highpwr = pDM_Odm->bCckHighPower; - /*else*/ - /*cck_highpwr = FALSE;*/ - - cck_agc_rpt = pPhyStaRpt->cfosho[0] ; - LNA_idx = ((cck_agc_rpt & 0xE0) >> 5); - VGA_idx = (cck_agc_rpt & 0x1F); - - if (pDM_Odm->SupportICType == ODM_RTL8812) { - switch (LNA_idx) { - case 7: - if (VGA_idx <= 27) - rx_pwr_all = -100 + 2 * (27 - VGA_idx); /*VGA_idx = 27~2*/ - else - rx_pwr_all = -100; - break; - case 6: - rx_pwr_all = -48 + 2 * (2 - VGA_idx); /*VGA_idx = 2~0*/ - break; - case 5: - rx_pwr_all = -42 + 2 * (7 - VGA_idx); /*VGA_idx = 7~5*/ - break; - case 4: - rx_pwr_all = -36 + 2 * (7 - VGA_idx); /*VGA_idx = 7~4*/ - break; - case 3: - /*rx_pwr_all = -28 + 2*(7-VGA_idx); VGA_idx = 7~0*/ - rx_pwr_all = -24 + 2 * (7 - VGA_idx); /*VGA_idx = 7~0*/ - break; - case 2: - if (cck_highpwr) - rx_pwr_all = -12 + 2 * (5 - VGA_idx); /*VGA_idx = 5~0*/ - else - rx_pwr_all = -6 + 2 * (5 - VGA_idx); - break; - case 1: - rx_pwr_all = 8 - 2 * VGA_idx; - break; - case 0: - rx_pwr_all = 14 - 2 * VGA_idx; - break; - default: - /*DbgPrint("CCK Exception default\n");*/ - break; - } - rx_pwr_all += 6; - PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); - - if (cck_highpwr == FALSE) { - if (PWDB_ALL >= 80) - PWDB_ALL = ((PWDB_ALL - 80) << 1) + ((PWDB_ALL - 80) >> 1) + 80; - else if ((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) - PWDB_ALL += 3; - if (PWDB_ALL > 100) - PWDB_ALL = 100; - } - } else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A)) { - s1Byte Pout = -6; - - switch (LNA_idx) { - case 5: - rx_pwr_all = Pout - 32 - (2 * VGA_idx); - break; - case 4: - rx_pwr_all = Pout - 24 - (2 * VGA_idx); - break; - case 2: - rx_pwr_all = Pout - 11 - (2 * VGA_idx); - break; - case 1: - rx_pwr_all = Pout + 5 - (2 * VGA_idx); - break; - case 0: - rx_pwr_all = Pout + 21 - (2 * VGA_idx); - break; - } - PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); - } else if (pDM_Odm->SupportICType == ODM_RTL8814A || pDM_Odm->SupportICType == ODM_RTL8822B) { - s1Byte Pout = -6; - - switch (LNA_idx) { - /*CCK only use LNA: 2, 3, 5, 7*/ - case 7: - rx_pwr_all = Pout - 32 - (2 * VGA_idx); - break; - case 5: - rx_pwr_all = Pout - 22 - (2 * VGA_idx); - break; - case 3: - rx_pwr_all = Pout - 2 - (2 * VGA_idx); - break; - case 2: - rx_pwr_all = Pout + 5 - (2 * VGA_idx); - break; - /*case 6:*/ - /*rx_pwr_all = Pout -26 - (2*VGA_idx);*/ - /*break;*/ - /*case 4:*/ - /*rx_pwr_all = Pout - 8 - (2*VGA_idx);*/ - /*break;*/ - /*case 1:*/ - /*rx_pwr_all = Pout + 21 - (2*VGA_idx);*/ - /*break;*/ - /*case 0:*/ - /*rx_pwr_all = Pout + 10 - (2*VGA_idx);*/ -/* // break;*/ - default: -/* //DbgPrint("CCK Exception default\n");*/ - break; - } - PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); - } - - pDM_Odm->cck_lna_idx = LNA_idx; - pDM_Odm->cck_vga_idx = VGA_idx; - pPhyInfo->RxPWDBAll = PWDB_ALL; -/* //if(pPktinfo->StationID == 0)*/ -/* //{*/ -/* // DbgPrint("CCK: LNA_idx = %d, VGA_idx = %d, pPhyInfo->RxPWDBAll = %d\n",*/ -/* // LNA_idx, VGA_idx, pPhyInfo->RxPWDBAll);*/ -/* //}*/ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->BTRxRSSIPercentage = PWDB_ALL; - pPhyInfo->RecvSignalPower = rx_pwr_all; -#endif - /*(3) Get Signal Quality (EVM)*/ - /*if (pPktinfo->bPacketMatchBSSID)*/ - { - u1Byte SQ, SQ_rpt; - - if ((pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { - SQ = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, 0, 0); - } else if (pPhyInfo->RxPWDBAll > 40 && !pDM_Odm->bInHctTest) { - SQ = 100; - } else { - SQ_rpt = pPhyStaRpt->pwdb_all; - - if (SQ_rpt > 64) - SQ = 0; - else if (SQ_rpt < 20) - SQ = 100; - else - SQ = ((64 - SQ_rpt) * 100) / 44; - } - -/* //DbgPrint("cck SQ = %d\n", SQ);*/ - pPhyInfo->SignalQuality = SQ; - pPhyInfo->RxMIMOSignalQuality[ODM_RF_PATH_A] = SQ; - } - - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { - if (i == 0) - pPhyInfo->RxMIMOSignalStrength[0] = PWDB_ALL; - else - pPhyInfo->RxMIMOSignalStrength[i] = 0; - } - } else { - /*is OFDM rate*/ - pDM_FatTable->hw_antsw_occur = pPhyStaRpt->hw_antsw_occur; - - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; - - /*(1)Get RSSI for OFDM rate*/ - - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { - /*2008/01/30 MH we will judge RF RX path now.*/ -/* //DbgPrint("pDM_Odm->RFPathRxEnable = %x\n", pDM_Odm->RFPathRxEnable);*/ - if (pDM_Odm->RFPathRxEnable & BIT(i)) - rf_rx_num++; -/* //else*/ -/* //continue;*/ - /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ -/* //if((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) && (!pDM_Odm->bIsMPChip))*/ - if (i < ODM_RF_PATH_C) - rx_pwr[i] = (pPhyStaRpt->gain_trsw[i] & 0x7F) - 110; - else - rx_pwr[i] = (pPhyStaRpt->gain_trsw_cd[i - 2] & 0x7F) - 110; -/* //else*/ - /*rx_pwr[i] = ((pPhyStaRpt->gain_trsw[i]& 0x3F)*2) - 110; OLD FORMULA*/ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->RxPwr[i] = rx_pwr[i]; -#endif - - /* Translate DBM to percentage. */ - RSSI = odm_QueryRxPwrPercentage(rx_pwr[i]); - - /*total_rssi += RSSI;*/ - /*Get the best two RSSI*/ - if (RSSI > best_rssi && RSSI > second_rssi) { - second_rssi = best_rssi; - best_rssi = RSSI; - } else if (RSSI > second_rssi && RSSI <= best_rssi) - second_rssi = RSSI; - - /*RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI));*/ - - pPhyInfo->RxMIMOSignalStrength[i] = (u1Byte) RSSI; - - - /*Get Rx snr value in DB*/ - if (i < ODM_RF_PATH_C) - pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->rxsnr[i] / 2; - else if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) - pPhyInfo->RxSNR[i] = pDM_Odm->PhyDbgInfo.RxSNRdB[i] = pPhyStaRpt->csi_current[i - 2] / 2; - -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) - /*(2) CFO_short & CFO_tail*/ - if (i < ODM_RF_PATH_C) { - pPhyInfo->Cfo_short[i] = odm_Cfo((pPhyStaRpt->cfosho[i])); - pPhyInfo->Cfo_tail[i] = odm_Cfo((pPhyStaRpt->cfotail[i])); - } -#endif - /* Record Signal Strength for next packet */ - if (pPktinfo->bPacketMatchBSSID) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if ((pDM_Odm->SupportPlatform == ODM_WIN) && - (pDM_Odm->PatchID == RT_CID_819x_Lenovo)) { - if (i == ODM_RF_PATH_A) - pPhyInfo->SignalQuality = odm_SQ_process_patch_RT_CID_819x_Lenovo(pDM_Odm, isCCKrate, PWDB_ALL, i, RSSI); - - } -#endif - } - } - - /*(3)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ - - /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ - if ((pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) && (!pDM_Odm->bIsMPChip)) - rx_pwr_all = (pPhyStaRpt->pwdb_all & 0x7f) - 110; - else - rx_pwr_all = (((pPhyStaRpt->pwdb_all) >> 1) & 0x7f) - 110; /*OLD FORMULA*/ - - PWDB_ALL_BT = PWDB_ALL = odm_QueryRxPwrPercentage(rx_pwr_all); - - pPhyInfo->RxPWDBAll = PWDB_ALL; - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("ODM OFDM RSSI=%d\n",pPhyInfo->RxPWDBAll));*/ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->BTRxRSSIPercentage = PWDB_ALL_BT; - pPhyInfo->RxPower = rx_pwr_all; - pPhyInfo->RecvSignalPower = rx_pwr_all; -#endif - - if ((pDM_Odm->SupportPlatform == ODM_WIN) && (pDM_Odm->PatchID == 19)) { - /*do nothing*/ - } else { - /*pMgntInfo->CustomerID != RT_CID_819x_Lenovo*/ - - /*(4)EVM of OFDM rate*/ - - if ((pPktinfo->DataRate >= ODM_RATEMCS8) && - (pPktinfo->DataRate <= ODM_RATEMCS15)) - Max_spatial_stream = 2; - else if ((pPktinfo->DataRate >= ODM_RATEVHTSS2MCS0) && - (pPktinfo->DataRate <= ODM_RATEVHTSS2MCS9)) - Max_spatial_stream = 2; - else if ((pPktinfo->DataRate >= ODM_RATEMCS16) && - (pPktinfo->DataRate <= ODM_RATEMCS23)) - Max_spatial_stream = 3; - else if ((pPktinfo->DataRate >= ODM_RATEVHTSS3MCS0) && - (pPktinfo->DataRate <= ODM_RATEVHTSS3MCS9)) - Max_spatial_stream = 3; - else - Max_spatial_stream = 1; - - /*if (pPktinfo->bPacketMatchBSSID) */ - { - /*DbgPrint("pPktinfo->DataRate = %d\n", pPktinfo->DataRate);*/ - - for (i = 0; i < Max_spatial_stream; i++) { - /*Do not use shift operation like "rx_evmX >>= 1" because the compilor of free build environment*/ - /*fill most significant bit to "zero" when doing shifting operation which may change a negative*/ - /*value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore.*/ - - if (pPktinfo->DataRate >= ODM_RATE6M && pPktinfo->DataRate <= ODM_RATE54M) { - if (i == ODM_RF_PATH_A) { - EVM = odm_EVMdbToPercentage((pPhyStaRpt->sigevm)); /*dbm*/ - EVM += 20; - if (EVM > 100) - EVM = 100; - } - } else { - if (i < ODM_RF_PATH_C) { - if (pPhyStaRpt->rxevm[i] == -128) - pPhyStaRpt->rxevm[i] = -25; - EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm[i])); /*dbm*/ - } else { - if (pPhyStaRpt->rxevm_cd[i - 2] == -128){ - pPhyStaRpt->rxevm_cd[i - 2] = -25; - } - EVM = odm_EVMdbToPercentage((pPhyStaRpt->rxevm_cd[i - 2])); /*dbm*/ - } - } - - if (i < ODM_RF_PATH_C) - EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm[i]); - else - EVMdbm = odm_EVMdbm_JaguarSeries(pPhyStaRpt->rxevm_cd[i - 2]); - /*RT_DISP(FRX, RX_PHY_SQ, ("RXRATE=%x RXEVM=%x EVM=%s%d\n",*/ - /*pPktinfo->DataRate, pPhyStaRpt->rxevm[i], "%", EVM));*/ - - { - if (i == ODM_RF_PATH_A) { - /*Fill value in RFD, Get the first spatial stream only*/ - pPhyInfo->SignalQuality = EVM; - } - pPhyInfo->RxMIMOSignalQuality[i] = EVM; -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) - pPhyInfo->RxMIMOEVMdbm[i] = EVMdbm; -#endif - } - } - } - } - - num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); - ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->cfotail, num_ss); - - } -/* //DbgPrint("isCCKrate= %d, pPhyInfo->SignalStrength=%d % PWDB_AL=%d rf_rx_num=%d\n", isCCKrate, pPhyInfo->SignalStrength, PWDB_ALL, rf_rx_num);*/ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - /*UI BSS List signal strength(in percentage), make it good looking, from 0~100.*/ - /*It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp().*/ - if (isCCKrate) { -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /*2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ - pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, PWDB_ALL, FALSE, TRUE); -#else - pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, PWDB_ALL));/*PWDB_ALL;*/ -#endif - } else { - if (rf_rx_num != 0) { - /* 2015/01 Sean, use the best two RSSI only, suggested by Ynlin and ChenYu.*/ - if (rf_rx_num == 1) - avg_rssi = best_rssi; - else - avg_rssi = (best_rssi + second_rssi)/2; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /* 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ - pPhyInfo->SignalStrength = SignalScaleProc(pDM_Odm->Adapter, avg_rssi, FALSE, FALSE); -#else - pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pDM_Odm, avg_rssi)); -#endif - } - } -#endif - pDM_Odm->RxPWDBAve = pDM_Odm->RxPWDBAve + pPhyInfo->RxPWDBAll; - - pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_anta; - pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_antb; - pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_antc; - pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_antd; - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_ANT_DIV, ODM_DBG_LOUD, ("StaID[%d]: antidx_anta = ((%d)), MatchBSSID = ((%d))\n", pPktinfo->StationID, pPhyStaRpt->antidx_anta, pPktinfo->bPacketMatchBSSID));*/ - - -/* DbgPrint("pPhyStaRpt->antidx_anta = %d, pPhyStaRpt->antidx_antb = %d\n",*/ -/* pPhyStaRpt->antidx_anta, pPhyStaRpt->antidx_antb);*/ -/* DbgPrint("----------------------------\n");*/ -/* DbgPrint("pPktinfo->StationID=%d, pPktinfo->DataRate=0x%x\n",pPktinfo->StationID, pPktinfo->DataRate);*/ -/* DbgPrint("pPhyStaRpt->r_RFMOD = %d\n", pPhyStaRpt->r_RFMOD);*/ -/* DbgPrint("pPhyStaRpt->gain_trsw[0]=0x%x, pPhyStaRpt->gain_trsw[1]=0x%x\n",*/ -/* pPhyStaRpt->gain_trsw[0],pPhyStaRpt->gain_trsw[1]);*/ -/* DbgPrint("pPhyStaRpt->gain_trsw[2]=0x%x, pPhyStaRpt->gain_trsw[3]=0x%x\n",*/ -/* pPhyStaRpt->gain_trsw_cd[0],pPhyStaRpt->gain_trsw_cd[1]);*/ -/* DbgPrint("pPhyStaRpt->pwdb_all = 0x%x, pPhyInfo->RxPWDBAll = %d\n", pPhyStaRpt->pwdb_all, pPhyInfo->RxPWDBAll);*/ -/* DbgPrint("pPhyStaRpt->cfotail[i] = 0x%x, pPhyStaRpt->CFO_tail[i] = 0x%x\n", pPhyStaRpt->cfotail[0], pPhyStaRpt->cfotail[1]);*/ -/* DbgPrint("pPhyStaRpt->rxevm[0] = %d, pPhyStaRpt->rxevm[1] = %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1]);*/ -/* DbgPrint("pPhyStaRpt->rxevm[2] = %d, pPhyStaRpt->rxevm[3] = %d\n", pPhyStaRpt->rxevm_cd[0], pPhyStaRpt->rxevm_cd[1]);*/ -/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[0]=%d, pPhyInfo->RxMIMOSignalStrength[1]=%d, RxPWDBAll=%d\n",*/ -/* pPhyInfo->RxMIMOSignalStrength[0], pPhyInfo->RxMIMOSignalStrength[1], pPhyInfo->RxPWDBAll);*/ -/* DbgPrint("pPhyInfo->RxMIMOSignalStrength[2]=%d, pPhyInfo->RxMIMOSignalStrength[3]=%d\n",*/ -/* pPhyInfo->RxMIMOSignalStrength[2], pPhyInfo->RxMIMOSignalStrength[3]);*/ -/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[0]=%d, pPhyInfo->RxMIMOSignalQuality[1]=%d\n",*/ -/* pPhyInfo->RxMIMOSignalQuality[0], pPhyInfo->RxMIMOSignalQuality[1]);*/ -/* DbgPrint("ppPhyInfo->RxMIMOSignalQuality[2]=%d, pPhyInfo->RxMIMOSignalQuality[3]=%d\n",*/ -/* pPhyInfo->RxMIMOSignalQuality[2], pPhyInfo->RxMIMOSignalQuality[3]);*/ - -} - -#endif - -VOID -phydm_reset_rssi_for_dm( - IN OUT PDM_ODM_T pDM_Odm, - IN u1Byte station_id - ) -{ - PSTA_INFO_T pEntry; - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - #endif - - pEntry = pDM_Odm->pODM_StaInfo[station_id]; - - if (!IS_STA_VALID(pEntry)) { - /**/ - return; - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("Reset RSSI for macid = (( %d ))\n", station_id)); - - - pEntry->rssi_stat.UndecoratedSmoothedCCK = -1; - pEntry->rssi_stat.UndecoratedSmoothedOFDM = -1; - pEntry->rssi_stat.UndecoratedSmoothedPWDB = -1; - pEntry->rssi_stat.OFDM_pkt = 0; - pEntry->rssi_stat.CCK_pkt = 0; - pEntry->rssi_stat.CCK_sum_power = 0; - pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_INIT; - pEntry->rssi_stat.PacketMap = 0; - pEntry->rssi_stat.ValidBit = 0; - - /*in WIN Driver: sta_ID==0 -> pEntry==NULL -> default port HAL_Data*/ - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - pEntry->bUsed = 0; - if (station_id == 0) { - - pHalData->UndecoratedSmoothedPWDB = -1; - /**/ - } - #endif - -} - -VOID -odm_Init_RSSIForDM( - IN OUT PDM_ODM_T pDM_Odm - ) -{ - -} - -VOID -odm_Process_RSSIForDM( - IN OUT PDM_ODM_T pDM_Odm, - OUT PODM_PHY_INFO_T pPhyInfo, - IN PODM_PACKET_INFO_T pPktinfo - ) -{ - - s4Byte UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK, UndecoratedSmoothedOFDM, RSSI_Ave, CCK_pkt; - u1Byte i, isCCKrate=0; - u1Byte RSSI_max, RSSI_min; - u4Byte Weighting=0; - u1Byte send_rssi_2_fw = 0; - PSTA_INFO_T pEntry; - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - #endif - - if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) - return; - - #ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY - odm_S0S1_SwAntDivByCtrlFrame_ProcessRSSI(pDM_Odm, pPhyInfo, pPktinfo); - #endif - - // - // 2012/05/30 MH/Luke.Lee Add some description - // In windows driver: AP/IBSS mode STA - // - //if (pDM_Odm->SupportPlatform == ODM_WIN) - //{ - // pEntry = pDM_Odm->pODM_StaInfo[pDM_Odm->pAidMap[pPktinfo->StationID-1]]; - //} - //else - pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; - - if (!IS_STA_VALID(pEntry)) { - return; - /**/ - } - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - if ((pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) && - (pDM_FatTable->enable_ctrl_frame_antdiv) - ) - { - if (pPktinfo->bPacketMatchBSSID) - pDM_Odm->data_frame_num++; - - if ((pDM_FatTable->use_ctrl_frame_antdiv)) { - if (!pPktinfo->bToSelf)/*data frame + CTRL frame*/ - return; - } else { - if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ - return; - } - } else -#endif - { - if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ - return; - } - - if(pPktinfo->bPacketBeacon) - pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; - - isCCKrate = (pPktinfo->DataRate <= ODM_RATE11M )?TRUE :FALSE; - pDM_Odm->RxRate = pPktinfo->DataRate; - - //--------------Statistic for antenna/path diversity------------------ - if(pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) - { - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - ODM_Process_RSSIForAntDiv(pDM_Odm,pPhyInfo,pPktinfo); - #endif - } - #if(defined(CONFIG_PATH_DIVERSITY)) - else if(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV) - { - phydm_process_rssi_for_path_div(pDM_Odm,pPhyInfo,pPktinfo); - } - #endif - //-----------------Smart Antenna Debug Message------------------// - - UndecoratedSmoothedCCK = pEntry->rssi_stat.UndecoratedSmoothedCCK; - UndecoratedSmoothedOFDM = pEntry->rssi_stat.UndecoratedSmoothedOFDM; - UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; - - if(pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) - { - - if(!isCCKrate)//ofdm rate - { -#if (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) { - u1Byte RX_count = 0; - u4Byte RSSI_linear = 0; - - if (pDM_Odm->RXAntStatus & ODM_RF_A) { - pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; - RX_count++; - RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]); - } else - pDM_Odm->RSSI_A = 0; - - if (pDM_Odm->RXAntStatus & ODM_RF_B) { - pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; - RX_count++; - RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]); - } else - pDM_Odm->RSSI_B = 0; - - if (pDM_Odm->RXAntStatus & ODM_RF_C) { - pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; - RX_count++; - RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]); - } else - pDM_Odm->RSSI_C = 0; - - if (pDM_Odm->RXAntStatus & ODM_RF_D) { - pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; - RX_count++; - RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]); - } else - pDM_Odm->RSSI_D = 0; - - /* Calculate average RSSI */ - switch (RX_count) { - case 2: - RSSI_linear = (RSSI_linear >> 1); - break; - case 3: - RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ - break; - case 4: - RSSI_linear = (RSSI_linear >> 2); - break; - } - RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); - } else -#endif - { - if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B] == 0) { - RSSI_Ave = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; - pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; - pDM_Odm->RSSI_B = 0; - } else { - /*DbgPrint("pRfd->Status.RxMIMOSignalStrength[0] = %d, pRfd->Status.RxMIMOSignalStrength[1] = %d\n",*/ - /*pRfd->Status.RxMIMOSignalStrength[0], pRfd->Status.RxMIMOSignalStrength[1]);*/ - pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; - pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; - - if (pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A] > pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]) { - RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; - RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; - } else { - RSSI_max = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; - RSSI_min = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; - } - if ((RSSI_max - RSSI_min) < 3) - RSSI_Ave = RSSI_max; - else if ((RSSI_max - RSSI_min) < 6) - RSSI_Ave = RSSI_max - 1; - else if ((RSSI_max - RSSI_min) < 10) - RSSI_Ave = RSSI_max - 2; - else - RSSI_Ave = RSSI_max - 3; - } - } - - //1 Process OFDM RSSI - if(UndecoratedSmoothedOFDM <= 0) // initialize - { - UndecoratedSmoothedOFDM = pPhyInfo->RxPWDBAll; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_INIT: (( %d ))\n", UndecoratedSmoothedOFDM)); - } - else - { - if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedOFDM) - { - UndecoratedSmoothedOFDM = - ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + - (RSSI_Ave)) /(Rx_Smooth_Factor); - UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM + 1; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_1: (( %d ))\n", UndecoratedSmoothedOFDM)); - } - else - { - UndecoratedSmoothedOFDM = - ( ((UndecoratedSmoothedOFDM)*(Rx_Smooth_Factor-1)) + - (RSSI_Ave)) /(Rx_Smooth_Factor); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("OFDM_2: (( %d ))\n", UndecoratedSmoothedOFDM)); - } - } - if (pEntry->rssi_stat.OFDM_pkt != 64) { - i = 63; - pEntry->rssi_stat.OFDM_pkt -= (u1Byte)(((pEntry->rssi_stat.PacketMap>>i)&BIT0)-1); - } - pEntry->rssi_stat.PacketMap = (pEntry->rssi_stat.PacketMap<<1) | BIT0; - - } - else - { - RSSI_Ave = pPhyInfo->RxPWDBAll; - pDM_Odm->RSSI_A = (u1Byte) pPhyInfo->RxPWDBAll; - pDM_Odm->RSSI_B = 0xFF; - pDM_Odm->RSSI_C = 0xFF; - pDM_Odm->RSSI_D = 0xFF; - - if (pEntry->rssi_stat.CCK_pkt <= 63) - pEntry->rssi_stat.CCK_pkt++; - - //1 Process CCK RSSI - if(UndecoratedSmoothedCCK <= 0) // initialize - { - UndecoratedSmoothedCCK = pPhyInfo->RxPWDBAll; - pEntry->rssi_stat.CCK_sum_power = (u2Byte)pPhyInfo->RxPWDBAll ; /*reset*/ - pEntry->rssi_stat.CCK_pkt = 1; /*reset*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_INIT: (( %d ))\n", UndecoratedSmoothedCCK)); - } else if (pEntry->rssi_stat.CCK_pkt <= CCK_RSSI_INIT_COUNT) { - - pEntry->rssi_stat.CCK_sum_power = pEntry->rssi_stat.CCK_sum_power + (u2Byte)pPhyInfo->RxPWDBAll; - UndecoratedSmoothedCCK = pEntry->rssi_stat.CCK_sum_power/pEntry->rssi_stat.CCK_pkt; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_0: (( %d )), SumPow = (( %d )), CCK_pkt = (( %d ))\n", - UndecoratedSmoothedCCK, pEntry->rssi_stat.CCK_sum_power, pEntry->rssi_stat.CCK_pkt)); - } - else - { - if(pPhyInfo->RxPWDBAll > (u4Byte)UndecoratedSmoothedCCK) - { - UndecoratedSmoothedCCK = - ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + - (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); - UndecoratedSmoothedCCK = UndecoratedSmoothedCCK + 1; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_1: (( %d ))\n", UndecoratedSmoothedCCK)); - } - else - { - UndecoratedSmoothedCCK = - ( ((UndecoratedSmoothedCCK)*(Rx_Smooth_Factor-1)) + - (pPhyInfo->RxPWDBAll)) /(Rx_Smooth_Factor); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("CCK_2: (( %d ))\n", UndecoratedSmoothedCCK)); - } - } - i = 63; - pEntry->rssi_stat.OFDM_pkt -= (u1Byte)((pEntry->rssi_stat.PacketMap>>i)&BIT0); - pEntry->rssi_stat.PacketMap = pEntry->rssi_stat.PacketMap<<1; - } - - //if(pEntry) - { - //2011.07.28 LukeLee: modified to prevent unstable CCK RSSI - if (pEntry->rssi_stat.OFDM_pkt == 64) { /* speed up when all packets are OFDM*/ - UndecoratedSmoothedPWDB = UndecoratedSmoothedOFDM; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_0[%d] = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK)); - } else { - if (pEntry->rssi_stat.ValidBit < 64) - pEntry->rssi_stat.ValidBit++; - - if (pEntry->rssi_stat.ValidBit == 64) { - Weighting = ((pEntry->rssi_stat.OFDM_pkt) > 4) ? 64 : (pEntry->rssi_stat.OFDM_pkt<<4); - UndecoratedSmoothedPWDB = (Weighting*UndecoratedSmoothedOFDM+(64-Weighting)*UndecoratedSmoothedCCK)>>6; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_1[%d] = (( %d )), W = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK, Weighting)); - } else { - if (pEntry->rssi_stat.ValidBit != 0) - UndecoratedSmoothedPWDB = (pEntry->rssi_stat.OFDM_pkt*UndecoratedSmoothedOFDM+(pEntry->rssi_stat.ValidBit-pEntry->rssi_stat.OFDM_pkt)*UndecoratedSmoothedCCK)/pEntry->rssi_stat.ValidBit; - else - UndecoratedSmoothedPWDB = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("PWDB_2[%d] = (( %d )), OFDM_pkt = (( %d )), Valid_Bit = (( %d ))\n", pPktinfo->StationID, UndecoratedSmoothedCCK, pEntry->rssi_stat.OFDM_pkt, pEntry->rssi_stat.ValidBit)); - } - } - - - if ((pEntry->rssi_stat.OFDM_pkt >= 1 || pEntry->rssi_stat.CCK_pkt >= 5) && (pEntry->rssi_stat.bsend_rssi == RA_RSSI_STATE_INIT)) { - - send_rssi_2_fw = 1; - pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_SEND; - } - - pEntry->rssi_stat.UndecoratedSmoothedCCK = UndecoratedSmoothedCCK; - pEntry->rssi_stat.UndecoratedSmoothedOFDM = UndecoratedSmoothedOFDM; - pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; - - - - if (send_rssi_2_fw) /* Trigger init rate by RSSI */ { - - if (pEntry->rssi_stat.OFDM_pkt != 0) - pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedOFDM; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("[Send to FW] PWDB = (( %d )), OFDM_pkt = (( %d )), CCK_pkt = (( %d ))\n", - UndecoratedSmoothedPWDB, pEntry->rssi_stat.OFDM_pkt, pEntry->rssi_stat.CCK_pkt)); - - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - phydm_ra_rssi_rpt_wk(pDM_Odm); - #endif - } - - - /*in WIN Driver: sta_ID==0 -> pEntry==NULL -> default port HAL_Data*/ - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - - if (pPktinfo->StationID == 0) { - /**/ - pHalData->UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; - } - #endif - - //DbgPrint("OFDM_pkt=%d, Weighting=%d\n", OFDM_pkt, Weighting); - //DbgPrint("UndecoratedSmoothedOFDM=%d, UndecoratedSmoothedPWDB=%d, UndecoratedSmoothedCCK=%d\n", - // UndecoratedSmoothedOFDM, UndecoratedSmoothedPWDB, UndecoratedSmoothedCCK); - - } - - } -} - - -#if(ODM_IC_11N_SERIES_SUPPORT ==1) -// -// Endianness before calling this API -// -VOID -ODM_PhyStatusQuery_92CSeries( - IN OUT PDM_ODM_T pDM_Odm, - OUT PODM_PHY_INFO_T pPhyInfo, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo - ) -{ - odm_RxPhyStatus92CSeries_Parsing(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); - odm_Process_RSSIForDM(pDM_Odm, pPhyInfo, pPktinfo); -} -#endif - - -// -// Endianness before calling this API -// -#if ODM_IC_11AC_SERIES_SUPPORT - -VOID -ODM_PhyStatusQuery_JaguarSeries( - IN OUT PDM_ODM_T pDM_Odm, - OUT PODM_PHY_INFO_T pPhyInfo, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo - ) -{ - odm_RxPhyStatusJaguarSeries_Parsing(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); - odm_Process_RSSIForDM(pDM_Odm, pPhyInfo, pPktinfo); - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - /*phydm_sbd_check(pDM_Odm);*/ - #endif -} -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -phydm_normal_driver_rx_sniffer( - IN OUT PDM_ODM_T pDM_Odm, - IN pu1Byte pDesc, - IN PRT_RFD_STATUS pRtRfdStatus, - IN pu1Byte pDrvInfo, - IN u1Byte PHYStatus - ) -{ - #if (defined(CONFIG_PHYDM_RX_SNIFFER_PARSING)) - u4Byte *pMsg; - u2Byte seq_num; - pFAT_T pDM_FatTable = &pDM_Odm->DM_FatTable; - - if (pRtRfdStatus->PacketReportType != NORMAL_RX) - return; - - if (!pDM_Odm->bLinked) { - if (pRtRfdStatus->bHwError) - return; - } - - if (!(pDM_FatTable->FAT_State == FAT_TRAINING_STATE)) - return; - - if (PHYStatus == TRUE) { - - if ((pDM_Odm->rx_pkt_type == Type_BlockAck) || (pDM_Odm->rx_pkt_type == Type_RTS) || (pDM_Odm->rx_pkt_type == Type_CTS)) - seq_num = 0; - else - seq_num = pRtRfdStatus->Seq_Num; - - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%04d , %01s , Rate=0x%02x , L=%04d , %s , %s", - seq_num, - /*pRtRfdStatus->MacID,*/ - ((pRtRfdStatus->bCRC) ? "C" : (pRtRfdStatus->bIsAMPDU) ? "A" : "_"), - pRtRfdStatus->DataRate, - pRtRfdStatus->Length, - ((pRtRfdStatus->BandWidth == 0) ? "20M":((pRtRfdStatus->BandWidth == 1) ? "40M" : "80M")), - ((pRtRfdStatus->bLDPC) ? "LDP" : "BCC") - )); - - if (pDM_Odm->rx_pkt_type == Type_Asoc_Req) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_REQ")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Asoc_Rsp) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "AS_RSP")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Probe_Req) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_REQ")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Probe_Rsp) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "PR_RSP")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Deauth) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "DEAUTH")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Beacon) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BEACON")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_BlockAckReq) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "BA_REQ")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_RTS) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__RTS_")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_CTS) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__CTS_")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Ack) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__ACK_")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_BlockAck) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "__BA__")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Data) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "_DATA_")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_Data_Ack) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "Data_Ack")); - /**/ - } else if (pDM_Odm->rx_pkt_type == Type_QosData) { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [%s]", "QoS_Data")); - /**/ - } else { - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [0x%x]", pDM_Odm->rx_pkt_type)); - /**/ - } - - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , [RSSI=%d,%d,%d,%d ]", - pDM_Odm->RSSI_A, - pDM_Odm->RSSI_B, - pDM_Odm->RSSI_C, - pDM_Odm->RSSI_D - )); - - pMsg = (pu4Byte)pDrvInfo; - - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, (" , P-STS[28:0]=%08x-%08x-%08x-%08x-%08x-%08x-%08x\n", - pMsg[6], pMsg[5], pMsg[4], pMsg[3], pMsg[2], pMsg[1], pMsg[1])); - } else { - - ODM_RT_TRACE_F(pDM_Odm, ODM_COMP_SNIFFER, ODM_DBG_LOUD, ("%04d , %01s , Rate=0x%02x , L=%04d , %s , %s\n", - pRtRfdStatus->Seq_Num, - /*pRtRfdStatus->MacID,*/ - ((pRtRfdStatus->bCRC) ? "C" : (pRtRfdStatus->bIsAMPDU) ? "A" : "_"), - pRtRfdStatus->DataRate, - pRtRfdStatus->Length, - ((pRtRfdStatus->BandWidth == 0) ? "20M" : ((pRtRfdStatus->BandWidth == 1) ? "40M" : "80M")), - ((pRtRfdStatus->bLDPC) ? "LDP" : "BCC") - )); - } - - - #endif -} -#endif - -VOID -ODM_PhyStatusQuery( - IN OUT PDM_ODM_T pDM_Odm, - OUT PODM_PHY_INFO_T pPhyInfo, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo - ) -{ -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_IC_PHY_STATUE_NEW_TYPE) { - phydm_RxPhyStatusNewType(pDM_Odm, pPhyStatus, pPktinfo, pPhyInfo); - return; - } -#endif - -#if ODM_IC_11AC_SERIES_SUPPORT - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - ODM_PhyStatusQuery_JaguarSeries(pDM_Odm, pPhyInfo, pPhyStatus, pPktinfo); -#endif - -#if ODM_IC_11N_SERIES_SUPPORT - if(pDM_Odm->SupportICType & ODM_IC_11N_SERIES ) - ODM_PhyStatusQuery_92CSeries(pDM_Odm,pPhyInfo,pPhyStatus,pPktinfo); -#endif -} - -// For future use. -VOID -ODM_MacStatusQuery( - IN OUT PDM_ODM_T pDM_Odm, - IN pu1Byte pMacStatus, - IN u1Byte MacID, - IN BOOLEAN bPacketMatchBSSID, - IN BOOLEAN bPacketToSelf, - IN BOOLEAN bPacketBeacon - ) -{ - // 2011/10/19 Driver team will handle in the future. - -} - - -// -// If you want to add a new IC, Please follow below template and generate a new one. -// -// - -HAL_STATUS -ODM_ConfigRFWithHeaderFile( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_Config_Type ConfigType, - IN ODM_RF_RADIO_PATH_E eRFPath - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("===>ODM_ConfigRFWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", - pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); - -//1 AP doesn't use PHYDM power tracking table in these ICs -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -#if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812) - { - if(ConfigType == CONFIG_RF_RADIO) { - if(eRFPath == ODM_RF_PATH_A){ - READ_AND_CONFIG_MP(8812A,_RadioA); - } - else if(eRFPath == ODM_RF_PATH_B){ - READ_AND_CONFIG_MP(8812A,_RadioB); - } - } - else if(ConfigType == CONFIG_RF_TXPWR_LMT) { - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - if ((pHalData->EEPROMSVID == 0x17AA && pHalData->EEPROMSMID == 0xA811) || - (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0xA812) || - (pHalData->EEPROMSVID == 0x10EC && pHalData->EEPROMSMID == 0x8812)) - READ_AND_CONFIG_MP(8812A,_TXPWR_LMT_HM812A03); - else - #endif - READ_AND_CONFIG_MP(8812A,_TXPWR_LMT); - } - } -#endif -#if (RTL8821A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821) - { - if(ConfigType == CONFIG_RF_RADIO) { - if(eRFPath == ODM_RF_PATH_A){ - READ_AND_CONFIG_MP(8821A,_RadioA); - } - } - else if(ConfigType == CONFIG_RF_TXPWR_LMT) { - if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { - if (pDM_Odm->ExtPA5G || pDM_Odm->ExtLNA5G) - READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_FEM); - else - READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8811AU_IPA); - } - else { - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (pMgntInfo->CustomerID == RT_CID_8821AE_ASUS_MB) - READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_8mm); - else if (pMgntInfo->CustomerID == RT_CID_ASUS_NB) - READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A_SAR_5mm); - else - #endif - READ_AND_CONFIG_MP(8821A,_TXPWR_LMT_8821A); - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigRFWithHeaderFile\n")); - } -#endif -#if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8192E) - { - if(ConfigType == CONFIG_RF_RADIO) { - if(eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8192E,_RadioA); - else if(eRFPath == ODM_RF_PATH_B) - READ_AND_CONFIG_MP(8192E,_RadioB); - } else if (ConfigType == CONFIG_RF_TXPWR_LMT) { -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) /*Refine by Vincent Lan for 5mm SAR pwr limit*/ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - if ((pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8192) || - (pHalData->EEPROMSVID == 0x11AD && pHalData->EEPROMSMID == 0x8193)) - READ_AND_CONFIG_MP(8192E, _TXPWR_LMT_8192E_SAR_5mm); - else -#endif - READ_AND_CONFIG_MP(8192E, _TXPWR_LMT); - } - } -#endif -#if (RTL8723D_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - if (ConfigType == CONFIG_RF_RADIO) { - if (eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8723D, _RadioA); - } else if (ConfigType == CONFIG_RF_TXPWR_LMT) - READ_AND_CONFIG_MP(8723D, _TXPWR_LMT); - } -#endif -#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) - -//1 All platforms support -#if (RTL8188E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188E) - { - if(ConfigType == CONFIG_RF_RADIO) { - if(eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8188E,_RadioA); - } - else if(ConfigType == CONFIG_RF_TXPWR_LMT) - READ_AND_CONFIG_MP(8188E,_TXPWR_LMT); - } -#endif -#if (RTL8723B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723B) { - if (ConfigType == CONFIG_RF_RADIO) - READ_AND_CONFIG_MP(8723B, _RadioA); - else if (ConfigType == CONFIG_RF_TXPWR_LMT) - READ_AND_CONFIG_MP(8723B, _TXPWR_LMT); - } -#endif -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8814A) - { - if(ConfigType == CONFIG_RF_RADIO) { - if(eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8814A,_RadioA); - else if(eRFPath == ODM_RF_PATH_B) - READ_AND_CONFIG_MP(8814A,_RadioB); - else if(eRFPath == ODM_RF_PATH_C) - READ_AND_CONFIG_MP(8814A,_RadioC); - else if(eRFPath == ODM_RF_PATH_D) - READ_AND_CONFIG_MP(8814A,_RadioD); - } - else if(ConfigType == CONFIG_RF_TXPWR_LMT) - READ_AND_CONFIG_MP(8814A,_TXPWR_LMT); - } -#endif -#if (RTL8703B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8703B) { - if (ConfigType == CONFIG_RF_RADIO) { - if (eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8703B, _RadioA); - } - } -#endif -#if (RTL8188F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188F) { - if (ConfigType == CONFIG_RF_RADIO) { - if (eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8188F, _RadioA); - } else if (ConfigType == CONFIG_RF_TXPWR_LMT) - READ_AND_CONFIG_MP(8188F, _TXPWR_LMT); - } -#endif -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) { - if (ConfigType == CONFIG_RF_RADIO) { - if (eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8822B, _RadioA); - else if (eRFPath == ODM_RF_PATH_B) - READ_AND_CONFIG_MP(8822B, _RadioB); - } else if(ConfigType == CONFIG_RF_TXPWR_LMT) - if (pDM_Odm->RFEType == 5) - READ_AND_CONFIG_MP(8822B, _TXPWR_LMT_type5); - else - READ_AND_CONFIG_MP(8822B, _TXPWR_LMT); - } -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8197F) { - if (ConfigType == CONFIG_RF_RADIO) { - if (eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG_MP(8197F, _RadioA); - else if (eRFPath == ODM_RF_PATH_B) - READ_AND_CONFIG_MP(8197F, _RadioB); - } - } -#endif - -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) { - if (ConfigType == CONFIG_RF_RADIO) { - if (eRFPath == ODM_RF_PATH_A) - READ_AND_CONFIG(8821C, _RadioA); - } else if (ConfigType == CONFIG_RF_TXPWR_LMT) - READ_AND_CONFIG(8821C, _TXPWR_LMT); - } -#endif - - return HAL_STATUS_SUCCESS; -} - -HAL_STATUS -ODM_ConfigRFWithTxPwrTrackHeaderFile( - IN PDM_ODM_T pDM_Odm - ) -{ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("===>ODM_ConfigRFWithTxPwrTrackHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", - pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); - - -//1 AP doesn't use PHYDM power tracking table in these ICs -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -#if RTL8821A_SUPPORT - if(pDM_Odm->SupportICType == ODM_RTL8821) - { - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8821A,_TxPowerTrack_PCIE); - else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8821A,_TxPowerTrack_USB); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8821A,_TxPowerTrack_SDIO); - } -#endif -#if RTL8812A_SUPPORT - if(pDM_Odm->SupportICType == ODM_RTL8812) - { - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8812A,_TxPowerTrack_PCIE); - else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { - if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) - READ_AND_CONFIG_MP(8812A,_TxPowerTrack_RFE3); - else - READ_AND_CONFIG_MP(8812A,_TxPowerTrack_USB); - } - - } -#endif -#if RTL8192E_SUPPORT - if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8192E,_TxPowerTrack_PCIE); - else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8192E,_TxPowerTrack_USB); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8192E,_TxPowerTrack_SDIO); - } -#endif -#if RTL8723D_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8723D, _TxPowerTrack_PCIE); - else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8723D, _TxPowerTrack_USB); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8723D, _TxPowerTrack_SDIO); - - READ_AND_CONFIG_MP(8723D, _TxXtalTrack); - } -#endif -#if RTL8188E_SUPPORT - if(pDM_Odm->SupportICType == ODM_RTL8188E) - { - if (PHY_QueryMacReg(pDM_Odm->Adapter, 0xF0, 0xF000) >= 8) { /*if 0xF0[15:12] >= 8, SMIC*/ - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8188E, _TxPowerTrack_PCIE_ICUT); - else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8188E, _TxPowerTrack_USB_ICUT); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8188E, _TxPowerTrack_SDIO_ICUT); - } else { /*else 0xF0[15:12] < 8, TSMC*/ - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8188E, _TxPowerTrack_PCIE); - else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8188E, _TxPowerTrack_USB); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8188E, _TxPowerTrack_SDIO); - } - - } -#endif -#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) - -//1 All platforms support -#if RTL8723B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8723B) { - if (pDM_Odm->SupportInterface == ODM_ITRF_PCIE) - READ_AND_CONFIG_MP(8723B, _TxPowerTrack_PCIE); - else if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8723B, _TxPowerTrack_USB); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8723B, _TxPowerTrack_SDIO); - } -#endif -#if RTL8814A_SUPPORT - if(pDM_Odm->SupportICType == ODM_RTL8814A) - { - if(pDM_Odm->RFEType == 0) - READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type0); - else if(pDM_Odm->RFEType == 2) - READ_AND_CONFIG_MP(8814A,_TxPowerTrack_Type2); - else if (pDM_Odm->RFEType == 5) - READ_AND_CONFIG_MP(8814A, _TxPowerTrack_Type5); - else - READ_AND_CONFIG_MP(8814A,_TxPowerTrack); - - READ_AND_CONFIG_MP(8814A, _TxPowerTSSI); - } -#endif -#if RTL8703B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8703B) { - if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8703B, _TxPowerTrack_USB); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8703B, _TxPowerTrack_SDIO); - - READ_AND_CONFIG_MP(8703B, _TxXtalTrack); - } -#endif - -#if RTL8188F_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8188F) { - if (pDM_Odm->SupportInterface == ODM_ITRF_USB) - READ_AND_CONFIG_MP(8188F, _TxPowerTrack_USB); - else if (pDM_Odm->SupportInterface == ODM_ITRF_SDIO) - READ_AND_CONFIG_MP(8188F, _TxPowerTrack_SDIO); - } -#endif - -#if RTL8822B_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8822B) { - if (pDM_Odm->RFEType == 0) - READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type0); - else if (pDM_Odm->RFEType == 1) - READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type1); - else if ((pDM_Odm->RFEType == 3) || (pDM_Odm->RFEType == 5)) - READ_AND_CONFIG_MP(8822B, _TxPowerTrack_Type3_Type5); - else if (pDM_Odm->RFEType == 6) - READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type6); - else if (pDM_Odm->RFEType == 7) - READ_AND_CONFIG_MP(8822B, _TxPowerTrack_type7); - else - READ_AND_CONFIG_MP(8822B, _TxPowerTrack); - } -#endif - -#if RTL8197F_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8197F) { - if (pDM_Odm->RFEType == 0) - READ_AND_CONFIG_MP(8197F, _TxPowerTrack_Type0); - else if (pDM_Odm->RFEType == 1) - READ_AND_CONFIG_MP(8197F, _TxPowerTrack_Type1); - else - READ_AND_CONFIG_MP(8197F, _TxPowerTrack); - } -#endif - -#if RTL8821C_SUPPORT - if (pDM_Odm->SupportICType == ODM_RTL8821C) - READ_AND_CONFIG(8821C, _TxPowerTrack); -#endif - - return HAL_STATUS_SUCCESS; -} - -HAL_STATUS -ODM_ConfigBBWithHeaderFile( - IN PDM_ODM_T pDM_Odm, - IN ODM_BB_Config_Type ConfigType - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); -#endif - -//1 AP doesn't use PHYDM initialization in these ICs -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -#if (RTL8812A_SUPPORT == 1) - if(pDM_Odm->SupportICType == ODM_RTL8812) - { - if (ConfigType == CONFIG_BB_PHY_REG) { - READ_AND_CONFIG_MP(8812A, _PHY_REG); - } else if (ConfigType == CONFIG_BB_AGC_TAB) { - READ_AND_CONFIG_MP(8812A, _AGC_TAB); - } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { - if (pDM_Odm->RFEType == 3 && pDM_Odm->bIsMPChip) - READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_ASUS); - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - else if (pMgntInfo->CustomerID == RT_CID_WNC_NEC && pDM_Odm->bIsMPChip) - READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_NEC); - #if RT_PLATFORM == PLATFORM_MACOSX - /*{1827}{1024} for BUFFALO power by rate table. Isaiah 2013-11-29*/ - else if (pMgntInfo->CustomerID == RT_CID_DNI_BUFFALO) - READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_DNI); - /* TP-Link T4UH, Isaiah 2015-03-16*/ - else if (pMgntInfo->CustomerID == RT_CID_TPLINK_HPWR) { - DbgPrint("RT_CID_TPLINK_HPWR:: _PHY_REG_PG_TPLINK\n"); - READ_AND_CONFIG_MP(8812A, _PHY_REG_PG_TPLINK); - } - #endif - #endif - else - READ_AND_CONFIG_MP(8812A, _PHY_REG_PG); - } - else if(ConfigType == CONFIG_BB_PHY_REG_MP){ - READ_AND_CONFIG_MP(8812A,_PHY_REG_MP); - } - else if(ConfigType == CONFIG_BB_AGC_TAB_DIFF) - { - if ((36 <= *pDM_Odm->pChannel) && (*pDM_Odm->pChannel <= 64)) - AGC_DIFF_CONFIG_MP(8812A,LB); - else if (100 <= *pDM_Odm->pChannel) - AGC_DIFF_CONFIG_MP(8812A,HB); - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8812AGCTABArray\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8812PHY_REGArray\n")); - } -#endif -#if (RTL8821A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821) { - if (ConfigType == CONFIG_BB_PHY_REG) { - READ_AND_CONFIG_MP(8821A, _PHY_REG); - } else if (ConfigType == CONFIG_BB_AGC_TAB) { - READ_AND_CONFIG_MP(8821A, _AGC_TAB); - } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - if ((pHalData->EEPROMSVID == 0x1043 && pHalData->EEPROMSMID == 0x207F)) - READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_E202SA); - else - #endif - #if (RT_PLATFORM == PLATFORM_MACOSX) - /*{1827}{1022} for BUFFALO power by rate table. Isaiah 2013-10-18*/ - if (pMgntInfo->CustomerID == RT_CID_DNI_BUFFALO) { - /*{1024} for BUFFALO power by rate table. (JP/US)*/ - if (pMgntInfo->ChannelPlan == RT_CHANNEL_DOMAIN_US_2G_CANADA_5G) - READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_DNI_US); - else - READ_AND_CONFIG_MP(8821A, _PHY_REG_PG_DNI_JP); - } else - #endif - #endif - READ_AND_CONFIG_MP(8821A,_PHY_REG_PG); - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() phy:Rtl8821AGCTABArray\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, (" ===> phy_ConfigBBWithHeaderFile() agc:Rtl8821PHY_REGArray\n")); - } -#endif -#if (RTL8192E_SUPPORT == 1) - if(pDM_Odm->SupportICType == ODM_RTL8192E) - { - if(ConfigType == CONFIG_BB_PHY_REG){ - READ_AND_CONFIG_MP(8192E,_PHY_REG); - }else if(ConfigType == CONFIG_BB_AGC_TAB){ - READ_AND_CONFIG_MP(8192E,_AGC_TAB); - }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ - READ_AND_CONFIG_MP(8192E,_PHY_REG_PG); - } - } -#endif -#if (RTL8723D_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - if (ConfigType == CONFIG_BB_PHY_REG) - READ_AND_CONFIG_MP(8723D, _PHY_REG); - else if (ConfigType == CONFIG_BB_AGC_TAB) - READ_AND_CONFIG_MP(8723D, _AGC_TAB); - else if (ConfigType == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8723D, _PHY_REG_PG); - } -#endif -#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) - - -//1 All platforms support -#if (RTL8188E_SUPPORT == 1) - if(pDM_Odm->SupportICType == ODM_RTL8188E) - { - if(ConfigType == CONFIG_BB_PHY_REG) - READ_AND_CONFIG_MP(8188E,_PHY_REG); - else if(ConfigType == CONFIG_BB_AGC_TAB) - READ_AND_CONFIG_MP(8188E,_AGC_TAB); - else if(ConfigType == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8188E,_PHY_REG_PG); - } -#endif -#if (RTL8723B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723B) { - if (ConfigType == CONFIG_BB_PHY_REG) { - READ_AND_CONFIG_MP(8723B, _PHY_REG); - } else if (ConfigType == CONFIG_BB_AGC_TAB) { - READ_AND_CONFIG_MP(8723B, _AGC_TAB); - } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { - READ_AND_CONFIG_MP(8723B, _PHY_REG_PG); - } - } -#endif -#if (RTL8814A_SUPPORT == 1) - if(pDM_Odm->SupportICType == ODM_RTL8814A) - { - if(ConfigType == CONFIG_BB_PHY_REG){ - READ_AND_CONFIG_MP(8814A,_PHY_REG); - }else if(ConfigType == CONFIG_BB_AGC_TAB){ - READ_AND_CONFIG_MP(8814A,_AGC_TAB); - }else if(ConfigType == CONFIG_BB_PHY_REG_PG){ - READ_AND_CONFIG_MP(8814A,_PHY_REG_PG); - }else if(ConfigType == CONFIG_BB_PHY_REG_MP){ - READ_AND_CONFIG_MP(8814A,_PHY_REG_MP); - } - } -#endif -#if (RTL8703B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8703B) { - if (ConfigType == CONFIG_BB_PHY_REG) - READ_AND_CONFIG_MP(8703B, _PHY_REG); - else if (ConfigType == CONFIG_BB_AGC_TAB) - READ_AND_CONFIG_MP(8703B, _AGC_TAB); - else if (ConfigType == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8703B, _PHY_REG_PG); - } -#endif -#if (RTL8188F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188F) { - if (ConfigType == CONFIG_BB_PHY_REG) - READ_AND_CONFIG_MP(8188F, _PHY_REG); - else if (ConfigType == CONFIG_BB_AGC_TAB) - READ_AND_CONFIG_MP(8188F, _AGC_TAB); - else if (ConfigType == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8188F, _PHY_REG_PG); - } -#endif -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) { - if (ConfigType == CONFIG_BB_PHY_REG) - READ_AND_CONFIG_MP(8822B, _PHY_REG); - else if (ConfigType == CONFIG_BB_AGC_TAB) - READ_AND_CONFIG_MP(8822B, _AGC_TAB); - else if (ConfigType == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8822B, _PHY_REG_PG); - /*else if (ConfigType == CONFIG_BB_PHY_REG_MP)*/ - /*READ_AND_CONFIG_MP(8822B, _PHY_REG_MP);*/ - } -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8197F) { - if (ConfigType == CONFIG_BB_PHY_REG) { - READ_AND_CONFIG_MP(8197F, _PHY_REG); - if (pDM_Odm->CutVersion == ODM_CUT_A) - phydm_phypara_a_cut(pDM_Odm); - } else if (ConfigType == CONFIG_BB_AGC_TAB) - READ_AND_CONFIG_MP(8197F, _AGC_TAB); -/* else if(ConfigType == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG_MP(8197F, _PHY_REG_PG); - else if(ConfigType == CONFIG_BB_PHY_REG_MP) - READ_AND_CONFIG_MP(8197F, _PHY_REG_MP); */ - } -#endif - -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - { - if (ConfigType == CONFIG_BB_PHY_REG) { - READ_AND_CONFIG(8821C, _PHY_REG); - } else if (ConfigType == CONFIG_BB_AGC_TAB) { - READ_AND_CONFIG(8821C, _AGC_TAB); - /* According to RFEtype, choosing correct AGC table*/ - if (pDM_Odm->RFEType == 2 || pDM_Odm->RFEType == 4 || pDM_Odm->RFEType == 7) - AGC_DIFF_CONFIG_MP(8821C, BTG); - } else if (ConfigType == CONFIG_BB_PHY_REG_PG) { - READ_AND_CONFIG(8821C, _PHY_REG_PG); - } - } -#endif - -#if (RTL8195A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8195A) - { - if(ConfigType == CONFIG_BB_PHY_REG) - READ_AND_CONFIG(8195A, _PHY_REG); - else if(ConfigType == CONFIG_BB_AGC_TAB) - READ_AND_CONFIG(8195A, _AGC_TAB); - else if(ConfigType == CONFIG_BB_PHY_REG_PG) - READ_AND_CONFIG(8195A, _PHY_REG_PG); - } -#endif - - return HAL_STATUS_SUCCESS; -} - -HAL_STATUS -ODM_ConfigMACWithHeaderFile( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("===>ODM_ConfigMACWithHeaderFile (%s)\n", (pDM_Odm->bIsMPChip) ? "MPChip" : "TestChip")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, - ("pDM_Odm->SupportPlatform: 0x%X, pDM_Odm->SupportInterface: 0x%X, pDM_Odm->BoardType: 0x%X\n", - pDM_Odm->SupportPlatform, pDM_Odm->SupportInterface, pDM_Odm->BoardType)); - -//1 AP doesn't use PHYDM initialization in these ICs -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -#if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812){ - READ_AND_CONFIG_MP(8812A, _MAC_REG); - } -#endif -#if (RTL8821A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821){ - READ_AND_CONFIG_MP(8821A, _MAC_REG); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("<===8821_ODM_ConfigMACwithHeaderFile\n")); - } -#endif -#if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8192E){ - READ_AND_CONFIG_MP(8192E, _MAC_REG); - } -#endif -#if (RTL8723D_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723D) - READ_AND_CONFIG_MP(8723D, _MAC_REG); -#endif -#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) - -//1 All platforms support -#if (RTL8188E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188E){ - READ_AND_CONFIG_MP(8188E, _MAC_REG); - } -#endif -#if (RTL8723B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723B) { - READ_AND_CONFIG_MP(8723B, _MAC_REG); - } -#endif -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8814A){ - READ_AND_CONFIG_MP(8814A, _MAC_REG); - } -#endif -#if (RTL8703B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8703B) - READ_AND_CONFIG_MP(8703B, _MAC_REG); -#endif -#if (RTL8188F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188F) - READ_AND_CONFIG_MP(8188F, _MAC_REG); -#endif -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) - READ_AND_CONFIG_MP(8822B, _MAC_REG); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8197F) - READ_AND_CONFIG_MP(8197F, _MAC_REG); -#endif - -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - READ_AND_CONFIG(8821C, _MAC_REG); -#endif - -#if (RTL8195A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8195A) - READ_AND_CONFIG_MP(8195A, _MAC_REG); -#endif - - return HAL_STATUS_SUCCESS; -} - -HAL_STATUS -ODM_ConfigFWWithHeaderFile( - IN PDM_ODM_T pDM_Odm, - IN ODM_FW_Config_Type ConfigType, - OUT u1Byte *pFirmware, - OUT u4Byte *pSize - ) -{ -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) - -#if (RTL8188E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188E) - { - #ifdef CONFIG_SFW_SUPPORTED - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8188E_T,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); - else if(ConfigType == CONFIG_FW_NIC_2) - READ_FIRMWARE_MP(8188E_S,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN_2) - READ_FIRMWARE_MP(8188E_S,_FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - if (ConfigType == CONFIG_FW_AP) - READ_FIRMWARE_MP(8188E_T,_FW_AP); - else if (ConfigType == CONFIG_FW_AP_2) - READ_FIRMWARE_MP(8188E_S,_FW_AP); - #endif //CONFIG_AP_WOWLAN - #else - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8188E_T,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8188E_T,_FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP) - READ_FIRMWARE_MP(8188E_T,_FW_AP); - #endif //CONFIG_AP_WOWLAN - #endif - } -#endif -#if (RTL8723B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723B) - { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8723B,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8723B,_FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE(8723B,_FW_AP_WoWLAN); - #endif - - } -#endif //#if (RTL8723B_SUPPORT == 1) -#if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812) - { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8812A,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8812A,_FW_WoWLAN); - else if (ConfigType == CONFIG_FW_BT) - READ_FIRMWARE_MP(8812A,_FW_NIC_BT); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE(8812A,_FW_AP); - #endif - } -#endif -#if (RTL8821A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821){ - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8821A,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8821A,_FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE_MP(8821A , _FW_AP); - #endif /*CONFIG_AP_WOWLAN*/ - else if (ConfigType == CONFIG_FW_BT) - READ_FIRMWARE_MP(8821A,_FW_NIC_BT); - } -#endif -#if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8192E) - { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8192E,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8192E,_FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE_MP(8192E,_FW_AP); - #endif - } -#endif -#if (RTL8723D_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723D) { - if (ConfigType == CONFIG_FW_NIC) { - READ_FIRMWARE_MP(8723D, _FW_NIC); - } else if (ConfigType == CONFIG_FW_WoWLAN) { - READ_FIRMWARE_MP(8723D, _FW_WoWLAN); - } - } -#endif -/*#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8814A) - { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8814A, _FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8814A, _FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE_MP(8814A, _FW_AP); - #endif - } -#endif */ - -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8814A) - { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8814A,_FW_NIC); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE_MP(8814A,_FW_AP); - #endif - } -#endif - -#if (RTL8703B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8703B) { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8703B, _FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8703B, _FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE(8703B, _FW_AP_WoWLAN); - #endif - } -#endif - -#if (RTL8188F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188F) { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8188F, _FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8188F, _FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP) - READ_FIRMWARE_MP(8188F, _FW_AP); - #endif - } -#endif - -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) { - - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8822B,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8822B, _FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE(8822B,_FW_AP); - #endif - } -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8197F) { - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8197F, _FW_NIC); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE(8197F , _FW_AP); - #endif - } -#endif - -#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN)) -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C){ - if (ConfigType == CONFIG_FW_NIC) - READ_FIRMWARE_MP(8821C,_FW_NIC); - else if (ConfigType == CONFIG_FW_WoWLAN) - READ_FIRMWARE_MP(8821C,_FW_WoWLAN); - #ifdef CONFIG_AP_WOWLAN - else if (ConfigType == CONFIG_FW_AP_WoWLAN) - READ_FIRMWARE_MP(8821C , _FW_AP); - #endif /*CONFIG_AP_WOWLAN*/ - } -#endif -#endif - -#endif//(DM_ODM_SUPPORT_TYPE != ODM_AP) - return HAL_STATUS_SUCCESS; -} - -u4Byte -ODM_GetHWImgVersion( - IN PDM_ODM_T pDM_Odm - ) -{ - u4Byte Version=0; - -//1 AP doesn't use PHYDM initialization in these ICs -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -#if (RTL8821A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821) - Version = GET_VERSION_MP(8821A,_MAC_REG); -#endif -#if (RTL8192E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8192E) - Version = GET_VERSION_MP(8192E,_MAC_REG); -#endif -#if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812) - Version = GET_VERSION_MP(8812A,_MAC_REG); -#endif -#if (RTL8723D_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723D) - Version = GET_VERSION_MP(8723D, _MAC_REG); -#endif -#endif //(DM_ODM_SUPPORT_TYPE != ODM_AP) - -/*1 All platforms support*/ -#if (RTL8188E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188E) - Version = GET_VERSION_MP(8188E,_MAC_REG); -#endif -#if (RTL8723B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8723B) - Version = GET_VERSION_MP(8723B, _MAC_REG); -#endif -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8814A) - Version = GET_VERSION_MP(8814A,_MAC_REG); -#endif -#if (RTL8703B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8703B) - Version = GET_VERSION_MP(8703B, _MAC_REG); -#endif -#if (RTL8188F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188F) - Version = GET_VERSION_MP(8188F, _MAC_REG); -#endif -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) - Version = GET_VERSION_MP(8822B, _MAC_REG); -#endif - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8197F) - Version = GET_VERSION_MP(8197F, _MAC_REG); -#endif - -#if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - Version = GET_VERSION(8821C, _MAC_REG); -#endif - - return Version; -} - -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -/* For 8822B only!! need to move to FW finally */ -/*==============================================*/ - -VOID -phydm_ResetPhyInfo( - IN PDM_ODM_T pPhydm, - OUT PODM_PHY_INFO_T pPhyInfo -) -{ - pPhyInfo->RxPWDBAll = 0; - pPhyInfo->SignalQuality = 0; - pPhyInfo->BandWidth = 0; - pPhyInfo->RxCount = 0; - ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalQuality, 0 , 4); - ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOSignalStrength, 0, 4); - ODM_Memory_Set(pPhydm, pPhyInfo->RxSNR, 0, 4); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->RxPower = -110; - pPhyInfo->RecvSignalPower = -110; - pPhyInfo->BTRxRSSIPercentage = 0; - pPhyInfo->SignalStrength = 0; - pPhyInfo->btCoexPwrAdjust = 0; - pPhyInfo->channel = 0; - pPhyInfo->bMuPacket = 0; - pPhyInfo->bBeamformed = 0; - pPhyInfo->rxsc = 0; - ODM_Memory_Set(pPhydm, pPhyInfo->RxPwr, -110, 4); - ODM_Memory_Set(pPhydm, pPhyInfo->RxMIMOEVMdbm, 0, 4); - ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_short, 0, 8); - ODM_Memory_Set(pPhydm, pPhyInfo->Cfo_tail, 0, 8); -#endif -} - -VOID -phydm_SetPerPathPhyInfo( - IN u1Byte RxPath, - IN s1Byte RxPwr, - IN s1Byte RxEVM, - IN s1Byte Cfo_tail, - IN s1Byte RxSNR, - OUT PODM_PHY_INFO_T pPhyInfo -) -{ - u1Byte EVMdBm = 0; - u1Byte EVMPercentage = 0; - - /* SNR is S(8,1), EVM is S(8,1), CFO is S(8,7) */ - - if (RxEVM < 0) { - /* Calculate EVM in dBm */ - EVMdBm = ((u1Byte)(0 - RxEVM) >> 1); - - /* Calculate EVM in percentage */ - if (EVMdBm >= 33) - EVMPercentage = 100; - else - EVMPercentage = (EVMdBm << 1) + (EVMdBm); - } - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->RxPwr[RxPath] = RxPwr; - pPhyInfo->RxMIMOEVMdbm[RxPath] = EVMdBm; - - /* CFO = CFO_tail * 312.5 / 2^7 ~= CFO tail * 39/512 (kHz)*/ - pPhyInfo->Cfo_tail[RxPath] = Cfo_tail; - pPhyInfo->Cfo_tail[RxPath] = ((pPhyInfo->Cfo_tail[RxPath] << 5) + (pPhyInfo->Cfo_tail[RxPath] << 2) + - (pPhyInfo->Cfo_tail[RxPath] << 1) + (pPhyInfo->Cfo_tail[RxPath])) >> 9; -#endif - - pPhyInfo->RxMIMOSignalStrength[RxPath] = odm_QueryRxPwrPercentage(RxPwr); - pPhyInfo->RxMIMOSignalQuality[RxPath] = EVMPercentage; - pPhyInfo->RxSNR[RxPath] = RxSNR >> 1; - -/* - //if (pPktinfo->bPacketMatchBSSID) - { - DbgPrint("Path (%d)--------\n", RxPath); - DbgPrint("RxPwr = %d, Signal strength = %d\n", pPhyInfo->RxPwr[RxPath], pPhyInfo->RxMIMOSignalStrength[RxPath]); - DbgPrint("EVMdBm = %d, Signal quality = %d\n", pPhyInfo->RxMIMOEVMdbm[RxPath], pPhyInfo->RxMIMOSignalQuality[RxPath]); - DbgPrint("CFO = %d, SNR = %d\n", pPhyInfo->Cfo_tail[RxPath], pPhyInfo->RxSNR[RxPath]); - } -*/ -} - -VOID -phydm_SetCommonPhyInfo( - IN s1Byte RxPower, - IN u1Byte channel, - IN BOOLEAN bBeamformed, - IN BOOLEAN bMuPacket, - IN u1Byte bandwidth, - IN u1Byte signalQuality, - IN u1Byte rxsc, - OUT PODM_PHY_INFO_T pPhyInfo -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - pPhyInfo->RxPower = RxPower; /* RSSI in dB */ - pPhyInfo->RecvSignalPower = RxPower; /* RSSI in dB */ - pPhyInfo->channel = channel; /* channel number */ - pPhyInfo->bBeamformed = bBeamformed; /* apply BF */ - pPhyInfo->bMuPacket = bMuPacket; /* MU packet */ - pPhyInfo->rxsc = rxsc; -#endif - pPhyInfo->RxPWDBAll = odm_QueryRxPwrPercentage(RxPower); /* RSSI in percentage */ - pPhyInfo->SignalQuality = signalQuality; /* signal quality */ - pPhyInfo->BandWidth = bandwidth; /* bandwidth */ - -/* - //if (pPktinfo->bPacketMatchBSSID) - { - DbgPrint("RxPWDBAll = %d, RxPower = %d, RecvSignalPower = %d\n", pPhyInfo->RxPWDBAll, pPhyInfo->RxPower, pPhyInfo->RecvSignalPower); - DbgPrint("SignalQuality = %d\n", pPhyInfo->SignalQuality); - DbgPrint("bBeamformed = %d, bMuPacket = %d, RxCount = %d\n", pPhyInfo->bBeamformed, pPhyInfo->bMuPacket, pPhyInfo->RxCount + 1); - DbgPrint("channel = %d, rxsc = %d, BandWidth = %d\n", channel, rxsc, bandwidth); - } -*/ -} - -VOID -phydm_GetRxPhyStatusType0( - IN PDM_ODM_T pDM_Odm, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo, - OUT PODM_PHY_INFO_T pPhyInfo -) -{ - /* Type 0 is used for cck packet */ - - PPHY_STATUS_RPT_JAGUAR2_TYPE0 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE0)pPhyStatus; - u1Byte i, SQ = 0; - s1Byte RxPower = pPhyStaRpt->pwdb - 110; - - -#if (RTL8723D_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8723D) - RxPower = pPhyStaRpt->pwdb - 97; -#endif - - /* Calculate Signal Quality*/ - if (pPktinfo->bPacketMatchBSSID) { - if (pPhyStaRpt->signal_quality >= 64) - SQ = 0; - else if (pPhyStaRpt->signal_quality <= 20) - SQ = 100; - else { - /* mapping to 2~99% */ - SQ = 64 - pPhyStaRpt->signal_quality; - SQ = ((SQ << 3) + SQ) >> 2; - } - } - - /* Modify CCK PWDB if old AGC */ - if (pDM_Odm->cck_new_agc == FALSE) { - u1Byte LNA_idx, VGA_idx; - -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - LNA_idx = pPhyStaRpt->lna_l; - else -#endif - LNA_idx = ((pPhyStaRpt->lna_h << 3) | pPhyStaRpt->lna_l); - VGA_idx = pPhyStaRpt->vga; - -#if (RTL8723D_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8723D) - RxPower = odm_CCKRSSI_8723D(LNA_idx, VGA_idx); -#endif -#if (RTL8822B_SUPPORT == 1) - /* Need to do !! */ - /*if (pDM_Odm->SupportICType & ODM_RTL8822B) */ - /*RxPower = odm_CCKRSSI_8822B(LNA_idx, VGA_idx);*/ -#endif -#if (RTL8197F_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8197F) - RxPower = odm_CCKRSSI_8197F(pDM_Odm, LNA_idx, VGA_idx); -#endif - } - - /* Update CCK packet counter */ - pDM_Odm->PhyDbgInfo.NumQryPhyStatusCCK++; - - /*CCK no STBC and LDPC*/ - pDM_Odm->PhyDbgInfo.bLdpcPkt = FALSE; - pDM_Odm->PhyDbgInfo.bStbcPkt = FALSE; - - /* Update Common information */ - phydm_SetCommonPhyInfo(RxPower, pPhyStaRpt->channel, FALSE, - FALSE, ODM_BW20M, SQ, pPhyStaRpt->rxsc, pPhyInfo); - - /* Update CCK pwdb */ - phydm_SetPerPathPhyInfo(ODM_RF_PATH_A, RxPower, 0, 0, 0, pPhyInfo); /* Update per-path information */ - - pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_a; - pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_b; - pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_c; - pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_d; -/* - //if (pPktinfo->bPacketMatchBSSID) - { - DbgPrint("pwdb = 0x%x, MP gain index = 0x%x, TRSW = 0x%x\n", pPhyStaRpt->pwdb, pPhyStaRpt->gain, pPhyStaRpt->trsw); - DbgPrint("channel = %d, band = %d, rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->rxsc); - DbgPrint("agc_table = 0x%x, agc_rpt 0x%x, bb_power = 0x%x\n", pPhyStaRpt->agc_table, pPhyStaRpt->agc_rpt, pPhyStaRpt->bb_power); - DbgPrint("length = %d, SQ = %d\n", pPhyStaRpt->length, pPhyStaRpt->signal_quality); - DbgPrint("antidx a = 0x%x, b = 0x%x, c = 0x%x, d = 0x%x\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); - DbgPrint("rsvd_0 = 0x%x, rsvd_1 = 0x%x, rsvd_2 = 0x%x\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2); - DbgPrint("rsvd_3 = 0x%x, rsvd_4 = 0x%x, rsvd_5 = 0x%x\n", pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); - DbgPrint("rsvd_6 = 0x%x, rsvd_7 = 0x%x, rsvd_8 = 0x%x\n", pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7, pPhyStaRpt->rsvd_8); - } -*/ -} - -VOID -phydm_GetRxPhyStatusType1( - IN PDM_ODM_T pDM_Odm, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo, - OUT PODM_PHY_INFO_T pPhyInfo -) -{ - /* Type 1 is used for ofdm packet */ - - PPHY_STATUS_RPT_JAGUAR2_TYPE1 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE1)pPhyStatus; - s1Byte rx_pwr_db = -120; - u1Byte i, rxsc, bw = ODM_BW20M, RxCount = 0; - BOOLEAN bMU; - u1Byte num_ss; - - /* Update OFDM packet counter */ - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; - - /* Update per-path information */ - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { - if (pDM_Odm->RXAntStatus & BIT(i)) { - s1Byte rx_path_pwr_db; - - /* RX path counter */ - RxCount++; - - /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ - /* EVM report is reported by stream, not path */ - rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ - phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, pPhyStaRpt->rxevm[RxCount - 1], - pPhyStaRpt->cfo_tail[i], pPhyStaRpt->rxsnr[i], pPhyInfo); - - /* search maximum pwdb */ - if (rx_path_pwr_db > rx_pwr_db) - rx_pwr_db = rx_path_pwr_db; - } - } - - /* mapping RX counter from 1~4 to 0~3 */ - if (RxCount > 0) - pPhyInfo->RxCount = RxCount - 1; - - /* Check if MU packet or not */ - if ((pPhyStaRpt->gid != 0) && (pPhyStaRpt->gid != 63)) { - bMU = TRUE; - pDM_Odm->PhyDbgInfo.NumQryMuPkt++; - } else - bMU = FALSE; - - /* Count BF packet */ - pDM_Odm->PhyDbgInfo.NumQryBfPkt = pDM_Odm->PhyDbgInfo.NumQryBfPkt + pPhyStaRpt->beamformed; - - /*STBC or LDPC pkt*/ - pDM_Odm->PhyDbgInfo.bLdpcPkt = pPhyStaRpt->ldpc; - pDM_Odm->PhyDbgInfo.bStbcPkt = pPhyStaRpt->stbc; - - /* Check sub-channel */ - if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) - rxsc = pPhyStaRpt->l_rxsc; - else - rxsc = pPhyStaRpt->ht_rxsc; - - /* Check RX bandwidth */ - if (pDM_Odm->SupportICType & ODM_RTL8822B) { - if ((rxsc >= 1) && (rxsc <= 8)) - bw = ODM_BW20M; - else if ((rxsc >= 9) && (rxsc <= 12)) - bw = ODM_BW40M; - else if (rxsc >= 13) - bw = ODM_BW80M; - else - bw = pPhyStaRpt->rf_mode; - } else if (pDM_Odm->SupportICType & (ODM_RTL8197F|ODM_RTL8723D)) { - if (pPhyStaRpt->rf_mode == 0) - bw = ODM_BW20M; - else if ((rxsc == 1) || (rxsc == 2)) - bw = ODM_BW20M; - else - bw = ODM_BW40M; - } - - /* Update packet information */ - phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, - bMU, bw, odm_EVMdbToPercentage(pPhyStaRpt->rxevm[0]), rxsc, pPhyInfo); - - num_ss =phydm_rate_to_num_ss(pDM_Odm, pPktinfo->DataRate ); - - ODM_ParsingCFO(pDM_Odm, pPktinfo, pPhyStaRpt->cfo_tail, num_ss); - pDM_Odm->DM_FatTable.antsel_rx_keep_0 = pPhyStaRpt->antidx_a; - pDM_Odm->DM_FatTable.antsel_rx_keep_1 = pPhyStaRpt->antidx_b; - pDM_Odm->DM_FatTable.antsel_rx_keep_2 = pPhyStaRpt->antidx_c; - pDM_Odm->DM_FatTable.antsel_rx_keep_3 = pPhyStaRpt->antidx_d; - - if (pPktinfo->bPacketMatchBSSID) { -/* - DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d, rf_mode = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc, pPhyStaRpt->rf_mode); - DbgPrint("Antidx A = %d, B = %d, C = %d, D = %d\n", pPhyStaRpt->antidx_a, pPhyStaRpt->antidx_b, pPhyStaRpt->antidx_c, pPhyStaRpt->antidx_d); - DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); - DbgPrint("EVM A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxevm[0], pPhyStaRpt->rxevm[1], pPhyStaRpt->rxevm[2], pPhyStaRpt->rxevm[3]); - DbgPrint("SNR A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->rxsnr[0], pPhyStaRpt->rxsnr[1], pPhyStaRpt->rxsnr[2], pPhyStaRpt->rxsnr[3]); - DbgPrint("CFO A: %d, B: %d, C: %d, D: %d\n", pPhyStaRpt->cfo_tail[0], pPhyStaRpt->cfo_tail[1], pPhyStaRpt->cfo_tail[2], pPhyStaRpt->cfo_tail[3]); - DbgPrint("paid = %d, gid = %d, length = %d\n", (pPhyStaRpt->paid + (pPhyStaRpt->paid_msb<<8)), pPhyStaRpt->gid, pPhyStaRpt->lsig_length); - DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); - DbgPrint("NBI: %d, pos: %d\n", pPhyStaRpt->nb_intf_flag, (pPhyStaRpt->intf_pos + (pPhyStaRpt->intf_pos_msb<<8))); - DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4, pPhyStaRpt->rsvd_5); -*/ - if ((pPhyStaRpt->gid != 0) && (pPhyStaRpt->gid != 63)) { - if (pPktinfo->DataRate >= ODM_RATEVHTSS1MCS0) - pDM_Odm->PhyDbgInfo.NumQryMuVhtPkt[pPktinfo->DataRate - 0x2C]++; - } else { - if (pPktinfo->DataRate >= ODM_RATEVHTSS1MCS0) - pDM_Odm->PhyDbgInfo.NumQryVhtPkt[pPktinfo->DataRate - 0x2C]++; - } - } -/* - DbgPrint("phydm_GetRxPhyStatusType1 pPktinfo->bPacketMatchBSSID = %d\n", pPktinfo->bPacketMatchBSSID); - DbgPrint("pPktinfo->DataRate = 0x%x\n", pPktinfo->DataRate); -*/ -} - -VOID -phydm_GetRxPhyStatusType2( - IN PDM_ODM_T pDM_Odm, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo, - OUT PODM_PHY_INFO_T pPhyInfo -) -{ - PPHY_STATUS_RPT_JAGUAR2_TYPE2 pPhyStaRpt = (PPHY_STATUS_RPT_JAGUAR2_TYPE2)pPhyStatus; - s1Byte rx_pwr_db = -120; - u1Byte i, rxsc, bw = ODM_BW20M, RxCount = 0; - - /* Update OFDM packet counter */ - pDM_Odm->PhyDbgInfo.NumQryPhyStatusOFDM++; - - /* Update per-path information */ - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { - if (pDM_Odm->RXAntStatus & BIT(i)) { - s1Byte rx_path_pwr_db; - - /* RX path counter */ - RxCount++; - - /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ -#if (RTL8197F_SUPPORT == 1) - if ((pDM_Odm->SupportICType & ODM_RTL8197F) && (pPhyStaRpt->pwdb[i] == 0x7f)) { /*for 97f workaround*/ - - if (i == ODM_RF_PATH_A) { - rx_path_pwr_db = (pPhyStaRpt->gain_a)<<1; - rx_path_pwr_db = rx_path_pwr_db - 110; - } else if (i == ODM_RF_PATH_B) { - rx_path_pwr_db = (pPhyStaRpt->gain_b)<<1; - rx_path_pwr_db = rx_path_pwr_db - 110; - } else - rx_path_pwr_db = 0; - } else -#endif - rx_path_pwr_db = pPhyStaRpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ - - phydm_SetPerPathPhyInfo(i, rx_path_pwr_db, 0, 0, 0, pPhyInfo); - - /* search maximum pwdb */ - if (rx_path_pwr_db > rx_pwr_db) - rx_pwr_db = rx_path_pwr_db; - } - } - - /* mapping RX counter from 1~4 to 0~3 */ - if (RxCount > 0) - pPhyInfo->RxCount = RxCount - 1; - - /* Check RX sub-channel */ - if ((pPktinfo->DataRate > ODM_RATE11M) && (pPktinfo->DataRate < ODM_RATEMCS0)) - rxsc = pPhyStaRpt->l_rxsc; - else - rxsc = pPhyStaRpt->ht_rxsc; - - /*STBC or LDPC pkt*/ - pDM_Odm->PhyDbgInfo.bLdpcPkt = pPhyStaRpt->ldpc; - pDM_Odm->PhyDbgInfo.bStbcPkt = pPhyStaRpt->stbc; - - /* Check RX bandwidth */ - /* the BW information of sc=0 is useless, because there is no information of RF mode*/ - - if (pDM_Odm->SupportICType & ODM_RTL8822B) { - if ((rxsc >= 1) && (rxsc <= 8)) - bw = ODM_BW20M; - else if ((rxsc >= 9) && (rxsc <= 12)) - bw = ODM_BW40M; - else if (rxsc >= 13) - bw = ODM_BW80M; - else - bw = ODM_BW20M; - } else if (pDM_Odm->SupportICType & (ODM_RTL8197F|ODM_RTL8723D)) { - if (rxsc == 3) - bw = ODM_BW40M; - else if ((rxsc == 1) || (rxsc == 2)) - bw = ODM_BW20M; - else - bw = ODM_BW20M; - } - - /* Update packet information */ - phydm_SetCommonPhyInfo(rx_pwr_db, pPhyStaRpt->channel, (BOOLEAN)pPhyStaRpt->beamformed, - FALSE, bw, 0, rxsc, pPhyInfo); - -/* - //if (pPktinfo->bPacketMatchBSSID) - { - DbgPrint("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d\n", pPhyStaRpt->channel, pPhyStaRpt->band, pPhyStaRpt->l_rxsc, pPhyStaRpt->ht_rxsc); - DbgPrint("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->pwdb[0], pPhyStaRpt->pwdb[1], pPhyStaRpt->pwdb[2], pPhyStaRpt->pwdb[3]); - DbgPrint("Agc table A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->agc_table_a, pPhyStaRpt->agc_table_b, pPhyStaRpt->agc_table_c, pPhyStaRpt->agc_table_d); - DbgPrint("Gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->gain_a, pPhyStaRpt->gain_b, pPhyStaRpt->gain_c, pPhyStaRpt->gain_d); - DbgPrint("TRSW A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->trsw_a, pPhyStaRpt->trsw_b, pPhyStaRpt->trsw_c, pPhyStaRpt->trsw_d); - DbgPrint("AAGC step A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->aagc_step_a, pPhyStaRpt->aagc_step_b, pPhyStaRpt->aagc_step_c, pPhyStaRpt->aagc_step_d); - DbgPrint("HT AAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->ht_aagc_gain[0], pPhyStaRpt->ht_aagc_gain[1], pPhyStaRpt->ht_aagc_gain[2], pPhyStaRpt->ht_aagc_gain[3]); - DbgPrint("DAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", pPhyStaRpt->dagc_gain[0], pPhyStaRpt->dagc_gain[1], pPhyStaRpt->dagc_gain[2], pPhyStaRpt->dagc_gain[3]); - DbgPrint("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", pPhyStaRpt->ldpc, pPhyStaRpt->stbc, pPhyStaRpt->beamformed, pPhyStaRpt->gnt_bt, pPhyStaRpt->hw_antsw_occu); - DbgPrint("counter: %d, syn_count: %d\n", pPhyStaRpt->counter, pPhyStaRpt->syn_count); - DbgPrint("cnt_cca2agc_rdy: %d, cnt_pw2cca: %d, shift_l_map\n", pPhyStaRpt->cnt_cca2agc_rdy, pPhyStaRpt->cnt_pw2cca, pPhyStaRpt->shift_l_map); - DbgPrint("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", pPhyStaRpt->rsvd_0, pPhyStaRpt->rsvd_1, pPhyStaRpt->rsvd_2, pPhyStaRpt->rsvd_3, pPhyStaRpt->rsvd_4); - DbgPrint("rsvd_5 = %d, rsvd_6 = %d, rsvd_6 = %d\n", pPhyStaRpt->rsvd_5, pPhyStaRpt->rsvd_6, pPhyStaRpt->rsvd_7); - } -*/ -} - -VOID -phydm_GetRxPhyStatusType5( - IN pu1Byte pPhyStatus -) -{ -/* - DbgPrint("DW0: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 3), *(pPhyStatus + 2), *(pPhyStatus + 1), *(pPhyStatus + 0)); - DbgPrint("DW1: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 7), *(pPhyStatus + 6), *(pPhyStatus + 5), *(pPhyStatus + 4)); - DbgPrint("DW2: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 11), *(pPhyStatus + 10), *(pPhyStatus + 9), *(pPhyStatus + 8)); - DbgPrint("DW3: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 15), *(pPhyStatus + 14), *(pPhyStatus + 13), *(pPhyStatus + 12)); - DbgPrint("DW4: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 19), *(pPhyStatus + 18), *(pPhyStatus + 17), *(pPhyStatus + 16)); - DbgPrint("DW5: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 23), *(pPhyStatus + 22), *(pPhyStatus + 21), *(pPhyStatus + 20)); - DbgPrint("DW6: 0x%02x%02x%02x%02x\n", *(pPhyStatus + 27), *(pPhyStatus + 26), *(pPhyStatus + 25), *(pPhyStatus + 24)); -*/ -} - -VOID -phydm_Process_RSSIForDMNewType( - IN OUT PDM_ODM_T pDM_Odm, - IN PODM_PHY_INFO_T pPhyInfo, - IN PODM_PACKET_INFO_T pPktinfo - ) -{ - s4Byte UndecoratedSmoothedPWDB, AccumulatePWDB; - u4Byte RSSI_Ave; - u1Byte i; - PSTA_INFO_T pEntry; - u1Byte scaling_factor = 4; - - if (pPktinfo->StationID >= ODM_ASSOCIATE_ENTRY_NUM) - return; - - pEntry = pDM_Odm->pODM_StaInfo[pPktinfo->StationID]; - - if (!IS_STA_VALID(pEntry)) - return; - - if ((!pPktinfo->bPacketMatchBSSID))/*data frame only*/ - return; - - if (pPktinfo->bPacketBeacon) - pDM_Odm->PhyDbgInfo.NumQryBeaconPkt++; - - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - if (pDM_Odm->SupportAbility & ODM_BB_ANT_DIV) - ODM_Process_RSSIForAntDiv(pDM_Odm,pPhyInfo,pPktinfo); - #endif - - if (pPktinfo->bPacketToSelf || pPktinfo->bPacketBeacon) { - u4Byte RSSI_linear = 0; - - pDM_Odm->RxRate = pPktinfo->DataRate; - UndecoratedSmoothedPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; - AccumulatePWDB = pDM_Odm->AccumulatePWDB[pPktinfo->StationID]; - pDM_Odm->RSSI_A = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_A]; - pDM_Odm->RSSI_B = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_B]; - pDM_Odm->RSSI_C = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_C]; - pDM_Odm->RSSI_D = pPhyInfo->RxMIMOSignalStrength[ODM_RF_PATH_D]; - - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { - if (pPhyInfo->RxMIMOSignalStrength[i] != 0) - RSSI_linear += odm_ConvertTo_linear(pPhyInfo->RxMIMOSignalStrength[i]); - } - - switch (pPhyInfo->RxCount + 1) { - case 2: - RSSI_linear = (RSSI_linear >> 1); - break; - case 3: - RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ - break; - case 4: - RSSI_linear = (RSSI_linear >> 2); - break; - } - RSSI_Ave = odm_ConvertTo_dB(RSSI_linear); - - if (UndecoratedSmoothedPWDB <= 0) { - AccumulatePWDB = (pPhyInfo->RxPWDBAll << scaling_factor); - UndecoratedSmoothedPWDB = pPhyInfo->RxPWDBAll; - } else { - AccumulatePWDB = AccumulatePWDB - (AccumulatePWDB>>scaling_factor) + RSSI_Ave; - UndecoratedSmoothedPWDB = (AccumulatePWDB + (1<<(scaling_factor - 1)))>>scaling_factor; - } - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == -1) - phydm_ra_rssi_rpt_wk(pDM_Odm); -#endif - pEntry->rssi_stat.UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; - pDM_Odm->AccumulatePWDB[pPktinfo->StationID] = AccumulatePWDB; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - if (pPktinfo->StationID == 0) { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); - - pHalData->UndecoratedSmoothedPWDB = UndecoratedSmoothedPWDB; - } -#endif - } -} - -VOID -phydm_RxPhyStatusNewType( - IN PDM_ODM_T pPhydm, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo, - OUT PODM_PHY_INFO_T pPhyInfo -) -{ - u1Byte phy_status_type = (*pPhyStatus & 0xf); - - /*DbgPrint("phydm_RxPhyStatusNewType================> (page: %d)\n", phy_status_type);*/ - - /* Memory reset */ - phydm_ResetPhyInfo(pPhydm, pPhyInfo); - - /* Phy status parsing */ - switch (phy_status_type) { - case 0: - { - phydm_GetRxPhyStatusType0(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); - break; - } - case 1: - { - phydm_GetRxPhyStatusType1(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); - break; - } - case 2: - { - phydm_GetRxPhyStatusType2(pPhydm, pPhyStatus, pPktinfo, pPhyInfo); - break; - } -/* - case 5: - { - phydm_GetRxPhyStatusType5(pPhyStatus); - return; - } -*/ - default: - return; - } - - /* Update signal strength to UI, and pPhyInfo->RxPWDBAll is the maximum RSSI of all path */ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pPhyInfo->SignalStrength = SignalScaleProc(pPhydm->Adapter, pPhyInfo->RxPWDBAll, FALSE, FALSE); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - pPhyInfo->SignalStrength = (u1Byte)(odm_SignalScaleMapping(pPhydm, pPhyInfo->RxPWDBAll)); -#endif - - /* Calculate average RSSI and smoothed RSSI */ - phydm_Process_RSSIForDMNewType(pPhydm, pPhyInfo, pPktinfo); - -} -/*==============================================*/ -#endif - -u4Byte -query_phydm_trx_capability( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte value32 = 0xFFFFFFFF; - - #if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - value32 = query_phydm_trx_capability_8821c(pDM_Odm); - #endif - - return value32; -} - -u4Byte -query_phydm_stbc_capability( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte value32 = 0xFFFFFFFF; - - #if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - value32 = query_phydm_stbc_capability_8821c(pDM_Odm); - #endif - - return value32; -} - -u4Byte -query_phydm_ldpc_capability( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte value32 = 0xFFFFFFFF; - - #if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - value32 = query_phydm_ldpc_capability_8821c(pDM_Odm); - #endif - - return value32; -} - -u4Byte -query_phydm_txbf_parameters( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte value32 = 0xFFFFFFFF; - - #if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - value32 = query_phydm_txbf_parameters_8821c(pDM_Odm); - #endif - - return value32; -} - -u4Byte -query_phydm_txbf_capability( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte value32 = 0xFFFFFFFF; - - #if (RTL8821C_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8821C) - value32 = query_phydm_txbf_capability_8821c(pDM_Odm); - #endif - - return value32; -} +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#define READ_AND_CONFIG_MP(ic, txt) (odm_read_and_config_mp_##ic##txt(p_dm)) +#define READ_AND_CONFIG_TC(ic, txt) (odm_read_and_config_tc_##ic##txt(p_dm)) + + +#if (PHYDM_TESTCHIP_SUPPORT == 1) +#define READ_AND_CONFIG(ic, txt) do {\ + if (p_dm->is_mp_chip)\ + READ_AND_CONFIG_MP(ic, txt);\ + else\ + READ_AND_CONFIG_TC(ic, txt);\ + } while (0) +#else +#define READ_AND_CONFIG READ_AND_CONFIG_MP +#endif + +#define GET_VERSION_MP(ic, txt) (odm_get_version_mp_##ic##txt()) +#define GET_VERSION_TC(ic, txt) (odm_get_version_tc_##ic##txt()) + +#if (PHYDM_TESTCHIP_SUPPORT == 1) + #define GET_VERSION(ic, txt) (p_dm->is_mp_chip ? GET_VERSION_MP(ic, txt) : GET_VERSION_TC(ic, txt)) +#else + #define GET_VERSION(ic, txt) GET_VERSION_MP(ic, txt) +#endif + +enum hal_status +odm_config_rf_with_header_file( + struct PHY_DM_STRUCT *p_dm, + enum odm_rf_config_type config_type, + u8 e_rf_path +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo); +#endif + enum hal_status result = HAL_STATUS_SUCCESS; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===>odm_config_rf_with_header_file (%s)\n", (p_dm->is_mp_chip) ? "MPChip" : "TestChip")); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", + p_dm->support_platform, p_dm->support_interface, p_dm->board_type)); + + /* 1 AP doesn't use PHYDM power tracking table in these ICs */ +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8812a, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8812a, _radiob); + } else if (config_type == CONFIG_RF_TXPWR_LMT) { +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + if ((p_hal_data->EEPROMSVID == 0x17AA && p_hal_data->EEPROMSMID == 0xA811) || + (p_hal_data->EEPROMSVID == 0x10EC && p_hal_data->EEPROMSMID == 0xA812) || + (p_hal_data->EEPROMSVID == 0x10EC && p_hal_data->EEPROMSMID == 0x8812)) + READ_AND_CONFIG_MP(8812a, _txpwr_lmt_hm812a03); + else +#endif + READ_AND_CONFIG_MP(8812a, _txpwr_lmt); + } + } +#endif +#if (RTL8821A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8821a, _radioa); + } else if (config_type == CONFIG_RF_TXPWR_LMT) { + if (p_dm->support_interface == ODM_ITRF_USB) { + if (p_dm->ext_pa_5g || p_dm->ext_lna_5g) + READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8811a_u_fem); + else + READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8811a_u_ipa); + } else { +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (p_mgnt_info->CustomerID == RT_CID_8821AE_ASUS_MB) + READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8821a_sar_8mm); + else if (p_mgnt_info->CustomerID == RT_CID_ASUS_NB) + READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8821a_sar_5mm); + else +#endif + READ_AND_CONFIG_MP(8821a, _txpwr_lmt_8821a); + } + } + } +#endif +#if (RTL8192E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8192E) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8192e, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8192e, _radiob); + } else if (config_type == CONFIG_RF_TXPWR_LMT) { +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) && (DEV_BUS_TYPE == RT_PCI_INTERFACE) /*Refine by Vincent Lan for 5mm SAR pwr limit*/ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + if ((p_hal_data->EEPROMSVID == 0x11AD && p_hal_data->EEPROMSMID == 0x8192) || + (p_hal_data->EEPROMSVID == 0x11AD && p_hal_data->EEPROMSMID == 0x8193)) + READ_AND_CONFIG_MP(8192e, _txpwr_lmt_8192e_sar_5mm); + else +#endif + READ_AND_CONFIG_MP(8192e, _txpwr_lmt); + } + } +#endif +#if (RTL8723D_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723D) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8723d, _radioa); + } else if (config_type == CONFIG_RF_TXPWR_LMT) + READ_AND_CONFIG_MP(8723d, _txpwr_lmt); + } +#endif +/* JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8710B) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8710b, _radioa); + } else if (config_type == CONFIG_RF_TXPWR_LMT) + READ_AND_CONFIG_MP(8710b, _txpwr_lmt); + } +#endif + +#endif/* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ + + /* 1 All platforms support */ +#if (RTL8188E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8188e, _radioa); + } else if (config_type == CONFIG_RF_TXPWR_LMT) + READ_AND_CONFIG_MP(8188e, _txpwr_lmt); + } +#endif +#if (RTL8723B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723B) { + if (config_type == CONFIG_RF_RADIO) + READ_AND_CONFIG_MP(8723b, _radioa); + else if (config_type == CONFIG_RF_TXPWR_LMT) + READ_AND_CONFIG_MP(8723b, _txpwr_lmt); + } +#endif +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8814A) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8814a, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8814a, _radiob); + else if (e_rf_path == RF_PATH_C) + READ_AND_CONFIG_MP(8814a, _radioc); + else if (e_rf_path == RF_PATH_D) + READ_AND_CONFIG_MP(8814a, _radiod); + } else if (config_type == CONFIG_RF_TXPWR_LMT) { + if (p_dm->rfe_type == 0) + READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type0); + else if (p_dm->rfe_type == 1) + READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type1); + else if (p_dm->rfe_type == 2) + READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type2); + else if (p_dm->rfe_type == 3) + READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type3); + else if (p_dm->rfe_type == 5) + READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type5); + else if (p_dm->rfe_type == 7) + READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type7); + else if (p_dm->rfe_type == 8) + READ_AND_CONFIG_MP(8814a,_txpwr_lmt_type8); + else + READ_AND_CONFIG_MP(8814a,_txpwr_lmt); + } + } +#endif +#if (RTL8703B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8703B) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8703b, _radioa); + } + } +#endif +#if (RTL8188F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8188f, _radioa); + } else if (config_type == CONFIG_RF_TXPWR_LMT) + READ_AND_CONFIG_MP(8188f, _txpwr_lmt); + } +#endif +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8822b, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8822b, _radiob); + } else if (config_type == CONFIG_RF_TXPWR_LMT) { + if (p_dm->rfe_type == 5) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type5); + else if (p_dm->rfe_type == 2) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type2); + else if (p_dm->rfe_type == 3) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type3); + else if (p_dm->rfe_type == 4) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type4); + else if (p_dm->rfe_type == 12) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type12); + else if (p_dm->rfe_type == 15) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type15); + else if (p_dm->rfe_type == 16) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type16); + else if (p_dm->rfe_type == 17) + READ_AND_CONFIG_MP(8822b, _txpwr_lmt_type17); + else + READ_AND_CONFIG_MP(8822b, _txpwr_lmt); + } + } +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG_MP(8197f, _radioa); + else if (e_rf_path == RF_PATH_B) + READ_AND_CONFIG_MP(8197f, _radiob); + } + } +#endif + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) { + if (config_type == CONFIG_RF_RADIO) { + if (e_rf_path == RF_PATH_A) + READ_AND_CONFIG(8821c, _radioa); + } else if (config_type == CONFIG_RF_TXPWR_LMT) + READ_AND_CONFIG(8821c, _txpwr_lmt); + } +#endif + + if (config_type == CONFIG_RF_RADIO) { + if (p_dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { + + result = phydm_set_reg_by_fw(p_dm, + PHYDM_HALMAC_CMD_END, + 0, + 0, + 0, + (enum rf_path)0, + 0); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("rf param offload end!result = %d", result)); + } + } + + return result; +} + +enum hal_status +odm_config_rf_with_tx_pwr_track_header_file( + struct PHY_DM_STRUCT *p_dm +) +{ + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===>odm_config_rf_with_tx_pwr_track_header_file (%s)\n", (p_dm->is_mp_chip) ? "MPChip" : "TestChip")); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", + p_dm->support_platform, p_dm->support_interface, p_dm->board_type)); + + + /* 1 AP doesn't use PHYDM power tracking table in these ICs */ +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) +#if RTL8821A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8821) { + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8821a, _txpowertrack_pcie); + else if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8821a, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8821a, _txpowertrack_sdio); + } +#endif +#if RTL8812A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8812) { + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8812a, _txpowertrack_pcie); + else if (p_dm->support_interface == ODM_ITRF_USB) { + if (p_dm->rfe_type == 3 && p_dm->is_mp_chip) + READ_AND_CONFIG_MP(8812a, _txpowertrack_rfe3); + else + READ_AND_CONFIG_MP(8812a, _txpowertrack_usb); + } + + } +#endif +#if RTL8192E_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8192E) { + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8192e, _txpowertrack_pcie); + else if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8192e, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8192e, _txpowertrack_sdio); + } +#endif +#if RTL8723D_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8723D) { + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8723d, _txpowertrack_pcie); + else if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8723d, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8723d, _txpowertrack_sdio); + + READ_AND_CONFIG_MP(8723d, _txxtaltrack); + } +#endif +/* JJ ADD 20161014 */ +#if RTL8710B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8710B) { + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8710b, _txpowertrack_pcie); + else if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8710b, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8710b, _txpowertrack_sdio); + + READ_AND_CONFIG_MP(8710b, _txxtaltrack); + } +#endif + +#if RTL8188E_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8188E) { + if (odm_get_mac_reg(p_dm, 0xF0, 0xF000) >= 8) { /*if 0xF0[15:12] >= 8, SMIC*/ + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie_icut); + else if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8188e, _txpowertrack_usb_icut); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8188e, _txpowertrack_sdio_icut); + } else { /*else 0xF0[15:12] < 8, TSMC*/ + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8188e, _txpowertrack_pcie); + else if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8188e, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8188e, _txpowertrack_sdio); + } + + } +#endif +#endif/* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ + + /* 1 All platforms support */ +#if RTL8723B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8723B) { + if (p_dm->support_interface == ODM_ITRF_PCIE) + READ_AND_CONFIG_MP(8723b, _txpowertrack_pcie); + else if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8723b, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8723b, _txpowertrack_sdio); + } +#endif +#if RTL8814A_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8814A) { + if (p_dm->rfe_type == 0) + READ_AND_CONFIG_MP(8814a, _txpowertrack_type0); + else if (p_dm->rfe_type == 2) + READ_AND_CONFIG_MP(8814a, _txpowertrack_type2); + else if (p_dm->rfe_type == 5) + READ_AND_CONFIG_MP(8814a, _txpowertrack_type5); + else if (p_dm->rfe_type == 7) + READ_AND_CONFIG_MP(8814a, _txpowertrack_type7); + else if (p_dm->rfe_type == 8) + READ_AND_CONFIG_MP(8814a, _txpowertrack_type8); + else + READ_AND_CONFIG_MP(8814a, _txpowertrack); + + READ_AND_CONFIG_MP(8814a, _txpowertssi); + } +#endif +#if RTL8703B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8703B) { + if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8703b, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8703b, _txpowertrack_sdio); + + READ_AND_CONFIG_MP(8703b, _txxtaltrack); + } +#endif + +#if RTL8188F_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (p_dm->support_interface == ODM_ITRF_USB) + READ_AND_CONFIG_MP(8188f, _txpowertrack_usb); + else if (p_dm->support_interface == ODM_ITRF_SDIO) + READ_AND_CONFIG_MP(8188f, _txpowertrack_sdio); + } +#endif + +#if RTL8822B_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8822B) { + if (p_dm->rfe_type == 0) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type0); + else if (p_dm->rfe_type == 1) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type1); + else if (p_dm->rfe_type == 2) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type2); + else if ((p_dm->rfe_type == 3) || (p_dm->rfe_type == 5)) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type3_type5); + else if (p_dm->rfe_type == 4) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type4); + else if (p_dm->rfe_type == 6) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type6); + else if (p_dm->rfe_type == 7) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type7); + else if (p_dm->rfe_type == 8) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type8); + else if (p_dm->rfe_type == 9) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type9); + else if (p_dm->rfe_type == 10) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type10); + else if (p_dm->rfe_type == 11) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type11); + else if (p_dm->rfe_type == 12) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type12); + else if (p_dm->rfe_type == 13) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type13); + else if (p_dm->rfe_type == 14) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type14); + else if (p_dm->rfe_type == 15) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type15); + else if (p_dm->rfe_type == 16) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type16); + else if (p_dm->rfe_type == 17) + READ_AND_CONFIG_MP(8822b, _txpowertrack_type17); + else + READ_AND_CONFIG_MP(8822b, _txpowertrack); + } +#endif + +#if RTL8197F_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8197F) { + if (p_dm->rfe_type == 0) + READ_AND_CONFIG_MP(8197f, _txpowertrack_type0); + else if (p_dm->rfe_type == 1) + READ_AND_CONFIG_MP(8197f, _txpowertrack_type1); + else + READ_AND_CONFIG_MP(8197f, _txpowertrack); + } +#endif + +#if RTL8821C_SUPPORT + if (p_dm->support_ic_type == ODM_RTL8821C) { + if (p_dm->rfe_type == 0x5) + READ_AND_CONFIG(8821c, _txpowertrack_type0x28); + else if (p_dm->rfe_type == 0x4) + READ_AND_CONFIG(8821c, _txpowertrack_type0x20); + else + READ_AND_CONFIG(8821c, _txpowertrack); + } +#endif + + return HAL_STATUS_SUCCESS; +} + +enum hal_status +odm_config_bb_with_header_file( + struct PHY_DM_STRUCT *p_dm, + enum odm_bb_config_type config_type +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo); +#endif + enum hal_status result = HAL_STATUS_SUCCESS; + + /* 1 AP doesn't use PHYDM initialization in these ICs */ +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8812a, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8812a, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) { + if (p_dm->rfe_type == 3 && p_dm->is_mp_chip) + READ_AND_CONFIG_MP(8812a, _phy_reg_pg_asus); +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + else if (p_mgnt_info->CustomerID == RT_CID_WNC_NEC && p_dm->is_mp_chip) + READ_AND_CONFIG_MP(8812a, _phy_reg_pg_nec); +#if RT_PLATFORM == PLATFORM_MACOSX + /*{1827}{1024} for BUFFALO power by rate table. Isaiah 2013-11-29*/ + else if (p_mgnt_info->CustomerID == RT_CID_DNI_BUFFALO) + READ_AND_CONFIG_MP(8812a, _phy_reg_pg_dni); + /* TP-Link T4UH, Isaiah 2015-03-16*/ + else if (p_mgnt_info->CustomerID == RT_CID_TPLINK_HPWR) { + dbg_print("RT_CID_TPLINK_HPWR:: _PHY_REG_PG_TPLINK\n"); + READ_AND_CONFIG_MP(8812a, _phy_reg_pg_tplink); + } +#endif +#endif + else + READ_AND_CONFIG_MP(8812a, _phy_reg_pg); + } else if (config_type == CONFIG_BB_PHY_REG_MP) + READ_AND_CONFIG_MP(8812a, _phy_reg_mp); + else if (config_type == CONFIG_BB_AGC_TAB_DIFF) { + p_dm->fw_offload_ability &= ~PHYDM_PHY_PARAM_OFFLOAD; + /*AGC_TAB DIFF dont support FW offload*/ + if ((*p_dm->p_channel >= 36) && (*p_dm->p_channel <= 64)) + AGC_DIFF_CONFIG_MP(8812a, lb); + else if (*p_dm->p_channel >= 100) + AGC_DIFF_CONFIG_MP(8812a, hb); + } + } +#endif +#if (RTL8821A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8821a, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8821a, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) { +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + if ((p_hal_data->EEPROMSVID == 0x1043 && p_hal_data->EEPROMSMID == 0x207F)) + READ_AND_CONFIG_MP(8821a, _phy_reg_pg_e202_sa); + else +#endif +#if (RT_PLATFORM == PLATFORM_MACOSX) + /*{1827}{1022} for BUFFALO power by rate table. Isaiah 2013-10-18*/ + if (p_mgnt_info->CustomerID == RT_CID_DNI_BUFFALO) { + /*{1024} for BUFFALO power by rate table. (JP/US)*/ + if (p_mgnt_info->ChannelPlan == RT_CHANNEL_DOMAIN_US_2G_CANADA_5G) + READ_AND_CONFIG_MP(8821a, _phy_reg_pg_dni_us); + else + READ_AND_CONFIG_MP(8821a, _phy_reg_pg_dni_jp); + } else +#endif +#endif + READ_AND_CONFIG_MP(8821a, _phy_reg_pg); + } + } +#endif +#if (RTL8192E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8192E) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8192e, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8192e, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8192e, _phy_reg_pg); + } +#endif +#if (RTL8723D_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723D) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8723d, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8723d, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8723d, _phy_reg_pg); + } +#endif +/* JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8710B) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8710b, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8710b, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8710b, _phy_reg_pg); + } +#endif + +#endif/* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ + + + /* 1 All platforms support */ +#if (RTL8188E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8188e, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8188e, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8188e, _phy_reg_pg); + } +#endif +#if (RTL8723B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723B) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8723b, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8723b, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8723b, _phy_reg_pg); + } +#endif +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8814A) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8814a, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8814a, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) { + if (p_dm->rfe_type == 0) + READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type0); + else if (p_dm->rfe_type == 2) + READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type2); + else if (p_dm->rfe_type == 3) + READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type3); + else if (p_dm->rfe_type == 4) + READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type4); + else if (p_dm->rfe_type == 5) + READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type5); + else if (p_dm->rfe_type == 7) + READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type7); + else if (p_dm->rfe_type == 8) + READ_AND_CONFIG_MP(8814a,_phy_reg_pg_type8); + else + READ_AND_CONFIG_MP(8814a,_phy_reg_pg); + } + else if (config_type == CONFIG_BB_PHY_REG_MP) + READ_AND_CONFIG_MP(8814a, _phy_reg_mp); + } +#endif +#if (RTL8703B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8703B) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8703b, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8703b, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8703b, _phy_reg_pg); + } +#endif +#if (RTL8188F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188F) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8188f, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8188f, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG_MP(8188f, _phy_reg_pg); + } +#endif +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG_MP(8822b, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8822b, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) { + if (p_dm->rfe_type == 2) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type2); + else if (p_dm->rfe_type == 3) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type3); + else if (p_dm->rfe_type == 4) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type4); + else if (p_dm->rfe_type == 5) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type5); + else if (p_dm->rfe_type == 12) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type12); + else if (p_dm->rfe_type == 15) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type15); + else if (p_dm->rfe_type == 16) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type16); + else if (p_dm->rfe_type == 17) + READ_AND_CONFIG_MP(8822b, _phy_reg_pg_type17); + else + READ_AND_CONFIG_MP(8822b, _phy_reg_pg); + } + + } +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F) { + if (config_type == CONFIG_BB_PHY_REG) { + READ_AND_CONFIG_MP(8197f, _phy_reg); + if (p_dm->cut_version == ODM_CUT_A) + phydm_phypara_a_cut(p_dm); + } else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG_MP(8197f, _agc_tab); + } +#endif + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG(8821c, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) { + READ_AND_CONFIG(8821c, _agc_tab); + /* According to RFEtype, choosing correct AGC table*/ + if (p_dm->default_rf_set_8821c == SWITCH_TO_BTG) + AGC_DIFF_CONFIG_MP(8821c, btg); + } else if (config_type == CONFIG_BB_PHY_REG_PG) { + if (p_dm->rfe_type == 0x5) + READ_AND_CONFIG(8821c, _phy_reg_pg_type0x28); + else + READ_AND_CONFIG(8821c, _phy_reg_pg); + } else if (config_type == CONFIG_BB_AGC_TAB_DIFF) { + p_dm->fw_offload_ability &= ~PHYDM_PHY_PARAM_OFFLOAD; + /*AGC_TAB DIFF dont support FW offload*/ + if (p_dm->current_rf_set_8821c == SWITCH_TO_BTG) + AGC_DIFF_CONFIG_MP(8821c, btg); + else if (p_dm->current_rf_set_8821c == SWITCH_TO_WLG) + AGC_DIFF_CONFIG_MP(8821c, wlg); + } else if (config_type == CONFIG_BB_PHY_REG_MP) + READ_AND_CONFIG(8821c, _phy_reg_mp); + } +#endif + +#if (RTL8195A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8195A) { + if (config_type == CONFIG_BB_PHY_REG) + READ_AND_CONFIG(8195a, _phy_reg); + else if (config_type == CONFIG_BB_AGC_TAB) + READ_AND_CONFIG(8195a, _agc_tab); + else if (config_type == CONFIG_BB_PHY_REG_PG) + READ_AND_CONFIG(8195a, _phy_reg_pg); + } +#endif + + if (config_type == CONFIG_BB_PHY_REG || config_type == CONFIG_BB_AGC_TAB) + if (p_dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { + + result = phydm_set_reg_by_fw(p_dm, + PHYDM_HALMAC_CMD_END, + 0, + 0, + 0, + (enum rf_path)0, + 0); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("phy param offload end!result = %d", result)); + } + + return result; +} + +enum hal_status +odm_config_mac_with_header_file( + struct PHY_DM_STRUCT *p_dm +) +{ + enum hal_status result = HAL_STATUS_SUCCESS; + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===>odm_config_mac_with_header_file (%s)\n", (p_dm->is_mp_chip) ? "MPChip" : "TestChip")); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("support_platform: 0x%X, support_interface: 0x%X, board_type: 0x%X\n", + p_dm->support_platform, p_dm->support_interface, p_dm->board_type)); + + /* 1 AP doesn't use PHYDM initialization in these ICs */ +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) + READ_AND_CONFIG_MP(8812a, _mac_reg); +#endif +#if (RTL8821A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821) + READ_AND_CONFIG_MP(8821a, _mac_reg); +#endif +#if (RTL8192E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8192E) + READ_AND_CONFIG_MP(8192e, _mac_reg); +#endif +#if (RTL8723D_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723D) + READ_AND_CONFIG_MP(8723d, _mac_reg); +#endif +/* JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8710B) + READ_AND_CONFIG_MP(8710b, _mac_reg); +#endif + +#endif/* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ + + /* 1 All platforms support */ +#if (RTL8188E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) + READ_AND_CONFIG_MP(8188e, _mac_reg); +#endif +#if (RTL8723B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723B) + READ_AND_CONFIG_MP(8723b, _mac_reg); +#endif +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8814A) + READ_AND_CONFIG_MP(8814a, _mac_reg); +#endif +#if (RTL8703B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8703B) + READ_AND_CONFIG_MP(8703b, _mac_reg); +#endif +#if (RTL8188F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188F) + READ_AND_CONFIG_MP(8188f, _mac_reg); +#endif +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) + READ_AND_CONFIG_MP(8822b, _mac_reg); +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F) + READ_AND_CONFIG_MP(8197f, _mac_reg); +#endif + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + READ_AND_CONFIG(8821c, _mac_reg); +#endif + +#if (RTL8195A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8195A) + READ_AND_CONFIG_MP(8195a, _mac_reg); +#endif + + if (p_dm->fw_offload_ability & PHYDM_PHY_PARAM_OFFLOAD) { + + result = phydm_set_reg_by_fw(p_dm, + PHYDM_HALMAC_CMD_END, + 0, + 0, + 0, + (enum rf_path)0, + 0); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("mac param offload end!result = %d", result)); + } + + return result; +} + +u32 +odm_get_hw_img_version( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 version = 0; + + /* 1 AP doesn't use PHYDM initialization in these ICs */ +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) +#if (RTL8821A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821) + version = GET_VERSION_MP(8821a, _mac_reg); +#endif +#if (RTL8192E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8192E) + version = GET_VERSION_MP(8192e, _mac_reg); +#endif +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) + version = GET_VERSION_MP(8812a, _mac_reg); +#endif +#if (RTL8723D_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723D) + version = GET_VERSION_MP(8723d, _mac_reg); +#endif +/* JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8710B) + version = GET_VERSION_MP(8710b, _mac_reg); +#endif + +#endif /* (DM_ODM_SUPPORT_TYPE != ODM_AP) */ + + /*1 All platforms support*/ +#if (RTL8188E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) + version = GET_VERSION_MP(8188e, _mac_reg); +#endif +#if (RTL8723B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8723B) + version = GET_VERSION_MP(8723b, _mac_reg); +#endif +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8814A) + version = GET_VERSION_MP(8814a, _mac_reg); +#endif +#if (RTL8703B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8703B) + version = GET_VERSION_MP(8703b, _mac_reg); +#endif +#if (RTL8188F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188F) + version = GET_VERSION_MP(8188f, _mac_reg); +#endif +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) + version = GET_VERSION_MP(8822b, _mac_reg); +#endif + +#if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F) + version = GET_VERSION_MP(8197f, _mac_reg); +#endif + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + version = GET_VERSION(8821c, _mac_reg); +#endif + + return version; +} + + +u32 +query_phydm_trx_capability( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 value32 = 0xFFFFFFFF; + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_trx_capability_8821c(p_dm); +#endif + + return value32; +} + +u32 +query_phydm_stbc_capability( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 value32 = 0xFFFFFFFF; + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_stbc_capability_8821c(p_dm); +#endif + + return value32; +} + +u32 +query_phydm_ldpc_capability( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 value32 = 0xFFFFFFFF; + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_ldpc_capability_8821c(p_dm); +#endif + + return value32; +} + +u32 +query_phydm_txbf_parameters( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 value32 = 0xFFFFFFFF; + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_txbf_parameters_8821c(p_dm); +#endif + + return value32; +} + +u32 +query_phydm_txbf_capability( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 value32 = 0xFFFFFFFF; + +#if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8821C) + value32 = query_phydm_txbf_capability_8821c(p_dm); +#endif + + return value32; +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.h index dc326265fc24..e3c65e33e4f8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_hwconfig.h @@ -1,568 +1,93 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - -#ifndef __HALHWOUTSRC_H__ -#define __HALHWOUTSRC_H__ - - -/*--------------------------Define -------------------------------------------*/ -#define CCK_RSSI_INIT_COUNT 5 - -#define RA_RSSI_STATE_INIT 0 -#define RA_RSSI_STATE_SEND 1 -#define RA_RSSI_STATE_HOLD 2 - -#define CFO_HW_RPT_2_MHZ(val) ((val<<1) + (val>>1)) -/* ((X* 3125) / 10)>>7 = (X*10)>>2 = X*2.5 = X<<1 + X>>1 */ - -#define AGC_DIFF_CONFIG_MP(ic, band) (ODM_ReadAndConfig_MP_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_MP_##ic##_AGC_TAB_DIFF_##band, \ - sizeof(Array_MP_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) -#define AGC_DIFF_CONFIG_TC(ic, band) (ODM_ReadAndConfig_TC_##ic##_AGC_TAB_DIFF(pDM_Odm, Array_TC_##ic##_AGC_TAB_DIFF_##band, \ - sizeof(Array_TC_##ic##_AGC_TAB_DIFF_##band)/sizeof(u4Byte))) - -#define AGC_DIFF_CONFIG(ic, band) do {\ - if (pDM_Odm->bIsMPChip)\ - AGC_DIFF_CONFIG_MP(ic,band);\ - else\ - AGC_DIFF_CONFIG_TC(ic,band);\ - } while(0) - - -//============================================================ -// structure and define -//============================================================ - -__PACK typedef struct _Phy_Rx_AGC_Info -{ - #if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte gain:7,trsw:1; - #else - u1Byte trsw:1,gain:7; - #endif -} __WLAN_ATTRIB_PACK__ PHY_RX_AGC_INFO_T, *pPHY_RX_AGC_INFO_T; - -__PACK typedef struct _Phy_Status_Rpt_8192cd { - PHY_RX_AGC_INFO_T path_agc[2]; - u1Byte ch_corr[2]; - u1Byte cck_sig_qual_ofdm_pwdb_all; - u1Byte cck_agc_rpt_ofdm_cfosho_a; - u1Byte cck_rpt_b_ofdm_cfosho_b; - u1Byte rsvd_1;/*ch_corr_msb;*/ - u1Byte noise_power_db_msb; - s1Byte path_cfotail[2]; - u1Byte pcts_mask[2]; - s1Byte stream_rxevm[2]; - u1Byte path_rxsnr[2]; - u1Byte noise_power_db_lsb; - u1Byte rsvd_2[3]; - u1Byte stream_csi[2]; - u1Byte stream_target_csi[2]; - s1Byte sig_evm; - u1Byte rsvd_3; - -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte antsel_rx_keep_2: 1; /*ex_intf_flg:1;*/ - u1Byte sgi_en: 1; - u1Byte rxsc: 2; - u1Byte idle_long: 1; - u1Byte r_ant_train_en: 1; - u1Byte ant_sel_b: 1; - u1Byte ant_sel: 1; -#else /*_BIG_ENDIAN_ */ - u1Byte ant_sel: 1; - u1Byte ant_sel_b: 1; - u1Byte r_ant_train_en: 1; - u1Byte idle_long: 1; - u1Byte rxsc: 2; - u1Byte sgi_en: 1; - u1Byte antsel_rx_keep_2: 1;/*ex_intf_flg:1;*/ -#endif -} __WLAN_ATTRIB_PACK__ PHY_STATUS_RPT_8192CD_T, *PPHY_STATUS_RPT_8192CD_T; - - -typedef struct _Phy_Status_Rpt_8812 { -/* DWORD 0*/ - u1Byte gain_trsw[2]; /*path-A and path-B {TRSW, gain[6:0] }*/ - u1Byte chl_num_LSB; /*channel number[7:0]*/ -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte chl_num_MSB: 2; /*channel number[9:8]*/ - u1Byte sub_chnl: 4; /*sub-channel location[3:0]*/ - u1Byte r_RFMOD: 2; /*RF mode[1:0]*/ -#else /*_BIG_ENDIAN_ */ - u1Byte r_RFMOD: 2; - u1Byte sub_chnl: 4; - u1Byte chl_num_MSB: 2; -#endif - -/* DWORD 1*/ - u1Byte pwdb_all; /*CCK signal quality / OFDM pwdb all*/ - s1Byte cfosho[2]; /*DW1 byte 1 DW1 byte2 CCK AGC report and CCK_BB_Power / OFDM Path-A and Path-B short CFO*/ -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - /*this should be checked again because the definition of 8812 and 8814 is different*/ -/* u1Byte r_cck_rx_enable_pathc:2; cck rx enable pathc[1:0]*/ -/* u1Byte cck_rx_path:4; cck rx path[3:0]*/ - u1Byte resvd_0: 6; - u1Byte bt_RF_ch_MSB: 2; /*8812A:2'b0 8814A: bt rf channel keep[7:6]*/ -#else /*_BIG_ENDIAN_*/ - u1Byte bt_RF_ch_MSB: 2; - u1Byte resvd_0: 6; -#endif - -/* DWORD 2*/ -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte ant_div_sw_a: 1; /*8812A: ant_div_sw_a 8814A: 1'b0*/ - u1Byte ant_div_sw_b: 1; /*8812A: ant_div_sw_b 8814A: 1'b0*/ - u1Byte bt_RF_ch_LSB: 6; /*8812A: 6'b0 8814A: bt rf channel keep[5:0]*/ -#else /*_BIG_ENDIAN_ */ - u1Byte bt_RF_ch_LSB: 6; - u1Byte ant_div_sw_b: 1; - u1Byte ant_div_sw_a: 1; -#endif - s1Byte cfotail[2]; /*DW2 byte 1 DW2 byte 2 path-A and path-B CFO tail*/ - u1Byte PCTS_MSK_RPT_0; /*PCTS mask report[7:0]*/ - u1Byte PCTS_MSK_RPT_1; /*PCTS mask report[15:8]*/ - -/* DWORD 3*/ - s1Byte rxevm[2]; /*DW3 byte 1 DW3 byte 2 stream 1 and stream 2 RX EVM*/ - s1Byte rxsnr[2]; /*DW3 byte 3 DW4 byte 0 path-A and path-B RX SNR*/ - -/* DWORD 4*/ - u1Byte PCTS_MSK_RPT_2; /*PCTS mask report[23:16]*/ -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte PCTS_MSK_RPT_3: 6; /*PCTS mask report[29:24]*/ - u1Byte pcts_rpt_valid: 1; /*pcts_rpt_valid*/ - u1Byte resvd_1: 1; /*1'b0*/ -#else /*_BIG_ENDIAN_*/ - u1Byte resvd_1: 1; - u1Byte pcts_rpt_valid: 1; - u1Byte PCTS_MSK_RPT_3: 6; -#endif - s1Byte rxevm_cd[2]; /*DW 4 byte 3 DW5 byte 0 8812A: 16'b0 8814A: stream 3 and stream 4 RX EVM*/ - -/* DWORD 5*/ - u1Byte csi_current[2]; /*DW5 byte 1 DW5 byte 2 8812A: stream 1 and 2 CSI 8814A: path-C and path-D RX SNR*/ - u1Byte gain_trsw_cd[2]; /*DW5 byte 3 DW6 byte 0 path-C and path-D {TRSW, gain[6:0] }*/ - -/* DWORD 6*/ - s1Byte sigevm; /*signal field EVM*/ -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte antidx_antc: 3; /*8812A: 3'b0 8814A: antidx_antc[2:0]*/ - u1Byte antidx_antd: 3; /*8812A: 3'b0 8814A: antidx_antd[2:0]*/ - u1Byte dpdt_ctrl_keep: 1; /*8812A: 1'b0 8814A: dpdt_ctrl_keep*/ - u1Byte GNT_BT_keep: 1; /*8812A: 1'b0 8814A: GNT_BT_keep*/ -#else /*_BIG_ENDIAN_*/ - u1Byte GNT_BT_keep: 1; - u1Byte dpdt_ctrl_keep: 1; - u1Byte antidx_antd: 3; - u1Byte antidx_antc: 3; -#endif -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte antidx_anta: 3; /*antidx_anta[2:0]*/ - u1Byte antidx_antb: 3; /*antidx_antb[2:0]*/ - u1Byte hw_antsw_occur: 2; /*1'b0*/ -#else /*_BIG_ENDIAN_*/ - u1Byte hw_antsw_occur: 2; - u1Byte antidx_antb: 3; - u1Byte antidx_anta: 3; -#endif -} PHY_STATUS_RPT_8812_T, *PPHY_STATUS_RPT_8812_T; - -VOID -phydm_reset_rssi_for_dm( - IN OUT PDM_ODM_T pDM_Odm, - IN u1Byte station_id -); - -VOID -odm_Init_RSSIForDM( - IN OUT PDM_ODM_T pDM_Odm -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -phydm_normal_driver_rx_sniffer( - IN OUT PDM_ODM_T pDM_Odm, - IN pu1Byte pDesc, - IN PRT_RFD_STATUS pRtRfdStatus, - IN pu1Byte pDrvInfo, - IN u1Byte PHYStatus - ); -#endif - -VOID -ODM_PhyStatusQuery( - IN OUT PDM_ODM_T pDM_Odm, - OUT PODM_PHY_INFO_T pPhyInfo, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo - ); - -VOID -ODM_MacStatusQuery( - IN OUT PDM_ODM_T pDM_Odm, - IN pu1Byte pMacStatus, - IN u1Byte MacID, - IN BOOLEAN bPacketMatchBSSID, - IN BOOLEAN bPacketToSelf, - IN BOOLEAN bPacketBeacon - ); - -HAL_STATUS -ODM_ConfigRFWithTxPwrTrackHeaderFile( - IN PDM_ODM_T pDM_Odm - ); - -HAL_STATUS -ODM_ConfigRFWithHeaderFile( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_Config_Type ConfigType, - IN ODM_RF_RADIO_PATH_E eRFPath - ); - -HAL_STATUS -ODM_ConfigBBWithHeaderFile( - IN PDM_ODM_T pDM_Odm, - IN ODM_BB_Config_Type ConfigType - ); - -HAL_STATUS -ODM_ConfigMACWithHeaderFile( - IN PDM_ODM_T pDM_Odm - ); - -HAL_STATUS -ODM_ConfigFWWithHeaderFile( - IN PDM_ODM_T pDM_Odm, - IN ODM_FW_Config_Type ConfigType, - OUT u1Byte *pFirmware, - OUT u4Byte *pSize - ); - -u4Byte -ODM_GetHWImgVersion( - IN PDM_ODM_T pDM_Odm - ); - -s4Byte -odm_SignalScaleMapping( - IN OUT PDM_ODM_T pDM_Odm, - IN s4Byte CurrSig - ); - -#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) -/*For 8822B only!! need to move to FW finally */ -/*==============================================*/ -VOID -phydm_RxPhyStatusNewType( - IN PDM_ODM_T pPhydm, - IN pu1Byte pPhyStatus, - IN PODM_PACKET_INFO_T pPktinfo, - OUT PODM_PHY_INFO_T pPhyInfo -); - -typedef struct _Phy_Status_Rpt_Jaguar2_Type0 { - /* DW0 */ - u1Byte page_num; - u1Byte pwdb; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte gain: 6; - u1Byte rsvd_0: 1; - u1Byte trsw: 1; -#else - u1Byte trsw: 1; - u1Byte rsvd_0: 1; - u1Byte gain: 6; -#endif - u1Byte rsvd_1; - - /* DW1 */ - u1Byte rsvd_2; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte rxsc: 4; - u1Byte agc_table: 4; -#else - u1Byte agc_table: 4; - u1Byte rxsc: 4; -#endif - u1Byte channel; - u1Byte band; - - /* DW2 */ - u2Byte length; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte antidx_a: 3; - u1Byte antidx_b: 3; - u1Byte rsvd_3: 2; - u1Byte antidx_c: 3; - u1Byte antidx_d: 3; - u1Byte rsvd_4:2; -#else - u1Byte rsvd_3: 2; - u1Byte antidx_b: 3; - u1Byte antidx_a: 3; - u1Byte rsvd_4:2; - u1Byte antidx_d: 3; - u1Byte antidx_c: 3; -#endif - - /* DW3 */ - u1Byte signal_quality; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte vga:5; - u1Byte lna_l:3; - u1Byte bb_power:6; - u1Byte rsvd_9:1; - u1Byte lna_h:1; -#else - u1Byte lna_l:3; - u1Byte vga:5; - u1Byte lna_h:1; - u1Byte rsvd_9:1; - u1Byte bb_power:6; -#endif - u1Byte rsvd_5; - - /* DW4 */ - u4Byte rsvd_6; - - /* DW5 */ - u4Byte rsvd_7; - - /* DW6 */ - u4Byte rsvd_8; -} PHY_STATUS_RPT_JAGUAR2_TYPE0, *PPHY_STATUS_RPT_JAGUAR2_TYPE0; - -typedef struct _Phy_Status_Rpt_Jaguar2_Type1 { - /* DW0 and DW1 */ - u1Byte page_num; - u1Byte pwdb[4]; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte l_rxsc: 4; - u1Byte ht_rxsc: 4; -#else - u1Byte ht_rxsc: 4; - u1Byte l_rxsc: 4; -#endif - u1Byte channel; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte band: 2; - u1Byte rsvd_0: 1; - u1Byte hw_antsw_occu: 1; - u1Byte gnt_bt: 1; - u1Byte ldpc: 1; - u1Byte stbc: 1; - u1Byte beamformed: 1; -#else - u1Byte beamformed: 1; - u1Byte stbc: 1; - u1Byte ldpc: 1; - u1Byte gnt_bt: 1; - u1Byte hw_antsw_occu: 1; - u1Byte rsvd_0: 1; - u1Byte band: 2; -#endif - - /* DW2 */ - u2Byte lsig_length; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte antidx_a: 3; - u1Byte antidx_b: 3; - u1Byte rsvd_1: 2; - u1Byte antidx_c: 3; - u1Byte antidx_d: 3; - u1Byte rsvd_2: 2; -#else - u1Byte rsvd_1: 2; - u1Byte antidx_b: 3; - u1Byte antidx_a: 3; - u1Byte rsvd_2: 2; - u1Byte antidx_d: 3; - u1Byte antidx_c: 3; -#endif - - /* DW3 */ - u1Byte paid; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte paid_msb: 1; - u1Byte gid: 6; - u1Byte rsvd_3: 1; -#else - u1Byte rsvd_3: 1; - u1Byte gid: 6; - u1Byte paid_msb: 1; -#endif - u1Byte intf_pos; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte intf_pos_msb: 1; - u1Byte rsvd_4: 2; - u1Byte nb_intf_flag: 1; - u1Byte rf_mode: 2; - u1Byte rsvd_5: 2; -#else - u1Byte rsvd_5: 2; - u1Byte rf_mode: 2; - u1Byte nb_intf_flag: 1; - u1Byte rsvd_4: 2; - u1Byte intf_pos_msb: 1; -#endif - - /* DW4 */ - s1Byte rxevm[4]; /* s(8,1) */ - - /* DW5 */ - s1Byte cfo_tail[4]; /* s(8,7) */ - - /* DW6 */ - s1Byte rxsnr[4]; /* s(8,1) */ -} PHY_STATUS_RPT_JAGUAR2_TYPE1, *PPHY_STATUS_RPT_JAGUAR2_TYPE1; - -typedef struct _Phy_Status_Rpt_Jaguar2_Type2 { - /* DW0 ane DW1 */ - u1Byte page_num; - u1Byte pwdb[4]; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte l_rxsc: 4; - u1Byte ht_rxsc: 4; -#else - u1Byte ht_rxsc: 4; - u1Byte l_rxsc: 4; -#endif - u1Byte channel; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte band: 2; - u1Byte rsvd_0: 1; - u1Byte hw_antsw_occu: 1; - u1Byte gnt_bt: 1; - u1Byte ldpc: 1; - u1Byte stbc: 1; - u1Byte beamformed: 1; -#else - u1Byte beamformed: 1; - u1Byte stbc: 1; - u1Byte ldpc: 1; - u1Byte gnt_bt: 1; - u1Byte hw_antsw_occu: 1; - u1Byte rsvd_0: 1; - u1Byte band: 2; -#endif - - /* DW2 */ -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte shift_l_map: 6; - u1Byte rsvd_1: 2; -#else - u1Byte rsvd_1: 2; - u1Byte shift_l_map: 6; -#endif - u1Byte cnt_pw2cca; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte agc_table_a: 4; - u1Byte agc_table_b: 4; - u1Byte agc_table_c: 4; - u1Byte agc_table_d: 4; -#else - u1Byte agc_table_b: 4; - u1Byte agc_table_a: 4; - u1Byte agc_table_d: 4; - u1Byte agc_table_c: 4; -#endif - - /* DW3 ~ DW6*/ - u1Byte cnt_cca2agc_rdy; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte gain_a: 6; - u1Byte rsvd_2: 1; - u1Byte trsw_a: 1; - u1Byte gain_b: 6; - u1Byte rsvd_3: 1; - u1Byte trsw_b: 1; - u1Byte gain_c: 6; - u1Byte rsvd_4: 1; - u1Byte trsw_c: 1; - u1Byte gain_d: 6; - u1Byte rsvd_5: 1; - u1Byte trsw_d: 1; - u1Byte aagc_step_a: 2; - u1Byte aagc_step_b: 2; - u1Byte aagc_step_c: 2; - u1Byte aagc_step_d: 2; -#else - u1Byte trsw_a: 1; - u1Byte rsvd_2: 1; - u1Byte gain_a: 6; - u1Byte trsw_b: 1; - u1Byte rsvd_3: 1; - u1Byte gain_b: 6; - u1Byte trsw_c: 1; - u1Byte rsvd_4: 1; - u1Byte gain_c: 6; - u1Byte trsw_d: 1; - u1Byte rsvd_5: 1; - u1Byte gain_d: 6; - u1Byte aagc_step_d: 2; - u1Byte aagc_step_c: 2; - u1Byte aagc_step_b: 2; - u1Byte aagc_step_a: 2; -#endif - u1Byte ht_aagc_gain[4]; - u1Byte dagc_gain[4]; -#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) - u1Byte counter: 6; - u1Byte rsvd_6: 2; - u1Byte syn_count: 5; - u1Byte rsvd_7:3; -#else - u1Byte rsvd_6: 2; - u1Byte counter: 6; - u1Byte rsvd_7:3; - u1Byte syn_count: 5; -#endif -} PHY_STATUS_RPT_JAGUAR2_TYPE2, *PPHY_STATUS_RPT_JAGUAR2_TYPE2; -/*==============================================*/ -#endif /*#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1)*/ - -u4Byte -query_phydm_trx_capability( - IN PDM_ODM_T pDM_Odm -); - -u4Byte -query_phydm_stbc_capability( - IN PDM_ODM_T pDM_Odm -); - -u4Byte -query_phydm_ldpc_capability( - IN PDM_ODM_T pDM_Odm -); - -u4Byte -query_phydm_txbf_parameters( - IN PDM_ODM_T pDM_Odm -); - -u4Byte -query_phydm_txbf_capability( - IN PDM_ODM_T pDM_Odm -); - -#endif /*#ifndef __HALHWOUTSRC_H__*/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __HALHWOUTSRC_H__ +#define __HALHWOUTSRC_H__ + + +/*--------------------------Define -------------------------------------------*/ +#define AGC_DIFF_CONFIG_MP(ic, band) (odm_read_and_config_mp_##ic##_agc_tab_diff(p_dm, array_mp_##ic##_agc_tab_diff_##band, \ + sizeof(array_mp_##ic##_agc_tab_diff_##band)/sizeof(u32))) +#define AGC_DIFF_CONFIG_TC(ic, band) (odm_read_and_config_tc_##ic##_agc_tab_diff(p_dm, array_tc_##ic##_agc_tab_diff_##band, \ + sizeof(array_tc_##ic##_agc_tab_diff_##band)/sizeof(u32))) + +#define AGC_DIFF_CONFIG(ic, band) do {\ + if (p_dm->is_mp_chip)\ + AGC_DIFF_CONFIG_MP(ic, band);\ + else\ + AGC_DIFF_CONFIG_TC(ic, band);\ + } while (0) + + +/* ************************************************************ + * structure and define + * ************************************************************ */ + +enum hal_status +odm_config_rf_with_tx_pwr_track_header_file( + struct PHY_DM_STRUCT *p_dm +); + +enum hal_status +odm_config_rf_with_header_file( + struct PHY_DM_STRUCT *p_dm, + enum odm_rf_config_type config_type, + u8 e_rf_path +); + +enum hal_status +odm_config_bb_with_header_file( + struct PHY_DM_STRUCT *p_dm, + enum odm_bb_config_type config_type +); + +enum hal_status +odm_config_mac_with_header_file( + struct PHY_DM_STRUCT *p_dm +); + +u32 +odm_get_hw_img_version( + struct PHY_DM_STRUCT *p_dm +); + + +u32 +query_phydm_trx_capability( + struct PHY_DM_STRUCT *p_dm +); + +u32 +query_phydm_stbc_capability( + struct PHY_DM_STRUCT *p_dm +); + +u32 +query_phydm_ldpc_capability( + struct PHY_DM_STRUCT *p_dm +); + +u32 +query_phydm_txbf_parameters( + struct PHY_DM_STRUCT *p_dm +); + +u32 +query_phydm_txbf_capability( + struct PHY_DM_STRUCT *p_dm +); + +#endif /*#ifndef __HALHWOUTSRC_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.c index d72002f84189..88b15ed71ad4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.c @@ -1,958 +1,1387 @@ -/****************************************************************************** - * - * 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 files -//============================================================ - -#include "mp_precomp.h" -#include "phydm_precomp.h" - -// -// ODM IO Relative API. -// - -u1Byte -ODM_Read1Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - return RTL_R8(RegAddr); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - return rtw_read8(Adapter,RegAddr); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - return PlatformEFIORead1Byte(Adapter, RegAddr); -#endif - -} - - -u2Byte -ODM_Read2Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - return RTL_R16(RegAddr); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - return rtw_read16(Adapter,RegAddr); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - return PlatformEFIORead2Byte(Adapter, RegAddr); -#endif - -} - - -u4Byte -ODM_Read4Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - return RTL_R32(RegAddr); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - return rtw_read32(Adapter,RegAddr); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - return PlatformEFIORead4Byte(Adapter, RegAddr); -#endif - -} - - -VOID -ODM_Write1Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u1Byte Data - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - RTL_W8(RegAddr, Data); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - rtw_write8(Adapter,RegAddr, Data); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformEFIOWrite1Byte(Adapter, RegAddr, Data); -#endif - -} - - -VOID -ODM_Write2Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u2Byte Data - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - RTL_W16(RegAddr, Data); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - rtw_write16(Adapter,RegAddr, Data); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformEFIOWrite2Byte(Adapter, RegAddr, Data); -#endif - -} - - -VOID -ODM_Write4Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte Data - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - prtl8192cd_priv priv = pDM_Odm->priv; - RTL_W32(RegAddr, Data); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - rtw_write32(Adapter,RegAddr, Data); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformEFIOWrite4Byte(Adapter, RegAddr, Data); -#endif - -} - - -VOID -ODM_SetMACReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); -#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - PADAPTER Adapter = pDM_Odm->Adapter; - PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -#endif -} - - -u4Byte -ODM_GetMACReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); -#elif(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - return PHY_QueryMacReg(pDM_Odm->Adapter, RegAddr, BitMask); -#endif -} - - -VOID -ODM_SetBBReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - PHY_SetBBReg(pDM_Odm->priv, RegAddr, BitMask, Data); -#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - PADAPTER Adapter = pDM_Odm->Adapter; - PHY_SetBBReg(Adapter, RegAddr, BitMask, Data); -#endif -} - - -u4Byte -ODM_GetBBReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return PHY_QueryBBReg(pDM_Odm->priv, RegAddr, BitMask); -#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - PADAPTER Adapter = pDM_Odm->Adapter; - return PHY_QueryBBReg(Adapter, RegAddr, BitMask); -#endif -} - - -VOID -ODM_SetRFReg( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_RADIO_PATH_E eRFPath, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - PHY_SetRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, Data); -#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data); - ODM_delay_us(2); - -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - PHY_SetRFReg(pDM_Odm->Adapter, eRFPath, RegAddr, BitMask, Data); -#endif -} - -u4Byte -ODM_GetRFReg( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_RADIO_PATH_E eRFPath, - IN u4Byte RegAddr, - IN u4Byte BitMask - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return PHY_QueryRFReg(pDM_Odm->priv, eRFPath, RegAddr, BitMask, 1); -#elif(DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - PADAPTER Adapter = pDM_Odm->Adapter; - return PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask); -#endif -} - - - - -// -// ODM Memory relative API. -// -VOID -ODM_AllocateMemory( - IN PDM_ODM_T pDM_Odm, - OUT PVOID *pPtr, - IN u4Byte length - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - *pPtr = kmalloc(length, GFP_ATOMIC); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) - *pPtr = rtw_zvmalloc(length); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformAllocateMemory(Adapter, pPtr, length); -#endif -} - -// length could be ignored, used to detect memory leakage. -VOID -ODM_FreeMemory( - IN PDM_ODM_T pDM_Odm, - OUT PVOID pPtr, - IN u4Byte length - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - kfree(pPtr); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) - rtw_vmfree(pPtr, length); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - //PADAPTER Adapter = pDM_Odm->Adapter; - PlatformFreeMemory(pPtr, length); -#endif -} - -VOID -ODM_MoveMemory( - IN PDM_ODM_T pDM_Odm, - OUT PVOID pDest, - IN PVOID pSrc, - IN u4Byte Length - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - memcpy(pDest, pSrc, Length); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) - _rtw_memcpy(pDest, pSrc, Length); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformMoveMemory(pDest, pSrc, Length); -#endif -} - -void ODM_Memory_Set( - IN PDM_ODM_T pDM_Odm, - IN PVOID pbuf, - IN s1Byte value, - IN u4Byte length -) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - memset(pbuf, value, length); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) - _rtw_memset(pbuf,value, length); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformFillMemory(pbuf,length,value); -#endif -} -s4Byte ODM_CompareMemory( - IN PDM_ODM_T pDM_Odm, - IN PVOID pBuf1, - IN PVOID pBuf2, - IN u4Byte length - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return memcmp(pBuf1,pBuf2,length); -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) - return _rtw_memcmp(pBuf1,pBuf2,length); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - return PlatformCompareMemory(pBuf1,pBuf2,length); -#endif -} - - - -// -// ODM MISC relative API. -// -VOID -ODM_AcquireSpinLock( - IN PDM_ODM_T pDM_Odm, - IN RT_SPINLOCK_TYPE type - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - rtw_odm_acquirespinlock(Adapter, type); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformAcquireSpinLock(Adapter, type); -#endif -} -VOID -ODM_ReleaseSpinLock( - IN PDM_ODM_T pDM_Odm, - IN RT_SPINLOCK_TYPE type - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif (DM_ODM_SUPPORT_TYPE & ODM_CE ) - PADAPTER Adapter = pDM_Odm->Adapter; - rtw_odm_releasespinlock(Adapter, type); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformReleaseSpinLock(Adapter, type); -#endif -} - -// -// Work item relative API. FOr MP driver only~! -// -VOID -ODM_InitializeWorkItem( - IN PDM_ODM_T pDM_Odm, - IN PRT_WORK_ITEM pRtWorkItem, - IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, - IN PVOID pContext, - IN const char* szID - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformInitializeWorkItem(Adapter, pRtWorkItem, RtWorkItemCallback, pContext, szID); -#endif -} - - -VOID -ODM_StartWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformStartWorkItem(pRtWorkItem); -#endif -} - - -VOID -ODM_StopWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformStopWorkItem(pRtWorkItem); -#endif -} - - -VOID -ODM_FreeWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformFreeWorkItem(pRtWorkItem); -#endif -} - - -VOID -ODM_ScheduleWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformScheduleWorkItem(pRtWorkItem); -#endif -} - - -VOID -ODM_IsWorkItemScheduled( - IN PRT_WORK_ITEM pRtWorkItem - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformIsWorkItemScheduled(pRtWorkItem); -#endif -} - - - -// -// ODM Timer relative API. -// -VOID -ODM_StallExecution( - IN u4Byte usDelay - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_udelay_os(usDelay); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformStallExecution(usDelay); -#endif -} - -VOID -ODM_delay_ms(IN u4Byte ms) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - delay_ms(ms); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_mdelay_os(ms); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - delay_ms(ms); -#endif -} - -VOID -ODM_delay_us(IN u4Byte us) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - delay_us(us); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_udelay_os(us); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PlatformStallExecution(us); -#endif -} - -VOID -ODM_sleep_ms(IN u4Byte ms) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_msleep_os(ms); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -#endif -} - -VOID -ODM_sleep_us(IN u4Byte us) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_usleep_os(us); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) -#endif -} - -VOID -ODM_SetTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer, - IN u4Byte msDelay - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - mod_timer(pTimer, jiffies + RTL_MILISECONDS_TO_JIFFIES(msDelay)); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - _set_timer(pTimer,msDelay ); //ms -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformSetTimer(Adapter, pTimer, msDelay); -#endif - -} - -VOID -ODM_InitializeTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer, - IN RT_TIMER_CALL_BACK CallBackFunc, - IN PVOID pContext, - IN const char* szID - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - init_timer(pTimer); - pTimer->function = CallBackFunc; - pTimer->data = (unsigned long)pDM_Odm; - /*mod_timer(pTimer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); */ -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - _init_timer(pTimer,Adapter->pnetdev,CallBackFunc,pDM_Odm); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformInitializeTimer(Adapter, pTimer, CallBackFunc,pContext,szID); -#endif -} - - -VOID -ODM_CancelTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - del_timer(pTimer); -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - _cancel_timer_ex(pTimer); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PlatformCancelTimer(Adapter, pTimer); -#endif -} - - -VOID -ODM_ReleaseTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - - PADAPTER Adapter = pDM_Odm->Adapter; - - // <20120301, Kordan> If the initilization fails, InitializeAdapterXxx will return regardless of InitHalDm. - // Hence, uninitialized timers cause BSOD when the driver releases resources since the init fail. - if (pTimer == 0) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_SERIOUS, ("=====>ODM_ReleaseTimer(), The timer is NULL! Please check it!\n")); - return; - } - - PlatformReleaseTimer(Adapter, pTimer); -#endif -} - - -u1Byte -phydm_trans_h2c_id( - IN PDM_ODM_T pDM_Odm, - IN u1Byte phydm_h2c_id -) -{ - u1Byte platform_h2c_id = phydm_h2c_id; - - switch (phydm_h2c_id) - { - //1 [0] - case ODM_H2C_RSSI_REPORT: - - #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - if(pDM_Odm->SupportICType == ODM_RTL8188E) - platform_h2c_id = H2C_88E_RSSI_REPORT; - else if(pDM_Odm->SupportICType == ODM_RTL8814A) - platform_h2c_id =H2C_8814A_RSSI_REPORT; - else - platform_h2c_id = H2C_RSSI_REPORT; - - #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - platform_h2c_id = H2C_RSSI_SETTING; - - #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) - #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) - if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) - platform_h2c_id = H2C_88XX_RSSI_REPORT; - else - #endif - #if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812) - platform_h2c_id = H2C_8812_RSSI_REPORT; - else - #endif - {} - #endif - - break; - - //1 [3] - case ODM_H2C_WIFI_CALIBRATION: - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - platform_h2c_id =H2C_WIFI_CALIBRATION; - - #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - #if (RTL8723B_SUPPORT == 1) - platform_h2c_id = H2C_8723B_BT_WLAN_CALIBRATION; - #endif - - #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) - #endif - break; - - - //1 [4] - case ODM_H2C_IQ_CALIBRATION: - #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - platform_h2c_id =H2C_IQ_CALIBRATION; - - #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) - platform_h2c_id = H2C_8812_IQ_CALIBRATION; - #endif - #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) - #endif - - break; - //1 [5] - case ODM_H2C_RA_PARA_ADJUST: - - #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B)) - platform_h2c_id =H2C_8814A_RA_PARA_ADJUST; - else - platform_h2c_id = H2C_RA_PARA_ADJUST; - #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - #if((RTL8812A_SUPPORT==1) ||(RTL8821A_SUPPORT==1)) - platform_h2c_id = H2C_8812_RA_PARA_ADJUST; - #elif ((RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) - platform_h2c_id = H2C_RA_PARA_ADJUST; - #elif(RTL8192E_SUPPORT==1) - platform_h2c_id =H2C_8192E_RA_PARA_ADJUST; - #elif(RTL8723B_SUPPORT==1) - platform_h2c_id =H2C_8723B_RA_PARA_ADJUST; - #endif - - #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) - #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) - if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) - platform_h2c_id = H2C_88XX_RA_PARA_ADJUST; - else - #endif - #if(RTL8812A_SUPPORT==1) - if(pDM_Odm->SupportICType == ODM_RTL8812) - platform_h2c_id = H2C_8812_RA_PARA_ADJUST; - else - #endif - {} - #endif - - break; - - - //1 [6] - case PHYDM_H2C_DYNAMIC_TX_PATH: - - #if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - if(pDM_Odm->SupportICType == ODM_RTL8814A) - { - platform_h2c_id =H2C_8814A_DYNAMIC_TX_PATH; - } - #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - #if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8814A) - platform_h2c_id = H2C_DYNAMIC_TX_PATH; - #endif - #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) - #if(RTL8814A_SUPPORT==1) - if( pDM_Odm->SupportICType == ODM_RTL8814A) - { - platform_h2c_id = H2C_88XX_DYNAMIC_TX_PATH; - } - #endif - - #endif - - break; - - /* [7]*/ - case PHYDM_H2C_FW_TRACE_EN: - - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (pDM_Odm->SupportICType & (ODM_RTL8814A|ODM_RTL8822B)) - platform_h2c_id = H2C_8814A_FW_TRACE_EN; - else - platform_h2c_id = H2C_FW_TRACE_EN; - - #elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - - platform_h2c_id = 0x49; - - #elif(DM_ODM_SUPPORT_TYPE & ODM_AP) - #if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) - if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) - platform_h2c_id = H2C_88XX_FW_TRACE_EN; - else - #endif - #if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812) - platform_h2c_id = H2C_8812_FW_TRACE_EN; - else - #endif - {} - - #endif - - break; - - case PHYDM_H2C_TXBF: - #if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) - platform_h2c_id = 0x41; /*H2C_TxBF*/ - #endif - break; - - case PHYDM_H2C_MU: - #if (RTL8822B_SUPPORT == 1) - platform_h2c_id = 0x4a; /*H2C_MU*/ - #endif - break; - - default: - platform_h2c_id = phydm_h2c_id; - break; - } - - return platform_h2c_id; - -} - -/*ODM FW relative API.*/ - -VOID -ODM_FillH2CCmd( - IN PDM_ODM_T pDM_Odm, - IN u1Byte phydm_h2c_id, - IN u4Byte CmdLen, - IN pu1Byte pCmdBuffer -) -{ - PADAPTER Adapter = pDM_Odm->Adapter; - u1Byte platform_h2c_id; - - platform_h2c_id=phydm_trans_h2c_id(pDM_Odm, phydm_h2c_id); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] platform_h2c_id = ((0x%x))\n", platform_h2c_id)); - -#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (pDM_Odm->SupportICType == ODM_RTL8188E) { - if (!pDM_Odm->RaSupport88E) - FillH2CCmd88E(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); - } else if (pDM_Odm->SupportICType == ODM_RTL8814A) - FillH2CCmd8814A(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); - else if (pDM_Odm->SupportICType == ODM_RTL8822B) -#if (RTL8822B_SUPPORT == 1) - FillH2CCmd8822B(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); -#endif - else - FillH2CCmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - rtw_hal_fill_h2c_cmd(Adapter, platform_h2c_id, CmdLen, pCmdBuffer); - -#elif(DM_ODM_SUPPORT_TYPE & ODM_AP) -#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) - if (pDM_Odm->SupportICType == ODM_RTL8881A || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) - GET_HAL_INTERFACE(pDM_Odm->priv)->FillH2CCmdHandler(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); - else -#endif -#if (RTL8812A_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8812) - FillH2CCmd8812(pDM_Odm->priv, platform_h2c_id, CmdLen, pCmdBuffer); - else -#endif - {} -#endif -} - -u1Byte -phydm_c2H_content_parsing( - IN PVOID pDM_VOID, - IN u1Byte c2hCmdId, - IN u1Byte c2hCmdLen, - IN pu1Byte tmpBuf -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - #endif - u1Byte Extend_c2hSubID = 0; - u1Byte find_c2h_cmd = TRUE; - - switch (c2hCmdId) { - case PHYDM_C2H_DBG: - phydm_fw_trace_handler(pDM_Odm, tmpBuf, c2hCmdLen); - break; - - case PHYDM_C2H_RA_RPT: - phydm_c2h_ra_report_handler(pDM_Odm, tmpBuf, c2hCmdLen); - break; - - case PHYDM_C2H_RA_PARA_RPT: - ODM_C2HRaParaReportHandler(pDM_Odm, tmpBuf, c2hCmdLen); - break; - - case PHYDM_C2H_DYNAMIC_TX_PATH_RPT: - if (pDM_Odm->SupportICType & (ODM_RTL8814A)) - phydm_c2h_dtp_handler(pDM_Odm, tmpBuf, c2hCmdLen); - break; - - case PHYDM_C2H_IQK_FINISH: - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) { - - RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Finish ==\n")); - PlatformAcquireSpinLock(Adapter, RT_IQK_SPINLOCK); - pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; - PlatformReleaseSpinLock(Adapter, RT_IQK_SPINLOCK); - pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = 0; - pDM_Odm->RFCalibrateInfo.IQK_ProgressingTime = ODM_GetProgressingTime(pDM_Odm, pDM_Odm->RFCalibrateInfo.IQK_StartTime); - } - - #endif - break; - - case PHYDM_C2H_DBG_CODE: - phydm_fw_trace_handler_code(pDM_Odm, tmpBuf, c2hCmdLen); - break; - - case PHYDM_C2H_EXTEND: - Extend_c2hSubID= tmpBuf[0]; - if (Extend_c2hSubID == PHYDM_EXTEND_C2H_DBG_PRINT) - phydm_fw_trace_handler_8051(pDM_Odm, tmpBuf, c2hCmdLen); - - break; - - default: - find_c2h_cmd = FALSE; - break; - } - - return find_c2h_cmd; - -} - -u8Byte -ODM_GetCurrentTime( - IN PDM_ODM_T pDM_Odm - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return 0; -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - return (u8Byte)rtw_get_current_time(); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - return PlatformGetCurrentTime(); -#endif -} - -u8Byte -ODM_GetProgressingTime( - IN PDM_ODM_T pDM_Odm, - IN u8Byte Start_Time - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - return 0; -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - return rtw_get_passing_time_ms((u4Byte)Start_Time); -#elif(DM_ODM_SUPPORT_TYPE & ODM_WIN) - return ((PlatformGetCurrentTime() - Start_Time)>>10); -#endif -} - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +/* + * ODM IO Relative API. + * */ + +u8 +odm_read_1byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct rtl8192cd_priv *priv = p_dm->priv; + return RTL_R8(reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + return rtl_read_byte(rtlpriv, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + return rtw_read8(adapter, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + return PlatformEFIORead1Byte(adapter, reg_addr); +#endif + +} + + +u16 +odm_read_2byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct rtl8192cd_priv *priv = p_dm->priv; + return RTL_R16(reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + return rtl_read_word(rtlpriv, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + return rtw_read16(adapter, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + return PlatformEFIORead2Byte(adapter, reg_addr); +#endif + +} + + +u32 +odm_read_4byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct rtl8192cd_priv *priv = p_dm->priv; + return RTL_R32(reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + return rtl_read_dword(rtlpriv, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + return rtw_read32(adapter, reg_addr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + return PlatformEFIORead4Byte(adapter, reg_addr); +#endif + +} + + +void +odm_write_1byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u8 data +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct rtl8192cd_priv *priv = p_dm->priv; + RTL_W8(reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + rtl_write_byte(rtlpriv, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + rtw_write8(adapter, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformEFIOWrite1Byte(adapter, reg_addr, data); +#endif + +} + + +void +odm_write_2byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u16 data +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct rtl8192cd_priv *priv = p_dm->priv; + RTL_W16(reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + rtl_write_word(rtlpriv, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + rtw_write16(adapter, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformEFIOWrite2Byte(adapter, reg_addr, data); +#endif + +} + + +void +odm_write_4byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 data +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + struct rtl8192cd_priv *priv = p_dm->priv; + RTL_W32(reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + rtl_write_dword(rtlpriv, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + rtw_write32(adapter, reg_addr, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformEFIOWrite4Byte(adapter, reg_addr, data); +#endif + +} + + +void +odm_set_mac_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask, + u32 data +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + phy_set_bb_reg(p_dm->priv, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PHY_SetBBReg(adapter, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + rtl_set_bbreg(rtlpriv->hw, reg_addr, bit_mask, data); +#else + phy_set_bb_reg(p_dm->adapter, reg_addr, bit_mask, data); +#endif +} + + +u32 +odm_get_mac_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + return phy_query_bb_reg(p_dm->priv, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + return PHY_QueryMacReg(p_dm->adapter, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + return rtl_get_bbreg(rtlpriv->hw, reg_addr, bit_mask); +#else + return phy_query_mac_reg(p_dm->adapter, reg_addr, bit_mask); +#endif +} + + +void +odm_set_bb_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask, + u32 data +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + phy_set_bb_reg(p_dm->priv, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PHY_SetBBReg(adapter, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + rtl_set_bbreg(rtlpriv->hw, reg_addr, bit_mask, data); +#else + phy_set_bb_reg(p_dm->adapter, reg_addr, bit_mask, data); +#endif +} + + +u32 +odm_get_bb_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + return phy_query_bb_reg(p_dm->priv, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + return PHY_QueryBBReg(adapter, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + return rtl_get_bbreg(rtlpriv->hw, reg_addr, bit_mask); +#else + return phy_query_bb_reg(p_dm->adapter, reg_addr, bit_mask); +#endif +} + + +void +odm_set_rf_reg( + struct PHY_DM_STRUCT *p_dm, + u8 e_rf_path, + u32 reg_addr, + u32 bit_mask, + u32 data +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + phy_set_rf_reg(p_dm->priv, e_rf_path, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PHY_SetRFReg(adapter, e_rf_path, reg_addr, bit_mask, data); + ODM_delay_us(2); + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + rtl_set_rfreg(rtlpriv->hw, e_rf_path, reg_addr, bit_mask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + phy_set_rf_reg(p_dm->adapter, e_rf_path, reg_addr, bit_mask, data); +#endif +} + +u32 +odm_get_rf_reg( + struct PHY_DM_STRUCT *p_dm, + u8 e_rf_path, + u32 reg_addr, + u32 bit_mask +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + return phy_query_rf_reg(p_dm->priv, e_rf_path, reg_addr, bit_mask, 1); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + return PHY_QueryRFReg(adapter, e_rf_path, reg_addr, bit_mask); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; + + return rtl_get_rfreg(rtlpriv->hw, e_rf_path, reg_addr, bit_mask); +#else + return phy_query_rf_reg(p_dm->adapter, e_rf_path, reg_addr, bit_mask); +#endif +} + +enum hal_status +phydm_set_reg_by_fw( + struct PHY_DM_STRUCT *p_dm, + enum phydm_halmac_param config_type, + u32 offset, + u32 data, + u32 mask, + enum rf_path e_rf_path, + u32 delay_time +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + return HAL_MAC_Config_PHY_WriteNByte(p_dm, + config_type, + offset, + data, + mask, + e_rf_path, + delay_time); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return rtw_phydm_cfg_phy_para(p_dm, + config_type, + offset, + data, + mask, + e_rf_path, + delay_time); +#endif + +} + + +/* + * ODM Memory relative API. + * */ +void +odm_allocate_memory( + struct PHY_DM_STRUCT *p_dm, + void **p_ptr, + u32 length +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + *p_ptr = kmalloc(length, GFP_ATOMIC); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + *p_ptr = kmalloc(length, GFP_ATOMIC); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + *p_ptr = rtw_zvmalloc(length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformAllocateMemory(adapter, p_ptr, length); +#endif +} + +/* length could be ignored, used to detect memory leakage. */ +void +odm_free_memory( + struct PHY_DM_STRUCT *p_dm, + void *p_ptr, + u32 length +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + kfree(p_ptr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + kfree(p_ptr); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + rtw_vmfree(p_ptr, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + /* struct _ADAPTER* adapter = p_dm->adapter; */ + PlatformFreeMemory(p_ptr, length); +#endif +} + +void +odm_move_memory( + struct PHY_DM_STRUCT *p_dm, + void *p_dest, + void *p_src, + u32 length +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + memcpy(p_dest, p_src, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + memcpy(p_dest, p_src, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + _rtw_memcpy(p_dest, p_src, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformMoveMemory(p_dest, p_src, length); +#endif +} + +void odm_memory_set( + struct PHY_DM_STRUCT *p_dm, + void *pbuf, + s8 value, + u32 length +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + memset(pbuf, value, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + memset(pbuf, value, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + _rtw_memset(pbuf, value, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformFillMemory(pbuf, length, value); +#endif +} +s32 odm_compare_memory( + struct PHY_DM_STRUCT *p_dm, + void *p_buf1, + void *p_buf2, + u32 length +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + return memcmp(p_buf1, p_buf2, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + return memcmp(p_buf1, p_buf2, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return _rtw_memcmp(p_buf1, p_buf2, length); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + return PlatformCompareMemory(p_buf1, p_buf2, length); +#endif +} + + + +/* + * ODM MISC relative API. + * */ +void +odm_acquire_spin_lock( + struct PHY_DM_STRUCT *p_dm, + enum rt_spinlock_type type +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + rtw_odm_acquirespinlock(adapter, type); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformAcquireSpinLock(adapter, type); +#endif +} +void +odm_release_spin_lock( + struct PHY_DM_STRUCT *p_dm, + enum rt_spinlock_type type +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + rtw_odm_releasespinlock(adapter, type); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformReleaseSpinLock(adapter, type); +#endif +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +/* + * Work item relative API. FOr MP driver only~! + * */ +void +odm_initialize_work_item( + struct PHY_DM_STRUCT *p_dm, + PRT_WORK_ITEM p_rt_work_item, + RT_WORKITEM_CALL_BACK rt_work_item_callback, + void *p_context, + const char *sz_id +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformInitializeWorkItem(adapter, p_rt_work_item, rt_work_item_callback, p_context, sz_id); +#endif +} + + +void +odm_start_work_item( + PRT_WORK_ITEM p_rt_work_item +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformStartWorkItem(p_rt_work_item); +#endif +} + + +void +odm_stop_work_item( + PRT_WORK_ITEM p_rt_work_item +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformStopWorkItem(p_rt_work_item); +#endif +} + + +void +odm_free_work_item( + PRT_WORK_ITEM p_rt_work_item +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformFreeWorkItem(p_rt_work_item); +#endif +} + + +void +odm_schedule_work_item( + PRT_WORK_ITEM p_rt_work_item +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformScheduleWorkItem(p_rt_work_item); +#endif +} + + +boolean +odm_is_work_item_scheduled( + PRT_WORK_ITEM p_rt_work_item +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + return PlatformIsWorkItemScheduled(p_rt_work_item); +#endif +} +#endif + + +/* + * ODM Timer relative API. + * */ + +void +ODM_delay_ms(u32 ms) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + delay_ms(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + mdelay(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + rtw_mdelay_os(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + delay_ms(ms); +#endif +} + +void +ODM_delay_us(u32 us) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + delay_us(us); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + udelay(us); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + rtw_udelay_os(us); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformStallExecution(us); +#endif +} + +void +ODM_sleep_ms(u32 ms) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + delay_ms(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + msleep(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + rtw_msleep_os(ms); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + delay_ms(ms); +#endif +} + +void +ODM_sleep_us(u32 us) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + delay_us(us); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + usleep_range(us, us + 1); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + rtw_usleep_os(us); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PlatformStallExecution(us); +#endif +} + +void +odm_set_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer, + u32 ms_delay +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + mod_timer(p_timer, jiffies + RTL_MILISECONDS_TO_JIFFIES(ms_delay)); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + mod_timer(p_timer, jiffies + msecs_to_jiffies(ms_delay)); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + _set_timer(p_timer, ms_delay); /* ms */ +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformSetTimer(adapter, p_timer, ms_delay); +#endif + +} + +void +odm_initialize_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer, + void *call_back_func, + void *p_context, + const char *sz_id +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + init_timer(p_timer); + p_timer->function = call_back_func; + p_timer->data = (unsigned long)p_dm; + /*mod_timer(p_timer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); */ +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + init_timer(p_timer); + p_timer->function = call_back_func; + p_timer->data = (unsigned long)p_dm; + /*mod_timer(p_timer, jiffies+RTL_MILISECONDS_TO_JIFFIES(10)); */ +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + struct _ADAPTER *adapter = p_dm->adapter; + + _init_timer(p_timer, adapter->pnetdev, call_back_func, p_dm); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + + PlatformInitializeTimer(adapter, p_timer, (RT_TIMER_CALL_BACK)call_back_func, p_context, sz_id); +#endif +} + + +void +odm_cancel_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + del_timer(p_timer); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + del_timer(p_timer); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + _cancel_timer_ex(p_timer); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PlatformCancelTimer(adapter, p_timer); +#endif +} + + +void +odm_release_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + + struct _ADAPTER *adapter = p_dm->adapter; + + /* <20120301, Kordan> If the initilization fails, InitializeAdapterXxx will return regardless of InitHalDm. + * Hence, uninitialized timers cause BSOD when the driver releases resources since the init fail. */ + if (p_timer == 0) { + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("=====>odm_release_timer(), The timer is NULL! Please check it!\n")); + return; + } + + PlatformReleaseTimer(adapter, p_timer); +#endif +} + + +u8 +phydm_trans_h2c_id( + struct PHY_DM_STRUCT *p_dm, + u8 phydm_h2c_id +) +{ + u8 platform_h2c_id = phydm_h2c_id; + + switch (phydm_h2c_id) { + /* 1 [0] */ + case ODM_H2C_RSSI_REPORT: + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (p_dm->support_ic_type == ODM_RTL8188E) + platform_h2c_id = H2C_88E_RSSI_REPORT; + else if (p_dm->support_ic_type == ODM_RTL8814A) + platform_h2c_id = H2C_8814A_RSSI_REPORT; + else + platform_h2c_id = H2C_RSSI_REPORT; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + platform_h2c_id = H2C_RSSI_SETTING; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) +#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) + if (p_dm->support_ic_type == ODM_RTL8881A || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type & PHYDM_IC_3081_SERIES) + platform_h2c_id = H2C_88XX_RSSI_REPORT; + else +#endif +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) + platform_h2c_id = H2C_8812_RSSI_REPORT; + else +#endif + {} +#endif + + break; + + /* 1 [3] */ + case ODM_H2C_WIFI_CALIBRATION: +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + platform_h2c_id = H2C_WIFI_CALIBRATION; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +#if (RTL8723B_SUPPORT == 1) + platform_h2c_id = H2C_8723B_BT_WLAN_CALIBRATION; +#endif + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) +#endif + break; + + + /* 1 [4] */ + case ODM_H2C_IQ_CALIBRATION: +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + platform_h2c_id = H2C_IQ_CALIBRATION; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + platform_h2c_id = H2C_8812_IQ_CALIBRATION; +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) +#endif + + break; + /* 1 [5] */ + case ODM_H2C_RA_PARA_ADJUST: + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) + platform_h2c_id = H2C_8814A_RA_PARA_ADJUST; + else + platform_h2c_id = H2C_RA_PARA_ADJUST; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + platform_h2c_id = H2C_8812_RA_PARA_ADJUST; +#elif ((RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) + platform_h2c_id = H2C_RA_PARA_ADJUST; +#elif (RTL8192E_SUPPORT == 1) + platform_h2c_id = H2C_8192E_RA_PARA_ADJUST; +#elif (RTL8723B_SUPPORT == 1) + platform_h2c_id = H2C_8723B_RA_PARA_ADJUST; +#endif + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) +#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) + if (p_dm->support_ic_type == ODM_RTL8881A || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type & PHYDM_IC_3081_SERIES) + platform_h2c_id = H2C_88XX_RA_PARA_ADJUST; + else +#endif +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) + platform_h2c_id = H2C_8812_RA_PARA_ADJUST; + else +#endif + {} +#endif + + break; + + + /* 1 [6] */ + case PHYDM_H2C_DYNAMIC_TX_PATH: + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (p_dm->support_ic_type == ODM_RTL8814A) + platform_h2c_id = H2C_8814A_DYNAMIC_TX_PATH; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8814A) + platform_h2c_id = H2C_DYNAMIC_TX_PATH; +#endif +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8814A) + platform_h2c_id = H2C_88XX_DYNAMIC_TX_PATH; +#endif + +#endif + + break; + + /* [7]*/ + case PHYDM_H2C_FW_TRACE_EN: + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) + platform_h2c_id = H2C_8814A_FW_TRACE_EN; + else + platform_h2c_id = H2C_FW_TRACE_EN; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + + platform_h2c_id = 0x49; + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) +#if ((RTL8881A_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) + if (p_dm->support_ic_type == ODM_RTL8881A || p_dm->support_ic_type == ODM_RTL8192E || p_dm->support_ic_type & PHYDM_IC_3081_SERIES) + platform_h2c_id = H2C_88XX_FW_TRACE_EN; + else +#endif +#if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) + platform_h2c_id = H2C_8812_FW_TRACE_EN; + else +#endif + {} + +#endif + + break; + + case PHYDM_H2C_TXBF: +#if ((RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1)) + platform_h2c_id = 0x41; /*H2C_TxBF*/ +#endif + break; + + case PHYDM_H2C_MU: +#if (RTL8822B_SUPPORT == 1) + platform_h2c_id = 0x4a; /*H2C_MU*/ +#endif + break; + + default: + platform_h2c_id = phydm_h2c_id; + break; + } + + return platform_h2c_id; + +} + +/*ODM FW relative API.*/ + +void +odm_fill_h2c_cmd( + struct PHY_DM_STRUCT *p_dm, + u8 phydm_h2c_id, + u32 cmd_len, + u8 *p_cmd_buffer +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + struct rtl_priv *rtlpriv = (struct rtl_priv *)p_dm->adapter; +#else + struct _ADAPTER *adapter = p_dm->adapter; +#endif + u8 h2c_id = phydm_trans_h2c_id(p_dm, phydm_h2c_id); + + PHYDM_DBG(p_dm, DBG_RA, ("[H2C] h2c_id=((0x%x))\n", h2c_id)); + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + if (p_dm->support_ic_type == ODM_RTL8188E) { + if (!p_dm->ra_support88e) + FillH2CCmd88E(adapter, h2c_id, cmd_len, p_cmd_buffer); + } else if (p_dm->support_ic_type == ODM_RTL8814A) + FillH2CCmd8814A(adapter, h2c_id, cmd_len, p_cmd_buffer); + else if (p_dm->support_ic_type == ODM_RTL8822B) + FillH2CCmd8822B(adapter, h2c_id, cmd_len, p_cmd_buffer); + else + FillH2CCmd(adapter, h2c_id, cmd_len, p_cmd_buffer); + +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + + #ifdef DM_ODM_CE_MAC80211 + rtlpriv->cfg->ops->fill_h2c_cmd(rtlpriv->hw, h2c_id,cmd_len, p_cmd_buffer); + #else + rtw_hal_fill_h2c_cmd(adapter, h2c_id, cmd_len, p_cmd_buffer); + #endif + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + + #if (RTL8812A_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8812) { + fill_h2c_cmd8812(p_dm->priv, h2c_id, cmd_len, p_cmd_buffer); + } else + #endif + { + GET_HAL_INTERFACE(p_dm->priv)->fill_h2c_cmd_handler(p_dm->priv, h2c_id, cmd_len, p_cmd_buffer); + } +#endif +} + +u8 +phydm_c2H_content_parsing( + void *p_dm_void, + u8 c2h_cmd_id, + u8 c2h_cmd_len, + u8 *tmp_buf +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; +#endif + u8 extend_c2h_sub_id = 0; + u8 find_c2h_cmd = true; + + if ((c2h_cmd_len > 12) || (c2h_cmd_len == 0)) { + dbg_print("[Warning] Error C2H ID=%d, len=%d\n", c2h_cmd_id, c2h_cmd_len); + + find_c2h_cmd = false; + return find_c2h_cmd; + } + + switch (c2h_cmd_id) { + case PHYDM_C2H_DBG: + phydm_fw_trace_handler(p_dm, tmp_buf, c2h_cmd_len); + break; + + case PHYDM_C2H_RA_RPT: + phydm_c2h_ra_report_handler(p_dm, tmp_buf, c2h_cmd_len); + break; + + case PHYDM_C2H_RA_PARA_RPT: + odm_c2h_ra_para_report_handler(p_dm, tmp_buf, c2h_cmd_len); + break; + + case PHYDM_C2H_DYNAMIC_TX_PATH_RPT: + if (p_dm->support_ic_type & (ODM_RTL8814A)) + phydm_c2h_dtp_handler(p_dm, tmp_buf, c2h_cmd_len); + break; + + case PHYDM_C2H_IQK_FINISH: +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + + if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) { + + RT_TRACE(COMP_MP, DBG_LOUD, ("== FW IQK Finish ==\n")); + odm_acquire_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.is_iqk_in_progress = false; + odm_release_spin_lock(p_dm, RT_IQK_SPINLOCK); + p_dm->rf_calibrate_info.iqk_progressing_time = 0; + p_dm->rf_calibrate_info.iqk_progressing_time = odm_get_progressing_time(p_dm, p_dm->rf_calibrate_info.iqk_start_time); + } + +#endif + break; + + case PHYDM_C2H_CLM_MONITOR: + phydm_c2h_clm_report_handler(p_dm, tmp_buf, c2h_cmd_len); + break; + + case PHYDM_C2H_DBG_CODE: + phydm_fw_trace_handler_code(p_dm, tmp_buf, c2h_cmd_len); + break; + + case PHYDM_C2H_EXTEND: + extend_c2h_sub_id = tmp_buf[0]; + if (extend_c2h_sub_id == PHYDM_EXTEND_C2H_DBG_PRINT) + phydm_fw_trace_handler_8051(p_dm, tmp_buf, c2h_cmd_len); + + break; + + default: + find_c2h_cmd = false; + break; + } + + return find_c2h_cmd; + +} + +u64 +odm_get_current_time( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + return (u64)rtw_get_current_time(); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + return jiffies; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return rtw_get_current_time(); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + return PlatformGetCurrentTime(); +#endif +} + +u64 +odm_get_progressing_time( + struct PHY_DM_STRUCT *p_dm, + u64 start_time +) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + return rtw_get_passing_time_ms((u32)start_time); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + return jiffies_to_msecs(jiffies - start_time); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return rtw_get_passing_time_ms((systime)start_time); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + return ((PlatformGetCurrentTime() - start_time) >> 10); +#endif +} + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) && !defined(DM_ODM_CE_MAC80211) + +void +phydm_set_hw_reg_handler_interface ( + struct PHY_DM_STRUCT *p_dm, + u8 RegName, + u8 *val + ) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) + struct _ADAPTER *adapter = p_dm->adapter; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + adapter->HalFunc.SetHwRegHandler(adapter, RegName, val); +#else + adapter->hal_func.set_hw_reg_handler(adapter, RegName, val); +#endif + +#endif + +} + +void +phydm_get_hal_def_var_handler_interface ( + struct PHY_DM_STRUCT *p_dm, + enum _HAL_DEF_VARIABLE e_variable, + void *p_value + ) +{ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) + struct _ADAPTER *adapter = p_dm->adapter; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + adapter->HalFunc.GetHalDefVarHandler(adapter, e_variable, p_value); +#else + adapter->hal_func.get_hal_def_var_handler(adapter, e_variable, p_value); +#endif + +#endif +} + +#endif + +void +odm_set_tx_power_index_by_rate_section ( + struct PHY_DM_STRUCT *p_dm, + enum rf_path path, + u8 Channel, + u8 RateSection + ) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + PHY_SetTxPowerIndexByRateSection(adapter, path, Channel, RateSection); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = p_dm->adapter; + + phy_set_tx_power_index_by_rs(adapter, Channel, path, RateSection); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + phy_set_tx_power_index_by_rate_section(p_dm->adapter, path, Channel, RateSection); +#endif +} + + +u8 +odm_get_tx_power_index ( + struct PHY_DM_STRUCT *p_dm, + enum rf_path path, + u8 tx_rate, + u8 band_width, + u8 Channel + ) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + + return PHY_GetTxPowerIndex(p_dm->adapter, path, tx_rate, (CHANNEL_WIDTH)band_width, Channel); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = p_dm->adapter; + + return phy_get_tx_power_index(adapter, (enum rf_path)path, tx_rate, band_width, Channel); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return phy_get_tx_power_index(p_dm->adapter, path, tx_rate, band_width, Channel); +#endif +} + + + +u8 +odm_efuse_one_byte_read( + struct PHY_DM_STRUCT *p_dm, + u16 addr, + u8 *data, + boolean b_pseu_do_test + ) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + + return (u8)EFUSE_OneByteRead(adapter, addr, data, b_pseu_do_test); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = p_dm->adapter; + + return rtl_efuse_onebyte_read(adapter, addr, data, b_pseu_do_test); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + return efuse_onebyte_read(p_dm->adapter, addr, data, b_pseu_do_test); +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + /*ReadEFuseByte(p_dm->priv, addr, data);*/ + /*return true;*/ +#endif +} + + + +void +odm_efuse_logical_map_read( + struct PHY_DM_STRUCT *p_dm, + u8 type, + u16 offset, + u32 *data +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + + EFUSE_ShadowRead(adapter, type, offset, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && defined(DM_ODM_CE_MAC80211) + void *adapter = p_dm->adapter; + + rtl_efuse_logical_map_read(adapter, type, offset, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + efuse_logical_map_read(p_dm->adapter, type, offset, data); +#endif +} + +enum hal_status +odm_iq_calibrate_by_fw( + struct PHY_DM_STRUCT *p_dm, + u8 clear, + u8 segment + ) +{ + enum hal_status iqk_result = HAL_STATUS_FAILURE; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + + if (HAL_MAC_FWIQK_Trigger(&GET_HAL_MAC_INFO(adapter), clear, segment) == 0) + iqk_result = HAL_STATUS_SUCCESS; +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) + iqk_result = rtw_phydm_fw_iqk(p_dm, clear, segment); +#endif + return iqk_result; +} + +void +odm_cmn_info_ptr_array_hook( + struct PHY_DM_STRUCT *p_dm, + enum odm_cmninfo_e cmn_info, + u16 index, + void *p_value +) +{ + switch (cmn_info) { + /*Dynamic call by reference pointer. */ + case ODM_CMNINFO_STA_STATUS: + p_dm->p_odm_sta_info[index] = (struct sta_info *)p_value; + break; + /* To remove the compiler warning, must add an empty default statement to handle the other values. */ + default: + /* do nothing */ + break; + } + +} + +void +phydm_cmn_sta_info_hook( + struct PHY_DM_STRUCT *p_dm, + u8 mac_id, + struct cmn_sta_info *pcmn_sta_info +) +{ + p_dm->p_phydm_sta_info[mac_id] = pcmn_sta_info; + + if (is_sta_active(pcmn_sta_info)) + p_dm->phydm_macid_table[pcmn_sta_info->mac_id] = mac_id; +} + +void +phydm_add_interrupt_mask_handler( + struct PHY_DM_STRUCT *p_dm, + u8 interrupt_type +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + + struct rtl8192cd_priv *priv = p_dm->priv; + + #if IS_EXIST_PCI || IS_EXIST_EMBEDDED + GET_HAL_INTERFACE(priv)->AddInterruptMaskHandler(priv, interrupt_type); + #endif + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +#endif +} + +void +phydm_enable_rx_related_interrupt_handler( + struct PHY_DM_STRUCT *p_dm +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + + struct rtl8192cd_priv *priv = p_dm->priv; + + #if IS_EXIST_PCI || IS_EXIST_EMBEDDED + GET_HAL_INTERFACE(priv)->EnableRxRelatedInterruptHandler(priv); + #endif + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) +#endif +} + +boolean +phydm_get_txbf_en( + struct PHY_DM_STRUCT *p_dm, + u16 mac_id, + u8 i +) +{ + boolean txbf_en = false; + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#elif (DM_ODM_SUPPORT_TYPE & ODM_CE) && !defined(DM_ODM_CE_MAC80211) + + #ifdef CONFIG_BEAMFORMING + enum beamforming_cap beamform_cap; + struct _ADAPTER *adapter = p_dm->adapter; + #if (BEAMFORMING_SUPPORT == 1) + beamform_cap = + phydm_beamforming_get_entry_beam_cap_by_mac_id(p_dm, mac_id); + #else/*for drv beamforming*/ + beamform_cap = + beamforming_get_entry_beam_cap_by_mac_id(&adapter->mlmepriv, mac_id); + #endif + if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) + txbf_en = true; + else + txbf_en = false; + #endif /*#ifdef CONFIG_BEAMFORMING*/ + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + + #if (BEAMFORMING_SUPPORT == 1) + u8 idx = 0xff; + boolean act_bfer = false; + BEAMFORMING_CAP beamform_cap = BEAMFORMING_CAP_NONE; + PRT_BEAMFORMING_ENTRY p_entry = NULL; + struct rtl8192cd_priv *priv = p_dm->priv; + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + struct _BF_DIV_COEX_ *p_dm_bdc_table = &p_dm->dm_bdc_table; + + p_dm_bdc_table->num_txbfee_client = 0; + p_dm_bdc_table->num_txbfer_client = 0; + #endif + #endif + + #if (BEAMFORMING_SUPPORT == 1) + beamform_cap = Beamforming_GetEntryBeamCapByMacId(priv, mac_id); + p_entry = Beamforming_GetEntryByMacId(priv, mac_id, &idx); + if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { + if (p_entry->Sounding_En) + txbf_en = true; + else + txbf_en = false; + act_bfer = true; + } + #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*BDC*/ + if (act_bfer == true) { + p_dm_bdc_table->w_bfee_client[i] = true; /* AP act as BFer */ + p_dm_bdc_table->num_txbfee_client++; + } else + p_dm_bdc_table->w_bfee_client[i] = false; /* AP act as BFer */ + + if (beamform_cap & (BEAMFORMEE_CAP_HT_EXPLICIT | BEAMFORMEE_CAP_VHT_SU)) { + p_dm_bdc_table->w_bfer_client[i] = true; /* AP act as BFee */ + p_dm_bdc_table->num_txbfer_client++; + } else + p_dm_bdc_table->w_bfer_client[i] = false; /* AP act as BFer */ + + #endif + #endif + +#endif + return txbf_en; + +} + +void +phydm_iqk_wait( + struct PHY_DM_STRUCT *p_dm, + u32 timeout +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct _ADAPTER *p_adapter = p_dm->adapter; + + rtl8812_iqk_wait(p_adapter, timeout); +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.h index 510c128f3013..1b0f6c2d6d8c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_interface.h @@ -1,426 +1,505 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - -#ifndef __ODM_INTERFACE_H__ -#define __ODM_INTERFACE_H__ - -#define INTERFACE_VERSION "1.1" /*2015.07.29 YuChen*/ - -// -// =========== Constant/Structure/Enum/... Define -// - - - -// -// =========== Macro Define -// - -#define _reg_all(_name) ODM_##_name -#define _reg_ic(_name, _ic) ODM_##_name##_ic -#define _bit_all(_name) BIT_##_name -#define _bit_ic(_name, _ic) BIT_##_name##_ic - -// _cat: implemented by Token-Pasting Operator. -#if 0 -#define _cat(_name, _ic_type, _func) \ - ( \ - _func##_all(_name) \ - ) -#endif - -/*=================================== - -#define ODM_REG_DIG_11N 0xC50 -#define ODM_REG_DIG_11AC 0xDDD - -ODM_REG(DIG,_pDM_Odm) -=====================================*/ - -#define _reg_11N(_name) ODM_REG_##_name##_11N -#define _reg_11AC(_name) ODM_REG_##_name##_11AC -#define _bit_11N(_name) ODM_BIT_##_name##_11N -#define _bit_11AC(_name) ODM_BIT_##_name##_11AC - -#ifdef __ECOS -#define _rtk_cat(_name, _ic_type, _func) \ - ( \ - ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ - _func##_11AC(_name) \ - ) -#else - -#define _cat(_name, _ic_type, _func) \ - ( \ - ((_ic_type) & ODM_IC_11N_SERIES)? _func##_11N(_name): \ - _func##_11AC(_name) \ - ) -#endif -/* -// only sample code -//#define _cat(_name, _ic_type, _func) \ -// ( \ -// ((_ic_type) & ODM_RTL8188E)? _func##_ic(_name, _8188E): \ -// _func##_ic(_name, _8195) \ -// ) -*/ - -// _name: name of register or bit. -// Example: "ODM_REG(R_A_AGC_CORE1, pDM_Odm)" -// gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on SupportICType. -#ifdef __ECOS -#define ODM_REG(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _reg) -#define ODM_BIT(_name, _pDM_Odm) _rtk_cat(_name, _pDM_Odm->SupportICType, _bit) -#else -#define ODM_REG(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _reg) -#define ODM_BIT(_name, _pDM_Odm) _cat(_name, _pDM_Odm->SupportICType, _bit) -#endif -typedef enum _PHYDM_H2C_CMD { - PHYDM_H2C_TXBF = 0x41, - ODM_H2C_RSSI_REPORT = 0x42, - ODM_H2C_IQ_CALIBRATION = 0x45, - ODM_H2C_RA_PARA_ADJUST = 0x47, - PHYDM_H2C_DYNAMIC_TX_PATH = 0x48, - PHYDM_H2C_FW_TRACE_EN = 0x49, - ODM_H2C_WIFI_CALIBRATION = 0x6d, - PHYDM_H2C_MU = 0x4a, - ODM_MAX_H2CCMD -}PHYDM_H2C_CMD; - -typedef enum _PHYDM_C2H_EVT { - PHYDM_C2H_DBG = 0, - PHYDM_C2H_LB = 1, - PHYDM_C2H_XBF = 2, - PHYDM_C2H_TX_REPORT = 3, - PHYDM_C2H_INFO = 9, - PHYDM_C2H_BT_MP = 11, - PHYDM_C2H_RA_RPT = 12, - PHYDM_C2H_RA_PARA_RPT=14, - PHYDM_C2H_DYNAMIC_TX_PATH_RPT = 15, - PHYDM_C2H_IQK_FINISH = 17, /*0x11*/ - PHYDM_C2H_DBG_CODE = 0xFE, - PHYDM_C2H_EXTEND = 0xFF, -}PHYDM_C2H_EVT; - -typedef enum _PHYDM_EXTEND_C2H_EVT { - PHYDM_EXTEND_C2H_DBG_PRINT = 0 - -}PHYDM_EXTEND_C2H_EVT; - - -// -// 2012/02/17 MH For non-MP compile pass only. Linux does not support workitem. -// Suggest HW team to use thread instead of workitem. Windows also support the feature. -// -#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -typedef void *PRT_WORK_ITEM ; -typedef void RT_WORKITEM_HANDLE,*PRT_WORKITEM_HANDLE; -typedef VOID (*RT_WORKITEM_CALL_BACK)(PVOID pContext); - -#if 0 -typedef struct tasklet_struct RT_WORKITEM_HANDLE, *PRT_WORKITEM_HANDLE; - -typedef struct _RT_WORK_ITEM -{ - - RT_WORKITEM_HANDLE Handle; // Platform-dependent handle for this workitem, e.g. Ndis Workitem object. - PVOID Adapter; // Pointer to Adapter object. - PVOID pContext; // Parameter to passed to CallBackFunc(). - RT_WORKITEM_CALL_BACK CallbackFunc; // Callback function of the workitem. - u1Byte RefCount; // 0: driver is going to unload, 1: No such workitem scheduled, 2: one workitem is schedueled. - PVOID pPlatformExt; // Pointer to platform-dependent extension. - BOOLEAN bFree; - char szID[36]; // An identity string of this workitem. -}RT_WORK_ITEM, *PRT_WORK_ITEM; - -#endif - - -#endif - -// -// =========== Extern Variable ??? It should be forbidden. -// - - -// -// =========== EXtern Function Prototype -// - - -u1Byte -ODM_Read1Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr - ); - -u2Byte -ODM_Read2Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr - ); - -u4Byte -ODM_Read4Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr - ); - -VOID -ODM_Write1Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u1Byte Data - ); - -VOID -ODM_Write2Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u2Byte Data - ); - -VOID -ODM_Write4Byte( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte Data - ); - -VOID -ODM_SetMACReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ); - -u4Byte -ODM_GetMACReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask - ); - -VOID -ODM_SetBBReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ); - -u4Byte -ODM_GetBBReg( - IN PDM_ODM_T pDM_Odm, - IN u4Byte RegAddr, - IN u4Byte BitMask - ); - -VOID -ODM_SetRFReg( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_RADIO_PATH_E eRFPath, - IN u4Byte RegAddr, - IN u4Byte BitMask, - IN u4Byte Data - ); - -u4Byte -ODM_GetRFReg( - IN PDM_ODM_T pDM_Odm, - IN ODM_RF_RADIO_PATH_E eRFPath, - IN u4Byte RegAddr, - IN u4Byte BitMask - ); - - -// -// Memory Relative Function. -// -VOID -ODM_AllocateMemory( - IN PDM_ODM_T pDM_Odm, - OUT PVOID *pPtr, - IN u4Byte length - ); -VOID -ODM_FreeMemory( - IN PDM_ODM_T pDM_Odm, - OUT PVOID pPtr, - IN u4Byte length - ); - -VOID -ODM_MoveMemory( - IN PDM_ODM_T pDM_Odm, - OUT PVOID pDest, - IN PVOID pSrc, - IN u4Byte Length - ); - -s4Byte ODM_CompareMemory( - IN PDM_ODM_T pDM_Odm, - IN PVOID pBuf1, - IN PVOID pBuf2, - IN u4Byte length - ); - -void ODM_Memory_Set - (IN PDM_ODM_T pDM_Odm, - IN PVOID pbuf, - IN s1Byte value, - IN u4Byte length); - -// -// ODM MISC-spin lock relative API. -// -VOID -ODM_AcquireSpinLock( - IN PDM_ODM_T pDM_Odm, - IN RT_SPINLOCK_TYPE type - ); - -VOID -ODM_ReleaseSpinLock( - IN PDM_ODM_T pDM_Odm, - IN RT_SPINLOCK_TYPE type - ); - - -// -// ODM MISC-workitem relative API. -// -VOID -ODM_InitializeWorkItem( - IN PDM_ODM_T pDM_Odm, - IN PRT_WORK_ITEM pRtWorkItem, - IN RT_WORKITEM_CALL_BACK RtWorkItemCallback, - IN PVOID pContext, - IN const char* szID - ); - -VOID -ODM_StartWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ); - -VOID -ODM_StopWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ); - -VOID -ODM_FreeWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ); - -VOID -ODM_ScheduleWorkItem( - IN PRT_WORK_ITEM pRtWorkItem - ); - -VOID -ODM_IsWorkItemScheduled( - IN PRT_WORK_ITEM pRtWorkItem - ); - -// -// ODM Timer relative API. -// -VOID -ODM_StallExecution( - IN u4Byte usDelay - ); - -VOID -ODM_delay_ms(IN u4Byte ms); - - - -VOID -ODM_delay_us(IN u4Byte us); - -VOID -ODM_sleep_ms(IN u4Byte ms); - -VOID -ODM_sleep_us(IN u4Byte us); - -VOID -ODM_SetTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer, - IN u4Byte msDelay - ); - -VOID -ODM_InitializeTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer, - IN RT_TIMER_CALL_BACK CallBackFunc, - IN PVOID pContext, - IN const char* szID - ); - -VOID -ODM_CancelTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer - ); - -VOID -ODM_ReleaseTimer( - IN PDM_ODM_T pDM_Odm, - IN PRT_TIMER pTimer - ); - -// -// ODM FW relative API. -// -VOID -ODM_FillH2CCmd( - IN PDM_ODM_T pDM_Odm, - IN u1Byte ElementID, - IN u4Byte CmdLen, - IN pu1Byte pCmdBuffer -); - -u1Byte -phydm_c2H_content_parsing( - IN PVOID pDM_VOID, - IN u1Byte c2hCmdId, - IN u1Byte c2hCmdLen, - IN pu1Byte tmpBuf -); - -u8Byte -ODM_GetCurrentTime( - IN PDM_ODM_T pDM_Odm - ); -u8Byte -ODM_GetProgressingTime( - IN PDM_ODM_T pDM_Odm, - IN u8Byte Start_Time - ); - -#endif // __ODM_INTERFACE_H__ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __ODM_INTERFACE_H__ +#define __ODM_INTERFACE_H__ + +#define INTERFACE_VERSION "1.2" /*2017.05.03 YuChen add phy param offload HAL MAC API*/ + +/*=========== Constant/Structure/Enum/... Define*/ + +enum phydm_h2c_cmd { + PHYDM_H2C_RA_MASK = 0x40, + PHYDM_H2C_TXBF = 0x41, + ODM_H2C_RSSI_REPORT = 0x42, + ODM_H2C_IQ_CALIBRATION = 0x45, + PHYDM_RA_MASK_ABOVE_3SS = 0x46, + ODM_H2C_RA_PARA_ADJUST = 0x47, + PHYDM_H2C_DYNAMIC_TX_PATH = 0x48, + PHYDM_H2C_FW_TRACE_EN = 0x49, + ODM_H2C_WIFI_CALIBRATION = 0x6d, + PHYDM_H2C_MU = 0x4a, + PHYDM_H2C_FW_GENERAL_INIT = 0x4c, + PHYDM_H2C_FW_CLM_MNTR = 0x4d, + ODM_MAX_H2CCMD +}; + +enum phydm_c2h_evt { + PHYDM_C2H_DBG = 0, + PHYDM_C2H_LB = 1, + PHYDM_C2H_XBF = 2, + PHYDM_C2H_TX_REPORT = 3, + PHYDM_C2H_INFO = 9, + PHYDM_C2H_BT_MP = 11, + PHYDM_C2H_RA_RPT = 12, + PHYDM_C2H_RA_PARA_RPT = 14, + PHYDM_C2H_DYNAMIC_TX_PATH_RPT = 15, + PHYDM_C2H_IQK_FINISH = 17, /*0x11*/ + PHYDM_C2H_CLM_MONITOR = 0x2a, + PHYDM_C2H_DBG_CODE = 0xFE, + PHYDM_C2H_EXTEND = 0xFF, +}; + +enum phydm_extend_c2h_evt { + PHYDM_EXTEND_C2H_DBG_PRINT = 0 + +}; + +enum phydm_halmac_param { + PHYDM_HALMAC_CMD_MAC_W8 = 0, + PHYDM_HALMAC_CMD_MAC_W16 = 1, + PHYDM_HALMAC_CMD_MAC_W32 = 2, + PHYDM_HALMAC_CMD_BB_W8, + PHYDM_HALMAC_CMD_BB_W16, + PHYDM_HALMAC_CMD_BB_W32, + PHYDM_HALMAC_CMD_RF_W, + PHYDM_HALMAC_CMD_DELAY_US, + PHYDM_HALMAC_CMD_DELAY_MS, + PHYDM_HALMAC_CMD_END = 0XFF, +}; + +/*=========== Macro Define*/ + +#define _reg_all(_name) ODM_##_name +#define _reg_ic(_name, _ic) ODM_##_name##_ic +#define _bit_all(_name) BIT_##_name +#define _bit_ic(_name, _ic) BIT_##_name##_ic + +/* _cat: implemented by Token-Pasting Operator. */ +#if 0 +#define _cat(_name, _ic_type, _func) \ + (\ + _func##_all(_name) \ + ) +#endif + +/*=================================== + +#define ODM_REG_DIG_11N 0xC50 +#define ODM_REG_DIG_11AC 0xDDD + +ODM_REG(DIG,_pdm_odm) +=====================================*/ + +#define _reg_11N(_name) ODM_REG_##_name##_11N +#define _reg_11AC(_name) ODM_REG_##_name##_11AC +#define _bit_11N(_name) ODM_BIT_##_name##_11N +#define _bit_11AC(_name) ODM_BIT_##_name##_11AC + +#ifdef __ECOS +#define _rtk_cat(_name, _ic_type, _func) \ + (\ + ((_ic_type) & ODM_IC_11N_SERIES) ? _func##_11N(_name) : \ + _func##_11AC(_name) \ + ) +#else + +#define _cat(_name, _ic_type, _func) \ + (\ + ((_ic_type) & ODM_IC_11N_SERIES) ? _func##_11N(_name) : \ + _func##_11AC(_name) \ + ) +#endif +/* + * only sample code + *#define _cat(_name, _ic_type, _func) \ + * ( \ + * ((_ic_type) & ODM_RTL8188E) ? _func##_ic(_name, _8188E) : \ + * _func##_ic(_name, _8195) \ + * ) + */ + +/* _name: name of register or bit. + * Example: "ODM_REG(R_A_AGC_CORE1, p_dm)" + * gets "ODM_R_A_AGC_CORE1" or "ODM_R_A_AGC_CORE1_8192C", depends on support_ic_type. */ +#ifdef __ECOS + #define ODM_REG(_name, _pdm_odm) _rtk_cat(_name, _pdm_odm->support_ic_type, _reg) + #define ODM_BIT(_name, _pdm_odm) _rtk_cat(_name, _pdm_odm->support_ic_type, _bit) +#else + #define ODM_REG(_name, _pdm_odm) _cat(_name, _pdm_odm->support_ic_type, _reg) + #define ODM_BIT(_name, _pdm_odm) _cat(_name, _pdm_odm->support_ic_type, _bit) +#endif + +/* + * =========== Extern Variable ??? It should be forbidden. + * */ + + +/* + * =========== EXtern Function Prototype + * */ + + +u8 +odm_read_1byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr +); + +u16 +odm_read_2byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr +); + +u32 +odm_read_4byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr +); + +void +odm_write_1byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u8 data +); + +void +odm_write_2byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u16 data +); + +void +odm_write_4byte( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 data +); + +void +odm_set_mac_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask, + u32 data +); + +u32 +odm_get_mac_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask +); + +void +odm_set_bb_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask, + u32 data +); + +u32 +odm_get_bb_reg( + struct PHY_DM_STRUCT *p_dm, + u32 reg_addr, + u32 bit_mask +); + +void +odm_set_rf_reg( + struct PHY_DM_STRUCT *p_dm, + u8 e_rf_path, + u32 reg_addr, + u32 bit_mask, + u32 data +); + +u32 +odm_get_rf_reg( + struct PHY_DM_STRUCT *p_dm, + u8 e_rf_path, + u32 reg_addr, + u32 bit_mask +); + + +/* + * Memory Relative Function. + * */ +void +odm_allocate_memory( + struct PHY_DM_STRUCT *p_dm, + void **p_ptr, + u32 length +); +void +odm_free_memory( + struct PHY_DM_STRUCT *p_dm, + void *p_ptr, + u32 length +); + +void +odm_move_memory( + struct PHY_DM_STRUCT *p_dm, + void *p_dest, + void *p_src, + u32 length +); + +s32 odm_compare_memory( + struct PHY_DM_STRUCT *p_dm, + void *p_buf1, + void *p_buf2, + u32 length +); + +void odm_memory_set( + struct PHY_DM_STRUCT *p_dm, + void *pbuf, + s8 value, + u32 length +); + +/* + * ODM MISC-spin lock relative API. + * */ +void +odm_acquire_spin_lock( + struct PHY_DM_STRUCT *p_dm, + enum rt_spinlock_type type +); + +void +odm_release_spin_lock( + struct PHY_DM_STRUCT *p_dm, + enum rt_spinlock_type type +); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +/* + * ODM MISC-workitem relative API. + * */ +void +odm_initialize_work_item( + struct PHY_DM_STRUCT *p_dm, + PRT_WORK_ITEM p_rt_work_item, + RT_WORKITEM_CALL_BACK rt_work_item_callback, + void *p_context, + const char *sz_id +); + +void +odm_start_work_item( + PRT_WORK_ITEM p_rt_work_item +); + +void +odm_stop_work_item( + PRT_WORK_ITEM p_rt_work_item +); + +void +odm_free_work_item( + PRT_WORK_ITEM p_rt_work_item +); + +void +odm_schedule_work_item( + PRT_WORK_ITEM p_rt_work_item +); + +boolean +odm_is_work_item_scheduled( + PRT_WORK_ITEM p_rt_work_item +); +#endif + +/* + * ODM Timer relative API. + * */ +void +ODM_delay_ms(u32 ms); + +void +ODM_delay_us(u32 us); + +void +ODM_sleep_ms(u32 ms); + +void +ODM_sleep_us(u32 us); + +void +odm_set_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer, + u32 ms_delay +); + +void +odm_initialize_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer, + void *call_back_func, + void *p_context, + const char *sz_id +); + +void +odm_cancel_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer +); + +void +odm_release_timer( + struct PHY_DM_STRUCT *p_dm, + struct timer_list *p_timer +); + +/*ODM FW relative API.*/ + + +enum hal_status +phydm_set_reg_by_fw( + struct PHY_DM_STRUCT *p_dm, + enum phydm_halmac_param config_type, + u32 offset, + u32 data, + u32 mask, + enum rf_path e_rf_path, + u32 delay_time +); + +void +odm_fill_h2c_cmd( + struct PHY_DM_STRUCT *p_dm, + u8 element_id, + u32 cmd_len, + u8 *p_cmd_buffer +); + +u8 +phydm_c2H_content_parsing( + void *p_dm_void, + u8 c2h_cmd_id, + u8 c2h_cmd_len, + u8 *tmp_buf +); + +u64 +odm_get_current_time( + struct PHY_DM_STRUCT *p_dm +); +u64 +odm_get_progressing_time( + struct PHY_DM_STRUCT *p_dm, + u64 start_time +); + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) && !defined(DM_ODM_CE_MAC80211) + +void +phydm_set_hw_reg_handler_interface ( + struct PHY_DM_STRUCT *p_dm, + u8 reg_Name, + u8 *val + ); + +void +phydm_get_hal_def_var_handler_interface ( + struct PHY_DM_STRUCT *p_dm, + enum _HAL_DEF_VARIABLE e_variable, + void *p_value + ); + +#endif + +void +odm_set_tx_power_index_by_rate_section ( + struct PHY_DM_STRUCT *p_dm, + enum rf_path path, + u8 Channel, + u8 RateSection +); + +u8 +odm_get_tx_power_index ( + struct PHY_DM_STRUCT *p_dm, + enum rf_path path, + u8 tx_rate, + u8 band_width, + u8 Channel +); + +u8 +odm_efuse_one_byte_read( + struct PHY_DM_STRUCT *p_dm, + u16 addr, + u8 *data, + boolean b_pseu_do_test +); + +void +odm_efuse_logical_map_read( + struct PHY_DM_STRUCT *p_dm, + u8 type, + u16 offset, + u32 *data +); + +enum hal_status +odm_iq_calibrate_by_fw( + struct PHY_DM_STRUCT *p_dm, + u8 clear, + u8 segment +); + +void +odm_cmn_info_ptr_array_hook( + struct PHY_DM_STRUCT *p_dm, + enum odm_cmninfo_e cmn_info, + u16 index, + void *p_value +); + +void +phydm_cmn_sta_info_hook( + struct PHY_DM_STRUCT *p_dm, + u8 index, + struct cmn_sta_info *pcmn_sta_info +); + +void +phydm_add_interrupt_mask_handler( + struct PHY_DM_STRUCT *p_dm, + u8 interrupt_type +); + +void +phydm_enable_rx_related_interrupt_handler( + struct PHY_DM_STRUCT *p_dm +); + +boolean +phydm_get_txbf_en( + struct PHY_DM_STRUCT *p_dm, + u16 mac_id, + u8 i +); + +void +phydm_iqk_wait( + struct PHY_DM_STRUCT *p_dm, + u32 timeout +); +#endif /* __ODM_INTERFACE_H__ */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_iqk.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_iqk.h deleted file mode 100644 index bb9031f27aee..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_iqk.h +++ /dev/null @@ -1,61 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMIQK_H__ -#define __PHYDMIQK_H__ - -/*--------------------------Define Parameters-------------------------------*/ -#define LOK_delay 1 -#define WBIQK_delay 10 -#define TX_IQK 0 -#define RX_IQK 1 -#define TXIQK 0 -#define RXIQK1 1 -#define RXIQK2 2 - -#define NUM 4 -/*---------------------------End Define Parameters-------------------------------*/ - -typedef struct _IQK_INFORMATION { - BOOLEAN LOK_fail[NUM]; - BOOLEAN IQK_fail[2][NUM]; - u4Byte IQC_Matrix[2][NUM]; - u1Byte IQKtimes; - u4Byte RFReg18; - u4Byte lna_idx; - u1Byte rxiqk_step; - u1Byte tmp1bcc; - - u4Byte IQK_Channel[2]; - BOOLEAN IQK_fail_report[2][4][2]; /*channel/path/TRX(TX:0, RX:1)*/ - u4Byte IQK_CFIR_real[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_real*/ - u4Byte IQK_CFIR_imag[2][4][2][8]; /*channel / path / TRX(TX:0, RX:1) / CFIR_imag*/ - u1Byte retry_count[2][4][3]; /*channel / path / (TXK:0, RXK1:1, RXK2:2)*/ - u1Byte gs_retry_count[2][4][2]; /*channel / path / (GSRXK1:0, GSRXK2:1)*/ - u1Byte RXIQK_fail_code[2][4]; /*channel / path 0:SRXK1 fail, 1:RXK1 fail 2:RXK2 fail*/ - u4Byte LOK_IDAC[2][4]; /*channel / path*/ - u4Byte RXIQK_AGC[2][4]; /*channel / path*/ - u4Byte bypassIQK[2][4]; /*channel / 0xc94/0xe94*/ - u4Byte tmp_GNTWL; - BOOLEAN is_BTG; - -} IQK_INFO, *PIQK_INFO; - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.c deleted file mode 100644 index a91cdee9b193..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.c +++ /dev/null @@ -1,191 +0,0 @@ -/****************************************************************************** - * - * 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 files*/ -/*============================================================*/ -#include "mp_precomp.h" -#include "phydm_precomp.h" - - -/* Add for KFree Feature Requested by RF David.*/ -/*This is a phydm API*/ - -VOID -phydm_SetKfreeToRF_8814A( - IN PVOID pDM_VOID, - IN u1Byte eRFPath, - IN u1Byte Data - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - BOOLEAN bOdd; - - if ((Data%2) != 0) { /*odd -> positive*/ - Data = Data - 1; - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT19, 1); - bOdd = TRUE; - } else { /*even -> negative*/ - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT19, 0); - bOdd = FALSE; - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RF_0x55[19]= %d\n", bOdd)); - switch (Data) { - case 0: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 0); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 0; - break; - case 2: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 0); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 0; - break; - case 4: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 1); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 1; - break; - case 6: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 1); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 1; - break; - case 8: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 2); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 2; - break; - case 10: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 2); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 2; - break; - case 12: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 3); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 3; - break; - case 14: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 3); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 3; - break; - case 16: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 4); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 4; - break; - case 18: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 1); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 4); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 4; - break; - case 20: - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT14, 0); - ODM_SetRFReg(pDM_Odm, eRFPath, rRF_TxGainOffset, BIT17|BIT16|BIT15, 5); - pRFCalibrateInfo->KfreeOffset[eRFPath] = 5; - break; - - default: - break; - } - - if (bOdd == FALSE) { - /*that means Kfree offset is negative, we need to record it.*/ - pRFCalibrateInfo->KfreeOffset[eRFPath] = (-1)*pRFCalibrateInfo->KfreeOffset[eRFPath]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): KfreeOffset = %d\n", pRFCalibrateInfo->KfreeOffset[eRFPath])); - } else - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): KfreeOffset = %d\n", pRFCalibrateInfo->KfreeOffset[eRFPath])); - -} - - -VOID -phydm_SetKfreeToRF( - IN PVOID pDM_VOID, - IN u1Byte eRFPath, - IN u1Byte Data - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_RTL8814A) - phydm_SetKfreeToRF_8814A(pDM_Odm, eRFPath, Data); -} - -VOID -phydm_ConfigKFree( - IN PVOID pDM_VOID, - IN u1Byte channelToSW, - IN pu1Byte kfreeTable - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - u1Byte rfpath = 0, maxRFpath = 0; - u1Byte channelIdx = 0; - - if (pDM_Odm->SupportICType & ODM_RTL8814A) - maxRFpath = 4; /*0~3*/ - else if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8192E | ODM_RTL8822B)) - maxRFpath = 2; /*0~1*/ - else - maxRFpath = 1; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("===>phy_ConfigKFree8814A()\n")); - - if (pRFCalibrateInfo->RegRfKFreeEnable == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RegRfKFreeEnable == 2, Disable\n")); - return; - } else if (pRFCalibrateInfo->RegRfKFreeEnable == 1 || pRFCalibrateInfo->RegRfKFreeEnable == 0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): RegRfKFreeEnable == TRUE\n")); - /*Make sure the targetval is defined*/ - if (((pRFCalibrateInfo->RegRfKFreeEnable == 1) && (kfreeTable[0] != 0xFF)) || (pRFCalibrateInfo->RfKFreeEnable == TRUE)) { - /*if kfreeTable[0] == 0xff, means no Kfree*/ - if (*pDM_Odm->pBandType == ODM_BAND_2_4G) { - if (channelToSW <= 14 && channelToSW >= 1) - channelIdx = PHYDM_2G; - } else if (*pDM_Odm->pBandType == ODM_BAND_5G) { - if (channelToSW >= 36 && channelToSW <= 48) - channelIdx = PHYDM_5GLB1; - if (channelToSW >= 52 && channelToSW <= 64) - channelIdx = PHYDM_5GLB2; - if (channelToSW >= 100 && channelToSW <= 120) - channelIdx = PHYDM_5GMB1; - if (channelToSW >= 124 && channelToSW <= 144) - channelIdx = PHYDM_5GMB2; - if (channelToSW >= 149 && channelToSW <= 177) - channelIdx = PHYDM_5GHB; - } - - for (rfpath = ODM_RF_PATH_A; rfpath < maxRFpath; rfpath++) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phydm_kfree(): PATH_%d: %#x\n", rfpath, kfreeTable[channelIdx*maxRFpath + rfpath])); - phydm_SetKfreeToRF(pDM_Odm, rfpath, kfreeTable[channelIdx*maxRFpath + rfpath]); - } - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("phy_ConfigKFree8814A(): targetval not defined, Don't execute KFree Process.\n")); - return; - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_MP, ODM_DBG_LOUD, ("<===phy_ConfigKFree8814A()\n")); -} - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.h deleted file mode 100644 index d95e7cb8af6d..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_kfree.h +++ /dev/null @@ -1,45 +0,0 @@ - -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMKFREE_H__ -#define __PHYDKFREE_H__ - -#define KFREE_VERSION "1.0" - -typedef enum tag_phydm_kfree_channeltosw { - PHYDM_2G = 0, - PHYDM_5GLB1 = 1, - PHYDM_5GLB2 = 2, - PHYDM_5GMB1 = 3, - PHYDM_5GMB2 = 4, - PHYDM_5GHB = 5, -} PHYDM_KFREE_CHANNELTOSW; - - -VOID -phydm_ConfigKFree( - IN PVOID pDM_VOID, - IN u1Byte channelToSW, - IN pu1Byte kfreeTable -); - - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.c new file mode 100644 index 000000000000..85e747d04107 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.c @@ -0,0 +1,171 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +const u16 db_invert_table[12][8] = { + { 1, 1, 1, 2, 2, 2, 2, 3}, + { 3, 3, 4, 4, 4, 5, 6, 6}, + { 7, 8, 9, 10, 11, 13, 14, 16}, + { 18, 20, 22, 25, 28, 32, 35, 40}, + { 45, 50, 56, 63, 71, 79, 89, 100}, + { 112, 126, 141, 158, 178, 200, 224, 251}, + { 282, 316, 355, 398, 447, 501, 562, 631}, + { 708, 794, 891, 1000, 1122, 1259, 1413, 1585}, + { 1778, 1995, 2239, 2512, 2818, 3162, 3548, 3981}, + { 4467, 5012, 5623, 6310, 7079, 7943, 8913, 10000}, + { 11220, 12589, 14125, 15849, 17783, 19953, 22387, 25119}, + { 28184, 31623, 35481, 39811, 44668, 50119, 56234, 65535} +}; + + +/*Y = 10*log(X)*/ +s32 +odm_pwdb_conversion( + s32 X, + u32 total_bit, + u32 decimal_bit +) +{ + s32 Y, integer = 0, decimal = 0; + u32 i; + + if (X == 0) + X = 1; /* log2(x), x can't be 0 */ + + for (i = (total_bit - 1); i > 0; i--) { + if (X & BIT(i)) { + integer = i; + if (i > 0) + decimal = (X & BIT(i - 1)) ? 2 : 0; /* decimal is 0.5dB*3=1.5dB~=2dB */ + break; + } + } + + Y = 3 * (integer - decimal_bit) + decimal; /* 10*log(x)=3*log2(x), */ + + return Y; +} + +s32 +odm_sign_conversion( + s32 value, + u32 total_bit +) +{ + if (value & BIT(total_bit - 1)) + value -= BIT(total_bit); + + return value; +} + +void +phydm_seq_sorting( + void *p_dm_void, + u32 *p_value, + u32 *rank_idx, + u32 *p_idx_out, + u8 seq_length +) +{ + u8 i = 0, j = 0; + u32 tmp_a, tmp_b; + u32 tmp_idx_a, tmp_idx_b; + + for (i = 0; i < seq_length; i++) { + rank_idx[i] = i; + /**/ + } + + for (i = 0; i < (seq_length - 1); i++) { + + for (j = 0; j < (seq_length - 1 - i); j++) { + + tmp_a = p_value[j]; + tmp_b = p_value[j + 1]; + + tmp_idx_a = rank_idx[j]; + tmp_idx_b = rank_idx[j + 1]; + + if (tmp_a < tmp_b) { + p_value[j] = tmp_b; + p_value[j + 1] = tmp_a; + + rank_idx[j] = tmp_idx_b; + rank_idx[j + 1] = tmp_idx_a; + } + } + } + + for (i = 0; i < seq_length; i++) { + p_idx_out[rank_idx[i]] = i + 1; + /**/ + } +} + +u32 +odm_convert_to_db( + u32 value) +{ + u8 i; + u8 j; + u32 dB; + + value = value & 0xFFFF; + + for (i = 0; i < 12; i++) { + if (value <= db_invert_table[i][7]) + break; + } + + if (i >= 12) { + return 96; /* maximum 96 dB */ + } + + for (j = 0; j < 8; j++) { + if (value <= db_invert_table[i][j]) + break; + } + + dB = (i << 3) + j + 1; + + return dB; +} + +u32 +odm_convert_to_linear( + u32 value) +{ + u8 i; + u8 j; + u32 linear; + + /* 1dB~96dB */ + + value = value & 0xFF; + + i = (u8)((value - 1) >> 3); + j = (u8)(value - 1) - (i << 3); + + linear = db_invert_table[i][j]; + + return linear; +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.h new file mode 100644 index 000000000000..a8fb77368481 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_math_lib.h @@ -0,0 +1,77 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDM_MATH_LIB_H__ +#define __PHYDM_MATH_LIB_H__ + +#define AUTO_MATH_LIB_VERSION "1.0" /* 2017.06.06*/ + + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + + + + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + + + +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + + +/* 1 ============================================================ + * 1 function prototype + * 1 ============================================================ */ + +s32 +odm_pwdb_conversion( + s32 X, + u32 total_bit, + u32 decimal_bit +); + +s32 +odm_sign_conversion( + s32 value, + u32 total_bit +); + +void +phydm_seq_sorting( + void *p_dm_void, + u32 *p_value, + u32 *rank_idx, + u32 *p_idx_out, + u8 seq_length +); + +u32 +odm_convert_to_db( + u32 value +); + +u32 +odm_convert_to_linear( + u32 value +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.c index f9fd923ee736..6f62dd7c9ccc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.c @@ -1,305 +1,417 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" -#include "phydm_noisemonitor.h" - -//================================================= -// This function is for inband noise test utility only -// To obtain the inband noise level(dbm), do the following. -// 1. disable DIG and Power Saving -// 2. Set initial gain = 0x1a -// 3. Stop updating idle time pwer report (for driver read) -// - 0x80c[25] -// -//================================================= - -#define Valid_Min -35 -#define Valid_Max 10 -#define ValidCnt 5 - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_WIN)) - -s2Byte odm_InbandNoise_Monitor_NSeries(PDM_ODM_T pDM_Odm,u8 bPauseDIG,u8 IGIValue,u32 max_time) -{ - u4Byte tmp4b; - u1Byte max_rf_path=0,rf_path; - u1Byte reg_c50, reg_c58,valid_done=0; - struct noise_level noise_data; - u8Byte start = 0, func_start = 0, func_end = 0; - - func_start = ODM_GetCurrentTime(pDM_Odm); - pDM_Odm->noise_level.noise_all = 0; - - if((pDM_Odm->RFType == ODM_1T2R) ||(pDM_Odm->RFType == ODM_2T2R)) - max_rf_path = 2; - else - max_rf_path = 1; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("odm_DebugControlInbandNoise_Nseries() ==> \n")); - - ODM_Memory_Set(pDM_Odm,&noise_data,0,sizeof(struct noise_level)); - - // - // Step 1. Disable DIG && Set initial gain. - // - - if(bPauseDIG) - { - odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); - } - // - // Step 2. Disable all power save for read registers - // - //dcmd_DebugControlPowerSave(pAdapter, PSDisable); - - // - // Step 3. Get noise power level - // - start = ODM_GetCurrentTime(pDM_Odm); - while(1) - { - - //Stop updating idle time pwer report (for driver read) - ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 1); - - //Read Noise Floor Report - tmp4b = ODM_GetBBReg(pDM_Odm, 0x8f8,bMaskDWord ); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Noise Floor Report (0x8f8) = 0x%08x\n", tmp4b)); - - //ODM_SetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0, TestInitialGain); - //if(max_rf_path == 2) - // ODM_SetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0, TestInitialGain); - - //update idle time pwer report per 5us - ODM_SetBBReg(pDM_Odm, rFPGA0_TxGainStage, BIT25, 0); - - noise_data.value[ODM_RF_PATH_A] = (u1Byte)(tmp4b&0xff); - noise_data.value[ODM_RF_PATH_B] = (u1Byte)((tmp4b&0xff00)>>8); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD, ("value_a = 0x%x(%d), value_b = 0x%x(%d)\n", - noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_A], noise_data.value[ODM_RF_PATH_B], noise_data.value[ODM_RF_PATH_B])); - - for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) - { - noise_data.sval[rf_path] = (s1Byte)noise_data.value[rf_path]; - noise_data.sval[rf_path] /= 2; - } - - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("sval_a = %d, sval_b = %d\n", - noise_data.sval[ODM_RF_PATH_A], noise_data.sval[ODM_RF_PATH_B])); - //ODM_delay_ms(10); - //ODM_sleep_ms(10); - - for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) - { - if( (noise_data.valid_cnt[rf_path] < ValidCnt) && (noise_data.sval[rf_path] < Valid_Max && noise_data.sval[rf_path] >= Valid_Min)) - { - noise_data.valid_cnt[rf_path]++; - noise_data.sum[rf_path] += noise_data.sval[rf_path]; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("RF_Path:%d Valid sval = %d\n", rf_path,noise_data.sval[rf_path])); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("Sum of sval = %d, \n", noise_data.sum[rf_path])); - if(noise_data.valid_cnt[rf_path] == ValidCnt) - { - valid_done++; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("After divided, RF_Path:%d ,sum = %d \n", rf_path,noise_data.sum[rf_path])); - } - - } - - } - - //printk("####### valid_done:%d #############\n",valid_done); - if ((valid_done==max_rf_path) || (ODM_GetProgressingTime(pDM_Odm,start) > max_time)) - { - for(rf_path = ODM_RF_PATH_A; rf_path < max_rf_path; rf_path++) - { - //printk("%s PATH_%d - sum = %d, valid_cnt = %d \n",__FUNCTION__,rf_path,noise_data.sum[rf_path], noise_data.valid_cnt[rf_path]); - if(noise_data.valid_cnt[rf_path]) - noise_data.sum[rf_path] /= noise_data.valid_cnt[rf_path]; - else - noise_data.sum[rf_path] = 0; - } - break; - } - } - reg_c50 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0); - reg_c50 &= ~BIT7; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XAAGCCore1, reg_c50, reg_c50)); - pDM_Odm->noise_level.noise[ODM_RF_PATH_A] = (u1Byte)(-110 + reg_c50 + noise_data.sum[ODM_RF_PATH_A]); - pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_A]; - - if(max_rf_path == 2){ - reg_c58 = (u1Byte)ODM_GetBBReg(pDM_Odm, rOFDM0_XBAGCCore1, bMaskByte0); - reg_c58 &= ~BIT7; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("0x%x = 0x%02x(%d)\n", rOFDM0_XBAGCCore1, reg_c58, reg_c58)); - pDM_Odm->noise_level.noise[ODM_RF_PATH_B] = (u1Byte)(-110 + reg_c58 + noise_data.sum[ODM_RF_PATH_B]); - pDM_Odm->noise_level.noise_all += pDM_Odm->noise_level.noise[ODM_RF_PATH_B]; - } - pDM_Odm->noise_level.noise_all /= max_rf_path; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_COMMON, ODM_DBG_LOUD,("noise_a = %d, noise_b = %d\n", - pDM_Odm->noise_level.noise[ODM_RF_PATH_A], - pDM_Odm->noise_level.noise[ODM_RF_PATH_B])); - - // - // Step 4. Recover the Dig - // - if(bPauseDIG) - { - odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); - } - func_end = ODM_GetProgressingTime(pDM_Odm,func_start) ; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_DebugControlInbandNoise_Nseries() <==\n")); - return pDM_Odm->noise_level.noise_all; - -} - -s2Byte -odm_InbandNoise_Monitor_ACSeries(PDM_ODM_T pDM_Odm, u8 bPauseDIG, u8 IGIValue, u32 max_time - ) -{ - s4Byte rxi_buf_anta, rxq_buf_anta; /*rxi_buf_antb, rxq_buf_antb;*/ - s4Byte value32, pwdb_A = 0, sval, noise, sum; - BOOLEAN pd_flag; - u1Byte i, valid_cnt; - u8Byte start = 0, func_start = 0, func_end = 0; - - - if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A))) - return 0; - - func_start = ODM_GetCurrentTime(pDM_Odm); - pDM_Odm->noise_level.noise_all = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() ==>\n")); - - /* Step 1. Disable DIG && Set initial gain. */ - if (bPauseDIG) - odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, IGIValue); - - /* Step 2. Disable all power save for read registers */ - /*dcmd_DebugControlPowerSave(pAdapter, PSDisable); */ - - /* Step 3. Get noise power level */ - start = ODM_GetCurrentTime(pDM_Odm); - - /* reset counters */ - sum = 0; - valid_cnt = 0; - - /* Step 3. Get noise power level */ - while (1) { - /*Set IGI=0x1C */ - ODM_Write_DIG(pDM_Odm, 0x1C); - /*stop CK320&CK88 */ - ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 1); - /*Read Path-A */ - ODM_SetBBReg(pDM_Odm, 0x8FC, bMaskDWord, 0x200); /*set debug port*/ - value32 = ODM_GetBBReg(pDM_Odm, 0xFA0, bMaskDWord); /*read debug port*/ - - rxi_buf_anta = (value32 & 0xFFC00) >> 10; /*rxi_buf_anta=RegFA0[19:10]*/ - rxq_buf_anta = value32 & 0x3FF; /*rxq_buf_anta=RegFA0[19:10]*/ - - pd_flag = (BOOLEAN) ((value32 & BIT31) >> 31); - - /*Not in packet detection period or Tx state */ - if ((!pd_flag) || (rxi_buf_anta != 0x200)) { - /*sign conversion*/ - rxi_buf_anta = ODM_SignConversion(rxi_buf_anta, 10); - rxq_buf_anta = ODM_SignConversion(rxq_buf_anta, 10); - - pwdb_A = ODM_PWdB_Conversion(rxi_buf_anta * rxi_buf_anta + rxq_buf_anta * rxq_buf_anta, 20, 18); /*S(10,9)*S(10,9)=S(20,18)*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("pwdb_A= %d dB, rxi_buf_anta= 0x%x, rxq_buf_anta= 0x%x\n", pwdb_A, rxi_buf_anta & 0x3FF, rxq_buf_anta & 0x3FF)); - } - /*Start CK320&CK88*/ - ODM_SetBBReg(pDM_Odm, 0x8B4, BIT6, 0); - /*BB Reset*/ - ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) & (~BIT0)); - ODM_Write1Byte(pDM_Odm, 0x02, ODM_Read1Byte(pDM_Odm, 0x02) | BIT0); - /*PMAC Reset*/ - ODM_Write1Byte(pDM_Odm, 0xB03, ODM_Read1Byte(pDM_Odm, 0xB03) & (~BIT0)); - ODM_Write1Byte(pDM_Odm, 0xB03, ODM_Read1Byte(pDM_Odm, 0xB03) | BIT0); - /*CCK Reset*/ - if (ODM_Read1Byte(pDM_Odm, 0x80B) & BIT4) { - ODM_Write1Byte(pDM_Odm, 0x80B, ODM_Read1Byte(pDM_Odm, 0x80B) & (~BIT4)); - ODM_Write1Byte(pDM_Odm, 0x80B, ODM_Read1Byte(pDM_Odm, 0x80B) | BIT4); - } - - sval = pwdb_A; - - if (sval < 0 && sval >= -27) { - if (valid_cnt < ValidCnt) { - valid_cnt++; - sum += sval; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Valid sval = %d\n", sval)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("Sum of sval = %d,\n", sum)); - if ((valid_cnt >= ValidCnt) || (ODM_GetProgressingTime(pDM_Odm, start) > max_time)) { - sum /= valid_cnt; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("After divided, sum = %d\n", sum)); - break; - } - } - } - } - - /*ADC backoff is 12dB,*/ - /*Ptarget=0x1C-110=-82dBm*/ - noise = sum + 12 + 0x1C - 110; - - /*Offset*/ - noise = noise - 3; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("noise = %d\n", noise)); - pDM_Odm->noise_level.noise_all = (s2Byte)noise; - - /* Step 4. Recover the Dig*/ - if (bPauseDIG) - odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, IGIValue); - - func_end = ODM_GetProgressingTime(pDM_Odm, func_start); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("odm_InbandNoise_Monitor_ACSeries() <==\n")); - - return pDM_Odm->noise_level.noise_all; -} - - - -s2Byte -ODM_InbandNoise_Monitor(PVOID pDM_VOID, u8 bPauseDIG, u8 IGIValue, u32 max_time) -{ - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if (pDM_Odm->SupportICType & ODM_IC_11AC_SERIES) - return odm_InbandNoise_Monitor_ACSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); - else - return odm_InbandNoise_Monitor_NSeries(pDM_Odm, bPauseDIG, IGIValue, max_time); -} - -#endif - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +/* ************************************************* + * This function is for inband noise test utility only + * To obtain the inband noise level(dbm), do the following. + * 1. disable DIG and Power Saving + * 2. Set initial gain = 0x1a + * 3. Stop updating idle time pwer report (for driver read) + * - 0x80c[25] + * + * ************************************************* */ + +#define VALID_CNT 5 + +void phydm_set_noise_data_sum(struct noise_level *noise_data, u8 max_rf_path) +{ + u8 rf_path; + + for (rf_path = RF_PATH_A; rf_path < max_rf_path; rf_path++) { + if (noise_data->valid_cnt[rf_path]) + noise_data->sum[rf_path] /= noise_data->valid_cnt[rf_path]; + else + noise_data->sum[rf_path] = 0; + } +} + +s16 odm_inband_noise_monitor_n_series(struct PHY_DM_STRUCT *p_dm, u8 is_pause_dig, u8 igi_value, u32 max_time) +{ + u32 tmp4b; + u8 max_rf_path = 0, rf_path; + u8 reg_c50, reg_c58, valid_done = 0; + struct noise_level noise_data; + u64 start = 0, func_start = 0, func_end = 0; + + func_start = odm_get_current_time(p_dm); + p_dm->noise_level.noise_all = 0; + + if ((p_dm->rf_type == RF_1T2R) || (p_dm->rf_type == RF_2T2R)) + max_rf_path = 2; + else + max_rf_path = 1; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("odm_DebugControlInbandNoise_Nseries() ==>\n")); + + odm_memory_set(p_dm, &noise_data, 0, sizeof(struct noise_level)); + /* step 1. Disable DIG && Set initial gain. */ + + if (is_pause_dig) + odm_pause_dig(p_dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi_value); + + /* step 3. Get noise power level */ + start = odm_get_current_time(p_dm); + while (1) { + + /* Stop updating idle time pwer report (for driver read) */ + odm_set_bb_reg(p_dm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 1); + + /* Read Noise Floor Report */ + tmp4b = odm_get_bb_reg(p_dm, 0x8f8, MASKDWORD); + + /* update idle time pwer report per 5us */ + odm_set_bb_reg(p_dm, REG_FPGA0_TX_GAIN_STAGE, BIT(25), 0); + + ODM_delay_us(5); + + noise_data.value[RF_PATH_A] = (u8)(tmp4b & 0xff); + noise_data.value[RF_PATH_B] = (u8)((tmp4b & 0xff00) >> 8); + + for (rf_path = RF_PATH_A; rf_path < max_rf_path; rf_path++) { + noise_data.sval[rf_path] = (s8)noise_data.value[rf_path]; + noise_data.sval[rf_path] /= 2; + } + + for (rf_path = RF_PATH_A; rf_path < max_rf_path; rf_path++) { + if (noise_data.valid_cnt[rf_path] < VALID_CNT) { + noise_data.valid_cnt[rf_path]++; + noise_data.sum[rf_path] += noise_data.sval[rf_path]; + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("rf_path:%d Valid sval = %d\n", rf_path, noise_data.sval[rf_path])); + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Sum of sval = %d,\n", noise_data.sum[rf_path])); + if (noise_data.valid_cnt[rf_path] == VALID_CNT) + valid_done++; + } + } + if ((valid_done == max_rf_path) || (odm_get_progressing_time(p_dm, start) > max_time)) { + phydm_set_noise_data_sum(&noise_data, max_rf_path); + break; + } + } + reg_c50 = (u8)odm_get_bb_reg(p_dm, REG_OFDM_0_XA_AGC_CORE1, MASKBYTE0); + reg_c50 &= ~BIT(7); + p_dm->noise_level.noise[RF_PATH_A] = (s8)(-110 + reg_c50 + noise_data.sum[RF_PATH_A]); + p_dm->noise_level.noise_all += p_dm->noise_level.noise[RF_PATH_A]; + + if (max_rf_path == 2) { + reg_c58 = (u8)odm_get_bb_reg(p_dm, REG_OFDM_0_XB_AGC_CORE1, MASKBYTE0); + reg_c58 &= ~BIT(7); + p_dm->noise_level.noise[RF_PATH_B] = (s8)(-110 + reg_c58 + noise_data.sum[RF_PATH_B]); + p_dm->noise_level.noise_all += p_dm->noise_level.noise[RF_PATH_B]; + } + p_dm->noise_level.noise_all /= max_rf_path; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("noise_a = %d, noise_b = %d, noise_all = %d\n", + p_dm->noise_level.noise[RF_PATH_A], p_dm->noise_level.noise[RF_PATH_B], + p_dm->noise_level.noise_all)); + + /* step 4. Recover the Dig */ + if (is_pause_dig) + odm_pause_dig(p_dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi_value); + func_end = odm_get_progressing_time(p_dm, func_start); + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("end\n")); + return p_dm->noise_level.noise_all; + +} + + +s16 +phydm_idle_noise_measurement_ac( + struct PHY_DM_STRUCT *p_dm, + u8 is_pause_dig, + u8 igi_value, + u32 max_time + ) +{ + u32 tmp4b; + u8 max_rf_path = 0, rf_path; + u8 reg_c50, reg_e50, valid_done = 0; + u64 start = 0, func_start = 0, func_end = 0; + struct noise_level noise_data; + + func_start = odm_get_current_time(p_dm); + p_dm->noise_level.noise_all = 0; + + if ((p_dm->rf_type == RF_1T2R) || (p_dm->rf_type == RF_2T2R)) + max_rf_path = 2; + else + max_rf_path = 1; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("phydm_idle_noise_measurement_ac==>\n")); + + odm_memory_set(p_dm, &noise_data, 0, sizeof(struct noise_level)); + + /*Step 1. Disable DIG && Set initial gain.*/ + + if (is_pause_dig) + odm_pause_dig(p_dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi_value); + + /*Step 2. Get noise power level*/ + start = odm_get_current_time(p_dm); + + while (1) { + + /*Stop updating idle time pwer report (for driver read)*/ + odm_set_bb_reg(p_dm, 0x9e4, BIT(30), 0x1); + + /*Read Noise Floor Report*/ + tmp4b = odm_get_bb_reg(p_dm, 0xff0, MASKDWORD); + + /*update idle time pwer report per 5us*/ + odm_set_bb_reg(p_dm, 0x9e4, BIT(30), 0x0); + + ODM_delay_us(5); + + noise_data.value[RF_PATH_A] = (u8)(tmp4b & 0xff); + noise_data.value[RF_PATH_B] = (u8)((tmp4b & 0xff00) >> 8); + + for (rf_path = RF_PATH_A; rf_path < max_rf_path; rf_path++) { + noise_data.sval[rf_path] = (s8)noise_data.value[rf_path]; + noise_data.sval[rf_path] = noise_data.sval[rf_path] >> 1; + } + + for (rf_path = RF_PATH_A; rf_path < max_rf_path; rf_path++) { + if (noise_data.valid_cnt[rf_path] < VALID_CNT) { + noise_data.valid_cnt[rf_path]++; + noise_data.sum[rf_path] += noise_data.sval[rf_path]; + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Path:%d Valid sval = %d\n", rf_path, noise_data.sval[rf_path])); + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Sum of sval = %d\n", noise_data.sum[rf_path])); + if (noise_data.valid_cnt[rf_path] == VALID_CNT) + valid_done++; + } + } + + if ((valid_done == max_rf_path) || (odm_get_progressing_time(p_dm, start) > max_time)) { + phydm_set_noise_data_sum(&noise_data, max_rf_path); + break; + } + } + reg_c50 = (u8)odm_get_bb_reg(p_dm, 0xc50, MASKBYTE0); + reg_c50 &= ~BIT(7); + p_dm->noise_level.noise[RF_PATH_A] = (s8)(-110 + reg_c50 + noise_data.sum[RF_PATH_A]); + p_dm->noise_level.noise_all += p_dm->noise_level.noise[RF_PATH_A]; + + if (max_rf_path == 2) { + reg_e50 = (u8)odm_get_bb_reg(p_dm, 0xe50, MASKBYTE0); + reg_e50 &= ~BIT(7); + p_dm->noise_level.noise[RF_PATH_B] = (s8)(-110 + reg_e50 + noise_data.sum[RF_PATH_B]); + p_dm->noise_level.noise_all += p_dm->noise_level.noise[RF_PATH_B]; + } + p_dm->noise_level.noise_all /= max_rf_path; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("noise_a = %d, noise_b = %d, noise_all = %d\n", + p_dm->noise_level.noise[RF_PATH_A], p_dm->noise_level.noise[RF_PATH_B], + p_dm->noise_level.noise_all)); + + /*Step 3. Recover the Dig*/ + if (is_pause_dig) + odm_pause_dig(p_dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi_value); + func_end = odm_get_progressing_time(p_dm, func_start); + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("end\n")); + return p_dm->noise_level.noise_all; + +} + + +s16 +odm_inband_noise_monitor_ac_series( + struct PHY_DM_STRUCT *p_dm, + u8 is_pause_dig, + u8 igi_value, + u32 max_time + ) +{ + s32 rxi_buf_anta, rxq_buf_anta; /*rxi_buf_antb, rxq_buf_antb;*/ + s32 value32, pwdb_A = 0, sval, noise, sum = 0; + boolean pd_flag; + u8 valid_cnt = 0; + u64 start = 0, func_start = 0, func_end = 0; + + if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8821C)) + return phydm_idle_noise_measurement_ac(p_dm, is_pause_dig, igi_value, max_time); + + if (!(p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A))) + return 0; + + func_start = odm_get_current_time(p_dm); + p_dm->noise_level.noise_all = 0; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("odm_inband_noise_monitor_ac_series() ==>\n")); + + /* step 1. Disable DIG && Set initial gain. */ + if (is_pause_dig) + odm_pause_dig(p_dm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, igi_value); + + /* step 3. Get noise power level */ + start = odm_get_current_time(p_dm); + + /* step 3. Get noise power level */ + while (1) { + /*Set IGI=0x1C */ + odm_write_dig(p_dm, 0x1C); + /*stop CK320&CK88 */ + odm_set_bb_reg(p_dm, 0x8B4, BIT(6), 1); + /*Read path-A */ + odm_set_bb_reg(p_dm, 0x8FC, MASKDWORD, 0x200); /*set debug port*/ + value32 = odm_get_bb_reg(p_dm, 0xFA0, MASKDWORD); /*read debug port*/ + + rxi_buf_anta = (value32 & 0xFFC00) >> 10; /*rxi_buf_anta=RegFA0[19:10]*/ + rxq_buf_anta = value32 & 0x3FF; /*rxq_buf_anta=RegFA0[19:10]*/ + + pd_flag = (boolean)((value32 & BIT(31)) >> 31); + + /*Not in packet detection period or Tx state */ + if ((!pd_flag) || (rxi_buf_anta != 0x200)) { + /*sign conversion*/ + rxi_buf_anta = odm_sign_conversion(rxi_buf_anta, 10); + rxq_buf_anta = odm_sign_conversion(rxq_buf_anta, 10); + + pwdb_A = odm_pwdb_conversion(rxi_buf_anta * rxi_buf_anta + rxq_buf_anta * rxq_buf_anta, 20, 18); /*S(10,9)*S(10,9)=S(20,18)*/ + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("pwdb_A= %d dB, rxi_buf_anta= 0x%x, rxq_buf_anta= 0x%x\n", pwdb_A, rxi_buf_anta & 0x3FF, rxq_buf_anta & 0x3FF)); + } + /*Start CK320&CK88*/ + odm_set_bb_reg(p_dm, 0x8B4, BIT(6), 0); + /*BB Reset*/ + odm_write_1byte(p_dm, 0x02, odm_read_1byte(p_dm, 0x02) & (~BIT(0))); + odm_write_1byte(p_dm, 0x02, odm_read_1byte(p_dm, 0x02) | BIT(0)); + /*PMAC Reset*/ + odm_write_1byte(p_dm, 0xB03, odm_read_1byte(p_dm, 0xB03) & (~BIT(0))); + odm_write_1byte(p_dm, 0xB03, odm_read_1byte(p_dm, 0xB03) | BIT(0)); + /*CCK Reset*/ + if (odm_read_1byte(p_dm, 0x80B) & BIT(4)) { + odm_write_1byte(p_dm, 0x80B, odm_read_1byte(p_dm, 0x80B) & (~BIT(4))); + odm_write_1byte(p_dm, 0x80B, odm_read_1byte(p_dm, 0x80B) | BIT(4)); + } + + sval = pwdb_A; + + if ((sval < 0 && sval >= -27) && (valid_cnt < VALID_CNT)){ + valid_cnt++; + sum += sval; + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Valid sval = %d\n", sval)); + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("Sum of sval = %d,\n", sum)); + if ((valid_cnt >= VALID_CNT) || (odm_get_progressing_time(p_dm, start) > max_time)) { + sum /= VALID_CNT; + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("After divided, sum = %d\n", sum)); + break; + } + } + } + + /*ADC backoff is 12dB,*/ + /*Ptarget=0x1C-110=-82dBm*/ + noise = sum + 12 + 0x1C - 110; + + /*Offset*/ + noise = noise - 3; + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("noise = %d\n", noise)); + p_dm->noise_level.noise_all = (s16)noise; + + /* step 4. Recover the Dig*/ + if (is_pause_dig) + odm_pause_dig(p_dm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, igi_value); + + func_end = odm_get_progressing_time(p_dm, func_start); + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, ("odm_inband_noise_monitor_ac_series() <==\n")); + + return p_dm->noise_level.noise_all; +} + + + +s16 +odm_inband_noise_monitor( + void *p_dm_void, + u8 is_pause_dig, + u8 igi_value, + u32 max_time + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + igi_value = 0x32; /*since HW ability is about +15~-35, we fix IGI = -60 for maximum coverage*/ + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) + return odm_inband_noise_monitor_ac_series(p_dm, is_pause_dig, igi_value, max_time); + else + return odm_inband_noise_monitor_n_series(p_dm, is_pause_dig, igi_value, max_time); +} + +void +phydm_noisy_detection( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 total_fa_cnt, total_cca_cnt; + u32 score = 0, i, score_smooth; + + total_cca_cnt = p_dm->false_alm_cnt.cnt_cca_all; + total_fa_cnt = p_dm->false_alm_cnt.cnt_all; + +#if 0 + if (total_fa_cnt * 16 >= total_cca_cnt * 14) /* 87.5 */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 12) /* 75 */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 10) /* 56.25 */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 8) /* 50 */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 7) /* 43.75 */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 6) /* 37.5 */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 5) /* 31.25% */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 4) /* 25% */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 3) /* 18.75% */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 2) /* 12.5% */ + ; + else if (total_fa_cnt * 16 >= total_cca_cnt * 1) /* 6.25% */ + ; +#endif + for (i = 0; i <= 16; i++) { + if (total_fa_cnt * 16 >= total_cca_cnt * (16 - i)) { + score = 16 - i; + break; + } + } + + /* noisy_decision_smooth = noisy_decision_smooth>>1 + (score<<3)>>1; */ + p_dm->noisy_decision_smooth = (p_dm->noisy_decision_smooth >> 1) + (score << 2); + + /* Round the noisy_decision_smooth: +"3" comes from (2^3)/2-1 */ + score_smooth = (total_cca_cnt >= 300) ? ((p_dm->noisy_decision_smooth + 3) >> 3) : 0; + + p_dm->noisy_decision = (score_smooth >= 3) ? 1 : 0; + + PHYDM_DBG(p_dm, DBG_ENV_MNTR, + ("[NoisyDetection] CCA_cnt=%d,FA_cnt=%d, noisy_dec_smooth=%d, score=%d, score_smooth=%d, noisy_dec=%d\n", + total_cca_cnt, total_fa_cnt, p_dm->noisy_decision_smooth, score, score_smooth, p_dm->noisy_decision)); + +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.h index 6625be61633a..97a745fb49dc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_noisemonitor.h @@ -1,49 +1,45 @@ -/****************************************************************************** - * - * 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 - * - * - *****************************************************************************/ -#ifndef __ODMNOISEMONITOR_H__ -#define __ODMNOISEMONITOR_H__ - -#define ODM_MAX_CHANNEL_NUM 38//14+24 -struct noise_level -{ - //u1Byte value_a, value_b; - u1Byte value[MAX_RF_PATH]; - //s1Byte sval_a, sval_b; - s1Byte sval[MAX_RF_PATH]; - - //s4Byte noise_a=0, noise_b=0,sum_a=0, sum_b=0; - //s4Byte noise[ODM_RF_PATH_MAX]; - s4Byte sum[MAX_RF_PATH]; - //u1Byte valid_cnt_a=0, valid_cnt_b=0, - u1Byte valid[MAX_RF_PATH]; - u1Byte valid_cnt[MAX_RF_PATH]; - -}; - - -typedef struct _ODM_NOISE_MONITOR_ -{ - s1Byte noise[MAX_RF_PATH]; - s2Byte noise_all; -}ODM_NOISE_MONITOR; - -s2Byte ODM_InbandNoise_Monitor(PVOID pDM_VOID,u8 bPauseDIG,u8 IGIValue,u32 max_time); - -#endif +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __ODMNOISEMONITOR_H__ +#define __ODMNOISEMONITOR_H__ + +#define ODM_MAX_CHANNEL_NUM 38/* 14+24 */ +struct noise_level { + u8 value[PHYDM_MAX_RF_PATH]; + s8 sval[PHYDM_MAX_RF_PATH]; + s32 sum[PHYDM_MAX_RF_PATH]; + u8 valid[PHYDM_MAX_RF_PATH]; + u8 valid_cnt[PHYDM_MAX_RF_PATH]; +}; + + +struct _ODM_NOISE_MONITOR_ { + s8 noise[PHYDM_MAX_RF_PATH]; + s16 noise_all; +}; + +s16 odm_inband_noise_monitor( + void *p_dm_void, + u8 is_pause_dig, + u8 igi_value, + u32 max_time +); + +void +phydm_noisy_detection( + void *p_dm_void +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.c index 0ddeba391a64..72e4bcb51512 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.c @@ -1,810 +1,692 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if(defined(CONFIG_PATH_DIVERSITY)) -#if RTL8814A_SUPPORT - -VOID -phydm_dtp_fix_tx_path( - IN PVOID pDM_VOID, - IN u1Byte path - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; - u1Byte i,num_enable_path=0; - - if(path==pDM_PathDiv->pre_tx_path) - { - return; - } - else - { - pDM_PathDiv->pre_tx_path=path; - } - - ODM_SetBBReg( pDM_Odm, 0x93c, BIT18|BIT19, 3); - - for(i=0; i<4; i++) - { - if(path&BIT(i)) - num_enable_path++; - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Number of trun-on path : (( %d ))\n", num_enable_path)); - - if(num_enable_path == 1) - { - ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); - - if(path==PHYDM_A)//1-1 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A ))\n")); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); - } - else if(path==PHYDM_B)//1-2 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B ))\n")); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); - } - else if(path==PHYDM_C)//1-3 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C ))\n")); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); - - } - else if(path==PHYDM_D)//1-4 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( D ))\n")); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 0); - } - - } - else if(num_enable_path == 2) - { - ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); - ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); - - if(path==PHYDM_AB)//2-1 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); - } - else if(path==PHYDM_AC)//2-2 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); - } - else if(path==PHYDM_AD)//2-3 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A D ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); - } - else if(path==PHYDM_BC)//2-4 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); - } - else if(path==PHYDM_BD)//2-5 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B D ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); - } - else if(path==PHYDM_CD)//2-6 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( C D ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 1); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 1); - } - - } - else if(num_enable_path == 3) - { - ODM_SetBBReg( pDM_Odm, 0x93c, 0xf00000, path); - ODM_SetBBReg( pDM_Odm, 0x940, 0xf0, path); - ODM_SetBBReg( pDM_Odm, 0x940, 0xf0000, path); - - if(path==PHYDM_ABC)//3-1 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B C))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 2); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 2); - //set for 3ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 2); - } - else if(path==PHYDM_ABD)//3-2 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A B D ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 1); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); - //set for 3ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); - - } - else if(path==PHYDM_ACD)//3-3 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( A C D ))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT25|BIT24, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT9|BIT8, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); - //set for 3ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT21|BIT20, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); - } - else if(path==PHYDM_BCD)//3-4 - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path (( B C D))\n")); - //set for 1ss - ODM_SetBBReg( pDM_Odm, 0x93c, BIT27|BIT26, 0); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT29|BIT28, 1); - ODM_SetBBReg( pDM_Odm, 0x93c, BIT31|BIT30, 2); - //set for 2ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT11|BIT10, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT13|BIT12, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT15|BIT14, 2); - //set for 3ss - ODM_SetBBReg( pDM_Odm, 0x940, BIT23|BIT22, 0); - ODM_SetBBReg( pDM_Odm, 0x940, BIT25|BIT24, 1); - ODM_SetBBReg( pDM_Odm, 0x940, BIT27|BIT26, 2); - } - } - else if(num_enable_path == 4) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" Trun on path ((A B C D))\n")); - } - -} - -VOID -phydm_find_default_path( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; - u4Byte rssi_avg_a=0, rssi_avg_b=0, rssi_avg_c=0, rssi_avg_d=0, rssi_avg_bcd=0; - u4Byte rssi_total_a=0, rssi_total_b=0, rssi_total_c=0, rssi_total_d=0; - - //2 Default Path Selection By RSSI - - rssi_avg_a = (pDM_PathDiv->path_a_cnt_all > 0)? (pDM_PathDiv->path_a_sum_all / pDM_PathDiv->path_a_cnt_all) :0 ; - rssi_avg_b = (pDM_PathDiv->path_b_cnt_all > 0)? (pDM_PathDiv->path_b_sum_all / pDM_PathDiv->path_b_cnt_all) :0 ; - rssi_avg_c = (pDM_PathDiv->path_c_cnt_all > 0)? (pDM_PathDiv->path_c_sum_all / pDM_PathDiv->path_c_cnt_all) :0 ; - rssi_avg_d = (pDM_PathDiv->path_d_cnt_all > 0)? (pDM_PathDiv->path_d_sum_all / pDM_PathDiv->path_d_cnt_all) :0 ; - - - pDM_PathDiv->path_a_sum_all = 0; - pDM_PathDiv->path_a_cnt_all = 0; - pDM_PathDiv->path_b_sum_all = 0; - pDM_PathDiv->path_b_cnt_all = 0; - pDM_PathDiv->path_c_sum_all = 0; - pDM_PathDiv->path_c_cnt_all = 0; - pDM_PathDiv->path_d_sum_all = 0; - pDM_PathDiv->path_d_cnt_all = 0; - - if(pDM_PathDiv->use_path_a_as_default_ant == 1) - { - rssi_avg_bcd=(rssi_avg_b+rssi_avg_c+rssi_avg_d)/3; - - if( (rssi_avg_a + ANT_DECT_RSSI_TH) > rssi_avg_bcd ) - { - pDM_PathDiv->is_pathA_exist=TRUE; - pDM_PathDiv->default_path=PATH_A; - } - else - { - pDM_PathDiv->is_pathA_exist=FALSE; - } - } - else - { - if( (rssi_avg_a >=rssi_avg_b) && (rssi_avg_a >=rssi_avg_c)&&(rssi_avg_a >=rssi_avg_d)) - pDM_PathDiv->default_path=PATH_A; - else if( (rssi_avg_b >=rssi_avg_c)&&(rssi_avg_b >=rssi_avg_d)) - pDM_PathDiv->default_path=PATH_B; - else if( rssi_avg_c >=rssi_avg_d) - pDM_PathDiv->default_path=PATH_C; - else - pDM_PathDiv->default_path=PATH_D; - } - - -} - - -VOID -phydm_candidate_dtp_update( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; - - pDM_PathDiv->num_candidate=3; - - if(pDM_PathDiv->use_path_a_as_default_ant == 1) - { - if(pDM_PathDiv->num_tx_path==3) - { - if(pDM_PathDiv->is_pathA_exist) - { - pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; - pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; - pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; - } - else // use path BCD - { - pDM_PathDiv->num_candidate=1; - phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD); - return; - } - } - else if(pDM_PathDiv->num_tx_path==2) - { - if(pDM_PathDiv->is_pathA_exist) - { - pDM_PathDiv->ant_candidate_1 = PHYDM_AB; - pDM_PathDiv->ant_candidate_2 = PHYDM_AC; - pDM_PathDiv->ant_candidate_3 = PHYDM_AD; - } - else - { - pDM_PathDiv->ant_candidate_1 = PHYDM_BC; - pDM_PathDiv->ant_candidate_2 = PHYDM_BD; - pDM_PathDiv->ant_candidate_3 = PHYDM_CD; - } - } - } - else - { - //2 3 TX Mode - if(pDM_PathDiv->num_tx_path==3)//choose 3 ant form 4 - { - if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 - { - pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; - pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; - pDM_PathDiv->ant_candidate_3 = PHYDM_ACD; - } - else if(pDM_PathDiv->default_path==PATH_B) - { - pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; - pDM_PathDiv->ant_candidate_2 = PHYDM_ABD; - pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; - } - else if(pDM_PathDiv->default_path == PATH_C) - { - pDM_PathDiv->ant_candidate_1 = PHYDM_ABC; - pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; - pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; - } - else if(pDM_PathDiv->default_path == PATH_D) - { - pDM_PathDiv->ant_candidate_1 = PHYDM_ABD; - pDM_PathDiv->ant_candidate_2 = PHYDM_ACD; - pDM_PathDiv->ant_candidate_3 = PHYDM_BCD; - } - } - - //2 2 TX Mode - else if(pDM_PathDiv->num_tx_path==2)//choose 2 ant form 4 - { - if(pDM_PathDiv->default_path == PATH_A) //choose 2 ant form 3 - { - pDM_PathDiv->ant_candidate_1 = PHYDM_AB; - pDM_PathDiv->ant_candidate_2 = PHYDM_AC; - pDM_PathDiv->ant_candidate_3 = PHYDM_AD; - } - else if(pDM_PathDiv->default_path==PATH_B) - { - pDM_PathDiv->ant_candidate_1 = PHYDM_AB; - pDM_PathDiv->ant_candidate_2 = PHYDM_BC; - pDM_PathDiv->ant_candidate_3 = PHYDM_BD; - } - else if(pDM_PathDiv->default_path == PATH_C) - { - pDM_PathDiv->ant_candidate_1 = PHYDM_AC; - pDM_PathDiv->ant_candidate_2 = PHYDM_BC; - pDM_PathDiv->ant_candidate_3 = PHYDM_CD; - } - else if(pDM_PathDiv->default_path == PATH_D) - { - pDM_PathDiv->ant_candidate_1= PHYDM_AD; - pDM_PathDiv->ant_candidate_2 = PHYDM_BD; - pDM_PathDiv->ant_candidate_3= PHYDM_CD; - } - } - } -} - - -VOID -phydm_dynamic_tx_path( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPATHDIV_T pDM_PathDiv = &pDM_Odm->DM_PathDiv; - - PSTA_INFO_T pEntry; - u4Byte i; - u1Byte num_client=0; - u1Byte H2C_Parameter[6] ={0}; - - - if(!pDM_Odm->bLinked) //bLinked==False - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("DTP_8814 [No Link!!!]\n")); - - if(pDM_PathDiv->bBecomeLinked == TRUE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be disconnected]----->\n")); - pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; - } - return; - } - else - { - if(pDM_PathDiv->bBecomeLinked ==FALSE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, (" [Be Linked !!!]----->\n")); - pDM_PathDiv->bBecomeLinked = pDM_Odm->bLinked; - } - } - - //2 [Period CTRL] - if(pDM_PathDiv->dtp_period >=2) - { - pDM_PathDiv->dtp_period=0; - } - else - { - //ODM_RT_TRACE(pDM_Odm,ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Phydm_Dynamic_Tx_Path_8814A() Stay = (( %d ))\n",pDM_PathDiv->dtp_period)); - pDM_PathDiv->dtp_period++; - return; - } - - - //2 [Fix Path] - if (pDM_Odm->path_select != PHYDM_AUTO_PATH) - { - return; - } - - //2 [Check Bfer] - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #if (BEAMFORMING_SUPPORT == 1) - { - BEAMFORMING_CAP BeamformCap = (pDM_Odm->BeamformingInfo.BeamformCap); - - if( BeamformCap & BEAMFORMER_CAP ) // BFmer On && Div On -> Div Off - { - if( pDM_PathDiv->fix_path_bfer == 0) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : OFF ] BFmer ==1 \n")); - pDM_PathDiv->fix_path_bfer = 1 ; - } - return; - } - else // BFmer Off && Div Off -> Div On - { - if( pDM_PathDiv->fix_path_bfer == 1 ) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("[ PathDiv : ON ] BFmer ==0 \n")); - pDM_PathDiv->fix_path_bfer = 0; - } - } - } - #endif - #endif - - if(pDM_PathDiv->use_path_a_as_default_ant ==1) - { - phydm_find_default_path(pDM_Odm); - phydm_candidate_dtp_update(pDM_Odm); - } - else - { - if( pDM_PathDiv->dtp_state == PHYDM_DTP_INIT) - { - phydm_find_default_path(pDM_Odm); - phydm_candidate_dtp_update(pDM_Odm); - pDM_PathDiv->dtp_state = PHYDM_DTP_RUNNING_1; - } - - else if( pDM_PathDiv->dtp_state == PHYDM_DTP_RUNNING_1) - { - pDM_PathDiv->dtp_check_patha_counter++; - - if(pDM_PathDiv->dtp_check_patha_counter>=NUM_RESET_DTP_PERIOD) - { - pDM_PathDiv->dtp_check_patha_counter=0; - pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; - } - //2 Search space update - else - { - // 1. find the worst candidate - - - // 2. repalce the worst candidate - } - } - } - - //2 Dynamic Path Selection H2C - - if(pDM_PathDiv->num_candidate == 1) - { - return; - } - else - { - H2C_Parameter[0] = pDM_PathDiv->num_candidate; - H2C_Parameter[1] = pDM_PathDiv->num_tx_path; - H2C_Parameter[2] = pDM_PathDiv->ant_candidate_1; - H2C_Parameter[3] = pDM_PathDiv->ant_candidate_2; - H2C_Parameter[4] = pDM_PathDiv->ant_candidate_3; - - ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, H2C_Parameter); - } - -} - - - -VOID -phydm_dynamic_tx_path_init( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); - PADAPTER pAdapter = pDM_Odm->Adapter; - #if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) - USB_MODE_MECH *pUsbModeMech = &pAdapter->UsbModeMechanism; - #endif - u1Byte search_space_2[NUM_CHOOSE2_FROM4]= {PHYDM_AB, PHYDM_AC, PHYDM_AD, PHYDM_BC, PHYDM_BD, PHYDM_CD }; - u1Byte search_space_3[NUM_CHOOSE3_FROM4]= {PHYDM_BCD, PHYDM_ACD, PHYDM_ABD, PHYDM_ABC}; - - #if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) - pDM_PathDiv->is_u3_mode = (pUsbModeMech->CurUsbMode==USB_MODE_U3)? 1 : 0 ; - #else - pDM_PathDiv->is_u3_mode = 1; - #endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("Dynamic TX Path Init 8814\n")); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV, ODM_DBG_LOUD, ("is_u3_mode = (( %d ))\n", pDM_PathDiv->is_u3_mode)); - - memcpy(&(pDM_PathDiv->search_space_2[0]), &(search_space_2[0]), NUM_CHOOSE2_FROM4); - memcpy(&(pDM_PathDiv->search_space_3[0]), &(search_space_3[0]), NUM_CHOOSE3_FROM4); - - pDM_PathDiv->use_path_a_as_default_ant= 1; - pDM_PathDiv->dtp_state = PHYDM_DTP_INIT; - pDM_Odm->path_select = PHYDM_AUTO_PATH; - pDM_PathDiv->path_div_type = PHYDM_4R_PATH_DIV; - - - if(pDM_PathDiv->is_u3_mode ) - { - pDM_PathDiv->num_tx_path=3; - phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BCD);/* 3TX Set Init TX Path*/ - - } - else - { - pDM_PathDiv->num_tx_path=2; - phydm_dtp_fix_tx_path(pDM_Odm, PHYDM_BC);/* 2TX // Set Init TX Path*/ - } - -} - - -VOID -phydm_process_rssi_for_path_div( - IN OUT PVOID pDM_VOID, - IN PVOID p_phy_info_void, - IN PVOID p_pkt_info_void - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_PHY_INFO_T pPhyInfo=(PODM_PHY_INFO_T)p_phy_info_void; - PODM_PACKET_INFO_T pPktinfo=(PODM_PACKET_INFO_T)p_pkt_info_void; - pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); - - if(pPktinfo->bPacketToSelf || pPktinfo->bPacketMatchBSSID) - { - if(pPktinfo->DataRate > ODM_RATE11M) - { - if(pDM_PathDiv->path_div_type == PHYDM_4R_PATH_DIV) - { - #if RTL8814A_SUPPORT - if(pDM_Odm->SupportICType & ODM_RTL8814A) - { - pDM_PathDiv->path_a_sum_all+=pPhyInfo->RxMIMOSignalStrength[0]; - pDM_PathDiv->path_a_cnt_all++; - - pDM_PathDiv->path_b_sum_all+=pPhyInfo->RxMIMOSignalStrength[1]; - pDM_PathDiv->path_b_cnt_all++; - - pDM_PathDiv->path_c_sum_all+=pPhyInfo->RxMIMOSignalStrength[2]; - pDM_PathDiv->path_c_cnt_all++; - - pDM_PathDiv->path_d_sum_all+=pPhyInfo->RxMIMOSignalStrength[3]; - pDM_PathDiv->path_d_cnt_all++; - } - #endif - } - else - { - pDM_PathDiv->PathA_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[0]; - pDM_PathDiv->PathA_Cnt[pPktinfo->StationID]++; - - pDM_PathDiv->PathB_Sum[pPktinfo->StationID]+=pPhyInfo->RxMIMOSignalStrength[1]; - pDM_PathDiv->PathB_Cnt[pPktinfo->StationID]++; - } - } - } - - -} - -#endif //#if RTL8814A_SUPPORT - -VOID -odm_pathdiv_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - pDM_Odm->path_select = (dm_value[0] & 0xf); - PHYDM_SNPRINTF((output+used, out_len-used,"Path_select = (( 0x%x ))\n",pDM_Odm->path_select )); - - //2 [Fix Path] - if (pDM_Odm->path_select != PHYDM_AUTO_PATH) - { - PHYDM_SNPRINTF((output+used, out_len-used,"Trun on path [%s%s%s%s]\n", - ((pDM_Odm->path_select) & 0x1)?"A":"", - ((pDM_Odm->path_select) & 0x2)?"B":"", - ((pDM_Odm->path_select) & 0x4)?"C":"", - ((pDM_Odm->path_select) & 0x8)?"D":"" )); - - phydm_dtp_fix_tx_path( pDM_Odm, pDM_Odm->path_select ); - } - else - { - PHYDM_SNPRINTF((output+used, out_len-used,"%s\n","Auto Path")); - } -} - -#endif // #if(defined(CONFIG_PATH_DIVERSITY)) - -VOID -phydm_c2h_dtp_handler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -) -{ -#if(defined(CONFIG_PATH_DIVERSITY)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pPATHDIV_T pDM_PathDiv = &(pDM_Odm->DM_PathDiv); - - u1Byte macid = CmdBuf[0]; - u1Byte target = CmdBuf[1]; - u1Byte nsc_1 = CmdBuf[2]; - u1Byte nsc_2 = CmdBuf[3]; - u1Byte nsc_3 = CmdBuf[4]; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Target_candidate = (( %d ))\n", target)); - /* - if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3)) - { - phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_1); - } - else if( nsc_2 >= nsc_3) - { - phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_2); - } - else - { - phydm_dtp_fix_tx_path(pDM_Odm, pDM_PathDiv->ant_candidate_3); - } - */ -#endif -} - -VOID -odm_PathDiversity( - IN PVOID pDM_VOID -) -{ -#if(defined(CONFIG_PATH_DIVERSITY)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); - return; - } - - #if RTL8812A_SUPPORT - - if(pDM_Odm->SupportICType & ODM_RTL8812) - ODM_PathDiversity_8812A(pDM_Odm); - else - #endif - - #if RTL8814A_SUPPORT - if(pDM_Odm->SupportICType & ODM_RTL8814A) - phydm_dynamic_tx_path(pDM_Odm); - else - #endif - {} -#endif -} - -VOID -odm_PathDiversityInit( - IN PVOID pDM_VOID -) -{ -#if(defined(CONFIG_PATH_DIVERSITY)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - /*pDM_Odm->SupportAbility |= ODM_BB_PATH_DIV;*/ - - if(pDM_Odm->mp_mode == TRUE) - return; - - if(!(pDM_Odm->SupportAbility & ODM_BB_PATH_DIV)) - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_PATH_DIV,ODM_DBG_LOUD,("Return: Not Support PathDiv\n")); - return; - } - -#if RTL8812A_SUPPORT - if(pDM_Odm->SupportICType & ODM_RTL8812) - ODM_PathDiversityInit_8812A(pDM_Odm); - else - #endif - - #if RTL8814A_SUPPORT - if(pDM_Odm->SupportICType & ODM_RTL8814A) - phydm_dynamic_tx_path_init(pDM_Odm); - else - #endif - {} -#endif -} - - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -// -// 2011/12/02 MH Copy from MP oursrc for temporarily test. -// - -VOID -odm_PathDivChkAntSwitchCallback( - PRT_TIMER pTimer -) -{ -} - -VOID -odm_PathDivChkAntSwitchWorkitemCallback( - IN PVOID pContext - ) -{ -} - -VOID -odm_CCKTXPathDiversityCallback( - PRT_TIMER pTimer -) -{ -} - -VOID -odm_CCKTXPathDiversityWorkItemCallback( - IN PVOID pContext - ) -{ -} -u1Byte -odm_SwAntDivSelectScanChnl( - IN PADAPTER Adapter - ) -{ - return 0; -} -VOID -odm_SwAntDivConstructScanChnl( - IN PADAPTER Adapter, - IN u1Byte ScanChnl - ) -{ -} - -#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#if (defined(CONFIG_PATH_DIVERSITY)) +#if RTL8814A_SUPPORT + +void +phydm_dtp_fix_tx_path( + void *p_dm_void, + u8 path +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->dm_path_div; + u8 i, num_enable_path = 0; + + if (path == p_dm_path_div->pre_tx_path) + return; + else + p_dm_path_div->pre_tx_path = path; + + odm_set_bb_reg(p_dm, 0x93c, BIT(18) | BIT(19), 3); + + for (i = 0; i < 4; i++) { + if (path & BIT(i)) + num_enable_path++; + } + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" number of turn-on path : (( %d ))\n", num_enable_path)); + + if (num_enable_path == 1) { + odm_set_bb_reg(p_dm, 0x93c, 0xf00000, path); + + if (path == BB_PATH_A) { /* 1-1 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A ))\n")); + odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); + } else if (path == BB_PATH_B) { /* 1-2 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B ))\n")); + odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); + } else if (path == BB_PATH_C) { /* 1-3 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( C ))\n")); + odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 0); + + } else if (path == BB_PATH_D) { /* 1-4 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( D ))\n")); + odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 0); + } + + } else if (num_enable_path == 2) { + odm_set_bb_reg(p_dm, 0x93c, 0xf00000, path); + odm_set_bb_reg(p_dm, 0x940, 0xf0, path); + + if (path == (BB_PATH_AB)) { /* 2-1 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A B ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 1); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 1); + } else if (path == BB_PATH_AC) { /* 2-2 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A C ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); + } else if (path == BB_PATH_AD) { /* 2-3 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A D ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 1); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 1); + } else if (path == BB_PATH_BC) { /* 2-4 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B C ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); + } else if (path == BB_PATH_BD) { /* 2-5 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B D ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 1); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 1); + } else if (path == BB_PATH_CD) { /* 2-6 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( C D ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 1); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 1); + } + + } else if (num_enable_path == 3) { + odm_set_bb_reg(p_dm, 0x93c, 0xf00000, path); + odm_set_bb_reg(p_dm, 0x940, 0xf0, path); + odm_set_bb_reg(p_dm, 0x940, 0xf0000, path); + + if (path == BB_PATH_ABC) { /* 3-1 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A B C))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 1); + odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 2); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 2); + /* set for 3ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(21) | BIT(20), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(23) | BIT(22), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(25) | BIT(24), 2); + } else if (path == BB_PATH_ABD) { /* 3-2 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A B D ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 1); + odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 2); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 2); + /* set for 3ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(21) | BIT(20), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(23) | BIT(22), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(27) | BIT(26), 2); + + } else if (path == BB_PATH_ACD) { /* 3-3 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( A C D ))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(25) | BIT(24), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); + odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 2); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(9) | BIT(8), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 2); + /* set for 3ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(21) | BIT(20), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(25) | BIT(24), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(27) | BIT(26), 2); + } else if (path == BB_PATH_BCD) { /* 3-4 */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path (( B C D))\n")); + /* set for 1ss */ + odm_set_bb_reg(p_dm, 0x93c, BIT(27) | BIT(26), 0); + odm_set_bb_reg(p_dm, 0x93c, BIT(29) | BIT(28), 1); + odm_set_bb_reg(p_dm, 0x93c, BIT(31) | BIT(30), 2); + /* set for 2ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(11) | BIT(10), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(13) | BIT(12), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(15) | BIT(14), 2); + /* set for 3ss */ + odm_set_bb_reg(p_dm, 0x940, BIT(23) | BIT(22), 0); + odm_set_bb_reg(p_dm, 0x940, BIT(25) | BIT(24), 1); + odm_set_bb_reg(p_dm, 0x940, BIT(27) | BIT(26), 2); + } + } else if (num_enable_path == 4) + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" Turn on path ((A B C D))\n")); + +} + +void +phydm_find_default_path( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->dm_path_div; + u32 rssi_avg_a = 0, rssi_avg_b = 0, rssi_avg_c = 0, rssi_avg_d = 0, rssi_avg_bcd = 0; + u32 rssi_total_a = 0, rssi_total_b = 0, rssi_total_c = 0, rssi_total_d = 0; + + /* 2 Default path Selection By RSSI */ + + rssi_avg_a = (p_dm_path_div->path_a_cnt_all > 0) ? (p_dm_path_div->path_a_sum_all / p_dm_path_div->path_a_cnt_all) : 0 ; + rssi_avg_b = (p_dm_path_div->path_b_cnt_all > 0) ? (p_dm_path_div->path_b_sum_all / p_dm_path_div->path_b_cnt_all) : 0 ; + rssi_avg_c = (p_dm_path_div->path_c_cnt_all > 0) ? (p_dm_path_div->path_c_sum_all / p_dm_path_div->path_c_cnt_all) : 0 ; + rssi_avg_d = (p_dm_path_div->path_d_cnt_all > 0) ? (p_dm_path_div->path_d_sum_all / p_dm_path_div->path_d_cnt_all) : 0 ; + + + p_dm_path_div->path_a_sum_all = 0; + p_dm_path_div->path_a_cnt_all = 0; + p_dm_path_div->path_b_sum_all = 0; + p_dm_path_div->path_b_cnt_all = 0; + p_dm_path_div->path_c_sum_all = 0; + p_dm_path_div->path_c_cnt_all = 0; + p_dm_path_div->path_d_sum_all = 0; + p_dm_path_div->path_d_cnt_all = 0; + + if (p_dm_path_div->use_path_a_as_default_ant == 1) { + rssi_avg_bcd = (rssi_avg_b + rssi_avg_c + rssi_avg_d) / 3; + + if ((rssi_avg_a + ANT_DECT_RSSI_TH) > rssi_avg_bcd) { + p_dm_path_div->is_path_a_exist = true; + p_dm_path_div->default_path = PATH_A; + } else + p_dm_path_div->is_path_a_exist = false; + } else { + if ((rssi_avg_a >= rssi_avg_b) && (rssi_avg_a >= rssi_avg_c) && (rssi_avg_a >= rssi_avg_d)) + p_dm_path_div->default_path = PATH_A; + else if ((rssi_avg_b >= rssi_avg_c) && (rssi_avg_b >= rssi_avg_d)) + p_dm_path_div->default_path = PATH_B; + else if (rssi_avg_c >= rssi_avg_d) + p_dm_path_div->default_path = PATH_C; + else + p_dm_path_div->default_path = PATH_D; + } + + +} + + +void +phydm_candidate_dtp_update( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->dm_path_div; + + p_dm_path_div->num_candidate = 3; + + if (p_dm_path_div->use_path_a_as_default_ant == 1) { + if (p_dm_path_div->num_tx_path == 3) { + if (p_dm_path_div->is_path_a_exist) { + p_dm_path_div->ant_candidate_1 = BB_PATH_ABC; + p_dm_path_div->ant_candidate_2 = BB_PATH_ABD; + p_dm_path_div->ant_candidate_3 = BB_PATH_ACD; + } else { /* use path BCD */ + p_dm_path_div->num_candidate = 1; + phydm_dtp_fix_tx_path(p_dm, BB_PATH_BCD); + return; + } + } else if (p_dm_path_div->num_tx_path == 2) { + if (p_dm_path_div->is_path_a_exist) { + p_dm_path_div->ant_candidate_1 = BB_PATH_AB; + p_dm_path_div->ant_candidate_2 = BB_PATH_AC; + p_dm_path_div->ant_candidate_3 = BB_PATH_AD; + } else { + p_dm_path_div->ant_candidate_1 = BB_PATH_BC; + p_dm_path_div->ant_candidate_2 = BB_PATH_BD; + p_dm_path_div->ant_candidate_3 = BB_PATH_CD; + } + } + } else { + /* 2 3 TX mode */ + if (p_dm_path_div->num_tx_path == 3) { /* choose 3 ant form 4 */ + if (p_dm_path_div->default_path == PATH_A) { /* choose 2 ant form 3 */ + p_dm_path_div->ant_candidate_1 = BB_PATH_ABC; + p_dm_path_div->ant_candidate_2 = BB_PATH_ABD; + p_dm_path_div->ant_candidate_3 = BB_PATH_ACD; + } else if (p_dm_path_div->default_path == PATH_B) { + p_dm_path_div->ant_candidate_1 = BB_PATH_ABC; + p_dm_path_div->ant_candidate_2 = BB_PATH_ABD; + p_dm_path_div->ant_candidate_3 = BB_PATH_BCD; + } else if (p_dm_path_div->default_path == PATH_C) { + p_dm_path_div->ant_candidate_1 = BB_PATH_ABC; + p_dm_path_div->ant_candidate_2 = BB_PATH_ACD; + p_dm_path_div->ant_candidate_3 = BB_PATH_BCD; + } else if (p_dm_path_div->default_path == PATH_D) { + p_dm_path_div->ant_candidate_1 = BB_PATH_ABD; + p_dm_path_div->ant_candidate_2 = BB_PATH_ACD; + p_dm_path_div->ant_candidate_3 = BB_PATH_BCD; + } + } + + /* 2 2 TX mode */ + else if (p_dm_path_div->num_tx_path == 2) { /* choose 2 ant form 4 */ + if (p_dm_path_div->default_path == PATH_A) { /* choose 2 ant form 3 */ + p_dm_path_div->ant_candidate_1 = BB_PATH_AB; + p_dm_path_div->ant_candidate_2 = BB_PATH_AC; + p_dm_path_div->ant_candidate_3 = BB_PATH_AD; + } else if (p_dm_path_div->default_path == PATH_B) { + p_dm_path_div->ant_candidate_1 = BB_PATH_AB; + p_dm_path_div->ant_candidate_2 = BB_PATH_BC; + p_dm_path_div->ant_candidate_3 = BB_PATH_BD; + } else if (p_dm_path_div->default_path == PATH_C) { + p_dm_path_div->ant_candidate_1 = BB_PATH_AC; + p_dm_path_div->ant_candidate_2 = BB_PATH_BC; + p_dm_path_div->ant_candidate_3 = BB_PATH_CD; + } else if (p_dm_path_div->default_path == PATH_D) { + p_dm_path_div->ant_candidate_1 = BB_PATH_AD; + p_dm_path_div->ant_candidate_2 = BB_PATH_BD; + p_dm_path_div->ant_candidate_3 = BB_PATH_CD; + } + } + } +} + + +void +phydm_dynamic_tx_path( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &p_dm->dm_path_div; + + struct sta_info *p_entry; + u32 i; + u8 num_client = 0; + u8 h2c_parameter[6] = {0}; + + + if (!p_dm->is_linked) { /* is_linked==False */ + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("DTP_8814 [No Link!!!]\n")); + + if (p_dm_path_div->is_become_linked == true) { + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" [Be disconnected]----->\n")); + p_dm_path_div->is_become_linked = p_dm->is_linked; + } + return; + } else { + if (p_dm_path_div->is_become_linked == false) { + PHYDM_DBG(p_dm, DBG_PATH_DIV, (" [Be Linked !!!]----->\n")); + p_dm_path_div->is_become_linked = p_dm->is_linked; + } + } + + /* 2 [period CTRL] */ + if (p_dm_path_div->dtp_period >= 2) + p_dm_path_div->dtp_period = 0; + else { + /* PHYDM_DBG(p_dm,DBG_PATH_DIV, ("Phydm_Dynamic_Tx_Path_8814A() Stay = (( %d ))\n",p_dm_path_div->dtp_period)); */ + p_dm_path_div->dtp_period++; + return; + } + + + /* 2 [Fix path] */ + if (p_dm->path_select != PHYDM_AUTO_PATH) + return; + + /* 2 [Check Bfer] */ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if (BEAMFORMING_SUPPORT == 1) + { + enum beamforming_cap beamform_cap = (p_dm->beamforming_info.beamform_cap); + + if (beamform_cap & BEAMFORMER_CAP) { /* BFmer On && Div On->Div Off */ + if (p_dm_path_div->fix_path_bfer == 0) { + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("[ PathDiv : OFF ] BFmer ==1\n")); + p_dm_path_div->fix_path_bfer = 1 ; + } + return; + } else { /* BFmer Off && Div Off->Div On */ + if (p_dm_path_div->fix_path_bfer == 1) { + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("[ PathDiv : ON ] BFmer ==0\n")); + p_dm_path_div->fix_path_bfer = 0; + } + } + } +#endif +#endif + + if (p_dm_path_div->use_path_a_as_default_ant == 1) { + phydm_find_default_path(p_dm); + phydm_candidate_dtp_update(p_dm); + } else { + if (p_dm_path_div->phydm_dtp_state == PHYDM_DTP_INIT) { + phydm_find_default_path(p_dm); + phydm_candidate_dtp_update(p_dm); + p_dm_path_div->phydm_dtp_state = PHYDM_DTP_RUNNING_1; + } + + else if (p_dm_path_div->phydm_dtp_state == PHYDM_DTP_RUNNING_1) { + p_dm_path_div->dtp_check_patha_counter++; + + if (p_dm_path_div->dtp_check_patha_counter >= NUM_RESET_DTP_PERIOD) { + p_dm_path_div->dtp_check_patha_counter = 0; + p_dm_path_div->phydm_dtp_state = PHYDM_DTP_INIT; + } + /* 2 Search space update */ + else { + /* 1. find the worst candidate */ + + + /* 2. repalce the worst candidate */ + } + } + } + + /* 2 Dynamic path Selection H2C */ + + if (p_dm_path_div->num_candidate == 1) + return; + else { + h2c_parameter[0] = p_dm_path_div->num_candidate; + h2c_parameter[1] = p_dm_path_div->num_tx_path; + h2c_parameter[2] = p_dm_path_div->ant_candidate_1; + h2c_parameter[3] = p_dm_path_div->ant_candidate_2; + h2c_parameter[4] = p_dm_path_div->ant_candidate_3; + + odm_fill_h2c_cmd(p_dm, PHYDM_H2C_DYNAMIC_TX_PATH, 6, h2c_parameter); + } + +} + + + +void +phydm_dynamic_tx_path_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm->dm_path_div); + struct _ADAPTER *p_adapter = p_dm->adapter; + u8 search_space_2[NUM_CHOOSE2_FROM4] = {BB_PATH_AB, BB_PATH_AC, BB_PATH_AD, BB_PATH_BC, BB_PATH_BD, BB_PATH_CD }; + u8 search_space_3[NUM_CHOOSE3_FROM4] = {BB_PATH_BCD, BB_PATH_ACD, BB_PATH_ABD, BB_PATH_ABC}; + +#if ((DM_ODM_SUPPORT_TYPE == ODM_WIN) && USB_SWITCH_SUPPORT) + p_dm_path_div->is_u3_mode = (*p_dm->hub_usb_mode == 2) ? 1 : 0; + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("[WIN USB] is_u3_mode = (( %d ))\n", p_dm_path_div->is_u3_mode)); +#else + p_dm_path_div->is_u3_mode = 1; +#endif + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("Dynamic TX path Init 8814\n")); + + memcpy(&(p_dm_path_div->search_space_2[0]), &(search_space_2[0]), NUM_CHOOSE2_FROM4); + memcpy(&(p_dm_path_div->search_space_3[0]), &(search_space_3[0]), NUM_CHOOSE3_FROM4); + + p_dm_path_div->use_path_a_as_default_ant = 1; + p_dm_path_div->phydm_dtp_state = PHYDM_DTP_INIT; + p_dm->path_select = PHYDM_AUTO_PATH; + p_dm_path_div->phydm_path_div_type = PHYDM_4R_PATH_DIV; + + + if (p_dm_path_div->is_u3_mode) { + p_dm_path_div->num_tx_path = 3; + phydm_dtp_fix_tx_path(p_dm, BB_PATH_BCD);/* 3TX Set Init TX path*/ + + } else { + p_dm_path_div->num_tx_path = 2; + phydm_dtp_fix_tx_path(p_dm, BB_PATH_BC);/* 2TX // Set Init TX path*/ + } + +} + + +void +phydm_process_rssi_for_path_div( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_phyinfo_struct *p_phy_info = (struct phydm_phyinfo_struct *)p_phy_info_void; + struct phydm_perpkt_info_struct *p_pktinfo = (struct phydm_perpkt_info_struct *)p_pkt_info_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm->dm_path_div); + + if (p_pktinfo->is_packet_to_self || p_pktinfo->is_packet_match_bssid) { + if (p_pktinfo->data_rate > ODM_RATE11M) { + if (p_dm_path_div->phydm_path_div_type == PHYDM_4R_PATH_DIV) { +#if RTL8814A_SUPPORT + if (p_dm->support_ic_type & ODM_RTL8814A) { + p_dm_path_div->path_a_sum_all += p_phy_info->rx_mimo_signal_strength[0]; + p_dm_path_div->path_a_cnt_all++; + + p_dm_path_div->path_b_sum_all += p_phy_info->rx_mimo_signal_strength[1]; + p_dm_path_div->path_b_cnt_all++; + + p_dm_path_div->path_c_sum_all += p_phy_info->rx_mimo_signal_strength[2]; + p_dm_path_div->path_c_cnt_all++; + + p_dm_path_div->path_d_sum_all += p_phy_info->rx_mimo_signal_strength[3]; + p_dm_path_div->path_d_cnt_all++; + } +#endif + } else { + p_dm_path_div->path_a_sum[p_pktinfo->station_id] += p_phy_info->rx_mimo_signal_strength[0]; + p_dm_path_div->path_a_cnt[p_pktinfo->station_id]++; + + p_dm_path_div->path_b_sum[p_pktinfo->station_id] += p_phy_info->rx_mimo_signal_strength[1]; + p_dm_path_div->path_b_cnt[p_pktinfo->station_id]++; + } + } + } + + +} + +#endif /* #if RTL8814A_SUPPORT */ + +void +odm_pathdiv_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm->dm_path_div); + u32 used = *_used; + u32 out_len = *_out_len; + + p_dm->path_select = (dm_value[0] & 0xf); + PHYDM_SNPRINTF((output + used, out_len - used, "Path_select = (( 0x%x ))\n", p_dm->path_select)); + + /* 2 [Fix path] */ + if (p_dm->path_select != PHYDM_AUTO_PATH) { + PHYDM_SNPRINTF((output + used, out_len - used, "Trun on path [%s%s%s%s]\n", + ((p_dm->path_select) & 0x1) ? "A" : "", + ((p_dm->path_select) & 0x2) ? "B" : "", + ((p_dm->path_select) & 0x4) ? "C" : "", + ((p_dm->path_select) & 0x8) ? "D" : "")); + + phydm_dtp_fix_tx_path(p_dm, p_dm->path_select); + } else + PHYDM_SNPRINTF((output + used, out_len - used, "%s\n", "Auto path")); + + *_used = used; + *_out_len = out_len; +} + +#endif /* #if(defined(CONFIG_PATH_DIVERSITY)) */ + +void +phydm_c2h_dtp_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +) +{ +#if (defined(CONFIG_PATH_DIVERSITY)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ODM_PATH_DIVERSITY_ *p_dm_path_div = &(p_dm->dm_path_div); + + u8 macid = cmd_buf[0]; + u8 target = cmd_buf[1]; + u8 nsc_1 = cmd_buf[2]; + u8 nsc_2 = cmd_buf[3]; + u8 nsc_3 = cmd_buf[4]; + + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("Target_candidate = (( %d ))\n", target)); + /* + if( (nsc_1 >= nsc_2) && (nsc_1 >= nsc_3)) + { + phydm_dtp_fix_tx_path(p_dm, p_dm_path_div->ant_candidate_1); + } + else if( nsc_2 >= nsc_3) + { + phydm_dtp_fix_tx_path(p_dm, p_dm_path_div->ant_candidate_2); + } + else + { + phydm_dtp_fix_tx_path(p_dm, p_dm_path_div->ant_candidate_3); + } + */ +#endif +} + +void +odm_path_diversity( + void *p_dm_void +) +{ +#if (defined(CONFIG_PATH_DIVERSITY)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & ODM_BB_PATH_DIV)) { + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("Return: Not Support PathDiv\n")); + return; + } + +#if RTL8812A_SUPPORT + + if (p_dm->support_ic_type & ODM_RTL8812) + odm_path_diversity_8812a(p_dm); + else +#endif + +#if RTL8814A_SUPPORT + if (p_dm->support_ic_type & ODM_RTL8814A) + phydm_dynamic_tx_path(p_dm); + else +#endif + {} +#endif +} + +void +phydm_path_diversity_init( + void *p_dm_void +) +{ +#if (defined(CONFIG_PATH_DIVERSITY)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + /*p_dm->support_ability |= ODM_BB_PATH_DIV;*/ + + if (*(p_dm->p_mp_mode) == true) + return; + + if (!(p_dm->support_ability & ODM_BB_PATH_DIV)) { + PHYDM_DBG(p_dm, DBG_PATH_DIV, ("Return: Not Support PathDiv\n")); + return; + } + +#if RTL8812A_SUPPORT + if (p_dm->support_ic_type & ODM_RTL8812) + odm_path_diversity_init_8812a(p_dm); + else +#endif + +#if RTL8814A_SUPPORT + if (p_dm->support_ic_type & ODM_RTL8814A) + phydm_dynamic_tx_path_init(p_dm); + else +#endif + {} +#endif +} + + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +/* + * 2011/12/02 MH Copy from MP oursrc for temporarily test. + * */ + +void +odm_path_div_chk_ant_switch_callback( + struct timer_list *p_timer +) +{ +} + +void +odm_path_div_chk_ant_switch_workitem_callback( + void *p_context +) +{ +} + +void +odm_cck_tx_path_diversity_callback( + struct timer_list *p_timer +) +{ +} + +void +odm_cck_tx_path_diversity_work_item_callback( + void *p_context +) +{ +} +u8 +odm_sw_ant_div_select_scan_chnl( + struct _ADAPTER *adapter +) +{ + return 0; +} +void +odm_sw_ant_div_construct_scan_chnl( + struct _ADAPTER *adapter, + u8 scan_chnl +) +{ +} + +#endif /* #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.h index 63a26410ede4..0db72997378a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pathdiv.h @@ -1,324 +1,294 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMPATHDIV_H__ -#define __PHYDMPATHDIV_H__ -/*#define PATHDIV_VERSION "2.0" //2014.11.04*/ -#define PATHDIV_VERSION "3.1" /*2015.07.29 by YuChen*/ - -#if(defined(CONFIG_PATH_DIVERSITY)) -#define USE_PATH_A_AS_DEFAULT_ANT //for 8814 dynamic TX path selection - -#define NUM_RESET_DTP_PERIOD 5 -#define ANT_DECT_RSSI_TH 3 - -#define PATH_A 1 -#define PATH_B 2 -#define PATH_C 3 -#define PATH_D 4 - -#define PHYDM_AUTO_PATH 0 -#define PHYDM_FIX_PATH 1 - -#define NUM_CHOOSE2_FROM4 6 -#define NUM_CHOOSE3_FROM4 4 - - -#define PHYDM_A BIT0 -#define PHYDM_B BIT1 -#define PHYDM_C BIT2 -#define PHYDM_D BIT3 -#define PHYDM_AB (BIT0 | BIT1) // 0 -#define PHYDM_AC (BIT0 | BIT2) // 1 -#define PHYDM_AD (BIT0 | BIT3) // 2 -#define PHYDM_BC (BIT1 | BIT2) // 3 -#define PHYDM_BD (BIT1 | BIT3) // 4 -#define PHYDM_CD (BIT2 | BIT3) // 5 - -#define PHYDM_ABC (BIT0 | BIT1 | BIT2) /* 0*/ -#define PHYDM_ABD (BIT0 | BIT1 | BIT3) /* 1*/ -#define PHYDM_ACD (BIT0 | BIT2 | BIT3) /* 2*/ -#define PHYDM_BCD (BIT1 | BIT2 | BIT3) /* 3*/ - -#define PHYDM_ABCD (BIT0 | BIT1 | BIT2 | BIT3) - - -typedef enum dtp_state -{ - PHYDM_DTP_INIT=1, - PHYDM_DTP_RUNNING_1 - -}PHYDM_DTP_STATE; - -typedef enum path_div_type -{ - PHYDM_2R_PATH_DIV = 1, - PHYDM_4R_PATH_DIV = 2 -}PHYDM_PATH_DIV_TYPE; - -VOID -phydm_process_rssi_for_path_div( - IN OUT PVOID pDM_VOID, - IN PVOID p_phy_info_void, - IN PVOID p_pkt_info_void - ); - -typedef struct _ODM_PATH_DIVERSITY_ -{ - u1Byte RespTxPath; - u1Byte PathSel[ODM_ASSOCIATE_ENTRY_NUM]; - u4Byte PathA_Sum[ODM_ASSOCIATE_ENTRY_NUM]; - u4Byte PathB_Sum[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte PathA_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; - u2Byte PathB_Cnt[ODM_ASSOCIATE_ENTRY_NUM]; - u1Byte path_div_type; - #if RTL8814A_SUPPORT - - u4Byte path_a_sum_all; - u4Byte path_b_sum_all; - u4Byte path_c_sum_all; - u4Byte path_d_sum_all; - - u4Byte path_a_cnt_all; - u4Byte path_b_cnt_all; - u4Byte path_c_cnt_all; - u4Byte path_d_cnt_all; - - u1Byte dtp_period; - BOOLEAN bBecomeLinked; - BOOLEAN is_u3_mode; - u1Byte num_tx_path; - u1Byte default_path; - u1Byte num_candidate; - u1Byte ant_candidate_1; - u1Byte ant_candidate_2; - u1Byte ant_candidate_3; - u1Byte dtp_state; - u1Byte dtp_check_patha_counter; - BOOLEAN fix_path_bfer; - u1Byte search_space_2[NUM_CHOOSE2_FROM4]; - u1Byte search_space_3[NUM_CHOOSE3_FROM4]; - - u1Byte pre_tx_path; - u1Byte use_path_a_as_default_ant; - BOOLEAN is_pathA_exist; - - #endif -}PATHDIV_T, *pPATHDIV_T; - - -#endif //#if(defined(CONFIG_PATH_DIVERSITY)) - -VOID -phydm_c2h_dtp_handler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen - ); - -VOID -odm_PathDiversityInit( - IN PVOID pDM_VOID - ); - -VOID -odm_PathDiversity( - IN PVOID pDM_VOID - ); - -VOID -odm_pathdiv_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len - ); - - - -//1 [OLD IC]-------------------------------------------------------------------------------- - - - - - - -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - -//#define PATHDIV_ENABLE 1 -#define dm_PathDiv_RSSI_Check ODM_PathDivChkPerPktRssi -#define PathDivCheckBeforeLink8192C ODM_PathDiversityBeforeLink92C - - - - -typedef struct _PathDiv_Parameter_define_ -{ - u4Byte org_5g_RegE30; - u4Byte org_5g_RegC14; - u4Byte org_5g_RegCA0; - u4Byte swt_5g_RegE30; - u4Byte swt_5g_RegC14; - u4Byte swt_5g_RegCA0; - //for 2G IQK information - u4Byte org_2g_RegC80; - u4Byte org_2g_RegC4C; - u4Byte org_2g_RegC94; - u4Byte org_2g_RegC14; - u4Byte org_2g_RegCA0; - - u4Byte swt_2g_RegC80; - u4Byte swt_2g_RegC4C; - u4Byte swt_2g_RegC94; - u4Byte swt_2g_RegC14; - u4Byte swt_2g_RegCA0; -}PATHDIV_PARA,*pPATHDIV_PARA; - -VOID -odm_PathDiversityInit_92C( - IN PADAPTER Adapter - ); - -VOID -odm_2TPathDiversityInit_92C( - IN PADAPTER Adapter - ); - -VOID -odm_1TPathDiversityInit_92C( - IN PADAPTER Adapter - ); - -BOOLEAN -odm_IsConnected_92C( - IN PADAPTER Adapter - ); - -BOOLEAN -ODM_PathDiversityBeforeLink92C( - //IN PADAPTER Adapter - IN PDM_ODM_T pDM_Odm - ); - -VOID -odm_PathDiversityAfterLink_92C( - IN PADAPTER Adapter - ); - -VOID -odm_SetRespPath_92C( - IN PADAPTER Adapter, - IN u1Byte DefaultRespPath - ); - -VOID -odm_OFDMTXPathDiversity_92C( - IN PADAPTER Adapter - ); - -VOID -odm_CCKTXPathDiversity_92C( - IN PADAPTER Adapter - ); - -VOID -odm_ResetPathDiversity_92C( - IN PADAPTER Adapter - ); - -VOID -odm_CCKTXPathDiversityCallback( - PRT_TIMER pTimer - ); - -VOID -odm_CCKTXPathDiversityWorkItemCallback( - IN PVOID pContext - ); - -VOID -odm_PathDivChkAntSwitchCallback( - PRT_TIMER pTimer - ); - -VOID -odm_PathDivChkAntSwitchWorkitemCallback( - IN PVOID pContext - ); - - -VOID -odm_PathDivChkAntSwitch( - PDM_ODM_T pDM_Odm - ); - -VOID -ODM_CCKPathDiversityChkPerPktRssi( - PADAPTER Adapter, - BOOLEAN bIsDefPort, - BOOLEAN bMatchBSSID, - PRT_WLAN_STA pEntry, - PRT_RFD pRfd, - pu1Byte pDesc - ); - -VOID -ODM_PathDivChkPerPktRssi( - PADAPTER Adapter, - BOOLEAN bIsDefPort, - BOOLEAN bMatchBSSID, - PRT_WLAN_STA pEntry, - PRT_RFD pRfd - ); - -VOID -ODM_PathDivRestAfterLink( - IN PDM_ODM_T pDM_Odm - ); - -VOID -ODM_FillTXPathInTXDESC( - IN PADAPTER Adapter, - IN PRT_TCB pTcb, - IN pu1Byte pDesc - ); - -VOID -odm_PathDivInit_92D( - IN PDM_ODM_T pDM_Odm - ); - -u1Byte -odm_SwAntDivSelectScanChnl( - IN PADAPTER Adapter - ); - -VOID -odm_SwAntDivConstructScanChnl( - IN PADAPTER Adapter, - IN u1Byte ScanChnl - ); - - #endif //#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - - - #endif //#ifndef __ODMPATHDIV_H__ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMPATHDIV_H__ +#define __PHYDMPATHDIV_H__ +/*#define PATHDIV_VERSION "2.0" //2014.11.04*/ +#define PATHDIV_VERSION "3.1" /*2015.07.29 by YuChen*/ + +#if (defined(CONFIG_PATH_DIVERSITY)) +#define USE_PATH_A_AS_DEFAULT_ANT /* for 8814 dynamic TX path selection */ + +#define NUM_RESET_DTP_PERIOD 5 +#define ANT_DECT_RSSI_TH 3 + +#define PATH_A 1 +#define PATH_B 2 +#define PATH_C 3 +#define PATH_D 4 + +#define PHYDM_AUTO_PATH 0 +#define PHYDM_FIX_PATH 1 + +#define NUM_CHOOSE2_FROM4 6 +#define NUM_CHOOSE3_FROM4 4 + +enum phydm_dtp_state { + PHYDM_DTP_INIT = 1, + PHYDM_DTP_RUNNING_1 + +}; + +enum phydm_path_div_type { + PHYDM_2R_PATH_DIV = 1, + PHYDM_4R_PATH_DIV = 2 +}; + +void +phydm_process_rssi_for_path_div( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void +); + +struct _ODM_PATH_DIVERSITY_ { + u8 resp_tx_path; + u8 path_sel[ODM_ASSOCIATE_ENTRY_NUM]; + u32 path_a_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u32 path_b_sum[ODM_ASSOCIATE_ENTRY_NUM]; + u16 path_a_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u16 path_b_cnt[ODM_ASSOCIATE_ENTRY_NUM]; + u8 phydm_path_div_type; +#if RTL8814A_SUPPORT + + u32 path_a_sum_all; + u32 path_b_sum_all; + u32 path_c_sum_all; + u32 path_d_sum_all; + + u32 path_a_cnt_all; + u32 path_b_cnt_all; + u32 path_c_cnt_all; + u32 path_d_cnt_all; + + u8 dtp_period; + boolean is_become_linked; + boolean is_u3_mode; + u8 num_tx_path; + u8 default_path; + u8 num_candidate; + u8 ant_candidate_1; + u8 ant_candidate_2; + u8 ant_candidate_3; + u8 phydm_dtp_state; + u8 dtp_check_patha_counter; + boolean fix_path_bfer; + u8 search_space_2[NUM_CHOOSE2_FROM4]; + u8 search_space_3[NUM_CHOOSE3_FROM4]; + + u8 pre_tx_path; + u8 use_path_a_as_default_ant; + boolean is_path_a_exist; + +#endif +}; + + +#endif /* #if(defined(CONFIG_PATH_DIVERSITY)) */ + +void +phydm_c2h_dtp_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +); + +void +phydm_path_diversity_init( + void *p_dm_void +); + +void +odm_path_diversity( + void *p_dm_void +); + +void +odm_pathdiv_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + + + +/* 1 [OLD IC]-------------------------------------------------------------------------------- */ + + + + + + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + +/* #define PATHDIV_ENABLE 1 */ +#define dm_path_div_rssi_check odm_path_div_chk_per_pkt_rssi +#define path_div_check_before_link8192c odm_path_diversity_before_link92c + + + + +struct _path_div_parameter_define_ { + u32 org_5g_rege30; + u32 org_5g_regc14; + u32 org_5g_regca0; + u32 swt_5g_rege30; + u32 swt_5g_regc14; + u32 swt_5g_regca0; + /* for 2G IQK information */ + u32 org_2g_regc80; + u32 org_2g_regc4c; + u32 org_2g_regc94; + u32 org_2g_regc14; + u32 org_2g_regca0; + + u32 swt_2g_regc80; + u32 swt_2g_regc4c; + u32 swt_2g_regc94; + u32 swt_2g_regc14; + u32 swt_2g_regca0; +}; + +void +odm_path_diversity_init_92c( + struct _ADAPTER *adapter +); + +void +odm_2t_path_diversity_init_92c( + struct _ADAPTER *adapter +); + +void +odm_1t_path_diversity_init_92c( + struct _ADAPTER *adapter +); + +boolean +odm_is_connected_92c( + struct _ADAPTER *adapter +); + +boolean +odm_path_diversity_before_link92c( + /* struct _ADAPTER* adapter */ + struct PHY_DM_STRUCT *p_dm +); + +void +odm_path_diversity_after_link_92c( + struct _ADAPTER *adapter +); + +void +odm_set_resp_path_92c( + struct _ADAPTER *adapter, + u8 default_resp_path +); + +void +odm_ofdm_tx_path_diversity_92c( + struct _ADAPTER *adapter +); + +void +odm_cck_tx_path_diversity_92c( + struct _ADAPTER *adapter +); + +void +odm_reset_path_diversity_92c( + struct _ADAPTER *adapter +); + +void +odm_cck_tx_path_diversity_callback( + struct timer_list *p_timer +); + +void +odm_cck_tx_path_diversity_work_item_callback( + void *p_context +); + +void +odm_path_div_chk_ant_switch_callback( + struct timer_list *p_timer +); + +void +odm_path_div_chk_ant_switch_workitem_callback( + void *p_context +); + + +void +odm_path_div_chk_ant_switch( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_cck_path_diversity_chk_per_pkt_rssi( + struct _ADAPTER *adapter, + boolean is_def_port, + boolean is_match_bssid, + struct _WLAN_STA *p_entry, + PRT_RFD p_rfd, + u8 *p_desc +); + +void +odm_path_div_chk_per_pkt_rssi( + struct _ADAPTER *adapter, + boolean is_def_port, + boolean is_match_bssid, + struct _WLAN_STA *p_entry, + PRT_RFD p_rfd +); + +void +odm_path_div_rest_after_link( + struct PHY_DM_STRUCT *p_dm +); + +void +odm_fill_tx_path_in_txdesc( + struct _ADAPTER *adapter, + PRT_TCB p_tcb, + u8 *p_desc +); + +void +odm_path_div_init_92d( + struct PHY_DM_STRUCT *p_dm +); + +u8 +odm_sw_ant_div_select_scan_chnl( + struct _ADAPTER *adapter +); + +void +odm_sw_ant_div_construct_scan_chnl( + struct _ADAPTER *adapter, + u8 scan_chnl +); + +#endif /* #if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) */ + + +#endif /* #ifndef __ODMPATHDIV_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.c new file mode 100644 index 000000000000..02f9be755986 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.c @@ -0,0 +1,2581 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void +phydm_rx_statistic_cal( + struct PHY_DM_STRUCT *p_phydm, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo +) +{ +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + struct _phy_status_rpt_jaguar2_type1 *p_phy_sta_rpt = (struct _phy_status_rpt_jaguar2_type1 *)p_phy_status; +#endif + u8 date_rate = (p_pktinfo->data_rate & 0x7f); + + if (date_rate <= ODM_RATE54M) { + + p_phydm->phy_dbg_info.num_qry_legacy_pkt[date_rate]++; + /**/ + } else if (date_rate <= ODM_RATEMCS31) { + + p_phydm->phy_dbg_info.num_qry_ht_pkt[date_rate - ODM_RATEMCS0]++; + p_phydm->phy_dbg_info.ht_pkt_not_zero = true; + + } + #if ODM_IC_11AC_SERIES_SUPPORT + else if (date_rate <= ODM_RATEVHTSS4MCS9) { + + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + if ((p_phy_sta_rpt->gid != 0) && (p_phy_sta_rpt->gid != 63) && (p_phydm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE)) { + + p_phydm->phy_dbg_info.num_qry_mu_vht_pkt[date_rate - ODM_RATEVHTSS1MCS0]++; + if (p_pktinfo->ppdu_cnt < 4) { + p_phydm->phy_dbg_info.num_of_ppdu[p_pktinfo->ppdu_cnt] = date_rate | BIT(7); + p_phydm->phy_dbg_info.gid_num[p_pktinfo->ppdu_cnt] = p_phy_sta_rpt->gid; + } + } else + #endif + { + p_phydm->phy_dbg_info.num_qry_vht_pkt[date_rate - ODM_RATEVHTSS1MCS0]++; + p_phydm->phy_dbg_info.vht_pkt_not_zero = true; + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + if (p_pktinfo->ppdu_cnt < 4) { + p_phydm->phy_dbg_info.num_of_ppdu[p_pktinfo->ppdu_cnt] = date_rate; + p_phydm->phy_dbg_info.gid_num[p_pktinfo->ppdu_cnt] = p_phy_sta_rpt->gid; + } + #endif + } + } + #endif +} + +void +phydm_reset_phystatus_avg( + struct PHY_DM_STRUCT *p_dm +) +{ + struct phydm_phystatus_avg *p_dbg_avg = &(p_dm->phy_dbg_info.phystatus_statistic_avg); + + odm_memory_set(p_dm, &(p_dbg_avg->rssi_cck_avg), 0, sizeof(struct phydm_phystatus_avg)); +} + +void +phydm_reset_phystatus_statistic( + struct PHY_DM_STRUCT *p_dm +) +{ + struct phydm_phystatus_statistic *p_dbg_statistic = &(p_dm->phy_dbg_info.phystatus_statistic_info); + + odm_memory_set(p_dm, &(p_dbg_statistic->rssi_cck_sum), 0, sizeof(struct phydm_phystatus_statistic)); +} + +void +phydm_avg_phystatus_index( + struct PHY_DM_STRUCT *p_dm, + struct phydm_phyinfo_struct *p_phy_info, + struct phydm_perpkt_info_struct *p_pktinfo +) +{ + u8 rate_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + struct phydm_phystatus_statistic *p_dbg_statistic = &(p_dm->phy_dbg_info.phystatus_statistic_info); + + if (p_pktinfo->data_rate <= ODM_RATE11M) { + + /*RSSI*/ + p_dbg_statistic->rssi_cck_sum += p_phy_info->rx_mimo_signal_strength[0]; + p_dbg_statistic->rssi_cck_cnt++; + } else if (p_pktinfo->data_rate <= ODM_RATE54M) { + + /*evm*/ + p_dbg_statistic->evm_ofdm_sum += p_phy_info->rx_mimo_evm_dbm[0]; + + /*SNR*/ + p_dbg_statistic->snr_ofdm_sum += p_phy_info->rx_snr[0]; + + /*RSSI*/ + p_dbg_statistic->rssi_ofdm_sum += p_phy_info->rx_mimo_signal_strength[0]; + p_dbg_statistic->rssi_ofdm_cnt++; + } else if (rate_ss == 1) { + + /*evm*/ + p_dbg_statistic->evm_1ss_sum += p_phy_info->rx_mimo_evm_dbm[0]; + + /*SNR*/ + p_dbg_statistic->snr_1ss_sum += p_phy_info->rx_snr[0]; + + p_dbg_statistic->rssi_1ss_sum += p_phy_info->rx_mimo_signal_strength[0]; + p_dbg_statistic->rssi_1ss_cnt++; + } else if (rate_ss == 2) { + #if (defined(PHYDM_COMPILE_ABOVE_2SS)) + /*evm*/ + p_dbg_statistic->evm_2ss_sum[0] += p_phy_info->rx_mimo_evm_dbm[0]; + p_dbg_statistic->evm_2ss_sum[1] += p_phy_info->rx_mimo_evm_dbm[1]; + + /*SNR*/ + p_dbg_statistic->snr_2ss_sum[0] += p_phy_info->rx_snr[0]; + p_dbg_statistic->snr_2ss_sum[1] += p_phy_info->rx_snr[1]; + + /*RSSI*/ + p_dbg_statistic->rssi_2ss_sum[0] += p_phy_info->rx_mimo_signal_strength[0]; + p_dbg_statistic->rssi_2ss_sum[1] += p_phy_info->rx_mimo_signal_strength[1]; + p_dbg_statistic->rssi_2ss_cnt++; + #endif + } else if (rate_ss == 3) { + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + /*evm*/ + p_dbg_statistic->evm_3ss_sum[0] += p_phy_info->rx_mimo_evm_dbm[0]; + p_dbg_statistic->evm_3ss_sum[1] += p_phy_info->rx_mimo_evm_dbm[1]; + p_dbg_statistic->evm_3ss_sum[2] += p_phy_info->rx_mimo_evm_dbm[2]; + + /*SNR*/ + p_dbg_statistic->snr_3ss_sum[0] += p_phy_info->rx_snr[0]; + p_dbg_statistic->snr_3ss_sum[1] += p_phy_info->rx_snr[1]; + p_dbg_statistic->snr_3ss_sum[2] += p_phy_info->rx_snr[2]; + + /*RSSI*/ + p_dbg_statistic->rssi_3ss_sum[0] += p_phy_info->rx_mimo_signal_strength[0]; + p_dbg_statistic->rssi_3ss_sum[1] += p_phy_info->rx_mimo_signal_strength[1]; + p_dbg_statistic->rssi_3ss_sum[2] += p_phy_info->rx_mimo_signal_strength[2]; + p_dbg_statistic->rssi_3ss_cnt++; + #endif + } else if (rate_ss == 4) { + #if (defined(PHYDM_COMPILE_ABOVE_4SS)) + /*evm*/ + p_dbg_statistic->evm_4ss_sum[0] += p_phy_info->rx_mimo_evm_dbm[0]; + p_dbg_statistic->evm_4ss_sum[1] += p_phy_info->rx_mimo_evm_dbm[1]; + p_dbg_statistic->evm_4ss_sum[2] += p_phy_info->rx_mimo_evm_dbm[2]; + p_dbg_statistic->evm_4ss_sum[3] += p_phy_info->rx_mimo_evm_dbm[3]; + + /*SNR*/ + p_dbg_statistic->snr_4ss_sum[0] += p_phy_info->rx_snr[0]; + p_dbg_statistic->snr_4ss_sum[1] += p_phy_info->rx_snr[1]; + p_dbg_statistic->snr_4ss_sum[2] += p_phy_info->rx_snr[2]; + p_dbg_statistic->snr_4ss_sum[3] += p_phy_info->rx_snr[3]; + + /*RSSI*/ + p_dbg_statistic->rssi_4ss_sum[0] += p_phy_info->rx_mimo_signal_strength[0]; + p_dbg_statistic->rssi_4ss_sum[1] += p_phy_info->rx_mimo_signal_strength[1]; + p_dbg_statistic->rssi_4ss_sum[2] += p_phy_info->rx_mimo_signal_strength[2]; + p_dbg_statistic->rssi_4ss_sum[3] += p_phy_info->rx_mimo_signal_strength[3]; + p_dbg_statistic->rssi_4ss_cnt++; + #endif + } +} + +u8 phydm_get_signal_quality( + struct phydm_phyinfo_struct *p_phy_info, + struct PHY_DM_STRUCT *p_dm, + struct _phy_status_rpt_8192cd *p_phy_sta_rpt + ) +{ + u8 SQ_rpt; + u8 result = 0; + + if (p_phy_info->rx_pwdb_all > 40 && !p_dm->is_in_hct_test) + result = 100; + else { + SQ_rpt = p_phy_sta_rpt->cck_sig_qual_ofdm_pwdb_all; + + if (SQ_rpt > 64) + result = 0; + else if (SQ_rpt < 20) + result = 100; + else + result = ((64 - SQ_rpt) * 100) / 44; + + } + + return result; +} + +u8 +phydm_query_rx_pwr_percentage( + s8 ant_power +) +{ + if ((ant_power <= -100) || (ant_power >= 20)) + return 0; + else if (ant_power >= 0) + return 100; + else + return 100 + ant_power; +} + + +s32 +phydm_signal_scale_mapping_92c_series( + struct PHY_DM_STRUCT *p_dm, + s32 curr_sig +) +{ + s32 ret_sig = 0; +#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + if (p_dm->support_interface == ODM_ITRF_PCIE) { + /* step 1. Scale mapping. */ + if (curr_sig >= 61 && curr_sig <= 100) + ret_sig = 90 + ((curr_sig - 60) / 4); + else if (curr_sig >= 41 && curr_sig <= 60) + ret_sig = 78 + ((curr_sig - 40) / 2); + else if (curr_sig >= 31 && curr_sig <= 40) + ret_sig = 66 + (curr_sig - 30); + else if (curr_sig >= 21 && curr_sig <= 30) + ret_sig = 54 + (curr_sig - 20); + else if (curr_sig >= 5 && curr_sig <= 20) + ret_sig = 42 + (((curr_sig - 5) * 2) / 3); + else if (curr_sig == 4) + ret_sig = 36; + else if (curr_sig == 3) + ret_sig = 27; + else if (curr_sig == 2) + ret_sig = 18; + else if (curr_sig == 1) + ret_sig = 9; + else + ret_sig = curr_sig; + } +#endif + +#if ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) + if ((p_dm->support_interface == ODM_ITRF_USB) || (p_dm->support_interface == ODM_ITRF_SDIO)) { + if (curr_sig >= 51 && curr_sig <= 100) + ret_sig = 100; + else if (curr_sig >= 41 && curr_sig <= 50) + ret_sig = 80 + ((curr_sig - 40) * 2); + else if (curr_sig >= 31 && curr_sig <= 40) + ret_sig = 66 + (curr_sig - 30); + else if (curr_sig >= 21 && curr_sig <= 30) + ret_sig = 54 + (curr_sig - 20); + else if (curr_sig >= 10 && curr_sig <= 20) + ret_sig = 42 + (((curr_sig - 10) * 2) / 3); + else if (curr_sig >= 5 && curr_sig <= 9) + ret_sig = 22 + (((curr_sig - 5) * 3) / 2); + else if (curr_sig >= 1 && curr_sig <= 4) + ret_sig = 6 + (((curr_sig - 1) * 3) / 2); + else + ret_sig = curr_sig; + } + +#endif + return ret_sig; +} + +s32 +phydm_signal_scale_mapping( + struct PHY_DM_STRUCT *p_dm, + s32 curr_sig +) +{ +#ifdef CONFIG_SIGNAL_SCALE_MAPPING + return phydm_signal_scale_mapping_92c_series(p_dm, curr_sig); +#else + return curr_sig; +#endif + +} + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +static u8 phydm_sq_patch_rt_cid_819x_lenovo( + struct PHY_DM_STRUCT *p_dm, + u8 is_cck_rate, + u8 PWDB_ALL, + u8 path, + u8 RSSI +) +{ + u8 SQ = 0; + + if (is_cck_rate) { + + if (IS_HARDWARE_TYPE_8192E(p_dm->adapter)) { + + /* */ + /* Expected signal strength and bars indication at Lenovo lab. 2013.04.11 */ + /* 802.11n, 802.11b, 802.11g only at channel 6 */ + /* */ + /* Attenuation (dB) OS Signal Bars RSSI by Xirrus (dBm) */ + /* 50 5 -49 */ + /* 55 5 -49 */ + /* 60 5 -50 */ + /* 65 5 -51 */ + /* 70 5 -52 */ + /* 75 5 -54 */ + /* 80 5 -55 */ + /* 85 4 -60 */ + /* 90 3 -63 */ + /* 95 3 -65 */ + /* 100 2 -67 */ + /* 102 2 -67 */ + /* 104 1 -70 */ + /* */ + + if (PWDB_ALL >= 50) + SQ = 100; + else if (PWDB_ALL >= 35 && PWDB_ALL < 50) + SQ = 80; + else if (PWDB_ALL >= 31 && PWDB_ALL < 35) + SQ = 60; + else if (PWDB_ALL >= 22 && PWDB_ALL < 31) + SQ = 40; + else if (PWDB_ALL >= 18 && PWDB_ALL < 22) + SQ = 20; + else + SQ = 10; + } else { + if (PWDB_ALL >= 50) + SQ = 100; + else if (PWDB_ALL >= 35 && PWDB_ALL < 50) + SQ = 80; + else if (PWDB_ALL >= 22 && PWDB_ALL < 35) + SQ = 60; + else if (PWDB_ALL >= 18 && PWDB_ALL < 22) + SQ = 40; + else + SQ = 10; + } + + } else { + /* OFDM rate */ + + if (IS_HARDWARE_TYPE_8192E(p_dm->adapter)) { + if (RSSI >= 45) + SQ = 100; + else if (RSSI >= 22 && RSSI < 45) + SQ = 80; + else if (RSSI >= 18 && RSSI < 22) + SQ = 40; + else + SQ = 20; + } else { + if (RSSI >= 45) + SQ = 100; + else if (RSSI >= 22 && RSSI < 45) + SQ = 80; + else if (RSSI >= 18 && RSSI < 22) + SQ = 40; + else + SQ = 20; + } + } + + RT_TRACE(COMP_DBG, DBG_TRACE, ("is_cck_rate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", is_cck_rate, PWDB_ALL, RSSI, SQ)); + + + return SQ; +} + +static u8 phydm_sq_patch_rt_cid_819x_acer( + struct PHY_DM_STRUCT *p_dm, + u8 is_cck_rate, + u8 PWDB_ALL, + u8 path, + u8 RSSI +) +{ + u8 SQ = 0; + + if (is_cck_rate) { + + RT_TRACE(COMP_DBG, DBG_WARNING, ("odm_SQ_process_patch_RT_Acer\n")); + +#if OS_WIN_FROM_WIN8(OS_VERSION) + + if (PWDB_ALL >= 50) + SQ = 100; + else if (PWDB_ALL >= 35 && PWDB_ALL < 50) + SQ = 80; + else if (PWDB_ALL >= 30 && PWDB_ALL < 35) + SQ = 60; + else if (PWDB_ALL >= 25 && PWDB_ALL < 30) + SQ = 40; + else if (PWDB_ALL >= 20 && PWDB_ALL < 25) + SQ = 20; + else + SQ = 10; +#else + if (PWDB_ALL >= 50) + SQ = 100; + else if (PWDB_ALL >= 35 && PWDB_ALL < 50) + SQ = 80; + else if (PWDB_ALL >= 30 && PWDB_ALL < 35) + SQ = 60; + else if (PWDB_ALL >= 25 && PWDB_ALL < 30) + SQ = 40; + else if (PWDB_ALL >= 20 && PWDB_ALL < 25) + SQ = 20; + else + SQ = 10; + + if (PWDB_ALL == 0) /* Abnormal case, do not indicate the value above 20 on Win7 */ + SQ = 20; +#endif + + + + } else { + /* OFDM rate */ + + if (IS_HARDWARE_TYPE_8192E(p_dm->adapter)) { + if (RSSI >= 45) + SQ = 100; + else if (RSSI >= 22 && RSSI < 45) + SQ = 80; + else if (RSSI >= 18 && RSSI < 22) + SQ = 40; + else + SQ = 20; + } else { + if (RSSI >= 35) + SQ = 100; + else if (RSSI >= 30 && RSSI < 35) + SQ = 80; + else if (RSSI >= 25 && RSSI < 30) + SQ = 40; + else + SQ = 20; + } + } + + RT_TRACE(COMP_DBG, DBG_LOUD, ("is_cck_rate(%#d), PWDB_ALL(%#d), RSSI(%#d), SQ(%#d)\n", is_cck_rate, PWDB_ALL, RSSI, SQ)); + + + return SQ; +} +#endif + +static u8 +phydm_evm_db_to_percentage( + s8 value +) +{ + /* */ + /* -33dB~0dB to 0%~99% */ + /* */ + s8 ret_val; + + ret_val = value; + ret_val /= 2; + + /*dbg_print("value=%d\n", value);*/ + /*ODM_RT_DISP(FRX, RX_PHY_SQ, ("EVMdbToPercentage92C value=%d / %x\n", ret_val, ret_val));*/ +#ifdef ODM_EVM_ENHANCE_ANTDIV + if (ret_val >= 0) + ret_val = 0; + + if (ret_val <= -40) + ret_val = -40; + + ret_val = 0 - ret_val; + ret_val *= 3; +#else + if (ret_val >= 0) + ret_val = 0; + + if (ret_val <= -33) + ret_val = -33; + + ret_val = 0 - ret_val; + ret_val *= 3; + + if (ret_val == 99) + ret_val = 100; +#endif + + return (u8)ret_val; +} + +static u8 +phydm_evm_dbm_jaguar_series( + s8 value +) +{ + s8 ret_val = value; + + /* -33dB~0dB to 33dB ~ 0dB */ + if (ret_val == -128) + ret_val = 127; + else if (ret_val < 0) + ret_val = 0 - ret_val; + + ret_val = ret_val >> 1; + return (u8)ret_val; +} + +static s16 +phydm_cfo( + s8 value +) +{ + s16 ret_val; + + if (value < 0) { + ret_val = 0 - value; + ret_val = (ret_val << 1) + (ret_val >> 1) ; /* *2.5~=312.5/2^7 */ + ret_val = ret_val | BIT(12); /* set bit12 as 1 for negative cfo */ + } else { + ret_val = value; + ret_val = (ret_val << 1) + (ret_val >> 1) ; /* *2.5~=312.5/2^7 */ + } + return ret_val; +} + +s8 +phydm_cck_rssi_convert( + struct PHY_DM_STRUCT *p_dm, + u16 lna_idx, + u8 vga_idx +) +{ + return (p_dm->cck_lna_gain_table[lna_idx] - (vga_idx << 1)); +} + +void +phydm_get_cck_rssi_table_from_reg( + struct PHY_DM_STRUCT *p_dm +) +{ + u8 used_lna_idx_tmp; + u32 reg_0xa80 = 0x7431, reg_0xabc = 0xcbe5edfd; /*example: {-53, -43, -33, -27, -19, -13, -3, 1}*/ /*{0xCB, 0xD5, 0xDF, 0xE5, 0xED, 0xF3, 0xFD, 0x2}*/ + u8 i; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("CCK LNA Gain table init\n")); + + if (!(p_dm->support_ic_type & (ODM_RTL8197F))) + return; + + reg_0xa80 = odm_get_bb_reg(p_dm, 0xa80, 0xFFFF); + reg_0xabc = odm_get_bb_reg(p_dm, 0xabc, MASKDWORD); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("reg_0xa80 = 0x%x\n", reg_0xa80)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("reg_0xabc = 0x%x\n", reg_0xabc)); + + for (i = 0; i <= 3; i++) { + used_lna_idx_tmp = (u8)((reg_0xa80 >> (4*i)) & 0x7); + p_dm->cck_lna_gain_table[used_lna_idx_tmp] = (s8)((reg_0xabc >> (8*i)) & 0xff); + } + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("cck_lna_gain_table = {%d,%d,%d,%d,%d,%d,%d,%d}\n", + p_dm->cck_lna_gain_table[0], + p_dm->cck_lna_gain_table[1], + p_dm->cck_lna_gain_table[2], + p_dm->cck_lna_gain_table[3], + p_dm->cck_lna_gain_table[4], + p_dm->cck_lna_gain_table[5], + p_dm->cck_lna_gain_table[6], + p_dm->cck_lna_gain_table[7])); + +} + +u8 +phydm_rate_to_num_ss( + struct PHY_DM_STRUCT *p_dm, + u8 data_rate +) +{ + u8 num_ss = 1; + + if (data_rate <= ODM_RATE54M) + num_ss = 1; + else if (data_rate <= ODM_RATEMCS31) + num_ss = ((data_rate - ODM_RATEMCS0) >> 3) + 1; + else if (data_rate <= ODM_RATEVHTSS1MCS9) + num_ss = 1; + else if (data_rate <= ODM_RATEVHTSS2MCS9) + num_ss = 2; + else if (data_rate <= ODM_RATEVHTSS3MCS9) + num_ss = 3; + else if (data_rate <= ODM_RATEVHTSS4MCS9) + num_ss = 4; + + return num_ss; +} + + + +#if (RTL8703B_SUPPORT == 1) +s8 +phydm_cck_rssi_8703B( + u16 LNA_idx, + u8 VGA_idx +) +{ + s8 rx_pwr_all = 0x00; + + switch (LNA_idx) { + case 0xf: + rx_pwr_all = -48 - (2 * VGA_idx); + break; + case 0xb: + rx_pwr_all = -42 - (2 * VGA_idx); /*TBD*/ + break; + case 0xa: + rx_pwr_all = -36 - (2 * VGA_idx); + break; + case 8: + rx_pwr_all = -32 - (2 * VGA_idx); + break; + case 7: + rx_pwr_all = -19 - (2 * VGA_idx); + break; + case 4: + rx_pwr_all = -6 - (2 * VGA_idx); + break; + case 0: + rx_pwr_all = -2 - (2 * VGA_idx); + break; + default: + /*rx_pwr_all = -53+(2*(31-VGA_idx));*/ + /*dbg_print("wrong LNA index\n");*/ + break; + + } + return rx_pwr_all; +} +#endif + +#if (RTL8195A_SUPPORT == 1) +s8 +phydm_cck_rssi_8195a( + struct PHY_DM_STRUCT *p_dm, + u16 LNA_idx, + u8 VGA_idx +) +{ + s8 rx_pwr_all = 0; + s8 lna_gain = 0; + s8 lna_gain_table_0[8] = {0, -8, -15, -22, -29, -36, -45, -54}; + s8 lna_gain_table_1[8] = {0, -8, -15, -22, -29, -36, -45, -54};/*use 8195A to calibrate this table. 2016.06.24, Dino*/ + + if (p_dm->cck_agc_report_type == 0) + lna_gain = lna_gain_table_0[LNA_idx]; + else + lna_gain = lna_gain_table_1[LNA_idx]; + + rx_pwr_all = lna_gain - (2 * VGA_idx); + + return rx_pwr_all; +} +#endif + +#if (RTL8192E_SUPPORT == 1) +s8 +phydm_cck_rssi_8192e( + struct PHY_DM_STRUCT *p_dm, + u16 LNA_idx, + u8 VGA_idx +) +{ + s8 rx_pwr_all = 0; + s8 lna_gain = 0; + s8 lna_gain_table_0[8] = {15, 9, -10, -21, -23, -27, -43, -44}; + s8 lna_gain_table_1[8] = {24, 18, 13, -4, -11, -18, -31, -36};/*use 8192EU to calibrate this table. 2015.12.15, Dino*/ + + if (p_dm->cck_agc_report_type == 0) + lna_gain = lna_gain_table_0[LNA_idx]; + else + lna_gain = lna_gain_table_1[LNA_idx]; + + rx_pwr_all = lna_gain - (2 * VGA_idx); + + return rx_pwr_all; +} +#endif + +#if (RTL8188E_SUPPORT == 1) +s8 +phydm_cck_rssi_8188e( + struct PHY_DM_STRUCT *p_dm, + u16 LNA_idx, + u8 VGA_idx +) +{ + s8 rx_pwr_all = 0; + s8 lna_gain = 0; + s8 lna_gain_table_0[8] = {17, -1, -13, -29, -32, -35, -38, -41};/*only use lna0/1/2/3/7*/ + s8 lna_gain_table_1[8] = {29, 20, 12, 3, -6, -15, -24, -33}; /*only use lna3 /7*/ + + if (p_dm->cut_version >= ODM_CUT_I) /*SMIC*/ + lna_gain = lna_gain_table_0[LNA_idx]; + else /*TSMC*/ + lna_gain = lna_gain_table_1[LNA_idx]; + + rx_pwr_all = lna_gain - (2 * VGA_idx); + + return rx_pwr_all; +} +#endif + +#if (RTL8821C_SUPPORT == 1) +s8 +phydm_cck_rssi_8821c( + struct PHY_DM_STRUCT *p_dm, + u8 LNA_idx, + u8 VGA_idx +) +{ + s8 rx_pwr_all = 0; + s8 lna_gain = 0; + s8 lna_gain_table_0[8] = {22, 8, -6, -22, -31, -40, -46, -52};/*only use lna2/3/5/7*/ + s8 lna_gain_table_1[16] = {10, 6, 2, -2, -6, -10, -14, -17, + -20, -24, -28, -31, -34, -37, -40, -44}; /*only use lna4/8/C/F*/ + + if (p_dm->cck_agc_report_type == 0) + lna_gain = lna_gain_table_0[LNA_idx]; + else + lna_gain = lna_gain_table_1[LNA_idx]; + + rx_pwr_all = lna_gain - (2 * VGA_idx); + + return rx_pwr_all; +} +#endif + +#if (ODM_IC_11N_SERIES_SUPPORT == 1) +void +phydm_rx_phy_status92c_series_parsing( + struct PHY_DM_STRUCT *p_dm, + struct phydm_phyinfo_struct *p_phy_info, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo +) +{ + u8 i, max_spatial_stream; + s8 rx_pwr[4], rx_pwr_all = 0; + u8 EVM, PWDB_ALL = 0, PWDB_ALL_BT; + u8 RSSI, total_rssi = 0; + boolean is_cck_rate = false; + u8 rf_rx_num = 0; + u8 LNA_idx = 0; + u8 VGA_idx = 0; + u8 cck_agc_rpt; + u8 num_ss; + u8 stream_rxevm_tmp = 0; + struct _phy_status_rpt_8192cd *p_phy_sta_rpt = (struct _phy_status_rpt_8192cd *)p_phy_status; + + is_cck_rate = (p_pktinfo->data_rate <= ODM_RATE11M) ? true : false; + p_dm->rate_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + + if (p_pktinfo->is_to_self) + p_dm->curr_station_id = p_pktinfo->station_id; + + p_phy_info->rx_mimo_signal_quality[RF_PATH_A] = -1; + p_phy_info->rx_mimo_signal_quality[RF_PATH_B] = -1; + + + if (is_cck_rate) { + p_dm->phy_dbg_info.num_qry_phy_status_cck++; + cck_agc_rpt = p_phy_sta_rpt->cck_agc_rpt_ofdm_cfosho_a; + + if (p_dm->support_ic_type & (ODM_RTL8703B)) { + +#if (RTL8703B_SUPPORT == 1) + if (p_dm->cck_agc_report_type == 1) { /*4 bit LNA*/ + + u8 cck_agc_rpt_b = (p_phy_sta_rpt->cck_rpt_b_ofdm_cfosho_b & BIT(7)) ? 1 : 0; + + LNA_idx = (cck_agc_rpt_b << 3) | ((cck_agc_rpt & 0xE0) >> 5); + VGA_idx = (cck_agc_rpt & 0x1F); + + rx_pwr_all = phydm_cck_rssi_8703B(LNA_idx, VGA_idx); + } +#endif + } else { /*3 bit LNA*/ + + LNA_idx = ((cck_agc_rpt & 0xE0) >> 5); + VGA_idx = (cck_agc_rpt & 0x1F); + + if (p_dm->support_ic_type & (ODM_RTL8188E)) { + +#if (RTL8188E_SUPPORT == 1) + rx_pwr_all = phydm_cck_rssi_8188e(p_dm, LNA_idx, VGA_idx); + /**/ +#endif + } +#if (RTL8192E_SUPPORT == 1) + else if (p_dm->support_ic_type & (ODM_RTL8192E)) { + + rx_pwr_all = phydm_cck_rssi_8192e(p_dm, LNA_idx, VGA_idx); + /**/ + } +#endif +#if (RTL8723B_SUPPORT == 1) + else if (p_dm->support_ic_type & (ODM_RTL8723B)) { + + rx_pwr_all = odm_CCKRSSI_8723B(LNA_idx, VGA_idx); + /**/ + } +#endif +#if (RTL8188F_SUPPORT == 1) + else if (p_dm->support_ic_type & (ODM_RTL8188F)) { + + rx_pwr_all = odm_CCKRSSI_8188F(LNA_idx, VGA_idx); + /**/ + } +#endif +#if (RTL8195A_SUPPORT == 1) + else if (p_dm->support_ic_type & (ODM_RTL8195A)) { + + rx_pwr_all = phydm_cck_rssi_8195a(LNA_idx, VGA_idx); + /**/ + } +#endif + } + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("ext_lna_gain (( %d )), LNA_idx: (( 0x%x )), VGA_idx: (( 0x%x )), rx_pwr_all: (( %d ))\n", + p_dm->ext_lna_gain, LNA_idx, VGA_idx, rx_pwr_all)); + + if (p_dm->board_type & ODM_BOARD_EXT_LNA) + rx_pwr_all -= p_dm->ext_lna_gain; + + PWDB_ALL = phydm_query_rx_pwr_percentage(rx_pwr_all); + + if (p_pktinfo->is_to_self) { + p_dm->cck_lna_idx = LNA_idx; + p_dm->cck_vga_idx = VGA_idx; + } + p_phy_info->rx_pwdb_all = PWDB_ALL; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + p_phy_info->bt_rx_rssi_percentage = PWDB_ALL; + p_phy_info->recv_signal_power = rx_pwr_all; +#endif + + /* (3) Get Signal Quality (EVM) */ + + + { + u8 SQ; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (p_dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) + SQ = phydm_sq_patch_rt_cid_819x_lenovo(p_dm, is_cck_rate, PWDB_ALL, 0, 0); + else if (p_dm->iot_table.win_patch_id == RT_CID_819X_ACER) + SQ = phydm_sq_patch_rt_cid_819x_acer(p_dm, is_cck_rate, PWDB_ALL, 0, 0); + else +#endif + SQ = phydm_get_signal_quality(p_phy_info, p_dm, p_phy_sta_rpt); + + /* dbg_print("cck SQ = %d\n", SQ); */ + p_phy_info->signal_quality = SQ; + p_phy_info->rx_mimo_signal_quality[RF_PATH_A] = SQ; + p_phy_info->rx_mimo_signal_quality[RF_PATH_B] = -1; + } + + for (i = RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { + if (i == 0) + p_phy_info->rx_mimo_signal_strength[0] = PWDB_ALL; + else + p_phy_info->rx_mimo_signal_strength[1] = 0; + } + } else { /* 2 is OFDM rate */ + p_dm->phy_dbg_info.num_qry_phy_status_ofdm++; + + /* */ + /* (1)Get RSSI for HT rate */ + /* */ + + for (i = RF_PATH_A; i < ODM_RF_PATH_MAX; i++) { + /* 2008/01/30 MH we will judge RF RX path now. */ + if (p_dm->rf_path_rx_enable & BIT(i)) + rf_rx_num++; + /* else */ + /* continue; */ + + rx_pwr[i] = ((p_phy_sta_rpt->path_agc[i].gain & 0x3F) * 2) - 110; + + if (p_pktinfo->is_to_self) { + p_dm->ofdm_agc_idx[i] = (p_phy_sta_rpt->path_agc[i].gain & 0x3F); + /**/ + } + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + p_phy_info->rx_pwr[i] = rx_pwr[i]; +#endif + + /* Translate DBM to percentage. */ + RSSI = phydm_query_rx_pwr_percentage(rx_pwr[i]); + total_rssi += RSSI; + /* RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI)); */ + + p_phy_info->rx_mimo_signal_strength[i] = (u8) RSSI; + + /* Get Rx snr value in DB */ + p_phy_info->rx_snr[i] = p_dm->phy_dbg_info.rx_snr_db[i] = (s8)(p_phy_sta_rpt->path_rxsnr[i] / 2); + + /* Record Signal Strength for next packet */ + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (i == RF_PATH_A) { + if (p_dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { + p_phy_info->signal_quality = phydm_sq_patch_rt_cid_819x_lenovo(p_dm, is_cck_rate, PWDB_ALL, i, RSSI); + } else if (p_dm->iot_table.win_patch_id == RT_CID_819X_ACER) + p_phy_info->signal_quality = phydm_sq_patch_rt_cid_819x_acer(p_dm, is_cck_rate, PWDB_ALL, 0, RSSI); + } +#endif + } + + + /* */ + /* (2)PWDB, Average PWDB calculated by hardware (for rate adaptive) */ + /* */ + rx_pwr_all = (((p_phy_sta_rpt->cck_sig_qual_ofdm_pwdb_all) >> 1) & 0x7f) - 110; + + PWDB_ALL_BT = PWDB_ALL = phydm_query_rx_pwr_percentage(rx_pwr_all); + + + p_phy_info->rx_pwdb_all = PWDB_ALL; + /* PHYDM_DBG(p_dm,DBG_RSSI_MNTR, ("ODM OFDM RSSI=%d\n",p_phy_info->rx_pwdb_all)); */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + p_phy_info->bt_rx_rssi_percentage = PWDB_ALL_BT; + p_phy_info->rx_power = rx_pwr_all; + p_phy_info->recv_signal_power = rx_pwr_all; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (p_dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { + /* do nothing */ + } else if (p_dm->iot_table.win_patch_id == RT_CID_819X_ACER) { + /* do nothing */ + } else +#endif + { + /* (3)EVM of HT rate */ + + if (p_pktinfo->data_rate >= ODM_RATEMCS8 && p_pktinfo->data_rate <= ODM_RATEMCS15) + max_spatial_stream = 2; /* both spatial stream make sense */ + else + max_spatial_stream = 1; /* only spatial stream 1 makes sense */ + + for (i = 0; i < max_spatial_stream; i++) { + /* Do not use shift operation like "rx_evmX >>= 1" because the compilor of free build environment */ + /* fill most significant bit to "zero" when doing shifting operation which may change a negative */ + /* value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore. */ + EVM = phydm_evm_db_to_percentage((p_phy_sta_rpt->stream_rxevm[i])); /* dbm */ + + /* GET_RX_STATUS_DESC_RX_MCS(p_desc), p_drv_info->rxevm[i], "%", EVM)); */ + + if (i == RF_PATH_A) /* Fill value in RFD, Get the first spatial stream only */ + p_phy_info->signal_quality = (u8)(EVM & 0xff); + + p_phy_info->rx_mimo_signal_quality[i] = (u8)(EVM & 0xff); + + if (p_phy_sta_rpt->stream_rxevm[i] < 0) + stream_rxevm_tmp = (u8)(0 - (p_phy_sta_rpt->stream_rxevm[i])); + + if (stream_rxevm_tmp == 64) + stream_rxevm_tmp = 0; + + p_phy_info->rx_mimo_evm_dbm[i] = stream_rxevm_tmp; + + } + } + + num_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + odm_parsing_cfo(p_dm, p_pktinfo, p_phy_sta_rpt->path_cfotail, num_ss); + + } +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + /* UI BSS List signal strength(in percentage), make it good looking, from 0~100. */ + /* It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp(). */ + if (is_cck_rate) { +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /* 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ */ + p_phy_info->signal_strength = SignalScaleProc(p_dm->adapter, PWDB_ALL, true, true); +#else + p_phy_info->signal_strength = (u8)(phydm_signal_scale_mapping(p_dm, PWDB_ALL));/*PWDB_ALL;*/ +#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + } else { + if (rf_rx_num != 0) { +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /* 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/ */ + p_phy_info->signal_strength = SignalScaleProc(p_dm->adapter, (total_rssi /= rf_rx_num), true, false); +#else + p_phy_info->signal_strength = (u8)(phydm_signal_scale_mapping(p_dm, total_rssi /= rf_rx_num)); +#endif + } + } +#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE))*/ + + /* dbg_print("is_cck_rate = %d, p_phy_info->rx_pwdb_all = %d, p_phy_sta_rpt->cck_agc_rpt_ofdm_cfosho_a = 0x%x\n", */ + /* is_cck_rate, p_phy_info->rx_pwdb_all, p_phy_sta_rpt->cck_agc_rpt_ofdm_cfosho_a); */ + + /* For 92C/92D HW (Hybrid) Antenna Diversity */ +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + /* For 88E HW Antenna Diversity */ + p_dm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->ant_sel; + p_dm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->ant_sel_b; + p_dm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antsel_rx_keep_2; +#endif + + if (p_pktinfo->is_packet_match_bssid) { + phydm_avg_phystatus_index(p_dm, p_phy_info, p_pktinfo); + phydm_rx_statistic_cal(p_dm, p_phy_status, p_pktinfo); + } + +} +#endif + +#if ODM_IC_11AC_SERIES_SUPPORT + +void +phydm_rx_phy_bw_jaguar_series_parsing( + struct phydm_phyinfo_struct *p_phy_info, + struct phydm_perpkt_info_struct *p_pktinfo, + struct _phy_status_rpt_8812 *p_phy_sta_rpt +) +{ + + if (p_pktinfo->data_rate <= ODM_RATE54M) { + switch (p_phy_sta_rpt->r_RFMOD) { + case 1: + if (p_phy_sta_rpt->sub_chnl == 0) + p_phy_info->band_width = 1; + else + p_phy_info->band_width = 0; + break; + + case 2: + if (p_phy_sta_rpt->sub_chnl == 0) + p_phy_info->band_width = 2; + else if (p_phy_sta_rpt->sub_chnl == 9 || p_phy_sta_rpt->sub_chnl == 10) + p_phy_info->band_width = 1; + else + p_phy_info->band_width = 0; + break; + + default: + case 0: + p_phy_info->band_width = 0; + break; + } + } + +} + +void +phydm_rx_phy_status_jaguar_series_parsing( + struct PHY_DM_STRUCT *p_dm, + struct phydm_phyinfo_struct *p_phy_info, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo +) +{ + u8 i, max_spatial_stream; + s8 rx_pwr[4], rx_pwr_all = 0; + u8 EVM = 0, evm_dbm, PWDB_ALL = 0, PWDB_ALL_BT; + u8 RSSI, avg_rssi = 0, best_rssi = 0, second_rssi = 0; + u8 is_cck_rate = 0; + u8 rf_rx_num = 0; + u8 cck_highpwr = 0; + u8 LNA_idx, VGA_idx; + struct _phy_status_rpt_8812 *p_phy_sta_rpt = (struct _phy_status_rpt_8812 *)p_phy_status; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u8 num_ss; + + phydm_rx_phy_bw_jaguar_series_parsing(p_phy_info, p_pktinfo, p_phy_sta_rpt); + + is_cck_rate = (p_pktinfo->data_rate <= ODM_RATE11M) ? true : false; + p_dm->rate_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + + if (p_pktinfo->is_to_self) + p_dm->curr_station_id = p_pktinfo->station_id; + else + p_dm->curr_station_id = 0xff; + + p_phy_info->rx_mimo_signal_quality[RF_PATH_A] = -1; + p_phy_info->rx_mimo_signal_quality[RF_PATH_B] = -1; + p_phy_info->rx_mimo_signal_quality[RF_PATH_C] = -1; + p_phy_info->rx_mimo_signal_quality[RF_PATH_D] = -1; + + if (is_cck_rate) { + u8 cck_agc_rpt; + + p_dm->phy_dbg_info.num_qry_phy_status_cck++; + + /*(1)Hardware does not provide RSSI for CCK*/ + /*(2)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ + + /*if(p_hal_data->e_rf_power_state == e_rf_on)*/ + cck_highpwr = p_dm->is_cck_high_power; + /*else*/ + /*cck_highpwr = false;*/ + + cck_agc_rpt = p_phy_sta_rpt->cfosho[0]; + LNA_idx = ((cck_agc_rpt & 0xE0) >> 5); + VGA_idx = (cck_agc_rpt & 0x1F); + + if (p_dm->support_ic_type == ODM_RTL8812) { + switch (LNA_idx) { + case 7: + if (VGA_idx <= 27) + rx_pwr_all = -100 + 2 * (27 - VGA_idx); /*VGA_idx = 27~2*/ + else + rx_pwr_all = -100; + break; + case 6: + rx_pwr_all = -48 + 2 * (2 - VGA_idx); /*VGA_idx = 2~0*/ + break; + case 5: + rx_pwr_all = -42 + 2 * (7 - VGA_idx); /*VGA_idx = 7~5*/ + break; + case 4: + rx_pwr_all = -36 + 2 * (7 - VGA_idx); /*VGA_idx = 7~4*/ + break; + case 3: + /*rx_pwr_all = -28 + 2*(7-VGA_idx); VGA_idx = 7~0*/ + rx_pwr_all = -24 + 2 * (7 - VGA_idx); /*VGA_idx = 7~0*/ + break; + case 2: + if (cck_highpwr) + rx_pwr_all = -12 + 2 * (5 - VGA_idx); /*VGA_idx = 5~0*/ + else + rx_pwr_all = -6 + 2 * (5 - VGA_idx); + break; + case 1: + rx_pwr_all = 8 - 2 * VGA_idx; + break; + case 0: + rx_pwr_all = 14 - 2 * VGA_idx; + break; + default: + /*dbg_print("CCK Exception default\n");*/ + break; + } + rx_pwr_all += 6; + PWDB_ALL = phydm_query_rx_pwr_percentage(rx_pwr_all); + + if (cck_highpwr == false) { + if (PWDB_ALL >= 80) + PWDB_ALL = ((PWDB_ALL - 80) << 1) + ((PWDB_ALL - 80) >> 1) + 80; + else if ((PWDB_ALL <= 78) && (PWDB_ALL >= 20)) + PWDB_ALL += 3; + if (PWDB_ALL > 100) + PWDB_ALL = 100; + } + } else if (p_dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A)) { + s8 pout = -6; + + switch (LNA_idx) { + case 5: + rx_pwr_all = pout - 32 - (2 * VGA_idx); + break; + case 4: + rx_pwr_all = pout - 24 - (2 * VGA_idx); + break; + case 2: + rx_pwr_all = pout - 11 - (2 * VGA_idx); + break; + case 1: + rx_pwr_all = pout + 5 - (2 * VGA_idx); + break; + case 0: + rx_pwr_all = pout + 21 - (2 * VGA_idx); + break; + } + PWDB_ALL = phydm_query_rx_pwr_percentage(rx_pwr_all); + } else if (p_dm->support_ic_type == ODM_RTL8814A || p_dm->support_ic_type == ODM_RTL8822B) { + s8 pout = -6; + + switch (LNA_idx) { + /*CCK only use LNA: 2, 3, 5, 7*/ + case 7: + rx_pwr_all = pout - 32 - (2 * VGA_idx); + break; + case 5: + rx_pwr_all = pout - 22 - (2 * VGA_idx); + break; + case 3: + rx_pwr_all = pout - 2 - (2 * VGA_idx); + break; + case 2: + rx_pwr_all = pout + 5 - (2 * VGA_idx); + break; + /*case 6:*/ + /*rx_pwr_all = pout -26 - (2*VGA_idx);*/ + /*break;*/ + /*case 4:*/ + /*rx_pwr_all = pout - 8 - (2*VGA_idx);*/ + /*break;*/ + /*case 1:*/ + /*rx_pwr_all = pout + 21 - (2*VGA_idx);*/ + /*break;*/ + /*case 0:*/ + /*rx_pwr_all = pout + 10 - (2*VGA_idx);*/ + /* break; */ + default: + /* dbg_print("CCK Exception default\n"); */ + break; + } + PWDB_ALL = phydm_query_rx_pwr_percentage(rx_pwr_all); + } + + p_dm->cck_lna_idx = LNA_idx; + p_dm->cck_vga_idx = VGA_idx; + p_phy_info->rx_pwdb_all = PWDB_ALL; + /* if(p_pktinfo->station_id == 0) */ + /* { */ + /* dbg_print("CCK: LNA_idx = %d, VGA_idx = %d, p_phy_info->rx_pwdb_all = %d\n", */ + /* LNA_idx, VGA_idx, p_phy_info->rx_pwdb_all); */ + /* } */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + p_phy_info->bt_rx_rssi_percentage = PWDB_ALL; + p_phy_info->recv_signal_power = rx_pwr_all; +#endif + /*(3) Get Signal Quality (EVM)*/ + /*if (p_pktinfo->is_packet_match_bssid)*/ + { + u8 SQ, SQ_rpt; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (p_dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) + SQ = phydm_sq_patch_rt_cid_819x_lenovo(p_dm, is_cck_rate, PWDB_ALL, 0, 0); + else +#endif + if (p_phy_info->rx_pwdb_all > 40 && !p_dm->is_in_hct_test) + SQ = 100; + else { + SQ_rpt = p_phy_sta_rpt->pwdb_all; + + if (SQ_rpt > 64) + SQ = 0; + else if (SQ_rpt < 20) + SQ = 100; + else + SQ = ((64 - SQ_rpt) * 100) / 44; + } + + /* dbg_print("cck SQ = %d\n", SQ); */ + p_phy_info->signal_quality = SQ; + p_phy_info->rx_mimo_signal_quality[RF_PATH_A] = SQ; + } + + for (i = RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { + if (i == 0) + p_phy_info->rx_mimo_signal_strength[0] = PWDB_ALL; + else + p_phy_info->rx_mimo_signal_strength[i] = 0; + } + } else { + /*is OFDM rate*/ + p_dm_fat_table->hw_antsw_occur = p_phy_sta_rpt->hw_antsw_occur; + + p_dm->phy_dbg_info.num_qry_phy_status_ofdm++; + + /*(1)Get RSSI for OFDM rate*/ + + for (i = RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { + /*2008/01/30 MH we will judge RF RX path now.*/ + /* dbg_print("p_dm->rf_path_rx_enable = %x\n", p_dm->rf_path_rx_enable); */ + if (p_dm->rf_path_rx_enable & BIT(i)) + rf_rx_num++; + /* else */ + /* continue; */ + /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ + /* if((p_dm->support_ic_type & (ODM_RTL8812|ODM_RTL8821)) && (!p_dm->is_mp_chip)) */ + if (i < RF_PATH_C) { + rx_pwr[i] = (p_phy_sta_rpt->gain_trsw[i] & 0x7F) - 110; + + if (p_pktinfo->is_to_self) + p_dm->ofdm_agc_idx[i] = p_phy_sta_rpt->gain_trsw[i]; + + } else + rx_pwr[i] = (p_phy_sta_rpt->gain_trsw_cd[i - 2] & 0x7F) - 110; + /* else */ + /*rx_pwr[i] = ((p_phy_sta_rpt->gain_trsw[i]& 0x3F)*2) - 110; OLD FORMULA*/ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + p_phy_info->rx_pwr[i] = rx_pwr[i]; +#endif + + /* Translate DBM to percentage. */ + RSSI = phydm_query_rx_pwr_percentage(rx_pwr[i]); + + /*total_rssi += RSSI;*/ + /*Get the best two RSSI*/ + if (RSSI > best_rssi && RSSI > second_rssi) { + second_rssi = best_rssi; + best_rssi = RSSI; + } else if (RSSI > second_rssi && RSSI <= best_rssi) + second_rssi = RSSI; + + /*RT_DISP(FRX, RX_PHY_SS, ("RF-%d RXPWR=%x RSSI=%d\n", i, rx_pwr[i], RSSI));*/ + + p_phy_info->rx_mimo_signal_strength[i] = (u8) RSSI; + + + /*Get Rx snr value in DB*/ + if (i < RF_PATH_C) + p_phy_info->rx_snr[i] = p_dm->phy_dbg_info.rx_snr_db[i] = p_phy_sta_rpt->rxsnr[i] / 2; + else if (p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) + p_phy_info->rx_snr[i] = p_dm->phy_dbg_info.rx_snr_db[i] = p_phy_sta_rpt->csi_current[i - 2] / 2; + +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) + /*(2) CFO_short & CFO_tail*/ + if (i < RF_PATH_C) { + p_phy_info->cfo_short[i] = phydm_cfo((p_phy_sta_rpt->cfosho[i])); + p_phy_info->cfo_tail[i] = phydm_cfo((p_phy_sta_rpt->cfotail[i])); + } +#endif + /* Record Signal Strength for next packet */ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (p_pktinfo->is_packet_match_bssid && (i == RF_PATH_A)) { + if (p_dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { + p_phy_info->signal_quality = phydm_sq_patch_rt_cid_819x_lenovo(p_dm, is_cck_rate, PWDB_ALL, i, RSSI); + } + } +#endif + } + + /*(3)PWDB, Average PWDB calculated by hardware (for rate adaptive)*/ + + /*2012.05.25 LukeLee: Testchip AGC report is wrong, it should be restored back to old formula in MP chip*/ + if ((p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A)) && (!p_dm->is_mp_chip)) + rx_pwr_all = (p_phy_sta_rpt->pwdb_all & 0x7f) - 110; + else + rx_pwr_all = (((p_phy_sta_rpt->pwdb_all) >> 1) & 0x7f) - 110; /*OLD FORMULA*/ + + PWDB_ALL_BT = PWDB_ALL = phydm_query_rx_pwr_percentage(rx_pwr_all); + + p_phy_info->rx_pwdb_all = PWDB_ALL; + /*PHYDM_DBG(p_dm,DBG_RSSI_MNTR, ("ODM OFDM RSSI=%d\n",p_phy_info->rx_pwdb_all));*/ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + p_phy_info->bt_rx_rssi_percentage = PWDB_ALL_BT; + p_phy_info->rx_power = rx_pwr_all; + p_phy_info->recv_signal_power = rx_pwr_all; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (p_dm->iot_table.win_patch_id == RT_CID_819X_LENOVO) { + /*do nothing*/ + } else +#endif + { + /*(4)EVM of OFDM rate*/ + + if ((p_pktinfo->data_rate >= ODM_RATEMCS8) && + (p_pktinfo->data_rate <= ODM_RATEMCS15)) + max_spatial_stream = 2; + else if ((p_pktinfo->data_rate >= ODM_RATEVHTSS2MCS0) && + (p_pktinfo->data_rate <= ODM_RATEVHTSS2MCS9)) + max_spatial_stream = 2; + else if ((p_pktinfo->data_rate >= ODM_RATEMCS16) && + (p_pktinfo->data_rate <= ODM_RATEMCS23)) + max_spatial_stream = 3; + else if ((p_pktinfo->data_rate >= ODM_RATEVHTSS3MCS0) && + (p_pktinfo->data_rate <= ODM_RATEVHTSS3MCS9)) + max_spatial_stream = 3; + else + max_spatial_stream = 1; + + /*if (p_pktinfo->is_packet_match_bssid) */ + { + /*dbg_print("p_pktinfo->data_rate = %d\n", p_pktinfo->data_rate);*/ + + for (i = 0; i < max_spatial_stream; i++) { + /*Do not use shift operation like "rx_evmX >>= 1" because the compilor of free build environment*/ + /*fill most significant bit to "zero" when doing shifting operation which may change a negative*/ + /*value to positive one, then the dbm value (which is supposed to be negative) is not correct anymore.*/ + + if (p_pktinfo->data_rate >= ODM_RATE6M && p_pktinfo->data_rate <= ODM_RATE54M) { + if (i == RF_PATH_A) { + EVM = phydm_evm_db_to_percentage((p_phy_sta_rpt->sigevm)); /*dbm*/ + EVM += 20; + if (EVM > 100) + EVM = 100; + } + } else { + if (i < RF_PATH_C) { + if (p_phy_sta_rpt->rxevm[i] == -128) + p_phy_sta_rpt->rxevm[i] = -25; + EVM = phydm_evm_db_to_percentage((p_phy_sta_rpt->rxevm[i])); /*dbm*/ + } else { + if (p_phy_sta_rpt->rxevm_cd[i - 2] == -128) + p_phy_sta_rpt->rxevm_cd[i - 2] = -25; + EVM = phydm_evm_db_to_percentage((p_phy_sta_rpt->rxevm_cd[i - 2])); /*dbm*/ + } + } + + if (i < RF_PATH_C) + evm_dbm = phydm_evm_dbm_jaguar_series(p_phy_sta_rpt->rxevm[i]); + else + evm_dbm = phydm_evm_dbm_jaguar_series(p_phy_sta_rpt->rxevm_cd[i - 2]); + /*RT_DISP(FRX, RX_PHY_SQ, ("RXRATE=%x RXEVM=%x EVM=%s%d\n",*/ + /*p_pktinfo->data_rate, p_phy_sta_rpt->rxevm[i], "%", EVM));*/ + + { + if (i == RF_PATH_A) { + /*Fill value in RFD, Get the first spatial stream only*/ + p_phy_info->signal_quality = EVM; + } + p_phy_info->rx_mimo_signal_quality[i] = EVM; +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) + p_phy_info->rx_mimo_evm_dbm[i] = evm_dbm; +#endif + } + } + } + } + + num_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + odm_parsing_cfo(p_dm, p_pktinfo, p_phy_sta_rpt->cfotail, num_ss); + + } + /* dbg_print("is_cck_rate= %d, p_phy_info->signal_strength=%d % PWDB_AL=%d rf_rx_num=%d\n", is_cck_rate, p_phy_info->signal_strength, PWDB_ALL, rf_rx_num); */ + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + /*UI BSS List signal strength(in percentage), make it good looking, from 0~100.*/ + /*It is assigned to the BSS List in GetValueFromBeaconOrProbeRsp().*/ + if (is_cck_rate) { +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /*2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ + p_phy_info->signal_strength = SignalScaleProc(p_dm->adapter, PWDB_ALL, false, true); +#else + p_phy_info->signal_strength = (u8)(phydm_signal_scale_mapping(p_dm, PWDB_ALL));/*PWDB_ALL;*/ +#endif + } else { + if (rf_rx_num != 0) { + /* 2015/01 Sean, use the best two RSSI only, suggested by Ynlin and ChenYu.*/ + if (rf_rx_num == 1) + avg_rssi = best_rssi; + else + avg_rssi = (best_rssi + second_rssi) / 2; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + /* 2012/01/12 MH Use customeris signal strength from HalComRxdDesc.c/*/ + p_phy_info->signal_strength = SignalScaleProc(p_dm->adapter, avg_rssi, false, false); +#else + p_phy_info->signal_strength = (u8)(phydm_signal_scale_mapping(p_dm, avg_rssi)); +#endif + } + } +#endif + p_dm->rx_pwdb_ave = p_dm->rx_pwdb_ave + p_phy_info->rx_pwdb_all; + + p_dm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->antidx_anta; + p_dm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->antidx_antb; + p_dm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antidx_antc; + p_dm->dm_fat_table.antsel_rx_keep_3 = p_phy_sta_rpt->antidx_antd; + + if (p_pktinfo->is_packet_match_bssid) { + phydm_avg_phystatus_index(p_dm, p_phy_info, p_pktinfo); + phydm_rx_statistic_cal(p_dm, p_phy_status, p_pktinfo); + } + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("StaID[%d]: antidx_anta = ((%d)), MatchBSSID = ((%d))\n", p_pktinfo->station_id, p_phy_sta_rpt->antidx_anta, p_pktinfo->is_packet_match_bssid));*/ + + + /* dbg_print("p_phy_sta_rpt->antidx_anta = %d, p_phy_sta_rpt->antidx_antb = %d\n",*/ + /* p_phy_sta_rpt->antidx_anta, p_phy_sta_rpt->antidx_antb);*/ + /* dbg_print("----------------------------\n");*/ + /* dbg_print("p_pktinfo->station_id=%d, p_pktinfo->data_rate=0x%x\n",p_pktinfo->station_id, p_pktinfo->data_rate);*/ + /* dbg_print("p_phy_sta_rpt->r_RFMOD = %d\n", p_phy_sta_rpt->r_RFMOD);*/ + /* dbg_print("p_phy_sta_rpt->gain_trsw[0]=0x%x, p_phy_sta_rpt->gain_trsw[1]=0x%x\n",*/ + /* p_phy_sta_rpt->gain_trsw[0],p_phy_sta_rpt->gain_trsw[1]);*/ + /* dbg_print("p_phy_sta_rpt->gain_trsw[2]=0x%x, p_phy_sta_rpt->gain_trsw[3]=0x%x\n",*/ + /* p_phy_sta_rpt->gain_trsw_cd[0],p_phy_sta_rpt->gain_trsw_cd[1]);*/ + /* dbg_print("p_phy_sta_rpt->pwdb_all = 0x%x, p_phy_info->rx_pwdb_all = %d\n", p_phy_sta_rpt->pwdb_all, p_phy_info->rx_pwdb_all);*/ + /* dbg_print("p_phy_sta_rpt->cfotail[i] = 0x%x, p_phy_sta_rpt->CFO_tail[i] = 0x%x\n", p_phy_sta_rpt->cfotail[0], p_phy_sta_rpt->cfotail[1]);*/ + /* dbg_print("p_phy_sta_rpt->rxevm[0] = %d, p_phy_sta_rpt->rxevm[1] = %d\n", p_phy_sta_rpt->rxevm[0], p_phy_sta_rpt->rxevm[1]);*/ + /* dbg_print("p_phy_sta_rpt->rxevm[2] = %d, p_phy_sta_rpt->rxevm[3] = %d\n", p_phy_sta_rpt->rxevm_cd[0], p_phy_sta_rpt->rxevm_cd[1]);*/ + /* dbg_print("p_phy_info->rx_mimo_signal_strength[0]=%d, p_phy_info->rx_mimo_signal_strength[1]=%d, rx_pwdb_all=%d\n",*/ + /* p_phy_info->rx_mimo_signal_strength[0], p_phy_info->rx_mimo_signal_strength[1], p_phy_info->rx_pwdb_all);*/ + /* dbg_print("p_phy_info->rx_mimo_signal_strength[2]=%d, p_phy_info->rx_mimo_signal_strength[3]=%d\n",*/ + /* p_phy_info->rx_mimo_signal_strength[2], p_phy_info->rx_mimo_signal_strength[3]);*/ + /* dbg_print("ppPhyInfo->rx_mimo_signal_quality[0]=%d, p_phy_info->rx_mimo_signal_quality[1]=%d\n",*/ + /* p_phy_info->rx_mimo_signal_quality[0], p_phy_info->rx_mimo_signal_quality[1]);*/ + /* dbg_print("ppPhyInfo->rx_mimo_signal_quality[2]=%d, p_phy_info->rx_mimo_signal_quality[3]=%d\n",*/ + /* p_phy_info->rx_mimo_signal_quality[2], p_phy_info->rx_mimo_signal_quality[3]);*/ + +} + +#endif + +void +phydm_reset_rssi_for_dm( + struct PHY_DM_STRUCT *p_dm, + u8 station_id +) +{ + struct cmn_sta_info *p_sta; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); +#endif + p_sta = p_dm->p_phydm_sta_info[station_id]; + + if (!is_sta_active(p_sta)) { + /**/ + return; + } + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("Reset RSSI for macid = (( %d ))\n", station_id)); + + + p_sta->rssi_stat.rssi_cck = -1; + p_sta->rssi_stat.rssi_ofdm = -1; + p_sta->rssi_stat.rssi = -1; + p_sta->rssi_stat.ofdm_pkt_cnt = 0; + p_sta->rssi_stat.cck_pkt_cnt = 0; + p_sta->rssi_stat.cck_sum_power = 0; + p_sta->rssi_stat.is_send_rssi = RA_RSSI_STATE_INIT; + p_sta->rssi_stat.packet_map = 0; + p_sta->rssi_stat.valid_bit = 0; + + /*in WIN Driver: sta_ID==0->p_entry==NULL -> default port HAL_Data*/ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + p_sta->dm_ctrl = p_sta->dm_ctrl & (~STA_DM_CTRL_ACTIVE); + if (station_id == 0) { + + p_hal_data->UndecoratedSmoothedPWDB = -1; + /**/ + } +#endif + +} + +void +phydm_process_rssi_for_dm( + struct PHY_DM_STRUCT *p_dm, + struct phydm_phyinfo_struct *p_phy_info, + struct phydm_perpkt_info_struct *p_pktinfo +) +{ + + s32 rssi_ave; + s8 undecorated_smoothed_pwdb, undecorated_smoothed_cck, undecorated_smoothed_ofdm; + u8 i, is_cck_rate = 0; + u8 RSSI_max, RSSI_min; + u32 weighting = 0; + u8 send_rssi_2_fw = 0; + struct cmn_sta_info *p_sta; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); +#endif + + if (p_pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) + return; + +#ifdef CONFIG_S0S1_SW_ANTENNA_DIVERSITY + odm_s0s1_sw_ant_div_by_ctrl_frame_process_rssi(p_dm, p_phy_info, p_pktinfo); +#endif + + p_sta = p_dm->p_phydm_sta_info[p_pktinfo->station_id]; + + if (!is_sta_active(p_sta)) { + return; + /**/ + } + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if ((p_dm->support_ability & ODM_BB_ANT_DIV) && + (p_dm_fat_table->enable_ctrl_frame_antdiv) + ) { + if (p_pktinfo->is_packet_match_bssid) + p_dm->data_frame_num++; + + if ((p_dm_fat_table->use_ctrl_frame_antdiv)) { + if (!p_pktinfo->is_to_self)/*data frame + CTRL frame*/ + return; + } else { + if ((!p_pktinfo->is_packet_match_bssid))/*data frame only*/ + return; + } + } else +#endif + { + if ((!p_pktinfo->is_packet_match_bssid))/*data frame only*/ + return; + } + + if (p_pktinfo->is_packet_beacon) + p_dm->phy_dbg_info.num_qry_beacon_pkt++; + + is_cck_rate = (p_pktinfo->data_rate <= ODM_RATE11M) ? true : false; + p_dm->rx_rate = p_pktinfo->data_rate; + + /* --------------Statistic for antenna/path diversity------------------ */ + if (p_dm->support_ability & ODM_BB_ANT_DIV) { +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + odm_process_rssi_for_ant_div(p_dm, p_phy_info, p_pktinfo); +#endif + } +#if (defined(CONFIG_PATH_DIVERSITY)) + else if (p_dm->support_ability & ODM_BB_PATH_DIV) + phydm_process_rssi_for_path_div(p_dm, p_phy_info, p_pktinfo); +#endif + /* -----------------Smart Antenna Debug Message------------------ */ + + undecorated_smoothed_cck = p_sta->rssi_stat.rssi_cck; + undecorated_smoothed_ofdm = p_sta->rssi_stat.rssi_ofdm; + undecorated_smoothed_pwdb = p_sta->rssi_stat.rssi; + + if (p_pktinfo->is_packet_to_self || p_pktinfo->is_packet_beacon) { + + if (!is_cck_rate) { /* ofdm rate */ +#if (RTL8814A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type & (ODM_RTL8814A | ODM_RTL8822B)) { + u8 RX_count = 0; + u32 RSSI_linear = 0; + + if (p_dm->rx_ant_status & BB_PATH_A) { + p_dm->RSSI_A = p_phy_info->rx_mimo_signal_strength[RF_PATH_A]; + RX_count++; + RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[RF_PATH_A]); + } else + p_dm->RSSI_A = 0; + + if (p_dm->rx_ant_status & BB_PATH_B) { + p_dm->RSSI_B = p_phy_info->rx_mimo_signal_strength[RF_PATH_B]; + RX_count++; + RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[RF_PATH_B]); + } else + p_dm->RSSI_B = 0; + + if (p_dm->rx_ant_status & BB_PATH_C) { + p_dm->RSSI_C = p_phy_info->rx_mimo_signal_strength[RF_PATH_C]; + RX_count++; + RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[RF_PATH_C]); + } else + p_dm->RSSI_C = 0; + + if (p_dm->rx_ant_status & BB_PATH_D) { + p_dm->RSSI_D = p_phy_info->rx_mimo_signal_strength[RF_PATH_D]; + RX_count++; + RSSI_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[RF_PATH_D]); + } else + p_dm->RSSI_D = 0; + + /* Calculate average RSSI */ + switch (RX_count) { + case 2: + RSSI_linear = (RSSI_linear >> 1); + break; + case 3: + RSSI_linear = ((RSSI_linear) + (RSSI_linear << 1) + (RSSI_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ + break; + case 4: + RSSI_linear = (RSSI_linear >> 2); + break; + } + rssi_ave = odm_convert_to_db(RSSI_linear); + } else +#endif + { + if (p_phy_info->rx_mimo_signal_strength[RF_PATH_B] == 0) { + rssi_ave = p_phy_info->rx_mimo_signal_strength[RF_PATH_A]; + p_dm->RSSI_A = p_phy_info->rx_mimo_signal_strength[RF_PATH_A]; + p_dm->RSSI_B = 0; + } else { + /*dbg_print("p_rfd->status.rx_mimo_signal_strength[0] = %d, p_rfd->status.rx_mimo_signal_strength[1] = %d\n",*/ + /*p_rfd->status.rx_mimo_signal_strength[0], p_rfd->status.rx_mimo_signal_strength[1]);*/ + p_dm->RSSI_A = p_phy_info->rx_mimo_signal_strength[RF_PATH_A]; + p_dm->RSSI_B = p_phy_info->rx_mimo_signal_strength[RF_PATH_B]; + + if (p_phy_info->rx_mimo_signal_strength[RF_PATH_A] > p_phy_info->rx_mimo_signal_strength[RF_PATH_B]) { + RSSI_max = p_phy_info->rx_mimo_signal_strength[RF_PATH_A]; + RSSI_min = p_phy_info->rx_mimo_signal_strength[RF_PATH_B]; + } else { + RSSI_max = p_phy_info->rx_mimo_signal_strength[RF_PATH_B]; + RSSI_min = p_phy_info->rx_mimo_signal_strength[RF_PATH_A]; + } + if ((RSSI_max - RSSI_min) < 3) + rssi_ave = RSSI_max; + else if ((RSSI_max - RSSI_min) < 6) + rssi_ave = RSSI_max - 1; + else if ((RSSI_max - RSSI_min) < 10) + rssi_ave = RSSI_max - 2; + else + rssi_ave = RSSI_max - 3; + } + } + + /* 1 Process OFDM RSSI */ + if (undecorated_smoothed_ofdm <= 0) { /* initialize */ + undecorated_smoothed_ofdm = (s8)p_phy_info->rx_pwdb_all; + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("OFDM_INIT: (( %d ))\n", undecorated_smoothed_ofdm)); + } else { + if (p_phy_info->rx_pwdb_all > (u32)undecorated_smoothed_ofdm) { + undecorated_smoothed_ofdm = + (s8)((((undecorated_smoothed_ofdm)*(RX_SMOOTH_FACTOR - 1)) + + (rssi_ave)) / (RX_SMOOTH_FACTOR)); + undecorated_smoothed_ofdm = undecorated_smoothed_ofdm + 1; + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("OFDM_1: (( %d ))\n", undecorated_smoothed_ofdm)); + } else { + undecorated_smoothed_ofdm = + (s8)((((undecorated_smoothed_ofdm)*(RX_SMOOTH_FACTOR - 1)) + + (rssi_ave)) / (RX_SMOOTH_FACTOR)); + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("OFDM_2: (( %d ))\n", undecorated_smoothed_ofdm)); + } + } + if (p_sta->rssi_stat.ofdm_pkt_cnt != 64) { + i = 63; + p_sta->rssi_stat.ofdm_pkt_cnt -= (u8)(((p_sta->rssi_stat.packet_map >> i) & BIT(0)) - 1); + } + p_sta->rssi_stat.packet_map = (p_sta->rssi_stat.packet_map << 1) | BIT(0); + + } else { + rssi_ave = p_phy_info->rx_pwdb_all; + p_dm->RSSI_A = (u8) p_phy_info->rx_pwdb_all; + p_dm->RSSI_B = 0xFF; + p_dm->RSSI_C = 0xFF; + p_dm->RSSI_D = 0xFF; + + if (p_sta->rssi_stat.cck_pkt_cnt <= 63) + p_sta->rssi_stat.cck_pkt_cnt++; + + /* 1 Process CCK RSSI */ + if (undecorated_smoothed_cck <= 0) { /* initialize */ + undecorated_smoothed_cck = (s8)p_phy_info->rx_pwdb_all; + p_sta->rssi_stat.cck_sum_power = (u16)p_phy_info->rx_pwdb_all ; /*reset*/ + p_sta->rssi_stat.cck_pkt_cnt = 1; /*reset*/ + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("CCK_INIT: (( %d ))\n", undecorated_smoothed_cck)); + } else if (p_sta->rssi_stat.cck_pkt_cnt <= CCK_RSSI_INIT_COUNT) { + + p_sta->rssi_stat.cck_sum_power = p_sta->rssi_stat.cck_sum_power + (u16)p_phy_info->rx_pwdb_all; + undecorated_smoothed_cck = p_sta->rssi_stat.cck_sum_power / p_sta->rssi_stat.cck_pkt_cnt; + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("CCK_0: (( %d )), SumPow = (( %d )), cck_pkt = (( %d ))\n", + undecorated_smoothed_cck, p_sta->rssi_stat.cck_sum_power, p_sta->rssi_stat.cck_pkt_cnt)); + } else { + if (p_phy_info->rx_pwdb_all > (u32)undecorated_smoothed_cck) { + undecorated_smoothed_cck = + (s8)((((undecorated_smoothed_cck)*(RX_SMOOTH_FACTOR - 1)) + + (p_phy_info->rx_pwdb_all)) / (RX_SMOOTH_FACTOR)); + undecorated_smoothed_cck = undecorated_smoothed_cck + 1; + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("CCK_1: (( %d ))\n", undecorated_smoothed_cck)); + } else { + undecorated_smoothed_cck = + (s8)((((undecorated_smoothed_cck)*(RX_SMOOTH_FACTOR - 1)) + + (p_phy_info->rx_pwdb_all)) / (RX_SMOOTH_FACTOR)); + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("CCK_2: (( %d ))\n", undecorated_smoothed_cck)); + } + } + i = 63; + p_sta->rssi_stat.ofdm_pkt_cnt -= (u8)((p_sta->rssi_stat.packet_map >> i) & BIT(0)); + p_sta->rssi_stat.packet_map = p_sta->rssi_stat.packet_map << 1; + } + + /* if(p_entry) */ + { + /* 2011.07.28 LukeLee: modified to prevent unstable CCK RSSI */ + if (p_sta->rssi_stat.ofdm_pkt_cnt == 64) { /* speed up when all packets are OFDM*/ + undecorated_smoothed_pwdb = undecorated_smoothed_ofdm; + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("PWDB_0[%d] = (( %d ))\n", p_pktinfo->station_id, undecorated_smoothed_cck)); + } else { + if (p_sta->rssi_stat.valid_bit < 64) + p_sta->rssi_stat.valid_bit++; + + if (p_sta->rssi_stat.valid_bit == 64) { + weighting = ((p_sta->rssi_stat.ofdm_pkt_cnt) > 4) ? 64 : (p_sta->rssi_stat.ofdm_pkt_cnt << 4); + undecorated_smoothed_pwdb = (s8)((weighting * undecorated_smoothed_ofdm + (64 - weighting) * undecorated_smoothed_cck) >> 6); + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("PWDB_1[%d] = (( %d )), W = (( %d ))\n", p_pktinfo->station_id, undecorated_smoothed_cck, weighting)); + } else { + if (p_sta->rssi_stat.valid_bit != 0) + undecorated_smoothed_pwdb = + (p_sta->rssi_stat.ofdm_pkt_cnt * undecorated_smoothed_ofdm + (p_sta->rssi_stat.valid_bit - p_sta->rssi_stat.ofdm_pkt_cnt) * undecorated_smoothed_cck) / p_sta->rssi_stat.valid_bit; + else + undecorated_smoothed_pwdb = 0; + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("PWDB_2[%d] = (( %d )), ofdm_pkt = (( %d )), Valid_Bit = (( %d ))\n", + p_pktinfo->station_id, undecorated_smoothed_cck, p_sta->rssi_stat.ofdm_pkt_cnt, p_sta->rssi_stat.valid_bit)); + } + } + + + if ((p_sta->rssi_stat.ofdm_pkt_cnt >= 1 || p_sta->rssi_stat.cck_pkt_cnt >= 5) && (p_sta->rssi_stat.is_send_rssi == RA_RSSI_STATE_INIT)) { + + send_rssi_2_fw = 1; + p_sta->rssi_stat.is_send_rssi = RA_RSSI_STATE_SEND; + } + + p_sta->rssi_stat.rssi_cck = undecorated_smoothed_cck; + p_sta->rssi_stat.rssi_ofdm = undecorated_smoothed_ofdm; + p_sta->rssi_stat.rssi = undecorated_smoothed_pwdb; + + + + if (send_rssi_2_fw) { /* Trigger init rate by RSSI */ + + if (p_sta->rssi_stat.ofdm_pkt_cnt != 0) + p_sta->rssi_stat.rssi = undecorated_smoothed_ofdm; + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, + ("[Send to FW] PWDB = (( %d )), ofdm_pkt = (( %d )), cck_pkt = (( %d ))\n", + undecorated_smoothed_pwdb, p_sta->rssi_stat.ofdm_pkt_cnt, p_sta->rssi_stat.cck_pkt_cnt)); + + } + + + /*in WIN Driver: sta_ID==0->p_entry==NULL -> default port HAL_Data*/ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + + if (p_pktinfo->station_id == 0) { + /**/ + p_hal_data->UndecoratedSmoothedPWDB = undecorated_smoothed_pwdb; + } +#endif + + /* dbg_print("ofdm_pkt=%d, weighting=%d\n", ofdm_pkt_cnt, weighting); */ + /* dbg_print("undecorated_smoothed_ofdm=%d, undecorated_smoothed_pwdb=%d, undecorated_smoothed_cck=%d\n", */ + /* undecorated_smoothed_ofdm, undecorated_smoothed_pwdb, undecorated_smoothed_cck); */ + + } + + } +} + +/* + * Endianness before calling this API + * */ + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) +/* For 8822B only!! need to move to FW finally */ +/*==============================================*/ + +boolean +phydm_query_is_mu_api( + struct PHY_DM_STRUCT *p_phydm, + u8 ppdu_idx, + u8 *p_data_rate, + u8 *p_gid +) +{ + u8 data_rate = 0, gid = 0; + boolean is_mu = false; + + data_rate = p_phydm->phy_dbg_info.num_of_ppdu[ppdu_idx]; + gid = p_phydm->phy_dbg_info.gid_num[ppdu_idx]; + + if (data_rate & BIT(7)) { + is_mu = true; + data_rate = data_rate & ~(BIT(7)); + } else + is_mu = false; + + *p_data_rate = data_rate; + *p_gid = gid; + + return is_mu; + +} + +void +phydm_reset_phy_info( + struct PHY_DM_STRUCT *p_phydm, + struct phydm_phyinfo_struct *p_phy_info +) +{ + p_phy_info->rx_pwdb_all = 0; + p_phy_info->signal_quality = 0; + p_phy_info->band_width = 0; + p_phy_info->rx_count = 0; + odm_memory_set(p_phydm, p_phy_info->rx_mimo_signal_quality, 0, 4); + odm_memory_set(p_phydm, p_phy_info->rx_mimo_signal_strength, 0, 4); + odm_memory_set(p_phydm, p_phy_info->rx_snr, 0, 4); + + p_phy_info->rx_power = -110; + p_phy_info->recv_signal_power = -110; + p_phy_info->bt_rx_rssi_percentage = 0; + p_phy_info->signal_strength = 0; + p_phy_info->channel = 0; + p_phy_info->is_mu_packet = 0; + p_phy_info->is_beamformed = 0; + p_phy_info->rxsc = 0; + odm_memory_set(p_phydm, p_phy_info->rx_pwr, -110, 4); + /*odm_memory_set(p_phydm, p_phy_info->rx_mimo_evm_dbm, 0, 4);*/ + odm_memory_set(p_phydm, p_phy_info->cfo_short, 0, 8); + odm_memory_set(p_phydm, p_phy_info->cfo_tail, 0, 8); + + odm_memory_set(p_phydm, p_phy_info->rx_mimo_evm_dbm, 0, 4); +} + +void +phydm_set_per_path_phy_info( + u8 rx_path, + s8 rx_pwr, + s8 rx_evm, + s8 cfo_tail, + s8 rx_snr, + struct phydm_phyinfo_struct *p_phy_info +) +{ + u8 evm_dbm = 0; + u8 evm_percentage = 0; + + /* SNR is S(8,1), EVM is S(8,1), CFO is S(8,7) */ + + if (rx_evm < 0) { + /* Calculate EVM in dBm */ + evm_dbm = ((u8)(0 - rx_evm) >> 1); + + /* Calculate EVM in percentage */ + if (evm_dbm >= 34) + evm_percentage = 100; + else + evm_percentage = (evm_dbm << 1) + (evm_dbm); + } + + p_phy_info->rx_pwr[rx_path] = rx_pwr; + + /* CFO = CFO_tail * 312.5 / 2^7 ~= CFO tail * 39/512 (kHz)*/ + p_phy_info->cfo_tail[rx_path] = cfo_tail; + p_phy_info->cfo_tail[rx_path] = ((p_phy_info->cfo_tail[rx_path] << 5) + (p_phy_info->cfo_tail[rx_path] << 2) + + (p_phy_info->cfo_tail[rx_path] << 1) + (p_phy_info->cfo_tail[rx_path])) >> 9; + + if (evm_dbm == 64) + evm_dbm = 0; /*if 1SS rate, evm_dbm [2nd stream] =64*/ + + p_phy_info->rx_mimo_evm_dbm[rx_path] = evm_dbm; + + p_phy_info->rx_mimo_signal_strength[rx_path] = phydm_query_rx_pwr_percentage(rx_pwr); + p_phy_info->rx_mimo_signal_quality[rx_path] = evm_percentage; + p_phy_info->rx_snr[rx_path] = rx_snr >> 1; + +#if 0 + /* if (p_pktinfo->is_packet_match_bssid) */ + { + dbg_print("path (%d)--------\n", rx_path); + dbg_print("rx_pwr = %d, Signal strength = %d\n", p_phy_info->rx_pwr[rx_path], p_phy_info->rx_mimo_signal_strength[rx_path]); + dbg_print("evm_dbm = %d, Signal quality = %d\n", p_phy_info->rx_mimo_evm_dbm[rx_path], p_phy_info->rx_mimo_signal_quality[rx_path]); + dbg_print("CFO = %d, SNR = %d\n", p_phy_info->cfo_tail[rx_path], p_phy_info->rx_snr[rx_path]); + } +#endif +} + +void +phydm_set_common_phy_info( + s8 rx_power, + u8 channel, + boolean is_beamformed, + boolean is_mu_packet, + u8 bandwidth, + u8 signal_quality, + u8 rxsc, + struct phydm_phyinfo_struct *p_phy_info +) +{ + p_phy_info->rx_power = rx_power; /* RSSI in dB */ + p_phy_info->recv_signal_power = rx_power; /* RSSI in dB */ + p_phy_info->channel = channel; /* channel number */ + p_phy_info->is_beamformed = is_beamformed; /* apply BF */ + p_phy_info->is_mu_packet = is_mu_packet; /* MU packet */ + p_phy_info->rxsc = rxsc; + + p_phy_info->rx_pwdb_all = phydm_query_rx_pwr_percentage(rx_power); /* RSSI in percentage */ + p_phy_info->signal_quality = signal_quality; /* signal quality */ + p_phy_info->band_width = bandwidth; /* bandwidth */ + +#if 0 + /* if (p_pktinfo->is_packet_match_bssid) */ + { + dbg_print("rx_pwdb_all = %d, rx_power = %d, recv_signal_power = %d\n", p_phy_info->rx_pwdb_all, p_phy_info->rx_power, p_phy_info->recv_signal_power); + dbg_print("signal_quality = %d\n", p_phy_info->signal_quality); + dbg_print("is_beamformed = %d, is_mu_packet = %d, rx_count = %d\n", p_phy_info->is_beamformed, p_phy_info->is_mu_packet, p_phy_info->rx_count + 1); + dbg_print("channel = %d, rxsc = %d, band_width = %d\n", channel, rxsc, bandwidth); + } +#endif +} + +void +phydm_get_rx_phy_status_type0( + struct PHY_DM_STRUCT *p_dm, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo, + struct phydm_phyinfo_struct *p_phy_info +) +{ + /* type 0 is used for cck packet */ + struct _phy_status_rpt_jaguar2_type0 *p_phy_sta_rpt = (struct _phy_status_rpt_jaguar2_type0 *)p_phy_status; + u8 SQ = 0; + s8 rx_power = p_phy_sta_rpt->pwdb - 110; + + + if (p_dm->support_ic_type & ODM_RTL8723D) { +#if (RTL8723D_SUPPORT == 1) + rx_power = p_phy_sta_rpt->pwdb - 97; +#endif + } +/*#if (RTL8710B_SUPPORT == 1)*/ + /*if (p_dm->support_ic_type & ODM_RTL8710B)*/ + /*rx_power = p_phy_sta_rpt->pwdb - 97;*/ +/*#endif*/ + +#if (RTL8821C_SUPPORT == 1) + else if (p_dm->support_ic_type & ODM_RTL8821C) { + if (p_phy_sta_rpt->pwdb >= -57) + rx_power = p_phy_sta_rpt->pwdb - 100; + else + rx_power = p_phy_sta_rpt->pwdb - 102; + } +#endif + + if (p_pktinfo->is_to_self) { + p_dm->ofdm_agc_idx[0] = p_phy_sta_rpt->pwdb; + p_dm->ofdm_agc_idx[1] = 0; + p_dm->ofdm_agc_idx[2] = 0; + p_dm->ofdm_agc_idx[3] = 0; + } + + + /* Calculate Signal Quality*/ + if (p_pktinfo->is_packet_match_bssid) { + if (p_phy_sta_rpt->signal_quality >= 64) + SQ = 0; + else if (p_phy_sta_rpt->signal_quality <= 20) + SQ = 100; + else { + /* mapping to 2~99% */ + SQ = 64 - p_phy_sta_rpt->signal_quality; + SQ = ((SQ << 3) + SQ) >> 2; + } + } + + /* Modify CCK PWDB if old AGC */ + if (p_dm->cck_new_agc == false) { + + #if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) + rx_power = phydm_cck_rssi_convert(p_dm, p_phy_sta_rpt->lna_l, p_phy_sta_rpt->vga); + else + #endif + { + u8 lna_idx, vga_idx; + + lna_idx = ((p_phy_sta_rpt->lna_h << 3) | p_phy_sta_rpt->lna_l); + vga_idx = p_phy_sta_rpt->vga; + + #if (RTL8723D_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8723D) + rx_power = odm_cckrssi_8723d(lna_idx, vga_idx); + #endif + + #if (RTL8710B_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8710B) + rx_power = odm_cckrssi_8710b(lna_idx, vga_idx); + #endif + + #if (RTL8822B_SUPPORT == 1) + /* Need to do !! */ + /*if (p_dm->support_ic_type & ODM_RTL8822B) */ + /*rx_power = odm_CCKRSSI_8822B(LNA_idx, VGA_idx);*/ + #endif + + #if (RTL8821C_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8821C) + rx_power = phydm_cck_rssi_8821c(p_dm, lna_idx, vga_idx); + #endif + } + + } + + /* Confirm CCK RSSI */ + #if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8197F) { + u8 bb_pwr_th_l = 5; /* round( 31*0.15 ) */ + u8 bb_pwr_th_h = 27; /* round( 31*0.85 ) */ + + if ((p_phy_sta_rpt->bb_power < bb_pwr_th_l) || (p_phy_sta_rpt->bb_power > bb_pwr_th_h)) + rx_power = 0; /* Error RSSI for CCK ; set 100*/ + } + #endif + + /* Update CCK packet counter */ + p_dm->phy_dbg_info.num_qry_phy_status_cck++; + + /*CCK no STBC and LDPC*/ + p_dm->phy_dbg_info.is_ldpc_pkt = false; + p_dm->phy_dbg_info.is_stbc_pkt = false; + + /* Update Common information */ + phydm_set_common_phy_info(rx_power, p_phy_sta_rpt->channel, false, + false, CHANNEL_WIDTH_20, SQ, p_phy_sta_rpt->rxsc, p_phy_info); + + /* Update CCK pwdb */ + phydm_set_per_path_phy_info(RF_PATH_A, rx_power, 0, 0, 0, p_phy_info); /* Update per-path information */ + + p_dm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->antidx_a; + p_dm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->antidx_b; + p_dm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antidx_c; + p_dm->dm_fat_table.antsel_rx_keep_3 = p_phy_sta_rpt->antidx_d; +#if 0 + /* if (p_pktinfo->is_packet_match_bssid) */ + { + dbg_print("pwdb = 0x%x, MP gain index = 0x%x, TRSW = 0x%x\n", p_phy_sta_rpt->pwdb, p_phy_sta_rpt->gain, p_phy_sta_rpt->trsw); + dbg_print("channel = %d, band = %d, rxsc = %d\n", p_phy_sta_rpt->channel, p_phy_sta_rpt->band, p_phy_sta_rpt->rxsc); + dbg_print("agc_table = 0x%x, agc_rpt 0x%x, bb_power = 0x%x\n", p_phy_sta_rpt->agc_table, p_phy_sta_rpt->agc_rpt, p_phy_sta_rpt->bb_power); + dbg_print("length = %d, SQ = %d\n", p_phy_sta_rpt->length, p_phy_sta_rpt->signal_quality); + dbg_print("antidx a = 0x%x, b = 0x%x, c = 0x%x, d = 0x%x\n", p_phy_sta_rpt->antidx_a, p_phy_sta_rpt->antidx_b, p_phy_sta_rpt->antidx_c, p_phy_sta_rpt->antidx_d); + dbg_print("rsvd_0 = 0x%x, rsvd_1 = 0x%x, rsvd_2 = 0x%x\n", p_phy_sta_rpt->rsvd_0, p_phy_sta_rpt->rsvd_1, p_phy_sta_rpt->rsvd_2); + dbg_print("rsvd_3 = 0x%x, rsvd_4 = 0x%x, rsvd_5 = 0x%x\n", p_phy_sta_rpt->rsvd_3, p_phy_sta_rpt->rsvd_4, p_phy_sta_rpt->rsvd_5); + dbg_print("rsvd_6 = 0x%x, rsvd_7 = 0x%x, rsvd_8 = 0x%x\n", p_phy_sta_rpt->rsvd_6, p_phy_sta_rpt->rsvd_7, p_phy_sta_rpt->rsvd_8); + } +#endif +} + +void +phydm_get_rx_phy_status_type1( + struct PHY_DM_STRUCT *p_dm, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo, + struct phydm_phyinfo_struct *p_phy_info +) +{ + /* type 1 is used for ofdm packet */ + + struct _phy_status_rpt_jaguar2_type1 *p_phy_sta_rpt = (struct _phy_status_rpt_jaguar2_type1 *)p_phy_status; + s8 rx_pwr_db = -120; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; + boolean is_mu; + u8 num_ss; + + /* Update OFDM packet counter */ + p_dm->phy_dbg_info.num_qry_phy_status_ofdm++; + + /* Update per-path information */ + for (i = RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { + if (p_dm->rx_ant_status & BIT(i)) { + s8 rx_path_pwr_db; + + /* RX path counter */ + rx_count++; + + /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ + /* EVM report is reported by stream, not path */ + rx_path_pwr_db = p_phy_sta_rpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ + + if (p_pktinfo->is_to_self) + p_dm->ofdm_agc_idx[i] = p_phy_sta_rpt->pwdb[i]; + + phydm_set_per_path_phy_info(i, rx_path_pwr_db, p_phy_sta_rpt->rxevm[rx_count - 1], + p_phy_sta_rpt->cfo_tail[i], p_phy_sta_rpt->rxsnr[i], p_phy_info); + + /* search maximum pwdb */ + if (rx_path_pwr_db > rx_pwr_db) + rx_pwr_db = rx_path_pwr_db; + } + } + + /* mapping RX counter from 1~4 to 0~3 */ + if (rx_count > 0) + p_phy_info->rx_count = rx_count - 1; + + /* Check if MU packet or not */ + if ((p_phy_sta_rpt->gid != 0) && (p_phy_sta_rpt->gid != 63)) { + is_mu = true; + p_dm->phy_dbg_info.num_qry_mu_pkt++; + } else + is_mu = false; + + /* count BF packet */ + p_dm->phy_dbg_info.num_qry_bf_pkt = p_dm->phy_dbg_info.num_qry_bf_pkt + p_phy_sta_rpt->beamformed; + + /*STBC or LDPC pkt*/ + p_dm->phy_dbg_info.is_ldpc_pkt = p_phy_sta_rpt->ldpc; + p_dm->phy_dbg_info.is_stbc_pkt = p_phy_sta_rpt->stbc; + + /* Check sub-channel */ + if ((p_pktinfo->data_rate > ODM_RATE11M) && (p_pktinfo->data_rate < ODM_RATEMCS0)) + rxsc = p_phy_sta_rpt->l_rxsc; + else + rxsc = p_phy_sta_rpt->ht_rxsc; + + /* Check RX bandwidth */ + if (p_dm->support_ic_type & ODM_RTL8822B) { + if ((rxsc >= 1) && (rxsc <= 8)) + bw = CHANNEL_WIDTH_20; + else if ((rxsc >= 9) && (rxsc <= 12)) + bw = CHANNEL_WIDTH_40; + else if (rxsc >= 13) + bw = CHANNEL_WIDTH_80; + else + bw = p_phy_sta_rpt->rf_mode; + } else if (p_dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8723D | ODM_RTL8710B)) { + if (p_phy_sta_rpt->rf_mode == 0) + bw = CHANNEL_WIDTH_20; + else if ((rxsc == 1) || (rxsc == 2)) + bw = CHANNEL_WIDTH_20; + else + bw = CHANNEL_WIDTH_40; + } + + /* Update packet information */ + phydm_set_common_phy_info(rx_pwr_db, p_phy_sta_rpt->channel, (boolean)p_phy_sta_rpt->beamformed, + is_mu, bw, p_phy_info->rx_mimo_signal_quality[0], rxsc, p_phy_info); + + num_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + + odm_parsing_cfo(p_dm, p_pktinfo, p_phy_sta_rpt->cfo_tail, num_ss); + p_dm->dm_fat_table.antsel_rx_keep_0 = p_phy_sta_rpt->antidx_a; + p_dm->dm_fat_table.antsel_rx_keep_1 = p_phy_sta_rpt->antidx_b; + p_dm->dm_fat_table.antsel_rx_keep_2 = p_phy_sta_rpt->antidx_c; + p_dm->dm_fat_table.antsel_rx_keep_3 = p_phy_sta_rpt->antidx_d; + + #if 0 + if (p_pktinfo->is_packet_match_bssid) { + + dbg_print("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d, rf_mode = %d\n", p_phy_sta_rpt->channel, p_phy_sta_rpt->band, p_phy_sta_rpt->l_rxsc, p_phy_sta_rpt->ht_rxsc, p_phy_sta_rpt->rf_mode); + dbg_print("Antidx A = %d, B = %d, C = %d, D = %d\n", p_phy_sta_rpt->antidx_a, p_phy_sta_rpt->antidx_b, p_phy_sta_rpt->antidx_c, p_phy_sta_rpt->antidx_d); + dbg_print("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->pwdb[0], p_phy_sta_rpt->pwdb[1], p_phy_sta_rpt->pwdb[2], p_phy_sta_rpt->pwdb[3]); + dbg_print("EVM A: %d, B: %d, C: %d, D: %d\n", p_phy_sta_rpt->rxevm[0], p_phy_sta_rpt->rxevm[1], p_phy_sta_rpt->rxevm[2], p_phy_sta_rpt->rxevm[3]); + dbg_print("SNR A: %d, B: %d, C: %d, D: %d\n", p_phy_sta_rpt->rxsnr[0], p_phy_sta_rpt->rxsnr[1], p_phy_sta_rpt->rxsnr[2], p_phy_sta_rpt->rxsnr[3]); + dbg_print("CFO A: %d, B: %d, C: %d, D: %d\n", p_phy_sta_rpt->cfo_tail[0], p_phy_sta_rpt->cfo_tail[1], p_phy_sta_rpt->cfo_tail[2], p_phy_sta_rpt->cfo_tail[3]); + dbg_print("paid = %d, gid = %d, length = %d\n", (p_phy_sta_rpt->paid + (p_phy_sta_rpt->paid_msb<<8)), p_phy_sta_rpt->gid, p_phy_sta_rpt->lsig_length); + dbg_print("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", p_phy_sta_rpt->ldpc, p_phy_sta_rpt->stbc, p_phy_sta_rpt->beamformed, p_phy_sta_rpt->gnt_bt, p_phy_sta_rpt->hw_antsw_occu); + dbg_print("NBI: %d, pos: %d\n", p_phy_sta_rpt->nb_intf_flag, (p_phy_sta_rpt->intf_pos + (p_phy_sta_rpt->intf_pos_msb<<8))); + dbg_print("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", p_phy_sta_rpt->rsvd_0, p_phy_sta_rpt->rsvd_1, p_phy_sta_rpt->rsvd_2, p_phy_sta_rpt->rsvd_3, p_phy_sta_rpt->rsvd_4, p_phy_sta_rpt->rsvd_5); + + } + + dbg_print("phydm_get_rx_phy_status_type1 p_pktinfo->is_packet_match_bssid = %d\n", p_pktinfo->is_packet_match_bssid); + dbg_print("p_pktinfo->data_rate = 0x%x\n", p_pktinfo->data_rate); + #endif +} + +void +phydm_get_rx_phy_status_type2( + struct PHY_DM_STRUCT *p_dm, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo, + struct phydm_phyinfo_struct *p_phy_info +) +{ + struct _phy_status_rpt_jaguar2_type2 *p_phy_sta_rpt = (struct _phy_status_rpt_jaguar2_type2 *)p_phy_status; + s8 rx_pwr_db = -120; + u8 i, rxsc, bw = CHANNEL_WIDTH_20, rx_count = 0; + + /* Update OFDM packet counter */ + p_dm->phy_dbg_info.num_qry_phy_status_ofdm++; + + /* Update per-path information */ + for (i = RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { + if (p_dm->rx_ant_status & BIT(i)) { + s8 rx_path_pwr_db; + + /* RX path counter */ + rx_count++; + + /* Update per-path information (RSSI_dB RSSI_percentage EVM SNR CFO SQ) */ +#if (RTL8197F_SUPPORT == 1) + if ((p_dm->support_ic_type & ODM_RTL8197F) && (p_phy_sta_rpt->pwdb[i] == 0x7f)) { /*for 97f workaround*/ + + if (i == RF_PATH_A) { + rx_path_pwr_db = (p_phy_sta_rpt->gain_a) << 1; + rx_path_pwr_db = rx_path_pwr_db - 110; + } else if (i == RF_PATH_B) { + rx_path_pwr_db = (p_phy_sta_rpt->gain_b) << 1; + rx_path_pwr_db = rx_path_pwr_db - 110; + } else + rx_path_pwr_db = 0; + } else +#endif + rx_path_pwr_db = p_phy_sta_rpt->pwdb[i] - 110; /* per-path pwdb in dB domain */ + + phydm_set_per_path_phy_info(i, rx_path_pwr_db, 0, 0, 0, p_phy_info); + + /* search maximum pwdb */ + if (rx_path_pwr_db > rx_pwr_db) + rx_pwr_db = rx_path_pwr_db; + } + } + + /* mapping RX counter from 1~4 to 0~3 */ + if (rx_count > 0) + p_phy_info->rx_count = rx_count - 1; + + /* Check RX sub-channel */ + if ((p_pktinfo->data_rate > ODM_RATE11M) && (p_pktinfo->data_rate < ODM_RATEMCS0)) + rxsc = p_phy_sta_rpt->l_rxsc; + else + rxsc = p_phy_sta_rpt->ht_rxsc; + + /*STBC or LDPC pkt*/ + p_dm->phy_dbg_info.is_ldpc_pkt = p_phy_sta_rpt->ldpc; + p_dm->phy_dbg_info.is_stbc_pkt = p_phy_sta_rpt->stbc; + + /* Check RX bandwidth */ + /* the BW information of sc=0 is useless, because there is no information of RF mode*/ + + if (p_dm->support_ic_type & ODM_RTL8822B) { + if ((rxsc >= 1) && (rxsc <= 8)) + bw = CHANNEL_WIDTH_20; + else if ((rxsc >= 9) && (rxsc <= 12)) + bw = CHANNEL_WIDTH_40; + else if (rxsc >= 13) + bw = CHANNEL_WIDTH_80; + else + bw = CHANNEL_WIDTH_20; + } else if (p_dm->support_ic_type & (ODM_RTL8197F | ODM_RTL8723D | ODM_RTL8710B)) {/* JJ ADD 20161014 */ + if (rxsc == 3) + bw = CHANNEL_WIDTH_40; + else if ((rxsc == 1) || (rxsc == 2)) + bw = CHANNEL_WIDTH_20; + else + bw = CHANNEL_WIDTH_20; + } + + /* Update packet information */ + phydm_set_common_phy_info(rx_pwr_db, p_phy_sta_rpt->channel, (boolean)p_phy_sta_rpt->beamformed, + false, bw, 0, rxsc, p_phy_info); + +#if 0 + /* if (p_pktinfo->is_packet_match_bssid) */ + { + dbg_print("channel = %d, band = %d, l_rxsc = %d, ht_rxsc = %d\n", p_phy_sta_rpt->channel, p_phy_sta_rpt->band, p_phy_sta_rpt->l_rxsc, p_phy_sta_rpt->ht_rxsc); + dbg_print("pwdb A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->pwdb[0], p_phy_sta_rpt->pwdb[1], p_phy_sta_rpt->pwdb[2], p_phy_sta_rpt->pwdb[3]); + dbg_print("Agc table A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->agc_table_a, p_phy_sta_rpt->agc_table_b, p_phy_sta_rpt->agc_table_c, p_phy_sta_rpt->agc_table_d); + dbg_print("Gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->gain_a, p_phy_sta_rpt->gain_b, p_phy_sta_rpt->gain_c, p_phy_sta_rpt->gain_d); + dbg_print("TRSW A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->trsw_a, p_phy_sta_rpt->trsw_b, p_phy_sta_rpt->trsw_c, p_phy_sta_rpt->trsw_d); + dbg_print("AAGC step A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->aagc_step_a, p_phy_sta_rpt->aagc_step_b, p_phy_sta_rpt->aagc_step_c, p_phy_sta_rpt->aagc_step_d); + dbg_print("HT AAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->ht_aagc_gain[0], p_phy_sta_rpt->ht_aagc_gain[1], p_phy_sta_rpt->ht_aagc_gain[2], p_phy_sta_rpt->ht_aagc_gain[3]); + dbg_print("DAGC gain A: 0x%x, B: 0x%x, C: 0x%x, D: 0x%x\n", p_phy_sta_rpt->dagc_gain[0], p_phy_sta_rpt->dagc_gain[1], p_phy_sta_rpt->dagc_gain[2], p_phy_sta_rpt->dagc_gain[3]); + dbg_print("ldpc: %d, stbc: %d, bf: %d, gnt_bt: %d, antsw: %d\n", p_phy_sta_rpt->ldpc, p_phy_sta_rpt->stbc, p_phy_sta_rpt->beamformed, p_phy_sta_rpt->gnt_bt, p_phy_sta_rpt->hw_antsw_occu); + dbg_print("counter: %d, syn_count: %d\n", p_phy_sta_rpt->counter, p_phy_sta_rpt->syn_count); + dbg_print("cnt_cca2agc_rdy: %d, cnt_pw2cca: %d, shift_l_map\n", p_phy_sta_rpt->cnt_cca2agc_rdy, p_phy_sta_rpt->cnt_pw2cca, p_phy_sta_rpt->shift_l_map); + dbg_print("rsvd_0 = %d, rsvd_1 = %d, rsvd_2 = %d, rsvd_3 = %d, rsvd_4 = %d, rsvd_5 = %d\n", p_phy_sta_rpt->rsvd_0, p_phy_sta_rpt->rsvd_1, p_phy_sta_rpt->rsvd_2, p_phy_sta_rpt->rsvd_3, p_phy_sta_rpt->rsvd_4); + dbg_print("rsvd_5 = %d, rsvd_6 = %d, rsvd_6 = %d\n", p_phy_sta_rpt->rsvd_5, p_phy_sta_rpt->rsvd_6, p_phy_sta_rpt->rsvd_7); + } +#endif +} + +void +phydm_get_rx_phy_status_type5( + u8 *p_phy_status +) +{ + /* + dbg_print("DW0: 0x%02x%02x%02x%02x\n", *(p_phy_status + 3), *(p_phy_status + 2), *(p_phy_status + 1), *(p_phy_status + 0)); + dbg_print("DW1: 0x%02x%02x%02x%02x\n", *(p_phy_status + 7), *(p_phy_status + 6), *(p_phy_status + 5), *(p_phy_status + 4)); + dbg_print("DW2: 0x%02x%02x%02x%02x\n", *(p_phy_status + 11), *(p_phy_status + 10), *(p_phy_status + 9), *(p_phy_status + 8)); + dbg_print("DW3: 0x%02x%02x%02x%02x\n", *(p_phy_status + 15), *(p_phy_status + 14), *(p_phy_status + 13), *(p_phy_status + 12)); + dbg_print("DW4: 0x%02x%02x%02x%02x\n", *(p_phy_status + 19), *(p_phy_status + 18), *(p_phy_status + 17), *(p_phy_status + 16)); + dbg_print("DW5: 0x%02x%02x%02x%02x\n", *(p_phy_status + 23), *(p_phy_status + 22), *(p_phy_status + 21), *(p_phy_status + 20)); + dbg_print("DW6: 0x%02x%02x%02x%02x\n", *(p_phy_status + 27), *(p_phy_status + 26), *(p_phy_status + 25), *(p_phy_status + 24)); + */ +} + +void +phydm_process_rssi_for_dm_new_type( + struct PHY_DM_STRUCT *p_dm, + struct phydm_phyinfo_struct *p_phy_info, + struct phydm_perpkt_info_struct *p_pktinfo +) +{ + s32 undecorated_smoothed_pwdb, accumulate_pwdb; + u32 rssi_ave, rssi_linear = 0; + u8 i; + struct cmn_sta_info *p_sta; + u8 scaling_factor = 4; + u8 is_cck_rate = (p_pktinfo->data_rate <= ODM_RATE11M) ? true : false; + + if (p_pktinfo->station_id >= ODM_ASSOCIATE_ENTRY_NUM) + return; + + p_sta = p_dm->p_phydm_sta_info[p_pktinfo->station_id]; + + if (!is_sta_active(p_sta)) + return; + + if ((!p_pktinfo->is_packet_match_bssid))/*data frame only*/ + return; + + if (p_pktinfo->is_packet_beacon) + p_dm->phy_dbg_info.num_qry_beacon_pkt++; + +#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) + if (p_dm->support_ability & ODM_BB_ANT_DIV) + odm_process_rssi_for_ant_div(p_dm, p_phy_info, p_pktinfo); +#endif + +#ifdef CONFIG_DYNAMIC_RX_PATH + phydm_process_phy_status_for_dynamic_rx_path(p_dm, p_phy_info, p_pktinfo); +#endif + + if (p_pktinfo->is_packet_to_self || p_pktinfo->is_packet_beacon) { + + p_dm->rx_rate = p_pktinfo->data_rate; + undecorated_smoothed_pwdb = p_sta->rssi_stat.rssi; + accumulate_pwdb = p_dm->accumulate_pwdb[p_pktinfo->station_id]; + p_dm->RSSI_A = p_phy_info->rx_mimo_signal_strength[RF_PATH_A]; + p_dm->RSSI_B = p_phy_info->rx_mimo_signal_strength[RF_PATH_B]; + p_dm->RSSI_C = p_phy_info->rx_mimo_signal_strength[RF_PATH_C]; + p_dm->RSSI_D = p_phy_info->rx_mimo_signal_strength[RF_PATH_D]; + + for (i = RF_PATH_A; i < ODM_RF_PATH_MAX_JAGUAR; i++) { + if (p_phy_info->rx_mimo_signal_strength[i] != 0) + rssi_linear += odm_convert_to_linear(p_phy_info->rx_mimo_signal_strength[i]); + } + + switch (p_phy_info->rx_count + 1) { + case 2: + rssi_linear = (rssi_linear >> 1); + break; + case 3: + rssi_linear = ((rssi_linear) + (rssi_linear << 1) + (rssi_linear << 3)) >> 5; /* RSSI_linear/3 ~ RSSI_linear*11/32 */ + break; + case 4: + rssi_linear = (rssi_linear >> 2); + break; + } + rssi_ave = odm_convert_to_db(rssi_linear); + + if (undecorated_smoothed_pwdb <= 0) { + accumulate_pwdb = (p_phy_info->rx_pwdb_all << scaling_factor); + undecorated_smoothed_pwdb = p_phy_info->rx_pwdb_all; + } else { + accumulate_pwdb = accumulate_pwdb - (accumulate_pwdb >> scaling_factor) + rssi_ave; + undecorated_smoothed_pwdb = (accumulate_pwdb + (1 << (scaling_factor - 1))) >> scaling_factor; + } + + p_sta->rssi_stat.rssi = (s8)undecorated_smoothed_pwdb; + + if (is_cck_rate) + p_sta->rssi_stat.rssi_cck = (s8)rssi_ave; + else + p_sta->rssi_stat.rssi_ofdm = (s8)rssi_ave; + + + p_dm->accumulate_pwdb[p_pktinfo->station_id] = accumulate_pwdb; + +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + if (p_pktinfo->station_id == 0) { + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_dm->adapter); + + p_hal_data->UndecoratedSmoothedPWDB = undecorated_smoothed_pwdb; + } +#endif + } +} + +void +phydm_rx_phy_status_new_type( + void *p_dm_void, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo, + struct phydm_phyinfo_struct *p_phy_info +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#ifdef PHYDM_PHYSTAUS_SMP_MODE + struct pkt_process_info *p_pkt_process = &(p_dm->pkt_proc_struct); +#endif + u8 phy_status_type = (*p_phy_status & 0xf); + +#ifdef PHYDM_PHYSTAUS_SMP_MODE + if (p_pkt_process->phystatus_smp_mode_en && phy_status_type != 0) { + + if (p_pkt_process->pre_ppdu_cnt == p_pktinfo->ppdu_cnt) + return; + + p_pkt_process->pre_ppdu_cnt = p_pktinfo->ppdu_cnt; + } +#endif + + /*dbg_print("phydm_rx_phy_status_new_type================> (page: %d)\n", phy_status_type);*/ + + /* Memory reset */ + phydm_reset_phy_info(p_dm, p_phy_info); + p_dm->rate_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + + /* Phy status parsing */ + switch (phy_status_type) { + case 0: /*CCK*/ + phydm_get_rx_phy_status_type0(p_dm, p_phy_status, p_pktinfo, p_phy_info); + break; + case 1: + phydm_get_rx_phy_status_type1(p_dm, p_phy_status, p_pktinfo, p_phy_info); + break; + case 2: + phydm_get_rx_phy_status_type2(p_dm, p_phy_status, p_pktinfo, p_phy_info); + break; +#if 0 + case 5: + phydm_get_rx_phy_status_type5(p_phy_status); + return; +#endif + default: + return; + } + + if (p_pktinfo->is_packet_match_bssid) { + phydm_avg_phystatus_index(p_dm, p_phy_info, p_pktinfo); + phydm_rx_statistic_cal(p_dm, p_phy_status, p_pktinfo); + } + + /* Update signal strength to UI, and p_phy_info->rx_pwdb_all is the maximum RSSI of all path */ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + p_phy_info->signal_strength = SignalScaleProc(p_dm->adapter, p_phy_info->rx_pwdb_all, false, false); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + p_phy_info->signal_strength = (u8)(phydm_signal_scale_mapping(p_dm, p_phy_info->rx_pwdb_all)); +#endif + + + +} +/*==============================================*/ +#endif + +void +odm_phy_status_query( + struct PHY_DM_STRUCT *p_dm, + struct phydm_phyinfo_struct *p_phy_info, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo +) +{ + + if (p_dm->support_ic_type & ODM_IC_PHY_STATUE_NEW_TYPE) { + #if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + phydm_rx_phy_status_new_type(p_dm, p_phy_status, p_pktinfo, p_phy_info); + phydm_process_rssi_for_dm_new_type(p_dm, p_phy_info, p_pktinfo); + #endif + } else if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + #if ODM_IC_11AC_SERIES_SUPPORT + phydm_rx_phy_status_jaguar_series_parsing(p_dm, p_phy_info, p_phy_status, p_pktinfo); + phydm_process_rssi_for_dm(p_dm, p_phy_info, p_pktinfo); + #endif + } else if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + #if ODM_IC_11N_SERIES_SUPPORT + phydm_rx_phy_status92c_series_parsing(p_dm, p_phy_info, p_phy_status, p_pktinfo); + phydm_process_rssi_for_dm(p_dm, p_phy_info, p_pktinfo); + #endif + } +} + +void +phydm_rx_phy_status_init( + void *p_dm_void +) +{ +#ifdef PHYDM_PHYSTAUS_SMP_MODE + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct pkt_process_info *p_pkt_process = &(p_dm->pkt_proc_struct); + + if (p_dm->support_ic_type == ODM_RTL8822B) { + + p_pkt_process->phystatus_smp_mode_en = 1; + p_pkt_process->pre_ppdu_cnt = 0xff; + + odm_set_mac_reg(p_dm, 0x60f, BIT(7), 1); /*phystatus sampling mode enable*/ + + odm_set_bb_reg(p_dm, 0x9e4, 0x3ff, 0x0); /*First update timming*/ + odm_set_bb_reg(p_dm, 0x9e4, 0xfc00, 0x0); /*Update Sampling time*/ + } +#endif +} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.h new file mode 100644 index 000000000000..ce8f6c5eed80 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_phystatus.h @@ -0,0 +1,1063 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDM_PHYSTATUS_H__ +#define __PHYDM_PHYSTATUS_H__ + + +/*--------------------------Define -------------------------------------------*/ +#define CCK_RSSI_INIT_COUNT 5 + +#define RA_RSSI_STATE_INIT 0 +#define RA_RSSI_STATE_SEND 1 +#define RA_RSSI_STATE_HOLD 2 + +#define CFO_HW_RPT_2_MHZ(val) ((val<<1) + (val>>1)) +/* ((X* 3125) / 10)>>7 = (X*10)>>2 = X*2.5 = X<<1 + X>>1 */ + +/* ************************************************************ + * structure and define + * ************************************************************ */ + +__PACK struct _phy_rx_agc_info { +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 gain: 7, trsw: 1; +#else + u8 trsw: 1, gain: 7; +#endif +}; + +__PACK struct _phy_status_rpt_8192cd { + struct _phy_rx_agc_info path_agc[2]; + u8 ch_corr[2]; + u8 cck_sig_qual_ofdm_pwdb_all; + u8 cck_agc_rpt_ofdm_cfosho_a; + u8 cck_rpt_b_ofdm_cfosho_b; + u8 rsvd_1;/*ch_corr_msb;*/ + u8 noise_power_db_msb; + s8 path_cfotail[2]; + u8 pcts_mask[2]; + s8 stream_rxevm[2]; + u8 path_rxsnr[2]; + u8 noise_power_db_lsb; + u8 rsvd_2[3]; + u8 stream_csi[2]; + u8 stream_target_csi[2]; + s8 sig_evm; + u8 rsvd_3; + +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antsel_rx_keep_2: 1; /*ex_intf_flg:1;*/ + u8 sgi_en: 1; + u8 rxsc: 2; + u8 idle_long: 1; + u8 r_ant_train_en: 1; + u8 ant_sel_b: 1; + u8 ant_sel: 1; +#else /*_BIG_ENDIAN_ */ + u8 ant_sel: 1; + u8 ant_sel_b: 1; + u8 r_ant_train_en: 1; + u8 idle_long: 1; + u8 rxsc: 2; + u8 sgi_en: 1; + u8 antsel_rx_keep_2: 1;/*ex_intf_flg:1;*/ +#endif +}; + +struct _phy_status_rpt_8812 { + /* DWORD 0*/ + u8 gain_trsw[2]; /*path-A and path-B {TRSW, gain[6:0] }*/ + u8 chl_num_LSB; /*channel number[7:0]*/ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 chl_num_MSB: 2; /*channel number[9:8]*/ + u8 sub_chnl: 4; /*sub-channel location[3:0]*/ + u8 r_RFMOD: 2; /*RF mode[1:0]*/ +#else /*_BIG_ENDIAN_ */ + u8 r_RFMOD: 2; + u8 sub_chnl: 4; + u8 chl_num_MSB: 2; +#endif + + /* DWORD 1*/ + u8 pwdb_all; /*CCK signal quality / OFDM pwdb all*/ + s8 cfosho[2]; /*DW1 byte 1 DW1 byte2 CCK AGC report and CCK_BB_Power / OFDM path-A and path-B short CFO*/ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + /*this should be checked again because the definition of 8812 and 8814 is different*/ + /* u8 r_cck_rx_enable_pathc:2; cck rx enable pathc[1:0]*/ + /* u8 cck_rx_path:4; cck rx path[3:0]*/ + u8 resvd_0: 6; + u8 bt_RF_ch_MSB: 2; /*8812A:2'b0 8814A: bt rf channel keep[7:6]*/ +#else /*_BIG_ENDIAN_*/ + u8 bt_RF_ch_MSB: 2; + u8 resvd_0: 6; +#endif + + /* DWORD 2*/ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 ant_div_sw_a: 1; /*8812A: ant_div_sw_a 8814A: 1'b0*/ + u8 ant_div_sw_b: 1; /*8812A: ant_div_sw_b 8814A: 1'b0*/ + u8 bt_RF_ch_LSB: 6; /*8812A: 6'b0 8814A: bt rf channel keep[5:0]*/ +#else /*_BIG_ENDIAN_ */ + u8 bt_RF_ch_LSB: 6; + u8 ant_div_sw_b: 1; + u8 ant_div_sw_a: 1; +#endif + s8 cfotail[2]; /*DW2 byte 1 DW2 byte 2 path-A and path-B CFO tail*/ + u8 PCTS_MSK_RPT_0; /*PCTS mask report[7:0]*/ + u8 PCTS_MSK_RPT_1; /*PCTS mask report[15:8]*/ + + /* DWORD 3*/ + s8 rxevm[2]; /*DW3 byte 1 DW3 byte 2 stream 1 and stream 2 RX EVM*/ + s8 rxsnr[2]; /*DW3 byte 3 DW4 byte 0 path-A and path-B RX SNR*/ + + /* DWORD 4*/ + u8 PCTS_MSK_RPT_2; /*PCTS mask report[23:16]*/ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 PCTS_MSK_RPT_3: 6; /*PCTS mask report[29:24]*/ + u8 pcts_rpt_valid: 1; /*pcts_rpt_valid*/ + u8 resvd_1: 1; /*1'b0*/ +#else /*_BIG_ENDIAN_*/ + u8 resvd_1: 1; + u8 pcts_rpt_valid: 1; + u8 PCTS_MSK_RPT_3: 6; +#endif + s8 rxevm_cd[2]; /*DW 4 byte 3 DW5 byte 0 8812A: 16'b0 8814A: stream 3 and stream 4 RX EVM*/ + + /* DWORD 5*/ + u8 csi_current[2]; /*DW5 byte 1 DW5 byte 2 8812A: stream 1 and 2 CSI 8814A: path-C and path-D RX SNR*/ + u8 gain_trsw_cd[2]; /*DW5 byte 3 DW6 byte 0 path-C and path-D {TRSW, gain[6:0] }*/ + + /* DWORD 6*/ + s8 sigevm; /*signal field EVM*/ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_antc: 3; /*8812A: 3'b0 8814A: antidx_antc[2:0]*/ + u8 antidx_antd: 3; /*8812A: 3'b0 8814A: antidx_antd[2:0]*/ + u8 dpdt_ctrl_keep: 1; /*8812A: 1'b0 8814A: dpdt_ctrl_keep*/ + u8 GNT_BT_keep: 1; /*8812A: 1'b0 8814A: GNT_BT_keep*/ +#else /*_BIG_ENDIAN_*/ + u8 GNT_BT_keep: 1; + u8 dpdt_ctrl_keep: 1; + u8 antidx_antd: 3; + u8 antidx_antc: 3; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_anta: 3; /*antidx_anta[2:0]*/ + u8 antidx_antb: 3; /*antidx_antb[2:0]*/ + u8 hw_antsw_occur: 2; /*1'b0*/ +#else /*_BIG_ENDIAN_*/ + u8 hw_antsw_occur: 2; + u8 antidx_antb: 3; + u8 antidx_anta: 3; +#endif +}; + + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + +__PACK struct _phy_status_rpt_jaguar2_type0 { + /* DW0 */ + u8 page_num; + u8 pwdb; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 gain: 6; + u8 rsvd_0: 1; + u8 trsw: 1; +#else + u8 trsw: 1; + u8 rsvd_0: 1; + u8 gain: 6; +#endif + u8 rsvd_1; + + /* DW1 */ + u8 rsvd_2; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 rxsc: 4; + u8 agc_table: 4; +#else + u8 agc_table: 4; + u8 rxsc: 4; +#endif + u8 channel; + u8 band; + + /* DW2 */ + u16 length; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_a: 3; + u8 antidx_b: 3; + u8 rsvd_3: 2; + u8 antidx_c: 3; + u8 antidx_d: 3; + u8 rsvd_4:2; +#else + u8 rsvd_3: 2; + u8 antidx_b: 3; + u8 antidx_a: 3; + u8 rsvd_4:2; + u8 antidx_d: 3; + u8 antidx_c: 3; +#endif + + /* DW3 */ + u8 signal_quality; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 vga:5; + u8 lna_l:3; + u8 bb_power:6; + u8 rsvd_9:1; + u8 lna_h:1; +#else + u8 lna_l:3; + u8 vga:5; + u8 lna_h:1; + u8 rsvd_9:1; + u8 bb_power:6; +#endif + u8 rsvd_5; + + /* DW4 */ + u32 rsvd_6; + + /* DW5 */ + u32 rsvd_7; + + /* DW6 */ + u32 rsvd_8; +}; + +__PACK struct _phy_status_rpt_jaguar2_type1 { + /* DW0 and DW1 */ + u8 page_num; + u8 pwdb[4]; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 l_rxsc: 4; + u8 ht_rxsc: 4; +#else + u8 ht_rxsc: 4; + u8 l_rxsc: 4; +#endif + u8 channel; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 band: 2; + u8 rsvd_0: 1; + u8 hw_antsw_occu: 1; + u8 gnt_bt: 1; + u8 ldpc: 1; + u8 stbc: 1; + u8 beamformed: 1; +#else + u8 beamformed: 1; + u8 stbc: 1; + u8 ldpc: 1; + u8 gnt_bt: 1; + u8 hw_antsw_occu: 1; + u8 rsvd_0: 1; + u8 band: 2; +#endif + + /* DW2 */ + u16 lsig_length; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_a: 3; + u8 antidx_b: 3; + u8 rsvd_1: 2; + u8 antidx_c: 3; + u8 antidx_d: 3; + u8 rsvd_2: 2; +#else + u8 rsvd_1: 2; + u8 antidx_b: 3; + u8 antidx_a: 3; + u8 rsvd_2: 2; + u8 antidx_d: 3; + u8 antidx_c: 3; +#endif + + /* DW3 */ + u8 paid; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 paid_msb: 1; + u8 gid: 6; + u8 rsvd_3: 1; +#else + u8 rsvd_3: 1; + u8 gid: 6; + u8 paid_msb: 1; +#endif + u8 intf_pos; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 intf_pos_msb: 1; + u8 rsvd_4: 2; + u8 nb_intf_flag: 1; + u8 rf_mode: 2; + u8 rsvd_5: 2; +#else + u8 rsvd_5: 2; + u8 rf_mode: 2; + u8 nb_intf_flag: 1; + u8 rsvd_4: 2; + u8 intf_pos_msb: 1; +#endif + + /* DW4 */ + s8 rxevm[4]; /* s(8,1) */ + + /* DW5 */ + s8 cfo_tail[4]; /* s(8,7) */ + + /* DW6 */ + s8 rxsnr[4]; /* s(8,1) */ +}; + +__PACK struct _phy_status_rpt_jaguar2_type2 { + /* DW0 ane DW1 */ + u8 page_num; + u8 pwdb[4]; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 l_rxsc: 4; + u8 ht_rxsc: 4; +#else + u8 ht_rxsc: 4; + u8 l_rxsc: 4; +#endif + u8 channel; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 band: 2; + u8 rsvd_0: 1; + u8 hw_antsw_occu: 1; + u8 gnt_bt: 1; + u8 ldpc: 1; + u8 stbc: 1; + u8 beamformed: 1; +#else + u8 beamformed: 1; + u8 stbc: 1; + u8 ldpc: 1; + u8 gnt_bt: 1; + u8 hw_antsw_occu: 1; + u8 rsvd_0: 1; + u8 band: 2; +#endif + + /* DW2 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 shift_l_map: 6; + u8 rsvd_1: 2; +#else + u8 rsvd_1: 2; + u8 shift_l_map: 6; +#endif + u8 cnt_pw2cca; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 agc_table_a: 4; + u8 agc_table_b: 4; + u8 agc_table_c: 4; + u8 agc_table_d: 4; +#else + u8 agc_table_b: 4; + u8 agc_table_a: 4; + u8 agc_table_d: 4; + u8 agc_table_c: 4; +#endif + + /* DW3 ~ DW6*/ + u8 cnt_cca2agc_rdy; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 gain_a: 6; + u8 rsvd_2: 1; + u8 trsw_a: 1; + u8 gain_b: 6; + u8 rsvd_3: 1; + u8 trsw_b: 1; + u8 gain_c: 6; + u8 rsvd_4: 1; + u8 trsw_c: 1; + u8 gain_d: 6; + u8 rsvd_5: 1; + u8 trsw_d: 1; + u8 aagc_step_a: 2; + u8 aagc_step_b: 2; + u8 aagc_step_c: 2; + u8 aagc_step_d: 2; +#else + u8 trsw_a: 1; + u8 rsvd_2: 1; + u8 gain_a: 6; + u8 trsw_b: 1; + u8 rsvd_3: 1; + u8 gain_b: 6; + u8 trsw_c: 1; + u8 rsvd_4: 1; + u8 gain_c: 6; + u8 trsw_d: 1; + u8 rsvd_5: 1; + u8 gain_d: 6; + u8 aagc_step_d: 2; + u8 aagc_step_c: 2; + u8 aagc_step_b: 2; + u8 aagc_step_a: 2; +#endif + u8 ht_aagc_gain[4]; + u8 dagc_gain[4]; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 counter: 6; + u8 rsvd_6: 2; + u8 syn_count: 5; + u8 rsvd_7:3; +#else + u8 rsvd_6: 2; + u8 counter: 6; + u8 rsvd_7:3; + u8 syn_count: 5; +#endif +}; +/*==============================================*/ +#elif (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 2) +__PACK struct _phy_status_rpt_jaguar2_type0 { + /* DW0 : Offset 0 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 page_num:4; + u8 pkt_cnt:2; + u8 channel_msb:2; +#else + u8 channel_msb:2; + u8 pkt_cnt:2; + u8 page_num:4; +#endif + u8 pwdb_a; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 gain_a: 6; + u8 rsvd_0: 1; + u8 trsw: 1; +#else + u8 trsw: 1; + u8 rsvd_0: 1; + u8 gain_a: 6; +#endif + +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 agc_table_b:4; + u8 agc_table_c:4; +#else + u8 agc_table_c:4; + u8 agc_table_b:4; +#endif + + /* DW1 : Offset 4 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 rsvd_1: 4; + u8 agc_table_d: 4; +#else + u8 agc_table_d: 4; + u8 rsvd_1: 4; +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 l_rxsc: 4; + u8 agc_table_a: 4; +#else + u8 agc_table_a: 4; + u8 l_rxsc: 4; +#endif + u8 channel; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 band:2; + u8 rsvd_2_1: 1; + u8 hw_antsw_occur_keep_cck:1; + u8 gnt_bt_keep_cck:1; + u8 rsvd_2_2:3; +#else + u8 rsvd_2_2:3; + u8 gnt_bt_keep_cck:1; + u8 hw_antsw_occur_keep_cck:1; + u8 rsvd_2_1: 1; + u8 band:2; +#endif + + /* DW2 : Offset 8 */ + u16 length; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_a: 4; + u8 antidx_b: 4; + u8 antidx_c: 4; + u8 antidx_d: 4; +#else + u8 antidx_b: 4; + u8 antidx_a: 4; + u8 antidx_d: 4; + u8 antidx_c: 4; +#endif + + /* DW3 : Offset 12 */ + u8 signal_quality; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 vga_a:5; + u8 lna_l_a:3; + u8 bb_power_a:6; + u8 rsvd_3_1:1; + u8 lna_h_a:1; +#else + u8 lna_l_a:3; + u8 vga_a:5; + u8 lna_h_a:1; + u8 rsvd_3_1:1; + u8 bb_power_a:6; +#endif + u8 rsvd_3_2; + + /* DW4 : Offset 16 */ + u8 pwdb_b; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 vga_b:5; + u8 lna_l_b:3; + u8 bb_power_b:6; + u8 rsvd_4_1:1; + u8 lna_h_b:1; + u8 gain_b: 6; + u8 rsvd_4_2:2; +#else + u8 lna_l_b:3; + u8 vga_b:5; + u8 lna_h_b:1; + u8 rsvd_4_1:1; + u8 bb_power_b:6; + u8 rsvd_4_2:2; + u8 gain_b: 6; +#endif + + /* DW5 : Offset 20 */ + u8 pwdb_c; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 vga_c:5; + u8 lna_l_c:3; + u8 bb_power_c:6; + u8 rsvd_5_1:1; + u8 lna_h_c:1; + u8 gain_c: 6; + u8 rsvd_5_2:2; +#else + u8 lna_l_c:3; + u8 vga_c:5; + u8 lna_h_c:1; + u8 rsvd_5_1:1; + u8 bb_power_c:6; + u8 rsvd_5_2:2; + u8 gain_c: 6; +#endif + + /* DW6 : Offset 24 */ + u8 pwdb_d; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 vga_d:5; + u8 lna_l_d:3; + u8 bb_power_d:6; + u8 rsvd_6_1:1; + u8 lna_h_d:1; + u8 gain_d: 6; + u8 rsvd_6_2:2; +#else + u8 lna_l_d:3; + u8 vga_d:5; + u8 lna_h_d:1; + u8 rsvd_6_1:1; + u8 bb_power_d:6; + u8 rsvd_6_2:2; + u8 gain_d: 6; +#endif +}; + +__PACK struct _phy_status_rpt_jaguar2_type1 { + /* DW0 : Offset 0 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 page_num:4; + u8 pkt_cnt:2; + u8 channel_pri_msb:2; +#else + u8 channel_pri_msb:2; + u8 pkt_cnt:2; + u8 page_num:4; +#endif + u8 pwdb_a; + u8 pwdb_b; + u8 pwdb_c; + + /* DW1 : Offset 4 */ + u8 pwdb_d; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 l_rxsc: 4; + u8 ht_rxsc: 4; +#else + u8 ht_rxsc: 4; + u8 l_rxsc: 4; +#endif + u8 channel_pri_lsb; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 band: 2; + u8 rsvd_0: 2; + u8 gnt_bt: 1; + u8 ldpc: 1; + u8 stbc: 1; + u8 beamformed: 1; +#else + u8 beamformed: 1; + u8 stbc: 1; + u8 ldpc: 1; + u8 gnt_bt: 1; + u8 rsvd_0: 2; + u8 band: 2; +#endif + + /* DW2 : Offset 8 */ + u8 channel_sec_lsb; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 channel_sec_msb:2; + u8 rsvd_1: 2; + u8 hw_antsw_occur_a:1; + u8 hw_antsw_occur_b:1; + u8 hw_antsw_occur_c:1; + u8 hw_antsw_occur_d:1; +#else + u8 hw_antsw_occur_d:1; + u8 hw_antsw_occur_c:1; + u8 hw_antsw_occur_b:1; + u8 hw_antsw_occur_a:1; + u8 rsvd_1: 2; + u8 channel_sec_msb:2; + +#endif +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 antidx_a: 4; + u8 antidx_b: 4; + u8 antidx_c: 4; + u8 antidx_d: 4; +#else + u8 antidx_b: 4; + u8 antidx_a: 4; + u8 antidx_d: 4; + u8 antidx_c: 4; +#endif + + /* DW3 : Offset 12 */ + u8 paid; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 paid_msb: 1; + u8 gid: 6; + u8 rsvd_3: 1; +#else + u8 rsvd_3: 1; + u8 gid: 6; + u8 paid_msb: 1; +#endif + u16 rsvd_4; +/* + u8 rsvd_4; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 rsvd_5: 6; + u8 rf_mode: 2; +#else + u8 rf_mode: 2; + u8 rsvd_5: 6; +#endif +*/ + /* DW4 */ + s8 rxevm[4]; /* s(8,1) */ + + /* DW5 */ + s8 cfo_tail[4]; /* s(8,7) */ + + /* DW6 */ + s8 rxsnr[4]; /* s(8,1) */ +}; +__PACK struct _phy_status_rpt_jaguar2_type2_type3 { + /* Type2 is primary channel & type3 is secondary channel */ + /* DW0 ane DW1 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 page_num:4; + u8 pkt_cnt:2; + u8 channel_msb:2; +#else + u8 channel_msb:2; + u8 pkt_cnt:2; + u8 page_num:4; +#endif + u8 pwdb[4]; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 l_rxsc: 4; + u8 ht_rxsc: 4; +#else + u8 ht_rxsc: 4; + u8 l_rxsc: 4; +#endif + u8 channel_lsb; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 band: 2; + u8 rsvd_0: 1; + u8 hw_antsw_occu: 1; + u8 gnt_bt: 1; + u8 ldpc: 1; + u8 stbc: 1; + u8 beamformed: 1; +#else + u8 beamformed: 1; + u8 stbc: 1; + u8 ldpc: 1; + u8 gnt_bt: 1; + u8 hw_antsw_occu: 1; + u8 rsvd_0: 1; + u8 band: 2; +#endif + + /* DW2 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 shift_l_map: 6; + u8 rsvd_1: 2; +#else + u8 rsvd_1: 2; + u8 shift_l_map: 6; +#endif + s8 pwed_th; /* dynamic energy threshold S(8,2) */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 agc_table_a: 4; + u8 agc_table_b: 4; + u8 agc_table_c: 4; + u8 agc_table_d: 4; +#else + u8 agc_table_b: 4; + u8 agc_table_a: 4; + u8 agc_table_d: 4; + u8 agc_table_c: 4; +#endif + + /* DW3 ~ DW6*/ + u8 cnt_cca2agc_rdy; /* Time(ns) = cnt_cca2agc_ready*25 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 mp_gain_a: 6; + u8 mp_gain_b_lsb: 2; + u8 mp_gain_b_msb: 4; + u8 mp_gain_c_lsb: 4; + u8 mp_gain_c_msb: 2; + u8 avg_noise_pwr_lsb: 4; + u8 rsvd_3:2; + /* u8 r_rfmod:2; */ + u8 mp_gain_d: 6; + u8 is_freq_select_fading: 1; + u8 rsvd_2: 1; + u8 aagc_step_a: 2; + u8 aagc_step_b: 2; + u8 aagc_step_c: 2; + u8 aagc_step_d: 2; +#else + u8 mp_gain_b_lsb: 2; + u8 mp_gain_a: 6; + u8 mp_gain_c_lsb: 4; + u8 mp_gain_b_msb: 4; + u8 rsvd_3:2; + /* u8 r_rfmod:2; */ + u8 avg_noise_pwr_lsb: 4; + u8 mp_gain_c_msb: 2; + u8 rsvd_2: 1; + u8 is_freq_select_fading: 1; + u8 mp_gain_d: 6; + u8 aagc_step_d: 2; + u8 aagc_step_c: 2; + u8 aagc_step_b: 2; + u8 aagc_step_a: 2; +#endif + u8 ht_aagc_gain[4]; + u8 dagc_gain[4]; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 counter: 6; + u8 syn_count_lsb: 2; + u8 syn_count_msb: 3; + u8 avg_noise_pwr_msb:5; +#else + u8 syn_count_lsb: 2; + u8 counter: 6; + u8 avg_noise_pwr_msb:5; + u8 syn_count_msb: 3; +#endif +}; + +__PACK struct _phy_status_rpt_jaguar2_type4 { + /* smart antenna */ + /* DW0 ane DW1 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 page_num:4; + u8 pkt_cnt:2; + u8 channel_msb:2; +#else + u8 channel_msb:2; + u8 pkt_cnt:2; + u8 page_num:4; +#endif + u8 pwdb[4]; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 l_rxsc: 4; + u8 ht_rxsc: 4; +#else + u8 ht_rxsc: 4; + u8 l_rxsc: 4; +#endif + u8 channel_lsb; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 band: 2; + u8 rsvd_0: 1; + u8 hw_antsw_occu: 1; + u8 gnt_bt: 1; + u8 ldpc: 1; + u8 stbc: 1; + u8 beamformed: 1; +#else + u8 beamformed: 1; + u8 stbc: 1; + u8 ldpc: 1; + u8 gnt_bt: 1; + u8 hw_antsw_occu: 1; + u8 rsvd_0: 1; + u8 band: 2; +#endif + + /* DW2 ~ DW3 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 bad_tone_cnt_min_eign_0:4; + u8 bad_tone_cnt_cn_excess_0:4; + u8 training_done_a:1; + u8 training_done_b:1; + u8 training_done_c:1; + u8 training_done_d:1; + u8 hw_antsw_occur_a:1; + u8 hw_antsw_occur_b:1; + u8 hw_antsw_occur_c:1; + u8 hw_antsw_occur_d:1; + u8 antidx_a: 4; + u8 antidx_b: 4; + u8 antidx_c: 4; + u8 antidx_d: 4; +#else + u8 bad_tone_cnt_cn_excess_0:4; + u8 bad_tone_cnt_min_eign_0:4; + u8 hw_antsw_occur_d:1; + u8 hw_antsw_occur_c:1; + u8 hw_antsw_occur_b:1; + u8 hw_antsw_occur_a:1; + u8 training_done_d:1; + u8 training_done_c:1; + u8 training_done_b:1; + u8 training_done_a:1; + u8 antidx_b: 4; + u8 antidx_a: 4; + u8 antidx_d: 4; + u8 antidx_c: 4; +#endif + u8 tx_pkt_cnt; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 bad_tone_cnt_min_eign_1:4; + u8 bad_tone_cnt_cn_excess_1:4; + u8 avg_cond_num_0:7; + u8 avg_cond_num_1_lsb:1; + u8 avg_cond_num_1_msb:6; + u8 rsvd_1:2; +#else + u8 bad_tone_cnt_cn_excess_1:4; + u8 bad_tone_cnt_min_eign_1:4; + u8 avg_cond_num_1_lsb:1; + u8 avg_cond_num_0:7; + u8 rsvd_1:2; + u8 avg_cond_num_1_msb:6; +#endif + + /* DW4 */ + s8 rxevm[4]; /* s(8,1) */ + + /* DW5 */ + u8 eigenvalue[4]; /* eigenvalue or eigenvalue of seg0 (in dB) */ + + /* DW6 */ + s8 rxsnr[4]; /* s(8,1) */ +}; + +__PACK struct _phy_status_rpt_jaguar2_type5 { + /* smart antenna */ + /* DW0 ane DW1 */ +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 page_num:4; + u8 pkt_cnt:2; + u8 channel_msb:2; +#else + u8 channel_msb:2; + u8 pkt_cnt:2; + u8 page_num:4; +#endif + u8 pwdb[4]; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 l_rxsc: 4; + u8 ht_rxsc: 4; +#else + u8 ht_rxsc: 4; + u8 l_rxsc: 4; +#endif + u8 channel_lsb; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 band: 2; + u8 rsvd_0: 1; + u8 hw_antsw_occu: 1; + u8 gnt_bt: 1; + u8 ldpc: 1; + u8 stbc: 1; + u8 beamformed: 1; +#else + u8 beamformed: 1; + u8 stbc: 1; + u8 ldpc: 1; + u8 gnt_bt: 1; + u8 hw_antsw_occu: 1; + u8 rsvd_0: 1; + u8 band: 2; +#endif + /* DW2 ~ DW5 */ + u8 rsvd_1; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 rsvd_2:4; + u8 hw_antsw_occur_a:1; + u8 hw_antsw_occur_b:1; + u8 hw_antsw_occur_c:1; + u8 hw_antsw_occur_d:1; + u8 antidx_a: 4; + u8 antidx_b: 4; + u8 antidx_c: 4; + u8 antidx_d: 4; +#else + u8 hw_antsw_occur_d:1; + u8 hw_antsw_occur_c:1; + u8 hw_antsw_occur_b:1; + u8 hw_antsw_occur_a:1; + u8 rsvd_2:4; + u8 antidx_b: 4; + u8 antidx_a: 4; + u8 antidx_d: 4; + u8 antidx_c: 4; +#endif + u8 tx_pkt_cnt; +#if (ODM_ENDIAN_TYPE == ODM_ENDIAN_LITTLE) + u8 inf_pos_0_A_flg:1; + u8 inf_pos_1_A_flg:1; + u8 inf_pos_0_B_flg:1; + u8 inf_pos_1_B_flg:1; + u8 inf_pos_0_C_flg:1; + u8 inf_pos_1_C_flg:1; + u8 inf_pos_0_D_flg:1; + u8 inf_pos_1_D_flg:1; +#else + u8 inf_pos_1_D_flg:1; + u8 inf_pos_0_D_flg:1; + u8 inf_pos_1_C_flg:1; + u8 inf_pos_0_C_flg:1; + u8 inf_pos_1_B_flg:1; + u8 inf_pos_0_B_flg:1; + u8 inf_pos_1_A_flg:1; + u8 inf_pos_0_A_flg:1; +#endif + u8 rsvd_3; + u8 rsvd_4; + u8 inf_pos_0_a; + u8 inf_pos_1_a; + u8 inf_pos_0_b; + u8 inf_pos_1_b; + u8 inf_pos_0_c; + u8 inf_pos_1_c; + u8 inf_pos_0_d; + u8 inf_pos_1_d; +}; +#endif /*#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1)*/ + +#if (ODM_PHY_STATUS_NEW_TYPE_SUPPORT == 1) + +void +phydm_rx_phy_status_new_type( + void *p_dm_void, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo, + struct phydm_phyinfo_struct *p_phy_info +); + +boolean +phydm_query_is_mu_api( + struct PHY_DM_STRUCT *p_phydm, + u8 ppdu_idx, + u8 *p_data_rate, + u8 *p_gid +); +#endif + +void +phydm_reset_phystatus_avg( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_reset_phystatus_statistic( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_reset_rssi_for_dm( + struct PHY_DM_STRUCT *p_dm, + u8 station_id +); + +void +phydm_get_cck_rssi_table_from_reg( + struct PHY_DM_STRUCT *p_dm +); + +u8 +phydm_rate_to_num_ss( + struct PHY_DM_STRUCT *p_dm, + u8 data_rate +); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +phydm_normal_driver_rx_sniffer( + struct PHY_DM_STRUCT *p_dm, + u8 *p_desc, + PRT_RFD_STATUS p_rt_rfd_status, + u8 *p_drv_info, + u8 phy_status +); +#endif + +s32 +phydm_signal_scale_mapping( + struct PHY_DM_STRUCT *p_dm, + s32 curr_sig +); + +void +odm_phy_status_query( + struct PHY_DM_STRUCT *p_dm, + struct phydm_phyinfo_struct *p_phy_info, + u8 *p_phy_status, + struct phydm_perpkt_info_struct *p_pktinfo +); + +void +phydm_rx_phy_status_init( + void *p_dm_void +); + +#endif /*#ifndef __HALHWOUTSRC_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.c new file mode 100644 index 000000000000..c361e32a8632 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.c @@ -0,0 +1,213 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_POWER_TRAINING_SUPPORT +void +phydm_reset_pt_para( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pow_train_stuc *p_pow_train_t = &(p_dm->pow_train_table); + + p_pow_train_t->pow_train_score = 0; + p_dm->phy_dbg_info.num_qry_phy_status_ofdm = 0; + p_dm->phy_dbg_info.num_qry_phy_status_cck = 0; +} + +void +phydm_update_power_training_state( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pow_train_stuc *p_pow_train_t = &(p_dm->pow_train_table); + struct phydm_fa_struct *p_fa_cnt = &(p_dm->false_alm_cnt); + struct phydm_dig_struct *p_dig_t = &p_dm->dm_dig_table; + u32 pt_score_tmp = 0; + u32 crc_ok_cnt; + u32 cca_all_cnt; + + + /*is_disable_power_training is the key to H2C to disable/enable power training*/ + /*if is_disable_power_training == 1, it will use largest power*/ + if (!(p_dm->support_ability & ODM_BB_PWR_TRAIN)) { + p_dm->is_disable_power_training = true; + phydm_reset_pt_para(p_dm); + return; + } + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("%s ======>\n", __FUNCTION__)); + + if (p_pow_train_t->force_power_training_state == DISABLE_POW_TRAIN) { + + p_dm->is_disable_power_training = true; + phydm_reset_pt_para(p_dm); + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("Disable PT\n")); + return; + + } else if (p_pow_train_t->force_power_training_state == ENABLE_POW_TRAIN) { + + p_dm->is_disable_power_training = false; + phydm_reset_pt_para(p_dm); + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("Enable PT\n")); + return; + + } else if (p_pow_train_t->force_power_training_state == DYNAMIC_POW_TRAIN) { + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("Dynamic PT\n")); + + if (!p_dm->is_linked) { + p_dm->is_disable_power_training = true; + p_pow_train_t->pow_train_score = 0; + p_dm->phy_dbg_info.num_qry_phy_status_ofdm = 0; + p_dm->phy_dbg_info.num_qry_phy_status_cck = 0; + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("PT is disabled due to no link.\n")); + return; + } + + /* First connect */ + if ((p_dm->is_linked) && (p_dig_t->is_media_connect == false)) { + p_pow_train_t->pow_train_score = 0; + p_dm->phy_dbg_info.num_qry_phy_status_ofdm = 0; + p_dm->phy_dbg_info.num_qry_phy_status_cck = 0; + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("(PT)First Connect\n")); + return; + } + + /* Compute score */ + crc_ok_cnt = p_dm->phy_dbg_info.num_qry_phy_status_ofdm + p_dm->phy_dbg_info.num_qry_phy_status_cck; + cca_all_cnt = p_fa_cnt->cnt_cca_all; + + if (crc_ok_cnt < cca_all_cnt) { + /* crc_ok <= (2/3)*cca */ + if ((crc_ok_cnt + (crc_ok_cnt >> 1)) <= cca_all_cnt) + pt_score_tmp = DISABLE_PT_SCORE; + + /* crc_ok <= (4/5)*cca */ + else if ((crc_ok_cnt + (crc_ok_cnt >> 2)) <= cca_all_cnt) + pt_score_tmp = KEEP_PRE_PT_SCORE; + + /* crc_ok > (4/5)*cca */ + else + pt_score_tmp = ENABLE_PT_SCORE; + } else { + pt_score_tmp = ENABLE_PT_SCORE; + } + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("crc_ok_cnt = %d, cnt_cca_all = %d\n", + crc_ok_cnt, cca_all_cnt)); + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("num_qry_phy_status_ofdm = %d, num_qry_phy_status_cck = %d\n", + p_dm->phy_dbg_info.num_qry_phy_status_ofdm, p_dm->phy_dbg_info.num_qry_phy_status_cck)); + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("pt_score_tmp = %d\n", pt_score_tmp)); + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("pt_score_tmp = 0(DISABLE), 1(KEEP), 2(ENABLE)\n")); + + /* smoothing */ + p_pow_train_t->pow_train_score = (pt_score_tmp << 4) + (p_pow_train_t->pow_train_score >> 1) + (p_pow_train_t->pow_train_score >> 2); + pt_score_tmp = (p_pow_train_t->pow_train_score + 32) >> 6; + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("pow_train_score = %d, score after smoothing = %d\n", + p_pow_train_t->pow_train_score, pt_score_tmp)); + + /* mode decision */ + if (pt_score_tmp == ENABLE_PT_SCORE) { + + p_dm->is_disable_power_training = false; + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("Enable power training under dynamic.\n")); + + } else if (pt_score_tmp == DISABLE_PT_SCORE) { + + p_dm->is_disable_power_training = true; + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("Disable PT due to noisy.\n")); + } + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("Final, score = %d, is_disable_power_training = %d\n", + pt_score_tmp, p_dm->is_disable_power_training)); + + p_dm->phy_dbg_info.num_qry_phy_status_ofdm = 0; + p_dm->phy_dbg_info.num_qry_phy_status_cck = 0; + } else { + + p_dm->is_disable_power_training = true; + phydm_reset_pt_para(p_dm); + + PHYDM_DBG(p_dm, DBG_PWR_TRAIN, ("PT is disabled due to unknown pt state.\n")); + return; + } +} + +void +phydm_pow_train_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pow_train_stuc *p_pow_train_t = &(p_dm->pow_train_table); + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i; + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "0: Dynamic state\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "1: Enable PT\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "2: Disable PT\n")); + + } else { + + for (i = 0; i < 10; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &var1[i]); + } + } + + if (var1[0] == 0) { + p_pow_train_t->force_power_training_state = DYNAMIC_POW_TRAIN; + PHYDM_SNPRINTF((output + used, out_len - used, "Dynamic state\n")); + } else if (var1[0] == 1) { + p_pow_train_t->force_power_training_state = ENABLE_POW_TRAIN; + PHYDM_SNPRINTF((output + used, out_len - used, "Enable PT\n")); + } else if (var1[0] == 2) { + p_pow_train_t->force_power_training_state = DISABLE_POW_TRAIN; + PHYDM_SNPRINTF((output + used, out_len - used, "Disable PT\n")); + } else { + PHYDM_SNPRINTF((output + used, out_len - used, "Set Error\n")); + } + } + + *_used = used; + *_out_len = out_len; +} + + +#endif + + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.h new file mode 100644 index 000000000000..8307890419b1 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pow_train.h @@ -0,0 +1,77 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDM_POW_TRAIN_H__ +#define __PHYDM_POW_TRAIN_H__ + +#define POW_TRAIN_VERSION "1.0" /* 2017.07.0141 Dino, Add phydm_pow_train.h*/ + + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + + +#ifdef PHYDM_POWER_TRAINING_SUPPORT +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + + +struct phydm_pow_train_stuc { + + u8 force_power_training_state; + u32 pow_train_score; +}; + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + + +enum pow_train_state_e { + DYNAMIC_POW_TRAIN = 0, + ENABLE_POW_TRAIN = 1, + DISABLE_POW_TRAIN = 2 +}; + +enum power_training_score { + DISABLE_PT_SCORE = 0, + KEEP_PRE_PT_SCORE = 1, + ENABLE_PT_SCORE = 2 +}; + +/* 1 ============================================================ + * 1 function prototype + * 1 ============================================================ */ + +void +phydm_update_power_training_state( + void *p_dm_void +); + +void +phydm_pow_train_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.c deleted file mode 100644 index b5a4a3060695..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.c +++ /dev/null @@ -1,1216 +0,0 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if !defined(_OUTSRC_COEXIST) -//============================================================ -// Global var -//============================================================ - - -u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D] = { - 0x0b40002d, // 0, -15.0dB - 0x0c000030, // 1, -14.5dB - 0x0cc00033, // 2, -14.0dB - 0x0d800036, // 3, -13.5dB - 0x0e400039, // 4, -13.0dB - 0x0f00003c, // 5, -12.5dB - 0x10000040, // 6, -12.0dB - 0x11000044, // 7, -11.5dB - 0x12000048, // 8, -11.0dB - 0x1300004c, // 9, -10.5dB - 0x14400051, // 10, -10.0dB - 0x15800056, // 11, -9.5dB - 0x16c0005b, // 12, -9.0dB - 0x18000060, // 13, -8.5dB - 0x19800066, // 14, -8.0dB - 0x1b00006c, // 15, -7.5dB - 0x1c800072, // 16, -7.0dB - 0x1e400079, // 17, -6.5dB - 0x20000080, // 18, -6.0dB - 0x22000088, // 19, -5.5dB - 0x24000090, // 20, -5.0dB - 0x26000098, // 21, -4.5dB - 0x288000a2, // 22, -4.0dB - 0x2ac000ab, // 23, -3.5dB - 0x2d4000b5, // 24, -3.0dB - 0x300000c0, // 25, -2.5dB - 0x32c000cb, // 26, -2.0dB - 0x35c000d7, // 27, -1.5dB - 0x390000e4, // 28, -1.0dB - 0x3c8000f2, // 29, -0.5dB - 0x40000100, // 30, +0dB - 0x43c0010f, // 31, +0.5dB - 0x47c0011f, // 32, +1.0dB - 0x4c000130, // 33, +1.5dB - 0x50800142, // 34, +2.0dB - 0x55400155, // 35, +2.5dB - 0x5a400169, // 36, +3.0dB - 0x5fc0017f, // 37, +3.5dB - 0x65400195, // 38, +4.0dB - 0x6b8001ae, // 39, +4.5dB - 0x71c001c7, // 40, +5.0dB - 0x788001e2, // 41, +5.5dB - 0x7f8001fe // 42, +6.0dB -}; - -u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { - {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB - {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB - {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB - {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB - {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB - {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB - {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB - {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB - {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB - {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB - {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB - {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB - {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB - {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB - {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB - {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB - {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB - {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB - {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB - {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB - {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB - {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB - {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB - {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB - {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB - {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB - {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB - {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB - {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB - {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB - {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB - {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB - {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -}; - - -u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { - {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB - {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB - {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB - {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB - {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB - {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB - {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB - {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB - {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB - {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB - {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB - {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB - {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB - {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB - {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB - {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB - {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB - {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB - {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB - {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB - {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB - {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB - {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB - {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB - {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB - {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB - {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB - {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB - {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB - {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB - {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB - {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB - {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -}; - -u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D] = { - 0x0b40002d, // 0, -15.0dB - 0x0c000030, // 1, -14.5dB - 0x0cc00033, // 2, -14.0dB - 0x0d800036, // 3, -13.5dB - 0x0e400039, // 4, -13.0dB - 0x0f00003c, // 5, -12.5dB - 0x10000040, // 6, -12.0dB - 0x11000044, // 7, -11.5dB - 0x12000048, // 8, -11.0dB - 0x1300004c, // 9, -10.5dB - 0x14400051, // 10, -10.0dB - 0x15800056, // 11, -9.5dB - 0x16c0005b, // 12, -9.0dB - 0x18000060, // 13, -8.5dB - 0x19800066, // 14, -8.0dB - 0x1b00006c, // 15, -7.5dB - 0x1c800072, // 16, -7.0dB - 0x1e400079, // 17, -6.5dB - 0x20000080, // 18, -6.0dB - 0x22000088, // 19, -5.5dB - 0x24000090, // 20, -5.0dB - 0x26000098, // 21, -4.5dB - 0x288000a2, // 22, -4.0dB - 0x2ac000ab, // 23, -3.5dB - 0x2d4000b5, // 24, -3.0dB - 0x300000c0, // 25, -2.5dB - 0x32c000cb, // 26, -2.0dB - 0x35c000d7, // 27, -1.5dB - 0x390000e4, // 28, -1.0dB - 0x3c8000f2, // 29, -0.5dB - 0x40000100, // 30, +0dB - 0x43c0010f, // 31, +0.5dB - 0x47c0011f, // 32, +1.0dB - 0x4c000130, // 33, +1.5dB - 0x50800142, // 34, +2.0dB - 0x55400155, // 35, +2.5dB - 0x5a400169, // 36, +3.0dB - 0x5fc0017f, // 37, +3.5dB - 0x65400195, // 38, +4.0dB - 0x6b8001ae, // 39, +4.5dB - 0x71c001c7, // 40, +5.0dB - 0x788001e2, // 41, +5.5dB - 0x7f8001fe // 42, +6.0dB -}; - - -u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { - {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB - {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB - {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB - {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB - {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB - {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB - {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB - {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB - {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB - {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB - {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB - {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB - {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB - {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB - {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB - {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB - {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB - {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB - {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB - {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB - {0x1c, 0x1a, 0x18, 0x12, 0x0e, 0x08, 0x04, 0x02}, // 20, -6.0dB - {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB - {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB - {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB - {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB - {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB - {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB - {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB - {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB - {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB - {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB - {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB - {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -}; - - -u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]= { - {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB - {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB - {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB - {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB - {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB - {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB - {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB - {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB - {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB - {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB - {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB - {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB - {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB - {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB - {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB - {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB - {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB - {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB - {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB - {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB - {0x1c, 0x1a, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB - {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB - {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB - {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB - {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB - {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB - {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB - {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB - {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB - {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB - {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB - {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB - {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -}; - -u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -{0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ -{0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ -{0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ -{0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ -{0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ -{0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ -{0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ -{0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ -{0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ -{0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ -{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ -{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ -{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ -{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ -{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ -{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ -{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ -{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ -{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ -{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ -{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ -}; - - -u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { -{0x16, 0x15, 0x13, 0x10, 0xD, 0x9, 0x6, 0x3, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 0 -16dB */ -{0x18, 0x17, 0x15, 0x12, 0xE, 0xA, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 1 -15.5dB */ -{0x1B, 0x1A, 0x18, 0x14, 0x10, 0xB, 0x7, 0x4, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 2 -15dB */ -{0x1F, 0x1E, 0x1B, 0x17, 0x12, 0xD, 0x8, 0x5, 0x2, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 3 -14.5dB */ -{0x22, 0x21, 0x1E, 0x19, 0x14, 0xE, 0x9, 0x5, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 4 -14dB */ -{0x26, 0x25, 0x22, 0x1C, 0x16, 0x10, 0xA, 0x6, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 5 -13.5dB */ -{0x2B, 0x2A, 0x26, 0x20, 0x19, 0x12, 0xC, 0x7, 0x3, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 6 -13dB */ -{0x30, 0x2F, 0x2A, 0x24, 0x1C, 0x14, 0xD, 0x8, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 7 -12.5dB */ -{0x36, 0x34, 0x2F, 0x28, 0x1F, 0x17, 0xF, 0x9, 0x4, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 8 -12dB */ -{0x3D, 0x3B, 0x35, 0x2D, 0x23, 0x19, 0x11, 0xA, 0x5, 0x1, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 9 -11.5dB */ -{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0xB, 0x5, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 10 -11dB */ -{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0xC, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 11 -10.5dB */ -{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0xE, 0x6, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 12 -10dB */ -{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0xF, 0x7, 0x2, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 13 -9.5dB */ -{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x8, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 14 -9dB */ -{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x9, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 15 -8.5dB */ -{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0xA, 0x3, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 16 -8dB */ -{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0xB, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 17 -7.5dB */ -{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0xD, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 18 -7dB */ -{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0xE, 0x4, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0}, /* 19 -6.5dB */ -{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x5, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0} /* 20 -6dB */ -}; - - -u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -}; - - - -#if 0 -u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { - /* Index0 6 dB */ 0x7fc001ff, - /* Index1 5.7dB */ 0x7b4001ed, - /* Index2 5.4dB */ 0x774001dd, - /* Index3 5.1dB */ 0x734001cd, - /* Index4 4.8dB */ 0x6f4001bd, - /* Index5 4.5dB */ 0x6b8001ae, - /* Index6 4.2dB */ 0x67c0019f, - /* Index7 3.9dB */ 0x64400191, - /* Index8 3.6dB */ 0x60c00183, - /* Index9 3.3dB */ 0x5d800176, - /* Index10 3 dB */ 0x5a80016a, - /* Index11 2.7dB */ 0x5740015d, - /* Index12 2.4dB */ 0x54400151, - /* Index13 2.1dB */ 0x51800146, - /* Index14 1.8dB */ 0x4ec0013b, - /* Index15 1.5dB */ 0x4c000130, - /* Index16 1.2dB */ 0x49800126, - /* Index17 0.9dB */ 0x4700011c, - /* Index18 0.6dB */ 0x44800112, - /* Index19 0.3dB */ 0x42000108, - /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index - /* Index21 -0.3dB */ 0x3dc000f7, - /* Index22 -0.6dB */ 0x3bc000ef, - /* Index23 -0.9dB */ 0x39c000e7, - /* Index24 -1.2dB */ 0x37c000df, - /* Index25 -1.5dB */ 0x35c000d7, - /* Index26 -1.8dB */ 0x340000d0, - /* Index27 -2.1dB */ 0x324000c9, - /* Index28 -2.4dB */ 0x308000c2, - /* Index29 -2.7dB */ 0x2f0000bc, - /* Index30 -3 dB */ 0x2d4000b5, - /* Index31 -3.3dB */ 0x2bc000af, - /* Index32 -3.6dB */ 0x2a4000a9, - /* Index33 -3.9dB */ 0x28c000a3, - /* Index34 -4.2dB */ 0x2780009e, - /* Index35 -4.5dB */ 0x26000098, - /* Index36 -4.8dB */ 0x24c00093, - /* Index37 -5.1dB */ 0x2380008e, - /* Index38 -5.4dB */ 0x22400089, - /* Index39 -5.7dB */ 0x21400085, - /* Index40 -6 dB */ 0x20000080, - /* Index41 -6.3dB */ 0x1f00007c, - /* Index42 -6.6dB */ 0x1e000078, - /* Index43 -6.9dB */ 0x1d000074, - /* Index44 -7.2dB */ 0x1c000070, - /* Index45 -7.5dB */ 0x1b00006c, - /* Index46 -7.8dB */ 0x1a000068, - /* Index47 -8.1dB */ 0x19400065, - /* Index48 -8.4dB */ 0x18400061, - /* Index49 -8.7dB */ 0x1780005e, - /* Index50 -9 dB */ 0x16c0005b, - /* Index51 -9.3dB */ 0x16000058, - /* Index52 -9.6dB */ 0x15400055, - /* Index53 -9.9dB */ 0x14800052 -}; -u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { - /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, - /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, - /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, - /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, - /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, - /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, - /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, - /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, - /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, - /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, - /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, - /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, - /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, - /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, - /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, - /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, - /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, - /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, - /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, - /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, - /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index - /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, - /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, - /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, - /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, - /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, - /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, - /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, - /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, - /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, - /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index - /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, - /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, - /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, - /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, - /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, - /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, - /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, - /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, - /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, - /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, - /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, - /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, - /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, - /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} -}; -u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { - /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} -}; -#endif - -#ifdef AP_BUILD_WORKAROUND - -unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { - /* +6.0dB */ 0x7f8001fe, - /* +5.5dB */ 0x788001e2, - /* +5.0dB */ 0x71c001c7, - /* +4.5dB */ 0x6b8001ae, - /* +4.0dB */ 0x65400195, - /* +3.5dB */ 0x5fc0017f, - /* +3.0dB */ 0x5a400169, - /* +2.5dB */ 0x55400155, - /* +2.0dB */ 0x50800142, - /* +1.5dB */ 0x4c000130, - /* +1.0dB */ 0x47c0011f, - /* +0.5dB */ 0x43c0010f, - /* 0.0dB */ 0x40000100, - /* -0.5dB */ 0x3c8000f2, - /* -1.0dB */ 0x390000e4, - /* -1.5dB */ 0x35c000d7, - /* -2.0dB */ 0x32c000cb, - /* -2.5dB */ 0x300000c0, - /* -3.0dB */ 0x2d4000b5, - /* -3.5dB */ 0x2ac000ab, - /* -4.0dB */ 0x288000a2, - /* -4.5dB */ 0x26000098, - /* -5.0dB */ 0x24000090, - /* -5.5dB */ 0x22000088, - /* -6.0dB */ 0x20000080, - /* -6.5dB */ 0x1a00006c, - /* -7.0dB */ 0x1c800072, - /* -7.5dB */ 0x18000060, - /* -8.0dB */ 0x19800066, - /* -8.5dB */ 0x15800056, - /* -9.0dB */ 0x26c0005b, - /* -9.5dB */ 0x14400051, - /* -10.0dB */ 0x24400051, - /* -10.5dB */ 0x1300004c, - /* -11.0dB */ 0x12000048, - /* -11.5dB */ 0x11000044, - /* -12.0dB */ 0x10000040 -}; -#endif - -#endif - - -u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3 -, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4 -, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; - - -#ifdef CONFIG_WLAN_HAL_8192EE -u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E] = { - /* Index0 6 dB */ 0x7fc001ff, - /* Index1 5.7dB */ 0x7b4001ed, - /* Index2 5.4dB */ 0x774001dd, - /* Index3 5.1dB */ 0x734001cd, - /* Index4 4.8dB */ 0x6f4001bd, - /* Index5 4.5dB */ 0x6b8001ae, - /* Index6 4.2dB */ 0x67c0019f, - /* Index7 3.9dB */ 0x64400191, - /* Index8 3.6dB */ 0x60c00183, - /* Index9 3.3dB */ 0x5d800176, - /* Index10 3 dB */ 0x5a80016a, - /* Index11 2.7dB */ 0x5740015d, - /* Index12 2.4dB */ 0x54400151, - /* Index13 2.1dB */ 0x51800146, - /* Index14 1.8dB */ 0x4ec0013b, - /* Index15 1.5dB */ 0x4c000130, - /* Index16 1.2dB */ 0x49800126, - /* Index17 0.9dB */ 0x4700011c, - /* Index18 0.6dB */ 0x44800112, - /* Index19 0.3dB */ 0x42000108, - /* Index20 0 dB */ 0x40000100, // 20 This is OFDM base index - /* Index21 -0.3dB */ 0x3dc000f7, - /* Index22 -0.6dB */ 0x3bc000ef, - /* Index23 -0.9dB */ 0x39c000e7, - /* Index24 -1.2dB */ 0x37c000df, - /* Index25 -1.5dB */ 0x35c000d7, - /* Index26 -1.8dB */ 0x340000d0, - /* Index27 -2.1dB */ 0x324000c9, - /* Index28 -2.4dB */ 0x308000c2, - /* Index29 -2.7dB */ 0x2f0000bc, - /* Index30 -3 dB */ 0x2d4000b5, - /* Index31 -3.3dB */ 0x2bc000af, - /* Index32 -3.6dB */ 0x2a4000a9, - /* Index33 -3.9dB */ 0x28c000a3, - /* Index34 -4.2dB */ 0x2780009e, - /* Index35 -4.5dB */ 0x26000098, - /* Index36 -4.8dB */ 0x24c00093, - /* Index37 -5.1dB */ 0x2380008e, - /* Index38 -5.4dB */ 0x22400089, - /* Index39 -5.7dB */ 0x21400085, - /* Index40 -6 dB */ 0x20000080, - /* Index41 -6.3dB */ 0x1f00007c, - /* Index42 -6.6dB */ 0x1e000078, - /* Index43 -6.9dB */ 0x1d000074, - /* Index44 -7.2dB */ 0x1c000070, - /* Index45 -7.5dB */ 0x1b00006c, - /* Index46 -7.8dB */ 0x1a000068, - /* Index47 -8.1dB */ 0x19400065, - /* Index48 -8.4dB */ 0x18400061, - /* Index49 -8.7dB */ 0x1780005e, - /* Index50 -9 dB */ 0x16c0005b, - /* Index51 -9.3dB */ 0x16000058, - /* Index52 -9.6dB */ 0x15400055, - /* Index53 -9.9dB */ 0x14800052 -}; -u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8] = { - /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x1C , 0x12 , 0x08 , 0x04}, - /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x1B , 0x11 , 0x08 , 0x04}, - /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x1A , 0x11 , 0x07 , 0x04}, - /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x19 , 0x10 , 0x07 , 0x04}, - /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x18 , 0x10 , 0x07 , 0x03}, - /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x18 , 0x0F , 0x07 , 0x03}, - /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x17 , 0x0F , 0x06 , 0x03}, - /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x16 , 0x0E , 0x06 , 0x03}, - /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x15 , 0x0E , 0x06 , 0x03}, - /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x14 , 0x0D , 0x06 , 0x03}, - /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x14 , 0x0D , 0x06 , 0x03}, - /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x13 , 0x0C , 0x05 , 0x03}, - /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x12 , 0x0C , 0x05 , 0x03}, - /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x12 , 0x0B , 0x05 , 0x03}, - /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, - /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x11 , 0x0B , 0x05 , 0x02}, - /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x10 , 0x0A , 0x05 , 0x02}, - /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x10 , 0x0A , 0x04 , 0x02}, - /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x0F , 0x0A , 0x04 , 0x02}, - /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x0E , 0x09 , 0x04 , 0x02}, - /* Index20 -6.0dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x0E , 0x09 , 0x04 , 0x02}, // 20 This is CCK base index - /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x0E , 0x09 , 0x04 , 0x02}, - /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x0D , 0x08 , 0x04 , 0x02}, - /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x0D , 0x08 , 0x04 , 0x02}, - /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x0C , 0x08 , 0x03 , 0x02}, - /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x0C , 0x08 , 0x03 , 0x02}, - /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, - /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x0B , 0x07 , 0x03 , 0x02}, - /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x0B , 0x07 , 0x03 , 0x02}, - /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x0A , 0x07 , 0x03 , 0x01}, - /* Index30 -9.0dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, // 30 This is hp CCK base index - /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x0A , 0x06 , 0x03 , 0x01}, - /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x09 , 0x06 , 0x03 , 0x01}, - /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x09 , 0x06 , 0x03 , 0x01}, - /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x09 , 0x06 , 0x02 , 0x01}, - /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, - /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x08 , 0x05 , 0x02 , 0x01}, - /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x08 , 0x05 , 0x02 , 0x01}, - /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, - /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, - /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x07 , 0x05 , 0x02 , 0x01}, - /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, - /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x07 , 0x04 , 0x02 , 0x01}, - /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x06 , 0x04 , 0x02 , 0x01}, - /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x05 , 0x03 , 0x02 , 0x01}, - /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x05 , 0x03 , 0x01 , 0x01}, - /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x04 , 0x03 , 0x01 , 0x01} -}; -u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8] = { - /* Index0 0 dB */ {0x36, 0x34 , 0x2E , 0x26 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index1 -0.3dB */ {0x34, 0x32 , 0x2C , 0x25 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index2 -0.6dB */ {0x32, 0x30 , 0x2B , 0x23 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index3 -0.9dB */ {0x31, 0x2F , 0x29 , 0x22 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index4 -1.2dB */ {0x2F, 0x2D , 0x28 , 0x21 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index5 -1.5dB */ {0x2D, 0x2C , 0x27 , 0x20 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index6 -1.8dB */ {0x2C, 0x2A , 0x25 , 0x1F , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index7 -2.1dB */ {0x2A, 0x29 , 0x24 , 0x1E , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index8 -2.4dB */ {0x29, 0x27 , 0x23 , 0x1D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index9 -2.7dB */ {0x27, 0x26 , 0x22 , 0x1C , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index10 -3 dB */ {0x26, 0x25 , 0x20 , 0x1B , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index11 -3.3dB */ {0x25, 0x23 , 0x1F , 0x1A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index12 -3.6dB */ {0x24, 0x22 , 0x1E , 0x19 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index13 -3.9dB */ {0x22, 0x21 , 0x1D , 0x18 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index14 -4.2dB */ {0x21, 0x20 , 0x1C , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index15 -4.5dB */ {0x20, 0x1F , 0x1B , 0x17 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index16 -4.8dB */ {0x1F, 0x1E , 0x1A , 0x16 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index17 -5.1dB */ {0x1E, 0x1D , 0x1A , 0x15 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index18 -5.4dB */ {0x1D, 0x1C , 0x19 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index19 -5.7dB */ {0x1C, 0x1B , 0x18 , 0x14 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index20 -6 dB */ {0x1B, 0x1A , 0x17 , 0x13 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index21 -6.3dB */ {0x1A, 0x19 , 0x16 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index22 -6.6dB */ {0x19, 0x18 , 0x15 , 0x12 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index23 -6.9dB */ {0x18, 0x17 , 0x15 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index24 -7.2dB */ {0x18, 0x17 , 0x14 , 0x11 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index25 -7.5dB */ {0x17, 0x16 , 0x13 , 0x10 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index26 -7.8dB */ {0x16, 0x15 , 0x13 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index27 -8.1dB */ {0x15, 0x14 , 0x12 , 0x0F , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index28 -8.4dB */ {0x14, 0x14 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index29 -8.7dB */ {0x14, 0x13 , 0x11 , 0x0E , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index30 -9 dB */ {0x13, 0x12 , 0x10 , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index31 -9.3dB */ {0x12, 0x12 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index32 -9.6dB */ {0x12, 0x11 , 0x0F , 0x0D , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index33 -9.9dB */ {0x11, 0x11 , 0x0F , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index34 -10.2dB */ {0x11, 0x11 , 0x0E , 0x0C , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index35 -10.5dB */ {0x10, 0x0F , 0x0E , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index36 -10.8dB */ {0x10, 0x0F , 0x0D , 0x0B , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index37 -11.1dB */ {0x0F, 0x0E , 0x0D , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index38 -11.4dB */ {0x0E, 0x0E , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index39 -11.7dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index40 -12 dB */ {0x0E, 0x0D , 0x0C , 0x0A , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index41 -12.3dB */ {0x0D, 0x0D , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index42 -12.6dB */ {0x0D, 0x0C , 0x0B , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index43 -12.9dB */ {0x0C, 0x0C , 0x0A , 0x09 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index44 -13.2dB */ {0x0C, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index45 -13.5dB */ {0x0B, 0x0B , 0x0A , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index46 -13.8dB */ {0x0B, 0x0B , 0x09 , 0x08 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index47 -14.1dB */ {0x0B, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index48 -14.4dB */ {0x0A, 0x0A , 0x09 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index49 -14.7dB */ {0x0A, 0x0A , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index50 -15 dB */ {0x0A, 0x09 , 0x08 , 0x07 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index51 -15.3dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index52 -15.6dB */ {0x09, 0x09 , 0x08 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00}, - /* Index53 -15.9dB */ {0x09, 0x08 , 0x07 , 0x06 , 0x00 , 0x00 , 0x00 , 0x00} -}; -#endif - -#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -{ - 0x081, // 0, -12.0dB - 0x088, // 1, -11.5dB - 0x090, // 2, -11.0dB - 0x099, // 3, -10.5dB - 0x0A2, // 4, -10.0dB - 0x0AC, // 5, -9.5dB - 0x0B6, // 6, -9.0dB - 0x0C0, // 7, -8.5dB - 0x0CC, // 8, -8.0dB - 0x0D8, // 9, -7.5dB - 0x0E5, // 10, -7.0dB - 0x0F2, // 11, -6.5dB - 0x101, // 12, -6.0dB - 0x110, // 13, -5.5dB - 0x120, // 14, -5.0dB - 0x131, // 15, -4.5dB - 0x143, // 16, -4.0dB - 0x156, // 17, -3.5dB - 0x16A, // 18, -3.0dB - 0x180, // 19, -2.5dB - 0x197, // 20, -2.0dB - 0x1AF, // 21, -1.5dB - 0x1C8, // 22, -1.0dB - 0x1E3, // 23, -0.5dB - 0x200, // 24, +0 dB - 0x21E, // 25, +0.5dB - 0x23E, // 26, +1.0dB - 0x261, // 27, +1.5dB - 0x285, // 28, +2.0dB - 0x2AB, // 29, +2.5dB - 0x2D3, // 30, +3.0dB - 0x2FE, // 31, +3.5dB - 0x32B, // 32, +4.0dB - 0x35C, // 33, +4.5dB - 0x38E, // 34, +5.0dB - 0x3C4, // 35, +5.5dB - 0x3FE // 36, +6.0dB -}; -#elif(ODM_IC_11AC_SERIES_SUPPORT) -u4Byte OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812] = { - 0x3FE, // 0, (6dB) - 0x3C4, // 1, (5.5dB) - 0x38E, // 2, (5dB) - 0x35C, // 3, (4.5dB) - 0x32B, // 4, (4dB) - 0x2FE, // 5, (3.5dB) - 0x2D3, // 6, (3dB) - 0x2AB, // 7, (2.5dB) - 0x285, // 8, (2dB) - 0x261, // 9, (1.5dB - 0x23E, // 10, (1dB) - 0x21E, // 11, (0.5dB) - 0x200, // 12, (0dB) 8814 int PA 2G default - 0x1E3, // 13, (-0.5dB) - 0x1C8, // 14, (-1dB) - 0x1AF, // 15, (-1.5dB) - 0x197, // 16, (-2dB) - 0x180, // 17, (-2.5dB) - 0x16A, // 18, (-3dB) 8812 / 8814 int PA 5G / 8814 ext PA 2G5G default - 0x156, // 19, (-3.5dB) - 0x143, // 20, (-4dB) 8812 HP default - 0x131, // 21, (-4.5dB) - 0x120, // 22, (-5dB) - 0x110, // 23, (-5.5dB) - 0x101, // 24, (-6dB) - 0x0F2, // 25, (-6.5dB) - 0x0E5, // 26, (-7dB) - 0x0D8, // 27, (-7.5dB) - 0x0CC, // 28, (-8dB) - 0x0C0, // 29, (-8.5dB) - 0x0B6, // 30, (-9dB) - 0x0AC, // 31, (-9.5dB) - 0x0A2, // 32, (-10dB) - 0x099, // 33, (-10.5dB) - 0x090, // 34, (-11dB) - 0x088, // 35, (-11.5dB) - 0x081, // 36, (-12dB) - 0x079, // 37, (-12.5dB) - 0x072, // 38, (-13dB) - 0x06c, // 39, (-13.5dB) - 0x066, // 40, (-14dB) - 0x060, // 41, (-14.5dB) - 0x05B // 42, (-15dB) -}; -#endif - -u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { - 0x0CD, - 0x0D9, - 0x0E6, - 0x0F3, - 0x102, - 0x111, - 0x121, - 0x132, - 0x144, - 0x158, - 0x16C, - 0x182, - 0x198, - 0x1B1, - 0x1CA, - 0x1E5, - 0x202, - 0x221, - 0x241, - 0x263, - 0x287, - 0x2AE, - 0x2D6, - 0x301, - 0x32F, - 0x35F, - 0x392, - 0x3C9, - 0x402, - 0x43F, - 0x47F, - 0x4C3, - 0x50C, - 0x558, - 0x5A9, - 0x5FF, - 0x65A, - 0x6BA, - 0x720, - 0x78C, - 0x7FF, -}; - - -//#endif -//3============================================================ -//3 Tx Power Tracking -//3============================================================ - -VOID -odm_TXPowerTrackingInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_RTL8822B | ODM_IC_11N_SERIES))) - return; -#endif - - odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -} - - -u1Byte -getSwingIndex( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0, BBswingMask = 0; - u4Byte bbSwing = 0; - u4Byte swingTableSize = 0; - pu4Byte pSwingTable = 0; - prtl8192cd_priv priv = pDM_Odm->priv; - -#if (RTL8197F_SUPPORT == 1) - if (GET_CHIP_VER(priv) == VERSION_8197F) { - bbSwing = PHY_QueryBBReg(priv, rOFDM0_XATxIQImbalance, bMaskOFDM_D); - pSwingTable = OFDMSwingTable_New; - swingTableSize = OFDM_TABLE_SIZE_92D; - BBswingMask = 22; - } -#endif - -#if (RTL8822B_SUPPORT == 1) - if (GET_CHIP_VER(priv) == VERSION_8822B) { - bbSwing = PHY_QueryBBReg(priv, rA_TxScale_Jaguar, 0xFFE00000); - pSwingTable = TxScalingTable_Jaguar; - swingTableSize = TXSCALE_TABLE_SIZE; - BBswingMask = 0; - } -#endif - - for (i = 0; i < swingTableSize-1; i++) { - u4Byte tableValue = pSwingTable[i] >> BBswingMask; - - if (bbSwing == tableValue) - break; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("bbSwing=0x%x bbswing_index=%d\n", bbSwing, i)); - - - return i; -} - - -VOID -odm_TXPowerTrackingThermalMeterInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - prtl8192cd_priv priv = pDM_Odm->priv; - u1Byte p; - u1Byte defaultSwingIndex; -#if (RTL8197F_SUPPORT == 1 || RTL8822B_SUPPORT == 1) - if ((GET_CHIP_VER(priv) == VERSION_8197F) || (GET_CHIP_VER(priv) == VERSION_8822B)) - defaultSwingIndex = getSwingIndex(pDM_Odm); -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - pMgntInfo->bTXPowerTracking = TRUE; - pHalData->TXPowercount = 0; - pHalData->bTXPowerTrackingInit = FALSE; - - if(pDM_Odm->mp_mode == FALSE) - pHalData->TxPowerTrackControl = TRUE; - ODM_RT_TRACE(pDM_Odm,COMP_POWER_TRACKING, DBG_LOUD, ("pMgntInfo->bTXPowerTracking = %d\n", pMgntInfo->bTXPowerTracking)); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #ifdef CONFIG_RTL8188E - { - pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; - pDM_Odm->RFCalibrateInfo.TXPowercount = 0; - pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; - - if(pDM_Odm->mp_mode == FALSE) - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; - - MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pDM_Odm->RFCalibrateInfo.TxPowerTrackControl); - } - #else - { - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct dm_priv *pdmpriv = &pHalData->dmpriv; - - //if(IS_HARDWARE_TYPE_8192C(pHalData)) - { - pdmpriv->bTXPowerTracking = _TRUE; - pdmpriv->TXPowercount = 0; - pdmpriv->bTXPowerTrackingInit = _FALSE; - - if(pDM_Odm->mp_mode == FALSE) //for mp driver, turn off txpwrtracking as default - pdmpriv->TxPowerTrackControl = _TRUE; - - } - MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); - - } - #endif//endif (CONFIG_RTL8188E==1) -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - - #ifdef RTL8188E_SUPPORT - { - pDM_Odm->RFCalibrateInfo.bTXPowerTracking = _TRUE; - pDM_Odm->RFCalibrateInfo.TXPowercount = 0; - pDM_Odm->RFCalibrateInfo.bTXPowerTrackingInit = _FALSE; - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = _TRUE; - pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; - } - #endif -#endif - - pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; - pDM_Odm->RFCalibrateInfo.DeltaPowerIndex = 0; - pDM_Odm->RFCalibrateInfo.DeltaPowerIndexLast = 0; - pDM_Odm->RFCalibrateInfo.PowerIndexOffset = 0; - pDM_Odm->RFCalibrateInfo.ThermalValue = 0; - pRFCalibrateInfo->DefaultOfdmIndex = 28; - -#if (RTL8197F_SUPPORT == 1) - if (GET_CHIP_VER(priv) == VERSION_8197F) { - pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= (OFDM_TABLE_SIZE_92D - 1)) ? 30 : defaultSwingIndex; - pRFCalibrateInfo->DefaultCckIndex = 28; - } -#endif - -#if (RTL8822B_SUPPORT == 1) - if (GET_CHIP_VER(priv) == VERSION_8822B) { - pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= (TXSCALE_TABLE_SIZE - 1)) ? 24 : defaultSwingIndex; - pRFCalibrateInfo->DefaultCckIndex = 20; - } -#endif - - -#if RTL8188E_SUPPORT - pRFCalibrateInfo->DefaultCckIndex = 20; // -6 dB -#elif RTL8192E_SUPPORT - pRFCalibrateInfo->DefaultCckIndex = 8; // -12 dB -#endif - pRFCalibrateInfo->BbSwingIdxOfdmBase = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; - pDM_Odm->RFCalibrateInfo.CCK_index = pRFCalibrateInfo->DefaultCckIndex; - - for (p = 0; p < MAX_RF_PATH; p++) { - pDM_Odm->RFCalibrateInfo.OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->BbSwingIdxOfdm[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->KfreeOffset[p] = 0; /* for 8814 kfree*/ - } - pRFCalibrateInfo->BbSwingIdxCck = pRFCalibrateInfo->DefaultCckIndex; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pRFCalibrateInfo->DefaultOfdmIndex=%d pRFCalibrateInfo->DefaultCckIndex=%d\n", pRFCalibrateInfo->DefaultOfdmIndex , pRFCalibrateInfo->DefaultCckIndex)); - - -} - - -VOID -ODM_TXPowerTrackingCheck( - IN PVOID pDM_VOID - ) -{ - // - // For AP/ADSL use prtl8192cd_priv - // For CE/NIC use PADAPTER - // - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - - - if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) - return; - - // - // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate - // at the same time. In the stage2/3, we need to prive universal interface and merge all - // HW dynamic mechanism. - // - switch (pDM_Odm->SupportPlatform) - { - case ODM_WIN: - odm_TXPowerTrackingCheckMP(pDM_Odm); - break; - - case ODM_CE: - odm_TXPowerTrackingCheckCE(pDM_Odm); - break; - - case ODM_AP: - odm_TXPowerTrackingCheckAP(pDM_Odm); - break; - - case ODM_ADSL: - /*odm_DIGAP(pDM_Odm);*/ - break; - } - -} - -VOID -odm_TXPowerTrackingCheckCE( - IN PVOID pDM_VOID - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - - #if(RTL8188E_SUPPORT==1) - - //if(!pMgntInfo->bTXPowerTracking /*|| (!pdmpriv->TxPowerTrackControl && pdmpriv->bAPKdone)*/) - if(!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) - { - return; - } - - if(!pDM_Odm->RFCalibrateInfo.TM_Trigger) //at least delay 1 sec - { - //pHalData->TxPowerCheckCnt++; //cosa add for debug - ODM_SetRFReg(pDM_Odm, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); - //DBG_8192C("Trigger 92C Thermal Meter!!\n"); - - pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; - return; - - } - else - { - //DBG_8192C("Schedule TxPowerTracking direct call!!\n"); - odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); - pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; - } - #endif - -#endif -} - -VOID -odm_TXPowerTrackingCheckMP( - IN PVOID pDM_VOID - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - - if (ODM_CheckPowerStatus(Adapter) == FALSE) - return; - - if(!Adapter->bSlaveOfDMSP || Adapter->DualMacSmartConcurrent == FALSE) - odm_TXPowerTrackingThermalMeterCheck(Adapter); -#endif - -} - - -VOID -odm_TXPowerTrackingCheckAP( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - prtl8192cd_priv priv = pDM_Odm->priv; - -#if ((RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8814A_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) - if (pDM_Odm->SupportICType & (ODM_RTL8188E | ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8881A | ODM_RTL8814A | ODM_RTL8197F | ODM_RTL8822B)) - ODM_TXPowerTrackingCallback_ThermalMeter(pDM_Odm); - else -#endif - { - } -#endif - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -VOID -odm_TXPowerTrackingThermalMeterCheck( - IN PADAPTER Adapter - ) -{ -#ifndef AP_BUILD_WORKAROUND -#if (HAL_CODE_BASE==RTL8192_C) - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - //HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - static u1Byte TM_Trigger = 0; - //u1Byte TxPowerCheckCnt = 5; //10 sec - - if(!pMgntInfo->bTXPowerTracking /*|| (!pHalData->TxPowerTrackControl && pHalData->bAPKdone)*/) - { - return; - } - - if(!TM_Trigger) //at least delay 1 sec - { - if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8812(Adapter)) - PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); - else - PHY_SetRFReg(Adapter, RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger 92C Thermal Meter!!\n")); - - TM_Trigger = 1; - return; - } - else - { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); - odm_TXPowerTrackingDirectCall(Adapter); //Using direct call is instead, added by Roger, 2009.06.18. - TM_Trigger = 0; - } -#endif -#endif -} - -#endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.h deleted file mode 100644 index 57bcad18f47e..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ap.h +++ /dev/null @@ -1,351 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMPOWERTRACKING_H__ -#define __PHYDMPOWERTRACKING_H__ - -#define POWRTRACKING_VERSION "1.1" - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#ifdef RTK_AC_SUPPORT -#define ODM_IC_11AC_SERIES_SUPPORT 1 -#else -#define ODM_IC_11AC_SERIES_SUPPORT 0 -#endif -#else -#define ODM_IC_11AC_SERIES_SUPPORT 1 -#endif - -#define DPK_DELTA_MAPPING_NUM 13 -#define index_mapping_HP_NUM 15 -#define DELTA_SWINGIDX_SIZE 30 -#define DELTA_SWINTSSI_SIZE 61 -#define BAND_NUM 3 -#define MAX_RF_PATH 4 -#define TXSCALE_TABLE_SIZE 37 -#define CCK_TABLE_SIZE_8723D 41 - -#define IQK_MAC_REG_NUM 4 -#define IQK_ADDA_REG_NUM 16 -#define IQK_BB_REG_NUM_MAX 10 - -#define IQK_BB_REG_NUM 9 - -#define HP_THERMAL_NUM 8 - -#define AVG_THERMAL_NUM 8 -#define IQK_Matrix_REG_NUM 8 -//#define IQK_Matrix_Settings_NUM 1+24+21 -#define IQK_Matrix_Settings_NUM (14+24+21) // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G - -#if !defined(_OUTSRC_COEXIST) -#define OFDM_TABLE_SIZE_92D 43 -#define OFDM_TABLE_SIZE 37 -#define CCK_TABLE_SIZE 33 -#define CCK_TABLE_SIZE_88F 21 - - - -//#define OFDM_TABLE_SIZE_92E 54 -//#define CCK_TABLE_SIZE_92E 54 -extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE_92D]; -extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; - - -extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE_92D]; -extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; -extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; - -#endif - -#define ODM_OFDM_TABLE_SIZE 37 -#define ODM_CCK_TABLE_SIZE 33 -// <20140613, YuChen> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -extern u1Byte DeltaSwingTableIdx_2GA_P_DEFAULT[DELTA_SWINGIDX_SIZE]; -extern u1Byte DeltaSwingTableIdx_2GA_N_DEFAULT[DELTA_SWINGIDX_SIZE]; - -static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; - -//extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; -//extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; -//extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; - -#ifdef CONFIG_WLAN_HAL_8192EE -#define OFDM_TABLE_SIZE_92E 54 -#define CCK_TABLE_SIZE_92E 54 -extern u4Byte OFDMSwingTable_92E[OFDM_TABLE_SIZE_92E]; -extern u1Byte CCKSwingTable_Ch1_Ch13_92E[CCK_TABLE_SIZE_92E][8]; -extern u1Byte CCKSwingTable_Ch14_92E[CCK_TABLE_SIZE_92E][8]; -#endif - -#define OFDM_TABLE_SIZE_8812 43 -#define AVG_THERMAL_NUM_8812 4 - -#if (RTL8814A_SUPPORT == 1 || RTL8822B_SUPPORT == 1) -extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; -#elif(ODM_IC_11AC_SERIES_SUPPORT) -extern unsigned int OFDMSwingTable_8812[OFDM_TABLE_SIZE_8812]; -#endif - -extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; - -#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck - -typedef struct _IQK_MATRIX_REGS_SETTING{ - BOOLEAN bIQKDone; - s4Byte Value[1][IQK_Matrix_REG_NUM]; -}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; - -typedef struct ODM_RF_Calibration_Structure -{ - //for tx power tracking - - u4Byte RegA24; // for TempCCK - s4Byte RegE94; - s4Byte RegE9C; - s4Byte RegEB4; - s4Byte RegEBC; - - //u1Byte bTXPowerTracking; - u1Byte TXPowercount; - BOOLEAN bTXPowerTrackingInit; - BOOLEAN bTXPowerTracking; - u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default - u1Byte TM_Trigger; - u1Byte InternalPA5G[2]; //pathA / pathB - - u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 - u1Byte ThermalValue; - u1Byte ThermalValue_LCK; - u1Byte ThermalValue_IQK; - u1Byte ThermalValue_DPK; - u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; - u1Byte ThermalValue_AVG_index; - u1Byte ThermalValue_RxGain; - u1Byte ThermalValue_Crystal; - u1Byte ThermalValue_DPKstore; - u1Byte ThermalValue_DPKtrack; - BOOLEAN TxPowerTrackingInProgress; - BOOLEAN bDPKenable; - - BOOLEAN bReloadtxpowerindex; - u1Byte bRfPiEnable; - u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug - - u1Byte bCCKinCH14; - u1Byte CCK_index; - u1Byte OFDM_index[MAX_RF_PATH]; - s1Byte PowerIndexOffset; - s1Byte DeltaPowerIndex; - s1Byte DeltaPowerIndexLast; - BOOLEAN bTxPowerChanged; - - u1Byte ThermalValue_HP[HP_THERMAL_NUM]; - u1Byte ThermalValue_HP_index; - IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; - u1Byte Delta_LCK; - u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; - - u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; - u1Byte BbSwingIdxOfdmCurrent; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -#else - u1Byte BbSwingIdxOfdmBase; -#endif - BOOLEAN BbSwingFlagOfdm; - u1Byte BbSwingIdxCck; - u1Byte BbSwingIdxCckCurrent; - u1Byte BbSwingIdxCckBase; - u1Byte DefaultOfdmIndex; - u1Byte DefaultCckIndex; - BOOLEAN BbSwingFlagCck; - - s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; - s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; - s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; - s1Byte Remnant_CCKSwingIdx; - s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ - BOOLEAN Modify_TxAGC_Flag_PathA; - BOOLEAN Modify_TxAGC_Flag_PathB; - BOOLEAN Modify_TxAGC_Flag_PathC; - BOOLEAN Modify_TxAGC_Flag_PathD; - BOOLEAN Modify_TxAGC_Flag_PathA_CCK; - - s1Byte KfreeOffset[MAX_RF_PATH]; - - //--------------------------------------------------------------------// - - //for IQK - u4Byte RegC04; - u4Byte Reg874; - u4Byte RegC08; - u4Byte RegB68; - u4Byte RegB6C; - u4Byte Reg870; - u4Byte Reg860; - u4Byte Reg864; - - BOOLEAN bIQKInitialized; - BOOLEAN bLCKInProgress; - BOOLEAN bAntennaDetected; - BOOLEAN bNeedIQK; - BOOLEAN bIQKInProgress; - BOOLEAN bIQKPAoff; - u1Byte Delta_IQK; - u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; - u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; - u4Byte IQK_BB_backup_recover[9]; - u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; - u4Byte TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ - u4Byte RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ - u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ - u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ - - u8Byte IQK_StartTime; - u8Byte IQK_TotalProgressingTime; - u8Byte IQK_ProgressingTime; - u4Byte LOK_Result; - u1Byte IQKstep; - u1Byte Kcount; - u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ - BOOLEAN isMPmode; - - //for APK - u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a - u1Byte bAPKdone; - u1Byte bAPKThermalMeterIgnore; - u1Byte bDPdone; - u1Byte bDPPathAOK; - u1Byte bDPPathBOK; - - /*Add by Yuchen for Kfree Phydm*/ - u1Byte RegRfKFreeEnable; /*for registry*/ - u1Byte RfKFreeEnable; /*for efuse enable check*/ - u4Byte TxLOK[2]; -}ODM_RF_CAL_T,*PODM_RF_CAL_T; - -VOID -odm_TXPowerTrackingCheckAP( - IN PVOID pDM_VOID - ); - -VOID -ODM_TXPowerTrackingCheck( - IN PVOID pDM_VOID - ); - - -VOID -odm_TXPowerTrackingThermalMeterInit( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingInit( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingCheckMP( - IN PVOID pDM_VOID - ); - - -VOID -odm_TXPowerTrackingCheckCE( - IN PVOID pDM_VOID - ); - - -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - -VOID -odm_TXPowerTrackingCallbackThermalMeter92C( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingCallbackRXGainThermalMeter92D( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingCallbackThermalMeter92D( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingDirectCall92C( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingThermalMeterCheck( - IN PADAPTER Adapter - ); - -#endif - - - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.c deleted file mode 100644 index 0c5c2470fd81..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.c +++ /dev/null @@ -1,756 +0,0 @@ -/****************************************************************************** - * - * 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 files */ -/*============================================================ */ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -//============================================================ -// Global var -//============================================================ - -u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { - 0x7f8001fe, /* 0, +6.0dB */ - 0x788001e2, /* 1, +5.5dB */ - 0x71c001c7, /* 2, +5.0dB*/ - 0x6b8001ae, /* 3, +4.5dB*/ - 0x65400195, /* 4, +4.0dB*/ - 0x5fc0017f, /* 5, +3.5dB*/ - 0x5a400169, /* 6, +3.0dB*/ - 0x55400155, /* 7, +2.5dB*/ - 0x50800142, /* 8, +2.0dB*/ - 0x4c000130, /* 9, +1.5dB*/ - 0x47c0011f, /* 10, +1.0dB*/ - 0x43c0010f, /* 11, +0.5dB*/ - 0x40000100, /* 12, +0dB*/ - 0x3c8000f2, /* 13, -0.5dB*/ - 0x390000e4, /* 14, -1.0dB*/ - 0x35c000d7, /* 15, -1.5dB*/ - 0x32c000cb, /* 16, -2.0dB*/ - 0x300000c0, /* 17, -2.5dB*/ - 0x2d4000b5, /* 18, -3.0dB*/ - 0x2ac000ab, /* 19, -3.5dB*/ - 0x288000a2, /* 20, -4.0dB*/ - 0x26000098, /* 21, -4.5dB*/ - 0x24000090, /* 22, -5.0dB*/ - 0x22000088, /* 23, -5.5dB*/ - 0x20000080, /* 24, -6.0dB*/ - 0x1e400079, /* 25, -6.5dB*/ - 0x1c800072, /* 26, -7.0dB*/ - 0x1b00006c, /* 27. -7.5dB*/ - 0x19800066, /* 28, -8.0dB*/ - 0x18000060, /* 29, -8.5dB*/ - 0x16c0005b, /* 30, -9.0dB*/ - 0x15800056, /* 31, -9.5dB*/ - 0x14400051, /* 32, -10.0dB*/ - 0x1300004c, /* 33, -10.5dB*/ - 0x12000048, /* 34, -11.0dB*/ - 0x11000044, /* 35, -11.5dB*/ - 0x10000040, /* 36, -12.0dB*/ -}; - -u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { - {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, /* 0, +0dB */ - {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 1, -0.5dB */ - {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 2, -1.0dB*/ - {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 3, -1.5dB*/ - {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 4, -2.0dB */ - {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 5, -2.5dB*/ - {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 6, -3.0dB*/ - {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 7, -3.5dB*/ - {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 8, -4.0dB */ - {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 9, -4.5dB*/ - {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 10, -5.0dB */ - {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 11, -5.5dB*/ - {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /* 12, -6.0dB <== default */ - {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 13, -6.5dB*/ - {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 14, -7.0dB */ - {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 15, -7.5dB*/ - {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ - {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 17, -8.5dB*/ - {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 18, -9.0dB */ - {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 19, -9.5dB*/ - {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 20, -10.0dB*/ - {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 21, -10.5dB*/ - {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 22, -11.0dB*/ - {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 23, -11.5dB*/ - {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 24, -12.0dB*/ - {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 25, -12.5dB*/ - {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 26, -13.0dB*/ - {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 27, -13.5dB*/ - {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 28, -14.0dB*/ - {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 29, -14.5dB*/ - {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 30, -15.0dB*/ - {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 31, -15.5dB*/ - {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} /* 32, -16.0dB*/ -}; - - -u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { - {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, /* 0, +0dB */ - {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 1, -0.5dB */ - {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 2, -1.0dB */ - {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /* 3, -1.5dB*/ - {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 4, -2.0dB */ - {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /* 5, -2.5dB*/ - {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 6, -3.0dB */ - {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 7, -3.5dB */ - {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 8, -4.0dB */ - {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /* 9, -4.5dB*/ - {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 10, -5.0dB */ - {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 11, -5.5dB*/ - {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 12, -6.0dB <== default*/ - {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 13, -6.5dB */ - {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 14, -7.0dB */ - {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 15, -7.5dB*/ - {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ - {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 17, -8.5dB*/ - {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 18, -9.0dB */ - {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 19, -9.5dB*/ - {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 20, -10.0dB*/ - {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 21, -10.5dB*/ - {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 22, -11.0dB*/ - {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 23, -11.5dB*/ - {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 24, -12.0dB*/ - {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 25, -12.5dB*/ - {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 26, -13.0dB*/ - {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 27, -13.5dB*/ - {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 28, -14.0dB*/ - {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 29, -14.5dB*/ - {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 30, -15.0dB*/ - {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 31, -15.5dB*/ - {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} /* 32, -16.0dB*/ -}; - - -u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { - 0x0b40002d, /* 0, -15.0dB */ - 0x0c000030, /* 1, -14.5dB*/ - 0x0cc00033, /* 2, -14.0dB*/ - 0x0d800036, /* 3, -13.5dB*/ - 0x0e400039, /* 4, -13.0dB */ - 0x0f00003c, /* 5, -12.5dB*/ - 0x10000040, /* 6, -12.0dB*/ - 0x11000044, /* 7, -11.5dB*/ - 0x12000048, /* 8, -11.0dB*/ - 0x1300004c, /* 9, -10.5dB*/ - 0x14400051, /* 10, -10.0dB*/ - 0x15800056, /* 11, -9.5dB*/ - 0x16c0005b, /* 12, -9.0dB*/ - 0x18000060, /* 13, -8.5dB*/ - 0x19800066, /* 14, -8.0dB*/ - 0x1b00006c, /* 15, -7.5dB*/ - 0x1c800072, /* 16, -7.0dB*/ - 0x1e400079, /* 17, -6.5dB*/ - 0x20000080, /* 18, -6.0dB*/ - 0x22000088, /* 19, -5.5dB*/ - 0x24000090, /* 20, -5.0dB*/ - 0x26000098, /* 21, -4.5dB*/ - 0x288000a2, /* 22, -4.0dB*/ - 0x2ac000ab, /* 23, -3.5dB*/ - 0x2d4000b5, /* 24, -3.0dB*/ - 0x300000c0, /* 25, -2.5dB*/ - 0x32c000cb, /* 26, -2.0dB*/ - 0x35c000d7, /* 27, -1.5dB*/ - 0x390000e4, /* 28, -1.0dB*/ - 0x3c8000f2, /* 29, -0.5dB*/ - 0x40000100, /* 30, +0dB*/ - 0x43c0010f, /* 31, +0.5dB*/ - 0x47c0011f, /* 32, +1.0dB*/ - 0x4c000130, /* 33, +1.5dB*/ - 0x50800142, /* 34, +2.0dB*/ - 0x55400155, /* 35, +2.5dB*/ - 0x5a400169, /* 36, +3.0dB*/ - 0x5fc0017f, /* 37, +3.5dB*/ - 0x65400195, /* 38, +4.0dB*/ - 0x6b8001ae, /* 39, +4.5dB*/ - 0x71c001c7, /* 40, +5.0dB*/ - 0x788001e2, /* 41, +5.5dB*/ - 0x7f8001fe /* 42, +6.0dB*/ -}; - - -u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -}; - - -u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { -{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -}; - - -u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -}; - - -u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { - {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, /* 0, -16.0dB*/ - {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, /* 1, -15.5dB*/ - {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 2, -15.0dB*/ - {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, /* 3, -14.5dB*/ - {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 4, -14.0dB*/ - {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, /* 5, -13.5dB*/ - {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, /* 6, -13.0dB*/ - {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, /* 7, -12.5dB*/ - {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, /* 8, -12.0dB*/ - {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, /* 9, -11.5dB*/ - {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 10, -11.0dB*/ - {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, /* 11, -10.5dB*/ - {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 12, -10.0dB*/ - {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, /* 13, -9.5dB*/ - {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, /* 14, -9.0dB */ - {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, /* 15, -8.5dB*/ - {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, /* 16, -8.0dB */ - {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, /* 17, -7.5dB*/ - {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, /* 18, -7.0dB */ - {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, /* 19, -6.5dB*/ - {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, /*20, -6.0dB */ - {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, /* 21, -5.5dB*/ - {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, /* 22, -5.0dB */ - {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, /* 23, -4.5dB*/ - {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, /* 24, -4.0dB */ - {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, /* 25, -3.5dB*/ - {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, /* 26, -3.0dB*/ - {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, /* 27, -2.5dB*/ - {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, /* 28, -2.0dB */ - {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, /* 29, -1.5dB*/ - {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, /* 30, -1.0dB*/ - {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, /* 31, -0.5dB*/ - {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} /* 32, +0dB*/ -}; - - -u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { - {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, /* 0, -16.0dB*/ - {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 1, -15.5dB*/ - {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 2, -15.0dB*/ - {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 3, -14.5dB*/ - {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, /* 4, -14.0dB*/ - {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /*5, -13.5dB*/ - {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 6, -13.0dB*/ - {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, /* 7, -12.5dB*/ - {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 8, -12.0dB*/ - {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, /* 9, -11.5dB*/ - {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, /* 10, -11.0dB*/ - {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, /*11, -10.5dB*/ - {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 12, -10.0dB*/ - {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, /* 13, -9.5dB*/ - {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, /*14, -9.0dB */ - {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, /* 15, -8.5dB*/ - {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 16, -8.0dB */ - {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, /* 17, -7.5dB*/ - {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, /* 18, -7.0dB */ - {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, /* 19, -6.5dB */ - {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 20, -6.0dB */ - {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, /* 21, -5.5dB*/ - {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, /* 22, -5.0dB */ - {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, /*23, -4.5dB*/ - {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, /* 24, -4.0dB */ - {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, /* 25, -3.5dB */ - {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, /* 26, -3.0dB */ - {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, /*27, -2.5dB*/ - {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, /* 28, -2.0dB */ - {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, /*29, -1.5dB*/ - {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, /* 30, -1.0dB */ - {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, /* 31, -0.5dB */ - {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} /* 32, +0dB */ -}; -u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { - 0x0CD, /*0 , -20dB*/ - 0x0D9, - 0x0E6, - 0x0F3, - 0x102, - 0x111, - 0x121, - 0x132, - 0x144, - 0x158, - 0x16C, - 0x182, - 0x198, - 0x1B1, - 0x1CA, - 0x1E5, - 0x202, - 0x221, - 0x241, - 0x263, - 0x287, - 0x2AE, - 0x2D6, - 0x301, - 0x32F, - 0x35F, - 0x392, - 0x3C9, - 0x402, - 0x43F, - 0x47F, - 0x4C3, - 0x50C, - 0x558, - 0x5A9, - 0x5FF, - 0x65A, - 0x6BA, - 0x720, - 0x78C, - 0x7FF, -}; - - -u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -{ - 0x081, /* 0, -12.0dB*/ - 0x088, /* 1, -11.5dB*/ - 0x090, /* 2, -11.0dB*/ - 0x099, /* 3, -10.5dB*/ - 0x0A2, /* 4, -10.0dB*/ - 0x0AC, /* 5, -9.5dB*/ - 0x0B6, /* 6, -9.0dB*/ - 0x0C0, /*7, -8.5dB*/ - 0x0CC, /* 8, -8.0dB*/ - 0x0D8, /* 9, -7.5dB*/ - 0x0E5, /* 10, -7.0dB*/ - 0x0F2, /* 11, -6.5dB*/ - 0x101, /* 12, -6.0dB*/ - 0x110, /* 13, -5.5dB*/ - 0x120, /* 14, -5.0dB*/ - 0x131, /* 15, -4.5dB*/ - 0x143, /* 16, -4.0dB*/ - 0x156, /* 17, -3.5dB*/ - 0x16A, /* 18, -3.0dB*/ - 0x180, /* 19, -2.5dB*/ - 0x197, /* 20, -2.0dB*/ - 0x1AF, /* 21, -1.5dB*/ - 0x1C8, /* 22, -1.0dB*/ - 0x1E3, /* 23, -0.5dB*/ - 0x200, /* 24, +0 dB*/ - 0x21E, /* 25, +0.5dB*/ - 0x23E, /* 26, +1.0dB*/ - 0x261, /* 27, +1.5dB*/ - 0x285,/* 28, +2.0dB*/ - 0x2AB, /* 29, +2.5dB*/ - 0x2D3, /*30, +3.0dB*/ - 0x2FE, /* 31, +3.5dB*/ - 0x32B, /* 32, +4.0dB*/ - 0x35C, /* 33, +4.5dB*/ - 0x38E, /* 34, +5.0dB*/ - 0x3C4, /* 35, +5.5dB*/ - 0x3FE /* 36, +6.0dB */ -}; - -#ifdef AP_BUILD_WORKAROUND - -unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { - /* +6.0dB */ 0x7f8001fe, - /* +5.5dB */ 0x788001e2, - /* +5.0dB */ 0x71c001c7, - /* +4.5dB */ 0x6b8001ae, - /* +4.0dB */ 0x65400195, - /* +3.5dB */ 0x5fc0017f, - /* +3.0dB */ 0x5a400169, - /* +2.5dB */ 0x55400155, - /* +2.0dB */ 0x50800142, - /* +1.5dB */ 0x4c000130, - /* +1.0dB */ 0x47c0011f, - /* +0.5dB */ 0x43c0010f, - /* 0.0dB */ 0x40000100, - /* -0.5dB */ 0x3c8000f2, - /* -1.0dB */ 0x390000e4, - /* -1.5dB */ 0x35c000d7, - /* -2.0dB */ 0x32c000cb, - /* -2.5dB */ 0x300000c0, - /* -3.0dB */ 0x2d4000b5, - /* -3.5dB */ 0x2ac000ab, - /* -4.0dB */ 0x288000a2, - /* -4.5dB */ 0x26000098, - /* -5.0dB */ 0x24000090, - /* -5.5dB */ 0x22000088, - /* -6.0dB */ 0x20000080, - /* -6.5dB */ 0x1a00006c, - /* -7.0dB */ 0x1c800072, - /* -7.5dB */ 0x18000060, - /* -8.0dB */ 0x19800066, - /* -8.5dB */ 0x15800056, - /* -9.0dB */ 0x26c0005b, - /* -9.5dB */ 0x14400051, - /* -10.0dB */ 0x24400051, - /* -10.5dB */ 0x1300004c, - /* -11.0dB */ 0x12000048, - /* -11.5dB */ 0x11000044, - /* -12.0dB */ 0x10000040 -}; -#endif - - - -VOID -odm_TXPowerTrackingInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) - return; -#endif - - odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -} - -u1Byte -getSwingIndex( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u1Byte i = 0; - u4Byte bbSwing; - u4Byte swingTableSize; - pu4Byte pSwingTable; - - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B - || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B - ) { - bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); - - pSwingTable = OFDMSwingTable_New; - swingTableSize = OFDM_TABLE_SIZE; - } else { -#if ((RTL8812A_SUPPORT==1)||(RTL8821A_SUPPORT==1)) - if (pDM_Odm->SupportICType == ODM_RTL8812 || pDM_Odm->SupportICType == ODM_RTL8821) - { - bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); - pSwingTable = TxScalingTable_Jaguar; - swingTableSize = TXSCALE_TABLE_SIZE; - } - else -#endif - { - bbSwing = 0; - pSwingTable = OFDMSwingTable; - swingTableSize = OFDM_TABLE_SIZE; - } - } - - for (i = 0; i < swingTableSize; ++i) { - u4Byte tableValue = pSwingTable[i]; - - if (tableValue >= 0x100000 ) - tableValue >>= 22; - if (bbSwing == tableValue) - break; - } - return i; -} - -VOID -odm_TXPowerTrackingThermalMeterInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); - u1Byte p = 0; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - if(pDM_Odm->mp_mode == FALSE) - pHalData->TxPowerTrackControl = TRUE; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - pRFCalibrateInfo->bTXPowerTracking = _TRUE; - pRFCalibrateInfo->TXPowercount = 0; - pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; - - if(pDM_Odm->mp_mode == FALSE) - pRFCalibrateInfo->TxPowerTrackControl = _TRUE; - else - pRFCalibrateInfo->TxPowerTrackControl = _FALSE; - - if(pDM_Odm->mp_mode == FALSE) - pRFCalibrateInfo->TxPowerTrackControl = _TRUE; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl)); - -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - #ifdef RTL8188E_SUPPORT - { - pRFCalibrateInfo->bTXPowerTracking = _TRUE; - pRFCalibrateInfo->TXPowercount = 0; - pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; - pRFCalibrateInfo->TxPowerTrackControl = _TRUE; - } - #endif -#endif - - //pDM_Odm->RFCalibrateInfo.TxPowerTrackControl = TRUE; - pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; - pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; - pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; - - if (pRFCalibrateInfo->DefaultBbSwingIndexFlag != TRUE) { - /*The index of "0 dB" in SwingTable.*/ - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || - pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) { - pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; - pRFCalibrateInfo->DefaultCckIndex = 20; - } else if (pDM_Odm->SupportICType == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ - pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ - pRFCalibrateInfo->DefaultCckIndex = 20; /*CCK:-6dB*/ - } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ - pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ - pRFCalibrateInfo->DefaultCckIndex = 28; /*CCK: -6dB*/ - } else { - pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; - pRFCalibrateInfo->DefaultCckIndex = 24; - } - pRFCalibrateInfo->DefaultBbSwingIndexFlag = TRUE; - } - - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; - pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; - - for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) - { - pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->DeltaPowerIndex[p] = 0; - pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - } - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = 0; - pRFCalibrateInfo->Modify_TxAGC_Value_CCK = 0; - -} - - -VOID -ODM_TXPowerTrackingCheck( - IN PVOID pDM_VOID - ) -{ - /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate - at the same time. In the stage2/3, we need to prive universal interface and merge all - HW dynamic mechanism. */ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - switch (pDM_Odm->SupportPlatform) - { - case ODM_WIN: - odm_TXPowerTrackingCheckMP(pDM_Odm); - break; - - case ODM_CE: - odm_TXPowerTrackingCheckCE(pDM_Odm); - break; - - case ODM_AP: - odm_TXPowerTrackingCheckAP(pDM_Odm); - break; - - default: - break; - } - -} - -VOID -odm_TXPowerTrackingCheckCE( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - - if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) - return; - - if (!pDM_Odm->RFCalibrateInfo.TM_Trigger) { - - if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) - || IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) - || IS_HARDWARE_TYPE_8703B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter) || IS_HARDWARE_TYPE_8822B(Adapter) - || IS_HARDWARE_TYPE_8821C(Adapter) - ) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_NEW, (BIT17 | BIT16), 0x03); - } else { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER_OLD, bRFRegOffsetMask, 0x60); - } - - - - pDM_Odm->RFCalibrateInfo.TM_Trigger = 1; - return; - } - else - { - - ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); - pDM_Odm->RFCalibrateInfo.TM_Trigger = 0; - } - -#endif -} - -VOID -odm_TXPowerTrackingCheckMP( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - - if (ODM_CheckPowerStatus(Adapter) == FALSE) - { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); - return; - } - - odm_TXPowerTrackingThermalMeterCheck(Adapter); -#endif - -} - - -VOID -odm_TXPowerTrackingCheckAP( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - prtl8192cd_priv priv = pDM_Odm->priv; - - return; - -#endif -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -odm_TXPowerTrackingThermalMeterCheck( - IN PADAPTER Adapter - ) -{ -#ifndef AP_BUILD_WORKAROUND - static u1Byte TM_Trigger = 0; - - if (!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, - ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); - return; - } - - if (!TM_Trigger) { - if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || - IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) - || IS_HARDWARE_TYPE_8703B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter)) - PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); - else - PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); - - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); - - TM_Trigger = 1; - return; - } else { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); - odm_TXPowerTrackingDirectCall(Adapter); - TM_Trigger = 0; - } -#endif -} -#endif - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.h deleted file mode 100644 index 47ecf4ff34dd..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_ce.h +++ /dev/null @@ -1,334 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMPOWERTRACKING_H__ -#define __PHYDMPOWERTRACKING_H__ - -#define POWRTRACKING_VERSION "1.1" - -#define DPK_DELTA_MAPPING_NUM 13 -#define index_mapping_HP_NUM 15 -#define OFDM_TABLE_SIZE 43 -#define CCK_TABLE_SIZE 33 -#define CCK_TABLE_SIZE_88F 21 -#define TXSCALE_TABLE_SIZE 37 -#define CCK_TABLE_SIZE_8723D 41 - -#define TXPWR_TRACK_TABLE_SIZE 30 -#define DELTA_SWINGIDX_SIZE 30 -#define DELTA_SWINTSSI_SIZE 61 -#define BAND_NUM 4 - -#define AVG_THERMAL_NUM 8 -#define HP_THERMAL_NUM 8 -#define IQK_MAC_REG_NUM 4 -#define IQK_ADDA_REG_NUM 16 -#define IQK_BB_REG_NUM_MAX 10 - -#define IQK_BB_REG_NUM 9 - - - -#define IQK_Matrix_REG_NUM 8 -#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G - -extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; -extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; - -extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; -extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; -extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; - -extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; - -// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; - -#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck - -typedef struct _IQK_MATRIX_REGS_SETTING{ - BOOLEAN bIQKDone; - s4Byte Value[3][IQK_Matrix_REG_NUM]; - BOOLEAN bBWIqkResultSaved[3]; -}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; - -typedef struct ODM_RF_Calibration_Structure -{ - //for tx power tracking - - u4Byte RegA24; // for TempCCK - s4Byte RegE94; - s4Byte RegE9C; - s4Byte RegEB4; - s4Byte RegEBC; - - u1Byte TXPowercount; - BOOLEAN bTXPowerTrackingInit; - BOOLEAN bTXPowerTracking; - u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default - u1Byte TM_Trigger; - u1Byte InternalPA5G[2]; //pathA / pathB - - u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 - u1Byte ThermalValue; - u1Byte ThermalValue_LCK; - u1Byte ThermalValue_IQK; - u1Byte ThermalValue_DPK; - u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; - u1Byte ThermalValue_AVG_index; - u1Byte ThermalValue_RxGain; - u1Byte ThermalValue_Crystal; - u1Byte ThermalValue_DPKstore; - u1Byte ThermalValue_DPKtrack; - BOOLEAN TxPowerTrackingInProgress; - - BOOLEAN bReloadtxpowerindex; - u1Byte bRfPiEnable; - u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug - - - //------------------------- Tx power Tracking -------------------------// - u1Byte bCCKinCH14; - u1Byte CCK_index; - u1Byte OFDM_index[MAX_RF_PATH]; - s1Byte PowerIndexOffset[MAX_RF_PATH]; - s1Byte DeltaPowerIndex[MAX_RF_PATH]; - s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; - BOOLEAN bTxPowerChanged; - s1Byte XtalOffset; - s1Byte XtalOffsetLast; - - u1Byte ThermalValue_HP[HP_THERMAL_NUM]; - u1Byte ThermalValue_HP_index; - IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; - u1Byte Delta_LCK; - s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB - u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; - s1Byte DeltaSwingTableXtal_P[DELTA_SWINGIDX_SIZE]; - s1Byte DeltaSwingTableXtal_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; - - u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; - u1Byte BbSwingIdxOfdmCurrent; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -#else - u1Byte BbSwingIdxOfdmBase; -#endif - BOOLEAN DefaultBbSwingIndexFlag; - BOOLEAN BbSwingFlagOfdm; - u1Byte BbSwingIdxCck; - u1Byte BbSwingIdxCckCurrent; - u1Byte BbSwingIdxCckBase; - u1Byte DefaultOfdmIndex; - u1Byte DefaultCckIndex; - BOOLEAN BbSwingFlagCck; - - s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; - s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; - s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; - s1Byte Remnant_CCKSwingIdx; - s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ - BOOLEAN Modify_TxAGC_Flag_PathA; - BOOLEAN Modify_TxAGC_Flag_PathB; - BOOLEAN Modify_TxAGC_Flag_PathC; - BOOLEAN Modify_TxAGC_Flag_PathD; - BOOLEAN Modify_TxAGC_Flag_PathA_CCK; - - s1Byte KfreeOffset[MAX_RF_PATH]; - - //--------------------------------------------------------------------// - - //for IQK - u4Byte RegC04; - u4Byte Reg874; - u4Byte RegC08; - u4Byte RegB68; - u4Byte RegB6C; - u4Byte Reg870; - u4Byte Reg860; - u4Byte Reg864; - - BOOLEAN bIQKInitialized; - BOOLEAN bLCKInProgress; - BOOLEAN bAntennaDetected; - BOOLEAN bNeedIQK; - BOOLEAN bIQKInProgress; - BOOLEAN bIQKPAoff; - u1Byte Delta_IQK; - u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; - u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; - u4Byte IQK_BB_backup_recover[9]; - u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; - u4Byte TxIQC_8723B[2][3][2]; // { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} - u4Byte RxIQC_8723B[2][2][2]; // { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} - u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ - u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ - u4Byte TxIQC_8723D[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ - u4Byte RxIQC_8723D[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ - - u1Byte IQKstep; - u1Byte Kcount; - u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ - BOOLEAN isMPmode; - - - - // IQK time measurement - u8Byte IQK_StartTime; - u8Byte IQK_ProgressingTime; - u8Byte IQK_TotalProgressingTime; - - u4Byte LOK_Result; - - //for APK - u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a - u1Byte bAPKdone; - u1Byte bAPKThermalMeterIgnore; - - // DPK - BOOLEAN bDPKFail; - u1Byte bDPdone; - u1Byte bDPPathAOK; - u1Byte bDPPathBOK; - - u4Byte TxLOK[2]; - u4Byte DpkTxAGC; - s4Byte DpkGain; - u4Byte DpkThermal[4]; - s1Byte Modify_TxAGC_Value_OFDM; - s1Byte Modify_TxAGC_Value_CCK; - - /*Add by Yuchen for Kfree Phydm*/ - u1Byte RegRfKFreeEnable; /*for registry*/ - u1Byte RfKFreeEnable; /*for efuse enable check*/ - -}ODM_RF_CAL_T,*PODM_RF_CAL_T; - - -VOID -ODM_TXPowerTrackingCheck( - IN PVOID pDM_VOID - ); - - -VOID -odm_TXPowerTrackingInit( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingCheckAP( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingThermalMeterInit( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingInit( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingCheckMP( - IN PVOID pDM_VOID - ); - - -VOID -odm_TXPowerTrackingCheckCE( - IN PVOID pDM_VOID - ); - -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - -VOID -odm_TXPowerTrackingCallbackThermalMeter92C( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingCallbackRXGainThermalMeter92D( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingCallbackThermalMeter92D( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingDirectCall92C( - IN PADAPTER Adapter - ); - -VOID -odm_TXPowerTrackingThermalMeterCheck( - IN PADAPTER Adapter - ); - -#endif - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.c deleted file mode 100644 index 5179cd1ac562..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.c +++ /dev/null @@ -1,784 +0,0 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -//============================================================ -// Global var -//============================================================ - -u4Byte OFDMSwingTable[OFDM_TABLE_SIZE] = { - 0x7f8001fe, // 0, +6.0dB - 0x788001e2, // 1, +5.5dB - 0x71c001c7, // 2, +5.0dB - 0x6b8001ae, // 3, +4.5dB - 0x65400195, // 4, +4.0dB - 0x5fc0017f, // 5, +3.5dB - 0x5a400169, // 6, +3.0dB - 0x55400155, // 7, +2.5dB - 0x50800142, // 8, +2.0dB - 0x4c000130, // 9, +1.5dB - 0x47c0011f, // 10, +1.0dB - 0x43c0010f, // 11, +0.5dB - 0x40000100, // 12, +0dB - 0x3c8000f2, // 13, -0.5dB - 0x390000e4, // 14, -1.0dB - 0x35c000d7, // 15, -1.5dB - 0x32c000cb, // 16, -2.0dB - 0x300000c0, // 17, -2.5dB - 0x2d4000b5, // 18, -3.0dB - 0x2ac000ab, // 19, -3.5dB - 0x288000a2, // 20, -4.0dB - 0x26000098, // 21, -4.5dB - 0x24000090, // 22, -5.0dB - 0x22000088, // 23, -5.5dB - 0x20000080, // 24, -6.0dB - 0x1e400079, // 25, -6.5dB - 0x1c800072, // 26, -7.0dB - 0x1b00006c, // 27. -7.5dB - 0x19800066, // 28, -8.0dB - 0x18000060, // 29, -8.5dB - 0x16c0005b, // 30, -9.0dB - 0x15800056, // 31, -9.5dB - 0x14400051, // 32, -10.0dB - 0x1300004c, // 33, -10.5dB - 0x12000048, // 34, -11.0dB - 0x11000044, // 35, -11.5dB - 0x10000040, // 36, -12.0dB -}; - -u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8] = { - {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04}, // 0, +0dB - {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 1, -0.5dB - {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 2, -1.0dB - {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 3, -1.5dB - {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 4, -2.0dB - {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 5, -2.5dB - {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 6, -3.0dB - {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 7, -3.5dB - {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 8, -4.0dB - {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 9, -4.5dB - {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 10, -5.0dB - {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 11, -5.5dB - {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 12, -6.0dB <== default - {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 13, -6.5dB - {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 14, -7.0dB - {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 15, -7.5dB - {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB - {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 17, -8.5dB - {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 18, -9.0dB - {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 19, -9.5dB - {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 20, -10.0dB - {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 21, -10.5dB - {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 22, -11.0dB - {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 23, -11.5dB - {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 24, -12.0dB - {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 25, -12.5dB - {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 26, -13.0dB - {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 27, -13.5dB - {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 28, -14.0dB - {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 29, -14.5dB - {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 30, -15.0dB - {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 31, -15.5dB - {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01} // 32, -16.0dB -}; - - -u1Byte CCKSwingTable_Ch14[CCK_TABLE_SIZE][8] = { - {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00}, // 0, +0dB - {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 1, -0.5dB - {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 2, -1.0dB - {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 3, -1.5dB - {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 4, -2.0dB - {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 5, -2.5dB - {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 6, -3.0dB - {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 7, -3.5dB - {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 8, -4.0dB - {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 9, -4.5dB - {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 10, -5.0dB - {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 11, -5.5dB - {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 12, -6.0dB <== default - {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 13, -6.5dB - {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 14, -7.0dB - {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 15, -7.5dB - {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB - {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 17, -8.5dB - {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 18, -9.0dB - {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 19, -9.5dB - {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 20, -10.0dB - {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 21, -10.5dB - {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 22, -11.0dB - {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 23, -11.5dB - {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 24, -12.0dB - {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 25, -12.5dB - {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 26, -13.0dB - {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 27, -13.5dB - {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 28, -14.0dB - {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 29, -14.5dB - {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 30, -15.0dB - {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 31, -15.5dB - {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00} // 32, -16.0dB -}; - - -u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE] = { - 0x0b40002d, // 0, -15.0dB - 0x0c000030, // 1, -14.5dB - 0x0cc00033, // 2, -14.0dB - 0x0d800036, // 3, -13.5dB - 0x0e400039, // 4, -13.0dB - 0x0f00003c, // 5, -12.5dB - 0x10000040, // 6, -12.0dB - 0x11000044, // 7, -11.5dB - 0x12000048, // 8, -11.0dB - 0x1300004c, // 9, -10.5dB - 0x14400051, // 10, -10.0dB - 0x15800056, // 11, -9.5dB - 0x16c0005b, // 12, -9.0dB - 0x18000060, // 13, -8.5dB - 0x19800066, // 14, -8.0dB - 0x1b00006c, // 15, -7.5dB - 0x1c800072, // 16, -7.0dB - 0x1e400079, // 17, -6.5dB - 0x20000080, // 18, -6.0dB - 0x22000088, // 19, -5.5dB - 0x24000090, // 20, -5.0dB - 0x26000098, // 21, -4.5dB - 0x288000a2, // 22, -4.0dB - 0x2ac000ab, // 23, -3.5dB - 0x2d4000b5, // 24, -3.0dB - 0x300000c0, // 25, -2.5dB - 0x32c000cb, // 26, -2.0dB - 0x35c000d7, // 27, -1.5dB - 0x390000e4, // 28, -1.0dB - 0x3c8000f2, // 29, -0.5dB - 0x40000100, // 30, +0dB - 0x43c0010f, // 31, +0.5dB - 0x47c0011f, // 32, +1.0dB - 0x4c000130, // 33, +1.5dB - 0x50800142, // 34, +2.0dB - 0x55400155, // 35, +2.5dB - 0x5a400169, // 36, +3.0dB - 0x5fc0017f, // 37, +3.5dB - 0x65400195, // 38, +4.0dB - 0x6b8001ae, // 39, +4.5dB - 0x71c001c7, // 40, +5.0dB - 0x788001e2, // 41, +5.5dB - 0x7f8001fe // 42, +6.0dB -}; - - -u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -}; - - -u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16] = { -{0x44, 0x42, 0x3C, 0x33, 0x28, 0x1C, 0x13, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -{0x48, 0x46, 0x3F, 0x36, 0x2A, 0x1E, 0x14, 0x0B, 0x05, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -{0x4D, 0x4A, 0x43, 0x39, 0x2C, 0x20, 0x15, 0x0C, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -{0x51, 0x4F, 0x47, 0x3C, 0x2F, 0x22, 0x16, 0x0D, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -{0x56, 0x53, 0x4B, 0x40, 0x32, 0x24, 0x17, 0x0E, 0x06, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -{0x5B, 0x58, 0x50, 0x43, 0x35, 0x26, 0x19, 0x0E, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -{0x60, 0x5D, 0x54, 0x47, 0x38, 0x28, 0x1A, 0x0F, 0x07, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -{0x66, 0x63, 0x59, 0x4C, 0x3B, 0x2B, 0x1C, 0x10, 0x08, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -{0x6C, 0x69, 0x5F, 0x50, 0x3F, 0x2D, 0x1E, 0x11, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -{0x73, 0x6F, 0x64, 0x55, 0x42, 0x30, 0x1F, 0x12, 0x08, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -{0x79, 0x76, 0x6A, 0x5A, 0x46, 0x33, 0x21, 0x13, 0x09, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -{0x81, 0x7C, 0x71, 0x5F, 0x4A, 0x36, 0x23, 0x14, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -{0x88, 0x84, 0x77, 0x65, 0x4F, 0x39, 0x25, 0x15, 0x0A, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -{0x90, 0x8C, 0x7E, 0x6B, 0x54, 0x3C, 0x27, 0x17, 0x0B, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -{0x99, 0x94, 0x86, 0x71, 0x58, 0x40, 0x2A, 0x18, 0x0B, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -{0xA2, 0x9D, 0x8E, 0x78, 0x5E, 0x43, 0x2C, 0x19, 0x0C, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -{0xAC, 0xA6, 0x96, 0x7F, 0x63, 0x47, 0x2F, 0x1B, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -{0xB6, 0xB0, 0x9F, 0x87, 0x69, 0x4C, 0x32, 0x1D, 0x0D, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -{0xC1, 0xBA, 0xA8, 0x8F, 0x6F, 0x50, 0x35, 0x1E, 0x0E, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -{0xCC, 0xC5, 0xB2, 0x97, 0x76, 0x55, 0x38, 0x20, 0x0F, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -{0xD8, 0xD1, 0xBD, 0xA0, 0x7D, 0x5A, 0x3B, 0x22, 0x10, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -}; - - -u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16] = { -{0x44, 0x42, 0x3C, 0x28, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-16dB*/ -{0x48, 0x46, 0x3F, 0x2A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15.5dB*/ -{0x4D, 0x4A, 0x43, 0x2C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-15dB*/ -{0x51, 0x4F, 0x47, 0x2F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14.5dB*/ -{0x56, 0x53, 0x4B, 0x32, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-14dB*/ -{0x5B, 0x58, 0x50, 0x35, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13.5dB*/ -{0x60, 0x5D, 0x54, 0x38, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-13dB*/ -{0x66, 0x63, 0x59, 0x3B, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12.5dB*/ -{0x6C, 0x69, 0x5F, 0x3F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-12dB*/ -{0x73, 0x6F, 0x64, 0x42, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11.5dB*/ -{0x79, 0x76, 0x6A, 0x46, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-11dB*/ -{0x81, 0x7C, 0x71, 0x4A, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10.5dB*/ -{0x88, 0x84, 0x77, 0x4F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-10dB*/ -{0x90, 0x8C, 0x7E, 0x54, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9.5dB*/ -{0x99, 0x94, 0x86, 0x58, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-9dB*/ -{0xA2, 0x9D, 0x8E, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8.5dB*/ -{0xAC, 0xA6, 0x96, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-8dB*/ -{0xB6, 0xB0, 0x9F, 0x69, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7.5dB*/ -{0xC1, 0xBA, 0xA8, 0x6F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-7dB*/ -{0xCC, 0xC5, 0xB2, 0x76, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}, /*-6.5dB*/ -{0xD8, 0xD1, 0xBD, 0x7D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00} /*-6dB*/ -}; - - - - -u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8] = { - {0x09, 0x08, 0x07, 0x06, 0x04, 0x03, 0x01, 0x01}, // 0, -16.0dB - {0x09, 0x09, 0x08, 0x06, 0x05, 0x03, 0x01, 0x01}, // 1, -15.5dB - {0x0a, 0x09, 0x08, 0x07, 0x05, 0x03, 0x02, 0x01}, // 2, -15.0dB - {0x0a, 0x0a, 0x09, 0x07, 0x05, 0x03, 0x02, 0x01}, // 3, -14.5dB - {0x0b, 0x0a, 0x09, 0x08, 0x06, 0x04, 0x02, 0x01}, // 4, -14.0dB - {0x0b, 0x0b, 0x0a, 0x08, 0x06, 0x04, 0x02, 0x01}, // 5, -13.5dB - {0x0c, 0x0c, 0x0a, 0x09, 0x06, 0x04, 0x02, 0x01}, // 6, -13.0dB - {0x0d, 0x0c, 0x0b, 0x09, 0x07, 0x04, 0x02, 0x01}, // 7, -12.5dB - {0x0d, 0x0d, 0x0c, 0x0a, 0x07, 0x05, 0x02, 0x01}, // 8, -12.0dB - {0x0e, 0x0e, 0x0c, 0x0a, 0x08, 0x05, 0x02, 0x01}, // 9, -11.5dB - {0x0f, 0x0f, 0x0d, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 10, -11.0dB - {0x10, 0x10, 0x0e, 0x0b, 0x08, 0x05, 0x03, 0x01}, // 11, -10.5dB - {0x11, 0x11, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 12, -10.0dB - {0x12, 0x12, 0x0f, 0x0c, 0x09, 0x06, 0x03, 0x01}, // 13, -9.5dB - {0x13, 0x13, 0x10, 0x0d, 0x0a, 0x06, 0x03, 0x01}, // 14, -9.0dB - {0x14, 0x14, 0x11, 0x0e, 0x0b, 0x07, 0x03, 0x02}, // 15, -8.5dB - {0x16, 0x15, 0x12, 0x0f, 0x0b, 0x07, 0x04, 0x01}, // 16, -8.0dB - {0x17, 0x16, 0x13, 0x10, 0x0c, 0x08, 0x04, 0x02}, // 17, -7.5dB - {0x18, 0x17, 0x15, 0x11, 0x0c, 0x08, 0x04, 0x02}, // 18, -7.0dB - {0x1a, 0x19, 0x16, 0x12, 0x0d, 0x09, 0x04, 0x02}, // 19, -6.5dB - {0x1b, 0x1a, 0x17, 0x13, 0x0e, 0x09, 0x04, 0x02}, // 20, -6.0dB - {0x1d, 0x1c, 0x18, 0x14, 0x0f, 0x0a, 0x05, 0x02}, // 21, -5.5dB - {0x1f, 0x1e, 0x1a, 0x15, 0x10, 0x0a, 0x05, 0x02}, // 22, -5.0dB - {0x20, 0x20, 0x1b, 0x16, 0x11, 0x08, 0x05, 0x02}, // 23, -4.5dB - {0x22, 0x21, 0x1d, 0x18, 0x11, 0x0b, 0x06, 0x02}, // 24, -4.0dB - {0x24, 0x23, 0x1f, 0x19, 0x13, 0x0c, 0x06, 0x03}, // 25, -3.5dB - {0x26, 0x25, 0x21, 0x1b, 0x14, 0x0d, 0x06, 0x03}, // 26, -3.0dB - {0x28, 0x28, 0x22, 0x1c, 0x15, 0x0d, 0x07, 0x03}, // 27, -2.5dB - {0x2b, 0x2a, 0x25, 0x1e, 0x16, 0x0e, 0x07, 0x03}, // 28, -2.0dB - {0x2d, 0x2d, 0x27, 0x1f, 0x18, 0x0f, 0x08, 0x03}, // 29, -1.5dB - {0x30, 0x2f, 0x29, 0x21, 0x19, 0x10, 0x08, 0x03}, // 30, -1.0dB - {0x33, 0x32, 0x2b, 0x23, 0x1a, 0x11, 0x08, 0x04}, // 31, -0.5dB - {0x36, 0x35, 0x2e, 0x25, 0x1c, 0x12, 0x09, 0x04} // 32, +0dB -}; - - -u1Byte CCKSwingTable_Ch14_New[CCK_TABLE_SIZE][8]= { - {0x09, 0x08, 0x07, 0x04, 0x00, 0x00, 0x00, 0x00}, // 0, -16.0dB - {0x09, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 1, -15.5dB - {0x0a, 0x09, 0x08, 0x05, 0x00, 0x00, 0x00, 0x00}, // 2, -15.0dB - {0x0a, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 3, -14.5dB - {0x0b, 0x0a, 0x09, 0x05, 0x00, 0x00, 0x00, 0x00}, // 4, -14.0dB - {0x0b, 0x0b, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 5, -13.5dB - {0x0c, 0x0c, 0x0a, 0x06, 0x00, 0x00, 0x00, 0x00}, // 6, -13.0dB - {0x0d, 0x0c, 0x0b, 0x06, 0x00, 0x00, 0x00, 0x00}, // 7, -12.5dB - {0x0d, 0x0d, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 8, -12.0dB - {0x0e, 0x0e, 0x0c, 0x07, 0x00, 0x00, 0x00, 0x00}, // 9, -11.5dB - {0x0f, 0x0f, 0x0d, 0x08, 0x00, 0x00, 0x00, 0x00}, // 10, -11.0dB - {0x10, 0x10, 0x0e, 0x08, 0x00, 0x00, 0x00, 0x00}, // 11, -10.5dB - {0x11, 0x11, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 12, -10.0dB - {0x12, 0x12, 0x0f, 0x09, 0x00, 0x00, 0x00, 0x00}, // 13, -9.5dB - {0x13, 0x13, 0x10, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 14, -9.0dB - {0x14, 0x14, 0x11, 0x0a, 0x00, 0x00, 0x00, 0x00}, // 15, -8.5dB - {0x16, 0x15, 0x12, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 16, -8.0dB - {0x17, 0x16, 0x13, 0x0b, 0x00, 0x00, 0x00, 0x00}, // 17, -7.5dB - {0x18, 0x17, 0x15, 0x0c, 0x00, 0x00, 0x00, 0x00}, // 18, -7.0dB - {0x1a, 0x19, 0x16, 0x0d, 0x00, 0x00, 0x00, 0x00}, // 19, -6.5dB - {0x1b, 0x1a, 0x17, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 20, -6.0dB - {0x1d, 0x1c, 0x18, 0x0e, 0x00, 0x00, 0x00, 0x00}, // 21, -5.5dB - {0x1f, 0x1e, 0x1a, 0x0f, 0x00, 0x00, 0x00, 0x00}, // 22, -5.0dB - {0x20, 0x20, 0x1b, 0x10, 0x00, 0x00, 0x00, 0x00}, // 23, -4.5dB - {0x22, 0x21, 0x1d, 0x11, 0x00, 0x00, 0x00, 0x00}, // 24, -4.0dB - {0x24, 0x23, 0x1f, 0x12, 0x00, 0x00, 0x00, 0x00}, // 25, -3.5dB - {0x26, 0x25, 0x21, 0x13, 0x00, 0x00, 0x00, 0x00}, // 26, -3.0dB - {0x28, 0x28, 0x24, 0x14, 0x00, 0x00, 0x00, 0x00}, // 27, -2.5dB - {0x2b, 0x2a, 0x25, 0x15, 0x00, 0x00, 0x00, 0x00}, // 28, -2.0dB - {0x2d, 0x2d, 0x17, 0x17, 0x00, 0x00, 0x00, 0x00}, // 29, -1.5dB - {0x30, 0x2f, 0x29, 0x18, 0x00, 0x00, 0x00, 0x00}, // 30, -1.0dB - {0x33, 0x32, 0x2b, 0x19, 0x00, 0x00, 0x00, 0x00}, // 31, -0.5dB - {0x36, 0x35, 0x2e, 0x1b, 0x00, 0x00, 0x00, 0x00} // 32, +0dB -}; -u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D] = { - 0x0CD, - 0x0D9, - 0x0E6, - 0x0F3, - 0x102, - 0x111, - 0x121, - 0x132, - 0x144, - 0x158, - 0x16C, - 0x182, - 0x198, - 0x1B1, - 0x1CA, - 0x1E5, - 0x202, - 0x221, - 0x241, - 0x263, - 0x287, - 0x2AE, - 0x2D6, - 0x301, - 0x32F, - 0x35F, - 0x392, - 0x3C9, - 0x402, - 0x43F, - 0x47F, - 0x4C3, - 0x50C, - 0x558, - 0x5A9, - 0x5FF, - 0x65A, - 0x6BA, - 0x720, - 0x78C, - 0x7FF, -}; - - -u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE] = -{ - 0x081, // 0, -12.0dB - 0x088, // 1, -11.5dB - 0x090, // 2, -11.0dB - 0x099, // 3, -10.5dB - 0x0A2, // 4, -10.0dB - 0x0AC, // 5, -9.5dB - 0x0B6, // 6, -9.0dB - 0x0C0, // 7, -8.5dB - 0x0CC, // 8, -8.0dB - 0x0D8, // 9, -7.5dB - 0x0E5, // 10, -7.0dB - 0x0F2, // 11, -6.5dB - 0x101, // 12, -6.0dB - 0x110, // 13, -5.5dB - 0x120, // 14, -5.0dB - 0x131, // 15, -4.5dB - 0x143, // 16, -4.0dB - 0x156, // 17, -3.5dB - 0x16A, // 18, -3.0dB - 0x180, // 19, -2.5dB - 0x197, // 20, -2.0dB - 0x1AF, // 21, -1.5dB - 0x1C8, // 22, -1.0dB - 0x1E3, // 23, -0.5dB - 0x200, // 24, +0 dB - 0x21E, // 25, +0.5dB - 0x23E, // 26, +1.0dB - 0x261, // 27, +1.5dB - 0x285, // 28, +2.0dB - 0x2AB, // 29, +2.5dB - 0x2D3, // 30, +3.0dB - 0x2FE, // 31, +3.5dB - 0x32B, // 32, +4.0dB - 0x35C, // 33, +4.5dB - 0x38E, // 34, +5.0dB - 0x3C4, // 35, +5.5dB - 0x3FE // 36, +6.0dB -}; - - -#ifdef AP_BUILD_WORKAROUND - -unsigned int TxPwrTrk_OFDM_SwingTbl[TxPwrTrk_OFDM_SwingTbl_Len] = { - /* +6.0dB */ 0x7f8001fe, - /* +5.5dB */ 0x788001e2, - /* +5.0dB */ 0x71c001c7, - /* +4.5dB */ 0x6b8001ae, - /* +4.0dB */ 0x65400195, - /* +3.5dB */ 0x5fc0017f, - /* +3.0dB */ 0x5a400169, - /* +2.5dB */ 0x55400155, - /* +2.0dB */ 0x50800142, - /* +1.5dB */ 0x4c000130, - /* +1.0dB */ 0x47c0011f, - /* +0.5dB */ 0x43c0010f, - /* 0.0dB */ 0x40000100, - /* -0.5dB */ 0x3c8000f2, - /* -1.0dB */ 0x390000e4, - /* -1.5dB */ 0x35c000d7, - /* -2.0dB */ 0x32c000cb, - /* -2.5dB */ 0x300000c0, - /* -3.0dB */ 0x2d4000b5, - /* -3.5dB */ 0x2ac000ab, - /* -4.0dB */ 0x288000a2, - /* -4.5dB */ 0x26000098, - /* -5.0dB */ 0x24000090, - /* -5.5dB */ 0x22000088, - /* -6.0dB */ 0x20000080, - /* -6.5dB */ 0x1a00006c, - /* -7.0dB */ 0x1c800072, - /* -7.5dB */ 0x18000060, - /* -8.0dB */ 0x19800066, - /* -8.5dB */ 0x15800056, - /* -9.0dB */ 0x26c0005b, - /* -9.5dB */ 0x14400051, - /* -10.0dB */ 0x24400051, - /* -10.5dB */ 0x1300004c, - /* -11.0dB */ 0x12000048, - /* -11.5dB */ 0x11000044, - /* -12.0dB */ 0x10000040 -}; - -#endif - -VOID -odm_TXPowerTrackingInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - if (!(pDM_Odm->SupportICType & (ODM_RTL8814A | ODM_IC_11N_SERIES | ODM_RTL8822B))) - return; -#endif - - odm_TXPowerTrackingThermalMeterInit(pDM_Odm); -} - -u1Byte -getSwingIndex( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u1Byte i = 0; - u4Byte bbSwing; - u4Byte swingTableSize; - pu4Byte pSwingTable; - - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || - pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188F || pDM_Odm->SupportICType == ODM_RTL8703B) - { - bbSwing = PHY_QueryBBReg(Adapter, rOFDM0_XATxIQImbalance, 0xFFC00000); - - pSwingTable = OFDMSwingTable_New; - swingTableSize = OFDM_TABLE_SIZE; - } else { - bbSwing = PHY_GetTxBBSwing_8812A(Adapter, pHalData->CurrentBandType, ODM_RF_PATH_A); - pSwingTable = TxScalingTable_Jaguar; - swingTableSize = TXSCALE_TABLE_SIZE; - } - - for (i = 0; i < swingTableSize; ++i) { - u4Byte tableValue = pSwingTable[i]; - - if (tableValue >= 0x100000 ) - tableValue >>= 22; - if (bbSwing == tableValue) - break; - } - return i; -} - -VOID -odm_TXPowerTrackingThermalMeterInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte defaultSwingIndex = getSwingIndex(pDM_Odm); - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u1Byte p = 0; - - if(pDM_Odm->mp_mode == FALSE) - pRFCalibrateInfo->TxPowerTrackControl = TRUE; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #ifdef CONFIG_RTL8188E - { - pRFCalibrateInfo->bTXPowerTracking = _TRUE; - pRFCalibrateInfo->TXPowercount = 0; - pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; - - if(pDM_Odm->mp_mode == FALSE) - pRFCalibrateInfo->TxPowerTrackControl = _TRUE; - - MSG_8192C("pDM_Odm TxPowerTrackControl = %d\n", pRFCalibrateInfo->TxPowerTrackControl); - } - #else - { - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - struct dm_priv *pdmpriv = &pHalData->dmpriv; - - pdmpriv->bTXPowerTracking = _TRUE; - pdmpriv->TXPowercount = 0; - pdmpriv->bTXPowerTrackingInit = _FALSE; - - if(pDM_Odm->mp_mode == FALSE) - pdmpriv->TxPowerTrackControl = _TRUE; - - MSG_8192C("pdmpriv->TxPowerTrackControl = %d\n", pdmpriv->TxPowerTrackControl); - - } - #endif -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - #ifdef RTL8188E_SUPPORT - { - pRFCalibrateInfo->bTXPowerTracking = _TRUE; - pRFCalibrateInfo->TXPowercount = 0; - pRFCalibrateInfo->bTXPowerTrackingInit = _FALSE; - pRFCalibrateInfo->TxPowerTrackControl = _TRUE; - } - #endif -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #if (MP_DRIVER == 1) - pRFCalibrateInfo->TxPowerTrackControl = FALSE; - #else - pRFCalibrateInfo->TxPowerTrackControl = TRUE; - #endif -#else - pRFCalibrateInfo->TxPowerTrackControl = TRUE; -#endif - - pRFCalibrateInfo->ThermalValue = pHalData->EEPROMThermalMeter; - pRFCalibrateInfo->ThermalValue_IQK = pHalData->EEPROMThermalMeter; - pRFCalibrateInfo->ThermalValue_LCK = pHalData->EEPROMThermalMeter; - - if (pRFCalibrateInfo->DefaultBbSwingIndexFlag != TRUE) { - /*The index of "0 dB" in SwingTable.*/ - if (pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723B || - pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8703B) { - pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= OFDM_TABLE_SIZE) ? 30 : defaultSwingIndex; - pRFCalibrateInfo->DefaultCckIndex = 20; - } else if (pDM_Odm->SupportICType == ODM_RTL8188F) { /*add by Mingzhi.Guo 2015-03-23*/ - pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ - pRFCalibrateInfo->DefaultCckIndex = 20; /*CCK:-6dB*/ - } else if (pDM_Odm->SupportICType == ODM_RTL8723D) { /*add by zhaohe 2015-10-27*/ - pRFCalibrateInfo->DefaultOfdmIndex = 28; /*OFDM: -1dB*/ - pRFCalibrateInfo->DefaultCckIndex = 28; /*CCK: -6dB*/ - } else { - pRFCalibrateInfo->DefaultOfdmIndex = (defaultSwingIndex >= TXSCALE_TABLE_SIZE) ? 24 : defaultSwingIndex; - pRFCalibrateInfo->DefaultCckIndex = 24; - } - pRFCalibrateInfo->DefaultBbSwingIndexFlag = TRUE; - } - - pRFCalibrateInfo->BbSwingIdxCckBase = pRFCalibrateInfo->DefaultCckIndex; - pRFCalibrateInfo->CCK_index = pRFCalibrateInfo->DefaultCckIndex; - - for (p = ODM_RF_PATH_A; p < MAX_RF_PATH; ++p) - { - pRFCalibrateInfo->BbSwingIdxOfdmBase[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->OFDM_index[p] = pRFCalibrateInfo->DefaultOfdmIndex; - pRFCalibrateInfo->DeltaPowerIndex[p] = 0; - pRFCalibrateInfo->DeltaPowerIndexLast[p] = 0; - pRFCalibrateInfo->PowerIndexOffset[p] = 0; - pRFCalibrateInfo->KfreeOffset[p] = 0; - } - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = 0; - pRFCalibrateInfo->Modify_TxAGC_Value_CCK = 0; - -} - - -VOID -ODM_TXPowerTrackingCheck( - IN PVOID pDM_VOID - ) -{ - - /* 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate - // at the same time. In the stage2/3, we need to prive universal interface and merge all - // HW dynamic mechanism.*/ - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - switch (pDM_Odm->SupportPlatform) - { - case ODM_WIN: - odm_TXPowerTrackingCheckMP(pDM_Odm); - break; - - case ODM_CE: - odm_TXPowerTrackingCheckCE(pDM_Odm); - break; - - case ODM_AP: - odm_TXPowerTrackingCheckAP(pDM_Odm); - break; - - default: - break; - } - -} - -VOID -odm_TXPowerTrackingCheckCE( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PADAPTER Adapter = pDM_Odm->Adapter; - #if ((RTL8188F_SUPPORT == 1)) - rtl8192c_odm_CheckTXPowerTracking(Adapter); - #endif - - #if(RTL8188E_SUPPORT==1) - - if (!(pDM_Odm->SupportAbility & ODM_RF_TX_PWR_TRACK)) { - return; - } - - if (!pRFCalibrateInfo->TM_Trigger) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); - /*DBG_8192C("Trigger 92C Thermal Meter!!\n");*/ - - pRFCalibrateInfo->TM_Trigger = 1; - return; - - } else { - /*DBG_8192C("Schedule TxPowerTracking direct call!!\n");*/ - odm_TXPowerTrackingCallback_ThermalMeter_8188E(Adapter); - pRFCalibrateInfo->TM_Trigger = 0; - } - #endif -#endif -} - -VOID -odm_TXPowerTrackingCheckMP( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - - if (*pDM_Odm->pIsFcsModeEnable) - return; - - if (ODM_CheckPowerStatus(Adapter) == FALSE) - { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, ("===>ODM_CheckPowerStatus() return FALSE\n")); - return; - } - - if (IS_HARDWARE_TYPE_8821B(Adapter)) /* TODO: Don't Do PowerTracking*/ - return; - - odm_TXPowerTrackingThermalMeterCheck(Adapter); - - -#endif - -} - - -VOID -odm_TXPowerTrackingCheckAP( - IN PVOID pDM_VOID - ) -{ -return; - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -VOID -odm_TXPowerTrackingDirectCall( - IN PADAPTER Adapter - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - ODM_TXPowerTrackingCallback_ThermalMeter(Adapter); -} - -VOID -odm_TXPowerTrackingThermalMeterCheck( - IN PADAPTER Adapter - ) -{ -#ifndef AP_BUILD_WORKAROUND - static u1Byte TM_Trigger = 0; - - if (!(GET_HAL_DATA(Adapter)->DM_OutSrc.SupportAbility & ODM_RF_TX_PWR_TRACK)) - { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD, - ("===>odm_TXPowerTrackingThermalMeterCheck(),pMgntInfo->bTXPowerTracking is FALSE, return!!\n")); - return; - } - - if (!TM_Trigger) - { - if (IS_HARDWARE_TYPE_8188E(Adapter) || IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_8192E(Adapter) || - IS_HARDWARE_TYPE_8723B(Adapter) || IS_HARDWARE_TYPE_8814A(Adapter) || IS_HARDWARE_TYPE_8188F(Adapter) || IS_HARDWARE_TYPE_8703B(Adapter) - || IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8723D(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter)) - PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER_88E, BIT17 | BIT16, 0x03); - else - PHY_SetRFReg(Adapter, ODM_RF_PATH_A, RF_T_METER, bRFRegOffsetMask, 0x60); - - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Trigger Thermal Meter!!\n")); - - TM_Trigger = 1; - return; - } else { - RT_TRACE(COMP_POWER_TRACKING, DBG_LOUD,("Schedule TxPowerTracking direct call!!\n")); - odm_TXPowerTrackingDirectCall(Adapter); - TM_Trigger = 0; - } -#endif -} - -#endif - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.h deleted file mode 100644 index 27e0253c1db9..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_powertracking_win.h +++ /dev/null @@ -1,299 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMPOWERTRACKING_H__ -#define __PHYDMPOWERTRACKING_H__ - -#define POWRTRACKING_VERSION "1.1" - -#define DPK_DELTA_MAPPING_NUM 13 -#define index_mapping_HP_NUM 15 -#define TXSCALE_TABLE_SIZE 37 -#define CCK_TABLE_SIZE_8723D 41 -#define TXPWR_TRACK_TABLE_SIZE 30 -#define DELTA_SWINGIDX_SIZE 30 -#define DELTA_SWINTSSI_SIZE 61 -#define BAND_NUM 3 -#define MAX_RF_PATH 4 -#define CCK_TABLE_SIZE_88F 21 - - -#define dm_CheckTXPowerTracking ODM_TXPowerTrackingCheck - -#define IQK_Matrix_Settings_NUM 14+24+21 // Channels_2_4G_NUM + Channels_5G_20M_NUM + Channels_5G -#define AVG_THERMAL_NUM 8 -#define HP_THERMAL_NUM 8 -#define IQK_Matrix_REG_NUM 8 -#define IQK_MAC_REG_NUM 4 -#define IQK_ADDA_REG_NUM 16 - -#define IQK_BB_REG_NUM 9 - - -extern u4Byte OFDMSwingTable[OFDM_TABLE_SIZE]; -extern u1Byte CCKSwingTable_Ch1_Ch13[CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch14 [CCK_TABLE_SIZE][8]; - -extern u4Byte OFDMSwingTable_New[OFDM_TABLE_SIZE]; -extern u1Byte CCKSwingTable_Ch1_Ch13_New[CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch14_New [CCK_TABLE_SIZE][8]; -extern u1Byte CCKSwingTable_Ch1_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -extern u1Byte CCKSwingTable_Ch1_Ch13_88F[CCK_TABLE_SIZE_88F][16]; -extern u1Byte CCKSwingTable_Ch14_88F[CCK_TABLE_SIZE_88F][16]; -extern u4Byte CCKSwingTable_Ch1_Ch14_8723D[CCK_TABLE_SIZE_8723D]; - -extern u4Byte TxScalingTable_Jaguar[TXSCALE_TABLE_SIZE]; - -// <20121018, Kordan> In case fail to read TxPowerTrack.txt, we use the table of 88E as the default table. -static u1Byte DeltaSwingTableIdx_2GA_P_8188E[] = {0, 0, 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 4, 4, 4, 4, 4, 4, 5, 5, 7, 7, 8, 8, 8, 9, 9, 9, 9, 9}; -static u1Byte DeltaSwingTableIdx_2GA_N_8188E[] = {0, 0, 0, 2, 2, 3, 3, 4, 4, 4, 4, 5, 5, 6, 6, 7, 7, 7, 7, 8, 8, 9, 9, 10, 10, 10, 11, 11, 11, 11}; - -VOID -ODM_TXPowerTrackingCheck( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingCheckAP( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingThermalMeterInit( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingInit( - IN PVOID pDM_VOID - ); - -VOID -odm_TXPowerTrackingCheckMP( - IN PVOID pDM_VOID - ); - - -VOID -odm_TXPowerTrackingCheckCE( - IN PVOID pDM_VOID - ); - -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - - -VOID -odm_TXPowerTrackingThermalMeterCheck( - IN PADAPTER Adapter - ); - -#endif - -typedef struct _IQK_MATRIX_REGS_SETTING{ - BOOLEAN bIQKDone; - s4Byte Value[3][IQK_Matrix_REG_NUM]; - BOOLEAN bBWIqkResultSaved[3]; -}IQK_MATRIX_REGS_SETTING,*PIQK_MATRIX_REGS_SETTING; - -typedef struct ODM_RF_Calibration_Structure -{ - //for tx power tracking - - u4Byte RegA24; // for TempCCK - s4Byte RegE94; - s4Byte RegE9C; - s4Byte RegEB4; - s4Byte RegEBC; - //u1Byte bTXPowerTracking; - u1Byte TXPowercount; - BOOLEAN bTXPowerTrackingInit; - BOOLEAN bTXPowerTracking; - u1Byte TxPowerTrackControl; //for mp mode, turn off txpwrtracking as default - u1Byte TM_Trigger; - u1Byte InternalPA5G[2]; //pathA / pathB - - u1Byte ThermalMeter[2]; // ThermalMeter, index 0 for RFIC0, and 1 for RFIC1 - u1Byte ThermalValue; - u1Byte ThermalValue_LCK; - u1Byte ThermalValue_IQK; - u1Byte ThermalValue_AVG[AVG_THERMAL_NUM]; - u1Byte ThermalValue_AVG_index; - u1Byte ThermalValue_RxGain; - - BOOLEAN bReloadtxpowerindex; - u1Byte bRfPiEnable; - u4Byte TXPowerTrackingCallbackCnt; //cosa add for debug - - - //------------------------- Tx power Tracking -------------------------// - u1Byte bCCKinCH14; - u1Byte CCK_index; - u1Byte OFDM_index[MAX_RF_PATH]; - s1Byte PowerIndexOffset[MAX_RF_PATH]; - s1Byte DeltaPowerIndex[MAX_RF_PATH]; - s1Byte DeltaPowerIndexLast[MAX_RF_PATH]; - BOOLEAN bTxPowerChanged; - s1Byte XtalOffset; - s1Byte XtalOffsetLast; - - u1Byte ThermalValue_HP[HP_THERMAL_NUM]; - u1Byte ThermalValue_HP_index; - IQK_MATRIX_REGS_SETTING IQKMatrixRegSetting[IQK_Matrix_Settings_NUM]; - u1Byte Delta_LCK; - s1Byte BBSwingDiff2G, BBSwingDiff5G; // Unit: dB - u1Byte DeltaSwingTableIdx_2GCCKA_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKA_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKB_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKB_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKC_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKC_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKD_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GCCKD_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GB_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GB_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GC_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GC_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GD_P[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GD_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GA_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GA_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GB_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GB_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GC_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GC_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GD_P[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_5GD_N[BAND_NUM][DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKA[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKB[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKC[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GCCKD[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GA[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GB[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GC[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_2GD[DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GA[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GB[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GC[BAND_NUM][DELTA_SWINTSSI_SIZE]; - u1Byte DeltaSwingTSSITable_5GD[BAND_NUM][DELTA_SWINTSSI_SIZE]; - s1Byte DeltaSwingTableXtal_P[DELTA_SWINGIDX_SIZE]; - s1Byte DeltaSwingTableXtal_N[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_P_8188E[DELTA_SWINGIDX_SIZE]; - u1Byte DeltaSwingTableIdx_2GA_N_8188E[DELTA_SWINGIDX_SIZE]; - - u1Byte BbSwingIdxOfdm[MAX_RF_PATH]; - u1Byte BbSwingIdxOfdmCurrent; -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - u1Byte BbSwingIdxOfdmBase[MAX_RF_PATH]; -#else - u1Byte BbSwingIdxOfdmBase; -#endif - BOOLEAN DefaultBbSwingIndexFlag; - BOOLEAN BbSwingFlagOfdm; - u1Byte BbSwingIdxCck; - u1Byte BbSwingIdxCckCurrent; - u1Byte BbSwingIdxCckBase; - u1Byte DefaultOfdmIndex; - u1Byte DefaultCckIndex; - BOOLEAN BbSwingFlagCck; - - s1Byte Absolute_OFDMSwingIdx[MAX_RF_PATH]; - s1Byte Remnant_OFDMSwingIdx[MAX_RF_PATH]; - s1Byte Absolute_CCKSwingIdx[MAX_RF_PATH]; - s1Byte Remnant_CCKSwingIdx; - s1Byte Modify_TxAGC_Value; /*Remnat compensate value at TxAGC */ - BOOLEAN Modify_TxAGC_Flag_PathA; - BOOLEAN Modify_TxAGC_Flag_PathB; - BOOLEAN Modify_TxAGC_Flag_PathC; - BOOLEAN Modify_TxAGC_Flag_PathD; - BOOLEAN Modify_TxAGC_Flag_PathA_CCK; - - s1Byte KfreeOffset[MAX_RF_PATH]; - - //--------------------------------------------------------------------// - - //for IQK - u4Byte RegC04; - u4Byte Reg874; - u4Byte RegC08; - u4Byte RegB68; - u4Byte RegB6C; - u4Byte Reg870; - u4Byte Reg860; - u4Byte Reg864; - - BOOLEAN bIQKInitialized; - BOOLEAN bLCKInProgress; - BOOLEAN bAntennaDetected; - BOOLEAN bNeedIQK; - BOOLEAN bIQKInProgress; - BOOLEAN bIQKPAoff; - u1Byte Delta_IQK; - u4Byte ADDA_backup[IQK_ADDA_REG_NUM]; - u4Byte IQK_MAC_backup[IQK_MAC_REG_NUM]; - u4Byte IQK_BB_backup_recover[9]; - u4Byte IQK_BB_backup[IQK_BB_REG_NUM]; - u4Byte TxIQC_8723B[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}} */ - u4Byte RxIQC_8723B[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}} */ - u4Byte TxIQC_8703B[3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ - u4Byte RxIQC_8703B[2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ - u4Byte TxIQC_8723D[2][3][2]; /* { {S1: 0xc94, 0xc80, 0xc4c} , {S0: 0xc9c, 0xc88, 0xc4c}}*/ - u4Byte RxIQC_8723D[2][2][2]; /* { {S1: 0xc14, 0xca0} , {S0: 0xc14, 0xca0}}*/ - - u8Byte IQK_StartTime; - u8Byte IQK_TotalProgressingTime; - u8Byte IQK_ProgressingTime; - u4Byte LOK_Result; - u1Byte IQKstep; - u1Byte Kcount; - u1Byte retry_count[4][2]; /* [4]: path ABCD, [2] TXK, RXK */ - BOOLEAN isMPmode; - - //for APK - u4Byte APKoutput[2][2]; //path A/B; output1_1a/output1_2a - u1Byte bAPKdone; - u1Byte bAPKThermalMeterIgnore; - - // DPK - BOOLEAN bDPKFail; - u1Byte bDPdone; - u1Byte bDPPathAOK; - u1Byte bDPPathBOK; - - u4Byte TxLOK[2]; - u4Byte DpkTxAGC; - s4Byte DpkGain; - u4Byte DpkThermal[4]; - - s1Byte Modify_TxAGC_Value_OFDM; - s1Byte Modify_TxAGC_Value_CCK; - - /*Add by Yuchen for Kfree Phydm*/ - u1Byte RegRfKFreeEnable; /*for registry*/ - u1Byte RfKFreeEnable; /*for efuse enable check*/ - - HALMAC_PWR_TRACKING_OPTION HALMAC_PWR_TRACKING_INFO; -}ODM_RF_CAL_T,*PODM_RF_CAL_T; - - - - -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pre_define.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pre_define.h index 032bf50d1855..17e2285516dc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pre_define.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_pre_define.h @@ -1,697 +1,701 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - - -#ifndef __PHYDMPREDEFINE_H__ -#define __PHYDMPREDEFINE_H__ - -//1 ============================================================ -//1 Definition -//1 ============================================================ - -#define PHYDM_CODE_BASE "PHYDM_010" -#define PHYDM_RELEASE_DATE "00000000" - -//Max path of IC -#define MAX_PATH_NUM_8188E 1 -#define MAX_PATH_NUM_8192E 2 -#define MAX_PATH_NUM_8723B 1 -#define MAX_PATH_NUM_8812A 2 -#define MAX_PATH_NUM_8821A 1 -#define MAX_PATH_NUM_8814A 4 -#define MAX_PATH_NUM_8822B 2 -#define MAX_PATH_NUM_8821B 2 -#define MAX_PATH_NUM_8703B 1 -#define MAX_PATH_NUM_8188F 1 -#define MAX_PATH_NUM_8723D 1 -#define MAX_PATH_NUM_8197F 2 -#define MAX_PATH_NUM_8821C 1 - -//Max RF path -#define ODM_RF_PATH_MAX 2 -#define ODM_RF_PATH_MAX_JAGUAR 4 - -/*Bit define path*/ -#define PHYDM_A BIT0 -#define PHYDM_B BIT1 -#define PHYDM_C BIT2 -#define PHYDM_D BIT3 -#define PHYDM_AB (BIT0 | BIT1) -#define PHYDM_AC (BIT0 | BIT2) -#define PHYDM_AD (BIT0 | BIT3) -#define PHYDM_BC (BIT1 | BIT2) -#define PHYDM_BD (BIT1 | BIT3) -#define PHYDM_CD (BIT2 | BIT3) -#define PHYDM_ABC (BIT0 | BIT1 | BIT2) -#define PHYDM_ABD (BIT0 | BIT1 | BIT3) -#define PHYDM_ACD (BIT0 | BIT2 | BIT3) -#define PHYDM_BCD (BIT1 | BIT2 | BIT3) -#define PHYDM_ABCD (BIT0 | BIT1 | BIT2 | BIT3) - -//number of entry -#if(DM_ODM_SUPPORT_TYPE & (ODM_CE)) - #define ASSOCIATE_ENTRY_NUM MACID_NUM_SW_LIMIT /* Max size of AsocEntry[].*/ - #define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM -#elif(DM_ODM_SUPPORT_TYPE & (ODM_AP)) - #define ASSOCIATE_ENTRY_NUM NUM_STAT - #define ODM_ASSOCIATE_ENTRY_NUM (ASSOCIATE_ENTRY_NUM+1) -#else - #define ODM_ASSOCIATE_ENTRY_NUM ((ASSOCIATE_ENTRY_NUM*3)+1) -#endif - -/* -----MGN rate--------------------------------- */ - -enum ODM_MGN_RATE { - ODM_MGN_1M = 0x02, - ODM_MGN_2M = 0x04, - ODM_MGN_5_5M = 0x0B, - ODM_MGN_6M = 0x0C, - ODM_MGN_9M = 0x12, - ODM_MGN_11M = 0x16, - ODM_MGN_12M = 0x18, - ODM_MGN_18M = 0x24, - ODM_MGN_24M = 0x30, - ODM_MGN_36M = 0x48, - ODM_MGN_48M = 0x60, - ODM_MGN_54M = 0x6C, - ODM_MGN_MCS32 = 0x7F, - ODM_MGN_MCS0, - ODM_MGN_MCS1, - ODM_MGN_MCS2, - ODM_MGN_MCS3, - ODM_MGN_MCS4, - ODM_MGN_MCS5, - ODM_MGN_MCS6, - ODM_MGN_MCS7, - ODM_MGN_MCS8, - ODM_MGN_MCS9, - ODM_MGN_MCS10, - ODM_MGN_MCS11, - ODM_MGN_MCS12, - ODM_MGN_MCS13, - ODM_MGN_MCS14, - ODM_MGN_MCS15, - ODM_MGN_MCS16, - ODM_MGN_MCS17, - ODM_MGN_MCS18, - ODM_MGN_MCS19, - ODM_MGN_MCS20, - ODM_MGN_MCS21, - ODM_MGN_MCS22, - ODM_MGN_MCS23, - ODM_MGN_MCS24, - ODM_MGN_MCS25, - ODM_MGN_MCS26, - ODM_MGN_MCS27, - ODM_MGN_MCS28, - ODM_MGN_MCS29, - ODM_MGN_MCS30, - ODM_MGN_MCS31, - ODM_MGN_VHT1SS_MCS0, - ODM_MGN_VHT1SS_MCS1, - ODM_MGN_VHT1SS_MCS2, - ODM_MGN_VHT1SS_MCS3, - ODM_MGN_VHT1SS_MCS4, - ODM_MGN_VHT1SS_MCS5, - ODM_MGN_VHT1SS_MCS6, - ODM_MGN_VHT1SS_MCS7, - ODM_MGN_VHT1SS_MCS8, - ODM_MGN_VHT1SS_MCS9, - ODM_MGN_VHT2SS_MCS0, - ODM_MGN_VHT2SS_MCS1, - ODM_MGN_VHT2SS_MCS2, - ODM_MGN_VHT2SS_MCS3, - ODM_MGN_VHT2SS_MCS4, - ODM_MGN_VHT2SS_MCS5, - ODM_MGN_VHT2SS_MCS6, - ODM_MGN_VHT2SS_MCS7, - ODM_MGN_VHT2SS_MCS8, - ODM_MGN_VHT2SS_MCS9, - ODM_MGN_VHT3SS_MCS0, - ODM_MGN_VHT3SS_MCS1, - ODM_MGN_VHT3SS_MCS2, - ODM_MGN_VHT3SS_MCS3, - ODM_MGN_VHT3SS_MCS4, - ODM_MGN_VHT3SS_MCS5, - ODM_MGN_VHT3SS_MCS6, - ODM_MGN_VHT3SS_MCS7, - ODM_MGN_VHT3SS_MCS8, - ODM_MGN_VHT3SS_MCS9, - ODM_MGN_VHT4SS_MCS0, - ODM_MGN_VHT4SS_MCS1, - ODM_MGN_VHT4SS_MCS2, - ODM_MGN_VHT4SS_MCS3, - ODM_MGN_VHT4SS_MCS4, - ODM_MGN_VHT4SS_MCS5, - ODM_MGN_VHT4SS_MCS6, - ODM_MGN_VHT4SS_MCS7, - ODM_MGN_VHT4SS_MCS8, - ODM_MGN_VHT4SS_MCS9, - ODM_MGN_UNKNOWN +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDMPREDEFINE_H__ +#define __PHYDMPREDEFINE_H__ + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + +#define PHYDM_CODE_BASE "PHYDM_V021" +#define PHYDM_RELEASE_DATE "20170801" + +/*PHYDM API status*/ +#define PHYDM_SET_FAIL 0 +#define PHYDM_SET_SUCCESS 1 +#define PHYDM_SET_NO_NEED 3 + +/*PHYDM Set/Revert*/ +#define PHYDM_SET 1 +#define PHYDM_REVERT 2 + +/* Max path of IC */ +/*N-IC*/ +#define MAX_PATH_NUM_8188E 1 +#define MAX_PATH_NUM_8188F 1 +#define MAX_PATH_NUM_8710B 1 +#define MAX_PATH_NUM_8723B 1 +#define MAX_PATH_NUM_8723D 1 +#define MAX_PATH_NUM_8703B 1 +#define MAX_PATH_NUM_8192E 2 +#define MAX_PATH_NUM_8197F 2 +#define MAX_PATH_NUM_8198F 4 +/*AC-IC*/ +#define MAX_PATH_NUM_8821A 1 +#define MAX_PATH_NUM_8821C 1 +#define MAX_PATH_NUM_8812A 2 +#define MAX_PATH_NUM_8822B 2 +#define MAX_PATH_NUM_8814A 4 +#define MAX_PATH_NUM_8814B 4 + +/* Max RF path */ +#define ODM_RF_PATH_MAX 2 +#define ODM_RF_PATH_MAX_JAGUAR 4 +#define PHYDM_MAX_RF_PATH 4 + +/* number of entry */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) + #ifdef DM_ODM_CE_MAC80211 + /* defined in wifi.h (32+1) */ + #else + #define ASSOCIATE_ENTRY_NUM MACID_NUM_SW_LIMIT /* Max size of asoc_entry[].*/ + #endif + #define ODM_ASSOCIATE_ENTRY_NUM ASSOCIATE_ENTRY_NUM +#elif(DM_ODM_SUPPORT_TYPE & (ODM_AP)) + #define ASSOCIATE_ENTRY_NUM NUM_STAT + #define ODM_ASSOCIATE_ENTRY_NUM (ASSOCIATE_ENTRY_NUM+1) +#else + #define ODM_ASSOCIATE_ENTRY_NUM ((ASSOCIATE_ENTRY_NUM*3)+1) +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + #define RX_SMOOTH_FACTOR 20 +#endif + +/* -----MGN rate--------------------------------- */ + +enum ODM_MGN_RATE { + ODM_MGN_1M = 0x02, + ODM_MGN_2M = 0x04, + ODM_MGN_5_5M = 0x0B, + ODM_MGN_6M = 0x0C, + ODM_MGN_9M = 0x12, + ODM_MGN_11M = 0x16, + ODM_MGN_12M = 0x18, + ODM_MGN_18M = 0x24, + ODM_MGN_24M = 0x30, + ODM_MGN_36M = 0x48, + ODM_MGN_48M = 0x60, + ODM_MGN_54M = 0x6C, + ODM_MGN_MCS32 = 0x7F, + ODM_MGN_MCS0 = 0x80, + ODM_MGN_MCS1, + ODM_MGN_MCS2, + ODM_MGN_MCS3, + ODM_MGN_MCS4, + ODM_MGN_MCS5, + ODM_MGN_MCS6, + ODM_MGN_MCS7 = 0x87, + ODM_MGN_MCS8, + ODM_MGN_MCS9, + ODM_MGN_MCS10, + ODM_MGN_MCS11, + ODM_MGN_MCS12, + ODM_MGN_MCS13, + ODM_MGN_MCS14, + ODM_MGN_MCS15, + ODM_MGN_MCS16 = 0x90, + ODM_MGN_MCS17, + ODM_MGN_MCS18, + ODM_MGN_MCS19, + ODM_MGN_MCS20, + ODM_MGN_MCS21, + ODM_MGN_MCS22, + ODM_MGN_MCS23, + ODM_MGN_MCS24 = 0x98, + ODM_MGN_MCS25, + ODM_MGN_MCS26, + ODM_MGN_MCS27, + ODM_MGN_MCS28, + ODM_MGN_MCS29, + ODM_MGN_MCS30, + ODM_MGN_MCS31, + ODM_MGN_VHT1SS_MCS0 = 0xa0, + ODM_MGN_VHT1SS_MCS1, + ODM_MGN_VHT1SS_MCS2, + ODM_MGN_VHT1SS_MCS3, + ODM_MGN_VHT1SS_MCS4, + ODM_MGN_VHT1SS_MCS5, + ODM_MGN_VHT1SS_MCS6, + ODM_MGN_VHT1SS_MCS7, + ODM_MGN_VHT1SS_MCS8, + ODM_MGN_VHT1SS_MCS9, + ODM_MGN_VHT2SS_MCS0 = 0xaa, + ODM_MGN_VHT2SS_MCS1 = 0xab, + ODM_MGN_VHT2SS_MCS2, + ODM_MGN_VHT2SS_MCS3, + ODM_MGN_VHT2SS_MCS4, + ODM_MGN_VHT2SS_MCS5 = 0xaf, + ODM_MGN_VHT2SS_MCS6 = 0xb0, + ODM_MGN_VHT2SS_MCS7, + ODM_MGN_VHT2SS_MCS8, + ODM_MGN_VHT2SS_MCS9 = 0xb3, + ODM_MGN_VHT3SS_MCS0 = 0xb4, + ODM_MGN_VHT3SS_MCS1, + ODM_MGN_VHT3SS_MCS2, + ODM_MGN_VHT3SS_MCS3, + ODM_MGN_VHT3SS_MCS4, + ODM_MGN_VHT3SS_MCS5, + ODM_MGN_VHT3SS_MCS6, + ODM_MGN_VHT3SS_MCS7 = 0xbb, + ODM_MGN_VHT3SS_MCS8 = 0xbc, + ODM_MGN_VHT3SS_MCS9 = 0xbd, + ODM_MGN_VHT4SS_MCS0 = 0xbe, + ODM_MGN_VHT4SS_MCS1, + ODM_MGN_VHT4SS_MCS2, + ODM_MGN_VHT4SS_MCS3, + ODM_MGN_VHT4SS_MCS4, + ODM_MGN_VHT4SS_MCS5, + ODM_MGN_VHT4SS_MCS6, + ODM_MGN_VHT4SS_MCS7, + ODM_MGN_VHT4SS_MCS8, + ODM_MGN_VHT4SS_MCS9 = 0xc7, + ODM_MGN_UNKNOWN }; - -#define ODM_MGN_MCS0_SG 0xc0 -#define ODM_MGN_MCS1_SG 0xc1 -#define ODM_MGN_MCS2_SG 0xc2 -#define ODM_MGN_MCS3_SG 0xc3 -#define ODM_MGN_MCS4_SG 0xc4 -#define ODM_MGN_MCS5_SG 0xc5 -#define ODM_MGN_MCS6_SG 0xc6 -#define ODM_MGN_MCS7_SG 0xc7 -#define ODM_MGN_MCS8_SG 0xc8 -#define ODM_MGN_MCS9_SG 0xc9 -#define ODM_MGN_MCS10_SG 0xca -#define ODM_MGN_MCS11_SG 0xcb -#define ODM_MGN_MCS12_SG 0xcc -#define ODM_MGN_MCS13_SG 0xcd -#define ODM_MGN_MCS14_SG 0xce -#define ODM_MGN_MCS15_SG 0xcf - -/* -----DESC rate--------------------------------- */ - -#define ODM_RATEMCS15_SG 0x1c -#define ODM_RATEMCS32 0x20 - - -// CCK Rates, TxHT = 0 -#define ODM_RATE1M 0x00 -#define ODM_RATE2M 0x01 -#define ODM_RATE5_5M 0x02 -#define ODM_RATE11M 0x03 -// OFDM Rates, TxHT = 0 -#define ODM_RATE6M 0x04 -#define ODM_RATE9M 0x05 -#define ODM_RATE12M 0x06 -#define ODM_RATE18M 0x07 -#define ODM_RATE24M 0x08 -#define ODM_RATE36M 0x09 -#define ODM_RATE48M 0x0A -#define ODM_RATE54M 0x0B -// MCS Rates, TxHT = 1 -#define ODM_RATEMCS0 0x0C -#define ODM_RATEMCS1 0x0D -#define ODM_RATEMCS2 0x0E -#define ODM_RATEMCS3 0x0F -#define ODM_RATEMCS4 0x10 -#define ODM_RATEMCS5 0x11 -#define ODM_RATEMCS6 0x12 -#define ODM_RATEMCS7 0x13 -#define ODM_RATEMCS8 0x14 -#define ODM_RATEMCS9 0x15 -#define ODM_RATEMCS10 0x16 -#define ODM_RATEMCS11 0x17 -#define ODM_RATEMCS12 0x18 -#define ODM_RATEMCS13 0x19 -#define ODM_RATEMCS14 0x1A -#define ODM_RATEMCS15 0x1B -#define ODM_RATEMCS16 0x1C -#define ODM_RATEMCS17 0x1D -#define ODM_RATEMCS18 0x1E -#define ODM_RATEMCS19 0x1F -#define ODM_RATEMCS20 0x20 -#define ODM_RATEMCS21 0x21 -#define ODM_RATEMCS22 0x22 -#define ODM_RATEMCS23 0x23 -#define ODM_RATEMCS24 0x24 -#define ODM_RATEMCS25 0x25 -#define ODM_RATEMCS26 0x26 -#define ODM_RATEMCS27 0x27 -#define ODM_RATEMCS28 0x28 -#define ODM_RATEMCS29 0x29 -#define ODM_RATEMCS30 0x2A -#define ODM_RATEMCS31 0x2B -#define ODM_RATEVHTSS1MCS0 0x2C -#define ODM_RATEVHTSS1MCS1 0x2D -#define ODM_RATEVHTSS1MCS2 0x2E -#define ODM_RATEVHTSS1MCS3 0x2F -#define ODM_RATEVHTSS1MCS4 0x30 -#define ODM_RATEVHTSS1MCS5 0x31 -#define ODM_RATEVHTSS1MCS6 0x32 -#define ODM_RATEVHTSS1MCS7 0x33 -#define ODM_RATEVHTSS1MCS8 0x34 -#define ODM_RATEVHTSS1MCS9 0x35 -#define ODM_RATEVHTSS2MCS0 0x36 -#define ODM_RATEVHTSS2MCS1 0x37 -#define ODM_RATEVHTSS2MCS2 0x38 -#define ODM_RATEVHTSS2MCS3 0x39 -#define ODM_RATEVHTSS2MCS4 0x3A -#define ODM_RATEVHTSS2MCS5 0x3B -#define ODM_RATEVHTSS2MCS6 0x3C -#define ODM_RATEVHTSS2MCS7 0x3D -#define ODM_RATEVHTSS2MCS8 0x3E -#define ODM_RATEVHTSS2MCS9 0x3F -#define ODM_RATEVHTSS3MCS0 0x40 -#define ODM_RATEVHTSS3MCS1 0x41 -#define ODM_RATEVHTSS3MCS2 0x42 -#define ODM_RATEVHTSS3MCS3 0x43 -#define ODM_RATEVHTSS3MCS4 0x44 -#define ODM_RATEVHTSS3MCS5 0x45 -#define ODM_RATEVHTSS3MCS6 0x46 -#define ODM_RATEVHTSS3MCS7 0x47 -#define ODM_RATEVHTSS3MCS8 0x48 -#define ODM_RATEVHTSS3MCS9 0x49 -#define ODM_RATEVHTSS4MCS0 0x4A -#define ODM_RATEVHTSS4MCS1 0x4B -#define ODM_RATEVHTSS4MCS2 0x4C -#define ODM_RATEVHTSS4MCS3 0x4D -#define ODM_RATEVHTSS4MCS4 0x4E -#define ODM_RATEVHTSS4MCS5 0x4F -#define ODM_RATEVHTSS4MCS6 0x50 -#define ODM_RATEVHTSS4MCS7 0x51 -#define ODM_RATEVHTSS4MCS8 0x52 -#define ODM_RATEVHTSS4MCS9 0x53 - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) -#else - #if (RTL8192E_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) - #define ODM_NUM_RATE_IDX (ODM_RATEMCS15+1) - #elif (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) - #define ODM_NUM_RATE_IDX (ODM_RATEMCS7+1) - #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) - #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS1MCS9+1) - #elif (RTL8812A_SUPPORT == 1) - #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS2MCS9+1) - #elif(RTL8814A_SUPPORT == 1) - #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS3MCS9+1) - #else - #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) - #endif -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#define CONFIG_SFW_SUPPORTED -#endif - -//1 ============================================================ -//1 enumeration -//1 ============================================================ - - -// ODM_CMNINFO_INTERFACE -typedef enum tag_ODM_Support_Interface_Definition -{ - ODM_ITRF_PCIE = 0x1, - ODM_ITRF_USB = 0x2, - ODM_ITRF_SDIO = 0x4, - ODM_ITRF_ALL = 0x7, -}ODM_INTERFACE_E; - -// ODM_CMNINFO_IC_TYPE -typedef enum tag_ODM_Support_IC_Type_Definition -{ - ODM_RTL8188E = BIT0, - ODM_RTL8812 = BIT1, - ODM_RTL8821 = BIT2, - ODM_RTL8192E = BIT3, - ODM_RTL8723B = BIT4, - ODM_RTL8814A = BIT5, - ODM_RTL8881A = BIT6, - ODM_RTL8822B = BIT7, - ODM_RTL8703B = BIT8, - ODM_RTL8195A = BIT9, - ODM_RTL8188F = BIT10, - ODM_RTL8723D = BIT11, - ODM_RTL8197F = BIT12, - ODM_RTL8821C = BIT13, - ODM_RTL8814B = BIT14, - ODM_RTL8198F = BIT15 -}ODM_IC_TYPE_E; - - -#define ODM_IC_1SS (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8723B | ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8821C | ODM_RTL8195A) -#define ODM_IC_2SS (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8812 | ODM_RTL8822B) -#define ODM_IC_3SS (ODM_RTL8814A) -#define ODM_IC_4SS (ODM_RTL8814B | ODM_RTL8198F) - - -#define ODM_IC_11N_SERIES (ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8197F) -#define ODM_IC_11AC_SERIES (ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8822B|ODM_RTL8821C) -#define ODM_IC_11AC_1_SERIES (ODM_RTL8812|ODM_RTL8821|ODM_RTL8881A) -#define ODM_IC_11AC_2_SERIES (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8821C) -#define ODM_IC_TXBF_SUPPORT (ODM_RTL8192E|ODM_RTL8812|ODM_RTL8821|ODM_RTL8814A|ODM_RTL8881A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) -#define ODM_IC_11N_GAIN_IDX_EDCCA (ODM_RTL8195A|ODM_RTL8703B|ODM_RTL8188F|ODM_RTL8723D|ODM_RTL8197F) -#define ODM_IC_11AC_GAIN_IDX_EDCCA (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8821C) -#define ODM_IC_PHY_STATUE_NEW_TYPE (ODM_RTL8197F|ODM_RTL8822B|ODM_RTL8723D|ODM_RTL8821C) - -#define PHYDM_IC_8051_SERIES (ODM_RTL8881A|ODM_RTL8812|ODM_RTL8821|ODM_RTL8188E|ODM_RTL8192E|ODM_RTL8723B|ODM_RTL8703B|ODM_RTL8188F) -#define PHYDM_IC_3081_SERIES (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) - -#define PHYDM_IC_SUPPORT_LA_MODE (ODM_RTL8814A|ODM_RTL8822B|ODM_RTL8197F|ODM_RTL8821C) - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - -#ifdef RTK_AC_SUPPORT -#define ODM_IC_11AC_SERIES_SUPPORT 1 -#else -#define ODM_IC_11AC_SERIES_SUPPORT 0 -#endif - -#define ODM_IC_11N_SERIES_SUPPORT 1 -#define ODM_CONFIG_BT_COEXIST 0 - -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -#define ODM_IC_11AC_SERIES_SUPPORT 1 -#define ODM_IC_11N_SERIES_SUPPORT 1 -#define ODM_CONFIG_BT_COEXIST 1 - -#else - -#if ((RTL8188E_SUPPORT == 1) || \ -(RTL8723B_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8195A_SUPPORT == 1) || (RTL8703B_SUPPORT == 1) || \ -(RTL8188F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -#define ODM_IC_11N_SERIES_SUPPORT 1 -#define ODM_IC_11AC_SERIES_SUPPORT 0 -#else -#define ODM_IC_11N_SERIES_SUPPORT 0 -#define ODM_IC_11AC_SERIES_SUPPORT 1 -#endif - -#ifdef CONFIG_BT_COEXIST -#define ODM_CONFIG_BT_COEXIST 1 -#else -#define ODM_CONFIG_BT_COEXIST 0 -#endif - -#endif - -#if ((RTL8814A_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1)) -#define PHYDM_LA_MODE_SUPPORT 1 -#else -#define PHYDM_LA_MODE_SUPPORT 0 -#endif - -#if ((RTL8197F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) -#define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 1 -#else -#define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 0 -#endif - -//ODM_CMNINFO_CUT_VER -typedef enum tag_ODM_Cut_Version_Definition -{ - ODM_CUT_A = 0, - ODM_CUT_B = 1, - ODM_CUT_C = 2, - ODM_CUT_D = 3, - ODM_CUT_E = 4, - ODM_CUT_F = 5, - - ODM_CUT_I = 8, - ODM_CUT_J = 9, - ODM_CUT_K = 10, - ODM_CUT_TEST = 15, -}ODM_CUT_VERSION_E; - -// ODM_CMNINFO_FAB_VER -typedef enum tag_ODM_Fab_Version_Definition -{ - ODM_TSMC = 0, - ODM_UMC = 1, -}ODM_FAB_E; - -// ODM_CMNINFO_RF_TYPE -// -// For example 1T2R (A+AB = BIT0|BIT4|BIT5) -// -typedef enum tag_ODM_RF_Path_Bit_Definition -{ - ODM_RF_A = BIT0, - ODM_RF_B = BIT1, - ODM_RF_C = BIT2, - ODM_RF_D = BIT3, -}ODM_RF_PATH_E; - -typedef enum tag_PHYDM_RF_TX_NUM { - ODM_1T = 1, - ODM_2T = 2, - ODM_3T = 3, - ODM_4T = 4, -} ODM_RF_TX_NUM_E; - -typedef enum tag_ODM_RF_Type_Definition { - ODM_1T1R, - ODM_1T2R, - ODM_2T2R, - ODM_2T2R_GREEN, - ODM_2T3R, - ODM_2T4R, - ODM_3T3R, - ODM_3T4R, - ODM_4T4R, - ODM_XTXR -}ODM_RF_TYPE_E; - - -typedef enum tag_ODM_MAC_PHY_Mode_Definition -{ - ODM_SMSP = 0, - ODM_DMSP = 1, - ODM_DMDP = 2, -}ODM_MAC_PHY_MODE_E; - - -typedef enum tag_BT_Coexist_Definition -{ - ODM_BT_BUSY = 1, - ODM_BT_ON = 2, - ODM_BT_OFF = 3, - ODM_BT_NONE = 4, -}ODM_BT_COEXIST_E; - -// ODM_CMNINFO_OP_MODE -typedef enum tag_Operation_Mode_Definition -{ - ODM_NO_LINK = BIT0, - ODM_LINK = BIT1, - ODM_SCAN = BIT2, - ODM_POWERSAVE = BIT3, - ODM_AP_MODE = BIT4, - ODM_CLIENT_MODE = BIT5, - ODM_AD_HOC = BIT6, - ODM_WIFI_DIRECT = BIT7, - ODM_WIFI_DISPLAY = BIT8, -}ODM_OPERATION_MODE_E; - -// ODM_CMNINFO_WM_MODE -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -typedef enum tag_Wireless_Mode_Definition -{ - ODM_WM_UNKNOW = 0x0, - ODM_WM_B = BIT0, - ODM_WM_G = BIT1, - ODM_WM_A = BIT2, - ODM_WM_N24G = BIT3, - ODM_WM_N5G = BIT4, - ODM_WM_AUTO = BIT5, - ODM_WM_AC = BIT6, -}ODM_WIRELESS_MODE_E; -#else -typedef enum tag_Wireless_Mode_Definition -{ - ODM_WM_UNKNOWN = 0x00,/*0x0*/ - ODM_WM_A = BIT0, /* 0x1*/ - ODM_WM_B = BIT1, /* 0x2*/ - ODM_WM_G = BIT2,/* 0x4*/ - ODM_WM_AUTO = BIT3,/* 0x8*/ - ODM_WM_N24G = BIT4,/* 0x10*/ - ODM_WM_N5G = BIT5,/* 0x20*/ - ODM_WM_AC_5G = BIT6,/* 0x40*/ - ODM_WM_AC_24G = BIT7,/* 0x80*/ - ODM_WM_AC_ONLY = BIT8,/* 0x100*/ - ODM_WM_MAX = BIT11/* 0x800*/ - -}ODM_WIRELESS_MODE_E; -#endif - -// ODM_CMNINFO_BAND -typedef enum tag_Band_Type_Definition -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - ODM_BAND_2_4G = BIT0, - ODM_BAND_5G = BIT1, -#else - ODM_BAND_2_4G = 0, - ODM_BAND_5G, - ODM_BAND_ON_BOTH, - ODM_BANDMAX -#endif -}ODM_BAND_TYPE_E; - - -// ODM_CMNINFO_SEC_CHNL_OFFSET -typedef enum tag_Secondary_Channel_Offset_Definition { - - PHYDM_DONT_CARE = 0, - PHYDM_BELOW = 1, - PHYDM_ABOVE = 2 -} PHYDM_SEC_CHNL_OFFSET_E; - -// ODM_CMNINFO_SEC_MODE -typedef enum tag_Security_Definition -{ - ODM_SEC_OPEN = 0, - ODM_SEC_WEP40 = 1, - ODM_SEC_TKIP = 2, - ODM_SEC_RESERVE = 3, - ODM_SEC_AESCCMP = 4, - ODM_SEC_WEP104 = 5, - ODM_WEP_WPA_MIXED = 6, // WEP + WPA - ODM_SEC_SMS4 = 7, -}ODM_SECURITY_E; - -// ODM_CMNINFO_BW -typedef enum tag_Bandwidth_Definition -{ - ODM_BW20M = 0, - ODM_BW40M = 1, - ODM_BW80M = 2, - ODM_BW160M = 3, - ODM_BW5M = 4, - ODM_BW10M = 5, - ODM_BW_MAX = 6 -}ODM_BW_E; - -// ODM_CMNINFO_CHNL - -// ODM_CMNINFO_BOARD_TYPE -typedef enum tag_Board_Definition -{ - ODM_BOARD_DEFAULT = 0, // The DEFAULT case. - ODM_BOARD_MINICARD = BIT(0), // 0 = non-mini card, 1= mini card. - ODM_BOARD_SLIM = BIT(1), // 0 = non-slim card, 1 = slim card - ODM_BOARD_BT = BIT(2), // 0 = without BT card, 1 = with BT - ODM_BOARD_EXT_PA = BIT(3), // 0 = no 2G ext-PA, 1 = existing 2G ext-PA - ODM_BOARD_EXT_LNA = BIT(4), // 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA - ODM_BOARD_EXT_TRSW = BIT(5), // 0 = no ext-TRSW, 1 = existing ext-TRSW - ODM_BOARD_EXT_PA_5G = BIT(6), // 0 = no 5G ext-PA, 1 = existing 5G ext-PA - ODM_BOARD_EXT_LNA_5G= BIT(7), // 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA -}ODM_BOARD_TYPE_E; - -typedef enum tag_ODM_Package_Definition -{ - ODM_PACKAGE_DEFAULT = 0, - ODM_PACKAGE_QFN68 = BIT(0), - ODM_PACKAGE_TFBGA90 = BIT(1), - ODM_PACKAGE_TFBGA79 = BIT(2), -}ODM_Package_TYPE_E; - -typedef enum tag_ODM_TYPE_GPA_Definition { - TYPE_GPA0 = 0x0000, - TYPE_GPA1 = 0x0055, - TYPE_GPA2 = 0x00AA, - TYPE_GPA3 = 0x00FF, - TYPE_GPA4 = 0x5500, - TYPE_GPA5 = 0x5555, - TYPE_GPA6 = 0x55AA, - TYPE_GPA7 = 0x55FF, - TYPE_GPA8 = 0xAA00, - TYPE_GPA9 = 0xAA55, - TYPE_GPA10 = 0xAAAA, - TYPE_GPA11 = 0xAAFF, - TYPE_GPA12 = 0xFF00, - TYPE_GPA13 = 0xFF55, - TYPE_GPA14 = 0xFFAA, - TYPE_GPA15 = 0xFFFF, -}ODM_TYPE_GPA_E; - -typedef enum tag_ODM_TYPE_APA_Definition { - TYPE_APA0 = 0x0000, - TYPE_APA1 = 0x0055, - TYPE_APA2 = 0x00AA, - TYPE_APA3 = 0x00FF, - TYPE_APA4 = 0x5500, - TYPE_APA5 = 0x5555, - TYPE_APA6 = 0x55AA, - TYPE_APA7 = 0x55FF, - TYPE_APA8 = 0xAA00, - TYPE_APA9 = 0xAA55, - TYPE_APA10 = 0xAAAA, - TYPE_APA11 = 0xAAFF, - TYPE_APA12 = 0xFF00, - TYPE_APA13 = 0xFF55, - TYPE_APA14 = 0xFFAA, - TYPE_APA15 = 0xFFFF, -}ODM_TYPE_APA_E; - -typedef enum tag_ODM_TYPE_GLNA_Definition { - TYPE_GLNA0 = 0x0000, - TYPE_GLNA1 = 0x0055, - TYPE_GLNA2 = 0x00AA, - TYPE_GLNA3 = 0x00FF, - TYPE_GLNA4 = 0x5500, - TYPE_GLNA5 = 0x5555, - TYPE_GLNA6 = 0x55AA, - TYPE_GLNA7 = 0x55FF, - TYPE_GLNA8 = 0xAA00, - TYPE_GLNA9 = 0xAA55, - TYPE_GLNA10 = 0xAAAA, - TYPE_GLNA11 = 0xAAFF, - TYPE_GLNA12 = 0xFF00, - TYPE_GLNA13 = 0xFF55, - TYPE_GLNA14 = 0xFFAA, - TYPE_GLNA15 = 0xFFFF, -}ODM_TYPE_GLNA_E; - -typedef enum tag_ODM_TYPE_ALNA_Definition { - TYPE_ALNA0 = 0x0000, - TYPE_ALNA1 = 0x0055, - TYPE_ALNA2 = 0x00AA, - TYPE_ALNA3 = 0x00FF, - TYPE_ALNA4 = 0x5500, - TYPE_ALNA5 = 0x5555, - TYPE_ALNA6 = 0x55AA, - TYPE_ALNA7 = 0x55FF, - TYPE_ALNA8 = 0xAA00, - TYPE_ALNA9 = 0xAA55, - TYPE_ALNA10 = 0xAAAA, - TYPE_ALNA11 = 0xAAFF, - TYPE_ALNA12 = 0xFF00, - TYPE_ALNA13 = 0xFF55, - TYPE_ALNA14 = 0xFFAA, - TYPE_ALNA15 = 0xFFFF, -}ODM_TYPE_ALNA_E; - - -typedef enum _ODM_RF_RADIO_PATH { - ODM_RF_PATH_A = 0, //Radio Path A - ODM_RF_PATH_B = 1, //Radio Path B - ODM_RF_PATH_C = 2, //Radio Path C - ODM_RF_PATH_D = 3, //Radio Path D - ODM_RF_PATH_AB, - ODM_RF_PATH_AC, - ODM_RF_PATH_AD, - ODM_RF_PATH_BC, - ODM_RF_PATH_BD, - ODM_RF_PATH_CD, - ODM_RF_PATH_ABC, - ODM_RF_PATH_ACD, - ODM_RF_PATH_BCD, - ODM_RF_PATH_ABCD, - // ODM_RF_PATH_MAX, //Max RF number 90 support -} ODM_RF_RADIO_PATH_E, *PODM_RF_RADIO_PATH_E; - -typedef enum _ODM_PARAMETER_INIT { - ODM_PRE_SETTING = 0, - ODM_POST_SETTING = 1, -} ODM_PARAMETER_INIT_E; - -#endif + +#define ODM_MGN_MCS0_SG 0xc0 +#define ODM_MGN_MCS1_SG 0xc1 +#define ODM_MGN_MCS2_SG 0xc2 +#define ODM_MGN_MCS3_SG 0xc3 +#define ODM_MGN_MCS4_SG 0xc4 +#define ODM_MGN_MCS5_SG 0xc5 +#define ODM_MGN_MCS6_SG 0xc6 +#define ODM_MGN_MCS7_SG 0xc7 +#define ODM_MGN_MCS8_SG 0xc8 +#define ODM_MGN_MCS9_SG 0xc9 +#define ODM_MGN_MCS10_SG 0xca +#define ODM_MGN_MCS11_SG 0xcb +#define ODM_MGN_MCS12_SG 0xcc +#define ODM_MGN_MCS13_SG 0xcd +#define ODM_MGN_MCS14_SG 0xce +#define ODM_MGN_MCS15_SG 0xcf + +/* -----DESC rate--------------------------------- */ + +#define ODM_RATEMCS15_SG 0x1c +#define ODM_RATEMCS32 0x20 + + +enum phydm_ctrl_info_rate { + ODM_RATE1M = 0x00, + ODM_RATE2M = 0x01, + ODM_RATE5_5M = 0x02, + ODM_RATE11M = 0x03, +/* OFDM Rates, TxHT = 0 */ + ODM_RATE6M = 0x04, + ODM_RATE9M = 0x05, + ODM_RATE12M = 0x06, + ODM_RATE18M = 0x07, + ODM_RATE24M = 0x08, + ODM_RATE36M = 0x09, + ODM_RATE48M = 0x0A, + ODM_RATE54M = 0x0B, +/* MCS Rates, TxHT = 1 */ + ODM_RATEMCS0 = 0x0C, + ODM_RATEMCS1 = 0x0D, + ODM_RATEMCS2 = 0x0E, + ODM_RATEMCS3 = 0x0F, + ODM_RATEMCS4 = 0x10, + ODM_RATEMCS5 = 0x11, + ODM_RATEMCS6 = 0x12, + ODM_RATEMCS7 = 0x13, + ODM_RATEMCS8 = 0x14, + ODM_RATEMCS9 = 0x15, + ODM_RATEMCS10 = 0x16, + ODM_RATEMCS11 = 0x17, + ODM_RATEMCS12 = 0x18, + ODM_RATEMCS13 = 0x19, + ODM_RATEMCS14 = 0x1A, + ODM_RATEMCS15 = 0x1B, + ODM_RATEMCS16 = 0x1C, + ODM_RATEMCS17 = 0x1D, + ODM_RATEMCS18 = 0x1E, + ODM_RATEMCS19 = 0x1F, + ODM_RATEMCS20 = 0x20, + ODM_RATEMCS21 = 0x21, + ODM_RATEMCS22 = 0x22, + ODM_RATEMCS23 = 0x23, + ODM_RATEMCS24 = 0x24, + ODM_RATEMCS25 = 0x25, + ODM_RATEMCS26 = 0x26, + ODM_RATEMCS27 = 0x27, + ODM_RATEMCS28 = 0x28, + ODM_RATEMCS29 = 0x29, + ODM_RATEMCS30 = 0x2A, + ODM_RATEMCS31 = 0x2B, + ODM_RATEVHTSS1MCS0 = 0x2C, + ODM_RATEVHTSS1MCS1 = 0x2D, + ODM_RATEVHTSS1MCS2 = 0x2E, + ODM_RATEVHTSS1MCS3 = 0x2F, + ODM_RATEVHTSS1MCS4 = 0x30, + ODM_RATEVHTSS1MCS5 = 0x31, + ODM_RATEVHTSS1MCS6 = 0x32, + ODM_RATEVHTSS1MCS7 = 0x33, + ODM_RATEVHTSS1MCS8 = 0x34, + ODM_RATEVHTSS1MCS9 = 0x35, + ODM_RATEVHTSS2MCS0 = 0x36, + ODM_RATEVHTSS2MCS1 = 0x37, + ODM_RATEVHTSS2MCS2 = 0x38, + ODM_RATEVHTSS2MCS3 = 0x39, + ODM_RATEVHTSS2MCS4 = 0x3A, + ODM_RATEVHTSS2MCS5 = 0x3B, + ODM_RATEVHTSS2MCS6 = 0x3C, + ODM_RATEVHTSS2MCS7 = 0x3D, + ODM_RATEVHTSS2MCS8 = 0x3E, + ODM_RATEVHTSS2MCS9 = 0x3F, + ODM_RATEVHTSS3MCS0 = 0x40, + ODM_RATEVHTSS3MCS1 = 0x41, + ODM_RATEVHTSS3MCS2 = 0x42, + ODM_RATEVHTSS3MCS3 = 0x43, + ODM_RATEVHTSS3MCS4 = 0x44, + ODM_RATEVHTSS3MCS5 = 0x45, + ODM_RATEVHTSS3MCS6 = 0x46, + ODM_RATEVHTSS3MCS7 = 0x47, + ODM_RATEVHTSS3MCS8 = 0x48, + ODM_RATEVHTSS3MCS9 = 0x49, + ODM_RATEVHTSS4MCS0 = 0x4A, + ODM_RATEVHTSS4MCS1 = 0x4B, + ODM_RATEVHTSS4MCS2 = 0x4C, + ODM_RATEVHTSS4MCS3 = 0x4D, + ODM_RATEVHTSS4MCS4 = 0x4E, + ODM_RATEVHTSS4MCS5 = 0x4F, + ODM_RATEVHTSS4MCS6 = 0x50, + ODM_RATEVHTSS4MCS7 = 0x51, + ODM_RATEVHTSS4MCS8 = 0x52, + ODM_RATEVHTSS4MCS9 = 0x53, +}; + +#define CCK_RATE_NUM 4 +#define OFDM_RATE_NUM 8 + +#define LEGACY_RATE_NUM 12 + +#define HT_RATE_NUM 32 +#define VHT_RATE_NUM 40 + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) +#else + #if (RTL8192E_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) + #define ODM_NUM_RATE_IDX (ODM_RATEMCS15+1) + #elif (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) + #define ODM_NUM_RATE_IDX (ODM_RATEMCS7+1) + #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) + #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS1MCS9+1) + #elif (RTL8812A_SUPPORT == 1) + #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS2MCS9+1) + #elif (RTL8814A_SUPPORT == 1) + #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS3MCS9+1) + #else + #define ODM_NUM_RATE_IDX (ODM_RATEVHTSS4MCS9+1) + #endif +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define CONFIG_SFW_SUPPORTED +#endif + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + + +/* ODM_CMNINFO_INTERFACE */ +enum odm_interface_e { + ODM_ITRF_PCIE = 0x1, + ODM_ITRF_USB = 0x2, + ODM_ITRF_SDIO = 0x4, + ODM_ITRF_ALL = 0x7, +}; + + +enum phydm_ic_e { + ODM_RTL8188E = BIT(0), + ODM_RTL8812 = BIT(1), + ODM_RTL8821 = BIT(2), + ODM_RTL8192E = BIT(3), + ODM_RTL8723B = BIT(4), + ODM_RTL8814A = BIT(5), + ODM_RTL8881A = BIT(6), + ODM_RTL8822B = BIT(7), + ODM_RTL8703B = BIT(8), + ODM_RTL8195A = BIT(9), + ODM_RTL8188F = BIT(10), + ODM_RTL8723D = BIT(11), + ODM_RTL8197F = BIT(12), + ODM_RTL8821C = BIT(13), + ODM_RTL8814B = BIT(14), + ODM_RTL8198F = BIT(15), + ODM_RTL8710B = BIT(16), + ODM_RTL8192F = BIT(17), + ODM_RTL8822C = BIT(18) +}; + +/*========[Run time IC flag] ===============================================================================]*/ + +#define ODM_IC_N_1SS (ODM_RTL8188E | ODM_RTL8188F | ODM_RTL8723B | ODM_RTL8703B | ODM_RTL8723D | ODM_RTL8195A | ODM_RTL8710B) +#define ODM_IC_N_2SS (ODM_RTL8192E | ODM_RTL8197F | ODM_RTL8192F) +#define ODM_IC_N_3SS 0 +#define ODM_IC_N_4SS (ODM_RTL8198F) + +#define ODM_IC_AC_1SS (ODM_RTL8881A | ODM_RTL8821 | ODM_RTL8821C) +#define ODM_IC_AC_2SS (ODM_RTL8812 | ODM_RTL8822B | ODM_RTL8822C) +#define ODM_IC_AC_3SS 0 +#define ODM_IC_AC_4SS (ODM_RTL8814A | ODM_RTL8814B) + +/*====the following macro DO NOT need to update when add a new IC======= */ +#define ODM_IC_1SS (ODM_IC_N_1SS | ODM_IC_AC_1SS) +#define ODM_IC_2SS (ODM_IC_N_2SS | ODM_IC_AC_2SS) +#define ODM_IC_3SS (ODM_IC_N_3SS | ODM_IC_AC_3SS) +#define ODM_IC_4SS (ODM_IC_N_4SS | ODM_IC_AC_4SS) + +#define PHYDM_IC_ABOVE_1SS (ODM_IC_1SS | ODM_IC_2SS | ODM_IC_3SS | ODM_IC_4SS) +#define PHYDM_IC_ABOVE_2SS (ODM_IC_2SS | ODM_IC_3SS | ODM_IC_4SS) +#define PHYDM_IC_ABOVE_3SS (ODM_IC_3SS | ODM_IC_4SS) +#define PHYDM_IC_ABOVE_4SS ODM_IC_4SS + +#define ODM_IC_11N_SERIES (ODM_IC_N_1SS | ODM_IC_N_2SS | ODM_IC_N_3SS | ODM_IC_N_4SS) +#define ODM_IC_11AC_SERIES (ODM_IC_AC_1SS | ODM_IC_AC_2SS | ODM_IC_AC_3SS | ODM_IC_AC_4SS) +/*====================================================*/ + +#define ODM_IC_11AC_1_SERIES (ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8881A) +#define ODM_IC_11AC_2_SERIES (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C) + +#define ODM_IC_TXBF_SUPPORT (ODM_RTL8192E | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8814A | ODM_RTL8881A | ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C) + +#define ODM_IC_11N_GAIN_IDX_EDCCA (ODM_RTL8195A | ODM_RTL8703B | ODM_RTL8188F | ODM_RTL8723D | ODM_RTL8197F | ODM_RTL8710B) +#define ODM_IC_11AC_GAIN_IDX_EDCCA (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8821C) +#define ODM_IC_GAIN_IDX_EDCCA (ODM_IC_11N_GAIN_IDX_EDCCA | ODM_IC_11AC_GAIN_IDX_EDCCA) + +#define ODM_IC_PHY_STATUE_NEW_TYPE (ODM_RTL8197F | ODM_RTL8822B | ODM_RTL8723D | ODM_RTL8821C | ODM_RTL8710B) + +#define PHYDM_IC_8051_SERIES (ODM_RTL8881A | ODM_RTL8812 | ODM_RTL8821 | ODM_RTL8192E | ODM_RTL8723B | ODM_RTL8703B | ODM_RTL8188F) +#define PHYDM_IC_3081_SERIES (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C) + +#define PHYDM_IC_SUPPORT_LA_MODE (ODM_RTL8814A | ODM_RTL8822B | ODM_RTL8197F | ODM_RTL8821C) +#define PHYDM_IC_SUPPORT_MU_BFEE (ODM_RTL8822B | ODM_RTL8821C | ODM_RTL8814B) +#define PHYDM_IC_SUPPORT_MU_BFER (ODM_RTL8822B | ODM_RTL8814B) + + +/*========[Compile time IC flag] ===============================================================================]*/ +/*========[AC/N Support] ===========================*/ +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + + #ifdef RTK_AC_SUPPORT + #define ODM_IC_11AC_SERIES_SUPPORT 1 + #else + #define ODM_IC_11AC_SERIES_SUPPORT 0 + #endif + + #define ODM_IC_11N_SERIES_SUPPORT 1 + +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + + #define ODM_IC_11AC_SERIES_SUPPORT 1 + #define ODM_IC_11N_SERIES_SUPPORT 1 + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + + #define ODM_IC_11AC_SERIES_SUPPORT 1 + #define ODM_IC_11N_SERIES_SUPPORT 1 + +#else /*ODM_CE*/ + + #if ((RTL8188E_SUPPORT == 1) || \ + (RTL8723B_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) || (RTL8195A_SUPPORT == 1) || (RTL8703B_SUPPORT == 1) || \ + (RTL8188F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8710B_SUPPORT == 1)) + #define ODM_IC_11N_SERIES_SUPPORT 1 + #define ODM_IC_11AC_SERIES_SUPPORT 0 + #else + #define ODM_IC_11N_SERIES_SUPPORT 0 + #define ODM_IC_11AC_SERIES_SUPPORT 1 + #endif +#endif + +/*===IC SS Compile Flag, prepare for code size reduction==============*/ +#if ((RTL8188E_SUPPORT == 1) || (RTL8188F_SUPPORT == 1) || (RTL8723B_SUPPORT == 1) || (RTL8703B_SUPPORT == 1) ||\ + (RTL8723D_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) ||\ + (RTL8195A_SUPPORT == 1) || (RTL8710B_SUPPORT == 1)) + + #define PHYDM_COMPILE_IC_1SS +#endif + +#if ((RTL8192E_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8812A_SUPPORT == 1) || (RTL8822B_SUPPORT == 1)) + #define PHYDM_COMPILE_IC_2SS +#endif + +/*#define PHYDM_COMPILE_IC_3SS*/ + +#if ((RTL8814B_SUPPORT == 1) || (RTL8814A_SUPPORT == 1)) + #define PHYDM_COMPILE_IC_4SS +#endif + +/*==[ABOVE N-SS COMPILE FLAG]=============================*/ +#if (defined(PHYDM_COMPILE_IC_1SS) || defined(PHYDM_COMPILE_IC_2SS) || defined(PHYDM_COMPILE_IC_3SS) || defined(PHYDM_COMPILE_IC_4SS)) + #define PHYDM_COMPILE_ABOVE_1SS +#endif + +#if (defined(PHYDM_COMPILE_IC_2SS) || defined(PHYDM_COMPILE_IC_3SS) || defined(PHYDM_COMPILE_IC_4SS)) + #define PHYDM_COMPILE_ABOVE_2SS +#endif + +#if (defined(PHYDM_COMPILE_IC_3SS) || defined(PHYDM_COMPILE_IC_4SS)) + #define PHYDM_COMPILE_ABOVE_3SS +#endif + +#if (defined(PHYDM_COMPILE_IC_4SS)) + #define PHYDM_COMPILE_ABOVE_4SS +#endif + +/*========[New Phy-Status Support] =========================================================================]*/ +#if (RTL8824B_SUPPORT == 1) + #define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 2 +#elif ((RTL8197F_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1) || (RTL8710B_SUPPORT == 1) ) + #define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 1 +#else + #define ODM_PHY_STATUS_NEW_TYPE_SUPPORT 0 +#endif + +/*==================================================================================================]*/ + +#if ((RTL8822B_SUPPORT == 1) || (RTL8197F_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) +#define PHYDM_COMMON_API_SUPPORT +#endif + +/* ODM_CMNINFO_CUT_VER */ +enum odm_cut_version_e { + ODM_CUT_A = 0, + ODM_CUT_B = 1, + ODM_CUT_C = 2, + ODM_CUT_D = 3, + ODM_CUT_E = 4, + ODM_CUT_F = 5, + ODM_CUT_G = 6, + ODM_CUT_H = 7, + ODM_CUT_I = 8, + ODM_CUT_J = 9, + ODM_CUT_K = 10, + ODM_CUT_TEST = 15, +}; + +/* ODM_CMNINFO_FAB_VER */ +enum odm_fab_e { + ODM_TSMC = 0, + ODM_UMC = 1, +}; + +/* ODM_CMNINFO_OP_MODE */ +enum odm_operation_mode_e { + ODM_NO_LINK = BIT(0), + ODM_LINK = BIT(1), + ODM_SCAN = BIT(2), + ODM_POWERSAVE = BIT(3), + ODM_AP_MODE = BIT(4), + ODM_CLIENT_MODE = BIT(5), + ODM_AD_HOC = BIT(6), + ODM_WIFI_DIRECT = BIT(7), + ODM_WIFI_DISPLAY = BIT(8), +}; + +/* ODM_CMNINFO_WM_MODE */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) +enum odm_wireless_mode_e { + ODM_WM_UNKNOW = 0x0, + ODM_WM_B = BIT(0), + ODM_WM_G = BIT(1), + ODM_WM_A = BIT(2), + ODM_WM_N24G = BIT(3), + ODM_WM_N5G = BIT(4), + ODM_WM_AUTO = BIT(5), + ODM_WM_AC = BIT(6), +}; +#else +enum odm_wireless_mode_e { + ODM_WM_UNKNOWN = 0x00,/*0x0*/ + ODM_WM_A = BIT(0), /* 0x1*/ + ODM_WM_B = BIT(1), /* 0x2*/ + ODM_WM_G = BIT(2),/* 0x4*/ + ODM_WM_AUTO = BIT(3),/* 0x8*/ + ODM_WM_N24G = BIT(4),/* 0x10*/ + ODM_WM_N5G = BIT(5),/* 0x20*/ + ODM_WM_AC_5G = BIT(6),/* 0x40*/ + ODM_WM_AC_24G = BIT(7),/* 0x80*/ + ODM_WM_AC_ONLY = BIT(8),/* 0x100*/ + ODM_WM_MAX = BIT(11)/* 0x800*/ + +}; +#endif + +/* ODM_CMNINFO_BAND */ +enum odm_band_type_e { +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + ODM_BAND_2_4G = BIT(0), + ODM_BAND_5G = BIT(1), +#else + ODM_BAND_2_4G = 0, + ODM_BAND_5G, + ODM_BAND_ON_BOTH, + ODM_BANDMAX +#endif +}; + + +/* ODM_CMNINFO_SEC_CHNL_OFFSET */ +enum phydm_sec_chnl_offset_e { + + PHYDM_DONT_CARE = 0, + PHYDM_BELOW = 1, + PHYDM_ABOVE = 2 +}; + +/* ODM_CMNINFO_SEC_MODE */ +enum odm_security_e { + ODM_SEC_OPEN = 0, + ODM_SEC_WEP40 = 1, + ODM_SEC_TKIP = 2, + ODM_SEC_RESERVE = 3, + ODM_SEC_AESCCMP = 4, + ODM_SEC_WEP104 = 5, + ODM_WEP_WPA_MIXED = 6, /* WEP + WPA */ + ODM_SEC_SMS4 = 7, +}; + +/* ODM_CMNINFO_CHNL */ + +/* ODM_CMNINFO_BOARD_TYPE */ +enum odm_board_type_e { + ODM_BOARD_DEFAULT = 0, /* The DEFAULT case. */ + ODM_BOARD_MINICARD = BIT(0), /* 0 = non-mini card, 1= mini card. */ + ODM_BOARD_SLIM = BIT(1), /* 0 = non-slim card, 1 = slim card */ + ODM_BOARD_BT = BIT(2), /* 0 = without BT card, 1 = with BT */ + ODM_BOARD_EXT_PA = BIT(3), /* 0 = no 2G ext-PA, 1 = existing 2G ext-PA */ + ODM_BOARD_EXT_LNA = BIT(4), /* 0 = no 2G ext-LNA, 1 = existing 2G ext-LNA */ + ODM_BOARD_EXT_TRSW = BIT(5), /* 0 = no ext-TRSW, 1 = existing ext-TRSW */ + ODM_BOARD_EXT_PA_5G = BIT(6), /* 0 = no 5G ext-PA, 1 = existing 5G ext-PA */ + ODM_BOARD_EXT_LNA_5G = BIT(7), /* 0 = no 5G ext-LNA, 1 = existing 5G ext-LNA */ +}; + +enum odm_package_type_e { + ODM_PACKAGE_DEFAULT = 0, + ODM_PACKAGE_QFN68 = BIT(0), + ODM_PACKAGE_TFBGA90 = BIT(1), + ODM_PACKAGE_TFBGA79 = BIT(2), +}; + +enum odm_type_gpa_e { + TYPE_GPA0 = 0x0000, + TYPE_GPA1 = 0x0055, + TYPE_GPA2 = 0x00AA, + TYPE_GPA3 = 0x00FF, + TYPE_GPA4 = 0x5500, + TYPE_GPA5 = 0x5555, + TYPE_GPA6 = 0x55AA, + TYPE_GPA7 = 0x55FF, + TYPE_GPA8 = 0xAA00, + TYPE_GPA9 = 0xAA55, + TYPE_GPA10 = 0xAAAA, + TYPE_GPA11 = 0xAAFF, + TYPE_GPA12 = 0xFF00, + TYPE_GPA13 = 0xFF55, + TYPE_GPA14 = 0xFFAA, + TYPE_GPA15 = 0xFFFF, +}; + +enum odm_type_apa_e { + TYPE_APA0 = 0x0000, + TYPE_APA1 = 0x0055, + TYPE_APA2 = 0x00AA, + TYPE_APA3 = 0x00FF, + TYPE_APA4 = 0x5500, + TYPE_APA5 = 0x5555, + TYPE_APA6 = 0x55AA, + TYPE_APA7 = 0x55FF, + TYPE_APA8 = 0xAA00, + TYPE_APA9 = 0xAA55, + TYPE_APA10 = 0xAAAA, + TYPE_APA11 = 0xAAFF, + TYPE_APA12 = 0xFF00, + TYPE_APA13 = 0xFF55, + TYPE_APA14 = 0xFFAA, + TYPE_APA15 = 0xFFFF, +}; + +enum odm_type_glna_e { + TYPE_GLNA0 = 0x0000, + TYPE_GLNA1 = 0x0055, + TYPE_GLNA2 = 0x00AA, + TYPE_GLNA3 = 0x00FF, + TYPE_GLNA4 = 0x5500, + TYPE_GLNA5 = 0x5555, + TYPE_GLNA6 = 0x55AA, + TYPE_GLNA7 = 0x55FF, + TYPE_GLNA8 = 0xAA00, + TYPE_GLNA9 = 0xAA55, + TYPE_GLNA10 = 0xAAAA, + TYPE_GLNA11 = 0xAAFF, + TYPE_GLNA12 = 0xFF00, + TYPE_GLNA13 = 0xFF55, + TYPE_GLNA14 = 0xFFAA, + TYPE_GLNA15 = 0xFFFF, +}; + +enum odm_type_alna_e { + TYPE_ALNA0 = 0x0000, + TYPE_ALNA1 = 0x0055, + TYPE_ALNA2 = 0x00AA, + TYPE_ALNA3 = 0x00FF, + TYPE_ALNA4 = 0x5500, + TYPE_ALNA5 = 0x5555, + TYPE_ALNA6 = 0x55AA, + TYPE_ALNA7 = 0x55FF, + TYPE_ALNA8 = 0xAA00, + TYPE_ALNA9 = 0xAA55, + TYPE_ALNA10 = 0xAAAA, + TYPE_ALNA11 = 0xAAFF, + TYPE_ALNA12 = 0xFF00, + TYPE_ALNA13 = 0xFF55, + TYPE_ALNA14 = 0xFFAA, + TYPE_ALNA15 = 0xFFFF, +}; + +#define PAUSE_FAIL 0 +#define PAUSE_SUCCESS 1 + +enum odm_parameter_init_e { + ODM_PRE_SETTING = 0, + ODM_POST_SETTING = 1, + ODM_INIT_FW_SETTING +}; + + +enum phydm_pause_type { + PHYDM_PAUSE = 1, /*Pause & Set new value*/ + PHYDM_PAUSE_NO_SET = 2, /*Pause & Stay in current value*/ + PHYDM_RESUME = 3 +}; + +enum phydm_pause_level { + PHYDM_PAUSE_RELEASE = -1, + PHYDM_PAUSE_LEVEL_0 = 0, /* Low Priority function */ + PHYDM_PAUSE_LEVEL_1 = 1, /* Middle Priority function */ + PHYDM_PAUSE_LEVEL_2 = 2, /* High priority function (ex: Check hang function) */ + PHYDM_PAUSE_LEVEL_3 = 3, /* Debug function (the highest priority) */ + PHYDM_PAUSE_MAX_NUM = 4 +}; + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_precomp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_precomp.h index f7c3a88dc48b..c8c7c5614d4a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_precomp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_precomp.h @@ -1,351 +1,403 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __ODM_PRECOMP_H__ -#define __ODM_PRECOMP_H__ - -#include "phydm_types.h" - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#include "Precomp.h" // We need to include mp_precomp.h due to batch file setting. -#else -#define TEST_FALG___ 1 -#endif - -//2 Config Flags and Structs - defined by each ODM Type - -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "../8192cd_cfg.h" - #include "../odm_inc.h" - - #include "../8192cd.h" - #include "../8192cd_util.h" - #ifdef _BIG_ENDIAN_ - #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG - #else - #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE - #endif - - #ifdef AP_BUILD_WORKAROUND - #include "../8192cd_headers.h" - #include "../8192cd_debug.h" - #endif - -#elif (DM_ODM_SUPPORT_TYPE ==ODM_CE) - #define __PACK - #define __WLAN_ATTRIB_PACK__ -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "mp_precomp.h" - #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE - #define __PACK - #define __WLAN_ATTRIB_PACK__ -#endif - -//2 OutSrc Header Files - -#include "phydm.h" -#include "phydm_hwconfig.h" -#include "phydm_debug.h" -#include "phydm_regdefine11ac.h" -#include "phydm_regdefine11n.h" -#include "phydm_interface.h" -#include "phydm_reg.h" - -#include "phydm_adc_sampling.h" - -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) -VOID -PHY_SetTxPowerLimit( - IN PDM_ODM_T pDM_Odm, - IN u8 *Regulation, - IN u8 *Band, - IN u8 *Bandwidth, - IN u8 *RateSection, - IN u8 *RfPath, - IN u8 *Channel, - IN u8 *PowerLimit -); - -#endif - -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) -#define RTL8703B_SUPPORT 0 -#define RTL8188F_SUPPORT 0 -#define RTL8723D_SUPPORT 0 -#endif - -#if RTL8188E_SUPPORT == 1 -#define RTL8188E_T_SUPPORT 1 -#ifdef CONFIG_SFW_SUPPORTED -#define RTL8188E_S_SUPPORT 1 -#else -#define RTL8188E_S_SUPPORT 0 -#endif -#endif - -#if (RTL8188E_SUPPORT==1) -#include "rtl8188e/hal8188erateadaptive.h"//for RA,Power training -#include "rtl8188e/halhwimg8188e_mac.h" -#include "rtl8188e/halhwimg8188e_rf.h" -#include "rtl8188e/halhwimg8188e_bb.h" -#include "rtl8188e/halhwimg8188e_t_fw.h" -#include "rtl8188e/halhwimg8188e_s_fw.h" -#include "rtl8188e/phydm_regconfig8188e.h" -#include "rtl8188e/phydm_rtl8188e.h" -#include "rtl8188e/hal8188ereg.h" -#include "rtl8188e/version_rtl8188e.h" -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8188e_hal.h" - #include "rtl8188e/halphyrf_8188e_ce.h" -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8188e/halphyrf_8188e_win.h" -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8188e/halphyrf_8188e_ap.h" -#endif -#endif //88E END - -#if (RTL8192E_SUPPORT==1) - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8192e/halphyrf_8192e_win.h" /*FOR_8192E_IQK*/ - #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8192e/halphyrf_8192e_ap.h" /*FOR_8192E_IQK*/ - #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8192e/halphyrf_8192e_ce.h" /*FOR_8192E_IQK*/ - #endif - -#include "rtl8192e/phydm_rtl8192e.h" //FOR_8192E_IQK -#include "rtl8192e/version_rtl8192e.h" -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) - #include "rtl8192e/halhwimg8192e_bb.h" - #include "rtl8192e/halhwimg8192e_mac.h" - #include "rtl8192e/halhwimg8192e_rf.h" - #include "rtl8192e/phydm_regconfig8192e.h" - #include "rtl8192e/halhwimg8192e_fw.h" - #include "rtl8192e/hal8192ereg.h" -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8192e_hal.h" -#endif -#endif //92E END - -#if (RTL8812A_SUPPORT==1) - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8812a/halphyrf_8812a_win.h" - #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8812a/halphyrf_8812a_ap.h" - #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8812a/halphyrf_8812a_ce.h" - #endif - - //#include "rtl8812a/HalPhyRf_8812A.h" //FOR_8812_IQK - #if (DM_ODM_SUPPORT_TYPE != ODM_AP) - #include "rtl8812a/halhwimg8812a_bb.h" - #include "rtl8812a/halhwimg8812a_mac.h" - #include "rtl8812a/halhwimg8812a_rf.h" - #include "rtl8812a/phydm_regconfig8812a.h" - #include "rtl8812a/halhwimg8812a_fw.h" - #include "rtl8812a/phydm_rtl8812a.h" - #endif - - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8812a_hal.h" - #endif - #include "rtl8812a/version_rtl8812a.h" - -#endif //8812 END - -#if (RTL8814A_SUPPORT==1) - -#include "rtl8814a/halhwimg8814a_mac.h" -#include "rtl8814a/halhwimg8814a_rf.h" -#include "rtl8814a/halhwimg8814a_bb.h" -#include "rtl8814a/version_rtl8814a.h" -#include "rtl8814a/phydm_rtl8814a.h" -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) - #include "rtl8814a/halhwimg8814a_fw.h" -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8814a/halphyrf_8814a_win.h" -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8814a/halphyrf_8814a_ce.h" -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - #include "rtl8814a/halphyrf_8814a_ap.h" -#endif - #include "rtl8814a/phydm_regconfig8814a.h" -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8814a_hal.h" - #include "rtl8814a/phydm_iqk_8814a.h" -#endif -#endif //8814 END - -#if (RTL8881A_SUPPORT==1)//FOR_8881_IQK -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#include "rtl8821a/phydm_iqk_8821a_win.h" -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -#include "rtl8821a/phydm_iqk_8821a_ce.h" -#else -#include "rtl8821a/phydm_iqk_8821a_ap.h" -#endif -//#include "rtl8881a/HalHWImg8881A_BB.h" -//#include "rtl8881a/HalHWImg8881A_MAC.h" -//#include "rtl8881a/HalHWImg8881A_RF.h" -//#include "rtl8881a/odm_RegConfig8881A.h" -#endif - -#if (RTL8723B_SUPPORT==1) -#include "rtl8723b/halhwimg8723b_mac.h" -#include "rtl8723b/halhwimg8723b_rf.h" -#include "rtl8723b/halhwimg8723b_bb.h" -#include "rtl8723b/halhwimg8723b_fw.h" -#include "rtl8723b/phydm_regconfig8723b.h" -#include "rtl8723b/phydm_rtl8723b.h" -#include "rtl8723b/hal8723breg.h" -#include "rtl8723b/version_rtl8723b.h" -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8723b/halphyrf_8723b_win.h" -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8723b/halphyrf_8723b_ce.h" - #include "rtl8723b/halhwimg8723b_mp.h" - #include "rtl8723b_hal.h" -#else - #include "rtl8723b/halphyrf_8723b_ap.h" -#endif -#endif - -#if (RTL8821A_SUPPORT==1) -#include "rtl8821a/halhwimg8821a_mac.h" -#include "rtl8821a/halhwimg8821a_rf.h" -#include "rtl8821a/halhwimg8821a_bb.h" -#include "rtl8821a/halhwimg8821a_fw.h" -#include "rtl8821a/phydm_regconfig8821a.h" -#include "rtl8821a/phydm_rtl8821a.h" -#include "rtl8821a/version_rtl8821a.h" -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #include "rtl8821a/halphyrf_8821a_win.h" -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8821a/halphyrf_8821a_ce.h" - #include "rtl8821a/phydm_iqk_8821a_ce.h"/*for IQK*/ - #include "rtl8812a/halphyrf_8812a_ce.h"/*for IQK,LCK,Power-tracking*/ - #include "rtl8812a_hal.h" -#else -#endif -#endif - -#if (RTL8822B_SUPPORT==1) -#include "rtl8822b/halhwimg8822b_mac.h" -#include "rtl8822b/halhwimg8822b_rf.h" -#include "rtl8822b/halhwimg8822b_bb.h" -#include "rtl8822b/halhwimg8822b_fw.h" -#include "rtl8822b/phydm_regconfig8822b.h" -#include "rtl8822b/halphyrf_8822b.h" -#include "rtl8822b/phydm_rtl8822b.h" -#include "rtl8822b/phydm_hal_api8822b.h" -#include "rtl8822b/version_rtl8822b.h" - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -#include /* struct HAL_DATA_TYPE */ -#include /* Rx_Smooth_Factor, reg definition and etc.*/ -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) -#endif - -#endif - -#if (RTL8703B_SUPPORT==1) -#include "rtl8703b/phydm_regconfig8703b.h" -#include "rtl8703b/halhwimg8703b_mac.h" -#include "rtl8703b/halhwimg8703b_rf.h" -#include "rtl8703b/halhwimg8703b_bb.h" -#include "rtl8703b/halhwimg8703b_fw.h" -#include "rtl8703b/halphyrf_8703b.h" -#include "rtl8703b/version_rtl8703b.h" -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -#include "rtl8703b_hal.h" -#endif -#endif - -#if (RTL8188F_SUPPORT == 1) -#include "rtl8188f/halhwimg8188f_mac.h" -#include "rtl8188f/halhwimg8188f_rf.h" -#include "rtl8188f/halhwimg8188f_bb.h" -#include "rtl8188f/halhwimg8188f_fw.h" -#include "rtl8188f/hal8188freg.h" -#include "rtl8188f/phydm_rtl8188f.h" -#include "rtl8188f/phydm_regconfig8188f.h" -#include "rtl8188f/halphyrf_8188f.h" /* for IQK,LCK,Power-tracking */ -#include "rtl8188f/version_rtl8188f.h" -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -#include "rtl8188f_hal.h" -#endif -#endif - -#if (RTL8723D_SUPPORT==1) - #if (DM_ODM_SUPPORT_TYPE != ODM_AP) - - #include "rtl8723d/halhwimg8723d_bb.h" - #include "rtl8723d/halhwimg8723d_mac.h" - #include "rtl8723d/halhwimg8723d_rf.h" - #include "rtl8723d/phydm_regconfig8723d.h" - #include "rtl8723d/halhwimg8723d_fw.h" - #include "rtl8723d/hal8723dreg.h" - #include "rtl8723d/phydm_rtl8723d.h" - #include "rtl8723d/halphyrf_8723d.h" - #include "rtl8723d/version_rtl8723d.h" - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8723d_hal.h" - #endif -#endif //8723D End - -#if (RTL8197F_SUPPORT == 1) -#include "rtl8197f/halhwimg8197f_mac.h" -#include "rtl8197f/halhwimg8197f_rf.h" -#include "rtl8197f/halhwimg8197f_bb.h" -#include "rtl8197f/phydm_hal_api8197f.h" -#include "rtl8197f/version_rtl8197f.h" -#include "rtl8197f/phydm_rtl8197f.h" -#include "rtl8197f/phydm_regconfig8197f.h" -#include "rtl8197f/halphyrf_8197f.h" -#include "rtl8197f/phydm_iqk_8197f.h" -#endif - -#if (RTL8821C_SUPPORT==1) -#include "rtl8821c/phydm_hal_api8821c.h" -#include "rtl8821c/halhwimg8821c_testchip_mac.h" -#include "rtl8821c/halhwimg8821c_testchip_rf.h" -#include "rtl8821c/halhwimg8821c_testchip_bb.h" -#include "rtl8821c/halhwimg8821c_mac.h" -#include "rtl8821c/halhwimg8821c_rf.h" -#include "rtl8821c/halhwimg8821c_bb.h" -#include "rtl8821c/halhwimg8821c_fw.h" -#include "rtl8821c/phydm_regconfig8821c.h" -#include "rtl8821c/halphyrf_8821c.h" -#include "rtl8821c/version_rtl8821c.h" -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include "rtl8821c_hal.h" -#endif -#endif - -#endif // __ODM_PRECOMP_H__ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __ODM_PRECOMP_H__ +#define __ODM_PRECOMP_H__ + +#include "phydm_types.h" +#include "phydm_features.h" +#include "halrf/halrf_features.h" + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "Precomp.h" /* We need to include mp_precomp.h due to batch file setting. */ +#else + #define TEST_FALG___ 1 +#endif + +/* 2 Config Flags and Structs - defined by each ODM type */ + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "../8192cd_cfg.h" + #include "../odm_inc.h" + + #include "../8192cd.h" + #include "../8192cd_util.h" + #ifdef _BIG_ENDIAN_ + #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG + #else + #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE + #endif + + #include "../8192cd_headers.h" + #include "../8192cd_debug.h" + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #ifdef DM_ODM_CE_MAC80211 + #include "../wifi.h" + #include "rtl_phydm.h" + #endif + #define __PACK + #define __WLAN_ATTRIB_PACK__ +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "mp_precomp.h" + #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE + #define __PACK + #define __WLAN_ATTRIB_PACK__ +#endif + +/* 2 OutSrc Header Files */ + +#include "phydm.h" +#include "phydm_hwconfig.h" +#include "phydm_phystatus.h" +#include "phydm_debug.h" +#include "phydm_regdefine11ac.h" +#include "phydm_regdefine11n.h" +#include "phydm_interface.h" +#include "phydm_reg.h" + +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) && !defined(DM_ODM_CE_MAC80211) + +void +phy_set_tx_power_limit( + struct PHY_DM_STRUCT *p_dm, + u8 *regulation, + u8 *band, + u8 *bandwidth, + u8 *rate_section, + u8 *rf_path, + u8 *channel, + u8 *power_limit +); + +enum hal_status +rtw_phydm_fw_iqk( + struct PHY_DM_STRUCT *p_dm, + u8 clear, + u8 segment +); + +enum hal_status +rtw_phydm_cfg_phy_para( + struct PHY_DM_STRUCT *p_dm, + enum phydm_halmac_param config_type, + u32 offset, + u32 data, + u32 mask, + enum rf_path e_rf_path, + u32 delay_time +); + +#endif + +#if (DM_ODM_SUPPORT_TYPE & ODM_AP) + #define RTL8703B_SUPPORT 0 + #define RTL8188F_SUPPORT 0 + #define RTL8723D_SUPPORT 0 +#endif + +/* JJ ADD 20161014 */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP|ODM_IOT)) +#define RTL8710B_SUPPORT 0 +#endif + +#if RTL8188E_SUPPORT == 1 + #define RTL8188E_T_SUPPORT 1 + #ifdef CONFIG_SFW_SUPPORTED + #define RTL8188E_S_SUPPORT 1 + #else + #define RTL8188E_S_SUPPORT 0 + #endif +#endif + +#if (RTL8188E_SUPPORT == 1) + #include "rtl8188e/hal8188erateadaptive.h" /* for RA,Power training */ + #include "rtl8188e/halhwimg8188e_mac.h" + #include "rtl8188e/halhwimg8188e_rf.h" + #include "rtl8188e/halhwimg8188e_bb.h" + #include "rtl8188e/phydm_regconfig8188e.h" + #include "rtl8188e/phydm_rtl8188e.h" + #include "rtl8188e/hal8188ereg.h" + #include "rtl8188e/version_rtl8188e.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8188e_hal.h" + #include "halrf/rtl8188e/halrf_8188e_ce.h" + #endif + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "halrf/rtl8188e/halrf_8188e_win.h" + #endif + #if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "halrf/rtl8188e/halrf_8188e_ap.h" + #endif +#endif /* 88E END */ + +#if (RTL8192E_SUPPORT == 1) + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "halrf/rtl8192e/halrf_8192e_win.h" /*FOR_8192E_IQK*/ + #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "halrf/rtl8192e/halrf_8192e_ap.h" /*FOR_8192E_IQK*/ + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "halrf/rtl8192e/halrf_8192e_ce.h" /*FOR_8192E_IQK*/ + #endif + + #include "rtl8192e/phydm_rtl8192e.h" /* FOR_8192E_IQK */ + #include "rtl8192e/version_rtl8192e.h" + #if (DM_ODM_SUPPORT_TYPE != ODM_AP) + #include "rtl8192e/halhwimg8192e_bb.h" + #include "rtl8192e/halhwimg8192e_mac.h" + #include "rtl8192e/halhwimg8192e_rf.h" + #include "rtl8192e/phydm_regconfig8192e.h" + #include "rtl8192e/hal8192ereg.h" + #endif + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8192e_hal.h" + #endif +#endif /* 92E END */ + +#if (RTL8812A_SUPPORT == 1) + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "halrf/rtl8812a/halrf_8812a_win.h" + #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "halrf/rtl8812a/halrf_8812a_ap.h" + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "halrf/rtl8812a/halrf_8812a_ce.h" + #endif + + /* #include "halrf/rtl8812a/halrf_8812a.h" */ /* FOR_8812_IQK */ + #if (DM_ODM_SUPPORT_TYPE != ODM_AP) + #include "rtl8812a/halhwimg8812a_bb.h" + #include "rtl8812a/halhwimg8812a_mac.h" + #include "rtl8812a/halhwimg8812a_rf.h" + #include "rtl8812a/phydm_regconfig8812a.h" + #include "rtl8812a/phydm_rtl8812a.h" + #endif + + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8812a_hal.h" + #endif + #include "rtl8812a/version_rtl8812a.h" + +#endif /* 8812 END */ + +#if (RTL8814A_SUPPORT == 1) + + #include "rtl8814a/halhwimg8814a_mac.h" + #include "rtl8814a/halhwimg8814a_rf.h" + #include "rtl8814a/halhwimg8814a_bb.h" + #include "rtl8814a/version_rtl8814a.h" + #include "rtl8814a/phydm_rtl8814a.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "halrf/rtl8814a/halrf_8814a_win.h" + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "halrf/rtl8814a/halrf_8814a_ce.h" + #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "halrf/rtl8814a/halrf_8814a_ap.h" + #endif + #include "rtl8814a/phydm_regconfig8814a.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8814a_hal.h" + #include "halrf/rtl8814a/halrf_iqk_8814a.h" + #endif +#endif /* 8814 END */ + +#if (RTL8881A_SUPPORT == 1)/* FOR_8881_IQK */ + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "halrf/rtl8821a/halrf_iqk_8821a_win.h" + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "halrf/rtl8821a/halrf_iqk_8821a_ce.h" + #else + #include "halrf/rtl8821a/halrf_iqk_8821a_ap.h" + #endif + /* #include "rtl8881a/HalHWImg8881A_BB.h" */ + /* #include "rtl8881a/HalHWImg8881A_MAC.h" */ + /* #include "rtl8881a/HalHWImg8881A_RF.h" */ + /* #include "rtl8881a/odm_RegConfig8881A.h" */ +#endif + +#if (RTL8723B_SUPPORT == 1) + #include "rtl8723b/halhwimg8723b_mac.h" + #include "rtl8723b/halhwimg8723b_rf.h" + #include "rtl8723b/halhwimg8723b_bb.h" + #include "rtl8723b/phydm_regconfig8723b.h" + #include "rtl8723b/phydm_rtl8723b.h" + #include "rtl8723b/hal8723breg.h" + #include "rtl8723b/version_rtl8723b.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "halrf/rtl8723b/halrf_8723b_win.h" + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "halrf/rtl8723b/halrf_8723b_ce.h" + #include "rtl8723b/halhwimg8723b_mp.h" + #include "rtl8723b_hal.h" + #else + #include "halrf/rtl8723b/halrf_8723b_ap.h" + #endif +#endif + +#if (RTL8821A_SUPPORT == 1) + #include "rtl8821a/halhwimg8821a_mac.h" + #include "rtl8821a/halhwimg8821a_rf.h" + #include "rtl8821a/halhwimg8821a_bb.h" + #include "rtl8821a/phydm_regconfig8821a.h" + #include "rtl8821a/phydm_rtl8821a.h" + #include "rtl8821a/version_rtl8821a.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #include "halrf/rtl8821a/halrf_8821a_win.h" + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "halrf/rtl8821a/halrf_8821a_ce.h" + #include "halrf/rtl8821a/halrf_iqk_8821a_ce.h"/*for IQK*/ + #include "halrf/rtl8812a/halrf_8812a_ce.h"/*for IQK,LCK,Power-tracking*/ + #include "rtl8812a_hal.h" + #else + #endif +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) +#include "../halmac/halmac_reg2.h" + +#define LDPC_HT_ENABLE_RX BIT(0) +#define LDPC_HT_ENABLE_TX BIT(1) +#define LDPC_HT_TEST_TX_ENABLE BIT(2) +#define LDPC_HT_CAP_TX BIT(3) + +#define STBC_HT_ENABLE_RX BIT(0) +#define STBC_HT_ENABLE_TX BIT(1) +#define STBC_HT_TEST_TX_ENABLE BIT(2) +#define STBC_HT_CAP_TX BIT(3) + + +#define LDPC_VHT_ENABLE_RX BIT(0) +#define LDPC_VHT_ENABLE_TX BIT(1) +#define LDPC_VHT_TEST_TX_ENABLE BIT(2) +#define LDPC_VHT_CAP_TX BIT(3) + +#define STBC_VHT_ENABLE_RX BIT(0) +#define STBC_VHT_ENABLE_TX BIT(1) +#define STBC_VHT_TEST_TX_ENABLE BIT(2) +#define STBC_VHT_CAP_TX BIT(3) +#endif + + +#if (RTL8822B_SUPPORT == 1) + #include "rtl8822b/halhwimg8822b_mac.h" + #include "rtl8822b/halhwimg8822b_rf.h" + #include "rtl8822b/halhwimg8822b_bb.h" + #include "rtl8822b/phydm_regconfig8822b.h" + #include "halrf/rtl8822b/halrf_8822b.h" + #include "rtl8822b/phydm_rtl8822b.h" + #include "rtl8822b/phydm_hal_api8822b.h" + #include "rtl8822b/version_rtl8822b.h" + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #ifdef DM_ODM_CE_MAC80211 + #include "../halmac/halmac_reg_8822b.h" + #else + #include /* struct HAL_DATA_TYPE */ + #include /* RX_SMOOTH_FACTOR, reg definition and etc.*/ + #endif + #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #endif + +#endif + +#if (RTL8703B_SUPPORT == 1) + #include "rtl8703b/phydm_regconfig8703b.h" + #include "rtl8703b/halhwimg8703b_mac.h" + #include "rtl8703b/halhwimg8703b_rf.h" + #include "rtl8703b/halhwimg8703b_bb.h" + #include "halrf/rtl8703b/halrf_8703b.h" + #include "rtl8703b/version_rtl8703b.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8703b_hal.h" + #endif +#endif + +#if (RTL8188F_SUPPORT == 1) + #include "rtl8188f/halhwimg8188f_mac.h" + #include "rtl8188f/halhwimg8188f_rf.h" + #include "rtl8188f/halhwimg8188f_bb.h" + #include "rtl8188f/hal8188freg.h" + #include "rtl8188f/phydm_rtl8188f.h" + #include "rtl8188f/phydm_regconfig8188f.h" + #include "halrf/rtl8188f/halrf_8188f.h" /* for IQK,LCK,Power-tracking */ + #include "rtl8188f/version_rtl8188f.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8188f_hal.h" + #endif +#endif + +#if (RTL8723D_SUPPORT == 1) + #if (DM_ODM_SUPPORT_TYPE != ODM_AP) + + #include "rtl8723d/halhwimg8723d_bb.h" + #include "rtl8723d/halhwimg8723d_mac.h" + #include "rtl8723d/halhwimg8723d_rf.h" + #include "rtl8723d/phydm_regconfig8723d.h" + #include "rtl8723d/hal8723dreg.h" + #include "rtl8723d/phydm_rtl8723d.h" + #include "halrf/rtl8723d/halrf_8723d.h" + #include "rtl8723d/version_rtl8723d.h" + #endif + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8723d_hal.h" + #endif +#endif /* 8723D End */ + +/* JJ ADD 20161014 */ +#if (RTL8710B_SUPPORT == 1) + #if (DM_ODM_SUPPORT_TYPE != ODM_AP) + + #include "rtl8710b/halhwimg8710b_bb.h" + #include "rtl8710b/halhwimg8710b_mac.h" + #include "rtl8710b/halhwimg8710b_rf.h" + #include "rtl8710b/phydm_regconfig8710b.h" + #include "rtl8710b/hal8710breg.h" + #include "rtl8710b/phydm_rtl8710b.h" + #include "halrf/rtl8710b/halrf_8710b.h" + #include "rtl8710b/version_rtl8710b.h" + #endif + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8710b_hal.h" + #endif +#endif /* 8710B End */ + +#if (RTL8197F_SUPPORT == 1) + #include "rtl8197f/halhwimg8197f_mac.h" + #include "rtl8197f/halhwimg8197f_rf.h" + #include "rtl8197f/halhwimg8197f_bb.h" + #include "rtl8197f/phydm_hal_api8197f.h" + #include "rtl8197f/version_rtl8197f.h" + #include "rtl8197f/phydm_rtl8197f.h" + #include "rtl8197f/phydm_regconfig8197f.h" + #include "halrf/rtl8197f/halrf_8197f.h" + #include "halrf/rtl8197f/halrf_iqk_8197f.h" +#endif + +#if (RTL8821C_SUPPORT == 1) + #include "rtl8821c/phydm_hal_api8821c.h" + #include "rtl8821c/halhwimg8821c_mac.h" + #include "rtl8821c/halhwimg8821c_rf.h" + #include "rtl8821c/halhwimg8821c_bb.h" + #include "rtl8821c/phydm_regconfig8821c.h" + #include "halrf/rtl8821c/halrf_8821c.h" + #include "rtl8821c/version_rtl8821c.h" + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include "rtl8821c_hal.h" + #endif +#endif + +#endif /* __ODM_PRECOMP_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.c new file mode 100644 index 000000000000..991e65b31e74 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.c @@ -0,0 +1,734 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" +#ifdef PHYDM_PRIMARY_CCA + +void +phydm_write_dynamic_cca( + void *p_dm_void, + u8 curr_mf_state + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + + if (primary_cca->mf_state != curr_mf_state) { + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) { + + if (curr_mf_state == MF_USC_LSC) { + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), MF_USC_LSC); + odm_set_bb_reg(p_dm, 0xc84, 0xf0000000, primary_cca->cca_th_40m_bkp); /*40M OFDM MF CCA threshold*/ + } else { + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), curr_mf_state); + odm_set_bb_reg(p_dm, 0xc84, 0xf0000000, 0); /*40M OFDM MF CCA threshold*/ + } + } + + primary_cca->mf_state = curr_mf_state; + PHYDM_DBG(p_dm, DBG_PRI_CCA, + ("Set CCA at ((%s SB)), 0xc6c[8:7]=((%d))\n", ((curr_mf_state == MF_USC_LSC)?"D":((curr_mf_state == MF_LSC)?"L":"U")), curr_mf_state)); + } +} + +void +phydm_primary_cca_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("[PriCCA] Reset\n")); + primary_cca->mf_state = 0xff; + primary_cca->pre_bw = (enum channel_width)0xff; + phydm_write_dynamic_cca(p_dm, MF_USC_LSC); +} + +void +phydm_primary_cca_11n( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pricca_struct *p_primary_cca = &(p_dm->dm_pri_cca); + enum channel_width curr_bw = (enum channel_width)(*(p_dm->p_band_width)); + + if (!(p_dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + if (!p_dm->is_linked) { /* is_linked==False */ + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("[PriCCA][No Link!!!]\n")); + + if (p_primary_cca->pri_cca_is_become_linked == true) { + phydm_primary_cca_reset(p_dm); + p_primary_cca->pri_cca_is_become_linked = p_dm->is_linked; + } + return; + + } else { + if (p_primary_cca->pri_cca_is_become_linked == false) { + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("[PriCCA][Linked !!!]\n")); + p_primary_cca->pri_cca_is_become_linked = p_dm->is_linked; + } + } + + if (curr_bw != p_primary_cca->pre_bw) { + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("[Primary CCA] start ==>\n")); + p_primary_cca->pre_bw = curr_bw; + + if (curr_bw == CHANNEL_WIDTH_40) { + + if ((*(p_dm->p_sec_ch_offset)) == SECOND_CH_AT_LSB) {/* Primary CH @ upper sideband*/ + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("BW40M, Primary CH at USB\n")); + phydm_write_dynamic_cca(p_dm, MF_USC); + + } else { /*Primary CH @ lower sideband*/ + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("BW40M, Primary CH at LSB\n")); + phydm_write_dynamic_cca(p_dm, MF_LSC); + } + } else { + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("Not BW40M, USB + LSB\n")); + phydm_primary_cca_reset(p_dm); + } + } +} + +#if 0 +#if (RTL8188E_SUPPORT == 1) +void +odm_dynamic_primary_cca_8188e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct sta_info *p_entry; + struct cmn_sta_info *p_sta; + struct phydm_fa_struct *false_alm_cnt = (struct phydm_fa_struct *)phydm_get_structure(p_dm, PHYDM_FALSEALMCNT); + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + boolean client_40mhz = false, client_tmp = false; /* connected client BW */ + boolean is_connected = false; /* connected or not */ + u8 client_40mhz_pre = 0; + u32 counter = 0; + u8 delay = 1; + u64 cur_tx_ok_cnt; + u64 cur_rx_ok_cnt; + u8 sec_ch_offset = *(p_dm->p_sec_ch_offset); + u8 i; + + if (!p_dm->is_linked) + return; + + if (!(p_dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + if (*(p_dm->p_band_width) == CHANNEL_WIDTH_20) { /*curr bw*/ + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), 0); + return; + } + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) || (DM_ODM_SUPPORT_TYPE == ODM_CE) + sec_ch_offset = sec_ch_offset % 2 + 1; /* NIC's definition is reverse to AP 1:secondary below, 2: secondary above */ + #endif + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("Second CH Offset = %d\n", sec_ch_offset)); + + /* 3 Check Current WLAN Traffic */ + cur_tx_ok_cnt = p_dm->tx_tp; + cur_rx_ok_cnt = p_dm->rx_tp; + + /* ==================Debug Message==================== */ + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("TP = %llu\n", cur_tx_ok_cnt + cur_rx_ok_cnt)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("is_BW40 = %d\n", *(p_dm->p_band_width))); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("BW_LSC = %d\n", false_alm_cnt->cnt_bw_lsc)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("BW_USC = %d\n", false_alm_cnt->cnt_bw_usc)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("CCA OFDM = %d\n", false_alm_cnt->cnt_ofdm_cca)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("CCA CCK = %d\n", false_alm_cnt->cnt_cck_cca)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("OFDM FA = %d\n", false_alm_cnt->cnt_ofdm_fail)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("CCK FA = %d\n", false_alm_cnt->cnt_cck_fail)); + /* ================================================ */ + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (ACTING_AS_AP(p_dm->adapter)) /* primary cca process only do at AP mode */ +#endif + { + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("ACTING as AP mode=%d\n", ACTING_AS_AP(p_dm->adapter))); + /* 3 To get entry's connection and BW infomation status. */ + for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) { + if (IsAPModeExist(p_dm->adapter) && GetFirstExtAdapter(p_dm->adapter) != NULL) + p_entry = AsocEntry_EnumStation(GetFirstExtAdapter(p_dm->adapter), i); + else + p_entry = AsocEntry_EnumStation(GetDefaultAdapter(p_dm->adapter), i); + if (p_entry != NULL) { + client_tmp = p_entry->BandWidth; /* client BW */ + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("Client_BW=%d\n", client_tmp)); + if (client_tmp > client_40mhz) + client_40mhz = client_tmp; /* 40M/20M coexist => 40M priority is High */ + + if (p_entry->bAssociated) { + is_connected = true; /* client is connected or not */ + break; + } + } else + break; + } +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + /* 3 To get entry's connection and BW infomation status. */ + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + p_sta = p_dm->p_phydm_sta_info[i]; + if (is_sta_active(p_sta)) { + client_tmp = p_sta->bw_mode; + if (client_tmp > client_40mhz) + client_40mhz = client_tmp; /* 40M/20M coexist => 40M priority is High */ + + is_connected = true; + } + } +#endif + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("is_connected=%d\n", is_connected)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("Is Client 40MHz=%d\n", client_40mhz)); + /* 1 Monitor whether the interference exists or not */ + if (primary_cca->monitor_flag == 1) { + if (sec_ch_offset == 1) { /* secondary channel is below the primary channel */ + if ((false_alm_cnt->cnt_ofdm_cca > 500) && (false_alm_cnt->cnt_bw_lsc > false_alm_cnt->cnt_bw_usc + 500)) { + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) { + primary_cca->intf_type = 1; + primary_cca->pri_cca_flag = 1; + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT7, 2); /* USC MF */ + if (primary_cca->dup_rts_flag == 1) + primary_cca->dup_rts_flag = 0; + } else { + primary_cca->intf_type = 2; + if (primary_cca->dup_rts_flag == 0) + primary_cca->dup_rts_flag = 1; + } + + } else { /* interferecne disappear */ + primary_cca->dup_rts_flag = 0; + primary_cca->intf_flag = 0; + primary_cca->intf_type = 0; + } + } else if (sec_ch_offset == 2) { /* secondary channel is above the primary channel */ + if ((false_alm_cnt->cnt_ofdm_cca > 500) && (false_alm_cnt->cnt_bw_usc > false_alm_cnt->cnt_bw_lsc + 500)) { + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) { + primary_cca->intf_type = 1; + primary_cca->pri_cca_flag = 1; + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT7, 1); /* LSC MF */ + if (primary_cca->dup_rts_flag == 1) + primary_cca->dup_rts_flag = 0; + } else { + primary_cca->intf_type = 2; + if (primary_cca->dup_rts_flag == 0) + primary_cca->dup_rts_flag = 1; + } + + } else { /* interferecne disappear */ + primary_cca->dup_rts_flag = 0; + primary_cca->intf_flag = 0; + primary_cca->intf_type = 0; + } + + + } + primary_cca->monitor_flag = 0; + } + + /* 1 Dynamic Primary CCA Main Function */ + if (primary_cca->monitor_flag == 0) { + if (*(p_dm->p_band_width) == CHANNEL_WIDTH_40) { /* if RFBW==40M mode which require to process primary cca */ + /* 2 STA is NOT Connected */ + if (!is_connected) { + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("STA NOT Connected!!!!\n")); + + if (primary_cca->pri_cca_flag == 1) { /* reset primary cca when STA is disconnected */ + primary_cca->pri_cca_flag = 0; + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), 0); + } + if (primary_cca->dup_rts_flag == 1) /* reset Duplicate RTS when STA is disconnected */ + primary_cca->dup_rts_flag = 0; + + if (sec_ch_offset == 1) { /* secondary channel is below the primary channel */ + if ((false_alm_cnt->cnt_ofdm_cca > 800) && (false_alm_cnt->cnt_bw_lsc * 5 > false_alm_cnt->cnt_bw_usc * 9)) { + primary_cca->intf_flag = 1; /* secondary channel interference is detected!!! */ + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) + primary_cca->intf_type = 1; /* interference is shift */ + else + primary_cca->intf_type = 2; /* interference is in-band */ + } else { + primary_cca->intf_flag = 0; + primary_cca->intf_type = 0; + } + } else if (sec_ch_offset == 2) { /* secondary channel is above the primary channel */ + if ((false_alm_cnt->cnt_ofdm_cca > 800) && (false_alm_cnt->cnt_bw_usc * 5 > false_alm_cnt->cnt_bw_lsc * 9)) { + primary_cca->intf_flag = 1; /* secondary channel interference is detected!!! */ + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) + primary_cca->intf_type = 1; /* interference is shift */ + else + primary_cca->intf_type = 2; /* interference is in-band */ + } else { + primary_cca->intf_flag = 0; + primary_cca->intf_type = 0; + } + } + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("primary_cca=%d\n", primary_cca->pri_cca_flag)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("Intf_Type=%d\n", primary_cca->intf_type)); + } + /* 2 STA is Connected */ + else { + if (client_40mhz == 0) /* 3 */ { /* client BW = 20MHz */ + if (primary_cca->pri_cca_flag == 0) { + primary_cca->pri_cca_flag = 1; + if (sec_ch_offset == 1) + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), 2); + else if (sec_ch_offset == 2) + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), 1); + } + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("STA Connected 20M!!! primary_cca=%d\n", primary_cca->pri_cca_flag)); + } else /* 3 */ { /* client BW = 40MHz */ + if (primary_cca->intf_flag == 1) { /* interference is detected!! */ + if (primary_cca->intf_type == 1) { + if (primary_cca->pri_cca_flag != 1) { + primary_cca->pri_cca_flag = 1; + if (sec_ch_offset == 1) + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), 2); + else if (sec_ch_offset == 2) + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), 1); + } + } else if (primary_cca->intf_type == 2) { + if (primary_cca->dup_rts_flag != 1) + primary_cca->dup_rts_flag = 1; + } + } else { /* if intf_flag==0 */ + if ((cur_tx_ok_cnt + cur_rx_ok_cnt) < 1) { /* idle mode or TP traffic is very low */ + if (sec_ch_offset == 1) { + if ((false_alm_cnt->cnt_ofdm_cca > 800) && (false_alm_cnt->cnt_bw_lsc * 5 > false_alm_cnt->cnt_bw_usc * 9)) { + primary_cca->intf_flag = 1; + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) + primary_cca->intf_type = 1; /* interference is shift */ + else + primary_cca->intf_type = 2; /* interference is in-band */ + } + } else if (sec_ch_offset == 2) { + if ((false_alm_cnt->cnt_ofdm_cca > 800) && (false_alm_cnt->cnt_bw_usc * 5 > false_alm_cnt->cnt_bw_lsc * 9)) { + primary_cca->intf_flag = 1; + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) + primary_cca->intf_type = 1; /* interference is shift */ + else + primary_cca->intf_type = 2; /* interference is in-band */ + } + + } + } else { /* TP Traffic is High */ + if (sec_ch_offset == 1) { + if (false_alm_cnt->cnt_bw_lsc > (false_alm_cnt->cnt_bw_usc + 500)) { + if (delay == 0) { /* add delay to avoid interference occurring abruptly, jump one time */ + primary_cca->intf_flag = 1; + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) + primary_cca->intf_type = 1; /* interference is shift */ + else + primary_cca->intf_type = 2; /* interference is in-band */ + delay = 1; + } else + delay = 0; + } + } else if (sec_ch_offset == 2) { + if (false_alm_cnt->cnt_bw_usc > (false_alm_cnt->cnt_bw_lsc + 500)) { + if (delay == 0) { /* add delay to avoid interference occurring abruptly */ + primary_cca->intf_flag = 1; + if (false_alm_cnt->cnt_ofdm_fail > false_alm_cnt->cnt_ofdm_cca >> 1) + primary_cca->intf_type = 1; /* interference is shift */ + else + primary_cca->intf_type = 2; /* interference is in-band */ + delay = 1; + } else + delay = 0; + } + } + } + } + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("Primary CCA=%d\n", primary_cca->pri_cca_flag)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("Duplicate RTS=%d\n", primary_cca->dup_rts_flag)); + } + + } /* end of connected */ + } + } + /* 1 Dynamic Primary CCA Monitor counter */ + if ((primary_cca->pri_cca_flag == 1) || (primary_cca->dup_rts_flag == 1)) { + if (client_40mhz == 0) { /* client=20M no need to monitor primary cca flag */ + client_40mhz_pre = client_40mhz; + return; + } + counter++; + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("counter=%d\n", counter)); + if ((counter == 30) || ((client_40mhz - client_40mhz_pre) == 1)) { /* Every 60 sec to monitor one time */ + primary_cca->monitor_flag = 1; /* monitor flag is triggered!!!!! */ + if (primary_cca->pri_cca_flag == 1) { + primary_cca->pri_cca_flag = 0; + odm_set_bb_reg(p_dm, 0xc6c, BIT(8) | BIT(7), 0); + } + counter = 0; + } + } + } + + client_40mhz_pre = client_40mhz; +} +#endif + +#if (RTL8192E_SUPPORT == 1) + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +odm_dynamic_primary_cca_mp_8192e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *p_adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct phydm_fa_struct *false_alm_cnt = &(p_dm->false_alm_cnt); + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + u64 OFDM_CCA, OFDM_FA, bw_usc_cnt, bw_lsc_cnt; + u8 sec_ch_offset; + static u8 count_down = PRI_CCA_MONITOR_TIME; + + if (!p_dm->is_linked) + return; + + if (!(p_dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + OFDM_CCA = false_alm_cnt->cnt_ofdm_cca; + OFDM_FA = false_alm_cnt->cnt_ofdm_fail; + bw_usc_cnt = false_alm_cnt->cnt_bw_usc; + bw_lsc_cnt = false_alm_cnt->cnt_bw_lsc; + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: OFDM CCA=%d\n", OFDM_CCA)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: OFDM FA=%d\n", OFDM_FA)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: BW_USC=%d\n", bw_usc_cnt)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: BW_LSC=%d\n", bw_lsc_cnt)); + sec_ch_offset = *(p_dm->p_sec_ch_offset); /* NIC: 2: sec is below, 1: sec is above */ + + + if (IsAPModeExist(p_adapter)) { + phydm_write_dynamic_cca(p_dm, MF_USC_LSC); + return; + } + + if (*(p_dm->p_band_width) != CHANNEL_WIDTH_40) + return; + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: Cont Down= %d\n", count_down)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: Primary_CCA_flag=%d\n", primary_cca->pri_cca_flag)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: Intf_Type=%d\n", primary_cca->intf_type)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: Intf_flag=%d\n", primary_cca->intf_flag)); + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: Duplicate RTS Flag=%d\n", primary_cca->dup_rts_flag)); + + if (primary_cca->pri_cca_flag == 0) { + + if (sec_ch_offset == SECOND_CH_AT_LSB) { /* Primary channel is above NOTE: duplicate CTS can remove this condition */ + + if ((OFDM_CCA > OFDMCCA_TH) && (bw_lsc_cnt > (bw_usc_cnt + bw_ind_bias)) + && (OFDM_FA > (OFDM_CCA >> 1))) { + + primary_cca->intf_type = 1; + primary_cca->intf_flag = 1; + phydm_write_dynamic_cca(p_dm, MF_USC); + primary_cca->pri_cca_flag = 1; + } else if ((OFDM_CCA > OFDMCCA_TH) && (bw_lsc_cnt > (bw_usc_cnt + bw_ind_bias)) + && (OFDM_FA < (OFDM_CCA >> 1))) { + + primary_cca->intf_type = 2; + primary_cca->intf_flag = 1; + phydm_write_dynamic_cca(p_dm, MF_USC); + primary_cca->pri_cca_flag = 1; + primary_cca->dup_rts_flag = 1; + p_hal_data->RTSEN = 1; + } else { + + primary_cca->intf_type = 0; + primary_cca->intf_flag = 0; + phydm_write_dynamic_cca(p_dm, MF_USC_LSC); + p_hal_data->RTSEN = 0; + primary_cca->dup_rts_flag = 0; + } + + } else if (sec_ch_offset == SECOND_CH_AT_USB) { + + if ((OFDM_CCA > OFDMCCA_TH) && (bw_usc_cnt > (bw_lsc_cnt + bw_ind_bias)) + && (OFDM_FA > (OFDM_CCA >> 1))) { + + primary_cca->intf_type = 1; + primary_cca->intf_flag = 1; + phydm_write_dynamic_cca(p_dm, MF_LSC); + primary_cca->pri_cca_flag = 1; + } else if ((OFDM_CCA > OFDMCCA_TH) && (bw_usc_cnt > (bw_lsc_cnt + bw_ind_bias)) + && (OFDM_FA < (OFDM_CCA >> 1))) { + + primary_cca->intf_type = 2; + primary_cca->intf_flag = 1; + phydm_write_dynamic_cca(p_dm, MF_LSC); + primary_cca->pri_cca_flag = 1; + primary_cca->dup_rts_flag = 1; + p_hal_data->RTSEN = 1; + } else { + + primary_cca->intf_type = 0; + primary_cca->intf_flag = 0; + phydm_write_dynamic_cca(p_dm, MF_USC_LSC); + p_hal_data->RTSEN = 0; + primary_cca->dup_rts_flag = 0; + } + + } + + } else { /* primary_cca->pri_cca_flag==1 */ + + count_down--; + if (count_down == 0) { + count_down = PRI_CCA_MONITOR_TIME; + primary_cca->pri_cca_flag = 0; + phydm_write_dynamic_cca(p_dm, MF_USC_LSC); /* default */ + p_hal_data->RTSEN = 0; + primary_cca->dup_rts_flag = 0; + primary_cca->intf_type = 0; + primary_cca->intf_flag = 0; + } + + } +} + +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + +void +odm_intf_detection( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fa_struct *false_alm_cnt = &(p_dm->false_alm_cnt); + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + + if ((false_alm_cnt->cnt_ofdm_cca > OFDMCCA_TH) + && (false_alm_cnt->cnt_bw_lsc > (false_alm_cnt->cnt_bw_usc + bw_ind_bias))) { + + primary_cca->intf_flag = 1; + primary_cca->CH_offset = 1; /* 1:LSC, 2:USC */ + if (false_alm_cnt->cnt_ofdm_fail > (false_alm_cnt->cnt_ofdm_cca >> 1)) + primary_cca->intf_type = 1; + else + primary_cca->intf_type = 2; + } else if ((false_alm_cnt->cnt_ofdm_cca > OFDMCCA_TH) + && (false_alm_cnt->cnt_bw_usc > (false_alm_cnt->cnt_bw_lsc + bw_ind_bias))) { + + primary_cca->intf_flag = 1; + primary_cca->CH_offset = 2; /* 1:LSC, 2:USC */ + if (false_alm_cnt->cnt_ofdm_fail > (false_alm_cnt->cnt_ofdm_cca >> 1)) + primary_cca->intf_type = 1; + else + primary_cca->intf_type = 2; + } else { + primary_cca->intf_flag = 0; + primary_cca->intf_type = 0; + primary_cca->CH_offset = 0; + } + +} + +void +odm_dynamic_primary_cca_ap_8192e( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + u8 i; + static u32 count_down = PRI_CCA_MONITOR_TIME; + u8 STA_BW = false, STA_BW_pre = false, STA_BW_TMP = false; + boolean is_connected = false; + u8 sec_ch_offset; + u8 cur_mf_state; + struct cmn_sta_info *p_entry; + + if (!p_dm->is_linked) + return; + + if (!(p_dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + sec_ch_offset = *(p_dm->p_sec_ch_offset); /* AP: 1: sec is below, 2: sec is above */ + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + p_entry = p_dm->p_phydm_sta_info[i]; + if (is_sta_active(p_entry)) { + + STA_BW_TMP = p_entry->bw_mode; + if (STA_BW_TMP > STA_BW) + STA_BW = STA_BW_TMP; + is_connected = true; + } + } + + if (*(p_dm->p_band_width) == CHANNEL_WIDTH_40) { + + if (primary_cca->pri_cca_flag == 0) { + if (is_connected) { + if (STA_BW == CHANNEL_WIDTH_20) { /* 2 STA BW=20M */ + primary_cca->pri_cca_flag = 1; + if (sec_ch_offset == 1) { + cur_mf_state = MF_USC; + phydm_write_dynamic_cca(p_dm, cur_mf_state); + } else if (sec_ch_offset == 2) { + cur_mf_state = MF_USC; + phydm_write_dynamic_cca(p_dm, cur_mf_state); + } + } else { /* 2 STA BW=40M */ + if (primary_cca->intf_flag == 0) + odm_intf_detection(p_dm); + else { /* intf_flag = 1 */ + if (primary_cca->intf_type == 1) { + if (primary_cca->CH_offset == 1) { + cur_mf_state = MF_USC; + if (sec_ch_offset == 1) /* AP, 1: primary is above 2: primary is below */ + phydm_write_dynamic_cca(p_dm, cur_mf_state); + } else if (primary_cca->CH_offset == 2) { + cur_mf_state = MF_LSC; + if (sec_ch_offset == 2) + phydm_write_dynamic_cca(p_dm, cur_mf_state); + } + } else if (primary_cca->intf_type == 2) + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("92E: primary_cca->intf_type = 2\n")); + } + } + + } else /* disconnected interference detection */ + odm_intf_detection(p_dm); /* end of disconnected */ + + + } else { /* primary_cca->pri_cca_flag == 1 */ + + if (STA_BW == 0) { + STA_BW_pre = STA_BW; + return; + } + + count_down--; + if ((count_down == 0) || ((STA_BW & STA_BW_pre) != 1)) { + count_down = PRI_CCA_MONITOR_TIME; + primary_cca->pri_cca_flag = 0; + primary_cca->intf_type = 0; + primary_cca->intf_flag = 0; + cur_mf_state = MF_USC_LSC; + phydm_write_dynamic_cca(p_dm, cur_mf_state); /* default */ + } + } + STA_BW_pre = STA_BW; + + } else { + /* 2 Reset */ + phydm_primary_cca_init(p_dm); + cur_mf_state = MF_USC_LSC; + phydm_write_dynamic_cca(p_dm, cur_mf_state); + count_down = PRI_CCA_MONITOR_TIME; + } + +} +#endif + + +#endif /* RTL8192E_SUPPORT == 1 */ +#endif + + +#endif + +boolean +odm_dynamic_primary_cca_dup_rts( + void *p_dm_void +) +{ +#ifdef PHYDM_PRIMARY_CCA + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + + return primary_cca->dup_rts_flag; +#else + return 0; +#endif +} + +void +phydm_primary_cca_init( + void *p_dm_void +) +{ +#ifdef PHYDM_PRIMARY_CCA + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_pricca_struct *primary_cca = &(p_dm->dm_pri_cca); + + if (!(p_dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + PHYDM_DBG(p_dm, DBG_PRI_CCA, ("[PriCCA] Init ==>\n")); + #if (RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) + primary_cca->dup_rts_flag = 0; + primary_cca->intf_flag = 0; + primary_cca->intf_type = 0; + primary_cca->monitor_flag = 0; + primary_cca->pri_cca_flag = 0; + primary_cca->ch_offset = 0; + #endif + primary_cca->mf_state = 0xff; + primary_cca->pre_bw = (enum channel_width)0xff; + + if (p_dm->support_ic_type & ODM_IC_11N_SERIES) + primary_cca->cca_th_40m_bkp = (u8)odm_get_bb_reg(p_dm, 0xc84, 0xf0000000); +#endif +} + +void +phydm_primary_cca( + void *p_dm_void +) +{ +#ifdef PHYDM_PRIMARY_CCA + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ic_type & ODM_IC_11N_SERIES)) + return; + + if (!(p_dm->support_ability & ODM_BB_PRIMARY_CCA)) + return; + + phydm_primary_cca_11n(p_dm); + +#endif +} + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.h new file mode 100644 index 000000000000..6d41eec81eb4 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_primary_cca.h @@ -0,0 +1,117 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDM_PRIMARYCCA_H__ +#define __PHYDM_PRIMARYCCA_H__ + +#define PRIMARYCCA_VERSION "1.0" /*2017.03.23, Dino*/ + +/*============================================================*/ +/*Definition */ +/*============================================================*/ + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) +#define SECOND_CH_AT_LSB 2 /*primary CH @ MSB, SD4: HAL_PRIME_CHNL_OFFSET_UPPER*/ +#define SECOND_CH_AT_USB 1 /*primary CH @ LSB, SD4: HAL_PRIME_CHNL_OFFSET_LOWER*/ +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#define SECOND_CH_AT_LSB 2 /*primary CH @ MSB, SD7: HAL_PRIME_CHNL_OFFSET_UPPER*/ +#define SECOND_CH_AT_USB 1 /*primary CH @ LSB, SD7: HAL_PRIME_CHNL_OFFSET_LOWER*/ +#else /*if (DM_ODM_SUPPORT_TYPE == ODM_AP)*/ +#define SECOND_CH_AT_LSB 1 /*primary CH @ MSB, SD8: HT_2NDCH_OFFSET_BELOW*/ +#define SECOND_CH_AT_USB 2 /*primary CH @ LSB, SD8: HT_2NDCH_OFFSET_ABOVE*/ +#endif + +#define OFDMCCA_TH 500 +#define bw_ind_bias 500 +#define PRI_CCA_MONITOR_TIME 30 + +#ifdef PHYDM_PRIMARY_CCA + +/*============================================================*/ +/*structure and define*/ +/*============================================================*/ +enum primary_cca_ch_position { /*N-series REG0xc6c[8:7]*/ + MF_USC_LSC = 0, + MF_LSC = 1, + MF_USC = 2 +}; + +struct phydm_pricca_struct { + + #if (RTL8188E_SUPPORT == 1) || (RTL8192E_SUPPORT == 1) + u8 pri_cca_flag; + u8 intf_flag; + u8 intf_type; + u8 monitor_flag; + u8 ch_offset; + #endif + u8 dup_rts_flag; + u8 cca_th_40m_bkp; /*c84[31:28]*/ + enum channel_width pre_bw; + u8 pri_cca_is_become_linked; + u8 mf_state; +}; + +/*============================================================*/ +/*function prototype*/ +/*============================================================*/ + +#if 0 +#if (RTL8192E_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +odm_dynamic_primary_cca_mp_8192e( + void *p_dm_void +); + +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + +void +odm_dynamic_primary_cca_ap_8192e( + void *p_dm_void +); +#endif +#endif + +#if (RTL8188E_SUPPORT == 1) + +void +odm_dynamic_primary_cca_8188e( + void *p_dm_void +); +#endif +#endif + +#endif /*#ifdef PHYDM_PRIMARY_CCA*/ + + +boolean +odm_dynamic_primary_cca_dup_rts( + void *p_dm_void +); + +void +phydm_primary_cca_init( + void *p_dm_void +); + +void +phydm_primary_cca( + void *p_dm_void +); + + +#endif /*#ifndef __PHYDM_PRIMARYCCA_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.c new file mode 100644 index 000000000000..7ff50f2e590b --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.c @@ -0,0 +1,393 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files +//============================================================ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef CONFIG_PSD_TOOL + +u32 +phydm_get_psd_data( + void *p_dm_void, + u32 psd_tone_idx, + u32 igi + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _PHYDM_PSD_ *p_dm_psd_table = &(p_dm->dm_psd_table); + u32 psd_report = 0; + + odm_set_bb_reg(p_dm, p_dm_psd_table->psd_reg, 0x3ff, psd_tone_idx); + + odm_set_bb_reg(p_dm, p_dm_psd_table->psd_reg, BIT(22), 1); /*PSD trigger start*/ + ODM_delay_us(10); + odm_set_bb_reg(p_dm, p_dm_psd_table->psd_reg, BIT(22), 0); /*PSD trigger stop*/ + + psd_report = odm_get_bb_reg(p_dm, p_dm_psd_table->psd_report_reg, 0xffff); + psd_report = odm_convert_to_db(psd_report) + igi; + + return psd_report; +} + +u8 psd_result_cali_tone_8821[7]= {21, 28, 33, 93, 98, 105, 127}; +u8 psd_result_cali_val_8821[7] = {67,69,71,72,71,69,67}; + +void +phydm_psd( + void *p_dm_void, + u32 igi, + u16 start_point, + u16 stop_point + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _PHYDM_PSD_ *p_dm_psd_table = &(p_dm->dm_psd_table); + u32 i = 0, mod_tone_idx; + u32 t = 0; + u16 fft_max_half_bw; + u32 psd_igi_a_reg; + u32 psd_igi_b_reg; + u16 psd_fc_channel = p_dm_psd_table->psd_fc_channel; + u8 ag_rf_mode_reg = 0; + u8 rf_reg18_9_8 = 0; + u32 psd_result_tmp = 0; + u8 psd_result = 0; + u8 psd_result_cali_tone[7] = {0}; + u8 psd_result_cali_val[7] = {0}; + u8 noise_table_idx = 0; + u8 set_result; + + if (p_dm->support_ic_type == ODM_RTL8821) { + odm_move_memory(p_dm, psd_result_cali_tone, psd_result_cali_tone_8821, 7); + odm_move_memory(p_dm, psd_result_cali_val, psd_result_cali_val_8821, 7); + } + + p_dm_psd_table->psd_in_progress = 1; + + /*[Stop DIG]*/ + p_dm->support_ability &= ~(ODM_BB_DIG); + p_dm->support_ability &= ~(ODM_BB_FA_CNT); + + + + PHYDM_DBG(p_dm, ODM_COMP_API, ("PSD Start =>\n")); + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + psd_igi_a_reg = 0xc50; + psd_igi_b_reg = 0xe50; + } else { + psd_igi_a_reg = 0xc50; + psd_igi_b_reg = 0xc58; + } + + /*[back up IGI]*/ + p_dm_psd_table->initial_gain_backup = odm_get_bb_reg(p_dm, psd_igi_a_reg, 0xff); + odm_set_bb_reg(p_dm, psd_igi_a_reg, 0xff, 0x6e); /*IGI target at 0dBm & make it can't CCA*/ + odm_set_bb_reg(p_dm, psd_igi_b_reg, 0xff, 0x6e); /*IGI target at 0dBm & make it can't CCA*/ + ODM_delay_us(10); + + if (phydm_stop_ic_trx(p_dm, PHYDM_SET) == PHYDM_SET_FAIL) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("STOP_TRX_FAIL\n")); + return; + } + + /*[Set IGI]*/ + odm_set_bb_reg(p_dm, psd_igi_a_reg, 0xff, igi); + odm_set_bb_reg(p_dm, psd_igi_b_reg, 0xff, igi); + + /*[Backup RF Reg]*/ + p_dm_psd_table->rf_0x18_bkp = odm_get_rf_reg(p_dm, RF_PATH_A, 0x18, RFREGOFFSETMASK); + p_dm_psd_table->rf_0x18_bkp_b = odm_get_rf_reg(p_dm, RF_PATH_B, 0x18, RFREGOFFSETMASK); + + if (psd_fc_channel > 14) { + + rf_reg18_9_8 = 1; + + if (36 <= psd_fc_channel && psd_fc_channel <= 64) + ag_rf_mode_reg = 0x1; + else if (100 <= psd_fc_channel && psd_fc_channel <= 140) + ag_rf_mode_reg = 0x3; + else if (140 < psd_fc_channel) + ag_rf_mode_reg = 0x5; + } + + /* RF path-a */ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x18, 0xff, psd_fc_channel); /* Set RF fc*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x18, 0x300, rf_reg18_9_8); + odm_set_rf_reg(p_dm, RF_PATH_A, 0x18, 0xc00, p_dm_psd_table->psd_bw_rf_reg); /*2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x18, 0xf0000, ag_rf_mode_reg); /* Set RF ag fc mode*/ + + /* RF path-b */ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x18, 0xff, psd_fc_channel); /* Set RF fc*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x18, 0x300, rf_reg18_9_8); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x18, 0xc00, p_dm_psd_table->psd_bw_rf_reg); /*2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x18, 0xf0000, ag_rf_mode_reg); /* Set RF ag fc mode*/ + + PHYDM_DBG(p_dm, ODM_COMP_API, ("0xc50=((0x%x))\n", odm_get_bb_reg(p_dm, 0xc50, MASKDWORD))); + /*PHYDM_DBG(p_dm, ODM_COMP_API, ("RF0x0=((0x%x))\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x0, RFREGOFFSETMASK)));*/ + PHYDM_DBG(p_dm, ODM_COMP_API, ("RF0x18=((0x%x))\n", odm_get_rf_reg(p_dm, RF_PATH_A, 0x18, RFREGOFFSETMASK))); + + /*[Stop 3-wires]*/ + phydm_stop_3_wire(p_dm, PHYDM_SET); + + ODM_delay_us(10); + + if (stop_point > (p_dm_psd_table->fft_smp_point-1)) + stop_point = (p_dm_psd_table->fft_smp_point-1); + + if (start_point > (p_dm_psd_table->fft_smp_point-1)) + start_point = (p_dm_psd_table->fft_smp_point-1); + + if (start_point > stop_point) + stop_point = start_point; + + + for (i = start_point; i <= stop_point; i++ ) { + + fft_max_half_bw = (p_dm_psd_table->fft_smp_point)>>1; + + if (i < fft_max_half_bw) { + mod_tone_idx = i + fft_max_half_bw; + } else { + mod_tone_idx = i - fft_max_half_bw; + } + + psd_result_tmp = 0; + for (t = 0; t < p_dm_psd_table->sw_avg_time; t++) { + psd_result_tmp += phydm_get_psd_data(p_dm, mod_tone_idx, igi); + /**/ + } + psd_result = (u8)((psd_result_tmp/p_dm_psd_table->sw_avg_time)) - p_dm_psd_table->psd_pwr_common_offset; + + if( p_dm_psd_table->fft_smp_point == 128 && (p_dm_psd_table->noise_k_en)) { + + if (i > psd_result_cali_tone[noise_table_idx]) { + noise_table_idx ++; + } + + if (noise_table_idx > 6) + noise_table_idx = 6; + + if (psd_result >= psd_result_cali_val[noise_table_idx]) + psd_result = psd_result - psd_result_cali_val[noise_table_idx]; + else + psd_result = 0; + + + p_dm_psd_table->psd_result[i] = psd_result; + } + + PHYDM_DBG(p_dm, ODM_COMP_API, ("[%d] N_cali = %d, PSD = %d\n", mod_tone_idx, psd_result_cali_val[noise_table_idx], psd_result)); + + } + + /*[Start 3-wires]*/ + phydm_stop_3_wire(p_dm, PHYDM_REVERT); + + ODM_delay_us(10); + + /*[Revert Reg]*/ + set_result = phydm_stop_ic_trx(p_dm, PHYDM_REVERT); + + odm_set_bb_reg(p_dm, psd_igi_a_reg, 0xff, p_dm_psd_table->initial_gain_backup); + odm_set_bb_reg(p_dm, psd_igi_b_reg, 0xff, p_dm_psd_table->initial_gain_backup); + + odm_set_rf_reg(p_dm, RF_PATH_A, 0x18, RFREGOFFSETMASK, p_dm_psd_table->rf_0x18_bkp); + odm_set_rf_reg(p_dm, RF_PATH_B, 0x18, RFREGOFFSETMASK, p_dm_psd_table->rf_0x18_bkp_b); + + PHYDM_DBG(p_dm, ODM_COMP_API, ("PSD finished\n\n")); + + p_dm->support_ability |= ODM_BB_DIG; + p_dm->support_ability |= ODM_BB_FA_CNT; + p_dm_psd_table->psd_in_progress = 0; + + +} + +void +phydm_psd_para_setting( + void *p_dm_void, + u8 sw_avg_time, + u8 hw_avg_time, + u8 i_q_setting, + u16 fft_smp_point, + u8 ant_sel, + u8 psd_input, + u8 channel, + u8 noise_k_en + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _PHYDM_PSD_ *p_dm_psd_table = &(p_dm->dm_psd_table); + u8 fft_smp_point_idx = 0; + + p_dm_psd_table->fft_smp_point = fft_smp_point; + + if (sw_avg_time == 0) + sw_avg_time = 1; + + p_dm_psd_table->sw_avg_time = sw_avg_time; + p_dm_psd_table->psd_fc_channel = channel; + p_dm_psd_table->noise_k_en = noise_k_en; + + if (fft_smp_point == 128) + fft_smp_point_idx = 0; + else if (fft_smp_point == 256) + fft_smp_point_idx = 1; + else if (fft_smp_point == 512) + fft_smp_point_idx = 2; + else if (fft_smp_point == 1024) + fft_smp_point_idx = 3; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + odm_set_bb_reg(p_dm, 0x910, BIT(11) | BIT(10), i_q_setting); + odm_set_bb_reg(p_dm, 0x910, BIT(13) | BIT(12), hw_avg_time); + odm_set_bb_reg(p_dm, 0x910, BIT(15) | BIT(14), fft_smp_point_idx); + odm_set_bb_reg(p_dm, 0x910, BIT(17) | BIT(16), ant_sel); + odm_set_bb_reg(p_dm, 0x910, BIT(23), psd_input); + + } else { + + } + + /*bw = (*p_dm->p_band_width); //ODM_BW20M */ + /*channel = *(p_dm->p_channel);*/ + + + + +} + +void +phydm_psd_init( + void *p_dm_void + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _PHYDM_PSD_ *p_dm_psd_table = &(p_dm->dm_psd_table); + + PHYDM_DBG(p_dm, ODM_COMP_API, ("PSD para init\n")); + + p_dm_psd_table->psd_in_progress = false; + + if (p_dm->support_ic_type & ODM_IC_11AC_SERIES) { + + p_dm_psd_table->psd_reg = 0x910; + p_dm_psd_table->psd_report_reg = 0xF44; + + if (ODM_IC_11AC_2_SERIES) + p_dm_psd_table->psd_bw_rf_reg = 1; /*2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + else + p_dm_psd_table->psd_bw_rf_reg = 2; /*2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + + } else { + + p_dm_psd_table->psd_reg = 0x808; + p_dm_psd_table->psd_report_reg = 0x8B4; + p_dm_psd_table->psd_bw_rf_reg = 2; /*2b'11: 20MHz, 2b'10: 40MHz, 2b'01: 80MHz */ + } + + if (p_dm->support_ic_type == ODM_RTL8812) + p_dm_psd_table->psd_pwr_common_offset = 0; + else if (p_dm->support_ic_type == ODM_RTL8821) + p_dm_psd_table->psd_pwr_common_offset = 0; + else + p_dm_psd_table->psd_pwr_common_offset = 0; + + phydm_psd_para_setting(p_dm, 1, 2, 3, 128, 0, 0, 7, 0); + /*phydm_psd(p_dm, 0x3c, 0, 127);*/ /* target at -50dBm */ + + +} + +void +phydm_psd_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u8 i; + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "{0} {sw_avg} {hw_avg 0:3} {1:I,2:Q,3:IQ} {fft_point: 128*(1:4)} {path_sel 0~3} {0:ADC, 1:RXIQC} {CH} {noise_k}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{1} {IGI(hex)} {start_point} {stop_point}\n")); + + } else { + + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if (var1[0] == 0) { + + for (i = 1; i < 10; i++) { + if (input[i + 1]) { + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + } + + PHYDM_SNPRINTF((output + used, out_len - used, "sw_avg_time=((%d)), hw_avg_time=((%d)), IQ=((%d)), fft=((%d)), path=((%d)), input =((%d)) ch=((%d)), noise_k=((%d))\n", + var1[1], var1[2], var1[3], var1[4], var1[5], var1[6], (u8)var1[7], (u8)var1[8])); + phydm_psd_para_setting(p_dm, (u8)var1[1], (u8)var1[2], (u8)var1[3], (u16)var1[4], (u8)var1[5], (u8)var1[6], (u8)var1[7], (u8)var1[8]); + + } else if (var1[0] == 1) { + + PHYDM_SSCANF(input[2], DCMD_HEX, &var1[1]); + PHYDM_SSCANF(input[3], DCMD_DECIMAL, &var1[2]); + PHYDM_SSCANF(input[4], DCMD_DECIMAL, &var1[3]); + PHYDM_SNPRINTF((output + used, out_len - used, "IGI=((0x%x)), start_point=((%d)), stop_point=((%d))\n", var1[1], var1[2], var1[3])); + p_dm->debug_components |= ODM_COMP_API; + phydm_psd(p_dm, var1[1], (u16)var1[2], (u16)var1[3]); + p_dm->debug_components &= (~ODM_COMP_API); + } + + } + + *_used = used; + *_out_len = out_len; + +} + +u8 +phydm_get_psd_result_table( + void *p_dm_void, + int index + ) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _PHYDM_PSD_ *p_dm_psd_table = &(p_dm->dm_psd_table); + u8 temp_result = 0; + + if(index<128) + temp_result = p_dm_psd_table->psd_result[index]; + + return temp_result; + +} + +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.h new file mode 100644 index 000000000000..0bde88a49138 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_psd.h @@ -0,0 +1,93 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMPSD_H__ +#define __PHYDMPSD_H__ + +/*#define PSD_VERSION "1.0"*/ /*2016.09.22 Dino*/ +#define PSD_VERSION "1.1" /*2016.10.07 Dino, Add Option for PSD Tone index Selection */ + +#ifdef CONFIG_PSD_TOOL + + +struct _PHYDM_PSD_ { + + u8 psd_in_progress; + u32 psd_reg; + u32 psd_report_reg; + u8 psd_pwr_common_offset; + u16 sw_avg_time; + u16 fft_smp_point; + u32 initial_gain_backup; + u32 rf_0x18_bkp; + u32 rf_0x18_bkp_b; + u16 psd_fc_channel; + u32 psd_bw_rf_reg; + u8 psd_result[128]; + u8 noise_k_en; +}; + +u32 +phydm_get_psd_data( + void *p_dm_void, + u32 psd_tone_idx, + u32 igi +); + +void +phydm_psd_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +void +phydm_psd( + void *p_dm_void, + u32 igi, + u16 start_point, + u16 stop_point +); + +void +phydm_psd_para_setting( + void *p_dm_void, + u8 sw_avg_time, + u8 hw_avg_time, + u8 i_q_setting, + u16 fft_smp_point, + u8 ant_sel, + u8 psd_input, + u8 channel, + u8 noise_k_en +); + +void +phydm_psd_init( + void *p_dm_void +); + +u8 +phydm_get_psd_result_table( + void *p_dm_void, + int index +); + +#endif +#endif + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.c index 51a2220a2a6a..9b953b7d0e80 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.c @@ -1,3420 +1,2342 @@ -/****************************************************************************** - * - * 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 files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -VOID -phydm_h2C_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte H2C_Parameter[H2C_MAX_LENGTH] = {0}; - u1Byte phydm_h2c_id = (u1Byte)dm_value[0]; - u1Byte i; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - PHYDM_SNPRINTF((output+used, out_len-used, "Phydm Send H2C_ID (( 0x%x))\n", phydm_h2c_id)); - for (i = 0; i < H2C_MAX_LENGTH; i++) { - - H2C_Parameter[i] = (u1Byte)dm_value[i+1]; - PHYDM_SNPRINTF((output+used, out_len-used, "H2C: Byte[%d] = ((0x%x))\n", i, H2C_Parameter[i])); - } - - ODM_FillH2CCmd(pDM_Odm, phydm_h2c_id, H2C_MAX_LENGTH, H2C_Parameter); - -} - -#if (defined(CONFIG_RA_DBG_CMD)) -VOID -odm_RA_ParaAdjust_Send_H2C( - IN PVOID pDM_VOID -) -{ - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte H2C_Parameter[6] = {0}; - - H2C_Parameter[0] = RA_FIRST_MACID; - - if (pRA_Table->RA_Para_feedback_req) { /*H2C_Parameter[5]=1 ; ask FW for all RA parameters*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Ask FW for RA parameter\n")); - H2C_Parameter[5] |= BIT1; /*ask FW to report RA parameters*/ - H2C_Parameter[1] = pRA_Table->para_idx; /*pRA_Table->para_idx;*/ - pRA_Table->RA_Para_feedback_req = 0; - } else { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[H2C] Send H2C to FW for modifying RA parameter\n")); - - H2C_Parameter[1] = pRA_Table->para_idx; - H2C_Parameter[2] = pRA_Table->rate_idx; - /* [8 bit]*/ - if (pRA_Table->para_idx == RADBG_RTY_PENALTY || pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO || pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { - H2C_Parameter[3] = pRA_Table->value; - H2C_Parameter[4] = 0; - } - /* [16 bit]*/ - else { - H2C_Parameter[3] = (u1Byte)(((pRA_Table->value_16) & 0xf0) >> 4); /*byte1*/ - H2C_Parameter[4] = (u1Byte)((pRA_Table->value_16) & 0x0f); /*byte0*/ - } - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[1] = 0x%x\n", H2C_Parameter[1])); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[2] = 0x%x\n", H2C_Parameter[2])); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[3] = 0x%x\n", H2C_Parameter[3])); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[4] = 0x%x\n", H2C_Parameter[4])); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" H2C_Parameter[5] = 0x%x\n", H2C_Parameter[5])); - - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RA_PARA_ADJUST, 6, H2C_Parameter); - -} - - -VOID -odm_RA_ParaAdjust( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte rate_idx = pRA_Table->rate_idx; - u1Byte value = pRA_Table->value; - u1Byte Pre_value = 0xff; - - if (pRA_Table->para_idx == RADBG_RTY_PENALTY) { - Pre_value = pRA_Table->RTY_P[rate_idx]; - pRA_Table->RTY_P[rate_idx] = value; - pRA_Table->RTY_P_modify_note[rate_idx] = 1; - } else if (pRA_Table->para_idx == RADBG_N_HIGH) { - - } else if (pRA_Table->para_idx == RADBG_N_LOW) { - - } else if (pRA_Table->para_idx == RADBG_RATE_UP_RTY_RATIO) { - Pre_value = pRA_Table->RATE_UP_RTY_RATIO[rate_idx]; - pRA_Table->RATE_UP_RTY_RATIO[rate_idx] = value; - pRA_Table->RATE_UP_RTY_RATIO_modify_note[rate_idx] = 1; - } else if (pRA_Table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { - Pre_value = pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx]; - pRA_Table->RATE_DOWN_RTY_RATIO[rate_idx] = value; - pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[rate_idx] = 1; - } - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("Change RA Papa[%d], Rate[ %d ], ((%d)) -> ((%d))\n", pRA_Table->para_idx, rate_idx, Pre_value, value)); - odm_RA_ParaAdjust_Send_H2C(pDM_Odm); -} - -VOID -phydm_ra_print_msg( - IN PVOID pDM_VOID, - IN u1Byte *value, - IN u1Byte *value_default, - IN u1Byte *modify_note -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u4Byte i; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate index| |Current-value| |Default-value| |Modify?|\n")); - for (i = 0 ; i <= (pRA_Table->rate_length); i++) { -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %20d %25d %20s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); -#else - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [ %d ] %10d %14d %14s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); -#endif - } - -} - -VOID -odm_RA_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - - pRA_Table->is_ra_dbg_init = FALSE; - - if (dm_value[0] == 100) { /*1 Print RA Parameters*/ - u1Byte default_pointer_value; - u1Byte *pvalue; - u1Byte *pvalue_default; - u1Byte *pmodify_note; - - pvalue = pvalue_default = pmodify_note = &default_pointer_value; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n")); - - if (dm_value[1] == RADBG_RTY_PENALTY) { /* [1]*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [1] RTY_PENALTY\n")); - pvalue = &(pRA_Table->RTY_P[0]); - pvalue_default = &(pRA_Table->RTY_P_default[0]); - pmodify_note = (u1Byte *)&(pRA_Table->RTY_P_modify_note[0]); - } else if (dm_value[1] == RADBG_N_HIGH) { /* [2]*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [2] N_HIGH\n")); - - } else if (dm_value[1] == RADBG_N_LOW) { /*[3]*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [3] N_LOW\n")); - - } else if (dm_value[1] == RADBG_RATE_UP_RTY_RATIO) { /* [8]*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [8] RATE_UP_RTY_RATIO\n")); - pvalue = &(pRA_Table->RATE_UP_RTY_RATIO[0]); - pvalue_default = &(pRA_Table->RATE_UP_RTY_RATIO_default[0]); - pmodify_note = (u1Byte *)&(pRA_Table->RATE_UP_RTY_RATIO_modify_note[0]); - } else if (dm_value[1] == RADBG_RATE_DOWN_RTY_RATIO) { /* [9]*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" [9] RATE_DOWN_RTY_RATIO\n")); - pvalue = &(pRA_Table->RATE_DOWN_RTY_RATIO[0]); - pvalue_default = &(pRA_Table->RATE_DOWN_RTY_RATIO_default[0]); - pmodify_note = (u1Byte *)&(pRA_Table->RATE_DOWN_RTY_RATIO_modify_note[0]); - } - - phydm_ra_print_msg(pDM_Odm, pvalue, pvalue_default, pmodify_note); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("\n------------------------------------------------------------------------------------\n\n")); - - } else if (dm_value[0] == 101) { - pRA_Table->para_idx = (u1Byte)dm_value[1]; - - pRA_Table->RA_Para_feedback_req = 1; - odm_RA_ParaAdjust_Send_H2C(pDM_Odm); - } else { - pRA_Table->para_idx = (u1Byte)dm_value[0]; - pRA_Table->rate_idx = (u1Byte)dm_value[1]; - pRA_Table->value = (u1Byte)dm_value[2]; - - odm_RA_ParaAdjust(pDM_Odm); - } -} - -VOID -odm_RA_ParaAdjust_init( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte i; - u1Byte ra_para_pool_u8[3] = { RADBG_RTY_PENALTY, RADBG_RATE_UP_RTY_RATIO, RADBG_RATE_DOWN_RTY_RATIO}; - u1Byte RateSize_HT_1ss = 20, RateSize_HT_2ss = 28, RateSize_HT_3ss = 36; /*4+8+8+8+8 =36*/ - u1Byte RateSize_VHT_1ss = 10, RateSize_VHT_2ss = 20, RateSize_VHT_3ss = 30; /*10 + 10 +10 =30*/ - /* - RTY_PENALTY = 1, //u8 - N_HIGH = 2, - N_LOW = 3, - RATE_UP_TABLE = 4, - RATE_DOWN_TABLE = 5, - TRYING_NECESSARY = 6, - DROPING_NECESSARY = 7, - RATE_UP_RTY_RATIO = 8, //u8 - RATE_DOWN_RTY_RATIO= 9, //u8 - ALL_PARA = 0xff - - */ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("odm_RA_ParaAdjust_init\n")); - - if (pDM_Odm->SupportICType & (ODM_RTL8188F | ODM_RTL8195A | ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8723D)) - pRA_Table->rate_length = RateSize_HT_1ss; - else if (pDM_Odm->SupportICType & (ODM_RTL8192E | ODM_RTL8197F)) - pRA_Table->rate_length = RateSize_HT_2ss; - else if (pDM_Odm->SupportICType & (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8821C)) - pRA_Table->rate_length = RateSize_HT_1ss + RateSize_VHT_1ss; - else if (pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8822B)) - pRA_Table->rate_length = RateSize_HT_2ss + RateSize_VHT_2ss; - else if (pDM_Odm->SupportICType == ODM_RTL8814A) - pRA_Table->rate_length = RateSize_HT_3ss + RateSize_VHT_3ss; - else - pRA_Table->rate_length = RateSize_HT_1ss; - - pRA_Table->is_ra_dbg_init = TRUE; - for (i = 0; i < 3; i++) { - pRA_Table->RA_Para_feedback_req = 1; - pRA_Table->para_idx = ra_para_pool_u8[i]; - odm_RA_ParaAdjust_Send_H2C(pDM_Odm); - } -} - -#else - -VOID -phydm_RA_debug_PCR( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u4Byte used = *_used; - u4Byte out_len = *_out_len; - - if (dm_value[0] == 100) { - PHYDM_SNPRINTF((output+used, out_len-used, "[Get] PCR RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); - /**/ - } else if (dm_value[0] == 0) { - pRA_Table->RA_offset_direction = 0; - pRA_Table->RA_threshold_offset = (u1Byte)dm_value[1]; - PHYDM_SNPRINTF((output+used, out_len-used, "[Set] PCR RA_threshold_offset = (( -%d ))\n", pRA_Table->RA_threshold_offset)); - } else if (dm_value[0] == 1) { - pRA_Table->RA_offset_direction = 1; - pRA_Table->RA_threshold_offset = (u1Byte)dm_value[1]; - PHYDM_SNPRINTF((output+used, out_len-used, "[Set] PCR RA_threshold_offset = (( +%d ))\n", pRA_Table->RA_threshold_offset)); - } else { - PHYDM_SNPRINTF((output+used, out_len-used, "[Set] Error\n")); - /**/ - } - -} - -#endif /*#if (defined(CONFIG_RA_DBG_CMD))*/ - -VOID -ODM_C2HRaParaReportHandler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - - u1Byte para_idx = CmdBuf[0]; /*Retry Penalty, NH, NL*/ - u1Byte RateTypeStart = CmdBuf[1]; - u1Byte RateTypeLength = CmdLen - 2; - u1Byte i; - - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[ From FW C2H RA Para ] CmdBuf[0]= (( %d ))\n", CmdBuf[0])); - -#if (defined(CONFIG_RA_DBG_CMD)) - if (para_idx == RADBG_RTY_PENALTY) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |RTY Penality Index|\n")); - - for (i = 0 ; i < (RateTypeLength) ; i++) { - if (pRA_Table->is_ra_dbg_init) - pRA_Table->RTY_P_default[RateTypeStart + i] = CmdBuf[2 + i]; - - pRA_Table->RTY_P[RateTypeStart + i] = CmdBuf[2 + i]; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d \n", (RateTypeStart + i), pRA_Table->RTY_P[RateTypeStart + i])); - } - - } else if (para_idx == RADBG_N_HIGH) { - /**/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-High|\n")); - - - } else if (para_idx == RADBG_N_LOW) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |N-Low|\n")); - /**/ - } - else if (para_idx == RADBG_RATE_UP_RTY_RATIO) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Up RTY Ratio|\n")); - - for (i = 0; i < (RateTypeLength); i++) { - if (pRA_Table->is_ra_dbg_init) - pRA_Table->RATE_UP_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; - - pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d\n", (RateTypeStart + i), pRA_Table->RATE_UP_RTY_RATIO[RateTypeStart + i])); - } - } else if (para_idx == RADBG_RATE_DOWN_RTY_RATIO) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" |Rate Index| |Rate Down RTY Ratio|\n")); - - for (i = 0; i < (RateTypeLength); i++) { - if (pRA_Table->is_ra_dbg_init) - pRA_Table->RATE_DOWN_RTY_RATIO_default[RateTypeStart + i] = CmdBuf[2 + i]; - - pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i] = CmdBuf[2 + i]; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("%8d %15d\n", (RateTypeStart + i), pRA_Table->RATE_DOWN_RTY_RATIO[RateTypeStart + i])); - } - } else -#endif - if (para_idx == RADBG_DEBUG_MONITOR1) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { - - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", CmdBuf[1])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Rate =", CmdBuf[2] & 0x7f)); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI =", (CmdBuf[2] & 0x80) >> 7)); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW =", CmdBuf[3])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "BW_max =", CmdBuf[4])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate0 =", CmdBuf[5])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "multi_rate1 =", CmdBuf[6])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", CmdBuf[7])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", CmdBuf[8])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "SGI_support =", CmdBuf[9])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "try_ness =", CmdBuf[10])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "pre_rate =", CmdBuf[11])); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RSSI =", CmdBuf[1])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x\n", "BW =", CmdBuf[2])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "DISRA =", CmdBuf[3])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "VHT_EN =", CmdBuf[4])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Hightest Rate =", CmdBuf[5])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Lowest Rate =", CmdBuf[6])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "SGI_support =", CmdBuf[7])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Rate_ID =", CmdBuf[8]));; - } - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - } else if (para_idx == RADBG_DEBUG_MONITOR2) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - if (pDM_Odm->SupportICType & PHYDM_IC_3081_SERIES) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "RateID =", CmdBuf[1])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest_rate =", CmdBuf[2])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "lowest_rate =", CmdBuf[3])); - - for (i = 4; i <= 11; i++) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("RAMASK = 0x%x\n", CmdBuf[i])); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %x%x %x%x %x%x %x%x\n", "RA Mask:", - CmdBuf[8], CmdBuf[7], CmdBuf[6], CmdBuf[5], CmdBuf[4], CmdBuf[3], CmdBuf[2], CmdBuf[1])); - } - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("-------------------------------\n")); - } else if (para_idx == RADBG_DEBUG_MONITOR3) { - - for (i = 0; i < (CmdLen - 1); i++) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("content[%d] = %d\n", i, CmdBuf[1 + i])); - } else if (para_idx == RADBG_DEBUG_MONITOR4) - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {%d.%d}\n", "RA Version =", CmdBuf[1], CmdBuf[2])); - else if (para_idx == RADBG_DEBUG_MONITOR5) { - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "Current rate =", CmdBuf[1])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Retry ratio =", CmdBuf[2])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s %d\n", "Rate down ratio =", CmdBuf[3])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x\n", "highest rate =", CmdBuf[4])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s {0x%x 0x%x}\n", "Muti-try =", CmdBuf[5], CmdBuf[6])); - ODM_RT_TRACE(pDM_Odm, ODM_FW_DEBUG_TRACE, ODM_DBG_LOUD, ("%5s 0x%x%x%x%x%x\n", "RA mask =", CmdBuf[11], CmdBuf[10], CmdBuf[9], CmdBuf[8], CmdBuf[7])); - } -} - -VOID -phydm_ra_dynamic_retry_count( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - PSTA_INFO_T pEntry; - u1Byte i, retry_offset; - u4Byte ma_rx_tp; - - if (!(pDM_Odm->SupportAbility & ODM_BB_DYNAMIC_ARFR)) { - return; - } - - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("pDM_Odm->pre_b_noisy = %d\n", pDM_Odm->pre_b_noisy ));*/ - if (pDM_Odm->pre_b_noisy != pDM_Odm->NoisyDecision) { - - if (pDM_Odm->NoisyDecision) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Noisy Env. RA fallback value\n")); - ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x0); - ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x04030201); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("->Clean Env. RA fallback value\n")); - ODM_SetMACReg(pDM_Odm, 0x430, bMaskDWord, 0x01000000); - ODM_SetMACReg(pDM_Odm, 0x434, bMaskDWord, 0x06050402); - } - pDM_Odm->pre_b_noisy = pDM_Odm->NoisyDecision; - } -} - -#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) - -VOID -phydm_retry_limit_table_bound( - IN PVOID pDM_VOID, - IN u1Byte *retry_limit, - IN u1Byte offset -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - - if (*retry_limit > offset) { - - *retry_limit -= offset; - - if (*retry_limit < pRA_Table->retrylimit_low) - *retry_limit = pRA_Table->retrylimit_low; - else if (*retry_limit > pRA_Table->retrylimit_high) - *retry_limit = pRA_Table->retrylimit_high; - } else - *retry_limit = pRA_Table->retrylimit_low; -} - -VOID -phydm_reset_retry_limit_table( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte i; - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) /*support all IC platform*/ - - #else - #if ((RTL8192E_SUPPORT == 1) || (RTL8723B_SUPPORT == 1) || (RTL8188E_SUPPORT == 1)) - u1Byte per_rate_retrylimit_table_20M[ODM_RATEMCS15+1] = { - 1, 1, 2, 4, /*CCK*/ - 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ - 2, 4, 6, 8, 12, 18, 20, 22, /*20M HT-1SS*/ - 2, 4, 6, 8, 12, 18, 20, 22 /*20M HT-2SS*/ - }; - u1Byte per_rate_retrylimit_table_40M[ODM_RATEMCS15+1] = { - 1, 1, 2, 4, /*CCK*/ - 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ - 4, 8, 12, 16, 24, 32, 32, 32, /*40M HT-1SS*/ - 4, 8, 12, 16, 24, 32, 32, 32 /*40M HT-2SS*/ - }; - - #elif (RTL8821A_SUPPORT == 1) || (RTL8881A_SUPPORT == 1) - - #elif (RTL8812A_SUPPORT == 1) - - #elif(RTL8814A_SUPPORT == 1) - - #else - - #endif - #endif - - memcpy(&(pRA_Table->per_rate_retrylimit_20M[0]), &(per_rate_retrylimit_table_20M[0]), ODM_NUM_RATE_IDX); - memcpy(&(pRA_Table->per_rate_retrylimit_40M[0]), &(per_rate_retrylimit_table_40M[0]), ODM_NUM_RATE_IDX); - - for (i = 0; i < ODM_NUM_RATE_IDX; i++) { - phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), 0); - phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), 0); - } -} - -VOID -phydm_ra_dynamic_retry_limit_init( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - - pRA_Table->retry_descend_num = RA_RETRY_DESCEND_NUM; - pRA_Table->retrylimit_low = RA_RETRY_LIMIT_LOW; - pRA_Table->retrylimit_high = RA_RETRY_LIMIT_HIGH; - - phydm_reset_retry_limit_table(pDM_Odm); - -} - -#endif - -VOID -phydm_ra_dynamic_retry_limit( - IN PVOID pDM_VOID -) -{ -#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - PSTA_INFO_T pEntry; - u1Byte i, retry_offset; - u4Byte ma_rx_tp; - - - if (pDM_Odm->pre_number_active_client == pDM_Odm->number_active_client) { - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, (" pre_number_active_client == number_active_client\n")); - return; - - } else { - if (pDM_Odm->number_active_client == 1) { - phydm_reset_retry_limit_table(pDM_Odm); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("one client only->reset to default value\n")); - } else { - - retry_offset = pDM_Odm->number_active_client * pRA_Table->retry_descend_num; - - for (i = 0; i < ODM_NUM_RATE_IDX; i++) { - - phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_20M[i]), retry_offset); - phydm_retry_limit_table_bound(pDM_Odm, &(pRA_Table->per_rate_retrylimit_40M[i]), retry_offset); - } - } - } -#endif -} - -#if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) -VOID -phydm_ra_dynamic_rate_id_on_assoc( - IN PVOID pDM_VOID, - IN u1Byte wireless_mode, - IN u1Byte init_rate_id -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", pDM_Odm->RFType, wireless_mode, init_rate_id)); - - if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { - - if ((pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) && - (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) - ){ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set N-2SS ARFR5 table\n")); - ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ - ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ - } else if ((pDM_Odm->SupportICType & (ODM_RTL8812)) && - (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) - ){ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[ON ASSOC] set AC-2SS ARFR0 table\n")); - ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ - ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ - } - } - -} - -VOID -phydm_ra_dynamic_rate_id_init( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) { - - ODM_SetMACReg(pDM_Odm, 0x4a4, bMaskDWord, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ - ODM_SetMACReg(pDM_Odm, 0x4a8, bMaskDWord, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ - - ODM_SetMACReg(pDM_Odm, 0x444, bMaskDWord, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ - ODM_SetMACReg(pDM_Odm, 0x448, bMaskDWord, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ - } -} - -VOID -phydm_update_rate_id( - IN PVOID pDM_VOID, - IN u1Byte rate, - IN u1Byte platform_macid -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte current_tx_ss; - u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ - u1Byte wireless_mode; - u1Byte phydm_macid; - PSTA_INFO_T pEntry; - - -#if 0 - if (rate_idx >= ODM_RATEVHTSS2MCS0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT2SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS2MCS0))); - /*dummy for SD4 check patch*/ - } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( VHT1SS-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEVHTSS1MCS0))); - /*dummy for SD4 check patch*/ - } else if (rate_idx >= ODM_RATEMCS0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, (rate_idx-ODM_RATEMCS0))); - /*dummy for SD4 check patch*/ - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate[%d]: (( HT-MCS%d ))\n", platform_macid, rate_idx)); - /*dummy for SD4 check patch*/ - } -#endif - - phydm_macid = pDM_Odm->platform2phydm_macid_table[platform_macid]; - pEntry = pDM_Odm->pODM_StaInfo[phydm_macid]; - - if (IS_STA_VALID(pEntry)) { - wireless_mode = pEntry->WirelessMode; - - if ((pDM_Odm->RFType == ODM_2T2R) | (pDM_Odm->RFType == ODM_2T2R_GREEN) | (pDM_Odm->RFType == ODM_2T3R) | (pDM_Odm->RFType == ODM_2T4R)) { - - pEntry->ratr_idx = pEntry->ratr_idx_init; - if (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) { /*N mode*/ - if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*2SS mode*/ - - pEntry->ratr_idx = ARFR_5_RATE_ID; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_5\n")); - } - } else if (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) {/*AC mode*/ - if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*2SS mode*/ - - pEntry->ratr_idx = ARFR_0_RATE_ID; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("ARFR_0\n")); - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("UPdate_RateID[%d]: (( 0x%x ))\n", platform_macid, pEntry->ratr_idx)); - } - } - -} -#endif - -VOID -phydm_print_rate( - IN PVOID pDM_VOID, - IN u1Byte rate, - IN u4Byte dbg_component -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54}; - u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ - u1Byte vht_en = (rate_idx >= ODM_RATEVHTSS1MCS0) ? 1 : 0; - u1Byte b_sgi = (rate & 0x80)>>7; - - ODM_RT_TRACE_F(pDM_Odm, dbg_component, ODM_DBG_LOUD, ("( %s%s%s%s%d%s%s)\n", - ((rate_idx >= ODM_RATEVHTSS1MCS0) && (rate_idx <= ODM_RATEVHTSS1MCS9)) ? "VHT 1ss " : "", - ((rate_idx >= ODM_RATEVHTSS2MCS0) && (rate_idx <= ODM_RATEVHTSS2MCS9)) ? "VHT 2ss " : "", - ((rate_idx >= ODM_RATEVHTSS3MCS0) && (rate_idx <= ODM_RATEVHTSS3MCS9)) ? "VHT 3ss " : "", - (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", - (vht_en) ? ((rate_idx - ODM_RATEVHTSS1MCS0)%10) : ((rate_idx >= ODM_RATEMCS0) ? (rate_idx - ODM_RATEMCS0) : ((rate_idx <= ODM_RATE54M)?legacy_table[rate_idx]:0)), - (b_sgi) ? "-S" : " ", - (rate_idx >= ODM_RATEMCS0) ? "" : "M")); -} - -VOID -phydm_c2h_ra_report_handler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte legacy_table[12] = {1,2,5,11,6,9,12,18,24,36,48,54}; - u1Byte macid = CmdBuf[1]; - u1Byte rate = CmdBuf[0]; - u1Byte rate_idx = rate & 0x7f; /*remove bit7 SGI*/ - u1Byte pre_rate = pRA_Table->link_tx_rate[macid]; - u1Byte rate_order; - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - - GET_HAL_DATA(Adapter)->CurrentRARate = HwRateToMRate(rate_idx); - #endif - - - if (CmdLen >= 4) { - if (CmdBuf[3] == 0) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("TX Init-Rate Update[%d]:", macid)); - /**/ - } else if (CmdBuf[3] == 0xff) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("FW Level: Fix rate[%d]:", macid)); - /**/ - } else if (CmdBuf[3] == 1) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Success[%d]:", macid)); - /**/ - } else if (CmdBuf[3] == 2) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try Fail & Try Again[%d]:", macid)); - /**/ - } else if (CmdBuf[3] == 3) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Rate Back[%d]:", macid)); - /**/ - } else if (CmdBuf[3] == 4) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("start rate by RSSI[%d]:", macid)); - /**/ - } else if (CmdBuf[3] == 5) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Try rate[%d]:", macid)); - /**/ - } - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("Tx Rate Update[%d]:", macid)); - /**/ - } - - /*phydm_print_rate(pDM_Odm, pre_rate_idx, ODM_COMP_RATE_ADAPTIVE);*/ - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, (">\n",macid );*/ - phydm_print_rate(pDM_Odm, rate, ODM_COMP_RATE_ADAPTIVE); - - pRA_Table->link_tx_rate[macid] = rate; - - /*trigger power training*/ - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - - rate_order = phydm_rate_order_compute(pDM_Odm, rate_idx); - - if ((pDM_Odm->bOneEntryOnly) || - ((rate_order > pRA_Table->highest_client_tx_order) && (pRA_Table->power_tracking_flag == 1)) - ) { - phydm_update_pwr_track(pDM_Odm, rate_idx); - pRA_Table->power_tracking_flag = 0; - } - - #endif - - /*trigger dynamic rate ID*/ - #if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) - if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8192E)) - phydm_update_rate_id(pDM_Odm, rate, macid); - #endif - -} - -VOID -odm_RSSIMonitorInit( - IN PVOID pDM_VOID -) -{ -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - pRA_Table->PT_collision_pre = TRUE; /*used in ODM_DynamicARFBSelect(WIN only)*/ - - pHalData->UndecoratedSmoothedPWDB = -1; - pHalData->ra_rpt_linked = FALSE; - #endif - - pRA_Table->firstconnect = FALSE; - - -#endif -} - -VOID -ODM_RAPostActionOnAssoc( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -/* - pDM_Odm->H2C_RARpt_connect = 1; - odm_RSSIMonitorCheck(pDM_Odm); - pDM_Odm->H2C_RARpt_connect = 0; -*/ -} - -VOID -phydm_initRaInfo( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - -#if (RTL8822B_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8822B) { - u4Byte ret_value; - - ret_value = ODM_GetBBReg(pDM_Odm, 0x4c8, bMaskByte2); - ODM_SetBBReg(pDM_Odm, 0x4cc, bMaskByte3, (ret_value - 1)); - } -#endif -} - -VOID -phydm_modify_RA_PCR_threshold( - IN PVOID pDM_VOID, - IN u1Byte RA_offset_direction, - IN u1Byte RA_threshold_offset - -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - - pRA_Table->RA_offset_direction = RA_offset_direction; - pRA_Table->RA_threshold_offset = RA_threshold_offset; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Set RA_threshold_offset = (( %s%d ))\n", ((RA_threshold_offset == 0) ? " " : ((RA_offset_direction) ? "+" : "-")), RA_threshold_offset)); -} - -VOID -odm_RSSIMonitorCheckMP( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte H2C_Parameter[H2C_0X42_LENGTH] = {0}; - u4Byte i; - BOOLEAN bExtRAInfo = TRUE; - u1Byte cmdlen = H2C_0X42_LENGTH; - u1Byte TxBF_EN = 0, stbc_en = 0; - - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PSTA_INFO_T pEntry = NULL; - s4Byte tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; - PMGNT_INFO pMgntInfo = &Adapter->MgntInfo; - PMGNT_INFO pDefaultMgntInfo = &Adapter->MgntInfo; - u8Byte curTxOkCnt = 0, curRxOkCnt = 0; -#if (BEAMFORMING_SUPPORT == 1) -#ifndef BEAMFORMING_VERSION_1 - BEAMFORMING_CAP Beamform_cap = BEAMFORMING_CAP_NONE; -#endif -#endif - PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); - - if (pDM_Odm->SupportICType == ODM_RTL8188E) { - bExtRAInfo = FALSE; - cmdlen = 3; - } - - while (pLoopAdapter) { - - if (pLoopAdapter != NULL) { - pMgntInfo = &pLoopAdapter->MgntInfo; - curTxOkCnt = pLoopAdapter->TxStats.NumTxBytesUnicast - pMgntInfo->lastTxOkCnt; - curRxOkCnt = pLoopAdapter->RxStats.NumRxBytesUnicast - pMgntInfo->lastRxOkCnt; - pMgntInfo->lastTxOkCnt = curTxOkCnt; - pMgntInfo->lastRxOkCnt = curRxOkCnt; - } - - for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) { - - if (IsAPModeExist(pLoopAdapter)) { - if (GetFirstExtAdapter(pLoopAdapter) != NULL && - GetFirstExtAdapter(pLoopAdapter) == pLoopAdapter) - pEntry = AsocEntry_EnumStation(pLoopAdapter, i); - else if (GetFirstGOPort(pLoopAdapter) != NULL && - IsFirstGoAdapter(pLoopAdapter)) - pEntry = AsocEntry_EnumStation(pLoopAdapter, i); - } else { - if (GetDefaultAdapter(pLoopAdapter) == pLoopAdapter) - pEntry = AsocEntry_EnumStation(pLoopAdapter, i); - } - - if (pEntry != NULL) { - if (pEntry->bAssociated) { - - RT_DISP_ADDR(FDM, DM_PWDB, ("pEntry->MacAddr ="), pEntry->MacAddr); - RT_DISP(FDM, DM_PWDB, ("pEntry->rssi = 0x%x(%d)\n", - pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); - - //2 BF_en -#if (BEAMFORMING_SUPPORT == 1) -#ifndef BEAMFORMING_VERSION_1 - Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pEntry->AssociatedMacId); - if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) - TxBF_EN = 1; -#else - if(Beamform_GetSupportBeamformerCap(GetDefaultAdapter(Adapter), pEntry)) - TxBF_EN = 1; -#endif -#endif - //2 STBC_en - if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pEntry->VHTInfo.STBC, STBC_VHT_ENABLE_TX)) || - TEST_FLAG(pEntry->HTInfo.STBC, STBC_HT_ENABLE_TX)) - stbc_en = 1; - - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) - tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) - tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; - - H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")),pRA_Table->RA_threshold_offset)); - - if (bExtRAInfo) { - if (curRxOkCnt > (curTxOkCnt * 6)) - H2C_Parameter[3] |= RAINFO_BE_RX_STATE; - - if (TxBF_EN) - H2C_Parameter[3] |= RAINFO_BF_STATE; - else { - if (stbc_en) - H2C_Parameter[3] |= RAINFO_STBC_STATE; - } - - if (pDM_Odm->NoisyDecision) - H2C_Parameter[3] |= RAINFO_NOISY_STATE; - else - H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); - #if 1 - if (pDM_Odm->H2C_RARpt_connect) { - H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("H2C_RARpt_connect = (( %d ))\n", pDM_Odm->H2C_RARpt_connect)); - } - #else - - if (pEntry->rssi_stat.ra_rpt_linked == FALSE) { - H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - pEntry->rssi_stat.ra_rpt_linked = TRUE; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("RA First Link, RSSI[%d] = ((%d))\n", - pEntry->AssociatedMacId, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); - } - #endif - } - - H2C_Parameter[2] = (u1Byte)(pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0xFF); - //H2C_Parameter[1] = 0x20; // fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 - H2C_Parameter[0] = (pEntry->AssociatedMacId); - - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); - } - } else - break; - } - - pLoopAdapter = GetNextExtAdapter(pLoopAdapter); - } - - - /*Default port*/ - if (tmpEntryMaxPWDB != 0) { // If associated entry is found - pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; - RT_DISP(FDM, DM_PWDB, ("EntryMaxPWDB = 0x%x(%d)\n", tmpEntryMaxPWDB, tmpEntryMaxPWDB)); - } else - pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; - - if (tmpEntryMinPWDB != 0xff) { // If associated entry is found - pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; - RT_DISP(FDM, DM_PWDB, ("EntryMinPWDB = 0x%x(%d)\n", tmpEntryMinPWDB, tmpEntryMinPWDB)); - - } else - pHalData->EntryMinUndecoratedSmoothedPWDB = 0; - - /* Default porti sent RSSI to FW */ - if (pHalData->bUseRAMask) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("1 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", - WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); - if (pHalData->UndecoratedSmoothedPWDB > 0) { - - PRT_HIGH_THROUGHPUT pHTInfo = GET_HT_INFO(pDefaultMgntInfo); - PRT_VERY_HIGH_THROUGHPUT pVHTInfo = GET_VHT_INFO(pDefaultMgntInfo); - - /* BF_en*/ - #if (BEAMFORMING_SUPPORT == 1) - #ifndef BEAMFORMING_VERSION_1 - Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pDefaultMgntInfo->mMacId); - - if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) - TxBF_EN = 1; - #else - if(Beamform_GetSupportBeamformerCap(GetDefaultAdapter(Adapter), NULL)) - TxBF_EN = 1; - #endif - #endif - - /* STBC_en*/ - if ((IS_WIRELESS_MODE_AC(Adapter) && TEST_FLAG(pVHTInfo->VhtCurStbc, STBC_VHT_ENABLE_TX)) || - TEST_FLAG(pHTInfo->HtCurStbc, STBC_HT_ENABLE_TX)) - stbc_en = 1; - - H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); - - if (bExtRAInfo) { - if (TxBF_EN) - H2C_Parameter[3] |= RAINFO_BF_STATE; - else { - if (stbc_en) - H2C_Parameter[3] |= RAINFO_STBC_STATE; - } - - #if 1 - if (pDM_Odm->H2C_RARpt_connect) { - H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("H2C_RARpt_connect = (( %d ))\n", pDM_Odm->H2C_RARpt_connect)); - } - #else - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("2 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", - WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); - - if (pHalData->ra_rpt_linked == FALSE) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RSSI_MONITOR, ODM_DBG_LOUD, ("3 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", - WIN_DEFAULT_PORT_MACID, pHalData->UndecoratedSmoothedPWDB, pHalData->ra_rpt_linked)); - - H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - pHalData->ra_rpt_linked = TRUE; - - - } - #endif - - if (pDM_Odm->NoisyDecision == 1) { - H2C_Parameter[3] |= RAINFO_NOISY_STATE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] Send H2C to FW\n")); - } else - H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_NOISY_DETECT, ODM_DBG_LOUD, ("[RSSIMonitorCheckMP] H2C_Parameter=%x\n", H2C_Parameter[3])); - } - - H2C_Parameter[2] = (u1Byte)(pHalData->UndecoratedSmoothedPWDB & 0xFF); - /*H2C_Parameter[1] = 0x20;*/ /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ - H2C_Parameter[0] = WIN_DEFAULT_PORT_MACID; /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ - - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); - } - - // BT 3.0 HS mode Rssi - if (pDM_Odm->bBtHsOperation) { - H2C_Parameter[2] = pDM_Odm->btHsRssi; - //H2C_Parameter[1] = 0x0; - H2C_Parameter[0] = WIN_BT_PORT_MACID; - - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); - } - } else - PlatformEFIOWrite1Byte(Adapter, 0x4fe, (u1Byte)pHalData->UndecoratedSmoothedPWDB); - - if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8192E)) - odm_RSSIDumpToRegister(pDM_Odm); - - - { - PADAPTER pLoopAdapter = GetDefaultAdapter(Adapter); - BOOLEAN default_pointer_value, *pbLink_temp = &default_pointer_value; - s4Byte GlobalRSSI_min = 0xFF, LocalRSSI_Min; - BOOLEAN bLink = FALSE; - - while (pLoopAdapter) { - LocalRSSI_Min = phydm_FindMinimumRSSI(pDM_Odm, pLoopAdapter, pbLink_temp); - //DbgPrint("pHalData->bLinked=%d, LocalRSSI_Min=%d\n", pHalData->bLinked, LocalRSSI_Min); - - if (*pbLink_temp) - bLink = TRUE; - - if ((LocalRSSI_Min < GlobalRSSI_min) && (*pbLink_temp)) - GlobalRSSI_min = LocalRSSI_Min; - - pLoopAdapter = GetNextExtAdapter(pLoopAdapter); - } - - pHalData->bLinked = bLink; - ODM_CmnInfoUpdate(&pHalData->DM_OutSrc , ODM_CMNINFO_LINK, (u8Byte)bLink); - - if (bLink) - ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, (u8Byte)GlobalRSSI_min); - else - ODM_CmnInfoUpdate(&pHalData->DM_OutSrc, ODM_CMNINFO_RSSI_MIN, 0); - - } - -#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -/*H2C_RSSI_REPORT*/ -s8 phydm_rssi_report(PDM_ODM_T pDM_Odm, u8 mac_id) -{ - PADAPTER Adapter = pDM_Odm->Adapter; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(Adapter); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u8 H2C_Parameter[H2C_0X42_LENGTH] = {0}; - u8 UL_DL_STATE = 0, STBC_TX = 0, TxBF_EN = 0; - u8 cmdlen = H2C_0X42_LENGTH, first_connect = _FALSE; - u64 curTxOkCnt = 0, curRxOkCnt = 0; - PSTA_INFO_T pEntry = pDM_Odm->pODM_StaInfo[mac_id]; - - if (!IS_STA_VALID(pEntry)) - return _FAIL; - - if (mac_id != pEntry->mac_id) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u:%u invalid\n", __func__, mac_id, pEntry->mac_id)); - rtw_warn_on(1); - return _FAIL; - } - - if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ - return _FAIL; - - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == (-1)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi == -1\n", __func__, pEntry->mac_id, MAC_ARG(pEntry->hwaddr))); - return _FAIL; - } - - curTxOkCnt = pdvobjpriv->traffic_stat.cur_tx_bytes; - curRxOkCnt = pdvobjpriv->traffic_stat.cur_rx_bytes; - if (curRxOkCnt > (curTxOkCnt * 6)) - UL_DL_STATE = 1; - else - UL_DL_STATE = 0; - - #ifdef CONFIG_BEAMFORMING - { - #if (BEAMFORMING_SUPPORT == 1) - BEAMFORMING_CAP Beamform_cap = phydm_Beamforming_GetEntryBeamCapByMacId(pDM_Odm, pEntry->mac_id); - #else/*for drv beamforming*/ - BEAMFORMING_CAP Beamform_cap = beamforming_get_entry_beam_cap_by_mac_id(&Adapter->mlmepriv, pEntry->mac_id); - #endif - - if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) - TxBF_EN = 1; - else - TxBF_EN = 0; - } - #endif /*#ifdef CONFIG_BEAMFORMING*/ - - if (TxBF_EN) - STBC_TX = 0; - else { - #ifdef CONFIG_80211AC_VHT - if (IsSupportedVHT(pEntry->wireless_mode)) - STBC_TX = TEST_FLAG(pEntry->vhtpriv.stbc_cap, STBC_VHT_ENABLE_TX); - else - #endif - #ifdef CONFIG_80211N_HT - STBC_TX = TEST_FLAG(pEntry->htpriv.stbc_cap, STBC_HT_ENABLE_TX); - #endif - } - - H2C_Parameter[0] = (u8)(pEntry->mac_id & 0xFF); - H2C_Parameter[2] = pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0x7F; - - if (UL_DL_STATE) - H2C_Parameter[3] |= RAINFO_BE_RX_STATE; - - if (TxBF_EN) - H2C_Parameter[3] |= RAINFO_BF_STATE; - if (STBC_TX) - H2C_Parameter[3] |= RAINFO_STBC_STATE; - if (pDM_Odm->NoisyDecision) - H2C_Parameter[3] |= RAINFO_NOISY_STATE; - - if ((pEntry->ra_rpt_linked == _FALSE) && (pEntry->rssi_stat.bsend_rssi == RA_RSSI_STATE_SEND)) { - H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - pEntry->ra_rpt_linked = _TRUE; - pEntry->rssi_stat.bsend_rssi = RA_RSSI_STATE_HOLD; - first_connect = _TRUE; - } - - H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); - - #if 1 - if (first_connect) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s mac_id:%u, mac:"MAC_FMT", rssi:%d\n", __func__, - pEntry->mac_id, MAC_ARG(pEntry->hwaddr), pEntry->rssi_stat.UndecoratedSmoothedPWDB)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s RAINFO - TP:%s, TxBF:%s, STBC:%s, Noisy:%s, Firstcont:%s\n", __func__, - (UL_DL_STATE) ? "DL" : "UL", (TxBF_EN) ? "EN" : "DIS", (STBC_TX) ? "EN" : "DIS", - (pDM_Odm->NoisyDecision) ? "True" : "False", (first_connect) ? "True" : "False")); - } - #endif - - if (pHalData->fw_ractrl == _TRUE) { - #if (RTL8188E_SUPPORT == 1) - if (pDM_Odm->SupportICType == ODM_RTL8188E) - cmdlen = 3; - #endif - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); - } else { - #if ((RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1)) - if (pDM_Odm->SupportICType == ODM_RTL8188E) - ODM_RA_SetRSSI_8188E(pDM_Odm, (u8)(pEntry->mac_id & 0xFF), pEntry->rssi_stat.UndecoratedSmoothedPWDB & 0x7F); - #endif - } - return _SUCCESS; -} - -void phydm_ra_rssi_rpt_wk_hdl(PVOID pContext) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pContext; - int i; - u8 mac_id = 0xFF; - PSTA_INFO_T pEntry = NULL; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - pEntry = pDM_Odm->pODM_StaInfo[i]; - if (IS_STA_VALID(pEntry)) { - if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ - continue; - if (pEntry->ra_rpt_linked == _FALSE) { - mac_id = i; - break; - } - } - } - if (mac_id != 0xFF) - phydm_rssi_report(pDM_Odm, mac_id); -} -void phydm_ra_rssi_rpt_wk(PVOID pContext) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pContext; - - rtw_run_in_thread_cmd(pDM_Odm->Adapter, phydm_ra_rssi_rpt_wk_hdl, pDM_Odm); -} -#endif - -VOID -odm_RSSIMonitorCheckCE( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PSTA_INFO_T pEntry; - int i; - int tmpEntryMaxPWDB = 0, tmpEntryMinPWDB = 0xff; - u8 sta_cnt = 0; - - if (pDM_Odm->bLinked != _TRUE) - return; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - pEntry = pDM_Odm->pODM_StaInfo[i]; - if (IS_STA_VALID(pEntry)) { - if (IS_MCAST(pEntry->hwaddr)) /*if(psta->mac_id ==1)*/ - continue; - - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB == (-1)) - continue; - - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < tmpEntryMinPWDB) - tmpEntryMinPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; - - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > tmpEntryMaxPWDB) - tmpEntryMaxPWDB = pEntry->rssi_stat.UndecoratedSmoothedPWDB; - - if (phydm_rssi_report(pDM_Odm, i)) - sta_cnt++; - } - } - - if (tmpEntryMaxPWDB != 0) // If associated entry is found - pHalData->EntryMaxUndecoratedSmoothedPWDB = tmpEntryMaxPWDB; - else - pHalData->EntryMaxUndecoratedSmoothedPWDB = 0; - - if (tmpEntryMinPWDB != 0xff) // If associated entry is found - pHalData->EntryMinUndecoratedSmoothedPWDB = tmpEntryMinPWDB; - else - pHalData->EntryMinUndecoratedSmoothedPWDB = 0; - - FindMinimumRSSI(Adapter);//get pdmpriv->MinUndecoratedPWDBForDM - - pDM_Odm->RSSI_Min = pHalData->MinUndecoratedPWDBForDM; - //ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); -#endif//if (DM_ODM_SUPPORT_TYPE == ODM_CE) -} - - -VOID -odm_RSSIMonitorCheckAP( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) -#if (RTL8812A_SUPPORT || RTL8881A_SUPPORT || RTL8192E_SUPPORT || RTL8814A_SUPPORT || RTL8197F_SUPPORT) - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u1Byte H2C_Parameter[H2C_0X42_LENGTH] = {0}; - u4Byte i; - BOOLEAN bExtRAInfo = TRUE; - u1Byte cmdlen = H2C_0X42_LENGTH; - u1Byte TxBF_EN = 0, stbc_en = 0; - - prtl8192cd_priv priv = pDM_Odm->priv; - PSTA_INFO_T pstat; - BOOLEAN act_bfer = FALSE; - -#if (BEAMFORMING_SUPPORT == 1) - u1Byte Idx=0xff; -#if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) - pBDC_T pDM_BdcTable = &pDM_Odm->DM_BdcTable; - pDM_BdcTable->num_Txbfee_Client = 0; - pDM_BdcTable->num_Txbfer_Client = 0; -#endif -#endif - if (!pDM_Odm->H2C_RARpt_connect && (priv->up_time % 2)) - return; - - if (pDM_Odm->SupportICType == ODM_RTL8188E) { - bExtRAInfo = FALSE; - cmdlen = 3; - } - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - pstat = pDM_Odm->pODM_StaInfo[i]; - - if (IS_STA_VALID(pstat)) { - if (pstat->sta_in_firmware != 1) - continue; - - //2 BF_en - #if (BEAMFORMING_SUPPORT == 1) - BEAMFORMING_CAP Beamform_cap = Beamforming_GetEntryBeamCapByMacId(priv, pstat->aid); - PRT_BEAMFORMING_ENTRY pEntry = Beamforming_GetEntryByMacId(priv, pstat->aid, &Idx); - - if (Beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) { - - if (pEntry->Sounding_En) - TxBF_EN = 1; - else - TxBF_EN = 0; - - act_bfer = TRUE; - } - - #if (defined(CONFIG_PHYDM_ANTENNA_DIVERSITY)) /*BDC*/ - if (act_bfer == TRUE) { - pDM_BdcTable->w_BFee_Client[i] = 1; //AP act as BFer - pDM_BdcTable->num_Txbfee_Client++; - } else { - pDM_BdcTable->w_BFee_Client[i] = 0; //AP act as BFer - } - - if ((Beamform_cap & BEAMFORMEE_CAP_HT_EXPLICIT) || (Beamform_cap & BEAMFORMEE_CAP_VHT_SU)) { - pDM_BdcTable->w_BFer_Client[i] = 1; //AP act as BFee - pDM_BdcTable->num_Txbfer_Client++; - } else { - pDM_BdcTable->w_BFer_Client[i] = 0; //AP act as BFer - } - #endif - #endif - - //2 STBC_en - if ((priv->pmib->dot11nConfigEntry.dot11nSTBC) && - ((pstat->ht_cap_buf.ht_cap_info & cpu_to_le16(_HTCAP_RX_STBC_CAP_)) - #ifdef RTK_AC_SUPPORT - || (pstat->vht_cap_buf.vht_cap_info & cpu_to_le32(_VHTCAP_RX_STBC_CAP_)) - #endif - )) - stbc_en = 1; - - //2 RAINFO - - H2C_Parameter[4] = (pRA_Table->RA_threshold_offset & 0x7f) | (pRA_Table->RA_offset_direction<<7); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA_threshold_offset = (( %s%d ))\n", ((pRA_Table->RA_threshold_offset == 0) ? " " : ((pRA_Table->RA_offset_direction) ? "+" : "-")), pRA_Table->RA_threshold_offset)); - - if (bExtRAInfo) { - if ((pstat->rx_avarage) > ((pstat->tx_avarage) * 6)) - H2C_Parameter[3] |= RAINFO_BE_RX_STATE; - - if (TxBF_EN) - H2C_Parameter[3] |= RAINFO_BF_STATE; - else { - if (stbc_en) - H2C_Parameter[3] |= RAINFO_STBC_STATE; - } - - if (pDM_Odm->NoisyDecision) - H2C_Parameter[3] |= RAINFO_NOISY_STATE; - else - H2C_Parameter[3] &= (~RAINFO_NOISY_STATE); - - if (pstat->H2C_rssi_rpt) { - H2C_Parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("[RA Init] set Init rate by RSSI, STA %d\n", pstat->aid)); - } - - /*ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RAINFO] H2C_Para[3] = %x\n",H2C_Parameter[3]));*/ - } - - H2C_Parameter[2] = (u1Byte)(pstat->rssi & 0xFF); - H2C_Parameter[0] = REMAP_AID(pstat); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_COMMON, ODM_DBG_LOUD, ("H2C_Parameter[3]=%d\n", H2C_Parameter[3])); - - //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[RSSI] H2C_Para[2] = %x, \n",H2C_Parameter[2])); - //ODM_RT_TRACE(pDM_Odm,PHYDM_COMP_RA_DBG, ODM_DBG_LOUD, ("[MACID] H2C_Para[0] = %x, \n",H2C_Parameter[0])); - - ODM_FillH2CCmd(pDM_Odm, ODM_H2C_RSSI_REPORT, cmdlen, H2C_Parameter); - - } - } - -#endif -#endif - -} - -VOID -odm_RSSIMonitorCheck( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) - return; - - switch (pDM_Odm->SupportPlatform) { - case ODM_WIN: - odm_RSSIMonitorCheckMP(pDM_Odm); - break; - - case ODM_CE: - odm_RSSIMonitorCheckCE(pDM_Odm); - break; - - case ODM_AP: - odm_RSSIMonitorCheckAP(pDM_Odm); - break; - - default: - break; - } - -} - -VOID -odm_RateAdaptiveMaskInit( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RATE_ADAPTIVE pOdmRA = &pDM_Odm->RateAdaptive; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMGNT_INFO pMgntInfo = &pDM_Odm->Adapter->MgntInfo; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pDM_Odm->Adapter); - - pMgntInfo->Ratr_State = DM_RATR_STA_INIT; - - if (pMgntInfo->DM_Type == DM_Type_ByDriver) - pHalData->bUseRAMask = TRUE; - else - pHalData->bUseRAMask = FALSE; - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - pOdmRA->Type = DM_Type_ByDriver; - if (pOdmRA->Type == DM_Type_ByDriver) - pDM_Odm->bUseRAMask = _TRUE; - else - pDM_Odm->bUseRAMask = _FALSE; -#endif - - pOdmRA->RATRState = DM_RATR_STA_INIT; - -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - if (pDM_Odm->SupportICType == ODM_RTL8812) - pOdmRA->LdpcThres = 50; - else - pOdmRA->LdpcThres = 35; - - pOdmRA->RtsThres = 35; - -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - pOdmRA->LdpcThres = 35; - pOdmRA->bUseLdpc = FALSE; - -#else - pOdmRA->UltraLowRSSIThresh = 9; - -#endif - - pOdmRA->HighRSSIThresh = 50; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && \ - ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - pOdmRA->LowRSSIThresh = 23; -#else - pOdmRA->LowRSSIThresh = 20; -#endif -} -/*----------------------------------------------------------------------------- - * Function: odm_RefreshRateAdaptiveMask() - * - * Overview: Update rate table mask according to rssi - * - * Input: NONE - * - * Output: NONE - * - * Return: NONE - * - * Revised History: - * When Who Remark - * 05/27/2009 hpfan Create Version 0. - * - *---------------------------------------------------------------------------*/ -VOID -odm_RefreshRateAdaptiveMask( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (!pDM_Odm->bLinked) - return; - - if (!(pDM_Odm->SupportAbility & ODM_BB_RA_MASK)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("odm_RefreshRateAdaptiveMask(): Return cos not supported\n")); - return; - } - // - // 2011/09/29 MH In HW integration first stage, we provide 4 different handle to operate - // at the same time. In the stage2/3, we need to prive universal interface and merge all - // HW dynamic mechanism. - // - switch (pDM_Odm->SupportPlatform) { - case ODM_WIN: - odm_RefreshRateAdaptiveMaskMP(pDM_Odm); - break; - - case ODM_CE: - odm_RefreshRateAdaptiveMaskCE(pDM_Odm); - break; - - case ODM_AP: - odm_RefreshRateAdaptiveMaskAPADSL(pDM_Odm); - break; - } - -} - -u1Byte -phydm_trans_platform_bw( - IN PVOID pDM_VOID, - IN u1Byte BW -) -{ - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (BW == CHANNEL_WIDTH_20) - BW = PHYDM_BW_20; - - else if (BW == CHANNEL_WIDTH_40) - BW = PHYDM_BW_40; - - else if (BW == CHANNEL_WIDTH_80) - BW = PHYDM_BW_80; - - else if (BW == CHANNEL_WIDTH_160) - BW = PHYDM_BW_160; - - else if (BW == CHANNEL_WIDTH_80_80) - BW = PHYDM_BW_80_80; - - #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - - if (BW == HT_CHANNEL_WIDTH_20) - BW = PHYDM_BW_20; - - else if (BW == HT_CHANNEL_WIDTH_20_40) - BW = PHYDM_BW_40; - - else if (BW == HT_CHANNEL_WIDTH_80) - BW = PHYDM_BW_80; - - else if (BW == HT_CHANNEL_WIDTH_160) - BW = PHYDM_BW_160; - - else if (BW == HT_CHANNEL_WIDTH_10) - BW = PHYDM_BW_10; - - else if (BW == HT_CHANNEL_WIDTH_5) - BW = PHYDM_BW_5; - - #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - if (BW == CHANNEL_WIDTH_20) - BW = PHYDM_BW_20; - - else if (BW == CHANNEL_WIDTH_40) - BW = PHYDM_BW_40; - - else if (BW == CHANNEL_WIDTH_80) - BW = PHYDM_BW_80; - - else if (BW == CHANNEL_WIDTH_160) - BW = PHYDM_BW_160; - - else if (BW == CHANNEL_WIDTH_80_80) - BW = PHYDM_BW_80_80; - #endif - - return BW; - -} - -u1Byte -phydm_trans_platform_rf_type( - IN PVOID pDM_VOID, - IN u1Byte RfType -) -{ - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (RfType == RF_1T2R) - RfType = PHYDM_RF_1T2R; - - else if (RfType == RF_2T4R) - RfType = PHYDM_RF_2T4R; - - else if (RfType == RF_2T2R) - RfType = PHYDM_RF_2T2R; - - else if (RfType == RF_1T1R) - RfType = PHYDM_RF_1T1R; - - else if (RfType == RF_2T2R_GREEN) - RfType = PHYDM_RF_2T2R_GREEN; - - else if (RfType == RF_3T3R) - RfType = PHYDM_RF_3T3R; - - else if (RfType == RF_4T4R) - RfType = PHYDM_RF_4T4R; - - else if (RfType == RF_2T3R) - RfType = PHYDM_RF_1T2R; - - else if (RfType == RF_3T4R) - RfType = PHYDM_RF_3T4R; - - #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - - if (RfType == MIMO_1T2R) - RfType = PHYDM_RF_1T2R; - - else if (RfType == MIMO_2T4R) - RfType = PHYDM_RF_2T4R; - - else if (RfType == MIMO_2T2R) - RfType = PHYDM_RF_2T2R; - - else if (RfType == MIMO_1T1R) - RfType = PHYDM_RF_1T1R; - - else if (RfType == MIMO_3T3R) - RfType = PHYDM_RF_3T3R; - - else if (RfType == MIMO_4T4R) - RfType = PHYDM_RF_4T4R; - - else if (RfType == MIMO_2T3R) - RfType = PHYDM_RF_1T2R; - - else if (RfType == MIMO_3T4R) - RfType = PHYDM_RF_3T4R; - - #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - if (RfType == RF_1T2R) - RfType = PHYDM_RF_1T2R; - - else if (RfType == RF_2T4R) - RfType = PHYDM_RF_2T4R; - - else if (RfType == RF_2T2R) - RfType = PHYDM_RF_2T2R; - - else if (RfType == RF_1T1R) - RfType = PHYDM_RF_1T1R; - - else if (RfType == RF_2T2R_GREEN) - RfType = PHYDM_RF_2T2R_GREEN; - - else if (RfType == RF_3T3R) - RfType = PHYDM_RF_3T3R; - - else if (RfType == RF_4T4R) - RfType = PHYDM_RF_4T4R; - - else if (RfType == RF_2T3R) - RfType = PHYDM_RF_1T2R; - - else if (RfType == RF_3T4R) - RfType = PHYDM_RF_3T4R; - - #endif - - return RfType; - -} - -u4Byte -phydm_trans_platform_wireless_mode( - IN PVOID pDM_VOID, - IN u4Byte wireless_mode -) -{ - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - - #elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - - #elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - - if (wireless_mode == WIRELESS_11A) - wireless_mode = PHYDM_WIRELESS_MODE_A; - - else if (wireless_mode == WIRELESS_11B) - wireless_mode = PHYDM_WIRELESS_MODE_B; - - else if ((wireless_mode == WIRELESS_11G) || (wireless_mode == WIRELESS_11BG)) - wireless_mode = PHYDM_WIRELESS_MODE_G; - - else if (wireless_mode == WIRELESS_AUTO) - wireless_mode = PHYDM_WIRELESS_MODE_AUTO; - - else if ((wireless_mode == WIRELESS_11_24N) || (wireless_mode == WIRELESS_11G_24N) || (wireless_mode == WIRELESS_11B_24N) || - (wireless_mode == WIRELESS_11BG_24N) || (wireless_mode == WIRELESS_MODE_24G) || (wireless_mode == WIRELESS_11ABGN) || (wireless_mode == WIRELESS_11AGN)) - wireless_mode = PHYDM_WIRELESS_MODE_N_24G; - - else if ((wireless_mode == WIRELESS_11_5N) || (wireless_mode == WIRELESS_11A_5N)) - wireless_mode = PHYDM_WIRELESS_MODE_N_5G; - - else if ((wireless_mode == WIRELESS_11AC) || (wireless_mode == WIRELESS_11_5AC) || (wireless_mode == WIRELESS_MODE_5G)) - wireless_mode = PHYDM_WIRELESS_MODE_AC_5G; - - else if (wireless_mode == WIRELESS_11_24AC) - wireless_mode = PHYDM_WIRELESS_MODE_AC_24G; - - else if (wireless_mode == WIRELESS_11AC) - wireless_mode = PHYDM_WIRELESS_MODE_AC_ONLY; - - else if (wireless_mode == WIRELESS_MODE_MAX) - wireless_mode = PHYDM_WIRELESS_MODE_MAX; - else - wireless_mode = PHYDM_WIRELESS_MODE_UNKNOWN; - #endif - - return wireless_mode; - -} - -u1Byte -phydm_vht_en_mapping( - IN PVOID pDM_VOID, - IN u4Byte WirelessMode -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte vht_en_out = 0; - - if ((WirelessMode == PHYDM_WIRELESS_MODE_AC_5G) || - (WirelessMode == PHYDM_WIRELESS_MODE_AC_24G) || - (WirelessMode == PHYDM_WIRELESS_MODE_AC_ONLY) - ) { - vht_en_out = 1; - /**/ - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("WirelessMode= (( 0x%x )), VHT_EN= (( %d ))\n", WirelessMode, vht_en_out)); - return vht_en_out; -} - -u1Byte -phydm_rate_id_mapping( - IN PVOID pDM_VOID, - IN u4Byte WirelessMode, - IN u1Byte RfType, - IN u1Byte bw -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte rate_id_idx = 0; - u1Byte phydm_BW; - u1Byte phydm_RfType; - - phydm_BW = phydm_trans_platform_bw(pDM_Odm, bw); - phydm_RfType = phydm_trans_platform_rf_type(pDM_Odm, RfType); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - WirelessMode = phydm_trans_platform_wireless_mode(pDM_Odm, WirelessMode); - #endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wirelessMode= (( 0x%x )), RfType = (( 0x%x )), BW = (( 0x%x ))\n", - WirelessMode, phydm_RfType, phydm_BW)); - - - switch (WirelessMode) { - - case PHYDM_WIRELESS_MODE_N_24G: - { - - if (phydm_BW == PHYDM_BW_40) { - - if (phydm_RfType == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_BGN_40M_1SS; - else if (phydm_RfType == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_BGN_40M_2SS; - else - rate_id_idx = PHYDM_ARFR5_N_3SS; - - } else { - - if (phydm_RfType == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_BGN_20M_1SS; - else if (phydm_RfType == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_BGN_20M_2SS; - else - rate_id_idx = PHYDM_ARFR5_N_3SS; - } - } - break; - - case PHYDM_WIRELESS_MODE_N_5G: - { - if (phydm_RfType == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_GN_N1SS; - else if (phydm_RfType == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_GN_N2SS; - else - rate_id_idx = PHYDM_ARFR5_N_3SS; - } - - break; - - case PHYDM_WIRELESS_MODE_G: - rate_id_idx = PHYDM_BG; - break; - - case PHYDM_WIRELESS_MODE_A: - rate_id_idx = PHYDM_G; - break; - - case PHYDM_WIRELESS_MODE_B: - rate_id_idx = PHYDM_B_20M; - break; - - - case PHYDM_WIRELESS_MODE_AC_5G: - case PHYDM_WIRELESS_MODE_AC_ONLY: - { - if (phydm_RfType == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_ARFR1_AC_1SS; - else if (phydm_RfType == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_ARFR0_AC_2SS; - else - rate_id_idx = PHYDM_ARFR4_AC_3SS; - } - break; - - case PHYDM_WIRELESS_MODE_AC_24G: - { - /*Becareful to set "Lowest rate" while using PHYDM_ARFR4_AC_3SS in 2.4G/5G*/ - if (phydm_BW >= PHYDM_BW_80) { - if (phydm_RfType == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_ARFR1_AC_1SS; - else if (phydm_RfType == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_ARFR0_AC_2SS; - else - rate_id_idx = PHYDM_ARFR4_AC_3SS; - } else { - - if (phydm_RfType == PHYDM_RF_1T1R) - rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; - else if (phydm_RfType == PHYDM_RF_2T2R) - rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; - else - rate_id_idx = PHYDM_ARFR4_AC_3SS; - } - } - break; - - default: - rate_id_idx = 0; - break; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RA Rate ID = (( 0x%d ))\n", rate_id_idx)); - - return rate_id_idx; -} - -VOID -phydm_UpdateHalRAMask( - IN PVOID pDM_VOID, - IN u4Byte wirelessMode, - IN u1Byte RfType, - IN u1Byte BW, - IN u1Byte MimoPs_enable, - IN u1Byte disable_cck_rate, - IN u4Byte *ratr_bitmap_msb_in, - IN u4Byte *ratr_bitmap_lsb_in, - IN u1Byte tx_rate_level - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte mask_rate_threshold; - u1Byte phydm_RfType; - u1Byte phydm_BW; - u4Byte ratr_bitmap = *ratr_bitmap_lsb_in, ratr_bitmap_msb = *ratr_bitmap_msb_in; - /*PODM_RATE_ADAPTIVE pRA = &(pDM_Odm->RateAdaptive);*/ - - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - wirelessMode = phydm_trans_platform_wireless_mode(pDM_Odm, wirelessMode); - #endif - - phydm_RfType = phydm_trans_platform_rf_type(pDM_Odm, RfType); - phydm_BW = phydm_trans_platform_bw(pDM_Odm, BW); - - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("phydm_RfType = (( %x )), RfType = (( %x ))\n", phydm_RfType, RfType));*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Platfoem original RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap)); - - switch (wirelessMode) { - - case PHYDM_WIRELESS_MODE_B: - { - ratr_bitmap &= 0x0000000f; - } - break; - - case PHYDM_WIRELESS_MODE_G: - { - ratr_bitmap &= 0x00000ff5; - } - break; - - case PHYDM_WIRELESS_MODE_A: - { - ratr_bitmap &= 0x00000ff0; - } - break; - - case PHYDM_WIRELESS_MODE_N_24G: - case PHYDM_WIRELESS_MODE_N_5G: - { - if (MimoPs_enable) - phydm_RfType = PHYDM_RF_1T1R; - - if (phydm_RfType == PHYDM_RF_1T1R) { - - if (phydm_BW == PHYDM_BW_40) - ratr_bitmap &= 0x000ff015; - else - ratr_bitmap &= 0x000ff005; - } else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) { - - if (phydm_BW == PHYDM_BW_40) - ratr_bitmap &= 0x0ffff015; - else - ratr_bitmap &= 0x0ffff005; - } else { /*3T*/ - - ratr_bitmap &= 0xfffff015; - ratr_bitmap_msb &= 0xf; - } - } - break; - - case PHYDM_WIRELESS_MODE_AC_24G: - { - if (phydm_RfType == PHYDM_RF_1T1R) - ratr_bitmap &= 0x003ff015; - else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) - ratr_bitmap &= 0xfffff015; - else {/*3T*/ - - ratr_bitmap &= 0xfffff010; - ratr_bitmap_msb &= 0x3ff; - } - - if (phydm_BW == PHYDM_BW_20) {/* AC 20MHz doesn't support MCS9 */ - ratr_bitmap &= 0x7fdfffff; - ratr_bitmap_msb &= 0x1ff; - } - } - break; - - case PHYDM_WIRELESS_MODE_AC_5G: - { - if (phydm_RfType == PHYDM_RF_1T1R) - ratr_bitmap &= 0x003ff010; - else if (phydm_RfType == PHYDM_RF_2T2R || phydm_RfType == PHYDM_RF_2T4R || phydm_RfType == PHYDM_RF_2T3R) - ratr_bitmap &= 0xfffff010; - else {/*3T*/ - - ratr_bitmap &= 0xfffff010; - ratr_bitmap_msb &= 0x3ff; - } - - if (phydm_BW == PHYDM_BW_20) {/* AC 20MHz doesn't support MCS9 */ - ratr_bitmap &= 0x7fdfffff; - ratr_bitmap_msb &= 0x1ff; - } - } - break; - - default: - break; - } - - if (wirelessMode != PHYDM_WIRELESS_MODE_B) { - - if (tx_rate_level == 0) - ratr_bitmap &= 0xffffffff; - else if (tx_rate_level == 1) - ratr_bitmap &= 0xfffffff0; - else if (tx_rate_level == 2) - ratr_bitmap &= 0xffffefe0; - else if (tx_rate_level == 3) - ratr_bitmap &= 0xffffcfc0; - else if (tx_rate_level == 4) - ratr_bitmap &= 0xffff8f80; - else if (tx_rate_level >= 5) - ratr_bitmap &= 0xffff0f00; - - } - - if (disable_cck_rate) - ratr_bitmap &= 0xfffffff0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("wirelessMode= (( 0x%x )), RfType = (( 0x%x )), BW = (( 0x%x )), MimoPs_en = (( %d )), tx_rate_level= (( 0x%d ))\n", - wirelessMode, phydm_RfType, phydm_BW, MimoPs_enable, tx_rate_level)); - - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("111 Phydm modified RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap));*/ - - *ratr_bitmap_lsb_in = ratr_bitmap; - *ratr_bitmap_msb_in = ratr_bitmap_msb; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Phydm modified RA Mask = (( 0x %x | %x ))\n", *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in)); - -} - -u1Byte -phydm_RA_level_decision( - IN PVOID pDM_VOID, - IN u4Byte rssi, - IN u1Byte Ratr_State - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte ra_lowest_rate; - u1Byte ra_rate_floor_table[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; /*MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/ - u1Byte new_Ratr_State = 0; - u1Byte i; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("curr RA level = ((%d)), Rate_floor_table ori [ %d , %d, %d , %d, %d, %d]\n", Ratr_State, - ra_rate_floor_table[0], ra_rate_floor_table[1], ra_rate_floor_table[2], ra_rate_floor_table[3], ra_rate_floor_table[4], ra_rate_floor_table[5])); - - for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { - - if (i >= (Ratr_State)) - ra_rate_floor_table[i] += RA_FLOOR_UP_GAP; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI = ((%d)), Rate_floor_table_mod [ %d , %d, %d , %d, %d, %d]\n", - rssi, ra_rate_floor_table[0], ra_rate_floor_table[1], ra_rate_floor_table[2], ra_rate_floor_table[3], ra_rate_floor_table[4], ra_rate_floor_table[5])); - - for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { - - if (rssi < ra_rate_floor_table[i]) { - new_Ratr_State = i; - break; - } - } - - - - return new_Ratr_State; - -} - -VOID -odm_RefreshRateAdaptiveMaskMP( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER pAdapter = pDM_Odm->Adapter; - PADAPTER pTargetAdapter = NULL; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(pAdapter); - u4Byte i; - PSTA_INFO_T pEntry; - u1Byte Ratr_State_new; - - if (pAdapter->bDriverStopped) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); - return; - } - - if (!pHalData->bUseRAMask) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); - return; - } - - // if default port is connected, update RA table for default port (infrastructure mode only) - if (pMgntInfo->mAssoc && (!ACTING_AS_AP(pAdapter))) { - odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pMgntInfo->mMacId, pMgntInfo->IOTPeer, pHalData->UndecoratedSmoothedPWDB); - /*ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Infrasture Mode\n"));*/ - - #if RA_MASK_PHYDMLIZE_WIN - Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->Ratr_State); - - if (pMgntInfo->Ratr_State != Ratr_State_new) { - - ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pMgntInfo->Bssid); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n\n", - pMgntInfo->Ratr_State, Ratr_State_new, pHalData->UndecoratedSmoothedPWDB)); - - pMgntInfo->Ratr_State = Ratr_State_new; - pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, Ratr_State_new); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); - /**/ - } - - #else - if (ODM_RAStateCheck(pDM_Odm, pHalData->UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pMgntInfo->Ratr_State)) { - ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pHalData->UndecoratedSmoothedPWDB, pMgntInfo->Ratr_State)); - pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); - } else if (pDM_Odm->bChangeState) { - ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr : "), pMgntInfo->Bssid); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); - pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); - } - #endif - } - - // - // The following part configure AP/VWifi/IBSS rate adaptive mask. - // - - if (pMgntInfo->mIbss) // Target: AP/IBSS peer. - pTargetAdapter = GetDefaultAdapter(pAdapter); - else - pTargetAdapter = GetFirstAPAdapter(pAdapter); - - // if extension port (softap) is started, updaet RA table for more than one clients associate - if (pTargetAdapter != NULL) { - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - - pEntry = AsocEntry_EnumStation(pTargetAdapter, i); - - if (IS_STA_VALID(pEntry)) { - - odm_RefreshLdpcRtsMP(pAdapter, pDM_Odm, pEntry->AssociatedMacId, pEntry->IOTPeer, pEntry->rssi_stat.UndecoratedSmoothedPWDB); - - #if RA_MASK_PHYDMLIZE_WIN - Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->Ratr_State); - - if (pEntry->Ratr_State != Ratr_State_new) { - - ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pEntry->MacAddr); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", - pEntry->Ratr_State, Ratr_State_new, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); - - pEntry->Ratr_State = Ratr_State_new; - pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pEntry->AssociatedMacId, NULL, Ratr_State_new); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); - /**/ - } - - - #else - - if (ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pMgntInfo->bSetTXPowerTrainingByOid, &pEntry->Ratr_State)) { - ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->MacAddr); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->Ratr_State)); - pAdapter->HalFunc.UpdateHalRAMaskHandler(pTargetAdapter, pEntry->AssociatedMacId, pEntry, pEntry->Ratr_State); - } else if (pDM_Odm->bChangeState) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); - pAdapter->HalFunc.UpdateHalRAMaskHandler(pAdapter, pMgntInfo->mMacId, NULL, pMgntInfo->Ratr_State); - } - #endif - - } - } - } - - #if RA_MASK_PHYDMLIZE_WIN - - #else - if (pMgntInfo->bSetTXPowerTrainingByOid) - pMgntInfo->bSetTXPowerTrainingByOid = FALSE; - #endif -#endif // #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -} - - -VOID -odm_RefreshRateAdaptiveMaskCE( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER pAdapter = pDM_Odm->Adapter; - PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; - u4Byte i; - PSTA_INFO_T pEntry; - u1Byte Ratr_State_new; - - if (RTW_CANNOT_RUN(pAdapter)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_TRACE, ("<---- odm_RefreshRateAdaptiveMask(): driver is going to unload\n")); - return; - } - - if (!pDM_Odm->bUseRAMask) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("<---- odm_RefreshRateAdaptiveMask(): driver does not control rate adaptive mask\n")); - return; - } - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - - pEntry = pDM_Odm->pODM_StaInfo[i]; - - if (IS_STA_VALID(pEntry)) { - - if (IS_MCAST(pEntry->hwaddr)) - continue; - - #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) - if ((pDM_Odm->SupportICType == ODM_RTL8812) || (pDM_Odm->SupportICType == ODM_RTL8821)) { - if (pEntry->rssi_stat.UndecoratedSmoothedPWDB < pRA->LdpcThres) { - pRA->bUseLdpc = TRUE; - pRA->bLowerRtsRate = TRUE; - if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) - Set_RA_LDPC_8812(pEntry, TRUE); - //DbgPrint("RSSI=%d, bUseLdpc = TRUE\n", pHalData->UndecoratedSmoothedPWDB); - } else if (pEntry->rssi_stat.UndecoratedSmoothedPWDB > (pRA->LdpcThres - 5)) { - pRA->bUseLdpc = FALSE; - pRA->bLowerRtsRate = FALSE; - if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) - Set_RA_LDPC_8812(pEntry, FALSE); - //DbgPrint("RSSI=%d, bUseLdpc = FALSE\n", pHalData->UndecoratedSmoothedPWDB); - } - } - #endif - - #if RA_MASK_PHYDMLIZE_CE - Ratr_State_new = phydm_RA_level_decision(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_level); - - if (pEntry->rssi_level != Ratr_State_new) { - - /*ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pstat->hwaddr);*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", - pEntry->rssi_level, Ratr_State_new, pEntry->rssi_stat.UndecoratedSmoothedPWDB)); - - pEntry->rssi_level = Ratr_State_new; - rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); - /**/ - } - #else - if (TRUE == ODM_RAStateCheck(pDM_Odm, pEntry->rssi_stat.UndecoratedSmoothedPWDB, FALSE , &pEntry->rssi_level)) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi_stat.UndecoratedSmoothedPWDB, pEntry->rssi_level)); - //printk("RSSI:%d, RSSI_LEVEL:%d\n", pstat->rssi_stat.UndecoratedSmoothedPWDB, pstat->rssi_level); - rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); - } else if (pDM_Odm->bChangeState) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Change Power Training State, bDisablePowerTraining = %d\n", pDM_Odm->bDisablePowerTraining)); - rtw_hal_update_ra_mask(pEntry, pEntry->rssi_level); - } - #endif - - } - } - -#endif -} - -VOID -odm_RefreshRateAdaptiveMaskAPADSL( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - struct rtl8192cd_priv *priv = pDM_Odm->priv; - struct aid_obj *aidarray; - u4Byte i; - PSTA_INFO_T pEntry; - u1Byte Ratr_State_new; - - if (priv->up_time % 2) - return; - - for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { - pEntry = pDM_Odm->pODM_StaInfo[i]; - - if (IS_STA_VALID(pEntry)) { - - #if defined(UNIVERSAL_REPEATER) || defined(MBSSID) - aidarray = container_of(pEntry, struct aid_obj, station); - priv = aidarray->priv; - #endif - - if (!priv->pmib->dot11StationConfigEntry.autoRate) - continue; - -#if RA_MASK_PHYDMLIZE_AP - Ratr_State_new = phydm_RA_level_decision(pDM_Odm, (u4Byte)pEntry->rssi, pEntry->rssi_level); - - if (pEntry->rssi_level != Ratr_State_new) { - - ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target AP addr :"), pEntry->hwaddr); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", pEntry->rssi_level, Ratr_State_new, pEntry->rssi)); - - pEntry->rssi_level = Ratr_State_new; - phydm_gen_ramask_h2c_AP(pDM_Odm, priv, pEntry, pEntry->rssi_level); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Stay in RA level = (( %d ))\n\n", Ratr_State_new)); - /**/ - } - -#else - if (ODM_RAStateCheck(pDM_Odm, (s4Byte)pEntry->rssi, FALSE, &pEntry->rssi_level)) { - ODM_PRINT_ADDR(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("Target STA addr : "), pEntry->hwaddr); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI:%d, RSSI_LEVEL:%d\n", pEntry->rssi, pEntry->rssi_level)); - - #ifdef CONFIG_WLAN_HAL - if (IS_HAL_CHIP(priv)) { - #ifdef WDS - /*if(!(pstat->state & WIFI_WDS))*/ /*if WDS donot setting*/ - #endif - GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, pEntry, pEntry->rssi_level); - } else - #endif - - #ifdef CONFIG_RTL_8812_SUPPORT - if (GET_CHIP_VER(priv) == VERSION_8812E) - UpdateHalRAMask8812(priv, pEntry, 3); - else - #endif - { - #ifdef CONFIG_RTL_88E_SUPPORT - if (GET_CHIP_VER(priv) == VERSION_8188E) { - #ifdef TXREPORT - add_RATid(priv, pEntry); - #endif - } - #endif - - - } - } -#endif /*#ifdef RA_MASK_PHYDMLIZE*/ - - } - } -#endif /*#if (DM_ODM_SUPPORT_TYPE & ODM_AP)*/ -} - -VOID -odm_RefreshBasicRateMask( - IN PVOID pDM_VOID -) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - static u1Byte Stage = 0; - u1Byte CurStage = 0; - OCTET_STRING osRateSet; - PMGNT_INFO pMgntInfo = GetDefaultMgntInfo(Adapter); - u1Byte RateSet[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M}; - - if (pDM_Odm->SupportICType != ODM_RTL8812 && pDM_Odm->SupportICType != ODM_RTL8821) - return; - - if (pDM_Odm->bLinked == FALSE) // unlink Default port information - CurStage = 0; - else if (pDM_Odm->RSSI_Min < 40) // link RSSI < 40% - CurStage = 1; - else if (pDM_Odm->RSSI_Min > 45) // link RSSI > 45% - CurStage = 3; - else - CurStage = 2; // link 25% <= RSSI <= 30% - - if (CurStage != Stage) { - if (CurStage == 1) { - FillOctetString(osRateSet, RateSet, 5); - FilterSupportRate(pMgntInfo->mBrates, &osRateSet, FALSE); - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)&osRateSet); - } else if (CurStage == 3 && (Stage == 1 || Stage == 2)) - Adapter->HalFunc.SetHwRegHandler(Adapter, HW_VAR_BASIC_RATE, (pu1Byte)(&pMgntInfo->mBrates)); - } - - Stage = CurStage; -#endif -} - -u1Byte -phydm_rate_order_compute( - IN PVOID pDM_VOID, - IN u1Byte rate_idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte rate_order = 0; - - if (rate_idx >= ODM_RATEVHTSS4MCS0) { - - rate_idx -= ODM_RATEVHTSS4MCS0; - /**/ - } else if (rate_idx >= ODM_RATEVHTSS3MCS0) { - - rate_idx -= ODM_RATEVHTSS3MCS0; - /**/ - } else if (rate_idx >= ODM_RATEVHTSS2MCS0) { - - rate_idx -= ODM_RATEVHTSS2MCS0; - /**/ - } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { - - rate_idx -= ODM_RATEVHTSS1MCS0; - /**/ - } else if (rate_idx >= ODM_RATEMCS24) { - - rate_idx -= ODM_RATEMCS24; - /**/ - } else if (rate_idx >= ODM_RATEMCS16) { - - rate_idx -= ODM_RATEMCS16; - /**/ - } else if (rate_idx >= ODM_RATEMCS8) { - - rate_idx -= ODM_RATEMCS8; - /**/ - } - rate_order = rate_idx; - - return rate_order; - -} - -VOID -phydm_ra_common_info_update( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - u2Byte macid; - u1Byte rate_order_tmp; - u1Byte cnt = 0; - - pRA_Table->highest_client_tx_order = 0; - pRA_Table->power_tracking_flag = 1; - - if (pDM_Odm->number_linked_client != 0) { - for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { - - rate_order_tmp = phydm_rate_order_compute(pDM_Odm, ((pRA_Table->link_tx_rate[macid]) & 0x7f)); - - if (rate_order_tmp >= (pRA_Table->highest_client_tx_order)) { - pRA_Table->highest_client_tx_order = rate_order_tmp; - pRA_Table->highest_client_tx_rate_order = macid; - } - - cnt++; - - if (cnt == pDM_Odm->number_linked_client) - break; - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("MACID[%d], Highest Tx order Update for power traking: %d\n", (pRA_Table->highest_client_tx_rate_order), (pRA_Table->highest_client_tx_order))); - } -} - -VOID -phydm_ra_info_watchdog( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - phydm_ra_common_info_update(pDM_Odm); - phydm_ra_dynamic_retry_limit(pDM_Odm); - phydm_ra_dynamic_retry_count(pDM_Odm); - odm_RefreshRateAdaptiveMask(pDM_Odm); - odm_RefreshBasicRateMask(pDM_Odm); -} - -VOID -phydm_ra_info_init( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - - pRA_Table->highest_client_tx_rate_order = 0; - pRA_Table->highest_client_tx_order = 0; - pRA_Table->RA_threshold_offset = 0; - pRA_Table->RA_offset_direction = 0; - - #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) - phydm_ra_dynamic_retry_limit_init(pDM_Odm); - #endif - - #if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) - phydm_ra_dynamic_rate_id_init(pDM_Odm); - #endif - #if (defined(CONFIG_RA_DBG_CMD)) - odm_RA_ParaAdjust_init(pDM_Odm); - #endif - -} - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) -u1Byte -odm_Find_RTS_Rate( - IN PVOID pDM_VOID, - IN u1Byte Tx_Rate, - IN BOOLEAN bErpProtect -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte RTS_Ini_Rate = ODM_RATE6M; - - if (bErpProtect) /* use CCK rate as RTS*/ - RTS_Ini_Rate = ODM_RATE1M; - else { - switch (Tx_Rate) { - case ODM_RATEVHTSS3MCS9: - case ODM_RATEVHTSS3MCS8: - case ODM_RATEVHTSS3MCS7: - case ODM_RATEVHTSS3MCS6: - case ODM_RATEVHTSS3MCS5: - case ODM_RATEVHTSS3MCS4: - case ODM_RATEVHTSS3MCS3: - case ODM_RATEVHTSS2MCS9: - case ODM_RATEVHTSS2MCS8: - case ODM_RATEVHTSS2MCS7: - case ODM_RATEVHTSS2MCS6: - case ODM_RATEVHTSS2MCS5: - case ODM_RATEVHTSS2MCS4: - case ODM_RATEVHTSS2MCS3: - case ODM_RATEVHTSS1MCS9: - case ODM_RATEVHTSS1MCS8: - case ODM_RATEVHTSS1MCS7: - case ODM_RATEVHTSS1MCS6: - case ODM_RATEVHTSS1MCS5: - case ODM_RATEVHTSS1MCS4: - case ODM_RATEVHTSS1MCS3: - case ODM_RATEMCS15: - case ODM_RATEMCS14: - case ODM_RATEMCS13: - case ODM_RATEMCS12: - case ODM_RATEMCS11: - case ODM_RATEMCS7: - case ODM_RATEMCS6: - case ODM_RATEMCS5: - case ODM_RATEMCS4: - case ODM_RATEMCS3: - case ODM_RATE54M: - case ODM_RATE48M: - case ODM_RATE36M: - case ODM_RATE24M: - RTS_Ini_Rate = ODM_RATE24M; - break; - case ODM_RATEVHTSS3MCS2: - case ODM_RATEVHTSS3MCS1: - case ODM_RATEVHTSS2MCS2: - case ODM_RATEVHTSS2MCS1: - case ODM_RATEVHTSS1MCS2: - case ODM_RATEVHTSS1MCS1: - case ODM_RATEMCS10: - case ODM_RATEMCS9: - case ODM_RATEMCS2: - case ODM_RATEMCS1: - case ODM_RATE18M: - case ODM_RATE12M: - RTS_Ini_Rate = ODM_RATE12M; - break; - case ODM_RATEVHTSS3MCS0: - case ODM_RATEVHTSS2MCS0: - case ODM_RATEVHTSS1MCS0: - case ODM_RATEMCS8: - case ODM_RATEMCS0: - case ODM_RATE9M: - case ODM_RATE6M: - RTS_Ini_Rate = ODM_RATE6M; - break; - case ODM_RATE11M: - case ODM_RATE5_5M: - case ODM_RATE2M: - case ODM_RATE1M: - RTS_Ini_Rate = ODM_RATE1M; - break; - default: - RTS_Ini_Rate = ODM_RATE6M; - break; - } - } - - if (*pDM_Odm->pBandType == 1) { - if (RTS_Ini_Rate < ODM_RATE6M) - RTS_Ini_Rate = ODM_RATE6M; - } - return RTS_Ini_Rate; - -} - -VOID -odm_Set_RA_DM_ARFB_by_Noisy( - IN PDM_ODM_T pDM_Odm -) -{ -#if 0 - - /*DbgPrint("DM_ARFB ====>\n");*/ - if (pDM_Odm->bNoisyState) { - ODM_Write4Byte(pDM_Odm, 0x430, 0x00000000); - ODM_Write4Byte(pDM_Odm, 0x434, 0x05040200); - /*DbgPrint("DM_ARFB ====> Noisy State\n");*/ - } else { - ODM_Write4Byte(pDM_Odm, 0x430, 0x02010000); - ODM_Write4Byte(pDM_Odm, 0x434, 0x07050403); - /*DbgPrint("DM_ARFB ====> Clean State\n");*/ - } -#endif -} - -VOID -ODM_UpdateNoisyState( - IN PVOID pDM_VOID, - IN BOOLEAN bNoisyStateFromC2H -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - /*DbgPrint("Get C2H Command! NoisyState=0x%x\n ", bNoisyStateFromC2H);*/ - if (pDM_Odm->SupportICType == ODM_RTL8821 || pDM_Odm->SupportICType == ODM_RTL8812 || - pDM_Odm->SupportICType == ODM_RTL8723B || pDM_Odm->SupportICType == ODM_RTL8192E || pDM_Odm->SupportICType == ODM_RTL8188E || pDM_Odm->SupportICType == ODM_RTL8723D) - pDM_Odm->bNoisyState = bNoisyStateFromC2H; - odm_Set_RA_DM_ARFB_by_Noisy(pDM_Odm); -}; - -VOID -phydm_update_pwr_track( - IN PVOID pDM_VOID, - IN u1Byte Rate -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte pathIdx = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Pwr Track Get Rate=0x%x\n", Rate)); - - pDM_Odm->TxRate = Rate; - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #if DEV_BUS_TYPE == RT_PCI_INTERFACE - #if USE_WORKITEM - PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); - #else - if (pDM_Odm->SupportICType == ODM_RTL8821) { - #if (RTL8821A_SUPPORT == 1) - ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); - #endif - } else if (pDM_Odm->SupportICType == ODM_RTL8812) { - for (pathIdx = ODM_RF_PATH_A; pathIdx < MAX_PATH_NUM_8812A; pathIdx++) { - #if (RTL8812A_SUPPORT == 1) - ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, pathIdx, 0); - #endif - } - } else if (pDM_Odm->SupportICType == ODM_RTL8723B) { - #if (RTL8723B_SUPPORT == 1) - ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); - #endif - } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { - for (pathIdx = ODM_RF_PATH_A; pathIdx < MAX_PATH_NUM_8192E; pathIdx++) { - #if (RTL8192E_SUPPORT == 1) - ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, pathIdx, 0); - #endif - } - } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { - #if (RTL8188E_SUPPORT == 1) - ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); - #endif - } - #endif - #else - PlatformScheduleWorkItem(&pDM_Odm->RaRptWorkitem); - #endif - #endif - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -s4Byte -phydm_FindMinimumRSSI( -IN PDM_ODM_T pDM_Odm, -IN PADAPTER pAdapter, -IN OUT BOOLEAN *pbLink_temp - - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PMGNT_INFO pMgntInfo = &(pAdapter->MgntInfo); - BOOLEAN act_as_ap = ACTING_AS_AP(pAdapter); - - /* 1.Determine the minimum RSSI */ - if ((!pMgntInfo->bMediaConnect) || - (act_as_ap && (pHalData->EntryMinUndecoratedSmoothedPWDB == 0))) {/* We should check AP mode and Entry info.into consideration, revised by Roger, 2013.10.18*/ - - pHalData->MinUndecoratedPWDBForDM = 0; - *pbLink_temp = FALSE; - - } else - *pbLink_temp = TRUE; - - - if (pMgntInfo->bMediaConnect) { /* Default port*/ - - if (act_as_ap || pMgntInfo->mIbss) { - pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; - /**/ - } else { - pHalData->MinUndecoratedPWDBForDM = pHalData->UndecoratedSmoothedPWDB; - /**/ - } - } else { /* associated entry pwdb*/ - pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; - /**/ - } - - return pHalData->MinUndecoratedPWDBForDM; -} - -VOID -ODM_UpdateInitRateWorkItemCallback( - IN PVOID pContext -) -{ - PADAPTER Adapter = (PADAPTER)pContext; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - u1Byte p = 0; - - if (pDM_Odm->SupportICType == ODM_RTL8821) { - ODM_TxPwrTrackSetPwr8821A(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); - /**/ - } else if (pDM_Odm->SupportICType == ODM_RTL8812) { - for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8812A; p++) { /*DOn't know how to include &c*/ - - ODM_TxPwrTrackSetPwr8812A(pDM_Odm, MIX_MODE, p, 0); - /**/ - } - } else if (pDM_Odm->SupportICType == ODM_RTL8723B) { - ODM_TxPwrTrackSetPwr_8723B(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); - /**/ - } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { - for (p = ODM_RF_PATH_A; p < MAX_PATH_NUM_8192E; p++) { /*DOn't know how to include &c*/ - ODM_TxPwrTrackSetPwr92E(pDM_Odm, MIX_MODE, p, 0); - /**/ - } - } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { - ODM_TxPwrTrackSetPwr88E(pDM_Odm, MIX_MODE, ODM_RF_PATH_A, 0); - /**/ - } -} - -VOID -odm_RSSIDumpToRegister( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - - if (pDM_Odm->SupportICType == ODM_RTL8812) { - PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[0]); - PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_Jaguar, Adapter->RxStats.RxRSSIPercentage[1]); - - /* Rx EVM*/ - PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[0]); - PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_Jaguar, Adapter->RxStats.RxEVMdbm[1]); - - /* Rx SNR*/ - PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); - PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_Jaguar, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); - - /* Rx Cfo_Short*/ - PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[0]); - PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_Jaguar, Adapter->RxStats.RxCfoShort[1]); - - /* Rx Cfo_Tail*/ - PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[0]); - PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_Jaguar, Adapter->RxStats.RxCfoTail[1]); - } else if (pDM_Odm->SupportICType == ODM_RTL8192E) { - PlatformEFIOWrite1Byte(Adapter, rA_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[0]); - PlatformEFIOWrite1Byte(Adapter, rB_RSSIDump_92E, Adapter->RxStats.RxRSSIPercentage[1]); - /* Rx EVM*/ - PlatformEFIOWrite1Byte(Adapter, rS1_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[0]); - PlatformEFIOWrite1Byte(Adapter, rS2_RXevmDump_92E, Adapter->RxStats.RxEVMdbm[1]); - /* Rx SNR*/ - PlatformEFIOWrite1Byte(Adapter, rA_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[0])); - PlatformEFIOWrite1Byte(Adapter, rB_RXsnrDump_92E, (u1Byte)(Adapter->RxStats.RxSNRdB[1])); - /* Rx Cfo_Short*/ - PlatformEFIOWrite2Byte(Adapter, rA_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[0]); - PlatformEFIOWrite2Byte(Adapter, rB_CfoShortDump_92E, Adapter->RxStats.RxCfoShort[1]); - /* Rx Cfo_Tail*/ - PlatformEFIOWrite2Byte(Adapter, rA_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[0]); - PlatformEFIOWrite2Byte(Adapter, rB_CfoLongDump_92E, Adapter->RxStats.RxCfoTail[1]); - } -} - -VOID -odm_RefreshLdpcRtsMP( - IN PADAPTER pAdapter, - IN PDM_ODM_T pDM_Odm, - IN u1Byte mMacId, - IN u1Byte IOTPeer, - IN s4Byte UndecoratedSmoothedPWDB -) -{ - BOOLEAN bCtlLdpc = FALSE; - PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; - - if (pDM_Odm->SupportICType != ODM_RTL8821 && pDM_Odm->SupportICType != ODM_RTL8812) - return; - - if ((pDM_Odm->SupportICType == ODM_RTL8821) && (pDM_Odm->CutVersion == ODM_CUT_A)) - bCtlLdpc = TRUE; - else if (pDM_Odm->SupportICType == ODM_RTL8812 && - IOTPeer == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) - bCtlLdpc = TRUE; - - if (bCtlLdpc) { - if (UndecoratedSmoothedPWDB < (pRA->LdpcThres - 5)) - MgntSet_TX_LDPC(pAdapter, mMacId, TRUE); - else if (UndecoratedSmoothedPWDB > pRA->LdpcThres) - MgntSet_TX_LDPC(pAdapter, mMacId, FALSE); - } - - if (UndecoratedSmoothedPWDB < (pRA->RtsThres - 5)) - pRA->bLowerRtsRate = TRUE; - else if (UndecoratedSmoothedPWDB > pRA->RtsThres) - pRA->bLowerRtsRate = FALSE; -} - -#if 0 -VOID -ODM_DynamicARFBSelect( - IN PVOID pDM_VOID, - IN u1Byte rate, - IN BOOLEAN Collision_State -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pRA_T pRA_Table = &pDM_Odm->DM_RA_Table; - - if (pDM_Odm->SupportICType != ODM_RTL8192E) - return; - - if (Collision_State == pRA_Table->PT_collision_pre) - return; - - if (rate >= DESC_RATEMCS8 && rate <= DESC_RATEMCS12) { - if (Collision_State == 1) { - if (rate == DESC_RATEMCS12) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060501); - } else if (rate == DESC_RATEMCS11) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07070605); - } else if (rate == DESC_RATEMCS10) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080706); - } else if (rate == DESC_RATEMCS9) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08080707); - } else { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x0); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09090808); - } - } else { /* Collision_State == 0*/ - if (rate == DESC_RATEMCS12) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05010000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); - } else if (rate == DESC_RATEMCS11) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x06050000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080807); - } else if (rate == DESC_RATEMCS10) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07060000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090908); - } else if (rate == DESC_RATEMCS9) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x07070000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0a090808); - } else { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x08080000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x0b0a0909); - } - } - } else { /* MCS13~MCS15, 1SS, G-mode*/ - if (Collision_State == 1) { - if (rate == DESC_RATEMCS15) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x05040302); - } else if (rate == DESC_RATEMCS14) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050302); - } else if (rate == DESC_RATEMCS13) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060502); - } else { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x00000000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x06050402); - } - } else { // Collision_State == 0 - if (rate == DESC_RATEMCS15) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x07060504); - } else if (rate == DESC_RATEMCS14) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x03020000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); - } else if (rate == DESC_RATEMCS13) { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x05020000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x09080706); - } else { - - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E, 0x04020000); - ODM_Write4Byte(pDM_Odm, REG_DARFRC_8192E+4, 0x08070605); - } - } - } - pRA_Table->PT_collision_pre = Collision_State; -} -#endif - -VOID -ODM_RateAdaptiveStateApInit( - IN PVOID PADAPTER_VOID, - IN PRT_WLAN_STA pEntry -) -{ - PADAPTER Adapter = (PADAPTER)PADAPTER_VOID; - pEntry->Ratr_State = DM_RATR_STA_INIT; -} -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ - -static void -FindMinimumRSSI( - IN PADAPTER pAdapter -) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); - - /*Determine the minimum RSSI*/ - - if ((pDM_Odm->bLinked != _TRUE) && - (pHalData->EntryMinUndecoratedSmoothedPWDB == 0)) { - pHalData->MinUndecoratedPWDBForDM = 0; - /*ODM_RT_TRACE(pDM_Odm,COMP_BB_POWERSAVING, DBG_LOUD, ("Not connected to any\n"));*/ - } else - pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; - - /*DBG_8192C("%s=>MinUndecoratedPWDBForDM(%d)\n",__FUNCTION__,pdmpriv->MinUndecoratedPWDBForDM);*/ - /*ODM_RT_TRACE(pDM_Odm,COMP_DIG, DBG_LOUD, ("MinUndecoratedPWDBForDM =%d\n",pHalData->MinUndecoratedPWDBForDM));*/ -} - -u8Byte -PhyDM_Get_Rate_Bitmap_Ex( - IN PVOID pDM_VOID, - IN u4Byte macid, - IN u8Byte ra_mask, - IN u1Byte rssi_level, - OUT u8Byte *dm_RA_Mask, - OUT u1Byte *dm_RteID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PSTA_INFO_T pEntry; - u8Byte rate_bitmap = 0; - u1Byte WirelessMode; - - pEntry = pDM_Odm->pODM_StaInfo[macid]; - if (!IS_STA_VALID(pEntry)) - return ra_mask; - WirelessMode = pEntry->wireless_mode; - switch (WirelessMode) { - case ODM_WM_B: - if (ra_mask & 0x000000000000000c) /* 11M or 5.5M enable */ - rate_bitmap = 0x000000000000000d; - else - rate_bitmap = 0x000000000000000f; - break; - - case (ODM_WM_G): - case (ODM_WM_A): - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x0000000000000f00; - else - rate_bitmap = 0x0000000000000ff0; - break; - - case (ODM_WM_B|ODM_WM_G): - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x0000000000000f00; - else if (rssi_level == DM_RATR_STA_MIDDLE) - rate_bitmap = 0x0000000000000ff0; - else - rate_bitmap = 0x0000000000000ff5; - break; - - case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G): - case (ODM_WM_B|ODM_WM_N24G): - case (ODM_WM_G|ODM_WM_N24G): - case (ODM_WM_A|ODM_WM_N5G): { - if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x00000000000f0000; - else if (rssi_level == DM_RATR_STA_MIDDLE) - rate_bitmap = 0x00000000000ff000; - else { - if (*(pDM_Odm->pBandWidth) == ODM_BW40M) - rate_bitmap = 0x00000000000ff015; - else - rate_bitmap = 0x00000000000ff005; - } - } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x000000000f8f0000; - else if (rssi_level == DM_RATR_STA_MIDDLE) - rate_bitmap = 0x000000000f8ff000; - else { - if (*(pDM_Odm->pBandWidth) == ODM_BW40M) - rate_bitmap = 0x000000000f8ff015; - else - rate_bitmap = 0x000000000f8ff005; - } - } else { - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x0000000f0f0f0000; - else if (rssi_level == DM_RATR_STA_MIDDLE) - rate_bitmap = 0x0000000fcfcfe000; - else { - if (*(pDM_Odm->pBandWidth) == ODM_BW40M) - rate_bitmap = 0x0000000ffffff015; - else - rate_bitmap = 0x0000000ffffff005; - } - } - } - break; - - case (ODM_WM_AC|ODM_WM_G): - if (rssi_level == 1) - rate_bitmap = 0x00000000fc3f0000; - else if (rssi_level == 2) - rate_bitmap = 0x00000000fffff000; - else - rate_bitmap = 0x00000000ffffffff; - break; - - case (ODM_WM_AC|ODM_WM_A): - - if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { - if (rssi_level == 1) /* add by Gary for ac-series */ - rate_bitmap = 0x00000000003f8000; - else if (rssi_level == 2) - rate_bitmap = 0x00000000003fe000; - else - rate_bitmap = 0x00000000003ff010; - } else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) { - if (rssi_level == 1) /* add by Gary for ac-series */ - rate_bitmap = 0x00000000fe3f8000; /* VHT 2SS MCS3~9 */ - else if (rssi_level == 2) - rate_bitmap = 0x00000000fffff000; /* VHT 2SS MCS0~9 */ - else - rate_bitmap = 0x00000000fffff010; /* All */ - } else { - if (rssi_level == 1) /* add by Gary for ac-series */ - rate_bitmap = 0x000003f8fe3f8000ULL; /* VHT 3SS MCS3~9 */ - else if (rssi_level == 2) - rate_bitmap = 0x000003fffffff000ULL; /* VHT3SS MCS0~9 */ - else - rate_bitmap = 0x000003fffffff010ULL; /* All */ - } - break; - - default: - if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) - rate_bitmap = 0x00000000000fffff; - else if (pDM_Odm->RFType == ODM_2T2R || pDM_Odm->RFType == ODM_2T3R || pDM_Odm->RFType == ODM_2T4R) - rate_bitmap = 0x000000000fffffff; - else - rate_bitmap = 0x0000003fffffffffULL; - break; - - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%016llx\n", rssi_level, WirelessMode, rate_bitmap)); - - return (ra_mask & rate_bitmap); -} - - -u4Byte -ODM_Get_Rate_Bitmap( - IN PVOID pDM_VOID, - IN u4Byte macid, - IN u4Byte ra_mask, - IN u1Byte rssi_level -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PSTA_INFO_T pEntry; - u4Byte rate_bitmap = 0; - u1Byte WirelessMode; - //u1Byte WirelessMode =*(pDM_Odm->pWirelessMode); - - - pEntry = pDM_Odm->pODM_StaInfo[macid]; - if (!IS_STA_VALID(pEntry)) - return ra_mask; - - WirelessMode = pEntry->wireless_mode; - - switch (WirelessMode) { - case ODM_WM_B: - if (ra_mask & 0x0000000c) //11M or 5.5M enable - rate_bitmap = 0x0000000d; - else - rate_bitmap = 0x0000000f; - break; - - case (ODM_WM_G): - case (ODM_WM_A): - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x00000f00; - else - rate_bitmap = 0x00000ff0; - break; - - case (ODM_WM_B|ODM_WM_G): - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x00000f00; - else if (rssi_level == DM_RATR_STA_MIDDLE) - rate_bitmap = 0x00000ff0; - else - rate_bitmap = 0x00000ff5; - break; - - case (ODM_WM_B|ODM_WM_G|ODM_WM_N24G) : - case (ODM_WM_B|ODM_WM_N24G) : - case (ODM_WM_G|ODM_WM_N24G) : - case (ODM_WM_A|ODM_WM_N5G) : { - if (pDM_Odm->RFType == ODM_1T2R || pDM_Odm->RFType == ODM_1T1R) { - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x000f0000; - else if (rssi_level == DM_RATR_STA_MIDDLE) - rate_bitmap = 0x000ff000; - else { - if (*(pDM_Odm->pBandWidth) == ODM_BW40M) - rate_bitmap = 0x000ff015; - else - rate_bitmap = 0x000ff005; - } - } else { - if (rssi_level == DM_RATR_STA_HIGH) - rate_bitmap = 0x0f8f0000; - else if (rssi_level == DM_RATR_STA_MIDDLE) - rate_bitmap = 0x0f8ff000; - else { - if (*(pDM_Odm->pBandWidth) == ODM_BW40M) - rate_bitmap = 0x0f8ff015; - else - rate_bitmap = 0x0f8ff005; - } - } - } - break; - - case (ODM_WM_AC|ODM_WM_G): - if (rssi_level == 1) - rate_bitmap = 0xfc3f0000; - else if (rssi_level == 2) - rate_bitmap = 0xfffff000; - else - rate_bitmap = 0xffffffff; - break; - - case (ODM_WM_AC|ODM_WM_A): - - if (pDM_Odm->RFType == RF_1T1R) { - if (rssi_level == 1) // add by Gary for ac-series - rate_bitmap = 0x003f8000; - else if (rssi_level == 2) - rate_bitmap = 0x003ff000; - else - rate_bitmap = 0x003ff010; - } else { - if (rssi_level == 1) // add by Gary for ac-series - rate_bitmap = 0xfe3f8000; // VHT 2SS MCS3~9 - else if (rssi_level == 2) - rate_bitmap = 0xfffff000; // VHT 2SS MCS0~9 - else - rate_bitmap = 0xfffff010; // All - } - break; - - default: - if (pDM_Odm->RFType == RF_1T2R) - rate_bitmap = 0x000fffff; - else - rate_bitmap = 0x0fffffff; - break; - - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RATE_ADAPTIVE, ODM_DBG_LOUD, ("%s ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", __func__, rssi_level, WirelessMode, rate_bitmap)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, (" ==> rssi_level:0x%02x, WirelessMode:0x%02x, rate_bitmap:0x%08x\n", rssi_level, WirelessMode, rate_bitmap)); - - return (ra_mask & rate_bitmap); - -} - -#endif //#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -VOID -phydm_gen_ramask_h2c_AP( - IN PVOID pDM_VOID, - IN struct rtl8192cd_priv *priv, - IN PSTA_INFO_T *pEntry, - IN u1Byte rssi_level -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & (ODM_RTL8192E | ODM_RTL8881A)) { - - #ifdef CONFIG_WLAN_HAL - GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, pEntry, rssi_level); - #endif - - } else if (pDM_Odm->SupportICType == ODM_RTL8812) { - - #if (RTL8812A_SUPPORT == 1) - UpdateHalRAMask8812(priv, pEntry, rssi_level); - /**/ - #endif - } else if (pDM_Odm->SupportICType == ODM_RTL8188E) { - - #if (RTL8188E_SUPPORT == 1) - #ifdef TXREPORT - add_RATid(priv, pEntry); - /**/ - #endif - #endif - } -} - - -#endif /*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ - - -/* RA_MASK_PHYDMLIZE, will delete it later*/ - -#if (RA_MASK_PHYDMLIZE_CE || RA_MASK_PHYDMLIZE_AP || RA_MASK_PHYDMLIZE_WIN) - -BOOLEAN -ODM_RAStateCheck( - IN PVOID pDM_VOID, - IN s4Byte RSSI, - IN BOOLEAN bForceUpdate, - OUT pu1Byte pRATRState -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RATE_ADAPTIVE pRA = &pDM_Odm->RateAdaptive; - const u1Byte GoUpGap = 5; - u1Byte HighRSSIThreshForRA = pRA->HighRSSIThresh; - u1Byte LowRSSIThreshForRA = pRA->LowRSSIThresh; - u1Byte RATRState; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("RSSI= (( %d )), Current_RSSI_level = (( %d ))\n", RSSI, *pRATRState)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Ori RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); - /* Threshold Adjustment:*/ - /* when RSSI state trends to go up one or two levels, make sure RSSI is high enough.*/ - /* Here GoUpGap is added to solve the boundary's level alternation issue.*/ -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - u1Byte UltraLowRSSIThreshForRA = pRA->UltraLowRSSIThresh; - - if (pDM_Odm->SupportICType == ODM_RTL8881A) - LowRSSIThreshForRA = 30; /* for LDPC / BCC switch*/ -#endif - - switch (*pRATRState) { - case DM_RATR_STA_INIT: - case DM_RATR_STA_HIGH: - break; - - case DM_RATR_STA_MIDDLE: - HighRSSIThreshForRA += GoUpGap; - break; - - case DM_RATR_STA_LOW: - HighRSSIThreshForRA += GoUpGap; - LowRSSIThreshForRA += GoUpGap; - break; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - case DM_RATR_STA_ULTRA_LOW: - HighRSSIThreshForRA += GoUpGap; - LowRSSIThreshForRA += GoUpGap; - UltraLowRSSIThreshForRA += GoUpGap; - break; -#endif - - default: - ODM_RT_ASSERT(pDM_Odm, FALSE, ("wrong rssi level setting %d !", *pRATRState)); - break; - } - - /* Decide RATRState by RSSI.*/ - if (RSSI > HighRSSIThreshForRA) - RATRState = DM_RATR_STA_HIGH; - else if (RSSI > LowRSSIThreshForRA) - RATRState = DM_RATR_STA_MIDDLE; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - else if (RSSI > UltraLowRSSIThreshForRA) - RATRState = DM_RATR_STA_LOW; - else - RATRState = DM_RATR_STA_ULTRA_LOW; -#else - else - RATRState = DM_RATR_STA_LOW; -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[Mod RA RSSI Thresh] High= (( %d )), Low = (( %d ))\n", HighRSSIThreshForRA, LowRSSIThreshForRA)); - /*printk("==>%s,RATRState:0x%02x ,RSSI:%d\n",__FUNCTION__,RATRState,RSSI);*/ - - if (*pRATRState != RATRState || bForceUpdate) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_RA_MASK, ODM_DBG_LOUD, ("[RSSI Level Update] %d -> %d\n", *pRATRState, RATRState)); - *pRATRState = RATRState; - return TRUE; - } - - return FALSE; -} - -#endif - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void +phydm_h2C_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 h2c_parameter[H2C_MAX_LENGTH] = {0}; + u8 phydm_h2c_id = (u8)dm_value[0]; + u8 i; + u32 used = *_used; + u32 out_len = *_out_len; + + PHYDM_SNPRINTF((output + used, out_len - used, "Phydm Send H2C_ID (( 0x%x))\n", phydm_h2c_id)); + for (i = 0; i < H2C_MAX_LENGTH; i++) { + + h2c_parameter[i] = (u8)dm_value[i + 1]; + PHYDM_SNPRINTF((output + used, out_len - used, "H2C: Byte[%d] = ((0x%x))\n", i, h2c_parameter[i])); + } + + odm_fill_h2c_cmd(p_dm, phydm_h2c_id, H2C_MAX_LENGTH, h2c_parameter); + + *_used = used; + *_out_len = out_len; +} + +void +phydm_fw_fix_rate( + void *p_dm_void, + u8 en, + u8 macid, + u8 bw, + u8 rate + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 reg_u32_tmp; + + if (p_dm->support_ic_type & PHYDM_IC_8051_SERIES) { + + reg_u32_tmp = (bw << 24) | (rate << 16) | (macid << 8) | en; + odm_set_bb_reg(p_dm, 0x4a0, MASKDWORD, reg_u32_tmp); + + } else { + + if (en == 1) + reg_u32_tmp = (0x60 << 24) | (macid << 16) | (bw << 8) | rate; + else + reg_u32_tmp = 0x40000000; + + odm_set_bb_reg(p_dm, 0x450, MASKDWORD, reg_u32_tmp); + } + if (en == 1) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("FW fix TX rate[id =%d], %dM, Rate(%d)=", macid, (20 << bw), rate)); + phydm_print_rate(p_dm, rate, ODM_COMP_API); + } else { + PHYDM_DBG(p_dm, ODM_COMP_API, ("Auto Rate\n")); + } +} + +void +phydm_ra_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u32 used = *_used; + u32 out_len = *_out_len; + char help[] = "-h"; + u32 var1[5] = {0}; + u8 i = 0; + u32 reg_u32_tmp; + + for (i = 0; i < 5; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &var1[i]); + } + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "{1} {0:-,1:+} {ofst}: set offset\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{1} {100}: show offset\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{2} {en} {macid} {bw} {rate}: fw fix rate\n")); + + } else if (var1[0] == 1) { /*Adjust PCR offset*/ + + if (var1[1] == 100) { + PHYDM_SNPRINTF((output + used, out_len - used, "[Get] RA_ofst=((%s%d))\n", + ((p_ra_table->RA_threshold_offset == 0) ? " " : ((p_ra_table->RA_offset_direction) ? "+" : "-")), p_ra_table->RA_threshold_offset)); + + } else if (var1[1] == 0) { + p_ra_table->RA_offset_direction = 0; + p_ra_table->RA_threshold_offset = (u8)var1[2]; + PHYDM_SNPRINTF((output + used, out_len - used, "[Set] RA_ofst=((-%d))\n", p_ra_table->RA_threshold_offset)); + } else if (var1[1] == 1) { + p_ra_table->RA_offset_direction = 1; + p_ra_table->RA_threshold_offset = (u8)var1[2]; + PHYDM_SNPRINTF((output + used, out_len - used, "[Set] RA_ofst=((+%d))\n", p_ra_table->RA_threshold_offset)); + } + + } else if (var1[0] == 2) { /*FW fix rate*/ + + PHYDM_SNPRINTF((output + used, out_len - used, + "[FW fix TX Rate] {en, macid,bw,rate}={%d, %d, %d, 0x%x}", var1[1], var1[2], var1[3], var1[4])); + + phydm_fw_fix_rate(p_dm, (u8)var1[1], (u8)var1[2], (u8)var1[3], (u8)var1[4]); + + } else { + PHYDM_SNPRINTF((output + used, out_len - used, "[Set] Error\n")); + /**/ + } + *_used = used; + *_out_len = out_len; +} + + + +void +odm_c2h_ra_para_report_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (defined(CONFIG_RA_DBG_CMD)) + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; +#endif + + u8 para_idx = cmd_buf[0]; /*Retry Penalty, NH, NL*/ +#if (defined(CONFIG_RA_DBG_CMD)) + u8 rate_type_start = cmd_buf[1]; + u8 rate_type_length = cmd_len - 2; +#endif + u8 i; + + + PHYDM_DBG(p_dm, DBG_RA, ("[ From FW C2H RA Para ] cmd_buf[0]= (( %d ))\n", cmd_buf[0])); + +#if (defined(CONFIG_RA_DBG_CMD)) + if (para_idx == RADBG_RTY_PENALTY) { + PHYDM_DBG(p_dm, DBG_RA, (" |rate index| |RTY Penality index|\n")); + + for (i = 0 ; i < (rate_type_length) ; i++) { + if (p_ra_table->is_ra_dbg_init) + p_ra_table->RTY_P_default[rate_type_start + i] = cmd_buf[2 + i]; + + p_ra_table->RTY_P[rate_type_start + i] = cmd_buf[2 + i]; + PHYDM_DBG(p_dm, DBG_RA, ("%8d %15d\n", (rate_type_start + i), p_ra_table->RTY_P[rate_type_start + i])); + } + + } else if (para_idx == RADBG_N_HIGH) { + /**/ + PHYDM_DBG(p_dm, DBG_RA, (" |rate index| |N-High|\n")); + + + } else if (para_idx == RADBG_N_LOW) { + PHYDM_DBG(p_dm, DBG_RA, (" |rate index| |N-Low|\n")); + /**/ + } else if (para_idx == RADBG_RATE_UP_RTY_RATIO) { + PHYDM_DBG(p_dm, DBG_RA, (" |rate index| |rate Up RTY Ratio|\n")); + + for (i = 0; i < (rate_type_length); i++) { + if (p_ra_table->is_ra_dbg_init) + p_ra_table->RATE_UP_RTY_RATIO_default[rate_type_start + i] = cmd_buf[2 + i]; + + p_ra_table->RATE_UP_RTY_RATIO[rate_type_start + i] = cmd_buf[2 + i]; + PHYDM_DBG(p_dm, DBG_RA, ("%8d %15d\n", (rate_type_start + i), p_ra_table->RATE_UP_RTY_RATIO[rate_type_start + i])); + } + } else if (para_idx == RADBG_RATE_DOWN_RTY_RATIO) { + PHYDM_DBG(p_dm, DBG_RA, (" |rate index| |rate Down RTY Ratio|\n")); + + for (i = 0; i < (rate_type_length); i++) { + if (p_ra_table->is_ra_dbg_init) + p_ra_table->RATE_DOWN_RTY_RATIO_default[rate_type_start + i] = cmd_buf[2 + i]; + + p_ra_table->RATE_DOWN_RTY_RATIO[rate_type_start + i] = cmd_buf[2 + i]; + PHYDM_DBG(p_dm, DBG_RA, ("%8d %15d\n", (rate_type_start + i), p_ra_table->RATE_DOWN_RTY_RATIO[rate_type_start + i])); + } + } else +#endif + if (para_idx == RADBG_DEBUG_MONITOR1) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("-------------------------------\n")); + if (p_dm->support_ic_type & PHYDM_IC_3081_SERIES) { + + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "RSSI =", cmd_buf[1])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "rate =", cmd_buf[2] & 0x7f)); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "SGI =", (cmd_buf[2] & 0x80) >> 7)); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "BW =", cmd_buf[3])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "BW_max =", cmd_buf[4])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "multi_rate0 =", cmd_buf[5])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "multi_rate1 =", cmd_buf[6])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "DISRA =", cmd_buf[7])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "VHT_EN =", cmd_buf[8])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "SGI_support =", cmd_buf[9])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "try_ness =", cmd_buf[10])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "pre_rate =", cmd_buf[11])); + } else { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "RSSI =", cmd_buf[1])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %x\n", "BW =", cmd_buf[2])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "DISRA =", cmd_buf[3])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "VHT_EN =", cmd_buf[4])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "Hightest rate =", cmd_buf[5])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "Lowest rate =", cmd_buf[6])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "SGI_support =", cmd_buf[7])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "Rate_ID =", cmd_buf[8])); + } + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("-------------------------------\n")); + } else if (para_idx == RADBG_DEBUG_MONITOR2) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("-------------------------------\n")); + if (p_dm->support_ic_type & PHYDM_IC_3081_SERIES) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "rate_id =", cmd_buf[1])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "highest_rate =", cmd_buf[2])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "lowest_rate =", cmd_buf[3])); + + for (i = 4; i <= 11; i++) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("RAMASK = 0x%x\n", cmd_buf[i])); + } else { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %x%x %x%x %x%x %x%x\n", "RA Mask:", + cmd_buf[8], cmd_buf[7], cmd_buf[6], cmd_buf[5], cmd_buf[4], cmd_buf[3], cmd_buf[2], cmd_buf[1])); + } + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("-------------------------------\n")); + } else if (para_idx == RADBG_DEBUG_MONITOR3) { + + for (i = 0; i < (cmd_len - 1); i++) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("content[%d] = %d\n", i, cmd_buf[1 + i])); + } else if (para_idx == RADBG_DEBUG_MONITOR4) + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s {%d.%d}\n", "RA version =", cmd_buf[1], cmd_buf[2])); + else if (para_idx == RADBG_DEBUG_MONITOR5) { + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "Current rate =", cmd_buf[1])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "Retry ratio =", cmd_buf[2])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s %d\n", "rate down ratio =", cmd_buf[3])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x\n", "highest rate =", cmd_buf[4])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s {0x%x 0x%x}\n", "Muti-try =", cmd_buf[5], cmd_buf[6])); + PHYDM_DBG(p_dm, DBG_FW_TRACE, ("%5s 0x%x%x%x%x%x\n", "RA mask =", cmd_buf[11], cmd_buf[10], cmd_buf[9], cmd_buf[8], cmd_buf[7])); + } +} + +void +phydm_ra_dynamic_retry_count( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & ODM_BB_DYNAMIC_ARFR)) + return; + + /*PHYDM_DBG(p_dm, DBG_RA, ("p_dm->pre_b_noisy = %d\n", p_dm->pre_b_noisy ));*/ + if (p_dm->pre_b_noisy != p_dm->noisy_decision) { + + if (p_dm->noisy_decision) { + PHYDM_DBG(p_dm, DBG_RA, ("Noisy Env. RA fallback\n")); + odm_set_mac_reg(p_dm, 0x430, MASKDWORD, 0x0); + odm_set_mac_reg(p_dm, 0x434, MASKDWORD, 0x04030201); + } else { + PHYDM_DBG(p_dm, DBG_RA, ("Clean Env. RA fallback\n")); + odm_set_mac_reg(p_dm, 0x430, MASKDWORD, 0x01000000); + odm_set_mac_reg(p_dm, 0x434, MASKDWORD, 0x06050402); + } + p_dm->pre_b_noisy = p_dm->noisy_decision; + } +} + +void +phydm_print_rate( + void *p_dm_void, + u8 rate, + u32 dbg_component +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 legacy_table[12] = {1, 2, 5, 11, 6, 9, 12, 18, 24, 36, 48, 54}; + u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ + u8 vht_en = (rate_idx >= ODM_RATEVHTSS1MCS0) ? 1 : 0; + u8 b_sgi = (rate & 0x80) >> 7; + + PHYDM_DBG_F(p_dm, dbg_component, ("( %s%s%s%s%d%s%s)\n", + ((rate_idx >= ODM_RATEVHTSS1MCS0) && (rate_idx <= ODM_RATEVHTSS1MCS9)) ? "VHT 1ss " : "", + ((rate_idx >= ODM_RATEVHTSS2MCS0) && (rate_idx <= ODM_RATEVHTSS2MCS9)) ? "VHT 2ss " : "", + ((rate_idx >= ODM_RATEVHTSS3MCS0) && (rate_idx <= ODM_RATEVHTSS3MCS9)) ? "VHT 3ss " : "", + (rate_idx >= ODM_RATEMCS0) ? "MCS " : "", + (vht_en) ? ((rate_idx - ODM_RATEVHTSS1MCS0) % 10) : ((rate_idx >= ODM_RATEMCS0) ? (rate_idx - ODM_RATEMCS0) : ((rate_idx <= ODM_RATE54M) ? legacy_table[rate_idx] : 0)), + (b_sgi) ? "-S" : " ", + (rate_idx >= ODM_RATEMCS0) ? "" : "M")); +} + +void +phydm_c2h_ra_report_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 macid = cmd_buf[1]; + u8 rate = cmd_buf[0]; + u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ + u8 rate_order; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + + if (cmd_len >=6) { + p_ra_table->ra_ratio[macid] = cmd_buf[6]; + PHYDM_DBG(p_dm, DBG_RA, ("RA retry ratio: [%d]:", p_ra_table->ra_ratio[macid])); + /**/ + } else if (cmd_len >= 4) { + if (cmd_buf[3] == 0) { + PHYDM_DBG(p_dm, DBG_RA, ("TX Init-rate Update[%d]:", macid)); + /**/ + } else if (cmd_buf[3] == 0xff) { + PHYDM_DBG(p_dm, DBG_RA, ("FW Level: Fix rate[%d]:", macid)); + /**/ + } else if (cmd_buf[3] == 1) { + PHYDM_DBG(p_dm, DBG_RA, ("Try Success[%d]:", macid)); + /**/ + } else if (cmd_buf[3] == 2) { + PHYDM_DBG(p_dm, DBG_RA, ("Try Fail & Try Again[%d]:", macid)); + /**/ + } else if (cmd_buf[3] == 3) { + PHYDM_DBG(p_dm, DBG_RA, ("rate Back[%d]:", macid)); + /**/ + } else if (cmd_buf[3] == 4) { + PHYDM_DBG(p_dm, DBG_RA, ("start rate by RSSI[%d]:", macid)); + /**/ + } else if (cmd_buf[3] == 5) { + PHYDM_DBG(p_dm, DBG_RA, ("Try rate[%d]:", macid)); + /**/ + } + } else { + PHYDM_DBG(p_dm, DBG_RA, ("Tx rate Update[%d]:", macid)); + /**/ + } + + /*phydm_print_rate(p_dm, pre_rate_idx, DBG_RA);*/ + /*PHYDM_DBG(p_dm, DBG_RA, (">\n",macid );*/ + phydm_print_rate(p_dm, rate, DBG_RA); + if (macid >= 128) { + u8 gid_index = macid - 128; + p_ra_table->mu1_rate[gid_index] = rate; + } + + /*p_ra_table->link_tx_rate[macid] = rate;*/ + + if (is_sta_active(p_sta)) { + p_sta->ra_info.curr_tx_rate = rate; + /**/ + } + + /*trigger power training*/ +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) + + rate_order = phydm_rate_order_compute(p_dm, rate_idx); + + if ((p_dm->is_one_entry_only) || + ((rate_order > p_ra_table->highest_client_tx_order) && (p_ra_table->power_tracking_flag == 1)) + ) { + halrf_update_pwr_track(p_dm, rate_idx); + p_ra_table->power_tracking_flag = 0; + } + +#endif + + /*trigger dynamic rate ID*/ +/*#if (defined(CONFIG_RA_DYNAMIC_RATE_ID))*/ /*dino will refine here later*/ +#if 0 + if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) + phydm_update_rate_id(p_dm, rate, macid); +#endif + +} + +void +odm_ra_post_action_on_assoc( + void *p_dm_void +) +{ +#if 0 + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + p_dm->h2c_rarpt_connect = 1; + phydm_rssi_monitor_check(p_dm); + p_dm->h2c_rarpt_connect = 0; +#endif +} + +void +phydm_modify_RA_PCR_threshold( + void *p_dm_void, + u8 RA_offset_direction, + u8 RA_threshold_offset + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + + p_ra_table->RA_offset_direction = RA_offset_direction; + p_ra_table->RA_threshold_offset = RA_threshold_offset; + PHYDM_DBG(p_dm, DBG_RA, ("Set RA_threshold_offset = (( %s%d ))\n", ((RA_threshold_offset == 0) ? " " : ((RA_offset_direction) ? "+" : "-")), RA_threshold_offset)); +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +odm_refresh_rate_adaptive_mask_mp( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + struct _ADAPTER *p_adapter = p_dm->adapter; + struct _ADAPTER *p_target_adapter = NULL; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + PMGNT_INFO p_mgnt_info = GetDefaultMgntInfo(p_adapter); + struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(p_adapter); + PMGNT_INFO p_loop_mgnt_info = &(p_loop_adapter->MgntInfo); + HAL_DATA_TYPE *p_loop_hal_data = GET_HAL_DATA(p_loop_adapter); + + u32 i; + struct sta_info *p_entry; + u8 ratr_state_new; + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("%s ======>\n", __func__)); + + if (p_adapter->bDriverStopped) { + PHYDM_DBG(p_dm, DBG_RA_MASK, ("driver is going to unload\n")); + return; + } + + if (!p_hal_data->bUseRAMask) { + PHYDM_DBG(p_dm, DBG_RA_MASK, ("driver does not control rate adaptive mask\n")); + return; + } + + /* if default port is connected, update RA table for default port (infrastructure mode only) */ + /* Need to consider other ports for P2P cases*/ + + while(p_loop_adapter){ + + p_loop_mgnt_info = &(p_loop_adapter->MgntInfo); + p_loop_hal_data = GET_HAL_DATA(p_loop_adapter); + + if (p_loop_mgnt_info->mAssoc && (!ACTING_AS_AP(p_loop_adapter))) { + odm_refresh_ldpc_rts_mp(p_loop_adapter, p_dm, p_loop_mgnt_info->mMacId, p_loop_mgnt_info->IOTPeer, p_loop_hal_data->UndecoratedSmoothedPWDB); + /*PHYDM_DBG(p_dm, DBG_RA_MASK, ("Infrasture mode\n"));*/ + + ratr_state_new = phydm_rssi_lv_dec(p_dm, p_loop_hal_data->UndecoratedSmoothedPWDB, p_loop_mgnt_info->Ratr_State); + + if ((p_loop_mgnt_info->Ratr_State != ratr_state_new) || (p_ra_table->up_ramask_cnt >= FORCED_UPDATE_RAMASK_PERIOD)) { + + p_ra_table->up_ramask_cnt = 0; + PHYDM_PRINT_ADDR(p_dm, DBG_RA_MASK, ("Target AP addr :"), p_loop_mgnt_info->Bssid); + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Update RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n\n", + p_mgnt_info->Ratr_State, ratr_state_new, p_loop_hal_data->UndecoratedSmoothedPWDB)); + + p_loop_mgnt_info->Ratr_State = ratr_state_new; + p_adapter->HalFunc.UpdateHalRAMaskHandler(p_loop_adapter, p_loop_mgnt_info->mMacId, NULL, ratr_state_new); + } else { + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Stay in RA level = (( %d ))\n\n", ratr_state_new)); + /**/ + } + } + + p_loop_adapter = GetNextExtAdapter(p_loop_adapter); + } + + /* */ + /* The following part configure AP/VWifi/IBSS rate adaptive mask. */ + /* */ + + if (p_mgnt_info->mIbss) /* Target: AP/IBSS peer. */ + p_target_adapter = GetDefaultAdapter(p_adapter); + else + p_target_adapter = GetFirstAPAdapter(p_adapter); + + /* if extension port (softap) is started, updaet RA table for more than one clients associate */ + if (p_target_adapter != NULL) { + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + + p_entry = AsocEntry_EnumStation(p_target_adapter, i); + + if (is_sta_active((&GET_STA_INFO(p_entry)))) { + + odm_refresh_ldpc_rts_mp(p_target_adapter, p_dm, GET_STA_INFO(p_entry).mac_id, p_entry->IOTPeer, GET_STA_INFO(p_entry).rssi_stat.rssi); + + ratr_state_new = phydm_rssi_lv_dec(p_dm, GET_STA_INFO(p_entry).rssi_stat.rssi, GET_STA_INFO(p_entry).ra_info.rssi_level); + + if ((GET_STA_INFO(p_entry).ra_info.rssi_level != ratr_state_new) || (p_ra_table->up_ramask_cnt >= FORCED_UPDATE_RAMASK_PERIOD)) { + + p_ra_table->up_ramask_cnt = 0; + PHYDM_PRINT_ADDR(p_dm, DBG_RA_MASK, ("Target AP addr :"), GET_STA_INFO(p_entry).mac_addr); + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", + GET_STA_INFO(p_entry).ra_info.rssi_level, ratr_state_new, GET_STA_INFO(p_entry).rssi_stat.rssi)); + + GET_STA_INFO(p_entry).ra_info.rssi_level = ratr_state_new; + p_adapter->HalFunc.UpdateHalRAMaskHandler(p_target_adapter, GET_STA_INFO(p_entry).mac_id, p_entry, ratr_state_new); + } else { + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Stay in RA level = (( %d ))\n\n", ratr_state_new)); + /**/ + } + + } + } + } +} + +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + +void +odm_refresh_rate_adaptive_mask_ap( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + struct rtl8192cd_priv *priv = p_dm->priv; + struct aid_obj *aidarray; + u32 i; + struct sta_info *p_entry; + struct cmn_sta_info *p_sta; + u8 ratr_state_new; + + if (priv->up_time % 2) + return; + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + p_entry = p_dm->p_odm_sta_info[i]; + p_sta = p_dm->p_phydm_sta_info[i]; + + if (is_sta_active(p_sta)) { + + #if defined(UNIVERSAL_REPEATER) || defined(MBSSID) + aidarray = container_of(p_entry, struct aid_obj, station); + priv = aidarray->priv; + #endif + + if (!priv->pmib->dot11StationConfigEntry.autoRate) + continue; + + ratr_state_new = phydm_rssi_lv_dec(p_dm, (u32)p_sta->rssi_stat.rssi, p_sta->ra_info.rssi_level); + + if ((p_sta->ra_info.rssi_level != ratr_state_new) || (p_ra_table->up_ramask_cnt >= FORCED_UPDATE_RAMASK_PERIOD)) { + + p_ra_table->up_ramask_cnt = 0; + PHYDM_PRINT_ADDR(p_dm, DBG_RA_MASK, ("Target AP addr :"), p_sta->mac_addr); + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Update Tx RA Level: ((%x)) -> ((%x)), RSSI = ((%d))\n", p_sta->ra_info.rssi_level, ratr_state_new, p_sta->rssi_stat.rssi)); + + p_sta->ra_info.rssi_level = ratr_state_new; + phydm_gen_ramask_h2c_AP(p_dm, priv, p_entry, p_sta->ra_info.rssi_level); + } else { + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Stay in RA level = (( %d ))\n\n", ratr_state_new)); + /**/ + } + } + } +} +#endif + +void +phydm_rate_adaptive_mask_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PMGNT_INFO p_mgnt_info = &p_dm->adapter->MgntInfo; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_dm->adapter); + + p_mgnt_info->Ratr_State = DM_RATR_STA_INIT; + + if (p_mgnt_info->DM_Type == dm_type_by_driver) + p_hal_data->bUseRAMask = true; + else + p_hal_data->bUseRAMask = false; + +#endif + + p_ra_t->ldpc_thres = 35; + p_ra_t->up_ramask_cnt = 0; + p_ra_t->up_ramask_cnt_tmp = 0; + +} + +void +phydm_refresh_rate_adaptive_mask( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table; + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("%s ======>\n", __func__)); + + if (!(p_dm->support_ability & ODM_BB_RA_MASK)) { + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Return: Not support\n")); + return; + } + + if (!p_dm->is_linked) + return; + + p_ra_t->up_ramask_cnt++; + /*p_ra_t->up_ramask_cnt_tmp++;*/ + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + + odm_refresh_rate_adaptive_mask_mp(p_dm); + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + + odm_refresh_rate_adaptive_mask_ap(p_dm); + +#else /*(DM_ODM_SUPPORT_TYPE == ODM_CE)*/ + + phydm_ra_mask_watchdog(p_dm); + +#endif + +} + +void +phydm_show_sta_info( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_sta = NULL; + struct ra_sta_info *p_ra = NULL; + #ifdef CONFIG_BEAMFORMING + struct bf_cmn_info *p_bf = NULL; + #endif + char help[] = "-h"; + u32 var1[10] = {0}; + u32 used = *_used; + u32 out_len = *_out_len; + u32 i, macid_start, macid_end; + u8 tatal_sta_num = 0; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &var1[0]); + + if ((strcmp(input[1], help) == 0)) { + PHYDM_SNPRINTF((output + used, out_len - used, "All STA: {1}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "STA[macid]: {2} {macid}\n")); + return; + } else if (var1[0] == 1) { + macid_start = 0; + macid_end = ODM_ASSOCIATE_ENTRY_NUM; + } else if (var1[0] == 2) { + macid_start = var1[1]; + macid_end = var1[1]; + } else { + PHYDM_SNPRINTF((output + used, out_len - used, "Warning input value!\n")); + return; + } + + for (i = macid_start; i < macid_end; i++) { + + p_sta = p_dm->p_phydm_sta_info[i]; + + + if (!is_sta_active(p_sta)) + continue; + + p_ra = &(p_sta->ra_info); + #ifdef CONFIG_BEAMFORMING + p_bf = &(p_sta->bf_info); + #endif + + tatal_sta_num++; + + PHYDM_SNPRINTF((output + used, out_len - used, "==[MACID: %d]============>\n", p_sta->mac_id)); + PHYDM_SNPRINTF((output + used, out_len - used, "AID:%d\n", p_sta->aid)); + PHYDM_SNPRINTF((output + used, out_len - used, "ADDR:%x-%x-%x-%x-%x-%x\n", + p_sta->mac_addr[5], p_sta->mac_addr[4], p_sta->mac_addr[3], p_sta->mac_addr[2], p_sta->mac_addr[1], p_sta->mac_addr[0])); + PHYDM_SNPRINTF((output + used, out_len - used, "DM_ctrl:0x%x\n", p_sta->dm_ctrl)); + PHYDM_SNPRINTF((output + used, out_len - used, "BW:%d, MIMO_Type:0x%x\n", p_sta->bw_mode, p_sta->mimo_type)); + PHYDM_SNPRINTF((output + used, out_len - used, "STBC_en:%d, LDPC_en=%d\n", p_sta->stbc_en, p_sta->ldpc_en)); + + /*[RSSI Info]*/ + PHYDM_SNPRINTF((output + used, out_len - used, "RSSI{All, OFDM, CCK}={%d, %d, %d}\n", + p_sta->rssi_stat.rssi, p_sta->rssi_stat.rssi_ofdm, p_sta->rssi_stat.rssi_cck)); + + /*[RA Info]*/ + PHYDM_SNPRINTF((output + used, out_len - used, "Rate_ID:%d, RSSI_LV:%d, ra_bw:%d, SGI_en:%d\n", + p_ra->rate_id, p_ra->rssi_level, p_ra->ra_bw_mode, p_ra->is_support_sgi)); + + PHYDM_SNPRINTF((output + used, out_len - used, "VHT_en:%d, Wireless_set=0x%x, sm_ps=%d\n", + p_ra->is_vht_enable, p_sta->support_wireless_set, p_sta->sm_ps)); + + PHYDM_SNPRINTF((output + used, out_len - used, "Dis{RA, PT}={%d, %d}, TxRx:%d, Noisy:%d\n", + p_ra->disable_ra, p_ra->disable_pt, p_ra->txrx_state, p_ra->is_noisy)); + + PHYDM_SNPRINTF((output + used, out_len - used, "TX{Rate, BW}={%d, %d}, RTY:%d\n", + p_ra->curr_tx_rate, p_ra->curr_tx_bw, p_ra->curr_retry_ratio)); + + PHYDM_SNPRINTF((output + used, out_len - used, "RA_MAsk:0x%llx\n", p_ra->ramask)); + + /*[TP]*/ + PHYDM_SNPRINTF((output + used, out_len - used, "TP{TX,RX}={%d, %d}\n", + p_sta->tx_moving_average_tp, p_sta->rx_moving_average_tp)); + + #ifdef CONFIG_BEAMFORMING + /*[Beamforming]*/ + PHYDM_SNPRINTF((output + used, out_len - used, "CAP{HT,VHT}={0x%x, 0x%x}\n", + p_bf->ht_beamform_cap, p_bf->vht_beamform_cap)); + PHYDM_SNPRINTF((output + used, out_len - used, "{p_aid,g_id}={0x%x, 0x%x}\n\n", + p_bf->p_aid, p_bf->g_id)); + #endif + } + + if (tatal_sta_num == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "No Linked STA\n")); + } + + *_used = used; + *_out_len = out_len; +} + +#ifdef PHYDM_3RD_REFORM_RA_MASK + +u8 +phydm_get_tx_stream_num( + void *p_dm_void, + enum rf_type mimo_type + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 tx_num = 1; + + if (mimo_type == RF_1T1R || mimo_type == RF_1T2R) + tx_num = 1; + else if (mimo_type == RF_2T2R || mimo_type == RF_2T3R || mimo_type == RF_2T4R) + tx_num = 2; + else if (mimo_type == RF_3T3R || mimo_type == RF_3T4R) + tx_num = 3; + else if (mimo_type == RF_4T4R) + tx_num = 4; + else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warrning] no mimo_type is found\n")); + } + return tx_num; +} + +u64 +phydm_get_bb_mod_ra_mask( + void *p_dm_void, + u8 macid +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + struct ra_sta_info *p_ra = NULL; + enum channel_width bw = 0; + enum wireless_set wireless_mode = 0; + u8 tx_stream_num = 1; + u8 rssi_lv = 0; + u64 ra_mask_bitmap = 0; + + if (is_sta_active(p_sta)) { + + p_ra = &(p_sta->ra_info); + bw = p_ra->ra_bw_mode; + wireless_mode = p_sta->support_wireless_set; + tx_stream_num = phydm_get_tx_stream_num(p_dm, p_sta->mimo_type); + rssi_lv = p_ra->rssi_level; + ra_mask_bitmap = p_ra->ramask; + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warning] %s invalid sta_info\n", __func__)); + return 0; + } + + PHYDM_DBG(p_dm, DBG_RA, ("macid=%d ori_RA_Mask= 0x%llx\n", macid, ra_mask_bitmap)); + PHYDM_DBG(p_dm, DBG_RA, ("wireless_mode=0x%x, tx_stream_num=%d, BW=%d, MimoPs=%d, rssi_lv=%d\n", + wireless_mode, tx_stream_num, bw, p_sta->sm_ps, rssi_lv)); + + if (p_sta->sm_ps == SM_PS_STATIC) /*mimo_ps_enable*/ + tx_stream_num = 1; + + + /*[Modify RA Mask by Wireless Mode]*/ + + if (wireless_mode == WIRELESS_CCK) /*B mode*/ + ra_mask_bitmap &= 0x0000000f; + else if (wireless_mode == WIRELESS_OFDM) /*G mode*/ + ra_mask_bitmap &= 0x00000ff0; + else if (wireless_mode == (WIRELESS_CCK | WIRELESS_OFDM)) /*BG mode*/ + ra_mask_bitmap &= 0x00000ff5; + else if (wireless_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT)) { + /*N_2G*/ + if (tx_stream_num == 1) { + if (bw == CHANNEL_WIDTH_40) + ra_mask_bitmap &= 0x000ff015; + else + ra_mask_bitmap &= 0x000ff005; + } else if (tx_stream_num == 2) { + + if (bw == CHANNEL_WIDTH_40) + ra_mask_bitmap &= 0x0ffff015; + else + ra_mask_bitmap &= 0x0ffff005; + } else if (tx_stream_num == 3) + ra_mask_bitmap &= 0xffffff015; + } else if (wireless_mode == (WIRELESS_OFDM | WIRELESS_HT)) { /*N_5G*/ + + if (tx_stream_num == 1) { + if (bw == CHANNEL_WIDTH_40) + ra_mask_bitmap &= 0x000ff030; + else + ra_mask_bitmap &= 0x000ff010; + } else if (tx_stream_num == 2) { + + if (bw == CHANNEL_WIDTH_40) + ra_mask_bitmap &= 0x0ffff030; + else + ra_mask_bitmap &= 0x0ffff010; + } else if (tx_stream_num == 3) + ra_mask_bitmap &= 0xffffff010; + } else if (wireless_mode == (WIRELESS_CCK |WIRELESS_OFDM | WIRELESS_VHT)) { + /*AC_2G*/ + if (tx_stream_num == 1) + ra_mask_bitmap &= 0x003ff015; + else if (tx_stream_num == 2) + ra_mask_bitmap &= 0xfffff015; + else if (tx_stream_num == 3) + ra_mask_bitmap &= 0x3fffffff010; + + + if (bw == CHANNEL_WIDTH_20) {/* AC 20MHz doesn't support MCS9 */ + ra_mask_bitmap &= 0x1ff7fdfffff; + } + } else if (wireless_mode == (WIRELESS_OFDM | WIRELESS_VHT)) { /*AC_5G*/ + + if (tx_stream_num == 1) + ra_mask_bitmap &= 0x003ff010; + else if (tx_stream_num == 2) + ra_mask_bitmap &= 0xfffff010; + else if (tx_stream_num == 3) + ra_mask_bitmap &= 0x3fffffff010; + + if (bw == CHANNEL_WIDTH_20) /* AC 20MHz doesn't support MCS9 */ + ra_mask_bitmap &= 0x1ff7fdfffff; + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warrning] No RA mask is found\n")); + /**/ + } + + PHYDM_DBG(p_dm, DBG_RA, ("Mod by mode=0x%llx\n", ra_mask_bitmap)); + + + /*[Modify RA Mask by RSSI level]*/ + if (wireless_mode != WIRELESS_CCK) { + + if (rssi_lv == 0) + ra_mask_bitmap &= 0xffffffff; + else if (rssi_lv == 1) + ra_mask_bitmap &= 0xfffffff0; + else if (rssi_lv == 2) + ra_mask_bitmap &= 0xffffefe0; + else if (rssi_lv == 3) + ra_mask_bitmap &= 0xffffcfc0; + else if (rssi_lv == 4) + ra_mask_bitmap &= 0xffff8f80; + else if (rssi_lv >= 5) + ra_mask_bitmap &= 0xffff0f00; + + } + PHYDM_DBG(p_dm, DBG_RA, ("Mod by RSSI=0x%llx\n", ra_mask_bitmap)); + + return ra_mask_bitmap; +} + +u8 +phydm_get_rate_id( + void *p_dm_void, + u8 macid +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + struct ra_sta_info *p_ra =NULL; + enum channel_width bw = 0; + enum wireless_set wireless_mode = 0; + u8 tx_stream_num = 1; + u8 rate_id_idx = PHYDM_BGN_20M_1SS; + + if (is_sta_active(p_sta)) { + + p_ra = &(p_sta->ra_info); + bw = p_ra->ra_bw_mode; + wireless_mode = p_sta->support_wireless_set; + tx_stream_num = phydm_get_tx_stream_num(p_dm, p_sta->mimo_type); + + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warning] %s: invalid sta_info\n", __func__)); + return 0; + } + + PHYDM_DBG(p_dm, DBG_RA, ("macid=%d, wireless_set=0x%x, tx_stream_num=%d, BW=0x%x\n", + macid, wireless_mode, tx_stream_num, bw)); + + if (wireless_mode == WIRELESS_CCK) /*B mode*/ + rate_id_idx = PHYDM_B_20M; + else if (wireless_mode == WIRELESS_OFDM) /*G mode*/ + rate_id_idx = PHYDM_G; + else if (wireless_mode == (WIRELESS_CCK | WIRELESS_OFDM)) /*BG mode*/ + rate_id_idx = PHYDM_BG; + else if (wireless_mode == (WIRELESS_OFDM | WIRELESS_HT)) { /*GN mode*/ + + if (tx_stream_num == 1) + rate_id_idx = PHYDM_GN_N1SS; + else if (tx_stream_num == 2) + rate_id_idx = PHYDM_GN_N2SS; + else if (tx_stream_num == 3) + rate_id_idx = PHYDM_ARFR5_N_3SS; + } else if (wireless_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_HT)) { /*BGN mode*/ + + + if (bw == CHANNEL_WIDTH_40) { + + if (tx_stream_num == 1) + rate_id_idx = PHYDM_BGN_40M_1SS; + else if (tx_stream_num == 2) + rate_id_idx = PHYDM_BGN_40M_2SS; + else if (tx_stream_num == 3) + rate_id_idx = PHYDM_ARFR5_N_3SS; + + } else { + + if (tx_stream_num == 1) + rate_id_idx = PHYDM_BGN_20M_1SS; + else if (tx_stream_num == 2) + rate_id_idx = PHYDM_BGN_20M_2SS; + else if (tx_stream_num == 3) + rate_id_idx = PHYDM_ARFR5_N_3SS; + } + } else if (wireless_mode == (WIRELESS_OFDM | WIRELESS_VHT)) { /*AC mode*/ + + if (tx_stream_num == 1) + rate_id_idx = PHYDM_ARFR1_AC_1SS; + else if (tx_stream_num == 2) + rate_id_idx = PHYDM_ARFR0_AC_2SS; + else if (tx_stream_num == 3) + rate_id_idx = PHYDM_ARFR4_AC_3SS; + } else if (wireless_mode == (WIRELESS_CCK | WIRELESS_OFDM | WIRELESS_VHT)) { /*AC 2.4G mode*/ + + if (bw >= CHANNEL_WIDTH_80) { + if (tx_stream_num == 1) + rate_id_idx = PHYDM_ARFR1_AC_1SS; + else if (tx_stream_num == 2) + rate_id_idx = PHYDM_ARFR0_AC_2SS; + else if (tx_stream_num == 3) + rate_id_idx = PHYDM_ARFR4_AC_3SS; + } else { + + if (tx_stream_num == 1) + rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; + else if (tx_stream_num == 2) + rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; + else if (tx_stream_num == 3) + rate_id_idx = PHYDM_ARFR4_AC_3SS; + } + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warrning] No rate_id is found\n")); + rate_id_idx = 0; + } + + PHYDM_DBG(p_dm, DBG_RA, ("Rate_ID=((0x%x))\n", rate_id_idx)); + + return rate_id_idx; +} + +void +phydm_ra_h2c( + void *p_dm_void, + u8 macid, + u8 dis_ra, + u8 dis_pt, + u8 no_update_bw, + u8 init_ra_lv, + u64 ra_mask +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + struct ra_sta_info *p_ra = NULL; + u8 h2c_val[H2C_MAX_LENGTH] = {0}; + + if (is_sta_active(p_sta)) { + p_ra = &(p_sta->ra_info); + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warning] %s invalid sta_info\n", __func__)); + return; + } + + PHYDM_DBG(p_dm, DBG_RA, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_RA, ("MACID=%d\n", p_sta->mac_id)); + + if (p_dm->is_disable_power_training == true) + dis_pt = true; + else if (p_dm->is_disable_power_training == false) + dis_pt = false; + + h2c_val[0] = p_sta->mac_id; + h2c_val[1] = (p_ra->rate_id & 0x1f) | ((init_ra_lv & 0x3) << 5) | (p_ra->is_support_sgi << 7); + h2c_val[2] = (u8)((p_ra->ra_bw_mode) | (((p_sta->ldpc_en) ? 1 : 0) << 2) | + ((no_update_bw & 0x1) << 3) | (p_ra->is_vht_enable << 4) | + ((dis_pt & 0x1) << 6) | ((dis_ra & 0x1) << 7)); + + h2c_val[3] = (u8)(ra_mask & 0xff); + h2c_val[4] = (u8)((ra_mask & 0xff00) >> 8); + h2c_val[5] = (u8)((ra_mask & 0xff0000) >> 16); + h2c_val[6] = (u8)((ra_mask & 0xff000000) >> 24); + + PHYDM_DBG(p_dm, DBG_RA, ("PHYDM h2c[0x40]=0x%x %x %x %x %x %x %x\n", + h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2], h2c_val[1], h2c_val[0])); + + odm_fill_h2c_cmd(p_dm, PHYDM_H2C_RA_MASK, H2C_MAX_LENGTH, h2c_val); + + #if (defined(PHYDM_COMPILE_ABOVE_3SS)) + if (p_dm->support_ic_type & (PHYDM_IC_ABOVE_3SS)) { + + h2c_val[3] = (u8)((ra_mask >> 32) & 0x000000ff); + h2c_val[4] = (u8)(((ra_mask >> 32) & 0x0000ff00) >> 8); + h2c_val[5] = (u8)(((ra_mask >> 32) & 0x00ff0000) >> 16); + h2c_val[6] = (u8)(((ra_mask >> 32) & 0xff000000) >> 24); + + PHYDM_DBG(p_dm, DBG_RA, ("PHYDM h2c[0x46]=0x%x %x %x %x %x %x %x\n", + h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2], h2c_val[1], h2c_val[0])); + + odm_fill_h2c_cmd(p_dm, PHYDM_RA_MASK_ABOVE_3SS, 5, h2c_val); + } + #endif +} + +void +phydm_ra_registed( + void *p_dm_void, + u8 macid, + u8 rssi_from_assoc +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + struct ra_sta_info *p_ra = NULL; + u8 init_ra_lv; + u64 ra_mask; + + if (is_sta_active(p_sta)) { + p_ra = &(p_sta->ra_info); + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warning] %s invalid sta_info\n", __func__)); + return; + } + + PHYDM_DBG(p_dm, DBG_RA, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_RA, ("MACID=%d\n", p_sta->mac_id)); + + + #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) + phydm_get_rate_id_88e(p_dm, macid); + else + #endif + { + p_ra->rate_id = phydm_get_rate_id(p_dm, macid); + } + + /*p_ra->is_vht_enable = (p_sta->support_wireless_set | WIRELESS_VHT) ? 1 : 0;*/ + /*p_ra->disable_ra = 0;*/ + /*p_ra->disable_pt = 0;*/ + ra_mask = phydm_get_bb_mod_ra_mask(p_dm, macid); + + + if (rssi_from_assoc > 40) + init_ra_lv = 3; + else if (rssi_from_assoc > 20) + init_ra_lv = 2; + else + init_ra_lv = 1; + + if (p_ra_t->record_ra_info) + p_ra_t->record_ra_info(p_dm, macid, p_sta, ra_mask); + + #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) + /*Driver RA*/ + odm_ra_update_rate_info_8188e(p_dm, macid, p_ra->rate_id, (u32)ra_mask, p_ra->is_support_sgi); + else + #endif + { + /*FW RA*/ + phydm_ra_h2c(p_dm, macid, p_ra->disable_ra, p_ra->disable_pt, 0, init_ra_lv, ra_mask); + } + + + +} + +void +phydm_ra_offline( + void *p_dm_void, + u8 macid +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + struct ra_sta_info *p_ra = NULL; + + if (is_sta_active(p_sta)) { + p_ra = &(p_sta->ra_info); + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[Warning] %s invalid sta_info\n", __func__)); + return; + } + + PHYDM_DBG(p_dm, DBG_RA, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_RA, ("MACID=%d\n", p_sta->mac_id)); + + odm_memory_set(p_dm, &(p_ra->rate_id), 0, sizeof(struct ra_sta_info)); + p_ra->disable_ra = 1; + p_ra->disable_pt = 1; + + if (p_ra_t->record_ra_info) + p_ra_t->record_ra_info(p_dm, macid, p_sta, 0); + + if (p_dm->support_ic_type != ODM_RTL8188E) + phydm_ra_h2c(p_dm, macid, p_ra->disable_ra, p_ra->disable_pt, 0, 0, 0); +} + +void +phydm_ra_mask_watchdog( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table; + struct cmn_sta_info *p_sta = NULL; + struct ra_sta_info *p_ra = NULL; + u8 macid; + u64 ra_mask; + u8 rssi_lv_new; + + if (!(p_dm->support_ability & ODM_BB_RA_MASK)) + return; + + if (((!p_dm->is_linked)) || (p_dm->phydm_sys_up_time % 2) == 1) + return; + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("%s ======>\n", __func__)); + + p_ra_t->up_ramask_cnt++; + + for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + + p_sta = p_dm->p_phydm_sta_info[macid]; + + if (!is_sta_active(p_sta)) + continue; + + p_ra = &(p_sta->ra_info); + + if (p_ra->disable_ra) + continue; + + + /*to be modified*/ + #if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) + if ((p_dm->support_ic_type == ODM_RTL8812) || + ((p_dm->support_ic_type == ODM_RTL8821) && (p_dm->cut_version == ODM_CUT_A)) + ) { + + if (p_sta->rssi_stat.rssi < p_ra_t->ldpc_thres) { + + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + set_ra_ldpc_8812(p_sta, true); /*LDPC TX enable*/ + #endif + PHYDM_DBG(p_dm, DBG_RA_MASK, ("RSSI=%d, ldpc_en =TRUE\n", p_sta->rssi_stat.rssi)); + + } else if (p_sta->rssi_stat.rssi > (p_ra_t->ldpc_thres + 3)) { + + #if (DM_ODM_SUPPORT_TYPE == ODM_CE) + set_ra_ldpc_8812(p_sta, false); /*LDPC TX disable*/ + #endif + PHYDM_DBG(p_dm, DBG_RA_MASK, ("RSSI=%d, ldpc_en =FALSE\n", p_sta->rssi_stat.rssi)); + } + } + #endif + + rssi_lv_new = phydm_rssi_lv_dec(p_dm, (u32)p_sta->rssi_stat.rssi, p_ra->rssi_level); + + if ((p_ra->rssi_level != rssi_lv_new) || + (p_ra_t->up_ramask_cnt >= FORCED_UPDATE_RAMASK_PERIOD)) { + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("RSSI LV:((%d))->((%d))\n", p_ra->rssi_level, rssi_lv_new)); + + p_ra->rssi_level = rssi_lv_new; + p_ra_t->up_ramask_cnt = 0; + + ra_mask = phydm_get_bb_mod_ra_mask(p_dm, macid); + + if (p_ra_t->record_ra_info) + p_ra_t->record_ra_info(p_dm, macid, p_sta, ra_mask); + + #if (RTL8188E_SUPPORT == 1) && (RATE_ADAPTIVE_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) + /*Driver RA*/ + odm_ra_update_rate_info_8188e(p_dm, macid, p_ra->rate_id, (u32)ra_mask, p_ra->is_support_sgi); + else + #endif + { + /*FW RA*/ + phydm_ra_h2c(p_dm, macid, p_ra->disable_ra, p_ra->disable_pt, 1, 0, ra_mask); + } + } + } + +} +#endif + +u8 +phydm_vht_en_mapping( + void *p_dm_void, + u32 wireless_mode +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 vht_en_out = 0; + + if ((wireless_mode == PHYDM_WIRELESS_MODE_AC_5G) || + (wireless_mode == PHYDM_WIRELESS_MODE_AC_24G) || + (wireless_mode == PHYDM_WIRELESS_MODE_AC_ONLY) + ) { + vht_en_out = 1; + /**/ + } + + PHYDM_DBG(p_dm, DBG_RA, ("wireless_mode= (( 0x%x )), VHT_EN= (( %d ))\n", wireless_mode, vht_en_out)); + return vht_en_out; +} + +u8 +phydm_rate_id_mapping( + void *p_dm_void, + u32 wireless_mode, + u8 rf_type, + u8 bw +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 rate_id_idx = 0; + + PHYDM_DBG(p_dm, DBG_RA, ("wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x ))\n", + wireless_mode, rf_type, bw)); + + + switch (wireless_mode) { + + case PHYDM_WIRELESS_MODE_N_24G: + { + + if (bw == CHANNEL_WIDTH_40) { + + if (rf_type == RF_1T1R) + rate_id_idx = PHYDM_BGN_40M_1SS; + else if (rf_type == RF_2T2R) + rate_id_idx = PHYDM_BGN_40M_2SS; + else + rate_id_idx = PHYDM_ARFR5_N_3SS; + + } else { + + if (rf_type == RF_1T1R) + rate_id_idx = PHYDM_BGN_20M_1SS; + else if (rf_type == RF_2T2R) + rate_id_idx = PHYDM_BGN_20M_2SS; + else + rate_id_idx = PHYDM_ARFR5_N_3SS; + } + } + break; + + case PHYDM_WIRELESS_MODE_N_5G: + { + if (rf_type == RF_1T1R) + rate_id_idx = PHYDM_GN_N1SS; + else if (rf_type == RF_2T2R) + rate_id_idx = PHYDM_GN_N2SS; + else + rate_id_idx = PHYDM_ARFR5_N_3SS; + } + + break; + + case PHYDM_WIRELESS_MODE_G: + rate_id_idx = PHYDM_BG; + break; + + case PHYDM_WIRELESS_MODE_A: + rate_id_idx = PHYDM_G; + break; + + case PHYDM_WIRELESS_MODE_B: + rate_id_idx = PHYDM_B_20M; + break; + + + case PHYDM_WIRELESS_MODE_AC_5G: + case PHYDM_WIRELESS_MODE_AC_ONLY: + { + if (rf_type == RF_1T1R) + rate_id_idx = PHYDM_ARFR1_AC_1SS; + else if (rf_type == RF_2T2R) + rate_id_idx = PHYDM_ARFR0_AC_2SS; + else + rate_id_idx = PHYDM_ARFR4_AC_3SS; + } + break; + + case PHYDM_WIRELESS_MODE_AC_24G: + { + /*Becareful to set "Lowest rate" while using PHYDM_ARFR4_AC_3SS in 2.4G/5G*/ + if (bw >= CHANNEL_WIDTH_80) { + if (rf_type == RF_1T1R) + rate_id_idx = PHYDM_ARFR1_AC_1SS; + else if (rf_type == RF_2T2R) + rate_id_idx = PHYDM_ARFR0_AC_2SS; + else + rate_id_idx = PHYDM_ARFR4_AC_3SS; + } else { + + if (rf_type == RF_1T1R) + rate_id_idx = PHYDM_ARFR2_AC_2G_1SS; + else if (rf_type == RF_2T2R) + rate_id_idx = PHYDM_ARFR3_AC_2G_2SS; + else + rate_id_idx = PHYDM_ARFR4_AC_3SS; + } + } + break; + + default: + rate_id_idx = 0; + break; + } + + PHYDM_DBG(p_dm, DBG_RA, ("RA rate ID = (( 0x%x ))\n", rate_id_idx)); + + return rate_id_idx; +} + +void +phydm_update_hal_ra_mask( + void *p_dm_void, + u32 wireless_mode, + u8 rf_type, + u8 bw, + u8 mimo_ps_enable, + u8 disable_cck_rate, + u32 *ratr_bitmap_msb_in, + u32 *ratr_bitmap_lsb_in, + u8 tx_rate_level +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 ratr_bitmap = *ratr_bitmap_lsb_in, ratr_bitmap_msb = *ratr_bitmap_msb_in; + + /*PHYDM_DBG(p_dm, DBG_RA_MASK, ("phydm_rf_type = (( %x )), rf_type = (( %x ))\n", phydm_rf_type, rf_type));*/ + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Platfoem original RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap)); + + switch (wireless_mode) { + + case PHYDM_WIRELESS_MODE_B: + { + ratr_bitmap &= 0x0000000f; + } + break; + + case PHYDM_WIRELESS_MODE_G: + { + ratr_bitmap &= 0x00000ff5; + } + break; + + case PHYDM_WIRELESS_MODE_A: + { + ratr_bitmap &= 0x00000ff0; + } + break; + + case PHYDM_WIRELESS_MODE_N_24G: + case PHYDM_WIRELESS_MODE_N_5G: + { + if (mimo_ps_enable) + rf_type = RF_1T1R; + + if (rf_type == RF_1T1R) { + + if (bw == CHANNEL_WIDTH_40) + ratr_bitmap &= 0x000ff015; + else + ratr_bitmap &= 0x000ff005; + } else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) { + + if (bw == CHANNEL_WIDTH_40) + ratr_bitmap &= 0x0ffff015; + else + ratr_bitmap &= 0x0ffff005; + } else { /*3T*/ + + ratr_bitmap &= 0xfffff015; + ratr_bitmap_msb &= 0xf; + } + } + break; + + case PHYDM_WIRELESS_MODE_AC_24G: + { + if (rf_type == RF_1T1R) + ratr_bitmap &= 0x003ff015; + else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) + ratr_bitmap &= 0xfffff015; + else {/*3T*/ + + ratr_bitmap &= 0xfffff010; + ratr_bitmap_msb &= 0x3ff; + } + + if (bw == CHANNEL_WIDTH_20) {/* AC 20MHz doesn't support MCS9 */ + ratr_bitmap &= 0x7fdfffff; + ratr_bitmap_msb &= 0x1ff; + } + } + break; + + case PHYDM_WIRELESS_MODE_AC_5G: + { + if (rf_type == RF_1T1R) + ratr_bitmap &= 0x003ff010; + else if (rf_type == RF_2T2R || rf_type == RF_2T4R || rf_type == RF_2T3R) + ratr_bitmap &= 0xfffff010; + else {/*3T*/ + + ratr_bitmap &= 0xfffff010; + ratr_bitmap_msb &= 0x3ff; + } + + if (bw == CHANNEL_WIDTH_20) {/* AC 20MHz doesn't support MCS9 */ + ratr_bitmap &= 0x7fdfffff; + ratr_bitmap_msb &= 0x1ff; + } + } + break; + + default: + break; + } + + if (wireless_mode != PHYDM_WIRELESS_MODE_B) { + + if (tx_rate_level == 0) + ratr_bitmap &= 0xffffffff; + else if (tx_rate_level == 1) + ratr_bitmap &= 0xfffffff0; + else if (tx_rate_level == 2) + ratr_bitmap &= 0xffffefe0; + else if (tx_rate_level == 3) + ratr_bitmap &= 0xffffcfc0; + else if (tx_rate_level == 4) + ratr_bitmap &= 0xffff8f80; + else if (tx_rate_level >= 5) + ratr_bitmap &= 0xffff0f00; + + } + + if (disable_cck_rate) + ratr_bitmap &= 0xfffffff0; + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("wireless_mode= (( 0x%x )), rf_type = (( 0x%x )), BW = (( 0x%x )), MimoPs_en = (( %d )), tx_rate_level= (( 0x%x ))\n", + wireless_mode, rf_type, bw, mimo_ps_enable, tx_rate_level)); + + /*PHYDM_DBG(p_dm, DBG_RA_MASK, ("111 Phydm modified RA Mask = (( 0x %x | %x ))\n", ratr_bitmap_msb, ratr_bitmap));*/ + + *ratr_bitmap_lsb_in = ratr_bitmap; + *ratr_bitmap_msb_in = ratr_bitmap_msb; + PHYDM_DBG(p_dm, DBG_RA_MASK, ("Phydm modified RA Mask = (( 0x %x | %x ))\n", *ratr_bitmap_msb_in, *ratr_bitmap_lsb_in)); + +} + +u8 +phydm_rssi_lv_dec( + void *p_dm_void, + u32 rssi, + u8 ratr_state +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 rssi_lv_table[RA_FLOOR_TABLE_SIZE] = {20, 34, 38, 42, 46, 50, 100}; /*MCS0 ~ MCS4 , VHT1SS MCS0 ~ MCS4 , G 6M~24M*/ + u8 new_rssi_lv = 0; + u8 i; + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("curr RA level=(%d), Table_ori=[%d, %d, %d, %d, %d, %d]\n", + ratr_state, rssi_lv_table[0], rssi_lv_table[1], rssi_lv_table[2], rssi_lv_table[3], rssi_lv_table[4], rssi_lv_table[5])); + + for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { + + if (i >= (ratr_state)) + rssi_lv_table[i] += RA_FLOOR_UP_GAP; + } + + PHYDM_DBG(p_dm, DBG_RA_MASK, ("RSSI=(%d), Table_mod=[%d, %d, %d, %d, %d, %d]\n", + rssi, rssi_lv_table[0], rssi_lv_table[1], rssi_lv_table[2], rssi_lv_table[3], rssi_lv_table[4], rssi_lv_table[5])); + + for (i = 0; i < RA_FLOOR_TABLE_SIZE; i++) { + + if (rssi < rssi_lv_table[i]) { + new_rssi_lv = i; + break; + } + } + return new_rssi_lv; +} + +u8 +phydm_rate_order_compute( + void *p_dm_void, + u8 rate_idx +) +{ + u8 rate_order = 0; + + if (rate_idx >= ODM_RATEVHTSS4MCS0) { + + rate_idx -= ODM_RATEVHTSS4MCS0; + /**/ + } else if (rate_idx >= ODM_RATEVHTSS3MCS0) { + + rate_idx -= ODM_RATEVHTSS3MCS0; + /**/ + } else if (rate_idx >= ODM_RATEVHTSS2MCS0) { + + rate_idx -= ODM_RATEVHTSS2MCS0; + /**/ + } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { + + rate_idx -= ODM_RATEVHTSS1MCS0; + /**/ + } else if (rate_idx >= ODM_RATEMCS24) { + + rate_idx -= ODM_RATEMCS24; + /**/ + } else if (rate_idx >= ODM_RATEMCS16) { + + rate_idx -= ODM_RATEMCS16; + /**/ + } else if (rate_idx >= ODM_RATEMCS8) { + + rate_idx -= ODM_RATEMCS8; + /**/ + } + rate_order = rate_idx; + + return rate_order; + +} + +void +phydm_ra_common_info_update( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + struct cmn_sta_info *p_sta = NULL; + u16 macid; + u8 rate_order_tmp; + u8 cnt = 0; + + p_ra_table->highest_client_tx_order = 0; + p_ra_table->power_tracking_flag = 1; + + if (p_dm->number_linked_client != 0) { + for (macid = 0; macid < ODM_ASSOCIATE_ENTRY_NUM; macid++) { + + p_sta = p_dm->p_phydm_sta_info[macid]; + + if (is_sta_active(p_sta)) { + + rate_order_tmp = phydm_rate_order_compute(p_dm, (p_sta->ra_info.curr_tx_rate & 0x7f)); + + if (rate_order_tmp >= (p_ra_table->highest_client_tx_order)) { + p_ra_table->highest_client_tx_order = rate_order_tmp; + p_ra_table->highest_client_tx_rate_order = macid; + } + + cnt++; + + if (cnt == p_dm->number_linked_client) + break; + } + } + PHYDM_DBG(p_dm, DBG_RA, ("MACID[%d], Highest Tx order Update for power traking: %d\n", (p_ra_table->highest_client_tx_rate_order), (p_ra_table->highest_client_tx_order))); + } +} + +void +phydm_ra_info_watchdog( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + phydm_ra_common_info_update(p_dm); + #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) + phydm_ra_dynamic_retry_limit(p_dm); + #endif + phydm_ra_dynamic_retry_count(p_dm); + phydm_refresh_rate_adaptive_mask(p_dm); + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + odm_refresh_basic_rate_mask(p_dm); + #endif +} + +void +phydm_ra_info_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + + p_ra_table->highest_client_tx_rate_order = 0; + p_ra_table->highest_client_tx_order = 0; + p_ra_table->RA_threshold_offset = 0; + p_ra_table->RA_offset_direction = 0; + +#if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + u32 ret_value; + + ret_value = odm_get_bb_reg(p_dm, 0x4c8, MASKBYTE2); + odm_set_bb_reg(p_dm, 0x4cc, MASKBYTE3, (ret_value - 1)); + } +#endif + + #ifdef CONFIG_RA_DYNAMIC_RTY_LIMIT + phydm_ra_dynamic_retry_limit_init(p_dm); + #endif + + #ifdef CONFIG_RA_DYNAMIC_RATE_ID + phydm_ra_dynamic_rate_id_init(p_dm); + #endif + + #ifdef CONFIG_RA_DBG_CMD + odm_ra_para_adjust_init(p_dm); + #endif + + phydm_rate_adaptive_mask_init(p_dm); + +} + +u8 +odm_find_rts_rate( + void *p_dm_void, + u8 tx_rate, + boolean is_erp_protect +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 rts_ini_rate = ODM_RATE6M; + + if (is_erp_protect) /* use CCK rate as RTS*/ + rts_ini_rate = ODM_RATE1M; + else { + switch (tx_rate) { + case ODM_RATEVHTSS3MCS9: + case ODM_RATEVHTSS3MCS8: + case ODM_RATEVHTSS3MCS7: + case ODM_RATEVHTSS3MCS6: + case ODM_RATEVHTSS3MCS5: + case ODM_RATEVHTSS3MCS4: + case ODM_RATEVHTSS3MCS3: + case ODM_RATEVHTSS2MCS9: + case ODM_RATEVHTSS2MCS8: + case ODM_RATEVHTSS2MCS7: + case ODM_RATEVHTSS2MCS6: + case ODM_RATEVHTSS2MCS5: + case ODM_RATEVHTSS2MCS4: + case ODM_RATEVHTSS2MCS3: + case ODM_RATEVHTSS1MCS9: + case ODM_RATEVHTSS1MCS8: + case ODM_RATEVHTSS1MCS7: + case ODM_RATEVHTSS1MCS6: + case ODM_RATEVHTSS1MCS5: + case ODM_RATEVHTSS1MCS4: + case ODM_RATEVHTSS1MCS3: + case ODM_RATEMCS15: + case ODM_RATEMCS14: + case ODM_RATEMCS13: + case ODM_RATEMCS12: + case ODM_RATEMCS11: + case ODM_RATEMCS7: + case ODM_RATEMCS6: + case ODM_RATEMCS5: + case ODM_RATEMCS4: + case ODM_RATEMCS3: + case ODM_RATE54M: + case ODM_RATE48M: + case ODM_RATE36M: + case ODM_RATE24M: + rts_ini_rate = ODM_RATE24M; + break; + case ODM_RATEVHTSS3MCS2: + case ODM_RATEVHTSS3MCS1: + case ODM_RATEVHTSS2MCS2: + case ODM_RATEVHTSS2MCS1: + case ODM_RATEVHTSS1MCS2: + case ODM_RATEVHTSS1MCS1: + case ODM_RATEMCS10: + case ODM_RATEMCS9: + case ODM_RATEMCS2: + case ODM_RATEMCS1: + case ODM_RATE18M: + case ODM_RATE12M: + rts_ini_rate = ODM_RATE12M; + break; + case ODM_RATEVHTSS3MCS0: + case ODM_RATEVHTSS2MCS0: + case ODM_RATEVHTSS1MCS0: + case ODM_RATEMCS8: + case ODM_RATEMCS0: + case ODM_RATE9M: + case ODM_RATE6M: + rts_ini_rate = ODM_RATE6M; + break; + case ODM_RATE11M: + case ODM_RATE5_5M: + case ODM_RATE2M: + case ODM_RATE1M: + rts_ini_rate = ODM_RATE1M; + break; + default: + rts_ini_rate = ODM_RATE6M; + break; + } + } + + if (*p_dm->p_band_type == ODM_BAND_5G) { + if (rts_ini_rate < ODM_RATE6M) + rts_ini_rate = ODM_RATE6M; + } + return rts_ini_rate; + +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +odm_refresh_basic_rate_mask( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + static u8 stage = 0; + u8 cur_stage = 0; + OCTET_STRING os_rate_set; + PMGNT_INFO p_mgnt_info = GetDefaultMgntInfo(adapter); + u8 rate_set[5] = {MGN_1M, MGN_2M, MGN_5_5M, MGN_11M, MGN_6M}; + + if (p_dm->support_ic_type != ODM_RTL8812 && p_dm->support_ic_type != ODM_RTL8821) + return; + + if (p_dm->is_linked == false) /* unlink Default port information */ + cur_stage = 0; + else if (p_dm->rssi_min < 40) /* link RSSI < 40% */ + cur_stage = 1; + else if (p_dm->rssi_min > 45) /* link RSSI > 45% */ + cur_stage = 3; + else + cur_stage = 2; /* link 25% <= RSSI <= 30% */ + + if (cur_stage != stage) { + if (cur_stage == 1) { + FillOctetString(os_rate_set, rate_set, 5); + FilterSupportRate(p_mgnt_info->mBrates, &os_rate_set, false); + phydm_set_hw_reg_handler_interface(p_dm, HW_VAR_BASIC_RATE, (u8 *)&os_rate_set); + } else if (cur_stage == 3 && (stage == 1 || stage == 2)) + phydm_set_hw_reg_handler_interface(p_dm, HW_VAR_BASIC_RATE, (u8 *)(&p_mgnt_info->mBrates)); + } + + stage = cur_stage; +} + +void +odm_refresh_ldpc_rts_mp( + struct _ADAPTER *p_adapter, + struct PHY_DM_STRUCT *p_dm, + u8 m_mac_id, + u8 iot_peer, + s32 undecorated_smoothed_pwdb +) +{ + boolean is_ctl_ldpc = false; + struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table; + + if (p_dm->support_ic_type != ODM_RTL8821 && p_dm->support_ic_type != ODM_RTL8812) + return; + + if ((p_dm->support_ic_type == ODM_RTL8821) && (p_dm->cut_version == ODM_CUT_A)) + is_ctl_ldpc = true; + else if (p_dm->support_ic_type == ODM_RTL8812 && + iot_peer == HT_IOT_PEER_REALTEK_JAGUAR_CCUTAP) + is_ctl_ldpc = true; + + if (is_ctl_ldpc) { + if (undecorated_smoothed_pwdb < (p_ra_t->ldpc_thres - 5)) + MgntSet_TX_LDPC(p_adapter, m_mac_id, true); + else if (undecorated_smoothed_pwdb > p_ra_t->ldpc_thres) + MgntSet_TX_LDPC(p_adapter, m_mac_id, false); + } +} + +void +odm_rate_adaptive_state_ap_init( + void *PADAPTER_VOID, + struct cmn_sta_info*p_entry +) +{ + struct _ADAPTER *adapter = (struct _ADAPTER *)PADAPTER_VOID; + p_entry->ra_info.rssi_level = DM_RATR_STA_INIT; +} + +#elif (DM_ODM_SUPPORT_TYPE & ODM_AP) + +void +phydm_gen_ramask_h2c_AP( + void *p_dm_void, + struct rtl8192cd_priv *priv, + struct sta_info *p_entry, + u8 rssi_level +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type == ODM_RTL8812) { + + #if (RTL8812A_SUPPORT == 1) + UpdateHalRAMask8812(priv, p_entry, rssi_level); + /**/ + #endif + } else if (p_dm->support_ic_type == ODM_RTL8188E) { + + #if (RTL8188E_SUPPORT == 1) + #ifdef TXREPORT + add_RATid(priv, p_entry); + /**/ + #endif + #endif + } else { + #ifdef CONFIG_WLAN_HAL + GET_HAL_INTERFACE(priv)->UpdateHalRAMaskHandler(priv, p_entry, rssi_level); + #endif + } +} + +#endif + +#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) + +void +phydm_retry_limit_table_bound( + void *p_dm_void, + u8 *retry_limit, + u8 offset +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + + if (*retry_limit > offset) { + + *retry_limit -= offset; + + if (*retry_limit < p_ra_table->retrylimit_low) + *retry_limit = p_ra_table->retrylimit_low; + else if (*retry_limit > p_ra_table->retrylimit_high) + *retry_limit = p_ra_table->retrylimit_high; + } else + *retry_limit = p_ra_table->retrylimit_low; +} + +void +phydm_reset_retry_limit_table( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 i; + + u8 per_rate_retrylimit_table_20M[ODM_RATEMCS15 + 1] = { + 1, 1, 2, 4, /*CCK*/ + 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ + 2, 4, 6, 8, 12, 18, 20, 22, /*20M HT-1SS*/ + 2, 4, 6, 8, 12, 18, 20, 22 /*20M HT-2SS*/ + }; + u8 per_rate_retrylimit_table_40M[ODM_RATEMCS15 + 1] = { + 1, 1, 2, 4, /*CCK*/ + 2, 2, 4, 6, 8, 12, 16, 18, /*OFDM*/ + 4, 8, 12, 16, 24, 32, 32, 32, /*40M HT-1SS*/ + 4, 8, 12, 16, 24, 32, 32, 32 /*40M HT-2SS*/ + }; + + memcpy(&(p_ra_table->per_rate_retrylimit_20M[0]), &(per_rate_retrylimit_table_20M[0]), ODM_NUM_RATE_IDX); + memcpy(&(p_ra_table->per_rate_retrylimit_40M[0]), &(per_rate_retrylimit_table_40M[0]), ODM_NUM_RATE_IDX); + + for (i = 0; i < ODM_NUM_RATE_IDX; i++) { + phydm_retry_limit_table_bound(p_dm, &(p_ra_table->per_rate_retrylimit_20M[i]), 0); + phydm_retry_limit_table_bound(p_dm, &(p_ra_table->per_rate_retrylimit_40M[i]), 0); + } +} + +void +phydm_ra_dynamic_retry_limit_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + + p_ra_table->retry_descend_num = RA_RETRY_DESCEND_NUM; + p_ra_table->retrylimit_low = RA_RETRY_LIMIT_LOW; + p_ra_table->retrylimit_high = RA_RETRY_LIMIT_HIGH; + + phydm_reset_retry_limit_table(p_dm); + +} + +void +phydm_ra_dynamic_retry_limit( + void *p_dm_void +) +{ + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 i, retry_offset; + u32 ma_rx_tp; + + + if (p_dm->pre_number_active_client == p_dm->number_active_client) { + + PHYDM_DBG(p_dm, DBG_RA, (" pre_number_active_client == number_active_client\n")); + return; + + } else { + if (p_dm->number_active_client == 1) { + phydm_reset_retry_limit_table(p_dm); + PHYDM_DBG(p_dm, DBG_RA, ("one client only->reset to default value\n")); + } else { + + retry_offset = p_dm->number_active_client * p_ra_table->retry_descend_num; + + for (i = 0; i < ODM_NUM_RATE_IDX; i++) { + + phydm_retry_limit_table_bound(p_dm, &(p_ra_table->per_rate_retrylimit_20M[i]), retry_offset); + phydm_retry_limit_table_bound(p_dm, &(p_ra_table->per_rate_retrylimit_40M[i]), retry_offset); + } + } + } +} +#endif + +#if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) +void +phydm_ra_dynamic_rate_id_on_assoc( + void *p_dm_void, + u8 wireless_mode, + u8 init_rate_id +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_RA, ("[ON ASSOC] rf_mode = ((0x%x)), wireless_mode = ((0x%x)), init_rate_id = ((0x%x))\n", p_dm->rf_type, wireless_mode, init_rate_id)); + + if ((p_dm->rf_type == RF_2T2R) || (p_dm->rf_type == RF_2T3R) || (p_dm->rf_type == RF_2T4R)) { + + if ((p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) && + (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) + ) { + PHYDM_DBG(p_dm, DBG_RA, ("[ON ASSOC] set N-2SS ARFR5 table\n")); + odm_set_mac_reg(p_dm, 0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ + odm_set_mac_reg(p_dm, 0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ + } else if ((p_dm->support_ic_type & (ODM_RTL8812)) && + (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) + ) { + PHYDM_DBG(p_dm, DBG_RA, ("[ON ASSOC] set AC-2SS ARFR0 table\n")); + odm_set_mac_reg(p_dm, 0x444, MASKDWORD, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ + odm_set_mac_reg(p_dm, 0x448, MASKDWORD, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ + } + } + +} + +void +phydm_ra_dynamic_rate_id_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8192E)) { + + odm_set_mac_reg(p_dm, 0x4a4, MASKDWORD, 0xfc1ffff); /*N-2SS, ARFR5, rate_id = 0xe*/ + odm_set_mac_reg(p_dm, 0x4a8, MASKDWORD, 0x0); /*N-2SS, ARFR5, rate_id = 0xe*/ + + odm_set_mac_reg(p_dm, 0x444, MASKDWORD, 0x0fff); /*AC-2SS, ARFR0, rate_id = 0x9*/ + odm_set_mac_reg(p_dm, 0x448, MASKDWORD, 0xff01f000); /*AC-2SS, ARFR0, rate_id = 0x9*/ + } +} + +void +phydm_update_rate_id( + void *p_dm_void, + u8 rate, + u8 platform_macid +) +{ +#if 0 + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 current_tx_ss; + u8 rate_idx = rate & 0x7f; /*remove bit7 SGI*/ + u8 wireless_mode; + u8 phydm_macid; + struct sta_info *p_entry; + struct cmn_sta_info *p_sta; + + +#if 0 + if (rate_idx >= ODM_RATEVHTSS2MCS0) { + PHYDM_DBG(p_dm, DBG_RA, ("rate[%d]: (( VHT2SS-MCS%d ))\n", platform_macid, (rate_idx - ODM_RATEVHTSS2MCS0))); + /*dummy for SD4 check patch*/ + } else if (rate_idx >= ODM_RATEVHTSS1MCS0) { + PHYDM_DBG(p_dm, DBG_RA, ("rate[%d]: (( VHT1SS-MCS%d ))\n", platform_macid, (rate_idx - ODM_RATEVHTSS1MCS0))); + /*dummy for SD4 check patch*/ + } else if (rate_idx >= ODM_RATEMCS0) { + PHYDM_DBG(p_dm, DBG_RA, ("rate[%d]: (( HT-MCS%d ))\n", platform_macid, (rate_idx - ODM_RATEMCS0))); + /*dummy for SD4 check patch*/ + } else { + PHYDM_DBG(p_dm, DBG_RA, ("rate[%d]: (( HT-MCS%d ))\n", platform_macid, rate_idx)); + /*dummy for SD4 check patch*/ + } +#endif + + phydm_macid = p_dm->phydm_macid_table[platform_macid]; + p_entry = p_dm->p_odm_sta_info[phydm_macid]; + p_sta = p_dm->p_phydm_sta_info[phydm_macid]; + + if (is_sta_active(p_sta)) { + wireless_mode = p_entry->wireless_mode; + + if ((p_dm->rf_type == RF_2T2R) || (p_dm->rf_type == RF_2T3R) || (p_dm->rf_type == RF_2T4R)) { + + if (wireless_mode & (ODM_WM_N24G | ODM_WM_N5G)) { /*N mode*/ + if (rate_idx >= ODM_RATEMCS8 && rate_idx <= ODM_RATEMCS15) { /*2SS mode*/ + + p_sta->ra_info.rate_id = ARFR_5_RATE_ID; + PHYDM_DBG(p_dm, DBG_RA, ("ARFR_5\n")); + } + } else if (wireless_mode & (ODM_WM_AC_5G | ODM_WM_AC_24G | ODM_WM_AC_ONLY)) {/*AC mode*/ + if (rate_idx >= ODM_RATEVHTSS2MCS0 && rate_idx <= ODM_RATEVHTSS2MCS9) {/*2SS mode*/ + + p_sta->ra_info.rate_id = ARFR_0_RATE_ID; + PHYDM_DBG(p_dm, DBG_RA, ("ARFR_0\n")); + } + } else + p_sta->ra_info.rate_id = ARFR_0_RATE_ID; + + PHYDM_DBG(p_dm, DBG_RA, ("UPdate_RateID[%d]: (( 0x%x ))\n", platform_macid, p_sta->ra_info.rate_id)); + } + } +#endif +} + +#endif + +#if (defined(CONFIG_RA_DBG_CMD)) +void +odm_ra_para_adjust_send_h2c( + void *p_dm_void +) +{ + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 h2c_parameter[6] = {0}; + + h2c_parameter[0] = RA_FIRST_MACID; + + if (p_ra_table->ra_para_feedback_req) { /*h2c_parameter[5]=1 ; ask FW for all RA parameters*/ + PHYDM_DBG(p_dm, DBG_RA, ("[H2C] Ask FW for RA parameter\n")); + h2c_parameter[5] |= BIT(1); /*ask FW to report RA parameters*/ + h2c_parameter[1] = p_ra_table->para_idx; /*p_ra_table->para_idx;*/ + p_ra_table->ra_para_feedback_req = 0; + } else { + PHYDM_DBG(p_dm, DBG_RA, ("[H2C] Send H2C to FW for modifying RA parameter\n")); + + h2c_parameter[1] = p_ra_table->para_idx; + h2c_parameter[2] = p_ra_table->rate_idx; + /* [8 bit]*/ + if (p_ra_table->para_idx == RADBG_RTY_PENALTY || p_ra_table->para_idx == RADBG_RATE_UP_RTY_RATIO || p_ra_table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { + h2c_parameter[3] = p_ra_table->value; + h2c_parameter[4] = 0; + } + /* [16 bit]*/ + else { + h2c_parameter[3] = (u8)(((p_ra_table->value_16) & 0xf0) >> 4); /*byte1*/ + h2c_parameter[4] = (u8)((p_ra_table->value_16) & 0x0f); /*byte0*/ + } + } + PHYDM_DBG(p_dm, DBG_RA, (" h2c_parameter[1] = 0x%x\n", h2c_parameter[1])); + PHYDM_DBG(p_dm, DBG_RA, (" h2c_parameter[2] = 0x%x\n", h2c_parameter[2])); + PHYDM_DBG(p_dm, DBG_RA, (" h2c_parameter[3] = 0x%x\n", h2c_parameter[3])); + PHYDM_DBG(p_dm, DBG_RA, (" h2c_parameter[4] = 0x%x\n", h2c_parameter[4])); + PHYDM_DBG(p_dm, DBG_RA, (" h2c_parameter[5] = 0x%x\n", h2c_parameter[5])); + + odm_fill_h2c_cmd(p_dm, ODM_H2C_RA_PARA_ADJUST, 6, h2c_parameter); + +} + + +void +odm_ra_para_adjust( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 rate_idx = p_ra_table->rate_idx; + u8 value = p_ra_table->value; + u8 pre_value = 0xff; + + if (p_ra_table->para_idx == RADBG_RTY_PENALTY) { + pre_value = p_ra_table->RTY_P[rate_idx]; + p_ra_table->RTY_P[rate_idx] = value; + p_ra_table->RTY_P_modify_note[rate_idx] = 1; + } else if (p_ra_table->para_idx == RADBG_N_HIGH) { + + } else if (p_ra_table->para_idx == RADBG_N_LOW) { + + } else if (p_ra_table->para_idx == RADBG_RATE_UP_RTY_RATIO) { + pre_value = p_ra_table->RATE_UP_RTY_RATIO[rate_idx]; + p_ra_table->RATE_UP_RTY_RATIO[rate_idx] = value; + p_ra_table->RATE_UP_RTY_RATIO_modify_note[rate_idx] = 1; + } else if (p_ra_table->para_idx == RADBG_RATE_DOWN_RTY_RATIO) { + pre_value = p_ra_table->RATE_DOWN_RTY_RATIO[rate_idx]; + p_ra_table->RATE_DOWN_RTY_RATIO[rate_idx] = value; + p_ra_table->RATE_DOWN_RTY_RATIO_modify_note[rate_idx] = 1; + } + PHYDM_DBG(p_dm, DBG_RA, ("Change RA Papa[%d], rate[ %d ], ((%d)) -> ((%d))\n", p_ra_table->para_idx, rate_idx, pre_value, value)); + odm_ra_para_adjust_send_h2c(p_dm); +} + +void +phydm_ra_print_msg( + void *p_dm_void, + u8 *value, + u8 *value_default, + u8 *modify_note +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u32 i; + + PHYDM_DBG(p_dm, DBG_RA, (" |rate index| |Current-value| |Default-value| |Modify?|\n")); + for (i = 0 ; i <= (p_ra_table->rate_length); i++) { +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + PHYDM_DBG(p_dm, DBG_RA, (" [ %d ] %20d %25d %20s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); +#else + PHYDM_DBG(p_dm, DBG_RA, (" [ %d ] %10d %14d %14s\n", i, value[i], value_default[i], ((modify_note[i] == 1) ? "V" : " . "))); +#endif + } + +} + +void +odm_RA_debug( + void *p_dm_void, + u32 *const dm_value +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + + p_ra_table->is_ra_dbg_init = false; + + if (dm_value[0] == 100) { /*1 Print RA Parameters*/ + u8 default_pointer_value; + u8 *pvalue; + u8 *pvalue_default; + u8 *pmodify_note; + + pvalue = pvalue_default = pmodify_note = &default_pointer_value; + + PHYDM_DBG(p_dm, DBG_RA, ("\n------------------------------------------------------------------------------------\n")); + + if (dm_value[1] == RADBG_RTY_PENALTY) { /* [1]*/ + PHYDM_DBG(p_dm, DBG_RA, (" [1] RTY_PENALTY\n")); + pvalue = &(p_ra_table->RTY_P[0]); + pvalue_default = &(p_ra_table->RTY_P_default[0]); + pmodify_note = (u8 *)&(p_ra_table->RTY_P_modify_note[0]); + } else if (dm_value[1] == RADBG_N_HIGH) /* [2]*/ + PHYDM_DBG(p_dm, DBG_RA, (" [2] N_HIGH\n")); + + else if (dm_value[1] == RADBG_N_LOW) /*[3]*/ + PHYDM_DBG(p_dm, DBG_RA, (" [3] N_LOW\n")); + + else if (dm_value[1] == RADBG_RATE_UP_RTY_RATIO) { /* [8]*/ + PHYDM_DBG(p_dm, DBG_RA, (" [8] RATE_UP_RTY_RATIO\n")); + pvalue = &(p_ra_table->RATE_UP_RTY_RATIO[0]); + pvalue_default = &(p_ra_table->RATE_UP_RTY_RATIO_default[0]); + pmodify_note = (u8 *)&(p_ra_table->RATE_UP_RTY_RATIO_modify_note[0]); + } else if (dm_value[1] == RADBG_RATE_DOWN_RTY_RATIO) { /* [9]*/ + PHYDM_DBG(p_dm, DBG_RA, (" [9] RATE_DOWN_RTY_RATIO\n")); + pvalue = &(p_ra_table->RATE_DOWN_RTY_RATIO[0]); + pvalue_default = &(p_ra_table->RATE_DOWN_RTY_RATIO_default[0]); + pmodify_note = (u8 *)&(p_ra_table->RATE_DOWN_RTY_RATIO_modify_note[0]); + } + + phydm_ra_print_msg(p_dm, pvalue, pvalue_default, pmodify_note); + PHYDM_DBG(p_dm, DBG_RA, ("\n------------------------------------------------------------------------------------\n\n")); + + } else if (dm_value[0] == 101) { + p_ra_table->para_idx = (u8)dm_value[1]; + + p_ra_table->ra_para_feedback_req = 1; + odm_ra_para_adjust_send_h2c(p_dm); + } else { + p_ra_table->para_idx = (u8)dm_value[0]; + p_ra_table->rate_idx = (u8)dm_value[1]; + p_ra_table->value = (u8)dm_value[2]; + + odm_ra_para_adjust(p_dm); + } +} + +void +odm_ra_para_adjust_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 i; + u8 ra_para_pool_u8[3] = { RADBG_RTY_PENALTY, RADBG_RATE_UP_RTY_RATIO, RADBG_RATE_DOWN_RTY_RATIO}; + u8 rate_size_ht_1ss = 20, rate_size_ht_2ss = 28, rate_size_ht_3ss = 36; /*4+8+8+8+8 =36*/ + u8 rate_size_vht_1ss = 10, rate_size_vht_2ss = 20, rate_size_vht_3ss = 30; /*10 + 10 +10 =30*/ +#if 0 + /* RTY_PENALTY = 1, u8 */ + /* N_HIGH = 2, */ + /* N_LOW = 3, */ + /* RATE_UP_TABLE = 4, */ + /* RATE_DOWN_TABLE = 5, */ + /* TRYING_NECESSARY = 6, */ + /* DROPING_NECESSARY = 7, */ + /* RATE_UP_RTY_RATIO = 8, u8 */ + /* RATE_DOWN_RTY_RATIO= 9, u8 */ + /* ALL_PARA = 0xff */ + +#endif + PHYDM_DBG(p_dm, DBG_RA, ("odm_ra_para_adjust_init\n")); + +/* JJ ADD 20161014 */ + if (p_dm->support_ic_type & (ODM_RTL8188F | ODM_RTL8195A | ODM_RTL8703B | ODM_RTL8723B | ODM_RTL8188E | ODM_RTL8723D | ODM_RTL8710B)) + p_ra_table->rate_length = rate_size_ht_1ss; + else if (p_dm->support_ic_type & (ODM_RTL8192E | ODM_RTL8197F)) + p_ra_table->rate_length = rate_size_ht_2ss; + else if (p_dm->support_ic_type & (ODM_RTL8821 | ODM_RTL8881A | ODM_RTL8821C)) + p_ra_table->rate_length = rate_size_ht_1ss + rate_size_vht_1ss; + else if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8822B)) + p_ra_table->rate_length = rate_size_ht_2ss + rate_size_vht_2ss; + else if (p_dm->support_ic_type == ODM_RTL8814A) + p_ra_table->rate_length = rate_size_ht_3ss + rate_size_vht_3ss; + else + p_ra_table->rate_length = rate_size_ht_1ss; + + p_ra_table->is_ra_dbg_init = true; + for (i = 0; i < 3; i++) { + p_ra_table->ra_para_feedback_req = 1; + p_ra_table->para_idx = ra_para_pool_u8[i]; + odm_ra_para_adjust_send_h2c(p_dm); + } +} + +#endif /*#if (defined(CONFIG_RA_DBG_CMD))*/ + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.h index 514b0212a9a6..ba8008b63c64 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rainfo.h @@ -1,583 +1,456 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __PHYDMRAINFO_H__ -#define __PHYDMRAINFO_H__ - -/*#define RAINFO_VERSION "2.0" //2014.11.04*/ -/*#define RAINFO_VERSION "3.0" //2015.01.13 Dino*/ -/*#define RAINFO_VERSION "3.1" //2015.01.14 Dino*/ -/*#define RAINFO_VERSION "3.3" 2015.07.29 YuChen*/ -/*#define RAINFO_VERSION "3.4"*/ /*2015.12.15 Stanley*/ -/*#define RAINFO_VERSION "4.0"*/ /*2016.03.24 Dino, Add more RA mask state and Phydm-lize partial ra mask function */ -/*#define RAINFO_VERSION "4.1"*/ /*2016.04.20 Dino, Add new function to adjust PCR RA threshold */ -#define RAINFO_VERSION "4.2" /*2016.05.17 Dino, Add H2C debug cmd */ - -#define H2C_0X42_LENGTH 5 -#define H2C_MAX_LENGTH 7 - -#define RA_FLOOR_UP_GAP 3 -#define RA_FLOOR_TABLE_SIZE 7 - -#define ACTIVE_TP_THRESHOLD 150 -#define RA_RETRY_DESCEND_NUM 2 -#define RA_RETRY_LIMIT_LOW 4 -#define RA_RETRY_LIMIT_HIGH 32 - -#define RAINFO_BE_RX_STATE BIT0 // 1:RX //ULDL -#define RAINFO_STBC_STATE BIT1 -//#define RAINFO_LDPC_STATE BIT2 -#define RAINFO_NOISY_STATE BIT2 // set by Noisy_Detection -#define RAINFO_SHURTCUT_STATE BIT3 -#define RAINFO_SHURTCUT_FLAG BIT4 -#define RAINFO_INIT_RSSI_RATE_STATE BIT5 -#define RAINFO_BF_STATE BIT6 -#define RAINFO_BE_TX_STATE BIT7 // 1:TX - -#define RA_MASK_CCK 0xf -#define RA_MASK_OFDM 0xff0 -#define RA_MASK_HT1SS 0xff000 -#define RA_MASK_HT2SS 0xff00000 -/*#define RA_MASK_MCS3SS */ -#define RA_MASK_HT4SS 0xff0 -#define RA_MASK_VHT1SS 0x3ff000 -#define RA_MASK_VHT2SS 0xffc00000 - -#if(DM_ODM_SUPPORT_TYPE == ODM_AP) -#define RA_FIRST_MACID 1 -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#define RA_FIRST_MACID 0 -#define WIN_DEFAULT_PORT_MACID 0 -#define WIN_BT_PORT_MACID 2 -#else /*if (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ -#define RA_FIRST_MACID 0 -#endif - -#define AP_InitRateAdaptiveState ODM_RateAdaptiveStateApInit - -#if (RA_MASK_PHYDMLIZE_CE || RA_MASK_PHYDMLIZE_AP || RA_MASK_PHYDMLIZE_WIN) -#define DM_RATR_STA_INIT 0 -#define DM_RATR_STA_HIGH 1 -#define DM_RATR_STA_MIDDLE 2 -#define DM_RATR_STA_LOW 3 -#define DM_RATR_STA_ULTRA_LOW 4 -#endif - -typedef enum _phydm_arfr_num { - ARFR_0_RATE_ID = 0x9, - ARFR_1_RATE_ID = 0xa, - ARFR_2_RATE_ID = 0xb, - ARFR_3_RATE_ID = 0xc, - ARFR_4_RATE_ID = 0xd, - ARFR_5_RATE_ID = 0xe -} PHYDM_RA_ARFR_NUM_E; - -typedef enum _Phydm_ra_dbg_para { - RADBG_PCR_TH_OFFSET = 0, - RADBG_RTY_PENALTY = 1, - RADBG_N_HIGH = 2, - RADBG_N_LOW = 3, - RADBG_TRATE_UP_TABLE = 4, - RADBG_TRATE_DOWN_TABLE = 5, - RADBG_TRYING_NECESSARY = 6, - RADBG_TDROPING_NECESSARY = 7, - RADBG_RATE_UP_RTY_RATIO = 8, - RADBG_RATE_DOWN_RTY_RATIO = 9, //u8 - - RADBG_DEBUG_MONITOR1 = 0xc, - RADBG_DEBUG_MONITOR2 = 0xd, - RADBG_DEBUG_MONITOR3 = 0xe, - RADBG_DEBUG_MONITOR4 = 0xf, - RADBG_DEBUG_MONITOR5 = 0x10, - NUM_RA_PARA -} PHYDM_RA_DBG_PARA_E; - -typedef enum PHYDM_WIRELESS_MODE { - - PHYDM_WIRELESS_MODE_UNKNOWN = 0x00, - PHYDM_WIRELESS_MODE_A = 0x01, - PHYDM_WIRELESS_MODE_B = 0x02, - PHYDM_WIRELESS_MODE_G = 0x04, - PHYDM_WIRELESS_MODE_AUTO = 0x08, - PHYDM_WIRELESS_MODE_N_24G = 0x10, - PHYDM_WIRELESS_MODE_N_5G = 0x20, - PHYDM_WIRELESS_MODE_AC_5G = 0x40, - PHYDM_WIRELESS_MODE_AC_24G = 0x80, - PHYDM_WIRELESS_MODE_AC_ONLY = 0x100, - PHYDM_WIRELESS_MODE_MAX = 0x800, - PHYDM_WIRELESS_MODE_ALL = 0xFFFF -} PHYDM_WIRELESS_MODE_E; - -typedef enum PHYDM_RATEID_IDX_ { - - PHYDM_BGN_40M_2SS = 0, - PHYDM_BGN_40M_1SS = 1, - PHYDM_BGN_20M_2SS = 2, - PHYDM_BGN_20M_1SS = 3, - PHYDM_GN_N2SS = 4, - PHYDM_GN_N1SS = 5, - PHYDM_BG = 6, - PHYDM_G = 7, - PHYDM_B_20M = 8, - PHYDM_ARFR0_AC_2SS = 9, - PHYDM_ARFR1_AC_1SS = 10, - PHYDM_ARFR2_AC_2G_1SS = 11, - PHYDM_ARFR3_AC_2G_2SS = 12, - PHYDM_ARFR4_AC_3SS = 13, - PHYDM_ARFR5_N_3SS = 14 -} PHYDM_RATEID_IDX_E; - -typedef enum _PHYDM_RF_TYPE_DEFINITION { - PHYDM_RF_1T1R = 0, - PHYDM_RF_1T2R, - PHYDM_RF_2T2R, - PHYDM_RF_2T2R_GREEN, - PHYDM_RF_2T3R, - PHYDM_RF_2T4R, - PHYDM_RF_3T3R, - PHYDM_RF_3T4R, - PHYDM_RF_4T4R, - PHYDM_RF_MAX_TYPE -} PHYDM_RF_TYPE_DEF_E; - -typedef enum _PHYDM_BW { - PHYDM_BW_20 = 0, - PHYDM_BW_40, - PHYDM_BW_80, - PHYDM_BW_80_80, - PHYDM_BW_160, - PHYDM_BW_10, - PHYDM_BW_5 -} PHYDM_BW_E; - - -#if (RATE_ADAPTIVE_SUPPORT == 1)//88E RA -typedef struct _ODM_RA_Info_ { - u1Byte RateID; - u4Byte RateMask; - u4Byte RAUseRate; - u1Byte RateSGI; - u1Byte RssiStaRA; - u1Byte PreRssiStaRA; - u1Byte SGIEnable; - u1Byte DecisionRate; - u1Byte PreRate; - u1Byte HighestRate; - u1Byte LowestRate; - u4Byte NscUp; - u4Byte NscDown; - u2Byte RTY[5]; - u4Byte TOTAL; - u2Byte DROP; - u1Byte Active; - u2Byte RptTime; - u1Byte RAWaitingCounter; - u1Byte RAPendingCounter; - u1Byte RADropAfterDown; -#if 1 //POWER_TRAINING_ACTIVE == 1 // For compile pass only~! - u1Byte PTActive; // on or off - u1Byte PTTryState; // 0 trying state, 1 for decision state - u1Byte PTStage; // 0~6 - u1Byte PTStopCount; //Stop PT counter - u1Byte PTPreRate; // if rate change do PT - u1Byte PTPreRssi; // if RSSI change 5% do PT - u1Byte PTModeSS; // decide whitch rate should do PT - u1Byte RAstage; // StageRA, decide how many times RA will be done between PT - u1Byte PTSmoothFactor; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) - u1Byte RateDownCounter; - u1Byte RateUpCounter; - u1Byte RateDirection; - u1Byte BoundingType; - u1Byte BoundingCounter; - u1Byte BoundingLearningTime; - u1Byte RateDownStartTime; -#endif -} ODM_RA_INFO_T, *PODM_RA_INFO_T; -#endif - - -typedef struct _Rate_Adaptive_Table_ { - u1Byte firstconnect; -#if(DM_ODM_SUPPORT_TYPE==ODM_WIN) - BOOLEAN PT_collision_pre; -#endif - -#if (defined(CONFIG_RA_DBG_CMD)) - BOOLEAN is_ra_dbg_init; - - u1Byte RTY_P[ODM_NUM_RATE_IDX]; - u1Byte RTY_P_default[ODM_NUM_RATE_IDX]; - BOOLEAN RTY_P_modify_note[ODM_NUM_RATE_IDX]; - - u1Byte RATE_UP_RTY_RATIO[ODM_NUM_RATE_IDX]; - u1Byte RATE_UP_RTY_RATIO_default[ODM_NUM_RATE_IDX]; - BOOLEAN RATE_UP_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; - - u1Byte RATE_DOWN_RTY_RATIO[ODM_NUM_RATE_IDX]; - u1Byte RATE_DOWN_RTY_RATIO_default[ODM_NUM_RATE_IDX]; - BOOLEAN RATE_DOWN_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; - - BOOLEAN RA_Para_feedback_req; - - u1Byte para_idx; - u1Byte rate_idx; - u1Byte value; - u2Byte value_16; - u1Byte rate_length; -#endif - u1Byte link_tx_rate[ODM_ASSOCIATE_ENTRY_NUM]; - u1Byte highest_client_tx_order; - u2Byte highest_client_tx_rate_order; - u1Byte power_tracking_flag; - u1Byte RA_threshold_offset; - u1Byte RA_offset_direction; - - #if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) - u1Byte per_rate_retrylimit_20M[ODM_NUM_RATE_IDX]; - u1Byte per_rate_retrylimit_40M[ODM_NUM_RATE_IDX]; - u1Byte retry_descend_num; - u1Byte retrylimit_low; - u1Byte retrylimit_high; - #endif - - -} RA_T, *pRA_T; - -typedef struct _ODM_RATE_ADAPTIVE { - u1Byte Type; // DM_Type_ByFW/DM_Type_ByDriver - u1Byte HighRSSIThresh; // if RSSI > HighRSSIThresh => RATRState is DM_RATR_STA_HIGH - u1Byte LowRSSIThresh; // if RSSI <= LowRSSIThresh => RATRState is DM_RATR_STA_LOW - u1Byte RATRState; // Current RSSI level, DM_RATR_STA_HIGH/DM_RATR_STA_MIDDLE/DM_RATR_STA_LOW - -#if(DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - u1Byte LdpcThres; // if RSSI > LdpcThres => switch from LPDC to BCC - BOOLEAN bLowerRtsRate; -#endif - -#if(DM_ODM_SUPPORT_TYPE & ODM_WIN) - u1Byte RtsThres; -#elif(DM_ODM_SUPPORT_TYPE & ODM_CE) - BOOLEAN bUseLdpc; -#else - u1Byte UltraLowRSSIThresh; - u4Byte LastRATR; // RATR Register Content -#endif - -} ODM_RATE_ADAPTIVE, *PODM_RATE_ADAPTIVE; - -VOID -phydm_h2C_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -); - -#if (defined(CONFIG_RA_DBG_CMD)) - -VOID -odm_RA_debug( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value -); - -VOID -odm_RA_ParaAdjust_init( - IN PVOID pDM_VOID -); - -#else - -VOID -phydm_RA_debug_PCR( - IN PVOID pDM_VOID, - IN u4Byte *const dm_value, - IN u4Byte *_used, - OUT char *output, - IN u4Byte *_out_len -); - -#endif - -VOID -ODM_C2HRaParaReportHandler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -); - -VOID -odm_RA_ParaAdjust( - IN PVOID pDM_VOID -); - -VOID -phydm_ra_dynamic_retry_count( - IN PVOID pDM_VOID -); - -VOID -phydm_ra_dynamic_retry_limit( - IN PVOID pDM_VOID -); - -VOID -phydm_ra_dynamic_rate_id_on_assoc( - IN PVOID pDM_VOID, - IN u1Byte wireless_mode, - IN u1Byte init_rate_id -); - -VOID -phydm_print_rate( - IN PVOID pDM_VOID, - IN u1Byte rate, - IN u4Byte dbg_component -); - -VOID -phydm_c2h_ra_report_handler( - IN PVOID pDM_VOID, - IN pu1Byte CmdBuf, - IN u1Byte CmdLen -); - -u1Byte -phydm_rate_order_compute( - IN PVOID pDM_VOID, - IN u1Byte rate_idx - ); - -VOID -phydm_ra_info_watchdog( - IN PVOID pDM_VOID -); - -VOID -phydm_ra_info_init( - IN PVOID pDM_VOID -); - -VOID -odm_RSSIMonitorInit( - IN PVOID pDM_VOID -); - -VOID -phydm_modify_RA_PCR_threshold( - IN PVOID pDM_VOID, - IN u1Byte RA_offset_direction, - IN u1Byte RA_threshold_offset -); - -VOID -odm_RSSIMonitorCheck( - IN PVOID pDM_VOID -); - -VOID -phydm_initRaInfo( - IN PVOID pDM_VOID -); - -u1Byte -phydm_vht_en_mapping( - IN PVOID pDM_VOID, - IN u4Byte WirelessMode -); - -u1Byte -phydm_rate_id_mapping( - IN PVOID pDM_VOID, - IN u4Byte WirelessMode, - IN u1Byte RfType, - IN u1Byte bw -); - -VOID -phydm_UpdateHalRAMask( - IN PVOID pDM_VOID, - IN u4Byte wirelessMode, - IN u1Byte RfType, - IN u1Byte BW, - IN u1Byte MimoPs_enable, - IN u1Byte disable_cck_rate, - IN u4Byte *ratr_bitmap_msb_in, - IN u4Byte *ratr_bitmap_in, - IN u1Byte tx_rate_level -); - -VOID -odm_RateAdaptiveMaskInit( - IN PVOID pDM_VOID -); - -VOID -odm_RefreshRateAdaptiveMask( - IN PVOID pDM_VOID -); - -VOID -odm_RefreshRateAdaptiveMaskMP( - IN PVOID pDM_VOID -); - -VOID -odm_RefreshRateAdaptiveMaskCE( - IN PVOID pDM_VOID -); - -VOID -odm_RefreshRateAdaptiveMaskAPADSL( - IN PVOID pDM_VOID -); - -u1Byte -phydm_RA_level_decision( - IN PVOID pDM_VOID, - IN u4Byte rssi, - IN u1Byte Ratr_State -); - -BOOLEAN -ODM_RAStateCheck( - IN PVOID pDM_VOID, - IN s4Byte RSSI, - IN BOOLEAN bForceUpdate, - OUT pu1Byte pRATRState -); - -VOID -odm_RefreshBasicRateMask( - IN PVOID pDM_VOID -); -VOID -ODM_RAPostActionOnAssoc( - IN PVOID pDM_Odm -); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - -u1Byte -odm_Find_RTS_Rate( - IN PVOID pDM_VOID, - IN u1Byte Tx_Rate, - IN BOOLEAN bErpProtect -); - -VOID -ODM_UpdateNoisyState( - IN PVOID pDM_VOID, - IN BOOLEAN bNoisyStateFromC2H -); - -VOID -phydm_update_pwr_track( - IN PVOID pDM_VOID, - IN u1Byte Rate -); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -s4Byte -phydm_FindMinimumRSSI( -IN PDM_ODM_T pDM_Odm, -IN PADAPTER pAdapter, -IN OUT BOOLEAN *pbLink_temp -); - -VOID -ODM_UpdateInitRateWorkItemCallback( - IN PVOID pContext -); - -VOID -odm_RSSIDumpToRegister( - IN PVOID pDM_VOID -); - -VOID -odm_RefreshLdpcRtsMP( - IN PADAPTER pAdapter, - IN PDM_ODM_T pDM_Odm, - IN u1Byte mMacId, - IN u1Byte IOTPeer, - IN s4Byte UndecoratedSmoothedPWDB -); - -#if 0 -VOID -ODM_DynamicARFBSelect( - IN PVOID pDM_VOID, - IN u1Byte rate, - IN BOOLEAN Collision_State -); -#endif - -VOID -ODM_RateAdaptiveStateApInit( - IN PVOID PADAPTER_VOID, - IN PRT_WLAN_STA pEntry -); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - -static void -FindMinimumRSSI( - IN PADAPTER pAdapter -); - -u8Byte -PhyDM_Get_Rate_Bitmap_Ex( - IN PVOID pDM_VOID, - IN u4Byte macid, - IN u8Byte ra_mask, - IN u1Byte rssi_level, - OUT u8Byte *dm_RA_Mask, - OUT u1Byte *dm_RteID -); -u4Byte -ODM_Get_Rate_Bitmap( - IN PVOID pDM_VOID, - IN u4Byte macid, - IN u4Byte ra_mask, - IN u1Byte rssi_level -); - -void phydm_ra_rssi_rpt_wk(PVOID pContext); -#endif/*#elif (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ - -#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) - -VOID -phydm_gen_ramask_h2c_AP( - IN PVOID pDM_VOID, - IN struct rtl8192cd_priv *priv, - IN PSTA_INFO_T *pEntry, - IN u1Byte rssi_level -); - -#endif/*#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN| ODM_CE))*/ - -#endif /*#ifndef __ODMRAINFO_H__*/ - - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMRAINFO_H__ +#define __PHYDMRAINFO_H__ + +/*#define RAINFO_VERSION "2.0"*/ /*2014.11.04*/ +/*#define RAINFO_VERSION "3.0"*/ /*2015.01.13 Dino*/ +/*#define RAINFO_VERSION "3.1"*/ /*2015.01.14 Dino*/ +/*#define RAINFO_VERSION "3.3"*/ /*2015.07.29 YuChen*/ +/*#define RAINFO_VERSION "3.4"*/ /*2015.12.15 Stanley*/ +/*#define RAINFO_VERSION "4.0"*/ /*2016.03.24 Dino, Add more RA mask state and Phydm-lize partial ra mask function */ +/*#define RAINFO_VERSION "4.1"*/ /*2016.04.20 Dino, Add new function to adjust PCR RA threshold */ +/*#define RAINFO_VERSION "4.2"*/ /*2016.05.17 Dino, Add H2C debug cmd */ +/*#define RAINFO_VERSION "4.3"*/ /*2016.07.11 Dino, Fix RA hang in CCK 1M problem */ +#define RAINFO_VERSION "5.0" /*2017.04.20 Dino, the 3rd PHYDM reform*/ + +#define FORCED_UPDATE_RAMASK_PERIOD 5 + +#define H2C_MAX_LENGTH 7 + +#define RA_FLOOR_UP_GAP 3 +#define RA_FLOOR_TABLE_SIZE 7 + +#define ACTIVE_TP_THRESHOLD 1 +#define RA_RETRY_DESCEND_NUM 2 +#define RA_RETRY_LIMIT_LOW 4 +#define RA_RETRY_LIMIT_HIGH 32 + +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) + #define RA_FIRST_MACID 1 +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define RA_FIRST_MACID 0 + #define WIN_DEFAULT_PORT_MACID 0 + #define WIN_BT_PORT_MACID 2 +#else /*if (DM_ODM_SUPPORT_TYPE == ODM_CE)*/ + #define RA_FIRST_MACID 0 +#endif + +#if (DM_ODM_SUPPORT_TYPE & ODM_WIN) +#define AP_InitRateAdaptiveState odm_rate_adaptive_state_ap_init +#endif + + +#define DM_RATR_STA_INIT 0 +#define DM_RATR_STA_HIGH 1 +#define DM_RATR_STA_MIDDLE 2 +#define DM_RATR_STA_LOW 3 +#define DM_RATR_STA_ULTRA_LOW 4 + +enum phydm_ra_dbg_para_e { + RADBG_PCR_TH_OFFSET = 0, + RADBG_RTY_PENALTY = 1, + RADBG_N_HIGH = 2, + RADBG_N_LOW = 3, + RADBG_TRATE_UP_TABLE = 4, + RADBG_TRATE_DOWN_TABLE = 5, + RADBG_TRYING_NECESSARY = 6, + RADBG_TDROPING_NECESSARY = 7, + RADBG_RATE_UP_RTY_RATIO = 8, + RADBG_RATE_DOWN_RTY_RATIO = 9, /* u8 */ + + RADBG_DEBUG_MONITOR1 = 0xc, + RADBG_DEBUG_MONITOR2 = 0xd, + RADBG_DEBUG_MONITOR3 = 0xe, + RADBG_DEBUG_MONITOR4 = 0xf, + RADBG_DEBUG_MONITOR5 = 0x10, + NUM_RA_PARA +}; + +enum phydm_wireless_mode_e { + + PHYDM_WIRELESS_MODE_UNKNOWN = 0x00, + PHYDM_WIRELESS_MODE_A = 0x01, + PHYDM_WIRELESS_MODE_B = 0x02, + PHYDM_WIRELESS_MODE_G = 0x04, + PHYDM_WIRELESS_MODE_AUTO = 0x08, + PHYDM_WIRELESS_MODE_N_24G = 0x10, + PHYDM_WIRELESS_MODE_N_5G = 0x20, + PHYDM_WIRELESS_MODE_AC_5G = 0x40, + PHYDM_WIRELESS_MODE_AC_24G = 0x80, + PHYDM_WIRELESS_MODE_AC_ONLY = 0x100, + PHYDM_WIRELESS_MODE_MAX = 0x800, + PHYDM_WIRELESS_MODE_ALL = 0xFFFF +}; + +enum phydm_rateid_idx_e { + + PHYDM_BGN_40M_2SS = 0, + PHYDM_BGN_40M_1SS = 1, + PHYDM_BGN_20M_2SS = 2, + PHYDM_BGN_20M_1SS = 3, + PHYDM_GN_N2SS = 4, + PHYDM_GN_N1SS = 5, + PHYDM_BG = 6, + PHYDM_G = 7, + PHYDM_B_20M = 8, + PHYDM_ARFR0_AC_2SS = 9, + PHYDM_ARFR1_AC_1SS = 10, + PHYDM_ARFR2_AC_2G_1SS = 11, + PHYDM_ARFR3_AC_2G_2SS = 12, + PHYDM_ARFR4_AC_3SS = 13, + PHYDM_ARFR5_N_3SS = 14 +}; + +#if (RATE_ADAPTIVE_SUPPORT == 1)/* 88E RA */ +struct _odm_ra_info_ { + u8 rate_id; + u32 rate_mask; + u32 ra_use_rate; + u8 rate_sgi; + u8 rssi_sta_ra; + u8 pre_rssi_sta_ra; + u8 sgi_enable; + u8 decision_rate; + u8 pre_rate; + u8 highest_rate; + u8 lowest_rate; + u32 nsc_up; + u32 nsc_down; + u16 RTY[5]; + u32 TOTAL; + u16 DROP; + u8 active; + u16 rpt_time; + u8 ra_waiting_counter; + u8 ra_pending_counter; + u8 ra_drop_after_down; +#if 1 /* POWER_TRAINING_ACTIVE == 1 */ /* For compile pass only~! */ + u8 pt_active; /* on or off */ + u8 pt_try_state; /* 0 trying state, 1 for decision state */ + u8 pt_stage; /* 0~6 */ + u8 pt_stop_count; /* Stop PT counter */ + u8 pt_pre_rate; /* if rate change do PT */ + u8 pt_pre_rssi; /* if RSSI change 5% do PT */ + u8 pt_mode_ss; /* decide whitch rate should do PT */ + u8 ra_stage; /* StageRA, decide how many times RA will be done between PT */ + u8 pt_smooth_factor; +#endif +#if (DM_ODM_SUPPORT_TYPE == ODM_AP) && ((DEV_BUS_TYPE == RT_USB_INTERFACE) || (DEV_BUS_TYPE == RT_SDIO_INTERFACE)) + u8 rate_down_counter; + u8 rate_up_counter; + u8 rate_direction; + u8 bounding_type; + u8 bounding_counter; + u8 bounding_learning_time; + u8 rate_down_start_time; +#endif +}; +#endif + + +struct _rate_adaptive_table_ { + u8 firstconnect; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + boolean PT_collision_pre; +#endif + +#if (defined(CONFIG_RA_DBG_CMD)) + boolean is_ra_dbg_init; + + u8 RTY_P[ODM_NUM_RATE_IDX]; + u8 RTY_P_default[ODM_NUM_RATE_IDX]; + boolean RTY_P_modify_note[ODM_NUM_RATE_IDX]; + + u8 RATE_UP_RTY_RATIO[ODM_NUM_RATE_IDX]; + u8 RATE_UP_RTY_RATIO_default[ODM_NUM_RATE_IDX]; + boolean RATE_UP_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; + + u8 RATE_DOWN_RTY_RATIO[ODM_NUM_RATE_IDX]; + u8 RATE_DOWN_RTY_RATIO_default[ODM_NUM_RATE_IDX]; + boolean RATE_DOWN_RTY_RATIO_modify_note[ODM_NUM_RATE_IDX]; + + boolean ra_para_feedback_req; + + u8 para_idx; + u8 rate_idx; + u8 value; + u16 value_16; + u8 rate_length; +#endif + /*u8 link_tx_rate[ODM_ASSOCIATE_ENTRY_NUM];*/ + u8 ra_ratio[ODM_ASSOCIATE_ENTRY_NUM]; + u8 mu1_rate[30]; + u8 highest_client_tx_order; + u16 highest_client_tx_rate_order; + u8 power_tracking_flag; + u8 RA_threshold_offset; + u8 RA_offset_direction; + u8 up_ramask_cnt; /*force update_ra_mask counter*/ + u8 up_ramask_cnt_tmp; /*Just for debug, should be removed latter*/ + +#if (defined(CONFIG_RA_DYNAMIC_RTY_LIMIT)) + u8 per_rate_retrylimit_20M[ODM_NUM_RATE_IDX]; + u8 per_rate_retrylimit_40M[ODM_NUM_RATE_IDX]; + u8 retry_descend_num; + u8 retrylimit_low; + u8 retrylimit_high; +#endif + u8 ldpc_thres; /* if RSSI > ldpc_thres => switch from LPDC to BCC */ + + void (*record_ra_info)(void *p_dm_void, u8 macid, struct cmn_sta_info *p_sta, u64 ra_mask); +}; + +void +phydm_h2C_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +#if (defined(CONFIG_RA_DBG_CMD)) + +void +odm_RA_debug( + void *p_dm_void, + u32 *const dm_value +); + +void +odm_ra_para_adjust_init( + void *p_dm_void +); + +#endif + +void +phydm_ra_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len +); + +void +odm_c2h_ra_para_report_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +); + +void +odm_ra_para_adjust( + void *p_dm_void +); + +void +phydm_ra_dynamic_retry_count( + void *p_dm_void +); + +void +phydm_ra_dynamic_retry_limit( + void *p_dm_void +); + +void +phydm_print_rate( + void *p_dm_void, + u8 rate, + u32 dbg_component +); + +void +phydm_c2h_ra_report_handler( + void *p_dm_void, + u8 *cmd_buf, + u8 cmd_len +); + +u8 +phydm_rate_order_compute( + void *p_dm_void, + u8 rate_idx +); + +void +phydm_ra_info_watchdog( + void *p_dm_void +); + +void +phydm_ra_info_init( + void *p_dm_void +); + +void +phydm_modify_RA_PCR_threshold( + void *p_dm_void, + u8 RA_offset_direction, + u8 RA_threshold_offset +); + +u8 +phydm_vht_en_mapping( + void *p_dm_void, + u32 wireless_mode +); + +u8 +phydm_rate_id_mapping( + void *p_dm_void, + u32 wireless_mode, + u8 rf_type, + u8 bw +); + +void +phydm_update_hal_ra_mask( + void *p_dm_void, + u32 wireless_mode, + u8 rf_type, + u8 BW, + u8 mimo_ps_enable, + u8 disable_cck_rate, + u32 *ratr_bitmap_msb_in, + u32 *ratr_bitmap_in, + u8 tx_rate_level +); + +void +phydm_refresh_rate_adaptive_mask( + void *p_dm_void +); + +u8 +phydm_rssi_lv_dec( + void *p_dm_void, + u32 rssi, + u8 ratr_state +); + +void +odm_ra_post_action_on_assoc( + void *p_dm +); + +u8 +odm_find_rts_rate( + void *p_dm_void, + u8 tx_rate, + boolean is_erp_protect +); + +void +phydm_show_sta_info( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +#ifdef PHYDM_3RD_REFORM_RA_MASK + +void +phydm_ra_registed( + void *p_dm_void, + u8 macid, + u8 rssi_from_assoc +); + +void +phydm_ra_offline( + void *p_dm_void, + u8 macid +); + + +void +phydm_ra_mask_watchdog( + void *p_dm_void +); + +#endif + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +odm_refresh_basic_rate_mask( + void *p_dm_void +); + +void +odm_update_init_rate_work_item_callback( + void *p_context +); + +void +odm_refresh_ldpc_rts_mp( + struct _ADAPTER *p_adapter, + struct PHY_DM_STRUCT *p_dm, + u8 m_mac_id, + u8 iot_peer, + s32 undecorated_smoothed_pwdb +); + +void +odm_rate_adaptive_state_ap_init( + void *PADAPTER_VOID, + struct cmn_sta_info *p_entry +); + +#elif (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + +void +phydm_gen_ramask_h2c_AP( + void *p_dm_void, + struct rtl8192cd_priv *priv, + struct sta_info *p_entry, + u8 rssi_level +); + +#endif/*#if (DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ + + +#if (defined(CONFIG_RA_DYNAMIC_RATE_ID)) +void +phydm_ra_dynamic_rate_id_on_assoc( + void *p_dm_void, + u8 wireless_mode, + u8 init_rate_id +); + +void +phydm_ra_dynamic_rate_id_init( + void *p_dm_void +); + +void +phydm_update_rate_id( + void *p_dm_void, + u8 rate, + u8 platform_macid +); + +#endif + +#endif /*#ifndef __ODMRAINFO_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_reg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_reg.h index 019b28ee81e2..9bb5dde234b5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_reg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_reg.h @@ -1,215 +1,224 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ -//============================================================ -// File Name: odm_reg.h -// -// Description: -// -// This file is for general register definition. -// -// -//============================================================ -#ifndef __HAL_ODM_REG_H__ -#define __HAL_ODM_REG_H__ - -// -// Register Definition -// - -//MAC REG -#define ODM_BB_RESET 0x002 -#define ODM_DUMMY 0x4fe -#define RF_T_METER_OLD 0x24 -#define RF_T_METER_NEW 0x42 - -#define ODM_EDCA_VO_PARAM 0x500 -#define ODM_EDCA_VI_PARAM 0x504 -#define ODM_EDCA_BE_PARAM 0x508 -#define ODM_EDCA_BK_PARAM 0x50C -#define ODM_TXPAUSE 0x522 - -/* LTE_COEX */ -#define REG_LTECOEX_CTRL 0x07C0 -#define REG_LTECOEX_WRITE_DATA 0x07C4 -#define REG_LTECOEX_READ_DATA 0x07C8 -#define REG_LTECOEX_PATH_CONTROL 0x70 - -//BB REG -#define ODM_FPGA_PHY0_PAGE8 0x800 -#define ODM_PSD_SETTING 0x808 -#define ODM_AFE_SETTING 0x818 -#define ODM_TXAGC_B_6_18 0x830 -#define ODM_TXAGC_B_24_54 0x834 -#define ODM_TXAGC_B_MCS32_5 0x838 -#define ODM_TXAGC_B_MCS0_MCS3 0x83c -#define ODM_TXAGC_B_MCS4_MCS7 0x848 -#define ODM_TXAGC_B_MCS8_MCS11 0x84c -#define ODM_ANALOG_REGISTER 0x85c -#define ODM_RF_INTERFACE_OUTPUT 0x860 -#define ODM_TXAGC_B_MCS12_MCS15 0x868 -#define ODM_TXAGC_B_11_A_2_11 0x86c -#define ODM_AD_DA_LSB_MASK 0x874 -#define ODM_ENABLE_3_WIRE 0x88c -#define ODM_PSD_REPORT 0x8b4 -#define ODM_R_ANT_SELECT 0x90c -#define ODM_CCK_ANT_SELECT 0xa07 -#define ODM_CCK_PD_THRESH 0xa0a -#define ODM_CCK_RF_REG1 0xa11 -#define ODM_CCK_MATCH_FILTER 0xa20 -#define ODM_CCK_RAKE_MAC 0xa2e -#define ODM_CCK_CNT_RESET 0xa2d -#define ODM_CCK_TX_DIVERSITY 0xa2f -#define ODM_CCK_FA_CNT_MSB 0xa5b -#define ODM_CCK_FA_CNT_LSB 0xa5c -#define ODM_CCK_NEW_FUNCTION 0xa75 -#define ODM_OFDM_PHY0_PAGE_C 0xc00 -#define ODM_OFDM_RX_ANT 0xc04 -#define ODM_R_A_RXIQI 0xc14 -#define ODM_R_A_AGC_CORE1 0xc50 -#define ODM_R_A_AGC_CORE2 0xc54 -#define ODM_R_B_AGC_CORE1 0xc58 -#define ODM_R_AGC_PAR 0xc70 -#define ODM_R_HTSTF_AGC_PAR 0xc7c -#define ODM_TX_PWR_TRAINING_A 0xc90 -#define ODM_TX_PWR_TRAINING_B 0xc98 -#define ODM_OFDM_FA_CNT1 0xcf0 -#define ODM_OFDM_PHY0_PAGE_D 0xd00 -#define ODM_OFDM_FA_CNT2 0xda0 -#define ODM_OFDM_FA_CNT3 0xda4 -#define ODM_OFDM_FA_CNT4 0xda8 -#define ODM_TXAGC_A_6_18 0xe00 -#define ODM_TXAGC_A_24_54 0xe04 -#define ODM_TXAGC_A_1_MCS32 0xe08 -#define ODM_TXAGC_A_MCS0_MCS3 0xe10 -#define ODM_TXAGC_A_MCS4_MCS7 0xe14 -#define ODM_TXAGC_A_MCS8_MCS11 0xe18 -#define ODM_TXAGC_A_MCS12_MCS15 0xe1c - -//RF REG -#define ODM_GAIN_SETTING 0x00 -#define ODM_CHANNEL 0x18 -#define ODM_RF_T_METER 0x24 -#define ODM_RF_T_METER_92D 0x42 -#define ODM_RF_T_METER_88E 0x42 -#define ODM_RF_T_METER_92E 0x42 -#define ODM_RF_T_METER_8812 0x42 -#define rRF_TxGainOffset 0x55 - -//Ant Detect Reg -#define ODM_DPDT 0x300 - -//PSD Init -#define ODM_PSDREG 0x808 - -//92D Path Div -#define PATHDIV_REG 0xB30 -#define PATHDIV_TRI 0xBA0 - - -// -// Bitmap Definition -// -#if(DM_ODM_SUPPORT_TYPE & (ODM_AP)) -// TX AGC -#define rTxAGC_A_CCK11_CCK1_JAguar 0xc20 -#define rTxAGC_A_Ofdm18_Ofdm6_JAguar 0xc24 -#define rTxAGC_A_Ofdm54_Ofdm24_JAguar 0xc28 -#define rTxAGC_A_MCS3_MCS0_JAguar 0xc2c -#define rTxAGC_A_MCS7_MCS4_JAguar 0xc30 -#define rTxAGC_A_MCS11_MCS8_JAguar 0xc34 -#define rTxAGC_A_MCS15_MCS12_JAguar 0xc38 -#define rTxAGC_A_Nss1Index3_Nss1Index0_JAguar 0xc3c -#define rTxAGC_A_Nss1Index7_Nss1Index4_JAguar 0xc40 -#define rTxAGC_A_Nss2Index1_Nss1Index8_JAguar 0xc44 -#define rTxAGC_A_Nss2Index5_Nss2Index2_JAguar 0xc48 -#define rTxAGC_A_Nss2Index9_Nss2Index6_JAguar 0xc4c -#if defined(CONFIG_WLAN_HAL_8814AE) -#define rTxAGC_A_MCS19_MCS16_JAguar 0xcd8 -#define rTxAGC_A_MCS23_MCS20_JAguar 0xcdc -#define rTxAGC_A_Nss3Index3_Nss3Index0_JAguar 0xce0 -#define rTxAGC_A_Nss3Index7_Nss3Index4_JAguar 0xce4 -#define rTxAGC_A_Nss3Index9_Nss3Index8_JAguar 0xce8 -#endif -#define rTxAGC_B_CCK11_CCK1_JAguar 0xe20 -#define rTxAGC_B_Ofdm18_Ofdm6_JAguar 0xe24 -#define rTxAGC_B_Ofdm54_Ofdm24_JAguar 0xe28 -#define rTxAGC_B_MCS3_MCS0_JAguar 0xe2c -#define rTxAGC_B_MCS7_MCS4_JAguar 0xe30 -#define rTxAGC_B_MCS11_MCS8_JAguar 0xe34 -#define rTxAGC_B_MCS15_MCS12_JAguar 0xe38 -#define rTxAGC_B_Nss1Index3_Nss1Index0_JAguar 0xe3c -#define rTxAGC_B_Nss1Index7_Nss1Index4_JAguar 0xe40 -#define rTxAGC_B_Nss2Index1_Nss1Index8_JAguar 0xe44 -#define rTxAGC_B_Nss2Index5_Nss2Index2_JAguar 0xe48 -#define rTxAGC_B_Nss2Index9_Nss2Index6_JAguar 0xe4c -#if defined(CONFIG_WLAN_HAL_8814AE) -#define rTxAGC_B_MCS19_MCS16_JAguar 0xed8 -#define rTxAGC_B_MCS23_MCS20_JAguar 0xedc -#define rTxAGC_B_Nss3Index3_Nss3Index0_JAguar 0xee0 -#define rTxAGC_B_Nss3Index7_Nss3Index4_JAguar 0xee4 -#define rTxAGC_B_Nss3Index9_Nss3Index8_JAguar 0xee8 -#define rTxAGC_C_CCK11_CCK1_JAguar 0x1820 -#define rTxAGC_C_Ofdm18_Ofdm6_JAguar 0x1824 -#define rTxAGC_C_Ofdm54_Ofdm24_JAguar 0x1828 -#define rTxAGC_C_MCS3_MCS0_JAguar 0x182c -#define rTxAGC_C_MCS7_MCS4_JAguar 0x1830 -#define rTxAGC_C_MCS11_MCS8_JAguar 0x1834 -#define rTxAGC_C_MCS15_MCS12_JAguar 0x1838 -#define rTxAGC_C_Nss1Index3_Nss1Index0_JAguar 0x183c -#define rTxAGC_C_Nss1Index7_Nss1Index4_JAguar 0x1840 -#define rTxAGC_C_Nss2Index1_Nss1Index8_JAguar 0x1844 -#define rTxAGC_C_Nss2Index5_Nss2Index2_JAguar 0x1848 -#define rTxAGC_C_Nss2Index9_Nss2Index6_JAguar 0x184c -#define rTxAGC_C_MCS19_MCS16_JAguar 0x18d8 -#define rTxAGC_C_MCS23_MCS20_JAguar 0x18dc -#define rTxAGC_C_Nss3Index3_Nss3Index0_JAguar 0x18e0 -#define rTxAGC_C_Nss3Index7_Nss3Index4_JAguar 0x18e4 -#define rTxAGC_C_Nss3Index9_Nss3Index8_JAguar 0x18e8 -#define rTxAGC_D_CCK11_CCK1_JAguar 0x1a20 -#define rTxAGC_D_Ofdm18_Ofdm6_JAguar 0x1a24 -#define rTxAGC_D_Ofdm54_Ofdm24_JAguar 0x1a28 -#define rTxAGC_D_MCS3_MCS0_JAguar 0x1a2c -#define rTxAGC_D_MCS7_MCS4_JAguar 0x1a30 -#define rTxAGC_D_MCS11_MCS8_JAguar 0x1a34 -#define rTxAGC_D_MCS15_MCS12_JAguar 0x1a38 -#define rTxAGC_D_Nss1Index3_Nss1Index0_JAguar 0x1a3c -#define rTxAGC_D_Nss1Index7_Nss1Index4_JAguar 0x1a40 -#define rTxAGC_D_Nss2Index1_Nss1Index8_JAguar 0x1a44 -#define rTxAGC_D_Nss2Index5_Nss2Index2_JAguar 0x1a48 -#define rTxAGC_D_Nss2Index9_Nss2Index6_JAguar 0x1a4c -#define rTxAGC_D_MCS19_MCS16_JAguar 0x1ad8 -#define rTxAGC_D_MCS23_MCS20_JAguar 0x1adc -#define rTxAGC_D_Nss3Index3_Nss3Index0_JAguar 0x1ae0 -#define rTxAGC_D_Nss3Index7_Nss3Index4_JAguar 0x1ae4 -#define rTxAGC_D_Nss3Index9_Nss3Index8_JAguar 0x1ae8 -#endif - -#define bTxAGC_byte0_Jaguar 0xff -#define bTxAGC_byte1_Jaguar 0xff00 -#define bTxAGC_byte2_Jaguar 0xff0000 -#define bTxAGC_byte3_Jaguar 0xff000000 -#endif - -#define BIT_FA_RESET BIT0 - - - -#endif - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * File Name: odm_reg.h + * + * Description: + * + * This file is for general register definition. + * + * + * ************************************************************ */ +#ifndef __HAL_ODM_REG_H__ +#define __HAL_ODM_REG_H__ + +/* + * Register Definition + * */ + +/* MAC REG */ +#define ODM_BB_RESET 0x002 +#define ODM_DUMMY 0x4fe +#define RF_T_METER_OLD 0x24 +#define RF_T_METER_NEW 0x42 + +#define ODM_EDCA_VO_PARAM 0x500 +#define ODM_EDCA_VI_PARAM 0x504 +#define ODM_EDCA_BE_PARAM 0x508 +#define ODM_EDCA_BK_PARAM 0x50C +#define ODM_TXPAUSE 0x522 + +/* LTE_COEX */ +#define REG_LTECOEX_CTRL 0x07C0 +#define REG_LTECOEX_WRITE_DATA 0x07C4 +#define REG_LTECOEX_READ_DATA 0x07C8 +#define REG_LTECOEX_PATH_CONTROL 0x70 + +/* BB REG */ +#define ODM_FPGA_PHY0_PAGE8 0x800 +#define ODM_PSD_SETTING 0x808 +#define ODM_AFE_SETTING 0x818 +#define ODM_TXAGC_B_6_18 0x830 +#define ODM_TXAGC_B_24_54 0x834 +#define ODM_TXAGC_B_MCS32_5 0x838 +#define ODM_TXAGC_B_MCS0_MCS3 0x83c +#define ODM_TXAGC_B_MCS4_MCS7 0x848 +#define ODM_TXAGC_B_MCS8_MCS11 0x84c +#define ODM_ANALOG_REGISTER 0x85c +#define ODM_RF_INTERFACE_OUTPUT 0x860 +#define ODM_TXAGC_B_MCS12_MCS15 0x868 +#define ODM_TXAGC_B_11_A_2_11 0x86c +#define ODM_AD_DA_LSB_MASK 0x874 +#define ODM_ENABLE_3_WIRE 0x88c +#define ODM_PSD_REPORT 0x8b4 +#define ODM_R_ANT_SELECT 0x90c +#define ODM_CCK_ANT_SELECT 0xa07 +#define ODM_CCK_PD_THRESH 0xa0a +#define ODM_CCK_RF_REG1 0xa11 +#define ODM_CCK_MATCH_FILTER 0xa20 +#define ODM_CCK_RAKE_MAC 0xa2e +#define ODM_CCK_CNT_RESET 0xa2d +#define ODM_CCK_TX_DIVERSITY 0xa2f +#define ODM_CCK_FA_CNT_MSB 0xa5b +#define ODM_CCK_FA_CNT_LSB 0xa5c +#define ODM_CCK_NEW_FUNCTION 0xa75 +#define ODM_OFDM_PHY0_PAGE_C 0xc00 +#define ODM_OFDM_RX_ANT 0xc04 +#define ODM_R_A_RXIQI 0xc14 +#define ODM_R_A_AGC_CORE1 0xc50 +#define ODM_R_A_AGC_CORE2 0xc54 +#define ODM_R_B_AGC_CORE1 0xc58 +#define ODM_R_AGC_PAR 0xc70 +#define ODM_R_HTSTF_AGC_PAR 0xc7c +#define ODM_TX_PWR_TRAINING_A 0xc90 +#define ODM_TX_PWR_TRAINING_B 0xc98 +#define ODM_OFDM_FA_CNT1 0xcf0 +#define ODM_OFDM_PHY0_PAGE_D 0xd00 +#define ODM_OFDM_FA_CNT2 0xda0 +#define ODM_OFDM_FA_CNT3 0xda4 +#define ODM_OFDM_FA_CNT4 0xda8 +#define ODM_TXAGC_A_6_18 0xe00 +#define ODM_TXAGC_A_24_54 0xe04 +#define ODM_TXAGC_A_1_MCS32 0xe08 +#define ODM_TXAGC_A_MCS0_MCS3 0xe10 +#define ODM_TXAGC_A_MCS4_MCS7 0xe14 +#define ODM_TXAGC_A_MCS8_MCS11 0xe18 +#define ODM_TXAGC_A_MCS12_MCS15 0xe1c + +/* RF REG */ +#define ODM_GAIN_SETTING 0x00 +#define ODM_CHANNEL 0x18 +#define ODM_RF_T_METER 0x24 +#define ODM_RF_T_METER_92D 0x42 +#define ODM_RF_T_METER_88E 0x42 +#define ODM_RF_T_METER_92E 0x42 +#define ODM_RF_T_METER_8812 0x42 +#define REG_RF_TX_GAIN_OFFSET 0x55 + +/* ant Detect Reg */ +#define ODM_DPDT 0x300 + +/* PSD Init */ +#define ODM_PSDREG 0x808 + +/* 92D path Div */ +#define PATHDIV_REG 0xB30 +#define PATHDIV_TRI 0xBA0 + + +/* + * Bitmap Definition + * */ +#if (DM_ODM_SUPPORT_TYPE & (ODM_AP)) + /* TX AGC */ + #define REG_TX_AGC_A_CCK_11_CCK_1_JAGUAR 0xc20 + #define REG_TX_AGC_A_OFDM18_OFDM6_JAGUAR 0xc24 + #define REG_TX_AGC_A_OFDM54_OFDM24_JAGUAR 0xc28 + #define REG_TX_AGC_A_MCS3_MCS0_JAGUAR 0xc2c + #define REG_TX_AGC_A_MCS7_MCS4_JAGUAR 0xc30 + #define REG_TX_AGC_A_MCS11_MCS8_JAGUAR 0xc34 + #define REG_TX_AGC_A_MCS15_MCS12_JAGUAR 0xc38 + #define REG_TX_AGC_A_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0xc3c + #define REG_TX_AGC_A_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0xc40 + #define REG_TX_AGC_A_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0xc44 + #define REG_TX_AGC_A_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0xc48 + #define REG_TX_AGC_A_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0xc4c + #if defined(CONFIG_WLAN_HAL_8814AE) + #define REG_TX_AGC_A_MCS19_MCS16_JAGUAR 0xcd8 + #define REG_TX_AGC_A_MCS23_MCS20_JAGUAR 0xcdc + #define REG_TX_AGC_A_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0xce0 + #define REG_TX_AGC_A_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0xce4 + #define REG_TX_AGC_A_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0xce8 + #endif + #define REG_TX_AGC_B_CCK_11_CCK_1_JAGUAR 0xe20 + #define REG_TX_AGC_B_OFDM18_OFDM6_JAGUAR 0xe24 + #define REG_TX_AGC_B_OFDM54_OFDM24_JAGUAR 0xe28 + #define REG_TX_AGC_B_MCS3_MCS0_JAGUAR 0xe2c + #define REG_TX_AGC_B_MCS7_MCS4_JAGUAR 0xe30 + #define REG_TX_AGC_B_MCS11_MCS8_JAGUAR 0xe34 + #define REG_TX_AGC_B_MCS15_MCS12_JAGUAR 0xe38 + #define REG_TX_AGC_B_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0xe3c + #define REG_TX_AGC_B_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0xe40 + #define REG_TX_AGC_B_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0xe44 + #define REG_TX_AGC_B_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0xe48 + #define REG_TX_AGC_B_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0xe4c + #if defined(CONFIG_WLAN_HAL_8814AE) + #define REG_TX_AGC_B_MCS19_MCS16_JAGUAR 0xed8 + #define REG_TX_AGC_B_MCS23_MCS20_JAGUAR 0xedc + #define REG_TX_AGC_B_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0xee0 + #define REG_TX_AGC_B_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0xee4 + #define REG_TX_AGC_B_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0xee8 + #define REG_TX_AGC_C_CCK_11_CCK_1_JAGUAR 0x1820 + #define REG_TX_AGC_C_OFDM18_OFDM6_JAGUAR 0x1824 + #define REG_TX_AGC_C_OFDM54_OFDM24_JAGUAR 0x1828 + #define REG_TX_AGC_C_MCS3_MCS0_JAGUAR 0x182c + #define REG_TX_AGC_C_MCS7_MCS4_JAGUAR 0x1830 + #define REG_TX_AGC_C_MCS11_MCS8_JAGUAR 0x1834 + #define REG_TX_AGC_C_MCS15_MCS12_JAGUAR 0x1838 + #define REG_TX_AGC_C_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0x183c + #define REG_TX_AGC_C_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0x1840 + #define REG_TX_AGC_C_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0x1844 + #define REG_TX_AGC_C_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0x1848 + #define REG_TX_AGC_C_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0x184c + #define REG_TX_AGC_C_MCS19_MCS16_JAGUAR 0x18d8 + #define REG_TX_AGC_C_MCS23_MCS20_JAGUAR 0x18dc + #define REG_TX_AGC_C_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0x18e0 + #define REG_TX_AGC_C_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0x18e4 + #define REG_TX_AGC_C_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0x18e8 + #define REG_TX_AGC_D_CCK_11_CCK_1_JAGUAR 0x1a20 + #define REG_TX_AGC_D_OFDM18_OFDM6_JAGUAR 0x1a24 + #define REG_TX_AGC_D_OFDM54_OFDM24_JAGUAR 0x1a28 + #define REG_TX_AGC_D_MCS3_MCS0_JAGUAR 0x1a2c + #define REG_TX_AGC_D_MCS7_MCS4_JAGUAR 0x1a30 + #define REG_TX_AGC_D_MCS11_MCS8_JAGUAR 0x1a34 + #define REG_TX_AGC_D_MCS15_MCS12_JAGUAR 0x1a38 + #define REG_TX_AGC_D_NSS1_INDEX3_NSS1_INDEX0_JAGUAR 0x1a3c + #define REG_TX_AGC_D_NSS1_INDEX7_NSS1_INDEX4_JAGUAR 0x1a40 + #define REG_TX_AGC_D_NSS2_INDEX1_NSS1_INDEX8_JAGUAR 0x1a44 + #define REG_TX_AGC_D_NSS2_INDEX5_NSS2_INDEX2_JAGUAR 0x1a48 + #define REG_TX_AGC_D_NSS2_INDEX9_NSS2_INDEX6_JAGUAR 0x1a4c + #define REG_TX_AGC_D_MCS19_MCS16_JAGUAR 0x1ad8 + #define REG_TX_AGC_D_MCS23_MCS20_JAGUAR 0x1adc + #define REG_TX_AGC_D_NSS3_INDEX3_NSS3_INDEX0_JAGUAR 0x1ae0 + #define REG_TX_AGC_D_NSS3_INDEX7_NSS3_INDEX4_JAGUAR 0x1ae4 + #define REG_TX_AGC_D_NSS3_INDEX9_NSS3_INDEX8_JAGUAR 0x1ae8 + #endif + + #define is_tx_agc_byte0_jaguar 0xff + #define is_tx_agc_byte1_jaguar 0xff00 + #define is_tx_agc_byte2_jaguar 0xff0000 + #define is_tx_agc_byte3_jaguar 0xff000000 +#endif + +#define BIT_FA_RESET BIT(0) + +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + #define REG_OFDM_0_XA_TX_IQ_IMBALANCE 0xC80 + #define REG_OFDM_0_ECCA_THRESHOLD 0xC4C + #define REG_FPGA0_XB_LSSI_READ_BACK 0x8A4 + #define REG_FPGA0_TX_GAIN_STAGE 0x80C + #define REG_OFDM_0_XA_AGC_CORE1 0xC50 + #define REG_OFDM_0_XB_AGC_CORE1 0xC58 + #define REG_A_TX_SCALE_JAGUAR 0xC1C + #define REG_B_TX_SCALE_JAGUAR 0xE1C + + #define REG_AFE_XTAL_CTRL 0x0024 + #define REG_AFE_PLL_CTRL 0x0028 + #define REG_MAC_PHY_CTRL 0x002C + + #define RF_CHNLBW 0x18 +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11ac.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11ac.h index 854ec3c3a4be..40a9b7fbed91 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11ac.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11ac.h @@ -1,94 +1,88 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __ODM_REGDEFINE11AC_H__ -#define __ODM_REGDEFINE11AC_H__ - -//2 RF REG LIST - - - -//2 BB REG LIST -//PAGE 8 -#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 -#define ODM_REG_BB_RX_PATH_11AC 0x808 -#define ODM_REG_BB_TX_PATH_11AC 0x80c -#define ODM_REG_BB_ATC_11AC 0x860 -#define ODM_REG_EDCCA_POWER_CAL 0x8dc -#define ODM_REG_DBG_RPT_11AC 0x8fc -//PAGE 9 -#define ODM_REG_EDCCA_DOWN_OPT 0x900 -#define ODM_REG_ACBB_EDCCA_ENHANCE 0x944 -#define ODM_ADC_TRIGGER_Jaguar2 0x95C /*ADC sample mode*/ -#define ODM_REG_OFDM_FA_RST_11AC 0x9A4 -#define ODM_REG_CCX_PERIOD_11AC 0x990 -#define ODM_REG_NHM_TH9_TH10_11AC 0x994 -#define ODM_REG_CLM_11AC 0x994 -#define ODM_REG_NHM_TH3_TO_TH0_11AC 0x998 -#define ODM_REG_NHM_TH7_TO_TH4_11AC 0x99c -#define ODM_REG_NHM_TH8_11AC 0x9a0 -#define ODM_REG_NHM_9E8_11AC 0x9e8 -#define ODM_REG_CSI_CONTENT_VALUE 0x9b4 -//PAGE A -#define ODM_REG_CCK_CCA_11AC 0xA0A -#define ODM_REG_CCK_FA_RST_11AC 0xA2C -#define ODM_REG_CCK_FA_11AC 0xA5C -//PAGE B -#define ODM_REG_RST_RPT_11AC 0xB58 -//PAGE C -#define ODM_REG_TRMUX_11AC 0xC08 -#define ODM_REG_IGI_A_11AC 0xC50 -//PAGE E -#define ODM_REG_IGI_B_11AC 0xE50 -#define ODM_REG_TRMUX_11AC_B 0xE08 -//PAGE F -#define ODM_REG_CCK_CRC32_CNT_11AC 0xF04 -#define ODM_REG_CCK_CCA_CNT_11AC 0xF08 -#define ODM_REG_VHT_CRC32_CNT_11AC 0xF0c -#define ODM_REG_HT_CRC32_CNT_11AC 0xF10 -#define ODM_REG_OFDM_CRC32_CNT_11AC 0xF14 -#define ODM_REG_OFDM_FA_11AC 0xF48 -#define ODM_REG_RPT_11AC 0xfa0 -#define ODM_REG_CLM_RESULT_11AC 0xfa4 -#define ODM_REG_NHM_CNT_11AC 0xfa8 -#define ODM_REG_NHM_DUR_READY_11AC 0xfb4 - -#define ODM_REG_NHM_CNT7_TO_CNT4_11AC 0xfac -#define ODM_REG_NHM_CNT11_TO_CNT8_11AC 0xfb0 -#define ODM_REG_OFDM_FA_TYPE2_11AC 0xFD0 -//PAGE 18 -#define ODM_REG_IGI_C_11AC 0x1850 -//PAGE 1A -#define ODM_REG_IGI_D_11AC 0x1A50 - -//2 MAC REG LIST -#define ODM_REG_RESP_TX_11AC 0x6D8 - - - -//DIG Related -#define ODM_BIT_IGI_11AC 0xFFFFFFFF -#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT16 -#define ODM_BIT_BB_RX_PATH_11AC 0xF -#define ODM_BIT_BB_TX_PATH_11AC 0xF -#define ODM_BIT_BB_ATC_11AC BIT14 - -#endif - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __ODM_REGDEFINE11AC_H__ +#define __ODM_REGDEFINE11AC_H__ + +/* 2 RF REG LIST */ + + + +/* 2 BB REG LIST + * PAGE 8 */ +#define ODM_REG_CCK_RPT_FORMAT_11AC 0x804 +#define ODM_REG_BB_RX_PATH_11AC 0x808 +#define ODM_REG_BB_TX_PATH_11AC 0x80c +#define ODM_REG_BB_ATC_11AC 0x860 +#define ODM_REG_EDCCA_POWER_CAL 0x8dc +#define ODM_REG_DBG_RPT_11AC 0x8fc +/* PAGE 9 */ +#define ODM_REG_EDCCA_DOWN_OPT 0x900 +#define ODM_REG_ACBB_EDCCA_ENHANCE 0x944 +#define odm_adc_trigger_jaguar2 0x95C /*ADC sample mode*/ +#define ODM_REG_OFDM_FA_RST_11AC 0x9A4 +#define ODM_REG_CCX_PERIOD_11AC 0x990 +#define ODM_REG_NHM_TH9_TH10_11AC 0x994 +#define ODM_REG_CLM_11AC 0x994 +#define ODM_REG_NHM_TH3_TO_TH0_11AC 0x998 +#define ODM_REG_NHM_TH7_TO_TH4_11AC 0x99c +#define ODM_REG_NHM_TH8_11AC 0x9a0 +#define ODM_REG_NHM_9E8_11AC 0x9e8 +#define ODM_REG_CSI_CONTENT_VALUE 0x9b4 +/* PAGE A */ +#define ODM_REG_CCK_CCA_11AC 0xA0A +#define ODM_REG_CCK_FA_RST_11AC 0xA2C +#define ODM_REG_CCK_FA_11AC 0xA5C +/* PAGE B */ +#define ODM_REG_RST_RPT_11AC 0xB58 +/* PAGE C */ +#define ODM_REG_TRMUX_11AC 0xC08 +#define ODM_REG_IGI_A_11AC 0xC50 +/* PAGE E */ +#define ODM_REG_IGI_B_11AC 0xE50 +#define ODM_REG_TRMUX_11AC_B 0xE08 +/* PAGE F */ +#define ODM_REG_CCK_CRC32_CNT_11AC 0xF04 +#define ODM_REG_CCK_CCA_CNT_11AC 0xF08 +#define ODM_REG_VHT_CRC32_CNT_11AC 0xF0c +#define ODM_REG_HT_CRC32_CNT_11AC 0xF10 +#define ODM_REG_OFDM_CRC32_CNT_11AC 0xF14 +#define ODM_REG_OFDM_FA_11AC 0xF48 +#define ODM_REG_RPT_11AC 0xfa0 +#define ODM_REG_CLM_RESULT_11AC 0xfa4 +#define ODM_REG_NHM_CNT_11AC 0xfa8 +#define ODM_REG_NHM_DUR_READY_11AC 0xfb4 + +#define ODM_REG_NHM_CNT7_TO_CNT4_11AC 0xfac +#define ODM_REG_NHM_CNT11_TO_CNT8_11AC 0xfb0 +#define ODM_REG_OFDM_FA_TYPE2_11AC 0xFD0 +/* PAGE 18 */ +#define ODM_REG_IGI_C_11AC 0x1850 +/* PAGE 1A */ +#define ODM_REG_IGI_D_11AC 0x1A50 + +/* 2 MAC REG LIST */ +#define ODM_REG_RESP_TX_11AC 0x6D8 + + + +/* DIG Related */ +#define ODM_BIT_IGI_11AC 0x0000007F +#define ODM_BIT_CCK_RPT_FORMAT_11AC BIT(16) +#define ODM_BIT_BB_RX_PATH_11AC 0xF +#define ODM_BIT_BB_TX_PATH_11AC 0xF +#define ODM_BIT_BB_ATC_11AC BIT(14) + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11n.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11n.h index ec8c6fa0e516..5c24a27c2904 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11n.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_regdefine11n.h @@ -1,213 +1,209 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __ODM_REGDEFINE11N_H__ -#define __ODM_REGDEFINE11N_H__ - - -//2 RF REG LIST -#define ODM_REG_RF_MODE_11N 0x00 -#define ODM_REG_RF_0B_11N 0x0B -#define ODM_REG_CHNBW_11N 0x18 -#define ODM_REG_T_METER_11N 0x24 -#define ODM_REG_RF_25_11N 0x25 -#define ODM_REG_RF_26_11N 0x26 -#define ODM_REG_RF_27_11N 0x27 -#define ODM_REG_RF_2B_11N 0x2B -#define ODM_REG_RF_2C_11N 0x2C -#define ODM_REG_RXRF_A3_11N 0x3C -#define ODM_REG_T_METER_92D_11N 0x42 -#define ODM_REG_T_METER_88E_11N 0x42 - - - -//2 BB REG LIST -//PAGE 8 -#define ODM_REG_BB_CTRL_11N 0x800 -#define ODM_REG_RF_PIN_11N 0x804 -#define ODM_REG_PSD_CTRL_11N 0x808 -#define ODM_REG_TX_ANT_CTRL_11N 0x80C -#define ODM_REG_BB_PWR_SAV5_11N 0x818 -#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 -#define ODM_REG_CCK_RPT_FORMAT_11N_B 0x82C -#define ODM_REG_RX_DEFUALT_A_11N 0x858 -#define ODM_REG_RX_DEFUALT_B_11N 0x85A -#define ODM_REG_BB_PWR_SAV3_11N 0x85C -#define ODM_REG_ANTSEL_CTRL_11N 0x860 -#define ODM_REG_RX_ANT_CTRL_11N 0x864 -#define ODM_REG_PIN_CTRL_11N 0x870 -#define ODM_REG_BB_PWR_SAV1_11N 0x874 -#define ODM_REG_ANTSEL_PATH_11N 0x878 -#define ODM_REG_BB_3WIRE_11N 0x88C -#define ODM_REG_SC_CNT_11N 0x8C4 -#define ODM_REG_PSD_DATA_11N 0x8B4 -#define ODM_REG_CCX_PERIOD_11N 0x894 -#define ODM_REG_NHM_TH9_TH10_11N 0x890 -#define ODM_REG_CLM_11N 0x890 -#define ODM_REG_NHM_TH3_TO_TH0_11N 0x898 -#define ODM_REG_NHM_TH7_TO_TH4_11N 0x89c -#define ODM_REG_NHM_TH8_11N 0xe28 -#define ODM_REG_CLM_READY_11N 0x8b4 -#define ODM_REG_CLM_RESULT_11N 0x8d0 -#define ODM_REG_NHM_CNT_11N 0x8d8 - -// For ACS, Jeffery, 2014-12-26 -#define ODM_REG_NHM_CNT7_TO_CNT4_11N 0x8dc -#define ODM_REG_NHM_CNT9_TO_CNT8_11N 0x8d0 -#define ODM_REG_NHM_CNT10_TO_CNT11_11N 0x8d4 - -//PAGE 9 -#define ODM_REG_BB_CTRL_PAGE9_11N 0x900 -#define ODM_REG_DBG_RPT_11N 0x908 -#define ODM_REG_BB_TX_PATH_11N 0x90c -#define ODM_REG_ANT_MAPPING1_11N 0x914 -#define ODM_REG_ANT_MAPPING2_11N 0x918 -#define ODM_REG_EDCCA_DOWN_OPT_11N 0x948 -#define ODM_REG_RX_DFIR_MOD_97F 0x948 - -//PAGE A -#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 -#define ODM_REG_CCK_ANT_SEL_11N 0xA04 -#define ODM_REG_CCK_CCA_11N 0xA0A -#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C -#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 -#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 -#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 -#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 -#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 -#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 -#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 -#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 -#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 -#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 -#define ODM_REG_CCK_FA_RST_11N 0xA2C -#define ODM_REG_CCK_FA_MSB_11N 0xA58 -#define ODM_REG_CCK_FA_LSB_11N 0xA5C -#define ODM_REG_CCK_CCA_CNT_11N 0xA60 -#define ODM_REG_BB_PWR_SAV4_11N 0xA74 -//PAGE B -#define ODM_REG_LNA_SWITCH_11N 0xB2C -#define ODM_REG_PATH_SWITCH_11N 0xB30 -#define ODM_REG_RSSI_CTRL_11N 0xB38 -#define ODM_REG_CONFIG_ANTA_11N 0xB68 -#define ODM_REG_RSSI_BT_11N 0xB9C -#define ODM_REG_RXCK_RFMOD 0xBB0 -#define ODM_REG_EDCCA_DCNF_97F 0xBC0 - -//PAGE C -#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 -#define ODM_REG_BB_RX_PATH_11N 0xC04 -#define ODM_REG_TRMUX_11N 0xC08 -#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C -#define ODM_REG_DOWNSAM_FACTOR_11N 0xC10 -#define ODM_REG_RXIQI_MATRIX_11N 0xC14 -#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C -#define ODM_REG_IGI_A_11N 0xC50 -#define ODM_REG_ANTDIV_PARA2_11N 0xC54 -#define ODM_REG_IGI_B_11N 0xC58 -#define ODM_REG_ANTDIV_PARA3_11N 0xC5C -#define ODM_REG_L1SBD_PD_CH_11N 0XC6C -#define ODM_REG_BB_PWR_SAV2_11N 0xC70 -#define ODM_REG_BB_AGC_SET_2_11N 0xc74 -#define ODM_REG_RX_OFF_11N 0xC7C -#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 -#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 -#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 -#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C -#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 -#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 -#define ODM_REG_SMALL_BANDWIDTH_11N 0xCE4 -#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 -//PAGE D -#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 -#define ODM_REG_BB_RX_ANT_11N 0xD04 -#define ODM_REG_BB_ATC_11N 0xD2C -#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 -#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 -#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 -#define ODM_REG_RPT_11N 0xDF4 -//PAGE E -#define ODM_REG_TXAGC_A_6_18_11N 0xE00 -#define ODM_REG_TXAGC_A_24_54_11N 0xE04 -#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 -#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 -#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 -#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 -#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C -#define ODM_REG_EDCCA_DCNF_11N 0xE24 -#define ODM_REG_TAP_UPD_97F 0xE24 -#define ODM_REG_FPGA0_IQK_11N 0xE28 -#define ODM_REG_PAGE_B1_97F 0xE28 -#define ODM_REG_TXIQK_TONE_A_11N 0xE30 -#define ODM_REG_RXIQK_TONE_A_11N 0xE34 -#define ODM_REG_TXIQK_PI_A_11N 0xE38 -#define ODM_REG_RXIQK_PI_A_11N 0xE3C -#define ODM_REG_TXIQK_11N 0xE40 -#define ODM_REG_RXIQK_11N 0xE44 -#define ODM_REG_IQK_AGC_PTS_11N 0xE48 -#define ODM_REG_IQK_AGC_RSP_11N 0xE4C -#define ODM_REG_BLUETOOTH_11N 0xE6C -#define ODM_REG_RX_WAIT_CCA_11N 0xE70 -#define ODM_REG_TX_CCK_RFON_11N 0xE74 -#define ODM_REG_TX_CCK_BBON_11N 0xE78 -#define ODM_REG_OFDM_RFON_11N 0xE7C -#define ODM_REG_OFDM_BBON_11N 0xE80 -#define ODM_REG_TX2RX_11N 0xE84 -#define ODM_REG_TX2TX_11N 0xE88 -#define ODM_REG_RX_CCK_11N 0xE8C -#define ODM_REG_RX_OFDM_11N 0xED0 -#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 -#define ODM_REG_RX2RX_11N 0xED8 -#define ODM_REG_STANDBY_11N 0xEDC -#define ODM_REG_SLEEP_11N 0xEE0 -#define ODM_REG_PMPD_ANAEN_11N 0xEEC -/* PAGE F */ -#define ODM_REG_PAGE_F_RST_11N 0xF14 -#define ODM_REG_IGI_C_11N 0xF84 -#define ODM_REG_IGI_D_11N 0xF88 -#define ODM_REG_CCK_CRC32_ERROR_CNT_11N 0xF84 -#define ODM_REG_CCK_CRC32_OK_CNT_11N 0xF88 -#define ODM_REG_HT_CRC32_CNT_11N 0xF90 -#define ODM_REG_OFDM_CRC32_CNT_11N 0xF94 - -//2 MAC REG LIST -#define ODM_REG_BB_RST_11N 0x02 -#define ODM_REG_ANTSEL_PIN_11N 0x4C -#define ODM_REG_EARLY_MODE_11N 0x4D0 -#define ODM_REG_RSSI_MONITOR_11N 0x4FE -#define ODM_REG_EDCA_VO_11N 0x500 -#define ODM_REG_EDCA_VI_11N 0x504 -#define ODM_REG_EDCA_BE_11N 0x508 -#define ODM_REG_EDCA_BK_11N 0x50C -#define ODM_REG_TXPAUSE_11N 0x522 -#define ODM_REG_RESP_TX_11N 0x6D8 -#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 -#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 - - -//DIG Related -#define ODM_BIT_IGI_11N 0x0000007F -#define ODM_BIT_CCK_RPT_FORMAT_11N BIT9 -#define ODM_BIT_BB_RX_PATH_11N 0xF -#define ODM_BIT_BB_TX_PATH_11N 0xF -#define ODM_BIT_BB_ATC_11N BIT11 - -#endif - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __ODM_REGDEFINE11N_H__ +#define __ODM_REGDEFINE11N_H__ + + +/* 2 RF REG LIST */ +#define ODM_REG_RF_MODE_11N 0x00 +#define ODM_REG_RF_0B_11N 0x0B +#define ODM_REG_CHNBW_11N 0x18 +#define ODM_REG_T_METER_11N 0x24 +#define ODM_REG_RF_25_11N 0x25 +#define ODM_REG_RF_26_11N 0x26 +#define ODM_REG_RF_27_11N 0x27 +#define ODM_REG_RF_2B_11N 0x2B +#define ODM_REG_RF_2C_11N 0x2C +#define ODM_REG_RXRF_A3_11N 0x3C +#define ODM_REG_T_METER_92D_11N 0x42 +#define ODM_REG_T_METER_88E_11N 0x42 + + + +/* 2 BB REG LIST + * PAGE 8 */ +#define ODM_REG_BB_CTRL_11N 0x800 +#define ODM_REG_RF_PIN_11N 0x804 +#define ODM_REG_PSD_CTRL_11N 0x808 +#define ODM_REG_TX_ANT_CTRL_11N 0x80C +#define ODM_REG_BB_PWR_SAV5_11N 0x818 +#define ODM_REG_CCK_RPT_FORMAT_11N 0x824 +#define ODM_REG_CCK_RPT_FORMAT_11N_B 0x82C +#define ODM_REG_RX_DEFUALT_A_11N 0x858 +#define ODM_REG_RX_DEFUALT_B_11N 0x85A +#define ODM_REG_BB_PWR_SAV3_11N 0x85C +#define ODM_REG_ANTSEL_CTRL_11N 0x860 +#define ODM_REG_RX_ANT_CTRL_11N 0x864 +#define ODM_REG_PIN_CTRL_11N 0x870 +#define ODM_REG_BB_PWR_SAV1_11N 0x874 +#define ODM_REG_ANTSEL_PATH_11N 0x878 +#define ODM_REG_BB_3WIRE_11N 0x88C +#define ODM_REG_SC_CNT_11N 0x8C4 +#define ODM_REG_PSD_DATA_11N 0x8B4 +#define ODM_REG_CCX_PERIOD_11N 0x894 +#define ODM_REG_NHM_TH9_TH10_11N 0x890 +#define ODM_REG_CLM_11N 0x890 +#define ODM_REG_NHM_TH3_TO_TH0_11N 0x898 +#define ODM_REG_NHM_TH7_TO_TH4_11N 0x89c +#define ODM_REG_NHM_TH8_11N 0xe28 +#define ODM_REG_CLM_READY_11N 0x8b4 +#define ODM_REG_CLM_RESULT_11N 0x8d0 +#define ODM_REG_NHM_CNT_11N 0x8d8 + +/* For struct _ACS_, Jeffery, 2014-12-26 */ +#define ODM_REG_NHM_CNT7_TO_CNT4_11N 0x8dc +#define ODM_REG_NHM_CNT9_TO_CNT8_11N 0x8d0 +#define ODM_REG_NHM_CNT10_TO_CNT11_11N 0x8d4 + +/* PAGE 9 */ +#define ODM_REG_BB_CTRL_PAGE9_11N 0x900 +#define ODM_REG_DBG_RPT_11N 0x908 +#define ODM_REG_BB_TX_PATH_11N 0x90c +#define ODM_REG_ANT_MAPPING1_11N 0x914 +#define ODM_REG_ANT_MAPPING2_11N 0x918 +#define ODM_REG_EDCCA_DOWN_OPT_11N 0x948 +#define ODM_REG_RX_DFIR_MOD_97F 0x948 +#define ODM_REG_SOML_97F 0x998 + +/* PAGE A */ +#define ODM_REG_CCK_ANTDIV_PARA1_11N 0xA00 +#define ODM_REG_CCK_ANT_SEL_11N 0xA04 +#define ODM_REG_CCK_CCA_11N 0xA0A +#define ODM_REG_CCK_ANTDIV_PARA2_11N 0xA0C +#define ODM_REG_CCK_ANTDIV_PARA3_11N 0xA10 +#define ODM_REG_CCK_ANTDIV_PARA4_11N 0xA14 +#define ODM_REG_CCK_FILTER_PARA1_11N 0xA22 +#define ODM_REG_CCK_FILTER_PARA2_11N 0xA23 +#define ODM_REG_CCK_FILTER_PARA3_11N 0xA24 +#define ODM_REG_CCK_FILTER_PARA4_11N 0xA25 +#define ODM_REG_CCK_FILTER_PARA5_11N 0xA26 +#define ODM_REG_CCK_FILTER_PARA6_11N 0xA27 +#define ODM_REG_CCK_FILTER_PARA7_11N 0xA28 +#define ODM_REG_CCK_FILTER_PARA8_11N 0xA29 +#define ODM_REG_CCK_FA_RST_11N 0xA2C +#define ODM_REG_CCK_FA_MSB_11N 0xA58 +#define ODM_REG_CCK_FA_LSB_11N 0xA5C +#define ODM_REG_CCK_CCA_CNT_11N 0xA60 +#define ODM_REG_BB_PWR_SAV4_11N 0xA74 +/* PAGE B */ +#define ODM_REG_LNA_SWITCH_11N 0xB2C +#define ODM_REG_PATH_SWITCH_11N 0xB30 +#define ODM_REG_RSSI_CTRL_11N 0xB38 +#define ODM_REG_CONFIG_ANTA_11N 0xB68 +#define ODM_REG_RSSI_BT_11N 0xB9C +#define ODM_REG_RXCK_RFMOD 0xBB0 +#define ODM_REG_EDCCA_DCNF_97F 0xBC0 + +/* PAGE C */ +#define ODM_REG_OFDM_FA_HOLDC_11N 0xC00 +#define ODM_REG_BB_RX_PATH_11N 0xC04 +#define ODM_REG_TRMUX_11N 0xC08 +#define ODM_REG_OFDM_FA_RSTC_11N 0xC0C +#define ODM_REG_DOWNSAM_FACTOR_11N 0xC10 +#define ODM_REG_RXIQI_MATRIX_11N 0xC14 +#define ODM_REG_TXIQK_MATRIX_LSB1_11N 0xC4C +#define ODM_REG_IGI_A_11N 0xC50 +#define ODM_REG_ANTDIV_PARA2_11N 0xC54 +#define ODM_REG_IGI_B_11N 0xC58 +#define ODM_REG_ANTDIV_PARA3_11N 0xC5C +#define ODM_REG_L1SBD_PD_CH_11N 0XC6C +#define ODM_REG_BB_PWR_SAV2_11N 0xC70 +#define ODM_REG_BB_AGC_SET_2_11N 0xc74 +#define ODM_REG_RX_OFF_11N 0xC7C +#define ODM_REG_TXIQK_MATRIXA_11N 0xC80 +#define ODM_REG_TXIQK_MATRIXB_11N 0xC88 +#define ODM_REG_TXIQK_MATRIXA_LSB2_11N 0xC94 +#define ODM_REG_TXIQK_MATRIXB_LSB2_11N 0xC9C +#define ODM_REG_RXIQK_MATRIX_LSB_11N 0xCA0 +#define ODM_REG_ANTDIV_PARA1_11N 0xCA4 +#define ODM_REG_SMALL_BANDWIDTH_11N 0xCE4 +#define ODM_REG_OFDM_FA_TYPE1_11N 0xCF0 +/* PAGE D */ +#define ODM_REG_OFDM_FA_RSTD_11N 0xD00 +#define ODM_REG_BB_RX_ANT_11N 0xD04 +#define ODM_REG_BB_ATC_11N 0xD2C +#define ODM_REG_OFDM_FA_TYPE2_11N 0xDA0 +#define ODM_REG_OFDM_FA_TYPE3_11N 0xDA4 +#define ODM_REG_OFDM_FA_TYPE4_11N 0xDA8 +#define ODM_REG_RPT_11N 0xDF4 +/* PAGE E */ +#define ODM_REG_TXAGC_A_6_18_11N 0xE00 +#define ODM_REG_TXAGC_A_24_54_11N 0xE04 +#define ODM_REG_TXAGC_A_1_MCS32_11N 0xE08 +#define ODM_REG_TXAGC_A_MCS0_3_11N 0xE10 +#define ODM_REG_TXAGC_A_MCS4_7_11N 0xE14 +#define ODM_REG_TXAGC_A_MCS8_11_11N 0xE18 +#define ODM_REG_TXAGC_A_MCS12_15_11N 0xE1C +#define ODM_REG_EDCCA_DCNF_11N 0xE24 +#define ODM_REG_TAP_UPD_97F 0xE24 +#define ODM_REG_FPGA0_IQK_11N 0xE28 +#define ODM_REG_PAGE_B1_97F 0xE28 +#define ODM_REG_TXIQK_TONE_A_11N 0xE30 +#define ODM_REG_RXIQK_TONE_A_11N 0xE34 +#define ODM_REG_TXIQK_PI_A_11N 0xE38 +#define ODM_REG_RXIQK_PI_A_11N 0xE3C +#define ODM_REG_TXIQK_11N 0xE40 +#define ODM_REG_RXIQK_11N 0xE44 +#define ODM_REG_IQK_AGC_PTS_11N 0xE48 +#define ODM_REG_IQK_AGC_RSP_11N 0xE4C +#define ODM_REG_BLUETOOTH_11N 0xE6C +#define ODM_REG_RX_WAIT_CCA_11N 0xE70 +#define ODM_REG_TX_CCK_RFON_11N 0xE74 +#define ODM_REG_TX_CCK_BBON_11N 0xE78 +#define ODM_REG_OFDM_RFON_11N 0xE7C +#define ODM_REG_OFDM_BBON_11N 0xE80 +#define ODM_REG_TX2RX_11N 0xE84 +#define ODM_REG_TX2TX_11N 0xE88 +#define ODM_REG_RX_CCK_11N 0xE8C +#define ODM_REG_RX_OFDM_11N 0xED0 +#define ODM_REG_RX_WAIT_RIFS_11N 0xED4 +#define ODM_REG_RX2RX_11N 0xED8 +#define ODM_REG_STANDBY_11N 0xEDC +#define ODM_REG_SLEEP_11N 0xEE0 +#define ODM_REG_PMPD_ANAEN_11N 0xEEC +/* PAGE F */ +#define ODM_REG_PAGE_F_RST_11N 0xF14 +#define ODM_REG_IGI_C_11N 0xF84 +#define ODM_REG_IGI_D_11N 0xF88 +#define ODM_REG_CCK_CRC32_ERROR_CNT_11N 0xF84 +#define ODM_REG_CCK_CRC32_OK_CNT_11N 0xF88 +#define ODM_REG_HT_CRC32_CNT_11N 0xF90 +#define ODM_REG_OFDM_CRC32_CNT_11N 0xF94 +#define ODM_REG_HT_CRC32_CNT_11N_AGG 0xFB8 + +/* 2 MAC REG LIST */ +#define ODM_REG_BB_RST_11N 0x02 +#define ODM_REG_ANTSEL_PIN_11N 0x4C +#define ODM_REG_EARLY_MODE_11N 0x4D0 +#define ODM_REG_RSSI_MONITOR_11N 0x4FE +#define ODM_REG_EDCA_VO_11N 0x500 +#define ODM_REG_EDCA_VI_11N 0x504 +#define ODM_REG_EDCA_BE_11N 0x508 +#define ODM_REG_EDCA_BK_11N 0x50C +#define ODM_REG_TXPAUSE_11N 0x522 +#define ODM_REG_RESP_TX_11N 0x6D8 +#define ODM_REG_ANT_TRAIN_PARA1_11N 0x7b0 +#define ODM_REG_ANT_TRAIN_PARA2_11N 0x7b4 + + +/* DIG Related */ +#define ODM_BIT_IGI_11N 0x0000007F +#define ODM_BIT_CCK_RPT_FORMAT_11N BIT(9) +#define ODM_BIT_BB_RX_PATH_11N 0xF +#define ODM_BIT_BB_TX_PATH_11N 0xF +#define ODM_BIT_BB_ATC_11N BIT(11) + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.c new file mode 100644 index 000000000000..1a1f6b01751a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.c @@ -0,0 +1,459 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +#ifdef PHYDM_SUPPORT_RSSI_MONITOR + +#ifdef PHYDM_3RD_REFORM_RSSI_MONOTOR +void +phydm_rssi_monitor_h2c( + void *p_dm_void, + u8 macid +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_t = &p_dm->dm_ra_table; + struct cmn_sta_info *p_sta = p_dm->p_phydm_sta_info[macid]; + struct ra_sta_info *p_ra = NULL; + u8 h2c_val[H2C_MAX_LENGTH] = {0}; + u8 stbc_en, ldpc_en; + u8 bf_en = 0; + u8 is_rx, is_tx; + + if (is_sta_active(p_sta)) { + p_ra = &(p_sta->ra_info); + } else { + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("[Warning] %s invalid sta_info\n", __func__)); + return; + } + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("%s ======>\n", __func__)); + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("MACID=%d\n", p_sta->mac_id)); + + is_rx = (p_ra->txrx_state == RX_STATE) ? 1 : 0; + is_tx = (p_ra->txrx_state == TX_STATE) ? 1 : 0; + stbc_en = (p_sta->stbc_en) ? 1 : 0; + ldpc_en = (p_sta->ldpc_en) ? 1 : 0; + + #ifdef CONFIG_BEAMFORMING + if ((p_sta->bf_info.ht_beamform_cap & BEAMFORMING_HT_BEAMFORMEE_ENABLE) || + (p_sta->bf_info.vht_beamform_cap & BEAMFORMING_VHT_BEAMFORMEE_ENABLE)) { + bf_en = 1; + } + #endif + + if (p_ra_t->RA_threshold_offset != 0) { + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RA_th_ofst = (( %s%d ))\n", + ((p_ra_t->RA_offset_direction) ? "+" : "-"), p_ra_t->RA_threshold_offset)); + } + + h2c_val[0] = p_sta->mac_id; + h2c_val[1] = 0; + h2c_val[2] = p_sta->rssi_stat.rssi; + h2c_val[3] = is_rx | (stbc_en << 1) | ((p_dm->noisy_decision & 0x1) << 2) | (bf_en << 6); + h2c_val[4] = (p_ra_t->RA_threshold_offset & 0x7f) | ((p_ra_t->RA_offset_direction & 0x1) << 7); + h2c_val[5] = 0; + h2c_val[6] = 0; + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("PHYDM h2c[0x42]=0x%x %x %x %x %x %x %x\n", + h2c_val[6], h2c_val[5], h2c_val[4], h2c_val[3], h2c_val[2], h2c_val[1], h2c_val[0])); + + #if (RTL8188E_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8188E) + odm_ra_set_rssi_8188e(p_dm, (u8)(p_sta->mac_id & 0xFF), p_sta->rssi_stat.rssi & 0x7F); + else + #endif + { + odm_fill_h2c_cmd(p_dm, ODM_H2C_RSSI_REPORT, H2C_MAX_LENGTH, h2c_val); + } +} + +void +phydm_calculate_rssi_min_max( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct cmn_sta_info *p_sta; + s8 rssi_max_tmp = 0, rssi_min_tmp = 100; + u8 i; + u8 sta_cnt = 0; + + if (!p_dm->is_linked) + return; + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("%s ======>\n", __func__)); + + for (i = 0; i < ODM_ASSOCIATE_ENTRY_NUM; i++) { + p_sta = p_dm->p_phydm_sta_info[i]; + if (is_sta_active(p_sta)) { + + sta_cnt++; + + if (p_sta->rssi_stat.rssi < rssi_min_tmp) + rssi_min_tmp = p_sta->rssi_stat.rssi; + + if (p_sta->rssi_stat.rssi > rssi_max_tmp) + rssi_max_tmp = p_sta->rssi_stat.rssi; + + /*[Send RSSI to FW]*/ + if (p_sta->ra_info.disable_ra == false) + phydm_rssi_monitor_h2c(p_dm, i); + + if (sta_cnt == p_dm->number_linked_client) + break; + } + } + + p_dm->rssi_max = (u8)rssi_max_tmp; + p_dm->rssi_min = (u8)rssi_min_tmp; + +} +#endif + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +s32 +phydm_find_minimum_rssi( + struct PHY_DM_STRUCT *p_dm, + struct _ADAPTER *p_adapter, + boolean *p_is_link_temp + +) +{ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + PMGNT_INFO p_mgnt_info = &(p_adapter->MgntInfo); + boolean act_as_ap = ACTING_AS_AP(p_adapter); + + /* 1.Determine the minimum RSSI */ + if ((!p_mgnt_info->bMediaConnect) || + (act_as_ap && (p_hal_data->EntryMinUndecoratedSmoothedPWDB == 0))) {/* We should check AP mode and Entry info.into consideration, revised by Roger, 2013.10.18*/ + + p_hal_data->MinUndecoratedPWDBForDM = 0; + *p_is_link_temp = false; + + } else + *p_is_link_temp = true; + + + if (p_mgnt_info->bMediaConnect) { /* Default port*/ + + if (act_as_ap || p_mgnt_info->mIbss) { + p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->EntryMinUndecoratedSmoothedPWDB; + /**/ + } else { + p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->UndecoratedSmoothedPWDB; + /**/ + } + } else { /* associated entry pwdb*/ + p_hal_data->MinUndecoratedPWDBForDM = p_hal_data->EntryMinUndecoratedSmoothedPWDB; + /**/ + } + + return p_hal_data->MinUndecoratedPWDBForDM; +} + +void +odm_rssi_monitor_check_mp( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + u8 h2c_parameter[H2C_0X42_LENGTH] = {0}; + u32 i; + boolean is_ext_ra_info = true; + u8 cmdlen = H2C_0X42_LENGTH; + u8 tx_bf_en = 0, stbc_en = 0; + + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct sta_info *p_entry = NULL; + s32 tmp_entry_max_pwdb = 0, tmp_entry_min_pwdb = 0xff; + PMGNT_INFO p_mgnt_info = &adapter->MgntInfo; + PMGNT_INFO p_default_mgnt_info = &adapter->MgntInfo; + u64 cur_tx_ok_cnt = 0, cur_rx_ok_cnt = 0; +#if (BEAMFORMING_SUPPORT == 1) +#ifndef BEAMFORMING_VERSION_1 + enum beamforming_cap beamform_cap = BEAMFORMING_CAP_NONE; +#endif +#endif + struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(adapter); + + if (p_dm->support_ic_type == ODM_RTL8188E) { + is_ext_ra_info = false; + cmdlen = 3; + } + + while (p_loop_adapter) { + + if (p_loop_adapter != NULL) { + p_mgnt_info = &p_loop_adapter->MgntInfo; + cur_tx_ok_cnt = p_loop_adapter->TxStats.NumTxBytesUnicast - p_mgnt_info->lastTxOkCnt; + cur_rx_ok_cnt = p_loop_adapter->RxStats.NumRxBytesUnicast - p_mgnt_info->lastRxOkCnt; + p_mgnt_info->lastTxOkCnt = cur_tx_ok_cnt; + p_mgnt_info->lastRxOkCnt = cur_rx_ok_cnt; + } + + for (i = 0; i < ASSOCIATE_ENTRY_NUM; i++) { + + if (IsAPModeExist(p_loop_adapter)) { + if (GetFirstExtAdapter(p_loop_adapter) != NULL && + GetFirstExtAdapter(p_loop_adapter) == p_loop_adapter) + p_entry = AsocEntry_EnumStation(p_loop_adapter, i); + else if (GetFirstGOPort(p_loop_adapter) != NULL && + IsFirstGoAdapter(p_loop_adapter)) + p_entry = AsocEntry_EnumStation(p_loop_adapter, i); + } else { + if (GetDefaultAdapter(p_loop_adapter) == p_loop_adapter) + p_entry = AsocEntry_EnumStation(p_loop_adapter, i); + } + + if (p_entry != NULL) { + if (p_entry->bAssociated) { + + RT_DISP_ADDR(FDM, DM_PWDB, ("p_entry->mac_addr ="), GET_STA_INFO(p_entry).mac_addr); + RT_DISP(FDM, DM_PWDB, ("p_entry->rssi = 0x%x(%d)\n", + GET_STA_INFO(p_entry).rssi_stat.rssi, GET_STA_INFO(p_entry).rssi_stat.rssi)); + + /* 2 BF_en */ +#if (BEAMFORMING_SUPPORT == 1) +#ifndef BEAMFORMING_VERSION_1 + beamform_cap = phydm_beamforming_get_entry_beam_cap_by_mac_id(p_dm, GET_STA_INFO(p_entry).mac_id); + if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) + tx_bf_en = 1; +#else + if (Beamform_GetSupportBeamformerCap(GetDefaultAdapter(adapter), p_entry)) + tx_bf_en = 1; +#endif +#endif + /* 2 STBC_en */ + if ((IS_WIRELESS_MODE_AC(adapter) && TEST_FLAG(p_entry->VHTInfo.STBC, STBC_VHT_ENABLE_TX)) || + TEST_FLAG(p_entry->HTInfo.STBC, STBC_HT_ENABLE_TX)) + stbc_en = 1; + + if (GET_STA_INFO(p_entry).rssi_stat.rssi < tmp_entry_min_pwdb) + tmp_entry_min_pwdb = GET_STA_INFO(p_entry).rssi_stat.rssi; + if (GET_STA_INFO(p_entry).rssi_stat.rssi > tmp_entry_max_pwdb) + tmp_entry_max_pwdb = GET_STA_INFO(p_entry).rssi_stat.rssi; + + h2c_parameter[4] = (p_ra_table->RA_threshold_offset & 0x7f) | (p_ra_table->RA_offset_direction << 7); + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RA_threshold_offset = (( %s%d ))\n", ((p_ra_table->RA_threshold_offset == 0) ? " " : ((p_ra_table->RA_offset_direction) ? "+" : "-")), p_ra_table->RA_threshold_offset)); + + if (is_ext_ra_info) { + if (cur_rx_ok_cnt > (cur_tx_ok_cnt * 6)) + h2c_parameter[3] |= RAINFO_BE_RX_STATE; + + if (tx_bf_en) + h2c_parameter[3] |= RAINFO_BF_STATE; + else { + if (stbc_en) + h2c_parameter[3] |= RAINFO_STBC_STATE; + } + + if (p_dm->noisy_decision) + h2c_parameter[3] |= RAINFO_NOISY_STATE; + else + h2c_parameter[3] &= (~RAINFO_NOISY_STATE); + + if (p_dm->h2c_rarpt_connect) { + h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("h2c_rarpt_connect = (( %d ))\n", p_dm->h2c_rarpt_connect)); + } + + } + + h2c_parameter[2] = (u8)(GET_STA_INFO(p_entry).rssi_stat.rssi & 0xFF); + /* h2c_parameter[1] = 0x20;*/ /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1 */ + h2c_parameter[0] = (GET_STA_INFO(p_entry).mac_id); + + odm_fill_h2c_cmd(p_dm, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter); + } + } else + break; + } + + p_loop_adapter = GetNextExtAdapter(p_loop_adapter); + } + + + /*Default port*/ + if (tmp_entry_max_pwdb != 0) { /* If associated entry is found */ + p_hal_data->EntryMaxUndecoratedSmoothedPWDB = tmp_entry_max_pwdb; + RT_DISP(FDM, DM_PWDB, ("EntryMaxPWDB = 0x%x(%d)\n", tmp_entry_max_pwdb, tmp_entry_max_pwdb)); + } else + p_hal_data->EntryMaxUndecoratedSmoothedPWDB = 0; + + if (tmp_entry_min_pwdb != 0xff) { /* If associated entry is found */ + p_hal_data->EntryMinUndecoratedSmoothedPWDB = tmp_entry_min_pwdb; + RT_DISP(FDM, DM_PWDB, ("EntryMinPWDB = 0x%x(%d)\n", tmp_entry_min_pwdb, tmp_entry_min_pwdb)); + + } else + p_hal_data->EntryMinUndecoratedSmoothedPWDB = 0; + + /* Default porti sent RSSI to FW */ + if (p_hal_data->bUseRAMask) { + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("1 RA First Link, RSSI[%d] = ((%d)) , ra_rpt_linked = ((%d))\n", + WIN_DEFAULT_PORT_MACID, p_hal_data->UndecoratedSmoothedPWDB, p_hal_data->ra_rpt_linked)); + if (p_hal_data->UndecoratedSmoothedPWDB > 0) { + + PRT_HIGH_THROUGHPUT p_ht_info = GET_HT_INFO(p_default_mgnt_info); + PRT_VERY_HIGH_THROUGHPUT p_vht_info = GET_VHT_INFO(p_default_mgnt_info); + + /* BF_en*/ +#if (BEAMFORMING_SUPPORT == 1) +#ifndef BEAMFORMING_VERSION_1 + beamform_cap = phydm_beamforming_get_entry_beam_cap_by_mac_id(p_dm, p_default_mgnt_info->m_mac_id); + + if (beamform_cap & (BEAMFORMER_CAP_HT_EXPLICIT | BEAMFORMER_CAP_VHT_SU)) + tx_bf_en = 1; +#else + if (Beamform_GetSupportBeamformerCap(GetDefaultAdapter(adapter), NULL)) + tx_bf_en = 1; +#endif +#endif + + /* STBC_en*/ + if ((IS_WIRELESS_MODE_AC(adapter) && TEST_FLAG(p_vht_info->VhtCurStbc, STBC_VHT_ENABLE_TX)) || + TEST_FLAG(p_ht_info->HtCurStbc, STBC_HT_ENABLE_TX)) + stbc_en = 1; + + h2c_parameter[4] = (p_ra_table->RA_threshold_offset & 0x7f) | (p_ra_table->RA_offset_direction << 7); + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RA_threshold_offset = (( %s%d ))\n", ((p_ra_table->RA_threshold_offset == 0) ? " " : ((p_ra_table->RA_offset_direction) ? "+" : "-")), p_ra_table->RA_threshold_offset)); + + if (is_ext_ra_info) { + if (tx_bf_en) + h2c_parameter[3] |= RAINFO_BF_STATE; + else { + if (stbc_en) + h2c_parameter[3] |= RAINFO_STBC_STATE; + } + + if (p_dm->h2c_rarpt_connect) { + h2c_parameter[3] |= RAINFO_INIT_RSSI_RATE_STATE; + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("h2c_rarpt_connect = (( %d ))\n", p_dm->h2c_rarpt_connect)); + } + + + if (p_dm->noisy_decision == 1) { + h2c_parameter[3] |= RAINFO_NOISY_STATE; + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("[RSSIMonitorCheckMP] Send H2C to FW\n")); + } else + h2c_parameter[3] &= (~RAINFO_NOISY_STATE); + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("[RSSIMonitorCheckMP] h2c_parameter=%x\n", h2c_parameter[3])); + } + + h2c_parameter[2] = (u8)(p_hal_data->UndecoratedSmoothedPWDB & 0xFF); + /*h2c_parameter[1] = 0x20;*/ /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ + h2c_parameter[0] = WIN_DEFAULT_PORT_MACID; /* fw v12 cmdid 5:use max macid ,for nic ,default macid is 0 ,max macid is 1*/ + + odm_fill_h2c_cmd(p_dm, ODM_H2C_RSSI_REPORT, cmdlen, h2c_parameter); + } + + } else + PlatformEFIOWrite1Byte(adapter, 0x4fe, (u8)p_hal_data->UndecoratedSmoothedPWDB); + + { + struct _ADAPTER *p_loop_adapter = GetDefaultAdapter(adapter); + boolean default_pointer_value, *p_is_link_temp = &default_pointer_value; + s32 global_rssi_min = 0xFF, local_rssi_min; + boolean is_link = false; + + while (p_loop_adapter) { + local_rssi_min = phydm_find_minimum_rssi(p_dm, p_loop_adapter, p_is_link_temp); + /* dbg_print("p_hal_data->is_linked=%d, local_rssi_min=%d\n", p_hal_data->is_linked, local_rssi_min); */ + + if (*p_is_link_temp) + is_link = true; + + if ((local_rssi_min < global_rssi_min) && (*p_is_link_temp)) + global_rssi_min = local_rssi_min; + + p_loop_adapter = GetNextExtAdapter(p_loop_adapter); + } + + p_hal_data->bLinked = is_link; + + p_dm->is_linked = is_link; + p_dm->rssi_min = (u8)((is_link) ? global_rssi_min : 0); + + } + + +} + +#endif + +void +phydm_rssi_monitor_check( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (!(p_dm->support_ability & ODM_BB_RSSI_MONITOR)) + return; + + if ((p_dm->phydm_sys_up_time % 2) == 1) /*for AP watchdog period = 1 sec*/ + return; + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("%s ======>\n", __func__)); + +#ifdef PHYDM_3RD_REFORM_RSSI_MONOTOR + phydm_calculate_rssi_min_max(p_dm); +#else + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + odm_rssi_monitor_check_mp(p_dm); + #endif +#endif + + PHYDM_DBG(p_dm, DBG_RSSI_MNTR, ("RSSI {max, min} = {%d, %d}\n", + p_dm->rssi_max, p_dm->rssi_min)); + +} + +void +phydm_rssi_monitor_init( + void *p_dm_void +) +{ + + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; +#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + p_ra_table->PT_collision_pre = true; /*used in odm_dynamic_arfb_select(WIN only)*/ + + p_hal_data->UndecoratedSmoothedPWDB = -1; + p_hal_data->ra_rpt_linked = false; +#endif + + p_ra_table->firstconnect = false; + p_dm->rssi_max = 0; + p_dm->rssi_min = 0; + +} + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.h new file mode 100644 index 000000000000..9aef3cc6f1b9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_rssi_monitor.h @@ -0,0 +1,65 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + + +#ifndef __PHYDM_RSSI_MONITOR_H__ +#define __PHYDM_RSSI_MONITOR_H__ + +#define RSSI_MONITOR_VERSION "1.0" /* 2017.05.011 Dino, Add phydm_rssi_monitor.h*/ + + +/* 1 ============================================================ + * 1 Definition + * 1 ============================================================ */ + +#define H2C_0X42_LENGTH 5 + +#define RAINFO_BE_RX_STATE BIT(0) /* 1:RX*/ /* ULDL */ +#define RAINFO_STBC_STATE BIT(1) +#define RAINFO_NOISY_STATE BIT(2) /* set by Noisy_Detection */ +/*#define RAINFO_SHURTCUT_STATE BIT(3)*/ +/*#define RAINFO_SHURTCUT_FLAG BIT(4)*/ +#define RAINFO_INIT_RSSI_RATE_STATE BIT(5) +#define RAINFO_BF_STATE BIT(6) +#define RAINFO_BE_TX_STATE BIT(7) /* 1:TX */ + +/* 1 ============================================================ + * 1 structure + * 1 ============================================================ */ + + + + +/* 1 ============================================================ + * 1 enumeration + * 1 ============================================================ */ + + + +/* 1 ============================================================ + * 1 function prototype + * 1 ============================================================ */ + +void +phydm_rssi_monitor_check( + void *p_dm_void +); + +void +phydm_rssi_monitor_init( + void *p_dm_void +); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.c new file mode 100644 index 000000000000..ec8a9a870785 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.c @@ -0,0 +1,2154 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +/* ****************************************************** + * when antenna test utility is on or some testing need to disable antenna diversity + * call this function to disable all ODM related mechanisms which will switch antenna. + * ****************************************************** */ +#if (defined(CONFIG_SMART_ANTENNA)) +#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) +void +phydm_cumitek_smt_ant_mapping_table_8822b( + void *p_dm_void, + u8 *table_path_a, + u8 *table_path_b +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 path_a_0to3_idx = 0; + u32 path_b_0to3_idx = 0; + u32 path_a_4to7_idx = 0; + u32 path_b_4to7_idx = 0; + + path_a_0to3_idx = ((table_path_a[3] & 0xf) << 24) | ((table_path_a[2] & 0xf) << 16) + | ((table_path_a[1] & 0xf) << 8) | (table_path_a[0] & 0xf); + + path_b_0to3_idx = ((table_path_b[3] & 0xf) << 28) | ((table_path_b[2] & 0xf) << 20) + | ((table_path_b[1] & 0xf) << 12) | ((table_path_b[0] & 0xf) << 4); + + path_a_4to7_idx = ((table_path_a[7] & 0xf) << 24) | ((table_path_a[6] & 0xf) << 16) + | ((table_path_a[5] & 0xf) << 8) | (table_path_a[4] & 0xf); + + path_b_4to7_idx = ((table_path_b[7] & 0xf) << 28) | ((table_path_b[6] & 0xf) << 20) + | ((table_path_b[5] & 0xf) << 12) | ((table_path_b[4] & 0xf) << 4); + + + /*PHYDM_DBG(p_dm, DBG_SMT_ANT, ("mapping table{A, B} = {0x%x, 0x%x}\n", path_a_0to3_idx, path_b_0to3_idx));*/ + + /*pathA*/ + odm_set_bb_reg(p_dm, 0xca4, MASKDWORD, path_a_0to3_idx); /*ant map 1*/ + odm_set_bb_reg(p_dm, 0xca8, MASKDWORD, path_a_4to7_idx); /*ant map 2*/ + + /*pathB*/ + odm_set_bb_reg(p_dm, 0xea4, MASKDWORD, path_b_0to3_idx); /*ant map 1*/ + odm_set_bb_reg(p_dm, 0xea8, MASKDWORD, path_b_4to7_idx); /*ant map 2*/ + +} + + +void +phydm_cumitek_smt_ant_init_8822b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant *p_smtant_table = &(p_dm->smtant_table); + struct smt_ant_cumitek *p_cumi_smtant_table = &(p_dm->smtant_table.cumi_smtant_table); + u32 value32; + + PHYDM_DBG(p_dm, DBG_SMT_ANT, ("[8822B Cumitek SmtAnt Int]\n")); + + /*========= MAC GPIO setting =================================*/ + + /* Pin, pin_name, RFE_CTRL_NUM*/ + + /* A0, 55, 5G_TRSW, 3*/ + /* A1, 52, 5G_TRSW, 0*/ + /* A2, 25, 5G_TRSW, 8*/ + + /* B0, 16, 5G_TRSW, 4*/ + /* B1, 13, 5G_TRSW, 11*/ + /* B2, 24, 5G_TRSW, 9*/ + + /*for RFE_CTRL 8 & 9*/ + odm_set_mac_reg(p_dm, 0x4c, BIT(24) | BIT(23), 2); + odm_set_mac_reg(p_dm, 0x44, BIT(27) | BIT(26), 0); + + /*for RFE_CTRL 0*/ + odm_set_mac_reg(p_dm, 0x4c, BIT(25), 0); + odm_set_mac_reg(p_dm, 0x64, BIT(29), 1); + + /*for RFE_CTRL 2 & 3*/ + odm_set_mac_reg(p_dm, 0x4c, BIT(26), 0); + odm_set_mac_reg(p_dm, 0x64, BIT(28), 1); + + /*for RFE_CTRL 11*/ + odm_set_mac_reg(p_dm, 0x40, BIT(3), 1); + + + /*0x604[25]=1 : 2bit mode for pathA&B&C&D*/ + /*0x604[25]=0 : 3bit mode for pathA&B*/ + p_smtant_table->tx_desc_mode = 0; + odm_set_mac_reg(p_dm, 0x604, BIT(25), (u32)p_smtant_table->tx_desc_mode); + + /*========= BB RFE setting =================================*/ + #if 0 + /*path A*/ + odm_set_bb_reg(p_dm, 0x1990, BIT(3), 0); /*RFE_CTRL_3*/ /*A_0*/ + odm_set_bb_reg(p_dm, 0xcbc, BIT(3), 0); /*inv*/ + odm_set_bb_reg(p_dm, 0xcb0, 0xf000, 8); + + odm_set_bb_reg(p_dm, 0x1990, BIT(1), 0); /*RFE_CTRL_0*/ /*A_1*/ + odm_set_bb_reg(p_dm, 0xcbc, BIT(0), 0); /*inv*/ + odm_set_bb_reg(p_dm, 0xcb0, 0xf, 0x9); + + odm_set_bb_reg(p_dm, 0x1990, BIT(8), 0); /*RFE_CTRL_8*/ /*A_2*/ + odm_set_bb_reg(p_dm, 0xcbc, BIT(8), 0); /*inv*/ + odm_set_bb_reg(p_dm, 0xcb4, 0xf, 0xa); + + + /*path B*/ + odm_set_bb_reg(p_dm, 0x1990, BIT(4), 1); /*RFE_CTRL_4*/ /*B_0*/ + odm_set_bb_reg(p_dm, 0xdbc, BIT(4), 0); /*inv*/ + odm_set_bb_reg(p_dm, 0xdb0, 0xf0000, 0xb); + + odm_set_bb_reg(p_dm, 0x1990, BIT(11), 1); /*RFE_CTRL_11*/ /*B_1*/ + odm_set_bb_reg(p_dm, 0xdbc, BIT(11), 0); /*inv*/ + odm_set_bb_reg(p_dm, 0xdb4, 0xf000, 0xc); + + odm_set_bb_reg(p_dm, 0x1990, BIT(9), 1); /*RFE_CTRL_9*/ /*B_2*/ + odm_set_bb_reg(p_dm, 0xdbc, BIT(9), 0); /*inv*/ + odm_set_bb_reg(p_dm, 0xdb4, 0xf0, 0xd); + #endif + /*========= BB SmtAnt setting =================================*/ + odm_set_mac_reg(p_dm, 0x668, BIT(3), 1); + odm_set_bb_reg(p_dm, 0x804, BIT(4), 0); /*lathch antsel*/ + odm_set_bb_reg(p_dm, 0x818, 0xf00000, 0); /*keep tx by rx*/ + odm_set_bb_reg(p_dm, 0x900, BIT(19), 0); /*fast train*/ + odm_set_bb_reg(p_dm, 0x900, BIT(18), 1); /*1: by TXDESC*/ + + /*pathA*/ + odm_set_bb_reg(p_dm, 0xca4, MASKDWORD, 0x03020100); /*ant map 1*/ + odm_set_bb_reg(p_dm, 0xca8, MASKDWORD, 0x07060504); /*ant map 2*/ + odm_set_bb_reg(p_dm, 0xcac, BIT(9), 0); /*keep antsel map by GNT_BT*/ + + /*pathB*/ + odm_set_bb_reg(p_dm, 0xea4, MASKDWORD, 0x30201000); /*ant map 1*/ + odm_set_bb_reg(p_dm, 0xea8, MASKDWORD, 0x70605040); /*ant map 2*/ + odm_set_bb_reg(p_dm, 0xeac, BIT(9), 0); /*keep antsel map by GNT_BT*/ +} + +void +phydm_cumitek_smt_ant_init_8197f( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant *p_smtant_table = &(p_dm->smtant_table); + struct smt_ant_cumitek *p_cumi_smtant_table = &(p_dm->smtant_table.cumi_smtant_table); + u32 value32; + + PHYDM_DBG(p_dm, DBG_SMT_ANT, ("[8197F Cumitek SmtAnt Int]\n")); + + /*GPIO setting*/ + + +} + +void +phydm_cumitek_smt_tx_ant_update( + void *p_dm_void, + u8 tx_ant_idx_path_a, + u8 tx_ant_idx_path_b, + u32 mac_id +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant *p_smtant_table = &(p_dm->smtant_table); + struct smt_ant_cumitek *p_cumi_smtant_table = &(p_dm->smtant_table.cumi_smtant_table); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Cumitek] Set TX-ANT[%d] = (( A:0x%x , B:0x%x ))\n", + mac_id, tx_ant_idx_path_a, tx_ant_idx_path_b)); + + /*path-A*/ + p_cumi_smtant_table->tx_ant_idx[0][mac_id] = tx_ant_idx_path_a; /*fill this value into TXDESC*/ + + /*path-B*/ + p_cumi_smtant_table->tx_ant_idx[1][mac_id] = tx_ant_idx_path_b; /*fill this value into TXDESC*/ +} + +void +phydm_cumitek_smt_rx_default_ant_update( + void *p_dm_void, + u8 rx_ant_idx_path_a, + u8 rx_ant_idx_path_b +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant *p_smtant_table = &(p_dm->smtant_table); + struct smt_ant_cumitek *p_cumi_smtant_table = &(p_dm->smtant_table.cumi_smtant_table); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Cumitek] Set RX-ANT = (( A:0x%x, B:0x%x ))\n", + rx_ant_idx_path_a, rx_ant_idx_path_b)); + + /*path-A*/ + if (p_cumi_smtant_table->rx_default_ant_idx[0] != rx_ant_idx_path_a) { + + #if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + + odm_set_bb_reg(p_dm, 0xc08, BIT(21) | BIT(20) | BIT(19), rx_ant_idx_path_a); /*default RX antenna*/ + odm_set_mac_reg(p_dm, 0x6d8, BIT(2) | BIT(1) | BIT(0), rx_ant_idx_path_a); /*default response TX antenna*/ + } + #endif + + #if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F) { + + } + #endif + + p_cumi_smtant_table->rx_default_ant_idx[0] = rx_ant_idx_path_a; + } + + /*path-B*/ + if (p_cumi_smtant_table->rx_default_ant_idx[1] != rx_ant_idx_path_b) { + + #if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + + odm_set_bb_reg(p_dm, 0xe08, BIT(21) | BIT(20) | BIT(19), rx_ant_idx_path_b); /*default antenna*/ + odm_set_mac_reg(p_dm, 0x6d8, BIT(5) | BIT(4) | BIT(3), rx_ant_idx_path_b); /*default response TX antenna*/ + } + #endif + + #if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F) { + + } + #endif + + p_cumi_smtant_table->rx_default_ant_idx[1] = rx_ant_idx_path_b; + } + +} + +void +phydm_cumitek_smt_ant_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant *p_smtant_table = &(p_dm->smtant_table); + struct smt_ant_cumitek *p_cumi_smtant_table = &(p_dm->smtant_table.cumi_smtant_table); + u32 used = *_used; + u32 out_len = *_out_len; + char help[] = "-h"; + u32 dm_value[10] = {0}; + u8 i; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &dm_value[0]); + + if (strcmp(input[1], help) == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "{1} {PathA rx_ant_idx} {pathB rx_ant_idx}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{2} {PathA tx_ant_idx} {pathB tx_ant_idx} {macid}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{3} {PathA mapping table} {PathB mapping table}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, "{4} {txdesc_mode 0:3bit, 1:2bit}\n")); + + } else if (dm_value[0] == 1) { /*fix rx_idle pattern*/ + + PHYDM_SSCANF(input[2], DCMD_DECIMAL, &dm_value[1]); + PHYDM_SSCANF(input[3], DCMD_DECIMAL, &dm_value[2]); + + phydm_cumitek_smt_rx_default_ant_update(p_dm, (u8)dm_value[1], (u8)dm_value[2]); + PHYDM_SNPRINTF((output + used, out_len - used, "RX Ant{A, B}={%d, %d}\n", dm_value[1], dm_value[2])); + + } else if (dm_value[0] == 2) { /*fix tx pattern*/ + + + for (i = 1; i < 4; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_DECIMAL, &dm_value[i]); + } + + PHYDM_SNPRINTF((output + used, out_len - used, "STA[%d] TX Ant{A, B}={%d, %d}\n",dm_value[3], dm_value[1], dm_value[2])); + phydm_cumitek_smt_tx_ant_update(p_dm, (u8)dm_value[1], (u8)dm_value[2], (u8)dm_value[3]); + + } else if (dm_value[0] == 3) { + + u8 table_path_a[8] = {0}; + u8 table_path_b[8] = {0}; + + for (i = 1; i < 4; i++) { + if (input[i + 1]) + PHYDM_SSCANF(input[i + 1], DCMD_HEX, &dm_value[i]); + } + + PHYDM_SNPRINTF((output + used, out_len - used, "Set Path-AB mapping table={%d, %d}\n", dm_value[1], dm_value[2])); + + for (i = 0; i <8; i++) { + table_path_a[i] = (u8)((dm_value[1] >> (4 * i)) & 0xf); + table_path_b[i] = (u8)((dm_value[2] >> (4 * i)) & 0xf); + } + + PHYDM_SNPRINTF((output + used, out_len - used, "Ant_Table_A[7:0]={0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x}\n", + table_path_a[7], table_path_a[6], table_path_a[5], table_path_a[4], table_path_a[3], table_path_a[2], table_path_a[1], table_path_a[0])); + PHYDM_SNPRINTF((output + used, out_len - used, "Ant_Table_B[7:0]={0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x}\n", + table_path_b[7], table_path_b[6], table_path_b[5], table_path_b[4], table_path_b[3], table_path_b[2], table_path_b[1], table_path_b[0])); + + phydm_cumitek_smt_ant_mapping_table_8822b(p_dm, &(table_path_a[0]), &(table_path_b[0])); + }else if (dm_value[0] == 4) { + + p_smtant_table->tx_desc_mode = (u8)dm_value[1]; + odm_set_mac_reg(p_dm, 0x604, BIT(25), (u32)p_smtant_table->tx_desc_mode); + } + *_used = used; + *_out_len = out_len; +} + +#endif + +#if (defined(CONFIG_HL_SMART_ANTENNA)) +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + +#if (RTL8822B_SUPPORT == 1) +void +phydm_hl_smart_ant_type2_init_8822b( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u8 j; + u8 rfu_codeword_table_init_2g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B] = { + {1, 1},/*0*/ + {1, 2}, + {2, 1}, + {2, 2}, + {4, 0}, + {5, 0}, + {6, 0}, + {7, 0}, + {8, 0},/*8*/ + {9, 0}, + {0xa, 0}, + {0xb, 0}, + {0xc, 0}, + {0xd, 0}, + {0xe, 0}, + {0xf, 0} + }; + u8 rfu_codeword_table_init_5g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B] ={ + #if 1 + {9, 1},/*0*/ + {9, 9}, + {1, 9}, + {9, 6}, + {2, 1}, + {2, 9}, + {9, 2}, + {2, 2},/*8*/ + {6, 1}, + {6, 9}, + {2, 9}, + {2, 2}, + {6, 2}, + {6, 6}, + {2, 6}, + {1, 1} + #else + {1, 1},/*0*/ + {9, 1}, + {9, 9}, + {1, 9}, + {1, 2}, + {9, 2}, + {9, 6}, + {1, 6}, + {2, 1},/*8*/ + {6, 1}, + {6, 9}, + {2, 9}, + {2, 2}, + {6, 2}, + {6, 6}, + {2, 6} + #endif + }; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***RTK 8822B SmartAnt_Init: Hong-Bo SmrtAnt Type2]\n")); + + /* ---------------------------------------- */ + /* GPIO 0-1 for Beam control */ + /* reg0x66[2:0]=0 */ + /* reg0x44[25:24] = 0 */ + /* reg0x44[23:16] enable_output for P_GPIO[7:0] */ + /* reg0x44[15:8] output_value for P_GPIO[7:0] */ + /* reg0x40[1:0] = 0 GPIO function */ + /* ------------------------------------------ */ + + odm_move_memory(p_dm, pdm_sat_table->rfu_codeword_table_2g, rfu_codeword_table_init_2g, (SUPPORT_BEAM_SET_PATTERN_NUM * MAX_PATH_NUM_8822B)); + odm_move_memory(p_dm, pdm_sat_table->rfu_codeword_table_5g, rfu_codeword_table_init_5g, (SUPPORT_BEAM_SET_PATTERN_NUM * MAX_PATH_NUM_8822B)); + + /*GPIO setting*/ + odm_set_mac_reg(p_dm, 0x64, (BIT(18) | BIT(17) | BIT(16)), 0); + odm_set_mac_reg(p_dm, 0x44, BIT(25) | BIT(24), 0); /*config P_GPIO[3:2] to data port*/ + odm_set_mac_reg(p_dm, 0x44, BIT(17) | BIT(16), 0x3); /*enable_output for P_GPIO[3:2]*/ + /*odm_set_mac_reg(p_dm, 0x44, BIT(9)|BIT(8), 0);*/ /*P_GPIO[3:2] output value*/ + odm_set_mac_reg(p_dm, 0x40, BIT(1) | BIT(0), 0); /*GPIO function*/ + + /*Hong_lin smart antenna HW setting*/ + pdm_sat_table->rfu_protocol_type = 2; + pdm_sat_table->rfu_protocol_delay_time = 45; + + pdm_sat_table->rfu_codeword_total_bit_num = 16;/*max=32bit*/ + pdm_sat_table->rfu_each_ant_bit_num = 4; + + pdm_sat_table->total_beam_set_num = 4; + pdm_sat_table->total_beam_set_num_2g = 4; + pdm_sat_table->total_beam_set_num_5g = 8; + +#if DEV_BUS_TYPE == RT_SDIO_INTERFACE + pdm_sat_table->latch_time = 100; /*mu sec*/ +#elif DEV_BUS_TYPE == RT_USB_INTERFACE + pdm_sat_table->latch_time = 100; /*mu sec*/ +#endif + pdm_sat_table->pkt_skip_statistic_en = 0; + + pdm_sat_table->ant_num = 2; + pdm_sat_table->ant_num_total = MAX_PATH_NUM_8822B; + pdm_sat_table->first_train_ant = MAIN_ANT; + + + + pdm_sat_table->fix_beam_pattern_en = 0; + pdm_sat_table->decision_holding_period = 0; + + /*beam training setting*/ + pdm_sat_table->pkt_counter = 0; + pdm_sat_table->per_beam_training_pkt_num = 10; + + /*set default beam*/ + pdm_sat_table->fast_training_beam_num = 0; + pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; + + for (j = 0; j < SUPPORT_BEAM_SET_PATTERN_NUM; j++) { + + pdm_sat_table->beam_set_avg_rssi_pre[j] = 0; + pdm_sat_table->beam_set_train_val_diff[j] = 0; + pdm_sat_table->beam_set_train_cnt[j] = 0; + } + phydm_set_rfu_beam_pattern_type2(p_dm); + p_dm_fat_table->fat_state = FAT_BEFORE_LINK_STATE; + +} +#endif + + +u32 +phydm_construct_hb_rfu_codeword_type2( + void *p_dm_void, + u32 beam_set_idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u32 sync_codeword = 0x7f; + u32 codeword = 0; + u32 data_tmp = 0; + u32 i; + + for (i = 0; i < pdm_sat_table->ant_num_total; i++) { + + if (*p_dm->p_band_type == ODM_BAND_5G) + data_tmp = pdm_sat_table->rfu_codeword_table_5g[beam_set_idx][i]; + else + data_tmp = pdm_sat_table->rfu_codeword_table_2g[beam_set_idx][i]; + + codeword |= (data_tmp << (i * pdm_sat_table->rfu_each_ant_bit_num)); + } + + codeword = (codeword<<8) | sync_codeword; + + return codeword; +} + +void +phydm_update_beam_pattern_type2( + void *p_dm_void, + u32 codeword, + u32 codeword_length +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u8 i; + boolean beam_ctrl_signal; + u32 one = 0x1; + u32 reg44_tmp_p, reg44_tmp_n, reg44_ori; + u8 devide_num = 4; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Set codeword = ((0x%x))\n", codeword)); + + reg44_ori = odm_get_mac_reg(p_dm, 0x44, MASKDWORD); + reg44_tmp_p = reg44_ori; + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44_ori =0x%x\n", reg44_ori));*/ + + /*devide_num = (pdm_sat_table->rfu_protocol_type == 2) ? 8 : 4;*/ + + for (i = 0; i <= (codeword_length - 1); i++) { + beam_ctrl_signal = (boolean)((codeword & BIT(i)) >> i); + + #if 1 + if (p_dm->debug_components & DBG_ANT_DIV) { + + if (i == (codeword_length - 1)) { + dbg_print("%d ]\n", beam_ctrl_signal); + /**/ + } else if (i == 0) { + dbg_print("Start sending codeword[1:%d] ---> [ %d ", codeword_length, beam_ctrl_signal); + /**/ + } else if ((i % devide_num) == (devide_num-1)) { + dbg_print("%d | ", beam_ctrl_signal); + /**/ + } else { + dbg_print("%d ", beam_ctrl_signal); + /**/ + } + } + #endif + + if (p_dm->support_ic_type == ODM_RTL8821) { + #if (RTL8821A_SUPPORT == 1) + reg44_tmp_p = reg44_ori & (~(BIT(11) | BIT(10))); /*clean bit 10 & 11*/ + reg44_tmp_p |= ((1 << 11) | (beam_ctrl_signal << 10)); + reg44_tmp_n = reg44_ori & (~(BIT(11) | BIT(10))); + + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n));*/ + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_p); + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_n); + #endif + } + #if (RTL8822B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8822B) { + + if (pdm_sat_table->rfu_protocol_type == 2) { + + reg44_tmp_p = reg44_tmp_p & ~(BIT(8)); /*clean bit 8*/ + reg44_tmp_p = reg44_tmp_p ^ BIT(9); /*get new clk high/low, exclusive-or*/ + + + reg44_tmp_p |= (beam_ctrl_signal << 8); + + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(pdm_sat_table->rfu_protocol_delay_time); + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44 =(( 0x%x )), reg44[9:8] = ((%x)), beam_ctrl_signal =((%x))\n", reg44_tmp_p, ((reg44_tmp_p & 0x300)>>8), beam_ctrl_signal));*/ + + } else { + reg44_tmp_p = reg44_ori & (~(BIT(9) | BIT(8))); /*clean bit 9 & 8*/ + reg44_tmp_p |= ((1 << 9) | (beam_ctrl_signal << 8)); + reg44_tmp_n = reg44_ori & (~(BIT(9) | BIT(8))); + + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n)); */ + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(10); + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_n); + ODM_delay_us(10); + } + } + #endif + } +} + +void +phydm_update_rx_idle_beam_type2( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u32 i; + + pdm_sat_table->update_beam_codeword = phydm_construct_hb_rfu_codeword_type2(p_dm, pdm_sat_table->rx_idle_beam_set_idx); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-Beam ] BeamSet idx = ((%d))\n", pdm_sat_table->rx_idle_beam_set_idx)); + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + phydm_update_beam_pattern_type2(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); +#else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_workitem); + /*odm_stall_execution(1);*/ +#endif + + pdm_sat_table->pre_codeword = pdm_sat_table->update_beam_codeword; +} + + +void +phydm_hl_smart_ant_debug_type2( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u32 used = *_used; + u32 out_len = *_out_len; + u32 one = 0x1; + u32 codeword_length = pdm_sat_table->rfu_codeword_total_bit_num; + u32 beam_ctrl_signal, i; + u8 devide_num = 4; + char help[] = "-h"; + u32 dm_value[10] = {0}; + + PHYDM_SSCANF(input[1], DCMD_DECIMAL, &dm_value[0]); + PHYDM_SSCANF(input[2], DCMD_DECIMAL, &dm_value[1]); + PHYDM_SSCANF(input[3], DCMD_DECIMAL, &dm_value[2]); + PHYDM_SSCANF(input[4], DCMD_DECIMAL, &dm_value[3]); + PHYDM_SSCANF(input[5], DCMD_DECIMAL, &dm_value[4]); + + + if (strcmp(input[1], help) == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, " 1 {fix_en} {codeword(Hex)}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, " 3 {Fix_training_num_en} {Per_beam_training_pkt_num} {Decision_holding_period}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, " 5 {0:show, 1:2G, 2:5G} {beam_num} {idxA(Hex)} {idxB(Hex)}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, " 7 {0:show, 1:2G, 2:5G} {total_beam_set_num}\n")); + PHYDM_SNPRINTF((output + used, out_len - used, " 8 {0:show, 1:set} {RFU delay time(us)}\n")); + + } else if (dm_value[0] == 1) { /*fix beam pattern*/ + + pdm_sat_table->fix_beam_pattern_en = dm_value[1]; + + if (pdm_sat_table->fix_beam_pattern_en == 1) { + + PHYDM_SSCANF(input[3], DCMD_HEX, &dm_value[2]); + pdm_sat_table->fix_beam_pattern_codeword = dm_value[2]; + + if (pdm_sat_table->fix_beam_pattern_codeword > (one << codeword_length)) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Codeword overflow, Current codeword is ((0x%x)), and should be less than ((%d))bit\n", + pdm_sat_table->fix_beam_pattern_codeword, codeword_length)); + + (pdm_sat_table->fix_beam_pattern_codeword) &= 0xffffff; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Auto modify to (0x%x)\n", pdm_sat_table->fix_beam_pattern_codeword)); + } + + pdm_sat_table->update_beam_codeword = pdm_sat_table->fix_beam_pattern_codeword; + + /*---------------------------------------------------------*/ + PHYDM_SNPRINTF((output + used, out_len - used, "Fix Beam Pattern\n")); + + /*devide_num = (pdm_sat_table->rfu_protocol_type == 2) ? 8 : 4;*/ + + for (i = 0; i <= (codeword_length - 1); i++) { + beam_ctrl_signal = (boolean)((pdm_sat_table->update_beam_codeword & BIT(i)) >> i); + + if (i == (codeword_length - 1)) { + PHYDM_SNPRINTF((output + used, out_len - used, "%d]\n", beam_ctrl_signal)); + /**/ + } else if (i == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "Send Codeword[1:%d] to RFU -> [%d", pdm_sat_table->rfu_codeword_total_bit_num, beam_ctrl_signal)); + /**/ + } else if ((i % devide_num) == (devide_num-1)) { + PHYDM_SNPRINTF((output + used, out_len - used, "%d|", beam_ctrl_signal)); + /**/ + } else { + PHYDM_SNPRINTF((output + used, out_len - used, "%d", beam_ctrl_signal)); + /**/ + } + } + /*---------------------------------------------------------*/ + + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + phydm_update_beam_pattern_type2(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); + #else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_workitem); + /*odm_stall_execution(1);*/ + #endif + } else if (pdm_sat_table->fix_beam_pattern_en == 0) + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Smart Antenna: Enable\n")); + + } else if (dm_value[0] == 2) { /*set latch time*/ + + pdm_sat_table->latch_time = dm_value[1]; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] latch_time =0x%x\n", pdm_sat_table->latch_time)); + } else if (dm_value[0] == 3) { + + pdm_sat_table->fix_training_num_en = dm_value[1]; + + if (pdm_sat_table->fix_training_num_en == 1) { + pdm_sat_table->per_beam_training_pkt_num = (u8)dm_value[2]; + pdm_sat_table->decision_holding_period = (u8)dm_value[3]; + + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", + pdm_sat_table->fix_training_num_en, pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); + + } else if (pdm_sat_table->fix_training_num_en == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] AUTO per_beam_training_pkt_num\n")); + /**/ + } + } else if (dm_value[0] == 4) { + #if 0 + if (dm_value[1] == 1) { + pdm_sat_table->ant_num = 1; + pdm_sat_table->first_train_ant = MAIN_ANT; + + } else if (dm_value[1] == 2) { + pdm_sat_table->ant_num = 1; + pdm_sat_table->first_train_ant = AUX_ANT; + + } else if (dm_value[1] == 3) { + pdm_sat_table->ant_num = 2; + pdm_sat_table->first_train_ant = MAIN_ANT; + } + + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Set ant Num = (( %d )), first_train_ant = (( %d ))\n", + pdm_sat_table->ant_num, (pdm_sat_table->first_train_ant - 1))); + #endif + } else if (dm_value[0] == 5) { /*set beam set table*/ + + PHYDM_SSCANF(input[4], DCMD_HEX, &dm_value[3]); + PHYDM_SSCANF(input[5], DCMD_HEX, &dm_value[4]); + + if (dm_value[1] == 1) { /*2G*/ + if (dm_value[2] < SUPPORT_BEAM_SET_PATTERN_NUM) { + pdm_sat_table->rfu_codeword_table_2g[dm_value[2] ][0] = (u8)dm_value[3]; + pdm_sat_table->rfu_codeword_table_2g[dm_value[2] ][1] = (u8)dm_value[4]; + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] Set 2G Table[%d] = [A:0x%x, B:0x%x]\n",dm_value[2], dm_value[3], dm_value[4])); + } + + } else if (dm_value[1] == 2) { /*5G*/ + if (dm_value[2] < SUPPORT_BEAM_SET_PATTERN_NUM) { + pdm_sat_table->rfu_codeword_table_5g[dm_value[2] ][0] = (u8)dm_value[3]; + pdm_sat_table->rfu_codeword_table_5g[dm_value[2] ][1] = (u8)dm_value[4]; + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] Set5G Table[%d] = [A:0x%x, B:0x%x]\n",dm_value[2], dm_value[3], dm_value[4])); + } + } else if (dm_value[1] == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] 2G Beam Table==============>\n")); + for (i = 0; i < pdm_sat_table->total_beam_set_num_2g; i++) { + PHYDM_SNPRINTF((output + used, out_len - used, "2G Table[%d] = [A:0x%x, B:0x%x]\n", + i, pdm_sat_table->rfu_codeword_table_2g[i][0], pdm_sat_table->rfu_codeword_table_2g[i][1])); + } + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] 5G Beam Table==============>\n")); + for (i = 0; i < pdm_sat_table->total_beam_set_num_5g; i++) { + PHYDM_SNPRINTF((output + used, out_len - used, "5G Table[%d] = [A:0x%x, B:0x%x]\n", + i, pdm_sat_table->rfu_codeword_table_5g[i][0], pdm_sat_table->rfu_codeword_table_5g[i][1])); + } + } + + } else if (dm_value[0] == 6) { + #if 0 + if (dm_value[1] == 0) { + if (dm_value[2] < SUPPORT_BEAM_SET_PATTERN_NUM) { + pdm_sat_table->rfu_codeword_table_5g[dm_value[2] ][0] = (u8)dm_value[3]; + pdm_sat_table->rfu_codeword_table_5g[dm_value[2] ][1] = (u8)dm_value[4]; + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] Set5G Table[%d] = [A:0x%x, B:0x%x]\n",dm_value[2], dm_value[3], dm_value[4])); + } + } else { + for (i = 0; i < pdm_sat_table->total_beam_set_num_5g; i++) { + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] Read 5G Table[%d] = [A:0x%x, B:0x%x]\n", + i, pdm_sat_table->rfu_codeword_table_5g[i][0], pdm_sat_table->rfu_codeword_table_5g[i][1])); + } + } + #endif + } else if (dm_value[0] == 7) { + + if (dm_value[1] == 1) { + + pdm_sat_table->total_beam_set_num_2g = (u8)(dm_value[2]); + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] total_beam_set_num_2g = ((%d))\n", pdm_sat_table->total_beam_set_num_2g)); + + } else if (dm_value[1] == 2) { + + pdm_sat_table->total_beam_set_num_5g = (u8)(dm_value[2]); + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] total_beam_set_num_5g = ((%d))\n", pdm_sat_table->total_beam_set_num_5g)); + } else if (dm_value[1] == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Show total_beam_set_num{2g,5g} = {%d,%d}\n", + pdm_sat_table->total_beam_set_num_2g, pdm_sat_table->total_beam_set_num_5g)); + } + + } else if (dm_value[0] == 8) { + + if (dm_value[1] == 1) { + pdm_sat_table->rfu_protocol_delay_time = (u16)(dm_value[2]); + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] Set rfu_protocol_delay_time = ((%d))\n", pdm_sat_table->rfu_protocol_delay_time)); + } else if (dm_value[1] == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "[SmtAnt] Read rfu_protocol_delay_time = ((%d))\n", pdm_sat_table->rfu_protocol_delay_time)); + } + } + + *_used = used; + *_out_len = out_len; +} + +void +phydm_set_rfu_beam_pattern_type2( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + + if (p_dm->ant_div_type != HL_SW_SMART_ANT_TYPE2) + return; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Training beam_set index = (( 0x%x ))\n", pdm_sat_table->fast_training_beam_num)); + pdm_sat_table->update_beam_codeword = phydm_construct_hb_rfu_codeword_type2(p_dm, pdm_sat_table->fast_training_beam_num); + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + phydm_update_beam_pattern_type2(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); + #else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_workitem); + /*odm_stall_execution(1);*/ + #endif +} + +void +phydm_fast_ant_training_hl_smart_antenna_type2( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + struct phydm_fat_struct *p_dm_fat_table = &(p_dm->dm_fat_table); + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + u32 codeword = 0; + u8 i = 0, j=0; + u8 avg_rssi_tmp; + u8 avg_rssi_tmp_ma; + u8 max_beam_ant_rssi = 0; + u8 rssi_target_beam = 0, target_beam_max_rssi = 0; + u8 evm1ss_target_beam = 0, evm2ss_target_beam = 0; + u32 target_beam_max_evm1ss = 0, target_beam_max_evm2ss = 0; + u32 beam_tmp; + u8 per_beam_val_diff_tmp = 0, training_pkt_num_offset; + u32 avg_evm2ss[2] = {0}, avg_evm2ss_sum = 0; + u32 avg_evm1ss = 0; + u32 beam_path_evm_2ss_cnt_all = 0; /*sum of all 2SS-pattern cnt*/ + u32 beam_path_evm_1ss_cnt_all = 0; /*sum of all 1SS-pattern cnt*/ + u8 decision_type; + + if (!p_dm->is_linked) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[No Link!!!]\n")); + + if (p_dm_fat_table->is_become_linked == true) { + + pdm_sat_table->decision_holding_period = 0; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Link->no Link\n")); + p_dm_fat_table->fat_state = FAT_BEFORE_LINK_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("change to (( %d )) FAT_state\n", p_dm_fat_table->fat_state)); + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + return; + + } else { + if (p_dm_fat_table->is_become_linked == false) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Linked !!!]\n")); + + p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("change to (( %d )) FAT_state\n", p_dm_fat_table->fat_state)); + + /*pdm_sat_table->fast_training_beam_num = 0;*/ + /*phydm_set_rfu_beam_pattern_type2(p_dm);*/ + + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + } + + + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("HL Smart ant Training: state (( %d ))\n", p_dm_fat_table->fat_state));*/ + + /* [DECISION STATE] */ + /*=======================================================================================*/ + if (p_dm_fat_table->fat_state == FAT_DECISION_STATE) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 3. In Decision state]\n")); + + /*compute target beam in each antenna*/ + + for (j = 0; j < (pdm_sat_table->total_beam_set_num); j++) { + + /*[Decision1: RSSI]-------------------------------------------------------------------*/ + if (pdm_sat_table->statistic_pkt_cnt[j] == 0) { /*if new RSSI = 0 -> MA_RSSI-=2*/ + avg_rssi_tmp = pdm_sat_table->beam_set_avg_rssi_pre[j]; + avg_rssi_tmp = (avg_rssi_tmp >= 2) ? (avg_rssi_tmp - 2) : avg_rssi_tmp; + avg_rssi_tmp_ma = avg_rssi_tmp; + } else { + avg_rssi_tmp = (u8)((pdm_sat_table->beam_set_rssi_avg_sum[j]) / (pdm_sat_table->statistic_pkt_cnt[j])); + avg_rssi_tmp_ma = (avg_rssi_tmp + pdm_sat_table->beam_set_avg_rssi_pre[j]) >> 1; + } + + pdm_sat_table->beam_set_avg_rssi_pre[j] = avg_rssi_tmp; + + if (avg_rssi_tmp > target_beam_max_rssi) { + rssi_target_beam = j; + target_beam_max_rssi = avg_rssi_tmp; + } + + /*[Decision2: EVM 2ss]-------------------------------------------------------------------*/ + if (pdm_sat_table->beam_path_evm_2ss_cnt[j] != 0) { + avg_evm2ss[0] = pdm_sat_table->beam_path_evm_2ss_sum[j][0] / pdm_sat_table->beam_path_evm_2ss_cnt[j]; + avg_evm2ss[1] = pdm_sat_table->beam_path_evm_2ss_sum[j][1] / pdm_sat_table->beam_path_evm_2ss_cnt[j]; + avg_evm2ss_sum = avg_evm2ss[0] + avg_evm2ss[1]; + beam_path_evm_2ss_cnt_all += pdm_sat_table->beam_path_evm_2ss_cnt[j]; + + pdm_sat_table->beam_set_avg_evm_2ss_pre[j] = (u8)avg_evm2ss_sum; + } + + if (avg_evm2ss_sum > target_beam_max_evm2ss) { + evm2ss_target_beam = j; + target_beam_max_evm2ss = avg_evm2ss_sum; + } + + /*[Decision3: EVM 1ss]-------------------------------------------------------------------*/ + if (pdm_sat_table->beam_path_evm_1ss_cnt[j] != 0) { + avg_evm1ss = pdm_sat_table->beam_path_evm_1ss_sum[j] / pdm_sat_table->beam_path_evm_1ss_cnt[j]; + beam_path_evm_1ss_cnt_all += pdm_sat_table->beam_path_evm_1ss_cnt[j]; + + pdm_sat_table->beam_set_avg_evm_1ss_pre[j] = (u8)avg_evm1ss; + } + + if (avg_evm1ss > target_beam_max_evm1ss) { + evm1ss_target_beam = j; + target_beam_max_evm1ss = avg_evm1ss; + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Beam[%d] Pkt_cnt=(( %d )), avg{MA,rssi}={%d, %d}, EVM1={%d}, EVM2={%d, %d, %d}\n", + j, pdm_sat_table->statistic_pkt_cnt[j], avg_rssi_tmp_ma, avg_rssi_tmp, avg_evm1ss, avg_evm2ss[0], avg_evm2ss[1], avg_evm2ss_sum)); + + /*reset counter value*/ + pdm_sat_table->beam_set_rssi_avg_sum[j] = 0; + pdm_sat_table->beam_path_rssi_sum[j][0] = 0; + pdm_sat_table->beam_path_rssi_sum[j][1] = 0; + pdm_sat_table->statistic_pkt_cnt[j] = 0; + + pdm_sat_table->beam_path_evm_2ss_sum[j][0] = 0; + pdm_sat_table->beam_path_evm_2ss_sum[j][1] = 0; + pdm_sat_table->beam_path_evm_2ss_cnt[j] = 0; + + pdm_sat_table->beam_path_evm_1ss_sum[j] = 0; + pdm_sat_table->beam_path_evm_1ss_cnt[j] = 0; + } + + /*[Joint Decision]-------------------------------------------------------------------*/ + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("--->1.[RSSI] Target Beam(( %d )) RSSI_max=((%d))\n", rssi_target_beam, target_beam_max_rssi)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("--->2.[Evm2SS] Target Beam(( %d )) EVM2SS_max=((%d))\n", evm2ss_target_beam, target_beam_max_evm2ss)); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("--->3.[Evm1SS] Target Beam(( %d )) EVM1SS_max=((%d))\n", evm1ss_target_beam, target_beam_max_evm1ss)); + + if (target_beam_max_rssi <= 10) { + pdm_sat_table->rx_idle_beam_set_idx = rssi_target_beam; + decision_type = 1; + } else { + if (beam_path_evm_2ss_cnt_all != 0) { + pdm_sat_table->rx_idle_beam_set_idx = evm2ss_target_beam; + decision_type = 2; + } else if (beam_path_evm_1ss_cnt_all != 0) { + pdm_sat_table->rx_idle_beam_set_idx = evm1ss_target_beam; + decision_type = 3; + } else { + pdm_sat_table->rx_idle_beam_set_idx = rssi_target_beam; + decision_type = 1; + } + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("---> Decision_type=((%d)), Final Target Beam(( %d ))\n", decision_type, pdm_sat_table->rx_idle_beam_set_idx)); + + /*Calculate packet counter offset*/ + for (j = 0; j < (pdm_sat_table->total_beam_set_num); j++) { + + if (decision_type == 1) { + per_beam_val_diff_tmp = target_beam_max_rssi - pdm_sat_table->beam_set_avg_rssi_pre[j]; + + } else if (decision_type == 2) { + per_beam_val_diff_tmp = ((u8)target_beam_max_evm2ss - pdm_sat_table->beam_set_avg_evm_2ss_pre[j]) >> 1; + } else if (decision_type == 3) { + per_beam_val_diff_tmp = (u8)target_beam_max_evm1ss - pdm_sat_table->beam_set_avg_evm_1ss_pre[j]; + } + pdm_sat_table->beam_set_train_val_diff[j] = per_beam_val_diff_tmp; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Beam_Set[%d]: diff= ((%d))\n", j, per_beam_val_diff_tmp)); + } + + /*set beam in each antenna*/ + phydm_update_rx_idle_beam_type2(p_dm); + p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + + } + /* [TRAINING STATE] */ + else if (p_dm_fat_table->fat_state == FAT_TRAINING_STATE) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2. In Training state]\n")); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("curr_beam_idx = (( %d )), pre_beam_idx = (( %d ))\n", + pdm_sat_table->fast_training_beam_num, pdm_sat_table->pre_fast_training_beam_num)); + + if (pdm_sat_table->fast_training_beam_num > pdm_sat_table->pre_fast_training_beam_num) + + pdm_sat_table->force_update_beam_en = 0; + + else { + + pdm_sat_table->force_update_beam_en = 1; + + pdm_sat_table->pkt_counter = 0; + beam_tmp = pdm_sat_table->fast_training_beam_num; + if (pdm_sat_table->fast_training_beam_num >= ((u32)pdm_sat_table->total_beam_set_num - 1)) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", pdm_sat_table->fast_training_beam_num)); + p_dm_fat_table->fat_state = FAT_DECISION_STATE; + phydm_fast_ant_training_hl_smart_antenna_type2(p_dm); + + } else { + pdm_sat_table->fast_training_beam_num++; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); + phydm_set_rfu_beam_pattern_type2(p_dm); + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + + } + } + pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Update Pre_Beam =(( %d ))\n", pdm_sat_table->pre_fast_training_beam_num)); + } + /* [Prepare state] */ + /*=======================================================================================*/ + else if (p_dm_fat_table->fat_state == FAT_PREPARE_STATE) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\n\n[ 1. In Prepare state]\n")); + + if (p_dm->pre_traffic_load == (p_dm->traffic_load)) { + if (pdm_sat_table->decision_holding_period != 0) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Holding_period = (( %d )), return!!!\n", pdm_sat_table->decision_holding_period)); + pdm_sat_table->decision_holding_period--; + return; + } + } + + /* Set training packet number*/ + if (pdm_sat_table->fix_training_num_en == 0) { + + switch (p_dm->traffic_load) { + + case TRAFFIC_HIGH: + pdm_sat_table->per_beam_training_pkt_num = 8; + pdm_sat_table->decision_holding_period = 2; + break; + case TRAFFIC_MID: + pdm_sat_table->per_beam_training_pkt_num = 6; + pdm_sat_table->decision_holding_period = 3; + break; + case TRAFFIC_LOW: + pdm_sat_table->per_beam_training_pkt_num = 3; /*ping 60000*/ + pdm_sat_table->decision_holding_period = 4; + break; + case TRAFFIC_ULTRA_LOW: + pdm_sat_table->per_beam_training_pkt_num = 1; + pdm_sat_table->decision_holding_period = 6; + break; + default: + break; + } + } + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("TrafficLoad = (( %d )), Fix_beam = (( %d )), per_beam_training_pkt_num = (( %d )), decision_holding_period = ((%d))\n", + p_dm->traffic_load, pdm_sat_table->fix_training_num_en, pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); + + /*Beam_set number*/ + if (*p_dm->p_band_type == ODM_BAND_5G) { + pdm_sat_table->total_beam_set_num = pdm_sat_table->total_beam_set_num_5g; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("5G beam_set num = ((%d))\n", pdm_sat_table->total_beam_set_num)); + } else { + pdm_sat_table->total_beam_set_num = pdm_sat_table->total_beam_set_num_2g; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("2G beam_set num = ((%d))\n", pdm_sat_table->total_beam_set_num)); + } + + for (j = 0; j < (pdm_sat_table->total_beam_set_num); j++) { + + training_pkt_num_offset = pdm_sat_table->beam_set_train_val_diff[j]; + + if ((pdm_sat_table->per_beam_training_pkt_num) > training_pkt_num_offset) + pdm_sat_table->beam_set_train_cnt[j] = pdm_sat_table->per_beam_training_pkt_num - training_pkt_num_offset; + else + pdm_sat_table->beam_set_train_cnt[j] = 1; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Beam_Set[ %d ] training_pkt_offset = ((%d)), training_pkt_num = ((%d))\n", + j, pdm_sat_table->beam_set_train_val_diff[j], pdm_sat_table->beam_set_train_cnt[j])); + } + + pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; + pdm_sat_table->update_beam_idx = 0; + pdm_sat_table->pkt_counter = 0; + + pdm_sat_table->fast_training_beam_num = 0; + phydm_set_rfu_beam_pattern_type2(p_dm); + pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + } + +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +phydm_beam_switch_workitem_callback( + void *p_context +) +{ + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE + pdm_sat_table->pkt_skip_statistic_en = 1; +#endif + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en)); + + phydm_update_beam_pattern_type2(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE + /*odm_stall_execution(pdm_sat_table->latch_time);*/ + pdm_sat_table->pkt_skip_statistic_en = 0; +#endif + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en, pdm_sat_table->latch_time)); +} + +void +phydm_beam_decision_workitem_callback( + void *p_context +) +{ + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Beam decision Workitem Callback\n")); + phydm_fast_ant_training_hl_smart_antenna_type2(p_dm); +} +#endif + +void +phydm_process_rssi_for_hb_smtant_type2( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void, + u8 rssi_avg +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_phyinfo_struct *p_phy_info = (struct phydm_phyinfo_struct *)p_phy_info_void; + struct phydm_perpkt_info_struct *p_pktinfo = (struct phydm_perpkt_info_struct *)p_pkt_info_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u8 train_pkt_number; + u32 beam_tmp; + u8 is_cck_rate; + u8 rx_power_ant0 = p_phy_info->rx_mimo_signal_strength[0]; + u8 rx_power_ant1 = p_phy_info->rx_mimo_signal_strength[1]; + u8 rx_evm_ant0 = p_phy_info->rx_mimo_evm_dbm[0]; + u8 rx_evm_ant1 = p_phy_info->rx_mimo_evm_dbm[1]; + u8 rate_ss = phydm_rate_to_num_ss(p_dm, p_pktinfo->data_rate); + + is_cck_rate = (p_pktinfo->data_rate <= ODM_RATE11M) ? true : false; + + + /*[Beacon]*/ + if (p_pktinfo->is_packet_beacon) { + + pdm_sat_table->beacon_counter++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("MatchBSSID_beacon_counter = ((%d))\n", pdm_sat_table->beacon_counter)); + + if (pdm_sat_table->beacon_counter >= pdm_sat_table->pre_beacon_counter + 2) { + + pdm_sat_table->update_beam_idx++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("pre_beacon_counter = ((%d)), pkt_counter = ((%d)), update_beam_idx = ((%d))\n", + pdm_sat_table->pre_beacon_counter, pdm_sat_table->pkt_counter, pdm_sat_table->update_beam_idx)); + + pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; + pdm_sat_table->pkt_counter = 0; + } + } + /*[data]*/ + else if (p_pktinfo->is_packet_to_self) { + + if (pdm_sat_table->pkt_skip_statistic_en == 0) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("ID[%d] pkt_cnt=((%d)): Beam_set = ((%d)), RSSI{A,B,avg} = {%d, %d, %d}\n", + p_pktinfo->station_id, pdm_sat_table->pkt_counter, pdm_sat_table->fast_training_beam_num, rx_power_ant0, rx_power_ant1, rssi_avg)); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Rate_ss = ((%d)), EVM{A,B} = {%d, %d}, RX Rate =", rate_ss, rx_evm_ant0, rx_evm_ant1)); + phydm_print_rate(p_dm, p_dm->rx_rate, DBG_ANT_DIV); + + + if (pdm_sat_table->pkt_counter >= 1) /*packet skip count*/ + { + pdm_sat_table->beam_set_rssi_avg_sum[pdm_sat_table->fast_training_beam_num] += rssi_avg; + pdm_sat_table->statistic_pkt_cnt[pdm_sat_table->fast_training_beam_num]++; + + pdm_sat_table->beam_path_rssi_sum[pdm_sat_table->fast_training_beam_num][0] += rx_power_ant0; + pdm_sat_table->beam_path_rssi_sum[pdm_sat_table->fast_training_beam_num][1] += rx_power_ant1; + + if (rate_ss == 2) { + pdm_sat_table->beam_path_evm_2ss_sum[pdm_sat_table->fast_training_beam_num][0] += rx_evm_ant0; + pdm_sat_table->beam_path_evm_2ss_sum[pdm_sat_table->fast_training_beam_num][1] += rx_evm_ant1; + pdm_sat_table->beam_path_evm_2ss_cnt[pdm_sat_table->fast_training_beam_num]++; + } else { + pdm_sat_table->beam_path_evm_1ss_sum[pdm_sat_table->fast_training_beam_num] += rx_evm_ant0; + pdm_sat_table->beam_path_evm_1ss_cnt[pdm_sat_table->fast_training_beam_num]++; + } + } + + pdm_sat_table->pkt_counter++; + + train_pkt_number = pdm_sat_table->beam_set_train_cnt[pdm_sat_table->fast_training_beam_num]; + + if (pdm_sat_table->pkt_counter >= train_pkt_number) { + + pdm_sat_table->update_beam_idx++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("pre_beacon_counter = ((%d)), Update_new_beam = ((%d))\n", + pdm_sat_table->pre_beacon_counter, pdm_sat_table->update_beam_idx)); + + pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; + pdm_sat_table->pkt_counter = 0; + } + } + } + + if (pdm_sat_table->update_beam_idx > 0) { + + pdm_sat_table->update_beam_idx = 0; + + if (pdm_sat_table->fast_training_beam_num >= ((u32)pdm_sat_table->total_beam_set_num - 1)) { + + p_dm_fat_table->fat_state = FAT_DECISION_STATE; + + #if DEV_BUS_TYPE == RT_PCI_INTERFACE + phydm_fast_ant_training_hl_smart_antenna_type2(p_dm); /*go to make decision*/ + #else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_decision_workitem); + #endif + + + } else { + beam_tmp = pdm_sat_table->fast_training_beam_num; + pdm_sat_table->fast_training_beam_num++; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Update Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); + phydm_set_rfu_beam_pattern_type2(p_dm); + pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; + + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + } + } + +} +#endif + +#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) + +void +phydm_hl_smart_ant_type1_init_8821a( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + u32 value32; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("***8821A SmartAnt_Init => ant_div_type=[Hong-Lin Smart ant Type1]\n")); + +#if 0 + /* ---------------------------------------- */ + /* GPIO 2-3 for Beam control */ + /* reg0x66[2]=0 */ + /* reg0x44[27:26] = 0 */ + /* reg0x44[23:16] enable_output for P_GPIO[7:0] */ + /* reg0x44[15:8] output_value for P_GPIO[7:0] */ + /* reg0x40[1:0] = 0 GPIO function */ + /* ------------------------------------------ */ +#endif + + /*GPIO setting*/ + odm_set_mac_reg(p_dm, 0x64, BIT(18), 0); + odm_set_mac_reg(p_dm, 0x44, BIT(27) | BIT(26), 0); + odm_set_mac_reg(p_dm, 0x44, BIT(19) | BIT(18), 0x3); /*enable_output for P_GPIO[3:2]*/ + /*odm_set_mac_reg(p_dm, 0x44, BIT(11)|BIT(10), 0);*/ /*output value*/ + odm_set_mac_reg(p_dm, 0x40, BIT(1) | BIT(0), 0); /*GPIO function*/ + + /*Hong_lin smart antenna HW setting*/ + pdm_sat_table->rfu_codeword_total_bit_num = 24;/*max=32*/ + pdm_sat_table->rfu_each_ant_bit_num = 4; + pdm_sat_table->beam_patten_num_each_ant = 4; + +#if DEV_BUS_TYPE == RT_SDIO_INTERFACE + pdm_sat_table->latch_time = 100; /*mu sec*/ +#elif DEV_BUS_TYPE == RT_USB_INTERFACE + pdm_sat_table->latch_time = 100; /*mu sec*/ +#endif + pdm_sat_table->pkt_skip_statistic_en = 0; + + pdm_sat_table->ant_num = 1;/*max=8*/ + pdm_sat_table->ant_num_total = NUM_ANTENNA_8821A; + pdm_sat_table->first_train_ant = MAIN_ANT; + + pdm_sat_table->rfu_codeword_table[0] = 0x0; + pdm_sat_table->rfu_codeword_table[1] = 0x4; + pdm_sat_table->rfu_codeword_table[2] = 0x8; + pdm_sat_table->rfu_codeword_table[3] = 0xc; + + pdm_sat_table->rfu_codeword_table_5g[0] = 0x1; + pdm_sat_table->rfu_codeword_table_5g[1] = 0x2; + pdm_sat_table->rfu_codeword_table_5g[2] = 0x4; + pdm_sat_table->rfu_codeword_table_5g[3] = 0x8; + + pdm_sat_table->fix_beam_pattern_en = 0; + pdm_sat_table->decision_holding_period = 0; + + /*beam training setting*/ + pdm_sat_table->pkt_counter = 0; + pdm_sat_table->per_beam_training_pkt_num = 10; + + /*set default beam*/ + pdm_sat_table->fast_training_beam_num = 0; + pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; + phydm_set_all_ant_same_beam_num(p_dm); + + p_dm_fat_table->fat_state = FAT_BEFORE_LINK_STATE; + + odm_set_bb_reg(p_dm, 0xCA4, MASKDWORD, 0x01000100); + odm_set_bb_reg(p_dm, 0xCA8, MASKDWORD, 0x01000100); + + /*[BB] FAT setting*/ + odm_set_bb_reg(p_dm, 0xc08, BIT(18) | BIT(17) | BIT(16), pdm_sat_table->ant_num); + odm_set_bb_reg(p_dm, 0xc08, BIT(31), 0); /*increase ant num every FAT period 0:+1, 1+2*/ + odm_set_bb_reg(p_dm, 0x8c4, BIT(2) | BIT(1), 1); /*change cca antenna timming threshold if no CCA occurred: 0:200ms / 1:100ms / 2:no use / 3: 300*/ + odm_set_bb_reg(p_dm, 0x8c4, BIT(0), 1); /*FAT_watchdog_en*/ + + value32 = odm_get_mac_reg(p_dm, 0x7B4, MASKDWORD); + odm_set_mac_reg(p_dm, 0x7b4, MASKDWORD, value32 | (BIT(16) | BIT(17))); /*Reg7B4[16]=1 enable antenna training */ + /*Reg7B4[17]=1 enable match MAC addr*/ + odm_set_mac_reg(p_dm, 0x7b4, 0xFFFF, 0);/*Match MAC ADDR*/ + odm_set_mac_reg(p_dm, 0x7b0, MASKDWORD, 0); + +} + +u32 +phydm_construct_hl_beam_codeword( + void *p_dm_void, + u32 *beam_pattern_idx, + u32 ant_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u32 codeword = 0; + u32 data_tmp; + u32 i; + u32 break_counter = 0; + + if (ant_num < 8) { + for (i = 0; i < (pdm_sat_table->ant_num_total); i++) { + /*PHYDM_DBG(p_dm,DBG_ANT_DIV, ("beam_pattern_num[%x] = %x\n",i,beam_pattern_num[i] ));*/ + if ((i < (pdm_sat_table->first_train_ant - 1)) || (break_counter >= (pdm_sat_table->ant_num))) { + data_tmp = 0; + /**/ + } else { + + break_counter++; + + if (beam_pattern_idx[i] == 0) { + + if (*p_dm->p_band_type == ODM_BAND_5G) + data_tmp = pdm_sat_table->rfu_codeword_table_5g[0]; + else + data_tmp = pdm_sat_table->rfu_codeword_table[0]; + + } else if (beam_pattern_idx[i] == 1) { + + + if (*p_dm->p_band_type == ODM_BAND_5G) + data_tmp = pdm_sat_table->rfu_codeword_table_5g[1]; + else + data_tmp = pdm_sat_table->rfu_codeword_table[1]; + + } else if (beam_pattern_idx[i] == 2) { + + if (*p_dm->p_band_type == ODM_BAND_5G) + data_tmp = pdm_sat_table->rfu_codeword_table_5g[2]; + else + data_tmp = pdm_sat_table->rfu_codeword_table[2]; + + } else if (beam_pattern_idx[i] == 3) { + + if (*p_dm->p_band_type == ODM_BAND_5G) + data_tmp = pdm_sat_table->rfu_codeword_table_5g[3]; + else + data_tmp = pdm_sat_table->rfu_codeword_table[3]; + } + } + + + codeword |= (data_tmp << (i * 4)); + + } + } + + return codeword; +} + +void +phydm_update_beam_pattern( + void *p_dm_void, + u32 codeword, + u32 codeword_length +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u8 i; + boolean beam_ctrl_signal; + u32 one = 0x1; + u32 reg44_tmp_p, reg44_tmp_n, reg44_ori; + u8 devide_num = 4; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Set Beam Pattern =0x%x\n", codeword)); + + reg44_ori = odm_get_mac_reg(p_dm, 0x44, MASKDWORD); + reg44_tmp_p = reg44_ori; + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44_ori =0x%x\n", reg44_ori));*/ + + devide_num = (pdm_sat_table->rfu_protocol_type == 2) ? 6 : 4; + + for (i = 0; i <= (codeword_length - 1); i++) { + beam_ctrl_signal = (boolean)((codeword & BIT(i)) >> i); + + if (p_dm->debug_components & DBG_ANT_DIV) { + + if (i == (codeword_length - 1)) { + dbg_print("%d ]\n", beam_ctrl_signal); + /**/ + } else if (i == 0) { + dbg_print("Send codeword[1:%d] ---> [ %d ", codeword_length, beam_ctrl_signal); + /**/ + } else if ((i % devide_num) == (devide_num-1)) { + dbg_print("%d | ", beam_ctrl_signal); + /**/ + } else { + dbg_print("%d ", beam_ctrl_signal); + /**/ + } + } + + if (p_dm->support_ic_type == ODM_RTL8821) { + #if (RTL8821A_SUPPORT == 1) + reg44_tmp_p = reg44_ori & (~(BIT(11) | BIT(10))); /*clean bit 10 & 11*/ + reg44_tmp_p |= ((1 << 11) | (beam_ctrl_signal << 10)); + reg44_tmp_n = reg44_ori & (~(BIT(11) | BIT(10))); + + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n));*/ + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_p); + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_n); + #endif + } + #if (RTL8822B_SUPPORT == 1) + else if (p_dm->support_ic_type == ODM_RTL8822B) { + + if (pdm_sat_table->rfu_protocol_type == 2) { + + reg44_tmp_p = reg44_tmp_p & ~(BIT(8)); /*clean bit 8*/ + reg44_tmp_p = reg44_tmp_p ^ BIT(9); /*get new clk high/low, exclusive-or*/ + + + reg44_tmp_p |= (beam_ctrl_signal << 8); + + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(10); + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44 =(( 0x%x )), reg44[9:8] = ((%x)), beam_ctrl_signal =((%x))\n", reg44_tmp_p, ((reg44_tmp_p & 0x300)>>8), beam_ctrl_signal));*/ + + } else { + reg44_tmp_p = reg44_ori & (~(BIT(9) | BIT(8))); /*clean bit 9 & 8*/ + reg44_tmp_p |= ((1 << 9) | (beam_ctrl_signal << 8)); + reg44_tmp_n = reg44_ori & (~(BIT(9) | BIT(8))); + + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("reg44_tmp_p =(( 0x%x )), reg44_tmp_n = (( 0x%x ))\n", reg44_tmp_p, reg44_tmp_n)); */ + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_p); + ODM_delay_us(10); + odm_set_mac_reg(p_dm, 0x44, MASKDWORD, reg44_tmp_n); + ODM_delay_us(10); + } + } + #endif + } +} + +void +phydm_update_rx_idle_beam( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct phydm_fat_struct *p_dm_fat_table = &p_dm->dm_fat_table; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u32 i; + + pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(p_dm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Set target beam_pattern codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); + + for (i = 0; i < (pdm_sat_table->ant_num); i++) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ Update Rx-Idle-Beam ] RxIdleBeam[%d] =%d\n", i, pdm_sat_table->rx_idle_beam[i])); + /**/ + } + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + phydm_update_beam_pattern(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); +#else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_workitem); + /*odm_stall_execution(1);*/ +#endif + + pdm_sat_table->pre_codeword = pdm_sat_table->update_beam_codeword; +} + +void +phydm_hl_smart_ant_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + u32 used = *_used; + u32 out_len = *_out_len; + u32 one = 0x1; + u32 codeword_length = pdm_sat_table->rfu_codeword_total_bit_num; + u32 beam_ctrl_signal, i; + u8 devide_num = 4; + + if (dm_value[0] == 1) { /*fix beam pattern*/ + + pdm_sat_table->fix_beam_pattern_en = dm_value[1]; + + if (pdm_sat_table->fix_beam_pattern_en == 1) { + + pdm_sat_table->fix_beam_pattern_codeword = dm_value[2]; + + if (pdm_sat_table->fix_beam_pattern_codeword > (one << codeword_length)) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Codeword overflow, Current codeword is ((0x%x)), and should be less than ((%d))bit\n", + pdm_sat_table->fix_beam_pattern_codeword, codeword_length)); + + (pdm_sat_table->fix_beam_pattern_codeword) &= 0xffffff; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Auto modify to (0x%x)\n", pdm_sat_table->fix_beam_pattern_codeword)); + } + + pdm_sat_table->update_beam_codeword = pdm_sat_table->fix_beam_pattern_codeword; + + /*---------------------------------------------------------*/ + PHYDM_SNPRINTF((output + used, out_len - used, "Fix Beam Pattern\n")); + + devide_num = (pdm_sat_table->rfu_protocol_type == 2) ? 6 : 4; + + for (i = 0; i <= (codeword_length - 1); i++) { + beam_ctrl_signal = (boolean)((pdm_sat_table->update_beam_codeword & BIT(i)) >> i); + + if (i == (codeword_length - 1)) { + PHYDM_SNPRINTF((output + used, out_len - used, "%d]\n", beam_ctrl_signal)); + /**/ + } else if (i == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "Send Codeword[1:24] to RFU -> [%d", beam_ctrl_signal)); + /**/ + } else if ((i % devide_num) == (devide_num-1)) { + PHYDM_SNPRINTF((output + used, out_len - used, "%d|", beam_ctrl_signal)); + /**/ + } else { + PHYDM_SNPRINTF((output + used, out_len - used, "%d", beam_ctrl_signal)); + /**/ + } + } + /*---------------------------------------------------------*/ + + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + phydm_update_beam_pattern(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); +#else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_workitem); + /*odm_stall_execution(1);*/ +#endif + } else if (pdm_sat_table->fix_beam_pattern_en == 0) + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Smart Antenna: Enable\n")); + + } else if (dm_value[0] == 2) { /*set latch time*/ + + pdm_sat_table->latch_time = dm_value[1]; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] latch_time =0x%x\n", pdm_sat_table->latch_time)); + } else if (dm_value[0] == 3) { + + pdm_sat_table->fix_training_num_en = dm_value[1]; + + if (pdm_sat_table->fix_training_num_en == 1) { + pdm_sat_table->per_beam_training_pkt_num = (u8)dm_value[2]; + pdm_sat_table->decision_holding_period = (u8)dm_value[3]; + + PHYDM_SNPRINTF((output + used, out_len - used, "[SmartAnt][Dbg] Fix_train_en = (( %d )), train_pkt_num = (( %d )), holding_period = (( %d )),\n", + pdm_sat_table->fix_training_num_en, pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); + + } else if (pdm_sat_table->fix_training_num_en == 0) { + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] AUTO per_beam_training_pkt_num\n")); + /**/ + } + } else if (dm_value[0] == 4) { + + if (dm_value[1] == 1) { + pdm_sat_table->ant_num = 1; + pdm_sat_table->first_train_ant = MAIN_ANT; + + } else if (dm_value[1] == 2) { + pdm_sat_table->ant_num = 1; + pdm_sat_table->first_train_ant = AUX_ANT; + + } else if (dm_value[1] == 3) { + pdm_sat_table->ant_num = 2; + pdm_sat_table->first_train_ant = MAIN_ANT; + } + + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Set ant Num = (( %d )), first_train_ant = (( %d ))\n", + pdm_sat_table->ant_num, (pdm_sat_table->first_train_ant - 1))); + } else if (dm_value[0] == 5) { + + if (dm_value[1] <= 3) { + pdm_sat_table->rfu_codeword_table[dm_value[1]] = dm_value[2]; + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Set Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", + dm_value[1], dm_value[2])); + } else { + for (i = 0; i < 4; i++) { + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Show Beam_2G: (( %d )), RFU codeword table = (( 0x%x ))\n", + i, pdm_sat_table->rfu_codeword_table[i])); + } + } + } else if (dm_value[0] == 6) { + + if (dm_value[1] <= 3) { + pdm_sat_table->rfu_codeword_table_5g[dm_value[1]] = dm_value[2]; + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Set Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", + dm_value[1], dm_value[2])); + } else { + for (i = 0; i < 4; i++) { + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Show Beam_5G: (( %d )), RFU codeword table = (( 0x%x ))\n", + i, pdm_sat_table->rfu_codeword_table_5g[i])); + } + } + } else if (dm_value[0] == 7) { + + if (dm_value[1] <= 4) { + + pdm_sat_table->beam_patten_num_each_ant = dm_value[1]; + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Set Beam number = (( %d ))\n", + pdm_sat_table->beam_patten_num_each_ant)); + } else { + + PHYDM_SNPRINTF((output + used, out_len - used, "[ SmartAnt ] Show Beam number = (( %d ))\n", + pdm_sat_table->beam_patten_num_each_ant)); + } + } + *_used = used; + *_out_len = out_len; +} + + +void +phydm_set_all_ant_same_beam_num( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + + if (p_dm->ant_div_type == HL_SW_SMART_ANT_TYPE1) { /*2ant for 8821A*/ + + pdm_sat_table->rx_idle_beam[0] = pdm_sat_table->fast_training_beam_num; + pdm_sat_table->rx_idle_beam[1] = pdm_sat_table->fast_training_beam_num; + } + + pdm_sat_table->update_beam_codeword = phydm_construct_hl_beam_codeword(p_dm, &(pdm_sat_table->rx_idle_beam[0]), pdm_sat_table->ant_num); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Set all ant beam_pattern: codeword = (( 0x%x ))\n", pdm_sat_table->update_beam_codeword)); + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + phydm_update_beam_pattern(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); +#else + odm_schedule_work_item(&pdm_sat_table->hl_smart_antenna_workitem); + /*odm_stall_execution(1);*/ +#endif +} + +void +odm_fast_ant_training_hl_smart_antenna_type1( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + struct phydm_fat_struct *p_dm_fat_table = &(p_dm->dm_fat_table); + struct _sw_antenna_switch_ *p_dm_swat_table = &p_dm->dm_swat_table; + u32 codeword = 0, i, j; + u32 target_ant; + u32 avg_rssi_tmp, avg_rssi_tmp_ma; + u32 target_ant_beam_max_rssi[SUPPORT_RF_PATH_NUM] = {0}; + u32 max_beam_ant_rssi = 0; + u32 target_ant_beam[SUPPORT_RF_PATH_NUM] = {0}; + u32 beam_tmp; + u8 next_ant; + u32 rssi_sorting_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; + u32 rank_idx_seq[SUPPORT_BEAM_PATTERN_NUM] = {0}; + u32 rank_idx_out[SUPPORT_BEAM_PATTERN_NUM] = {0}; + u8 per_beam_rssi_diff_tmp = 0, training_pkt_num_offset; + u32 break_counter = 0; + u32 used_ant; + + + if (!p_dm->is_linked) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[No Link!!!]\n")); + + if (p_dm_fat_table->is_become_linked == true) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Link->no Link\n")); + p_dm_fat_table->fat_state = FAT_BEFORE_LINK_STATE; + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("change to (( %d )) FAT_state\n", p_dm_fat_table->fat_state)); + + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + return; + + } else { + if (p_dm_fat_table->is_become_linked == false) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Linked !!!]\n")); + + p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("change to (( %d )) FAT_state\n", p_dm_fat_table->fat_state)); + + /*pdm_sat_table->fast_training_beam_num = 0;*/ + /*phydm_set_all_ant_same_beam_num(p_dm);*/ + + p_dm_fat_table->is_become_linked = p_dm->is_linked; + } + } + + if (*(p_dm_fat_table->p_force_tx_ant_by_desc) == false) { + if (p_dm->is_one_entry_only == true) + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_REG); + else + odm_tx_by_tx_desc_or_reg(p_dm, TX_BY_DESC); + } + + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("HL Smart ant Training: state (( %d ))\n", p_dm_fat_table->fat_state));*/ + + /* [DECISION STATE] */ + /*=======================================================================================*/ + if (p_dm_fat_table->fat_state == FAT_DECISION_STATE) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 3. In Decision state]\n")); + phydm_fast_training_enable(p_dm, FAT_OFF); + + break_counter = 0; + /*compute target beam in each antenna*/ + for (i = (pdm_sat_table->first_train_ant - 1); i < pdm_sat_table->ant_num_total; i++) { + for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { + + if (pdm_sat_table->pkt_rssi_cnt[i][j] == 0) { + avg_rssi_tmp = pdm_sat_table->pkt_rssi_pre[i][j]; + avg_rssi_tmp = (avg_rssi_tmp >= 2) ? (avg_rssi_tmp - 2) : avg_rssi_tmp; + avg_rssi_tmp_ma = avg_rssi_tmp; + } else { + avg_rssi_tmp = (pdm_sat_table->pkt_rssi_sum[i][j]) / (pdm_sat_table->pkt_rssi_cnt[i][j]); + avg_rssi_tmp_ma = (avg_rssi_tmp + pdm_sat_table->pkt_rssi_pre[i][j]) >> 1; + } + + rssi_sorting_seq[j] = avg_rssi_tmp; + pdm_sat_table->pkt_rssi_pre[i][j] = avg_rssi_tmp; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("ant[%d], Beam[%d]: pkt_cnt=(( %d )), avg_rssi_MA=(( %d )), avg_rssi=(( %d ))\n", + i, j, pdm_sat_table->pkt_rssi_cnt[i][j], avg_rssi_tmp_ma, avg_rssi_tmp)); + + if (avg_rssi_tmp > target_ant_beam_max_rssi[i]) { + target_ant_beam[i] = j; + target_ant_beam_max_rssi[i] = avg_rssi_tmp; + } + + /*reset counter value*/ + pdm_sat_table->pkt_rssi_sum[i][j] = 0; + pdm_sat_table->pkt_rssi_cnt[i][j] = 0; + + } + pdm_sat_table->rx_idle_beam[i] = target_ant_beam[i]; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("---------> Target of ant[%d]: Beam_num-(( %d )) RSSI= ((%d))\n", + i, target_ant_beam[i], target_ant_beam_max_rssi[i])); + + /*sorting*/ + /* + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Pre]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); + */ + + /*phydm_seq_sorting(p_dm, &rssi_sorting_seq[0], &rank_idx_seq[0], &rank_idx_out[0], SUPPORT_BEAM_PATTERN_NUM);*/ + + /* + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Post]rssi_sorting_seq = [%d, %d, %d, %d]\n", rssi_sorting_seq[0], rssi_sorting_seq[1], rssi_sorting_seq[2], rssi_sorting_seq[3])); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Post]rank_idx_seq = [%d, %d, %d, %d]\n", rank_idx_seq[0], rank_idx_seq[1], rank_idx_seq[2], rank_idx_seq[3])); + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Post]rank_idx_out = [%d, %d, %d, %d]\n", rank_idx_out[0], rank_idx_out[1], rank_idx_out[2], rank_idx_out[3])); + */ + + if (target_ant_beam_max_rssi[i] > max_beam_ant_rssi) { + target_ant = i; + max_beam_ant_rssi = target_ant_beam_max_rssi[i]; + /*PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Target of ant = (( %d )) max_beam_ant_rssi = (( %d ))\n", + target_ant, max_beam_ant_rssi));*/ + } + break_counter++; + if (break_counter >= (pdm_sat_table->ant_num)) + break; + } + +#ifdef CONFIG_FAT_PATCH + break_counter = 0; + for (i = (pdm_sat_table->first_train_ant - 1); i < pdm_sat_table->ant_num_total; i++) { + for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { + + per_beam_rssi_diff_tmp = (u8)(max_beam_ant_rssi - pdm_sat_table->pkt_rssi_pre[i][j]); + pdm_sat_table->beam_train_rssi_diff[i][j] = per_beam_rssi_diff_tmp; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("ant[%d], Beam[%d]: RSSI_diff= ((%d))\n", + i, j, per_beam_rssi_diff_tmp)); + } + break_counter++; + if (break_counter >= (pdm_sat_table->ant_num)) + break; + } +#endif + + if (target_ant == 0) + target_ant = MAIN_ANT; + else if (target_ant == 1) + target_ant = AUX_ANT; + + if (pdm_sat_table->ant_num > 1) { + /* [ update RX ant ]*/ + odm_update_rx_idle_ant(p_dm, (u8)target_ant); + + /* [ update TX ant ]*/ + odm_update_tx_ant(p_dm, (u8)target_ant, (p_dm_fat_table->train_idx)); + } + + /*set beam in each antenna*/ + phydm_update_rx_idle_beam(p_dm); + + odm_ant_div_on_off(p_dm, ANTDIV_ON); + p_dm_fat_table->fat_state = FAT_PREPARE_STATE; + return; + + } + /* [TRAINING STATE] */ + else if (p_dm_fat_table->fat_state == FAT_TRAINING_STATE) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ 2. In Training state]\n")); + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("fat_beam_n = (( %d )), pre_fat_beam_n = (( %d ))\n", + pdm_sat_table->fast_training_beam_num, pdm_sat_table->pre_fast_training_beam_num)); + + if (pdm_sat_table->fast_training_beam_num > pdm_sat_table->pre_fast_training_beam_num) + + pdm_sat_table->force_update_beam_en = 0; + + else { + + pdm_sat_table->force_update_beam_en = 1; + + pdm_sat_table->pkt_counter = 0; + beam_tmp = pdm_sat_table->fast_training_beam_num; + if (pdm_sat_table->fast_training_beam_num >= (pdm_sat_table->beam_patten_num_each_ant - 1)) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Timeout Update] Beam_num (( %d )) -> (( decision ))\n", pdm_sat_table->fast_training_beam_num)); + p_dm_fat_table->fat_state = FAT_DECISION_STATE; + odm_fast_ant_training_hl_smart_antenna_type1(p_dm); + + } else { + pdm_sat_table->fast_training_beam_num++; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[Timeout Update] Beam_num (( %d )) -> (( %d ))\n", beam_tmp, pdm_sat_table->fast_training_beam_num)); + phydm_set_all_ant_same_beam_num(p_dm); + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + + } + } + pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[prepare state] Update Pre_Beam =(( %d ))\n", pdm_sat_table->pre_fast_training_beam_num)); + } + /* [Prepare state] */ + /*=======================================================================================*/ + else if (p_dm_fat_table->fat_state == FAT_PREPARE_STATE) { + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("\n\n[ 1. In Prepare state]\n")); + + if (p_dm->pre_traffic_load == (p_dm->traffic_load)) { + if (pdm_sat_table->decision_holding_period != 0) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Holding_period = (( %d )), return!!!\n", pdm_sat_table->decision_holding_period)); + pdm_sat_table->decision_holding_period--; + return; + } + } + + + /* Set training packet number*/ + if (pdm_sat_table->fix_training_num_en == 0) { + + switch (p_dm->traffic_load) { + + case TRAFFIC_HIGH: + pdm_sat_table->per_beam_training_pkt_num = 8; + pdm_sat_table->decision_holding_period = 2; + break; + case TRAFFIC_MID: + pdm_sat_table->per_beam_training_pkt_num = 6; + pdm_sat_table->decision_holding_period = 3; + break; + case TRAFFIC_LOW: + pdm_sat_table->per_beam_training_pkt_num = 3; /*ping 60000*/ + pdm_sat_table->decision_holding_period = 4; + break; + case TRAFFIC_ULTRA_LOW: + pdm_sat_table->per_beam_training_pkt_num = 1; + pdm_sat_table->decision_holding_period = 6; + break; + default: + break; + } + } + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Fix_training_en = (( %d )), training_pkt_num_base = (( %d )), holding_period = ((%d))\n", + pdm_sat_table->fix_training_num_en, pdm_sat_table->per_beam_training_pkt_num, pdm_sat_table->decision_holding_period)); + + +#ifdef CONFIG_FAT_PATCH + break_counter = 0; + for (i = (pdm_sat_table->first_train_ant - 1); i < pdm_sat_table->ant_num_total; i++) { + for (j = 0; j < (pdm_sat_table->beam_patten_num_each_ant); j++) { + + per_beam_rssi_diff_tmp = pdm_sat_table->beam_train_rssi_diff[i][j]; + training_pkt_num_offset = per_beam_rssi_diff_tmp; + + if ((pdm_sat_table->per_beam_training_pkt_num) > training_pkt_num_offset) + pdm_sat_table->beam_train_cnt[i][j] = pdm_sat_table->per_beam_training_pkt_num - training_pkt_num_offset; + else + pdm_sat_table->beam_train_cnt[i][j] = 1; + + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("ant[%d]: Beam_num-(( %d )) training_pkt_num = ((%d))\n", + i, j, pdm_sat_table->beam_train_cnt[i][j])); + } + break_counter++; + if (break_counter >= (pdm_sat_table->ant_num)) + break; + } + + + phydm_fast_training_enable(p_dm, FAT_OFF); + pdm_sat_table->pre_beacon_counter = pdm_sat_table->beacon_counter; + pdm_sat_table->update_beam_idx = 0; + + if (*p_dm->p_band_type == ODM_BAND_5G) { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Set 5G ant\n")); + /*used_ant = (pdm_sat_table->first_train_ant == MAIN_ANT) ? AUX_ANT : MAIN_ANT;*/ + used_ant = pdm_sat_table->first_train_ant; + } else { + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("Set 2.4G ant\n")); + used_ant = pdm_sat_table->first_train_ant; + } + + odm_update_rx_idle_ant(p_dm, (u8)used_ant); + +#else + /* Set training MAC addr. of target */ + odm_set_next_mac_addr_target(p_dm); + phydm_fast_training_enable(p_dm, FAT_ON); +#endif + + odm_ant_div_on_off(p_dm, ANTDIV_OFF); + pdm_sat_table->pkt_counter = 0; + pdm_sat_table->fast_training_beam_num = 0; + phydm_set_all_ant_same_beam_num(p_dm); + pdm_sat_table->pre_fast_training_beam_num = pdm_sat_table->fast_training_beam_num; + p_dm_fat_table->fat_state = FAT_TRAINING_STATE; + } + +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +void +phydm_beam_switch_workitem_callback( + void *p_context +) +{ + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + struct smt_ant_honbo *pdm_sat_table = &(p_dm->dm_sat_table); + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE + pdm_sat_table->pkt_skip_statistic_en = 1; +#endif + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Beam Switch Workitem Callback, pkt_skip_statistic_en = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en)); + + phydm_update_beam_pattern(p_dm, pdm_sat_table->update_beam_codeword, pdm_sat_table->rfu_codeword_total_bit_num); + +#if DEV_BUS_TYPE != RT_PCI_INTERFACE + /*odm_stall_execution(pdm_sat_table->latch_time);*/ + pdm_sat_table->pkt_skip_statistic_en = 0; +#endif + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("pkt_skip_statistic_en = (( %d )), latch_time = (( %d ))\n", pdm_sat_table->pkt_skip_statistic_en, pdm_sat_table->latch_time)); +} + +void +phydm_beam_decision_workitem_callback( + void *p_context +) +{ + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + PHYDM_DBG(p_dm, DBG_ANT_DIV, ("[ SmartAnt ] Beam decision Workitem Callback\n")); + odm_fast_ant_training_hl_smart_antenna_type1(p_dm); +} +#endif + + +#endif /*#ifdef CONFIG_HL_SMART_ANTENNA_TYPE1*/ + + +#endif/*#ifdef CONFIG_HL_SMART_ANTENNA*/ + + + +void +phydm_smt_ant_config( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant *p_smtant_table = &(p_dm->smtant_table); + + #if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) + + p_dm->support_ability |= ODM_BB_SMT_ANT; + p_smtant_table->smt_ant_vendor = SMTANT_CUMITEK; + p_smtant_table->smt_ant_type = 1; + #if (RTL8822B_SUPPORT == 1) + p_dm->rfe_type = SMTANT_TMP_RFE_TYPE; + #endif + #elif (defined(CONFIG_HL_SMART_ANTENNA)) + + p_dm->support_ability |= ODM_BB_SMT_ANT; + p_smtant_table->smt_ant_vendor = SMTANT_HON_BO; + + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + p_smtant_table->smt_ant_type = 1; + #endif + + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + p_smtant_table->smt_ant_type = 2; + #endif + #endif + + PHYDM_DBG(p_dm, DBG_SMT_ANT, ("[SmtAnt Config] Vendor=((%d)), Smt_ant_type =((%d))\n", + p_smtant_table->smt_ant_vendor, p_smtant_table->smt_ant_type)); +} +#endif + + +void +phydm_smt_ant_init( + void *p_dm_void +) +{ +#if (defined(CONFIG_SMART_ANTENNA)) + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct smt_ant *p_smtant_table = &(p_dm->smtant_table); + + phydm_smt_ant_config(p_dm); + + + if (p_smtant_table->smt_ant_vendor == SMTANT_CUMITEK) { + + #if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) + #if (RTL8822B_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8822B) { + phydm_cumitek_smt_ant_init_8822b(p_dm); + /**/ + } + #endif + + #if (RTL8197F_SUPPORT == 1) + if (p_dm->support_ic_type == ODM_RTL8197F) { + phydm_cumitek_smt_ant_init_8197f(p_dm); + /**/ + } + #endif + #endif /*#if (defined(CONFIG_CUMITEK_SMART_ANTENNA))*/ + + } else if (p_smtant_table->smt_ant_vendor == SMTANT_HON_BO) { + + #if (defined(CONFIG_HL_SMART_ANTENNA)) + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + if (p_dm->support_ic_type == ODM_RTL8821) { + phydm_hl_smart_ant_type1_init_8821a(p_dm); + /**/ + } + #endif + + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + if (p_dm->support_ic_type == ODM_RTL8822B) { + phydm_hl_smart_ant_type2_init_8822b(p_dm); + /**/ + } + #endif + #endif/*#if (defined(CONFIG_HL_SMART_ANTENNA))*/ + } +#endif +} + + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.h new file mode 100644 index 000000000000..98f6717d4d81 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_smt_ant.h @@ -0,0 +1,239 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __PHYDMSMTANT_H__ +#define __PHYDMSMTANT_H__ + +/*#define SMT_ANT_VERSION "1.1"*/ /*2017.03.13*/ +/*#define SMT_ANT_VERSION "1.2"*/ /*2017.03.28*/ +#define SMT_ANT_VERSION "2.0" /* Add Cumitek SmtAnt 2017.05.25*/ + +#define SMTANT_RTK 1 +#define SMTANT_HON_BO 2 +#define SMTANT_CUMITEK 3 + +#if (defined(CONFIG_SMART_ANTENNA)) + + +#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) +struct smt_ant_cumitek { + u8 tx_ant_idx[2][ODM_ASSOCIATE_ENTRY_NUM]; /*[pathA~B] [MACID 0~128]*/ + u8 rx_default_ant_idx[2]; /*[pathA~B]*/ +}; +#endif + +#if (defined(CONFIG_HL_SMART_ANTENNA)) +struct smt_ant_honbo { + u32 latch_time; + boolean pkt_skip_statistic_en; + u32 fix_beam_pattern_en; + u32 fix_training_num_en; + u32 fix_beam_pattern_codeword; + u32 update_beam_codeword; + u32 ant_num; /*number of "used" smart beam antenna*/ + u32 ant_num_total;/*number of "total" smart beam antenna*/ + u32 first_train_ant; /*decide witch antenna to train first*/ + + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE1 + u32 pkt_rssi_pre[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM];/*rssi of each path with a certain beam pattern*/ + u8 beam_train_rssi_diff[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; + u8 beam_train_cnt[SUPPORT_RF_PATH_NUM][SUPPORT_BEAM_PATTERN_NUM]; + u32 rfu_codeword_table[4]; /*2G beam truth table*/ + u32 rfu_codeword_table_5g[4]; /*5G beam truth table*/ + u32 beam_patten_num_each_ant;/*number of beam can be switched in each antenna*/ + u32 rx_idle_beam[SUPPORT_RF_PATH_NUM]; + u32 pkt_rssi_sum[8][SUPPORT_BEAM_PATTERN_NUM]; + u32 pkt_rssi_cnt[8][SUPPORT_BEAM_PATTERN_NUM]; + #endif + + u32 fast_training_beam_num;/*current training beam_set index*/ + u32 pre_fast_training_beam_num;/*pre training beam_set index*/ + u32 rfu_codeword_total_bit_num; /* total bit number of RFU protocol*/ + u32 rfu_each_ant_bit_num; /* bit number of RFU protocol for each ant*/ + u8 per_beam_training_pkt_num; + u8 decision_holding_period; + + + u32 pre_codeword; + boolean force_update_beam_en; + u32 beacon_counter; + u32 pre_beacon_counter; + u8 pkt_counter; /*packet number that each beam-set should be colected in training state*/ + u8 update_beam_idx; /*the index announce that the beam can be updated*/ + u8 rfu_protocol_type; + u16 rfu_protocol_delay_time; + + #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + RT_WORK_ITEM hl_smart_antenna_workitem; + RT_WORK_ITEM hl_smart_antenna_decision_workitem; + #endif + + + #ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 + u8 beam_set_avg_rssi_pre[SUPPORT_BEAM_SET_PATTERN_NUM]; /*avg pre_rssi of each beam set*/ + u8 beam_set_train_val_diff[SUPPORT_BEAM_SET_PATTERN_NUM]; /*rssi of a beam pattern set, ex: a set = {ant1_beam=1, ant2_beam=3}*/ + u8 beam_set_train_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; /*training pkt num of each beam set*/ + u32 beam_set_rssi_avg_sum[SUPPORT_BEAM_SET_PATTERN_NUM]; /*RSSI_sum of avg(pathA,pathB) for each beam-set)*/ + u32 beam_path_rssi_sum[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B];/*RSSI_sum of each path for each beam-set)*/ + + u8 beam_set_avg_evm_2ss_pre[SUPPORT_BEAM_SET_PATTERN_NUM]; + u32 beam_path_evm_2ss_sum[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B];/*2SS evm_sum of each path for each beam-set)*/ + u32 beam_path_evm_2ss_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; + + u8 beam_set_avg_evm_1ss_pre[SUPPORT_BEAM_SET_PATTERN_NUM]; + u32 beam_path_evm_1ss_sum[SUPPORT_BEAM_SET_PATTERN_NUM];/*1SS evm_sum of each path for each beam-set)*/ + u32 beam_path_evm_1ss_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; + + u32 statistic_pkt_cnt[SUPPORT_BEAM_SET_PATTERN_NUM]; /*statistic_pkt_cnt for SmtAnt make decision*/ + + u8 total_beam_set_num; /*number of beam set can be switched*/ + u8 total_beam_set_num_2g;/*number of beam set can be switched in 2G*/ + u8 total_beam_set_num_5g;/*number of beam set can be switched in 5G*/ + + u8 rfu_codeword_table_2g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B]; /*2G beam truth table*/ + u8 rfu_codeword_table_5g[SUPPORT_BEAM_SET_PATTERN_NUM][MAX_PATH_NUM_8822B]; /*5G beam truth table*/ + u8 rx_idle_beam_set_idx; /*the filanl decsion result*/ + #endif + + +}; +#endif /*#if (defined(CONFIG_HL_SMART_ANTENNA))*/ + +struct smt_ant { + u8 smt_ant_vendor; + u8 smt_ant_type; + u8 tx_desc_mode; /*0:3 bit mode, 1:2 bit mode*/ + #if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) + struct smt_ant_cumitek cumi_smtant_table; + #endif +}; + +#if (defined(CONFIG_CUMITEK_SMART_ANTENNA)) +void +phydm_cumitek_smt_tx_ant_update( + void *p_dm_void, + u8 tx_ant_idx_path_a, + u8 tx_ant_idx_path_b, + u32 mac_id +); + +void +phydm_cumitek_smt_rx_default_ant_update( + void *p_dm_void, + u8 rx_ant_idx_path_a, + u8 rx_ant_idx_path_b +); + +void +phydm_cumitek_smt_ant_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +#endif + + +#if (defined(CONFIG_HL_SMART_ANTENNA)) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +phydm_beam_switch_workitem_callback( + void *p_context +); + +void +phydm_beam_decision_workitem_callback( + void *p_context +); +#endif /*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ + + + +#ifdef CONFIG_HL_SMART_ANTENNA_TYPE2 +void +phydm_hl_smart_ant_type2_init_8822b( + void *p_dm_void +); + +void +phydm_update_beam_pattern_type2( + void *p_dm_void, + u32 codeword, + u32 codeword_length +); + +void +phydm_set_rfu_beam_pattern_type2( + void *p_dm_void +); + +void +phydm_hl_smart_ant_debug_type2( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +void +phydm_process_rssi_for_hb_smtant_type2( + void *p_dm_void, + void *p_phy_info_void, + void *p_pkt_info_void, + u8 rssi_avg +); + +#endif/*#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE2))*/ + + +#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1)) + +void +phydm_update_beam_pattern( + void *p_dm_void, + u32 codeword, + u32 codeword_length +); + +void +phydm_set_all_ant_same_beam_num( + void *p_dm_void +); + +void +phydm_hl_smart_ant_debug( + void *p_dm_void, + char input[][16], + u32 *_used, + char *output, + u32 *_out_len, + u32 input_num +); + +#endif/*#if (defined(CONFIG_HL_SMART_ANTENNA_TYPE1))*/ +#endif/*#if (defined(CONFIG_HL_SMART_ANTENNA))*/ +#endif/*#if (defined(CONFIG_SMART_ANTENNA))*/ + +void +phydm_smt_ant_init( + void *p_dm_void +); + +#endif \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.c new file mode 100644 index 000000000000..9c312a94477e --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.c @@ -0,0 +1,529 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 files + * ************************************************************ */ + +#include "mp_precomp.h" +#include "phydm_precomp.h" + +void +phydm_dynamicsoftmletting( + struct PHY_DM_STRUCT *p_dm +) +{ + + u32 ret_val; + +#if (RTL8822B_SUPPORT == 1) + if (*(p_dm->p_mp_mode) == false) { + if (p_dm->support_ic_type & ODM_RTL8822B) { + + if ((!p_dm->is_linked)|(p_dm->iot_table.is_linked_cmw500)) + return; + + if (true == p_dm->bsomlenabled) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("PHYDM_DynamicSoftMLSetting(): SoML has been enable, skip dynamic SoML switch\n")); + return; + } + + ret_val = odm_get_bb_reg(p_dm, 0xf8c, MASKBYTE0); + PHYDM_DBG(p_dm, ODM_COMP_API, ("PHYDM_DynamicSoftMLSetting(): Read 0xF8C = 0x%08X\n", ret_val)); + + if (ret_val < 0x16) { + PHYDM_DBG(p_dm, ODM_COMP_API, ("PHYDM_DynamicSoftMLSetting(): 0xF8C(== 0x%08X) < 0x16, enable SoML\n", ret_val)); + phydm_somlrxhp_setting(p_dm, true); + /*odm_set_bb_reg(p_dm, 0x19a8, MASKDWORD, 0xc10a0000);*/ + p_dm->bsomlenabled = true; + } + } + } +#endif + +} + +#ifdef CONFIG_ADAPTIVE_SOML +void +phydm_soml_on_off( + void *p_dm_void, + u8 swch +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &(p_dm->dm_soml_table); + + if (swch == SOML_ON) { + + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("(( Turn on )) SOML\n")); + + if (p_dm->support_ic_type == ODM_RTL8822B) + phydm_somlrxhp_setting(p_dm, true); + else if (p_dm->support_ic_type == ODM_RTL8197F) + odm_set_bb_reg(p_dm, 0x998, BIT(6), swch); + + } else if (swch == SOML_OFF) { + + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("(( Turn off )) SOML\n")); + + if (p_dm->support_ic_type == ODM_RTL8822B) + phydm_somlrxhp_setting(p_dm, false); + else if (p_dm->support_ic_type == ODM_RTL8197F) + odm_set_bb_reg(p_dm, 0x998, BIT(6), swch); + } + p_dm_soml_table->soml_on_off = swch; +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +phydm_adaptive_soml_callback( + struct timer_list *p_timer +) +{ + struct _ADAPTER *adapter = (struct _ADAPTER *)p_timer->Adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &(p_hal_data->DM_OutSrc); + struct adaptive_soml *p_dm_soml_table = &(p_dm->dm_soml_table); + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE +#if USE_WORKITEM + odm_schedule_work_item(&(p_dm_soml_table->phydm_adaptive_soml_workitem)); +#else + { + /*dbg_print("phydm_adaptive_soml-phydm_adaptive_soml_callback\n");*/ + phydm_adsl(p_dm); + } +#endif +#else + odm_schedule_work_item(&(p_dm_soml_table->phydm_adaptive_soml_workitem)); +#endif +} + +void +phydm_adaptive_soml_workitem_callback( + void *p_context +) +{ +#ifdef CONFIG_ADAPTIVE_SOML + struct _ADAPTER *p_adapter = (struct _ADAPTER *)p_context; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(p_adapter); + struct PHY_DM_STRUCT *p_dm = &(p_hal_data->DM_OutSrc); + + /*dbg_print("phydm_adaptive_soml-phydm_adaptive_soml_workitem_callback\n");*/ + phydm_adsl(p_dm); +#endif +} + +#else + +void +phydm_adaptive_soml_callback( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("******SOML_Callback******\n")); + phydm_adsl(p_dm); + +} + +#endif + + + + +void +phydm_soml_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &(p_dm->dm_soml_table); + u32 used = *_used; + u32 out_len = *_out_len; + + if (dm_value[0] == 1) { /*Turn on/off SOML*/ + p_dm_soml_table->soml_select = (u8)dm_value[1]; + + } else if (dm_value[0] == 2) { /*training number for SOML*/ + + p_dm_soml_table->soml_train_num = (u8)dm_value[1]; + PHYDM_SNPRINTF((output + used, out_len - used, "soml_train_num = ((%d))\n", p_dm_soml_table->soml_train_num)); + } else if (dm_value[0] == 3) { /*training interval for SOML*/ + + p_dm_soml_table->soml_intvl = (u8)dm_value[1]; + PHYDM_SNPRINTF((output + used, out_len - used, "soml_intvl = ((%d))\n", p_dm_soml_table->soml_intvl)); + } else if (dm_value[0] == 4) { /*function period for SOML*/ + + p_dm_soml_table->soml_period = (u8)dm_value[1]; + PHYDM_SNPRINTF((output + used, out_len - used, "soml_period = ((%d))\n", p_dm_soml_table->soml_period)); + } else if (dm_value[0] == 5) { /*delay_time for SOML*/ + + p_dm_soml_table->soml_delay_time = (u8)dm_value[1]; + PHYDM_SNPRINTF((output + used, out_len - used, "soml_delay_time = ((%d))\n", p_dm_soml_table->soml_delay_time)); + } else if (dm_value[0] == 100) { /*show parameters*/ + + PHYDM_SNPRINTF((output + used, out_len - used, "soml_train_num = ((%d))\n", p_dm_soml_table->soml_train_num)); + PHYDM_SNPRINTF((output + used, out_len - used, "soml_intvl = ((%d))\n", p_dm_soml_table->soml_intvl)); + PHYDM_SNPRINTF((output + used, out_len - used, "soml_period = ((%d))\n", p_dm_soml_table->soml_period)); + PHYDM_SNPRINTF((output + used, out_len - used, "soml_delay_time = ((%d))\n", p_dm_soml_table->soml_delay_time)); + } + *_used = used; + *_out_len = out_len; +} + +void +phydm_soml_statistics( + void *p_dm_void, + u8 on_off_state + +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &(p_dm->dm_soml_table); + + u8 i; + u32 num_bytes_diff; + + if (p_dm->support_ic_type == ODM_RTL8197F) { + if (on_off_state == SOML_ON) { + for (i = 0; i < HT_RATE_IDX; i++) { + num_bytes_diff = p_dm_soml_table->num_ht_bytes[i] - p_dm_soml_table->pre_num_ht_bytes[i]; + p_dm_soml_table->num_ht_bytes_on[i] += num_bytes_diff; + p_dm_soml_table->pre_num_ht_bytes[i] = p_dm_soml_table->num_ht_bytes[i]; + } + } else if (on_off_state == SOML_OFF) { + for (i = 0; i < HT_RATE_IDX; i++) { + num_bytes_diff = p_dm_soml_table->num_ht_bytes[i] - p_dm_soml_table->pre_num_ht_bytes[i]; + p_dm_soml_table->num_ht_bytes_off[i] += num_bytes_diff; + p_dm_soml_table->pre_num_ht_bytes[i] = p_dm_soml_table->num_ht_bytes[i]; + } + } + } else if (p_dm->support_ic_type == ODM_RTL8822B) { + if (on_off_state == SOML_ON) { + for (i = 0; i < VHT_RATE_IDX; i++) { + num_bytes_diff = p_dm_soml_table->num_vht_bytes[i] - p_dm_soml_table->pre_num_vht_bytes[i]; + p_dm_soml_table->num_vht_bytes_on[i] += num_bytes_diff; + p_dm_soml_table->pre_num_vht_bytes[i] = p_dm_soml_table->num_vht_bytes[i]; + } + } else if (on_off_state == SOML_OFF) { + for (i = 0; i < VHT_RATE_IDX; i++) { + num_bytes_diff = p_dm_soml_table->num_vht_bytes[i] - p_dm_soml_table->pre_num_vht_bytes[i]; + p_dm_soml_table->num_vht_bytes_off[i] += num_bytes_diff; + p_dm_soml_table->pre_num_vht_bytes[i] = p_dm_soml_table->num_vht_bytes[i]; + } + } + } +} + +void +phydm_adsl( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &(p_dm->dm_soml_table); + + u8 i; + u8 next_on_off; + u8 rate_num = 1, rate_ss_shift = 0; + u32 byte_total_on = 0, byte_total_off = 0; + u32 ht_reset[HT_RATE_IDX] = {0}, vht_reset[VHT_RATE_IDX] = {0}; + u8 size = sizeof(ht_reset[0]); + + if (p_dm->support_ic_type & ODM_IC_4SS) + rate_num = 4; + else if (p_dm->support_ic_type & ODM_IC_3SS) + rate_num = 3; + else if (p_dm->support_ic_type & ODM_IC_2SS) + rate_num = 2; + + if ((p_dm->support_ic_type & ODM_ADAPTIVE_SOML_SUPPORT_IC)) { + if (p_dm->number_active_client == 1) { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("rssi_min =%d\n", p_dm->rssi_min)); + if ((p_dm->rssi_min >= SOML_RSSI_TH_HIGH) || (p_dm_soml_table->is_soml_method_enable == 1)) { + + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("> TH_H || is_soml_method_enable==1\n")); + + if (p_dm->rssi_min >= SOML_RSSI_TH_LOW) { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("> TH_L, soml_state_cnt =((%d))\n", p_dm_soml_table->soml_state_cnt)); + /*Traning state: 0(alt) 1(ori) 2(alt) 3(ori)============================================================*/ + if (p_dm_soml_table->soml_state_cnt < ((p_dm_soml_table->soml_train_num)<<1)) { + + if (p_dm_soml_table->soml_state_cnt == 0) { + + if (p_dm->support_ic_type == ODM_RTL8197F) { + + odm_move_memory(p_dm, p_dm_soml_table->num_ht_bytes, ht_reset, HT_RATE_IDX*size); + odm_move_memory(p_dm, p_dm_soml_table->num_ht_bytes_on, ht_reset, HT_RATE_IDX*size); + odm_move_memory(p_dm, p_dm_soml_table->num_ht_bytes_off, ht_reset, HT_RATE_IDX*size); + } else if (p_dm->support_ic_type == ODM_RTL8822B) { + + odm_move_memory(p_dm, p_dm_soml_table->num_vht_bytes, vht_reset, VHT_RATE_IDX*size); + odm_move_memory(p_dm, p_dm_soml_table->num_vht_bytes_on, vht_reset, VHT_RATE_IDX*size); + odm_move_memory(p_dm, p_dm_soml_table->num_vht_bytes_off, vht_reset, VHT_RATE_IDX*size); + } + + p_dm_soml_table->is_soml_method_enable = 1; + p_dm_soml_table->soml_state_cnt++; + next_on_off = (p_dm_soml_table->soml_on_off == SOML_ON) ? SOML_ON : SOML_OFF; + phydm_soml_on_off(p_dm, next_on_off); + odm_set_timer(p_dm, &p_dm_soml_table->phydm_adaptive_soml_timer, p_dm_soml_table->soml_delay_time); /*ms*/ + } else if ((p_dm_soml_table->soml_state_cnt % 2) != 0) { + + p_dm_soml_table->soml_state_cnt++; + if (p_dm->support_ic_type == ODM_RTL8197F) + odm_move_memory(p_dm, p_dm_soml_table->pre_num_ht_bytes, p_dm_soml_table->num_ht_bytes, HT_RATE_IDX*size); + else if (p_dm->support_ic_type == ODM_RTL8822B) + odm_move_memory(p_dm, p_dm_soml_table->pre_num_vht_bytes, p_dm_soml_table->num_vht_bytes, VHT_RATE_IDX*size); + odm_set_timer(p_dm, &p_dm_soml_table->phydm_adaptive_soml_timer, p_dm_soml_table->soml_intvl); /*ms*/ + } else if ((p_dm_soml_table->soml_state_cnt % 2) == 0) { + + p_dm_soml_table->soml_state_cnt++; + phydm_soml_statistics(p_dm, p_dm_soml_table->soml_on_off); + next_on_off = (p_dm_soml_table->soml_on_off == SOML_ON) ? SOML_OFF : SOML_ON; + phydm_soml_on_off(p_dm, next_on_off); + odm_set_timer(p_dm, &p_dm_soml_table->phydm_adaptive_soml_timer, p_dm_soml_table->soml_delay_time); /*ms*/ + } + } + /*Decision state: ==============================================================*/ + else { + + p_dm_soml_table->soml_state_cnt = 0; + phydm_soml_statistics(p_dm, p_dm_soml_table->soml_on_off); + + /* [Search 1st and 2ed rate by counter] */ + if (p_dm->support_ic_type == ODM_RTL8197F) { + + for (i = 0; i < rate_num; i++) { + rate_ss_shift = (i << 3); + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("*num_ht_bytes_on HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (rate_ss_shift), (rate_ss_shift+7), + p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 0], p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 1], + p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 2], p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 3], + p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 4], p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 5], + p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 6], p_dm_soml_table->num_ht_bytes_on[rate_ss_shift + 7])); + } + + for (i = 0; i < rate_num; i++) { + rate_ss_shift = (i << 3); + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("*num_ht_bytes_off HT MCS[%d :%d ] = {%d, %d, %d, %d, %d, %d, %d, %d}\n", + (rate_ss_shift), (rate_ss_shift+7), + p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 0], p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 1], + p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 2], p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 3], + p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 4], p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 5], + p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 6], p_dm_soml_table->num_ht_bytes_off[rate_ss_shift + 7])); + } + + for (i = 0; i < HT_RATE_IDX; i++) { + + byte_total_on += p_dm_soml_table->num_vht_bytes_on[i]; + byte_total_off += p_dm_soml_table->num_vht_bytes_off[i]; + } + + } else if (p_dm->support_ic_type == ODM_RTL8822B) { + + for (i = 0; i < rate_num; i++) { + rate_ss_shift = 10 * i; + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("* num_vht_bytes_on VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 0], p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 1], + p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 2], p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 3], + p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 4], p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 5], + p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 6], p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 7], + p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 8], p_dm_soml_table->num_vht_bytes_on[rate_ss_shift + 9])); + } + + for (i = 0; i < rate_num; i++) { + rate_ss_shift = 10 * i; + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("* num_vht_bytes_off VHT-%d ss MCS[0:9] = {%d, %d, %d, %d, %d, %d, %d, %d, %d, %d}\n", + (i + 1), + p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 0], p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 1], + p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 2], p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 3], + p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 4], p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 5], + p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 6], p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 7], + p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 8], p_dm_soml_table->num_vht_bytes_off[rate_ss_shift + 9])); + } + for (i = 0; i < VHT_RATE_IDX; i++) { + byte_total_on += p_dm_soml_table->num_vht_bytes_on[i]; + byte_total_off += p_dm_soml_table->num_vht_bytes_off[i]; + } + } + + /* [Decision] */ + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[ byte_total_on = %d ; byte_total_off = %d ]\n", byte_total_on, byte_total_off)); + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[Decisoin state ]\n")); + if (byte_total_on > byte_total_off) { + next_on_off = SOML_ON; + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[ byte_total_on > byte_total_off ==> SOML_ON ]\n")); + } else if (byte_total_on < byte_total_off) { + next_on_off = SOML_OFF; + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[ byte_total_on < byte_total_off ==> SOML_OFF ]\n")); + } else { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[ stay at soml_last_state ]\n")); + next_on_off = p_dm_soml_table->soml_last_state; + } + + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[ Final decisoin ] : ")); + phydm_soml_on_off(p_dm, next_on_off); + p_dm_soml_table->soml_last_state = next_on_off; + } + } else { /* RSSI< = SOML_RSSI_TH_LOW */ + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[ TH_L ]\n")); + phydm_adaptive_soml_reset(p_dm); + phydm_soml_on_off(p_dm, SOML_ON); + } + } else { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[escape from > TH_H || is_soml_method_enable==1]\n")); + phydm_adaptive_soml_reset(p_dm); + phydm_soml_on_off(p_dm, SOML_ON); + } + } else { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[multi-Client]\n")); + phydm_adaptive_soml_reset(p_dm); + phydm_soml_on_off(p_dm, SOML_ON); + } + } +} + +void +phydm_adaptive_soml_reset( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &p_dm->dm_soml_table; + + p_dm_soml_table->soml_state_cnt = 0; + p_dm_soml_table->is_soml_method_enable = 0; + p_dm_soml_table->soml_counter = 0; +} + +#endif /* end of CONFIG_ADAPTIVE_SOML*/ + +void +phydm_adaptive_soml_timers( + void *p_dm_void, + u8 state +) +{ +#ifdef CONFIG_ADAPTIVE_SOML + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &p_dm->dm_soml_table; + + if (state == INIT_SOML_TIMMER) { + odm_initialize_timer(p_dm, &p_dm_soml_table->phydm_adaptive_soml_timer, + (void *)phydm_adaptive_soml_callback, NULL, "phydm_adaptive_soml_timer"); + } else if (state == CANCEL_SOML_TIMMER) { + odm_cancel_timer(p_dm, &p_dm_soml_table->phydm_adaptive_soml_timer); + } else if (state == RELEASE_SOML_TIMMER) { + odm_release_timer(p_dm, &p_dm_soml_table->phydm_adaptive_soml_timer); + } +#endif +} + +void +phydm_adaptive_soml_init( + void *p_dm_void +) +{ +#ifdef CONFIG_ADAPTIVE_SOML + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &p_dm->dm_soml_table; + + if (!(p_dm->support_ability & ODM_BB_ADAPTIVE_SOML)) { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[Return] Not Support Adaptive SOML\n")); + return; + } + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("phydm_adaptive_soml_init\n")); + + p_dm_soml_table->soml_state_cnt = 0; + p_dm_soml_table->soml_delay_time = 40; + p_dm_soml_table->soml_intvl = 150; + p_dm_soml_table->soml_train_num = 4; + p_dm_soml_table->is_soml_method_enable = 0; + p_dm_soml_table->soml_counter = 0; + p_dm_soml_table->soml_period = 4; + p_dm_soml_table->soml_select = 0; +#endif +} + +void +phydm_adaptive_soml( + void *p_dm_void +) +{ +#ifdef CONFIG_ADAPTIVE_SOML + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct adaptive_soml *p_dm_soml_table = &p_dm->dm_soml_table; + + if (!(p_dm->support_ability & ODM_BB_ADAPTIVE_SOML)) { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, + ("[Return!!!] Not Support Adaptive SOML Function\n")); + return; + } + + if (p_dm_soml_table->soml_counter < p_dm_soml_table->soml_period) { + p_dm_soml_table->soml_counter++; + return; + } + p_dm_soml_table->soml_counter = 0; + + + if (p_dm_soml_table->soml_select == 0) { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[Adaptive SOML Training !!!]\n")); + } else if (p_dm_soml_table->soml_select == 1) { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[Turn on SOML !!!] Exit from Adaptive SOML Training\n")); + phydm_soml_on_off(p_dm, SOML_ON); + return; + } else if (p_dm_soml_table->soml_select == 2) { + PHYDM_DBG(p_dm, DBG_ADPTV_SOML, ("[Turn off SOML !!!] Exit from Adaptive SOML Training\n")); + phydm_soml_on_off(p_dm, SOML_OFF); + return; + } + + phydm_adsl(p_dm); + +#endif +} + +void +phydm_init_soft_ml_setting( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + +#if (RTL8822B_SUPPORT == 1) + if (*(p_dm->p_mp_mode) == false) { + if (p_dm->support_ic_type & ODM_RTL8822B) + /*odm_set_bb_reg(p_dm, 0x19a8, MASKDWORD, 0xd10a0000);*/ + phydm_somlrxhp_setting(p_dm, true); + p_dm->bsomlenabled = true; + } +#endif +#if (RTL8821C_SUPPORT == 1) + if (*(p_dm->p_mp_mode) == false) { + if (p_dm->support_ic_type & ODM_RTL8821C) + odm_set_bb_reg(p_dm, 0x19a8, BIT(31)|BIT(30)|BIT(29)|BIT(28), 0xd); + } +#endif +} + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.h new file mode 100644 index 000000000000..da86bd493a30 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_soml.h @@ -0,0 +1,148 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __PHYDMSOML_H__ +#define __PHYDMSOML_H__ + +#define ADAPTIVE_SOML_VERSION "1.0" + +#define ODM_ADAPTIVE_SOML_SUPPORT_IC (ODM_RTL8822B | ODM_RTL8197F) + +#define INIT_SOML_TIMMER 0 +#define CANCEL_SOML_TIMMER 1 +#define RELEASE_SOML_TIMMER 2 + +#define SOML_RSSI_TH_HIGH 25 +#define SOML_RSSI_TH_LOW 20 + +#define HT_RATE_IDX 32 +#define VHT_RATE_IDX 40 + +#define SOML_ON 1 +#define SOML_OFF 0 + +#ifdef CONFIG_ADAPTIVE_SOML + +struct adaptive_soml { + boolean is_soml_method_enable; + u8 soml_on_off; + u8 soml_state_cnt; + u8 soml_delay_time; + u8 soml_intvl; + u8 soml_train_num; + u8 soml_counter; + u8 soml_period; + u8 soml_select; + u8 soml_last_state; + u32 num_ht_bytes[HT_RATE_IDX]; + u32 pre_num_ht_bytes[HT_RATE_IDX]; + u32 num_ht_bytes_on[HT_RATE_IDX]; + u32 num_ht_bytes_off[HT_RATE_IDX]; + #if ODM_IC_11AC_SERIES_SUPPORT + u32 num_vht_bytes[VHT_RATE_IDX]; + u32 pre_num_vht_bytes[VHT_RATE_IDX]; + u32 num_vht_bytes_on[VHT_RATE_IDX]; + u32 num_vht_bytes_off[VHT_RATE_IDX]; + #endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +#if USE_WORKITEM + RT_WORK_ITEM phydm_adaptive_soml_workitem; +#endif +#endif + struct timer_list phydm_adaptive_soml_timer; + +}; + +void +phydm_dynamicsoftmletting( + struct PHY_DM_STRUCT *p_dm +); + +void +phydm_soml_on_off( + void *p_dm_void, + u8 swch +); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +phydm_adaptive_soml_callback( + struct timer_list *p_timer +); + +void +phydm_adaptive_soml_workitem_callback( + void *p_context +); + +#else + +void +phydm_adaptive_soml_callback( + void *p_dm_void +); + +#endif + +void +phydm_soml_debug( + void *p_dm_void, + u32 *const dm_value, + u32 *_used, + char *output, + u32 *_out_len +); + +void +phydm_soml_statistics( + void *p_dm_void, + u8 on_off_state + +); + +void +phydm_adsl( + void *p_dm_void +); + +void +phydm_adaptive_soml_reset( + void *p_dm_void +); + +#endif + +void +phydm_adaptive_soml_timers( + void *p_dm_void, + u8 state +); + +void +phydm_adaptive_soml_init( + void *p_dm_void +); + +void +phydm_adaptive_soml( + void *p_dm_void +); + +void +phydm_init_soft_ml_setting( + void *p_dm_void +); + +#endif /*#ifndef __PHYDMSOML_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_types.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_types.h index a5382fb9c07e..2565cf37921e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_types.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/phydm_types.h @@ -1,261 +1,260 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ -#ifndef __ODM_TYPES_H__ -#define __ODM_TYPES_H__ - - -/*Define Different SW team support*/ -#define ODM_AP 0x01 /*BIT0*/ -#define ODM_CE 0x04 /*BIT2*/ -#define ODM_WIN 0x08 /*BIT3*/ -#define ODM_ADSL 0x10 /*BIT4*/ -#define ODM_IOT 0x20 /*BIT5*/ - -/*Deifne HW endian support*/ -#define ODM_ENDIAN_BIG 0 -#define ODM_ENDIAN_LITTLE 1 - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->DM_OutSrc))) -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) -#define GET_PDM_ODM(__pAdapter) ((PDM_ODM_T)(&((GET_HAL_DATA(__pAdapter))->odmpriv))) -#endif - -#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) -#define RT_PCI_INTERFACE 1 -#define RT_USB_INTERFACE 2 -#define RT_SDIO_INTERFACE 3 -#endif - -typedef enum _HAL_STATUS{ - HAL_STATUS_SUCCESS, - HAL_STATUS_FAILURE, - /*RT_STATUS_PENDING, - RT_STATUS_RESOURCE, - RT_STATUS_INVALID_CONTEXT, - RT_STATUS_INVALID_PARAMETER, - RT_STATUS_NOT_SUPPORT, - RT_STATUS_OS_API_FAILED,*/ -}HAL_STATUS,*PHAL_STATUS; - -#if( DM_ODM_SUPPORT_TYPE == ODM_AP) -#define MP_DRIVER 0 -#endif -#if(DM_ODM_SUPPORT_TYPE != ODM_WIN) - -#define VISTA_USB_RX_REVISE 0 - -// -// Declare for ODM spin lock defintion temporarily fro compile pass. -// -typedef enum _RT_SPINLOCK_TYPE{ - RT_TX_SPINLOCK = 1, - RT_RX_SPINLOCK = 2, - RT_RM_SPINLOCK = 3, - RT_CAM_SPINLOCK = 4, - RT_SCAN_SPINLOCK = 5, - RT_LOG_SPINLOCK = 7, - RT_BW_SPINLOCK = 8, - RT_CHNLOP_SPINLOCK = 9, - RT_RF_OPERATE_SPINLOCK = 10, - RT_INITIAL_SPINLOCK = 11, - RT_RF_STATE_SPINLOCK = 12, // For RF state. Added by Bruce, 2007-10-30. -#if VISTA_USB_RX_REVISE - RT_USBRX_CONTEXT_SPINLOCK = 13, - RT_USBRX_POSTPROC_SPINLOCK = 14, // protect data of Adapter->IndicateW/ IndicateR -#endif - //Shall we define Ndis 6.2 SpinLock Here ? - RT_PORT_SPINLOCK=16, - RT_VNIC_SPINLOCK=17, - RT_HVL_SPINLOCK=18, - RT_H2C_SPINLOCK = 20, // For H2C cmd. Added by tynli. 2009.11.09. - - RT_BTData_SPINLOCK=25, - - RT_WAPI_OPTION_SPINLOCK=26, - RT_WAPI_RX_SPINLOCK=27, - - // add for 92D CCK control issue - RT_CCK_PAGEA_SPINLOCK = 28, - RT_BUFFER_SPINLOCK = 29, - RT_CHANNEL_AND_BANDWIDTH_SPINLOCK = 30, - RT_GEN_TEMP_BUF_SPINLOCK = 31, - RT_AWB_SPINLOCK = 32, - RT_FW_PS_SPINLOCK = 33, - RT_HW_TIMER_SPIN_LOCK = 34, - RT_MPT_WI_SPINLOCK = 35, - RT_P2P_SPIN_LOCK = 36, // Protect P2P context - RT_DBG_SPIN_LOCK = 37, - RT_IQK_SPINLOCK = 38, - RT_PENDED_OID_SPINLOCK = 39, - RT_CHNLLIST_SPINLOCK = 40, - RT_INDIC_SPINLOCK = 41, //protect indication - RT_RFD_SPINLOCK = 42, - RT_SYNC_IO_CNT_SPINLOCK = 43, - RT_LAST_SPINLOCK, -}RT_SPINLOCK_TYPE; - -#endif - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - #define STA_INFO_T RT_WLAN_STA - #define PSTA_INFO_T PRT_WLAN_STA - #define __func__ __FUNCTION__ - #define PHYDM_TESTCHIP_SUPPORT TESTCHIP_SUPPORT - #define bMaskH3Bytes 0xffffff00 - #define SUCCESS 0 - #define FAIL (-1) - -#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) - - // To let ADSL/AP project compile ok; it should be removed after all conflict are solved. Added by Annie, 2011-10-07. - #define ADSL_AP_BUILD_WORKAROUND - #define AP_BUILD_WORKAROUND - - #ifdef AP_BUILD_WORKAROUND - #include "../typedef.h" - #else - typedef void VOID,*PVOID; - typedef unsigned char BOOLEAN,*PBOOLEAN; - typedef unsigned char u1Byte,*pu1Byte; - typedef unsigned short u2Byte,*pu2Byte; - typedef unsigned int u4Byte,*pu4Byte; - typedef unsigned long long u8Byte,*pu8Byte; -#if 1 -/* In ARM platform, system would use the type -- "char" as "unsigned char" - * And we only use s1Byte/ps1Byte as INT8 now, so changes the type of s1Byte.*/ - typedef signed char s1Byte,*ps1Byte; -#else - typedef char s1Byte,*ps1Byte; -#endif - typedef short s2Byte,*ps2Byte; - typedef long s4Byte,*ps4Byte; - typedef long long s8Byte,*ps8Byte; - #endif - - typedef struct rtl8192cd_priv *prtl8192cd_priv; - typedef struct stat_info STA_INFO_T,*PSTA_INFO_T; - typedef struct timer_list RT_TIMER, *PRT_TIMER; - typedef void * RT_TIMER_CALL_BACK; - -#ifdef CONFIG_PCI_HCI - #define DEV_BUS_TYPE RT_PCI_INTERFACE -#endif - - #define _TRUE 1 - #define _FALSE 0 - - #if (defined(TESTCHIP_SUPPORT)) - #define PHYDM_TESTCHIP_SUPPORT 1 - #else - #define PHYDM_TESTCHIP_SUPPORT 0 - #endif - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - #include -#if 0 - typedef u8 u1Byte, *pu1Byte; - typedef u16 u2Byte,*pu2Byte; - typedef u32 u4Byte,*pu4Byte; - typedef u64 u8Byte,*pu8Byte; - typedef s8 s1Byte,*ps1Byte; - typedef s16 s2Byte,*ps2Byte; - typedef s32 s4Byte,*ps4Byte; - typedef s64 s8Byte,*ps8Byte; -#else - #define u1Byte u8 - #define pu1Byte u8* - - #define u2Byte u16 - #define pu2Byte u16* - - #define u4Byte u32 - #define pu4Byte u32* - - #define u8Byte u64 - #define pu8Byte u64* - - #define s1Byte s8 - #define ps1Byte s8* - - #define s2Byte s16 - #define ps2Byte s16* - - #define s4Byte s32 - #define ps4Byte s32* - - #define s8Byte s64 - #define ps8Byte s64* - -#endif - #ifdef CONFIG_USB_HCI - #define DEV_BUS_TYPE RT_USB_INTERFACE - #elif defined(CONFIG_PCI_HCI) - #define DEV_BUS_TYPE RT_PCI_INTERFACE - #elif defined(CONFIG_SDIO_HCI) - #define DEV_BUS_TYPE RT_SDIO_INTERFACE - #elif defined(CONFIG_GSPI_HCI) - #define DEV_BUS_TYPE RT_SDIO_INTERFACE - #endif - - - #if defined(CONFIG_LITTLE_ENDIAN) - #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE - #elif defined (CONFIG_BIG_ENDIAN) - #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG - #endif - - typedef struct timer_list RT_TIMER, *PRT_TIMER; - typedef void * RT_TIMER_CALL_BACK; - #define STA_INFO_T struct sta_info - #define PSTA_INFO_T struct sta_info * - - - - #define TRUE _TRUE - #define FALSE _FALSE - - - #define SET_TX_DESC_ANTSEL_A_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 24, 1, __Value) - #define SET_TX_DESC_ANTSEL_B_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+8, 25, 1, __Value) - #define SET_TX_DESC_ANTSEL_C_88E(__pTxDesc, __Value) SET_BITS_TO_LE_4BYTE(__pTxDesc+28, 29, 1, __Value) - - //define useless flag to avoid compile warning - #define USE_WORKITEM 0 - #define FOR_BRAZIL_PRETEST 0 - #define FPGA_TWO_MAC_VERIFICATION 0 - #define RTL8881A_SUPPORT 0 - - #if (defined(TESTCHIP_SUPPORT)) - #define PHYDM_TESTCHIP_SUPPORT 1 - #else - #define PHYDM_TESTCHIP_SUPPORT 0 - #endif -#endif - -#define READ_NEXT_PAIR(v1, v2, i) do { if (i+2 >= ArrayLen) break; i += 2; v1 = Array[i]; v2 = Array[i+1]; } while(0) -#define COND_ELSE 2 -#define COND_ENDIF 3 - -#include "phydm_features.h" - -#endif // __ODM_TYPES_H__ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __ODM_TYPES_H__ +#define __ODM_TYPES_H__ + + +/*Define Different SW team support*/ +#define ODM_AP 0x01 /*BIT(0)*/ +#define ODM_CE 0x04 /*BIT(2)*/ +#define ODM_WIN 0x08 /*BIT(3)*/ +#define ODM_ADSL 0x10 /*BIT(4)*/ /*already combine with ODM_AP, and is nouse now*/ +#define ODM_IOT 0x20 /*BIT(5)*/ + +/*For FW API*/ +#define __iram_odm_func__ + +/*Deifne HW endian support*/ +#define ODM_ENDIAN_BIG 0 +#define ODM_ENDIAN_LITTLE 1 + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define GET_PDM_ODM(__padapter) ((struct PHY_DM_STRUCT*)(&((GET_HAL_DATA(__padapter))->DM_OutSrc))) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #define GET_PDM_ODM(__padapter) ((struct PHY_DM_STRUCT*)(&((GET_HAL_DATA(__padapter))->odmpriv))) +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #define GET_PDM_ODM(__padapter) ((struct PHY_DM_STRUCT*)(&(__padapter->pshare->_dmODM))) +#endif + +#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) + #define RT_PCI_INTERFACE 1 + #define RT_USB_INTERFACE 2 + #define RT_SDIO_INTERFACE 3 +#endif + +enum hal_status { + HAL_STATUS_SUCCESS, + HAL_STATUS_FAILURE, + /*RT_STATUS_PENDING, + RT_STATUS_RESOURCE, + RT_STATUS_INVALID_CONTEXT, + RT_STATUS_INVALID_PARAMETER, + RT_STATUS_NOT_SUPPORT, + RT_STATUS_OS_API_FAILED,*/ +}; + +#if (DM_ODM_SUPPORT_TYPE != ODM_WIN) + +#define VISTA_USB_RX_REVISE 0 + +/* + * Declare for ODM spin lock defintion temporarily fro compile pass. + * */ +enum rt_spinlock_type { + RT_TX_SPINLOCK = 1, + RT_RX_SPINLOCK = 2, + RT_RM_SPINLOCK = 3, + RT_CAM_SPINLOCK = 4, + RT_SCAN_SPINLOCK = 5, + RT_LOG_SPINLOCK = 7, + RT_BW_SPINLOCK = 8, + RT_CHNLOP_SPINLOCK = 9, + RT_RF_OPERATE_SPINLOCK = 10, + RT_INITIAL_SPINLOCK = 11, + RT_RF_STATE_SPINLOCK = 12, /* For RF state. Added by Bruce, 2007-10-30. */ +#if VISTA_USB_RX_REVISE + RT_USBRX_CONTEXT_SPINLOCK = 13, + RT_USBRX_POSTPROC_SPINLOCK = 14, /* protect data of adapter->IndicateW/ IndicateR */ +#endif + /* Shall we define Ndis 6.2 SpinLock Here ? */ + RT_PORT_SPINLOCK = 16, + RT_VNIC_SPINLOCK = 17, + RT_HVL_SPINLOCK = 18, + RT_H2C_SPINLOCK = 20, /* For H2C cmd. Added by tynli. 2009.11.09. */ + + rt_bt_data_spinlock = 25, + + RT_WAPI_OPTION_SPINLOCK = 26, + RT_WAPI_RX_SPINLOCK = 27, + + /* add for 92D CCK control issue */ + RT_CCK_PAGEA_SPINLOCK = 28, + RT_BUFFER_SPINLOCK = 29, + RT_CHANNEL_AND_BANDWIDTH_SPINLOCK = 30, + RT_GEN_TEMP_BUF_SPINLOCK = 31, + RT_AWB_SPINLOCK = 32, + RT_FW_PS_SPINLOCK = 33, + RT_HW_TIMER_SPIN_LOCK = 34, + RT_MPT_WI_SPINLOCK = 35, + RT_P2P_SPIN_LOCK = 36, /* Protect P2P context */ + RT_DBG_SPIN_LOCK = 37, + RT_IQK_SPINLOCK = 38, + RT_PENDED_OID_SPINLOCK = 39, + RT_CHNLLIST_SPINLOCK = 40, + RT_INDIC_SPINLOCK = 41, /* protect indication */ + RT_RFD_SPINLOCK = 42, + RT_SYNC_IO_CNT_SPINLOCK = 43, + RT_LAST_SPINLOCK, +}; + +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define sta_info _RT_WLAN_STA + #define __func__ __FUNCTION__ + #define PHYDM_TESTCHIP_SUPPORT TESTCHIP_SUPPORT + #define MASKH3BYTES 0xffffff00 + #define SUCCESS 0 + #define FAIL (-1) + + #define u8 u1Byte + #define s8 s1Byte + + #define u16 u2Byte + #define s16 s2Byte + + #define u32 u4Byte + #define s32 s4Byte + + #define u64 u8Byte + #define s64 s8Byte + + #define timer_list _RT_TIMER + + +#elif (DM_ODM_SUPPORT_TYPE == ODM_AP) + #include "../typedef.h" + + #ifdef CONFIG_PCI_HCI + #define DEV_BUS_TYPE RT_PCI_INTERFACE + #endif + + #if (defined(TESTCHIP_SUPPORT)) + #define PHYDM_TESTCHIP_SUPPORT 1 + #else + #define PHYDM_TESTCHIP_SUPPORT 0 + #endif + + #define sta_info stat_info + #define boolean bool + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) && defined(DM_ODM_CE_MAC80211) + + #include + + #define DEV_BUS_TYPE RT_PCI_INTERFACE + + #if defined(__LITTLE_ENDIAN) + #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE + #elif defined(__BIG_ENDIAN) + #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG + #else + #error + #endif + + /* define useless flag to avoid compile warning */ + #define USE_WORKITEM 0 + #define FOR_BRAZIL_PRETEST 0 + #define FPGA_TWO_MAC_VERIFICATION 0 + #define RTL8881A_SUPPORT 0 + #define PHYDM_TESTCHIP_SUPPORT 0 + + /* support list */ + #define RTL8188E_SUPPORT 0 + #define RTL8812A_SUPPORT 0 + #define RTL8821A_SUPPORT 0 + #define RTL8723B_SUPPORT 0 + #define RTL8723D_SUPPORT 0 + #define RTL8192E_SUPPORT 0 + #define RTL8814A_SUPPORT 0 + #define RTL8195A_SUPPORT 0 + #define RTL8197F_SUPPORT 0 + #define RTL8703B_SUPPORT 0 + #define RTL8188F_SUPPORT 0 + #define RTL8822B_SUPPORT 1 + #define RTL8821B_SUPPORT 0 + #define RTL8821C_SUPPORT 0 + + #define RATE_ADAPTIVE_SUPPORT 0 + #define POWER_TRAINING_ACTIVE 0 + + #define sta_info rtl_sta_info + #define boolean bool + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + #include + + #ifdef CONFIG_USB_HCI + #define DEV_BUS_TYPE RT_USB_INTERFACE + #elif defined(CONFIG_PCI_HCI) + #define DEV_BUS_TYPE RT_PCI_INTERFACE + #elif defined(CONFIG_SDIO_HCI) + #define DEV_BUS_TYPE RT_SDIO_INTERFACE + #elif defined(CONFIG_GSPI_HCI) + #define DEV_BUS_TYPE RT_SDIO_INTERFACE + #endif + + + #if defined(CONFIG_LITTLE_ENDIAN) + #define ODM_ENDIAN_TYPE ODM_ENDIAN_LITTLE + #elif defined (CONFIG_BIG_ENDIAN) + #define ODM_ENDIAN_TYPE ODM_ENDIAN_BIG + #endif + + #define boolean bool + + #define SET_TX_DESC_ANTSEL_A_88E(__ptx_desc, __value) SET_BITS_TO_LE_4BYTE(__ptx_desc+8, 24, 1, __value) + #define SET_TX_DESC_ANTSEL_B_88E(__ptx_desc, __value) SET_BITS_TO_LE_4BYTE(__ptx_desc+8, 25, 1, __value) + #define SET_TX_DESC_ANTSEL_C_88E(__ptx_desc, __value) SET_BITS_TO_LE_4BYTE(__ptx_desc+28, 29, 1, __value) + + /* define useless flag to avoid compile warning */ + #define USE_WORKITEM 0 + #define FOR_BRAZIL_PRETEST 0 + #define FPGA_TWO_MAC_VERIFICATION 0 + #define RTL8881A_SUPPORT 0 + + #if (defined(TESTCHIP_SUPPORT)) + #define PHYDM_TESTCHIP_SUPPORT 1 + #else + #define PHYDM_TESTCHIP_SUPPORT 0 + #endif +#endif + +#define READ_NEXT_PAIR(v1, v2, i) do { if (i+2 >= array_len) break; i += 2; v1 = array[i]; v2 = array[i+1]; } while (0) +#define COND_ELSE 2 +#define COND_ENDIF 3 + +#define MASKBYTE0 0xff +#define MASKBYTE1 0xff00 +#define MASKBYTE2 0xff0000 +#define MASKBYTE3 0xff000000 +#define MASKHWORD 0xffff0000 +#define MASKLWORD 0x0000ffff +#define MASKDWORD 0xffffffff +#define MASK7BITS 0x7f +#define MASK12BITS 0xfff +#define MASKH4BITS 0xf0000000 +#define MASK20BITS 0xfffff +#define MASKOFDM_D 0xffc00000 +#define MASKCCK 0x3f3f3f3f +#define RFREGOFFSETMASK 0xfffff +#define MASKH3BYTES 0xffffff00 +#define MASKL3BYTES 0x00ffffff +#define MASKBYTE2HIGHNIBBLE 0x00f00000 +#define MASKBYTE3LOWNIBBLE 0x0f000000 +#define MASKL3BYTES 0x00ffffff +#define RFREGOFFSETMASK 0xfffff + +#endif /* __ODM_TYPES_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.c deleted file mode 100644 index 4b41ff111f13..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.c +++ /dev/null @@ -1,481 +0,0 @@ -/****************************************************************************** - * - * Copyright(c) 2007 - 2012 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 - * - * - ******************************************************************************/ - -/****************************************************************************** - - History: - Data Who Remark (Internal History) - - 05/14/2012 MH Collect RTK inernal infromation and generate channel plan draft. - -******************************************************************************/ - -//============================================================ -// include files -//============================================================ -#include "mp_precomp.h" -#include "phydm_precomp.h" -#include "rtchnlplan.h" - - - -// -// Channel Plan Domain Code -// - -/* - Channel Plan Contents - Domain Code EEPROM Countries in Specific Domain - 2G RD 5G RD Bit[6:0] 2G 5G - Case Old Define 00h~1Fh Old Define Old Define - 1 2G_WORLD 5G_NULL 20h Worldwird 13 NA - 2 2G_ETSI1 5G_NULL 21h Europe 2G NA - 3 2G_FCC1 5G_NULL 22h US 2G NA - 4 2G_MKK1 5G_NULL 23h Japan 2G NA - 5 2G_ETSI2 5G_NULL 24h France 2G NA - 6 2G_FCC1 5G_FCC1 25h US 2G US 5G ¤K¤j°ê»{ÃÒ - 7 2G_WORLD 5G_ETSI1 26h Worldwird 13 Europe ¤K¤j°ê»{ÃÒ - 8 2G_MKK1 5G_MKK1 27h Japan 2G Japan 5G ¤K¤j°ê»{ÃÒ - 9 2G_WORLD 5G_KCC1 28h Worldwird 13 Korea ¤K¤j°ê»{ÃÒ - 10 2G_WORLD 5G_FCC2 29h Worldwird 13 US o/w DFS Channels - 11 2G_WORLD 5G_FCC3 30h Worldwird 13 India, Mexico - 12 2G_WORLD 5G_FCC4 31h Worldwird 13 Venezuela - 13 2G_WORLD 5G_FCC5 32h Worldwird 13 China - 14 2G_WORLD 5G_FCC6 33h Worldwird 13 Israel - 15 2G_FCC1 5G_FCC7 34h US 2G US/Canada ¤K¤j°ê»{ÃÒ - 16 2G_WORLD 5G_ETSI2 35h Worldwird 13 Australia, New Zealand ¤K¤j°ê»{ÃÒ - 17 2G_WORLD 5G_ETSI3 36h Worldwird 13 Russia - 18 2G_MKK1 5G_MKK2 37h Japan 2G Japan (W52, W53) - 19 2G_MKK1 5G_MKK3 38h Japan 2G Japan (W56) - 20 2G_FCC1 5G_NCC1 39h US 2G Taiwan ¤K¤j°ê»{ÃÒ - - NA 2G_WORLD 5G_FCC1 7F FCC FCC DFS Channels Realtek Define - - - - - - 2.4G Regulatory Domains - Case 2G RD Regulation Channels Frequencyes Note Countries in Specific Domain - 1 2G_WORLD ETSI 1~13 2412~2472 Passive scan CH 12, 13 Worldwird 13 - 2 2G_ETSI1 ETSI 1~13 2412~2472 Europe - 3 2G_FCC1 FCC 1~11 2412~2462 US - 4 2G_MKK1 MKK 1~13, 14 2412~2472, 2484 Japan - 5 2G_ETSI2 ETSI 10~13 2457~2472 France - - - - - 5G Regulatory Domains - Case 5G RD Regulation Channels Frequencyes Note Countries in Specific Domain - 1 5G_NULL NA NA NA Do not support 5GHz - 2 5G_ETSI1 ETSI "36~48, 52~64, - 100~140" "5180~5240, 5260~5230 - 5500~5700" Band1, Ban2, Band3 Europe - 3 5G_ETSI2 ETSI "36~48, 52~64, - 100~140, 149~165" "5180~5240, 5260~5230 - 5500~5700, 5745~5825" Band1, Ban2, Band3, Band4 Australia, New Zealand - 4 5G_ETSI3 ETSI "36~48, 52~64, - 100~132, 149~165" - "5180~5240, 5260~5230 - 5500~5660, 5745~5825" Band1, Ban2, Band3(except CH 136, 140), Band4" Russia - 5 5G_FCC1 FCC "36~48, 52~64, - 100~140, 149~165" - "5180~5240, 5260~5230 - 5500~5700, 5745~5825" Band1(5150~5250MHz), - Band2(5250~5350MHz), - Band3(5470~5725MHz), - Band4(5725~5850MHz)" US - 6 5G_FCC2 FCC 36~48, 149~165 5180~5240, 5745~5825 Band1, Band4 FCC o/w DFS Channels - 7 5G_FCC3 FCC "36~48, 52~64, - 149~165" "5180~5240, 5260~5230 - 5745~5825" Band1, Ban2, Band4 India, Mexico - 8 5G_FCC4 FCC "36~48, 52~64, - 149~161" "5180~5240, 5260~5230 - 5745~5805" Band1, Ban2, - Band4(except CH 165)" Venezuela - 9 5G_FCC5 FCC 149~165 5745~5825 Band4 China - 10 5G_FCC6 FCC 36~48, 52~64 5180~5240, 5260~5230 Band1, Band2 Israel - 11 5G_FCC7 - 5G_IC1 FCC - IC" "36~48, 52~64, - 100~116, 136, 140, - 149~165" "5180~5240, 5260~5230 - 5500~5580, 5680, 5700, - 5745~5825" "Band1, Band2, - Band3(except 5600~5650MHz), - Band4" "US - Canada" - 12 5G_KCC1 KCC "36~48, 52~64, - 100~124, 149~165" "5180~5240, 5260~5230 - 5500~5620, 5745~5825" "Band1, Ban2, - Band3(5470~5650MHz), - Band4" Korea - 13 5G_MKK1 MKK "36~48, 52~64, - 100~140" "5180~5240, 5260~5230 - 5500~5700" W52, W53, W56 Japan - 14 5G_MKK2 MKK 36~48, 52~64 5180~5240, 5260~5230 W52, W53 Japan (W52, W53) - 15 5G_MKK3 MKK 100~140 5500~5700 W56 Japan (W56) - 16 5G_NCC1 NCC "56~64, - 100~116, 136, 140, - 149~165" "5260~5320 - 5500~5580, 5680, 5700, - 5745~5825" "Band2(except CH 52), - Band3(except 5600~5650MHz), - Band4" Taiwan - - -*/ - -// -// 2.4G CHannel -// -/* - - 2.4G Band Regulatory Domains RTL8192D - Channel Number Channel Frequency US Canada Europe Spain France Japan Japan 20M 40M - (MHz) (FCC) (IC) (ETSI) (MPHPT) - 1 2412 v v v v v - 2 2417 v v v v v - 3 2422 v v v v v v - 4 2427 v v v v v v - 5 2432 v v v v v v - 6 2437 v v v v v v - 7 2442 v v v v v v - 8 2447 v v v v v v - 9 2452 v v v v v v - 10 2457 v v v v v v v v - 11 2462 v v v v v v v v - 12 2467 v v v v v - 13 2472 v v v v - 14 2484 v v - - -*/ - - -// -// 5G Operating Channel -// -/* - - 5G Band RTL8192D RTL8195 (Jaguar) Jaguar 2 Regulatory Domains - Channel Number Channel Frequency Global Global Global "US -(FCC 15.407)" "Canada -(FCC, except 5.6~5.65GHz)" Argentina, Australia, New Zealand, Brazil, S. Africa (FCC/ETSI) "Europe -(CE 301 893)" China India, Mexico, Singapore Israel, Turkey "Japan -(MIC Item 19-3, 19-3-2)" Korea Russia, Ukraine "Taiwan -(NCC)" Venezuela - (MHz) (20MHz) (20MHz) (40MHz) (80MHz) (160MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) (20MHz) -"Band 1 -5.15GHz -~ -5.25GHz" 36 5180 v v v v v Indoor Indoor v Indoor v Indoor Indoor v v v - 40 5200 v v v Indoor Indoor v Indoor v Indoor Indoor v v v - 44 5220 v v v v Indoor Indoor v Indoor v Indoor Indoor v v v - 48 5240 v v v Indoor Indoor v Indoor v Indoor Indoor v v v -"Band 2 -5.25GHz -~ -5.35GHz -(DFS)" 52 5260 v v v v v v v v Indoor v Indoor Indoor v v v - 56 5280 v v v v v v Indoor v Indoor Indoor v v Indoor v - 60 5300 v v v v v v v Indoor v Indoor Indoor v v Indoor v - 64 5320 v v v v v v Indoor v Indoor Indoor v v Indoor v - -"Band 3 -5.47GHz -~ -5.725GHz -(DFS)" 100 5500 v v v v v v v v v v v v v - 104 5520 v v v v v v v v v v v - 108 5540 v v v v v v v v v v v v - 112 5560 v v v v v v v v v v v - 116 5580 v v v v v v v v v v v v v - 120 5600 v v v Indoor v Indoor v v v - 124 5620 v v v v Indoor v Indoor v v v - 128 5640 v v v Indoor v Indoor v v - 132 5660 v v v E v Indoor v Indoor v v - 136 5680 v v v v v v v v v - 140 5700 v v E v v v v v v v - 144 5720 E E E -"Band 4 -5.725GHz -~ -5.85GHz -(~5.9GHz)" 149 5745 v v v v v v v v v v v v v v - 153 5765 v v v v v v v v v v v v - 157 5785 v v v v v v v v v v v v v - 161 5805 v v v v v v v v v v v v - 165 5825 v v P P v v v v v v v v v - 169 5845 P P P - 173 5865 P P P P - 177 5885 P P P -Channel Count 28 28 14 7 0 28 24 20 24 19 5 13 8 19 20 22 15 12 - E: FCC accepted the ask for CH144 from Accord. PS: 160MHz ¥Î 80MHz+80MHz¹ê²{¡H Argentina Belgium (¤ñ§Q®É) India Israel Russia - P: Customer's requirement from James. Australia The Netherlands (²üÄõ) Mexico Turkey Ukraine - New Zealand UK (­^°ê) Singapore - Brazil Switzerland (·ç¤h) - - -*/ - -/*---------------------------Define Local Constant---------------------------*/ - - -// define Maximum Power v.s each band for each region -// ISRAEL -// Format: -// RT_CHANNEL_DOMAIN_Region ={{{Chnl_Start, Chnl_end, Pwr_dB_Max}, {Chn2_Start, Chn2_end, Pwr_dB_Max}, {Chn3_Start, Chn3_end, Pwr_dB_Max}, {Chn4_Start, Chn4_end, Pwr_dB_Max}, {Chn5_Start, Chn5_end, Pwr_dB_Max}}, Limit_Num} */ -// RT_CHANNEL_DOMAIN_FCC ={{{01,11,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} -// "NR" is non-release channle. -// Issue--- Israel--Russia--New Zealand -// DOMAIN_01= (2G_WORLD, 5G_NULL) -// DOMAIN_02= (2G_ETSI1, 5G_NULL) -// DOMAIN_03= (2G_FCC1, 5G_NULL) -// DOMAIN_04= (2G_MKK1, 5G_NULL) -// DOMAIN_05= (2G_ETSI2, 5G_NULL) -// DOMAIN_06= (2G_FCC1, 5G_FCC1) -// DOMAIN_07= (2G_WORLD, 5G_ETSI1) -// DOMAIN_08= (2G_MKK1, 5G_MKK1) -// DOMAIN_09= (2G_WORLD, 5G_KCC1) -// DOMAIN_10= (2G_WORLD, 5G_FCC2) -// DOMAIN_11= (2G_WORLD, 5G_FCC3)----india -// DOMAIN_12= (2G_WORLD, 5G_FCC4)----Venezuela -// DOMAIN_13= (2G_WORLD, 5G_FCC5)----China -// DOMAIN_14= (2G_WORLD, 5G_FCC6)----Israel -// DOMAIN_15= (2G_FCC1, 5G_FCC7)-----Canada -// DOMAIN_16= (2G_WORLD, 5G_ETSI2)---Australia -// DOMAIN_17= (2G_WORLD, 5G_ETSI3)---Russia -// DOMAIN_18= (2G_MKK1, 5G_MKK2)-----Japan -// DOMAIN_19= (2G_MKK1, 5G_MKK3)-----Japan -// DOMAIN_20= (2G_FCC1, 5G_NCC1)-----Taiwan -// DOMAIN_21= (2G_FCC1, 5G_NCC1)-----Taiwan - - -static RT_CHANNEL_PLAN_MAXPWR ChnlPlanPwrMax_2G[] = { - - // 2G_WORLD, - {{1, 13, 20}, 1}, - - // 2G_ETSI1 - {{1, 13, 20}, 1}, - - /* RT_CHANNEL_DOMAIN_ETSI */ - {{{1, 11, 17}, {40, 56, 17}, {60, 128, 17}, {0, 0, 0}, {149, 165, 17}}, 4}, - - // RT_CHANNEL_DOMAIN_MKK - {{{1, 11, 17}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}, {0, 0, 0}}, 1}, - - // Add new channel plan mex power table. - // ...... - }; - - -/* -//===========================================1:(2G_WORLD, 5G_NULL) - -RT_CHANNEL_PLAN_MAXPWR RT_DOMAIN_01 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} - -//===========================================2:(2G_ETSI1, 5G_NULL) - -RT_DOMAIN_02 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} - -//===========================================3:(2G_FCC1, 5G_NULL) - -RT_DOMAIN_03 ={{{01,11,30}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} - -//===========================================4:(2G_MKK1, 5G_NULL) - -RT_DOMAIN_04 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} - -//===========================================5:(2G_ETSI2, 5G_NULL) - -RT_DOMAIN_05 ={{{10,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}}, 1} - -//===========================================6:(2G_FCC1, 5G_FCC1) - -RT_DOMAIN_06 ={{{01,13,30}, {36,48,17}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} - -//===========================================7:(2G_WORLD, 5G_ETSI1) - -RT_DOMAIN_07 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {NR,NR,0}}, 4} - -//===========================================8:(2G_MKK1, 5G_MKK1) - -RT_DOMAIN_08 ={{{01,14,23}, {36,48,23}, {52,64,23}, {100,140,23}, {NR,NR,0}}, 4} - -//===========================================9:(2G_WORLD, 5G_KCC1) - -RT_DOMAIN_09 ={{{01,13,20}, {36,48,17}, {52,64,23}, {100,124,23}, {149,165,23}}, 5} - -//===========================================10:(2G_WORLD, 5G_FCC2) - -RT_DOMAIN_10 ={{{01,13,20}, {36,48,17}, {NR,NR,0}, {NR,NR,0}, {149,165,30}}, 3} - -//===========================================11:(2G_WORLD, 5G_FCC3) -RT_DOMAIN_11 ={{{01,13,20}, {36,48,23}, {52,64,23}, {NR,NR,0}, {149,165,23}}, 4} - -//===========================================12:(2G_WORLD, 5G_FCC4) -RT_DOMAIN_12 ={{{01,13,20}, {36,48,24}, {52,64,24}, {NR,NR,0}, {149,161,27}}, 4} - -//===========================================13:(2G_WORLD, 5G_FCC5) -RT_DOMAIN_13 ={{{01,13,20}, {NR,NR,0}, {NR,NR,0}, {NR,NR,0}, {149,165,27}}, 2} - -//===========================================14:(2G_WORLD, 5G_FCC6) -RT_DOMAIN_14 ={{{01,13,20}, {36,48,17}, {52,64,17}, {NR,NR,0}, {NR,NR,0}}, 3} - -//===========================================15:(2G_FCC1, 5G_FCC7) -RT_DOMAIN_15 ={{{01,11,30}, {36,48,23}, {52,64,24}, {100,140,24}, {149,165,30}}, 5} - -//===========================================16:(2G_WORLD, 5G_ETSI2) -RT_DOMAIN_16 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} - -//===========================================17:(2G_WORLD, 5G_ETSI3) -RT_DOMAIN_17 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,132,30}, {149,165,20}}, 5} - -//===========================================18:(2G_MKK1, 5G_MKK2) -RT_DOMAIN_18 ={{{01,14,23}, {36,48,23}, {52,64,23}, {NR,NR,0}, {NR,NR,0}}, 3} - -//===========================================19:(2G_MKK1, 5G_MKK3) -RT_DOMAIN_19 ={{{01,14,23}, {NR,NR,0}, {NR,NR,0}, {100,140,23}, {NR,NR,0}}, 2} - -//===========================================20:(2G_FCC1, 5G_NCC1) -RT_DOMAIN_20 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {100,140,24}, {149,165,30}}, 4} - -//===========================================21:(2G_FCC1, 5G_NCC2) -RT_DOMAIN_21 ={{{01,11,30}, {NR,NR,0}, {56,64,23}, {NR,NR,0}, {149,165,30}}, 3} - -//===========================================22:(2G_WORLD, 5G_FCC3) -RT_DOMAIN_22 ={{{01,13,24}, {36,48,20}, {52,64,24}, {NR,NR,0}, {149,165,30}}, 4} - -//===========================================23:(2G_WORLD, 5G_ETSI2) -RT_DOMAIN_23 ={{{01,13,20}, {36,48,23}, {52,64,23}, {100,140,30}, {149,165,30}}, 5} - -*/ - -// -// Counter & Realtek Channel plan transfer table. -// -RT_CHNL_CTRY_TBL RtCtryChnlTbl[] = -{ - - { - RT_CTRY_AL, // "Albaniaªüº¸¤Ú¥§¨È" - "AL", - RT_2G_WORLD, - RT_5G_WORLD, - RT_CHANNEL_DOMAIN_UNDEFINED // 2G/5G world. - }, -#if 0 - { - RT_CTRY_BB, // "Barbados¤Ú¤Ú¦h´µ" - "BB", - RT_2G_WORLD, - RT_5G_NULL, - RT_CHANNEL_DOMAIN_EFUSE_0x20 // 2G world. 5G_NULL - }, - - { - RT_CTRY_DE, // "Germany¼w°ê" - "DE", - RT_2G_WORLD, - RT_5G_ETSI1, - RT_CHANNEL_DOMAIN_EFUSE_0x26 - }, - - { - RT_CTRY_US, // "Germany¼w°ê" - "US", - RT_2G_FCC1, - RT_5G_FCC7, - RT_CHANNEL_DOMAIN_EFUSE_0x34 - }, - - { - RT_CTRY_JP, // "Germany¼w°ê" - "JP", - RT_2G_MKK1, - RT_5G_MKK1, - RT_CHANNEL_DOMAIN_EFUSE_0x34 - }, - - { - RT_CTRY_TW, // "Germany¼w°ê" - "TW", - RT_2G_FCC1, - RT_5G_NCC1, - RT_CHANNEL_DOMAIN_EFUSE_0x39 - }, -#endif - -}; // RtCtryChnlTbl - -// -// Realtek Defined Channel plan. -// -#if 0 - -static RT_CHANNEL_PLAN_NEW RtChnlPlan[] = -{ - // Channel Plan 0x20. - { - &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. - RT_CHANNEL_DOMAIN_EFUSE_0x20, // RT_CHANNEL_DOMAIN RT Channel Plan Define - RT_2G_WORLD, // RT_REGULATION_2G - RT_5G_NULL, // RT_REGULATION_5G - RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. - RT_SREQ_NA, // RT Channel plan special & customerize requirement. - - CHNL_RT_2G_WORLD, - CHNL_RT_2G_WORLD_SCAN_TYPE, - &ChnlPlanPwrMax_2G[0], - - CHNL_RT_5G_NULL, - CHNL_RT_5G_NULL_SCAN_TYPE, - - - }, - - // Channel Plan 0x26. - { - &RtCtryChnlTbl[1], // RT_CHNL_CTRY_TBL Country & channel plan transfer table. - RT_CHANNEL_DOMAIN_EFUSE_0x26, // RT_CHANNEL_DOMAIN RT Channel Plan Define - RT_2G_WORLD, // RT_REGULATION_2G - RT_5G_ETSI1, // RT_REGULATION_5G - RT_WORLD, // RT_REGULATION_CMN RT Regulatory domain definition. - RT_SREQ_NA, // RT Channel plan special & customerize requirement. - - CHNL_RT_2G_WORLD, // 2G workd cannel - CHNL_RT_2G_WORLD_SCAN_TYPE, - &ChnlPlanPwrMax_2G[1], - - CHNL_RT_5G_ETSI1, - CHNL_RT_5G_ETSI1_SCAN_TYPE, - - } - - -}; -#endif - - - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.h deleted file mode 100644 index 37786cf8f00d..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtchnlplan.h +++ /dev/null @@ -1,699 +0,0 @@ -/****************************************************************************** - * - * Copyright(c) 2007 - 2012 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 - * - * - ******************************************************************************/ - - -#ifndef __RT_CHANNELPLAN_H__ -#define __RT_CHANNELPLAN_H__ - -typedef enum _RT_CHANNEL_DOMAIN_NEW -{ - - //===== Add new channel plan above this line ===============// - - // For new architecture we define different 2G/5G CH area for all country. - // 2.4 G only - RT_CHANNEL_DOMAIN_2G_WORLD_5G_NULL = 0x20, - RT_CHANNEL_DOMAIN_2G_ETSI1_5G_NULL = 0x21, - RT_CHANNEL_DOMAIN_2G_FCC1_5G_NULL = 0x22, - RT_CHANNEL_DOMAIN_2G_MKK1_5G_NULL = 0x23, - RT_CHANNEL_DOMAIN_2G_ETSI2_5G_NULL = 0x24, - // 2.4 G + 5G type 1 - RT_CHANNEL_DOMAIN_2G_FCC1_5G_FCC1 = 0x25, - RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x26, - //RT_CHANNEL_DOMAIN_2G_WORLD_5G_ETSI1 = 0x27, - // ..... - - RT_CHANNEL_DOMAIN_MAX_NEW, - -}RT_CHANNEL_DOMAIN_NEW, *PRT_CHANNEL_DOMAIN_NEW; - - -#if 0 -#define DOMAIN_CODE_2G_WORLD \ - {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -#define DOMAIN_CODE_2G_ETSI1 \ - {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -#define DOMAIN_CODE_2G_ETSI2 \ - {1,2,3,4,5,6,7,8,9,10,11}, 11 -#define DOMAIN_CODE_2G_FCC1 \ - {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 -#define DOMAIN_CODE_2G_MKK1 \ - {10,11,12,13}, 4 - -#define DOMAIN_CODE_5G_ETSI1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -#define DOMAIN_CODE_5G_ETSI2 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -#define DOMAIN_CODE_5G_ETSI3 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -#define DOMAIN_CODE_5G_FCC1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -#define DOMAIN_CODE_5G_FCC2 \ - {36,40,44,48,149,153,157,161,165}, 9 -#define DOMAIN_CODE_5G_FCC3 \ - {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -#define DOMAIN_CODE_5G_FCC4 \ - {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -#define DOMAIN_CODE_5G_FCC5 \ - {149,153,157,161,165}, 5 -#define DOMAIN_CODE_5G_FCC6 \ - {36,40,44,48,52,56,60,64}, 8 -#define DOMAIN_CODE_5G_FCC7 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -#define DOMAIN_CODE_5G_IC1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -#define DOMAIN_CODE_5G_KCC1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -#define DOMAIN_CODE_5G_MKK1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -#define DOMAIN_CODE_5G_MKK2 \ - {36,40,44,48,52,56,60,64}, 8 -#define DOMAIN_CODE_5G_MKK3 \ - {100,104,108,112,116,120,124,128,132,136,140}, 11 -#define DOMAIN_CODE_5G_NCC1 \ - {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -#define DOMAIN_CODE_5G_NCC2 \ - {56,60,64,149,153,157,161,165}, 8 -#define UNDEFINED \ - {0}, 0 -#endif - -// -// -// -/* - -Countries "Country Abbreviation" Domain Code SKU's Ch# of 20MHz - 2G 5G Ch# of 40MHz -"Albaniaªüº¸¤Ú¥§¨È" AL Local Test - -"Algeriaªüº¸¤Î§Q¨È" DZ CE TCF - -"Antigua & Barbuda¦w´£¥Ê®q&¤Ú¥¬¹F" AG 2G_WORLD FCC TCF - -"Argentinaªü®Ú§Ê" AR 2G_WORLD Local Test - -"Armenia¨È¬ü¥§¨È" AM 2G_WORLD ETSI - -"Arubaªü¾|¤Ú®q" AW 2G_WORLD FCC TCF - -"Australia¿D¬w" AU 2G_WORLD 5G_ETSI2 - -"Austria¶ø¦a§Q" AT 2G_WORLD 5G_ETSI1 CE - -"Azerbaijanªü¶ë«ô¾Ê" AZ 2G_WORLD CE TCF - -"Bahamas¤Ú«¢°¨" BS 2G_WORLD - -"Barbados¤Ú¤Ú¦h´µ" BB 2G_WORLD FCC TCF - -"Belgium¤ñ§Q®É" BE 2G_WORLD 5G_ETSI1 CE - -"Bermuda¦Ê¼}¹F" BM 2G_WORLD FCC TCF - -"Brazil¤Ú¦è" BR 2G_WORLD Local Test - -"Bulgaria«O¥[§Q¨È" BG 2G_WORLD 5G_ETSI1 CE - -"Canada¥[®³¤j" CA 2G_FCC1 5G_FCC7 IC / FCC IC / FCC - -"Cayman Islands¶}°Ò¸s®q" KY 2G_WORLD 5G_ETSI1 CE - -"Chile´¼§Q" CL 2G_WORLD FCC TCF - -"China¤¤°ê" CN 2G_WORLD 5G_FCC5 «H³¡?¡i2002¡j353? - -"Columbia­ô­Û¤ñ¨È" CO 2G_WORLD Voluntary - -"Costa Rica­ô´µ¹F¾¤¥[" CR 2G_WORLD FCC TCF - -"Cyprus¶ë®ú¸ô´µ" CY 2G_WORLD 5G_ETSI1 CE - -"Czech ±¶§J" CZ 2G_WORLD 5G_ETSI1 CE - -"Denmark¤¦³Á" DK 2G_WORLD 5G_ETSI1 CE - -"Dominican Republic¦h©ú¥§¥[¦@©M°ê" DO 2G_WORLD FCC TCF - -"Egypt®J¤Î" EG 2G_WORLD CE T CF - -"El SalvadorÂĺ¸¥Ë¦h" SV 2G_WORLD Voluntary - -"Estonia·R¨F¥§¨È" EE 2G_WORLD 5G_ETSI1 CE - -"FinlandªâÄõ" FI 2G_WORLD 5G_ETSI1 CE - -"Franceªk°ê" FR 5G_E TSI1 CE - -"Germany¼w°ê" DE 2G_WORLD 5G_ETSI1 CE - -"Greece §Æþ" GR 2G_WORLD 5G_ETSI1 CE - -"GuamÃö®q" GU 2G_WORLD - -"Guatemala¥Ê¦a°¨©Ô" GT 2G_WORLD - -"Haiti®ü¦a" HT 2G_WORLD FCC TCF - -"Honduras§»³£©Ô´µ" HN 2G_WORLD FCC TCF - -"Hungary¦I¤ú§Q" HU 2G_WORLD 5G_ETSI1 CE - -"Iceland¦B®q" IS 2G_WORLD 5G_ETSI1 CE - -"India¦L«×" IN 2G_WORLD 5G_FCC3 FCC/CE TCF - -"Ireland·Rº¸Äõ" IE 2G_WORLD 5G_ETSI1 CE - -"Israel¥H¦â¦C" IL 5G_F CC6 CE TCF - -"Italy¸q¤j§Q" IT 2G_WORLD 5G_ETSI1 CE - -"Japan¤é¥»" JP 2G_MKK1 5G_MKK1 MKK MKK - -"KoreaÁú°ê" KR 2G_WORLD 5G_KCC1 KCC KCC - -"Latvia©Ô²æºû¨È" LV 2G_WORLD 5G_ETSI1 CE - -"Lithuania¥ß³³©{" LT 2G_WORLD 5G_ETSI1 CE - -"Luxembourg¿c´Ë³ù" LU 2G_WORLD 5G_ETSI1 CE - -"Malaysia°¨¨Ó¦è¨È" MY 2G_WORLD Local Test - -"Malta°¨º¸¥L" MT 2G_WORLD 5G_ETSI1 CE - -"Mexico¾¥¦è­ô" MX 2G_WORLD 5G_FCC3 Local Test - -"Morocco¼¯¬¥­ô" MA CE TCF - -"Netherlands²üÄõ" NL 2G_WORLD 5G_ETSI1 CE - -"New Zealand¯Ã¦èÄõ" NZ 2G_WORLD 5G_ETSI2 - -"Norway®¿«Â" NO 2G_WORLD 5G_ETSI1 CE - -"Panama¤Ú®³°¨ " PA 2G_FCC1 Voluntary - -"Philippinesµá«ß»«" PH 2G_WORLD FCC TCF - -"PolandªiÄõ" PL 2G_WORLD 5G_ETSI1 CE - -"Portugal¸²µå¤ú" PT 2G_WORLD 5G_ETSI1 CE - -"Romaniaù°¨¥§¨È" RO 2G_WORLD 5G_ETSI1 CE - -"Russia«Xù´µ" RU 2G_WORLD 5G_ETSI3 CE TCF - -"Saudi Arabia¨F¦aªü©Ô§B" SA 2G_WORLD CE TCF - -"Singapore·s¥[©Y" SG 2G_WORLD - -"Slovakia´µ¬¥¥ï§J" SK 2G_WORLD 5G_ETSI1 CE - -"Slovenia´µ¬¥ºû¥§¨È" SI 2G_WORLD 5G_ETSI1 CE - -"South Africa«n«D" ZA 2G_WORLD CE TCF - -"Spain¦è¯Z¤ú" ES 5G_ETSI1 CE - -"Sweden·ç¨å" SE 2G_WORLD 5G_ETSI1 CE - -"Switzerland·ç¤h" CH 2G_WORLD 5G_ETSI1 CE - -"Taiwan»OÆW" TW 2G_FCC1 5G_NCC1 NCC - -"Thailand®õ°ê" TH 2G_WORLD FCC/CE TCF - -"Turkey¤g¦Õ¨ä" TR 2G_WORLD - -"Ukraine¯Q§JÄõ" UA 2G_WORLD Local Test - -"United Kingdom­^°ê" GB 2G_WORLD 5G_ETSI1 CE ETSI - -"United States¬ü°ê" US 2G_FCC1 5G_FCC7 FCC FCC - -"Venezuela©e¤º·ç©Ô" VE 2G_WORLD 5G_FCC4 FCC TCF - -"Vietnam¶V«n" VN 2G_WORLD FCC/CE TCF - - - -*/ - -// Counter abbervation. -typedef enum _RT_COUNTRY_DEFINE_NUM -{ - RT_CTRY_AL, // "Albaniaªüº¸¤Ú¥§¨È" - RT_CTRY_DZ, // "Algeriaªüº¸¤Î§Q¨È" - RT_CTRY_AG, // "Antigua & Barbuda¦w´£¥Ê®q&¤Ú¥¬¹F" - RT_CTRY_AR, // "Argentinaªü®Ú§Ê" - RT_CTRY_AM, // "Armenia¨È¬ü¥§¨È" - RT_CTRY_AW, // "Arubaªü¾|¤Ú®q" - RT_CTRY_AU, // "Australia¿D¬w" - RT_CTRY_AT, // "Austria¶ø¦a§Q" - RT_CTRY_AZ, // "Azerbaijanªü¶ë«ô¾Ê" - RT_CTRY_BS, // "Bahamas¤Ú«¢°¨" - RT_CTRY_BB, // "Barbados¤Ú¤Ú¦h´µ" - RT_CTRY_BE, // "Belgium¤ñ§Q®É" - RT_CTRY_BM, // "Bermuda¦Ê¼}¹F" - RT_CTRY_BR, // "Brazil¤Ú¦è" - RT_CTRY_BG, // "Bulgaria«O¥[§Q¨È" - RT_CTRY_CA, // "Canada¥[®³¤j" - RT_CTRY_KY, // "Cayman Islands¶}°Ò¸s®q" - RT_CTRY_CL, // "Chile´¼§Q" - RT_CTRY_CN, // "China¤¤°ê" - RT_CTRY_CO, // "Columbia­ô­Û¤ñ¨È" - RT_CTRY_CR, // "Costa Rica­ô´µ¹F¾¤¥[" - RT_CTRY_CY, // "Cyprus¶ë®ú¸ô´µ" - RT_CTRY_CZ, // "Czech ±¶§J" - RT_CTRY_DK, // "Denmark¤¦³Á" - RT_CTRY_DO, // "Dominican Republic¦h©ú¥§¥[¦@©M°ê" - RT_CTRY_CE, // "Egypt®J¤Î" EG 2G_WORLD - RT_CTRY_SV, // "El SalvadorÂĺ¸¥Ë¦h" - RT_CTRY_EE, // "Estonia·R¨F¥§¨È" - RT_CTRY_FI, // "FinlandªâÄõ" - RT_CTRY_FR, // "Franceªk°ê" - RT_CTRY_DE, // "Germany¼w°ê" - RT_CTRY_GR, // "Greece §Æþ" - RT_CTRY_GU, // "GuamÃö®q" - RT_CTRY_GT, // "Guatemala¥Ê¦a°¨©Ô" - RT_CTRY_HT, // "Haiti®ü¦a" - RT_CTRY_HN, // "Honduras§»³£©Ô´µ" - RT_CTRY_HU, // "Hungary¦I¤ú§Q" - RT_CTRY_IS, // "Iceland¦B®q" - RT_CTRY_IN, // "India¦L«×" - RT_CTRY_IE, // "Ireland·Rº¸Äõ" - RT_CTRY_IL, // "Israel¥H¦â¦C" - RT_CTRY_IT, // "Italy¸q¤j§Q" - RT_CTRY_JP, // "Japan¤é¥»" - RT_CTRY_KR, // "KoreaÁú°ê" - RT_CTRY_LV, // "Latvia©Ô²æºû¨È" - RT_CTRY_LT, // "Lithuania¥ß³³©{" - RT_CTRY_LU, // "Luxembourg¿c´Ë³ù" - RT_CTRY_MY, // "Malaysia°¨¨Ó¦è¨È" - RT_CTRY_MT, // "Malta°¨º¸¥L" - RT_CTRY_MX, // "Mexico¾¥¦è­ô" - RT_CTRY_MA, // "Morocco¼¯¬¥­ô" - RT_CTRY_NL, // "Netherlands²üÄõ" - RT_CTRY_NZ, // "New Zealand¯Ã¦èÄõ" - RT_CTRY_NO, // "Norway®¿«Â" - RT_CTRY_PA, // "Panama¤Ú®³°¨ " - RT_CTRY_PH, // "Philippinesµá«ß»«" - RT_CTRY_PL, // "PolandªiÄõ" - RT_CTRY_PT, // "Portugal¸²µå¤ú" - RT_CTRY_RO, // "Romaniaù°¨¥§¨È" - RT_CTRY_RU, // "Russia«Xù´µ" - RT_CTRY_SA, // "Saudi Arabia¨F¦aªü©Ô§B" - RT_CTRY_SG, // "Singapore·s¥[©Y" - RT_CTRY_SK, // "Slovakia´µ¬¥¥ï§J" - RT_CTRY_SI, // "Slovenia´µ¬¥ºû¥§¨È" - RT_CTRY_ZA, // "South Africa«n«D" - RT_CTRY_ES, // "Spain¦è¯Z¤ú" - RT_CTRY_SE, // "Sweden·ç¨å" - RT_CTRY_CH, // "Switzerland·ç¤h" - RT_CTRY_TW, // "Taiwan»OÆW" - RT_CTRY_TH, // "Thailand®õ°ê" - RT_CTRY_TR, // "Turkey¤g¦Õ¨ä" - RT_CTRY_UA, // "Ukraine¯Q§JÄõ" - RT_CTRY_GB, // "United Kingdom­^°ê" - RT_CTRY_US, // "United States¬ü°ê" - RT_CTRY_VE, // "Venezuela©e¤º·ç©Ô" - RT_CTRY_VN, // "Vietnam¶V«n" - RT_CTRY_MAX, // - -}RT_COUNTRY_NAME, *PRT_COUNTRY_NAME; - -// Scan type including active and passive scan. -typedef enum _RT_SCAN_TYPE_NEW -{ - SCAN_NULL, - SCAN_ACT, - SCAN_PAS, - SCAN_BOTH, -}RT_SCAN_TYPE_NEW, *PRT_SCAN_TYPE_NEW; - - -// Power table sample. - -typedef struct _RT_CHNL_PLAN_LIMIT -{ - u2Byte Chnl_Start; - u2Byte Chnl_end; - - u2Byte Freq_Start; - u2Byte Freq_end; -}RT_CHNL_PLAN_LIMIT, *PRT_CHNL_PLAN_LIMIT; - - -// -// 2.4G Regulatory Domains -// -typedef enum _RT_REGULATION_DOMAIN_2G -{ - RT_2G_NULL, - RT_2G_WORLD, - RT_2G_ETSI1, - RT_2G_FCC1, - RT_2G_MKK1, - RT_2G_ETSI2 - -}RT_REGULATION_2G, *PRT_REGULATION_2G; - - -//typedef struct _RT_CHANNEL_BEHAVIOR -//{ -// u1Byte Chnl; -// RT_SCAN_TYPE_NEW -// -//}RT_CHANNEL_BEHAVIOR, *PRT_CHANNEL_BEHAVIOR; - -//typedef struct _RT_CHANNEL_PLAN_TYPE -//{ -// RT_CHANNEL_BEHAVIOR -// u1Byte Chnl_num; -//}RT_CHNL_PLAN_TYPE, *PRT_CHNL_PLAN_TYPE; - -// -// 2.4G Channel Number -// Channel definition & number -// -#define CHNL_RT_2G_NULL \ - {0}, 0 -#define CHNL_RT_2G_WORLD \ - {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -#define CHNL_RT_2G_WORLD_TEST \ - {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 - -#define CHNL_RT_2G_EFSI1 \ - {1,2,3,4,5,6,7,8,9,10,11,12,13}, 13 -#define CHNL_RT_2G_FCC1 \ - {1,2,3,4,5,6,7,8,9,10,11}, 11 -#define CHNL_RT_2G_MKK1 \ - {1,2,3,4,5,6,7,8,9,10,11,12,13,14}, 14 -#define CHNL_RT_2G_ETSI2 \ - {10,11,12,13}, 4 - -// -// 2.4G Channel Active or passive scan. -// -#define CHNL_RT_2G_NULL_SCAN_TYPE \ - {SCAN_NULL} -#define CHNL_RT_2G_WORLD_SCAN_TYPE \ - {1,1,1,1,1,1,1,1,1,1,1,0,0} -#define CHNL_RT_2G_EFSI1_SCAN_TYPE \ - {1,1,1,1,1,1,1,1,1,1,1,1,1} -#define CHNL_RT_2G_FCC1_SCAN_TYPE \ - {1,1,1,1,1,1,1,1,1,1,1} -#define CHNL_RT_2G_MKK1_SCAN_TYPE \ - {1,1,1,1,1,1,1,1,1,1,1,1,1,1} -#define CHNL_RT_2G_ETSI2_SCAN_TYPE \ - {1,1,1,1} - - -// -// 2.4G Band & Frequency Section -// Freqency start & end / band number -// -#define FREQ_RT_2G_NULL \ - {0}, 0 - // Passive scan CH 12, 13 -#define FREQ_RT_2G_WORLD \ - {2412, 2472}, 1 -#define FREQ_RT_2G_EFSI1 \ - {2412, 2472}, 1 -#define FREQ_RT_2G_FCC1 \ - {2412, 2462}, 1 -#define FREQ_RT_2G_MKK1 \ - {2412, 2484}, 1 -#define FREQ_RT_2G_ETSI2 \ - {2457, 2472}, 1 - - -// -// 5G Regulatory Domains -// -typedef enum _RT_REGULATION_DOMAIN_5G -{ - RT_5G_NULL, - RT_5G_WORLD, - RT_5G_ETSI1, - RT_5G_ETSI2, - RT_5G_ETSI3, - RT_5G_FCC1, - RT_5G_FCC2, - RT_5G_FCC3, - RT_5G_FCC4, - RT_5G_FCC5, - RT_5G_FCC6, - RT_5G_FCC7, - RT_5G_IC1, - RT_5G_KCC1, - RT_5G_MKK1, - RT_5G_MKK2, - RT_5G_MKK3, - RT_5G_NCC1, - -}RT_REGULATION_5G, *PRT_REGULATION_5G; - -// -// 5G Channel Number -// -#define CHNL_RT_5G_NULL \ - {0}, 0 -#define CHNL_RT_5G_WORLD \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -#define CHNL_RT_5G_ETSI1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -#define CHNL_RT_5G_ETSI2 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -#define CHNL_RT_5G_ETSI3 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -#define CHNL_RT_5G_FCC1 \ - {36,40,44,48,149,153,157,161,165}, 9 -#define CHNL_RT_5G_FCC2 \ - {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -#define CHNL_RT_5G_FCC3 \ - {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -#define CHNL_RT_5G_FCC4 \ - {149,153,157,161,165}, 5 -#define CHNL_RT_5G_FCC5 \ - {36,40,44,48,52,56,60,64}, 8 -#define CHNL_RT_5G_FCC6 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -#define CHNL_RT_5G_FCC7 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -#define CHNL_RT_5G_IC1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -#define CHNL_RT_5G_KCC1 \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -#define CHNL_RT_5G_MKK1 \ - {36,40,44,48,52,56,60,64}, 8 -#define CHNL_RT_5G_MKK2 \ - {100,104,108,112,116,120,124,128,132,136,140}, 11 -#define CHNL_RT_5G_MKK3 \ - {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -#define CHNL_RT_5G_NCC1 \ - {56,60,64,149,153,157,161,165}, 8 - -// -// 5G Channel Active or passive scan. -// -#define CHNL_RT_5G_NULL_SCAN_TYPE \ - {SCAN_NULL} -#define CHNL_RT_5G_WORLD_SCAN_TYPE \ - {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} -#define CHNL_RT_5G_ETSI1_SCAN_TYPE \ - {1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1,1} -#define CHNL_RT_5G_ETSI2_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,149,153,157,161,165}, 22 -#define CHNL_RT_5G_ETSI3_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,149,153,157,161,165}, 24 -#define CHNL_RT_5G_FCC1_SCAN_TYPE \ - {36,40,44,48,149,153,157,161,165}, 9 -#define CHNL_RT_5G_FCC2_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,149,153,157,161,165}, 13 -#define CHNL_RT_5G_FCC3_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,149,153,157,161}, 12 -#define CHNL_RT_5G_FCC4_SCAN_TYPE \ - {149,153,157,161,165}, 5 -#define CHNL_RT_5G_FCC5_SCAN_TYPE \ - {36,40,44,48,52,56,60,64}, 8 -#define CHNL_RT_5G_FCC6_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -#define CHNL_RT_5G_FCC7_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 20 -#define CHNL_RT_5G_IC1_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,149,153,157,161,165}, 20 -#define CHNL_RT_5G_KCC1_SCAN_TYPE \ - {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140}, 19 -#define CHNL_RT_5G_MKK1_SCAN_TYPE \ - {36,40,44,48,52,56,60,64}, 8 -#define CHNL_RT_5G_MKK2_SCAN_TYPE \ - {100,104,108,112,116,120,124,128,132,136,140}, 11 -#define CHNL_RT_5G_MKK3_SCAN_TYPE \ - {56,60,64,100,104,108,112,116,136,140,149,153,157,161,165}, 24 -#define CHNL_RT_5G_NCC1_SCAN_TYPE \ - {56,60,64,149,153,157,161,165}, 8 - -// -// Global Regulation -// -typedef enum _RT_REGULATION_COMMON -{ - RT_WORLD, - RT_FCC, - RT_MKK, - RT_ETSI, - RT_IC, - RT_CE, - RT_NCC, - -}RT_REGULATION_CMN, *PRT_REGULATION_CMN; - - - -// -// Special requirement for different regulation domain. -// For internal test or customerize special request. -// -typedef enum _RT_CHNLPLAN_SREQ -{ - RT_SREQ_NA = 0x0, - RT_SREQ_2G_ADHOC_11N = 0x00000001, - RT_SREQ_2G_ADHOC_11B = 0x00000002, - RT_SREQ_2G_ALL_PASS = 0x00000004, - RT_SREQ_2G_ALL_ACT = 0x00000008, - RT_SREQ_5G_ADHOC_11N = 0x00000010, - RT_SREQ_5G_ADHOC_11AC = 0x00000020, - RT_SREQ_5G_ALL_PASS = 0x00000040, - RT_SREQ_5G_ALL_ACT = 0x00000080, - RT_SREQ_C1_PLAN = 0x00000100, - RT_SREQ_C2_PLAN = 0x00000200, - RT_SREQ_C3_PLAN = 0x00000400, - RT_SREQ_C4_PLAN = 0x00000800, - RT_SREQ_NFC_ON = 0x00001000, - RT_SREQ_MASK = 0x0000FFFF, /* Requirements bit mask */ - -}RT_CHNLPLAN_SREQ, *PRT_CHNLPLAN_SREQ; - - -// -// RT_COUNTRY_NAME & RT_REGULATION_2G & RT_REGULATION_5G transfer table -// -// -typedef struct _RT_CHANNEL_PLAN_COUNTRY_TRANSFER_TABLE -{ - // - // Define countery domain and corresponding - // - RT_COUNTRY_NAME Country_Enum; - char Country_Name[3]; - - //char Domain_Name[12]; - RT_REGULATION_2G Domain_2G; - - RT_REGULATION_5G Domain_5G; - - RT_CHANNEL_DOMAIN RtChDomain; - //u1Byte Country_Area; - -}RT_CHNL_CTRY_TBL, *PRT_CHNL_CTRY_TBL; - - -#define RT_MAX_CHNL_NUM_2G 13 -#define RT_MAX_CHNL_NUM_5G 44 - -// Power table sample. - -typedef struct _RT_CHNL_PLAN_PWR_LIMIT -{ - u2Byte Chnl_Start; - u2Byte Chnl_end; - u1Byte dB_Max; - u2Byte mW_Max; -}RT_CHNL_PWR_LIMIT, *PRT_CHNL_PWR_LIMIT; - - -#define RT_MAX_BAND_NUM 5 - -typedef struct _RT_CHANNEL_PLAN_MAXPWR -{ -// STRING_T - RT_CHNL_PWR_LIMIT Chnl[RT_MAX_BAND_NUM]; - u1Byte Band_Useful_Num; - - -}RT_CHANNEL_PLAN_MAXPWR, *PRT_CHANNEL_PLAN_MAXPWR; - - -// -// Power By Rate Table. -// - - - -typedef struct _RT_CHANNEL_PLAN_NEW -{ - // - // Define countery domain and corresponding - // - //char Country_Name[36]; - //u1Byte Country_Enum; - - //char Domain_Name[12]; - - - PRT_CHNL_CTRY_TBL pCtryTransfer; - - RT_CHANNEL_DOMAIN RtChDomain; - - RT_REGULATION_2G Domain_2G; - - RT_REGULATION_5G Domain_5G; - - RT_REGULATION_CMN Regulator; - - RT_CHNLPLAN_SREQ ChnlSreq; - - //RT_CHNL_PLAN_LIMIT RtChnl; - - u1Byte Chnl2G[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD - u1Byte Len2G; - u1Byte Chnl2GScanTp[MAX_CHANNEL_NUM]; // CHNL_RT_2G_WORLD_SCAN_TYPE - //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD - - u1Byte Chnl5G[MAX_CHANNEL_NUM]; - u1Byte Len5G; - u1Byte Chnl5GScanTp[MAX_CHANNEL_NUM]; - //u1Byte Freq2G[2]; // FREQ_RT_2G_WORLD - - RT_CHANNEL_PLAN_MAXPWR ChnlMaxPwr; - - -}RT_CHANNEL_PLAN_NEW, *PRT_CHANNEL_PLAN_NEW; - - -#endif // __RT_CHANNELPLAN_H__ - - - - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/hal8723dreg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/hal8723dreg.h index 97dacb3c1c4a..11e8a6470f1b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/hal8723dreg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/hal8723dreg.h @@ -1,927 +1,942 @@ -/***************************************************************************** - * Copyright(c) 2009, RealTEK Technology Inc. All Right Reserved. - * - * Module: __INC_HAL8723DREG_H - * - * - * Note: 1. Define Mac register address and corresponding bit mask map - * - * - * Export: Constants, macro, functions(API), global variables(None). - * - * Abbrev: - * - * History: - * Data Who Remark - * - *****************************************************************************/ -#ifndef __INC_HAL8723DREG_H -#define __INC_HAL8723DREG_H - - - -//============================================================ -// -//============================================================ - -//----------------------------------------------------- -// -// 0x0000h ~ 0x00FFh System Configuration -// -//----------------------------------------------------- -#define REG_SYS_ISO_CTRL_8723D 0x0000 // 2 Byte -#define REG_SYS_FUNC_EN_8723D 0x0002 // 2 Byte -#define REG_SYS_PW_CTRL_8723D 0x0004 // 4 Byte -#define REG_SYS_CLKR_8723D 0x0008 // 2 Byte -#define REG_SYS_EEPROM_CTRL_8723D 0x000A // 2 Byte -#define REG_EE_VPD_8723D 0x000C // 2 Byte -#define REG_SYS_SWR_CTRL1_8723D 0x0010 // 1 Byte -#define REG_SYS_SWR_CTRL2_8723D 0x0014 // 1 Byte -#define REG_SYS_SWR_CTRL3_8723D 0x0018 // 4 Byte -#define REG_RSV_CTRL_8723D 0x001C // 3 Byte -#define REG_RF_CTRL_8723D 0x001F // 1 Byte -#define REG_AFE_CTRL1_8723D 0x0024 // 4 Byte -#define REG_AFE_CTRL2_8723D 0x0028 // 4 Byte -#define REG_AFE_CTRL3_8723D 0x002c // 4 Byte -#define REG_EFUSE_CTRL_8723D 0x0030 -#define REG_LDO_EFUSE_CTRL_8723D 0x0034 -#define REG_PWR_DATA_8723D 0x0038 -#define REG_CAL_TIMER_8723D 0x003C -#define REG_ACLK_MON_8723D 0x003E -#define REG_GPIO_MUXCFG_8723D 0x0040 -#define REG_GPIO_IO_SEL_8723D 0x0042 -#define REG_MAC_PINMUX_CFG_8723D 0x0043 // ?????? -#define REG_GPIO_PIN_CTRL_8723D 0x0044 -#define REG_GPIO_INTM_8723D 0x0048 -#define BIT_REG_LED_CFG_8723D 0x004C -#define REG_LEDCFG2_8723D 0x004E // ?????? -#define REG_FSIMR_8723D 0x0050 -#define REG_FSISR_8723D 0x0054 -#define REG_HSIMR_8723D 0x0058 -#define REG_HSISR_8723D 0x005c -#define REG_GPIO_EXT_CTRL_8723D 0x0060 -#define REG_MULTI_FUNC_CTRL_8723D 0x0068 -#define REG_GPIO_STATUS_8723D 0x006C -#define REG_SDIO_CTRL_8723D 0x0070 -#define REG_HCI_OPT_CTRL_8723D 0x0074 -#define REG_AFE_CTRL4_8723D 0x0078 -#define REG_LDO_SWR_CTRL_8723D 0x007C -#define REG_8051FW_CTRL_8723D 0x0080 -#define REG_FW_DBG_STATUS_8723D 0x0088 -#define REG_FW_DBG_CTRL_8723D 0x008F -#define REG_WLLPS_CTRL_8723D 0x0090 -#define REG_HIMR0_8723D 0x00B0 -#define REG_HISR0_8723D 0x00B4 -#define REG_HIMR1_8723D 0x00B8 -#define REG_HISR1_8723D 0x00BC -#define REG_PMC_DBG_CTRL2_8723D 0x00CC -#define REG_EFUSE_BURN_GNT_8723D 0x00CF -#define REG_XTAL_AAC_8723D 0x00EC -#define REG_SYS_CFG1_8723D 0x00F0 -#define REG_SYS_CFG2_8723D 0x00FC -#define REG_ROM_VERSION 0x00FD - -//----------------------------------------------------- -// -// 0x0100h ~ 0x01FFh MACTOP General Configuration -// -//----------------------------------------------------- -#define REG_CR_8723D 0x0100 -#define REG_PBP_8723D 0x0104 // ?????? -#define REG_PKT_BUFF_ACCESS_CTRL_8723D 0x0106 // ?????? -#define REG_TRXDMA_CTRL_8723D 0x010C -#define REG_TRXFF_BNDY_8723D 0x0114 -#define REG_RXFF_PTR_8723D 0x011C -#define REG_CPWM_8723D 0x012C -#define REG_FWIMR_8723D 0x0130 -#define REG_FWISR_8723D 0x0134 -#define REG_FTIMR_8723D 0x0138 -#define REG_PKTBUF_DBG_CTRL_8723D 0x0140 -#define REG_RXPKTBUF_CTRL_8723D 0x0142 // ?????? -#define REG_PKTBUF_DBG_DATA_L_8723D 0x0144 -#define REG_PKTBUF_DBG_DATA_H_8723D 0x0148 - -#define REG_TC0_CTRL_8723D 0x0150 -#define REG_TC1_CTRL_8723D 0x0154 -#define REG_TC2_CTRL_8723D 0x0158 -#define REG_TC3_CTRL_8723D 0x015C -#define REG_TC4_CTRL_8723D 0x0160 -#define REG_TCUNIT_BASE_8723D 0x0164 -#define REG_RSVD3_8723D 0x0168 // ????? - -#define REG_C2HEVT_MSG_NORMAL_8723D 0x01A0 // ?????? -#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 // ?????? -#define REG_C2hEVT_CMD_CONTENT_88XX 0x01A2 // ?????? -#define REG_C2HEVT_CMD_LEN_88XX 0x01AE // ?????? -#define REG_C2HEVT_CLEAR_8723D 0x01AF // ?????? -#define REG_MCUTST_1_8723D 0x01C0 -#define REG_MCUTST_2_8723D 0x01C4 -#define REG_MCUTST_WOWLAN_8723D 0x01C7 // ?????? -#define REG_FMETHR_8723D 0x01C8 -#define REG_HMETFR_8723D 0x01CC -#define REG_HMEBOX_0_8723D 0x01D0 -#define REG_HMEBOX_1_8723D 0x01D4 -#define REG_HMEBOX_2_8723D 0x01D8 -#define REG_HMEBOX_3_8723D 0x01DC -#define REG_LLT_INIT_8723D 0x01E0 -#define REG_HMEBOX_EXT0_8723D 0x01F0 // ?????? -#define REG_HMEBOX_EXT1_8723D 0x01F4 // ?????? -#define REG_HMEBOX_EXT2_8723D 0x01F8 // ?????? -#define REG_HMEBOX_EXT3_8723D 0x01FC // ?????? - -//----------------------------------------------------- -// -// 0x0200h ~ 0x027Fh TXDMA Configuration -// -//----------------------------------------------------- -#define REG_RQPN_8723D 0x0200 -#define REG_FIFOPAGE_8723D 0x0204 -#define REG_TDECTRL_8723D 0x0208 -#define REG_TXDMA_OFFSET_CHK_8723D 0x020C -#define REG_TXDMA_STATUS_8723D 0x0210 -#define REG_RQPN_NPQ_8723D 0x0214 -#define REG_AUTO_LLT_8723D 0x0224 -#define REG_DWBCN1_CTRL_8723D 0x0228 - - -//----------------------------------------------------- -// -// 0x0280h ~ 0x02FFh RXDMA Configuration -// -//----------------------------------------------------- -#define REG_RXDMA_AGG_PG_TH_8723D 0x0280 -#define REG_RXPKT_NUM_8723D 0x0284 // The number of packets in RXPKTBUF. -#define REG_RXDMA_CONTROL_8723D 0x0286 // ?????? Control the RX DMA. -#define REG_RXDMA_STATUS_8723D 0x0288 -#define REG_RXDMA_PRO_8723D 0x0290 // ?????? -#define REG_EARLY_MODE_CONTROL_8723D 0x02BC // ?????? -#define REG_RSVD5_8723D 0x02F0 // ?????? - - -//----------------------------------------------------- -// -// 0x0300h ~ 0x03FFh PCIe -// -//----------------------------------------------------- -#define REG_PCIE_CTRL_REG_8723D 0x0300 -#define REG_INT_MIG_8723D 0x0304 // Interrupt Migration -#define REG_BCNQ_TXBD_DESA_8723D 0x0308 // TX Beacon Descriptor Address -#define REG_MGQ_TXBD_DESA_8723D 0x0310 // TX Manage Queue Descriptor Address -#define REG_VOQ_TXBD_DESA_8723D 0x0318 // TX VO Queue Descriptor Address -#define REG_VIQ_TXBD_DESA_8723D 0x0320 // TX VI Queue Descriptor Address -#define REG_BEQ_TXBD_DESA_8723D 0x0328 // TX BE Queue Descriptor Address -#define REG_BKQ_TXBD_DESA_8723D 0x0330 // TX BK Queue Descriptor Address -#define REG_RXQ_RXBD_DESA_8723D 0x0338 // RX Queue Descriptor Address -#define REG_HI0Q_TXBD_DESA_8723D 0x0340 -#define REG_HI1Q_TXBD_DESA_8723D 0x0348 -#define REG_HI2Q_TXBD_DESA_8723D 0x0350 -#define REG_HI3Q_TXBD_DESA_8723D 0x0358 -#define REG_HI4Q_TXBD_DESA_8723D 0x0360 -#define REG_HI5Q_TXBD_DESA_8723D 0x0368 -#define REG_HI6Q_TXBD_DESA_8723D 0x0370 -#define REG_HI7Q_TXBD_DESA_8723D 0x0378 -#define REG_MGQ_TXBD_NUM_8723D 0x0380 -#define REG_RX_RXBD_NUM_8723D 0x0382 -#define REG_VOQ_TXBD_NUM_8723D 0x0384 -#define REG_VIQ_TXBD_NUM_8723D 0x0386 -#define REG_BEQ_TXBD_NUM_8723D 0x0388 -#define REG_BKQ_TXBD_NUM_8723D 0x038A -#define REG_HI0Q_TXBD_NUM_8723D 0x038C -#define REG_HI1Q_TXBD_NUM_8723D 0x038E -#define REG_HI2Q_TXBD_NUM_8723D 0x0390 -#define REG_HI3Q_TXBD_NUM_8723D 0x0392 -#define REG_HI4Q_TXBD_NUM_8723D 0x0394 -#define REG_HI5Q_TXBD_NUM_8723D 0x0396 -#define REG_HI6Q_TXBD_NUM_8723D 0x0398 -#define REG_HI7Q_TXBD_NUM_8723D 0x039A -#define REG_TSFTIMER_HCI_8723D 0x039C - -//Read Write Point -#define REG_VOQ_TXBD_IDX_8723D 0x03A0 -#define REG_VIQ_TXBD_IDX_8723D 0x03A4 -#define REG_BEQ_TXBD_IDX_8723D 0x03A8 -#define REG_BKQ_TXBD_IDX_8723D 0x03AC -#define REG_MGQ_TXBD_IDX_8723D 0x03B0 -#define REG_RXQ_TXBD_IDX_8723D 0x03B4 -#define REG_HI0Q_TXBD_IDX_8723D 0x03B8 -#define REG_HI1Q_TXBD_IDX_8723D 0x03BC -#define REG_HI2Q_TXBD_IDX_8723D 0x03C0 -#define REG_HI3Q_TXBD_IDX_8723D 0x03C4 -#define REG_HI4Q_TXBD_IDX_8723D 0x03C8 -#define REG_HI5Q_TXBD_IDX_8723D 0x03CC -#define REG_HI6Q_TXBD_IDX_8723D 0x03D0 -#define REG_HI7Q_TXBD_IDX_8723D 0x03D4 - -#define REG_PCIE_HCPWM_8723DE 0x03D8 // ?????? -#define REG_PCIE_HRPWM_8723DE 0x03DC //PCIe RPWM // ?????? -#define REG_DBI_WDATA_V1_8723D 0x03E8 -#define REG_DBI_RDATA_V1_8723D 0x03EC -#define REG_DBI_FLAG_V1_8723D 0x03F0 -#define REG_MDIO_V1_8723D 0x03F4 -#define REG_PCIE_MIX_CFG_8723D 0x03F8 -#define REG_HCI_MIX_CFG_8723D 0x03FC - -//----------------------------------------------------- -// -// 0x0400h ~ 0x047Fh Protocol Configuration -// -//----------------------------------------------------- -#define REG_TXPKT_EMPTY_8723D 0x041A -#define REG_PTCL_POLL_MGN_8723D 0x041F -#define REG_FWHW_TXQ_CTRL_8723D 0x0420 -#define REG_HWSEQ_CTRL_8723D 0x0423 -#define REG_BCNQ_BDNY_8723D 0x0424 -#define REG_MGQ_BDNY_8723D 0x0425 -#define REG_LIFETIME_EN_8723D 0x0426 -#define REG_FW_FREE_TAIL_8723D 0x0427 -#define REG_SPEC_SIFS_8723D 0x0428 -#define REG_RETRY_LIMIT_8723D 0x042A -#define REG_TXBF_CTRL_8723D 0x042C -#define REG_DARFRC_8723D 0x0430 -#define REG_RARFRC_8723D 0x0438 -#define REG_RRSR_8723D 0x0440 -#define REG_ARFR0_8723D 0x0444 -#define REG_ARFR1_8723D 0x044C -#define REG_CCK_CHECK_8723D 0x0454 -#define REG_BCNQ2_BDNY_8723D 0x0455 -#define REG_AMPDU_MAX_TIME_8723D 0x0456 -#define REG_BCNQ1_BDNY_8723D 0x0457 -#define REG_AMPDU_MAX_LENGTH_8723D 0x0458 -#define REG_WMAC_LBK_BUF_HD_8723D 0x045D -#define REG_NDPA_OPT_CTRL_8723D 0x045F -#define REG_FAST_EDCA_CTRL_8723D 0x0460 -#define REG_RD_RESP_PKT_TH_8723D 0x0463 -#define REG_DATA_SC_8723D 0x0483 -#define REG_TXRPT_START_OFFSET 0x04AC -#define REG_POWER_STAGE1_8723D 0x04B4 -#define REG_PTCL_SDF_STATUS_8723D 0x04BB -#define REG_SW_AMPDU_BURST_MODE_CTRL_8723D 0x04BC -#define REG_EVTQ_BNDY_8723D 0x04BF -#define REG_PKT_LIFE_TIME_8723D 0x04C0 -#define REG_PKT_BE_BK_LIFE_TIME_8723D 0x04C2 // ?????? - -#define REG_STBC_SETTING_8723D 0x04C4 -#define REG_HT_SINGLE_AMPDU_8723D 0x04C7 -#define REG_PROT_MODE_CTRL_8723D 0x04C8 -#define REG_MAX_AGGR_NUM_8723D 0x04CA -#define REG_RTS_MAX_AGGR_NUM_8723D 0x04CB -#define REG_BAR_MODE_CTRL_8723D 0x04CC -#define REG_RA_TRY_RATE_AGG_LMT_8723D 0x04CF -#define REG_MACID_SLEEP2_8723D 0x04D0 -#define REG_PTCL_HWSSN0_8723D 0x04D8 -#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723D 0x045D // ?????? - - -/************* 0x1480~0x14A7 is for NAN ***************/ -//Own Master Rank, 8Bytes -#define REG_NAN_INTERFACE_ADDR_8723D 0x2480 // 6 bytes -#define REG_NAN_RANDOM_FACTOR_8723D 0x2486 // 1 byte -#define REG_NAN_MASTER_PREF_8723D 0x2487 // 1 byte - -//0x5dc[25:24] NAN role - -//Current Anchor Master Record -#define REG_NAN_CAMR_L_8723D 0x2488 // 4 bytes -#define REG_NAN_CAMR_H_8723D 0x248C // 4 byte -//#define REG_HOP_CNT_8723D 0x05DC -#define REG_NAN_CAMR_AMBTT_8723D 0x2490 // 4 bytes - -//Last Anchor Master Record -#define REG_NAN_LAMR_L_8723D 0x2494 // 4 bytes -#define REG_NAN_LAMR_H_8723D 0x2498 // 4 byte -#define REG_NAN_LAMR_AMBTT_8723D 0x249C // 4 bytes - -//TSF Synced:bit 0 -//Anchor Master: bit 7 -#define REG_NAN_STATUS_8723D 0x24A0 //BIT0 -/***************************************************/ - - -//----------------------------------------------------- -// -// 0x0500h ~ 0x05FFh EDCA Configuration -// -//----------------------------------------------------- -// gogogo -#define REG_EDCA_VO_PARAM_8723D 0x0500 -#define REG_EDCA_VI_PARAM_8723D 0x0504 -#define REG_EDCA_BE_PARAM_8723D 0x0508 -#define REG_EDCA_BK_PARAM_8723D 0x050C -#define REG_BCNTCFG_8723D 0x0510 -#define REG_PIFS_8723D 0x0512 -#define REG_RDG_PIFS_8723D 0x0513 -#define REG_SIFS_CTX_8723D 0x0514 -#define REG_SIFS_TRX_8723D 0x0516 -#define REG_AGGR_BREAK_TIME_8723D 0x051A -#define REG_SLOT_8723D 0x051B -#define REG_TX_PTCL_CTRL_8723D 0x0520 -#define REG_TXPAUSE_8723D 0x0522 -#define REG_DIS_TXREQ_CLR_8723D 0x0523 -#define REG_RD_CTRL_8723D 0x0524 -// -// Format for offset 540h-542h: -// [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. -// [7:4]: Reserved. -// [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. -// [23:20]: Reserved -// Description: -// | -// |<--Setup--|--Hold------------>| -// --------------|---------------------- -// | -// TBTT -// Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. -// Described by Designer Tim and Bruce, 2011-01-14. -// -#define REG_TBTT_PROHIBIT_8723D 0x0540 -#define REG_RD_NAV_NXT_8723D 0x0544 -#define REG_NAV_PROT_LEN_8723D 0x0546 -#define REG_BCN_CTRL_8723D 0x0550 -#define REG_EDCA_BCNCTRL1_IOREG_8723D 0x0551 -#define REG_MBID_NUM_8723D 0x0552 -#define REG_DUAL_TSF_RST_8723D 0x0553 -#define REG_BCN_INTERVAL_8723D 0x0554 -#define REG_DRVERLYINT_8723D 0x0558 -#define REG_BCNDMATIM_8723D 0x0559 -#define REG_ATIMWND_8723D 0x055A -#define REG_USTIME_TSF_8723D 0x055C -#define REG_BCN_MAX_ERR_8723D 0x055D -#define REG_RXTSF_OFFSET_CCK_8723D 0x055E -#define REG_RXTSF_OFFSET_OFDM_8723D 0x055F -#define REG_TSFTR_8723D 0x0560 -#define REG_CTWND_8723D 0x0572 -#define REG_SECONDARY_CCA_CTRL_8723D 0x0577 // ?????? -#define REG_TSFTR2_8723D 0x0578 -#define REG_PSTIMER_8723D 0x0580 -#define REG_TIMER0_8723D 0x0584 -#define REG_TIMER1_8723D 0x0588 -#define REG_SCH_MULTI_BCN_8723D 0x05B2 -#define REG_SCH_CURRENT_BCN_8723D 0x05B3 -#define REG_ACMHWCTRL_8723D 0x05C0 -#define REG_SCH_SDFX_EARLY_8723D 0x05CF -#define REG_SCH_PORT2_EARLY_8723D 0x05D0 -#define REG_SCH_TSFT_DIFF_8723D 0x05D2 -#define REG_EDCA_BCNCTRL2_IOREG_8723D 0x05D4 -#define REG_EDCA_DRVERLYINT1_IOREG_8723D 0x05D4 -#define REG_EDCA_BCNSPACE3_IOREG_8723D 0x05D8 -#define REG_EDCA_BCNSPACE4_IOREG_8723D 0x05DA -#define REG_HOP_CNT_8723D 0x05DC -#define REG_SCH_M_DW_8723D 0x05DD -#define REG_SCH_M_SLOT_8723D 0x05DE -#define REG_SCH_EARLY_DWEND_8723D 0x05DF -#define REG_SCH_TXCMD_8723D 0x05F8 - -//----------------------------------------------------- -// -// 0x0600h ~ 0x07FFh WMAC Configuration -// -//----------------------------------------------------- -// gogogo -#define REG_MAC_CR_8723D 0x0600 -#define REG_TCR_8723D 0x0604 -#define REG_RCR_8723D 0x0608 -#define REG_RX_PKT_LIMIT_8723D 0x060C -#define REG_RX_DLK_TIME_8723D 0x060D -#define REG_RX_DRVINFO_SZ_8723D 0x060F - -#define REG_MACID_8723D 0x0610 -#define REG_BSSID_8723D 0x0618 -#define REG_MAR_8723D 0x0620 -#define REG_MBIDCAMCFG_8723D 0x0628 - -#define REG_USTIME_EDCA_8723D 0x0638 -#define REG_MAC_SPEC_SIFS_8723D 0x063A -#define REG_RESP_SIFP_CCK_8723D 0x063C -#define REG_RESP_SIFS_OFDM_8723D 0x063E -#define REG_ACKTO_8723D 0x0640 -#define REG_CTS2TO_8723D 0x0641 -#define REG_EIFS_8723D 0x0642 - -#define REG_NAV_UPPER_8723D 0x0652 // ?????? -#define REG_TRXPTCL_CTL_8723D 0x0668 - -// Security -#define REG_CAMCMD_8723D 0x0670 -#define REG_CAMWRITE_8723D 0x0674 -#define REG_CAMREAD_8723D 0x0678 -#define REG_CAMDBG_8723D 0x067C -#define REG_SECCFG_8723D 0x0680 - -// Power -#define REG_WOW_CTRL_8723D 0x0690 -#define REG_PS_RX_INFO_8723D 0x0692 -#define REG_UAPSD_TID_8723D 0x0693 -#define REG_WKFMCAM_NUM_8723D 0x0698 -#define REG_RXFLTMAP0_8723D 0x06A0 -#define REG_RXFLTMAP1_8723D 0x06A2 -#define REG_RXFLTMAP2_8723D 0x06A4 -#define REG_BCN_PSR_RPT_8723D 0x06A8 -#define REG_BT_COEX_TABLE_8723D 0x06C0 -#define REG_ASSOCIATED_BFMER0_INFO_8723D 0x06E4 -#define REG_ASSOCIATED_BFMER1_INFO_8723D 0x06EC -#define REG_CSI_RPT_PARAM_BW20_8723D 0x06F4 -#define REG_CSI_RPT_PARAM_BW40_8723D 0x06F8 -#define REG_CSI_RPT_PARAM_BW80_8723D 0x06FC - -// Hardware Port 2 -#define REG_MACID1_8723D 0x0700 -#define REG_BSSID1_8723D 0x0708 -#define REG_ASSOCIATED_BFMEE_SEL_8723D 0x0714 -#define REG_SND_PTCL_CTRL_8723D 0x0718 - -//----------------------------------------------------- -// -// Redifine 8192C register definition for compatibility -// -//----------------------------------------------------- - -// TODO: use these definition when using REG_xxx naming rule. -// NOTE: DO NOT Remove these definition. Use later. -#define EFUSE_CTRL_8723D REG_EFUSE_CTRL_8723D // E-Fuse Control. -#define EFUSE_TEST_8723D REG_LDO_EFUSE_CTRL_8723D // E-Fuse Test. -#define MSR_8723D (REG_CR_8723D + 2) // Media Status register -#define ISR_8723D REG_HISR0_8723D -#define TSFR_8723D REG_TSFTR_8723D // Timing Sync Function Timer Register. - -// Redifine MACID register, to compatible prior ICs. -#define IDR0_8723D REG_MACID_8723D // MAC ID Register, Offset 0x0050-0x0053 -#define IDR4_8723D (REG_MACID_8723D + 4) // MAC ID Register, Offset 0x0054-0x0055 - - -// -// 9. Security Control Registers (Offset: ) -// -#define RWCAM_8723D REG_CAMCMD_8723D //IN 8190 Data Sheet is called CAMcmd -#define WCAMI_8723D REG_CAMWRITE_8723D // Software write CAM input content -#define RCAMO_8723D REG_CAMREAD_8723D // Software read/write CAM config -#define CAMDBG_8723D REG_CAMDBG_8723D -#define SECR_8723D REG_SECCFG_8723D //Security Configuration Register - - -//---------------------------------------------------------------------------- -// 8195 IMR/ISR bits (offset 0xB0, 8bits) -//---------------------------------------------------------------------------- -#define IMR_DISABLED_8723D 0 -// IMR DW0(0x00B0-00B3) Bit 0-31 -#define IMR_TIMER2_8723D BIT31 // Timeout interrupt 2 -#define IMR_TIMER1_8723D BIT30 // Timeout interrupt 1 -#define IMR_PSTIMEOUT_8723D BIT29 // Power Save Time Out Interrupt -#define IMR_GTINT4_8723D BIT28 // When GTIMER4 expires, this bit is set to 1 -#define IMR_GTINT3_8723D BIT27 // When GTIMER3 expires, this bit is set to 1 -#define IMR_TXBCN0ERR_8723D BIT26 // Transmit Beacon0 Error -#define IMR_TXBCN0OK_8723D BIT25 // Transmit Beacon0 OK -#define IMR_TSF_BIT32_TOGGLE_8723D BIT24 // TSF Timer BIT32 toggle indication interrupt -#define IMR_BCNDMAINT0_8723D BIT20 // Beacon DMA Interrupt 0 -#define IMR_BCNDERR0_8723D BIT16 // Beacon Queue DMA OK0 -#define IMR_HSISR_IND_ON_INT_8723D BIT15 // HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) -#define IMR_BCNDMAINT_E_8723D BIT14 // Beacon DMA Interrupt Extension for Win7 -#define IMR_ATIMEND_8723D BIT12 // CTWidnow End or ATIM Window End -#define IMR_C2HCMD_8723D BIT10 // CPU to Host Command INT Status, Write 1 clear -#define IMR_CPWM2_8723D BIT9 // CPU power Mode exchange INT Status, Write 1 clear -#define IMR_CPWM_8723D BIT8 // CPU power Mode exchange INT Status, Write 1 clear -#define IMR_HIGHDOK_8723D BIT7 // High Queue DMA OK -#define IMR_MGNTDOK_8723D BIT6 // Management Queue DMA OK -#define IMR_BKDOK_8723D BIT5 // AC_BK DMA OK -#define IMR_BEDOK_8723D BIT4 // AC_BE DMA OK -#define IMR_VIDOK_8723D BIT3 // AC_VI DMA OK -#define IMR_VODOK_8723D BIT2 // AC_VO DMA OK -#define IMR_RDU_8723D BIT1 // Rx Descriptor Unavailable -#define IMR_ROK_8723D BIT0 // Receive DMA OK - -// IMR DW1(0x00B4-00B7) Bit 0-31 -#define IMR_BCNDMAINT7_8723D BIT27 // Beacon DMA Interrupt 7 -#define IMR_BCNDMAINT6_8723D BIT26 // Beacon DMA Interrupt 6 -#define IMR_BCNDMAINT5_8723D BIT25 // Beacon DMA Interrupt 5 -#define IMR_BCNDMAINT4_8723D BIT24 // Beacon DMA Interrupt 4 -#define IMR_BCNDMAINT3_8723D BIT23 // Beacon DMA Interrupt 3 -#define IMR_BCNDMAINT2_8723D BIT22 // Beacon DMA Interrupt 2 -#define IMR_BCNDMAINT1_8723D BIT21 // Beacon DMA Interrupt 1 -#define IMR_BCNDOK7_8723D BIT20 // Beacon Queue DMA OK Interrup 7 -#define IMR_BCNDOK6_8723D BIT19 // Beacon Queue DMA OK Interrup 6 -#define IMR_BCNDOK5_8723D BIT18 // Beacon Queue DMA OK Interrup 5 -#define IMR_BCNDOK4_8723D BIT17 // Beacon Queue DMA OK Interrup 4 -#define IMR_BCNDOK3_8723D BIT16 // Beacon Queue DMA OK Interrup 3 -#define IMR_BCNDOK2_8723D BIT15 // Beacon Queue DMA OK Interrup 2 -#define IMR_BCNDOK1_8723D BIT14 // Beacon Queue DMA OK Interrup 1 -#define IMR_ATIMEND_E_8723D BIT13 // ATIM Window End Extension for Win7 -#define IMR_TXERR_8723D BIT11 // Tx Error Flag Interrupt Status, write 1 clear. -#define IMR_RXERR_8723D BIT10 // Rx Error Flag INT Status, Write 1 clear -#define IMR_TXFOVW_8723D BIT9 // Transmit FIFO Overflow -#define IMR_RXFOVW_8723D BIT8 // Receive FIFO Overflow - - - -#define IMR_MCUERR_8723D BIT28 // Beacon DMA Interrupt 7 - - -/*=================================================================== -===================================================================== -Here the register defines are for 92C. When the define is as same with 92C, -we will use the 92C's define for the consistency -So the following defines for 92C is not entire!!!!!! -===================================================================== -=====================================================================*/ -/* -Based on Datasheet V33---090401 -Register Summary -Current IOREG MAP -0x0000h ~ 0x00FFh System Configuration (256 Bytes) -0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) -0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) -0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) -0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) -0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) -0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) -0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) -0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) -*/ -//---------------------------------------------------------------------------- -// 8195 (TXPAUSE) transmission pause (Offset 0x522, 8 bits) -//---------------------------------------------------------------------------- -/* -#define StopBecon BIT6 -#define StopHigh BIT5 -#define StopMgt BIT4 -#define StopVO BIT3 -#define StopVI BIT2 -#define StopBE BIT1 -#define StopBK BIT0 -*/ - - - -//============================================================================ -// 8192C Regsiter Bit and Content definition -//============================================================================ -//----------------------------------------------------- -// -// 0x0000h ~ 0x00FFh System Configuration -// -//----------------------------------------------------- -/* -//2 SYS_ISO_CTRL -#define ISO_MD2PP BIT(0) -#define ISO_UA2USB BIT(1) -#define ISO_UD2CORE BIT(2) -#define ISO_PA2PCIE BIT(3) -#define ISO_PD2CORE BIT(4) -#define ISO_IP2MAC BIT(5) -#define ISO_DIOP BIT(6) -#define ISO_DIOE BIT(7) -#define ISO_EB2CORE BIT(8) -#define ISO_DIOR BIT(9) -#define PWC_EV12V BIT(15) - - -//2 SYS_FUNC_EN -#define FEN_BBRSTB BIT(0) -#define FEN_BB_GLB_RSTn BIT(1) -#define FEN_USBA BIT(2) -#define FEN_UPLL BIT(3) -#define FEN_USBD BIT(4) -#define FEN_DIO_PCIE BIT(5) -#define FEN_PCIEA BIT(6) -#define FEN_PPLL BIT(7) -#define FEN_PCIED BIT(8) -#define FEN_DIOE BIT(9) -#define FEN_CPUEN BIT(10) -#define FEN_DCORE BIT(11) -#define FEN_ELDR BIT(12) -#define FEN_DIO_RF BIT(13) -#define FEN_HWPDN BIT(14) -#define FEN_MREGEN BIT(15) - -//2 APS_FSMCO -#define PFM_LDALL BIT(0) -#define PFM_ALDN BIT(1) -#define PFM_LDKP BIT(2) -#define PFM_WOWL BIT(3) -#define EnPDN BIT(4) -#define PDN_PL BIT(5) -#define APFM_ONMAC BIT(8) -#define APFM_OFF BIT(9) -#define APFM_RSM BIT(10) -#define AFSM_HSUS BIT(11) -#define AFSM_PCIE BIT(12) -#define APDM_MAC BIT(13) -#define APDM_HOST BIT(14) -#define APDM_HPDN BIT(15) -#define RDY_MACON BIT(16) -#define SUS_HOST BIT(17) -#define ROP_ALD BIT(20) -#define ROP_PWR BIT(21) -#define ROP_SPS BIT(22) -#define SOP_MRST BIT(25) -#define SOP_FUSE BIT(26) -#define SOP_ABG BIT(27) -#define SOP_AMB BIT(28) -#define SOP_RCK BIT(29) -#define SOP_A8M BIT(30) -#define XOP_BTCK BIT(31) - -//2 SYS_CLKR -#define ANAD16V_EN BIT(0) -#define ANA8M BIT(1) -#define MACSLP BIT(4) -#define LOADER_CLK_EN BIT(5) - - -//2 9346CR - -#define BOOT_FROM_EEPROM BIT(4) -#define EEPROM_EN BIT(5) - - -//2 RF_CTRL -#define RF_EN BIT(0) -#define RF_RSTB BIT(1) -#define RF_SDMRSTB BIT(2) - -//2 LDOV12D_CTRL -#define LDV12_EN BIT(0) -#define LDV12_SDBY BIT(1) -#define LPLDO_HSM BIT(2) -#define LPLDO_LSM_DIS BIT(3) -#define _LDV12_VADJ(x) (((x) & 0xF) << 4) - - -//2 EFUSE_TEST (For RTL8723 partially) -#define EF_TRPT BIT(7) -#define EF_CELL_SEL (BIT(8)|BIT(9)) // 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 -#define LDOE25_EN BIT(31) -#define EFUSE_SEL(x) (((x) & 0x3) << 8) -#define EFUSE_SEL_MASK 0x300 -#define EFUSE_WIFI_SEL_0 0x0 -#define EFUSE_BT_SEL_0 0x1 -#define EFUSE_BT_SEL_1 0x2 -#define EFUSE_BT_SEL_2 0x3 - - -//2 8051FWDL -//2 MCUFWDL -#define MCUFWDL_EN BIT(0) -#define MCUFWDL_RDY BIT(1) -#define FWDL_ChkSum_rpt BIT(2) -#define MACINI_RDY BIT(3) -#define BBINI_RDY BIT(4) -#define RFINI_RDY BIT(5) -#define WINTINI_RDY BIT(6) -#define RAM_DL_SEL BIT(7) -#define ROM_DLEN BIT(19) -#define CPRST BIT(23) - - - -//2 REG_SYS_CFG -#define XCLK_VLD BIT(0) -#define ACLK_VLD BIT(1) -#define UCLK_VLD BIT(2) -#define PCLK_VLD BIT(3) -#define PCIRSTB BIT(4) -#define V15_VLD BIT(5) -#define TRP_B15V_EN BIT(7) -#define SIC_IDLE BIT(8) -#define BD_MAC2 BIT(9) -#define BD_MAC1 BIT(10) -#define IC_MACPHY_MODE BIT(11) -#define CHIP_VER (BIT(12)|BIT(13)|BIT(14)|BIT(15)) -#define BT_FUNC BIT(16) -#define VENDOR_ID BIT(19) -#define PAD_HWPD_IDN BIT(22) -#define TRP_VAUX_EN BIT(23) // RTL ID -#define TRP_BT_EN BIT(24) -#define BD_PKG_SEL BIT(25) -#define BD_HCI_SEL BIT(26) -#define TYPE_ID BIT(27) - -#define CHIP_VER_RTL_MASK 0xF000 //Bit 12 ~ 15 -#define CHIP_VER_RTL_SHIFT 12 - -*/ -//----------------------------------------------------- -// -// 0x0100h ~ 0x01FFh MACTOP General Configuration -// -//----------------------------------------------------- -/* - -//2 Function Enable Registers -//2 CR 0x0100-0x0103 - - -#define HCI_TXDMA_EN BIT(0) -#define HCI_RXDMA_EN BIT(1) -#define TXDMA_EN BIT(2) -#define RXDMA_EN BIT(3) -#define PROTOCOL_EN BIT(4) -#define SCHEDULE_EN BIT(5) -#define MACTXEN BIT(6) -#define MACRXEN BIT(7) -#define ENSWBCN BIT(8) -#define ENSEC BIT(9) -#define CALTMR_EN BIT(10) // 32k CAL TMR enable - -// Network type -#define _NETTYPE(x) (((x) & 0x3) << 16) -#define MASK_NETTYPE 0x30000 -#define NT_NO_LINK 0x0 -#define NT_LINK_AD_HOC 0x1 -#define NT_LINK_AP 0x2 -#define NT_AS_AP 0x3 - - -//2 PBP - Page Size Register 0x0104 -#define GET_RX_PAGE_SIZE(value) ((value) & 0xF) -#define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) -#define _PSRX_MASK 0xF -#define _PSTX_MASK 0xF0 -#define _PSRX(x) (x) -#define _PSTX(x) ((x) << 4) - -#define PBP_64 0x0 -#define PBP_128 0x1 -#define PBP_256 0x2 -#define PBP_512 0x3 -#define PBP_1024 0x4 - - -//2 TX/RXDMA 0x010C -#define RXDMA_ARBBW_EN BIT(0) -#define RXSHFT_EN BIT(1) -#define RXDMA_AGG_EN BIT(2) -#define QS_VO_QUEUE BIT(8) -#define QS_VI_QUEUE BIT(9) -#define QS_BE_QUEUE BIT(10) -#define QS_BK_QUEUE BIT(11) -#define QS_MANAGER_QUEUE BIT(12) -#define QS_HIGH_QUEUE BIT(13) - -#define HQSEL_VOQ BIT(0) -#define HQSEL_VIQ BIT(1) -#define HQSEL_BEQ BIT(2) -#define HQSEL_BKQ BIT(3) -#define HQSEL_MGTQ BIT(4) -#define HQSEL_HIQ BIT(5) - -// For normal driver, 0x10C -#define _TXDMA_HIQ_MAP(x) (((x)&0x3) << 14) -#define _TXDMA_MGQ_MAP(x) (((x)&0x3) << 12) -#define _TXDMA_BKQ_MAP(x) (((x)&0x3) << 10) -#define _TXDMA_BEQ_MAP(x) (((x)&0x3) << 8 ) -#define _TXDMA_VIQ_MAP(x) (((x)&0x3) << 6 ) -#define _TXDMA_VOQ_MAP(x) (((x)&0x3) << 4 ) - -#define QUEUE_LOW 1 -#define QUEUE_NORMAL 2 -#define QUEUE_HIGH 3 - - -//2 REG_C2HEVT_CLEAR 0x01AF -#define C2H_EVT_HOST_CLOSE 0x00 // Set by driver and notify FW that the driver has read the C2H command message -#define C2H_EVT_FW_CLOSE 0xFF // Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. - - - -//2 LLT_INIT 0x01E0 -#define _LLT_NO_ACTIVE 0x0 -#define _LLT_WRITE_ACCESS 0x1 -#define _LLT_READ_ACCESS 0x2 - -#define _LLT_INIT_DATA(x) ((x) & 0xFF) -#define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) -#define _LLT_OP(x) (((x) & 0x3) << 30) -#define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) - -*/ -//----------------------------------------------------- -// -// 0x0200h ~ 0x027Fh TXDMA Configuration -// -//----------------------------------------------------- -/* -//2 TDECTL 0x0208 -#define BLK_DESC_NUM_SHIFT 4 -#define BLK_DESC_NUM_MASK 0xF - - -//2 TXDMA_OFFSET_CHK 0x020C -#define DROP_DATA_EN BIT(9) -*/ -//----------------------------------------------------- -// -// 0x0280h ~ 0x028Bh RX DMA Configuration -// -//----------------------------------------------------- -/* -//2 REG_RXDMA_CONTROL, 0x0286h - -// Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before -// this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. -#define RXPKT_RELEASE_POLL BIT(0) -// Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in -// this bit. FW can start releasing packets after RXDMA entering idle mode. -#define RXDMA_IDLE BIT(1) -// When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host -// completed, and stop DMA packet to host. RXDMA will then report Default: 0; -#define RW_RELEASE_EN BIT(2) -*/ -//----------------------------------------------------- -// -// 0x0400h ~ 0x047Fh Protocol Configuration -// -//----------------------------------------------------- -/* -//2 FWHW_TXQ_CTRL 0x0420 -#define EN_AMPDU_RTY_NEW BIT(7) - - -//2 REG_LIFECTRL_CTRL 0x0426 -#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 -#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 -#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 -#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 - -#define HAL92C_MSDU_LIFE_TIME_UNIT 128 // in us, said by Tim. - - -//2 SPEC SIFS 0x0428 -#define _SPEC_SIFS_CCK(x) ((x) & 0xFF) -#define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) - -//2 RL 0x042A -#define RETRY_LIMIT_SHORT_SHIFT 8 -#define RETRY_LIMIT_LONG_SHIFT 0 - -#define _LRL(x) ((x) & 0x3F) -#define _SRL(x) (((x) & 0x3F) << 8) -*/ - -//----------------------------------------------------- -// -// 0x0500h ~ 0x05FFh EDCA Configuration -// -//----------------------------------------------------- -/* -//2 EDCA setting 0x050C -#define AC_PARAM_TXOP_LIMIT_OFFSET 16 -#define AC_PARAM_ECW_MAX_OFFSET 12 -#define AC_PARAM_ECW_MIN_OFFSET 8 -#define AC_PARAM_AIFS_OFFSET 0 - - -//2 BCN_CTRL 0x0550 -#define EN_TXBCN_RPT BIT(2) -#define EN_BCN_FUNCTION BIT(3) - -//2 TxPause 0x0522 -#define STOP_BCNQ BIT(6) -*/ - - -//2 ACMHWCTRL 0x05C0 -#define AcmHw_HwEn_8723D BIT(0) -#define AcmHw_VoqEn_8723D BIT(1) -#define AcmHw_ViqEn_8723D BIT(2) -#define AcmHw_BeqEn_8723D BIT(3) -#define AcmHw_VoqStatus_8723D BIT(5) -#define AcmHw_ViqStatus_8723D BIT(6) -#define AcmHw_BeqStatus_8723D BIT(7) - - - -//----------------------------------------------------- -// -// 0x0600h ~ 0x07FFh WMAC Configuration -// -//----------------------------------------------------- -/* - -//2 TCR 0x0604 -#define DIS_GCLK BIT(1) -#define PAD_SEL BIT(2) -#define PWR_ST BIT(6) -#define PWRBIT_OW_EN BIT(7) -#define ACRC BIT(8) -#define CFENDFORM BIT(9) -#define ICV BIT(10) -*/ - -//---------------------------------------------------------------------------- -// 8195 (RCR) Receive Configuration Register (Offset 0x608, 32 bits) -//---------------------------------------------------------------------------- -/* -#define RCR_APPFCS BIT31 // WMAC append FCS after pauload -#define RCR_APP_MIC BIT30 // MACRX will retain the MIC at the bottom of the packet. -#define RCR_APP_ICV BIT29 // MACRX will retain the ICV at the bottom of the packet. -#define RCR_APP_PHYST_RXFF BIT28 // HY Status is appended before RX packet in RXFF -#define RCR_APP_BA_SSN BIT27 // SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. -#define RCR_RSVD_BIT26 BIT26 // Reserved -*/ -#define RCR_TCPOFLD_EN BIT25 // Enable TCP checksum offload -/*#define RCR_ENMBID BIT24 // Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. -#define RCR_LSIGEN BIT23 // Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. -#define RCR_MFBEN BIT22 // Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. -*/ - - -#endif // #ifndef __INC_HAL8723DREG_H +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/***************************************************************************** + * Copyright(c) 2009, RealTEK Technology Inc. All Right Reserved. + * + * Module: __INC_HAL8723DREG_H + * + * + * Note: 1. Define Mac register address and corresponding bit mask map + * + * + * Export: Constants, macro, functions(API), global variables(None). + * + * Abbrev: + * + * History: + * data Who Remark + * + *****************************************************************************/ +#ifndef __INC_HAL8723DREG_H +#define __INC_HAL8723DREG_H + + + +/* ************************************************************ + * + * ************************************************************ */ + +/* ----------------------------------------------------- + * + * 0x0000h ~ 0x00FFh System Configuration + * + * ----------------------------------------------------- */ +#define REG_SYS_ISO_CTRL_8723D 0x0000 /* 2 Byte */ +#define REG_SYS_FUNC_EN_8723D 0x0002 /* 2 Byte */ +#define REG_SYS_PW_CTRL_8723D 0x0004 /* 4 Byte */ +#define REG_SYS_CLKR_8723D 0x0008 /* 2 Byte */ +#define REG_SYS_EEPROM_CTRL_8723D 0x000A /* 2 Byte */ +#define REG_EE_VPD_8723D 0x000C /* 2 Byte */ +#define REG_SYS_SWR_CTRL1_8723D 0x0010 /* 1 Byte */ +#define REG_SYS_SWR_CTRL2_8723D 0x0014 /* 1 Byte */ +#define REG_SYS_SWR_CTRL3_8723D 0x0018 /* 4 Byte */ +#define REG_RSV_CTRL_8723D 0x001C /* 3 Byte */ +#define REG_RF_CTRL_8723D 0x001F /* 1 Byte */ +#define REG_AFE_CTRL1_8723D 0x0024 /* 4 Byte */ +#define REG_AFE_CTRL2_8723D 0x0028 /* 4 Byte */ +#define REG_AFE_CTRL3_8723D 0x002c /* 4 Byte */ +#define REG_EFUSE_CTRL_8723D 0x0030 +#define REG_LDO_EFUSE_CTRL_8723D 0x0034 +#define REG_PWR_DATA_8723D 0x0038 +#define REG_CAL_TIMER_8723D 0x003C +#define REG_ACLK_MON_8723D 0x003E +#define REG_GPIO_MUXCFG_8723D 0x0040 +#define REG_GPIO_IO_SEL_8723D 0x0042 +#define REG_MAC_PINMUX_CFG_8723D 0x0043 /* ?????? */ +#define REG_GPIO_PIN_CTRL_8723D 0x0044 +#define REG_GPIO_INTM_8723D 0x0048 +#define BIT_REG_LED_CFG_8723D 0x004C +#define REG_LEDCFG2_8723D 0x004E /* ?????? */ +#define REG_FSIMR_8723D 0x0050 +#define REG_FSISR_8723D 0x0054 +#define REG_HSIMR_8723D 0x0058 +#define REG_HSISR_8723D 0x005c +#define REG_GPIO_EXT_CTRL_8723D 0x0060 +#define REG_MULTI_FUNC_CTRL_8723D 0x0068 +#define REG_GPIO_STATUS_8723D 0x006C +#define REG_SDIO_CTRL_8723D 0x0070 +#define REG_HCI_OPT_CTRL_8723D 0x0074 +#define REG_AFE_CTRL4_8723D 0x0078 +#define REG_LDO_SWR_CTRL_8723D 0x007C +#define REG_8051FW_CTRL_8723D 0x0080 +#define REG_FW_DBG_STATUS_8723D 0x0088 +#define REG_FW_DBG_CTRL_8723D 0x008F +#define REG_WLLPS_CTRL_8723D 0x0090 +#define REG_HIMR0_8723D 0x00B0 +#define REG_HISR0_8723D 0x00B4 +#define REG_HIMR1_8723D 0x00B8 +#define REG_HISR1_8723D 0x00BC +#define REG_PMC_DBG_CTRL2_8723D 0x00CC +#define REG_EFUSE_BURN_GNT_8723D 0x00CF +#define REG_XTAL_AAC_8723D 0x00EC +#define REG_SYS_CFG1_8723D 0x00F0 +#define REG_SYS_CFG2_8723D 0x00FC +#define REG_ROM_VERSION 0x00FD + +/* ----------------------------------------------------- + * + * 0x0100h ~ 0x01FFh MACTOP General Configuration + * + * ----------------------------------------------------- */ +#define REG_CR_8723D 0x0100 +#define REG_PBP_8723D 0x0104 /* ?????? */ +#define REG_PKT_BUFF_ACCESS_CTRL_8723D 0x0106 /* ?????? */ +#define REG_TRXDMA_CTRL_8723D 0x010C +#define REG_TRXFF_BNDY_8723D 0x0114 +#define REG_RXFF_PTR_8723D 0x011C +#define REG_CPWM_8723D 0x012C +#define REG_FWIMR_8723D 0x0130 +#define REG_FWISR_8723D 0x0134 +#define REG_FTIMR_8723D 0x0138 +#define REG_PKTBUF_DBG_CTRL_8723D 0x0140 +#define REG_RXPKTBUF_CTRL_8723D 0x0142 /* ?????? */ +#define REG_PKTBUF_DBG_DATA_L_8723D 0x0144 +#define REG_PKTBUF_DBG_DATA_H_8723D 0x0148 + +#define REG_TC0_CTRL_8723D 0x0150 +#define REG_TC1_CTRL_8723D 0x0154 +#define REG_TC2_CTRL_8723D 0x0158 +#define REG_TC3_CTRL_8723D 0x015C +#define REG_TC4_CTRL_8723D 0x0160 +#define REG_TCUNIT_BASE_8723D 0x0164 +#define REG_RSVD3_8723D 0x0168 /* ????? */ + +#define REG_C2HEVT_MSG_NORMAL_8723D 0x01A0 /* ?????? */ +#define REG_C2HEVT_CMD_SEQ_88XX 0x01A1 /* ?????? */ +#define reg_c2h_evt_cmd_content_88xx 0x01A2 /* ?????? */ +#define REG_C2HEVT_CMD_LEN_88XX 0x01AE /* ?????? */ +#define REG_C2HEVT_CLEAR_8723D 0x01AF /* ?????? */ +#define REG_MCUTST_1_8723D 0x01C0 +#define REG_MCUTST_2_8723D 0x01C4 +#define REG_MCUTST_WOWLAN_8723D 0x01C7 /* ?????? */ +#define REG_FMETHR_8723D 0x01C8 +#define REG_HMETFR_8723D 0x01CC +#define REG_HMEBOX_0_8723D 0x01D0 +#define REG_HMEBOX_1_8723D 0x01D4 +#define REG_HMEBOX_2_8723D 0x01D8 +#define REG_HMEBOX_3_8723D 0x01DC +#define REG_LLT_INIT_8723D 0x01E0 +#define REG_HMEBOX_EXT0_8723D 0x01F0 /* ?????? */ +#define REG_HMEBOX_EXT1_8723D 0x01F4 /* ?????? */ +#define REG_HMEBOX_EXT2_8723D 0x01F8 /* ?????? */ +#define REG_HMEBOX_EXT3_8723D 0x01FC /* ?????? */ + +/* ----------------------------------------------------- + * + * 0x0200h ~ 0x027Fh TXDMA Configuration + * + * ----------------------------------------------------- */ +#define REG_RQPN_8723D 0x0200 +#define REG_FIFOPAGE_8723D 0x0204 +#define REG_TDECTRL_8723D 0x0208 +#define REG_TXDMA_OFFSET_CHK_8723D 0x020C +#define REG_TXDMA_STATUS_8723D 0x0210 +#define REG_RQPN_NPQ_8723D 0x0214 +#define REG_AUTO_LLT_8723D 0x0224 +#define REG_DWBCN1_CTRL_8723D 0x0228 + + +/* ----------------------------------------------------- + * + * 0x0280h ~ 0x02FFh RXDMA Configuration + * + * ----------------------------------------------------- */ +#define REG_RXDMA_AGG_PG_TH_8723D 0x0280 +#define REG_RXPKT_NUM_8723D 0x0284 /* The number of packets in RXPKTBUF. */ +#define REG_RXDMA_CONTROL_8723D 0x0286 /* ?????? Control the RX DMA. */ +#define REG_RXDMA_STATUS_8723D 0x0288 +#define REG_RXDMA_PRO_8723D 0x0290 /* ?????? */ +#define REG_EARLY_MODE_CONTROL_8723D 0x02BC /* ?????? */ +#define REG_RSVD5_8723D 0x02F0 /* ?????? */ + + +/* ----------------------------------------------------- + * + * 0x0300h ~ 0x03FFh PCIe + * + * ----------------------------------------------------- */ +#define REG_PCIE_CTRL_REG_8723D 0x0300 +#define REG_INT_MIG_8723D 0x0304 /* Interrupt Migration */ +#define REG_BCNQ_TXBD_DESA_8723D 0x0308 /* TX Beacon Descriptor Address */ +#define REG_MGQ_TXBD_DESA_8723D 0x0310 /* TX Manage Queue Descriptor Address */ +#define REG_VOQ_TXBD_DESA_8723D 0x0318 /* TX VO Queue Descriptor Address */ +#define REG_VIQ_TXBD_DESA_8723D 0x0320 /* TX VI Queue Descriptor Address */ +#define REG_BEQ_TXBD_DESA_8723D 0x0328 /* TX BE Queue Descriptor Address */ +#define REG_BKQ_TXBD_DESA_8723D 0x0330 /* TX BK Queue Descriptor Address */ +#define REG_RXQ_RXBD_DESA_8723D 0x0338 /* RX Queue Descriptor Address */ +#define REG_HI0Q_TXBD_DESA_8723D 0x0340 +#define REG_HI1Q_TXBD_DESA_8723D 0x0348 +#define REG_HI2Q_TXBD_DESA_8723D 0x0350 +#define REG_HI3Q_TXBD_DESA_8723D 0x0358 +#define REG_HI4Q_TXBD_DESA_8723D 0x0360 +#define REG_HI5Q_TXBD_DESA_8723D 0x0368 +#define REG_HI6Q_TXBD_DESA_8723D 0x0370 +#define REG_HI7Q_TXBD_DESA_8723D 0x0378 +#define REG_MGQ_TXBD_NUM_8723D 0x0380 +#define REG_RX_RXBD_NUM_8723D 0x0382 +#define REG_VOQ_TXBD_NUM_8723D 0x0384 +#define REG_VIQ_TXBD_NUM_8723D 0x0386 +#define REG_BEQ_TXBD_NUM_8723D 0x0388 +#define REG_BKQ_TXBD_NUM_8723D 0x038A +#define REG_HI0Q_TXBD_NUM_8723D 0x038C +#define REG_HI1Q_TXBD_NUM_8723D 0x038E +#define REG_HI2Q_TXBD_NUM_8723D 0x0390 +#define REG_HI3Q_TXBD_NUM_8723D 0x0392 +#define REG_HI4Q_TXBD_NUM_8723D 0x0394 +#define REG_HI5Q_TXBD_NUM_8723D 0x0396 +#define REG_HI6Q_TXBD_NUM_8723D 0x0398 +#define REG_HI7Q_TXBD_NUM_8723D 0x039A +#define REG_TSFTIMER_HCI_8723D 0x039C + +/* Read Write Point */ +#define REG_VOQ_TXBD_IDX_8723D 0x03A0 +#define REG_VIQ_TXBD_IDX_8723D 0x03A4 +#define REG_BEQ_TXBD_IDX_8723D 0x03A8 +#define REG_BKQ_TXBD_IDX_8723D 0x03AC +#define REG_MGQ_TXBD_IDX_8723D 0x03B0 +#define REG_RXQ_TXBD_IDX_8723D 0x03B4 +#define REG_HI0Q_TXBD_IDX_8723D 0x03B8 +#define REG_HI1Q_TXBD_IDX_8723D 0x03BC +#define REG_HI2Q_TXBD_IDX_8723D 0x03C0 +#define REG_HI3Q_TXBD_IDX_8723D 0x03C4 +#define REG_HI4Q_TXBD_IDX_8723D 0x03C8 +#define REG_HI5Q_TXBD_IDX_8723D 0x03CC +#define REG_HI6Q_TXBD_IDX_8723D 0x03D0 +#define REG_HI7Q_TXBD_IDX_8723D 0x03D4 + +#define REG_PCIE_HCPWM_8723DE 0x03D8 /* ?????? */ +#define REG_PCIE_HRPWM_8723DE 0x03DC /* PCIe RPWM */ /* ?????? */ +#define REG_DBI_WDATA_V1_8723D 0x03E8 +#define REG_DBI_RDATA_V1_8723D 0x03EC +#define REG_DBI_FLAG_V1_8723D 0x03F0 +#define REG_MDIO_V1_8723D 0x03F4 +#define REG_PCIE_MIX_CFG_8723D 0x03F8 +#define REG_HCI_MIX_CFG_8723D 0x03FC + +/* ----------------------------------------------------- + * + * 0x0400h ~ 0x047Fh Protocol Configuration + * + * ----------------------------------------------------- */ +#define REG_TXPKT_EMPTY_8723D 0x041A +#define REG_PTCL_POLL_MGN_8723D 0x041F +#define REG_FWHW_TXQ_CTRL_8723D 0x0420 +#define REG_HWSEQ_CTRL_8723D 0x0423 +#define REG_BCNQ_BDNY_8723D 0x0424 +#define REG_MGQ_BDNY_8723D 0x0425 +#define REG_LIFETIME_EN_8723D 0x0426 +#define REG_FW_FREE_TAIL_8723D 0x0427 +#define REG_SPEC_SIFS_8723D 0x0428 +#define REG_RETRY_LIMIT_8723D 0x042A +#define REG_TXBF_CTRL_8723D 0x042C +#define REG_DARFRC_8723D 0x0430 +#define REG_RARFRC_8723D 0x0438 +#define REG_RRSR_8723D 0x0440 +#define REG_ARFR0_8723D 0x0444 +#define REG_ARFR1_8723D 0x044C +#define REG_CCK_CHECK_8723D 0x0454 +#define REG_BCNQ2_BDNY_8723D 0x0455 +#define REG_AMPDU_MAX_TIME_8723D 0x0456 +#define REG_BCNQ1_BDNY_8723D 0x0457 +#define REG_AMPDU_MAX_LENGTH_8723D 0x0458 +#define REG_WMAC_LBK_BUF_HD_8723D 0x045D +#define REG_NDPA_OPT_CTRL_8723D 0x045F +#define REG_FAST_EDCA_CTRL_8723D 0x0460 +#define REG_RD_RESP_PKT_TH_8723D 0x0463 +#define REG_DATA_SC_8723D 0x0483 +#define REG_TXRPT_START_OFFSET 0x04AC +#define REG_POWER_STAGE1_8723D 0x04B4 +#define REG_PTCL_SDF_STATUS_8723D 0x04BB +#define REG_SW_AMPDU_BURST_MODE_CTRL_8723D 0x04BC +#define REG_EVTQ_BNDY_8723D 0x04BF +#define REG_PKT_LIFE_TIME_8723D 0x04C0 +#define REG_PKT_BE_BK_LIFE_TIME_8723D 0x04C2 /* ?????? */ + +#define REG_STBC_SETTING_8723D 0x04C4 +#define REG_HT_SINGLE_AMPDU_8723D 0x04C7 +#define REG_PROT_MODE_CTRL_8723D 0x04C8 +#define REG_MAX_AGGR_NUM_8723D 0x04CA +#define REG_RTS_MAX_AGGR_NUM_8723D 0x04CB +#define REG_BAR_MODE_CTRL_8723D 0x04CC +#define REG_RA_TRY_RATE_AGG_LMT_8723D 0x04CF +#define REG_MACID_SLEEP2_8723D 0x04D0 +#define REG_PTCL_HWSSN0_8723D 0x04D8 +#define REG_TXPKTBUF_WMAC_LBK_BF_HD_8723D 0x045D /* ?????? */ + + +/************* 0x1480~0x14A7 is for NAN ***************/ +/* Own Master Rank, 8Bytes */ +#define REG_NAN_INTERFACE_ADDR_8723D 0x2480 /* 6 bytes */ +#define REG_NAN_RANDOM_FACTOR_8723D 0x2486 /* 1 byte */ +#define REG_NAN_MASTER_PREF_8723D 0x2487 /* 1 byte */ + +/* 0x5dc[25:24] NAN role */ + +/* Current Anchor Master Record */ +#define REG_NAN_CAMR_L_8723D 0x2488 /* 4 bytes */ +#define REG_NAN_CAMR_H_8723D 0x248C /* 4 byte + * #define REG_HOP_CNT_8723D 0x05DC */ +#define REG_NAN_CAMR_AMBTT_8723D 0x2490 /* 4 bytes */ + +/* Last Anchor Master Record */ +#define REG_NAN_LAMR_L_8723D 0x2494 /* 4 bytes */ +#define REG_NAN_LAMR_H_8723D 0x2498 /* 4 byte */ +#define REG_NAN_LAMR_AMBTT_8723D 0x249C /* 4 bytes */ + +/* TSF Synced:bit 0 + * Anchor Master: bit 7 */ +#define REG_NAN_STATUS_8723D 0x24A0 /* BIT0 + ***************************************************/ + + +/* ----------------------------------------------------- + * + * 0x0500h ~ 0x05FFh EDCA Configuration + * + * ----------------------------------------------------- + * gogogo */ +#define REG_EDCA_VO_PARAM_8723D 0x0500 +#define REG_EDCA_VI_PARAM_8723D 0x0504 +#define REG_EDCA_BE_PARAM_8723D 0x0508 +#define REG_EDCA_BK_PARAM_8723D 0x050C +#define REG_BCNTCFG_8723D 0x0510 +#define REG_PIFS_8723D 0x0512 +#define REG_RDG_PIFS_8723D 0x0513 +#define REG_SIFS_CTX_8723D 0x0514 +#define REG_SIFS_TRX_8723D 0x0516 +#define REG_AGGR_BREAK_TIME_8723D 0x051A +#define REG_SLOT_8723D 0x051B +#define REG_TX_PTCL_CTRL_8723D 0x0520 +#define REG_TXPAUSE_8723D 0x0522 +#define REG_DIS_TXREQ_CLR_8723D 0x0523 +#define REG_RD_CTRL_8723D 0x0524 +/* + * Format for offset 540h-542h: + * [3:0]: TBTT prohibit setup in unit of 32us. The time for HW getting beacon content before TBTT. + * [7:4]: Reserved. + * [19:8]: TBTT prohibit hold in unit of 32us. The time for HW holding to send the beacon packet. + * [23:20]: Reserved + * Description: + * | + * |<--Setup--|--Hold------------>| + * --------------|---------------------- + * | + * TBTT + * Note: We cannot update beacon content to HW or send any AC packets during the time between Setup and Hold. + * Described by Designer Tim and Bruce, 2011-01-14. + * */ +#define REG_TBTT_PROHIBIT_8723D 0x0540 +#define REG_RD_NAV_NXT_8723D 0x0544 +#define REG_NAV_PROT_LEN_8723D 0x0546 +#define REG_BCN_CTRL_8723D 0x0550 +#define REG_EDCA_BCNCTRL1_IOREG_8723D 0x0551 +#define REG_MBID_NUM_8723D 0x0552 +#define REG_DUAL_TSF_RST_8723D 0x0553 +#define REG_BCN_INTERVAL_8723D 0x0554 +#define REG_DRVERLYINT_8723D 0x0558 +#define REG_BCNDMATIM_8723D 0x0559 +#define REG_ATIMWND_8723D 0x055A +#define REG_USTIME_TSF_8723D 0x055C +#define REG_BCN_MAX_ERR_8723D 0x055D +#define REG_RXTSF_OFFSET_CCK_8723D 0x055E +#define REG_RXTSF_OFFSET_OFDM_8723D 0x055F +#define REG_TSFTR_8723D 0x0560 +#define REG_CTWND_8723D 0x0572 +#define REG_SECONDARY_CCA_CTRL_8723D 0x0577 /* ?????? */ +#define REG_TSFTR2_8723D 0x0578 +#define REG_PSTIMER_8723D 0x0580 +#define REG_TIMER0_8723D 0x0584 +#define REG_TIMER1_8723D 0x0588 +#define REG_SCH_MULTI_BCN_8723D 0x05B2 +#define REG_SCH_CURRENT_BCN_8723D 0x05B3 +#define REG_ACMHWCTRL_8723D 0x05C0 +#define REG_SCH_SDFX_EARLY_8723D 0x05CF +#define REG_SCH_PORT2_EARLY_8723D 0x05D0 +#define REG_SCH_TSFT_DIFF_8723D 0x05D2 +#define REG_EDCA_BCNCTRL2_IOREG_8723D 0x05D4 +#define REG_EDCA_DRVERLYINT1_IOREG_8723D 0x05D4 +#define REG_EDCA_BCNSPACE3_IOREG_8723D 0x05D8 +#define REG_EDCA_BCNSPACE4_IOREG_8723D 0x05DA +#define REG_HOP_CNT_8723D 0x05DC +#define REG_SCH_M_DW_8723D 0x05DD +#define REG_SCH_M_SLOT_8723D 0x05DE +#define REG_SCH_EARLY_DWEND_8723D 0x05DF +#define REG_SCH_TXCMD_8723D 0x05F8 + +/* ----------------------------------------------------- + * + * 0x0600h ~ 0x07FFh WMAC Configuration + * + * ----------------------------------------------------- + * gogogo */ +#define REG_MAC_CR_8723D 0x0600 +#define REG_TCR_8723D 0x0604 +#define REG_RCR_8723D 0x0608 +#define REG_RX_PKT_LIMIT_8723D 0x060C +#define REG_RX_DLK_TIME_8723D 0x060D +#define REG_RX_DRVINFO_SZ_8723D 0x060F + +#define REG_MACID_8723D 0x0610 +#define REG_BSSID_8723D 0x0618 +#define REG_MAR_8723D 0x0620 +#define REG_MBIDCAMCFG_8723D 0x0628 + +#define REG_USTIME_EDCA_8723D 0x0638 +#define REG_MAC_SPEC_SIFS_8723D 0x063A +#define REG_RESP_SIFP_CCK_8723D 0x063C +#define REG_RESP_SIFS_OFDM_8723D 0x063E +#define REG_ACKTO_8723D 0x0640 +#define REG_CTS2TO_8723D 0x0641 +#define REG_EIFS_8723D 0x0642 + +#define REG_NAV_UPPER_8723D 0x0652 /* ?????? */ +#define REG_TRXPTCL_CTL_8723D 0x0668 + +/* security */ +#define REG_CAMCMD_8723D 0x0670 +#define REG_CAMWRITE_8723D 0x0674 +#define REG_CAMREAD_8723D 0x0678 +#define REG_CAMDBG_8723D 0x067C +#define REG_SECCFG_8723D 0x0680 + +/* Power */ +#define REG_WOW_CTRL_8723D 0x0690 +#define REG_PS_RX_INFO_8723D 0x0692 +#define REG_UAPSD_TID_8723D 0x0693 +#define REG_WKFMCAM_NUM_8723D 0x0698 +#define REG_RXFLTMAP0_8723D 0x06A0 +#define REG_RXFLTMAP1_8723D 0x06A2 +#define REG_RXFLTMAP2_8723D 0x06A4 +#define REG_BCN_PSR_RPT_8723D 0x06A8 +#define REG_BT_COEX_TABLE_8723D 0x06C0 +#define REG_ASSOCIATED_BFMER0_INFO_8723D 0x06E4 +#define REG_ASSOCIATED_BFMER1_INFO_8723D 0x06EC +#define REG_CSI_RPT_PARAM_BW20_8723D 0x06F4 +#define REG_CSI_RPT_PARAM_BW40_8723D 0x06F8 +#define REG_CSI_RPT_PARAM_BW80_8723D 0x06FC + +/* Hardware Port 2 */ +#define REG_MACID1_8723D 0x0700 +#define REG_BSSID1_8723D 0x0708 +#define REG_ASSOCIATED_BFMEE_SEL_8723D 0x0714 +#define REG_SND_PTCL_CTRL_8723D 0x0718 + +/* ----------------------------------------------------- + * + * Redifine 8192C register definition for compatibility + * + * ----------------------------------------------------- */ + +/* TODO: use these definition when using REG_xxx naming rule. + * NOTE: DO NOT Remove these definition. Use later. */ +#define EFUSE_CTRL_8723D REG_EFUSE_CTRL_8723D /* E-Fuse Control. */ +#define EFUSE_TEST_8723D REG_LDO_EFUSE_CTRL_8723D /* E-Fuse Test. */ +#define MSR_8723D (REG_CR_8723D + 2) /* Media status register */ +#define ISR_8723D REG_HISR0_8723D +#define TSFR_8723D REG_TSFTR_8723D /* Timing Sync Function Timer Register. */ + +/* Redifine MACID register, to compatible prior ICs. */ +#define IDR0_8723D REG_MACID_8723D /* MAC ID Register, Offset 0x0050-0x0053 */ +#define IDR4_8723D (REG_MACID_8723D + 4) /* MAC ID Register, Offset 0x0054-0x0055 */ + + +/* + * 9. security Control Registers (Offset: ) + * */ +#define RWCAM_8723D REG_CAMCMD_8723D /* 8190 data Sheet is called CAMcmd */ +#define WCAMI_8723D REG_CAMWRITE_8723D /* Software write CAM input content */ +#define RCAMO_8723D REG_CAMREAD_8723D /* Software read/write CAM config */ +#define CAMDBG_8723D REG_CAMDBG_8723D +#define SECR_8723D REG_SECCFG_8723D /* security Configuration Register */ + + +/* ---------------------------------------------------------------------------- + * 8195 IMR/ISR bits (offset 0xB0, 8bits) + * ---------------------------------------------------------------------------- */ +#define IMR_DISABLED_8723D 0 +/* IMR DW0(0x00B0-00B3) Bit 0-31 */ +#define IMR_TIMER2_8723D BIT(31) /* Timeout interrupt 2 */ +#define IMR_TIMER1_8723D BIT(30) /* Timeout interrupt 1 */ +#define IMR_PSTIMEOUT_8723D BIT(29) /* Power Save Time Out Interrupt */ +#define IMR_GTINT4_8723D BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ +#define IMR_GTINT3_8723D BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ +#define IMR_TXBCN0ERR_8723D BIT(26) /* Transmit Beacon0 Error */ +#define IMR_TXBCN0OK_8723D BIT(25) /* Transmit Beacon0 OK */ +#define IMR_TSF_BIT32_TOGGLE_8723D BIT(24) /* TSF Timer BIT32 toggle indication interrupt */ +#define IMR_BCNDMAINT0_8723D BIT(20) /* Beacon DMA Interrupt 0 */ +#define IMR_BCNDERR0_8723D BIT(16) /* Beacon Queue DMA OK0 */ +#define IMR_HSISR_IND_ON_INT_8723D BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ +#define IMR_BCNDMAINT_E_8723D BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ +#define IMR_ATIMEND_8723D BIT(12) /* CTWidnow End or ATIM Window End */ +#define IMR_C2HCMD_8723D BIT(10) /* CPU to Host Command INT status, Write 1 clear */ +#define IMR_CPWM2_8723D BIT(9) /* CPU power mode exchange INT status, Write 1 clear */ +#define IMR_CPWM_8723D BIT(8) /* CPU power mode exchange INT status, Write 1 clear */ +#define IMR_HIGHDOK_8723D BIT(7) /* High Queue DMA OK */ +#define IMR_MGNTDOK_8723D BIT(6) /* Management Queue DMA OK */ +#define IMR_BKDOK_8723D BIT(5) /* AC_BK DMA OK */ +#define IMR_BEDOK_8723D BIT(4) /* AC_BE DMA OK */ +#define IMR_VIDOK_8723D BIT(3) /* AC_VI DMA OK */ +#define IMR_VODOK_8723D BIT(2) /* AC_VO DMA OK */ +#define IMR_RDU_8723D BIT(1) /* Rx Descriptor Unavailable */ +#define IMR_ROK_8723D BIT(0) /* Receive DMA OK */ + +/* IMR DW1(0x00B4-00B7) Bit 0-31 */ +#define IMR_BCNDMAINT7_8723D BIT(27) /* Beacon DMA Interrupt 7 */ +#define IMR_BCNDMAINT6_8723D BIT(26) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5_8723D BIT(25) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4_8723D BIT(24) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3_8723D BIT(23) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2_8723D BIT(22) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1_8723D BIT(21) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK7_8723D BIT(20) /* Beacon Queue DMA OK Interrup 7 */ +#define IMR_BCNDOK6_8723D BIT(19) /* Beacon Queue DMA OK Interrup 6 */ +#define IMR_BCNDOK5_8723D BIT(18) /* Beacon Queue DMA OK Interrup 5 */ +#define IMR_BCNDOK4_8723D BIT(17) /* Beacon Queue DMA OK Interrup 4 */ +#define IMR_BCNDOK3_8723D BIT(16) /* Beacon Queue DMA OK Interrup 3 */ +#define IMR_BCNDOK2_8723D BIT(15) /* Beacon Queue DMA OK Interrup 2 */ +#define IMR_BCNDOK1_8723D BIT(14) /* Beacon Queue DMA OK Interrup 1 */ +#define IMR_ATIMEND_E_8723D BIT(13) /* ATIM Window End Extension for Win7 */ +#define IMR_TXERR_8723D BIT(11) /* Tx Error Flag Interrupt status, write 1 clear. */ +#define IMR_RXERR_8723D BIT(10) /* Rx Error Flag INT status, Write 1 clear */ +#define IMR_TXFOVW_8723D BIT(9) /* Transmit FIFO Overflow */ +#define IMR_RXFOVW_8723D BIT(8) /* Receive FIFO Overflow */ + + + +#define IMR_MCUERR_8723D BIT(28) /* Beacon DMA Interrupt 7 */ + + +/*=================================================================== +===================================================================== +Here the register defines are for 92C. When the define is as same with 92C, +we will use the 92C's define for the consistency +So the following defines for 92C is not entire!!!!!! +===================================================================== +=====================================================================*/ +/* +Based on Datasheet V33---090401 +Register Summary +Current IOREG MAP +0x0000h ~ 0x00FFh System Configuration (256 Bytes) +0x0100h ~ 0x01FFh MACTOP General Configuration (256 Bytes) +0x0200h ~ 0x027Fh TXDMA Configuration (128 Bytes) +0x0280h ~ 0x02FFh RXDMA Configuration (128 Bytes) +0x0300h ~ 0x03FFh PCIE EMAC Reserved Region (256 Bytes) +0x0400h ~ 0x04FFh Protocol Configuration (256 Bytes) +0x0500h ~ 0x05FFh EDCA Configuration (256 Bytes) +0x0600h ~ 0x07FFh WMAC Configuration (512 Bytes) +0x2000h ~ 0x3FFFh 8051 FW Download Region (8196 Bytes) +*/ +/* ---------------------------------------------------------------------------- + * 8195 (TXPAUSE) transmission pause (Offset 0x522, 8 bits) + * ---------------------------------------------------------------------------- + * +#define StopBecon BIT(6) +#define StopHigh BIT(5) +#define StopMgt BIT(4) +#define StopVO BIT(3) +#define StopVI BIT(2) +#define StopBE BIT(1) +#define StopBK BIT(0) +*/ + + + +/* **************************************************************************** + * 8192C Regsiter Bit and Content definition + * **************************************************************************** + * ----------------------------------------------------- + * + * 0x0000h ~ 0x00FFh System Configuration + * + * ----------------------------------------------------- */ +#if 0 + /* 2 SYS_ISO_CTRL */ + #define ISO_MD2PP BIT(0) + #define ISO_UA2USB BIT(1) + #define ISO_UD2CORE BIT(2) + #define ISO_PA2PCIE BIT(3) + #define ISO_PD2CORE BIT(4) + #define ISO_IP2MAC BIT(5) + #define ISO_DIOP BIT(6) + #define ISO_DIOE BIT(7) + #define ISO_EB2CORE BIT(8) + #define ISO_DIOR BIT(9) + #define PWC_EV12V BIT(15) + + + /* 2 SYS_FUNC_EN */ + #define FEN_BBRSTB BIT(0) + #define FEN_BB_GLB_RSTn BIT(1) + #define FEN_USBA BIT(2) + #define FEN_UPLL BIT(3) + #define FEN_USBD BIT(4) + #define FEN_DIO_PCIE BIT(5) + #define FEN_PCIEA BIT(6) + #define FEN_PPLL BIT(7) + #define FEN_PCIED BIT(8) + #define FEN_DIOE BIT(9) + #define FEN_CPUEN BIT(10) + #define FEN_DCORE BIT(11) + #define FEN_ELDR BIT(12) + #define FEN_DIO_RF BIT(13) + #define FEN_HWPDN BIT(14) + #define FEN_MREGEN BIT(15) + + /* 2 APS_FSMCO */ + #define PFM_LDALL BIT(0) + #define PFM_ALDN BIT(1) + #define PFM_LDKP BIT(2) + #define PFM_WOWL BIT(3) + #define EnPDN BIT(4) + #define PDN_PL BIT(5) + #define APFM_ONMAC BIT(8) + #define APFM_OFF BIT(9) + #define APFM_RSM BIT(10) + #define AFSM_HSUS BIT(11) + #define AFSM_PCIE BIT(12) + #define APDM_MAC BIT(13) + #define APDM_HOST BIT(14) + #define APDM_HPDN BIT(15) + #define RDY_MACON BIT(16) + #define SUS_HOST BIT(17) + #define ROP_ALD BIT(20) + #define ROP_PWR BIT(21) + #define ROP_SPS BIT(22) + #define SOP_MRST BIT(25) + #define SOP_FUSE BIT(26) + #define SOP_ABG BIT(27) + #define SOP_AMB BIT(28) + #define SOP_RCK BIT(29) + #define SOP_A8M BIT(30) + #define XOP_BTCK BIT(31) + + /* 2 SYS_CLKR */ + #define ANAD16V_EN BIT(0) + #define ANA8M BIT(1) + #define MACSLP BIT(4) + #define LOADER_CLK_EN BIT(5) + + + /* 2 9346CR */ + + #define BOOT_FROM_EEPROM BIT(4) + #define EEPROM_EN BIT(5) + + + /* 2 RF_CTRL */ + #define RF_EN BIT(0) + #define RF_RSTB BIT(1) + #define RF_SDMRSTB BIT(2) + + /* 2 LDOV12D_CTRL */ + #define LDV12_EN BIT(0) + #define LDV12_SDBY BIT(1) + #define LPLDO_HSM BIT(2) + #define LPLDO_LSM_DIS BIT(3) + #define _LDV12_VADJ(x) (((x) & 0xF) << 4) + + + /* 2 EFUSE_TEST (For RTL8723 partially) */ + #define EF_TRPT BIT(7) + #define EF_CELL_SEL (BIT(8) | BIT(9)) /* 00: Wifi Efuse, 01: BT Efuse0, 10: BT Efuse1, 11: BT Efuse2 */ + #define LDOE25_EN BIT(31) + #define EFUSE_SEL(x) (((x) & 0x3) << 8) + #define EFUSE_SEL_MASK 0x300 + #define EFUSE_WIFI_SEL_0 0x0 + #define EFUSE_BT_SEL_0 0x1 + #define EFUSE_BT_SEL_1 0x2 + #define EFUSE_BT_SEL_2 0x3 + + + /* 2 8051FWDL */ + /* 2 MCUFWDL */ + #define MCUFWDL_EN BIT(0) + #define MCUFWDL_RDY BIT(1) + #define FWDL_ChkSum_rpt BIT(2) + #define MACINI_RDY BIT(3) + #define BBINI_RDY BIT(4) + #define RFINI_RDY BIT(5) + #define WINTINI_RDY BIT(6) + #define RAM_DL_SEL BIT(7) + #define ROM_DLEN BIT(19) + #define CPRST BIT(23) + + + + /* 2 REG_SYS_CFG */ + #define XCLK_VLD BIT(0) + #define ACLK_VLD BIT(1) + #define UCLK_VLD BIT(2) + #define PCLK_VLD BIT(3) + #define PCIRSTB BIT(4) + #define V15_VLD BIT(5) + #define TRP_B15V_EN BIT(7) + #define SIC_IDLE BIT(8) + #define BD_MAC2 BIT(9) + #define BD_MAC1 BIT(10) + #define IC_MACPHY_MODE BIT(11) + #define CHIP_VER (BIT(12) | BIT(13) | BIT(14) | BIT(15)) + #define BT_FUNC BIT(16) + #define VENDOR_ID BIT(19) + #define PAD_HWPD_IDN BIT(22) + #define TRP_VAUX_EN BIT(23) /* RTL ID */ + #define TRP_BT_EN BIT(24) + #define BD_PKG_SEL BIT(25) + #define BD_HCI_SEL BIT(26) + #define TYPE_ID BIT(27) + + #define CHIP_VER_RTL_MASK 0xF000 /* Bit 12 ~ 15 */ + #define CHIP_VER_RTL_SHIFT 12 + +#endif +/* ----------------------------------------------------- + * + * 0x0100h ~ 0x01FFh MACTOP General Configuration + * + * ----------------------------------------------------- */ +#if 0 + + /* 2 Function Enable Registers */ + /* 2 CR 0x0100-0x0103 */ + + + #define HCI_TXDMA_EN BIT(0) + #define HCI_RXDMA_EN BIT(1) + #define TXDMA_EN BIT(2) + #define RXDMA_EN BIT(3) + #define PROTOCOL_EN BIT(4) + #define SCHEDULE_EN BIT(5) + #define MACTXEN BIT(6) + #define MACRXEN BIT(7) + #define ENSWBCN BIT(8) + #define ENSEC BIT(9) + #define CALTMR_EN BIT(10) /* 32k CAL TMR enable */ + + /* Network type */ + #define _NETTYPE(x) (((x) & 0x3) << 16) + #define MASK_NETTYPE 0x30000 + #define NT_NO_LINK 0x0 + #define NT_LINK_AD_HOC 0x1 + #define NT_LINK_AP 0x2 + #define NT_AS_AP 0x3 + + + /* 2 PBP - Page Size Register 0x0104 */ + #define GET_RX_PAGE_SIZE(value) ((value) & 0xF) + #define GET_TX_PAGE_SIZE(value) (((value) & 0xF0) >> 4) + #define _PSRX_MASK 0xF + #define _PSTX_MASK 0xF0 + #define _PSRX(x) (x) + #define _PSTX(x) ((x) << 4) + + #define PBP_64 0x0 + #define PBP_128 0x1 + #define PBP_256 0x2 + #define PBP_512 0x3 + #define PBP_1024 0x4 + + + /* 2 TX/RXDMA 0x010C */ + #define RXDMA_ARBBW_EN BIT(0) + #define RXSHFT_EN BIT(1) + #define RXDMA_AGG_EN BIT(2) + #define QS_VO_QUEUE BIT(8) + #define QS_VI_QUEUE BIT(9) + #define QS_BE_QUEUE BIT(10) + #define QS_BK_QUEUE BIT(11) + #define QS_MANAGER_QUEUE BIT(12) + #define QS_HIGH_QUEUE BIT(13) + + #define HQSEL_VOQ BIT(0) + #define HQSEL_VIQ BIT(1) + #define HQSEL_BEQ BIT(2) + #define HQSEL_BKQ BIT(3) + #define HQSEL_MGTQ BIT(4) + #define HQSEL_HIQ BIT(5) + + /* For normal driver, 0x10C */ + #define _TXDMA_HIQ_MAP(x) (((x) & 0x3) << 14) + #define _TXDMA_MGQ_MAP(x) (((x) & 0x3) << 12) + #define _TXDMA_BKQ_MAP(x) (((x) & 0x3) << 10) + #define _TXDMA_BEQ_MAP(x) (((x) & 0x3) << 8) + #define _TXDMA_VIQ_MAP(x) (((x) & 0x3) << 6) + #define _TXDMA_VOQ_MAP(x) (((x) & 0x3) << 4) + + #define QUEUE_LOW 1 + #define QUEUE_NORMAL 2 + #define QUEUE_HIGH 3 + + + /* 2 REG_C2HEVT_CLEAR 0x01AF */ + #define C2H_EVT_HOST_CLOSE 0x00 /* Set by driver and notify FW that the driver has read the C2H command message */ + #define C2H_EVT_FW_CLOSE 0xFF /* Set by FW indicating that FW had set the C2H command message and it's not yet read by driver. */ + + + + /* 2 LLT_INIT 0x01E0 */ + #define _LLT_NO_ACTIVE 0x0 + #define _LLT_WRITE_ACCESS 0x1 + #define _LLT_READ_ACCESS 0x2 + + #define _LLT_INIT_DATA(x) ((x) & 0xFF) + #define _LLT_INIT_ADDR(x) (((x) & 0xFF) << 8) + #define _LLT_OP(x) (((x) & 0x3) << 30) + #define _LLT_OP_VALUE(x) (((x) >> 30) & 0x3) + +#endif +/* ----------------------------------------------------- + * + * 0x0200h ~ 0x027Fh TXDMA Configuration + * + * ----------------------------------------------------- */ +#if 0 + /* 2 TDECTL 0x0208 */ + #define BLK_DESC_NUM_SHIFT 4 + #define BLK_DESC_NUM_MASK 0xF + + + /* 2 TXDMA_OFFSET_CHK 0x020C */ + #define DROP_DATA_EN BIT(9) +#endif +/* ----------------------------------------------------- + * + * 0x0280h ~ 0x028Bh RX DMA Configuration + * + * ----------------------------------------------------- */ +#if 0 + /* 2 REG_RXDMA_CONTROL, 0x0286h */ + + /* Write only. When this bit is set, RXDMA will decrease RX PKT counter by one. Before */ + /* this bit is polled, FW shall update RXFF_RD_PTR first. This register is write pulse and auto clear. */ + #define RXPKT_RELEASE_POLL BIT(0) + /* Read only. When RXMA finishes on-going DMA operation, RXMDA will report idle state in */ + /* this bit. FW can start releasing packets after RXDMA entering idle mode. */ + #define RXDMA_IDLE BIT(1) + /* When this bit is set, RXDMA will enter this mode after on-going RXDMA packet to host */ + /* completed, and stop DMA packet to host. RXDMA will then report Default: 0; */ + #define RW_RELEASE_EN BIT(2) +#endif +/* ----------------------------------------------------- + * + * 0x0400h ~ 0x047Fh Protocol Configuration + * + * ----------------------------------------------------- */ +#if 0 + /* 2 FWHW_TXQ_CTRL 0x0420 */ + #define EN_AMPDU_RTY_NEW BIT(7) + + + /* 2 REG_LIFECTRL_CTRL 0x0426 */ + #define HAL92C_EN_PKT_LIFE_TIME_BK BIT(3) + #define HAL92C_EN_PKT_LIFE_TIME_BE BIT(2) + #define HAL92C_EN_PKT_LIFE_TIME_VI BIT(1) + #define HAL92C_EN_PKT_LIFE_TIME_VO BIT(0) + + #define HAL92C_MSDU_LIFE_TIME_UNIT 128 /* in us, said by Tim. */ + + + /* 2 SPEC SIFS 0x0428 */ + #define _SPEC_SIFS_CCK(x) ((x) & 0xFF) + #define _SPEC_SIFS_OFDM(x) (((x) & 0xFF) << 8) + + /* 2 RL 0x042A */ + #define RETRY_LIMIT_SHORT_SHIFT 8 + #define RETRY_LIMIT_LONG_SHIFT 0 + + #define _LRL(x) ((x) & 0x3F) + #define _SRL(x) (((x) & 0x3F) << 8) +#endif + +/* ----------------------------------------------------- + * + * 0x0500h ~ 0x05FFh EDCA Configuration + * + * ----------------------------------------------------- */ +#if 0 + /* 2 EDCA setting 0x050C */ + #define AC_PARAM_TXOP_LIMIT_OFFSET 16 + #define AC_PARAM_ECW_MAX_OFFSET 12 + #define AC_PARAM_ECW_MIN_OFFSET 8 + #define AC_PARAM_AIFS_OFFSET 0 + + + /* 2 BCN_CTRL 0x0550 */ + #define EN_TXBCN_RPT BIT(2) + #define EN_BCN_FUNCTION BIT(3) + + /* 2 TxPause 0x0522 */ + #define STOP_BCNQ BIT(6) +#endif + + +/* 2 ACMHWCTRL 0x05C0 */ +#define acm_hw_hw_en_8723d BIT(0) +#define acm_hw_voq_en_8723d BIT(1) +#define acm_hw_viq_en_8723d BIT(2) +#define acm_hw_beq_en_8723d BIT(3) +#define acm_hw_voq_status_8723d BIT(5) +#define acm_hw_viq_status_8723d BIT(6) +#define acm_hw_beq_status_8723d BIT(7) + + + +/* ----------------------------------------------------- + * + * 0x0600h ~ 0x07FFh WMAC Configuration + * + * ----------------------------------------------------- */ +#if 0 + + /* 2 TCR 0x0604 */ + #define DIS_GCLK BIT(1) + #define PAD_SEL BIT(2) + #define PWR_ST BIT(6) + #define PWRBIT_OW_EN BIT(7) + #define ACRC BIT(8) + #define CFENDFORM BIT(9) + #define ICV BIT(10) +#endif + +/* ---------------------------------------------------------------------------- + * 8195 (RCR) Receive Configuration Register (Offset 0x608, 32 bits) + * ---------------------------------------------------------------------------- */ +#if 0 + #define RCR_APPFCS BIT(31) /* WMAC append FCS after pauload */ + #define RCR_APP_MIC BIT(30) /* MACRX will retain the MIC at the bottom of the packet. */ + #define RCR_APP_ICV BIT(29) /* MACRX will retain the ICV at the bottom of the packet. */ + #define RCR_APP_PHYST_RXFF BIT(28) /* HY status is appended before RX packet in RXFF */ + #define RCR_APP_BA_SSN BIT(27) /* SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. */ + #define RCR_RSVD_BIT(26) BIT26 /* Reserved */ +#endif +#define RCR_TCPOFLD_EN BIT(25) /* Enable TCP checksum offload */ +#if 0 + #define RCR_ENMBID BIT(24) /* Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. */ + #define RCR_LSIGEN BIT(23) /* Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. */ + #define RCR_MFBEN BIT(22) /* Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. */ +#endif + + +#endif /* #ifndef __INC_HAL8723DREG_H */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.c index 5ce660f65e11..58b88f252f03 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.c @@ -1,923 +1,919 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.26*/ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (RTL8723D_SUPPORT == 1) -static BOOLEAN -CheckPositive( - IN PDM_ODM_T pDM_Odm, - IN const u4Byte Condition1, - IN const u4Byte Condition2, - IN const u4Byte Condition3, - IN const u4Byte Condition4 -) -{ - u1Byte _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*/ - ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ - - u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; - - u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; - u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; - - u4Byte driver1 = cut_version_for_para << 24 | - (pDM_Odm->SupportInterface & 0xF0) << 16 | - pDM_Odm->SupportPlatform << 16 | - pkg_type_for_para << 12 | - (pDM_Odm->SupportInterface & 0x0F) << 8 | - _BoardType; - - u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | - (pDM_Odm->TypeGPA & 0xFF) << 8 | - (pDM_Odm->TypeALNA & 0xFF) << 16 | - (pDM_Odm->TypeAPA & 0xFF) << 24; - -u4Byte driver3 = 0; - - u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | - (pDM_Odm->TypeGPA & 0xFF00) | - (pDM_Odm->TypeALNA & 0xFF00) << 8 | - (pDM_Odm->TypeAPA & 0xFF00) << 16; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); - - 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] */ - - cond1 &= 0x00FF0FFF; - driver1 &= 0x00FF0FFF; - - if ((cond1 & driver1) == cond1) { - u4Byte 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)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ - return TRUE; - else - return FALSE; - } else - return FALSE; -} -static BOOLEAN -CheckNegative( - IN PDM_ODM_T pDM_Odm, - IN const u4Byte Condition1, - IN const u4Byte Condition2 -) -{ - return TRUE; -} - -/****************************************************************************** -* AGC_TAB.TXT -******************************************************************************/ - -u4Byte Array_MP_8723D_AGC_TAB[] = { - 0xC78, 0xFE000101, - 0xC78, 0xFD010101, - 0xC78, 0xFC020101, - 0xC78, 0xFB030101, - 0xC78, 0xFA040101, - 0xC78, 0xF9050101, - 0xC78, 0xF8060101, - 0xC78, 0xF7070101, - 0xC78, 0xF6080101, - 0xC78, 0xF5090101, - 0xC78, 0xF40A0101, - 0xC78, 0xF30B0101, - 0xC78, 0xF20C0101, - 0xC78, 0xF10D0101, - 0xC78, 0xF00E0101, - 0xC78, 0xEF0F0101, - 0xC78, 0xEE100101, - 0xC78, 0xED110101, - 0xC78, 0xEC120101, - 0xC78, 0xEB130101, - 0xC78, 0xEA140101, - 0xC78, 0xE9150101, - 0xC78, 0xE8160101, - 0xC78, 0xE7170101, - 0xC78, 0xE6180101, - 0xC78, 0xE5190101, - 0xC78, 0xE41A0101, - 0xC78, 0xE31B0101, - 0xC78, 0xE21C0101, - 0xC78, 0xE11D0101, - 0xC78, 0xE01E0101, - 0xC78, 0x861F0101, - 0xC78, 0x85200101, - 0xC78, 0x84210101, - 0xC78, 0x83220101, - 0xC78, 0x82230101, - 0xC78, 0x81240101, - 0xC78, 0x80250101, - 0xC78, 0x44260101, - 0xC78, 0x43270101, - 0xC78, 0x42280101, - 0xC78, 0x41290101, - 0xC78, 0x402A0101, - 0xC78, 0x022B0101, - 0xC78, 0x012C0101, - 0xC78, 0x002D0101, - 0xC78, 0xC52E0001, - 0xC78, 0xC42F0001, - 0xC78, 0xC3300001, - 0xC78, 0xC2310001, - 0xC78, 0xC1320001, - 0xC78, 0xC0330001, - 0xC78, 0x04340001, - 0xC78, 0x03350001, - 0xC78, 0x02360001, - 0xC78, 0x01370001, - 0xC78, 0x00380001, - 0xC78, 0x00390001, - 0xC78, 0x003A0001, - 0xC78, 0x003B0001, - 0xC78, 0x003C0001, - 0xC78, 0x003D0001, - 0xC78, 0x003E0001, - 0xC78, 0x003F0001, - 0xC78, 0x6F002001, - 0xC78, 0x6F012001, - 0xC78, 0x6F022001, - 0xC78, 0x6F032001, - 0xC78, 0x6F042001, - 0xC78, 0x6F052001, - 0xC78, 0x6F062001, - 0xC78, 0x6F072001, - 0xC78, 0x6F082001, - 0xC78, 0x6F092001, - 0xC78, 0x6F0A2001, - 0xC78, 0x6F0B2001, - 0xC78, 0x6F0C2001, - 0xC78, 0x6F0D2001, - 0xC78, 0x6F0E2001, - 0xC78, 0x6F0F2001, - 0xC78, 0x6F102001, - 0xC78, 0x6F112001, - 0xC78, 0x6F122001, - 0xC78, 0x6F132001, - 0xC78, 0x6F142001, - 0xC78, 0x6F152001, - 0xC78, 0x6F162001, - 0xC78, 0x6F172001, - 0xC78, 0x6F182001, - 0xC78, 0x6F192001, - 0xC78, 0x6F1A2001, - 0xC78, 0x6F1B2001, - 0xC78, 0x6F1C2001, - 0xC78, 0x6F1D2001, - 0xC78, 0x6F1E2001, - 0xC78, 0x6F1F2001, - 0xC78, 0x6F202001, - 0xC78, 0x6F212001, - 0xC78, 0x6F222001, - 0xC78, 0x6F232001, - 0xC78, 0x6E242001, - 0xC78, 0x6D252001, - 0xC78, 0x6C262001, - 0xC78, 0x6B272001, - 0xC78, 0x6A282001, - 0xC78, 0x69292001, - 0xC78, 0x4B2A2001, - 0xC78, 0x4A2B2001, - 0xC78, 0x492C2001, - 0xC78, 0x482D2001, - 0xC78, 0x472E2001, - 0xC78, 0x462F2001, - 0xC78, 0x45302001, - 0xC78, 0x44312001, - 0xC78, 0x43322001, - 0xC78, 0x42332001, - 0xC78, 0x41342001, - 0xC78, 0x40352001, - 0xC78, 0x02362001, - 0xC78, 0x01372001, - 0xC78, 0x00382001, - 0xC78, 0x00392001, - 0xC78, 0x003A2001, - 0xC78, 0x003B2001, - 0xC78, 0x003C2001, - 0xC78, 0x003D2001, - 0xC78, 0x003E2001, - 0xC78, 0x003F2001, - 0xC78, 0x7F003101, - 0xC78, 0x7F013101, - 0xC78, 0x7F023101, - 0xC78, 0x7F033101, - 0xC78, 0x7F043101, - 0xC78, 0x7F053101, - 0xC78, 0x7F063101, - 0xC78, 0x7F073101, - 0xC78, 0x7E083101, - 0xC78, 0x7D093101, - 0xC78, 0x7C0A3101, - 0xC78, 0x7B0B3101, - 0xC78, 0x7A0C3101, - 0xC78, 0x790D3101, - 0xC78, 0x780E3101, - 0xC78, 0x770F3101, - 0xC78, 0x76103101, - 0xC78, 0x75113101, - 0xC78, 0x74123101, - 0xC78, 0x73133101, - 0xC78, 0x72143101, - 0xC78, 0x71153101, - 0xC78, 0x70163101, - 0xC78, 0x6F173101, - 0xC78, 0x6E183101, - 0xC78, 0x6D193101, - 0xC78, 0x6C1A3101, - 0xC78, 0x6B1B3101, - 0xC78, 0x6A1C3101, - 0xC78, 0x691D3101, - 0xC78, 0x681E3101, - 0xC78, 0x4B1F3101, - 0xC78, 0x4A203101, - 0xC78, 0x49213101, - 0xC78, 0x48223101, - 0xC78, 0x47233101, - 0xC78, 0x46243101, - 0xC78, 0x45253101, - 0xC78, 0x44263101, - 0xC78, 0x43273101, - 0xC78, 0x42283101, - 0xC78, 0x41293101, - 0xC78, 0x402A3101, - 0xC78, 0x022B3101, - 0xC78, 0x012C3101, - 0xC78, 0x002D3101, - 0xC78, 0x002E3101, - 0xC78, 0x002F3101, - 0xC78, 0x00303101, - 0xC78, 0x00313101, - 0xC78, 0x00323101, - 0xC78, 0x00333101, - 0xC78, 0x00343101, - 0xC78, 0x00353101, - 0xC78, 0x00363101, - 0xC78, 0x00373101, - 0xC78, 0x00383101, - 0xC78, 0x00393101, - 0xC78, 0x003A3101, - 0xC78, 0x003B3101, - 0xC78, 0x003C3101, - 0xC78, 0x003D3101, - 0xC78, 0x003E3101, - 0xC78, 0x003F3101, - 0xC78, 0xFE403101, - 0xC78, 0xFD413101, - 0xC78, 0xFC423101, - 0xC78, 0xFB433101, - 0xC78, 0xFA443101, - 0xC78, 0xF9453101, - 0xC78, 0xF8463101, - 0xC78, 0xF7473101, - 0xC78, 0xF6483101, - 0xC78, 0xF5493101, - 0xC78, 0xF44A3101, - 0xC78, 0xF34B3101, - 0xC78, 0xF24C3101, - 0xC78, 0xF14D3101, - 0xC78, 0xF04E3101, - 0xC78, 0xEF4F3101, - 0xC78, 0xEE503101, - 0xC78, 0xED513101, - 0xC78, 0xEC523101, - 0xC78, 0xEB533101, - 0xC78, 0xEA543101, - 0xC78, 0xE9553101, - 0xC78, 0xE8563101, - 0xC78, 0xE7573101, - 0xC78, 0xE6583101, - 0xC78, 0xE5593101, - 0xC78, 0xE45A3101, - 0xC78, 0xE35B3101, - 0xC78, 0xE25C3101, - 0xC78, 0xE15D3101, - 0xC78, 0xE05E3101, - 0xC78, 0x865F3101, - 0xC78, 0x85603101, - 0xC78, 0x84613101, - 0xC78, 0x83623101, - 0xC78, 0x82633101, - 0xC78, 0x81643101, - 0xC78, 0x80653101, - 0xC78, 0x80663101, - 0xC78, 0x80673101, - 0xC78, 0x80683101, - 0xC78, 0x80693101, - 0xC78, 0x806A3101, - 0xC78, 0x806B3101, - 0xC78, 0x806C3101, - 0xC78, 0x806D3101, - 0xC78, 0x806E3101, - 0xC78, 0x806F3101, - 0xC78, 0x80703101, - 0xC78, 0x80713101, - 0xC78, 0x80723101, - 0xC78, 0x80733101, - 0xC78, 0x80743101, - 0xC78, 0x80753101, - 0xC78, 0x80763101, - 0xC78, 0x80773101, - 0xC78, 0x80783101, - 0xC78, 0x80793101, - 0xC78, 0x807A3101, - 0xC78, 0x807B3101, - 0xC78, 0x807C3101, - 0xC78, 0x807D3101, - 0xC78, 0x807E3101, - 0xC78, 0x807F3101, - 0xC78, 0xEF402001, - 0xC78, 0xEF412001, - 0xC78, 0xEF422001, - 0xC78, 0xEF432001, - 0xC78, 0xEF442001, - 0xC78, 0xEF452001, - 0xC78, 0xEF462001, - 0xC78, 0xEF472001, - 0xC78, 0xEF482001, - 0xC78, 0xEF492001, - 0xC78, 0xEF4A2001, - 0xC78, 0xEF4B2001, - 0xC78, 0xEF4C2001, - 0xC78, 0xEF4D2001, - 0xC78, 0xEF4E2001, - 0xC78, 0xEF4F2001, - 0xC78, 0xEF502001, - 0xC78, 0xEF512001, - 0xC78, 0xEF522001, - 0xC78, 0xEF532001, - 0xC78, 0xEF542001, - 0xC78, 0xEF552001, - 0xC78, 0xEF562001, - 0xC78, 0xEF572001, - 0xC78, 0xEF582001, - 0xC78, 0xEF592001, - 0xC78, 0xEF5A2001, - 0xC78, 0xEF5B2001, - 0xC78, 0xEF5C2001, - 0xC78, 0xEF5D2001, - 0xC78, 0xEF5E2001, - 0xC78, 0xEF5F2001, - 0xC78, 0xEF602001, - 0xC78, 0xEE612001, - 0xC78, 0xED622001, - 0xC78, 0xEC632001, - 0xC78, 0xEB642001, - 0xC78, 0xEA652001, - 0xC78, 0xE9662001, - 0xC78, 0xE8672001, - 0xC78, 0xCB682001, - 0xC78, 0xCA692001, - 0xC78, 0xC96A2001, - 0xC78, 0xC86B2001, - 0xC78, 0xC76C2001, - 0xC78, 0xC66D2001, - 0xC78, 0xC56E2001, - 0xC78, 0xC46F2001, - 0xC78, 0xC3702001, - 0xC78, 0xC2712001, - 0xC78, 0xC1722001, - 0xC78, 0xC0732001, - 0xC78, 0x82742001, - 0xC78, 0x81752001, - 0xC78, 0x80762001, - 0xC78, 0x80772001, - 0xC78, 0x80782001, - 0xC78, 0x80792001, - 0xC78, 0x807A2001, - 0xC78, 0x807B2001, - 0xC78, 0x807C2001, - 0xC78, 0x807D2001, - 0xC78, 0x807E2001, - 0xC78, 0x807F2001, - 0xC78, 0xFA001101, - 0xC78, 0xF9011101, - 0xC78, 0xF8021101, - 0xC78, 0xF7031101, - 0xC78, 0xF6041101, - 0xC78, 0xF5051101, - 0xC78, 0xF4061101, - 0xC78, 0xD7071101, - 0xC78, 0xD6081101, - 0xC78, 0xD5091101, - 0xC78, 0xD40A1101, - 0xC78, 0x970B1101, - 0xC78, 0x960C1101, - 0xC78, 0x950D1101, - 0xC78, 0x940E1101, - 0xC78, 0x930F1101, - 0xC78, 0x92101101, - 0xC78, 0x91111101, - 0xC78, 0x90121101, - 0xC78, 0x8F131101, - 0xC78, 0x8E141101, - 0xC78, 0x8D151101, - 0xC78, 0x8C161101, - 0xC78, 0x8B171101, - 0xC78, 0x8A181101, - 0xC78, 0x89191101, - 0xC78, 0x881A1101, - 0xC78, 0x871B1101, - 0xC78, 0x861C1101, - 0xC78, 0x851D1101, - 0xC78, 0x841E1101, - 0xC78, 0x831F1101, - 0xC78, 0x82201101, - 0xC78, 0x81211101, - 0xC78, 0x80221101, - 0xC78, 0x43231101, - 0xC78, 0x42241101, - 0xC78, 0x41251101, - 0xC78, 0x04261101, - 0xC78, 0x03271101, - 0xC78, 0x02281101, - 0xC78, 0x01291101, - 0xC78, 0x002A1101, - 0xC78, 0xC42B1001, - 0xC78, 0xC32C1001, - 0xC78, 0xC22D1001, - 0xC78, 0xC12E1001, - 0xC78, 0xC02F1001, - 0xC78, 0x85301001, - 0xC78, 0x84311001, - 0xC78, 0x83321001, - 0xC78, 0x82331001, - 0xC78, 0x81341001, - 0xC78, 0x80351001, - 0xC78, 0x05361001, - 0xC78, 0x04371001, - 0xC78, 0x03381001, - 0xC78, 0x02391001, - 0xC78, 0x013A1001, - 0xC78, 0x003B1001, - 0xC78, 0x003C1001, - 0xC78, 0x003D1001, - 0xC78, 0x003E1001, - 0xC78, 0x003F1001, - 0xC50, 0x69553422, - 0xC50, 0x69553420, - -}; - -void -ODM_ReadAndConfig_MP_8723D_AGC_TAB( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte i = 0; - u1Byte cCond; - BOOLEAN bMatched = TRUE, bSkipped = FALSE; - u4Byte ArrayLen = sizeof(Array_MP_8723D_AGC_TAB)/sizeof(u4Byte); - pu4Byte Array = Array_MP_8723D_AGC_TAB; - - u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_AGC_TAB\n")); - - while ((i + 1) < ArrayLen) { - v1 = Array[i]; - v2 = Array[i + 1]; - - if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ - if (v1 & BIT31) {/* positive condition*/ - cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); - if (cCond == COND_ENDIF) {/*end*/ - bMatched = TRUE; - bSkipped = FALSE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); - } else if (cCond == COND_ELSE) { /*else*/ - bMatched = bSkipped?FALSE:TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); - } else {/*if , else if*/ - pre_v1 = v1; - pre_v2 = v2; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); - } - } else if (v1 & BIT30) { /*negative condition*/ - if (bSkipped == FALSE) { - if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { - bMatched = TRUE; - bSkipped = TRUE; - } else { - bMatched = FALSE; - bSkipped = FALSE; - } - } else - bMatched = FALSE; - } - } else { - if (bMatched) - odm_ConfigBB_AGC_8723D(pDM_Odm, v1, bMaskDWord, v2); - } - i = i + 2; - } -} - -u4Byte -ODM_GetVersion_MP_8723D_AGC_TAB(void) -{ - return 31; -} - -/****************************************************************************** -* PHY_REG.TXT -******************************************************************************/ - -u4Byte Array_MP_8723D_PHY_REG[] = { - 0x800, 0x80046C00, - 0x804, 0x00000003, - 0x808, 0x0000FC00, - 0x80C, 0x0000000A, - 0x810, 0x10001331, - 0x814, 0x020C3D10, - 0x818, 0x00200385, - 0x81C, 0x00000000, - 0x820, 0x01000100, - 0x824, 0x00390204, - 0x828, 0x00000000, - 0x82C, 0x00000000, - 0x830, 0x00000000, - 0x834, 0x00000000, - 0x838, 0x00000000, - 0x83C, 0x00000000, - 0x840, 0x00010000, - 0x844, 0x00000000, - 0x848, 0x00000000, - 0x84C, 0x00000000, - 0x850, 0x00000000, - 0x854, 0x00000000, - 0x858, 0x569A11A9, - 0x85C, 0x01000014, - 0x860, 0x66F60110, - 0x864, 0x461F0641, - 0x868, 0x00000000, - 0x86C, 0x27272700, - 0x870, 0x07000460, - 0x874, 0x25004000, - 0x878, 0x00000808, - 0x87C, 0x004F0201, - 0x880, 0xB2002E12, - 0x884, 0x00000007, - 0x888, 0x00000000, - 0x88C, 0xCCC000C0, - 0x890, 0x00000800, - 0x894, 0xFFFFFFFE, - 0x898, 0x40302010, - 0x89C, 0x00706050, - 0x900, 0x00000000, - 0x904, 0x00000023, - 0x908, 0x00000000, - 0x90C, 0x81121111, - 0x910, 0x00000402, - 0x914, 0x00000300, - 0x920, 0x18C6318C, - 0x924, 0x0000018C, - 0x948, 0x99000000, - 0x94C, 0x00000010, - 0x950, 0x00003800, - 0x954, 0x5A380000, - 0x958, 0x4BC6D87A, - 0x95C, 0x04EB9B79, - 0x96C, 0x00000003, - 0x970, 0x00000000, - 0x974, 0x00000000, - 0x978, 0x00000000, - 0x97C, 0x13000000, - 0x980, 0x00000000, - 0xA00, 0x00D047C8, - 0xA04, 0x80FF800C, - 0xA08, 0x8C838300, - 0xA0C, 0x2E20100F, - 0xA10, 0x9500BB78, - 0xA14, 0x1114D028, - 0xA18, 0x00881117, - 0xA1C, 0x89140F00, - 0xA20, 0xE82C0001, - 0xA24, 0x64B80C1C, - 0xA28, 0x00008810, - 0xA2C, 0x00D30000, - 0xA70, 0x101FBF00, - 0xA74, 0x00000007, - 0xA78, 0x00008900, - 0xA7C, 0x225B0606, - 0xA80, 0x2180FA74, - 0xA84, 0x00200000, - 0xA88, 0x040C0000, - 0xA8C, 0x12345678, - 0xA90, 0xABCDEF00, - 0xA94, 0x001B1B89, - 0xA98, 0x00000000, - 0xA9C, 0x00020000, - 0xAA0, 0x00000000, - 0xAA4, 0x0000000C, - 0xAA8, 0xCA100008, - 0xAAC, 0x01235667, - 0xAB0, 0x00000000, - 0xAB4, 0x20201402, - 0xB2C, 0x00000000, - 0xC00, 0x48071D40, - 0xC04, 0x03A05611, - 0xC08, 0x000000E4, - 0xC0C, 0x6C6C6C6C, - 0xC10, 0x28800000, - 0xC14, 0x40000100, - 0xC18, 0x08800000, - 0xC1C, 0x40000100, - 0xC20, 0x00000000, - 0xC24, 0x00000000, - 0xC28, 0x00000000, - 0xC2C, 0x00000000, - 0xC30, 0x69E9AC48, - 0xC34, 0x31000040, - 0xC38, 0x21688080, - 0xC3C, 0x000016D4, - 0xC40, 0x1F78403F, - 0xC44, 0x00010036, - 0xC48, 0xEC020107, - 0xC4C, 0x007F037F, - 0xC50, 0x69553420, - 0xC54, 0x43BC0094, - 0xC58, 0x00015969, - 0xC5C, 0x00310492, - 0xC60, 0x00280A00, - 0xC64, 0x7112848B, - 0xC68, 0x47C074FF, - 0xC6C, 0x00000036, - 0xC70, 0x2C7F000D, - 0xC74, 0x020600DB, - 0xC78, 0x0000001F, - 0xC7C, 0x00B91612, - 0xC80, 0x390000E4, - 0xC84, 0x11F60000, - 0xC88, 0x40000100, - 0xC8C, 0x20200000, - 0xC90, 0x00091521, - 0xC94, 0x00000000, - 0xC98, 0x00121820, - 0xC9C, 0x00007F7F, - 0xCA0, 0x00012000, - 0xCA4, 0xA00000A0, - 0xCA8, 0x85E7C606, - 0xCAC, 0x00000060, - 0xCB0, 0x00000000, - 0xCB4, 0x00000000, - 0xCB8, 0x00000000, - 0xCBC, 0x28000000, - 0xCC0, 0x0010A3D0, - 0xCC4, 0x00000F7D, - 0xCC8, 0x000442D6, - 0xCCC, 0x00000000, - 0xCD0, 0x000001C8, - 0xCD4, 0x001C8000, - 0xCD8, 0x00000100, - 0xCDC, 0x40100000, - 0xCE0, 0x00222220, - 0xCE4, 0x20000000, - 0xCE8, 0x37644302, - 0xCEC, 0x2F97D40C, - 0xD00, 0x00030740, - 0xD04, 0x40020401, - 0xD08, 0x0000907F, - 0xD0C, 0x20010201, - 0xD10, 0xA0633333, - 0xD14, 0x3333BC53, - 0xD18, 0x7A8F5B6F, - 0xD2C, 0xCC979975, - 0xD30, 0x00000000, - 0xD34, 0x80608000, - 0xD38, 0x88000000, - 0xD3C, 0xC0127343, - 0xD40, 0x00000000, - 0xD44, 0x00000000, - 0xD48, 0x00000000, - 0xD4C, 0x00000000, - 0xD50, 0x00000038, - 0xD54, 0x00000000, - 0xD58, 0x00000282, - 0xD5C, 0x30032064, - 0xD60, 0x4653DE68, - 0xD64, 0x04518A3C, - 0xD68, 0x00002101, - 0xE00, 0x2D2D2D2D, - 0xE04, 0x2D2D2D2D, - 0xE08, 0x0390272D, - 0xE10, 0x2D2D2D2D, - 0xE14, 0x2D2D2D2D, - 0xE18, 0x2D2D2D2D, - 0xE1C, 0x2D2D2D2D, - 0xE28, 0x00000000, - 0xE30, 0x1000DC1F, - 0xE34, 0x10008C1F, - 0xE38, 0x02140102, - 0xE3C, 0x681604C2, - 0xE40, 0x01007C00, - 0xE44, 0x01004800, - 0xE48, 0xFB000000, - 0xE4C, 0x000028D1, - 0xE50, 0x1000DC1F, - 0xE54, 0x10008C1F, - 0xE58, 0x02140102, - 0xE5C, 0x28160D05, - 0xE60, 0x00000008, - 0xE68, 0x001B25A4, - 0xE6C, 0x01C00014, - 0xE70, 0x01C00016, - 0xE74, 0x02000014, - 0xE78, 0x02000014, - 0xE7C, 0x02000014, - 0xE80, 0x02000014, - 0xE84, 0x01C00014, - 0xE88, 0x02000014, - 0xE8C, 0x01C00014, - 0xED0, 0x01C00014, - 0xED4, 0x01C00014, - 0xED8, 0x01C00014, - 0xEDC, 0x00000014, - 0xEE0, 0x00000014, - 0xEE8, 0x21555448, - 0xEEC, 0x03C00014, - 0xF14, 0x00000003, - 0xF00, 0x00100300, - 0xF08, 0x0000800B, - 0xF0C, 0x0000F007, - 0xF10, 0x0000A487, - 0xF1C, 0x80000064, - 0xF38, 0x00030155, - 0xF3C, 0x0000003A, - 0xF4C, 0x13000000, - 0xF50, 0x00000000, - 0xF18, 0x00000000, - -}; - -void -ODM_ReadAndConfig_MP_8723D_PHY_REG( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte i = 0; - u1Byte cCond; - BOOLEAN bMatched = TRUE, bSkipped = FALSE; - u4Byte ArrayLen = sizeof(Array_MP_8723D_PHY_REG)/sizeof(u4Byte); - pu4Byte Array = Array_MP_8723D_PHY_REG; - - u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_PHY_REG\n")); - - while ((i + 1) < ArrayLen) { - v1 = Array[i]; - v2 = Array[i + 1]; - - if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ - if (v1 & BIT31) {/* positive condition*/ - cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); - if (cCond == COND_ENDIF) {/*end*/ - bMatched = TRUE; - bSkipped = FALSE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); - } else if (cCond == COND_ELSE) { /*else*/ - bMatched = bSkipped?FALSE:TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); - } else {/*if , else if*/ - pre_v1 = v1; - pre_v2 = v2; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); - } - } else if (v1 & BIT30) { /*negative condition*/ - if (bSkipped == FALSE) { - if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { - bMatched = TRUE; - bSkipped = TRUE; - } else { - bMatched = FALSE; - bSkipped = FALSE; - } - } else - bMatched = FALSE; - } - } else { - if (bMatched) - odm_ConfigBB_PHY_8723D(pDM_Odm, v1, bMaskDWord, v2); - } - i = i + 2; - } -} - -u4Byte -ODM_GetVersion_MP_8723D_PHY_REG(void) -{ - return 31; -} - -/****************************************************************************** -* PHY_REG_PG.TXT -******************************************************************************/ - -u4Byte Array_MP_8723D_PHY_REG_PG[] = { - 0, 0, 0, 0x00000e08, 0x0000ff00, 0x00003200, - 0, 0, 0, 0x0000086c, 0xffffff00, 0x32323200, - 0, 0, 0, 0x00000e00, 0xffffffff, 0x32343434, - 0, 0, 0, 0x00000e04, 0xffffffff, 0x28303032, - 0, 0, 0, 0x00000e10, 0xffffffff, 0x30323234, - 0, 0, 0, 0x00000e14, 0xffffffff, 0x26282830 -}; - -void -ODM_ReadAndConfig_MP_8723D_PHY_REG_PG( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte i = 0; - u4Byte ArrayLen = sizeof(Array_MP_8723D_PHY_REG_PG)/sizeof(u4Byte); - pu4Byte Array = Array_MP_8723D_PHY_REG_PG; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - PlatformZeroMemory(pHalData->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); - pHalData->nLinesReadPwrByRate = ArrayLen/6; -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_PHY_REG_PG\n")); - - pDM_Odm->PhyRegPgVersion = 1; - pDM_Odm->PhyRegPgValueType = PHY_REG_PG_EXACT_VALUE; - - for (i = 0; i < ArrayLen; i += 6) { - u4Byte v1 = Array[i]; - u4Byte v2 = Array[i+1]; - u4Byte v3 = Array[i+2]; - u4Byte v4 = Array[i+3]; - u4Byte v5 = Array[i+4]; - u4Byte v6 = Array[i+5]; - - odm_ConfigBB_PHY_REG_PG_8723D(pDM_Odm, v1, v2, v3, v4, v5, v6); - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - rsprintf((char *)pHalData->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", - (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); -#endif - } -} - - - -#endif /* end of HWIMG_SUPPORT*/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +/*Image2HeaderVersion: 3.5.2*/ +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (RTL8723D_SUPPORT == 1) +static boolean +check_positive( + struct PHY_DM_STRUCT *p_dm, + const u32 condition1, + const u32 condition2, + const u32 condition3, + const u32 condition4 +) +{ + u8 _board_type = ((p_dm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ + ((p_dm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ + ((p_dm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ + ((p_dm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ + ((p_dm->board_type & BIT(2)) >> 2) << 4 | /* _BT*/ + ((p_dm->board_type & BIT(1)) >> 1) << 5 | /* _NGFF*/ + ((p_dm->board_type & BIT(5)) >> 5) << 6; /* _TRSWT*/ + + u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; + + u8 cut_version_for_para = (p_dm->cut_version == ODM_CUT_A) ? 15 : p_dm->cut_version; + u8 pkg_type_for_para = (p_dm->package_type == 0) ? 15 : p_dm->package_type; + + u32 driver1 = cut_version_for_para << 24 | + (p_dm->support_interface & 0xF0) << 16 | + p_dm->support_platform << 16 | + pkg_type_for_para << 12 | + (p_dm->support_interface & 0x0F) << 8 | + _board_type; + + u32 driver2 = (p_dm->type_glna & 0xFF) << 0 | + (p_dm->type_gpa & 0xFF) << 8 | + (p_dm->type_alna & 0xFF) << 16 | + (p_dm->type_apa & 0xFF) << 24; + + u32 driver3 = 0; + + u32 driver4 = (p_dm->type_glna & 0xFF00) >> 8 | + (p_dm->type_gpa & 0xFF00) | + (p_dm->type_alna & 0xFF00) << 8 | + (p_dm->type_apa & 0xFF00) << 16; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===> check_positive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===> check_positive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + (" (Platform, Interface) = (0x%X, 0x%X)\n", p_dm->support_platform, p_dm->support_interface)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + (" (Board, Package) = (0x%X, 0x%X)\n", p_dm->board_type, p_dm->package_type)); + + + /*============== 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] */ + + cond1 &= 0x00FF0FFF; + driver1 &= 0x00FF0FFF; + + if ((cond1 & driver1) == cond1) { + u32 bit_mask = 0; + + if ((cond1 & 0x0F) == 0) /* board_type is DONTCARE*/ + return true; + + if ((cond1 & BIT(0)) != 0) /*GLNA*/ + bit_mask |= 0x000000FF; + if ((cond1 & BIT(1)) != 0) /*GPA*/ + bit_mask |= 0x0000FF00; + if ((cond1 & BIT(2)) != 0) /*ALNA*/ + bit_mask |= 0x00FF0000; + if ((cond1 & BIT(3)) != 0) /*APA*/ + bit_mask |= 0xFF000000; + + if (((cond2 & bit_mask) == (driver2 & bit_mask)) && ((cond4 & bit_mask) == (driver4 & bit_mask))) /* board_type of each RF path is matched*/ + return true; + else + return false; + } else + return false; +} +static boolean +check_negative( + struct PHY_DM_STRUCT *p_dm, + const u32 condition1, + const u32 condition2 +) +{ + return true; +} + +/****************************************************************************** +* agc_tab.TXT +******************************************************************************/ + +u32 array_mp_8723d_agc_tab[] = { + 0xC78, 0xFE000101, + 0xC78, 0xFD010101, + 0xC78, 0xFC020101, + 0xC78, 0xFB030101, + 0xC78, 0xFA040101, + 0xC78, 0xF9050101, + 0xC78, 0xF8060101, + 0xC78, 0xF7070101, + 0xC78, 0xF6080101, + 0xC78, 0xF5090101, + 0xC78, 0xF40A0101, + 0xC78, 0xF30B0101, + 0xC78, 0xF20C0101, + 0xC78, 0xF10D0101, + 0xC78, 0xF00E0101, + 0xC78, 0xEF0F0101, + 0xC78, 0xEE100101, + 0xC78, 0xED110101, + 0xC78, 0xEC120101, + 0xC78, 0xEB130101, + 0xC78, 0xEA140101, + 0xC78, 0xE9150101, + 0xC78, 0xE8160101, + 0xC78, 0xE7170101, + 0xC78, 0xE6180101, + 0xC78, 0xE5190101, + 0xC78, 0xE41A0101, + 0xC78, 0xE31B0101, + 0xC78, 0xE21C0101, + 0xC78, 0xE11D0101, + 0xC78, 0xE01E0101, + 0xC78, 0x861F0101, + 0xC78, 0x85200101, + 0xC78, 0x84210101, + 0xC78, 0x83220101, + 0xC78, 0x82230101, + 0xC78, 0x81240101, + 0xC78, 0x80250101, + 0xC78, 0x44260101, + 0xC78, 0x43270101, + 0xC78, 0x42280101, + 0xC78, 0x41290101, + 0xC78, 0x402A0101, + 0xC78, 0x022B0101, + 0xC78, 0x012C0101, + 0xC78, 0x002D0101, + 0xC78, 0xC52E0001, + 0xC78, 0xC42F0001, + 0xC78, 0xC3300001, + 0xC78, 0xC2310001, + 0xC78, 0xC1320001, + 0xC78, 0xC0330001, + 0xC78, 0x04340001, + 0xC78, 0x03350001, + 0xC78, 0x02360001, + 0xC78, 0x01370001, + 0xC78, 0x00380001, + 0xC78, 0x00390001, + 0xC78, 0x003A0001, + 0xC78, 0x003B0001, + 0xC78, 0x003C0001, + 0xC78, 0x003D0001, + 0xC78, 0x003E0001, + 0xC78, 0x003F0001, + 0xC78, 0x6F002001, + 0xC78, 0x6F012001, + 0xC78, 0x6F022001, + 0xC78, 0x6F032001, + 0xC78, 0x6F042001, + 0xC78, 0x6F052001, + 0xC78, 0x6F062001, + 0xC78, 0x6F072001, + 0xC78, 0x6F082001, + 0xC78, 0x6F092001, + 0xC78, 0x6F0A2001, + 0xC78, 0x6F0B2001, + 0xC78, 0x6F0C2001, + 0xC78, 0x6F0D2001, + 0xC78, 0x6F0E2001, + 0xC78, 0x6F0F2001, + 0xC78, 0x6F102001, + 0xC78, 0x6F112001, + 0xC78, 0x6F122001, + 0xC78, 0x6F132001, + 0xC78, 0x6F142001, + 0xC78, 0x6F152001, + 0xC78, 0x6F162001, + 0xC78, 0x6F172001, + 0xC78, 0x6F182001, + 0xC78, 0x6F192001, + 0xC78, 0x6F1A2001, + 0xC78, 0x6F1B2001, + 0xC78, 0x6F1C2001, + 0xC78, 0x6F1D2001, + 0xC78, 0x6F1E2001, + 0xC78, 0x6F1F2001, + 0xC78, 0x6F202001, + 0xC78, 0x6F212001, + 0xC78, 0x6F222001, + 0xC78, 0x6F232001, + 0xC78, 0x6E242001, + 0xC78, 0x6D252001, + 0xC78, 0x6C262001, + 0xC78, 0x6B272001, + 0xC78, 0x6A282001, + 0xC78, 0x69292001, + 0xC78, 0x4B2A2001, + 0xC78, 0x4A2B2001, + 0xC78, 0x492C2001, + 0xC78, 0x482D2001, + 0xC78, 0x472E2001, + 0xC78, 0x462F2001, + 0xC78, 0x45302001, + 0xC78, 0x44312001, + 0xC78, 0x43322001, + 0xC78, 0x42332001, + 0xC78, 0x41342001, + 0xC78, 0x40352001, + 0xC78, 0x02362001, + 0xC78, 0x01372001, + 0xC78, 0x00382001, + 0xC78, 0x00392001, + 0xC78, 0x003A2001, + 0xC78, 0x003B2001, + 0xC78, 0x003C2001, + 0xC78, 0x003D2001, + 0xC78, 0x003E2001, + 0xC78, 0x003F2001, + 0xC78, 0x7F003101, + 0xC78, 0x7F013101, + 0xC78, 0x7F023101, + 0xC78, 0x7F033101, + 0xC78, 0x7F043101, + 0xC78, 0x7F053101, + 0xC78, 0x7F063101, + 0xC78, 0x7F073101, + 0xC78, 0x7E083101, + 0xC78, 0x7D093101, + 0xC78, 0x7C0A3101, + 0xC78, 0x7B0B3101, + 0xC78, 0x7A0C3101, + 0xC78, 0x790D3101, + 0xC78, 0x780E3101, + 0xC78, 0x770F3101, + 0xC78, 0x76103101, + 0xC78, 0x75113101, + 0xC78, 0x74123101, + 0xC78, 0x73133101, + 0xC78, 0x72143101, + 0xC78, 0x71153101, + 0xC78, 0x70163101, + 0xC78, 0x6F173101, + 0xC78, 0x6E183101, + 0xC78, 0x6D193101, + 0xC78, 0x6C1A3101, + 0xC78, 0x6B1B3101, + 0xC78, 0x6A1C3101, + 0xC78, 0x691D3101, + 0xC78, 0x681E3101, + 0xC78, 0x4B1F3101, + 0xC78, 0x4A203101, + 0xC78, 0x49213101, + 0xC78, 0x48223101, + 0xC78, 0x47233101, + 0xC78, 0x46243101, + 0xC78, 0x45253101, + 0xC78, 0x44263101, + 0xC78, 0x43273101, + 0xC78, 0x42283101, + 0xC78, 0x41293101, + 0xC78, 0x402A3101, + 0xC78, 0x022B3101, + 0xC78, 0x012C3101, + 0xC78, 0x002D3101, + 0xC78, 0x002E3101, + 0xC78, 0x002F3101, + 0xC78, 0x00303101, + 0xC78, 0x00313101, + 0xC78, 0x00323101, + 0xC78, 0x00333101, + 0xC78, 0x00343101, + 0xC78, 0x00353101, + 0xC78, 0x00363101, + 0xC78, 0x00373101, + 0xC78, 0x00383101, + 0xC78, 0x00393101, + 0xC78, 0x003A3101, + 0xC78, 0x003B3101, + 0xC78, 0x003C3101, + 0xC78, 0x003D3101, + 0xC78, 0x003E3101, + 0xC78, 0x003F3101, + 0xC78, 0xFE403101, + 0xC78, 0xFD413101, + 0xC78, 0xFC423101, + 0xC78, 0xFB433101, + 0xC78, 0xFA443101, + 0xC78, 0xF9453101, + 0xC78, 0xF8463101, + 0xC78, 0xF7473101, + 0xC78, 0xF6483101, + 0xC78, 0xF5493101, + 0xC78, 0xF44A3101, + 0xC78, 0xF34B3101, + 0xC78, 0xF24C3101, + 0xC78, 0xF14D3101, + 0xC78, 0xF04E3101, + 0xC78, 0xEF4F3101, + 0xC78, 0xEE503101, + 0xC78, 0xED513101, + 0xC78, 0xEC523101, + 0xC78, 0xEB533101, + 0xC78, 0xEA543101, + 0xC78, 0xE9553101, + 0xC78, 0xE8563101, + 0xC78, 0xE7573101, + 0xC78, 0xE6583101, + 0xC78, 0xE5593101, + 0xC78, 0xE45A3101, + 0xC78, 0xE35B3101, + 0xC78, 0xE25C3101, + 0xC78, 0xE15D3101, + 0xC78, 0xE05E3101, + 0xC78, 0x865F3101, + 0xC78, 0x85603101, + 0xC78, 0x84613101, + 0xC78, 0x83623101, + 0xC78, 0x82633101, + 0xC78, 0x81643101, + 0xC78, 0x80653101, + 0xC78, 0x80663101, + 0xC78, 0x80673101, + 0xC78, 0x80683101, + 0xC78, 0x80693101, + 0xC78, 0x806A3101, + 0xC78, 0x806B3101, + 0xC78, 0x806C3101, + 0xC78, 0x806D3101, + 0xC78, 0x806E3101, + 0xC78, 0x806F3101, + 0xC78, 0x80703101, + 0xC78, 0x80713101, + 0xC78, 0x80723101, + 0xC78, 0x80733101, + 0xC78, 0x80743101, + 0xC78, 0x80753101, + 0xC78, 0x80763101, + 0xC78, 0x80773101, + 0xC78, 0x80783101, + 0xC78, 0x80793101, + 0xC78, 0x807A3101, + 0xC78, 0x807B3101, + 0xC78, 0x807C3101, + 0xC78, 0x807D3101, + 0xC78, 0x807E3101, + 0xC78, 0x807F3101, + 0xC78, 0xEF402001, + 0xC78, 0xEF412001, + 0xC78, 0xEF422001, + 0xC78, 0xEF432001, + 0xC78, 0xEF442001, + 0xC78, 0xEF452001, + 0xC78, 0xEF462001, + 0xC78, 0xEF472001, + 0xC78, 0xEF482001, + 0xC78, 0xEF492001, + 0xC78, 0xEF4A2001, + 0xC78, 0xEF4B2001, + 0xC78, 0xEF4C2001, + 0xC78, 0xEF4D2001, + 0xC78, 0xEF4E2001, + 0xC78, 0xEF4F2001, + 0xC78, 0xEF502001, + 0xC78, 0xEF512001, + 0xC78, 0xEF522001, + 0xC78, 0xEF532001, + 0xC78, 0xEF542001, + 0xC78, 0xEF552001, + 0xC78, 0xEF562001, + 0xC78, 0xEF572001, + 0xC78, 0xEF582001, + 0xC78, 0xEF592001, + 0xC78, 0xEF5A2001, + 0xC78, 0xEF5B2001, + 0xC78, 0xEF5C2001, + 0xC78, 0xEF5D2001, + 0xC78, 0xEF5E2001, + 0xC78, 0xEF5F2001, + 0xC78, 0xEF602001, + 0xC78, 0xEE612001, + 0xC78, 0xED622001, + 0xC78, 0xEC632001, + 0xC78, 0xEB642001, + 0xC78, 0xEA652001, + 0xC78, 0xE9662001, + 0xC78, 0xE8672001, + 0xC78, 0xCB682001, + 0xC78, 0xCA692001, + 0xC78, 0xC96A2001, + 0xC78, 0xC86B2001, + 0xC78, 0xC76C2001, + 0xC78, 0xC66D2001, + 0xC78, 0xC56E2001, + 0xC78, 0xC46F2001, + 0xC78, 0xC3702001, + 0xC78, 0xC2712001, + 0xC78, 0xC1722001, + 0xC78, 0xC0732001, + 0xC78, 0x82742001, + 0xC78, 0x81752001, + 0xC78, 0x80762001, + 0xC78, 0x80772001, + 0xC78, 0x80782001, + 0xC78, 0x80792001, + 0xC78, 0x807A2001, + 0xC78, 0x807B2001, + 0xC78, 0x807C2001, + 0xC78, 0x807D2001, + 0xC78, 0x807E2001, + 0xC78, 0x807F2001, + 0xC78, 0xFA001101, + 0xC78, 0xF9011101, + 0xC78, 0xF8021101, + 0xC78, 0xF7031101, + 0xC78, 0xF6041101, + 0xC78, 0xF5051101, + 0xC78, 0xF4061101, + 0xC78, 0xD7071101, + 0xC78, 0xD6081101, + 0xC78, 0xD5091101, + 0xC78, 0xD40A1101, + 0xC78, 0x970B1101, + 0xC78, 0x960C1101, + 0xC78, 0x950D1101, + 0xC78, 0x940E1101, + 0xC78, 0x930F1101, + 0xC78, 0x92101101, + 0xC78, 0x91111101, + 0xC78, 0x90121101, + 0xC78, 0x8F131101, + 0xC78, 0x8E141101, + 0xC78, 0x8D151101, + 0xC78, 0x8C161101, + 0xC78, 0x8B171101, + 0xC78, 0x8A181101, + 0xC78, 0x89191101, + 0xC78, 0x881A1101, + 0xC78, 0x871B1101, + 0xC78, 0x861C1101, + 0xC78, 0x851D1101, + 0xC78, 0x841E1101, + 0xC78, 0x831F1101, + 0xC78, 0x82201101, + 0xC78, 0x81211101, + 0xC78, 0x80221101, + 0xC78, 0x43231101, + 0xC78, 0x42241101, + 0xC78, 0x41251101, + 0xC78, 0x04261101, + 0xC78, 0x03271101, + 0xC78, 0x02281101, + 0xC78, 0x01291101, + 0xC78, 0x002A1101, + 0xC78, 0xC42B1001, + 0xC78, 0xC32C1001, + 0xC78, 0xC22D1001, + 0xC78, 0xC12E1001, + 0xC78, 0xC02F1001, + 0xC78, 0x85301001, + 0xC78, 0x84311001, + 0xC78, 0x83321001, + 0xC78, 0x82331001, + 0xC78, 0x81341001, + 0xC78, 0x80351001, + 0xC78, 0x05361001, + 0xC78, 0x04371001, + 0xC78, 0x03381001, + 0xC78, 0x02391001, + 0xC78, 0x013A1001, + 0xC78, 0x003B1001, + 0xC78, 0x003C1001, + 0xC78, 0x003D1001, + 0xC78, 0x003E1001, + 0xC78, 0x003F1001, + 0xC50, 0x69553422, + 0xC50, 0x69553420, + +}; + +void +odm_read_and_config_mp_8723d_agc_tab( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8723d_agc_tab)/sizeof(u32); + u32 *array = array_mp_8723d_agc_tab; + + u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_read_and_config_mp_8723d_agc_tab\n")); + + while ((i + 1) < array_len) { + v1 = array[i]; + v2 = array[i + 1]; + + if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ + if (v1 & BIT(31)) {/* positive condition*/ + c_cond = (u8)((v1 & (BIT(29)|BIT(28))) >> 28); + if (c_cond == COND_ENDIF) {/*end*/ + is_matched = true; + is_skipped = false; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ENDIF\n")); + } else if (c_cond == COND_ELSE) { /*else*/ + is_matched = is_skipped?false:true; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ELSE\n")); + } else {/*if , else if*/ + pre_v1 = v1; + pre_v2 = v2; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("IF or ELSE IF\n")); + } + } else if (v1 & BIT(30)) { /*negative condition*/ + if (is_skipped == false) { + if (check_positive(p_dm, pre_v1, pre_v2, v1, v2)) { + is_matched = true; + is_skipped = true; + } else { + is_matched = false; + is_skipped = false; + } + } else + is_matched = false; + } + } else { + if (is_matched) + odm_config_bb_agc_8723d(p_dm, v1, MASKDWORD, v2); + } + i = i + 2; + } +} + +u32 +odm_get_version_mp_8723d_agc_tab(void) +{ + return 36; +} + +/****************************************************************************** +* phy_reg.TXT +******************************************************************************/ + +u32 array_mp_8723d_phy_reg[] = { + 0x800, 0x80046C00, + 0x804, 0x00000003, + 0x808, 0x0000FC00, + 0x80C, 0x0000000A, + 0x810, 0x10001331, + 0x814, 0x020C3D10, + 0x818, 0x00200385, + 0x81C, 0x00000000, + 0x820, 0x01000100, + 0x824, 0x00390204, + 0x828, 0x00000000, + 0x82C, 0x00000000, + 0x830, 0x00000000, + 0x834, 0x00000000, + 0x838, 0x00000000, + 0x83C, 0x00000000, + 0x840, 0x00010000, + 0x844, 0x00000000, + 0x848, 0x00000000, + 0x84C, 0x00000000, + 0x850, 0x00000000, + 0x854, 0x00000000, + 0x858, 0x569A11A9, + 0x85C, 0x01000014, + 0x860, 0x66F60110, + 0x864, 0x461F0641, + 0x868, 0x00000000, + 0x86C, 0x27272700, + 0x870, 0x07000460, + 0x874, 0x25004000, + 0x878, 0x00000808, + 0x87C, 0x004F0201, + 0x880, 0xB2002E12, + 0x884, 0x00000007, + 0x888, 0x00000000, + 0x88C, 0xCCC000C0, + 0x890, 0x00000800, + 0x894, 0xFFFFFFFE, + 0x898, 0x40302010, + 0x89C, 0x00706050, + 0x900, 0x00000000, + 0x904, 0x00000023, + 0x908, 0x00000000, + 0x90C, 0x81121111, + 0x910, 0x00000402, + 0x914, 0x00000300, + 0x920, 0x18C6318C, + 0x924, 0x0000018C, + 0x948, 0x99000000, + 0x94C, 0x00000010, + 0x950, 0x00003800, + 0x954, 0x5A380000, + 0x958, 0x4BC6D87A, + 0x95C, 0x04EB9B79, + 0x96C, 0x00000003, + 0x970, 0x00000000, + 0x974, 0x00000000, + 0x978, 0x00000000, + 0x97C, 0x13000000, + 0x980, 0x00000000, + 0xA00, 0x00D046C8, + 0xA04, 0x80FF800C, + 0xA08, 0x8C838300, + 0xA0C, 0x2E20100F, + 0xA10, 0x9500BB78, + 0xA14, 0x1114D028, + 0xA18, 0x00881117, + 0xA1C, 0x89140F00, + 0xA20, 0xE82C0001, + 0xA24, 0x64B80C1C, + 0xA28, 0x00008810, + 0xA2C, 0x00D30000, + 0xA70, 0x101FBF00, + 0xA74, 0x00000007, + 0xA78, 0x00008900, + 0xA7C, 0x225B0606, + 0xA80, 0x2180FA74, + 0xA84, 0x00200000, + 0xA88, 0x040C0000, + 0xA8C, 0x12345678, + 0xA90, 0xABCDEF00, + 0xA94, 0x001B1B89, + 0xA98, 0x00000000, + 0xA9C, 0x00020000, + 0xAA0, 0x00000000, + 0xAA4, 0x0000000C, + 0xAA8, 0xCA100008, + 0xAAC, 0x01235667, + 0xAB0, 0x00000000, + 0xAB4, 0x20201402, + 0xB2C, 0x00000000, + 0xC00, 0x48071D40, + 0xC04, 0x03A05611, + 0xC08, 0x000000E4, + 0xC0C, 0x6C6C6C6C, + 0xC10, 0x28800000, + 0xC14, 0x40000100, + 0xC18, 0x08800000, + 0xC1C, 0x40000100, + 0xC20, 0x00000000, + 0xC24, 0x00000000, + 0xC28, 0x00000000, + 0xC2C, 0x00000000, + 0xC30, 0x69E9AC48, + 0xC34, 0x31000040, + 0xC38, 0x21688080, + 0xC3C, 0x000016D4, + 0xC40, 0x1F78403F, + 0xC44, 0x00010036, + 0xC48, 0xEC020107, + 0xC4C, 0x007F037F, + 0xC50, 0x69553420, + 0xC54, 0x43BC0094, + 0xC58, 0x00015969, + 0xC5C, 0x00310492, + 0xC60, 0x00280A00, + 0xC64, 0x7112848B, + 0xC68, 0x47C074FF, + 0xC6C, 0x00000036, + 0xC70, 0x2C7F000D, + 0xC74, 0x020600DB, + 0xC78, 0x0000001F, + 0xC7C, 0x00B91612, + 0xC80, 0x390000E4, + 0xC84, 0x21F60000, + 0xC88, 0x40000100, + 0xC8C, 0x20200000, + 0xC90, 0x00091521, + 0xC94, 0x00000000, + 0xC98, 0x00121820, + 0xC9C, 0x00007F7F, + 0xCA0, 0x00012000, + 0xCA4, 0x800000A0, + 0xCA8, 0x84E6C606, + 0xCAC, 0x00000060, + 0xCB0, 0x00000000, + 0xCB4, 0x00000000, + 0xCB8, 0x00000000, + 0xCBC, 0x28000000, + 0xCC0, 0x0010A3D0, + 0xCC4, 0x00000F7D, + 0xCC8, 0x000442D6, + 0xCCC, 0x00000000, + 0xCD0, 0x000001C8, + 0xCD4, 0x001C8000, + 0xCD8, 0x00000100, + 0xCDC, 0x40100000, + 0xCE0, 0x00222220, + 0xCE4, 0x20000000, + 0xCE8, 0x37644302, + 0xCEC, 0x2F97D40C, + 0xD00, 0x00030740, + 0xD04, 0x40020401, + 0xD08, 0x0000907F, + 0xD0C, 0x20010201, + 0xD10, 0xA0633333, + 0xD14, 0x3333BC53, + 0xD18, 0x7A8F5B6F, + 0xD2C, 0xCC979975, + 0xD30, 0x00000000, + 0xD34, 0x40608000, + 0xD38, 0x88000000, + 0xD3C, 0xC0127343, + 0xD40, 0x00000000, + 0xD44, 0x00000000, + 0xD48, 0x00000000, + 0xD4C, 0x00000000, + 0xD50, 0x00000038, + 0xD54, 0x00000000, + 0xD58, 0x00000282, + 0xD5C, 0x30032064, + 0xD60, 0x4653DE68, + 0xD64, 0x04518A3C, + 0xD68, 0x00002101, + 0xE00, 0x2D2D2D2D, + 0xE04, 0x2D2D2D2D, + 0xE08, 0x0390272D, + 0xE10, 0x2D2D2D2D, + 0xE14, 0x2D2D2D2D, + 0xE18, 0x2D2D2D2D, + 0xE1C, 0x2D2D2D2D, + 0xE28, 0x00000000, + 0xE30, 0x1000DC1F, + 0xE34, 0x10008C1F, + 0xE38, 0x02140102, + 0xE3C, 0x681604C2, + 0xE40, 0x01007C00, + 0xE44, 0x01004800, + 0xE48, 0xFB000000, + 0xE4C, 0x000028D1, + 0xE50, 0x1000DC1F, + 0xE54, 0x10008C1F, + 0xE58, 0x02140102, + 0xE5C, 0x28160D05, + 0xE60, 0x00000008, + 0xE68, 0x001B25A4, + 0xE6C, 0x01C00014, + 0xE70, 0x01C00016, + 0xE74, 0x02000014, + 0xE78, 0x02000014, + 0xE7C, 0x02000014, + 0xE80, 0x02000014, + 0xE84, 0x01C00014, + 0xE88, 0x02000014, + 0xE8C, 0x01C00014, + 0xED0, 0x01C00014, + 0xED4, 0x01C00014, + 0xED8, 0x01C00014, + 0xEDC, 0x00000014, + 0xEE0, 0x00000014, + 0xEE8, 0x21555448, + 0xEEC, 0x03C00014, + 0xF14, 0x00000003, + 0xF00, 0x00100300, + 0xF08, 0x0000800B, + 0xF0C, 0x0000F007, + 0xF10, 0x0000A487, + 0xF1C, 0x80000064, + 0xF38, 0x00030155, + 0xF3C, 0x0000003A, + 0xF4C, 0x13000000, + 0xF50, 0x00000000, + 0xF18, 0x00000000, + +}; + +void +odm_read_and_config_mp_8723d_phy_reg( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8723d_phy_reg)/sizeof(u32); + u32 *array = array_mp_8723d_phy_reg; + + u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_read_and_config_mp_8723d_phy_reg\n")); + + while ((i + 1) < array_len) { + v1 = array[i]; + v2 = array[i + 1]; + + if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ + if (v1 & BIT(31)) {/* positive condition*/ + c_cond = (u8)((v1 & (BIT(29)|BIT(28))) >> 28); + if (c_cond == COND_ENDIF) {/*end*/ + is_matched = true; + is_skipped = false; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ENDIF\n")); + } else if (c_cond == COND_ELSE) { /*else*/ + is_matched = is_skipped?false:true; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ELSE\n")); + } else {/*if , else if*/ + pre_v1 = v1; + pre_v2 = v2; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("IF or ELSE IF\n")); + } + } else if (v1 & BIT(30)) { /*negative condition*/ + if (is_skipped == false) { + if (check_positive(p_dm, pre_v1, pre_v2, v1, v2)) { + is_matched = true; + is_skipped = true; + } else { + is_matched = false; + is_skipped = false; + } + } else + is_matched = false; + } + } else { + if (is_matched) + odm_config_bb_phy_8723d(p_dm, v1, MASKDWORD, v2); + } + i = i + 2; + } +} + +u32 +odm_get_version_mp_8723d_phy_reg(void) +{ + return 36; +} + +/****************************************************************************** +* phy_reg_pg.TXT +******************************************************************************/ + +u32 array_mp_8723d_phy_reg_pg[] = { + 0, 0, 0, 0x00000e08, 0x0000ff00, 0x00003200, + 0, 0, 0, 0x0000086c, 0xffffff00, 0x32323200, + 0, 0, 0, 0x00000e00, 0xffffffff, 0x32343434, + 0, 0, 0, 0x00000e04, 0xffffffff, 0x28303032, + 0, 0, 0, 0x00000e10, 0xffffffff, 0x30323234, + 0, 0, 0, 0x00000e14, 0xffffffff, 0x26282830 +}; + +void +odm_read_and_config_mp_8723d_phy_reg_pg( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 i = 0; + u32 array_len = sizeof(array_mp_8723d_phy_reg_pg)/sizeof(u32); + u32 *array = array_mp_8723d_phy_reg_pg; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + PlatformZeroMemory(p_hal_data->BufOfLinesPwrByRate, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); + p_hal_data->nLinesReadPwrByRate = array_len/6; +#endif + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_read_and_config_mp_8723d_phy_reg_pg\n")); + + p_dm->phy_reg_pg_version = 1; + p_dm->phy_reg_pg_value_type = PHY_REG_PG_EXACT_VALUE; + + for (i = 0; i < array_len; i += 6) { + u32 v1 = array[i]; + u32 v2 = array[i+1]; + u32 v3 = array[i+2]; + u32 v4 = array[i+3]; + u32 v5 = array[i+4]; + u32 v6 = array[i+5]; + + odm_config_bb_phy_reg_pg_8723d(p_dm, v1, v2, v3, v4, v5, v6); + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + rsprintf((char *)p_hal_data->BufOfLinesPwrByRate[i/6], 100, "%s, %s, %s, 0x%X, 0x%08X, 0x%08X,", + (v1 == 0?"2.4G":" 5G"), (v2 == 0?"A":"B"), (v3 == 0?"1Tx":"2Tx"), v4, v5, v6); +#endif + } +} + + + +#endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.h index b0cfd3cfb82e..44aea06f7c0c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_bb.h @@ -1,59 +1,54 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.26*/ -#if (RTL8723D_SUPPORT == 1) -#ifndef __INC_MP_BB_HW_IMG_8723D_H -#define __INC_MP_BB_HW_IMG_8723D_H - - -/****************************************************************************** -* AGC_TAB.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_AGC_TAB(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_AGC_TAB(void); - -/****************************************************************************** -* PHY_REG.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_PHY_REG(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_PHY_REG(void); - -/****************************************************************************** -* PHY_REG_PG.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_PHY_REG_PG(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_PHY_REG_PG(void); - -#endif -#endif /* end of HWIMG_SUPPORT*/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +/*Image2HeaderVersion: 3.5.2*/ +#if (RTL8723D_SUPPORT == 1) +#ifndef __INC_MP_BB_HW_IMG_8723D_H +#define __INC_MP_BB_HW_IMG_8723D_H + + +/****************************************************************************** +* agc_tab.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_agc_tab(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_agc_tab(void); + +/****************************************************************************** +* phy_reg.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_phy_reg(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_phy_reg(void); + +/****************************************************************************** +* phy_reg_pg.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_phy_reg_pg(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_phy_reg_pg(void); + +#endif +#endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.c deleted file mode 100644 index 052c48b0f8a5..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.c +++ /dev/null @@ -1,4840 +0,0 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.16*/ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#ifdef LOAD_FW_HEADER_FROM_DRIVER -#include "../../rtl8723d/hal8723d_fw.h" -#endif - - -#if (RTL8723D_SUPPORT == 1) -#if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) - - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8723d_fw_ap[] = { -0xD1, 0x23, 0x20, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x17, 0xA0, 0x52, 0x02, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x02, 0x85, 0xAD, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xA5, 0x97, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xBE, 0x67, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xBA, 0x86, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xBA, 0xD6, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xBE, 0x11, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, -0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, -0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, -0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, -0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, -0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, -0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, -0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, -0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, -0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, -0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, -0x30, 0x04, 0x04, 0x04, 0x05, 0x08, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x06, 0x0B, 0x0D, -0x0E, 0x0F, 0x11, 0x12, 0x14, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, -0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, 0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0xC8, 0x00, -0xF0, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, 0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, -0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, -0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, -0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, -0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, -0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x86, 0xC0, 0x74, 0x01, 0x93, -0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -0x04, 0x90, 0x86, 0xC0, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0x02, 0x85, 0xEB, -0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, -0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, -0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, -0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x86, 0xA9, 0xE4, 0x7E, -0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, -0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, -0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, -0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, -0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, -0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, -0xFE, 0xED, 0x59, 0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, -0xFD, 0xEC, 0x48, 0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, -0x22, 0xE0, 0xFB, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, -0xE9, 0xF0, 0x22, 0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, -0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, -0x93, 0x68, 0x60, 0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x41, 0x96, 0x84, 0x00, 0x44, 0x96, 0x43, -0x41, 0x4E, 0x59, 0x00, 0x44, 0x96, 0x3F, 0x61, 0x6E, 0x79, 0x00, 0x41, 0x96, 0x86, 0x00, 0x00, -0x9B, 0xD7, 0xB6, 0x2A, 0x96, 0x8F, 0x90, 0x96, 0x81, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, 0x90, -0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x96, 0x81, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, -0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, 0xB4, -0xF1, 0x3C, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0x35, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, -0x12, 0x8F, 0xBF, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB7, 0x12, 0xA1, 0x04, 0xFF, 0xED, 0x2F, 0x90, -0x86, 0xB8, 0xF1, 0x2D, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB9, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, -0x1F, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, -0x05, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x01, -0x02, 0x02, 0x1F, 0x12, 0x02, 0x06, 0x90, 0x93, 0x25, 0xF1, 0x3C, 0x90, 0x93, 0x26, 0xF1, 0x35, -0x90, 0x93, 0x27, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x80, 0xFE, 0x90, 0x93, 0x56, 0xE0, -0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xEE, 0x54, 0xBF, 0x4F, 0xFF, 0xF0, 0x12, -0x02, 0x06, 0xFE, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, 0xFF, 0x90, 0x93, 0x56, 0xF0, 0xEE, -0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, 0x0F, 0xFE, 0xEF, -0x54, 0xF0, 0x4E, 0x90, 0x93, 0x56, 0xF1, 0x3C, 0xFF, 0x54, 0x7F, 0x90, 0x93, 0x58, 0xF0, 0xEF, -0x12, 0x8F, 0xC8, 0xFF, 0x90, 0x93, 0x57, 0xE0, 0x54, 0xFE, 0xF1, 0x34, 0x90, 0x93, 0x59, 0x12, -0x8F, 0xBF, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x93, 0x57, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x12, -0xBB, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0x7A, 0xED, 0xF0, 0x90, 0x96, 0x79, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x44, 0x7F, 0x47, 0x12, -0x88, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x12, 0x7B, 0x2E, -0x7F, 0x46, 0x12, 0x88, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x11, -0x81, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, -0x7F, 0x45, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, -0x4A, 0x90, 0x96, 0x79, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x11, 0x73, 0x80, 0x02, 0xC3, 0x33, -0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, 0x11, 0x73, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x11, 0x81, 0x60, 0x10, 0x7F, 0x61, 0x11, 0x73, -0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0F, 0x7F, 0x61, 0x11, 0x73, -0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x79, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, -0x22, 0x12, 0x7B, 0x2E, 0x90, 0x96, 0x7A, 0xE0, 0x22, 0x90, 0x93, 0x30, 0xE0, 0x20, 0xE0, 0x02, -0x21, 0x55, 0xE4, 0x90, 0x94, 0xA2, 0xF0, 0x90, 0x94, 0xA2, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x40, -0x02, 0x21, 0x55, 0x12, 0xB3, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0x90, 0x93, 0x31, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x21, 0x4D, 0x12, 0x02, 0x06, 0xFF, 0x30, -0xE0, 0x1A, 0x90, 0x93, 0x32, 0xE0, 0xFE, 0x90, 0x94, 0xA2, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, -0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x32, 0xF0, 0xEF, 0xC3, 0x13, 0x30, -0xE0, 0x15, 0x90, 0x93, 0x33, 0xE0, 0xFF, 0x90, 0x94, 0xA2, 0x11, 0x79, 0x80, 0x02, 0xC3, 0x33, -0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x33, 0xF0, 0x12, 0x87, 0x3D, 0xFF, 0x90, 0x94, 0xA2, 0xE0, 0xFE, -0x24, 0x34, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0x35, 0xFF, 0x74, 0x39, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF1, 0xBF, 0xFF, 0x74, 0x3E, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0xA1, 0x04, 0xFF, 0x74, 0x43, 0x2E, 0xF5, 0x82, -0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x31, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, -0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x31, 0xF0, 0x22, 0x90, 0x94, 0xA2, -0xE0, 0x04, 0xF0, 0x01, 0x97, 0x22, 0x90, 0x94, 0x9F, 0x12, 0x86, 0x7A, 0x90, 0x94, 0x9E, 0xEF, -0xF0, 0x12, 0x86, 0x83, 0x89, 0xDA, 0x00, 0x89, 0xDF, 0x01, 0x89, 0xE3, 0x08, 0x89, 0xE8, 0x09, -0x89, 0xED, 0x0A, 0x89, 0xF2, 0x12, 0x89, 0xF7, 0x13, 0x89, 0xFC, 0x14, 0x8A, 0x01, 0x20, 0x8A, -0x06, 0x25, 0x8A, 0x0B, 0x26, 0x8A, 0x10, 0x29, 0x8A, 0x15, 0x2A, 0x8A, 0x19, 0x40, 0x8A, 0x20, -0x42, 0x8A, 0x2B, 0x43, 0x8A, 0x30, 0x44, 0x8A, 0xA2, 0x47, 0x8A, 0xA2, 0x49, 0x8A, 0x35, 0x60, -0x8A, 0x39, 0x61, 0x8A, 0x3E, 0x62, 0x8A, 0x43, 0x63, 0x8A, 0x48, 0x64, 0x8A, 0x4D, 0x65, 0x8A, -0x52, 0x66, 0x8A, 0x57, 0x67, 0x8A, 0x5C, 0x68, 0x8A, 0x61, 0x69, 0x8A, 0x66, 0x6B, 0x8A, 0x6B, -0x6C, 0x8A, 0x70, 0x6D, 0x8A, 0x75, 0x6E, 0x8A, 0x7A, 0x6F, 0x8A, 0x7F, 0x70, 0x8A, 0x84, 0xC2, -0x8A, 0x89, 0xC3, 0x8A, 0x8E, 0xC4, 0x00, 0x00, 0x8A, 0x93, 0x51, 0xA3, 0x02, 0x86, 0xE0, 0x51, -0xA3, 0x41, 0xA9, 0x51, 0xA3, 0x02, 0x90, 0x02, 0x51, 0xA3, 0x02, 0x97, 0xFB, 0x51, 0xA3, 0x02, -0x98, 0x16, 0x51, 0xA3, 0x02, 0x98, 0x25, 0x51, 0xA3, 0x02, 0x87, 0x55, 0x51, 0xA3, 0x02, 0x9F, -0xF3, 0x51, 0xA3, 0x02, 0xA0, 0x02, 0x51, 0xA3, 0x02, 0xAF, 0xF1, 0x51, 0xA3, 0x02, 0xB7, 0xEF, -0x51, 0xA3, 0x02, 0xB8, 0xEF, 0x51, 0xA3, 0x01, 0x89, 0x51, 0xA3, 0x90, 0x8A, 0xA5, 0x80, 0x05, -0x51, 0xA3, 0x90, 0x8A, 0xB5, 0x12, 0x9F, 0xE9, 0x02, 0x04, 0x7E, 0x51, 0xA3, 0x02, 0x25, 0xEC, -0x51, 0xA3, 0x02, 0x5B, 0xF3, 0x51, 0xA3, 0x61, 0x74, 0x51, 0xA3, 0x02, 0x77, 0x4F, 0x51, 0xA3, -0x02, 0x7C, 0x60, 0x51, 0xA3, 0x02, 0x7A, 0xC6, 0x51, 0xA3, 0x02, 0x5D, 0x36, 0x51, 0xA3, 0x02, -0x7B, 0xE9, 0x51, 0xA3, 0x02, 0x70, 0x33, 0x51, 0xA3, 0x02, 0x48, 0xC9, 0x51, 0xA3, 0x02, 0x79, -0xF3, 0x51, 0xA3, 0x02, 0x3F, 0xD4, 0x51, 0xA3, 0x02, 0x51, 0x7B, 0x51, 0xA3, 0x02, 0x79, 0x30, -0x51, 0xA3, 0x02, 0x57, 0xF2, 0x51, 0xA3, 0x02, 0x74, 0x8D, 0x51, 0xA3, 0x02, 0x78, 0x9A, 0x51, -0xA3, 0x02, 0x5E, 0x0B, 0x51, 0xA3, 0x02, 0xB9, 0x05, 0x51, 0xA3, 0x02, 0xB9, 0x0D, 0x51, 0xA3, -0x02, 0x87, 0x43, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x90, 0x01, -0xC2, 0xF0, 0x22, 0x90, 0x94, 0x9F, 0x02, 0x86, 0x71, 0xF1, 0xF5, 0x90, 0x93, 0x4B, 0xE0, 0x70, -0x12, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, 0x93, 0x51, -0x74, 0x01, 0xF0, 0x90, 0x93, 0x4D, 0xE0, 0x70, 0x12, 0x71, 0x6E, 0x12, 0x02, 0x06, 0xC4, 0x54, -0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, 0x52, 0x74, 0x01, 0xF0, 0x71, 0x6E, 0x12, 0x87, 0x3D, -0xFF, 0x90, 0x94, 0xA6, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0B, 0x71, 0x6E, 0x12, -0x87, 0x36, 0x90, 0x94, 0xA7, 0xF0, 0x80, 0x05, 0x90, 0x94, 0xA7, 0xEF, 0xF0, 0x90, 0x94, 0xA6, -0xE0, 0x90, 0x94, 0xA5, 0xF0, 0x90, 0x94, 0xA7, 0xE0, 0xFE, 0x90, 0x94, 0xA5, 0xE0, 0xFF, 0xD3, -0x9E, 0x50, 0x38, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x94, -0xA5, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x94, 0xA5, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0xAF, -0xD0, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xAF, 0xCC, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x08, 0x90, 0x94, -0xA5, 0xE0, 0xFF, 0x12, 0xAF, 0xD0, 0x12, 0xAE, 0x7E, 0x80, 0xBA, 0x90, 0x05, 0x5E, 0xE4, 0xF0, -0x90, 0x94, 0xA6, 0xE0, 0x70, 0x17, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x10, 0xB1, 0xD7, 0x90, -0x8A, 0xED, 0xB1, 0xDA, 0x12, 0xBD, 0x69, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x94, -0xA2, 0x02, 0x86, 0x71, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0xF5, 0x71, 0x6E, 0x12, -0x98, 0x0A, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x71, 0x6E, 0x12, 0x02, 0x06, 0x20, 0xE0, -0x02, 0xA1, 0x05, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, -0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, 0x87, 0x3D, 0x90, -0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0x12, 0x87, 0x35, 0x90, 0x88, 0x9F, 0xF0, 0x80, -0x4B, 0x12, 0x87, 0x3D, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, -0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, 0x3D, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, -0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, 0x36, 0xFF, 0xC3, -0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, 0xF0, -0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0x97, 0xDD, 0x30, -0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, 0xE0, 0xC3, -0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, 0xF0, 0x90, -0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, 0x13, 0x90, -0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, 0x05, 0xE4, -0x90, 0x88, 0xDD, 0xF0, 0x71, 0x6E, 0xF1, 0xC0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x37, -0x90, 0x88, 0x9D, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0xE0, 0xF1, 0xCA, 0x30, 0xE0, 0x28, 0x12, -0xD2, 0x7C, 0x30, 0xE0, 0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, 0xDF, -0xE0, 0x60, 0x05, 0x75, 0x61, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x8A, 0xF3, 0xB1, 0xC8, -0x7D, 0x02, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, -0xC8, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0xD2, 0x95, 0x74, 0x11, 0xF0, 0x90, 0x05, -0x58, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, -0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, -0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, -0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, -0x88, 0xA5, 0xF0, 0x80, 0x65, 0x71, 0x6E, 0xF1, 0xC0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -0x05, 0x75, 0x62, 0x02, 0x80, 0x0E, 0x12, 0xD2, 0x7C, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x01, 0x80, -0x03, 0xE4, 0xF5, 0x62, 0x90, 0x8A, 0xF1, 0xB1, 0xDA, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, -0x7D, 0xAC, 0x80, 0x02, 0x7D, 0x2C, 0x7F, 0x40, 0x12, 0x7B, 0x2E, 0x71, 0x6E, 0xF1, 0xC0, 0x13, -0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, -0x90, 0x8A, 0xF3, 0xB1, 0xC8, 0xAD, 0x62, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, -0xC8, 0x12, 0x9F, 0x30, 0x12, 0xD2, 0x95, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, -0xF0, 0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xF1, 0xCA, 0x30, 0xE0, 0x09, 0x90, -0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0xB1, 0xC8, 0x7F, 0x01, 0x12, -0x04, 0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0xB1, 0xC8, 0x7F, 0x03, -0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, -0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, -0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, -0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x86, 0x0C, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, -0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x85, 0xED, 0xF0, -0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xE1, 0x55, 0xEE, -0xF1, 0xCA, 0x30, 0xE0, 0x02, 0xE1, 0x55, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xE1, -0x55, 0xEF, 0x70, 0x02, 0xC1, 0xB1, 0x24, 0xFE, 0x70, 0x02, 0xC1, 0xF6, 0x24, 0xFE, 0x60, 0x4F, -0x24, 0xFC, 0x70, 0x02, 0xE1, 0x3B, 0x24, 0xFC, 0x60, 0x02, 0xE1, 0x4B, 0xEE, 0xB4, 0x0E, 0x03, -0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, -0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, -0x96, 0x85, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, 0xED, 0xB1, 0xDA, -0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0xE1, 0x4B, 0x12, 0x7B, 0xCC, 0xE1, 0x4B, 0x90, -0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, -0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, -0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xE1, 0x4B, -0x90, 0x86, 0x00, 0xB1, 0xDA, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x4B, 0x12, 0x68, 0xC2, 0xE1, -0x4B, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, 0x03, -0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, -0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x64, 0x90, 0x86, 0x02, 0xB1, 0xDA, 0xEF, 0x64, 0x01, 0x70, -0x5A, 0x12, 0x73, 0x5A, 0x80, 0x55, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, -0xB1, 0xDA, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, -0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0xDA, 0xBF, 0x01, -0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, 0x39, 0xE0, 0xB4, -0x0C, 0x09, 0x12, 0xCD, 0x4B, 0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xD2, -0x4E, 0x90, 0x01, 0xBB, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, -0x5D, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x1D, 0x12, 0xD2, 0x58, 0x12, 0xA2, 0x78, 0x90, 0x8A, 0xF9, -0xB1, 0xC8, 0xB1, 0xD1, 0x12, 0xB8, 0xB6, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0xF1, -0xFB, 0x02, 0xB8, 0xBD, 0x90, 0x93, 0x29, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x30, 0xE4, 0x90, -0x92, 0x20, 0xF0, 0x90, 0x93, 0x2C, 0x12, 0xA2, 0x78, 0x90, 0x93, 0x29, 0xE0, 0x54, 0xEF, 0xF0, -0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0x7D, 0x04, 0x7F, 0x01, 0x02, -0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, 0xC8, 0x7D, 0x31, 0x12, 0xCD, 0x42, 0xB1, 0xDA, 0x22, 0xF0, -0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0xF0, 0xEE, 0x54, 0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, -0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x1C, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x8A, 0xF9, -0xB1, 0xC8, 0xB1, 0xD1, 0x12, 0xB8, 0xB6, 0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0xB1, 0xC8, 0xF1, -0xFB, 0x12, 0xB8, 0xBD, 0x22, 0x90, 0x94, 0xA2, 0x02, 0x86, 0x7A, 0x7D, 0x0C, 0x7F, 0x01, 0x02, -0x04, 0x7E, 0x12, 0x8F, 0xF5, 0x12, 0x02, 0x06, 0x30, 0xE0, 0x14, 0x12, 0xB5, 0xE0, 0x90, 0x86, -0xB3, 0xE0, 0x64, 0x01, 0x70, 0x27, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x1E, 0x90, -0x93, 0x25, 0xE0, 0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, 0x90, 0x01, 0x3C, 0xE0, -0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, 0xE4, 0xF0, 0x11, 0xB2, 0x12, 0x8B, 0x6E, -0x12, 0x87, 0x3D, 0x90, 0x93, 0x04, 0x12, 0x87, 0x35, 0x90, 0x93, 0x05, 0xF0, 0x90, 0x93, 0x04, -0xE0, 0x54, 0x01, 0x90, 0x93, 0x11, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x02, 0x90, 0x93, 0x12, -0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x04, 0x90, 0x93, 0x13, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, -0x08, 0x90, 0x93, 0x14, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x15, 0xF0, 0x90, -0x93, 0x05, 0xE0, 0x54, 0x01, 0x90, 0x93, 0x16, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x02, 0x90, -0x93, 0x17, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x04, 0x90, 0x93, 0x18, 0xF0, 0x90, 0x93, 0x05, -0xE0, 0x54, 0x08, 0x90, 0x93, 0x19, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x1A, -0xF0, 0x22, 0xC2, 0xAF, 0xF1, 0xF3, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0xE4, 0x90, 0x93, -0x0F, 0xF0, 0xA3, 0xF0, 0xD2, 0xAF, 0x22, 0x90, 0x93, 0x20, 0xE0, 0x90, 0x95, 0x86, 0xF0, 0x90, -0x93, 0x21, 0xE0, 0x90, 0x95, 0x87, 0xF0, 0x90, 0x93, 0x22, 0xE0, 0x90, 0x95, 0x88, 0xF0, 0x90, -0x93, 0x23, 0xE0, 0x90, 0x95, 0x89, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x90, 0x95, 0x8A, 0xF0, 0x90, -0x93, 0x11, 0xE0, 0x90, 0x95, 0x8B, 0xF0, 0x90, 0x93, 0x12, 0xE0, 0x90, 0x95, 0x8C, 0xF0, 0x90, -0x93, 0x13, 0xE0, 0x90, 0x95, 0x8D, 0xF0, 0x90, 0x93, 0x14, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, -0x93, 0x15, 0xE0, 0x90, 0x95, 0x8F, 0xF0, 0x90, 0x93, 0x16, 0xE0, 0x90, 0x95, 0x90, 0xF0, 0x90, -0x93, 0x17, 0xE0, 0x90, 0x95, 0x91, 0xF0, 0x90, 0x93, 0x18, 0xE0, 0x90, 0x95, 0x92, 0xF0, 0x90, -0x93, 0x19, 0xE0, 0x90, 0x95, 0x93, 0xF0, 0x90, 0x93, 0x1A, 0xE0, 0x90, 0x95, 0x94, 0xF0, 0xF1, -0xCB, 0xD1, 0x51, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x50, 0x09, 0xD1, 0x0F, 0x74, 0x01, 0xF0, -0xB1, 0xCA, 0x80, 0xF3, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x12, 0xB6, 0x17, 0x90, -0x95, 0x23, 0xF0, 0xA3, 0xF1, 0xAA, 0xB1, 0xD1, 0x50, 0x4C, 0xB1, 0xF9, 0x90, 0x95, 0x2E, 0xE0, -0xFE, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x31, 0xE0, 0x24, 0x4D, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x30, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x31, -0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xEE, 0x12, 0xD2, 0x36, 0x12, 0x86, -0x7A, 0xD1, 0x35, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0x12, 0xD2, 0x28, 0x12, -0x86, 0x7A, 0xB1, 0xCA, 0x80, 0xB0, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x02, 0xA1, 0x96, 0x90, 0x93, -0x03, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0x96, 0xE4, 0x90, 0x95, 0x9F, 0xD1, 0x51, 0x90, 0x95, 0x23, -0xE0, 0xFF, 0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x25, 0xE0, 0xFC, 0xA3, -0xE0, 0xFD, 0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, -0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x95, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, -0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, -0x90, 0x95, 0x2A, 0xF0, 0xFC, 0x74, 0x07, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -0x54, 0xC0, 0x90, 0x95, 0x2C, 0xF0, 0xEC, 0x24, 0x18, 0x90, 0x95, 0x29, 0xF0, 0xFD, 0x90, 0x95, -0x25, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0xEF, 0x54, 0xFC, 0x90, 0x95, -0x2B, 0xF0, 0x90, 0x95, 0x2A, 0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x95, 0x27, 0x8F, 0xF0, -0x12, 0x02, 0xE7, 0x90, 0x95, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0xCE, 0x68, 0x90, 0x95, -0x23, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -0x95, 0x23, 0x12, 0xC6, 0xDE, 0x40, 0x1B, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, -0x27, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xED, 0x9F, 0xFF, 0xEC, 0x9E, 0x90, 0x95, 0x23, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x95, 0x2B, 0xE0, 0x24, 0xC0, 0x60, 0x02, 0x81, 0x9A, 0xB1, 0xDE, 0x24, 0x18, -0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0xEF, 0x60, 0x02, 0x81, 0x8F, 0xB1, 0xDE, 0x24, 0x19, 0xFD, -0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x95, 0x44, 0xF1, 0xBA, 0x90, 0x95, 0x44, 0xE0, 0xFF, 0xD1, -0x08, 0x9F, 0x50, 0x17, 0xB1, 0xDE, 0x24, 0x1A, 0xF1, 0xB2, 0xB1, 0xBE, 0x90, 0x95, 0x2D, 0xE0, -0x24, 0x45, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x1A, 0x80, 0xDF, 0x90, 0x95, 0x44, 0xE0, 0x70, -0x02, 0x61, 0xBC, 0xE4, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x40, 0x02, 0x61, 0xA4, 0xB1, 0xF9, -0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x30, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, -0x90, 0x95, 0x44, 0xE0, 0xFD, 0xEE, 0x6D, 0x70, 0x21, 0xEF, 0x12, 0xD2, 0x36, 0x12, 0x86, 0x71, -0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0xED, 0xF0, 0xD0, 0x01, 0xD0, -0x02, 0xD0, 0x03, 0xD1, 0x5B, 0xEF, 0x60, 0x02, 0x80, 0x4D, 0x90, 0x95, 0x44, 0xE0, 0x64, 0x03, -0x70, 0x54, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x43, 0xD1, 0x5B, -0xEF, 0x70, 0x11, 0xD1, 0x25, 0x90, 0x95, 0xAA, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x3F, 0xD1, -0x5B, 0xEF, 0x60, 0x2A, 0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x90, 0xF5, 0x82, 0xE4, 0x34, 0x95, -0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0B, 0x90, 0x95, 0x2E, 0xE0, 0xFF, 0x24, 0x8B, 0xF1, 0xD4, -0x60, 0x05, 0x74, 0x9F, 0x2F, 0x80, 0x15, 0xB1, 0xEB, 0x74, 0x01, 0xF0, 0x80, 0x12, 0x90, 0x95, -0x2E, 0xE0, 0x24, 0x9F, 0x80, 0x06, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x9F, 0xB1, 0xF1, 0xE4, 0xF0, -0xB1, 0xCA, 0x41, 0xF8, 0x90, 0x95, 0x9F, 0xE0, 0x70, 0x4F, 0xA3, 0xE0, 0x70, 0x4B, 0xA3, 0xE0, -0x70, 0x47, 0xA3, 0xE0, 0x70, 0x43, 0xA3, 0xE0, 0x70, 0x3F, 0x81, 0x8F, 0xE4, 0x90, 0x95, 0x2E, -0xF0, 0xB1, 0xD1, 0x50, 0x1C, 0x74, 0x8B, 0x2E, 0xF1, 0xD4, 0x60, 0x09, 0x74, 0x9F, 0x2E, 0xB1, -0xF1, 0xE4, 0xF0, 0x80, 0x08, 0x74, 0x9F, 0x2E, 0xB1, 0xF1, 0x74, 0x01, 0xF0, 0xB1, 0xCA, 0x80, -0xE0, 0x90, 0x95, 0x9F, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, 0xA3, -0xE0, 0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, 0x81, 0x8F, 0xE4, 0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, -0x40, 0x02, 0x81, 0x8F, 0xB1, 0xF9, 0xB1, 0xEB, 0xE0, 0x70, 0x02, 0x81, 0x8B, 0x90, 0x93, 0x29, -0xE0, 0x30, 0xE0, 0x06, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x71, 0xE4, 0xFF, 0xFE, 0x90, 0x04, 0x1D, -0xE0, 0x60, 0x10, 0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x50, 0x07, 0x0F, 0xBF, 0x00, 0x01, -0x0E, 0x80, 0xEA, 0x90, 0x04, 0x1D, 0xE0, 0x70, 0x52, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x86, 0xF5, -0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x06, 0xF0, 0x7B, 0x08, -0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x95, 0x27, 0xEE, 0xF0, 0xA3, 0xF1, 0xBA, 0xD1, 0x08, 0x94, -0x06, 0x50, 0x1E, 0xB1, 0xDE, 0x24, 0x0A, 0xF1, 0xB2, 0xB1, 0xBE, 0x90, 0x95, 0x27, 0xA3, 0xE0, -0xFE, 0x90, 0x95, 0x2D, 0xE0, 0x2E, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xD1, 0x1A, 0x80, -0xDC, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x06, 0x35, 0xF0, 0xB1, 0xCA, 0x61, 0xFE, 0x12, -0xCE, 0x52, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, 0x21, 0xB6, 0x90, 0x95, 0x2C, 0xE0, 0x60, 0x02, -0xA1, 0x91, 0xB1, 0xDE, 0x24, 0x16, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x06, 0x34, 0xEF, -0xF0, 0xB1, 0xDE, 0x24, 0x17, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x06, 0x37, 0xF1, 0xAA, -0xB1, 0xD1, 0x50, 0x3C, 0xB1, 0xF9, 0xE4, 0x90, 0x95, 0x2D, 0xF0, 0xD1, 0x08, 0x94, 0x06, 0x50, -0x2B, 0xB1, 0xDE, 0x24, 0x04, 0x2D, 0xFD, 0x90, 0x8A, 0xE9, 0xB1, 0xBE, 0x90, 0x95, 0x2E, 0xE0, -0xFE, 0x12, 0xD2, 0x28, 0x12, 0x86, 0x71, 0x90, 0x95, 0x2D, 0xE0, 0xF5, 0x82, 0xD1, 0x89, 0x6F, -0x60, 0x06, 0xD1, 0x0F, 0xE4, 0xF0, 0x80, 0x04, 0xD1, 0x1E, 0x80, 0xCF, 0xB1, 0xCA, 0x80, 0xC0, -0x90, 0x95, 0x9A, 0xE0, 0x64, 0x01, 0x60, 0x17, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x11, 0xA3, 0xE0, -0x64, 0x01, 0x60, 0x0B, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x05, 0xA3, 0xE0, 0xB4, 0x01, 0x06, 0x90, -0x95, 0x2F, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x64, 0x01, 0x70, 0x4F, 0x11, 0xB2, 0x12, -0xBD, 0x71, 0x12, 0xBB, 0x83, 0x90, 0x93, 0x25, 0xE0, 0x70, 0x02, 0x21, 0xB6, 0x90, 0x01, 0x3C, -0xE0, 0x30, 0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x7C, 0x05, 0x90, 0x93, -0x26, 0xE0, 0x60, 0x08, 0xF5, 0x4D, 0xE4, 0xF5, 0x4E, 0xFB, 0x80, 0x15, 0x90, 0x93, 0x27, 0xE0, -0x60, 0x08, 0xFB, 0xE4, 0xF5, 0x4D, 0xF5, 0x4E, 0x80, 0x07, 0x75, 0x4D, 0x20, 0xE4, 0xF5, 0x4E, -0xFB, 0x7D, 0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, 0x72, 0xB7, 0x21, 0xB6, 0xF1, 0xCB, 0xD1, 0x51, -0x90, 0x95, 0x2E, 0xF0, 0xB1, 0xD1, 0x50, 0x09, 0xD1, 0x0F, 0x74, 0x01, 0xF0, 0xB1, 0xCA, 0x80, -0xF3, 0x12, 0xCE, 0x52, 0x21, 0xB6, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x96, 0x65, 0xE0, -0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, 0x66, 0xEE, -0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0x64, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, -0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x2E, 0xE0, 0x04, 0xF0, -0x22, 0x90, 0x93, 0x0E, 0xE0, 0xFF, 0x90, 0x95, 0x2E, 0xE0, 0xFE, 0xC3, 0x9F, 0x22, 0x90, 0x95, -0x25, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x29, 0xE0, 0x22, 0x90, 0x95, 0x2E, 0xE0, 0x24, -0x9F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0x74, 0x86, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x02, 0x7B, 0x07, 0x90, 0x95, 0x2D, 0xE0, 0xFD, 0xC3, 0x22, 0x74, -0x9A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, -0x2D, 0xE0, 0x04, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x45, 0x90, 0x95, 0xA7, 0x02, 0x86, -0x7A, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0x95, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, -0x90, 0x96, 0x17, 0xE0, 0xFF, 0x90, 0x95, 0x35, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, -0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x95, 0xA4, 0x12, 0x86, -0x7A, 0xE4, 0xFF, 0x90, 0x95, 0xAA, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, 0x95, 0xA7, -0xD1, 0x84, 0xFE, 0x90, 0x95, 0xA4, 0xD1, 0x84, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0x80, -0xE2, 0x7F, 0x01, 0x22, 0x12, 0x86, 0x71, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, 0x1F, 0xE4, -0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, 0x95, 0x22, 0xEF, 0xF0, 0x60, 0xF0, 0x90, -0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0F, -0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x35, 0xBE, 0x12, 0xC0, 0x91, 0xD1, -0xFE, 0x30, 0xE1, 0x09, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x12, 0x8D, 0xDA, 0xD1, 0xFE, 0x30, -0xE2, 0x09, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x12, 0x8D, 0xDA, 0xD1, 0xFE, 0xFF, 0x30, 0xE5, -0x0B, 0x54, 0xDF, 0xF0, 0x12, 0xB6, 0xF0, 0xBF, 0x01, 0x02, 0x11, 0xC7, 0xD1, 0xFE, 0x30, 0xE6, -0x09, 0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x8D, 0xDA, 0xD2, 0xAF, 0x80, 0xA1, 0xD2, 0xAF, -0xC2, 0xAF, 0x90, 0x86, 0xAF, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0x64, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, -0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x3D, -0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x68, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x26, -0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xFD, 0x12, 0x8D, 0xDA, 0xEF, 0x64, 0x01, 0x70, 0x02, -0x80, 0x05, 0xF1, 0xDD, 0x30, 0xE0, 0x06, 0xB1, 0x97, 0xF1, 0xE7, 0xF1, 0x9E, 0x90, 0x96, 0x68, -0xE0, 0x12, 0xCD, 0x09, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0xF1, 0xC2, 0x80, 0x08, 0xF1, 0xC2, 0xF1, -0x9E, 0xB1, 0x97, 0xF1, 0xE7, 0xF1, 0x9E, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x13, 0xF1, 0xDD, -0x30, 0xE0, 0x0E, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0x12, 0xCD, 0x09, 0x7D, 0x28, 0x12, 0x04, -0x7E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, -0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x2E, -0xF0, 0x22, 0xFC, 0xED, 0x2C, 0xFD, 0x90, 0x8A, 0xE9, 0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x2D, -0xF0, 0x22, 0x90, 0x96, 0x64, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0x22, 0xE4, 0x90, 0x95, 0x2F, 0xF0, -0x90, 0x95, 0x9A, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x88, 0xA1, -0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x96, 0x66, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, -0x8A, 0x9B, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, -0x6E, 0x11, 0x0A, 0x7A, 0x93, 0x79, 0x1B, 0x02, 0x69, 0xF5, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, -0x75, 0x48, 0x05, 0x7B, 0x01, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, 0x6E, 0x11, 0x0A, 0x7A, 0x93, -0x79, 0x20, 0x02, 0x69, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x28, 0xF0, 0xBF, 0x01, 0x07, -0x11, 0x38, 0xE4, 0x90, 0x93, 0x28, 0xF0, 0x22, 0x11, 0xCF, 0x71, 0xC9, 0xBF, 0x01, 0x06, 0x90, -0x94, 0xA2, 0xE0, 0xA3, 0xF0, 0x11, 0xCF, 0x71, 0xC2, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, -0x90, 0x94, 0xA4, 0xF0, 0x11, 0xCF, 0x71, 0xD0, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, -0x94, 0xA5, 0xF0, 0x11, 0xCF, 0x11, 0xD6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, 0x94, -0xA6, 0xF0, 0x11, 0xCF, 0x71, 0xBB, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xA2, 0xE0, 0x90, 0x94, 0xA7, -0xF0, 0x90, 0x94, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x94, -0xAB, 0xF0, 0x90, 0x94, 0xA7, 0xE0, 0x90, 0x94, 0xAC, 0xF0, 0x90, 0x94, 0xAD, 0x74, 0x12, 0xF0, -0x90, 0x94, 0xCF, 0x74, 0x05, 0xF0, 0x90, 0x94, 0xAF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, -0xF0, 0x90, 0x94, 0xAB, 0xE0, 0x90, 0x94, 0xB2, 0xF0, 0x90, 0x94, 0xAC, 0xE0, 0x90, 0x94, 0xB3, -0xF0, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xAD, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, -0x01, 0x7A, 0x94, 0x79, 0xA2, 0x22, 0x7F, 0xF3, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x90, 0x94, 0xA2, -0xEF, 0xF0, 0x71, 0x13, 0x71, 0xD0, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEB, -0xF0, 0x71, 0x13, 0x71, 0xC9, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEC, 0xF0, -0x71, 0x13, 0x71, 0xC2, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xED, 0xF0, 0x71, -0x13, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, -0x94, 0xEE, 0xF0, 0x71, 0x13, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -0x94, 0xE9, 0xE0, 0x90, 0x94, 0xEF, 0xF0, 0x71, 0x13, 0x71, 0xB4, 0xBF, 0x01, 0x08, 0x90, 0x94, -0xE9, 0xE0, 0x90, 0x94, 0xF0, 0xF0, 0x71, 0x13, 0x71, 0x1A, 0x70, 0x52, 0x90, 0x94, 0xE9, 0xE0, -0x90, 0x94, 0xF1, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0xE0, 0x70, 0x3E, -0x7B, 0x01, 0x7A, 0x94, 0x79, 0xEA, 0x7F, 0xFA, 0x71, 0x1C, 0x70, 0x32, 0x90, 0x94, 0xE9, 0xE0, -0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x94, 0xF1, 0xE0, 0xFE, 0x90, 0x94, 0xEA, 0xE0, 0x54, 0x07, -0xFD, 0xEE, 0x4D, 0x90, 0x94, 0xF1, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x94, 0xF1, 0xE0, -0xFF, 0x90, 0x94, 0xEA, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x94, 0xF1, 0xF0, 0x71, 0x13, -0x7F, 0xFD, 0x71, 0x1C, 0x70, 0x46, 0x90, 0x94, 0xE9, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x94, 0xF2, -0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0xC0, 0x70, 0x2D, 0xEF, -0x70, 0x11, 0x90, 0x94, 0xF2, 0xE0, 0xFF, 0x90, 0x94, 0xE9, 0xE0, 0x54, 0x03, 0xF1, 0xCF, 0x90, -0x94, 0xF2, 0xF0, 0x90, 0x94, 0xE9, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x94, 0xF2, 0xE0, -0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x71, 0x13, 0x7F, 0xF0, -0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, 0xF3, 0xF0, -0x71, 0x13, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, -0x90, 0x94, 0xF4, 0xF0, 0x71, 0x13, 0x71, 0xBB, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, -0x94, 0xF5, 0xF0, 0x71, 0x13, 0x11, 0xD6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xE9, 0xE0, 0x90, 0x94, -0xF6, 0xF0, 0x71, 0x13, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, -0xE9, 0xE0, 0x90, 0x94, 0xF7, 0xF0, 0x90, 0x94, 0xA3, 0x74, 0x19, 0xF0, 0x90, 0x94, 0xC5, 0x74, -0x08, 0xF0, 0x90, 0x94, 0xEB, 0xE0, 0x90, 0x94, 0xA5, 0xF0, 0x90, 0x94, 0xEC, 0xE0, 0x90, 0x94, -0xA6, 0xF0, 0x90, 0x94, 0xED, 0xE0, 0x90, 0x94, 0xA7, 0xF0, 0x90, 0x94, 0xEE, 0xE0, 0x90, 0x94, -0xA8, 0xF0, 0x90, 0x94, 0xEF, 0xE0, 0x90, 0x94, 0xA9, 0xF0, 0x90, 0x94, 0xF0, 0xE0, 0x90, 0x94, -0xAA, 0xF0, 0x90, 0x94, 0xF1, 0xE0, 0x90, 0x94, 0xAB, 0xF0, 0x90, 0x94, 0xF2, 0xE0, 0x90, 0x94, -0xAC, 0xF0, 0x90, 0x94, 0xC6, 0x74, 0x1A, 0xF0, 0x90, 0x94, 0xE8, 0x74, 0x05, 0xF0, 0x90, 0x94, -0xF3, 0xE0, 0x90, 0x94, 0xC8, 0xF0, 0x90, 0x94, 0xF4, 0xE0, 0x90, 0x94, 0xC9, 0xF0, 0x90, 0x94, -0xF5, 0xE0, 0x90, 0x94, 0xCA, 0xF0, 0x90, 0x94, 0xF6, 0xE0, 0x90, 0x94, 0xCB, 0xF0, 0x90, 0x94, -0xF7, 0xE0, 0x90, 0x94, 0xCC, 0xF0, 0x90, 0x94, 0xA2, 0xE0, 0xB4, 0x01, 0x1C, 0x7B, 0x01, 0x7A, -0x94, 0x79, 0xA3, 0x90, 0x8A, 0x77, 0xF1, 0xE9, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x94, 0x79, -0xC6, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, 0x75, -0x47, 0xA3, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, 0x75, 0x45, -0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0xC8, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, -0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xE9, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, -0xA6, 0xEF, 0x64, 0x01, 0x22, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, -0x4B, 0x12, 0x04, 0x80, 0x71, 0xAD, 0x71, 0xB4, 0xBF, 0x01, 0x1C, 0x90, 0x94, 0x9E, 0xE0, 0xFE, -0x54, 0x01, 0x90, 0x93, 0x4B, 0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, 0x4D, 0xF0, 0x90, 0x94, 0x9E, -0xE0, 0x54, 0x08, 0x90, 0x93, 0x4C, 0xF0, 0x71, 0xAD, 0x71, 0x1A, 0x70, 0x35, 0x90, 0x94, 0x9E, -0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x9F, 0x7F, 0xFA, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x94, 0x9F, 0x80, 0x03, 0x90, 0x94, 0x9E, 0xE0, 0x54, 0x07, -0x90, 0x93, 0x4F, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, -0x4E, 0xF0, 0x71, 0xAD, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x94, -0x9E, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0x50, 0xF0, 0x22, 0x7B, 0x01, 0x7A, -0x94, 0x79, 0x9E, 0x22, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, -0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, -0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, -0x12, 0x7B, 0x2E, 0x12, 0xB9, 0x90, 0x12, 0xC8, 0x7B, 0x12, 0x7B, 0x79, 0x12, 0xC8, 0x88, 0x12, -0xB9, 0x23, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, 0x93, 0x48, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, -0x15, 0x90, 0x93, 0x48, 0xE0, 0x04, 0xF0, 0x91, 0x4B, 0x91, 0x97, 0x90, 0x00, 0x80, 0xE0, 0x44, -0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, -0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x11, 0xDD, 0xB1, 0x63, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, -0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, 0xDF, 0x71, 0x25, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, -0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x12, 0x7B, 0x1B, 0x90, 0x86, -0xB3, 0xEF, 0xF0, 0x91, 0x65, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, -0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xB9, 0x2F, 0x12, 0xB9, -0x68, 0xE4, 0xF5, 0x21, 0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, -0x7B, 0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, -0xAD, 0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0xF1, 0x2A, 0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x12, -0x8D, 0xDA, 0xB1, 0xB4, 0xD1, 0x31, 0x91, 0xBB, 0x12, 0xCE, 0x8B, 0x90, 0x8A, 0x73, 0x12, 0x8D, -0xDA, 0x12, 0xC8, 0x5E, 0x90, 0x93, 0x49, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x54, -0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, 0xEF, 0xF0, 0x44, 0x08, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -0x64, 0x02, 0x70, 0x29, 0xB1, 0x5C, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x2F, 0xB1, 0x5A, -0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x5A, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0x90, -0x93, 0x2E, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, 0x64, 0x01, -0x70, 0x1D, 0xB1, 0x53, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2F, 0xB1, 0x51, 0x30, 0xE1, -0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x51, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x23, 0x90, -0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, 0x20, 0xB1, 0x4A, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, -0x2F, 0xB1, 0x48, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x48, 0x30, 0xE2, 0x02, -0x7F, 0x01, 0x90, 0x93, 0x2E, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, -0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, -0x7E, 0x00, 0x22, 0xE4, 0x90, 0x94, 0x9E, 0xF0, 0xA3, 0xF0, 0x12, 0xC8, 0xA8, 0xEF, 0x64, 0x01, -0x60, 0x3B, 0xC3, 0x90, 0x94, 0x9F, 0xE0, 0x94, 0x88, 0x90, 0x94, 0x9E, 0xE0, 0x94, 0x13, 0x40, -0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1D, -0x90, 0x94, 0x9E, 0xF1, 0xC0, 0xF1, 0xC8, 0xD3, 0x90, 0x94, 0x9F, 0xE0, 0x94, 0x32, 0x90, 0x94, -0x9E, 0xE0, 0x94, 0x00, 0x40, 0xC4, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBD, 0x90, 0x01, 0xC7, -0x74, 0xFE, 0xF0, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x7A, -0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, 0x12, 0x86, 0x7A, 0x7A, 0x80, 0x79, 0xBF, -0x90, 0x89, 0x34, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x7A, -0x7A, 0x81, 0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, -0x40, 0x12, 0x86, 0x7A, 0xF1, 0xD7, 0x12, 0x86, 0x7A, 0x7A, 0x81, 0x79, 0xD9, 0x90, 0x89, 0x49, -0x12, 0x86, 0x7A, 0x7A, 0x82, 0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, 0x7A, 0xE4, 0x90, 0x96, -0x17, 0xF0, 0x90, 0x94, 0x9E, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x10, -0x74, 0x28, 0x2F, 0x12, 0xC6, 0x87, 0xE4, 0xF0, 0x90, 0x94, 0x9E, 0xE0, 0x04, 0xF0, 0x80, 0xE6, -0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, -0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, -0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF1, 0x14, 0xFF, 0xF1, 0x1C, 0x12, 0xD0, -0x29, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0xF1, 0x30, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x7D, -0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x12, 0x8F, 0xFB, 0x90, -0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, -0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, 0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, -0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, -0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, -0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xF1, -0x14, 0xF1, 0x1C, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x30, 0x12, -0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, 0x8D, 0xC8, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x7E, 0x00, 0x7F, -0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, -0x54, 0x7F, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, -0x88, 0x9C, 0xF0, 0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x33, 0x33, 0x33, 0x54, -0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, -0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0xF1, 0x7C, 0x90, 0x95, 0xD0, 0xEF, 0xF0, 0x90, 0x8A, 0x89, -0x30, 0xE0, 0x13, 0x12, 0x8D, 0xC8, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, -0xE0, 0x44, 0x04, 0xF0, 0x80, 0x05, 0x12, 0x8D, 0xC8, 0xF1, 0x30, 0x90, 0x95, 0xD0, 0xE0, 0x30, -0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, -0x74, 0x80, 0xF0, 0x12, 0xCD, 0x55, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, 0x95, 0xD2, -0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x95, 0xD1, 0xEF, 0xF0, 0x7F, 0x83, 0x12, -0x7B, 0x41, 0xAE, 0x07, 0x90, 0x95, 0xD1, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x95, -0xD3, 0xE0, 0x94, 0x64, 0x90, 0x95, 0xD2, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, -0x44, 0x40, 0xF0, 0x90, 0x95, 0xD1, 0xE0, 0xFF, 0x22, 0x90, 0x95, 0xD2, 0xF1, 0xC0, 0x80, 0xC3, -0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xF0, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x25, -0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, 0x89, 0x46, 0x22, 0x90, -0x01, 0xE4, 0x74, 0x10, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, -0x8E, 0x83, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x5B, 0xE0, 0x54, 0xFE, 0x4F, -0xF0, 0x22, 0x12, 0x8F, 0xF5, 0x12, 0x8B, 0x6E, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x7F, 0x90, 0x88, -0x36, 0xF0, 0xEF, 0x12, 0x8F, 0xCA, 0xA3, 0x12, 0x87, 0x3C, 0xFD, 0x54, 0xF0, 0xC4, 0x54, 0x0F, -0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0x12, 0x8F, 0xBF, 0xFC, 0x54, 0x01, 0x25, 0xE0, -0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, -0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, -0x54, 0x0F, 0x12, 0x87, 0x34, 0x90, 0x88, 0x35, 0x31, 0x04, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x8D, -0xC8, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x8B, 0x6E, 0x12, 0x87, 0x2E, 0xFF, 0x54, 0x01, 0xFE, -0x90, 0x88, 0x9B, 0x12, 0xB8, 0xE0, 0x12, 0x87, 0x2C, 0x12, 0xB8, 0xD6, 0x90, 0x88, 0x9B, 0x12, -0xB8, 0xCD, 0x12, 0x87, 0x2B, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x90, 0x88, -0x9B, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x12, 0x87, 0x2B, 0x54, 0x40, 0xFE, 0xEF, -0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0xBD, 0x61, 0x20, 0xE0, 0x2F, 0xEF, 0xC3, 0x13, -0x20, 0xE0, 0x0B, 0x75, 0x62, 0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, -0x62, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x61, 0x80, 0x03, 0x75, 0x61, 0x01, 0x90, -0x8A, 0xF3, 0x12, 0x8D, 0xC8, 0xAD, 0x62, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x12, 0x8B, 0x6E, 0x12, -0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, -0x12, 0xBD, 0x57, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xD2, 0x4E, 0x90, 0x01, 0xBB, 0x31, 0x0B, 0x90, -0x01, 0xBE, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x88, 0x34, 0xE0, -0x54, 0x0F, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x17, 0x90, 0x88, 0x36, 0xE0, 0x60, -0x11, 0x31, 0x0C, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x31, 0x83, 0x02, 0x04, 0x7A, 0x12, -0x73, 0x8F, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB1, 0x6E, 0x90, 0x88, 0x9D, -0xE0, 0x20, 0xE0, 0x3E, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x36, 0x90, 0x8A, 0xD7, 0x12, -0x8D, 0xDA, 0x31, 0x0C, 0x60, 0x1E, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0xE4, 0xFD, 0x7F, 0x0C, -0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x90, 0x8B, 0x01, 0x31, -0x83, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, -0x51, 0x87, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x31, 0x9C, 0xF1, 0xDA, 0x7F, -0x01, 0x12, 0xD1, 0x76, 0x90, 0x8B, 0x07, 0x31, 0x83, 0x02, 0x04, 0x7A, 0xE4, 0x90, 0x95, 0xD0, -0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x34, 0x91, 0xDB, 0x70, 0x30, 0x12, 0xD2, 0x8D, 0xF0, 0x12, -0xD1, 0xF2, 0x90, 0x95, 0xD0, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, 0x1B, -0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0x51, 0x87, 0x91, -0xD3, 0x31, 0xDC, 0x51, 0x79, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0xDA, 0x22, 0xE4, 0x90, 0x92, 0x20, -0xF0, 0x90, 0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x7B, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x7A, 0x91, 0xDB, 0x70, 0x76, 0x12, 0xD1, 0xF2, 0x12, 0xD2, 0x85, 0x60, 0x22, -0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, -0x06, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, 0xF0, -0x80, 0x00, 0x75, 0x7B, 0x01, 0xE5, 0x7B, 0x60, 0x45, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, -0x90, 0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0x51, 0x87, 0x91, 0xD3, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, -0x64, 0x01, 0x70, 0x0F, 0x31, 0xDC, 0xFF, 0xA3, 0xE0, 0x2F, 0x51, 0x79, 0x31, 0xE1, 0xFF, 0xA3, -0xE0, 0x80, 0x0B, 0x31, 0xDC, 0x51, 0x8E, 0x2F, 0x51, 0x79, 0x31, 0xE1, 0x51, 0x8E, 0x2F, 0x33, -0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0xDA, 0x22, 0xF0, -0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, -0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xFF, 0xA3, -0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0xE4, 0xF5, 0x7B, 0x90, 0x06, 0xA9, 0xE0, 0xF5, -0x7B, 0x54, 0xC0, 0x70, 0x17, 0x51, 0xFE, 0x54, 0xFD, 0xF0, 0xB1, 0x6B, 0x90, 0x88, 0x39, 0xE0, -0x60, 0x4B, 0xF1, 0xD3, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, 0x7B, 0x30, 0xE6, -0x21, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0x31, -0x0B, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8D, 0xDA, 0x80, 0x07, 0x12, 0x73, 0x8F, -0x80, 0x02, 0x51, 0xFE, 0xE5, 0x7B, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0D, 0xE0, 0x44, 0x02, 0x51, -0x6F, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, -0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, -0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, 0x8D, 0xDA, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, -0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, 0x90, 0x88, 0xE6, 0xE0, 0x30, -0xE0, 0x14, 0x12, 0xB3, 0xF5, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, -0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0x97, 0xDD, 0x30, 0xE0, -0x13, 0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, -0x90, 0x88, 0xE8, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0x61, 0xEA, 0x90, 0x88, 0x4D, 0xE0, -0x04, 0xF0, 0x90, 0x05, 0x61, 0x91, 0x37, 0x12, 0xD2, 0x1A, 0x90, 0x05, 0x60, 0x91, 0x37, 0x12, -0x86, 0x58, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x91, 0x37, 0x78, -0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x91, 0x36, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, -0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, 0xCD, 0x55, 0x74, 0x05, -0xF0, 0x12, 0x6E, 0x2F, 0x12, 0xD1, 0x6E, 0x90, 0x88, 0x32, 0x31, 0xE4, 0x30, 0xE0, 0x0B, 0x90, -0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x04, 0xF1, 0xB6, 0xF1, 0xE1, 0x12, 0xC9, 0x23, 0xBF, 0x03, 0x14, -0x90, 0x93, 0x49, 0xE0, 0xB4, 0x01, 0x0D, 0x90, 0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, -0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, -0x93, 0x29, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0xD2, 0x58, 0x51, 0x78, 0x12, 0xB8, 0xBD, 0x90, 0x86, -0xB3, 0xE0, 0xB4, 0x01, 0x10, 0xF1, 0xBD, 0x20, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, -0xE0, 0x03, 0x12, 0xD1, 0xB6, 0x22, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, -0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x6E, 0x12, 0xCD, 0xB1, 0x12, 0xCD, 0xAA, 0x90, 0x07, -0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, 0x91, 0xCB, 0xE0, 0xFE, 0x74, 0x69, -0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x04, 0xE8, 0x90, -0x96, 0x6A, 0x91, 0x37, 0x12, 0xD2, 0x1A, 0x90, 0x96, 0x69, 0x91, 0x37, 0x12, 0x86, 0x58, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x6B, 0x91, 0x37, 0x78, 0x10, 0x12, 0x03, -0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x91, 0x36, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -0x01, 0xD0, 0x00, 0x12, 0x86, 0x58, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, -0xF5, 0x83, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -0xEF, 0x64, 0x01, 0x22, 0x91, 0xDB, 0x70, 0x0A, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x04, 0xF1, 0xC8, -0x51, 0x6F, 0x22, 0x90, 0x88, 0x32, 0xF1, 0xC0, 0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, -0x03, 0x30, 0xE0, 0x02, 0xF1, 0xB6, 0x90, 0x88, 0x31, 0x12, 0xCD, 0x4E, 0x30, 0xE0, 0x0B, 0xEF, -0x12, 0xD2, 0x44, 0xF0, 0x54, 0x07, 0x70, 0x4A, 0x80, 0x46, 0x90, 0x88, 0x3F, 0xE0, 0x04, 0xF0, -0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0xD0, 0x84, 0x40, 0x34, 0x91, 0xDB, 0x70, 0x32, -0x31, 0x0C, 0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x8D, 0xDA, 0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, -0x8D, 0xDA, 0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0xB1, 0x63, -0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, -0xB1, 0x6B, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, -0x90, 0x8A, 0xB9, 0x12, 0xCD, 0x0D, 0x7D, 0x01, 0x02, 0x04, 0x7E, 0x91, 0xDB, 0x70, 0x17, 0x90, -0x88, 0x36, 0xE0, 0x60, 0x11, 0xF1, 0xC8, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x12, 0xD2, 0x44, 0xF0, -0x54, 0x07, 0x70, 0x02, 0xB1, 0x6B, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x97, 0xF0, 0x74, 0xA5, 0xA3, 0xF0, 0x12, 0x64, -0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x03, 0x12, 0xBE, 0xA4, 0xE5, 0x2D, 0x30, 0xE1, 0x02, 0xF1, 0xF0, -0xE5, 0x2D, 0x30, 0xE3, 0x03, 0x12, 0xC8, 0xB4, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xC8, 0xC7, -0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, 0xC8, 0xD8, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0xD1, 0x77, 0xE5, -0x2F, 0x30, 0xE1, 0x02, 0x71, 0x06, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xBE, 0x98, 0xE5, 0x2F, -0x30, 0xE3, 0x02, 0x91, 0xE4, 0xE5, 0x2F, 0x30, 0xE4, 0x02, 0xB1, 0x7B, 0xE5, 0x2F, 0x30, 0xE5, -0x02, 0x31, 0x13, 0xE5, 0x2F, 0x30, 0xE6, 0x02, 0xD1, 0x60, 0xE5, 0x2F, 0x30, 0xE7, 0x03, 0x12, -0xC9, 0x14, 0xE5, 0x30, 0x30, 0xE0, 0x03, 0x12, 0xC9, 0x2B, 0xE5, 0x30, 0x30, 0xE4, 0x03, 0x12, -0xC9, 0x3B, 0xE5, 0x30, 0x30, 0xE5, 0x03, 0x12, 0xC9, 0x40, 0x74, 0x97, 0x04, 0x90, 0x01, 0xC4, -0xF0, 0x74, 0xA5, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x51, 0xFE, -0x54, 0x07, 0x70, 0x02, 0xB1, 0x6B, 0x22, 0x31, 0xEB, 0xE4, 0xFF, 0x12, 0xD1, 0x76, 0x90, 0x93, -0x03, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0xCE, 0xAC, 0x90, 0x8B, 0x07, 0x12, 0x8D, 0xDA, 0x02, 0x8F, -0xD1, 0x91, 0xDB, 0x60, 0x02, 0xE1, 0xB5, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xE1, 0xB5, 0x90, -0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x32, 0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x2A, 0x90, 0x88, -0x9C, 0xE0, 0x70, 0x24, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1D, 0xE0, 0x54, 0x07, 0x64, 0x07, -0x70, 0x16, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, 0x0E, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, -0x07, 0xF1, 0xD3, 0x54, 0xFE, 0x12, 0xB1, 0x76, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, -0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, -0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, 0x07, 0xF1, 0xE0, 0x90, 0x94, 0x9C, 0xF0, -0x90, 0x07, 0xF0, 0xE0, 0x90, 0x94, 0x9D, 0xF0, 0xF1, 0xC8, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, -0xEC, 0xF0, 0x12, 0xD2, 0x6A, 0x24, 0xFD, 0x50, 0x02, 0x80, 0x02, 0x51, 0x98, 0x12, 0xD2, 0x6A, -0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xAA, 0xE0, -0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, -0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, 0xCA, 0xCE, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x90, 0x88, -0x32, 0xF1, 0xC0, 0x30, 0xE0, 0x5C, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x23, 0xF1, -0xE8, 0x6F, 0x70, 0x4E, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0xD2, 0x8D, 0x12, 0xD2, -0x61, 0x7F, 0x03, 0x12, 0x7C, 0x05, 0xF1, 0xE1, 0xF1, 0xB6, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, -0x80, 0x30, 0x12, 0xD2, 0x85, 0x64, 0x01, 0x70, 0x29, 0xF1, 0xE8, 0xFE, 0x6F, 0x60, 0x23, 0x90, -0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x1A, 0x12, 0xCD, 0x4B, 0x30, 0xE0, 0x14, 0xEF, 0x54, -0xBF, 0x12, 0xD2, 0x61, 0x7F, 0x03, 0x12, 0x7C, 0x3B, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x7C, 0x74, -0xF1, 0xDA, 0x12, 0xB8, 0xC5, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x93, 0x29, -0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, -0x74, 0x02, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, -0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, -0xE4, 0xFF, 0x90, 0x95, 0xAB, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, -0xCF, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x74, 0x90, 0x95, 0xAC, 0x74, 0x03, 0xF0, 0x90, 0x95, 0xCE, -0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, -0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, 0x11, 0x7C, 0xE0, 0xFD, 0x74, -0xAE, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xDA, -0x7B, 0x01, 0x7A, 0x95, 0x79, 0xAC, 0x90, 0x8A, 0x77, 0x12, 0x9F, 0xE9, 0x12, 0x04, 0x7E, 0x90, -0x95, 0xCF, 0xE0, 0x04, 0x54, 0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x95, 0xCF, -0xE0, 0x90, 0x04, 0x7F, 0xF0, 0x90, 0x95, 0xAB, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, -0x90, 0x8A, 0x79, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xF5, 0x82, 0xE4, 0x35, -0x83, 0xF5, 0x83, 0x22, 0x90, 0x94, 0x9E, 0x12, 0x86, 0x7A, 0x71, 0x4F, 0x12, 0x02, 0x06, 0x54, -0x7F, 0xFD, 0x12, 0x87, 0x3D, 0xFE, 0x54, 0x1F, 0x90, 0x94, 0xA2, 0x12, 0x8F, 0xC6, 0x90, 0x94, -0xA1, 0x12, 0x87, 0x35, 0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0x94, -0xA4, 0x12, 0x87, 0x35, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x94, 0xA3, 0x12, -0x8F, 0xC6, 0xFF, 0x12, 0x87, 0x36, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x94, -0xA6, 0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, -0x33, 0x33, 0x33, 0x54, 0x80, 0x31, 0xDB, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x94, 0xA3, 0xE0, 0x54, -0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x31, 0xDB, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x60, 0x02, 0x21, -0xDA, 0x90, 0x94, 0xA2, 0xE0, 0x54, 0x1F, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x71, 0x5A, 0x54, 0xE0, -0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x31, 0xDB, 0x54, 0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, -0x25, 0xE0, 0x31, 0xDB, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0x94, 0xA1, 0xE0, 0x54, 0x01, 0xC4, 0x33, -0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x71, 0x5A, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0x94, 0xA4, -0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x31, 0xDB, 0x54, 0xCF, 0x4F, 0xD1, 0x9F, 0xE0, 0x54, 0xFB, -0xD1, 0x9F, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x94, 0xA7, 0xE0, 0x12, 0x9F, 0xCF, 0xD0, -0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x30, 0x71, 0x4F, 0xE9, 0x24, 0x03, 0xF9, -0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, 0x02, 0x4C, 0x90, 0x94, 0xA5, 0x74, 0x01, -0xF0, 0x90, 0x94, 0xA5, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x0F, 0xEF, 0x71, 0x49, 0x8F, 0x82, -0x8E, 0x83, 0xE4, 0x12, 0x02, 0x5E, 0xD1, 0x7E, 0x80, 0xE7, 0x90, 0x93, 0x4F, 0xE0, 0x54, 0x07, -0xFF, 0xBF, 0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, 0x54, 0x74, 0x01, 0xF0, 0xE4, 0x90, -0x94, 0xA5, 0xF0, 0x90, 0x94, 0xA5, 0xE0, 0xFC, 0x71, 0x49, 0x8F, 0x82, 0x8E, 0x83, 0x12, 0x02, -0x1F, 0xFF, 0xED, 0xF1, 0x4C, 0xE5, 0x82, 0x2C, 0x11, 0x7C, 0xEF, 0xF0, 0xD1, 0x7E, 0xE0, 0xB4, -0x04, 0xE1, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0x12, 0x97, 0x9E, 0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, -0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, -0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE6, 0x02, 0x61, 0x10, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, -0x6D, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x6E, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, -0x90, 0x96, 0x6F, 0xF0, 0x90, 0x96, 0x6E, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, -0x61, 0x05, 0x90, 0x96, 0x6D, 0xE0, 0xFF, 0x71, 0x62, 0x61, 0x05, 0x90, 0x96, 0x6D, 0xE0, 0x24, -0xD6, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, 0x42, 0x75, -0xF0, 0x12, 0x31, 0xE0, 0x13, 0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0x75, 0xF0, -0x12, 0x31, 0xE0, 0x12, 0x8F, 0xCA, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0x75, 0xF0, 0x12, 0x31, -0xE0, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0x42, 0xD1, 0x94, 0xFB, 0xE4, 0xFD, 0x0F, -0x71, 0x42, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x50, 0x12, 0x04, 0x6E, 0x71, 0x3F, 0x75, 0xF0, 0x12, -0x71, 0x5A, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, 0x71, 0x42, 0x75, 0xF0, 0x12, 0x71, -0x5A, 0x54, 0x1F, 0x71, 0x40, 0xF1, 0x4C, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x42, 0x75, 0xF0, -0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, -0x02, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, -0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, -0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0x42, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, -0x82, 0xE4, 0x34, 0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, -0x82, 0x71, 0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, -0xE0, 0xFB, 0x0D, 0x71, 0x15, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0xF1, 0x28, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, -0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, -0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xF5, 0x83, 0xE0, -0xFB, 0x0D, 0x71, 0x15, 0x90, 0x96, 0x6D, 0xE0, 0x22, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, -0x94, 0x9E, 0x02, 0x86, 0x71, 0x75, 0xF0, 0x12, 0xE5, 0x72, 0x90, 0x89, 0x51, 0x12, 0x04, 0x6E, -0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x77, 0xEF, 0xF0, 0x7F, 0x8F, -0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x3B, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, 0x70, -0x31, 0x90, 0x96, 0x78, 0xF0, 0x90, 0x96, 0x78, 0xE0, 0xFD, 0x90, 0x96, 0x77, 0xE0, 0x71, 0xC6, -0xE5, 0x82, 0x2D, 0x11, 0x7C, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, 0x15, 0x90, 0x96, 0x78, 0xE0, 0x04, -0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDE, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, -0xF1, 0x28, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, -0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, 0x30, 0xE6, 0x1E, 0x71, 0xC4, 0xB1, 0x77, 0xE0, 0x54, 0x03, -0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x61, 0x12, 0x75, 0x80, 0x71, 0xB7, 0xE0, 0x90, 0x92, -0x5E, 0xF0, 0xA3, 0x74, 0x01, 0x80, 0x4D, 0xB1, 0x94, 0x04, 0xF0, 0xB1, 0x94, 0x64, 0x02, 0x70, -0x1B, 0x74, 0x18, 0x25, 0x61, 0xB1, 0x6F, 0xE0, 0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, 0x71, 0xC4, -0xE0, 0xFD, 0xB1, 0x79, 0xD1, 0xAB, 0x71, 0xC4, 0xD1, 0x8B, 0x80, 0x28, 0xB1, 0x94, 0xD3, 0x94, -0x03, 0x40, 0x17, 0x90, 0x8A, 0xB3, 0x12, 0x8D, 0xC8, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x71, 0xB7, -0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x74, 0x03, 0x80, 0x0A, 0x71, 0xC4, 0xB1, 0x77, 0xD1, 0xAB, -0x71, 0xC4, 0xD1, 0x8B, 0xF0, 0xAB, 0x61, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0x8F, 0x72, 0x8D, -0x73, 0xEF, 0x71, 0xC6, 0xE0, 0xF5, 0x74, 0x54, 0x7F, 0xF5, 0x75, 0xE5, 0x74, 0x54, 0x80, 0xF5, -0x77, 0x75, 0xF0, 0x12, 0xEF, 0xD1, 0x97, 0xF5, 0x79, 0x75, 0xF0, 0x12, 0xEF, 0x31, 0xE0, 0xC4, -0x54, 0x03, 0xF5, 0x7A, 0xB1, 0x6B, 0x74, 0xFF, 0xF0, 0xF1, 0x5A, 0xF0, 0xE5, 0x74, 0x45, 0x77, -0xFF, 0xD1, 0x72, 0xEF, 0xF0, 0xE5, 0x72, 0xB1, 0x7B, 0xE0, 0x54, 0x03, 0xF5, 0x78, 0x74, 0x46, -0x25, 0x72, 0xF1, 0x2F, 0xE5, 0x78, 0xF0, 0xE5, 0x75, 0x65, 0x79, 0x70, 0x40, 0x71, 0x55, 0xC4, -0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0xE5, 0x77, 0x70, 0x08, 0xE5, 0x75, 0x44, 0x80, 0xF5, 0x74, -0xA1, 0x41, 0xF1, 0x5A, 0xF0, 0xE5, 0x72, 0xF1, 0x40, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, 0x37, -0xCF, 0xB1, 0x89, 0xE5, 0x72, 0xF0, 0xE4, 0x90, 0x95, 0x39, 0x12, 0x96, 0x53, 0x7B, 0x01, 0xFA, -0x7D, 0x02, 0x7F, 0x04, 0xD1, 0xBF, 0x7D, 0x07, 0xAF, 0x72, 0x02, 0xC0, 0x40, 0xE5, 0x75, 0xC3, -0x95, 0x79, 0x50, 0x56, 0xAB, 0x72, 0xAD, 0x79, 0xAF, 0x75, 0x12, 0x72, 0x7F, 0x8F, 0x76, 0x85, -0x76, 0x74, 0x71, 0x55, 0xC4, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x95, 0x39, 0xB1, 0x88, 0xE5, 0x76, -0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x75, 0xF0, 0xE5, 0x77, 0x12, 0x8F, 0xCA, 0x12, 0xC6, 0xBC, -0xE4, 0xFB, 0xFA, 0xD1, 0x85, 0xE5, 0x75, 0xC3, 0x94, 0x0C, 0x40, 0x25, 0x71, 0x55, 0xC4, 0x13, -0x54, 0x07, 0x30, 0xE0, 0x1C, 0xE5, 0x73, 0x60, 0x18, 0xE5, 0x77, 0x70, 0x14, 0xE5, 0x75, 0x44, -0x80, 0xF5, 0x74, 0xB1, 0x6B, 0xE5, 0x76, 0xF0, 0x80, 0x07, 0xD1, 0x72, 0xE5, 0x79, 0xF0, 0xF5, -0x74, 0xB1, 0x8D, 0xE5, 0x74, 0xF0, 0xB1, 0x6B, 0xE0, 0xFF, 0xF1, 0xD4, 0xEF, 0xF0, 0xA3, 0xE4, -0xF0, 0xA3, 0xE5, 0x78, 0xF1, 0x37, 0x7B, 0x01, 0x7A, 0x00, 0xD1, 0x85, 0x90, 0x92, 0x80, 0xE5, -0x78, 0xF0, 0xAB, 0x73, 0xAD, 0x74, 0xAF, 0x72, 0x02, 0x75, 0x80, 0x74, 0x18, 0x25, 0x72, 0xF5, -0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xE0, 0xFD, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x05, -0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x35, -0xE4, 0xF0, 0xA3, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, -0x22, 0x7D, 0x01, 0xAF, 0x64, 0xAC, 0x05, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0xFD, 0xE0, 0xFF, 0x71, -0xC6, 0xE0, 0xF5, 0x72, 0x54, 0x7F, 0xF5, 0x74, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x50, 0x12, -0x04, 0x6E, 0xE0, 0xF9, 0x90, 0x95, 0x2F, 0xE0, 0xD1, 0x94, 0xFE, 0xEF, 0xB1, 0x7B, 0xE0, 0x54, -0x03, 0xF5, 0x73, 0xE5, 0x74, 0x90, 0x81, 0x9D, 0x93, 0xFB, 0xED, 0xF1, 0x40, 0xE4, 0xF0, 0xA3, -0xEB, 0xF0, 0x31, 0xDC, 0xC4, 0x54, 0x03, 0x90, 0x95, 0x30, 0xF0, 0x74, 0xC6, 0x2D, 0xD1, 0x76, -0xE5, 0x74, 0xF0, 0x74, 0x46, 0x2D, 0xF1, 0x2F, 0xE5, 0x73, 0xF0, 0xE5, 0x74, 0xD3, 0x9E, 0x40, -0x06, 0x8E, 0x74, 0xAF, 0x06, 0x8F, 0x72, 0x8C, 0x75, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x75, 0x50, -0x30, 0xE5, 0x72, 0x30, 0xE7, 0x09, 0x85, 0x74, 0x72, 0x1C, 0xEC, 0x70, 0x21, 0x80, 0x22, 0xE5, -0x74, 0xD3, 0x99, 0x40, 0x15, 0xAD, 0x01, 0x90, 0x95, 0x2F, 0xE0, 0xFB, 0x90, 0x95, 0x34, 0xEC, -0xF0, 0xAF, 0x74, 0x12, 0xC7, 0xB8, 0x8F, 0x72, 0x80, 0x07, 0x89, 0x72, 0x80, 0x03, 0x0F, 0x80, -0xCA, 0x90, 0x95, 0x2F, 0xE0, 0xFF, 0xB1, 0x8D, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x72, -0xF1, 0x37, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0x05, 0x7F, 0x08, 0xD1, 0xBF, -0x90, 0x95, 0x2F, 0xE0, 0xFF, 0x90, 0x92, 0x80, 0xE5, 0x73, 0xF0, 0xE4, 0xFB, 0xAD, 0x72, 0x02, -0x75, 0x80, 0x74, 0xC6, 0x25, 0x72, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x90, 0x94, -0xA5, 0xE0, 0x04, 0xF0, 0x22, 0x7D, 0x05, 0x7F, 0x04, 0x80, 0x34, 0xE0, 0x90, 0x92, 0x5E, 0xF0, -0xA3, 0x74, 0x02, 0x22, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xF0, -0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, -0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x61, 0x02, 0x75, 0x80, 0x7A, 0x00, 0x7D, 0x03, 0x7F, 0x01, 0x90, -0x01, 0xC6, 0xE0, 0x64, 0x80, 0x70, 0x60, 0x90, 0x95, 0x3F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xEB, -0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, 0x95, 0x35, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x43, 0xF0, -0xEC, 0xA3, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x45, 0xF0, 0xEC, 0xA3, -0xF0, 0x90, 0x95, 0x39, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x47, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, -0x95, 0x3B, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0x49, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x95, 0x3D, -0x74, 0xFE, 0xF0, 0x90, 0x95, 0x5F, 0x74, 0x0C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3D, 0x12, -0x8D, 0xB6, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x73, 0xF0, 0x22, -0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x08, 0xA4, -0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0xE5, 0x75, 0x25, 0xE0, 0x24, 0x75, -0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x72, -0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x73, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xFD, 0x12, -0x8D, 0xDA, 0x90, 0x96, 0x74, 0xE0, 0x90, 0x96, 0x73, 0xB4, 0x01, 0x09, 0xE0, 0xB1, 0x7B, 0xE0, -0x44, 0x04, 0xF0, 0x80, 0x07, 0xE0, 0xB1, 0x7B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, -0x8D, 0xC8, 0x12, 0x9F, 0x30, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x21, 0xE8, 0xE4, 0xFD, 0x80, 0xB0, -0x7D, 0x01, 0x80, 0xAC, 0x90, 0x95, 0x37, 0xE4, 0xF0, 0xA3, 0x22, 0x7D, 0x05, 0x7F, 0x01, 0xC1, -0xBF, 0x7A, 0x00, 0x7D, 0x01, 0x7F, 0x01, 0xC1, 0xBF, 0x7A, 0x00, 0xE4, 0xFD, 0x7F, 0x01, 0xC1, -0xBF, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, 0x60, 0x34, 0xA3, 0xE0, 0x20, 0xE0, 0x2F, 0x90, -0x8A, 0xB9, 0x12, 0x8D, 0xC8, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x11, 0x2F, 0x30, 0xE0, -0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, -0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, -0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x62, -0xEC, 0x90, 0x96, 0x49, 0x12, 0x04, 0x31, 0x90, 0x96, 0x49, 0x31, 0x50, 0x11, 0xB6, 0x90, 0x01, -0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, -0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA1, 0xE4, 0x30, 0xE0, 0x05, -0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, 0x20, 0xE0, 0x33, 0x11, 0x2F, 0x30, 0xE0, -0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0x96, 0x47, 0xF0, 0x80, 0x06, 0x90, 0x96, -0x47, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x96, 0x48, 0x30, 0xE0, 0x05, 0x74, -0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x96, 0x47, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x31, -0x6E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x62, 0xEC, 0x90, 0x96, 0x4F, 0x12, 0x04, 0x31, 0x90, 0x96, 0x4F, -0x31, 0x50, 0x11, 0xB6, 0x90, 0x8A, 0xFD, 0x12, 0x8D, 0xDA, 0x12, 0xA7, 0xD3, 0x54, 0xFE, 0x31, -0x76, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, 0x01, -0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA1, -0xE4, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x11, 0x2F, 0x30, 0xE0, 0x35, 0x90, 0x88, -0xDF, 0xE0, 0x60, 0x08, 0x90, 0x96, 0x4D, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, 0x4D, -0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0x96, 0x4E, 0xF0, 0x80, 0x06, -0x90, 0x96, 0x4E, 0x74, 0x02, 0xF0, 0x90, 0x96, 0x4D, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x7F, 0x01, -0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, -0xF3, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0x22, 0x7F, 0x02, -0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x94, 0xFB, -0xF0, 0xD1, 0xA4, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, -0x2E, 0xE4, 0xFF, 0x91, 0x65, 0x90, 0x93, 0x30, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x75, 0x12, 0xA7, -0xD3, 0x44, 0x02, 0x31, 0x76, 0xE4, 0x90, 0x94, 0xFC, 0xF0, 0x90, 0x94, 0xFC, 0xE0, 0xFF, 0xC3, -0x94, 0x05, 0x50, 0x2D, 0x71, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0x90, 0x93, 0x33, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x94, 0xFC, 0x91, 0x25, 0xF0, 0x90, -0x94, 0xFC, 0x91, 0x44, 0x44, 0x40, 0x12, 0x9F, 0xC7, 0x90, 0x94, 0xFC, 0xE0, 0x04, 0xF0, 0x80, -0xC9, 0x90, 0x07, 0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, -0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xB1, -0xCF, 0x90, 0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x94, 0xFD, 0xF0, 0x90, 0x94, 0xFD, -0xE0, 0x30, 0xE0, 0x19, 0x90, 0x94, 0xFB, 0xE0, 0x04, 0xF0, 0xB1, 0xC0, 0x90, 0x02, 0x26, 0xE0, -0x90, 0x94, 0xFD, 0xF0, 0x90, 0x94, 0xFB, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE0, 0x90, 0x02, 0x03, -0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x94, 0xFE, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, -0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, 0x94, 0xFD, 0xF0, 0x90, 0x02, 0x01, 0x51, 0x84, 0x90, -0x02, 0x02, 0x51, 0x84, 0x90, 0x02, 0x14, 0x51, 0x84, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, -0xB1, 0xD7, 0x90, 0x94, 0xFE, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, -0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x71, 0xF5, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, -0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x94, 0xFD, 0xE0, 0x2F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x9D, 0x31, 0x7C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x63, 0x14, -0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x71, 0xF5, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, -0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, -0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, -0x90, 0x93, 0x30, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, -0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x94, 0xFB, 0xF0, 0x90, 0x94, 0xFB, 0xE0, -0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2D, 0x71, 0xED, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -0xF9, 0xFF, 0x90, 0x93, 0x32, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x94, 0xFB, 0x91, 0x25, -0xF0, 0x90, 0x94, 0xFB, 0x91, 0x44, 0x44, 0x20, 0x12, 0x9F, 0xC7, 0x90, 0x94, 0xFB, 0xE0, 0x04, -0xF0, 0x80, 0xC9, 0x71, 0xCF, 0x54, 0xFE, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x71, 0xCF, 0x44, -0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x12, 0xA7, 0xD3, 0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, -0x07, 0x71, 0xCF, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, -0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x65, 0x90, 0x00, 0x90, -0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, -0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x24, 0x6F, 0xF5, 0x82, 0xE4, -0x34, 0x8D, 0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, 0x64, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, -0x00, 0xA8, 0x07, 0x08, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, -0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, 0x90, 0x88, 0x39, -0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0x91, 0xB8, 0xBF, 0x01, 0x08, 0x51, 0x8D, 0x90, 0x01, -0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x43, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -0x90, 0x01, 0xB1, 0x22, 0xE0, 0xFF, 0x24, 0x34, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -0x90, 0x01, 0xB2, 0xF0, 0x74, 0x39, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -0x01, 0xB3, 0xF0, 0xE0, 0x22, 0x90, 0x96, 0x70, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x96, 0x70, 0xE0, 0x6F, 0x60, -0x36, 0xC3, 0x90, 0x96, 0x72, 0xE0, 0x94, 0x88, 0x90, 0x96, 0x71, 0xE0, 0x94, 0x13, 0x40, 0x08, -0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, 0x71, 0x12, 0x9F, 0xC0, 0x12, 0x9F, -0xC8, 0xD3, 0x90, 0x96, 0x72, 0xE0, 0x94, 0x32, 0x90, 0x96, 0x71, 0xE0, 0x94, 0x00, 0x40, 0xBF, -0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB8, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, -0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x63, 0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, -0xE0, 0x60, 0x05, 0x75, 0x63, 0x10, 0x80, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, -0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x63, 0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, -0xE0, 0x30, 0xE0, 0x05, 0x75, 0x63, 0x20, 0x80, 0x02, 0xA1, 0xC7, 0x90, 0x01, 0xB9, 0x74, 0x08, -0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x63, 0xF0, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x24, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xB1, 0xB6, -0x12, 0x04, 0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, -0xB1, 0xB6, 0x31, 0x50, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, 0x4C, 0xE0, 0x70, -0x29, 0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x94, 0xFF, 0x74, 0x22, 0xF0, -0x90, 0x95, 0x21, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x01, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x94, -0x79, 0xFF, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x54, 0xE0, 0xFF, 0x70, -0x0A, 0x90, 0x93, 0x51, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, -0xF0, 0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, -0xEF, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0x51, 0xE0, 0x60, 0x06, 0x90, -0x01, 0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, -0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x94, 0xFB, 0x12, 0x04, 0x31, 0x90, 0x94, 0xFB, 0x22, -0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x74, -0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x22, -0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0xD1, 0x17, 0x90, 0x88, 0x27, 0xF0, 0xA3, 0xEF, -0xF0, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0x44, 0x01, 0xF0, 0x7D, -0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, 0x90, 0x93, 0x0E, -0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x80, 0xC0, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, -0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x02, 0x91, 0x0D, 0x22, 0xE4, 0x90, 0x94, 0xF8, 0xF0, 0xA3, -0xF0, 0xA3, 0xF0, 0x90, 0x94, 0xF8, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0x54, 0xE0, 0x70, 0x18, -0x90, 0x93, 0x51, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x94, 0xF8, 0xE0, 0x24, 0x2A, -0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, -0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, -0x6F, 0x60, 0x03, 0x12, 0xA5, 0x6B, 0xC2, 0xAF, 0xF1, 0x24, 0xBF, 0x01, 0x02, 0xD1, 0x20, 0xD2, -0xAF, 0xB1, 0x0A, 0x12, 0xAF, 0xCA, 0x12, 0x83, 0x4D, 0x80, 0xA8, 0x90, 0x01, 0x9A, 0xE0, 0x54, -0xC0, 0x44, 0x0B, 0xF0, 0xB1, 0xC0, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, -0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xA4, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0x7F, 0x90, -0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xA4, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB6, -0xA3, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, 0xBD, -0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x31, 0x59, 0x12, 0x95, 0xBE, 0x90, 0x88, 0x36, -0xE0, 0x70, 0x0C, 0x12, 0x8D, 0xD7, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x22, -0xE4, 0x90, 0x96, 0x7F, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x23, 0xC3, 0x90, -0x96, 0x80, 0xE0, 0x94, 0xD0, 0x90, 0x96, 0x7F, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, -0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x96, 0x7F, 0x12, 0x9F, 0xC0, 0xB1, 0xC0, 0x80, -0xD6, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, 0x24, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, -0x90, 0x93, 0x48, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, -0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, -0x80, 0xDE, 0x74, 0x24, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, 0x7F, 0x01, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0xF1, 0xA4, 0xE4, 0xFB, 0x90, -0x96, 0x5B, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, -0xC4, 0x2B, 0x12, 0xA4, 0xCB, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE3, 0x90, 0x07, 0xC2, 0xB1, -0xCF, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x7B, 0xF1, 0x9D, 0x7A, 0x00, 0x90, 0x96, 0x7C, 0xE0, 0x54, 0x03, -0xFB, 0x70, 0x0B, 0x90, 0x07, 0xC4, 0x12, 0xD2, 0x73, 0x74, 0x03, 0xF0, 0x80, 0x0F, 0xEB, 0x64, -0x02, 0x4A, 0x70, 0x16, 0x90, 0x07, 0xC6, 0x12, 0xD2, 0x73, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, -0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, -0x8F, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x29, 0x12, 0xB8, 0xE0, 0xFF, -0xF0, 0x12, 0x02, 0x06, 0x11, 0xD6, 0x90, 0x93, 0x29, 0x11, 0xCD, 0x4E, 0xF0, 0x90, 0x05, 0x52, -0xE0, 0x54, 0x07, 0x90, 0x94, 0xA2, 0x60, 0x16, 0x12, 0x86, 0x71, 0x12, 0x87, 0x3D, 0xFD, 0x90, -0x05, 0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x93, 0x2B, 0xF0, 0xA3, 0xED, 0xF0, 0x80, 0x26, 0x12, 0x86, -0x71, 0x12, 0x87, 0x3D, 0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, -0xFE, 0x7C, 0x00, 0x7D, 0x05, 0x12, 0x02, 0x92, 0x90, 0x93, 0x2B, 0xEF, 0xF0, 0xEB, 0x75, 0xF0, -0x05, 0x84, 0xA3, 0xF0, 0x12, 0x8B, 0x6E, 0x12, 0x02, 0x06, 0x20, 0xE0, 0x13, 0x12, 0x8D, 0xD7, -0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x12, 0x9F, 0x30, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0B, -0x90, 0x8A, 0x89, 0x12, 0x8D, 0xC8, 0x12, 0x8F, 0xFB, 0x11, 0xBD, 0x12, 0xA7, 0xBD, 0x20, 0xE0, -0x04, 0xEF, 0x44, 0x20, 0xF0, 0x11, 0xB6, 0x30, 0xE0, 0x14, 0x90, 0x88, 0x36, 0x74, 0x01, 0xF0, -0xE4, 0x90, 0x88, 0x38, 0xF0, 0x11, 0xC5, 0x90, 0x05, 0x58, 0x74, 0x05, 0xF0, 0x22, 0xE4, 0x90, -0x88, 0x36, 0xF0, 0x90, 0x88, 0x38, 0x74, 0x0C, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFE, 0xF0, -0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, 0xC3, 0x13, 0x22, 0x90, 0x93, 0x29, -0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xF0, 0xEE, 0x54, -0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x22, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, -0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0x12, -0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x30, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x04, -0xE4, 0x12, 0x96, 0x54, 0x22, 0x12, 0x02, 0x06, 0x90, 0x93, 0x49, 0xF0, 0x22, 0x12, 0x02, 0x06, -0xFF, 0x90, 0x93, 0x4A, 0xF0, 0xBF, 0x01, 0x0A, 0x7F, 0x01, 0x12, 0x98, 0xDD, 0xE4, 0x90, 0x93, -0x4A, 0xF0, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, 0x96, 0x53, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x75, -0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x87, 0x75, 0x2C, 0x33, 0xF5, 0x31, 0xF5, 0x32, 0xF5, -0x33, 0xF5, 0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, -0xF0, 0xA3, 0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, -0xE5, 0x33, 0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x06, 0x43, 0x39, 0x10, 0x75, 0x3A, -0x01, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, -0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, -0x90, 0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, 0x74, 0xC6, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xBA, 0xF0, -0xA3, 0x74, 0x77, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x89, 0xF0, 0xA3, 0x74, 0x56, 0xF0, 0x90, 0x8A, -0xB9, 0x74, 0x8D, 0xF0, 0xA3, 0x74, 0xE4, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xAB, 0xF0, 0xA3, 0x74, -0xD3, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xA8, 0xF0, 0xA3, 0x74, 0x84, 0xF0, 0x90, 0x8A, 0xC3, 0x74, -0xBF, 0xF0, 0xA3, 0x74, 0x96, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0xB1, 0xF0, -0x90, 0x8A, 0x85, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0xBD, 0xF0, 0x90, 0x86, 0x04, 0x74, 0xCD, 0xF0, -0xA3, 0x74, 0x66, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xB6, 0xF0, 0xA3, 0x74, 0xC3, 0xF0, 0x90, 0x86, -0x0C, 0x74, 0xB0, 0xF0, 0xA3, 0x74, 0x37, 0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xB0, 0xF0, 0xA3, 0x74, -0xBD, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xCE, 0xF0, 0xA3, 0x74, 0xFA, 0xF0, 0x90, 0x86, 0x02, 0x74, -0xCF, 0xF0, 0xA3, 0x74, 0x6B, 0xF0, 0x90, 0x8A, 0xFD, 0x74, 0xBF, 0xF0, 0xA3, 0x74, 0xC7, 0xF0, -0x90, 0x8A, 0xF9, 0x74, 0xC0, 0xF0, 0xA3, 0x74, 0x26, 0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xC8, 0xF0, -0xA3, 0x74, 0x2B, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0x97, 0xF0, 0xA3, 0x74, 0x07, 0xF0, 0x90, 0x8A, -0xD3, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0x90, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xD0, 0xF0, 0xA3, 0x74, -0x3F, 0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xCD, 0xF0, 0xA3, 0x74, 0x16, 0xF0, 0x90, 0x86, 0x06, 0x74, -0xBE, 0xF0, 0xA3, 0x74, 0xAE, 0xF0, 0x22, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, -0xAF, 0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x86, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, -0x74, 0x86, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, -0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, -0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xD6, 0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x75, 0x50, -0xE5, 0x3D, 0x30, 0xE1, 0x02, 0xB1, 0x85, 0xE5, 0x3D, 0x30, 0xE2, 0x02, 0x71, 0xBD, 0xE5, 0x3D, -0x30, 0xE4, 0x02, 0x71, 0x7E, 0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0x9F, 0x36, 0xE5, 0x3F, 0x30, -0xE2, 0x09, 0xB1, 0xCF, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, -0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, -0x12, 0xA1, 0x8B, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0x91, 0xC1, 0xE5, 0x40, 0x30, 0xE6, 0x02, 0x91, -0xFC, 0xE5, 0x40, 0x30, 0xE7, 0x02, 0xB1, 0xAF, 0x74, 0xD6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x12, 0x34, -0x78, 0xB1, 0x71, 0x90, 0x96, 0x83, 0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, 0x12, 0x90, -0x96, 0x83, 0xE0, 0xFF, 0x64, 0x01, 0x60, 0x24, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, -0x19, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, -0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, 0x83, 0xE0, 0xFF, 0x91, 0x0E, 0x22, 0x90, 0x88, 0x36, -0xE0, 0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x08, 0x90, 0x8B, 0x01, 0x12, 0x8D, 0xDA, -0x80, 0x05, 0xB1, 0x69, 0x12, 0xA5, 0x6B, 0x90, 0x93, 0x56, 0xE0, 0xFF, 0x12, 0x8F, 0xCA, 0x30, -0xE0, 0x1A, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0xB1, 0x91, 0x90, 0x93, 0x57, 0xE0, 0x30, -0xE0, 0x0A, 0x71, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x87, 0xC7, 0x22, 0x90, 0x93, 0x56, -0xE0, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, 0x00, 0x22, 0xAD, 0x07, -0x90, 0x93, 0x58, 0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0x96, 0x53, 0xB1, 0x7E, 0x90, 0x93, -0x59, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, 0xF0, 0x90, 0x96, 0x55, 0xF0, 0xEE, 0xA3, 0xF0, 0x91, -0xA2, 0x90, 0x96, 0x57, 0xF0, 0xEE, 0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x64, 0x90, 0x93, 0x56, -0xE0, 0xFE, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x59, 0xEE, 0x91, 0x02, 0x20, 0xE0, 0x02, 0x7D, 0x01, -0x91, 0xAA, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, 0x91, 0xAA, 0xC4, -0x13, 0x54, 0x07, 0x30, 0xE0, 0x24, 0xA3, 0xE0, 0x30, 0xE0, 0x0F, 0x90, 0x96, 0x58, 0xE0, 0x90, -0x92, 0x20, 0xF0, 0x90, 0x96, 0x57, 0x91, 0xB2, 0x80, 0x10, 0x91, 0xA2, 0xFF, 0x12, 0x7C, 0x6A, -0x71, 0xFD, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0x87, 0xC7, 0x90, 0x93, 0x56, 0xE0, 0xC4, 0x54, -0x0F, 0x30, 0xE0, 0x0D, 0x90, 0x96, 0x56, 0xE0, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0x55, 0x91, -0xB2, 0x22, 0x90, 0x96, 0x53, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x12, 0x87, 0xC7, 0x90, 0x93, 0x56, -0xE0, 0x22, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, -0x33, 0x90, 0x88, 0x31, 0xB1, 0x61, 0x30, 0xE0, 0x32, 0xEF, 0x54, 0xBF, 0xB1, 0x4D, 0x30, 0xE0, -0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0xB1, 0x56, 0x74, 0x04, 0xF0, 0x90, -0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8D, -0xC8, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0xA5, 0x6B, 0x22, 0x90, 0x88, 0x31, 0xE0, -0xFF, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x1E, 0xEF, 0x54, 0x7F, 0xB1, 0x4D, 0x30, 0xE1, 0x06, 0xE0, -0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, 0xFD, 0xB1, 0x56, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x03, 0x12, 0xA5, 0x6B, 0x12, 0x97, 0xDD, 0x30, 0xE0, 0x21, 0x90, 0x88, 0xA4, 0xE0, 0xFF, -0xC3, 0x13, 0x30, 0xE0, 0x17, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, -0x30, 0xE1, 0x05, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xF0, 0x90, 0x04, -0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, -0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, -0x22, 0x90, 0x01, 0xC7, 0x74, 0x66, 0xF0, 0xE4, 0xFF, 0x22, 0xFF, 0x90, 0x95, 0x35, 0xE5, 0xF0, -0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xA4, 0xF3, 0x02, 0x8F, -0x5A, 0xE4, 0x90, 0x95, 0xD2, 0xF0, 0x90, 0x95, 0xD0, 0x74, 0x14, 0xF0, 0x90, 0x95, 0xF2, 0x74, -0x01, 0xF0, 0xFB, 0x7A, 0x95, 0x79, 0xD0, 0x12, 0x8D, 0xB6, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, -0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, 0x8D, -0xDA, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8D, 0xDA, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, -0xE0, 0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0x97, 0x9E, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, -0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x8D, 0xDA, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -0xC4, 0x74, 0x11, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x8D, 0xDA, 0x53, 0x91, -0xBF, 0x74, 0x11, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x67, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0xBE, 0xFF, -0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, -0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, -0x12, 0xA6, 0x91, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xA1, 0x33, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x94, 0x9F, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x94, 0x9E, -0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0xF1, 0x87, 0xE0, 0x90, 0x94, 0xA1, 0xF0, 0x12, 0x7B, 0x07, 0x7C, -0x00, 0xAD, 0x07, 0x90, 0x94, 0x9E, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x94, 0x9F, 0xE0, 0x60, -0x05, 0xF1, 0x7B, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xF1, 0x7B, 0x54, 0xC0, 0xF0, 0x90, 0x94, 0xA1, 0xE0, 0xFF, -0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, -0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, -0x04, 0xF0, 0xAF, 0x05, 0xF1, 0x72, 0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x94, 0xA0, 0xE0, -0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0xF1, 0x72, 0xF5, 0x83, 0xEE, 0xF0, -0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, -0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, -0xE4, 0x34, 0x84, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0x87, 0xE0, -0x90, 0x96, 0x82, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, -0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, -0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x96, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x05, -0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, 0x70, 0x03, -0x7F, 0x01, 0x22, 0x12, 0x97, 0xDD, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x96, 0x76, 0xE0, 0x94, 0x03, -0x90, 0x96, 0x75, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, 0x80, 0x1B, 0xD3, 0x90, -0x96, 0x76, 0xE0, 0x94, 0xE8, 0x90, 0x96, 0x75, 0xE0, 0x94, 0x03, 0x40, 0x0A, 0x90, 0x01, 0xC0, -0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x96, -0x75, 0x12, 0x9F, 0xC0, 0x80, 0xA8, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x93, 0x01, 0xED, 0xF0, -0x22, 0x90, 0x05, 0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0x7D, 0x07, 0xAF, 0x64, -0xED, 0x30, 0xE0, 0x26, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0xD1, 0x8F, 0xEF, 0x90, 0x89, -0x59, 0xD1, 0x8F, 0xEF, 0x90, 0x89, 0x5B, 0xD1, 0x8F, 0xEF, 0x90, 0x89, 0x5D, 0xD1, 0x8F, 0xEF, -0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, -0x12, 0xEF, 0xD1, 0xD6, 0xE4, 0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE2, 0x08, 0x75, 0xF0, 0x12, 0xEF, -0xD1, 0xCB, 0xE4, 0xF0, 0xF1, 0x3C, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0xF1, 0x3C, 0xEE, 0xF0, -0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x6D, 0x90, 0x96, 0x17, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x64, -0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x64, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0x54, 0xE5, 0x64, 0x12, -0xAB, 0xC6, 0xE0, 0xF5, 0x6F, 0xF1, 0xA1, 0xE0, 0x65, 0x6F, 0x60, 0x15, 0x90, 0x92, 0x5E, 0xE5, -0x6F, 0xF0, 0xE4, 0xA3, 0xF0, 0xAB, 0x64, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0xF1, 0xA1, 0xE5, 0x6F, -0xF0, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x01, 0x70, 0x50, 0xA3, 0xE0, 0x65, 0x64, 0x70, 0x4A, 0xA3, -0xE0, 0xF5, 0x65, 0xA3, 0xE0, 0x90, 0x95, 0x2E, 0xF0, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE0, 0x65, -0x65, 0x70, 0x02, 0xC1, 0x50, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE5, 0x65, 0xF0, 0xE5, 0x64, 0x12, -0xAD, 0x7B, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x95, 0x2E, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xE5, 0x64, -0x12, 0xAD, 0x7B, 0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x65, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xAB, -0x64, 0xE4, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0xC1, 0x50, 0xAF, 0x64, 0x12, 0x78, 0x4A, 0x75, 0xF0, -0x12, 0xE5, 0x64, 0x12, 0xA9, 0xE0, 0x12, 0x8F, 0xCA, 0xFD, 0xF1, 0x21, 0xED, 0xF0, 0x90, 0x95, -0x37, 0x12, 0xAD, 0x88, 0xE5, 0x64, 0xF0, 0x12, 0xB3, 0xD6, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0xFF, 0x90, 0x95, 0x3B, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x7B, 0x02, 0x12, 0xAF, 0xE9, 0xD1, 0xD1, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0xC6, -0xE0, 0xFD, 0xE5, 0x64, 0xC4, 0x54, 0xF0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -0xE0, 0x54, 0x80, 0xFB, 0xF1, 0x21, 0xEB, 0xF0, 0x12, 0xAF, 0xD4, 0xED, 0xF0, 0x90, 0x95, 0x35, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x96, 0x16, 0xD1, 0xBB, 0x7B, 0x03, 0x12, 0xAF, 0xE9, 0xAF, -0x64, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x02, 0xC1, 0x50, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x12, 0xA9, -0xE0, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x02, 0xC1, 0x50, 0xE5, 0x64, 0x12, 0xB3, 0xD6, 0x80, 0x05, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x02, -0xC1, 0x50, 0xD1, 0xD1, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, 0x70, 0x07, 0xD1, 0xC6, 0xE0, 0x70, 0x02, -0xC1, 0x50, 0xE5, 0x64, 0x75, 0xF0, 0x12, 0xA4, 0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, -0x7B, 0x01, 0x90, 0x95, 0x23, 0x12, 0x86, 0x7A, 0xF1, 0x28, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0xD1, -0xA7, 0x2F, 0xFF, 0xF1, 0x15, 0x2F, 0xFF, 0xD1, 0xEE, 0x2F, 0xF5, 0x6E, 0xD1, 0xD1, 0xE0, 0xF5, -0x6A, 0xA3, 0xE0, 0xF5, 0x6B, 0xD1, 0xC6, 0xE0, 0xFF, 0x90, 0x95, 0x26, 0xE4, 0xF0, 0xA3, 0xEF, -0xF0, 0xE5, 0x64, 0x12, 0xAB, 0xC6, 0xE0, 0xF5, 0x65, 0x54, 0x80, 0xF5, 0x67, 0xE5, 0x65, 0x54, -0x7F, 0xF5, 0x66, 0x90, 0x96, 0x16, 0xE0, 0x60, 0x11, 0x75, 0x70, 0x0A, 0xD1, 0xAD, 0xE4, 0x93, -0xC3, 0x13, 0x74, 0x01, 0x93, 0x13, 0xF5, 0x71, 0x80, 0x0D, 0x7B, 0xFF, 0x12, 0x9F, 0xD7, 0x12, -0x86, 0x7A, 0xE4, 0xF5, 0x70, 0xF5, 0x71, 0xF1, 0x1B, 0x12, 0x03, 0x13, 0x12, 0xBD, 0x7A, 0xF1, -0x28, 0x90, 0x95, 0x37, 0x12, 0xBD, 0x7E, 0xD1, 0xA7, 0xFF, 0x90, 0x95, 0x39, 0x12, 0xBD, 0x7E, -0xF1, 0x15, 0xFF, 0x90, 0x95, 0x3B, 0x12, 0xBD, 0x7E, 0x7B, 0x01, 0x12, 0xAF, 0xE1, 0xD1, 0xE8, -0x12, 0xBD, 0x7A, 0x90, 0x95, 0x26, 0xE0, 0xFF, 0xA3, 0xE0, 0xF1, 0x8C, 0xA3, 0xF1, 0x84, 0xA3, -0xE4, 0xF0, 0xA3, 0xE5, 0x65, 0xF0, 0x7B, 0x02, 0x12, 0xAF, 0xE1, 0x75, 0xF0, 0x12, 0xE5, 0x64, -0x12, 0xAE, 0x97, 0xFF, 0xE5, 0x66, 0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x66, 0xE5, 0x66, 0x45, 0x67, -0xF5, 0x65, 0x74, 0x76, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0xC3, 0x94, -0x05, 0x40, 0x02, 0x81, 0xED, 0xE5, 0x66, 0x90, 0x81, 0x61, 0x93, 0xF5, 0x6C, 0xFD, 0xAF, 0x66, -0x12, 0x60, 0x6F, 0x8F, 0x6C, 0xE5, 0x67, 0x60, 0x04, 0x05, 0x6C, 0x05, 0x6C, 0x90, 0x04, 0x8C, -0xE0, 0x64, 0x01, 0x70, 0x28, 0xE5, 0x66, 0xC3, 0x94, 0x0C, 0x40, 0x21, 0x74, 0x84, 0x25, 0x66, -0xF5, 0x82, 0xE4, 0x34, 0x04, 0xF5, 0x83, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x06, -0xE5, 0x6C, 0x2E, 0xFF, 0x80, 0x05, 0xC3, 0xE5, 0x6C, 0x9E, 0xFF, 0x8F, 0x6C, 0xE5, 0x6C, 0xD3, -0x94, 0x1A, 0xAF, 0x6C, 0x40, 0x02, 0x7F, 0x1A, 0x8F, 0x6C, 0x12, 0x96, 0x45, 0x7B, 0x03, 0xFA, -0x12, 0xAF, 0xE3, 0xE5, 0x65, 0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0x27, 0xE0, 0x9F, -0x90, 0x95, 0x26, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x64, 0xC3, 0xE5, 0x6B, 0x94, 0x0A, 0xE5, -0x6A, 0x94, 0x00, 0x40, 0x02, 0x81, 0x0F, 0xD1, 0x83, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x05, 0xD1, -0x83, 0xE0, 0x14, 0xF0, 0xD1, 0xE8, 0xFF, 0x90, 0x95, 0x27, 0xE0, 0x2F, 0xFF, 0x90, 0x95, 0x26, -0xE0, 0xD1, 0xF4, 0xD1, 0xA6, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6A, 0xC3, 0x13, 0xFE, -0xE5, 0x6B, 0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x28, 0xE5, 0x64, 0x94, 0x05, 0x50, -0x05, 0xD1, 0x83, 0x74, 0x03, 0xF0, 0x90, 0x95, 0x35, 0xF1, 0x84, 0xE5, 0x6A, 0xC3, 0x13, 0xA3, -0xF0, 0xE5, 0x6B, 0x13, 0xA3, 0xD1, 0x55, 0xD1, 0xBB, 0x7B, 0x01, 0x12, 0xAE, 0xB9, 0x12, 0xAD, -0xA1, 0x81, 0xED, 0xF1, 0x1B, 0x12, 0x03, 0x13, 0x65, 0x6E, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x52, -0x90, 0x95, 0x35, 0xF0, 0xA3, 0xE5, 0x6E, 0xF0, 0xC3, 0x13, 0xFF, 0xA3, 0xE4, 0xF0, 0xA3, 0xEF, -0xD1, 0x55, 0xD1, 0xBB, 0x7B, 0x02, 0x12, 0xAE, 0xB9, 0xE5, 0x64, 0xC3, 0x94, 0x05, 0x50, 0x0F, -0xD1, 0x83, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x07, 0x12, 0x96, 0x40, 0x7B, 0x03, 0x80, 0x0C, 0xE5, -0x6E, 0xC3, 0x94, 0x03, 0x50, 0x11, 0x12, 0x96, 0x40, 0x7B, 0x04, 0xFA, 0x12, 0xAE, 0xBB, 0x7D, -0x06, 0xAF, 0x64, 0x11, 0x40, 0xC1, 0x50, 0xE4, 0xFD, 0xAF, 0x64, 0x12, 0xAC, 0x4D, 0x11, 0x3C, -0x81, 0xED, 0x12, 0x96, 0x40, 0x7B, 0x08, 0xFA, 0x12, 0xAE, 0xBB, 0xF1, 0x5D, 0x81, 0xED, 0xD1, -0x83, 0xE4, 0xF0, 0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, 0x6C, 0xAD, 0x64, 0xAF, 0x6B, 0xAE, -0x6A, 0x12, 0x41, 0x9C, 0x8E, 0x68, 0x8F, 0x69, 0xD1, 0xAD, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x71, -0xFF, 0xE4, 0x93, 0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x69, 0x9F, 0xE5, 0x68, 0x9E, 0x40, 0x34, 0xD1, -0x9A, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x64, 0x12, 0xAC, 0x4D, 0xD1, 0xAD, 0xC3, 0x74, 0x01, 0x93, -0x95, 0x71, 0xFE, 0xE4, 0x93, 0x94, 0x00, 0x90, 0x95, 0x37, 0xF0, 0xA3, 0xCE, 0xF0, 0x90, 0x95, -0x35, 0xE5, 0x68, 0xF0, 0xA3, 0xE5, 0x69, 0xF0, 0xE4, 0x90, 0x95, 0x39, 0x12, 0x96, 0x53, 0x7B, -0x01, 0x80, 0x20, 0xF1, 0x0D, 0xC3, 0xE5, 0x69, 0x9F, 0xE5, 0x68, 0x94, 0x00, 0x50, 0x1A, 0xD1, -0x9A, 0xE4, 0xF0, 0x12, 0xAD, 0xA1, 0xF1, 0x03, 0x12, 0xAF, 0xD4, 0xEF, 0xF0, 0xE4, 0x12, 0x96, -0x52, 0x7B, 0x02, 0xFA, 0x12, 0xAF, 0xDB, 0x80, 0x54, 0x11, 0x3C, 0xD1, 0xAD, 0xE4, 0x93, 0xFF, -0x74, 0x01, 0x93, 0xF1, 0x8C, 0xF1, 0x03, 0xF1, 0x21, 0xEF, 0xF0, 0xD1, 0x9A, 0xD1, 0xBB, 0x7B, -0x03, 0x7A, 0x00, 0x12, 0xAF, 0xDB, 0xD1, 0x9A, 0xE0, 0x04, 0xF0, 0xE5, 0x66, 0x90, 0x81, 0xED, -0x93, 0x25, 0x70, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, 0x9A, 0xE0, 0xC3, 0x9F, 0xEE, 0xF1, 0xB1, 0x40, -0x1C, 0xD1, 0x9A, 0xE4, 0xF1, 0x0C, 0xD1, 0xAD, 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, -0x00, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x64, 0x12, 0xAF, 0x70, 0xF0, 0x75, 0xF0, 0x12, -0xE5, 0x64, 0x90, 0x89, 0x56, 0x12, 0x04, 0x6E, 0xE0, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x3A, 0xF1, -0x1B, 0xF1, 0x28, 0xAE, 0xF0, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xD1, 0xA6, 0x2F, -0xFF, 0xEE, 0xD1, 0xF4, 0xFE, 0x90, 0x00, 0x08, 0xD1, 0xFA, 0x90, 0x95, 0x28, 0xF0, 0xA3, 0xEF, -0xF0, 0x12, 0x03, 0x13, 0xFF, 0xC3, 0x90, 0x95, 0x29, 0xE0, 0x9F, 0xFE, 0x90, 0x95, 0x28, 0xE0, -0x95, 0xF0, 0x90, 0x95, 0x2A, 0xF0, 0xA3, 0xCE, 0xF0, 0xF1, 0x15, 0xFD, 0xAC, 0xF0, 0x25, 0xE0, -0xFF, 0xEC, 0x33, 0xFE, 0xEF, 0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0xD1, 0xA7, 0x25, 0xE0, 0xFF, 0xE5, -0xF0, 0x33, 0xFE, 0x90, 0x00, 0x02, 0xD1, 0xFA, 0xCF, 0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0xD1, 0xE8, -0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, 0xEC, 0x3E, 0x90, -0x95, 0x2C, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x26, 0xF1, 0x4A, 0xF1, 0x64, 0xD1, 0xDC, 0x50, -0x07, 0x90, 0x95, 0x26, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, -0xF1, 0x64, 0x12, 0xAF, 0x79, 0xF0, 0x90, 0x95, 0x28, 0xF1, 0x4A, 0xF1, 0x6C, 0xD1, 0xDC, 0x50, -0x07, 0x90, 0x95, 0x28, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, -0xF1, 0x6C, 0x12, 0xAF, 0x79, 0xF0, 0x90, 0x95, 0x2C, 0xF1, 0x4A, 0xF1, 0x74, 0xD1, 0xDC, 0x50, -0x07, 0x90, 0x95, 0x2C, 0xF1, 0x30, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x64, 0x25, 0xE0, -0xF1, 0x74, 0x12, 0xAF, 0x79, 0xF0, 0xC3, 0x74, 0xFF, 0x95, 0x6B, 0xFF, 0x74, 0xFF, 0x95, 0x6A, -0xFE, 0xF1, 0x95, 0xD1, 0xDC, 0x50, 0x0A, 0xE5, 0x6B, 0x2D, 0xFF, 0xE5, 0x6A, 0x3C, 0xFE, 0x80, -0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0xF1, 0x95, 0x12, 0xAF, 0x79, 0xF0, 0xF1, 0x7C, 0xFB, 0xC3, 0x74, -0xFF, 0x9B, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0x74, 0xFF, 0x94, 0x00, 0xFD, 0x74, 0xFF, 0x94, 0x00, -0xFC, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x65, 0xD3, 0x12, 0x03, 0xDA, 0x50, 0x11, 0xF1, 0x7C, 0xFF, -0xE4, 0xFC, 0xFD, 0x90, 0x8D, 0x71, 0x12, 0x86, 0x65, 0x12, 0x86, 0x30, 0x80, 0x06, 0x74, 0xFF, -0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0x8D, 0x71, 0x12, 0x04, 0x31, 0xF1, 0x5D, 0xE4, 0x90, 0x95, 0x35, -0xF0, 0x12, 0x96, 0x4E, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0xFF, 0x7F, 0x01, 0x12, 0xAE, 0xBF, -0x05, 0x64, 0x01, 0xA0, 0x22, 0xF0, 0x90, 0x95, 0x23, 0x12, 0x86, 0x71, 0x90, 0x00, 0x06, 0x12, -0x03, 0x3E, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, -0xFE, 0x90, 0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0x95, 0x39, 0xF0, -0xA3, 0xEF, 0xF0, 0x74, 0x28, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x12, -0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0x22, 0x74, 0xA6, 0x25, 0x64, 0xF5, 0x82, -0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xFE, 0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, 0xE5, 0x66, 0x25, -0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0x3B, -0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x90, 0x89, 0x55, 0x02, 0x04, -0x6E, 0x75, 0xF0, 0x12, 0xE5, 0x64, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, 0xF5, 0x83, 0xE0, 0xFC, -0xA3, 0xE0, 0xFD, 0xD3, 0x9F, 0xEC, 0x9E, 0x22, 0x90, 0x95, 0x23, 0x12, 0x86, 0x71, 0x90, 0x00, -0x08, 0x02, 0x03, 0x3E, 0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, -0x35, 0xF0, 0x22, 0x90, 0x95, 0x35, 0xE5, 0x68, 0xF0, 0xA3, 0xE5, 0x69, 0xF0, 0xE5, 0x66, 0x90, -0x81, 0x9D, 0x93, 0xFF, 0x22, 0x90, 0x00, 0x06, 0x02, 0x03, 0x3E, 0x90, 0x95, 0x23, 0x02, 0x86, -0x71, 0x90, 0x95, 0x39, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xED, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0x22, 0xEF, 0xC4, 0x54, 0xF0, -0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, -0x74, 0xFF, 0x9F, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0xE5, 0x64, 0x25, 0xE0, 0x22, 0x7D, 0x01, 0xAF, -0x64, 0x02, 0x61, 0xF7, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, 0x24, 0x26, 0xF5, 0x82, -0xE4, 0x34, 0x8E, 0x22, 0x24, 0x56, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, 0x90, 0x95, 0x2A, 0xE0, -0xFE, 0xA3, 0xE0, 0x22, 0xE5, 0x6A, 0xF0, 0xA3, 0xE5, 0x6B, 0xF0, 0x22, 0x90, 0x95, 0x37, 0xCF, -0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE5, 0x64, 0x25, 0xE0, 0x24, 0x86, 0xF5, 0x82, 0xE4, 0x34, 0x8E, -0x22, 0x74, 0xB6, 0x25, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, 0xD3, 0x9D, -0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xE4, 0xF5, 0x77, 0xEF, 0x14, 0xF5, 0x76, 0xED, -0xFF, 0xE5, 0x76, 0xF5, 0x82, 0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, -0xF8, 0x65, 0x83, 0x98, 0x40, 0x52, 0xE5, 0x76, 0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, -0x33, 0x95, 0xE0, 0xFE, 0xEB, 0x12, 0xAF, 0x4C, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, -0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xE5, 0x76, 0x12, 0xB3, 0xEA, 0x80, 0x05, 0xC3, -0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, -0x13, 0x85, 0x76, 0x78, 0x05, 0x77, 0x90, 0x95, 0x34, 0xE0, 0x65, 0x77, 0x60, 0x0A, 0xE5, 0x78, -0xD3, 0x9D, 0x40, 0x04, 0x15, 0x76, 0x80, 0x97, 0xAF, 0x78, 0x22, 0xEF, 0x64, 0x13, 0x60, 0x04, -0xEF, 0xB4, 0x0B, 0x05, 0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, -0x0A, 0x05, 0x90, 0x88, 0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, -0x90, 0x88, 0xE5, 0x80, 0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, 0x61, 0x22, 0x90, 0x93, -0x56, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, -0x93, 0x58, 0xF0, 0x90, 0x93, 0x56, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, -0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, -0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, 0x44, 0x07, 0xF0, -0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, -0x02, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8D, -0xC8, 0x7F, 0x20, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x8A, 0x75, 0x12, 0x8D, 0xDA, 0x90, 0x8A, 0xE5, -0x12, 0x8D, 0xC8, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, 0xAB, 0xF0, -0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, -0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, -0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x7B, -0x2E, 0x80, 0xFE, 0x22, 0xE4, 0xF5, 0x7B, 0xF5, 0x7C, 0xF5, 0x7D, 0x31, 0x23, 0xBF, 0x03, 0x02, -0x31, 0x33, 0x22, 0x90, 0x01, 0x02, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x31, 0x23, 0xBF, 0x03, 0x02, -0x31, 0x33, 0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, 0xF0, 0x22, 0xE4, 0xFF, 0x02, 0x35, 0xBE, -0x90, 0x8A, 0xDF, 0x12, 0xA1, 0x83, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x96, 0x2D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x96, 0x37, 0x12, 0x04, -0x31, 0x90, 0x96, 0x2F, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x37, 0x12, 0x86, 0x65, -0x12, 0x86, 0x4B, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x2F, 0x12, 0x04, -0xB8, 0x90, 0x96, 0x33, 0x12, 0x86, 0x65, 0x12, 0x86, 0x4B, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0x12, 0x86, 0x58, 0x90, 0x96, 0x3B, 0x12, 0x04, 0x31, 0x90, 0x96, 0x3B, 0x12, 0xB1, -0x50, 0x90, 0x96, 0x2D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x96, 0x5F, -0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, -0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0x96, 0x60, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x51, -0xA3, 0x70, 0x05, 0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, 0x51, 0xA5, 0x70, 0x0A, 0x90, -0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, 0x51, 0xA3, 0x70, 0x09, 0x90, -0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x51, 0xA5, 0x70, 0x3F, -0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, -0xEF, 0x54, 0x02, 0x51, 0xB8, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, -0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0x51, 0xB8, -0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, -0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0xC8, 0x7D, 0x11, 0xB1, 0x42, -0x12, 0x8D, 0xDA, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, 0xFF, -0x90, 0x8A, 0xF3, 0xB1, 0x0D, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x96, 0x5F, 0xE0, 0xFD, 0x70, -0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0x51, 0xB1, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, 0x5F, -0xE0, 0xFD, 0xB4, 0x02, 0x06, 0x51, 0xB1, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x51, -0xB1, 0xF0, 0x22, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0x60, 0x12, 0x86, 0x65, 0xC3, 0x02, 0x03, -0xDA, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0x60, -0x12, 0x04, 0x31, 0x90, 0x96, 0x60, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, -0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x94, 0x9D, 0xE0, 0x24, 0x46, 0xFF, 0x90, -0x94, 0x9C, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, -0x86, 0x3D, 0x90, 0x88, 0x85, 0x91, 0xDC, 0xEF, 0x24, 0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, -0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, 0x91, 0xDC, 0x90, 0x88, 0x85, 0x51, 0xAA, 0x50, 0x02, -0x61, 0xC4, 0x90, 0x88, 0x89, 0x12, 0x86, 0x65, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x86, -0x3D, 0x90, 0x95, 0xAF, 0x12, 0x04, 0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2C, 0x12, 0x9F, -0x15, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, -0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, -0x00, 0xFA, 0x91, 0xE5, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x1D, 0x90, 0x88, 0x33, 0xB1, 0x4E, 0x30, -0xE0, 0x02, 0x81, 0xC1, 0x91, 0xE5, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, -0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, 0x95, 0xAB, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, -0x90, 0x95, 0xAC, 0xE0, 0x94, 0xA0, 0x90, 0x95, 0xAB, 0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, -0xFB, 0x24, 0x5C, 0x91, 0xD4, 0xE0, 0x04, 0xF0, 0x90, 0x95, 0xAF, 0x12, 0x04, 0xB8, 0xEF, 0x54, -0x7F, 0xFF, 0x74, 0xFC, 0x2B, 0x91, 0xC9, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x95, -0xAB, 0xA3, 0xE0, 0x91, 0xC7, 0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, -0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, -0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x81, 0xC1, 0xE4, 0xFF, 0xFE, 0x91, 0xD1, 0xE0, 0x2F, -0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x95, 0xAD, 0xEE, 0xF0, -0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x91, 0xF0, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, 0xAD, -0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, 0x91, 0xD1, 0xE0, 0x2F, 0xFF, 0x91, 0xF0, -0x40, 0x07, 0x90, 0x95, 0xAE, 0xEE, 0xF0, 0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, -0xFF, 0x91, 0xC2, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, -0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, 0xAE, 0xE0, 0x80, 0x18, 0x91, 0xC2, 0xE0, 0xFD, 0xC3, -0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x95, -0xAE, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, -0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, -0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, -0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, -0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, -0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0xB1, 0x55, -0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, 0xA3, 0x12, 0x8D, 0xC8, 0xE4, 0xFF, 0x12, 0x04, -0x7E, 0x22, 0x90, 0x95, 0xAD, 0xE0, 0xFE, 0x24, 0xFC, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -0x22, 0x74, 0x5C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, -0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x95, 0xAF, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, -0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, -0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x22, 0xFF, 0x90, 0x8A, 0xF9, 0xE0, 0xFC, 0xA3, -0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0xE4, 0xFE, 0x91, 0xD1, 0xE4, 0xF0, 0x74, 0xFC, 0x2E, 0x91, -0xC9, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, -0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, -0xF0, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, -0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, -0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, 0x94, 0x9E, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, -0xFF, 0x7F, 0xFF, 0x80, 0x20, 0xB1, 0xB1, 0xB1, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x12, 0xA4, 0xCB, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x12, 0xA4, -0xCB, 0x12, 0xB6, 0x17, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, -0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x12, 0xB7, 0xA2, 0xB1, 0xAA, 0x90, 0x07, 0xC3, 0xE0, 0x30, -0xE5, 0xF9, 0xED, 0x54, 0x03, 0x24, 0xC8, 0x12, 0xA4, 0xCB, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x7D, 0x12, 0xB7, 0x9D, 0xD1, 0x48, -0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, 0xEF, -0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, 0xF0, -0x80, 0x24, 0xD1, 0x48, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, 0xC2, -0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, 0xF0, -0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, -0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, 0x96, 0x7E, 0xE0, 0x54, 0x03, -0xFF, 0x22, 0x90, 0x95, 0x23, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, -0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0xD1, -0x7F, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x04, 0xD1, 0x7F, 0x5F, 0xFF, 0x22, 0x74, -0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x22, 0x12, 0x97, 0xF3, 0xE4, 0xA3, -0xF0, 0xA3, 0xF0, 0x90, 0x93, 0x0A, 0x12, 0x96, 0x53, 0x90, 0x93, 0x25, 0xF0, 0xA3, 0xF0, 0xA3, -0xF0, 0x22, 0x90, 0x04, 0x24, 0xEF, 0xF0, 0x90, 0x04, 0x57, 0xF0, 0x22, 0x90, 0x93, 0x0E, 0xE0, -0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x02, 0x92, 0xED, 0x4C, 0x70, 0x05, -0x90, 0x93, 0x1B, 0x80, 0x2A, 0xED, 0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1C, 0x80, 0x1F, -0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1D, 0x80, 0x14, 0xED, 0x64, 0x03, 0x4C, 0x70, -0x05, 0x90, 0x93, 0x1E, 0x80, 0x09, 0xED, 0x64, 0x04, 0x4C, 0x70, 0x0D, 0x90, 0x93, 0x1F, 0xE0, -0xFF, 0xD1, 0xA2, 0x90, 0x93, 0x0F, 0x12, 0x9F, 0xC0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, -0x30, 0xE0, 0x12, 0x75, 0x0E, 0x10, 0x80, 0x40, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, -0x75, 0x0E, 0x01, 0x80, 0x33, 0x90, 0x88, 0x31, 0x12, 0xA1, 0xE4, 0x30, 0xE0, 0x05, 0x75, 0x0E, -0x02, 0x80, 0x25, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0E, 0x08, 0x80, -0x17, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x0B, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x05, 0x75, 0x0E, -0x11, 0x80, 0x05, 0x12, 0xB5, 0xC7, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, -0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x1F, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x06, 0x75, -0x0F, 0x40, 0x02, 0xD0, 0x16, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, -0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, -0x75, 0x0F, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x0F, -0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x0F, 0x04, -0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, -0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x3F, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, -0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x2F, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x80, -0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, 0x0F, 0x11, 0x80, 0x18, 0x90, 0x06, -0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, 0x0F, 0x12, 0x80, -0x05, 0x12, 0xB5, 0xC7, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, -0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, -0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x11, -0x84, 0x40, 0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, -0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, -0xA2, 0x90, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, -0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, -0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xBF, 0x87, 0xE0, 0x90, 0x94, 0x9E, 0xF0, 0x90, -0x88, 0x32, 0xE0, 0x12, 0x8F, 0xCA, 0x30, 0xE0, 0x02, 0x21, 0x59, 0x90, 0x88, 0x31, 0xE0, 0x30, -0xE0, 0x1D, 0x12, 0x9F, 0x15, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, -0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, -0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, -0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, -0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, -0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, -0x88, 0x4B, 0x31, 0x65, 0x90, 0x88, 0x4E, 0x12, 0xC7, 0xAD, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, -0x90, 0x88, 0x4E, 0x31, 0x65, 0x90, 0x88, 0x3E, 0x12, 0xC7, 0xAD, 0x40, 0x04, 0xEF, 0x24, 0x50, -0xF0, 0x90, 0x88, 0x4E, 0x12, 0xA1, 0xE4, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, -0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0x31, 0x6E, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0x90, 0x88, -0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, -0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x2B, 0x90, 0x95, 0xF3, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x15, 0x74, -0x01, 0xF0, 0x90, 0x95, 0xF5, 0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xF3, 0x90, 0x8A, 0x77, -0x12, 0x9F, 0xE9, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0xC8, 0x7F, 0x04, 0x12, 0x04, -0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x34, 0xC4, 0x13, 0x54, -0x07, 0x30, 0xE0, 0x2D, 0x90, 0x96, 0x86, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0xC8, 0x40, 0x21, -0x90, 0x93, 0x29, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x96, 0x86, 0xF0, 0x90, 0x93, 0x29, 0xE0, -0x13, 0x30, 0xE0, 0x0D, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x88, 0x41, 0x74, 0xD0, -0xF0, 0x22, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, -0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, -0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, -0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x77, 0xF5, 0x82, -0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0xF5, 0x83, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0x22, 0xE0, 0x90, -0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, 0x2B, -0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, -0x54, 0x0F, 0x22, 0xED, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0x12, 0x02, 0x06, 0x13, -0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x3C, -0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x00, 0x82, 0xDC, - -}; -u4Byte ArrayLength_MP_8723D_FW_AP = 21184; - -#endif - -void -ODM_ReadFirmware_MP_8723D_FW_AP( - IN PDM_ODM_T pDM_Odm, - OUT u1Byte *pFirmware, - OUT u4Byte *pFirmwareSize -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_ap; -#else - ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_ap, array_length_mp_8723d_fw_ap); -#endif - *pFirmwareSize = array_length_mp_8723d_fw_ap; -} - - -#endif /* #if (defined(CONFIG_AP_WOWLAN)||(DM_ODM_SUPPORT_TYPE & (ODM_AP)) */ - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8723d_fw_nic[] = { -0xD1, 0x23, 0x10, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x16, 0x12, 0x64, 0x02, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x02, 0x86, 0x75, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xBC, 0x29, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC8, 0x27, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC6, 0x90, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xC6, 0xE0, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC7, 0xD1, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x15, 0xF0, 0xFF, 0x0F, 0x00, 0x00, 0x00, 0x15, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x05, 0xF0, -0xFF, 0x0F, 0x00, 0x00, 0x00, 0x05, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x10, 0xF0, 0xFF, 0x0F, -0x00, 0x00, 0x00, 0x10, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0xF5, 0x0F, 0x00, 0x00, 0x00, 0x00, -0x00, 0xF0, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0A, -0x08, 0x03, 0x03, 0x00, 0x04, 0x09, 0x07, 0x03, 0x03, 0x00, 0x04, 0x08, 0x06, 0x03, 0x02, 0x00, -0x04, 0x08, 0x05, 0x03, 0x01, 0x00, 0x04, 0x0D, 0x0A, 0x07, 0x05, 0x00, 0x08, 0x0C, 0x0A, 0x07, -0x04, 0x00, 0x08, 0x0B, 0x0A, 0x06, 0x05, 0x00, 0x08, 0x0B, 0x0A, 0x05, 0x03, 0x00, 0x08, 0x0B, -0x0A, 0x03, 0x02, 0x00, 0x08, 0x14, 0x12, 0x0C, 0x04, 0x00, 0x10, 0x14, 0x12, 0x09, 0x04, 0x00, -0x10, 0x24, 0x22, 0x1C, 0x12, 0x00, 0x20, 0x24, 0x22, 0x18, 0x0C, 0x00, 0x20, 0x24, 0x22, 0x14, -0x06, 0x00, 0x20, 0x24, 0x22, 0x0F, 0x04, 0x00, 0x20, 0x24, 0x21, 0x0A, 0x04, 0x00, 0x20, 0x23, -0x21, 0x0C, 0x04, 0x00, 0x20, 0x23, 0x1F, 0x0A, 0x04, 0x00, 0x20, 0x22, 0x1F, 0x0F, 0x04, 0x00, -0x20, 0x21, 0x1F, 0x16, 0x0C, 0x00, 0x20, 0x31, 0x2F, 0x20, 0x14, 0x00, 0x30, 0x31, 0x2F, 0x18, -0x10, 0x00, 0x30, 0x31, 0x2C, 0x18, 0x0C, 0x00, 0x30, 0x31, 0x2A, 0x14, 0x0C, 0x00, 0x30, 0x31, -0x28, 0x14, 0x00, 0x00, 0x30, 0x31, 0x24, 0x14, 0x00, 0x00, 0x30, 0x31, 0x1E, 0x14, 0x00, 0x00, -0x30, 0x04, 0x04, 0x04, 0x05, 0x08, 0x08, 0x09, 0x09, 0x0C, 0x0E, 0x10, 0x12, 0x06, 0x0B, 0x0D, -0x0E, 0x0F, 0x11, 0x12, 0x14, 0x00, 0x04, 0x00, 0x04, 0x00, 0x08, 0x00, 0x10, 0x00, 0x23, 0x00, -0x2D, 0x00, 0x50, 0x00, 0x91, 0x00, 0xC3, 0x01, 0x27, 0x01, 0x31, 0x01, 0x5E, 0x00, 0xC8, 0x00, -0xF0, 0x00, 0xDC, 0x01, 0x5E, 0x01, 0x68, 0x01, 0x9A, 0x01, 0xCC, 0x01, 0xEA, 0x02, 0x02, 0x04, -0x08, 0x0C, 0x12, 0x18, 0x24, 0x30, 0x48, 0x60, 0x6C, 0x14, 0x28, 0x32, 0x50, 0x78, 0xA0, 0xC8, -0xE6, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x02, 0x02, 0x03, 0x03, 0x04, 0x04, 0x02, 0x04, 0x06, -0x07, 0x07, 0x08, 0x08, 0x08, 0x01, 0x01, 0x01, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x02, -0x02, 0x03, 0x03, 0x04, 0x05, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, 0x03, 0x03, 0x03, -0x02, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, -0x02, 0x19, 0x06, 0x04, 0x02, 0x00, 0x18, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -0xEC, 0x24, 0x8B, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x8A, 0x25, 0x0C, 0xF8, -0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -0x0C, 0x24, 0x8B, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x8A, -0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x8A, 0xA6, -0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x86, 0xF8, 0x74, 0x01, 0x93, -0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x8A, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x8A, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -0x04, 0x90, 0x86, 0xF8, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x8A, 0x2F, -0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x8A, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x8B, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -0x0F, 0x74, 0x8A, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, -0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, -0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xE8, 0x8F, 0xF0, 0xA4, 0xCC, 0x8B, 0xF0, 0xA4, -0x2C, 0xFC, 0xE9, 0x8E, 0xF0, 0xA4, 0x2C, 0xFC, 0x8A, 0xF0, 0xED, 0xA4, 0x2C, 0xFC, 0xEA, 0x8E, -0xF0, 0xA4, 0xCD, 0xA8, 0xF0, 0x8B, 0xF0, 0xA4, 0x2D, 0xCC, 0x38, 0x25, 0xF0, 0xFD, 0xE9, 0x8F, -0xF0, 0xA4, 0x2C, 0xCD, 0x35, 0xF0, 0xFC, 0xEB, 0x8E, 0xF0, 0xA4, 0xFE, 0xA9, 0xF0, 0xEB, 0x8F, -0xF0, 0xA4, 0xCF, 0xC5, 0xF0, 0x2E, 0xCD, 0x39, 0xFE, 0xE4, 0x3C, 0xFC, 0xEA, 0xA4, 0x2D, 0xCE, -0x35, 0xF0, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, 0xFD, -0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, 0xFC, -0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, 0xA3, -0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, 0xD0, -0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, -0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, -0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x02, 0x86, 0xB3, 0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, -0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, -0xF8, 0x54, 0x07, 0x24, 0x0C, 0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, -0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, -0x20, 0x40, 0x80, 0x90, 0x86, 0xFE, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, -0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, -0xE0, 0x60, 0xA8, 0x40, 0xB8, 0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, -0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, -0x83, 0xCA, 0xDF, 0xE9, 0xDE, 0xE7, 0x80, 0xBE, 0xC1, 0x5D, 0xC5, 0x66, 0x8A, 0x51, 0x41, 0x96, -0xFD, 0x00, 0x00, 0x90, 0x96, 0xFB, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, 0x90, 0x86, 0xAF, 0xE0, -0xFF, 0x90, 0x96, 0xFB, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, 0x90, 0x02, 0x09, -0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, 0xB4, 0xF1, 0xA0, 0xFF, -0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0x6B, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0x12, 0xB8, 0x9D, -0xED, 0x2F, 0x90, 0x86, 0xB7, 0xF1, 0x98, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, 0xF1, 0x64, 0xFF, -0xED, 0x2F, 0x90, 0x86, 0xB9, 0x12, 0x9F, 0xEE, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, -0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x02, 0x02, -0x02, 0x1F, 0x12, 0xA0, 0xC2, 0x90, 0x93, 0x60, 0xF1, 0xA0, 0x90, 0x93, 0x61, 0xF1, 0x6B, 0x90, -0x93, 0x7B, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0x90, 0x93, 0x7C, 0xF1, 0x98, 0x90, 0x93, -0x96, 0xF1, 0x64, 0x90, 0x93, 0x97, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0x4F, -0xF0, 0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0x12, 0x9F, 0xE1, 0x12, 0x02, 0x06, 0xFF, 0xF1, 0xA1, -0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0xC0, 0x03, 0xF1, 0xF5, 0xF1, 0x6C, -0x12, 0xE2, 0xB7, 0xD0, 0x03, 0x12, 0x8F, 0x42, 0xF1, 0xF5, 0xF1, 0xA1, 0xFE, 0x54, 0x03, 0x12, -0x8B, 0x8E, 0x90, 0x95, 0x36, 0x74, 0x10, 0xF0, 0x90, 0x95, 0x58, 0x74, 0x07, 0xF1, 0xF4, 0x12, -0x02, 0x06, 0x90, 0x95, 0x38, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x36, 0x12, 0x90, 0x2E, 0x7F, -0x04, 0x02, 0x04, 0x7E, 0xF0, 0x90, 0x95, 0x33, 0xC1, 0x3D, 0x12, 0x9F, 0xE1, 0x90, 0x93, 0xE1, -0xE0, 0x70, 0x13, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, -0x90, 0x93, 0xE7, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xE3, 0xE0, 0x70, 0x13, 0x12, 0x87, 0xF5, 0x12, -0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, 0xE8, 0x74, 0x01, 0xF0, 0x12, -0x87, 0xF5, 0x12, 0x87, 0xA1, 0xFF, 0x90, 0x95, 0x37, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, -0xE0, 0x0C, 0x12, 0x87, 0xF5, 0x12, 0x87, 0x6C, 0x90, 0x95, 0x38, 0xF0, 0x80, 0x05, 0x90, 0x95, -0x38, 0xEF, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x90, 0x95, 0x38, 0xE0, 0xFE, -0x90, 0x95, 0x36, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x37, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0x54, -0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x95, -0x36, 0x70, 0x06, 0xE0, 0xFF, 0xF1, 0xE5, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xB8, 0xBC, 0x90, 0x93, -0xE8, 0xE0, 0x60, 0x07, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0xF1, 0xE5, 0x12, 0xE3, 0x7B, 0x80, 0xBB, -0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x95, 0x37, 0xE0, 0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, -0x70, 0x13, 0x90, 0x86, 0x0C, 0x11, 0xD0, 0x90, 0x8A, 0xED, 0x11, 0xD0, 0x12, 0xE3, 0xD6, 0x54, -0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0x9A, 0x2E, 0x90, 0x8A, 0xFD, -0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x96, 0xFF, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x30, 0xE0, 0x02, 0x41, 0x4C, 0xEE, 0x12, 0xA9, 0xA5, 0x30, 0xE0, 0x02, 0x41, 0x4C, 0x90, 0x88, -0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0x41, 0x4C, 0xEF, 0x70, 0x02, 0x21, 0xA8, 0x24, 0xFE, 0x70, -0x02, 0x21, 0xED, 0x24, 0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0x41, 0x32, 0x24, 0xFC, 0x60, -0x02, 0x41, 0x45, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, -0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x04, 0x11, 0x90, 0x96, 0xFF, 0xE0, 0xFF, 0x60, 0x05, 0x12, 0x67, 0x80, -0x80, 0x05, 0x90, 0x8A, 0xED, 0x11, 0xD0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, 0x60, 0x02, 0x41, -0x45, 0x12, 0x7B, 0xCC, 0x41, 0x45, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, -0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, -0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, -0xE0, 0x64, 0x0C, 0x60, 0x02, 0x41, 0x45, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xEF, 0x64, 0x01, 0x60, -0x02, 0x41, 0x45, 0x12, 0x68, 0xC2, 0x41, 0x45, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, -0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, -0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, -0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x67, 0x90, 0x86, -0x02, 0x11, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x5D, 0x12, 0x73, 0x5A, 0x80, 0x58, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, -0x90, 0x86, 0x00, 0x11, 0xD0, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, -0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x18, 0x12, 0x7A, 0x49, -0x80, 0x13, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x88, 0x32, 0x12, 0x9F, 0xE7, 0x30, -0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0x12, 0xE3, 0x2C, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, 0x95, 0xB3, 0xEF, 0xF0, 0x60, -0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, -0xE0, 0x0F, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, 0x35, 0xBE, 0x12, 0xD5, -0x7A, 0x51, 0xAC, 0x30, 0xE1, 0x08, 0x54, 0xFD, 0xF0, 0x90, 0x86, 0x08, 0x11, 0xD0, 0x51, 0xAC, -0x30, 0xE2, 0x08, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x11, 0xD0, 0x51, 0xAC, 0x30, 0xE6, 0x08, -0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, 0x11, 0xD0, 0xD2, 0xAF, 0x80, 0xB5, 0xD2, 0xAF, 0xC2, 0xAF, -0x90, 0x86, 0xAF, 0xE0, 0x22, 0x11, 0xCD, 0xEF, 0x70, 0x02, 0xFF, 0x22, 0xF1, 0x18, 0x90, 0x93, -0xAC, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, 0x54, 0xF1, 0xFF, 0xEE, 0x04, -0x54, 0x07, 0x25, 0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x12, 0xE3, 0x71, 0xB5, 0x07, 0x04, 0xEE, -0x54, 0xF1, 0xF0, 0xF1, 0x18, 0xF5, 0x7F, 0xE4, 0x90, 0x93, 0x5A, 0xF0, 0xE5, 0x7F, 0x75, 0xF0, -0x1B, 0xA4, 0x24, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x30, 0xE0, 0x28, 0x71, -0x82, 0xE0, 0x24, 0xAF, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFF, 0xE5, 0x7F, 0xF1, -0x34, 0xEF, 0x71, 0x81, 0xE0, 0x04, 0x71, 0x81, 0xE0, 0xFF, 0x90, 0x93, 0xAE, 0xE0, 0xFE, 0xEF, -0xB5, 0x06, 0x04, 0x71, 0x82, 0xE4, 0xF0, 0xE5, 0x7F, 0xF1, 0x34, 0xE0, 0xFC, 0x90, 0x93, 0xAC, -0xE0, 0xF1, 0x34, 0xE0, 0x6C, 0x60, 0x13, 0xE5, 0x7F, 0x12, 0x9B, 0x7C, 0x12, 0xE2, 0xAA, 0xAF, -0x04, 0xF1, 0x42, 0xE5, 0x7F, 0x12, 0x9B, 0x7C, 0x71, 0x8E, 0xE5, 0x7F, 0xF1, 0xD6, 0x54, 0x07, -0xFF, 0x60, 0x03, 0xBF, 0x02, 0x10, 0xE5, 0x7F, 0x12, 0x98, 0x24, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, -0x04, 0xE4, 0xFD, 0x12, 0x9A, 0x39, 0xAD, 0x7F, 0x7F, 0x01, 0x12, 0x9A, 0xDE, 0x90, 0x93, 0xAD, -0xE0, 0xC3, 0x13, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x05, 0xE4, 0xFF, 0x12, 0x9F, 0xF5, 0x7F, 0x01, -0x22, 0xF0, 0x74, 0xD2, 0x25, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xFF, 0xEE, -0x13, 0x13, 0x54, 0x07, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF5, 0xED, -0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0x81, 0x79, 0x90, 0x06, 0x03, 0xE0, 0x54, 0xFB, -0xF0, 0x90, 0x96, 0xF5, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, 0x54, -0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xDE, 0x54, 0x90, 0x96, 0xF6, 0xEF, 0xF0, 0x90, 0x04, -0x83, 0xF0, 0x90, 0x96, 0xA1, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0x45, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, -0x96, 0xA5, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, 0xB1, 0x49, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0x90, 0x96, 0xF5, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, -0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0xF1, 0x21, 0x7F, 0x00, 0x7E, 0x0A, 0xB1, 0x49, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xF5, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, -0x78, 0x0A, 0xF1, 0x21, 0x7F, 0x00, 0x7E, 0x0D, 0xB1, 0x49, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, -0x00, 0x90, 0x96, 0xF6, 0xB1, 0x68, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0x21, 0x7F, -0x18, 0xB1, 0x47, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x00, 0xF1, 0x2A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x93, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x58, 0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, 0xF0, -0x90, 0x96, 0xA1, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x00, 0xB1, 0x45, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xA5, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x09, 0xB1, 0x49, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xA5, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xF1, 0x2A, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0x93, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, -0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xDD, 0xCA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x9F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, -0x70, 0x90, 0x96, 0xA9, 0x12, 0x04, 0x31, 0x90, 0x96, 0xA1, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, -0x90, 0x96, 0xA9, 0xF1, 0xBA, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xA1, -0x12, 0x04, 0xB8, 0x90, 0x96, 0xA5, 0xF1, 0xBA, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x86, 0x24, 0x90, 0x96, 0xAD, 0x12, 0x04, 0x31, 0x90, 0x96, 0xAD, 0x12, 0x04, 0xB8, 0x90, -0x92, 0x18, 0x12, 0x04, 0x31, 0x90, 0x96, 0x9F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x00, 0x7E, 0x08, 0x91, 0xDF, 0x90, 0x96, 0xA1, 0x22, 0x90, -0x05, 0x61, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, -0x05, 0xAA, 0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x90, -0x93, 0x58, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0x17, 0x90, 0x93, 0xDA, 0xE0, 0x04, 0xF0, 0xF1, 0x18, -0x04, 0xFF, 0x90, 0x96, 0x1B, 0xF0, 0x90, 0x93, 0x59, 0xE0, 0xB5, 0x07, 0x05, 0xE4, 0x90, 0x96, -0x1B, 0xF0, 0x90, 0x93, 0xD8, 0xE0, 0xFF, 0x60, 0x1A, 0x90, 0x96, 0x1B, 0xF1, 0xC3, 0xE0, 0xC3, -0x9F, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xFB, 0xFD, 0x7F, 0x50, 0x7E, 0x01, -0x12, 0x66, 0x33, 0x90, 0x96, 0x1B, 0xE0, 0xFF, 0xF1, 0xD6, 0x54, 0x07, 0xFE, 0x64, 0x02, 0x60, -0x03, 0xEE, 0x70, 0x11, 0xEF, 0xF1, 0xC4, 0xE0, 0x24, 0xFC, 0xFF, 0xE4, 0x90, 0x92, 0x20, 0xF0, -0xA3, 0xEF, 0x12, 0xA6, 0x13, 0x90, 0x93, 0x58, 0xE0, 0xF1, 0xD2, 0x54, 0x07, 0xFF, 0x14, 0x60, -0x0F, 0x14, 0x60, 0x07, 0x14, 0x60, 0x09, 0x24, 0x03, 0x70, 0x0B, 0x12, 0x9B, 0x8E, 0x80, 0x03, -0x12, 0x9A, 0x23, 0x12, 0x98, 0x32, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0x90, 0x93, 0xDA, 0xE0, 0xD3, -0x9F, 0x40, 0x02, 0xE1, 0x17, 0xB1, 0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0x90, 0x05, 0x62, 0xB1, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -0xB1, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x86, 0x24, 0x90, 0x96, 0x1C, 0x12, 0x04, 0x31, 0x90, 0x05, 0x65, 0xB1, 0x68, 0x12, 0xCF, 0xCA, -0x90, 0x05, 0x64, 0xB1, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -0x90, 0x05, 0x66, 0xB1, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0xB1, 0x68, -0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, -0x90, 0x96, 0x20, 0x12, 0x04, 0x31, 0x90, 0x96, 0x1B, 0xF1, 0xC3, 0xB1, 0x68, 0x12, 0xE3, 0x82, -0x90, 0x96, 0x1C, 0x12, 0x86, 0x31, 0x12, 0x85, 0xAD, 0x90, 0x96, 0x24, 0x12, 0x04, 0x31, 0x90, -0x96, 0x1C, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x24, 0x12, 0xCF, 0xD8, 0x50, 0x0C, 0x90, 0x96, 0x20, -0x12, 0xCC, 0xA6, 0x90, 0x96, 0x20, 0x12, 0x04, 0x31, 0x90, 0x96, 0x20, 0x12, 0xCF, 0xC2, 0x90, -0x05, 0x8B, 0xEF, 0xF0, 0x90, 0x96, 0x20, 0x12, 0xCF, 0xAE, 0x90, 0x05, 0x8A, 0xEF, 0xF0, 0x90, -0x96, 0x20, 0x12, 0xCF, 0xA6, 0x90, 0x05, 0x89, 0xEF, 0xF0, 0x90, 0x96, 0x20, 0x12, 0xE3, 0x8A, -0x90, 0x96, 0x24, 0x12, 0xCF, 0xC2, 0x90, 0x05, 0x87, 0xEF, 0xF0, 0x90, 0x96, 0x24, 0x12, 0xCF, -0xAE, 0x90, 0x05, 0x86, 0xEF, 0xF0, 0x90, 0x96, 0x24, 0x12, 0xCF, 0xA6, 0x90, 0x05, 0x85, 0xEF, -0xF0, 0x90, 0x96, 0x24, 0x12, 0xE2, 0xD4, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, -0x22, 0x12, 0x03, 0xFE, 0x90, 0x96, 0xA5, 0x02, 0x04, 0x31, 0x7F, 0x84, 0x7E, 0x08, 0x91, 0xDF, -0x90, 0x96, 0x8F, 0x22, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xE1, 0xEF, 0xF0, 0xED, 0x64, -0x01, 0x70, 0x31, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x0E, 0x80, 0x08, 0x90, 0x96, -0xE1, 0xE0, 0x24, 0xFE, 0xF5, 0x0E, 0x90, 0x96, 0x8F, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, -0xAF, 0x0E, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0xDE, 0x42, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, -0xAF, 0x0E, 0x80, 0x1E, 0x90, 0x96, 0x8F, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, -0xE1, 0xB1, 0x68, 0x12, 0xDE, 0x42, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x96, 0xE1, -0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x96, 0x93, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, -0x7F, 0x01, 0x12, 0xDD, 0xCA, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x86, 0x31, 0x02, 0x86, 0x17, -0x90, 0x96, 0x2A, 0xE0, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5D, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0x22, 0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0xE0, 0x22, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0xEF, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x44, 0x7F, 0x6F, -0x12, 0x04, 0x7E, 0x12, 0x88, 0xCD, 0x90, 0x96, 0xF0, 0xE0, 0x90, 0x96, 0xEF, 0xB4, 0x01, 0x0A, -0xE0, 0x12, 0xAE, 0x93, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x08, 0xE0, 0x12, 0xAE, 0x93, 0xE0, 0x54, -0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x8A, -0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, -0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, 0x95, 0x33, 0xEF, 0xF0, 0x51, 0x85, -0x12, 0xE3, 0xFA, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7C, 0xF0, 0x51, 0x85, -0x12, 0xE3, 0xF3, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7D, 0xF0, 0x51, 0x85, -0x12, 0xE3, 0xEC, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x7E, 0xF0, 0x51, 0x85, -0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, -0x7F, 0xF0, 0x51, 0x85, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -0x7A, 0xE0, 0x90, 0x95, 0x80, 0xF0, 0x51, 0x85, 0x12, 0xC3, 0x5A, 0xBF, 0x01, 0x08, 0x90, 0x95, -0x7A, 0xE0, 0x90, 0x95, 0x81, 0xF0, 0x51, 0x85, 0x7F, 0xFB, 0xF1, 0x97, 0x70, 0x52, 0x90, 0x95, -0x7A, 0xE0, 0x90, 0x95, 0x82, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0xE0, -0x70, 0x3E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x7B, 0x7F, 0xFA, 0xF1, 0x97, 0x70, 0x32, 0x90, 0x95, -0x7A, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x95, 0x82, 0xE0, 0xFE, 0x90, 0x95, 0x7B, 0xE0, -0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x95, 0x82, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x95, -0x82, 0xE0, 0xFF, 0x90, 0x95, 0x7B, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x95, 0x82, 0xF0, -0x51, 0x85, 0x7F, 0xFD, 0xF1, 0x97, 0x70, 0x47, 0x90, 0x95, 0x7A, 0xE0, 0xFE, 0x54, 0xCC, 0x90, -0x95, 0x83, 0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0xC0, 0x70, -0x2E, 0xEF, 0x70, 0x12, 0x90, 0x95, 0x83, 0xE0, 0xFF, 0x90, 0x95, 0x7A, 0xE0, 0x54, 0x03, 0x12, -0xE3, 0xBE, 0x90, 0x95, 0x83, 0xF0, 0x90, 0x95, 0x7A, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, -0x95, 0x83, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x51, -0x85, 0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, -0x95, 0x84, 0xF0, 0x51, 0x85, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -0x95, 0x7A, 0xE0, 0x90, 0x95, 0x85, 0xF0, 0x51, 0x85, 0x12, 0xE3, 0xE5, 0xBF, 0x01, 0x08, 0x90, -0x95, 0x7A, 0xE0, 0x90, 0x95, 0x86, 0xF0, 0x51, 0x85, 0x12, 0xE3, 0xDE, 0xBF, 0x01, 0x08, 0x90, -0x95, 0x7A, 0xE0, 0x90, 0x95, 0x87, 0xF0, 0x51, 0x85, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -0xBF, 0x01, 0x08, 0x90, 0x95, 0x7A, 0xE0, 0x90, 0x95, 0x88, 0xF0, 0x90, 0x95, 0x34, 0x74, 0x19, -0xF0, 0x90, 0x95, 0x56, 0x74, 0x08, 0xF0, 0x90, 0x95, 0x7C, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x90, -0x95, 0x7D, 0xE0, 0x90, 0x95, 0x37, 0xF0, 0x90, 0x95, 0x7E, 0xE0, 0x90, 0x95, 0x38, 0xF0, 0x90, -0x95, 0x7F, 0xE0, 0x90, 0x95, 0x39, 0xF0, 0x90, 0x95, 0x80, 0xE0, 0x90, 0x95, 0x3A, 0xF0, 0x90, -0x95, 0x81, 0xE0, 0x90, 0x95, 0x3B, 0xF0, 0x90, 0x95, 0x82, 0xE0, 0x90, 0x95, 0x3C, 0xF0, 0x90, -0x95, 0x83, 0xE0, 0x90, 0x95, 0x3D, 0xF0, 0x90, 0x95, 0x57, 0x74, 0x1A, 0xF0, 0x90, 0x95, 0x79, -0x74, 0x05, 0xF0, 0x90, 0x95, 0x84, 0xE0, 0x90, 0x95, 0x59, 0xF0, 0x90, 0x95, 0x85, 0xE0, 0x90, -0x95, 0x5A, 0xF0, 0x90, 0x95, 0x86, 0xE0, 0x90, 0x95, 0x5B, 0xF0, 0x90, 0x95, 0x87, 0xE0, 0x90, -0x95, 0x5C, 0xF0, 0x90, 0x95, 0x88, 0xE0, 0x90, 0x95, 0x5D, 0xF0, 0x90, 0x95, 0x33, 0xE0, 0xB4, -0x01, 0x19, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x34, 0x12, 0xB9, 0x53, 0x12, 0x04, 0x7E, 0x7B, 0x01, -0x7A, 0x95, 0x79, 0x57, 0x11, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, -0x95, 0x75, 0x47, 0x34, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, -0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x59, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, -0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x7A, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x12, 0x9F, 0xE1, 0x12, 0x87, 0xF5, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, -0x48, 0x05, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x12, 0x87, 0xF5, 0x12, 0x02, -0x06, 0x20, 0xE0, 0x02, 0x81, 0x22, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, -0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, -0x87, 0xA1, 0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0x12, 0x87, 0x6B, 0x90, 0x88, -0x9F, 0xF0, 0x80, 0x4B, 0x12, 0x87, 0xA1, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, -0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0D, 0x12, 0x87, 0xA1, 0x90, 0x88, 0x9E, -0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, -0x6C, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, -0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, -0x9C, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, -0x88, 0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, -0x90, 0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, -0x9F, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, -0x02, 0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0x12, 0x87, 0xF4, 0x12, 0xE3, 0x46, 0x20, 0xE0, -0x37, 0x90, 0x88, 0x9D, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x28, -0x12, 0xE3, 0xA5, 0x30, 0xE0, 0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, -0xDF, 0xE0, 0x60, 0x05, 0x75, 0x61, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x8A, 0xF3, 0x11, -0x40, 0x7D, 0x02, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, -0xE0, 0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, -0x11, 0x40, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0xE4, 0x01, 0x74, 0x11, 0xF0, 0xF1, -0xED, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, -0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, -0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, -0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, -0x80, 0x67, 0x12, 0x87, 0xF5, 0x12, 0xE3, 0x46, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x02, 0x80, 0x0E, -0x12, 0xE3, 0xA5, 0x30, 0xE0, 0x05, 0x75, 0x62, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x62, 0x90, 0x8A, -0xF1, 0x12, 0x88, 0xD0, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, 0x7D, 0xAC, 0x80, 0x02, 0x7D, -0x2C, 0x7F, 0x40, 0x12, 0x7B, 0x2E, 0x12, 0x87, 0xF5, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0x13, -0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, -0x90, 0x8A, 0xF3, 0x11, 0x40, 0xAD, 0x62, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x11, -0x40, 0xF1, 0x91, 0x12, 0xE4, 0x01, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, -0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, 0x88, 0xA0, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x09, 0x90, 0x88, -0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0x11, 0x40, 0x7F, 0x01, 0x12, 0x04, -0x7E, 0x90, 0x88, 0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0x11, 0x40, 0x7F, 0x03, 0x12, -0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8B, 0x61, 0x8A, 0x62, -0x89, 0x63, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x64, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, -0x01, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x69, 0xF5, 0x12, 0x9D, 0xEE, 0xFF, 0xC3, 0x13, -0x20, 0xE0, 0x02, 0xA1, 0x91, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x73, 0x12, 0xE4, 0x09, 0x75, -0x64, 0x21, 0x12, 0xE3, 0xAE, 0x30, 0xE0, 0x05, 0x12, 0xE2, 0xE3, 0x80, 0x0D, 0xE4, 0x90, 0x88, -0x2D, 0xF0, 0xA3, 0xF0, 0x7D, 0x40, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x88, 0x2C, 0x12, 0xE2, 0xCC, -0x30, 0xE0, 0x03, 0x43, 0x64, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x14, -0x12, 0xE3, 0x6A, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x80, 0x12, 0xE3, 0x6A, 0x13, 0x54, -0x03, 0x20, 0xE0, 0x03, 0x43, 0x64, 0x40, 0xD1, 0x4D, 0x90, 0x88, 0x2F, 0xE0, 0x70, 0x05, 0x7F, -0x01, 0x12, 0xB9, 0xDC, 0x12, 0xD2, 0xAB, 0x30, 0xE0, 0x04, 0x7F, 0x04, 0x80, 0x0C, 0x12, 0xA7, -0x8F, 0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0xB9, 0xDC, 0xC1, 0x08, 0xD1, -0x4A, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x04, 0x60, 0x02, 0xC1, 0x45, 0xFF, 0x12, 0xB9, 0xDC, 0xC1, -0x45, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x78, 0x12, 0xE4, 0x09, 0x43, 0x64, 0x31, 0x12, 0xE3, -0xAE, 0x30, 0xE0, 0x05, 0x12, 0xE2, 0xE3, 0x80, 0x07, 0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, -0x90, 0x88, 0x2C, 0x12, 0xE2, 0xCC, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x02, 0xEF, 0xC4, 0x54, 0x0F, -0x30, 0xE0, 0x03, 0x43, 0x64, 0x04, 0xD1, 0x4D, 0x12, 0xD2, 0xAB, 0x30, 0xE0, 0x0F, 0xF1, 0xC8, -0x60, 0x36, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0xE4, 0xFD, 0x7F, 0x02, 0x80, 0x1E, 0xF1, 0xF6, 0xF1, -0xC8, 0x70, 0x1D, 0x12, 0x7B, 0xAD, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x07, 0x12, 0x9C, 0xC0, 0x7D, -0x01, 0x80, 0x08, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x80, 0x08, -0x90, 0x88, 0x39, 0xE0, 0x90, 0x88, 0x30, 0xF0, 0x90, 0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x35, -0xD1, 0x4A, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, 0x0B, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, -0x7F, 0x04, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, -0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x12, 0xE0, 0xDB, 0x12, 0x9C, 0xC0, 0x7D, 0x01, 0x12, -0x04, 0x7E, 0x12, 0xC3, 0x9E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x64, 0x01, 0x90, 0x05, 0x27, -0xE5, 0x64, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, -0x12, 0x04, 0x80, 0x12, 0xC3, 0x82, 0x12, 0x04, 0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, -0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, -0x74, 0x02, 0x12, 0xCA, 0x57, 0xFF, 0x12, 0xE3, 0x10, 0x12, 0xE2, 0x01, 0x90, 0x8A, 0x89, 0x11, -0x40, 0xF1, 0x91, 0x90, 0x8A, 0x89, 0x11, 0x40, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, -0x8A, 0x89, 0x11, 0x40, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, -0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, -0x88, 0x41, 0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, -0x41, 0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, -0x06, 0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, -0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x12, 0xCA, 0x57, 0x12, 0xE3, -0x10, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3F, 0x12, 0x04, 0x80, -0x90, 0x8A, 0xA3, 0x11, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0xF1, 0xED, 0x7E, 0x00, 0xFF, 0x7D, -0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, -0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, -0xF0, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xB1, 0x57, 0x90, 0x88, 0x9D, 0xE0, -0x20, 0xE0, 0x3D, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x35, 0x90, 0x8A, 0xD7, 0x12, 0x88, -0xD0, 0x12, 0xA6, 0xFF, 0x60, 0x18, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x12, 0xD0, 0xC0, 0x90, 0x8A, -0xF9, 0x11, 0x40, 0xF1, 0x91, 0x90, 0x8B, 0x01, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x90, 0x88, -0x39, 0xE0, 0x70, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, -0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x04, 0x7E, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x64, 0x01, 0x22, -0x90, 0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0x90, 0x88, 0x2F, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x8A, -0xF9, 0x11, 0x40, 0xF1, 0x91, 0xF1, 0xF6, 0x80, 0xEE, 0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x90, -0x8A, 0xF9, 0x11, 0x40, 0xF1, 0x91, 0x80, 0xDF, 0x90, 0x88, 0x30, 0xE0, 0x64, 0x02, 0x22, 0x12, -0xD2, 0xAB, 0x30, 0xE0, 0x10, 0xF1, 0xC8, 0x60, 0x0C, 0x90, 0x8A, 0xB9, 0x11, 0x40, 0x7D, 0x01, -0x7F, 0x02, 0x12, 0x04, 0x7E, 0xF1, 0xC8, 0x60, 0x03, 0x12, 0xD0, 0xA4, 0x22, 0x90, 0x05, 0x58, -0x74, 0x02, 0xF0, 0x22, 0x80, 0xB1, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xF1, 0xE1, -0x90, 0x04, 0x24, 0xE0, 0xFF, 0xE4, 0xFE, 0x12, 0x87, 0xF5, 0x8E, 0x82, 0x12, 0xBF, 0xF7, 0x2F, -0xFD, 0xEE, 0x11, 0x24, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x03, 0xEC, 0x22, 0x90, 0x93, 0x58, 0xE0, -0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x64, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0x22, 0xE4, 0x90, 0x96, 0x2B, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0x20, 0xE0, 0x02, 0x21, -0xA7, 0x12, 0x8F, 0xD2, 0x54, 0x07, 0x90, 0x96, 0x28, 0xF0, 0x60, 0x07, 0xE0, 0x64, 0x02, 0x60, -0x02, 0x21, 0x3B, 0x90, 0x93, 0x5A, 0xE0, 0x70, 0x2A, 0x71, 0x63, 0x7B, 0x4E, 0x51, 0x2A, 0x11, -0x1C, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, 0x04, 0x7D, 0x01, 0x51, 0x39, 0xBF, 0x01, 0x0C, 0x31, 0xA8, -0x44, 0x01, 0xF0, 0x90, 0x93, 0x5A, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x96, 0x29, 0xE0, 0xFD, 0x7B, -0x4F, 0x21, 0x12, 0x90, 0x93, 0x5A, 0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x2B, 0x12, 0x8F, 0x18, -0xFF, 0x12, 0x8F, 0xD6, 0xFE, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x02, 0x21, 0x29, 0xEF, 0x31, 0xB0, -0xFF, 0x30, 0xE0, 0x08, 0x90, 0x96, 0x2B, 0x74, 0x01, 0xF0, 0x80, 0x12, 0xEF, 0xC3, 0x13, 0x20, -0xE0, 0x0C, 0x90, 0x96, 0x2B, 0x74, 0x01, 0xF0, 0x71, 0x63, 0x7B, 0x50, 0x51, 0x2A, 0x90, 0x96, -0x2B, 0xE0, 0x60, 0x67, 0x90, 0x93, 0xDF, 0xE0, 0xFF, 0x90, 0x93, 0xDE, 0xE0, 0x6F, 0x60, 0x46, -0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x01, 0x40, 0x08, 0x90, 0x96, 0x2C, 0x74, 0x04, 0xF0, 0x80, -0x05, 0xE4, 0x90, 0x96, 0x2C, 0xF0, 0x11, 0x1C, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x96, 0x2C, 0xE0, -0xFB, 0x7D, 0x01, 0x51, 0x39, 0xBF, 0x01, 0x13, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xA3, 0x74, 0x03, -0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x90, 0x96, 0x29, 0xE0, 0xFD, -0x7B, 0x51, 0xE4, 0xFF, 0x41, 0x2E, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x51, 0x23, 0x90, 0x93, 0x58, -0xE0, 0xFF, 0x31, 0xAC, 0x54, 0xFB, 0xF0, 0x80, 0x02, 0x51, 0x23, 0x90, 0x93, 0x5A, 0xE0, 0x64, -0x05, 0x70, 0x74, 0x12, 0x8A, 0xB5, 0xEF, 0x70, 0x6E, 0x80, 0x68, 0x90, 0x96, 0x28, 0xE0, 0xFF, -0x64, 0x03, 0x60, 0x05, 0xEF, 0x64, 0x01, 0x70, 0x5E, 0x90, 0x93, 0x5A, 0xE0, 0x64, 0x05, 0x70, -0x56, 0x90, 0x96, 0x28, 0xE0, 0x64, 0x01, 0x70, 0x3C, 0x12, 0x8F, 0xC0, 0xE0, 0xD3, 0x94, 0x1F, -0x90, 0x93, 0x58, 0xE0, 0x40, 0x0F, 0x11, 0x21, 0xE0, 0xFF, 0x90, 0x8A, 0xBF, 0x91, 0xC8, 0x7D, -0x00, 0x7C, 0x7C, 0x80, 0x1D, 0x11, 0x20, 0xE0, 0xFB, 0x12, 0x8F, 0xC0, 0xE0, 0x7D, 0x00, 0x25, -0xE0, 0x25, 0xE0, 0xFC, 0xAF, 0x03, 0x90, 0x8A, 0xBF, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, -0x8A, 0x83, 0x12, 0x04, 0x7E, 0x12, 0x8F, 0x18, 0xFD, 0x7F, 0x02, 0x51, 0xDE, 0x12, 0x8A, 0xB5, -0xEF, 0x70, 0x04, 0x7F, 0x06, 0xF1, 0xF5, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, -0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0xE4, -0x90, 0x96, 0x1B, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, 0x57, 0xC3, 0x13, 0x54, 0x07, 0xFF, -0x31, 0xB0, 0xFE, 0x30, 0xE0, 0x4C, 0xEF, 0x71, 0x6C, 0xEE, 0x54, 0xFE, 0xF0, 0xEF, 0x31, 0xB0, -0xFF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0F, 0x12, 0xE3, 0x71, 0x71, 0x6C, 0xEF, 0x54, 0xFB, -0xF0, 0x90, 0x96, 0x1B, 0x74, 0x01, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x1C, 0x51, 0x23, -0x31, 0xA8, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0x93, 0xDE, 0xF0, 0x12, 0x8F, 0x18, 0xFD, 0x7F, 0x02, -0x51, 0xDE, 0x90, 0x96, 0x1B, 0xE0, 0x60, 0x0A, 0x01, 0x32, 0x31, 0xA8, 0x54, 0xFD, 0xF0, 0xE4, -0x71, 0x5D, 0x22, 0x90, 0x93, 0x5A, 0x74, 0x05, 0xF0, 0x22, 0x7D, 0x6F, 0x7F, 0xFF, 0x90, 0x05, -0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x96, 0xBE, 0xEE, 0xF0, 0xA3, 0x12, 0xE3, 0x93, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x29, 0x90, -0x05, 0x22, 0xE0, 0x90, 0x96, 0xC4, 0xF0, 0x7B, 0x14, 0x12, 0x88, 0xC6, 0xEF, 0x64, 0x01, 0x70, -0x06, 0x71, 0xA0, 0x71, 0xF4, 0x80, 0x04, 0x7F, 0x00, 0x80, 0x13, 0x90, 0x96, 0xC4, 0xE0, 0xFD, -0x7B, 0x15, 0xE4, 0xFF, 0x51, 0x2E, 0x80, 0x04, 0x71, 0xA0, 0x71, 0xF4, 0xF1, 0x0C, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x8F, 0x65, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x95, 0x33, 0xF0, 0x7B, 0x17, 0x12, -0x88, 0xC6, 0xEF, 0x64, 0x01, 0x70, 0x39, 0xE5, 0x65, 0x12, 0x8F, 0x34, 0xE0, 0xFC, 0x71, 0x7A, -0x12, 0xE2, 0xAA, 0xAF, 0x04, 0x12, 0x8F, 0x42, 0x71, 0x7A, 0x12, 0x8B, 0x8E, 0xE5, 0x65, 0x12, -0x8F, 0xD6, 0x54, 0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0D, 0xE5, 0x65, 0x11, 0x24, 0xE0, 0xFF, -0x7E, 0x00, 0xE4, 0xFB, 0xFD, 0x51, 0x39, 0xAD, 0x65, 0x7F, 0x01, 0x51, 0xDE, 0x7F, 0x01, 0x22, -0x90, 0x95, 0x33, 0xE0, 0xFD, 0x7B, 0x49, 0xE4, 0xFF, 0x51, 0x2E, 0x7F, 0x00, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x2E, 0xED, 0xF0, 0x90, 0x96, 0x2D, 0xEF, 0xF0, 0x64, -0x02, 0x70, 0x24, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x2F, 0xF0, 0x7B, 0x4A, 0x7D, 0x6F, 0x12, -0x88, 0xC8, 0xBF, 0x01, 0x07, 0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, 0x47, 0x90, 0x96, 0x2F, 0xE0, -0xFD, 0x7B, 0x46, 0x51, 0xD7, 0x80, 0x41, 0x90, 0x96, 0x2D, 0xE0, 0x64, 0x01, 0x70, 0x30, 0x71, -0x5D, 0x90, 0x96, 0x2E, 0xE0, 0xFF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x60, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, 0xD4, 0xF0, 0xEF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x61, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, 0xD5, 0xF0, 0x80, 0x07, 0x90, -0x04, 0xD4, 0xE4, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFB, 0xFD, 0x7F, -0xFF, 0x41, 0x2E, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0x29, 0xF0, 0x22, 0x75, 0xF0, 0x1B, 0xA4, -0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0xE5, 0x65, 0x75, 0xF0, 0x1B, 0xA4, -0x24, 0x5C, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFE, 0x54, 0x03, 0x22, 0x31, 0xA8, -0x20, 0xE0, 0x07, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0x41, 0x23, 0x31, 0xA8, 0x44, 0x04, 0xF0, 0x22, -0x90, 0x96, 0xBE, 0xA3, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, -0x12, 0x66, 0xDB, 0x90, 0x96, 0xC2, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xC1, -0xE0, 0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, -0xC0, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x96, 0xDD, 0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, -0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, 0xDE, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, -0xFD, 0x90, 0x96, 0xDC, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, -0x8A, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xDC, 0xEF, -0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x4F, 0x90, 0x05, -0x22, 0xE0, 0x90, 0x96, 0xE0, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x26, 0x7F, 0xFF, -0x12, 0x04, 0x7E, 0x12, 0x88, 0xCD, 0xEF, 0x64, 0x01, 0x70, 0x0B, 0x71, 0xD2, 0x90, 0x93, 0x58, -0xE0, 0x20, 0xE0, 0x16, 0x80, 0x10, 0x91, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x0D, 0x71, 0xD2, 0x90, -0x93, 0x58, 0xE0, 0x20, 0xE0, 0x04, 0x91, 0xE2, 0x91, 0xB4, 0x90, 0x96, 0xE0, 0xE0, 0xFF, 0x90, -0x8A, 0xF9, 0x91, 0xC8, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0x91, 0xD9, 0x80, 0x0F, 0x91, 0xD9, 0x91, -0xB4, 0x71, 0xD2, 0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, 0x04, 0x91, 0xE2, 0x91, 0xB4, 0x90, 0x88, -0x9D, 0xE0, 0x30, 0xE0, 0x18, 0x91, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x11, 0x90, 0x05, 0x22, 0xE0, -0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x91, 0xC8, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0xF1, 0x0C, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, -0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, -0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, 0x22, 0x90, 0x96, 0xDC, 0xE0, 0xFF, 0x90, 0x8A, -0xC7, 0x22, 0x90, 0x96, 0xDE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0x22, 0x12, 0xA0, -0xC2, 0xFF, 0x54, 0x0F, 0xF5, 0x64, 0xEF, 0xC4, 0x54, 0x0F, 0x64, 0x0F, 0x70, 0x3F, 0x90, 0x93, -0x58, 0xE0, 0x54, 0xFE, 0xFF, 0xF0, 0xE5, 0x64, 0x54, 0x07, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xF1, -0x4E, 0x12, 0x87, 0x98, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xDF, 0x20, 0xE0, 0x05, 0x74, 0x06, -0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, 0xAF, 0x64, 0x51, -0x83, 0xBF, 0x01, 0x05, 0xE4, 0xFD, 0xFF, 0x51, 0xDE, 0x7F, 0x02, 0xA1, 0xEB, 0xE5, 0x64, 0x75, -0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, -0x01, 0xE5, 0x63, 0x24, 0x01, 0xF9, 0xE4, 0x35, 0x62, 0x85, 0x61, 0x45, 0xF5, 0x46, 0x89, 0x47, -0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x12, 0x69, 0xF5, 0xE5, 0x64, 0x12, 0x8F, 0xD6, 0x54, -0xF7, 0xF0, 0xB1, 0xEE, 0xC4, 0x54, 0x0F, 0x14, 0x65, 0x64, 0x70, 0x71, 0x90, 0x88, 0x36, 0xE0, -0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x05, 0x80, 0x5E, 0xB1, 0xEE, 0xC4, -0x54, 0x0F, 0x90, 0x93, 0x59, 0xF1, 0xEE, 0xFC, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFE, 0x90, 0x93, -0x58, 0xE0, 0x54, 0x0F, 0x4E, 0xF0, 0xEC, 0x54, 0x60, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x93, 0xAD, -0xE0, 0x54, 0xF9, 0x4F, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xF1, 0xF0, 0x12, 0x97, 0xED, 0x90, -0x93, 0xD5, 0xE0, 0x90, 0x93, 0xD9, 0x30, 0xE0, 0x0B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xC1, 0x44, -0x02, 0xF0, 0x80, 0x07, 0xE0, 0x44, 0x01, 0xF0, 0x54, 0xC1, 0xF0, 0x90, 0x93, 0xD9, 0xE0, 0x54, -0xBF, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x44, 0x01, 0xF0, 0x7F, 0x03, 0xF1, 0xF5, 0x22, 0xAB, 0x61, -0xAA, 0x62, 0xA9, 0x63, 0x02, 0x02, 0x06, 0x90, 0x96, 0xD7, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, -0x70, 0x53, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, -0x90, 0x96, 0xD8, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x7E, 0x02, 0xD1, 0xE5, 0x70, 0x05, 0x90, -0x88, 0xBE, 0x80, 0x1C, 0xE4, 0xFF, 0xD1, 0xE4, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, -0xA3, 0xF0, 0x80, 0x5B, 0xE4, 0xFF, 0x7E, 0x02, 0xD1, 0xE5, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, -0xF0, 0xA3, 0xF0, 0x80, 0x4A, 0xE4, 0x7F, 0x80, 0xD1, 0xE4, 0x70, 0x43, 0x90, 0x88, 0xBE, 0xF0, -0xA3, 0x04, 0xF0, 0x80, 0x3A, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, 0xD1, -0xF8, 0x4E, 0x4F, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, -0xBE, 0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0xD1, 0xF8, 0x4E, 0x4F, -0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, -0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x11, 0x12, 0xBB, -0x64, 0x12, 0x88, 0xD0, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, -0xFF, 0x90, 0x8A, 0xF3, 0x91, 0xC8, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x96, 0xD7, 0xE0, 0xFD, -0x70, 0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0xD1, 0xF1, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, -0xD7, 0xE0, 0xFD, 0xB4, 0x02, 0x06, 0xD1, 0xF1, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, -0xD1, 0xF1, 0xF0, 0x22, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xD8, 0x12, 0x86, 0x31, 0xC3, 0x02, 0x03, -0xDA, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xD8, -0x12, 0x04, 0x31, 0x90, 0x96, 0xD8, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x22, 0x90, 0x04, 0x1F, 0x74, -0x20, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0xF1, 0x78, 0x01, 0x32, 0x90, -0x88, 0x2C, 0xE0, 0x90, 0x88, 0x38, 0x30, 0xE0, 0x04, 0xE0, 0xFF, 0x80, 0x07, 0x91, 0xC3, 0x7D, -0x01, 0x02, 0x04, 0x7E, 0xAE, 0x07, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x15, 0x12, 0xE3, 0x6A, 0x13, -0x54, 0x03, 0x20, 0xE0, 0x0C, 0xAF, 0x06, 0x91, 0xC5, 0x7D, 0x01, 0x12, 0x04, 0x7E, 0x7F, 0x01, -0x22, 0x7F, 0x00, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, -0x08, 0x90, 0x8B, 0x01, 0x12, 0x88, 0xD0, 0x80, 0x05, 0x12, 0xE3, 0xD6, 0xF1, 0x1F, 0x90, 0x93, -0x5A, 0xE0, 0xB4, 0x01, 0x02, 0x11, 0x32, 0x22, 0x12, 0xE2, 0xC9, 0x30, 0xE0, 0x0C, 0xEF, 0xC4, -0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x03, 0x12, 0xE3, 0xB7, 0x90, 0x88, 0x31, 0xF1, 0xE7, 0x30, -0xE0, 0x09, 0x12, 0xD0, 0x3D, 0x54, 0x07, 0x70, 0x3F, 0x80, 0x3B, 0x12, 0xE2, 0x5C, 0x40, 0x36, -0x12, 0xA7, 0x68, 0x70, 0x33, 0x12, 0xA6, 0xFF, 0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xD0, -0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xD0, 0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, -0x94, 0x02, 0x40, 0x09, 0xF1, 0xD9, 0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, -0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0xF1, 0x1F, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, -0x22, 0x90, 0x95, 0x33, 0x02, 0x86, 0x46, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0xF0, 0x90, -0x00, 0x06, 0x02, 0x02, 0x1F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0x90, 0x05, -0x63, 0xE0, 0xFE, 0x90, 0x05, 0x62, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x96, -0x50, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0xFE, 0x90, 0x05, 0x60, 0xE0, 0x24, 0x00, -0xFF, 0xEA, 0x3E, 0xFE, 0xED, 0xB4, 0x08, 0x0A, 0x90, 0x05, 0x58, 0xE0, 0xFC, 0x2F, 0xFF, 0xEA, -0x3E, 0xFE, 0x90, 0x96, 0x2D, 0x74, 0x17, 0xF0, 0x90, 0x96, 0x4F, 0x74, 0x06, 0xF0, 0x90, 0x96, -0x2F, 0xED, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0xFD, 0xC3, 0x13, 0x54, 0x07, 0x12, 0x8F, 0x34, 0xE0, -0x90, 0x96, 0x30, 0xF0, 0xA3, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x90, 0x96, 0x50, 0xE0, 0xFE, 0xA3, -0xE0, 0x90, 0x96, 0x33, 0xF0, 0xEE, 0xA3, 0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x2D, 0x12, 0x90, -0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x11, 0xC2, 0xFF, 0x54, 0x01, -0xFE, 0x90, 0x93, 0xD5, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xEE, 0x54, -0x01, 0x12, 0x87, 0x9F, 0x90, 0x93, 0xD6, 0x12, 0x87, 0x6B, 0x90, 0x93, 0xD7, 0xF0, 0xE4, 0xA3, -0xF0, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0xB4, 0x64, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, -0x96, 0x06, 0x90, 0x93, 0xD7, 0x74, 0x03, 0xF0, 0x90, 0x93, 0xD7, 0xE0, 0x04, 0x90, 0x93, 0xDA, -0xF0, 0x22, 0x8B, 0x61, 0x8A, 0x62, 0x89, 0x63, 0x02, 0x02, 0x06, 0x90, 0x95, 0x30, 0x12, 0x86, -0x46, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0x12, 0x86, 0x4F, 0xA1, 0x4F, 0x00, 0xA1, 0x58, 0x01, 0xA1, -0x61, 0x10, 0xA1, 0x6A, 0x12, 0xA1, 0x72, 0x14, 0xA2, 0x9D, 0x15, 0xA1, 0x7B, 0x16, 0xA1, 0x84, -0x18, 0xA1, 0x8D, 0x19, 0xA1, 0x95, 0x1B, 0xA1, 0x9E, 0x1C, 0xA1, 0xA7, 0x20, 0xA1, 0xB0, 0x24, -0xA1, 0xB9, 0x25, 0xA1, 0xC2, 0x27, 0xA1, 0xCA, 0x29, 0xA1, 0xD2, 0x2A, 0xA1, 0xDB, 0x40, 0xA1, -0xE6, 0x42, 0xA2, 0x9D, 0x47, 0xA2, 0x9D, 0x49, 0xA1, 0xF5, 0x60, 0xA1, 0xFE, 0x61, 0xA2, 0x07, -0x62, 0xA2, 0x10, 0x63, 0xA2, 0x19, 0x64, 0xA2, 0x22, 0x65, 0xA2, 0x2B, 0x66, 0xA2, 0x34, 0x67, -0xA2, 0x3D, 0x68, 0xA2, 0x46, 0x69, 0xA2, 0x4F, 0x6B, 0xA2, 0x58, 0x6C, 0xA2, 0x61, 0x6D, 0xA2, -0x6A, 0x6E, 0xA2, 0x73, 0x6F, 0xA2, 0x7C, 0x70, 0xA2, 0x85, 0xC3, 0x00, 0x00, 0xA2, 0x8E, 0x90, -0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, 0x1D, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, -0xFA, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x97, 0xFE, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, -0x41, 0x9E, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x86, 0x90, 0x95, 0x30, 0x12, 0x86, -0x3D, 0x02, 0x87, 0x72, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x9C, 0xEE, 0x90, 0x95, 0x30, -0x12, 0x86, 0x3D, 0x01, 0x7B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x15, 0x90, 0x95, -0x30, 0x12, 0x86, 0x3D, 0x02, 0x87, 0xA7, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xA8, 0x95, -0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x94, 0xD5, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, -0xAF, 0xF5, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x61, 0x7F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, -0x61, 0x4F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xB7, 0xC9, 0x90, 0x95, 0x30, 0x12, 0x86, -0x3D, 0x90, 0x8A, 0xA5, 0x80, 0x09, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x90, 0x8A, 0xB5, 0x12, -0xB9, 0x56, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x92, 0x8C, 0x90, 0x95, -0x30, 0x12, 0x86, 0x3D, 0x02, 0x77, 0x4F, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7C, 0x60, -0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7A, 0xC6, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, -0x5D, 0x36, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x7B, 0xE9, 0x90, 0x95, 0x30, 0x12, 0x86, -0x3D, 0x02, 0x70, 0x33, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x48, 0xC9, 0x90, 0x95, 0x30, -0x12, 0x86, 0x3D, 0x02, 0x79, 0xF3, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x3F, 0xD4, 0x90, -0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x51, 0x7B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x79, -0x30, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x57, 0xF2, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, -0x02, 0x74, 0x8D, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0x78, 0x9A, 0x90, 0x95, 0x30, 0x12, -0x86, 0x3D, 0x02, 0x5E, 0x0B, 0x90, 0x95, 0x30, 0x12, 0x86, 0x3D, 0x02, 0xB8, 0xA6, 0x90, 0x01, -0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x12, 0x02, -0x06, 0xFF, 0x90, 0x93, 0x3A, 0xF0, 0xBF, 0x01, 0x07, 0x51, 0xB1, 0xE4, 0x90, 0x93, 0x3A, 0xF0, -0x22, 0x71, 0x48, 0x12, 0xE3, 0xF3, 0xBF, 0x01, 0x06, 0x90, 0x95, 0x33, 0xE0, 0xA3, 0xF0, 0x71, -0x48, 0x12, 0xE3, 0xEC, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x35, 0xF0, 0x71, -0x48, 0x12, 0xE3, 0xFA, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x36, 0xF0, 0x71, -0x48, 0x12, 0xE3, 0xDE, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x37, 0xF0, 0x71, -0x48, 0x12, 0xE3, 0xE5, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x33, 0xE0, 0x90, 0x95, 0x38, 0xF0, 0x90, -0x95, 0x34, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x95, 0x3C, 0xF0, -0x90, 0x95, 0x38, 0xE0, 0x90, 0x95, 0x3D, 0xF0, 0x90, 0x95, 0x3E, 0x74, 0x12, 0xF0, 0x90, 0x95, -0x60, 0x74, 0x05, 0xF0, 0x90, 0x95, 0x40, 0x12, 0xE3, 0x93, 0x90, 0x95, 0x3C, 0xE0, 0x90, 0x95, -0x43, 0xF0, 0x90, 0x95, 0x3D, 0xE0, 0x90, 0x95, 0x44, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3E, -0x12, 0x90, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x33, 0x22, 0x12, -0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x3F, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, -0xE4, 0x71, 0x78, 0x22, 0x90, 0x96, 0x76, 0xE0, 0xFF, 0x90, 0x95, 0xC2, 0xE4, 0xF0, 0xA3, 0xEF, -0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, -0xA8, 0x7E, 0x90, 0x93, 0x3B, 0x12, 0xE3, 0x1E, 0x12, 0x87, 0x9F, 0x90, 0x93, 0x3C, 0x12, 0x87, -0x6B, 0x90, 0x93, 0x3D, 0xF0, 0xF1, 0xDC, 0x90, 0x93, 0x3B, 0xE0, 0x54, 0x01, 0xFF, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x19, 0x71, 0xEA, 0x60, 0x09, 0x71, 0xE3, -0x12, 0x7C, 0x05, 0xF1, 0xD3, 0x80, 0x07, 0x71, 0xE3, 0x12, 0x7C, 0x3B, 0xF1, 0x9B, 0x12, 0x79, -0xD4, 0x80, 0x17, 0x71, 0xEA, 0x60, 0x07, 0x71, 0xE3, 0x12, 0x7C, 0x05, 0x80, 0x05, 0x71, 0xE3, -0x12, 0x7C, 0x3B, 0xF1, 0x71, 0xF1, 0x78, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x01, -0x3F, 0x22, 0xF1, 0x68, 0x60, 0x02, 0xA1, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0xA1, 0x22, -0x90, 0x88, 0x2C, 0xE0, 0x20, 0xE0, 0x38, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x31, 0x90, 0x06, -0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x29, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x23, 0x90, 0x04, 0x1A, 0xE0, -0xF4, 0x70, 0x1C, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x15, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, -0x70, 0x0D, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x06, 0x12, 0xB4, 0x68, 0x12, 0xB1, 0x5F, 0x90, -0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, -0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, 0x90, -0x07, 0xF1, 0xE0, 0x90, 0x95, 0x2D, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x95, 0x2E, 0xF0, 0x90, -0x01, 0x57, 0x12, 0xD0, 0x16, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, 0xF0, 0xB1, 0x3E, 0x24, -0xFD, 0x50, 0x02, 0x80, 0x0D, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x04, 0xD1, 0x84, 0x80, 0x02, -0xD1, 0x1E, 0xB1, 0x3E, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, -0x90, 0x06, 0xAA, 0xE0, 0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, -0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, 0xCA, 0x5F, 0xE4, 0x90, 0x88, -0x3F, 0xF0, 0x12, 0xE2, 0xC9, 0x30, 0xE0, 0x58, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, -0x20, 0xB1, 0x36, 0x6F, 0x70, 0x4A, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xF1, 0x7F, 0x71, -0xDF, 0x12, 0x7C, 0x05, 0xF1, 0xA2, 0x12, 0xE3, 0xB7, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, -0x2F, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x24, 0xB1, 0x36, 0xFE, 0x6F, -0x60, 0x1E, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x15, 0x90, 0x88, 0x32, 0x12, 0x9F, -0xE7, 0x30, 0xE0, 0x0C, 0xEF, 0x54, 0xBF, 0x71, 0xDF, 0x12, 0x7C, 0x3B, 0xF1, 0x78, 0xF1, 0x71, -0xB1, 0x2E, 0x90, 0x88, 0x2C, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x02, 0xB1, 0x2E, 0x22, 0x90, 0x88, -0x32, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, -0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0xE4, 0xF5, 0x7E, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, -0xA1, 0xE9, 0xF1, 0x68, 0x60, 0x02, 0xA1, 0xE9, 0xF1, 0xED, 0xB1, 0x3E, 0x60, 0x22, 0x24, 0xFE, -0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, 0x60, 0x06, 0x90, -0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, 0xF0, 0x80, 0x00, -0x75, 0x7E, 0x01, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x11, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, -0x03, 0xE4, 0xF5, 0x7E, 0xF1, 0x8F, 0xEF, 0x70, 0x02, 0xF5, 0x7E, 0xE5, 0x7E, 0x60, 0x4A, 0x90, -0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0x7D, 0x01, 0x7F, 0x04, -0x12, 0x04, 0x7E, 0xF1, 0x87, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x0F, 0xB1, -0xEA, 0xFF, 0xA3, 0xE0, 0x2F, 0xD1, 0x10, 0xB1, 0xEF, 0xFF, 0xA3, 0xE0, 0x80, 0x0B, 0xB1, 0xEA, -0xB1, 0xF9, 0x2F, 0xD1, 0x10, 0xB1, 0xEF, 0xB1, 0xF9, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -0x88, 0x4F, 0xF0, 0x90, 0x8A, 0xD7, 0x12, 0x88, 0xD0, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, -0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xFF, 0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, -0x24, 0xFE, 0x22, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, -0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0xF5, -0x7E, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x7E, 0x54, 0xC0, 0x70, 0x18, 0xD1, 0x7C, 0x54, 0xFD, 0xF0, -0x12, 0x9F, 0x1F, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x42, 0x7F, 0x02, 0x12, 0xB7, 0x47, 0x7F, 0x02, -0x02, 0x7B, 0x2E, 0xE5, 0x7E, 0x30, 0xE6, 0x1B, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x15, -0xD1, 0xF8, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x88, 0xD0, 0x80, 0x07, 0x12, 0x73, -0x8F, 0x80, 0x02, 0xD1, 0x7C, 0xE5, 0x7E, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0A, 0xD1, 0x03, 0x90, -0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, -0x54, 0xFE, 0xF0, 0x22, 0x90, 0x06, 0xA9, 0xF1, 0xE6, 0xFD, 0x54, 0xC0, 0x70, 0x04, 0xD1, 0x7C, -0x80, 0x62, 0xED, 0x30, 0xE6, 0x47, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x70, 0x2C, 0x90, 0x88, -0x31, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x09, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x20, -0xD1, 0xFF, 0x64, 0x01, 0x70, 0x29, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x8A, 0x71, -0x12, 0x90, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x80, 0x15, 0xD1, 0xF8, 0x64, 0x02, 0x60, 0x08, -0x90, 0x8A, 0xE1, 0x12, 0x88, 0xD0, 0x80, 0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0xD1, 0x7C, 0x90, -0x95, 0xED, 0xE0, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0A, 0xD1, 0x03, 0x90, 0x88, 0x31, 0xE0, 0x44, -0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x90, -0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0xE4, 0x90, 0x96, 0x1B, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, -0x56, 0xF1, 0x68, 0x70, 0x52, 0xF1, 0x7F, 0xF0, 0xF1, 0xED, 0x90, 0x96, 0x1B, 0x74, 0x01, 0xF0, -0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x15, 0x90, 0x88, 0x30, 0xE0, -0xB4, 0x02, 0x05, 0xE4, 0x90, 0x96, 0x1B, 0xF0, 0xF1, 0x8F, 0xEF, 0x70, 0x04, 0x90, 0x96, 0x1B, -0xF0, 0x90, 0x96, 0x1B, 0xE0, 0x60, 0x20, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, -0xB9, 0x12, 0x90, 0x40, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xF1, 0x87, 0xB1, 0xEA, 0xD1, -0x10, 0x90, 0x8A, 0xD7, 0x12, 0x88, 0xD0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, 0x01, -0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x90, -0x88, 0x3C, 0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, -0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, -0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0xF1, 0x06, 0xF1, 0x71, 0x7F, 0x01, 0x12, -0xB9, 0x60, 0x90, 0x8B, 0x07, 0x12, 0x88, 0xD0, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x13, 0xF1, -0xD3, 0x90, 0x93, 0x3E, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, 0xD4, 0xF1, 0xDC, 0xE4, 0xFF, -0x71, 0x9E, 0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x93, 0x3C, 0xE0, -0x14, 0x90, 0x93, 0x3E, 0xF0, 0x22, 0xE0, 0x90, 0x95, 0xED, 0xF0, 0xE0, 0x22, 0x90, 0x05, 0x63, -0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, -0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, -0xE0, 0x44, 0x80, 0xF0, 0x22, 0x11, 0x7E, 0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x30, -0xE0, 0x27, 0xEF, 0x54, 0x04, 0x25, 0xE0, 0xFE, 0xE0, 0x54, 0xF7, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, -0x02, 0x25, 0xE0, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x90, 0x04, 0x57, 0xE0, 0x90, 0x93, 0x05, -0xF0, 0x90, 0x04, 0x55, 0xE0, 0x90, 0x93, 0x04, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0x54, 0x01, 0xFF, -0xEF, 0x90, 0x07, 0xDC, 0x60, 0x25, 0xE4, 0xF0, 0xF0, 0x90, 0x07, 0xDE, 0xF0, 0xA3, 0x04, 0xF0, -0x90, 0x07, 0xDD, 0x74, 0x03, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0xA3, -0x74, 0x10, 0xF0, 0x90, 0x07, 0xDC, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE4, 0xF0, 0x22, 0x12, 0x02, -0x06, 0xFF, 0x54, 0x01, 0xFE, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0xEC, 0xE0, -0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x9F, 0xE1, 0x12, 0x87, 0xF5, 0x12, 0x02, 0x06, 0xFF, 0x54, -0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0x31, 0xA5, 0xA3, 0x12, 0x87, 0xA0, 0xFD, 0x54, 0xF0, 0xC4, -0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, -0x1F, 0xFC, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, -0x54, 0x04, 0xC3, 0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, -0xC4, 0x54, 0xF0, 0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, 0x12, 0x87, 0x6B, 0x90, 0x88, 0x35, 0x12, -0x87, 0x98, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x90, 0x40, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x87, -0xF5, 0x12, 0x87, 0x65, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, 0xE3, 0x1E, 0x4F, 0x12, -0x87, 0x63, 0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x31, 0x9C, 0x54, 0x08, 0xFE, 0xEF, 0x54, -0xF7, 0x12, 0x87, 0x62, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x31, 0x9C, 0x54, 0x20, 0xFE, -0xEF, 0x54, 0xDF, 0x12, 0x87, 0x62, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, -0xF0, 0x12, 0xD2, 0xAE, 0x20, 0xE0, 0x2F, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0B, 0x75, 0x62, 0x01, -0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, 0x62, 0x90, 0x88, 0xDF, 0xE0, 0x60, -0x05, 0xE4, 0xF5, 0x61, 0x80, 0x03, 0x75, 0x61, 0x01, 0x90, 0x8A, 0xF3, 0x12, 0x90, 0x40, 0xAD, -0x62, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x12, 0x87, 0xF5, 0x12, 0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, -0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xD3, 0x1E, 0xF0, 0x90, 0x88, -0x36, 0x12, 0xE3, 0x2C, 0x12, 0xA6, 0xFE, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x4D, 0xFF, 0x90, 0x88, -0x9B, 0xF0, 0xEE, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xF1, 0x80, 0x20, 0xE6, 0x02, 0x41, 0xC7, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, -0xE9, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x96, 0xEA, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, -0x90, 0x96, 0xEB, 0xF0, 0x90, 0x96, 0xEA, 0xE0, 0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, -0x41, 0xC0, 0x90, 0x96, 0xE9, 0xE0, 0xFF, 0xF1, 0x87, 0x41, 0xC0, 0x90, 0x96, 0xE9, 0xE0, 0x24, -0xD6, 0x12, 0xDC, 0x81, 0xFB, 0xE4, 0xFD, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0x13, -0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0x31, 0xA5, -0xFB, 0x0D, 0xE4, 0xFF, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x71, 0x05, 0xC4, 0x54, 0x03, 0xFB, 0x0D, -0xE4, 0xFF, 0x51, 0xF9, 0xF1, 0xD5, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x90, -0x89, 0x50, 0x12, 0x04, 0x6E, 0x51, 0xF6, 0x75, 0xF0, 0x12, 0x91, 0x74, 0xC4, 0x13, 0x54, 0x01, -0xFB, 0x0D, 0x7F, 0x01, 0x51, 0xF9, 0x75, 0xF0, 0x12, 0x91, 0x74, 0x54, 0x1F, 0x51, 0xF7, 0x12, -0xB7, 0x70, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, -0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, -0x82, 0x51, 0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, -0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, -0xFD, 0x0F, 0x51, 0xF9, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, -0xF4, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x51, 0xF4, 0x75, 0xF0, -0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xCC, -0xF1, 0x80, 0x30, 0xE0, 0x02, 0xF1, 0xEE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, -0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, -0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, -0x83, 0xEB, 0xF0, 0x22, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x51, 0xCC, 0x90, 0x96, 0xE9, 0xE0, 0x22, -0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, 0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, 0x95, 0x2F, -0x12, 0x86, 0x46, 0xB1, 0xBF, 0x12, 0x02, 0x06, 0x54, 0x7F, 0xFD, 0x12, 0x87, 0xA1, 0xFE, 0x54, -0x1F, 0x90, 0x95, 0x33, 0xF0, 0xEE, 0x54, 0x80, 0x31, 0xA5, 0x90, 0x95, 0x32, 0x12, 0x87, 0x6B, -0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x90, 0x95, 0x35, 0x12, 0x87, 0x6B, -0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, 0x95, 0x34, 0xF0, 0xEE, 0x54, 0x80, 0x31, -0xA5, 0xFF, 0x12, 0x87, 0x6C, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, 0x95, 0x37, -0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, 0xC4, 0x33, -0x33, 0x33, 0x54, 0x80, 0x71, 0x00, 0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x95, 0x34, 0xE0, 0x54, 0x01, -0xC4, 0x33, 0x33, 0x54, 0xC0, 0x71, 0x00, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x60, 0x02, 0x81, 0x6E, -0x90, 0x95, 0x33, 0xE0, 0x54, 0x1F, 0x91, 0x6F, 0x54, 0xE0, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x71, -0x00, 0x54, 0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x71, 0x00, 0x54, 0xF3, -0x4F, 0xF0, 0x90, 0x95, 0x32, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, 0x91, 0x6F, 0x54, 0xDF, -0x4F, 0xF0, 0x90, 0x95, 0x35, 0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x71, 0x00, 0x54, 0xCF, 0x4F, -0x12, 0xE3, 0x52, 0xE0, 0x54, 0xFB, 0x12, 0xE3, 0x52, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, -0x95, 0x38, 0xE0, 0x12, 0xE3, 0xBE, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, 0xE7, 0xE0, 0x60, -0x37, 0xB1, 0xBF, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, -0x02, 0x4C, 0x90, 0x95, 0x36, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x36, 0xE0, 0xFF, 0xC3, 0x94, 0x04, -0x50, 0x16, 0xEF, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0xB1, 0xBF, 0x8F, 0x82, 0x8E, 0x83, 0xE4, -0x12, 0x02, 0x5E, 0x12, 0xE3, 0x7B, 0x80, 0xE0, 0x90, 0x93, 0xE5, 0xE0, 0x54, 0x07, 0xFF, 0xBF, -0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, 0xEA, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x95, 0x36, -0xF0, 0x90, 0x95, 0x36, 0xE0, 0xFC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x95, 0x2F, 0x12, -0xC1, 0x37, 0xFF, 0xED, 0x12, 0xB7, 0x70, 0xE5, 0x82, 0x2C, 0x12, 0xB9, 0x4B, 0xEF, 0xF0, 0x12, -0xE3, 0x7B, 0xE0, 0xB4, 0x04, 0xDB, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0x12, 0x9C, 0xB4, 0x22, 0xFF, -0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, 0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x8F, 0x75, 0x8D, 0x76, -0xEF, 0xD1, 0x00, 0xE0, 0xF5, 0x77, 0x54, 0x7F, 0xF5, 0x78, 0xE5, 0x77, 0x54, 0x80, 0xF5, 0x7A, -0x75, 0xF0, 0x12, 0xEF, 0xF1, 0xD8, 0xF5, 0x7C, 0x75, 0xF0, 0x12, 0xEF, 0x71, 0x05, 0xC4, 0x54, -0x03, 0xF5, 0x7D, 0xB1, 0xD0, 0x74, 0xFF, 0xF0, 0xE5, 0x78, 0x12, 0xDC, 0x5F, 0xB1, 0xDC, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x77, 0x45, 0x7A, 0xFF, 0xF1, 0xE0, 0xEF, 0xF0, 0xE5, 0x75, 0xD1, -0x93, 0xE0, 0x54, 0x03, 0xF5, 0x7B, 0x74, 0x46, 0x25, 0x75, 0x12, 0xE3, 0xCE, 0xE5, 0x7B, 0xF0, -0xE5, 0x78, 0x65, 0x7C, 0x70, 0x4D, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, 0x13, 0x54, -0x07, 0x30, 0xE0, 0x0C, 0xE5, 0x7A, 0x70, 0x08, 0xE5, 0x78, 0x44, 0x80, 0xF5, 0x77, 0xA1, 0x92, -0xE5, 0x78, 0x12, 0xDC, 0x5F, 0xB1, 0xDC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xB1, 0xE3, 0xE0, 0xFF, -0xA3, 0xE0, 0x90, 0x95, 0xC4, 0xCF, 0xB1, 0xC5, 0xE5, 0x75, 0xF0, 0xE4, 0x90, 0x95, 0xC6, 0x12, -0xA3, 0x77, 0x7B, 0x01, 0xFA, 0x7D, 0x02, 0x7F, 0x04, 0x12, 0xD4, 0x4F, 0x7D, 0x07, 0xAF, 0x75, -0x02, 0xD4, 0xFD, 0xE5, 0x78, 0xC3, 0x95, 0x7C, 0x50, 0x61, 0xAB, 0x75, 0xAD, 0x7C, 0xAF, 0x78, -0x12, 0x72, 0x7F, 0x8F, 0x79, 0x85, 0x79, 0x77, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, -0x13, 0x54, 0x01, 0xFF, 0x90, 0x95, 0xC6, 0xE4, 0xB1, 0xC5, 0xE5, 0x79, 0xF0, 0xA3, 0xE4, 0xF0, -0xA3, 0xE5, 0x78, 0xF0, 0xE5, 0x7A, 0x31, 0xA5, 0x12, 0xDC, 0xC4, 0xE4, 0xFB, 0xFA, 0x12, 0xD4, -0xB8, 0xE5, 0x78, 0xC3, 0x94, 0x0C, 0x40, 0x2A, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x91, 0x74, 0xC4, -0x13, 0x54, 0x07, 0x30, 0xE0, 0x1C, 0xE5, 0x76, 0x60, 0x18, 0xE5, 0x7A, 0x70, 0x14, 0xE5, 0x78, -0x44, 0x80, 0xF5, 0x77, 0xB1, 0xD0, 0xE5, 0x79, 0xF0, 0x80, 0x07, 0xF1, 0xE0, 0xE5, 0x7C, 0xF0, -0xF5, 0x77, 0xB1, 0xC9, 0xE5, 0x77, 0xF0, 0xB1, 0xD0, 0xE0, 0xFF, 0x12, 0xDD, 0x19, 0xEF, 0xF0, -0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x7B, 0x12, 0xE3, 0x9C, 0x7B, 0x01, 0x7A, 0x00, 0x12, 0xD4, 0xB8, -0x90, 0x92, 0x80, 0xE5, 0x7B, 0xF0, 0xAB, 0x76, 0xAD, 0x77, 0xAF, 0x75, 0x02, 0x75, 0x80, 0x90, -0x95, 0x2F, 0x02, 0x86, 0x3D, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xC2, 0xE4, 0xF0, 0xA3, 0x22, -0x74, 0x77, 0x25, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xE4, 0x93, 0xFE, 0x74, -0x01, 0x93, 0xFF, 0xE5, 0x75, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x61, -0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, -0x30, 0xE6, 0x1A, 0xB1, 0xFE, 0xD1, 0x8F, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, -0xAF, 0x61, 0x12, 0x75, 0x80, 0xB1, 0xF1, 0xD1, 0x88, 0x74, 0x01, 0x80, 0x52, 0xF1, 0x74, 0xE0, -0x04, 0xF0, 0xF1, 0x74, 0xE0, 0x64, 0x02, 0x70, 0x1E, 0x74, 0x77, 0x25, 0x61, 0xB1, 0xD4, 0xE0, -0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, 0xB1, 0xFE, 0xE0, 0xFD, 0xD1, 0x91, 0x12, 0xE2, 0xF3, 0xB1, -0xFE, 0xD1, 0x88, 0x74, 0x02, 0x80, 0x28, 0xF1, 0x74, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x13, 0x90, -0x8A, 0xB3, 0x12, 0x90, 0x40, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0xB1, 0xF1, 0xD1, 0x88, 0x74, 0x03, -0x80, 0x0D, 0xB1, 0xFE, 0xD1, 0x8F, 0x12, 0xE2, 0xF3, 0xB1, 0xFE, 0xD1, 0x88, 0x74, 0x02, 0xF0, -0xAB, 0x61, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x22, 0xE0, -0xFD, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, -0x7D, 0x01, 0xAF, 0x67, 0xAC, 0x05, 0x90, 0x95, 0xBC, 0xEF, 0xF0, 0xFD, 0xE0, 0xFF, 0xD1, 0x00, -0xE0, 0xF5, 0x75, 0x54, 0x7F, 0xF5, 0x77, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x50, 0x12, 0x04, -0x6E, 0xE0, 0xF9, 0x90, 0x95, 0xBC, 0xE0, 0xF1, 0xD5, 0xFE, 0xEF, 0xD1, 0x93, 0xE0, 0x54, 0x03, -0xF5, 0x76, 0xE5, 0x77, 0x90, 0x81, 0x9D, 0x93, 0xFB, 0xED, 0xB1, 0xE5, 0xE4, 0xF0, 0xA3, 0xEB, -0xF0, 0x71, 0x01, 0xC4, 0x54, 0x03, 0x90, 0x95, 0xBD, 0xF0, 0x74, 0xC6, 0x2D, 0xF1, 0xE4, 0xE5, -0x77, 0xF0, 0x74, 0x46, 0x2D, 0x12, 0xE3, 0xCE, 0xE5, 0x76, 0xF0, 0xE5, 0x77, 0xD3, 0x9E, 0x40, -0x06, 0x8E, 0x77, 0xAF, 0x06, 0x8F, 0x75, 0x8C, 0x78, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x78, 0x50, -0x30, 0xE5, 0x75, 0x30, 0xE7, 0x09, 0x85, 0x77, 0x75, 0x1C, 0xEC, 0x70, 0x21, 0x80, 0x22, 0xE5, -0x77, 0xD3, 0x99, 0x40, 0x15, 0xAD, 0x01, 0x90, 0x95, 0xBC, 0xE0, 0xFB, 0x90, 0x95, 0xC1, 0xEC, -0xF0, 0xAF, 0x77, 0x12, 0xB5, 0x93, 0x8F, 0x75, 0x80, 0x07, 0x89, 0x75, 0x80, 0x03, 0x0F, 0x80, -0xCA, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0xB1, 0xC9, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x75, -0x12, 0xE3, 0x9C, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x7B, 0x01, 0xFA, 0x7D, 0x05, 0x7F, 0x08, 0x12, -0xD4, 0x4F, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x90, 0x92, 0x80, 0xE5, 0x76, 0xF0, 0xE4, 0xFB, 0xAD, -0x75, 0x02, 0x75, 0x80, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, -0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0xF3, 0xEF, 0xF0, 0xF1, 0x80, 0x30, 0xE6, 0x38, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, -0x70, 0x2E, 0x90, 0x96, 0xF4, 0xF0, 0x90, 0x96, 0xF4, 0xE0, 0xFD, 0x90, 0x96, 0xF3, 0xE0, 0xD1, -0x00, 0xE5, 0x82, 0x2D, 0x12, 0xB9, 0x4B, 0xE0, 0xFB, 0xE4, 0xFF, 0x51, 0xCC, 0x90, 0x96, 0xF4, -0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDD, 0xF1, 0x80, 0x30, 0xE0, 0x02, 0xF1, 0xEE, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, -0x74, 0xC6, 0x25, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x21, 0xAC, 0xE4, 0xFD, -0x7F, 0x8D, 0x02, 0x7B, 0x2E, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, 0x60, 0x34, 0xA3, 0xE0, -0x20, 0xE0, 0x2F, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, -0x11, 0x33, 0x30, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, 0x88, -0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, -0x71, 0x9A, 0x22, 0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x31, 0x4A, 0x90, 0x96, 0xC7, 0x12, 0x04, 0x31, 0x90, 0x96, 0xC7, 0x51, 0x7D, 0x90, -0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, -0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA5, 0xF2, 0x30, 0xE0, -0x05, 0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, 0x20, 0xE0, 0x33, 0x11, 0x33, 0x30, -0xE0, 0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0x96, 0xC5, 0xF0, 0x80, 0x06, 0x90, -0x96, 0xC5, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x96, 0xC6, 0x30, 0xE0, 0x05, -0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x96, 0xC5, 0x11, 0xB7, 0x12, 0x9B, 0xF9, -0x31, 0x57, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x4A, 0x90, 0x96, 0xCD, 0x12, 0x04, 0x31, 0x90, -0x96, 0xCD, 0x51, 0x7D, 0x12, 0x88, 0xCD, 0x91, 0x68, 0x31, 0x5F, 0x90, 0x01, 0x00, 0x74, 0x3F, -0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, -0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0xA5, 0xF2, 0x30, 0xE0, 0x05, 0x7F, 0x01, -0x12, 0x71, 0x9A, 0x11, 0x33, 0x30, 0xE0, 0x35, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x90, 0x96, -0xCB, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, 0xCB, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, -0x30, 0xE0, 0x07, 0xE4, 0x90, 0x96, 0xCC, 0xF0, 0x80, 0x06, 0x90, 0x96, 0xCC, 0x74, 0x02, 0xF0, -0x90, 0x96, 0xCB, 0x11, 0xB7, 0x12, 0x9B, 0xF9, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, -0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, -0x70, 0xED, 0x44, 0x80, 0xFD, 0xEC, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, -0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE4, 0x90, 0x95, 0x8C, 0xF0, 0xF1, 0xAA, 0x7F, 0x08, 0x12, 0x7B, -0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x91, 0x0B, 0x90, 0x93, -0x3F, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x65, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x02, 0x31, -0x5F, 0xE4, 0x90, 0x95, 0x8D, 0xF0, 0x90, 0x95, 0x8D, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, -0x51, 0xCC, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x42, 0xE0, -0xFD, 0xEF, 0x5D, 0x60, 0x0F, 0x90, 0x95, 0x8D, 0x91, 0x89, 0x90, 0x95, 0x8D, 0x91, 0xA9, 0x44, -0x40, 0xF0, 0x91, 0x61, 0x90, 0x95, 0x8D, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x90, 0x07, 0xC7, 0xE4, -0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, -0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0xF1, 0x4F, 0x90, 0x02, 0x26, 0xE0, -0x44, 0x01, 0xF0, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, 0x95, 0x8E, 0xE0, 0x30, 0xE0, 0x18, 0x90, -0x95, 0x8C, 0xE0, 0x04, 0xF1, 0x3F, 0x90, 0x02, 0x26, 0xE0, 0x90, 0x95, 0x8E, 0xF0, 0x90, 0x95, -0x8C, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE1, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, -0xE0, 0x90, 0x95, 0x8F, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, -0x90, 0x95, 0x8E, 0xF0, 0x90, 0x02, 0x01, 0x51, 0x74, 0x90, 0x02, 0x02, 0x51, 0x74, 0x90, 0x02, -0x14, 0x51, 0x74, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x54, -0xEF, 0xF0, 0x90, 0x95, 0x8F, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, -0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, 0x71, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, -0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0x8E, 0xE0, 0x2F, 0xF0, 0x22, 0x12, 0x04, 0xB8, -0x90, 0x92, 0x18, 0x12, 0x04, 0x31, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xD4, 0x31, 0x65, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x39, -0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0xB1, 0x38, 0xBF, 0x01, 0x08, 0x51, 0x8D, 0x90, 0x01, -0xE5, 0xE0, 0x04, 0xF0, 0x22, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, -0x8D, 0xF5, 0x83, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, 0x67, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, -0xA8, 0x07, 0x08, 0x22, 0x75, 0x66, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0x71, -0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, -0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, -0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x3F, 0xE0, 0x30, 0xE0, 0x70, 0x90, 0xFD, -0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, -0x95, 0x8C, 0xF0, 0x90, 0x95, 0x8C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2C, 0x51, 0xCC, 0x80, -0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFD, 0xEF, 0x5D, -0x60, 0x0F, 0x90, 0x95, 0x8C, 0x91, 0x89, 0x90, 0x95, 0x8C, 0x91, 0xA9, 0x44, 0x20, 0xF0, 0x91, -0x61, 0x90, 0x95, 0x8C, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x7F, 0x92, 0x91, 0x6A, 0xFD, 0x7F, 0x92, -0x12, 0x7B, 0x2E, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, -0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x06, 0x7F, 0x92, -0xF1, 0x47, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, -0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, 0x91, 0x0B, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x96, 0xEC, 0xEF, 0xF0, -0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, -0x90, 0x96, 0xEC, 0xE0, 0x6F, 0x60, 0x32, 0xC3, 0x90, 0x96, 0xEE, 0xE0, 0x94, 0x88, 0x90, 0x96, -0xED, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, -0xED, 0x91, 0x5A, 0xD3, 0x90, 0x96, 0xEE, 0xE0, 0x94, 0x32, 0x90, 0x96, 0xED, 0xE0, 0x94, 0x00, -0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xBC, 0x22, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, -0xE7, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, -0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, -0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x4D, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x43, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x48, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -0x18, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0x63, -0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, 0x00, 0x51, 0x9D, 0x22, 0xE4, 0x90, 0x95, 0x2F, 0xF0, 0xA3, -0xF0, 0xF1, 0x57, 0xEF, 0x64, 0x01, 0x60, 0x39, 0xC3, 0x90, 0x95, 0x30, 0xE0, 0x94, 0x88, 0x90, -0x95, 0x2F, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, -0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, 0x95, 0x2F, 0x91, 0x5A, 0xD3, 0x90, 0x95, 0x30, 0xE0, -0x94, 0x32, 0x90, 0x95, 0x2F, 0xE0, 0x94, 0x00, 0x40, 0xC7, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, -0xC0, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x90, 0x93, 0x3B, 0xE0, 0xC3, 0x13, 0x20, 0xE0, -0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, -0x05, 0x75, 0x66, 0x01, 0x80, 0x2E, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x66, 0x10, 0x80, -0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, -0x05, 0x75, 0x66, 0x04, 0x80, 0x0E, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x66, 0x20, -0x80, 0x02, 0xE1, 0x37, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x66, 0xF0, -0x7F, 0x00, 0x22, 0xE4, 0xF5, 0x7A, 0xEF, 0x14, 0xF5, 0x79, 0xED, 0xFF, 0xE5, 0x79, 0xF5, 0x82, -0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, 0x40, -0x50, 0xE5, 0x79, 0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, 0xEB, -0xF1, 0x70, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, -0x83, 0x00, 0xE5, 0x79, 0x51, 0xC9, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x13, 0x85, 0x79, 0x7B, 0x05, 0x7A, 0x90, -0x95, 0xC1, 0xE0, 0x65, 0x7A, 0x60, 0x0A, 0xE5, 0x7B, 0xD3, 0x9D, 0x40, 0x04, 0x15, 0x79, 0x80, -0x99, 0xAF, 0x7B, 0x22, 0xE4, 0x90, 0x95, 0xEE, 0xF0, 0xF1, 0x7E, 0xD1, 0xBB, 0xF1, 0x0A, 0xD1, -0xD6, 0x90, 0x07, 0xE3, 0x12, 0xA7, 0xE6, 0x60, 0x59, 0xE4, 0x90, 0x95, 0xEF, 0xF0, 0x90, 0x96, -0x11, 0x74, 0x08, 0xF0, 0x90, 0x05, 0x68, 0xE0, 0x90, 0x95, 0xF1, 0xF0, 0x90, 0x05, 0x69, 0xE0, -0x90, 0x95, 0xF2, 0xF0, 0x90, 0x05, 0x6A, 0xE0, 0x90, 0x95, 0xF3, 0xF0, 0x90, 0x05, 0x6B, 0xE0, -0x90, 0x95, 0xF4, 0xF0, 0x90, 0x05, 0x78, 0xE0, 0x90, 0x95, 0xF5, 0xF0, 0x90, 0x05, 0x79, 0xE0, -0x90, 0x95, 0xF6, 0xF0, 0x90, 0x05, 0x7A, 0xE0, 0x90, 0x95, 0xF7, 0xF0, 0x90, 0x05, 0x7B, 0xE0, -0x90, 0x95, 0xF8, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xEF, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x12, -0x04, 0x7E, 0x90, 0x95, 0xED, 0xE0, 0xFD, 0x60, 0x41, 0xA3, 0xE0, 0x51, 0xCB, 0x80, 0x05, 0xC3, -0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x60, 0xE7, 0x90, 0x95, 0xEE, 0xE0, 0xFB, -0x74, 0x01, 0xA8, 0x03, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFE, 0xF4, 0xFD, 0x90, 0x95, -0xED, 0xE0, 0x5D, 0xF0, 0x90, 0x07, 0xE3, 0xE0, 0x4E, 0xF0, 0xAF, 0x03, 0x12, 0xBF, 0xFD, 0x12, -0xBE, 0x94, 0x90, 0x95, 0xEE, 0xE0, 0x04, 0xF0, 0x80, 0xB8, 0x22, 0xE4, 0xFF, 0x74, 0x80, 0xD1, -0xFF, 0x74, 0x2D, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0x22, 0xF5, -0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x94, 0xD1, 0xFF, 0x74, 0x13, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0xE4, 0xFF, 0x74, 0x9C, 0xD1, 0xFF, 0x74, -0x1C, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x04, 0xEF, 0x22, 0x74, 0x90, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0x24, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0xE4, 0xFF, 0x74, 0x88, 0xD1, 0xFF, -0x74, 0x06, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xD1, 0xCF, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, -0xE0, 0x90, 0x93, 0x0E, 0xF0, 0xE4, 0xFF, 0xD1, 0xFD, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xD1, 0xCF, 0xB4, 0x04, 0xF1, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0xF0, -0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x22, 0x74, -0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, -0x7F, 0x01, 0x22, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x02, 0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, -0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, 0x90, 0x24, -0xA0, 0xE0, 0x90, 0x93, 0x03, 0x30, 0xE7, 0x05, 0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE0, 0x54, 0xFD, -0xF0, 0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF1, 0x3F, 0x90, 0x01, 0x98, 0xE0, -0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xAA, 0xF0, -0x74, 0xB7, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xAA, 0x04, -0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB7, 0xA3, 0xF0, 0x22, 0x90, 0x93, 0x3F, 0xE0, 0x20, 0xE0, 0x03, -0x02, 0xB8, 0x9C, 0xE4, 0x90, 0x95, 0x33, 0xF0, 0x90, 0x95, 0x33, 0xE0, 0xFF, 0xC3, 0x94, 0x05, -0x40, 0x03, 0x02, 0xB8, 0x9C, 0x51, 0xCC, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -0xFF, 0x90, 0x93, 0x40, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x03, 0x02, 0xB8, 0x93, 0x12, 0x02, 0x06, -0xFF, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x41, 0xE0, 0xFE, 0x90, 0x95, 0x33, 0xE0, 0xFD, 0x74, 0x01, -0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x41, 0xF0, 0xEF, 0xC3, -0x13, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x95, 0x33, 0xE0, 0xFE, 0x74, 0x01, -0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x42, 0xF0, 0x12, 0x87, -0xA1, 0xFF, 0x90, 0x95, 0x33, 0xE0, 0xFE, 0x24, 0x43, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -0xEF, 0x12, 0x87, 0x6B, 0xFF, 0x74, 0x48, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, -0x11, 0x9D, 0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0x98, -0xFF, 0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x40, -0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, -0x40, 0xF0, 0x22, 0x90, 0x95, 0x33, 0xE0, 0x04, 0xF0, 0x02, 0xB7, 0xD8, 0x22, 0xF0, 0x90, 0x00, -0x03, 0x12, 0x02, 0x1F, 0xFF, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0xE0, 0xF0, 0xBF, 0x01, -0x0A, 0x7F, 0x01, 0x12, 0x90, 0x49, 0xE4, 0x90, 0x93, 0xE0, 0xF0, 0x22, 0xE4, 0xFD, 0x02, 0x8F, -0xE7, 0x90, 0x95, 0xED, 0xEF, 0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x96, 0x11, -0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x70, 0x90, 0x95, 0xEE, 0x74, 0x03, 0xF0, 0x90, 0x96, 0x10, 0x74, -0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, -0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, 0x82, 0x2E, 0x31, 0x4B, 0xE0, 0xFD, 0x74, 0xF0, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xDA, 0x7B, -0x01, 0x7A, 0x95, 0x79, 0xEE, 0x31, 0x53, 0x12, 0x04, 0x7E, 0x90, 0x96, 0x11, 0xE0, 0x04, 0x54, -0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x96, 0x11, 0xE0, 0x90, 0x04, 0x7F, 0xF0, -0x90, 0x95, 0xED, 0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, 0x90, 0x8A, 0x79, 0x12, 0x90, -0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFF, 0x01, 0xC1, 0xF5, 0x82, 0xE4, 0x35, 0x83, -0xF5, 0x83, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x27, -0x90, 0x96, 0x52, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0x74, 0x74, 0x01, 0xF0, 0x90, 0x96, 0x54, 0xEF, -0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x52, 0x31, 0x53, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, -0x90, 0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, -0x30, 0xE0, 0x10, 0xA3, 0x74, 0x01, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, -0x02, 0x31, 0xC2, 0x12, 0xA5, 0x47, 0xE4, 0xFF, 0x31, 0x60, 0x90, 0x8B, 0x07, 0xB1, 0x11, 0x02, -0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x04, 0x7F, -0x01, 0x80, 0x02, 0x7F, 0x02, 0x31, 0xDC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x2F, 0xE0, 0x90, 0x96, 0xFE, 0xF0, 0x6F, 0x70, 0x02, 0x41, 0xE6, -0xEF, 0x14, 0x60, 0x42, 0x14, 0x60, 0x70, 0x14, 0x70, 0x02, 0x41, 0x92, 0x14, 0x70, 0x02, 0x41, -0xBD, 0x24, 0x04, 0x60, 0x02, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x3A, -0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, 0x4A, 0x41, 0xE6, 0x90, 0x96, 0xFE, -0xE0, 0xB4, 0x03, 0x04, 0x71, 0x4F, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0x64, 0x01, 0x60, 0x02, -0x41, 0xE6, 0x71, 0x3D, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x05, 0x12, 0x97, 0xAE, -0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x05, 0x12, 0x97, 0xB9, 0x41, 0xE6, 0x90, 0x96, -0xFE, 0xE0, 0xB4, 0x03, 0x05, 0x12, 0x97, 0xA0, 0x41, 0xE6, 0x90, 0x96, 0xFE, 0xE0, 0x60, 0x02, -0x41, 0xE6, 0x12, 0x97, 0xF4, 0x80, 0x7F, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x11, -0x80, 0x74, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x01, 0x04, 0x51, 0xFD, 0x80, 0x69, 0x90, 0x96, 0xFE, -0xE0, 0xB4, 0x03, 0x04, 0x71, 0x5C, 0x80, 0x5E, 0x90, 0x96, 0xFE, 0xE0, 0x70, 0x58, 0x51, 0xFA, -0x80, 0x54, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x04, 0x04, 0x71, 0x8B, 0x80, 0x49, 0x90, 0x96, 0xFE, -0xE0, 0xB4, 0x01, 0x04, 0x71, 0x26, 0x80, 0x3E, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, -0x54, 0x80, 0x33, 0x90, 0x96, 0xFE, 0xE0, 0x70, 0x2D, 0x71, 0x23, 0x80, 0x29, 0x90, 0x96, 0xFE, -0xE0, 0xB4, 0x03, 0x04, 0x71, 0x6D, 0x80, 0x1E, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x01, 0x04, 0x51, -0xEE, 0x80, 0x13, 0x90, 0x96, 0xFE, 0xE0, 0xB4, 0x02, 0x04, 0x71, 0x9D, 0x80, 0x08, 0x90, 0x96, -0xFE, 0xE0, 0x70, 0x02, 0x51, 0xEB, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x97, 0xF4, 0x90, 0x8A, -0xF9, 0x12, 0x90, 0x40, 0x7D, 0x1F, 0x71, 0x79, 0xF0, 0x22, 0x12, 0x97, 0xF4, 0x90, 0x8A, 0xF9, -0x12, 0x90, 0x40, 0x7D, 0x20, 0x71, 0x64, 0x12, 0x88, 0xD0, 0x90, 0x88, 0x2F, 0x74, 0x02, 0xF0, -0x22, 0x12, 0x97, 0xF6, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x23, 0x71, 0x64, 0x12, 0x88, -0xD0, 0x80, 0xE7, 0x12, 0x97, 0xF4, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x21, 0x7F, 0xFF, -0x12, 0x04, 0x7E, 0x90, 0x88, 0x2F, 0x74, 0x03, 0xF0, 0x22, 0x12, 0x97, 0xAE, 0x90, 0x05, 0x27, -0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0x90, 0x88, 0x2F, 0xF0, 0x22, 0x12, 0x97, 0xB9, 0x80, 0xEE, 0x12, -0x97, 0xA0, 0x80, 0xE9, 0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x80, 0xD7, 0x90, 0x8A, 0xEF, 0x12, -0x88, 0xD0, 0x80, 0xA6, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x90, 0x8A, 0xF9, -0x12, 0x90, 0x40, 0x7D, 0x25, 0x71, 0x79, 0xF0, 0x22, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x05, -0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, 0x88, 0x2F, 0x74, 0x04, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x90, -0x40, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x12, 0x97, 0xF6, 0x80, 0x96, 0x90, 0x86, 0x0C, -0x12, 0x88, 0xD0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x7D, 0x24, 0x71, 0x79, 0xF0, 0x22, 0x90, -0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x4A, 0x90, 0x88, 0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, -0x7E, 0x01, 0x90, 0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, -0x30, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x21, 0xC2, 0x91, 0x02, 0x90, 0x88, 0x30, 0xE0, 0xB4, -0x0C, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x10, 0x90, 0x88, -0x30, 0xE0, 0xB4, 0x04, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0xFF, 0x12, 0x04, -0x7E, 0x22, 0x90, 0x01, 0x57, 0xE0, 0x60, 0x20, 0x12, 0xD0, 0x16, 0xF0, 0x90, 0x88, 0x31, 0x12, -0x9F, 0xE7, 0x30, 0xE0, 0x03, 0x02, 0xD0, 0x3D, 0x12, 0xE2, 0x5C, 0x40, 0x0B, 0xE4, 0xFF, 0x12, -0x78, 0x4A, 0xBF, 0x01, 0x03, 0x12, 0x9F, 0xD9, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x29, 0xF0, 0x74, 0xBC, 0xA3, 0xF0, -0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x03, 0x12, 0xD0, 0x84, 0xE5, 0x2D, 0x30, 0xE1, 0x02, -0x31, 0x47, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xDD, 0x6D, 0xE5, 0x2D, 0x30, 0xE5, 0x03, 0x12, -0xDD, 0x7E, 0xE5, 0x2D, 0x30, 0xE6, 0x03, 0x12, 0xC8, 0x58, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x31, -0x9C, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0xC8, 0x65, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xCF, -0xDF, 0xE5, 0x2F, 0x30, 0xE3, 0x03, 0x12, 0xD0, 0x02, 0xE5, 0x2F, 0x30, 0xE4, 0x03, 0x12, 0xD0, -0x1E, 0xE5, 0x2F, 0x30, 0xE5, 0x03, 0x12, 0xD0, 0x49, 0xE5, 0x2F, 0x30, 0xE6, 0x03, 0x12, 0xD0, -0x6B, 0xE5, 0x30, 0x30, 0xE4, 0x02, 0xF1, 0xDB, 0xE5, 0x30, 0x30, 0xE5, 0x02, 0xB1, 0x09, 0xE5, -0x36, 0x30, 0xE0, 0x03, 0x12, 0xB6, 0x04, 0xE5, 0x36, 0x30, 0xE6, 0x02, 0xB1, 0x5B, 0xE5, 0x36, -0x30, 0xE7, 0x02, 0xB1, 0x19, 0xE5, 0x37, 0x30, 0xE2, 0x02, 0xB1, 0x25, 0xE5, 0x37, 0x30, 0xE3, -0x02, 0xB1, 0x31, 0x74, 0x29, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBC, 0xA3, 0xF0, 0xD0, 0x07, -0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x8A, 0xDF, 0xB1, 0x11, 0x02, 0x04, -0x7A, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, -0x7F, 0x01, 0xB1, 0x3D, 0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x02, 0xB1, 0x3D, -0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0xB1, 0x3D, 0x22, 0x90, 0x95, 0xEF, -0xEF, 0xF0, 0x90, 0x95, 0xED, 0x74, 0x18, 0xF0, 0x90, 0x96, 0x0F, 0x74, 0x01, 0xF0, 0xFB, 0x7A, -0x95, 0x79, 0xED, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, 0x93, 0x03, 0xE0, 0x30, -0xE0, 0x1E, 0xE4, 0xFF, 0xB1, 0x3D, 0xE4, 0xFF, 0xB1, 0x81, 0x7F, 0x01, 0xB1, 0x81, 0x90, 0x93, -0x03, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x80, 0xF0, -0x22, 0xEF, 0x70, 0x05, 0x90, 0x93, 0x05, 0x80, 0x03, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x12, 0x7B, -0x07, 0x90, 0x95, 0xED, 0xEF, 0xF0, 0x90, 0x95, 0xED, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, -0xD1, 0x34, 0xE4, 0xFF, 0x74, 0x08, 0x2F, 0xF1, 0x84, 0xE0, 0xFE, 0xD1, 0x27, 0x8F, 0x82, 0x75, -0x83, 0x00, 0xD1, 0x2D, 0xB4, 0x06, 0xED, 0x90, 0x95, 0xED, 0xE0, 0x24, 0x52, 0xF9, 0xE4, 0x34, -0xFC, 0xD1, 0x34, 0x12, 0x02, 0x06, 0x70, 0x5E, 0xD1, 0x27, 0x12, 0x87, 0xA1, 0x64, 0x02, 0x70, -0x55, 0x90, 0x24, 0x87, 0xE0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x5E, 0x90, 0x24, 0x86, 0xE0, 0x90, -0x00, 0x04, 0x12, 0x02, 0x5E, 0xD1, 0x27, 0x12, 0x87, 0x65, 0x64, 0x01, 0x70, 0x38, 0x12, 0x9F, -0xEF, 0x64, 0x0D, 0x70, 0x31, 0xFF, 0x74, 0x88, 0x12, 0xB6, 0xFF, 0xEF, 0x24, 0x08, 0xD1, 0x3B, -0xD1, 0x50, 0xD1, 0x2D, 0xB4, 0x08, 0xEF, 0x90, 0x05, 0xDC, 0xE0, 0xFF, 0xD1, 0x27, 0x90, 0x00, -0x10, 0xEF, 0x12, 0x02, 0x5E, 0xE4, 0xFF, 0x12, 0xB6, 0xFD, 0xEF, 0x24, 0x11, 0xD1, 0x3B, 0xD1, -0x50, 0xD1, 0x2D, 0xB4, 0x04, 0xF1, 0x22, 0x90, 0x95, 0xEE, 0x02, 0x86, 0x3D, 0xEE, 0x12, 0x02, -0x5E, 0x0F, 0xEF, 0x22, 0xFA, 0x7B, 0x01, 0xA3, 0x02, 0x86, 0x46, 0xFD, 0xE4, 0x33, 0xFC, 0x90, -0x95, 0xEE, 0x22, 0x7E, 0x00, 0xC3, 0x74, 0x07, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, 0x16, -0x12, 0x86, 0x3D, 0x8D, 0x82, 0x8C, 0x83, 0x22, 0xF1, 0x8C, 0x90, 0x96, 0x19, 0xF0, 0x90, 0x96, -0x19, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x29, 0xD1, 0x43, 0xF1, 0x7C, 0x12, 0xC1, 0x2F, 0xC3, -0x9D, 0x50, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x96, 0x19, 0xE0, 0xFF, 0xD1, 0x43, 0xF1, 0x7C, 0x12, -0xC1, 0x2F, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, 0x22, 0x90, 0x96, 0x19, 0xE0, 0x04, 0xF0, 0x80, -0xCD, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x96, 0x12, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0xFF, 0xC3, 0x13, -0x20, 0xE0, 0x78, 0xF1, 0x62, 0xF1, 0x57, 0xD1, 0x58, 0xEF, 0x60, 0x0D, 0x7B, 0x01, 0x7A, 0x93, -0x79, 0x13, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x5A, 0xF1, 0x62, 0xF1, 0x57, 0xD1, 0x58, 0xEF, -0x60, 0x18, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x13, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x0B, 0x7B, -0x01, 0x7A, 0x93, 0x79, 0x1C, 0x12, 0xE3, 0x01, 0x70, 0x39, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x20, -0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, 0x06, 0xD1, 0x58, 0xEF, 0x60, 0x10, 0xF1, -0x51, 0xD1, 0x58, 0xEF, 0x60, 0x09, 0xF1, 0x62, 0xF1, 0x57, 0xF1, 0x94, 0xEF, 0x70, 0x14, 0xF1, -0x62, 0xF1, 0x57, 0xF1, 0x69, 0xEF, 0x60, 0x26, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0F, 0x12, 0xE3, -0x01, 0x60, 0x1B, 0x90, 0x96, 0x12, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xF1, 0x51, 0xD1, 0x58, 0xEF, -0x60, 0x0C, 0xF1, 0x51, 0xF1, 0x94, 0xEF, 0x70, 0x05, 0x90, 0x96, 0x12, 0x04, 0xF0, 0x90, 0x96, -0x12, 0xE0, 0xFF, 0x90, 0x05, 0x18, 0xE4, 0xF0, 0xA3, 0xF0, 0xEF, 0x90, 0x05, 0xB3, 0x60, 0x0C, -0xE0, 0x44, 0x80, 0xF0, 0x90, 0x24, 0xA0, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xE0, 0x44, 0x20, 0xF0, -0x22, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x2D, 0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, -0x20, 0x22, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x06, 0x22, 0xF1, 0x8C, 0xFF, 0xF1, 0xE0, 0x6E, 0x60, -0x03, 0x7F, 0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x08, 0xF3, 0x7F, 0x01, 0x22, 0x12, 0x02, 0x1F, 0xFD, -0xC3, 0x74, 0x07, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0x90, 0x96, 0x13, 0x12, -0x86, 0x46, 0xE4, 0x22, 0xF1, 0x8C, 0xFF, 0xF1, 0xE0, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, -0xEF, 0xB4, 0x06, 0xF3, 0x7F, 0x01, 0x22, 0xF1, 0x8C, 0x90, 0x96, 0x19, 0xF0, 0x90, 0x96, 0x19, -0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x21, 0x12, 0xC1, 0x14, 0xC3, 0x9D, 0x50, 0x03, 0x7F, 0x00, -0x22, 0x90, 0x96, 0x19, 0xE0, 0xFF, 0x12, 0xC1, 0x14, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, 0x22, -0x90, 0x96, 0x19, 0xE0, 0x04, 0xF0, 0x80, 0xD5, 0x7F, 0x00, 0x22, 0xE4, 0xFF, 0x02, 0x35, 0xBE, -0x90, 0x96, 0x16, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x12, 0x02, 0x1F, 0xFE, 0x90, -0x96, 0x13, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, 0x02, 0x1F, 0xE4, 0x90, 0x96, -0x16, 0xF0, 0xEF, 0x75, 0xF0, 0x40, 0xA4, 0x24, 0x80, 0xF9, 0x74, 0x82, 0x35, 0xF0, 0xFA, 0x7B, -0x01, 0x90, 0x96, 0x12, 0x12, 0x86, 0x46, 0x12, 0x02, 0x06, 0x90, 0x96, 0x15, 0xF0, 0xA3, 0x74, -0x1C, 0xF0, 0x90, 0x96, 0x15, 0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x21, 0x08, -0x90, 0x96, 0x12, 0x12, 0x86, 0x3D, 0x8E, 0x82, 0x12, 0xBF, 0xF7, 0x90, 0x96, 0x17, 0xF0, 0xEE, -0xFD, 0x7C, 0x00, 0xF5, 0x82, 0x8C, 0x83, 0xA3, 0xA3, 0x12, 0x02, 0x1F, 0xFE, 0x8D, 0x82, 0x8C, -0x83, 0xA3, 0x12, 0x02, 0x1F, 0xFD, 0xED, 0xFF, 0x90, 0x96, 0x18, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -0x90, 0x96, 0x17, 0xE0, 0x64, 0x01, 0x60, 0x0E, 0xA3, 0xA3, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0x96, -0x16, 0xE0, 0x2F, 0xF0, 0x80, 0xAC, 0xE4, 0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, -0xC3, 0x94, 0x08, 0x50, 0x1A, 0x90, 0x96, 0x16, 0xE0, 0x24, 0x03, 0x31, 0x41, 0x31, 0x37, 0xFF, -0x90, 0x96, 0x1A, 0xE0, 0x24, 0x20, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x31, 0x09, 0x80, 0xDC, 0x90, -0x96, 0x16, 0xE0, 0x24, 0x0B, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x96, 0x12, 0x31, 0x37, 0x90, 0x93, -0x28, 0xF0, 0x70, 0x2B, 0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, 0x24, 0x10, 0xFD, -0xE4, 0x33, 0xFC, 0x90, 0x96, 0x12, 0x12, 0xBE, 0x50, 0x12, 0x02, 0x1F, 0xFE, 0x74, 0x29, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0x31, 0x0C, 0xE0, 0xB4, 0x04, 0xDA, 0x22, 0xE4, -0x90, 0x96, 0x1A, 0xF0, 0x90, 0x96, 0x1A, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x1A, 0x90, 0x96, -0x16, 0xE0, 0x24, 0x0C, 0x31, 0x41, 0x31, 0x37, 0xFF, 0x90, 0x96, 0x1A, 0xE0, 0x24, 0x29, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0x31, 0x09, 0x80, 0xDC, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x96, 0x1A, -0xE0, 0x04, 0xF0, 0x22, 0x7E, 0x00, 0xC3, 0x74, 0x03, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, -0x16, 0x12, 0x86, 0x3D, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, 0xFD, 0xC3, 0x74, 0x03, 0x9F, -0xFF, 0xE4, 0x9E, 0xFE, 0x90, 0x96, 0x13, 0x12, 0x86, 0x3D, 0x8F, 0x82, 0x8E, 0x83, 0x02, 0x02, -0x1F, 0xFD, 0xE4, 0x33, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x96, 0x12, -0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, 0xA3, 0x77, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x90, 0x00, 0x80, -0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x91, 0x43, 0x71, 0x75, 0x12, 0x7B, 0x79, -0x71, 0xBD, 0x31, 0x51, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0x74, 0x02, 0xF0, 0xFF, -0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0xE0, 0x04, 0xF0, 0x51, 0x61, 0x51, 0xAB, 0x90, 0x00, 0x80, -0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, -0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x05, 0xE4, 0xFF, 0x12, 0x90, 0x49, 0x12, 0xB4, 0xEA, 0x90, 0x00, -0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0x71, 0x61, 0x31, 0xCF, 0x90, 0x00, -0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x7E, -0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE1, 0x12, 0x04, 0x80, 0x51, 0x5A, -0x71, 0x5A, 0xBF, 0x01, 0x1C, 0x90, 0x95, 0x2F, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x93, 0xE1, 0xF0, -0xEE, 0x54, 0x04, 0x90, 0x93, 0xE3, 0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x08, 0x90, 0x93, 0xE2, -0xF0, 0x51, 0x5A, 0x7F, 0xFB, 0x12, 0x97, 0x97, 0x70, 0x35, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x07, -0x70, 0x15, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x30, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x0F, 0x90, 0x95, 0x30, 0x80, 0x03, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0x07, 0x90, 0x93, 0xE5, -0xF0, 0x90, 0x95, 0x2F, 0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0xE4, 0xF0, 0x51, -0x5A, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x95, 0x2F, 0xE0, 0x54, -0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0xE6, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x2F, -0x22, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, 0x51, 0x7B, 0x90, 0x01, 0x64, 0x74, 0x01, -0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, -0xE0, 0x91, 0x08, 0x71, 0xDD, 0xE4, 0xF5, 0x21, 0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, -0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, -0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0x71, 0x54, 0x12, 0x7B, 0xDB, -0x90, 0x8A, 0xC5, 0x12, 0x88, 0xD0, 0x51, 0xCF, 0x71, 0x9E, 0x12, 0x96, 0x54, 0x51, 0xCA, 0x71, -0x8F, 0x90, 0x8A, 0x73, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x71, 0x82, 0x02, 0x04, 0x80, 0x7B, -0x00, 0x7A, 0x00, 0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x46, 0x7B, 0xFF, 0x7A, 0x80, 0x79, -0x80, 0x90, 0x89, 0x31, 0x12, 0x86, 0x46, 0x7A, 0x80, 0x79, 0xBF, 0x90, 0x89, 0x34, 0x12, 0x86, -0x46, 0x7A, 0x81, 0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x46, 0x7A, 0x81, 0x79, 0x75, 0x90, -0x89, 0x3D, 0x12, 0x86, 0x46, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, 0x12, 0x86, 0x46, 0x71, -0x6B, 0x7A, 0x81, 0x79, 0xD9, 0x90, 0x89, 0x49, 0x12, 0x86, 0x46, 0x7A, 0x82, 0x79, 0x01, 0x90, -0x89, 0x4C, 0x12, 0x86, 0x46, 0xE4, 0x90, 0x96, 0x76, 0xF0, 0x90, 0x95, 0x2F, 0xF0, 0x90, 0x95, -0x2F, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x0F, 0x74, 0x87, 0x2F, 0x71, 0x4C, 0xE4, 0xF0, 0x90, -0x95, 0x2F, 0xE0, 0x04, 0xF0, 0x80, 0xE7, 0x22, 0x74, 0x87, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -0x96, 0xF5, 0x83, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, -0xA6, 0x90, 0x01, 0xE4, 0x74, 0x10, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, -0x89, 0x46, 0x02, 0x86, 0x46, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, -0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3B, 0x22, 0x7E, -0x00, 0x7F, 0x88, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x58, 0x02, 0x04, 0x80, 0x7E, 0x00, -0x7F, 0x01, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x04, 0x80, 0x90, 0x88, 0x2C, -0xE0, 0x54, 0xFD, 0xF0, 0xE4, 0x12, 0xA3, 0x78, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0x90, 0x01, 0x8C, -0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, -0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x75, 0x39, 0x06, -0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, 0x10, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, -0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, -0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x75, 0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, -0x07, 0x75, 0x2C, 0x32, 0xF5, 0x31, 0x75, 0x32, 0xC1, 0x75, 0x33, 0x0C, 0xF5, 0x34, 0x90, 0x01, -0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, 0xF0, -0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, 0xE5, -0x34, 0xF0, 0x22, 0x90, 0x8A, 0x79, 0x74, 0x87, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE5, -0x74, 0xC6, 0xF0, 0xA3, 0x74, 0x81, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0xA0, 0xF0, 0xA3, 0x74, 0xCB, -0xF0, 0x90, 0x8A, 0xB9, 0x74, 0x88, 0xF0, 0xA3, 0x74, 0xDA, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0xAE, -0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x90, 0x8A, 0xA5, 0x74, 0xAB, 0xF0, 0xA3, 0x74, 0x0D, 0xF0, 0x90, -0x8A, 0xC3, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0x0E, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xDE, 0xF0, 0xA3, -0x74, 0x7C, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0x9D, 0xF0, 0xA3, 0x74, 0xF7, 0xF0, 0x90, 0x86, 0x04, -0x74, 0xDE, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xDE, 0xF0, 0xA3, 0x74, 0x88, -0xF0, 0x90, 0x86, 0x0C, 0x74, 0xB0, 0xF0, 0xA3, 0x74, 0x3B, 0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xB0, -0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xE0, 0xF0, 0xA3, 0x74, 0xE5, 0xF0, 0x90, -0x86, 0x02, 0x74, 0xE1, 0xF0, 0xA3, 0x74, 0x44, 0xF0, 0x90, 0x8A, 0xFD, 0x74, 0xD1, 0xF0, 0xA3, -0x74, 0x59, 0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xD4, 0xF0, 0xA3, 0x74, 0x3E, 0xF0, 0x90, 0x8A, 0xDB, -0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x3A, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0x9C, 0xF0, 0xA3, 0x74, 0x05, -0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0x72, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xE2, -0xF0, 0xA3, 0x74, 0x17, 0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xE2, 0xF0, 0xA3, 0x74, 0x75, 0xF0, 0x90, -0x86, 0x06, 0x74, 0xD3, 0xF0, 0xA3, 0x74, 0x28, 0xF0, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, -0x2A, 0xF0, 0x74, 0xC5, 0xA3, 0xF0, 0x90, 0x93, 0x57, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, -0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, -0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0x2A, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -0xC5, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x95, 0x89, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, -0x95, 0x89, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0xEA, 0xE0, 0x70, 0x18, 0x90, 0x93, 0xE7, 0xE0, -0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x95, 0x89, 0xE0, 0x24, 0x66, 0x90, 0x01, 0xC4, 0xF0, -0x74, 0xC5, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, -0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, -0x9F, 0x1F, 0xC2, 0xAF, 0xB1, 0x2A, 0xBF, 0x01, 0x03, 0x12, 0xB4, 0xCA, 0xD2, 0xAF, 0xB1, 0xC8, -0x12, 0xAF, 0xEC, 0x12, 0x83, 0x4D, 0x80, 0xA7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x93, 0xE7, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xD1, 0x75, 0xEF, 0x44, -0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0xD1, 0x75, 0x90, 0x92, 0x18, -0x12, 0x04, 0x31, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, 0xE2, 0xE0, 0x70, 0x29, -0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x95, 0x90, 0x74, 0x22, 0xF0, 0x90, -0x95, 0xB2, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x92, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0x90, 0x12, 0x90, 0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0xEA, 0xE0, 0xFF, 0x70, 0x0A, -0x90, 0x93, 0xE7, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, -0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, -0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0xE7, 0xE0, 0x60, 0x06, 0x90, 0x01, -0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xE8, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x8C, 0x12, 0x04, 0x31, 0x90, 0x95, 0x8C, 0x02, 0x04, -0xB8, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x0D, 0xF0, 0x22, -0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -0x74, 0x90, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0x74, 0x90, 0x04, 0x90, 0x01, 0xC4, -0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -0x74, 0xE0, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE1, 0x03, 0x12, -0x9F, 0x15, 0xE5, 0x3D, 0x30, 0xE2, 0x03, 0x12, 0x9F, 0x54, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, -0xB4, 0xE5, 0x3D, 0x30, 0xE5, 0x02, 0xF1, 0xB7, 0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0xD0, 0xC7, -0xE5, 0x3E, 0x30, 0xE4, 0x02, 0xF1, 0xBA, 0xE5, 0x3F, 0x30, 0xE1, 0x03, 0x12, 0xBB, 0xAF, 0xE5, -0x3F, 0x30, 0xE0, 0x03, 0x12, 0xD1, 0xB9, 0xE5, 0x3F, 0x30, 0xE4, 0x02, 0xF1, 0xB3, 0xE5, 0x3F, -0x30, 0xE2, 0x0A, 0x12, 0xD2, 0x0E, 0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, -0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x90, 0x40, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, -0xE4, 0x03, 0x12, 0xA7, 0xA9, 0xE5, 0x40, 0x30, 0xE5, 0x03, 0x12, 0xD2, 0x70, 0xE5, 0x40, 0x30, -0xE6, 0x03, 0x12, 0xD2, 0xB6, 0xE5, 0x40, 0x30, 0xE7, 0x03, 0x12, 0xD2, 0x50, 0x74, 0xE0, 0x04, -0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, -0xD0, 0xE0, 0x32, 0x22, 0x02, 0x34, 0x78, 0x02, 0x8D, 0x6F, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, -0x0F, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x40, 0xF0, -0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -0xC4, 0x74, 0xD1, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x88, 0xD0, 0x53, 0x91, -0xBF, 0x74, 0xD1, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, -0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x27, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0xC8, 0xFF, -0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, -0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x05, 0xE4, -0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, -0x03, 0x90, 0x8A, 0x87, 0x12, 0x88, 0xD0, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, -0x04, 0xF0, 0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, -0x14, 0x12, 0xB4, 0x71, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, -0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0x9C, 0xD1, 0x54, 0x03, 0x30, -0xE0, 0x13, 0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, -0xF0, 0x90, 0x88, 0xE8, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x88, 0x2E, 0x74, -0x01, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x75, 0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x12, 0x8D, -0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, -0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, -0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0x90, 0x88, -0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0A, -0x91, 0x92, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0x31, 0x6A, 0x90, 0x88, 0x32, 0x12, 0xA5, 0xF2, -0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0x9B, 0x90, 0x8A, 0xE5, -0x12, 0x90, 0x40, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x0A, 0x90, -0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0x9B, 0x22, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, -0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD3, 0xFE, 0x90, 0x95, 0x2F, 0xF0, -0x90, 0x88, 0x32, 0x12, 0xA9, 0xA4, 0x30, 0xE0, 0x02, 0x41, 0x38, 0x90, 0x88, 0x31, 0xE0, 0x30, -0xE0, 0x1C, 0x51, 0x58, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, -0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, -0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, -0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, -0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, -0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, -0x4B, 0x51, 0x44, 0x90, 0x88, 0x4E, 0x51, 0x4D, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, -0x88, 0x4E, 0x51, 0x44, 0x90, 0x88, 0x3E, 0x51, 0x4D, 0x98, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, -0x90, 0x88, 0x4E, 0x12, 0xA5, 0xF2, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, 0xEF, -0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, 0xE0, -0x54, 0xF8, 0x4F, 0xF0, 0x31, 0x6A, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, -0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x22, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x90, -0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, 0x2E, 0xE0, 0x24, 0x46, 0xFF, -0x90, 0x95, 0x2D, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, -0x12, 0x85, 0xBA, 0x90, 0x88, 0x85, 0x91, 0x66, 0xEF, 0x24, 0x46, 0x91, 0xAC, 0x90, 0x88, 0x89, -0x91, 0x66, 0x90, 0x88, 0x85, 0x12, 0x9E, 0xEA, 0x50, 0x02, 0x61, 0x4D, 0x90, 0x88, 0x89, 0x12, -0x86, 0x31, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, 0xBA, 0x90, 0x95, 0xF1, 0x12, 0x04, -0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2B, 0x51, 0x58, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, -0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, -0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x91, 0x6F, 0xEB, 0x2F, 0xFF, -0xEA, 0x80, 0x1E, 0x90, 0x88, 0x33, 0x12, 0x9F, 0xE7, 0x30, 0xE0, 0x02, 0x81, 0x4A, 0x91, 0x6F, -0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, -0xED, 0x3E, 0x90, 0x95, 0xED, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x95, 0xEE, 0xE0, 0x94, 0xA0, -0x90, 0x95, 0xED, 0xE0, 0x94, 0x00, 0x50, 0x35, 0xA3, 0xE0, 0xFB, 0x24, 0xED, 0x91, 0x5D, 0x04, -0xF0, 0x90, 0x95, 0xF1, 0x12, 0x04, 0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0x8D, 0x2B, 0x91, 0x52, -0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x95, 0xED, 0xA3, 0xE0, 0x91, 0x50, 0xEF, 0xF0, -0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, -0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, -0x81, 0x4A, 0xE4, 0xFF, 0xFE, 0x91, 0x5A, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, -0x9D, 0x40, 0x07, 0x90, 0x95, 0xEF, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE6, 0x91, -0x7A, 0x9C, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, 0xEF, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, -0x50, 0x13, 0x91, 0x5A, 0x2F, 0xFF, 0x91, 0x7A, 0x9C, 0x40, 0x07, 0x90, 0x95, 0xF0, 0xEE, 0xF0, -0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x91, 0x4B, 0xE0, 0xFD, 0xEF, 0xC3, -0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, -0xF0, 0xE0, 0x80, 0x18, 0x91, 0x4B, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, -0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x95, 0xF0, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, -0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, -0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, -0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, -0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, -0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, -0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x91, 0x92, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, -0x8A, 0xA3, 0x12, 0x90, 0x40, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x95, 0xEF, 0xE0, 0xFE, -0x24, 0x8D, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, -0x95, 0xF1, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, -0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, -0xE4, 0x22, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, -0x92, 0x98, 0x22, 0x90, 0x96, 0xB5, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0x01, 0xFF, 0xE4, 0x3E, 0xFE, -0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xFF, 0x20, 0xE0, 0x02, 0xE1, -0xA5, 0x90, 0x93, 0xD9, 0xE0, 0xFE, 0x20, 0xE0, 0x02, 0xC1, 0x1E, 0x90, 0x93, 0xD7, 0xE0, 0xFD, -0x90, 0x93, 0xDA, 0xE0, 0xD3, 0x9D, 0x50, 0x02, 0xC1, 0x1E, 0x90, 0x05, 0x58, 0xE0, 0x90, 0x96, -0xBD, 0xF0, 0xEF, 0x12, 0x8F, 0xD3, 0x54, 0x07, 0xFF, 0x64, 0x02, 0x60, 0x03, 0xEF, 0x70, 0x24, -0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x1B, 0x90, 0x93, 0xD9, 0xE0, 0x44, 0x40, 0xF0, -0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0xBD, 0xE0, 0xFF, 0x90, 0x93, 0xD6, 0xE0, 0x2F, 0x24, -0xFD, 0x12, 0xA6, 0x10, 0x12, 0x8D, 0x4F, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0x12, 0x86, 0x24, 0x90, 0x96, 0xB1, 0x12, 0x04, 0x31, 0x90, 0x05, 0x65, 0x12, 0x8D, 0x68, -0xF1, 0xCA, 0x90, 0x05, 0x64, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x05, 0x66, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0xF1, 0xB6, 0x90, 0x93, 0xD6, 0xE0, 0xFB, 0xE4, 0xFA, 0xF9, 0xF8, 0x90, 0x96, 0xBD, -0x12, 0x8D, 0x68, 0x12, 0x85, 0xAD, 0xE4, 0xFB, 0x7A, 0x04, 0x12, 0x85, 0xC8, 0x90, 0x96, 0xB1, -0x12, 0x86, 0x31, 0x12, 0x85, 0xAD, 0x90, 0x96, 0xB9, 0x12, 0xE3, 0x39, 0xF1, 0xD8, 0x50, 0x04, -0x91, 0xA3, 0xF1, 0xB9, 0xF1, 0xBF, 0x90, 0x05, 0x8B, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xAE, -0x90, 0x05, 0x8A, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xA6, 0x90, 0x05, 0x89, 0xEF, 0xF0, 0x90, -0x96, 0xB5, 0x12, 0xE3, 0x8A, 0x90, 0x96, 0xB9, 0xF1, 0xC2, 0x90, 0x05, 0x87, 0xEF, 0xF0, 0x90, -0x96, 0xB9, 0xF1, 0xAE, 0x90, 0x05, 0x86, 0xEF, 0xF0, 0x90, 0x96, 0xB9, 0xF1, 0xA6, 0x90, 0x05, -0x85, 0xEF, 0xF0, 0x90, 0x96, 0xB9, 0x12, 0xE2, 0xD4, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, 0x93, -0xD5, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0xA5, 0x90, 0x93, 0xD9, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0x54, -0x1F, 0x70, 0x02, 0xE1, 0xA5, 0xEF, 0x54, 0xC1, 0xFF, 0xEE, 0x14, 0x54, 0x1F, 0x25, 0xE0, 0x4F, -0xF0, 0xE0, 0xC3, 0x13, 0x54, 0x1F, 0x60, 0x02, 0xE1, 0xA5, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x40, -0xF0, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0xF0, 0x90, 0x05, 0x69, 0x12, 0x8D, 0x68, 0xF1, 0xCA, -0x90, 0x05, 0x68, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0x90, 0x05, 0x6A, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x86, 0x24, 0x90, 0x96, 0xB1, 0x12, 0xE3, 0x39, 0x12, 0x04, 0x31, 0x90, 0x05, 0x6D, 0x12, -0x8D, 0x68, 0xF1, 0xCA, 0x90, 0x05, 0x6C, 0x12, 0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, -0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6E, 0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0xF1, 0xB6, 0x90, 0x96, 0xB1, 0x12, 0x86, 0x31, 0xC0, 0x00, 0xC0, 0x01, -0xC0, 0x02, 0xC0, 0x03, 0x90, 0x93, 0xD5, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xE4, 0xFC, 0xFD, -0xFE, 0x12, 0xE3, 0x82, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xAD, 0x90, -0x96, 0xB1, 0x12, 0x04, 0x31, 0x90, 0x96, 0xB9, 0x12, 0x04, 0xB8, 0x90, 0x96, 0xB1, 0x12, 0x9E, -0xEA, 0x50, 0x04, 0x91, 0xA3, 0xF1, 0xB9, 0xF1, 0xBF, 0x90, 0x05, 0x67, 0xEF, 0xF0, 0x90, 0x96, -0xB5, 0xF1, 0xAE, 0x90, 0x05, 0x66, 0xEF, 0xF0, 0x90, 0x96, 0xB5, 0xF1, 0xA6, 0x90, 0x05, 0x65, -0xEF, 0xF0, 0x90, 0x96, 0xB5, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x64, 0xEF, 0xF0, 0x90, 0x96, 0xB1, -0xF1, 0xC2, 0x90, 0x05, 0x63, 0xEF, 0xF0, 0x90, 0x96, 0xB1, 0xF1, 0xAE, 0x90, 0x05, 0x62, 0xEF, -0xF0, 0x90, 0x96, 0xB1, 0xF1, 0xA6, 0x90, 0x05, 0x61, 0xEF, 0xF0, 0x90, 0x96, 0xB1, 0x12, 0x04, -0xB8, 0x90, 0x05, 0x60, 0xEF, 0xF0, 0x90, 0x05, 0x50, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x05, 0x22, -0xE0, 0x54, 0xBF, 0xF0, 0x7F, 0x08, 0x12, 0x9F, 0xF5, 0x90, 0x93, 0xD9, 0xE0, 0x54, 0xC1, 0x44, -0x28, 0xF0, 0x44, 0x01, 0xF0, 0x22, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x02, 0x03, 0xEB, 0x12, 0x04, -0xB8, 0x78, 0x10, 0x02, 0x03, 0xEB, 0x12, 0x86, 0x24, 0x90, 0x96, 0xB5, 0x02, 0x04, 0x31, 0x90, -0x96, 0xB5, 0x12, 0x04, 0xB8, 0x78, 0x18, 0x02, 0x03, 0xEB, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, -0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0x12, 0x86, 0x31, 0xD3, 0x02, 0x03, 0xDA, 0x90, -0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x05, 0x12, 0x97, 0xC8, 0x60, 0x15, 0x90, 0x88, 0x36, 0xE0, -0x70, 0x04, 0xEF, 0x30, 0xE0, 0x0B, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0xA3, -0xF2, 0x22, 0x12, 0xA7, 0x68, 0x70, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x90, 0x01, 0x57, -0x11, 0x16, 0x12, 0xA6, 0x06, 0x22, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0x12, 0xA7, -0x68, 0x70, 0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, 0x90, 0x01, 0x57, 0x11, 0x16, 0xF0, 0x90, -0x88, 0x31, 0xE0, 0x11, 0x3E, 0x54, 0x07, 0x70, 0x03, 0x12, 0x9F, 0x1F, 0x22, 0xEF, 0x54, 0xFB, -0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, -0x19, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x13, 0x12, 0xA6, 0xFF, 0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, -0xE1, 0x12, 0xBD, 0x11, 0x02, 0x04, 0x7A, 0x12, 0x73, 0x8F, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -0xBF, 0x01, 0x10, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0A, 0x12, 0xA6, 0x7C, 0x54, 0x07, 0x70, 0x03, -0x12, 0x9F, 0x1F, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, -0x12, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0xA7, 0x8F, 0xBF, 0x01, 0x05, 0x80, 0x04, -0x12, 0x97, 0x42, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x60, 0x13, 0x12, 0xA6, 0xFF, 0x60, -0x0E, 0x12, 0x7A, 0x65, 0xEF, 0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0x11, 0xC0, 0x22, -0xE4, 0xFD, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x31, 0x0E, 0x90, 0x96, 0x1B, 0xEF, 0xF0, 0x90, 0x8A, -0x89, 0x30, 0xE0, 0x13, 0x12, 0x90, 0x40, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, -0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x06, 0x12, 0x90, 0x40, 0x12, 0x97, 0x91, 0x90, 0x96, 0x1B, -0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, -0x01, 0x2F, 0x74, 0x80, 0xF0, 0x12, 0xCC, 0x92, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, -0x96, 0x1D, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x96, 0x1C, 0xEF, 0xF0, 0x7F, -0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, -0x90, 0x96, 0x1E, 0xE0, 0x94, 0x64, 0x90, 0x96, 0x1D, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, -0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0x22, 0x90, 0x96, 0x1D, 0x31, 0x52, -0x80, 0xC3, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xE4, 0x90, 0x96, 0xF1, 0xF0, 0xA3, 0xF0, -0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, 0xE0, -0x70, 0x03, 0x7F, 0x01, 0x22, 0x12, 0x9C, 0xD1, 0x54, 0x03, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x96, -0xF2, 0xE0, 0x94, 0x03, 0x90, 0x96, 0xF1, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, -0x80, 0x1B, 0xD3, 0x90, 0x96, 0xF2, 0xE0, 0x94, 0xE8, 0x90, 0x96, 0xF1, 0xE0, 0x94, 0x03, 0x40, -0x0A, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, -0x7C, 0x6A, 0x90, 0x96, 0xF1, 0x31, 0x52, 0x80, 0xA7, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, -0x4C, 0x90, 0x88, 0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x88, 0x2F, 0xE0, -0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x32, 0xEF, 0xC3, 0x13, 0x30, 0xE0, -0x03, 0x02, 0xB9, 0xC2, 0x12, 0x97, 0xCF, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0C, 0x90, 0x8A, -0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x0C, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0x70, 0x0D, -0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, -0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, -0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0x9C, 0xB4, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, -0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x88, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, -0x88, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x88, 0xD0, 0x22, -0x90, 0x88, 0x31, 0x51, 0xAE, 0x30, 0xE0, 0x32, 0xEF, 0x54, 0xBF, 0x71, 0x14, 0x30, 0xE0, 0x06, -0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, 0x71, 0x1D, 0x74, 0x04, 0xF0, 0x90, 0x88, -0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x90, 0x40, -0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0x9F, 0x1F, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xFF, -0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0xA9, 0xA5, 0x30, 0xE0, -0x1E, 0xEF, 0x54, 0x7F, 0x71, 0x14, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, -0x54, 0xFD, 0x71, 0x1D, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0x9F, 0x1F, 0x90, -0x88, 0xA1, 0x51, 0xAE, 0x30, 0xE0, 0x22, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, -0x18, 0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, -0x44, 0x04, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x03, -0x12, 0x99, 0xBF, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, -0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x95, 0x30, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x95, 0x2F, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x71, -0xFE, 0x90, 0x95, 0x32, 0xF0, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x95, 0x2F, 0xE0, -0x90, 0x04, 0x25, 0xF0, 0x90, 0x95, 0x30, 0xE0, 0x60, 0x05, 0x71, 0xF2, 0x44, 0x80, 0xF0, 0xAF, -0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0x71, -0xF2, 0x54, 0xC0, 0xF0, 0x90, 0x95, 0x32, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, -0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, 0xAF, 0x05, 0x71, 0xE7, 0xE0, -0x54, 0x01, 0xFE, 0x90, 0x95, 0x31, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, -0xFE, 0x71, 0xE7, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, -0xFF, 0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, -0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, -0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x86, -0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, 0xFE, 0x90, 0x96, 0xFC, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, -0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, -0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x05, -0x22, 0xEF, 0xF0, 0x90, 0x93, 0x01, 0xED, 0xF0, 0x22, 0x7A, 0x00, 0x7D, 0x03, 0x7F, 0x01, 0x90, -0x01, 0xC6, 0xE0, 0x64, 0x80, 0x70, 0x60, 0x90, 0x95, 0xCC, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xEB, -0xA3, 0xF0, 0xEA, 0xA3, 0xF0, 0x90, 0x95, 0xC2, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD0, 0xF0, -0xEC, 0xA3, 0xF0, 0x90, 0x95, 0xC4, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD2, 0xF0, 0xEC, 0xA3, -0xF0, 0x90, 0x95, 0xC6, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD4, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, -0x95, 0xC8, 0xE0, 0xFC, 0xA3, 0xE0, 0x90, 0x95, 0xD6, 0xF0, 0xEC, 0xA3, 0xF0, 0x90, 0x95, 0xCA, -0x74, 0xFE, 0xF0, 0x90, 0x95, 0xEC, 0x74, 0x0C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xCA, 0x12, -0x90, 0x2E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0x7D, 0x05, 0x7F, 0x04, 0x80, 0x91, 0x7D, 0x05, -0x7F, 0x01, 0x80, 0x8B, 0x7A, 0x00, 0x7D, 0x01, 0x7F, 0x01, 0x80, 0x83, 0x7A, 0x00, 0xE4, 0xFD, -0x7F, 0x01, 0x81, 0x4F, 0xE6, 0xFD, 0xAF, 0x67, 0xEF, 0x91, 0xEC, 0xE0, 0x54, 0xF8, 0xF5, 0x75, -0xED, 0x42, 0x75, 0xEF, 0x91, 0xEC, 0xE5, 0x75, 0xF0, 0x22, 0xE5, 0x67, 0xC4, 0x54, 0xF0, 0x24, -0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x7D, 0x07, 0xAF, 0x67, 0xED, 0x30, 0xE0, -0x22, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0xB1, 0x4A, 0x90, 0x89, 0x59, 0xB1, 0x4A, 0x90, -0x89, 0x5B, 0xB1, 0x4A, 0x90, 0x89, 0x5D, 0xB1, 0x4A, 0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, -0xF0, 0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, 0x12, 0xEF, 0xB1, 0x74, 0xE4, 0xF0, 0xA3, -0xF0, 0xED, 0x30, 0xE2, 0x08, 0x75, 0xF0, 0x12, 0xEF, 0xB1, 0x69, 0xE4, 0xF0, 0xB1, 0x56, 0xE0, -0x54, 0xBF, 0x44, 0x80, 0xFE, 0xB1, 0x56, 0xEE, 0xF0, 0x22, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, -0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x22, 0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, -0x81, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, 0x55, 0x02, 0x04, 0x6E, 0x75, -0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, 0x53, 0x02, 0x04, 0x6E, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x70, -0x90, 0x96, 0x76, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x67, 0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x67, -0xC3, 0x9F, 0x40, 0x03, 0x02, 0xDC, 0x1F, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE0, 0xF5, 0x72, 0x12, -0xE3, 0x5E, 0xE0, 0x65, 0x72, 0x60, 0x16, 0x90, 0x92, 0x5E, 0xE5, 0x72, 0xF0, 0xE4, 0xA3, 0xF0, -0xAB, 0x67, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0x12, 0xE3, 0x5E, 0xE5, 0x72, 0xF0, 0x90, 0x04, 0xA0, -0xE0, 0x64, 0x01, 0x70, 0x52, 0xA3, 0xE0, 0x65, 0x67, 0x70, 0x4C, 0xA3, 0xE0, 0xF5, 0x68, 0xA3, -0xE0, 0x90, 0x95, 0xB9, 0xF0, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE0, 0x65, 0x68, 0x70, 0x03, 0x02, -0xDC, 0x1A, 0xE5, 0x67, 0x12, 0xAE, 0x00, 0xE5, 0x68, 0xF0, 0xE5, 0x67, 0x12, 0xAE, 0x93, 0xE0, -0x54, 0xFC, 0xFF, 0x90, 0x95, 0xB9, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xE5, 0x67, 0x12, 0xAE, 0x93, -0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x68, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xAB, 0x67, 0xE4, 0xFD, -0xFF, 0x12, 0x6F, 0x75, 0x02, 0xDC, 0x1A, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0x75, 0xF0, 0x12, 0xE5, -0x67, 0x12, 0xAB, 0x05, 0x12, 0xA9, 0xA5, 0xFD, 0x12, 0xDD, 0x12, 0xED, 0xF0, 0x90, 0x95, 0xC4, -0xE4, 0x12, 0xAD, 0xC5, 0xE5, 0x67, 0xF0, 0x12, 0xB2, 0xB5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0xFF, 0x90, 0x95, 0xC8, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x7B, 0x02, 0x91, 0xCC, 0xB1, 0x6F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xB1, 0x64, 0xE0, -0xFD, 0x91, 0xEA, 0xE0, 0x54, 0x80, 0xFB, 0x12, 0xDD, 0x12, 0xEB, 0xF0, 0x12, 0xDD, 0x19, 0xED, -0xF0, 0x90, 0x95, 0xC2, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x96, 0x75, 0x12, 0xDC, 0xC3, 0x7B, -0x03, 0x91, 0xCC, 0xAF, 0x67, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x03, 0x02, 0xDC, 0x1A, 0x75, 0xF0, -0x12, 0xE5, 0x67, 0x12, 0xAB, 0x05, 0x12, 0xA9, 0xA5, 0x30, 0xE0, 0x03, 0x02, 0xDC, 0x1A, 0xE5, -0x67, 0x12, 0xB2, 0xB5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, -0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x03, 0x02, 0xDC, 0x1A, 0xB1, 0x6F, 0xE0, 0xFE, 0xA3, 0xE0, 0x4E, -0x70, 0x08, 0xB1, 0x64, 0xE0, 0x70, 0x03, 0x02, 0xDC, 0x1A, 0xE5, 0x67, 0x75, 0xF0, 0x12, 0xA4, -0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x46, -0x12, 0xE3, 0xC6, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xDD, 0x00, 0x2F, 0xFF, 0x12, 0xDD, 0x06, -0x2F, 0xFF, 0x12, 0xDD, 0x0C, 0x2F, 0xF5, 0x71, 0xB1, 0x6F, 0xE0, 0xF5, 0x6D, 0xA3, 0xE0, 0xF5, -0x6E, 0xB1, 0x64, 0xE0, 0xFF, 0x90, 0x95, 0xB7, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xE5, 0x67, 0x12, -0xAE, 0x00, 0xE0, 0xF5, 0x68, 0x54, 0x80, 0xF5, 0x6A, 0xE5, 0x68, 0x54, 0x7F, 0xF5, 0x69, 0x90, -0x96, 0x75, 0xE0, 0x60, 0x12, 0x75, 0x73, 0x0A, 0x12, 0xDC, 0x5D, 0xE4, 0x93, 0xC3, 0x13, 0x74, -0x01, 0x93, 0x13, 0xF5, 0x74, 0x80, 0x0A, 0x7B, 0xFF, 0x12, 0xC3, 0x6B, 0xE4, 0xF5, 0x73, 0xF5, -0x74, 0x12, 0xDD, 0x28, 0x12, 0xE2, 0xBE, 0x12, 0xE3, 0xC6, 0x90, 0x95, 0xC4, 0x12, 0xE2, 0xC2, -0x12, 0xDD, 0x00, 0xFF, 0x90, 0x95, 0xC6, 0x12, 0xE2, 0xC2, 0x12, 0xDD, 0x06, 0xFF, 0x90, 0x95, -0xC8, 0x12, 0xE2, 0xC2, 0x7B, 0x01, 0x91, 0xC4, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0x12, 0xDD, -0x0C, 0x12, 0xE2, 0xBE, 0x90, 0x95, 0xB7, 0xE0, 0xFF, 0xA3, 0xE0, 0x12, 0xDD, 0x31, 0xA3, 0x12, -0xDD, 0x20, 0xA3, 0xE4, 0xF0, 0xA3, 0xE5, 0x68, 0xF0, 0x7B, 0x02, 0x91, 0xC4, 0x75, 0xF0, 0x12, -0xE5, 0x67, 0x12, 0xAF, 0xD8, 0xFF, 0xE5, 0x69, 0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x69, 0xE5, 0x69, -0x45, 0x6A, 0xF5, 0x68, 0x12, 0xDC, 0x51, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x03, 0x02, 0xD9, 0xFA, -0xE5, 0x69, 0x90, 0x81, 0x61, 0x93, 0xF5, 0x6F, 0xFD, 0xAF, 0x69, 0x12, 0x60, 0x6F, 0x8F, 0x6F, -0xE5, 0x6A, 0x60, 0x04, 0x05, 0x6F, 0x05, 0x6F, 0x90, 0x04, 0x8C, 0xE0, 0x64, 0x01, 0x70, 0x28, -0xE5, 0x69, 0xC3, 0x94, 0x0C, 0x40, 0x21, 0x74, 0x84, 0x25, 0x69, 0xF5, 0x82, 0xE4, 0x34, 0x04, -0xF5, 0x83, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x06, 0xE5, 0x6F, 0x2E, 0xFF, 0x80, -0x05, 0xC3, 0xE5, 0x6F, 0x9E, 0xFF, 0x8F, 0x6F, 0xE5, 0x6F, 0xD3, 0x94, 0x1A, 0xAF, 0x6F, 0x40, -0x02, 0x7F, 0x1A, 0x8F, 0x6F, 0x12, 0xA3, 0x69, 0x7B, 0x03, 0xFA, 0x12, 0xD4, 0xC6, 0xE5, 0x68, -0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0xB8, 0xE0, 0x9F, 0x90, 0x95, 0xB7, 0xE0, 0x94, -0x00, 0x40, 0x02, 0x80, 0x74, 0xC3, 0xE5, 0x6E, 0x94, 0x0A, 0xE5, 0x6D, 0x94, 0x00, 0x40, 0x02, -0x21, 0x08, 0x12, 0xC3, 0x48, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x06, 0x12, 0xC3, 0x48, 0xE0, 0x14, -0xF0, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0xB1, 0x0C, 0xFF, 0x90, 0x95, 0xB8, 0xE0, 0x2F, 0xFF, -0x90, 0x95, 0xB7, 0xE0, 0x35, 0xF0, 0xFE, 0xB1, 0x06, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0xB1, -0x00, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6D, 0xC3, 0x13, 0xFE, 0xE5, 0x6E, 0x13, 0xFF, -0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x27, 0xE5, 0x67, 0x94, 0x05, 0x50, 0x06, 0x12, 0xC3, 0x48, -0x74, 0x03, 0xF0, 0x90, 0x95, 0xC2, 0xB1, 0x20, 0xE5, 0x6D, 0xC3, 0x13, 0xA3, 0xF0, 0xE5, 0x6E, -0x13, 0xA3, 0x91, 0x8A, 0x7B, 0x01, 0x12, 0xD4, 0x49, 0x12, 0xAE, 0xA0, 0x61, 0xEB, 0xB1, 0x28, -0x65, 0x71, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x53, 0x90, 0x95, 0xC2, 0xF0, 0xA3, 0xE5, 0x71, 0xF0, -0xC3, 0x13, 0xFF, 0xA3, 0xE4, 0xF0, 0xA3, 0xEF, 0x91, 0x8A, 0x7B, 0x02, 0x12, 0xD4, 0x49, 0xE5, -0x67, 0xC3, 0x94, 0x05, 0x50, 0x10, 0x12, 0xC3, 0x48, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x07, 0x12, -0xA3, 0x64, 0x7B, 0x03, 0x80, 0x0C, 0xE5, 0x71, 0xC3, 0x94, 0x03, 0x50, 0x12, 0x12, 0xA3, 0x64, -0x7B, 0x04, 0xFA, 0x12, 0xD4, 0x4B, 0x7D, 0x06, 0xAF, 0x67, 0x12, 0xD4, 0xFD, 0x81, 0x1A, 0xE4, -0xFD, 0xAF, 0x67, 0x12, 0xAC, 0x7C, 0x12, 0xD4, 0xF9, 0x61, 0xEB, 0x12, 0xA3, 0x64, 0x7B, 0x08, -0xFA, 0x12, 0xD4, 0x4B, 0x91, 0xCE, 0x61, 0xEB, 0x12, 0xC3, 0x48, 0xE4, 0xF0, 0x90, 0x91, 0x6C, -0x74, 0x02, 0xF0, 0xAB, 0x6F, 0xAD, 0x67, 0xAF, 0x6E, 0xAE, 0x6D, 0x12, 0x41, 0x9C, 0x8E, 0x6B, -0x8F, 0x6C, 0x91, 0x5D, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFF, 0xE4, 0x93, 0x94, 0x00, 0xFE, -0xD3, 0xE5, 0x6C, 0x9F, 0xE5, 0x6B, 0x9E, 0x40, 0x34, 0x91, 0x20, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, -0x67, 0x12, 0xAC, 0x7C, 0x91, 0x5D, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFE, 0xE4, 0x93, 0x94, -0x00, 0x90, 0x95, 0xC4, 0xF0, 0xA3, 0xCE, 0xF0, 0x90, 0x95, 0xC2, 0xE5, 0x6B, 0xF0, 0xA3, 0xE5, -0x6C, 0xF0, 0xE4, 0x90, 0x95, 0xC6, 0x12, 0xA3, 0x77, 0x7B, 0x01, 0x80, 0x1F, 0x91, 0x75, 0xC3, -0xE5, 0x6C, 0x9F, 0xE5, 0x6B, 0x94, 0x00, 0x50, 0x19, 0x91, 0x20, 0xE4, 0xF0, 0x12, 0xAE, 0xA0, -0x91, 0x6B, 0xB1, 0x19, 0xEF, 0xF0, 0xE4, 0x12, 0xA3, 0x76, 0x7B, 0x02, 0xFA, 0x12, 0xD4, 0xBE, -0x61, 0xEB, 0x12, 0xD4, 0xF9, 0x91, 0x5D, 0xE4, 0x93, 0xFF, 0x74, 0x01, 0x93, 0xB1, 0x31, 0x91, -0x6B, 0xB1, 0x12, 0xEF, 0xF0, 0x74, 0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0x91, 0xC1, -0x7B, 0x03, 0x7A, 0x00, 0x12, 0xD4, 0xBE, 0x91, 0x20, 0xE0, 0x04, 0xF0, 0xE5, 0x69, 0x90, 0x81, -0xED, 0x93, 0x25, 0x73, 0xFF, 0xE4, 0x33, 0xFE, 0x91, 0x20, 0xE0, 0xC3, 0x9F, 0xEE, 0x64, 0x80, -0xF8, 0x74, 0x80, 0x98, 0x50, 0x02, 0x61, 0xEB, 0x91, 0x20, 0xE4, 0x91, 0x74, 0x91, 0x5D, 0x74, -0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, 0x00, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0xE5, 0x67, -0x12, 0xAD, 0xE5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x61, 0xEB, 0x91, 0x51, 0xE0, 0x64, 0x05, 0x60, -0x02, 0x41, 0xBA, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, 0x70, 0x10, 0x91, 0x38, 0xE4, 0xF0, 0x90, -0x04, 0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, 0xD4, 0xD4, 0x61, 0xFF, 0xAD, 0x69, 0xAF, 0x67, 0x12, -0x72, 0xEE, 0x91, 0xF4, 0xEF, 0xF0, 0x12, 0xD4, 0xEA, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, 0x91, -0x7D, 0xFF, 0xC3, 0x94, 0x30, 0x40, 0x1C, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x12, 0xAB, 0x05, 0xFE, -0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x0B, 0x91, 0xF4, 0xE0, 0x60, 0x06, 0x90, 0x96, 0x75, -0xE0, 0x60, 0x0A, 0xE4, 0x78, 0x88, 0xF6, 0x91, 0x38, 0xE4, 0xF0, 0x80, 0x56, 0x91, 0xE8, 0xE0, -0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEF, 0x12, 0xCA, 0x4E, 0x98, 0x50, 0x1D, 0x91, 0x7D, -0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0x12, 0xCA, 0x4E, 0x98, 0x50, 0x0E, 0x91, 0xDC, 0xE0, -0xB5, 0x69, 0x08, 0x91, 0x45, 0xE0, 0xC3, 0x94, 0x0A, 0x40, 0x23, 0x78, 0x88, 0xE6, 0xFF, 0x70, -0x04, 0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, 0x88, 0xB4, 0x01, 0x04, 0x76, 0x03, 0x80, 0x02, 0x76, -0x05, 0x91, 0x45, 0xE4, 0xF0, 0x91, 0x7D, 0xFF, 0x91, 0xE8, 0xEF, 0xF0, 0x80, 0x05, 0x91, 0x38, -0xE0, 0x04, 0xF0, 0x91, 0xDC, 0xE5, 0x69, 0xF0, 0x61, 0xE6, 0x91, 0x51, 0xE0, 0x64, 0x06, 0x60, -0x02, 0x61, 0xEB, 0xF5, 0x6B, 0xF5, 0x6C, 0x12, 0xD4, 0xEA, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, -0xD3, 0xE5, 0x6E, 0x94, 0xE8, 0xE5, 0x6D, 0x94, 0x03, 0x40, 0x06, 0x78, 0x86, 0x76, 0x05, 0x80, -0x15, 0xD3, 0xE5, 0x6E, 0x94, 0xFA, 0xE5, 0x6D, 0x94, 0x00, 0x40, 0x06, 0x78, 0x86, 0x76, 0x02, -0x80, 0x04, 0xE4, 0x78, 0x86, 0xF6, 0xE5, 0x6E, 0xAE, 0x6D, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, -0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x06, 0xE4, 0x91, 0xD5, 0x90, -0x95, 0xBA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, 0xF6, 0x90, 0x95, 0xB4, 0x12, 0x86, -0x3D, 0x78, 0x87, 0xE6, 0xFD, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, 0x85, 0xF0, 0x83, 0x12, 0x03, -0x3E, 0xAE, 0xF0, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, -0xF9, 0xFF, 0xED, 0x90, 0x82, 0x01, 0x91, 0xD5, 0xEF, 0x25, 0x6C, 0xF5, 0x6C, 0xEE, 0x35, 0x6B, -0xF5, 0x6B, 0xC3, 0x90, 0x95, 0xBB, 0xE0, 0x95, 0x6C, 0x90, 0x95, 0xBA, 0xE0, 0x95, 0x6B, 0x40, -0x07, 0x78, 0x87, 0x06, 0xE6, 0xB4, 0x05, 0xB3, 0x78, 0x87, 0xE6, 0xC3, 0x13, 0xF6, 0xFD, 0x08, -0xE6, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, 0xD3, 0x9D, 0x40, -0x07, 0xE6, 0x79, 0x87, 0x97, 0xF6, 0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0x91, 0x2C, 0xE0, 0xC3, -0x13, 0xFF, 0x78, 0x89, 0xE6, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0xFF, 0x91, 0x2C, 0xEF, 0xF0, 0x91, -0x2C, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x05, 0x91, 0x2C, 0x74, 0xC0, 0xF0, 0x91, 0x2C, 0xE0, 0x24, -0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, 0xD8, 0xF8, -0x78, 0x89, 0xF6, 0xE6, 0x25, 0xE0, 0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, 0x89, 0xE6, 0x14, -0xFF, 0x78, 0x88, 0xA6, 0x07, 0xD3, 0x90, 0x95, 0xB8, 0xE0, 0x94, 0x03, 0x90, 0x95, 0xB7, 0xE0, -0x94, 0x00, 0x40, 0x02, 0xE4, 0xF6, 0x78, 0x88, 0x12, 0xD4, 0xD4, 0x91, 0x51, 0xE0, 0xFF, 0xD3, -0x94, 0x05, 0x50, 0x05, 0xEF, 0x04, 0xFF, 0x80, 0x02, 0x7F, 0x00, 0x91, 0x51, 0xEF, 0xF0, 0xE4, -0xF5, 0x6B, 0xF5, 0x6C, 0x91, 0xCE, 0xE4, 0x90, 0x95, 0xC2, 0xF0, 0x12, 0xA3, 0x72, 0xA3, 0xF0, -0x7B, 0x01, 0xFA, 0x7D, 0xFF, 0x7F, 0x01, 0x12, 0xD4, 0x4F, 0x05, 0x67, 0x02, 0xD5, 0x89, 0x22, -0x74, 0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0x4F, 0x25, 0x67, -0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0xF6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xE5, 0x69, 0x25, -0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x90, 0x95, 0xC2, 0xE5, 0x6B, -0xF0, 0xA3, 0xE5, 0x6C, 0xF0, 0xE5, 0x69, 0x90, 0x81, 0x9D, 0x93, 0xFF, 0x22, 0x74, 0xD6, 0x25, -0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x90, 0x95, 0xB4, 0x12, 0x86, -0x3D, 0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0xFF, 0xAE, 0xF0, 0x90, 0x00, 0x08, 0x12, 0x03, 0x3E, -0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x90, 0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0xEE, 0x35, -0xF0, 0x90, 0x95, 0xC6, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x87, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -0x96, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x95, 0xC8, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x7D, 0x01, -0xAF, 0x67, 0x02, 0x61, 0xF7, 0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0x74, 0xA6, 0x25, 0x67, -0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x74, 0x5F, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, -0x8D, 0xF5, 0x83, 0x22, 0x74, 0xE6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, -0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, 0x90, 0x00, 0x06, 0x02, 0x03, 0x3E, 0x90, 0x00, 0x08, 0x02, -0x03, 0x3E, 0x90, 0x95, 0xC6, 0xE4, 0xF0, 0xA3, 0x22, 0x90, 0x95, 0xC4, 0xE4, 0xF0, 0xA3, 0x22, -0xE5, 0x6D, 0xF0, 0xA3, 0xE5, 0x6E, 0xF0, 0x22, 0x90, 0x95, 0xB4, 0x12, 0x86, 0x3D, 0x02, 0x03, -0x13, 0x90, 0x95, 0xC4, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xEF, 0x64, 0x13, 0x60, 0x04, 0xEF, -0xB4, 0x0B, 0x05, 0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, -0x05, 0x90, 0x88, 0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, -0x88, 0xE5, 0x80, 0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, 0x61, 0x22, 0x90, 0x8A, 0x75, -0x12, 0x88, 0xD0, 0x90, 0x8A, 0xE5, 0x12, 0x90, 0x40, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, -0xCF, 0x12, 0xA7, 0xE6, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, -0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, -0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, -0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x93, -0xD8, 0xE0, 0x60, 0x05, 0x7F, 0x07, 0x12, 0x9F, 0xF5, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x96, 0x8D, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x96, 0x8C, 0xEF, 0xF0, 0xA3, 0xA3, -0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, 0x96, 0x97, 0x12, 0x04, 0x31, 0x90, 0x96, 0x8F, 0x12, 0x04, -0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0x97, 0x12, 0x8F, 0xBA, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0x90, 0x96, 0x8F, 0x12, 0x04, 0xB8, 0x90, 0x96, 0x93, 0x12, 0x8F, 0xBA, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0x90, 0x96, 0x9B, 0x12, 0x04, 0x31, 0x90, -0x96, 0x8D, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x96, 0x9B, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, -0x12, 0x04, 0x31, 0x90, 0x96, 0x8C, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x90, 0x96, 0x93, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xB1, 0xCA, -0x90, 0x96, 0x8F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, -0x01, 0x0D, 0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, -0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, -0xE1, 0xF0, 0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x12, 0xB0, 0xB7, -0x12, 0x9B, 0xF9, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x16, 0x90, 0x93, 0x3B, 0xE0, 0x20, 0xE0, 0x0F, -0x90, 0x86, 0x0C, 0x12, 0x88, 0xD0, 0x90, 0x8A, 0xF9, 0x12, 0x90, 0x40, 0x12, 0x97, 0x91, 0x22, -0x90, 0x95, 0x2F, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, -0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x6F, -0xF1, 0x5B, 0xF1, 0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, -0x12, 0xBF, 0x84, 0xE0, 0xFE, 0x74, 0xE5, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0x12, 0xB6, 0xCF, -0xB4, 0x04, 0xEA, 0x90, 0x96, 0xE6, 0x12, 0x8D, 0x68, 0x12, 0xCF, 0xCA, 0x90, 0x96, 0xE5, 0x12, -0x8D, 0x68, 0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xE7, -0x12, 0x8D, 0x68, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x86, 0x24, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8D, 0x68, 0x78, -0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x24, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, -0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, -0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x25, 0xF1, 0x5B, 0xF1, -0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0x12, 0xBF, -0x84, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0x12, 0xBF, 0x84, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, -0x3E, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -0xAC, 0x06, 0xEF, 0xF1, 0xCD, 0xF1, 0x54, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, -0x03, 0x24, 0xC8, 0x12, 0xBF, 0x84, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x54, 0xFC, 0x90, -0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, -0xFC, 0xFF, 0xF1, 0xCF, 0xE4, 0xFB, 0x90, 0x96, 0xD3, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, -0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, 0x12, 0xBF, 0x84, 0xEF, 0xF0, 0x0B, 0xEB, -0xB4, 0x04, 0xE3, 0x90, 0x07, 0xC2, 0x12, 0xB7, 0x4F, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF7, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xDF, 0xCD, 0x7A, 0x00, 0x90, 0x96, 0xF8, 0xE0, 0x54, 0x03, 0xFB, -0x70, 0x0A, 0x90, 0x07, 0xC4, 0x11, 0x5C, 0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, 0x02, 0x4A, -0x70, 0x15, 0x90, 0x07, 0xC6, 0x11, 0x5C, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, -0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, 0xEC, 0xA3, -0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF9, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xDF, 0xCD, 0x11, 0xD1, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, -0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, -0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x11, 0xD1, 0x64, 0x02, 0x70, -0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, -0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, -0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x7E, 0x00, 0x90, 0x96, 0xFA, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x12, 0x7A, 0x65, 0xEF, 0x70, -0x03, 0x12, 0x97, 0x42, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, -0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x0F, -0x10, 0x80, 0x2E, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x21, -0x90, 0x88, 0x31, 0x12, 0xA5, 0xF2, 0x30, 0xE0, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x13, 0x90, 0x88, -0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0F, 0x08, 0x80, 0x05, 0x12, 0xB7, 0x37, 0x80, -0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, -0xE0, 0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x10, 0x40, 0x21, 0xEE, 0x90, 0x88, 0x38, -0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, -0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x10, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, -0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x10, 0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, -0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x10, 0x04, 0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x10, -0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x10, 0x10, 0x80, 0x3F, 0x90, -0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x10, 0x20, 0x80, 0x2F, 0x90, -0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x10, 0x80, 0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, -0x05, 0x75, 0x10, 0x11, 0x80, 0x18, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, -0xFF, 0xBF, 0x80, 0x05, 0x75, 0x10, 0x12, 0x80, 0x05, 0x12, 0xB7, 0x37, 0x80, 0x0E, 0x90, 0x01, -0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, -0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x51, 0x69, 0x40, 0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, -0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, -0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0xA5, 0xFB, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, -0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, -0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x3F, 0xE0, -0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, -0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xE4, 0xFE, 0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0xE4, 0xF0, 0x74, 0x8D, 0x2E, 0x12, 0xCC, 0x52, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, -0xE6, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, -0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, -0xFB, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x90, 0x96, 0xE4, 0xF0, 0x22, 0xFF, 0x90, -0x95, 0xC2, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, -0x13, 0x54, 0x1F, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x84, 0xEF, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, -0x02, 0x7C, 0x05, 0x90, 0x01, 0x34, 0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x43, -0x64, 0x08, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, 0x7B, 0x01, 0xAF, 0x61, 0x02, 0x75, -0x80, 0x90, 0x96, 0x16, 0x12, 0x86, 0x46, 0x7A, 0x93, 0x79, 0x29, 0x12, 0xBF, 0xA7, 0xEF, 0x22, -0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, 0xE0, 0x54, -0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x22, 0xE0, 0x90, 0x01, 0xBA, -0xF0, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0x12, 0x04, 0x31, 0x90, 0x96, 0xB1, 0x12, -0x04, 0xB8, 0x90, 0x96, 0xB9, 0x22, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0xC4, 0x13, 0x13, 0x54, -0x03, 0x22, 0xF0, 0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xB6, -0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xC4, 0x13, -0x22, 0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, 0x95, 0x36, 0xE0, 0x04, -0xF0, 0x22, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, 0x02, 0x85, 0xC8, 0x12, 0x04, 0xB8, 0x90, 0x05, 0x88, -0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0xF0, 0xA3, 0xE4, 0xF0, -0xA3, 0xE5, 0x76, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x88, -0x2C, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x25, 0xE0, -0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x22, 0xF5, 0x82, -0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x7F, 0xF3, -0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, -0x02, 0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, -0xA6, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x02, 0x7C, 0x05, -0xFC, 0x2A, -}; -u32 array_length_mp_8723d_fw_nic = 25650; - - -#endif - -void -ODM_ReadFirmware_MP_8723D_FW_NIC( - IN PDM_ODM_T pDM_Odm, - OUT u1Byte *pFirmware, - OUT u4Byte *pFirmwareSize -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_nic; -#else - ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_nic, array_length_mp_8723d_fw_nic); -#endif - *pFirmwareSize = array_length_mp_8723d_fw_nic; -} - -#ifndef LOAD_FW_HEADER_FROM_DRIVER -u8 array_mp_8723d_fw_wowlan[] = { -0xD1, 0x23, 0x30, 0x00, 0x10, 0x00, 0x00, 0x00, 0x05, 0x16, 0x18, 0x17, 0x4A, 0x70, 0x02, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x02, 0x87, 0xD0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xBA, 0x0E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC8, 0x4C, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xB9, 0x82, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0xBF, 0xE7, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC7, 0xF6, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, -0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x83, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, -0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, -0xEC, 0x24, 0x87, 0xF8, 0xE6, 0xBC, 0x02, 0x02, 0x74, 0xFF, 0xC3, 0x95, 0x81, 0xB4, 0x40, 0x00, -0x40, 0xCE, 0x79, 0x03, 0x78, 0x80, 0x16, 0xE6, 0x08, 0x70, 0x0B, 0xC2, 0xAF, 0xE6, 0x30, 0xE1, -0x03, 0x44, 0x18, 0xF6, 0xD2, 0xAF, 0x08, 0xD9, 0xED, 0xEA, 0x8B, 0xD0, 0x22, 0xE5, 0x0C, 0xFF, -0x23, 0x24, 0x81, 0xF8, 0x0F, 0x08, 0x08, 0xBF, 0x03, 0x04, 0x7F, 0x00, 0x78, 0x81, 0xE6, 0x30, -0xE4, 0xF2, 0x00, 0xE5, 0x0C, 0xC3, 0x9F, 0x50, 0x20, 0x05, 0x0C, 0x74, 0x86, 0x25, 0x0C, 0xF8, -0xE6, 0xFD, 0xA6, 0x81, 0x08, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xCD, 0xF8, 0xE8, -0x6D, 0x60, 0xE0, 0x08, 0xE6, 0xC0, 0xE0, 0x80, 0xF6, 0xE5, 0x0C, 0xD3, 0x9F, 0x40, 0x27, 0xE5, -0x0C, 0x24, 0x87, 0xF8, 0xE6, 0xAE, 0x0C, 0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xCD, -0xF8, 0xE5, 0x81, 0x6D, 0x60, 0x06, 0xD0, 0xE0, 0xF6, 0x18, 0x80, 0xF5, 0xE5, 0x0C, 0x24, 0x86, -0xC8, 0xF6, 0x15, 0x0C, 0x80, 0xD3, 0xE5, 0x0C, 0x23, 0x24, 0x81, 0xF8, 0x7F, 0x04, 0xC2, 0xAF, -0xE6, 0x30, 0xE0, 0x03, 0x10, 0xE2, 0x0C, 0x7F, 0x00, 0x30, 0xE1, 0x07, 0x30, 0xE3, 0x04, 0x7F, -0x08, 0x54, 0xF4, 0x54, 0x7C, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x42, 0x07, 0x22, 0x78, 0x86, 0xA6, -0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, -0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, 0x76, 0x30, 0x90, 0x88, 0x60, 0x74, 0x01, 0x93, -0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, -0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0x74, 0x81, -0x2F, 0x2F, 0xF8, 0xE6, 0x20, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x44, 0x30, 0xF6, 0xD2, 0xAF, 0xAE, -0x0C, 0xEE, 0xC3, 0x9F, 0x50, 0x21, 0x0E, 0x74, 0x86, 0x2E, 0xF8, 0xE6, 0xF9, 0x08, 0xE6, 0x18, -0xBE, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x09, 0xE7, 0x19, 0x19, 0xF7, 0x09, -0x09, 0x80, 0xF3, 0x16, 0x16, 0x80, 0xDA, 0xEE, 0xD3, 0x9F, 0x40, 0x04, 0x05, 0x81, 0x05, 0x81, -0xEE, 0xD3, 0x9F, 0x40, 0x22, 0x74, 0x86, 0x2E, 0xF8, 0x08, 0xE6, 0xF9, 0xEE, 0xB5, 0x0C, 0x02, -0xA9, 0x81, 0x18, 0x06, 0x06, 0xE6, 0xFD, 0xED, 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, -0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -0x04, 0x90, 0x88, 0x60, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, -0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, -0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x83, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, -0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, -0x60, 0x08, 0xA8, 0x05, 0xE7, 0xF6, 0x1D, 0x19, 0x80, 0xF4, 0xA8, 0x03, 0xA6, 0x05, 0x1F, 0xE5, -0x0C, 0xB5, 0x07, 0xE3, 0x7F, 0x00, 0x22, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xFD, 0x18, 0x86, 0x01, -0x0F, 0x74, 0x86, 0x2F, 0xF8, 0xA6, 0x01, 0x08, 0x86, 0x04, 0xE5, 0x0C, 0xB5, 0x07, 0x02, 0xAC, -0x81, 0xED, 0x6C, 0x60, 0x08, 0x0D, 0x09, 0xA8, 0x05, 0xE6, 0xF7, 0x80, 0xF4, 0xE5, 0x0C, 0xB5, -0x07, 0xDE, 0x89, 0x81, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, -0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, -0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, 0xE2, 0x01, 0x0F, 0x02, 0x83, 0x4C, 0x8F, 0xF0, -0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, -0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x32, 0x50, 0x30, 0x80, 0x07, 0x30, 0xF1, 0x06, 0xED, 0xF6, -0x60, 0x27, 0x7E, 0x02, 0x08, 0x30, 0xF0, 0x10, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x25, 0x0E, 0x30, -0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x14, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x15, 0x54, 0xEC, -0x4E, 0xF6, 0xD2, 0xAF, 0xD2, 0xA9, 0x02, 0x83, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, -0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0xD2, 0xA9, 0x54, 0x80, 0x4F, 0xFF, 0x22, 0xEF, 0x2B, 0xFF, -0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, -0xFE, 0xED, 0x99, 0xFD, 0xEC, 0x98, 0xFC, 0x22, 0xEF, 0x5B, 0xFF, 0xEE, 0x5A, 0xFE, 0xED, 0x59, -0xFD, 0xEC, 0x58, 0xFC, 0x22, 0xEF, 0x4B, 0xFF, 0xEE, 0x4A, 0xFE, 0xED, 0x49, 0xFD, 0xEC, 0x48, -0xFC, 0x22, 0xE0, 0xF8, 0xA3, 0xE0, 0xF9, 0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0x22, 0xE0, 0xFB, -0xA3, 0xE0, 0xFA, 0xA3, 0xE0, 0xF9, 0x22, 0xEB, 0xF0, 0xA3, 0xEA, 0xF0, 0xA3, 0xE9, 0xF0, 0x22, -0xD0, 0x83, 0xD0, 0x82, 0xF8, 0xE4, 0x93, 0x70, 0x12, 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, -0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, -0xEF, 0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0xE3, 0xF5, 0xF0, 0x09, 0xE2, 0x08, 0xB5, 0xF0, 0x6B, 0xDF, -0xF5, 0x80, 0x67, 0xE3, 0xF5, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x5E, 0xDF, 0xF5, 0x80, 0x5A, -0x87, 0xF0, 0x09, 0xE6, 0x08, 0xB5, 0xF0, 0x52, 0xDF, 0xF6, 0x80, 0x4E, 0x87, 0xF0, 0x09, 0xE2, -0x08, 0xB5, 0xF0, 0x46, 0xDF, 0xF6, 0x80, 0x42, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE0, -0xA3, 0xB5, 0xF0, 0x36, 0xDF, 0xF6, 0x80, 0x32, 0x88, 0x82, 0x8C, 0x83, 0x87, 0xF0, 0x09, 0xE4, -0x93, 0xA3, 0xB5, 0xF0, 0x25, 0xDF, 0xF5, 0x80, 0x21, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, -0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, -0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, 0xDF, 0xF4, 0x02, 0x87, 0x55, 0x80, 0x87, 0x80, -0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, -0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, 0x74, 0x80, 0x3C, 0x02, 0x87, 0x61, 0x89, 0x82, -0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, -0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x76, 0xDF, -0xE3, 0xDE, 0xE1, 0x80, 0x70, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xE2, 0x08, -0xB5, 0xF0, 0x62, 0xDF, 0xF4, 0x80, 0x5E, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, 0xE6, -0x08, 0xB5, 0xF0, 0x51, 0xDF, 0xF5, 0x80, 0x4D, 0x89, 0x82, 0x8A, 0x83, 0xE0, 0xF5, 0xF0, 0xA3, -0xE2, 0x08, 0xB5, 0xF0, 0x40, 0xDF, 0xF5, 0x80, 0x3C, 0x89, 0x82, 0x8A, 0x83, 0xE4, 0x93, 0xF5, -0xF0, 0xA3, 0xE6, 0x08, 0xB5, 0xF0, 0x2E, 0xDF, 0xF4, 0x80, 0x2A, 0x80, 0x02, 0x80, 0x57, 0x89, -0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, -0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0x06, 0xDF, -0xE4, 0xDE, 0xE2, 0x80, 0x00, 0x7F, 0xFF, 0xB5, 0xF0, 0x02, 0x0F, 0x22, 0x40, 0x02, 0x7F, 0x01, -0x22, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -0xC5, 0x83, 0xCC, 0xE0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xD5, -0xDF, 0xE5, 0xDE, 0xE3, 0x80, 0xCF, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE0, 0xF5, 0xF0, 0xA3, -0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, -0xC5, 0x83, 0xCC, 0xB5, 0xF0, 0xAF, 0xDF, 0xE4, 0xDE, 0xE2, 0x80, 0xA9, 0x88, 0xF0, 0xEF, 0x60, -0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, -0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, 0x23, 0x45, 0x82, 0x23, 0x90, 0x86, 0x9D, 0x73, -0x02, 0x88, 0x0E, 0x02, 0x83, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, -0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, 0x0C, -0xC8, 0xC3, 0x33, 0xC4, 0x54, 0x0F, 0x44, 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, -0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, 0x88, -0x53, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, -0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, 0xB8, -0xE4, 0x93, 0xA3, 0xFA, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, -0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, 0xDE, -0xE7, 0x80, 0xBE, 0x41, 0x9A, 0x49, 0x00, 0x41, 0x99, 0x07, 0x00, 0x41, 0x98, 0x86, 0x00, 0x00, -0x93, 0xB0, 0xB0, 0xEE, 0xAF, 0x59, 0x90, 0x9A, 0x46, 0xEF, 0xF0, 0x7F, 0x02, 0x12, 0x85, 0x27, -0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x9A, 0x46, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, -0x22, 0x12, 0xE5, 0x6B, 0x2E, 0x90, 0x86, 0xB4, 0xD1, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, -0xF1, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0xF0, 0xF1, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x86, -0xB7, 0xF0, 0xF1, 0xE2, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, 0xD1, 0x1B, 0xFF, 0xED, 0x2F, 0x90, -0x86, 0xB9, 0x12, 0xE5, 0xB4, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x90, 0x97, 0x2F, 0x12, 0x85, 0xF7, -0x90, 0x97, 0x2E, 0xEF, 0xF0, 0x12, 0x86, 0x00, 0x89, 0x35, 0x00, 0x89, 0x39, 0x01, 0x89, 0x3D, -0x03, 0x89, 0x42, 0x04, 0x89, 0x47, 0x12, 0x89, 0x4C, 0x14, 0x89, 0x51, 0x20, 0x89, 0x55, 0x25, -0x89, 0x5A, 0x27, 0x89, 0x5F, 0x29, 0x89, 0x64, 0x2A, 0x89, 0x69, 0x60, 0x89, 0x6D, 0x61, 0x89, -0x72, 0x62, 0x89, 0x77, 0x63, 0x89, 0x7C, 0x64, 0x89, 0x81, 0x65, 0x89, 0x86, 0x66, 0x89, 0x8B, -0x67, 0x89, 0x90, 0x68, 0x89, 0x95, 0x69, 0x89, 0x9A, 0x6B, 0x89, 0x9F, 0x6C, 0x89, 0xA4, 0x6D, -0x89, 0xA9, 0x6E, 0x89, 0xAE, 0x6F, 0x89, 0xB3, 0x70, 0x89, 0xBD, 0x80, 0x89, 0xB8, 0x81, 0x89, -0xC1, 0x82, 0x89, 0xC6, 0x83, 0x89, 0xCB, 0x84, 0x89, 0xD5, 0x86, 0x89, 0xD0, 0x88, 0x89, 0xDA, -0xC3, 0x00, 0x00, 0x89, 0xDF, 0x31, 0xEF, 0x01, 0x81, 0x31, 0xEF, 0x21, 0xF5, 0x31, 0xEF, 0x02, -0xE0, 0x29, 0x31, 0xEF, 0x02, 0x95, 0xF2, 0x31, 0xEF, 0x02, 0x90, 0x01, 0x31, 0xEF, 0x02, 0x97, -0xEA, 0x31, 0xEF, 0xA1, 0x1B, 0x31, 0xEF, 0x02, 0x97, 0xF9, 0x31, 0xEF, 0x02, 0x9F, 0xF1, 0x31, -0xEF, 0x02, 0xAF, 0xF1, 0x31, 0xEF, 0x02, 0xA7, 0xFB, 0x31, 0xEF, 0x41, 0xC3, 0x31, 0xEF, 0x02, -0x77, 0x4F, 0x31, 0xEF, 0x02, 0x7C, 0x60, 0x31, 0xEF, 0x02, 0x7A, 0xC6, 0x31, 0xEF, 0x02, 0x5D, -0x36, 0x31, 0xEF, 0x02, 0x7B, 0xE9, 0x31, 0xEF, 0x02, 0x70, 0x33, 0x31, 0xEF, 0x02, 0x48, 0xC9, -0x31, 0xEF, 0x02, 0x79, 0xF3, 0x31, 0xEF, 0x02, 0x3F, 0xD4, 0x31, 0xEF, 0x02, 0x51, 0x7B, 0x31, -0xEF, 0x02, 0x79, 0x30, 0x31, 0xEF, 0x02, 0x57, 0xF2, 0x31, 0xEF, 0x02, 0x74, 0x8D, 0x31, 0xEF, -0x02, 0x78, 0x9A, 0x31, 0xEF, 0x02, 0x5E, 0x0B, 0x31, 0xEF, 0x02, 0xA6, 0x0B, 0x31, 0xEF, 0xC1, -0x36, 0x31, 0xEF, 0x02, 0xE5, 0x19, 0x31, 0xEF, 0x02, 0xE5, 0x2F, 0x31, 0xEF, 0x02, 0xE5, 0x78, -0x31, 0xEF, 0x02, 0xE5, 0xC1, 0x31, 0xEF, 0x02, 0xD4, 0x06, 0x31, 0xEF, 0x02, 0xB0, 0x07, 0x90, -0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x97, 0x2E, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, -0x97, 0x2F, 0x02, 0x85, 0xEE, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, 0x90, 0x95, 0xD9, 0xE0, 0x70, -0x0D, 0x51, 0xBD, 0xF1, 0xF9, 0x30, 0xE0, 0x06, 0x90, 0x95, 0xDF, 0x74, 0x01, 0xF0, 0x90, 0x95, -0xDB, 0xE0, 0x70, 0x12, 0x51, 0xBD, 0x12, 0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, -0x90, 0x95, 0xE0, 0x74, 0x01, 0xF0, 0x51, 0xBD, 0xD1, 0x14, 0xFF, 0x90, 0x97, 0x36, 0xF0, 0x12, -0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x51, 0xBD, 0xF1, 0x1B, 0x90, 0x97, 0x37, 0xF0, 0x80, -0x05, 0x90, 0x97, 0x37, 0xEF, 0xF0, 0x90, 0x97, 0x36, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x90, 0x97, -0x37, 0xE0, 0xFE, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0xD3, 0x9E, 0x50, 0x3B, 0x51, 0xBD, 0x12, 0x02, -0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, -0x90, 0x97, 0x35, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0x96, 0xC7, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0x97, -0x82, 0x90, 0x95, 0xE0, 0xE0, 0x60, 0x08, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, 0x96, 0xC7, 0x90, -0x97, 0x35, 0xE0, 0x04, 0xF0, 0x80, 0xB7, 0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x97, 0x36, 0xE0, -0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, 0x90, 0x86, 0x0C, 0xD1, 0x2C, 0x90, 0x8A, -0xED, 0xD1, 0x2C, 0x12, 0xBF, 0xC3, 0x54, 0xBF, 0xF0, 0x54, 0x7F, 0xF0, 0x22, 0x90, 0x97, 0x32, -0x02, 0x85, 0xEE, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xC3, 0x9D, 0x75, 0x48, 0x05, -0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x69, 0xF5, 0x51, 0xBD, 0x12, 0x02, 0x06, 0x20, 0xE0, -0x02, 0x81, 0x4E, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, -0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x13, 0xD1, 0x14, 0x90, 0x88, -0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF1, 0x1A, 0x90, 0x88, 0x9F, 0xF0, 0x80, 0x48, 0xD1, -0x14, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x14, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, -0x74, 0x03, 0x80, 0x0C, 0xD1, 0x14, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, -0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0xF1, 0x1B, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, -0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, -0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0xC1, 0x8B, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, -0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, -0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, -0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, -0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, 0x51, -0xBD, 0xF1, 0x13, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x35, 0x90, 0x88, 0x9D, 0xE0, 0xC3, -0x13, 0x20, 0xE0, 0x05, 0xF1, 0xDA, 0x30, 0xE0, 0x27, 0xF1, 0xF0, 0x30, 0xE0, 0x08, 0x90, 0x88, -0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0x75, 0x0D, 0x01, 0x80, -0x03, 0xE4, 0xF5, 0x0D, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0x7D, 0x02, 0xAF, 0x0D, 0x12, 0x04, 0x7E, -0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1D, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, -0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0xB1, 0x12, 0x7D, 0x04, 0x7F, 0x02, 0x12, 0x04, -0x7E, 0x12, 0xF0, 0x40, 0x74, 0x11, 0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xA5, -0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, -0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, -0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, -0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, 0x67, 0x51, 0xBD, -0xF1, 0x13, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, 0x0D, 0xF1, -0xF0, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x0E, 0x90, 0x8A, 0xF1, 0xD1, -0x2C, 0x90, 0x89, 0x04, 0xE0, 0x30, 0xE0, 0x04, 0x7D, 0xAC, 0x80, 0x02, 0x7D, 0x2C, 0x7F, 0x40, -0x12, 0x7B, 0x2E, 0x51, 0xBD, 0xF1, 0x13, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, -0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0xAD, 0x0E, 0x7F, -0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0xB1, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x12, -0xF0, 0x40, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x88, 0xAF, -0xF0, 0x90, 0x88, 0xA0, 0xF1, 0xDA, 0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, -0x80, 0x11, 0x90, 0x8A, 0x97, 0xB1, 0x12, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xD0, 0xE0, -0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0xB1, 0x12, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, -0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, -0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x12, 0xEF, 0xFA, 0xFF, 0x54, -0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0xF1, 0xDB, 0xA3, 0xD1, 0x13, 0xFD, 0x54, 0xF0, 0xC4, 0x54, -0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF0, 0xF1, 0x13, 0xFC, 0x54, 0x01, 0x25, -0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, -0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, -0xE0, 0x54, 0x0F, 0xF1, 0x19, 0x90, 0x88, 0x35, 0xF0, 0xF1, 0xE2, 0xFD, 0x90, 0x8A, 0x89, 0xB1, -0x12, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x99, 0x07, 0xE0, 0x60, 0x08, 0x12, 0xEF, 0xD8, 0xB1, -0x12, 0x12, 0xBF, 0xA4, 0x51, 0xBD, 0xD1, 0x1C, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, -0xD7, 0xBD, 0xD1, 0x1A, 0xFE, 0x12, 0xEF, 0xC6, 0x90, 0x88, 0x9B, 0x12, 0xD7, 0xA9, 0xD1, 0x1A, -0xFE, 0x12, 0xEF, 0xCF, 0x90, 0x88, 0x9B, 0xF0, 0xEE, 0x12, 0xF0, 0x30, 0xD1, 0x1A, 0x54, 0x40, -0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0x97, 0xA2, 0x20, 0xE0, 0x2E, 0xEF, -0xC3, 0x13, 0x20, 0xE0, 0x0B, 0x75, 0x0E, 0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, 0x0E, -0xE4, 0xF5, 0x0E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x0D, 0x80, 0x03, 0x75, 0x0D, -0x01, 0x90, 0x8A, 0xF3, 0xB1, 0x12, 0xAD, 0x0E, 0xAF, 0x0D, 0x12, 0x04, 0x7E, 0x51, 0xBD, 0x12, -0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, -0x12, 0xD0, 0x4B, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xEE, 0x59, 0x12, 0xBC, 0x46, 0x90, 0x01, 0xBE, -0xF0, 0x22, 0x4E, 0xF0, 0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, -0x02, 0x1F, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0xC4, 0xCF, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, 0xE0, -0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xEF, 0xFA, -0x20, 0xE0, 0x05, 0x12, 0xE0, 0x8D, 0xE1, 0x0E, 0x51, 0xBD, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x27, -0x12, 0xD7, 0xBD, 0x12, 0xA7, 0x17, 0x12, 0xEF, 0xC6, 0x90, 0x93, 0x27, 0xF0, 0xEE, 0x54, 0x08, -0xFE, 0xEF, 0x54, 0xF7, 0x12, 0xA7, 0x16, 0x12, 0xEF, 0xCF, 0x90, 0x93, 0x27, 0x12, 0xA7, 0x0E, -0x12, 0xF0, 0x03, 0x90, 0x93, 0x27, 0x12, 0xF0, 0x0C, 0xD1, 0x12, 0x54, 0x80, 0xFF, 0x90, 0x93, -0x28, 0xE0, 0x54, 0x7F, 0x4F, 0xF0, 0xF1, 0xF9, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, -0x04, 0xF0, 0x51, 0xBD, 0xF1, 0xF0, 0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, -0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, 0x08, 0x90, 0x93, 0x28, 0xF1, 0xDA, 0x20, 0xE0, 0x41, 0xD1, -0x14, 0x54, 0x7F, 0xFF, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x80, 0xF1, 0x19, 0x90, 0x93, 0x29, 0xF0, -0xF1, 0x13, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x2A, 0x12, 0xE0, 0x49, 0x54, 0xFE, 0xFF, 0xEE, -0x54, 0x01, 0x4F, 0xF0, 0xF1, 0xE2, 0x54, 0x04, 0xFF, 0x90, 0x93, 0x2B, 0xE0, 0x54, 0xFB, 0x4F, -0xF0, 0x12, 0xAA, 0x33, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x12, 0xA8, 0xDB, -0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x01, 0x17, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x95, -0x5F, 0x74, 0x05, 0xF0, 0x12, 0x97, 0xC2, 0x7A, 0x94, 0x79, 0x3E, 0x12, 0x04, 0x80, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x90, 0x00, 0x03, 0x02, 0x02, 0x1F, 0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, -0x1F, 0x12, 0x02, 0x06, 0x90, 0x06, 0x74, 0xD1, 0x13, 0x90, 0x06, 0x75, 0xF1, 0x1A, 0x90, 0x06, -0x76, 0xF0, 0xF1, 0x13, 0x90, 0x06, 0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, 0xF0, -0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x98, -0x70, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x72, 0x12, 0xC3, 0xA6, -0x12, 0xEF, 0x17, 0x24, 0x02, 0x12, 0xEF, 0x54, 0x24, 0x04, 0x12, 0xEF, 0x0E, 0x24, 0x03, 0x12, -0xEF, 0x54, 0x24, 0x08, 0x12, 0xEF, 0x0E, 0x24, 0x04, 0x12, 0xEF, 0x54, 0x24, 0x0C, 0x12, 0xEF, -0x0E, 0x24, 0x05, 0xF1, 0xE8, 0x7A, 0x98, 0x79, 0x76, 0xF1, 0x21, 0x90, 0x98, 0x71, 0xE0, 0xFD, -0xB4, 0x02, 0x08, 0x90, 0x98, 0x70, 0xE0, 0x44, 0x48, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x0A, 0x90, -0x98, 0x70, 0xE0, 0x44, 0x50, 0x90, 0x98, 0x76, 0xF0, 0x90, 0x98, 0x77, 0x74, 0x80, 0xF0, 0xA3, -0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x12, 0xEF, 0x23, 0xF1, 0xE8, 0x7A, 0x98, 0x79, 0x76, 0xF1, 0x21, -0x90, 0x98, 0x76, 0x74, 0xFF, 0x12, 0x94, 0x38, 0x12, 0xEF, 0x23, 0x04, 0xF1, 0xE8, 0x7A, 0x98, -0x79, 0x76, 0xF1, 0x21, 0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, -0x01, 0x22, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0xFF, 0x90, 0x98, 0x75, 0xF0, 0x7B, 0x01, 0x22, -0x12, 0x02, 0x06, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, -0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x03, 0xF0, 0xBF, 0x01, 0x07, 0x11, 0x14, 0xE4, 0x90, -0x93, 0x03, 0xF0, 0x22, 0x11, 0xA6, 0x71, 0xA2, 0xBF, 0x01, 0x06, 0x90, 0x97, 0x32, 0xE0, 0xA3, -0xF0, 0x11, 0xA6, 0x71, 0x9B, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x34, 0xF0, -0x11, 0xA6, 0x71, 0xA9, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x11, -0xA6, 0x11, 0xAD, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x36, 0xF0, 0x11, 0xA6, -0x71, 0x94, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x32, 0xE0, 0x90, 0x97, 0x37, 0xF0, 0x90, 0x97, 0x33, -0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x97, 0x3B, 0xF0, 0x90, 0x97, -0x37, 0xE0, 0x90, 0x97, 0x3C, 0xF0, 0x90, 0x97, 0x3D, 0x74, 0x12, 0xF0, 0x90, 0x97, 0x5F, 0x74, -0x05, 0xF0, 0x90, 0x97, 0x3F, 0xEF, 0xF1, 0xBA, 0x90, 0x97, 0x3B, 0xE0, 0x90, 0x97, 0x42, 0xF0, -0x90, 0x97, 0x3C, 0xE0, 0x90, 0x97, 0x43, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x3D, 0x12, 0x8D, -0x00, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x32, 0x22, 0x7F, 0xF3, 0x7E, -0x01, 0x02, 0x5F, 0xA6, 0x90, 0x97, 0x32, 0xEF, 0xF0, 0x51, 0xEC, 0x71, 0xA9, 0xBF, 0x01, 0x08, -0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7B, 0xF0, 0x51, 0xEC, 0x71, 0xA2, 0xBF, 0x01, 0x08, 0x90, -0x97, 0x79, 0xE0, 0x90, 0x97, 0x7C, 0xF0, 0x51, 0xEC, 0x71, 0x9B, 0xBF, 0x01, 0x08, 0x90, 0x97, -0x79, 0xE0, 0x90, 0x97, 0x7D, 0xF0, 0x51, 0xEC, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7E, 0xF0, 0x51, 0xEC, 0x7F, 0xF8, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x7F, 0xF0, 0x51, 0xEC, -0x71, 0x8D, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x80, 0xF0, 0x51, 0xEC, 0x51, -0xF3, 0x64, 0x01, 0x70, 0x54, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x81, 0xF0, 0x54, 0x07, 0x60, -0x08, 0x90, 0x97, 0x79, 0xE0, 0x54, 0xE0, 0x70, 0x40, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x7A, 0x7F, -0xFA, 0x51, 0xF5, 0x64, 0x01, 0x70, 0x32, 0x90, 0x97, 0x79, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, -0x90, 0x97, 0x81, 0xE0, 0xFE, 0x90, 0x97, 0x7A, 0xE0, 0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x97, -0x81, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x97, 0x81, 0xE0, 0xFF, 0x90, 0x97, 0x7A, 0xE0, -0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x97, 0x81, 0xF0, 0x51, 0xEC, 0x7F, 0xFD, 0x51, 0xF5, 0x64, -0x01, 0x70, 0x4B, 0x90, 0x97, 0x79, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x97, 0x82, 0xF0, 0xEE, 0x54, -0x0C, 0xFF, 0x60, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x54, 0xC0, 0x70, 0x32, 0xEF, 0x70, 0x16, 0x90, -0x97, 0x82, 0xE0, 0xFF, 0x90, 0x97, 0x79, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, -0x4E, 0x90, 0x97, 0x82, 0xF0, 0x90, 0x97, 0x79, 0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x97, -0x82, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x51, 0xEC, -0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, -0x83, 0xF0, 0x51, 0xEC, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x97, -0x79, 0xE0, 0x90, 0x97, 0x84, 0xF0, 0x51, 0xEC, 0x71, 0x94, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, -0xE0, 0x90, 0x97, 0x85, 0xF0, 0x51, 0xEC, 0x11, 0xAD, 0xBF, 0x01, 0x08, 0x90, 0x97, 0x79, 0xE0, -0x90, 0x97, 0x86, 0xF0, 0x51, 0xEC, 0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -0x90, 0x97, 0x79, 0xE0, 0x90, 0x97, 0x87, 0xF0, 0x90, 0x97, 0x33, 0x74, 0x19, 0xF0, 0x90, 0x97, -0x55, 0x74, 0x08, 0xF0, 0x90, 0x97, 0x7B, 0xE0, 0x90, 0x97, 0x35, 0xF0, 0x90, 0x97, 0x7C, 0xE0, -0x90, 0x97, 0x36, 0xF0, 0x90, 0x97, 0x7D, 0xE0, 0x90, 0x97, 0x37, 0xF0, 0x90, 0x97, 0x7E, 0xE0, -0x90, 0x97, 0x38, 0xF0, 0x90, 0x97, 0x7F, 0xE0, 0x90, 0x97, 0x39, 0xF0, 0x90, 0x97, 0x80, 0xE0, -0x90, 0x97, 0x3A, 0xF0, 0x90, 0x97, 0x81, 0xE0, 0x90, 0x97, 0x3B, 0xF0, 0x90, 0x97, 0x82, 0xE0, -0x90, 0x97, 0x3C, 0xF0, 0x90, 0x97, 0x56, 0x74, 0x1A, 0xF0, 0x90, 0x97, 0x78, 0x74, 0x05, 0xF0, -0x90, 0x97, 0x83, 0xE0, 0x90, 0x97, 0x58, 0xF0, 0x90, 0x97, 0x84, 0xE0, 0x90, 0x97, 0x59, 0xF0, -0x90, 0x97, 0x85, 0xE0, 0x90, 0x97, 0x5A, 0xF0, 0x90, 0x97, 0x86, 0xE0, 0x90, 0x97, 0x5B, 0xF0, -0x90, 0x97, 0x87, 0xE0, 0x90, 0x97, 0x5C, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0xB4, 0x01, 0x17, 0x7B, -0x01, 0x7A, 0x97, 0x79, 0x33, 0x12, 0xEF, 0xA7, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x56, 0x12, 0x8D, -0x00, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x97, 0x75, 0x47, 0x33, 0x75, -0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, 0xF1, 0x8C, 0x75, 0x46, 0x97, 0x75, 0x47, 0x58, -0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x97, -0x79, 0x79, 0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x22, 0x7E, 0x00, 0x7F, 0x0B, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xD9, 0x12, 0x04, 0x80, 0x71, 0x86, 0x71, 0x8D, 0xBF, -0x01, 0x1C, 0x90, 0x97, 0x2E, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x95, 0xD9, 0xF0, 0xEE, 0x54, 0x04, -0x90, 0x95, 0xDB, 0xF0, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x08, 0x90, 0x95, 0xDA, 0xF0, 0x71, 0x86, -0x51, 0xF3, 0x64, 0x01, 0x70, 0x35, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, -0x7A, 0x97, 0x79, 0x2F, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x97, -0x2F, 0x80, 0x03, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x07, 0x90, 0x95, 0xDD, 0xF0, 0x90, 0x97, 0x2E, -0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x95, 0xDC, 0xF0, 0x71, 0x86, 0x7F, 0xFD, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x97, 0x2E, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, -0x3F, 0x90, 0x95, 0xDE, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x2E, 0x22, 0x7F, 0xF9, 0x7E, -0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF2, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF6, 0x7E, 0x01, 0x02, -0x5F, 0xA6, 0x7F, 0xF5, 0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x7F, 0xF4, 0x7E, 0x01, 0x02, 0x5F, 0xA6, -0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x12, 0xB8, 0xAA, 0x12, -0xD8, 0x54, 0x12, 0x7B, 0x79, 0x12, 0xD8, 0x61, 0x91, 0x2D, 0x7F, 0x01, 0x12, 0x84, 0x15, 0x90, -0x95, 0xCB, 0x74, 0x02, 0xF0, 0xFF, 0x12, 0x84, 0x15, 0x90, 0x95, 0xCB, 0xE0, 0x04, 0xF0, 0xB1, -0x98, 0xB1, 0x10, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, -0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x11, 0xB4, -0x12, 0xD8, 0xA7, 0xB1, 0x80, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, -0x2E, 0xF1, 0xCB, 0x51, 0xFC, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, -0xF0, 0x90, 0x97, 0x2D, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0xE4, 0x90, 0x86, -0xAF, 0x91, 0x38, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, -0xF1, 0xB2, 0xE4, 0x90, 0x95, 0xC5, 0x91, 0x38, 0x90, 0x95, 0x63, 0x91, 0x38, 0xA3, 0x91, 0x38, -0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0x75, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, -0x22, 0x7E, 0x00, 0x7F, 0x25, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x24, 0x12, 0x04, 0x80, -0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0xE0, 0x7A, 0x91, 0x40, 0x90, 0x86, 0xB3, 0xE0, -0xFF, 0x64, 0x02, 0x70, 0x29, 0xB1, 0x09, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x43, 0xB1, -0x07, 0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x41, 0xB1, 0x07, 0x30, 0xE2, 0x02, 0x7E, 0x01, -0x90, 0x93, 0x42, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, 0x64, -0x01, 0x70, 0x1D, 0xB1, 0x00, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x91, 0xFE, 0x30, -0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x91, 0xFE, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x1F, -0xF1, 0x93, 0x70, 0x20, 0x91, 0xF7, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0x91, 0xF5, -0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, 0x91, 0xF5, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, -0x93, 0x42, 0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, -0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, -0xF1, 0x86, 0x12, 0x7B, 0xDB, 0x12, 0xA4, 0xFA, 0xB1, 0x43, 0x91, 0x61, 0xB1, 0x55, 0xB1, 0x6C, -0x90, 0x8A, 0x73, 0x12, 0x8E, 0x2C, 0x90, 0x95, 0xE4, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, -0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x95, 0xE6, 0xF0, 0x90, 0x95, 0xE4, 0xE0, 0x54, -0xEF, 0xF0, 0x22, 0xF1, 0xDF, 0x79, 0x08, 0x02, 0x04, 0x80, 0x90, 0x93, 0x24, 0xF1, 0xA2, 0x30, -0xE0, 0x02, 0x91, 0x40, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, -0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xF1, 0xC2, 0x7A, 0x95, -0x79, 0xD0, 0x12, 0x04, 0x80, 0x90, 0x95, 0xD1, 0x74, 0x08, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0x12, 0xBF, 0x48, 0xE4, 0xF0, 0x0F, 0xEF, -0xB4, 0x08, 0xF6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, 0xF0, -0xB1, 0xB2, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, -0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xB8, 0x0D, 0x12, 0xB8, 0x46, 0xE4, 0xF5, -0x21, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x03, 0x05, 0x75, 0x22, 0x08, 0x80, 0x03, 0xE4, 0xF5, 0x22, -0xE4, 0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, -0x51, 0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, -0x7B, 0x2E, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, 0xB1, 0x6C, 0x12, 0x8A, 0xBD, 0xF1, 0x9A, 0xD1, -0x39, 0x4E, 0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2F, 0x12, 0x8E, 0x14, 0x90, 0x95, 0xD1, 0x12, -0x8F, 0x1A, 0x90, 0x95, 0xD2, 0xF0, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x04, 0xFE, 0x90, 0x95, 0xD0, -0xE0, 0x54, 0xFB, 0x4E, 0xF0, 0x12, 0x8F, 0x13, 0x90, 0x95, 0xD3, 0xF0, 0xEF, 0x54, 0x08, 0xFF, -0x90, 0x95, 0xD0, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0x90, 0x95, 0xD0, 0xE0, 0x54, 0xFE, 0x22, -0x90, 0x95, 0xD0, 0xE0, 0x30, 0xE0, 0x77, 0x90, 0x95, 0xD4, 0xE0, 0x04, 0xF0, 0x90, 0x95, 0xD7, -0xE0, 0x64, 0x01, 0x70, 0x30, 0x90, 0x95, 0xD0, 0xF1, 0xD8, 0x30, 0xE0, 0x28, 0x90, 0x95, 0xD6, -0xE0, 0x70, 0x22, 0x90, 0x95, 0xD3, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x17, 0xEF, 0x13, -0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0xD1, 0xBF, 0xD1, 0x39, 0xF0, 0x80, 0x07, 0x12, 0xAA, -0x79, 0xD1, 0x39, 0xF0, 0x22, 0x90, 0x95, 0xD4, 0xE0, 0xFF, 0x90, 0x95, 0xD1, 0xE0, 0xD3, 0x9F, -0x50, 0x2C, 0x90, 0x06, 0x92, 0xE0, 0x20, 0xE2, 0x16, 0x90, 0x95, 0xD6, 0xE0, 0x70, 0x10, 0x90, -0x8A, 0xAF, 0x12, 0x8D, 0x12, 0xF1, 0x72, 0x90, 0x95, 0xCF, 0xE0, 0x04, 0xF0, 0x80, 0x06, 0x90, -0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, 0x90, 0x95, 0xD4, 0xF0, 0x90, 0x95, 0xD6, 0xF0, 0x22, 0xE4, -0xFD, 0xFF, 0x12, 0x6E, 0x71, 0xE4, 0xFF, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x9A, 0x36, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, 0x44, -0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x12, 0x8E, 0x29, 0x90, 0x9A, 0x37, 0xE0, 0x90, 0x9A, 0x36, 0xB4, -0x01, 0x07, 0xF1, 0x0F, 0x44, 0x04, 0xF0, 0x80, 0x05, 0xF1, 0x0F, 0x54, 0xFB, 0xF0, 0x90, 0x8A, -0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, -0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x95, -0xD0, 0xE0, 0xFD, 0x30, 0xE0, 0x4B, 0x90, 0x95, 0xD5, 0xE0, 0xFC, 0x60, 0x44, 0xF1, 0xAA, 0x80, -0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, -0x60, 0x0B, 0xE4, 0x90, 0x95, 0xD5, 0xF0, 0x90, 0x95, 0xD7, 0x04, 0xF0, 0x22, 0x90, 0x95, 0xD2, -0xE0, 0xD3, 0x9C, 0x50, 0x14, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0xD1, 0xBF, -0x80, 0x03, 0x12, 0xAA, 0x79, 0xD1, 0x39, 0xF0, 0x22, 0x90, 0x8A, 0xAF, 0x12, 0x8D, 0x12, 0xF1, -0x72, 0x22, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xD5, 0xE0, 0x04, 0xF0, 0x22, -0xA1, 0x4A, 0xE4, 0xFD, 0xC1, 0xC9, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x12, 0x69, 0xF5, 0x75, -0x45, 0x01, 0x22, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, -0xFE, 0x22, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x74, 0x01, 0x7E, 0x00, 0xA8, 0x07, -0x08, 0x22, 0x90, 0x93, 0x24, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, -0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x10, -0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x7E, -0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, -0x90, 0x95, 0xE9, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, -0x60, 0x34, 0xA3, 0xE0, 0x20, 0xE0, 0x2F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0x7F, -0x04, 0x12, 0x04, 0x7E, 0x11, 0x37, 0x30, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, -0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, -0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, 0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD1, 0xBB, 0xEC, 0x90, 0x99, 0xF9, 0x12, 0x04, 0x31, -0x90, 0x99, 0xF9, 0x12, 0xD1, 0x0B, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, 0x90, 0x01, 0x01, -0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, -0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xD1, 0xD5, 0xF0, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, -0x88, 0x9B, 0x11, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, -0x20, 0xE0, 0x33, 0x11, 0x37, 0x30, 0xE0, 0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, -0x99, 0xF7, 0xF0, 0x80, 0x06, 0x90, 0x99, 0xF7, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, -0x90, 0x99, 0xF8, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x99, -0xF7, 0x12, 0xD1, 0xB2, 0x51, 0x4F, 0x12, 0xD1, 0xC7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x2F, 0x90, -0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x12, 0x66, 0x33, 0x90, 0x88, 0x3E, -0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x10, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, -0x21, 0x75, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x7C, 0x12, 0xEF, 0x2C, 0x12, 0xF0, 0x38, 0x60, -0x22, 0x24, 0xFE, 0x60, 0x03, 0x04, 0x70, 0x1E, 0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0xE0, 0xFF, -0x60, 0x06, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x0E, 0xEF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xA3, -0xF0, 0x80, 0x00, 0x75, 0x10, 0x01, 0xE5, 0x10, 0x60, 0x4B, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, -0x09, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x12, 0xBE, 0xAD, 0x12, 0xBF, 0xB3, 0x90, 0x88, 0x3F, -0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x11, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x11, 0xDD, 0xFF, 0xA3, -0xE0, 0x11, 0xCE, 0xFF, 0xA3, 0xE0, 0x80, 0x0D, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x11, 0xDD, 0xF1, -0x5D, 0x11, 0xCE, 0xF1, 0x5D, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, -0x8A, 0xD7, 0x12, 0x8E, 0x2C, 0x22, 0x90, 0x97, 0xB5, 0xED, 0xF0, 0xA3, 0xEB, 0xF1, 0x53, 0xE4, -0x90, 0x97, 0xB8, 0xF0, 0x51, 0x7B, 0xEF, 0x54, 0x0C, 0x64, 0x08, 0x60, 0x02, 0x41, 0x19, 0x51, -0x1F, 0xA3, 0xE0, 0x24, 0x06, 0xFD, 0x90, 0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x64, 0x88, 0x70, 0x79, -0x51, 0x1F, 0xA3, 0xE0, 0x24, 0x07, 0xFD, 0x90, 0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x64, 0x8E, 0x70, -0x68, 0x90, 0x97, 0xB8, 0x04, 0xF0, 0x51, 0x1F, 0xF1, 0x67, 0x2D, 0x04, 0xFD, 0x90, 0x8A, 0xE9, -0x51, 0x4F, 0xEF, 0x64, 0x03, 0x70, 0x52, 0x51, 0x1F, 0xF1, 0x67, 0x2D, 0x24, 0x06, 0xFD, 0x90, -0x8A, 0xE9, 0x51, 0x4F, 0xEF, 0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x01, 0x80, 0x38, 0x90, -0x93, 0x24, 0x11, 0xE0, 0x30, 0xE0, 0x22, 0x90, 0x95, 0xB9, 0xE0, 0x64, 0x02, 0x70, 0x11, 0x90, -0x93, 0x25, 0x11, 0xE0, 0x30, 0xE0, 0x02, 0x80, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, 0x80, 0x17, -0x51, 0x1F, 0xA3, 0xE0, 0xFD, 0x51, 0x8B, 0x80, 0x10, 0x90, 0x93, 0x27, 0x12, 0xC1, 0x8E, 0x30, -0xE0, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x02, 0xF1, 0x4A, 0x90, 0x97, 0xB8, 0xE0, 0xFF, 0x22, 0x90, -0x97, 0xB3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x9A, 0x20, -0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x21, -0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x9A, 0x1F, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, -0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x97, 0xB5, 0xE0, 0xFD, -0x90, 0x97, 0xB4, 0xE0, 0x2D, 0xFD, 0x90, 0x97, 0xB3, 0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, -0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, 0x8A, 0xE9, 0xE0, 0xFC, -0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, 0xE4, 0xFD, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, 0xED, 0x2F, 0xFF, 0xE4, 0x3E, -0xFE, 0x7C, 0x00, 0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, 0x90, 0x97, 0xBC, 0xF0, 0xA3, 0xEF, 0xF0, -0x7E, 0x00, 0x7F, 0xE3, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x35, 0x12, 0x04, 0x80, 0x90, -0x97, 0xBD, 0xE0, 0x24, 0x01, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x36, 0xEF, 0xF0, 0x90, 0x97, -0xBD, 0xE0, 0x24, 0x04, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x39, 0xEF, 0xF0, 0x90, 0x97, 0xBD, -0xE0, 0x24, 0x05, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3A, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, -0x24, 0x06, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3B, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x24, -0x07, 0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3C, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x08, -0x91, 0x05, 0x51, 0x7A, 0x90, 0x94, 0x3D, 0xEF, 0xF0, 0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, -0x94, 0x08, 0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x09, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, -0x70, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, -0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, 0x94, 0x02, 0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, -0x61, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, 0x70, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x96, 0xF5, 0x82, -0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, 0xE4, 0x90, 0x97, 0xBB, 0xF0, 0xF1, 0x3C, 0x94, 0x10, -0x50, 0x1C, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x31, 0xFD, 0x90, 0x97, 0xBC, 0xE0, 0x51, 0x70, 0x90, -0x97, 0xBB, 0xE0, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xDE, 0xE4, 0x90, -0x97, 0xBB, 0xF0, 0x90, 0x94, 0x97, 0xE0, 0xFF, 0x90, 0x97, 0xBB, 0xE0, 0xFE, 0xC3, 0x9F, 0x50, -0x1F, 0x90, 0x97, 0xBD, 0xE0, 0x24, 0x63, 0xFD, 0x91, 0x06, 0xFC, 0xEE, 0x7E, 0x00, 0x2D, 0x51, -0x77, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x98, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x44, 0x80, 0xD3, -0x90, 0x94, 0x3A, 0x12, 0xE7, 0xB1, 0x90, 0x97, 0xB9, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x30, 0xE3, -0x0D, 0x7F, 0x01, 0x12, 0xAA, 0x81, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, 0x80, 0x20, 0x7E, 0x00, -0x90, 0x97, 0xBA, 0xE0, 0x54, 0x07, 0xFF, 0x64, 0x01, 0x60, 0x05, 0xEF, 0x64, 0x02, 0x70, 0x0E, -0xE4, 0xFD, 0x12, 0xCE, 0x5F, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, 0xF0, 0x7F, 0x00, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xFF, 0x90, 0x97, 0xBC, 0xE0, 0x34, 0x00, 0x22, 0xF1, 0x54, 0xA3, -0xED, 0xF0, 0xF1, 0xE8, 0x7A, 0x80, 0x79, 0x80, 0xF1, 0xB7, 0x78, 0xC2, 0x7C, 0x97, 0x7D, 0x01, -0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x86, 0xF1, 0xB0, 0x78, 0xC6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, -0x7A, 0x80, 0x79, 0x8A, 0xF1, 0xB0, 0xE4, 0x90, 0x97, 0xCB, 0xF0, 0xB1, 0x5A, 0xCF, 0x24, 0x06, -0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x08, 0x60, 0x02, 0xA1, 0x3E, 0xB1, 0x5A, 0xCF, 0x24, -0x07, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x06, 0x60, 0x02, 0xA1, 0x3E, 0x90, 0x97, 0xCB, -0x04, 0xF0, 0xE4, 0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x1E, 0x50, 0x16, 0x90, 0x97, 0xB4, 0xE0, -0x24, 0x0A, 0xFD, 0x90, 0x97, 0xB3, 0xE0, 0x51, 0x70, 0x90, 0x97, 0xCA, 0xF1, 0xDF, 0xB1, 0x4F, -0x80, 0xE5, 0x78, 0xB6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x34, 0x12, 0xF0, -0x27, 0x60, 0x02, 0xA1, 0x3E, 0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x15, 0x50, 0x18, 0xF1, 0x30, -0xB1, 0x65, 0xCD, 0x24, 0x20, 0x51, 0x6F, 0x90, 0x97, 0xCA, 0xE0, 0x24, 0xC6, 0xF5, 0x82, 0xE4, -0x34, 0x97, 0xB1, 0x4F, 0x80, 0xE3, 0x78, 0xC6, 0x7C, 0x97, 0x12, 0xE4, 0xC8, 0xEF, 0x70, 0x75, -0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0x54, 0xDF, 0xF0, 0x90, 0x93, 0x26, 0xE0, 0x30, 0xE0, 0x02, -0x80, 0x0F, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, 0x11, 0x90, 0x93, 0x25, 0x11, 0xE0, 0x20, 0xE0, -0x09, 0x90, 0x01, 0xC7, 0x74, 0x09, 0xF1, 0x4A, 0x80, 0x54, 0xE4, 0x90, 0x97, 0xCA, 0xF0, 0x12, -0xF0, 0x1E, 0x50, 0x0B, 0x51, 0x5B, 0x90, 0x97, 0xCA, 0xF1, 0xCD, 0xB1, 0x4F, 0x80, 0xF0, 0xE4, -0x90, 0x97, 0xCA, 0xF0, 0x12, 0xF0, 0x15, 0x50, 0x18, 0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, 0x16, -0x51, 0x6F, 0x90, 0x97, 0xCA, 0xE0, 0x24, 0xC2, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xB1, 0x4F, 0x80, -0xE3, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xBC, 0x12, 0xCF, 0xC2, 0xA3, 0xF0, 0x7A, 0x97, 0x79, 0xC2, -0x12, 0xC3, 0xB0, 0x80, 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x97, -0xCB, 0xE0, 0xFF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xBB, 0xE0, 0x04, 0xF0, 0x22, 0xF5, -0x83, 0xEF, 0xF0, 0x90, 0x97, 0xCA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x97, 0xB5, 0xE0, 0xFF, 0x90, -0x97, 0xB4, 0xE0, 0x2F, 0xFF, 0x90, 0x97, 0xB3, 0xE0, 0x34, 0x00, 0x22, 0xF1, 0x54, 0xA3, 0xED, -0xF0, 0x78, 0xB6, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x94, 0xF1, 0xB7, 0xF1, -0xE8, 0x7A, 0x80, 0x79, 0x9A, 0xF1, 0xBE, 0x78, 0xCC, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, -0x80, 0x79, 0xAA, 0xF1, 0xBE, 0xE4, 0x90, 0x97, 0xDF, 0xF0, 0x51, 0x1F, 0xA3, 0xE0, 0xFD, 0xF1, -0x7C, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xE1, 0x2A, 0xB1, 0x5A, 0xCF, 0x24, 0x0E, 0xCF, 0x34, 0x00, -0x51, 0x7A, 0xEF, 0x64, 0x3A, 0x60, 0x02, 0xE1, 0x2A, 0xB1, 0x5A, 0xCF, 0x24, 0x30, 0xCF, 0x34, -0x00, 0x51, 0x7A, 0xEF, 0x64, 0x87, 0x60, 0x02, 0xE1, 0x2A, 0x90, 0x97, 0xDF, 0x04, 0xF0, 0xE4, -0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x10, 0x50, 0x18, 0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, -0x38, 0x51, 0x6F, 0x90, 0x97, 0xDC, 0xE0, 0x24, 0xCC, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF1, 0x71, -0x80, 0xE2, 0xE4, 0x90, 0x97, 0xDD, 0xF0, 0x90, 0x97, 0xDD, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, -0x02, 0xE1, 0x2A, 0x75, 0xF0, 0x38, 0xEF, 0xF1, 0xC5, 0x20, 0xE0, 0x02, 0xE1, 0x2A, 0xE4, 0x90, -0x97, 0xDE, 0xF0, 0xF1, 0xD6, 0x90, 0x93, 0x5E, 0x12, 0x04, 0x6E, 0xE0, 0xFE, 0x90, 0x97, 0xDE, -0xE0, 0xC3, 0x9E, 0x40, 0x02, 0xE1, 0x22, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x75, 0xF9, 0x74, -0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, 0x29, 0xF9, 0xEA, 0x35, 0xF0, -0xFA, 0x78, 0xCC, 0x7C, 0x97, 0x12, 0xEF, 0xE4, 0x60, 0x02, 0xE1, 0x13, 0x90, 0x06, 0x33, 0xE0, -0x44, 0x01, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x06, 0x50, 0x12, -0xF1, 0x30, 0xB1, 0x65, 0xCD, 0x24, 0x4A, 0x51, 0x6F, 0x90, 0x97, 0xDC, 0xF1, 0xDF, 0xF1, 0x71, -0x80, 0xE8, 0xE4, 0x90, 0x97, 0xDC, 0xF0, 0xF1, 0x43, 0x94, 0x10, 0x50, 0x0B, 0x51, 0x5B, 0x90, -0x97, 0xDC, 0xF1, 0xCD, 0xF1, 0x71, 0x80, 0xEF, 0xF1, 0xD6, 0xF1, 0xC5, 0xFE, 0xC3, 0x13, 0x30, -0xE0, 0x2C, 0xEF, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x65, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, -0x01, 0x78, 0xBC, 0x7C, 0x97, 0x12, 0xEF, 0xE4, 0x70, 0x70, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, -0x0B, 0x90, 0x93, 0x25, 0x12, 0xA6, 0x03, 0x20, 0xE0, 0x1D, 0x80, 0x12, 0x80, 0x19, 0x90, 0x95, -0xB9, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0x93, 0x25, 0x12, 0xA6, 0x03, 0x20, 0xE0, 0x09, 0x90, 0x01, -0xC7, 0x74, 0x0A, 0xF1, 0x4A, 0x80, 0x53, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xB6, 0x90, 0x97, 0xE3, -0x12, 0x85, 0xF7, 0x7A, 0x97, 0x79, 0xCC, 0x90, 0x97, 0xE6, 0x12, 0x85, 0xF7, 0x90, 0x97, 0xDD, -0xE0, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x5F, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x90, 0x97, 0xE9, -0x12, 0x85, 0xF7, 0xE4, 0x90, 0x97, 0xEC, 0xF0, 0xA3, 0xF0, 0x7A, 0x97, 0x79, 0xBC, 0x12, 0xC2, -0x04, 0x80, 0x07, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x05, 0xF0, 0x90, 0x97, 0xDE, 0xE0, 0x04, 0xF0, -0xC1, 0x13, 0x90, 0x97, 0xDD, 0xE0, 0x04, 0xF0, 0xA1, 0xF7, 0x90, 0x97, 0xDF, 0xE0, 0xFF, 0x22, -0x90, 0x97, 0xB5, 0xE0, 0xFD, 0x90, 0x97, 0xB4, 0xE0, 0x2D, 0xFD, 0x22, 0x90, 0x97, 0xBB, 0xE0, -0xFF, 0xC3, 0x22, 0x90, 0x97, 0xDC, 0xE0, 0xFF, 0xC3, 0x22, 0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x44, -0x01, 0xF0, 0x22, 0xF0, 0x90, 0x97, 0xB3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xFF, 0xA3, 0xE0, -0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0xFD, 0x90, 0x97, 0xB5, 0xE0, -0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xDC, 0xE0, 0x04, 0xF0, 0x22, 0x12, 0xCF, 0xA1, 0xED, -0xF0, 0x2F, 0xFF, 0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xEF, 0x64, 0x86, -0x70, 0x1B, 0x90, 0x97, 0xE2, 0xE0, 0xFF, 0x90, 0x97, 0xE1, 0xE0, 0x2F, 0x12, 0xE9, 0xF4, 0xCF, -0x24, 0x07, 0xCF, 0x34, 0x00, 0x51, 0x7A, 0xBF, 0xDD, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, -0x7E, 0x00, 0x7F, 0x04, 0x02, 0x01, 0xE0, 0x7E, 0x00, 0x7F, 0x06, 0x02, 0x01, 0xE0, 0x7E, 0x00, -0x7F, 0x10, 0x02, 0x01, 0xE0, 0x90, 0x93, 0x5D, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xE0, 0x24, 0xBC, -0xF5, 0x82, 0xE4, 0x34, 0x97, 0x22, 0x90, 0x97, 0xDD, 0xE0, 0xFF, 0x75, 0xF0, 0x38, 0x22, 0xE0, -0x24, 0xB6, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0x22, 0x78, 0xBC, 0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, -0x22, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x08, 0x12, 0xD7, 0xBD, 0x12, 0x8E, 0x13, 0x90, 0x93, 0x09, -0x12, 0x8F, 0x1A, 0x90, 0x93, 0x0A, 0xF0, 0x12, 0xBF, 0xDD, 0x90, 0x93, 0x08, 0xE0, 0x54, 0x01, -0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, 0x1A, 0x11, 0x5E, 0x60, -0x0A, 0x11, 0x57, 0x12, 0x7C, 0x05, 0x12, 0xBF, 0xCB, 0x80, 0x07, 0x11, 0x57, 0x12, 0x7C, 0x3B, -0xF1, 0xED, 0x12, 0x79, 0xD4, 0x80, 0x17, 0x11, 0x5E, 0x60, 0x07, 0x11, 0x57, 0x12, 0x7C, 0x05, -0x80, 0x05, 0x11, 0x57, 0x12, 0x7C, 0x3B, 0x91, 0xE4, 0x91, 0xEB, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, -0x0A, 0xE0, 0x90, 0x01, 0x3F, 0x22, 0xF1, 0xE6, 0x64, 0x01, 0x60, 0x02, 0x21, 0x83, 0x90, 0x88, -0x36, 0xE0, 0x70, 0x02, 0x21, 0x83, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x33, 0x90, 0x06, 0xA9, -0xE0, 0x54, 0xC0, 0x70, 0x2B, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x25, 0x90, 0x04, 0x1A, 0xE0, 0xF4, -0x70, 0x1E, 0xE0, 0x54, 0x07, 0x64, 0x07, 0x70, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, -0x0F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x08, 0x12, 0xB4, 0x41, 0x54, 0xFE, 0x12, 0xD1, 0xCF, -0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, -0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, -0x90, 0x07, 0xF1, 0xE0, 0x90, 0x97, 0x2B, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x97, 0x2C, 0xF0, -0x12, 0xBB, 0x8F, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEC, 0xF0, 0x31, 0x8C, 0x24, 0xFD, 0x50, -0x02, 0x80, 0x03, 0x12, 0xBA, 0xFA, 0x31, 0x8C, 0x64, 0x01, 0x70, 0x22, 0x90, 0x06, 0xAB, 0xE0, -0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xAA, 0xE0, 0x90, 0x88, 0x3C, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, -0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x31, 0x95, -0xE4, 0x90, 0x88, 0x3F, 0xF0, 0xD1, 0x00, 0x30, 0xE0, 0x52, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x20, 0xE0, 0x21, 0x31, 0x84, 0x6F, 0x70, 0x44, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, -0xBF, 0xAB, 0x11, 0x53, 0x12, 0x7C, 0x05, 0xF1, 0xF4, 0x12, 0xBF, 0x9D, 0x90, 0x88, 0x3D, 0xE0, -0x14, 0xF0, 0x80, 0x28, 0x12, 0xF0, 0x38, 0x64, 0x01, 0x70, 0x21, 0x31, 0x84, 0xFE, 0x6F, 0x60, -0x1B, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x12, 0x12, 0x97, 0xD5, 0x30, 0xE0, 0x0C, -0xEF, 0x54, 0xBF, 0x11, 0x53, 0x12, 0x7C, 0x3B, 0x91, 0xEB, 0x91, 0xE4, 0x90, 0x88, 0x32, 0xE0, -0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, -0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x97, 0x2C, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x97, 0x2B, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, -0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x85, 0xBA, 0x90, 0x88, 0x85, 0x71, 0xA4, 0xEF, 0x24, -0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, 0x71, 0xA4, -0x90, 0x88, 0x85, 0x71, 0xBF, 0x50, 0x02, 0x41, 0x8B, 0x90, 0x88, 0x89, 0x12, 0x85, 0xE2, 0x90, -0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, 0xBA, 0x90, 0x98, 0x7E, 0x12, 0x04, 0x31, 0x90, 0x88, -0x31, 0xE0, 0x30, 0xE0, 0x2B, 0x91, 0xF3, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, 0x33, -0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, 0xFD, -0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x71, 0xAD, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x1E, -0x90, 0x88, 0x33, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x02, 0x61, 0x89, 0x71, 0xAD, 0x90, 0x88, 0x4E, -0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, -0x98, 0x7A, 0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x98, 0x7B, 0xE0, 0x94, 0xA0, 0x90, 0x98, 0x7A, -0xE0, 0x94, 0x00, 0x50, 0x36, 0xA3, 0xE0, 0xFB, 0x24, 0xEB, 0x71, 0x9C, 0xE0, 0x04, 0xF0, 0x90, -0x98, 0x7E, 0x12, 0x04, 0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0x8B, 0x2B, 0x71, 0x91, 0xE0, 0xFE, -0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x98, 0x7A, 0xA3, 0xE0, 0x71, 0x8F, 0xEF, 0xF0, 0x90, 0x88, -0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, -0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x61, 0x89, -0xE4, 0xFF, 0xFE, 0x71, 0x99, 0xE0, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, -0x40, 0x07, 0x90, 0x98, 0x7C, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, 0x91, 0xCB, -0x40, 0x02, 0x80, 0x15, 0x90, 0x98, 0x7C, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, -0x71, 0x99, 0xE0, 0x2F, 0xFF, 0x91, 0xCB, 0x40, 0x07, 0x90, 0x98, 0x7D, 0xEE, 0xF0, 0x80, 0x03, -0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x71, 0x8A, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, -0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x98, 0x7D, 0xE0, -0x80, 0x18, 0x71, 0x8A, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, -0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x98, 0x7D, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, -0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, -0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, 0x9F, -0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4F, -0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, 0xE0, -0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, -0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x12, 0xCF, 0xCE, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, 0x8A, -0xA3, 0x12, 0x8D, 0x12, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x98, 0x7C, 0xE0, 0xFE, 0x24, -0x8B, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x74, 0xEB, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, 0x98, 0x7E, -0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, 0x03, 0xEB, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x9A, 0x1B, 0x12, -0x85, 0xE2, 0xC3, 0x02, 0x03, 0xDA, 0x90, 0x9A, 0x1A, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, 0x70, -0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, -0x9A, 0x1B, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0x71, 0xB8, 0x70, 0x05, 0x90, 0x88, 0xBE, 0x80, -0x1B, 0xE4, 0xFF, 0xFE, 0x71, 0xBA, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, 0xF0, -0x80, 0x56, 0xE4, 0xFF, 0x71, 0xB8, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, 0x80, -0x47, 0xE4, 0x7F, 0x80, 0xFE, 0x71, 0xBA, 0x70, 0x3F, 0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, 0xF0, -0x80, 0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, 0x91, 0xB5, 0x60, 0x08, -0x90, 0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, 0x7E, -0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0x91, 0xB5, 0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, -0x80, 0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, -0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, 0x11, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x12, -0x8E, 0x2C, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, 0xFF, 0x90, -0x8A, 0xF3, 0x12, 0x9A, 0x7E, 0x90, 0x9A, 0x1A, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, 0xB4, -0x01, 0x06, 0x91, 0xAE, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x9A, 0x1A, 0xE0, 0xFD, 0xB4, 0x02, 0x06, -0x91, 0xAE, 0x44, 0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x91, 0xAE, 0xF0, 0x22, 0x90, 0x88, -0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x9A, 0x1B, 0x12, 0x04, 0x31, -0x90, 0x9A, 0x1B, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, 0x91, 0xE0, 0xFD, -0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, -0x9D, 0xE4, 0x9C, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, -0x7C, 0x74, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, -0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x12, 0x97, 0xDF, 0x79, 0x08, 0x12, 0x04, -0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, -0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, 0x74, 0x02, 0x91, 0xF2, 0xFF, 0xB1, 0xF2, 0x12, -0xEE, 0x67, 0x90, 0x8A, 0x89, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, -0x89, 0x12, 0x8D, 0x12, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, 0x8D, -0x12, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, -0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, 0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, 0x74, -0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, 0x54, -0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, 0x88, -0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, -0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0x91, 0xF2, 0xB1, 0xF2, 0x7E, 0x00, 0x7F, 0x18, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x0C, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, 0x8D, -0x12, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, 0x7D, -0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, -0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, -0xF0, 0x22, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x22, -0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x24, 0x12, 0xD7, 0xBD, 0xF1, 0x17, 0x12, 0xEF, 0xC6, -0x90, 0x93, 0x24, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0xF1, 0x16, 0x12, 0xEF, 0xCF, -0x90, 0x93, 0x24, 0xF1, 0x0E, 0x12, 0xF0, 0x03, 0x90, 0x93, 0x24, 0x12, 0xF0, 0x0C, 0x4E, 0x12, -0x8F, 0x1A, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x26, 0xE0, 0x54, 0xFE, 0x12, 0x8E, 0x12, 0xFE, -0x54, 0x01, 0xFD, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, 0xEE, 0x54, 0x04, 0xFE, -0xED, 0x54, 0xFB, 0x4E, 0xFE, 0x12, 0x8E, 0x13, 0xFD, 0x54, 0x08, 0xFC, 0xEE, 0x54, 0xF7, 0x4C, -0xFE, 0x90, 0x93, 0x25, 0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEE, 0x54, 0xEF, 0x4D, 0xF0, 0xEF, 0x54, -0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, 0x4F, 0xFF, 0x12, 0x8F, 0x1A, 0x12, 0xF0, 0x30, 0x90, 0x93, -0x26, 0x12, 0x8E, 0x13, 0x54, 0x02, 0xFF, 0x90, 0x93, 0x25, 0xE0, 0x54, 0xFD, 0x4F, 0x12, 0xD7, -0xB3, 0x12, 0xCE, 0x56, 0x12, 0xD7, 0x75, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, -0x12, 0xE3, 0xEE, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x12, 0xE4, 0x0B, 0x90, -0x93, 0x25, 0x12, 0x98, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x93, 0x24, 0xD1, 0x03, 0x20, 0xE0, 0x0E, -0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x08, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x01, -0x80, 0x0E, 0x7F, 0x00, 0x80, 0x0A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x01, 0xFF, -0x12, 0xE5, 0xD4, 0x90, 0x93, 0x24, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0x1E, 0x90, -0x93, 0x24, 0xE0, 0x54, 0x01, 0xFF, 0x12, 0xD6, 0x8F, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0xEE, -0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0xFE, 0x22, 0xEF, 0x60, -0x05, 0x12, 0xD2, 0xF9, 0xF1, 0x27, 0x22, 0x90, 0x95, 0xC6, 0xF1, 0xDB, 0xE0, 0xFE, 0x24, 0x28, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0x12, 0xCF, 0x99, 0xE0, -0xFD, 0x90, 0x97, 0x32, 0xE0, 0x24, 0x2C, 0x12, 0xE3, 0x45, 0x90, 0x97, 0x32, 0xE0, 0x2F, 0x24, -0x30, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, 0x04, 0x12, 0xCF, 0xBA, 0xE0, 0xFE, 0x74, 0x05, 0x2D, 0x12, -0xCE, 0x4F, 0x90, 0x95, 0x6D, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, 0x33, 0xE0, 0x24, 0x0C, 0xF9, -0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x6F, 0x12, -0x69, 0xF5, 0x90, 0x97, 0x33, 0xE0, 0x24, 0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0x12, 0xC6, 0xAD, -0xE0, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0x12, 0xCE, 0x56, 0x90, 0x95, 0x73, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x95, 0xC7, 0xF1, 0xDB, 0x90, 0x95, 0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x4E, -0x60, 0x11, 0x90, 0x97, 0x32, 0x12, 0xC7, 0x80, 0x8F, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x77, -0x12, 0x69, 0xF5, 0x90, 0x95, 0xC8, 0xF1, 0xDB, 0x12, 0xC7, 0x81, 0x90, 0x95, 0x6B, 0xA3, 0xE0, -0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x97, 0x02, 0x69, 0xF5, 0xE0, 0xFF, 0x12, 0x7B, 0x07, -0x90, 0x97, 0x32, 0xEF, 0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x22, 0x7D, 0x02, 0x7F, -0x02, 0x12, 0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x93, 0x0C, 0xE0, 0x20, -0xE0, 0x02, 0x01, 0xCA, 0xE4, 0x90, 0x97, 0x32, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0xFF, 0xC3, 0x94, -0x05, 0x40, 0x02, 0x01, 0xCA, 0x12, 0x97, 0xAA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -0xF9, 0xFF, 0x90, 0x93, 0x0D, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x01, 0xC2, 0x12, 0x02, 0x06, -0xFF, 0x30, 0xE0, 0x1A, 0x90, 0x93, 0x0E, 0xE0, 0xFE, 0x90, 0x97, 0x32, 0xE0, 0xFD, 0x74, 0x01, -0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x0E, 0xF0, 0xEF, 0xC3, -0x13, 0x30, 0xE0, 0x15, 0x90, 0x93, 0x0F, 0xE0, 0xFF, 0x90, 0x97, 0x32, 0x11, 0xD3, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0F, 0xF0, 0x12, 0x8E, 0x14, 0xFF, 0x90, 0x97, 0x32, -0xE0, 0xFE, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x8F, 0x1A, 0xFF, -0x74, 0x15, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x12, 0x8F, 0x13, 0xFF, -0x74, 0x1A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, -0x74, 0x1F, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x0D, 0xE0, -0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0D, -0xF0, 0x22, 0x90, 0x97, 0x32, 0xE0, 0x04, 0xF0, 0x01, 0x09, 0x22, 0x7F, 0x61, 0x12, 0x7B, 0x41, -0x90, 0x9A, 0x3C, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x9A, 0x3D, 0xED, 0xF0, 0x90, 0x9A, 0x3C, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, -0x42, 0x7F, 0x47, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, -0x12, 0x7B, 0x2E, 0x7F, 0x46, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, -0x46, 0x51, 0x71, 0x60, 0x0D, 0x7F, 0x45, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, -0x80, 0x0C, 0x7F, 0x45, 0x11, 0xCD, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, -0x45, 0x80, 0x46, 0x90, 0x9A, 0x3C, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x11, 0xCD, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, 0x11, 0xCD, -0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x51, 0x71, 0x60, 0x0E, 0x11, 0xCB, -0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, 0x11, 0xCB, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xAD, 0x07, 0x90, 0x93, 0x29, 0xE0, 0x75, 0xF0, 0x40, 0xA4, 0xFF, 0x90, 0x9A, 0x15, 0xE5, -0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x93, 0x2A, 0xE0, 0xC3, 0x13, 0x54, 0x7F, -0x90, 0x9A, 0x18, 0xF0, 0x90, 0x93, 0x2B, 0xE0, 0x13, 0x13, 0x54, 0x01, 0x90, 0x9A, 0x19, 0xF0, -0xED, 0x64, 0x01, 0x70, 0x6E, 0xE0, 0x70, 0x15, 0x90, 0x9A, 0x15, 0xE0, 0x70, 0x02, 0xA3, 0xE0, -0x60, 0x0B, 0x90, 0x9A, 0x15, 0x74, 0xFF, 0x75, 0xF0, 0xD0, 0x12, 0x02, 0xE7, 0x51, 0x33, 0x54, -0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, 0xDB, 0x51, 0x33, 0x54, 0x01, 0xFD, 0x11, -0xDB, 0x90, 0x93, 0x2A, 0xE0, 0x30, 0xE0, 0x3B, 0x51, 0x24, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, -0x02, 0x7D, 0x01, 0x11, 0xDB, 0xE4, 0x90, 0x9A, 0x17, 0xF0, 0x90, 0x9A, 0x18, 0xE0, 0xFF, 0x90, -0x9A, 0x17, 0xE0, 0xC3, 0x9F, 0x50, 0x1C, 0x51, 0x24, 0x54, 0x01, 0xFD, 0x11, 0xDB, 0x51, 0x24, -0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, 0xDB, 0x90, 0x9A, 0x17, 0xE0, 0x04, -0xF0, 0x80, 0xD7, 0x22, 0x90, 0x9A, 0x15, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9A, 0x19, 0xE0, -0xFD, 0x51, 0x42, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, 0xFF, 0x90, 0x93, 0x27, 0xE0, 0xFE, 0xC4, -0x13, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x11, 0x8F, 0x12, 0xBD, 0x01, 0x15, -0xE5, 0x12, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xEE, 0x54, 0x1F, 0xFE, -0x12, 0x7A, 0xAE, 0x80, 0x07, 0xAF, 0x12, 0xAE, 0x11, 0x12, 0x7C, 0x6A, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x12, 0x7B, 0x2E, 0x90, 0x9A, 0x3D, 0xE0, 0x22, 0x90, 0x01, 0xC7, 0x74, 0x10, 0xF0, 0x7F, -0x01, 0x90, 0x9A, 0x48, 0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x02, 0x70, 0x22, 0x90, 0x9A, -0x48, 0xE0, 0xFD, 0x64, 0x01, 0x70, 0x66, 0x12, 0x9F, 0x4B, 0x90, 0x93, 0x28, 0x12, 0x8F, 0xDA, -0x30, 0xE0, 0x09, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x51, 0xAF, 0x05, 0x80, 0x4B, -0x12, 0x97, 0x93, 0x70, 0x32, 0x90, 0x97, 0x2D, 0xE0, 0xFF, 0x30, 0xE0, 0x2A, 0x90, 0x00, 0xD4, -0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x00, 0xC6, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x44, -0x30, 0xF0, 0x90, 0x00, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0xCC, 0xE0, 0x54, 0xFB, 0xF0, -0xEF, 0x54, 0xFE, 0x90, 0x97, 0x2D, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0xF1, 0xEA, 0x90, -0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x9A, 0x48, 0xE0, 0xFF, 0x31, 0x81, 0x12, 0x96, 0x39, -0xF0, 0x02, 0x97, 0xB2, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x99, 0x84, 0xF0, -0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0x12, 0x95, 0x65, 0x90, 0x99, 0x8C, 0xF0, 0xA3, 0xF0, -0xA3, 0xF0, 0x90, 0x01, 0xC4, 0x74, 0x04, 0xF0, 0x74, 0xAB, 0xA3, 0x12, 0xD6, 0x15, 0x12, 0xCE, -0x56, 0x90, 0x99, 0x7B, 0x12, 0xD7, 0xA0, 0x90, 0x99, 0x83, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x20, -0xE0, 0x02, 0xC1, 0x1F, 0xE4, 0x90, 0x99, 0x82, 0xF0, 0x90, 0x99, 0x83, 0xE0, 0xFF, 0x90, 0x99, -0x82, 0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xC1, 0x1F, 0xF1, 0xD8, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, -0x90, 0x99, 0x8C, 0xEF, 0xF0, 0x12, 0xD5, 0x69, 0x54, 0x3F, 0xFE, 0x90, 0x99, 0x7D, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x99, 0x88, 0xEE, 0x12, 0xEF, 0x8B, 0x30, 0xE0, 0x0A, 0xC3, 0x13, 0x20, 0xE0, -0x05, 0x12, 0xD7, 0xDB, 0x80, 0x02, 0x7E, 0x00, 0xEF, 0x24, 0x18, 0x2E, 0xFF, 0x90, 0x99, 0x8D, -0xF0, 0x90, 0x99, 0x7C, 0xE0, 0x2F, 0xFF, 0x90, 0x99, 0x7B, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x99, -0x7F, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9A, 0x7B, 0xC0, 0x07, 0x90, 0x99, 0x7F, 0xD1, 0x3B, 0x7D, -0x01, 0x12, 0x04, 0x7E, 0xC0, 0x07, 0x90, 0x99, 0x7F, 0xD1, 0x3B, 0x7D, 0x04, 0x12, 0x04, 0x7E, -0xAB, 0x07, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0xE3, 0x4E, 0x90, 0x99, 0x84, 0xEF, 0xF0, 0xD1, 0x2F, -0x12, 0x9A, 0x7B, 0xEF, 0x54, 0xFC, 0x90, 0x99, 0x81, 0xF0, 0x90, 0x99, 0x8D, 0xE0, 0xFF, 0x90, -0x99, 0x7D, 0xE4, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0xF1, 0xE1, 0x12, 0xD6, 0x1F, 0x90, 0x99, 0x7D, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x7B, 0xD1, 0x3B, 0x7D, 0x0F, 0x12, 0x04, 0x7E, 0x7D, -0x01, 0x12, 0xE4, 0xD7, 0xEF, 0x60, 0x12, 0x12, 0x9F, 0x4B, 0x90, 0x99, 0x7B, 0xD1, 0x3B, 0x7D, -0x10, 0x12, 0x04, 0x7E, 0x90, 0x95, 0x61, 0xEF, 0xF0, 0xF1, 0xE1, 0x90, 0x99, 0x7B, 0x12, 0xD7, -0xCC, 0xF1, 0xD8, 0xD3, 0x9F, 0xEC, 0x9E, 0x40, 0x0F, 0x12, 0xEF, 0xB6, 0xED, 0x9F, 0xFF, 0xEC, -0x9E, 0x90, 0x99, 0x7B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x07, 0xE0, 0x60, 0x3F, 0x90, 0x99, -0x81, 0xE0, 0x24, 0xB0, 0x60, 0x18, 0x24, 0xD0, 0x60, 0x02, 0xA1, 0xB9, 0xF1, 0xD0, 0x20, 0xE0, -0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, 0xB9, 0x80, 0x10, 0xF1, 0xD0, -0x20, 0xE0, 0x0B, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, 0xB9, 0xD1, 0x2F, -0x90, 0x99, 0x88, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x12, 0xE8, 0x28, 0xA1, 0xB9, 0x90, 0x99, 0x81, -0xE0, 0x24, 0xF8, 0x60, 0x3A, 0x24, 0x80, 0x60, 0x36, 0x24, 0xC8, 0x60, 0x06, 0x24, 0x20, 0x60, -0x02, 0xA1, 0xB9, 0x90, 0x93, 0x27, 0xE0, 0xFF, 0x12, 0x8F, 0xDB, 0x20, 0xE0, 0x02, 0xA1, 0xB9, -0x90, 0x93, 0x3A, 0xE0, 0x04, 0xF0, 0xD1, 0x2F, 0xF1, 0x0B, 0xEF, 0x70, 0x02, 0xA1, 0xB9, 0x90, -0x99, 0x81, 0xE0, 0xFF, 0x12, 0xE0, 0xCF, 0x90, 0x93, 0x3B, 0xE0, 0x04, 0xF0, 0xA1, 0xB9, 0x90, -0x93, 0x24, 0x12, 0xC1, 0x8E, 0x30, 0xE0, 0x5F, 0x90, 0x99, 0x84, 0xE0, 0xFF, 0x90, 0x99, 0x80, -0xE0, 0x2F, 0xFF, 0x90, 0x99, 0x7F, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, -0x90, 0x99, 0x8A, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9A, 0x7B, 0xEF, 0x64, 0x45, 0x70, 0x38, 0xD1, -0xFB, 0x12, 0xEA, 0xCE, 0xEF, 0x64, 0x01, 0x70, 0x2E, 0xD1, 0xFB, 0x12, 0xEB, 0x0D, 0xEF, 0x64, -0x01, 0x70, 0x24, 0x90, 0x99, 0x8E, 0x04, 0xD1, 0xFA, 0xA3, 0xE0, 0xFD, 0x12, 0xEA, 0x26, 0xEF, -0x70, 0x0D, 0x90, 0x99, 0x8C, 0xE0, 0xFD, 0x90, 0xFD, 0x11, 0xD1, 0xFA, 0x12, 0xEA, 0x7F, 0x90, -0x99, 0x8C, 0xE0, 0x90, 0xFD, 0x11, 0xF0, 0xD1, 0x2F, 0xF1, 0x0B, 0xEF, 0x60, 0x1C, 0xD1, 0x2F, -0x90, 0x99, 0x84, 0xE0, 0xFD, 0x90, 0x99, 0x87, 0xE0, 0xFB, 0x90, 0x99, 0x8C, 0xE0, 0x90, 0x97, -0xB7, 0xF0, 0x12, 0x99, 0x76, 0xEF, 0x60, 0x02, 0xF1, 0x04, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, -0x30, 0xE0, 0x0F, 0xD1, 0x2F, 0x90, 0x99, 0x84, 0xE0, 0xFD, 0x12, 0x9C, 0x0D, 0xEF, 0x60, 0x02, -0xF1, 0x04, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x0F, 0xD1, 0x2F, 0x90, -0x99, 0x84, 0xE0, 0xFD, 0x12, 0x9D, 0x6C, 0xEF, 0x60, 0x02, 0xF1, 0x04, 0x90, 0x93, 0x24, 0x12, -0x8F, 0xDA, 0x30, 0xE0, 0x1C, 0x90, 0x99, 0x8E, 0xE0, 0x70, 0x16, 0xD1, 0x2F, 0x90, 0x99, 0x84, -0xE0, 0xFD, 0x12, 0xE4, 0xA1, 0xEF, 0x60, 0x09, 0x12, 0x9F, 0x4B, 0x90, 0x01, 0xC7, 0x74, 0x22, -0xF0, 0xD1, 0x2F, 0x90, 0x99, 0x84, 0xE0, 0xFD, 0xD1, 0x4C, 0xEF, 0x60, 0x0C, 0x90, 0x93, 0x2D, -0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x04, -0x7F, 0x01, 0x51, 0x81, 0x12, 0xE0, 0xB8, 0xEF, 0x64, 0x01, 0x70, 0x37, 0x90, 0x93, 0x3C, 0xE0, -0x04, 0xF0, 0x12, 0xE0, 0x64, 0xAD, 0x07, 0xEF, 0x64, 0x01, 0x60, 0x1F, 0x12, 0x9F, 0x4B, 0xED, -0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, -0x01, 0xC7, 0x74, 0x43, 0xF0, 0x7F, 0x01, 0x51, 0x81, 0x80, 0x24, 0x90, 0x99, 0x7B, 0x12, 0xE0, -0x51, 0x80, 0x14, 0x90, 0x93, 0x26, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x11, 0x90, 0x93, -0x24, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, 0x99, 0x82, 0xE0, 0x04, 0xF0, 0x61, 0x49, 0x74, -0x04, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xAB, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -0x99, 0x7F, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x97, 0xB8, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x97, 0xB5, 0xED, -0x12, 0x9F, 0x53, 0xF1, 0x0B, 0xEF, 0x70, 0x02, 0xC1, 0xF7, 0x12, 0x9A, 0x1F, 0x12, 0xE4, 0xB8, -0x70, 0x02, 0xC1, 0xF7, 0x12, 0x9D, 0x5A, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0x90, 0x97, 0xB8, -0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x93, 0x25, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x33, 0xD1, 0x38, -0x7D, 0x09, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x06, 0x70, 0x27, 0xD1, 0x38, 0x7D, 0x14, 0x12, 0x04, -0x7E, 0xEF, 0x70, 0x1D, 0xD1, 0x38, 0x7D, 0x15, 0x12, 0x04, 0x7E, 0xEF, 0x64, 0x50, 0x70, 0x11, -0xD1, 0x38, 0x7D, 0x21, 0x12, 0x04, 0x7E, 0xEF, 0x20, 0xE0, 0x03, 0x30, 0xE2, 0x03, 0x7F, 0x01, -0x22, 0x90, 0x93, 0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x3B, 0xD1, 0x38, 0x7D, 0x09, -0x12, 0x04, 0x7E, 0xEF, 0x64, 0x11, 0x70, 0x2F, 0x90, 0x97, 0xB9, 0xE0, 0x24, 0x14, 0xFF, 0x90, -0x97, 0xB8, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x97, 0xB6, 0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x40, 0x7D, -0x02, 0x12, 0x04, 0x7E, 0xEF, 0x70, 0x10, 0x90, 0x97, 0xB6, 0xD1, 0x3B, 0x7D, 0x03, 0x12, 0x04, -0x7E, 0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, 0xF0, 0x90, 0x99, 0x8A, 0xE0, 0xFE, -0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x99, 0x8E, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x97, 0xBA, 0xEE, 0xF0, -0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x97, 0xC2, 0xF0, 0x90, 0x97, 0xC2, 0xE0, 0xFD, 0xC3, 0x94, 0x06, -0x50, 0x21, 0x90, 0x97, 0xBB, 0xE0, 0x24, 0x04, 0x12, 0xE4, 0xBF, 0x90, 0x8A, 0xE9, 0x12, 0x9A, -0x4F, 0x90, 0x97, 0xC2, 0x12, 0x9F, 0xCD, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xC2, 0xE0, 0x04, -0xF0, 0x80, 0xD5, 0x78, 0x2E, 0x7C, 0x93, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xBC, 0x12, -0xF0, 0x27, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, -0x85, 0x4E, 0x90, 0x97, 0xB2, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, -0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE1, 0x0D, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFD, -0xF0, 0x90, 0x86, 0x08, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0x30, 0xE2, 0x09, 0x54, 0xFB, 0xF0, -0x90, 0x86, 0x0A, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0xFF, 0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, -0x12, 0xCF, 0x30, 0xBF, 0x01, 0x02, 0x71, 0x04, 0xF1, 0xC8, 0xE0, 0x30, 0xE6, 0x09, 0x54, 0xBF, -0xF0, 0x90, 0x8A, 0x7D, 0x12, 0x8E, 0x2C, 0xF1, 0xC8, 0xE0, 0xFF, 0x30, 0xE7, 0x06, 0x54, 0x7F, -0xF0, 0x12, 0xBE, 0x11, 0xD2, 0xAF, 0x80, 0xA1, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, 0x22, -0x90, 0x93, 0x04, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0x90, 0x99, 0x7B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -0x22, 0x90, 0x99, 0x7D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x7F, 0x64, 0x7E, 0x00, 0x02, 0x7C, -0x6A, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x0C, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, -0xE0, 0x04, 0xE4, 0x12, 0x94, 0x39, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x95, 0xD8, 0xF0, 0xBF, -0x01, 0x0A, 0x7F, 0x01, 0x12, 0x90, 0xB4, 0xE4, 0x90, 0x95, 0xD8, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x29, 0x90, 0x00, 0x8C, -0xE0, 0x90, 0x9A, 0x30, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x9A, 0x31, 0xEF, 0xF0, 0x90, -0x00, 0x8E, 0xE0, 0x90, 0x9A, 0x32, 0xF0, 0x90, 0x9A, 0x31, 0xE0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, -0xEF, 0x30, 0xE0, 0x02, 0x11, 0x5B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, -0x7B, 0x2E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x3A, 0xEF, 0xF0, 0x7F, 0x8F, -0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x4A, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, 0x01, 0x70, -0x40, 0x90, 0x9A, 0x3B, 0xF0, 0x90, 0x9A, 0x3B, 0xE0, 0xFD, 0x90, 0x9A, 0x3A, 0xE0, 0xC4, 0x54, -0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, 0x82, 0xE4, -0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFF, 0x11, 0xC6, 0x90, 0x9A, 0x3B, 0xE0, 0x04, 0xF0, -0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, 0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0x11, -0x5B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, -0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, -0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xE4, 0x90, -0x97, 0x88, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x97, 0x88, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x95, -0xE2, 0xE0, 0x70, 0x18, 0x90, 0x95, 0xDF, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x97, -0x88, 0xE0, 0x24, 0xEE, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xB0, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, -0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, -0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0xBB, 0x62, 0xC2, 0xAF, 0x12, 0xB8, 0x6E, 0xBF, -0x01, 0x16, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x03, 0x07, 0x90, 0x97, 0x2D, 0xE0, 0x20, 0xE0, -0x05, 0xEF, 0x64, 0x03, 0x60, 0x02, 0x31, 0x64, 0xD2, 0xAF, 0x12, 0xD0, 0x55, 0x11, 0x1D, 0x12, -0x83, 0x4D, 0x80, 0x93, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x02, 0x31, 0x6E, 0x22, 0x90, 0x88, -0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0xEB, 0xAA, 0xBF, 0x01, 0x08, 0x31, 0x87, -0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xB2, -0x31, 0x97, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x97, 0x8B, 0xF0, 0x12, 0xDB, 0xCA, 0x7F, -0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x71, -0xEB, 0x90, 0x93, 0x0C, 0xE0, 0x20, 0xE0, 0x02, 0x41, 0x9A, 0x91, 0x41, 0x44, 0x02, 0x12, 0xD1, -0xCF, 0xE4, 0x90, 0x97, 0x8C, 0xF0, 0x90, 0x97, 0x8C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2E, -0x12, 0x97, 0xAA, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0F, -0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x10, 0x90, 0x97, 0x8C, 0xF1, 0xED, 0x90, 0x97, 0x8C, 0x12, 0xEF, -0x6A, 0x44, 0x40, 0xF0, 0x91, 0x3A, 0x90, 0x97, 0x8C, 0xE0, 0x04, 0xF0, 0x80, 0xC8, 0x90, 0x07, -0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, 0xC4, -0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x12, 0xDF, 0x77, 0x90, -0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x97, 0x8D, 0xF0, 0x90, 0x97, 0x8D, 0xE0, 0x30, -0xE0, 0x1A, 0x90, 0x97, 0x8B, 0xE0, 0x04, 0xF0, 0x12, 0xCF, 0x63, 0x90, 0x02, 0x26, 0xE0, 0x90, -0x97, 0x8D, 0xF0, 0x90, 0x97, 0x8B, 0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xDF, 0x90, 0x02, 0x03, 0x74, -0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x97, 0x8E, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, -0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, 0x97, 0x8D, 0xF0, 0x90, 0x02, 0x01, 0x51, 0xA9, 0x90, 0x02, -0x02, 0x51, 0xA9, 0x90, 0x02, 0x14, 0x51, 0xA9, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, -0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x97, 0x8E, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, -0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, 0x48, 0xE4, 0xFD, 0x12, 0x76, -0xF7, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x97, 0x8D, 0xE0, 0x2F, -0xF0, 0x22, 0x75, 0x0F, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, 0x91, 0x48, 0x7D, 0x01, -0x12, 0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, -0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, -0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x0C, 0xE0, 0x30, 0xE0, 0x6A, 0x90, 0xFD, 0x09, 0xE4, -0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x97, 0x8B, -0xF0, 0x90, 0x97, 0x8B, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2E, 0x12, 0x97, 0xAA, 0x80, 0x05, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0E, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, -0x10, 0x90, 0x97, 0x8B, 0xF1, 0xED, 0x90, 0x97, 0x8B, 0x12, 0xEF, 0x6A, 0x44, 0x20, 0xF0, 0x91, -0x3A, 0x90, 0x97, 0x8B, 0xE0, 0x04, 0xF0, 0x80, 0xC8, 0x71, 0xE4, 0x54, 0xFE, 0xFD, 0x7F, 0x92, -0x12, 0x7B, 0x2E, 0x71, 0xE4, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x91, 0x41, 0x54, -0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x07, 0x71, 0xE4, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, -0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, 0x01, -0x71, 0xEB, 0x90, 0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, 0x7E, -0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x90, 0x9A, 0x33, 0xEF, 0x12, -0x95, 0x65, 0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x9A, 0x33, -0xE0, 0x6F, 0x60, 0x35, 0xC3, 0x90, 0x9A, 0x35, 0xE0, 0x94, 0x88, 0x90, 0x9A, 0x34, 0xE0, 0x94, -0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x9A, 0x34, 0x12, 0xC9, -0x1C, 0x91, 0x3A, 0xD3, 0x90, 0x9A, 0x35, 0xE0, 0x94, 0x32, 0x90, 0x9A, 0x34, 0xE0, 0x94, 0x00, -0x40, 0xC0, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, -0x6A, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, -0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0xF0, 0x22, -0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, -0x8E, 0x2C, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, -0xE0, 0x64, 0x08, 0x70, 0x1F, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x13, 0x91, 0x48, 0xE4, 0xFD, -0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, -0x90, 0x88, 0xE7, 0xF0, 0x90, 0x88, 0xA1, 0x12, 0x97, 0xA2, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, -0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x7C, 0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, 0xB1, -0xAF, 0x12, 0xDE, 0x64, 0x90, 0x05, 0x60, 0xB1, 0xAF, 0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0xB1, 0xAF, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0xA3, 0xB1, 0xAF, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0x12, 0x85, 0xD5, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, 0x7F, -0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, 0xCF, 0xCE, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0x12, -0xDD, 0x0D, 0x12, 0xA6, 0x00, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, -0xA7, 0xED, 0x12, 0x96, 0x40, 0x12, 0xDF, 0xEA, 0xE4, 0x90, 0x95, 0xCF, 0xF0, 0x12, 0xEE, 0xFC, -0x90, 0x93, 0x24, 0x12, 0xC1, 0x8E, 0x30, 0xE0, 0x52, 0x90, 0x95, 0x63, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0x7C, 0x00, 0x7D, 0x64, 0x12, 0x02, 0x92, 0x90, 0x95, 0xB7, 0xE0, 0x6E, 0x70, 0x03, 0xA3, -0xE0, 0x6F, 0x60, 0x0A, 0x90, 0x95, 0xB7, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0x90, 0x95, -0x67, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x75, 0xE0, 0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, -0x07, 0x0F, 0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, 0x31, 0xF0, 0x7F, 0x01, 0x02, 0xAA, -0x81, 0x12, 0xCE, 0x9F, 0xE4, 0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x9A, 0x3E, 0xE0, -0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x3E, -0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0xC1, 0x9B, 0x90, 0x06, 0x03, 0xE0, 0x54, -0xFB, 0xF0, 0x90, 0x9A, 0x3E, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, -0x54, 0x9F, 0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xDB, 0xA2, 0x90, 0x9A, 0x3F, 0xEF, 0xF0, 0x90, -0x04, 0x83, 0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, -0x7E, 0x09, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x10, 0xB1, 0xAC, 0xEF, 0x54, 0x03, -0xFF, 0xE4, 0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0xF1, 0xE4, 0x7F, 0x00, 0x7E, 0x0A, 0xF1, -0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xB1, 0xAC, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, -0x0A, 0xF1, 0xE4, 0x7F, 0x00, 0x7E, 0x0D, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, 0x00, -0x90, 0x9A, 0x3F, 0xB1, 0xAF, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xF1, 0xE4, 0x7F, 0x18, -0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, 0xA8, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x00, 0x12, 0xEF, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, -0x99, 0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x5D, 0x90, 0x06, 0x03, 0xE0, 0x44, -0x04, 0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x08, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, -0x00, 0x00, 0x01, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, -0x09, 0xF1, 0x0A, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, 0xA8, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x0C, 0x00, 0x12, 0xEF, 0xEF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x99, -0x96, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xD9, -0x64, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0xF1, 0x14, 0x90, 0x99, 0xA4, 0x22, -0x7F, 0x58, 0x7E, 0x0C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0xA2, 0xEE, 0xF0, -0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, 0x99, 0xAC, 0x12, 0x04, 0x31, 0x90, 0x99, 0xA4, 0x12, -0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x99, 0xAC, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xC0, 0x04, -0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, 0xA4, 0x12, 0x04, 0xB8, 0x90, 0x99, 0xA8, 0x12, -0x85, 0xE2, 0x12, 0x85, 0xC8, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, -0x90, 0x99, 0xB0, 0x12, 0x04, 0x31, 0x90, 0x99, 0xB0, 0x12, 0xD1, 0x0B, 0x90, 0x99, 0xA2, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x04, 0x12, -0x97, 0xD8, 0x30, 0xE0, 0x08, 0x12, 0xD7, 0x5C, 0xE4, 0x90, 0x98, 0xA3, 0xF0, 0x90, 0x99, 0xA4, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x98, 0x89, 0xB1, 0xAF, 0xF1, 0xE7, 0xF1, 0x06, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x98, 0x8A, 0xB1, 0xAF, 0xF1, 0xE7, 0xF1, 0x10, -0x90, 0x98, 0x9F, 0xE0, 0x90, 0x06, 0x08, 0xF0, 0x90, 0x98, 0xA1, 0xA3, 0xE0, 0x90, 0x06, 0xA0, -0xF0, 0xA3, 0xE4, 0xF0, 0x90, 0x98, 0x8D, 0xE0, 0xFF, 0x60, 0x05, 0xA3, 0xE0, 0xFD, 0xB1, 0xB6, -0x90, 0x98, 0x8C, 0xE0, 0xFF, 0x60, 0x0C, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, 0xFB, 0x12, 0xDB, 0x29, -0x12, 0xD9, 0xE2, 0x22, 0x12, 0x03, 0xFE, 0x90, 0x99, 0xA8, 0x02, 0x04, 0x31, 0xE0, 0xFF, 0x24, -0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x1F, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, 0x75, 0x29, 0x10, -0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x07, 0x75, 0x2C, 0x02, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, -0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, -0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, -0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x75, 0x39, 0x07, 0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x75, -0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, -0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x7D, 0x02, -0x90, 0x01, 0xC4, 0x74, 0x6E, 0xF0, 0x74, 0xB8, 0xA3, 0xF0, 0x90, 0x95, 0xCB, 0xE0, 0xFF, 0xED, -0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, -0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0x6E, 0x04, 0x90, -0x01, 0xC4, 0xF0, 0x74, 0xB8, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x8A, 0x79, 0x74, 0x88, 0xF0, -0xA3, 0x74, 0x66, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xB9, 0xF0, 0xA3, 0x74, 0x73, 0xF0, 0x90, 0x8B, -0x03, 0x74, 0x88, 0xF0, 0xA3, 0x74, 0xBA, 0xF0, 0x90, 0x8A, 0xB9, 0x74, 0xEC, 0xF0, 0xA3, 0x74, -0xDF, 0xF0, 0x90, 0x8A, 0xC3, 0x74, 0xDB, 0xF0, 0xA3, 0x74, 0xE9, 0xF0, 0x90, 0x8A, 0xF3, 0x74, -0xDD, 0xF0, 0xA3, 0x74, 0x15, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xA3, 0xF0, 0xA3, 0x74, 0xC6, 0xF0, -0x90, 0x86, 0x04, 0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x21, 0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xD1, 0xF0, -0xA3, 0x74, 0xE7, 0xF0, 0x90, 0x86, 0x0C, 0x74, 0x98, 0xF0, 0xA3, 0x74, 0x3F, 0xF0, 0x90, 0x8A, -0xEF, 0x74, 0xD1, 0xF0, 0xA3, 0x74, 0x14, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xEB, 0xF0, 0xA3, 0x74, -0x44, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xEC, 0xF0, 0xA3, 0x74, 0x23, 0xF0, 0x90, 0x8A, 0xFD, 0x74, -0xD7, 0xF0, 0xA3, 0x74, 0xEA, 0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xD8, 0xF0, 0xA3, 0x74, 0x49, 0xF0, -0x90, 0x8A, 0xAF, 0x74, 0xC0, 0xF0, 0xA3, 0x74, 0xE8, 0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xDC, 0xF0, -0xA3, 0x74, 0x29, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0x7D, 0xF0, 0x90, 0x8A, -0xA3, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0xCE, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xD2, 0xF0, 0xA3, 0x74, -0x21, 0xF0, 0x22, 0x8F, 0x13, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x13, -0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x01, 0xC4, 0x74, 0x82, 0xF0, 0x74, 0xB9, 0xA3, 0xF0, 0x12, 0x6C, 0xD6, 0x12, 0x97, 0x93, 0x70, -0x37, 0x90, 0x97, 0x2D, 0xE0, 0xFF, 0x20, 0xE0, 0x2F, 0xE5, 0x26, 0x30, 0xE3, 0x2A, 0x90, 0x00, -0xCC, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0xD4, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x00, 0xC6, 0xE0, -0x44, 0x02, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x54, 0xCF, 0xF0, 0x90, 0x00, 0x23, 0xE0, 0x54, 0x7F, -0xF0, 0xEF, 0x44, 0x01, 0x90, 0x97, 0x2D, 0xF0, 0x74, 0x82, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -0xB9, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, -0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0E, -0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x02, 0x51, 0xB0, 0xE5, -0x2D, 0x30, 0xE3, 0x03, 0x12, 0xD8, 0xF9, 0xE5, 0x2D, 0x30, 0xE4, 0x03, 0x12, 0xD9, 0x0C, 0xE5, -0x2D, 0x30, 0xE5, 0x03, 0x12, 0xD9, 0x1D, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x51, 0xB9, 0xE5, 0x2F, -0x30, 0xE1, 0x03, 0x12, 0xB4, 0x60, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, 0xC8, 0x7D, 0xE5, 0x2F, -0x30, 0xE3, 0x02, 0x51, 0xC9, 0xE5, 0x2F, 0x30, 0xE4, 0x02, 0x71, 0x72, 0xE5, 0x2F, 0x30, 0xE5, -0x02, 0x71, 0xD4, 0xE5, 0x2F, 0x30, 0xE6, 0x02, 0x51, 0xDB, 0x74, 0x0E, 0x04, 0x90, 0x01, 0xC4, -0xF0, 0x74, 0xBA, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0x71, 0xF5, 0x22, 0x12, 0x98, 0xE7, 0xE4, 0xFF, 0x91, 0xCF, -0x90, 0x8B, 0x07, 0x71, 0xCD, 0xF9, 0x02, 0x04, 0x7A, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x0A, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x04, 0x71, 0x8F, 0x71, 0x9A, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -0xBF, 0x01, 0x0E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x08, 0x51, 0xF2, 0x54, 0x07, 0x70, 0x02, 0x71, -0x62, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, 0x10, 0x90, 0x06, 0xA9, -0xE0, 0xF5, 0x10, 0x54, 0xC0, 0x70, 0x18, 0x51, 0xF2, 0x54, 0xFD, 0xF0, 0x71, 0x62, 0x90, 0x88, -0x39, 0xE0, 0x60, 0x4D, 0x12, 0xB4, 0x41, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, -0x10, 0x30, 0xE6, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1C, 0x90, 0x88, 0x3A, 0xE0, -0x44, 0x01, 0xF0, 0x91, 0x46, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8E, 0x2C, 0x80, -0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0x51, 0xF2, 0xE5, 0x10, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0D, -0xE0, 0x44, 0x02, 0x71, 0x9A, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, -0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0x12, 0xAE, 0x43, 0x7D, 0x01, 0x02, -0x04, 0x7E, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x15, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x71, -0x8F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x91, 0xC4, 0x54, 0x07, 0x70, 0x02, 0x71, 0x62, 0x22, 0x90, -0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, -0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, -0x66, 0x33, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x11, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x06, 0x71, -0xCA, 0xF9, 0x02, 0x04, 0x7A, 0xF1, 0xC3, 0x71, 0x62, 0x22, 0x90, 0x8B, 0x01, 0xE0, 0xFE, 0xA3, -0xE0, 0xAA, 0x06, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x18, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x12, 0x91, 0x46, 0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, 0xE1, 0x71, 0xCD, 0xF9, 0x02, 0x04, -0x7A, 0x12, 0x73, 0x8F, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xD1, 0xC7, 0x90, -0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x3F, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x37, 0x90, 0x8A, -0xD7, 0x12, 0x8E, 0x2C, 0x91, 0x46, 0x60, 0x1F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, -0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, -0x7E, 0x71, 0xCA, 0xF9, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x08, 0x90, 0x8A, 0xB9, -0x12, 0x8D, 0x12, 0xD1, 0xAD, 0x22, 0x90, 0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0x12, 0xA6, 0x00, -0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xF1, 0x9D, 0x90, 0x88, -0x31, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x09, 0xEF, 0x91, 0xC4, 0x54, 0x07, 0x70, 0x4D, 0x80, 0x49, -0x90, 0x88, 0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x12, 0xEE, 0xC2, -0x40, 0x37, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x32, 0x91, 0x46, 0x70, 0x08, 0x90, 0x8A, 0xF5, -0x12, 0x8E, 0x2C, 0x80, 0x27, 0x90, 0x8A, 0xF5, 0x12, 0x8E, 0x2C, 0x90, 0x88, 0x40, 0xE0, 0x04, -0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, 0x91, 0xBC, 0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, 0x03, -0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0x71, 0x62, 0x22, 0x90, 0x88, 0x32, 0xE0, -0x54, 0xFB, 0xF0, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x25, 0x90, -0x99, 0x58, 0x74, 0x1E, 0xF0, 0x90, 0x99, 0x7A, 0x74, 0x01, 0xF0, 0x90, 0x99, 0x5A, 0xEF, 0xF0, -0x7B, 0x01, 0x7A, 0x99, 0x79, 0x58, 0x12, 0xEF, 0xA7, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, -0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xB1, 0x50, 0x12, 0xA4, 0xE4, 0x7F, 0x01, -0x91, 0xCF, 0x90, 0x8B, 0x07, 0x12, 0x8E, 0x2C, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x30, 0xF1, -0xCB, 0x90, 0x93, 0x0B, 0xE0, 0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, 0xD4, 0xF1, 0xDD, 0xE4, 0xFF, -0x12, 0xA0, 0x11, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, -0x30, 0xE0, 0x0C, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0x98, 0x22, -0xE4, 0x90, 0x98, 0x82, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x3C, 0x12, 0xA7, 0xE6, 0x64, 0x01, -0x70, 0x35, 0xF1, 0xAB, 0xF0, 0x12, 0xEF, 0x2C, 0x90, 0x98, 0x82, 0x74, 0x01, 0xF0, 0xE4, 0x90, -0x88, 0x3D, 0xF0, 0x04, 0x60, 0x21, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, -0x12, 0x8D, 0x12, 0xD1, 0xAD, 0xF1, 0xB3, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x12, 0x98, 0xDD, 0x71, -0xA4, 0x90, 0x8A, 0xD7, 0x12, 0x8E, 0x2C, 0x22, 0xE4, 0x90, 0x9A, 0x08, 0xF0, 0x7F, 0x03, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x03, 0xEF, 0xF0, 0xF1, 0x57, 0x90, 0x9A, 0x03, -0xE0, 0xFF, 0xF1, 0x49, 0x74, 0x01, 0xF0, 0x90, 0x9A, 0x08, 0xE0, 0xFE, 0xEF, 0xD1, 0xB4, 0xEE, -0xF0, 0x90, 0x9A, 0x03, 0xE0, 0xD1, 0x03, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0xF8, -0x78, 0x10, 0x12, 0x03, 0xEB, 0xAB, 0x07, 0xB1, 0xF8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x92, -0x20, 0xEF, 0xF0, 0xB1, 0xF8, 0x90, 0x92, 0x21, 0xEF, 0xF0, 0x7D, 0x01, 0x7F, 0x50, 0x7E, 0x01, -0x12, 0x66, 0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, 0x04, 0x02, 0x04, 0xB8, 0x90, 0x97, -0xB3, 0xE0, 0xFB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x08, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, -0x22, 0xE4, 0x90, 0x97, 0xB3, 0xF0, 0x90, 0x97, 0xB3, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x40, 0x02, -0xC1, 0xA5, 0xF1, 0x48, 0xE0, 0x64, 0x01, 0x70, 0x74, 0x90, 0x97, 0xB3, 0xE0, 0xD1, 0x03, 0x12, -0x04, 0xB8, 0xE4, 0x7B, 0x01, 0xD1, 0xA6, 0x70, 0x3A, 0x90, 0x97, 0xB3, 0xE0, 0xFB, 0xD1, 0xB4, -0xE0, 0x60, 0x21, 0x14, 0x70, 0x57, 0xEB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x0C, 0xF5, 0x82, 0xE4, -0x34, 0x99, 0xF5, 0x83, 0x12, 0x04, 0xB8, 0xEB, 0xD1, 0x03, 0x12, 0x04, 0x31, 0x90, 0x97, 0xB3, -0xE0, 0xFF, 0x80, 0x0B, 0xB1, 0xFE, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, 0xD1, -0xC2, 0x80, 0x2A, 0x90, 0x97, 0xB3, 0xE0, 0xD1, 0x03, 0x12, 0x04, 0xB8, 0xE4, 0xFB, 0xD1, 0xA6, -0x50, 0x1B, 0xB1, 0xFE, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0xFF, 0xFF, 0xEE, 0x34, 0xFF, 0xFE, 0xED, -0x34, 0xFF, 0xFD, 0xEC, 0x34, 0xFF, 0xFC, 0xEB, 0xD1, 0x03, 0x12, 0x04, 0x31, 0x90, 0x97, 0xB3, -0xE0, 0x04, 0xF0, 0xC1, 0x16, 0x22, 0xFA, 0xF9, 0xF8, 0xC3, 0x02, 0x03, 0xDA, 0x7D, 0x01, 0x7F, -0x04, 0x02, 0x04, 0x7E, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, -0x83, 0x22, 0xEF, 0x24, 0xFC, 0x60, 0x05, 0x04, 0x70, 0x05, 0x80, 0x04, 0x12, 0xDA, 0x63, 0x22, -0xE4, 0x90, 0x97, 0xB4, 0xF0, 0x90, 0x99, 0x07, 0x04, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x04, -0xF0, 0x12, 0xE7, 0xB9, 0xE4, 0x90, 0x98, 0x88, 0xF0, 0xFF, 0xF1, 0x67, 0x12, 0xA7, 0xE6, 0x64, -0x01, 0x70, 0x47, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, 0x7E, -0x7F, 0x05, 0x7E, 0x00, 0x12, 0x7A, 0xAE, 0x12, 0xEF, 0xD8, 0x12, 0x8D, 0x12, 0xF1, 0xA4, 0x90, -0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x23, 0x90, 0x97, 0xB4, 0xE0, 0x04, 0xF0, 0x7F, 0x01, 0x7E, -0x00, 0x12, 0x7A, 0xAE, 0x90, 0x8A, 0xB9, 0x12, 0x8D, 0x12, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, -0x7E, 0x90, 0x97, 0xB4, 0xE0, 0xD3, 0x94, 0x0A, 0x40, 0xD5, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x0A, 0xF1, 0xBB, 0xA1, 0x9F, 0xEF, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x11, 0xF5, -0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0x90, 0x01, 0x53, 0xE4, 0xF0, 0xFF, 0xF1, 0x48, 0xE4, -0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF7, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, -0xD9, 0xEF, 0xF0, 0x90, 0x93, 0x06, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x74, 0x10, 0x2F, 0xFF, 0x90, -0x97, 0xD9, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, 0x12, 0xC7, 0x81, 0x75, 0x48, 0x04, 0x7B, -0x01, 0x7A, 0x98, 0x79, 0x9B, 0x12, 0x69, 0xF5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7D, 0x02, 0x7F, -0x02, 0x02, 0x7C, 0x7E, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x3C, 0xE0, 0x90, -0x05, 0x73, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, 0x90, 0x9A, 0x08, 0xF0, -0x7F, 0x04, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, 0x93, 0x0A, 0xE0, 0x90, -0x05, 0x73, 0xF0, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0x91, 0x4D, 0x22, 0x90, 0x93, 0x09, -0xE0, 0x14, 0x90, 0x93, 0x0B, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xE7, 0xF0, 0x74, 0xBF, 0xA3, 0xF0, 0x12, 0x75, -0x50, 0xE5, 0x3D, 0x30, 0xE0, 0x03, 0x12, 0xD9, 0x59, 0xE5, 0x3D, 0x30, 0xE1, 0x03, 0x12, 0xBF, -0xD4, 0xE5, 0x3D, 0x30, 0xE2, 0x03, 0x12, 0xBB, 0xB2, 0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, 0xE7, -0xE5, 0x3E, 0x30, 0xE0, 0x03, 0x12, 0xC8, 0x8F, 0xE5, 0x3F, 0x30, 0xE2, 0x09, 0x11, 0x9B, 0x90, -0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8D, -0x12, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, 0x12, 0xBD, 0x09, 0xE5, 0x40, -0x30, 0xE5, 0x03, 0x12, 0xCF, 0xFF, 0xE5, 0x40, 0x30, 0xE6, 0x02, 0x31, 0xA1, 0xE5, 0x40, 0x30, -0xE7, 0x03, 0x12, 0xCF, 0xDF, 0x74, 0xE7, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBF, 0xA3, 0xF0, -0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2E, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x01, 0x17, -0xA3, 0xE0, 0xB4, 0x01, 0x22, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x90, 0x8A, 0x7F, 0x11, 0xDC, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, 0x09, 0x74, 0x03, -0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x8E, 0x2C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFC, 0xA3, 0xE0, -0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x9A, 0x1F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, -0xE0, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, -0x3F, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x9A, 0x23, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0x7D, -0x26, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x12, 0x8E, 0x29, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, 0x05, -0x31, 0x8B, 0x30, 0xE0, 0x07, 0x12, 0x9A, 0x28, 0x31, 0x95, 0x11, 0xDC, 0x90, 0x9A, 0x23, 0xE0, -0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xAE, 0x43, 0x7D, 0x27, 0x12, 0x04, 0x7E, 0x31, 0x82, 0x80, 0x09, -0x31, 0x82, 0x11, 0xDC, 0x12, 0x9A, 0x28, 0x31, 0x95, 0x11, 0xDC, 0x90, 0x88, 0x9D, 0xE0, 0x30, -0xE0, 0x17, 0x31, 0x8B, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, 0x90, 0x8A, -0xF9, 0x12, 0xAE, 0x43, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0x31, 0xFD, 0x7F, 0x01, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x90, 0x9A, 0x1F, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, -0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x9A, 0x21, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, -0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x12, 0x8F, 0xDB, 0x30, 0xE0, 0x21, 0xEF, 0x54, 0x7F, 0x12, -0xD0, 0x42, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFD, 0xF0, 0x12, -0xD0, 0x4B, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xBB, 0x62, 0x31, 0x8B, 0x30, -0xE0, 0x22, 0x90, 0x88, 0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, 0x54, 0xFD, 0xF0, -0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x04, -0xE0, 0x54, 0xFB, 0xF0, 0x7F, 0x01, 0x02, 0x97, 0x1E, 0xE4, 0xFF, 0x91, 0xCF, 0x90, 0x04, 0x1F, -0x74, 0x20, 0xF0, 0x22, 0x90, 0x97, 0xE0, 0x12, 0x85, 0xF7, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x97, -0xF1, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x39, 0x12, 0x8E, 0x22, 0xEF, 0x64, 0x01, -0x70, 0x16, 0x80, 0x00, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x11, 0xF1, 0xCC, -0x90, 0x97, 0xEE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, 0xEE, 0x12, 0xE3, 0x28, 0x90, 0x97, -0xF0, 0xEF, 0xF0, 0x90, 0x97, 0xEE, 0xF1, 0xEA, 0x90, 0x97, 0xEC, 0xE0, 0xFD, 0x12, 0xE1, 0x20, -0x90, 0x97, 0xED, 0xE0, 0x60, 0x02, 0x41, 0xE8, 0x91, 0xDA, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -0x90, 0x97, 0xE3, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, -0xD1, 0xE2, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE0, 0x71, 0xA6, -0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x91, 0xDD, 0xC0, -0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE6, 0x71, 0xA6, 0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, -0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x24, 0x60, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, -0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE6, 0x71, 0xA6, 0x75, 0x48, 0x10, 0xD0, 0x01, -0xD0, 0x02, 0xD0, 0x03, 0x71, 0x92, 0xE0, 0x2F, 0x24, 0x72, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, -0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x97, 0xE9, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, -0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xE6, 0x12, 0x85, 0xEE, 0x90, 0x98, -0x1D, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x20, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x20, 0x90, 0x98, -0x24, 0x74, 0x3A, 0xF0, 0x90, 0x97, 0xE0, 0x12, 0x85, 0xEE, 0xF1, 0x8F, 0x71, 0x95, 0xD1, 0xC4, -0xF1, 0x87, 0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xF2, 0x71, 0x92, 0xD1, 0xC4, 0xFA, -0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0xCD, 0x75, 0x48, 0x28, 0xD0, -0x03, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xF0, 0xE0, 0xFF, 0x90, 0x97, 0xEF, 0xE0, 0x2F, 0xFF, 0x90, -0x97, 0xEE, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xFD, 0xE4, 0x3F, 0xFC, 0x90, 0x95, 0xBD, 0xE0, -0xFB, 0x7F, 0x3A, 0x91, 0xE7, 0x71, 0x95, 0xD1, 0xC4, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, -0x75, 0x46, 0x97, 0x75, 0x47, 0xF2, 0x75, 0x48, 0x28, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x95, -0xB9, 0xE0, 0xB4, 0x02, 0x0D, 0x90, 0x95, 0xBD, 0xE0, 0xFF, 0x90, 0x97, 0xF0, 0xE0, 0xFD, 0x12, -0xCC, 0xBA, 0x90, 0x06, 0x33, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x97, 0xF1, 0xE0, 0xFD, 0x7B, 0x3A, -0x21, 0xF9, 0x12, 0x69, 0xF5, 0x90, 0x97, 0xEE, 0xA3, 0xE0, 0xFF, 0xA3, 0x22, 0x90, 0x97, 0x32, -0x12, 0x85, 0xF7, 0x90, 0x97, 0x32, 0x12, 0x85, 0xEE, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0xB4, 0x12, 0x85, 0xF7, 0x78, 0xC0, 0x7C, -0x99, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x8E, 0x12, 0x9F, 0xB7, 0x90, 0x05, 0x22, 0xE0, -0x90, 0x99, 0xBF, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x33, 0x12, 0x8E, 0x22, 0xEF, -0x64, 0x01, 0x70, 0x16, 0x80, 0x00, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x10, -0xF1, 0xCC, 0x90, 0x99, 0xBC, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xBC, 0x12, 0xE3, 0x28, -0x90, 0x99, 0xBE, 0xEF, 0xF0, 0x90, 0x99, 0xBC, 0xF1, 0xEA, 0x90, 0x99, 0xBA, 0xE0, 0xFD, 0x12, -0xE1, 0x20, 0x90, 0x99, 0xBB, 0xE0, 0x70, 0x49, 0x91, 0xDA, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, -0x90, 0x99, 0xB7, 0x71, 0xA6, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0xE3, -0xDB, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x99, 0xB7, 0x71, 0xA6, 0x75, -0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0xD1, 0xD8, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, -0x02, 0xC0, 0x01, 0x90, 0x99, 0xB4, 0x71, 0xA6, 0x75, 0x48, 0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, -0x40, 0x90, 0x99, 0xBB, 0xE0, 0x64, 0x01, 0x70, 0x3D, 0x91, 0xDA, 0xC0, 0x03, 0x8B, 0x45, 0x75, -0x46, 0x93, 0x75, 0x47, 0x49, 0x75, 0x48, 0x06, 0xD0, 0x03, 0x12, 0xE3, 0xDB, 0xFA, 0x7B, 0x01, -0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x53, 0x75, 0x48, 0x06, 0xD0, 0x03, 0xD1, -0xD8, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x59, 0x75, 0x48, -0x04, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x95, 0xB9, 0xE0, 0xB4, 0x02, 0x0D, 0x90, 0x95, 0xBC, -0xE0, 0xFF, 0x90, 0x99, 0xBE, 0xE0, 0xFD, 0x12, 0xCC, 0xBA, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x10, -0xF0, 0x90, 0x99, 0xBF, 0xE0, 0xFD, 0x7B, 0x34, 0x31, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -0x05, 0x22, 0xED, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0xA3, 0xA3, 0xE0, 0x24, 0x38, 0xF9, -0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, -0xD5, 0xEC, 0x12, 0x97, 0xBA, 0xAA, 0x07, 0x90, 0x99, 0xDC, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -0x00, 0xF1, 0xDC, 0xEA, 0x24, 0xEF, 0x60, 0x34, 0x24, 0xD7, 0x70, 0x02, 0xC1, 0x41, 0x24, 0x3A, -0x60, 0x02, 0xC1, 0x75, 0xD1, 0xB5, 0x24, 0x0A, 0xD1, 0xEB, 0xE4, 0xD1, 0xA9, 0xE4, 0xF0, 0xFE, -0x74, 0x00, 0x2F, 0xF1, 0xD4, 0x7D, 0x14, 0xD1, 0x90, 0x12, 0xCF, 0x6A, 0xD1, 0x9B, 0x90, 0x90, -0xBE, 0x12, 0x04, 0x31, 0x7D, 0x14, 0x7C, 0x00, 0xE4, 0xFF, 0xC1, 0x3C, 0x90, 0x99, 0xD5, 0xE4, -0x75, 0xF0, 0x14, 0x12, 0x02, 0xE7, 0x90, 0x99, 0xD5, 0xA3, 0xE0, 0xFB, 0xFF, 0x24, 0x06, 0xFC, -0xE4, 0x33, 0x90, 0x99, 0xE0, 0xF0, 0xA3, 0xCC, 0xF0, 0x90, 0x99, 0xE0, 0xA3, 0xE0, 0xD1, 0xF5, -0xE4, 0xD1, 0xA9, 0xE4, 0x12, 0xCF, 0xB6, 0xE0, 0xFE, 0xA9, 0x03, 0x74, 0x05, 0x29, 0x12, 0xCE, -0x4F, 0xFE, 0x90, 0x99, 0xDA, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xD5, 0xE0, 0xFC, 0xA3, 0xE0, -0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xD3, 0xEF, 0x94, 0x00, 0xEE, 0x94, 0x01, 0x90, 0x99, 0xD5, 0x40, -0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xE9, 0x7C, 0x00, 0x24, 0x00, 0xF9, 0xEC, 0x34, 0xFC, 0xFA, -0x7B, 0x01, 0xC3, 0xE4, 0x9F, 0xFD, 0x74, 0x01, 0x9E, 0xFC, 0xD1, 0x92, 0x90, 0x99, 0xD7, 0xE0, -0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0xD1, 0xD2, -0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0x7B, 0x01, 0x7A, 0xFC, 0x79, 0x00, 0x90, 0x99, -0xD5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0xE4, 0x9F, 0xFF, 0x74, 0x01, 0x9E, 0xFE, 0xD1, 0xBC, -0xC3, 0x9F, 0xFD, 0xEC, 0x9E, 0xFC, 0x12, 0x45, 0xC2, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0x12, 0x85, 0xAD, 0xD1, 0x95, 0xF1, 0xDC, 0x80, 0x0D, 0xA3, 0xE0, 0x7E, 0x00, 0x24, 0x00, -0xF1, 0xD4, 0xD1, 0xBC, 0xFD, 0xD1, 0x92, 0x90, 0x99, 0xD5, 0x74, 0xFF, 0x75, 0xF0, 0xEC, 0x12, -0x02, 0xE7, 0xD1, 0xB5, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, -0x02, 0xC0, 0x01, 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0xD1, 0x9B, 0x90, 0x90, 0xBE, -0x12, 0x04, 0x31, 0xD1, 0xBC, 0xFD, 0xD0, 0x01, 0xD0, 0x02, 0x7F, 0x11, 0x12, 0x3C, 0xD9, 0x80, -0x2C, 0xD1, 0xB5, 0x24, 0x2A, 0xD1, 0xEB, 0xE4, 0xD1, 0xA9, 0xE4, 0xF0, 0x12, 0xCF, 0xAB, 0x7D, -0x48, 0xD1, 0x90, 0xD1, 0xA1, 0xD1, 0xCD, 0x12, 0x85, 0xAD, 0xE4, 0xFD, 0xFC, 0xD1, 0x95, 0xD1, -0xA1, 0xD1, 0xCD, 0x12, 0x85, 0xAD, 0xD1, 0x95, 0xD1, 0xA1, 0x12, 0x03, 0xCD, 0x90, 0x99, 0xD8, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, 0xD8, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, -0x99, 0xE0, 0xA3, 0xE0, 0xD1, 0xF5, 0xEF, 0xD1, 0xA9, 0xED, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x7C, 0x00, 0x12, 0x45, 0xC2, 0x90, 0x99, 0xDC, 0x02, 0x04, 0x31, 0x90, 0x90, 0xBB, 0x12, 0x85, -0xF7, 0x90, 0x99, 0xDC, 0x02, 0x04, 0xB8, 0x74, 0x03, 0xF0, 0x74, 0x01, 0x2E, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x99, 0xD5, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x99, 0xDA, 0xE0, -0xFC, 0xA3, 0xE0, 0x22, 0xE0, 0x2F, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x78, 0x10, 0x12, -0x03, 0xEB, 0x90, 0x99, 0xDC, 0x02, 0x85, 0xE2, 0x12, 0x69, 0xF5, 0x90, 0x99, 0xBC, 0xA3, 0xE0, -0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x48, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xFD, 0xE4, 0x33, 0x90, 0x99, -0xE0, 0xF0, 0xA3, 0xED, 0xF0, 0xFE, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x07, 0x12, 0xD7, 0x8E, 0xD1, 0xF8, 0xE0, -0x90, 0x98, 0xA4, 0xF0, 0x74, 0x01, 0x2F, 0xD1, 0xAD, 0xE0, 0x90, 0x98, 0xC5, 0x12, 0xD3, 0xF9, -0x90, 0x98, 0xE6, 0xF0, 0xEF, 0x24, 0x20, 0x90, 0x97, 0x32, 0xF0, 0xF1, 0x81, 0x90, 0x98, 0xA4, -0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0xA5, 0x12, 0x69, 0xF5, 0x90, 0x98, 0xA4, 0xF1, -0x78, 0x90, 0x98, 0xC5, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0xC6, 0x12, 0x69, 0xF5, -0x90, 0x98, 0xC5, 0xF1, 0x78, 0x90, 0x98, 0xE6, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x98, 0x79, -0xE7, 0x12, 0x69, 0xF5, 0xE4, 0xFF, 0x90, 0x98, 0xA4, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x03, -0x0F, 0x80, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x90, 0x97, 0x32, 0xE0, 0x2F, 0xF0, -0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x45, 0x01, 0xF5, 0x46, 0x89, 0x47, 0x22, 0x90, -0x98, 0x1A, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x1D, 0x71, 0xA6, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, -0x93, 0x79, 0xCD, 0x12, 0x69, 0xF5, 0x90, 0x98, 0x1A, 0x71, 0xA6, 0x75, 0x48, 0x10, 0x7B, 0x01, -0x7A, 0x93, 0x79, 0xDD, 0x12, 0x69, 0xF5, 0x90, 0x98, 0x20, 0x12, 0x04, 0xB8, 0x90, 0x93, 0xED, -0x12, 0x04, 0x31, 0x90, 0x98, 0x24, 0xE0, 0x90, 0x93, 0xF4, 0xF0, 0x22, 0xF0, 0x7B, 0x18, 0x7D, -0x01, 0x02, 0x66, 0xDB, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, 0x99, 0xD7, 0xE0, -0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x22, 0x02, 0x34, 0x78, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, -0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xF6, 0xF0, 0x74, 0xC7, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, -0x12, 0x8E, 0x2C, 0x53, 0x91, 0xBF, 0x74, 0xF6, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC7, 0xA3, -0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, -0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x4C, 0x90, 0x01, 0xC4, -0xED, 0xF0, 0x74, 0xC8, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, -0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x95, 0xD6, -0xE0, 0x04, 0xF0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0xA0, 0x66, 0x22, 0x11, -0xD8, 0x90, 0x98, 0x82, 0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x8D, 0x12, 0x7D, -0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x09, 0x12, -0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x98, 0x82, 0xE0, 0x30, 0xE6, 0x11, 0x90, -0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, -0xF1, 0xCE, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, 0x98, 0x84, 0xF0, 0xA3, 0xF0, 0x7F, -0x83, 0x12, 0x7B, 0x41, 0x90, 0x98, 0x83, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, -0x90, 0x98, 0x83, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, 0x98, 0x85, 0xE0, 0x94, 0x64, -0x90, 0x98, 0x84, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, -0x98, 0x83, 0xE0, 0xFF, 0x22, 0x90, 0x98, 0x84, 0x31, 0x1C, 0x80, 0xC3, 0xE4, 0x75, 0xF0, 0x01, -0x02, 0x02, 0xE7, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xC1, 0xF1, 0xA4, 0xED, -0xF0, 0x90, 0x97, 0xD9, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -0x97, 0x79, 0xE1, 0x12, 0x04, 0x80, 0x90, 0x01, 0xC4, 0x74, 0x23, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, -0x90, 0x95, 0xBE, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x97, 0xD8, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, -0x24, 0x29, 0xF1, 0x99, 0x74, 0x41, 0xF0, 0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x97, -0xD9, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, 0x90, 0x97, 0xDD, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, -0x28, 0x29, 0x12, 0xC7, 0xEE, 0x90, 0x97, 0xC3, 0xE0, 0xFD, 0x12, 0xE1, 0x20, 0x91, 0x17, 0x90, -0x97, 0xDD, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x97, 0xDB, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x97, -0xE1, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x74, 0x5F, 0xF0, 0x90, -0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x94, 0x39, 0xE0, 0xFF, 0x7E, 0x02, -0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, 0x97, 0xDD, 0xA3, 0xE0, 0xFD, 0x12, 0xC6, 0xF6, 0xEE, 0xF0, -0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0xE0, 0x90, 0x97, 0xE5, 0xF0, 0x90, 0x97, 0xDD, 0x31, 0x1C, -0x90, 0x95, 0x2E, 0xE0, 0x90, 0x97, 0xC1, 0xB4, 0x01, 0x0B, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, -0x44, 0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x20, 0xFD, 0x90, 0x97, -0xDF, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, -0x90, 0x97, 0xDD, 0x70, 0x17, 0xA3, 0xE0, 0x12, 0xC6, 0xF5, 0x12, 0xC6, 0xA7, 0x74, 0x01, 0xF0, -0x90, 0x97, 0xE6, 0x74, 0x03, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x80, 0x13, 0xA3, 0xE0, 0x12, 0xC6, -0xF5, 0x12, 0xC6, 0xA7, 0x74, 0x02, 0xF0, 0x90, 0x97, 0xE6, 0x04, 0xF0, 0xA3, 0x14, 0xF0, 0x91, -0x4C, 0xEF, 0x64, 0xFE, 0x90, 0x97, 0xDD, 0x70, 0x1E, 0xA3, 0xE0, 0x24, 0x00, 0xF1, 0xAE, 0xC0, -0x03, 0x8B, 0x45, 0x91, 0x56, 0xD0, 0x03, 0x12, 0x97, 0x8C, 0x91, 0x56, 0x7B, 0x01, 0x7A, 0x97, -0x79, 0xE8, 0x12, 0x69, 0xF5, 0x80, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, -0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, -0x83, 0xE4, 0xF0, 0x90, 0x97, 0xE8, 0xF0, 0xA3, 0xF0, 0x91, 0x4C, 0xE4, 0x90, 0x97, 0xDA, 0xF0, -0x91, 0x60, 0xFE, 0x90, 0x97, 0xDD, 0xA3, 0xE0, 0xFD, 0xEF, 0x2D, 0x12, 0xC6, 0xF6, 0xEE, 0xF0, -0x91, 0x60, 0xFE, 0x74, 0xEA, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEE, 0x91, 0x0F, -0xE0, 0xB4, 0x08, 0xDC, 0x91, 0x21, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x20, 0x12, 0x02, 0xE7, -0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x02, 0xE7, 0x91, 0x17, 0xE4, 0x90, 0x98, 0x64, -0xF0, 0xE4, 0x90, 0x97, 0xDA, 0xF0, 0x91, 0x43, 0x50, 0x0C, 0x91, 0x90, 0xF0, 0xE0, 0x12, 0xC6, -0xF6, 0xE4, 0x91, 0x0F, 0x80, 0xF0, 0x12, 0xAF, 0xEA, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xFB, 0xF0, -0x90, 0x95, 0xBF, 0x91, 0xB1, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xB1, 0xEB, -0xED, 0xFF, 0x90, 0x95, 0xBE, 0xB1, 0xF5, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, -0x97, 0xD9, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, -0x90, 0x92, 0x06, 0x74, 0x10, 0xF0, 0x7B, 0x63, 0xE4, 0xFD, 0x12, 0x71, 0xD4, 0x90, 0x97, 0xC1, -0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xE1, 0x70, 0x15, 0x90, -0x91, 0xA0, 0x91, 0x3B, 0x90, 0x91, 0xA3, 0x12, 0x85, 0xF7, 0x90, 0x91, 0xA6, 0x91, 0x33, 0x12, -0x6F, 0x34, 0x80, 0x13, 0x90, 0x91, 0x96, 0x91, 0x3B, 0x90, 0x91, 0x99, 0x12, 0x85, 0xF7, 0x90, -0x91, 0x9C, 0x91, 0x33, 0x12, 0x6E, 0xF3, 0x90, 0x98, 0x64, 0xE0, 0x04, 0xF0, 0x90, 0x06, 0x31, -0xE0, 0x30, 0xE2, 0x06, 0x91, 0x2B, 0x50, 0x02, 0x41, 0xD1, 0x91, 0x2B, 0x40, 0x0A, 0x90, 0x06, -0x35, 0xE0, 0x44, 0x20, 0x90, 0x06, 0x34, 0xF0, 0xE4, 0x90, 0x97, 0xDA, 0xF0, 0x91, 0x43, 0x50, -0x1E, 0x91, 0x90, 0xF0, 0x90, 0x97, 0xDA, 0xE0, 0x24, 0xC4, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, -0x83, 0xE0, 0xFF, 0x90, 0x97, 0xD8, 0xE0, 0x12, 0xC6, 0xF6, 0xEF, 0x91, 0x0F, 0x80, 0xDE, 0x90, -0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x0E, 0x90, 0x95, 0xBE, 0xE0, 0xFF, -0x90, 0x97, 0xD9, 0xE0, 0x24, 0x08, 0xFD, 0x91, 0xBA, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x20, 0x90, -0x05, 0x22, 0xE0, 0x90, 0x98, 0x63, 0xF0, 0x7B, 0x1D, 0x12, 0x8E, 0x22, 0xBF, 0x01, 0x02, 0x91, -0x70, 0x90, 0x98, 0x63, 0xE0, 0xFD, 0x7B, 0x1E, 0xE4, 0xFF, 0x12, 0xC4, 0xCF, 0x80, 0x02, 0x91, -0x70, 0x12, 0xC1, 0xFD, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x74, -0x23, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC9, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -0x90, 0x97, 0xDA, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x02, -0xE7, 0x90, 0x97, 0xDD, 0xE4, 0x75, 0xF0, 0x08, 0x02, 0x02, 0xE7, 0x90, 0x98, 0x64, 0xE0, 0xC3, -0x94, 0x0A, 0x22, 0x74, 0x10, 0xF0, 0x7A, 0x93, 0x79, 0xF5, 0x22, 0x12, 0x85, 0xF7, 0x7A, 0x97, -0x79, 0xC4, 0x22, 0x90, 0x97, 0xDA, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x22, 0x90, 0x97, 0xDD, 0xE4, -0x75, 0xF0, 0x02, 0x02, 0x02, 0xE7, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3C, 0x75, 0x48, 0x02, 0x22, -0x90, 0x97, 0xDA, 0xE0, 0xFF, 0x24, 0x3E, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0x22, -0x90, 0x95, 0xBE, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x08, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, -0x66, 0xDB, 0x90, 0x97, 0xD8, 0xEF, 0xF0, 0x90, 0x95, 0xBE, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x22, -0x90, 0x97, 0xDE, 0xE0, 0x2F, 0xFF, 0x90, 0x97, 0xDD, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x98, 0x61, -0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xBE, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, 0x90, 0x97, 0xD8, 0xEF, -0x22, 0xE0, 0xFD, 0x75, 0xF0, 0x80, 0xA4, 0xAE, 0xF0, 0x22, 0x90, 0x99, 0xC7, 0xED, 0xF0, 0x90, -0x99, 0xC6, 0xEF, 0xF0, 0x12, 0x7B, 0x07, 0x90, 0x99, 0xD4, 0xEF, 0xF0, 0xE0, 0xFD, 0x24, 0x01, -0x12, 0xC6, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0xC6, 0xF8, 0xD1, 0x56, 0x54, 0x3F, 0x90, -0x99, 0xD1, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x99, 0xD0, 0xF0, 0xD1, 0x19, 0x50, 0x0C, 0xD1, -0x22, 0xF0, 0xE0, 0x12, 0xC6, 0xF6, 0xE4, 0xD1, 0x01, 0x80, 0xF0, 0x90, 0x99, 0xD2, 0xE0, 0x24, -0xF8, 0xFB, 0x90, 0x99, 0xD1, 0xE0, 0x34, 0xFF, 0xFA, 0x90, 0x99, 0xC7, 0xE0, 0xFF, 0x90, 0x91, -0xDC, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x7D, 0x0A, 0x7C, 0x00, 0x7F, 0x10, -0x7E, 0x00, 0x12, 0x6D, 0xED, 0x90, 0x95, 0xBF, 0xE0, 0xFF, 0x90, 0x99, 0xC6, 0xE0, 0xFD, 0xD3, -0x9F, 0x40, 0x38, 0x90, 0x95, 0xBF, 0xE0, 0xFC, 0x91, 0xB3, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, -0x13, 0xD8, 0xF9, 0xB1, 0xEB, 0xEC, 0xFF, 0xC3, 0xED, 0xB1, 0xF7, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -0xD8, 0xF9, 0x24, 0x28, 0xFF, 0xE4, 0x3E, 0xFE, 0xD1, 0x11, 0xFD, 0x90, 0x99, 0xC7, 0xE0, 0xFC, -0xC3, 0xED, 0x9C, 0xD1, 0x09, 0x7D, 0x38, 0x7C, 0x00, 0x80, 0x35, 0x90, 0x99, 0xC6, 0x91, 0xB1, -0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xB1, 0xEB, 0xED, 0xFF, 0x90, 0x95, 0xBF, -0xB1, 0xF5, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x38, 0xFD, 0xE4, 0x3E, 0xFC, 0xD1, -0x11, 0xFF, 0x90, 0x99, 0xC7, 0xE0, 0xFE, 0xC3, 0xEF, 0x9E, 0xD1, 0x09, 0x7F, 0x28, 0x7E, 0x00, -0x12, 0x71, 0xD4, 0xF1, 0x6A, 0x90, 0x91, 0x45, 0x12, 0x85, 0xF7, 0x0B, 0x7A, 0x99, 0x79, 0xC8, -0x90, 0x91, 0x48, 0x12, 0x85, 0xF7, 0x90, 0x91, 0x4B, 0x74, 0x08, 0xF0, 0x7A, 0x94, 0x79, 0x2D, -0x12, 0x4E, 0xA5, 0xE4, 0x90, 0x99, 0xD0, 0xF0, 0xD1, 0x19, 0x50, 0x1E, 0xD1, 0x22, 0xF0, 0x90, -0x99, 0xD0, 0xE0, 0x24, 0xC8, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x99, -0xD3, 0xE0, 0x12, 0xC6, 0xF6, 0xEF, 0xD1, 0x01, 0x80, 0xDE, 0x22, 0xFF, 0x90, 0x92, 0x07, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, 0xEF, 0x78, 0x07, -0x22, 0xF0, 0x90, 0x99, 0xD0, 0xE0, 0x04, 0xF0, 0x22, 0xFB, 0x90, 0x92, 0x06, 0x74, 0x08, 0xF0, -0x22, 0x90, 0x99, 0xD1, 0xA3, 0xE0, 0x24, 0xF8, 0x22, 0x90, 0x99, 0xD0, 0xE0, 0xFF, 0xC3, 0x94, -0x08, 0x22, 0x90, 0x99, 0xD4, 0xE0, 0xFD, 0x90, 0x99, 0xD2, 0xE0, 0x2D, 0xFD, 0x90, 0x99, 0xD1, -0xE0, 0x34, 0x00, 0xCD, 0x24, 0x20, 0xCD, 0x34, 0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, -0x3C, 0xFE, 0x90, 0x99, 0xC6, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, 0x90, 0x99, 0xD3, 0xEF, 0x22, 0xF5, -0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x22, 0x90, -0x97, 0xC0, 0xED, 0xF0, 0x90, 0x97, 0xBE, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xE6, 0x15, 0x90, -0x97, 0xBE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x21, 0x23, 0xAD, 0x07, 0x90, 0x95, -0x6D, 0x31, 0x1C, 0x90, 0x95, 0x6D, 0xE0, 0xFF, 0xAE, 0x05, 0x74, 0x04, 0x2E, 0xF1, 0xBA, 0xEF, -0xF0, 0x90, 0x95, 0x6D, 0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0xF1, 0x91, 0xEF, 0xF0, 0x22, 0xE4, -0x90, 0x98, 0x7D, 0xF0, 0xA3, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, 0xF0, 0x12, 0x76, 0x9B, -0xEF, 0x64, 0x01, 0x70, 0x71, 0x90, 0x95, 0xC6, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x0D, 0xF0, -0x7B, 0x08, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x98, 0x7A, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -0x98, 0x7A, 0x12, 0xE3, 0x28, 0x90, 0x98, 0x7C, 0xEF, 0xF0, 0x90, 0x98, 0x7A, 0x12, 0xC7, 0xEA, -0xE4, 0xFD, 0x12, 0xE1, 0x20, 0x90, 0x98, 0x7C, 0xE0, 0xFF, 0x90, 0x98, 0x7B, 0xE0, 0x2F, 0xFF, -0x90, 0x98, 0x7A, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, 0xFE, 0x90, 0x98, 0x7D, -0xF0, 0xA3, 0xEF, 0xF0, 0xD1, 0x7C, 0xF1, 0x27, 0x90, 0x95, 0xC6, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, -0xC4, 0xE7, 0xF1, 0x27, 0x90, 0x95, 0xC2, 0xE0, 0xFB, 0x7F, 0x11, 0x12, 0xC4, 0xE7, 0x12, 0xC1, -0xFD, 0x90, 0x95, 0x75, 0x31, 0x1C, 0x22, 0x90, 0x98, 0x7D, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, -0xE4, 0x90, 0x9A, 0x44, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x22, 0xC3, 0x90, -0x9A, 0x45, 0xE0, 0x94, 0xD0, 0x90, 0x9A, 0x44, 0xE0, 0x94, 0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, -0xE0, 0x44, 0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x9A, 0x44, 0x31, 0x1C, 0xF1, 0x63, 0x80, 0xD7, -0x7F, 0x01, 0x22, 0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, -0x22, 0x90, 0x95, 0xCC, 0x12, 0x97, 0xD8, 0x30, 0xE0, 0x0A, 0xF1, 0x6A, 0xF1, 0xC2, 0xA3, 0x04, -0xF0, 0x02, 0xC3, 0xB0, 0x90, 0x8A, 0xAF, 0x12, 0x8D, 0x12, 0x7D, 0x08, 0xE4, 0xFF, 0x02, 0x04, -0x7E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0x22, 0x90, 0x97, 0xE0, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x22, 0x74, 0x00, 0x2F, 0xF9, 0xE4, -0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xF0, 0x74, 0x04, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -0x83, 0x22, 0x90, 0x99, 0xB7, 0x12, 0x85, 0xF7, 0xE4, 0x90, 0x99, 0xBA, 0xF0, 0x22, 0x90, 0x88, -0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, 0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, -0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, 0x8E, -0x2C, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8E, 0x2C, 0x22, 0x90, -0x88, 0x31, 0x12, 0x97, 0xA2, 0x30, 0xE0, 0x35, 0xEF, 0x54, 0xBF, 0x11, 0x42, 0x30, 0xE0, 0x06, -0xE0, 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, 0xF0, 0x11, 0x4B, 0x74, 0x04, 0xF0, 0x90, -0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0F, 0x90, 0x8A, 0xB9, 0x12, 0x8D, -0x12, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x80, 0x03, 0x12, 0xBB, 0x62, 0xE4, 0xFF, 0x02, -0x97, 0x1E, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, -0xF0, 0x90, 0x01, 0xB8, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0xDF, 0xE0, -0x60, 0x24, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0x70, 0x31, 0x01, 0x12, 0x04, 0xB8, 0xEF, 0x44, -0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x31, 0x01, 0x31, 0x0B, 0x7F, -0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x95, 0xDA, 0xE0, 0x70, 0x29, 0x90, 0x07, 0xCC, 0xE0, -0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x97, 0x8F, 0x74, 0x22, 0xF0, 0x90, 0x97, 0xB1, 0x74, 0x01, -0xF0, 0x90, 0x97, 0x91, 0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0x8F, 0x12, 0x8D, 0x00, -0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xE2, 0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x95, 0xDF, 0xE0, -0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x01, 0xC5, -0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, 0x60, 0x06, 0x90, 0x01, -0xC4, 0x74, 0x07, 0xF0, 0x90, 0x95, 0xDF, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x01, 0xF0, -0x90, 0x95, 0xE0, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x90, 0x97, 0x8B, 0x12, 0x04, 0x31, 0x90, 0x97, 0x8B, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x92, -0x18, 0x02, 0x04, 0x31, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xBB, 0xEC, 0x90, 0x99, -0xFF, 0x12, 0x04, 0x31, 0x90, 0x99, 0xFF, 0x31, 0x0B, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, -0x31, 0xD5, 0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x12, 0x8E, 0x29, 0x12, 0xB4, 0x41, 0x54, 0xFE, -0x31, 0xCF, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0x90, 0x01, -0x01, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, -0x98, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x12, 0x98, 0x37, 0x30, 0xE0, 0x35, -0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x90, 0x99, 0xFD, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, -0x99, 0xFD, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, 0x90, 0x99, 0xFE, 0xF0, -0x80, 0x06, 0x90, 0x99, 0xFE, 0x74, 0x02, 0xF0, 0x90, 0x99, 0xFD, 0x31, 0xB2, 0x12, 0x9A, 0x4F, -0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, -0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, 0x22, 0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, -0x7F, 0x02, 0x02, 0x7B, 0x2E, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFB, 0x90, -0x93, 0x43, 0xE0, 0x90, 0x92, 0x90, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, -0xF0, 0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0x31, 0xB2, 0x12, 0x9A, -0x4F, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x19, 0x90, 0x93, 0x08, 0xE0, 0x20, 0xE0, 0x12, 0x90, 0x86, -0x0C, 0x12, 0x8E, 0x2C, 0x90, 0x8A, 0xF9, 0x12, 0x8D, 0x12, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0x2F, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -0x90, 0x97, 0x2E, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xDC, 0x19, 0x90, 0x97, 0x31, 0xF0, 0x51, -0xF1, 0x90, 0x97, 0x2E, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x97, 0x2F, 0xE0, 0x60, 0x05, 0x51, -0xE3, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0xE0, 0x54, 0xC0, 0xF0, 0x51, 0xE3, 0x54, 0xC0, 0xF0, 0x90, 0x97, 0x31, 0xE0, 0xFF, 0xAE, 0x05, -0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, -0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, -0xAF, 0x05, 0x51, 0xD8, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x97, 0x30, 0xE0, 0x25, 0xE0, 0x25, 0xE0, -0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x51, 0xD8, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, 0x2F, 0x12, 0xCF, 0x99, 0xE0, 0x54, 0xF7, -0xF0, 0x74, 0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, -0x04, 0xAF, 0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -0xF5, 0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE0, -0xFF, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x95, 0xC5, 0x51, -0xEF, 0xAB, 0x05, 0x74, 0x01, 0x2B, 0x12, 0xC6, 0xAD, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, 0xC6, -0xF8, 0xB1, 0x7F, 0x90, 0x95, 0x63, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0x71, 0xF0, 0xFE, -0x74, 0x02, 0x2B, 0x71, 0xFD, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x65, 0xF0, 0xA3, 0xEF, -0xF0, 0x74, 0x05, 0x2B, 0x12, 0xCF, 0x91, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0x12, 0xCF, 0xBA, 0xE0, -0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x67, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, 0x71, -0xE7, 0xFE, 0x74, 0x06, 0x2B, 0x71, 0xDE, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x69, 0xF0, -0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, -0x08, 0x2B, 0x71, 0x81, 0x24, 0x00, 0xFF, 0xEC, 0x3E, 0x90, 0x95, 0x6B, 0xF0, 0xA3, 0xEF, 0xF0, -0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x93, 0x06, 0xF1, 0x8E, 0x12, -0xC6, 0xF8, 0xE0, 0x90, 0x98, 0x8B, 0xF0, 0x74, 0x01, 0x2F, 0x12, 0xC6, 0xAD, 0xE0, 0x90, 0x98, -0x8C, 0x71, 0xF9, 0x90, 0x98, 0x8D, 0xF0, 0x74, 0x03, 0x2F, 0x71, 0xF0, 0x90, 0x98, 0x8E, 0x12, -0xCF, 0xB6, 0xE0, 0x90, 0x98, 0x8F, 0xF0, 0x74, 0x05, 0x2F, 0x12, 0xCF, 0x91, 0xE0, 0x90, 0x98, -0x90, 0xF0, 0x74, 0x06, 0x2F, 0x71, 0xDE, 0x90, 0x98, 0x91, 0xF0, 0x74, 0x07, 0x2F, 0x71, 0xE7, -0x90, 0x98, 0x92, 0xF0, 0x74, 0x08, 0x2F, 0x71, 0x81, 0x90, 0x98, 0x93, 0xF0, 0x22, 0xF5, 0x82, -0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, 0x02, 0x2F, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x02, 0x09, -0xE0, 0xFD, 0x12, 0x97, 0x9A, 0x90, 0x93, 0x04, 0xF1, 0xBD, 0x12, 0xA7, 0x17, 0x54, 0x04, 0xFC, -0xEF, 0x54, 0xFB, 0x4C, 0xFF, 0x90, 0x93, 0x04, 0xF1, 0xA9, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, -0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0x90, 0x93, 0x04, 0x12, 0x8E, 0x13, 0xFF, 0xED, 0x2F, 0x90, -0x93, 0x05, 0x12, 0x8F, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0x06, 0xF0, 0x12, 0x8F, 0x13, 0xFF, -0xAE, 0x05, 0xED, 0x2F, 0x90, 0x93, 0x07, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, -0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x09, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x40, 0xF0, 0x71, -0x8A, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x30, 0xE0, 0x39, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x01, 0xF0, -0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF1, 0x97, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x08, -0x91, 0xC7, 0x90, 0x98, 0xA3, 0x74, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x12, -0xAF, 0xD0, 0x20, 0xE0, 0x0D, 0x90, 0x9A, 0x04, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x27, 0x10, 0x12, -0xBD, 0x98, 0x12, 0xAF, 0xD0, 0x30, 0xE0, 0x0A, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x02, 0xF0, 0x12, -0xC7, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE4, -0xFD, 0xFC, 0x90, 0x01, 0x1D, 0xE0, 0xFE, 0x90, 0x01, 0x1C, 0xB1, 0x7F, 0x90, 0x9A, 0x2C, 0xF0, -0xA3, 0xEF, 0xD1, 0x15, 0xE0, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x9A, 0x2E, 0xF0, 0xA3, 0xEF, -0xF0, 0xB1, 0x60, 0x90, 0x9A, 0x2C, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xB5, 0x07, 0x06, 0xEA, 0xB5, -0x06, 0x02, 0x80, 0x40, 0xB1, 0x60, 0xD3, 0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x0E, 0x90, 0x9A, 0x2D, -0xE0, 0x9F, 0xFD, 0x90, 0x9A, 0x2C, 0xE0, 0x9E, 0xFC, 0x80, 0x29, 0xB1, 0x60, 0xC3, 0x90, 0x9A, -0x2D, 0xE0, 0x9F, 0x90, 0x9A, 0x2C, 0xE0, 0x9E, 0x50, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, -0x90, 0x9A, 0x2F, 0xE0, 0x9F, 0xFF, 0x90, 0x9A, 0x2E, 0xE0, 0x9E, 0xFE, 0xC3, 0xE4, 0x9F, 0xFD, -0x74, 0x40, 0x9E, 0xFC, 0xD3, 0xED, 0x94, 0x00, 0xEC, 0x94, 0x38, 0x40, 0x02, 0xE1, 0x5C, 0xC3, -0xEC, 0x94, 0x08, 0x50, 0x0A, 0xED, 0x94, 0x00, 0xEC, 0x94, 0x00, 0x40, 0x02, 0x91, 0xC7, 0x22, -0x90, 0x9A, 0x2E, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x22, 0xD1, 0x16, 0x12, 0xCE, 0x56, 0x90, 0x97, 0x32, -0xF1, 0xA0, 0xF9, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x7A, 0xEC, 0xC3, 0x99, 0x50, 0x75, 0x90, -0x97, 0x32, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, -0xB1, 0x69, 0x54, 0x3F, 0x90, 0x97, 0x34, 0x12, 0xEF, 0x8B, 0x30, 0xE0, 0x09, 0xC3, 0x13, 0x20, -0xE0, 0x04, 0xF1, 0xDB, 0x80, 0x02, 0x7E, 0x00, 0xEE, 0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, 0x33, -0xCF, 0x2B, 0xCF, 0x34, 0x00, 0x90, 0x97, 0x34, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x97, 0x34, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xD1, 0x1F, 0x90, 0x97, 0x34, 0xEE, 0xF1, 0x7D, 0xF1, 0xCC, 0xD3, -0x90, 0x97, 0x33, 0xE0, 0x9F, 0x90, 0x97, 0x32, 0xE0, 0x9E, 0x40, 0x0F, 0x12, 0xEF, 0xB6, 0x90, -0x97, 0x33, 0xE0, 0x9F, 0xF0, 0x90, 0x97, 0x32, 0xE0, 0x9E, 0xF0, 0x90, 0x97, 0x32, 0x12, 0xE0, -0x51, 0x0C, 0x80, 0x86, 0x22, 0xF0, 0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0x7D, -0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0xD1, 0x36, 0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, -0x04, 0xD1, 0x36, 0x5F, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, -0xED, 0x22, 0x12, 0xE0, 0x64, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x42, 0xF0, 0x74, 0xD6, 0xA3, -0xF0, 0xED, 0x64, 0x01, 0x60, 0x1E, 0x12, 0x9F, 0x4B, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, -0x74, 0x40, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x41, 0xF0, 0x7F, -0x01, 0x02, 0xAA, 0x81, 0xB1, 0x88, 0x90, 0x02, 0x87, 0xE0, 0x70, 0xF8, 0x90, 0x06, 0x90, 0xE0, -0x44, 0x02, 0xF0, 0x74, 0x42, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD6, 0xA3, 0xF0, 0x22, 0xEF, -0x70, 0x02, 0xE1, 0x42, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE6, 0x1D, 0x90, 0x95, 0xEA, 0xE0, 0x54, -0xFE, 0xF0, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x07, 0x90, 0x01, 0x0C, 0xE0, 0x30, 0xE1, 0x45, -0x90, 0x01, 0xC7, 0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x95, 0xEA, 0xE0, 0x44, 0x01, 0xF0, 0x90, -0x06, 0x0F, 0xE0, 0x30, 0xE5, 0x10, 0x90, 0x01, 0x0C, 0xE0, 0x20, 0xE1, 0x09, 0x90, 0x95, 0xEA, -0xE0, 0x54, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x10, 0x90, 0x01, 0x0C, -0xE0, 0x30, 0xE1, 0x09, 0x90, 0x95, 0xEA, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xC7, -0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x95, 0xBB, 0xE0, 0xFF, 0x60, 0x02, 0xF1, 0x64, 0x90, 0x01, -0xC7, 0xE4, 0xF1, 0xB3, 0x12, 0xCE, 0x56, 0xF1, 0x75, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0xF0, -0x7B, 0x35, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, 0xC4, 0xCF, 0x90, 0x8A, 0xEF, 0x12, 0x8E, 0x2C, 0x91, -0xC7, 0xD1, 0x42, 0xF1, 0x5B, 0x90, 0x86, 0x0C, 0x12, 0x8E, 0x2C, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, -0x12, 0xC4, 0xCF, 0x12, 0xDD, 0xB9, 0x90, 0x01, 0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, -0x7C, 0x74, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x06, 0x90, 0xE0, 0x54, 0xF0, 0xF0, -0xF1, 0x5C, 0x12, 0xE0, 0x8D, 0x12, 0x97, 0x80, 0x02, 0x94, 0x61, 0x22, 0x90, 0x02, 0x86, 0xE0, -0x54, 0xFB, 0xF0, 0x22, 0xF1, 0x85, 0x12, 0xC7, 0x83, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, -0x79, 0x2F, 0x02, 0x69, 0xF5, 0x90, 0x88, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xF0, 0xA3, 0xEF, -0xF0, 0x90, 0x97, 0x32, 0x22, 0x12, 0x7B, 0x07, 0x7E, 0x00, 0x74, 0x00, 0x2F, 0x22, 0xE0, 0xFF, -0x12, 0x7B, 0x07, 0x74, 0x00, 0x2F, 0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, 0x54, 0x7F, 0xF0, 0x22, -0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, 0xE0, 0x22, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, -0xF7, 0x4E, 0x22, 0xF0, 0x90, 0x01, 0x17, 0xE0, 0xFE, 0x90, 0x01, 0x16, 0x22, 0xE0, 0x54, 0xFE, -0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0x22, 0xEE, 0x8F, 0xF0, 0x12, -0x02, 0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x74, 0x03, 0x2D, 0xF5, 0x82, -0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xFE, 0x22, 0xE4, 0x90, 0x9A, 0x38, 0xF0, 0xA3, -0xF0, 0x90, 0x05, 0xF8, 0xE0, 0x70, 0x0F, 0xA3, 0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, -0xE0, 0x70, 0x03, 0x7F, 0x01, 0x22, 0x12, 0xC1, 0x8B, 0x30, 0xE0, 0x15, 0xD3, 0x90, 0x9A, 0x39, -0xE0, 0x94, 0x03, 0x90, 0x9A, 0x38, 0xE0, 0x94, 0x00, 0x40, 0x02, 0x80, 0x13, 0x7F, 0x01, 0x80, -0x1B, 0xD3, 0x90, 0x9A, 0x39, 0xE0, 0x94, 0xE8, 0x90, 0x9A, 0x38, 0xE0, 0x94, 0x03, 0x40, 0x0A, -0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, -0x6A, 0x90, 0x9A, 0x38, 0x12, 0xC9, 0x1C, 0x80, 0xA8, 0x90, 0x05, 0x22, 0xEF, 0xF0, 0x90, 0x93, -0x01, 0xED, 0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, -0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, -0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, 0x04, 0xF0, -0x22, 0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xF0, 0x12, 0xCF, 0x63, 0x90, 0x01, 0x98, -0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, -0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x97, 0x2E, 0xF0, 0xA3, 0xF0, 0x11, 0x9B, -0xEF, 0x64, 0x01, 0x60, 0x3D, 0xC3, 0x90, 0x97, 0x2F, 0xE0, 0x94, 0x88, 0x90, 0x97, 0x2E, 0xE0, -0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, -0xF0, 0x80, 0x1F, 0x90, 0x97, 0x2E, 0x12, 0xC9, 0x1C, 0x12, 0xB4, 0x3A, 0xD3, 0x90, 0x97, 0x2F, -0xE0, 0x94, 0x32, 0x90, 0x97, 0x2E, 0xE0, 0x94, 0x00, 0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, -0xE3, 0xBC, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x0B, -0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, 0x10, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x8A, 0x75, 0x12, -0x8E, 0x2C, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, 0xCF, -0xE0, 0x90, 0x98, 0x7A, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, -0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, -0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, -0xFD, 0x7F, 0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x90, 0x8A, 0xE5, 0x12, 0x8D, 0x12, 0x7F, -0x80, 0x02, 0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x99, 0x90, 0xEC, 0xF0, -0xA3, 0xED, 0xF0, 0x90, 0x99, 0x8F, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, -0x99, 0x9A, 0x12, 0x04, 0x31, 0x90, 0x99, 0x92, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x99, -0x9A, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x99, 0x92, 0x12, 0x04, 0xB8, 0x90, 0x99, 0x96, 0x12, 0x85, 0xE2, 0x12, 0x85, 0xC8, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0x90, 0x99, 0x9E, 0x12, 0x04, 0x31, 0x90, -0x99, 0x90, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x99, 0x9E, 0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, -0x12, 0x04, 0x31, 0x90, 0x99, 0x8F, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x24, 0xEF, 0xF0, 0xED, 0x64, -0x01, 0x70, 0x2E, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, 0xF5, 0x14, 0x80, 0x08, 0x90, 0x9A, -0x24, 0xE0, 0x24, 0xFE, 0xF5, 0x14, 0x90, 0x99, 0x92, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, -0xAF, 0x14, 0x51, 0x54, 0x51, 0x4C, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x14, 0x80, -0x20, 0x90, 0x99, 0x92, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9A, 0x24, 0x12, 0xB5, -0xAF, 0x51, 0x58, 0x51, 0x4C, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9A, 0x24, 0xE0, -0xFF, 0x51, 0x54, 0x7F, 0x01, 0x31, 0x64, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0x31, 0x64, -0x90, 0x99, 0x92, 0x22, 0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x99, 0x96, 0x12, 0x04, 0x31, 0x7D, 0x18, -0x7C, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x9B, 0xE0, 0xFF, 0x71, -0x41, 0xEF, 0x60, 0x68, 0x90, 0x98, 0x9C, 0xE0, 0xFB, 0xD3, 0x94, 0x00, 0x40, 0x1A, 0x90, 0x99, -0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x0F, 0xAF, 0x03, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, 0xB7, -0xE7, 0x7F, 0x08, 0x7E, 0x0E, 0x12, 0xB7, 0x14, 0x90, 0x98, 0x9B, 0xE0, 0xFF, 0x90, 0x06, 0x33, -0xF0, 0x71, 0x29, 0xE4, 0xFB, 0xFD, 0x31, 0xE2, 0x90, 0x98, 0x9E, 0xE0, 0x60, 0x07, 0x90, 0x93, -0x05, 0xE0, 0xFF, 0x71, 0x6C, 0x90, 0x98, 0x9D, 0xE0, 0x90, 0x97, 0xB4, 0xF0, 0x90, 0x98, 0x88, -0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x12, 0xBF, 0x67, 0x90, 0x97, 0xB4, 0x12, 0xB5, 0xAF, 0x90, 0x9A, -0x04, 0x12, 0x04, 0x31, 0x12, 0xBF, 0xBB, 0x12, 0xBD, 0x9F, 0x80, 0x48, 0xE4, 0x90, 0x98, 0x88, -0xF0, 0x90, 0x99, 0x07, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xB7, 0x7C, 0xE4, -0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x13, 0x90, 0x98, 0xA0, 0xE0, 0xFD, 0x90, 0x8A, 0x89, 0x12, -0x8D, 0x12, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x7B, 0xAD, 0x90, 0x97, 0xB6, 0x74, 0x07, 0xF0, -0x90, 0x97, 0xD8, 0xF0, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xB6, 0x12, 0x8D, 0x00, 0x7F, 0x04, 0x12, -0x04, 0x7E, 0x71, 0x32, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x98, 0x93, 0xE0, 0x90, 0x9A, 0x27, -0xF0, 0x22, 0x90, 0x93, 0x04, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0xA0, 0x11, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x8B, 0xE0, 0xFE, 0x90, 0x98, 0x88, -0xE0, 0xC3, 0x9E, 0x40, 0x04, 0x7F, 0x00, 0x80, 0x0E, 0xEF, 0x60, 0x05, 0xD3, 0x94, 0x0E, 0x40, -0x04, 0x7F, 0x00, 0x80, 0x02, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xD9, 0xEF, 0xF0, 0x12, 0x76, 0x9B, 0xBF, 0x01, 0x1F, 0x90, 0x06, -0x32, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x97, 0xD9, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x07, 0x12, -0xC7, 0xCC, 0x90, 0x97, 0xDA, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xC1, 0xFD, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, 0xEF, 0xB4, 0x01, 0x0D, -0xEB, 0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, 0x02, 0xAF, 0x06, 0xEF, -0xC4, 0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0xC4, 0x74, 0xCA, 0xF0, -0x74, 0xDB, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0xCA, 0x04, -0x90, 0x01, 0xC4, 0xF0, 0x74, 0xDB, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x91, 0x19, 0x90, 0x9A, 0x47, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, -0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, -0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, -0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x91, 0x19, 0x90, 0x97, 0x2E, 0xF0, 0x90, 0x88, 0x32, 0x12, 0x8F, 0xDA, 0x30, 0xE0, 0x02, 0x81, -0xED, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x1D, 0x12, 0xA4, 0xF3, 0x33, 0x33, 0x33, 0x54, 0xF8, -0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, -0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, -0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, -0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, -0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, 0x91, 0xF9, 0x90, 0x88, 0x4E, 0xB1, 0x02, 0x40, -0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x91, 0xF9, 0x90, 0x88, 0x3E, 0xB1, 0x02, 0x40, -0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x12, 0x98, 0xE0, 0xFF, 0x7E, 0x00, 0x90, 0x88, -0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, -0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0xB1, 0x0D, 0x80, 0x07, 0x90, 0x88, 0x33, -0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, -0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x90, 0x88, 0x33, -0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x90, 0x97, 0x2E, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, -0x6C, 0xD1, 0x5B, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, -0x2F, 0xB1, 0xEF, 0xE0, 0xFE, 0x74, 0x28, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xB1, 0xB2, 0xB4, -0x04, 0xEC, 0x90, 0x9A, 0x29, 0x12, 0xB5, 0xAF, 0xD1, 0x64, 0x90, 0x9A, 0x28, 0x12, 0xB5, 0xAF, -0x12, 0x85, 0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9A, 0x2A, 0x12, 0xB5, -0xAF, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, -0xD5, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0xB5, 0xAF, 0x78, 0x18, 0x12, -0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x85, 0xD5, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0xB1, 0xDD, 0x74, -0x34, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0xB1, 0xDD, 0x74, -0x2E, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xB1, 0xB2, 0xB4, 0x06, 0xDF, 0x22, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, 0xF0, 0x22, 0xF5, -0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -0xAC, 0x06, 0xEF, 0xD1, 0x77, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, -0x03, 0x24, 0xC8, 0xB1, 0xEF, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, -0xFF, 0x7F, 0xFF, 0x80, 0x21, 0xD1, 0x5B, 0xB1, 0xE8, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, 0xB1, 0xEF, 0xE0, 0xFE, 0x74, 0xC8, 0x2D, 0xF5, 0x82, 0xE4, -0x34, 0x07, 0x12, 0xCE, 0x54, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, -0xEE, 0xA3, 0xF0, 0x22, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, -0x07, 0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, 0xD1, 0x79, 0xE4, 0xFB, -0x90, 0x9A, 0x0B, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, -0x74, 0xC4, 0x2B, 0xB1, 0xEF, 0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xE4, 0x90, 0x07, 0xC2, 0xF1, -0x77, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x40, 0xD1, 0x72, 0x7A, 0x00, 0x90, 0x9A, 0x41, 0xE0, 0x54, -0x03, 0xFB, 0x70, 0x0A, 0x90, 0x07, 0xC4, 0xD1, 0xFE, 0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, -0x02, 0x4A, 0x70, 0x15, 0x90, 0x07, 0xC6, 0xD1, 0xFE, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, -0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, -0xEC, 0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, -0x42, 0xD1, 0x72, 0xF1, 0x6D, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, -0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, -0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0xF1, 0x6D, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, -0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, -0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, -0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, -0x9A, 0x43, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, -0x97, 0x35, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0x2F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -0xE0, 0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x04, 0xB1, 0xB2, 0xB4, 0x08, 0xE7, 0x90, -0x95, 0x5F, 0xE0, 0x90, 0x04, 0x8C, 0xF0, 0x90, 0x95, 0x61, 0xE0, 0x90, 0x04, 0x8D, 0xF0, 0x75, -0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3E, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0x37, 0x12, 0x69, 0xF5, 0x90, 0x95, 0xCA, 0xE0, 0x60, 0x1F, 0x90, 0x97, 0x35, 0xE0, 0xFF, 0x12, -0x7B, 0x07, 0x7E, 0x00, 0x12, 0xCF, 0xAB, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x95, 0x75, 0x47, -0x2F, 0x75, 0x48, 0x34, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x22, 0x90, 0x95, 0xCC, 0xE0, 0x30, 0xE0, -0x37, 0x12, 0xA7, 0xE6, 0x64, 0x01, 0x70, 0x30, 0x90, 0x9A, 0x49, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, -0x0A, 0x0B, 0x90, 0x95, 0xCE, 0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x9A, 0x49, 0xF0, 0x90, 0x95, 0xCE, -0xE0, 0xFF, 0x90, 0x95, 0xCD, 0xE0, 0xD3, 0x9F, 0x50, 0x0E, 0x90, 0x95, 0xCF, 0xE0, 0x70, 0x08, -0xE4, 0x90, 0x95, 0xCE, 0xF0, 0x12, 0xCF, 0x71, 0x22, 0x12, 0x97, 0x9A, 0x90, 0x95, 0xCC, 0x11, -0x49, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, -0x07, 0x12, 0x8E, 0x14, 0x90, 0x95, 0xCD, 0xF0, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, -0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, -0x44, 0x01, 0xF0, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, 0x02, -0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, 0x7F, 0x02, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x11, 0x7A, 0x90, -0x95, 0xCA, 0xE0, 0xFF, 0x12, 0xDF, 0x7F, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, 0x86, 0xB3, -0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, -0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x0D, 0x90, -0x93, 0x27, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xEF, -0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, 0x02, 0x9F, -0x4B, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, 0x90, 0x95, 0xB9, 0x80, -0x03, 0x90, 0x95, 0xBA, 0xE0, 0x90, 0x95, 0x60, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x14, 0x60, 0x13, -0x14, 0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, -0xFE, 0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x90, 0x9A, 0x12, 0xED, 0xF0, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xF7, 0xE4, 0x90, 0x9A, 0x13, 0xF0, -0xA3, 0xF0, 0x12, 0x02, 0x06, 0xFF, 0x12, 0x8E, 0x14, 0xFD, 0x12, 0x8F, 0xE2, 0xFB, 0x71, 0x4E, -0x90, 0x9A, 0x13, 0xEF, 0xF0, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xEE, 0x12, 0x8F, 0xE2, 0xFF, 0x11, -0xE1, 0x90, 0x9A, 0x14, 0xEF, 0xF0, 0x90, 0x95, 0x60, 0xE0, 0x24, 0xFE, 0x60, 0x14, 0x24, 0xFE, -0x60, 0x10, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, 0x05, 0x70, 0x40, 0x51, 0xB8, 0x51, 0xC4, -0x80, 0x0C, 0x51, 0xB8, 0x90, 0x95, 0x60, 0xE0, 0x90, 0x99, 0xE6, 0xF0, 0x31, 0xAD, 0x90, 0x9A, -0x14, 0xE0, 0xFF, 0x90, 0x9A, 0x0F, 0x12, 0x85, 0xEE, 0x90, 0x9A, 0x13, 0xE0, 0x7C, 0x00, 0x29, -0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x45, 0x01, 0x75, -0x46, 0x95, 0x75, 0x47, 0x2F, 0xA3, 0xE0, 0xF5, 0x48, 0x12, 0x69, 0xF5, 0x22, 0x90, 0x99, 0xE2, -0x12, 0x85, 0xF7, 0x90, 0x99, 0xE6, 0xE0, 0xFE, 0x64, 0x04, 0x70, 0x0D, 0x51, 0x9F, 0x12, 0x02, -0x06, 0x90, 0x99, 0xE7, 0x12, 0x8E, 0x13, 0x80, 0x11, 0xEE, 0x64, 0x02, 0x70, 0x35, 0x51, 0x9F, -0x12, 0x8F, 0x1B, 0x90, 0x99, 0xE7, 0xF0, 0x12, 0x02, 0x06, 0x90, 0x99, 0xE8, 0xF0, 0x12, 0x8F, -0xE2, 0x90, 0x99, 0xE9, 0x12, 0x8E, 0x1B, 0x90, 0x99, 0xEA, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, -0x1F, 0x90, 0x99, 0xEB, 0xF0, 0x90, 0x00, 0x07, 0x12, 0x02, 0x1F, 0x90, 0x99, 0xEC, 0xF0, 0x12, -0x8F, 0x13, 0xFF, 0xED, 0x70, 0x19, 0xFE, 0x51, 0xA5, 0xE0, 0xB4, 0xFF, 0x06, 0x51, 0xA5, 0xE4, -0xF0, 0x80, 0x07, 0x51, 0xA5, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x06, 0xE8, 0x90, -0x99, 0xE6, 0xE0, 0xFE, 0xB4, 0x04, 0x18, 0xA3, 0xE0, 0xFD, 0x51, 0x9F, 0xED, 0x51, 0xB0, 0xFD, -0x51, 0x9F, 0x90, 0x00, 0x01, 0xED, 0x12, 0x02, 0x5E, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x20, 0xEE, -0xB4, 0x02, 0x1F, 0x90, 0x99, 0xE8, 0x51, 0x9D, 0xEE, 0x51, 0xB0, 0x44, 0x20, 0x54, 0x7F, 0x51, -0x9E, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x02, 0x5E, 0x90, 0x99, 0xE7, 0xE0, 0x90, 0x00, 0x02, 0x12, -0x02, 0x5E, 0x51, 0x9F, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x44, 0x20, -0x12, 0x02, 0x4C, 0x90, 0x99, 0xE9, 0x51, 0x9D, 0x90, 0x00, 0x04, 0xEE, 0x12, 0x02, 0x5E, 0x90, -0x99, 0xEA, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x02, 0x5E, 0x90, 0x99, 0xEB, 0xE0, 0x90, 0x00, 0x06, -0x12, 0x02, 0x5E, 0x90, 0x99, 0xEC, 0xE0, 0x90, 0x00, 0x07, 0x02, 0x02, 0x5E, 0xE0, 0xFE, 0x90, -0x99, 0xE2, 0x02, 0x85, 0xEE, 0x74, 0xE7, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, -0x12, 0x02, 0x4C, 0x90, 0x99, 0xE8, 0xE0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x2F, 0x90, 0x9A, -0x12, 0xE0, 0xFD, 0x22, 0x90, 0x99, 0xF2, 0xED, 0xF0, 0x90, 0x99, 0xEF, 0x12, 0x85, 0xF7, 0x12, -0x8F, 0x13, 0x90, 0x99, 0xF6, 0xF0, 0x90, 0x99, 0xEF, 0x12, 0xC3, 0xA6, 0x75, 0x48, 0x03, 0x7B, -0x01, 0x7A, 0x99, 0x79, 0xF3, 0x12, 0x69, 0xF5, 0x90, 0x99, 0xF2, 0xE0, 0x70, 0x2E, 0xFF, 0x71, -0x1D, 0xE0, 0xB4, 0xFF, 0x06, 0x71, 0x1D, 0xE4, 0xF0, 0x80, 0x07, 0x71, 0x1D, 0xE0, 0x04, 0xF0, -0x80, 0x05, 0x0F, 0xEF, 0xB4, 0x03, 0xE8, 0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, 0xF3, -0x75, 0x48, 0x03, 0x90, 0x99, 0xEF, 0x12, 0x85, 0xEE, 0x12, 0x69, 0xF5, 0x22, 0x74, 0xF3, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0x22, 0xA3, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0xE0, 0xFD, 0x74, 0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFE, -0xEF, 0x30, 0xE7, 0x04, 0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, 0xED, 0x30, 0xE6, 0x08, 0xAF, 0x03, -0x11, 0xE1, 0xAE, 0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, 0x2E, 0xFF, 0x22, 0x12, 0x7B, -0x07, 0x90, 0x97, 0x32, 0xE4, 0x12, 0xD7, 0x7D, 0x71, 0x28, 0x90, 0x97, 0x34, 0xEF, 0xF0, 0x90, -0x97, 0x32, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x06, -0x7B, 0x01, 0x7A, 0x93, 0x79, 0x49, 0x71, 0xD4, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x3E, -0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, -0x71, 0xD4, 0x71, 0xE1, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x06, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x53, -0x71, 0xD4, 0x12, 0xC6, 0xDE, 0x12, 0xC7, 0x87, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, -0x59, 0x02, 0x69, 0xF5, 0x12, 0x69, 0xF5, 0x90, 0x97, 0x32, 0x22, 0x12, 0x69, 0xF5, 0x90, 0x99, -0xBC, 0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x24, 0x42, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0xEF, 0x60, -0x07, 0x90, 0x95, 0xBC, 0xE0, 0xFF, 0x71, 0x6E, 0x22, 0x12, 0xD7, 0x85, 0x12, 0xC7, 0x83, 0x75, -0x48, 0x70, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x5D, 0x02, 0x69, 0xF5, 0xEF, 0x60, 0x07, 0x90, 0x95, -0xC1, 0xE0, 0xFF, 0x71, 0xF9, 0x22, 0x90, 0x97, 0xBA, 0x12, 0xCF, 0xA4, 0xED, 0xF0, 0x78, 0xBE, -0x7C, 0x97, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0xBA, 0x12, 0x9F, 0xB0, 0x90, 0x97, 0xBC, -0xE0, 0xFF, 0x90, 0x97, 0xBB, 0xE0, 0x2F, 0x91, 0xBF, 0x90, 0x97, 0xC2, 0xF0, 0xA3, 0xEF, 0xF0, -0x24, 0x06, 0xFF, 0xE4, 0x3E, 0x12, 0x9A, 0x7A, 0xEF, 0x64, 0x08, 0x70, 0x53, 0x90, 0x97, 0xC3, -0xE0, 0x24, 0x07, 0xFF, 0x90, 0x97, 0xC2, 0xE0, 0x34, 0x00, 0x12, 0x9A, 0x7A, 0xEF, 0x70, 0x40, -0x90, 0x97, 0xBD, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, 0x25, 0x90, 0x97, -0xC3, 0xE0, 0x24, 0x18, 0xFD, 0x90, 0x97, 0xC2, 0xE0, 0x12, 0x9A, 0x70, 0x90, 0x97, 0xBD, 0xE0, -0x24, 0xBE, 0xF5, 0x82, 0xE4, 0x34, 0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xBD, 0xE0, 0x04, -0xF0, 0x80, 0xD1, 0x78, 0xBE, 0x7C, 0x97, 0x91, 0xC8, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, -0x22, 0x90, 0x97, 0xB5, 0xED, 0x12, 0x9F, 0x53, 0x12, 0xAF, 0x0B, 0xEF, 0x60, 0x09, 0x12, 0x9A, -0x1F, 0x91, 0xB8, 0x60, 0x02, 0x7F, 0x01, 0x22, 0xA3, 0xE0, 0xFD, 0x91, 0x16, 0xEF, 0x22, 0xFF, -0x90, 0x97, 0xBA, 0xE0, 0x34, 0x00, 0xFE, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, -0x7E, 0x00, 0x7F, 0x04, 0x02, 0x87, 0xAC, 0xE4, 0xFE, 0xED, 0x30, 0xE1, 0x11, 0x90, 0x01, 0x3F, -0xE0, 0x30, 0xE2, 0x0A, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x0E, 0xED, 0x30, -0xE0, 0x24, 0xEF, 0x30, 0xE6, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0x7E, 0x01, 0xEF, 0x30, -0xE7, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x21, 0xF0, 0x7E, 0x01, 0xEF, 0x30, 0xE5, 0x08, 0x90, 0x01, -0xC7, 0x74, 0x23, 0xF0, 0x7E, 0x01, 0xAF, 0x06, 0x22, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x97, 0x32, -0xF0, 0x12, 0x02, 0x06, 0x90, 0x95, 0xB9, 0x12, 0x8E, 0x13, 0x90, 0x95, 0xBA, 0xF0, 0x22, 0xB1, -0x6B, 0x2E, 0x90, 0x95, 0xBB, 0x12, 0x8E, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBC, 0x12, 0x8F, -0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBD, 0xF0, 0x12, 0x8F, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, -0xBE, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xBF, 0x12, 0x8E, 0x1B, 0xFF, 0xED, -0x2F, 0x90, 0x95, 0xC0, 0xB1, 0xB4, 0x90, 0x95, 0xC1, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, -0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x22, 0xB1, 0x6B, 0x2E, 0x90, 0x95, 0xC2, 0x12, 0x8E, -0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC3, 0x12, 0x8F, 0x1A, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC4, -0xF0, 0x12, 0x8F, 0x13, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC5, 0xF0, 0x12, 0x8F, 0xE2, 0xFF, 0xED, -0x2F, 0x90, 0x95, 0xC6, 0x12, 0x8E, 0x1B, 0xFF, 0xED, 0x2F, 0x90, 0x95, 0xC7, 0xB1, 0xB4, 0x90, -0x95, 0xC8, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, 0x1F, 0xFF, 0xAE, 0x05, 0xED, 0x2F, -0x22, 0xB1, 0x6B, 0x2E, 0x90, 0x95, 0xC9, 0x12, 0x8E, 0x13, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, -0x95, 0xCA, 0xF0, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, 0x60, 0x3A, 0x90, 0x95, 0xBF, 0x12, 0xD2, 0xEF, -0x12, 0xCF, 0xAB, 0x12, 0xC3, 0x9D, 0x75, 0x48, 0x40, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xF5, 0x12, -0x69, 0xF5, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x54, 0x1E, 0x90, 0x95, 0xC0, 0xE0, 0x12, 0xCC, 0xB3, -0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x12, 0x77, 0xA4, 0x7D, 0x01, 0x7F, -0x03, 0x12, 0x54, 0x1E, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0xC1, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0xBA, 0xE0, 0xFF, 0xB4, 0x02, 0x07, 0xF1, 0x82, 0x74, 0x08, -0xF0, 0x80, 0x09, 0xEF, 0xB4, 0x04, 0x05, 0xF1, 0x82, 0x74, 0x10, 0xF0, 0x90, 0x97, 0xC1, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x64, 0x02, 0x4E, 0x60, 0x08, 0xEF, 0x64, 0x01, 0x4E, 0x60, 0x02, 0xE1, -0x75, 0x90, 0x94, 0x36, 0xE0, 0xFF, 0x64, 0xFE, 0x70, 0x02, 0xE1, 0x75, 0xEF, 0x64, 0x02, 0x60, -0x07, 0xEF, 0x64, 0x03, 0x60, 0x02, 0xE1, 0x75, 0x90, 0x94, 0x96, 0xF1, 0xB1, 0x90, 0x98, 0x4E, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x28, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x97, 0x79, -0xE4, 0x12, 0x04, 0x80, 0x7E, 0x00, 0x7F, 0x40, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x0C, -0x12, 0x04, 0x80, 0x90, 0x97, 0xC1, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x4D, 0x75, -0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x66, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, 0x98, 0x79, -0x50, 0x12, 0x97, 0x8C, 0x75, 0x46, 0x94, 0x75, 0x47, 0x05, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, -0x98, 0x79, 0x60, 0x12, 0x69, 0xF5, 0xF1, 0x93, 0x74, 0x20, 0xF1, 0x9D, 0x90, 0x8F, 0x3A, 0xF1, -0x7A, 0x90, 0x8F, 0x3D, 0xF1, 0x8A, 0x90, 0x8F, 0x40, 0xF0, 0x7A, 0x98, 0x79, 0x50, 0x12, 0x4C, -0x23, 0x75, 0x45, 0x01, 0x75, 0x46, 0x98, 0x75, 0x47, 0x0C, 0x80, 0x24, 0xF1, 0x93, 0x74, 0x10, -0xF1, 0x9D, 0x90, 0x91, 0x8C, 0xF1, 0x7A, 0x90, 0x91, 0x8F, 0xF1, 0x8A, 0x90, 0x91, 0x92, 0xF0, -0x7A, 0x94, 0x79, 0x05, 0x12, 0x61, 0x34, 0x75, 0x45, 0x01, 0x75, 0x46, 0x98, 0x75, 0x47, 0x14, -0x75, 0x48, 0x28, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xE4, 0x12, 0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, -0x46, 0x97, 0x75, 0x47, 0xEC, 0x75, 0x48, 0x20, 0x7B, 0x01, 0x7A, 0x97, 0x79, 0xC3, 0x12, 0x69, -0xF5, 0x90, 0x97, 0xEA, 0xE0, 0x54, 0x03, 0x90, 0x97, 0xE3, 0xF0, 0xC3, 0x94, 0x04, 0x50, 0x1C, -0xE0, 0x90, 0x95, 0x5F, 0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, 0x97, 0x75, 0x47, 0xC3, 0x75, 0x48, -0x20, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3F, 0x12, 0x69, 0xF5, 0x80, 0x06, 0x90, 0x95, 0x5F, 0x74, -0x05, 0xF0, 0x90, 0x97, 0xE3, 0xE0, 0xFF, 0x90, 0x95, 0xBA, 0xE0, 0xFD, 0x7B, 0x01, 0x7A, 0x97, -0x79, 0xC3, 0x12, 0x8F, 0x4E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x85, 0xF7, 0x7A, 0x98, 0x79, -0x0C, 0x22, 0x90, 0x98, 0x4C, 0x74, 0x80, 0xF0, 0xA3, 0x22, 0x12, 0x85, 0xF7, 0x90, 0x98, 0x4E, -0xA3, 0xE0, 0x22, 0x90, 0x98, 0x4E, 0xA3, 0xE0, 0xFB, 0x90, 0x92, 0x06, 0x22, 0xF0, 0xE4, 0xA3, -0xF0, 0xA3, 0xF0, 0xFD, 0xFC, 0xFF, 0xFE, 0x12, 0x71, 0xD4, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0x98, -0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, 0xFF, 0x22, 0x7F, 0x50, 0x7E, 0x0C, 0x12, 0x70, 0x70, -0x90, 0x98, 0x89, 0xEF, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x70, 0x70, 0x90, 0x98, 0x8A, 0xEF, -0xF0, 0x90, 0x99, 0xA4, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x99, 0xA8, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xB7, 0x06, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, -0x99, 0xA8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, 0x12, 0xB7, 0x10, 0x90, 0x06, 0x08, 0xE0, -0x90, 0x98, 0x9F, 0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, 0x90, 0x06, 0xA0, 0x12, 0xCE, 0x56, 0x90, -0x98, 0xA1, 0xF0, 0xA3, 0xEF, 0x12, 0xD7, 0x97, 0x90, 0x06, 0xA0, 0x74, 0x20, 0xF0, 0xA3, 0x74, -0x01, 0xF0, 0xE4, 0xFD, 0xFF, 0x02, 0xB5, 0xB6, 0x12, 0x9F, 0x54, 0x90, 0x98, 0x86, 0xE0, 0x64, -0x01, 0xF0, 0xE0, 0x24, 0x28, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xE8, 0xA3, 0xF0, 0x12, 0x9A, 0x1F, -0x90, 0x97, 0xB7, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x97, 0xB5, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -0xE4, 0x90, 0x97, 0xDB, 0xF0, 0xEF, 0x24, 0x24, 0xFF, 0xE4, 0x3E, 0xFE, 0xC0, 0x06, 0x51, 0x05, -0xF0, 0xD0, 0x06, 0xE4, 0xFB, 0xFA, 0x31, 0xE9, 0xF0, 0x4E, 0x60, 0x51, 0xE0, 0x24, 0x01, 0xFF, -0x90, 0x97, 0xDC, 0xE0, 0x34, 0x00, 0x12, 0x9A, 0x7A, 0x90, 0x97, 0xBA, 0xEF, 0xF0, 0xE4, 0x90, -0x97, 0xB9, 0xF0, 0x90, 0x97, 0xBA, 0xE0, 0xFF, 0x90, 0x97, 0xB9, 0xE0, 0xFE, 0xC3, 0x9F, 0x50, -0x2C, 0x90, 0x97, 0xDD, 0xE0, 0x24, 0x02, 0xFD, 0x90, 0x97, 0xDC, 0xE0, 0x34, 0x00, 0xFC, 0xEE, -0x7E, 0x00, 0x2D, 0x12, 0x9A, 0x77, 0x90, 0x97, 0xB9, 0xE0, 0x24, 0xBB, 0xF5, 0x82, 0xE4, 0x34, -0x97, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0xC6, 0x90, 0x97, 0xB6, -0xE0, 0x24, 0x24, 0xFF, 0x90, 0x97, 0xB5, 0xE0, 0x34, 0x00, 0xFE, 0xC0, 0x06, 0x51, 0x05, 0xF0, -0xD0, 0x06, 0x7B, 0x03, 0x7A, 0x00, 0xE4, 0x31, 0xE9, 0xF0, 0xE4, 0x90, 0x97, 0xB9, 0xF0, 0x90, -0x97, 0xB9, 0xE0, 0xFF, 0xC3, 0x94, 0x03, 0x50, 0x70, 0xA3, 0xE0, 0xFE, 0x60, 0x63, 0xEF, 0x75, -0xF0, 0x21, 0xA4, 0x24, 0xA4, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x6F, -0x70, 0x4F, 0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x97, 0xBA, 0xE0, 0xFF, 0x7E, 0x00, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x97, 0xB9, 0xE0, 0x75, 0xF0, 0x21, 0xA4, 0x24, 0xA5, 0xF9, 0x74, 0x98, -0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, 0xBB, 0x7C, 0x97, 0x7D, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, -0x87, 0xAC, 0xEF, 0x70, 0x1C, 0x90, 0x01, 0xC7, 0x74, 0x24, 0xF0, 0x7F, 0x01, 0x12, 0xAA, 0x81, -0x12, 0xAF, 0xD0, 0x30, 0xE0, 0x03, 0x12, 0xBF, 0x57, 0x12, 0x95, 0x43, 0xE4, 0xFF, 0x12, 0xA0, -0x11, 0x90, 0x97, 0xB9, 0xE0, 0x04, 0xF0, 0x80, 0x86, 0x22, 0x12, 0xCF, 0xA1, 0xED, 0xF0, 0xA3, -0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0xC3, 0x90, 0x97, 0xE6, 0xE0, 0x94, 0x01, 0x90, 0x97, 0xE5, 0xE0, -0x94, 0x00, 0x50, 0x02, 0x80, 0x6F, 0xE4, 0x90, 0x97, 0xE9, 0xF0, 0xA3, 0xF0, 0x31, 0xFC, 0x12, -0x9A, 0x7B, 0x90, 0x97, 0xE3, 0xE0, 0x70, 0x03, 0xA3, 0xE0, 0x6F, 0x70, 0x17, 0x90, 0x97, 0xE1, -0xE0, 0x24, 0x02, 0x31, 0xF4, 0xFE, 0x90, 0x97, 0xE2, 0xE0, 0xFD, 0x51, 0x19, 0xBF, 0x01, 0x02, -0x80, 0x5A, 0x80, 0x00, 0x90, 0x97, 0xE1, 0xE0, 0x24, 0x01, 0x31, 0xF4, 0x12, 0x9A, 0x7A, 0x7E, -0x00, 0x90, 0x97, 0xE7, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, 0x02, 0xFF, 0xEE, 0x33, 0xFE, 0x90, -0x97, 0xE0, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x97, 0xE9, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, -0x90, 0x97, 0xE5, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x90, 0x97, 0xEA, 0xE0, 0x9F, 0x90, 0x97, -0xE9, 0xE0, 0x9E, 0x40, 0x98, 0xE4, 0xFE, 0xFF, 0x22, 0xFD, 0x31, 0x5A, 0x90, 0x97, 0xDC, 0xEE, -0xF0, 0xA3, 0xEF, 0x22, 0xFF, 0x90, 0x97, 0xE0, 0xE0, 0x34, 0x00, 0x22, 0x90, 0x97, 0xE0, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x97, 0xB8, 0xE0, 0x24, 0xDC, 0xFE, 0x90, 0x97, 0xB7, 0xE0, -0x34, 0xFF, 0x90, 0x97, 0xE5, 0xF0, 0xA3, 0xCE, 0x22, 0xED, 0x14, 0x60, 0x06, 0x04, 0x70, 0x03, -0x7F, 0x01, 0x22, 0x7F, 0x01, 0x22, 0x12, 0x9F, 0x54, 0xA3, 0xED, 0xF0, 0x90, 0x95, 0x69, 0xE0, -0x70, 0x02, 0xA3, 0xE0, 0x60, 0x2D, 0xE4, 0x90, 0x97, 0xB6, 0xF0, 0x51, 0xC5, 0x50, 0x27, 0x12, -0x9A, 0x1F, 0x51, 0x77, 0x12, 0x9A, 0x4F, 0x90, 0x97, 0xB6, 0xE0, 0x24, 0x77, 0xF5, 0x82, 0xE4, -0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0x04, -0xF0, 0x80, 0xD8, 0x7F, 0x00, 0x22, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, 0x95, -0x75, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xED, 0x24, 0x1C, 0xFD, 0x90, 0x8A, 0xE9, 0x22, 0x12, -0x9F, 0x54, 0xA3, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x51, 0xC5, 0x50, 0x21, 0x12, 0x9A, 0x1F, 0x51, -0x77, 0x12, 0x9A, 0x4F, 0x90, 0x97, 0xB6, 0xE0, 0x24, 0x97, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -0x83, 0xE0, 0xB5, 0x07, 0x1D, 0x90, 0x97, 0xB6, 0xE0, 0x04, 0xF0, 0x80, 0xDB, 0x90, 0x06, 0x32, -0xE0, 0x44, 0x80, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, 0x01, 0x12, 0xAA, 0x81, 0x7F, -0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x97, 0xB6, 0xE0, 0xFD, 0xC3, 0x94, 0x02, 0x22, 0x12, 0x9F, -0x54, 0xE4, 0xA3, 0xF0, 0x90, 0x97, 0xB5, 0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x2C, 0x90, 0x97, -0xB4, 0xE0, 0x24, 0x10, 0x12, 0x9D, 0x64, 0xFE, 0x90, 0x8A, 0xE9, 0x12, 0x9A, 0x4F, 0x90, 0x97, -0xB5, 0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, -0x00, 0x22, 0x90, 0x97, 0xB5, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x7F, 0x01, 0x22, 0x12, 0x9F, 0x54, -0x24, 0x16, 0xFF, 0xE4, 0x3E, 0x12, 0x9A, 0x7A, 0x90, 0x95, 0x73, 0xA3, 0xE0, 0xB5, 0x07, 0x1E, -0x90, 0x97, 0xB4, 0xE0, 0x24, 0x16, 0x12, 0x9D, 0x64, 0xFE, 0x12, 0xAE, 0x40, 0x7D, 0x01, 0x12, -0x04, 0x7E, 0xEF, 0xFD, 0x90, 0x95, 0x73, 0xE0, 0x6D, 0x70, 0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, -0x22, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, -0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x15, 0x10, -0x80, 0x2D, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x15, 0x01, 0x80, 0x20, 0x90, -0x88, 0x31, 0x12, 0x98, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x15, 0x02, 0x80, 0x12, 0x90, 0x88, 0x38, -0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x15, 0x08, 0x80, 0x04, 0x71, 0xA2, 0x80, 0x0E, 0x90, -0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x15, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x08, 0xE0, 0xC3, 0x13, -0x20, 0xE0, 0x48, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, -0x3F, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x4C, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, 0x0B, 0x90, -0x02, 0x82, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x02, 0x80, 0x3A, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, -0x05, 0x75, 0x0F, 0x08, 0x80, 0x2E, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, -0x02, 0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x0F, 0x04, 0x80, 0x19, 0x90, 0x88, 0xE6, 0xE0, 0x30, -0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x40, -0x80, 0x02, 0x80, 0x8E, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x0F, 0xF0, -0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x16, 0x40, 0x81, 0xCC, 0x90, 0x88, 0x38, 0xE0, -0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, -0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x16, 0x01, 0x80, 0x70, 0x90, 0x88, 0x3A, 0xE0, -0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x16, 0x02, 0x80, 0x62, 0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, -0xC3, 0x9E, 0x50, 0x05, 0x75, 0x16, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x16, 0x08, -0x80, 0x4A, 0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x16, 0x10, 0x80, 0x3E, 0x90, 0x88, -0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x16, 0x20, 0x80, 0x2E, 0x90, 0x88, -0x9C, 0xE0, 0x60, 0x05, 0x75, 0x16, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, -0x75, 0x16, 0x11, 0x80, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, -0xBF, 0x80, 0x05, 0x75, 0x16, 0x12, 0x80, 0x04, 0x71, 0xA2, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, -0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x16, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x4A, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, -0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xC1, 0x54, 0xEE, 0x12, 0x8F, 0xDB, 0x30, 0xE0, -0x02, 0xC1, 0x54, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, 0xC1, 0x54, 0xEF, 0x70, 0x02, -0xA1, 0xB0, 0x24, 0xFE, 0x70, 0x02, 0xA1, 0xF8, 0x24, 0xFE, 0x60, 0x50, 0x24, 0xFC, 0x70, 0x02, -0xC1, 0x3F, 0x24, 0xFC, 0x60, 0x02, 0xC1, 0x4F, 0xEE, 0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, -0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, -0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x12, 0x90, 0x9A, 0x4A, 0xE0, 0xFF, -0x60, 0x05, 0x12, 0x67, 0x80, 0x80, 0x06, 0x90, 0x8A, 0xED, 0x12, 0x8E, 0x2C, 0x90, 0x88, 0x39, -0xE0, 0x64, 0x08, 0x60, 0x02, 0xC1, 0x4F, 0x12, 0x7B, 0xCC, 0xC1, 0x4F, 0x90, 0x88, 0x39, 0xE0, -0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, -0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, -0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xC1, 0x4F, 0x90, 0x86, -0x00, 0x12, 0x8E, 0x2C, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xC1, 0x4F, 0x12, 0x68, 0xC2, 0xC1, 0x4F, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, -0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, -0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x67, 0x90, 0x86, 0x02, 0x12, 0x8E, 0x2C, 0xEF, 0x64, -0x01, 0x70, 0x5C, 0x12, 0x73, 0x5A, 0x80, 0x57, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, -0x86, 0x00, 0x12, 0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, -0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x86, 0x00, 0x12, -0x8E, 0x2C, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, -0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0x97, 0xD5, 0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, -0x88, 0x39, 0xD1, 0x59, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x88, -0x38, 0xE0, 0x90, 0x01, 0xBB, 0xF0, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, -0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0xD1, 0xC2, 0x40, -0x40, 0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, -0xD3, 0x9F, 0x50, 0x2D, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0x9F, 0x5F, -0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, -0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, -0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x9F, 0x22, 0xE4, 0xFE, -0x12, 0xA3, 0x99, 0xE4, 0xF0, 0x74, 0x8B, 0x2E, 0x12, 0xA3, 0x91, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, -0xB4, 0xA0, 0xED, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, -0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0x90, 0x93, 0x08, 0xE0, -0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xA7, 0xED, 0x22, 0xF9, 0xE4, -0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x76, -0x12, 0x69, 0xF5, 0x90, 0x98, 0x70, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0x22, 0x90, 0x05, 0x63, 0xE0, -0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, 0xE0, -0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, 0xE0, -0x44, 0x80, 0xF0, 0x22, 0xFF, 0x90, 0x98, 0x75, 0xF0, 0x7B, 0x01, 0x7A, 0x98, 0x79, 0x76, 0x12, -0x8F, 0x21, 0x90, 0x98, 0x72, 0x12, 0x85, 0xEE, 0xE9, 0x22, 0xE0, 0xFF, 0x24, 0x10, 0xF5, 0x82, -0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x15, 0x2F, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, -0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, -0xF8, 0xFF, 0x90, 0x95, 0xEA, 0xE0, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, -0x82, 0x8E, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, 0x27, -0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, 0x54, -0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x98, 0xA0, 0xF0, -0x90, 0x8A, 0x89, 0x22, 0x7D, 0x01, 0x7E, 0x00, 0x7F, 0x10, 0x12, 0x87, 0xAC, 0xEF, 0x22, 0x7F, -0x84, 0x7E, 0x08, 0x12, 0xB7, 0x14, 0x90, 0x99, 0x92, 0x22, 0x90, 0x97, 0x32, 0x12, 0x85, 0xF7, -0x02, 0x02, 0x06, 0x54, 0x40, 0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x22, 0xF0, 0xEE, 0x54, 0x80, -0xFE, 0xEF, 0x54, 0x7F, 0x22, 0x90, 0x97, 0xCA, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x22, 0x90, 0x97, -0xCA, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x87, 0xAC, 0xEF, 0x22, -0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x22, -0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0x2C, 0xC0, -}; -u32 array_length_mp_8723d_fw_wowlan = 28778; - -#endif - -void -ODM_ReadFirmware_MP_8723D_FW_WoWLAN( - IN PDM_ODM_T pDM_Odm, - OUT u1Byte *pFirmware, - OUT u4Byte *pFirmwareSize -) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - *((SIZE_PTR *)pFirmware) = (SIZE_PTR)array_mp_8723d_fw_wowlan; -#else - ODM_MoveMemory(pDM_Odm, pFirmware, array_mp_8723d_fw_wowlan, array_length_mp_8723d_fw_wowlan); -#endif - *pFirmwareSize = array_length_mp_8723d_fw_wowlan; -} - - - -#endif /* end of (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP)))*/ - -#endif /* end of HWIMG_SUPPORT*/ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.h deleted file mode 100644 index 5fef7fbdbe27..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_fw.h +++ /dev/null @@ -1,62 +0,0 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.16*/ -#if (RTL8723D_SUPPORT == 1) -#ifndef __INC_MP_FW_HW_IMG_8723D_H -#define __INC_MP_FW_HW_IMG_8723D_H - - -/****************************************************************************** -* FW_AP.TXT -******************************************************************************/ - -void -ODM_ReadFirmware_MP_8723D_FW_AP( - IN PDM_ODM_T pDM_Odm, - OUT u1Byte *pFirmware, - OUT u4Byte *pFirmwareSize -); - -/****************************************************************************** -* FW_NIC.TXT -******************************************************************************/ - -void -ODM_ReadFirmware_MP_8723D_FW_NIC( - IN PDM_ODM_T pDM_Odm, - OUT u1Byte *pFirmware, - OUT u4Byte *pFirmwareSize -); - -/****************************************************************************** -* FW_WoWLAN.TXT -******************************************************************************/ - -void -ODM_ReadFirmware_MP_8723D_FW_WoWLAN( - IN PDM_ODM_T pDM_Odm, - OUT u1Byte *pFirmware, - OUT u4Byte *pFirmwareSize -); - -#endif -#endif /* end of HWIMG_SUPPORT*/ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.c index 7db88257e467..db42972ba955 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.c @@ -1,301 +1,301 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.26*/ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (RTL8723D_SUPPORT == 1) -static BOOLEAN -CheckPositive( - IN PDM_ODM_T pDM_Odm, - IN const u4Byte Condition1, - IN const u4Byte Condition2, - IN const u4Byte Condition3, - IN const u4Byte Condition4 -) -{ - u1Byte _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*/ - ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ - - u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; - - u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; - u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; - - u4Byte driver1 = cut_version_for_para << 24 | - (pDM_Odm->SupportInterface & 0xF0) << 16 | - pDM_Odm->SupportPlatform << 16 | - pkg_type_for_para << 12 | - (pDM_Odm->SupportInterface & 0x0F) << 8 | - _BoardType; - - u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | - (pDM_Odm->TypeGPA & 0xFF) << 8 | - (pDM_Odm->TypeALNA & 0xFF) << 16 | - (pDM_Odm->TypeAPA & 0xFF) << 24; - -u4Byte driver3 = 0; - - u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | - (pDM_Odm->TypeGPA & 0xFF00) | - (pDM_Odm->TypeALNA & 0xFF00) << 8 | - (pDM_Odm->TypeAPA & 0xFF00) << 16; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); - - 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] */ - - cond1 &= 0x00FF0FFF; - driver1 &= 0x00FF0FFF; - - if ((cond1 & driver1) == cond1) { - u4Byte 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)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ - return TRUE; - else - return FALSE; - } else - return FALSE; -} -static BOOLEAN -CheckNegative( - IN PDM_ODM_T pDM_Odm, - IN const u4Byte Condition1, - IN const u4Byte Condition2 -) -{ - return TRUE; -} - -/****************************************************************************** -* MAC_REG.TXT -******************************************************************************/ - -u4Byte Array_MP_8723D_MAC_REG[] = { - 0x020, 0x00000013, - 0x02F, 0x00000010, - 0x077, 0x00000007, - 0x421, 0x0000000F, - 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, 0x00000028, - 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, 0x00000028, - 0x63C, 0x0000000A, - 0x63D, 0x0000000A, - 0x63E, 0x0000000C, - 0x63F, 0x0000000C, - 0x640, 0x00000040, - 0x642, 0x00000040, - 0x643, 0x00000000, - 0x652, 0x000000C8, - 0x66A, 0x000000B0, - 0x66E, 0x00000005, - 0x700, 0x00000021, - 0x701, 0x00000043, - 0x702, 0x00000065, - 0x703, 0x00000087, - 0x708, 0x00000021, - 0x709, 0x00000043, - 0x70A, 0x00000065, - 0x70B, 0x00000087, - 0x765, 0x00000018, - 0x76E, 0x00000004, - 0x7C0, 0x00000038, - 0x7C2, 0x0000000F, - 0x7C3, 0x000000C0, - 0x073, 0x00000004, - 0x7C4, 0x00000077, - 0x07C, 0x00000003, - 0x016, 0x000000B3, - -}; - -void -ODM_ReadAndConfig_MP_8723D_MAC_REG( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte i = 0; - u1Byte cCond; - BOOLEAN bMatched = TRUE, bSkipped = FALSE; - u4Byte ArrayLen = sizeof(Array_MP_8723D_MAC_REG)/sizeof(u4Byte); - pu4Byte Array = Array_MP_8723D_MAC_REG; - - u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_MAC_REG\n")); - - while ((i + 1) < ArrayLen) { - v1 = Array[i]; - v2 = Array[i + 1]; - - if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ - if (v1 & BIT31) {/* positive condition*/ - cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); - if (cCond == COND_ENDIF) {/*end*/ - bMatched = TRUE; - bSkipped = FALSE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); - } else if (cCond == COND_ELSE) { /*else*/ - bMatched = bSkipped?FALSE:TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); - } else {/*if , else if*/ - pre_v1 = v1; - pre_v2 = v2; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); - } - } else if (v1 & BIT30) { /*negative condition*/ - if (bSkipped == FALSE) { - if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { - bMatched = TRUE; - bSkipped = TRUE; - } else { - bMatched = FALSE; - bSkipped = FALSE; - } - } else - bMatched = FALSE; - } - } else { - if (bMatched) - odm_ConfigMAC_8723D(pDM_Odm, v1, (u1Byte)v2); - } - i = i + 2; - } -} - -u4Byte -ODM_GetVersion_MP_8723D_MAC_REG(void) -{ - return 31; -} - -#endif /* end of HWIMG_SUPPORT*/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +/*Image2HeaderVersion: 3.5.2*/ +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (RTL8723D_SUPPORT == 1) +static boolean +check_positive( + struct PHY_DM_STRUCT *p_dm, + const u32 condition1, + const u32 condition2, + const u32 condition3, + const u32 condition4 +) +{ + u8 _board_type = ((p_dm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ + ((p_dm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ + ((p_dm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ + ((p_dm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ + ((p_dm->board_type & BIT(2)) >> 2) << 4 | /* _BT*/ + ((p_dm->board_type & BIT(1)) >> 1) << 5 | /* _NGFF*/ + ((p_dm->board_type & BIT(5)) >> 5) << 6; /* _TRSWT*/ + + u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; + + u8 cut_version_for_para = (p_dm->cut_version == ODM_CUT_A) ? 15 : p_dm->cut_version; + u8 pkg_type_for_para = (p_dm->package_type == 0) ? 15 : p_dm->package_type; + + u32 driver1 = cut_version_for_para << 24 | + (p_dm->support_interface & 0xF0) << 16 | + p_dm->support_platform << 16 | + pkg_type_for_para << 12 | + (p_dm->support_interface & 0x0F) << 8 | + _board_type; + + u32 driver2 = (p_dm->type_glna & 0xFF) << 0 | + (p_dm->type_gpa & 0xFF) << 8 | + (p_dm->type_alna & 0xFF) << 16 | + (p_dm->type_apa & 0xFF) << 24; + + u32 driver3 = 0; + + u32 driver4 = (p_dm->type_glna & 0xFF00) >> 8 | + (p_dm->type_gpa & 0xFF00) | + (p_dm->type_alna & 0xFF00) << 8 | + (p_dm->type_apa & 0xFF00) << 16; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===> check_positive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===> check_positive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + (" (Platform, Interface) = (0x%X, 0x%X)\n", p_dm->support_platform, p_dm->support_interface)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + (" (Board, Package) = (0x%X, 0x%X)\n", p_dm->board_type, p_dm->package_type)); + + + /*============== 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] */ + + cond1 &= 0x00FF0FFF; + driver1 &= 0x00FF0FFF; + + if ((cond1 & driver1) == cond1) { + u32 bit_mask = 0; + + if ((cond1 & 0x0F) == 0) /* board_type is DONTCARE*/ + return true; + + if ((cond1 & BIT(0)) != 0) /*GLNA*/ + bit_mask |= 0x000000FF; + if ((cond1 & BIT(1)) != 0) /*GPA*/ + bit_mask |= 0x0000FF00; + if ((cond1 & BIT(2)) != 0) /*ALNA*/ + bit_mask |= 0x00FF0000; + if ((cond1 & BIT(3)) != 0) /*APA*/ + bit_mask |= 0xFF000000; + + if (((cond2 & bit_mask) == (driver2 & bit_mask)) && ((cond4 & bit_mask) == (driver4 & bit_mask))) /* board_type of each RF path is matched*/ + return true; + else + return false; + } else + return false; +} +static boolean +check_negative( + struct PHY_DM_STRUCT *p_dm, + const u32 condition1, + const u32 condition2 +) +{ + return true; +} + +/****************************************************************************** +* mac_reg.TXT +******************************************************************************/ + +u32 array_mp_8723d_mac_reg[] = { + 0x020, 0x00000013, + 0x02F, 0x00000010, + 0x077, 0x00000007, + 0x421, 0x0000000F, + 0x428, 0x0000000A, + 0x429, 0x00000010, + 0x430, 0x00000000, + 0x431, 0x00000000, + 0x432, 0x00000000, + 0x433, 0x00000001, + 0x434, 0x00000002, + 0x435, 0x00000003, + 0x436, 0x00000005, + 0x437, 0x00000007, + 0x438, 0x00000000, + 0x439, 0x00000000, + 0x43A, 0x00000000, + 0x43B, 0x00000001, + 0x43C, 0x00000002, + 0x43D, 0x00000003, + 0x43E, 0x00000005, + 0x43F, 0x00000007, + 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, 0x00000028, + 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, 0x00000028, + 0x63C, 0x0000000A, + 0x63D, 0x0000000A, + 0x63E, 0x0000000C, + 0x63F, 0x0000000C, + 0x640, 0x00000040, + 0x642, 0x00000040, + 0x643, 0x00000000, + 0x652, 0x000000C8, + 0x66A, 0x000000B0, + 0x66E, 0x00000005, + 0x700, 0x00000021, + 0x701, 0x00000043, + 0x702, 0x00000065, + 0x703, 0x00000087, + 0x708, 0x00000021, + 0x709, 0x00000043, + 0x70A, 0x00000065, + 0x70B, 0x00000087, + 0x765, 0x00000018, + 0x76E, 0x00000004, + 0x7C0, 0x00000038, + 0x7C2, 0x0000000F, + 0x7C3, 0x000000C0, + 0x073, 0x00000004, + 0x7C4, 0x00000077, + 0x07C, 0x00000003, + 0x016, 0x000000B3, + +}; + +void +odm_read_and_config_mp_8723d_mac_reg( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8723d_mac_reg)/sizeof(u32); + u32 *array = array_mp_8723d_mac_reg; + + u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_read_and_config_mp_8723d_mac_reg\n")); + + while ((i + 1) < array_len) { + v1 = array[i]; + v2 = array[i + 1]; + + if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ + if (v1 & BIT(31)) {/* positive condition*/ + c_cond = (u8)((v1 & (BIT(29)|BIT(28))) >> 28); + if (c_cond == COND_ENDIF) {/*end*/ + is_matched = true; + is_skipped = false; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ENDIF\n")); + } else if (c_cond == COND_ELSE) { /*else*/ + is_matched = is_skipped?false:true; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ELSE\n")); + } else {/*if , else if*/ + pre_v1 = v1; + pre_v2 = v2; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("IF or ELSE IF\n")); + } + } else if (v1 & BIT(30)) { /*negative condition*/ + if (is_skipped == false) { + if (check_positive(p_dm, pre_v1, pre_v2, v1, v2)) { + is_matched = true; + is_skipped = true; + } else { + is_matched = false; + is_skipped = false; + } + } else + is_matched = false; + } + } else { + if (is_matched) + odm_config_mac_8723d(p_dm, v1, (u8)v2); + } + i = i + 2; + } +} + +u32 +odm_get_version_mp_8723d_mac_reg(void) +{ + return 36; +} + +#endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.h index b847cfdb8779..99236a7c8994 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_mac.h @@ -1,39 +1,34 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.26*/ -#if (RTL8723D_SUPPORT == 1) -#ifndef __INC_MP_MAC_HW_IMG_8723D_H -#define __INC_MP_MAC_HW_IMG_8723D_H - - -/****************************************************************************** -* MAC_REG.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_MAC_REG(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_MAC_REG(void); - -#endif -#endif /* end of HWIMG_SUPPORT*/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +/*Image2HeaderVersion: 3.5.2*/ +#if (RTL8723D_SUPPORT == 1) +#ifndef __INC_MP_MAC_HW_IMG_8723D_H +#define __INC_MP_MAC_HW_IMG_8723D_H + + +/****************************************************************************** +* mac_reg.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_mac_reg(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_mac_reg(void); + +#endif +#endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.c index 8094080c10b2..34f53978db85 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.c @@ -1,1199 +1,1200 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.26*/ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (RTL8723D_SUPPORT == 1) -static BOOLEAN -CheckPositive( - IN PDM_ODM_T pDM_Odm, - IN const u4Byte Condition1, - IN const u4Byte Condition2, - IN const u4Byte Condition3, - IN const u4Byte Condition4 -) -{ - u1Byte _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*/ - ((pDM_Odm->BoardType & BIT1) >> 1) << 5; /* _NGFF*/ - - u4Byte cond1 = Condition1, cond2 = Condition2, cond3 = Condition3, cond4 = Condition4; - - u1Byte cut_version_for_para = (pDM_Odm->CutVersion == ODM_CUT_A) ? 15 : pDM_Odm->CutVersion; - u1Byte pkg_type_for_para = (pDM_Odm->PackageType == 0) ? 15 : pDM_Odm->PackageType; - - u4Byte driver1 = cut_version_for_para << 24 | - (pDM_Odm->SupportInterface & 0xF0) << 16 | - pDM_Odm->SupportPlatform << 16 | - pkg_type_for_para << 12 | - (pDM_Odm->SupportInterface & 0x0F) << 8 | - _BoardType; - - u4Byte driver2 = (pDM_Odm->TypeGLNA & 0xFF) << 0 | - (pDM_Odm->TypeGPA & 0xFF) << 8 | - (pDM_Odm->TypeALNA & 0xFF) << 16 | - (pDM_Odm->TypeAPA & 0xFF) << 24; - -u4Byte driver3 = 0; - - u4Byte driver4 = (pDM_Odm->TypeGLNA & 0xFF00) >> 8 | - (pDM_Odm->TypeGPA & 0xFF00) | - (pDM_Odm->TypeALNA & 0xFF00) << 8 | - (pDM_Odm->TypeAPA & 0xFF00) << 16; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> CheckPositive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_TRACE, - ("===> CheckPositive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); - - 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] */ - - cond1 &= 0x00FF0FFF; - driver1 &= 0x00FF0FFF; - - if ((cond1 & driver1) == cond1) { - u4Byte 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)) && ((cond4 & bitMask) == (driver4 & bitMask))) /* BoardType of each RF path is matched*/ - return TRUE; - else - return FALSE; - } else - return FALSE; -} -static BOOLEAN -CheckNegative( - IN PDM_ODM_T pDM_Odm, - IN const u4Byte Condition1, - IN const u4Byte Condition2 -) -{ - return TRUE; -} - -/****************************************************************************** -* RadioA.TXT -******************************************************************************/ - -u4Byte Array_MP_8723D_RadioA[] = { - 0x050, 0x00019000, - 0x000, 0x00010000, - 0x0B1, 0x00054573, - 0x0B4, 0x000508AB, - 0x0B7, 0x00014787, - 0x0B8, 0x000064CB, - 0x01B, 0x00073A40, - 0x051, 0x00038CAF, - 0x052, 0x000FCCA3, - 0x053, 0x00090F38, - 0x054, 0x00011083, - 0x057, 0x000D0000, - 0x08D, 0x00000A1A, - 0x082, 0x00082AAC, - 0x08E, 0x00076940, - 0x08F, 0x00088400, - 0x061, 0x00038CAF, - 0x062, 0x000FCCA3, - 0x063, 0x00090F38, - 0x064, 0x00011083, - 0x067, 0x000D0000, - 0x092, 0x00082AAC, - 0x0EF, 0x00000400, - 0x030, 0x000008CA, - 0x030, 0x000018CF, - 0x030, 0x000028CA, - 0x030, 0x000038CA, - 0x0EF, 0x00000000, - 0x0EE, 0x00000400, - 0x030, 0x000008CA, - 0x030, 0x000018CF, - 0x030, 0x000028CA, - 0x030, 0x000038CA, - 0x0EE, 0x00000000, - 0x0EF, 0x00000100, - 0x033, 0x00000000, - 0x03F, 0x0000CCA3, - 0x033, 0x00000001, - 0x03F, 0x0000CCA3, - 0x033, 0x00000002, - 0x03F, 0x0000CCA3, - 0x033, 0x00000003, - 0x03F, 0x0000CCA3, - 0x033, 0x00000004, - 0x03F, 0x0000CCA3, - 0x033, 0x00000005, - 0x03F, 0x0000CCA3, - 0x033, 0x00000006, - 0x03F, 0x0000CCA3, - 0x033, 0x00000007, - 0x03F, 0x0000CCA3, - 0x0EF, 0x00000000, - 0x0EE, 0x00000100, - 0x033, 0x00000000, - 0x03F, 0x0000CCA3, - 0x033, 0x00000001, - 0x03F, 0x0000CCA3, - 0x033, 0x00000002, - 0x03F, 0x0000CCA3, - 0x033, 0x00000003, - 0x03F, 0x0000CCA3, - 0x033, 0x00000004, - 0x03F, 0x0000CCA3, - 0x033, 0x00000005, - 0x03F, 0x0000CCA3, - 0x033, 0x00000006, - 0x03F, 0x0000CCA3, - 0x033, 0x00000007, - 0x03F, 0x0000CCA3, - 0x0EE, 0x00000000, - 0x0EF, 0x00000800, - 0x030, 0x0000002D, - 0x030, 0x0000122C, - 0x030, 0x0000222F, - 0x030, 0x0000326C, - 0x030, 0x0000466B, - 0x030, 0x0000566E, - 0x030, 0x000066EB, - 0x030, 0x000077EC, - 0x030, 0x000087EF, - 0x030, 0x000097F2, - 0x030, 0x0000A7F5, - 0x0EF, 0x00000000, - 0x0EE, 0x00000800, - 0x030, 0x00000001, - 0x030, 0x00001011, - 0x030, 0x00002011, - 0x030, 0x00003013, - 0x030, 0x00004033, - 0x030, 0x00005033, - 0x030, 0x00006037, - 0x030, 0x0000703F, - 0x030, 0x0000803F, - 0x030, 0x0000903F, - 0x030, 0x0000A03F, - 0x0EE, 0x00000000, - 0x082, 0x00083B8C, - 0x0ED, 0x00000008, - 0x030, 0x000030F6, - 0x030, 0x00002004, - 0x030, 0x000010F6, - 0x030, 0x000000F6, - 0x0ED, 0x00000000, - 0x092, 0x00083B8C, - 0x0EC, 0x00000008, - 0x030, 0x000030F6, - 0x030, 0x00002004, - 0x030, 0x000010F6, - 0x030, 0x000000F6, - 0x0EC, 0x00000000, - 0x0EF, 0x00010000, - 0x030, 0x0001C11C, - 0x030, 0x000181F4, - 0x030, 0x00014108, - 0x030, 0x000101E4, - 0x030, 0x0000C11C, - 0x030, 0x000081F4, - 0x030, 0x00004108, - 0x030, 0x000001E4, - 0x0EF, 0x00000000, - 0x0EE, 0x00010000, - 0x030, 0x0001C11C, - 0x030, 0x000181F4, - 0x030, 0x00014108, - 0x030, 0x000101E4, - 0x030, 0x0000C11C, - 0x030, 0x000081F4, - 0x030, 0x00004108, - 0x030, 0x000001E4, - 0x0EE, 0x00000000, - 0x0EF, 0x00080000, - 0x033, 0x00000007, - 0x03E, 0x0000005F, - 0x03F, 0x000B3FDB, - 0x033, 0x00000004, - 0x03E, 0x0000005D, - 0x03F, 0x000BFFE0, - 0x033, 0x00000005, - 0x03E, 0x0000005D, - 0x03F, 0x000FBFCE, - 0x033, 0x00000006, - 0x03E, 0x0000005F, - 0x03F, 0x000A7FFB, - 0x0EF, 0x00000000, - 0x0EE, 0x00000002, - 0x030, 0x00000001, - 0x030, 0x00002001, - 0x030, 0x00004001, - 0x030, 0x00007001, - 0x030, 0x00006001, - 0x030, 0x00020001, - 0x030, 0x00022001, - 0x030, 0x00024001, - 0x030, 0x00027001, - 0x030, 0x00026001, - 0x030, 0x00034001, - 0x030, 0x00037001, - 0x030, 0x00036001, - 0x030, 0x00008000, - 0x030, 0x0000A000, - 0x030, 0x0000C000, - 0x030, 0x0000E000, - 0x030, 0x0001C000, - 0x030, 0x0001E000, - 0x0EE, 0x00000000, - 0x0EE, 0x00020000, - 0x0EF, 0x00020000, - 0x030, 0x00000F75, - 0x030, 0x00002F55, - 0x030, 0x00003F75, - 0x0EE, 0x00000000, - 0x0EF, 0x00000000, - 0x018, 0x00008401, - 0xFFE, 0x00000000, - -}; - -void -ODM_ReadAndConfig_MP_8723D_RadioA( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte i = 0; - u1Byte cCond; - BOOLEAN bMatched = TRUE, bSkipped = FALSE; - u4Byte ArrayLen = sizeof(Array_MP_8723D_RadioA)/sizeof(u4Byte); - pu4Byte Array = Array_MP_8723D_RadioA; - - u4Byte v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_RadioA\n")); - - while ((i + 1) < ArrayLen) { - v1 = Array[i]; - v2 = Array[i + 1]; - - if (v1 & (BIT31 | BIT30)) {/*positive & negative condition*/ - if (v1 & BIT31) {/* positive condition*/ - cCond = (u1Byte)((v1 & (BIT29|BIT28)) >> 28); - if (cCond == COND_ENDIF) {/*end*/ - bMatched = TRUE; - bSkipped = FALSE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ENDIF\n")); - } else if (cCond == COND_ELSE) { /*else*/ - bMatched = bSkipped?FALSE:TRUE; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("ELSE\n")); - } else {/*if , else if*/ - pre_v1 = v1; - pre_v2 = v2; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("IF or ELSE IF\n")); - } - } else if (v1 & BIT30) { /*negative condition*/ - if (bSkipped == FALSE) { - if (CheckPositive(pDM_Odm, pre_v1, pre_v2, v1, v2)) { - bMatched = TRUE; - bSkipped = TRUE; - } else { - bMatched = FALSE; - bSkipped = FALSE; - } - } else - bMatched = FALSE; - } - } else { - if (bMatched) - odm_ConfigRF_RadioA_8723D(pDM_Odm, v1, v2); - } - i = i + 2; - } -} - -u4Byte -ODM_GetVersion_MP_8723D_RadioA(void) -{ - return 31; -} - -/****************************************************************************** -* TxPowerTrack_PCIE.TXT -******************************************************************************/ - -#if DEV_BUS_TYPE == RT_PCI_INTERFACE -u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -}; -u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -#endif - -void -ODM_ReadAndConfig_MP_8723D_TxPowerTrack_PCIE( - IN PDM_ODM_T pDM_Odm -) -{ -#if DEV_BUS_TYPE == RT_PCI_INTERFACE - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); - - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE); - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_PCIE_8723D, DELTA_SWINGIDX_SIZE*3); -#endif -} - -/****************************************************************************** -* TxPowerTrack_SDIO.TXT -******************************************************************************/ - -#if DEV_BUS_TYPE == RT_SDIO_INTERFACE -u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -}; -u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -#endif - -void -ODM_ReadAndConfig_MP_8723D_TxPowerTrack_SDIO( - IN PDM_ODM_T pDM_Odm -) -{ -#if DEV_BUS_TYPE == RT_SDIO_INTERFACE - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); - - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE); - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_SDIO_8723D, DELTA_SWINGIDX_SIZE*3); -#endif -} - -/****************************************************************************** -* TxPowerTrack_USB.TXT -******************************************************************************/ - -#if DEV_BUS_TYPE == RT_USB_INTERFACE -u1Byte gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, - {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, -}; -u1Byte gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8723D[][DELTA_SWINGIDX_SIZE] = { - {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, - {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, -}; -u1Byte gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8723D[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; -u1Byte gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8723D[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; -#endif - -void -ODM_ReadAndConfig_MP_8723D_TxPowerTrack_USB( - IN PDM_ODM_T pDM_Odm -) -{ -#if DEV_BUS_TYPE == RT_USB_INTERFACE - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); - - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P, gDeltaSwingTableIdx_MP_2GA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N, gDeltaSwingTableIdx_MP_2GA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P, gDeltaSwingTableIdx_MP_2GB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N, gDeltaSwingTableIdx_MP_2GB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P, gDeltaSwingTableIdx_MP_2GCCKA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N, gDeltaSwingTableIdx_MP_2GCCKA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P, gDeltaSwingTableIdx_MP_2GCCKB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N, gDeltaSwingTableIdx_MP_2GCCKB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE); - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_P, gDeltaSwingTableIdx_MP_5GA_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GA_N, gDeltaSwingTableIdx_MP_5GA_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_P, gDeltaSwingTableIdx_MP_5GB_P_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableIdx_5GB_N, gDeltaSwingTableIdx_MP_5GB_N_TxPowerTrack_USB_8723D, DELTA_SWINGIDX_SIZE*3); -#endif -} - -/****************************************************************************** -* TXPWR_LMT.TXT -******************************************************************************/ - -const char *Array_MP_8723D_TXPWR_LMT[] = { - "FCC", "2.4G", "20M", "CCK", "1T", "01", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "01", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "01", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "02", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "02", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "02", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "03", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "03", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "03", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "04", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "04", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "04", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "05", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "05", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "05", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "06", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "06", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "06", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "07", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "07", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "07", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "08", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "08", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "08", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "09", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "09", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "09", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "10", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "10", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "10", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "11", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "11", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "11", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "12", "30", - "ETSI", "2.4G", "20M", "CCK", "1T", "12", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "12", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "13", "17", - "ETSI", "2.4G", "20M", "CCK", "1T", "13", "30", - "MKK", "2.4G", "20M", "CCK", "1T", "13", "30", - "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", - "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", - "MKK", "2.4G", "20M", "CCK", "1T", "14", "30", - "FCC", "2.4G", "20M", "OFDM", "1T", "01", "26", - "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "01", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "02", "28", - "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "02", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "03", "30", - "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "03", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "04", "30", - "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "04", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "05", "30", - "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "05", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "06", "30", - "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "06", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "07", "30", - "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "07", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "08", "30", - "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "08", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", - "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "09", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "10", "28", - "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "10", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "11", "26", - "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "11", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "12", "24", - "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "12", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "13", "14", - "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "31", - "MKK", "2.4G", "20M", "OFDM", "1T", "13", "31", - "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", - "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", - "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", - "FCC", "2.4G", "20M", "HT", "1T", "01", "24", - "ETSI", "2.4G", "20M", "HT", "1T", "01", "31", - "MKK", "2.4G", "20M", "HT", "1T", "01", "31", - "FCC", "2.4G", "20M", "HT", "1T", "02", "26", - "ETSI", "2.4G", "20M", "HT", "1T", "02", "31", - "MKK", "2.4G", "20M", "HT", "1T", "02", "31", - "FCC", "2.4G", "20M", "HT", "1T", "03", "30", - "ETSI", "2.4G", "20M", "HT", "1T", "03", "31", - "MKK", "2.4G", "20M", "HT", "1T", "03", "31", - "FCC", "2.4G", "20M", "HT", "1T", "04", "30", - "ETSI", "2.4G", "20M", "HT", "1T", "04", "31", - "MKK", "2.4G", "20M", "HT", "1T", "04", "31", - "FCC", "2.4G", "20M", "HT", "1T", "05", "30", - "ETSI", "2.4G", "20M", "HT", "1T", "05", "31", - "MKK", "2.4G", "20M", "HT", "1T", "05", "31", - "FCC", "2.4G", "20M", "HT", "1T", "06", "30", - "ETSI", "2.4G", "20M", "HT", "1T", "06", "31", - "MKK", "2.4G", "20M", "HT", "1T", "06", "31", - "FCC", "2.4G", "20M", "HT", "1T", "07", "30", - "ETSI", "2.4G", "20M", "HT", "1T", "07", "31", - "MKK", "2.4G", "20M", "HT", "1T", "07", "31", - "FCC", "2.4G", "20M", "HT", "1T", "08", "30", - "ETSI", "2.4G", "20M", "HT", "1T", "08", "31", - "MKK", "2.4G", "20M", "HT", "1T", "08", "31", - "FCC", "2.4G", "20M", "HT", "1T", "09", "30", - "ETSI", "2.4G", "20M", "HT", "1T", "09", "31", - "MKK", "2.4G", "20M", "HT", "1T", "09", "31", - "FCC", "2.4G", "20M", "HT", "1T", "10", "26", - "ETSI", "2.4G", "20M", "HT", "1T", "10", "31", - "MKK", "2.4G", "20M", "HT", "1T", "10", "31", - "FCC", "2.4G", "20M", "HT", "1T", "11", "24", - "ETSI", "2.4G", "20M", "HT", "1T", "11", "31", - "MKK", "2.4G", "20M", "HT", "1T", "11", "31", - "FCC", "2.4G", "20M", "HT", "1T", "12", "23", - "ETSI", "2.4G", "20M", "HT", "1T", "12", "31", - "MKK", "2.4G", "20M", "HT", "1T", "12", "31", - "FCC", "2.4G", "20M", "HT", "1T", "13", "13", - "ETSI", "2.4G", "20M", "HT", "1T", "13", "31", - "MKK", "2.4G", "20M", "HT", "1T", "13", "31", - "FCC", "2.4G", "20M", "HT", "1T", "14", "63", - "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", - "MKK", "2.4G", "20M", "HT", "1T", "14", "63", - "FCC", "2.4G", "20M", "HT", "2T", "01", "28", - "ETSI", "2.4G", "20M", "HT", "2T", "01", "30", - "MKK", "2.4G", "20M", "HT", "2T", "01", "30", - "FCC", "2.4G", "20M", "HT", "2T", "02", "28", - "ETSI", "2.4G", "20M", "HT", "2T", "02", "30", - "MKK", "2.4G", "20M", "HT", "2T", "02", "30", - "FCC", "2.4G", "20M", "HT", "2T", "03", "30", - "ETSI", "2.4G", "20M", "HT", "2T", "03", "30", - "MKK", "2.4G", "20M", "HT", "2T", "03", "30", - "FCC", "2.4G", "20M", "HT", "2T", "04", "30", - "ETSI", "2.4G", "20M", "HT", "2T", "04", "30", - "MKK", "2.4G", "20M", "HT", "2T", "04", "30", - "FCC", "2.4G", "20M", "HT", "2T", "05", "30", - "ETSI", "2.4G", "20M", "HT", "2T", "05", "30", - "MKK", "2.4G", "20M", "HT", "2T", "05", "30", - "FCC", "2.4G", "20M", "HT", "2T", "06", "30", - "ETSI", "2.4G", "20M", "HT", "2T", "06", "30", - "MKK", "2.4G", "20M", "HT", "2T", "06", "30", - "FCC", "2.4G", "20M", "HT", "2T", "07", "30", - "ETSI", "2.4G", "20M", "HT", "2T", "07", "30", - "MKK", "2.4G", "20M", "HT", "2T", "07", "30", - "FCC", "2.4G", "20M", "HT", "2T", "08", "30", - "ETSI", "2.4G", "20M", "HT", "2T", "08", "30", - "MKK", "2.4G", "20M", "HT", "2T", "08", "30", - "FCC", "2.4G", "20M", "HT", "2T", "09", "28", - "ETSI", "2.4G", "20M", "HT", "2T", "09", "30", - "MKK", "2.4G", "20M", "HT", "2T", "09", "30", - "FCC", "2.4G", "20M", "HT", "2T", "10", "28", - "ETSI", "2.4G", "20M", "HT", "2T", "10", "30", - "MKK", "2.4G", "20M", "HT", "2T", "10", "30", - "FCC", "2.4G", "20M", "HT", "2T", "11", "28", - "ETSI", "2.4G", "20M", "HT", "2T", "11", "30", - "MKK", "2.4G", "20M", "HT", "2T", "11", "30", - "FCC", "2.4G", "20M", "HT", "2T", "12", "63", - "ETSI", "2.4G", "20M", "HT", "2T", "12", "30", - "MKK", "2.4G", "20M", "HT", "2T", "12", "30", - "FCC", "2.4G", "20M", "HT", "2T", "13", "63", - "ETSI", "2.4G", "20M", "HT", "2T", "13", "30", - "MKK", "2.4G", "20M", "HT", "2T", "13", "30", - "FCC", "2.4G", "20M", "HT", "2T", "14", "63", - "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", - "MKK", "2.4G", "20M", "HT", "2T", "14", "63", - "FCC", "2.4G", "40M", "HT", "1T", "01", "63", - "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", - "MKK", "2.4G", "40M", "HT", "1T", "01", "63", - "FCC", "2.4G", "40M", "HT", "1T", "02", "63", - "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", - "MKK", "2.4G", "40M", "HT", "1T", "02", "63", - "FCC", "2.4G", "40M", "HT", "1T", "03", "24", - "ETSI", "2.4G", "40M", "HT", "1T", "03", "30", - "MKK", "2.4G", "40M", "HT", "1T", "03", "30", - "FCC", "2.4G", "40M", "HT", "1T", "04", "24", - "ETSI", "2.4G", "40M", "HT", "1T", "04", "30", - "MKK", "2.4G", "40M", "HT", "1T", "04", "30", - "FCC", "2.4G", "40M", "HT", "1T", "05", "24", - "ETSI", "2.4G", "40M", "HT", "1T", "05", "30", - "MKK", "2.4G", "40M", "HT", "1T", "05", "30", - "FCC", "2.4G", "40M", "HT", "1T", "06", "24", - "ETSI", "2.4G", "40M", "HT", "1T", "06", "30", - "MKK", "2.4G", "40M", "HT", "1T", "06", "30", - "FCC", "2.4G", "40M", "HT", "1T", "07", "24", - "ETSI", "2.4G", "40M", "HT", "1T", "07", "30", - "MKK", "2.4G", "40M", "HT", "1T", "07", "30", - "FCC", "2.4G", "40M", "HT", "1T", "08", "24", - "ETSI", "2.4G", "40M", "HT", "1T", "08", "30", - "MKK", "2.4G", "40M", "HT", "1T", "08", "30", - "FCC", "2.4G", "40M", "HT", "1T", "09", "24", - "ETSI", "2.4G", "40M", "HT", "1T", "09", "30", - "MKK", "2.4G", "40M", "HT", "1T", "09", "30", - "FCC", "2.4G", "40M", "HT", "1T", "10", "22", - "ETSI", "2.4G", "40M", "HT", "1T", "10", "30", - "MKK", "2.4G", "40M", "HT", "1T", "10", "30", - "FCC", "2.4G", "40M", "HT", "1T", "11", "20", - "ETSI", "2.4G", "40M", "HT", "1T", "11", "30", - "MKK", "2.4G", "40M", "HT", "1T", "11", "30", - "FCC", "2.4G", "40M", "HT", "1T", "12", "63", - "ETSI", "2.4G", "40M", "HT", "1T", "12", "30", - "MKK", "2.4G", "40M", "HT", "1T", "12", "30", - "FCC", "2.4G", "40M", "HT", "1T", "13", "63", - "ETSI", "2.4G", "40M", "HT", "1T", "13", "30", - "MKK", "2.4G", "40M", "HT", "1T", "13", "30", - "FCC", "2.4G", "40M", "HT", "1T", "14", "63", - "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", - "MKK", "2.4G", "40M", "HT", "1T", "14", "63", - "FCC", "2.4G", "40M", "HT", "2T", "01", "63", - "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", - "MKK", "2.4G", "40M", "HT", "2T", "01", "63", - "FCC", "2.4G", "40M", "HT", "2T", "02", "63", - "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", - "MKK", "2.4G", "40M", "HT", "2T", "02", "63", - "FCC", "2.4G", "40M", "HT", "2T", "03", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "03", "26", - "MKK", "2.4G", "40M", "HT", "2T", "03", "26", - "FCC", "2.4G", "40M", "HT", "2T", "04", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "04", "26", - "MKK", "2.4G", "40M", "HT", "2T", "04", "26", - "FCC", "2.4G", "40M", "HT", "2T", "05", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "05", "26", - "MKK", "2.4G", "40M", "HT", "2T", "05", "26", - "FCC", "2.4G", "40M", "HT", "2T", "06", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "06", "26", - "MKK", "2.4G", "40M", "HT", "2T", "06", "26", - "FCC", "2.4G", "40M", "HT", "2T", "07", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "07", "26", - "MKK", "2.4G", "40M", "HT", "2T", "07", "26", - "FCC", "2.4G", "40M", "HT", "2T", "08", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "08", "26", - "MKK", "2.4G", "40M", "HT", "2T", "08", "26", - "FCC", "2.4G", "40M", "HT", "2T", "09", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "09", "26", - "MKK", "2.4G", "40M", "HT", "2T", "09", "26", - "FCC", "2.4G", "40M", "HT", "2T", "10", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "10", "26", - "MKK", "2.4G", "40M", "HT", "2T", "10", "26", - "FCC", "2.4G", "40M", "HT", "2T", "11", "26", - "ETSI", "2.4G", "40M", "HT", "2T", "11", "26", - "MKK", "2.4G", "40M", "HT", "2T", "11", "26", - "FCC", "2.4G", "40M", "HT", "2T", "12", "63", - "ETSI", "2.4G", "40M", "HT", "2T", "12", "26", - "MKK", "2.4G", "40M", "HT", "2T", "12", "26", - "FCC", "2.4G", "40M", "HT", "2T", "13", "63", - "ETSI", "2.4G", "40M", "HT", "2T", "13", "26", - "MKK", "2.4G", "40M", "HT", "2T", "13", "26", - "FCC", "2.4G", "40M", "HT", "2T", "14", "63", - "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", - "MKK", "2.4G", "40M", "HT", "2T", "14", "63", - "FCC", "5G", "20M", "OFDM", "1T", "36", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", - "MKK", "5G", "20M", "OFDM", "1T", "36", "32", - "FCC", "5G", "20M", "OFDM", "1T", "40", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", - "MKK", "5G", "20M", "OFDM", "1T", "40", "32", - "FCC", "5G", "20M", "OFDM", "1T", "44", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", - "MKK", "5G", "20M", "OFDM", "1T", "44", "32", - "FCC", "5G", "20M", "OFDM", "1T", "48", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", - "MKK", "5G", "20M", "OFDM", "1T", "48", "32", - "FCC", "5G", "20M", "OFDM", "1T", "52", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", - "MKK", "5G", "20M", "OFDM", "1T", "52", "32", - "FCC", "5G", "20M", "OFDM", "1T", "56", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", - "MKK", "5G", "20M", "OFDM", "1T", "56", "32", - "FCC", "5G", "20M", "OFDM", "1T", "60", "32", - "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", - "MKK", "5G", "20M", "OFDM", "1T", "60", "32", - "FCC", "5G", "20M", "OFDM", "1T", "64", "28", - "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", - "MKK", "5G", "20M", "OFDM", "1T", "64", "32", - "FCC", "5G", "20M", "OFDM", "1T", "100", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", - "MKK", "5G", "20M", "OFDM", "1T", "100", "32", - "FCC", "5G", "20M", "OFDM", "1T", "114", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", - "MKK", "5G", "20M", "OFDM", "1T", "114", "32", - "FCC", "5G", "20M", "OFDM", "1T", "108", "32", - "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", - "MKK", "5G", "20M", "OFDM", "1T", "108", "32", - "FCC", "5G", "20M", "OFDM", "1T", "112", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", - "MKK", "5G", "20M", "OFDM", "1T", "112", "32", - "FCC", "5G", "20M", "OFDM", "1T", "116", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", - "MKK", "5G", "20M", "OFDM", "1T", "116", "32", - "FCC", "5G", "20M", "OFDM", "1T", "120", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", - "MKK", "5G", "20M", "OFDM", "1T", "120", "32", - "FCC", "5G", "20M", "OFDM", "1T", "124", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", - "MKK", "5G", "20M", "OFDM", "1T", "124", "32", - "FCC", "5G", "20M", "OFDM", "1T", "128", "32", - "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", - "MKK", "5G", "20M", "OFDM", "1T", "128", "32", - "FCC", "5G", "20M", "OFDM", "1T", "132", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", - "MKK", "5G", "20M", "OFDM", "1T", "132", "32", - "FCC", "5G", "20M", "OFDM", "1T", "136", "30", - "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", - "MKK", "5G", "20M", "OFDM", "1T", "136", "32", - "FCC", "5G", "20M", "OFDM", "1T", "140", "28", - "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", - "MKK", "5G", "20M", "OFDM", "1T", "140", "32", - "FCC", "5G", "20M", "OFDM", "1T", "149", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", - "MKK", "5G", "20M", "OFDM", "1T", "149", "63", - "FCC", "5G", "20M", "OFDM", "1T", "153", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", - "MKK", "5G", "20M", "OFDM", "1T", "153", "63", - "FCC", "5G", "20M", "OFDM", "1T", "157", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", - "MKK", "5G", "20M", "OFDM", "1T", "157", "63", - "FCC", "5G", "20M", "OFDM", "1T", "161", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", - "MKK", "5G", "20M", "OFDM", "1T", "161", "63", - "FCC", "5G", "20M", "OFDM", "1T", "165", "34", - "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", - "MKK", "5G", "20M", "OFDM", "1T", "165", "63", - "FCC", "5G", "20M", "HT", "1T", "36", "30", - "ETSI", "5G", "20M", "HT", "1T", "36", "32", - "MKK", "5G", "20M", "HT", "1T", "36", "32", - "FCC", "5G", "20M", "HT", "1T", "40", "30", - "ETSI", "5G", "20M", "HT", "1T", "40", "32", - "MKK", "5G", "20M", "HT", "1T", "40", "32", - "FCC", "5G", "20M", "HT", "1T", "44", "30", - "ETSI", "5G", "20M", "HT", "1T", "44", "32", - "MKK", "5G", "20M", "HT", "1T", "44", "32", - "FCC", "5G", "20M", "HT", "1T", "48", "30", - "ETSI", "5G", "20M", "HT", "1T", "48", "32", - "MKK", "5G", "20M", "HT", "1T", "48", "32", - "FCC", "5G", "20M", "HT", "1T", "52", "34", - "ETSI", "5G", "20M", "HT", "1T", "52", "32", - "MKK", "5G", "20M", "HT", "1T", "52", "32", - "FCC", "5G", "20M", "HT", "1T", "56", "34", - "ETSI", "5G", "20M", "HT", "1T", "56", "32", - "MKK", "5G", "20M", "HT", "1T", "56", "32", - "FCC", "5G", "20M", "HT", "1T", "60", "32", - "ETSI", "5G", "20M", "HT", "1T", "60", "32", - "MKK", "5G", "20M", "HT", "1T", "60", "32", - "FCC", "5G", "20M", "HT", "1T", "64", "28", - "ETSI", "5G", "20M", "HT", "1T", "64", "32", - "MKK", "5G", "20M", "HT", "1T", "64", "32", - "FCC", "5G", "20M", "HT", "1T", "100", "30", - "ETSI", "5G", "20M", "HT", "1T", "100", "32", - "MKK", "5G", "20M", "HT", "1T", "100", "32", - "FCC", "5G", "20M", "HT", "1T", "114", "30", - "ETSI", "5G", "20M", "HT", "1T", "114", "32", - "MKK", "5G", "20M", "HT", "1T", "114", "32", - "FCC", "5G", "20M", "HT", "1T", "108", "32", - "ETSI", "5G", "20M", "HT", "1T", "108", "32", - "MKK", "5G", "20M", "HT", "1T", "108", "32", - "FCC", "5G", "20M", "HT", "1T", "112", "34", - "ETSI", "5G", "20M", "HT", "1T", "112", "32", - "MKK", "5G", "20M", "HT", "1T", "112", "32", - "FCC", "5G", "20M", "HT", "1T", "116", "34", - "ETSI", "5G", "20M", "HT", "1T", "116", "32", - "MKK", "5G", "20M", "HT", "1T", "116", "32", - "FCC", "5G", "20M", "HT", "1T", "120", "34", - "ETSI", "5G", "20M", "HT", "1T", "120", "32", - "MKK", "5G", "20M", "HT", "1T", "120", "32", - "FCC", "5G", "20M", "HT", "1T", "124", "34", - "ETSI", "5G", "20M", "HT", "1T", "124", "32", - "MKK", "5G", "20M", "HT", "1T", "124", "32", - "FCC", "5G", "20M", "HT", "1T", "128", "32", - "ETSI", "5G", "20M", "HT", "1T", "128", "32", - "MKK", "5G", "20M", "HT", "1T", "128", "32", - "FCC", "5G", "20M", "HT", "1T", "132", "30", - "ETSI", "5G", "20M", "HT", "1T", "132", "32", - "MKK", "5G", "20M", "HT", "1T", "132", "32", - "FCC", "5G", "20M", "HT", "1T", "136", "30", - "ETSI", "5G", "20M", "HT", "1T", "136", "32", - "MKK", "5G", "20M", "HT", "1T", "136", "32", - "FCC", "5G", "20M", "HT", "1T", "140", "28", - "ETSI", "5G", "20M", "HT", "1T", "140", "32", - "MKK", "5G", "20M", "HT", "1T", "140", "32", - "FCC", "5G", "20M", "HT", "1T", "149", "34", - "ETSI", "5G", "20M", "HT", "1T", "149", "32", - "MKK", "5G", "20M", "HT", "1T", "149", "63", - "FCC", "5G", "20M", "HT", "1T", "153", "34", - "ETSI", "5G", "20M", "HT", "1T", "153", "32", - "MKK", "5G", "20M", "HT", "1T", "153", "63", - "FCC", "5G", "20M", "HT", "1T", "157", "34", - "ETSI", "5G", "20M", "HT", "1T", "157", "32", - "MKK", "5G", "20M", "HT", "1T", "157", "63", - "FCC", "5G", "20M", "HT", "1T", "161", "34", - "ETSI", "5G", "20M", "HT", "1T", "161", "32", - "MKK", "5G", "20M", "HT", "1T", "161", "63", - "FCC", "5G", "20M", "HT", "1T", "165", "34", - "ETSI", "5G", "20M", "HT", "1T", "165", "32", - "MKK", "5G", "20M", "HT", "1T", "165", "63", - "FCC", "5G", "20M", "HT", "2T", "36", "28", - "ETSI", "5G", "20M", "HT", "2T", "36", "30", - "MKK", "5G", "20M", "HT", "2T", "36", "30", - "FCC", "5G", "20M", "HT", "2T", "40", "28", - "ETSI", "5G", "20M", "HT", "2T", "40", "30", - "MKK", "5G", "20M", "HT", "2T", "40", "30", - "FCC", "5G", "20M", "HT", "2T", "44", "28", - "ETSI", "5G", "20M", "HT", "2T", "44", "30", - "MKK", "5G", "20M", "HT", "2T", "44", "30", - "FCC", "5G", "20M", "HT", "2T", "48", "28", - "ETSI", "5G", "20M", "HT", "2T", "48", "30", - "MKK", "5G", "20M", "HT", "2T", "48", "30", - "FCC", "5G", "20M", "HT", "2T", "52", "34", - "ETSI", "5G", "20M", "HT", "2T", "52", "30", - "MKK", "5G", "20M", "HT", "2T", "52", "30", - "FCC", "5G", "20M", "HT", "2T", "56", "32", - "ETSI", "5G", "20M", "HT", "2T", "56", "30", - "MKK", "5G", "20M", "HT", "2T", "56", "30", - "FCC", "5G", "20M", "HT", "2T", "60", "30", - "ETSI", "5G", "20M", "HT", "2T", "60", "30", - "MKK", "5G", "20M", "HT", "2T", "60", "30", - "FCC", "5G", "20M", "HT", "2T", "64", "26", - "ETSI", "5G", "20M", "HT", "2T", "64", "30", - "MKK", "5G", "20M", "HT", "2T", "64", "30", - "FCC", "5G", "20M", "HT", "2T", "100", "28", - "ETSI", "5G", "20M", "HT", "2T", "100", "30", - "MKK", "5G", "20M", "HT", "2T", "100", "30", - "FCC", "5G", "20M", "HT", "2T", "114", "28", - "ETSI", "5G", "20M", "HT", "2T", "114", "30", - "MKK", "5G", "20M", "HT", "2T", "114", "30", - "FCC", "5G", "20M", "HT", "2T", "108", "30", - "ETSI", "5G", "20M", "HT", "2T", "108", "30", - "MKK", "5G", "20M", "HT", "2T", "108", "30", - "FCC", "5G", "20M", "HT", "2T", "112", "32", - "ETSI", "5G", "20M", "HT", "2T", "112", "30", - "MKK", "5G", "20M", "HT", "2T", "112", "30", - "FCC", "5G", "20M", "HT", "2T", "116", "32", - "ETSI", "5G", "20M", "HT", "2T", "116", "30", - "MKK", "5G", "20M", "HT", "2T", "116", "30", - "FCC", "5G", "20M", "HT", "2T", "120", "34", - "ETSI", "5G", "20M", "HT", "2T", "120", "30", - "MKK", "5G", "20M", "HT", "2T", "120", "30", - "FCC", "5G", "20M", "HT", "2T", "124", "32", - "ETSI", "5G", "20M", "HT", "2T", "124", "30", - "MKK", "5G", "20M", "HT", "2T", "124", "30", - "FCC", "5G", "20M", "HT", "2T", "128", "30", - "ETSI", "5G", "20M", "HT", "2T", "128", "30", - "MKK", "5G", "20M", "HT", "2T", "128", "30", - "FCC", "5G", "20M", "HT", "2T", "132", "28", - "ETSI", "5G", "20M", "HT", "2T", "132", "30", - "MKK", "5G", "20M", "HT", "2T", "132", "30", - "FCC", "5G", "20M", "HT", "2T", "136", "28", - "ETSI", "5G", "20M", "HT", "2T", "136", "30", - "MKK", "5G", "20M", "HT", "2T", "136", "30", - "FCC", "5G", "20M", "HT", "2T", "140", "26", - "ETSI", "5G", "20M", "HT", "2T", "140", "30", - "MKK", "5G", "20M", "HT", "2T", "140", "30", - "FCC", "5G", "20M", "HT", "2T", "149", "34", - "ETSI", "5G", "20M", "HT", "2T", "149", "30", - "MKK", "5G", "20M", "HT", "2T", "149", "63", - "FCC", "5G", "20M", "HT", "2T", "153", "34", - "ETSI", "5G", "20M", "HT", "2T", "153", "30", - "MKK", "5G", "20M", "HT", "2T", "153", "63", - "FCC", "5G", "20M", "HT", "2T", "157", "34", - "ETSI", "5G", "20M", "HT", "2T", "157", "30", - "MKK", "5G", "20M", "HT", "2T", "157", "63", - "FCC", "5G", "20M", "HT", "2T", "161", "34", - "ETSI", "5G", "20M", "HT", "2T", "161", "30", - "MKK", "5G", "20M", "HT", "2T", "161", "63", - "FCC", "5G", "20M", "HT", "2T", "165", "34", - "ETSI", "5G", "20M", "HT", "2T", "165", "30", - "MKK", "5G", "20M", "HT", "2T", "165", "63", - "FCC", "5G", "40M", "HT", "1T", "38", "30", - "ETSI", "5G", "40M", "HT", "1T", "38", "32", - "MKK", "5G", "40M", "HT", "1T", "38", "32", - "FCC", "5G", "40M", "HT", "1T", "46", "30", - "ETSI", "5G", "40M", "HT", "1T", "46", "32", - "MKK", "5G", "40M", "HT", "1T", "46", "32", - "FCC", "5G", "40M", "HT", "1T", "54", "32", - "ETSI", "5G", "40M", "HT", "1T", "54", "32", - "MKK", "5G", "40M", "HT", "1T", "54", "32", - "FCC", "5G", "40M", "HT", "1T", "62", "32", - "ETSI", "5G", "40M", "HT", "1T", "62", "32", - "MKK", "5G", "40M", "HT", "1T", "62", "32", - "FCC", "5G", "40M", "HT", "1T", "102", "28", - "ETSI", "5G", "40M", "HT", "1T", "102", "32", - "MKK", "5G", "40M", "HT", "1T", "102", "32", - "FCC", "5G", "40M", "HT", "1T", "110", "32", - "ETSI", "5G", "40M", "HT", "1T", "110", "32", - "MKK", "5G", "40M", "HT", "1T", "110", "32", - "FCC", "5G", "40M", "HT", "1T", "118", "34", - "ETSI", "5G", "40M", "HT", "1T", "118", "32", - "MKK", "5G", "40M", "HT", "1T", "118", "32", - "FCC", "5G", "40M", "HT", "1T", "126", "34", - "ETSI", "5G", "40M", "HT", "1T", "126", "32", - "MKK", "5G", "40M", "HT", "1T", "126", "32", - "FCC", "5G", "40M", "HT", "1T", "134", "32", - "ETSI", "5G", "40M", "HT", "1T", "134", "32", - "MKK", "5G", "40M", "HT", "1T", "134", "32", - "FCC", "5G", "40M", "HT", "1T", "151", "34", - "ETSI", "5G", "40M", "HT", "1T", "151", "32", - "MKK", "5G", "40M", "HT", "1T", "151", "63", - "FCC", "5G", "40M", "HT", "1T", "159", "34", - "ETSI", "5G", "40M", "HT", "1T", "159", "32", - "MKK", "5G", "40M", "HT", "1T", "159", "63", - "FCC", "5G", "40M", "HT", "2T", "38", "28", - "ETSI", "5G", "40M", "HT", "2T", "38", "30", - "MKK", "5G", "40M", "HT", "2T", "38", "30", - "FCC", "5G", "40M", "HT", "2T", "46", "28", - "ETSI", "5G", "40M", "HT", "2T", "46", "30", - "MKK", "5G", "40M", "HT", "2T", "46", "30", - "FCC", "5G", "40M", "HT", "2T", "54", "30", - "ETSI", "5G", "40M", "HT", "2T", "54", "30", - "MKK", "5G", "40M", "HT", "2T", "54", "30", - "FCC", "5G", "40M", "HT", "2T", "62", "30", - "ETSI", "5G", "40M", "HT", "2T", "62", "30", - "MKK", "5G", "40M", "HT", "2T", "62", "30", - "FCC", "5G", "40M", "HT", "2T", "102", "26", - "ETSI", "5G", "40M", "HT", "2T", "102", "30", - "MKK", "5G", "40M", "HT", "2T", "102", "30", - "FCC", "5G", "40M", "HT", "2T", "110", "30", - "ETSI", "5G", "40M", "HT", "2T", "110", "30", - "MKK", "5G", "40M", "HT", "2T", "110", "30", - "FCC", "5G", "40M", "HT", "2T", "118", "34", - "ETSI", "5G", "40M", "HT", "2T", "118", "30", - "MKK", "5G", "40M", "HT", "2T", "118", "30", - "FCC", "5G", "40M", "HT", "2T", "126", "32", - "ETSI", "5G", "40M", "HT", "2T", "126", "30", - "MKK", "5G", "40M", "HT", "2T", "126", "30", - "FCC", "5G", "40M", "HT", "2T", "134", "30", - "ETSI", "5G", "40M", "HT", "2T", "134", "30", - "MKK", "5G", "40M", "HT", "2T", "134", "30", - "FCC", "5G", "40M", "HT", "2T", "151", "34", - "ETSI", "5G", "40M", "HT", "2T", "151", "30", - "MKK", "5G", "40M", "HT", "2T", "151", "63", - "FCC", "5G", "40M", "HT", "2T", "159", "34", - "ETSI", "5G", "40M", "HT", "2T", "159", "30", - "MKK", "5G", "40M", "HT", "2T", "159", "63", - "FCC", "5G", "80M", "VHT", "1T", "42", "30", - "ETSI", "5G", "80M", "VHT", "1T", "42", "32", - "MKK", "5G", "80M", "VHT", "1T", "42", "32", - "FCC", "5G", "80M", "VHT", "1T", "58", "28", - "ETSI", "5G", "80M", "VHT", "1T", "58", "32", - "MKK", "5G", "80M", "VHT", "1T", "58", "32", - "FCC", "5G", "80M", "VHT", "1T", "106", "30", - "ETSI", "5G", "80M", "VHT", "1T", "106", "32", - "MKK", "5G", "80M", "VHT", "1T", "106", "32", - "FCC", "5G", "80M", "VHT", "1T", "122", "34", - "ETSI", "5G", "80M", "VHT", "1T", "122", "32", - "MKK", "5G", "80M", "VHT", "1T", "122", "32", - "FCC", "5G", "80M", "VHT", "1T", "155", "34", - "ETSI", "5G", "80M", "VHT", "1T", "155", "32", - "MKK", "5G", "80M", "VHT", "1T", "155", "63", - "FCC", "5G", "80M", "VHT", "2T", "42", "28", - "ETSI", "5G", "80M", "VHT", "2T", "42", "30", - "MKK", "5G", "80M", "VHT", "2T", "42", "30", - "FCC", "5G", "80M", "VHT", "2T", "58", "26", - "ETSI", "5G", "80M", "VHT", "2T", "58", "30", - "MKK", "5G", "80M", "VHT", "2T", "58", "30", - "FCC", "5G", "80M", "VHT", "2T", "106", "28", - "ETSI", "5G", "80M", "VHT", "2T", "106", "30", - "MKK", "5G", "80M", "VHT", "2T", "106", "30", - "FCC", "5G", "80M", "VHT", "2T", "122", "32", - "ETSI", "5G", "80M", "VHT", "2T", "122", "30", - "MKK", "5G", "80M", "VHT", "2T", "122", "30", - "FCC", "5G", "80M", "VHT", "2T", "155", "34", - "ETSI", "5G", "80M", "VHT", "2T", "155", "30", - "MKK", "5G", "80M", "VHT", "2T", "155", "63" -}; - -void -ODM_ReadAndConfig_MP_8723D_TXPWR_LMT( - IN PDM_ODM_T pDM_Odm -) -{ - u4Byte i = 0; -#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) - u4Byte ArrayLen = sizeof(Array_MP_8723D_TXPWR_LMT)/sizeof(u1Byte); - pu1Byte Array = (pu1Byte)Array_MP_8723D_TXPWR_LMT; -#else - u4Byte ArrayLen = sizeof(Array_MP_8723D_TXPWR_LMT)/sizeof(pu1Byte); - pu1Byte *Array = (pu1Byte *)Array_MP_8723D_TXPWR_LMT; -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - PlatformZeroMemory(pHalData->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); - pHalData->nLinesReadPwrLmt = ArrayLen/7; -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_8723D_TXPWR_LMT\n")); - - for (i = 0; i < ArrayLen; i += 7) { -#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) - u1Byte regulation = Array[i]; - u1Byte band = Array[i+1]; - u1Byte bandwidth = Array[i+2]; - u1Byte rate = Array[i+3]; - u1Byte rfPath = Array[i+4]; - u1Byte chnl = Array[i+5]; - u1Byte val = Array[i+6]; -#else - pu1Byte regulation = Array[i]; - pu1Byte band = Array[i+1]; - pu1Byte bandwidth = Array[i+2]; - pu1Byte rate = Array[i+3]; - pu1Byte rfPath = Array[i+4]; - pu1Byte chnl = Array[i+5]; - pu1Byte val = Array[i+6]; -#endif - - odm_ConfigBB_TXPWR_LMT_8723D(pDM_Odm, regulation, band, bandwidth, rate, rfPath, chnl, val); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - rsprintf((char *)pHalData->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", - regulation, band, bandwidth, rate, rfPath, chnl, val); -#endif - } - -} - -/****************************************************************************** -* TxXtalTrack.TXT -******************************************************************************/ - -s1Byte gDeltaSwingTableXtal_MP_N_TxXtalTrack_8723D[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; -s1Byte gDeltaSwingTableXtal_MP_P_TxXtalTrack_8723D[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -10, -12, -14, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16}; - -void -ODM_ReadAndConfig_MP_8723D_TxXtalTrack( - IN PDM_ODM_T pDM_Odm -) -{ - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ReadAndConfig_MP_MP_8723D\n")); - - - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableXtal_P, gDeltaSwingTableXtal_MP_P_TxXtalTrack_8723D, DELTA_SWINGIDX_SIZE); - ODM_MoveMemory(pDM_Odm, pRFCalibrateInfo->DeltaSwingTableXtal_N, gDeltaSwingTableXtal_MP_N_TxXtalTrack_8723D, DELTA_SWINGIDX_SIZE); -} - -#endif /* end of HWIMG_SUPPORT*/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +/*Image2HeaderVersion: 3.5.2*/ +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (RTL8723D_SUPPORT == 1) +static boolean +check_positive( + struct PHY_DM_STRUCT *p_dm, + const u32 condition1, + const u32 condition2, + const u32 condition3, + const u32 condition4 +) +{ + u8 _board_type = ((p_dm->board_type & BIT(4)) >> 4) << 0 | /* _GLNA*/ + ((p_dm->board_type & BIT(3)) >> 3) << 1 | /* _GPA*/ + ((p_dm->board_type & BIT(7)) >> 7) << 2 | /* _ALNA*/ + ((p_dm->board_type & BIT(6)) >> 6) << 3 | /* _APA */ + ((p_dm->board_type & BIT(2)) >> 2) << 4 | /* _BT*/ + ((p_dm->board_type & BIT(1)) >> 1) << 5 | /* _NGFF*/ + ((p_dm->board_type & BIT(5)) >> 5) << 6; /* _TRSWT*/ + + u32 cond1 = condition1, cond2 = condition2, cond3 = condition3, cond4 = condition4; + + u8 cut_version_for_para = (p_dm->cut_version == ODM_CUT_A) ? 15 : p_dm->cut_version; + u8 pkg_type_for_para = (p_dm->package_type == 0) ? 15 : p_dm->package_type; + + u32 driver1 = cut_version_for_para << 24 | + (p_dm->support_interface & 0xF0) << 16 | + p_dm->support_platform << 16 | + pkg_type_for_para << 12 | + (p_dm->support_interface & 0x0F) << 8 | + _board_type; + + u32 driver2 = (p_dm->type_glna & 0xFF) << 0 | + (p_dm->type_gpa & 0xFF) << 8 | + (p_dm->type_alna & 0xFF) << 16 | + (p_dm->type_apa & 0xFF) << 24; + + u32 driver3 = 0; + + u32 driver4 = (p_dm->type_glna & 0xFF00) >> 8 | + (p_dm->type_gpa & 0xFF00) | + (p_dm->type_alna & 0xFF00) << 8 | + (p_dm->type_apa & 0xFF00) << 16; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===> check_positive (cond1, cond2, cond3, cond4) = (0x%X 0x%X 0x%X 0x%X)\n", cond1, cond2, cond3, cond4)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + ("===> check_positive (driver1, driver2, driver3, driver4) = (0x%X 0x%X 0x%X 0x%X)\n", driver1, driver2, driver3, driver4)); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, + (" (Platform, Interface) = (0x%X, 0x%X)\n", p_dm->support_platform, p_dm->support_interface)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, + (" (Board, Package) = (0x%X, 0x%X)\n", p_dm->board_type, p_dm->package_type)); + + + /*============== 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] */ + + cond1 &= 0x00FF0FFF; + driver1 &= 0x00FF0FFF; + + if ((cond1 & driver1) == cond1) { + u32 bit_mask = 0; + + if ((cond1 & 0x0F) == 0) /* board_type is DONTCARE*/ + return true; + + if ((cond1 & BIT(0)) != 0) /*GLNA*/ + bit_mask |= 0x000000FF; + if ((cond1 & BIT(1)) != 0) /*GPA*/ + bit_mask |= 0x0000FF00; + if ((cond1 & BIT(2)) != 0) /*ALNA*/ + bit_mask |= 0x00FF0000; + if ((cond1 & BIT(3)) != 0) /*APA*/ + bit_mask |= 0xFF000000; + + if (((cond2 & bit_mask) == (driver2 & bit_mask)) && ((cond4 & bit_mask) == (driver4 & bit_mask))) /* board_type of each RF path is matched*/ + return true; + else + return false; + } else + return false; +} +static boolean +check_negative( + struct PHY_DM_STRUCT *p_dm, + const u32 condition1, + const u32 condition2 +) +{ + return true; +} + +/****************************************************************************** +* radioa.TXT +******************************************************************************/ + +u32 array_mp_8723d_radioa[] = { + 0x050, 0x0001B000, + 0x049, 0x0004AA00, + 0x000, 0x00010000, + 0x0B1, 0x00054573, + 0x0B4, 0x000508AB, + 0x0B7, 0x00014787, + 0x0B8, 0x000064CB, + 0x01B, 0x00073A40, + 0x051, 0x00038CAF, + 0x052, 0x000FCCA3, + 0x053, 0x00090F38, + 0x054, 0x00011083, + 0x057, 0x000D0000, + 0x08D, 0x00000A1A, + 0x082, 0x00082AAC, + 0x08E, 0x00076940, + 0x08F, 0x00088400, + 0x061, 0x00038CAF, + 0x062, 0x000FCCA3, + 0x063, 0x00090F38, + 0x064, 0x00011083, + 0x067, 0x000D0000, + 0x092, 0x00082AAC, + 0x0EF, 0x00000400, + 0x030, 0x000008CA, + 0x030, 0x000018CF, + 0x030, 0x000028CA, + 0x030, 0x000038CA, + 0x0EF, 0x00000000, + 0x0EE, 0x00000400, + 0x030, 0x000008CA, + 0x030, 0x000018CF, + 0x030, 0x000028CA, + 0x030, 0x000038CA, + 0x0EE, 0x00000000, + 0x0EF, 0x00000100, + 0x033, 0x00000000, + 0x03F, 0x0000CCA3, + 0x033, 0x00000001, + 0x03F, 0x0000CCA3, + 0x033, 0x00000002, + 0x03F, 0x0000CCA3, + 0x033, 0x00000003, + 0x03F, 0x0000CCA3, + 0x033, 0x00000004, + 0x03F, 0x0000CCA3, + 0x033, 0x00000005, + 0x03F, 0x0000CCA3, + 0x033, 0x00000006, + 0x03F, 0x0000CCA3, + 0x033, 0x00000007, + 0x03F, 0x0000CCA3, + 0x0EF, 0x00000000, + 0x0EE, 0x00000100, + 0x033, 0x00000000, + 0x03F, 0x0000CCA3, + 0x033, 0x00000001, + 0x03F, 0x0000CCA3, + 0x033, 0x00000002, + 0x03F, 0x0000CCA3, + 0x033, 0x00000003, + 0x03F, 0x0000CCA3, + 0x033, 0x00000004, + 0x03F, 0x0000CCA3, + 0x033, 0x00000005, + 0x03F, 0x0000CCA3, + 0x033, 0x00000006, + 0x03F, 0x0000CCA3, + 0x033, 0x00000007, + 0x03F, 0x0000CCA3, + 0x0EE, 0x00000000, + 0x0EF, 0x00000800, + 0x030, 0x0000002D, + 0x030, 0x0000122C, + 0x030, 0x0000222F, + 0x030, 0x0000326C, + 0x030, 0x0000466B, + 0x030, 0x0000566E, + 0x030, 0x000066EB, + 0x030, 0x000077EC, + 0x030, 0x000087EF, + 0x030, 0x000097F2, + 0x030, 0x0000A7F5, + 0x0EF, 0x00000000, + 0x0EE, 0x00000800, + 0x030, 0x00000001, + 0x030, 0x00001011, + 0x030, 0x00002011, + 0x030, 0x00003013, + 0x030, 0x00004033, + 0x030, 0x00005033, + 0x030, 0x00006037, + 0x030, 0x0000703F, + 0x030, 0x0000803F, + 0x030, 0x0000903F, + 0x030, 0x0000A03F, + 0x0EE, 0x00000000, + 0x082, 0x00083B8C, + 0x0ED, 0x00000008, + 0x030, 0x000030F6, + 0x030, 0x00002004, + 0x030, 0x000010F6, + 0x030, 0x000000F6, + 0x0ED, 0x00000000, + 0x092, 0x00083B8C, + 0x0EC, 0x00000008, + 0x030, 0x000030F6, + 0x030, 0x00002004, + 0x030, 0x000010F6, + 0x030, 0x000000F6, + 0x0EC, 0x00000000, + 0x0EF, 0x00010000, + 0x030, 0x0001C11C, + 0x030, 0x000181F4, + 0x030, 0x00014108, + 0x030, 0x000101E4, + 0x030, 0x0000C11C, + 0x030, 0x000081F4, + 0x030, 0x00004108, + 0x030, 0x000001E4, + 0x0EF, 0x00000000, + 0x0EE, 0x00010000, + 0x030, 0x0001C11C, + 0x030, 0x000181F4, + 0x030, 0x00014108, + 0x030, 0x000101E4, + 0x030, 0x0000C11C, + 0x030, 0x000081F4, + 0x030, 0x00004108, + 0x030, 0x000001E4, + 0x0EE, 0x00000000, + 0x0EF, 0x00080000, + 0x033, 0x00000007, + 0x03E, 0x0000005F, + 0x03F, 0x000B3FDB, + 0x033, 0x00000004, + 0x03E, 0x0000005D, + 0x03F, 0x000BFFE0, + 0x033, 0x00000005, + 0x03E, 0x0000005D, + 0x03F, 0x000FBFCE, + 0x033, 0x00000006, + 0x03E, 0x0000005F, + 0x03F, 0x000A7FFB, + 0x0EF, 0x00000000, + 0x0EE, 0x00000002, + 0x030, 0x00000001, + 0x030, 0x00002001, + 0x030, 0x00004001, + 0x030, 0x00007001, + 0x030, 0x00006001, + 0x030, 0x00020001, + 0x030, 0x00022001, + 0x030, 0x00024001, + 0x030, 0x00027001, + 0x030, 0x00026001, + 0x030, 0x00034001, + 0x030, 0x00037001, + 0x030, 0x00036001, + 0x030, 0x00008000, + 0x030, 0x0000A000, + 0x030, 0x0000C000, + 0x83000100, 0x00000000, 0x40000000, 0x00000000, + 0x030, 0x0000E024, + 0xA0000000, 0x00000000, + 0x030, 0x0000E000, + 0xB0000000, 0x00000000, + 0x030, 0x0001C000, + 0x030, 0x0001E000, + 0x0EE, 0x00000000, + 0x0EE, 0x00020000, + 0x0EF, 0x00020000, + 0x030, 0x00000F75, + 0x030, 0x00002F55, + 0x030, 0x00003F75, + 0x0EE, 0x00000000, + 0x0EF, 0x00000000, + 0x018, 0x00008401, + 0xFFE, 0x00000000, + +}; + +void +odm_read_and_config_mp_8723d_radioa( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 i = 0; + u8 c_cond; + boolean is_matched = true, is_skipped = false; + u32 array_len = sizeof(array_mp_8723d_radioa)/sizeof(u32); + u32 *array = array_mp_8723d_radioa; + + u32 v1 = 0, v2 = 0, pre_v1 = 0, pre_v2 = 0; + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_read_and_config_mp_8723d_radioa\n")); + + while ((i + 1) < array_len) { + v1 = array[i]; + v2 = array[i + 1]; + + if (v1 & (BIT(31) | BIT(30))) {/*positive & negative condition*/ + if (v1 & BIT(31)) {/* positive condition*/ + c_cond = (u8)((v1 & (BIT(29)|BIT(28))) >> 28); + if (c_cond == COND_ENDIF) {/*end*/ + is_matched = true; + is_skipped = false; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ENDIF\n")); + } else if (c_cond == COND_ELSE) { /*else*/ + is_matched = is_skipped?false:true; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("ELSE\n")); + } else {/*if , else if*/ + pre_v1 = v1; + pre_v2 = v2; + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("IF or ELSE IF\n")); + } + } else if (v1 & BIT(30)) { /*negative condition*/ + if (is_skipped == false) { + if (check_positive(p_dm, pre_v1, pre_v2, v1, v2)) { + is_matched = true; + is_skipped = true; + } else { + is_matched = false; + is_skipped = false; + } + } else + is_matched = false; + } + } else { + if (is_matched) + odm_config_rf_radio_a_8723d(p_dm, v1, v2); + } + i = i + 2; + } +} + +u32 +odm_get_version_mp_8723d_radioa(void) +{ + return 36; +} + +/****************************************************************************** +* txpowertrack_pcie.TXT +******************************************************************************/ + +#if DEV_BUS_TYPE == RT_PCI_INTERFACE +u8 g_delta_swing_table_idx_mp_5gb_n_txpowertrack_pcie_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, +}; +u8 g_delta_swing_table_idx_mp_5gb_p_txpowertrack_pcie_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, +}; +u8 g_delta_swing_table_idx_mp_5ga_n_txpowertrack_pcie_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, +}; +u8 g_delta_swing_table_idx_mp_5ga_p_txpowertrack_pcie_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, +}; +u8 g_delta_swing_table_idx_mp_2gb_n_txpowertrack_pcie_8723d[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2gb_p_txpowertrack_pcie_8723d[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2ga_n_txpowertrack_pcie_8723d[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2ga_p_txpowertrack_pcie_8723d[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_pcie_8723d[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_pcie_8723d[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_pcie_8723d[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_8723d[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; +#endif + +void +odm_read_and_config_mp_8723d_txpowertrack_pcie( + struct PHY_DM_STRUCT *p_dm +) +{ +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> ODM_ReadAndConfig_MP_mp_8723d\n")); + + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE); + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_pcie_8723d, DELTA_SWINGIDX_SIZE*3); +#endif +} + +/****************************************************************************** +* txpowertrack_sdio.TXT +******************************************************************************/ + +#if DEV_BUS_TYPE == RT_SDIO_INTERFACE +u8 g_delta_swing_table_idx_mp_5gb_n_txpowertrack_sdio_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, +}; +u8 g_delta_swing_table_idx_mp_5gb_p_txpowertrack_sdio_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, +}; +u8 g_delta_swing_table_idx_mp_5ga_n_txpowertrack_sdio_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, +}; +u8 g_delta_swing_table_idx_mp_5ga_p_txpowertrack_sdio_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, +}; +u8 g_delta_swing_table_idx_mp_2gb_n_txpowertrack_sdio_8723d[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2gb_p_txpowertrack_sdio_8723d[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2ga_n_txpowertrack_sdio_8723d[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2ga_p_txpowertrack_sdio_8723d[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_sdio_8723d[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_sdio_8723d[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_sdio_8723d[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_8723d[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; +#endif + +void +odm_read_and_config_mp_8723d_txpowertrack_sdio( + struct PHY_DM_STRUCT *p_dm +) +{ +#if DEV_BUS_TYPE == RT_SDIO_INTERFACE + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> ODM_ReadAndConfig_MP_mp_8723d\n")); + + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE); + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_sdio_8723d, DELTA_SWINGIDX_SIZE*3); +#endif +} + +/****************************************************************************** +* txpowertrack_usb.TXT +******************************************************************************/ + +#if DEV_BUS_TYPE == RT_USB_INTERFACE +u8 g_delta_swing_table_idx_mp_5gb_n_txpowertrack_usb_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, +}; +u8 g_delta_swing_table_idx_mp_5gb_p_txpowertrack_usb_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, +}; +u8 g_delta_swing_table_idx_mp_5ga_n_txpowertrack_usb_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 16, 17, 17, 17, 17, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, + {0, 1, 2, 3, 3, 5, 5, 6, 6, 7, 8, 9, 10, 11, 11, 12, 13, 14, 14, 15, 15, 16, 16, 17, 17, 18, 18, 18, 18, 18}, +}; +u8 g_delta_swing_table_idx_mp_5ga_p_txpowertrack_usb_8723d[][DELTA_SWINGIDX_SIZE] = { + {0, 1, 1, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, + {0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15, 15}, +}; +u8 g_delta_swing_table_idx_mp_2gb_n_txpowertrack_usb_8723d[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2gb_p_txpowertrack_usb_8723d[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2ga_n_txpowertrack_usb_8723d[] = {0, 0, 1, 1, 1, 2, 2, 3, 4, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 8, 8, 8, 9, 9, 9, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2ga_p_txpowertrack_usb_8723d[] = {0, 0, 1, 1, 2, 2, 2, 3, 3, 4, 4, 5, 5, 6, 7, 7, 8, 8, 8, 9, 9, 10, 10, 10, 10, 10, 10, 10, 10, 10}; +u8 g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_usb_8723d[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_usb_8723d[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_usb_8723d[] = {0, 1, 1, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 6, 7, 7, 7, 8, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11}; +u8 g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_8723d[] = {0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7, 8, 9, 9, 10, 10, 11, 11, 11, 11, 11, 11, 11, 11, 11}; +#endif + +void +odm_read_and_config_mp_8723d_txpowertrack_usb( + struct PHY_DM_STRUCT *p_dm +) +{ +#if DEV_BUS_TYPE == RT_USB_INTERFACE + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> ODM_ReadAndConfig_MP_mp_8723d\n")); + + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2ga_p, g_delta_swing_table_idx_mp_2ga_p_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2ga_n, g_delta_swing_table_idx_mp_2ga_n_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2gb_p, g_delta_swing_table_idx_mp_2gb_p_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2gb_n, g_delta_swing_table_idx_mp_2gb_n_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_p, g_delta_swing_table_idx_mp_2g_cck_a_p_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_a_n, g_delta_swing_table_idx_mp_2g_cck_a_n_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_p, g_delta_swing_table_idx_mp_2g_cck_b_p_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_2g_cck_b_n, g_delta_swing_table_idx_mp_2g_cck_b_n_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE); + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5ga_p, g_delta_swing_table_idx_mp_5ga_p_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5ga_n, g_delta_swing_table_idx_mp_5ga_n_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5gb_p, g_delta_swing_table_idx_mp_5gb_p_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE*3); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_idx_5gb_n, g_delta_swing_table_idx_mp_5gb_n_txpowertrack_usb_8723d, DELTA_SWINGIDX_SIZE*3); +#endif +} + +/****************************************************************************** +* txpwr_lmt.TXT +******************************************************************************/ + +const char *array_mp_8723d_txpwr_lmt[] = { + "FCC", "2.4G", "20M", "CCK", "1T", "01", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "01", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "01", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "02", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "02", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "02", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "03", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "03", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "03", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "04", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "04", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "04", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "05", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "05", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "05", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "06", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "06", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "06", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "07", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "07", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "07", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "08", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "08", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "08", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "09", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "09", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "09", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "10", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "10", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "10", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "11", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "11", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "11", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "12", "30", + "ETSI", "2.4G", "20M", "CCK", "1T", "12", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "12", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "13", "17", + "ETSI", "2.4G", "20M", "CCK", "1T", "13", "30", + "MKK", "2.4G", "20M", "CCK", "1T", "13", "30", + "FCC", "2.4G", "20M", "CCK", "1T", "14", "63", + "ETSI", "2.4G", "20M", "CCK", "1T", "14", "63", + "MKK", "2.4G", "20M", "CCK", "1T", "14", "30", + "FCC", "2.4G", "20M", "OFDM", "1T", "01", "26", + "ETSI", "2.4G", "20M", "OFDM", "1T", "01", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "01", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "02", "28", + "ETSI", "2.4G", "20M", "OFDM", "1T", "02", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "02", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "03", "30", + "ETSI", "2.4G", "20M", "OFDM", "1T", "03", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "03", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "04", "30", + "ETSI", "2.4G", "20M", "OFDM", "1T", "04", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "04", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "05", "30", + "ETSI", "2.4G", "20M", "OFDM", "1T", "05", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "05", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "06", "30", + "ETSI", "2.4G", "20M", "OFDM", "1T", "06", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "06", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "07", "30", + "ETSI", "2.4G", "20M", "OFDM", "1T", "07", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "07", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "08", "30", + "ETSI", "2.4G", "20M", "OFDM", "1T", "08", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "08", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "09", "30", + "ETSI", "2.4G", "20M", "OFDM", "1T", "09", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "09", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "10", "28", + "ETSI", "2.4G", "20M", "OFDM", "1T", "10", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "10", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "11", "26", + "ETSI", "2.4G", "20M", "OFDM", "1T", "11", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "11", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "12", "24", + "ETSI", "2.4G", "20M", "OFDM", "1T", "12", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "12", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "13", "14", + "ETSI", "2.4G", "20M", "OFDM", "1T", "13", "31", + "MKK", "2.4G", "20M", "OFDM", "1T", "13", "31", + "FCC", "2.4G", "20M", "OFDM", "1T", "14", "63", + "ETSI", "2.4G", "20M", "OFDM", "1T", "14", "63", + "MKK", "2.4G", "20M", "OFDM", "1T", "14", "63", + "FCC", "2.4G", "20M", "HT", "1T", "01", "24", + "ETSI", "2.4G", "20M", "HT", "1T", "01", "31", + "MKK", "2.4G", "20M", "HT", "1T", "01", "31", + "FCC", "2.4G", "20M", "HT", "1T", "02", "26", + "ETSI", "2.4G", "20M", "HT", "1T", "02", "31", + "MKK", "2.4G", "20M", "HT", "1T", "02", "31", + "FCC", "2.4G", "20M", "HT", "1T", "03", "30", + "ETSI", "2.4G", "20M", "HT", "1T", "03", "31", + "MKK", "2.4G", "20M", "HT", "1T", "03", "31", + "FCC", "2.4G", "20M", "HT", "1T", "04", "30", + "ETSI", "2.4G", "20M", "HT", "1T", "04", "31", + "MKK", "2.4G", "20M", "HT", "1T", "04", "31", + "FCC", "2.4G", "20M", "HT", "1T", "05", "30", + "ETSI", "2.4G", "20M", "HT", "1T", "05", "31", + "MKK", "2.4G", "20M", "HT", "1T", "05", "31", + "FCC", "2.4G", "20M", "HT", "1T", "06", "30", + "ETSI", "2.4G", "20M", "HT", "1T", "06", "31", + "MKK", "2.4G", "20M", "HT", "1T", "06", "31", + "FCC", "2.4G", "20M", "HT", "1T", "07", "30", + "ETSI", "2.4G", "20M", "HT", "1T", "07", "31", + "MKK", "2.4G", "20M", "HT", "1T", "07", "31", + "FCC", "2.4G", "20M", "HT", "1T", "08", "30", + "ETSI", "2.4G", "20M", "HT", "1T", "08", "31", + "MKK", "2.4G", "20M", "HT", "1T", "08", "31", + "FCC", "2.4G", "20M", "HT", "1T", "09", "30", + "ETSI", "2.4G", "20M", "HT", "1T", "09", "31", + "MKK", "2.4G", "20M", "HT", "1T", "09", "31", + "FCC", "2.4G", "20M", "HT", "1T", "10", "26", + "ETSI", "2.4G", "20M", "HT", "1T", "10", "31", + "MKK", "2.4G", "20M", "HT", "1T", "10", "31", + "FCC", "2.4G", "20M", "HT", "1T", "11", "24", + "ETSI", "2.4G", "20M", "HT", "1T", "11", "31", + "MKK", "2.4G", "20M", "HT", "1T", "11", "31", + "FCC", "2.4G", "20M", "HT", "1T", "12", "23", + "ETSI", "2.4G", "20M", "HT", "1T", "12", "31", + "MKK", "2.4G", "20M", "HT", "1T", "12", "31", + "FCC", "2.4G", "20M", "HT", "1T", "13", "13", + "ETSI", "2.4G", "20M", "HT", "1T", "13", "31", + "MKK", "2.4G", "20M", "HT", "1T", "13", "31", + "FCC", "2.4G", "20M", "HT", "1T", "14", "63", + "ETSI", "2.4G", "20M", "HT", "1T", "14", "63", + "MKK", "2.4G", "20M", "HT", "1T", "14", "63", + "FCC", "2.4G", "20M", "HT", "2T", "01", "28", + "ETSI", "2.4G", "20M", "HT", "2T", "01", "30", + "MKK", "2.4G", "20M", "HT", "2T", "01", "30", + "FCC", "2.4G", "20M", "HT", "2T", "02", "28", + "ETSI", "2.4G", "20M", "HT", "2T", "02", "30", + "MKK", "2.4G", "20M", "HT", "2T", "02", "30", + "FCC", "2.4G", "20M", "HT", "2T", "03", "30", + "ETSI", "2.4G", "20M", "HT", "2T", "03", "30", + "MKK", "2.4G", "20M", "HT", "2T", "03", "30", + "FCC", "2.4G", "20M", "HT", "2T", "04", "30", + "ETSI", "2.4G", "20M", "HT", "2T", "04", "30", + "MKK", "2.4G", "20M", "HT", "2T", "04", "30", + "FCC", "2.4G", "20M", "HT", "2T", "05", "30", + "ETSI", "2.4G", "20M", "HT", "2T", "05", "30", + "MKK", "2.4G", "20M", "HT", "2T", "05", "30", + "FCC", "2.4G", "20M", "HT", "2T", "06", "30", + "ETSI", "2.4G", "20M", "HT", "2T", "06", "30", + "MKK", "2.4G", "20M", "HT", "2T", "06", "30", + "FCC", "2.4G", "20M", "HT", "2T", "07", "30", + "ETSI", "2.4G", "20M", "HT", "2T", "07", "30", + "MKK", "2.4G", "20M", "HT", "2T", "07", "30", + "FCC", "2.4G", "20M", "HT", "2T", "08", "30", + "ETSI", "2.4G", "20M", "HT", "2T", "08", "30", + "MKK", "2.4G", "20M", "HT", "2T", "08", "30", + "FCC", "2.4G", "20M", "HT", "2T", "09", "28", + "ETSI", "2.4G", "20M", "HT", "2T", "09", "30", + "MKK", "2.4G", "20M", "HT", "2T", "09", "30", + "FCC", "2.4G", "20M", "HT", "2T", "10", "28", + "ETSI", "2.4G", "20M", "HT", "2T", "10", "30", + "MKK", "2.4G", "20M", "HT", "2T", "10", "30", + "FCC", "2.4G", "20M", "HT", "2T", "11", "28", + "ETSI", "2.4G", "20M", "HT", "2T", "11", "30", + "MKK", "2.4G", "20M", "HT", "2T", "11", "30", + "FCC", "2.4G", "20M", "HT", "2T", "12", "63", + "ETSI", "2.4G", "20M", "HT", "2T", "12", "30", + "MKK", "2.4G", "20M", "HT", "2T", "12", "30", + "FCC", "2.4G", "20M", "HT", "2T", "13", "63", + "ETSI", "2.4G", "20M", "HT", "2T", "13", "30", + "MKK", "2.4G", "20M", "HT", "2T", "13", "30", + "FCC", "2.4G", "20M", "HT", "2T", "14", "63", + "ETSI", "2.4G", "20M", "HT", "2T", "14", "63", + "MKK", "2.4G", "20M", "HT", "2T", "14", "63", + "FCC", "2.4G", "40M", "HT", "1T", "01", "63", + "ETSI", "2.4G", "40M", "HT", "1T", "01", "63", + "MKK", "2.4G", "40M", "HT", "1T", "01", "63", + "FCC", "2.4G", "40M", "HT", "1T", "02", "63", + "ETSI", "2.4G", "40M", "HT", "1T", "02", "63", + "MKK", "2.4G", "40M", "HT", "1T", "02", "63", + "FCC", "2.4G", "40M", "HT", "1T", "03", "24", + "ETSI", "2.4G", "40M", "HT", "1T", "03", "30", + "MKK", "2.4G", "40M", "HT", "1T", "03", "30", + "FCC", "2.4G", "40M", "HT", "1T", "04", "24", + "ETSI", "2.4G", "40M", "HT", "1T", "04", "30", + "MKK", "2.4G", "40M", "HT", "1T", "04", "30", + "FCC", "2.4G", "40M", "HT", "1T", "05", "24", + "ETSI", "2.4G", "40M", "HT", "1T", "05", "30", + "MKK", "2.4G", "40M", "HT", "1T", "05", "30", + "FCC", "2.4G", "40M", "HT", "1T", "06", "24", + "ETSI", "2.4G", "40M", "HT", "1T", "06", "30", + "MKK", "2.4G", "40M", "HT", "1T", "06", "30", + "FCC", "2.4G", "40M", "HT", "1T", "07", "24", + "ETSI", "2.4G", "40M", "HT", "1T", "07", "30", + "MKK", "2.4G", "40M", "HT", "1T", "07", "30", + "FCC", "2.4G", "40M", "HT", "1T", "08", "24", + "ETSI", "2.4G", "40M", "HT", "1T", "08", "30", + "MKK", "2.4G", "40M", "HT", "1T", "08", "30", + "FCC", "2.4G", "40M", "HT", "1T", "09", "24", + "ETSI", "2.4G", "40M", "HT", "1T", "09", "30", + "MKK", "2.4G", "40M", "HT", "1T", "09", "30", + "FCC", "2.4G", "40M", "HT", "1T", "10", "22", + "ETSI", "2.4G", "40M", "HT", "1T", "10", "30", + "MKK", "2.4G", "40M", "HT", "1T", "10", "30", + "FCC", "2.4G", "40M", "HT", "1T", "11", "20", + "ETSI", "2.4G", "40M", "HT", "1T", "11", "30", + "MKK", "2.4G", "40M", "HT", "1T", "11", "30", + "FCC", "2.4G", "40M", "HT", "1T", "12", "63", + "ETSI", "2.4G", "40M", "HT", "1T", "12", "30", + "MKK", "2.4G", "40M", "HT", "1T", "12", "30", + "FCC", "2.4G", "40M", "HT", "1T", "13", "63", + "ETSI", "2.4G", "40M", "HT", "1T", "13", "30", + "MKK", "2.4G", "40M", "HT", "1T", "13", "30", + "FCC", "2.4G", "40M", "HT", "1T", "14", "63", + "ETSI", "2.4G", "40M", "HT", "1T", "14", "63", + "MKK", "2.4G", "40M", "HT", "1T", "14", "63", + "FCC", "2.4G", "40M", "HT", "2T", "01", "63", + "ETSI", "2.4G", "40M", "HT", "2T", "01", "63", + "MKK", "2.4G", "40M", "HT", "2T", "01", "63", + "FCC", "2.4G", "40M", "HT", "2T", "02", "63", + "ETSI", "2.4G", "40M", "HT", "2T", "02", "63", + "MKK", "2.4G", "40M", "HT", "2T", "02", "63", + "FCC", "2.4G", "40M", "HT", "2T", "03", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "03", "26", + "MKK", "2.4G", "40M", "HT", "2T", "03", "26", + "FCC", "2.4G", "40M", "HT", "2T", "04", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "04", "26", + "MKK", "2.4G", "40M", "HT", "2T", "04", "26", + "FCC", "2.4G", "40M", "HT", "2T", "05", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "05", "26", + "MKK", "2.4G", "40M", "HT", "2T", "05", "26", + "FCC", "2.4G", "40M", "HT", "2T", "06", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "06", "26", + "MKK", "2.4G", "40M", "HT", "2T", "06", "26", + "FCC", "2.4G", "40M", "HT", "2T", "07", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "07", "26", + "MKK", "2.4G", "40M", "HT", "2T", "07", "26", + "FCC", "2.4G", "40M", "HT", "2T", "08", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "08", "26", + "MKK", "2.4G", "40M", "HT", "2T", "08", "26", + "FCC", "2.4G", "40M", "HT", "2T", "09", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "09", "26", + "MKK", "2.4G", "40M", "HT", "2T", "09", "26", + "FCC", "2.4G", "40M", "HT", "2T", "10", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "10", "26", + "MKK", "2.4G", "40M", "HT", "2T", "10", "26", + "FCC", "2.4G", "40M", "HT", "2T", "11", "26", + "ETSI", "2.4G", "40M", "HT", "2T", "11", "26", + "MKK", "2.4G", "40M", "HT", "2T", "11", "26", + "FCC", "2.4G", "40M", "HT", "2T", "12", "63", + "ETSI", "2.4G", "40M", "HT", "2T", "12", "26", + "MKK", "2.4G", "40M", "HT", "2T", "12", "26", + "FCC", "2.4G", "40M", "HT", "2T", "13", "63", + "ETSI", "2.4G", "40M", "HT", "2T", "13", "26", + "MKK", "2.4G", "40M", "HT", "2T", "13", "26", + "FCC", "2.4G", "40M", "HT", "2T", "14", "63", + "ETSI", "2.4G", "40M", "HT", "2T", "14", "63", + "MKK", "2.4G", "40M", "HT", "2T", "14", "63", + "FCC", "5G", "20M", "OFDM", "1T", "36", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "36", "32", + "MKK", "5G", "20M", "OFDM", "1T", "36", "32", + "FCC", "5G", "20M", "OFDM", "1T", "40", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "40", "32", + "MKK", "5G", "20M", "OFDM", "1T", "40", "32", + "FCC", "5G", "20M", "OFDM", "1T", "44", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "44", "32", + "MKK", "5G", "20M", "OFDM", "1T", "44", "32", + "FCC", "5G", "20M", "OFDM", "1T", "48", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "48", "32", + "MKK", "5G", "20M", "OFDM", "1T", "48", "32", + "FCC", "5G", "20M", "OFDM", "1T", "52", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "52", "32", + "MKK", "5G", "20M", "OFDM", "1T", "52", "32", + "FCC", "5G", "20M", "OFDM", "1T", "56", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "56", "32", + "MKK", "5G", "20M", "OFDM", "1T", "56", "32", + "FCC", "5G", "20M", "OFDM", "1T", "60", "32", + "ETSI", "5G", "20M", "OFDM", "1T", "60", "32", + "MKK", "5G", "20M", "OFDM", "1T", "60", "32", + "FCC", "5G", "20M", "OFDM", "1T", "64", "28", + "ETSI", "5G", "20M", "OFDM", "1T", "64", "32", + "MKK", "5G", "20M", "OFDM", "1T", "64", "32", + "FCC", "5G", "20M", "OFDM", "1T", "100", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "100", "32", + "MKK", "5G", "20M", "OFDM", "1T", "100", "32", + "FCC", "5G", "20M", "OFDM", "1T", "114", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "114", "32", + "MKK", "5G", "20M", "OFDM", "1T", "114", "32", + "FCC", "5G", "20M", "OFDM", "1T", "108", "32", + "ETSI", "5G", "20M", "OFDM", "1T", "108", "32", + "MKK", "5G", "20M", "OFDM", "1T", "108", "32", + "FCC", "5G", "20M", "OFDM", "1T", "112", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "112", "32", + "MKK", "5G", "20M", "OFDM", "1T", "112", "32", + "FCC", "5G", "20M", "OFDM", "1T", "116", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "116", "32", + "MKK", "5G", "20M", "OFDM", "1T", "116", "32", + "FCC", "5G", "20M", "OFDM", "1T", "120", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "120", "32", + "MKK", "5G", "20M", "OFDM", "1T", "120", "32", + "FCC", "5G", "20M", "OFDM", "1T", "124", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "124", "32", + "MKK", "5G", "20M", "OFDM", "1T", "124", "32", + "FCC", "5G", "20M", "OFDM", "1T", "128", "32", + "ETSI", "5G", "20M", "OFDM", "1T", "128", "32", + "MKK", "5G", "20M", "OFDM", "1T", "128", "32", + "FCC", "5G", "20M", "OFDM", "1T", "132", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "132", "32", + "MKK", "5G", "20M", "OFDM", "1T", "132", "32", + "FCC", "5G", "20M", "OFDM", "1T", "136", "30", + "ETSI", "5G", "20M", "OFDM", "1T", "136", "32", + "MKK", "5G", "20M", "OFDM", "1T", "136", "32", + "FCC", "5G", "20M", "OFDM", "1T", "140", "28", + "ETSI", "5G", "20M", "OFDM", "1T", "140", "32", + "MKK", "5G", "20M", "OFDM", "1T", "140", "32", + "FCC", "5G", "20M", "OFDM", "1T", "149", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "149", "32", + "MKK", "5G", "20M", "OFDM", "1T", "149", "63", + "FCC", "5G", "20M", "OFDM", "1T", "153", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "153", "32", + "MKK", "5G", "20M", "OFDM", "1T", "153", "63", + "FCC", "5G", "20M", "OFDM", "1T", "157", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "157", "32", + "MKK", "5G", "20M", "OFDM", "1T", "157", "63", + "FCC", "5G", "20M", "OFDM", "1T", "161", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "161", "32", + "MKK", "5G", "20M", "OFDM", "1T", "161", "63", + "FCC", "5G", "20M", "OFDM", "1T", "165", "34", + "ETSI", "5G", "20M", "OFDM", "1T", "165", "32", + "MKK", "5G", "20M", "OFDM", "1T", "165", "63", + "FCC", "5G", "20M", "HT", "1T", "36", "30", + "ETSI", "5G", "20M", "HT", "1T", "36", "32", + "MKK", "5G", "20M", "HT", "1T", "36", "32", + "FCC", "5G", "20M", "HT", "1T", "40", "30", + "ETSI", "5G", "20M", "HT", "1T", "40", "32", + "MKK", "5G", "20M", "HT", "1T", "40", "32", + "FCC", "5G", "20M", "HT", "1T", "44", "30", + "ETSI", "5G", "20M", "HT", "1T", "44", "32", + "MKK", "5G", "20M", "HT", "1T", "44", "32", + "FCC", "5G", "20M", "HT", "1T", "48", "30", + "ETSI", "5G", "20M", "HT", "1T", "48", "32", + "MKK", "5G", "20M", "HT", "1T", "48", "32", + "FCC", "5G", "20M", "HT", "1T", "52", "34", + "ETSI", "5G", "20M", "HT", "1T", "52", "32", + "MKK", "5G", "20M", "HT", "1T", "52", "32", + "FCC", "5G", "20M", "HT", "1T", "56", "34", + "ETSI", "5G", "20M", "HT", "1T", "56", "32", + "MKK", "5G", "20M", "HT", "1T", "56", "32", + "FCC", "5G", "20M", "HT", "1T", "60", "32", + "ETSI", "5G", "20M", "HT", "1T", "60", "32", + "MKK", "5G", "20M", "HT", "1T", "60", "32", + "FCC", "5G", "20M", "HT", "1T", "64", "28", + "ETSI", "5G", "20M", "HT", "1T", "64", "32", + "MKK", "5G", "20M", "HT", "1T", "64", "32", + "FCC", "5G", "20M", "HT", "1T", "100", "30", + "ETSI", "5G", "20M", "HT", "1T", "100", "32", + "MKK", "5G", "20M", "HT", "1T", "100", "32", + "FCC", "5G", "20M", "HT", "1T", "114", "30", + "ETSI", "5G", "20M", "HT", "1T", "114", "32", + "MKK", "5G", "20M", "HT", "1T", "114", "32", + "FCC", "5G", "20M", "HT", "1T", "108", "32", + "ETSI", "5G", "20M", "HT", "1T", "108", "32", + "MKK", "5G", "20M", "HT", "1T", "108", "32", + "FCC", "5G", "20M", "HT", "1T", "112", "34", + "ETSI", "5G", "20M", "HT", "1T", "112", "32", + "MKK", "5G", "20M", "HT", "1T", "112", "32", + "FCC", "5G", "20M", "HT", "1T", "116", "34", + "ETSI", "5G", "20M", "HT", "1T", "116", "32", + "MKK", "5G", "20M", "HT", "1T", "116", "32", + "FCC", "5G", "20M", "HT", "1T", "120", "34", + "ETSI", "5G", "20M", "HT", "1T", "120", "32", + "MKK", "5G", "20M", "HT", "1T", "120", "32", + "FCC", "5G", "20M", "HT", "1T", "124", "34", + "ETSI", "5G", "20M", "HT", "1T", "124", "32", + "MKK", "5G", "20M", "HT", "1T", "124", "32", + "FCC", "5G", "20M", "HT", "1T", "128", "32", + "ETSI", "5G", "20M", "HT", "1T", "128", "32", + "MKK", "5G", "20M", "HT", "1T", "128", "32", + "FCC", "5G", "20M", "HT", "1T", "132", "30", + "ETSI", "5G", "20M", "HT", "1T", "132", "32", + "MKK", "5G", "20M", "HT", "1T", "132", "32", + "FCC", "5G", "20M", "HT", "1T", "136", "30", + "ETSI", "5G", "20M", "HT", "1T", "136", "32", + "MKK", "5G", "20M", "HT", "1T", "136", "32", + "FCC", "5G", "20M", "HT", "1T", "140", "28", + "ETSI", "5G", "20M", "HT", "1T", "140", "32", + "MKK", "5G", "20M", "HT", "1T", "140", "32", + "FCC", "5G", "20M", "HT", "1T", "149", "34", + "ETSI", "5G", "20M", "HT", "1T", "149", "32", + "MKK", "5G", "20M", "HT", "1T", "149", "63", + "FCC", "5G", "20M", "HT", "1T", "153", "34", + "ETSI", "5G", "20M", "HT", "1T", "153", "32", + "MKK", "5G", "20M", "HT", "1T", "153", "63", + "FCC", "5G", "20M", "HT", "1T", "157", "34", + "ETSI", "5G", "20M", "HT", "1T", "157", "32", + "MKK", "5G", "20M", "HT", "1T", "157", "63", + "FCC", "5G", "20M", "HT", "1T", "161", "34", + "ETSI", "5G", "20M", "HT", "1T", "161", "32", + "MKK", "5G", "20M", "HT", "1T", "161", "63", + "FCC", "5G", "20M", "HT", "1T", "165", "34", + "ETSI", "5G", "20M", "HT", "1T", "165", "32", + "MKK", "5G", "20M", "HT", "1T", "165", "63", + "FCC", "5G", "20M", "HT", "2T", "36", "28", + "ETSI", "5G", "20M", "HT", "2T", "36", "30", + "MKK", "5G", "20M", "HT", "2T", "36", "30", + "FCC", "5G", "20M", "HT", "2T", "40", "28", + "ETSI", "5G", "20M", "HT", "2T", "40", "30", + "MKK", "5G", "20M", "HT", "2T", "40", "30", + "FCC", "5G", "20M", "HT", "2T", "44", "28", + "ETSI", "5G", "20M", "HT", "2T", "44", "30", + "MKK", "5G", "20M", "HT", "2T", "44", "30", + "FCC", "5G", "20M", "HT", "2T", "48", "28", + "ETSI", "5G", "20M", "HT", "2T", "48", "30", + "MKK", "5G", "20M", "HT", "2T", "48", "30", + "FCC", "5G", "20M", "HT", "2T", "52", "34", + "ETSI", "5G", "20M", "HT", "2T", "52", "30", + "MKK", "5G", "20M", "HT", "2T", "52", "30", + "FCC", "5G", "20M", "HT", "2T", "56", "32", + "ETSI", "5G", "20M", "HT", "2T", "56", "30", + "MKK", "5G", "20M", "HT", "2T", "56", "30", + "FCC", "5G", "20M", "HT", "2T", "60", "30", + "ETSI", "5G", "20M", "HT", "2T", "60", "30", + "MKK", "5G", "20M", "HT", "2T", "60", "30", + "FCC", "5G", "20M", "HT", "2T", "64", "26", + "ETSI", "5G", "20M", "HT", "2T", "64", "30", + "MKK", "5G", "20M", "HT", "2T", "64", "30", + "FCC", "5G", "20M", "HT", "2T", "100", "28", + "ETSI", "5G", "20M", "HT", "2T", "100", "30", + "MKK", "5G", "20M", "HT", "2T", "100", "30", + "FCC", "5G", "20M", "HT", "2T", "114", "28", + "ETSI", "5G", "20M", "HT", "2T", "114", "30", + "MKK", "5G", "20M", "HT", "2T", "114", "30", + "FCC", "5G", "20M", "HT", "2T", "108", "30", + "ETSI", "5G", "20M", "HT", "2T", "108", "30", + "MKK", "5G", "20M", "HT", "2T", "108", "30", + "FCC", "5G", "20M", "HT", "2T", "112", "32", + "ETSI", "5G", "20M", "HT", "2T", "112", "30", + "MKK", "5G", "20M", "HT", "2T", "112", "30", + "FCC", "5G", "20M", "HT", "2T", "116", "32", + "ETSI", "5G", "20M", "HT", "2T", "116", "30", + "MKK", "5G", "20M", "HT", "2T", "116", "30", + "FCC", "5G", "20M", "HT", "2T", "120", "34", + "ETSI", "5G", "20M", "HT", "2T", "120", "30", + "MKK", "5G", "20M", "HT", "2T", "120", "30", + "FCC", "5G", "20M", "HT", "2T", "124", "32", + "ETSI", "5G", "20M", "HT", "2T", "124", "30", + "MKK", "5G", "20M", "HT", "2T", "124", "30", + "FCC", "5G", "20M", "HT", "2T", "128", "30", + "ETSI", "5G", "20M", "HT", "2T", "128", "30", + "MKK", "5G", "20M", "HT", "2T", "128", "30", + "FCC", "5G", "20M", "HT", "2T", "132", "28", + "ETSI", "5G", "20M", "HT", "2T", "132", "30", + "MKK", "5G", "20M", "HT", "2T", "132", "30", + "FCC", "5G", "20M", "HT", "2T", "136", "28", + "ETSI", "5G", "20M", "HT", "2T", "136", "30", + "MKK", "5G", "20M", "HT", "2T", "136", "30", + "FCC", "5G", "20M", "HT", "2T", "140", "26", + "ETSI", "5G", "20M", "HT", "2T", "140", "30", + "MKK", "5G", "20M", "HT", "2T", "140", "30", + "FCC", "5G", "20M", "HT", "2T", "149", "34", + "ETSI", "5G", "20M", "HT", "2T", "149", "30", + "MKK", "5G", "20M", "HT", "2T", "149", "63", + "FCC", "5G", "20M", "HT", "2T", "153", "34", + "ETSI", "5G", "20M", "HT", "2T", "153", "30", + "MKK", "5G", "20M", "HT", "2T", "153", "63", + "FCC", "5G", "20M", "HT", "2T", "157", "34", + "ETSI", "5G", "20M", "HT", "2T", "157", "30", + "MKK", "5G", "20M", "HT", "2T", "157", "63", + "FCC", "5G", "20M", "HT", "2T", "161", "34", + "ETSI", "5G", "20M", "HT", "2T", "161", "30", + "MKK", "5G", "20M", "HT", "2T", "161", "63", + "FCC", "5G", "20M", "HT", "2T", "165", "34", + "ETSI", "5G", "20M", "HT", "2T", "165", "30", + "MKK", "5G", "20M", "HT", "2T", "165", "63", + "FCC", "5G", "40M", "HT", "1T", "38", "30", + "ETSI", "5G", "40M", "HT", "1T", "38", "32", + "MKK", "5G", "40M", "HT", "1T", "38", "32", + "FCC", "5G", "40M", "HT", "1T", "46", "30", + "ETSI", "5G", "40M", "HT", "1T", "46", "32", + "MKK", "5G", "40M", "HT", "1T", "46", "32", + "FCC", "5G", "40M", "HT", "1T", "54", "32", + "ETSI", "5G", "40M", "HT", "1T", "54", "32", + "MKK", "5G", "40M", "HT", "1T", "54", "32", + "FCC", "5G", "40M", "HT", "1T", "62", "32", + "ETSI", "5G", "40M", "HT", "1T", "62", "32", + "MKK", "5G", "40M", "HT", "1T", "62", "32", + "FCC", "5G", "40M", "HT", "1T", "102", "28", + "ETSI", "5G", "40M", "HT", "1T", "102", "32", + "MKK", "5G", "40M", "HT", "1T", "102", "32", + "FCC", "5G", "40M", "HT", "1T", "110", "32", + "ETSI", "5G", "40M", "HT", "1T", "110", "32", + "MKK", "5G", "40M", "HT", "1T", "110", "32", + "FCC", "5G", "40M", "HT", "1T", "118", "34", + "ETSI", "5G", "40M", "HT", "1T", "118", "32", + "MKK", "5G", "40M", "HT", "1T", "118", "32", + "FCC", "5G", "40M", "HT", "1T", "126", "34", + "ETSI", "5G", "40M", "HT", "1T", "126", "32", + "MKK", "5G", "40M", "HT", "1T", "126", "32", + "FCC", "5G", "40M", "HT", "1T", "134", "32", + "ETSI", "5G", "40M", "HT", "1T", "134", "32", + "MKK", "5G", "40M", "HT", "1T", "134", "32", + "FCC", "5G", "40M", "HT", "1T", "151", "34", + "ETSI", "5G", "40M", "HT", "1T", "151", "32", + "MKK", "5G", "40M", "HT", "1T", "151", "63", + "FCC", "5G", "40M", "HT", "1T", "159", "34", + "ETSI", "5G", "40M", "HT", "1T", "159", "32", + "MKK", "5G", "40M", "HT", "1T", "159", "63", + "FCC", "5G", "40M", "HT", "2T", "38", "28", + "ETSI", "5G", "40M", "HT", "2T", "38", "30", + "MKK", "5G", "40M", "HT", "2T", "38", "30", + "FCC", "5G", "40M", "HT", "2T", "46", "28", + "ETSI", "5G", "40M", "HT", "2T", "46", "30", + "MKK", "5G", "40M", "HT", "2T", "46", "30", + "FCC", "5G", "40M", "HT", "2T", "54", "30", + "ETSI", "5G", "40M", "HT", "2T", "54", "30", + "MKK", "5G", "40M", "HT", "2T", "54", "30", + "FCC", "5G", "40M", "HT", "2T", "62", "30", + "ETSI", "5G", "40M", "HT", "2T", "62", "30", + "MKK", "5G", "40M", "HT", "2T", "62", "30", + "FCC", "5G", "40M", "HT", "2T", "102", "26", + "ETSI", "5G", "40M", "HT", "2T", "102", "30", + "MKK", "5G", "40M", "HT", "2T", "102", "30", + "FCC", "5G", "40M", "HT", "2T", "110", "30", + "ETSI", "5G", "40M", "HT", "2T", "110", "30", + "MKK", "5G", "40M", "HT", "2T", "110", "30", + "FCC", "5G", "40M", "HT", "2T", "118", "34", + "ETSI", "5G", "40M", "HT", "2T", "118", "30", + "MKK", "5G", "40M", "HT", "2T", "118", "30", + "FCC", "5G", "40M", "HT", "2T", "126", "32", + "ETSI", "5G", "40M", "HT", "2T", "126", "30", + "MKK", "5G", "40M", "HT", "2T", "126", "30", + "FCC", "5G", "40M", "HT", "2T", "134", "30", + "ETSI", "5G", "40M", "HT", "2T", "134", "30", + "MKK", "5G", "40M", "HT", "2T", "134", "30", + "FCC", "5G", "40M", "HT", "2T", "151", "34", + "ETSI", "5G", "40M", "HT", "2T", "151", "30", + "MKK", "5G", "40M", "HT", "2T", "151", "63", + "FCC", "5G", "40M", "HT", "2T", "159", "34", + "ETSI", "5G", "40M", "HT", "2T", "159", "30", + "MKK", "5G", "40M", "HT", "2T", "159", "63", + "FCC", "5G", "80M", "VHT", "1T", "42", "30", + "ETSI", "5G", "80M", "VHT", "1T", "42", "32", + "MKK", "5G", "80M", "VHT", "1T", "42", "32", + "FCC", "5G", "80M", "VHT", "1T", "58", "28", + "ETSI", "5G", "80M", "VHT", "1T", "58", "32", + "MKK", "5G", "80M", "VHT", "1T", "58", "32", + "FCC", "5G", "80M", "VHT", "1T", "106", "30", + "ETSI", "5G", "80M", "VHT", "1T", "106", "32", + "MKK", "5G", "80M", "VHT", "1T", "106", "32", + "FCC", "5G", "80M", "VHT", "1T", "122", "34", + "ETSI", "5G", "80M", "VHT", "1T", "122", "32", + "MKK", "5G", "80M", "VHT", "1T", "122", "32", + "FCC", "5G", "80M", "VHT", "1T", "155", "34", + "ETSI", "5G", "80M", "VHT", "1T", "155", "32", + "MKK", "5G", "80M", "VHT", "1T", "155", "63", + "FCC", "5G", "80M", "VHT", "2T", "42", "28", + "ETSI", "5G", "80M", "VHT", "2T", "42", "30", + "MKK", "5G", "80M", "VHT", "2T", "42", "30", + "FCC", "5G", "80M", "VHT", "2T", "58", "26", + "ETSI", "5G", "80M", "VHT", "2T", "58", "30", + "MKK", "5G", "80M", "VHT", "2T", "58", "30", + "FCC", "5G", "80M", "VHT", "2T", "106", "28", + "ETSI", "5G", "80M", "VHT", "2T", "106", "30", + "MKK", "5G", "80M", "VHT", "2T", "106", "30", + "FCC", "5G", "80M", "VHT", "2T", "122", "32", + "ETSI", "5G", "80M", "VHT", "2T", "122", "30", + "MKK", "5G", "80M", "VHT", "2T", "122", "30", + "FCC", "5G", "80M", "VHT", "2T", "155", "34", + "ETSI", "5G", "80M", "VHT", "2T", "155", "30", + "MKK", "5G", "80M", "VHT", "2T", "155", "63" +}; + +void +odm_read_and_config_mp_8723d_txpwr_lmt( + struct PHY_DM_STRUCT *p_dm +) +{ + u32 i = 0; +#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) + u32 array_len = sizeof(array_mp_8723d_txpwr_lmt)/sizeof(u8); + u8 *array = (u8 *)array_mp_8723d_txpwr_lmt; +#else + u32 array_len = sizeof(array_mp_8723d_txpwr_lmt)/sizeof(u8 *); + u8 **array = (u8 **)array_mp_8723d_txpwr_lmt; +#endif + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter = p_dm->adapter; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + + PlatformZeroMemory(p_hal_data->BufOfLinesPwrLmt, MAX_LINES_HWCONFIG_TXT*MAX_BYTES_LINE_HWCONFIG_TXT); + p_hal_data->nLinesReadPwrLmt = array_len/7; +#endif + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_read_and_config_mp_8723d_txpwr_lmt\n")); + + for (i = 0; i < array_len; i += 7) { +#if (DM_ODM_SUPPORT_TYPE == ODM_IOT) + u8 regulation = array[i]; + u8 band = array[i+1]; + u8 bandwidth = array[i+2]; + u8 rate = array[i+3]; + u8 rf_path = array[i+4]; + u8 chnl = array[i+5]; + u8 val = array[i+6]; +#else + u8 *regulation = array[i]; + u8 *band = array[i+1]; + u8 *bandwidth = array[i+2]; + u8 *rate = array[i+3]; + u8 *rf_path = array[i+4]; + u8 *chnl = array[i+5]; + u8 *val = array[i+6]; +#endif + + odm_config_bb_txpwr_lmt_8723d(p_dm, regulation, band, bandwidth, rate, rf_path, chnl, val); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + rsprintf((char *)p_hal_data->BufOfLinesPwrLmt[i/7], 100, "\"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\", \"%s\",", + regulation, band, bandwidth, rate, rf_path, chnl, val); +#endif + } + +} + +/****************************************************************************** +* txxtaltrack.TXT +******************************************************************************/ + +s8 g_delta_swing_table_xtal_mp_n_txxtaltrack_8723d[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}; +s8 g_delta_swing_table_xtal_mp_p_txxtaltrack_8723d[] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, -10, -12, -14, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16, -16}; + +void +odm_read_and_config_mp_8723d_txxtaltrack( + struct PHY_DM_STRUCT *p_dm +) +{ + struct odm_rf_calibration_structure *p_rf_calibrate_info = &(p_dm->rf_calibrate_info); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> ODM_ReadAndConfig_MP_mp_8723d\n")); + + + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_xtal_p, g_delta_swing_table_xtal_mp_p_txxtaltrack_8723d, DELTA_SWINGIDX_SIZE); + odm_move_memory(p_dm, p_rf_calibrate_info->delta_swing_table_xtal_n, g_delta_swing_table_xtal_mp_n_txxtaltrack_8723d, DELTA_SWINGIDX_SIZE); +} + +#endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.h index fee30d19a597..b97529bde8f8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halhwimg8723d_rf.h @@ -1,89 +1,84 @@ -/****************************************************************************** -* -* 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 -* -* -******************************************************************************/ - -/*Image2HeaderVersion: 2.26*/ -#if (RTL8723D_SUPPORT == 1) -#ifndef __INC_MP_RF_HW_IMG_8723D_H -#define __INC_MP_RF_HW_IMG_8723D_H - - -/****************************************************************************** -* RadioA.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_RadioA(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_RadioA(void); - -/****************************************************************************** -* TxPowerTrack_PCIE.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_TxPowerTrack_PCIE(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_PCIE(void); - -/****************************************************************************** -* TxPowerTrack_SDIO.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_TxPowerTrack_SDIO(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_SDIO(void); - -/****************************************************************************** -* TxPowerTrack_USB.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_TxPowerTrack_USB(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_TxPowerTrack_USB(void); - -/****************************************************************************** -* TXPWR_LMT.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_TXPWR_LMT(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_TXPWR_LMT(void); - -/****************************************************************************** -* TxXtalTrack.TXT -******************************************************************************/ - -void -ODM_ReadAndConfig_MP_8723D_TxXtalTrack(/* TC: Test Chip, MP: MP Chip*/ - IN PDM_ODM_T pDM_Odm -); -u4Byte ODM_GetVersion_MP_8723D_TxXtalTrack(void); - -#endif -#endif /* end of HWIMG_SUPPORT*/ - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +/*Image2HeaderVersion: 3.5.2*/ +#if (RTL8723D_SUPPORT == 1) +#ifndef __INC_MP_RF_HW_IMG_8723D_H +#define __INC_MP_RF_HW_IMG_8723D_H + + +/****************************************************************************** +* radioa.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_radioa(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_radioa(void); + +/****************************************************************************** +* txpowertrack_pcie.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_txpowertrack_pcie(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_txpowertrack_pcie(void); + +/****************************************************************************** +* txpowertrack_sdio.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_txpowertrack_sdio(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_txpowertrack_sdio(void); + +/****************************************************************************** +* txpowertrack_usb.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_txpowertrack_usb(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_txpowertrack_usb(void); + +/****************************************************************************** +* txpwr_lmt.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_txpwr_lmt(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_txpwr_lmt(void); + +/****************************************************************************** +* txxtaltrack.TXT +******************************************************************************/ + +void +odm_read_and_config_mp_8723d_txxtaltrack(/* tc: Test Chip, mp: mp Chip*/ + struct PHY_DM_STRUCT *p_dm +); +u32 odm_get_version_mp_8723d_txxtaltrack(void); + +#endif +#endif /* end of HWIMG_SUPPORT*/ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.c deleted file mode 100644 index edbef910c3ea..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.c +++ /dev/null @@ -1,4101 +0,0 @@ -/****************************************************************************** - * - * 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 "Mp_Precomp.h" -#include "../phydm_precomp.h" - - -#if (RTL8723D_SUPPORT == 1) - -/*---------------------------Define Local Constant---------------------------*/ -/*IQK*/ -#define IQK_DELAY_TIME_8723D 10 - -/* 2010/04/25 MH Define the max tx power tracking tx agc power.*/ -#define ODM_TXPWRTRACK_MAX_IDX_8723D 6 - -#define PATH_S1 0 -#define IDX_0xC94 0 -#define IDX_0xC80 1 -#define IDX_0xC4C 2 - -#define IDX_0xC14 0 -#define IDX_0xCA0 1 - - -#define PATH_S0 1 -#define IDX_0xCD0 0 -#define IDX_0xCD4 1 - -#define IDX_0xCD8 0 -#define IDX_0xCDC 1 - -#define KEY 0 -#define VAL 1 - - - -/*---------------------------Define Local Constant---------------------------*/ - - -/* Tx Power Tracking*/ - - -void setIqkMatrix_8723D( - PDM_ODM_T pDM_Odm, - u1Byte OFDM_index, - u1Byte RFPath, - s4Byte IqkResult_X, - s4Byte IqkResult_Y - ) - { - s4Byte ele_A = 0, ele_D = 0, ele_C = 0, value32, tmp; - s4Byte ele_A_ext = 0, ele_C_ext = 0, ele_D_ext = 0; - - if (OFDM_index >= OFDM_TABLE_SIZE) - OFDM_index = OFDM_TABLE_SIZE-1; - else if (OFDM_index < 0) - OFDM_index = 0; - - if ((IqkResult_X != 0) && (*(pDM_Odm->pBandType) == ODM_BAND_2_4G)) { - - /* new element D */ - ele_D = (OFDMSwingTable_New[OFDM_index] & 0xFFC00000)>>22; - ele_D_ext = (((IqkResult_X * ele_D)>>7)&0x01); - /* new element A */ - if ((IqkResult_X & 0x00000200) != 0) /* consider minus */ - IqkResult_X = IqkResult_X | 0xFFFFFC00; - ele_A = ((IqkResult_X * ele_D)>>8)&0x000003FF; - ele_A_ext = ((IqkResult_X * ele_D)>>7) & 0x1; - /* new element C */ - if ((IqkResult_Y & 0x00000200) != 0) - IqkResult_Y = IqkResult_Y | 0xFFFFFC00; - ele_C = ((IqkResult_Y * ele_D)>>8)&0x000003FF; - ele_C_ext = ((IqkResult_Y * ele_D)>>7) & 0x1; - - switch (RFPath) { - case ODM_RF_PATH_A: - /* write new elements A, C, D to regC80, regC94, reg0xc4c, and element B is always 0 */ - /* write 0xc80 */ - value32 = (ele_D << 22) | ((ele_C & 0x3F) << 16) | ele_A; - ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, value32); - /* write 0xc94 */ - value32 = (ele_C & 0x000003C0) >> 6; - ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, value32); - /* write 0xc4c */ - value32 = (ele_D_ext << 28) | (ele_A_ext << 31) | (ele_C_ext << 29); - value32 = (ODM_GetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord)&(~(BIT31|BIT29|BIT28))) | value32; - ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord, value32); - break; - - case ODM_RF_PATH_B: - /*wirte new elements A, C, D to regCd0 and regCd4, element B is always 0*/ - value32 = ele_D; - ODM_SetBBReg(pDM_Odm, 0xCd4, 0x007FE000, value32); - - value32 = ele_C; - ODM_SetBBReg(pDM_Odm, 0xCd4, 0x000007FE, value32); - - value32 = ele_A; - ODM_SetBBReg(pDM_Odm, 0xCd0, 0x000007FE, value32); - - ODM_SetBBReg(pDM_Odm, 0xCd4, BIT12, ele_D_ext); - ODM_SetBBReg(pDM_Odm, 0xCd0, BIT0, ele_A_ext); - ODM_SetBBReg(pDM_Odm, 0xCd4, BIT0, ele_C_ext); - break; - default: - break; - } - } else { - switch (RFPath) { - case ODM_RF_PATH_A: - ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord, OFDMSwingTable_New[OFDM_index]); - ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, bMaskH4Bits, 0x00); - value32 = ODM_GetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord)&(~(BIT31|BIT29|BIT28)); - ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, bMaskDWord, value32); - break; - - case ODM_RF_PATH_B: - /*image S1:c80 to S0:Cd0 and Cd4*/ - ODM_SetBBReg(pDM_Odm, 0xcd0, 0x000007FE, OFDMSwingTable_New[OFDM_index]&0x000003FF); - ODM_SetBBReg(pDM_Odm, 0xcd0, 0x0007E000, (OFDMSwingTable_New[OFDM_index]&0x0000FC00)>>10); - ODM_SetBBReg(pDM_Odm, 0xcd4, 0x0000007E, (OFDMSwingTable_New[OFDM_index]&0x003F0000)>>16); - ODM_SetBBReg(pDM_Odm, 0xcd4, 0x007FE000, (OFDMSwingTable_New[OFDM_index]&0xFFC00000)>>22); - - ODM_SetBBReg(pDM_Odm, 0xcd4, 0x00000780, 0x00); - - ODM_SetBBReg(pDM_Odm, 0xcd4, BIT12, 0x0); - ODM_SetBBReg(pDM_Odm, 0xcd4, BIT0, 0x0); - ODM_SetBBReg(pDM_Odm, 0xcd0, BIT0, 0x0); - break; - default: - break; - } - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("TxPwrTracking path %c: X = 0x%x, Y = 0x%x ele_A = 0x%x ele_C = 0x%x ele_D = 0x%x ele_A_ext = 0x%x ele_C_ext = 0x%x ele_D_ext = 0x%x\n", - (RFPath == ODM_RF_PATH_A ? 'A' : 'B'), (u4Byte)IqkResult_X, (u4Byte)IqkResult_Y, (u4Byte)ele_A, (u4Byte)ele_C, (u4Byte)ele_D, (u4Byte)ele_A_ext, (u4Byte)ele_C_ext, (u4Byte)ele_D_ext)); - } - -VOID -setCCKFilterCoefficient_8723D( - PDM_ODM_T pDM_Odm, - u1Byte CCKSwingIndex -) -{ - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[CCKSwingIndex]); -} - -void DoIQK_8723D( - PVOID pDM_VOID, - u1Byte DeltaThermalIndex, - u1Byte ThermalValue, - u1Byte Threshold - ) -{ - u4Byte bIsBtEnable = 0; - - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PADAPTER Adapter = pDM_Odm->Adapter; -#endif - - - if (pDM_Odm->mp_mode == FALSE) - bIsBtEnable = ODM_GetMACReg(pDM_Odm, 0xa8, bMaskDWord) & BIT17; - - if (bIsBtEnable) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Skip IQK because BT is enable\n")); - return; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Do IQK because BT is disable\n")); - } - - ODM_ResetIQKResult(pDM_Odm); - - pDM_Odm->RFCalibrateInfo.ThermalValue_IQK= ThermalValue; -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - PHY_IQCalibrate_8723D(pDM_Odm, FALSE); -#else - PHY_IQCalibrate_8723D(Adapter, FALSE); -#endif - -} - -/*----------------------------------------------------------------------------- - * Function: ODM_TxPwrTrackSetPwr_8723D() - * - * Overview: 8723D change all channel tx power accordign to flag. - * OFDM & CCK are all different. - * - * Input: NONE - * - * Output: NONE - * - * Return: NONE - * - * Revised History: - * When Who Remark - * 04/23/2012 MHC Create Version 0. - * - *---------------------------------------------------------------------------*/ -VOID -ODM_TxPwrTrackSetPwr_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PVOID pDM_VOID, -#else - IN PDM_ODM_T pDM_VOID, -#endif - PWRTRACK_METHOD Method, - u1Byte RFPath, - u1Byte ChannelMappedIndex - ) -{ - - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - PADAPTER Adapter = pDM_Odm->Adapter; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - u1Byte PwrTrackingLimit_OFDM = 30; - u1Byte PwrTrackingLimit_CCK = 40; - u1Byte TxRate = 0xFF; - u1Byte Final_OFDM_Swing_Index = 0; - u1Byte Final_CCK_Swing_Index = 0; - u1Byte i = 0; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) -#if (MP_DRIVER == 1) - PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); - - TxRate = MptToMgntRate(pMptCtx->MptRateIndex); -#else - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - if (!pMgntInfo->ForcedDataRate) { - if (pDM_Odm->TxRate != 0xFF) - TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); - } else { - TxRate = (u1Byte) pMgntInfo->ForcedDataRate; - } -#endif -#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - if (pDM_Odm->mp_mode == TRUE) { /*CE MP*/ - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); - - TxRate = MptToMgntRate(pMptCtx->MptRateIndex); - } else { /*CE normal*/ - u2Byte rate = *(pDM_Odm->pForcedDataRate); - - if (!rate) { /*auto rate*/ - if (pDM_Odm->TxRate != 0xFF) -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); -#elif (DM_ODM_SUPPORT_TYPE & (ODM_CE)) - if (pDM_Odm->number_linked_client != 0) - TxRate = HwRateToMRate(pDM_Odm->TxRate); -#endif - } else { /*force rate*/ - TxRate = (u1Byte)rate; - } - } -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD,("===>ODM_TxPwrTrackSetPwr8723DA\n")); - - if (TxRate != 0xFF) { - /*CCK*/ - if (((TxRate >= MGN_1M) && (TxRate <= MGN_5_5M)) || TxRate == MGN_11M) - PwrTrackingLimit_CCK = 40; - /*OFDM*/ - else if ((TxRate >= MGN_6M) && (TxRate <= MGN_48M)) - PwrTrackingLimit_OFDM = 36; - else if (TxRate == MGN_54M) - PwrTrackingLimit_OFDM = 34; - - /* HT*/ - else if ((TxRate >= MGN_MCS0) && (TxRate <= MGN_MCS2)) - PwrTrackingLimit_OFDM = 38; - else if ((TxRate >= MGN_MCS3) && (TxRate <= MGN_MCS4)) - PwrTrackingLimit_OFDM = 36; - else if ((TxRate >= MGN_MCS5) && (TxRate <= MGN_MCS7)) - PwrTrackingLimit_OFDM = 34; - - else if ((TxRate >= MGN_MCS8) && (TxRate <= MGN_MCS10)) - PwrTrackingLimit_OFDM = 38; - else if ((TxRate >= MGN_MCS11) && (TxRate <= MGN_MCS12)) - PwrTrackingLimit_OFDM = 36; - else if ((TxRate >= MGN_MCS13) && (TxRate <= MGN_MCS15)) - PwrTrackingLimit_OFDM = 34; - - else - PwrTrackingLimit_OFDM = pRFCalibrateInfo->DefaultOfdmIndex; /*Default OFDM index = 30 */ - } - - if (Method == TXAGC) { - u1Byte rf = 0; - u4Byte pwr = 0, TxAGC = 0; - PADAPTER Adapter = pDM_Odm->Adapter; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("odm_TxPwrTrackSetPwr_8723D CH=%d\n", *(pDM_Odm->pChannel))); - - pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; //Remnant index equal to aboslute compensate value. - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE )) - -#if (MP_DRIVER != 1) - /*PHY_SetTxPowerLevelByPath8723D(Adapter, pHalData->CurrentChannel, RFPath); //Using new set power function - //PHY_SetTxPowerLevel8723D(pDM_Odm->Adapter, *pDM_Odm->pChannel);*/ - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; - pRFCalibrateInfo->Modify_TxAGC_Flag_PathB = TRUE; - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; - if (RFPath == ODM_RF_PATH_A) { - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7 ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS8_MCS15 ); - } else { - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7 ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS8_MCS15 ); - } -#else - - if (RFPath == ODM_RF_PATH_A) { - /*CCK Path S1*/ - pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); - pwr += pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_A]; - PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pwr); - TxAGC = (pwr<<16)|(pwr<<8)|(pwr); - PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0x00ffffff, TxAGC); - RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: CCK Tx-rf(A) Power = 0x%x\n", TxAGC)); - - /*OFDM Path S1*/ - pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); - pwr += (pRFCalibrateInfo->BbSwingIdxOfdm[ODM_RF_PATH_A] - pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_A]); - TxAGC = ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); - PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs11_Mcs08, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs15_Mcs12, bMaskDWord, TxAGC); - RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); - } else if (RFPath == ODM_RF_PATH_B) { - - pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_Rate18_06, 0xFF); - pwr += pRFCalibrateInfo->PowerIndexOffset[ODM_RF_PATH_B]; - PHY_SetBBReg(Adapter, rTxAGC_B_CCK1_55_Mcs32, bMaskByte3, pwr); - PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0xff000000, pwr); - RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: CCK Tx-rf(B) Power = 0x%x\n", pwr)); - - - pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_Rate18_06, 0xFF); - pwr += (pRFCalibrateInfo->BbSwingIdxOfdm[ODM_RF_PATH_B] - pRFCalibrateInfo->BbSwingIdxOfdmBase[ODM_RF_PATH_B]); - TxAGC = ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); - PHY_SetBBReg(Adapter, rTxAGC_B_Rate18_06, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_B_Rate54_24, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_B_Mcs03_Mcs00, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_B_Mcs07_Mcs04, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_B_Mcs11_Mcs08, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_B_Mcs15_Mcs12, bMaskDWord, TxAGC); - RT_DISP(FPHY, PHY_TXPWR, ("ODM_TxPwrTrackSetPwr_8723D: OFDM Tx-rf(B) Power = 0x%x\n", TxAGC)); - } -#endif - -#endif -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - /*PHY_RF6052SetCCKTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel)); - //PHY_RF6052SetOFDMTxPower(pDM_Odm->priv, *(pDM_Odm->pChannel));*/ -#endif - - } else if (Method == BBSWING) { - Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; - Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - (" pRFCalibrateInfo->DefaultOfdmIndex=%d, pRFCalibrateInfo->DefaultCCKIndex=%d, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]=%d, pRFCalibrateInfo->Remnant_CCKSwingIdx=%d RF_Path = %d\n", - pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->DefaultCckIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], pRFCalibrateInfo->Remnant_CCKSwingIdx, RFPath)); - - /* Adjust BB swing by OFDM IQ matrix */ - if (Final_OFDM_Swing_Index >= PwrTrackingLimit_OFDM) - Final_OFDM_Swing_Index = PwrTrackingLimit_OFDM; - else if (Final_OFDM_Swing_Index < 0) - Final_OFDM_Swing_Index = 0; - - if (Final_CCK_Swing_Index >= CCK_TABLE_SIZE_8723D) - Final_CCK_Swing_Index = CCK_TABLE_SIZE_8723D-1; - else if (pRFCalibrateInfo->BbSwingIdxCck < 0) - Final_CCK_Swing_Index = 0; - - setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_A, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); - - setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); - - setCCKFilterCoefficient_8723D(pDM_Odm, Final_CCK_Swing_Index); - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; - - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Final_CCK_Swing_Index=%d\n", Final_CCK_Swing_Index)); - - } else if (Method == MIX_MODE) { - #if (MP_DRIVER == 1) - u4Byte TxAGC = 0; /*add by Mingzhi.Guo 2015-04-10*/ - s4Byte pwr = 0; - #endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("pDM_Odm->DefaultOfdmIndex=%d, pDM_Odm->DefaultCCKIndex=%d, pDM_Odm->Absolute_OFDMSwingIdx[RFPath]=%d, RF_Path = %d\n", - pRFCalibrateInfo->DefaultOfdmIndex, pRFCalibrateInfo->DefaultCckIndex, pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath], RFPath)); - - Final_OFDM_Swing_Index = pRFCalibrateInfo->DefaultOfdmIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; - - if (RFPath == ODM_RF_PATH_A) { - Final_CCK_Swing_Index = pRFCalibrateInfo->DefaultCckIndex + pRFCalibrateInfo->Absolute_OFDMSwingIdx[RFPath]; /*CCK Follow Path-A and lower CCK index means higher power.*/ - - if (Final_OFDM_Swing_Index > PwrTrackingLimit_OFDM) { - pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit_OFDM; - - setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_A, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); - setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_B, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; - - /*Set TxAGC Page C{};*/ - /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM);*/ - /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit_OFDM, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); - } else if (Final_OFDM_Swing_Index < 0) { - pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index ; - - setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_A, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); - setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_B, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; - - /*Set TxAGC Page C{};*/ - /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM);*/ - /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); - } else { - setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_A, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][0], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][1]); - setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); - - if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA) { - pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; - - /*Set TxAGC Page C{};*/ - /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7 ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS8_MCS15 );*/ - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); - } - } -#if (MP_DRIVER == 1) - if ((pDM_Odm->mp_mode) == 1) { - pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); - pwr += (pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_A] - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM); - - if (pwr > 0x3F) - pwr = 0x3F; - else if (pwr < 0) - pwr = 0; - - TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); - PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8188F: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); - - } else -#endif - { - - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, OFDM); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, HT_MCS0_MCS7); - } - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_A] ; - - if (Final_CCK_Swing_Index > PwrTrackingLimit_CCK) { - pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index - PwrTrackingLimit_CCK; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Over Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d \n", PwrTrackingLimit_CCK, pRFCalibrateInfo->Remnant_CCKSwingIdx)); - - /* Adjust BB swing by CCK filter coefficient*/ - ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[PwrTrackingLimit_CCK]); - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; - - /*Set TxAGC Page C{};*/ - /* PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK);*/ - - } else if (Final_CCK_Swing_Index < 0) { - pRFCalibrateInfo->Remnant_CCKSwingIdx = Final_CCK_Swing_Index; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Under Limit , PwrTrackingLimit_CCK = %d , pDM_Odm->Remnant_CCKSwingIdx = %d \n", 0, pRFCalibrateInfo->Remnant_CCKSwingIdx)); - - ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[0]); - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = TRUE; - - - /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK);*/ - - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A CCK Compensate with BBSwing , Final_CCK_Swing_Index = %d \n", Final_CCK_Swing_Index)); - - ODM_SetBBReg(pDM_Odm, 0xab4, 0x000007FF, CCKSwingTable_Ch1_Ch14_8723D[Final_CCK_Swing_Index]); - - /* if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK) {*/ - pRFCalibrateInfo->Remnant_CCKSwingIdx = 0; - - - /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK ); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, CCK );*/ - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA_CCK = FALSE; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_A pDM_Odm->Modify_TxAGC_Flag_CCK = FALSE \n")); - } -#if (MP_DRIVER == 1) - if ((pDM_Odm->mp_mode) == 1) { - pwr = PHY_QueryBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1); - pwr += pRFCalibrateInfo->Remnant_CCKSwingIdx-pRFCalibrateInfo->Modify_TxAGC_Value_CCK; - - if (pwr > 0x3F) - pwr = 0x3F; - else if (pwr < 0) - pwr = 0; - - PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, pwr); - TxAGC = (pwr<<16)|(pwr<<8)|(pwr); - PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, 0xffffff00, TxAGC); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: CCK Tx-rf(A) Power = 0x%x\n", TxAGC)); - } else -#endif - - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_A, pHalData->CurrentChannel, CCK); - - pRFCalibrateInfo->Modify_TxAGC_Value_CCK = pRFCalibrateInfo->Remnant_CCKSwingIdx; - } -#if 0 - if (RFPath == ODM_RF_PATH_B) { - if (Final_OFDM_Swing_Index > PwrTrackingLimit_OFDM) { - pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index - PwrTrackingLimit_OFDM; - - setIqkMatrix_8723D(pDM_Odm, PwrTrackingLimit_OFDM, ODM_RF_PATH_B, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; - - - /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Over BBSwing Limit , PwrTrackingLimit = %d , Remnant TxAGC Value = %d \n", PwrTrackingLimit_OFDM, pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); - } else if (Final_OFDM_Swing_Index < 0) { - pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = Final_OFDM_Swing_Index ; - - setIqkMatrix_8723D(pDM_Odm, 0, ODM_RF_PATH_B, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = TRUE; - - - /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Lower then BBSwing lower bound 0 , Remnant TxAGC Value = %d \n", pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath])); - } else { - setIqkMatrix_8723D(pDM_Odm, Final_OFDM_Swing_Index, ODM_RF_PATH_B, - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][4], - pRFCalibrateInfo->IQKMatrixRegSetting[ChannelMappedIndex].Value[0][5]); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B Compensate with BBSwing , Final_OFDM_Swing_Index = %d \n", Final_OFDM_Swing_Index)); - - if (pRFCalibrateInfo->Modify_TxAGC_Flag_PathB) { - pRFCalibrateInfo->Remnant_OFDMSwingIdx[RFPath] = 0; - - /*PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7);*/ - - pRFCalibrateInfo->Modify_TxAGC_Flag_PathA = FALSE; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("******Path_B pDM_Odm->Modify_TxAGC_Flag = FALSE \n")); - } - } -#if (MP_DRIVER == 1) - if ((pDM_Odm->mp_mode) == 1) { - pwr = PHY_QueryBBReg(Adapter, rTxAGC_A_Rate18_06, 0xFF); - pwr += (pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_B] - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM); - - if (pwr > 0x3F) - pwr = 0x3F; - else if (pwr < 0) - pwr = 0; - - TxAGC |= ((pwr<<24)|(pwr<<16)|(pwr<<8)|pwr); - PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskDWord, TxAGC); - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskDWord, TxAGC); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("ODM_TxPwrTrackSetPwr8723D: OFDM Tx-rf(A) Power = 0x%x\n", TxAGC)); - - } else -#endif - { - - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, OFDM); - PHY_SetTxPowerIndexByRateSection(Adapter, ODM_RF_PATH_B, pHalData->CurrentChannel, HT_MCS0_MCS7); - } - pRFCalibrateInfo->Modify_TxAGC_Value_OFDM = pRFCalibrateInfo->Remnant_OFDMSwingIdx[ODM_RF_PATH_B] ; - } -#endif -} else { - return; - } -} - -VOID -GetDeltaSwingTable_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PVOID pDM_VOID, -#else - IN PDM_ODM_T pDM_Odm, -#endif - OUT pu1Byte *TemperatureUP_A, - OUT pu1Byte *TemperatureDOWN_A, - OUT pu1Byte *TemperatureUP_B, - OUT pu1Byte *TemperatureDOWN_B - ) -{ -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PADAPTER Adapter = pDM_Odm->Adapter; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u1Byte TxRate = 0xFF; - u1Byte channel = pHalData->CurrentChannel; - - if (pDM_Odm->mp_mode == TRUE) { - #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN | ODM_CE)) - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - #if (MP_DRIVER == 1) - PMPT_CONTEXT pMptCtx = &(Adapter->MptCtx); - - TxRate = MptToMgntRate(pMptCtx->MptRateIndex); - #endif - #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - PMPT_CONTEXT pMptCtx = &(Adapter->mppriv.MptCtx); - - TxRate = MptToMgntRate(pMptCtx->MptRateIndex); - #endif - #endif - } else { - u2Byte rate = *(pDM_Odm->pForcedDataRate); - - if (!rate) { /*auto rate*/ - if (rate != 0xFF) { - #if (DM_ODM_SUPPORT_TYPE & ODM_WIN) - TxRate = Adapter->HalFunc.GetHwRateFromMRateHandler(pDM_Odm->TxRate); - #elif (DM_ODM_SUPPORT_TYPE & ODM_CE) - if (pDM_Odm->number_linked_client != 0) - TxRate = HwRateToMRate(pDM_Odm->TxRate); - #endif - } - } else { /*force rate*/ - TxRate = (u1Byte)rate; - } - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, ("Power Tracking TxRate=0x%X\n", TxRate)); - - if ( 1 <= channel && channel <= 14) { - if (IS_CCK_RATE(TxRate)) { - *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_P; - *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKA_N; - *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_P; - *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GCCKB_N; - } else { - *TemperatureUP_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_P; - *TemperatureDOWN_A = pRFCalibrateInfo->DeltaSwingTableIdx_2GA_N; - *TemperatureUP_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_P; - *TemperatureDOWN_B = pRFCalibrateInfo->DeltaSwingTableIdx_2GB_N; - } - } else { - *TemperatureUP_A = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; - *TemperatureDOWN_A = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; - *TemperatureUP_B = (pu1Byte)DeltaSwingTableIdx_2GA_P_8188E; - *TemperatureDOWN_B = (pu1Byte)DeltaSwingTableIdx_2GA_N_8188E; - } - - return; -} - -VOID -GetDeltaSwingXtalTable_8723D( - PVOID pDM_VOID, - ps1Byte *TemperatureUP_Xtal, - ps1Byte *TemperatureDOWN_Xtal -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - - *TemperatureUP_Xtal = pRFCalibrateInfo->DeltaSwingTableXtal_P; - *TemperatureDOWN_Xtal = pRFCalibrateInfo->DeltaSwingTableXtal_N; -} - - - -VOID -ODM_TxXtalTrackSetXtal_8723D( - PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PODM_RF_CAL_T pRFCalibrateInfo = &(pDM_Odm->RFCalibrateInfo); - PADAPTER Adapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - - s1Byte CrystalCap; - - - CrystalCap = pHalData->CrystalCap & 0x3F; - CrystalCap = CrystalCap + pRFCalibrateInfo->XtalOffset; - - if (CrystalCap < 0) - CrystalCap = 0; - else if (CrystalCap > 63) - CrystalCap = 63; - - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("CrystalCap(%d)= pHalData->CrystalCap(%d) + pRFCalibrateInfo->XtalOffset(%d)\n", CrystalCap, pHalData->CrystalCap, pRFCalibrateInfo->XtalOffset)); - - ODM_SetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000, (CrystalCap | (CrystalCap << 6))); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_TX_PWR_TRACK, ODM_DBG_LOUD, - ("CrystalCap(0x2c) 0x%X\n", ODM_GetBBReg(pDM_Odm, REG_MAC_PHY_CTRL, 0xFFF000))); - -} - -void ConfigureTxpowerTrack_8723D( - PTXPWRTRACK_CFG pConfig - ) -{ - pConfig->SwingTableSize_CCK = CCK_TABLE_SIZE_8723D; - pConfig->SwingTableSize_OFDM = OFDM_TABLE_SIZE; - pConfig->Threshold_IQK = IQK_THRESHOLD; - pConfig->AverageThermalNum = AVG_THERMAL_NUM_8723D; - pConfig->RfPathCount = MAX_PATH_NUM_8723D; - pConfig->ThermalRegAddr = RF_T_METER_88E; - - pConfig->ODM_TxPwrTrackSetPwr = ODM_TxPwrTrackSetPwr_8723D; - pConfig->DoIQK = DoIQK_8723D; - pConfig->PHY_LCCalibrate = PHY_LCCalibrate_8723D; - pConfig->GetDeltaSwingTable = GetDeltaSwingTable_8723D; - pConfig->GetDeltaSwingXtalTable = GetDeltaSwingXtalTable_8723D; - pConfig->ODM_TxXtalTrackSetXtal = ODM_TxXtalTrackSetXtal_8723D; -} - - -#define MAX_TOLERANCE 5 -#define IQK_DELAY_TIME 1 - -u1Byte -phy_PathS1_IQK_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN configPathS0 - ) -{ - u4Byte regEAC, regE94, regE9C, tmp, Path_SEL_BB/*, regEA4*/; - u1Byte result = 0x00, Ktime; - u4Byte originalPath, originalGNT; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#endif -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 TXIQK!!\n")); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 TXIQK = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); - /*save RF path*/ - Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 TXIQK = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000000); - - /*IQK setting*/ - /*leave IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - /* --- \A7\EF\BCgTXIQK mode table ---//*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00004); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005d); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xBFFE0); - - /*path-A IQK setting*/ - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x08008c0c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x8214019f); - ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160200); - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - - /*LO calibration setting*/ - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); - - /*PA, PAD setting*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x600, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x1E0, 0x3); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8d, 0x1F, 0xf); - - /*LOK setting added for 8723D*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, 0x10, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x54, 0x1, 0x1); -#if 1 - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe0d); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x60d); -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); - - /*enter IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - -#if 1 - /*backup Path & GNT value */ - originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); - ODM_delay_ms(1); - originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); - - /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -#endif - - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); - ODM_delay_ms(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); - - /*One shot, Path S1 LOK & IQK*/ - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xfa000000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - /* delay x ms */ - /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ - - Ktime = 0; - while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { - ODM_delay_ms(1); - Ktime++; - } - -#if 1 - /*Restore GNT_WL/GNT_BT and Path owner*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -#endif - - - /*reload RF path*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); - - /*leave IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - /*PA/PAD controlled by 0x0*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); - - /* Check failed*/ - regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); - regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); - regE9C = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); - /*monitor image power before & after IQK*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", - ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); - - if (!(regEAC & BIT28) && - (((regE94 & 0x03FF0000)>>16) != 0x142) && - (((regE9C & 0x03FF0000)>>16) != 0x42)) - - result |= 0x01; - else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 TXIQK FAIL\n")); - - - return result; - - } - -u1Byte -phy_PathS1_RxIQK_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN configPathS0 - ) -{ - u4Byte regEAC, regE94, regE9C, regEA4, u4tmp, tmp, Path_SEL_BB; - u1Byte result = 0x00, Ktime; - u4Byte originalPath, originalGNT; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#endif -#endif - - Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 RXIQK Step1!!\n")); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK1 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000000); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK1 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6))); */ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - /*IQK setting*/ - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - - /*path-A IQK setting*/ - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - - ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160000); - ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); - - /*LO calibration setting*/ - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); - - /*modify RXIQK mode table*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xef, bRFRegOffsetMask, 0x80000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00006); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xa7ffb); - - /*---------PA/PAD=0----------*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x56, 0x600, 0x0); -#if 1 - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe0d); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x60d); -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1@ Path S1 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2@ Path S1 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); - - /*enter IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - -#if 1 - /*backup Path & GNT value */ - originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); - ODM_delay_ms(1); - originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); - - /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -#endif - - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); - ODM_delay_ms(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); - - /*One shot, Path S1 LOK & IQK*/ - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - /*delay x ms*/ - /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ - - Ktime = 0; - while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { - ODM_delay_ms(1); - Ktime++; - } - - - regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); - regE94 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); - regE9C = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94 = 0x%x, 0xe9c = 0x%x\n", regE94, regE9C)); - /*monitor image power before & after IQK*/ - ODM_RT_TRACE(pDM_Odm , ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90(before IQK)= 0x%x, 0xe98(afer IQK) = 0x%x\n", - ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); - - - tmp = (regE9C & 0x03FF0000)>>16; - if ((tmp & 0x200) > 0) - tmp = 0x400 - tmp; - - if (!(regEAC & BIT28) && - (((regE94 & 0x03FF0000)>>16) != 0x142) && - (((regE9C & 0x03FF0000)>>16) != 0x42)) - - result |= 0x01; - else { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP1 FAIL\n")); -#if 1 - /*Restore GNT_WL/GNT_BT and Path owner*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -#endif - /*reload RF path*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); - return result; - } - - u4tmp = 0x80007C00 | (regE94&0x3FF0000) | ((regE9C&0x3FF0000) >> 16); - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, u4tmp); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40 = 0x%x u4tmp = 0x%x\n", ODM_GetBBReg(pDM_Odm, rTx_IQK, bMaskDWord), u4tmp)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S1 RXIQK STEP2!!\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S1 RXIQK2 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S1 RXIQK2 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6))); */ - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - - ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82170000); - ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28171400); - - /*LO calibration setting*/ - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); - - - /*modify RXIQK mode table*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00007); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xb3fdb); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S1 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S1 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); - - /*enter IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - -#if 1 - /*backup Path & GNT value */ - originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); - ODM_delay_ms(1); - originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); - - /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -#endif - - - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); - ODM_delay_ms(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S1 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S1 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); - - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - - /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ - - Ktime = 0; - while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { - ODM_delay_ms(1); - Ktime++; - } - -#if 1 - /*Restore GNT_WL/GNT_BT and Path owner*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -#endif - - - /*reload RF path*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); - - /*leave IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - /* PA/PAD controlled by 0x0*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xdf, 0x800, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); - - regEAC = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); - regEA4 = ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac = 0x%x\n", regEAC)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4 = 0x%x, 0xeac = 0x%x\n", regEA4, regEAC)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0(before IQK)= 0x%x, 0xea8(afer IQK) = 0x%x\n", - ODM_GetBBReg(pDM_Odm, 0xea0, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xea8, bMaskDWord))); - - - tmp = (regEAC & 0x03FF0000)>>16; - if ((tmp & 0x200) > 0) - tmp = 0x400 - tmp; - - if (!(regEAC & BIT27) && /*if Tx is OK, check whether Rx is OK*/ - (((regEA4 & 0x03FF0000)>>16) != 0x132) && - (((regEAC & 0x03FF0000)>>16) != 0x36) && - (((regEA4 & 0x03FF0000)>>16) < 0x11a) && - (((regEA4 & 0x03FF0000)>>16) > 0xe6) && - (tmp < 0x1a)) - result |= 0x02; - else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S1 RXIQK STEP2 FAIL\n")); - - - return result; -} - - -u1Byte -phy_PathS0_IQK_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER pAdapter -#endif - ) -{ - u4Byte regEA4, regEAC, regE94, regE9C, regE94_S0, regE9C_S0, regEA4_S0, regEAC_S0, tmp, Path_SEL_BB; - u1Byte result = 0x00, Ktime; - u4Byte originalPath, originalGNT; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 TXIQK!\n")); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 TXIQK = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); - Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); - - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000280); /*10 od 0x948 0x1 [7] ; WL:S1 to S0;BT:S0 to S1;*/ - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 TXIQK = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - /*modify TXIQK mode table*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, bRFRegOffsetMask, 0x80000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00004); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005d); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xBFFE0); - - /*path-A IQK setting*/ - ODM_SetBBReg(pDM_Odm, 0xe30, bMaskDWord, 0x08008c0c); - ODM_SetBBReg(pDM_Odm, 0xe34, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, 0xe38, bMaskDWord, 0x8214018a); - ODM_SetBBReg(pDM_Odm, 0xe3c, bMaskDWord, 0x28160200); - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - - /*LO calibration setting*/ - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x00462911); - - /*PA, PAD setting*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x600, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x1E0, 0x3); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x8d, 0x1F, 0xf); - - /*LOK setting added for 8723D*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, 0x10, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x64, 0x1, 0x1); - -#if 1 - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe6d); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x66d); -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 TXIQK = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); - - - /*enter IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - -#if 1 - /*backup Path & GNT value */ - originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); - ODM_delay_ms(1); - originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); - - /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -#endif - - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); - ODM_delay_ms(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 TXIQK = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); - - /*One shot, Path S1 LOK & IQK*/ - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - /*delay x ms*/ - /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ - - Ktime = 0; - while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { - ODM_delay_ms(1); - Ktime++; - } - -#if 1 - /*Restore GNT_WL/GNT_BT and Path owner*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -#endif - - - /*reload RF path*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); - - /*leave IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - /*PA/PAD controlled by 0x0*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); - - /* Check failed*/ - regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); - regE94_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); - regE9C_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", regE94_S0, regE9C_S0)); - /*monitor image power before & after IQK*/ - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", - ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); - - if (!(regEAC_S0 & BIT28) && - (((regE94_S0 & 0x03FF0000)>>16) != 0x142) && - (((regE9C_S0 & 0x03FF0000)>>16) != 0x42)) - - result |= 0x01; - else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 TXIQK FAIL\n")); - - return result; -} - - - -u1Byte -phy_PathS0_RxIQK_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN configPathS0 - ) -{ - u4Byte regE94, regE9C, regEA4, regEAC, regE94_S0, regE9C_S0, regEA4_S0, regEAC_S0, tmp, u4tmp, Path_SEL_BB; - u1Byte result = 0x00, Ktime; - u4Byte originalPath, originalGNT; - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - - Path_SEL_BB = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 RxIQK Step1!!\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK1 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, 0x99000280); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK1 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x18008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - - ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82160000); - ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28160000); - - - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a911); - - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, bRFRegOffsetMask, 0x80000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00006); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xa7ffb); - - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x66, 0x600, 0x0); - -#if 1 - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask, 0xe6d); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask, 0x66d); -#endif - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK1 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - -#if 1 - /*backup Path & GNT value */ - originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); - ODM_delay_ms(1); - originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); - - /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -#endif - - - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); - ODM_delay_ms(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK1 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); - - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - - /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ - - Ktime = 0; - while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { - ODM_delay_ms(1); - Ktime++; - } - - regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); - regE94_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord); - regE9C_S0 = ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe94_s0 = 0x%x, 0xe9c_s0 = 0x%x\n", regE94_S0, regE9C_S0)); - /*monitor image power before & after IQK*/ - ODM_RT_TRACE(pDM_Odm , ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe90_s0(before IQK)= 0x%x, 0xe98_s0(afer IQK) = 0x%x\n", - ODM_GetBBReg(pDM_Odm, 0xe90, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xe98, bMaskDWord))); - - - tmp = (regE9C_S0 & 0x03FF0000)>>16; - if ((tmp & 0x200) > 0) - tmp = 0x400 - tmp; - - if (!(regEAC_S0 & BIT28) && - (((regE94_S0 & 0x03FF0000)>>16) != 0x142) && - (((regE9C_S0 & 0x03FF0000)>>16) != 0x42)) - - result |= 0x01; - else { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP1 FAIL\n")); -#if 1 - /*Restore GNT_WL/GNT_BT and Path owner*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -#endif - - /*reload RF path*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); - return result; - } - - u4tmp = 0x80007C00 | (regE94_S0&0x3FF0000) | ((regE9C_S0&0x3FF0000) >> 16); - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, u4tmp); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xe40_s0 = 0x%x u4tmp = 0x%x\n", ODM_GetBBReg(pDM_Odm, rTx_IQK, bMaskDWord), u4tmp)); - - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]Path S0 RXIQK STEP2!!\n\n")); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x67 @S0 RXIQK2 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]0x1e6@S0 RXIQK2 = 0x%x\n", PlatformEFIORead1Byte(pAdapter, 0x1e6)));*/ - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x18008c1c); - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x38008c1c); - - ODM_SetBBReg(pDM_Odm, rTx_IQK_PI_A, bMaskDWord, 0x82170000); - ODM_SetBBReg(pDM_Odm, rRx_IQK_PI_A, bMaskDWord, 0x28171400); - - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Rsp, bMaskDWord, 0x0046a8d1); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xee, 0x80000, 0x1); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x33, bRFRegOffsetMask, 0x00007); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3e, bRFRegOffsetMask, 0x0005f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x3f, bRFRegOffsetMask, 0xb3fdb); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x1 @S0 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, bRFRegOffsetMask))); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("RF0x2 @S0 RXIQK2 = 0x%x\n", ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, bRFRegOffsetMask))); - /*enter IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - -#if 1 - /*backup Path & GNT value */ - originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); - ODM_delay_ms(1); - originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); - - /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -#endif - - - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0054); - ODM_delay_ms(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]GNT_BT @S0 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord))); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0x948 @S0 RXIQK2 = 0x%x\n", ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord))); - - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf9000000); - ODM_SetBBReg(pDM_Odm, rIQK_AGC_Pts, bMaskDWord, 0xf8000000); - - - /*ODM_delay_ms(IQK_DELAY_TIME_8723D);*/ - Ktime = 0; - while ((!ODM_GetBBReg(pDM_Odm, 0xeac, BIT26)) && Ktime < 10) { - ODM_delay_ms(1); - Ktime++; - } - -#if 1 - /*Restore GNT_WL/GNT_BT and Path owner*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); -#endif - - /*reload RF path*/ - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB); - - /*leave IQK mode*/ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0xde, 0x800, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x2, BIT0, 0x0); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x1, BIT0, 0x0); - - regEAC_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord); - regEA4_S0 = ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xeac_s0 = 0x%x\n", regEAC_S0)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea4_s0 = 0x%x, 0xeac_s0 = 0x%x\n", regEA4_S0, regEAC_S0)); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xea0_s0(before IQK)= 0x%x, 0xea8_s0(afer IQK) = 0x%x\n", - ODM_GetBBReg(pDM_Odm, 0xea0, bMaskDWord), ODM_GetBBReg(pDM_Odm, 0xea8, bMaskDWord))); - - - tmp = (regEAC_S0 & 0x03FF0000)>>16; - if ((tmp & 0x200) > 0) - tmp = 0x400 - tmp; - - if (!(regEAC_S0 & BIT27) && /*if Tx is OK, check whether Rx is OK*/ - (((regEA4_S0 & 0x03FF0000)>>16) != 0x132) && - (((regEAC_S0 & 0x03FF0000)>>16) != 0x36) && - (((regEA4_S0 & 0x03FF0000)>>16) < 0x11a) && - (((regEA4_S0 & 0x03FF0000)>>16) > 0xe6) && - (tmp < 0x1a)) - result |= 0x02; - else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("S0 RXIQK STEP2 FAIL\n")); - - - return result; -} - - -VOID -_PHY_PathS1FillIQKMatrix_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN bIQKOK, - IN s4Byte result[][8], - IN u1Byte final_candidate, - IN BOOLEAN bTxOnly - ) - { - u4Byte Oldval_1, X, TX1_A, reg; - s4Byte Y, TX1_C; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#endif -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 IQ Calibration %s !\n", (bIQKOK) ? "Success" : "Failed")); - - if (final_candidate == 0xFF) - return; - - else if (bIQKOK) { - Oldval_1 = (ODM_GetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, bMaskDWord) >> 22) & 0x3FF; - - X = result[final_candidate][0]; - - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX1_A = (X * Oldval_1) >> 8; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX1_A = 0x%x, Oldval_1 0x%x\n", X, TX1_A, Oldval_1)); - ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x3FF, TX1_A); - - ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(31), ((X * Oldval_1 >> 7) & 0x1)); - - Y = result[final_candidate][1]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - TX1_C = (Y * Oldval_1) >> 8; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX1_C = 0x%x\n", Y, TX1_C)); - ODM_SetBBReg(pDM_Odm, rOFDM0_XCTxAFE, 0xF0000000, ((TX1_C & 0x3C0) >> 6)); - ODM_SetBBReg(pDM_Odm, rOFDM0_XATxIQImbalance, 0x003F0000, (TX1_C & 0x3F)); - - ODM_SetBBReg(pDM_Odm, rOFDM0_ECCAThreshold, BIT(29), ((Y * Oldval_1 >> 7) & 0x1)); - - if (bTxOnly) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("_PHY_PathS1FillIQKMatrix_8723D only Tx OK\n")); - return; - } - reg = result[final_candidate][2]; -#if (DM_ODM_SUPPORT_TYPE == ODM_AP) - if (RTL_ABS(reg , 0x100) >= 16) - reg = 0x100; -#endif - ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0x3FF, reg); - - reg = result[final_candidate][3] & 0x3F; - ODM_SetBBReg(pDM_Odm, rOFDM0_XARxIQImbalance, 0xFC00, reg); - - reg = (result[final_candidate][3] >> 6) & 0xF; - ODM_SetBBReg(pDM_Odm, rOFDM0_RxIQExtAnta, 0xF0000000, reg); -/* -10 os 7201 10 -10 id ea4 [25:16] p -10 os 7202 10 -10 od c14 VarFromTmp [9:0] p - -10 os 7201 11 -10 id eac [25:22] p -10 os 7202 11 -10 od ca0 VarFromTmp [31:28] p - -10 os 7201 12 -10 id eac [21:16] p -10 os 7202 12 -10 od c14 VarFromTmp [15:10] p -*/ - } - } - -VOID -_PHY_PathS0FillIQKMatrix_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN bIQKOK, - IN s4Byte result[][8], - IN u1Byte final_candidate, - IN BOOLEAN bTxOnly - ) -{ - u4Byte Oldval_0, X, TX0_A, reg; - s4Byte Y, TX0_C; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 IQ Calibration %s !\n", (bIQKOK)?"Success":"Failed")); - - if (final_candidate == 0xFF) - return; - - else if (bIQKOK) { - Oldval_0 = (ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord) >> 13) & 0x3FF; - - X = result[final_candidate][4]; - if ((X & 0x00000200) != 0) - X = X | 0xFFFFFC00; - TX0_A = (X * Oldval_0) >> 8; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("X = 0x%x, TX0_A = 0x%x, Oldval_0 0x%x\n", X, TX0_A, Oldval_0)); - ODM_SetBBReg(pDM_Odm, 0xcd0, 0x7FE, TX0_A); - - ODM_SetBBReg(pDM_Odm, 0xcd0, BIT(0), ((X * Oldval_0>>7) & 0x1)); - - Y = result[final_candidate][5]; - if ((Y & 0x00000200) != 0) - Y = Y | 0xFFFFFC00; - - TX0_C = (Y * Oldval_0) >> 8; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Y = 0x%x, TX0_C = 0x%x\n", Y, TX0_C)); - ODM_SetBBReg(pDM_Odm, 0xcd4, 0x7FE, (TX0_C & 0x3FF)); - - ODM_SetBBReg(pDM_Odm, 0xcd4, BIT(0), ((Y * Oldval_0>>7) & 0x1)); - - if (bTxOnly) - return; - - reg = result[final_candidate][6]; - ODM_SetBBReg(pDM_Odm, 0xcd8, 0x3FF, reg); - - reg = result[final_candidate][7]; - ODM_SetBBReg(pDM_Odm, 0xcd8, 0x003FF000, reg); -/* -10 os 7201 10 -10 id ea4 [25:16] p -10 os 7202 10 -10 od cd8 VarFromTmp [9:0] p - -10 os 7201 11 -10 id eac [25:16] p -10 os 7202 11 -10 od cd8 VarFromTmp [21:12] p - RegE94_S1 = result[i][0]; - RegE9C_S1 = result[i][1]; - RegEA4_S1 = result[i][2]; - RegEAC_S1 = result[i][3]; - RegE94_S0 = result[i][4]; - RegE9C_S0 = result[i][5]; - RegEA4_S0 = result[i][6]; - RegEAC_S0 = result[i][7]; -*/ - } -} -// 2011/07/26 MH Add an API for testing IQK fail case. -// -// MP Already declare in odm.c -#if !(DM_ODM_SUPPORT_TYPE & ODM_WIN) -BOOLEAN -ODM_CheckPowerStatus( - IN PADAPTER Adapter) -{ -/* - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - RT_RF_POWER_STATE rtState; - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - - // 2011/07/27 MH We are not testing ready~~!! We may fail to get correct value when init sequence. - if (pMgntInfo->init_adpt_in_progress == TRUE) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return TRUE, due to initadapter")); - return TRUE; - } - - // - // 2011/07/19 MH We can not execute tx pwoer tracking/ LLC calibrate or IQK. - // - Adapter->HalFunc.GetHwRegHandler(Adapter, HW_VAR_RF_STATE, (pu1Byte)(&rtState)); - if(Adapter->bDriverStopped || Adapter->bDriverIsGoingToPnpSetPowerSleep || rtState == eRfOff) - { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("ODM_CheckPowerStatus Return FALSE, due to %d/%d/%d\n", - Adapter->bDriverStopped, Adapter->bDriverIsGoingToPnpSetPowerSleep, rtState)); - return FALSE; - } -*/ - return TRUE; -} -#endif - -VOID -_PHY_SaveADDARegisters_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte ADDAReg, - IN pu4Byte ADDABackup, - IN u4Byte RegisterNum - ) -{ - u4Byte i; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif - - if (ODM_CheckPowerStatus(pAdapter) == FALSE) - return; -#endif - - - for (i = 0 ; i < RegisterNum ; i++) { - ADDABackup[i] = ODM_GetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord); - } -} - - -VOID -_PHY_SaveMACRegisters_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte MACReg, - IN pu4Byte MACBackup - ) -{ - u4Byte i; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - - for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { - MACBackup[i] = ODM_Read1Byte(pDM_Odm, MACReg[i]); - } - MACBackup[i] = ODM_Read4Byte(pDM_Odm, MACReg[i]); - -} - - -VOID -_PHY_ReloadADDARegisters_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte ADDAReg, - IN pu4Byte ADDABackup, - IN u4Byte RegiesterNum - ) -{ - u4Byte i; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload ADDA power saving parameters !\n")); - for (i = 0 ; i < RegiesterNum; i++) { - ODM_SetBBReg(pDM_Odm, ADDAReg[i], bMaskDWord, ADDABackup[i]); - } -} - -VOID -_PHY_ReloadMACRegisters_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte MACReg, - IN pu4Byte MACBackup - ) -{ - u4Byte i; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Reload MAC parameters !\n")); - for (i = 0 ; i < (IQK_MAC_REG_NUM - 1); i++) { - ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)MACBackup[i]); - } - ODM_Write4Byte(pDM_Odm, MACReg[i], MACBackup[i]); -} - - -VOID -_PHY_PathADDAOn_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte ADDAReg, - IN BOOLEAN isPathAOn, - IN BOOLEAN is2T - ) -{ - u4Byte pathOn; - u4Byte i; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - - - pathOn = isPathAOn ? 0x03c00016 : 0x03c00016; - - if (FALSE == is2T) { - pathOn = 0x03c00016; - ODM_SetBBReg(pDM_Odm, ADDAReg[0], bMaskDWord, 0x03c00016); - } else { - ODM_SetBBReg(pDM_Odm, ADDAReg[0], bMaskDWord, pathOn); - } - - for (i = 1 ; i < IQK_ADDA_REG_NUM ; i++) { - ODM_SetBBReg(pDM_Odm,ADDAReg[i], bMaskDWord, pathOn); - } - -} - -VOID -_PHY_MACSettingCalibration_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte MACReg, - IN pu4Byte MACBackup - ) -{ - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - -/* - ODM_Write1Byte(pDM_Odm, MACReg[i], 0x3F); - - for(i = 1 ; i < (IQK_MAC_REG_NUM - 1); i++){ - ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT3))); - } - ODM_Write1Byte(pDM_Odm, MACReg[i], (u1Byte)(MACBackup[i]&(~BIT5))); -*/ - - /*ODM_SetBBReg(pDM_Odm, 0x522, bMaskByte0, 0x7f);*/ - /*ODM_SetBBReg(pDM_Odm, 0x550, bMaskByte0, 0x15);*/ - /*ODM_SetBBReg(pDM_Odm, 0x551, bMaskByte0, 0x00);*/ - - ODM_SetBBReg(pDM_Odm, 0x520, 0x00ff0000, 0xff); - - - -} - -VOID -_PHY_PathAStandBy_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER pAdapter -#endif - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-S1 standby mode!\n")); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); -/* ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x00010000);*/ - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x0, 0x0, bRFRegOffsetMask, 0x10000); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -} - -VOID -_PHY_PathBStandBy_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER pAdapter -#endif - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path-S0 standby mode!\n")); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)0x1, 0x0, bRFRegOffsetMask, 0x10000); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); -} - - -VOID -_PHY_PIModeSwitch_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN PIMode - ) -{ - u4Byte mode; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - - - mode = PIMode ? 0x01000100 : 0x01000000; - ODM_SetBBReg(pDM_Odm, rFPGA0_XA_HSSIParameter1, bMaskDWord, mode); - ODM_SetBBReg(pDM_Odm, rFPGA0_XB_HSSIParameter1, bMaskDWord, mode); -} - -BOOLEAN -phy_SimularityCompare_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN s4Byte result[][8], - IN u1Byte c1, - IN u1Byte c2 - ) -{ - u4Byte i, j, diff, SimularityBitMap, bound = 0; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - u1Byte final_candidate[2] = {0xFF, 0xFF}; - BOOLEAN bResult = TRUE; -/*#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) -// BOOLEAN is2T = IS_92C_SERIAL( pHalData->VersionID); -//#else*/ - BOOLEAN is2T = TRUE; -/*#endif*/ - - s4Byte tmp1 = 0,tmp2 = 0; - - if (is2T) - bound = 8; - else - bound = 4; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("===> IQK:phy_SimularityCompare_8723D c1 %d c2 %d!!!\n", c1, c2)); - - - SimularityBitMap = 0; - - for (i = 0; i < bound; i++) { - - if ((i == 1) || (i == 3) || (i == 5) || (i == 7)) { - if ((result[c1][i] & 0x00000200) != 0) - tmp1 = result[c1][i] | 0xFFFFFC00; - else - tmp1 = result[c1][i]; - - if ((result[c2][i] & 0x00000200) != 0) - tmp2 = result[c2][i] | 0xFFFFFC00; - else - tmp2 = result[c2][i]; - } else { - tmp1 = result[c1][i]; - tmp2 = result[c2][i]; - } - - diff = (tmp1 > tmp2) ? (tmp1 - tmp2) : (tmp2 - tmp1); - - if (diff > MAX_TOLERANCE) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:differnece overflow %d index %d compare1 0x%x compare2 0x%x!!!\n", diff, i, result[c1][i], result[c2][i])); - - if ((i == 2 || i == 6) && !SimularityBitMap) { - if (result[c1][i]+result[c1][i+1] == 0) - final_candidate[(i/4)] = c2; - else if (result[c2][i]+result[c2][i+1] == 0) - final_candidate[(i/4)] = c1; - else - SimularityBitMap = SimularityBitMap|(1<odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - u4Byte i; - u1Byte PathS1_OK, PathS0_OK; - u1Byte tmp0xc50 = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC50, bMaskByte0); - u1Byte tmp0xc58 = (u1Byte)ODM_GetBBReg(pDM_Odm, 0xC58, bMaskByte0); - u4Byte ADDA_REG[IQK_ADDA_REG_NUM] = { - rFPGA0_XCD_SwitchControl, rBlue_Tooth, - rRx_Wait_CCA, rTx_CCK_RFON, - rTx_CCK_BBON, rTx_OFDM_RFON, - rTx_OFDM_BBON, rTx_To_Rx, - rTx_To_Tx, rRx_CCK, - rRx_OFDM, rRx_Wait_RIFS, - rRx_TO_Rx, rStandby, - rSleep, rPMPD_ANAEN }; - u4Byte IQK_MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; - - - u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { - rOFDM0_TRxPathEnable, rOFDM0_TRMuxPar, - rFPGA0_XCD_RFInterfaceSW, rConfig_AntA, rConfig_AntB, - rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, - rFPGA0_XB_RFInterfaceOE, rCCK0_AFESetting - }; - u4Byte cnt_IQKFail = 0; - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) - u4Byte retryCount = 2; -#else -#if MP_DRIVER - const u4Byte retryCount = 9; -#else - const u4Byte retryCount = 2; -#endif -#endif - - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_AP|ODM_ADSL)) -#ifdef MP_TEST - if (pDM_Odm->priv->pshare->rf_ft_var.mp_specific) - retryCount = 9; -#endif -#endif - - - if (t == 0) { - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_SaveADDARegisters_8723D(pAdapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); - _PHY_SaveMACRegisters_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); - _PHY_SaveADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -#else - _PHY_SaveADDARegisters_8723D(pDM_Odm, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); - _PHY_SaveMACRegisters_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); - _PHY_SaveADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -#endif - } - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQ Calibration for 1T1R_S0/S1 for %d times\n", t)); - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, TRUE, is2T); -#else - _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, TRUE, is2T); -#endif - - -/* - if(t==0) - { - pDM_Odm->RFCalibrateInfo.bRfPiEnable = (u1Byte)ODM_GetBBReg(pDM_Odm, rFPGA0_XA_HSSIParameter1, BIT(8)); - } - - if(!pDM_Odm->RFCalibrateInfo.bRfPiEnable){ - // Switch BB to PI mode to do IQ Calibration. -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_PIModeSwitch_8723D(pAdapter, TRUE); -#else - _PHY_PIModeSwitch_8723D(pDM_Odm, TRUE); -#endif - } -*/ - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_MACSettingCalibration_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -#else - _PHY_MACSettingCalibration_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); -#endif - - /*BB setting*/ - /*ODM_SetBBReg(pDM_Odm, rFPGA0_RFMOD, BIT24, 0x00);*/ - ODM_SetBBReg(pDM_Odm, rCCK0_AFESetting, 0x0f000000, 0xf); - ODM_SetBBReg(pDM_Odm, rOFDM0_TRxPathEnable, bMaskDWord, 0x03a05611); - ODM_SetBBReg(pDM_Odm, rOFDM0_TRMuxPar, bMaskDWord, 0x000800e4); - ODM_SetBBReg(pDM_Odm, rFPGA0_XCD_RFInterfaceSW, bMaskDWord, 0x25204200); - - /*IQ calibration setting*/ - /*ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK setting!\n")); */ - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - -if (is2T) { - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_PathBStandBy_8723D(pAdapter); - - - _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, FALSE, is2T); -#else - _PHY_PathBStandBy_8723D(pDM_Odm); - - - _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, FALSE, is2T); -#endif - } - - -#if 1 - for (i = 0 ; i < retryCount ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PathS1_OK = phy_PathS1_IQK_8723D(pAdapter, is2T); -#else - PathS1_OK = phy_PathS1_IQK_8723D(pDM_Odm, is2T); -#endif - - if (PathS1_OK == 0x01) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Tx IQK Success!!\n")); - result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; - result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; - break; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Tx IQK Fail!!\n")); - result[t][0] = 0x100; - result[t][1] = 0x0; - cnt_IQKFail++; - } -#if 0 - else if (i == (retryCount-1) && PathS1_OK == 0x01) - { - RT_DISP(FINIT, INIT_IQK, ("Path S1 IQK Only Tx Success!!\n")); - - result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16; - result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16; - } -#endif - } -#endif - - -#if 1 - for (i = 0 ; i < retryCount ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PathS1_OK = phy_PathS1_RxIQK_8723D(pAdapter, is2T); -#else - PathS1_OK = phy_PathS1_RxIQK_8723D(pDM_Odm, is2T); -#endif - if (PathS1_OK == 0x03) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Rx IQK Success!!\n")); - result[t][2] = (ODM_GetBBReg(pDM_Odm, rRx_Power_Before_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; - result[t][3] = (ODM_GetBBReg(pDM_Odm, rRx_Power_After_IQK_A_2, bMaskDWord)&0x3FF0000)>>16; - break; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 Rx IQK Fail!!\n")); - result[t][2] = 0x100; - result[t][3] = 0x0; - cnt_IQKFail++; - } - } - - if (0x00 == PathS1_OK) { - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 IQK failed!!\n")); - } - -#endif - - if (is2T) { - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_PathAStandBy_8723D(pAdapter); - - - _PHY_PathADDAOn_8723D(pAdapter, ADDA_REG, FALSE, is2T); -#else - _PHY_PathAStandBy_8723D(pDM_Odm); - - - _PHY_PathADDAOn_8723D(pDM_Odm, ADDA_REG, FALSE, is2T); -#endif - - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x808000); - ODM_SetBBReg(pDM_Odm, rTx_IQK, bMaskDWord, 0x01007c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK, bMaskDWord, 0x01004800); - - -#if 1 - for (i = 0 ; i < retryCount ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PathS0_OK = phy_PathS0_IQK_8723D(pAdapter); -#else - PathS0_OK = phy_PathS0_IQK_8723D(pDM_Odm); -#endif - - if (PathS0_OK == 0x01) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Tx IQK Success!!\n")); - result[t][4] = (ODM_GetBBReg(pDM_Odm, 0xe94, bMaskDWord)&0x3FF0000)>>16; - result[t][5] = (ODM_GetBBReg(pDM_Odm, 0xe9c, bMaskDWord)&0x3FF0000)>>16; - break; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Tx IQK Fail!!\n")); - result[t][4] = 0x100; - result[t][5] = 0x0; - cnt_IQKFail++; - } -#if 0 - else if (i == (retryCount-1) && PathS1_OK == 0x01) - { - RT_DISP(FINIT, INIT_IQK, ("Path S0 IQK Only Tx Success!!\n")); - - result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_B, bMaskDWord)&0x3FF0000)>>16; - result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_B, bMaskDWord)&0x3FF0000)>>16; - } -#endif - } -#endif - - -#if 1 - -for (i = 0 ; i < retryCount ; i++) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PathS0_OK = phy_PathS0_RxIQK_8723D(pAdapter, is2T); -#else - PathS0_OK = phy_PathS0_RxIQK_8723D(pDM_Odm, is2T); -#endif - if (PathS0_OK == 0x03) { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Rx IQK Success!!\n")); -/* result[t][0] = (ODM_GetBBReg(pDM_Odm, rTx_Power_Before_IQK_A, bMaskDWord)&0x3FF0000)>>16;*/ -/* result[t][1] = (ODM_GetBBReg(pDM_Odm, rTx_Power_After_IQK_A, bMaskDWord)&0x3FF0000)>>16;*/ - result[t][6] = (ODM_GetBBReg(pDM_Odm, 0xea4, bMaskDWord)&0x3FF0000)>>16; - result[t][7] = (ODM_GetBBReg(pDM_Odm, 0xeac, bMaskDWord)&0x3FF0000)>>16; - break; - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 Rx IQK Fail!!\n")); - result[t][6] = 0x100; - result[t][7] = 0x0; - cnt_IQKFail++; - } - } - - - - if (0x00 == PathS0_OK) - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S0 IQK failed!!\n")); - -#endif - } - - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Back to BB mode, load original value!\n")); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - if (t != 0) { - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - - _PHY_ReloadADDARegisters_8723D(pAdapter, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters*/ - _PHY_ReloadMACRegisters_8723D(pAdapter, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); - - _PHY_ReloadADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -#else - - _PHY_ReloadADDARegisters_8723D(pDM_Odm, ADDA_REG, pDM_Odm->RFCalibrateInfo.ADDA_backup, IQK_ADDA_REG_NUM); - - /* Reload MAC parameters*/ - _PHY_ReloadMACRegisters_8723D(pDM_Odm, IQK_MAC_REG, pDM_Odm->RFCalibrateInfo.IQK_MAC_backup); - - _PHY_ReloadADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup, IQK_BB_REG_NUM); -#endif - - - ODM_SetBBReg(pDM_Odm, 0xc50, bMaskByte0, 0x50); - ODM_SetBBReg(pDM_Odm, 0xc50, bMaskByte0, tmp0xc50); - if (is2T) { - ODM_SetBBReg(pDM_Odm, 0xc58, bMaskByte0, 0x50); - ODM_SetBBReg(pDM_Odm, 0xc58, bMaskByte0, tmp0xc58); - } - - - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); - - - } - - pDM_Odm->nIQK_Cnt++; - - if (cnt_IQKFail == 0) - pDM_Odm->nIQK_OK_Cnt++; - else - pDM_Odm->nIQK_Fail_Cnt = pDM_Odm->nIQK_Fail_Cnt + cnt_IQKFail; - - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_IQCalibrate_8723D() <==\n")); - -} - - -VOID -phy_LCCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PVOID pDM_VOID, -#else - IN PDM_ODM_T pDM_Odm, -#endif - IN BOOLEAN is2T - ) -{ - u1Byte tmpReg; - u4Byte RF_Amode=0, RF_Bmode=0, LC_Cal, cnt; -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PADAPTER pAdapter = pDM_Odm->Adapter; -#endif - - - tmpReg = ODM_Read1Byte(pDM_Odm, 0xd03); - - if ((tmpReg & 0x70) != 0) - ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg & 0x8F); - else - ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0xFF); - - /*backup RF0x18*/ - - LC_Cal = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); - - - /*Start LCK*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal | 0x08000); - - for (cnt = 0; cnt < 100; cnt++) { - if (ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, 0x8000) != 0x1) - break; - ODM_delay_ms(10); - } - - /* Recover channel number*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask, LC_Cal); - - /*Restore original situation*/ - if ((tmpReg & 0x70) != 0) - ODM_Write1Byte(pDM_Odm, 0xd03, tmpReg); - else - ODM_Write1Byte(pDM_Odm, REG_TXPAUSE, 0x00); -} - - -#define APK_BB_REG_NUM 8 -#define APK_CURVE_REG_NUM 4 -#define PATH_NUM 2 - -VOID -phy_APCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN s1Byte delta, - IN BOOLEAN is2T - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - u4Byte regD[PATH_NUM]; - u4Byte tmpReg, index, offset, apkbound; - u1Byte path, i, pathbound = PATH_NUM; - u4Byte BB_backup[APK_BB_REG_NUM]; - u4Byte BB_REG[APK_BB_REG_NUM] = { - rFPGA1_TxBlock, rOFDM0_TRxPathEnable, - rFPGA0_RFMOD, rOFDM0_TRMuxPar, - rFPGA0_XCD_RFInterfaceSW, rFPGA0_XAB_RFInterfaceSW, - rFPGA0_XA_RFInterfaceOE, rFPGA0_XB_RFInterfaceOE }; - u4Byte BB_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x00204000 }; - u4Byte BB_normal_AP_MODE[APK_BB_REG_NUM] = { - 0x00000020, 0x00a05430, 0x02040000, - 0x000800e4, 0x22204000 }; - - u4Byte AFE_backup[IQK_ADDA_REG_NUM]; - u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { - rFPGA0_XCD_SwitchControl, rBlue_Tooth, - rRx_Wait_CCA, rTx_CCK_RFON, - rTx_CCK_BBON, rTx_OFDM_RFON, - rTx_OFDM_BBON, rTx_To_Rx, - rTx_To_Tx, rRx_CCK, - rRx_OFDM, rRx_Wait_RIFS, - rRx_TO_Rx, rStandby, - rSleep, rPMPD_ANAEN }; - - u4Byte MAC_backup[IQK_MAC_REG_NUM]; - u4Byte MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; - - u4Byte APK_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x1852c, 0x5852c, 0x1852c, 0x5852c}, - {0x2852e, 0x0852e, 0x3852e, 0x0852e, 0x0852e} - }; - - u4Byte APK_normal_RF_init_value[PATH_NUM][APK_BB_REG_NUM] = { - {0x0852c, 0x0a52c, 0x3a52c, 0x5a52c, 0x5a52c}, - {0x0852c, 0x0a52c, 0x5a52c, 0x5a52c, 0x5a52c} - }; - - u4Byte APK_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52014, 0x52013, 0x5200f, 0x5208d}, - {0x5201a, 0x52019, 0x52016, 0x52033, 0x52050} - }; - - u4Byte APK_normal_RF_value_0[PATH_NUM][APK_BB_REG_NUM] = { - {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a}, - {0x52019, 0x52017, 0x52010, 0x5200d, 0x5206a} - }; - - u4Byte AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4}; - - u4Byte APK_offset[PATH_NUM] = { - rConfig_AntA, rConfig_AntB}; - - u4Byte APK_normal_offset[PATH_NUM] = { - rConfig_Pmpd_AntA, rConfig_Pmpd_AntB}; - - u4Byte APK_value[PATH_NUM] = { - 0x92fc0000, 0x12fc0000}; - - u4Byte APK_normal_value[PATH_NUM] = { - 0x92680000, 0x12680000}; - - s1Byte APK_delta_mapping[APK_BB_REG_NUM][13] = { - {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-4, -3, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-6, -4, -2, -2, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-1, -1, -1, -1, -1, -1, 0, 1, 2, 3, 4, 5, 6}, - {-11, -9, -7, -5, -3, -1, 0, 0, 0, 0, 0, 0, 0} - }; - - u4Byte APK_normal_setting_value_1[13] = { - 0x01017018, 0xf7ed8f84, 0x1b1a1816, 0x2522201e, 0x322e2b28, - 0x433f3a36, 0x5b544e49, 0x7b726a62, 0xa69a8f84, 0xdfcfc0b3, - 0x12680000, 0x00880000, 0x00880000 - }; - - u4Byte APK_normal_setting_value_2[16] = { - 0x01c7021d, 0x01670183, 0x01000123, 0x00bf00e2, 0x008d00a3, - 0x0068007b, 0x004d0059, 0x003a0042, 0x002b0031, 0x001f0025, - 0x0017001b, 0x00110014, 0x000c000f, 0x0009000b, 0x00070008, - 0x00050006 - }; - - u4Byte APK_result[PATH_NUM][APK_BB_REG_NUM]; -/* u4Byte AP_curve[PATH_NUM][APK_CURVE_REG_NUM];*/ - - s4Byte BB_offset, delta_V, delta_offset; - -#if MP_DRIVER == 1 -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); -#else - PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); -#endif - pMptCtx->APK_bound[0] = 45; - pMptCtx->APK_bound[1] = 52; - -#endif - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_APCalibrate_8723D() delta %d\n", delta)); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("AP Calibration for %s\n", (is2T ? "2T2R" : "1T1R"))); - if (!is2T) - pathbound = 1; - - - -/* Temporarily do not allow normal driver to do the following settings because these offset -// and value will cause RF internal PA to be unpredictably disabled by HW, such that RF Tx signal -// will disappear after disable/enable card many times on 88CU. RF SD and DD have not find the -// root cause, so we remove these actions temporarily. Added by tynli and SD3 Allen. 2010.05.31.*/ -#if MP_DRIVER != 1 - return; -#endif - - for (index = 0; index < PATH_NUM; index++) { - APK_offset[index] = APK_normal_offset[index]; - APK_value[index] = APK_normal_value[index]; - AFE_on_off[index] = 0x6fdb25a4; - } - - for (index = 0; index < APK_BB_REG_NUM; index++) { - for (path = 0; path < pathbound; path++) { - APK_RF_init_value[path][index] = APK_normal_RF_init_value[path][index]; - APK_RF_value_0[path][index] = APK_normal_RF_value_0[path][index]; - } - BB_AP_MODE[index] = BB_normal_AP_MODE[index]; - } - - apkbound = 6; - - - for (index = 0; index < APK_BB_REG_NUM ; index++) { - if (index == 0) - continue; - BB_backup[index] = ODM_GetBBReg(pDM_Odm, BB_REG[index], bMaskDWord); - } - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_SaveMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); - - - _PHY_SaveADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _PHY_SaveMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); - - - _PHY_SaveADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - for (path = 0; path < pathbound; path++) { - - - if (path == ODM_RF_PATH_A) { - - offset = rPdp_AntA; - for (index = 0; index < 11; index++) { - ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); - - offset += 0x04; - } - - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); - - offset = rConfig_AntA; - for (; index < 13; index++) { - ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); - - offset += 0x04; - } - - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); - - - offset = rPdp_AntA; - for (index = 0; index < 16; index++) { - ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); - - offset += 0x04; - } - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - } else if (path == ODM_RF_PATH_B) { - - offset = rPdp_AntB; - for (index = 0; index < 10; index++) { - ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); - - offset += 0x04; - } - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x12680000); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PHY_SetBBReg(pAdapter, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -#else - PHY_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x12680000); -#endif - - offset = rConfig_AntA; - index = 11; - for (; index < 13; index++) { - ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_1[index]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); - - offset += 0x04; - } - - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); - - - offset = 0xb60; - for (index = 0; index < 16; index++) { - ODM_SetBBReg(pDM_Odm, offset, bMaskDWord, APK_normal_setting_value_2[index]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", offset, ODM_GetBBReg(pDM_Odm, offset, bMaskDWord))); - - offset += 0x04; - } - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - } - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - regD[path] = PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord); -#else - regD[path] = ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord); -#endif - - - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - ODM_SetBBReg(pDM_Odm, AFE_REG[index], bMaskDWord, AFE_on_off[path]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xe70 %x\n", ODM_GetBBReg(pDM_Odm, rRx_Wait_CCA, bMaskDWord))); - - - if (path == 0) { - for (index = 0; index < APK_BB_REG_NUM ; index++) { - - if (index == 0) - continue; - else if (index < 5) - ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_AP_MODE[index]); - else if (BB_REG[index] == 0x870) - ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); - else - ODM_SetBBReg(pDM_Odm, BB_REG[index], BIT10, 0x0); - } - - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); - } else { - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); - - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x800 %x\n", ODM_GetBBReg(pDM_Odm, 0x800, bMaskDWord))); - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_MACSettingCalibration_8723D(pAdapter, MAC_REG, MAC_backup); -#else - _PHY_MACSettingCalibration_8723D(pDM_Odm, MAC_REG, MAC_backup); -#endif - - if (path == ODM_RF_PATH_A) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x10000); - } else { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bMaskDWord, 0x10000); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20103); - } - - delta_offset = ((delta+14)/2); - if (delta_offset < 0) - delta_offset = 0; - else if (delta_offset > 12) - delta_offset = 12; - - - for (index = 0; index < APK_BB_REG_NUM; index++) { - if (index != 1) - continue; - - tmpReg = APK_RF_init_value[path][index]; -#if 1 - if (!pDM_Odm->RFCalibrateInfo.bAPKThermalMeterIgnore) { - BB_offset = (tmpReg & 0xF0000) >> 16; - - if (!(tmpReg & BIT15)) { - BB_offset = -BB_offset; - } - - delta_V = APK_delta_mapping[index][delta_offset]; - - BB_offset += delta_V; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() APK index %d tmpReg 0x%x delta_V %d delta_offset %d\n", index, tmpReg, delta_V, delta_offset)); - - if (BB_offset < 0) { - tmpReg = tmpReg & (~BIT15); - BB_offset = -BB_offset; - } else { - tmpReg = tmpReg | BIT15; - } - tmpReg = (tmpReg & 0xFFF0FFFF) | (BB_offset << 16); - } -#endif - - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_IPA_A, bMaskDWord, 0x8992e); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xc %x\n", PHY_QueryRFReg(pAdapter, path, RF_IPA_A, bMaskDWord))); - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x0 %x\n", PHY_QueryRFReg(pAdapter, path, RF_AC, bMaskDWord))); - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_TXBIAS_A, bMaskDWord, tmpReg); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xd %x\n", PHY_QueryRFReg(pAdapter, path, RF_TXBIAS_A, bMaskDWord))); -#else - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xc %x\n", ODM_GetRFReg(pDM_Odm, path, RF_IPA_A, bMaskDWord))); - ODM_SetRFReg(pDM_Odm, path, RF_AC, bMaskDWord, APK_RF_value_0[path][index]); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x0 %x\n", ODM_GetRFReg(pDM_Odm, path, RF_AC, bMaskDWord))); - ODM_SetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord, tmpReg); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xd %x\n", ODM_GetRFReg(pDM_Odm, path, RF_TXBIAS_A, bMaskDWord))); -#endif - - - i = 0; - do - { - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); - { - ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[0]); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); - ODM_delay_ms(3); - ODM_SetBBReg(pDM_Odm, APK_offset[path], bMaskDWord, APK_value[1]); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0x%x value 0x%x\n", APK_offset[path], ODM_GetBBReg(pDM_Odm, APK_offset[path], bMaskDWord))); - - ODM_delay_ms(20); - } - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - if (path == ODM_RF_PATH_A) - tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0x03E00000); - else - tmpReg = ODM_GetBBReg(pDM_Odm, rAPK, 0xF8000000); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_APCalibrate_8723D() offset 0xbd8[25:21] %x\n", tmpReg)); - - - i++; - } - while(tmpReg > apkbound && i < 4); - - APK_result[path][index] = tmpReg; - } - } - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_ReloadMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); -#else - _PHY_ReloadMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); -#endif - - - for (index = 0; index < APK_BB_REG_NUM ; index++) { - - if (index == 0) - continue; - ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]); - } - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_ReloadADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _PHY_ReloadADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - - for (path = 0; path < pathbound; path++) - { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0xd, bMaskDWord, regD[path]); - if (path == ODM_RF_PATH_B) { - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20101); - } - - - if (APK_result[path][1] > 6) - APK_result[path][1] = 6; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("apk path %d result %d 0x%x \t", path, 1, APK_result[path][1])); - } - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\n")); - - - for (path = 0; path < pathbound; path++) { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x3, bMaskDWord, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (APK_result[path][1] << 5) | APK_result[path][1])); - if (path == ODM_RF_PATH_A) - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x4, bMaskDWord, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x00 << 5) | 0x05)); - else - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, 0x4, bMaskDWord, - ((APK_result[path][1] << 15) | (APK_result[path][1] << 10) | (0x02 << 5) | 0x05)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - if (!IS_HARDWARE_TYPE_8723A(pAdapter)) - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)path, RF_BS_PA_APSET_G9_G11, bMaskDWord, - ((0x08 << 15) | (0x08 << 10) | (0x08 << 5) | 0x08)); -#endif - } - - pDM_Odm->RFCalibrateInfo.bAPKdone = TRUE; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_APCalibrate_8723D()\n")); -} - - - -#define DP_BB_REG_NUM 7 -#define DP_RF_REG_NUM 1 -#define DP_RETRY_LIMIT 10 -#define DP_PATH_NUM 2 -#define DP_DPK_NUM 3 -#define DP_DPK_VALUE_NUM 2 - - - - - -VOID -PHY_IQCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN bReCovery - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #else - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - - #if (MP_DRIVER == 1) - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); - #else - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - #endif - #endif -#endif - - - u1Byte u1bTmp; - u2Byte count = 0; - s4Byte result[4][8]; - u1Byte i, final_candidate, Indexforchannel; - BOOLEAN bPathS1_OK, bPathS0_OK; - s4Byte RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0, RegTmp = 0; - s4Byte RegC80, RegC94, RegC14, RegCA0, RegCd0, RegCd4, RegCd8; - BOOLEAN is12simular, is13simular, is23simular; - BOOLEAN bSingleTone = FALSE, bCarrierSuppression = FALSE, bContinousTx = FALSE; - u4Byte IQK_BB_REG_92C[IQK_BB_REG_NUM] = { - rOFDM0_XARxIQImbalance, rOFDM0_XBRxIQImbalance, - rOFDM0_ECCAThreshold, rOFDM0_AGCRSSITable, - rOFDM0_XATxIQImbalance, rOFDM0_XBTxIQImbalance, - rOFDM0_XCTxAFE, rOFDM0_XDTxAFE, - rOFDM0_RxIQExtAnta}; - u4Byte Path_SEL_BB_phyIQK; - u4Byte originalPath, originalGNT, oriPathCtrl; -#if 1 -ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("================ IQK Start ===================\n")); - - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE) ) - if (ODM_CheckPowerStatus(pAdapter) == FALSE) - return; -#else - prtl8192cd_priv priv = pDM_Odm->priv; - -#ifdef MP_TEST - if (priv->pshare->rf_ft_var.mp_specific) { - if ((OPMODE & WIFI_MP_CTX_PACKET) || (OPMODE & WIFI_MP_CTX_ST)) - return; - } -#endif - - if (priv->pshare->IQK_88E_done) - bReCovery= 1; - priv->pshare->IQK_88E_done = 1; - -#endif - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { - return; - } -#endif - - -#if MP_DRIVER == 1 - -/*#if (DM_ODM_SUPPORT_TYPE == ODM_WIN)*/ - /* Add to determine IQK ON/OFF in certain case, Suggested by Cheng.*/ - /* if (!pHalData->IQK_MP_Switch) - return;*/ -/*#endif*/ - - bSingleTone = pMptCtx->bSingleTone; - bCarrierSuppression = pMptCtx->bCarrierSuppression; - bContinousTx = pMptCtx->bStartContTx; -#endif - - /* 20120213 Turn on when continuous Tx to pass lab testing. (required by Edlu)*/ - if (bSingleTone || bCarrierSuppression || bContinousTx) - return; - - - -#if DISABLE_BB_RF - return; -#endif - - if (pDM_Odm->RFCalibrateInfo.bIQKInProgress) - return; - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("=====>PHY_IQCalibrate_8723D\n")); - - - Path_SEL_BB_phyIQK = ODM_GetBBReg(pDM_Odm, 0x948, bMaskDWord); - -#if (DM_ODM_SUPPORT_TYPE & (ODM_CE|ODM_AP)) - if (bReCovery) -#else - if (bReCovery && (!pAdapter->bInHctTest)) -#endif - { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_INIT, ODM_DBG_LOUD, ("PHY_IQCalibrate_8723D: Return due to bReCovery!\n")); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_ReloadADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -#else - _PHY_ReloadADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -#endif - return; - } - - /*Check & wait if BT is doing IQK*/ - - if (pDM_Odm->mp_mode == FALSE) { -#if MP_DRIVER != 1 - SetFwWiFiCalibrationCmd_8723D(pAdapter, 1); - - - count = 0; - u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); - while (u1bTmp != 0x1 && count < 1000) { - PlatformStallExecution(10); - u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); - count++; - } - if (count >= 1000) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]Polling 0x1e6 to 1 for WiFi calibration H2C cmd FAIL! count(%d)", count)); - } - - - u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e7); - while ((!(u1bTmp&BIT0)) && count < 6000) { - PlatformStallExecution(50); - u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e7); - count++; - } -#endif - } - - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK:Start!!!\n")); - ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); - pDM_Odm->RFCalibrateInfo.bIQKInProgress = TRUE; - ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); - - for (i = 0; i < 8; i++) { - result[0][i] = 0; - result[1][i] = 0; - result[2][i] = 0; - result[3][i] = 0; - } - - final_candidate = 0xff; - bPathS1_OK = FALSE; - bPathS0_OK = FALSE; - is12simular = FALSE; - is23simular = FALSE; - is13simular = FALSE; - -for (i = 0; i < 3; i++) { - -#if 1 - /*set path control to WL*/ - oriPathCtrl = ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3); /*save 0x67*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]original 0x67 = 0x%x\n", oriPathCtrl)); - ODM_SetMACReg(pDM_Odm, 0x64, BIT31, 0x1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]set 0x67 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); - - /*backup Path & GNT value */ - originalPath = ODM_GetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, bMaskDWord); /*save 0x70*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0x800f0038); - ODM_delay_ms(1); - originalGNT = ODM_GetBBReg(pDM_Odm, REG_LTECOEX_READ_DATA, bMaskDWord); /*save 0x38*/ - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]OriginalGNT = 0x%x\n", originalGNT)); - - /*set GNT_WL=1/GNT_BT=1 and Path owner to WiFi for pause BT traffic*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, 0x0000ff00); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc0020038); /*0x38[15:8] = 0x77*/ - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, BIT26, 0x1); -#endif - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - phy_IQCalibrate_8723D(pAdapter, result, i, TRUE); -#else - phy_IQCalibrate_8723D(pDM_Odm, result, i, TRUE); -#endif - -#if 1 - /*Restore GNT_WL/GNT_BT and Path owner*/ - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_WRITE_DATA, bMaskDWord, originalGNT); - ODM_SetBBReg(pDM_Odm, REG_LTECOEX_CTRL, bMaskDWord, 0xc00f0038); - ODM_SetMACReg(pDM_Odm, REG_LTECOEX_PATH_CONTROL, 0xffffffff, originalPath); - - /*Restore path control owner*/ - ODM_SetMACReg(pDM_Odm, 0x64, bMaskByte3, oriPathCtrl); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]restore 0x67 = 0x%x\n", ODM_GetMACReg(pDM_Odm, 0x64, bMaskByte3))); -#endif - - if (i == 1) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - is12simular = phy_SimularityCompare_8723D(pAdapter, result, 0, 1); -#else - is12simular = phy_SimularityCompare_8723D(pDM_Odm, result, 0, 1); -#endif - - if (is12simular) { - final_candidate = 0; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is12simular final_candidate is %x\n",final_candidate)); - break; - } - } - - if (i == 2) { -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - is13simular = phy_SimularityCompare_8723D(pAdapter, result, 0, 2); -#else - is13simular = phy_SimularityCompare_8723D(pDM_Odm, result, 0, 2); -#endif - - if (is13simular) { - final_candidate = 0; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is13simular final_candidate is %x\n",final_candidate)); - - break; - } -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - is23simular = phy_SimularityCompare_8723D(pAdapter, result, 1, 2); -#else - is23simular = phy_SimularityCompare_8723D(pDM_Odm, result, 1, 2); -#endif - - if (is23simular) { - final_candidate = 1; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK: is23simular final_candidate is %x\n",final_candidate)); - } else { - for (i = 0; i < 8; i++) - RegTmp += result[3][i]; - - if (RegTmp != 0) - final_candidate = 3; - else - final_candidate = 0xFF; - - } - } - } - - - - for (i = 0; i < 4; i++) { - RegE94_S1 = result[i][0]; - RegE9C_S1 = result[i][1]; - RegEA4_S1 = result[i][2]; - RegEAC_S1 = result[i][3]; - RegE94_S0 = result[i][4]; - RegE9C_S0 = result[i][5]; - RegEA4_S0 = result[i][6]; - RegEAC_S0 = result[i][7]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] RegE94_S1=%x RegE9C_S1=%x RegEA4_S1=%x RegEAC_S1=%x RegE94_S0=%x RegE9C_S0=%x RegEA4_S0=%x RegEAC_S0=%x\n ", RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0)); - } - - if (final_candidate != 0xff) { - pDM_Odm->RFCalibrateInfo.RegE94 = RegE94_S1 = result[final_candidate][0]; - pDM_Odm->RFCalibrateInfo.RegE9C = RegE9C_S1 = result[final_candidate][1]; - RegEA4_S1 = result[final_candidate][2]; - RegEAC_S1 = result[final_candidate][3]; - pDM_Odm->RFCalibrateInfo.RegEB4 = RegE94_S0 = result[final_candidate][4]; - pDM_Odm->RFCalibrateInfo.RegEBC = RegE9C_S0 = result[final_candidate][5]; - RegEA4_S0 = result[final_candidate][6]; - RegEAC_S0 = result[final_candidate][7]; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] final_candidate is %x\n", final_candidate)); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] TX1_X=%x TX1_Y=%x RX1_X=%x RX1_Y=%x TX0_X=%x TX0_Y=%x RX0_X=%x RX0_Y=%x\n ", RegE94_S1, RegE9C_S1, RegEA4_S1, RegEAC_S1, RegE94_S0, RegE9C_S0, RegEA4_S0, RegEAC_S0)); - bPathS1_OK = bPathS0_OK = TRUE; - } else { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK] FAIL use default value\n")); - - pDM_Odm->RFCalibrateInfo.RegE94 = pDM_Odm->RFCalibrateInfo.RegEB4 = 0x100; - pDM_Odm->RFCalibrateInfo.RegE9C = pDM_Odm->RFCalibrateInfo.RegEBC = 0x0; - } - - - if (RegE94_S1 != 0) - _PHY_PathS1FillIQKMatrix_8723D(pAdapter, bPathS1_OK, result, final_candidate, (RegEA4_S1 == 0)); - if (RegE94_S0 != 0) - _PHY_PathS0FillIQKMatrix_8723D(pAdapter, bPathS0_OK, result, final_candidate, (RegEA4_S0 == 0)); - - - RegC80 = ODM_GetBBReg(pDM_Odm, 0xc80, bMaskDWord); - RegC94 = ODM_GetBBReg(pDM_Odm, 0xc94, bMaskDWord); - RegC14 = ODM_GetBBReg(pDM_Odm, 0xc14, bMaskDWord); - RegCA0 = ODM_GetBBReg(pDM_Odm, 0xca0, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xc80 = 0x%x 0xc94 = 0x%x 0xc14 = 0x%x 0xca0 = 0x%x\n", RegC80, RegC94, RegC14, RegCA0)); - - - RegCd0 = ODM_GetBBReg(pDM_Odm, 0xcd0, bMaskDWord); - RegCd4 = ODM_GetBBReg(pDM_Odm, 0xcd4, bMaskDWord); - RegCd8 = ODM_GetBBReg(pDM_Odm, 0xcd8, bMaskDWord); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("[IQK]0xcd0 = 0x%x 0xcd4 = 0x%x 0xcd8 = 0x%x\n", RegCd0, RegCd4, RegCd8)); - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - Indexforchannel = ODM_GetRightChnlPlaceforIQK(pHalData->CurrentChannel); -#else - Indexforchannel = 0; -#endif - - - if (final_candidate < 4) { - for (i = 0; i < IQK_Matrix_REG_NUM; i++) - pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].Value[0][i] = result[final_candidate][i]; - pDM_Odm->RFCalibrateInfo.IQKMatrixRegSetting[Indexforchannel].bIQKDone = TRUE; - } - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("\nIQK OK Indexforchannel %d.\n", Indexforchannel)); -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - _PHY_SaveADDARegisters_8723D(pAdapter, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, 9); -#else - _PHY_SaveADDARegisters_8723D(pDM_Odm, IQK_BB_REG_92C, pDM_Odm->RFCalibrateInfo.IQK_BB_backup_recover, IQK_BB_REG_NUM); -#endif - - if (pDM_Odm->mp_mode == FALSE) { -#if MP_DRIVER != 1 - SetFwWiFiCalibrationCmd_8723D(pAdapter, 0); - - - count = 0; - u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); - while (u1bTmp != 0 && count < 1000) { - PlatformStallExecution(10); - u1bTmp = PlatformEFIORead1Byte(pAdapter, 0x1e6); - count++; - } - - if (count >= 1000) { - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("[IQK]Polling 0x1e6 to 0 for WiFi calibration H2C cmd FAIL! count(%d)", count)); - } -#endif - } - - ODM_AcquireSpinLock(pDM_Odm, RT_IQK_SPINLOCK); - pDM_Odm->RFCalibrateInfo.bIQKInProgress = FALSE; - ODM_ReleaseSpinLock(pDM_Odm, RT_IQK_SPINLOCK); - - - ODM_SetBBReg(pDM_Odm, 0x948, bMaskDWord, Path_SEL_BB_phyIQK); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("IQK finished\n")); -#endif - -} - - -VOID -PHY_LCCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PVOID pDM_VOID -#else - IN PDM_ODM_T pDM_Odm -#endif - ) -{ - BOOLEAN bSingleTone = FALSE, bCarrierSuppression = FALSE; - u4Byte timeout = 2000, timecount = 0; - -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - PADAPTER pAdapter = pDM_Odm->Adapter; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - - #if (MP_DRIVER == 1) - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PMPT_CONTEXT pMptCtx = &(pAdapter->MptCtx); - #else - PMPT_CONTEXT pMptCtx = &(pAdapter->mppriv.MptCtx); - #endif - #endif -#endif - -#if MP_DRIVER == 1 - bSingleTone = pMptCtx->bSingleTone; - bCarrierSuppression = pMptCtx->bCarrierSuppression; -#endif - - -#if DISABLE_BB_RF - return; -#endif - - - - -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { - return; - } -#endif - - if (bSingleTone || bCarrierSuppression) - return; - - while(*(pDM_Odm->pbScanInProcess) && timecount < timeout) - { - ODM_delay_ms(50); - timecount += 50; - } - - pDM_Odm->RFCalibrateInfo.bLCKInProgress = TRUE; - - phy_LCCalibrate_8723D(pDM_Odm, FALSE); - - pDM_Odm->RFCalibrateInfo.bLCKInProgress = FALSE; - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("LCK:Finish!!!interface %d\n", pDM_Odm->InterfaceIndex)); - -} - -VOID -PHY_APCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN s1Byte delta - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif -#if DISABLE_BB_RF - return; -#endif - - return; -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (!(pDM_Odm->SupportAbility & ODM_RF_CALIBRATION)) { - return; - } -#endif - -#if FOR_BRAZIL_PRETEST != 1 - if (pDM_Odm->RFCalibrateInfo.bAPKdone) -#endif - return; - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_APCalibrate_8723D(pAdapter, delta, FALSE); -#else - phy_APCalibrate_8723D(pDM_Odm, delta, FALSE); -#endif - } -VOID phy_SetRFPathSwitch_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN bMain, - IN BOOLEAN is2T - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#endif - - if (bMain) { - ODM_SetMACReg(pDM_Odm, 0x7C4, bMaskLWord, 0x7700); - } else { - ODM_SetMACReg(pDM_Odm, 0x7C4, bMaskLWord, 0xDD00); - } - - ODM_SetMACReg(pDM_Odm, 0x7C0, bMaskDWord, 0xC00F0038); - ODM_SetMACReg(pDM_Odm, 0x70, BIT26, 1); - ODM_SetMACReg(pDM_Odm, 0x64, BIT31, 1); -} - -VOID PHY_SetRFPathSwitch_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN bMain - ) -{ -HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; -#endif -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#endif - -#if DISABLE_BB_RF - return; -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - phy_SetRFPathSwitch_8723D(pAdapter, bMain, TRUE); -#endif - -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - -VOID -phy_DigitalPredistortion_8723D( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PADAPTER pAdapter, -#else - IN PDM_ODM_T pDM_Odm, -#endif - IN BOOLEAN is2T - ) -{ -#if (RT_PLATFORM == PLATFORM_WINDOWS) -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - - u4Byte tmpReg, tmpReg2, index, i; - u1Byte path, pathbound = PATH_NUM; - u4Byte AFE_backup[IQK_ADDA_REG_NUM]; - u4Byte AFE_REG[IQK_ADDA_REG_NUM] = { - rFPGA0_XCD_SwitchControl, rBlue_Tooth, - rRx_Wait_CCA, rTx_CCK_RFON, - rTx_CCK_BBON, rTx_OFDM_RFON, - rTx_OFDM_BBON, rTx_To_Rx, - rTx_To_Tx, rRx_CCK, - rRx_OFDM, rRx_Wait_RIFS, - rRx_TO_Rx, rStandby, - rSleep, rPMPD_ANAEN }; - - u4Byte BB_backup[DP_BB_REG_NUM]; - u4Byte BB_REG[DP_BB_REG_NUM] = { - rOFDM0_TRxPathEnable, rFPGA0_RFMOD, - rOFDM0_TRMuxPar, rFPGA0_XCD_RFInterfaceSW, - rFPGA0_XAB_RFInterfaceSW, rFPGA0_XA_RFInterfaceOE, - rFPGA0_XB_RFInterfaceOE}; - u4Byte BB_settings[DP_BB_REG_NUM] = { - 0x00a05430, 0x02040000, 0x000800e4, 0x22208000, - 0x0, 0x0, 0x0}; - - u4Byte RF_backup[DP_PATH_NUM][DP_RF_REG_NUM]; - u4Byte RF_REG[DP_RF_REG_NUM] = { - RF_TXBIAS_A}; - - u4Byte MAC_backup[IQK_MAC_REG_NUM]; - u4Byte MAC_REG[IQK_MAC_REG_NUM] = { - REG_TXPAUSE, REG_BCN_CTRL, - REG_BCN_CTRL_1, REG_GPIO_MUXCFG}; - - u4Byte Tx_AGC[DP_DPK_NUM][DP_DPK_VALUE_NUM] = { - {0x1e1e1e1e, 0x03901e1e}, - {0x18181818, 0x03901818}, - {0x0e0e0e0e, 0x03900e0e} - }; - - u4Byte AFE_on_off[PATH_NUM] = { - 0x04db25a4, 0x0b1b25a4}; - - u1Byte RetryCount = 0; - - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("==>phy_DigitalPredistortion_8723D()\n")); - - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("phy_DigitalPredistortion_8723D for %s\n", (is2T ? "2T2R" : "1T1R"))); - - - for (index = 0; index < DP_BB_REG_NUM; index++) - BB_backup[index] = ODM_GetBBReg(pDM_Odm, BB_REG[index], bMaskDWord); - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_SaveMACRegisters_8723D(pAdapter, BB_REG, MAC_backup); -#else - _PHY_SaveMACRegisters_8723D(pDM_Odm, BB_REG, MAC_backup); -#endif - - - for (path = 0; path < DP_PATH_NUM; path++) { - for (index = 0; index < DP_RF_REG_NUM; index++) -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - RF_backup[path][index] = PHY_QueryRFReg(pAdapter, path, RF_REG[index], bMaskDWord); -#else - RF_backup[path][index] = ODM_GetRFReg(pAdapter, path, RF_REG[index], bMaskDWord); -#endif - } - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_SaveADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#else - _PHY_SaveADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); -#endif - - - for (index = 0; index < IQK_ADDA_REG_NUM ; index++) - ODM_SetBBReg(pDM_Odm, AFE_REG[index], bMaskDWord, 0x6fdb25a4); - - - for (index = 0; index < DP_BB_REG_NUM; index++) { - if (index < 4) - ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_settings[index]); - else if (index == 4) - ODM_SetBBReg(pDM_Odm,BB_REG[index], bMaskDWord, BB_backup[index]|BIT10|BIT26); - else - ODM_SetBBReg(pDM_Odm, BB_REG[index], BIT10, 0x00); - } - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_MACSettingCalibration_8723D(pAdapter, MAC_REG, MAC_backup); -#else - _PHY_MACSettingCalibration_8723D(pDM_Odm, MAC_REG, MAC_backup); -#endif - - - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_A, bMaskDWord, 0x01008c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_A, bMaskDWord, 0x01008c00); - ODM_SetBBReg(pDM_Odm, rTx_IQK_Tone_B, bMaskDWord, 0x01008c00); - ODM_SetBBReg(pDM_Odm, rRx_IQK_Tone_B, bMaskDWord, 0x01008c00); - - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x10000); - - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); - ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - - for (i = 0; i < 3; i++) { - - for (index = 0; index < 3; index++) - ODM_SetBBReg(pDM_Odm, 0xe00+index*4, bMaskDWord, Tx_AGC[i][0]); - ODM_SetBBReg(pDM_Odm,0xe00+index*4, bMaskDWord, Tx_AGC[i][1]); - for (index = 0; index < 4; index++) - ODM_SetBBReg(pDM_Odm, 0xe10+index*4, bMaskDWord, Tx_AGC[i][0]); - - - ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02097098); - ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0xf76d9f84); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); - ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); - - - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x80047788); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x00047788); - ODM_delay_ms(50); - } - - - for (index = 0; index < 3; index++) - ODM_SetBBReg(pDM_Odm, 0xe00+index*4, bMaskDWord, 0x34343434); - ODM_SetBBReg(pDM_Odm, 0xe08+index*4, bMaskDWord, 0x03903434); - for (index = 0; index < 4; index++) - ODM_SetBBReg(pDM_Odm, 0xe10+index*4, bMaskDWord, 0x34343434); - - - ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02017098); - ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0xf76d9f84); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); - ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); - - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0c, bMaskDWord, 0x8992b); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x0d, bMaskDWord, 0x0e52c); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, 0x00, bMaskDWord, 0x5205a ); - - - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); - ODM_delay_ms(50); - - while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathAOK) - { - - ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c297018); - tmpReg = ODM_GetBBReg(pDM_Odm, 0xbe0, bMaskDWord); - ODM_delay_ms(10); - ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x0c29701f); - tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbe8, bMaskDWord); - ODM_delay_ms(10); - - tmpReg = (tmpReg & bMaskHWord) >> 16; - tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; - if (tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff) { - ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x02017098); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x800477c0); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x000477c0); - ODM_delay_ms(50); - RetryCount++; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 DPK RetryCount %d 0xbe0[31:16] %x 0xbe8[31:16] %x\n", RetryCount, tmpReg, tmpReg2)); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 DPK Success\n")); - pDM_Odm->RFCalibrateInfo.bDPPathAOK = TRUE; - break; - } - } - RetryCount = 0; - - - if (pDM_Odm->RFCalibrateInfo.bDPPathAOK) { - - ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x01017098); - ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x776d9f84); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntA, bMaskDWord, 0x0004ab87); - ODM_SetBBReg(pDM_Odm, rConfig_AntA, bMaskDWord, 0x00880000); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); - - for (i = rPdp_AntA; i <= 0xb3c; i += 4) { - ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("Path S1 ofsset = 0x%x\n", i)); - } - - - ODM_SetBBReg(pDM_Odm, 0xb40, bMaskDWord, 0x40404040); - ODM_SetBBReg(pDM_Odm, 0xb44, bMaskDWord, 0x28324040); - ODM_SetBBReg(pDM_Odm, 0xb48, bMaskDWord, 0x10141920); - - for (i = 0xb4c; i <= 0xb5c; i += 4) { - ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); - } - - - ODM_SetBBReg(pDM_Odm, 0xbc0, bMaskDWord, 0x0005361f); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - } else { - ODM_SetBBReg(pDM_Odm, rPdp_AntA, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, rPdp_AntA_4, bMaskDWord, 0x00000000); - } - - - if (is2T) { - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_AC, bMaskDWord, 0x10000); - - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); - ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - - for (i = 0; i < 3; i++) { - - for(index = 0; index < 4; index++) - ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, Tx_AGC[i][0]); - for(index = 0; index < 2; index++) - ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, Tx_AGC[i][0]); - for(index = 0; index < 2; index++) - ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, Tx_AGC[i][0]); - - - ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02097098); - ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); - ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); - - - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x80047788); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x00047788); - ODM_delay_ms(50); - } - - - for (index = 0; index < 4; index++) - ODM_SetBBReg(pDM_Odm, 0x830+index*4, bMaskDWord, 0x34343434); - for (index = 0; index < 2; index++) - ODM_SetBBReg(pDM_Odm, 0x848+index*4, bMaskDWord, 0x34343434); - for (index = 0; index < 2; index++) - ODM_SetBBReg(pDM_Odm, 0x868+index*4, bMaskDWord, 0x34343434); - - - ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); - ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0xf76d9f84); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); - ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); - - - ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x0101000f); - ODM_SetBBReg(pDM_Odm, 0x840, bMaskDWord, 0x01120103); - - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x0c, bMaskDWord, 0x8992b); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, 0x0d, bMaskDWord, 0x0e52c); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_AC, bMaskDWord, 0x5205a); - - - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); - ODM_delay_ms(50); - - while(RetryCount < DP_RETRY_LIMIT && !pDM_Odm->RFCalibrateInfo.bDPPathBOK) - { - - ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c297018); - tmpReg = ODM_GetBBReg(pDM_Odm, 0xbf0, bMaskDWord); - ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x0c29701f); - tmpReg2 = ODM_GetBBReg(pDM_Odm, 0xbf8, bMaskDWord); - - tmpReg = (tmpReg & bMaskHWord) >> 16; - tmpReg2 = (tmpReg2 & bMaskHWord) >> 16; - - if (tmpReg < 0xf0 || tmpReg > 0x105 || tmpReg2 > 0xff) { - ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x02017098); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x800000); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x800477c0); - ODM_delay_ms(1); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x000477c0); - ODM_delay_ms(50); - RetryCount++; - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK RetryCount %d 0xbf0[31:16] %x, 0xbf8[31:16] %x\n", RetryCount , tmpReg, tmpReg2)); - } else { - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B DPK Success\n")); - pDM_Odm->RFCalibrateInfo.bDPPathBOK = TRUE; - break; - } - } - - - if (pDM_Odm->RFCalibrateInfo.bDPPathBOK) { - - ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x01017098); - ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x776d9f84); - ODM_SetBBReg(pDM_Odm, rConfig_Pmpd_AntB, bMaskDWord, 0x0004ab87); - ODM_SetBBReg(pDM_Odm, rConfig_AntB, bMaskDWord, 0x00880000); - - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x400000); - for (i = 0xb60; i <= 0xb9c; i += 4) { - ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x40004000); - ODM_RT_TRACE(pDM_Odm, ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("path B ofsset = 0x%x\n", i)); - } - - - ODM_SetBBReg(pDM_Odm, 0xba0, bMaskDWord, 0x40404040); - ODM_SetBBReg(pDM_Odm, 0xba4, bMaskDWord, 0x28324050); - ODM_SetBBReg(pDM_Odm, 0xba8, bMaskDWord, 0x0c141920); - - for (i = 0xbac; i <= 0xbbc; i += 4) { - ODM_SetBBReg(pDM_Odm, i, bMaskDWord, 0x0c0c0c0c); - } - - - ODM_SetBBReg(pDM_Odm, 0xbc4, bMaskDWord, 0x0005361f); - ODM_SetBBReg(pDM_Odm, rFPGA0_IQK, 0xffffff00, 0x000000); - - } else { - ODM_SetBBReg(pDM_Odm, rPdp_AntB, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, rPdp_AntB_4, bMaskDWord, 0x00000000); - } - } - - - for (index = 0; index < DP_BB_REG_NUM; index++) - ODM_SetBBReg(pDM_Odm, BB_REG[index], bMaskDWord, BB_backup[index]); - - - for (path = 0; path < DP_PATH_NUM; path++) { - for (i = 0 ; i < DP_RF_REG_NUM ; i++) { - ODM_SetRFReg(pDM_Odm, path, RF_REG[i], bMaskDWord, RF_backup[path][i]); - } - } - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE1, bMaskDWord, 0x1000f); - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_MODE2, bMaskDWord, 0x20101); - - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - _PHY_ReloadADDARegisters_8723D(pAdapter, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - - _PHY_ReloadMACRegisters_8723D(pAdapter, MAC_REG, MAC_backup); -#else - _PHY_ReloadADDARegisters_8723D(pDM_Odm, AFE_REG, AFE_backup, IQK_ADDA_REG_NUM); - - - _PHY_ReloadMACRegisters_8723D(pDM_Odm, MAC_REG, MAC_backup); -#endif - - pDM_Odm->RFCalibrateInfo.bDPdone = TRUE; - ODM_RT_TRACE(pDM_Odm,ODM_COMP_CALIBRATION, ODM_DBG_LOUD, ("<==phy_DigitalPredistortion_8723D()\n")); -#endif -} - -VOID -PHY_DigitalPredistortion_8723D( -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PADAPTER pAdapter -#else - IN PDM_ODM_T pDM_Odm -#endif - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif -#if DISABLE_BB_RF - return; -#endif - - return; - - if (pDM_Odm->RFCalibrateInfo.bDPdone) - return; -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - - if (IS_92C_SERIAL(pHalData->VersionID)) { - phy_DigitalPredistortion_8723D(pAdapter, TRUE); - } - else -#endif - { - - phy_DigitalPredistortion_8723D(pAdapter, FALSE); - } -} - - - - - -BOOLEAN phy_QueryRFPathSwitch_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN is2T - ) -{ -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - #if (DM_ODM_SUPPORT_TYPE == ODM_CE) - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - #endif - #if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - #endif -#endif - - - if (ODM_GetBBReg(pDM_Odm, 0x7C4, bMaskLWord) == 0x7700) - return TRUE; - else - return FALSE; - -} - - - - -BOOLEAN PHY_QueryRFPathSwitch_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm -#else - IN PADAPTER pAdapter -#endif - ) -{ - -#if DISABLE_BB_RF - return TRUE; -#endif - -#if !(DM_ODM_SUPPORT_TYPE & ODM_AP) - return phy_QueryRFPathSwitch_8723D(pAdapter, FALSE); -#else - return phy_QueryRFPathSwitch_8723D(pDM_Odm, FALSE); -#endif - -} -#endif - - - -#else - -VOID -PHY_IQCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN BOOLEAN bReCovery - ){} -VOID -PHY_LCCalibrate_8723D( - IN PDM_ODM_T pDM_Odm - ){} - -VOID -ODM_TxPwrTrackSetPwr_8723D( - PDM_ODM_T pDM_Odm, - PWRTRACK_METHOD Method, - u1Byte RFPath, - u1Byte ChannelMappedIndex - ){} -#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.h deleted file mode 100644 index 7138254ea346..000000000000 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/halphyrf_8723d.h +++ /dev/null @@ -1,153 +0,0 @@ -/****************************************************************************** - * - * 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 - * - * - ******************************************************************************/ - -#ifndef __HAL_PHY_RF_8723D_H__ -#define __HAL_PHY_RF_8723D_H__ - -/*--------------------------Define Parameters-------------------------------*/ -#define IQK_DELAY_TIME_8723D 10 //ms -#define index_mapping_NUM_8723D 15 -#define AVG_THERMAL_NUM_8723D 4 -#define RF_T_METER_8723D 0x42 - -void ConfigureTxpowerTrack_8723D( - PTXPWRTRACK_CFG pConfig - ); - -VOID -GetDeltaSwingTable_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PVOID pDM_VOID, -#else - IN PDM_ODM_T pDM_Odm, -#endif - OUT pu1Byte *TemperatureUP_A, - OUT pu1Byte *TemperatureDOWN_A, - OUT pu1Byte *TemperatureUP_B, - OUT pu1Byte *TemperatureDOWN_B - ); - -VOID -setCCKFilterCoefficient_8723D( - PDM_ODM_T pDM_Odm, - u1Byte CCKSwingIndex -); - -void DoIQK_8723D( - PVOID pDM_VOID, - u1Byte DeltaThermalIndex, - u1Byte ThermalValue, - u1Byte Threshold - ); - -VOID -ODM_TxPwrTrackSetPwr_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PVOID pDM_VOID, -#else - IN PDM_ODM_T pDM_Odm, -#endif - PWRTRACK_METHOD Method, - u1Byte RFPath, - u1Byte ChannelMappedIndex - ); - -VOID -ODM_TxXtalTrackSetXtal_8723D( - PVOID pDM_VOID -); - -//1 7. IQK - -void -PHY_IQCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER Adapter, -#endif - IN BOOLEAN bReCovery); - - -// -// LC calibrate -// -void -PHY_LCCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_CE) - PVOID pDM_VOID -#else - IN PDM_ODM_T pDM_Odm -#endif -); - -// -// AP calibrate -// -void -PHY_APCalibrate_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN s1Byte delta); -void -PHY_DigitalPredistortion_8723D( IN PADAPTER pAdapter); - - -VOID -_PHY_SaveADDARegisters_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte ADDAReg, - IN pu4Byte ADDABackup, - IN u4Byte RegisterNum - ); - -VOID -_PHY_PathADDAOn_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte ADDAReg, - IN BOOLEAN isPathAOn, - IN BOOLEAN is2T - ); - -VOID -_PHY_MACSettingCalibration_8723D( -#if (DM_ODM_SUPPORT_TYPE & ODM_AP) - IN PDM_ODM_T pDM_Odm, -#else - IN PADAPTER pAdapter, -#endif - IN pu4Byte MACReg, - IN pu4Byte MACBackup - ); - - -#endif // #ifndef __HAL_PHY_RF_8723D_H__ - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.c index 1fab6ef70aeb..0587e60feffe 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.c @@ -1,7 +1,7 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. - * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * * 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. @@ -11,179 +11,172 @@ * 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 "Mp_Precomp.h" +#include "mp_precomp.h" #include "../phydm_precomp.h" -#if (RTL8723D_SUPPORT == 1) +#if (RTL8723D_SUPPORT == 1) void -odm_ConfigRFReg_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Data, - IN ODM_RF_RADIO_PATH_E RF_PATH, - IN u4Byte RegAddr - ) +odm_config_rf_reg_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 data, + enum rf_path RF_PATH, + u32 reg_addr +) { - if(Addr == 0xfe || Addr == 0xffe) - { - #ifdef CONFIG_LONG_DELAY_ISSUE + if (addr == 0xfe || addr == 0xffe) { +#ifdef CONFIG_LONG_DELAY_ISSUE ODM_sleep_ms(50); - #else +#else ODM_delay_ms(50); - #endif - } - else - { - ODM_SetRFReg(pDM_Odm, RF_PATH, RegAddr, bRFRegOffsetMask, Data); - // Add 1us delay between BB/RF register setting. +#endif + } else { + odm_set_rf_reg(p_dm, RF_PATH, reg_addr, RFREGOFFSETMASK, data); + /* Add 1us delay between BB/RF register setting. */ ODM_delay_us(1); - } + } } -void -odm_ConfigRF_RadioA_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Data - ) +void +odm_config_rf_radio_a_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 data +) { - u4Byte content = 0x1000; // RF_Content: radioa_txt - u4Byte maskforPhySet= (u4Byte)(content&0xE000); + u32 content = 0x1000; /* RF_Content: radioa_txt */ + u32 maskfor_phy_set = (u32)(content & 0xE000); - odm_ConfigRFReg_8723D(pDM_Odm, Addr, Data, ODM_RF_PATH_A, Addr|maskforPhySet); + odm_config_rf_reg_8723d(p_dm, addr, data, RF_PATH_A, addr | maskfor_phy_set); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioA] %08X %08X\n", Addr, Data)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_config_rf_with_header_file: [RadioA] %08X %08X\n", addr, data)); } -void -odm_ConfigRF_RadioB_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Data - ) +void +odm_config_rf_radio_b_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 data +) { - u4Byte content = 0x1001; // RF_Content: radiob_txt - u4Byte maskforPhySet= (u4Byte)(content&0xE000); + u32 content = 0x1001; /* RF_Content: radiob_txt */ + u32 maskfor_phy_set = (u32)(content & 0xE000); + + odm_config_rf_reg_8723d(p_dm, addr, data, RF_PATH_B, addr | maskfor_phy_set); + + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_config_rf_with_header_file: [RadioB] %08X %08X\n", addr, data)); - odm_ConfigRFReg_8723D(pDM_Odm, Addr, Data, ODM_RF_PATH_B, Addr|maskforPhySet); - - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigRFWithHeaderFile: [RadioB] %08X %08X\n", Addr, Data)); - } -void -odm_ConfigMAC_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u1Byte Data - ) +void +odm_config_mac_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u8 data +) { - ODM_Write1Byte(pDM_Odm, Addr, Data); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigMACWithHeaderFile: [MAC_REG] %08X %08X\n", Addr, Data)); + odm_write_1byte(p_dm, addr, data); + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_config_mac_with_header_file: [MAC_REG] %08X %08X\n", addr, data)); } -void -odm_ConfigBB_AGC_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Bitmask, - IN u4Byte Data - ) +void +odm_config_bb_agc_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 bitmask, + u32 data +) { - ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); - // Add 1us delay between BB/RF register setting. + odm_set_bb_reg(p_dm, addr, bitmask, data); + /* Add 1us delay between BB/RF register setting. */ ODM_delay_us(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [AGC_TAB] %08X %08X\n", Addr, Data)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_config_bb_with_header_file: [AGC_TAB] %08X %08X\n", addr, data)); } void -odm_ConfigBB_PHY_REG_PG_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Band, - IN u4Byte RfPath, - IN u4Byte TxNum, - IN u4Byte Addr, - IN u4Byte Bitmask, - IN u4Byte Data - ) -{ - if (Addr == 0xfe || Addr == 0xffe) - #ifdef CONFIG_LONG_DELAY_ISSUE +odm_config_bb_phy_reg_pg_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 band, + u32 rf_path, + u32 tx_num, + u32 addr, + u32 bitmask, + u32 data +) +{ + if (addr == 0xfe || addr == 0xffe) +#ifdef CONFIG_LONG_DELAY_ISSUE ODM_sleep_ms(50); - #else +#else ODM_delay_ms(50); - #endif - else - { -#if !(DM_ODM_SUPPORT_TYPE&ODM_AP) - PHY_StoreTxPowerByRate(pDM_Odm->Adapter, Band, RfPath, TxNum, Addr, Bitmask, Data); #endif - } - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_LOUD, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X %08X\n", Addr, Bitmask, Data)); + else { +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) + phy_store_tx_power_by_rate(p_dm->adapter, band, rf_path, tx_num, addr, bitmask, data); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PHY_StoreTxPowerByRate(p_dm->adapter, band, rf_path, tx_num, addr, bitmask, data); +#endif + } + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_config_bb_with_header_file: [PHY_REG] %08X %08X %08X\n", addr, bitmask, data)); } -void -odm_ConfigBB_PHY_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Bitmask, - IN u4Byte Data - ) -{ -/*DbgPrint("odm_ConfigBB_PHY_8723D(), Addr = 0x%x, data = 0x%x\n", Addr, Data);*/ - if (Addr == 0xfe) - #ifdef CONFIG_LONG_DELAY_ISSUE +void +odm_config_bb_phy_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 bitmask, + u32 data +) +{ + /*dbg_print("odm_config_bb_phy_8723d(), addr = 0x%x, data = 0x%x\n", addr, data);*/ + if (addr == 0xfe) +#ifdef CONFIG_LONG_DELAY_ISSUE ODM_sleep_ms(50); - #else +#else ODM_delay_ms(50); - #endif - else if (Addr == 0xfd) +#endif + else if (addr == 0xfd) ODM_delay_ms(5); - else if (Addr == 0xfc) + else if (addr == 0xfc) ODM_delay_ms(1); - else if (Addr == 0xfb) + else if (addr == 0xfb) ODM_delay_us(50); - else if (Addr == 0xfa) + else if (addr == 0xfa) ODM_delay_us(5); - else if (Addr == 0xf9) + else if (addr == 0xf9) ODM_delay_us(1); - else - { - ODM_SetBBReg(pDM_Odm, Addr, Bitmask, Data); - } - - // Add 1us delay between BB/RF register setting. + else + odm_set_bb_reg(p_dm, addr, bitmask, data); + + /* Add 1us delay between BB/RF register setting. */ ODM_delay_us(1); - ODM_RT_TRACE(pDM_Odm,ODM_COMP_INIT, ODM_DBG_TRACE, ("===> ODM_ConfigBBWithHeaderFile: [PHY_REG] %08X %08X\n", Addr, Data)); + PHYDM_DBG(p_dm, ODM_COMP_INIT, ("===> odm_config_bb_with_header_file: [PHY_REG] %08X %08X\n", addr, data)); } void -odm_ConfigBB_TXPWR_LMT_8723D( - IN PDM_ODM_T pDM_Odm, - IN pu1Byte Regulation, - IN pu1Byte Band, - IN pu1Byte Bandwidth, - IN pu1Byte RateSection, - IN pu1Byte RfPath, - IN pu1Byte Channel, - IN pu1Byte PowerLimit - ) -{ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - PHY_SetTxPowerLimit(pDM_Odm, Regulation, Band, - Bandwidth, RateSection, RfPath, Channel, PowerLimit); +odm_config_bb_txpwr_lmt_8723d( + struct PHY_DM_STRUCT *p_dm, + u8 *regulation, + u8 *band, + u8 *bandwidth, + u8 *rate_section, + u8 *rf_path, + u8 *channel, + u8 *power_limit +) +{ +#if (DM_ODM_SUPPORT_TYPE & ODM_CE) + phy_set_tx_power_limit(p_dm, regulation, band, + bandwidth, rate_section, rf_path, channel, power_limit); +#elif (DM_ODM_SUPPORT_TYPE & ODM_WIN) + PHY_SetTxPowerLimit(p_dm, regulation, band, + bandwidth, rate_section, rf_path, channel, power_limit); #endif } #endif - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.h index 7ffeb0b847d5..a0874c4f1c44 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_regconfig8723d.h @@ -1,7 +1,7 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. - * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * * 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. @@ -11,88 +11,81 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_ODM_REGCONFIG_H_8723D #define __INC_ODM_REGCONFIG_H_8723D - + #if (RTL8723D_SUPPORT == 1) void -odm_ConfigRFReg_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Data, - IN ODM_RF_RADIO_PATH_E RF_PATH, - IN u4Byte RegAddr - ); - -void -odm_ConfigRF_RadioA_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Data - ); - -void -odm_ConfigRF_RadioB_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Data - ); - -void -odm_ConfigMAC_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u1Byte Data - ); - -void -odm_ConfigBB_AGC_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Bitmask, - IN u4Byte Data - ); +odm_config_rf_reg_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 data, + enum rf_path RF_PATH, + u32 reg_addr +); void -odm_ConfigBB_PHY_REG_PG_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Band, - IN u4Byte RfPath, - IN u4Byte TxNum, - IN u4Byte Addr, - IN u4Byte Bitmask, - IN u4Byte Data - ); +odm_config_rf_radio_a_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 data +); -void -odm_ConfigBB_PHY_8723D( - IN PDM_ODM_T pDM_Odm, - IN u4Byte Addr, - IN u4Byte Bitmask, - IN u4Byte Data - ); - void -odm_ConfigBB_TXPWR_LMT_8723D( - IN PDM_ODM_T pDM_Odm, - IN pu1Byte Regulation, - IN pu1Byte Band, - IN pu1Byte Bandwidth, - IN pu1Byte RateSection, - IN pu1Byte RfPath, - IN pu1Byte Channel, - IN pu1Byte PowerLimit - ); - - +odm_config_rf_radio_b_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 data +); + +void +odm_config_mac_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u8 data +); + +void +odm_config_bb_agc_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 bitmask, + u32 data +); + +void +odm_config_bb_phy_reg_pg_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 band, + u32 rf_path, + u32 tx_num, + u32 addr, + u32 bitmask, + u32 data +); + +void +odm_config_bb_phy_8723d( + struct PHY_DM_STRUCT *p_dm, + u32 addr, + u32 bitmask, + u32 data +); + +void +odm_config_bb_txpwr_lmt_8723d( + struct PHY_DM_STRUCT *p_dm, + u8 *regulation, + u8 *band, + u8 *bandwidth, + u8 *rate_section, + u8 *rf_path, + u8 *channel, + u8 *power_limit +); + + #endif -#endif // end of SUPPORT - - +#endif /* end of SUPPORT */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.c index 02d55debbcfc..fc4e42eaab9b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.c @@ -1,7 +1,7 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. - * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * * 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. @@ -11,12 +11,7 @@ * 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 files @@ -27,27 +22,27 @@ #if (RTL8723D_SUPPORT == 1) -s1Byte -odm_CCKRSSI_8723D( - IN u1Byte LNA_idx, - IN u1Byte VGA_idx - ) +s8 +odm_cckrssi_8723d( + u8 lna_idx, + u8 vga_idx +) { - s1Byte rx_pwr_all = 0x00; - - switch (LNA_idx) { + s8 rx_pwr_all = 0x00; + + switch (lna_idx) { case 0xf: - rx_pwr_all = -46 - (2 * VGA_idx); - break; - case 0xa: - rx_pwr_all = -20 - (2 * VGA_idx); + rx_pwr_all = -46 - (2 * vga_idx); break; - case 7: - rx_pwr_all = -10 - (2 * VGA_idx); - break; - case 4: - rx_pwr_all = 4 - (2 * VGA_idx); + case 0xa: + rx_pwr_all = -20 - (2 * vga_idx); + break; + case 7: + rx_pwr_all = -10 - (2 * vga_idx); + break; + case 4: + rx_pwr_all = 4 - (2 * vga_idx); break; default: break; @@ -58,11 +53,3 @@ odm_CCKRSSI_8723D( } #endif - - - - - - - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.h index 909602126309..6c8eeddd881b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/phydm_rtl8723d.h @@ -1,7 +1,7 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. - * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * * 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. @@ -11,22 +11,17 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __ODM_RTL8723D_H__ #define __ODM_RTL8723D_H__ #if (RTL8723D_SUPPORT == 1) -s1Byte -odm_CCKRSSI_8723D( - IN u1Byte LNA_idx, - IN u1Byte VGA_idx - ); +s8 +odm_cckrssi_8723d( + u8 lna_idx, + u8 vga_idx +); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/version_rtl8723d.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/version_rtl8723d.h index f27606c70b81..2bb4856f1e76 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/version_rtl8723d.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/rtl8723d/version_rtl8723d.h @@ -1,5 +1,4 @@ /*RTL8723D PHY Parameters*/ -#define SVN_COMMIT_VERSION_8723D 22597 -#define RELEASE_DATE_8723D 20161209 +#define RELEASE_DATE_8723D 20170824 #define COMMIT_BY_8723D "BB_Jessica" -#define RELEASE_VERSION_8723D 31 +#define RELEASE_VERSION_8723D 36 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.c index 395a21756a0d..f0e3164a2fb4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.c @@ -1,536 +1,552 @@ -//============================================================ -// Description: -// -// This file is for TXBF mechanism -// -//============================================================ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (BEAMFORMING_SUPPORT == 1) -/*Beamforming halcomtxbf API create by YuChen 2015/05*/ - -VOID -halComTxbf_beamformInit( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_RTL8822B) - HalTxbf8822B_Init(pDM_Odm); -} - -/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -VOID -halComTxbf_ConfigGtab( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->SupportICType & ODM_RTL8822B) - HalTxbf8822B_ConfigGtab(pDM_Odm); -} - -VOID -phydm_beamformSetSoundingEnter( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_EnterWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_EnterWorkItem)); -#else - halComTxbf_EnterWorkItemCallback(pDM_Odm); -#endif -} - -VOID -phydm_beamformSetSoundingLeave( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_LeaveWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_LeaveWorkItem)); -#else - halComTxbf_LeaveWorkItemCallback(pDM_Odm); -#endif -} - -VOID -phydm_beamformSetSoundingRate( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_RateWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_RateWorkItem)); -#else - halComTxbf_RateWorkItemCallback(pDM_Odm); -#endif -} - -VOID -phydm_beamformSetSoundingStatus( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_StatusWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_StatusWorkItem)); -#else - halComTxbf_StatusWorkItemCallback(pDM_Odm); -#endif -} - -VOID -phydm_beamformSetSoundingFwNdpa( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (*pDM_Odm->pbFwDwRsvdPageInProgress) - ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); - else - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); -#else - halComTxbf_FwNdpaWorkItemCallback(pDM_Odm); -#endif -} - -VOID -phydm_beamformSetSoundingClk( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ClkWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ClkWorkItem)); -#elif(DM_ODM_SUPPORT_TYPE == ODM_CE) - PADAPTER padapter = pDM_Odm->Adapter; - - rtw_run_in_thread_cmd(padapter, halComTxbf_ClkWorkItemCallback, padapter); -#else - halComTxbf_ClkWorkItemCallback(pDM_Odm); -#endif -} - -VOID -phydm_beamformSetResetTxPath( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_ResetTxPathWorkItem)); -#else - halComTxbf_ResetTxPathWorkItemCallback(pDM_Odm); -#endif -} - -VOID -phydm_beamformSetGetTxRate( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - if (PlatformIsWorkItemScheduled(&(pTxbfInfo->Txbf_GetTxRateWorkItem)) == FALSE) - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_GetTxRateWorkItem)); -#else - halComTxbf_GetTxRateWorkItemCallback(pDM_Odm); -#endif -} - -VOID -halComTxbf_EnterWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - u1Byte Idx = pTxbfInfo->TXBFIdx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) - HalTxbfJaguar_Enter(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8192E) - HalTxbf8192E_Enter(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8814A) - HalTxbf8814A_Enter(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8822B) - HalTxbf8822B_Enter(pDM_Odm, Idx); -} - -VOID -halComTxbf_LeaveWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - u1Byte Idx = pTxbfInfo->TXBFIdx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) - HalTxbfJaguar_Leave(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8192E) - HalTxbf8192E_Leave(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8814A) - HalTxbf8814A_Leave(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8822B) - HalTxbf8822B_Leave(pDM_Odm, Idx); -} - - -VOID -halComTxbf_FwNdpaWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - u1Byte Idx = pTxbfInfo->NdpaIdx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) - HalTxbfJaguar_FwTxBF(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8192E) - HalTxbf8192E_FwTxBF(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8814A) - HalTxbf8814A_FwTxBF(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8822B) - HalTxbf8822B_FwTxBF(pDM_Odm, Idx); -} - -VOID -halComTxbf_ClkWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pDM_Odm->SupportICType & ODM_RTL8812) - HalTxbfJaguar_Clk_8812A(pDM_Odm); -} - - - -VOID -halComTxbf_RateWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - u1Byte BW = pTxbfInfo->BW; - u1Byte Rate = pTxbfInfo->Rate; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pDM_Odm->SupportICType & ODM_RTL8812) - HalTxbf8812A_setNDPArate(pDM_Odm, BW, Rate); - else if (pDM_Odm->SupportICType & ODM_RTL8192E) - HalTxbf8192E_setNDPArate(pDM_Odm, BW, Rate); - else if (pDM_Odm->SupportICType & ODM_RTL8814A) - HalTxbf8814A_setNDPArate(pDM_Odm, BW, Rate); - -} - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -halComTxbf_FwNdpaTimerCallback( - IN PRT_TIMER pTimer - ) -{ - - PADAPTER Adapter = (PADAPTER)pTimer->Adapter; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (*pDM_Odm->pbFwDwRsvdPageInProgress) - ODM_SetTimer(pDM_Odm, &(pTxbfInfo->Txbf_FwNdpaTimer), 5); - else - PlatformScheduleWorkItem(&(pTxbfInfo->Txbf_FwNdpaWorkItem)); -} -#endif - - -VOID -halComTxbf_StatusWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - u1Byte Idx = pTxbfInfo->TXBFIdx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pDM_Odm->SupportICType & (ODM_RTL8812|ODM_RTL8821)) - HalTxbfJaguar_Status(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8192E) - HalTxbf8192E_Status(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8814A) - HalTxbf8814A_Status(pDM_Odm, Idx); - else if (pDM_Odm->SupportICType & ODM_RTL8822B) - HalTxbf8822B_Status(pDM_Odm, Idx); -} - -VOID -halComTxbf_ResetTxPathWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - u1Byte Idx = pTxbfInfo->TXBFIdx; - - if (pDM_Odm->SupportICType & ODM_RTL8814A) - HalTxbf8814A_ResetTxPath(pDM_Odm, Idx); - -} - -VOID -halComTxbf_GetTxRateWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ) -{ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; -#else - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#endif - - if (pDM_Odm->SupportICType & ODM_RTL8814A) - HalTxbf8814A_GetTxRate(pDM_Odm); -} - - -BOOLEAN -HalComTxbf_Set( - IN PVOID pDM_VOID, - IN u1Byte setType, - IN PVOID pInBuf - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - pu1Byte pU1Tmp=(pu1Byte)pInBuf; - PHAL_TXBF_INFO pTxbfInfo = &pDM_Odm->BeamformingInfo.TxbfInfo; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] setType = 0x%X\n", __func__, setType)); - - switch(setType){ - case TXBF_SET_SOUNDING_ENTER: - pTxbfInfo->TXBFIdx = *pU1Tmp; - phydm_beamformSetSoundingEnter(pDM_Odm); - break; - - case TXBF_SET_SOUNDING_LEAVE: - pTxbfInfo->TXBFIdx = *pU1Tmp; - phydm_beamformSetSoundingLeave(pDM_Odm); - break; - - case TXBF_SET_SOUNDING_RATE: - pTxbfInfo->BW = pU1Tmp[0]; - pTxbfInfo->Rate = pU1Tmp[1]; - phydm_beamformSetSoundingRate(pDM_Odm); - break; - - case TXBF_SET_SOUNDING_STATUS: - pTxbfInfo->TXBFIdx = *pU1Tmp; - phydm_beamformSetSoundingStatus(pDM_Odm); - break; - - case TXBF_SET_SOUNDING_FW_NDPA: - pTxbfInfo->NdpaIdx = *pU1Tmp; - phydm_beamformSetSoundingFwNdpa(pDM_Odm); - break; - - case TXBF_SET_SOUNDING_CLK: - phydm_beamformSetSoundingClk(pDM_Odm); - break; - - case TXBF_SET_TX_PATH_RESET: - pTxbfInfo->TXBFIdx = *pU1Tmp; - phydm_beamformSetResetTxPath(pDM_Odm); - break; - - case TXBF_SET_GET_TX_RATE: - phydm_beamformSetGetTxRate(pDM_Odm); - break; - - } - - return TRUE; -} - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -BOOLEAN -HalComTxbf_Get( - IN PADAPTER Adapter, - IN u1Byte getType, - OUT PVOID pOutBuf - ) -{ - PHAL_DATA_TYPE pHalData=GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - PBOOLEAN pBoolean=(PBOOLEAN)pOutBuf; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (getType == TXBF_GET_EXPLICIT_BEAMFORMEE) { - if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) - *pBoolean = FALSE; - else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ - IS_HARDWARE_TYPE_8821B(Adapter) || - IS_HARDWARE_TYPE_8192E(Adapter) || - IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) - *pBoolean = TRUE; - else - *pBoolean = FALSE; - } else if (getType == TXBF_GET_EXPLICIT_BEAMFORMER) { - if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(Adapter)) - *pBoolean = FALSE; - else if (/*IS_HARDWARE_TYPE_8822B(Adapter) ||*/ - IS_HARDWARE_TYPE_8821B(Adapter) || - IS_HARDWARE_TYPE_8192E(Adapter) || - IS_HARDWARE_TYPE_JAGUAR(Adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(Adapter)) { - if(pHalData->RF_Type == RF_2T2R || pHalData->RF_Type == RF_3T3R) - *pBoolean = TRUE; - else - *pBoolean = FALSE; - } else - *pBoolean = FALSE; - } else if (getType == TXBF_GET_MU_MIMO_STA) { -#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) - if (IS_HARDWARE_TYPE_8822B(Adapter) || IS_HARDWARE_TYPE_8821C(Adapter)) - *pBoolean = TRUE; - else -#endif - *pBoolean = FALSE; - - - } else if (getType == TXBF_GET_MU_MIMO_AP) { -#if (RTL8822B_SUPPORT == 1) - if (IS_HARDWARE_TYPE_8822B(Adapter)) - *pBoolean = TRUE; - else -#endif - *pBoolean = FALSE; - } - - return TRUE; -} -#endif - - -#endif - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * Description: + * + * This file is for TXBF mechanism + * + * ************************************************************ */ +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (BEAMFORMING_SUPPORT == 1) +/*Beamforming halcomtxbf API create by YuChen 2015/05*/ + +void +hal_com_txbf_beamform_init( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + boolean is_iqgen_setting_ok = false; + + if (p_dm->support_ic_type & ODM_RTL8814A) { + is_iqgen_setting_ok = phydm_beamforming_set_iqgen_8814A(p_dm); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] is_iqgen_setting_ok = %d\n", __func__, is_iqgen_setting_ok)); + } +} + +/*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ +void +hal_com_txbf_config_gtab( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_config_gtab(p_dm); +} + +void +phydm_beamform_set_sounding_enter( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (odm_is_work_item_scheduled(&(p_txbf_info->txbf_enter_work_item)) == false) + odm_schedule_work_item(&(p_txbf_info->txbf_enter_work_item)); +#else + hal_com_txbf_enter_work_item_callback(p_dm); +#endif +} + +void +phydm_beamform_set_sounding_leave( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (odm_is_work_item_scheduled(&(p_txbf_info->txbf_leave_work_item)) == false) + odm_schedule_work_item(&(p_txbf_info->txbf_leave_work_item)); +#else + hal_com_txbf_leave_work_item_callback(p_dm); +#endif +} + +void +phydm_beamform_set_sounding_rate( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (odm_is_work_item_scheduled(&(p_txbf_info->txbf_rate_work_item)) == false) + odm_schedule_work_item(&(p_txbf_info->txbf_rate_work_item)); +#else + hal_com_txbf_rate_work_item_callback(p_dm); +#endif +} + +void +phydm_beamform_set_sounding_status( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (odm_is_work_item_scheduled(&(p_txbf_info->txbf_status_work_item)) == false) + odm_schedule_work_item(&(p_txbf_info->txbf_status_work_item)); +#else + hal_com_txbf_status_work_item_callback(p_dm); +#endif +} + +void +phydm_beamform_set_sounding_fw_ndpa( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (*p_dm->p_is_fw_dw_rsvd_page_in_progress) + odm_set_timer(p_dm, &(p_txbf_info->txbf_fw_ndpa_timer), 5); + else + odm_schedule_work_item(&(p_txbf_info->txbf_fw_ndpa_work_item)); +#else + hal_com_txbf_fw_ndpa_work_item_callback(p_dm); +#endif +} + +void +phydm_beamform_set_sounding_clk( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (odm_is_work_item_scheduled(&(p_txbf_info->txbf_clk_work_item)) == false) + odm_schedule_work_item(&(p_txbf_info->txbf_clk_work_item)); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + struct _ADAPTER *padapter = p_dm->adapter; + + rtw_run_in_thread_cmd(padapter, hal_com_txbf_clk_work_item_callback, p_dm); +#else + hal_com_txbf_clk_work_item_callback(p_dm); +#endif +} + +void +phydm_beamform_set_reset_tx_path( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (odm_is_work_item_scheduled(&(p_txbf_info->txbf_reset_tx_path_work_item)) == false) + odm_schedule_work_item(&(p_txbf_info->txbf_reset_tx_path_work_item)); +#else + hal_com_txbf_reset_tx_path_work_item_callback(p_dm); +#endif +} + +void +phydm_beamform_set_get_tx_rate( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + if (odm_is_work_item_scheduled(&(p_txbf_info->txbf_get_tx_rate_work_item)) == false) + odm_schedule_work_item(&(p_txbf_info->txbf_get_tx_rate_work_item)); +#else + hal_com_txbf_get_tx_rate_work_item_callback(p_dm); +#endif +} + +void +hal_com_txbf_enter_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + u8 idx = p_txbf_info->txbf_idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_enter(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_enter(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_enter(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_enter(p_dm, idx); +} + +void +hal_com_txbf_leave_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + u8 idx = p_txbf_info->txbf_idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_leave(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_leave(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_leave(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_leave(p_dm, idx); +} + + +void +hal_com_txbf_fw_ndpa_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + u8 idx = p_txbf_info->ndpa_idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_fw_txbf(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_fw_tx_bf(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_fw_txbf(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_fw_txbf(p_dm, idx); +} + +void +hal_com_txbf_clk_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_dm->support_ic_type & ODM_RTL8812) + hal_txbf_jaguar_clk_8812a(p_dm); +} + + + +void +hal_com_txbf_rate_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + u8 BW = p_txbf_info->BW; + u8 rate = p_txbf_info->rate; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_dm->support_ic_type & ODM_RTL8812) + hal_txbf_8812a_set_ndpa_rate(p_dm, BW, rate); + else if (p_dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_set_ndpa_rate(p_dm, BW, rate); + else if (p_dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_set_ndpa_rate(p_dm, BW, rate); + +} + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +hal_com_txbf_fw_ndpa_timer_callback( + struct timer_list *p_timer +) +{ + + struct _ADAPTER *adapter = (struct _ADAPTER *)p_timer->Adapter; + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (*p_dm->p_is_fw_dw_rsvd_page_in_progress) + odm_set_timer(p_dm, &(p_txbf_info->txbf_fw_ndpa_timer), 5); + else + odm_schedule_work_item(&(p_txbf_info->txbf_fw_ndpa_work_item)); +} +#endif + + +void +hal_com_txbf_status_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + u8 idx = p_txbf_info->txbf_idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821)) + hal_txbf_jaguar_status(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8192E) + hal_txbf_8192e_status(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_status(p_dm, idx); + else if (p_dm->support_ic_type & ODM_RTL8822B) + hal_txbf_8822b_status(p_dm, idx); +} + +void +hal_com_txbf_reset_tx_path_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + u8 idx = p_txbf_info->txbf_idx; + + if (p_dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_reset_tx_path(p_dm, idx); + +} + +void +hal_com_txbf_get_tx_rate_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +) +{ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; +#else + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#endif + + if (p_dm->support_ic_type & ODM_RTL8814A) + hal_txbf_8814a_get_tx_rate(p_dm); +} + + +boolean +hal_com_txbf_set( + void *p_dm_void, + u8 set_type, + void *p_in_buf +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 *p_u1_tmp = (u8 *)p_in_buf; + struct _HAL_TXBF_INFO *p_txbf_info = &p_dm->beamforming_info.txbf_info; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] set_type = 0x%X\n", __func__, set_type)); + + switch (set_type) { + case TXBF_SET_SOUNDING_ENTER: + p_txbf_info->txbf_idx = *p_u1_tmp; + phydm_beamform_set_sounding_enter(p_dm); + break; + + case TXBF_SET_SOUNDING_LEAVE: + p_txbf_info->txbf_idx = *p_u1_tmp; + phydm_beamform_set_sounding_leave(p_dm); + break; + + case TXBF_SET_SOUNDING_RATE: + p_txbf_info->BW = p_u1_tmp[0]; + p_txbf_info->rate = p_u1_tmp[1]; + phydm_beamform_set_sounding_rate(p_dm); + break; + + case TXBF_SET_SOUNDING_STATUS: + p_txbf_info->txbf_idx = *p_u1_tmp; + phydm_beamform_set_sounding_status(p_dm); + break; + + case TXBF_SET_SOUNDING_FW_NDPA: + p_txbf_info->ndpa_idx = *p_u1_tmp; + phydm_beamform_set_sounding_fw_ndpa(p_dm); + break; + + case TXBF_SET_SOUNDING_CLK: + phydm_beamform_set_sounding_clk(p_dm); + break; + + case TXBF_SET_TX_PATH_RESET: + p_txbf_info->txbf_idx = *p_u1_tmp; + phydm_beamform_set_reset_tx_path(p_dm); + break; + + case TXBF_SET_GET_TX_RATE: + phydm_beamform_set_get_tx_rate(p_dm); + break; + + } + + return true; +} + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +boolean +hal_com_txbf_get( + struct _ADAPTER *adapter, + u8 get_type, + void *p_out_buf +) +{ + PHAL_DATA_TYPE p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + boolean *p_boolean = (boolean *)p_out_buf; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (get_type == TXBF_GET_EXPLICIT_BEAMFORMEE) { + if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(adapter)) + *p_boolean = false; + else if (/*IS_HARDWARE_TYPE_8822B(adapter) ||*/ + IS_HARDWARE_TYPE_8821B(adapter) || + IS_HARDWARE_TYPE_8192E(adapter) || + IS_HARDWARE_TYPE_JAGUAR(adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) + *p_boolean = true; + else + *p_boolean = false; + } else if (get_type == TXBF_GET_EXPLICIT_BEAMFORMER) { + if (IS_HARDWARE_TYPE_OLDER_THAN_8812A(adapter)) + *p_boolean = false; + else if (/*IS_HARDWARE_TYPE_8822B(adapter) ||*/ + IS_HARDWARE_TYPE_8821B(adapter) || + IS_HARDWARE_TYPE_8192E(adapter) || + IS_HARDWARE_TYPE_JAGUAR(adapter) || IS_HARDWARE_TYPE_JAGUAR_AND_JAGUAR2(adapter)) { + if (p_hal_data->RF_Type == RF_2T2R || p_hal_data->RF_Type == RF_3T3R) + *p_boolean = true; + else + *p_boolean = false; + } else + *p_boolean = false; + } else if (get_type == TXBF_GET_MU_MIMO_STA) { +#if ((RTL8822B_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) + if (IS_HARDWARE_TYPE_8822B(adapter) || IS_HARDWARE_TYPE_8821C(adapter)) + *p_boolean = true; + else +#endif + *p_boolean = false; + + + } else if (get_type == TXBF_GET_MU_MIMO_AP) { +#if (RTL8822B_SUPPORT == 1) + if (IS_HARDWARE_TYPE_8822B(adapter)) + *p_boolean = true; + else +#endif + *p_boolean = false; + } + + return true; +} +#endif + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.h index 4d87082ab83e..0d95b69908e2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/halcomtxbf.h @@ -1,180 +1,193 @@ -#ifndef __HAL_COM_TXBF_H__ -#define __HAL_COM_TXBF_H__ - -/* -typedef BOOLEAN -(*TXBF_GET)( - IN PVOID pAdapter, - IN u1Byte getType, - OUT PVOID pOutBuf - ); - -typedef BOOLEAN -(*TXBF_SET)( - IN PVOID pAdapter, - IN u1Byte setType, - OUT PVOID pInBuf - ); -*/ - -typedef enum _TXBF_SET_TYPE{ - TXBF_SET_SOUNDING_ENTER, - TXBF_SET_SOUNDING_LEAVE, - TXBF_SET_SOUNDING_RATE, - TXBF_SET_SOUNDING_STATUS, - TXBF_SET_SOUNDING_FW_NDPA, - TXBF_SET_SOUNDING_CLK, - TXBF_SET_TX_PATH_RESET, - TXBF_SET_GET_TX_RATE -}TXBF_SET_TYPE,*PTXBF_SET_TYPE; - - -typedef enum _TXBF_GET_TYPE{ - TXBF_GET_EXPLICIT_BEAMFORMEE, - TXBF_GET_EXPLICIT_BEAMFORMER, - TXBF_GET_MU_MIMO_STA, - TXBF_GET_MU_MIMO_AP -}TXBF_GET_TYPE,*PTXBF_GET_TYPE; - - - -//2 HAL TXBF related -typedef struct _HAL_TXBF_INFO { - u1Byte TXBFIdx; - u1Byte NdpaIdx; - u1Byte BW; - u1Byte Rate; - - RT_TIMER Txbf_FwNdpaTimer; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_WORK_ITEM Txbf_EnterWorkItem; - RT_WORK_ITEM Txbf_LeaveWorkItem; - RT_WORK_ITEM Txbf_FwNdpaWorkItem; - RT_WORK_ITEM Txbf_ClkWorkItem; - RT_WORK_ITEM Txbf_StatusWorkItem; - RT_WORK_ITEM Txbf_RateWorkItem; - RT_WORK_ITEM Txbf_ResetTxPathWorkItem; - RT_WORK_ITEM Txbf_GetTxRateWorkItem; -#endif - -} HAL_TXBF_INFO, *PHAL_TXBF_INFO; - -#if (BEAMFORMING_SUPPORT == 1) - -VOID -halComTxbf_beamformInit( - IN PVOID pDM_VOID - ); - -VOID -halComTxbf_ConfigGtab( - IN PVOID pDM_VOID - ); - -VOID -halComTxbf_EnterWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -halComTxbf_LeaveWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -halComTxbf_FwNdpaWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -halComTxbf_ClkWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -halComTxbf_ResetTxPathWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -halComTxbf_GetTxRateWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -halComTxbf_RateWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -VOID -halComTxbf_FwNdpaTimerCallback( - IN PRT_TIMER pTimer - ); - -VOID -halComTxbf_StatusWorkItemCallback( -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN PADAPTER Adapter -#else - IN PVOID pDM_VOID -#endif - ); - -BOOLEAN -HalComTxbf_Set( - IN PVOID pDM_VOID, - IN u1Byte setType, - IN PVOID pInBuf - ); - -BOOLEAN -HalComTxbf_Get( - IN PADAPTER Adapter, - IN u1Byte getType, - OUT PVOID pOutBuf - ); - -#else -#define halComTxbf_beamformInit(pDM_VOID) NULL -#define halComTxbf_ConfigGtab(pDM_VOID) NULL -#define halComTxbf_EnterWorkItemCallback(_Adapter) NULL -#define halComTxbf_LeaveWorkItemCallback(_Adapter) NULL -#define halComTxbf_FwNdpaWorkItemCallback(_Adapter) NULL -#define halComTxbf_ClkWorkItemCallback(_Adapter) NULL -#define halComTxbf_RateWorkItemCallback(_Adapter) NULL -#define halComTxbf_FwNdpaTimerCallback(_Adapter) NULL -#define halComTxbf_StatusWorkItemCallback(_Adapter) NULL -#define HalComTxbf_Get(_Adapter, _getType, _pOutBuf) - -#endif - -#endif // #ifndef __HAL_COM_TXBF_H__ - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HAL_COM_TXBF_H__ +#define __HAL_COM_TXBF_H__ + +/* +typedef bool +(*TXBF_GET)( + void* p_adapter, + u8 get_type, + void* p_out_buf + ); + +typedef bool +(*TXBF_SET)( + void* p_adapter, + u8 set_type, + void* p_in_buf + ); +*/ + +enum txbf_set_type { + TXBF_SET_SOUNDING_ENTER, + TXBF_SET_SOUNDING_LEAVE, + TXBF_SET_SOUNDING_RATE, + TXBF_SET_SOUNDING_STATUS, + TXBF_SET_SOUNDING_FW_NDPA, + TXBF_SET_SOUNDING_CLK, + TXBF_SET_TX_PATH_RESET, + TXBF_SET_GET_TX_RATE +}; + + +enum txbf_get_type { + TXBF_GET_EXPLICIT_BEAMFORMEE, + TXBF_GET_EXPLICIT_BEAMFORMER, + TXBF_GET_MU_MIMO_STA, + TXBF_GET_MU_MIMO_AP +}; + + + +/* 2 HAL TXBF related */ +struct _HAL_TXBF_INFO { + u8 txbf_idx; + u8 ndpa_idx; + u8 BW; + u8 rate; + + struct timer_list txbf_fw_ndpa_timer; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + RT_WORK_ITEM txbf_enter_work_item; + RT_WORK_ITEM txbf_leave_work_item; + RT_WORK_ITEM txbf_fw_ndpa_work_item; + RT_WORK_ITEM txbf_clk_work_item; + RT_WORK_ITEM txbf_status_work_item; + RT_WORK_ITEM txbf_rate_work_item; + RT_WORK_ITEM txbf_reset_tx_path_work_item; + RT_WORK_ITEM txbf_get_tx_rate_work_item; +#endif + +}; + +#if (BEAMFORMING_SUPPORT == 1) + +void +hal_com_txbf_beamform_init( + void *p_dm_void +); + +void +hal_com_txbf_config_gtab( + void *p_dm_void +); + +void +hal_com_txbf_enter_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +hal_com_txbf_leave_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +hal_com_txbf_fw_ndpa_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +hal_com_txbf_clk_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +hal_com_txbf_reset_tx_path_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +hal_com_txbf_get_tx_rate_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +hal_com_txbf_rate_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +void +hal_com_txbf_fw_ndpa_timer_callback( + struct timer_list *p_timer +); + +void +hal_com_txbf_status_work_item_callback( +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + struct _ADAPTER *adapter +#else + void *p_dm_void +#endif +); + +boolean +hal_com_txbf_set( + void *p_dm_void, + u8 set_type, + void *p_in_buf +); + +boolean +hal_com_txbf_get( + struct _ADAPTER *adapter, + u8 get_type, + void *p_out_buf +); + +#else +#define hal_com_txbf_beamform_init(p_dm_void) NULL +#define hal_com_txbf_config_gtab(p_dm_void) NULL +#define hal_com_txbf_enter_work_item_callback(_adapter) NULL +#define hal_com_txbf_leave_work_item_callback(_adapter) NULL +#define hal_com_txbf_fw_ndpa_work_item_callback(_adapter) NULL +#define hal_com_txbf_clk_work_item_callback(_adapter) NULL +#define hal_com_txbf_rate_work_item_callback(_adapter) NULL +#define hal_com_txbf_fw_ndpa_timer_callback(_adapter) NULL +#define hal_com_txbf_status_work_item_callback(_adapter) NULL +#define hal_com_txbf_get(_adapter, _get_type, _pout_buf) + +#endif + +#endif /* #ifndef __HAL_COM_TXBF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.c index 778eb919d597..e82a99b8713e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.c @@ -1,392 +1,401 @@ -//============================================================ -// Description: -// -// This file is for 8192E TXBF mechanism -// -//============================================================ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (BEAMFORMING_SUPPORT == 1) -#if (RTL8192E_SUPPORT == 1) - -VOID -HalTxbf8192E_setNDPArate( - IN PVOID pDM_VOID, - IN u1Byte BW, - IN u1Byte Rate -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8192E, (Rate << 2 | BW)); - -} - -VOID -halTxbf8192E_RfMode( - IN PVOID pDM_VOID, - IN PRT_BEAMFORMING_INFO pBeamInfo -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - BOOLEAN bSelfBeamformer = FALSE; - BOOLEAN bSelfBeamformee = FALSE; - BEAMFORMING_CAP BeamformCap = BEAMFORMING_CAP_NONE; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pDM_Odm->RFType == ODM_1T1R) - return; - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF Mode table write enable*/ - - if (pBeamInfo->beamformee_su_cnt > 0) { - /*Path_A*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ - /*Path_B*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ - } else { - /*Path_A*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ - /*Path_B*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0xfffff, 0x18000); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x0000f); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ - } - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WE_LUT, 0x80000, 0x0); /*RF Mode table write disable*/ - - if (pBeamInfo->beamformee_su_cnt > 0) { - ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x83321333); - ODM_SetBBReg(pDM_Odm, rCCK0_AFESetting, bMaskByte3, 0xc1); - } else - ODM_SetBBReg(pDM_Odm, rFPGA1_TxInfo, bMaskDWord, 0x81121313); -} - - - -VOID -halTxbf8192E_FwTxBFCmd( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Idx, Period0 = 0, Period1 = 0; - u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; - u1Byte u1TxBFParm[3] = {0}; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { - if (pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - if (Idx == 0) { - if (pBeamInfo->BeamformeeEntry[Idx].bSound) - PageNum0 = 0xFE; - else - PageNum0 = 0xFF; //stop sounding - Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); - } else if (Idx == 1) { - if (pBeamInfo->BeamformeeEntry[Idx].bSound) - PageNum1 = 0xFE; - else - PageNum1 = 0xFF; //stop sounding - Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); - } - } - } - - u1TxBFParm[0] = PageNum0; - u1TxBFParm[1] = PageNum1; - u1TxBFParm[2] = (Period1 << 4) | Period0; - ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, - ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); -} - - -VOID -halTxbf8192E_DownloadNDPA( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; - u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; - BOOLEAN bSendBeacon = FALSE; - PADAPTER Adapter = pDM_Odm->Adapter; - u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; - /*default reseved 1 page for the IC type which is undefined.*/ - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -#endif - if (Idx == 0) - Head_Page = 0xFE; - else - Head_Page = 0xFE; - - Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); - - /*Set REG_CR bit 8. DMA beacon by SW.*/ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); - ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp | BIT0)); - - /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ - tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2); - ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422 & (~BIT6)); - - if (tmpReg422 & BIT6) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s There is an Adapter is sending beacon.\n", __func__)); - bSendBeacon = TRUE; - } - - /*TDECTRL[15:8] 0x209[7:0] = 0xFE/0xFD NDPA Head for TXDMA*/ - ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, Head_Page); - - do { - /*Clear beacon valid check bit.*/ - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); - ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2, (BcnValidReg | BIT0)); - - // download NDPA rsvd page. - Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); - -#if(DEV_BUS_TYPE == RT_PCI_INTERFACE) - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); - count = 0; - while ((count < 20) && (u1bTmp & BIT4)) { - count++; - ODM_delay_us(10); - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3); - } - ODM_Write1Byte(pDM_Odm, REG_MGQ_TXBD_NUM_8192E+3, u1bTmp | BIT4); -#endif - - /*check rsvd page download OK.*/ - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); - count = 0; - while (!(BcnValidReg & BIT0) && count < 20) { - count++; - ODM_delay_us(10); - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+2); - } - DLBcnCount++; - } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); - - if (!(BcnValidReg & BIT0)) - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_WARNING, ("%s Download RSVD page failed!\n", __func__)); - - /*TDECTRL[15:8] 0x209[7:0] = 0xF9 Beacon Head for TXDMA*/ - ODM_Write1Byte(pDM_Odm, REG_DWBCN0_CTRL_8192E+1, TxPageBndy); - - /*To make sure that if there exists an adapter which would like to send beacon.*/ - /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ - /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ - /*the beacon cannot be sent by HW.*/ - /*2010.06.23. Added by tynli.*/ - if (bSendBeacon) - ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8192E+2, tmpReg422); - - /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ - /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8192E+1); - ODM_Write1Byte(pDM_Odm, REG_CR_8192E+1, (u1bTmp & (~BIT0))); - - pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -#endif -} - - -VOID -HalTxbf8192E_Enter( - IN PVOID pDM_VOID, - IN u1Byte BFerBFeeIdx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; - u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); - u4Byte CSI_Param; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - RT_BEAMFORMER_ENTRY BeamformerEntry; - u2Byte STAid = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - halTxbf8192E_RfMode(pDM_Odm, pBeamformingInfo); - - if (pDM_Odm->RFType == ODM_2T2R) - ODM_Write4Byte(pDM_Odm, 0xd80, 0x00000000); /*Nc =2*/ - - if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { - BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; - - /*Sounding protocol control*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xCB); - - /*MAC address/Partial AID of Beamformer*/ - if (BFerIdx == 0) { - for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8192E+i), BeamformerEntry.MacAddr[i]); - } else { - for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8192E+i), BeamformerEntry.MacAddr[i]); - } - - /*CSI report parameters of Beamformer Default use Nc = 2*/ - CSI_Param = 0x03090309; - - ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8192E, CSI_Param); - ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8192E, CSI_Param); - ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8192E, CSI_Param); - - /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E+3, 0x50); - - } - - if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - STAid = BeamformeeEntry.MacId; - else - STAid = BeamformeeEntry.P_AID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s], STAid=0x%X\n", __func__, STAid)); - - /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ - if (BFeeIdx == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, STAid); - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+3) | BIT4 | BIT6 | BIT7); - } else - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, STAid | BIT12 | BIT14 | BIT15); - - /*CSI report parameters of Beamformee*/ - if (BFeeIdx == 0) { - /*Get BIT24 & BIT25*/ - u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3) & 0x3; - - ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+3, tmp | 0x60); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, STAid | BIT9); - } else { - /*Set BIT25*/ - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, STAid | 0xE200); - } - phydm_Beamforming_Notify(pDM_Odm); - - } -} - - -VOID -HalTxbf8192E_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - halTxbf8192E_RfMode(pDM_Odm, pBeamInfo); - - /* Clear P_AID of Beamformee - * Clear MAC addresss of Beamformer - * Clear Associated Bfmee Sel - */ - if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8192E, 0xC8); - - if (Idx == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E, 0); - ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8192E+4, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); - } else { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8192E+2) & 0xF000); - ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8192E+4, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8192E+2) & 0x60); - } - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d\n", __func__, Idx)); -} - - -VOID -HalTxbf8192E_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u2Byte BeamCtrlVal; - u4Byte BeamCtrlReg; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - BeamCtrlVal = BeamformEntry.MacId; - else - BeamCtrlVal = BeamformEntry.P_AID; - - if (Idx == 0) - BeamCtrlReg = REG_TXBF_CTRL_8192E; - else { - BeamCtrlReg = REG_TXBF_CTRL_8192E+2; - BeamCtrlVal |= BIT12 | BIT14 | BIT15; - } - - if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamInfo->applyVmatrix == TRUE)) { - if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) - BeamCtrlVal |= BIT9; - else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) - BeamCtrlVal |= BIT10; - } else - BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); - - ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Idx %d BeamCtrlReg %x BeamCtrlVal %x\n", __func__, Idx, BeamCtrlReg, BeamCtrlVal)); -} - - -VOID -HalTxbf8192E_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) - halTxbf8192E_DownloadNDPA(pDM_Odm, Idx); - - halTxbf8192E_FwTxBFCmd(pDM_Odm); -} - -#endif /* #if (RTL8192E_SUPPORT == 1)*/ - -#endif - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * Description: + * + * This file is for 8192E TXBF mechanism + * + * ************************************************************ */ +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (BEAMFORMING_SUPPORT == 1) +#if (RTL8192E_SUPPORT == 1) + +void +hal_txbf_8192e_set_ndpa_rate( + void *p_dm_void, + u8 BW, + u8 rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + odm_write_1byte(p_dm, REG_NDPA_OPT_CTRL_8192E, (rate << 2 | BW)); + +} + +void +hal_txbf_8192e_rf_mode( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_dm->rf_type == RF_1T1R) + return; + + odm_set_rf_reg(p_dm, RF_PATH_A, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(p_dm, RF_PATH_B, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ + + if (p_beam_info->beamformee_su_cnt > 0) { + /*Path_A*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*Select RX mode 0x30=0x18000*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ + /*Path_B*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0xfffff, 0x18000); /*Select RX mode*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0x77fc2); /*Enable TXIQGEN in RX mode*/ + } else { + /*Path_A*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0xfffff, 0x18000); /*Select RX mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ + /*Path_B*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0xfffff, 0x18000); /*Select RX mode*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x0000f); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0x77f82); /*Disable TXIQGEN in RX mode*/ + } + + odm_set_rf_reg(p_dm, RF_PATH_A, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ + odm_set_rf_reg(p_dm, RF_PATH_B, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ + + if (p_beam_info->beamformee_su_cnt > 0) { + odm_set_bb_reg(p_dm, 0x90c, MASKDWORD, 0x83321333); + odm_set_bb_reg(p_dm, 0xa04, MASKBYTE3, 0xc1); + } else + odm_set_bb_reg(p_dm, 0x90c, MASKDWORD, 0x81121313); +} + + + +void +hal_txbf_8192e_fw_txbf_cmd( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx, period0 = 0, period1 = 0; + u8 PageNum0 = 0xFF, PageNum1 = 0xFF; + u8 u1_tx_bf_parm[3] = {0}; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + if (p_beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (idx == 0) { + if (p_beam_info->beamformee_entry[idx].is_sound) + PageNum0 = 0xFE; + else + PageNum0 = 0xFF; /* stop sounding */ + period0 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + } else if (idx == 1) { + if (p_beam_info->beamformee_entry[idx].is_sound) + PageNum1 = 0xFE; + else + PageNum1 = 0xFF; /* stop sounding */ + period1 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + } + } + } + + u1_tx_bf_parm[0] = PageNum0; + u1_tx_bf_parm[1] = PageNum1; + u1_tx_bf_parm[2] = (period1 << 4) | period0; + odm_fill_h2c_cmd(p_dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); + + PHYDM_DBG(p_dm, DBG_TXBF, + ("[%s] PageNum0 = %d period0 = %d, PageNum1 = %d period1 %d\n", __func__, PageNum0, period0, PageNum1, period1)); +} + + +void +hal_txbf_8192e_download_ndpa( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 u1b_tmp = 0, tmp_reg422 = 0, head_page; + u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; + boolean is_send_beacon = false; + u8 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; + /*default reseved 1 page for the IC type which is undefined.*/ + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + *p_dm->p_is_fw_dw_rsvd_page_in_progress = true; +#endif + if (idx == 0) + head_page = 0xFE; + else + head_page = 0xFE; + + phydm_get_hal_def_var_handler_interface(p_dm, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_page_bndy); + + /*Set REG_CR bit 8. DMA beacon by SW.*/ + u1b_tmp = odm_read_1byte(p_dm, REG_CR_8192E+1); + odm_write_1byte(p_dm, REG_CR_8192E+1, (u1b_tmp | BIT(0))); + + /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ + tmp_reg422 = odm_read_1byte(p_dm, REG_FWHW_TXQ_CTRL_8192E+2); + odm_write_1byte(p_dm, REG_FWHW_TXQ_CTRL_8192E+2, tmp_reg422 & (~BIT(6))); + + if (tmp_reg422 & BIT(6)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s There is an adapter is sending beacon.\n", __func__)); + is_send_beacon = true; + } + + /*TDECTRL[15:8] 0x209[7:0] = 0xFE/0xFD NDPA Head for TXDMA*/ + odm_write_1byte(p_dm, REG_DWBCN0_CTRL_8192E+1, head_page); + + do { + /*Clear beacon valid check bit.*/ + bcn_valid_reg = odm_read_1byte(p_dm, REG_DWBCN0_CTRL_8192E+2); + odm_write_1byte(p_dm, REG_DWBCN0_CTRL_8192E+2, (bcn_valid_reg | BIT(0))); + + /* download NDPA rsvd page. */ + beamforming_send_ht_ndpa_packet(p_dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + +#if (DEV_BUS_TYPE == RT_PCI_INTERFACE) + u1b_tmp = odm_read_1byte(p_dm, REG_MGQ_TXBD_NUM_8192E+3); + count = 0; + while ((count < 20) && (u1b_tmp & BIT(4))) { + count++; + ODM_delay_us(10); + u1b_tmp = odm_read_1byte(p_dm, REG_MGQ_TXBD_NUM_8192E+3); + } + odm_write_1byte(p_dm, REG_MGQ_TXBD_NUM_8192E+3, u1b_tmp | BIT(4)); +#endif + + /*check rsvd page download OK.*/ + bcn_valid_reg = odm_read_1byte(p_dm, REG_DWBCN0_CTRL_8192E+2); + count = 0; + while (!(bcn_valid_reg & BIT(0)) && count < 20) { + count++; + ODM_delay_us(10); + bcn_valid_reg = odm_read_1byte(p_dm, REG_DWBCN0_CTRL_8192E+2); + } + dl_bcn_count++; + } while (!(bcn_valid_reg & BIT(0)) && dl_bcn_count < 5); + + if (!(bcn_valid_reg & BIT(0))) + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Download RSVD page failed!\n", __func__)); + + /*TDECTRL[15:8] 0x209[7:0] = 0xF9 Beacon Head for TXDMA*/ + odm_write_1byte(p_dm, REG_DWBCN0_CTRL_8192E+1, tx_page_bndy); + + /*To make sure that if there exists an adapter which would like to send beacon.*/ + /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ + /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ + /*the beacon cannot be sent by HW.*/ + /*2010.06.23. Added by tynli.*/ + if (is_send_beacon) + odm_write_1byte(p_dm, REG_FWHW_TXQ_CTRL_8192E+2, tmp_reg422); + + /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ + /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ + u1b_tmp = odm_read_1byte(p_dm, REG_CR_8192E+1); + odm_write_1byte(p_dm, REG_CR_8192E+1, (u1b_tmp & (~BIT(0)))); + + p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + *p_dm->p_is_fw_dw_rsvd_page_in_progress = false; +#endif +} + + +void +hal_txbf_8192e_enter( + void *p_dm_void, + u8 bfer_bfee_idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; + u8 bfee_idx = (bfer_bfee_idx & 0xF); + u32 csi_param; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + u16 sta_id = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + hal_txbf_8192e_rf_mode(p_dm, p_beamforming_info); + + if (p_dm->rf_type == RF_2T2R) + odm_write_4byte(p_dm, 0xd80, 0x00000000); /*nc =2*/ + + if ((p_beamforming_info->beamformer_su_cnt > 0) && (bfer_idx < BEAMFORMER_ENTRY_NUM)) { + beamformer_entry = p_beamforming_info->beamformer_entry[bfer_idx]; + + /*Sounding protocol control*/ + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8192E, 0xCB); + + /*MAC address/Partial AID of Beamformer*/ + if (bfer_idx == 0) { + for (i = 0; i < 6 ; i++) + odm_write_1byte(p_dm, (REG_ASSOCIATED_BFMER0_INFO_8192E+i), beamformer_entry.mac_addr[i]); + } else { + for (i = 0; i < 6 ; i++) + odm_write_1byte(p_dm, (REG_ASSOCIATED_BFMER1_INFO_8192E+i), beamformer_entry.mac_addr[i]); + } + + /*CSI report parameters of Beamformer Default use nc = 2*/ + csi_param = 0x03090309; + + odm_write_4byte(p_dm, REG_CSI_RPT_PARAM_BW20_8192E, csi_param); + odm_write_4byte(p_dm, REG_CSI_RPT_PARAM_BW40_8192E, csi_param); + odm_write_4byte(p_dm, REG_CSI_RPT_PARAM_BW80_8192E, csi_param); + + /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8192E+3, 0x50); + + } + + if ((p_beamforming_info->beamformee_su_cnt > 0) && (bfee_idx < BEAMFORMEE_ENTRY_NUM)) { + beamformee_entry = p_beamforming_info->beamformee_entry[bfee_idx]; + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + sta_id = beamformee_entry.mac_id; + else + sta_id = beamformee_entry.p_aid; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s], sta_id=0x%X\n", __func__, sta_id)); + + /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ + if (bfee_idx == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8192E, sta_id); + odm_write_1byte(p_dm, REG_TXBF_CTRL_8192E+3, odm_read_1byte(p_dm, REG_TXBF_CTRL_8192E+3) | BIT(4) | BIT(6) | BIT(7)); + } else + odm_write_2byte(p_dm, REG_TXBF_CTRL_8192E+2, sta_id | BIT(12) | BIT(14) | BIT(15)); + + /*CSI report parameters of Beamformee*/ + if (bfee_idx == 0) { + /*Get BIT24 & BIT25*/ + u8 tmp = odm_read_1byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8192E+3) & 0x3; + + odm_write_1byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8192E+3, tmp | 0x60); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8192E, sta_id | BIT(9)); + } else { + /*Set BIT25*/ + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, sta_id | 0xE200); + } + phydm_beamforming_notify(p_dm); + + } +} + + +void +hal_txbf_8192e_leave( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + hal_txbf_8192e_rf_mode(p_dm, p_beam_info); + + /* Clear P_AID of Beamformee + * Clear MAC addresss of Beamformer + * Clear Associated Bfmee Sel + */ + if (p_beam_info->beamform_cap == BEAMFORMING_CAP_NONE) + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8192E, 0xC8); + + if (idx == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8192E, 0); + odm_write_4byte(p_dm, REG_ASSOCIATED_BFMER0_INFO_8192E, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMER0_INFO_8192E+4, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8192E, 0); + } else { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8192E+2, odm_read_1byte(p_dm, REG_TXBF_CTRL_8192E+2) & 0xF000); + odm_write_4byte(p_dm, REG_ASSOCIATED_BFMER1_INFO_8192E, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMER1_INFO_8192E+4, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8192E+2, odm_read_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8192E+2) & 0x60); + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] idx %d\n", __func__, idx)); +} + + +void +hal_txbf_8192e_status( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 beam_ctrl_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamform_entry = p_beam_info->beamformee_entry[idx]; + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + beam_ctrl_val = beamform_entry.mac_id; + else + beam_ctrl_val = beamform_entry.p_aid; + + if (idx == 0) + beam_ctrl_reg = REG_TXBF_CTRL_8192E; + else { + beam_ctrl_reg = REG_TXBF_CTRL_8192E+2; + beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); + } + + if ((beamform_entry.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (p_beam_info->apply_v_matrix == true)) { + if (beamform_entry.sound_bw == CHANNEL_WIDTH_20) + beam_ctrl_val |= BIT(9); + else if (beamform_entry.sound_bw == CHANNEL_WIDTH_40) + beam_ctrl_val |= BIT(10); + } else + beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); + + odm_write_2byte(p_dm, beam_ctrl_reg, beam_ctrl_val); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] idx %d beam_ctrl_reg %x beam_ctrl_val %x\n", __func__, idx, beam_ctrl_reg, beam_ctrl_val)); +} + + +void +hal_txbf_8192e_fw_tx_bf( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) + hal_txbf_8192e_download_ndpa(p_dm, idx); + + hal_txbf_8192e_fw_txbf_cmd(p_dm); +} + +#endif /* #if (RTL8192E_SUPPORT == 1)*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.h index 6092438490df..636e0d558c57 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8192e.h @@ -1,61 +1,74 @@ -#ifndef __HAL_TXBF_8192E_H__ -#define __HAL_TXBF_8192E_H__ - -#if (RTL8192E_SUPPORT == 1) -#if (BEAMFORMING_SUPPORT == 1) - -VOID -HalTxbf8192E_setNDPArate( - IN PVOID pDM_VOID, - IN u1Byte BW, - IN u1Byte Rate -); - -VOID -HalTxbf8192E_Enter( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8192E_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8192E_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8192E_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); -#else - -#define HalTxbf8192E_setNDPArate(pDM_VOID, BW, Rate) -#define HalTxbf8192E_Enter(pDM_VOID, Idx) -#define HalTxbf8192E_Leave(pDM_VOID, Idx) -#define HalTxbf8192E_Status(pDM_VOID, Idx) -#define HalTxbf8192E_FwTxBF(pDM_VOID, Idx) - -#endif - -#else - -#define HalTxbf8192E_setNDPArate(pDM_VOID, BW, Rate) -#define HalTxbf8192E_Enter(pDM_VOID, Idx) -#define HalTxbf8192E_Leave(pDM_VOID, Idx) -#define HalTxbf8192E_Status(pDM_VOID, Idx) -#define HalTxbf8192E_FwTxBF(pDM_VOID, Idx) - -#endif - -#endif - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HAL_TXBF_8192E_H__ +#define __HAL_TXBF_8192E_H__ + +#if (RTL8192E_SUPPORT == 1) +#if (BEAMFORMING_SUPPORT == 1) + +void +hal_txbf_8192e_set_ndpa_rate( + void *p_dm_void, + u8 BW, + u8 rate +); + +void +hal_txbf_8192e_enter( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8192e_leave( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8192e_status( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8192e_fw_tx_bf( + void *p_dm_void, + u8 idx +); +#else + +#define hal_txbf_8192e_set_ndpa_rate(p_dm_void, BW, rate) +#define hal_txbf_8192e_enter(p_dm_void, idx) +#define hal_txbf_8192e_leave(p_dm_void, idx) +#define hal_txbf_8192e_status(p_dm_void, idx) +#define hal_txbf_8192e_fw_tx_bf(p_dm_void, idx) + +#endif + +#else + +#define hal_txbf_8192e_set_ndpa_rate(p_dm_void, BW, rate) +#define hal_txbf_8192e_enter(p_dm_void, idx) +#define hal_txbf_8192e_leave(p_dm_void, idx) +#define hal_txbf_8192e_status(p_dm_void, idx) +#define hal_txbf_8192e_fw_tx_bf(p_dm_void, idx) + +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.c index 1c6670825f15..9cfb0150e0ec 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.c @@ -1,677 +1,720 @@ -//============================================================ -// Description: -// -// This file is for 8814A TXBF mechanism -// -//============================================================ - -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (BEAMFORMING_SUPPORT == 1) -#if (RTL8814A_SUPPORT == 1) - -VOID -HalTxbf8814A_setNDPArate( - IN PVOID pDM_VOID, - IN u1Byte BW, - IN u1Byte Rate -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8814A, BW); - ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8814A, (u1Byte) Rate); - -} - -#define PHYDM_MEMORY_MAP_BUF_READ 0x8000 -#define PHYDM_CTRL_INFO_PAGE 0x660 - -VOID -phydm_DataRate_8814A( - IN PDM_ODM_T pDM_Odm, - IN u1Byte macId, - OUT pu4Byte data, - IN u1Byte dataLen - ) -{ - u1Byte i = 0; - u2Byte XReadDataAddr = 0; - - ODM_Write2Byte(pDM_Odm, REG_PKTBUF_DBG_CTRL_8814A, PHYDM_CTRL_INFO_PAGE); - XReadDataAddr = PHYDM_MEMORY_MAP_BUF_READ + macId*32; /*Ctrl Info: 32Bytes for each macid(n)*/ - - if ((XReadDataAddr < PHYDM_MEMORY_MAP_BUF_READ) || (XReadDataAddr > 0x8FFF)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("XReadDataAddr(0x%x) is not correct!\n", XReadDataAddr)); - return; - } - - /* Read data */ - for (i = 0; i < dataLen; i++) - *(data+i) = ODM_Read2Byte(pDM_Odm, XReadDataAddr+i); - -} - -VOID -HalTxbf8814A_GetTxRate( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pEntry; - u4Byte TxRptData = 0; - u1Byte DataRate = 0xFF; - - pEntry = &(pBeamInfo->BeamformeeEntry[pBeamInfo->BeamformeeCurIdx]); - - phydm_DataRate_8814A(pDM_Odm, (u1Byte)pEntry->MacId, &TxRptData, 1); - DataRate = (u1Byte)TxRptData; - DataRate &= bMask7bits; /*Bit7 indicates SGI*/ - - pDM_Odm->TxBfDataRate = DataRate; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] pDM_Odm->TxBfDataRate = 0x%x\n", __func__, pDM_Odm->TxBfDataRate)); -} - -VOID -HalTxbf8814A_ResetTxPath( - IN PVOID pDM_VOID, - IN u1Byte idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; -#if DEV_BUS_TYPE == RT_USB_INTERFACE - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - u1Byte Nr_index = 0, txSS = 0; - - if (idx < BEAMFORMEE_ENTRY_NUM) - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; - else - return; - - if ((pDM_Odm->LastUSBHub) != (*pDM_Odm->HubUsbMode)) { - Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); - - if (*pDM_Odm->HubUsbMode == 2) { - if (pDM_Odm->RFType == ODM_4T4R) - txSS = 0xf; - else if (pDM_Odm->RFType == ODM_3T3R) - txSS = 0xe; - else - txSS = 0x6; - } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ - txSS = 0x6; - else - txSS = 0x6; - - if (txSS == 0xf) { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93f); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskDWord, 0x93f93f0); - } else if (txSS == 0xe) { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93e); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e93e0); - } else if (txSS == 0x6) { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x936); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskLWord, 0x9360); - } - - if (idx == 0) { - switch (Nr_index) { - case 0: - break; - - case 1: /*Nsts = 2 BC*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ - break; - - case 2: /*Nsts = 3 BCD*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ - break; - - default: /*Nr>3, same as Case 3*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ - break; - } - } else { - switch (Nr_index) { - case 0: - break; - - case 1: /*Nsts = 2 BC*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ - break; - - case 2: /*Nsts = 3 BCD*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ - break; - - default: /*Nr>3, same as Case 3*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ - break; - } - } - - pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; - } else - return; -#endif -} - - -u1Byte -halTxbf8814A_GetNtx( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Ntx = 0, txSS = 3; - -#if DEV_BUS_TYPE == RT_USB_INTERFACE - txSS = *pDM_Odm->HubUsbMode; -#endif - if (txSS == 3 || txSS == 2) { - if (pDM_Odm->RFType == ODM_4T4R) - Ntx = 3; - else if (pDM_Odm->RFType == ODM_3T3R) - Ntx = 2; - else - Ntx = 1; - } else if (txSS == 1) /*USB 2.0 always 2Tx*/ - Ntx = 1; - else - Ntx = 1; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Ntx = %d\n", __func__, Ntx)); - return Ntx; -} - -u1Byte -halTxbf8814A_GetNrx( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Nrx = 0; - - if (pDM_Odm->RFType == ODM_4T4R) - Nrx = 3; - else if (pDM_Odm->RFType == ODM_3T3R) - Nrx = 2; - else if (pDM_Odm->RFType == ODM_2T2R) - Nrx = 1; - else if (pDM_Odm->RFType == ODM_2T3R) - Nrx = 2; - else if (pDM_Odm->RFType == ODM_2T4R) - Nrx = 3; - else if (pDM_Odm->RFType == ODM_1T1R) - Nrx = 0; - else if (pDM_Odm->RFType == ODM_1T2R) - Nrx = 1; - else - Nrx = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Nrx = %d\n", __func__, Nrx)); - return Nrx; -} - -VOID -halTxbf8814A_RfMode( - IN PVOID pDM_VOID, - IN PRT_BEAMFORMING_INFO pBeamformingInfo, - IN u1Byte idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i, Nr_index = 0; - u1Byte txSS = 3; /*default use 3 Tx*/ - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - - if (idx < BEAMFORMEE_ENTRY_NUM) - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; - else - return; - - Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), BeamformeeEntry.CompSteeringNumofBFer); - - if (pDM_Odm->RFType == ODM_1T1R) - return; - - for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x1); - /*RF Mode table write enable*/ - } - - if (pBeamformingInfo->beamformee_su_cnt > 0) { - for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableAddr, 0xfffff, 0x18000); - /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData0, 0xfffff, 0xBE77F); - /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData1, 0xfffff, 0x226BF); - /*Enable TXIQGEN in RX mode*/ - } - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); - /*Enable TXIQGEN in RX mode*/ - } - - for (i = ODM_RF_PATH_A; i < MAX_RF_PATH; i++) { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x0); - /*RF Mode table write disable*/ - } - - if (pBeamformingInfo->beamformee_su_cnt > 0) { -#if DEV_BUS_TYPE == RT_USB_INTERFACE - pDM_Odm->LastUSBHub = *pDM_Odm->HubUsbMode; - txSS = *pDM_Odm->HubUsbMode; -#endif - if (txSS == 3 || txSS == 2) { - if (pDM_Odm->RFType == ODM_4T4R) - txSS = 0xf; - else if (pDM_Odm->RFType == ODM_3T3R) - txSS = 0xe; - else - txSS = 0x6; - } else if (txSS == 1) /*USB 2.0 always 2Tx*/ - txSS = 0x6; - else - txSS = 0x6; - - if (txSS == 0xf) { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93f); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskDWord, 0x93f93f0); - } else if (txSS == 0xe) { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x93e); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e93e0); - } else if (txSS == 0x6) { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x936); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskLWord, 0x9360); - } - - /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT28 | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ - - if (idx == 0) { - switch (Nr_index) { - case 0: - break; - - case 1: /*Nsts = 2 BC*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ - break; - - case 2: /*Nsts = 3 BCD*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ - break; - - default: /*Nr>3, same as Case 3*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ - - break; - } - } else { - switch (Nr_index) { - case 0: - break; - - case 1: /*Nsts = 2 BC*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x9366); /*tx2path, BC*/ - break; - - case 2: /*Nsts = 3 BCD*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93e93ee); /*tx3path, BCD*/ - break; - - default: /*Nr>3, same as Case 3*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8814A, bMaskByte3LowNibble | bMaskL3Bytes, 0x93f93ff); /*tx4path, ABCD*/ - break; - } - } - } - - if ((pBeamformingInfo->beamformee_su_cnt == 0) && (pBeamformingInfo->beamformer_su_cnt == 0)) { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8814A, bMaskByte3 | bMaskByte2HighNibble, 0x932); /*set TxPath selection for 8814a BFer bug refine*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8814A, bMaskDWord, 0x93e9360); - } -} -#if 0 -VOID -halTxbf8814A_DownloadNDPA( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte u1bTmp = 0, tmpReg422 = 0; - u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; - u2Byte Head_Page = 0x7FE; - BOOLEAN bSendBeacon = FALSE; - u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; - PADAPTER Adapter = pDM_Odm->Adapter; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -#endif - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); - - /*Set REG_CR bit 8. DMA beacon by SW.*/ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8814A + 1); - ODM_Write1Byte(pDM_Odm, REG_CR_8814A + 1, (u1bTmp | BIT0)); - - - /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ - tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2); - ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422 & (~BIT6)); - - if (tmpReg422 & BIT6) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: There is an Adapter is sending beacon.\n", __func__)); - bSendBeacon = TRUE; - } - - /*0x204[11:0] Beacon Head for TXDMA*/ - ODM_Write2Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); - - do { - /*Clear beacon valid check bit.*/ - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1); - ODM_Write1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1, (BcnValidReg | BIT7)); - - /*download NDPA rsvd page.*/ - if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) - Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); - else - Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); - - /*check rsvd page download OK.*/ - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 1); - count = 0; - while (!(BcnValidReg & BIT7) && count < 20) { - count++; - ODM_delay_ms(10); - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A + 2); - } - DLBcnCount++; - } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); - - if (!(BcnValidReg & BIT7)) - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); - - /*0x204[11:0] Beacon Head for TXDMA*/ - ODM_Write2Byte(pDM_Odm, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); - - /*To make sure that if there exists an adapter which would like to send beacon.*/ - /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ - /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ - /*the beacon cannot be sent by HW.*/ - /*2010.06.23. Added by tynli.*/ - if (bSendBeacon) - ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8814A + 2, tmpReg422); - - /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ - /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8814A + 1); - ODM_Write1Byte(pDM_Odm, REG_CR_8814A + 1, (u1bTmp & (~BIT0))); - - pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -#endif -} - -VOID -halTxbf8814A_FwTxBFCmd( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Idx, Period = 0; - u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; - u1Byte u1TxBFParm[3] = {0}; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { - if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - if (pBeamInfo->BeamformeeEntry[Idx].bSound) { - PageNum0 = 0xFE; - PageNum1 = 0x07; - Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); - } else if (PageNum0 == 0xFF) { - PageNum0 = 0xFF; /*stop sounding*/ - PageNum1 = 0x0F; - } - } - } - - u1TxBFParm[0] = PageNum0; - u1TxBFParm[1] = PageNum1; - u1TxBFParm[2] = Period; - ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, - ("[%s] PageNum0 = %d, PageNum1 = %d Period = %d\n", __func__, PageNum0, PageNum1, Period)); -} -#endif -VOID -HalTxbf8814A_Enter( - IN PVOID pDM_VOID, - IN u1Byte BFerBFeeIdx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; - u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - RT_BEAMFORMER_ENTRY BeamformerEntry; - u2Byte STAid = 0, CSI_Param = 0; - u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerIdx, BFeeIdx)); - ODM_SetMACReg(pDM_Odm, REG_SND_PTCL_CTRL_8814A, bMaskByte1 | bMaskByte2, 0x0202); - - if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { - BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; - /*Sounding protocol control*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xDB); - - /*MAC address/Partial AID of Beamformer*/ - if (BFerIdx == 0) { - for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), BeamformerEntry.MacAddr[i]); - } else { - for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8814A + i), BeamformerEntry.MacAddr[i]); - } - - /*CSI report parameters of Beamformer*/ - Nc_index = halTxbf8814A_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ - Nr_index = BeamformerEntry.NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ - - grouping = 0; - - /*for ac = 1, for n = 3*/ - if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) - codebookinfo = 1; - else if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) - codebookinfo = 3; - - coefficientsize = 3; - - CSI_Param = (u2Byte)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (Nr_index << 3) | (Nc_index)); - - if (BFerIdx == 0) - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, CSI_Param); - else - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, CSI_Param); - /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A + 3, 0x40); - - } - - if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; - - halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - STAid = BeamformeeEntry.MacId; - else - STAid = BeamformeeEntry.P_AID; - - /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ - if (BFeeIdx == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, STAid); - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); - } else - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, STAid | BIT14 | BIT15 | BIT12); - - /*CSI report parameters of Beamformee*/ - if (BFeeIdx == 0) { - /*Get BIT24 & BIT25*/ - u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; - - ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, STAid | BIT9); - } else - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, STAid | 0xE200); /*Set BIT25*/ - - phydm_Beamforming_Notify(pDM_Odm); - } - -} - - -VOID -HalTxbf8814A_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMER_ENTRY BeamformerEntry; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - - if (Idx < BEAMFORMER_ENTRY_NUM) { - BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; - } else - return; - - /*Clear P_AID of Beamformee*/ - /*Clear MAC address of Beamformer*/ - /*Clear Associated Bfmee Sel*/ - - if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8814A, 0xD8); - if (Idx == 0) { - ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A, 0); - } else { - ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8814A + 2, 0); - } - } - - if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { - halTxbf8814A_RfMode(pDM_Odm, pBeamformingInfo, Idx); - if (Idx == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, 0x0); - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 3) | BIT4 | BIT6 | BIT7); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); - } else { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT14 | BIT15 | BIT12); - - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); - } - } -} - -VOID -HalTxbf8814A_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u2Byte BeamCtrlVal, tmpVal; - u4Byte BeamCtrlReg; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMEE_ENTRY BeamformEntry; - - if (Idx < BEAMFORMEE_ENTRY_NUM) - BeamformEntry = pBeamformingInfo->BeamformeeEntry[Idx]; - else - return; - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - BeamCtrlVal = BeamformEntry.MacId; - else - BeamCtrlVal = BeamformEntry.P_AID; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, BeamformEntry.BeamformEntryState)); - - if (Idx == 0) - BeamCtrlReg = REG_TXBF_CTRL_8814A; - else { - BeamCtrlReg = REG_TXBF_CTRL_8814A + 2; - BeamCtrlVal |= BIT12 | BIT14 | BIT15; - } - - if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamformingInfo->applyVmatrix == TRUE)) { - if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) - BeamCtrlVal |= BIT9; - else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) - BeamCtrlVal |= (BIT9 | BIT10); - else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) - BeamCtrlVal |= (BIT9 | BIT10 | BIT11); - } else { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); - BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); - } - - ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); - /*disable NDP packet use beamforming */ - tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8814A); - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8814A, tmpVal | BIT15); - -} - - - - - -VOID -HalTxbf8814A_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ -#if 0 - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) - halTxbf8814A_DownloadNDPA(pDM_Odm, Idx); - - halTxbf8814A_FwTxBFCmd(pDM_Odm); -#endif -} - -#endif /* (RTL8814A_SUPPORT == 1)*/ - -#endif - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * Description: + * + * This file is for 8814A TXBF mechanism + * + * ************************************************************ */ + +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (BEAMFORMING_SUPPORT == 1) +#if (RTL8814A_SUPPORT == 1) + +boolean +phydm_beamforming_set_iqgen_8814A( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + u16 counter = 0; + u32 rf_mode[4]; + + for (i = RF_PATH_A ; i < MAX_RF_PATH ; i++) + odm_set_rf_reg(p_dm, i, RF_WE_LUT, 0x80000, 0x1); /*RF mode table write enable*/ + + while (1) { + counter++; + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) + odm_set_rf_reg(p_dm, i, RF_RCK_OS, 0xfffff, 0x18000); /*Select Rx mode*/ + + ODM_delay_us(2); + + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) + rf_mode[i] = odm_get_rf_reg(p_dm, i, RF_RCK_OS, 0xfffff); + + if ((rf_mode[0] == 0x18000) && (rf_mode[1] == 0x18000) && (rf_mode[2] == 0x18000) && (rf_mode[3] == 0x18000)) + break; + else if (counter == 100) { + PHYDM_DBG(p_dm, DBG_TXBF, ("iqgen setting fail:8814A\n")); + return false; + } + } + + for (i = RF_PATH_A ; i < MAX_RF_PATH ; i++) { + odm_set_rf_reg(p_dm, i, RF_TXPA_G1, 0xfffff, 0xBE77F); /*Set Table data*/ + odm_set_rf_reg(p_dm, i, RF_TXPA_G2, 0xfffff, 0x226BF); /*Enable TXIQGEN in Rx mode*/ + } + odm_set_rf_reg(p_dm, RF_PATH_A, RF_TXPA_G2, 0xfffff, 0xE26BF); /*Enable TXIQGEN in Rx mode*/ + + for (i = RF_PATH_A; i < MAX_RF_PATH; i++) + odm_set_rf_reg(p_dm, i, RF_WE_LUT, 0x80000, 0x0); /*RF mode table write disable*/ + + return true; + +} + + + +void +hal_txbf_8814a_set_ndpa_rate( + void *p_dm_void, + u8 BW, + u8 rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + odm_write_1byte(p_dm, REG_NDPA_OPT_CTRL_8814A, BW); + odm_write_1byte(p_dm, REG_NDPA_RATE_8814A, (u8) rate); + +} +#if 0 +#define PHYDM_MEMORY_MAP_BUF_READ 0x8000 +#define PHYDM_CTRL_INFO_PAGE 0x660 + +void +phydm_data_rate_8814a( + struct PHY_DM_STRUCT *p_dm, + u8 mac_id, + u32 *data, + u8 data_len +) +{ + u8 i = 0; + u16 x_read_data_addr = 0; + + odm_write_2byte(p_dm, REG_PKTBUF_DBG_CTRL_8814A, PHYDM_CTRL_INFO_PAGE); + x_read_data_addr = PHYDM_MEMORY_MAP_BUF_READ + mac_id * 32; /*Ctrl Info: 32Bytes for each macid(n)*/ + + if ((x_read_data_addr < PHYDM_MEMORY_MAP_BUF_READ) || (x_read_data_addr > 0x8FFF)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("x_read_data_addr(0x%x) is not correct!\n", x_read_data_addr)); + return; + } + + /* Read data */ + for (i = 0; i < data_len; i++) + *(data + i) = odm_read_2byte(p_dm, x_read_data_addr + i); + +} +#endif + +void +hal_txbf_8814a_get_tx_rate( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_entry; + struct _rate_adaptive_table_ *p_ra_table = &p_dm->dm_ra_table; + struct cmn_sta_info *p_sta = NULL; + u8 data_rate = 0xFF; + u8 macid = 0; + + p_entry = &(p_beam_info->beamformee_entry[p_beam_info->beamformee_cur_idx]); + macid = (u8)p_entry->mac_id; + + p_sta = p_dm->p_phydm_sta_info[macid]; + + if (is_sta_active(p_sta)) { + + data_rate = (p_sta->ra_info.curr_tx_rate) & 0x7f; /*Bit7 indicates SGI*/ + p_beam_info->tx_bf_data_rate = data_rate; + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] p_dm->tx_bf_data_rate = 0x%x\n", __func__, p_beam_info->tx_bf_data_rate)); +} + +void +hal_txbf_8814a_reset_tx_path( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; +#if DEV_BUS_TYPE == RT_USB_INTERFACE + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + u8 nr_index = 0, tx_ss = 0; + + if (idx < BEAMFORMEE_ENTRY_NUM) + beamformee_entry = p_beamforming_info->beamformee_entry[idx]; + else + return; + + if ((p_beamforming_info->last_usb_hub) != (*p_dm->hub_usb_mode)) { + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm), beamformee_entry.comp_steering_num_of_bfer); + + if (*p_dm->hub_usb_mode == 2) { + if (p_dm->rf_type == RF_4T4R) + tx_ss = 0xf; + else if (p_dm->rf_type == RF_3T3R) + tx_ss = 0xe; + else + tx_ss = 0x6; + } else if (*p_dm->hub_usb_mode == 1) /*USB 2.0 always 2Tx*/ + tx_ss = 0x6; + else + tx_ss = 0x6; + + if (tx_ss == 0xf) { + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); + } else if (tx_ss == 0xe) { + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); + } else if (tx_ss == 0x6) { + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2_8814A, MASKLWORD, 0x9360); + } + + if (idx == 0) { + switch (nr_index) { + case 0: + break; + + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + break; + + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + break; + + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + break; + } + } else { + switch (nr_index) { + case 0: + break; + + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + break; + + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + break; + + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + break; + } + } + + p_beamforming_info->last_usb_hub = *p_dm->hub_usb_mode; + } else + return; +#endif +} + + +u8 +hal_txbf_8814a_get_ntx( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 ntx = 0, tx_ss = 3; + +#if DEV_BUS_TYPE == RT_USB_INTERFACE + tx_ss = *p_dm->hub_usb_mode; +#endif + if (tx_ss == 3 || tx_ss == 2) { + if (p_dm->rf_type == RF_4T4R) + ntx = 3; + else if (p_dm->rf_type == RF_3T3R) + ntx = 2; + else + ntx = 1; + } else if (tx_ss == 1) /*USB 2.0 always 2Tx*/ + ntx = 1; + else + ntx = 1; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ntx = %d\n", __func__, ntx)); + return ntx; +} + +u8 +hal_txbf_8814a_get_nrx( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 nrx = 0; + + if (p_dm->rf_type == RF_4T4R) + nrx = 3; + else if (p_dm->rf_type == RF_3T3R) + nrx = 2; + else if (p_dm->rf_type == RF_2T2R) + nrx = 1; + else if (p_dm->rf_type == RF_2T3R) + nrx = 2; + else if (p_dm->rf_type == RF_2T4R) + nrx = 3; + else if (p_dm->rf_type == RF_1T1R) + nrx = 0; + else if (p_dm->rf_type == RF_1T2R) + nrx = 1; + else + nrx = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] nrx = %d\n", __func__, nrx)); + return nrx; +} + +void +hal_txbf_8814a_rf_mode( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beamforming_info, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 nr_index = 0; + u8 tx_ss = 3; /*default use 3 Tx*/ + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + + if (idx < BEAMFORMEE_ENTRY_NUM) + beamformee_entry = p_beamforming_info->beamformee_entry[idx]; + else + return; + + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm), beamformee_entry.comp_steering_num_of_bfer); + + if (p_dm->rf_type == RF_1T1R) + return; + + if (p_beamforming_info->beamformee_su_cnt > 0) { +#if DEV_BUS_TYPE == RT_USB_INTERFACE + p_beamforming_info->last_usb_hub = *p_dm->hub_usb_mode; + tx_ss = *p_dm->hub_usb_mode; +#endif + if (tx_ss == 3 || tx_ss == 2) { + if (p_dm->rf_type == RF_4T4R) + tx_ss = 0xf; + else if (p_dm->rf_type == RF_3T3R) + tx_ss = 0xe; + else + tx_ss = 0x6; + } else if (tx_ss == 1) /*USB 2.0 always 2Tx*/ + tx_ss = 0x6; + else + tx_ss = 0x6; + + if (tx_ss == 0xf) { + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93f); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKDWORD, 0x93f93f0); + } else if (tx_ss == 0xe) { + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x93e); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e93e0); + } else if (tx_ss == 0x6) { + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x936); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2_8814A, MASKLWORD, 0x9360); + } + + /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT(28) | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, BIT30, 0x1); /*if Nsts > Nc don't apply V matrix*/ + + if (idx == 0) { + switch (nr_index) { + case 0: + break; + + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + break; + + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + break; + + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF0_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + + break; + } + } else { + switch (nr_index) { + case 0: + break; + + case 1: /*Nsts = 2 BC*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x9366); /*tx2path, BC*/ + break; + + case 2: /*Nsts = 3 BCD*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93e93ee); /*tx3path, BCD*/ + break; + + default: /*nr>3, same as Case 3*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8814A, MASKBYTE3LOWNIBBLE | MASKL3BYTES, 0x93f93ff); /*tx4path, ABCD*/ + break; + } + } + } + + if ((p_beamforming_info->beamformee_su_cnt == 0) && (p_beamforming_info->beamformer_su_cnt == 0)) { + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8814A, MASKBYTE3 | MASKBYTE2HIGHNIBBLE, 0x932); /*set tx_path selection for 8814a BFer bug refine*/ + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2_8814A, MASKDWORD, 0x93e9360); + } +} +#if 0 +void +hal_txbf_8814a_download_ndpa( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 u1b_tmp = 0, tmp_reg422 = 0; + u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; + u16 head_page = 0x7FE; + boolean is_send_beacon = false; + u16 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + struct _ADAPTER *adapter = p_dm->adapter; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + *p_dm->p_is_fw_dw_rsvd_page_in_progress = true; +#endif + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + phydm_get_hal_def_var_handler_interface(p_dm, HAL_DEF_TX_PAGE_BOUNDARY, (u16 *)&tx_page_bndy); + + /*Set REG_CR bit 8. DMA beacon by SW.*/ + u1b_tmp = odm_read_1byte(p_dm, REG_CR_8814A + 1); + odm_write_1byte(p_dm, REG_CR_8814A + 1, (u1b_tmp | BIT(0))); + + + /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ + tmp_reg422 = odm_read_1byte(p_dm, REG_FWHW_TXQ_CTRL_8814A + 2); + odm_write_1byte(p_dm, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422 & (~BIT(6))); + + if (tmp_reg422 & BIT(6)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: There is an adapter is sending beacon.\n", __func__)); + is_send_beacon = true; + } + + /*0x204[11:0] Beacon Head for TXDMA*/ + odm_write_2byte(p_dm, REG_FIFOPAGE_CTRL_2_8814A, head_page); + + do { + /*Clear beacon valid check bit.*/ + bcn_valid_reg = odm_read_1byte(p_dm, REG_FIFOPAGE_CTRL_2_8814A + 1); + odm_write_1byte(p_dm, REG_FIFOPAGE_CTRL_2_8814A + 1, (bcn_valid_reg | BIT(7))); + + /*download NDPA rsvd page.*/ + if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) + beamforming_send_vht_ndpa_packet(p_dm, p_beam_entry->mac_addr, p_beam_entry->AID, p_beam_entry->sound_bw, BEACON_QUEUE); + else + beamforming_send_ht_ndpa_packet(p_dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + + /*check rsvd page download OK.*/ + bcn_valid_reg = odm_read_1byte(p_dm, REG_FIFOPAGE_CTRL_2_8814A + 1); + count = 0; + while (!(bcn_valid_reg & BIT(7)) && count < 20) { + count++; + ODM_delay_ms(10); + bcn_valid_reg = odm_read_1byte(p_dm, REG_FIFOPAGE_CTRL_2_8814A + 2); + } + dl_bcn_count++; + } while (!(bcn_valid_reg & BIT(7)) && dl_bcn_count < 5); + + if (!(bcn_valid_reg & BIT(7))) + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Download RSVD page failed!\n", __func__)); + + /*0x204[11:0] Beacon Head for TXDMA*/ + odm_write_2byte(p_dm, REG_FIFOPAGE_CTRL_2_8814A, tx_page_bndy); + + /*To make sure that if there exists an adapter which would like to send beacon.*/ + /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ + /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ + /*the beacon cannot be sent by HW.*/ + /*2010.06.23. Added by tynli.*/ + if (is_send_beacon) + odm_write_1byte(p_dm, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422); + + /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ + /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ + u1b_tmp = odm_read_1byte(p_dm, REG_CR_8814A + 1); + odm_write_1byte(p_dm, REG_CR_8814A + 1, (u1b_tmp & (~BIT(0)))); + + p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + *p_dm->p_is_fw_dw_rsvd_page_in_progress = false; +#endif +} + +void +hal_txbf_8814a_fw_txbf_cmd( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx, period = 0; + u8 PageNum0 = 0xFF, PageNum1 = 0xFF; + u8 u1_tx_bf_parm[3] = {0}; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + if (p_beam_info->beamformee_entry[idx].is_used && p_beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (p_beam_info->beamformee_entry[idx].is_sound) { + PageNum0 = 0xFE; + PageNum1 = 0x07; + period = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + } else if (PageNum0 == 0xFF) { + PageNum0 = 0xFF; /*stop sounding*/ + PageNum1 = 0x0F; + } + } + } + + u1_tx_bf_parm[0] = PageNum0; + u1_tx_bf_parm[1] = PageNum1; + u1_tx_bf_parm[2] = period; + odm_fill_h2c_cmd(p_dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); + + PHYDM_DBG(p_dm, DBG_TXBF, + ("[%s] PageNum0 = %d, PageNum1 = %d period = %d\n", __func__, PageNum0, PageNum1, period)); +} +#endif +void +hal_txbf_8814a_enter( + void *p_dm_void, + u8 bfer_bfee_idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; + u8 bfee_idx = (bfer_bfee_idx & 0xF); + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + u16 sta_id = 0, csi_param = 0; + u8 nc_index = 0, nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] bfer_idx=%d, bfee_idx=%d\n", __func__, bfer_idx, bfee_idx)); + odm_set_mac_reg(p_dm, REG_SND_PTCL_CTRL_8814A, MASKBYTE1 | MASKBYTE2, 0x0202); + + if ((p_beamforming_info->beamformer_su_cnt > 0) && (bfer_idx < BEAMFORMER_ENTRY_NUM)) { + beamformer_entry = p_beamforming_info->beamformer_entry[bfer_idx]; + /*Sounding protocol control*/ + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8814A, 0xDB); + + /*MAC address/Partial AID of Beamformer*/ + if (bfer_idx == 0) { + for (i = 0; i < 6 ; i++) + odm_write_1byte(p_dm, (REG_ASSOCIATED_BFMER0_INFO_8814A + i), beamformer_entry.mac_addr[i]); + } else { + for (i = 0; i < 6 ; i++) + odm_write_1byte(p_dm, (REG_ASSOCIATED_BFMER1_INFO_8814A + i), beamformer_entry.mac_addr[i]); + } + + /*CSI report parameters of Beamformer*/ + nc_index = hal_txbf_8814a_get_nrx(p_dm); /*for 8814A nrx = 3(4 ant), min=0(1 ant)*/ + nr_index = beamformer_entry.num_of_sounding_dim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so nr_index don't care*/ + + grouping = 0; + + /*for ac = 1, for n = 3*/ + if (beamformer_entry.beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) + codebookinfo = 1; + else if (beamformer_entry.beamform_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT) + codebookinfo = 3; + + coefficientsize = 3; + + csi_param = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); + + if (bfer_idx == 0) + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW20_8814A, csi_param); + else + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW20_8814A + 2, csi_param); + /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8814A + 3, 0x40); + + } + + if ((p_beamforming_info->beamformee_su_cnt > 0) && (bfee_idx < BEAMFORMEE_ENTRY_NUM)) { + beamformee_entry = p_beamforming_info->beamformee_entry[bfee_idx]; + + hal_txbf_8814a_rf_mode(p_dm, p_beamforming_info, bfee_idx); + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + sta_id = beamformee_entry.mac_id; + else + sta_id = beamformee_entry.p_aid; + + /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ + if (bfee_idx == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8814A, sta_id); + odm_write_1byte(p_dm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(p_dm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); + } else + odm_write_2byte(p_dm, REG_TXBF_CTRL_8814A + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); + + /*CSI report parameters of Beamformee*/ + if (bfee_idx == 0) { + /*Get BIT24 & BIT25*/ + u8 tmp = odm_read_1byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3) & 0x3; + + odm_write_1byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 3, tmp | 0x60); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8814A, sta_id | BIT(9)); + } else + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, sta_id | 0xE200); /*Set BIT25*/ + + phydm_beamforming_notify(p_dm); + } + +} + + +void +hal_txbf_8814a_leave( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + + if (idx < BEAMFORMER_ENTRY_NUM) { + beamformer_entry = p_beamforming_info->beamformer_entry[idx]; + beamformee_entry = p_beamforming_info->beamformee_entry[idx]; + } else + return; + + /*Clear P_AID of Beamformee*/ + /*Clear MAC address of Beamformer*/ + /*Clear Associated Bfmee Sel*/ + + if (beamformer_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8814A, 0xD8); + if (idx == 0) { + odm_write_4byte(p_dm, REG_ASSOCIATED_BFMER0_INFO_8814A, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMER0_INFO_8814A + 4, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW20_8814A, 0); + } else { + odm_write_4byte(p_dm, REG_ASSOCIATED_BFMER1_INFO_8814A, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMER1_INFO_8814A + 4, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW20_8814A + 2, 0); + } + } + + if (beamformee_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { + hal_txbf_8814a_rf_mode(p_dm, p_beamforming_info, idx); + if (idx == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8814A, 0x0); + odm_write_1byte(p_dm, REG_TXBF_CTRL_8814A + 3, odm_read_1byte(p_dm, REG_TXBF_CTRL_8814A + 3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8814A, 0); + } else { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8814A + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); + + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2, odm_read_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8814A + 2) & 0x60); + } + } +} + +void +hal_txbf_8814a_status( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 beam_ctrl_val, tmp_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamform_entry; + + if (idx < BEAMFORMEE_ENTRY_NUM) + beamform_entry = p_beamforming_info->beamformee_entry[idx]; + else + return; + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + beam_ctrl_val = beamform_entry.mac_id; + else + beam_ctrl_val = beamform_entry.p_aid; + + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, beamform_entry.beamform_entry_state = %d", __func__, beamform_entry.beamform_entry_state)); + + if (idx == 0) + beam_ctrl_reg = REG_TXBF_CTRL_8814A; + else { + beam_ctrl_reg = REG_TXBF_CTRL_8814A + 2; + beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); + } + + if ((beamform_entry.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (p_beamforming_info->apply_v_matrix == true)) { + if (beamform_entry.sound_bw == CHANNEL_WIDTH_20) + beam_ctrl_val |= BIT(9); + else if (beamform_entry.sound_bw == CHANNEL_WIDTH_40) + beam_ctrl_val |= (BIT(9) | BIT(10)); + else if (beamform_entry.sound_bw == CHANNEL_WIDTH_80) + beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); + } else { + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, Don't apply Vmatrix", __func__)); + beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); + } + + odm_write_2byte(p_dm, beam_ctrl_reg, beam_ctrl_val); + /*disable NDP packet use beamforming */ + tmp_val = odm_read_2byte(p_dm, REG_TXBF_CTRL_8814A); + odm_write_2byte(p_dm, REG_TXBF_CTRL_8814A, tmp_val | BIT(15)); + +} + + + + + +void +hal_txbf_8814a_fw_txbf( + void *p_dm_void, + u8 idx +) +{ +#if 0 + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) + hal_txbf_8814a_download_ndpa(p_dm, idx); + + hal_txbf_8814a_fw_txbf_cmd(p_dm); +#endif +} + +#endif /* (RTL8814A_SUPPORT == 1)*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.h index b4351e39236d..b070564af2d6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8814a.h @@ -1,83 +1,103 @@ -#ifndef __HAL_TXBF_8814A_H__ -#define __HAL_TXBF_8814A_H__ - -#if (RTL8814A_SUPPORT == 1) -#if (BEAMFORMING_SUPPORT == 1) - -VOID -HalTxbf8814A_setNDPArate( - IN PVOID pDM_VOID, - IN u1Byte BW, - IN u1Byte Rate -); - -u1Byte -halTxbf8814A_GetNtx( - IN PVOID pDM_VOID - ); - -VOID -HalTxbf8814A_Enter( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8814A_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8814A_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - -VOID -HalTxbf8814A_ResetTxPath( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8814A_GetTxRate( - IN PVOID pDM_VOID - ); - -VOID -HalTxbf8814A_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - -#else - -#define HalTxbf8814A_setNDPArate(pDM_VOID, BW, Rate) -#define halTxbf8814A_GetNtx(pDM_VOID) 0 -#define HalTxbf8814A_Enter(pDM_VOID, Idx) -#define HalTxbf8814A_Leave(pDM_VOID, Idx) -#define HalTxbf8814A_Status(pDM_VOID, Idx) -#define HalTxbf8814A_ResetTxPath(pDM_VOID, Idx) -#define HalTxbf8814A_GetTxRate(pDM_VOID) -#define HalTxbf8814A_FwTxBF(pDM_VOID, Idx) - -#endif - -#else - -#define HalTxbf8814A_setNDPArate(pDM_VOID, BW, Rate) -#define halTxbf8814A_GetNtx(pDM_VOID) 0 -#define HalTxbf8814A_Enter(pDM_VOID, Idx) -#define HalTxbf8814A_Leave(pDM_VOID, Idx) -#define HalTxbf8814A_Status(pDM_VOID, Idx) -#define HalTxbf8814A_ResetTxPath(pDM_VOID, Idx) -#define HalTxbf8814A_GetTxRate(pDM_VOID) -#define HalTxbf8814A_FwTxBF(pDM_VOID, Idx) -#endif - -#endif - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HAL_TXBF_8814A_H__ +#define __HAL_TXBF_8814A_H__ + +#if (RTL8814A_SUPPORT == 1) +#if (BEAMFORMING_SUPPORT == 1) + +boolean +phydm_beamforming_set_iqgen_8814A( + void *p_dm_void +); + +void +hal_txbf_8814a_set_ndpa_rate( + void *p_dm_void, + u8 BW, + u8 rate +); + +u8 +hal_txbf_8814a_get_ntx( + void *p_dm_void +); + +void +hal_txbf_8814a_enter( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8814a_leave( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8814a_status( + void *p_dm_void, + u8 idx +); + +void +hal_txbf_8814a_reset_tx_path( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8814a_get_tx_rate( + void *p_dm_void +); + +void +hal_txbf_8814a_fw_txbf( + void *p_dm_void, + u8 idx +); + +#else + +#define hal_txbf_8814a_set_ndpa_rate(p_dm_void, BW, rate) +#define hal_txbf_8814a_get_ntx(p_dm_void) 0 +#define hal_txbf_8814a_enter(p_dm_void, idx) +#define hal_txbf_8814a_leave(p_dm_void, idx) +#define hal_txbf_8814a_status(p_dm_void, idx) +#define hal_txbf_8814a_reset_tx_path(p_dm_void, idx) +#define hal_txbf_8814a_get_tx_rate(p_dm_void) +#define hal_txbf_8814a_fw_txbf(p_dm_void, idx) +#define phydm_beamforming_set_iqgen_8814A(p_dm_void) 0 + +#endif + +#else + +#define hal_txbf_8814a_set_ndpa_rate(p_dm_void, BW, rate) +#define hal_txbf_8814a_get_ntx(p_dm_void) 0 +#define hal_txbf_8814a_enter(p_dm_void, idx) +#define hal_txbf_8814a_leave(p_dm_void, idx) +#define hal_txbf_8814a_status(p_dm_void, idx) +#define hal_txbf_8814a_reset_tx_path(p_dm_void, idx) +#define hal_txbf_8814a_get_tx_rate(p_dm_void) +#define hal_txbf_8814a_fw_txbf(p_dm_void, idx) +#define phydm_beamforming_set_iqgen_8814A(p_dm_void) 0 +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.c index e3b11bc11a43..e7d75a45b484 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.c @@ -1,8 +1,22 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /*============================================================*/ -/* Description: */ -/* */ -/* This file is for 8814A TXBF mechanism */ -/* */ +/* Description: */ +/* */ +/* This file is for 8814A TXBF mechanism */ +/* */ /*============================================================*/ #include "mp_precomp.h" @@ -11,246 +25,246 @@ #if (RTL8822B_SUPPORT == 1) #if (BEAMFORMING_SUPPORT == 1) -u1Byte -halTxbf8822B_GetNtx( - IN PVOID pDM_VOID - ) +u8 +hal_txbf_8822b_get_ntx( + void *p_dm_void +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Ntx = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 ntx = 0; #if DEV_BUS_TYPE == RT_USB_INTERFACE - if (pDM_Odm->SupportInterface == ODM_ITRF_USB) { - if (*pDM_Odm->HubUsbMode == 2) {/*USB3.0*/ - if (pDM_Odm->RFType == ODM_4T4R) - Ntx = 3; - else if (pDM_Odm->RFType == ODM_3T3R) - Ntx = 2; + if (p_dm->support_interface == ODM_ITRF_USB) { + if (*p_dm->hub_usb_mode == 2) {/*USB3.0*/ + if (p_dm->rf_type == RF_4T4R) + ntx = 3; + else if (p_dm->rf_type == RF_3T3R) + ntx = 2; else - Ntx = 1; - } else if (*pDM_Odm->HubUsbMode == 1) /*USB 2.0 always 2Tx*/ - Ntx = 1; + ntx = 1; + } else if (*p_dm->hub_usb_mode == 1) /*USB 2.0 always 2Tx*/ + ntx = 1; else - Ntx = 1; + ntx = 1; } else #endif { - if (pDM_Odm->RFType == ODM_4T4R) - Ntx = 3; - else if (pDM_Odm->RFType == ODM_3T3R) - Ntx = 2; + if (p_dm->rf_type == RF_4T4R) + ntx = 3; + else if (p_dm->rf_type == RF_3T3R) + ntx = 2; else - Ntx = 1; + ntx = 1; } - return Ntx; + return ntx; } -u1Byte -halTxbf8822B_GetNrx( - IN PVOID pDM_VOID - ) +u8 +hal_txbf_8822b_get_nrx( + void *p_dm_void +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Nrx = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 nrx = 0; - if (pDM_Odm->RFType == ODM_4T4R) - Nrx = 3; - else if (pDM_Odm->RFType == ODM_3T3R) - Nrx = 2; - else if (pDM_Odm->RFType == ODM_2T2R) - Nrx = 1; - else if (pDM_Odm->RFType == ODM_2T3R) - Nrx = 2; - else if (pDM_Odm->RFType == ODM_2T4R) - Nrx = 3; - else if (pDM_Odm->RFType == ODM_1T1R) - Nrx = 0; - else if (pDM_Odm->RFType == ODM_1T2R) - Nrx = 1; + if (p_dm->rf_type == RF_4T4R) + nrx = 3; + else if (p_dm->rf_type == RF_3T3R) + nrx = 2; + else if (p_dm->rf_type == RF_2T2R) + nrx = 1; + else if (p_dm->rf_type == RF_2T3R) + nrx = 2; + else if (p_dm->rf_type == RF_2T4R) + nrx = 3; + else if (p_dm->rf_type == RF_1T1R) + nrx = 0; + else if (p_dm->rf_type == RF_1T2R) + nrx = 1; else - Nrx = 0; + nrx = 0; + + return nrx; - return Nrx; - } /***************SU & MU BFee Entry********************/ -VOID -halTxbf8822B_RfMode( - IN PVOID pDM_VOID, - IN PRT_BEAMFORMING_INFO pBeamformingInfo, - IN u1Byte idx - ) +void +hal_txbf_8822b_rf_mode( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beamforming_info, + u8 idx +) { #if 0 - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i, Nr_index = 0; - BOOLEAN bSelfBeamformer = FALSE; - BOOLEAN bSelfBeamformee = FALSE; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i, nr_index = 0; + boolean is_self_beamformer = false; + boolean is_self_beamformee = false; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; if (idx < BEAMFORMEE_ENTRY_NUM) - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[idx]; + beamformee_entry = p_beamforming_info->beamformee_entry[idx]; else return; - if (pDM_Odm->RFType == ODM_1T1R) + if (p_dm->rf_type == RF_1T1R) return; - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x1); - /*RF Mode table write enable*/ + for (i = RF_PATH_A; i < RF_PATH_B; i++) { + odm_set_rf_reg(p_dm, (enum rf_path)i, rf_welut_jaguar, 0x80000, 0x1); + /*RF mode table write enable*/ } - if ((pBeamformingInfo->beamformee_su_cnt > 0) || (pBeamformingInfo->beamformee_mu_cnt > 0)) { - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableAddr, 0xfffff, 0x18000); + if ((p_beamforming_info->beamformee_su_cnt > 0) || (p_beamforming_info->beamformee_mu_cnt > 0)) { + for (i = RF_PATH_A; i < RF_PATH_B; i++) { + odm_set_rf_reg(p_dm, (enum rf_path)i, rf_mode_table_addr, 0xfffff, 0x18000); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData0, 0xfffff, 0xBE77F); + odm_set_rf_reg(p_dm, (enum rf_path)i, rf_mode_table_data0, 0xfffff, 0xBE77F); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_ModeTableData1, 0xfffff, 0x226BF); + odm_set_rf_reg(p_dm, (enum rf_path)i, rf_mode_table_data1, 0xfffff, 0x226BF); /*Enable TXIQGEN in RX mode*/ } - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); + odm_set_rf_reg(p_dm, RF_PATH_A, rf_mode_table_data1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ } - for (i = ODM_RF_PATH_A; i < ODM_RF_PATH_B; i++) { - ODM_SetRFReg(pDM_Odm, (ODM_RF_RADIO_PATH_E)i, RF_WeLut_Jaguar, 0x80000, 0x0); - /*RF Mode table write disable*/ + for (i = RF_PATH_A; i < RF_PATH_B; i++) { + odm_set_rf_reg(p_dm, (enum rf_path)i, rf_welut_jaguar, 0x80000, 0x0); + /*RF mode table write disable*/ } - if (pBeamformingInfo->beamformee_su_cnt > 0) { + if (p_beamforming_info->beamformee_su_cnt > 0) { /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x2); /*enable BB TxBF ant mapping register*/ - + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ + if (idx == 0) { /*Nsts = 2 AB*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); - /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430);*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF0_8822B, 0xffff, 0x0433); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + /*odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430);*/ } else {/*IDX =1*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); - /*ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2, bMaskLWord, 0x430;*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + /*odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2, MASKLWORD, 0x430;*/ } } else { - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430); /*2SS by path-A,B*/ + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*2SS by path-A,B*/ } - - if (pBeamformingInfo->beamformee_mu_cnt > 0) { + + if (p_beamforming_info->beamformee_mu_cnt > 0) { /*MU STAs share the common setting*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 1); - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); } #endif } #if 0 -VOID -halTxbf8822B_DownloadNDPA( - IN PADAPTER Adapter, - IN u1Byte Idx - ) +void +hal_txbf_8822b_download_ndpa( + struct _ADAPTER *adapter, + u8 idx +) { - u1Byte u1bTmp = 0, tmpReg422 = 0; - u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; - u2Byte Head_Page = 0x7FE; - BOOLEAN bSendBeacon = FALSE; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u2Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ - PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; + u8 u1b_tmp = 0, tmp_reg422 = 0; + u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; + u16 head_page = 0x7FE; + boolean is_send_beacon = false; + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + u16 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8814A; /*default reseved 1 page for the IC type which is undefined.*/ + struct _RT_BEAMFORMING_INFO *p_beam_info = GET_BEAMFORM_INFO(adapter); + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + + p_hal_data->is_fw_dw_rsvd_page_in_progress = true; + phydm_get_hal_def_var_handler_interface(p_dm, HAL_DEF_TX_PAGE_BOUNDARY, (u16 *)&tx_page_bndy); - pHalData->bFwDwRsvdPageInProgress = TRUE; - Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu2Byte)&TxPageBndy); - /*Set REG_CR bit 8. DMA beacon by SW.*/ - u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); - PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp|BIT0)); + u1b_tmp = platform_efio_read_1byte(adapter, REG_CR_8814A + 1); + platform_efio_write_1byte(adapter, REG_CR_8814A + 1, (u1b_tmp | BIT(0))); /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ - tmpReg422 = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2); - PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422&(~BIT6)); + tmp_reg422 = platform_efio_read_1byte(adapter, REG_FWHW_TXQ_CTRL_8814A + 2); + platform_efio_write_1byte(adapter, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422 & (~BIT(6))); - if (tmpReg422 & BIT6) { - RT_TRACE(COMP_INIT, DBG_LOUD, ("SetBeamformDownloadNDPA_8814A(): There is an Adapter is sending beacon.\n")); - bSendBeacon = TRUE; + if (tmp_reg422 & BIT(6)) { + RT_TRACE(COMP_INIT, DBG_LOUD, ("SetBeamformDownloadNDPA_8814A(): There is an adapter is sending beacon.\n")); + is_send_beacon = true; } /*0x204[11:0] Beacon Head for TXDMA*/ - PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, Head_Page); - - do { + platform_efio_write_2byte(adapter, REG_FIFOPAGE_CTRL_2_8814A, head_page); + + do { /*Clear beacon valid check bit.*/ - BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1); - PlatformEFIOWrite1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+1, (BcnValidReg|BIT7)); - + bcn_valid_reg = platform_efio_read_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); + platform_efio_write_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 1, (bcn_valid_reg | BIT(7))); + /*download NDPA rsvd page.*/ - if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) - Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); - else - Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); - + if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) + beamforming_send_vht_ndpa_packet(p_dm, p_beam_entry->mac_addr, p_beam_entry->AID, p_beam_entry->sound_bw, BEACON_QUEUE); + else + beamforming_send_ht_ndpa_packet(p_dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + /*check rsvd page download OK.*/ - BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); + bcn_valid_reg = platform_efio_read_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 1); count = 0; - while (!(BcnValidReg & BIT7) && count < 20) { + while (!(bcn_valid_reg & BIT(7)) && count < 20) { count++; delay_us(10); - BcnValidReg = PlatformEFIORead1Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A+2); + bcn_valid_reg = platform_efio_read_1byte(adapter, REG_FIFOPAGE_CTRL_2_8814A + 2); } - DLBcnCount++; - } while (!(BcnValidReg & BIT7) && DLBcnCount < 5); - - if (!(BcnValidReg & BIT0)) + dl_bcn_count++; + } while (!(bcn_valid_reg & BIT(7)) && dl_bcn_count < 5); + + if (!(bcn_valid_reg & BIT(0))) RT_DISP(FBEAM, FBEAM_ERROR, ("%s Download RSVD page failed!\n", __func__)); /*0x204[11:0] Beacon Head for TXDMA*/ - PlatformEFIOWrite2Byte(Adapter, REG_FIFOPAGE_CTRL_2_8814A, TxPageBndy); + platform_efio_write_2byte(adapter, REG_FIFOPAGE_CTRL_2_8814A, tx_page_bndy); /*To make sure that if there exists an adapter which would like to send beacon.*/ /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ /*the beacon cannot be sent by HW.*/ /*2010.06.23. Added by tynli.*/ - if (bSendBeacon) - PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL_8814A+2, tmpReg422); + if (is_send_beacon) + platform_efio_write_1byte(adapter, REG_FWHW_TXQ_CTRL_8814A + 2, tmp_reg422); /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ - u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR_8814A+1); - PlatformEFIOWrite1Byte(Adapter, REG_CR_8814A+1, (u1bTmp&(~BIT0))); + u1b_tmp = platform_efio_read_1byte(adapter, REG_CR_8814A + 1); + platform_efio_write_1byte(adapter, REG_CR_8814A + 1, (u1b_tmp & (~BIT(0)))); - pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; + p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; - pHalData->bFwDwRsvdPageInProgress = FALSE; + p_hal_data->is_fw_dw_rsvd_page_in_progress = false; } -VOID -halTxbf8822B_FwTxBFCmd( - IN PADAPTER Adapter - ) +void +hal_txbf_8822b_fw_txbf_cmd( + struct _ADAPTER *adapter +) { - u1Byte Idx, Period = 0; - u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; - u1Byte u1TxBFParm[3] = {0}; + u8 idx, period = 0; + u8 PageNum0 = 0xFF, PageNum1 = 0xFF; + u8 u1_tx_bf_parm[3] = {0}; - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); + PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo); + struct _RT_BEAMFORMING_INFO *p_beam_info = GET_BEAMFORM_INFO(adapter); - for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { - if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - if (pBeamInfo->BeamformeeEntry[Idx].bSound) { + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + if (p_beam_info->beamformee_entry[idx].is_used && p_beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (p_beam_info->beamformee_entry[idx].is_sound) { PageNum0 = 0xFE; PageNum1 = 0x07; - Period = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); + period = (u8)(p_beam_info->beamformee_entry[idx].sound_period); } else if (PageNum0 == 0xFF) { PageNum0 = 0xFF; /*stop sounding*/ PageNum1 = 0x0F; @@ -258,245 +272,246 @@ halTxbf8822B_FwTxBFCmd( } } - u1TxBFParm[0] = PageNum0; - u1TxBFParm[1] = PageNum1; - u1TxBFParm[2] = Period; - FillH2CCmd(Adapter, PHYDM_H2C_TXBF, 3, u1TxBFParm); - - RT_DISP(FBEAM, FBEAM_FUN, ("@%s End, PageNum0 = 0x%x, PageNum1 = 0x%x Period = %d", __func__, PageNum0, PageNum1, Period)); + u1_tx_bf_parm[0] = PageNum0; + u1_tx_bf_parm[1] = PageNum1; + u1_tx_bf_parm[2] = period; + fill_h2c_cmd(adapter, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); + + RT_DISP(FBEAM, FBEAM_FUN, ("@%s End, PageNum0 = 0x%x, PageNum1 = 0x%x period = %d", __func__, PageNum0, PageNum1, period)); } #endif -VOID -HalTxbf8822B_Init( - IN PVOID pDM_VOID - ) +#if 0 +void +hal_txbf_8822b_init( + void *p_dm_void +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte u1bTmp; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - PADAPTER Adapter = pDM_Odm->Adapter; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 u1b_tmp; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _ADAPTER *adapter = p_dm->adapter; - ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT16, 1); /*Enable P1 aggr new packet according to P0 transfer time*/ - ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT15|BIT14|BIT13|BIT12, 10); /*MU Retry Limit*/ - ODM_SetBBReg(pDM_Odm, 0x14c0 , BIT7, 0); /*Disable Tx MU-MIMO until sounding done*/ - ODM_SetBBReg(pDM_Odm, 0x14c0 , 0x3F, 0); /* Clear validity of MU STAs */ - ODM_Write1Byte(pDM_Odm, 0x167c , 0x70); /*MU-MIMO Option as default value*/ - ODM_Write2Byte(pDM_Odm, 0x1680 , 0); /*MU-MIMO Control as default value*/ + odm_set_bb_reg(p_dm, 0x14c0, BIT(16), 1); /*Enable P1 aggr new packet according to P0 transfer time*/ + odm_set_bb_reg(p_dm, 0x14c0, BIT(15) | BIT14 | BIT13 | BIT12, 10); /*MU Retry Limit*/ + odm_set_bb_reg(p_dm, 0x14c0, BIT(7), 0); /*Disable Tx MU-MIMO until sounding done*/ + odm_set_bb_reg(p_dm, 0x14c0, 0x3F, 0); /* Clear validity of MU STAs */ + odm_write_1byte(p_dm, 0x167c, 0x70); /*MU-MIMO Option as default value*/ + odm_write_2byte(p_dm, 0x1680, 0); /*MU-MIMO Control as default value*/ /* Set MU NDPA rate & BW source */ /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ - u1bTmp = ODM_Read1Byte(pDM_Odm, 0x42C); - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B, (u1bTmp|BIT6)); - /* 0x45F[7:0] = 0x10 (Rate=OFDM_6M, BW20) */ - ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, 0x10); + u1b_tmp = odm_read_1byte(p_dm, 0x42C); + odm_write_1byte(p_dm, REG_TXBF_CTRL_8822B, (u1b_tmp | BIT(6))); + /* 0x45F[7:0] = 0x10 (rate=OFDM_6M, BW20) */ + odm_write_1byte(p_dm, REG_NDPA_OPT_CTRL_8822B, 0x10); /*Temp Settings*/ - ODM_SetBBReg(pDM_Odm, 0x6DC , 0x3F000000, 4); /*STA2's CSI rate is fixed at 6M*/ - ODM_SetBBReg(pDM_Odm, 0x1C94 , bMaskDWord, 0xAFFFAFFF); /*Grouping bitmap parameters*/ + odm_set_bb_reg(p_dm, 0x6DC, 0x3F000000, 4); /*STA2's CSI rate is fixed at 6M*/ + odm_set_bb_reg(p_dm, 0x1C94, MASKDWORD, 0xAFFFAFFF); /*Grouping bitmap parameters*/ /* Init HW variable */ - pBeamformingInfo->RegMUTxCtrl = ODM_Read4Byte(pDM_Odm, 0x14c0); + p_beamforming_info->reg_mu_tx_ctrl = odm_read_4byte(p_dm, 0x14c0); - if (pDM_Odm->RFType == ODM_2T2R) { /*2T2R*/ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: RFType is 2T2R\n", __func__)); - config_phydm_trx_mode_8822b(pDM_Odm, (ODM_RF_PATH_E)3, (ODM_RF_PATH_E)3, TRUE);/*Tx2path*/ + if (p_dm->rf_type == RF_2T2R) { /*2T2R*/ + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: rf_type is 2T2R\n", __func__)); + config_phydm_trx_mode_8822b(p_dm, (enum bb_path)3, (enum bb_path)3, true);/*Tx2path*/ } #if (OMNIPEEK_SNIFFER_ENABLED == 1) /* Config HW to receive packet on the user position from registry for sniffer mode. */ - /* ODM_SetBBReg(pDM_Odm, 0xB00 , BIT9, 1);*/ /* For A-cut only. RegB00[9] = 1 (enable PMAC Rx) */ - ODM_SetBBReg(pDM_Odm, 0xB54 , BIT30, 1); /* RegB54[30] = 1 (force user position) */ - ODM_SetBBReg(pDM_Odm, 0xB54 , (BIT29|BIT28), Adapter->MgntInfo.SniffUserPosition); /* RegB54[29:28] = user position (0~3) */ - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Set Adapter->MgntInfo.SniffUserPosition=%#X\n", Adapter->MgntInfo.SniffUserPosition)); + /* odm_set_bb_reg(p_dm, 0xB00, BIT(9), 1);*/ /* For A-cut only. RegB00[9] = 1 (enable PMAC Rx) */ + odm_set_bb_reg(p_dm, 0xB54, BIT(30), 1); /* RegB54[30] = 1 (force user position) */ + odm_set_bb_reg(p_dm, 0xB54, (BIT(29) | BIT28), adapter->MgntInfo.sniff_user_position); /* RegB54[29:28] = user position (0~3) */ + PHYDM_DBG(p_dm, DBG_TXBF, ("Set adapter->MgntInfo.sniff_user_position=%#X\n", adapter->MgntInfo.sniff_user_position)); #endif } +#endif -VOID -HalTxbf8822B_Enter( - IN PVOID pDM_VOID, - IN u1Byte BFerBFeeIdx - ) +void +hal_txbf_8822b_enter( + void *p_dm_void, + u8 bfer_bfee_idx +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - u1Byte BFerIdx = (BFerBFeeIdx & 0xF0)>>4; - u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); - u2Byte CSI_Param = 0; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; - PRT_BEAMFORMER_ENTRY pBeamformerEntry; - u2Byte value16, STAid = 0; - u1Byte Nc_index = 0, Nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; - u4Byte gid_valid, user_position_l, user_position_h; - u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; - u1Byte u1bTmp; - u4Byte u4bTmp; - - RT_DISP(FBEAM, FBEAM_FUN, ("%s: BFerBFeeIdx=%d, BFerIdx=%d, BFeeIdx=%d\n", __func__, BFerBFeeIdx, BFerIdx, BFeeIdx)); + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; + u8 bfee_idx = (bfer_bfee_idx & 0xF); + u16 csi_param = 0; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beamformee_entry; + struct _RT_BEAMFORMER_ENTRY *p_beamformer_entry; + u16 value16, sta_id = 0; + u8 nc_index = 0, nr_index = 0, grouping = 0, codebookinfo = 0, coefficientsize = 0; + u32 gid_valid, user_position_l, user_position_h; + u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; + u8 u1b_tmp; + u32 u4b_tmp; + + RT_DISP(FBEAM, FBEAM_FUN, ("%s: bfer_bfee_idx=%d, bfer_idx=%d, bfee_idx=%d\n", __func__, bfer_bfee_idx, bfer_idx, bfee_idx)); /*************SU BFer Entry Init*************/ - if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { - pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; - pBeamformerEntry->is_mu_ap = FALSE; + if ((p_beamforming_info->beamformer_su_cnt > 0) && (bfer_idx < BEAMFORMER_ENTRY_NUM)) { + p_beamformer_entry = &p_beamforming_info->beamformer_entry[bfer_idx]; + p_beamformer_entry->is_mu_ap = false; /*Sounding protocol control*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); - - + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8822B, 0xDB); + + for (i = 0; i < MAX_BEAMFORMER_SU; i++) { - if ((pBeamformingInfo->beamformer_su_reg_maping & BIT(i)) == 0) { - pBeamformingInfo->beamformer_su_reg_maping |= BIT(i); - pBeamformerEntry->su_reg_index = i; + if ((p_beamforming_info->beamformer_su_reg_maping & BIT(i)) == 0) { + p_beamforming_info->beamformer_su_reg_maping |= BIT(i); + p_beamformer_entry->su_reg_index = i; break; } } - + /*MAC address/Partial AID of Beamformer*/ - if (pBeamformerEntry->su_reg_index == 0) { + if (p_beamformer_entry->su_reg_index == 0) { for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); + odm_write_1byte(p_dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), p_beamformer_entry->mac_addr[i]); } else { for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER1_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); + odm_write_1byte(p_dm, (REG_ASSOCIATED_BFMER1_INFO_8822B + i), p_beamformer_entry->mac_addr[i]); } /*CSI report parameters of Beamformer*/ - Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /*for 8814A Nrx = 3(4 Ant), min=0(1 Ant)*/ - Nr_index = pBeamformerEntry->NumofSoundingDim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ - + nc_index = hal_txbf_8822b_get_nrx(p_dm); /*for 8814A nrx = 3(4 ant), min=0(1 ant)*/ + nr_index = p_beamformer_entry->num_of_sounding_dim; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so nr_index don't care*/ + grouping = 0; /*for ac = 1, for n = 3*/ - if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) - codebookinfo = 1; - else if (pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_HT_EXPLICIT) - codebookinfo = 3; + if (p_beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) + codebookinfo = 1; + else if (p_beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_HT_EXPLICIT) + codebookinfo = 3; coefficientsize = 3; - CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); + csi_param = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); - if (BFerIdx == 0) - ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, CSI_Param); + if (bfer_idx == 0) + odm_write_2byte(p_dm, REG_TX_CSI_RPT_PARAM_BW20_8822B, csi_param); else - ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, CSI_Param); + odm_write_2byte(p_dm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, csi_param); /*ndp_rx_standby_timer, 8814 need > 0x56, suggest from Dvaid*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B+3, 0x70); - + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8822B + 3, 0x70); + } /*************SU BFee Entry Init*************/ - if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { - pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; - pBeamformeeEntry->is_mu_sta = FALSE; - halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - STAid = pBeamformeeEntry->MacId; - else - STAid = pBeamformeeEntry->P_AID; + if ((p_beamforming_info->beamformee_su_cnt > 0) && (bfee_idx < BEAMFORMEE_ENTRY_NUM)) { + p_beamformee_entry = &p_beamforming_info->beamformee_entry[bfee_idx]; + p_beamformee_entry->is_mu_sta = false; + hal_txbf_8822b_rf_mode(p_dm, p_beamforming_info, bfee_idx); + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + sta_id = p_beamformee_entry->mac_id; + else + sta_id = p_beamformee_entry->p_aid; for (i = 0; i < MAX_BEAMFORMEE_SU; i++) { - if ((pBeamformingInfo->beamformee_su_reg_maping & BIT(i)) == 0) { - pBeamformingInfo->beamformee_su_reg_maping |= BIT(i); - pBeamformeeEntry->su_reg_index = i; + if ((p_beamforming_info->beamformee_su_reg_maping & BIT(i)) == 0) { + p_beamforming_info->beamformee_su_reg_maping |= BIT(i); + p_beamformee_entry->su_reg_index = i; break; } } - + /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ - if (pBeamformeeEntry->su_reg_index == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, STAid); - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); - } else { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, STAid | BIT14 | BIT15 | BIT12); - } + if (p_beamformee_entry->su_reg_index == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8822B, sta_id); + odm_write_1byte(p_dm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(p_dm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); + } else + odm_write_2byte(p_dm, REG_TXBF_CTRL_8822B + 2, sta_id | BIT(14) | BIT(15) | BIT(12)); /*CSI report parameters of Beamformee*/ - if (pBeamformeeEntry->su_reg_index == 0) { + if (p_beamformee_entry->su_reg_index == 0) { /*Get BIT24 & BIT25*/ - u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+3) & 0x3; - - ODM_Write1Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, STAid | BIT9); - } else - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, STAid | 0xE200); /*Set BIT25*/ - - phydm_Beamforming_Notify(pDM_Odm); + u8 tmp = odm_read_1byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3) & 0x3; + + odm_write_1byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 3, tmp | 0x60); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8822B, sta_id | BIT(9)); + } else + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, sta_id | 0xE200); /*Set BIT25*/ + + phydm_beamforming_notify(p_dm); } /*************MU BFer Entry Init*************/ - if ((pBeamformingInfo->beamformer_mu_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { - pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[BFerIdx]; - pBeamformingInfo->mu_ap_index = BFerIdx; - pBeamformerEntry->is_mu_ap = TRUE; + if ((p_beamforming_info->beamformer_mu_cnt > 0) && (bfer_idx < BEAMFORMER_ENTRY_NUM)) { + p_beamformer_entry = &p_beamforming_info->beamformer_entry[bfer_idx]; + p_beamforming_info->mu_ap_index = bfer_idx; + p_beamformer_entry->is_mu_ap = true; for (i = 0; i < 8; i++) - pBeamformerEntry->gid_valid[i] = 0; + p_beamformer_entry->gid_valid[i] = 0; for (i = 0; i < 16; i++) - pBeamformerEntry->user_position[i] = 0; - + p_beamformer_entry->user_position[i] = 0; + /*Sounding protocol control*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8822B, 0xDB); /* MAC address */ for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+i), pBeamformerEntry->MacAddr[i]); + odm_write_1byte(p_dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + i), p_beamformer_entry->mac_addr[i]); /* Set partial AID */ - ODM_Write2Byte(pDM_Odm, (REG_ASSOCIATED_BFMER0_INFO_8822B+6), pBeamformerEntry->P_AID); + odm_write_2byte(p_dm, (REG_ASSOCIATED_BFMER0_INFO_8822B + 6), p_beamformer_entry->p_aid); /* Fill our AID to 0x1680[11:0] and [13:12] = 2b'00, BF report segment select to 3895 bytes*/ - u1bTmp = ODM_Read1Byte(pDM_Odm, 0x1680); - u1bTmp = (pBeamformerEntry->AID)&0xFFF; - ODM_Write1Byte(pDM_Odm, 0x1680, u1bTmp); + u1b_tmp = odm_read_1byte(p_dm, 0x1680); + u1b_tmp = (p_beamformer_entry->p_aid) & 0xFFF; + odm_write_1byte(p_dm, 0x1680, u1b_tmp); /* Set 80us for leaving ndp_rx_standby_state */ - ODM_Write1Byte(pDM_Odm, 0x71B, 0x50); - + odm_write_1byte(p_dm, 0x71B, 0x50); + /* Set 0x6A0[14] = 1 to accept action_no_ack */ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); - u1bTmp |= 0x40; - ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); + u1b_tmp = odm_read_1byte(p_dm, REG_RXFLTMAP0_8822B + 1); + u1b_tmp |= 0x40; + odm_write_1byte(p_dm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); /* Set 0x6A2[5:4] = 1 to NDPA and BF report poll */ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP1_8822B); - u1bTmp |= 0x30; - ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP1_8822B, u1bTmp); - + u1b_tmp = odm_read_1byte(p_dm, REG_RXFLTMAP1_8822B); + u1b_tmp |= 0x30; + odm_write_1byte(p_dm, REG_RXFLTMAP1_8822B, u1b_tmp); + /*CSI report parameters of Beamformer*/ - Nc_index = halTxbf8822B_GetNrx(pDM_Odm); /* Depend on RF type */ - Nr_index = 1; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so Nr_index don't care*/ + nc_index = hal_txbf_8822b_get_nrx(p_dm); /* Depend on RF type */ + nr_index = 1; /*0x718[7] = 1 use Nsts, 0x718[7] = 0 use reg setting. as Bfee, we use Nsts, so nr_index don't care*/ grouping = 0; /*no grouping*/ codebookinfo = 1; /*7 bit for psi, 9 bit for phi*/ - coefficientsize = 0; /*This is nothing really matter*/ - CSI_Param = (u2Byte)((coefficientsize<<10)|(codebookinfo<<8)|(grouping<<6)|(Nr_index<<3)|(Nc_index)); - ODM_Write2Byte(pDM_Odm, 0x6F4, CSI_Param); + coefficientsize = 0; /*This is nothing really matter*/ + csi_param = (u16)((coefficientsize << 10) | (codebookinfo << 8) | (grouping << 6) | (nr_index << 3) | (nc_index)); + odm_write_2byte(p_dm, 0x6F4, csi_param); - /*for B-Cut*/ - ODM_SetBBReg(pDM_Odm, 0x6A0 , BIT20, 0); - ODM_SetBBReg(pDM_Odm, 0x688 , BIT20, 0); + /*for B-cut*/ + odm_set_bb_reg(p_dm, 0x6A0, BIT(20), 0); + odm_set_bb_reg(p_dm, 0x688, BIT(20), 0); } - + /*************MU BFee Entry Init*************/ - if ((pBeamformingInfo->beamformee_mu_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { - pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[BFeeIdx]; - pBeamformeeEntry->is_mu_sta = TRUE; + if ((p_beamforming_info->beamformee_mu_cnt > 0) && (bfee_idx < BEAMFORMEE_ENTRY_NUM)) { + p_beamformee_entry = &p_beamforming_info->beamformee_entry[bfee_idx]; + p_beamformee_entry->is_mu_sta = true; for (i = 0; i < MAX_BEAMFORMEE_MU; i++) { - if ((pBeamformingInfo->beamformee_mu_reg_maping & BIT(i)) == 0) { - pBeamformingInfo->beamformee_mu_reg_maping |= BIT(i); - pBeamformeeEntry->mu_reg_index = i; + if ((p_beamforming_info->beamformee_mu_reg_maping & BIT(i)) == 0) { + p_beamforming_info->beamformee_mu_reg_maping |= BIT(i); + p_beamformee_entry->mu_reg_index = i; break; } } - if (pBeamformeeEntry->mu_reg_index == 0xFF) { + if (p_beamformee_entry->mu_reg_index == 0xFF) { /* There is no valid bit in beamformee_mu_reg_maping */ RT_DISP(FBEAM, FBEAM_FUN, ("%s: ERROR! There is no valid bit in beamformee_mu_reg_maping!\n", __func__)); return; } - + /*User position table*/ - switch (pBeamformeeEntry->mu_reg_index) { + switch (p_beamformee_entry->mu_reg_index) { case 0: gid_valid = 0x7fe; user_position_l = 0x111110; @@ -531,90 +546,90 @@ HalTxbf8822B_Enter( for (i = 0; i < 8; i++) { if (i < 4) { - pBeamformeeEntry->gid_valid[i] = (u1Byte)(gid_valid & 0xFF); + p_beamformee_entry->gid_valid[i] = (u8)(gid_valid & 0xFF); gid_valid = (gid_valid >> 8); } else - pBeamformeeEntry->gid_valid[i] = 0; + p_beamformee_entry->gid_valid[i] = 0; } for (i = 0; i < 16; i++) { if (i < 4) - pBeamformeeEntry->user_position[i] = (u1Byte)((user_position_l >>(i*8)) & 0xFF); + p_beamformee_entry->user_position[i] = (u8)((user_position_l >> (i * 8)) & 0xFF); else if (i < 8) - pBeamformeeEntry->user_position[i] = (u1Byte)((user_position_h >>((i-4)*8)) & 0xFF); + p_beamformee_entry->user_position[i] = (u8)((user_position_h >> ((i - 4) * 8)) & 0xFF); else - pBeamformeeEntry->user_position[i] = 0; + p_beamformee_entry->user_position[i] = 0; } /*Sounding protocol control*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xDB); + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8822B, 0xDB); /*select MU STA table*/ - pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); - pBeamformingInfo->RegMUTxCtrl |= (pBeamformeeEntry->mu_reg_index << 8)&(BIT8|BIT9|BIT10); - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); - - ODM_SetBBReg(pDM_Odm, 0x14c4 , bMaskDWord, 0); /*Reset gid_valid table*/ - ODM_SetBBReg(pDM_Odm, 0x14c8 , bMaskDWord, user_position_l); - ODM_SetBBReg(pDM_Odm, 0x14cc , bMaskDWord, user_position_h); + p_beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + p_beamforming_info->reg_mu_tx_ctrl |= (p_beamformee_entry->mu_reg_index << 8) & (BIT(8) | BIT(9) | BIT(10)); + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - /*set validity of MU STAs*/ - pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; - pBeamformingInfo->RegMUTxCtrl |= pBeamformingInfo->beamformee_mu_reg_maping&0x3F; - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); + odm_set_bb_reg(p_dm, 0x14c4, MASKDWORD, 0); /*Reset gid_valid table*/ + odm_set_bb_reg(p_dm, 0x14c8, MASKDWORD, user_position_l); + odm_set_bb_reg(p_dm, 0x14cc, MASKDWORD, user_position_h); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, RegMUTxCtrl = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", - __func__, pBeamformingInfo->RegMUTxCtrl, user_position_l, user_position_h)); + /*set validity of MU STAs*/ + p_beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; + p_beamforming_info->reg_mu_tx_ctrl |= p_beamforming_info->beamformee_mu_reg_maping & 0x3F; + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - value16 = ODM_Read2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index]); + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, reg_mu_tx_ctrl = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", + __func__, p_beamforming_info->reg_mu_tx_ctrl, user_position_l, user_position_h)); + + value16 = odm_read_2byte(p_dm, mu_reg[p_beamformee_entry->mu_reg_index]); value16 &= 0xFE00; /*Clear PAID*/ - value16 |= BIT9; /*Enable MU BFee*/ - value16 |= pBeamformeeEntry->P_AID; - ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , value16); - + value16 |= BIT(9); /*Enable MU BFee*/ + value16 |= p_beamformee_entry->p_aid; + odm_write_2byte(p_dm, mu_reg[p_beamformee_entry->mu_reg_index], value16); + /* 0x42C[30] = 1 (0: from Tx desc, 1: from 0x45F) */ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3); - u1bTmp |= 0xD0; /* Set bit 28, 30, 31 to 3b'111*/ - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, u1bTmp); + u1b_tmp = odm_read_1byte(p_dm, REG_TXBF_CTRL_8822B + 3); + u1b_tmp |= 0xD0; /* Set bit 28, 30, 31 to 3b'111*/ + odm_write_1byte(p_dm, REG_TXBF_CTRL_8822B + 3, u1b_tmp); /* Set NDPA to 6M*/ - ODM_Write1Byte(pDM_Odm, REG_NDPA_RATE_8822B, 0x4); + odm_write_1byte(p_dm, REG_NDPA_RATE_8822B, 0x4); - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B); - u1bTmp &= 0xFC; /* Clear bit 0, 1*/ - ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8822B, u1bTmp); + u1b_tmp = odm_read_1byte(p_dm, REG_NDPA_OPT_CTRL_8822B); + u1b_tmp &= 0xFC; /* Clear bit 0, 1*/ + odm_write_1byte(p_dm, REG_NDPA_OPT_CTRL_8822B, u1b_tmp); - u4bTmp = ODM_Read4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B); - u4bTmp = ((u4bTmp & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202*/ - ODM_Write4Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, u4bTmp); + u4b_tmp = odm_read_4byte(p_dm, REG_SND_PTCL_CTRL_8822B); + u4b_tmp = ((u4b_tmp & 0xFF0000FF) | 0x020200); /* Set [23:8] to 0x0202*/ + odm_write_4byte(p_dm, REG_SND_PTCL_CTRL_8822B, u4b_tmp); /* Set 0x6A0[14] = 1 to accept action_no_ack */ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1); - u1bTmp |= 0x40; - ODM_Write1Byte(pDM_Odm, REG_RXFLTMAP0_8822B+1, u1bTmp); + u1b_tmp = odm_read_1byte(p_dm, REG_RXFLTMAP0_8822B + 1); + u1b_tmp |= 0x40; + odm_write_1byte(p_dm, REG_RXFLTMAP0_8822B + 1, u1b_tmp); /* End of MAC registers setting */ - - halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, BFeeIdx); + + hal_txbf_8822b_rf_mode(p_dm, p_beamforming_info, bfee_idx); #if (SUPPORT_MU_BF == 1) /*Special for plugfest*/ delay_ms(50); /* wait for 4-way handshake ending*/ - SendSWVHTGIDMgntFrame(pDM_Odm, pBeamformeeEntry->MacAddr, BFeeIdx); -#endif + send_sw_vht_gid_mgnt_frame(p_dm, p_beamformee_entry->mac_addr, bfee_idx); +#endif - phydm_Beamforming_Notify(pDM_Odm); + phydm_beamforming_notify(p_dm); #if 1 { - u4Byte ctrl_info_offset, index; + u32 ctrl_info_offset, index; /*Set Ctrl Info*/ - ODM_Write2Byte(pDM_Odm, 0x140, 0x660); - ctrl_info_offset = 0x8000 + 32 * pBeamformeeEntry->MacId; + odm_write_2byte(p_dm, 0x140, 0x660); + ctrl_info_offset = 0x8000 + 32 * p_beamformee_entry->mac_id; /*Reset Ctrl Info*/ for (index = 0; index < 8; index++) - ODM_Write4Byte(pDM_Odm, ctrl_info_offset + index*4, 0); - - ODM_Write4Byte(pDM_Odm, ctrl_info_offset, (pBeamformeeEntry->mu_reg_index + 1) << 16); - ODM_Write1Byte(pDM_Odm, 0x81, 0x80); /*RPTBUF ready*/ + odm_write_4byte(p_dm, ctrl_info_offset + index * 4, 0); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, MacId = %d, ctrl_info_offset = 0x%x, mu_reg_index = %x\n", - __func__, pBeamformeeEntry->MacId, ctrl_info_offset, pBeamformeeEntry->mu_reg_index)); + odm_write_4byte(p_dm, ctrl_info_offset, (p_beamformee_entry->mu_reg_index + 1) << 16); + odm_write_1byte(p_dm, 0x81, 0x80); /*RPTBUF ready*/ + + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, mac_id = %d, ctrl_info_offset = 0x%x, mu_reg_index = %x\n", + __func__, p_beamformee_entry->mac_id, ctrl_info_offset, p_beamformee_entry->mu_reg_index)); } #endif } @@ -622,21 +637,21 @@ HalTxbf8822B_Enter( } -VOID -HalTxbf8822B_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx - ) +void +hal_txbf_8822b_leave( + void *p_dm_void, + u8 idx +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMER_ENTRY pBeamformerEntry; - PRT_BEAMFORMEE_ENTRY pBeamformeeEntry; - u4Byte mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMER_ENTRY *p_beamformer_entry; + struct _RT_BEAMFORMEE_ENTRY *p_beamformee_entry; + u32 mu_reg[6] = {0x1684, 0x1686, 0x1688, 0x168a, 0x168c, 0x168e}; - if (Idx < BEAMFORMER_ENTRY_NUM) { - pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[Idx]; - pBeamformeeEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; + if (idx < BEAMFORMER_ENTRY_NUM) { + p_beamformer_entry = &p_beamforming_info->beamformer_entry[idx]; + p_beamformee_entry = &p_beamforming_info->beamformee_entry[idx]; } else return; @@ -644,147 +659,145 @@ HalTxbf8822B_Leave( /*Clear MAC address of Beamformer*/ /*Clear Associated Bfmee Sel*/ - if (pBeamformerEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8822B, 0xD8); - if (pBeamformerEntry->is_mu_ap == 0) { /*SU BFer */ - if (pBeamformerEntry->su_reg_index == 0) { - ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER0_INFO_8822B+4, 0); - ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0); + if (p_beamformer_entry->beamform_entry_cap == BEAMFORMING_CAP_NONE) { + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8822B, 0xD8); + if (p_beamformer_entry->is_mu_ap == 0) { /*SU BFer */ + if (p_beamformer_entry->su_reg_index == 0) { + odm_write_4byte(p_dm, REG_ASSOCIATED_BFMER0_INFO_8822B, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMER0_INFO_8822B + 4, 0); + odm_write_2byte(p_dm, REG_TX_CSI_RPT_PARAM_BW20_8822B, 0); } else { - ODM_Write4Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMER1_INFO_8822B+4, 0); - ODM_Write2Byte(pDM_Odm, REG_TX_CSI_RPT_PARAM_BW20_8822B+2, 0); + odm_write_4byte(p_dm, REG_ASSOCIATED_BFMER1_INFO_8822B, 0); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMER1_INFO_8822B + 4, 0); + odm_write_2byte(p_dm, REG_TX_CSI_RPT_PARAM_BW20_8822B + 2, 0); } - pBeamformingInfo->beamformer_su_reg_maping &= ~(BIT(pBeamformerEntry->su_reg_index)); - pBeamformerEntry->su_reg_index = 0xFF; + p_beamforming_info->beamformer_su_reg_maping &= ~(BIT(p_beamformer_entry->su_reg_index)); + p_beamformer_entry->su_reg_index = 0xFF; } else { /*MU BFer */ /*set validity of MU STA0 and MU STA1*/ - pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); + p_beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - ODM_Memory_Set(pDM_Odm, pBeamformerEntry->gid_valid, 0, 8); - ODM_Memory_Set(pDM_Odm, pBeamformerEntry->user_position, 0, 16); - pBeamformerEntry->is_mu_ap = FALSE; + odm_memory_set(p_dm, p_beamformer_entry->gid_valid, 0, 8); + odm_memory_set(p_dm, p_beamformer_entry->user_position, 0, 16); + p_beamformer_entry->is_mu_ap = false; } } - if (pBeamformeeEntry->BeamformEntryCap == BEAMFORMING_CAP_NONE) { - halTxbf8822B_RfMode(pDM_Odm, pBeamformingInfo, Idx); - if (pBeamformeeEntry->is_mu_sta == 0) { /*SU BFee*/ - if (pBeamformeeEntry->su_reg_index == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, 0x0); - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8822B+3)|BIT4|BIT6|BIT7); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); + if (p_beamformee_entry->beamform_entry_cap == BEAMFORMING_CAP_NONE) { + hal_txbf_8822b_rf_mode(p_dm, p_beamforming_info, idx); + if (p_beamformee_entry->is_mu_sta == 0) { /*SU BFee*/ + if (p_beamformee_entry->su_reg_index == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8822B, 0x0); + odm_write_1byte(p_dm, REG_TXBF_CTRL_8822B + 3, odm_read_1byte(p_dm, REG_TXBF_CTRL_8822B + 3) | BIT(4) | BIT(6) | BIT(7)); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8822B, 0); } else { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B+2, 0x0 | BIT14 | BIT15 | BIT12); + odm_write_2byte(p_dm, REG_TXBF_CTRL_8822B + 2, 0x0 | BIT(14) | BIT(15) | BIT(12)); - ODM_Write2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2, - ODM_Read2Byte(pDM_Odm, REG_ASSOCIATED_BFMEE_SEL_8822B+2) & 0x60); + odm_write_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2, + odm_read_2byte(p_dm, REG_ASSOCIATED_BFMEE_SEL_8822B + 2) & 0x60); } - pBeamformingInfo->beamformee_su_reg_maping &= ~(BIT(pBeamformeeEntry->su_reg_index)); - pBeamformeeEntry->su_reg_index = 0xFF; + p_beamforming_info->beamformee_su_reg_maping &= ~(BIT(p_beamformee_entry->su_reg_index)); + p_beamformee_entry->su_reg_index = 0xFF; } else { /*MU BFee */ /*Disable sending NDPA & BF-rpt-poll to this BFee*/ - ODM_Write2Byte(pDM_Odm, mu_reg[pBeamformeeEntry->mu_reg_index] , 0); + odm_write_2byte(p_dm, mu_reg[p_beamformee_entry->mu_reg_index], 0); /*set validity of MU STA*/ - pBeamformingInfo->RegMUTxCtrl &= ~(BIT(pBeamformeeEntry->mu_reg_index)); - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); + p_beamforming_info->reg_mu_tx_ctrl &= ~(BIT(p_beamformee_entry->mu_reg_index)); + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); - - pBeamformeeEntry->is_mu_sta = FALSE; - pBeamformingInfo->beamformee_mu_reg_maping &= ~(BIT(pBeamformeeEntry->mu_reg_index)); - pBeamformeeEntry->mu_reg_index = 0xFF; + + p_beamformee_entry->is_mu_sta = false; + p_beamforming_info->beamformee_mu_reg_maping &= ~(BIT(p_beamformee_entry->mu_reg_index)); + p_beamformee_entry->mu_reg_index = 0xFF; } } } /***********SU & MU BFee Entry Only when souding done****************/ -VOID -HalTxbf8822B_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx - ) +void +hal_txbf_8822b_status( + void *p_dm_void, + u8 beamform_idx +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u2Byte BeamCtrlVal, tmpVal; - u4Byte BeamCtrlReg; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamformEntry; - BOOLEAN is_mu_sounding = pBeamformingInfo->is_mu_sounding, is_bitmap_ready = FALSE; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 beam_ctrl_val, tmp_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry; + boolean is_mu_sounding = p_beamforming_info->is_mu_sounding, is_bitmap_ready = false; u16 bitmap; u8 idx, gid, i; u8 id1, id0; u32 gid_valid[6] = {0}; - u32 user_position_lsb[6] = {0}; - u32 user_position_msb[6] = {0}; u32 value32; - BOOLEAN is_sounding_success[6] = {FALSE}; + boolean is_sounding_success[6] = {false}; - if (Idx < BEAMFORMEE_ENTRY_NUM) - pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[Idx]; + if (beamform_idx < BEAMFORMEE_ENTRY_NUM) + p_beamform_entry = &p_beamforming_info->beamformee_entry[beamform_idx]; else return; - + /*SU sounding done */ - if (is_mu_sounding == FALSE) { + if (is_mu_sounding == false) { - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - BeamCtrlVal = pBeamformEntry->MacId; - else - BeamCtrlVal = pBeamformEntry->P_AID; + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + beam_ctrl_val = p_beamform_entry->mac_id; + else + beam_ctrl_val = p_beamform_entry->p_aid; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BeamformEntry.BeamformEntryState = %d", __func__, pBeamformEntry->BeamformEntryState)); + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, beamform_entry.beamform_entry_state = %d", __func__, p_beamform_entry->beamform_entry_state)); - if (pBeamformEntry->su_reg_index == 0) { - BeamCtrlReg = REG_TXBF_CTRL_8822B; - } else { - BeamCtrlReg = REG_TXBF_CTRL_8822B+2; - BeamCtrlVal |= BIT12|BIT14|BIT15; + if (p_beamform_entry->su_reg_index == 0) + beam_ctrl_reg = REG_TXBF_CTRL_8822B; + else { + beam_ctrl_reg = REG_TXBF_CTRL_8822B + 2; + beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); } - if (pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_20) - BeamCtrlVal |= BIT9; - else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_40) - BeamCtrlVal |= (BIT9|BIT10); - else if (pBeamformEntry->SoundBW == CHANNEL_WIDTH_80) - BeamCtrlVal |= (BIT9|BIT10|BIT11); + if (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (p_beamform_entry->sound_bw == CHANNEL_WIDTH_20) + beam_ctrl_val |= BIT(9); + else if (p_beamform_entry->sound_bw == CHANNEL_WIDTH_40) + beam_ctrl_val |= (BIT(9) | BIT(10)); + else if (p_beamform_entry->sound_bw == CHANNEL_WIDTH_80) + beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); } else { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, Don't apply Vmatrix", __func__)); - BeamCtrlVal &= ~(BIT9|BIT10|BIT11); + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, Don't apply Vmatrix", __func__)); + beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); } - ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); + odm_write_2byte(p_dm, beam_ctrl_reg, beam_ctrl_val); /*disable NDP packet use beamforming */ - tmpVal = ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8822B); - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8822B, tmpVal|BIT15); + tmp_val = odm_read_2byte(p_dm, REG_TXBF_CTRL_8822B); + odm_write_2byte(p_dm, REG_TXBF_CTRL_8822B, tmp_val | BIT(15)); } else { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, MU Sounding Done\n", __func__)); + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, MU Sounding Done\n", __func__)); /*MU sounding done */ - if (1){//(pBeamformEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, BEAMFORMING_ENTRY_STATE_PROGRESSED\n", __func__)); + if (1) { /* (p_beamform_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { */ + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, BEAMFORMING_ENTRY_STATE_PROGRESSED\n", __func__)); - value32 = ODM_GetBBReg(pDM_Odm, 0x1684, bMaskDWord); - is_sounding_success[0] = (value32 & BIT10)?1:0; - is_sounding_success[1] = (value32 & BIT26)?1:0; - value32 = ODM_GetBBReg(pDM_Odm, 0x1688, bMaskDWord); - is_sounding_success[2] = (value32 & BIT10)?1:0; - is_sounding_success[3] = (value32 & BIT26)?1:0; - value32 = ODM_GetBBReg(pDM_Odm, 0x168C, bMaskDWord); - is_sounding_success[4] = (value32 & BIT10)?1:0; - is_sounding_success[5] = (value32 & BIT26)?1:0; + value32 = odm_get_bb_reg(p_dm, 0x1684, MASKDWORD); + is_sounding_success[0] = (value32 & BIT(10)) ? 1 : 0; + is_sounding_success[1] = (value32 & BIT(26)) ? 1 : 0; + value32 = odm_get_bb_reg(p_dm, 0x1688, MASKDWORD); + is_sounding_success[2] = (value32 & BIT(10)) ? 1 : 0; + is_sounding_success[3] = (value32 & BIT(26)) ? 1 : 0; + value32 = odm_get_bb_reg(p_dm, 0x168C, MASKDWORD); + is_sounding_success[4] = (value32 & BIT(10)) ? 1 : 0; + is_sounding_success[5] = (value32 & BIT(26)) ? 1 : 0; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("@%s, is_sounding_success STA1:%d, STA2:%d, STA3:%d, STA4:%d, STA5:%d, STA6:%d\n", - __func__, is_sounding_success[0], is_sounding_success[1] , is_sounding_success[2] , is_sounding_success[3] , is_sounding_success[4] , is_sounding_success[5] )); - - value32 = ODM_GetBBReg(pDM_Odm, 0xF4C, 0xFFFF0000); - //ODM_SetBBReg(pDM_Odm, 0x19E0, bMaskHWord, 0xFFFF);/*Let MAC ignore bitmap*/ - - is_bitmap_ready = (BOOLEAN)((value32 & BIT15) >> 15); + PHYDM_DBG(p_dm, DBG_TXBF, ("@%s, is_sounding_success STA1:%d, STA2:%d, STA3:%d, STA4:%d, STA5:%d, STA6:%d\n", + __func__, is_sounding_success[0], is_sounding_success[1], is_sounding_success[2], is_sounding_success[3], is_sounding_success[4], is_sounding_success[5])); + + value32 = odm_get_bb_reg(p_dm, 0xF4C, 0xFFFF0000); + /* odm_set_bb_reg(p_dm, 0x19E0, MASKHWORD, 0xFFFF);Let MAC ignore bitmap */ + + is_bitmap_ready = (boolean)((value32 & BIT(15)) >> 15); bitmap = (u16)(value32 & 0x3FFF); - + for (idx = 0; idx < 15; idx++) { if (idx < 5) {/*bit0~4*/ id0 = 0; @@ -795,7 +808,7 @@ HalTxbf8822B_Status( } else if (idx < 12) { /*bit9~11*/ id0 = 2; id1 = (u8)(idx - 6); - } else if (idx < 14) { /*bit12~13*/ + } else if (idx < 14) { /*bit12~13*/ id0 = 3; id1 = (u8)(idx - 8); } else { /*bit14*/ @@ -824,69 +837,69 @@ HalTxbf8822B_Status( } for (i = 0; i < BEAMFORMEE_ENTRY_NUM; i++) { - pBeamformEntry = &pBeamformingInfo->BeamformeeEntry[i]; - if ((pBeamformEntry->is_mu_sta) && (pBeamformEntry->mu_reg_index < 6)) { - value32 = gid_valid[pBeamformEntry->mu_reg_index]; + p_beamform_entry = &p_beamforming_info->beamformee_entry[i]; + if ((p_beamform_entry->is_mu_sta) && (p_beamform_entry->mu_reg_index < 6)) { + value32 = gid_valid[p_beamform_entry->mu_reg_index]; for (idx = 0; idx < 4; idx++) { - pBeamformEntry->gid_valid[idx] = (u8)(value32 & 0xFF); + p_beamform_entry->gid_valid[idx] = (u8)(value32 & 0xFF); value32 = (value32 >> 8); } } } for (idx = 0; idx < 6; idx++) { - pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); - pBeamformingInfo->RegMUTxCtrl |= ((idx<<8)&(BIT8|BIT9|BIT10)); - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); - ODM_SetMACReg(pDM_Odm, 0x14C4, bMaskDWord, gid_valid[idx]); /*set MU STA gid valid table*/ + p_beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + p_beamforming_info->reg_mu_tx_ctrl |= ((idx << 8) & (BIT(8) | BIT(9) | BIT(10))); + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + odm_set_mac_reg(p_dm, 0x14C4, MASKDWORD, gid_valid[idx]); /*set MU STA gid valid table*/ } /*Enable TxMU PPDU*/ - if (pBeamformingInfo->dbg_disable_mu_tx == FALSE) - pBeamformingInfo->RegMUTxCtrl |= BIT7; + if (p_beamforming_info->dbg_disable_mu_tx == false) + p_beamforming_info->reg_mu_tx_ctrl |= BIT(7); else - pBeamformingInfo->RegMUTxCtrl &= ~BIT7; - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); + p_beamforming_info->reg_mu_tx_ctrl &= ~BIT(7); + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); } } } /*Only used for MU BFer Entry when get GID management frame (self is as MU STA)*/ -VOID -HalTxbf8822B_ConfigGtab( - IN PVOID pDM_VOID - ) +void +hal_txbf_8822b_config_gtab( + void *p_dm_void +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; - u4Byte gid_valid = 0, user_position_l = 0, user_position_h = 0, i; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMER_ENTRY *p_beamformer_entry = NULL; + u32 gid_valid = 0, user_position_l = 0, user_position_h = 0, i; - if (pBeamformingInfo->mu_ap_index < BEAMFORMER_ENTRY_NUM) - pBeamformerEntry = &pBeamformingInfo->BeamformerEntry[pBeamformingInfo->mu_ap_index]; + if (p_beamforming_info->mu_ap_index < BEAMFORMER_ENTRY_NUM) + p_beamformer_entry = &p_beamforming_info->beamformer_entry[p_beamforming_info->mu_ap_index]; else return; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s==>\n", __func__)); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s==>\n", __func__)); /*For GID 0~31*/ for (i = 0; i < 4; i++) - gid_valid |= (pBeamformerEntry->gid_valid[i] << (i<<3)); + gid_valid |= (p_beamformer_entry->gid_valid[i] << (i << 3)); for (i = 0; i < 8; i++) { if (i < 4) - user_position_l |= (pBeamformerEntry->user_position[i] << (i << 3)); + user_position_l |= (p_beamformer_entry->user_position[i] << (i << 3)); else - user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 4)<<3)); + user_position_h |= (p_beamformer_entry->user_position[i] << ((i - 4) << 3)); } /*select MU STA0 table*/ - pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); - ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); - ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); - ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); + p_beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + odm_set_bb_reg(p_dm, 0x14c4, MASKDWORD, gid_valid); + odm_set_bb_reg(p_dm, 0x14c8, MASKDWORD, user_position_l); + odm_set_bb_reg(p_dm, 0x14cc, MASKDWORD, user_position_h); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA0: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", - __func__, gid_valid, user_position_l, user_position_h)); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: STA0: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", + __func__, gid_valid, user_position_l, user_position_h)); gid_valid = 0; user_position_l = 0; @@ -894,46 +907,46 @@ HalTxbf8822B_ConfigGtab( /*For GID 32~64*/ for (i = 4; i < 8; i++) - gid_valid |= (pBeamformerEntry->gid_valid[i] << ((i - 4)<<3)); + gid_valid |= (p_beamformer_entry->gid_valid[i] << ((i - 4) << 3)); for (i = 8; i < 16; i++) { if (i < 4) - user_position_l |= (pBeamformerEntry->user_position[i] << ((i - 8) << 3)); + user_position_l |= (p_beamformer_entry->user_position[i] << ((i - 8) << 3)); else - user_position_h |= (pBeamformerEntry->user_position[i] << ((i - 12) << 3)); + user_position_h |= (p_beamformer_entry->user_position[i] << ((i - 12) << 3)); } /*select MU STA1 table*/ - pBeamformingInfo->RegMUTxCtrl &= ~(BIT8|BIT9|BIT10); - pBeamformingInfo->RegMUTxCtrl |= BIT8; - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); - ODM_SetBBReg(pDM_Odm, 0x14c4, bMaskDWord, gid_valid); - ODM_SetBBReg(pDM_Odm, 0x14c8, bMaskDWord, user_position_l); - ODM_SetBBReg(pDM_Odm, 0x14cc, bMaskDWord, user_position_h); + p_beamforming_info->reg_mu_tx_ctrl &= ~(BIT(8) | BIT(9) | BIT(10)); + p_beamforming_info->reg_mu_tx_ctrl |= BIT(8); + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + odm_set_bb_reg(p_dm, 0x14c4, MASKDWORD, gid_valid); + odm_set_bb_reg(p_dm, 0x14c8, MASKDWORD, user_position_l); + odm_set_bb_reg(p_dm, 0x14cc, MASKDWORD, user_position_h); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s: STA1: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", - __func__, gid_valid, user_position_l, user_position_h)); + PHYDM_DBG(p_dm, DBG_TXBF, ("%s: STA1: gid_valid = 0x%x, user_position_l = 0x%x, user_position_h = 0x%x\n", + __func__, gid_valid, user_position_l, user_position_h)); /* Set validity of MU STA0 and MU STA1*/ - pBeamformingInfo->RegMUTxCtrl &= 0xFFFFFFC0; - pBeamformingInfo->RegMUTxCtrl |= 0x3; /* STA0, STA1*/ - ODM_Write4Byte(pDM_Odm, 0x14c0, pBeamformingInfo->RegMUTxCtrl); - + p_beamforming_info->reg_mu_tx_ctrl &= 0xFFFFFFC0; + p_beamforming_info->reg_mu_tx_ctrl |= 0x3; /* STA0, STA1*/ + odm_write_4byte(p_dm, 0x14c0, p_beamforming_info->reg_mu_tx_ctrl); + } #if 0 /*This function translate the bitmap to GTAB*/ -VOID +void haltxbf8822b_gtab_translation( - IN PDM_ODM_T pDM_Odm -) + struct PHY_DM_STRUCT *p_dm +) { u8 idx, gid; u8 id1, id0; u32 gid_valid[6] = {0}; u32 user_position_lsb[6] = {0}; u32 user_position_msb[6] = {0}; - + for (idx = 0; idx < 15; idx++) { if (idx < 5) {/*bit0~4*/ id0 = 0; @@ -944,7 +957,7 @@ haltxbf8822b_gtab_translation( } else if (idx < 12) { /*bit9~11*/ id0 = 2; id1 = (u8)(idx - 6); - } else if (idx < 14) { /*bit12~13*/ + } else if (idx < 14) { /*bit12~13*/ id0 = 3; id1 = (u8)(idx - 8); } else { /*bit14*/ @@ -963,7 +976,7 @@ haltxbf8822b_gtab_translation( /*user_position_msb[id0] |= (0 << ((gid - 16) << 1));*/ user_position_msb[id1] |= (1 << ((gid - 16) << 1)); } - + /*Pair 2*/ gid += 1; gid_valid[id0] |= (1 << gid); @@ -980,26 +993,26 @@ haltxbf8822b_gtab_translation( for (idx = 0; idx < 6; idx++) { - /*DbgPrint("gid_valid[%d] = 0x%x\n", idx, gid_valid[idx]); - DbgPrint("user_position[%d] = 0x%x %x\n", idx, user_position_msb[idx], user_position_lsb[idx]);*/ + /*dbg_print("gid_valid[%d] = 0x%x\n", idx, gid_valid[idx]); + dbg_print("user_position[%d] = 0x%x %x\n", idx, user_position_msb[idx], user_position_lsb[idx]);*/ } } #endif -VOID -HalTxbf8822B_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx - ) +void +hal_txbf_8822b_fw_txbf( + void *p_dm_void, + u8 idx +) { #if 0 - PRT_BEAMFORMING_INFO pBeamInfo = GET_BEAMFORM_INFO(Adapter); - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry+Idx; + struct _RT_BEAMFORMING_INFO *p_beam_info = GET_BEAMFORM_INFO(adapter); + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; - if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) - halTxbf8822B_DownloadNDPA(Adapter, Idx); + if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) + hal_txbf_8822b_download_ndpa(adapter, idx); - halTxbf8822B_FwTxBFCmd(Adapter); + hal_txbf_8822b_fw_txbf_cmd(adapter); #endif } @@ -1007,92 +1020,93 @@ HalTxbf8822B_FwTxBF( #if (defined(CONFIG_BB_TXBF_API)) /*this function is only used for BFer*/ -VOID +void phydm_8822btxbf_rfmode( - IN PVOID pDM_VOID, - IN u1Byte SUBFeeCnt, - IN u1Byte MUBFeeCnt - ) + void *p_dm_void, + u8 su_bfee_cnt, + u8 mu_bfee_cnt +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i, Nr_index = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i; - if (pDM_Odm->RFType == ODM_1T1R) + if (p_dm->rf_type == RF_1T1R) return; - if ((SUBFeeCnt > 0) || (MUBFeeCnt > 0)) { - for (i = ODM_RF_PATH_A; i <= ODM_RF_PATH_B; i++) { - ODM_SetRFReg(pDM_Odm, i, 0xEF, BIT19, 0x1); /*RF Mode table write enable*/ - ODM_SetRFReg(pDM_Odm, i, 0x33, 0xF, 3); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, i, 0x3E, 0xfffff, 0x00036); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, i, 0x3F, 0xfffff, 0x5AFCE); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, i, 0xEF, BIT19, 0x0); /*RF Mode table write disable*/ + if ((su_bfee_cnt > 0) || (mu_bfee_cnt > 0)) { + for (i = RF_PATH_A; i <= RF_PATH_B; i++) { + odm_set_rf_reg(p_dm, (enum rf_path)i, 0xEF, BIT(19), 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(p_dm, (enum rf_path)i, 0x33, 0xF, 3); /*Select RX mode*/ + odm_set_rf_reg(p_dm, (enum rf_path)i, 0x3E, 0xfffff, 0x00036); /*Set Table data*/ + odm_set_rf_reg(p_dm, (enum rf_path)i, 0x3F, 0xfffff, 0x5AFCE); /*Set Table data*/ + odm_set_rf_reg(p_dm, (enum rf_path)i, 0xEF, BIT(19), 0x0); /*RF mode table write disable*/ } } - if (SUBFeeCnt > 0 || MUBFeeCnt > 0) { + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(30), 1); /*if Nsts > Nc, don't apply V matrix*/ + + if (su_bfee_cnt > 0 || mu_bfee_cnt > 0) { /*for 8814 19ac(idx 1), 19b4(idx 0), different Tx ant setting*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x2); /*enable BB TxBF ant mapping register*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 1); /*ignore user since 8822B only 2Tx*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x2); /*enable BB TxBF ant mapping register*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 1); /*ignore user since 8822B only 2Tx*/ + /*Nsts = 2 AB*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, 0xffff, 0x0433); + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x043); } else { - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT28|BIT29, 0x0); /*enable BB TxBF ant mapping register*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT31, 0); /*ignore user since 8822B only 2Tx*/ - - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ - ODM_SetBBReg(pDM_Odm, REG_BB_TX_PATH_SEL_2_8822B, bMaskLWord, 0x430); /*2SS by path-A,B*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(28) | BIT29, 0x0); /*enable BB TxBF ant mapping register*/ + odm_set_bb_reg(p_dm, REG_BB_TXBF_ANT_SET_BF1_8822B, BIT(31), 0); /*ignore user since 8822B only 2Tx*/ + + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_1_8822B, 0xfff00000, 0x1); /*1SS by path-A*/ + odm_set_bb_reg(p_dm, REG_BB_TX_PATH_SEL_2_8822B, MASKLWORD, 0x430); /*2SS by path-A,B*/ } } /*this function is for BFer bug workaround*/ -VOID +void phydm_8822b_sutxbfer_workaroud( - IN PVOID pDM_VOID, - IN BOOLEAN EnableSUBfer, - IN u1Byte Nc, - IN u1Byte Nr, - IN u1Byte Ng, - IN u1Byte CB, - IN u1Byte BW, - IN BOOLEAN isVHT - ) + void *p_dm_void, + boolean enable_su_bfer, + u8 nc, + u8 nr, + u8 ng, + u8 CB, + u8 BW, + boolean is_vht +) { - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; - if (EnableSUBfer) { - ODM_SetBBReg(pDM_Odm, 0x19f8, BIT22|BIT21|BIT20, 0x1); - ODM_SetBBReg(pDM_Odm, 0x19f8, BIT25|BIT24|BIT23, 0x0); - ODM_SetBBReg(pDM_Odm, 0x19f8, BIT16, 0x1); + if (enable_su_bfer) { + odm_set_bb_reg(p_dm, 0x19f8, BIT(22) | BIT(21) | BIT(20), 0x1); + odm_set_bb_reg(p_dm, 0x19f8, BIT(25) | BIT(24) | BIT(23), 0x0); + odm_set_bb_reg(p_dm, 0x19f8, BIT(16), 0x1); - if (isVHT) - ODM_SetBBReg(pDM_Odm, 0x19f0, BIT5|BIT4|BIT3|BIT2|BIT1|BIT0, 0x1f); + if (is_vht) + odm_set_bb_reg(p_dm, 0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x1f); else - ODM_SetBBReg(pDM_Odm, 0x19f0, BIT5|BIT4|BIT3|BIT2|BIT1|BIT0, 0x22); - - ODM_SetBBReg(pDM_Odm, 0x19f0, BIT7|BIT6, Nc); - ODM_SetBBReg(pDM_Odm, 0x19f0, BIT9|BIT8, Nr); - ODM_SetBBReg(pDM_Odm, 0x19f0, BIT11|BIT10, Ng); - ODM_SetBBReg(pDM_Odm, 0x19f0, BIT13|BIT12, CB); + odm_set_bb_reg(p_dm, 0x19f0, BIT(5) | BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0), 0x22); - ODM_SetBBReg(pDM_Odm, 0xb58, BIT3|BIT2, BW); - ODM_SetBBReg(pDM_Odm, 0xb58, BIT7|BIT6|BIT5|BIT4, 0x0); - ODM_SetBBReg(pDM_Odm, 0xb58, BIT9|BIT8, BW); - ODM_SetBBReg(pDM_Odm, 0xb58, BIT13|BIT12|BIT11|BIT10, 0x0); + odm_set_bb_reg(p_dm, 0x19f0, BIT(7) | BIT(6), nc); + odm_set_bb_reg(p_dm, 0x19f0, BIT(9) | BIT(8), nr); + odm_set_bb_reg(p_dm, 0x19f0, BIT(11) | BIT(10), ng); + odm_set_bb_reg(p_dm, 0x19f0, BIT(13) | BIT(12), CB); + + odm_set_bb_reg(p_dm, 0xb58, BIT(3) | BIT(2), BW); + odm_set_bb_reg(p_dm, 0xb58, BIT(7) | BIT(6) | BIT(5) | BIT(4), 0x0); + odm_set_bb_reg(p_dm, 0xb58, BIT(9) | BIT(8), BW); + odm_set_bb_reg(p_dm, 0xb58, BIT(13) | BIT(12) | BIT(11) | BIT(10), 0x0); } else - ODM_SetBBReg(pDM_Odm, 0x19f8, BIT16, 0x0); + odm_set_bb_reg(p_dm, 0x19f8, BIT(16), 0x0); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] enable_su_bfer = %d, is_vht = %d\n", __func__, enable_su_bfer, is_vht)); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] nc = %d, nr = %d, ng = %d, CB = %d, BW = %d\n", __func__, nc, nr, ng, CB, BW)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] EnableSUBfer = %d, isVHT = %d\n", __func__, EnableSUBfer, isVHT)); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] Nc = %d, Nr = %d, Ng = %d, CB = %d, BW = %d\n", __func__, Nc, Nr, Ng, CB, BW)); - } #endif #endif /* (RTL8822B_SUPPORT == 1)*/ - - diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.h index abf92967b2d2..2ff19bd665d7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbf8822b.h @@ -1,87 +1,93 @@ -#ifndef __HAL_TXBF_8822B_H__ -#define __HAL_TXBF_8822B_H__ - -#if (RTL8822B_SUPPORT == 1) -#if (BEAMFORMING_SUPPORT == 1) - -VOID -HalTxbf8822B_Init( - IN PVOID pDM_VOID - ); - -VOID -HalTxbf8822B_Enter( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8822B_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbf8822B_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - -VOID -HalTxbf8822B_ConfigGtab( - IN PVOID pDM_VOID - ); - -VOID -HalTxbf8822B_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); -#else -#define HalTxbf8822B_Init(pDM_VOID) -#define HalTxbf8822B_Enter(pDM_VOID, Idx) -#define HalTxbf8822B_Leave(pDM_VOID, Idx) -#define HalTxbf8822B_Status(pDM_VOID, Idx) -#define HalTxbf8822B_FwTxBF(pDM_VOID, Idx) -#define HalTxbf8822B_ConfigGtab(pDM_VOID) - -#endif - -#if (defined(CONFIG_BB_TXBF_API)) -VOID -phydm_8822btxbf_rfmode( - IN PVOID pDM_VOID, - IN u1Byte SUBFeeCnt, - IN u1Byte MUBFeeCnt - ); - -VOID -phydm_8822b_sutxbfer_workaroud( - IN PVOID pDM_VOID, - IN BOOLEAN EnableSUBfer, - IN u1Byte Nc, - IN u1Byte Nr, - IN u1Byte Ng, - IN u1Byte CB, - IN u1Byte BW, - IN BOOLEAN isVHT - ); - -#else -#define phydm_8822btxbf_rfmode(pDM_VOID, SUBFeeCnt, MUBFeeCnt) -#define phydm_8822b_sutxbfer_workaroud(pDM_VOID, EnableSUBfer, Nc, Nr, Ng, CB, BW, isVHT) -#endif - -#else -#define HalTxbf8822B_Init(pDM_VOID) -#define HalTxbf8822B_Enter(pDM_VOID, Idx) -#define HalTxbf8822B_Leave(pDM_VOID, Idx) -#define HalTxbf8822B_Status(pDM_VOID, Idx) -#define HalTxbf8822B_FwTxBF(pDM_VOID, Idx) -#define HalTxbf8822B_ConfigGtab(pDM_VOID) - -#endif -#endif - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HAL_TXBF_8822B_H__ +#define __HAL_TXBF_8822B_H__ + +#if (RTL8822B_SUPPORT == 1) +#if (BEAMFORMING_SUPPORT == 1) + +void +hal_txbf_8822b_enter( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8822b_leave( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_8822b_status( + void *p_dm_void, + u8 beamform_idx +); + +void +hal_txbf_8822b_config_gtab( + void *p_dm_void +); + +void +hal_txbf_8822b_fw_txbf( + void *p_dm_void, + u8 idx +); +#else +#define hal_txbf_8822b_enter(p_dm_void, idx) +#define hal_txbf_8822b_leave(p_dm_void, idx) +#define hal_txbf_8822b_status(p_dm_void, idx) +#define hal_txbf_8822b_fw_txbf(p_dm_void, idx) +#define hal_txbf_8822b_config_gtab(p_dm_void) + +#endif + +#if (defined(CONFIG_BB_TXBF_API)) +void +phydm_8822btxbf_rfmode( + void *p_dm_void, + u8 su_bfee_cnt, + u8 mu_bfee_cnt +); + +void +phydm_8822b_sutxbfer_workaroud( + void *p_dm_void, + boolean enable_su_bfer, + u8 nc, + u8 nr, + u8 ng, + u8 CB, + u8 BW, + boolean is_vht +); + +#else +#define phydm_8822btxbf_rfmode(p_dm_void, su_bfee_cnt, mu_bfee_cnt) +#define phydm_8822b_sutxbfer_workaroud(p_dm_void, enable_su_bfer, nc, nr, ng, CB, BW, is_vht) +#endif + +#else +#define hal_txbf_8822b_enter(p_dm_void, idx) +#define hal_txbf_8822b_leave(p_dm_void, idx) +#define hal_txbf_8822b_status(p_dm_void, idx) +#define hal_txbf_8822b_fw_txbf(p_dm_void, idx) +#define hal_txbf_8822b_config_gtab(p_dm_void) + +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.c index 4fbad2db84f4..ebccedcfb593 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.c @@ -1,1502 +1,1510 @@ -//============================================================ -// Description: -// -// This file is for TXBF interface mechanism -// -//============================================================ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (BEAMFORMING_SUPPORT == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -Beamforming_GidPAid( - PADAPTER Adapter, - PRT_TCB pTcb -) -{ - u1Byte Idx = 0; - u1Byte RA[6] ={0}; - pu1Byte pHeader = GET_FRAME_OF_FIRST_FRAG(Adapter, pTcb); - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - - if (Adapter->HardwareType < HARDWARE_TYPE_RTL8192EE) - return; - else if (IS_WIRELESS_MODE_N(Adapter) == FALSE) - return; - -#if (SUPPORT_MU_BF == 1) - if (pTcb->TxBFPktType == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* MU NDPA */ -#else - if (0) { -#endif - /* Fill G_ID and P_AID */ - pTcb->G_ID = 63; - if (pBeamInfo->FirstMUBFeeIndex < BEAMFORMEE_ENTRY_NUM) { - pTcb->P_AID = pBeamInfo->BeamformeeEntry[pBeamInfo->FirstMUBFeeIndex].P_AID; - RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID)); - } - } else { - GET_80211_HDR_ADDRESS1(pHeader, &RA); - - // VHT SU PPDU carrying one or more group addressed MPDUs or - // Transmitting a VHT NDP intended for multiple recipients - if (MacAddr_isBcst(RA) || MacAddr_isMulticast(RA) || pTcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) { - pTcb->G_ID = 63; - pTcb->P_AID = 0; - } else if (ACTING_AS_AP(Adapter)) { - u2Byte AID = (u2Byte) (MacIdGetOwnerAssociatedClientAID(Adapter, pTcb->macId) & 0x1ff); /*AID[0:8]*/ - - /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s pTcb->macId=0x%X, AID=0x%X\n", __func__, pTcb->macId, AID));*/ - pTcb->G_ID = 63; - - if (AID == 0) /*A PPDU sent by an AP to a non associated STA*/ - pTcb->P_AID = 0; - else { /*Sent by an AP and addressed to a STA associated with that AP*/ - u2Byte BSSID = 0; - GET_80211_HDR_ADDRESS2(pHeader, &RA); - BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*BSSID[44:47] xor BSSID[40:43]*/ - pTcb->P_AID = (AID + BSSID *32) & 0x1ff; /*(dec(A) + dec(B)*32) mod 512*/ - } - } else if (ACTING_AS_IBSS(Adapter)) { - pTcb->G_ID = 63; - /*P_AID for infrasturcture mode; MACID for ad-hoc mode. */ - pTcb->P_AID = pTcb->macId; - } else if (MgntLinkStatusQuery(Adapter)) { /*Addressed to AP*/ - pTcb->G_ID = 0; - GET_80211_HDR_ADDRESS1(pHeader, &RA); - pTcb->P_AID = RA[5]; /*RA[39:47]*/ - pTcb->P_AID = (pTcb->P_AID << 1) | (RA[4] >> 7 ); - } else { - pTcb->G_ID = 63; - pTcb->P_AID = 0; - } - /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, pTcb->G_ID, pTcb->P_AID));*/ - } -} - - -RT_STATUS -Beamforming_GetReportFrame( - IN PADAPTER Adapter, - IN PRT_RFD pRfd, - IN POCTET_STRING pPduOS - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; - pu1Byte pMIMOCtrlField, pCSIReport, pCSIMatrix; - u1Byte Idx, Nc, Nr, CH_W; - u2Byte CSIMatrixLen = 0; - - ACT_PKT_TYPE pktType = ACT_PKT_TYPE_UNKNOWN; - - //Memory comparison to see if CSI report is the same with previous one - pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, Frame_Addr2(*pPduOS), &Idx); - - if (pBeamformEntry == NULL) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetReportFrame: Cannot find entry by addr\n")); - return RT_STATUS_FAILURE; - } - - pktType = PacketGetActionFrameType(pPduOS); - - //-@ Modified by David - if (pktType == ACT_PKT_VHT_COMPRESSED_BEAMFORMING) { - pMIMOCtrlField = pPduOS->Octet + 26; - Nc = ((*pMIMOCtrlField) & 0x7) + 1; - Nr = (((*pMIMOCtrlField) & 0x38) >> 3) + 1; - CH_W = (((*pMIMOCtrlField) & 0xC0) >> 6); - pCSIMatrix = pMIMOCtrlField + 3 + Nc; //24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) - CSIMatrixLen = pPduOS->Length - 26 -3 -Nc; - } else if (pktType == ACT_PKT_HT_COMPRESSED_BEAMFORMING) { - pMIMOCtrlField = pPduOS->Octet + 26; - Nc = ((*pMIMOCtrlField) & 0x3) + 1; - Nr = (((*pMIMOCtrlField) & 0xC) >> 2) + 1; - CH_W = (((*pMIMOCtrlField) & 0x10) >> 4); - pCSIMatrix = pMIMOCtrlField + 6 + Nr; //24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(Nc=2) - CSIMatrixLen = pPduOS->Length - 26 -6 -Nr; - } else - return RT_STATUS_SUCCESS; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] idx=%d, pkt type=%d, Nc=%d, Nr=%d, CH_W=%d\n", __func__, Idx, pktType, Nc, Nr, CH_W)); - - return RT_STATUS_SUCCESS; -} - - -VOID -ConstructHTNDPAPacket( - PADAPTER Adapter, - pu1Byte RA, - pu1Byte Buffer, - pu4Byte pLength, - CHANNEL_WIDTH BW - ) -{ - u2Byte Duration= 0; - PMGNT_INFO pMgntInfo = &(Adapter->MgntInfo); - OCTET_STRING pNDPAFrame,ActionContent; - u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; - - PlatformZeroMemory(Buffer, 32); - - SET_80211_HDR_FRAME_CONTROL(Buffer,0); - - SET_80211_HDR_ORDER(Buffer, 1); - SET_80211_HDR_TYPE_AND_SUBTYPE(Buffer,Type_Action_No_Ack); - - SET_80211_HDR_ADDRESS1(Buffer, RA); - SET_80211_HDR_ADDRESS2(Buffer, Adapter->CurrentAddress); - SET_80211_HDR_ADDRESS3(Buffer, pMgntInfo->Bssid); - - Duration = 2*aSifsTime + 40; - - if (BW == CHANNEL_WIDTH_40) - Duration+= 87; - else - Duration+= 180; - - SET_80211_HDR_DURATION(Buffer, Duration); - - //HT control field - SET_HT_CTRL_CSI_STEERING(Buffer+sMacHdrLng, 3); - SET_HT_CTRL_NDP_ANNOUNCEMENT(Buffer+sMacHdrLng, 1); - - FillOctetString(pNDPAFrame, Buffer, sMacHdrLng+sHTCLng); - - FillOctetString(ActionContent, ActionHdr, 4); - PacketAppendData(&pNDPAFrame, ActionContent); - - *pLength = 32; -} - - - - -BOOLEAN -SendFWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u4Byte BufLen; - pu1Byte BufAddr; - u1Byte DescLen = 0, Idx = 0, NDPTxRate; - PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pBeamformEntry == NULL) - return FALSE; - - NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { -#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) - DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; -#endif - BufAddr = pBuf->Buffer.VirtualAddress + DescLen; - - ConstructHTNDPAPacket( - Adapter, - RA, - BufAddr, - &BufLen, - BW - ); - - pTcb->PacketLength = BufLen + DescLen; - - pTcb->bTxEnableSwCalcDur = TRUE; - - pTcb->BWOfPacket = BW; - - if(ACTING_AS_IBSS(Adapter) || ACTING_AS_AP(Adapter)) - pTcb->G_ID = 63; - - pTcb->P_AID = pBeamformEntry->P_AID; - pTcb->DataRate = NDPTxRate; /*rate of NDP decide by Nr*/ - - Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; -} - - -BOOLEAN -SendSWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u1Byte Idx = 0, NDPTxRate = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { - ConstructHTNDPAPacket( - Adapter, - RA, - pBuf->Buffer.VirtualAddress, - &pTcb->PacketLength, - BW - ); - - pTcb->bTxEnableSwCalcDur = TRUE; - - pTcb->BWOfPacket = BW; - - MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; -} - - - -VOID -ConstructVHTNDPAPacket( - IN PDM_ODM_T pDM_Odm, - pu1Byte RA, - u2Byte AID, - pu1Byte Buffer, - pu4Byte pLength, - CHANNEL_WIDTH BW - ) -{ - u2Byte Duration= 0; - u1Byte Sequence = 0; - pu1Byte pNDPAFrame = Buffer; - RT_NDPA_STA_INFO STAInfo; - PADAPTER Adapter = pDM_Odm->Adapter; - u1Byte Idx = 0; - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - // Frame control. - SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); - SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); - - SET_80211_HDR_ADDRESS1(pNDPAFrame, RA); - SET_80211_HDR_ADDRESS2(pNDPAFrame, pBeamformEntry->MyMacAddr); - - Duration = 2*aSifsTime + 44; - - if (BW == CHANNEL_WIDTH_80) - Duration += 40; - else if(BW == CHANNEL_WIDTH_40) - Duration+= 87; - else - Duration+= 180; - - SET_80211_HDR_DURATION(pNDPAFrame, Duration); - - Sequence = *(pDM_Odm->pSoundingSeq) << 2; - ODM_MoveMemory(pDM_Odm, pNDPAFrame+16, &Sequence, 1); - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP) == FALSE) - AID = 0; - - STAInfo.AID = AID; - STAInfo.FeedbackType = 0; - STAInfo.NcIndex = 0; - - ODM_MoveMemory(pDM_Odm, pNDPAFrame+17, (pu1Byte)&STAInfo, 2); - - *pLength = 19; -} - - -BOOLEAN -SendFWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u4Byte BufLen; - pu1Byte BufAddr; - u1Byte DescLen = 0, Idx = 0, NDPTxRate = 0; - PADAPTER pDefAdapter = GetDefaultAdapter(Adapter); - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PRT_BEAMFORMEE_ENTRY pBeamformEntry =phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pBeamformEntry == NULL) - return FALSE; - - NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetFWBuffer(pDefAdapter, &pTcb, &pBuf)) { -#if(DEV_BUS_TYPE != RT_PCI_INTERFACE) - DescLen = Adapter->HWDescHeadLength - pHalData->USBALLDummyLength; -#endif - BufAddr = pBuf->Buffer.VirtualAddress + DescLen; - - ConstructVHTNDPAPacket( - pDM_Odm, - RA, - AID, - BufAddr, - &BufLen, - BW - ); - - pTcb->PacketLength = BufLen + DescLen; - - pTcb->bTxEnableSwCalcDur = TRUE; - - pTcb->BWOfPacket = BW; - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS) || phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_AP)) - pTcb->G_ID = 63; - - pTcb->P_AID = pBeamformEntry->P_AID; - pTcb->DataRate = NDPTxRate; /*decide by Nr*/ - - Adapter->HalFunc.CmdSendPacketHandler(Adapter, pTcb, pBuf, pTcb->PacketLength, DESC_PACKET_TYPE_NORMAL, FALSE); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] End, ret=%d\n", __func__, ret)); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; -} - - - -BOOLEAN -SendSWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u1Byte Idx = 0, NDPTxRate = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { - ConstructVHTNDPAPacket( - pDM_Odm, - RA, - AID, - pBuf->Buffer.VirtualAddress, - &pTcb->PacketLength, - BW - ); - - pTcb->bTxEnableSwCalcDur = TRUE; - pTcb->BWOfPacket = BW; - - /*rate of NDP decide by Nr*/ - MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; -} - -#ifdef SUPPORT_MU_BF -#if (SUPPORT_MU_BF == 1) -/* -// Description: On VHT GID management frame by an MU beamformee. -// -// 2015.05.20. Created by tynli. -*/ -RT_STATUS -Beamforming_GetVHTGIDMgntFrame( - IN PADAPTER Adapter, - IN PRT_RFD pRfd, - IN POCTET_STRING pPduOS - ) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &pHalData->DM_OutSrc; - RT_STATUS rtStatus = RT_STATUS_SUCCESS; - pu1Byte pBuffer = NULL; - pu1Byte pRaddr = NULL; - u1Byte MemStatus[8] = {0}, UserPos[16] = {0}; - u1Byte idx; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMER_ENTRY pBeamformEntry = &pBeamInfo->BeamformerEntry[pBeamInfo->mu_ap_index]; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] On VHT GID mgnt frame!\n", __func__)); - - /* Check length*/ - if (pPduOS->Length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY+16)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Invalid length (%d)\n", pPduOS->Length)); - return RT_STATUS_INVALID_LENGTH; - } - - /* Check RA*/ - pRaddr = (pu1Byte)(pPduOS->Octet)+4; - if (!eqMacAddr(pRaddr, Adapter->CurrentAddress)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Beamforming_GetVHTGIDMgntFrame(): Drop because of RA error.\n")); - return RT_STATUS_PKT_DROP; - } - - RT_DISP_DATA(FBEAM, FBEAM_DATA, "On VHT GID Mgnt Frame ==>:\n", pPduOS->Octet, pPduOS->Length); - - /*Parsing Membership Status Array*/ - pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; - for (idx = 0; idx < 8; idx++) { - MemStatus[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); - pBeamformEntry->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(pBuffer+idx); - } - - RT_DISP_DATA(FBEAM, FBEAM_DATA, "MemStatus: ", MemStatus, 8); - - /* Parsing User Position Array*/ - pBuffer = pPduOS->Octet + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; - for (idx = 0; idx < 16; idx++) { - UserPos[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); - pBeamformEntry->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(pBuffer+idx); - } - - RT_DISP_DATA(FBEAM, FBEAM_DATA, "UserPos: ", UserPos, 16); - - /* Group ID detail printed*/ - { - u1Byte i, j; - u1Byte tmpVal; - u2Byte tmpVal2; - - for (i = 0; i < 8; i++) { - tmpVal = MemStatus[i]; - tmpVal2 = ((UserPos[i*2 + 1] << 8) & 0xFF00) + (UserPos[i * 2] & 0xFF); - for (j = 0; j < 8; j++) { - if ((tmpVal >> j) & BIT0) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("Use Group ID (%d), User Position (%d)\n", - (i*8+j), (tmpVal2 >> 2 * j)&0x3)); - } - } - } - } - - /* Indicate GID frame to IHV service. */ - { - u1Byte Indibuffer[24] = {0}; - u1Byte Indioffset = 0; - - PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->gid_valid, 8); - Indioffset += 8; - PlatformMoveMemory(Indibuffer + Indioffset, pBeamformEntry->user_position, 16); - Indioffset += 16; - - PlatformIndicateCustomStatus( - Adapter, - RT_CUSTOM_EVENT_VHT_RECV_GID_MGNT_FRAME, - RT_CUSTOM_INDI_TARGET_IHV, - Indibuffer, - Indioffset); - } - - /* Config HW GID table */ - halComTxbf_ConfigGtab(pDM_Odm); - - return rtStatus; -} - -/* -// Description: Construct VHT Group ID (GID) management frame. -// -// 2015.05.20. Created by tynli. -*/ -VOID -ConstructVHTGIDMgntFrame( - IN PDM_ODM_T pDM_Odm, - IN pu1Byte RA, - IN PRT_BEAMFORMEE_ENTRY pBeamformEntry, - OUT pu1Byte Buffer, - OUT pu4Byte pLength - -) -{ - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PADAPTER Adapter = pBeamInfo->SourceAdapter; - OCTET_STRING osFTMFrame, tmp; - - FillOctetString(osFTMFrame, Buffer, 0); - *pLength = 0; - - ConstructMaFrameHdr( - Adapter, - RA, - ACT_CAT_VHT, - ACT_VHT_GROUPID_MANAGEMENT, - &osFTMFrame); - - /* Membership Status Array*/ - FillOctetString(tmp, pBeamformEntry->gid_valid, 8); - PacketAppendData(&osFTMFrame, tmp); - - /* User Position Array*/ - FillOctetString(tmp, pBeamformEntry->user_position, 16); - PacketAppendData(&osFTMFrame, tmp); - - *pLength = osFTMFrame.Length; - - RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTGIDMgntFrame():\n", Buffer, *pLength); -} - -BOOLEAN -SendSWVHTGIDMgntFrame( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u1Byte Idx - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u1Byte DataRate = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = &pBeamInfo->BeamformeeEntry[Idx]; - PADAPTER Adapter = pBeamInfo->SourceAdapter; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { - ConstructVHTGIDMgntFrame( - pDM_Odm, - RA, - pBeamformEntry, - pBuf->Buffer.VirtualAddress, - &pTcb->PacketLength - ); - - pTcb->BWOfPacket = CHANNEL_WIDTH_20; - DataRate = MGN_6M; - MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; -} - - -/* -// Description: Construct VHT beamforming report poll. -// -// 2015.05.20. Created by tynli. -*/ -VOID -ConstructVHTBFReportPoll( - IN PDM_ODM_T pDM_Odm, - IN pu1Byte RA, - OUT pu1Byte Buffer, - OUT pu4Byte pLength -) -{ - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PADAPTER Adapter = pBeamInfo->SourceAdapter; - pu1Byte pBFRptPoll = Buffer; - - /* Frame control*/ - SET_80211_HDR_FRAME_CONTROL(pBFRptPoll, 0); - SET_80211_HDR_TYPE_AND_SUBTYPE(pBFRptPoll, Type_Beamforming_Report_Poll); - - /* Duration*/ - SET_80211_HDR_DURATION(pBFRptPoll, 100); - - /* RA*/ - SET_VHT_BF_REPORT_POLL_RA(pBFRptPoll, RA); - - /* TA*/ - SET_VHT_BF_REPORT_POLL_TA(pBFRptPoll, Adapter->CurrentAddress); - - /* Feedback Segment Retransmission Bitmap*/ - SET_VHT_BF_REPORT_POLL_FEEDBACK_SEG_RETRAN_BITMAP(pBFRptPoll, 0xFF); - - *pLength = 17; - - RT_DISP_DATA(FBEAM, FBEAM_DATA, "ConstructVHTBFReportPoll():\n", Buffer, *pLength); - -} - -BOOLEAN -SendSWVHTBFReportPoll( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN BOOLEAN bFinalPoll - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u1Byte Idx = 0, DataRate = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - PADAPTER Adapter = pBeamInfo->SourceAdapter; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { - ConstructVHTBFReportPoll( - pDM_Odm, - RA, - pBuf->Buffer.VirtualAddress, - &pTcb->PacketLength - ); - - pTcb->bTxEnableSwCalcDur = TRUE; /* need?*/ - pTcb->BWOfPacket = CHANNEL_WIDTH_20; - - if (bFinalPoll) - pTcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; - else - pTcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL; - - DataRate = MGN_6M; /* Legacy OFDM rate*/ - MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, DataRate); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "SendSWVHTBFReportPoll():\n", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; - -} - - -/* -// Description: Construct VHT MU NDPA packet. -// We should combine this function with ConstructVHTNDPAPacket() in the future. -// -// 2015.05.21. Created by tynli. -*/ -VOID -ConstructVHTMUNDPAPacket( - IN PDM_ODM_T pDM_Odm, - IN CHANNEL_WIDTH BW, - OUT pu1Byte Buffer, - OUT pu4Byte pLength - ) -{ - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PADAPTER Adapter = pBeamInfo->SourceAdapter; - u2Byte Duration = 0; - u1Byte Sequence = 0; - pu1Byte pNDPAFrame = Buffer; - RT_NDPA_STA_INFO STAInfo; - u1Byte idx; - u1Byte DestAddr[6] = {0}; - PRT_BEAMFORMEE_ENTRY pEntry = NULL; - - /* Fill the first MU BFee entry (STA1) MAC addr to destination address then - HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ - for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { - pEntry = &(pBeamInfo->BeamformeeEntry[idx]); - if (pEntry->is_mu_sta) { - cpMacAddr(DestAddr, pEntry->MacAddr); - break; - } - } - if (pEntry == NULL) - return; - - /* Frame control.*/ - SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); - SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); - - SET_80211_HDR_ADDRESS1(pNDPAFrame, DestAddr); - SET_80211_HDR_ADDRESS2(pNDPAFrame, pEntry->MyMacAddr); - - /*--------------------------------------------*/ - /* Need to modify "Duration" to MU consideration. */ - Duration = 2*aSifsTime + 44; - - if (BW == CHANNEL_WIDTH_80) - Duration += 40; - else if(BW == CHANNEL_WIDTH_40) - Duration+= 87; - else - Duration+= 180; - /*--------------------------------------------*/ - - SET_80211_HDR_DURATION(pNDPAFrame, Duration); - - Sequence = *(pDM_Odm->pSoundingSeq) << 2; - ODM_MoveMemory(pDM_Odm, pNDPAFrame + 16, &Sequence, 1); - - *pLength = 17; - - /* Construct STA info. for multiple STAs*/ - for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { - pEntry = &(pBeamInfo->BeamformeeEntry[idx]); - if (pEntry->is_mu_sta) { - STAInfo.AID = pEntry->AID; - STAInfo.FeedbackType = 1; /* 1'b1: MU*/ - STAInfo.NcIndex = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BeamformeeEntry idx(%d), AID =%d\n", __func__, idx, pEntry->AID)); - - ODM_MoveMemory(pDM_Odm, pNDPAFrame+(*pLength), (pu1Byte)&STAInfo, 2); - *pLength += 2; - } - } - -} - -BOOLEAN -SendSWVHTMUNDPAPacket( - IN PVOID pDM_VOID, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u1Byte NDPTxRate = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PADAPTER Adapter = pBeamInfo->SourceAdapter; - - NDPTxRate = MGN_VHT2SS_MCS0; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { - ConstructVHTMUNDPAPacket( - pDM_Odm, - BW, - pBuf->Buffer.VirtualAddress, - &pTcb->PacketLength - ); - - pTcb->bTxEnableSwCalcDur = TRUE; - pTcb->BWOfPacket = BW; - pTcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA; - - /*rate of NDP decide by Nr*/ - MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; -} - - -VOID -DBG_ConstructVHTMUNDPAPacket( - IN PDM_ODM_T pDM_Odm, - IN CHANNEL_WIDTH BW, - OUT pu1Byte Buffer, - OUT pu4Byte pLength - ) -{ - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PADAPTER Adapter = pBeamInfo->SourceAdapter; - u2Byte Duration = 0; - u1Byte Sequence = 0; - pu1Byte pNDPAFrame = Buffer; - RT_NDPA_STA_INFO STAInfo; - u1Byte idx; - u1Byte DestAddr[6] = {0}; - PRT_BEAMFORMEE_ENTRY pEntry = NULL; - - BOOLEAN is_STA1 = FALSE; - - - /* Fill the first MU BFee entry (STA1) MAC addr to destination address then - HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ - for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { - pEntry = &(pBeamInfo->BeamformeeEntry[idx]); - if (pEntry->is_mu_sta) { - if (is_STA1 == FALSE) { - is_STA1 = TRUE; - continue; - } else { - cpMacAddr(DestAddr, pEntry->MacAddr); - break; - } - } - } - - /* Frame control.*/ - SET_80211_HDR_FRAME_CONTROL(pNDPAFrame, 0); - SET_80211_HDR_TYPE_AND_SUBTYPE(pNDPAFrame, Type_NDPA); - - SET_80211_HDR_ADDRESS1(pNDPAFrame, DestAddr); - SET_80211_HDR_ADDRESS2(pNDPAFrame, pDM_Odm->CurrentAddress); - - /*--------------------------------------------*/ - /* Need to modify "Duration" to MU consideration. */ - Duration = 2*aSifsTime + 44; - - if (BW == CHANNEL_WIDTH_80) - Duration += 40; - else if (BW == CHANNEL_WIDTH_40) - Duration += 87; - else - Duration += 180; - /*--------------------------------------------*/ - - SET_80211_HDR_DURATION(pNDPAFrame, Duration); - - Sequence = *(pDM_Odm->pSoundingSeq) << 2; - ODM_MoveMemory(pDM_Odm, pNDPAFrame + 16, &Sequence, 1); - - *pLength = 17; - - /*STA2's STA Info*/ - STAInfo.AID = pEntry->AID; - STAInfo.FeedbackType = 1; /* 1'b1: MU */ - STAInfo.NcIndex = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Get BeamformeeEntry idx(%d), AID =%d\n", __func__, idx, pEntry->AID)); - - ODM_MoveMemory(pDM_Odm, pNDPAFrame+(*pLength), (pu1Byte)&STAInfo, 2); - *pLength += 2; - -} - -BOOLEAN -DBG_SendSWVHTMUNDPAPacket( - IN PVOID pDM_VOID, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_TCB pTcb; - PRT_TX_LOCAL_BUFFER pBuf; - BOOLEAN ret = TRUE; - u1Byte NDPTxRate = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PADAPTER Adapter = pBeamInfo->SourceAdapter; - - NDPTxRate = MGN_VHT2SS_MCS0; - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - - PlatformAcquireSpinLock(Adapter, RT_TX_SPINLOCK); - - if (MgntGetBuffer(Adapter, &pTcb, &pBuf)) { - DBG_ConstructVHTMUNDPAPacket( - pDM_Odm, - BW, - pBuf->Buffer.VirtualAddress, - &pTcb->PacketLength - ); - - pTcb->bTxEnableSwCalcDur = TRUE; - pTcb->BWOfPacket = BW; - pTcb->TxBFPktType = RT_BF_PKT_TYPE_UNICAST_NDPA; - - /*rate of NDP decide by Nr*/ - MgntSendPacket(Adapter, pTcb, pBuf, pTcb->PacketLength, NORMAL_QUEUE, NDPTxRate); - } else - ret = FALSE; - - PlatformReleaseSpinLock(Adapter, RT_TX_SPINLOCK); - - if (ret) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "", pBuf->Buffer.VirtualAddress, pTcb->PacketLength); - - return ret; -} - - -#endif /*#if (SUPPORT_MU_BF == 1)*/ -#endif /*#ifdef SUPPORT_MU_BF*/ - - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - -u4Byte -Beamforming_GetReportFrame( - IN PVOID pDM_VOID, - union recv_frame *precv_frame - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u4Byte ret = _SUCCESS; - PRT_BEAMFORMEE_ENTRY pBeamformEntry = NULL; - pu1Byte pframe = precv_frame->u.hdr.rx_data; - u4Byte frame_len = precv_frame->u.hdr.len; - pu1Byte TA; - u1Byte Idx, offset; - - - /*Memory comparison to see if CSI report is the same with previous one*/ - TA = GetAddr2Ptr(pframe); - pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, TA, &Idx); - if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) - offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ - else if(pBeamformEntry->BeamformEntryCap & BEAMFORMER_CAP_HT_EXPLICIT) - offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(Nc=2)*/ - else - return ret; - - - return ret; -} - - -BOOLEAN -SendFWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - struct xmit_frame *pmgntframe; - struct pkt_attrib *pattrib; - struct rtw_ieee80211_hdr *pwlanhdr; - struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); - struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; - u1Byte *pframe; - u2Byte *fctrl; - u2Byte duration = 0; - u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - - if (pmgntframe == NULL) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; - } - - //update attribute - pattrib = &pmgntframe->attrib; - update_mgntframe_attrib(Adapter, pattrib); - - pattrib->qsel = QSLT_BEACON; - NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - pattrib->rate = NDPTxRate; - pattrib->bwmode = BW; - pattrib->order = 1; - pattrib->subtype = WIFI_ACTION_NOACK; - - _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); - - pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - - pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; - - fctrl = &pwlanhdr->frame_ctl; - *(fctrl) = 0; - - SetOrderBit(pframe); - SetFrameSubType(pframe, WIFI_ACTION_NOACK); - - _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); - - if( pmlmeext->cur_wireless_mode == WIRELESS_11B) - aSifsTime = 10; - else - aSifsTime = 16; - - duration = 2*aSifsTime + 40; - - if(BW == CHANNEL_WIDTH_40) - duration+= 87; - else - duration+= 180; - - SetDuration(pframe, duration); - - //HT control field - SET_HT_CTRL_CSI_STEERING(pframe+24, 3); - SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); - - _rtw_memcpy(pframe+28, ActionHdr, 4); - - pattrib->pktlen = 32; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(Adapter, pmgntframe); - - return _TRUE; -} - - -BOOLEAN -SendSWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - struct xmit_frame *pmgntframe; - struct pkt_attrib *pattrib; - struct rtw_ieee80211_hdr *pwlanhdr; - struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); - struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - u1Byte ActionHdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; - pu1Byte pframe; - pu2Byte fctrl; - u2Byte duration = 0; - u1Byte aSifsTime = 0, NDPTxRate = 0, Idx = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - NDPTxRate = Beamforming_GetHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - - if (pmgntframe == NULL) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; - } - - /*update attribute*/ - pattrib = &pmgntframe->attrib; - update_mgntframe_attrib(Adapter, pattrib); - pattrib->qsel = QSLT_MGNT; - pattrib->rate = NDPTxRate; - pattrib->bwmode = BW; - pattrib->order = 1; - pattrib->subtype = WIFI_ACTION_NOACK; - - _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); - - pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - fctrl = &pwlanhdr->frame_ctl; - *(fctrl) = 0; - - SetOrderBit(pframe); - SetFrameSubType(pframe, WIFI_ACTION_NOACK); - - _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); - - if (pmlmeext->cur_wireless_mode == WIRELESS_11B) - aSifsTime = 10; - else - aSifsTime = 16; - - duration = 2*aSifsTime + 40; - - if (BW == CHANNEL_WIDTH_40) - duration += 87; - else - duration += 180; - - SetDuration(pframe, duration); - - /*HT control field*/ - SET_HT_CTRL_CSI_STEERING(pframe+24, 3); - SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe+24, 1); - - _rtw_memcpy(pframe+28, ActionHdr, 4); - - pattrib->pktlen = 32; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(Adapter, pmgntframe); - - return _TRUE; -} - - -BOOLEAN -SendFWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - struct xmit_frame *pmgntframe; - struct pkt_attrib *pattrib; - struct rtw_ieee80211_hdr *pwlanhdr; - struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); - struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); - pu1Byte pframe; - pu2Byte fctrl; - u2Byte duration = 0; - u1Byte sequence = 0, aSifsTime = 0, NDPTxRate= 0, Idx = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - RT_NDPA_STA_INFO sta_info; - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - - if (pmgntframe == NULL) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; - } - - //update attribute - pattrib = &pmgntframe->attrib; - _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); - update_mgntframe_attrib(Adapter, pattrib); - - pattrib->qsel = QSLT_BEACON; - NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - pattrib->rate = NDPTxRate; - pattrib->bwmode = BW; - pattrib->subtype = WIFI_NDPA; - - _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); - - pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - - pwlanhdr = (struct rtw_ieee80211_hdr*)pframe; - - fctrl = &pwlanhdr->frame_ctl; - *(fctrl) = 0; - - SetFrameSubType(pframe, WIFI_NDPA); - - _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); - - if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) - aSifsTime = 16; - else - aSifsTime = 10; - - duration = 2*aSifsTime + 44; - - if(BW == CHANNEL_WIDTH_80) - duration += 40; - else if(BW == CHANNEL_WIDTH_40) - duration+= 87; - else - duration+= 180; - - SetDuration(pframe, duration); - - sequence = pBeamInfo->SoundingSequence<< 2; - if (pBeamInfo->SoundingSequence >= 0x3f) - pBeamInfo->SoundingSequence = 0; - else - pBeamInfo->SoundingSequence++; - - _rtw_memcpy(pframe+16, &sequence,1); - - if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) - AID = 0; - - sta_info.AID = AID; - sta_info.FeedbackType = 0; - sta_info.NcIndex= 0; - - _rtw_memcpy(pframe+17, (u8 *)&sta_info, 2); - - pattrib->pktlen = 19; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(Adapter, pmgntframe); - - return _TRUE; -} - - - -BOOLEAN -SendSWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - struct xmit_frame *pmgntframe; - struct pkt_attrib *pattrib; - struct rtw_ieee80211_hdr *pwlanhdr; - struct xmit_priv *pxmitpriv = &(Adapter->xmitpriv); - struct mlme_ext_priv *pmlmeext = &Adapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); - RT_NDPA_STA_INFO ndpa_sta_info; - u1Byte NDPTxRate = 0, sequence = 0, aSifsTime = 0, Idx = 0; - pu1Byte pframe; - pu2Byte fctrl; - u2Byte duration = 0; - PRT_BEAMFORMING_INFO pBeamInfo = &(pDM_Odm->BeamformingInfo); - PRT_BEAMFORMEE_ENTRY pBeamformEntry = phydm_Beamforming_GetBFeeEntryByAddr(pDM_Odm, RA, &Idx); - - NDPTxRate = Beamforming_GetVHTNDPTxRate(pDM_Odm, pBeamformEntry->CompSteeringNumofBFer); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] NDPTxRate =%d\n", __func__, NDPTxRate)); - - pmgntframe = alloc_mgtxmitframe(pxmitpriv); - - if (pmgntframe == NULL) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s, alloc mgnt frame fail\n", __func__)); - return _FALSE; - } - - /*update attribute*/ - pattrib = &pmgntframe->attrib; - _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); - update_mgntframe_attrib(Adapter, pattrib); - pattrib->qsel = QSLT_MGNT; - pattrib->rate = NDPTxRate; - pattrib->bwmode = BW; - pattrib->subtype = WIFI_NDPA; - - _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); - - pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; - - pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; - - fctrl = &pwlanhdr->frame_ctl; - *(fctrl) = 0; - - SetFrameSubType(pframe, WIFI_NDPA); - - _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); - _rtw_memcpy(pwlanhdr->addr2, pBeamformEntry->MyMacAddr, ETH_ALEN); - - if (IsSupported5G(pmlmeext->cur_wireless_mode) || IsSupportedHT(pmlmeext->cur_wireless_mode)) - aSifsTime = 16; - else - aSifsTime = 10; - - duration = 2*aSifsTime + 44; - - if (BW == CHANNEL_WIDTH_80) - duration += 40; - else if (BW == CHANNEL_WIDTH_40) - duration += 87; - else - duration += 180; - - SetDuration(pframe, duration); - - sequence = pBeamInfo->SoundingSequence << 2; - if (pBeamInfo->SoundingSequence >= 0x3f) - pBeamInfo->SoundingSequence = 0; - else - pBeamInfo->SoundingSequence++; - - _rtw_memcpy(pframe+16, &sequence, 1); - if (((pmlmeinfo->state&0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state&0x03) == WIFI_FW_AP_STATE)) - AID = 0; - - ndpa_sta_info.AID = AID; - ndpa_sta_info.FeedbackType = 0; - ndpa_sta_info.NcIndex = 0; - - _rtw_memcpy(pframe+17, (u8 *)&ndpa_sta_info, 2); - - pattrib->pktlen = 19; - - pattrib->last_txcmdsz = pattrib->pktlen; - - dump_mgntframe(Adapter, pmgntframe); - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] [%d]\n", __func__, __LINE__)); - - return _TRUE; -} - - -#endif - - -VOID -Beamforming_GetNDPAFrame( - IN PVOID pDM_VOID, -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN OCTET_STRING pduOS -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - union recv_frame *precv_frame -#endif -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PADAPTER Adapter = pDM_Odm->Adapter; - pu1Byte TA ; - u1Byte Idx, Sequence; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - pu1Byte pNDPAFrame = pduOS.Octet; -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - pu1Byte pNDPAFrame = precv_frame->u.hdr.rx_data; -#endif - PRT_BEAMFORMER_ENTRY pBeamformerEntry = NULL; /*Modified By Jeffery @2014-10-29*/ - - -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_DISP_DATA(FBEAM, FBEAM_DATA, "Beamforming_GetNDPAFrame\n", pduOS.Octet, pduOS.Length); - if (IsCtrlNDPA(pNDPAFrame) == FALSE) -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - if (GetFrameSubType(pNDPAFrame) != WIFI_NDPA) -#endif - return; - else if (!(pDM_Odm->SupportICType & (ODM_RTL8812 | ODM_RTL8821))) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] not 8812 or 8821A, return\n", __func__)); - return; - } -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - TA = Frame_Addr2(pduOS); -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - TA = GetAddr2Ptr(pNDPAFrame); -#endif - /*Remove signaling TA. */ - TA[0] = TA[0] & 0xFE; - - pBeamformerEntry = phydm_Beamforming_GetBFerEntryByAddr(pDM_Odm, TA, &Idx); // Modified By Jeffery @2014-10-29 - - /*Break options for Clock Reset*/ - if (pBeamformerEntry == NULL) - return; - else if (!(pBeamformerEntry->BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU)) - return; - /*LogSuccess: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ - /*ClockResetTimes: While BFer entry always doesn't receive our CSI, clock will reset again and again.So ClockResetTimes is limited to 5 times.2015-04-13, Jeffery*/ - else if ((pBeamformerEntry->LogSuccess == 1) || (pBeamformerEntry->ClockResetTimes == 5)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, LogSuccess=%d, ClockResetTimes=%d, clock reset is no longer needed.\n", - __func__, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->LogSuccess, pBeamformerEntry->ClockResetTimes)); - - return; - } - - Sequence = (pNDPAFrame[16]) >> 2; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start, Sequence=%d, LogSeq=%d, PreLogSeq=%d, LogRetryCnt=%d, ClockResetTimes=%d, LogSuccess=%d\n", - __func__, Sequence, pBeamformerEntry->LogSeq, pBeamformerEntry->PreLogSeq, pBeamformerEntry->LogRetryCnt, pBeamformerEntry->ClockResetTimes, pBeamformerEntry->LogSuccess)); - - if ((pBeamformerEntry->LogSeq != 0) && (pBeamformerEntry->PreLogSeq != 0)) { - /*Success condition*/ - if ((pBeamformerEntry->LogSeq != Sequence) && (pBeamformerEntry->PreLogSeq != pBeamformerEntry->LogSeq)) { - /* break option for clcok reset, 2015-03-30, Jeffery */ - pBeamformerEntry->LogRetryCnt = 0; - /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ - /*That is, LogSuccess is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ - pBeamformerEntry->LogSuccess = 1; - - } else {/*Fail condition*/ - - if (pBeamformerEntry->LogRetryCnt == 5) { - pBeamformerEntry->ClockResetTimes++; - pBeamformerEntry->LogRetryCnt = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Clock Reset!!! ClockResetTimes=%d\n", - __func__, pBeamformerEntry->ClockResetTimes)); - HalComTxbf_Set(pDM_Odm, TXBF_SET_SOUNDING_CLK, NULL); - - } else - pBeamformerEntry->LogRetryCnt++; - } - } - - /*Update LogSeq & PreLogSeq*/ - pBeamformerEntry->PreLogSeq = pBeamformerEntry->LogSeq; - pBeamformerEntry->LogSeq = Sequence; - -} - - - -#endif +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * Description: + * + * This file is for TXBF interface mechanism + * + * ************************************************************ */ +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) +void +beamforming_gid_paid( + struct _ADAPTER *adapter, + PRT_TCB p_tcb +) +{ + u8 RA[6] = {0}; + u8 *p_header = GET_FRAME_OF_FIRST_FRAG(adapter, p_tcb); + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + + if (adapter->HardwareType < HARDWARE_TYPE_RTL8192EE) + return; + else if (IS_WIRELESS_MODE_N(adapter) == false) + return; + +#if (SUPPORT_MU_BF == 1) + if (p_tcb->tx_bf_pkt_type == RT_BF_PKT_TYPE_BROADCAST_NDPA) { /* MU NDPA */ +#else + if (0) { +#endif + /* Fill G_ID and P_AID */ + p_tcb->G_ID = 63; + if (p_beam_info->first_mu_bfee_index < BEAMFORMEE_ENTRY_NUM) { + p_tcb->P_AID = p_beam_info->beamformee_entry[p_beam_info->first_mu_bfee_index].p_aid; + RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, p_tcb->G_ID, p_tcb->P_AID)); + } + } else { + GET_80211_HDR_ADDRESS1(p_header, &RA); + + /* VHT SU PPDU carrying one or more group addressed MPDUs or */ + /* Transmitting a VHT NDP intended for multiple recipients */ + if (MacAddr_isBcst(RA) || MacAddr_isMulticast(RA) || p_tcb->macId == MAC_ID_STATIC_FOR_BROADCAST_MULTICAST) { + p_tcb->G_ID = 63; + p_tcb->P_AID = 0; + } else if (ACTING_AS_AP(adapter)) { + u16 AID = (u16)(MacIdGetOwnerAssociatedClientAID(adapter, p_tcb->macId) & 0x1ff); /*AID[0:8]*/ + + /*RT_DISP(FBEAM, FBEAM_FUN, ("@%s p_tcb->mac_id=0x%X, AID=0x%X\n", __func__, p_tcb->mac_id, AID));*/ + p_tcb->G_ID = 63; + + if (AID == 0) /*A PPDU sent by an AP to a non associated STA*/ + p_tcb->P_AID = 0; + else { /*Sent by an AP and addressed to a STA associated with that AP*/ + u16 BSSID = 0; + GET_80211_HDR_ADDRESS2(p_header, &RA); + BSSID = ((RA[5] & 0xf0) >> 4) ^ (RA[5] & 0xf); /*BSSID[44:47] xor BSSID[40:43]*/ + p_tcb->P_AID = (AID + BSSID * 32) & 0x1ff; /*(dec(A) + dec(B)*32) mod 512*/ + } + } else if (ACTING_AS_IBSS(adapter)) { + p_tcb->G_ID = 63; + /*P_AID for infrasturcture mode; MACID for ad-hoc mode. */ + p_tcb->P_AID = p_tcb->macId; + } else if (MgntLinkStatusQuery(adapter)) { /*Addressed to AP*/ + p_tcb->G_ID = 0; + GET_80211_HDR_ADDRESS1(p_header, &RA); + p_tcb->P_AID = RA[5]; /*RA[39:47]*/ + p_tcb->P_AID = (p_tcb->P_AID << 1) | (RA[4] >> 7); + } else { + p_tcb->G_ID = 63; + p_tcb->P_AID = 0; + } + /*RT_DISP(FBEAM, FBEAM_FUN, ("[David]@%s End, G_ID=0x%X, P_AID=0x%X\n", __func__, p_tcb->G_ID, p_tcb->P_AID));*/ + } +} + + +enum rt_status +beamforming_get_report_frame( + struct _ADAPTER *adapter, + PRT_RFD p_rfd, + POCTET_STRING p_pdu_os +) +{ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL; + u8 *p_mimo_ctrl_field, p_csi_matrix; + u8 idx, nc, nr, CH_W; + u16 csi_matrix_len = 0; + + ACT_PKT_TYPE pkt_type = ACT_PKT_TYPE_UNKNOWN; + + /* Memory comparison to see if CSI report is the same with previous one */ + p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, Frame_Addr2(*p_pdu_os), &idx); + + if (p_beamform_entry == NULL) { + PHYDM_DBG(p_dm, DBG_TXBF, ("beamforming_get_report_frame: Cannot find entry by addr\n")); + return RT_STATUS_FAILURE; + } + + pkt_type = PacketGetActionFrameType(p_pdu_os); + + /* -@ Modified by David */ + if (pkt_type == ACT_PKT_VHT_COMPRESSED_BEAMFORMING) { + p_mimo_ctrl_field = p_pdu_os->Octet + 26; + nc = ((*p_mimo_ctrl_field) & 0x7) + 1; + nr = (((*p_mimo_ctrl_field) & 0x38) >> 3) + 1; + CH_W = (((*p_mimo_ctrl_field) & 0xC0) >> 6); + /*p_csi_matrix = p_mimo_ctrl_field + 3 + nc;*/ /* 24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(nc=2) */ + csi_matrix_len = p_pdu_os->Length - 26 - 3 - nc; + } else if (pkt_type == ACT_PKT_HT_COMPRESSED_BEAMFORMING) { + p_mimo_ctrl_field = p_pdu_os->Octet + 26; + nc = ((*p_mimo_ctrl_field) & 0x3) + 1; + nr = (((*p_mimo_ctrl_field) & 0xC) >> 2) + 1; + CH_W = (((*p_mimo_ctrl_field) & 0x10) >> 4); + /*p_csi_matrix = p_mimo_ctrl_field + 6 + nr;*/ /* 24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField) +SNR(nc=2) */ + csi_matrix_len = p_pdu_os->Length - 26 - 6 - nr; + } else + return RT_STATUS_SUCCESS; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] idx=%d, pkt type=%d, nc=%d, nr=%d, CH_W=%d\n", __func__, idx, pkt_type, nc, nr, CH_W)); + + return RT_STATUS_SUCCESS; +} + + +void +construct_ht_ndpa_packet( + struct _ADAPTER *adapter, + u8 *RA, + u8 *buffer, + u32 *p_length, + enum channel_width BW +) +{ + u16 duration = 0; + PMGNT_INFO p_mgnt_info = &(adapter->MgntInfo); + OCTET_STRING p_ndpa_frame, action_content; + u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; + + PlatformZeroMemory(buffer, 32); + + SET_80211_HDR_FRAME_CONTROL(buffer, 0); + + SET_80211_HDR_ORDER(buffer, 1); + SET_80211_HDR_TYPE_AND_SUBTYPE(buffer, Type_Action_No_Ack); + + SET_80211_HDR_ADDRESS1(buffer, RA); + SET_80211_HDR_ADDRESS2(buffer, adapter->CurrentAddress); + SET_80211_HDR_ADDRESS3(buffer, p_mgnt_info->Bssid); + + duration = 2 * a_SifsTime + 40; + + if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + + SET_80211_HDR_DURATION(buffer, duration); + + /* HT control field */ + SET_HT_CTRL_CSI_STEERING(buffer + sMacHdrLng, 3); + SET_HT_CTRL_NDP_ANNOUNCEMENT(buffer + sMacHdrLng, 1); + + FillOctetString(p_ndpa_frame, buffer, sMacHdrLng + sHTCLng); + + FillOctetString(action_content, action_hdr, 4); + PacketAppendData(&p_ndpa_frame, action_content); + + *p_length = 32; +} + + + + +boolean +send_fw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u32 buf_len; + u8 *buf_addr; + u8 desc_len = 0, idx = 0, ndp_tx_rate; + struct _ADAPTER *p_def_adapter = GetDefaultAdapter(adapter); + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_beamform_entry == NULL) + return false; + + ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetFWBuffer(p_def_adapter, &p_tcb, &p_buf)) { +#if (DEV_BUS_TYPE != RT_PCI_INTERFACE) + desc_len = adapter->HWDescHeadLength - p_hal_data->USBALLDummyLength; +#endif + buf_addr = p_buf->Buffer.VirtualAddress + desc_len; + + construct_ht_ndpa_packet( + adapter, + RA, + buf_addr, + &buf_len, + BW + ); + + p_tcb->PacketLength = buf_len + desc_len; + + p_tcb->bTxEnableSwCalcDur = true; + + p_tcb->BWOfPacket = BW; + + if (ACTING_AS_IBSS(adapter) || ACTING_AS_AP(adapter)) + p_tcb->G_ID = 63; + + p_tcb->P_AID = p_beamform_entry->p_aid; + p_tcb->DataRate = ndp_tx_rate; /*rate of NDP decide by nr*/ + + adapter->HalFunc.CmdSendPacketHandler(adapter, p_tcb, p_buf, p_tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; +} + + +boolean +send_sw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 idx = 0, ndp_tx_rate = 0; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + construct_ht_ndpa_packet( + adapter, + RA, + p_buf->Buffer.VirtualAddress, + &p_tcb->PacketLength, + BW + ); + + p_tcb->bTxEnableSwCalcDur = true; + + p_tcb->BWOfPacket = BW; + + MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; +} + + + +void +construct_vht_ndpa_packet( + struct PHY_DM_STRUCT *p_dm, + u8 *RA, + u16 AID, + u8 *buffer, + u32 *p_length, + enum channel_width BW +) +{ + u16 duration = 0; + u8 sequence = 0; + u8 *p_ndpa_frame = buffer; + struct _RT_NDPA_STA_INFO sta_info; + struct _ADAPTER *adapter = p_dm->adapter; + u8 idx = 0; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + /* Frame control. */ + SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0); + SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA); + + SET_80211_HDR_ADDRESS1(p_ndpa_frame, RA); + SET_80211_HDR_ADDRESS2(p_ndpa_frame, p_beamform_entry->my_mac_addr); + + duration = 2 * a_SifsTime + 44; + + if (BW == CHANNEL_WIDTH_80) + duration += 40; + else if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + + SET_80211_HDR_DURATION(p_ndpa_frame, duration); + + sequence = *(p_dm->p_sounding_seq) << 2; + odm_move_memory(p_dm, p_ndpa_frame + 16, &sequence, 1); + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss) || phydm_acting_determine(p_dm, phydm_acting_as_ap) == false) + AID = 0; + + sta_info.aid = AID; + sta_info.feedback_type = 0; + sta_info.nc_index = 0; + + odm_move_memory(p_dm, p_ndpa_frame + 17, (u8 *)&sta_info, 2); + + *p_length = 19; +} + + +boolean +send_fw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u32 buf_len; + u8 *buf_addr; + u8 desc_len = 0, idx = 0, ndp_tx_rate = 0; + struct _ADAPTER *p_def_adapter = GetDefaultAdapter(adapter); + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_beamform_entry == NULL) + return false; + + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetFWBuffer(p_def_adapter, &p_tcb, &p_buf)) { +#if (DEV_BUS_TYPE != RT_PCI_INTERFACE) + desc_len = adapter->HWDescHeadLength - p_hal_data->USBALLDummyLength; +#endif + buf_addr = p_buf->Buffer.VirtualAddress + desc_len; + + construct_vht_ndpa_packet( + p_dm, + RA, + AID, + buf_addr, + &buf_len, + BW + ); + + p_tcb->PacketLength = buf_len + desc_len; + + p_tcb->bTxEnableSwCalcDur = true; + + p_tcb->BWOfPacket = BW; + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss) || phydm_acting_determine(p_dm, phydm_acting_as_ap)) + p_tcb->G_ID = 63; + + p_tcb->P_AID = p_beamform_entry->p_aid; + p_tcb->DataRate = ndp_tx_rate; /*decide by nr*/ + + adapter->HalFunc.CmdSendPacketHandler(adapter, p_tcb, p_buf, p_tcb->PacketLength, DESC_PACKET_TYPE_NORMAL, false); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] End, ret=%d\n", __func__, ret)); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; +} + + + +boolean +send_sw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 idx = 0, ndp_tx_rate = 0; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + construct_vht_ndpa_packet( + p_dm, + RA, + AID, + p_buf->Buffer.VirtualAddress, + &p_tcb->PacketLength, + BW + ); + + p_tcb->bTxEnableSwCalcDur = true; + p_tcb->BWOfPacket = BW; + + /*rate of NDP decide by nr*/ + MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; +} + +#ifdef SUPPORT_MU_BF +#if (SUPPORT_MU_BF == 1) +/* + * Description: On VHT GID management frame by an MU beamformee. + * + * 2015.05.20. Created by tynli. + */ +enum rt_status +beamforming_get_vht_gid_mgnt_frame( + struct _ADAPTER *adapter, + PRT_RFD p_rfd, + POCTET_STRING p_pdu_os +) +{ + HAL_DATA_TYPE *p_hal_data = GET_HAL_DATA(adapter); + struct PHY_DM_STRUCT *p_dm = &p_hal_data->DM_OutSrc; + enum rt_status rt_status = RT_STATUS_SUCCESS; + u8 *p_buffer = NULL; + u8 *p_raddr = NULL; + u8 mem_status[8] = {0}, user_pos[16] = {0}; + u8 idx; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMER_ENTRY *p_beamform_entry = &p_beam_info->beamformer_entry[p_beam_info->mu_ap_index]; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] On VHT GID mgnt frame!\n", __func__)); + + /* Check length*/ + if (p_pdu_os->length < (FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY + 16)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("beamforming_get_vht_gid_mgnt_frame(): Invalid length (%d)\n", p_pdu_os->length)); + return RT_STATUS_INVALID_LENGTH; + } + + /* Check RA*/ + p_raddr = (u8 *)(p_pdu_os->Octet) + 4; + if (!eq_mac_addr(p_raddr, adapter->CurrentAddress)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("beamforming_get_vht_gid_mgnt_frame(): Drop because of RA error.\n")); + return RT_STATUS_PKT_DROP; + } + + RT_DISP_DATA(FBEAM, FBEAM_DATA, "On VHT GID Mgnt Frame ==>:\n", p_pdu_os->Octet, p_pdu_os->length); + + /*Parsing Membership status array*/ + p_buffer = p_pdu_os->Octet + FRAME_OFFSET_VHT_GID_MGNT_MEMBERSHIP_STATUS_ARRAY; + for (idx = 0; idx < 8; idx++) { + mem_status[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(p_buffer + idx); + p_beamform_entry->gid_valid[idx] = GET_VHT_GID_MGNT_INFO_MEMBERSHIP_STATUS(p_buffer + idx); + } + + RT_DISP_DATA(FBEAM, FBEAM_DATA, "mem_status: ", mem_status, 8); + + /* Parsing User Position array*/ + p_buffer = p_pdu_os->Octet + FRAME_OFFSET_VHT_GID_MGNT_USER_POSITION_ARRAY; + for (idx = 0; idx < 16; idx++) { + user_pos[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(p_buffer + idx); + p_beamform_entry->user_position[idx] = GET_VHT_GID_MGNT_INFO_USER_POSITION(p_buffer + idx); + } + + RT_DISP_DATA(FBEAM, FBEAM_DATA, "user_pos: ", user_pos, 16); + + /* Group ID detail printed*/ + { + u8 i, j; + u8 tmp_val; + u16 tmp_val2; + + for (i = 0; i < 8; i++) { + tmp_val = mem_status[i]; + tmp_val2 = ((user_pos[i * 2 + 1] << 8) & 0xFF00) + (user_pos[i * 2] & 0xFF); + for (j = 0; j < 8; j++) { + if ((tmp_val >> j) & BIT(0)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("Use Group ID (%d), User Position (%d)\n", + (i * 8 + j), (tmp_val2 >> 2 * j) & 0x3)); + } + } + } + } + + /* Indicate GID frame to IHV service. */ + { + u8 indibuffer[24] = {0}; + u8 indioffset = 0; + + PlatformMoveMemory(indibuffer + indioffset, p_beamform_entry->gid_valid, 8); + indioffset += 8; + PlatformMoveMemory(indibuffer + indioffset, p_beamform_entry->user_position, 16); + indioffset += 16; + + PlatformIndicateCustomStatus( + adapter, + RT_CUSTOM_EVENT_VHT_RECV_GID_MGNT_FRAME, + RT_CUSTOM_INDI_TARGET_IHV, + indibuffer, + indioffset); + } + + /* Config HW GID table */ + hal_com_txbf_config_gtab(p_dm); + + return rt_status; +} + +/* + * Description: Construct VHT Group ID (GID) management frame. + * + * 2015.05.20. Created by tynli. + */ +void +construct_vht_gid_mgnt_frame( + struct PHY_DM_STRUCT *p_dm, + u8 *RA, + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry, + u8 *buffer, + u32 *p_length + +) +{ + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _ADAPTER *adapter = p_beam_info->source_adapter; + OCTET_STRING os_ftm_frame, tmp; + + FillOctetString(os_ftm_frame, buffer, 0); + *p_length = 0; + + ConstructMaFrameHdr( + adapter, + RA, + ACT_CAT_VHT, + ACT_VHT_GROUPID_MANAGEMENT, + &os_ftm_frame); + + /* Membership status array*/ + FillOctetString(tmp, p_beamform_entry->gid_valid, 8); + PacketAppendData(&os_ftm_frame, tmp); + + /* User Position array*/ + FillOctetString(tmp, p_beamform_entry->user_position, 16); + PacketAppendData(&os_ftm_frame, tmp); + + *p_length = os_ftm_frame.length; + + RT_DISP_DATA(FBEAM, FBEAM_DATA, "construct_vht_gid_mgnt_frame():\n", buffer, *p_length); +} + +boolean +send_sw_vht_gid_mgnt_frame( + void *p_dm_void, + u8 *RA, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 data_rate = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = &p_beam_info->beamformee_entry[idx]; + struct _ADAPTER *adapter = p_beam_info->source_adapter; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + construct_vht_gid_mgnt_frame( + p_dm, + RA, + p_beamform_entry, + p_buf->Buffer.VirtualAddress, + &p_tcb->PacketLength + ); + + p_tcb->bw_of_packet = CHANNEL_WIDTH_20; + data_rate = MGN_6M; + MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, data_rate); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; +} + + +/* + * Description: Construct VHT beamforming report poll. + * + * 2015.05.20. Created by tynli. + */ +void +construct_vht_bf_report_poll( + struct PHY_DM_STRUCT *p_dm, + u8 *RA, + u8 *buffer, + u32 *p_length +) +{ + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _ADAPTER *adapter = p_beam_info->source_adapter; + u8 *p_bf_rpt_poll = buffer; + + /* Frame control*/ + SET_80211_HDR_FRAME_CONTROL(p_bf_rpt_poll, 0); + SET_80211_HDR_TYPE_AND_SUBTYPE(p_bf_rpt_poll, Type_Beamforming_Report_Poll); + + /* duration*/ + SET_80211_HDR_DURATION(p_bf_rpt_poll, 100); + + /* RA*/ + SET_VHT_BF_REPORT_POLL_RA(p_bf_rpt_poll, RA); + + /* TA*/ + SET_VHT_BF_REPORT_POLL_TA(p_bf_rpt_poll, adapter->CurrentAddress); + + /* Feedback Segment Retransmission Bitmap*/ + SET_VHT_BF_REPORT_POLL_FEEDBACK_SEG_RETRAN_BITMAP(p_bf_rpt_poll, 0xFF); + + *p_length = 17; + + RT_DISP_DATA(FBEAM, FBEAM_DATA, "construct_vht_bf_report_poll():\n", buffer, *p_length); + +} + +boolean +send_sw_vht_bf_report_poll( + void *p_dm_void, + u8 *RA, + boolean is_final_poll +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 idx = 0, data_rate = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + struct _ADAPTER *adapter = p_beam_info->source_adapter; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + construct_vht_bf_report_poll( + p_dm, + RA, + p_buf->Buffer.VirtualAddress, + &p_tcb->PacketLength + ); + + p_tcb->bTxEnableSwCalcDur = true; /* need?*/ + p_tcb->BWOfPacket = CHANNEL_WIDTH_20; + + if (is_final_poll) + p_tcb->TxBFPktType = RT_BF_PKT_TYPE_FINAL_BF_REPORT_POLL; + else + p_tcb->TxBFPktType = RT_BF_PKT_TYPE_BF_REPORT_POLL; + + data_rate = MGN_6M; /* Legacy OFDM rate*/ + MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, data_rate); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "send_sw_vht_bf_report_poll():\n", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; + +} + + +/* + * Description: Construct VHT MU NDPA packet. + * We should combine this function with construct_vht_ndpa_packet() in the future. + * + * 2015.05.21. Created by tynli. + */ +void +construct_vht_mu_ndpa_packet( + struct PHY_DM_STRUCT *p_dm, + enum channel_width BW, + u8 *buffer, + u32 *p_length +) +{ + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _ADAPTER *adapter = p_beam_info->source_adapter; + u16 duration = 0; + u8 sequence = 0; + u8 *p_ndpa_frame = buffer; + struct _RT_NDPA_STA_INFO sta_info; + u8 idx; + u8 dest_addr[6] = {0}; + struct _RT_BEAMFORMEE_ENTRY *p_entry = NULL; + + /* Fill the first MU BFee entry (STA1) MAC addr to destination address then + HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + p_entry = &(p_beam_info->beamformee_entry[idx]); + if (p_entry->is_mu_sta) { + cp_mac_addr(dest_addr, p_entry->mac_addr); + break; + } + } + if (p_entry == NULL) + return; + + /* Frame control.*/ + SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0); + SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA); + + SET_80211_HDR_ADDRESS1(p_ndpa_frame, dest_addr); + SET_80211_HDR_ADDRESS2(p_ndpa_frame, p_entry->my_mac_addr); + + /*--------------------------------------------*/ + /* Need to modify "duration" to MU consideration. */ + duration = 2 * a_SifsTime + 44; + + if (BW == CHANNEL_WIDTH_80) + duration += 40; + else if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + /*--------------------------------------------*/ + + SET_80211_HDR_DURATION(p_ndpa_frame, duration); + + sequence = *(p_dm->p_sounding_seq) << 2; + odm_move_memory(p_dm, p_ndpa_frame + 16, &sequence, 1); + + *p_length = 17; + + /* Construct STA info. for multiple STAs*/ + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + p_entry = &(p_beam_info->beamformee_entry[idx]); + if (p_entry->is_mu_sta) { + sta_info.aid = p_entry->AID; + sta_info.feedback_type = 1; /* 1'b1: MU*/ + sta_info.nc_index = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Get beamformee_entry idx(%d), AID =%d\n", __func__, idx, p_entry->AID)); + + odm_move_memory(p_dm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); + *p_length += 2; + } + } + +} + +boolean +send_sw_vht_mu_ndpa_packet( + void *p_dm_void, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 ndp_tx_rate = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _ADAPTER *adapter = p_beam_info->source_adapter; + + ndp_tx_rate = MGN_VHT2SS_MCS0; + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + construct_vht_mu_ndpa_packet( + p_dm, + BW, + p_buf->Buffer.VirtualAddress, + &p_tcb->PacketLength + ); + + p_tcb->bTxEnableSwCalcDur = true; + p_tcb->BWOfPacket = BW; + p_tcb->TxBFPktType = RT_BF_PKT_TYPE_BROADCAST_NDPA; + + /*rate of NDP decide by nr*/ + MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; +} + + +void +dbg_construct_vht_mundpa_packet( + struct PHY_DM_STRUCT *p_dm, + enum channel_width BW, + u8 *buffer, + u32 *p_length +) +{ + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _ADAPTER *adapter = p_beam_info->source_adapter; + u16 duration = 0; + u8 sequence = 0; + u8 *p_ndpa_frame = buffer; + struct _RT_NDPA_STA_INFO sta_info; + u8 idx; + u8 dest_addr[6] = {0}; + struct _RT_BEAMFORMEE_ENTRY *p_entry = NULL; + + boolean is_STA1 = false; + + + /* Fill the first MU BFee entry (STA1) MAC addr to destination address then + HW will change A1 to broadcast addr. 2015.05.28. Suggested by SD1 Chunchu. */ + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + p_entry = &(p_beam_info->beamformee_entry[idx]); + if (p_entry->is_mu_sta) { + if (is_STA1 == false) { + is_STA1 = true; + continue; + } else { + cp_mac_addr(dest_addr, p_entry->mac_addr); + break; + } + } + } + + /* Frame control.*/ + SET_80211_HDR_FRAME_CONTROL(p_ndpa_frame, 0); + SET_80211_HDR_TYPE_AND_SUBTYPE(p_ndpa_frame, Type_NDPA); + + SET_80211_HDR_ADDRESS1(p_ndpa_frame, dest_addr); + SET_80211_HDR_ADDRESS2(p_ndpa_frame, p_dm->CurrentAddress); + + /*--------------------------------------------*/ + /* Need to modify "duration" to MU consideration. */ + duration = 2 * a_SifsTime + 44; + + if (BW == CHANNEL_WIDTH_80) + duration += 40; + else if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + /*--------------------------------------------*/ + + SET_80211_HDR_DURATION(p_ndpa_frame, duration); + + sequence = *(p_dm->p_sounding_seq) << 2; + odm_move_memory(p_dm, p_ndpa_frame + 16, &sequence, 1); + + *p_length = 17; + + /*STA2's STA Info*/ + sta_info.aid = p_entry->aid; + sta_info.feedback_type = 1; /* 1'b1: MU */ + sta_info.nc_index = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Get beamformee_entry idx(%d), AID =%d\n", __func__, idx, p_entry->aid)); + + odm_move_memory(p_dm, p_ndpa_frame + (*p_length), (u8 *)&sta_info, 2); + *p_length += 2; + +} + +boolean +dbg_send_sw_vht_mundpa_packet( + void *p_dm_void, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + PRT_TCB p_tcb; + PRT_TX_LOCAL_BUFFER p_buf; + boolean ret = true; + u8 ndp_tx_rate = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _ADAPTER *adapter = p_beam_info->source_adapter; + + ndp_tx_rate = MGN_VHT2SS_MCS0; + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + + PlatformAcquireSpinLock(adapter, RT_TX_SPINLOCK); + + if (MgntGetBuffer(adapter, &p_tcb, &p_buf)) { + dbg_construct_vht_mundpa_packet( + p_dm, + BW, + p_buf->Buffer.VirtualAddress, + &p_tcb->PacketLength + ); + + p_tcb->bTxEnableSwCalcDur = true; + p_tcb->BWOfPacket = BW; + p_tcb->TxBFPktType = RT_BF_PKT_TYPE_UNICAST_NDPA; + + /*rate of NDP decide by nr*/ + MgntSendPacket(adapter, p_tcb, p_buf, p_tcb->PacketLength, NORMAL_QUEUE, ndp_tx_rate); + } else + ret = false; + + PlatformReleaseSpinLock(adapter, RT_TX_SPINLOCK); + + if (ret) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "", p_buf->Buffer.VirtualAddress, p_tcb->PacketLength); + + return ret; +} + + +#endif /*#if (SUPPORT_MU_BF == 1)*/ +#endif /*#ifdef SUPPORT_MU_BF*/ + + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + +u32 +beamforming_get_report_frame( + void *p_dm_void, + union recv_frame *precv_frame +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u32 ret = _SUCCESS; + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = NULL; + u8 *pframe = precv_frame->u.hdr.rx_data; + u32 frame_len = precv_frame->u.hdr.len; + u8 *TA; + u8 idx, offset; + + + /*Memory comparison to see if CSI report is the same with previous one*/ + TA = get_addr2_ptr(pframe); + p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, TA, &idx); + if (p_beamform_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) + offset = 31; /*24+(1+1+3)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(nc=2)*/ + else if (p_beamform_entry->beamform_entry_cap & BEAMFORMER_CAP_HT_EXPLICIT) + offset = 34; /*24+(1+1+6)+2 MAC header+(Category+ActionCode+MIMOControlField)+SNR(nc=2)*/ + else + return ret; + + + return ret; +} + + +boolean +send_fw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + struct rtw_ieee80211_hdr *pwlanhdr; + struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; + u8 *pframe; + u16 *fctrl; + u16 duration = 0; + u8 a_sifs_time = 0, ndp_tx_rate = 0, idx = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + + if (pmgntframe == NULL) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, alloc mgnt frame fail\n", __func__)); + return false; + } + + /* update attribute */ + pattrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, pattrib); + + pattrib->qsel = QSLT_BEACON; + ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + pattrib->rate = ndp_tx_rate; + pattrib->bwmode = BW; + pattrib->order = 1; + pattrib->subtype = WIFI_ACTION_NOACK; + + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + fctrl = &pwlanhdr->frame_ctl; + *(fctrl) = 0; + + set_order_bit(pframe); + set_frame_sub_type(pframe, WIFI_ACTION_NOACK); + + _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + if (pmlmeext->cur_wireless_mode == WIRELESS_11B) + a_sifs_time = 10; + else + a_sifs_time = 16; + + duration = 2 * a_sifs_time + 40; + + if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + + set_duration(pframe, duration); + + /* HT control field */ + SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); + SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); + + _rtw_memcpy(pframe + 28, action_hdr, 4); + + pattrib->pktlen = 32; + + pattrib->last_txcmdsz = pattrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + + return true; +} + + +boolean +send_sw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + struct rtw_ieee80211_hdr *pwlanhdr; + struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + u8 action_hdr[4] = {ACT_CAT_VENDOR, 0x00, 0xe0, 0x4c}; + u8 *pframe; + u16 *fctrl; + u16 duration = 0; + u8 a_sifs_time = 0, ndp_tx_rate = 0, idx = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + ndp_tx_rate = beamforming_get_htndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + + if (pmgntframe == NULL) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, alloc mgnt frame fail\n", __func__)); + return false; + } + + /*update attribute*/ + pattrib = &pmgntframe->attrib; + update_mgntframe_attrib(adapter, pattrib); + pattrib->qsel = QSLT_MGNT; + pattrib->rate = ndp_tx_rate; + pattrib->bwmode = BW; + pattrib->order = 1; + pattrib->subtype = WIFI_ACTION_NOACK; + + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + fctrl = &pwlanhdr->frame_ctl; + *(fctrl) = 0; + + set_order_bit(pframe); + set_frame_sub_type(pframe, WIFI_ACTION_NOACK); + + _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr3, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); + + if (pmlmeext->cur_wireless_mode == WIRELESS_11B) + a_sifs_time = 10; + else + a_sifs_time = 16; + + duration = 2 * a_sifs_time + 40; + + if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + + set_duration(pframe, duration); + + /*HT control field*/ + SET_HT_CTRL_CSI_STEERING(pframe + 24, 3); + SET_HT_CTRL_NDP_ANNOUNCEMENT(pframe + 24, 1); + + _rtw_memcpy(pframe + 28, action_hdr, 4); + + pattrib->pktlen = 32; + + pattrib->last_txcmdsz = pattrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + + return true; +} + + +boolean +send_fw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + struct rtw_ieee80211_hdr *pwlanhdr; + struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + u8 *pframe; + u16 *fctrl; + u16 duration = 0; + u8 sequence = 0, a_sifs_time = 0, ndp_tx_rate = 0, idx = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + struct _RT_NDPA_STA_INFO sta_info; + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + + if (pmgntframe == NULL) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, alloc mgnt frame fail\n", __func__)); + return false; + } + + /* update attribute */ + pattrib = &pmgntframe->attrib; + _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); + update_mgntframe_attrib(adapter, pattrib); + + pattrib->qsel = QSLT_BEACON; + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + pattrib->rate = ndp_tx_rate; + pattrib->bwmode = BW; + pattrib->subtype = WIFI_NDPA; + + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + fctrl = &pwlanhdr->frame_ctl; + *(fctrl) = 0; + + set_frame_sub_type(pframe, WIFI_NDPA); + + _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN); + + if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) + a_sifs_time = 16; + else + a_sifs_time = 10; + + duration = 2 * a_sifs_time + 44; + + if (BW == CHANNEL_WIDTH_80) + duration += 40; + else if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + + set_duration(pframe, duration); + + sequence = p_beam_info->sounding_sequence << 2; + if (p_beam_info->sounding_sequence >= 0x3f) + p_beam_info->sounding_sequence = 0; + else + p_beam_info->sounding_sequence++; + + _rtw_memcpy(pframe + 16, &sequence, 1); + + if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) + AID = 0; + + sta_info.aid = AID; + sta_info.feedback_type = 0; + sta_info.nc_index = 0; + + _rtw_memcpy(pframe + 17, (u8 *)&sta_info, 2); + + pattrib->pktlen = 19; + + pattrib->last_txcmdsz = pattrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + + return true; +} + + + +boolean +send_sw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _ADAPTER *adapter = p_dm->adapter; + struct xmit_frame *pmgntframe; + struct pkt_attrib *pattrib; + struct rtw_ieee80211_hdr *pwlanhdr; + struct xmit_priv *pxmitpriv = &(adapter->xmitpriv); + struct mlme_ext_priv *pmlmeext = &adapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + struct mlme_priv *pmlmepriv = &(adapter->mlmepriv); + struct _RT_NDPA_STA_INFO ndpa_sta_info; + u8 ndp_tx_rate = 0, sequence = 0, a_sifs_time = 0, idx = 0; + u8 *pframe; + u16 *fctrl; + u16 duration = 0; + struct _RT_BEAMFORMING_INFO *p_beam_info = &(p_dm->beamforming_info); + struct _RT_BEAMFORMEE_ENTRY *p_beamform_entry = phydm_beamforming_get_bfee_entry_by_addr(p_dm, RA, &idx); + + ndp_tx_rate = beamforming_get_vht_ndp_tx_rate(p_dm, p_beamform_entry->comp_steering_num_of_bfer); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndp_tx_rate =%d\n", __func__, ndp_tx_rate)); + + pmgntframe = alloc_mgtxmitframe(pxmitpriv); + + if (pmgntframe == NULL) { + PHYDM_DBG(p_dm, DBG_TXBF, ("%s, alloc mgnt frame fail\n", __func__)); + return false; + } + + /*update attribute*/ + pattrib = &pmgntframe->attrib; + _rtw_memcpy(pattrib->ra, RA, ETH_ALEN); + update_mgntframe_attrib(adapter, pattrib); + pattrib->qsel = QSLT_MGNT; + pattrib->rate = ndp_tx_rate; + pattrib->bwmode = BW; + pattrib->subtype = WIFI_NDPA; + + _rtw_memset(pmgntframe->buf_addr, 0, WLANHDR_OFFSET + TXDESC_OFFSET); + + pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET; + + pwlanhdr = (struct rtw_ieee80211_hdr *)pframe; + + fctrl = &pwlanhdr->frame_ctl; + *(fctrl) = 0; + + set_frame_sub_type(pframe, WIFI_NDPA); + + _rtw_memcpy(pwlanhdr->addr1, RA, ETH_ALEN); + _rtw_memcpy(pwlanhdr->addr2, p_beamform_entry->my_mac_addr, ETH_ALEN); + + if (is_supported_5g(pmlmeext->cur_wireless_mode) || is_supported_ht(pmlmeext->cur_wireless_mode)) + a_sifs_time = 16; + else + a_sifs_time = 10; + + duration = 2 * a_sifs_time + 44; + + if (BW == CHANNEL_WIDTH_80) + duration += 40; + else if (BW == CHANNEL_WIDTH_40) + duration += 87; + else + duration += 180; + + set_duration(pframe, duration); + + sequence = p_beam_info->sounding_sequence << 2; + if (p_beam_info->sounding_sequence >= 0x3f) + p_beam_info->sounding_sequence = 0; + else + p_beam_info->sounding_sequence++; + + _rtw_memcpy(pframe + 16, &sequence, 1); + if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) + AID = 0; + + ndpa_sta_info.aid = AID; + ndpa_sta_info.feedback_type = 0; + ndpa_sta_info.nc_index = 0; + + _rtw_memcpy(pframe + 17, (u8 *)&ndpa_sta_info, 2); + + pattrib->pktlen = 19; + + pattrib->last_txcmdsz = pattrib->pktlen; + + dump_mgntframe(adapter, pmgntframe); + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] [%d]\n", __func__, __LINE__)); + + return true; +} + + +#endif + + +void +beamforming_get_ndpa_frame( + void *p_dm_void, +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + OCTET_STRING pdu_os +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + union recv_frame *precv_frame +#endif +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 *TA ; + u8 idx, sequence; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + u8 *p_ndpa_frame = pdu_os.Octet; +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + u8 *p_ndpa_frame = precv_frame->u.hdr.rx_data; +#endif + struct _RT_BEAMFORMER_ENTRY *p_beamformer_entry = NULL; /*Modified By Jeffery @2014-10-29*/ + + +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + RT_DISP_DATA(FBEAM, FBEAM_DATA, "beamforming_get_ndpa_frame\n", pdu_os.Octet, pdu_os.Length); + if (IsCtrlNDPA(p_ndpa_frame) == false) +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + if (get_frame_sub_type(p_ndpa_frame) != WIFI_NDPA) +#endif + return; + else if (!(p_dm->support_ic_type & (ODM_RTL8812 | ODM_RTL8821))) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] not 8812 or 8821A, return\n", __func__)); + return; + } +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + TA = Frame_Addr2(pdu_os); +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + TA = get_addr2_ptr(p_ndpa_frame); +#endif + /*Remove signaling TA. */ + TA[0] = TA[0] & 0xFE; + + p_beamformer_entry = phydm_beamforming_get_bfer_entry_by_addr(p_dm, TA, &idx); /* Modified By Jeffery @2014-10-29 */ + + /*Break options for Clock Reset*/ + if (p_beamformer_entry == NULL) + return; + else if (!(p_beamformer_entry->beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU)) + return; + /*log_success: As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is NO LONGER needed !2015-04-10, Jeffery*/ + /*clock_reset_times: While BFer entry always doesn't receive our CSI, clock will reset again and again.So clock_reset_times is limited to 5 times.2015-04-13, Jeffery*/ + else if ((p_beamformer_entry->log_success == 1) || (p_beamformer_entry->clock_reset_times == 5)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] log_seq=%d, pre_log_seq=%d, log_retry_cnt=%d, log_success=%d, clock_reset_times=%d, clock reset is no longer needed.\n", + __func__, p_beamformer_entry->log_seq, p_beamformer_entry->pre_log_seq, p_beamformer_entry->log_retry_cnt, p_beamformer_entry->log_success, p_beamformer_entry->clock_reset_times)); + + return; + } + + sequence = (p_ndpa_frame[16]) >> 2; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start, sequence=%d, log_seq=%d, pre_log_seq=%d, log_retry_cnt=%d, clock_reset_times=%d, log_success=%d\n", + __func__, sequence, p_beamformer_entry->log_seq, p_beamformer_entry->pre_log_seq, p_beamformer_entry->log_retry_cnt, p_beamformer_entry->clock_reset_times, p_beamformer_entry->log_success)); + + if ((p_beamformer_entry->log_seq != 0) && (p_beamformer_entry->pre_log_seq != 0)) { + /*Success condition*/ + if ((p_beamformer_entry->log_seq != sequence) && (p_beamformer_entry->pre_log_seq != p_beamformer_entry->log_seq)) { + /* break option for clcok reset, 2015-03-30, Jeffery */ + p_beamformer_entry->log_retry_cnt = 0; + /*As long as 8812A receive NDPA and feedback CSI succeed once, clock reset is no longer needed.*/ + /*That is, log_success is NOT needed to be reset to zero, 2015-04-13, Jeffery*/ + p_beamformer_entry->log_success = 1; + + } else {/*Fail condition*/ + + if (p_beamformer_entry->log_retry_cnt == 5) { + p_beamformer_entry->clock_reset_times++; + p_beamformer_entry->log_retry_cnt = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Clock Reset!!! clock_reset_times=%d\n", + __func__, p_beamformer_entry->clock_reset_times)); + hal_com_txbf_set(p_dm, TXBF_SET_SOUNDING_CLK, NULL); + + } else + p_beamformer_entry->log_retry_cnt++; + } + } + + /*Update log_seq & pre_log_seq*/ + p_beamformer_entry->pre_log_seq = p_beamformer_entry->log_seq; + p_beamformer_entry->log_seq = sequence; + +} + + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.h index 0e5134707ebc..795cfc8b5f81 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfinterface.h @@ -1,162 +1,179 @@ -#ifndef __HAL_TXBF_INTERFACE_H__ -#define __HAL_TXBF_INTERFACE_H__ - -#if (BEAMFORMING_SUPPORT == 1) -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) -VOID -Beamforming_GidPAid( - PADAPTER Adapter, - PRT_TCB pTcb - ); - -RT_STATUS -Beamforming_GetReportFrame( - IN PADAPTER Adapter, - IN PRT_RFD pRfd, - IN POCTET_STRING pPduOS - ); - -VOID -Beamforming_GetNDPAFrame( - IN PVOID pDM_VOID, - IN OCTET_STRING pduOS - ); - -BOOLEAN -SendFWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ); - -BOOLEAN -SendFWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ); - -BOOLEAN -SendSWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ); - -BOOLEAN -SendSWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ); - -#if (SUPPORT_MU_BF == 1) -RT_STATUS -Beamforming_GetVHTGIDMgntFrame( - IN PADAPTER Adapter, - IN PRT_RFD pRfd, - IN POCTET_STRING pPduOS - ); - -BOOLEAN -SendSWVHTGIDMgntFrame( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u1Byte Idx - ); - -BOOLEAN -SendSWVHTBFReportPoll( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN BOOLEAN bFinalPoll - ); - -BOOLEAN -SendSWVHTMUNDPAPacket( - IN PVOID pDM_VOID, - IN CHANNEL_WIDTH BW - ); -#else -#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -#define SendSWVHTGIDMgntFrame(pDM_VOID, RA) -#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) -#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) -#endif - - -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - -u4Byte -Beamforming_GetReportFrame( - IN PVOID pDM_VOID, - union recv_frame *precv_frame - ); - -BOOLEAN -SendFWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ); - -BOOLEAN -SendSWHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN CHANNEL_WIDTH BW - ); - -BOOLEAN -SendFWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ); - -BOOLEAN -SendSWVHTNDPAPacket( - IN PVOID pDM_VOID, - IN pu1Byte RA, - IN u2Byte AID, - IN CHANNEL_WIDTH BW - ); -#endif - -VOID -Beamforming_GetNDPAFrame( - IN PVOID pDM_VOID, -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - IN OCTET_STRING pduOS -#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) - union recv_frame *precv_frame -#endif -); - -BOOLEAN -DBG_SendSWVHTMUNDPAPacket( - IN PVOID pDM_VOID, - IN CHANNEL_WIDTH BW - ); - -#else -#define Beamforming_GetNDPAFrame(pDM_Odm, _PduOS) -#if (DM_ODM_SUPPORT_TYPE == ODM_CE) -#define Beamforming_GetReportFrame(Adapter, precv_frame) RT_STATUS_FAILURE -#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) -#define Beamforming_GetReportFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -#define Beamforming_GetVHTGIDMgntFrame(Adapter, pRfd, pPduOS) RT_STATUS_FAILURE -#endif -#define SendFWHTNDPAPacket(pDM_VOID, RA, BW) -#define SendSWHTNDPAPacket(pDM_VOID, RA, BW) -#define SendFWVHTNDPAPacket(pDM_VOID, RA, AID, BW) -#define SendSWVHTNDPAPacket(pDM_VOID, RA, AID, BW) -#define SendSWVHTGIDMgntFrame(pDM_VOID, RA, idx) -#define SendSWVHTBFReportPoll(pDM_VOID, RA, bFinalPoll) -#define SendSWVHTMUNDPAPacket(pDM_VOID, BW) -#endif - -#endif +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HAL_TXBF_INTERFACE_H__ +#define __HAL_TXBF_INTERFACE_H__ + +#if (BEAMFORMING_SUPPORT == 1) +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + +#define a_SifsTime ((IS_WIRELESS_MODE_5G(adapter)|| IS_WIRELESS_MODE_N_24G(adapter))? 16 : 10) + +void +beamforming_gid_paid( + struct _ADAPTER *adapter, + PRT_TCB p_tcb +); + +enum rt_status +beamforming_get_report_frame( + struct _ADAPTER *adapter, + PRT_RFD p_rfd, + POCTET_STRING p_pdu_os +); + +void +beamforming_get_ndpa_frame( + void *p_dm_void, + OCTET_STRING pdu_os +); + +boolean +send_fw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +); + +boolean +send_fw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +); + +boolean +send_sw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +); + +boolean +send_sw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +); + +#if (SUPPORT_MU_BF == 1) +enum rt_status +beamforming_get_vht_gid_mgnt_frame( + struct _ADAPTER *adapter, + PRT_RFD p_rfd, + POCTET_STRING p_pdu_os +); + +boolean +send_sw_vht_gid_mgnt_frame( + void *p_dm_void, + u8 *RA, + u8 idx +); + +boolean +send_sw_vht_bf_report_poll( + void *p_dm_void, + u8 *RA, + boolean is_final_poll +); + +boolean +send_sw_vht_mu_ndpa_packet( + void *p_dm_void, + enum channel_width BW +); +#else +#define beamforming_get_vht_gid_mgnt_frame(adapter, p_rfd, p_pdu_os) RT_STATUS_FAILURE +#define send_sw_vht_gid_mgnt_frame(p_dm_void, RA) +#define send_sw_vht_bf_report_poll(p_dm_void, RA, is_final_poll) +#define send_sw_vht_mu_ndpa_packet(p_dm_void, BW) +#endif + + +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + +u32 +beamforming_get_report_frame( + void *p_dm_void, + union recv_frame *precv_frame +); + +boolean +send_fw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +); + +boolean +send_sw_ht_ndpa_packet( + void *p_dm_void, + u8 *RA, + enum channel_width BW +); + +boolean +send_fw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +); + +boolean +send_sw_vht_ndpa_packet( + void *p_dm_void, + u8 *RA, + u16 AID, + enum channel_width BW +); +#endif + +void +beamforming_get_ndpa_frame( + void *p_dm_void, +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + OCTET_STRING pdu_os +#elif (DM_ODM_SUPPORT_TYPE == ODM_CE) + union recv_frame *precv_frame +#endif +); + +boolean +dbg_send_sw_vht_mundpa_packet( + void *p_dm_void, + enum channel_width BW +); + +#else +#define beamforming_get_ndpa_frame(p_dm, _pdu_os) +#if (DM_ODM_SUPPORT_TYPE == ODM_CE) + #define beamforming_get_report_frame(adapter, precv_frame) RT_STATUS_FAILURE +#elif (DM_ODM_SUPPORT_TYPE == ODM_WIN) + #define beamforming_get_report_frame(adapter, p_rfd, p_pdu_os) RT_STATUS_FAILURE + #define beamforming_get_vht_gid_mgnt_frame(adapter, p_rfd, p_pdu_os) RT_STATUS_FAILURE +#endif +#define send_fw_ht_ndpa_packet(p_dm_void, RA, BW) +#define send_sw_ht_ndpa_packet(p_dm_void, RA, BW) +#define send_fw_vht_ndpa_packet(p_dm_void, RA, AID, BW) +#define send_sw_vht_ndpa_packet(p_dm_void, RA, AID, BW) +#define send_sw_vht_gid_mgnt_frame(p_dm_void, RA, idx) +#define send_sw_vht_bf_report_poll(p_dm_void, RA, is_final_poll) +#define send_sw_vht_mu_ndpa_packet(p_dm_void, BW) +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.c index e1253710f697..038683739b50 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.c @@ -1,527 +1,540 @@ -//============================================================ -// Description: -// -// This file is for 8812/8821/8811 TXBF mechanism -// -//============================================================ -#include "mp_precomp.h" -#include "../phydm_precomp.h" - -#if (BEAMFORMING_SUPPORT == 1) -#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -VOID -HalTxbf8812A_setNDPArate( - IN PVOID pDM_VOID, - IN u1Byte BW, - IN u1Byte Rate -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - ODM_Write1Byte(pDM_Odm, REG_NDPA_OPT_CTRL_8812A, (Rate << 2 | BW)); - -} - -VOID -halTxbfJaguar_RfMode( - IN PVOID pDM_VOID, - IN PRT_BEAMFORMING_INFO pBeamInfo -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - if (pDM_Odm->RFType == ODM_1T1R) - return; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] set TxIQGen\n", __func__)); - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x1); /*RF Mode table write enable*/ - - if (pBeamInfo->beamformee_su_cnt > 0) { - // Paath_A - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ - // Path_B - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ - } else { - // Paath_A - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ - // Path_B - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableAddr, 0x78000, 0x3); /*Select RX mode*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData0, 0xfffff, 0x3F7FF); /*Set Table data*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_ModeTableData1, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ - } - - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ - ODM_SetRFReg(pDM_Odm, ODM_RF_PATH_B, RF_WeLut_Jaguar, 0x80000, 0x0); /*RF Mode table write disable*/ - - if (pBeamInfo->beamformee_su_cnt > 0) - ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x33); - else - ODM_SetBBReg(pDM_Odm, rTxPath_Jaguar, bMaskByte1, 0x11); -} - - -VOID -halTxbfJaguar_DownloadNDPA( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte u1bTmp = 0, tmpReg422 = 0, Head_Page; - u1Byte BcnValidReg = 0, count = 0, DLBcnCount = 0; - BOOLEAN bSendBeacon = FALSE; - u1Byte TxPageBndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; /*default reseved 1 page for the IC type which is undefined.*/ - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; - PADAPTER Adapter = pDM_Odm->Adapter; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *pDM_Odm->pbFwDwRsvdPageInProgress = TRUE; -#endif - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (Idx == 0) - Head_Page = 0xFE; - else - Head_Page = 0xFE; - - Adapter->HalFunc.GetHalDefVarHandler(Adapter, HAL_DEF_TX_PAGE_BOUNDARY, (pu1Byte)&TxPageBndy); - - /*Set REG_CR bit 8. DMA beacon by SW.*/ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); - ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp | BIT0)); - - - /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ - tmpReg422 = ODM_Read1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2); - ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422 & (~BIT6)); - - if (tmpReg422 & BIT6) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("SetBeamformDownloadNDPA_8812(): There is an Adapter is sending beacon.\n")); - bSendBeacon = TRUE; - } - - /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ - ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, Head_Page); - - do { - /*Clear beacon valid check bit.*/ - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); - ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 2, (BcnValidReg | BIT0)); - - /*download NDPA rsvd page.*/ - if (pBeamEntry->BeamformEntryCap & BEAMFORMER_CAP_VHT_SU) - Beamforming_SendVHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->AID, pBeamEntry->SoundBW, BEACON_QUEUE); - else - Beamforming_SendHTNDPAPacket(pDM_Odm, pBeamEntry->MacAddr, pBeamEntry->SoundBW, BEACON_QUEUE); - - /*check rsvd page download OK.*/ - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); - count = 0; - while (!(BcnValidReg & BIT0) && count < 20) { - count++; - ODM_delay_ms(10); - BcnValidReg = ODM_Read1Byte(pDM_Odm, REG_TDECTRL_8812A + 2); - } - DLBcnCount++; - } while (!(BcnValidReg & BIT0) && DLBcnCount < 5); - - if (!(BcnValidReg & BIT0)) - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("%s Download RSVD page failed!\n", __func__)); - - /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ - ODM_Write1Byte(pDM_Odm, REG_TDECTRL_8812A + 1, TxPageBndy); - - /*To make sure that if there exists an adapter which would like to send beacon.*/ - /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ - /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ - /*the beacon cannot be sent by HW.*/ - /*2010.06.23. Added by tynli.*/ - if (bSendBeacon) - ODM_Write1Byte(pDM_Odm, REG_FWHW_TXQ_CTRL_8812A + 2, tmpReg422); - - /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ - /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ - u1bTmp = ODM_Read1Byte(pDM_Odm, REG_CR_8812A + 1); - ODM_Write1Byte(pDM_Odm, REG_CR_8812A + 1, (u1bTmp & (~BIT0))); - - pBeamEntry->BeamformEntryState = BEAMFORMING_ENTRY_STATE_PROGRESSED; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - *pDM_Odm->pbFwDwRsvdPageInProgress = FALSE; -#endif -} - - -VOID -halTxbfJaguar_FwTxBFCmd( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Idx, Period0 = 0, Period1 = 0; - u1Byte PageNum0 = 0xFF, PageNum1 = 0xFF; - u1Byte u1TxBFParm[3] = {0}; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - for (Idx = 0; Idx < BEAMFORMEE_ENTRY_NUM; Idx++) { - /*Modified by David*/ - if (pBeamInfo->BeamformeeEntry[Idx].bUsed && pBeamInfo->BeamformeeEntry[Idx].BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) { - if (Idx == 0) { - if (pBeamInfo->BeamformeeEntry[Idx].bSound) - PageNum0 = 0xFE; - else - PageNum0 = 0xFF; /*stop sounding*/ - Period0 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); - } else if (Idx == 1) { - if (pBeamInfo->BeamformeeEntry[Idx].bSound) - PageNum1 = 0xFE; - else - PageNum1 = 0xFF; /*stop sounding*/ - Period1 = (u1Byte)(pBeamInfo->BeamformeeEntry[Idx].SoundPeriod); - } - } - } - - u1TxBFParm[0] = PageNum0; - u1TxBFParm[1] = PageNum1; - u1TxBFParm[2] = (Period1 << 4) | Period0; - ODM_FillH2CCmd(pDM_Odm, PHYDM_H2C_TXBF, 3, u1TxBFParm); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, - ("[%s] PageNum0 = %d Period0 = %d, PageNum1 = %d Period1 %d\n", __func__, PageNum0, Period0, PageNum1, Period1)); -} - - -VOID -HalTxbfJaguar_Enter( - IN PVOID pDM_VOID, - IN u1Byte BFerBFeeIdx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte i = 0; - u1Byte BFerIdx = (BFerBFeeIdx & 0xF0) >> 4; - u1Byte BFeeIdx = (BFerBFeeIdx & 0xF); - u4Byte CSI_Param; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - RT_BEAMFORMER_ENTRY BeamformerEntry; - u2Byte STAid = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!\n", __func__)); - - halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); - - if (pDM_Odm->RFType == ODM_2T2R) - ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x00000000); /*Nc =2*/ - else - ODM_SetBBReg(pDM_Odm, ODM_REG_CSI_CONTENT_VALUE, bMaskDWord, 0x01081008); /*Nc =1*/ - - if ((pBeamformingInfo->beamformer_su_cnt > 0) && (BFerIdx < BEAMFORMER_ENTRY_NUM)) { - BeamformerEntry = pBeamformingInfo->BeamformerEntry[BFerIdx]; - - /*Sounding protocol control*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); - - /*MAC address/Partial AID of Beamformer*/ - if (BFerIdx == 0) { - for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_BFMER0_INFO_8812A + i), BeamformerEntry.MacAddr[i]); - /*CSI report use legacy ofdm so don't need to fill P_AID. */ - /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER0_INFO_8812A+6, BeamformEntry.P_AID); */ - } else { - for (i = 0; i < 6 ; i++) - ODM_Write1Byte(pDM_Odm, (REG_BFMER1_INFO_8812A + i), BeamformerEntry.MacAddr[i]); - /*CSI report use legacy ofdm so don't need to fill P_AID.*/ - /*PlatformEFIOWrite2Byte(Adapter, REG_BFMER1_INFO_8812A+6, BeamformEntry.P_AID);*/ - } - - /*CSI report parameters of Beamformee*/ - if (BeamformerEntry.BeamformEntryCap & BEAMFORMEE_CAP_VHT_SU) { - if (pDM_Odm->RFType == ODM_2T2R) - CSI_Param = 0x01090109; - else - CSI_Param = 0x01080108; - } else { - if (pDM_Odm->RFType == ODM_2T2R) - CSI_Param = 0x03090309; - else - CSI_Param = 0x03080308; - } - - ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, CSI_Param); - ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, CSI_Param); - ODM_Write4Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, CSI_Param); - - /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); - } - - - if ((pBeamformingInfo->beamformee_su_cnt > 0) && (BFeeIdx < BEAMFORMEE_ENTRY_NUM)) { - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[BFeeIdx]; - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - STAid = BeamformeeEntry.MacId; - else - STAid = BeamformeeEntry.P_AID; - - /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ - if (BFeeIdx == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, STAid); - ODM_Write1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3, ODM_Read1Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 3) | BIT4 | BIT6 | BIT7); - } else - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, STAid | BIT12 | BIT14 | BIT15); - - /*CSI report parameters of Beamformee*/ - if (BFeeIdx == 0) { - /*Get BIT24 & BIT25*/ - u1Byte tmp = ODM_Read1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3) & 0x3; - - ODM_Write1Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); - ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, STAid | BIT9); - } else { - /*Set BIT25*/ - ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, STAid | 0xE200); - } - phydm_Beamforming_Notify(pDM_Odm); - } -} - - -VOID -HalTxbfJaguar_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamformingInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMER_ENTRY BeamformerEntry; - RT_BEAMFORMEE_ENTRY BeamformeeEntry; - - if (Idx < BEAMFORMER_ENTRY_NUM) { - BeamformerEntry = pBeamformingInfo->BeamformerEntry[Idx]; - BeamformeeEntry = pBeamformingInfo->BeamformeeEntry[Idx]; - } else - return; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s]Start!, IDx = %d\n", __func__, Idx)); - - /*Clear P_AID of Beamformee*/ - /*Clear MAC address of Beamformer*/ - /*Clear Associated Bfmee Sel*/ - - if (BeamformerEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); - if (Idx == 0) { - ODM_Write4Byte(pDM_Odm, REG_BFMER0_INFO_8812A, 0); - ODM_Write2Byte(pDM_Odm, REG_BFMER0_INFO_8812A + 4, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); - } else { - ODM_Write4Byte(pDM_Odm, REG_BFMER1_INFO_8812A, 0); - ODM_Write2Byte(pDM_Odm, REG_BFMER1_INFO_8812A + 4, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW20_8812A, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW40_8812A, 0); - ODM_Write2Byte(pDM_Odm, REG_CSI_RPT_PARAM_BW80_8812A, 0); - } - } - - if (BeamformeeEntry.BeamformEntryCap == BEAMFORMING_CAP_NONE) { - halTxbfJaguar_RfMode(pDM_Odm, pBeamformingInfo); - if (Idx == 0) { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A, 0x0); - ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A, 0); - } else { - ODM_Write2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_TXBF_CTRL_8812A + 2) & 0xF000); - ODM_Write2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2, ODM_Read2Byte(pDM_Odm, REG_BFMEE_SEL_8812A + 2) & 0x60); - } - } - -} - - -VOID -HalTxbfJaguar_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u2Byte BeamCtrlVal; - u4Byte BeamCtrlReg; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - RT_BEAMFORMEE_ENTRY BeamformEntry = pBeamInfo->BeamformeeEntry[Idx]; - - if (phydm_actingDetermine(pDM_Odm, PhyDM_ACTING_AS_IBSS)) - BeamCtrlVal = BeamformEntry.MacId; - else - BeamCtrlVal = BeamformEntry.P_AID; - - if (Idx == 0) - BeamCtrlReg = REG_TXBF_CTRL_8812A; - else { - BeamCtrlReg = REG_TXBF_CTRL_8812A + 2; - BeamCtrlVal |= BIT12 | BIT14 | BIT15; - } - - if ((BeamformEntry.BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (pBeamInfo->applyVmatrix == TRUE)) { - if (BeamformEntry.SoundBW == CHANNEL_WIDTH_20) - BeamCtrlVal |= BIT9; - else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_40) - BeamCtrlVal |= (BIT9 | BIT10); - else if (BeamformEntry.SoundBW == CHANNEL_WIDTH_80) - BeamCtrlVal |= (BIT9 | BIT10 | BIT11); - } else - BeamCtrlVal &= ~(BIT9 | BIT10 | BIT11); - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] BeamCtrlVal = 0x%x!\n", __func__, BeamCtrlVal)); - - ODM_Write2Byte(pDM_Odm, BeamCtrlReg, BeamCtrlVal); -} - - - -VOID -HalTxbfJaguar_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - PRT_BEAMFORMEE_ENTRY pBeamEntry = pBeamInfo->BeamformeeEntry + Idx; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pBeamEntry->BeamformEntryState == BEAMFORMING_ENTRY_STATE_PROGRESSING) - halTxbfJaguar_DownloadNDPA(pDM_Odm, Idx); - - halTxbfJaguar_FwTxBFCmd(pDM_Odm); -} - - -VOID -HalTxbfJaguar_Patch( - IN PVOID pDM_VOID, - IN u1Byte Operation -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - PRT_BEAMFORMING_INFO pBeamInfo = &pDM_Odm->BeamformingInfo; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (pBeamInfo->BeamformCap == BEAMFORMING_CAP_NONE) - return; -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - if (Operation == SCAN_OPT_BACKUP_BAND0) - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xC8); - else if (Operation == SCAN_OPT_RESTORE) - ODM_Write1Byte(pDM_Odm, REG_SND_PTCL_CTRL_8812A, 0xCB); -#endif -} - -VOID -HalTxbfJaguar_Clk_8812A( - IN PVOID pDM_VOID -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u2Byte u2btmp; - u1Byte Count = 0, u1btmp; - PADAPTER Adapter = pDM_Odm->Adapter; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] Start!\n", __func__)); - - if (*(pDM_Odm->pbScanInProcess)) { - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_LOUD, ("[%s] return by Scan\n", __func__)); - return; - } -#if DEV_BUS_TYPE == RT_PCI_INTERFACE - /*Stop PCIe TxDMA*/ - ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); -#endif - - /*Stop Usb TxDMA*/ -#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) - RT_DISABLE_FUNC(Adapter, DF_TX_BIT); - PlatformReturnAllPendingTxPackets(Adapter); -#else - rtw_write_port_cancel(Adapter); -#endif - - /*Wait TXFF empty*/ - for (Count = 0; Count < 100; Count++) { - u2btmp = ODM_Read2Byte(pDM_Odm, REG_TXPKT_EMPTY_8812A); - u2btmp = u2btmp & 0xfff; - if (u2btmp != 0xfff) { - ODM_delay_ms(10); - continue; - } else - break; - } - - /*TX pause*/ - ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0xFF); - - /*Wait TX State Machine OK*/ - for (Count = 0; Count < 100; Count++) { - if (ODM_Read4Byte(pDM_Odm, REG_SCH_TXCMD_8812A) != 0) - continue; - else - break; - } - - - /*Stop RX DMA path*/ - u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); - ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT2); - - for (Count = 0; Count < 100; Count++) { - u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); - if (u1btmp & BIT1) - break; - else - ODM_delay_ms(10); - } - - /*Disable clock*/ - ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xf0); - /*Disable 320M*/ - ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); - /*Enable 320M*/ - ODM_Write1Byte(pDM_Odm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); - /*Enable clock*/ - ODM_Write1Byte(pDM_Odm, REG_SYS_CLKR_8812A + 1, 0xfc); - - - /*Release Tx pause*/ - ODM_Write1Byte(pDM_Odm, REG_TXPAUSE_8812A, 0); - - /*Enable RX DMA path*/ - u1btmp = ODM_Read1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A); - ODM_Write1Byte(pDM_Odm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT2)); -#if DEV_BUS_TYPE == RT_PCI_INTERFACE - /*Enable PCIe TxDMA*/ - ODM_Write1Byte(pDM_Odm, REG_PCIE_CTRL_REG_8812A + 1, 0); -#endif - /*Start Usb TxDMA*/ - RT_ENABLE_FUNC(Adapter, DF_TX_BIT); -} - -#endif - - - -#endif - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +/* ************************************************************ + * Description: + * + * This file is for 8812/8821/8811 TXBF mechanism + * + * ************************************************************ */ +#include "mp_precomp.h" +#include "../phydm_precomp.h" + +#if (BEAMFORMING_SUPPORT == 1) +#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) +void +hal_txbf_8812a_set_ndpa_rate( + void *p_dm_void, + u8 BW, + u8 rate +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + odm_write_1byte(p_dm, REG_NDPA_OPT_CTRL_8812A, (rate << 2 | BW)); + +} + +void +hal_txbf_jaguar_rf_mode( + void *p_dm_void, + struct _RT_BEAMFORMING_INFO *p_beam_info +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + if (p_dm->rf_type == RF_1T1R) + return; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] set TxIQGen\n", __func__)); + + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x1); /*RF mode table write enable*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x1); /*RF mode table write enable*/ + + if (p_beam_info->beamformee_su_cnt > 0) { + /* Paath_A */ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ + /* Path_B */ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0xE26BF); /*Enable TXIQGEN in RX mode*/ + } else { + /* Paath_A */ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_A, 0x32, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ + /* Path_B */ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x30, 0x78000, 0x3); /*Select RX mode*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x31, 0xfffff, 0x3F7FF); /*Set Table data*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0x32, 0xfffff, 0xC26BF); /*Disable TXIQGEN in RX mode*/ + } + + odm_set_rf_reg(p_dm, RF_PATH_A, 0xef, 0x80000, 0x0); /*RF mode table write disable*/ + odm_set_rf_reg(p_dm, RF_PATH_B, 0xef, 0x80000, 0x0); /*RF mode table write disable*/ + + if (p_beam_info->beamformee_su_cnt > 0) + odm_set_bb_reg(p_dm, 0x80c, MASKBYTE1, 0x33); + else + odm_set_bb_reg(p_dm, 0x80c, MASKBYTE1, 0x11); +} + + +void +hal_txbf_jaguar_download_ndpa( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 u1b_tmp = 0, tmp_reg422 = 0, head_page; + u8 bcn_valid_reg = 0, count = 0, dl_bcn_count = 0; + boolean is_send_beacon = false; + u8 tx_page_bndy = LAST_ENTRY_OF_TX_PKT_BUFFER_8812; /*default reseved 1 page for the IC type which is undefined.*/ + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + struct _ADAPTER *adapter = p_dm->adapter; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + *p_dm->p_is_fw_dw_rsvd_page_in_progress = true; +#endif + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (idx == 0) + head_page = 0xFE; + else + head_page = 0xFE; + + phydm_get_hal_def_var_handler_interface(p_dm, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_page_bndy); + + /*Set REG_CR bit 8. DMA beacon by SW.*/ + u1b_tmp = odm_read_1byte(p_dm, REG_CR_8812A + 1); + odm_write_1byte(p_dm, REG_CR_8812A + 1, (u1b_tmp | BIT(0))); + + + /*Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame.*/ + tmp_reg422 = odm_read_1byte(p_dm, REG_FWHW_TXQ_CTRL_8812A + 2); + odm_write_1byte(p_dm, REG_FWHW_TXQ_CTRL_8812A + 2, tmp_reg422 & (~BIT(6))); + + if (tmp_reg422 & BIT(6)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("SetBeamformDownloadNDPA_8812(): There is an adapter is sending beacon.\n")); + is_send_beacon = true; + } + + /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ + odm_write_1byte(p_dm, REG_TDECTRL_8812A + 1, head_page); + + do { + /*Clear beacon valid check bit.*/ + bcn_valid_reg = odm_read_1byte(p_dm, REG_TDECTRL_8812A + 2); + odm_write_1byte(p_dm, REG_TDECTRL_8812A + 2, (bcn_valid_reg | BIT(0))); + + /*download NDPA rsvd page.*/ + if (p_beam_entry->beamform_entry_cap & BEAMFORMER_CAP_VHT_SU) + beamforming_send_vht_ndpa_packet(p_dm, p_beam_entry->mac_addr, p_beam_entry->aid, p_beam_entry->sound_bw, BEACON_QUEUE); + else + beamforming_send_ht_ndpa_packet(p_dm, p_beam_entry->mac_addr, p_beam_entry->sound_bw, BEACON_QUEUE); + + /*check rsvd page download OK.*/ + bcn_valid_reg = odm_read_1byte(p_dm, REG_TDECTRL_8812A + 2); + count = 0; + while (!(bcn_valid_reg & BIT(0)) && count < 20) { + count++; + ODM_delay_ms(10); + bcn_valid_reg = odm_read_1byte(p_dm, REG_TDECTRL_8812A + 2); + } + dl_bcn_count++; + } while (!(bcn_valid_reg & BIT(0)) && dl_bcn_count < 5); + + if (!(bcn_valid_reg & BIT(0))) + PHYDM_DBG(p_dm, DBG_TXBF, ("%s Download RSVD page failed!\n", __func__)); + + /*TDECTRL[15:8] 0x209[7:0] = 0xF6 Beacon Head for TXDMA*/ + odm_write_1byte(p_dm, REG_TDECTRL_8812A + 1, tx_page_bndy); + + /*To make sure that if there exists an adapter which would like to send beacon.*/ + /*If exists, the origianl value of 0x422[6] will be 1, we should check this to*/ + /*prevent from setting 0x422[6] to 0 after download reserved page, or it will cause*/ + /*the beacon cannot be sent by HW.*/ + /*2010.06.23. Added by tynli.*/ + if (is_send_beacon) + odm_write_1byte(p_dm, REG_FWHW_TXQ_CTRL_8812A + 2, tmp_reg422); + + /*Do not enable HW DMA BCN or it will cause Pcie interface hang by timing issue. 2011.11.24. by tynli.*/ + /*Clear CR[8] or beacon packet will not be send to TxBuf anymore.*/ + u1b_tmp = odm_read_1byte(p_dm, REG_CR_8812A + 1); + odm_write_1byte(p_dm, REG_CR_8812A + 1, (u1b_tmp & (~BIT(0)))); + + p_beam_entry->beamform_entry_state = BEAMFORMING_ENTRY_STATE_PROGRESSED; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + *p_dm->p_is_fw_dw_rsvd_page_in_progress = false; +#endif +} + + +void +hal_txbf_jaguar_fw_txbf_cmd( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 idx, period0 = 0, period1 = 0; + u8 PageNum0 = 0xFF, PageNum1 = 0xFF; + u8 u1_tx_bf_parm[3] = {0}; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + for (idx = 0; idx < BEAMFORMEE_ENTRY_NUM; idx++) { + /*Modified by David*/ + if (p_beam_info->beamformee_entry[idx].is_used && p_beam_info->beamformee_entry[idx].beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) { + if (idx == 0) { + if (p_beam_info->beamformee_entry[idx].is_sound) + PageNum0 = 0xFE; + else + PageNum0 = 0xFF; /*stop sounding*/ + period0 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + } else if (idx == 1) { + if (p_beam_info->beamformee_entry[idx].is_sound) + PageNum1 = 0xFE; + else + PageNum1 = 0xFF; /*stop sounding*/ + period1 = (u8)(p_beam_info->beamformee_entry[idx].sound_period); + } + } + } + + u1_tx_bf_parm[0] = PageNum0; + u1_tx_bf_parm[1] = PageNum1; + u1_tx_bf_parm[2] = (period1 << 4) | period0; + odm_fill_h2c_cmd(p_dm, PHYDM_H2C_TXBF, 3, u1_tx_bf_parm); + + PHYDM_DBG(p_dm, DBG_TXBF, + ("[%s] PageNum0 = %d period0 = %d, PageNum1 = %d period1 %d\n", __func__, PageNum0, period0, PageNum1, period1)); +} + + +void +hal_txbf_jaguar_enter( + void *p_dm_void, + u8 bfer_bfee_idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 i = 0; + u8 bfer_idx = (bfer_bfee_idx & 0xF0) >> 4; + u8 bfee_idx = (bfer_bfee_idx & 0xF); + u32 csi_param; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + u16 sta_id = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]Start!\n", __func__)); + + hal_txbf_jaguar_rf_mode(p_dm, p_beamforming_info); + + if (p_dm->rf_type == RF_2T2R) + odm_set_bb_reg(p_dm, ODM_REG_CSI_CONTENT_VALUE, MASKDWORD, 0x00000000); /*nc =2*/ + else + odm_set_bb_reg(p_dm, ODM_REG_CSI_CONTENT_VALUE, MASKDWORD, 0x01081008); /*nc =1*/ + + if ((p_beamforming_info->beamformer_su_cnt > 0) && (bfer_idx < BEAMFORMER_ENTRY_NUM)) { + beamformer_entry = p_beamforming_info->beamformer_entry[bfer_idx]; + + /*Sounding protocol control*/ + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8812A, 0xCB); + + /*MAC address/Partial AID of Beamformer*/ + if (bfer_idx == 0) { + for (i = 0; i < 6 ; i++) + odm_write_1byte(p_dm, (REG_BFMER0_INFO_8812A + i), beamformer_entry.mac_addr[i]); + /*CSI report use legacy ofdm so don't need to fill P_AID. */ + /*platform_efio_write_2byte(adapter, REG_BFMER0_INFO_8812A+6, beamform_entry.P_AID); */ + } else { + for (i = 0; i < 6 ; i++) + odm_write_1byte(p_dm, (REG_BFMER1_INFO_8812A + i), beamformer_entry.mac_addr[i]); + /*CSI report use legacy ofdm so don't need to fill P_AID.*/ + /*platform_efio_write_2byte(adapter, REG_BFMER1_INFO_8812A+6, beamform_entry.P_AID);*/ + } + + /*CSI report parameters of Beamformee*/ + if (beamformer_entry.beamform_entry_cap & BEAMFORMEE_CAP_VHT_SU) { + if (p_dm->rf_type == RF_2T2R) + csi_param = 0x01090109; + else + csi_param = 0x01080108; + } else { + if (p_dm->rf_type == RF_2T2R) + csi_param = 0x03090309; + else + csi_param = 0x03080308; + } + + odm_write_4byte(p_dm, REG_CSI_RPT_PARAM_BW20_8812A, csi_param); + odm_write_4byte(p_dm, REG_CSI_RPT_PARAM_BW40_8812A, csi_param); + odm_write_4byte(p_dm, REG_CSI_RPT_PARAM_BW80_8812A, csi_param); + + /*Timeout value for MAC to leave NDP_RX_standby_state (60 us, Test chip) (80 us, MP chip)*/ + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8812A + 3, 0x50); + } + + + if ((p_beamforming_info->beamformee_su_cnt > 0) && (bfee_idx < BEAMFORMEE_ENTRY_NUM)) { + beamformee_entry = p_beamforming_info->beamformee_entry[bfee_idx]; + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + sta_id = beamformee_entry.mac_id; + else + sta_id = beamformee_entry.p_aid; + + /*P_AID of Beamformee & enable NDPA transmission & enable NDPA interrupt*/ + if (bfee_idx == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8812A, sta_id); + odm_write_1byte(p_dm, REG_TXBF_CTRL_8812A + 3, odm_read_1byte(p_dm, REG_TXBF_CTRL_8812A + 3) | BIT(4) | BIT(6) | BIT(7)); + } else + odm_write_2byte(p_dm, REG_TXBF_CTRL_8812A + 2, sta_id | BIT(12) | BIT(14) | BIT(15)); + + /*CSI report parameters of Beamformee*/ + if (bfee_idx == 0) { + /*Get BIT24 & BIT25*/ + u8 tmp = odm_read_1byte(p_dm, REG_BFMEE_SEL_8812A + 3) & 0x3; + + odm_write_1byte(p_dm, REG_BFMEE_SEL_8812A + 3, tmp | 0x60); + odm_write_2byte(p_dm, REG_BFMEE_SEL_8812A, sta_id | BIT(9)); + } else { + /*Set BIT25*/ + odm_write_2byte(p_dm, REG_BFMEE_SEL_8812A + 2, sta_id | 0xE200); + } + phydm_beamforming_notify(p_dm); + } +} + + +void +hal_txbf_jaguar_leave( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beamforming_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMER_ENTRY beamformer_entry; + struct _RT_BEAMFORMEE_ENTRY beamformee_entry; + + if (idx < BEAMFORMER_ENTRY_NUM) { + beamformer_entry = p_beamforming_info->beamformer_entry[idx]; + beamformee_entry = p_beamforming_info->beamformee_entry[idx]; + } else + return; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s]Start!, IDx = %d\n", __func__, idx)); + + /*Clear P_AID of Beamformee*/ + /*Clear MAC address of Beamformer*/ + /*Clear Associated Bfmee Sel*/ + + if (beamformer_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8812A, 0xC8); + if (idx == 0) { + odm_write_4byte(p_dm, REG_BFMER0_INFO_8812A, 0); + odm_write_2byte(p_dm, REG_BFMER0_INFO_8812A + 4, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW20_8812A, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW40_8812A, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW80_8812A, 0); + } else { + odm_write_4byte(p_dm, REG_BFMER1_INFO_8812A, 0); + odm_write_2byte(p_dm, REG_BFMER1_INFO_8812A + 4, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW20_8812A, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW40_8812A, 0); + odm_write_2byte(p_dm, REG_CSI_RPT_PARAM_BW80_8812A, 0); + } + } + + if (beamformee_entry.beamform_entry_cap == BEAMFORMING_CAP_NONE) { + hal_txbf_jaguar_rf_mode(p_dm, p_beamforming_info); + if (idx == 0) { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8812A, 0x0); + odm_write_2byte(p_dm, REG_BFMEE_SEL_8812A, 0); + } else { + odm_write_2byte(p_dm, REG_TXBF_CTRL_8812A + 2, odm_read_2byte(p_dm, REG_TXBF_CTRL_8812A + 2) & 0xF000); + odm_write_2byte(p_dm, REG_BFMEE_SEL_8812A + 2, odm_read_2byte(p_dm, REG_BFMEE_SEL_8812A + 2) & 0x60); + } + } + +} + + +void +hal_txbf_jaguar_status( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 beam_ctrl_val; + u32 beam_ctrl_reg; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY beamform_entry = p_beam_info->beamformee_entry[idx]; + + if (phydm_acting_determine(p_dm, phydm_acting_as_ibss)) + beam_ctrl_val = beamform_entry.mac_id; + else + beam_ctrl_val = beamform_entry.p_aid; + + if (idx == 0) + beam_ctrl_reg = REG_TXBF_CTRL_8812A; + else { + beam_ctrl_reg = REG_TXBF_CTRL_8812A + 2; + beam_ctrl_val |= BIT(12) | BIT(14) | BIT(15); + } + + if ((beamform_entry.beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSED) && (p_beam_info->apply_v_matrix == true)) { + if (beamform_entry.sound_bw == CHANNEL_WIDTH_20) + beam_ctrl_val |= BIT(9); + else if (beamform_entry.sound_bw == CHANNEL_WIDTH_40) + beam_ctrl_val |= (BIT(9) | BIT(10)); + else if (beamform_entry.sound_bw == CHANNEL_WIDTH_80) + beam_ctrl_val |= (BIT(9) | BIT(10) | BIT(11)); + } else + beam_ctrl_val &= ~(BIT(9) | BIT(10) | BIT(11)); + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] beam_ctrl_val = 0x%x!\n", __func__, beam_ctrl_val)); + + odm_write_2byte(p_dm, beam_ctrl_reg, beam_ctrl_val); +} + + + +void +hal_txbf_jaguar_fw_txbf( + void *p_dm_void, + u8 idx +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + struct _RT_BEAMFORMEE_ENTRY *p_beam_entry = p_beam_info->beamformee_entry + idx; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_beam_entry->beamform_entry_state == BEAMFORMING_ENTRY_STATE_PROGRESSING) + hal_txbf_jaguar_download_ndpa(p_dm, idx); + + hal_txbf_jaguar_fw_txbf_cmd(p_dm); +} + + +void +hal_txbf_jaguar_patch( + void *p_dm_void, + u8 operation +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + struct _RT_BEAMFORMING_INFO *p_beam_info = &p_dm->beamforming_info; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (p_beam_info->beamform_cap == BEAMFORMING_CAP_NONE) + return; +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + if (operation == SCAN_OPT_BACKUP_BAND0) + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8812A, 0xC8); + else if (operation == SCAN_OPT_RESTORE) + odm_write_1byte(p_dm, REG_SND_PTCL_CTRL_8812A, 0xCB); +#endif +} + +void +hal_txbf_jaguar_clk_8812a( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u16 u2btmp; + u8 count = 0, u1btmp; + struct _ADAPTER *adapter = p_dm->adapter; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] Start!\n", __func__)); + + if (*(p_dm->p_is_scan_in_process)) { + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] return by Scan\n", __func__)); + return; + } +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + /*Stop PCIe TxDMA*/ + odm_write_1byte(p_dm, REG_PCIE_CTRL_REG_8812A + 1, 0xFE); +#endif + + /*Stop Usb TxDMA*/ +#if (DM_ODM_SUPPORT_TYPE == ODM_WIN) + RT_DISABLE_FUNC(adapter, DF_TX_BIT); + PlatformReturnAllPendingTxPackets(adapter); +#else + rtw_write_port_cancel(adapter); +#endif + + /*Wait TXFF empty*/ + for (count = 0; count < 100; count++) { + u2btmp = odm_read_2byte(p_dm, REG_TXPKT_EMPTY_8812A); + u2btmp = u2btmp & 0xfff; + if (u2btmp != 0xfff) { + ODM_delay_ms(10); + continue; + } else + break; + } + + /*TX pause*/ + odm_write_1byte(p_dm, REG_TXPAUSE_8812A, 0xFF); + + /*Wait TX state Machine OK*/ + for (count = 0; count < 100; count++) { + if (odm_read_4byte(p_dm, REG_SCH_TXCMD_8812A) != 0) + continue; + else + break; + } + + + /*Stop RX DMA path*/ + u1btmp = odm_read_1byte(p_dm, REG_RXDMA_CONTROL_8812A); + odm_write_1byte(p_dm, REG_RXDMA_CONTROL_8812A, u1btmp | BIT(2)); + + for (count = 0; count < 100; count++) { + u1btmp = odm_read_1byte(p_dm, REG_RXDMA_CONTROL_8812A); + if (u1btmp & BIT(1)) + break; + else + ODM_delay_ms(10); + } + + /*Disable clock*/ + odm_write_1byte(p_dm, REG_SYS_CLKR_8812A + 1, 0xf0); + /*Disable 320M*/ + odm_write_1byte(p_dm, REG_AFE_PLL_CTRL_8812A + 3, 0x8); + /*Enable 320M*/ + odm_write_1byte(p_dm, REG_AFE_PLL_CTRL_8812A + 3, 0xa); + /*Enable clock*/ + odm_write_1byte(p_dm, REG_SYS_CLKR_8812A + 1, 0xfc); + + + /*Release Tx pause*/ + odm_write_1byte(p_dm, REG_TXPAUSE_8812A, 0); + + /*Enable RX DMA path*/ + u1btmp = odm_read_1byte(p_dm, REG_RXDMA_CONTROL_8812A); + odm_write_1byte(p_dm, REG_RXDMA_CONTROL_8812A, u1btmp & (~BIT(2))); +#if DEV_BUS_TYPE == RT_PCI_INTERFACE + /*Enable PCIe TxDMA*/ + odm_write_1byte(p_dm, REG_PCIE_CTRL_REG_8812A + 1, 0); +#endif + /*Start Usb TxDMA*/ + RT_ENABLE_FUNC(adapter, DF_TX_BIT); +} + +#endif + + + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.h index 8260d9b2f9ca..4b1b32099f85 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/haltxbfjaguar.h @@ -1,75 +1,88 @@ -#ifndef __HAL_TXBF_JAGUAR_H__ -#define __HAL_TXBF_JAGUAR_H__ -#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) -#if (BEAMFORMING_SUPPORT == 1) - -VOID -HalTxbf8812A_setNDPArate( - IN PVOID pDM_VOID, - IN u1Byte BW, - IN u1Byte Rate -); - - -VOID -HalTxbfJaguar_Enter( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbfJaguar_Leave( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbfJaguar_Status( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbfJaguar_FwTxBF( - IN PVOID pDM_VOID, - IN u1Byte Idx - ); - - -VOID -HalTxbfJaguar_Patch( - IN PVOID pDM_VOID, - IN u1Byte Operation - ); - - -VOID -HalTxbfJaguar_Clk_8812A( - IN PVOID pDM_VOID - ); -#else - -#define HalTxbf8812A_setNDPArate(pDM_VOID, BW, Rate) -#define HalTxbfJaguar_Enter(pDM_VOID, Idx) -#define HalTxbfJaguar_Leave(pDM_VOID, Idx) -#define HalTxbfJaguar_Status(pDM_VOID, Idx) -#define HalTxbfJaguar_FwTxBF(pDM_VOID, Idx) -#define HalTxbfJaguar_Patch(pDM_VOID, Operation) -#define HalTxbfJaguar_Clk_8812A(pDM_VOID) -#endif -#else - -#define HalTxbf8812A_setNDPArate(pDM_VOID, BW, Rate) -#define HalTxbfJaguar_Enter(pDM_VOID, Idx) -#define HalTxbfJaguar_Leave(pDM_VOID, Idx) -#define HalTxbfJaguar_Status(pDM_VOID, Idx) -#define HalTxbfJaguar_FwTxBF(pDM_VOID, Idx) -#define HalTxbfJaguar_Patch(pDM_VOID, Operation) -#define HalTxbfJaguar_Clk_8812A(pDM_VOID) -#endif - -#endif // #ifndef __HAL_TXBF_JAGUAR_H__ - +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HAL_TXBF_JAGUAR_H__ +#define __HAL_TXBF_JAGUAR_H__ +#if ((RTL8812A_SUPPORT == 1) || (RTL8821A_SUPPORT == 1)) +#if (BEAMFORMING_SUPPORT == 1) + +void +hal_txbf_8812a_set_ndpa_rate( + void *p_dm_void, + u8 BW, + u8 rate +); + + +void +hal_txbf_jaguar_enter( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_jaguar_leave( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_jaguar_status( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_jaguar_fw_txbf( + void *p_dm_void, + u8 idx +); + + +void +hal_txbf_jaguar_patch( + void *p_dm_void, + u8 operation +); + + +void +hal_txbf_jaguar_clk_8812a( + void *p_dm_void +); +#else + +#define hal_txbf_8812a_set_ndpa_rate(p_dm_void, BW, rate) +#define hal_txbf_jaguar_enter(p_dm_void, idx) +#define hal_txbf_jaguar_leave(p_dm_void, idx) +#define hal_txbf_jaguar_status(p_dm_void, idx) +#define hal_txbf_jaguar_fw_txbf(p_dm_void, idx) +#define hal_txbf_jaguar_patch(p_dm_void, operation) +#define hal_txbf_jaguar_clk_8812a(p_dm_void) +#endif +#else + +#define hal_txbf_8812a_set_ndpa_rate(p_dm_void, BW, rate) +#define hal_txbf_jaguar_enter(p_dm_void, idx) +#define hal_txbf_jaguar_leave(p_dm_void, idx) +#define hal_txbf_jaguar_status(p_dm_void, idx) +#define hal_txbf_jaguar_fw_txbf(p_dm_void, idx) +#define hal_txbf_jaguar_patch(p_dm_void, operation) +#define hal_txbf_jaguar_clk_8812a(p_dm_void) +#endif + +#endif /* #ifndef __HAL_TXBF_JAGUAR_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.c index fd3417bf8ce7..2fb3f0a6c95b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.c @@ -1,180 +1,202 @@ -#include "mp_precomp.h" -#include "phydm_precomp.h" - -#if (defined(CONFIG_BB_TXBF_API)) -#if (RTL8822B_SUPPORT == 1) -/*Add by YuChen for 8822B MU-MIMO API*/ - -/*this function is only used for BFer*/ -u1Byte -phydm_get_ndpa_rate( - IN PVOID pDM_VOID - ) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte NDPARate = ODM_RATE6M; - - if (pDM_Odm->RSSI_Min >= 30) /*link RSSI > 30%*/ - NDPARate = ODM_RATE24M; - else if (pDM_Odm->RSSI_Min <= 25) - NDPARate = ODM_RATE6M; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] NDPARate = 0x%x\n", __func__, NDPARate)); - - return NDPARate; - -} - -/*this function is only used for BFer*/ -u1Byte -phydm_get_beamforming_sounding_info( - IN PVOID pDM_VOID, - IN pu2Byte Troughput, - IN u1Byte Total_BFee_Num, - IN pu1Byte TxRate - ) -{ - u1Byte idx = 0; - u1Byte soundingdecision = 0xff; - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - - for (idx = 0; idx < Total_BFee_Num; idx++) { - if (((TxRate[idx] >= ODM_RATEVHTSS3MCS7) && (TxRate[idx] <= ODM_RATEVHTSS3MCS9))) - soundingdecision = soundingdecision & ~(1<= 500) - snding_score = 100; - else if (Throughput >= 450) - snding_score = 90; - else if (Throughput >= 400) - snding_score = 80; - else if (Throughput >= 350) - snding_score = 70; - else if (Throughput >= 300) - snding_score = 60; - else if (Throughput >= 250) - snding_score = 50; - else if (Throughput >= 200) - snding_score = 40; - else if (Throughput >= 150) - snding_score = 30; - else if (Throughput >= 100) - snding_score = 20; - else if (Throughput >= 50) - snding_score = 10; - else - snding_score = 0; - - ODM_RT_TRACE(pDM_Odm, PHYDM_COMP_TXBF, ODM_DBG_TRACE, ("[%s] snding_score = 0x%d\n", __func__, snding_score)); - - return snding_score; - -} - - -#endif -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -u1Byte -Beamforming_GetHTNDPTxRate( - IN PVOID pDM_VOID, - u1Byte CompSteeringNumofBFer -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Nr_index = 0; - u1Byte NDPTxRate; - /*Find Nr*/ -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) - Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); - else -#endif - Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); - - switch (Nr_index) { - case 1: - NDPTxRate = ODM_MGN_MCS8; - break; - - case 2: - NDPTxRate = ODM_MGN_MCS16; - break; - - case 3: - NDPTxRate = ODM_MGN_MCS24; - break; - - default: - NDPTxRate = ODM_MGN_MCS8; - break; - } - -return NDPTxRate; - -} - -u1Byte -Beamforming_GetVHTNDPTxRate( - IN PVOID pDM_VOID, - u1Byte CompSteeringNumofBFer -) -{ - PDM_ODM_T pDM_Odm = (PDM_ODM_T)pDM_VOID; - u1Byte Nr_index = 0; - u1Byte NDPTxRate; - /*Find Nr*/ -#if (RTL8814A_SUPPORT == 1) - if (pDM_Odm->SupportICType & ODM_RTL8814A) - Nr_index = TxBF_Nr(halTxbf8814A_GetNtx(pDM_Odm), CompSteeringNumofBFer); - else -#endif - Nr_index = TxBF_Nr(1, CompSteeringNumofBFer); - - switch (Nr_index) { - case 1: - NDPTxRate = ODM_MGN_VHT2SS_MCS0; - break; - - case 2: - NDPTxRate = ODM_MGN_VHT3SS_MCS0; - break; - - case 3: - NDPTxRate = ODM_MGN_VHT4SS_MCS0; - break; - - default: - NDPTxRate = ODM_MGN_VHT2SS_MCS0; - break; - } - -return NDPTxRate; - -} -#endif - -#endif - +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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 "mp_precomp.h" +#include "phydm_precomp.h" + +#if (defined(CONFIG_BB_TXBF_API)) +#if (RTL8822B_SUPPORT == 1) +/*Add by YuChen for 8822B MU-MIMO API*/ + +/*this function is only used for BFer*/ +u8 +phydm_get_ndpa_rate( + void *p_dm_void +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 ndpa_rate = ODM_RATE6M; + + if (p_dm->rssi_min >= 30) /*link RSSI > 30%*/ + ndpa_rate = ODM_RATE24M; + else if (p_dm->rssi_min <= 25) + ndpa_rate = ODM_RATE6M; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] ndpa_rate = 0x%x\n", __func__, ndpa_rate)); + + return ndpa_rate; + +} + +/*this function is only used for BFer*/ +u8 +phydm_get_beamforming_sounding_info( + void *p_dm_void, + u16 *troughput, + u8 total_bfee_num, + u8 *tx_rate +) +{ + u8 idx = 0; + u8 soundingdecision = 0xff; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + for (idx = 0; idx < total_bfee_num; idx++) { + if (p_dm->support_ic_type & (ODM_RTL8814A)) { + if (((tx_rate[idx] >= ODM_RATEVHTSS3MCS7) && (tx_rate[idx] <= ODM_RATEVHTSS3MCS9))) + soundingdecision = soundingdecision & ~(1 << idx); + } else if (p_dm->support_ic_type & (ODM_RTL8822B | ODM_RTL8822C | ODM_RTL8812)) { + if (((tx_rate[idx] >= ODM_RATEVHTSS2MCS7) && (tx_rate[idx] <= ODM_RATEVHTSS2MCS9))) + soundingdecision = soundingdecision & ~(1 << idx); + } else if (p_dm->support_ic_type & (ODM_RTL8814B)) { + if (((tx_rate[idx] >= ODM_RATEVHTSS4MCS7) && (tx_rate[idx] <= ODM_RATEVHTSS4MCS9))) + soundingdecision = soundingdecision & ~(1 << idx); + } + } + + for (idx = 0; idx < total_bfee_num; idx++) { + if (troughput[idx] <= 10) + soundingdecision = soundingdecision & ~(1 << idx); + } + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] soundingdecision = 0x%x\n", __func__, soundingdecision)); + + return soundingdecision; + +} + +/*this function is only used for BFer*/ +u8 +phydm_get_mu_bfee_snding_decision( + void *p_dm_void, + u16 throughput +) +{ + u8 snding_score = 0; + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + + /*throughput unit is Mbps*/ + if (throughput >= 500) + snding_score = 100; + else if (throughput >= 450) + snding_score = 90; + else if (throughput >= 400) + snding_score = 80; + else if (throughput >= 350) + snding_score = 70; + else if (throughput >= 300) + snding_score = 60; + else if (throughput >= 250) + snding_score = 50; + else if (throughput >= 200) + snding_score = 40; + else if (throughput >= 150) + snding_score = 30; + else if (throughput >= 100) + snding_score = 20; + else if (throughput >= 50) + snding_score = 10; + else + snding_score = 0; + + PHYDM_DBG(p_dm, DBG_TXBF, ("[%s] snding_score = 0x%x\n", __func__, snding_score)); + + return snding_score; + +} + + +#endif +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) +u8 +beamforming_get_htndp_tx_rate( + void *p_dm_void, + u8 comp_steering_num_of_bfer +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 nr_index = 0; + u8 ndp_tx_rate; + /*Find nr*/ +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8814A) + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm), comp_steering_num_of_bfer); + else +#endif + nr_index = tx_bf_nr(1, comp_steering_num_of_bfer); + + switch (nr_index) { + case 1: + ndp_tx_rate = ODM_MGN_MCS8; + break; + + case 2: + ndp_tx_rate = ODM_MGN_MCS16; + break; + + case 3: + ndp_tx_rate = ODM_MGN_MCS24; + break; + + default: + ndp_tx_rate = ODM_MGN_MCS8; + break; + } + + return ndp_tx_rate; + +} + +u8 +beamforming_get_vht_ndp_tx_rate( + void *p_dm_void, + u8 comp_steering_num_of_bfer +) +{ + struct PHY_DM_STRUCT *p_dm = (struct PHY_DM_STRUCT *)p_dm_void; + u8 nr_index = 0; + u8 ndp_tx_rate; + /*Find nr*/ +#if (RTL8814A_SUPPORT == 1) + if (p_dm->support_ic_type & ODM_RTL8814A) + nr_index = tx_bf_nr(hal_txbf_8814a_get_ntx(p_dm), comp_steering_num_of_bfer); + else +#endif + nr_index = tx_bf_nr(1, comp_steering_num_of_bfer); + + switch (nr_index) { + case 1: + ndp_tx_rate = ODM_MGN_VHT2SS_MCS0; + break; + + case 2: + ndp_tx_rate = ODM_MGN_VHT3SS_MCS0; + break; + + case 3: + ndp_tx_rate = ODM_MGN_VHT4SS_MCS0; + break; + + default: + ndp_tx_rate = ODM_MGN_VHT2SS_MCS0; + break; + } + + return ndp_tx_rate; + +} +#endif + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.h index 23c90ab112b0..96809e83d5b5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/phydm/txbf/phydm_hal_txbf_api.h @@ -1,70 +1,65 @@ -/********************************************************************************/ -/**/ -/*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*/ -/**/ -/**/ -/********************************************************************************/ -#ifndef __PHYDM_HAL_TXBF_API_H__ -#define __PHYDM_HAL_TXBF_API_H__ - -#if (defined(CONFIG_BB_TXBF_API)) - -#if (DM_ODM_SUPPORT_TYPE != ODM_AP) -#define TxBF_Nr(a, b) ((a > b) ? (b) : (a)) - -u1Byte -Beamforming_GetHTNDPTxRate( - IN PVOID pDM_VOID, - u1Byte CompSteeringNumofBFer -); - -u1Byte -Beamforming_GetVHTNDPTxRate( - IN PVOID pDM_VOID, - u1Byte CompSteeringNumofBFer -); - -#endif - -#if (RTL8822B_SUPPORT == 1) -u1Byte -phydm_get_beamforming_sounding_info( - IN PVOID pDM_VOID, - IN pu2Byte Troughput, - IN u1Byte Total_BFee_Num, - IN pu1Byte TxRate - ); - -u1Byte -phydm_get_ndpa_rate( - IN PVOID pDM_VOID - ); - -u1Byte -phydm_get_mu_bfee_snding_decision( - IN PVOID pDM_VOID, - IN u2Byte Throughput - ); - -#else -#define phydm_get_beamforming_sounding_info(pDM_VOID, Troughput, Total_BFee_Num, TxRate) -#define phydm_get_ndpa_rate(pDM_VOID) -#define phydm_get_mu_bfee_snding_decision(pDM_VOID, Troughput) - -#endif - -#endif -#endif - +/****************************************************************************** + * + * Copyright(c) 2011 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __PHYDM_HAL_TXBF_API_H__ +#define __PHYDM_HAL_TXBF_API_H__ + +#if (defined(CONFIG_BB_TXBF_API)) + +#if (DM_ODM_SUPPORT_TYPE != ODM_AP) +#define tx_bf_nr(a, b) ((a > b) ? (b) : (a)) + +u8 +beamforming_get_htndp_tx_rate( + void *p_dm_void, + u8 comp_steering_num_of_bfer +); + +u8 +beamforming_get_vht_ndp_tx_rate( + void *p_dm_void, + u8 comp_steering_num_of_bfer +); + +#endif + +#if (RTL8822B_SUPPORT == 1) +u8 +phydm_get_beamforming_sounding_info( + void *p_dm_void, + u16 *troughput, + u8 total_bfee_num, + u8 *tx_rate +); + +u8 +phydm_get_ndpa_rate( + void *p_dm_void +); + +u8 +phydm_get_mu_bfee_snding_decision( + void *p_dm_void, + u16 throughput +); + +#else +#define phydm_get_beamforming_sounding_info(p_dm_void, troughput, total_bfee_num, tx_rate) +#define phydm_get_ndpa_rate(p_dm_void) +#define phydm_get_mu_bfee_snding_decision(p_dm_void, troughput) + +#endif + +#endif +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/Hal8723DPwrSeq.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/Hal8723DPwrSeq.c index f2721cfedd4c..8e99a0b5cb49 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/Hal8723DPwrSeq.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/Hal8723DPwrSeq.c @@ -1,25 +1,18 @@ +/****************************************************************************** + * + * Copyright(c) Semiconductor - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ -/*++ -Copyright (c) Realtek Semiconductor Corp. All rights reserved. - -Module Name: - Hal8821PwrSeq.c - -Abstract: - This file includes all kinds of Power Action event for RTL8821A and corresponding hardware configurtions which are released from HW SD. - -Major Change History: - When Who What - ---------- --------------- ------------------------------- - 2011-08-08 Roger Create. - ---*/ - -#include "Mp_Precomp.h" - -#if WPP_SOFTWARE_TRACE - #include "Hal8723DPwrSeq.tmh" -#endif #include "Hal8723DPwrSeq.h" diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.c index 4afa0f7ac274..54d5b4d21a1e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.c @@ -1,6 +1,6 @@ /****************************************************************************** * -* Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. +* Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,6 @@ * 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 -* -* ******************************************************************************/ #ifdef CONFIG_RTL8723D @@ -27,21 +22,21 @@ #if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) u8 array_mp_8723d_fw_ap[] = { -0xD1, 0x23, 0x20, 0x00, 0x1B, 0x00, 0x00, 0x00, -0x12, 0x07, 0x14, 0x07, 0x16, 0x5D, 0x02, 0x00, +0xD1, 0x23, 0x20, 0x00, 0x27, 0x00, 0x00, 0x00, +0x09, 0x15, 0x17, 0x38, 0xAE, 0x5D, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x85, 0xA9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xB9, 0x68, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xB8, 0xA5, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC7, 0x30, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xC5, 0x63, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC4, 0x9A, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC5, 0x2E, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xC6, 0xDA, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xBE, 0xAA, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xBB, 0x8E, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xC5, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, @@ -158,7 +153,7 @@ u8 array_mp_8723d_fw_ap[] = { 0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, -0x76, 0x30, 0x90, 0x86, 0xBC, 0x74, 0x01, 0x93, +0x76, 0x30, 0x90, 0x86, 0xC0, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, @@ -177,7 +172,7 @@ u8 array_mp_8723d_fw_ap[] = { 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -0x04, 0x90, 0x86, 0xBC, 0x93, 0xF6, 0x08, 0xEF, +0x04, 0x90, 0x86, 0xC0, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, @@ -243,1413 +238,1171 @@ u8 array_mp_8723d_fw_ap[] = { 0x74, 0x01, 0x93, 0x70, 0x0D, 0xA3, 0xA3, 0x93, 0xF8, 0x74, 0x01, 0x93, 0xF5, 0x82, 0x88, 0x83, 0xE4, 0x73, 0x74, 0x02, 0x93, 0x68, 0x60, 0xEF, -0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x41, 0x96, 0xC5, -0x00, 0x44, 0x96, 0x83, 0x41, 0x4E, 0x59, 0x00, -0x44, 0x96, 0x7F, 0x61, 0x6E, 0x79, 0x00, 0x41, -0x96, 0xC7, 0x00, 0x00, 0xBE, 0x6E, 0xC0, 0x7F, -0x8B, 0xB1, 0x90, 0x96, 0xC2, 0xEF, 0xF0, 0x7F, -0x02, 0xB1, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0xFF, -0x90, 0x96, 0xC2, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, -0x86, 0xAF, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, -0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, -0x2E, 0x90, 0x86, 0xB4, 0xF0, 0xF1, 0xA8, 0xFF, -0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0x2D, 0xFF, -0xED, 0x2F, 0x90, 0x86, 0xB6, 0xF1, 0x3E, 0xFF, -0xED, 0x2F, 0x90, 0x86, 0xB7, 0xF1, 0x8C, 0xFF, -0xED, 0x2F, 0x90, 0x86, 0xB8, 0xF1, 0x23, 0xFF, -0xED, 0x2F, 0x90, 0x86, 0xB9, 0xF1, 0x34, 0xFF, -0xAE, 0x05, 0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, -0x22, 0x4E, 0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, -0x02, 0x1F, 0x90, 0x94, 0xC3, 0xF0, 0x90, 0x00, -0x02, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x06, -0x02, 0x02, 0x1F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -0x00, 0x03, 0x02, 0x02, 0x1F, 0x12, 0x02, 0x06, -0xFE, 0xF1, 0x2E, 0xFF, 0x74, 0xD6, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x8D, 0xF1, 0x3B, 0xFF, 0x74, -0xC6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF1, -0x89, 0xFF, 0x74, 0x18, 0x2E, 0xF1, 0x9B, 0xEF, -0xF0, 0x74, 0xC6, 0x2E, 0xF1, 0x93, 0xE0, 0x30, -0xE5, 0x16, 0x75, 0xF0, 0x12, 0xEE, 0xF1, 0xC6, -0x13, 0x13, 0x54, 0x03, 0xFB, 0xAF, 0x06, 0x74, -0xD6, 0x2E, 0xF1, 0xD2, 0xFD, 0x12, 0x6B, 0xFD, -0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x04, -0x02, 0x02, 0x1F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x96, -0xF5, 0x83, 0x22, 0x90, 0x94, 0xC1, 0xD1, 0x6D, -0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0x12, 0x02, -0x06, 0x90, 0x93, 0x25, 0xF0, 0xF1, 0xA8, 0x90, -0x93, 0x26, 0xF1, 0x2D, 0x90, 0x93, 0x27, 0xF0, -0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, -0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x74, 0xD6, -0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -0x83, 0xE0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0xF1, -0xA8, 0xF1, 0x2A, 0x90, 0x94, 0xC4, 0xF1, 0x3E, -0x90, 0x94, 0xC5, 0xF1, 0x8C, 0x90, 0x94, 0xC6, -0xF1, 0x23, 0x90, 0x94, 0xC7, 0xF1, 0x34, 0x90, -0x94, 0xC8, 0xF0, 0xEF, 0xD1, 0x7F, 0x88, 0x1A, -0x00, 0x88, 0x26, 0x01, 0x88, 0x2E, 0x02, 0x88, -0x35, 0x03, 0x88, 0x3C, 0x04, 0x88, 0x44, 0x05, -0x88, 0x4E, 0x06, 0x88, 0x77, 0x07, 0x00, 0x00, -0x88, 0xD1, 0x90, 0x94, 0xC1, 0x74, 0x02, 0xF0, -0xA3, 0x74, 0x29, 0xF0, 0x01, 0xD6, 0x12, 0xDD, -0x0C, 0x74, 0x2A, 0xF0, 0x01, 0xD6, 0x91, 0x27, -0x74, 0x31, 0xF0, 0x01, 0xD6, 0x91, 0x27, 0x74, -0x32, 0xF0, 0x01, 0xD6, 0x12, 0xDD, 0x0C, 0x74, -0x33, 0xF0, 0x01, 0xD6, 0xF1, 0xEA, 0x90, 0x8A, -0x83, 0x12, 0xA5, 0x4E, 0x01, 0xED, 0x90, 0x94, -0xC3, 0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, 0x94, -0xC4, 0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, 0x94, -0xC5, 0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, 0x94, -0xC6, 0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, 0x94, -0xC7, 0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, 0x90, -0x94, 0xC3, 0xE0, 0x90, 0x94, 0xAC, 0xF0, 0x90, -0x94, 0xC6, 0x11, 0xF1, 0x78, 0x10, 0x12, 0x03, -0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0x11, 0xF0, 0x78, 0x18, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x94, 0xC5, 0x11, 0xF1, -0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, -0x12, 0xD2, 0xB5, 0x90, 0x94, 0xC4, 0x11, 0xF1, -0x12, 0x86, 0x54, 0x90, 0x94, 0xA2, 0x02, 0x04, -0x31, 0x91, 0x27, 0x74, 0xFF, 0xF0, 0x90, 0x94, -0xC2, 0xE0, 0xFF, 0x90, 0x94, 0xC1, 0xE0, 0xFD, -0xF1, 0xEA, 0x90, 0x8A, 0xCF, 0xE0, 0xF8, 0xA3, -0xE0, 0xF5, 0x82, 0x88, 0x83, 0x02, 0x04, 0x7E, -0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, -0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, -0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, 0x51, -0x33, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x04, -0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, 0xE0, -0x64, 0x08, 0x70, 0x21, 0x90, 0x88, 0xE6, 0xE0, -0x30, 0xE0, 0x15, 0x12, 0x9B, 0xAD, 0xF0, 0xE4, -0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, -0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, -0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0xA5, 0x25, -0x54, 0x03, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, -0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, -0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, -0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0x21, 0xE0, -0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, -0x61, 0x11, 0xF1, 0x12, 0xD2, 0xB0, 0x90, 0x05, -0x60, 0x11, 0xF1, 0x12, 0x86, 0x54, 0xC0, 0x04, -0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, -0x62, 0x11, 0xF1, 0x78, 0x10, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x11, 0xF0, 0x78, 0x18, 0x12, -0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0x12, 0x86, 0x54, 0x90, 0x88, 0x81, -0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, -0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0C, 0x12, -0xB0, 0xFF, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, -0x12, 0xB7, 0x2D, 0x90, 0x88, 0x32, 0xF1, 0xDA, -0x30, 0xE0, 0x0D, 0x90, 0x01, 0x3B, 0xE0, 0x30, -0xE4, 0x06, 0x12, 0xAF, 0x96, 0x12, 0xB7, 0x1E, -0x12, 0xBC, 0x14, 0xBF, 0x03, 0x14, 0x90, 0x93, -0x4A, 0xE0, 0xB4, 0x01, 0x0D, 0x90, 0x01, 0xB8, -0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, 0xE0, 0x44, -0x80, 0xF0, 0x90, 0x8A, 0xE5, 0x91, 0xA3, 0x7F, -0x01, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x29, 0xE0, -0x30, 0xE0, 0x06, 0xF1, 0xF9, 0xF1, 0x5F, 0xF1, -0xF1, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x01, 0x11, -0x12, 0xAF, 0x18, 0x20, 0xE0, 0x0B, 0xEF, 0xC4, -0x13, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x12, 0xDB, -0x10, 0x22, 0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, -0x90, 0x86, 0x0C, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, -0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xC6, 0xED, -0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, -0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0x61, 0xAC, -0xEE, 0x12, 0x94, 0xA8, 0x30, 0xE0, 0x02, 0x61, -0xAC, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, -0x02, 0x61, 0xAC, 0xEF, 0x70, 0x02, 0x61, 0x0B, -0x24, 0xFE, 0x70, 0x02, 0x61, 0x50, 0x24, 0xFE, -0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0x61, 0x95, -0x24, 0xFC, 0x60, 0x02, 0x61, 0xA5, 0xEE, 0xB4, -0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, -0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, -0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, -0x11, 0x90, 0x96, 0xC6, 0xE0, 0xFF, 0x60, 0x05, -0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, 0xED, -0x51, 0x33, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, -0x60, 0x02, 0x61, 0xA5, 0x12, 0x7B, 0xCC, 0x61, -0xA5, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, -0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, -0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, -0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, -0x51, 0x33, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, -0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, -0x61, 0xA5, 0x90, 0x86, 0x00, 0x51, 0x33, 0xEF, -0x64, 0x01, 0x60, 0x02, 0x61, 0xA5, 0x12, 0x68, -0xC2, 0x61, 0xA5, 0x90, 0x88, 0x39, 0xE0, 0xB4, -0x0E, 0x0B, 0x90, 0x86, 0x00, 0x51, 0x33, 0xBF, -0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, -0x00, 0x51, 0x33, 0xBF, 0x01, 0x03, 0x12, 0x68, -0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, -0x64, 0x90, 0x86, 0x02, 0x51, 0x33, 0xEF, 0x64, -0x01, 0x70, 0x5A, 0x12, 0x73, 0x5A, 0x80, 0x55, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, -0x86, 0x00, 0x51, 0x33, 0xBF, 0x01, 0x03, 0x12, -0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, -0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, -0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x51, 0x33, -0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, -0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, -0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, -0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x0C, 0x09, 0x12, 0xAF, 0xAE, 0x30, -0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, -0x12, 0xDC, 0x51, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, -0x85, 0x4E, 0x90, 0x95, 0x43, 0xEF, 0xF0, 0x60, -0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, -0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, -0xE0, 0x0F, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, -0xF0, 0xE4, 0xFF, 0x12, 0xBA, 0x31, 0x12, 0xC9, -0x38, 0x91, 0x1E, 0x30, 0xE1, 0x08, 0x54, 0xFD, -0xF0, 0x90, 0x86, 0x08, 0x51, 0x33, 0x91, 0x1E, -0x30, 0xE2, 0x08, 0x54, 0xFB, 0xF0, 0x90, 0x86, -0x0A, 0x51, 0x33, 0x91, 0x1E, 0xFF, 0x30, 0xE5, -0x0C, 0x54, 0xDF, 0xF0, 0x12, 0x9D, 0xFC, 0xBF, -0x01, 0x03, 0x12, 0xD4, 0x21, 0x91, 0x1E, 0x30, -0xE6, 0x08, 0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, -0x51, 0x33, 0xD2, 0xAF, 0x80, 0xA3, 0xD2, 0xAF, -0xC2, 0xAF, 0x90, 0x86, 0xAF, 0xE0, 0x22, 0x90, -0x94, 0xC1, 0x74, 0x01, 0xF0, 0xA3, 0x22, 0x90, -0x93, 0x29, 0xE0, 0x30, 0xE0, 0x5A, 0xC4, 0x54, -0x0F, 0x20, 0xE0, 0x1B, 0xF1, 0xF9, 0xF1, 0x5F, -0x90, 0x8A, 0xF9, 0x91, 0xA3, 0x51, 0x2A, 0x12, -0x9F, 0xB4, 0x30, 0xE0, 0x08, 0x90, 0x8A, 0x89, -0x91, 0xA3, 0x12, 0x9F, 0xAD, 0xE1, 0xF1, 0x90, -0x93, 0x29, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -0x2F, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, -0x2C, 0xF1, 0x5F, 0x90, 0x93, 0x29, 0xE0, 0x54, -0xEF, 0xF0, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0C, -0x90, 0x8A, 0x89, 0x91, 0xA3, 0x7D, 0x04, 0x7F, -0x01, 0x02, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x91, -0xA3, 0x7D, 0x31, 0x12, 0xA7, 0xCF, 0x51, 0x33, -0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, -0x90, 0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, -0x82, 0x8E, 0x83, 0x22, 0x90, 0x94, 0xC1, 0xEF, -0xF0, 0xD1, 0xFC, 0x7F, 0xF4, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x08, -0xE0, 0x90, 0x95, 0x0A, 0xF0, 0xD1, 0xFC, 0x7F, -0xF5, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x08, 0x90, 0x95, 0x08, 0xE0, 0x90, 0x95, 0x0B, -0xF0, 0xD1, 0xFC, 0x7F, 0xF6, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x08, -0xE0, 0x90, 0x95, 0x0C, 0xF0, 0xD1, 0xFC, 0x7F, -0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x08, 0x90, 0x95, 0x08, 0xE0, 0x90, 0x95, 0x0D, -0xF0, 0xD1, 0xFC, 0x7F, 0xF8, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x08, -0xE0, 0x90, 0x95, 0x0E, 0xF0, 0xD1, 0xFC, 0x12, -0xBF, 0xC1, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x08, -0xE0, 0x90, 0x95, 0x0F, 0xF0, 0xD1, 0xFC, 0x7F, -0xFB, 0xF1, 0xE1, 0x70, 0x52, 0x90, 0x95, 0x08, -0xE0, 0x90, 0x95, 0x10, 0xF0, 0x54, 0x07, 0x60, -0x08, 0x90, 0x95, 0x08, 0xE0, 0x54, 0xE0, 0x70, -0x3E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x09, 0x7F, -0xFA, 0xF1, 0xE1, 0x70, 0x32, 0x90, 0x95, 0x08, -0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, 0x95, -0x10, 0xE0, 0xFE, 0x90, 0x95, 0x09, 0xE0, 0x54, -0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x95, 0x10, 0xF0, -0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x95, 0x10, -0xE0, 0xFF, 0x90, 0x95, 0x09, 0xE0, 0x54, 0xE0, -0xFE, 0xEF, 0x4E, 0x90, 0x95, 0x10, 0xF0, 0xD1, -0xFC, 0x7F, 0xFD, 0xF1, 0xE1, 0x70, 0x47, 0x90, -0x95, 0x08, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x95, -0x11, 0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, -0x90, 0x95, 0x08, 0xE0, 0x54, 0xC0, 0x70, 0x2E, -0xEF, 0x70, 0x12, 0x90, 0x95, 0x11, 0xE0, 0xFF, -0x90, 0x95, 0x08, 0xE0, 0x54, 0x03, 0x12, 0xDC, -0xE5, 0x90, 0x95, 0x11, 0xF0, 0x90, 0x95, 0x08, -0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x95, -0x11, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, -0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0xD1, 0xFC, -0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x95, 0x08, 0xE0, 0x90, 0x95, -0x12, 0xF0, 0xD1, 0xFC, 0x7F, 0xF1, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -0x08, 0xE0, 0x90, 0x95, 0x13, 0xF0, 0xD1, 0xFC, -0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x95, 0x08, 0xE0, 0x90, 0x95, -0x14, 0xF0, 0xD1, 0xFC, 0x7F, 0xF3, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -0x08, 0xE0, 0x90, 0x95, 0x15, 0xF0, 0xD1, 0xFC, -0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x95, 0x08, 0xE0, 0x90, 0x95, -0x16, 0xF0, 0x90, 0x94, 0xC2, 0x74, 0x19, 0xF0, -0x90, 0x94, 0xE4, 0x74, 0x08, 0xF0, 0x90, 0x95, -0x0A, 0xE0, 0x90, 0x94, 0xC4, 0xF0, 0x90, 0x95, -0x0B, 0xE0, 0x90, 0x94, 0xC5, 0xF0, 0x90, 0x95, -0x0C, 0xE0, 0x90, 0x94, 0xC6, 0xF0, 0x90, 0x95, -0x0D, 0xE0, 0x90, 0x94, 0xC7, 0xF0, 0x90, 0x95, -0x0E, 0xE0, 0x90, 0x94, 0xC8, 0xF0, 0x90, 0x95, -0x0F, 0xE0, 0x90, 0x94, 0xC9, 0xF0, 0x90, 0x95, -0x10, 0xE0, 0x90, 0x94, 0xCA, 0xF0, 0x90, 0x95, -0x11, 0xE0, 0x90, 0x94, 0xCB, 0xF0, 0x90, 0x94, -0xE5, 0x74, 0x1A, 0xF0, 0x90, 0x95, 0x07, 0x74, -0x05, 0xF0, 0x90, 0x95, 0x12, 0xE0, 0x90, 0x94, -0xE7, 0xF0, 0x90, 0x95, 0x13, 0xE0, 0x90, 0x94, -0xE8, 0xF0, 0x90, 0x95, 0x14, 0xE0, 0x90, 0x94, -0xE9, 0xF0, 0x90, 0x95, 0x15, 0xE0, 0x90, 0x94, -0xEA, 0xF0, 0x90, 0x95, 0x16, 0xE0, 0x90, 0x94, -0xEB, 0xF0, 0x90, 0x94, 0xC1, 0xE0, 0xB4, 0x01, -0x19, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xC2, 0x12, -0xA5, 0x4B, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, -0x94, 0x79, 0xE5, 0x91, 0x91, 0x7F, 0x04, 0x02, -0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, -0x75, 0x47, 0xC2, 0x75, 0x48, 0x0A, 0x7B, 0x01, -0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, 0x75, -0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0xE7, -0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, -0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x95, -0x79, 0x08, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, -0x04, 0x03, 0x12, 0xB7, 0x5D, 0x90, 0x88, 0x9D, -0xE0, 0x20, 0xE0, 0x41, 0x90, 0x88, 0x36, 0xE0, -0x64, 0x01, 0x70, 0x39, 0x90, 0x8A, 0xD7, 0x51, -0x33, 0x12, 0xAF, 0x9E, 0x60, 0x1D, 0x90, 0x8A, -0xB9, 0x91, 0xA3, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, -0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x91, 0xA3, 0x12, -0xB0, 0xB3, 0x90, 0x8B, 0x01, 0x12, 0x9F, 0xC2, -0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, -0x0C, 0x90, 0x8A, 0xB9, 0x91, 0xA3, 0x7D, 0x01, -0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xF0, 0xE4, -0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, -0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, -0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, 0xE4, 0xF5, -0x7A, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x5A, 0x12, -0xAF, 0xA5, 0x70, 0x55, 0x12, 0xDB, 0x65, 0x75, -0x7A, 0x01, 0xE5, 0x7A, 0x60, 0x4B, 0x90, 0x88, -0x39, 0xE0, 0x20, 0xE2, 0x0C, 0x90, 0x8A, 0xB9, -0x91, 0xA3, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, -0x7E, 0x12, 0x9F, 0xDA, 0x90, 0x88, 0x3F, 0xE0, -0x60, 0x04, 0x64, 0x01, 0x70, 0x0F, 0xF1, 0xD2, -0xFF, 0xA3, 0xE0, 0x2F, 0xF1, 0x60, 0xF1, 0xD7, -0xFF, 0xA3, 0xE0, 0x80, 0x0D, 0xF1, 0xD2, 0x12, -0xDB, 0x06, 0x2F, 0xF1, 0x60, 0xF1, 0xD7, 0x12, -0xDB, 0x06, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, -0x90, 0x88, 0x4F, 0xF0, 0x90, 0x8A, 0xD7, 0x51, -0x33, 0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, -0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, -0x22, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x64, -0x01, 0x22, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xC3, -0x22, 0x90, 0x93, 0x29, 0xE0, 0x44, 0x10, 0xF0, -0x22, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, -0x2B, 0x22, 0xF1, 0xC2, 0x90, 0x93, 0x4C, 0xE0, -0x70, 0x12, 0x11, 0xC3, 0x12, 0x02, 0x06, 0x13, +0xA3, 0xA3, 0xA3, 0x80, 0xDF, 0x41, 0x96, 0xCA, +0x00, 0x41, 0x96, 0xCF, 0x00, 0x44, 0x96, 0x95, +0x41, 0x4E, 0x59, 0x00, 0x44, 0x96, 0x91, 0x61, +0x6E, 0x79, 0x00, 0x41, 0x96, 0xD2, 0x00, 0x00, +0xBF, 0x01, 0xC1, 0x7F, 0x8A, 0x4D, 0x90, 0x96, +0xC9, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, 0x90, +0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x96, 0xC9, 0xE0, +0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, +0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x02, 0x06, +0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, 0xB4, +0xF0, 0x12, 0x98, 0xAC, 0xFF, 0xED, 0x2F, 0x90, +0x86, 0xB5, 0xF1, 0xE9, 0xFF, 0xED, 0x2F, 0x90, +0x86, 0xB6, 0xF1, 0xF3, 0xFF, 0xED, 0x2F, 0x90, +0x86, 0xB7, 0xF1, 0xFD, 0xFF, 0xED, 0x2F, 0x90, +0x86, 0xB8, 0xF1, 0x29, 0xFF, 0xED, 0x2F, 0x90, +0x86, 0xB9, 0x12, 0xA7, 0xD8, 0xFF, 0xAE, 0x05, +0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x4E, +0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, +0x12, 0x9F, 0xE9, 0x12, 0x8A, 0xC6, 0xFF, 0x54, +0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0x12, 0x8F, +0xF1, 0xA3, 0xF0, 0x12, 0x98, 0xAC, 0xFD, 0x54, +0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, +0xE0, 0x54, 0xF0, 0x4F, 0xF1, 0xF3, 0xFC, 0x54, +0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, +0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, +0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, +0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, +0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0xF1, 0xE8, 0x90, +0x88, 0x35, 0xF1, 0xFD, 0xFD, 0x90, 0x8A, 0x89, +0x12, 0x8B, 0x46, 0x7F, 0x02, 0x12, 0x04, 0x7E, +0x90, 0x94, 0xB6, 0xD1, 0x6D, 0xF1, 0x2A, 0xFF, +0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, 0x12, 0xDC, +0xB2, 0xF1, 0x28, 0xFE, 0x12, 0xDD, 0x47, 0x90, +0x88, 0x9B, 0x12, 0xDD, 0x74, 0xF1, 0x27, 0x12, +0xDD, 0x3D, 0x90, 0x88, 0x9B, 0x12, 0xDD, 0x6B, +0xF1, 0x27, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, +0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0x5C, 0x5F, +0x90, 0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, +0x88, 0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xBD, +0xBC, 0xF0, 0x90, 0x88, 0x36, 0x12, 0xDC, 0xEB, +0x12, 0xA7, 0xE7, 0x90, 0x01, 0xBE, 0xF0, 0x22, +0x4F, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, +0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x03, 0x02, +0x02, 0x1F, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, +0x04, 0x02, 0x02, 0x1F, 0x12, 0x9F, 0xE9, 0x90, +0x93, 0x4C, 0xE0, 0x70, 0x0F, 0x51, 0xC6, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, 0x93, 0x52, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x4E, 0xE0, -0x70, 0x12, 0x11, 0xC3, 0x12, 0x02, 0x06, 0xC4, -0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, -0x53, 0x74, 0x01, 0xF0, 0x12, 0x87, 0xA3, 0xFF, -0x90, 0x94, 0xC5, 0xF0, 0x12, 0x02, 0x06, 0xC3, -0x13, 0x30, 0xE0, 0x0B, 0x11, 0xC3, 0x12, 0x87, -0x2E, 0x90, 0x94, 0xC6, 0xF0, 0x80, 0x05, 0x90, -0x94, 0xC6, 0xEF, 0xF0, 0x90, 0x94, 0xC5, 0xE0, -0x90, 0x94, 0xC4, 0xF0, 0x90, 0x94, 0xC6, 0xE0, -0xFE, 0x90, 0x94, 0xC4, 0xE0, 0xFF, 0xD3, 0x9E, -0x50, 0x34, 0x11, 0xC3, 0x12, 0x02, 0x06, 0x54, -0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x94, 0xC4, -0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x94, -0xC4, 0x70, 0x06, 0xE0, 0xFF, 0xF1, 0x74, 0x80, -0x04, 0xE0, 0xFF, 0xF1, 0xCF, 0x90, 0x93, 0x53, -0xE0, 0x60, 0x07, 0x90, 0x94, 0xC4, 0xE0, 0xFF, -0xF1, 0x74, 0xF1, 0xC8, 0x80, 0xBE, 0x90, 0x05, -0x5E, 0xE4, 0xF0, 0x90, 0x94, 0xC5, 0xE0, 0x70, -0x19, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x12, -0x12, 0x8A, 0x30, 0x90, 0x8A, 0xED, 0x12, 0x8A, -0x33, 0x12, 0xA7, 0xC7, 0x54, 0xBF, 0xF0, 0x54, -0x7F, 0xF0, 0x22, 0x90, 0x94, 0xC1, 0x02, 0x86, -0x6D, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0xF1, 0xC2, 0x12, 0xB7, 0x25, 0x90, 0x88, 0x9D, -0x12, 0xB7, 0x6B, 0xF0, 0xFC, 0x12, 0x02, 0x06, -0xFD, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xFF, -0x90, 0x94, 0xA1, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, -0xED, 0x54, 0x08, 0xFF, 0xEC, 0x54, 0xF7, 0x4F, -0xFF, 0x90, 0x88, 0x9D, 0xF0, 0x12, 0x02, 0x06, -0x12, 0xDC, 0xCA, 0x90, 0x88, 0x9D, 0xF1, 0xF6, -0x4E, 0x12, 0xAF, 0x02, 0x54, 0x40, 0xFD, 0xEF, -0x54, 0xBF, 0x4D, 0xFF, 0x90, 0x88, 0x9D, 0xF0, -0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x4E, -0xF0, 0x11, 0xC3, 0xE9, 0x24, 0x01, 0xF9, 0xE4, -0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, -0x48, 0x04, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9E, -0x12, 0x69, 0xF5, 0x11, 0xC3, 0x12, 0x02, 0x06, -0x20, 0xE0, 0x02, 0x41, 0xF2, 0x90, 0x05, 0x54, +0x70, 0x0F, 0x51, 0xC6, 0xC4, 0x54, 0x0F, 0xFF, +0xBF, 0x05, 0x06, 0x90, 0x93, 0x53, 0x74, 0x01, +0xF0, 0x12, 0x98, 0xA6, 0xFF, 0x90, 0x94, 0xBA, +0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, +0x0F, 0x90, 0x94, 0xB6, 0x12, 0x86, 0x6D, 0x12, +0x87, 0xEA, 0x90, 0x94, 0xBB, 0xF0, 0x80, 0x05, +0x90, 0x94, 0xBB, 0xEF, 0xF0, 0x90, 0x94, 0xBA, +0xE0, 0x90, 0x94, 0xB9, 0xF0, 0x90, 0x94, 0xBB, +0xE0, 0xFE, 0x90, 0x94, 0xB9, 0xE0, 0xFF, 0xD3, +0x9E, 0x50, 0x36, 0x51, 0xC6, 0x54, 0x01, 0xFD, +0x12, 0x6E, 0x71, 0x90, 0x94, 0xB9, 0xE0, 0xFF, +0x12, 0x78, 0x4A, 0xEF, 0x90, 0x94, 0xB9, 0x70, +0x06, 0xE0, 0xFF, 0xF1, 0xF8, 0x80, 0x05, 0xE0, +0xFF, 0x12, 0xB8, 0x14, 0x90, 0x93, 0x53, 0xE0, +0x60, 0x07, 0x90, 0x94, 0xB9, 0xE0, 0xFF, 0xF1, +0xF8, 0x90, 0x94, 0xB9, 0xE0, 0x04, 0xF0, 0x80, +0xBC, 0x90, 0x05, 0x5E, 0xE4, 0xF0, 0x90, 0x94, +0xBA, 0xE0, 0x70, 0x17, 0xFF, 0x12, 0x78, 0x4A, +0xEF, 0x70, 0x10, 0x11, 0xCA, 0x90, 0x8A, 0xED, +0x11, 0xCD, 0x12, 0xDD, 0xA3, 0x54, 0xBF, 0xF0, +0x54, 0x7F, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x12, +0x04, 0x7E, 0x90, 0x86, 0x0C, 0xE0, 0xFE, 0xA3, +0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, +0xD0, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, +0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, +0x41, 0x48, 0xEE, 0xF1, 0xF1, 0x30, 0xE0, 0x02, +0x41, 0x48, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, +0x70, 0x02, 0x41, 0x48, 0xEF, 0x70, 0x02, 0x21, +0xA4, 0x24, 0xFE, 0x70, 0x02, 0x21, 0xE9, 0x24, +0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0x41, +0x2E, 0x24, 0xFC, 0x60, 0x02, 0x41, 0x41, 0xEE, +0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, +0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, +0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, +0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, +0x04, 0x11, 0x90, 0x96, 0xD0, 0xE0, 0xFF, 0x60, +0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, +0xED, 0x11, 0xCD, 0x90, 0x88, 0x39, 0xE0, 0x64, +0x08, 0x60, 0x02, 0x41, 0x41, 0x12, 0x7B, 0xCC, +0x41, 0x41, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, +0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, +0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, +0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, +0x00, 0x11, 0xCD, 0xBF, 0x01, 0x03, 0x12, 0x71, +0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, +0x02, 0x41, 0x41, 0x90, 0x86, 0x00, 0x11, 0xCD, +0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0x41, 0x12, +0x68, 0xC2, 0x41, 0x41, 0x90, 0x88, 0x39, 0xE0, +0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xCD, +0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, +0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, +0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, +0x86, 0x00, 0x11, 0xCD, 0xBF, 0x01, 0x03, 0x12, +0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, +0x70, 0x67, 0x90, 0x86, 0x02, 0x11, 0xCD, 0xEF, +0x64, 0x01, 0x70, 0x5D, 0x12, 0x73, 0x5A, 0x80, +0x58, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, +0x90, 0x86, 0x00, 0x11, 0xCD, 0xBF, 0x01, 0x03, +0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, +0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, +0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x11, +0xCD, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, +0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, +0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, +0x18, 0x12, 0x7A, 0x49, 0x80, 0x13, 0x90, 0x88, +0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x88, 0x32, +0x12, 0xAF, 0x0F, 0x30, 0xE0, 0x03, 0x12, 0x79, +0xD4, 0x90, 0x88, 0x39, 0x12, 0xDC, 0xEB, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFB, 0xFA, +0xFD, 0x7F, 0x01, 0x12, 0x85, 0x4E, 0x90, 0x95, +0x38, 0xEF, 0xF0, 0x60, 0xF0, 0x90, 0x86, 0xAF, +0xE0, 0xFF, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0xE5, +0xC2, 0xAF, 0xEF, 0x30, 0xE0, 0x0F, 0x90, 0x86, +0xAF, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xFF, 0x12, +0xB5, 0xE7, 0x12, 0xC7, 0xB4, 0x51, 0xBE, 0xE0, +0x30, 0xE1, 0x08, 0x54, 0xFD, 0xF0, 0x90, 0x86, +0x08, 0x11, 0xCD, 0x51, 0xBE, 0xE0, 0x30, 0xE2, +0x08, 0x54, 0xFB, 0xF0, 0x90, 0x86, 0x0A, 0x11, +0xCD, 0x51, 0xBE, 0xE0, 0xFF, 0x30, 0xE5, 0x0C, +0x54, 0xDF, 0xF0, 0x12, 0xD4, 0x43, 0xBF, 0x01, +0x03, 0x12, 0xD4, 0xE8, 0x51, 0xBE, 0xE0, 0x30, +0xE6, 0x08, 0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, +0x11, 0xCD, 0xD2, 0xAF, 0x80, 0x9F, 0xD2, 0xAF, +0xC2, 0xAF, 0x90, 0x86, 0xAF, 0x22, 0x90, 0x94, +0xB6, 0x12, 0x86, 0x6D, 0x02, 0x02, 0x06, 0x90, +0x93, 0x29, 0xE0, 0x30, 0xE0, 0x5D, 0xC4, 0x54, +0x0F, 0x20, 0xE0, 0x1D, 0x12, 0xDD, 0x50, 0x12, +0xA7, 0x92, 0x90, 0x8A, 0xF9, 0x71, 0x46, 0x11, +0xC4, 0x12, 0xDD, 0x04, 0x30, 0xE0, 0x07, 0x90, +0x8A, 0x89, 0x71, 0x46, 0xF1, 0xE6, 0x02, 0xAD, +0x94, 0x90, 0x93, 0x29, 0xE0, 0xC4, 0x54, 0x0F, +0x30, 0xE0, 0x30, 0xE4, 0x90, 0x92, 0x20, 0xF0, +0x90, 0x93, 0x2C, 0x12, 0xA7, 0x92, 0x90, 0x93, +0x29, 0xE0, 0x54, 0xEF, 0xF0, 0xE0, 0xC3, 0x13, +0x30, 0xE0, 0x0C, 0x90, 0x8A, 0x89, 0x71, 0x46, +0x7D, 0x04, 0x7F, 0x01, 0x02, 0x04, 0x7E, 0x90, +0x8A, 0xF9, 0x71, 0x46, 0x7D, 0x31, 0x12, 0xD2, +0x82, 0x11, 0xCD, 0x22, 0x90, 0x8A, 0x77, 0xE0, +0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, +0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, 0xFE, +0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0x90, +0x8A, 0xD9, 0x71, 0x46, 0x7F, 0x01, 0x12, 0x04, +0x7E, 0x90, 0x88, 0xA1, 0xF1, 0xF0, 0x30, 0xE0, +0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, +0x71, 0x9A, 0xE4, 0x90, 0x88, 0xAF, 0xF0, 0xA3, +0x12, 0xD4, 0x1D, 0x30, 0xE0, 0x09, 0x90, 0x8A, +0xF9, 0x71, 0x46, 0x7D, 0x0E, 0x80, 0x32, 0x90, +0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, +0x15, 0x12, 0xDD, 0x59, 0x20, 0xE0, 0x06, 0x12, +0xA6, 0xF9, 0x12, 0xDD, 0x85, 0x90, 0x8A, 0xF9, +0x71, 0x46, 0x7D, 0x0F, 0x80, 0x13, 0x90, 0x88, +0x36, 0xE0, 0x60, 0x12, 0x12, 0xA6, 0xF9, 0x12, +0xDD, 0x85, 0x90, 0x8A, 0xF9, 0x71, 0x46, 0x7D, +0x10, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x88, +0xA0, 0xE0, 0x30, 0xE0, 0x08, 0x90, 0x8A, 0xF9, +0x71, 0x46, 0x12, 0xA9, 0x17, 0xF1, 0xED, 0x30, +0xE0, 0x0A, 0x90, 0x8A, 0x97, 0x71, 0x46, 0xE4, +0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xA1, 0xE0, +0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x0E, 0x90, 0x06, +0xCD, 0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x06, 0xCF, +0xE0, 0x54, 0xEF, 0xF0, 0x12, 0xBE, 0x34, 0x30, +0xE0, 0x1C, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, +0xE0, 0x14, 0xEE, 0x44, 0x08, 0xF0, 0xA3, 0xE0, +0xC3, 0x13, 0x54, 0x7F, 0xFF, 0x90, 0x8A, 0xD1, +0x12, 0x9E, 0x75, 0x12, 0x04, 0x7E, 0x90, 0x05, +0x63, 0xE0, 0x90, 0x96, 0xB7, 0xF0, 0x90, 0x05, +0x62, 0xE0, 0x90, 0x96, 0xB6, 0xF0, 0x90, 0x05, +0x61, 0xE0, 0x90, 0x96, 0xB5, 0xF0, 0x90, 0x05, +0x60, 0xE0, 0x90, 0x96, 0xB4, 0xF0, 0xD1, 0xD0, +0x12, 0xD4, 0x27, 0x90, 0x96, 0xB4, 0xD1, 0xD1, +0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, +0x06, 0xC0, 0x07, 0x90, 0x96, 0xB6, 0xD1, 0xD1, +0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, +0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, +0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, +0xD1, 0xD0, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, +0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, +0x86, 0x54, 0x90, 0x94, 0xB0, 0x02, 0x04, 0x31, +0x90, 0x94, 0xB6, 0xEF, 0xF0, 0xD1, 0xC9, 0x7F, +0xF4, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, +0x08, 0x90, 0x94, 0xFD, 0xE0, 0x90, 0x94, 0xFF, +0xF0, 0xD1, 0xC9, 0x7F, 0xF5, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xFD, +0xE0, 0x90, 0x95, 0x00, 0xF0, 0xD1, 0xC9, 0x7F, +0xF6, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, +0x08, 0x90, 0x94, 0xFD, 0xE0, 0x90, 0x95, 0x01, +0xF0, 0xD1, 0xC9, 0x7F, 0xF7, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xFD, +0xE0, 0x90, 0x95, 0x02, 0xF0, 0xD1, 0xC9, 0x7F, +0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, +0x08, 0x90, 0x94, 0xFD, 0xE0, 0x90, 0x95, 0x03, +0xF0, 0xD1, 0xC9, 0x12, 0xDD, 0x9C, 0xBF, 0x01, +0x08, 0x90, 0x94, 0xFD, 0xE0, 0x90, 0x95, 0x04, +0xF0, 0xD1, 0xC9, 0x12, 0xDC, 0xC1, 0x70, 0x53, +0x90, 0x94, 0xFD, 0xE0, 0x90, 0x95, 0x05, 0xF0, +0x54, 0x07, 0x60, 0x08, 0x90, 0x94, 0xFD, 0xE0, +0x54, 0xE0, 0x70, 0x3F, 0x7B, 0x01, 0x7A, 0x94, +0x79, 0xFE, 0x7F, 0xFA, 0x12, 0xDC, 0xC3, 0x70, +0x32, 0x90, 0x94, 0xFD, 0xE0, 0xFC, 0x54, 0x07, +0x70, 0x12, 0x90, 0x95, 0x05, 0xE0, 0xFE, 0x90, +0x94, 0xFE, 0xE0, 0x54, 0x07, 0xFD, 0xEE, 0x4D, +0x90, 0x95, 0x05, 0xF0, 0xEC, 0x54, 0xE0, 0x70, +0x12, 0x90, 0x95, 0x05, 0xE0, 0xFF, 0x90, 0x94, +0xFE, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, +0x95, 0x05, 0xF0, 0xD1, 0xC9, 0x7F, 0xFD, 0x12, +0xDC, 0xC3, 0x70, 0x47, 0x90, 0x94, 0xFD, 0xE0, +0xFE, 0x54, 0xCC, 0x90, 0x95, 0x06, 0xF0, 0xEE, +0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x94, 0xFD, +0xE0, 0x54, 0xC0, 0x70, 0x2E, 0xEF, 0x70, 0x12, +0x90, 0x95, 0x06, 0xE0, 0xFF, 0x90, 0x94, 0xFD, +0xE0, 0x54, 0x03, 0x12, 0xDD, 0x94, 0x90, 0x95, +0x06, 0xF0, 0x90, 0x94, 0xFD, 0xE0, 0xFF, 0x54, +0xC0, 0x70, 0x10, 0x90, 0x95, 0x06, 0xE0, 0xFE, +0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, +0xEE, 0x4F, 0xF0, 0xD1, 0xC9, 0x7F, 0xF0, 0x7E, +0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, +0x94, 0xFD, 0xE0, 0x90, 0x95, 0x07, 0xF0, 0xD1, +0xC9, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, +0xBF, 0x01, 0x08, 0x90, 0x94, 0xFD, 0xE0, 0x90, +0x95, 0x08, 0xF0, 0xD1, 0xC9, 0x7F, 0xF2, 0x7E, +0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, +0x94, 0xFD, 0xE0, 0x90, 0x95, 0x09, 0xF0, 0xD1, +0xC9, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x5F, 0xA6, +0xBF, 0x01, 0x08, 0x90, 0x94, 0xFD, 0xE0, 0x90, +0x95, 0x0A, 0xF0, 0xD1, 0xC9, 0x7F, 0xFC, 0x7E, +0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, +0x94, 0xFD, 0xE0, 0x90, 0x95, 0x0B, 0xF0, 0x90, +0x94, 0xB7, 0x74, 0x19, 0xF0, 0x90, 0x94, 0xD9, +0x74, 0x08, 0xF0, 0x90, 0x94, 0xFF, 0xE0, 0x90, +0x94, 0xB9, 0xF0, 0x90, 0x95, 0x00, 0xE0, 0x90, +0x94, 0xBA, 0xF0, 0x90, 0x95, 0x01, 0xE0, 0x90, +0x94, 0xBB, 0xF0, 0x90, 0x95, 0x02, 0xE0, 0x90, +0x94, 0xBC, 0xF0, 0x90, 0x95, 0x03, 0xE0, 0x90, +0x94, 0xBD, 0xF0, 0x90, 0x95, 0x04, 0xE0, 0x90, +0x94, 0xBE, 0xF0, 0x90, 0x95, 0x05, 0xE0, 0x90, +0x94, 0xBF, 0xF0, 0x90, 0x95, 0x06, 0xE0, 0x90, +0x94, 0xC0, 0xF0, 0x90, 0x94, 0xDA, 0x74, 0x1A, +0xF0, 0x90, 0x94, 0xFC, 0x74, 0x05, 0xF0, 0x90, +0x95, 0x07, 0xE0, 0x90, 0x94, 0xDC, 0xF0, 0x90, +0x95, 0x08, 0xE0, 0x90, 0x94, 0xDD, 0xF0, 0x90, +0x95, 0x09, 0xE0, 0x90, 0x94, 0xDE, 0xF0, 0x90, +0x95, 0x0A, 0xE0, 0x90, 0x94, 0xDF, 0xF0, 0x90, +0x95, 0x0B, 0xE0, 0x90, 0x94, 0xE0, 0xF0, 0x90, +0x94, 0xB6, 0xE0, 0xB4, 0x01, 0x19, 0x7B, 0x01, +0x7A, 0x94, 0x79, 0xB7, 0x12, 0xA4, 0x3F, 0x12, +0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xDA, +0x71, 0x34, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, +0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0xB7, +0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, +0xA0, 0x12, 0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, +0x46, 0x94, 0x75, 0x47, 0xDC, 0x75, 0x48, 0x05, +0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, +0xF5, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xFD, 0x22, +0xA3, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x22, +0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, +0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0xE4, +0x90, 0x94, 0xA1, 0xF0, 0x90, 0x88, 0x35, 0x74, +0x02, 0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, +0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x42, +0xE4, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x88, +0x4E, 0x74, 0x10, 0xF0, 0xA3, 0x74, 0x50, 0xF0, +0x12, 0xDB, 0xED, 0x90, 0x8A, 0x89, 0x71, 0x46, +0x12, 0xA9, 0x17, 0x90, 0x8A, 0x89, 0x71, 0x46, +0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, +0x8A, 0x89, 0x71, 0x46, 0xF1, 0xE6, 0x90, 0x86, +0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x88, +0x41, 0x74, 0xDD, 0xF0, 0x80, 0x18, 0xEF, 0xB4, +0x03, 0x0F, 0x90, 0x88, 0x41, 0x74, 0xF4, 0xF0, +0x90, 0x00, 0x92, 0xE0, 0x54, 0x7F, 0xF0, 0x80, +0x05, 0xE4, 0x90, 0x88, 0x41, 0xF0, 0x90, 0x00, +0x79, 0xE0, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0D, +0x90, 0x00, 0x28, 0xE0, 0x30, 0xE2, 0x06, 0x90, +0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, +0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, +0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, +0x07, 0xF0, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, +0x7B, 0x01, 0x7A, 0x93, 0x79, 0x31, 0x12, 0x04, +0x80, 0x90, 0x8A, 0xA3, 0x71, 0x46, 0x7F, 0x01, +0x12, 0x04, 0x7E, 0x7E, 0x00, 0x7F, 0x02, 0x7D, +0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, 0x12, +0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, 0x7F, +0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, 0xF0, +0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, 0x9C, +0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, +0x1C, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x8A, +0xF9, 0x71, 0x46, 0x11, 0xC4, 0x12, 0xDD, 0x04, +0x30, 0xE0, 0x07, 0x90, 0x8A, 0x89, 0x71, 0x46, +0xF1, 0xE6, 0x12, 0xAD, 0x94, 0x22, 0x7D, 0x0C, +0x7F, 0x01, 0x02, 0x04, 0x7E, 0x90, 0x88, 0xA0, +0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, +0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x96, 0xC1, 0xEF, 0xF0, 0xA3, 0xED, +0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8B, 0x46, 0x7D, +0x44, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x90, 0x8A, +0xFD, 0x12, 0x88, 0xCD, 0x90, 0x96, 0xC2, 0xE0, +0x90, 0x96, 0xC1, 0xB4, 0x01, 0x09, 0xE0, 0x11, +0x48, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x07, 0xE0, +0x11, 0x48, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, +0xF9, 0x12, 0x8B, 0x46, 0x12, 0xA9, 0x17, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFD, 0xE5, 0x0E, +0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, +0x34, 0x81, 0xF5, 0x83, 0x22, 0x8D, 0x0E, 0xEF, +0x30, 0xE6, 0x1E, 0x11, 0xDC, 0x11, 0x44, 0xE0, +0x54, 0x03, 0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, +0xAF, 0x0E, 0x12, 0x75, 0x80, 0x11, 0xCF, 0xE0, +0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x74, 0x01, 0x80, +0x4D, 0x11, 0xEB, 0x04, 0xF0, 0x11, 0xEB, 0x64, +0x02, 0x70, 0x1B, 0x74, 0x1E, 0x25, 0x0E, 0x31, +0xB5, 0xE0, 0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, +0x11, 0xDC, 0xE0, 0xFD, 0x11, 0x46, 0xF1, 0xEA, +0x11, 0xDC, 0x91, 0xBE, 0x80, 0x28, 0x11, 0xEB, +0xD3, 0x94, 0x03, 0x40, 0x17, 0x90, 0x8A, 0xB3, +0x12, 0x8B, 0x46, 0xAF, 0x0E, 0x12, 0x04, 0x7E, +0x11, 0xCF, 0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, +0x74, 0x03, 0x80, 0x0A, 0x11, 0xDC, 0x11, 0x44, +0xF1, 0xEA, 0x11, 0xDC, 0x91, 0xBE, 0xF0, 0xAB, +0x0E, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0x74, +0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x8E, +0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x0E, 0xC4, 0x54, +0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, +0xF5, 0x83, 0x22, 0x74, 0xB6, 0x25, 0x0E, 0xF5, +0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0x22, +0x8F, 0x70, 0x8D, 0x71, 0xEF, 0x11, 0xDE, 0xE0, +0xFD, 0x54, 0x7F, 0xF5, 0x72, 0xED, 0x54, 0x80, +0xF5, 0x73, 0xF1, 0xBB, 0xF5, 0x75, 0x75, 0xF0, +0x12, 0xEF, 0x91, 0xEE, 0xC4, 0x54, 0x03, 0xF5, +0x76, 0x31, 0xB1, 0x74, 0xFF, 0xF0, 0x31, 0xBD, +0xE5, 0x73, 0x4D, 0xFF, 0x91, 0xDD, 0xEF, 0xF0, +0xE5, 0x70, 0x11, 0x48, 0xE0, 0x54, 0x03, 0xF5, +0x74, 0x74, 0x46, 0x25, 0x70, 0x12, 0xC7, 0x79, +0xE5, 0x74, 0xF0, 0xE5, 0x72, 0x65, 0x75, 0x70, +0x22, 0x75, 0xF0, 0x12, 0xE5, 0x70, 0xF1, 0xB3, +0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0B, 0xE5, +0x73, 0x70, 0x07, 0xE5, 0x72, 0x44, 0x80, 0xFD, +0x80, 0x4A, 0x31, 0xBD, 0x7D, 0x07, 0xAF, 0x70, +0x02, 0xB7, 0x4E, 0xE5, 0x72, 0xC3, 0x95, 0x75, +0x50, 0x34, 0xAB, 0x70, 0xAD, 0x75, 0xAF, 0x72, +0x12, 0x72, 0x7F, 0xAD, 0x07, 0xE5, 0x72, 0xC3, +0x94, 0x0C, 0x40, 0x28, 0x75, 0xF0, 0x12, 0xE5, +0x70, 0xF1, 0xB3, 0xFE, 0xC4, 0x13, 0x54, 0x07, +0x30, 0xE0, 0x19, 0xE5, 0x71, 0x60, 0x15, 0xE5, +0x73, 0x70, 0x11, 0xE5, 0x72, 0x44, 0x80, 0xFD, +0x31, 0xB1, 0xEF, 0xF0, 0x80, 0x06, 0x91, 0xDD, +0xE5, 0x75, 0xF0, 0xFD, 0x90, 0x92, 0x80, 0xE5, +0x74, 0xF0, 0xAB, 0x71, 0xAF, 0x70, 0x02, 0x75, +0x80, 0x74, 0x1E, 0x25, 0x70, 0xF5, 0x82, 0xE4, +0x34, 0x96, 0xF5, 0x83, 0x22, 0xE5, 0x72, 0x25, +0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, +0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, 0x01, 0x93, +0xFF, 0xE5, 0x70, 0x25, 0xE0, 0x24, 0x75, 0xF5, +0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xEE, 0xF0, +0xA3, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0x90, 0x96, 0x7B, 0x12, 0xDD, +0x62, 0x12, 0xD1, 0x46, 0x90, 0x96, 0x86, 0xF0, +0xE4, 0x90, 0x96, 0x83, 0xF0, 0x90, 0x96, 0x7B, +0x12, 0xAD, 0x9F, 0x90, 0x96, 0x7E, 0xF0, 0xEF, +0x54, 0x07, 0x90, 0x96, 0x80, 0xF0, 0x90, 0x96, +0x7B, 0xE0, 0x71, 0xEF, 0xE0, 0x90, 0x96, 0x81, +0xF0, 0xF1, 0xBB, 0x54, 0x7F, 0x90, 0x96, 0x84, +0xF0, 0x90, 0x96, 0x7B, 0xE0, 0xF1, 0xC7, 0xE0, +0x90, 0x96, 0x85, 0xF0, 0xED, 0x54, 0x7F, 0x90, +0x96, 0x7F, 0xF0, 0xEB, 0x70, 0x20, 0x90, 0x89, +0x3D, 0x91, 0xB6, 0xFF, 0x12, 0xDC, 0xF8, 0xFD, +0x90, 0x89, 0x40, 0x91, 0xC7, 0x2D, 0xFF, 0xE4, +0x35, 0xF0, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, +0x90, 0x96, 0x7B, 0xE0, 0x31, 0xD3, 0x90, 0x96, +0x84, 0xE0, 0xFF, 0x90, 0x96, 0x7F, 0xE0, 0xFE, +0xD3, 0x9F, 0x40, 0x0C, 0x90, 0x96, 0x7C, 0xE0, +0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF0, 0x80, 0x0F, +0x90, 0x96, 0x85, 0xE0, 0xFF, 0xEE, 0xC3, 0x9F, +0x50, 0x05, 0x90, 0x96, 0x7C, 0xEF, 0xF0, 0x90, +0x96, 0x7C, 0xE0, 0xFE, 0x54, 0x7F, 0x90, 0x96, +0x7F, 0xF0, 0xEE, 0x54, 0x80, 0x90, 0x96, 0x82, +0xF0, 0x90, 0x96, 0x7D, 0xE0, 0x70, 0x24, 0xA3, +0x91, 0xD2, 0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, +0x90, 0x96, 0x80, 0x71, 0x3F, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, +0x83, 0xF0, 0x90, 0x96, 0x81, 0xE0, 0x54, 0x7F, +0xF0, 0x80, 0x40, 0x90, 0x96, 0x7E, 0x91, 0xD2, +0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x96, +0x80, 0x71, 0x3F, 0x80, 0x02, 0xC3, 0x33, 0xD8, +0xFC, 0x4F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, +0x96, 0x7B, 0xE0, 0x71, 0xEF, 0xE0, 0x54, 0x07, +0xFF, 0x90, 0x96, 0x81, 0xF0, 0x90, 0x89, 0x46, +0x91, 0xB6, 0xF5, 0x82, 0x91, 0xCC, 0x33, 0x33, +0x33, 0x54, 0xF8, 0x4F, 0x90, 0x96, 0x81, 0xF0, +0x44, 0x80, 0xF0, 0x90, 0x96, 0x7C, 0x91, 0xAE, +0x11, 0xDE, 0xEF, 0xF0, 0xEE, 0x70, 0x05, 0x90, +0x01, 0xC8, 0xEF, 0xF0, 0x90, 0x96, 0x81, 0x91, +0xAE, 0x71, 0xEF, 0xEF, 0xF0, 0xEE, 0x11, 0x48, +0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x96, 0x86, 0xE0, +0x54, 0x03, 0x4F, 0xFE, 0x90, 0x96, 0x7B, 0xE0, +0xFF, 0x11, 0x48, 0xEE, 0xF0, 0x7D, 0x01, 0x12, +0x61, 0xF7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, +0x61, 0x12, 0x7B, 0x41, 0x90, 0x96, 0xC5, 0xE0, +0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, +0xC6, 0xED, 0xF0, 0x90, 0x96, 0xC5, 0xEF, 0xF0, +0xD3, 0x94, 0x07, 0x50, 0x42, 0x7F, 0x47, 0x71, +0x39, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, +0x5F, 0xFD, 0x7F, 0x47, 0x12, 0x7B, 0x2E, 0x7F, +0x46, 0x71, 0x39, 0x80, 0x02, 0xC3, 0x33, 0xD8, +0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0x91, 0xA6, 0x60, +0x0D, 0x7F, 0x45, 0x71, 0x39, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, 0x7F, 0x45, +0x71, 0x39, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, +0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x46, 0x90, +0x96, 0xC5, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, +0x71, 0x39, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, +0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, +0x7F, 0x62, 0x71, 0x39, 0x80, 0x02, 0xC3, 0x33, +0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x91, 0xA6, +0x60, 0x0E, 0x71, 0x37, 0x80, 0x02, 0xC3, 0x33, +0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, +0x71, 0x37, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, +0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE5, 0x62, 0xC4, +0x54, 0xF0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, +0x81, 0xF5, 0x83, 0x22, 0xAD, 0x07, 0x90, 0x93, +0x59, 0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, +0x96, 0x99, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, +0x90, 0x93, 0x5A, 0xE0, 0x75, 0xF0, 0x08, 0xA4, +0xAE, 0xF0, 0x90, 0x96, 0x9B, 0xF0, 0xEE, 0xA3, +0xF0, 0x91, 0x9E, 0x90, 0x96, 0x9D, 0xF0, 0xEE, +0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x67, 0x90, +0x93, 0x57, 0xE0, 0xFE, 0x12, 0x8F, 0xF1, 0x30, +0xE0, 0x5C, 0xEE, 0x12, 0xA6, 0xA1, 0x20, 0xE0, +0x02, 0x7D, 0x01, 0x91, 0x97, 0xFE, 0x54, 0x0F, +0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, +0x91, 0x97, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, +0x25, 0xA3, 0xE0, 0x30, 0xE0, 0x10, 0x90, 0x96, +0x9E, 0xE0, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, +0x9D, 0x12, 0xBD, 0xC6, 0x80, 0x10, 0x91, 0x9E, +0xFF, 0x12, 0x7C, 0x6A, 0x12, 0xA6, 0x9C, 0x20, +0xE0, 0x02, 0x7D, 0x01, 0x71, 0x47, 0x90, 0x93, +0x57, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0E, +0x90, 0x96, 0x9C, 0xE0, 0x90, 0x92, 0x20, 0xF0, +0x90, 0x96, 0x9B, 0x12, 0xBD, 0xC6, 0x22, 0x71, +0x47, 0x90, 0x93, 0x57, 0xE0, 0x22, 0x90, 0x96, +0x99, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x12, 0x7B, +0x2E, 0x90, 0x96, 0xC6, 0xE0, 0x22, 0xE0, 0xFF, +0x90, 0x96, 0x7B, 0xE0, 0xFE, 0x22, 0x12, 0x86, +0x6D, 0x90, 0x96, 0x7F, 0xE0, 0x22, 0xE0, 0x90, +0x92, 0x5E, 0xF0, 0xA3, 0x74, 0x02, 0x22, 0x12, +0x86, 0x6D, 0x8F, 0x82, 0x75, 0x83, 0x00, 0x02, +0x02, 0x1F, 0xE0, 0x24, 0x6F, 0xF5, 0x82, 0xE4, +0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xC6, 0x25, +0x70, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, +0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, +0x52, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0x12, +0x7B, 0x41, 0xEF, 0x20, 0xE6, 0x02, 0xC1, 0x1B, +0x90, 0x00, 0x8C, 0xE0, 0x90, 0x96, 0xBB, 0xF0, +0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x96, 0xBC, +0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x96, +0xBD, 0xF0, 0x90, 0x96, 0xBC, 0xE0, 0x24, 0xFC, +0x60, 0x10, 0x24, 0x03, 0x60, 0x02, 0xC1, 0x0B, +0x90, 0x96, 0xBB, 0xE0, 0xFF, 0x12, 0xCF, 0xF0, +0xC1, 0x0B, 0x90, 0x96, 0xBB, 0xE0, 0x24, 0xD6, +0x12, 0xC6, 0x43, 0xFB, 0xE4, 0xFD, 0xFF, 0xD1, +0x4D, 0x75, 0xF0, 0x12, 0x91, 0xEE, 0x13, 0x13, +0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x4D, +0x75, 0xF0, 0x12, 0x91, 0xEE, 0x12, 0x8F, 0xF1, +0xFB, 0x0D, 0xE4, 0xFF, 0xD1, 0x4D, 0x75, 0xF0, +0x12, 0x91, 0xEE, 0xC4, 0x54, 0x03, 0xFB, 0x0D, +0xE4, 0xFF, 0xD1, 0x4D, 0x75, 0xF0, 0x12, 0xF1, +0xBF, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x4D, 0xF1, +0xC7, 0xD1, 0x4A, 0x75, 0xF0, 0x12, 0xF1, 0xB3, +0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, +0xD1, 0x4D, 0x75, 0xF0, 0x12, 0xF1, 0xB3, 0x54, +0x1F, 0xD1, 0x4B, 0xF1, 0xDC, 0xE0, 0xFB, 0xE4, +0xFD, 0x0F, 0xD1, 0x4D, 0x75, 0xF0, 0x08, 0xA4, +0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xD1, +0x48, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x02, 0xF5, +0x82, 0xE4, 0x34, 0x82, 0xD1, 0x48, 0x75, 0xF0, +0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, +0x82, 0xD1, 0x48, 0x75, 0xF0, 0x08, 0xA4, 0x24, +0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, +0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xD1, 0x4D, 0x75, +0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, 0x82, 0xE4, +0x34, 0x82, 0xD1, 0x48, 0x75, 0xF0, 0x08, 0xA4, +0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xD1, +0x48, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x07, 0xF5, +0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, +0x0D, 0xD1, 0x20, 0x7F, 0x8F, 0x12, 0x7B, 0x41, +0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, +0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, +0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, +0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, +0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, +0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, +0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0xD1, 0x20, 0x90, +0x96, 0xBB, 0xE0, 0x22, 0x90, 0x96, 0x87, 0x12, +0x86, 0x76, 0x90, 0x96, 0x87, 0x12, 0x8A, 0xC9, +0x54, 0x7F, 0xFD, 0x12, 0x98, 0xAC, 0xFE, 0x54, +0x1F, 0x90, 0x96, 0x8B, 0xF0, 0xEE, 0x54, 0x80, +0x12, 0x8F, 0xF1, 0x90, 0x96, 0x8A, 0x12, 0x87, +0xE9, 0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, +0xC4, 0x54, 0x0F, 0x90, 0x96, 0x8D, 0x12, 0x87, +0xE9, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, +0x03, 0x90, 0x96, 0x8C, 0xF0, 0xEE, 0x54, 0x80, +0x12, 0x8F, 0xF1, 0xFF, 0x12, 0x87, 0xEA, 0xFB, +0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, +0x96, 0x8F, 0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, +0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, +0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0x91, 0xE9, +0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x96, 0x8C, 0xE0, +0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0x91, +0xE9, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x70, 0x0D, +0xEC, 0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0x91, +0xE9, 0x54, 0xF3, 0x4F, 0xF0, 0x90, 0x96, 0x8B, +0xE0, 0x54, 0x1F, 0xF1, 0xAE, 0x54, 0xE0, 0x4F, +0xF0, 0xEC, 0x54, 0x03, 0x91, 0xE9, 0x54, 0xFC, +0x4F, 0xF0, 0x90, 0x96, 0x8A, 0xE0, 0x54, 0x01, +0xC4, 0x33, 0x54, 0xE0, 0xF1, 0xAE, 0x54, 0xDF, +0x4F, 0xF0, 0x90, 0x96, 0x8D, 0xE0, 0x54, 0x03, +0xC4, 0x54, 0xF0, 0x91, 0xE9, 0x54, 0xCF, 0x4F, +0xF1, 0xD0, 0xE0, 0x54, 0xFB, 0xF1, 0xD0, 0xC0, +0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x96, 0x90, +0xE0, 0x12, 0xDD, 0x94, 0xD0, 0x82, 0xD0, 0x83, +0xF0, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x35, 0x90, +0x96, 0x87, 0x12, 0x86, 0x6D, 0xE9, 0x24, 0x03, +0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, +0x1F, 0x12, 0x02, 0x4C, 0x90, 0x96, 0x8E, 0x74, +0x01, 0xF0, 0x90, 0x96, 0x8E, 0xE0, 0xFF, 0xC3, +0x94, 0x04, 0x50, 0x10, 0xEF, 0x12, 0xDC, 0xCC, +0xE4, 0x12, 0x02, 0x5E, 0x90, 0x96, 0x8E, 0xE0, +0x04, 0xF0, 0x80, 0xE6, 0x90, 0x93, 0x50, 0xE0, +0x54, 0x07, 0xFF, 0xBF, 0x05, 0x0A, 0xEC, 0xB4, +0x01, 0x06, 0x90, 0x93, 0x55, 0x74, 0x01, 0xF0, +0xE4, 0x90, 0x96, 0x8E, 0xF0, 0x90, 0x96, 0x8E, +0xE0, 0xFC, 0x12, 0xDC, 0xCC, 0x12, 0x02, 0x1F, +0xFF, 0xED, 0xF1, 0xDC, 0x12, 0xB5, 0xDC, 0xEF, +0xF0, 0x90, 0x96, 0x8E, 0xE0, 0x04, 0xF0, 0xE0, +0xB4, 0x04, 0xE2, 0xAF, 0x05, 0x90, 0x8A, 0xFF, +0x12, 0x9E, 0x75, 0x02, 0x04, 0x7E, 0xFF, 0x75, +0xF0, 0x12, 0xED, 0x90, 0x89, 0x51, 0x12, 0x04, +0x6E, 0xE0, 0x22, 0x75, 0xF0, 0x12, 0xEF, 0x90, +0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x75, +0xF0, 0x12, 0x90, 0x89, 0x50, 0x02, 0x04, 0x6E, +0xF0, 0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, +0x8D, 0xF5, 0x83, 0x22, 0x75, 0xF0, 0x08, 0xA4, +0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, +0x83, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, 0x80, +0xF0, 0x7B, 0x01, 0xAF, 0x0E, 0x02, 0x75, 0x80, +0x81, 0xF6, 0x12, 0x9F, 0xE9, 0x12, 0x02, 0x06, +0x30, 0xE0, 0x13, 0x71, 0x7B, 0x90, 0x86, 0xB3, +0xE0, 0x64, 0x01, 0x70, 0x28, 0x90, 0xFE, 0x10, +0xE0, 0x44, 0x04, 0xF0, 0x80, 0x1F, 0x90, 0x93, +0x25, 0xE0, 0x60, 0x16, 0x7D, 0x10, 0xE4, 0xFF, +0x12, 0x7C, 0x3B, 0x90, 0x01, 0x3C, 0xE0, 0x30, +0xE4, 0x03, 0x74, 0x10, 0xF0, 0x90, 0x01, 0x63, +0xE4, 0xF0, 0x12, 0xD4, 0xC5, 0x11, 0xA6, 0x90, +0x93, 0x04, 0x12, 0x87, 0xE9, 0x90, 0x93, 0x05, +0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x01, 0x90, +0x93, 0x11, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, +0x02, 0x90, 0x93, 0x12, 0xF0, 0x90, 0x93, 0x04, +0xE0, 0x54, 0x04, 0x90, 0x93, 0x13, 0xF0, 0x90, +0x93, 0x04, 0xE0, 0x54, 0x08, 0x90, 0x93, 0x14, +0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x10, 0x90, +0x93, 0x15, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, +0x01, 0x90, 0x93, 0x16, 0xF0, 0x90, 0x93, 0x05, +0xE0, 0x54, 0x02, 0x90, 0x93, 0x17, 0xF0, 0x90, +0x93, 0x05, 0xE0, 0x54, 0x04, 0x90, 0x93, 0x18, +0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x08, 0x90, +0x93, 0x19, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, +0x10, 0x90, 0x93, 0x1A, 0xF0, 0x22, 0x90, 0x94, +0xB6, 0x12, 0x86, 0x6D, 0x90, 0x00, 0x01, 0x02, +0x02, 0x1F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0xF1, 0xE9, 0x12, 0xDD, 0x7D, 0x90, 0x88, +0x9D, 0x12, 0xDC, 0xB2, 0xF0, 0xFC, 0x12, 0x02, +0x06, 0xFD, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, +0xFF, 0x90, 0x94, 0xA2, 0xE0, 0x54, 0xFE, 0x4F, +0xF0, 0xED, 0x54, 0x08, 0xFF, 0xEC, 0x54, 0xF7, +0x4F, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0x12, 0x02, +0x06, 0x12, 0xDD, 0x3D, 0x90, 0x88, 0x9D, 0x12, +0xDD, 0x6B, 0x4E, 0x12, 0xA7, 0xA7, 0x54, 0x40, +0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x90, 0x88, +0x9D, 0xF0, 0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, +0x7F, 0x4E, 0xF0, 0x90, 0x94, 0xB6, 0x12, 0x86, +0x6D, 0xE9, 0x24, 0x01, 0xF9, 0xE4, 0x3A, 0x8B, +0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x04, +0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9E, 0x12, 0x69, +0xF5, 0x90, 0x94, 0xB6, 0x12, 0x86, 0x6D, 0x12, +0x87, 0xEA, 0xFF, 0x54, 0x03, 0x90, 0x88, 0x9F, +0xF0, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, 0x01, +0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x90, 0x94, 0xAE, +0xE0, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x02, 0x06, +0x20, 0xE0, 0x02, 0x41, 0xB0, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, 0xE0, -0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, 0x12, 0x87, -0xA8, 0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, -0x88, 0xCF, 0x12, 0x87, 0x2D, 0x90, 0x88, 0x9F, -0xF0, 0x80, 0x4B, 0x12, 0x87, 0xA8, 0xFF, 0xC3, -0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, 0x94, 0x03, -0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, -0x0D, 0x12, 0x87, 0xA8, 0x90, 0x88, 0x9E, 0x80, -0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, 0x24, -0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, 0x87, 0x2E, -0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, -0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, -0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, -0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0xA5, -0x25, 0x54, 0x03, 0x30, 0xE0, 0x3D, 0x90, 0x88, -0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, -0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, -0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, -0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, -0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, -0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, -0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, -0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0xF0, -0x11, 0xC3, 0x12, 0x87, 0x3F, 0xC4, 0x13, 0x13, -0x54, 0x03, 0x20, 0xE0, 0x37, 0x90, 0x88, 0x9D, -0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0xE0, 0x91, -0xA8, 0x30, 0xE0, 0x28, 0xF1, 0xEB, 0x30, 0xE0, -0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, -0x0B, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0x75, -0x61, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, -0x8A, 0xF3, 0x12, 0x8C, 0xA3, 0x7D, 0x02, 0xAF, -0x61, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, -0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1D, 0x90, 0x88, -0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -0x0D, 0x90, 0x8A, 0x89, 0x12, 0x8C, 0xA3, 0x7D, -0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0xF1, 0xDA, -0x74, 0x11, 0xF0, 0x90, 0x94, 0xA1, 0xE0, 0x30, -0xE0, 0x31, 0x90, 0x94, 0xAA, 0x74, 0x01, 0xF0, +0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x14, 0x11, 0xAC, +0x90, 0x88, 0x9E, 0xF0, 0x24, 0x0A, 0x90, 0x88, +0xCF, 0x12, 0x87, 0xE9, 0x90, 0x88, 0x9F, 0xF0, +0x80, 0x28, 0x11, 0xAC, 0xFF, 0xC3, 0x94, 0x2A, +0x50, 0x14, 0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, +0x90, 0x88, 0x9E, 0x74, 0x03, 0x80, 0x0C, 0x11, +0xA6, 0x90, 0x88, 0x9E, 0x80, 0x05, 0x90, 0x88, +0x9E, 0x74, 0x2A, 0xF0, 0x24, 0x0A, 0x90, 0x88, +0xCF, 0xF0, 0xB1, 0xBD, 0x30, 0xE0, 0x3D, 0x90, +0x88, 0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, +0x88, 0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, +0x90, 0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, +0x90, 0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, +0xC3, 0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, +0x9F, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, +0x90, 0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, +0x02, 0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, +0xF0, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, 0x0F, +0x30, 0xE0, 0x18, 0x12, 0xDD, 0x59, 0x30, 0xE0, +0x0D, 0x90, 0x8A, 0x89, 0x12, 0x8B, 0x46, 0x7D, +0x04, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x71, 0x3A, +0x74, 0x11, 0xF0, 0x90, 0x94, 0xA2, 0xE0, 0x30, +0xE0, 0x31, 0x90, 0x94, 0xAB, 0x74, 0x01, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x06, 0xC7, 0xE0, 0xFE, -0x90, 0x06, 0xC6, 0xF1, 0xE2, 0xFE, 0xE4, 0xFD, -0x78, 0x10, 0x12, 0xD2, 0xB2, 0x90, 0x06, 0xC5, -0xE0, 0xFE, 0x90, 0x06, 0xC4, 0xF1, 0xE2, 0xFE, -0xE4, 0xFD, 0x12, 0x86, 0x54, 0x90, 0x94, 0xA6, -0x12, 0x04, 0x31, 0x90, 0x05, 0x58, 0x74, 0x02, -0xF0, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, -0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, -0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, -0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, -0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, -0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, -0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, -0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, -0x80, 0x71, 0x11, 0xC3, 0x12, 0x87, 0x3F, 0xC4, -0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x05, 0x75, -0x62, 0x02, 0x80, 0x0D, 0xF1, 0xEB, 0x30, 0xE0, -0x05, 0x75, 0x62, 0x01, 0x80, 0x03, 0xE4, 0xF5, -0x62, 0x90, 0x8A, 0xF1, 0x12, 0x8A, 0x33, 0x90, -0x89, 0x04, 0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, -0x07, 0xE0, 0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, -0xE0, 0x54, 0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, -0x12, 0x7B, 0x2E, 0x11, 0xC3, 0x12, 0x87, 0x3F, -0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, -0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, -0x9A, 0x90, 0x8A, 0xF3, 0x12, 0x8C, 0xA3, 0xAD, -0x62, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0xE4, 0xFB, -0xFD, 0x7F, 0xFF, 0x12, 0xA3, 0x45, 0xF1, 0xDA, -0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, -0xDF, 0xF0, 0xE4, 0x90, 0x88, 0xAF, 0xF0, 0x90, -0x88, 0xA0, 0xE0, 0x91, 0xA8, 0x30, 0xE0, 0x09, -0x90, 0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, 0x80, -0x12, 0x90, 0x8A, 0x97, 0x12, 0x8C, 0xA3, 0x7F, -0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xD0, 0xE0, -0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0x12, 0x8C, -0xA3, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, 0x88, -0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, -0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xF1, 0xC2, 0x11, 0xC3, 0x12, 0x02, 0x06, -0xFF, 0x54, 0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, -0x91, 0xA8, 0xA3, 0xF0, 0x12, 0x87, 0xA8, 0xFD, -0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x88, -0x34, 0xE0, 0x54, 0xF0, 0x4F, 0x12, 0x87, 0x3E, -0xFC, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, -0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, -0x04, 0xC3, 0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, -0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, -0x54, 0xF0, 0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, -0x12, 0x87, 0x2D, 0x90, 0x88, 0x35, 0x12, 0x87, -0x8C, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x8C, 0xA3, -0x7F, 0x02, 0x12, 0x04, 0x7E, 0x11, 0xC3, 0x12, -0x87, 0x24, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, -0x9B, 0x12, 0xB7, 0x6B, 0x12, 0x87, 0x22, 0xFE, -0x12, 0xB7, 0x35, 0x90, 0x88, 0x9B, 0x12, 0xB7, -0x3E, 0x12, 0x87, 0x21, 0x12, 0xDC, 0xCA, 0x90, -0x88, 0x9B, 0xF1, 0xF6, 0x12, 0x87, 0x21, 0x54, -0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, 0x90, 0x88, -0x9B, 0xF0, 0x12, 0xC6, 0x5C, 0x20, 0xE0, 0x2F, -0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0B, 0x75, 0x62, -0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x0B, 0x80, -0x0E, 0xE4, 0xF5, 0x62, 0x90, 0x88, 0xDF, 0xE0, -0x60, 0x05, 0xE4, 0xF5, 0x61, 0x80, 0x03, 0x75, -0x61, 0x01, 0x90, 0x8A, 0xF3, 0x12, 0x8C, 0xA3, -0xAD, 0x62, 0xAF, 0x61, 0x12, 0x04, 0x7E, 0x11, -0xC3, 0x12, 0x5C, 0x5F, 0x90, 0x88, 0x36, 0xE0, -0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x54, -0xFB, 0xF0, 0x12, 0xC6, 0x6E, 0xF0, 0x90, 0x88, -0x36, 0x12, 0xDC, 0x51, 0x12, 0xAF, 0x9D, 0x90, -0x01, 0xBE, 0xF0, 0x22, 0xF0, 0xEE, 0x54, 0x80, -0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, 0xD3, -0x20, 0xE6, 0x02, 0xA1, 0xCD, 0x90, 0x00, 0x8C, -0xE0, 0x90, 0x96, 0xB0, 0xF0, 0x7F, 0x8D, 0x12, -0x7B, 0x41, 0x90, 0x96, 0xB1, 0xEF, 0xF0, 0x90, -0x00, 0x8E, 0xE0, 0x90, 0x96, 0xB2, 0xF0, 0x90, -0x96, 0xB1, 0xE0, 0x24, 0xFC, 0x60, 0x10, 0x24, -0x03, 0x60, 0x02, 0xA1, 0xC5, 0x90, 0x96, 0xB0, -0xE0, 0xFF, 0x12, 0xAE, 0x3F, 0xA1, 0xC5, 0x90, -0x96, 0xB0, 0xE0, 0x24, 0xD6, 0x12, 0x87, 0xD2, -0xFB, 0xE4, 0xFD, 0xFF, 0xB1, 0xFF, 0x75, 0xF0, -0x12, 0x12, 0x87, 0xC6, 0x13, 0x13, 0x54, 0x03, -0xFB, 0x0D, 0xE4, 0xFF, 0xB1, 0xFF, 0x75, 0xF0, -0x12, 0x12, 0x87, 0xC6, 0x91, 0xA8, 0xFB, 0x0D, -0xE4, 0xFF, 0xB1, 0xFF, 0x75, 0xF0, 0x12, 0x12, -0x87, 0xC6, 0xC4, 0x54, 0x03, 0xFB, 0x0D, 0xE4, -0xFF, 0xB1, 0xFF, 0x75, 0xF0, 0x12, 0x12, 0xAE, -0x10, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0xFF, 0x12, -0xAE, 0x20, 0xB1, 0xFC, 0x75, 0xF0, 0x12, 0xF1, -0x60, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, -0x01, 0xB1, 0xFF, 0x75, 0xF0, 0x12, 0xF1, 0x60, -0x54, 0x1F, 0xB1, 0xFD, 0x12, 0xDC, 0x17, 0xE0, -0xFB, 0xE4, 0xFD, 0x0F, 0xB1, 0xFF, 0x75, 0xF0, -0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, -0x82, 0xB1, 0xFA, 0x75, 0xF0, 0x08, 0xA4, 0x24, -0x02, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xB1, 0xFA, -0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, -0xE4, 0x34, 0x82, 0xB1, 0xFA, 0x75, 0xF0, 0x08, -0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, -0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0xB1, -0xFF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, -0x82, 0xE4, 0x34, 0x82, 0xB1, 0xFA, 0x75, 0xF0, -0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, -0x82, 0xB1, 0xFA, 0x75, 0xF0, 0x08, 0xA4, 0x24, -0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, -0xE0, 0xFB, 0x0D, 0xB1, 0xD2, 0xF1, 0xD3, 0x30, -0xE0, 0x03, 0x12, 0xAF, 0x09, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, -0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, -0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, -0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, -0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, -0xF0, 0x22, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0xB1, -0xD2, 0x90, 0x96, 0xB0, 0xE0, 0x22, 0x90, 0x94, -0xBD, 0x12, 0x86, 0x76, 0xF1, 0x6E, 0x12, 0x02, -0x06, 0x54, 0x7F, 0xFD, 0x12, 0x87, 0xA8, 0xFE, -0x54, 0x1F, 0x90, 0x94, 0xC1, 0x91, 0xA4, 0x90, -0x94, 0xC0, 0x12, 0x87, 0x2D, 0xFE, 0x54, 0x03, -0xFC, 0xEE, 0x54, 0x30, 0xC4, 0x54, 0x0F, 0x12, -0x87, 0x2A, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, -0x54, 0x03, 0x90, 0x94, 0xC2, 0x91, 0xA4, 0xFF, -0x12, 0x87, 0x2E, 0xFB, 0x54, 0x08, 0x13, 0x13, -0x13, 0x54, 0x1F, 0x90, 0x94, 0xC5, 0xF0, 0xFA, -0xEB, 0x54, 0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, -0xF0, 0xEF, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, -0x54, 0x80, 0x12, 0x87, 0xC1, 0x54, 0x7F, 0x4F, -0xF0, 0x90, 0x94, 0xC2, 0xE0, 0x12, 0x9D, 0x9C, -0x12, 0x87, 0xC1, 0x54, 0xBF, 0x4F, 0xF0, 0xEA, -0x60, 0x02, 0xE1, 0x5A, 0x90, 0x94, 0xC1, 0xE0, -0x54, 0x1F, 0xF1, 0x5B, 0x54, 0xE0, 0x4F, 0xF0, -0xEC, 0x54, 0x03, 0x12, 0x87, 0xC1, 0x54, 0xFC, -0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, 0xE0, 0x25, -0xE0, 0x12, 0x87, 0xC1, 0x54, 0xF3, 0x4F, 0xF0, -0x90, 0x94, 0xC0, 0xE0, 0x54, 0x01, 0xC4, 0x33, -0x54, 0xE0, 0xF1, 0x5B, 0x54, 0xDF, 0x4F, 0xF0, -0x90, 0x94, 0xC3, 0xE0, 0x54, 0x03, 0xC4, 0x54, -0xF0, 0x12, 0x87, 0xC1, 0x54, 0xCF, 0x4F, 0xF0, -0x74, 0xC6, 0x2D, 0x12, 0x87, 0x93, 0xE0, 0x54, -0xFB, 0xF0, 0x74, 0xC6, 0x2D, 0x12, 0x87, 0x93, -0xC0, 0x83, 0xC0, 0x82, 0xE0, 0xFF, 0x90, 0x94, -0xC6, 0xE0, 0x12, 0xDC, 0xE5, 0xD0, 0x82, 0xD0, -0x83, 0xF0, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x30, -0xF1, 0x6E, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, -0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, 0x02, -0x4C, 0x90, 0x94, 0xC4, 0x74, 0x01, 0xF0, 0x90, -0x94, 0xC4, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x50, -0x0F, 0xEF, 0xF1, 0x68, 0x8F, 0x82, 0x8E, 0x83, -0xE4, 0x12, 0x02, 0x5E, 0xF1, 0xC8, 0x80, 0xE7, -0x90, 0x93, 0x50, 0xE0, 0x54, 0x07, 0xFF, 0xBF, -0x05, 0x0A, 0xEC, 0xB4, 0x01, 0x06, 0x90, 0x93, -0x55, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x94, 0xC4, -0xF0, 0x90, 0x94, 0xC4, 0xE0, 0xFC, 0xF1, 0x68, -0x8F, 0x82, 0x8E, 0x83, 0x12, 0x02, 0x1F, 0xFF, -0xED, 0x12, 0xDC, 0x17, 0xE5, 0x82, 0x2C, 0x12, -0xAF, 0x10, 0xEF, 0xF0, 0xF1, 0xC8, 0xE0, 0xB4, -0x04, 0xDF, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0x12, -0xA5, 0x2D, 0x22, 0xFF, 0x75, 0xF0, 0x12, 0xED, -0x90, 0x89, 0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, -0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x94, -0xBD, 0x02, 0x86, 0x6D, 0x7D, 0x01, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xB6, -0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, -0x12, 0x8C, 0xA3, 0x7D, 0x44, 0x7F, 0x6F, 0x12, -0x04, 0x7E, 0x90, 0x8A, 0xFD, 0x12, 0x8A, 0x33, -0x90, 0x96, 0xB7, 0xE0, 0x90, 0x96, 0xB6, 0xB4, -0x01, 0x0A, 0xE0, 0x12, 0xAB, 0xE6, 0xE0, 0x44, -0x04, 0xF0, 0x80, 0x08, 0xE0, 0x12, 0xAB, 0xE6, -0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, -0x8C, 0xA3, 0x12, 0xB0, 0xB3, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x90, 0x94, 0xC1, 0x02, 0x86, 0x76, -0x90, 0x94, 0xC4, 0xE0, 0x04, 0xF0, 0x22, 0xE4, -0xFD, 0x80, 0xA3, 0x7F, 0x8F, 0x12, 0x7B, 0x41, -0xEF, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, +0x90, 0x06, 0xC6, 0x71, 0x42, 0xFE, 0xE4, 0xFD, +0x78, 0x10, 0x12, 0xD4, 0x29, 0x90, 0x06, 0xC5, +0xE0, 0xFE, 0x90, 0x06, 0xC4, 0x71, 0x42, 0xFE, +0xE4, 0xFD, 0x12, 0x86, 0x54, 0x90, 0x94, 0xA7, +0x12, 0x04, 0x31, 0x90, 0x94, 0xAE, 0xE0, 0x13, +0x13, 0x54, 0x3F, 0x30, 0xE0, 0x13, 0xA3, 0xE0, +0x20, 0xE0, 0x07, 0x54, 0x01, 0x44, 0x64, 0xF0, +0x80, 0x07, 0x90, 0x94, 0xAF, 0xE0, 0x54, 0xFE, +0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, +0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, +0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, 0x90, 0x88, +0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, +0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, 0x88, 0xA5, +0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, +0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, 0xA5, 0xE0, +0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, +0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, 0x80, 0x3F, +0x90, 0x8A, 0xF1, 0x12, 0x88, 0xCD, 0x90, 0x89, +0x04, 0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x08, +0xE0, 0x54, 0x0F, 0x44, 0xA0, 0xF0, 0x80, 0x06, +0xE0, 0x54, 0x0F, 0x44, 0x20, 0xF0, 0x90, 0x94, +0xB6, 0x12, 0x86, 0x6D, 0x12, 0x87, 0xF4, 0x13, +0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, +0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, +0x71, 0x4B, 0x71, 0x3A, 0x74, 0x43, 0xF0, 0x90, +0x88, 0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, +0x88, 0xAF, 0xF0, 0x12, 0x8F, 0xED, 0x30, 0xE0, +0x09, 0x90, 0x88, 0xD0, 0xE0, 0x44, 0x02, 0xF0, +0x80, 0x12, 0x90, 0x8A, 0x97, 0x12, 0x8B, 0x46, +0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xD0, +0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0x12, +0x8B, 0x46, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, +0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, +0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, -0xEC, 0x3E, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, -0x13, 0x54, 0x1F, 0x22, 0x81, 0xAF, 0xF0, 0xEE, -0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x22, 0x12, -0x97, 0xC2, 0x12, 0x02, 0x06, 0x30, 0xE0, 0x13, -0x11, 0xAC, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x01, -0x70, 0x28, 0x90, 0xFE, 0x10, 0xE0, 0x44, 0x04, -0xF0, 0x80, 0x1F, 0x90, 0x93, 0x25, 0xE0, 0x60, -0x16, 0x7D, 0x10, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, -0x90, 0x01, 0x3C, 0xE0, 0x30, 0xE4, 0x03, 0x74, -0x10, 0xF0, 0x90, 0x01, 0x63, 0xE4, 0xF0, 0x12, -0xD4, 0x01, 0x12, 0x87, 0xA3, 0x90, 0x93, 0x04, -0x12, 0x87, 0x2D, 0x90, 0x93, 0x05, 0xF0, 0x90, -0x93, 0x04, 0xE0, 0x54, 0x01, 0x90, 0x93, 0x11, -0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, 0x02, 0x90, -0x93, 0x12, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0x54, -0x04, 0x90, 0x93, 0x13, 0xF0, 0x90, 0x93, 0x04, -0xE0, 0x54, 0x08, 0x90, 0x93, 0x14, 0xF0, 0x90, -0x93, 0x04, 0xE0, 0x54, 0x10, 0x90, 0x93, 0x15, -0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x01, 0x90, -0x93, 0x16, 0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, -0x02, 0x90, 0x93, 0x17, 0xF0, 0x90, 0x93, 0x05, -0xE0, 0x54, 0x04, 0x90, 0x93, 0x18, 0xF0, 0x90, -0x93, 0x05, 0xE0, 0x54, 0x08, 0x90, 0x93, 0x19, -0xF0, 0x90, 0x93, 0x05, 0xE0, 0x54, 0x10, 0x90, -0x93, 0x1A, 0xF0, 0x22, 0x90, 0x01, 0x17, 0xE0, -0xFE, 0x90, 0x01, 0x16, 0x12, 0x97, 0xE2, 0x90, -0x88, 0x27, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, -0x86, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x93, 0x03, -0xE0, 0x44, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, -0x12, 0x7C, 0x74, 0x90, 0x05, 0x52, 0xE0, 0x54, -0x07, 0x04, 0x90, 0x93, 0x0E, 0x71, 0x9B, 0x90, -0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE4, -0x90, 0x95, 0x1C, 0xF0, 0x12, 0xD0, 0x9A, 0x7F, -0x08, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xEF, 0xFD, -0x7F, 0x08, 0x12, 0x7B, 0x2E, 0xE4, 0xFF, 0x71, -0x3F, 0x90, 0x93, 0x31, 0xE0, 0x20, 0xE0, 0x02, -0x21, 0xDF, 0x71, 0x94, 0x44, 0x02, 0x12, 0xB7, -0x65, 0xE4, 0x90, 0x95, 0x1D, 0xF0, 0x90, 0x95, -0x1D, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2B, -0x71, 0xA5, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, -0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x34, 0xE0, -0xFD, 0xEF, 0x5D, 0x60, 0x0E, 0x90, 0x95, 0x1D, -0x91, 0x04, 0x90, 0x95, 0x1D, 0x91, 0x24, 0x44, -0x40, 0x71, 0x8C, 0x90, 0x95, 0x1D, 0xE0, 0x04, -0xF0, 0x80, 0xCB, 0x90, 0x07, 0xC7, 0xE4, 0xF0, -0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, -0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, -0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, -0xA3, 0xF1, 0xE2, 0x90, 0x02, 0x26, 0xE0, 0x44, -0x01, 0xF0, 0xE0, 0x90, 0x95, 0x1E, 0xF0, 0x90, -0x95, 0x1E, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0x95, -0x1C, 0xE0, 0x04, 0xD1, 0x2F, 0x90, 0x02, 0x26, -0xE0, 0x90, 0x95, 0x1E, 0xF0, 0x90, 0x95, 0x1C, -0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE1, 0x90, 0x02, -0x03, 0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, -0x90, 0x95, 0x1F, 0xF0, 0x90, 0x04, 0x22, 0xE0, -0x44, 0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, -0x95, 0x1E, 0xF0, 0x90, 0x02, 0x01, 0x31, 0xEF, -0x90, 0x02, 0x02, 0x31, 0xEF, 0x90, 0x02, 0x14, -0x31, 0xEF, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, -0x24, 0xF0, 0x11, 0xDF, 0x90, 0x95, 0x1F, 0xE0, -0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, -0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x71, -0xAD, 0xF0, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, -0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, -0xFF, 0x90, 0x95, 0x1E, 0xE0, 0x2F, 0xF0, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, -0x08, 0x11, 0xE7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x75, 0x64, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, -0x10, 0xF0, 0x71, 0xAD, 0xF0, 0x7D, 0x01, 0x12, -0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, -0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, 0xE0, -0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, -0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, -0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x31, 0xE0, -0x30, 0xE0, 0x67, 0x90, 0xFD, 0x09, 0xE4, 0xF0, -0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, -0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x95, 0x1C, 0xF0, -0x90, 0x95, 0x1C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, -0x50, 0x2B, 0x71, 0xA5, 0x80, 0x05, 0xC3, 0x33, -0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, -0x33, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x0E, 0x90, -0x95, 0x1C, 0x91, 0x04, 0x90, 0x95, 0x1C, 0x91, -0x24, 0x44, 0x20, 0x71, 0x8C, 0x90, 0x95, 0x1C, -0xE0, 0x04, 0xF0, 0x80, 0xCB, 0x71, 0x38, 0x54, -0xFE, 0xFD, 0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x71, -0x38, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, 0x7B, -0x2E, 0x71, 0x94, 0x54, 0xFD, 0xFD, 0x7F, 0x02, -0x80, 0x07, 0x71, 0x38, 0x44, 0x01, 0xFD, 0x7F, -0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, -0x41, 0xEF, 0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, -0x7B, 0x2E, 0x7F, 0x01, 0x71, 0x3F, 0x90, 0x00, -0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, -0x7F, 0x92, 0x12, 0x7B, 0x41, 0xEF, 0x22, 0x90, -0x96, 0xB3, 0xEF, 0x71, 0x9B, 0x90, 0x01, 0x09, -0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, -0x90, 0x96, 0xB3, 0xE0, 0x6F, 0x60, 0x34, 0xC3, -0x90, 0x96, 0xB5, 0xE0, 0x94, 0x88, 0x90, 0x96, -0xB4, 0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, -0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x96, -0xB4, 0xB1, 0xF5, 0x71, 0x8D, 0xD3, 0x90, 0x96, -0xB5, 0xE0, 0x94, 0x32, 0x90, 0x96, 0xB4, 0xE0, -0x94, 0x00, 0x40, 0xC1, 0x90, 0x01, 0xC6, 0xE0, -0x30, 0xE0, 0xBA, 0x22, 0xF0, 0x7F, 0x14, 0x7E, -0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x02, 0x12, 0x7B, -0x41, 0xEF, 0x22, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, -0xF0, 0x22, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, -0x00, 0xA8, 0x07, 0x08, 0x22, 0x90, 0x88, 0xA0, -0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, -0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, -0x90, 0x92, 0x90, 0x22, 0x90, 0x93, 0x03, 0xE0, -0x54, 0xFE, 0x71, 0x9B, 0x90, 0x93, 0x0A, 0x71, -0xE4, 0x90, 0x93, 0x25, 0xF0, 0xA3, 0xF0, 0xA3, -0xF0, 0x22, 0xE4, 0x90, 0x95, 0x50, 0xF0, 0x90, -0x95, 0xBB, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, -0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x88, 0x39, 0xE0, -0xFF, 0x60, 0x03, 0xB4, 0x08, 0x0D, 0xF1, 0x55, -0xBF, 0x01, 0x08, 0x31, 0xF8, 0x90, 0x01, 0xE5, -0xE0, 0x04, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x3F, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -0x90, 0x01, 0xB0, 0xF0, 0x74, 0x44, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -0x01, 0xB1, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x35, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -0x90, 0x01, 0xB2, 0xF0, 0x74, 0x3A, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -0x01, 0xB3, 0xF0, 0xE0, 0x22, 0xF1, 0xA7, 0x12, -0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x12, 0x8A, 0x33, -0x12, 0xC8, 0x72, 0x12, 0xB3, 0x54, 0x91, 0x85, -0x71, 0xC4, 0x90, 0x8A, 0x73, 0x12, 0x8A, 0x33, -0x90, 0x00, 0x6A, 0xE0, 0x30, 0xE2, 0x14, 0x90, -0x92, 0x20, 0x74, 0x01, 0xF0, 0xA3, 0x74, 0xF4, -0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x68, 0x7E, 0x01, -0x12, 0x66, 0x33, 0x12, 0xCF, 0xF5, 0x90, 0x93, -0x4A, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, 0x29, -0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, 0x54, -0xEF, 0xF0, 0x44, 0x08, 0xF0, 0x90, 0x86, 0xB3, -0xE0, 0xFF, 0x64, 0x02, 0x70, 0x29, 0xB1, 0x26, -0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, 0x2F, -0xB1, 0x24, 0x30, 0xE1, 0x02, 0x7E, 0x01, 0x90, -0x93, 0x2D, 0xB1, 0x24, 0x30, 0xE2, 0x02, 0x7E, -0x01, 0x90, 0x93, 0x2E, 0xEE, 0xF0, 0x90, 0xFD, -0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, 0xEF, -0x64, 0x01, 0x70, 0x1D, 0xB1, 0x1D, 0x30, 0xE0, -0x02, 0x7F, 0x01, 0x90, 0x93, 0x2F, 0xB1, 0x1B, -0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, -0xB1, 0x1B, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, -0x23, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, -0x20, 0xB1, 0x14, 0x30, 0xE0, 0x02, 0x7F, 0x01, -0x90, 0x93, 0x2F, 0xB1, 0x12, 0x30, 0xE1, 0x02, -0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x12, 0x30, -0xE2, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2E, 0xEF, -0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, 0xE0, -0x7F, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x70, -0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, 0xFD, -0x80, 0xE0, 0x7E, 0x00, 0x22, 0x7E, 0x00, 0x7F, -0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, -0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, 0x74, -0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, 0x00, -0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, -0x79, 0xA1, 0x12, 0x04, 0x80, 0x90, 0x86, 0xB3, -0xE0, 0xFC, 0x64, 0x02, 0x70, 0x14, 0xB1, 0x26, -0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0xB1, 0x9C, -0xFE, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4E, -0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x09, 0xB1, -0x1D, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x0F, -0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, 0x13, -0xB1, 0x14, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0xEF, -0xB1, 0x9C, 0xFF, 0x90, 0x88, 0xA0, 0xE0, 0x54, -0xBF, 0x4F, 0xF0, 0x22, 0x54, 0x01, 0xC4, 0x33, -0x33, 0x54, 0xC0, 0x22, 0xE4, 0x90, 0x94, 0xBD, -0xF0, 0xA3, 0xF0, 0x12, 0xD0, 0x49, 0xEF, 0x64, -0x01, 0x60, 0x3B, 0xC3, 0x90, 0x94, 0xBE, 0xE0, -0x94, 0x88, 0x90, 0x94, 0xBD, 0xE0, 0x94, 0x13, -0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, -0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, -0x1D, 0x90, 0x94, 0xBD, 0xB1, 0xF5, 0x71, 0x8D, -0xD3, 0x90, 0x94, 0xBE, 0xE0, 0x94, 0x32, 0x90, -0x94, 0xBD, 0xE0, 0x94, 0x00, 0x40, 0xC4, 0x90, -0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBD, 0x90, 0x01, -0xC7, 0x74, 0xFE, 0xF0, 0x22, 0xE4, 0x75, 0xF0, -0x01, 0x02, 0x02, 0xE7, 0xE4, 0x90, 0x96, 0xC0, -0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, -0xE1, 0x22, 0xC3, 0x90, 0x96, 0xC1, 0xE0, 0x94, -0xD0, 0x90, 0x96, 0xC0, 0xE0, 0x94, 0x07, 0x40, -0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, -0x7F, 0x00, 0x22, 0x90, 0x96, 0xC0, 0xB1, 0xF5, -0xD1, 0x30, 0x80, 0xD7, 0x7F, 0x01, 0x22, 0xF0, -0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, -0x93, 0x0E, 0xE0, 0xFD, 0x7C, 0x00, 0xA3, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x02, 0x92, 0xED, -0x4C, 0x70, 0x05, 0x90, 0x93, 0x1B, 0x80, 0x2A, -0xED, 0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x93, -0x1C, 0x80, 0x1F, 0xED, 0x64, 0x02, 0x4C, 0x70, -0x05, 0x90, 0x93, 0x1D, 0x80, 0x14, 0xED, 0x64, -0x03, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1E, 0x80, -0x09, 0xED, 0x64, 0x04, 0x4C, 0x70, 0x0D, 0x90, -0x93, 0x1F, 0xE0, 0xFF, 0x12, 0xD4, 0x17, 0x90, -0x93, 0x0F, 0xB1, 0xF5, 0x22, 0x12, 0x8F, 0x6E, -0xE4, 0xFF, 0xD1, 0xC1, 0x90, 0x93, 0x03, 0xE0, -0x30, 0xE0, 0x02, 0xD1, 0x37, 0x90, 0x8B, 0x07, -0x12, 0x8A, 0x33, 0x90, 0x93, 0x29, 0xE0, 0x30, -0xE0, 0x1E, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, -0x8A, 0xF9, 0x12, 0x8C, 0xA3, 0x12, 0x8A, 0x2A, -0xF1, 0xB4, 0x30, 0xE0, 0x08, 0x90, 0x8A, 0x89, -0x12, 0x8C, 0xA3, 0xF1, 0xAD, 0x12, 0x8F, 0xF1, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, -0x28, 0x90, 0x96, 0x3E, 0x74, 0x1E, 0xF0, 0x90, -0x96, 0x60, 0x74, 0x01, 0xF0, 0x90, 0x96, 0x40, -0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x3E, -0x12, 0xA5, 0x4B, 0x12, 0x04, 0x7E, 0x90, 0x8A, -0xE5, 0x12, 0x8C, 0xA3, 0x7F, 0x04, 0x12, 0x04, -0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF1, 0x0E, -0xF1, 0xBB, 0x7F, 0x01, 0xD1, 0xC1, 0x90, 0x8B, -0x07, 0xF1, 0xC2, 0x02, 0x04, 0x7A, 0xE4, 0x90, -0x95, 0xF3, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, -0x3B, 0x12, 0xAF, 0xA5, 0x70, 0x36, 0xF1, 0xD2, -0xF0, 0x12, 0xDB, 0x65, 0x90, 0x95, 0xF3, 0x74, -0x01, 0xF0, 0xE4, 0x90, 0x88, 0x3D, 0xF0, 0x04, -0x60, 0x22, 0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, -0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8C, 0xA3, 0x7D, -0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xF1, 0xDA, -0x12, 0x8F, 0xD2, 0x12, 0x8F, 0x60, 0x90, 0x8A, -0xD7, 0x12, 0x8A, 0x33, 0x22, 0x90, 0x02, 0x87, -0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, -0xE0, 0x64, 0x3F, 0x60, 0x05, 0x75, 0x64, 0x01, -0x80, 0x2E, 0x90, 0x02, 0x96, 0xE0, 0x60, 0x05, -0x75, 0x64, 0x10, 0x80, 0x23, 0x90, 0x02, 0x86, -0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, -0x86, 0xE0, 0x30, 0xE3, 0x05, 0x75, 0x64, 0x04, -0x80, 0x0E, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, -0x05, 0x75, 0x64, 0x20, 0x80, 0x02, 0x80, 0x32, -0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, -0xB8, 0xE5, 0x64, 0xF0, 0x7F, 0x00, 0x22, 0xE4, -0xFD, 0xFF, 0x02, 0x6E, 0x71, 0x7D, 0x0C, 0x7F, -0x01, 0x02, 0x04, 0x7E, 0x90, 0x93, 0x29, 0xE0, -0xC3, 0x13, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, -0x7C, 0x74, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, -0xF9, 0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, -0x01, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0x90, 0x05, -0x73, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, -0xF0, 0x22, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0xC0, -0xF0, 0x22, 0x90, 0x8A, 0xDF, 0xF1, 0xC2, 0x02, -0x04, 0x7A, 0x12, 0x97, 0xC2, 0x12, 0x90, 0xC3, -0x12, 0xA0, 0x02, 0x7A, 0x93, 0x79, 0x1B, 0x02, -0x69, 0xF5, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, -0x75, 0x48, 0x05, 0x7B, 0x01, 0x22, 0x12, 0x97, -0xC2, 0x12, 0x90, 0xC3, 0x11, 0x02, 0x7A, 0x93, -0x79, 0x20, 0x02, 0x69, 0xF5, 0x90, 0x94, 0xBE, -0x12, 0x86, 0x76, 0x90, 0x94, 0xBD, 0xEF, 0xF0, -0x12, 0x86, 0x7F, 0xA0, 0xB0, 0x00, 0xA0, 0xB9, -0x01, 0xA0, 0xC2, 0x06, 0xA0, 0xD6, 0x08, 0xA0, -0xDF, 0x09, 0xA0, 0xE8, 0x0A, 0xA0, 0xF0, 0x12, -0xA0, 0xF8, 0x13, 0xA1, 0x00, 0x14, 0xA1, 0x09, -0x1E, 0xA1, 0x11, 0x20, 0xA1, 0x1A, 0x25, 0xA1, -0x22, 0x26, 0xA1, 0x2B, 0x29, 0xA1, 0x34, 0x2A, -0xA1, 0x3D, 0x40, 0xA1, 0x48, 0x42, 0xA1, 0x56, -0x43, 0xA1, 0x5F, 0x44, 0xA2, 0x29, 0x47, 0xA1, -0x68, 0x49, 0xA1, 0x70, 0x60, 0xA1, 0x79, 0x61, -0xA1, 0x82, 0x62, 0xA1, 0x8B, 0x63, 0xA1, 0x94, -0x64, 0xA1, 0x9D, 0x65, 0xA1, 0xA6, 0x66, 0xA1, -0xAF, 0x67, 0xA1, 0xB8, 0x68, 0xA1, 0xC1, 0x69, -0xA1, 0xCA, 0x6B, 0xA1, 0xD3, 0x6C, 0xA1, 0xDC, -0x6D, 0xA1, 0xE5, 0x6E, 0xA1, 0xEE, 0x6F, 0xA1, -0xF7, 0x70, 0xA2, 0x00, 0xC2, 0xA2, 0x08, 0xC3, -0xA2, 0x11, 0xC4, 0xA0, 0xCA, 0xC6, 0xA0, 0xCA, -0xC7, 0xA0, 0xCA, 0xC8, 0x00, 0x00, 0xA2, 0x1A, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0x86, -0xDC, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, -0x90, 0x02, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, -0x61, 0xF9, 0x90, 0x94, 0xBD, 0xE0, 0xFF, 0xA3, -0x12, 0x86, 0x6D, 0x02, 0xBD, 0x1D, 0x90, 0x94, -0xBE, 0x12, 0x86, 0x6D, 0x02, 0x97, 0xFF, 0x90, -0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0x9F, 0xF2, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x01, 0x0E, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x41, 0x2A, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0xE1, 0xEA, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0xAF, -0xE8, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x41, -0xEF, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, -0x93, 0xB1, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, -0xA1, 0xB5, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, -0x02, 0xAF, 0xF7, 0x90, 0x94, 0xBE, 0x12, 0x86, -0x6D, 0x02, 0xB8, 0xB0, 0x90, 0x94, 0xBE, 0x12, -0x86, 0x6D, 0x02, 0xB7, 0xE4, 0x90, 0x94, 0xBE, -0x12, 0x86, 0x6D, 0x90, 0x8A, 0xA5, 0x80, 0x09, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x90, 0x8A, -0xB5, 0xB1, 0x4E, 0x02, 0x04, 0x7E, 0x90, 0x94, -0xBE, 0x12, 0x86, 0x6D, 0x02, 0x25, 0xEC, 0x90, -0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0x5B, 0xF3, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0xE1, 0xB7, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0x90, -0xC9, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, -0x77, 0x4F, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, -0x02, 0x7C, 0x60, 0x90, 0x94, 0xBE, 0x12, 0x86, -0x6D, 0x02, 0x7A, 0xC6, 0x90, 0x94, 0xBE, 0x12, -0x86, 0x6D, 0x02, 0x5D, 0x36, 0x90, 0x94, 0xBE, -0x12, 0x86, 0x6D, 0x02, 0x7B, 0xE9, 0x90, 0x94, -0xBE, 0x12, 0x86, 0x6D, 0x02, 0x70, 0x33, 0x90, -0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0x48, 0xC9, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0x79, -0xF3, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, -0x87, 0xDB, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, -0x02, 0x51, 0x7B, 0x90, 0x94, 0xBE, 0x12, 0x86, -0x6D, 0x02, 0x79, 0x30, 0x90, 0x94, 0xBE, 0x12, -0x86, 0x6D, 0x02, 0x57, 0xF2, 0x90, 0x94, 0xBE, -0x12, 0x86, 0x6D, 0x02, 0x74, 0x8D, 0x90, 0x94, -0xBE, 0x12, 0x86, 0x6D, 0x02, 0x78, 0x9A, 0x90, -0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0x5E, 0x0B, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0xE1, 0xAF, -0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, 0xB8, -0xC6, 0x90, 0x94, 0xBE, 0x12, 0x86, 0x6D, 0x02, -0x87, 0xAE, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, -0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x90, 0x01, 0xC2, -0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, -0x28, 0xF0, 0xBF, 0x01, 0x07, 0x51, 0x3D, 0xE4, -0x90, 0x93, 0x28, 0xF0, 0x22, 0x51, 0xE8, 0x7F, -0xEF, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x06, 0x90, 0x94, 0xC1, 0xE0, 0xA3, 0xF0, 0x51, -0xE8, 0x7F, 0xEE, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -0xBF, 0x01, 0x08, 0x90, 0x94, 0xC1, 0xE0, 0x90, -0x94, 0xC3, 0xF0, 0x51, 0xE8, 0x7F, 0xED, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -0x94, 0xC1, 0xE0, 0x90, 0x94, 0xC4, 0xF0, 0x51, -0xE8, 0x7F, 0xEC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -0xBF, 0x01, 0x08, 0x90, 0x94, 0xC1, 0xE0, 0x90, -0x94, 0xC5, 0xF0, 0x51, 0xE8, 0x7F, 0xEB, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -0x94, 0xC1, 0xE0, 0x90, 0x94, 0xC6, 0xF0, 0x90, -0x94, 0xC2, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, -0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x94, 0xCA, 0xF0, -0x90, 0x94, 0xC6, 0xE0, 0x90, 0x94, 0xCB, 0xF0, -0x90, 0x94, 0xCC, 0x74, 0x12, 0xF0, 0x90, 0x94, -0xEE, 0x74, 0x05, 0xF0, 0x90, 0x94, 0xCE, 0xF1, -0xD8, 0x90, 0x94, 0xCA, 0xE0, 0x90, 0x94, 0xD1, -0xF0, 0x90, 0x94, 0xCB, 0xE0, 0x90, 0x94, 0xD2, -0xF0, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xCC, 0x12, -0x8C, 0x91, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xF0, -0x7B, 0x01, 0x7A, 0x94, 0x79, 0xC1, 0x22, 0x12, -0x02, 0x06, 0x90, 0x94, 0xE4, 0xF0, 0x12, 0x87, -0xA8, 0x90, 0x94, 0xE5, 0xF0, 0x60, 0x0D, 0x71, -0x39, 0xB1, 0x58, 0x90, 0x94, 0xE5, 0x71, 0x39, -0x7B, 0x57, 0x71, 0x45, 0x90, 0x94, 0xC1, 0x74, -0x20, 0xF0, 0x90, 0x94, 0xE3, 0x74, 0x03, 0xF0, -0x90, 0x05, 0x22, 0xE0, 0x90, 0x94, 0xC3, 0xF0, -0x90, 0x93, 0x5D, 0xE0, 0x90, 0x94, 0xC4, 0xF0, -0x90, 0x93, 0x5E, 0xE0, 0x90, 0x94, 0xC5, 0x51, -0xE7, 0x12, 0x8C, 0x91, 0x7F, 0x04, 0x02, 0x04, -0x7E, 0xE0, 0xFF, 0x90, 0x94, 0xE4, 0xE0, 0xFD, -0x22, 0x7D, 0xFF, 0xE4, 0xFF, 0xEB, 0xB4, 0x57, -0x04, 0x71, 0xE1, 0x80, 0x0E, 0xEF, 0x70, 0x07, -0x90, 0x93, 0x5D, 0xE0, 0x4D, 0x80, 0x04, 0xB1, -0x70, 0x71, 0xE1, 0x90, 0x05, 0x22, 0xF0, 0x90, -0x93, 0x01, 0xEB, 0xF0, 0x22, 0xE4, 0x90, 0x96, -0xAD, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, -0x90, 0x96, 0xAF, 0xF0, 0x7B, 0x47, 0x71, 0x41, -0x90, 0x05, 0xF8, 0xE0, 0x70, 0x1A, 0xA3, 0xE0, -0x70, 0x16, 0xA3, 0xE0, 0x70, 0x12, 0xA3, 0xE0, -0x70, 0x0E, 0x90, 0x96, 0xAF, 0xE0, 0xFD, 0x7B, -0x48, 0xE4, 0xFF, 0x71, 0x45, 0x7F, 0x01, 0x22, -0xB1, 0x25, 0x54, 0x03, 0x30, 0xE0, 0x19, 0xD3, -0x90, 0x96, 0xAE, 0xE0, 0x94, 0x03, 0x90, 0x96, -0xAD, 0xE0, 0x94, 0x00, 0x40, 0x06, 0x71, 0xEC, -0x7B, 0x5A, 0x80, 0x17, 0x7F, 0x01, 0x80, 0x1C, -0xD3, 0x90, 0x96, 0xAE, 0xE0, 0x94, 0xE8, 0x90, -0x96, 0xAD, 0xE0, 0x94, 0x03, 0x40, 0x0B, 0x71, -0xEC, 0x7B, 0x5B, 0xE4, 0xFF, 0x71, 0x45, 0x7F, -0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, -0x6A, 0x90, 0x96, 0xAD, 0x12, 0x9D, 0xF5, 0x80, -0x97, 0x90, 0x93, 0x5E, 0xE0, 0xFF, 0x90, 0x93, -0x5D, 0xE0, 0x4F, 0x22, 0x90, 0x01, 0xC0, 0xE0, -0x44, 0x20, 0xF0, 0x90, 0x96, 0xAF, 0xE0, 0xFD, -0x22, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, -0x81, 0x8A, 0x90, 0x95, 0x08, 0xF0, 0x90, 0x95, -0x08, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x28, -0xEF, 0x12, 0xBE, 0x52, 0x7A, 0x95, 0x79, 0x07, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x12, 0x90, 0x95, -0x07, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x09, 0xF5, -0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEF, 0xF0, -0x90, 0x95, 0x08, 0xE0, 0x04, 0xF0, 0x80, 0xCE, -0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, -0x09, 0x75, 0x48, 0x08, 0x12, 0x8F, 0xEA, 0x12, -0x69, 0xF5, 0x90, 0x94, 0xC1, 0x74, 0x24, 0xF0, -0x90, 0x94, 0xE3, 0x74, 0x08, 0xF0, 0x75, 0x45, -0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x11, 0xF5, -0x48, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xE6, 0x12, -0x69, 0xF5, 0x90, 0x94, 0xE4, 0x74, 0x25, 0xF0, -0x90, 0x95, 0x06, 0x74, 0x08, 0x51, 0xE7, 0xB1, -0x4B, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x94, -0x79, 0xE4, 0x12, 0x8C, 0x91, 0x7F, 0x04, 0x12, -0x04, 0x7E, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x96, 0xA4, 0xEF, 0xF0, 0xA3, -0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, -0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x07, 0x90, -0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, -0x1D, 0xE0, 0x60, 0x38, 0x90, 0x05, 0x22, 0xE0, -0x90, 0x96, 0xA8, 0xF0, 0x7B, 0x26, 0x71, 0x41, -0x90, 0x8A, 0xFD, 0x12, 0x8A, 0x33, 0xEF, 0x64, -0x01, 0x70, 0x02, 0x80, 0x07, 0xB1, 0x25, 0x54, -0x03, 0x30, 0xE0, 0x09, 0xB1, 0x82, 0xB1, 0x39, -0x90, 0x8A, 0x9B, 0xB1, 0x2D, 0x90, 0x96, 0xA8, -0xE0, 0xFD, 0x7B, 0x27, 0xE4, 0xFF, 0x71, 0x45, -0xB1, 0x42, 0x80, 0x0B, 0xB1, 0x42, 0xB1, 0x2D, -0xB1, 0x82, 0xB1, 0x39, 0x90, 0x8A, 0x9B, 0xB1, -0x2D, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x18, -0xB1, 0x25, 0x54, 0x03, 0x30, 0xE0, 0x11, 0x90, -0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, 0x90, 0x8A, -0xF9, 0xD1, 0x54, 0x7D, 0x28, 0x12, 0x04, 0x7E, -0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xA1, -0xE0, 0xC4, 0x13, 0x13, 0x22, 0xE0, 0xFC, 0xA3, -0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, 0x04, -0x7E, 0x90, 0x96, 0xA6, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0x22, 0x90, 0x96, 0xA4, 0xE0, 0xFF, 0x90, -0x8A, 0xC7, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, -0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, -0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, 0x5D, 0xED, -0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x93, 0x5D, -0xE0, 0x5E, 0xFE, 0xED, 0x5F, 0x4E, 0xF0, 0x22, -0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, 0x5E, 0xED, -0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x93, 0x5E, -0x80, 0xE6, 0x90, 0x86, 0xB6, 0xE0, 0xFF, 0x90, -0x96, 0xA5, 0xE0, 0xFB, 0x90, 0x92, 0x13, 0x74, -0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, -0x96, 0xA6, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, -0xFD, 0x90, 0x96, 0xA4, 0xE0, 0xFF, 0x90, 0x8A, -0x95, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, -0x8A, 0x83, 0x02, 0x04, 0x7E, 0x12, 0x02, 0x06, -0x90, 0x88, 0x9C, 0xF0, 0x60, 0x34, 0xA3, 0xE0, -0x20, 0xE0, 0x2F, 0x90, 0x8A, 0xB9, 0x12, 0x8C, -0xA3, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, -0xF1, 0xBF, 0x30, 0xE0, 0x1D, 0xEF, 0x13, 0x13, -0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, 0x88, -0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, 0x12, -0x71, 0x9A, 0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, -0x12, 0x94, 0xA8, 0x30, 0xE0, 0x1E, 0xEF, 0x54, -0x7F, 0xF1, 0xE1, 0x30, 0xE1, 0x06, 0xE0, 0x44, -0x02, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFD, 0x12, -0xC6, 0x6D, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x02, 0xD1, 0x45, 0xB1, 0x25, 0x54, 0x03, -0x30, 0xE0, 0x21, 0x90, 0x88, 0xA4, 0xE0, 0xFF, -0xC3, 0x13, 0x30, 0xE0, 0x17, 0xEF, 0x54, 0xFD, -0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, -0x30, 0xE1, 0x05, 0xE0, 0x44, 0x04, 0xF0, 0x22, -0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x88, 0x38, -0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0xD1, 0x54, 0x7D, -0x01, 0x02, 0x04, 0x7E, 0xE0, 0xFC, 0xA3, 0xE0, -0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x96, 0x9F, -0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, 0x70, 0x51, -0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEE, -0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, 0x90, 0x96, -0xA0, 0x12, 0x04, 0x31, 0xE4, 0x7F, 0x80, 0xF1, -0x43, 0x70, 0x05, 0x90, 0x88, 0xBE, 0x80, 0x1B, -0xE4, 0xFF, 0xFE, 0xF1, 0x45, 0x70, 0x0A, 0x90, -0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, -0x56, 0xE4, 0xFF, 0xF1, 0x43, 0x70, 0x09, 0x90, -0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, 0x80, 0x47, -0xE4, 0x7F, 0x80, 0xFE, 0xF1, 0x45, 0x70, 0x3F, -0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, 0xF0, 0x80, -0x36, 0x7F, 0x2C, 0x7E, 0x09, 0x12, 0x70, 0x70, -0xEF, 0x54, 0x02, 0xF1, 0x58, 0x60, 0x08, 0x90, -0x88, 0xBE, 0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, -0x90, 0x88, 0xBE, 0xF0, 0x7F, 0x30, 0x7E, 0x09, -0x12, 0x70, 0x70, 0xEF, 0x54, 0x01, 0xF1, 0x58, -0x60, 0x07, 0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, -0x06, 0x90, 0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, -0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, -0xF9, 0x12, 0x8C, 0xA3, 0x7D, 0x11, 0xF1, 0xCF, -0x12, 0x8A, 0x33, 0x90, 0x07, 0x78, 0xE0, 0x90, -0x88, 0xBD, 0xF0, 0x90, 0x88, 0xDF, 0xE0, 0xFF, -0x90, 0x8A, 0xF3, 0xD1, 0x54, 0xE4, 0xFD, 0x12, -0x04, 0x7E, 0x90, 0x96, 0x9F, 0xE0, 0xFD, 0x70, -0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0xF1, -0x51, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, 0x9F, -0xE0, 0xFD, 0xB4, 0x02, 0x06, 0xF1, 0x51, 0x44, -0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0xF1, -0x51, 0xF0, 0x22, 0x7E, 0x02, 0xFD, 0xFC, 0x90, -0x96, 0xA0, 0x12, 0x86, 0x61, 0xC3, 0x02, 0x03, -0xDA, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, -0xFF, 0xE4, 0xFE, 0xFD, 0xFC, 0x90, 0x96, 0xA0, -0x12, 0x04, 0x31, 0x90, 0x96, 0xA0, 0x12, 0x04, -0xB8, 0xEC, 0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x13, 0x90, 0x06, 0x92, 0xE0, -0x30, 0xE1, 0x08, 0x90, 0x8B, 0x01, 0x12, 0x8A, -0x33, 0x80, 0x04, 0xF1, 0xC7, 0xD1, 0x45, 0x90, -0x93, 0x57, 0xE0, 0xFF, 0x12, 0x94, 0xA8, 0x30, -0xE0, 0x1C, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -0x03, 0x12, 0xD0, 0x12, 0x90, 0x93, 0x58, 0xE0, -0x30, 0xE0, 0x0B, 0x12, 0xA9, 0xB1, 0x20, 0xE0, -0x02, 0x7D, 0x01, 0x12, 0xA8, 0x5B, 0x22, 0x12, -0x02, 0x06, 0x90, 0x93, 0x4A, 0xF0, 0x22, 0x12, -0x02, 0x06, 0x90, 0x96, 0x17, 0xF0, 0x22, 0x90, -0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0x90, -0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x7F, -0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, -0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, -0x32, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x80, -0xFE, 0x90, 0x93, 0x57, 0xE0, 0x54, 0x7F, 0x4E, -0xFE, 0xF0, 0xEF, 0x54, 0x40, 0xFF, 0xEE, 0x54, -0xBF, 0x4F, 0xF1, 0x02, 0x54, 0x20, 0xFD, 0xEF, -0x54, 0xDF, 0x4D, 0xFF, 0x90, 0x93, 0x57, 0xF0, -0xEE, 0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, -0xFF, 0xF0, 0x12, 0x02, 0x06, 0x54, 0x0F, 0xFE, -0xEF, 0x54, 0xF0, 0x4E, 0x90, 0x93, 0x57, 0xF0, -0x12, 0x87, 0xA8, 0xFF, 0x54, 0x7F, 0x90, 0x93, -0x59, 0xF0, 0xEF, 0x12, 0x94, 0xA6, 0xFF, 0x90, -0x93, 0x58, 0xE0, 0x54, 0xFE, 0x4F, 0x12, 0x87, -0x2D, 0x90, 0x93, 0x5A, 0x12, 0x87, 0x3E, 0x54, -0x01, 0x25, 0xE0, 0xFF, 0x90, 0x93, 0x58, 0xE0, -0x54, 0xFD, 0x4F, 0xF0, 0x31, 0xB1, 0x20, 0xE0, -0x02, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x96, 0xBB, 0xED, 0xF0, 0x90, -0x96, 0xBA, 0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, -0x42, 0x7F, 0x47, 0x31, 0x05, 0x80, 0x02, 0xC3, -0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, -0x12, 0x7B, 0x2E, 0x7F, 0x46, 0x31, 0x05, 0x80, -0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, -0x46, 0x31, 0xCA, 0x60, 0x0D, 0x7F, 0x45, 0x31, -0x05, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, -0x80, 0x0C, 0x7F, 0x45, 0x31, 0x05, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, -0x45, 0x80, 0x4A, 0x90, 0x96, 0xBA, 0xE0, 0x24, -0xF8, 0xF0, 0x7F, 0x63, 0x31, 0x05, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, -0x63, 0x12, 0x7B, 0x2E, 0x7F, 0x62, 0x31, 0x05, -0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, -0x7F, 0x62, 0x31, 0xCA, 0x60, 0x10, 0x7F, 0x61, -0x31, 0x05, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0F, 0x7F, 0x61, -0x31, 0x05, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -0xF4, 0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x7B, 0x41, -0x90, 0x96, 0xBA, 0xE0, 0xFE, 0x74, 0x01, 0xA8, -0x06, 0x08, 0x22, 0xAD, 0x07, 0x90, 0x93, 0x59, -0xE0, 0x75, 0xF0, 0x20, 0xA4, 0xFF, 0x90, 0x96, -0x93, 0xE5, 0xF0, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -0x93, 0x5A, 0xE0, 0x75, 0xF0, 0x08, 0xA4, 0xAE, -0xF0, 0x90, 0x96, 0x95, 0xF0, 0xEE, 0xA3, 0xF0, -0x31, 0xC2, 0x90, 0x96, 0x97, 0xF0, 0xEE, 0xA3, -0xF0, 0xED, 0x64, 0x01, 0x60, 0x63, 0x90, 0x93, -0x57, 0xE0, 0xFE, 0x12, 0x94, 0xA8, 0x30, 0xE0, -0x58, 0xEE, 0x31, 0xB6, 0x20, 0xE0, 0x02, 0x7D, -0x01, 0x31, 0xAA, 0xFE, 0x54, 0x0F, 0xFF, 0xEE, -0xC4, 0x13, 0x13, 0x54, 0x01, 0xFD, 0x31, 0xAA, -0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x23, 0xA3, -0xE0, 0x30, 0xE0, 0x0F, 0x90, 0x96, 0x98, 0xE0, -0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0x97, 0x31, -0xD2, 0x80, 0x0F, 0x31, 0xC2, 0xFF, 0x12, 0x7C, -0x6A, 0x31, 0xB1, 0x20, 0xE0, 0x02, 0x7D, 0x01, -0x11, 0x5B, 0x90, 0x93, 0x57, 0xE0, 0xC4, 0x54, -0x0F, 0x30, 0xE0, 0x0D, 0x90, 0x96, 0x96, 0xE0, -0x90, 0x92, 0x20, 0xF0, 0x90, 0x96, 0x95, 0x31, -0xD2, 0x22, 0x11, 0x5B, 0x90, 0x93, 0x57, 0xE0, -0x22, 0x90, 0x93, 0x57, 0xE0, 0xFE, 0x54, 0x0F, -0xFF, 0xEE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x7D, -0x00, 0x22, 0x90, 0x96, 0x93, 0xE0, 0xFE, 0xA3, -0xE0, 0x22, 0x12, 0x7B, 0x2E, 0x90, 0x96, 0xBB, -0xE0, 0x22, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, -0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, -0x33, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x96, 0x73, 0x12, 0xA7, 0xD8, 0x12, 0xB7, -0x7A, 0x90, 0x96, 0x7E, 0xF0, 0xE4, 0x90, 0x96, -0x7B, 0xF0, 0x90, 0x96, 0x73, 0xF1, 0x1B, 0x90, -0x96, 0x76, 0xF0, 0xEF, 0x54, 0x07, 0x90, 0x96, -0x78, 0xF0, 0x90, 0x96, 0x73, 0xE0, 0x71, 0x34, -0xE0, 0x90, 0x96, 0x79, 0xF0, 0xD1, 0x0C, 0x54, -0x7F, 0x90, 0x96, 0x7C, 0xF0, 0x90, 0x96, 0x73, -0xE0, 0xD1, 0x20, 0xE0, 0x90, 0x96, 0x7D, 0xF0, -0xED, 0x54, 0x7F, 0x90, 0x96, 0x77, 0xF0, 0xEB, -0x70, 0x1F, 0x90, 0x89, 0x3D, 0x91, 0x08, 0xFF, -0xF1, 0xC3, 0xFD, 0x90, 0x89, 0x40, 0x91, 0x10, -0x2D, 0xFF, 0xE4, 0x35, 0xF0, 0xC3, 0x13, 0xFE, -0xEF, 0x13, 0xFF, 0x90, 0x96, 0x73, 0xE0, 0xB1, -0x46, 0x90, 0x96, 0x7C, 0xE0, 0xFF, 0x90, 0x96, -0x77, 0xE0, 0xFE, 0xD3, 0x9F, 0x40, 0x0C, 0x90, -0x96, 0x74, 0xE0, 0x54, 0x80, 0xFD, 0xEF, 0x4D, -0xF0, 0x80, 0x0F, 0x90, 0x96, 0x7D, 0xE0, 0xFF, -0xEE, 0xC3, 0x9F, 0x50, 0x05, 0x90, 0x96, 0x74, -0xEF, 0xF0, 0x90, 0x96, 0x74, 0xE0, 0xFE, 0x54, -0x7F, 0x90, 0x96, 0x77, 0xF0, 0xEE, 0x54, 0x80, -0x90, 0x96, 0x7A, 0xF0, 0x90, 0x96, 0x75, 0xE0, -0x70, 0x24, 0xA3, 0x91, 0x1B, 0xC0, 0x83, 0xC0, -0x82, 0xE0, 0xFF, 0x90, 0x96, 0x78, 0x31, 0x0B, -0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x96, 0x79, -0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x40, 0x90, 0x96, -0x76, 0x91, 0x1B, 0xC0, 0x83, 0xC0, 0x82, 0xE0, -0xFF, 0x90, 0x96, 0x78, 0x31, 0x0B, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, 0xD0, -0x83, 0xF0, 0x90, 0x96, 0x73, 0xE0, 0x71, 0x34, -0xE0, 0x54, 0x07, 0xFF, 0x90, 0x96, 0x79, 0xF0, -0x90, 0x89, 0x46, 0x91, 0x08, 0xF5, 0x82, 0x91, -0x15, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x4F, 0x90, -0x96, 0x79, 0xF0, 0x44, 0x80, 0xF0, 0x90, 0x96, -0x74, 0x91, 0x00, 0x71, 0x50, 0xEF, 0xF0, 0xEE, -0x70, 0x05, 0x90, 0x01, 0xC8, 0xEF, 0xF0, 0x90, -0x96, 0x79, 0x91, 0x00, 0x71, 0x34, 0xEF, 0xF0, -0xEE, 0x71, 0xE6, 0xE0, 0x54, 0xFC, 0xFF, 0x90, -0x96, 0x7E, 0xE0, 0x54, 0x03, 0x4F, 0xFE, 0x90, -0x96, 0x73, 0xE0, 0xFF, 0x71, 0xE6, 0xEE, 0xF0, -0x7D, 0x01, 0x12, 0xBB, 0x9B, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xE5, 0x65, 0xC4, 0x54, 0xF0, 0x24, -0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, 0x82, 0xE4, -0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0xE5, 0x61, -0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, -0x34, 0x81, 0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, -0x30, 0xE6, 0x1E, 0x71, 0x4E, 0xE0, 0xFD, 0xE5, -0x61, 0x71, 0xE6, 0xE0, 0x54, 0x03, 0x90, 0x92, -0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x61, 0x12, 0x75, -0x80, 0x71, 0x41, 0x71, 0xDD, 0x74, 0x01, 0x80, -0x53, 0x71, 0xF3, 0x04, 0xF0, 0x71, 0xF3, 0x64, -0x02, 0x70, 0x1F, 0x74, 0x29, 0x25, 0x61, 0x91, -0x61, 0xE0, 0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, -0x71, 0x4E, 0xE0, 0xFD, 0xE5, 0x61, 0x71, 0xE6, -0x91, 0x26, 0x71, 0x4E, 0x71, 0xDD, 0x74, 0x02, -0x80, 0x2A, 0x71, 0xF3, 0xD3, 0x94, 0x03, 0x40, -0x13, 0x90, 0x8A, 0xB3, 0x12, 0x8C, 0xA3, 0xAF, -0x61, 0x12, 0x04, 0x7E, 0x71, 0x41, 0x71, 0xDD, -0x74, 0x03, 0x80, 0x10, 0x71, 0x4E, 0xE0, 0xFD, -0xE5, 0x61, 0x71, 0xE6, 0x91, 0x26, 0x71, 0x4E, -0x71, 0xDD, 0x74, 0x02, 0xF0, 0xAB, 0x61, 0xE4, -0xFD, 0xFF, 0x02, 0x6F, 0x75, 0xE0, 0x90, 0x92, -0x5E, 0xF0, 0xA3, 0x22, 0xE5, 0x65, 0xC4, 0x54, -0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, -0xF5, 0x83, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, -0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE0, 0x22, -0xE0, 0xFF, 0x90, 0x96, 0x73, 0xE0, 0xFE, 0x22, -0x12, 0x86, 0x6D, 0x90, 0x96, 0x77, 0xE0, 0x22, -0x12, 0x86, 0x6D, 0x8F, 0x82, 0x75, 0x83, 0x00, -0x02, 0x02, 0x1F, 0xE0, 0x24, 0x6F, 0xF5, 0x82, -0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, 0x54, -0x03, 0x90, 0x92, 0x80, 0xF0, 0x7B, 0x01, 0xAF, -0x61, 0x02, 0x75, 0x80, 0x90, 0x95, 0xC5, 0x12, -0x86, 0x76, 0xE4, 0xFF, 0x90, 0x95, 0xCB, 0xE0, -0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x14, 0x90, 0x95, -0xC8, 0x91, 0x10, 0xFE, 0x90, 0x95, 0xC5, 0x91, -0x10, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, -0x80, 0xE2, 0x7F, 0x01, 0x22, 0x74, 0x29, 0x25, -0x73, 0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, -0x22, 0x8F, 0x73, 0x8D, 0x74, 0xEF, 0x71, 0x50, -0xE0, 0xFD, 0x54, 0x7F, 0xF5, 0x75, 0xED, 0x54, -0x80, 0xF5, 0x76, 0xD1, 0x0C, 0xF5, 0x78, 0x75, -0xF0, 0x12, 0xEF, 0x12, 0x87, 0xC6, 0xC4, 0x54, -0x03, 0xF5, 0x79, 0x91, 0x5D, 0x74, 0xFF, 0xF0, -0xB1, 0x30, 0xE5, 0x76, 0x4D, 0xFF, 0xB1, 0x24, -0xEF, 0xF0, 0xE5, 0x73, 0x71, 0xE6, 0xE0, 0x54, -0x03, 0xF5, 0x77, 0x74, 0x46, 0x25, 0x73, 0xD1, -0x18, 0xE5, 0x77, 0xF0, 0xE5, 0x75, 0x65, 0x78, -0x70, 0x23, 0x75, 0xF0, 0x12, 0xE5, 0x73, 0x12, -0x97, 0x60, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -0x0B, 0xE5, 0x76, 0x70, 0x07, 0xE5, 0x75, 0x44, -0x80, 0xFD, 0x80, 0x4B, 0xB1, 0x30, 0x7D, 0x07, -0xAF, 0x73, 0x02, 0xBC, 0x5A, 0xE5, 0x75, 0xC3, -0x95, 0x78, 0x50, 0x35, 0xAB, 0x73, 0xAD, 0x78, -0xAF, 0x75, 0x12, 0x72, 0x7F, 0xAD, 0x07, 0xE5, -0x75, 0xC3, 0x94, 0x0C, 0x40, 0x29, 0x75, 0xF0, -0x12, 0xE5, 0x73, 0x12, 0x97, 0x60, 0xFE, 0xC4, -0x13, 0x54, 0x07, 0x30, 0xE0, 0x19, 0xE5, 0x74, -0x60, 0x15, 0xE5, 0x76, 0x70, 0x11, 0xE5, 0x75, -0x44, 0x80, 0xFD, 0x91, 0x5D, 0xEF, 0xF0, 0x80, -0x06, 0xB1, 0x24, 0xE5, 0x78, 0xF0, 0xFD, 0x90, -0x92, 0x80, 0xE5, 0x77, 0xF0, 0xAB, 0x74, 0xAF, -0x73, 0x02, 0x75, 0x80, 0x74, 0xC6, 0x25, 0x73, -0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, -0xE5, 0x75, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, -0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, 0xFE, -0x74, 0x01, 0x93, 0xFF, 0xE5, 0x73, 0x25, 0xE0, -0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xAA, -0x07, 0xA9, 0x05, 0xEA, 0x71, 0x50, 0xE0, 0xF5, -0x73, 0x54, 0x7F, 0xF5, 0x75, 0x75, 0xF0, 0x12, -0xEA, 0xD1, 0x23, 0xE0, 0x90, 0x95, 0x53, 0xF0, -0x75, 0xF0, 0x12, 0xEA, 0xD1, 0x10, 0xFF, 0xEA, -0x71, 0xE6, 0xE0, 0x54, 0x03, 0xF5, 0x74, 0xE5, -0x75, 0x90, 0x81, 0x9D, 0x93, 0xFD, 0xEA, 0x25, -0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xED, 0xF0, 0x75, -0xF0, 0x12, 0xEA, 0x12, 0x87, 0xC6, 0xFE, 0xC4, -0x54, 0x03, 0x90, 0x95, 0x52, 0xF0, 0x74, 0xC6, -0x2A, 0xB1, 0x28, 0xE5, 0x75, 0xF0, 0x74, 0x46, -0x2A, 0xD1, 0x18, 0xE5, 0x74, 0xF0, 0xE5, 0x75, -0xD3, 0x9F, 0x40, 0x04, 0x8F, 0x75, 0x8F, 0x73, -0x89, 0x76, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x76, -0x50, 0x33, 0xE5, 0x73, 0x30, 0xE7, 0x09, 0x85, -0x75, 0x73, 0x19, 0xE9, 0x70, 0x24, 0x80, 0x25, -0x90, 0x95, 0x53, 0xE0, 0xFD, 0xE5, 0x75, 0xD3, -0x9D, 0x40, 0x0F, 0xAB, 0x02, 0x90, 0x95, 0x57, -0xE9, 0xF0, 0xAF, 0x75, 0xD1, 0x8F, 0x8F, 0x73, -0x80, 0x0B, 0x90, 0x95, 0x53, 0xE0, 0xF5, 0x73, -0x80, 0x03, 0x0F, 0x80, 0xC7, 0xAF, 0x02, 0x90, -0x92, 0x80, 0xE5, 0x74, 0xF0, 0xE4, 0xFB, 0xAD, -0x73, 0x02, 0x75, 0x80, 0x75, 0xF0, 0x12, 0xEF, -0x90, 0x89, 0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, -0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, -0x75, 0xF0, 0x12, 0x90, 0x89, 0x50, 0x02, 0x04, -0x6E, 0xE6, 0xFD, 0xAF, 0x65, 0xEF, 0x71, 0x34, -0xE0, 0x54, 0xF8, 0xF5, 0x73, 0xED, 0x42, 0x73, -0xEF, 0x71, 0x34, 0xE5, 0x73, 0xF0, 0x22, 0xD3, +0xEC, 0x3E, 0x22, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, +0xEB, 0xB4, 0x57, 0x04, 0x71, 0x70, 0x80, 0x0E, +0xEF, 0x70, 0x07, 0x90, 0x93, 0x5D, 0xE0, 0x4D, +0x80, 0x04, 0xF1, 0xBF, 0x71, 0x70, 0x90, 0x05, +0x22, 0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, +0x90, 0x93, 0x5E, 0xE0, 0xFF, 0x90, 0x93, 0x5D, +0xE0, 0x4F, 0x22, 0x90, 0x01, 0x17, 0xE0, 0xFE, +0x90, 0x01, 0x16, 0x71, 0x42, 0x90, 0x88, 0x27, +0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x86, 0xE0, +0x44, 0x04, 0xF0, 0x90, 0x93, 0x03, 0xE0, 0x44, +0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, +0x74, 0x90, 0x05, 0x52, 0xE0, 0x54, 0x07, 0x04, +0x90, 0x93, 0x0E, 0x12, 0xA7, 0xAE, 0x90, 0x04, +0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x12, 0x02, +0x06, 0x90, 0x94, 0xD9, 0xF0, 0x11, 0xAC, 0x90, +0x94, 0xDA, 0xF0, 0x60, 0x0D, 0xB1, 0x3C, 0xF1, +0xD7, 0x90, 0x94, 0xDA, 0xB1, 0x3C, 0x7B, 0x57, +0x71, 0x50, 0x90, 0x94, 0xB6, 0x74, 0x20, 0xF0, +0x90, 0x94, 0xD8, 0x74, 0x03, 0xF0, 0x90, 0x05, +0x22, 0xE0, 0x90, 0x94, 0xB8, 0xF0, 0x90, 0x93, +0x5D, 0xE0, 0x90, 0x94, 0xB9, 0xF0, 0x90, 0x93, +0x5E, 0xE0, 0x90, 0x94, 0xBA, 0x71, 0xFF, 0x12, +0x8B, 0x34, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xF0, +0x7B, 0x01, 0x7A, 0x94, 0x79, 0xB6, 0x22, 0x91, +0x00, 0x7F, 0xEF, 0x7E, 0x01, 0x12, 0x5F, 0xA6, +0xBF, 0x01, 0x06, 0x90, 0x94, 0xB6, 0xE0, 0xA3, +0xF0, 0x91, 0x00, 0x7F, 0xEE, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xB6, +0xE0, 0x90, 0x94, 0xB8, 0xF0, 0x91, 0x00, 0x7F, +0xED, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, +0x08, 0x90, 0x94, 0xB6, 0xE0, 0x90, 0x94, 0xB9, +0xF0, 0x91, 0x00, 0x7F, 0xEC, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x94, 0xB6, +0xE0, 0x90, 0x94, 0xBA, 0xF0, 0x91, 0x00, 0x7F, +0xEB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, +0x08, 0x90, 0x94, 0xB6, 0xE0, 0x90, 0x94, 0xBB, +0xF0, 0x90, 0x94, 0xB7, 0xE0, 0xFF, 0xA3, 0xE0, +0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x94, +0xBF, 0xF0, 0x90, 0x94, 0xBB, 0xE0, 0x90, 0x94, +0xC0, 0xF0, 0x90, 0x94, 0xC1, 0x74, 0x12, 0xF0, +0x90, 0x94, 0xE3, 0x74, 0x05, 0xF0, 0x90, 0x94, +0xC3, 0x12, 0xDD, 0x62, 0x90, 0x94, 0xBF, 0xE0, +0x90, 0x94, 0xC6, 0xF0, 0x90, 0x94, 0xC0, 0xE0, +0x90, 0x94, 0xC7, 0xF0, 0x7B, 0x01, 0x7A, 0x94, +0x79, 0xC1, 0x12, 0x8B, 0x34, 0x7F, 0x04, 0x02, +0x04, 0x7E, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, +0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4C, 0x12, 0x04, +0x80, 0x91, 0x00, 0x12, 0xDD, 0x9C, 0xBF, 0x01, +0x1C, 0x90, 0x94, 0xB6, 0xE0, 0xFE, 0x54, 0x01, +0x90, 0x93, 0x4C, 0xF0, 0xEE, 0x54, 0x04, 0x90, +0x93, 0x4E, 0xF0, 0x90, 0x94, 0xB6, 0xE0, 0x54, +0x08, 0x90, 0x93, 0x4D, 0xF0, 0x91, 0x00, 0x12, +0xDC, 0xC1, 0x70, 0x35, 0x90, 0x94, 0xB6, 0xE0, +0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0x94, +0x79, 0xB7, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, +0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x94, 0xB7, 0x80, +0x03, 0x90, 0x94, 0xB6, 0xE0, 0x54, 0x07, 0x90, +0x93, 0x50, 0xF0, 0x90, 0x94, 0xB6, 0xE0, 0x54, +0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x93, 0x4F, +0xF0, 0x91, 0x00, 0x7F, 0xFD, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x94, 0xB6, +0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, +0x93, 0x51, 0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x94, +0xD9, 0xE0, 0xFD, 0x22, 0xE4, 0x90, 0x96, 0xB8, +0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, +0x96, 0xBA, 0xF0, 0x7B, 0x47, 0xD1, 0x5A, 0x90, +0x05, 0xF8, 0xE0, 0x70, 0x1A, 0xA3, 0xE0, 0x70, +0x16, 0xA3, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, +0x0E, 0x90, 0x96, 0xBA, 0xE0, 0xFD, 0x7B, 0x48, +0xE4, 0xFF, 0x71, 0x50, 0x7F, 0x01, 0x22, 0xB1, +0xBD, 0x30, 0xE0, 0x19, 0xD3, 0x90, 0x96, 0xB9, +0xE0, 0x94, 0x03, 0x90, 0x96, 0xB8, 0xE0, 0x94, +0x00, 0x40, 0x06, 0xD1, 0x60, 0x7B, 0x5A, 0x80, +0x17, 0x7F, 0x01, 0x80, 0x1C, 0xD3, 0x90, 0x96, +0xB9, 0xE0, 0x94, 0xE8, 0x90, 0x96, 0xB8, 0xE0, +0x94, 0x03, 0x40, 0x0B, 0xD1, 0x60, 0x7B, 0x5B, +0xE4, 0xFF, 0x71, 0x50, 0x7F, 0x00, 0x22, 0x7F, +0x32, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x96, +0xB8, 0xF1, 0xEF, 0x80, 0x9A, 0x90, 0x88, 0xA1, +0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0xB8, 0xEF, 0xF0, 0x12, 0x97, 0xD3, 0x30, 0xE6, -0x39, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, -0x01, 0x70, 0x2F, 0x90, 0x96, 0xB9, 0xF0, 0x90, -0x96, 0xB9, 0xE0, 0xFD, 0x90, 0x96, 0xB8, 0xE0, -0x71, 0x50, 0xE5, 0x82, 0x2D, 0xF1, 0x10, 0xE0, -0xFB, 0xE4, 0xFF, 0x12, 0x95, 0xD2, 0x90, 0x96, -0xB9, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, -0x40, 0xDD, 0x12, 0x97, 0xD3, 0x30, 0xE0, 0x02, -0xF1, 0x09, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, -0xF5, 0x78, 0xEF, 0x14, 0xF5, 0x77, 0xED, 0xFF, -0xE5, 0x77, 0xF5, 0x82, 0x33, 0x95, 0xE0, 0xF5, -0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, 0xF8, -0x65, 0x83, 0x98, 0x40, 0x52, 0xE5, 0x77, 0x78, -0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, 0x33, -0x95, 0xE0, 0xFE, 0xEB, 0x12, 0xDC, 0x17, 0xE5, -0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, 0xF5, -0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, 0xE5, -0x77, 0x12, 0x9B, 0xA2, 0x80, 0x05, 0xC3, 0x33, -0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x55, -0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, 0x60, 0x13, -0x85, 0x77, 0x79, 0x05, 0x78, 0x90, 0x95, 0x57, -0xE0, 0x65, 0x78, 0x60, 0x0A, 0xE5, 0x79, 0xD3, -0x9D, 0x40, 0x04, 0x15, 0x77, 0x80, 0x97, 0xAF, -0x79, 0x22, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0xFE, -0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, 0x7B, 0x2E, -0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, -0x90, 0x93, 0x29, 0xE0, 0xFF, 0x13, 0x13, 0x13, -0x54, 0x1F, 0x22, 0x90, 0x88, 0x32, 0xF1, 0x1B, -0x30, 0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, -0x03, 0x30, 0xE0, 0x02, 0xF1, 0x96, 0x90, 0x88, -0x31, 0xF1, 0xB1, 0x30, 0xE0, 0x07, 0xEF, 0xF1, -0xDB, 0x70, 0x4A, 0x80, 0x45, 0x90, 0x88, 0x3F, -0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, -0xEF, 0xF0, 0xF1, 0xCF, 0x40, 0x34, 0xF1, 0xA5, -0x70, 0x33, 0xF1, 0x9E, 0x70, 0x08, 0x90, 0x8A, -0xF5, 0x12, 0x8A, 0x33, 0x80, 0x28, 0x90, 0x8A, -0xF5, 0x12, 0x8A, 0x33, 0x90, 0x88, 0x40, 0xE0, -0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, 0x09, -0xF1, 0x8E, 0xE4, 0x90, 0x88, 0x40, 0xF0, 0x80, -0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, 0x3F, -0xF0, 0x22, 0x12, 0xA6, 0x45, 0x22, 0x90, 0x88, -0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x7D, 0x02, -0x7F, 0x02, 0x02, 0x7C, 0x7E, 0xF0, 0x90, 0x88, -0x34, 0xE0, 0x54, 0x0F, 0x22, 0xE4, 0xFF, 0x12, -0x78, 0x4A, 0xEF, 0x64, 0x01, 0x22, 0x90, 0x88, -0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0xF1, 0x23, -0x02, 0x8C, 0x2F, 0x75, 0xF0, 0x02, 0xA4, 0xF5, -0x82, 0x85, 0xF0, 0x83, 0x02, 0x03, 0x3E, 0x90, -0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, -0xD3, 0x9F, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, -0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x22, -0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, -0x5C, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, -0x97, 0xC2, 0x12, 0xB7, 0x25, 0x90, 0x93, 0x29, -0xF1, 0x6B, 0x12, 0xAF, 0x02, 0xF1, 0x35, 0x90, -0x93, 0x29, 0xF1, 0x3E, 0x4E, 0xF0, 0x90, 0x05, -0x52, 0xE0, 0x54, 0x07, 0x90, 0x94, 0xC1, 0x60, -0x13, 0x12, 0x87, 0xA6, 0xFD, 0x90, 0x05, 0x56, -0xE0, 0xC3, 0x9D, 0x90, 0x93, 0x2B, 0xF0, 0xA3, -0xED, 0xF0, 0x80, 0x23, 0x12, 0x87, 0xA6, 0xFB, -0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, 0xFF, -0xE4, 0x94, 0x00, 0xFE, 0x7C, 0x00, 0x7D, 0x05, -0x12, 0x02, 0x92, 0x90, 0x93, 0x2B, 0xEF, 0xF0, -0xEB, 0x75, 0xF0, 0x05, 0x84, 0xA3, 0xF0, 0x12, -0x90, 0xC3, 0x12, 0x02, 0x06, 0x20, 0xE0, 0x12, -0x12, 0x8A, 0x30, 0x90, 0x8A, 0xF9, 0x12, 0x8C, -0xA3, 0x11, 0xB3, 0x90, 0x01, 0x57, 0xE4, 0xF0, -0x80, 0x0C, 0x90, 0x8A, 0x89, 0x12, 0x8C, 0xA3, -0x12, 0x9F, 0xAD, 0x12, 0x8F, 0xF1, 0x12, 0xAF, -0x18, 0x20, 0xE0, 0x04, 0xEF, 0x44, 0x20, 0xF0, -0x12, 0x9F, 0xB4, 0x30, 0xE0, 0x15, 0x90, 0x88, -0x36, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x88, 0x38, -0xF0, 0xD1, 0xA4, 0x11, 0xFF, 0x74, 0x06, 0xF0, -0x02, 0x6E, 0x2F, 0xE4, 0x90, 0x88, 0x36, 0xF0, -0x90, 0x88, 0x38, 0x74, 0x0C, 0xF0, 0x90, 0x88, -0x31, 0xE0, 0x54, 0xFE, 0xF0, 0xA3, 0xE0, 0x54, -0xFB, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x04, -0x7E, 0x12, 0xD0, 0x55, 0x90, 0x95, 0xF3, 0xEF, -0xF0, 0x90, 0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, -0x8C, 0xA3, 0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, -0x7E, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, -0x80, 0x05, 0x12, 0x8C, 0xA3, 0x11, 0xB3, 0x90, -0x95, 0xF3, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, -0x2F, 0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, -0x06, 0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0x11, -0xFF, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0x90, -0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, -0x88, 0x4F, 0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, -0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, -0xC0, 0x07, 0x90, 0x94, 0xA0, 0xE0, 0x24, 0x46, -0xFF, 0x90, 0x94, 0x9F, 0xE0, 0x34, 0x00, 0xAB, -0x07, 0xFA, 0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, -0x06, 0x12, 0x86, 0x39, 0x90, 0x88, 0x85, 0x71, -0x1F, 0xEF, 0x24, 0x46, 0xFF, 0xE4, 0x3E, 0xFE, -0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x90, 0x88, -0x89, 0x71, 0x1F, 0x90, 0x88, 0x85, 0x12, 0xA7, -0x4A, 0x50, 0x02, 0x41, 0x07, 0x90, 0x88, 0x89, -0x12, 0x86, 0x61, 0x90, 0x88, 0x85, 0x12, 0x04, -0xB8, 0x12, 0x86, 0x39, 0x90, 0x95, 0xD2, 0x12, -0x04, 0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -0x2B, 0x71, 0x4D, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, -0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, -0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, -0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, -0xEE, 0x94, 0x00, 0xFA, 0x71, 0x28, 0xEB, 0x2F, -0xFF, 0xEA, 0x80, 0x1E, 0x90, 0x88, 0x33, 0x12, -0xAF, 0xB1, 0x30, 0xE0, 0x02, 0x61, 0x04, 0x71, -0x28, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, -0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, -0xFF, 0xED, 0x3E, 0x90, 0x95, 0xCE, 0xF0, 0xA3, -0xEF, 0xF0, 0xC3, 0x90, 0x95, 0xCF, 0xE0, 0x94, -0xA0, 0x90, 0x95, 0xCE, 0xE0, 0x94, 0x00, 0x50, -0x36, 0xA3, 0xE0, 0xFB, 0x24, 0x5F, 0x71, 0x17, -0xE0, 0x04, 0xF0, 0x90, 0x95, 0xD2, 0x12, 0x04, -0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0xFF, 0x2B, -0x71, 0x0C, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, -0x09, 0x90, 0x95, 0xCE, 0xA3, 0xE0, 0x71, 0x0A, -0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, -0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, 0x2E, 0x90, +0x9F, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, +0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, +0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, +0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x34, +0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0xA3, 0xF0, +0x7B, 0x26, 0xD1, 0x5A, 0x90, 0x8A, 0xFD, 0x12, +0x88, 0xCD, 0xEF, 0x64, 0x01, 0x70, 0x02, 0x80, +0x05, 0xB1, 0xBD, 0x30, 0xE0, 0x04, 0xD1, 0x7F, +0xEE, 0xF0, 0x90, 0x96, 0xA3, 0xE0, 0xFD, 0x7B, +0x27, 0xE4, 0xFF, 0x71, 0x50, 0xD1, 0x6D, 0x12, +0x04, 0x7E, 0x80, 0x09, 0xD1, 0x6D, 0x12, 0x04, +0x7E, 0xD1, 0x7F, 0xEE, 0xF0, 0x90, 0x88, 0x9D, +0xE0, 0x30, 0xE0, 0x19, 0xB1, 0xBD, 0x30, 0xE0, +0x14, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, +0x90, 0x8A, 0xF9, 0x12, 0xA7, 0x01, 0x8C, 0x83, +0x7D, 0x28, 0x12, 0x04, 0x7E, 0x90, 0x04, 0x1F, +0x74, 0x20, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x7D, 0xFF, 0xE4, 0xFF, 0x61, 0x50, +0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x90, +0x96, 0xBA, 0xE0, 0xFD, 0x22, 0x90, 0x96, 0x9F, +0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0xE0, 0xFC, 0xA3, +0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, +0x86, 0xB6, 0xE0, 0xFF, 0x90, 0x96, 0xA0, 0xE0, +0xFB, 0x90, 0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, +0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, 0xA1, 0xEE, +0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, +0x9F, 0xE0, 0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, +0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x12, +0x04, 0x7E, 0x90, 0x96, 0xA1, 0xE0, 0xFE, 0xA3, +0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0xE0, 0xFC, 0xA3, +0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x12, 0x04, +0x7E, 0x90, 0x96, 0xA1, 0xA3, 0xE0, 0xFF, 0x24, +0x12, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, +0xE0, 0x54, 0x01, 0xFE, 0x90, 0x96, 0xA0, 0xE0, +0x25, 0xE0, 0x25, 0xE0, 0x44, 0x02, 0x4E, 0xFE, +0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, +0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x96, 0xA9, 0xED, 0xF0, 0xA3, +0xEB, 0xF0, 0x90, 0x96, 0xA8, 0xEF, 0xF0, 0xE4, +0xFD, 0xFC, 0x12, 0xD1, 0x46, 0x90, 0x96, 0xAB, +0xF0, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, +0x90, 0x96, 0xA8, 0xE0, 0x90, 0x04, 0x25, 0xF0, +0x90, 0x96, 0xA9, 0xE0, 0x60, 0x06, 0xF1, 0xB4, +0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, +0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, +0xE0, 0x54, 0xC0, 0xF0, 0xF1, 0xB4, 0xE0, 0x54, +0xC0, 0xF0, 0x90, 0x96, 0xAB, 0xE0, 0xFF, 0xAE, +0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, +0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, +0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, +0xF0, 0xAF, 0x05, 0xD1, 0xE8, 0xE0, 0x54, 0x01, +0xFE, 0x90, 0x96, 0xAA, 0xE0, 0x25, 0xE0, 0x25, +0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xD1, 0xE7, +0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, +0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, +0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, 0x0D, 0x2D, +0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, +0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x74, 0x21, 0x2F, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xEF, +0xB4, 0xFF, 0x06, 0x90, 0x93, 0x5E, 0xED, 0xF0, +0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x93, 0x5E, 0xE0, +0x5E, 0xFE, 0xED, 0x5F, 0x4E, 0xF0, 0x22, 0xEF, +0xB4, 0xFF, 0x06, 0x90, 0x93, 0x5D, 0xED, 0xF0, +0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x93, 0x5D, 0x80, +0xE6, 0x90, 0x94, 0xB6, 0x02, 0x86, 0x76, 0xE4, +0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xF1, 0xE9, +0x12, 0xA0, 0x02, 0x7A, 0x93, 0x79, 0x1B, 0x02, +0x69, 0xF5, 0x90, 0x94, 0xB6, 0x12, 0x86, 0x6D, +0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, +0x05, 0x7B, 0x01, 0x22, 0x12, 0x9F, 0xE9, 0x11, +0x02, 0x7A, 0x93, 0x79, 0x20, 0x02, 0x69, 0xF5, +0x90, 0x96, 0xA5, 0x12, 0x86, 0x76, 0x90, 0x96, +0xA4, 0xEF, 0xF0, 0x12, 0x86, 0x7F, 0xA0, 0xB3, +0x00, 0xA0, 0xBC, 0x01, 0xA0, 0xC5, 0x06, 0xA0, +0xD9, 0x08, 0xA0, 0xE2, 0x09, 0xA0, 0xEB, 0x0A, +0xA0, 0xF3, 0x12, 0xA0, 0xFB, 0x13, 0xA1, 0x03, +0x14, 0xA1, 0x0C, 0x1E, 0xA1, 0x15, 0x20, 0xA1, +0x1E, 0x25, 0xA1, 0x27, 0x26, 0xA1, 0x30, 0x29, +0xA1, 0x38, 0x2A, 0xA1, 0x41, 0x40, 0xA1, 0x4C, +0x42, 0xA1, 0x5A, 0x43, 0xA1, 0x63, 0x44, 0xA2, +0x2C, 0x47, 0xA1, 0x6C, 0x49, 0xA1, 0x74, 0x60, +0xA1, 0x7D, 0x61, 0xA1, 0x86, 0x62, 0xA1, 0x8F, +0x63, 0xA1, 0x98, 0x64, 0xA1, 0xA1, 0x65, 0xA1, +0xAA, 0x66, 0xA1, 0xB3, 0x67, 0xA1, 0xBC, 0x68, +0xA1, 0xC5, 0x69, 0xA1, 0xCD, 0x6B, 0xA1, 0xD6, +0x6C, 0xA1, 0xDF, 0x6D, 0xA1, 0xE8, 0x6E, 0xA1, +0xF1, 0x6F, 0xA1, 0xFA, 0x70, 0xA2, 0x03, 0xC2, +0xA2, 0x0B, 0xC3, 0xA2, 0x14, 0xC4, 0xA0, 0xCD, +0xC6, 0xA0, 0xCD, 0xC7, 0xA0, 0xCD, 0xC8, 0x00, +0x00, 0xA2, 0x1D, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0x02, 0x86, 0xE0, 0x90, 0x96, 0xA5, 0x12, +0x86, 0x6D, 0x02, 0x88, 0x04, 0x90, 0x96, 0xA5, +0x12, 0x86, 0x6D, 0x61, 0xAD, 0x90, 0x96, 0xA4, +0xE0, 0xFF, 0xA3, 0x12, 0x86, 0x6D, 0x02, 0xBF, +0xBF, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, +0x97, 0xFA, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, +0x02, 0x9F, 0xF6, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0x01, 0x14, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0xE1, 0xEF, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0xC1, 0x27, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0x02, 0xA8, 0x03, 0x90, 0x96, 0xA5, 0x12, +0x86, 0x6D, 0x02, 0x9B, 0xB6, 0x90, 0x96, 0xA5, +0x12, 0x86, 0x6D, 0x02, 0x87, 0x30, 0x90, 0x96, +0xA5, 0x12, 0x86, 0x6D, 0x02, 0xA8, 0x12, 0x90, +0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, 0xA8, 0x55, +0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x81, 0x9B, +0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, 0xB0, +0x18, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x90, +0x8A, 0xA5, 0x80, 0x09, 0x90, 0x96, 0xA5, 0x12, +0x86, 0x6D, 0x90, 0x8A, 0xB5, 0x91, 0x42, 0x02, +0x04, 0x7E, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, +0x02, 0x25, 0xEC, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0x02, 0x5B, 0xF3, 0x90, 0x96, 0xA5, 0x12, +0x86, 0x6D, 0xE1, 0xDF, 0x90, 0x96, 0xA5, 0x12, +0x86, 0x6D, 0x02, 0x98, 0xB2, 0x90, 0x96, 0xA5, +0x12, 0x86, 0x6D, 0x02, 0x77, 0x4F, 0x90, 0x96, +0xA5, 0x12, 0x86, 0x6D, 0x02, 0x7C, 0x60, 0x90, +0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, 0x7A, 0xC6, +0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, 0x5D, +0x36, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, +0x7B, 0xE9, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, +0x02, 0x70, 0x33, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0x02, 0x48, 0xC9, 0x90, 0x96, 0xA5, 0x12, +0x86, 0x6D, 0x02, 0x79, 0xF3, 0x90, 0x96, 0xA5, +0x12, 0x86, 0x6D, 0x80, 0x60, 0x90, 0x96, 0xA5, +0x12, 0x86, 0x6D, 0x02, 0x51, 0x7B, 0x90, 0x96, +0xA5, 0x12, 0x86, 0x6D, 0x02, 0x79, 0x30, 0x90, +0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, 0x57, 0xF2, +0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, 0x74, +0x8D, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, 0x02, +0x78, 0x9A, 0x90, 0x96, 0xA5, 0x12, 0x86, 0x6D, +0x02, 0x5E, 0x0B, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0x81, 0x7C, 0x90, 0x96, 0xA5, 0x12, 0x86, +0x6D, 0x02, 0xB7, 0xE9, 0x90, 0x96, 0xA5, 0x12, +0x86, 0x6D, 0x02, 0xB7, 0xFF, 0x90, 0x01, 0xC0, +0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, 0xA4, 0xE0, +0x90, 0x01, 0xC2, 0xF0, 0x22, 0x12, 0x02, 0x06, +0xFF, 0x12, 0x98, 0xAC, 0x90, 0x94, 0xB8, 0x12, +0x87, 0xE9, 0x90, 0x94, 0xB9, 0x12, 0x87, 0xF3, +0x90, 0x94, 0xBA, 0x12, 0x87, 0xFD, 0x90, 0x94, +0xBB, 0x12, 0x87, 0x29, 0x90, 0x94, 0xBC, 0xF1, +0xD8, 0x90, 0x94, 0xBD, 0xF0, 0xEF, 0x12, 0x86, +0x7F, 0xA2, 0x7B, 0x00, 0xA2, 0x87, 0x01, 0xA2, +0x8E, 0x02, 0xA2, 0x96, 0x03, 0xA2, 0x9E, 0x04, +0xA2, 0xA5, 0x05, 0xA2, 0xAE, 0x06, 0xA2, 0xD7, +0x07, 0xA3, 0x35, 0x08, 0xA3, 0x37, 0x09, 0x00, +0x00, 0xA3, 0x76, 0x90, 0x94, 0xB6, 0x74, 0x02, +0xF0, 0xA3, 0x74, 0x29, 0xF0, 0x61, 0x7C, 0x71, +0xA5, 0x74, 0x2A, 0xF0, 0x61, 0x7C, 0x71, 0x97, +0xA3, 0x74, 0x31, 0xF0, 0x61, 0x7C, 0x71, 0x97, +0xA3, 0x74, 0x32, 0xF0, 0x61, 0x7C, 0x71, 0xA5, +0x74, 0x33, 0xF0, 0x61, 0x7C, 0x71, 0x9E, 0x90, +0x8A, 0x83, 0x91, 0x42, 0x61, 0x93, 0x90, 0x94, +0xB8, 0xE0, 0x90, 0x88, 0xE1, 0xF0, 0x90, 0x94, +0xB9, 0xE0, 0x90, 0x88, 0xE2, 0xF0, 0x90, 0x94, +0xBA, 0xE0, 0x90, 0x88, 0xE3, 0xF0, 0x90, 0x94, +0xBB, 0xE0, 0x90, 0x88, 0xE4, 0xF0, 0x90, 0x94, +0xBC, 0xE0, 0x90, 0x88, 0xE5, 0xF0, 0x22, 0x90, +0x94, 0xB8, 0xE0, 0x90, 0x94, 0xAD, 0xF0, 0x90, +0x94, 0xBB, 0x12, 0x8E, 0xD1, 0x78, 0x10, 0x12, +0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, +0xC0, 0x07, 0x12, 0x8E, 0xD0, 0x78, 0x18, 0x12, +0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, +0xD0, 0x00, 0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, +0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x94, 0xBA, +0x12, 0x8E, 0xD1, 0x78, 0x08, 0x12, 0x03, 0xFE, +0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, +0x12, 0x86, 0x54, 0x12, 0xD4, 0x2C, 0x90, 0x94, +0xB9, 0x12, 0x8E, 0xD1, 0x12, 0x86, 0x54, 0x90, +0x94, 0xA3, 0x02, 0x04, 0x31, 0x81, 0x4C, 0x90, +0x94, 0xAF, 0xE0, 0x44, 0x01, 0xFF, 0xF0, 0x90, +0x94, 0xB8, 0xE0, 0x54, 0x7F, 0x25, 0xE0, 0xFE, +0xEF, 0x54, 0x01, 0x4E, 0x90, 0x94, 0xAF, 0xF0, +0xE0, 0xFF, 0xC3, 0x13, 0x54, 0x7F, 0xC3, 0x94, +0x1E, 0x50, 0x06, 0xEF, 0x54, 0x01, 0x44, 0x3C, +0xF0, 0x90, 0x94, 0xAF, 0xE0, 0xFF, 0xC3, 0x13, +0x54, 0x7F, 0xD3, 0x94, 0x50, 0x40, 0x27, 0xEF, +0x54, 0x01, 0x44, 0xA0, 0xF0, 0x22, 0x71, 0x97, +0xA3, 0x74, 0xFF, 0xF0, 0x90, 0x94, 0xB7, 0xE0, +0xFF, 0x90, 0x94, 0xB6, 0xE0, 0xFD, 0x71, 0x9E, +0x90, 0x8A, 0xCF, 0xE0, 0xF8, 0xA3, 0xE0, 0xF5, +0x82, 0x88, 0x83, 0x12, 0x04, 0x7E, 0x22, 0x90, +0x94, 0xB6, 0x74, 0x01, 0xF0, 0x22, 0x7B, 0x01, +0x7A, 0x94, 0x79, 0xB8, 0x22, 0x90, 0x94, 0xB6, +0x74, 0x06, 0xF0, 0xA3, 0x22, 0x12, 0x02, 0x06, +0x64, 0x01, 0x60, 0x02, 0x81, 0x3E, 0x90, 0x94, +0xFD, 0xF0, 0x90, 0x94, 0xFD, 0xE0, 0xFF, 0xC3, +0x94, 0x10, 0x50, 0x28, 0xEF, 0x12, 0xC0, 0xD5, +0x7A, 0x94, 0x79, 0xFC, 0x12, 0x5F, 0xA6, 0xBF, +0x01, 0x12, 0x90, 0x94, 0xFC, 0xE0, 0xFF, 0xA3, +0xE0, 0x24, 0xFE, 0xF5, 0x82, 0xE4, 0x34, 0x94, +0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x94, 0xFD, 0xE0, +0x04, 0xF0, 0x80, 0xCE, 0x75, 0x45, 0x01, 0x75, +0x46, 0x94, 0x75, 0x47, 0xFE, 0x75, 0x48, 0x08, +0x71, 0x9E, 0x12, 0x69, 0xF5, 0x90, 0x94, 0xB6, +0x74, 0x24, 0xF0, 0x90, 0x94, 0xD8, 0x74, 0x08, +0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, 0x95, 0x75, +0x47, 0x06, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x94, +0x79, 0xDB, 0x12, 0x69, 0xF5, 0x90, 0x94, 0xD9, +0x74, 0x25, 0xF0, 0x90, 0x94, 0xFB, 0x74, 0x08, +0x12, 0x9B, 0xFF, 0x91, 0x3F, 0x12, 0x04, 0x7E, +0x7B, 0x01, 0x7A, 0x94, 0x79, 0xD9, 0x12, 0x8B, +0x34, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0x90, +0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, +0x82, 0x8E, 0x83, 0x22, 0x90, 0x94, 0xBE, 0x74, +0x27, 0xF0, 0x90, 0x94, 0xE0, 0x74, 0x06, 0xF0, +0x90, 0x94, 0xC0, 0x74, 0x08, 0xF0, 0xE4, 0x91, +0x94, 0x90, 0x94, 0xB4, 0xE0, 0x90, 0x94, 0xC4, +0xF0, 0x90, 0x94, 0xB5, 0xE0, 0x90, 0x94, 0xC5, +0xF0, 0x7B, 0x01, 0x7A, 0x94, 0x79, 0xBE, 0x91, +0x3F, 0x02, 0x04, 0x7E, 0x12, 0x02, 0x06, 0x90, +0x93, 0x4A, 0xF0, 0x70, 0x03, 0xF1, 0xD1, 0xF0, +0x22, 0xE4, 0x90, 0x95, 0x45, 0xF0, 0x90, 0x95, +0xB0, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, +0xA3, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, +0xFF, 0x90, 0x93, 0x31, 0xE0, 0x54, 0xFE, 0x4F, +0xF0, 0x30, 0xE0, 0x03, 0xE4, 0x91, 0x94, 0x22, +0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0xF1, 0xAE, +0x90, 0x93, 0x0A, 0x91, 0x93, 0x90, 0x93, 0x25, +0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xF1, 0xA1, +0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x12, 0x88, +0xCD, 0x12, 0xB0, 0xE3, 0x12, 0x8E, 0xD8, 0xB1, +0x06, 0x91, 0xB0, 0x90, 0x8A, 0x73, 0x12, 0x88, +0xCD, 0x90, 0x00, 0x6A, 0xE0, 0x30, 0xE2, 0x14, +0x90, 0x92, 0x20, 0x74, 0x01, 0xF0, 0xA3, 0x74, +0xF4, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x68, 0x7E, +0x01, 0x12, 0x66, 0x33, 0x12, 0xD0, 0x45, 0x90, +0x93, 0x4A, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, +0x29, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xFD, 0xF0, +0x54, 0xEF, 0xF0, 0x44, 0x08, 0xF0, 0x90, 0x86, +0xB3, 0xE0, 0xFF, 0x64, 0x02, 0x70, 0x29, 0xB1, +0xA7, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, +0x2F, 0xB1, 0xA5, 0x30, 0xE1, 0x02, 0x7E, 0x01, +0x90, 0x93, 0x2D, 0xB1, 0xA5, 0x30, 0xE2, 0x02, +0x7E, 0x01, 0x90, 0x93, 0x2E, 0xEE, 0xF0, 0x90, +0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, 0x22, +0xEF, 0x64, 0x01, 0x70, 0x1D, 0xB1, 0x9E, 0x30, +0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2F, 0xB1, +0x9C, 0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, +0x2D, 0xB1, 0x9C, 0x30, 0xE2, 0x02, 0x7F, 0x01, +0x80, 0x23, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, +0x70, 0x20, 0xB1, 0x95, 0x30, 0xE0, 0x02, 0x7F, +0x01, 0x90, 0x93, 0x2F, 0xB1, 0x93, 0x30, 0xE1, +0x02, 0x7F, 0x01, 0x90, 0x93, 0x2D, 0xB1, 0x93, +0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x2E, +0xEF, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, +0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, +0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, +0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x7E, 0x00, +0x7F, 0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, +0x79, 0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, +0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, +0x00, 0x7F, 0x14, 0x7D, 0x00, 0x7B, 0x01, 0x7A, +0x94, 0x79, 0xA2, 0x12, 0x04, 0x80, 0x90, 0x86, +0xB3, 0xE0, 0xFC, 0x64, 0x02, 0x70, 0x19, 0xB1, +0xA7, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x54, +0x01, 0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFE, 0x90, +0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, 0x22, +0xEC, 0x64, 0x01, 0x70, 0x09, 0xB1, 0x9E, 0x30, +0xE2, 0x02, 0x7F, 0x01, 0x80, 0x0F, 0x90, 0x86, +0xB3, 0xE0, 0x64, 0x03, 0x70, 0x18, 0xB1, 0x95, +0x30, 0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x54, 0x01, +0xC4, 0x33, 0x33, 0x54, 0xC0, 0xFF, 0x90, 0x88, +0xA0, 0xE0, 0x54, 0xBF, 0x4F, 0xF0, 0x22, 0x12, +0x02, 0x06, 0xFF, 0x54, 0x80, 0xFE, 0x90, 0x93, +0x57, 0xE0, 0x54, 0x7F, 0x4E, 0xFE, 0xF0, 0xEF, +0x54, 0x40, 0xFF, 0xEE, 0x54, 0xBF, 0x4F, 0xF1, +0xA7, 0x54, 0x20, 0xFD, 0xEF, 0x54, 0xDF, 0x4D, +0xFF, 0x90, 0x93, 0x57, 0xF0, 0xEE, 0x54, 0x10, +0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0xFF, 0xF0, 0x12, +0x02, 0x06, 0x54, 0x0F, 0xFE, 0xEF, 0x54, 0xF0, +0x4E, 0x90, 0x93, 0x57, 0xF0, 0x12, 0x98, 0xAC, +0xFF, 0x54, 0x7F, 0x90, 0x93, 0x59, 0xF0, 0xEF, +0x54, 0x80, 0x12, 0x8F, 0xF1, 0xFF, 0x90, 0x93, +0x58, 0xE0, 0x54, 0xFE, 0x12, 0x87, 0xE8, 0x90, +0x93, 0x5A, 0x12, 0x87, 0xF3, 0x54, 0x01, 0x25, +0xE0, 0xFF, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xFD, +0x4F, 0xF0, 0xD1, 0x9C, 0x20, 0xE0, 0x02, 0x7D, +0x01, 0x02, 0x93, 0x47, 0x90, 0x93, 0x57, 0xE0, +0xFE, 0x54, 0x0F, 0xFF, 0xEE, 0xC4, 0x13, 0x13, +0x54, 0x03, 0x7D, 0x00, 0x22, 0x90, 0x93, 0x57, +0xE0, 0xFF, 0x12, 0x8F, 0xF1, 0x30, 0xE0, 0x1B, +0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x03, 0x12, +0xD0, 0x62, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, +0x0A, 0xD1, 0x9C, 0x20, 0xE0, 0x02, 0x7D, 0x01, +0x12, 0x93, 0x47, 0x22, 0x90, 0x88, 0x36, 0xE0, +0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, +0x08, 0x90, 0x8B, 0x01, 0x12, 0x88, 0xCD, 0x80, +0x05, 0x12, 0xDD, 0xA3, 0xD1, 0xF0, 0x80, 0xBD, +0xD1, 0xF9, 0x8C, 0x83, 0x7D, 0x01, 0x02, 0x04, +0x7E, 0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, +0xB9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x22, +0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x0F, +0x90, 0x88, 0x36, 0xE0, 0x60, 0x09, 0xF1, 0x20, +0xF0, 0x54, 0x07, 0x70, 0x02, 0xD1, 0xF0, 0x22, +0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFE, 0x22, 0xE4, +0xF5, 0x77, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x77, +0x54, 0xC0, 0x70, 0x12, 0xF1, 0x20, 0xF0, 0x54, +0xFD, 0xF0, 0xD1, 0xF0, 0x90, 0x88, 0x39, 0xE0, +0x60, 0x46, 0xF1, 0xB5, 0xF0, 0x22, 0xE5, 0x77, +0x30, 0xE6, 0x21, 0x90, 0x88, 0x36, 0xE0, 0x64, +0x01, 0x70, 0x1C, 0x90, 0x88, 0x3A, 0xE0, 0x44, +0x01, 0xF1, 0xE7, 0x64, 0x02, 0x60, 0x08, 0x90, +0x8A, 0xE1, 0x12, 0x88, 0xCD, 0x80, 0x08, 0x12, +0xDB, 0xAA, 0x80, 0x03, 0xF1, 0x20, 0xF0, 0xE5, +0x77, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x0D, 0xE0, +0x44, 0x02, 0xF1, 0x89, 0x90, 0x88, 0x31, 0xE0, +0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, +0x22, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, +0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, +0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, +0x33, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0xFF, +0xF0, 0x12, 0x02, 0x06, 0xFE, 0x22, 0xF0, 0xE4, +0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x00, 0x02, +0xE0, 0x44, 0x01, 0x22, 0x90, 0x88, 0x39, 0xE0, +0xB4, 0x04, 0x03, 0xF1, 0xB5, 0xF0, 0x90, 0x88, +0x9D, 0xE0, 0x20, 0xE0, 0x03, 0x12, 0xBB, 0x1C, +0x22, 0x90, 0x05, 0x21, 0xE0, 0x54, 0x7F, 0x22, +0xF0, 0x90, 0x00, 0x06, 0x02, 0x02, 0x1F, 0x12, +0x02, 0x06, 0x90, 0x96, 0x0C, 0xF0, 0x22, 0xF0, +0x90, 0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, 0x12, +0x02, 0x06, 0xFF, 0x90, 0x93, 0x28, 0xF0, 0xBF, +0x01, 0x08, 0x12, 0x9C, 0x07, 0xE4, 0x90, 0x93, +0x28, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, +0xFF, 0x90, 0x93, 0x5C, 0xE0, 0x54, 0xFE, 0x4F, +0xF0, 0x22, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, +0xF0, 0x60, 0x39, 0xA3, 0xE0, 0x20, 0xE0, 0x34, +0x90, 0x8A, 0xB9, 0x12, 0x8B, 0x46, 0xE4, 0xFD, +0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9B, +0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1D, 0xEF, +0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, +0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, +0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, +0x09, 0x12, 0x71, 0x9A, 0x22, 0x12, 0x9F, 0xE9, +0x12, 0xDD, 0x7D, 0x90, 0x93, 0x29, 0x12, 0xDC, +0xB2, 0x12, 0xA7, 0xA7, 0x12, 0xDD, 0x47, 0x90, +0x93, 0x29, 0x12, 0xDD, 0x74, 0x4E, 0xF0, 0x90, +0x05, 0x52, 0xE0, 0x54, 0x07, 0x90, 0x94, 0xB6, +0x60, 0x13, 0x12, 0x98, 0xA9, 0xFD, 0x90, 0x05, +0x56, 0xE0, 0xC3, 0x9D, 0x90, 0x93, 0x2B, 0xF0, +0xA3, 0xED, 0xF0, 0x80, 0x23, 0x12, 0x98, 0xA9, +0xFB, 0xFF, 0x90, 0x05, 0x54, 0xE0, 0xC3, 0x9F, +0xFF, 0xE4, 0x94, 0x00, 0xFE, 0x7C, 0x00, 0x7D, +0x05, 0x12, 0x02, 0x92, 0x90, 0x93, 0x2B, 0xEF, +0xF0, 0xEB, 0x75, 0xF0, 0x05, 0x84, 0xA3, 0xF0, +0x12, 0x8A, 0xC6, 0x20, 0xE0, 0x12, 0x12, 0x88, +0xCA, 0x90, 0x8A, 0xF9, 0x12, 0x8B, 0x46, 0x31, +0x17, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x80, 0x0B, +0x90, 0x8A, 0x89, 0x12, 0x8B, 0x46, 0x12, 0x8F, +0xE6, 0xB1, 0x94, 0xB1, 0x9C, 0x20, 0xE0, 0x04, +0xEF, 0x44, 0x20, 0xF0, 0x12, 0xDD, 0x04, 0x30, +0xE0, 0x1D, 0x90, 0x88, 0x36, 0x74, 0x01, 0xF0, +0xE4, 0x90, 0x88, 0x38, 0xF0, 0x90, 0x88, 0x32, +0xE0, 0x44, 0x04, 0x31, 0x67, 0xFB, 0x90, 0x92, +0x98, 0x74, 0x06, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, +0x90, 0x88, 0x36, 0xF0, 0x90, 0x88, 0x38, 0x74, +0x0C, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFE, +0xF0, 0xA3, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0xE4, +0xFD, 0xFF, 0x02, 0x04, 0x7E, 0x12, 0xD0, 0xB2, +0x90, 0x95, 0xE8, 0xEF, 0xF0, 0x90, 0x8A, 0x89, +0x30, 0xE0, 0x13, 0x12, 0x8B, 0x46, 0x7D, 0x01, +0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, +0xE0, 0x44, 0x04, 0xF0, 0x80, 0x05, 0x12, 0x8B, +0x46, 0x31, 0x17, 0x90, 0x95, 0xE8, 0xE0, 0x30, +0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, +0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, +0x74, 0x80, 0xF0, 0x31, 0x68, 0xFB, 0x90, 0x92, +0x98, 0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xF0, +0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, +0x90, 0x88, 0x4F, 0xE0, 0x22, 0x90, 0x88, 0x85, +0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, +0x94, 0xA0, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x94, +0x9F, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, +0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x86, +0x39, 0x90, 0x88, 0x85, 0x71, 0x92, 0xEF, 0x24, +0x46, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, 0xFD, +0xE4, 0x3C, 0xFC, 0x90, 0x88, 0x89, 0x71, 0x92, +0x90, 0x88, 0x85, 0x12, 0x86, 0x61, 0xC3, 0x12, +0x03, 0xDA, 0x50, 0x02, 0x41, 0x77, 0x90, 0x88, +0x89, 0x12, 0x86, 0x61, 0x90, 0x88, 0x85, 0x12, +0x04, 0xB8, 0x12, 0x86, 0x39, 0x90, 0x95, 0xC8, +0x12, 0x04, 0x31, 0x90, 0x88, 0x31, 0xE0, 0x30, +0xE0, 0x34, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, +0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, 0xC3, +0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x50, +0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, 0xE0, +0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, 0x00, +0xFA, 0x71, 0x81, 0x78, 0x07, 0x12, 0x03, 0xEB, +0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x22, 0x90, 0x88, +0x33, 0xF1, 0x0F, 0x30, 0xE0, 0x02, 0x61, 0x71, +0x71, 0x81, 0x78, 0x07, 0x12, 0x03, 0xEB, 0x90, +0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, 0x60, 0x9D, +0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, 0xFF, 0xED, +0x3E, 0x90, 0x95, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, +0xC3, 0x90, 0x95, 0xC5, 0xE0, 0x94, 0xA0, 0x90, +0x95, 0xC4, 0xE0, 0x94, 0x00, 0x50, 0x30, 0xA3, +0xE0, 0xFB, 0x24, 0x5F, 0x71, 0x8A, 0xE0, 0x04, +0xF0, 0x71, 0x81, 0xEF, 0x54, 0x7F, 0xFF, 0x74, +0xFF, 0x2B, 0x71, 0x79, 0xE0, 0xFE, 0xEF, 0xC3, +0x9E, 0x50, 0x09, 0x90, 0x95, 0xC4, 0xA3, 0xE0, +0x71, 0x77, 0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, +0x04, 0xF0, 0xE0, 0x90, 0x00, 0xFE, 0xF0, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, -0x40, 0x02, 0x61, 0x04, 0xE4, 0xFF, 0xFE, 0x71, -0x14, 0xE0, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, +0x40, 0x02, 0x61, 0x71, 0xE4, 0xFF, 0xFE, 0x71, +0x87, 0xE0, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, 0x90, 0x95, -0xD0, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, -0xA0, 0xE5, 0x71, 0x33, 0x40, 0x02, 0x80, 0x15, -0x90, 0x95, 0xD0, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, -0x94, 0xA0, 0x50, 0x13, 0x71, 0x14, 0xE0, 0x2F, -0xFF, 0x71, 0x33, 0x40, 0x07, 0x90, 0x95, 0xD1, +0xC6, 0xEE, 0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, +0xA0, 0xE5, 0x71, 0x9B, 0x40, 0x02, 0x80, 0x15, +0x90, 0x95, 0xC6, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, +0x94, 0xA0, 0x50, 0x13, 0x71, 0x87, 0xE0, 0x2F, +0xFF, 0x71, 0x9B, 0x40, 0x07, 0x90, 0x95, 0xC7, 0xEE, 0xF0, 0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, -0x05, 0x5E, 0xE0, 0xFF, 0x71, 0x05, 0xE0, 0xFD, +0x05, 0x5E, 0xE0, 0xFF, 0x71, 0x72, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, -0x90, 0x95, 0xD1, 0xE0, 0x80, 0x18, 0x71, 0x05, +0x90, 0x95, 0xC7, 0xE0, 0x80, 0x18, 0x71, 0x72, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, -0xF0, 0x90, 0x95, 0xD1, 0xE0, 0x04, 0x90, 0x88, +0xF0, 0x90, 0x95, 0xC7, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, @@ -1661,420 +1414,694 @@ u8 array_mp_8723d_fw_ap[] = { 0x90, 0x88, 0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, -0xF0, 0x11, 0xFF, 0x74, 0x03, 0xF0, 0x12, 0x6E, -0x2F, 0x90, 0x8A, 0xA3, 0x12, 0x8C, 0xA3, 0xE4, -0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x95, 0xD0, -0xE0, 0xFE, 0x24, 0xFF, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0x22, 0x74, 0x5F, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, -0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, -0x90, 0x95, 0xD2, 0x12, 0x04, 0xB8, 0x78, 0x07, -0x02, 0x03, 0xEB, 0x90, 0x88, 0x91, 0xE0, 0xFD, +0x31, 0x67, 0xFB, 0x12, 0xDC, 0x43, 0x90, 0x8A, +0xA3, 0x12, 0x8B, 0x46, 0xE4, 0xFF, 0x12, 0x04, +0x7E, 0x22, 0x90, 0x95, 0xC6, 0xE0, 0xFE, 0x24, +0xFF, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, +0x22, 0x90, 0x95, 0xC8, 0x02, 0x04, 0xB8, 0x74, +0x5F, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, +0x83, 0x22, 0x12, 0x04, 0x31, 0x90, 0x88, 0x89, +0x02, 0x04, 0xB8, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, -0x9D, 0xE4, 0x9C, 0x22, 0xF0, 0x90, 0x88, 0x53, -0xE0, 0x24, 0x04, 0x22, 0x7E, 0x00, 0x7F, 0x62, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, -0x12, 0x04, 0x80, 0x90, 0x88, 0x35, 0x74, 0x02, -0xF0, 0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, -0xA3, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, -0xF0, 0xA3, 0x74, 0x02, 0x71, 0x4C, 0xFF, 0x91, -0x36, 0xF1, 0x9B, 0x90, 0x8A, 0x89, 0x12, 0x8C, -0xA3, 0x11, 0xB3, 0x90, 0x8A, 0x89, 0x12, 0x8C, -0xA3, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, -0x90, 0x8A, 0x89, 0x12, 0x8C, 0xA3, 0x12, 0x9F, -0xAD, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, -0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, -0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, -0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, -0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, -0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, -0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, -0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, -0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, -0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, -0x07, 0x71, 0x4C, 0x91, 0x36, 0x7E, 0x00, 0x7F, -0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, -0x31, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, -0x8C, 0xA3, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x7E, -0x00, 0x7F, 0x02, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, -0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x0A, -0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, -0xF0, 0x90, 0x88, 0x9C, 0xF0, 0x22, 0x33, 0x33, -0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, -0x74, 0x50, 0xF0, 0x22, 0xE4, 0xFE, 0x71, 0x14, -0xE4, 0xF0, 0x74, 0xFF, 0x2E, 0x71, 0x0C, 0x74, +0x9D, 0xE4, 0x9C, 0x22, 0xE4, 0xFE, 0x71, 0x87, +0xE4, 0xF0, 0x74, 0xFF, 0x2E, 0x71, 0x79, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, -0x7A, 0x90, 0x94, 0xBD, 0xF0, 0x90, 0x88, 0x32, -0xE0, 0x12, 0x94, 0xA8, 0x30, 0xE0, 0x02, 0xA1, -0x34, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x1C, -0x71, 0x4D, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, -0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, 0xE0, 0x24, -0x03, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, -0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, 0x74, -0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, -0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, 0xE0, -0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, 0x50, -0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, 0x88, -0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, 0xC3, -0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, 0x90, -0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, -0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, 0xB1, -0x40, 0x90, 0x88, 0x4E, 0xB1, 0x49, 0x40, 0x04, -0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0xB1, -0x40, 0x90, 0x88, 0x3E, 0xB1, 0x49, 0x40, 0x04, -0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x12, -0x8F, 0xDA, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, -0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, -0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, 0xF0, -0xF1, 0x2D, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, -0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, -0x22, 0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, -0x74, 0x80, 0x98, 0x22, 0x12, 0xAF, 0xA5, 0x60, -0x02, 0xC1, 0x87, 0x90, 0x88, 0x36, 0xE0, 0x70, -0x02, 0xC1, 0x87, 0x90, 0x88, 0x9D, 0xE0, 0x20, -0xE0, 0x32, 0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, -0x70, 0x2A, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x24, -0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1D, 0xE0, -0x54, 0x07, 0x64, 0x07, 0x70, 0x16, 0x90, 0x06, -0x62, 0xE0, 0x54, 0x03, 0x70, 0x0E, 0x90, 0x88, -0x39, 0xE0, 0xB4, 0x04, 0x07, 0x12, 0x9B, 0x94, -0x54, 0xFE, 0xF1, 0x65, 0x90, 0x05, 0x63, 0xE0, -0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, -0x90, 0x88, 0x86, 0xF0, 0x90, 0x05, 0x61, 0xE0, -0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, -0x90, 0x88, 0x88, 0xF0, 0x90, 0x07, 0xF1, 0xE0, -0x90, 0x94, 0x9F, 0xF0, 0x90, 0x07, 0xF0, 0xE0, -0x90, 0x94, 0xA0, 0xF0, 0xF1, 0x47, 0xF0, 0x90, -0x88, 0x3A, 0xE0, 0x54, 0xEC, 0xF0, 0xD1, 0x90, -0x24, 0xFD, 0x50, 0x02, 0x80, 0x02, 0xD1, 0xAC, -0xD1, 0x90, 0x64, 0x01, 0x70, 0x30, 0x90, 0x06, -0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, -0xA9, 0xE0, 0x30, 0xE5, 0x05, 0xA3, 0xE0, 0xFF, +0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, +0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, 0x87, 0x12, +0x88, 0xCD, 0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, +0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0xE7, +0xE0, 0x64, 0x08, 0x70, 0x21, 0x90, 0x88, 0xE6, +0xE0, 0x30, 0xE0, 0x15, 0x12, 0xB4, 0x08, 0xF0, +0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0xE6, +0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, 0x80, +0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x12, 0x9D, +0xBD, 0x30, 0xE0, 0x13, 0x90, 0x88, 0xE8, 0xE0, +0x04, 0xF0, 0xE0, 0xB4, 0x14, 0x09, 0x90, 0x04, +0x9C, 0xE4, 0xF0, 0x90, 0x88, 0xE8, 0xF0, 0x90, +0x88, 0x36, 0xE0, 0x70, 0x02, 0x81, 0xD1, 0x90, +0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, +0x12, 0x8E, 0xD1, 0x12, 0xD4, 0x27, 0x90, 0x05, +0x60, 0x12, 0x8E, 0xD1, 0x12, 0x86, 0x54, 0xC0, +0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, +0x05, 0x62, 0x12, 0x8E, 0xD1, 0x78, 0x10, 0x12, +0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, +0xD0, 0x00, 0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, +0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x8E, 0xD0, +0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, +0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, +0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, +0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, +0xE0, 0x0F, 0x31, 0x68, 0xFB, 0x90, 0x92, 0x98, +0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0x12, 0xDD, +0x8C, 0x90, 0x88, 0x32, 0xB1, 0x26, 0x30, 0xE0, +0x10, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x09, +0x7D, 0x02, 0x7F, 0x02, 0x12, 0x7C, 0x7E, 0xF1, +0xD9, 0x12, 0xB9, 0xB3, 0xFF, 0xBF, 0x03, 0x14, +0x90, 0x93, 0x4A, 0xE0, 0xB4, 0x01, 0x0D, 0x90, +0x01, 0xB8, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x21, +0xE0, 0x44, 0x80, 0xF0, 0x90, 0x8A, 0xE5, 0x12, +0x8B, 0x46, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, +0x93, 0x29, 0xE0, 0x30, 0xE0, 0x08, 0x12, 0xDD, +0x50, 0x12, 0xA7, 0x92, 0xB1, 0x94, 0x90, 0x86, +0xB3, 0xE0, 0xB4, 0x01, 0x10, 0xB1, 0x9C, 0x20, +0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, +0xE0, 0x03, 0x12, 0xDC, 0x57, 0x22, 0xE4, 0x90, +0x92, 0x20, 0xF0, 0x90, 0x88, 0x3E, 0xE0, 0x13, +0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, 0x77, +0x90, 0x88, 0x36, 0xE0, 0x60, 0x53, 0xF1, 0x92, +0x70, 0x4F, 0xF1, 0xF0, 0x75, 0x77, 0x01, 0xE5, +0x77, 0x60, 0x46, 0x90, 0x88, 0x39, 0xE0, 0x20, +0xE2, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8B, 0x46, +0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xF1, +0xE8, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, 0x64, +0x01, 0x70, 0x10, 0xB1, 0x1E, 0xFF, 0xA3, 0xE0, +0x2F, 0x12, 0xA7, 0x93, 0xB1, 0x23, 0xFF, 0xA3, +0xE0, 0x80, 0x0C, 0xB1, 0x1E, 0xB1, 0x8A, 0x2F, +0x12, 0xA7, 0x93, 0xB1, 0x23, 0xB1, 0x8A, 0x2F, +0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, +0xF0, 0x22, 0xFF, 0xA3, 0xE0, 0x75, 0xF0, 0x03, +0xA4, 0x24, 0xFE, 0x22, 0x90, 0x93, 0x29, 0xE0, +0x44, 0x10, 0xF0, 0x22, 0x90, 0x93, 0x29, 0xE0, +0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, +0x90, 0x95, 0xC3, 0xF0, 0xF1, 0x93, 0x60, 0x02, +0xC1, 0xF2, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, +0xC1, 0xF2, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, +0x2F, 0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, 0x70, +0x27, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x21, 0x90, +0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1A, 0xA3, 0xE0, +0x54, 0x07, 0xFF, 0xBF, 0x07, 0x12, 0x90, 0x06, +0x62, 0xE0, 0x54, 0x03, 0x70, 0x0A, 0x90, 0x88, +0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xC3, 0x62, +0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, +0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, +0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, +0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, 0xF0, +0x90, 0x07, 0xF1, 0xE0, 0x90, 0x94, 0x9F, 0xF0, +0x90, 0x07, 0xF0, 0xE0, 0x90, 0x94, 0xA0, 0xF0, +0x12, 0xBA, 0x2E, 0xF0, 0x90, 0x88, 0x3A, 0xE0, +0x54, 0xEC, 0xF0, 0xD1, 0xFB, 0x24, 0xFD, 0x50, +0x02, 0x80, 0x03, 0x12, 0xA7, 0x27, 0xD1, 0xFB, +0x64, 0x01, 0x70, 0x3A, 0x90, 0x06, 0xAB, 0xE0, +0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xA9, 0xE0, +0x30, 0xE5, 0x06, 0xA3, 0xE0, 0x90, 0x95, 0xC3, +0xF0, 0x90, 0x95, 0xC3, 0xE0, 0xFF, 0x60, 0x02, 0x80, 0x05, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, -0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x31, 0x10, -0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x90, 0x88, 0x32, -0x12, 0xAF, 0x1B, 0x30, 0xE0, 0x5F, 0xEF, 0xC4, -0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x24, 0xD1, -0x88, 0x6F, 0x70, 0x51, 0xEF, 0x60, 0x4E, 0x90, -0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0x9F, -0xD2, 0xD1, 0x99, 0x12, 0x7C, 0x05, 0xF1, 0x1E, -0x12, 0xAF, 0x96, 0x90, 0x88, 0x3D, 0xE0, 0x14, -0xF0, 0x80, 0x32, 0x90, 0x88, 0x34, 0xE0, 0xC4, -0x54, 0x0F, 0x64, 0x01, 0x70, 0x27, 0xD1, 0x88, -0xFE, 0x6F, 0x60, 0x21, 0x90, 0x05, 0x73, 0xE0, -0xFF, 0xEE, 0x6F, 0x60, 0x18, 0x12, 0xAF, 0xAE, -0x30, 0xE0, 0x12, 0xEF, 0x54, 0xBF, 0xD1, 0x99, -0x12, 0x7C, 0x3B, 0x7D, 0x01, 0x7F, 0x02, 0x12, -0x7C, 0x74, 0x12, 0x9F, 0xBB, 0xD1, 0xA4, 0x22, -0x90, 0x88, 0x3C, 0xE0, 0xFF, 0xA3, 0xE0, 0x22, -0x90, 0x88, 0x34, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, -0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, -0xFD, 0x7F, 0x03, 0x22, 0x90, 0x88, 0x32, 0xE0, -0x44, 0x04, 0xF0, 0x22, 0xE4, 0xF5, 0x7A, 0x90, -0x06, 0xA9, 0xE0, 0xF5, 0x7A, 0x54, 0xC0, 0x70, -0x19, 0xF1, 0x16, 0x54, 0xFD, 0xF0, 0x12, 0xA6, -0x45, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x4E, 0x12, -0x9B, 0x94, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, -0x7B, 0x2E, 0xE5, 0x7A, 0x30, 0xE6, 0x22, 0x90, -0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1C, 0x90, -0x88, 0x3A, 0xE0, 0x44, 0x01, 0x12, 0xAF, 0x9D, -0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, -0x8A, 0x33, 0x80, 0x07, 0x12, 0x73, 0x8F, 0x80, -0x02, 0xF1, 0x16, 0xE5, 0x7A, 0x90, 0x88, 0x3A, -0x30, 0xE7, 0x0E, 0xE0, 0x44, 0x02, 0x12, 0x8F, -0x56, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, -0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, -0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x7D, 0x01, -0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x12, 0x02, 0x06, -0xFF, 0x54, 0x01, 0xFE, 0x22, 0x90, 0x88, 0x33, -0xE0, 0x54, 0xFE, 0xF0, 0x22, 0x54, 0x04, 0xFD, -0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, 0xF0, 0xEE, -0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x22, 0x90, -0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, -0x02, 0x22, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, -0x60, 0x02, 0xB1, 0x54, 0x22, 0x7F, 0x02, 0x12, -0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, -0x02, 0x7B, 0x2E, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, -0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, -0x4F, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, -0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, -0xE0, 0x22, 0x12, 0xAF, 0xA5, 0x70, 0x0B, 0x90, -0x88, 0x36, 0xE0, 0x60, 0x05, 0xF1, 0x47, 0x12, -0x8F, 0x56, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, -0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, -0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, -0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, -0x0F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x09, 0xF1, -0x16, 0x54, 0x07, 0x70, 0x03, 0x12, 0xA6, 0x45, -0x22, 0x12, 0xAF, 0xA5, 0x70, 0x15, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x0F, 0xF1, 0x47, 0xF0, 0x90, -0x88, 0x31, 0xE0, 0x12, 0xAF, 0xDB, 0x70, 0x03, -0x12, 0xA6, 0x45, 0x22, 0x90, 0x93, 0x31, 0xE0, -0x20, 0xE0, 0x03, 0x02, 0xB8, 0xAF, 0xE4, 0x90, -0x94, 0xC1, 0xF0, 0x90, 0x94, 0xC1, 0xE0, 0xFF, -0xC3, 0x94, 0x05, 0x40, 0x03, 0x02, 0xB8, 0xAF, -0x12, 0x9B, 0xA5, 0x80, 0x05, 0xC3, 0x33, 0xCE, -0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x32, -0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x01, 0xA6, -0x12, 0x02, 0x06, 0xFF, 0x30, 0xE0, 0x1A, 0x90, -0x93, 0x33, 0xE0, 0xFE, 0x90, 0x94, 0xC1, 0xE0, -0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x33, -0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x16, 0x90, -0x93, 0x34, 0xE0, 0xFF, 0x90, 0x94, 0xC1, 0x12, -0xA9, 0x0B, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -0x4F, 0x90, 0x93, 0x34, 0xF0, 0x12, 0x87, 0xA8, -0xFF, 0x90, 0x94, 0xC1, 0xE0, 0xFE, 0x24, 0x35, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, -0x12, 0x87, 0x2D, 0xFF, 0x74, 0x3A, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0x12, 0x87, 0x3B, 0xFF, -0x74, 0x3F, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, -0x12, 0x87, 0x89, 0xFF, 0x74, 0x44, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, -0x90, 0x93, 0x32, 0xE0, 0xFF, 0x74, 0x01, 0xA8, -0x06, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -0x4F, 0x90, 0x93, 0x32, 0xF0, 0x22, 0x90, 0x94, -0xC1, 0xE0, 0x04, 0xF0, 0x02, 0xB7, 0xF3, 0x22, -0x12, 0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, -0x31, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, -0x04, 0xE4, 0x12, 0x9B, 0xE5, 0x22, 0x12, 0x02, -0x06, 0xFF, 0x90, 0x93, 0x4B, 0xF0, 0xBF, 0x01, -0x0A, 0x7F, 0x01, 0x12, 0x8C, 0xAC, 0xE4, 0x90, -0x93, 0x4B, 0xF0, 0x22, 0x90, 0x95, 0xCE, 0xEF, -0xF0, 0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, -0x90, 0x95, 0xF2, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, -0x72, 0x90, 0x95, 0xCF, 0x74, 0x03, 0xF0, 0x90, -0x95, 0xF1, 0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, -0x0F, 0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, -0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, -0xF5, 0x83, 0xE5, 0x82, 0x2E, 0x12, 0xAF, 0x10, -0xE0, 0xFD, 0x74, 0xD1, 0x2E, 0xF5, 0x82, 0xE4, -0x34, 0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, -0xB4, 0x08, 0xD9, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0xCF, 0x12, 0xA5, 0x4B, 0x12, 0x04, 0x7E, 0x90, -0x95, 0xF2, 0xE0, 0x04, 0x54, 0x0F, 0xFF, 0xF0, -0xBF, 0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x95, 0xF2, -0xE0, 0x90, 0x04, 0x7F, 0xF0, 0x90, 0x95, 0xCE, -0xE0, 0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, -0x90, 0x8A, 0x79, 0x12, 0x8C, 0xA3, 0x7F, 0x04, -0x12, 0x04, 0x7E, 0x22, 0xE4, 0xFF, 0x01, 0xDC, -0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, -0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, -0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, -0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, -0x74, 0x68, 0xF0, 0x74, 0xB9, 0xA3, 0xF0, 0x12, -0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, 0x02, 0x91, -0x91, 0xE5, 0x2D, 0x30, 0xE1, 0x02, 0x31, 0x64, -0xE5, 0x2D, 0x30, 0xE3, 0x02, 0x91, 0xAC, 0xE5, -0x2D, 0x30, 0xE4, 0x02, 0x91, 0x9B, 0xE5, 0x2D, -0x30, 0xE5, 0x02, 0x91, 0xE1, 0xE5, 0x2F, 0x30, -0xE0, 0x03, 0x12, 0x9E, 0x85, 0xE5, 0x2F, 0x30, -0xE1, 0x03, 0x12, 0x88, 0xF8, 0xE5, 0x2F, 0x30, -0xE2, 0x03, 0x12, 0xB7, 0x52, 0xE5, 0x2F, 0x30, -0xE3, 0x03, 0x12, 0xB7, 0x8A, 0xE5, 0x2F, 0x30, -0xE4, 0x03, 0x12, 0xB7, 0xC9, 0xE5, 0x2F, 0x30, -0xE5, 0x02, 0x91, 0xBF, 0xE5, 0x2F, 0x30, 0xE6, -0x03, 0x12, 0xB7, 0xB1, 0xE5, 0x2F, 0x30, 0xE7, -0x02, 0x91, 0x05, 0xE5, 0x30, 0x30, 0xE0, 0x02, -0x71, 0xFD, 0xE5, 0x30, 0x30, 0xE4, 0x02, 0x51, -0x2F, 0xE5, 0x30, 0x30, 0xE5, 0x03, 0x12, 0x9F, -0xEA, 0x74, 0x68, 0x04, 0x90, 0x01, 0xC4, 0xF0, -0x74, 0xB9, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, -0xFF, 0x90, 0x95, 0xCE, 0xEF, 0xF0, 0x90, 0x88, -0x2B, 0xE0, 0x90, 0x95, 0xE0, 0xF0, 0xE4, 0x90, -0x95, 0xCF, 0xF0, 0x90, 0x95, 0xE0, 0xE0, 0xFE, -0x90, 0x95, 0xCF, 0xE0, 0xFF, 0xC3, 0x9E, 0x50, -0x2B, 0xE0, 0xFE, 0x71, 0x68, 0xE4, 0xF0, 0xEE, -0x91, 0x49, 0xE0, 0x30, 0xE7, 0x0A, 0x75, 0xF0, -0x12, 0xEF, 0x71, 0x72, 0xE4, 0xF0, 0x80, 0x0C, -0x12, 0x7C, 0x8F, 0x90, 0x95, 0xCF, 0xE0, 0x71, -0x68, 0x74, 0x01, 0xF0, 0x90, 0x95, 0xCF, 0xE0, -0x04, 0xF0, 0x80, 0xC7, 0x7F, 0x0C, 0x7E, 0x00, -0x12, 0x7C, 0x6A, 0xE4, 0x90, 0x95, 0xCF, 0xF0, -0x90, 0x95, 0xE0, 0xE0, 0xFF, 0x90, 0x95, 0xCF, -0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x61, 0x67, -0x74, 0xD0, 0x2E, 0x71, 0x6A, 0xE0, 0x70, 0x02, -0x61, 0x5F, 0xEE, 0xC4, 0x54, 0xF0, 0x24, 0x06, -0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, -0xFD, 0xEE, 0xC4, 0x54, 0xF0, 0x24, 0x07, 0xF5, -0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x71, 0x78, -0xFC, 0x75, 0xF0, 0x12, 0x91, 0x8B, 0xEE, 0xF0, -0xA3, 0xEF, 0xF0, 0xEC, 0xC4, 0x54, 0xF0, 0x24, -0x0A, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -0xE0, 0xFD, 0xEC, 0x71, 0x8A, 0x71, 0x78, 0x75, -0xF0, 0x12, 0x90, 0x89, 0x57, 0x12, 0x04, 0x6E, -0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x7F, 0x01, -0x90, 0x95, 0xCF, 0xE0, 0xFE, 0x71, 0x8A, 0xE5, -0x82, 0x2F, 0x12, 0xAF, 0x10, 0xE0, 0xFD, 0x75, -0xF0, 0x12, 0xEE, 0x90, 0x89, 0x57, 0x12, 0x04, -0x6E, 0x75, 0xF0, 0x02, 0xEF, 0x12, 0x04, 0x6E, -0xE4, 0x8D, 0xF0, 0x12, 0x02, 0xE7, 0x0F, 0xEF, -0xB4, 0x05, 0xD5, 0x71, 0x81, 0x24, 0x09, 0xF5, -0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0xFE, -0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x55, 0x12, -0x04, 0x6E, 0xEE, 0xF0, 0x71, 0x81, 0x24, 0x04, -0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, -0xFE, 0x91, 0x2C, 0xF5, 0x83, 0xEE, 0xF0, 0x90, -0x95, 0xCF, 0xE0, 0xFF, 0x90, 0x95, 0xCE, 0xE0, -0xFD, 0x71, 0x9B, 0x90, 0x95, 0xCF, 0xE0, 0x75, -0xF0, 0x12, 0x71, 0x72, 0x74, 0x01, 0xF0, 0x90, -0x95, 0xCF, 0xE0, 0x04, 0xF0, 0x41, 0x88, 0x22, -0x24, 0xD0, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -0x83, 0x22, 0x90, 0x89, 0x56, 0x02, 0x04, 0x6E, -0xE0, 0xFE, 0xED, 0xFF, 0x90, 0x95, 0xCF, 0xE0, -0x22, 0x90, 0x95, 0xCF, 0xE0, 0xFF, 0xC4, 0x54, -0xF0, 0x22, 0xC4, 0x54, 0xF0, 0x24, 0x0B, 0xF5, -0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x7D, -0x01, 0xAF, 0x65, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0xED, 0x60, 0x12, 0x71, 0xC0, 0x90, -0x89, 0x5F, 0x71, 0xF1, 0x90, 0x89, 0x53, 0x71, -0xF1, 0x91, 0x24, 0xF5, 0x83, 0xE4, 0xF0, 0x91, -0x35, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0x12, -0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, -0x12, 0xEF, 0x90, 0x89, 0x59, 0x12, 0x04, 0x6E, -0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, -0x90, 0x89, 0x5B, 0x12, 0x04, 0x6E, 0xE4, 0xF0, -0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, -0x5D, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, -0x75, 0xF0, 0x12, 0xEF, 0x22, 0x91, 0x14, 0xBF, -0x03, 0x02, 0x91, 0x1C, 0x22, 0xE4, 0xF5, 0x7A, -0xF5, 0x7B, 0xF5, 0x7C, 0x91, 0x14, 0xBF, 0x03, -0x02, 0x91, 0x1C, 0x22, 0x90, 0x01, 0x02, 0xE0, -0x54, 0x03, 0xFF, 0x22, 0x90, 0x05, 0x21, 0xE0, -0x54, 0x7F, 0xF0, 0x22, 0x90, 0x89, 0x55, 0x12, -0x04, 0x6E, 0xE4, 0xF0, 0x74, 0xAD, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x94, 0x22, 0xEF, 0xC4, 0x54, -0xF0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, -0xF5, 0x83, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, -0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, 0xF5, 0x82, -0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x7D, 0x07, -0xAF, 0x65, 0xED, 0x30, 0xE0, 0x0C, 0x71, 0xC0, -0x90, 0x89, 0x5F, 0x12, 0x04, 0x6E, 0xE4, 0xF0, -0xA3, 0xF0, 0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, -0x12, 0xEF, 0x91, 0x8B, 0xE4, 0xF0, 0xA3, 0xF0, -0xED, 0x30, 0xE2, 0x0A, 0x75, 0xF0, 0x12, 0xEF, -0x91, 0x24, 0xF5, 0x83, 0xE4, 0xF0, 0x91, 0x35, -0xEE, 0xF0, 0x22, 0x90, 0x89, 0x53, 0x02, 0x04, -0x6E, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, -0x8F, 0x03, 0x22, 0x90, 0x8A, 0x75, 0x12, 0x8A, -0x33, 0x90, 0x8A, 0xE5, 0x12, 0x8C, 0xA3, 0x7F, -0x02, 0x02, 0x04, 0x7E, 0x90, 0x93, 0x03, 0xE0, -0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8C, -0xA3, 0x7F, 0x20, 0x12, 0x04, 0x7E, 0x22, 0xE4, -0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x19, 0x90, -0x88, 0x36, 0xE0, 0x60, 0x13, 0x12, 0xAF, 0x9E, -0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, 0xE1, 0x12, -0x9F, 0xC2, 0x02, 0x04, 0x7A, 0x12, 0x73, 0x8F, -0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, 0xCE, -0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, 0x01, -0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, 0xE5, -0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, 0xF0, -0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, 0xF5, -0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, 0x00, -0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, 0x12, -0x7B, 0x2E, 0x80, 0xFE, 0x22, 0x12, 0x97, 0xC2, -0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, 0xA1, -0xAE, 0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, 0x60, -0x19, 0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, 0x94, -0xC7, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, 0x14, -0x90, 0x94, 0xC7, 0x74, 0x06, 0xF0, 0xA3, 0xF0, -0x80, 0x0A, 0x90, 0x94, 0xC7, 0x74, 0x0C, 0xF0, -0xA3, 0x74, 0x04, 0xF0, 0xB1, 0xC2, 0xB1, 0xAF, -0x40, 0x1B, 0x90, 0x94, 0xC5, 0xE0, 0xD1, 0x52, -0x7A, 0x94, 0x79, 0xC4, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x07, 0x90, 0x94, 0xC4, 0xE0, 0xF4, 0x70, -0x3D, 0xB1, 0xB7, 0x80, 0xE1, 0xB1, 0xC2, 0xB1, -0xAF, 0x40, 0x33, 0x90, 0x94, 0xC5, 0xE0, 0xFD, -0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, 0x01, -0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, 0xFC, -0x90, 0x94, 0xC7, 0xE0, 0xFB, 0xC3, 0xED, 0x9B, -0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x12, 0x90, 0xC3, -0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, 0xFD, -0xB1, 0xD3, 0xB1, 0xB7, 0x80, 0xC9, 0x22, 0x90, -0x94, 0xC6, 0xE0, 0xD3, 0x94, 0x00, 0x22, 0x90, -0x94, 0xC5, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0x14, -0xF0, 0x22, 0x90, 0x94, 0xC7, 0xE0, 0x90, 0x94, -0xC5, 0xF0, 0x90, 0x94, 0xC8, 0xE0, 0x90, 0x94, -0xC6, 0xF0, 0x22, 0x8E, 0x61, 0x8F, 0x62, 0x8D, -0x63, 0xE4, 0x90, 0x94, 0xC9, 0xF0, 0x90, 0x00, -0x37, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, 0x12, -0x7B, 0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, 0x7B, -0x2E, 0xE5, 0x62, 0xFD, 0x7F, 0x31, 0x12, 0x7B, -0x2E, 0xE5, 0x61, 0x54, 0x03, 0xFF, 0x90, 0x00, -0x32, 0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, 0x32, -0x12, 0x7B, 0x2E, 0xAD, 0x63, 0x7F, 0x30, 0x12, -0x7B, 0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, 0x80, -0xFD, 0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, 0x00, -0x33, 0xE0, 0x30, 0xE7, 0x09, 0xD1, 0x4A, 0x50, -0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, 0xFD, -0x7F, 0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x37, -0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, 0x7B, -0x2E, 0xD1, 0x4A, 0x7F, 0x00, 0x50, 0x02, 0x7F, -0x01, 0x22, 0x90, 0x94, 0xC9, 0xE0, 0xC3, 0x94, -0x64, 0x22, 0x24, 0xA8, 0xFF, 0xE4, 0x34, 0x01, -0xFE, 0x7B, 0x01, 0x22, 0xE4, 0x90, 0x86, 0xAF, -0x12, 0x9B, 0xE4, 0x90, 0x93, 0x01, 0xF0, 0x90, -0x93, 0x5D, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x00, -0x80, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, -0x7B, 0x2E, 0x12, 0xC3, 0x7C, 0xF1, 0xD2, 0x12, -0x7B, 0x79, 0x12, 0xC5, 0x0C, 0xD1, 0x5C, 0x7F, -0x01, 0x12, 0x84, 0x15, 0x90, 0x93, 0x49, 0x74, -0x02, 0xF0, 0xFF, 0x12, 0x84, 0x15, 0x90, 0x93, -0x49, 0xE0, 0x04, 0xF0, 0xF1, 0x75, 0x12, 0x9C, -0x45, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xFD, -0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, 0xFF, +0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x31, 0x75, +0xE4, 0x90, 0x88, 0x3F, 0xF0, 0xA3, 0xF0, 0x90, +0x88, 0x32, 0xB1, 0x9F, 0x30, 0xE0, 0x64, 0xEF, +0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x27, +0xD1, 0xF3, 0x6F, 0x70, 0x56, 0xEF, 0x60, 0x53, +0x90, 0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xF1, +0xE0, 0xF1, 0x04, 0x12, 0x7C, 0x05, 0xF1, 0xD9, +0x7D, 0x02, 0x7F, 0x02, 0x12, 0x7C, 0x7E, 0x90, +0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, 0x34, 0x90, +0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, +0x70, 0x29, 0xD1, 0xF3, 0xFE, 0x6F, 0x60, 0x23, +0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, +0x1A, 0x90, 0x88, 0x32, 0xF1, 0x0F, 0x30, 0xE0, +0x12, 0xEF, 0x54, 0xBF, 0xF1, 0x04, 0x12, 0x7C, +0x3B, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x7C, 0x74, +0x12, 0xBA, 0xC4, 0x90, 0x88, 0x32, 0xE0, 0x44, +0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, +0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xFF, +0xC4, 0x54, 0x0F, 0x22, 0xF0, 0x90, 0x01, 0x3F, +0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0xE0, +0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x88, +0x32, 0xB1, 0x9F, 0x30, 0xE0, 0x10, 0xEF, 0xC4, +0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x07, 0x7D, +0x02, 0x7F, 0x02, 0x12, 0x7C, 0x7E, 0x90, 0x88, +0x31, 0xF1, 0x0F, 0x30, 0xE0, 0x08, 0xEF, 0x12, +0xBA, 0xEB, 0x70, 0x4D, 0x80, 0x48, 0x90, 0x88, +0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, +0x54, 0xEF, 0xF0, 0x12, 0xDC, 0x4C, 0x9F, 0x40, +0x35, 0xF1, 0x92, 0x70, 0x34, 0x12, 0xA7, 0xE8, +0x70, 0x08, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xCD, +0x80, 0x28, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xCD, +0x90, 0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, +0x94, 0x02, 0x40, 0x09, 0xF1, 0x8A, 0xE4, 0x90, +0x88, 0x40, 0xF0, 0x80, 0x03, 0x12, 0xDB, 0xAA, +0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x22, 0x12, 0xA6, +0xF0, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, +0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, +0x64, 0x01, 0x22, 0xE4, 0x90, 0x95, 0xE8, 0xF0, +0x90, 0x88, 0x36, 0xE0, 0x60, 0x32, 0xF1, 0x92, +0x70, 0x2E, 0xF1, 0xE0, 0xF0, 0xF1, 0xF0, 0x90, +0x95, 0xE8, 0x74, 0x01, 0xF0, 0xE4, 0x90, 0x88, +0x3D, 0xF0, 0x04, 0x60, 0x1B, 0x90, 0x88, 0x39, +0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, 0xB9, 0x12, +0x8B, 0x46, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, +0x7E, 0xF1, 0xE8, 0xB1, 0x1E, 0x12, 0xA7, 0x93, +0x22, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, +0x90, 0x88, 0x3C, 0xE0, 0x90, 0x05, 0x73, 0x22, +0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, +0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, +0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, +0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, +0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, +0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, +0x90, 0x93, 0x31, 0xE0, 0x20, 0xE0, 0x02, 0x01, +0xD9, 0xE4, 0x90, 0x94, 0xB6, 0xF0, 0x11, 0xDA, +0x40, 0x02, 0x01, 0xD9, 0x31, 0x73, 0x80, 0x05, +0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, +0x90, 0x93, 0x32, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, +0x02, 0x01, 0xD1, 0x12, 0x02, 0x06, 0xFF, 0x30, +0xE0, 0x1A, 0x90, 0x93, 0x33, 0xE0, 0xFE, 0x90, +0x94, 0xB6, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, +0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, +0x90, 0x93, 0x33, 0xF0, 0xEF, 0xC3, 0x13, 0x30, +0xE0, 0x16, 0x90, 0x93, 0x34, 0xE0, 0xFF, 0x90, +0x94, 0xB6, 0x12, 0x93, 0x3F, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x34, 0xF0, +0x12, 0x98, 0xAC, 0xFF, 0x90, 0x94, 0xB6, 0xE0, +0xFE, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0xEF, 0x12, 0x87, 0xE9, 0xFF, 0x74, +0x3A, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x12, +0x87, 0xF0, 0xFF, 0x74, 0x3F, 0x2E, 0xF5, 0x82, +0xE4, 0x34, 0x93, 0x12, 0x87, 0xFA, 0xFF, 0x74, +0x44, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, +0x83, 0xEF, 0xF0, 0x90, 0x93, 0x32, 0xE0, 0xFF, +0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x32, 0xF0, +0x22, 0x90, 0x94, 0xB6, 0xE0, 0x04, 0xF0, 0x01, +0x26, 0x22, 0x90, 0x94, 0xB6, 0xE0, 0xFF, 0xC3, +0x94, 0x05, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, +0x00, 0x90, 0x89, 0x2E, 0x12, 0x86, 0x76, 0x7B, +0xFF, 0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, +0x12, 0x86, 0x76, 0x7A, 0x80, 0x79, 0xBF, 0x90, +0x89, 0x34, 0x12, 0x86, 0x76, 0x7A, 0x81, 0x79, +0x61, 0x90, 0x89, 0x3A, 0x12, 0x86, 0x76, 0x7A, +0x81, 0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, +0x76, 0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, +0x12, 0x86, 0x76, 0x31, 0x66, 0x7A, 0x81, 0x79, +0xD9, 0x90, 0x89, 0x49, 0x12, 0x86, 0x76, 0x7A, +0x82, 0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, +0x76, 0xE4, 0x90, 0x96, 0x1D, 0xF0, 0x90, 0x96, +0x0C, 0xF0, 0x90, 0x94, 0xB6, 0xF0, 0x11, 0xDA, +0x50, 0x0F, 0x74, 0x2E, 0x2F, 0x31, 0x5E, 0xE4, +0xF0, 0x90, 0x94, 0xB6, 0xE0, 0x04, 0xF0, 0x80, +0xED, 0x22, 0x74, 0x2E, 0x25, 0x62, 0xF5, 0x82, +0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x7A, 0x81, +0x79, 0xB1, 0x90, 0x89, 0x46, 0x02, 0x86, 0x76, +0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, 0x00, 0xA8, +0x07, 0x08, 0x22, 0xE4, 0x90, 0x95, 0x11, 0xF0, +0x12, 0xD0, 0xF7, 0xF1, 0xB5, 0xE4, 0xFF, 0x71, +0xB1, 0x90, 0x93, 0x31, 0xE0, 0x20, 0xE0, 0x02, +0x41, 0x6D, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x02, +0xF0, 0xE4, 0x90, 0x95, 0x12, 0xF0, 0x90, 0x95, +0x12, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2B, +0x31, 0x73, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, +0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x34, 0xE0, +0xFD, 0xEF, 0x5D, 0x60, 0x0E, 0x90, 0x95, 0x12, +0x91, 0x38, 0x90, 0x95, 0x12, 0x91, 0x58, 0x44, +0x40, 0x91, 0x00, 0x90, 0x95, 0x12, 0xE0, 0x04, +0xF0, 0x80, 0xCB, 0x90, 0x07, 0xC7, 0xE4, 0xF0, +0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, +0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, +0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, +0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, +0x90, 0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, +0x90, 0x95, 0x13, 0xF0, 0x90, 0x95, 0x13, 0xE0, +0x30, 0xE0, 0x18, 0x90, 0x95, 0x11, 0xE0, 0x04, +0xF1, 0xAD, 0x90, 0x02, 0x26, 0xE0, 0x90, 0x95, +0x13, 0xF0, 0x90, 0x95, 0x11, 0xE0, 0xD3, 0x94, +0xFA, 0x40, 0xE1, 0x90, 0x02, 0x03, 0x74, 0x80, +0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x95, 0x14, +0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, +0x90, 0x02, 0x00, 0xE0, 0x90, 0x95, 0x13, 0xF0, +0x90, 0x02, 0x01, 0x51, 0x7D, 0x90, 0x02, 0x02, +0x51, 0x7D, 0x90, 0x02, 0x14, 0x51, 0x7D, 0xE0, +0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x12, +0x9B, 0xAE, 0x90, 0x95, 0x14, 0xE0, 0x90, 0x04, +0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, 0xFF, 0xF0, +0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, 0x08, 0xF0, +0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, 0x32, +0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, 0xFF, 0x90, +0x95, 0x13, 0xE0, 0x2F, 0xF0, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x96, 0x31, +0x7B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x61, +0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x10, 0xF0, +0x91, 0x08, 0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, +0x90, 0x88, 0x41, 0xE0, 0x90, 0x00, 0x93, 0xF0, +0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, +0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, +0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, +0x90, 0x93, 0x31, 0xE0, 0x30, 0xE0, 0x5E, 0x90, +0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, +0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, +0x90, 0x95, 0x11, 0xF0, 0x90, 0x95, 0x11, 0xE0, +0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2B, 0x31, 0x73, +0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, +0xF9, 0xFF, 0x90, 0x93, 0x33, 0xE0, 0xFD, 0xEF, +0x5D, 0x60, 0x0E, 0x90, 0x95, 0x11, 0x91, 0x38, +0x90, 0x95, 0x11, 0x91, 0x58, 0x44, 0x20, 0x91, +0x00, 0x90, 0x95, 0x11, 0xE0, 0x04, 0xF0, 0x80, +0xCB, 0x90, 0x00, 0x92, 0xE0, 0x54, 0xFE, 0xF0, +0xE0, 0x44, 0x08, 0xF0, 0x90, 0x00, 0x02, 0xE0, +0x54, 0xFD, 0xF0, 0x80, 0x07, 0x90, 0x00, 0x92, +0xE0, 0x44, 0x01, 0xF0, 0x90, 0x00, 0x08, 0xE0, +0x44, 0x10, 0xF0, 0x7F, 0x01, 0x71, 0xB1, 0x90, +0x00, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, +0x6A, 0x90, 0x96, 0xBE, 0xEF, 0x12, 0xA7, 0xAE, +0x90, 0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, +0x02, 0x7F, 0x01, 0x90, 0x96, 0xBE, 0xE0, 0x6F, +0x60, 0x35, 0xC3, 0x90, 0x96, 0xC0, 0xE0, 0x94, +0x88, 0x90, 0x96, 0xBF, 0xE0, 0x94, 0x13, 0x40, +0x08, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, +0x22, 0x90, 0x96, 0xBF, 0x12, 0x9F, 0xEF, 0x91, +0x01, 0xD3, 0x90, 0x96, 0xC0, 0xE0, 0x94, 0x32, +0x90, 0x96, 0xBF, 0xE0, 0x94, 0x00, 0x40, 0xC0, +0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xB9, 0x22, +0xF0, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, +0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x54, +0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, 0xFB, 0x90, +0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, 0x22, 0x90, +0x88, 0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, +0x0E, 0x12, 0xDB, 0x52, 0xBF, 0x01, 0x08, 0x51, +0x86, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, +0xE0, 0xFF, 0x24, 0x3F, 0xF5, 0x82, 0xE4, 0x34, +0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, 0xF0, +0x74, 0x44, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, 0x22, +0xE0, 0xFF, 0x24, 0x35, 0xF5, 0x82, 0xE4, 0x34, +0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, 0xF0, +0x74, 0x3A, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, 0xE0, +0x22, 0xE4, 0x90, 0x94, 0xB6, 0xF0, 0xA3, 0xF0, +0x12, 0xD0, 0xA5, 0xEF, 0x64, 0x01, 0x60, 0x3C, +0xC3, 0x90, 0x94, 0xB7, 0xE0, 0x94, 0x88, 0x90, +0x94, 0xB6, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, +0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, +0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1E, 0x90, 0x94, +0xB6, 0x12, 0x9F, 0xEF, 0x91, 0x01, 0xD3, 0x90, +0x94, 0xB7, 0xE0, 0x94, 0x32, 0x90, 0x94, 0xB6, +0xE0, 0x94, 0x00, 0x40, 0xC3, 0x90, 0x01, 0xC6, +0xE0, 0x30, 0xE3, 0xBC, 0x90, 0x01, 0xC7, 0x74, +0xFE, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, +0xFD, 0xED, 0x70, 0x02, 0xA1, 0xB5, 0x90, 0x87, +0x0B, 0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, +0x09, 0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x87, +0x0C, 0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, +0x02, 0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, +0xC1, 0xE0, 0x44, 0x01, 0xF0, 0xA1, 0xB5, 0x90, +0x96, 0xCA, 0xE0, 0x31, 0x72, 0x80, 0x05, 0xC3, +0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xED, +0xFB, 0xEF, 0x5B, 0x60, 0x7B, 0xE4, 0xFC, 0xB1, +0xBB, 0xA4, 0xFF, 0xEC, 0x7A, 0x00, 0x2F, 0xFF, +0xEA, 0x35, 0xF0, 0xFE, 0x74, 0xD0, 0xB1, 0xCE, +0x90, 0x87, 0x0C, 0xE0, 0xF9, 0x75, 0xF0, 0x08, +0x90, 0x86, 0xBB, 0xB1, 0xD9, 0xEF, 0xB1, 0xBA, +0xA4, 0xFF, 0xEC, 0x2F, 0xFF, 0xEA, 0x35, 0xF0, +0xFE, 0x74, 0xF0, 0xB1, 0xCE, 0x75, 0xF0, 0x08, +0xE9, 0x90, 0x86, 0xBF, 0xB1, 0xD9, 0xEF, 0xF0, +0x0C, 0xEC, 0xB4, 0x04, 0xC2, 0xB1, 0xC3, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5D, 0xFD, +0xB1, 0xC3, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, +0x90, 0x01, 0xCC, 0xF0, 0x90, 0x96, 0xCA, 0xE0, +0x04, 0xF0, 0xE0, 0x54, 0x03, 0xF0, 0x90, 0x87, +0x0C, 0xE0, 0x04, 0xF0, 0xE0, 0x7F, 0x00, 0xB4, +0x0A, 0x02, 0x7F, 0x01, 0xEF, 0x70, 0x02, 0x81, +0xD9, 0xE4, 0x90, 0x87, 0x0C, 0xF0, 0x81, 0xD9, +0x90, 0x01, 0xC0, 0xE0, 0x44, 0x02, 0xF0, 0x90, +0x96, 0xCA, 0xE0, 0x44, 0x80, 0x90, 0x00, 0x8A, +0xB1, 0xBA, 0x90, 0x01, 0xD0, 0x12, 0x04, 0x6E, +0xE0, 0x90, 0x01, 0xC3, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xF0, 0x90, 0x96, 0xCA, 0xE0, 0x75, +0xF0, 0x04, 0x22, 0x90, 0x96, 0xCA, 0xE0, 0xFF, +0x74, 0x01, 0xA8, 0x07, 0x08, 0x22, 0x2F, 0xF5, +0x82, 0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, +0x22, 0x12, 0x04, 0x6E, 0xE5, 0x82, 0x2C, 0xF5, +0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, +0x56, 0xEF, 0xF0, 0x90, 0x88, 0x2B, 0xE0, 0x90, +0x96, 0x68, 0xF0, 0xE4, 0x90, 0x96, 0x57, 0xF0, +0x90, 0x96, 0x68, 0xE0, 0xFE, 0x90, 0x96, 0x57, +0xE0, 0xFF, 0xC3, 0x9E, 0x50, 0x2B, 0xE0, 0xFE, +0xF1, 0x06, 0xE4, 0xF0, 0xEE, 0xF1, 0x3D, 0xE0, +0x30, 0xE7, 0x0A, 0x75, 0xF0, 0x12, 0xEF, 0xF1, +0x10, 0xE4, 0xF0, 0x80, 0x0C, 0x12, 0x7C, 0x8F, +0x90, 0x96, 0x57, 0xE0, 0xF1, 0x06, 0x74, 0x01, +0xF0, 0x90, 0x96, 0x57, 0xE0, 0x04, 0xF0, 0x80, +0xC7, 0x7F, 0x0C, 0x7E, 0x00, 0x12, 0x7C, 0x6A, +0xE4, 0x90, 0x96, 0x57, 0xF0, 0x90, 0x96, 0x68, +0xE0, 0xFF, 0x90, 0x96, 0x57, 0xE0, 0xFE, 0xC3, +0x9F, 0x40, 0x02, 0xE1, 0x01, 0x74, 0x58, 0x2E, +0xF1, 0x08, 0xE0, 0x70, 0x02, 0xC1, 0xF9, 0xEE, +0xC4, 0x54, 0xF0, 0x24, 0x06, 0xF5, 0x82, 0xE4, +0x34, 0x81, 0xF5, 0x83, 0xE0, 0xFD, 0xEE, 0xC4, +0x54, 0xF0, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, +0x81, 0xF5, 0x83, 0xF1, 0x16, 0xFC, 0x75, 0xF0, +0x12, 0x90, 0x89, 0x53, 0xF1, 0x1F, 0xEC, 0xC4, +0x54, 0xF0, 0x24, 0x0A, 0xF5, 0x82, 0xE4, 0x34, +0x81, 0xF5, 0x83, 0xE0, 0xFD, 0xEC, 0xF1, 0x28, +0xF1, 0x16, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x57, +0xF1, 0x1F, 0x7F, 0x01, 0x90, 0x96, 0x57, 0xE0, +0xFE, 0xF1, 0x28, 0xE5, 0x82, 0x2F, 0xB1, 0xDF, +0xE0, 0xFD, 0x75, 0xF0, 0x12, 0xEE, 0x90, 0x89, +0x57, 0x12, 0x04, 0x6E, 0x75, 0xF0, 0x02, 0xEF, +0xF1, 0x35, 0xED, 0xF0, 0x0F, 0xEF, 0xB4, 0x05, +0xDB, 0x90, 0x96, 0x57, 0xE0, 0xFF, 0xC4, 0x54, +0xF0, 0x24, 0x09, 0xF5, 0x82, 0xE4, 0x34, 0x81, +0xF5, 0x83, 0xE0, 0xFE, 0xF1, 0x9F, 0xEE, 0xF0, +0x90, 0x96, 0x57, 0xE0, 0xFF, 0x90, 0x96, 0x56, +0xE0, 0xFD, 0x12, 0x61, 0xF7, 0x90, 0x96, 0x57, +0xE0, 0x75, 0xF0, 0x12, 0xF1, 0x10, 0x74, 0x01, +0xF0, 0x90, 0x96, 0x57, 0xE0, 0x04, 0xF0, 0xC1, +0x45, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x24, 0x58, +0xF5, 0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, +0x90, 0x89, 0x56, 0x02, 0x04, 0x6E, 0xE0, 0xFE, +0xED, 0xFF, 0x90, 0x96, 0x57, 0xE0, 0x22, 0x12, +0x04, 0x6E, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, +0xC4, 0x54, 0xF0, 0x24, 0x0B, 0xF5, 0x82, 0xE4, +0x34, 0x81, 0xF5, 0x83, 0x22, 0x12, 0x04, 0x6E, +0xE4, 0xF0, 0xA3, 0x22, 0xEF, 0xC4, 0x54, 0xF0, +0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, +0x83, 0x22, 0x7D, 0x07, 0xAF, 0x62, 0xED, 0x30, +0xE0, 0x1E, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, +0x57, 0xF1, 0x93, 0x90, 0x89, 0x59, 0xF1, 0x93, +0x90, 0x89, 0x5B, 0xF1, 0x93, 0x90, 0x89, 0x5D, +0xF1, 0x93, 0x90, 0x89, 0x5F, 0xF1, 0x35, 0xF0, +0xED, 0x30, 0xE1, 0x0A, 0x75, 0xF0, 0x12, 0xEF, +0x90, 0x89, 0x53, 0xF1, 0x35, 0xF0, 0xED, 0x30, +0xE2, 0x04, 0xF1, 0x9F, 0xE4, 0xF0, 0xF1, 0x3C, +0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0xF1, 0x3C, +0xEE, 0xF0, 0x22, 0x12, 0x04, 0x6E, 0xE4, 0xF0, +0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x22, 0x75, +0xF0, 0x12, 0xEF, 0x90, 0x89, 0x55, 0x02, 0x04, +0x6E, 0xE4, 0xFF, 0xA1, 0xE7, 0xF0, 0x7F, 0x0A, +0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x00, 0x08, +0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xF1, 0xB5, 0x12, +0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xC0, 0xDF, +0x12, 0xC1, 0x18, 0x75, 0x21, 0x80, 0xE4, 0xF5, +0x22, 0xF5, 0x23, 0x75, 0x24, 0x80, 0x90, 0x00, +0x50, 0xE5, 0x21, 0xF0, 0xA3, 0xE5, 0x22, 0xF0, +0xA3, 0xE5, 0x23, 0xF0, 0xA3, 0xE5, 0x24, 0xF0, +0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x4B, +0xF0, 0xBF, 0x01, 0x0A, 0x7F, 0x01, 0x12, 0x8C, +0x78, 0xE4, 0x90, 0x93, 0x4B, 0xF0, 0x22, 0x12, +0x02, 0x06, 0x90, 0x93, 0x25, 0xF0, 0x12, 0x98, +0xAC, 0x90, 0x93, 0x26, 0x12, 0x87, 0xE9, 0x90, +0x93, 0x27, 0xF0, 0x22, 0xE4, 0xFD, 0x02, 0x8F, +0xFA, 0x90, 0x95, 0xC3, 0xEF, 0xF0, 0x90, 0x04, +0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x95, 0xE7, +0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x72, 0x90, 0x95, +0xC4, 0x74, 0x03, 0xF0, 0x90, 0x95, 0xE6, 0x74, +0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, 0xE4, +0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, +0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, 0xE5, +0x82, 0x2E, 0x12, 0xB5, 0xDF, 0xE0, 0xFD, 0x74, +0xC6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, +0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xD9, +0x7B, 0x01, 0x7A, 0x95, 0x79, 0xC4, 0x12, 0xA4, +0x3F, 0x12, 0x04, 0x7E, 0x90, 0x95, 0xE7, 0xE0, +0x04, 0x54, 0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, +0xE4, 0xF0, 0x90, 0x95, 0xE7, 0xE0, 0x90, 0x04, +0x7F, 0xF0, 0x90, 0x95, 0xC3, 0xE0, 0x70, 0x05, +0x90, 0x8A, 0xE5, 0x80, 0x03, 0x90, 0x8A, 0x79, +0x12, 0x8B, 0x46, 0x7F, 0x04, 0x12, 0x04, 0x7E, +0x22, 0xE4, 0xFF, 0x01, 0x19, 0xC0, 0xE0, 0xC0, +0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, +0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, +0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, +0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xA5, 0xF0, +0x74, 0xB8, 0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, +0x30, 0x30, 0xE1, 0x02, 0x51, 0xCB, 0xE5, 0x2D, +0x30, 0xE1, 0x02, 0x11, 0xA1, 0xE5, 0x2D, 0x30, +0xE3, 0x02, 0x71, 0x09, 0xE5, 0x2D, 0x30, 0xE4, +0x02, 0x51, 0xF8, 0xE5, 0x2D, 0x30, 0xE5, 0x02, +0x71, 0x52, 0xE5, 0x2F, 0x30, 0xE0, 0x02, 0x31, +0xBA, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, 0xAB, +0xE0, 0xE5, 0x2F, 0x30, 0xE2, 0x02, 0x51, 0xDF, +0xE5, 0x2F, 0x30, 0xE3, 0x02, 0x31, 0x82, 0xE5, +0x2F, 0x30, 0xE4, 0x02, 0x51, 0x0D, 0xE5, 0x2F, +0x30, 0xE5, 0x02, 0x31, 0xD3, 0xE5, 0x2F, 0x30, +0xE6, 0x03, 0x12, 0xA7, 0x08, 0xE5, 0x2F, 0x30, +0xE7, 0x02, 0x31, 0x9A, 0xE5, 0x30, 0x30, 0xE0, +0x02, 0x31, 0x70, 0xE5, 0x30, 0x30, 0xE4, 0x03, +0x12, 0xB7, 0xA9, 0xE5, 0x30, 0x30, 0xE5, 0x02, +0x31, 0x68, 0x74, 0xA5, 0x04, 0x90, 0x01, 0xC4, +0xF0, 0x74, 0xB8, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, +0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, +0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, +0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, +0x90, 0x8A, 0xDF, 0x31, 0xF4, 0x02, 0x04, 0x7A, +0x31, 0xB3, 0xFF, 0xBF, 0x03, 0x0B, 0x90, 0x93, +0x4A, 0xE0, 0xB4, 0x01, 0x04, 0x12, 0xA7, 0xD1, +0xF0, 0x22, 0x12, 0xAF, 0x92, 0x70, 0x12, 0x90, +0x88, 0x36, 0xE0, 0x60, 0x0C, 0x90, 0x88, 0x3A, +0xE0, 0x20, 0xE4, 0x05, 0x51, 0x2E, 0x12, 0xA7, +0x89, 0x22, 0xE4, 0xF5, 0x77, 0xF5, 0x78, 0xF5, +0x79, 0x31, 0xB3, 0xFF, 0xBF, 0x03, 0x0B, 0x90, +0x93, 0x4A, 0xE0, 0xB4, 0x01, 0x04, 0x12, 0xA7, +0xD1, 0xF0, 0x22, 0x90, 0x01, 0x02, 0xE0, 0x54, +0x03, 0x22, 0x12, 0xAD, 0x2D, 0xE4, 0xFF, 0x51, +0x39, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x02, +0x51, 0x76, 0x90, 0x8B, 0x07, 0x12, 0x88, 0xCD, +0x02, 0x8F, 0xC2, 0xE4, 0xFF, 0x12, 0x78, 0x4A, +0xBF, 0x01, 0x18, 0x90, 0x88, 0x36, 0xE0, 0x60, +0x12, 0x12, 0xA7, 0xE8, 0x64, 0x02, 0x60, 0x08, +0x90, 0x8A, 0xE1, 0x31, 0xF4, 0x02, 0x04, 0x7A, +0x12, 0x73, 0x8F, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, +0xAA, 0x06, 0xF9, 0x22, 0x12, 0xAF, 0x9B, 0x51, +0xC4, 0x7F, 0x01, 0x51, 0x39, 0x90, 0x8B, 0x07, +0x31, 0xF4, 0x02, 0x04, 0x7A, 0x12, 0xAF, 0x92, +0x70, 0x1B, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x15, +0x90, 0x88, 0x3A, 0xE0, 0x20, 0xE4, 0x0E, 0x51, +0x2E, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x51, 0xEB, +0x70, 0x03, 0x12, 0xA6, 0xF0, 0x22, 0x90, 0x01, +0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, +0x28, 0x90, 0x96, 0x33, 0x74, 0x1E, 0xF0, 0x90, +0x96, 0x55, 0x74, 0x01, 0xF0, 0x90, 0x96, 0x35, +0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x33, +0x12, 0xA4, 0x3F, 0x12, 0x04, 0x7E, 0x90, 0x8A, +0xE5, 0x12, 0x8B, 0x46, 0x7F, 0x04, 0x12, 0x04, +0x7E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, +0x0E, 0xE0, 0xFD, 0x7C, 0x00, 0xA3, 0xE0, 0xFE, +0xA3, 0xE0, 0xFF, 0x12, 0x02, 0x92, 0xED, 0x4C, +0x70, 0x05, 0x90, 0x93, 0x1B, 0x80, 0x2A, 0xED, +0x64, 0x01, 0x4C, 0x70, 0x05, 0x90, 0x93, 0x1C, +0x80, 0x1F, 0xED, 0x64, 0x02, 0x4C, 0x70, 0x05, +0x90, 0x93, 0x1D, 0x80, 0x14, 0xED, 0x64, 0x03, +0x4C, 0x70, 0x05, 0x90, 0x93, 0x1E, 0x80, 0x09, +0xED, 0x64, 0x04, 0x4C, 0x70, 0x0D, 0x90, 0x93, +0x1F, 0xE0, 0xFF, 0x51, 0xD5, 0x90, 0x93, 0x0F, +0x12, 0x9F, 0xEF, 0x22, 0x7D, 0x02, 0x7F, 0x02, +0x02, 0x7C, 0x74, 0x90, 0x88, 0x36, 0xE0, 0x60, +0x03, 0x12, 0xA7, 0xBC, 0x22, 0x90, 0x04, 0x24, +0xEF, 0xF0, 0x90, 0x04, 0x57, 0xF0, 0x22, 0x90, +0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, +0xAD, 0xA7, 0x22, 0x54, 0xFB, 0xF0, 0x90, 0x88, +0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x54, 0x07, 0x22, +0x90, 0x8A, 0x75, 0x12, 0x88, 0xCD, 0x90, 0x8A, +0xE5, 0x12, 0x8B, 0x46, 0x7F, 0x02, 0x02, 0x04, +0x7E, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x0B, +0x90, 0x8A, 0xE5, 0x12, 0x8B, 0x46, 0x7F, 0x20, +0x12, 0x04, 0x7E, 0x22, 0x90, 0x88, 0x36, 0xE0, +0x64, 0x01, 0x70, 0x2D, 0x12, 0xA7, 0xE8, 0x60, +0x15, 0x90, 0x8A, 0xB9, 0x12, 0x8B, 0x46, 0xE4, +0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, 0x8B, +0x01, 0x31, 0xF4, 0x02, 0x04, 0x7A, 0x90, 0x88, +0x39, 0xE0, 0x70, 0x0D, 0x90, 0x8A, 0xB9, 0x12, +0x8B, 0x46, 0x7D, 0x01, 0x7F, 0x04, 0x12, 0x04, +0x7E, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, +0xC3, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, +0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, +0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, +0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, +0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, +0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, +0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0xC0, 0xE0, +0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, +0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, +0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, +0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x8E, +0xF0, 0x74, 0xBB, 0xA3, 0xF0, 0x12, 0x75, 0x50, +0xE5, 0x3D, 0x30, 0xE0, 0x02, 0xB1, 0xD5, 0xE5, +0x3D, 0x30, 0xE1, 0x02, 0xD1, 0x3E, 0xE5, 0x3D, +0x30, 0xE2, 0x03, 0x12, 0xA6, 0xD4, 0xE5, 0x3D, +0x30, 0xE4, 0x02, 0x91, 0x64, 0xE5, 0x3E, 0x30, +0xE0, 0x03, 0x12, 0xA9, 0x1D, 0xE5, 0x3E, 0x30, +0xE3, 0x02, 0x91, 0x44, 0xE5, 0x3F, 0x30, 0xE2, +0x09, 0xD1, 0x65, 0x90, 0x07, 0x8F, 0xE0, 0x44, +0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, 0x90, +0x8A, 0xE5, 0x12, 0x8B, 0x46, 0x7F, 0x04, 0x12, +0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x02, 0x31, +0xFC, 0xE5, 0x40, 0x30, 0xE5, 0x02, 0xB1, 0x57, +0xE5, 0x40, 0x30, 0xE6, 0x02, 0xB1, 0x06, 0xE5, +0x40, 0x30, 0xE7, 0x02, 0x91, 0xB5, 0x74, 0x8E, +0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBB, 0xA3, +0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, +0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, +0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, +0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x01, 0x8C, 0xE4, +0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, +0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, +0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, +0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x9D, 0xE0, +0x30, 0xE0, 0x0D, 0xB1, 0xDF, 0x30, 0xE0, 0x08, +0x90, 0x8A, 0xBB, 0x12, 0x8B, 0x46, 0x91, 0xF9, +0xB1, 0xD6, 0x90, 0x96, 0xCE, 0xEF, 0xF0, 0x90, +0x86, 0xB3, 0xE0, 0xB4, 0x02, 0x12, 0x90, 0x96, +0xCE, 0xE0, 0xFF, 0x64, 0x01, 0x60, 0x25, 0x90, +0x01, 0x4D, 0xE0, 0x64, 0x80, 0xF0, 0x80, 0x19, +0x90, 0x01, 0x00, 0x74, 0xFF, 0xF0, 0x7F, 0x64, +0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, 0x06, 0x90, +0xE0, 0x44, 0x01, 0xF0, 0x90, 0x96, 0xCE, 0xE0, +0xFF, 0x12, 0x93, 0xFC, 0x22, 0x90, 0x88, 0xB8, +0xE0, 0x30, 0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, +0x27, 0x90, 0x94, 0xAE, 0x12, 0xAD, 0x26, 0x30, +0xE0, 0x1B, 0x90, 0x88, 0xC2, 0xE0, 0xC4, 0x54, +0x0F, 0x20, 0xE0, 0x08, 0x90, 0x8A, 0xBB, 0x12, +0x8B, 0x46, 0x91, 0xF9, 0x90, 0x94, 0xAE, 0xE0, +0x54, 0xF7, 0xF0, 0x80, 0x06, 0x90, 0x8A, 0x99, +0x12, 0x88, 0xCD, 0x90, 0x88, 0xF0, 0xE0, 0x30, +0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x88, 0xCD, +0x22, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, +0xC2, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x90, 0x88, +0x31, 0xE0, 0xFF, 0x12, 0x8F, 0xF1, 0x30, 0xE0, +0x1E, 0xEF, 0x54, 0x7F, 0xB1, 0xB2, 0x30, 0xE1, +0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, +0x54, 0xFD, 0xB1, 0xBB, 0x04, 0xF0, 0x90, 0x88, +0x36, 0xE0, 0x60, 0x03, 0x12, 0xA6, 0xF0, 0x12, +0x9D, 0xBD, 0x30, 0xE0, 0x21, 0x90, 0x88, 0xA4, +0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x17, 0xEF, +0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, +0x88, 0xA4, 0x30, 0xE1, 0x05, 0xE0, 0x44, 0x04, +0xF0, 0x22, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, +0x94, 0xA1, 0xE0, 0xB4, 0x01, 0x14, 0xE4, 0xF0, +0x90, 0x01, 0x5B, 0xF0, 0x90, 0x92, 0x20, 0xF0, +0x90, 0x88, 0x95, 0xE0, 0xC3, 0x13, 0x54, 0x7F, +0xB1, 0xC7, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0xC4, +0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x32, 0xEF, +0x54, 0xBF, 0xB1, 0xB2, 0x30, 0xE0, 0x06, 0xE0, +0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFE, +0xB1, 0xBB, 0x74, 0x04, 0xF0, 0x90, 0x88, 0xA3, +0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, +0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8B, 0x46, 0x7D, +0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, 0xA6, +0xF0, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, +0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, 0xB9, 0x74, +0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xE0, 0x90, +0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x58, +0x7E, 0x01, 0x02, 0x66, 0x33, 0x22, 0x90, 0x01, +0xC7, 0x74, 0x66, 0xF0, 0xE4, 0xFF, 0x22, 0x90, +0x88, 0xA1, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, +0xEF, 0x64, 0x39, 0x70, 0x46, 0x90, 0x88, 0x9D, +0xE0, 0x30, 0xE0, 0x3F, 0xB1, 0xDF, 0x30, 0xE0, +0x3A, 0x90, 0x88, 0xC2, 0xE0, 0xFF, 0xC4, 0x54, +0x0F, 0x30, 0xE0, 0x2F, 0x90, 0x94, 0xB4, 0xE0, +0x04, 0xF0, 0xD1, 0x34, 0x30, 0xE0, 0x1C, 0xEE, +0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, +0x90, 0x01, 0x63, 0xE4, 0xF0, 0x90, 0x01, 0x3C, +0x74, 0x10, 0xF0, 0xEF, 0x54, 0xEF, 0x90, 0x88, +0xC2, 0xF0, 0x22, 0x90, 0x88, 0xB0, 0xE0, 0x70, +0x02, 0x91, 0xFE, 0x22, 0x90, 0x94, 0xAE, 0xE0, +0xFE, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, 0x88, +0x36, 0xE0, 0x60, 0x03, 0x12, 0xAF, 0x16, 0x02, +0x8A, 0xCF, 0x90, 0x00, 0xAB, 0xE0, 0xFE, 0x90, +0x00, 0xAA, 0x12, 0x9B, 0x42, 0x54, 0x7F, 0x90, +0x95, 0xC1, 0xF0, 0xA3, 0xEF, 0xF0, 0xE0, 0x30, +0xE1, 0x02, 0x91, 0x44, 0x22, 0xD3, 0x10, 0xAF, +0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, +0x30, 0xE0, 0x32, 0x90, 0x88, 0xF7, 0xE0, 0xB4, +0x01, 0x1B, 0xA3, 0xE0, 0xB4, 0x01, 0x26, 0x74, +0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, +0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0x9E, 0x75, +0x12, 0x04, 0x7E, 0x80, 0x10, 0x90, 0x88, 0xF7, +0xE0, 0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, +0x8A, 0xE7, 0x12, 0x88, 0xCD, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, +0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, +0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, +0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, +0x01, 0xC4, 0x74, 0xAA, 0xF0, 0x74, 0xBE, 0xA3, +0xF0, 0x12, 0x6C, 0xD6, 0xE5, 0x25, 0x30, 0xE7, +0x02, 0xD1, 0x4A, 0x74, 0xAA, 0x04, 0x90, 0x01, +0xC4, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0xD0, 0x07, +0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, +0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, +0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, +0x32, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x80, 0xF0, +0x12, 0xC3, 0xD1, 0xF1, 0x85, 0x12, 0x7B, 0x79, +0x91, 0x44, 0xF1, 0x92, 0x7F, 0x01, 0x12, 0x84, +0x15, 0x90, 0x93, 0x49, 0x74, 0x02, 0xF0, 0xFF, +0x12, 0x84, 0x15, 0x90, 0x93, 0x49, 0xE0, 0x04, +0xF0, 0xF1, 0xA4, 0x12, 0xA4, 0xC6, 0x90, 0x00, +0x80, 0xE0, 0x44, 0x40, 0xF0, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, 0xE0, 0xB4, -0xFD, 0x05, 0xE4, 0xFF, 0x12, 0x8C, 0xAC, 0x12, -0x9D, 0xA4, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, -0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0xF1, 0xC8, -0xD1, 0xE3, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, -0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0xE4, 0xFF, -0x02, 0x84, 0x9E, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, -0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4C, 0x12, -0x04, 0x80, 0xF1, 0x6E, 0xF1, 0xC1, 0xBF, 0x01, -0x1C, 0x90, 0x94, 0xBD, 0xE0, 0xFE, 0x54, 0x01, -0x90, 0x93, 0x4C, 0xF0, 0xEE, 0x54, 0x04, 0x90, -0x93, 0x4E, 0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x54, -0x08, 0x90, 0x93, 0x4D, 0xF0, 0xF1, 0x6E, 0x7F, -0xFB, 0x12, 0x8F, 0xE1, 0x70, 0x35, 0x90, 0x94, -0xBD, 0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, -0x7A, 0x94, 0x79, 0xBE, 0x7F, 0xFA, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x94, -0xBE, 0x80, 0x03, 0x90, 0x94, 0xBD, 0xE0, 0x54, -0x07, 0x90, 0x93, 0x50, 0xF0, 0x90, 0x94, 0xBD, -0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, -0x93, 0x4F, 0xF0, 0xF1, 0x6E, 0x7F, 0xFD, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, -0x94, 0xBD, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, -0x3F, 0x90, 0x93, 0x51, 0xF0, 0x22, 0x7B, 0x01, -0x7A, 0x94, 0x79, 0xBD, 0x22, 0x12, 0x7B, 0x1B, -0x90, 0x86, 0xB3, 0xEF, 0xF0, 0xF1, 0x8F, 0x90, +0xFD, 0x05, 0xE4, 0xFF, 0x12, 0x8C, 0x78, 0x12, +0xB4, 0x79, 0x90, 0x00, 0x81, 0xE0, 0x44, 0x04, +0xF0, 0xF1, 0x7B, 0x12, 0x9C, 0xB2, 0x90, 0x00, +0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, +0x80, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x44, 0x10, +0xF0, 0x90, 0x07, 0xDB, 0xE0, 0x44, 0x80, 0xF0, +0x90, 0x06, 0x0D, 0x74, 0xFF, 0xF0, 0xE4, 0xFF, +0x02, 0x84, 0x9E, 0x90, 0x01, 0xE4, 0x74, 0x27, +0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x90, 0x01, 0x94, +0xE0, 0x44, 0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, +0xF0, 0x22, 0xE4, 0x90, 0x86, 0xAF, 0x12, 0xA4, +0x93, 0x90, 0x93, 0x01, 0xF0, 0x90, 0x93, 0x5D, +0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x7B, 0x1B, 0x90, +0x86, 0xB3, 0xEF, 0xF0, 0x12, 0xB7, 0xBD, 0x90, 0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, -0x76, 0x6D, 0x12, 0x75, 0xE0, 0xF1, 0xDF, 0x12, -0xC0, 0x18, 0x75, 0x21, 0x80, 0xE4, 0xF5, 0x22, -0xF5, 0x23, 0x75, 0x24, 0x80, 0xAD, 0x21, 0x7F, -0x50, 0x12, 0x7B, 0x2E, 0xAD, 0x22, 0x7F, 0x51, -0x12, 0x7B, 0x2E, 0xAD, 0x23, 0x7F, 0x52, 0x12, -0x7B, 0x2E, 0xAD, 0x24, 0x7F, 0x53, 0x02, 0x7B, -0x2E, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, 0xA6, -0x90, 0x01, 0xE4, 0x74, 0x1B, 0xF0, 0xA3, 0xE4, -0xF0, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, -0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x75, +0x9F, 0xE9, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, +0x03, 0x02, 0xC0, 0x56, 0xEF, 0x24, 0x39, 0x60, +0x12, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1F, +0xE4, 0x90, 0x94, 0xBC, 0xF0, 0xA3, 0x74, 0x06, +0xF0, 0x80, 0x14, 0x90, 0x94, 0xBC, 0x74, 0x06, +0xF0, 0xA3, 0xF0, 0x80, 0x0A, 0x90, 0x94, 0xBC, +0x74, 0x0C, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x12, +0xC0, 0x6A, 0x12, 0xC0, 0x57, 0x40, 0x1B, 0x90, +0x94, 0xBA, 0xE0, 0x11, 0xD5, 0x7A, 0x94, 0x79, +0xB9, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x07, 0x90, +0x94, 0xB9, 0xE0, 0xF4, 0x70, 0x40, 0x11, 0x5F, +0x80, 0xE0, 0x11, 0x6A, 0x11, 0x57, 0x40, 0x36, +0x90, 0x94, 0xBA, 0xE0, 0xFD, 0x7C, 0x00, 0x24, +0xA8, 0xFF, 0xEC, 0x34, 0x01, 0xFE, 0xED, 0x24, +0x01, 0xFD, 0xEC, 0x33, 0xFC, 0x90, 0x94, 0xBC, +0xE0, 0xFB, 0xC3, 0xED, 0x9B, 0xFD, 0xEC, 0x94, +0x00, 0xFC, 0x90, 0x94, 0xB6, 0x12, 0x86, 0x6D, +0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, 0xFD, +0x11, 0x7B, 0x11, 0x5F, 0x80, 0xC6, 0x22, 0x90, +0x94, 0xBB, 0xE0, 0xD3, 0x94, 0x00, 0x22, 0x90, +0x94, 0xBA, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0x14, +0xF0, 0x22, 0x90, 0x94, 0xBC, 0xE0, 0x90, 0x94, +0xBA, 0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x90, 0x94, +0xBB, 0xF0, 0x22, 0xE4, 0x90, 0x94, 0xBE, 0xF0, +0x90, 0x00, 0x37, 0xE0, 0x44, 0x80, 0xF0, 0x90, +0x00, 0xCF, 0x74, 0x69, 0xF0, 0xEF, 0x90, 0x00, +0x31, 0xF0, 0xEE, 0x54, 0x03, 0xFF, 0xA3, 0xE0, +0x54, 0xFC, 0x4F, 0xF0, 0x90, 0x00, 0x30, 0xED, +0xF0, 0x90, 0x00, 0x33, 0xE0, 0x44, 0x80, 0xF0, +0x90, 0x00, 0x33, 0xE0, 0x30, 0xE7, 0x09, 0x11, +0xCD, 0x50, 0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, +0x90, 0x00, 0xCF, 0xE4, 0xF0, 0x90, 0x00, 0x37, +0xE0, 0x54, 0x7F, 0xF0, 0x11, 0xCD, 0x7F, 0x00, +0x50, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x94, 0xBE, +0xE0, 0xC3, 0x94, 0x64, 0x22, 0x24, 0xA8, 0xFF, +0xE4, 0x34, 0x01, 0xFE, 0x7B, 0x01, 0x22, 0x75, 0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, 0x87, 0x75, 0x2C, 0x33, 0xF5, 0x31, 0xF5, 0x32, 0xF5, 0x33, 0xF5, 0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, @@ -2082,43 +2109,43 @@ u8 array_mp_8723d_fw_ap[] = { 0xF0, 0xA3, 0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, -0x75, 0x39, 0x06, 0x43, 0x39, 0x10, 0x75, 0x3A, +0x75, 0x39, 0x07, 0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, 0x08, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, 0x22, 0x7D, 0x02, 0x90, 0x01, 0xC4, -0x74, 0x43, 0xF0, 0x74, 0xC0, 0xA3, 0xF0, 0x90, +0x74, 0x43, 0xF0, 0x74, 0xC1, 0xA3, 0xF0, 0x90, 0x93, 0x49, 0xE0, 0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0x43, 0x04, 0x90, 0x01, 0xC4, 0xF0, -0x74, 0xC0, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xE4, -0x90, 0x95, 0x19, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, -0x90, 0x95, 0x19, 0xE0, 0x64, 0x01, 0xF0, 0x90, +0x74, 0xC1, 0xA3, 0xF0, 0x7F, 0x01, 0x22, 0xE4, +0x90, 0x95, 0x0E, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, +0x90, 0x95, 0x0E, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0x55, 0xE0, 0x70, 0x18, 0x90, 0x93, 0x52, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, 0x90, -0x95, 0x19, 0xE0, 0x24, 0x7F, 0x90, 0x01, 0xC4, -0xF0, 0x74, 0xC0, 0xA3, 0xF0, 0x12, 0x7C, 0x54, +0x95, 0x0E, 0xE0, 0x24, 0x7F, 0x90, 0x01, 0xC4, +0xF0, 0x74, 0xC1, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, 0x03, -0x12, 0xA6, 0x45, 0xC2, 0xAF, 0x11, 0x43, 0xBF, -0x01, 0x02, 0x31, 0x9F, 0xD2, 0xAF, 0x11, 0xE0, -0x12, 0x97, 0xF4, 0x12, 0x83, 0x4D, 0x80, 0xA8, +0x12, 0xA6, 0xF0, 0xC2, 0xAF, 0x31, 0x43, 0xBF, +0x01, 0x02, 0x51, 0x9F, 0xD2, 0xAF, 0x31, 0xE0, +0x12, 0x97, 0xF8, 0x12, 0x83, 0x4D, 0x80, 0xA8, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x52, 0xE0, 0x60, 0x24, 0x7F, 0x54, 0x7E, -0x09, 0x12, 0x70, 0x70, 0x31, 0x8C, 0x12, 0x04, +0x09, 0x12, 0x70, 0x70, 0x51, 0x8C, 0x12, 0x04, 0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, -0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x31, 0x8C, -0x31, 0x96, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, +0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x51, 0x8C, +0x51, 0x96, 0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, 0x4D, 0xE0, 0x70, 0x29, 0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, -0x90, 0x95, 0x20, 0x74, 0x22, 0xF0, 0x90, 0x95, -0x42, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x22, 0x74, -0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x20, -0x12, 0x8C, 0x91, 0x7F, 0x04, 0x12, 0x04, 0x7E, +0x90, 0x95, 0x15, 0x74, 0x22, 0xF0, 0x90, 0x95, +0x37, 0x74, 0x01, 0xF0, 0x90, 0x95, 0x17, 0x74, +0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x15, +0x12, 0x8B, 0x34, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0x55, 0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x93, 0x52, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, 0xF0, @@ -2128,912 +2155,899 @@ u8 array_mp_8723d_fw_ap[] = { 0x93, 0x52, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x53, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x1C, 0x12, -0x04, 0x31, 0x90, 0x95, 0x1C, 0x22, 0x12, 0x04, +0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, 0x11, 0x12, +0x04, 0x31, 0x90, 0x95, 0x11, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, 0x31, 0x90, -0x88, 0x31, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0x9B, -0xEC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x96, 0x61, 0xEE, 0xF0, 0xA3, 0xEF, -0xF0, 0x12, 0x70, 0x70, 0x90, 0x96, 0x6B, 0x12, -0x04, 0x31, 0x90, 0x96, 0x63, 0x12, 0x04, 0xB8, -0x12, 0x03, 0xCD, 0x90, 0x96, 0x6B, 0x12, 0x86, +0x88, 0x31, 0xE0, 0x30, 0xE0, 0x03, 0x12, 0xB4, +0x1F, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x71, 0x55, 0x90, 0x96, 0xAC, 0x12, 0x04, +0x31, 0x90, 0x96, 0xAC, 0x51, 0x96, 0x51, 0xE2, +0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, +0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, +0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, +0xF0, 0x12, 0xA7, 0xB5, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, +0xAD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x71, 0x55, 0x90, 0x96, 0xB0, 0x12, 0x04, 0x31, +0x90, 0x96, 0xB0, 0x51, 0x96, 0x51, 0xE2, 0x90, +0x8A, 0xFD, 0x12, 0x88, 0xCD, 0x90, 0x06, 0xB7, +0x74, 0x11, 0xF0, 0x7F, 0x03, 0x7E, 0x00, 0x12, +0x7C, 0x6A, 0x90, 0x06, 0xB4, 0xE0, 0x54, 0x0F, +0x70, 0xF1, 0x90, 0x07, 0xD5, 0xE0, 0x44, 0x80, +0xF0, 0x7F, 0x0A, 0x80, 0x09, 0x90, 0x06, 0x62, +0xE0, 0x30, 0xE0, 0x09, 0x7F, 0x01, 0x7E, 0x00, +0x12, 0x7C, 0x6A, 0x80, 0xF0, 0x71, 0x62, 0x90, +0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, +0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, +0xF0, 0x90, 0x07, 0xD5, 0xE0, 0x54, 0x7F, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x30, 0x7E, +0x08, 0x12, 0x70, 0x70, 0xED, 0x44, 0x80, 0xFD, +0xEC, 0x22, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, +0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x96, 0x69, 0xEE, 0xF0, 0xA3, 0xEF, +0xF0, 0x12, 0x70, 0x70, 0x90, 0x96, 0x73, 0x12, +0x04, 0x31, 0x90, 0x96, 0x6B, 0x12, 0x04, 0xB8, +0x12, 0x03, 0xCD, 0x90, 0x96, 0x73, 0x12, 0x86, 0x61, 0x12, 0x86, 0x47, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x63, 0x12, -0x04, 0xB8, 0x90, 0x96, 0x67, 0x12, 0x86, 0x61, +0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x6B, 0x12, +0x04, 0xB8, 0x90, 0x96, 0x6F, 0x12, 0x86, 0x61, 0x12, 0x86, 0x47, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, 0x90, 0x96, -0x6F, 0x12, 0x04, 0x31, 0x90, 0x96, 0x6F, 0x31, -0x96, 0x90, 0x96, 0x61, 0xE0, 0xFE, 0xA3, 0xE0, +0x77, 0x12, 0x04, 0x31, 0x90, 0x96, 0x77, 0x51, +0x96, 0x90, 0x96, 0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x71, 0x42, 0x90, 0x96, 0x89, 0x12, 0x04, 0x31, -0x90, 0x96, 0x89, 0x31, 0x96, 0x51, 0x91, 0x90, -0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, -0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, -0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, -0x90, 0x88, 0x9B, 0x12, 0x8F, 0xDA, 0x30, 0xE0, -0x05, 0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, -0xB8, 0xE0, 0x20, 0xE0, 0x34, 0x12, 0xA7, 0xBF, -0x30, 0xE0, 0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, -0x07, 0xE4, 0x90, 0x96, 0x87, 0xF0, 0x80, 0x06, -0x90, 0x96, 0x87, 0x74, 0x01, 0xF0, 0xEF, 0xC4, -0x13, 0x54, 0x07, 0x90, 0x96, 0x88, 0x30, 0xE0, -0x05, 0x74, 0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, -0xF0, 0x90, 0x96, 0x87, 0x71, 0x39, 0x12, 0xA5, -0xA9, 0x12, 0xB7, 0x5D, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x7F, 0x30, 0x7E, 0x08, 0x02, 0x70, 0xAD, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, -0x42, 0x90, 0x96, 0x8F, 0x12, 0x04, 0x31, 0x90, -0x96, 0x8F, 0x31, 0x96, 0x51, 0x91, 0x90, 0x8A, -0xFD, 0x12, 0x8A, 0x33, 0x90, 0x06, 0xB7, 0x74, -0x11, 0xF0, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, -0x6A, 0x90, 0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, -0xF1, 0x12, 0x9B, 0x94, 0x54, 0xFE, 0x12, 0xB7, -0x65, 0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, -0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, -0x44, 0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0x8F, -0xDA, 0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, -0x9A, 0x12, 0xA7, 0xBF, 0x30, 0xE0, 0x35, 0x90, -0x88, 0xDF, 0xE0, 0x60, 0x08, 0x90, 0x96, 0x8D, -0x74, 0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, -0x8D, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, -0xE0, 0x07, 0xE4, 0x90, 0x96, 0x8E, 0xF0, 0x80, -0x06, 0x90, 0x96, 0x8E, 0x74, 0x02, 0xF0, 0x90, -0x96, 0x8D, 0x71, 0x39, 0x12, 0xA5, 0xA9, 0x7F, -0x01, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, -0x60, 0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, -0xF3, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, -0x70, 0xED, 0x44, 0x80, 0xFD, 0xEC, 0x22, 0x90, -0x88, 0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, -0xF0, 0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, -0x9A, 0x90, 0x88, 0xBE, 0x71, 0x39, 0x12, 0xA5, -0xA9, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x0C, 0x12, -0x8A, 0x30, 0x90, 0x8A, 0xF9, 0x12, 0x8C, 0xA3, -0x12, 0xB0, 0xB3, 0x22, 0x90, 0x8A, 0x79, 0x74, -0x86, 0xF0, 0xA3, 0x74, 0xC2, 0xF0, 0x90, 0x8A, -0xE5, 0x74, 0xC4, 0xF0, 0xA3, 0x74, 0x8B, 0xF0, -0x90, 0x8B, 0x03, 0x74, 0xA0, 0xF0, 0xA3, 0x74, -0x1D, 0xF0, 0x90, 0x8A, 0xB9, 0x74, 0x8A, 0xF0, -0xA3, 0x74, 0x3D, 0xF0, 0x90, 0x8A, 0xD5, 0x74, -0xA9, 0xF0, 0xA3, 0x74, 0xE1, 0xF0, 0x90, 0x8A, -0xFB, 0x74, 0xAB, 0xF0, 0xA3, 0x74, 0x5D, 0xF0, -0x90, 0x8A, 0xA5, 0x74, 0x96, 0xF0, 0xA3, 0x74, -0x06, 0xF0, 0x90, 0x8A, 0xB5, 0x74, 0x87, 0xF0, -0xA3, 0x74, 0x45, 0xF0, 0x90, 0x8A, 0xC3, 0x74, -0xD0, 0xF0, 0xA3, 0x74, 0xB9, 0xF0, 0x90, 0x8A, -0xF3, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0xEA, 0xF0, -0x90, 0x8A, 0x85, 0x74, 0xA6, 0xF0, 0xA3, 0x74, -0x5D, 0xF0, 0x90, 0x86, 0x04, 0x74, 0xD1, 0xF0, -0xA3, 0x74, 0xA0, 0xF0, 0x90, 0x8A, 0xA9, 0x74, -0xC3, 0xF0, 0xA3, 0x74, 0x4F, 0xF0, 0x90, 0x8B, -0x07, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0xF6, 0xF0, -0x90, 0x8A, 0xAD, 0x74, 0x9D, 0xF0, 0xA3, 0x74, -0x2D, 0xF0, 0x90, 0x86, 0x0C, 0x74, 0xC2, 0xF0, -0xA3, 0x74, 0x11, 0xF0, 0x90, 0x8A, 0xEF, 0x74, -0xC2, 0xF0, 0xA3, 0x74, 0x98, 0xF0, 0x90, 0x86, -0x00, 0x74, 0xD9, 0xF0, 0xA3, 0x74, 0x93, 0xF0, -0x90, 0x86, 0x02, 0x74, 0xDA, 0xF0, 0xA3, 0x74, -0x04, 0xF0, 0x90, 0x8A, 0xFD, 0x74, 0xA3, 0xF0, -0xA3, 0x74, 0x65, 0xF0, 0x90, 0x8A, 0xF9, 0x74, -0xC8, 0xF0, 0xA3, 0x74, 0x30, 0xF0, 0x90, 0x8A, -0xDB, 0x74, 0xC9, 0xF0, 0xA3, 0x74, 0x05, 0xF0, -0x90, 0x8A, 0xAF, 0x74, 0xA4, 0xF0, 0xA3, 0x74, -0x8B, 0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xB4, 0xF0, -0xA3, 0x74, 0x70, 0xF0, 0x90, 0x8A, 0xF5, 0x74, -0xDA, 0xF0, 0xA3, 0x74, 0xC1, 0xF0, 0x90, 0x8A, -0xA3, 0x74, 0xB4, 0xF0, 0xA3, 0x74, 0x44, 0xF0, -0x90, 0x86, 0x06, 0x74, 0xC7, 0xF0, 0xA3, 0x74, -0x61, 0xF0, 0x22, 0x8F, 0x0D, 0x7F, 0x02, 0x12, -0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x0D, -0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x01, 0xC4, 0x74, 0x9A, 0xF0, 0x74, 0xC4, 0xA3, -0xF0, 0x12, 0x6C, 0xD6, 0xE5, 0x25, 0x30, 0xE7, -0x02, 0x91, 0xF1, 0x74, 0x9A, 0x04, 0x90, 0x01, -0xC4, 0xF0, 0x74, 0xC4, 0xA3, 0xF0, 0xD0, 0x07, -0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -0x32, 0x90, 0x00, 0xAB, 0xE0, 0xFE, 0x90, 0x00, -0xAA, 0x12, 0x97, 0xE2, 0x54, 0x7F, 0x90, 0x95, -0xCC, 0xF0, 0xA3, 0xEF, 0xF0, 0xE0, 0x30, 0xE1, -0x02, 0xB1, 0x0C, 0x22, 0x90, 0x01, 0x8C, 0xE4, -0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, -0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, -0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, -0x44, 0x04, 0xF0, 0x22, 0x80, 0xDE, 0xC0, 0xE0, -0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, -0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x2E, -0xF0, 0x74, 0xC5, 0xA3, 0xF0, 0x12, 0x75, 0x50, -0xE5, 0x3D, 0x30, 0xE1, 0x03, 0x12, 0xAF, 0xB8, -0xE5, 0x3D, 0x30, 0xE2, 0x03, 0x12, 0xA7, 0x6E, -0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xB1, 0xE0, 0xE5, -0x3E, 0x30, 0xE0, 0x03, 0x12, 0xB0, 0xB9, 0xE5, -0x3E, 0x30, 0xE3, 0x02, 0xB1, 0x2C, 0xE5, 0x3F, -0x30, 0xE2, 0x09, 0xD1, 0x98, 0x90, 0x07, 0x8F, -0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, -0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8C, 0xA3, 0x7F, -0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, -0x03, 0x12, 0x9E, 0xFE, 0xE5, 0x40, 0x30, 0xE5, -0x02, 0xD1, 0x20, 0xE5, 0x40, 0x30, 0xE6, 0x03, -0x12, 0xA5, 0xF3, 0xE5, 0x40, 0x30, 0xE7, 0x02, -0xD1, 0x78, 0x74, 0x2E, 0x04, 0x90, 0x01, 0xC4, -0xF0, 0x74, 0xC5, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, -0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, -0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -0x12, 0x34, 0x78, 0xD1, 0x64, 0x90, 0x96, 0xC4, -0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, -0x12, 0x90, 0x96, 0xC4, 0xE0, 0xFF, 0x64, 0x01, -0x60, 0x25, 0x90, 0x01, 0x4D, 0xE0, 0x64, 0x80, -0xF0, 0x80, 0x19, 0x90, 0x01, 0x00, 0x74, 0xFF, -0xF0, 0x7F, 0x64, 0x7E, 0x00, 0x12, 0x7C, 0x6A, -0x90, 0x06, 0x90, 0xE0, 0x44, 0x01, 0xF0, 0x90, -0x96, 0xC4, 0xE0, 0xFF, 0x12, 0xA9, 0x13, 0x22, -0x90, 0x88, 0x31, 0xD1, 0x5C, 0x30, 0xE0, 0x33, -0xEF, 0x54, 0xBF, 0x12, 0xA7, 0xE1, 0x30, 0xE0, -0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, 0xE0, -0x54, 0xFE, 0xD1, 0x6D, 0x74, 0x04, 0xF0, 0x90, -0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, -0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8C, -0xA3, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, -0x12, 0xA6, 0x45, 0x22, 0xE0, 0xFF, 0xC4, 0x13, -0x13, 0x54, 0x03, 0x22, 0x90, 0x01, 0xC7, 0x74, -0x66, 0xF0, 0xE4, 0xFF, 0x22, 0xF0, 0x90, 0x01, -0xB9, 0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, -0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, 0x05, 0x90, -0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, 0x99, 0x12, -0x8A, 0x33, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, -0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8A, 0x33, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, -0xF7, 0xE0, 0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, -0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, -0x12, 0xA5, 0x2D, 0x80, 0x10, 0x90, 0x88, 0xF7, -0xE0, 0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, -0x8A, 0xE7, 0x12, 0x8A, 0x33, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x01, 0xC4, 0x74, 0xDA, 0xF0, 0x74, 0xC6, 0xA3, -0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x8A, 0x33, 0x53, -0x91, 0xBF, 0x74, 0xDA, 0x04, 0x90, 0x01, 0xC4, -0xF0, 0x74, 0xC6, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, -0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, -0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, -0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, -0x30, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, 0xC7, -0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, -0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, -0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, -0x32, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x94, 0xBE, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -0x90, 0x94, 0xBD, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, -0x12, 0xB7, 0x7A, 0x90, 0x94, 0xC0, 0xF0, 0x12, -0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x90, 0x94, -0xBD, 0xE0, 0x90, 0x04, 0x25, 0xF0, 0x90, 0x94, -0xBE, 0xE0, 0x60, 0x06, 0x12, 0xDC, 0x9A, 0x44, -0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x54, -0xC0, 0xF0, 0x12, 0xDC, 0x9A, 0x54, 0xC0, 0xF0, -0x90, 0x94, 0xC0, 0xE0, 0xFF, 0xAE, 0x05, 0x74, -0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, -0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, 0xAF, -0x05, 0x12, 0xC8, 0x25, 0xE0, 0x54, 0x01, 0xFE, -0x90, 0x94, 0xBF, 0xE0, 0x25, 0xE0, 0x25, 0xE0, -0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x12, 0xC8, -0x25, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, -0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, 0x0D, -0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, 0x05, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, -0x90, 0x94, 0xBD, 0xED, 0xF0, 0x64, 0x01, 0x60, -0x27, 0xE0, 0xFE, 0x64, 0x02, 0x60, 0x21, 0xEE, -0x64, 0x29, 0x60, 0x1C, 0xEE, 0x64, 0x2A, 0x60, -0x17, 0xEE, 0x64, 0x36, 0x60, 0x12, 0xEE, 0xB4, -0x37, 0x02, 0x80, 0x0C, 0xAD, 0x07, 0x7F, 0xFF, -0x12, 0xA5, 0x70, 0x90, 0x93, 0x5E, 0xE0, 0xFF, -0x90, 0x93, 0x5D, 0xE0, 0x4F, 0x90, 0x05, 0x22, -0xF0, 0x90, 0x94, 0xBD, 0xE0, 0x90, 0x93, 0x01, -0xF0, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, -0x90, 0x89, 0x2E, 0x12, 0x86, 0x76, 0x7B, 0xFF, -0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, 0x12, -0x86, 0x76, 0x7A, 0x80, 0x79, 0xBF, 0x90, 0x89, -0x34, 0x12, 0x86, 0x76, 0x7A, 0x81, 0x79, 0x61, -0x90, 0x89, 0x3A, 0x12, 0x86, 0x76, 0x7A, 0x81, -0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, 0x76, -0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, 0x12, -0x86, 0x76, 0x11, 0xFB, 0x7A, 0x81, 0x79, 0xD9, -0x90, 0x89, 0x49, 0x12, 0x86, 0x76, 0x7A, 0x82, -0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, 0x76, -0xE4, 0x90, 0x96, 0x28, 0xF0, 0x90, 0x96, 0x17, -0xF0, 0x90, 0x94, 0xBD, 0xF0, 0x90, 0x94, 0xBD, -0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x0F, 0x74, -0x39, 0x2F, 0x11, 0xF3, 0xE4, 0xF0, 0x90, 0x94, -0xBD, 0xE0, 0x04, 0xF0, 0x80, 0xE7, 0x22, 0x74, -0x39, 0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x96, -0xF5, 0x83, 0x22, 0x7A, 0x81, 0x79, 0xB1, 0x90, -0x89, 0x46, 0x02, 0x86, 0x76, 0xEF, 0x64, 0x13, -0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, 0x88, -0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, 0x04, -0xEF, 0xB4, 0x0A, 0x05, 0x90, 0x88, 0xE4, 0x80, -0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, 0xB4, -0x09, 0x05, 0x90, 0x88, 0xE5, 0x80, 0x03, 0x90, -0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, 0x61, 0x22, -0x90, 0x04, 0x85, 0xE0, 0xF5, 0x6E, 0x90, 0x96, -0x28, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x65, 0x90, -0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x65, 0xC3, 0x9F, -0x40, 0x02, 0xE1, 0xF4, 0xE5, 0x65, 0x12, 0xAB, -0x50, 0xE0, 0xF5, 0x70, 0x12, 0xDC, 0x8E, 0xE0, -0x65, 0x70, 0x60, 0x16, 0x90, 0x92, 0x5E, 0xE5, -0x70, 0xF0, 0xE4, 0xA3, 0xF0, 0xAB, 0x65, 0xFD, -0xFF, 0x12, 0x6F, 0x75, 0x12, 0xDC, 0x8E, 0xE5, -0x70, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x01, -0x70, 0x4C, 0xA3, 0xE0, 0x65, 0x65, 0x70, 0x46, -0xA3, 0xE0, 0xF5, 0x66, 0xA3, 0xE0, 0x90, 0x95, -0x4F, 0xF0, 0xE5, 0x65, 0x12, 0xAB, 0x50, 0xE0, -0x65, 0x66, 0x70, 0x02, 0xE1, 0xF0, 0xE5, 0x65, -0x12, 0xAB, 0x50, 0xE5, 0x66, 0xF0, 0x12, 0xAB, -0xE4, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x95, 0x4F, -0xE0, 0x54, 0x03, 0x4F, 0xFF, 0x12, 0xAB, 0xE4, -0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x66, 0xF0, -0xA3, 0x74, 0xFF, 0xF0, 0xAB, 0x65, 0xE4, 0xFD, -0xFF, 0x12, 0x6F, 0x75, 0xE1, 0xF0, 0x74, 0xAD, -0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, -0x83, 0xE0, 0xFB, 0x7A, 0x00, 0x75, 0xF0, 0x12, -0xE5, 0x65, 0x90, 0x89, 0x55, 0x12, 0x04, 0x6E, -0xE0, 0xC3, 0x9B, 0xFE, 0xE4, 0x9A, 0x90, 0x95, -0x47, 0xF0, 0xA3, 0xCE, 0xF0, 0x75, 0xF0, 0x12, -0xE5, 0x65, 0x12, 0xBC, 0x8B, 0xE0, 0xFE, 0xA3, -0xE0, 0xC3, 0x9B, 0xF5, 0x6C, 0xEE, 0x9A, 0xF5, -0x6B, 0xAF, 0x65, 0x12, 0x78, 0x4A, 0xEF, 0x70, -0x02, 0xE1, 0xF0, 0x75, 0xF0, 0x12, 0xE5, 0x65, -0x12, 0x87, 0xC6, 0x12, 0x94, 0xA8, 0x30, 0xE0, -0x02, 0xE1, 0xF0, 0xE5, 0x65, 0x13, 0x13, 0x13, -0x54, 0x1F, 0x12, 0xAC, 0x1C, 0xE0, 0xFD, 0x7C, -0x00, 0xE5, 0x65, 0x12, 0x9B, 0xA2, 0x80, 0x05, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x02, -0xE1, 0xF0, 0xE5, 0x6C, 0x45, 0x6B, 0x70, 0x0C, -0x90, 0x95, 0x47, 0xE0, 0x70, 0x02, 0xA3, 0xE0, -0x70, 0x02, 0xE1, 0xF0, 0xE5, 0x65, 0x75, 0xF0, -0x12, 0xA4, 0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, -0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x95, 0x44, 0x12, -0x86, 0x76, 0x12, 0xDC, 0xF5, 0x12, 0x03, 0x13, -0x2F, 0xFF, 0x12, 0xDC, 0x4B, 0x2F, 0xFF, 0x90, -0x00, 0x06, 0x12, 0x03, 0x3E, 0x2F, 0xFF, 0x12, -0xDC, 0x36, 0x2F, 0xF5, 0x6F, 0xE5, 0x65, 0x12, -0xAB, 0x50, 0xE0, 0xF5, 0x66, 0x54, 0x80, 0xF5, -0x68, 0xE5, 0x66, 0x54, 0x7F, 0xF5, 0x67, 0x90, -0x96, 0x16, 0xE0, 0x60, 0x12, 0x75, 0x71, 0x0A, -0x12, 0xDC, 0x09, 0xE4, 0x93, 0xC3, 0x13, 0x74, -0x01, 0x93, 0x13, 0xF5, 0x72, 0x80, 0x09, 0x7B, -0xFF, 0x11, 0xFB, 0xE4, 0xF5, 0x71, 0xF5, 0x72, -0x75, 0xF0, 0x12, 0xE5, 0x65, 0x12, 0xAE, 0x10, -0xFF, 0xE5, 0x67, 0xD3, 0x9F, 0x40, 0x08, 0x8F, -0x67, 0xE5, 0x67, 0x45, 0x68, 0xF5, 0x66, 0x12, -0xDB, 0x8D, 0xE0, 0xC3, 0x94, 0x05, 0x40, 0x02, -0x81, 0x71, 0xE5, 0x67, 0x90, 0x81, 0x61, 0x93, -0xF5, 0x6D, 0xFD, 0xAF, 0x67, 0x12, 0x60, 0x6F, -0x8F, 0x6D, 0xE5, 0x68, 0x60, 0x04, 0x05, 0x6D, -0x05, 0x6D, 0xE5, 0x67, 0xC3, 0x94, 0x0C, 0x40, -0x1D, 0x74, 0x18, 0x25, 0x65, 0x12, 0x87, 0x9B, -0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, 0x30, 0xE7, -0x06, 0xE5, 0x6D, 0x2E, 0xFF, 0x80, 0x05, 0xC3, -0xE5, 0x6D, 0x9E, 0xFF, 0x8F, 0x6D, 0xE5, 0x6D, -0xD3, 0x94, 0x1A, 0xAF, 0x6D, 0x40, 0x02, 0x7F, -0x1A, 0x8F, 0x6D, 0xE5, 0x66, 0x90, 0x81, 0xD9, -0x93, 0xFF, 0xD3, 0x90, 0x95, 0x48, 0xE0, 0x9F, -0x90, 0x95, 0x47, 0xE0, 0x94, 0x00, 0x40, 0x02, -0x81, 0x24, 0xC3, 0xE5, 0x6C, 0x94, 0x0A, 0xE5, -0x6B, 0x94, 0x00, 0x40, 0x02, 0x61, 0xD3, 0x11, -0xEF, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x05, 0x11, -0xEF, 0xE0, 0x14, 0xF0, 0x12, 0xDC, 0x30, 0xFF, -0x90, 0x95, 0x48, 0xE0, 0x2F, 0xFF, 0x90, 0x95, -0x47, 0xE0, 0x12, 0xDB, 0xCD, 0x12, 0xDC, 0x4A, -0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6B, -0xC3, 0x13, 0xFE, 0xE5, 0x6C, 0x13, 0xFF, 0xD3, -0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x0D, 0xE5, 0x65, -0x94, 0x05, 0x50, 0x05, 0x11, 0xEF, 0x74, 0x03, -0xF0, 0x81, 0x24, 0x12, 0xDC, 0xC4, 0x12, 0x03, -0x13, 0x65, 0x6F, 0x70, 0x02, 0xE5, 0xF0, 0x70, -0x2D, 0xE5, 0x65, 0xC3, 0x94, 0x05, 0x50, 0x0A, -0x11, 0xEF, 0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, -0x80, 0x07, 0xE5, 0x6F, 0xC3, 0x94, 0x03, 0x50, -0x09, 0x7D, 0x06, 0xAF, 0x65, 0x12, 0xBC, 0x5A, -0xE1, 0xF0, 0xE4, 0xFD, 0xAF, 0x65, 0x12, 0xAC, -0x69, 0x12, 0xBC, 0x56, 0xC1, 0x6B, 0x12, 0xBB, -0x97, 0xC1, 0x6B, 0x11, 0xEF, 0xE4, 0xF0, 0x90, -0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, 0x6D, 0xAD, -0x65, 0xAF, 0x6C, 0xAE, 0x6B, 0x12, 0x41, 0x9C, -0x8E, 0x69, 0x8F, 0x6A, 0x12, 0xDC, 0x09, 0xC3, -0x74, 0x01, 0x93, 0x95, 0x72, 0xFF, 0xE4, 0x93, -0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x6A, 0x9F, 0xE5, -0x69, 0x9E, 0x40, 0x0E, 0x12, 0xDB, 0xA5, 0xE4, -0xF0, 0x7D, 0x01, 0xAF, 0x65, 0x12, 0xAC, 0x69, -0xC1, 0x6B, 0x12, 0xDD, 0x04, 0xC3, 0xE5, 0x6A, -0x9F, 0xE5, 0x69, 0x94, 0x00, 0x50, 0x0E, 0x12, -0xDB, 0xA5, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x65, -0x12, 0xAD, 0x57, 0xC1, 0x6B, 0x12, 0xBC, 0x56, -0x12, 0xDB, 0xA5, 0xE0, 0x04, 0xF0, 0xE5, 0x67, -0x90, 0x81, 0xED, 0x93, 0x25, 0x71, 0xFF, 0xE4, -0x33, 0xFE, 0x12, 0xDB, 0xA5, 0xE0, 0xC3, 0x9F, -0xEE, 0x12, 0xB5, 0x4D, 0x50, 0x02, 0xC1, 0x6B, -0x12, 0xDB, 0xA5, 0xE4, 0xF0, 0x12, 0xDD, 0x04, -0x12, 0xDC, 0x09, 0x74, 0x01, 0x93, 0x2F, 0xFF, +0x22, 0x90, 0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, +0x74, 0xC6, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xC4, +0xF0, 0xA3, 0x74, 0xFE, 0xF0, 0x90, 0x8B, 0x03, +0x74, 0xA0, 0xF0, 0xA3, 0x74, 0x20, 0xF0, 0x90, +0x8A, 0xB9, 0x74, 0x88, 0xF0, 0xA3, 0x74, 0xD7, +0xF0, 0x90, 0x8A, 0xD5, 0x74, 0x91, 0xF0, 0xA3, +0x74, 0xE4, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0x90, +0xF0, 0xA3, 0x74, 0x55, 0xF0, 0x90, 0x8A, 0xA5, +0x74, 0x96, 0xF0, 0xA3, 0x74, 0x54, 0xF0, 0x90, +0x8A, 0xB5, 0x74, 0xC5, 0xF0, 0xA3, 0x74, 0xEE, +0xF0, 0x90, 0x8A, 0x75, 0x74, 0xB4, 0xF0, 0xA3, +0x74, 0xCB, 0xF0, 0x90, 0x8A, 0xC1, 0x74, 0x8B, +0xF0, 0xA3, 0x74, 0x4F, 0xF0, 0x90, 0x8A, 0xC3, +0x74, 0xD1, 0xF0, 0xA3, 0x74, 0x16, 0xF0, 0x90, +0x8A, 0xF3, 0x74, 0xD1, 0xF0, 0xA3, 0x74, 0x56, +0xF0, 0x90, 0x8A, 0x85, 0x74, 0xD2, 0xF0, 0xA3, +0x74, 0x31, 0xF0, 0x90, 0x86, 0x04, 0x74, 0xBD, +0xF0, 0xA3, 0x74, 0xE8, 0xF0, 0x90, 0x8A, 0xA9, +0x74, 0xD1, 0xF0, 0xA3, 0x74, 0x62, 0xF0, 0x90, +0x8B, 0x07, 0x74, 0xD1, 0xF0, 0xA3, 0x74, 0x87, +0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xA5, 0xF0, 0xA3, +0x74, 0xAE, 0xF0, 0x90, 0x8A, 0xBB, 0x74, 0xD2, +0xF0, 0xA3, 0x74, 0x8B, 0xF0, 0x90, 0x86, 0x0C, +0x74, 0xC2, 0xF0, 0xA3, 0x74, 0xAA, 0xF0, 0x90, +0x8A, 0xEF, 0x74, 0xC2, 0xF0, 0xA3, 0x74, 0xE9, +0xF0, 0x90, 0x86, 0x00, 0x74, 0xDA, 0xF0, 0xA3, +0x74, 0x1C, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xDA, +0xF0, 0xA3, 0x74, 0x91, 0xF0, 0x90, 0x8A, 0xFD, +0x74, 0x9D, 0xF0, 0xA3, 0x74, 0x44, 0xF0, 0x90, +0x8A, 0xF9, 0x74, 0xC5, 0xF0, 0xA3, 0x74, 0x94, +0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xC7, 0xF0, 0xA3, +0x74, 0x81, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0x9D, +0xF0, 0xA3, 0x74, 0xC7, 0xF0, 0x90, 0x8A, 0xD3, +0x74, 0xCE, 0xF0, 0xA3, 0x74, 0xD6, 0xF0, 0x90, +0x8A, 0xF5, 0x74, 0xDC, 0xF0, 0xA3, 0x74, 0x03, +0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xAB, 0xF0, 0xA3, +0x74, 0xB4, 0xF0, 0x90, 0x86, 0x06, 0x74, 0x9E, +0xF0, 0xA3, 0x74, 0xF3, 0xF0, 0x22, 0x8F, 0x0D, +0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, +0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, +0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, +0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, +0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, +0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x0D, 0xF0, +0x74, 0xC5, 0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, +0x88, 0xCD, 0x53, 0x91, 0xBF, 0x74, 0x0D, 0x04, +0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC5, 0xA3, 0xF0, +0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, +0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, +0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, +0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, +0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, +0xC0, 0x07, 0x7D, 0x63, 0x90, 0x01, 0xC4, 0xED, +0xF0, 0x74, 0xC5, 0xFF, 0xA3, 0xF0, 0xED, 0x04, +0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, +0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, +0x83, 0xD0, 0xE0, 0x32, 0x90, 0x96, 0xCB, 0xED, +0xF0, 0x64, 0x01, 0x60, 0x27, 0xE0, 0xFE, 0x64, +0x02, 0x60, 0x21, 0xEE, 0x64, 0x29, 0x60, 0x1C, +0xEE, 0x64, 0x2A, 0x60, 0x17, 0xEE, 0x64, 0x36, +0x60, 0x12, 0xEE, 0xB4, 0x37, 0x02, 0x80, 0x0C, +0xAD, 0x07, 0x7F, 0xFF, 0x12, 0x9F, 0xBF, 0x90, +0x93, 0x5E, 0xE0, 0xFF, 0x90, 0x93, 0x5D, 0xE0, +0x4F, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x96, 0xCB, +0xE0, 0x90, 0x93, 0x01, 0xF0, 0x22, 0xE6, 0xFD, +0xAF, 0x62, 0xEF, 0x12, 0x93, 0xEF, 0xE0, 0x54, +0xF8, 0xF5, 0x70, 0xED, 0x42, 0x70, 0xEF, 0x12, +0x93, 0xEF, 0xE5, 0x70, 0xF0, 0x22, 0x12, 0x02, +0x06, 0xFE, 0x12, 0x87, 0xEA, 0xFF, 0x74, 0xD6, +0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0x12, 0x87, +0xF0, 0xFF, 0x74, 0xC6, 0x2E, 0xF5, 0x82, 0xE4, +0x34, 0x8D, 0x12, 0x87, 0xFA, 0xFF, 0x74, 0x0D, +0x2E, 0xD1, 0x37, 0xEF, 0xF0, 0x74, 0xC6, 0x2E, +0x12, 0x97, 0xD4, 0xE0, 0x30, 0xE5, 0x17, 0x75, +0xF0, 0x12, 0xEE, 0x12, 0x94, 0xEE, 0x13, 0x13, +0x54, 0x03, 0xFB, 0xAF, 0x06, 0x74, 0xD6, 0x2E, +0xD1, 0x43, 0xFD, 0x12, 0x6B, 0xFD, 0x22, 0xF5, +0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x74, +0xD6, 0x25, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x8D, +0xF5, 0x83, 0xE0, 0x22, 0xE4, 0xF5, 0x75, 0xEF, +0x14, 0xF5, 0x74, 0xED, 0xFF, 0xE5, 0x74, 0xF5, +0x82, 0x33, 0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, +0x82, 0x9F, 0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, +0x40, 0x52, 0xE5, 0x74, 0x78, 0x03, 0xA2, 0xE7, +0x13, 0xD8, 0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, +0xEB, 0x12, 0x97, 0xDC, 0xE5, 0x82, 0x2F, 0xF5, +0x82, 0xE5, 0x83, 0x3E, 0xF5, 0x83, 0xE0, 0xF5, +0x82, 0x75, 0x83, 0x00, 0xE5, 0x74, 0x12, 0xB1, +0x70, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, +0xD8, 0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, +0x55, 0x82, 0x4E, 0x60, 0x13, 0x85, 0x74, 0x76, +0x05, 0x75, 0x90, 0x95, 0x4C, 0xE0, 0x65, 0x75, +0x60, 0x0A, 0xE5, 0x76, 0xD3, 0x9D, 0x40, 0x04, +0x15, 0x74, 0x80, 0x97, 0xAF, 0x76, 0x22, 0xAA, +0x07, 0xA9, 0x05, 0xEA, 0x12, 0x90, 0xDE, 0xE0, +0xF5, 0x70, 0x54, 0x7F, 0xF5, 0x72, 0x75, 0xF0, +0x12, 0xEA, 0x12, 0x97, 0xCA, 0xE0, 0x90, 0x95, +0x48, 0xF0, 0x75, 0xF0, 0x12, 0xEA, 0x12, 0x97, +0xBF, 0xFF, 0xEA, 0x12, 0x90, 0x48, 0xE0, 0x54, +0x03, 0xF5, 0x71, 0xE5, 0x72, 0x90, 0x81, 0x9D, +0x93, 0xFD, 0xEA, 0x25, 0xE0, 0x24, 0x75, 0xF5, +0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE4, 0xF0, +0xA3, 0xED, 0xF0, 0x75, 0xF0, 0x12, 0xEA, 0x12, +0x94, 0xEE, 0xFE, 0xC4, 0x54, 0x03, 0x90, 0x95, +0x47, 0xF0, 0x74, 0xC6, 0x2A, 0x12, 0x94, 0xE1, +0xE5, 0x72, 0xF0, 0x74, 0x46, 0x2A, 0xF1, 0x79, +0xE5, 0x71, 0xF0, 0xE5, 0x72, 0xD3, 0x9F, 0x40, +0x04, 0x8F, 0x72, 0x8F, 0x70, 0x89, 0x73, 0xE4, +0xFF, 0xEF, 0xC3, 0x95, 0x73, 0x50, 0x33, 0xE5, +0x70, 0x30, 0xE7, 0x09, 0x85, 0x72, 0x70, 0x19, +0xE9, 0x70, 0x24, 0x80, 0x25, 0x90, 0x95, 0x48, +0xE0, 0xFD, 0xE5, 0x72, 0xD3, 0x9D, 0x40, 0x0F, +0xAB, 0x02, 0x90, 0x95, 0x4C, 0xE9, 0xF0, 0xAF, +0x72, 0xD1, 0x4C, 0x8F, 0x70, 0x80, 0x0B, 0x90, +0x95, 0x48, 0xE0, 0xF5, 0x70, 0x80, 0x03, 0x0F, +0x80, 0xC7, 0xAF, 0x02, 0x90, 0x92, 0x80, 0xE5, +0x71, 0xF0, 0xE4, 0xFB, 0xAD, 0x70, 0x02, 0x75, +0x80, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, +0x22, 0xEF, 0x64, 0x13, 0x60, 0x04, 0xEF, 0xB4, +0x0B, 0x05, 0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, +0x64, 0x12, 0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, +0x90, 0x88, 0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, +0x60, 0x04, 0xEF, 0xB4, 0x09, 0x05, 0x90, 0x88, +0xE5, 0x80, 0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, +0x0F, 0xAF, 0x0F, 0x22, 0x90, 0x04, 0x85, 0xE0, +0xF5, 0x6B, 0x90, 0x96, 0x1D, 0xE0, 0x04, 0xF0, +0xE4, 0xF5, 0x62, 0x90, 0x88, 0x2B, 0xE0, 0xFF, +0xE5, 0x62, 0xC3, 0x9F, 0x40, 0x03, 0x02, 0xCE, +0x36, 0xE5, 0x62, 0x12, 0x90, 0xDE, 0xE0, 0xF5, +0x6D, 0x12, 0xDD, 0x33, 0xF5, 0x83, 0xE0, 0x65, +0x6D, 0x60, 0x18, 0x90, 0x92, 0x5E, 0xE5, 0x6D, +0xF0, 0xE4, 0xA3, 0xF0, 0xAB, 0x62, 0xFD, 0xFF, +0x12, 0x6F, 0x75, 0x12, 0xDD, 0x33, 0xF5, 0x83, +0xE5, 0x6D, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0x64, +0x01, 0x70, 0x50, 0xA3, 0xE0, 0x65, 0x62, 0x70, +0x4A, 0xA3, 0xE0, 0xF5, 0x63, 0xA3, 0xE0, 0x90, +0x95, 0x44, 0xF0, 0xE5, 0x62, 0x12, 0x90, 0xDE, +0xE0, 0x65, 0x63, 0x70, 0x02, 0xC1, 0x31, 0xE5, +0x62, 0x12, 0x90, 0xDE, 0xE5, 0x63, 0xF0, 0xE5, +0x62, 0x12, 0x90, 0x48, 0xE0, 0x54, 0xFC, 0xFF, +0x90, 0x95, 0x44, 0xE0, 0x54, 0x03, 0x4F, 0xFF, +0xE5, 0x62, 0x12, 0x90, 0x48, 0xEF, 0xF0, 0x90, +0x92, 0x5E, 0xE5, 0x63, 0xF0, 0xA3, 0x74, 0xFF, +0xF0, 0xAB, 0x62, 0xE4, 0xFD, 0xFF, 0x12, 0x6F, +0x75, 0xC1, 0x31, 0x75, 0xF0, 0x12, 0xE5, 0x62, +0x12, 0xB7, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x3C, +0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x12, +0xE5, 0x62, 0x90, 0x89, 0x53, 0x12, 0x04, 0x6E, +0xE0, 0xF5, 0x68, 0xA3, 0xE0, 0xF5, 0x69, 0xE5, +0x62, 0x75, 0xF0, 0x12, 0xA4, 0x24, 0x57, 0xF9, +0x74, 0x89, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, +0x95, 0x39, 0x12, 0x86, 0x76, 0xD1, 0x94, 0xFF, +0x12, 0x03, 0x13, 0x2F, 0xFF, 0xD1, 0x9A, 0x2F, +0xFF, 0xD1, 0x83, 0x2F, 0xFF, 0xD1, 0x7A, 0x2F, +0xF5, 0x6C, 0xE5, 0x62, 0x12, 0x90, 0xDE, 0xE0, +0xF5, 0x63, 0x54, 0x80, 0xF5, 0x65, 0xE5, 0x63, +0x54, 0x7F, 0xF5, 0x64, 0x75, 0xF0, 0x12, 0xE5, +0x62, 0x12, 0xB7, 0x10, 0xE0, 0x64, 0x01, 0x60, +0x02, 0x41, 0x12, 0xD1, 0x37, 0xD1, 0x94, 0xFF, +0xAE, 0xF0, 0x12, 0x03, 0x13, 0x2F, 0xFF, 0xE5, +0xF0, 0x3E, 0xFE, 0xD1, 0x9A, 0x2F, 0xFF, 0xEE, +0xD1, 0x80, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, +0xD1, 0x7A, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, +0x95, 0x3E, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x03, +0x13, 0xFF, 0xC3, 0x90, 0x95, 0x3F, 0xE0, 0x9F, +0xFE, 0x90, 0x95, 0x3E, 0xE0, 0x95, 0xF0, 0x90, +0x95, 0x40, 0xF0, 0xA3, 0xCE, 0xF0, 0xD1, 0x83, +0xFD, 0xAC, 0xF0, 0x25, 0xE0, 0xFF, 0xEC, 0x33, +0xFE, 0xEF, 0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0xD1, +0x9A, 0x25, 0xE0, 0xFF, 0xE5, 0xF0, 0x33, 0xFE, +0xD1, 0x94, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xCF, +0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0xD1, 0x37, 0xD1, +0x7A, 0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, 0xCE, +0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, 0xEC, 0x3E, +0x90, 0x95, 0x42, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, +0x95, 0x3C, 0xD1, 0xC5, 0xF1, 0xB8, 0x34, 0x8E, +0xD1, 0x89, 0x9E, 0x50, 0x07, 0x90, 0x95, 0x3C, +0xD1, 0xAB, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, +0xE5, 0x62, 0xF1, 0xB8, 0x34, 0x8E, 0x12, 0x91, +0xDC, 0x90, 0x95, 0x3E, 0xD1, 0xC5, 0xF1, 0xC0, +0x34, 0x8E, 0xD1, 0x89, 0x9E, 0x50, 0x07, 0x90, +0x95, 0x3E, 0xD1, 0xAB, 0x80, 0x04, 0x7E, 0xFF, +0x7F, 0xFF, 0xE5, 0x62, 0xF1, 0xC0, 0x34, 0x8E, +0x12, 0x91, 0xDC, 0x90, 0x95, 0x42, 0xD1, 0xC5, +0xF1, 0xC8, 0x34, 0x8E, 0xD1, 0x89, 0x9E, 0x50, +0x07, 0x90, 0x95, 0x42, 0xD1, 0xAB, 0x80, 0x04, +0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x62, 0xF1, 0xC8, +0x34, 0x8E, 0x12, 0x91, 0xDC, 0xC3, 0x74, 0xFF, +0x95, 0x69, 0xFF, 0x74, 0xFF, 0x95, 0x68, 0xFE, +0x12, 0xDD, 0x29, 0x34, 0x8E, 0xD1, 0x89, 0x9E, +0x50, 0x0A, 0xE5, 0x69, 0x2D, 0xFF, 0xE5, 0x68, +0x3C, 0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, +0x12, 0xDD, 0x29, 0x34, 0x8E, 0x12, 0x91, 0xDC, +0xF1, 0xD8, 0xFB, 0xC3, 0x74, 0xFF, 0x9B, 0xFF, +0x74, 0xFF, 0x9E, 0xFE, 0x74, 0xFF, 0x94, 0x00, +0xFD, 0x74, 0xFF, 0x94, 0x00, 0xFC, 0x90, 0x8D, +0x71, 0xF1, 0xE9, 0x50, 0x11, 0xF1, 0xD8, 0xFF, +0xE4, 0xFC, 0xFD, 0x90, 0x8D, 0x71, 0x12, 0x86, +0x61, 0x12, 0x86, 0x2C, 0x80, 0x06, 0x74, 0xFF, +0xFF, 0xFE, 0xFD, 0xFC, 0x90, 0x8D, 0x71, 0x12, +0x04, 0x31, 0xAF, 0x62, 0x12, 0x78, 0x4A, 0xEF, +0x70, 0x02, 0xC1, 0x31, 0x75, 0xF0, 0x12, 0xE5, +0x62, 0x12, 0x94, 0xEE, 0x12, 0x8F, 0xF1, 0x30, +0xE0, 0x02, 0xC1, 0x31, 0xE5, 0x62, 0x13, 0x13, +0x13, 0x54, 0x1F, 0x12, 0x94, 0xD3, 0xE0, 0xFD, +0x7C, 0x00, 0xE5, 0x62, 0x12, 0xB1, 0x70, 0x80, +0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, +0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, +0x02, 0xC1, 0x31, 0xE5, 0x69, 0x45, 0x68, 0x70, +0x0C, 0x90, 0x95, 0x3C, 0xE0, 0x70, 0x02, 0xA3, +0xE0, 0x70, 0x02, 0xC1, 0x31, 0x90, 0x96, 0x0B, +0xE0, 0x60, 0x11, 0x75, 0x6E, 0x0A, 0xD1, 0xB7, +0xE4, 0x93, 0xC3, 0x13, 0x74, 0x01, 0x93, 0x13, +0xF5, 0x6F, 0x80, 0x0A, 0x7B, 0xFF, 0x12, 0xB1, +0x66, 0xE4, 0xF5, 0x6E, 0xF5, 0x6F, 0x75, 0xF0, +0x12, 0xE5, 0x62, 0x12, 0x97, 0xBF, 0xFF, 0xE5, +0x64, 0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x64, 0xE5, +0x64, 0x45, 0x65, 0xF5, 0x63, 0xD1, 0x3D, 0xE0, +0xC3, 0x94, 0x05, 0x40, 0x02, 0x81, 0x21, 0xE5, +0x64, 0x90, 0x81, 0x61, 0x93, 0xF5, 0x6A, 0xFD, +0xAF, 0x64, 0x12, 0x60, 0x6F, 0x8F, 0x6A, 0xE5, +0x65, 0x60, 0x04, 0x05, 0x6A, 0x05, 0x6A, 0xE5, +0x64, 0xC3, 0x94, 0x0C, 0x40, 0x1D, 0x74, 0x0D, +0x25, 0x62, 0x12, 0xC6, 0x37, 0xE0, 0xFF, 0x54, +0x7F, 0xFE, 0xEF, 0x30, 0xE7, 0x06, 0xE5, 0x6A, +0x2E, 0xFF, 0x80, 0x05, 0xC3, 0xE5, 0x6A, 0x9E, +0xFF, 0x8F, 0x6A, 0xE5, 0x6A, 0xD3, 0x94, 0x1A, +0xAF, 0x6A, 0x40, 0x02, 0x7F, 0x1A, 0x8F, 0x6A, +0xE5, 0x63, 0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, +0x90, 0x95, 0x3D, 0xE0, 0x9F, 0x90, 0x95, 0x3C, +0xE0, 0x94, 0x00, 0x40, 0x02, 0x61, 0xDA, 0xC3, +0xE5, 0x69, 0x94, 0x0A, 0xE5, 0x68, 0x94, 0x00, +0x50, 0x7A, 0x12, 0xB1, 0x5A, 0xE0, 0xC3, 0x94, +0x01, 0x40, 0x06, 0x12, 0xB1, 0x5A, 0xE0, 0x14, +0xF0, 0xD1, 0x37, 0xD1, 0x7A, 0xFF, 0x90, 0x95, +0x3D, 0xE0, 0x2F, 0xFF, 0x90, 0x95, 0x3C, 0xE0, +0xD1, 0x80, 0x2F, 0xFD, 0xEE, 0x35, 0xF0, 0xFC, +0xE5, 0x68, 0xC3, 0x13, 0xFE, 0xE5, 0x69, 0x13, +0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, 0x0E, +0xE5, 0x62, 0x94, 0x05, 0x50, 0x06, 0x12, 0xB1, +0x5A, 0x74, 0x02, 0xF0, 0x61, 0xDA, 0xD1, 0x37, +0x12, 0x03, 0x13, 0x65, 0x6C, 0x70, 0x02, 0xE5, +0xF0, 0x70, 0x25, 0xE5, 0x62, 0xC3, 0x94, 0x05, +0x50, 0x12, 0x12, 0xB1, 0x5A, 0xE0, 0xD3, 0x94, +0x00, 0x40, 0x09, 0x7D, 0x06, 0xAF, 0x62, 0x12, +0xB7, 0x4E, 0xC1, 0x31, 0xE4, 0xFD, 0xAF, 0x62, +0x12, 0x90, 0xF8, 0x12, 0xB7, 0x4A, 0xC1, 0x16, +0xF1, 0xAA, 0xC1, 0x16, 0x12, 0xB1, 0x5A, 0xE4, +0xF0, 0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, +0x6A, 0xAD, 0x62, 0xAF, 0x69, 0xAE, 0x68, 0x12, +0x41, 0x9C, 0x8E, 0x66, 0x8F, 0x67, 0xD1, 0xB7, +0xC3, 0x74, 0x01, 0x93, 0x95, 0x6F, 0xFF, 0xE4, +0x93, 0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x67, 0x9F, +0xE5, 0x66, 0x9E, 0x40, 0x0D, 0xD1, 0x55, 0xE4, +0xF0, 0x7D, 0x01, 0xAF, 0x62, 0x12, 0x90, 0xF8, +0xC1, 0x16, 0xF1, 0xD0, 0xC3, 0xE5, 0x67, 0x9F, +0xE5, 0x66, 0x94, 0x00, 0x50, 0x0D, 0xD1, 0x55, +0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x62, 0x12, 0xC6, +0xBF, 0xC1, 0x16, 0x12, 0xB7, 0x4A, 0xD1, 0x55, +0xE0, 0x04, 0xF0, 0xE5, 0x64, 0x90, 0x81, 0xED, +0x93, 0x25, 0x6E, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, +0x55, 0xE0, 0xC3, 0x9F, 0xEE, 0xD1, 0xA4, 0x50, +0x02, 0xC1, 0x16, 0xD1, 0x55, 0xE4, 0xF0, 0xF1, +0xD0, 0xD1, 0xB7, 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, 0x34, 0x00, 0xC3, 0x13, 0xFE, 0xEF, -0x13, 0xFF, 0xE5, 0x65, 0x12, 0xAD, 0x46, 0xC1, -0x6B, 0x12, 0xDB, 0x8D, 0xE0, 0x64, 0x05, 0x60, -0x02, 0xA1, 0x3E, 0x90, 0x04, 0xA0, 0xE0, 0x64, -0x02, 0x70, 0x11, 0x12, 0xDB, 0x4C, 0xE4, 0xF0, -0x90, 0x04, 0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, -0xAE, 0x29, 0xC1, 0x81, 0xAD, 0x67, 0xAF, 0x65, -0x12, 0x72, 0xEE, 0x12, 0xDC, 0x82, 0xEF, 0xF0, -0x12, 0xAB, 0x32, 0xE0, 0x54, 0x07, 0x78, 0x88, -0xF6, 0x12, 0x87, 0xCE, 0xFF, 0xC3, 0x94, 0x30, -0x40, 0x1D, 0x75, 0xF0, 0x12, 0xE5, 0x65, 0x12, -0x87, 0xC6, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x20, 0xE0, 0x0C, 0x12, 0xDC, 0x82, 0xE0, 0x60, -0x06, 0x90, 0x96, 0x16, 0xE0, 0x60, 0x0B, 0xE4, -0x78, 0x88, 0xF6, 0x12, 0xDB, 0x4C, 0xE4, 0xF0, -0x80, 0x5C, 0x12, 0xDC, 0x76, 0xE0, 0xFE, 0x24, -0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEF, 0x12, 0xB5, -0x4A, 0x50, 0x1F, 0x12, 0x87, 0xCE, 0x24, 0x05, -0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0x12, 0xB5, 0x4A, -0x50, 0x10, 0x12, 0xDC, 0x6A, 0xE0, 0xB5, 0x67, -0x09, 0x12, 0xDB, 0x59, 0xE0, 0xC3, 0x94, 0x0A, -0x40, 0x26, 0x78, 0x88, 0xE6, 0xFF, 0x70, 0x04, -0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, 0x88, 0xB4, -0x01, 0x04, 0x76, 0x03, 0x80, 0x02, 0x76, 0x05, -0x12, 0xDB, 0x59, 0xE4, 0xF0, 0x12, 0x87, 0xCE, -0xFF, 0x12, 0xDC, 0x76, 0xEF, 0xF0, 0x80, 0x06, -0x12, 0xDB, 0x4C, 0xE0, 0x04, 0xF0, 0x12, 0xDC, -0x6A, 0xE5, 0x67, 0xF0, 0xC1, 0x66, 0x12, 0xDB, -0x8D, 0xE0, 0x64, 0x06, 0x60, 0x02, 0xC1, 0x6B, -0xF5, 0x69, 0xF5, 0x6A, 0x12, 0xAB, 0x32, 0xE0, -0x54, 0x07, 0x78, 0x88, 0xF6, 0xD3, 0xE5, 0x6C, -0x94, 0xE8, 0xE5, 0x6B, 0x94, 0x03, 0x40, 0x06, -0x78, 0x86, 0x76, 0x05, 0x80, 0x15, 0xD3, 0xE5, -0x6C, 0x94, 0xFA, 0xE5, 0x6B, 0x94, 0x00, 0x40, -0x06, 0x78, 0x86, 0x76, 0x02, 0x80, 0x04, 0xE4, -0x78, 0x86, 0xF6, 0xE5, 0x6C, 0xAE, 0x6B, 0x78, -0x86, 0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, -0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x82, -0x06, 0xE4, 0x12, 0xDC, 0xFD, 0x90, 0x95, 0x50, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, -0xF6, 0x12, 0xDC, 0xC4, 0x78, 0x87, 0xE6, 0xFD, -0x12, 0xAF, 0xC3, 0xAE, 0xF0, 0x78, 0x86, 0x86, -0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, -0x13, 0xD8, 0xF9, 0xFF, 0xED, 0x90, 0x82, 0x01, -0x12, 0xDC, 0xFD, 0xEF, 0x25, 0x6A, 0xF5, 0x6A, -0xEE, 0x35, 0x69, 0xF5, 0x69, 0xC3, 0x90, 0x95, -0x51, 0xE0, 0x95, 0x6A, 0x90, 0x95, 0x50, 0xE0, -0x95, 0x69, 0x40, 0x07, 0x78, 0x87, 0x06, 0xE6, -0xB4, 0x05, 0xBE, 0x78, 0x87, 0xE6, 0xC3, 0x13, +0x13, 0xFF, 0xE5, 0x62, 0x12, 0x91, 0xD3, 0xC1, +0x16, 0xD1, 0x3D, 0xE0, 0x64, 0x05, 0x60, 0x02, +0x81, 0xF2, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, +0x70, 0x10, 0xD1, 0x61, 0xE4, 0xF0, 0x90, 0x04, +0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, 0xC5, 0xD6, +0xC1, 0x2A, 0xAD, 0x64, 0xAF, 0x62, 0x12, 0x72, +0xEE, 0x12, 0xDD, 0x1F, 0xF5, 0x83, 0xEF, 0xF0, +0x12, 0x93, 0xED, 0xE0, 0x54, 0x07, 0x78, 0x88, +0xF6, 0x12, 0xC6, 0x3F, 0xFF, 0xC3, 0x94, 0x30, +0x40, 0x1F, 0x75, 0xF0, 0x12, 0xE5, 0x62, 0x12, +0x94, 0xEE, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, +0x20, 0xE0, 0x0E, 0x12, 0xDD, 0x1F, 0xF5, 0x83, +0xE0, 0x60, 0x06, 0x90, 0x96, 0x0B, 0xE0, 0x60, +0x0A, 0xE4, 0x78, 0x88, 0xF6, 0xD1, 0x61, 0xE4, +0xF0, 0x80, 0x5D, 0x12, 0xDD, 0x15, 0xF5, 0x83, +0xE0, 0xFE, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, +0xEF, 0xD1, 0xA1, 0x50, 0x1F, 0x12, 0xC6, 0x3F, +0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0xD1, +0xA1, 0x50, 0x11, 0x12, 0xDD, 0x0B, 0xF5, 0x83, +0xE0, 0xB5, 0x64, 0x08, 0xD1, 0x6E, 0xE0, 0xC3, +0x94, 0x0A, 0x40, 0x27, 0x78, 0x88, 0xE6, 0xFF, +0x70, 0x04, 0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, +0x88, 0xB4, 0x01, 0x04, 0x76, 0x03, 0x80, 0x02, +0x76, 0x05, 0xD1, 0x6E, 0xE4, 0xF0, 0x12, 0xC6, +0x3F, 0xFF, 0x12, 0xDD, 0x15, 0xF5, 0x83, 0xEF, +0xF0, 0x80, 0x05, 0xD1, 0x61, 0xE0, 0x04, 0xF0, +0x12, 0xDD, 0x0B, 0xF5, 0x83, 0xE5, 0x64, 0xF0, +0xC1, 0x11, 0xD1, 0x3D, 0xE0, 0x64, 0x06, 0x60, +0x02, 0xC1, 0x16, 0xF5, 0x66, 0xF5, 0x67, 0x12, +0x93, 0xED, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, +0xD3, 0xE5, 0x69, 0x94, 0xE8, 0xE5, 0x68, 0x94, +0x03, 0x40, 0x06, 0x78, 0x86, 0x76, 0x05, 0x80, +0x15, 0xD3, 0xE5, 0x69, 0x94, 0xFA, 0xE5, 0x68, +0x94, 0x00, 0x40, 0x06, 0x78, 0x86, 0x76, 0x02, +0x80, 0x04, 0xE4, 0x78, 0x86, 0xF6, 0xE5, 0x69, +0xAE, 0x68, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, +0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, +0xFF, 0x90, 0x82, 0x06, 0xE4, 0xF1, 0xB1, 0x90, +0x95, 0x45, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, +0x78, 0x87, 0xF6, 0xD1, 0x37, 0x78, 0x87, 0xE6, +0xFD, 0x12, 0xDC, 0xF8, 0xAE, 0xF0, 0x78, 0x86, +0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, +0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xED, 0x90, 0x82, +0x01, 0xF1, 0xB1, 0xEF, 0x25, 0x67, 0xF5, 0x67, +0xEE, 0x35, 0x66, 0xF5, 0x66, 0xC3, 0x90, 0x95, +0x46, 0xE0, 0x95, 0x67, 0x90, 0x95, 0x45, 0xE0, +0x95, 0x66, 0x40, 0x07, 0x78, 0x87, 0x06, 0xE6, +0xB4, 0x05, 0xC0, 0x78, 0x87, 0xE6, 0xC3, 0x13, 0xF6, 0xFD, 0x08, 0xE6, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, 0xD3, 0x9D, 0x40, 0x07, 0xE6, 0x79, 0x87, 0x97, -0xF6, 0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0x12, -0xDB, 0x99, 0xE0, 0xC3, 0x13, 0xFF, 0x78, 0x89, -0xE6, 0xC4, 0x33, 0x54, 0xE0, 0x2F, 0xFF, 0x12, -0xDB, 0x99, 0xEF, 0xF0, 0x12, 0xDB, 0x99, 0xE0, -0xC3, 0x94, 0xC0, 0x40, 0x06, 0x12, 0xDB, 0x99, -0x74, 0xC0, 0xF0, 0x12, 0xDB, 0x99, 0xE0, 0x24, -0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, -0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, 0xD8, 0xF8, -0x78, 0x89, 0xF6, 0xE6, 0x25, 0xE0, 0xF6, 0x70, -0x03, 0xFF, 0x80, 0x05, 0x78, 0x89, 0xE6, 0x14, -0xFF, 0x78, 0x88, 0xA6, 0x07, 0xD3, 0x90, 0x95, -0x48, 0xE0, 0x94, 0x03, 0x90, 0x95, 0x47, 0xE0, -0x94, 0x00, 0x40, 0x02, 0xE4, 0xF6, 0x78, 0x88, -0x12, 0xAE, 0x29, 0x12, 0xDB, 0x8D, 0xE0, 0xFF, -0xD3, 0x94, 0x05, 0x50, 0x05, 0xEF, 0x04, 0xFF, -0x80, 0x02, 0x7F, 0x00, 0x12, 0xDB, 0x8D, 0xEF, -0xF0, 0xE4, 0xF5, 0x69, 0xF5, 0x6A, 0x75, 0xF0, -0x12, 0xE5, 0x65, 0x12, 0xBB, 0x72, 0xE0, 0x64, -0x01, 0x60, 0x02, 0xE1, 0xED, 0x12, 0xDC, 0xC4, -0x12, 0xDC, 0xF5, 0xAE, 0xF0, 0x12, 0x03, 0x13, -0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0x12, 0xDC, 0x4A, -0x2F, 0xFF, 0xEE, 0x12, 0xDB, 0xCD, 0xFE, 0x90, -0x00, 0x08, 0x12, 0xDB, 0xD3, 0x90, 0x95, 0x49, -0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x03, 0x13, 0xFF, -0xC3, 0x90, 0x95, 0x4A, 0xE0, 0x9F, 0xFE, 0x90, -0x95, 0x49, 0xE0, 0x95, 0xF0, 0x90, 0x95, 0x4B, -0xF0, 0xA3, 0xCE, 0xF0, 0x90, 0x00, 0x06, 0x12, -0x03, 0x3E, 0xFD, 0xAC, 0xF0, 0x25, 0xE0, 0xFF, -0xEC, 0x33, 0xFE, 0xEF, 0x2D, 0xFD, 0xEE, 0x3C, -0xFC, 0x12, 0xDC, 0x4B, 0x25, 0xE0, 0xFF, 0xE5, -0xF0, 0x33, 0xFE, 0x90, 0x00, 0x02, 0x12, 0xDB, -0xD3, 0xCF, 0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0x12, -0xDC, 0x30, 0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, -0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, 0xEC, -0x3E, 0x90, 0x95, 0x4D, 0xF0, 0xA3, 0xEF, 0xF0, -0x90, 0x95, 0x47, 0x12, 0xDB, 0xBC, 0x12, 0xDC, -0xA6, 0x12, 0xDB, 0xB1, 0x9E, 0x50, 0x09, 0x90, -0x95, 0x47, 0x12, 0xDC, 0x25, 0xFE, 0x80, 0x04, -0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x65, 0x12, 0xDC, -0xA6, 0x12, 0xAD, 0x4F, 0x90, 0x95, 0x49, 0x12, -0xDB, 0xBC, 0x12, 0xDC, 0xB0, 0x12, 0xDB, 0xB1, -0x9E, 0x50, 0x09, 0x90, 0x95, 0x49, 0x12, 0xDC, -0x25, 0xFE, 0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, -0xE5, 0x65, 0x12, 0xDC, 0xB0, 0x12, 0xAD, 0x4F, -0x90, 0x95, 0x4D, 0x12, 0xDB, 0xBC, 0x12, 0xDC, -0xBA, 0x12, 0xDB, 0xB1, 0x9E, 0x50, 0x09, 0x90, -0x95, 0x4D, 0x12, 0xDC, 0x25, 0xFE, 0x80, 0x04, -0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x65, 0x12, 0xDC, -0xBA, 0x12, 0xAD, 0x4F, 0xC3, 0x74, 0xFF, 0x95, -0x6C, 0xFF, 0x74, 0xFF, 0x95, 0x6B, 0xFE, 0x12, -0xDC, 0x5E, 0x12, 0xDB, 0xB1, 0x9E, 0x50, 0x0A, -0xE5, 0x6C, 0x2D, 0xFF, 0xE5, 0x6B, 0x3C, 0xFE, -0x80, 0x04, 0x7E, 0xFF, 0x7F, 0xFF, 0x12, 0xDC, -0x5E, 0x12, 0xAD, 0x4F, 0x12, 0xDC, 0xED, 0xFB, -0xC3, 0x74, 0xFF, 0x9B, 0xFF, 0x74, 0xFF, 0x9E, -0xFE, 0x74, 0xFF, 0x94, 0x00, 0xFD, 0x74, 0xFF, -0x94, 0x00, 0xFC, 0x90, 0x8D, 0x71, 0x12, 0x86, -0x61, 0xD3, 0x12, 0x03, 0xDA, 0x50, 0x12, 0x12, -0xDC, 0xED, 0xFF, 0xE4, 0xFC, 0xFD, 0x90, 0x8D, -0x71, 0x12, 0x86, 0x61, 0x12, 0x86, 0x2C, 0x80, -0x06, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x90, -0x8D, 0x71, 0x12, 0x04, 0x31, 0x12, 0xBB, 0x97, -0x05, 0x65, 0x21, 0x47, 0x22, 0x90, 0x93, 0x57, +0xF6, 0x80, 0x04, 0xE4, 0x78, 0x89, 0xF6, 0xD1, +0x49, 0xE0, 0xC3, 0x13, 0xFF, 0x78, 0x89, 0xE6, +0xC4, 0x33, 0x54, 0xE0, 0x2F, 0xFF, 0xD1, 0x49, +0xEF, 0xF0, 0xD1, 0x49, 0xE0, 0xC3, 0x94, 0xC0, +0x40, 0x05, 0xD1, 0x49, 0x74, 0xC0, 0xF0, 0xD1, +0x49, 0xE0, 0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, +0xEF, 0x78, 0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, +0x13, 0xD8, 0xF8, 0x78, 0x89, 0xF6, 0xE6, 0x25, +0xE0, 0xF6, 0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, +0x89, 0xE6, 0x14, 0xFF, 0x78, 0x88, 0xA6, 0x07, +0xD3, 0x90, 0x95, 0x3D, 0xE0, 0x94, 0x03, 0x90, +0x95, 0x3C, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xE4, +0xF6, 0x78, 0x88, 0x12, 0xC5, 0xD6, 0xD1, 0x3D, +0xE0, 0xFF, 0xD3, 0x94, 0x05, 0x50, 0x05, 0xEF, +0x04, 0xFF, 0x80, 0x02, 0x7F, 0x00, 0xD1, 0x3D, +0xEF, 0xF0, 0xE4, 0xF5, 0x66, 0xF5, 0x67, 0xF1, +0xAA, 0x05, 0x62, 0x02, 0xC7, 0xC3, 0x22, 0x90, +0x95, 0x39, 0x02, 0x86, 0x6D, 0x74, 0x76, 0x25, +0x62, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, +0x22, 0x74, 0x4F, 0x25, 0x62, 0xF5, 0x82, 0xE4, +0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xA6, 0x25, +0x62, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, +0x22, 0x74, 0x76, 0x25, 0x62, 0xF5, 0x82, 0xE4, +0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0xF6, +0x25, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, +0x83, 0x22, 0x90, 0x00, 0x08, 0x02, 0x03, 0x3E, +0x35, 0xF0, 0xFE, 0x90, 0x00, 0x06, 0x02, 0x03, +0x3E, 0xF5, 0x83, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, +0xD3, 0x9F, 0xEC, 0x22, 0x90, 0x00, 0x02, 0x02, +0x03, 0x3E, 0x90, 0x00, 0x04, 0x02, 0x03, 0x3E, +0xE0, 0xD3, 0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, +0x80, 0x98, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, +0xED, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0x22, 0xE5, +0x64, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, +0x34, 0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFE, 0xA3, +0xE0, 0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFF, 0x74, +0xFF, 0x9E, 0xFE, 0xE5, 0x62, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD1, 0x46, +0x90, 0x96, 0xD1, 0xF0, 0x90, 0x88, 0x32, 0x12, +0x8F, 0xF0, 0x30, 0xE0, 0x02, 0xE1, 0x9E, 0x90, +0x88, 0x31, 0xE0, 0x30, 0xE0, 0x1F, 0x90, 0x88, +0x53, 0xE0, 0x24, 0x04, 0x33, 0x33, 0x33, 0x54, +0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, 0x88, 0x53, +0xE0, 0x04, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, +0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, +0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, +0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, 0x88, 0x4A, +0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, 0xD3, 0x9E, +0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, 0xF0, 0x90, +0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, 0x80, 0x11, +0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, +0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, +0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, 0x88, 0x4B, +0xF1, 0xE0, 0x90, 0x88, 0x4E, 0xD1, 0xA0, 0x40, +0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, +0xF1, 0xE0, 0x90, 0x88, 0x3E, 0xD1, 0xA0, 0x40, +0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, +0x12, 0xAD, 0x26, 0xFF, 0x7E, 0x00, 0x90, 0x88, +0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, +0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, +0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, +0xF0, 0x12, 0xDD, 0x8C, 0x80, 0x07, 0x90, 0x88, +0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x7D, 0x01, 0xAF, 0x62, 0x02, 0x61, +0xF7, 0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, +0x25, 0xE0, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x22, +0x25, 0xE0, 0x24, 0x26, 0xF5, 0x82, 0xE4, 0x22, +0x25, 0xE0, 0x24, 0x56, 0xF5, 0x82, 0xE4, 0x22, +0xE5, 0x64, 0x90, 0x81, 0x9D, 0x93, 0xFF, 0x22, +0x90, 0x95, 0x40, 0xE0, 0xFE, 0xA3, 0xE0, 0x22, +0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, +0x22, 0x12, 0x86, 0x61, 0xD3, 0x02, 0x03, 0xDA, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, +0x96, 0xC3, 0xEF, 0xF0, 0x90, 0x00, 0x8F, 0xE0, +0x30, 0xE6, 0x3D, 0x90, 0x00, 0x8D, 0xE0, 0x64, +0x01, 0x70, 0x35, 0x90, 0x96, 0xC4, 0xF0, 0x90, +0x96, 0xC4, 0xE0, 0xFD, 0x90, 0x96, 0xC3, 0xE0, +0x12, 0x90, 0xDE, 0xE5, 0x82, 0x2D, 0x12, 0xB5, +0xDF, 0xE0, 0xFB, 0xE4, 0xFF, 0x12, 0x96, 0x20, +0x90, 0x96, 0xC4, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, +0x94, 0x10, 0x40, 0xDB, 0x90, 0x00, 0x8F, 0xE0, +0x30, 0xE0, 0x05, 0x90, 0x00, 0x8D, 0xE4, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x57, 0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x93, 0x59, 0xF0, 0x90, 0x93, 0x57, 0xE0, 0x54, 0xEF, -0xF0, 0x22, 0xE4, 0x90, 0x95, 0xF5, 0xF0, 0x90, -0x95, 0xF3, 0x74, 0x14, 0xF0, 0x90, 0x96, 0x15, -0x74, 0x01, 0xF0, 0xFB, 0x7A, 0x95, 0x79, 0xF3, -0x12, 0x8C, 0x91, 0x7F, 0x04, 0x02, 0x04, 0x7E, -0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, -0x12, 0x9E, 0x2F, 0x90, 0x01, 0x98, 0xE0, 0x54, -0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, -0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, -0xE4, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x95, -0xF5, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, -0x41, 0x90, 0x95, 0xF4, 0xEF, 0xF0, 0x7F, 0x83, -0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, 0x95, 0xF4, -0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, -0x95, 0xF6, 0xE0, 0x94, 0x64, 0x90, 0x95, 0xF5, -0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, -0xE0, 0x44, 0x40, 0xF0, 0x90, 0x95, 0xF4, 0xE0, -0xFF, 0x22, 0x90, 0x95, 0xF5, 0x12, 0x9D, 0xF5, -0x80, 0xC2, 0x90, 0x01, 0xC4, 0x74, 0x9A, 0xF0, -0x74, 0xD0, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, -0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0x9A, 0x04, -0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD0, 0xA3, 0xF0, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x12, 0xB7, 0x7A, 0x90, 0x96, 0xC3, 0xF0, 0xED, -0x90, 0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, -0xF0, 0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, -0x80, 0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, -0x67, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, -0x9D, 0xE0, 0x30, 0xE0, 0x5E, 0x90, 0x94, 0xA1, -0xE0, 0x30, 0xE0, 0x3D, 0x90, 0x94, 0xAC, 0xE0, -0xFF, 0x90, 0x94, 0xAB, 0xE0, 0xC3, 0x9F, 0x40, -0x24, 0x31, 0x5E, 0x90, 0x06, 0xC4, 0x31, 0x5C, -0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, -0x31, 0x5C, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, -0x06, 0xC6, 0x31, 0x5C, 0x31, 0x64, 0xE4, 0x90, -0x94, 0xAB, 0xF0, 0x80, 0x1B, 0x31, 0x6F, 0x31, -0x64, 0x90, 0x94, 0xAB, 0xE0, 0x04, 0xF0, 0x80, -0x0F, 0x90, 0x94, 0xAA, 0xE0, 0x60, 0x09, 0x31, -0x6F, 0x31, 0x64, 0xE4, 0x90, 0x94, 0xAA, 0xF0, -0x90, 0x8A, 0xBB, 0x12, 0x8C, 0xA3, 0xE4, 0xFF, -0x12, 0x04, 0x7E, 0x22, 0xEF, 0xF0, 0x90, 0x94, -0xA2, 0x02, 0x04, 0xB8, 0x78, 0x18, 0x12, 0x03, -0xEB, 0x90, 0x06, 0xC7, 0xEF, 0xF0, 0x22, 0x90, -0x94, 0xA6, 0x12, 0x04, 0xB8, 0x90, 0x06, 0xC4, -0xEF, 0xF0, 0x90, 0x94, 0xA6, 0x12, 0x04, 0xB8, -0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, -0xEF, 0xF0, 0x90, 0x94, 0xA6, 0x12, 0x04, 0xB8, -0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC6, -0xEF, 0xF0, 0x90, 0x94, 0xA6, 0x02, 0x04, 0xB8, -0x90, 0x94, 0xBD, 0xEF, 0xF0, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xEF, -0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, 0x60, 0x08, -0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, 0x80, 0x6E, -0x51, 0xA7, 0x51, 0x33, 0x90, 0x07, 0xC3, 0xE0, -0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, -0x51, 0x3A, 0xFE, 0x74, 0xA9, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x96, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, -0xEF, 0xB4, 0x04, 0xE9, 0x90, 0x96, 0xAA, 0x12, -0x88, 0xF1, 0x51, 0xB0, 0x90, 0x96, 0xA9, 0x12, -0x88, 0xF1, 0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, -0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0xAB, -0x12, 0x88, 0xF1, 0x78, 0x10, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, +0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0xE4, 0x90, 0x95, 0xEA, 0xF0, 0x90, 0x95, +0xE8, 0x74, 0x14, 0xF0, 0x90, 0x96, 0x0A, 0x74, +0x01, 0xF0, 0xFB, 0x7A, 0x95, 0x79, 0xE8, 0x12, +0x8B, 0x34, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x9A, 0xE0, +0x54, 0xC0, 0x44, 0x0B, 0x12, 0xB7, 0xAD, 0x90, +0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, 0x00, 0xB4, +0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x01, 0x95, +0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, 0x7F, 0x01, +0x22, 0x22, 0xE4, 0x90, 0x95, 0xEA, 0xF0, 0xA3, +0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x95, +0xE9, 0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, +0xAE, 0x07, 0x90, 0x95, 0xE9, 0xE0, 0xFF, 0xB5, +0x06, 0x01, 0x22, 0xC3, 0x90, 0x95, 0xEB, 0xE0, +0x94, 0x64, 0x90, 0x95, 0xEA, 0xE0, 0x94, 0x00, +0x40, 0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, +0xF0, 0x90, 0x95, 0xE9, 0xE0, 0xFF, 0x22, 0x90, +0x95, 0xEA, 0x12, 0x9F, 0xEF, 0x80, 0xC2, 0x90, +0x01, 0xC4, 0x74, 0xF7, 0xF0, 0x74, 0xD0, 0xA3, +0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, +0xE0, 0xF7, 0x74, 0xF7, 0x04, 0x90, 0x01, 0xC4, +0xF0, 0x74, 0xD0, 0xA3, 0xF0, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x31, 0x46, 0x90, +0x96, 0xCC, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, +0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0x67, +0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, +0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, 0x7F, +0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, +0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, +0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, +0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, 0xBD, 0xE0, +0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0x36, 0xE0, +0x70, 0x0C, 0x12, 0x88, 0xCA, 0x90, 0x8A, 0xF9, +0x12, 0x8B, 0x46, 0x12, 0xA9, 0x17, 0x22, 0x90, +0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x5E, 0x90, 0x94, +0xA2, 0xE0, 0x30, 0xE0, 0x3D, 0x90, 0x94, 0xAD, +0xE0, 0xFF, 0x90, 0x94, 0xAC, 0xE0, 0xC3, 0x9F, +0x40, 0x24, 0x31, 0xEF, 0x90, 0x06, 0xC4, 0x31, +0xED, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, +0xC5, 0x31, 0xED, 0x78, 0x10, 0x12, 0x03, 0xEB, +0x90, 0x06, 0xC6, 0x31, 0xED, 0x31, 0xF5, 0xE4, +0x90, 0x94, 0xAC, 0xF0, 0x80, 0x1B, 0x51, 0x00, +0x31, 0xF5, 0x90, 0x94, 0xAC, 0xE0, 0x04, 0xF0, +0x80, 0x0F, 0x90, 0x94, 0xAB, 0xE0, 0x60, 0x09, +0x51, 0x00, 0x31, 0xF5, 0xE4, 0x90, 0x94, 0xAB, +0xF0, 0x90, 0x8A, 0xBB, 0x12, 0x8B, 0x46, 0xE4, +0xFF, 0x12, 0x04, 0x7E, 0x22, 0xEF, 0xF0, 0x90, +0x94, 0xA3, 0x02, 0x04, 0xB8, 0x78, 0x18, 0x12, +0x03, 0xEB, 0x90, 0x06, 0xC7, 0xEF, 0xF0, 0x22, +0x90, 0x94, 0xA7, 0x12, 0x04, 0xB8, 0x90, 0x06, +0xC4, 0xEF, 0xF0, 0x90, 0x94, 0xA7, 0x12, 0x04, +0xB8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, +0xC5, 0xEF, 0xF0, 0x90, 0x94, 0xA7, 0x12, 0x04, +0xB8, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, +0xC6, 0xEF, 0xF0, 0x90, 0x94, 0xA7, 0x02, 0x04, +0xB8, 0x90, 0x96, 0xCD, 0xEF, 0xF0, 0x90, 0x88, +0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, +0x12, 0x8B, 0x46, 0x7D, 0x11, 0x51, 0x82, 0x12, +0x88, 0xCD, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, +0xBD, 0xF0, 0x90, 0x96, 0xCD, 0xE0, 0xFD, 0x70, +0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0x51, +0x7B, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, 0xCD, +0xE0, 0xFD, 0xB4, 0x02, 0x06, 0x51, 0x7B, 0x44, +0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x51, +0x7B, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, +0x1F, 0x22, 0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, +0x8A, 0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x94, 0xB6, 0x74, 0x02, 0xF0, +0x90, 0x88, 0xC2, 0xE0, 0x44, 0x10, 0xF0, 0x90, +0x88, 0xAF, 0xE0, 0x60, 0x02, 0x81, 0x18, 0x90, +0x8A, 0xD9, 0x12, 0x8B, 0x46, 0xE4, 0xFF, 0x12, +0x04, 0x7E, 0x90, 0x88, 0xA1, 0xE0, 0x30, 0xE0, +0x04, 0x7F, 0x01, 0x80, 0x37, 0x90, 0x88, 0x9D, +0x12, 0x9D, 0xC0, 0x30, 0xE0, 0x04, 0x7F, 0x0D, +0x80, 0x2A, 0x90, 0x88, 0xA0, 0xE0, 0xFF, 0xC4, +0x54, 0x0F, 0x30, 0xE0, 0x10, 0xEF, 0x13, 0x13, +0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x09, 0x80, +0x13, 0x7F, 0x03, 0x80, 0x0F, 0x90, 0x88, 0xA0, +0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x04, 0x7F, 0x03, +0x80, 0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x90, +0x88, 0xAF, 0x74, 0x01, 0x91, 0x1D, 0x30, 0xE0, +0x05, 0x12, 0x9B, 0x4B, 0x80, 0x33, 0x90, 0x88, +0x9D, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x29, +0x90, 0x88, 0xA3, 0xE0, 0x44, 0x20, 0xF0, 0x90, +0x88, 0x9C, 0xE0, 0x60, 0x0C, 0x90, 0x8A, 0xB9, +0x12, 0x8B, 0x46, 0x7D, 0x01, 0x7F, 0x04, 0x80, +0x0D, 0x12, 0x9B, 0x4B, 0x90, 0x8A, 0xB9, 0x12, +0x8B, 0x46, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, +0x7E, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x06, 0x7B, +0x04, 0x7D, 0x6F, 0x80, 0x03, 0xE4, 0xFB, 0xFD, +0x7F, 0xFF, 0x12, 0x9B, 0x50, 0x12, 0x8F, 0xED, +0x30, 0xE0, 0x0B, 0x90, 0x8A, 0x97, 0x12, 0x8B, +0x46, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, +0xA1, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0E, 0x90, +0x06, 0xCD, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x06, +0xCF, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x05, 0x63, +0xE0, 0x90, 0x94, 0xBA, 0xF0, 0x90, 0x05, 0x62, +0xE0, 0x90, 0x94, 0xB9, 0xF0, 0x90, 0x05, 0x61, +0xE0, 0x90, 0x94, 0xB8, 0xF0, 0x90, 0x05, 0x60, +0xE0, 0x90, 0x94, 0xB7, 0xF0, 0x12, 0x8E, 0xD0, +0x91, 0x27, 0x90, 0x94, 0xB7, 0x12, 0x8E, 0xD1, 0x12, 0x86, 0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x12, 0x88, 0xF0, 0x78, 0x18, -0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -0x01, 0xD0, 0x00, 0x12, 0x86, 0x54, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x90, 0x07, 0xC0, 0x74, 0x80, -0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, -0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x51, -0xC3, 0x51, 0x33, 0x90, 0x07, 0xC3, 0xE0, 0x30, -0xE5, 0xF9, 0xED, 0x54, 0x03, 0x24, 0xC8, 0x51, -0x3A, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -0xAC, 0x06, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x30, -0xE0, 0x06, 0x7E, 0xFF, 0x7F, 0xFF, 0x80, 0x22, -0x51, 0xA7, 0x51, 0x33, 0x90, 0x07, 0xC3, 0xE0, -0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, -0xC9, 0x51, 0x3A, 0xFE, 0x74, 0xC8, 0x2D, 0xF5, -0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x12, 0x97, -0xE2, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -0x07, 0xC0, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, -0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, -0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, 0xEE, 0xF0, -0xA3, 0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, -0xF0, 0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xBC, 0x51, -0xBE, 0x7A, 0x00, 0x90, 0x96, 0xBD, 0xE0, 0x54, -0x03, 0xFB, 0x70, 0x0A, 0x90, 0x07, 0xC4, 0x71, -0x0E, 0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, -0x02, 0x4A, 0x70, 0x15, 0x90, 0x07, 0xC6, 0x71, -0x0E, 0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, -0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, -0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, -0xEC, 0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0xBE, 0x51, 0xBE, 0x71, 0x7D, 0x70, 0x0D, 0x90, -0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, -0x01, 0xF0, 0x80, 0x37, 0xEF, 0x64, 0x01, 0x4E, -0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, -0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x24, 0x71, -0x7D, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, 0xC6, -0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, 0xF0, -0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, 0x0B, -0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, 0xC2, -0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, -0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, 0x90, -0x96, 0xBF, 0xE0, 0x54, 0x03, 0xFF, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, -0xFC, 0xFF, 0x51, 0xC5, 0xE4, 0xFB, 0x90, 0x96, -0x9B, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, -0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, -0x2B, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, -0xEF, 0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xDF, 0x90, -0x07, 0xC2, 0x12, 0x9F, 0xE2, 0x90, 0x07, 0xC3, -0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x90, 0x95, 0x44, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, -0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x7D, -0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0A, 0x71, 0xF4, -0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, 0x03, -0x71, 0xF4, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, -0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, 0x5F, -0x22, 0x90, 0x93, 0x03, 0xE0, 0x54, 0xFE, 0xF0, -0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0xE4, -0x90, 0x93, 0x0F, 0xF0, 0xA3, 0xF0, 0x22, 0x90, -0x04, 0x24, 0xEF, 0xF0, 0x90, 0x04, 0x57, 0xF0, -0x22, 0x90, 0x93, 0x20, 0xE0, 0x90, 0x95, 0xA7, -0xF0, 0x90, 0x93, 0x21, 0xE0, 0x90, 0x95, 0xA8, -0xF0, 0x90, 0x93, 0x22, 0xE0, 0x90, 0x95, 0xA9, -0xF0, 0x90, 0x93, 0x23, 0xE0, 0x90, 0x95, 0xAA, -0xF0, 0x90, 0x93, 0x24, 0xE0, 0x90, 0x95, 0xAB, -0xF0, 0x90, 0x93, 0x11, 0xE0, 0x90, 0x95, 0xAC, -0xF0, 0x90, 0x93, 0x12, 0xE0, 0x90, 0x95, 0xAD, -0xF0, 0x90, 0x93, 0x13, 0xE0, 0x90, 0x95, 0xAE, -0xF0, 0x90, 0x93, 0x14, 0xE0, 0x90, 0x95, 0xAF, -0xF0, 0x90, 0x93, 0x15, 0xE0, 0x90, 0x95, 0xB0, -0xF0, 0x90, 0x93, 0x16, 0xE0, 0x90, 0x95, 0xB1, -0xF0, 0x90, 0x93, 0x17, 0xE0, 0x90, 0x95, 0xB2, -0xF0, 0x90, 0x93, 0x18, 0xE0, 0x90, 0x95, 0xB3, -0xF0, 0x90, 0x93, 0x19, 0xE0, 0x90, 0x95, 0xB4, -0xF0, 0x90, 0x93, 0x1A, 0xE0, 0x90, 0x95, 0xB5, -0xF0, 0x12, 0x9B, 0xDA, 0x90, 0x95, 0x4F, 0xF0, -0x12, 0xD9, 0x3C, 0x50, 0x0B, 0x12, 0xD9, 0x49, -0x74, 0x01, 0xF0, 0x12, 0xD9, 0x35, 0x80, 0xF0, -0x90, 0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, -0x12, 0x97, 0xE2, 0x90, 0x95, 0x44, 0xF0, 0xA3, -0x12, 0xD9, 0x75, 0x12, 0xD9, 0x3C, 0x50, 0x51, -0x12, 0xD9, 0x5F, 0x90, 0x95, 0x4F, 0xE0, 0xFE, -0x24, 0xB6, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0x12, -0xDB, 0xFA, 0xE0, 0x24, 0x4D, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x51, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0x12, 0xDB, -0xFA, 0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, 0xFC, -0xFA, 0x7B, 0x01, 0xEE, 0x12, 0xDC, 0x3C, 0x12, -0x86, 0x76, 0x12, 0xDB, 0xFE, 0xE0, 0x24, 0x38, -0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0x12, 0xD9, -0x85, 0x12, 0x86, 0x76, 0x12, 0xD9, 0x35, 0x80, -0xAA, 0x90, 0x02, 0x87, 0xE0, 0x70, 0x03, 0x02, -0xD9, 0x27, 0x90, 0x93, 0x03, 0xE0, 0x20, 0xE0, -0x03, 0x02, 0xD9, 0x27, 0xE4, 0x90, 0x95, 0xC0, -0x12, 0x9B, 0xE2, 0x90, 0x95, 0x44, 0xE0, 0xFF, -0xA3, 0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, -0x90, 0x95, 0x46, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -0xEC, 0x90, 0xFD, 0x11, 0xF0, 0x74, 0x01, 0x2D, -0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, -0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, -0xFF, 0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x95, 0x48, -0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, -0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, -0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x95, -0x4B, 0xF0, 0xFC, 0x74, 0x07, 0x2D, 0xF5, 0x82, -0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xC0, -0x90, 0x95, 0x4D, 0xF0, 0xEC, 0x24, 0x18, 0x90, -0x95, 0x4A, 0xF0, 0xFD, 0x90, 0x95, 0x46, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0xE9, 0x12, -0xA5, 0xA9, 0xEF, 0x54, 0xFC, 0x90, 0x95, 0x4C, -0xF0, 0x90, 0x95, 0x4B, 0xE0, 0x24, 0x18, 0xFF, -0xE4, 0x33, 0x90, 0x95, 0x48, 0x8F, 0xF0, 0x12, -0x02, 0xE7, 0x90, 0x95, 0x48, 0xE0, 0xFE, 0xA3, -0xE0, 0xFF, 0x71, 0xDF, 0x90, 0x95, 0x44, 0xEE, -0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x88, 0x27, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x44, -0x12, 0xDB, 0xB3, 0x9E, 0x40, 0x1B, 0x90, 0x88, -0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, 0x27, -0xE0, 0x34, 0x00, 0xFE, 0xC3, 0xED, 0x9F, 0xFF, -0xEC, 0x9E, 0x90, 0x95, 0x44, 0xF0, 0xA3, 0xEF, -0xF0, 0x90, 0x95, 0x4C, 0xE0, 0x24, 0xC0, 0x60, -0x03, 0x02, 0xD8, 0x23, 0x12, 0xD9, 0x28, 0x24, -0x18, 0xFD, 0x90, 0x8A, 0xE9, 0x12, 0xA5, 0xA9, -0xEF, 0x60, 0x03, 0x02, 0xD8, 0x17, 0x12, 0xD9, -0x28, 0x24, 0x19, 0xFD, 0x90, 0x8A, 0xE9, 0x12, -0xA5, 0xA9, 0x90, 0x95, 0x65, 0x12, 0xDC, 0xDD, -0x90, 0x95, 0x65, 0xE0, 0xFF, 0x12, 0xD9, 0x6E, -0x9F, 0x50, 0x1B, 0x12, 0xD9, 0x28, 0x24, 0x1A, -0x12, 0xD9, 0x7D, 0x12, 0xA5, 0xA9, 0x90, 0x95, -0x4E, 0xE0, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0x12, 0xD9, 0x54, 0x80, 0xDA, 0x90, 0x95, -0x65, 0xE0, 0x70, 0x02, 0xE1, 0x33, 0xE4, 0x90, -0x95, 0x4F, 0xF0, 0x12, 0xD9, 0x3C, 0x40, 0x02, -0xE1, 0x1A, 0x12, 0xD9, 0x5F, 0x90, 0x95, 0x4F, -0xE0, 0xFF, 0x24, 0x51, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0x95, 0x65, -0xE0, 0xFD, 0xEE, 0x6D, 0x70, 0x20, 0xEF, 0x12, -0xDC, 0x3C, 0x12, 0x86, 0x6D, 0xC0, 0x03, 0xC0, -0x02, 0xC0, 0x01, 0x12, 0xDB, 0xDC, 0xED, 0xF0, -0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, 0xAC, -0x34, 0xEF, 0x60, 0x02, 0x80, 0x4C, 0x90, 0x95, -0x65, 0xE0, 0x64, 0x03, 0x70, 0x54, 0x12, 0xDB, -0xDC, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x83, -0x12, 0xAC, 0x34, 0xEF, 0x70, 0x10, 0x12, 0xDB, -0xDC, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x7F, -0x12, 0xAC, 0x34, 0xEF, 0x60, 0x2C, 0x90, 0x95, -0x4F, 0xE0, 0xFF, 0x24, 0xB1, 0xF5, 0x82, 0xE4, -0x34, 0x95, 0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, -0x0C, 0x90, 0x95, 0x4F, 0xE0, 0xFF, 0x24, 0xAC, -0x12, 0xDC, 0xD4, 0x60, 0x05, 0x74, 0xC0, 0x2F, -0x80, 0x16, 0x12, 0xDB, 0xEC, 0x74, 0x01, 0xF0, -0x80, 0x13, 0x90, 0x95, 0x4F, 0xE0, 0x24, 0xC0, -0x80, 0x06, 0x90, 0x95, 0x4F, 0xE0, 0x24, 0xC0, -0x12, 0xDB, 0xF2, 0xE4, 0xF0, 0x12, 0xD9, 0x35, -0xC1, 0x6B, 0x90, 0x95, 0xC0, 0xE0, 0x70, 0x56, -0xA3, 0xE0, 0x70, 0x52, 0xA3, 0xE0, 0x70, 0x4E, -0xA3, 0xE0, 0x70, 0x4A, 0xA3, 0xE0, 0x70, 0x46, -0x02, 0xD8, 0x17, 0xE4, 0x90, 0x95, 0x4F, 0xF0, -0x12, 0xD9, 0x3C, 0x50, 0x20, 0x74, 0xAC, 0x2E, -0x12, 0xDC, 0xD4, 0x60, 0x0A, 0x74, 0xC0, 0x2E, -0x12, 0xDB, 0xF2, 0xE4, 0xF0, 0x80, 0x09, 0x74, -0xC0, 0x2E, 0x12, 0xDB, 0xF2, 0x74, 0x01, 0xF0, -0x12, 0xD9, 0x35, 0x80, 0xDB, 0x90, 0x95, 0xC0, -0xE0, 0x70, 0x13, 0xA3, 0xE0, 0x70, 0x0F, 0xA3, -0xE0, 0x70, 0x0B, 0xA3, 0xE0, 0x70, 0x07, 0xA3, -0xE0, 0x70, 0x03, 0x02, 0xD8, 0x17, 0xE4, 0x90, -0x95, 0x4F, 0xF0, 0x12, 0xD9, 0x3C, 0x40, 0x03, -0x02, 0xD8, 0x17, 0x12, 0xD9, 0x5F, 0x12, 0xDB, -0xEC, 0xE0, 0x70, 0x03, 0x02, 0xD8, 0x12, 0x90, -0x93, 0x29, 0xE0, 0x30, 0xE0, 0x06, 0xC4, 0x54, -0x0F, 0x30, 0xE0, 0x76, 0xE4, 0xFF, 0xFE, 0x90, -0x04, 0x1D, 0xE0, 0x60, 0x10, 0xD3, 0xEF, 0x94, -0xE8, 0xEE, 0x94, 0x03, 0x50, 0x07, 0x0F, 0xBF, -0x00, 0x01, 0x0E, 0x80, 0xEA, 0x90, 0x04, 0x1D, -0xE0, 0x70, 0x57, 0x90, 0x95, 0x4F, 0xE0, 0x24, -0xA7, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x06, 0xF0, -0x7B, 0x08, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, -0x95, 0x48, 0xEE, 0xF0, 0xA3, 0x12, 0xDC, 0xDD, -0x12, 0xD9, 0x6E, 0x94, 0x06, 0x50, 0x21, 0x12, -0xD9, 0x28, 0x24, 0x0A, 0x12, 0xD9, 0x7D, 0x12, -0xA5, 0xA9, 0x90, 0x95, 0x48, 0xA3, 0xE0, 0xFE, -0x90, 0x95, 0x4E, 0xE0, 0x2E, 0x24, 0x2C, 0xF5, -0x82, 0xE4, 0x34, 0xFC, 0x31, 0x54, 0x80, 0xD8, -0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x06, -0x35, 0xF0, 0x31, 0x35, 0x02, 0xD7, 0x7B, 0x12, -0xD3, 0xC9, 0x90, 0x06, 0x36, 0x74, 0xDD, 0xF0, -0x02, 0xD5, 0x19, 0x90, 0x95, 0x4D, 0xE0, 0x60, -0x02, 0x21, 0x21, 0x31, 0x28, 0x24, 0x16, 0xFD, -0x90, 0x8A, 0xE9, 0x12, 0xA5, 0xA9, 0x90, 0x06, -0x34, 0xEF, 0xF0, 0x31, 0x28, 0x24, 0x17, 0xFD, -0x90, 0x8A, 0xE9, 0x12, 0xA5, 0xA9, 0x90, 0x06, -0x37, 0x31, 0x75, 0x31, 0x3C, 0x50, 0x3D, 0x31, -0x5F, 0xE4, 0x90, 0x95, 0x4E, 0xF0, 0x31, 0x6E, -0x94, 0x06, 0x50, 0x2C, 0x31, 0x28, 0x24, 0x04, -0x2D, 0xFD, 0x90, 0x8A, 0xE9, 0x12, 0xA5, 0xA9, -0x90, 0x95, 0x4F, 0xE0, 0xFE, 0x31, 0x85, 0x12, -0x86, 0x6D, 0x90, 0x95, 0x4E, 0xE0, 0xF5, 0x82, -0x12, 0xAC, 0x15, 0x6F, 0x60, 0x06, 0x31, 0x49, -0xE4, 0xF0, 0x80, 0x04, 0x31, 0x58, 0x80, 0xCE, -0x31, 0x35, 0x80, 0xBF, 0x90, 0x95, 0xBB, 0xE0, -0x64, 0x01, 0x60, 0x17, 0xA3, 0xE0, 0x64, 0x01, -0x60, 0x11, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x0B, -0xA3, 0xE0, 0x64, 0x01, 0x60, 0x05, 0xA3, 0xE0, -0xB4, 0x01, 0x06, 0x90, 0x95, 0x50, 0x74, 0x01, -0xF0, 0x90, 0x95, 0x50, 0xE0, 0x64, 0x01, 0x70, -0x54, 0x12, 0xD4, 0x01, 0x12, 0xC6, 0x64, 0x12, -0xC5, 0xE5, 0x90, 0x93, 0x25, 0xE0, 0x70, 0x03, -0x02, 0xD5, 0x19, 0x90, 0x01, 0x3C, 0xE0, 0x30, -0xE4, 0x03, 0x74, 0x10, 0xF0, 0x7D, 0x10, 0xE4, -0xFF, 0x12, 0x7C, 0x05, 0x90, 0x93, 0x26, 0xE0, -0x60, 0x07, 0xF5, 0x4D, 0xE4, 0xF5, 0x4E, 0x80, -0x17, 0x90, 0x93, 0x27, 0xE0, 0x60, 0x08, 0xFB, -0xE4, 0xF5, 0x4D, 0xF5, 0x4E, 0x80, 0x0A, 0x75, -0x4D, 0x20, 0xE4, 0xF5, 0x4E, 0xFB, 0x80, 0x01, -0xFB, 0x7D, 0x01, 0x7F, 0x60, 0x7E, 0x01, 0x12, -0x72, 0xB7, 0x02, 0xD5, 0x19, 0x12, 0x9B, 0xDA, -0x90, 0x95, 0x4F, 0xF0, 0x31, 0x3C, 0x50, 0x09, -0x31, 0x49, 0x74, 0x01, 0xF0, 0x31, 0x35, 0x80, -0xF3, 0x12, 0xD3, 0xC9, 0x02, 0xD5, 0x19, 0x22, -0x90, 0x95, 0x46, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x90, 0x95, 0x4A, 0xE0, 0x22, 0x90, 0x95, 0x4F, -0xE0, 0x04, 0xF0, 0x22, 0x90, 0x93, 0x0E, 0xE0, -0xFF, 0x90, 0x95, 0x4F, 0xE0, 0xFE, 0xC3, 0x9F, -0x22, 0x74, 0xBB, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0xF5, 0x83, 0x22, 0xF5, 0x83, 0xEF, 0xF0, -0x90, 0x95, 0x4E, 0xE0, 0x04, 0xF0, 0x22, 0x74, -0xA7, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -0x83, 0xE0, 0xFF, 0x02, 0x7B, 0x07, 0x90, 0x95, -0x4E, 0xE0, 0xFD, 0xC3, 0x22, 0xEF, 0xF0, 0xE4, -0x90, 0x95, 0x4F, 0xF0, 0x22, 0xFC, 0xED, 0x2C, -0xFD, 0x90, 0x8A, 0xE9, 0x22, 0x75, 0xF0, 0x03, -0xA4, 0x24, 0x98, 0xF5, 0x82, 0xE4, 0x34, 0x95, -0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, -0x07, 0x30, 0xE0, 0x12, 0x75, 0x0E, 0x10, 0x80, -0x40, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, -0x05, 0x75, 0x0E, 0x01, 0x80, 0x33, 0x90, 0x88, -0x31, 0x12, 0x8F, 0xDA, 0x30, 0xE0, 0x05, 0x75, -0x0E, 0x02, 0x80, 0x25, 0x90, 0x88, 0x38, 0xE0, -0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x0E, 0x08, -0x80, 0x17, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, -0x0B, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x05, 0x75, -0x0E, 0x11, 0x80, 0x05, 0x12, 0x9F, 0xCA, 0x80, -0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, -0x01, 0xB8, 0xE5, 0x0E, 0xF0, 0x7F, 0x00, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0x06, 0xC0, 0x07, 0x90, 0x94, 0xB9, 0x12, 0x8E, +0xD1, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, +0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, +0x54, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, +0x07, 0x12, 0x8E, 0xD0, 0x78, 0x18, 0x12, 0x03, +0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, +0x00, 0x12, 0x86, 0x54, 0xA3, 0x12, 0x04, 0x31, +0x90, 0x88, 0xA1, 0x12, 0xAF, 0x0F, 0x30, 0xE0, +0x2F, 0x90, 0x94, 0xB0, 0x12, 0x04, 0xB8, 0x90, +0x94, 0xBB, 0x12, 0xCF, 0xE9, 0x40, 0x21, 0x90, +0x94, 0xB0, 0x12, 0x86, 0x61, 0x90, 0x94, 0xBB, +0x12, 0x04, 0xB8, 0x12, 0x86, 0x39, 0xE4, 0xFB, +0x7A, 0x78, 0xF9, 0xF8, 0xC3, 0x12, 0x03, 0xDA, +0x50, 0x06, 0x90, 0x94, 0xB5, 0xE0, 0x04, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x88, +0x9D, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x78, +0x08, 0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, +0xAA, 0x06, 0xAB, 0x07, 0x22, 0x90, 0x02, 0x84, +0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0xA3, 0xE0, 0x44, +0x01, 0xF0, 0x22, 0xE4, 0x90, 0x96, 0xC7, 0xF0, +0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, +0x24, 0xC3, 0x90, 0x96, 0xC8, 0xE0, 0x94, 0xD0, +0x90, 0x96, 0xC7, 0xE0, 0x94, 0x07, 0x40, 0x0A, +0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, 0x7F, +0x00, 0x22, 0x90, 0x96, 0xC7, 0x12, 0x9F, 0xEF, +0x12, 0xB7, 0xAE, 0x80, 0xD5, 0x7F, 0x01, 0x22, +0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0A, 0x91, +0x8D, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, +0x03, 0x91, 0x8D, 0xFF, 0x22, 0x74, 0xFF, 0x9D, +0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, 0xED, +0x5F, 0x22, 0x90, 0x95, 0xBA, 0x12, 0x86, 0x76, +0xE4, 0xFF, 0x90, 0x95, 0xC0, 0xE0, 0xFE, 0xEF, +0xC3, 0x9E, 0x50, 0x16, 0x90, 0x95, 0xBD, 0x12, +0x94, 0xC7, 0xFE, 0x90, 0x95, 0xBA, 0x12, 0x94, +0xC7, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, +0x80, 0xE0, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, +0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x03, 0xE0, +0xFE, 0xEE, 0x54, 0xFE, 0xF0, 0x7D, 0x08, 0xE4, +0xFF, 0x12, 0x7C, 0x7E, 0xE4, 0x90, 0x93, 0x0F, +0xF0, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0x90, 0x93, 0x20, 0xE0, 0x90, 0x95, 0x9C, 0xF0, +0x90, 0x93, 0x21, 0xE0, 0x90, 0x95, 0x9D, 0xF0, +0x90, 0x93, 0x22, 0xE0, 0x90, 0x95, 0x9E, 0xF0, +0x90, 0x93, 0x23, 0xE0, 0x90, 0x95, 0x9F, 0xF0, +0x90, 0x93, 0x24, 0xE0, 0x90, 0x95, 0xA0, 0xF0, +0x90, 0x93, 0x11, 0xE0, 0x90, 0x95, 0xA1, 0xF0, +0x90, 0x93, 0x12, 0xE0, 0x90, 0x95, 0xA2, 0xF0, +0x90, 0x93, 0x13, 0xE0, 0x90, 0x95, 0xA3, 0xF0, +0x90, 0x93, 0x14, 0xE0, 0x90, 0x95, 0xA4, 0xF0, +0x90, 0x93, 0x15, 0xE0, 0x90, 0x95, 0xA5, 0xF0, +0x90, 0x93, 0x16, 0xE0, 0x90, 0x95, 0xA6, 0xF0, +0x90, 0x93, 0x17, 0xE0, 0x90, 0x95, 0xA7, 0xF0, +0x90, 0x93, 0x18, 0xE0, 0x90, 0x95, 0xA8, 0xF0, +0x90, 0x93, 0x19, 0xE0, 0x90, 0x95, 0xA9, 0xF0, +0x90, 0x93, 0x1A, 0xE0, 0x90, 0x95, 0xAA, 0xF0, +0x12, 0xA4, 0x89, 0x90, 0x95, 0x44, 0xF0, 0x12, +0xD9, 0xA5, 0x50, 0x0B, 0x12, 0xD9, 0xDF, 0x74, +0x01, 0xF0, 0x12, 0xD9, 0x91, 0x80, 0xF0, 0x90, +0x01, 0x1F, 0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x12, +0x9B, 0x42, 0x90, 0x95, 0x39, 0xF0, 0xA3, 0x12, +0xD9, 0xF5, 0x12, 0xD9, 0xA5, 0x50, 0x51, 0x12, +0xD9, 0xC0, 0x90, 0x95, 0x44, 0xE0, 0xFE, 0x24, +0xAB, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0x12, 0xDC, +0xA3, 0xE0, 0x24, 0x4D, 0xF5, 0x82, 0xE4, 0x34, +0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x46, 0x2E, +0xF5, 0x82, 0xE4, 0x34, 0x95, 0x12, 0xDC, 0xA3, +0xE0, 0x24, 0x4E, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, +0x7B, 0x01, 0xEE, 0x12, 0xDC, 0xDD, 0x12, 0x86, +0x76, 0x12, 0xDC, 0xA7, 0xE0, 0x24, 0x38, 0xF9, +0xE4, 0x34, 0xFC, 0xFA, 0xEE, 0x12, 0xDA, 0x0E, +0x12, 0x86, 0x76, 0x12, 0xD9, 0x91, 0x80, 0xAA, +0x90, 0x02, 0x87, 0xE0, 0x70, 0x03, 0x02, 0xD9, +0x7D, 0x90, 0x93, 0x03, 0xE0, 0x20, 0xE0, 0x03, +0x02, 0xD9, 0x7D, 0xE4, 0x90, 0x95, 0xB5, 0x12, +0xA4, 0x91, 0x90, 0x95, 0x39, 0xE0, 0xFF, 0xA3, +0xE0, 0xA3, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, +0x95, 0x3B, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, +0x90, 0xFD, 0x11, 0xF0, 0x74, 0x01, 0x2D, 0xF5, +0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, +0x74, 0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, +0xF5, 0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, +0xEA, 0x3E, 0x54, 0x3F, 0x90, 0x95, 0x3D, 0xF0, +0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, +0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, +0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x95, 0x40, +0xF0, 0xFC, 0x74, 0x07, 0x2D, 0xF5, 0x82, 0xE4, +0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0xC0, 0x90, +0x95, 0x42, 0xF0, 0xEC, 0x24, 0x18, 0x90, 0x95, +0x3F, 0xF0, 0xFD, 0x90, 0x95, 0x3B, 0xE0, 0xFE, +0xA3, 0xE0, 0xFF, 0x12, 0xD9, 0x82, 0xEF, 0x54, +0xFC, 0x90, 0x95, 0x41, 0xF0, 0x90, 0x95, 0x40, +0xE0, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0x90, 0x95, +0x3D, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x95, +0x3D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x91, 0x78, +0x90, 0x95, 0x39, 0xEE, 0x8F, 0xF0, 0x12, 0x02, +0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, +0xFF, 0x90, 0x95, 0x39, 0x12, 0xCE, 0x8B, 0x9E, +0x40, 0x1B, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, +0xFF, 0x90, 0x88, 0x27, 0xE0, 0x34, 0x00, 0xFE, +0xC3, 0xED, 0x9F, 0xFF, 0xEC, 0x9E, 0x90, 0x95, +0x39, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x95, 0x41, +0xE0, 0x24, 0xC0, 0x60, 0x03, 0x02, 0xD8, 0xC8, +0x12, 0xD9, 0x98, 0x24, 0x18, 0x12, 0xD9, 0x81, +0xEF, 0x60, 0x03, 0x02, 0xD8, 0xBA, 0x12, 0xD9, +0x98, 0x24, 0x19, 0x12, 0xD9, 0x81, 0x90, 0x95, +0x5A, 0x12, 0xD9, 0xFD, 0x90, 0x95, 0x5A, 0xE0, +0xFF, 0x12, 0xD9, 0xCF, 0x9F, 0x50, 0x18, 0x12, +0xD9, 0x98, 0x24, 0x1A, 0x12, 0xD9, 0x7E, 0x90, +0x95, 0x43, 0xE0, 0x24, 0x5B, 0xF5, 0x82, 0xE4, +0x34, 0x95, 0x12, 0xD9, 0xEA, 0x80, 0xDD, 0x90, +0x95, 0x5A, 0xE0, 0x70, 0x02, 0xE1, 0xE9, 0xE4, +0x90, 0x95, 0x44, 0xF0, 0x12, 0xD9, 0xA5, 0x40, +0x02, 0xE1, 0xD0, 0x12, 0xD9, 0xC0, 0x90, 0x95, +0x44, 0xE0, 0xFF, 0x24, 0x46, 0xF5, 0x82, 0xE4, +0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFE, 0x90, 0x95, +0x5A, 0xE0, 0xFD, 0xEE, 0x6D, 0x70, 0x1F, 0xEF, +0x12, 0xDC, 0xDD, 0x12, 0x86, 0x6D, 0xC0, 0x03, +0xC0, 0x02, 0xC0, 0x01, 0x12, 0xDC, 0x93, 0xED, +0xF0, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x91, +0x9A, 0xEF, 0x60, 0x02, 0x80, 0x4A, 0x90, 0x95, +0x5A, 0xE0, 0x64, 0x03, 0x70, 0x52, 0x12, 0xDC, +0x93, 0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x95, +0x91, 0x9A, 0xEF, 0x70, 0x0F, 0x12, 0xDC, 0x93, +0x74, 0x03, 0xF0, 0x7A, 0x96, 0x79, 0x91, 0x91, +0x9A, 0xEF, 0x60, 0x2C, 0x90, 0x95, 0x44, 0xE0, +0xFF, 0x24, 0xA6, 0xF5, 0x82, 0xE4, 0x34, 0x95, +0xF5, 0x83, 0xE0, 0x60, 0x02, 0x80, 0x0C, 0x90, +0x95, 0x44, 0xE0, 0xFF, 0x24, 0xA1, 0x12, 0xDA, +0x05, 0x60, 0x05, 0x74, 0xB5, 0x2F, 0x80, 0x16, +0x12, 0xD9, 0xB2, 0x74, 0x01, 0xF0, 0x80, 0x13, +0x90, 0x95, 0x44, 0xE0, 0x24, 0xB5, 0x80, 0x06, +0x90, 0x95, 0x44, 0xE0, 0x24, 0xB5, 0x12, 0xD9, +0xB8, 0xE4, 0xF0, 0x12, 0xD9, 0x91, 0xE1, 0x24, +0x90, 0x95, 0xB5, 0xE0, 0x70, 0x52, 0xA3, 0xE0, +0x70, 0x4E, 0xA3, 0xE0, 0x70, 0x4A, 0xA3, 0xE0, +0x70, 0x46, 0xA3, 0xE0, 0x70, 0x42, 0x02, 0xD8, +0xBA, 0xE4, 0x90, 0x95, 0x44, 0xF0, 0x12, 0xD9, +0xA5, 0x50, 0x1D, 0x74, 0xA1, 0x2E, 0x12, 0xDA, +0x05, 0x60, 0x09, 0x74, 0xB5, 0x2E, 0x31, 0xB8, +0xE4, 0xF0, 0x80, 0x08, 0x74, 0xB5, 0x2E, 0x31, +0xB8, 0x74, 0x01, 0xF0, 0x31, 0x91, 0x80, 0xDE, +0x90, 0x95, 0xB5, 0xE0, 0x70, 0x12, 0xA3, 0xE0, +0x70, 0x0E, 0xA3, 0xE0, 0x70, 0x0A, 0xA3, 0xE0, +0x70, 0x06, 0xA3, 0xE0, 0x70, 0x02, 0x01, 0xBA, +0xE4, 0x90, 0x95, 0x44, 0xF0, 0x31, 0xA5, 0x40, +0x02, 0x01, 0xBA, 0x31, 0xC0, 0x31, 0xB2, 0xE0, +0x60, 0x7C, 0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, +0x06, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x6F, 0xE4, +0xFF, 0xFE, 0x90, 0x04, 0x1D, 0xE0, 0x60, 0x10, +0xD3, 0xEF, 0x94, 0xE8, 0xEE, 0x94, 0x03, 0x50, +0x07, 0x0F, 0xBF, 0x00, 0x01, 0x0E, 0x80, 0xEA, +0x90, 0x04, 0x1D, 0xE0, 0x70, 0x50, 0x90, 0x95, +0x44, 0xE0, 0x24, 0x9C, 0xF5, 0x82, 0xE4, 0x34, +0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x92, 0x13, +0x74, 0x06, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, +0x66, 0xDB, 0x90, 0x95, 0x3D, 0xEE, 0xF0, 0xA3, +0x31, 0xFD, 0x31, 0xCF, 0x94, 0x06, 0x50, 0x1C, +0x31, 0x98, 0x24, 0x0A, 0x31, 0x7E, 0x90, 0x95, +0x3D, 0xA3, 0xE0, 0xFE, 0x90, 0x95, 0x43, 0xE0, +0x2E, 0x24, 0x2C, 0xF5, 0x82, 0xE4, 0x34, 0xFC, +0x31, 0xEA, 0x80, 0xDE, 0x90, 0x04, 0x1F, 0x74, +0x20, 0xF0, 0x90, 0x06, 0x35, 0xF0, 0x31, 0x91, +0x01, 0x2D, 0x31, 0xD6, 0x12, 0xD4, 0x35, 0x90, +0x06, 0x36, 0x74, 0xDD, 0xF0, 0x02, 0xD5, 0xE0, +0x90, 0x95, 0x42, 0xE0, 0x60, 0x02, 0x21, 0x75, +0x31, 0x98, 0x24, 0x16, 0x31, 0x81, 0x90, 0x06, +0x34, 0xEF, 0xF0, 0x31, 0x98, 0x24, 0x17, 0x31, +0x81, 0x90, 0x06, 0x37, 0x31, 0xF5, 0x31, 0xA5, +0x50, 0x38, 0x31, 0xC0, 0xE4, 0x90, 0x95, 0x43, +0xF0, 0x31, 0xCF, 0x94, 0x06, 0x50, 0x27, 0x31, +0x98, 0x24, 0x04, 0x2D, 0x31, 0x81, 0x90, 0x95, +0x44, 0xE0, 0xFE, 0x51, 0x0E, 0x12, 0x86, 0x6D, +0x90, 0x95, 0x43, 0xE0, 0xF5, 0x82, 0x12, 0x94, +0xCC, 0x6F, 0x60, 0x06, 0x31, 0xDF, 0xE4, 0xF0, +0x80, 0x04, 0x31, 0xEE, 0x80, 0xD3, 0x31, 0x91, +0x80, 0xC4, 0x90, 0x95, 0xB0, 0xE0, 0x64, 0x01, +0x60, 0x17, 0xA3, 0xE0, 0x64, 0x01, 0x60, 0x11, +0xA3, 0xE0, 0x64, 0x01, 0x60, 0x0B, 0xA3, 0xE0, +0x64, 0x01, 0x60, 0x05, 0xA3, 0xE0, 0xB4, 0x01, +0x06, 0x90, 0x95, 0x45, 0x74, 0x01, 0xF0, 0x90, +0x95, 0x45, 0xE0, 0xB4, 0x01, 0x13, 0x12, 0xD4, +0xC5, 0x90, 0x93, 0x03, 0xE0, 0x44, 0x20, 0xF0, +0x12, 0xBD, 0xD6, 0x12, 0xBC, 0x7A, 0x02, 0xD5, +0xE0, 0x12, 0xA4, 0x89, 0x90, 0x95, 0x44, 0xF0, +0x31, 0xA5, 0x50, 0x09, 0x31, 0xDF, 0x74, 0x01, +0xF0, 0x31, 0x91, 0x80, 0xF3, 0x31, 0xD6, 0x12, +0xD4, 0x35, 0x02, 0xD5, 0xE0, 0x22, 0xFC, 0xED, +0x2C, 0xFD, 0x90, 0x8A, 0xE9, 0xE0, 0xFA, 0xA3, +0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, +0x7E, 0x90, 0x95, 0x44, 0xE0, 0x04, 0xF0, 0x22, +0x90, 0x95, 0x3B, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, +0x90, 0x95, 0x3F, 0xE0, 0x22, 0x90, 0x93, 0x0E, +0xE0, 0xFF, 0x90, 0x95, 0x44, 0xE0, 0xFE, 0xC3, +0x9F, 0x22, 0x90, 0x95, 0x44, 0xE0, 0x24, 0xB5, +0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, +0x74, 0x9C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, +0xF5, 0x83, 0xE0, 0xFF, 0x02, 0x7B, 0x07, 0x90, +0x95, 0x43, 0xE0, 0xFD, 0xC3, 0x22, 0x90, 0x95, +0x39, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x74, +0xB0, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, +0x83, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, +0x43, 0xE0, 0x04, 0xF0, 0x22, 0xEF, 0xF0, 0xE4, +0x90, 0x95, 0x44, 0xF0, 0x22, 0xEF, 0xF0, 0xE4, +0x90, 0x95, 0x43, 0xF0, 0x22, 0xF5, 0x82, 0xE4, +0x34, 0x95, 0xF5, 0x83, 0xE0, 0x22, 0x75, 0xF0, +0x03, 0xA4, 0x24, 0x8D, 0xF5, 0x82, 0xE4, 0x34, +0x95, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, -0xE0, 0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, -0x75, 0x0F, 0x40, 0x41, 0xAE, 0x90, 0x88, 0x38, -0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, -0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, -0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, -0x75, 0x0F, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, -0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x0F, -0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, -0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x0F, 0x04, -0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x0F, -0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, -0xE4, 0x05, 0x75, 0x0F, 0x10, 0x80, 0x3F, 0x90, -0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, -0xE0, 0x05, 0x75, 0x0F, 0x20, 0x80, 0x2F, 0x90, -0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x0F, 0x80, -0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, -0x05, 0x75, 0x0F, 0x11, 0x80, 0x18, 0x90, 0x06, -0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, -0xFF, 0xBF, 0x80, 0x05, 0x75, 0x0F, 0x12, 0x80, -0x05, 0x12, 0x9F, 0xCA, 0x80, 0x0E, 0x90, 0x01, -0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, -0x0F, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x12, 0xAF, 0xCF, 0x40, 0x3F, 0x90, 0x88, -0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, -0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, -0x2C, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, -0x88, 0x3F, 0x71, 0x08, 0x33, 0x33, 0x33, 0x54, -0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, -0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, -0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, -0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0xFF, 0xA3, -0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, -0x90, 0x93, 0x29, 0xE0, 0x30, 0xE0, 0x34, 0xC4, -0x13, 0x54, 0x07, 0x30, 0xE0, 0x2D, 0x90, 0x96, -0xC7, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0xC8, -0x40, 0x21, 0x90, 0x93, 0x29, 0xE0, 0x54, 0xDF, -0xF0, 0xE4, 0x90, 0x96, 0xC7, 0xF0, 0x90, 0x93, -0x29, 0xE0, 0x13, 0x30, 0xE0, 0x0D, 0x90, 0x88, -0x31, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x88, 0x41, -0x74, 0xD0, 0xF0, 0x22, 0x74, 0x76, 0x25, 0x65, -0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE4, -0xF0, 0x74, 0xF6, 0x25, 0x65, 0xF5, 0x82, 0xE4, -0x34, 0x8D, 0xF5, 0x83, 0x22, 0x90, 0x05, 0x63, -0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, 0x62, -0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, 0x61, -0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, 0x60, -0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, 0x32, -0xE0, 0x44, 0x80, 0xF0, 0x22, 0x74, 0x76, 0x25, -0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, -0x22, 0x74, 0x4F, 0x25, 0x65, 0xF5, 0x82, 0xE4, -0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xA6, 0x25, -0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, -0x22, 0xF5, 0x83, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -0xD3, 0x9F, 0xEC, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0xC3, 0x74, 0xFF, 0x9F, 0xFF, 0x74, 0xFF, -0x9E, 0xFE, 0xE5, 0x65, 0x22, 0x35, 0xF0, 0xFE, -0x90, 0x00, 0x06, 0x12, 0x03, 0x3E, 0x2F, 0xFF, -0xEE, 0x35, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, -0x79, 0x66, 0x90, 0x95, 0xC8, 0x12, 0x86, 0x76, -0x90, 0x95, 0xCB, 0x22, 0x90, 0x95, 0x4F, 0xE0, -0x24, 0xC0, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -0x83, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x74, 0xB6, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -0x22, 0xE5, 0x67, 0x25, 0xE0, 0x24, 0x75, 0xF5, -0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0x75, -0xF0, 0x08, 0xA4, 0x24, 0x00, 0xF5, 0x82, 0xE4, -0x34, 0x82, 0xF5, 0x83, 0x22, 0xE0, 0xFE, 0xA3, -0xE0, 0xFF, 0xED, 0x2F, 0xFF, 0xEC, 0x3E, 0x22, -0x90, 0x95, 0x44, 0x12, 0x86, 0x6D, 0x90, 0x00, -0x08, 0x02, 0x03, 0x3E, 0x75, 0xF0, 0x03, 0xA4, -0x24, 0x56, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -0x83, 0x22, 0xFE, 0x90, 0x00, 0x04, 0x02, 0x03, -0x3E, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, 0x88, -0x38, 0xE0, 0x90, 0x01, 0xBB, 0x22, 0xE5, 0x65, -0x25, 0xE0, 0x24, 0x86, 0xF5, 0x82, 0xE4, 0x34, -0x8E, 0x22, 0x74, 0xA6, 0x25, 0x65, 0xF5, 0x82, -0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x74, 0x5F, -0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -0x83, 0x22, 0x74, 0xE6, 0x25, 0x65, 0xF5, 0x82, -0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xB6, -0x25, 0x65, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -0x83, 0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x25, 0xE0, -0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, -0x25, 0xE0, 0x24, 0x26, 0xF5, 0x82, 0xE4, 0x34, -0x8E, 0x22, 0x25, 0xE0, 0x24, 0x56, 0xF5, 0x82, -0xE4, 0x34, 0x8E, 0x22, 0x90, 0x95, 0x44, 0x02, -0x86, 0x6D, 0xFE, 0x54, 0x10, 0xFD, 0xEF, 0x54, -0xEF, 0x4D, 0xFF, 0x22, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0xF5, 0x83, 0xE0, 0x22, 0xEF, 0xF0, 0xE4, -0x90, 0x95, 0x4E, 0xF0, 0x22, 0x25, 0xE0, 0x25, -0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x90, 0x95, 0x4B, -0xE0, 0xFE, 0xA3, 0xE0, 0x22, 0x90, 0x00, 0x02, -0x12, 0x03, 0x3E, 0xFF, 0x22, 0x93, 0xFD, 0x7C, -0x00, 0x02, 0x02, 0x80, 0xE5, 0x67, 0x90, 0x81, -0x9D, 0x93, 0xFF, 0x22, 0x90, 0x94, 0xC1, 0x74, -0x06, 0xF0, 0xA3, 0x22, 0x5E, 0xD1 +0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, +0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x10, 0x10, +0x80, 0x44, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, +0x60, 0x05, 0x75, 0x10, 0x01, 0x80, 0x37, 0x90, +0x88, 0x31, 0x12, 0xAD, 0x26, 0x30, 0xE0, 0x05, +0x75, 0x10, 0x02, 0x80, 0x29, 0x90, 0x88, 0x38, +0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x10, +0x08, 0x80, 0x1B, 0x90, 0x93, 0x29, 0xE0, 0x30, +0xE0, 0x0B, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x05, +0x75, 0x10, 0x11, 0x80, 0x09, 0x90, 0x01, 0xB8, +0xE4, 0xF0, 0x7F, 0x01, 0x80, 0x0E, 0x90, 0x01, +0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, +0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x1E, 0x90, +0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x11, 0x40, +0x61, 0x3F, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, +0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, +0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, +0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x11, 0x01, +0x80, 0x75, 0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, +0x03, 0x60, 0x05, 0x75, 0x11, 0x02, 0x80, 0x67, +0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, +0x50, 0x05, 0x75, 0x11, 0x04, 0x80, 0x58, 0xEF, +0x30, 0xE2, 0x05, 0x75, 0x11, 0x08, 0x80, 0x4F, +0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, +0x11, 0x10, 0x80, 0x43, 0x90, 0x88, 0x32, 0xE0, +0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, +0x11, 0x20, 0x80, 0x33, 0x90, 0x88, 0x9C, 0xE0, +0x60, 0x05, 0x75, 0x11, 0x80, 0x80, 0x28, 0x90, +0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, 0x11, +0x11, 0x80, 0x1C, 0x90, 0x06, 0x62, 0xE0, 0x30, +0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, +0x05, 0x75, 0x11, 0x12, 0x80, 0x09, 0x90, 0x01, +0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x80, 0x0E, 0x90, +0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, +0xE5, 0x11, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, +0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, +0x60, 0x05, 0x75, 0x61, 0x01, 0x80, 0x34, 0x90, +0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x61, 0x10, +0x80, 0x29, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, +0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, +0xE3, 0x05, 0x75, 0x61, 0x04, 0x80, 0x14, 0x90, +0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x61, +0x20, 0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, +0x7F, 0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, +0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x61, 0xF0, 0x7F, +0x00, 0x22, 0x90, 0x94, 0xA1, 0x74, 0x01, 0xF0, +0x90, 0x06, 0x92, 0x04, 0xF0, 0x90, 0x01, 0x3C, +0x74, 0x04, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x44, +0x08, 0xF0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, +0x60, 0x16, 0x90, 0x8A, 0xB9, 0x12, 0x8B, 0x46, +0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, +0x8A, 0xF9, 0x12, 0x8B, 0x46, 0x12, 0xA9, 0x17, +0x90, 0x8A, 0xAF, 0x12, 0x8B, 0x46, 0x7D, 0x08, +0xE4, 0xFF, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x8D, +0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, +0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, +0xA3, 0xF0, 0x22, 0x91, 0x4C, 0x9F, 0x40, 0x3A, +0x90, 0x88, 0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, +0x92, 0xE0, 0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, +0x9F, 0x50, 0x27, 0x90, 0x88, 0x48, 0xE0, 0x24, +0x08, 0xF0, 0x90, 0x88, 0x3F, 0x12, 0xAD, 0x8C, +0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, +0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, +0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, +0x91, 0x43, 0x22, 0x90, 0x92, 0x98, 0x74, 0x03, +0xF0, 0x02, 0x6E, 0x2F, 0x90, 0x88, 0x93, 0xE0, +0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, 0x22, 0x90, +0x93, 0x29, 0xE0, 0x30, 0xE0, 0x34, 0xC4, 0x13, +0x54, 0x07, 0x30, 0xE0, 0x2D, 0x90, 0x96, 0xD2, +0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0xC8, 0x40, +0x21, 0x90, 0x93, 0x29, 0xE0, 0x54, 0xDF, 0xF0, +0xE4, 0x90, 0x96, 0xD2, 0xF0, 0x90, 0x93, 0x29, +0xE0, 0x13, 0x30, 0xE0, 0x0D, 0x90, 0x88, 0x31, +0xE0, 0x44, 0x01, 0xF0, 0x90, 0x88, 0x41, 0x74, +0xD0, 0xF0, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, +0x5B, 0x90, 0x95, 0xBD, 0x12, 0x86, 0x76, 0x90, +0x95, 0xC0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x74, +0xAB, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, +0x83, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, +0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x4F, +0x22, 0x7F, 0xFB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, +0xEF, 0x64, 0x01, 0x22, 0x24, 0x03, 0xFF, 0xE4, +0x33, 0xFE, 0x90, 0x96, 0x87, 0x12, 0x86, 0x6D, +0x8F, 0x82, 0x8E, 0x83, 0x22, 0x75, 0xF0, 0x03, +0xA4, 0x24, 0x4B, 0xF5, 0x82, 0xE4, 0x34, 0x95, +0xF5, 0x83, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, +0x90, 0x88, 0x38, 0xE0, 0x90, 0x01, 0xBB, 0x22, +0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, 0x85, 0xF0, +0x83, 0x02, 0x03, 0x3E, 0x90, 0x93, 0x29, 0xE0, +0xC3, 0x13, 0x22, 0x74, 0xA6, 0x25, 0x62, 0xF5, +0x82, 0xE4, 0x34, 0x8E, 0x22, 0x74, 0x5F, 0x25, +0x62, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0x22, 0x74, +0xE6, 0x25, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x8D, +0x22, 0xE5, 0x62, 0x25, 0xE0, 0x24, 0x86, 0xF5, +0x82, 0xE4, 0x22, 0x74, 0xB6, 0x25, 0x62, 0xF5, +0x82, 0xE4, 0x34, 0x8D, 0x22, 0xFE, 0x54, 0x10, +0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, 0x54, +0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, 0x22, +0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x93, 0x2B, +0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x54, +0x07, 0x22, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, +0xEB, 0xF0, 0x22, 0xF0, 0xEE, 0x54, 0x20, 0xFE, +0xEF, 0x54, 0xDF, 0x22, 0xF0, 0xEE, 0x54, 0x08, +0xFE, 0xEF, 0x54, 0xF7, 0x22, 0x12, 0x02, 0x06, +0xFF, 0x54, 0x01, 0xFE, 0x22, 0x8C, 0x83, 0xE4, +0xFD, 0x02, 0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, +0x54, 0xFE, 0xF0, 0x22, 0x25, 0xE0, 0x25, 0xE0, +0xFE, 0xEF, 0x4E, 0x22, 0x7F, 0xF9, 0x7E, 0x01, +0x02, 0x5F, 0xA6, 0x90, 0x88, 0x31, 0xE0, 0x54, +0xF7, 0xF0, 0x22, 0x00, 0x4B, 0xD1 }; -u32 array_length_mp_8723d_fw_ap = 23862; +u32 array_length_mp_8723d_fw_ap = 24014; #endif /*defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))*/ #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) u8 array_mp_8723d_fw_nic[] = { -0xD1, 0x23, 0x10, 0x00, 0x1B, 0x00, 0x00, 0x00, -0x12, 0x07, 0x14, 0x07, 0x52, 0x6B, 0x02, 0x00, +0xD1, 0x23, 0x10, 0x00, 0x27, 0x00, 0x00, 0x00, +0x09, 0x15, 0x17, 0x38, 0x2E, 0x6C, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x86, 0x71, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xD3, 0x74, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xD5, 0x5E, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xE5, 0x25, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xDD, 0xBD, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xE0, 0xAF, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xE1, 0x07, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xE4, 0xCF, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xBF, 0x08, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xB9, 0x5E, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xDD, 0x67, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, @@ -3150,7 +3164,7 @@ u8 array_mp_8723d_fw_nic[] = { 0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, -0x76, 0x30, 0x90, 0x86, 0xF4, 0x74, 0x01, 0x93, +0x76, 0x30, 0x90, 0x86, 0xFD, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, @@ -3169,7 +3183,7 @@ u8 array_mp_8723d_fw_nic[] = { 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x8A, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -0x04, 0x90, 0x86, 0xF4, 0x93, 0xF6, 0x08, 0xEF, +0x04, 0x90, 0x86, 0xFD, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, @@ -3237,7 +3251,7 @@ u8 array_mp_8723d_fw_nic[] = { 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, -0x86, 0xFA, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, +0x86, 0xF4, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, @@ -3245,2049 +3259,747 @@ u8 array_mp_8723d_fw_nic[] = { 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, -0xDE, 0xE7, 0x80, 0xBE, 0xC9, 0x2C, 0xDC, 0x0C, -0xD5, 0xD8, 0x41, 0x97, 0x14, 0x00, 0x00, 0x90, -0x97, 0x12, 0xEF, 0xF0, 0x7F, 0x02, 0xB1, 0x27, -0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x97, 0x12, -0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, -0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x12, 0x02, -0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, 0x90, 0x86, -0xB4, 0xF0, 0xF1, 0xA6, 0xFF, 0xED, 0x2F, 0x90, -0x86, 0xB5, 0xF1, 0x72, 0xFF, 0xED, 0x2F, 0x90, -0x86, 0xB6, 0x12, 0x8F, 0xD6, 0xFF, 0xED, 0x2F, -0x90, 0x86, 0xB7, 0xF1, 0xFB, 0xFF, 0xED, 0x2F, -0x90, 0x86, 0xB8, 0xF1, 0x61, 0xFF, 0xED, 0x2F, -0x90, 0x86, 0xB9, 0xF1, 0x68, 0xFF, 0xAE, 0x05, -0xED, 0x2F, 0x90, 0x86, 0xBA, 0xF0, 0x22, 0x4E, -0xFF, 0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, -0xF0, 0x90, 0x00, 0x06, 0x02, 0x02, 0x1F, 0x90, -0x95, 0x59, 0xF0, 0x90, 0x00, 0x02, 0x02, 0x02, -0x1F, 0x8B, 0x61, 0x8A, 0x62, 0x89, 0x63, 0x12, -0x02, 0x06, 0x90, 0x93, 0x60, 0xF0, 0xF1, 0xA6, -0x90, 0x93, 0x61, 0xF1, 0x72, 0x90, 0x93, 0x7B, -0x12, 0x8F, 0xD6, 0x90, 0x93, 0x7C, 0xF1, 0xFB, -0x90, 0x93, 0x96, 0xF1, 0x61, 0x90, 0x93, 0x97, -0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x00, -0x01, 0x02, 0x02, 0x1F, 0x12, 0x8F, 0xE8, 0xF1, -0xA2, 0xFE, 0x54, 0x03, 0xFD, 0xEE, 0x13, 0x13, -0x54, 0x07, 0xFB, 0xC0, 0x03, 0x12, 0x8A, 0x44, -0xF1, 0x73, 0x12, 0xEA, 0x65, 0xD0, 0x03, 0x12, -0xA7, 0x28, 0x12, 0x8A, 0x44, 0xF1, 0xA6, 0xFE, -0x54, 0x03, 0x12, 0x9A, 0x94, 0x90, 0x95, 0x5A, -0x74, 0x10, 0xF0, 0x90, 0x95, 0x7C, 0x74, 0x07, -0x12, 0x8A, 0x43, 0x12, 0x02, 0x06, 0x90, 0x95, -0x5C, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x5A, -0x12, 0x8E, 0xB7, 0x7F, 0x04, 0x02, 0x04, 0x7E, -0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x04, 0x02, -0x02, 0x1F, 0xF1, 0xE8, 0x90, 0x93, 0xE7, 0xE0, -0x70, 0x12, 0x51, 0x44, 0x12, 0x02, 0x06, 0x13, -0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, 0x93, -0xED, 0x74, 0x01, 0xF0, 0x90, 0x93, 0xE9, 0xE0, -0x70, 0x12, 0x51, 0x44, 0x12, 0x02, 0x06, 0xC4, -0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x93, -0xEE, 0x74, 0x01, 0xF0, 0x51, 0x44, 0x12, 0x87, -0xA6, 0xFF, 0x90, 0x95, 0x5B, 0xF0, 0x12, 0x02, -0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0B, 0x51, 0x44, -0x12, 0x87, 0x73, 0x90, 0x95, 0x5C, 0xF0, 0x80, -0x05, 0x90, 0x95, 0x5C, 0xEF, 0xF0, 0x90, 0x95, -0x5B, 0xE0, 0x90, 0x95, 0x5A, 0xF0, 0x90, 0x95, -0x5C, 0xE0, 0xFE, 0x90, 0x95, 0x5A, 0xE0, 0xFF, -0xD3, 0x9E, 0x50, 0x39, 0x51, 0x44, 0x12, 0x02, +0xDE, 0xE7, 0x80, 0xBE, 0x41, 0x97, 0x40, 0x00, +0x41, 0x97, 0x44, 0x00, 0x00, 0xBF, 0x5F, 0xD9, +0xE4, 0xDC, 0xF1, 0x90, 0x97, 0x3F, 0xEF, 0xF0, +0x7F, 0x02, 0xB1, 0x27, 0x90, 0x86, 0xAF, 0xE0, +0xFF, 0x90, 0x97, 0x3F, 0xE0, 0xFE, 0xEF, 0x4E, +0x90, 0x86, 0xAF, 0xF0, 0x22, 0x90, 0x02, 0x09, +0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, +0xED, 0x2E, 0x90, 0x86, 0xB4, 0xF0, 0x12, 0x8F, +0x98, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF0, +0xF1, 0xF1, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, +0xF1, 0x9E, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB7, +0xF1, 0x6D, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, +0xF1, 0x66, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB9, +0xF1, 0xF7, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, +0x86, 0xBA, 0xF0, 0x22, 0x4E, 0xFF, 0xF0, 0x90, +0x00, 0x05, 0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, +0x04, 0x02, 0x02, 0x1F, 0x12, 0xAC, 0x9E, 0x12, +0x02, 0x06, 0x90, 0x93, 0x60, 0xF0, 0x12, 0x8F, +0x98, 0x90, 0x93, 0x61, 0xF0, 0xF1, 0xF1, 0x90, +0x93, 0x7B, 0xF1, 0x9E, 0x90, 0x93, 0x7C, 0xF1, +0x6D, 0x90, 0x93, 0x96, 0xF1, 0x66, 0x90, 0x93, +0x97, 0xF0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, +0x00, 0x03, 0x02, 0x02, 0x1F, 0x12, 0x02, 0x06, +0xFE, 0xF1, 0xF1, 0xFF, 0x74, 0xD6, 0x2E, 0xF5, +0x82, 0xE4, 0x34, 0x8D, 0xF1, 0x9B, 0xFF, 0x74, +0xC6, 0x2E, 0x12, 0x9D, 0x7B, 0xEF, 0xF1, 0x6D, +0xFF, 0x74, 0x4D, 0x2E, 0x12, 0xEC, 0x0B, 0xEF, +0xF0, 0x74, 0xC6, 0x2E, 0x12, 0x9D, 0x7B, 0xE0, +0x30, 0xE5, 0x18, 0x75, 0xF0, 0x12, 0xEE, 0x12, +0x9B, 0xEB, 0x13, 0x13, 0x54, 0x03, 0xFB, 0xAF, +0x06, 0x74, 0xD6, 0x2E, 0x12, 0x9A, 0x7F, 0xFD, +0x12, 0x6B, 0xFD, 0x22, 0x90, 0x95, 0x4E, 0xD1, +0x39, 0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, 0xF0, +0x90, 0x00, 0x06, 0x02, 0x02, 0x1F, 0x12, 0xBD, +0xE7, 0x90, 0x93, 0xE7, 0xE0, 0x70, 0x12, 0x51, +0x4E, 0x12, 0x02, 0x06, 0x13, 0x13, 0x54, 0x3F, +0x30, 0xE0, 0x06, 0x90, 0x93, 0xED, 0x74, 0x01, +0xF0, 0x90, 0x93, 0xE9, 0xE0, 0x70, 0x12, 0x51, +0x4E, 0x12, 0x02, 0x06, 0xC4, 0x54, 0x0F, 0xFF, +0xBF, 0x05, 0x06, 0x90, 0x93, 0xEE, 0x74, 0x01, +0xF0, 0xF1, 0x92, 0xFF, 0x90, 0x95, 0x52, 0xF0, +0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, 0xE0, 0x09, +0x12, 0x87, 0xEC, 0x90, 0x95, 0x53, 0xF0, 0x80, +0x05, 0x90, 0x95, 0x53, 0xEF, 0xF0, 0x90, 0x95, +0x52, 0xE0, 0x90, 0x95, 0x51, 0xF0, 0x90, 0x95, +0x53, 0xE0, 0xFE, 0x90, 0x95, 0x51, 0xE0, 0xFF, +0xD3, 0x9E, 0x50, 0x39, 0x51, 0x4E, 0x12, 0x02, 0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, -0x95, 0x5A, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, -0x90, 0x95, 0x5A, 0x70, 0x06, 0xE0, 0xFF, 0xF1, -0xEE, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xD7, 0xCE, +0x95, 0x51, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, +0x90, 0x95, 0x51, 0x70, 0x06, 0xE0, 0xFF, 0xF1, +0xF1, 0x80, 0x05, 0xE0, 0xFF, 0x12, 0xCF, 0xAE, 0x90, 0x93, 0xEE, 0xE0, 0x60, 0x07, 0x90, 0x95, -0x5A, 0xE0, 0xFF, 0xF1, 0xEE, 0x90, 0x95, 0x5A, +0x51, 0xE0, 0xFF, 0xF1, 0xF1, 0x90, 0x95, 0x51, 0xE0, 0x04, 0xF0, 0x80, 0xB9, 0x90, 0x05, 0x5E, -0xE4, 0xF0, 0x90, 0x95, 0x5B, 0xE0, 0x70, 0x1A, +0xE4, 0xF0, 0x90, 0x95, 0x52, 0xE0, 0x70, 0x1A, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, 0x90, -0x86, 0x0C, 0xB1, 0x33, 0x90, 0x8A, 0xED, 0xB1, -0x33, 0x12, 0xE3, 0xA8, 0x54, 0xBF, 0xF0, 0x54, -0x7F, 0xF0, 0x22, 0x90, 0x95, 0x54, 0x12, 0x86, -0x42, 0x90, 0x95, 0x53, 0xEF, 0xF0, 0x12, 0x86, -0x4B, 0x89, 0x5E, 0x00, 0x89, 0x63, 0x01, 0x89, -0x67, 0x06, 0x89, 0x78, 0x10, 0x89, 0x7D, 0x12, -0x89, 0x82, 0x14, 0x8A, 0x3C, 0x15, 0x89, 0x87, -0x16, 0x89, 0x8C, 0x18, 0x89, 0x91, 0x19, 0x89, -0x96, 0x1B, 0x89, 0x9B, 0x1C, 0x89, 0xA0, 0x1E, -0x89, 0xA5, 0x20, 0x89, 0xA9, 0x24, 0x89, 0xAE, -0x25, 0x89, 0xB3, 0x27, 0x89, 0xB8, 0x29, 0x89, -0xBD, 0x2A, 0x89, 0xC2, 0x40, 0x89, 0xC9, 0x42, -0x8A, 0x3C, 0x47, 0x89, 0xD4, 0x49, 0x89, 0xD9, -0x60, 0x89, 0xDD, 0x61, 0x89, 0xE2, 0x62, 0x89, -0xE7, 0x63, 0x89, 0xEC, 0x64, 0x89, 0xF1, 0x65, -0x89, 0xF6, 0x66, 0x89, 0xFB, 0x67, 0x8A, 0x00, -0x68, 0x8A, 0x05, 0x69, 0x8A, 0x0A, 0x6B, 0x8A, -0x0F, 0x6C, 0x8A, 0x14, 0x6D, 0x8A, 0x19, 0x6E, -0x8A, 0x1E, 0x6F, 0x8A, 0x23, 0x70, 0x8A, 0x28, -0xC3, 0x89, 0x6C, 0xC6, 0x89, 0x6C, 0xC7, 0x89, -0x6C, 0xC8, 0x00, 0x00, 0x8A, 0x2D, 0x51, 0x3D, -0x02, 0x87, 0x19, 0x51, 0x3D, 0x01, 0x02, 0x51, -0x3D, 0x02, 0xB1, 0x0E, 0x90, 0x95, 0x53, 0xE0, -0xFF, 0xA3, 0x12, 0x86, 0x39, 0x02, 0xB1, 0xAD, -0x51, 0x3D, 0x02, 0x98, 0x04, 0x51, 0x3D, 0x02, -0xAF, 0xF3, 0x51, 0x3D, 0x02, 0xB7, 0xE5, 0x51, -0x3D, 0x02, 0x87, 0x79, 0x51, 0x3D, 0x02, 0x9F, -0xF9, 0x51, 0x3D, 0x02, 0xA8, 0x6D, 0x51, 0x3D, -0x02, 0xA9, 0x14, 0x51, 0x3D, 0x02, 0x87, 0xAC, -0x51, 0x3D, 0x02, 0xB0, 0xBA, 0x51, 0x3D, 0xC1, -0xD2, 0x51, 0x3D, 0x02, 0xB7, 0xF4, 0x51, 0x3D, -0x02, 0xBF, 0xE0, 0x51, 0x3D, 0x02, 0xA9, 0x85, -0x51, 0x3D, 0x02, 0xC8, 0xA3, 0x51, 0x3D, 0x02, -0xC7, 0xD7, 0x51, 0x3D, 0x90, 0x8A, 0xA5, 0x80, -0x05, 0x51, 0x3D, 0x90, 0x8A, 0xB5, 0x12, 0xCE, -0xA8, 0x02, 0x04, 0x7E, 0x51, 0x3D, 0x02, 0xE6, -0x6F, 0x51, 0x3D, 0x80, 0x6D, 0x51, 0x3D, 0x02, -0x77, 0x4F, 0x51, 0x3D, 0x02, 0x7C, 0x60, 0x51, -0x3D, 0x02, 0x7A, 0xC6, 0x51, 0x3D, 0x02, 0x5D, -0x36, 0x51, 0x3D, 0x02, 0x7B, 0xE9, 0x51, 0x3D, -0x02, 0x70, 0x33, 0x51, 0x3D, 0x02, 0x48, 0xC9, -0x51, 0x3D, 0x02, 0x79, 0xF3, 0x51, 0x3D, 0x02, -0xCF, 0xC3, 0x51, 0x3D, 0x02, 0x51, 0x7B, 0x51, -0x3D, 0x02, 0x79, 0x30, 0x51, 0x3D, 0x02, 0x57, -0xF2, 0x51, 0x3D, 0x02, 0x74, 0x8D, 0x51, 0x3D, -0x02, 0x78, 0x9A, 0x51, 0x3D, 0x02, 0x5E, 0x0B, -0x51, 0x3D, 0x02, 0xCF, 0x53, 0x90, 0x01, 0xC0, -0xE0, 0x44, 0x01, 0xF0, 0x90, 0x95, 0x53, 0xE0, -0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, 0x95, 0x54, -0x02, 0x86, 0x39, 0xF0, 0x90, 0x95, 0x57, 0x02, -0x86, 0x39, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0xF1, 0xE8, 0x12, 0xA9, 0x7D, 0x90, 0x88, -0x9D, 0x12, 0xEA, 0x4A, 0x4F, 0xF0, 0xFC, 0x12, -0x02, 0x06, 0xFD, 0x54, 0x04, 0x13, 0x13, 0x54, -0x3F, 0xFF, 0x90, 0x95, 0x37, 0xE0, 0x54, 0xFE, -0x4F, 0xF0, 0xED, 0x54, 0x08, 0xFF, 0xEC, 0x54, -0xF7, 0x4F, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0x12, -0x02, 0x06, 0x12, 0xEB, 0x17, 0xFF, 0x90, 0x88, -0x9D, 0x12, 0xEB, 0x0E, 0x4E, 0xFF, 0xF0, 0x12, -0x02, 0x06, 0xFE, 0x54, 0x40, 0xFD, 0xEF, 0x54, -0xBF, 0x4D, 0xFF, 0x90, 0x88, 0x9D, 0xF0, 0xEE, -0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x4E, 0x51, -0x43, 0xE9, 0x24, 0x01, 0xF9, 0xE4, 0x3A, 0x8B, -0x45, 0x12, 0xEB, 0x47, 0x7B, 0x01, 0x7A, 0x88, -0x79, 0x9E, 0x12, 0x69, 0xF5, 0x51, 0x44, 0x12, -0x02, 0x06, 0x20, 0xE0, 0x02, 0x81, 0x72, 0x90, -0x05, 0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, -0xC3, 0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, -0xA0, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x15, -0x12, 0x87, 0xA6, 0x90, 0x88, 0x9E, 0xF0, 0x24, -0x0A, 0x90, 0x88, 0xCF, 0x12, 0x87, 0x72, 0x90, -0x88, 0x9F, 0xF0, 0x80, 0x4B, 0x12, 0x87, 0xA6, -0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x15, 0xEF, 0xC3, -0x94, 0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, -0x03, 0x80, 0x0D, 0x12, 0x87, 0xA6, 0x90, 0x88, -0x9E, 0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, -0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0x12, -0x87, 0x73, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, -0xEF, 0xC3, 0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, -0x05, 0x74, 0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, -0x80, 0x06, 0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, -0x12, 0xA6, 0xFD, 0x30, 0xE0, 0x3D, 0x90, 0x88, -0x9E, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, -0xA6, 0xF0, 0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, -0x88, 0x9F, 0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, -0x88, 0xA8, 0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, -0x13, 0x90, 0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, -0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, -0x01, 0x3E, 0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, -0x12, 0x7C, 0x05, 0xE4, 0x90, 0x88, 0xDD, 0x51, -0x43, 0xF1, 0xD7, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x20, 0xE0, 0x37, 0x90, 0x88, 0x9D, 0xE0, 0xC3, -0x13, 0x20, 0xE0, 0x06, 0xE0, 0xF1, 0xE1, 0x30, -0xE0, 0x28, 0x12, 0xEB, 0x05, 0x30, 0xE0, 0x08, -0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, 0x80, 0x0B, -0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0x75, 0x61, -0x01, 0x80, 0x03, 0xE4, 0xF5, 0x61, 0x90, 0x8A, -0xF3, 0xD1, 0xC9, 0x7D, 0x02, 0xAF, 0x61, 0x12, -0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, 0xC4, 0x54, -0x0F, 0x30, 0xE0, 0x1D, 0x90, 0x88, 0xA1, 0xE0, -0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0C, 0x90, -0x8A, 0x89, 0xD1, 0xC9, 0x7D, 0x04, 0x7F, 0x02, -0x12, 0x04, 0x7E, 0x12, 0xEB, 0x3F, 0x74, 0x11, -0xF0, 0x90, 0x95, 0x37, 0xE0, 0x30, 0xE0, 0x33, -0x90, 0x95, 0x40, 0x74, 0x01, 0xF0, 0xE4, 0xA3, -0xF0, 0x90, 0x06, 0xC7, 0xE0, 0xFE, 0x90, 0x06, -0xC6, 0x12, 0xCF, 0xBA, 0xFE, 0xE4, 0xFD, 0x78, -0x10, 0x12, 0xD0, 0xF7, 0x90, 0x06, 0xC5, 0xE0, -0xFE, 0x90, 0x06, 0xC4, 0x12, 0xCF, 0xBA, 0xFE, -0xE4, 0xFD, 0x12, 0x86, 0x20, 0x90, 0x95, 0x3C, -0x12, 0x04, 0x31, 0x90, 0x05, 0x58, 0x74, 0x02, -0xF0, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x01, 0x08, -0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, 0x80, 0x2B, -0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, 0x08, 0x90, -0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, 0x1C, 0x90, -0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, 0x90, 0x88, -0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, 0x90, 0x88, -0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, 0x88, 0xB0, -0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, 0xA5, 0xF0, -0x80, 0x6B, 0x51, 0x44, 0xF1, 0xD7, 0xC4, 0x13, -0x13, 0x54, 0x03, 0x30, 0xE0, 0x05, 0x75, 0x62, -0x02, 0x80, 0x0E, 0x12, 0xEB, 0x05, 0x30, 0xE0, -0x05, 0x75, 0x62, 0x01, 0x80, 0x03, 0xE4, 0xF5, -0x62, 0x90, 0x8A, 0xF1, 0xB1, 0x33, 0x90, 0x89, -0x04, 0xE0, 0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, -0xE0, 0x54, 0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, -0x54, 0x0F, 0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, -0x7B, 0x2E, 0x51, 0x44, 0xF1, 0xD7, 0x13, 0x13, -0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, 0x7F, 0x03, -0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, -0x8A, 0xF3, 0xD1, 0xC9, 0xAD, 0x62, 0x7F, 0x02, -0x12, 0x04, 0x7E, 0xE4, 0x12, 0xA1, 0x88, 0x12, -0xEB, 0x3F, 0x74, 0x43, 0xF0, 0x90, 0x88, 0xA3, -0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x88, 0xAF, -0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xF1, 0xE1, 0x30, -0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, 0x44, 0x02, -0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0xD1, 0xC9, -0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xD0, -0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, 0xD1, -0xC9, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, 0x88, -0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, 0xA1, -0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, 0xA1, 0x8C, -0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, -0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0x16, 0xED, -0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, -0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xC1, 0xB2, -0xEE, 0xF1, 0xE1, 0x30, 0xE0, 0x02, 0xC1, 0xB2, -0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, -0xC1, 0xB2, 0xEF, 0x70, 0x02, 0xC1, 0x0A, 0x24, -0xFE, 0x70, 0x02, 0xC1, 0x4F, 0x24, 0xFE, 0x60, -0x4F, 0x24, 0xFC, 0x70, 0x02, 0xC1, 0x94, 0x24, -0xFC, 0x60, 0x02, 0xC1, 0xA7, 0xEE, 0xB4, 0x0E, -0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, -0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, -0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x11, -0x90, 0x97, 0x16, 0xE0, 0xFF, 0x60, 0x05, 0x12, -0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, 0xED, 0xB1, -0x33, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, 0x60, -0x02, 0xC1, 0xA7, 0x12, 0x7B, 0xCC, 0xC1, 0xA7, -0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, -0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, -0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0xB1, -0x33, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, -0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, 0x02, 0xC1, -0xA7, 0x90, 0x86, 0x00, 0xB1, 0x33, 0xEF, 0x64, -0x01, 0x60, 0x02, 0xC1, 0xA7, 0x12, 0x68, 0xC2, -0xC1, 0xA7, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, -0x0B, 0x90, 0x86, 0x00, 0xB1, 0x33, 0xBF, 0x01, -0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, -0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, -0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, -0xB1, 0x33, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, -0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, 0x70, 0x67, -0x90, 0x86, 0x02, 0xB1, 0x33, 0xEF, 0x64, 0x01, -0x70, 0x5D, 0x12, 0x73, 0x5A, 0x80, 0x58, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, -0x00, 0xB1, 0x33, 0xBF, 0x01, 0x03, 0x12, 0x71, -0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, +0x86, 0x0C, 0x11, 0xCD, 0x90, 0x8A, 0xED, 0x11, +0xCD, 0x12, 0xBD, 0xF4, 0x54, 0xBF, 0xF0, 0x54, +0x7F, 0xF0, 0x22, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, +0xA4, 0xC7, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, +0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, +0x46, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, +0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, +0x41, 0x48, 0xEE, 0xF1, 0x8B, 0x30, 0xE0, 0x02, +0x41, 0x48, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, +0x70, 0x02, 0x41, 0x48, 0xEF, 0x70, 0x02, 0x21, +0xA4, 0x24, 0xFE, 0x70, 0x02, 0x21, 0xE9, 0x24, +0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0x41, +0x2E, 0x24, 0xFC, 0x60, 0x02, 0x41, 0x41, 0xEE, +0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, +0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, +0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, -0x0C, 0x0B, 0x90, 0x86, 0x00, 0xB1, 0x33, 0xBF, -0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, -0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x18, 0x12, -0x7A, 0x49, 0x80, 0x13, 0x90, 0x88, 0x39, 0xE0, -0xB4, 0x0C, 0x0C, 0x90, 0x88, 0x32, 0x12, 0xAE, -0xC1, 0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, -0x88, 0x39, 0x12, 0xEA, 0xEA, 0xE0, 0x90, 0x01, -0xBB, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, -0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, -0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, -0x83, 0x22, 0xF1, 0xE8, 0x51, 0x44, 0x12, 0x02, -0x06, 0xFF, 0x54, 0x7F, 0x90, 0x88, 0x36, 0xF0, -0xEF, 0xF1, 0xE1, 0xA3, 0xF0, 0x12, 0x87, 0xA6, -0xFD, 0x54, 0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, -0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, 0xF1, 0xD6, -0xFC, 0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, -0x31, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, -0x04, 0xC3, 0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, -0x54, 0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, -0x54, 0xF0, 0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, -0x12, 0x87, 0x72, 0x90, 0x88, 0x35, 0x12, 0x87, -0xFB, 0xFD, 0x90, 0x8A, 0x89, 0xD1, 0xC9, 0x7F, -0x02, 0x12, 0x04, 0x7E, 0x51, 0x44, 0x12, 0x87, -0x62, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x88, 0x9B, -0x12, 0xEA, 0x4A, 0x4F, 0x12, 0x87, 0x60, 0xFE, -0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, 0xFF, -0x90, 0x88, 0x9B, 0xF0, 0xEE, 0x54, 0x08, 0xFE, -0xEF, 0x54, 0xF7, 0x12, 0x87, 0x5F, 0x12, 0xEB, -0x17, 0xFF, 0x90, 0x88, 0x9B, 0x12, 0xEB, 0x0E, -0x12, 0x87, 0x5F, 0x54, 0x40, 0xFE, 0xEF, 0x54, -0xBF, 0x4E, 0x90, 0x88, 0x9B, 0xF0, 0x12, 0xBA, -0x92, 0x20, 0xE0, 0x2E, 0xEF, 0xC3, 0x13, 0x20, -0xE0, 0x0B, 0x75, 0x62, 0x01, 0x90, 0x88, 0xDF, -0xE0, 0x60, 0x0B, 0x80, 0x0E, 0xE4, 0xF5, 0x62, -0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, -0x61, 0x80, 0x03, 0x75, 0x61, 0x01, 0x90, 0x8A, -0xF3, 0xD1, 0xC9, 0xAD, 0x62, 0xAF, 0x61, 0x12, -0x04, 0x7E, 0x51, 0x44, 0x12, 0x5C, 0x5F, 0x90, -0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, -0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xE3, 0x05, -0xF0, 0x90, 0x88, 0x36, 0x12, 0xEA, 0xEA, 0xE0, -0x90, 0x01, 0xBB, 0x12, 0xBD, 0x19, 0x90, 0x01, -0xBE, 0xF0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -0x00, 0x03, 0x02, 0x02, 0x1F, 0xF0, 0xEE, 0x54, -0x80, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, 0x22, -0x90, 0x95, 0x57, 0x02, 0x86, 0x42, 0x7D, 0x01, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x97, 0x08, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -0x8A, 0xF9, 0x12, 0x8E, 0xC9, 0x7D, 0x44, 0x7F, -0x6F, 0x12, 0x04, 0x7E, 0x12, 0x8D, 0x30, 0x90, -0x97, 0x09, 0xE0, 0x90, 0x97, 0x08, 0xB4, 0x01, -0x08, 0x11, 0x35, 0xE0, 0x44, 0x04, 0xF0, 0x80, -0x06, 0x11, 0x35, 0xE0, 0x54, 0xFB, 0xF0, 0x90, -0x8A, 0xF9, 0x12, 0x8E, 0xC9, 0x12, 0xBC, 0x83, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xC4, 0x54, -0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, -0xF5, 0x83, 0x22, 0x8D, 0x61, 0xEF, 0x30, 0xE6, -0x1D, 0x11, 0xE2, 0xE0, 0xFD, 0xE5, 0x61, 0x11, -0x36, 0xD1, 0x8B, 0xE4, 0xFB, 0xAF, 0x61, 0x12, -0x75, 0x80, 0x11, 0xD5, 0xE0, 0x90, 0x92, 0x5E, -0xF0, 0xA3, 0x74, 0x01, 0x80, 0x66, 0xD1, 0x93, -0xE0, 0x04, 0xF0, 0xD1, 0x93, 0xE0, 0x64, 0x02, -0x70, 0x25, 0x74, 0x6B, 0x25, 0x61, 0xF1, 0x6C, -0xE0, 0xFD, 0xF4, 0x60, 0x02, 0x80, 0x04, 0x11, -0xE2, 0xE0, 0xFD, 0xE5, 0x61, 0x11, 0x36, 0xD1, -0x8B, 0x7B, 0x01, 0xAF, 0x61, 0x12, 0x75, 0x80, -0x11, 0xE2, 0x12, 0xEA, 0xE1, 0x80, 0x35, 0xD1, -0x93, 0xE0, 0xD3, 0x94, 0x03, 0x40, 0x17, 0x90, -0x8A, 0xB3, 0x12, 0x8E, 0xC9, 0xAF, 0x61, 0x12, -0x04, 0x7E, 0x11, 0xD5, 0xE0, 0x90, 0x92, 0x5E, -0xF0, 0xA3, 0x74, 0x03, 0x80, 0x16, 0x11, 0xE2, -0xE0, 0xFD, 0xE5, 0x61, 0x11, 0x36, 0xD1, 0x8B, -0x7B, 0x01, 0xAF, 0x61, 0x12, 0x75, 0x80, 0x11, -0xE2, 0x12, 0xEA, 0xE1, 0xF0, 0xAB, 0x61, 0xE4, +0x04, 0x11, 0x90, 0x97, 0x46, 0xE0, 0xFF, 0x60, +0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, +0xED, 0x11, 0xCD, 0x90, 0x88, 0x39, 0xE0, 0x64, +0x08, 0x60, 0x02, 0x41, 0x41, 0x12, 0x7B, 0xCC, +0x41, 0x41, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, +0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, +0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, +0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, +0x00, 0x11, 0xCD, 0xBF, 0x01, 0x03, 0x12, 0x71, +0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, +0x02, 0x41, 0x41, 0x90, 0x86, 0x00, 0x11, 0xCD, +0xEF, 0x64, 0x01, 0x60, 0x02, 0x41, 0x41, 0x12, +0x68, 0xC2, 0x41, 0x41, 0x90, 0x88, 0x39, 0xE0, +0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x11, 0xCD, +0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, +0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, +0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, +0x86, 0x00, 0x11, 0xCD, 0xBF, 0x01, 0x03, 0x12, +0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, +0x70, 0x67, 0x90, 0x86, 0x02, 0x11, 0xCD, 0xEF, +0x64, 0x01, 0x70, 0x5D, 0x12, 0x73, 0x5A, 0x80, +0x58, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, +0x90, 0x86, 0x00, 0x11, 0xCD, 0xBF, 0x01, 0x03, +0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, +0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, +0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x11, +0xCD, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, +0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, +0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, +0x18, 0x12, 0x7A, 0x49, 0x80, 0x13, 0x90, 0x88, +0x39, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, 0x88, 0x32, +0x12, 0xB5, 0x2C, 0x30, 0xE0, 0x03, 0x12, 0x79, +0xD4, 0x90, 0x88, 0x39, 0x12, 0xBE, 0x83, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x95, +0x4E, 0x02, 0x86, 0x39, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0x12, 0xD3, 0xE6, 0xFF, 0x54, +0x01, 0xFE, 0x90, 0x88, 0x9D, 0x12, 0xBE, 0x90, +0x4F, 0xF0, 0xFC, 0x12, 0x02, 0x06, 0xFD, 0x54, +0x04, 0x13, 0x13, 0x54, 0x3F, 0xFF, 0x90, 0x95, +0x38, 0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0xED, 0x54, +0x08, 0xFF, 0xEC, 0x54, 0xF7, 0x4F, 0xFF, 0x90, +0x88, 0x9D, 0xF0, 0x12, 0x02, 0x06, 0x12, 0xBE, +0x6D, 0x90, 0x88, 0x9D, 0x12, 0xBE, 0x5A, 0x4E, +0xFF, 0xF0, 0x12, 0x02, 0x06, 0xFE, 0x54, 0x40, +0xFD, 0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x90, 0x88, +0x9D, 0xF0, 0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, +0x7F, 0x4E, 0x51, 0x4D, 0xE9, 0x24, 0x01, 0xF9, +0xE4, 0x3A, 0x8B, 0x45, 0x12, 0xAF, 0xDE, 0x7B, +0x01, 0x7A, 0x88, 0x79, 0x9E, 0x12, 0x69, 0xF5, +0x12, 0x87, 0xEC, 0xFF, 0x54, 0x03, 0x90, 0x88, +0x9F, 0xF0, 0xEF, 0x54, 0x04, 0x13, 0x13, 0x54, +0x01, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0x90, 0x95, +0x44, 0xE0, 0x54, 0xFB, 0x4F, 0xF0, 0x12, 0x02, +0x06, 0x20, 0xE0, 0x02, 0x81, 0x3E, 0x90, 0x05, +0x54, 0xE0, 0x90, 0x88, 0xAE, 0xF0, 0xE0, 0xC3, +0x13, 0x90, 0x88, 0xAD, 0xF0, 0x90, 0x88, 0xA0, +0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x11, 0xF1, +0x98, 0x90, 0x88, 0x9E, 0x12, 0xEC, 0x23, 0x12, +0x87, 0xF1, 0x90, 0x88, 0x9F, 0xF0, 0x80, 0x24, +0xF1, 0x98, 0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x14, +0xEF, 0xC3, 0x94, 0x03, 0x50, 0x07, 0x90, 0x88, +0x9E, 0x74, 0x03, 0x80, 0x0C, 0xF1, 0x92, 0x90, +0x88, 0x9E, 0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, +0x2A, 0x12, 0xEC, 0x23, 0x12, 0xAC, 0xC7, 0x30, +0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, 0x75, 0xF0, +0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, 0xE0, 0xC3, +0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0x75, +0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, 0xF0, 0x90, +0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xA9, +0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, 0x13, 0x90, +0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, 0x74, 0x08, +0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, 0x05, 0xE4, +0x90, 0x88, 0xDD, 0xF0, 0x12, 0xE6, 0x44, 0x30, +0xE0, 0x18, 0x12, 0xEB, 0xEB, 0x30, 0xE0, 0x0C, +0x90, 0x8A, 0x89, 0xD1, 0x5A, 0x7D, 0x04, 0x7F, +0x02, 0x12, 0x04, 0x7E, 0x12, 0xEC, 0x1B, 0x74, +0x11, 0xF0, 0x90, 0x95, 0x38, 0xE0, 0x30, 0xE0, +0x33, 0x90, 0x95, 0x41, 0x74, 0x01, 0xF0, 0xE4, +0xA3, 0xF0, 0x90, 0x06, 0xC7, 0xE0, 0xFE, 0x90, +0x06, 0xC6, 0x12, 0xBA, 0x70, 0xFE, 0xE4, 0xFD, +0x78, 0x10, 0x12, 0xCD, 0xF4, 0x90, 0x06, 0xC5, +0xE0, 0xFE, 0x90, 0x06, 0xC4, 0x12, 0xBA, 0x70, +0xFE, 0xE4, 0xFD, 0x12, 0x86, 0x20, 0x90, 0x95, +0x3D, 0x12, 0x04, 0x31, 0x90, 0x95, 0x44, 0xE0, +0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x13, 0xA3, +0xE0, 0x20, 0xE0, 0x07, 0x54, 0x01, 0x44, 0x64, +0xF0, 0x80, 0x07, 0x90, 0x95, 0x45, 0xE0, 0x54, +0xFE, 0xF0, 0x12, 0xAF, 0xC8, 0x90, 0x88, 0xA5, +0xE0, 0xB4, 0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, +0x01, 0xF0, 0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, +0xB4, 0x04, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, +0xF0, 0x80, 0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, +0x06, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, +0x80, 0x0D, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, +0x06, 0x90, 0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, +0x90, 0x88, 0xA5, 0xF0, 0x80, 0x3C, 0x90, 0x8A, +0xF1, 0x11, 0xCD, 0x90, 0x89, 0x04, 0xE0, 0x90, +0x00, 0x40, 0x30, 0xE0, 0x08, 0xE0, 0x54, 0x0F, +0x44, 0xA0, 0xF0, 0x80, 0x06, 0xE0, 0x54, 0x0F, +0x44, 0x20, 0xF0, 0x51, 0x4E, 0x12, 0x87, 0x9F, +0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, +0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, +0x9A, 0x12, 0xA4, 0xC2, 0x12, 0xEC, 0x1B, 0x74, +0x43, 0xF0, 0x90, 0x88, 0xA3, 0xE0, 0x54, 0xDF, +0xF0, 0xE4, 0x90, 0x88, 0xAF, 0xF0, 0xF1, 0x87, +0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, 0x44, +0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0xD1, +0x5A, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, +0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, +0xD1, 0x5A, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, +0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, +0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x90, 0x97, 0x16, 0x12, 0x86, 0x42, +0x90, 0x97, 0x15, 0xEF, 0xF0, 0x12, 0x86, 0x4B, +0x8D, 0x58, 0x00, 0x8D, 0x5D, 0x01, 0x8D, 0x62, +0x06, 0x8D, 0x78, 0x10, 0x8D, 0x7D, 0x12, 0x8D, +0x82, 0x14, 0x8D, 0x87, 0x16, 0x8D, 0x8C, 0x18, +0x8D, 0x91, 0x19, 0x8D, 0x96, 0x1B, 0x8D, 0x9B, +0x1C, 0x8D, 0x9F, 0x1E, 0x8D, 0xA4, 0x20, 0x8D, +0xA9, 0x24, 0x8D, 0xAE, 0x25, 0x8D, 0xB3, 0x27, +0x8D, 0xB8, 0x29, 0x8D, 0xBD, 0x2A, 0x8D, 0xC2, +0x40, 0x8D, 0xC9, 0x42, 0x8D, 0xD4, 0x43, 0x8E, +0x41, 0x47, 0x8D, 0xD9, 0x49, 0x8D, 0xDE, 0x60, +0x8D, 0xE2, 0x61, 0x8D, 0xE7, 0x62, 0x8D, 0xEC, +0x63, 0x8D, 0xF1, 0x64, 0x8D, 0xF6, 0x65, 0x8D, +0xFB, 0x66, 0x8E, 0x00, 0x67, 0x8E, 0x05, 0x68, +0x8E, 0x0A, 0x69, 0x8E, 0x0F, 0x6B, 0x8E, 0x14, +0x6C, 0x8E, 0x19, 0x6D, 0x8E, 0x1E, 0x6E, 0x8E, +0x23, 0x6F, 0x8E, 0x28, 0x70, 0x8E, 0x2D, 0xC3, +0x8D, 0x67, 0xC6, 0x8D, 0x67, 0xC7, 0x8D, 0x67, +0xC8, 0x8D, 0x73, 0xCB, 0x00, 0x00, 0x8E, 0x32, +0xD1, 0x42, 0x02, 0x87, 0x1D, 0xD1, 0x42, 0x02, +0x87, 0xFE, 0xD1, 0x42, 0x02, 0xCC, 0x09, 0x90, +0x97, 0x15, 0xE0, 0xFF, 0xA3, 0x12, 0x86, 0x39, +0x02, 0xD0, 0x3B, 0xD1, 0x42, 0x02, 0xCE, 0x00, +0xD1, 0x42, 0x02, 0xA0, 0x08, 0xD1, 0x42, 0x02, +0xBF, 0xDD, 0xD1, 0x42, 0x02, 0xC0, 0xB7, 0xD1, +0x42, 0x02, 0x87, 0x74, 0xD1, 0x42, 0x02, 0xA7, +0xFA, 0xD1, 0x42, 0x02, 0xAF, 0xE6, 0xD1, 0x42, +0x02, 0xB0, 0x8B, 0xD1, 0x42, 0xE1, 0x9E, 0xD1, +0x42, 0x02, 0xC0, 0xC6, 0xD1, 0x42, 0x02, 0xBD, +0x1E, 0xD1, 0x42, 0x02, 0xA9, 0x02, 0xD1, 0x42, +0x02, 0xC1, 0x89, 0xD1, 0x42, 0x02, 0xB0, 0xFC, +0xD1, 0x42, 0x02, 0xC7, 0xD4, 0xD1, 0x42, 0x02, +0xC1, 0xCC, 0xD1, 0x42, 0x90, 0x8A, 0xA5, 0x80, +0x05, 0xD1, 0x42, 0x90, 0x8A, 0xB5, 0x12, 0xC9, +0xA1, 0x02, 0x04, 0x7E, 0xD1, 0x42, 0x02, 0x25, +0xEC, 0xD1, 0x42, 0x02, 0xDF, 0xB2, 0xD1, 0x42, +0x41, 0x54, 0xD1, 0x42, 0x02, 0x77, 0x4F, 0xD1, +0x42, 0x02, 0x7C, 0x60, 0xD1, 0x42, 0x02, 0x7A, +0xC6, 0xD1, 0x42, 0x02, 0x5D, 0x36, 0xD1, 0x42, +0x02, 0x7B, 0xE9, 0xD1, 0x42, 0x02, 0x70, 0x33, +0xD1, 0x42, 0x02, 0x48, 0xC9, 0xD1, 0x42, 0x02, +0x79, 0xF3, 0xD1, 0x42, 0x02, 0xC8, 0x20, 0xD1, +0x42, 0x02, 0x51, 0x7B, 0xD1, 0x42, 0x02, 0x79, +0x30, 0xD1, 0x42, 0x02, 0x57, 0xF2, 0xD1, 0x42, +0x02, 0x74, 0x8D, 0xD1, 0x42, 0x02, 0x78, 0x9A, +0xD1, 0x42, 0x02, 0x5E, 0x0B, 0xD1, 0x42, 0x02, +0xCF, 0x1C, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x01, +0xF0, 0x90, 0x97, 0x15, 0xE0, 0x90, 0x01, 0xC2, +0xF0, 0x22, 0x90, 0x97, 0x16, 0x02, 0x86, 0x39, +0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, +0xF5, 0x82, 0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, +0x8A, 0x79, 0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, +0x8E, 0x83, 0x22, 0x90, 0x8A, 0xD9, 0xD1, 0x5A, +0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xA1, +0xF1, 0x8A, 0x30, 0xE0, 0x04, 0x7F, 0x03, 0x80, +0x02, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0xE4, 0x90, +0x88, 0xAF, 0xF0, 0xA3, 0x12, 0xE6, 0x4C, 0x30, +0xE0, 0x09, 0x90, 0x8A, 0xF9, 0xD1, 0x5A, 0x7D, +0x0E, 0x80, 0x32, 0x12, 0xE6, 0x44, 0x30, 0xE0, +0x17, 0x12, 0xEB, 0xEB, 0x20, 0xE0, 0x08, 0x12, +0xAB, 0xDD, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, +0x8A, 0xF9, 0xD1, 0x5A, 0x7D, 0x0F, 0x80, 0x15, +0x90, 0x88, 0x36, 0xE0, 0x60, 0x14, 0x12, 0xAB, +0xDD, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x8A, +0xF9, 0xD1, 0x5A, 0x7D, 0x10, 0x7F, 0x6F, 0x12, +0x04, 0x7E, 0x90, 0x88, 0xA0, 0xE0, 0x30, 0xE0, +0x08, 0x90, 0x8A, 0xF9, 0xD1, 0x5A, 0x12, 0xAC, +0x6E, 0xF1, 0x87, 0x30, 0xE0, 0x0A, 0x90, 0x8A, +0x97, 0xD1, 0x5A, 0xE4, 0xFF, 0x12, 0x04, 0x7E, +0x90, 0x88, 0xA1, 0xE0, 0xFF, 0xC3, 0x13, 0x30, +0xE0, 0x0E, 0x90, 0x06, 0xCD, 0xE0, 0x54, 0xEF, +0xF0, 0x90, 0x06, 0xCF, 0xE0, 0x54, 0xEF, 0xF0, +0x12, 0xBE, 0x63, 0x30, 0xE0, 0x19, 0xEF, 0x13, +0x13, 0x54, 0x3F, 0x30, 0xE0, 0x11, 0xEE, 0x44, +0x08, 0xF0, 0xA3, 0xE0, 0xC3, 0x13, 0x54, 0x7F, +0xFF, 0x90, 0x8A, 0xD1, 0x12, 0xAD, 0xA8, 0x90, +0x05, 0x63, 0xE0, 0x90, 0x97, 0x2C, 0xF0, 0x90, +0x05, 0x62, 0xE0, 0x90, 0x97, 0x2B, 0xF0, 0x90, +0x05, 0x61, 0xE0, 0x90, 0x97, 0x2A, 0xF0, 0x90, +0x05, 0x60, 0xE0, 0x90, 0x97, 0x29, 0x12, 0xCD, +0xEA, 0x90, 0x97, 0x29, 0xF1, 0xEA, 0x12, 0x86, +0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, +0x07, 0x90, 0x97, 0x2B, 0xF1, 0xEA, 0x78, 0x10, +0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, +0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0xF1, +0xEA, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, +0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, +0x20, 0x90, 0x95, 0x46, 0x02, 0x04, 0x31, 0x90, +0x88, 0xA0, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, +0x01, 0x22, 0x90, 0x95, 0x4E, 0x12, 0x86, 0x39, +0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0x12, 0xD3, +0xE6, 0xFF, 0xF1, 0x98, 0xFE, 0x54, 0x03, 0xFD, +0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0xC0, 0x03, +0x12, 0x87, 0xEC, 0x54, 0x0F, 0x90, 0x97, 0x28, +0xF0, 0xD0, 0x03, 0x12, 0xA7, 0x03, 0xF1, 0x92, +0xFE, 0x54, 0x03, 0x12, 0xA1, 0xFC, 0x90, 0x95, +0x51, 0x74, 0x10, 0xF0, 0x90, 0x95, 0x73, 0x74, +0x07, 0x51, 0x4D, 0x12, 0x02, 0x06, 0x90, 0x95, +0x53, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x51, +0xD1, 0x48, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, +0x95, 0x51, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, +0x22, 0x7D, 0x01, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x97, 0x39, 0xEF, 0xF0, 0xA3, +0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8E, 0x5A, +0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, 0x7E, 0x12, +0x88, 0xCA, 0x90, 0x97, 0x3A, 0xE0, 0x90, 0x97, +0x39, 0xB4, 0x01, 0x09, 0xE0, 0x11, 0x3C, 0xE0, +0x44, 0x04, 0xF0, 0x80, 0x07, 0xE0, 0x11, 0x3C, +0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, +0x8E, 0x5A, 0x12, 0xAC, 0x6E, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xE5, 0x0E, 0xC4, 0x54, 0xF0, 0x24, +0x05, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, +0x22, 0x8D, 0x0E, 0xEF, 0x30, 0xE6, 0x1C, 0x11, +0xD2, 0xE0, 0xFD, 0x11, 0x3A, 0xE0, 0x54, 0x03, +0x90, 0x92, 0x80, 0xF0, 0xE4, 0xFB, 0xAF, 0x0E, +0x12, 0x75, 0x80, 0x11, 0xC5, 0x11, 0xE1, 0x74, +0x01, 0x80, 0x51, 0x11, 0xE8, 0x04, 0xF0, 0x11, +0xE8, 0x64, 0x02, 0x70, 0x1E, 0x74, 0x5E, 0x25, +0x0E, 0x31, 0xB7, 0xE0, 0xFD, 0xF4, 0x60, 0x02, +0x80, 0x04, 0x11, 0xD2, 0xE0, 0xFD, 0x11, 0x3A, +0x12, 0xEB, 0x2E, 0x11, 0xD2, 0x11, 0xE1, 0x74, +0x02, 0x80, 0x29, 0x11, 0xE8, 0xD3, 0x94, 0x03, +0x40, 0x13, 0x90, 0x8A, 0xB3, 0x12, 0x8E, 0x5A, +0xAF, 0x0E, 0x12, 0x04, 0x7E, 0x11, 0xC5, 0x11, +0xE1, 0x74, 0x03, 0x80, 0x0F, 0x11, 0xD2, 0xE0, +0xFD, 0x11, 0x3A, 0x12, 0xEB, 0x2E, 0x11, 0xD2, +0x11, 0xE1, 0x74, 0x02, 0xF0, 0xAB, 0x0E, 0xE4, 0xFD, 0xFF, 0x02, 0x6F, 0x75, 0x74, 0xB6, 0x25, -0x61, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, -0xE4, 0xF0, 0xE5, 0x61, 0xC4, 0x54, 0xF0, 0x24, +0x0E, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, +0xE4, 0xF0, 0xE5, 0x0E, 0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x70, 0x90, -0x96, 0x6A, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, 0x67, -0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x67, 0xC3, -0x9F, 0x40, 0x02, 0xC1, 0x41, 0xE5, 0x67, 0x11, -0xE4, 0xE0, 0xF5, 0x72, 0x12, 0xEA, 0xC3, 0xE0, -0x65, 0x72, 0x60, 0x16, 0x90, 0x92, 0x5E, 0xE5, -0x72, 0xF0, 0xE4, 0xA3, 0xF0, 0xAB, 0x67, 0xFD, -0xFF, 0x12, 0x6F, 0x75, 0x12, 0xEA, 0xC3, 0xE5, -0x72, 0xF0, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x01, -0x70, 0x4C, 0xA3, 0xE0, 0x65, 0x67, 0x70, 0x46, -0xA3, 0xE0, 0xF5, 0x68, 0xA3, 0xE0, 0x90, 0x95, -0xDF, 0xF0, 0xE5, 0x67, 0x11, 0xE4, 0xE0, 0x65, -0x68, 0x70, 0x02, 0xC1, 0x3D, 0xE5, 0x67, 0x11, -0xE4, 0xE5, 0x68, 0xF0, 0xE5, 0x67, 0x11, 0x36, -0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x95, 0xDF, 0xE0, -0x54, 0x03, 0x4F, 0xFF, 0xE5, 0x67, 0x11, 0x36, -0xEF, 0xF0, 0x90, 0x92, 0x5E, 0xE5, 0x68, 0xF0, -0xA3, 0x74, 0xFF, 0xF0, 0xAB, 0x67, 0xE4, 0xFD, -0xFF, 0x12, 0x6F, 0x75, 0xC1, 0x3D, 0x74, 0x43, -0x25, 0x67, 0x12, 0xD6, 0x69, 0xE0, 0xFB, 0x7A, -0x00, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, -0x55, 0x12, 0x04, 0x6E, 0xE0, 0xC3, 0x9B, 0xFE, -0xE4, 0x9A, 0x90, 0x95, 0xDD, 0xF0, 0xA3, 0xCE, -0xF0, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x90, 0x89, -0x53, 0x12, 0x04, 0x6E, 0xE0, 0xFE, 0xA3, 0xE0, -0xC3, 0x9B, 0xF5, 0x6E, 0xEE, 0x9A, 0xF5, 0x6D, -0xAF, 0x67, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x02, -0xC1, 0x3D, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0xD1, -0xA4, 0x12, 0x8F, 0xE1, 0x30, 0xE0, 0x02, 0xC1, -0x3D, 0xE5, 0x67, 0x13, 0x13, 0x13, 0x54, 0x1F, -0x12, 0xB7, 0xA5, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, -0x67, 0x12, 0xB7, 0xDA, 0x80, 0x05, 0xC3, 0x33, -0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEE, 0x5C, -0xFE, 0xEF, 0x5D, 0x4E, 0x60, 0x02, 0xC1, 0x3D, -0xE5, 0x6E, 0x45, 0x6D, 0x70, 0x0C, 0x90, 0x95, -0xDD, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x70, 0x02, -0xC1, 0x3D, 0xE5, 0x67, 0x75, 0xF0, 0x12, 0xA4, -0x24, 0x57, 0xF9, 0x74, 0x89, 0x35, 0xF0, 0xFA, -0x7B, 0x01, 0x90, 0x95, 0xDA, 0x12, 0x86, 0x42, -0x90, 0x00, 0x02, 0x12, 0x03, 0x3E, 0xFF, 0x12, -0x03, 0x13, 0x2F, 0xFF, 0x12, 0xEB, 0x37, 0xFF, -0x12, 0xEA, 0xFC, 0x90, 0x00, 0x08, 0x12, 0x03, -0x3E, 0x2F, 0xF5, 0x71, 0xE5, 0x67, 0x11, 0xE4, -0xE0, 0xF5, 0x68, 0x54, 0x80, 0xF5, 0x6A, 0xE5, -0x68, 0x54, 0x7F, 0xF5, 0x69, 0x90, 0x96, 0x58, -0xE0, 0x60, 0x11, 0x75, 0x73, 0x0A, 0xF1, 0xC3, -0xE4, 0x93, 0xC3, 0x13, 0x74, 0x01, 0x93, 0x13, -0xF5, 0x74, 0x80, 0x0A, 0x7B, 0xFF, 0x12, 0xCE, -0x8E, 0xE4, 0xF5, 0x73, 0xF5, 0x74, 0x75, 0xF0, -0x12, 0xE5, 0x67, 0xF1, 0xFC, 0xFF, 0xE5, 0x69, -0xD3, 0x9F, 0x40, 0x08, 0x8F, 0x69, 0xE5, 0x69, -0x45, 0x6A, 0xF5, 0x68, 0xD1, 0x4E, 0xE0, 0xC3, -0x94, 0x05, 0x40, 0x02, 0x81, 0x29, 0xE5, 0x69, -0x90, 0x81, 0x61, 0x93, 0xF5, 0x6F, 0xFD, 0xAF, -0x69, 0x12, 0x60, 0x6F, 0x8F, 0x6F, 0xE5, 0x6A, -0x60, 0x04, 0x05, 0x6F, 0x05, 0x6F, 0xE5, 0x69, -0xC3, 0x94, 0x0C, 0x40, 0x1D, 0x74, 0x5A, 0x25, -0x67, 0x12, 0xDC, 0x04, 0xE0, 0xFF, 0x54, 0x7F, -0xFE, 0xEF, 0x30, 0xE7, 0x06, 0xE5, 0x6F, 0x2E, -0xFF, 0x80, 0x05, 0xC3, 0xE5, 0x6F, 0x9E, 0xFF, -0x8F, 0x6F, 0xE5, 0x6F, 0xD3, 0x94, 0x1A, 0xAF, -0x6F, 0x40, 0x02, 0x7F, 0x1A, 0x8F, 0x6F, 0xE5, -0x68, 0x90, 0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, -0x95, 0xDE, 0xE0, 0x9F, 0x90, 0x95, 0xDD, 0xE0, -0x94, 0x00, 0x40, 0x02, 0x61, 0xE3, 0xC3, 0xE5, -0x6E, 0x94, 0x0A, 0xE5, 0x6D, 0x94, 0x00, 0x40, -0x02, 0x61, 0x96, 0xD1, 0x42, 0xE0, 0xC3, 0x94, -0x01, 0x40, 0x05, 0xD1, 0x42, 0xE0, 0x14, 0xF0, -0x90, 0x95, 0xDA, 0x12, 0x86, 0x39, 0x90, 0x00, -0x08, 0x12, 0x03, 0x3E, 0xFF, 0x90, 0x95, 0xDE, -0xE0, 0x2F, 0xFF, 0x90, 0x95, 0xDD, 0xE0, 0x35, -0xF0, 0xFE, 0x12, 0xEA, 0xFC, 0xEE, 0x35, 0xF0, -0xFE, 0x12, 0xEB, 0x37, 0xFD, 0xEE, 0x35, 0xF0, -0xFC, 0xE5, 0x6D, 0xC3, 0x13, 0xFE, 0xE5, 0x6E, -0x13, 0xFF, 0xD3, 0xED, 0x9F, 0xEC, 0x9E, 0x40, -0x0D, 0xE5, 0x67, 0x94, 0x05, 0x50, 0x05, 0xD1, -0x42, 0x74, 0x03, 0xF0, 0x61, 0xE3, 0x90, 0x95, -0xDA, 0x12, 0x86, 0x39, 0x12, 0x03, 0x13, 0x65, -0x71, 0x70, 0x02, 0xE5, 0xF0, 0x70, 0x2A, 0xE5, -0x67, 0xC3, 0x94, 0x05, 0x50, 0x0A, 0xD1, 0x42, -0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x07, -0xE5, 0x71, 0xC3, 0x94, 0x03, 0x50, 0x08, 0x7D, -0x06, 0xAF, 0x67, 0xF1, 0x78, 0xC1, 0x3D, 0xE4, -0xFD, 0xAF, 0x67, 0xD1, 0xAC, 0xF1, 0x74, 0xC1, -0x21, 0x12, 0xD6, 0x71, 0xC1, 0x21, 0xD1, 0x42, -0xE4, 0xF0, 0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, -0xAB, 0x6F, 0xAD, 0x67, 0xAF, 0x6E, 0xAE, 0x6D, -0x12, 0x41, 0x9C, 0x8E, 0x6B, 0x8F, 0x6C, 0xF1, -0xC3, 0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFF, -0xE4, 0x93, 0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x6C, -0x9F, 0xE5, 0x6B, 0x9E, 0x40, 0x0C, 0xD1, 0x66, -0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x67, 0xD1, 0xAC, -0xC1, 0x21, 0x12, 0xEB, 0x2F, 0xC3, 0xE5, 0x6C, -0x9F, 0xE5, 0x6B, 0x94, 0x00, 0x50, 0x0D, 0xD1, -0x66, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x67, 0x12, -0xDD, 0x1C, 0xC1, 0x21, 0xF1, 0x74, 0xD1, 0x66, -0xE0, 0x04, 0xF0, 0xE5, 0x69, 0x90, 0x81, 0xED, -0x93, 0x25, 0x73, 0xFF, 0xE4, 0x33, 0xFE, 0xD1, -0x66, 0xE0, 0xC3, 0x9F, 0xEE, 0xF1, 0xAF, 0x50, -0x02, 0xC1, 0x21, 0xD1, 0x66, 0xE4, 0xF0, 0x12, -0xEB, 0x2F, 0xF1, 0xC3, 0x74, 0x01, 0x93, 0x2F, -0xFF, 0xE4, 0x93, 0x34, 0x00, 0xC3, 0x13, 0xFE, -0xEF, 0x13, 0xFF, 0xE5, 0x67, 0xF1, 0xE7, 0xC1, -0x21, 0xD1, 0x4E, 0xE0, 0x64, 0x05, 0x60, 0x02, -0x81, 0xEC, 0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, -0x70, 0x10, 0xD1, 0x72, 0xE4, 0xF0, 0x90, 0x04, -0xA1, 0xE0, 0x78, 0x88, 0xF6, 0x12, 0xB7, 0xBC, -0xC1, 0x35, 0xAD, 0x69, 0xAF, 0x67, 0x12, 0x72, -0xEE, 0x12, 0xEA, 0xB7, 0xEF, 0xF0, 0xE5, 0x67, -0x12, 0xB7, 0x87, 0xE0, 0x54, 0x07, 0x78, 0x88, -0xF6, 0xF1, 0xB6, 0xFF, 0xC3, 0x94, 0x30, 0x40, -0x1C, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0xD1, 0xA4, -0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, -0x0C, 0x12, 0xEA, 0xB7, 0xE0, 0x60, 0x06, 0x90, -0x96, 0x58, 0xE0, 0x60, 0x0A, 0xE4, 0x78, 0x88, -0xF6, 0xD1, 0x72, 0xE4, 0xF0, 0x80, 0x55, 0x12, -0xEA, 0xAB, 0xE0, 0xFE, 0x24, 0x05, 0xFD, 0xE4, -0x33, 0xFC, 0xEF, 0xF1, 0xAC, 0x50, 0x1C, 0xF1, -0xB6, 0x24, 0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, -0xF1, 0xAC, 0x50, 0x0F, 0x12, 0xEA, 0x9F, 0xE0, -0xB5, 0x69, 0x08, 0xD1, 0x7F, 0xE0, 0xC3, 0x94, -0x0A, 0x40, 0x24, 0x78, 0x88, 0xE6, 0xFF, 0x70, -0x04, 0x76, 0x01, 0x80, 0x0C, 0xEF, 0x78, 0x88, -0xB4, 0x01, 0x04, 0x76, 0x03, 0x80, 0x02, 0x76, -0x05, 0xD1, 0x7F, 0xE4, 0xF0, 0xF1, 0xB6, 0xFF, -0x12, 0xEA, 0xAB, 0xEF, 0xF0, 0x80, 0x05, 0xD1, -0x72, 0xE0, 0x04, 0xF0, 0x12, 0xEA, 0x9F, 0xE5, -0x69, 0xF0, 0xC1, 0x1C, 0xD1, 0x4E, 0xE0, 0x64, -0x06, 0x60, 0x02, 0xC1, 0x21, 0xF5, 0x6B, 0xF5, -0x6C, 0xE5, 0x67, 0x12, 0xB7, 0x87, 0xE0, 0x54, -0x07, 0x78, 0x88, 0xF6, 0xD3, 0xE5, 0x6E, 0x94, -0xE8, 0xE5, 0x6D, 0x94, 0x03, 0x40, 0x06, 0x78, -0x86, 0x76, 0x05, 0x80, 0x15, 0xD3, 0xE5, 0x6E, -0x94, 0xFA, 0xE5, 0x6D, 0x94, 0x00, 0x40, 0x06, -0x78, 0x86, 0x76, 0x02, 0x80, 0x04, 0xE4, 0x78, -0x86, 0xF6, 0xE5, 0x6E, 0xAE, 0x6D, 0x78, 0x86, -0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, -0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x82, 0x06, -0xE4, 0x12, 0xEB, 0x28, 0x90, 0x95, 0xE0, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, 0xF6, -0x90, 0x95, 0xDA, 0x12, 0x86, 0x39, 0x78, 0x87, -0xE6, 0xFD, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, -0x85, 0xF0, 0x83, 0x12, 0x03, 0x3E, 0xAE, 0xF0, +0x22, 0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x22, +0x74, 0xB6, 0x25, 0x0E, 0xF5, 0x82, 0xE4, 0x34, +0x8E, 0xF5, 0x83, 0xE0, 0x22, 0x8F, 0x75, 0x8D, +0x76, 0xEF, 0x11, 0xD4, 0xE0, 0xFD, 0x54, 0x7F, +0xF5, 0x77, 0xED, 0x54, 0x80, 0xF5, 0x78, 0x12, +0xE1, 0xB2, 0xF5, 0x7A, 0x75, 0xF0, 0x12, 0xEF, +0x12, 0x9B, 0xEB, 0xC4, 0x54, 0x03, 0xF5, 0x7B, +0x31, 0xB3, 0x74, 0xFF, 0xF0, 0x31, 0xBF, 0xE5, +0x78, 0x4D, 0xFF, 0x12, 0xE1, 0x95, 0xEF, 0xF0, +0xE5, 0x75, 0x11, 0x3C, 0xE0, 0x54, 0x03, 0xF5, +0x79, 0x74, 0x46, 0x25, 0x75, 0x12, 0xE1, 0xA1, +0xE5, 0x79, 0xF0, 0xE5, 0x77, 0x65, 0x7A, 0x70, +0x22, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x12, 0x9D, +0x5F, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x0B, +0xE5, 0x78, 0x70, 0x07, 0xE5, 0x77, 0x44, 0x80, +0xFD, 0x80, 0x4B, 0x31, 0xBF, 0x7D, 0x07, 0xAF, +0x75, 0x61, 0x45, 0xE5, 0x77, 0xC3, 0x95, 0x7A, +0x50, 0x35, 0xAB, 0x75, 0xAD, 0x7A, 0xAF, 0x77, +0x12, 0x72, 0x7F, 0xAD, 0x07, 0xE5, 0x77, 0xC3, +0x94, 0x0C, 0x40, 0x2A, 0x75, 0xF0, 0x12, 0xE5, +0x75, 0x12, 0x9D, 0x5F, 0xFE, 0xC4, 0x13, 0x54, +0x07, 0x30, 0xE0, 0x1A, 0xE5, 0x76, 0x60, 0x16, +0xE5, 0x78, 0x70, 0x12, 0xE5, 0x77, 0x44, 0x80, +0xFD, 0x31, 0xB3, 0xEF, 0xF0, 0x80, 0x07, 0x12, +0xE1, 0x95, 0xE5, 0x7A, 0xF0, 0xFD, 0x90, 0x92, +0x80, 0xE5, 0x79, 0xF0, 0xAB, 0x76, 0xAF, 0x75, +0x02, 0x75, 0x80, 0x74, 0x5E, 0x25, 0x75, 0xF5, +0x82, 0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0xE5, +0x77, 0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, +0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, 0xFE, 0x74, +0x01, 0x93, 0xFF, 0xE5, 0x75, 0x25, 0xE0, 0x24, +0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, +0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xF3, +0x12, 0xC0, 0xAE, 0x12, 0xE2, 0xE8, 0x90, 0x96, +0xFE, 0xF0, 0xE4, 0x90, 0x96, 0xFB, 0xF0, 0x90, +0x96, 0xF3, 0x12, 0xAB, 0xC5, 0x90, 0x96, 0xF6, +0xF0, 0xEF, 0x54, 0x07, 0x90, 0x96, 0xF8, 0x71, +0x2F, 0xE0, 0x90, 0x96, 0xF9, 0xF0, 0x12, 0xE1, +0xB2, 0x54, 0x7F, 0x90, 0x96, 0xFC, 0xF0, 0x90, +0x96, 0xF3, 0xE0, 0x12, 0xE1, 0xA9, 0xE0, 0x90, +0x96, 0xFD, 0xF0, 0xED, 0x54, 0x7F, 0x90, 0x96, +0xF7, 0xF0, 0xEB, 0x70, 0x21, 0x90, 0x89, 0x3D, +0x71, 0xA8, 0xFF, 0x12, 0xEB, 0x42, 0xFD, 0x90, +0x89, 0x40, 0x12, 0xD3, 0xCB, 0x2D, 0xFF, 0xE4, +0x35, 0xF0, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, +0x90, 0x96, 0xF3, 0xE0, 0x31, 0xD5, 0x90, 0x96, +0xFC, 0xE0, 0xFF, 0x90, 0x96, 0xF7, 0xE0, 0xFE, +0xD3, 0x9F, 0x40, 0x0C, 0x90, 0x96, 0xF4, 0xE0, +0x54, 0x80, 0xFD, 0xEF, 0x4D, 0xF0, 0x80, 0x0F, +0x90, 0x96, 0xFD, 0xE0, 0xFF, 0xEE, 0xC3, 0x9F, +0x50, 0x05, 0x90, 0x96, 0xF4, 0xEF, 0xF0, 0x90, +0x96, 0xF4, 0xE0, 0xFE, 0x54, 0x7F, 0x90, 0x96, +0xF7, 0xF0, 0xEE, 0x54, 0x80, 0x90, 0x96, 0xFA, +0xF0, 0x90, 0x96, 0xF5, 0xE0, 0x70, 0x22, 0xA3, +0xE0, 0x71, 0xB0, 0xC0, 0x83, 0xC0, 0x82, 0x12, +0xC2, 0x93, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, +0xFC, 0xF4, 0x5F, 0xD0, 0x82, 0xD0, 0x83, 0xF0, +0x90, 0x96, 0xF9, 0xE0, 0x54, 0x7F, 0xF0, 0x80, +0x3A, 0x90, 0x96, 0xF6, 0xE0, 0x71, 0xB0, 0xC0, +0x83, 0xC0, 0x82, 0x12, 0xC2, 0x93, 0x08, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, 0x82, +0xD0, 0x83, 0x71, 0x2F, 0xE0, 0x54, 0x07, 0xFF, +0x90, 0x96, 0xF9, 0xF0, 0x90, 0x89, 0x46, 0x71, +0xA8, 0xF5, 0x82, 0x12, 0xD3, 0xD0, 0x33, 0x33, +0x33, 0x54, 0xF8, 0x4F, 0x90, 0x96, 0xF9, 0xF0, +0x44, 0x80, 0xF0, 0x90, 0x96, 0xF4, 0x71, 0xA0, +0x11, 0xD4, 0xEF, 0xF0, 0xEE, 0x70, 0x05, 0x90, +0x01, 0xC8, 0xEF, 0xF0, 0x90, 0x96, 0xF9, 0x71, +0xA0, 0x71, 0x34, 0xEF, 0xF0, 0xEE, 0x11, 0x3C, +0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x96, 0xFE, 0xE0, +0x54, 0x03, 0x4F, 0xFE, 0x90, 0x96, 0xF3, 0xE0, +0xFF, 0x11, 0x3C, 0xEE, 0xF0, 0x7D, 0x01, 0x12, +0x61, 0xF7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, +0x90, 0x96, 0xF3, 0xE0, 0xC4, 0x54, 0xF0, 0x24, +0x01, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, +0x22, 0x7D, 0x07, 0xAF, 0x67, 0xED, 0x30, 0xE0, +0x1E, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, +0x71, 0x8D, 0x90, 0x89, 0x59, 0x71, 0x8D, 0x90, +0x89, 0x5B, 0x71, 0x8D, 0x90, 0x89, 0x5D, 0x71, +0x8D, 0x90, 0x89, 0x5F, 0x71, 0x99, 0xF0, 0xED, +0x30, 0xE1, 0x0A, 0x75, 0xF0, 0x12, 0xEF, 0x90, +0x89, 0x53, 0x71, 0x99, 0xF0, 0xED, 0x30, 0xE2, +0x05, 0x12, 0xD7, 0xC7, 0xE4, 0xF0, 0x12, 0xEA, +0xDC, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, 0x12, +0xEA, 0xDC, 0xEE, 0xF0, 0x22, 0x12, 0x04, 0x6E, +0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, +0x22, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0x22, +0xE0, 0xFF, 0x90, 0x96, 0xF3, 0xE0, 0xFE, 0x22, +0x12, 0x86, 0x39, 0x90, 0x96, 0xF7, 0xE0, 0x22, +0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, +0x83, 0x22, 0x90, 0x04, 0x85, 0xE0, 0xF5, 0x70, +0x90, 0x96, 0x5D, 0xE0, 0x04, 0xF0, 0xE4, 0xF5, +0x67, 0x90, 0x88, 0x2B, 0xE0, 0xFF, 0xE5, 0x67, +0xC3, 0x9F, 0x40, 0x03, 0x02, 0x9A, 0x4D, 0xE5, +0x67, 0x11, 0xD4, 0xE0, 0xF5, 0x72, 0x12, 0xEB, +0x97, 0xE0, 0x65, 0x72, 0x60, 0x16, 0x90, 0x92, +0x5E, 0xE5, 0x72, 0xF0, 0xE4, 0xA3, 0xF0, 0xAB, +0x67, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0x12, 0xEB, +0x97, 0xE5, 0x72, 0xF0, 0x90, 0x04, 0xA0, 0xE0, +0x64, 0x01, 0x70, 0x4E, 0xA3, 0xE0, 0x65, 0x67, +0x70, 0x48, 0xA3, 0xE0, 0xF5, 0x68, 0xA3, 0xE0, +0x90, 0x95, 0xDC, 0xF0, 0xE5, 0x67, 0x11, 0xD4, +0xE0, 0x65, 0x68, 0x70, 0x03, 0x02, 0x9A, 0x48, +0xE5, 0x67, 0x11, 0xD4, 0xE5, 0x68, 0xF0, 0xE5, +0x67, 0x11, 0x3C, 0xE0, 0x54, 0xFC, 0xFF, 0x90, +0x95, 0xDC, 0xE0, 0x54, 0x03, 0x4F, 0xFF, 0xE5, +0x67, 0x11, 0x3C, 0xEF, 0xF0, 0x90, 0x92, 0x5E, +0xE5, 0x68, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xAB, +0x67, 0xE4, 0xFD, 0xFF, 0x12, 0x6F, 0x75, 0x02, +0x9A, 0x48, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x12, +0xD7, 0xCB, 0xE0, 0xFF, 0x90, 0x95, 0xD4, 0xE4, +0xF0, 0xA3, 0xEF, 0xF0, 0x75, 0xF0, 0x12, 0xE5, +0x67, 0x90, 0x89, 0x53, 0x12, 0x04, 0x6E, 0xE0, +0xF5, 0x6D, 0xA3, 0xE0, 0xF5, 0x6E, 0xE5, 0x67, +0x75, 0xF0, 0x12, 0xA4, 0x24, 0x57, 0xF9, 0x74, +0x89, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x95, +0xD1, 0x12, 0x86, 0x42, 0x12, 0xEB, 0xD6, 0xFF, +0x12, 0x03, 0x13, 0x2F, 0xFF, 0x12, 0xEB, 0xDC, +0x2F, 0xFF, 0x12, 0xEB, 0x28, 0x2F, 0xFF, 0x12, +0xEB, 0x0F, 0x2F, 0xF5, 0x71, 0xE5, 0x67, 0x11, +0xD4, 0xE0, 0xF5, 0x68, 0x54, 0x80, 0xF5, 0x6A, +0xE5, 0x68, 0x54, 0x7F, 0xF5, 0x69, 0x75, 0xF0, +0x12, 0xE5, 0x67, 0x12, 0xD7, 0x75, 0xE0, 0x64, +0x01, 0x60, 0x02, 0xC1, 0x16, 0x12, 0x9F, 0xF4, +0x12, 0xEB, 0xD6, 0xFF, 0xAE, 0xF0, 0x12, 0x03, +0x13, 0x2F, 0xFF, 0xE5, 0xF0, 0x3E, 0xFE, 0x12, +0xEB, 0xDC, 0x2F, 0xFF, 0xEE, 0x12, 0xEB, 0x25, +0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0xFE, 0x12, 0xEB, +0x0F, 0x2F, 0xFF, 0xEE, 0x35, 0xF0, 0x90, 0x95, +0xD6, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x03, 0x13, +0xFF, 0xC3, 0x90, 0x95, 0xD7, 0xE0, 0x9F, 0xFE, +0x90, 0x95, 0xD6, 0xE0, 0x95, 0xF0, 0x90, 0x95, +0xD8, 0xF0, 0xA3, 0xCE, 0xF0, 0x12, 0xEB, 0x28, +0xFD, 0xAC, 0xF0, 0x25, 0xE0, 0xFF, 0xEC, 0x33, +0xFE, 0xEF, 0x2D, 0xFD, 0xEE, 0x3C, 0xFC, 0x12, +0xEB, 0xDC, 0x25, 0xE0, 0xFF, 0xE5, 0xF0, 0x33, +0xFE, 0x12, 0xEB, 0xD6, 0x2F, 0xFF, 0xEE, 0x35, +0xF0, 0xCF, 0x2D, 0xFD, 0xEF, 0x3C, 0xFC, 0x12, +0xEB, 0x09, 0xAE, 0xF0, 0x78, 0x02, 0xC3, 0x33, +0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x2D, 0xFF, 0xEC, +0x3E, 0x90, 0x95, 0xDA, 0xF0, 0xA3, 0xEF, 0xF0, +0x90, 0x95, 0xD4, 0x12, 0xEA, 0xB1, 0x12, 0xEB, +0xAE, 0x12, 0xEA, 0xC2, 0x50, 0x08, 0x90, 0x95, +0xD4, 0x12, 0xEA, 0xEA, 0x80, 0x04, 0x7E, 0xFF, +0x7F, 0xFF, 0xE5, 0x67, 0x12, 0xEB, 0xAE, 0x31, +0xDE, 0x90, 0x95, 0xD6, 0x12, 0xEA, 0xB1, 0x12, +0xEB, 0xB8, 0x12, 0xEA, 0xC2, 0x50, 0x08, 0x90, +0x95, 0xD6, 0x12, 0xEA, 0xEA, 0x80, 0x04, 0x7E, +0xFF, 0x7F, 0xFF, 0xE5, 0x67, 0x12, 0xEB, 0xB8, +0x31, 0xDE, 0x90, 0x95, 0xDA, 0x12, 0xEA, 0xB1, +0x12, 0xEB, 0xC2, 0x12, 0xEA, 0xC2, 0x50, 0x08, +0x90, 0x95, 0xDA, 0x12, 0xEA, 0xEA, 0x80, 0x04, +0x7E, 0xFF, 0x7F, 0xFF, 0xE5, 0x67, 0x12, 0xEB, +0xC2, 0x31, 0xDE, 0xC3, 0x74, 0xFF, 0x95, 0x6E, +0xFF, 0x74, 0xFF, 0x95, 0x6D, 0xFE, 0x12, 0xEB, +0x8B, 0x12, 0xEA, 0xC2, 0x50, 0x0A, 0xE5, 0x6E, +0x2D, 0xFF, 0xE5, 0x6D, 0x3C, 0xFE, 0x80, 0x04, +0x7E, 0xFF, 0x7F, 0xFF, 0x12, 0xEB, 0x8B, 0x31, +0xDE, 0x12, 0xEC, 0x13, 0xFB, 0xC3, 0x74, 0xFF, +0x9B, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0x74, 0xFF, +0x94, 0x00, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0xFC, +0x90, 0x8D, 0x71, 0x12, 0xE6, 0x3D, 0x50, 0x12, +0x12, 0xEC, 0x13, 0xFF, 0xE4, 0xFC, 0xFD, 0x90, +0x8D, 0x71, 0x12, 0x86, 0x2D, 0x12, 0x85, 0xA9, +0x80, 0x06, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, +0x90, 0x8D, 0x71, 0x12, 0x04, 0x31, 0xAF, 0x67, +0x12, 0x78, 0x4A, 0xEF, 0x70, 0x03, 0x02, 0x9A, +0x48, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x12, 0x9B, +0xEB, 0x12, 0x8F, 0x8B, 0x30, 0xE0, 0x03, 0x02, +0x9A, 0x48, 0xE5, 0x67, 0x13, 0x13, 0x13, 0x54, +0x1F, 0x71, 0xB0, 0xE0, 0xFD, 0x7C, 0x00, 0xE5, +0x67, 0x54, 0x07, 0xFF, 0x12, 0xC2, 0x9F, 0x80, +0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, +0xFF, 0xEE, 0x5C, 0xFE, 0xEF, 0x5D, 0x4E, 0x60, +0x03, 0x02, 0x9A, 0x48, 0xE5, 0x6E, 0x45, 0x6D, +0x70, 0x0D, 0x90, 0x95, 0xD4, 0xE0, 0x70, 0x02, +0xA3, 0xE0, 0x70, 0x03, 0x02, 0x9A, 0x48, 0x90, +0x96, 0x4B, 0xE0, 0x60, 0x12, 0x75, 0x73, 0x0A, +0x12, 0xEA, 0xCE, 0xE4, 0x93, 0xC3, 0x13, 0x74, +0x01, 0x93, 0x13, 0xF5, 0x74, 0x80, 0x0A, 0x7B, +0xFF, 0x12, 0xE0, 0x5E, 0xE4, 0xF5, 0x73, 0xF5, +0x74, 0x75, 0xF0, 0x12, 0xE5, 0x67, 0x12, 0xE1, +0xB6, 0xFF, 0xE5, 0x69, 0xD3, 0x9F, 0x40, 0x08, +0x8F, 0x69, 0xE5, 0x69, 0x45, 0x6A, 0xF5, 0x68, +0x12, 0x9A, 0x73, 0xE0, 0xC3, 0x94, 0x05, 0x40, +0x03, 0x02, 0x98, 0x37, 0xE5, 0x69, 0x90, 0x81, +0x61, 0x93, 0xF5, 0x6F, 0xFD, 0xAF, 0x69, 0x12, +0x60, 0x6F, 0x8F, 0x6F, 0xE5, 0x6A, 0x60, 0x04, +0x05, 0x6F, 0x05, 0x6F, 0xE5, 0x69, 0xC3, 0x94, +0x0C, 0x40, 0x1D, 0x74, 0x4D, 0x25, 0x67, 0x12, +0xEC, 0x0B, 0xE0, 0xFF, 0x54, 0x7F, 0xFE, 0xEF, +0x30, 0xE7, 0x06, 0xE5, 0x6F, 0x2E, 0xFF, 0x80, +0x05, 0xC3, 0xE5, 0x6F, 0x9E, 0xFF, 0x8F, 0x6F, +0xE5, 0x6F, 0xD3, 0x94, 0x1A, 0xAF, 0x6F, 0x40, +0x02, 0x7F, 0x1A, 0x8F, 0x6F, 0xE5, 0x68, 0x90, +0x81, 0xD9, 0x93, 0xFF, 0xD3, 0x90, 0x95, 0xD5, +0xE0, 0x9F, 0x90, 0x95, 0xD4, 0xE0, 0x94, 0x00, +0x40, 0x02, 0xE1, 0xED, 0xC3, 0xE5, 0x6E, 0x94, +0x0A, 0xE5, 0x6D, 0x94, 0x00, 0x50, 0x7C, 0x12, +0xE0, 0x49, 0xE0, 0xC3, 0x94, 0x01, 0x40, 0x06, +0x12, 0xE0, 0x49, 0xE0, 0x14, 0xF0, 0x12, 0xEB, +0x09, 0xFF, 0x90, 0x95, 0xD5, 0xE0, 0x2F, 0xFF, +0x90, 0x95, 0xD4, 0xE0, 0x12, 0xEB, 0x25, 0x2F, +0xFD, 0xEE, 0x35, 0xF0, 0xFC, 0xE5, 0x6D, 0xC3, +0x13, 0xFE, 0xE5, 0x6E, 0x13, 0xFF, 0xD3, 0xED, +0x9F, 0xEC, 0x9E, 0x40, 0x0E, 0xE5, 0x67, 0x94, +0x05, 0x50, 0x06, 0x12, 0xE0, 0x49, 0x74, 0x02, +0xF0, 0xE1, 0xED, 0x12, 0x9F, 0xF4, 0x12, 0x03, +0x13, 0x65, 0x71, 0x70, 0x02, 0xE5, 0xF0, 0x70, +0x24, 0xE5, 0x67, 0xC3, 0x94, 0x05, 0x50, 0x12, +0x12, 0xE0, 0x49, 0xE0, 0xD3, 0x94, 0x00, 0x40, +0x09, 0x7D, 0x06, 0xAF, 0x67, 0x71, 0x45, 0x02, +0x9A, 0x48, 0xE4, 0xFD, 0xAF, 0x67, 0x11, 0xF5, +0x71, 0x41, 0x02, 0x9A, 0x2C, 0x12, 0xEB, 0xFC, +0x02, 0x9A, 0x2C, 0x12, 0xE0, 0x49, 0xE4, 0xF0, +0x90, 0x91, 0x6C, 0x74, 0x02, 0xF0, 0xAB, 0x6F, +0xAD, 0x67, 0xAF, 0x6E, 0xAE, 0x6D, 0x12, 0x41, +0x9C, 0x8E, 0x6B, 0x8F, 0x6C, 0x12, 0xEA, 0xCE, +0xC3, 0x74, 0x01, 0x93, 0x95, 0x74, 0xFF, 0xE4, +0x93, 0x94, 0x00, 0xFE, 0xD3, 0xE5, 0x6C, 0x9F, +0xE5, 0x6B, 0x9E, 0x40, 0x0E, 0x12, 0x9F, 0xE6, +0xE4, 0xF0, 0x7D, 0x01, 0xAF, 0x67, 0x11, 0xF5, +0x02, 0x9A, 0x2C, 0x12, 0xEC, 0x03, 0xC3, 0xE5, +0x6C, 0x9F, 0xE5, 0x6B, 0x94, 0x00, 0x50, 0x0F, +0x12, 0x9F, 0xE6, 0xE4, 0xF0, 0x7D, 0x01, 0xAF, +0x67, 0x12, 0xE0, 0xDE, 0x02, 0x9A, 0x2C, 0x71, +0x41, 0x12, 0x9F, 0xE6, 0xE0, 0x04, 0xF0, 0xE5, +0x69, 0x90, 0x81, 0xED, 0x93, 0x25, 0x73, 0xFF, +0xE4, 0x33, 0xFE, 0xF1, 0xE6, 0xE0, 0xC3, 0x9F, +0xEE, 0xB1, 0x70, 0x50, 0x02, 0x41, 0x2C, 0xF1, +0xE6, 0xE4, 0xF0, 0x12, 0xEC, 0x03, 0x12, 0xEA, +0xCE, 0x74, 0x01, 0x93, 0x2F, 0xFF, 0xE4, 0x93, +0x34, 0x00, 0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, +0xE5, 0x67, 0x12, 0x91, 0xD5, 0x41, 0x2C, 0x51, +0x73, 0xE0, 0x64, 0x05, 0x60, 0x02, 0x21, 0x06, +0x90, 0x04, 0xA0, 0xE0, 0x64, 0x02, 0x70, 0x10, +0x51, 0x5A, 0xE4, 0xF0, 0x90, 0x04, 0xA1, 0xE0, +0x78, 0x88, 0xF6, 0x12, 0xDF, 0xBA, 0x41, 0x40, +0xAD, 0x69, 0xAF, 0x67, 0x12, 0x72, 0xEE, 0x12, +0xEB, 0x7F, 0xEF, 0xF0, 0xE5, 0x67, 0x12, 0x93, +0x34, 0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, 0x74, +0xD6, 0x25, 0x67, 0x51, 0x7F, 0xFF, 0xC3, 0x94, +0x30, 0x40, 0x1C, 0x75, 0xF0, 0x12, 0xE5, 0x67, +0x71, 0xEB, 0xFE, 0xC4, 0x13, 0x13, 0x54, 0x03, +0x20, 0xE0, 0x0C, 0x12, 0xEB, 0x7F, 0xE0, 0x60, +0x06, 0x90, 0x96, 0x4B, 0xE0, 0x60, 0x0A, 0xE4, +0x78, 0x88, 0xF6, 0x51, 0x5A, 0xE4, 0xF0, 0x80, +0x5D, 0x12, 0xEB, 0x73, 0xE0, 0xFE, 0x24, 0x05, +0xFD, 0xE4, 0x33, 0xFC, 0xEF, 0xB1, 0x6D, 0x50, +0x20, 0x74, 0xD6, 0x25, 0x67, 0x51, 0x7F, 0x24, +0x05, 0xFD, 0xE4, 0x33, 0xFC, 0xEE, 0xB1, 0x6D, +0x50, 0x0F, 0x12, 0xEB, 0x67, 0xE0, 0xB5, 0x69, +0x08, 0x51, 0x67, 0xE0, 0xC3, 0x94, 0x0A, 0x40, +0x28, 0x78, 0x88, 0xE6, 0xFF, 0x70, 0x04, 0x76, +0x01, 0x80, 0x0C, 0xEF, 0x78, 0x88, 0xB4, 0x01, +0x04, 0x76, 0x03, 0x80, 0x02, 0x76, 0x05, 0x51, +0x67, 0xE4, 0xF0, 0x74, 0xD6, 0x25, 0x67, 0x51, +0x7F, 0xFF, 0x12, 0xEB, 0x73, 0xEF, 0xF0, 0x80, +0x05, 0x51, 0x5A, 0xE0, 0x04, 0xF0, 0x12, 0xEB, +0x67, 0xE5, 0x69, 0xF0, 0x41, 0x27, 0x51, 0x73, +0xE0, 0x64, 0x06, 0x60, 0x02, 0x41, 0x2C, 0xF5, +0x6B, 0xF5, 0x6C, 0xE5, 0x67, 0x12, 0x93, 0x34, +0xE0, 0x54, 0x07, 0x78, 0x88, 0xF6, 0xD3, 0xE5, +0x6E, 0x94, 0xE8, 0xE5, 0x6D, 0x94, 0x03, 0x40, +0x06, 0x78, 0x86, 0x76, 0x05, 0x80, 0x15, 0xD3, +0xE5, 0x6E, 0x94, 0xFA, 0xE5, 0x6D, 0x94, 0x00, +0x40, 0x06, 0x78, 0x86, 0x76, 0x02, 0x80, 0x04, +0xE4, 0x78, 0x86, 0xF6, 0xE5, 0x6E, 0xAE, 0x6D, 0x78, 0x86, 0x86, 0x00, 0x08, 0x80, 0x05, 0xCE, -0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0xED, -0x90, 0x82, 0x01, 0x12, 0xEB, 0x28, 0xEF, 0x25, -0x6C, 0xF5, 0x6C, 0xEE, 0x35, 0x6B, 0xF5, 0x6B, -0xC3, 0x90, 0x95, 0xE1, 0xE0, 0x95, 0x6C, 0x90, -0x95, 0xE0, 0xE0, 0x95, 0x6B, 0x40, 0x07, 0x78, -0x87, 0x06, 0xE6, 0xB4, 0x05, 0xB2, 0x78, 0x87, -0xE6, 0xC3, 0x13, 0xF6, 0xFD, 0x08, 0xE6, 0x24, -0x01, 0xFF, 0xE4, 0x33, 0xA2, 0xE7, 0x13, 0xEF, -0x13, 0x08, 0xF6, 0xD3, 0x9D, 0x40, 0x07, 0xE6, -0x79, 0x87, 0x97, 0xF6, 0x80, 0x04, 0xE4, 0x78, -0x89, 0xF6, 0xD1, 0x5A, 0xE0, 0xC3, 0x13, 0xFF, -0x78, 0x89, 0xE6, 0xC4, 0x33, 0x54, 0xE0, 0x2F, -0xFF, 0xD1, 0x5A, 0xEF, 0xF0, 0xD1, 0x5A, 0xE0, -0xC3, 0x94, 0xC0, 0x40, 0x05, 0xD1, 0x5A, 0x74, -0xC0, 0xF0, 0xD1, 0x5A, 0xE0, 0x24, 0x1F, 0xFF, -0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x06, 0xCE, 0xA2, -0xE7, 0x13, 0xCE, 0x13, 0xD8, 0xF8, 0x78, 0x89, -0xF6, 0xE6, 0x25, 0xE0, 0xF6, 0x70, 0x03, 0xFF, -0x80, 0x05, 0x78, 0x89, 0xE6, 0x14, 0xFF, 0x78, -0x88, 0xA6, 0x07, 0xD3, 0x90, 0x95, 0xDE, 0xE0, -0x94, 0x03, 0x90, 0x95, 0xDD, 0xE0, 0x94, 0x00, -0x40, 0x02, 0xE4, 0xF6, 0x78, 0x88, 0x12, 0xB7, -0xBC, 0xD1, 0x4E, 0xE0, 0xFF, 0xD3, 0x94, 0x05, -0x50, 0x05, 0xEF, 0x04, 0xFF, 0x80, 0x02, 0x7F, -0x00, 0xD1, 0x4E, 0xEF, 0xF0, 0xE4, 0xF5, 0x6B, -0xF5, 0x6C, 0x12, 0xD6, 0x71, 0x05, 0x67, 0x21, -0x00, 0x22, 0x74, 0x7B, 0x25, 0x67, 0xF5, 0x82, -0xE4, 0x34, 0x96, 0xF5, 0x83, 0x22, 0x74, 0x76, -0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, -0x83, 0x22, 0x74, 0x4F, 0x25, 0x67, 0xF5, 0x82, -0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xA6, +0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, 0x90, +0x82, 0x06, 0xE4, 0xF1, 0xC2, 0x90, 0x95, 0xDD, +0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x78, 0x87, +0xF6, 0xF1, 0xF4, 0x78, 0x87, 0xE6, 0xFD, 0x12, +0xEB, 0x42, 0xAE, 0xF0, 0x78, 0x86, 0x86, 0x00, +0x08, 0x80, 0x05, 0xCE, 0xC3, 0x13, 0xCE, 0x13, +0xD8, 0xF9, 0xFF, 0xED, 0x90, 0x82, 0x01, 0xF1, +0xC2, 0xEF, 0x25, 0x6C, 0xF5, 0x6C, 0xEE, 0x35, +0x6B, 0xF5, 0x6B, 0xC3, 0x90, 0x95, 0xDE, 0xE0, +0x95, 0x6C, 0x90, 0x95, 0xDD, 0xE0, 0x95, 0x6B, +0x40, 0x07, 0x78, 0x87, 0x06, 0xE6, 0xB4, 0x05, +0xC0, 0x78, 0x87, 0xE6, 0xC3, 0x13, 0xF6, 0xFD, +0x08, 0xE6, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, +0xE7, 0x13, 0xEF, 0x13, 0x08, 0xF6, 0xD3, 0x9D, +0x40, 0x07, 0xE6, 0x79, 0x87, 0x97, 0xF6, 0x80, +0x04, 0xE4, 0x78, 0x89, 0xF6, 0x51, 0x4E, 0xE0, +0xC3, 0x13, 0xFF, 0x78, 0x89, 0xE6, 0xC4, 0x33, +0x54, 0xE0, 0x2F, 0xFF, 0x51, 0x4E, 0xEF, 0xF0, +0x51, 0x4E, 0xE0, 0xC3, 0x94, 0xC0, 0x40, 0x05, +0x51, 0x4E, 0x74, 0xC0, 0xF0, 0x51, 0x4E, 0xE0, +0x24, 0x1F, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, +0x06, 0xCE, 0xA2, 0xE7, 0x13, 0xCE, 0x13, 0xD8, +0xF8, 0x78, 0x89, 0xF6, 0xE6, 0x25, 0xE0, 0xF6, +0x70, 0x03, 0xFF, 0x80, 0x05, 0x78, 0x89, 0xE6, +0x14, 0xFF, 0x78, 0x88, 0xA6, 0x07, 0xD3, 0x90, +0x95, 0xD5, 0xE0, 0x94, 0x03, 0x90, 0x95, 0xD4, +0xE0, 0x94, 0x00, 0x40, 0x02, 0xE4, 0xF6, 0x78, +0x88, 0x12, 0xDF, 0xBA, 0x51, 0x73, 0xE0, 0xFF, +0xD3, 0x94, 0x05, 0x50, 0x05, 0xEF, 0x04, 0xFF, +0x80, 0x02, 0x7F, 0x00, 0x51, 0x73, 0xEF, 0xF0, +0xE4, 0xF5, 0x6B, 0xF5, 0x6C, 0x12, 0xEB, 0xFC, +0x05, 0x67, 0x02, 0x93, 0xC9, 0x22, 0x74, 0x4F, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0xF6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -0xF5, 0x83, 0x22, 0xE0, 0x54, 0x03, 0x90, 0x92, -0x80, 0xF0, 0x22, 0x74, 0xB6, 0x25, 0x61, 0xF5, -0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xFF, -0x75, 0xF0, 0x12, 0xED, 0x90, 0x89, 0x52, 0x12, -0x04, 0x6E, 0xE0, 0x22, 0x8F, 0x75, 0x8D, 0x76, -0xEF, 0x11, 0xE4, 0xE0, 0xFD, 0x54, 0x7F, 0xF5, -0x77, 0xED, 0x54, 0x80, 0xF5, 0x78, 0xF1, 0xF8, -0xF5, 0x7A, 0x75, 0xF0, 0x12, 0xEF, 0xD1, 0xA4, -0xC4, 0x54, 0x03, 0xF5, 0x7B, 0xF1, 0x68, 0x74, -0xFF, 0xF0, 0xF1, 0xD1, 0xE5, 0x78, 0x4D, 0xFF, -0x12, 0xDD, 0xD4, 0xEF, 0xF0, 0xE5, 0x75, 0x11, -0x36, 0xE0, 0x54, 0x03, 0xF5, 0x79, 0x74, 0x46, -0x25, 0x75, 0x12, 0xDD, 0xE0, 0xE5, 0x79, 0xF0, -0xE5, 0x77, 0x65, 0x7A, 0x70, 0x22, 0x75, 0xF0, -0x12, 0xE5, 0x75, 0x12, 0xD9, 0x47, 0xC4, 0x13, -0x54, 0x07, 0x30, 0xE0, 0x0B, 0xE5, 0x78, 0x70, -0x07, 0xE5, 0x77, 0x44, 0x80, 0xFD, 0x80, 0x4B, -0xF1, 0xD1, 0x7D, 0x07, 0xAF, 0x75, 0x80, 0x60, -0xE5, 0x77, 0xC3, 0x95, 0x7A, 0x50, 0x35, 0xAB, -0x75, 0xAD, 0x7A, 0xAF, 0x77, 0x12, 0x72, 0x7F, -0xAD, 0x07, 0xE5, 0x77, 0xC3, 0x94, 0x0C, 0x40, -0x2A, 0x75, 0xF0, 0x12, 0xE5, 0x75, 0x12, 0xD9, -0x47, 0xFE, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -0x1A, 0xE5, 0x76, 0x60, 0x16, 0xE5, 0x78, 0x70, -0x12, 0xE5, 0x77, 0x44, 0x80, 0xFD, 0xF1, 0x68, -0xEF, 0xF0, 0x80, 0x07, 0x12, 0xDD, 0xD4, 0xE5, -0x7A, 0xF0, 0xFD, 0x90, 0x92, 0x80, 0xE5, 0x79, -0xF0, 0xAB, 0x76, 0xAF, 0x75, 0x02, 0x75, 0x80, -0x74, 0x6B, 0x25, 0x75, 0xF5, 0x82, 0xE4, 0x34, -0x96, 0xF5, 0x83, 0x22, 0x7D, 0x07, 0xAF, 0x67, -0xED, 0x30, 0xE0, 0x08, 0x12, 0xD6, 0x98, 0x90, -0x89, 0x5F, 0xF1, 0xA4, 0xED, 0x30, 0xE1, 0x09, -0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x53, 0xF1, -0xA4, 0xED, 0x30, 0xE2, 0x09, 0x75, 0xF0, 0x12, -0xEF, 0x12, 0xD6, 0x5E, 0xE4, 0xF0, 0x12, 0xD6, -0xD5, 0xEE, 0xF0, 0x22, 0x12, 0x04, 0x6E, 0xE4, -0xF0, 0xA3, 0xF0, 0x22, 0xD3, 0x9D, 0xEC, 0x64, -0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x74, 0xD6, -0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, -0x83, 0xE0, 0x22, 0xE5, 0x69, 0x25, 0xE0, 0x24, -0x75, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, -0x22, 0xE5, 0x77, 0x25, 0xE0, 0x24, 0x75, 0xF5, -0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE4, 0x93, -0xFE, 0x74, 0x01, 0x93, 0xFF, 0xE5, 0x75, 0x25, -0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -0xF5, 0x83, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, -0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x4F, 0x12, -0x04, 0x6E, 0xE0, 0x22, 0x12, 0x8F, 0xE8, 0x90, -0x04, 0x24, 0xE0, 0xFF, 0xE4, 0xFE, 0x12, 0x8A, -0x44, 0x8E, 0x82, 0x12, 0xB5, 0x57, 0x2F, 0xFD, -0xEE, 0x11, 0x2B, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, -0x03, 0xEC, 0x22, 0x90, 0x93, 0x58, 0xE0, 0xC3, -0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, -0x64, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -0x22, 0xE4, 0x90, 0x96, 0x31, 0xF0, 0x90, 0x93, -0x58, 0xE0, 0xFF, 0x20, 0xE0, 0x02, 0x21, 0xB7, -0xF1, 0xD3, 0x54, 0x07, 0x90, 0x96, 0x2E, 0xF0, -0x60, 0x07, 0xE0, 0x64, 0x02, 0x60, 0x02, 0x21, -0x4A, 0x90, 0x93, 0x5A, 0xE0, 0x70, 0x2E, 0x12, -0xEA, 0xF3, 0x7B, 0x4E, 0x12, 0xA7, 0xD3, 0x11, -0x23, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, 0x04, 0x7D, -0x01, 0x12, 0xA2, 0x07, 0xBF, 0x01, 0x0D, 0x12, -0xA3, 0x35, 0x44, 0x01, 0xF0, 0x90, 0x93, 0x5A, -0x74, 0x01, 0xF0, 0x22, 0x90, 0x96, 0x2F, 0xE0, -0xFD, 0x7B, 0x4F, 0x21, 0x1E, 0x90, 0x93, 0x5A, -0xE0, 0x64, 0x01, 0x60, 0x02, 0x21, 0x3B, 0xF1, -0xC6, 0xFF, 0xF1, 0xD7, 0xFE, 0xC4, 0x54, 0x0F, -0x30, 0xE0, 0x02, 0x21, 0x38, 0xEF, 0x12, 0xA3, -0x3D, 0xFF, 0x30, 0xE0, 0x08, 0x90, 0x96, 0x31, -0x74, 0x01, 0xF0, 0x80, 0x14, 0xEF, 0xC3, 0x13, -0x20, 0xE0, 0x0E, 0x90, 0x96, 0x31, 0x74, 0x01, -0xF0, 0x12, 0xEA, 0xF3, 0x7B, 0x50, 0x12, 0xA7, -0xD3, 0x90, 0x96, 0x31, 0xE0, 0x60, 0x6C, 0x90, -0x93, 0xDF, 0xE0, 0xFF, 0x90, 0x93, 0xDE, 0xE0, -0x6F, 0x60, 0x48, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, -0x94, 0x01, 0x40, 0x08, 0x90, 0x96, 0x32, 0x74, -0x04, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x96, 0x32, -0xF0, 0x11, 0x23, 0xE0, 0xFF, 0x7E, 0x00, 0x90, -0x96, 0x32, 0xE0, 0xFB, 0x7D, 0x01, 0x12, 0xA2, -0x07, 0xBF, 0x01, 0x13, 0xE4, 0x90, 0x92, 0x20, -0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, 0xFB, 0xFD, -0x7F, 0x58, 0x7E, 0x01, 0x02, 0x66, 0x33, 0x90, -0x96, 0x2F, 0xE0, 0xFD, 0x7B, 0x51, 0xE4, 0xFF, -0x02, 0xA1, 0x8C, 0xE4, 0x90, 0x93, 0xDE, 0xF0, -0x12, 0xA3, 0x95, 0x90, 0x93, 0x58, 0xE0, 0xFF, -0x12, 0xA3, 0x39, 0x54, 0xFB, 0xF0, 0x80, 0x03, -0x12, 0xA3, 0x95, 0x90, 0x93, 0x5A, 0xE0, 0x64, -0x05, 0x70, 0x74, 0x31, 0xB8, 0xEF, 0x70, 0x6F, -0x80, 0x68, 0x90, 0x96, 0x2E, 0xE0, 0xFF, 0x64, -0x03, 0x60, 0x05, 0xEF, 0x64, 0x01, 0x70, 0x5F, -0x90, 0x93, 0x5A, 0xE0, 0x64, 0x05, 0x70, 0x57, -0x90, 0x96, 0x2E, 0xE0, 0x64, 0x01, 0x70, 0x3D, -0x12, 0xA5, 0x37, 0xE0, 0xD3, 0x94, 0x1F, 0x90, -0x93, 0x58, 0xE0, 0x40, 0x10, 0x11, 0x28, 0xE0, -0xFF, 0x90, 0x8A, 0xBF, 0x12, 0xAF, 0xC1, 0x7D, -0x00, 0x7C, 0x7C, 0x80, 0x1D, 0x11, 0x27, 0xE0, -0xFB, 0x12, 0xA5, 0x37, 0xE0, 0x7D, 0x00, 0x25, -0xE0, 0x25, 0xE0, 0xFC, 0xAF, 0x03, 0x90, 0x8A, -0xBF, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xF5, 0x82, -0x8A, 0x83, 0x12, 0x04, 0x7E, 0xF1, 0xC6, 0xFD, -0x7F, 0x02, 0x12, 0xA1, 0x09, 0x31, 0xB8, 0xEF, -0x70, 0x05, 0x7F, 0x06, 0x12, 0xE3, 0x0F, 0x22, -0x12, 0x8D, 0x30, 0xEF, 0x70, 0x02, 0xFF, 0x22, -0xF1, 0xC6, 0x90, 0x93, 0xAC, 0xF0, 0x90, 0x93, -0x58, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, 0x54, -0xF1, 0xFF, 0xEE, 0x04, 0x54, 0x07, 0x25, 0xE0, -0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x12, 0xEB, 0x20, -0x54, 0x07, 0xB5, 0x07, 0x04, 0xEE, 0x54, 0xF1, -0xF0, 0xF1, 0xC6, 0xF5, 0x7D, 0xE4, 0x90, 0x93, -0x5A, 0xF0, 0xE5, 0x7D, 0x75, 0xF0, 0x1B, 0xA4, -0x24, 0x5F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0xE0, 0x30, 0xE0, 0x29, 0x51, 0x88, 0xE0, -0x24, 0xAF, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0xE0, 0xFF, 0x12, 0xE3, 0x94, 0xEF, 0xF0, -0x51, 0x88, 0xE0, 0x04, 0xF0, 0x51, 0x88, 0xE0, -0xFF, 0x90, 0x93, 0xAE, 0xE0, 0xFE, 0xEF, 0xB5, -0x06, 0x04, 0x51, 0x88, 0xE4, 0xF0, 0x12, 0xE3, -0x94, 0xE0, 0xFC, 0x90, 0x93, 0xAC, 0xE0, 0x12, -0xE3, 0x96, 0xE0, 0x6C, 0x60, 0x14, 0xE5, 0x7D, -0x12, 0xA3, 0x71, 0x12, 0xEA, 0x58, 0xAF, 0x04, -0x12, 0xA7, 0x28, 0xE5, 0x7D, 0x12, 0xA3, 0x71, -0x51, 0x94, 0xE5, 0x7D, 0xF1, 0xD7, 0x54, 0x07, -0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0F, 0xE5, 0x7D, -0x11, 0x2B, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, 0x04, -0xE4, 0xFD, 0x12, 0xA2, 0x07, 0xAD, 0x7D, 0x7F, -0x01, 0x12, 0xA1, 0x09, 0x90, 0x93, 0xAD, 0xE0, -0xC3, 0x13, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x05, -0xE4, 0xFF, 0x12, 0xE3, 0x0F, 0x7F, 0x01, 0x22, -0x74, 0xD2, 0x25, 0x7D, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0x22, 0xFF, 0xEE, 0x13, 0x13, -0x54, 0x07, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x97, 0x0C, 0xED, 0xF0, 0xE4, -0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0x61, 0x7F, -0x90, 0x06, 0x03, 0xE0, 0x54, 0xFB, 0xF0, 0x90, -0x97, 0x0C, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, -0xFE, 0x90, 0x04, 0x42, 0xE0, 0x54, 0x9F, 0x4E, -0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xE6, 0xE6, 0x90, -0x97, 0x0D, 0xEF, 0xF0, 0x90, 0x04, 0x83, 0xF0, -0x90, 0x96, 0xB8, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0x01, 0x90, 0x96, 0xBC, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x01, 0x91, 0x53, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xBC, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, -0x00, 0x7E, 0x09, 0x91, 0x57, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x10, 0x90, 0x97, 0x0C, 0x91, -0x76, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x01, -0x12, 0x03, 0xEB, 0x78, 0x04, 0xF1, 0xE6, 0x7F, -0x00, 0x7E, 0x0A, 0x91, 0x57, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x0C, 0x00, 0x90, 0x97, 0x0C, 0x91, -0x76, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x0A, -0xF1, 0xE6, 0x7F, 0x00, 0x7E, 0x0D, 0x91, 0x57, -0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, 0x00, 0x90, -0x97, 0x0D, 0x91, 0x76, 0xEF, 0x54, 0x03, 0xFF, -0xE4, 0x78, 0x1A, 0xF1, 0xE6, 0x7F, 0x18, 0x91, -0x55, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, -0x90, 0x96, 0xBC, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0x00, 0xF1, 0xEF, 0x12, 0x04, 0x3D, 0x00, -0x00, 0x0C, 0x00, 0x90, 0x96, 0xAA, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x58, 0x90, -0x06, 0x03, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x96, -0xB8, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, -0x90, 0x96, 0xBC, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0x00, 0x91, 0x53, 0x12, 0x04, 0x3D, 0x00, -0x00, 0x00, 0x01, 0x90, 0x96, 0xBC, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, -0x09, 0x91, 0x57, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x0C, 0x00, 0x90, 0x96, 0xBC, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x0C, 0x00, 0xF1, 0xEF, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xAA, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x7D, -0x18, 0x7C, 0x00, 0xE4, 0xFF, 0x12, 0xA7, 0xEF, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, 0xB6, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, -0x96, 0xC0, 0x12, 0x04, 0x31, 0x90, 0x96, 0xB8, -0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, -0xC0, 0x12, 0x86, 0x2D, 0x12, 0x86, 0x13, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x96, 0xB8, 0x12, 0x04, 0xB8, 0x90, 0x96, 0xBC, -0x12, 0x86, 0x2D, 0x12, 0x86, 0x13, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, -0x20, 0x90, 0x96, 0xC4, 0x12, 0x04, 0x31, 0x90, -0x96, 0xC4, 0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, -0x12, 0x04, 0x31, 0x90, 0x96, 0xB6, 0xE0, 0xFE, -0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x7F, 0x00, 0x7E, 0x08, 0x71, -0xE5, 0x90, 0x96, 0xB8, 0x22, 0x90, 0x05, 0x61, -0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0x78, 0x08, -0x12, 0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, -0x06, 0xAB, 0x07, 0x90, 0x05, 0x60, 0xE0, 0xFF, -0xE4, 0xFC, 0xFD, 0xFE, 0x22, 0x90, 0x93, 0x58, -0xE0, 0x20, 0xE0, 0x02, 0xE1, 0xAB, 0x90, 0x93, -0xD9, 0xE0, 0x20, 0xE0, 0x02, 0xA1, 0xF7, 0x12, -0xEA, 0x93, 0x50, 0x02, 0xA1, 0xF7, 0x90, 0x93, -0xE0, 0xE0, 0x30, 0xE0, 0x23, 0x54, 0xFE, 0xF0, -0x90, 0x93, 0xE2, 0xE0, 0x90, 0x93, 0xD6, 0xF0, -0x90, 0x93, 0xE5, 0xE0, 0x90, 0x93, 0xD7, 0xF0, -0x90, 0x93, 0xE3, 0xE0, 0x90, 0x93, 0x5D, 0xF0, -0x90, 0x93, 0xE4, 0xE0, 0x90, 0x93, 0x78, 0xF0, -0x90, 0x05, 0x58, 0xE0, 0x90, 0x95, 0xFB, 0xF0, -0xF1, 0xCF, 0x54, 0x07, 0xFF, 0x64, 0x02, 0x60, -0x03, 0xEF, 0x70, 0x21, 0x90, 0x93, 0xD9, 0x12, -0xBA, 0x92, 0x20, 0xE0, 0x18, 0xEF, 0x44, 0x40, -0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x95, -0xFB, 0xE0, 0xFF, 0x90, 0x93, 0xD6, 0xE0, 0x2F, -0x24, 0xFD, 0x12, 0xBB, 0x72, 0x91, 0x5D, 0x12, -0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0x90, 0x05, 0x62, 0x91, 0x76, 0x78, -0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -0x91, 0x76, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x86, 0x20, 0x90, 0x95, 0xEF, 0x12, 0x04, 0x31, -0x90, 0x05, 0x65, 0x91, 0x76, 0x12, 0xD0, 0xF5, -0x90, 0x05, 0x64, 0x91, 0x76, 0x12, 0x86, 0x20, -0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -0x90, 0x05, 0x66, 0x91, 0x76, 0x78, 0x10, 0x12, -0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, -0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x91, 0x76, -0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0xF1, 0xBC, 0x90, -0x93, 0xD6, 0xE0, 0xFB, 0xE4, 0xFA, 0xF9, 0xF8, -0x90, 0x95, 0xFB, 0x91, 0x76, 0x12, 0x85, 0xA9, -0xE4, 0xFB, 0x7A, 0x04, 0x12, 0x85, 0xC4, 0x90, -0x95, 0xEF, 0x12, 0x86, 0x2D, 0x12, 0x85, 0xA9, -0x90, 0x95, 0xF7, 0x12, 0x04, 0x31, 0xF1, 0xB6, -0x90, 0x95, 0xF7, 0x12, 0xA7, 0xE0, 0x50, 0x07, -0xF1, 0xAE, 0x12, 0xEA, 0x3C, 0xF1, 0xBF, 0x90, -0x95, 0xF3, 0x12, 0xA5, 0x77, 0x90, 0x05, 0x8B, -0xF1, 0xAC, 0x12, 0xEA, 0xCF, 0xF1, 0xAC, 0x12, -0xEA, 0xD8, 0xF1, 0xAC, 0x90, 0x05, 0x88, 0xEF, -0xF0, 0x90, 0x95, 0xF7, 0x12, 0xA5, 0x77, 0x90, -0x05, 0x87, 0xEF, 0xF0, 0x90, 0x95, 0xF7, 0x12, -0xEA, 0x87, 0xEF, 0xF0, 0x90, 0x95, 0xF7, 0x12, -0xEA, 0x7B, 0xEF, 0xF0, 0x90, 0x95, 0xF7, 0x12, -0xEA, 0x6C, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, -0x93, 0xD5, 0xE0, 0x20, 0xE0, 0x02, 0xE1, 0xAB, -0x90, 0x93, 0xD9, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, -0x54, 0x1F, 0x70, 0x02, 0xE1, 0xAB, 0xEF, 0x54, -0xC1, 0xFF, 0xEE, 0x14, 0x54, 0x1F, 0xFE, 0x25, -0xE0, 0x4F, 0xF0, 0xE0, 0xC3, 0x13, 0x54, 0x1F, -0x60, 0x02, 0xE1, 0xAB, 0x90, 0x93, 0xE1, 0xE0, -0x30, 0xE0, 0x17, 0x54, 0xFE, 0xF0, 0x90, 0x93, -0xE0, 0xE0, 0x44, 0x01, 0xF0, 0xA3, 0xE0, 0x54, -0xFE, 0xFF, 0x90, 0x93, 0xD5, 0xE0, 0x54, 0x01, -0x4F, 0xF0, 0x90, 0x05, 0x22, 0xE0, 0x44, 0x40, -0xFD, 0x7B, 0x58, 0x7F, 0x40, 0x12, 0xA1, 0x8C, -0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, 0xF0, 0x90, -0x05, 0x69, 0x91, 0x76, 0x12, 0xD0, 0xF5, 0x90, -0x05, 0x68, 0x91, 0x76, 0x12, 0x86, 0x20, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x05, 0x6A, 0x91, 0x76, 0x78, 0x10, 0x12, 0x03, -0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x91, 0x76, 0x78, -0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, -0x95, 0xEF, 0x12, 0x04, 0x31, 0xF1, 0xB6, 0x90, -0x95, 0xF7, 0x12, 0x04, 0x31, 0x90, 0x05, 0x6D, -0x91, 0x76, 0x12, 0xD0, 0xF5, 0x90, 0x05, 0x6C, -0x91, 0x76, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, -0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x6E, -0x91, 0x76, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0xA3, 0x91, 0x76, 0x78, 0x18, 0x12, -0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0xF1, 0xBC, 0x90, 0x95, 0xEF, 0x12, -0x86, 0x2D, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, -0xC0, 0x03, 0x90, 0x93, 0xD5, 0xE0, 0xC3, 0x13, -0x54, 0x7F, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, 0xFB, -0x7A, 0x04, 0xF9, 0xF8, 0x12, 0x85, 0xC4, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x85, 0xA9, 0x90, 0x95, 0xEF, 0x12, 0x04, 0x31, -0x90, 0x95, 0xF7, 0x12, 0x04, 0xB8, 0x90, 0x95, -0xEF, 0x12, 0xAD, 0x80, 0x50, 0x07, 0xF1, 0xAE, -0x12, 0xEA, 0x3C, 0xF1, 0xBF, 0x90, 0x95, 0xF3, -0x12, 0xA5, 0x77, 0x90, 0x05, 0x67, 0xF1, 0xAC, -0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x66, -0xF1, 0xAC, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, -0x05, 0x65, 0xF1, 0xAC, 0x90, 0x05, 0x64, 0xEF, -0xF0, 0x90, 0x95, 0xEF, 0x12, 0xA5, 0x77, 0x90, -0x05, 0x63, 0xF1, 0xB4, 0x78, 0x10, 0x12, 0x03, -0xEB, 0x90, 0x05, 0x62, 0xF1, 0xB4, 0x78, 0x08, -0x12, 0x03, 0xEB, 0x90, 0x05, 0x61, 0xF1, 0xB4, -0x90, 0x05, 0x60, 0xEF, 0xF0, 0x90, 0x05, 0x50, -0xE0, 0x44, 0x08, 0xF0, 0x90, 0x05, 0x22, 0xE0, -0x54, 0xBF, 0xFD, 0x7B, 0x59, 0x7F, 0x40, 0x12, -0xA1, 0x8C, 0x7F, 0x08, 0x12, 0xE3, 0x0F, 0x90, -0x93, 0xD9, 0xE0, 0x54, 0xC1, 0x44, 0x28, 0xF0, -0x44, 0x01, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0x95, -0xF3, 0x02, 0x04, 0xB8, 0xEF, 0xF0, 0x90, 0x95, -0xEF, 0x02, 0x04, 0xB8, 0x12, 0x86, 0x20, 0x90, -0x95, 0xF3, 0x02, 0x04, 0x31, 0xF0, 0x90, 0x93, -0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0x22, 0x90, -0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0x75, -0xF0, 0x1B, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0x12, 0x03, -0xFE, 0x90, 0x96, 0xBC, 0x02, 0x04, 0x31, 0x7F, -0x84, 0x7E, 0x08, 0x71, 0xE5, 0x90, 0x96, 0xA6, -0x22, 0x8B, 0x61, 0x8A, 0x62, 0x89, 0x63, 0x12, -0x02, 0x06, 0xFF, 0x54, 0x0F, 0xF5, 0x64, 0xEF, -0xC4, 0x54, 0x0F, 0x64, 0x0F, 0x70, 0x3F, 0x90, -0x93, 0x58, 0xE0, 0x54, 0xFE, 0xFF, 0xF0, 0xE5, -0x64, 0x54, 0x07, 0x25, 0xE0, 0xFE, 0xEF, 0x54, -0xF1, 0x4E, 0x12, 0x87, 0xFB, 0xC4, 0x13, 0x54, -0x07, 0x90, 0x93, 0xDF, 0x20, 0xE0, 0x05, 0x74, -0x06, 0xF0, 0x80, 0x03, 0x74, 0x01, 0xF0, 0x7D, -0x20, 0xE4, 0xFF, 0x12, 0x7C, 0x3B, 0xAF, 0x64, -0x31, 0xAC, 0xBF, 0x01, 0x05, 0xE4, 0xFD, 0xFF, -0x31, 0x09, 0x7F, 0x02, 0x01, 0xFB, 0xE5, 0x64, -0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF9, 0x74, -0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, -0xC0, 0x01, 0xE5, 0x63, 0x24, 0x01, 0xF9, 0xE4, -0x35, 0x62, 0x85, 0x61, 0x45, 0x12, 0xEB, 0x47, -0xD0, 0x01, 0xD0, 0x02, 0x12, 0x69, 0xF5, 0xE5, -0x64, 0x12, 0x9F, 0xD7, 0x54, 0xF7, 0x11, 0xFF, -0xC4, 0x54, 0x0F, 0x14, 0x65, 0x64, 0x70, 0x76, -0x90, 0x88, 0x36, 0xE0, 0x70, 0x07, 0x90, 0x88, -0x2C, 0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x05, 0x80, -0x62, 0x31, 0x00, 0xC4, 0x54, 0x0F, 0x90, 0x93, -0x59, 0x12, 0x87, 0x68, 0xFC, 0x54, 0x0F, 0xC4, -0x54, 0xF0, 0xFE, 0x90, 0x93, 0x58, 0xE0, 0x54, -0x0F, 0x4E, 0xF0, 0xEC, 0x54, 0x60, 0xC4, 0x54, -0x0F, 0xFF, 0x90, 0x93, 0xAD, 0xE0, 0x54, 0xF9, -0x4F, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xF1, -0xF0, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x90, -0x93, 0xD5, 0xE0, 0x90, 0x93, 0xD9, 0x30, 0xE0, -0x0B, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xC1, 0x44, -0x02, 0xF0, 0x80, 0x07, 0xE0, 0x44, 0x01, 0xF0, -0x54, 0xC1, 0xF0, 0x90, 0x93, 0xD9, 0xE0, 0x54, -0xBF, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x44, 0x01, -0xF0, 0x7F, 0x03, 0x12, 0xE3, 0x0F, 0x22, 0xF0, -0xAB, 0x61, 0xAA, 0x62, 0xA9, 0x63, 0x02, 0x02, -0x06, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x96, 0x34, 0xED, 0xF0, 0x90, 0x96, 0x33, -0xEF, 0xF0, 0x64, 0x02, 0x70, 0x24, 0x90, 0x05, -0x22, 0xE0, 0x90, 0x96, 0x35, 0xF0, 0x7B, 0x4A, -0x7D, 0x6F, 0x12, 0x8D, 0x2B, 0xBF, 0x01, 0x07, -0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, 0x47, 0x90, -0x96, 0x35, 0xE0, 0xFD, 0x7B, 0x46, 0x51, 0x00, -0x80, 0x41, 0x90, 0x96, 0x33, 0xE0, 0x64, 0x01, -0x70, 0x30, 0x31, 0x88, 0x90, 0x96, 0x34, 0xE0, -0xFF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x60, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xF4, -0x90, 0x04, 0xD4, 0xF0, 0xEF, 0x75, 0xF0, 0x1B, -0xA4, 0x24, 0x61, 0xF5, 0x82, 0xE4, 0x34, 0x93, -0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, 0xD5, 0xF0, -0x80, 0x07, 0x90, 0x04, 0xD4, 0xE4, 0xF0, 0xA3, -0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xFB, 0xFD, 0x7F, 0xFF, 0xEB, 0xB4, 0x57, 0x04, -0x71, 0x4C, 0x80, 0x0E, 0xEF, 0x70, 0x07, 0x90, -0x93, 0xF3, 0xE0, 0x4D, 0x80, 0x04, 0xF1, 0xB9, -0x71, 0x4C, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x93, -0x01, 0xEB, 0xF0, 0x22, 0x8F, 0x65, 0x90, 0x05, -0x22, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x7B, 0x17, -0x12, 0x8D, 0x29, 0xEF, 0x64, 0x01, 0x70, 0x39, -0xE5, 0x65, 0x12, 0xE3, 0x96, 0xE0, 0xFC, 0x71, -0x6F, 0x12, 0xEA, 0x58, 0xAF, 0x04, 0xF1, 0x28, -0x71, 0x6F, 0x12, 0x9A, 0x94, 0xE5, 0x65, 0x12, -0x9F, 0xD7, 0x54, 0x07, 0xFF, 0x60, 0x03, 0xBF, -0x02, 0x0E, 0xE5, 0x65, 0x12, 0x98, 0x2B, 0xE0, -0xFF, 0x7E, 0x00, 0xE4, 0xFB, 0xFD, 0x51, 0x07, -0xAD, 0x65, 0x7F, 0x01, 0x31, 0x09, 0x7F, 0x01, -0x22, 0x90, 0x95, 0x57, 0xE0, 0xFD, 0x7B, 0x49, -0xE4, 0xFF, 0x31, 0x8C, 0x7F, 0x00, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0xD4, 0xEE, 0xF0, 0xA3, 0xF1, 0xE7, 0xF0, 0x90, -0x04, 0x1D, 0xE0, 0x60, 0x29, 0x90, 0x05, 0x22, -0xE0, 0x90, 0x96, 0xDA, 0xF0, 0x7B, 0x14, 0x12, -0x8D, 0x29, 0xEF, 0x64, 0x01, 0x70, 0x06, 0xB1, -0xFB, 0xD1, 0x4F, 0x80, 0x04, 0x7F, 0x00, 0x80, -0x13, 0x90, 0x96, 0xDA, 0xE0, 0xFD, 0x7B, 0x15, -0xE4, 0xFF, 0x31, 0x8C, 0x80, 0x04, 0xB1, 0xFB, -0xD1, 0x4F, 0xF1, 0xB0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xE4, 0x90, 0x96, 0xFF, 0xF0, 0xA3, 0xF0, -0x90, 0x05, 0x22, 0xE0, 0x90, 0x97, 0x01, 0xF0, -0x7B, 0x47, 0x7D, 0xFF, 0xE4, 0xFF, 0x31, 0x8C, -0x90, 0x05, 0xF8, 0xE0, 0x70, 0x1A, 0xA3, 0xE0, -0x70, 0x16, 0xA3, 0xE0, 0x70, 0x12, 0xA3, 0xE0, -0x70, 0x0E, 0x90, 0x97, 0x01, 0xE0, 0xFD, 0x7B, -0x48, 0xE4, 0xFF, 0x31, 0x8C, 0x7F, 0x01, 0x22, -0xD1, 0xFD, 0x30, 0xE0, 0x1A, 0xD3, 0x90, 0x97, -0x00, 0xE0, 0x94, 0x03, 0x90, 0x96, 0xFF, 0xE0, -0x94, 0x00, 0x40, 0x07, 0x71, 0x63, 0xFD, 0x7B, -0x5A, 0x80, 0x18, 0x7F, 0x01, 0x80, 0x18, 0xD3, -0x90, 0x97, 0x00, 0xE0, 0x94, 0xE8, 0x90, 0x96, -0xFF, 0xE0, 0x94, 0x03, 0x40, 0x07, 0x71, 0x63, -0xFD, 0x7B, 0x5B, 0x41, 0x00, 0x7F, 0x32, 0x7E, -0x00, 0x12, 0x7C, 0x6A, 0x90, 0x96, 0xFF, 0xF1, -0xD9, 0x80, 0x9D, 0xE4, 0x90, 0x96, 0x21, 0xF0, -0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, 0x5D, 0xC3, -0x13, 0x54, 0x07, 0xFF, 0x71, 0x3D, 0xFE, 0x30, -0xE0, 0x52, 0xEF, 0x71, 0x57, 0xF5, 0x83, 0xEE, -0x54, 0xFE, 0xF0, 0xEF, 0x71, 0x3D, 0xFF, 0x13, -0x13, 0x54, 0x3F, 0x30, 0xE0, 0x13, 0x12, 0xEB, -0x20, 0x54, 0x07, 0x71, 0x57, 0xF5, 0x83, 0xEF, -0x54, 0xFB, 0xF0, 0x90, 0x96, 0x21, 0x74, 0x01, -0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x1C, -0x71, 0x95, 0x71, 0x35, 0x44, 0x02, 0xF0, 0xE4, -0x90, 0x93, 0xDE, 0x12, 0x9F, 0xC5, 0xFD, 0x7F, -0x02, 0x31, 0x09, 0x90, 0x96, 0x21, 0xE0, 0x60, -0x0B, 0x02, 0x98, 0x39, 0x71, 0x35, 0x54, 0xFD, -0xF0, 0xE4, 0x31, 0x88, 0x22, 0x90, 0x93, 0x58, -0xE0, 0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, -0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, -0xF5, 0x83, 0xE0, 0x22, 0x90, 0x93, 0xF4, 0xE0, -0xFF, 0x90, 0x93, 0xF3, 0xE0, 0x4F, 0x22, 0x75, -0xF0, 0x1B, 0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0x22, 0x90, 0x01, 0xC0, 0xE0, 0x44, -0x20, 0xF0, 0x90, 0x97, 0x01, 0xE0, 0x22, 0xE5, -0x65, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5C, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFE, -0x54, 0x03, 0x22, 0x71, 0x35, 0x20, 0xE0, 0x07, -0xC3, 0x13, 0x30, 0xE0, 0x07, 0x80, 0x06, 0x71, -0x35, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x93, 0x5A, -0x74, 0x05, 0xF0, 0x22, 0x90, 0x93, 0x58, 0xE0, -0x20, 0xE0, 0x02, 0xA1, 0x2E, 0x90, 0x93, 0xDA, -0xE0, 0x04, 0x12, 0x9F, 0xC5, 0x04, 0xFF, 0x90, -0x96, 0x21, 0xF0, 0x90, 0x93, 0x59, 0xE0, 0xB5, -0x07, 0x05, 0xE4, 0x90, 0x96, 0x21, 0xF0, 0x90, -0x93, 0xD8, 0xE0, 0xFF, 0x60, 0x1A, 0x90, 0x96, -0x21, 0xB1, 0x3A, 0xE0, 0xC3, 0x9F, 0x90, 0x92, -0x21, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xFB, -0xFD, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x66, 0x33, -0x90, 0x96, 0x21, 0xE0, 0xFF, 0x12, 0x9F, 0xD7, -0x54, 0x07, 0xFE, 0x64, 0x02, 0x60, 0x03, 0xEE, -0x70, 0x11, 0xEF, 0xB1, 0x3B, 0xE0, 0x24, 0xFC, -0xFF, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0xA3, 0xEF, -0x12, 0xBB, 0x75, 0x12, 0x9F, 0xCF, 0x54, 0x07, -0xFF, 0x14, 0x60, 0x0E, 0x14, 0x60, 0x07, 0x14, -0x60, 0x08, 0x24, 0x03, 0x70, 0x09, 0x71, 0x83, -0x80, 0x02, 0x71, 0x95, 0x12, 0x98, 0x39, 0x12, -0xEA, 0x93, 0x40, 0x02, 0xA1, 0x2E, 0x12, 0x9C, -0x5D, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, -0x9C, 0x76, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0xA3, 0x12, 0x9C, 0x76, 0x78, 0x18, -0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, 0x96, -0x22, 0x12, 0x04, 0x31, 0x90, 0x05, 0x65, 0x12, -0x9C, 0x76, 0x12, 0xD0, 0xF5, 0x90, 0x05, 0x64, -0x12, 0x9C, 0x76, 0x12, 0x86, 0x20, 0xC0, 0x04, -0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, -0x66, 0x12, 0x9C, 0x76, 0x78, 0x10, 0x12, 0x03, -0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x9C, 0x76, -0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, -0x90, 0x96, 0x26, 0x12, 0x04, 0x31, 0x90, 0x96, -0x21, 0xB1, 0x3A, 0x12, 0x9C, 0x76, 0xFB, 0x7A, -0x04, 0xF9, 0xF8, 0x12, 0x85, 0xC4, 0x90, 0x96, -0x22, 0x12, 0x86, 0x2D, 0x12, 0x85, 0xA9, 0x90, -0x96, 0x2A, 0x12, 0x04, 0x31, 0x90, 0x96, 0x22, -0x12, 0x04, 0xB8, 0x90, 0x96, 0x2A, 0xF1, 0xE0, -0x50, 0x0B, 0xB1, 0x31, 0x12, 0xEA, 0x3C, 0x90, -0x96, 0x26, 0x12, 0x04, 0x31, 0x90, 0x96, 0x26, -0xB1, 0x77, 0x90, 0x05, 0x8B, 0xB1, 0x2F, 0x12, -0xEA, 0xCF, 0xB1, 0x2F, 0x12, 0xEA, 0xD8, 0xB1, -0x2F, 0x90, 0x05, 0x88, 0xEF, 0xF0, 0x90, 0x96, -0x2A, 0xB1, 0x77, 0x90, 0x05, 0x87, 0xEF, 0xF0, -0x90, 0x96, 0x2A, 0x12, 0xEA, 0x87, 0xEF, 0xF0, -0x90, 0x96, 0x2A, 0x12, 0xEA, 0x7B, 0xEF, 0xF0, -0x90, 0x96, 0x2A, 0x12, 0xEA, 0x6C, 0x22, 0xEF, -0xF0, 0x90, 0x96, 0x26, 0x02, 0x04, 0xB8, 0x90, -0x96, 0x30, 0xE0, 0x75, 0xF0, 0x1B, 0xA4, 0x24, -0x5D, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, -0x22, 0x90, 0x95, 0x3C, 0x12, 0x04, 0xB8, 0x90, -0x06, 0xC4, 0xEF, 0xF0, 0x90, 0x95, 0x3C, 0x12, -0x04, 0xB8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, -0x06, 0xC5, 0xEF, 0xF0, 0x90, 0x95, 0x3C, 0x12, -0x04, 0xB8, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, -0x06, 0xC6, 0xEF, 0xF0, 0x90, 0x95, 0x3C, 0x12, -0x04, 0xB8, 0x78, 0x18, 0x02, 0x03, 0xEB, 0x90, -0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x6C, 0x90, 0x95, -0x37, 0xE0, 0x30, 0xE0, 0x48, 0x90, 0x95, 0x42, -0xE0, 0xFF, 0x90, 0x95, 0x41, 0xE0, 0xC3, 0x9F, -0x40, 0x2C, 0xB1, 0xF5, 0x90, 0x06, 0xC4, 0xB1, -0xF3, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, -0xC5, 0xB1, 0xF3, 0x78, 0x10, 0x12, 0x03, 0xEB, -0x90, 0x06, 0xC6, 0xEF, 0xF0, 0x90, 0x95, 0x38, -0xB1, 0x77, 0x90, 0x06, 0xC7, 0xEF, 0xF0, 0xE4, -0x90, 0x95, 0x41, 0xF0, 0x80, 0x21, 0xB1, 0x49, -0x90, 0x06, 0xC7, 0xEF, 0xF0, 0x90, 0x95, 0x41, -0xE0, 0x04, 0xF0, 0x80, 0x12, 0x90, 0x95, 0x40, -0xE0, 0x60, 0x0C, 0xB1, 0x49, 0x90, 0x06, 0xC7, -0xEF, 0xF0, 0xE4, 0x90, 0x95, 0x40, 0xF0, 0x90, -0x8A, 0xBB, 0x12, 0x8E, 0xC9, 0xE4, 0xFF, 0x12, -0x04, 0x7E, 0x22, 0xEF, 0xF0, 0x90, 0x95, 0x38, -0x02, 0x04, 0xB8, 0x90, 0x96, 0xD4, 0xA3, 0xE0, -0xFF, 0x90, 0x92, 0x13, 0x74, 0x03, 0xF0, 0x7B, -0x06, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x96, -0xD8, 0xEE, 0xF0, 0xFC, 0xA3, 0xEF, 0xF0, 0xFD, -0x90, 0x96, 0xD7, 0xE0, 0xFF, 0x74, 0x10, 0x2D, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xEF, -0xF0, 0x90, 0x96, 0xD6, 0x22, 0x90, 0x86, 0xB6, -0xE0, 0xFF, 0x90, 0x96, 0xF3, 0xE0, 0xFB, 0x90, -0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, -0x66, 0xDB, 0x90, 0x96, 0xF4, 0xEE, 0xF0, 0xFC, -0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x96, 0xF2, 0xE0, -0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, -0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x96, 0xF2, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, -0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x9D, -0xE0, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, 0xE4, -0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, -0x3E, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x96, 0xF6, -0xF0, 0x7B, 0x26, 0x12, 0x8D, 0x29, 0xEF, 0x64, -0x01, 0x70, 0x0B, 0xD1, 0x2D, 0x90, 0x93, 0x58, -0xE0, 0x20, 0xE0, 0x14, 0x80, 0x0E, 0xD1, 0xFD, -0x30, 0xE0, 0x0D, 0xD1, 0x2D, 0x90, 0x93, 0x58, -0xE0, 0x20, 0xE0, 0x04, 0xF1, 0x1C, 0xF1, 0x07, -0x90, 0x96, 0xF6, 0xE0, 0xFD, 0x7B, 0x27, 0xE4, -0xFF, 0x31, 0x8C, 0xF1, 0x13, 0x80, 0x0F, 0xF1, -0x13, 0xF1, 0x07, 0xD1, 0x2D, 0x90, 0x93, 0x58, -0xE0, 0x20, 0xE0, 0x04, 0xF1, 0x1C, 0xF1, 0x07, -0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x17, 0xD1, -0xFD, 0x30, 0xE0, 0x12, 0x90, 0x05, 0x22, 0xE0, -0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x12, 0xAF, -0xC1, 0x7D, 0x28, 0x12, 0x04, 0x7E, 0xF1, 0xB0, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xA1, -0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0xE0, -0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, -0x02, 0x04, 0x7E, 0x90, 0x96, 0xF2, 0xE0, 0xFF, -0x90, 0x8A, 0xC7, 0x22, 0x90, 0x96, 0xF4, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x96, 0xF7, 0xEF, 0xF0, 0xED, 0x64, 0x01, 0x70, -0x30, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, -0xF5, 0x0E, 0x80, 0x08, 0x90, 0x96, 0xF7, 0xE0, -0x24, 0xFE, 0xF5, 0x0E, 0x90, 0x96, 0xA6, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x0E, -0xE4, 0xFC, 0xFD, 0xFE, 0xF1, 0x9E, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x0E, 0x80, -0x1E, 0x90, 0x96, 0xA6, 0x12, 0x04, 0x3D, 0x00, -0x00, 0x00, 0xFF, 0x90, 0x96, 0xF7, 0x12, 0x9C, -0x76, 0xF1, 0x9E, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0xFF, 0x90, 0x96, 0xF7, 0xE0, 0xFF, 0xE4, -0xFC, 0xFD, 0xFE, 0x90, 0x96, 0xAA, 0x12, 0x04, -0x31, 0x7D, 0x18, 0x7C, 0x00, 0x7F, 0x01, 0xF1, -0xEF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x96, -0xAA, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, -0xE4, 0xFF, 0xF1, 0xEF, 0x90, 0x96, 0xA6, 0x22, -0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x7F, 0x01, -0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x93, 0xF4, -0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x93, -0xF4, 0xE0, 0x5E, 0xFE, 0xED, 0x5F, 0x4E, 0xF0, -0x22, 0x61, 0x9C, 0x7D, 0x6F, 0xE4, 0xFF, 0x21, -0x8C, 0xE4, 0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, -0x12, 0x86, 0x2D, 0xD3, 0x02, 0x03, 0xDA, 0xEF, -0xF0, 0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, -0xA4, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x96, -0xA3, 0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, -0x7B, 0xBD, 0x90, 0x96, 0xAE, 0x12, 0x04, 0x31, -0x90, 0x96, 0xA6, 0x12, 0x04, 0xB8, 0x12, 0x03, -0xCD, 0x90, 0x96, 0xAE, 0x12, 0x86, 0x2D, 0x12, -0x86, 0x13, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0x90, 0x96, 0xA6, 0x12, 0x04, 0xB8, -0x90, 0x96, 0xAA, 0x12, 0x86, 0x2D, 0x12, 0x86, -0x13, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0x12, 0x86, 0x20, 0x90, 0x96, 0xB2, 0x12, -0x04, 0x31, 0x90, 0x96, 0xA4, 0xA3, 0xE0, 0xFD, -0xC0, 0x05, 0x90, 0x96, 0xB2, 0x12, 0x04, 0xB8, -0x90, 0x8B, 0x9F, 0x12, 0x04, 0x31, 0x90, 0x96, -0xA3, 0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x8B, 0x61, 0x8A, -0x62, 0x89, 0x63, 0x90, 0x93, 0xE0, 0xE0, 0x54, -0xFE, 0x12, 0x87, 0x61, 0xFC, 0x30, 0xE0, 0x44, -0x90, 0x93, 0xE1, 0xE0, 0x44, 0x01, 0xFE, 0xF0, -0x12, 0x02, 0x06, 0x54, 0xFE, 0xFD, 0xEE, 0x54, -0x01, 0x4D, 0x90, 0x93, 0xE1, 0xF0, 0x12, 0x87, -0xA6, 0x90, 0x93, 0xE2, 0xF0, 0xEC, 0xC3, 0x13, -0x54, 0x7F, 0xFF, 0xA3, 0x12, 0x87, 0x72, 0xFE, -0xC3, 0x9F, 0x90, 0x93, 0xE4, 0xF0, 0xA3, 0xEE, -0xF0, 0xBE, 0x64, 0x04, 0x74, 0x01, 0xF0, 0x22, -0x90, 0x93, 0xE5, 0xE0, 0x64, 0x96, 0x70, 0x53, -0x74, 0x03, 0xF0, 0x22, 0x90, 0x93, 0xE1, 0xE0, -0x54, 0xFE, 0x12, 0xA0, 0xFF, 0xFF, 0x54, 0x01, -0xFE, 0x90, 0x93, 0xD5, 0xE0, 0x54, 0xFE, 0x4E, -0xFE, 0xF0, 0xEF, 0x54, 0xFE, 0xFF, 0xEE, 0x54, -0x01, 0x4F, 0xF0, 0x12, 0x87, 0xA6, 0x90, 0x93, -0xD6, 0x12, 0x87, 0x72, 0x90, 0x93, 0xD7, 0xF0, -0xE4, 0xA3, 0xF0, 0x90, 0x93, 0xD7, 0xE0, 0xFF, -0xB4, 0x64, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x0A, -0xEF, 0xB4, 0x96, 0x06, 0x90, 0x93, 0xD7, 0x74, -0x03, 0xF0, 0x90, 0x93, 0xD7, 0xE0, 0x04, 0x90, -0x93, 0xDA, 0xF0, 0x22, 0x31, 0x7D, 0x90, 0x93, -0x03, 0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x30, 0xE0, -0x27, 0xEF, 0x54, 0x04, 0x25, 0xE0, 0xFE, 0xE0, -0x54, 0xF7, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, -0x25, 0xE0, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, -0x90, 0x04, 0x57, 0xE0, 0x90, 0x93, 0x05, 0xF0, -0x90, 0x04, 0x55, 0xE0, 0x90, 0x93, 0x04, 0xF0, -0x90, 0x93, 0x03, 0xE0, 0x54, 0x01, 0xFF, 0xEF, -0x90, 0x07, 0xDC, 0x60, 0x25, 0xE4, 0xF0, 0xF0, -0x90, 0x07, 0xDE, 0xF0, 0xA3, 0x04, 0xF0, 0x90, -0x07, 0xDD, 0x74, 0x03, 0xF0, 0x90, 0x07, 0xE3, -0xE0, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0xA3, 0x74, -0x10, 0xF0, 0x90, 0x07, 0xDC, 0xE0, 0x44, 0x01, -0xF0, 0x22, 0xE4, 0xF0, 0x22, 0x12, 0x02, 0x06, -0xFF, 0x54, 0x01, 0xFE, 0x22, 0x31, 0x7D, 0x90, -0x93, 0x3B, 0x12, 0xEA, 0x4A, 0x4F, 0xF0, 0x12, -0x87, 0xA6, 0x90, 0x93, 0x3C, 0x12, 0x87, 0x72, -0x90, 0x93, 0x3D, 0xF0, 0x12, 0xBF, 0xCA, 0xF0, -0x90, 0x93, 0x3B, 0xE0, 0x54, 0x01, 0xFF, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, -0x01, 0x70, 0x1A, 0x31, 0xF4, 0x60, 0x0A, 0x31, -0xED, 0x12, 0x7C, 0x05, 0x12, 0xBF, 0xC1, 0x80, -0x07, 0x31, 0xED, 0x12, 0x7C, 0x3B, 0xF1, 0xAB, -0x12, 0x79, 0xD4, 0x80, 0x17, 0x31, 0xF4, 0x60, -0x07, 0x31, 0xED, 0x12, 0x7C, 0x05, 0x80, 0x05, -0x31, 0xED, 0x12, 0x7C, 0x3B, 0xD1, 0xB0, 0xD1, -0xB7, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, 0x10, 0xF0, -0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, 0x3D, 0xE0, -0x90, 0x01, 0x3F, 0x22, 0xF1, 0x54, 0x64, 0x01, -0x60, 0x02, 0x61, 0x38, 0x90, 0x88, 0x36, 0xE0, -0x70, 0x02, 0x61, 0x38, 0x90, 0x88, 0x2C, 0xE0, -0x20, 0xE0, 0x38, 0x90, 0x88, 0x9D, 0xE0, 0x20, -0xE0, 0x31, 0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, -0x70, 0x29, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x23, -0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1C, 0xE0, -0x54, 0x07, 0x64, 0x07, 0x70, 0x15, 0x90, 0x06, -0x62, 0xE0, 0x54, 0x03, 0x70, 0x0D, 0x90, 0x88, -0x39, 0xE0, 0xB4, 0x04, 0x06, 0x12, 0xC4, 0x74, -0x12, 0xC1, 0x5C, 0x90, 0x05, 0x63, 0xE0, 0x90, -0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, -0x88, 0x86, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, -0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, -0x88, 0x88, 0xF0, 0x90, 0x07, 0xF1, 0xE0, 0x90, -0x95, 0x35, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, -0x95, 0x36, 0xF0, 0xF1, 0x6E, 0x90, 0x88, 0x3A, -0xE0, 0x54, 0xEC, 0xF0, 0x71, 0x54, 0x24, 0xFD, -0x50, 0x02, 0x80, 0x0F, 0x90, 0x88, 0x2C, 0xE0, -0x30, 0xE0, 0x05, 0x12, 0xBD, 0x21, 0x80, 0x03, -0x12, 0xBD, 0x9B, 0x71, 0x54, 0x64, 0x01, 0x70, -0x30, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, -0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, 0x05, -0xA3, 0xE0, 0xFF, 0x80, 0x05, 0x90, 0x88, 0x3C, -0xE0, 0xFF, 0x90, 0x88, 0x3C, 0xEF, 0xF0, 0xA3, -0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, -0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, -0xF0, 0x71, 0x5D, 0xE4, 0x90, 0x88, 0x3F, 0xF0, -0xD1, 0xC8, 0x30, 0xE0, 0x59, 0xEF, 0xC4, 0x13, -0x13, 0x54, 0x03, 0x20, 0xE0, 0x22, 0x71, 0x4C, -0x6F, 0x70, 0x4B, 0xEF, 0x60, 0x48, 0x90, 0x88, -0x32, 0xE0, 0x44, 0x40, 0xF0, 0xF1, 0xEB, 0x31, -0xE9, 0x12, 0x7C, 0x05, 0xF1, 0xB2, 0xF1, 0x5B, -0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, 0x2E, -0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, -0x01, 0x70, 0x23, 0x71, 0x4C, 0xFE, 0x6F, 0x60, -0x1D, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, -0x60, 0x14, 0x90, 0x88, 0x32, 0xD1, 0xC1, 0x30, -0xE0, 0x0C, 0xEF, 0x54, 0xBF, 0x31, 0xE9, 0x12, -0x7C, 0x3B, 0xD1, 0xB7, 0xD1, 0xB0, 0x71, 0x44, -0x90, 0x88, 0x2C, 0xE0, 0xC3, 0x13, 0x20, 0xE0, -0x02, 0x71, 0x44, 0x22, 0x90, 0x88, 0x32, 0xE0, -0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, -0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, -0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x85, -0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x95, 0x36, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x95, -0x35, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, -0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x85, -0xB6, 0x90, 0x88, 0x85, 0x12, 0x04, 0x31, 0x90, -0x88, 0x89, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0x46, -0x12, 0xEA, 0x3F, 0x90, 0x88, 0x89, 0x12, 0x04, -0x31, 0x90, 0x88, 0x89, 0x12, 0x04, 0xB8, 0x90, -0x88, 0x85, 0xB1, 0x80, 0x50, 0x02, 0x81, 0x5C, -0x90, 0x88, 0x89, 0x12, 0x86, 0x2D, 0x90, 0x88, -0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, 0xB6, 0x12, -0x9F, 0xBF, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -0x30, 0xF1, 0xE3, 0xE4, 0x33, 0xFE, 0xEF, 0x78, -0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, -0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, -0x94, 0x00, 0xFA, 0x12, 0x9F, 0xAE, 0x78, 0x07, -0x12, 0x03, 0xEB, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, -0x23, 0x90, 0x88, 0x33, 0xD1, 0xC1, 0x30, 0xE0, -0x02, 0xA1, 0x62, 0x12, 0x9F, 0xAE, 0x78, 0x07, -0x12, 0x03, 0xEB, 0x90, 0x88, 0x4E, 0xE0, 0xFD, -0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, -0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, 0x95, 0xEF, -0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x95, 0xF0, -0xE0, 0x94, 0xA0, 0x90, 0x95, 0xEF, 0xE0, 0x94, -0x00, 0x50, 0x31, 0xA3, 0xE0, 0xFB, 0x24, 0xF5, -0xB1, 0x70, 0x04, 0x12, 0x9F, 0xAD, 0xEF, 0x54, -0x7F, 0xFF, 0x74, 0x95, 0x2B, 0xB1, 0x65, 0xE0, -0xFE, 0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x95, -0xEF, 0xA3, 0xE0, 0xB1, 0x63, 0xEF, 0xF0, 0x90, -0x88, 0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0xFD, 0x7F, -0xFE, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x4C, 0xE0, -0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, -0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, 0xA1, -0x62, 0xE4, 0xFF, 0xFE, 0xB1, 0x6D, 0x2F, 0xFF, -0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, -0x40, 0x07, 0x90, 0x95, 0xF1, 0xEE, 0xF0, 0x80, -0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE6, 0xD1, 0x97, -0x40, 0x02, 0x80, 0x14, 0x90, 0x95, 0xF1, 0xE0, -0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x12, -0xB1, 0x6D, 0x2F, 0xFF, 0xD1, 0x97, 0x40, 0x07, -0x90, 0x95, 0xF2, 0xEE, 0xF0, 0x80, 0x03, 0x0E, -0x80, 0xE8, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x90, -0x95, 0xF1, 0xE0, 0xFE, 0xB1, 0x63, 0xE0, 0xFD, -0xEF, 0xC3, 0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, -0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, -0x90, 0x95, 0xF2, 0xE0, 0x80, 0x1D, 0x90, 0x95, -0xF1, 0xE0, 0xFE, 0xB1, 0x63, 0xE0, 0xFD, 0xC3, -0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, -0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, 0x95, -0xF2, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, -0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, -0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, -0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, 0xF0, -0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, 0x50, -0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, 0x51, -0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, -0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, 0x88, -0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, 0x4F, -0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, -0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, -0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x12, 0xC7, -0xAE, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x90, -0x8A, 0xA3, 0x12, 0x8E, 0xC9, 0xE4, 0xFF, 0x12, -0x04, 0x7E, 0x22, 0x24, 0x95, 0xF5, 0x82, 0xE4, -0x34, 0x94, 0xF5, 0x83, 0x22, 0x74, 0xF5, 0x2E, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -0x22, 0x7E, 0x02, 0xFD, 0xFC, 0x90, 0x96, 0xEE, -0x12, 0x86, 0x2D, 0xC3, 0x02, 0x03, 0xDA, 0x90, -0x96, 0xED, 0xEF, 0xF0, 0x90, 0x88, 0xE0, 0xE0, -0x70, 0x51, 0x7F, 0x48, 0x7E, 0x09, 0x12, 0x70, -0x70, 0xEE, 0x54, 0x0F, 0xFE, 0xE4, 0xFD, 0xFC, -0x90, 0x96, 0xEE, 0x12, 0x04, 0x31, 0xE4, 0x7F, -0x80, 0xB1, 0x79, 0x70, 0x05, 0x90, 0x88, 0xBE, -0x80, 0x1B, 0xE4, 0xFF, 0xFE, 0xB1, 0x7B, 0x70, -0x0A, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xE4, 0xA3, -0xF0, 0x80, 0x5A, 0xE4, 0xFF, 0xB1, 0x79, 0x70, -0x09, 0x90, 0x88, 0xBE, 0x04, 0xF0, 0xA3, 0xF0, -0x80, 0x4B, 0xE4, 0x7F, 0x80, 0xFE, 0xB1, 0x7B, -0x70, 0x43, 0x90, 0x88, 0xBE, 0xF0, 0xA3, 0x04, -0xF0, 0x80, 0x3A, 0x7F, 0x2C, 0x7E, 0x09, 0x12, -0x70, 0x70, 0xEF, 0x54, 0x02, 0xD1, 0x83, 0x4E, -0x4F, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, 0x01, -0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, 0xF0, -0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, -0x54, 0x01, 0xD1, 0x83, 0x4E, 0x4F, 0x60, 0x07, -0xE4, 0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, -0x88, 0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, -0xE0, 0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, -0x8E, 0xC9, 0x7D, 0x11, 0x7F, 0xFF, 0x12, 0x04, -0x7E, 0x90, 0x8A, 0xEF, 0x12, 0x8D, 0x33, 0x90, -0x07, 0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, -0x88, 0xDF, 0xE0, 0xFF, 0x90, 0x8A, 0xF3, 0xF1, -0xC1, 0xE4, 0xFD, 0x12, 0x04, 0x7E, 0x90, 0x96, -0xED, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x24, 0xED, -0xB4, 0x01, 0x0A, 0x90, 0x88, 0xB8, 0xE0, 0x54, -0x1F, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x96, 0xED, -0xE0, 0xFD, 0xB4, 0x02, 0x0A, 0x90, 0x88, 0xB8, -0xE0, 0x54, 0x1F, 0x44, 0x60, 0xF0, 0x22, 0xED, -0xB4, 0x03, 0x07, 0x90, 0x88, 0xB8, 0xE0, 0x54, -0x1F, 0xF0, 0x22, 0xFF, 0xE4, 0xFE, 0xFD, 0xFC, -0x90, 0x96, 0xEE, 0x12, 0x04, 0x31, 0x90, 0x96, -0xEE, 0x12, 0x04, 0xB8, 0xEC, 0x4D, 0x22, 0x90, -0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, 0x90, -0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, 0x94, -0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, 0x22, -0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x7D, -0x01, 0x7F, 0x02, 0x02, 0x7C, 0x74, 0x90, 0x88, -0x31, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, -0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x13, -0x54, 0x1F, 0x22, 0xD1, 0xC8, 0x30, 0xE0, 0x0B, -0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, -0x02, 0xF1, 0x5B, 0xD1, 0xBE, 0x30, 0xE0, 0x08, -0xF1, 0x62, 0x54, 0x07, 0x70, 0x3F, 0x80, 0x3B, -0xF1, 0xCA, 0x40, 0x37, 0xF1, 0x54, 0x64, 0x01, -0x70, 0x33, 0x12, 0xBD, 0x1A, 0x70, 0x08, 0x90, -0x8A, 0xF5, 0x12, 0x8D, 0x33, 0x80, 0x27, 0x90, -0x8A, 0xF5, 0x12, 0x8D, 0x33, 0x90, 0x88, 0x40, -0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, 0x40, -0x09, 0xF1, 0x2E, 0xE4, 0x90, 0x88, 0x40, 0xF0, -0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, 0x90, 0x88, -0x3F, 0xF0, 0x22, 0xF1, 0x95, 0x22, 0x90, 0x88, -0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x01, -0x57, 0xE0, 0x60, 0x17, 0xF1, 0x71, 0xD1, 0xBE, -0x30, 0xE0, 0x02, 0x80, 0x1D, 0xF1, 0xCA, 0x40, -0x0A, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, -0x02, 0xF1, 0x2E, 0x22, 0xE4, 0xFF, 0x12, 0x78, -0x4A, 0xEF, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, -0x7C, 0x7E, 0xEF, 0x54, 0xFB, 0xF0, 0x90, 0x88, -0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x01, -0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, -0xF0, 0x22, 0xF1, 0x54, 0x64, 0x01, 0x70, 0x14, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x0E, 0xF1, 0x6E, -0x90, 0x88, 0x31, 0xE0, 0xF1, 0x63, 0x54, 0x07, -0x70, 0x02, 0xF1, 0x95, 0x22, 0x90, 0x88, 0x2C, -0xE0, 0x90, 0x88, 0x38, 0x30, 0xE0, 0x05, 0xE0, -0xFF, 0x02, 0xE8, 0x84, 0xF1, 0xBC, 0x7D, 0x01, -0x02, 0x04, 0x7E, 0x7D, 0x02, 0x7F, 0x02, 0x12, -0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, -0x7E, 0x90, 0x88, 0x38, 0xE0, 0xFF, 0x90, 0x8A, -0xB9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, 0x8C, -0x83, 0x22, 0x90, 0x88, 0x3F, 0xE0, 0x04, 0xF0, -0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, 0xF0, 0x90, -0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, -0xD3, 0x9F, 0x22, 0x90, 0x88, 0x53, 0xE0, 0x24, -0x04, 0xFF, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0x90, -0x05, 0x73, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, -0x93, 0x3A, 0xF0, 0xBF, 0x01, 0x07, 0x11, 0x06, -0xE4, 0x90, 0x93, 0x3A, 0xF0, 0x22, 0x11, 0xB3, -0x7F, 0xEF, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x06, 0x90, 0x95, 0x57, 0xE0, 0xA3, 0xF0, -0x11, 0xB3, 0x7F, 0xEE, 0x7E, 0x01, 0x12, 0x5F, -0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x57, 0xE0, -0x90, 0x95, 0x59, 0xF0, 0x11, 0xB3, 0x7F, 0xED, -0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -0x90, 0x95, 0x57, 0xE0, 0x90, 0x95, 0x5A, 0xF0, -0x11, 0xB3, 0x7F, 0xEC, 0x7E, 0x01, 0x12, 0x5F, -0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x57, 0xE0, -0x90, 0x95, 0x5B, 0xF0, 0x11, 0xB3, 0x7F, 0xEB, -0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, -0x90, 0x95, 0x57, 0xE0, 0x90, 0x95, 0x5C, 0xF0, -0x90, 0x95, 0x58, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, -0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x95, 0x60, -0xF0, 0x90, 0x95, 0x5C, 0xE0, 0x90, 0x95, 0x61, -0xF0, 0x90, 0x95, 0x62, 0x74, 0x12, 0xF0, 0x90, -0x95, 0x84, 0x74, 0x05, 0xF0, 0x90, 0x95, 0x64, -0x12, 0xA7, 0xE7, 0xF0, 0x90, 0x95, 0x60, 0xE0, -0x90, 0x95, 0x67, 0xF0, 0x90, 0x95, 0x61, 0xE0, -0x90, 0x95, 0x68, 0xF0, 0x7B, 0x01, 0x7A, 0x95, -0x79, 0x62, 0x12, 0x8E, 0xB7, 0x7F, 0x04, 0x02, -0x04, 0x7E, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0x57, 0x22, 0x12, 0x02, 0x06, 0x90, 0x95, 0x7A, -0xF0, 0x12, 0x87, 0xA6, 0x90, 0x95, 0x7B, 0xF0, -0x60, 0x0F, 0x31, 0x06, 0x12, 0xD7, 0xD3, 0x90, -0x95, 0x7B, 0x31, 0x06, 0x7B, 0x57, 0x12, 0xA1, -0x8C, 0x90, 0x95, 0x57, 0x74, 0x20, 0xF0, 0x90, -0x95, 0x79, 0x74, 0x03, 0xF0, 0x90, 0x05, 0x22, -0xE0, 0x90, 0x95, 0x59, 0xF0, 0x90, 0x93, 0xF3, -0xE0, 0x90, 0x95, 0x5A, 0xF0, 0x90, 0x93, 0xF4, -0xE0, 0x90, 0x95, 0x5B, 0x11, 0xB2, 0x12, 0x8E, -0xB7, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xE0, 0xFF, -0x90, 0x95, 0x7A, 0xE0, 0xFD, 0x22, 0x12, 0x02, -0x06, 0x64, 0x01, 0x60, 0x02, 0x21, 0xA4, 0x90, -0x95, 0x9E, 0xF0, 0x90, 0x95, 0x9E, 0xE0, 0xFF, -0xC3, 0x94, 0x10, 0x50, 0x29, 0xEF, 0x31, 0xA5, -0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9D, 0x12, 0x5F, -0xA6, 0xBF, 0x01, 0x12, 0x90, 0x95, 0x9D, 0xE0, -0xFF, 0xA3, 0xE0, 0x24, 0x9F, 0xF5, 0x82, 0xE4, -0x34, 0x95, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, -0x9E, 0xE0, 0x04, 0xF0, 0x80, 0xCD, 0x75, 0x45, -0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x9F, 0x75, -0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x59, -0x12, 0x69, 0xF5, 0x90, 0x95, 0x57, 0x74, 0x24, -0xF0, 0x90, 0x95, 0x79, 0x74, 0x08, 0xF0, 0x75, -0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0xA7, -0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x7C, -0x12, 0x69, 0xF5, 0x90, 0x95, 0x7A, 0x74, 0x25, -0xF0, 0x90, 0x95, 0x9C, 0x74, 0x08, 0x11, 0xB2, -0x12, 0xCE, 0xA5, 0x12, 0x04, 0x7E, 0x7B, 0x01, -0x7A, 0x95, 0x79, 0x7A, 0x12, 0x8E, 0xB7, 0x7F, -0x04, 0x12, 0x04, 0x7E, 0x22, 0x24, 0xA8, 0xFF, -0xE4, 0x34, 0x01, 0xFE, 0x22, 0x12, 0x8F, 0xE8, -0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, 0x41, -0x3C, 0xEF, 0x24, 0x39, 0x60, 0x12, 0x14, 0x60, -0x19, 0x24, 0x02, 0x70, 0x1F, 0xE4, 0x90, 0x95, -0x5D, 0xF0, 0xA3, 0x74, 0x06, 0xF0, 0x80, 0x14, -0x90, 0x95, 0x5D, 0x74, 0x06, 0xF0, 0xA3, 0xF0, -0x80, 0x0A, 0x90, 0x95, 0x5D, 0x74, 0x0C, 0xF0, -0xA3, 0x74, 0x04, 0xF0, 0x51, 0x50, 0x51, 0x3D, -0x40, 0x1D, 0x90, 0x95, 0x5B, 0xE0, 0x31, 0xA5, -0x7B, 0x01, 0x7A, 0x95, 0x79, 0x5A, 0x12, 0x5F, -0xA6, 0xBF, 0x01, 0x07, 0x90, 0x95, 0x5A, 0xE0, -0xF4, 0x70, 0x39, 0x51, 0x45, 0x80, 0xDF, 0x51, -0x50, 0x51, 0x3D, 0x40, 0x2F, 0x90, 0x95, 0x5B, -0xE0, 0xFD, 0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, -0x34, 0x01, 0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, -0x33, 0xFC, 0x90, 0x95, 0x5D, 0xE0, 0xFB, 0xC3, -0xED, 0x9B, 0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x12, -0x8A, 0x44, 0x51, 0x71, 0xFD, 0x12, 0xDE, 0xA9, -0x51, 0x45, 0x80, 0xCD, 0x22, 0x90, 0x95, 0x5C, -0xE0, 0xD3, 0x94, 0x00, 0x22, 0x90, 0x95, 0x5B, -0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0x14, 0xF0, 0x22, -0x90, 0x95, 0x5D, 0xE0, 0x90, 0x95, 0x5B, 0xF0, -0x90, 0x95, 0x5E, 0xE0, 0x90, 0x95, 0x5C, 0xF0, -0x22, 0x7E, 0x00, 0xC3, 0x74, 0x07, 0x9F, 0xFD, -0xE4, 0x9E, 0xFC, 0x90, 0x96, 0x18, 0x12, 0x86, -0x39, 0x8D, 0x82, 0x8C, 0x83, 0x02, 0x02, 0x1F, -0xB1, 0x25, 0x90, 0x96, 0x1B, 0xF0, 0x90, 0x96, -0x1B, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x31, -0x51, 0x61, 0xFD, 0xC3, 0x74, 0x07, 0x71, 0xF8, -0x12, 0x02, 0x1F, 0xC3, 0x9D, 0x50, 0x03, 0x7F, -0x00, 0x22, 0x90, 0x96, 0x1B, 0xE0, 0xFF, 0x51, -0x61, 0xFD, 0xC3, 0x74, 0x07, 0x71, 0xF8, 0x12, -0x02, 0x1F, 0xD3, 0x9D, 0x40, 0x03, 0x7F, 0x01, -0x22, 0x90, 0x96, 0x1B, 0xE0, 0x04, 0xF0, 0x80, -0xC5, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x96, 0x14, -0xF0, 0x90, 0x93, 0x03, 0xE0, 0xFF, 0xC3, 0x13, -0x20, 0xE0, 0x74, 0x71, 0x81, 0x51, 0x78, 0xEF, -0x60, 0x0D, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x13, -0x71, 0x87, 0x71, 0x92, 0xEF, 0x60, 0x58, 0x71, -0x81, 0x51, 0x78, 0xEF, 0x60, 0x17, 0x7B, 0x01, -0x7A, 0x93, 0x79, 0x13, 0x71, 0x87, 0x71, 0x92, -0xEF, 0x60, 0x0A, 0x7B, 0x01, 0x7A, 0x93, 0x79, -0x1C, 0xB1, 0x17, 0x70, 0x3A, 0x7B, 0x01, 0x7A, -0x93, 0x79, 0x20, 0x90, 0x96, 0x18, 0x12, 0x86, -0x42, 0x7A, 0x93, 0x79, 0x06, 0x51, 0x78, 0xEF, -0x60, 0x14, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x2D, -0x71, 0x87, 0x51, 0x78, 0xEF, 0x60, 0x07, 0x71, -0x81, 0xB1, 0x2D, 0xEF, 0x70, 0x11, 0x71, 0x81, -0x71, 0x92, 0xEF, 0x60, 0x31, 0x7B, 0x01, 0x7A, -0x93, 0x79, 0x0F, 0xB1, 0x17, 0x60, 0x27, 0x90, -0x96, 0x14, 0x74, 0x01, 0xF0, 0x80, 0x1F, 0x7B, -0x01, 0x7A, 0x93, 0x79, 0x2D, 0x71, 0x87, 0x51, -0x78, 0xEF, 0x60, 0x12, 0x7B, 0x01, 0x7A, 0x93, -0x79, 0x2D, 0x71, 0x87, 0xB1, 0x2D, 0xEF, 0x70, -0x05, 0x90, 0x96, 0x14, 0x04, 0xF0, 0x90, 0x96, -0x14, 0xE0, 0xFF, 0x90, 0x05, 0x18, 0xE4, 0xF0, -0xA3, 0xF0, 0xEF, 0x90, 0x05, 0xB3, 0x60, 0x0C, -0xE0, 0x44, 0x80, 0xF0, 0x90, 0x24, 0xA0, 0xE0, -0x44, 0x01, 0xF0, 0x22, 0xE0, 0x44, 0x20, 0xF0, -0x22, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x06, 0x90, -0x96, 0x18, 0x12, 0x86, 0x42, 0x7A, 0x93, 0x79, -0x20, 0x22, 0xB1, 0x25, 0xFF, 0xB1, 0x40, 0x6E, -0x60, 0x03, 0x7F, 0x00, 0x22, 0x0F, 0xEF, 0xB4, -0x08, 0xF3, 0x7F, 0x01, 0x22, 0xB1, 0x25, 0x90, -0x96, 0x1B, 0xF0, 0x90, 0x96, 0x1B, 0xE0, 0xFF, -0xC3, 0x94, 0x04, 0x50, 0x25, 0x71, 0xDD, 0x12, -0x02, 0x1F, 0xC3, 0x9D, 0x50, 0x03, 0x7F, 0x00, -0x22, 0x90, 0x96, 0x1B, 0xE0, 0xFF, 0x71, 0xDD, -0x12, 0x02, 0x1F, 0xD3, 0x9D, 0x40, 0x03, 0x7F, -0x01, 0x22, 0x90, 0x96, 0x1B, 0xE0, 0x04, 0xF0, -0x80, 0xD1, 0x7F, 0x00, 0x22, 0x7E, 0x00, 0xC3, -0x74, 0x03, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, -0x96, 0x18, 0x12, 0x86, 0x39, 0x8D, 0x82, 0x8C, -0x83, 0x12, 0x02, 0x1F, 0xFD, 0xC3, 0x74, 0x03, -0x9F, 0xFF, 0xE4, 0x9E, 0xFE, 0x90, 0x96, 0x15, -0x12, 0x86, 0x39, 0x8F, 0x82, 0x8E, 0x83, 0x22, -0xE4, 0x90, 0x96, 0x18, 0xF0, 0xEF, 0x75, 0xF0, -0x40, 0xA4, 0x24, 0x80, 0xF9, 0x74, 0x82, 0x35, -0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x96, 0x14, 0x12, -0x86, 0x42, 0x12, 0x02, 0x06, 0x90, 0x96, 0x17, -0xF0, 0xA3, 0x74, 0x1C, 0xF0, 0x90, 0x96, 0x17, -0xE0, 0xFF, 0xA3, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, -0x02, 0xA1, 0x0B, 0x90, 0x96, 0x14, 0x12, 0x86, -0x39, 0x8E, 0x82, 0xB1, 0x57, 0x90, 0x96, 0x19, -0xF0, 0xEE, 0xFD, 0x7C, 0x00, 0xF5, 0x82, 0x8C, -0x83, 0xA3, 0xA3, 0x12, 0x02, 0x1F, 0xFE, 0x8D, -0x82, 0x8C, 0x83, 0xA3, 0x12, 0x02, 0x1F, 0xFD, -0xED, 0xFF, 0x90, 0x96, 0x1A, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x96, 0x19, 0xE0, 0x64, 0x01, -0x60, 0x0E, 0xA3, 0xA3, 0xE0, 0x24, 0x03, 0xFF, -0x90, 0x96, 0x18, 0xE0, 0x2F, 0xF0, 0x80, 0xAD, -0xE4, 0x90, 0x96, 0x1C, 0xF0, 0x90, 0x96, 0x1C, -0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x17, 0x90, -0x96, 0x18, 0xE0, 0x24, 0x03, 0xB1, 0x66, 0x91, -0x00, 0xB1, 0x5D, 0x24, 0x20, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xB1, 0x0C, 0x80, 0xDF, 0x90, 0x96, -0x18, 0xE0, 0x24, 0x0B, 0xFF, 0xE4, 0x33, 0xFE, -0x90, 0x96, 0x14, 0x91, 0x00, 0x12, 0x02, 0x1F, -0x90, 0x93, 0x28, 0xF0, 0x70, 0x27, 0x90, 0x96, -0x1C, 0xF0, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0x24, -0x10, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x96, 0x14, -0x51, 0x6E, 0xFE, 0x74, 0x29, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0xB1, 0x0F, -0xE0, 0xB4, 0x04, 0xDE, 0x22, 0xE4, 0x90, 0x96, -0x1C, 0xF0, 0x90, 0x96, 0x1C, 0xE0, 0xFF, 0xC3, -0x94, 0x04, 0x50, 0x17, 0x90, 0x96, 0x18, 0xE0, -0x24, 0x0C, 0xB1, 0x66, 0x91, 0x00, 0xB1, 0x5D, -0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xB1, -0x0C, 0x80, 0xDF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, -0x90, 0x96, 0x1C, 0xE0, 0x04, 0xF0, 0x22, 0x90, -0x96, 0x18, 0x12, 0x86, 0x42, 0x7A, 0x93, 0x79, -0x29, 0x71, 0xA5, 0xEF, 0x22, 0x90, 0x96, 0x15, -0x12, 0x86, 0x42, 0xE4, 0x22, 0xB1, 0x25, 0xFF, -0xB1, 0x40, 0x6E, 0x60, 0x03, 0x7F, 0x00, 0x22, -0x0F, 0xEF, 0xB4, 0x06, 0xF3, 0x7F, 0x01, 0x22, -0x90, 0x96, 0x18, 0x12, 0x86, 0x39, 0x8F, 0x82, -0x75, 0x83, 0x00, 0x12, 0x02, 0x1F, 0xFE, 0x90, -0x96, 0x15, 0x12, 0x86, 0x39, 0x8F, 0x82, 0x75, -0x83, 0x00, 0x02, 0x02, 0x1F, 0x12, 0x02, 0x1F, -0xFF, 0x90, 0x96, 0x1C, 0xE0, 0x22, 0xFD, 0xE4, -0x33, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, -0x3C, 0xFE, 0x90, 0x96, 0x14, 0x22, 0xE4, 0x90, -0x95, 0xF0, 0xF0, 0x12, 0xE8, 0x63, 0x12, 0xD2, -0xEE, 0x12, 0xD1, 0xCB, 0x12, 0xD1, 0x97, 0x90, -0x07, 0xE3, 0xE0, 0x90, 0x95, 0xEF, 0xF0, 0xE0, -0x60, 0x59, 0xE4, 0x90, 0x95, 0xF1, 0xF0, 0x90, -0x96, 0x13, 0x74, 0x08, 0xF0, 0x90, 0x05, 0x68, -0xE0, 0x90, 0x95, 0xF3, 0xF0, 0x90, 0x05, 0x69, -0xE0, 0x90, 0x95, 0xF4, 0xF0, 0x90, 0x05, 0x6A, -0xE0, 0x90, 0x95, 0xF5, 0xF0, 0x90, 0x05, 0x6B, -0xE0, 0x90, 0x95, 0xF6, 0xF0, 0x90, 0x05, 0x78, -0xE0, 0x90, 0x95, 0xF7, 0xF0, 0x90, 0x05, 0x79, -0xE0, 0x90, 0x95, 0xF8, 0xF0, 0x90, 0x05, 0x7A, -0xE0, 0x90, 0x95, 0xF9, 0xF0, 0x90, 0x05, 0x7B, -0xE0, 0x90, 0x95, 0xFA, 0xF0, 0x7B, 0x01, 0x7A, -0x95, 0x79, 0xF1, 0x12, 0x8E, 0xB7, 0x7F, 0x04, -0x12, 0x04, 0x7E, 0x90, 0x95, 0xEF, 0xE0, 0xFD, -0x60, 0x3F, 0xA3, 0xE0, 0xF1, 0xDC, 0x80, 0x05, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0xEF, 0x5D, 0x60, 0xE7, 0x90, 0x95, 0xF0, 0xE0, -0xFB, 0x74, 0x01, 0xA8, 0x03, 0x08, 0x80, 0x02, -0xC3, 0x33, 0xD8, 0xFC, 0xFE, 0xF4, 0xFD, 0x90, -0x95, 0xEF, 0xE0, 0x5D, 0xF0, 0x90, 0x07, 0xE3, -0xE0, 0x4E, 0xF0, 0xAF, 0x03, 0x91, 0x08, 0x51, -0xBC, 0x90, 0x95, 0xF0, 0xE0, 0x04, 0xF0, 0x80, -0xBA, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x96, 0xC8, 0x12, 0xA7, 0xE7, 0xF0, -0x12, 0xC7, 0x9E, 0x90, 0x96, 0xD3, 0xF0, 0xE4, -0x90, 0x96, 0xD0, 0xF0, 0x90, 0x96, 0xC8, 0x12, -0xAE, 0xCB, 0x90, 0x96, 0xCB, 0xF0, 0xEF, 0x54, -0x07, 0x90, 0x96, 0xCD, 0xF1, 0x82, 0xE0, 0x90, -0x96, 0xCE, 0xF0, 0x12, 0x97, 0xF8, 0x54, 0x7F, -0x90, 0x96, 0xD1, 0xF0, 0x90, 0x96, 0xC8, 0xE0, -0x75, 0xF0, 0x12, 0xF1, 0xD2, 0x90, 0x96, 0xD2, -0xF0, 0xED, 0x54, 0x7F, 0x90, 0x96, 0xCC, 0xF0, -0xEB, 0x70, 0x2A, 0x90, 0x89, 0x3D, 0xF1, 0x9C, -0xFF, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, 0x85, -0xF0, 0x83, 0x12, 0x03, 0x3E, 0xFD, 0x90, 0x89, -0x40, 0xB1, 0x52, 0x2D, 0xFF, 0xE4, 0x35, 0xF0, -0xC3, 0x13, 0xFE, 0xEF, 0x13, 0xFF, 0x90, 0x96, -0xC8, 0xE0, 0x12, 0x97, 0xE7, 0x90, 0x96, 0xD1, -0xE0, 0xFF, 0x90, 0x96, 0xCC, 0xE0, 0xFE, 0xD3, -0x9F, 0x40, 0x0C, 0x90, 0x96, 0xC9, 0xE0, 0x54, -0x80, 0xFD, 0xEF, 0x4D, 0xF0, 0x80, 0x0F, 0x90, -0x96, 0xD2, 0xE0, 0xFF, 0xEE, 0xC3, 0x9F, 0x50, -0x05, 0x90, 0x96, 0xC9, 0xEF, 0xF0, 0x90, 0x96, -0xC9, 0xE0, 0xFE, 0x54, 0x7F, 0x90, 0x96, 0xCC, -0xF0, 0xEE, 0x54, 0x80, 0x90, 0x96, 0xCF, 0xF0, -0x90, 0x96, 0xCA, 0xE0, 0x70, 0x1F, 0xA3, 0xF1, -0xA4, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0xAF, 0x80, -0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xD0, -0x82, 0xD0, 0x83, 0xF0, 0x90, 0x96, 0xCE, 0xE0, -0x54, 0x7F, 0xF0, 0x80, 0x36, 0x90, 0x96, 0xCB, -0xF1, 0xA4, 0xC0, 0x83, 0xC0, 0x82, 0xF1, 0xAF, -0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xD0, -0x82, 0xD0, 0x83, 0xF1, 0x82, 0xE0, 0x54, 0x07, -0xFF, 0x90, 0x96, 0xCE, 0xF0, 0x90, 0x89, 0x46, -0xF1, 0x9C, 0xF5, 0x82, 0xB1, 0x57, 0x33, 0x33, -0x33, 0x54, 0xF8, 0x4F, 0x90, 0x96, 0xCE, 0xF0, -0x44, 0x80, 0xF0, 0x90, 0x96, 0xC9, 0xF1, 0x94, -0x12, 0x90, 0xE4, 0xEF, 0xF0, 0xEE, 0x70, 0x05, -0x90, 0x01, 0xC8, 0xEF, 0xF0, 0x90, 0x96, 0xCE, -0xF1, 0x94, 0xF1, 0x87, 0xEF, 0xF0, 0xEE, 0x12, -0x90, 0x36, 0xE0, 0x54, 0xFC, 0xFF, 0x90, 0x96, -0xD3, 0xE0, 0x54, 0x03, 0x4F, 0xFE, 0x90, 0x96, -0xC8, 0xE0, 0xFF, 0x12, 0x90, 0x36, 0xEE, 0xF0, -0x7D, 0x01, 0x12, 0xD6, 0x75, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xF0, 0x90, 0x96, 0xC8, 0xE0, 0xC4, -0x54, 0xF0, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, -0x81, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x90, 0x96, -0xC8, 0xE0, 0xFE, 0x22, 0x12, 0x86, 0x39, 0x90, -0x96, 0xCC, 0xE0, 0x22, 0xE0, 0x24, 0x6F, 0xF5, -0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0xE0, -0xFF, 0x90, 0x96, 0xCD, 0xE0, 0xFE, 0x74, 0x01, -0xA8, 0x06, 0x08, 0x22, 0xE6, 0xFD, 0xAF, 0x67, -0xEF, 0xF1, 0x87, 0xE0, 0x54, 0xF8, 0xF5, 0x75, -0xED, 0x42, 0x75, 0xEF, 0xF1, 0x87, 0xE5, 0x75, -0xF0, 0x22, 0x90, 0x89, 0x50, 0x12, 0x04, 0x6E, -0xE0, 0x22, 0x54, 0x07, 0xFF, 0x74, 0x01, 0x7E, -0x00, 0xA8, 0x07, 0x08, 0x22, 0x12, 0x02, 0x06, -0x54, 0x01, 0xFF, 0x90, 0x93, 0xF2, 0xE0, 0x54, -0xFE, 0x4F, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x8B, 0x61, 0x8A, 0x62, 0x89, -0x63, 0x90, 0x05, 0x27, 0xE0, 0xF5, 0x64, 0x8B, -0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, 0x48, 0x01, -0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x69, -0xF5, 0x12, 0xA1, 0x00, 0xFF, 0xC3, 0x13, 0x20, -0xE0, 0x02, 0x01, 0xAB, 0x90, 0x88, 0x2C, 0xE0, -0x30, 0xE0, 0x6F, 0x51, 0x7F, 0x75, 0x64, 0x21, -0x51, 0x86, 0x30, 0xE0, 0x04, 0x51, 0xC3, 0x80, -0x0D, 0xE4, 0x90, 0x88, 0x2D, 0xF0, 0xA3, 0xF0, -0x7D, 0x40, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x88, -0x2C, 0x12, 0xAE, 0xCB, 0x30, 0xE0, 0x03, 0x43, -0x64, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -0x03, 0x43, 0x64, 0x14, 0x90, 0x88, 0x2C, 0xE0, -0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, -0x64, 0x80, 0x90, 0x88, 0x2C, 0x12, 0xA7, 0x00, -0x20, 0xE0, 0x03, 0x43, 0x64, 0x40, 0x31, 0x65, -0x90, 0x88, 0x2F, 0xE0, 0x70, 0x04, 0x7F, 0x01, -0x31, 0x6C, 0x51, 0x8F, 0x30, 0xE0, 0x04, 0x7F, -0x04, 0x80, 0x0B, 0x51, 0xB7, 0xEF, 0x60, 0x04, -0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x31, 0x6C, -0x21, 0x1F, 0x31, 0x62, 0x90, 0x88, 0x2F, 0xE0, -0x64, 0x04, 0x60, 0x02, 0x21, 0x5D, 0xFF, 0x31, -0x6C, 0x21, 0x5D, 0x90, 0x88, 0x2C, 0xE0, 0x30, -0xE0, 0x75, 0x51, 0x7F, 0x43, 0x64, 0x31, 0x51, -0x86, 0x30, 0xE0, 0x04, 0x51, 0xC3, 0x80, 0x07, -0x7D, 0x40, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, -0x88, 0x2C, 0x12, 0xAE, 0xCB, 0x30, 0xE0, 0x03, -0x43, 0x64, 0x02, 0xEF, 0xC4, 0x54, 0x0F, 0x30, -0xE0, 0x03, 0x43, 0x64, 0x04, 0x31, 0x65, 0x51, -0x8F, 0x30, 0xE0, 0x10, 0x51, 0x78, 0x60, 0x37, -0x90, 0x8A, 0xB9, 0x12, 0x8E, 0xC9, 0xE4, 0xFD, -0x7F, 0x02, 0x80, 0x1E, 0xB1, 0xF9, 0x51, 0x78, -0x70, 0x1D, 0x12, 0x7B, 0xAD, 0x51, 0xB7, 0xBF, -0x01, 0x07, 0x12, 0xAF, 0xB9, 0x7D, 0x01, 0x80, -0x09, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0xC9, 0xE4, -0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x80, 0x08, 0x90, -0x88, 0x39, 0xE0, 0x90, 0x88, 0x30, 0xF0, 0x90, -0x05, 0x40, 0x74, 0x22, 0xF0, 0x80, 0x36, 0x31, -0x62, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, 0x0C, -0x90, 0x8A, 0xB9, 0x12, 0x8E, 0xC9, 0x7D, 0x01, -0x7F, 0x04, 0x80, 0x11, 0x90, 0x88, 0x30, 0xE0, -0xB4, 0x08, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8E, -0xC9, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, -0xD1, 0x11, 0x12, 0xAF, 0xB9, 0x7D, 0x01, 0x12, -0x04, 0x7E, 0x12, 0xC8, 0xD1, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x75, 0x64, 0x01, 0x90, 0x05, 0x27, -0xE5, 0x64, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x2F, 0xE0, 0x90, -0x97, 0x15, 0xF0, 0x6F, 0x70, 0x02, 0x41, 0x73, -0xEF, 0x14, 0x60, 0x42, 0x14, 0x60, 0x6C, 0x14, -0x70, 0x02, 0x41, 0x1F, 0x14, 0x70, 0x02, 0x41, -0x4A, 0x24, 0x04, 0x60, 0x02, 0x41, 0x73, 0x90, -0x97, 0x15, 0xE0, 0xB4, 0x04, 0x04, 0x91, 0x37, -0x41, 0x73, 0x90, 0x97, 0x15, 0xE0, 0xB4, 0x02, -0x04, 0x91, 0x46, 0x41, 0x73, 0x90, 0x97, 0x15, -0xE0, 0xB4, 0x03, 0x04, 0x91, 0x4A, 0x41, 0x73, -0x90, 0x97, 0x15, 0xE0, 0x64, 0x01, 0x60, 0x02, -0x41, 0x73, 0x91, 0x39, 0x41, 0x73, 0x90, 0x97, -0x15, 0xE0, 0xB4, 0x04, 0x04, 0x91, 0x5D, 0x41, -0x73, 0x90, 0x97, 0x15, 0xE0, 0xB4, 0x02, 0x04, -0x91, 0x6E, 0x41, 0x73, 0x90, 0x97, 0x15, 0xE0, -0xB4, 0x03, 0x04, 0x91, 0x4E, 0x41, 0x73, 0x90, -0x97, 0x15, 0xE0, 0x60, 0x02, 0x41, 0x73, 0x91, -0x1A, 0x41, 0x73, 0x90, 0x97, 0x15, 0xE0, 0xB4, -0x04, 0x04, 0xD1, 0xF2, 0x80, 0x75, 0x90, 0x97, -0x15, 0xE0, 0xB4, 0x01, 0x04, 0x91, 0x00, 0x80, -0x6A, 0x90, 0x97, 0x15, 0xE0, 0xB4, 0x03, 0x05, -0x12, 0xE8, 0x77, 0x80, 0x5E, 0x90, 0x97, 0x15, -0xE0, 0x70, 0x58, 0x71, 0xFE, 0x80, 0x54, 0x90, -0x97, 0x15, 0xE0, 0xB4, 0x04, 0x04, 0xD1, 0x60, -0x80, 0x49, 0x90, 0x97, 0x15, 0xE0, 0xB4, 0x01, -0x04, 0x91, 0x23, 0x80, 0x3E, 0x90, 0x97, 0x15, -0xE0, 0xB4, 0x02, 0x04, 0xF1, 0xD3, 0x80, 0x33, -0x90, 0x97, 0x15, 0xE0, 0x70, 0x2D, 0x91, 0x21, -0x80, 0x29, 0x90, 0x97, 0x15, 0xE0, 0xB4, 0x03, -0x04, 0xD1, 0x1A, 0x80, 0x1E, 0x90, 0x97, 0x15, -0xE0, 0xB4, 0x01, 0x04, 0x71, 0xE3, 0x80, 0x13, -0x90, 0x97, 0x15, 0xE0, 0xB4, 0x02, 0x04, 0xD1, -0x24, 0x80, 0x08, 0x90, 0x97, 0x15, 0xE0, 0x70, -0x02, 0x71, 0xE1, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x90, 0x88, 0x30, 0xE0, 0x64, 0x02, 0x22, 0x7D, -0x03, 0x7F, 0x02, 0x02, 0x7C, 0x05, 0x90, 0x88, -0x2C, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0x90, -0x88, 0x2C, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, -0x03, 0x22, 0x51, 0x8F, 0x30, 0xE0, 0x11, 0x51, -0x78, 0x60, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8E, -0xC9, 0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, 0x7E, -0x51, 0x78, 0x60, 0x02, 0x91, 0xF8, 0x22, 0x90, -0x05, 0x43, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, -0x7F, 0x01, 0x22, 0x90, 0x01, 0x34, 0x74, 0x40, -0xF0, 0xFD, 0xE4, 0xFF, 0x12, 0x7C, 0x74, 0x43, -0x64, 0x08, 0x22, 0xE4, 0xF5, 0x7C, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x71, 0x12, 0xAF, 0x54, 0x64, -0x01, 0x70, 0x6A, 0xF1, 0x36, 0x75, 0x7C, 0x01, -0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x11, 0x90, -0x88, 0x30, 0xE0, 0xB4, 0x02, 0x03, 0xE4, 0xF5, -0x7C, 0x51, 0xB7, 0xEF, 0x70, 0x02, 0xF5, 0x7C, -0xE5, 0x7C, 0x60, 0x49, 0x90, 0x88, 0x39, 0xE0, -0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8E, -0xC9, 0x91, 0x89, 0xD1, 0x09, 0x90, 0x88, 0x3F, -0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x0F, 0x71, -0x4E, 0xFF, 0xA3, 0xE0, 0x2F, 0x71, 0x72, 0x71, -0x53, 0xFF, 0xA3, 0xE0, 0x80, 0x0F, 0x71, 0x4E, -0xFF, 0xA3, 0x71, 0x5D, 0x2F, 0x71, 0x72, 0x71, -0x53, 0xFF, 0xA3, 0x71, 0x5D, 0x2F, 0x33, 0x33, -0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, -0x8A, 0xD7, 0x12, 0x8D, 0x33, 0x22, 0xE4, 0x90, -0x92, 0x20, 0xF0, 0x90, 0x88, 0x3E, 0xE0, 0x13, -0x13, 0x13, 0x54, 0x1F, 0x22, 0xE0, 0x75, 0xF0, -0x03, 0xA4, 0x24, 0xFE, 0x22, 0xE0, 0x44, 0x02, -0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, -0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, -0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, 0x66, 0x33, -0xE4, 0x90, 0x96, 0x21, 0xF0, 0x90, 0x88, 0x36, -0xE0, 0x60, 0x55, 0x12, 0xAF, 0x54, 0x64, 0x01, -0x70, 0x4E, 0x12, 0xAF, 0xEB, 0xF0, 0xF1, 0x36, -0x90, 0x96, 0x21, 0x74, 0x01, 0xF0, 0xE4, 0x90, -0x88, 0x3D, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, -0xE0, 0x15, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, -0x05, 0xE4, 0x90, 0x96, 0x21, 0xF0, 0x51, 0xB7, -0xEF, 0x70, 0x04, 0x90, 0x96, 0x21, 0xF0, 0x90, -0x96, 0x21, 0xE0, 0x60, 0x1B, 0x90, 0x88, 0x39, -0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, -0x8E, 0xC9, 0x91, 0x89, 0xD1, 0x09, 0x71, 0x4E, -0x71, 0x72, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0x33, -0x22, 0x91, 0x1A, 0x90, 0x8A, 0xF9, 0x12, 0x8E, -0xC9, 0x7D, 0x1F, 0x7F, 0x6F, 0x12, 0x04, 0x7E, -0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, 0x90, -0x88, 0x2F, 0x74, 0x04, 0xF0, 0x22, 0x91, 0x1A, -0x90, 0x8A, 0xF9, 0x12, 0x8E, 0xC9, 0x7D, 0x20, -0x7F, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, -0x12, 0x8D, 0x33, 0x90, 0x88, 0x2F, 0x74, 0x02, -0xF0, 0x22, 0x90, 0x88, 0x2F, 0x74, 0x01, 0xF0, -0x22, 0x91, 0x1A, 0x90, 0x8A, 0xF9, 0x12, 0x8E, -0xC9, 0x7D, 0x21, 0x7F, 0xFF, 0x12, 0x04, 0x7E, -0x90, 0x88, 0x2F, 0x74, 0x03, 0xF0, 0x22, 0x91, -0x5D, 0x90, 0x05, 0x27, 0xE0, 0x54, 0xBF, 0xF0, -0xE4, 0x90, 0x88, 0x2F, 0xF0, 0x22, 0x91, 0x6E, -0x80, 0xEF, 0x91, 0x4E, 0x80, 0xEB, 0x90, 0x8A, -0xF9, 0x12, 0x8E, 0xC9, 0x91, 0x83, 0x90, 0x88, -0x2F, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x8A, 0xF9, -0x12, 0x8E, 0xC9, 0x91, 0x83, 0xB1, 0xF9, 0x90, -0x88, 0x2F, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x86, -0x0C, 0x12, 0x8D, 0x33, 0x90, 0x8A, 0xF9, 0x12, -0x8E, 0xC9, 0x91, 0x83, 0x90, 0x88, 0x2F, 0x74, -0x01, 0xF0, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x04, -0x7E, 0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, 0x7E, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, -0xC1, 0x54, 0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, -0x38, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, -0x30, 0x90, 0x8A, 0xD7, 0x12, 0x8D, 0x33, 0xB1, -0x1A, 0x60, 0x18, 0x90, 0x8A, 0xB9, 0x12, 0x8E, -0xC9, 0xB1, 0xF2, 0x90, 0x8A, 0xF9, 0x12, 0x8E, -0xC9, 0x91, 0x83, 0x90, 0x8B, 0x01, 0xF1, 0x2E, -0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, -0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0xC9, 0x91, -0x89, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x07, -0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x10, 0x90, -0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x07, 0x51, 0xB7, -0xBF, 0x01, 0x04, 0x80, 0x03, 0x91, 0x90, 0x22, -0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x60, 0x12, -0xB1, 0x1A, 0x60, 0x0E, 0x12, 0x7A, 0x65, 0xEF, -0x70, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0xC9, -0xB1, 0xF2, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, -0x01, 0xF0, 0x90, 0x88, 0x34, 0xE0, 0x54, 0x0F, -0x22, 0x90, 0x06, 0xA9, 0xE0, 0x90, 0x95, 0xEF, -0xF0, 0xE0, 0xFD, 0x54, 0xC0, 0x70, 0x04, 0xB1, -0x93, 0x80, 0x5C, 0xED, 0x30, 0xE6, 0x47, 0x90, -0x88, 0x36, 0xE0, 0x64, 0x02, 0x70, 0x2C, 0x90, -0x88, 0x31, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x09, -0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x80, -0x20, 0xB1, 0x1A, 0x64, 0x01, 0x70, 0x29, 0x90, -0x88, 0x3A, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x8A, -0x71, 0x12, 0x8E, 0xC9, 0x7F, 0x01, 0x12, 0x04, -0x7E, 0x80, 0x15, 0xB1, 0x13, 0x64, 0x02, 0x60, -0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8D, 0x33, 0x80, -0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0xB1, 0x93, -0x90, 0x95, 0xEF, 0xE0, 0x90, 0x88, 0x3A, 0x30, -0xE7, 0x04, 0x71, 0x65, 0x80, 0x73, 0xE0, 0x54, -0xFD, 0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x54, -0xFE, 0xF0, 0x22, 0xE4, 0xF5, 0x7C, 0x90, 0x06, -0xA9, 0xE0, 0xF5, 0x7C, 0x54, 0xC0, 0x70, 0x17, -0xB1, 0x93, 0x54, 0xFD, 0xF0, 0x12, 0xAF, 0x95, -0x90, 0x88, 0x39, 0xE0, 0x60, 0x3B, 0x7F, 0x02, -0xF1, 0xB1, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE5, -0x7C, 0x30, 0xE6, 0x1B, 0x90, 0x88, 0x36, 0xE0, -0x64, 0x01, 0x70, 0x15, 0xB1, 0x13, 0x64, 0x02, -0x60, 0x08, 0x90, 0x8A, 0xE1, 0x12, 0x8D, 0x33, -0x80, 0x07, 0x12, 0x73, 0x8F, 0x80, 0x02, 0xB1, -0x93, 0xE5, 0x7C, 0x90, 0x88, 0x3A, 0x30, 0xE7, -0x04, 0x71, 0x65, 0x80, 0x14, 0xE0, 0x54, 0xFD, -0xF0, 0x22, 0xE4, 0xFD, 0x7F, 0x0C, 0x02, 0x04, -0x7E, 0x90, 0x05, 0x27, 0xE0, 0x44, 0x40, 0xF0, -0x22, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, -0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, -0x22, 0x12, 0x7A, 0x65, 0xEF, 0x70, 0x02, 0x91, -0x90, 0x22, 0x90, 0x8A, 0xF9, 0x12, 0x8E, 0xC9, -0x7D, 0x25, 0x61, 0xEB, 0x90, 0x86, 0x0C, 0x12, -0x8D, 0x33, 0x90, 0x8A, 0xF9, 0x12, 0x8E, 0xC9, -0x7D, 0x24, 0x61, 0xEB, 0x71, 0x80, 0x12, 0xAE, -0xB0, 0x7F, 0x01, 0xD1, 0xB5, 0x90, 0x8B, 0x07, -0x12, 0x8D, 0x33, 0x90, 0x93, 0x3B, 0xE0, 0x30, -0xE0, 0x15, 0xF1, 0xC1, 0x90, 0x93, 0x3E, 0xE0, -0x60, 0x05, 0x14, 0xF0, 0x02, 0x79, 0xD4, 0xF1, -0xCA, 0xF0, 0xE4, 0xFF, 0x12, 0xA9, 0xA7, 0x22, -0x90, 0x8A, 0xF9, 0x12, 0x8E, 0xC9, 0x7D, 0x22, -0x7F, 0xFF, 0x12, 0x04, 0x7E, 0xB1, 0xF9, 0x90, -0x88, 0x2F, 0x74, 0x03, 0xF0, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0xB7, 0xBF, -0x01, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, -0x31, 0x6C, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x10, 0xA3, 0x74, -0x01, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0xC3, -0x13, 0x30, 0xE0, 0x02, 0xD1, 0x76, 0x51, 0xD3, -0xE4, 0xFF, 0xD1, 0xB5, 0x90, 0x8B, 0x07, 0x12, -0x8D, 0x33, 0x02, 0x9C, 0x7D, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x33, 0xE0, -0xC3, 0x13, 0x30, 0xE0, 0x28, 0x90, 0x96, 0x80, -0x74, 0x1E, 0xF0, 0x90, 0x96, 0xA2, 0x74, 0x01, -0xF0, 0x90, 0x96, 0x82, 0xEF, 0xF0, 0x7B, 0x01, -0x7A, 0x96, 0x79, 0x80, 0x12, 0xCE, 0xA5, 0x12, -0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x8E, 0xC9, -0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0xB1, 0xF9, 0x90, 0x8A, 0xF9, 0x12, -0x8E, 0xC9, 0x7D, 0x23, 0x7F, 0xFF, 0x12, 0x04, -0x7E, 0x90, 0x8A, 0xEF, 0x12, 0x8D, 0x33, 0x90, -0x88, 0x2F, 0x74, 0x02, 0xF0, 0x22, 0xE4, 0xFF, -0x12, 0x78, 0x4A, 0xBF, 0x01, 0x17, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x11, 0xB1, 0x1A, 0x64, 0x02, -0x60, 0x08, 0x90, 0x8A, 0xE1, 0xF1, 0x2E, 0x02, -0x04, 0x7A, 0x12, 0x73, 0x8F, 0x22, 0xE0, 0xFE, -0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x90, 0x05, -0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, 0x05, -0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, 0x05, -0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, 0x05, -0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, 0x88, -0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x90, 0x88, -0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x4A, 0x90, 0x88, -0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, 0x7E, -0x01, 0x90, 0x88, 0x2F, 0xE0, 0x7D, 0x00, 0xB4, -0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, 0x30, -0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0xC1, 0x76, -0x51, 0x9A, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, -0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0xC9, 0xE4, -0xFD, 0x7F, 0x0C, 0x80, 0x10, 0x90, 0x88, 0x30, -0xE0, 0x70, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8E, -0xC9, 0xE4, 0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, -0x22, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x01, 0xFD, -0x22, 0x90, 0x8A, 0xDF, 0xF1, 0x2E, 0x02, 0x04, -0x7A, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x05, 0x73, -0xF0, 0x22, 0x90, 0x93, 0x3C, 0xE0, 0x14, 0x90, -0x93, 0x3E, 0x22, 0x90, 0x86, 0x0C, 0x12, 0x8D, -0x33, 0x90, 0x88, 0x2F, 0x74, 0x03, 0xF0, 0x22, -0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, 0x60, -0x35, 0xA3, 0xE0, 0x20, 0xE0, 0x30, 0x90, 0x8A, -0xB9, 0x12, 0x8E, 0xC9, 0xE4, 0xFD, 0x7F, 0x04, -0x12, 0x04, 0x7E, 0x12, 0xC0, 0x1F, 0x30, 0xE0, -0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, -0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, -0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, -0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, -0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0xAA, -0xEC, 0x90, 0x96, 0xDD, 0x12, 0x04, 0x31, 0x90, -0x96, 0xDD, 0x51, 0x82, 0x90, 0x01, 0x01, 0xE0, -0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, -0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, 0x90, -0x06, 0xB4, 0x74, 0x86, 0xF0, 0x90, 0x88, 0x9B, -0x12, 0xBB, 0x56, 0x30, 0xE0, 0x05, 0x7F, 0x03, -0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, 0xE0, 0x20, -0xE0, 0x39, 0x11, 0x1F, 0x30, 0xE0, 0x34, 0x90, -0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, 0x90, 0x96, -0xDB, 0xF0, 0x80, 0x06, 0x90, 0x96, 0xDB, 0x74, -0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x90, -0x96, 0xDC, 0x30, 0xE0, 0x05, 0x74, 0x01, 0xF0, -0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, 0x96, 0xDB, -0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, -0x12, 0xA6, 0x54, 0x31, 0x54, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, -0x70, 0xED, 0x44, 0x80, 0xFD, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x11, 0xAA, 0xEC, -0x90, 0x96, 0xE3, 0x12, 0x04, 0x31, 0x90, 0x96, -0xE3, 0x51, 0x82, 0x12, 0x8D, 0x30, 0x90, 0x06, -0xB7, 0x74, 0x11, 0xF0, 0x7F, 0x03, 0x7E, 0x00, -0x12, 0x7C, 0x6A, 0x90, 0x06, 0xB4, 0xE0, 0x54, -0x0F, 0x70, 0xF1, 0x91, 0x74, 0x31, 0x5C, 0x90, -0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, -0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, -0xF0, 0x90, 0x88, 0x9B, 0x12, 0xBB, 0x56, 0x30, -0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x11, -0x1F, 0x30, 0xE0, 0x3B, 0x90, 0x88, 0xDF, 0xE0, -0x60, 0x08, 0x90, 0x96, 0xE1, 0x74, 0x01, 0xF0, -0x80, 0x05, 0xE4, 0x90, 0x96, 0xE1, 0xF0, 0xEF, -0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x07, 0xE4, -0x90, 0x96, 0xE2, 0xF0, 0x80, 0x06, 0x90, 0x96, -0xE2, 0x74, 0x02, 0xF0, 0x90, 0x96, 0xE1, 0xE0, -0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x12, -0xA6, 0x54, 0x7F, 0x01, 0x12, 0x71, 0x9A, 0x90, -0x88, 0x9A, 0xE0, 0x60, 0x02, 0xE4, 0xF0, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x02, 0x12, 0x7B, -0x41, 0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x02, 0x02, -0x7B, 0x2E, 0xE4, 0x90, 0x95, 0xB2, 0xF0, 0x12, -0xE7, 0x0E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, -0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, -0xE4, 0xFF, 0x51, 0xDA, 0x90, 0x93, 0x3F, 0xE0, -0x20, 0xE0, 0x02, 0x41, 0x67, 0x7F, 0x02, 0x12, -0x7B, 0x41, 0xEF, 0x44, 0x02, 0x31, 0x5C, 0xE4, -0x90, 0x95, 0xB3, 0xF0, 0x90, 0x95, 0xB3, 0xE0, -0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2D, 0x12, 0xB7, -0xDD, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x42, 0xE0, 0xFD, -0xEF, 0x5D, 0x60, 0x0F, 0x90, 0x95, 0xB3, 0x91, -0x91, 0x90, 0x95, 0xB3, 0x91, 0xB1, 0x44, 0x40, -0xF0, 0x91, 0x6D, 0x90, 0x95, 0xB3, 0xE0, 0x04, -0xF0, 0x80, 0xC9, 0x90, 0x07, 0xC7, 0xE4, 0xF0, -0x90, 0x07, 0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, -0x77, 0xF0, 0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, -0x07, 0xC0, 0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, -0xA3, 0xF1, 0x71, 0x90, 0x02, 0x26, 0xE0, 0x44, -0x01, 0xF0, 0xE0, 0x90, 0x95, 0xB4, 0xF0, 0x90, -0x95, 0xB4, 0xE0, 0x30, 0xE0, 0x18, 0x90, 0x95, -0xB2, 0xE0, 0x04, 0xD1, 0x89, 0x90, 0x02, 0x26, -0xE0, 0x90, 0x95, 0xB4, 0xF0, 0x90, 0x95, 0xB2, -0xE0, 0xD3, 0x94, 0xFA, 0x40, 0xE1, 0x90, 0x02, -0x03, 0x74, 0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, -0x90, 0x95, 0xB5, 0xF0, 0x90, 0x04, 0x22, 0xE0, -0x44, 0x10, 0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, -0x95, 0xB4, 0xF0, 0x90, 0x02, 0x01, 0x51, 0x7A, -0xF0, 0x90, 0x02, 0x02, 0x51, 0x7A, 0xF0, 0x90, -0x02, 0x14, 0x51, 0x7A, 0xF0, 0xE0, 0x04, 0xF0, -0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, -0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x95, 0xB5, 0xE0, -0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, -0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x91, -0x7D, 0x90, 0x92, 0x90, 0xF0, 0xE4, 0xFD, 0x12, -0x76, 0xF7, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xEF, -0xF0, 0x22, 0xE0, 0xFF, 0x90, 0x95, 0xB4, 0xE0, -0x2F, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, -0x12, 0x04, 0x31, 0x7F, 0x30, 0x7E, 0x08, 0x02, -0x70, 0xAD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x71, 0x29, 0x31, 0x62, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x60, -0x03, 0xB4, 0x08, 0x0D, 0xB1, 0x20, 0xBF, 0x01, -0x08, 0x51, 0x92, 0x90, 0x01, 0xE5, 0xE0, 0x04, -0xF0, 0x22, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -0x18, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, -0x0E, 0xC3, 0x13, 0x30, 0xE0, 0x07, 0xF1, 0x91, -0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, 0x00, 0x51, -0xA2, 0x22, 0x90, 0x97, 0x05, 0xEF, 0xF0, 0xE4, -0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, -0x7F, 0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, -0x97, 0x05, 0xE0, 0x6F, 0x60, 0x32, 0xC3, 0x90, -0x97, 0x07, 0xE0, 0x94, 0x88, 0x90, 0x97, 0x06, -0xE0, 0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, -0xE0, 0x44, 0x10, 0xF0, 0x22, 0x90, 0x97, 0x06, -0x91, 0x66, 0xD3, 0x90, 0x97, 0x07, 0xE0, 0x94, -0x32, 0x90, 0x97, 0x06, 0xE0, 0x94, 0x00, 0x40, -0xC3, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, 0xBC, -0x22, 0x75, 0x66, 0x14, 0x90, 0x88, 0x32, 0xE0, -0x44, 0x10, 0xF0, 0x91, 0x7D, 0x90, 0x92, 0x90, -0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x90, 0x88, -0x41, 0xE0, 0xFD, 0x7F, 0x93, 0x12, 0x7B, 0x2E, -0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, 0x90, 0x01, -0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, 0x10, 0xF0, -0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, 0x90, 0xF0, -0x90, 0x93, 0x3F, 0xE0, 0x30, 0xE0, 0x71, 0x90, -0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, 0x08, 0xF0, -0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, 0xF0, 0xE4, -0x90, 0x95, 0xB2, 0xF0, 0x90, 0x95, 0xB2, 0xE0, -0xFF, 0xC3, 0x94, 0x05, 0x50, 0x2D, 0x12, 0xB7, -0xDD, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, -0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x41, 0xE0, 0xFD, -0xEF, 0x5D, 0x60, 0x0F, 0x90, 0x95, 0xB2, 0x91, -0x91, 0x90, 0x95, 0xB2, 0x91, 0xB1, 0x44, 0x20, -0xF0, 0x91, 0x6D, 0x90, 0x95, 0xB2, 0xE0, 0x04, -0xF0, 0x80, 0xC9, 0x7F, 0x92, 0x91, 0x76, 0xFD, -0x7F, 0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x92, 0x12, -0x7B, 0x41, 0xEF, 0x44, 0x08, 0xFD, 0x7F, 0x92, -0x12, 0x7B, 0x2E, 0x7F, 0x02, 0x12, 0x7B, 0x41, -0xEF, 0x54, 0xFD, 0xFD, 0x7F, 0x02, 0x80, 0x07, -0x7F, 0x92, 0x12, 0xBF, 0xB1, 0x7F, 0x92, 0x12, -0x7B, 0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, -0x44, 0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, -0x7F, 0x01, 0x51, 0xDA, 0x90, 0x00, 0x90, 0xE0, -0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, -0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0xE4, 0x75, -0xF0, 0x01, 0x12, 0x02, 0xE7, 0x7F, 0x14, 0x7E, -0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x02, 0x12, 0x7B, -0x41, 0xEF, 0x54, 0xFE, 0x22, 0x90, 0x88, 0xA0, -0xE0, 0xC4, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, -0x88, 0xE0, 0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, -0x22, 0xE0, 0xFF, 0x24, 0x4D, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB0, -0xF0, 0x74, 0x52, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB1, 0xF0, -0x22, 0xE0, 0xFF, 0x24, 0x43, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, -0xF0, 0x74, 0x48, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB3, 0xF0, -0xE0, 0x22, 0xE4, 0x90, 0x95, 0x53, 0xF0, 0xA3, -0xF0, 0xF1, 0x79, 0xEF, 0x64, 0x01, 0x60, 0x39, -0xC3, 0x90, 0x95, 0x54, 0xE0, 0x94, 0x88, 0x90, -0x95, 0x53, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, -0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, -0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, 0x95, -0x53, 0x91, 0x66, 0xD3, 0x90, 0x95, 0x54, 0xE0, -0x94, 0x32, 0x90, 0x95, 0x53, 0xE0, 0x94, 0x00, -0x40, 0xC7, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, -0xC0, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, -0x90, 0x93, 0x3B, 0xE0, 0xC3, 0x13, 0x20, 0xE0, -0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, -0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, -0x05, 0x75, 0x66, 0x01, 0x80, 0x2E, 0x90, 0x02, -0x96, 0xE0, 0x60, 0x05, 0x75, 0x66, 0x10, 0x80, -0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, -0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, 0xE3, -0x05, 0x75, 0x66, 0x04, 0x80, 0x0E, 0x90, 0x88, -0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x66, 0x20, -0x80, 0x02, 0xC1, 0x81, 0x90, 0x01, 0xB9, 0x74, -0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x66, 0xF0, -0x7F, 0x00, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, -0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, -0x8A, 0x87, 0x12, 0x8D, 0x33, 0x90, 0x88, 0xE6, -0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, -0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x23, -0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x17, 0x91, -0x7D, 0x90, 0x92, 0x90, 0xF0, 0xE4, 0xFD, 0x12, -0x76, 0xF7, 0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, -0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, -0x88, 0xE7, 0xF0, 0x12, 0xA6, 0xFD, 0x30, 0xE0, -0x13, 0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, -0xB4, 0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, -0x90, 0x88, 0xE8, 0xF0, 0x90, 0x88, 0x2C, 0xE0, -0x30, 0xE0, 0x06, 0x90, 0x88, 0x2E, 0x74, 0x01, -0xF0, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x75, 0x90, -0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x12, 0x9C, 0x5D, -0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, 0x9C, -0x76, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, -0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0xA3, 0x12, 0x9C, 0x76, 0x78, 0x18, 0x12, -0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, 0x88, 0x81, -0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, 0x54, -0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0A, 0xF1, -0xAE, 0x74, 0x05, 0xF0, 0x12, 0x6E, 0x2F, 0xD1, -0x91, 0x90, 0x88, 0x32, 0x12, 0xBB, 0x56, 0x30, -0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, -0x03, 0x12, 0xAF, 0xAB, 0x90, 0x8A, 0xE5, 0x12, -0x8E, 0xC9, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, -0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x0A, 0x90, 0x01, -0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, 0xAF, 0xAB, -0x22, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, -0x22, 0xF0, 0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, -0x6A, 0x90, 0x88, 0x33, 0xE0, 0x54, 0xFE, 0xF0, +0xF5, 0x83, 0x22, 0x74, 0x76, 0x25, 0x67, 0xF5, +0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0xF5, +0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0xE0, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, +0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE6, 0x02, +0x61, 0xAD, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x97, +0x30, 0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, +0x97, 0x31, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, +0x90, 0x97, 0x32, 0xF0, 0x90, 0x97, 0x31, 0xE0, +0x24, 0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, +0x61, 0x9D, 0x90, 0x97, 0x30, 0xE0, 0xFF, 0xB1, +0x83, 0x61, 0x9D, 0x90, 0x97, 0x30, 0xE0, 0x24, +0xD6, 0x51, 0x7F, 0xFB, 0xE4, 0xFD, 0xFF, 0x71, +0xDF, 0x75, 0xF0, 0x12, 0x71, 0xEB, 0x13, 0x13, +0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0xDF, +0x75, 0xF0, 0x12, 0x71, 0xEB, 0x12, 0x8F, 0x8B, +0xFB, 0x0D, 0xE4, 0xFF, 0x71, 0xDF, 0x75, 0xF0, +0x12, 0x71, 0xEB, 0xC4, 0x54, 0x03, 0xFB, 0x0D, +0xE4, 0xFF, 0x71, 0xDF, 0x75, 0xF0, 0x12, 0x12, +0xE1, 0xB6, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0xDF, +0x12, 0xE1, 0xA9, 0x71, 0xDC, 0x75, 0xF0, 0x12, +0xB1, 0x5F, 0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, +0x7F, 0x01, 0x71, 0xDF, 0x75, 0xF0, 0x12, 0xB1, +0x5F, 0x54, 0x1F, 0x71, 0xDD, 0xF1, 0xFA, 0xE0, +0xFB, 0xE4, 0xFD, 0x0F, 0x71, 0xDF, 0x75, 0xF0, +0x08, 0xA4, 0x24, 0x01, 0xF5, 0x82, 0xE4, 0x34, +0x82, 0x71, 0xDA, 0x75, 0xF0, 0x08, 0xA4, 0x24, +0x02, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x71, 0xDA, +0x75, 0xF0, 0x08, 0xA4, 0x24, 0x03, 0xF5, 0x82, +0xE4, 0x34, 0x82, 0x71, 0xDA, 0x75, 0xF0, 0x08, +0xA4, 0x24, 0x04, 0xF5, 0x82, 0xE4, 0x34, 0x82, +0xF5, 0x83, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x71, +0xDF, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x05, 0xF5, +0x82, 0xE4, 0x34, 0x82, 0x71, 0xDA, 0x75, 0xF0, +0x08, 0xA4, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, +0x82, 0x71, 0xDA, 0x75, 0xF0, 0x08, 0xA4, 0x24, +0x07, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, +0xE0, 0xFB, 0x0D, 0x71, 0xB2, 0x7F, 0x8F, 0x12, +0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, +0x7F, 0x8D, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, +0x16, 0xEF, 0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, +0x0E, 0xEF, 0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, +0x06, 0xEF, 0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, +0xF5, 0x82, 0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, +0xF0, 0x22, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x71, +0xB2, 0x90, 0x97, 0x30, 0xE0, 0x22, 0xFF, 0x75, +0xF0, 0x12, 0xED, 0x90, 0x89, 0x52, 0x12, 0x04, +0x6E, 0xE0, 0x22, 0x90, 0x96, 0xFF, 0x12, 0x86, +0x42, 0xB1, 0x67, 0x12, 0x02, 0x06, 0x54, 0x7F, +0xFD, 0x12, 0x8F, 0x98, 0xFE, 0x54, 0x1F, 0x90, +0x97, 0x03, 0xF0, 0xEE, 0x54, 0x80, 0x12, 0x8F, +0x8B, 0x90, 0x97, 0x02, 0xF0, 0x12, 0x87, 0xF1, +0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, 0x30, 0xC4, +0x54, 0x0F, 0x90, 0x97, 0x05, 0xF0, 0x12, 0x87, +0xF1, 0xFE, 0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, +0x03, 0x90, 0x97, 0x04, 0xF0, 0xEE, 0x54, 0x80, +0x12, 0x8F, 0x8B, 0xFF, 0x12, 0x87, 0xF1, 0xFB, +0x54, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x90, +0x97, 0x07, 0xF0, 0xFA, 0xEB, 0x54, 0x04, 0x13, +0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, 0x54, 0x01, +0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, 0x71, 0xE6, +0x54, 0x7F, 0x4F, 0xF0, 0x90, 0x97, 0x04, 0xE0, +0x12, 0xE4, 0x5C, 0x71, 0xE6, 0x54, 0xBF, 0x4F, +0xF0, 0xEA, 0x70, 0x0D, 0xEC, 0x54, 0x03, 0x25, +0xE0, 0x25, 0xE0, 0x71, 0xE6, 0x54, 0xF3, 0x4F, +0xF0, 0x90, 0x97, 0x03, 0xE0, 0x54, 0x1F, 0xB1, +0x5A, 0x54, 0xE0, 0x4F, 0xF0, 0xEC, 0x54, 0x03, +0x71, 0xE6, 0x54, 0xFC, 0x4F, 0xF0, 0x90, 0x97, +0x02, 0xE0, 0x54, 0x01, 0xC4, 0x33, 0x54, 0xE0, +0xB1, 0x5A, 0x54, 0xDF, 0x4F, 0xF0, 0x90, 0x97, +0x05, 0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, 0x71, +0xE6, 0x54, 0xCF, 0x4F, 0xB1, 0x77, 0xE0, 0x54, +0xFB, 0xB1, 0x77, 0xC0, 0x83, 0xC0, 0x82, 0xE0, +0xFF, 0x90, 0x97, 0x08, 0xE0, 0x12, 0xCE, 0xF7, +0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, 0x93, 0xED, +0xE0, 0x60, 0x3A, 0xB1, 0x67, 0xE9, 0x24, 0x03, +0xF9, 0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, +0x1F, 0x12, 0x02, 0x4C, 0x90, 0x97, 0x06, 0x74, +0x01, 0xF0, 0x90, 0x97, 0x06, 0xE0, 0xFF, 0xC3, +0x94, 0x04, 0x50, 0x19, 0xEF, 0x24, 0x03, 0xFF, +0xE4, 0x33, 0xFE, 0xB1, 0x67, 0x8F, 0x82, 0x8E, +0x83, 0xE4, 0x12, 0x02, 0x5E, 0x90, 0x97, 0x06, +0xE0, 0x04, 0xF0, 0x80, 0xDD, 0x90, 0x93, 0xEB, +0xE0, 0x54, 0x07, 0xFF, 0xBF, 0x05, 0x0A, 0xEC, +0xB4, 0x01, 0x06, 0x90, 0x93, 0xF0, 0x74, 0x01, +0xF0, 0xE4, 0x90, 0x97, 0x06, 0xF0, 0x90, 0x97, +0x06, 0xE0, 0xFC, 0x24, 0x03, 0xFF, 0xE4, 0x33, +0xFE, 0x90, 0x96, 0xFF, 0x12, 0xD2, 0x78, 0xFF, +0xED, 0xF1, 0xFA, 0xB1, 0xD6, 0xEF, 0xF0, 0x90, +0x97, 0x06, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x04, +0xDD, 0xAF, 0x05, 0x90, 0x8A, 0xFF, 0xE0, 0xFC, +0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x02, +0x04, 0x7E, 0xFF, 0x75, 0xF0, 0x12, 0xED, 0x90, +0x89, 0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x90, +0x96, 0xFF, 0x02, 0x86, 0x39, 0xD3, 0x9D, 0xEC, +0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0xF0, +0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, +0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x97, 0x3B, 0xEF, 0xF0, 0x90, +0x00, 0x8F, 0xE0, 0x30, 0xE6, 0x3B, 0x90, 0x00, +0x8D, 0xE0, 0x64, 0x01, 0x70, 0x33, 0x90, 0x97, +0x3C, 0xF0, 0x90, 0x97, 0x3C, 0xE0, 0xFD, 0x90, +0x97, 0x3B, 0xE0, 0x12, 0x90, 0xD4, 0xE5, 0x82, +0x2D, 0xB1, 0xD9, 0xE0, 0xFB, 0xE4, 0xFF, 0x71, +0xB2, 0x90, 0x97, 0x3C, 0xE0, 0x04, 0xF0, 0xE0, +0xC3, 0x94, 0x10, 0x40, 0xDD, 0x90, 0x00, 0x8F, +0xE0, 0x30, 0xE0, 0x05, 0x90, 0x00, 0x8D, 0xE4, +0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE5, 0x82, +0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0xF1, 0x9E, 0x90, 0x95, 0x53, 0xF0, 0x90, 0x88, -0x32, 0xE0, 0x12, 0x8F, 0xE1, 0x30, 0xE0, 0x02, -0xE1, 0x5C, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, -0x17, 0xF1, 0x85, 0x90, 0x88, 0x4B, 0xF0, 0x90, -0x88, 0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, +0x12, 0xE2, 0xE8, 0x90, 0x97, 0x47, 0xF0, 0x90, +0x88, 0x32, 0x12, 0x8F, 0x8A, 0x30, 0xE0, 0x02, +0xC1, 0xAA, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, +0x1F, 0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x33, +0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, +0x90, 0x88, 0x53, 0xE0, 0x04, 0x33, 0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, 0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, @@ -5297,1187 +4009,2518 @@ u8 array_mp_8723d_fw_nic[] = { 0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, 0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, -0x90, 0x88, 0x4B, 0xF1, 0x68, 0x90, 0x88, 0x4E, -0xE0, 0x12, 0x97, 0xAC, 0x40, 0x04, 0xEF, 0x24, -0x50, 0xF0, 0x90, 0x88, 0x4E, 0xF1, 0x68, 0x90, -0x88, 0x3E, 0xE0, 0x12, 0x97, 0xAC, 0x40, 0x04, -0xEF, 0x24, 0x50, 0xF0, 0x90, 0x88, 0x4E, 0x12, -0xBB, 0x56, 0xFF, 0x7E, 0x00, 0x90, 0x88, 0x42, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, 0x58, -0xF0, 0x90, 0x88, 0x4E, 0xE0, 0x54, 0x07, 0xFF, -0x90, 0x05, 0xB1, 0xE0, 0x54, 0xF8, 0x4F, 0xF0, -0xD1, 0x91, 0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, -0x44, 0x01, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xE0, 0xFF, 0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, -0x22, 0x74, 0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, -0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, -0xE4, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x88, 0x53, -0xE0, 0x24, 0x04, 0x33, 0x33, 0x33, 0x54, 0xF8, -0x22, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x02, 0x7F, -0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, 0x86, -0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, -0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x88, -0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, -0x4F, 0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, -0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0xD1, -0x89, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, -0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, -0x93, 0x3F, 0xE0, 0x20, 0xE0, 0x03, 0x02, 0xC8, -0xA2, 0xE4, 0x90, 0x95, 0x57, 0xF0, 0x90, 0x95, -0x57, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x40, 0x03, -0x02, 0xC8, 0xA2, 0x12, 0xB7, 0xDD, 0x80, 0x05, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0x90, 0x93, 0x40, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, -0x02, 0x01, 0x99, 0x12, 0x02, 0x06, 0xFF, 0x30, -0xE0, 0x1A, 0x90, 0x93, 0x41, 0xE0, 0xFE, 0x90, -0x95, 0x57, 0xE0, 0xFD, 0x74, 0x01, 0xA8, 0x05, -0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4E, -0x90, 0x93, 0x41, 0xF0, 0xEF, 0xC3, 0x13, 0x30, -0xE0, 0x16, 0x90, 0x93, 0x42, 0xE0, 0xFF, 0x90, -0x95, 0x57, 0x12, 0xB7, 0xB4, 0x80, 0x02, 0xC3, -0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x42, 0xF0, -0x12, 0x87, 0xA6, 0xFF, 0x90, 0x95, 0x57, 0xE0, -0xFE, 0x24, 0x43, 0xF5, 0x82, 0xE4, 0x34, 0x93, -0xF5, 0x83, 0xEF, 0x12, 0x87, 0x72, 0xFF, 0x74, -0x48, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0x12, -0x8F, 0xD3, 0xFF, 0x74, 0x4D, 0x2E, 0xF5, 0x82, -0xE4, 0x34, 0x93, 0x12, 0x87, 0xF8, 0xFF, 0x74, -0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0xEF, 0xF0, 0x90, 0x93, 0x40, 0xE0, 0xFF, -0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, 0xC3, -0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x40, 0xF0, -0x22, 0x90, 0x95, 0x57, 0xE0, 0x04, 0xF0, 0x02, -0xC7, 0xE6, 0x22, 0x12, 0x02, 0x06, 0x54, 0x01, -0xFF, 0x90, 0x93, 0x3F, 0xE0, 0x54, 0xFE, 0x4F, -0xF0, 0x30, 0xE0, 0x02, 0x11, 0xB7, 0x22, 0xE4, -0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0xE4, -0x90, 0x86, 0xAF, 0xF0, 0x11, 0xB8, 0x90, 0x93, -0x01, 0xF0, 0x90, 0x93, 0xF3, 0xF0, 0xA3, 0xF0, -0x22, 0x7E, 0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, -0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x04, 0x80, -0x90, 0x88, 0x2C, 0xE0, 0x54, 0xFD, 0xF0, 0x11, -0xB7, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0xD1, 0x76, -0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x12, 0x8D, -0x33, 0x91, 0xE6, 0x11, 0xD1, 0xB1, 0x64, 0x31, -0x25, 0xF1, 0x44, 0x90, 0x8A, 0x73, 0x12, 0x8D, -0x33, 0x90, 0x00, 0x6A, 0xE0, 0x30, 0xE2, 0x14, -0x90, 0x92, 0x20, 0x74, 0x01, 0xF0, 0xA3, 0x74, -0xF4, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x68, 0x7E, -0x01, 0x12, 0x66, 0x33, 0x22, 0xD1, 0x6B, 0x79, -0x3B, 0x02, 0x04, 0x80, 0x90, 0x00, 0x80, 0xE0, -0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, -0x12, 0xDF, 0x91, 0xD1, 0x98, 0x12, 0x7B, 0x79, -0xF1, 0x7E, 0x11, 0xBF, 0x7F, 0x01, 0x12, 0x84, -0x15, 0x90, 0x93, 0x57, 0x74, 0x02, 0xF0, 0xFF, -0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0xE0, 0x04, -0xF0, 0x91, 0x99, 0x11, 0xEE, 0x90, 0x00, 0x80, -0xE0, 0x44, 0x40, 0xFD, 0x7F, 0x80, 0x12, 0x7B, -0x2E, 0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, -0x01, 0xA0, 0xE0, 0xB4, 0xFD, 0x04, 0xE4, 0xFF, -0x31, 0x9E, 0x12, 0xC4, 0xD2, 0x90, 0x00, 0x81, -0xE0, 0x44, 0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, -0x2E, 0xD1, 0x84, 0x71, 0xFC, 0x90, 0x00, 0xAA, -0xE0, 0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, -0xF0, 0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x90, 0x95, -0x57, 0xEF, 0xF0, 0x71, 0xEC, 0x7F, 0xF4, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -0x95, 0x9E, 0xE0, 0x90, 0x95, 0xA0, 0xF0, 0x71, -0xEC, 0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -0xBF, 0x01, 0x08, 0x90, 0x95, 0x9E, 0xE0, 0x90, -0x95, 0xA1, 0xF0, 0x71, 0xEC, 0x7F, 0xF6, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -0x95, 0x9E, 0xE0, 0x90, 0x95, 0xA2, 0xF0, 0x71, -0xEC, 0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -0xBF, 0x01, 0x08, 0x90, 0x95, 0x9E, 0xE0, 0x90, -0x95, 0xA3, 0xF0, 0x71, 0xEC, 0x7F, 0xF8, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, -0x95, 0x9E, 0xE0, 0x90, 0x95, 0xA4, 0xF0, 0x71, -0xEC, 0x91, 0x92, 0xBF, 0x01, 0x08, 0x90, 0x95, -0x9E, 0xE0, 0x90, 0x95, 0xA5, 0xF0, 0x71, 0xEC, -0x7F, 0xFB, 0x71, 0xF3, 0x70, 0x52, 0x90, 0x95, -0x9E, 0xE0, 0x90, 0x95, 0xA6, 0xF0, 0x54, 0x07, -0x60, 0x08, 0x90, 0x95, 0x9E, 0xE0, 0x54, 0xE0, -0x70, 0x3E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x9F, -0x7F, 0xFA, 0x71, 0xF3, 0x70, 0x32, 0x90, 0x95, -0x9E, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, 0x90, -0x95, 0xA6, 0xE0, 0xFE, 0x90, 0x95, 0x9F, 0xE0, -0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x95, 0xA6, -0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, 0x95, -0xA6, 0xE0, 0xFF, 0x90, 0x95, 0x9F, 0xE0, 0x54, -0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x95, 0xA6, 0xF0, -0x71, 0xEC, 0x7F, 0xFD, 0x71, 0xF3, 0x70, 0x46, -0x90, 0x95, 0x9E, 0xE0, 0xFE, 0x54, 0xCC, 0x90, -0x95, 0xA7, 0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, -0x08, 0x90, 0x95, 0x9E, 0xE0, 0x54, 0xC0, 0x70, -0x2D, 0xEF, 0x70, 0x11, 0x90, 0x95, 0xA7, 0xE0, -0xFF, 0x90, 0x95, 0x9E, 0xE0, 0x54, 0x03, 0xD1, -0x7C, 0x90, 0x95, 0xA7, 0xF0, 0x90, 0x95, 0x9E, -0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x95, -0xA7, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, -0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x71, 0xEC, -0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x95, 0x9E, 0xE0, 0x90, 0x95, -0xA8, 0xF0, 0x71, 0xEC, 0x7F, 0xF1, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -0x9E, 0xE0, 0x90, 0x95, 0xA9, 0xF0, 0x71, 0xEC, -0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x95, 0x9E, 0xE0, 0x90, 0x95, -0xAA, 0xF0, 0x71, 0xEC, 0x7F, 0xF3, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, -0x9E, 0xE0, 0x90, 0x95, 0xAB, 0xF0, 0x71, 0xEC, -0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x95, 0x9E, 0xE0, 0x90, 0x95, -0xAC, 0xF0, 0x90, 0x95, 0x58, 0x74, 0x19, 0xF0, -0x90, 0x95, 0x7A, 0x74, 0x08, 0xF0, 0x90, 0x95, -0xA0, 0xE0, 0x90, 0x95, 0x5A, 0xF0, 0x90, 0x95, -0xA1, 0xE0, 0x90, 0x95, 0x5B, 0xF0, 0x90, 0x95, -0xA2, 0xE0, 0x90, 0x95, 0x5C, 0xF0, 0x90, 0x95, -0xA3, 0xE0, 0x90, 0x95, 0x5D, 0xF0, 0x90, 0x95, -0xA4, 0xE0, 0x90, 0x95, 0x5E, 0xF0, 0x90, 0x95, -0xA5, 0xE0, 0x90, 0x95, 0x5F, 0xF0, 0x90, 0x95, -0xA6, 0xE0, 0x90, 0x95, 0x60, 0xF0, 0x90, 0x95, -0xA7, 0xE0, 0x90, 0x95, 0x61, 0xF0, 0x90, 0x95, -0x7B, 0x74, 0x1A, 0xF0, 0x90, 0x95, 0x9D, 0x74, -0x05, 0xF0, 0x90, 0x95, 0xA8, 0xE0, 0x90, 0x95, -0x7D, 0xF0, 0x90, 0x95, 0xA9, 0xE0, 0x90, 0x95, -0x7E, 0xF0, 0x90, 0x95, 0xAA, 0xE0, 0x90, 0x95, -0x7F, 0xF0, 0x90, 0x95, 0xAB, 0xE0, 0x90, 0x95, -0x80, 0xF0, 0x90, 0x95, 0xAC, 0xE0, 0x90, 0x95, -0x81, 0xF0, 0x90, 0x95, 0x57, 0xE0, 0xB4, 0x01, -0x19, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x58, 0xD1, -0xA5, 0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x95, -0x79, 0x7B, 0x12, 0x8E, 0xB7, 0x7F, 0x04, 0x02, -0x04, 0x7E, 0x75, 0x45, 0x01, 0x75, 0x46, 0x95, -0x75, 0x47, 0x58, 0x75, 0x48, 0x0A, 0x7B, 0x01, -0x7A, 0x01, 0x79, 0xA0, 0x12, 0x69, 0xF5, 0x75, -0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x7D, -0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, 0x01, 0x79, -0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, 0x7A, 0x95, -0x79, 0x9E, 0x22, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -0xEF, 0x64, 0x01, 0x22, 0x7E, 0x00, 0x7F, 0x0B, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xE7, -0x12, 0x04, 0x80, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0x53, 0x91, 0x92, 0xBF, 0x01, 0x1C, 0x90, 0x95, -0x53, 0xE0, 0xFE, 0x54, 0x01, 0x90, 0x93, 0xE7, -0xF0, 0xEE, 0x54, 0x04, 0x90, 0x93, 0xE9, 0xF0, -0x90, 0x95, 0x53, 0xE0, 0x54, 0x08, 0x90, 0x93, -0xE8, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x53, -0x7F, 0xFB, 0x71, 0xF3, 0x70, 0x35, 0x90, 0x95, -0x53, 0xE0, 0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, -0x7A, 0x95, 0x79, 0x54, 0x7F, 0xFA, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x95, -0x54, 0x80, 0x03, 0x90, 0x95, 0x53, 0xE0, 0x54, -0x07, 0x90, 0x93, 0xEB, 0xF0, 0x90, 0x95, 0x53, -0xE0, 0x54, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, -0x93, 0xEA, 0xF0, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0x53, 0x7F, 0xFD, 0x7E, 0x01, 0x12, 0x5F, 0xA6, -0xBF, 0x01, 0x0E, 0x90, 0x95, 0x53, 0xE0, 0x54, -0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, 0x93, 0xEC, -0xF0, 0x22, 0x7F, 0xF9, 0x7E, 0x01, 0x02, 0x5F, -0xA6, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, -0xF0, 0x91, 0xB3, 0x90, 0x01, 0x64, 0x74, 0x01, -0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, -0x02, 0x67, 0xD2, 0x12, 0x76, 0x6D, 0x12, 0x75, -0xE0, 0x12, 0xDF, 0x28, 0x12, 0xDF, 0x63, 0x75, -0x21, 0x80, 0xE4, 0xF5, 0x22, 0xF5, 0x23, 0x75, -0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, 0x7B, -0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, -0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, 0xAD, -0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0x7B, 0x00, -0x7A, 0x00, 0x79, 0x00, 0x90, 0x89, 0x2E, 0x12, -0x86, 0x42, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x80, -0x90, 0x89, 0x31, 0x12, 0x86, 0x42, 0x7A, 0x80, -0x79, 0xBF, 0x90, 0x89, 0x34, 0x12, 0x86, 0x42, -0x7A, 0x81, 0x79, 0x61, 0x90, 0x89, 0x3A, 0x12, -0x86, 0x42, 0x7A, 0x81, 0x79, 0x75, 0x90, 0x89, -0x3D, 0x12, 0x86, 0x42, 0x7A, 0x81, 0x79, 0x9D, -0x90, 0x89, 0x40, 0x12, 0x86, 0x42, 0xD1, 0x8E, -0x7A, 0x81, 0x79, 0xD9, 0x90, 0x89, 0x49, 0x12, -0x86, 0x42, 0x7A, 0x82, 0x79, 0x01, 0x90, 0x89, -0x4C, 0x12, 0x86, 0x42, 0xE4, 0x90, 0x96, 0x6A, -0xF0, 0x90, 0x96, 0x59, 0xF0, 0x90, 0x95, 0x53, -0xF0, 0x90, 0x95, 0x53, 0xE0, 0xFF, 0xC3, 0x94, -0x05, 0x50, 0x10, 0x74, 0x7B, 0x2F, 0x12, 0x96, -0x46, 0xE4, 0xF0, 0x90, 0x95, 0x53, 0xE0, 0x04, -0xF0, 0x80, 0xE6, 0x22, 0x7E, 0x00, 0x7F, 0x62, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, -0x12, 0x04, 0x80, 0xD1, 0x6B, 0x79, 0x3B, 0x12, -0x04, 0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, -0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, -0x74, 0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, -0xA3, 0x74, 0x02, 0xF0, 0x12, 0xAF, 0xE3, 0x33, -0x33, 0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, -0xA3, 0x74, 0x50, 0xF0, 0xF1, 0x68, 0x90, 0x8A, -0x89, 0x12, 0x8E, 0xC9, 0x12, 0xBC, 0x83, 0x90, -0x8A, 0x89, 0x12, 0x8E, 0xC9, 0x7D, 0x0C, 0x7F, -0x02, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, -0x8E, 0xC9, 0x7D, 0x0C, 0x7F, 0x01, 0x12, 0x04, -0x7E, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, -0x08, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x80, -0x11, 0xEF, 0xB4, 0x03, 0x08, 0x90, 0x88, 0x41, -0x74, 0x14, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, -0x41, 0xF0, 0x7F, 0x79, 0x12, 0x7B, 0x41, 0xEF, -0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0F, 0x7F, 0x28, -0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE2, 0x06, 0x90, -0x88, 0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, -0x74, 0x02, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, -0xE0, 0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, -0x07, 0xF0, 0x12, 0xC7, 0x85, 0x90, 0x88, 0x4E, -0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x7E, 0x00, 0x7F, -0x18, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, -0x3F, 0x12, 0x04, 0x80, 0x90, 0x8A, 0xA3, 0x12, -0x8E, 0xC9, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, -0x05, 0x58, 0x74, 0x02, 0xF0, 0x7E, 0x00, 0xFF, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, -0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, -0x7F, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, -0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, -0x9C, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x04, 0x7D, -0x00, 0x7B, 0x01, 0x7A, 0x93, 0x22, 0xE4, 0xFD, -0xFF, 0x02, 0x6E, 0x71, 0x25, 0xE0, 0x25, 0xE0, -0xFE, 0xEF, 0x4E, 0x22, 0x90, 0x01, 0xE4, 0x74, -0x1B, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x7A, 0x81, -0x79, 0xB1, 0x90, 0x89, 0x46, 0x02, 0x86, 0x42, -0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, 0x90, -0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x8A, 0x77, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, -0x83, 0x22, 0x90, 0x95, 0xEF, 0xEF, 0xF0, 0x90, -0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, 0x96, -0x13, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x70, 0x90, -0x95, 0xF0, 0x74, 0x03, 0xF0, 0x90, 0x96, 0x12, -0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, 0xFF, -0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, 0x24, -0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, 0x83, -0xE5, 0x82, 0x2E, 0xF1, 0x3C, 0xE0, 0xFD, 0x74, -0xF2, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, 0x08, 0xDA, -0x7B, 0x01, 0x7A, 0x95, 0x79, 0xF0, 0xD1, 0xA5, -0x12, 0x04, 0x7E, 0x90, 0x96, 0x13, 0xE0, 0x04, -0x54, 0x0F, 0xFF, 0xF0, 0xBF, 0x0F, 0x02, 0xE4, -0xF0, 0x90, 0x96, 0x13, 0xE0, 0x90, 0x04, 0x7F, -0xF0, 0x90, 0x95, 0xEF, 0xE0, 0x70, 0x05, 0x90, -0x8A, 0xE5, 0x80, 0x03, 0x90, 0x8A, 0x79, 0x12, -0x8E, 0xC9, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, -0xE4, 0xFF, 0xC1, 0xB2, 0xF5, 0x82, 0xE4, 0x35, -0x83, 0xF5, 0x83, 0x22, 0x7E, 0x00, 0x7F, 0x8E, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x58, -0x02, 0x04, 0x80, 0x12, 0x02, 0x06, 0xFF, 0x90, -0x93, 0xE6, 0xF0, 0xBF, 0x01, 0x09, 0x7F, 0x01, -0x31, 0x9E, 0xE4, 0x90, 0x93, 0xE6, 0xF0, 0x22, -0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, -0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, -0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, +0x90, 0x88, 0x4B, 0xD1, 0xB6, 0x90, 0x88, 0x4E, +0xE0, 0xB1, 0x6D, 0x40, 0x04, 0xEF, 0x24, 0x50, +0xF0, 0x90, 0x88, 0x4E, 0xD1, 0xB6, 0x90, 0x88, +0x3E, 0xE0, 0xB1, 0x6D, 0x40, 0x04, 0xEF, 0x24, +0x50, 0xF0, 0x90, 0x88, 0x4E, 0xD1, 0xC7, 0xFF, +0x7E, 0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, +0xEF, 0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, +0x4E, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, +0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0x12, 0xDF, 0x0B, +0x80, 0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, +0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, +0x24, 0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0xE4, +0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x3E, 0xE0, +0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xE4, 0xF5, +0x7C, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x65, 0xF1, +0xD1, 0x70, 0x61, 0x12, 0xEA, 0x89, 0x75, 0x7C, +0x01, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x11, +0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, 0x03, 0xE4, +0xF5, 0x7C, 0xF1, 0xDA, 0xEF, 0x70, 0x02, 0xF5, +0x7C, 0xE5, 0x7C, 0x60, 0x3F, 0x90, 0x88, 0x39, +0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, +0x8E, 0x5A, 0xF1, 0xBB, 0xF1, 0xC9, 0x90, 0x88, +0x3F, 0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x0F, +0xD1, 0xBF, 0xFF, 0xA3, 0xE0, 0x2F, 0xF1, 0x54, +0xD1, 0xC4, 0xFF, 0xA3, 0xE0, 0x80, 0x0B, 0xD1, +0xBF, 0xF1, 0x3D, 0x2F, 0xF1, 0x54, 0xD1, 0xC4, +0xF1, 0x3D, 0x2F, 0x33, 0x33, 0x33, 0x54, 0xF8, +0x90, 0x88, 0x4F, 0xF0, 0x22, 0xFF, 0xA3, 0xE0, +0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, 0xE0, +0x44, 0x02, 0xF0, 0xE4, 0x90, 0x92, 0x20, 0xF0, +0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, 0x21, 0xF0, +0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, 0x01, 0x02, +0x66, 0x33, 0xE4, 0x90, 0x96, 0x15, 0xF0, 0x90, +0x88, 0x36, 0xE0, 0x60, 0x4D, 0xF1, 0xD1, 0x70, +0x49, 0x12, 0xEB, 0xF4, 0xF0, 0x12, 0xEA, 0x89, +0x90, 0x96, 0x15, 0x74, 0x01, 0xF0, 0xE4, 0x90, +0x88, 0x3D, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, +0xE0, 0x15, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x02, +0x05, 0xE4, 0x90, 0x96, 0x15, 0xF0, 0xF1, 0xDA, +0xEF, 0x70, 0x04, 0x90, 0x96, 0x15, 0xF0, 0x90, +0x96, 0x15, 0xE0, 0x60, 0x15, 0x90, 0x88, 0x39, +0xE0, 0x20, 0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, +0x8E, 0x5A, 0xF1, 0xBB, 0xF1, 0xC9, 0xD1, 0xBF, +0xF1, 0x54, 0x22, 0x7D, 0x01, 0x7F, 0x04, 0x02, +0x04, 0x7E, 0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, +0x80, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, +0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, +0x01, 0x22, 0x90, 0x05, 0x43, 0xE0, 0x7F, 0x00, +0x30, 0xE7, 0x02, 0x7F, 0x01, 0x22, 0x74, 0xA6, +0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, +0x83, 0x22, 0x41, 0x88, 0x90, 0x95, 0xD1, 0x02, +0x86, 0x39, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, +0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, +0x12, 0xBD, 0xE7, 0x90, 0x04, 0x24, 0xE0, 0xFF, +0xE4, 0xFE, 0x12, 0x8A, 0x4E, 0x8E, 0x82, 0x12, +0xD3, 0xD0, 0x2F, 0xFD, 0xEE, 0x11, 0x2B, 0xED, +0xF0, 0x0E, 0xEE, 0xB4, 0x03, 0xEC, 0x22, 0xC3, +0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, 0xA4, 0x24, +0x64, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, +0x22, 0x12, 0x88, 0xCA, 0xEF, 0x70, 0x02, 0xFF, +0x22, 0x71, 0xBC, 0x90, 0x93, 0xAC, 0xF0, 0x90, +0x93, 0x58, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, 0xEF, +0x54, 0xF1, 0xFF, 0xEE, 0x04, 0x54, 0x07, 0x25, +0xE0, 0x4F, 0xF0, 0xA3, 0xE0, 0xFF, 0x90, 0x93, +0x58, 0xE0, 0xFE, 0xC3, 0x13, 0x54, 0x07, 0xB5, +0x07, 0x04, 0xEE, 0x54, 0xF1, 0xF0, 0x71, 0xBC, +0xF5, 0x7D, 0xE4, 0x90, 0x93, 0x5A, 0xF0, 0xE5, +0x7D, 0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5F, 0xF5, +0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x30, +0xE0, 0x26, 0x11, 0xFF, 0xE0, 0x24, 0xAF, 0xF5, +0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0xFF, +0xB1, 0x8B, 0xEF, 0x11, 0xFE, 0xE0, 0x04, 0x11, +0xFE, 0xE0, 0xFF, 0x90, 0x93, 0xAE, 0xE0, 0xFE, +0xEF, 0xB5, 0x06, 0x04, 0x11, 0xFF, 0xE4, 0xF0, +0xB1, 0x8B, 0xE0, 0xFC, 0x90, 0x93, 0xAC, 0xE0, +0xB1, 0x8D, 0xE0, 0x6C, 0x60, 0x0C, 0xE5, 0x7D, +0xB1, 0x9D, 0xD1, 0xEE, 0xE5, 0x7D, 0xB1, 0x9D, +0x31, 0xFC, 0xE5, 0x7D, 0xD1, 0x47, 0x54, 0x07, +0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0E, 0xE5, 0x7D, +0x11, 0x2B, 0xE0, 0xFF, 0x7E, 0x00, 0x7B, 0x04, +0xE4, 0xFD, 0xB1, 0x3C, 0xAD, 0x7D, 0x7F, 0x01, +0x91, 0x43, 0x90, 0x93, 0xAD, 0xE0, 0xC3, 0x13, +0x54, 0x03, 0xFF, 0xBF, 0x02, 0x05, 0xE4, 0xFF, +0x12, 0xB8, 0xC6, 0x7F, 0x01, 0x22, 0xF0, 0x74, +0xD2, 0x25, 0x7D, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0x22, 0xE4, 0x90, 0x96, 0x1A, 0xF0, +0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, 0x02, 0x21, +0xFB, 0xD1, 0x43, 0x54, 0x07, 0x90, 0x96, 0x17, +0xF0, 0x60, 0x05, 0xE0, 0x64, 0x02, 0x70, 0x65, +0x90, 0x93, 0x5A, 0xE0, 0x70, 0x3F, 0x90, 0x05, +0x22, 0xE0, 0x90, 0x96, 0x18, 0xF0, 0x7B, 0x4E, +0x7D, 0x6F, 0xE4, 0xFF, 0x91, 0xC7, 0x90, 0x93, +0x58, 0xE0, 0x11, 0x27, 0xE0, 0xFF, 0x7E, 0x00, +0x7B, 0x04, 0x7D, 0x01, 0xB1, 0x3C, 0xBF, 0x01, +0x11, 0x90, 0x93, 0x58, 0xE0, 0x91, 0x31, 0xE0, +0x44, 0x01, 0xF0, 0x90, 0x93, 0x5A, 0x74, 0x01, +0xF0, 0x22, 0x90, 0x96, 0x18, 0xE0, 0xFD, 0x7B, +0x4F, 0xE4, 0xFF, 0x81, 0xC7, 0x90, 0x93, 0x5A, +0xE0, 0xB4, 0x01, 0x03, 0x74, 0x05, 0xF0, 0x71, +0xBC, 0xFD, 0x7F, 0x02, 0x91, 0x43, 0x90, 0x93, +0x5A, 0xE0, 0x64, 0x05, 0x70, 0x75, 0x11, 0x39, +0xEF, 0x70, 0x70, 0x80, 0x69, 0x90, 0x96, 0x17, +0xE0, 0xFF, 0x64, 0x03, 0x60, 0x05, 0xEF, 0x64, +0x01, 0x70, 0x60, 0x90, 0x93, 0x5A, 0xE0, 0x64, +0x05, 0x70, 0x58, 0x90, 0x96, 0x17, 0xE0, 0x64, +0x01, 0x70, 0x3F, 0x90, 0x96, 0x19, 0xD1, 0xDE, +0xD3, 0x94, 0x1F, 0x90, 0x93, 0x58, 0xE0, 0x40, +0x10, 0x11, 0x28, 0xE0, 0xFF, 0x90, 0x8A, 0xBF, +0x12, 0xAB, 0xE5, 0x7D, 0x00, 0x7C, 0x7C, 0x80, +0x1E, 0x11, 0x27, 0xE0, 0xFB, 0x90, 0x96, 0x19, +0xD1, 0xDE, 0x7D, 0x00, 0x25, 0xE0, 0x25, 0xE0, +0xFC, 0xAF, 0x03, 0x90, 0x8A, 0xBF, 0xE0, 0xFA, +0xA3, 0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x12, +0x04, 0x7E, 0x71, 0xBC, 0xFD, 0x7F, 0x02, 0x91, +0x43, 0x11, 0x39, 0xEF, 0x70, 0x05, 0x7F, 0x06, +0x12, 0xB8, 0xC6, 0x22, 0xFF, 0xEE, 0x13, 0x13, +0x54, 0x07, 0xFD, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x97, 0x3D, 0xED, 0xF0, 0xE4, +0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0x41, 0xEA, +0x90, 0x06, 0x03, 0xE0, 0x54, 0xFB, 0xF0, 0x90, +0x97, 0x3D, 0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, +0xFE, 0x90, 0x04, 0x42, 0xE0, 0x54, 0x9F, 0x4E, +0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xE2, 0x71, 0x90, +0x97, 0x3E, 0xEF, 0xF0, 0x90, 0x04, 0x83, 0xF0, +0x90, 0x96, 0xE3, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x00, 0x01, 0x90, 0x96, 0xE7, 0x12, 0x04, 0x3D, +0x00, 0x00, 0x00, 0x01, 0x71, 0xB1, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, 0xE7, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x7F, +0x00, 0x7E, 0x09, 0x71, 0xB5, 0x12, 0x04, 0x3D, +0x00, 0x00, 0x00, 0x10, 0x90, 0x97, 0x3D, 0x12, +0x8F, 0xEA, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, +0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0xD1, 0x2B, +0x7F, 0x00, 0x7E, 0x0A, 0x71, 0xB5, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x97, 0x3D, +0x12, 0x8F, 0xEA, 0xEF, 0x54, 0x03, 0xFF, 0xE4, +0x78, 0x0A, 0xD1, 0x2B, 0x7F, 0x00, 0x7E, 0x0D, +0x71, 0xB5, 0x12, 0x04, 0x3D, 0x0C, 0x00, 0x00, +0x00, 0x90, 0x97, 0x3E, 0x12, 0x8F, 0xEA, 0xEF, +0x54, 0x03, 0xFF, 0xE4, 0x78, 0x1A, 0xD1, 0x2B, +0x7F, 0x18, 0x71, 0xB3, 0x12, 0x04, 0x3D, 0x00, +0x00, 0x0C, 0x00, 0x90, 0x96, 0xE7, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x00, 0xD1, 0x34, 0x12, +0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, +0xD5, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x04, 0x00, +0x80, 0x58, 0x90, 0x06, 0x03, 0xE0, 0x44, 0x04, +0xF0, 0x90, 0x96, 0xE3, 0x12, 0x04, 0x3D, 0x00, +0x00, 0x00, 0x01, 0x90, 0x96, 0xE7, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x00, 0x71, 0xB1, 0x12, +0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x96, +0xE7, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, +0x7F, 0x00, 0x7E, 0x09, 0x71, 0xB5, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x96, 0xE7, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0xD1, +0x34, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, +0x90, 0x96, 0xD5, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x0C, 0x00, 0x7D, 0x18, 0x7C, 0x00, 0xE4, 0xFF, +0xF1, 0x7B, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x96, +0xE1, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, +0x70, 0x90, 0x96, 0xEB, 0x12, 0x04, 0x31, 0x90, +0x96, 0xE3, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, +0x90, 0x96, 0xEB, 0x12, 0xEB, 0x3C, 0xC0, 0x04, +0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, +0xE3, 0x12, 0x04, 0xB8, 0x90, 0x96, 0xE7, 0x12, +0xEB, 0x3C, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, +0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, 0x96, 0xEF, +0x12, 0x04, 0x31, 0x90, 0x96, 0xEF, 0x12, 0xDA, +0xFC, 0x90, 0x96, 0xE1, 0xE0, 0xFE, 0xA3, 0xE0, +0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0x7F, 0x00, 0x7E, 0x08, 0x71, 0x4F, 0x90, +0x96, 0xE3, 0x22, 0xF0, 0x90, 0x93, 0x58, 0xE0, +0xC3, 0x13, 0x54, 0x07, 0x22, 0xE4, 0x90, 0x96, +0x15, 0xF0, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, +0x5F, 0xC3, 0x13, 0x54, 0x07, 0xFF, 0x91, 0x35, +0xE0, 0xFE, 0x30, 0xE0, 0x53, 0xEF, 0x91, 0x35, +0xEE, 0x54, 0xFE, 0xF0, 0xEF, 0x91, 0x35, 0x12, +0xB5, 0x2C, 0x30, 0xE0, 0x11, 0x90, 0x93, 0x58, +0xE0, 0xFE, 0x91, 0x31, 0xEF, 0x54, 0xFB, 0xF0, +0x90, 0x96, 0x15, 0x74, 0x01, 0xF0, 0x90, 0x04, +0xE0, 0xE0, 0x30, 0xE1, 0x1F, 0xF1, 0xF3, 0x90, +0x93, 0x58, 0xE0, 0x91, 0x31, 0xE0, 0x44, 0x02, +0xF0, 0xE4, 0x90, 0x93, 0xDE, 0x71, 0xBB, 0xFD, +0x7F, 0x02, 0x91, 0x43, 0x90, 0x96, 0x15, 0xE0, +0x60, 0x0E, 0x21, 0x0B, 0x90, 0x93, 0x58, 0xE0, +0x91, 0x31, 0xE0, 0x54, 0xFD, 0xF0, 0x91, 0xC2, +0x22, 0xC3, 0x13, 0x54, 0x07, 0x75, 0xF0, 0x1B, +0xA4, 0x24, 0x62, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x97, 0x34, 0xED, 0xF0, 0x90, +0x97, 0x33, 0xEF, 0xF0, 0x64, 0x02, 0x70, 0x24, +0x90, 0x05, 0x22, 0xE0, 0x90, 0x97, 0x35, 0xF0, +0x7B, 0x4A, 0x7D, 0x6F, 0x12, 0x88, 0xC5, 0xBF, +0x01, 0x07, 0x90, 0x04, 0xD4, 0x74, 0xFF, 0x80, +0x47, 0x90, 0x97, 0x35, 0xE0, 0xFD, 0x7B, 0x46, +0xB1, 0x35, 0x80, 0x41, 0x90, 0x97, 0x33, 0xE0, +0x64, 0x01, 0x70, 0x30, 0x91, 0xC3, 0x90, 0x97, +0x34, 0xE0, 0xFF, 0x75, 0xF0, 0x1B, 0xA4, 0x24, +0x60, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, +0xE0, 0xF4, 0x90, 0x04, 0xD4, 0xF0, 0xEF, 0x75, +0xF0, 0x1B, 0xA4, 0x24, 0x61, 0xF5, 0x82, 0xE4, +0x34, 0x93, 0xF5, 0x83, 0xE0, 0xF4, 0x90, 0x04, +0xD5, 0xF0, 0x80, 0x07, 0x90, 0x04, 0xD4, 0xE4, +0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, 0xEB, +0xB4, 0x57, 0x05, 0x12, 0xEB, 0xA3, 0x80, 0x10, +0xEF, 0x70, 0x07, 0x90, 0x93, 0xF3, 0xE0, 0x4D, +0x80, 0x06, 0x12, 0xC1, 0x36, 0x12, 0xEB, 0xA3, +0x90, 0x05, 0x22, 0xF0, 0x90, 0x93, 0x01, 0xEB, +0xF0, 0x22, 0x8F, 0x65, 0x90, 0x05, 0x22, 0xE0, +0x90, 0x95, 0x4E, 0xF0, 0x7B, 0x17, 0x12, 0x88, +0xC3, 0xEF, 0x64, 0x01, 0x70, 0x30, 0xE5, 0x65, +0xB1, 0x8D, 0xE0, 0xFC, 0xB1, 0x9B, 0xD1, 0xEE, +0xB1, 0x9B, 0x31, 0xFC, 0xE5, 0x65, 0xD1, 0x47, +0x54, 0x07, 0xFF, 0x60, 0x03, 0xBF, 0x02, 0x0D, +0xE5, 0x65, 0x11, 0x2B, 0xE0, 0xFF, 0x7E, 0x00, +0xE4, 0xFB, 0xFD, 0xB1, 0x3C, 0xAD, 0x65, 0x7F, +0x01, 0x91, 0x43, 0x7F, 0x01, 0x22, 0x90, 0x95, +0x4E, 0xE0, 0xFD, 0x7B, 0x49, 0xE4, 0xFF, 0x91, +0xC7, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0x90, 0x97, 0x09, 0xEE, 0xF0, +0xA3, 0x12, 0xC0, 0xAE, 0x90, 0x04, 0x1D, 0xE0, +0x60, 0x2B, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x97, +0x0F, 0xF0, 0x7B, 0x14, 0x12, 0x88, 0xC3, 0xEF, +0x64, 0x01, 0x70, 0x08, 0x12, 0xEA, 0x57, 0x12, +0xAD, 0x8F, 0x80, 0x04, 0x7F, 0x00, 0x80, 0x16, +0x90, 0x97, 0x0F, 0xE0, 0xFD, 0x7B, 0x15, 0xE4, +0xFF, 0x91, 0xC7, 0x80, 0x06, 0x12, 0xEA, 0x57, +0x12, 0xAD, 0x8F, 0x12, 0xEB, 0xE2, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xE5, 0x7D, 0x75, 0xF0, 0x1B, +0xA4, 0x24, 0x5B, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0x22, 0xE5, 0x65, 0x75, 0xF0, 0x1B, +0xA4, 0x24, 0x5C, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0xE0, 0xFE, 0x54, 0x03, 0x22, 0xE4, +0x90, 0x97, 0x2D, 0xF0, 0xA3, 0xF0, 0x90, 0x05, +0x22, 0xE0, 0x90, 0x97, 0x2F, 0xF0, 0x7B, 0x47, +0x7D, 0xFF, 0xE4, 0xFF, 0x91, 0xC7, 0x90, 0x05, +0xF8, 0xE0, 0x70, 0x1A, 0xA3, 0xE0, 0x70, 0x16, +0xA3, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, +0x90, 0x97, 0x2F, 0xE0, 0xFD, 0x7B, 0x48, 0xE4, +0xFF, 0x91, 0xC7, 0x7F, 0x01, 0x22, 0x12, 0xAC, +0xC7, 0x30, 0xE0, 0x1A, 0xD3, 0x90, 0x97, 0x2E, +0xE0, 0x94, 0x03, 0x90, 0x97, 0x2D, 0xE0, 0x94, +0x00, 0x40, 0x07, 0x12, 0xEB, 0x4E, 0x7B, 0x5A, +0x80, 0x18, 0x7F, 0x01, 0x80, 0x18, 0xD3, 0x90, +0x97, 0x2E, 0xE0, 0x94, 0xE8, 0x90, 0x97, 0x2D, +0xE0, 0x94, 0x03, 0x40, 0x07, 0x12, 0xEB, 0x4E, +0x7B, 0x5B, 0xA1, 0x35, 0x7F, 0x32, 0x7E, 0x00, +0x12, 0x7C, 0x6A, 0x90, 0x97, 0x2D, 0x12, 0xBD, +0xED, 0x80, 0x9B, 0x12, 0x03, 0xFE, 0x90, 0x96, +0xE7, 0x02, 0x04, 0x31, 0x7F, 0x84, 0x7E, 0x08, +0x71, 0x4F, 0x90, 0x96, 0xD1, 0x22, 0xF0, 0x90, +0x93, 0x58, 0xE0, 0xC3, 0x13, 0x54, 0x07, 0x75, +0xF0, 0x1B, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, +0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x93, +0x58, 0xE0, 0x30, 0xE0, 0x7D, 0x90, 0x93, 0xDA, +0xE0, 0x04, 0x71, 0xBB, 0x04, 0xFF, 0x90, 0x96, +0x15, 0xF0, 0x90, 0x93, 0x59, 0xE0, 0xB5, 0x07, +0x05, 0xE4, 0x90, 0x96, 0x15, 0xF0, 0x90, 0x93, +0xD8, 0xE0, 0xFF, 0x60, 0x10, 0xD1, 0xDB, 0xC3, +0x9F, 0x12, 0xEB, 0xCC, 0xFB, 0xFD, 0x7F, 0x50, +0x7E, 0x01, 0x12, 0x66, 0x33, 0x90, 0x96, 0x15, +0xE0, 0xD1, 0x47, 0x54, 0x07, 0x90, 0x96, 0x16, +0xD1, 0x3E, 0x54, 0x07, 0xFF, 0x14, 0x60, 0x0E, +0x14, 0x60, 0x07, 0x14, 0x60, 0x08, 0x24, 0x03, +0x70, 0x08, 0xF1, 0xF3, 0x80, 0x02, 0xF1, 0xF3, +0x31, 0x0B, 0x12, 0xEB, 0x5B, 0x50, 0x23, 0x90, +0x96, 0x16, 0xE0, 0xFF, 0x64, 0x02, 0x60, 0x03, +0xEF, 0x70, 0x0F, 0xD1, 0xDB, 0x24, 0xFC, 0xFF, +0xE4, 0x90, 0x92, 0x20, 0xF0, 0xA3, 0xEF, 0x12, +0x9F, 0x57, 0xD1, 0xDB, 0x12, 0xEB, 0xCC, 0x12, +0xBD, 0xFC, 0x22, 0x90, 0x96, 0x15, 0xE0, 0x75, +0xF0, 0x1B, 0xA4, 0x24, 0x5D, 0xF5, 0x82, 0xE4, +0x34, 0x93, 0xF5, 0x83, 0xE0, 0x22, 0xFD, 0xEE, +0x13, 0x13, 0x54, 0x07, 0xFB, 0x90, 0x93, 0x58, +0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x90, 0x97, 0x28, +0xF0, 0xAF, 0x04, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x97, 0x25, 0xEF, 0xF0, 0xED, +0x64, 0x01, 0x70, 0x31, 0xEB, 0xB4, 0x01, 0x07, +0xE0, 0x24, 0x02, 0xF5, 0x10, 0x80, 0x08, 0x90, +0x97, 0x25, 0xE0, 0x24, 0xFE, 0xF5, 0x10, 0x90, +0x96, 0xD1, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0xFF, 0xAF, 0x10, 0xE4, 0xFC, 0xFD, 0xFE, 0x12, +0xEA, 0xF6, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0xFF, 0xAF, 0x10, 0x80, 0x1F, 0x90, 0x96, 0xD1, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, +0x97, 0x25, 0x12, 0x8F, 0xEA, 0x12, 0xEA, 0xF6, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, +0x97, 0x25, 0xE0, 0xFF, 0xE4, 0xFC, 0xFD, 0xFE, +0x90, 0x96, 0xD5, 0x12, 0x04, 0x31, 0x7D, 0x18, +0x7C, 0x00, 0x7F, 0x01, 0xF1, 0x7B, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x96, 0xCF, 0xEC, 0xF0, 0xA3, +0xED, 0xF0, 0x90, 0x96, 0xCE, 0xEF, 0xF0, 0xA3, +0xA3, 0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, 0x96, +0xD9, 0x12, 0x04, 0x31, 0x90, 0x96, 0xD1, 0x12, +0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x96, 0xD9, +0x12, 0xEB, 0x3C, 0xC0, 0x04, 0xC0, 0x05, 0xC0, +0x06, 0xC0, 0x07, 0x90, 0x96, 0xD1, 0x12, 0x04, +0xB8, 0x90, 0x96, 0xD5, 0x12, 0xEB, 0x3C, 0xD0, +0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, +0x86, 0x20, 0x90, 0x96, 0xDD, 0x12, 0x04, 0x31, +0x90, 0x96, 0xCF, 0xA3, 0xE0, 0xFD, 0xC0, 0x05, +0x90, 0x96, 0xDD, 0x12, 0x04, 0xB8, 0x90, 0x8B, +0x9F, 0x12, 0x04, 0x31, 0x90, 0x96, 0xCE, 0xE0, +0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0x90, 0x93, 0x5A, 0x74, 0x05, +0xF0, 0x22, 0x12, 0xAC, 0x9E, 0x12, 0x02, 0x06, +0xFF, 0x54, 0x0F, 0xF5, 0x64, 0xEF, 0xC4, 0x54, +0x0F, 0x64, 0x0F, 0x70, 0x41, 0x90, 0x93, 0x58, +0xE0, 0x54, 0xFE, 0xFF, 0xF0, 0xE5, 0x64, 0x54, +0x07, 0x25, 0xE0, 0xFE, 0xEF, 0x54, 0xF1, 0x4E, +0x12, 0x87, 0x6D, 0xC4, 0x13, 0x54, 0x07, 0x90, +0x93, 0xDF, 0x20, 0xE0, 0x05, 0x74, 0x06, 0xF0, +0x80, 0x03, 0x74, 0x01, 0xF0, 0x7D, 0x20, 0xE4, +0xFF, 0x12, 0x7C, 0x3B, 0xAF, 0x64, 0x12, 0xA4, +0xEA, 0xBF, 0x01, 0x06, 0xE4, 0xFD, 0xFF, 0x12, +0xA4, 0x43, 0x7F, 0x02, 0x01, 0xF4, 0xE5, 0x64, +0x75, 0xF0, 0x1B, 0xA4, 0x24, 0x5B, 0xF9, 0x74, +0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xC0, 0x02, +0xC0, 0x01, 0xE5, 0x63, 0x24, 0x01, 0xF9, 0xE4, +0x35, 0x62, 0x85, 0x61, 0x45, 0xF1, 0xDE, 0xD0, +0x01, 0xD0, 0x02, 0x12, 0x69, 0xF5, 0xE5, 0x64, +0x12, 0xA6, 0x47, 0x54, 0xF7, 0x11, 0xF8, 0xC4, +0x54, 0x0F, 0x14, 0x65, 0x64, 0x70, 0x70, 0x90, +0x88, 0x36, 0xE0, 0x70, 0x07, 0x90, 0x88, 0x2C, +0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x05, 0x80, 0x5C, +0x11, 0xF9, 0xC4, 0x54, 0x0F, 0x90, 0x93, 0x59, +0x12, 0x87, 0xF7, 0xFC, 0x54, 0x0F, 0xC4, 0x54, +0xF0, 0xFE, 0x90, 0x93, 0x58, 0xE0, 0x54, 0x0F, +0x4E, 0xF0, 0xEC, 0x54, 0x60, 0xC4, 0x54, 0x0F, +0xFF, 0x90, 0x93, 0xAD, 0xE0, 0x54, 0xF9, 0x4F, +0xF0, 0x90, 0x93, 0x58, 0xE0, 0x54, 0xF1, 0xF0, +0xF1, 0xC8, 0x90, 0x93, 0xD5, 0xE0, 0x90, 0x93, +0xD9, 0x30, 0xE0, 0x0B, 0xE0, 0x54, 0xFE, 0xF0, +0x54, 0xC1, 0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, +0x44, 0x01, 0xF0, 0x54, 0xC1, 0xF0, 0x90, 0x93, +0x58, 0xE0, 0x44, 0x01, 0xF0, 0xE4, 0x90, 0x93, +0x5A, 0xF0, 0x7F, 0x03, 0x12, 0xB8, 0xC6, 0x22, +0xF0, 0xAB, 0x61, 0xAA, 0x62, 0xA9, 0x63, 0x02, +0x02, 0x06, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x91, 0x9E, 0x90, 0x05, 0x27, 0xE0, 0xF5, +0x64, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, 0x75, +0x48, 0x01, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x2C, +0x12, 0x69, 0xF5, 0x11, 0xF9, 0xFF, 0xC3, 0x13, +0x20, 0xE0, 0x02, 0x21, 0xB6, 0x90, 0x88, 0x2C, +0xE0, 0x30, 0xE0, 0x71, 0x71, 0x8A, 0x75, 0x64, +0x21, 0x71, 0xB9, 0x30, 0xE0, 0x04, 0x71, 0xCD, +0x80, 0x0D, 0xE4, 0x90, 0x88, 0x2D, 0xF0, 0xA3, +0xF0, 0x7D, 0x40, 0xFF, 0x12, 0x7C, 0x7E, 0x90, +0x88, 0x2C, 0x71, 0xC5, 0x30, 0xE0, 0x03, 0x43, +0x64, 0x12, 0xEF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, +0x03, 0x43, 0x64, 0x14, 0x90, 0x88, 0x2C, 0xE0, +0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, 0x03, 0x43, +0x64, 0x80, 0x90, 0x88, 0x2C, 0x91, 0xCA, 0x20, +0xE0, 0x03, 0x43, 0x64, 0x40, 0x51, 0x71, 0x90, +0x88, 0x2F, 0xE0, 0x70, 0x04, 0x7F, 0x01, 0x51, +0x78, 0x90, 0x88, 0x2C, 0x71, 0x91, 0x30, 0xE0, +0x04, 0x7F, 0x04, 0x80, 0x0C, 0x12, 0x9F, 0xDA, +0xEF, 0x60, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, +0x02, 0x51, 0x78, 0x41, 0x2C, 0x51, 0x6E, 0x90, +0x88, 0x2F, 0xE0, 0x64, 0x04, 0x60, 0x02, 0x41, +0x69, 0xFF, 0x51, 0x78, 0x41, 0x69, 0x90, 0x88, +0x2C, 0xE0, 0x30, 0xE0, 0x77, 0x71, 0x8A, 0x43, +0x64, 0x31, 0x71, 0xB9, 0x30, 0xE0, 0x04, 0x71, +0xCD, 0x80, 0x07, 0x7D, 0x40, 0xE4, 0xFF, 0x12, +0x7C, 0x7E, 0x90, 0x88, 0x2C, 0x71, 0xC5, 0x30, +0xE0, 0x03, 0x43, 0x64, 0x02, 0xEF, 0xC4, 0x54, +0x0F, 0x30, 0xE0, 0x03, 0x43, 0x64, 0x04, 0x51, +0x71, 0x90, 0x88, 0x2C, 0x71, 0x91, 0x30, 0xE0, +0x10, 0x71, 0x83, 0x60, 0x37, 0x90, 0x8A, 0xB9, +0x12, 0x8E, 0x5A, 0xE4, 0xFD, 0x7F, 0x02, 0x80, +0x1E, 0x91, 0x85, 0x71, 0x83, 0x70, 0x1D, 0x12, +0x7B, 0xAD, 0x12, 0x9F, 0xDA, 0xBF, 0x01, 0x06, +0x71, 0xDD, 0x7D, 0x01, 0x80, 0x09, 0x90, 0x8A, +0xB9, 0x12, 0x8E, 0x5A, 0xE4, 0xFD, 0xFF, 0x12, +0x04, 0x7E, 0x80, 0x08, 0x90, 0x88, 0x39, 0xE0, +0x90, 0x88, 0x30, 0xF0, 0x90, 0x05, 0x40, 0x74, +0x22, 0xF0, 0x80, 0x35, 0x51, 0x6E, 0x90, 0x88, +0x30, 0xE0, 0xB4, 0x02, 0x0C, 0x90, 0x8A, 0xB9, +0x12, 0x8E, 0x5A, 0x7D, 0x01, 0x7F, 0x04, 0x80, +0x11, 0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0D, +0x90, 0x8A, 0xB9, 0x12, 0x8E, 0x5A, 0x7D, 0x01, +0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x91, 0xBE, 0x71, +0xDD, 0x7D, 0x01, 0x12, 0x04, 0x7E, 0x12, 0xCF, +0x31, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0x64, +0x01, 0x90, 0x05, 0x27, 0xE5, 0x64, 0xF0, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, +0x88, 0x2F, 0xE0, 0x90, 0x97, 0x45, 0xF0, 0x6F, +0x70, 0x02, 0x61, 0x7E, 0xEF, 0x14, 0x60, 0x42, +0x14, 0x60, 0x6C, 0x14, 0x70, 0x02, 0x61, 0x2A, +0x14, 0x70, 0x02, 0x61, 0x55, 0x24, 0x04, 0x60, +0x02, 0x61, 0x7E, 0x90, 0x97, 0x45, 0xE0, 0xB4, +0x04, 0x04, 0x91, 0x4A, 0x61, 0x7E, 0x90, 0x97, +0x45, 0xE0, 0xB4, 0x02, 0x04, 0x91, 0x5A, 0x61, +0x7E, 0x90, 0x97, 0x45, 0xE0, 0xB4, 0x03, 0x04, +0x91, 0x3B, 0x61, 0x7E, 0x90, 0x97, 0x45, 0xE0, +0x64, 0x01, 0x60, 0x02, 0x61, 0x7E, 0x91, 0x3D, +0x61, 0x7E, 0x90, 0x97, 0x45, 0xE0, 0xB4, 0x04, +0x04, 0x91, 0x4E, 0x61, 0x7E, 0x90, 0x97, 0x45, +0xE0, 0xB4, 0x02, 0x04, 0x91, 0x5E, 0x61, 0x7E, +0x90, 0x97, 0x45, 0xE0, 0xB4, 0x03, 0x04, 0x91, +0x31, 0x61, 0x7E, 0x90, 0x97, 0x45, 0xE0, 0x60, +0x02, 0x61, 0x7E, 0x71, 0xEE, 0x80, 0x7F, 0x90, +0x97, 0x45, 0xE0, 0xB4, 0x04, 0x04, 0x91, 0x8D, +0x80, 0x74, 0x90, 0x97, 0x45, 0xE0, 0xB4, 0x01, +0x04, 0x91, 0x07, 0x80, 0x69, 0x90, 0x97, 0x45, +0xE0, 0xB4, 0x03, 0x04, 0x91, 0xAD, 0x80, 0x5E, +0x90, 0x97, 0x45, 0xE0, 0x70, 0x58, 0x91, 0x05, +0x80, 0x54, 0x90, 0x97, 0x45, 0xE0, 0xB4, 0x04, +0x04, 0x91, 0x74, 0x80, 0x49, 0x90, 0x97, 0x45, +0xE0, 0xB4, 0x01, 0x04, 0x91, 0x1D, 0x80, 0x3E, +0x90, 0x97, 0x45, 0xE0, 0xB4, 0x02, 0x04, 0x91, +0xA5, 0x80, 0x33, 0x90, 0x97, 0x45, 0xE0, 0x70, +0x2D, 0x91, 0x1B, 0x80, 0x29, 0x90, 0x97, 0x45, +0xE0, 0xB4, 0x03, 0x04, 0xD1, 0xC0, 0x80, 0x1E, +0x90, 0x97, 0x45, 0xE0, 0xB4, 0x01, 0x04, 0x71, +0xF7, 0x80, 0x13, 0x90, 0x97, 0x45, 0xE0, 0xB4, +0x02, 0x04, 0xD1, 0xDE, 0x80, 0x08, 0x90, 0x97, +0x45, 0xE0, 0x70, 0x02, 0x71, 0xF5, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0x90, 0x88, 0x30, 0xE0, 0x64, +0x02, 0x22, 0x7D, 0x03, 0x7F, 0x02, 0x02, 0x7C, +0x05, 0xE0, 0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, +0x22, 0x90, 0x88, 0x2C, 0x71, 0x91, 0x30, 0xE0, +0x11, 0x71, 0x83, 0x60, 0x0D, 0x90, 0x8A, 0xB9, +0x12, 0x8E, 0x5A, 0x7D, 0x01, 0x7F, 0x02, 0x12, +0x04, 0x7E, 0x71, 0x83, 0x60, 0x02, 0xF1, 0xA0, +0x22, 0x90, 0x88, 0x2C, 0xE0, 0x13, 0x13, 0x54, +0x3F, 0x22, 0x90, 0x88, 0x32, 0xE0, 0xFF, 0x13, +0x13, 0x13, 0x54, 0x1F, 0x22, 0x90, 0x01, 0x34, +0x74, 0x40, 0xF0, 0xFD, 0xE4, 0xFF, 0x12, 0x7C, +0x74, 0x43, 0x64, 0x08, 0x22, 0x90, 0x88, 0x38, +0xE0, 0xFF, 0x90, 0x8A, 0xB9, 0xE0, 0xFC, 0xA3, +0xE0, 0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x88, +0x2F, 0x74, 0x01, 0xF0, 0x22, 0x71, 0xEE, 0x90, +0x8A, 0xF9, 0x12, 0x8E, 0x5A, 0x7D, 0x1F, 0xD1, +0xCE, 0x74, 0x04, 0xF0, 0x22, 0x71, 0xEE, 0x90, +0x8A, 0xF9, 0x12, 0x8E, 0x5A, 0x7D, 0x20, 0x91, +0xB5, 0x12, 0x88, 0xCD, 0x90, 0x88, 0x2F, 0x74, +0x02, 0xF0, 0x22, 0x71, 0xEE, 0x90, 0x8A, 0xF9, +0x12, 0x8E, 0x5A, 0x7D, 0x21, 0x7F, 0xFF, 0x12, +0x04, 0x7E, 0x90, 0x88, 0x2F, 0x74, 0x03, 0xF0, +0x22, 0x90, 0x8A, 0xF9, 0x12, 0x8E, 0x5A, 0x91, +0x6E, 0x80, 0xB3, 0x91, 0x31, 0x90, 0x05, 0x27, +0xE0, 0x54, 0xBF, 0xF0, 0xE4, 0x90, 0x88, 0x2F, +0xF0, 0x22, 0x91, 0x4E, 0x80, 0xEF, 0x90, 0x8A, +0xF9, 0x12, 0x8E, 0x5A, 0x91, 0x6E, 0x91, 0x85, +0x80, 0x94, 0x91, 0x5E, 0x80, 0xDF, 0x90, 0x86, +0x0C, 0x12, 0x88, 0xCD, 0x90, 0x8A, 0xF9, 0x12, +0x8E, 0x5A, 0x91, 0x6E, 0x80, 0x80, 0xE4, 0xFD, +0xFF, 0x02, 0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, +0x8E, 0x5A, 0x7D, 0x22, 0x7F, 0xFF, 0x12, 0x04, +0x7E, 0x91, 0x85, 0x80, 0xA5, 0x90, 0x05, 0x27, +0xE0, 0x44, 0x40, 0xF0, 0x22, 0x91, 0x85, 0x90, +0x8A, 0xF9, 0x12, 0x8E, 0x5A, 0x7D, 0x23, 0x91, +0xB5, 0x12, 0x88, 0xCD, 0x81, 0x14, 0x8B, 0x61, +0x8A, 0x62, 0x89, 0x63, 0x22, 0x90, 0x86, 0x0C, +0x12, 0x88, 0xCD, 0x81, 0x2A, 0x90, 0x8A, 0xEF, +0x12, 0x88, 0xCD, 0x81, 0x14, 0x7F, 0xFF, 0x12, +0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x22, 0x12, 0x7A, +0x65, 0xEF, 0x70, 0x02, 0xD1, 0xF2, 0x22, 0x90, +0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x97, 0x10, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, +0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, 0x88, +0x9D, 0xE0, 0x30, 0xE0, 0x07, 0x90, 0x05, 0x10, +0xE4, 0xF0, 0xA3, 0xF0, 0x90, 0x04, 0x1D, 0xE0, +0x60, 0x3F, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x97, +0x14, 0xF0, 0x7B, 0x26, 0x12, 0x88, 0xC3, 0xEF, +0x64, 0x01, 0x70, 0x0B, 0xB1, 0x6D, 0x90, 0x93, +0x58, 0xE0, 0x20, 0xE0, 0x14, 0x80, 0x0E, 0x91, +0xC7, 0x30, 0xE0, 0x0D, 0xB1, 0x6D, 0x90, 0x93, +0x58, 0xE0, 0x20, 0xE0, 0x04, 0xB1, 0xB4, 0xEE, +0xF0, 0x90, 0x97, 0x14, 0xE0, 0xFD, 0x7B, 0x27, +0xE4, 0xFF, 0x12, 0xA4, 0xC7, 0xB1, 0xA0, 0x80, +0x0F, 0xB1, 0xA0, 0xB1, 0x6D, 0x90, 0x93, 0x58, +0xE0, 0x20, 0xE0, 0x04, 0xB1, 0xB4, 0xEE, 0xF0, +0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x16, 0x91, +0xC7, 0x30, 0xE0, 0x11, 0x90, 0x05, 0x22, 0xE0, +0x54, 0x6F, 0xFF, 0x90, 0x8A, 0xF9, 0x71, 0xE5, +0x7D, 0x28, 0x12, 0x04, 0x7E, 0x12, 0xEB, 0xE2, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xB6, +0xE0, 0xFF, 0x90, 0x97, 0x11, 0xE0, 0xFB, 0x90, +0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, +0x66, 0xDB, 0x90, 0x97, 0x12, 0xEE, 0xF0, 0xFC, +0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x97, 0x10, 0xE0, +0xFF, 0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, +0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, +0x90, 0x97, 0x10, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, +0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, +0x83, 0x02, 0x04, 0x7E, 0x90, 0x97, 0x12, 0xE0, +0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x9B, 0xE0, +0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, 0x8C, 0x83, +0x12, 0x04, 0x7E, 0x90, 0x97, 0x12, 0xA3, 0xE0, +0xFF, 0x24, 0x12, 0xF5, 0x82, 0xE4, 0x34, 0xFC, +0xF5, 0x83, 0xE0, 0x54, 0x01, 0xFE, 0x90, 0x97, +0x11, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x44, 0x02, +0x4E, 0xFE, 0x74, 0x12, 0x2F, 0xF5, 0x82, 0xE4, +0x34, 0xFC, 0xF5, 0x83, 0x22, 0xD3, 0x10, 0xAF, +0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, 0x1A, 0xED, +0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x97, 0x19, 0xEF, +0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xE2, 0xE8, 0x90, +0x97, 0x1C, 0xF0, 0x12, 0x7B, 0x07, 0x7C, 0x00, +0xAD, 0x07, 0x90, 0x97, 0x19, 0xE0, 0x90, 0x04, +0x25, 0xF0, 0x90, 0x97, 0x1A, 0xE0, 0x60, 0x05, +0xD1, 0xB4, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, +0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xD1, 0xB4, 0x54, +0xC0, 0xF0, 0x90, 0x97, 0x1C, 0xE0, 0xFF, 0xAE, +0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, +0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, +0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, +0xF0, 0xAF, 0x05, 0xB1, 0xEA, 0xE0, 0x54, 0x01, +0xFE, 0x90, 0x97, 0x1B, 0xE0, 0x25, 0xE0, 0x25, +0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xB1, 0xE9, +0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, +0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, +0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, 0x0D, 0x2D, +0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, +0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, 0x05, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x74, 0x21, 0x2F, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, +0x90, 0x8A, 0xF9, 0x12, 0x8E, 0x5A, 0x7D, 0x25, +0xD1, 0xCE, 0x74, 0x04, 0xF0, 0x22, 0x7F, 0x6F, +0x12, 0x04, 0x7E, 0x90, 0x05, 0x27, 0xE0, 0x54, +0xBF, 0xF0, 0x90, 0x88, 0x2F, 0x22, 0x90, 0x86, +0x0C, 0x12, 0x88, 0xCD, 0x90, 0x8A, 0xF9, 0x12, +0x8E, 0x5A, 0x7D, 0x24, 0xD1, 0xCE, 0x74, 0x04, +0xF0, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, +0x02, 0xF1, 0xD6, 0x90, 0x88, 0x9D, 0xE0, 0x20, +0xE0, 0x03, 0x12, 0xEA, 0x24, 0x22, 0x90, 0x88, +0x2C, 0xE0, 0x90, 0x88, 0x38, 0x30, 0xE0, 0x04, +0xE0, 0xFF, 0x80, 0x07, 0x71, 0xE0, 0x7D, 0x01, +0x02, 0x04, 0x7E, 0xAE, 0x07, 0x12, 0x9F, 0xDA, +0xBF, 0x01, 0x14, 0x90, 0x88, 0x2C, 0x91, 0xCA, +0x20, 0xE0, 0x0C, 0xAF, 0x06, 0x71, 0xE2, 0x7D, +0x01, 0x12, 0x04, 0x7E, 0x7F, 0x01, 0x22, 0x7F, +0x00, 0x22, 0x71, 0xC2, 0x30, 0xE0, 0x0B, 0xEF, +0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, +0xF1, 0xCF, 0x12, 0xB5, 0x29, 0x30, 0xE0, 0x09, +0x12, 0xB5, 0xCF, 0x54, 0x07, 0x70, 0x40, 0x80, +0x3C, 0x12, 0xEA, 0x0D, 0xD3, 0x9F, 0x40, 0x35, +0x12, 0x9F, 0xD1, 0x70, 0x32, 0xF1, 0xC1, 0x70, +0x08, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xCD, 0x80, +0x27, 0x90, 0x8A, 0xF5, 0x12, 0x88, 0xCD, 0x90, +0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, +0x02, 0x40, 0x09, 0xF1, 0x98, 0xE4, 0x90, 0x88, +0x40, 0xF0, 0x80, 0x03, 0x12, 0xE7, 0x55, 0xE4, +0x90, 0x88, 0x3F, 0xF0, 0x22, 0xF1, 0x06, 0x22, +0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, +0x90, 0x88, 0x36, 0xE0, 0x64, 0x02, 0x60, 0x17, +0xF1, 0xC1, 0x60, 0x13, 0x12, 0x7A, 0x65, 0xEF, +0x70, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0x5A, +0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x22, +0xF0, 0x90, 0x88, 0x34, 0xE0, 0x54, 0x0F, 0x22, +0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, 0x22, 0x7D, +0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, 0x90, 0x00, +0x02, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0xF5, 0x46, +0x89, 0x47, 0x75, 0x48, 0x04, 0x22, 0x91, 0x9E, +0x90, 0x93, 0xE0, 0xE0, 0x54, 0xFE, 0x12, 0x87, +0x66, 0xFC, 0x30, 0xE0, 0x45, 0x90, 0x93, 0xE1, +0xE0, 0x44, 0x01, 0xFE, 0xF0, 0x12, 0x02, 0x06, +0x54, 0xFE, 0xFD, 0xEE, 0x54, 0x01, 0x4D, 0x90, +0x93, 0xE1, 0xF0, 0x12, 0x8F, 0x98, 0x90, 0x93, +0xE2, 0xF0, 0xEC, 0xC3, 0x13, 0x54, 0x7F, 0xFF, +0xA3, 0xF0, 0x12, 0x87, 0xF1, 0xFE, 0xC3, 0x9F, +0x90, 0x93, 0xE4, 0xF0, 0xA3, 0xEE, 0xF0, 0xBE, +0x64, 0x04, 0x74, 0x01, 0xF0, 0x22, 0x90, 0x93, +0xE5, 0xE0, 0x64, 0x96, 0x70, 0x54, 0x74, 0x03, +0xF0, 0x22, 0x90, 0x93, 0xE1, 0xE0, 0x54, 0xFE, +0x12, 0xA8, 0xF8, 0xFF, 0x54, 0x01, 0xFE, 0x90, +0x93, 0xD5, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, +0xEF, 0x54, 0xFE, 0xFF, 0xEE, 0x54, 0x01, 0x4F, +0xF0, 0x12, 0x8F, 0x98, 0x90, 0x93, 0xD6, 0xF0, +0x12, 0x87, 0xF1, 0x90, 0x93, 0xD7, 0xF0, 0xE4, +0xA3, 0xF0, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0xB4, +0x64, 0x05, 0x74, 0x01, 0xF0, 0x80, 0x0A, 0xEF, +0xB4, 0x96, 0x06, 0x90, 0x93, 0xD7, 0x74, 0x03, +0xF0, 0x90, 0x93, 0xD7, 0xE0, 0x04, 0x90, 0x93, +0xDA, 0xF0, 0x22, 0x11, 0xF4, 0x90, 0x93, 0x03, +0xE0, 0x54, 0xFE, 0x4E, 0xF0, 0x30, 0xE0, 0x27, +0xEF, 0x54, 0x04, 0x25, 0xE0, 0xFE, 0xE0, 0x54, +0xF7, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, 0x25, +0xE0, 0xFF, 0xEE, 0x54, 0xFB, 0x4F, 0xF0, 0x90, +0x04, 0x57, 0xE0, 0x90, 0x93, 0x05, 0xF0, 0x90, +0x04, 0x55, 0xE0, 0x90, 0x93, 0x04, 0xF0, 0x90, +0x93, 0x03, 0xE0, 0x54, 0x01, 0xFF, 0xEF, 0x90, +0x07, 0xDC, 0x60, 0x25, 0xE4, 0xF0, 0xF0, 0x90, +0x07, 0xDE, 0xF0, 0xA3, 0x04, 0xF0, 0x90, 0x07, +0xDD, 0x74, 0x03, 0xF0, 0x90, 0x07, 0xE3, 0xE0, +0xF0, 0xA3, 0x74, 0x50, 0xF0, 0xA3, 0x74, 0x10, +0xF0, 0x90, 0x07, 0xDC, 0xE0, 0x44, 0x01, 0xF0, +0x22, 0xE4, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, +0x54, 0x01, 0xFE, 0x22, 0x11, 0xF4, 0x90, 0x93, +0x3B, 0x12, 0xBE, 0x90, 0x4F, 0xF0, 0x12, 0x8F, +0x98, 0x90, 0x93, 0x3C, 0xF0, 0x12, 0x87, 0xF1, +0x90, 0x93, 0x3D, 0xF0, 0xB1, 0x74, 0x90, 0x93, +0x3B, 0xE0, 0x54, 0x01, 0xFF, 0xD3, 0x10, 0xAF, +0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x64, 0x01, 0x70, +0x19, 0x31, 0x69, 0x60, 0x09, 0x31, 0x62, 0x12, +0x7C, 0x05, 0xB1, 0x6B, 0x80, 0x07, 0x31, 0x62, +0x12, 0x7C, 0x3B, 0xB1, 0x33, 0x12, 0x79, 0xD4, +0x80, 0x17, 0x31, 0x69, 0x60, 0x07, 0x31, 0x62, +0x12, 0x7C, 0x05, 0x80, 0x05, 0x31, 0x62, 0x12, +0x7C, 0x3B, 0xB1, 0x1B, 0xB1, 0x22, 0x12, 0x7B, +0xCC, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, +0x01, 0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, +0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, 0x01, 0x3F, +0x22, 0xE4, 0x90, 0x95, 0xE7, 0xF0, 0x12, 0x9F, +0xD2, 0x60, 0x02, 0x41, 0xBF, 0x90, 0x88, 0x36, +0xE0, 0x70, 0x02, 0x41, 0xBF, 0x90, 0x88, 0x2C, +0xE0, 0x20, 0xE0, 0x36, 0x90, 0x88, 0x9D, 0xE0, +0x20, 0xE0, 0x2F, 0x90, 0x06, 0xA9, 0xE0, 0x54, +0xC0, 0x70, 0x27, 0x90, 0x88, 0x9C, 0xE0, 0x70, +0x21, 0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1A, +0xA3, 0xE0, 0x54, 0x07, 0xFF, 0xBF, 0x07, 0x12, +0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, 0x0A, +0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, +0xDB, 0xBC, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, +0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, +0x86, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, +0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, +0x88, 0xF0, 0x90, 0x07, 0xF1, 0xE0, 0x90, 0x95, +0x35, 0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x95, +0x36, 0xF0, 0xB1, 0xA1, 0xF0, 0x90, 0x88, 0x3A, +0xE0, 0x54, 0xEC, 0xF0, 0x51, 0xDB, 0x24, 0xFD, +0x50, 0x02, 0x80, 0x0F, 0x90, 0x88, 0x2C, 0xE0, +0x30, 0xE0, 0x05, 0x12, 0xE6, 0x77, 0x80, 0x03, +0x12, 0xE6, 0xF9, 0x51, 0xDB, 0x64, 0x01, 0x70, +0x3A, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, +0xF0, 0x90, 0x06, 0xA9, 0xE0, 0x30, 0xE5, 0x06, +0xA3, 0xE0, 0x90, 0x95, 0xE7, 0xF0, 0x90, 0x95, +0xE7, 0xE0, 0xFF, 0x60, 0x02, 0x80, 0x05, 0x90, +0x88, 0x3C, 0xE0, 0xFF, 0x90, 0x88, 0x3C, 0xEF, +0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, 0x90, 0x88, +0x3C, 0xE0, 0xFE, 0xFF, 0x80, 0x00, 0x90, 0x88, +0x3D, 0xEF, 0xF0, 0x51, 0xE4, 0xE4, 0x90, 0x88, +0x3F, 0xF0, 0xA3, 0xF0, 0x12, 0xAB, 0xC2, 0x30, +0xE0, 0x5B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, +0x20, 0xE0, 0x24, 0x51, 0xD3, 0x6F, 0x70, 0x4D, +0xEF, 0x60, 0x4A, 0x90, 0x88, 0x32, 0xE0, 0x44, +0x40, 0xF0, 0x12, 0xEB, 0xF4, 0x31, 0x5E, 0x12, +0x7C, 0x05, 0xB1, 0x3A, 0x12, 0xAF, 0xCF, 0x90, +0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, 0x2E, 0x90, +0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, 0x01, +0x70, 0x23, 0x51, 0xD3, 0xFE, 0x6F, 0x60, 0x1D, +0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, 0x60, +0x14, 0x90, 0x88, 0x32, 0xB1, 0x2C, 0x30, 0xE0, +0x0C, 0xEF, 0x54, 0xBF, 0x31, 0x5E, 0x12, 0x7C, +0x3B, 0xB1, 0x22, 0xB1, 0x1B, 0x51, 0xCB, 0x90, +0x88, 0x2C, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x02, +0x51, 0xCB, 0x22, 0x90, 0x88, 0x32, 0xE0, 0x44, +0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, 0xFF, +0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, 0xFF, +0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x85, 0x12, +0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x95, +0x36, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x95, 0x35, +0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, +0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x85, 0xB6, +0x90, 0x88, 0x85, 0x91, 0xEE, 0xEF, 0x24, 0x46, +0x12, 0xB8, 0xBB, 0x90, 0x88, 0x89, 0x91, 0xEE, +0x90, 0x88, 0x85, 0x12, 0xB8, 0xB4, 0x50, 0x02, +0x61, 0xD5, 0x90, 0x88, 0x89, 0x12, 0x86, 0x2D, +0x90, 0x88, 0x85, 0x12, 0x04, 0xB8, 0x12, 0x85, +0xB6, 0x90, 0x95, 0xEC, 0x12, 0x04, 0x31, 0x90, +0x88, 0x31, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, +0x53, 0xE0, 0x24, 0x04, 0xFF, 0xE4, 0x33, 0xFE, +0xEF, 0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, +0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, 0xFE, +0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, +0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x91, 0xF7, 0xEB, +0x2F, 0xFF, 0xEA, 0x80, 0x1D, 0x90, 0x88, 0x33, +0xB1, 0x2C, 0x30, 0xE0, 0x02, 0x81, 0xD3, 0x91, +0xF7, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, +0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, +0xFF, 0xED, 0x3E, 0x90, 0x95, 0xE8, 0xF0, 0xA3, +0xEF, 0xF0, 0xC3, 0x90, 0x95, 0xE9, 0xE0, 0x94, +0xA0, 0x90, 0x95, 0xE8, 0xE0, 0x94, 0x00, 0x50, +0x34, 0xA3, 0xE0, 0xFB, 0x24, 0xF5, 0x91, 0xE6, +0xE0, 0x04, 0xF0, 0x90, 0x95, 0xEC, 0x12, 0x04, +0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, 0x95, 0x2B, +0x91, 0xDB, 0xE0, 0xFE, 0xEF, 0xC3, 0x9E, 0x50, +0x09, 0x90, 0x95, 0xE8, 0xA3, 0xE0, 0x91, 0xD9, +0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, 0x04, 0xF0, +0xE0, 0x90, 0x00, 0xFE, 0xF0, 0x90, 0x88, 0x4C, +0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, +0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0x40, 0x02, +0x81, 0xD3, 0xE4, 0xFF, 0xFE, 0x91, 0xE3, 0xE0, +0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, +0xD3, 0x9D, 0x40, 0x07, 0x90, 0x95, 0xEA, 0xEE, +0xF0, 0x80, 0x05, 0x0E, 0xEE, 0xB4, 0xA0, 0xE5, +0xB1, 0x02, 0x40, 0x02, 0x80, 0x15, 0x90, 0x95, +0xEA, 0xE0, 0x04, 0xFE, 0xEE, 0xC3, 0x94, 0xA0, +0x50, 0x13, 0x91, 0xE3, 0xE0, 0x2F, 0xFF, 0xB1, +0x02, 0x40, 0x07, 0x90, 0x95, 0xEB, 0xEE, 0xF0, +0x80, 0x03, 0x0E, 0x80, 0xE7, 0x90, 0x05, 0x5E, +0xE0, 0xFF, 0x91, 0xD4, 0xE0, 0xFD, 0xEF, 0xC3, +0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, +0xF0, 0x90, 0x88, 0x51, 0xEE, 0xF0, 0x90, 0x95, +0xEB, 0xE0, 0x80, 0x18, 0x91, 0xD4, 0xE0, 0xFD, +0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, +0xF0, 0xEE, 0x04, 0x90, 0x88, 0x51, 0xF0, 0x90, +0x95, 0xEB, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, +0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, +0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, +0xF0, 0xE4, 0x80, 0x0E, 0xE4, 0x90, 0x88, 0x49, +0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x74, +0x50, 0x9F, 0x90, 0x88, 0x48, 0xF0, 0x90, 0x88, +0x51, 0xE0, 0xFF, 0xA3, 0xE0, 0xC3, 0x9F, 0x90, +0x88, 0x4F, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x90, +0x88, 0x8E, 0xE0, 0x24, 0x08, 0xFF, 0x90, 0x88, +0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, +0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, +0x90, 0x88, 0x4F, 0xE0, 0x24, 0x10, 0xF0, 0x12, +0xBE, 0x9E, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, +0x90, 0x8A, 0xA3, 0x12, 0x8E, 0x5A, 0xE4, 0xFF, +0x12, 0x04, 0x7E, 0x22, 0x90, 0x95, 0xEA, 0xE0, +0xFE, 0x24, 0x95, 0xF5, 0x82, 0xE4, 0x34, 0x94, +0xF5, 0x83, 0x22, 0x74, 0xF5, 0x2E, 0xF5, 0x82, +0xE4, 0x34, 0x93, 0xF5, 0x83, 0x22, 0x12, 0x04, +0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, 0x90, +0x95, 0xEC, 0x12, 0x04, 0xB8, 0x78, 0x07, 0x02, +0x03, 0xEB, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, +0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, +0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, +0xE4, 0x9C, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, +0x7C, 0x74, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, +0x74, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x13, 0x13, +0x54, 0x3F, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, +0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, +0x7E, 0x12, 0x9F, 0x62, 0xB1, 0x1B, 0x7F, 0x01, +0xD1, 0x07, 0x90, 0x8B, 0x07, 0x12, 0x88, 0xCD, +0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x13, 0xB1, +0x6B, 0x90, 0x93, 0x3E, 0xE0, 0x60, 0x05, 0x14, +0xF0, 0x02, 0x79, 0xD4, 0xB1, 0x74, 0xE4, 0xFF, +0x31, 0x1D, 0x22, 0x90, 0x93, 0x3D, 0xE0, 0x90, +0x05, 0x73, 0xF0, 0x22, 0x90, 0x93, 0x3C, 0xE0, +0x14, 0x90, 0x93, 0x3E, 0xF0, 0x22, 0x90, 0x01, +0x57, 0xE0, 0x60, 0x1C, 0xB1, 0xA4, 0xF0, 0xB1, +0x29, 0x30, 0xE0, 0x02, 0x80, 0x41, 0x12, 0xEA, +0x0D, 0xD3, 0x9F, 0x40, 0x0B, 0xE4, 0xFF, 0x12, +0x78, 0x4A, 0xBF, 0x01, 0x03, 0x12, 0xAF, 0x98, +0x22, 0x90, 0x01, 0x57, 0xE4, 0xF0, 0x90, 0x01, +0x3C, 0x74, 0x02, 0x22, 0x12, 0x9F, 0xD1, 0x70, +0x1D, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x17, 0x90, +0x88, 0x3A, 0xE0, 0x20, 0xE4, 0x10, 0xB1, 0xA1, +0xF0, 0x90, 0x88, 0x31, 0xE0, 0xB1, 0xD0, 0x54, +0x07, 0x70, 0x03, 0x12, 0xAF, 0x06, 0x22, 0xEF, +0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, +0xFD, 0xF0, 0x22, 0xE4, 0xFE, 0x91, 0xE3, 0xE4, +0xF0, 0x74, 0x95, 0x2E, 0x91, 0xDB, 0x74, 0xFF, +0xF0, 0x0E, 0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, +0x88, 0x4D, 0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, +0x88, 0x50, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, +0x74, 0xA0, 0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, +0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x28, 0x90, +0x96, 0x98, 0x74, 0x1E, 0xF0, 0x90, 0x96, 0xBA, +0x74, 0x01, 0xF0, 0x90, 0x96, 0x9A, 0xEF, 0xF0, +0x7B, 0x01, 0x7A, 0x96, 0x79, 0x98, 0x12, 0xC9, +0x9E, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, +0x8E, 0x5A, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0x2C, 0xE0, +0x30, 0xE0, 0x11, 0xA3, 0x74, 0x01, 0xF0, 0x90, +0x88, 0x2C, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, +0x03, 0x12, 0xBC, 0x33, 0x12, 0x9E, 0xCE, 0xE4, +0xFF, 0xD1, 0x07, 0x90, 0x8B, 0x07, 0x12, 0x88, +0xCD, 0x90, 0x93, 0x58, 0xE0, 0x20, 0xE0, 0x03, +0x02, 0xB8, 0xA3, 0xC3, 0x13, 0x54, 0x07, 0x60, +0x03, 0x02, 0xB8, 0xA3, 0x90, 0x93, 0xD9, 0xE0, +0x30, 0xE0, 0x5B, 0x12, 0xEB, 0x5B, 0x40, 0x56, +0x90, 0x93, 0xE0, 0xE0, 0x30, 0xE0, 0x23, 0x54, +0xFE, 0xF0, 0x90, 0x93, 0xE2, 0xE0, 0x90, 0x93, +0xD6, 0xF0, 0x90, 0x93, 0xE5, 0xE0, 0x90, 0x93, +0xD7, 0xF0, 0x90, 0x93, 0xE3, 0xE0, 0x90, 0x93, +0x5D, 0xF0, 0x90, 0x93, 0xE4, 0xE0, 0x90, 0x93, +0x78, 0xF0, 0x90, 0x05, 0x58, 0xE0, 0x90, 0x95, +0xF3, 0x12, 0xA6, 0x3E, 0x54, 0x07, 0xFF, 0x64, +0x02, 0x60, 0x03, 0xEF, 0x70, 0x08, 0x12, 0xEB, +0x15, 0x24, 0xFD, 0x12, 0x9F, 0x54, 0x12, 0xEB, +0x15, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0x12, 0xBD, +0xFC, 0xE4, 0x90, 0x93, 0xDA, 0xF0, 0x90, 0x93, +0xD5, 0xE0, 0x20, 0xE0, 0x03, 0x02, 0xB8, 0xA3, +0x90, 0x93, 0xD9, 0xE0, 0xFF, 0xC3, 0x13, 0xFE, +0x54, 0x1F, 0x70, 0x03, 0x02, 0xB8, 0xA3, 0xEF, +0x54, 0xC1, 0xFF, 0xEE, 0x14, 0x54, 0x1F, 0xFE, +0x25, 0xE0, 0x4F, 0xF0, 0xE0, 0xC3, 0x13, 0x54, +0x1F, 0x60, 0x03, 0x02, 0xB8, 0xA3, 0x90, 0x93, +0xE1, 0xE0, 0x30, 0xE0, 0x17, 0x54, 0xFE, 0xF0, +0x90, 0x93, 0xE0, 0xE0, 0x44, 0x01, 0xF0, 0xA3, +0xE0, 0x54, 0xFE, 0xFF, 0x90, 0x93, 0xD5, 0xE0, +0x54, 0x01, 0x4F, 0xF0, 0x90, 0x05, 0x22, 0xE0, +0x44, 0x40, 0xFD, 0x7B, 0x58, 0x7F, 0x40, 0x12, +0xA4, 0xC7, 0x90, 0x05, 0x50, 0xE0, 0x54, 0xF7, +0xF0, 0x90, 0x05, 0x69, 0x12, 0xCD, 0xEC, 0x90, +0x05, 0x68, 0x12, 0x8F, 0xEA, 0x12, 0x86, 0x20, +0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, +0x90, 0x05, 0x6A, 0x12, 0x8F, 0xEA, 0x78, 0x10, +0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, +0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, +0x8F, 0xEA, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, +0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, +0x86, 0x20, 0x90, 0x95, 0xE7, 0x12, 0x04, 0x31, +0x12, 0xB8, 0xAE, 0x90, 0x95, 0xEF, 0x12, 0x04, +0x31, 0x90, 0x05, 0x6D, 0x12, 0xCD, 0xEC, 0x90, +0x05, 0x6C, 0x12, 0x8F, 0xEA, 0x12, 0x86, 0x20, +0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, +0x90, 0x05, 0x6E, 0x12, 0x8F, 0xEA, 0x78, 0x10, +0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, 0x04, +0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, +0x8F, 0xEA, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, +0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, +0x86, 0x20, 0x90, 0x95, 0xEB, 0x12, 0x04, 0x31, +0x90, 0x95, 0xE7, 0x12, 0x86, 0x2D, 0xC0, 0x00, +0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0x90, 0x93, +0xD5, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0xFF, 0xE4, +0xFC, 0xFD, 0xFE, 0xFB, 0x7A, 0x04, 0xF9, 0xF8, +0x12, 0x85, 0xC4, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0x85, 0xA9, 0x90, 0x95, +0xE7, 0x12, 0x04, 0x31, 0x90, 0x95, 0xEF, 0x12, +0x04, 0xB8, 0x90, 0x95, 0xE7, 0x11, 0xB4, 0x50, +0x0D, 0x11, 0xA6, 0xEF, 0x24, 0x01, 0x11, 0xBB, +0x90, 0x95, 0xEB, 0x12, 0x04, 0x31, 0x11, 0xA6, +0x78, 0x18, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x67, +0x11, 0xA4, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, +0x05, 0x66, 0x11, 0xA4, 0x78, 0x08, 0x12, 0x03, +0xEB, 0x90, 0x05, 0x65, 0x11, 0xA4, 0x90, 0x05, +0x64, 0x11, 0xAC, 0x78, 0x18, 0x12, 0x03, 0xEB, +0x90, 0x05, 0x63, 0x11, 0xAC, 0x78, 0x10, 0x12, +0x03, 0xEB, 0x90, 0x05, 0x62, 0x11, 0xAC, 0x78, +0x08, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x61, 0x11, +0xAC, 0x90, 0x05, 0x60, 0xEF, 0xF0, 0x90, 0x05, +0x50, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x05, 0x22, +0xE0, 0x54, 0xBF, 0xFD, 0x7B, 0x59, 0x7F, 0x40, +0x12, 0xA4, 0xC7, 0x7F, 0x08, 0x11, 0xC6, 0x90, +0x93, 0xD9, 0xE0, 0x54, 0xC1, 0x44, 0x28, 0xF0, +0x44, 0x01, 0xF0, 0x22, 0xEF, 0xF0, 0x90, 0x95, +0xEB, 0x02, 0x04, 0xB8, 0xEF, 0xF0, 0x90, 0x95, +0xE7, 0x02, 0x04, 0xB8, 0x12, 0x86, 0x2D, 0xC3, +0x02, 0x03, 0xDA, 0xFF, 0xE4, 0x3E, 0xFE, 0xE4, +0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0x90, +0x05, 0x63, 0xE0, 0xFE, 0x90, 0x05, 0x62, 0xE0, +0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, +0x96, 0x96, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x05, +0x61, 0xE0, 0xFE, 0x90, 0x05, 0x60, 0xE0, 0x24, +0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xED, 0xB4, 0x08, +0x0A, 0x90, 0x05, 0x58, 0xE0, 0xFC, 0x2F, 0xFF, +0xEA, 0x3E, 0xFE, 0x90, 0x96, 0x73, 0x74, 0x17, +0xF0, 0x90, 0x96, 0x95, 0x74, 0x06, 0xF0, 0x90, +0x96, 0x75, 0xED, 0xF0, 0x90, 0x93, 0x58, 0xE0, +0xFD, 0xC3, 0x13, 0x54, 0x07, 0x12, 0xA5, 0x8D, +0xE0, 0x90, 0x96, 0x76, 0xF0, 0xA3, 0xEF, 0xF0, +0xEE, 0xA3, 0xF0, 0x90, 0x96, 0x96, 0xE0, 0xFE, +0xA3, 0xE0, 0x90, 0x96, 0x79, 0xF0, 0xEE, 0xA3, +0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x73, 0x12, +0x8E, 0x48, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x90, 0x93, 0x58, 0xE0, +0x30, 0xE0, 0x0A, 0x90, 0x93, 0xD8, 0xE0, 0x60, +0x04, 0x7F, 0x07, 0x11, 0xC6, 0x22, 0xC0, 0xE0, +0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, +0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, +0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, +0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x5E, +0xF0, 0x74, 0xB9, 0xA3, 0xF0, 0x12, 0x75, 0x50, +0xE5, 0x3D, 0x30, 0xE0, 0x02, 0x31, 0x4C, 0xE5, +0x3D, 0x30, 0xE1, 0x02, 0xD1, 0x77, 0xE5, 0x3D, +0x30, 0xE2, 0x02, 0x51, 0x93, 0xE5, 0x3D, 0x30, +0xE4, 0x02, 0x51, 0x79, 0xE5, 0x3D, 0x30, 0xE5, +0x02, 0xB1, 0xE5, 0xE5, 0x3E, 0x30, 0xE0, 0x02, +0x51, 0xB0, 0xE5, 0x3E, 0x30, 0xE3, 0x02, 0x51, +0x36, 0xE5, 0x3E, 0x30, 0xE4, 0x02, 0xD1, 0xAF, +0xE5, 0x3F, 0x30, 0xE1, 0x02, 0x71, 0xDF, 0xE5, +0x3F, 0x30, 0xE0, 0x02, 0x71, 0x8B, 0xE5, 0x3F, +0x30, 0xE4, 0x02, 0xB1, 0xE6, 0xE5, 0x3F, 0x30, +0xE2, 0x09, 0xD1, 0xC6, 0x90, 0x07, 0x8F, 0xE0, +0x44, 0x10, 0xF0, 0xE5, 0x40, 0x30, 0xE1, 0x0B, +0x90, 0x8A, 0xE5, 0x12, 0x8E, 0x5A, 0x7F, 0x04, +0x12, 0x04, 0x7E, 0xE5, 0x40, 0x30, 0xE4, 0x03, +0x12, 0xB5, 0x41, 0xE5, 0x40, 0x30, 0xE5, 0x02, +0x91, 0x4E, 0xE5, 0x40, 0x30, 0xE6, 0x02, 0x91, +0xAB, 0xE5, 0x40, 0x30, 0xE7, 0x02, 0x71, 0x3A, +0x74, 0x5E, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, +0xB9, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, +0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, +0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x01, 0x8C, 0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, -0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x80, 0xDE, -0x90, 0x00, 0xAB, 0xE0, 0xFE, 0x90, 0x00, 0xAA, -0xF1, 0xBA, 0x54, 0x7F, 0x90, 0x95, 0xED, 0xF0, -0xA3, 0xEF, 0xF0, 0xE0, 0x30, 0xE1, 0x02, 0xF1, -0x7E, 0x22, 0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, -0xEC, 0x3E, 0x22, 0x12, 0x87, 0xA2, 0x12, 0x87, -0x6F, 0x90, 0x95, 0x5A, 0x12, 0x8F, 0xD6, 0x90, -0x95, 0x5B, 0x12, 0x87, 0xFB, 0x90, 0x95, 0x5C, -0x12, 0x87, 0x61, 0x90, 0x95, 0x5D, 0x12, 0x87, -0x68, 0x90, 0x95, 0x5E, 0xF0, 0xEF, 0x12, 0x86, -0x4B, 0xD0, 0x05, 0x00, 0xD0, 0x11, 0x01, 0xD0, -0x18, 0x02, 0xD0, 0x1F, 0x03, 0xD0, 0x26, 0x04, -0xD0, 0x2D, 0x05, 0xD0, 0x3B, 0x06, 0xD0, 0x64, -0x07, 0x00, 0x00, 0xD0, 0xC2, 0x90, 0x95, 0x57, -0x74, 0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, 0x01, -0xC7, 0x11, 0xED, 0x74, 0x2A, 0xF0, 0x01, 0xC7, -0x11, 0xE5, 0x74, 0x31, 0xF0, 0x01, 0xC7, 0x11, -0xE5, 0x74, 0x32, 0xF0, 0x01, 0xC7, 0x11, 0xED, -0x74, 0x33, 0xF0, 0x01, 0xC7, 0x7B, 0x01, 0x7A, -0x95, 0x79, 0x59, 0x90, 0x8A, 0x83, 0x12, 0xCE, -0xA8, 0x01, 0xE2, 0x90, 0x95, 0x59, 0xE0, 0x90, -0x88, 0xE1, 0xF0, 0x90, 0x95, 0x5A, 0xE0, 0x90, -0x88, 0xE2, 0xF0, 0x90, 0x95, 0x5B, 0xE0, 0x90, -0x88, 0xE3, 0xF0, 0x90, 0x95, 0x5C, 0xE0, 0x90, -0x88, 0xE4, 0xF0, 0x90, 0x95, 0x5D, 0xE0, 0x90, -0x88, 0xE5, 0xF0, 0x22, 0x90, 0x95, 0x59, 0xE0, -0x90, 0x95, 0x42, 0xF0, 0x90, 0x95, 0x5C, 0x12, -0x9C, 0x76, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -0x12, 0x9C, 0x76, 0x78, 0x18, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x95, 0x5B, 0x12, 0x9C, -0x76, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, +0x01, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x00, +0xAB, 0xE0, 0xFE, 0x90, 0x00, 0xAA, 0x51, 0x70, +0x54, 0x7F, 0x90, 0x95, 0xE5, 0xF0, 0xA3, 0xEF, +0xF0, 0xE0, 0x30, 0xE1, 0x02, 0x51, 0x36, 0x22, +0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, +0x22, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x12, +0xD1, 0x05, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xBB, +0x12, 0x8E, 0x5A, 0xE4, 0xFF, 0x12, 0x04, 0x7E, +0x71, 0x83, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, +0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x08, +0x90, 0x8B, 0x01, 0x12, 0x88, 0xCD, 0x80, 0x05, +0xB1, 0xF4, 0x12, 0xAF, 0x06, 0x02, 0xA6, 0x56, +0x51, 0xF6, 0x90, 0x96, 0x15, 0xEF, 0xF0, 0x90, +0x8A, 0x89, 0x30, 0xE0, 0x13, 0x12, 0x8E, 0x5A, +0x7D, 0x01, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, +0x88, 0x33, 0xE0, 0x44, 0x04, 0xF0, 0x80, 0x06, +0x12, 0x8E, 0x5A, 0x12, 0xAC, 0x6E, 0x90, 0x96, +0x15, 0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, +0xE0, 0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, +0x90, 0x01, 0x2F, 0x74, 0x80, 0xF0, 0xD1, 0x9E, +0x74, 0x02, 0xF0, 0x02, 0x6E, 0x2F, 0xE4, 0x90, +0x96, 0x17, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, +0x7B, 0x41, 0x90, 0x96, 0x16, 0xEF, 0xF0, 0x7F, +0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, 0x96, +0x16, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, +0x90, 0x96, 0x18, 0xE0, 0x94, 0x64, 0x90, 0x96, +0x17, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, +0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x96, 0x16, +0xE0, 0xFF, 0x22, 0x90, 0x96, 0x17, 0xB1, 0xED, +0x80, 0xC3, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, +0x05, 0x90, 0x8A, 0xEB, 0x80, 0x2C, 0x90, 0x95, +0x44, 0x12, 0x9E, 0xC7, 0x30, 0xE0, 0x20, 0x90, +0x88, 0xC2, 0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, +0x0D, 0x90, 0x8A, 0xBB, 0x12, 0x8E, 0x5A, 0xE4, +0xFF, 0x12, 0x04, 0x7E, 0x71, 0x83, 0x90, 0x95, +0x44, 0xE0, 0x54, 0xF7, 0xF0, 0x80, 0x06, 0x90, +0x8A, 0x99, 0x12, 0x88, 0xCD, 0x90, 0x88, 0xF0, +0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, +0x88, 0xCD, 0x22, 0x90, 0x88, 0xC2, 0xE0, 0x54, +0xEF, 0xF0, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xFF, +0x30, 0xE0, 0x4B, 0x90, 0x88, 0x30, 0xE0, 0x7E, +0x00, 0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x88, +0x2F, 0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, +0x01, 0xED, 0x4E, 0x70, 0x31, 0xEF, 0xC3, 0x13, +0x30, 0xE0, 0x02, 0x80, 0x7E, 0x12, 0xAB, 0x99, +0x90, 0x88, 0x30, 0xE0, 0xB4, 0x08, 0x0C, 0x90, +0x8A, 0xB9, 0x12, 0x8E, 0x5A, 0xE4, 0xFD, 0x7F, +0x0C, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0x70, +0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0x5A, 0xE4, +0xFD, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0x90, +0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x4B, 0x90, +0x88, 0x30, 0xE0, 0x7E, 0x00, 0xB4, 0x02, 0x02, +0x7E, 0x01, 0x90, 0x88, 0x2F, 0xE0, 0x7D, 0x00, +0xB4, 0x04, 0x02, 0x7D, 0x01, 0xED, 0x4E, 0x70, +0x31, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x02, 0x80, +0x2A, 0x12, 0xB5, 0x7E, 0x90, 0x88, 0x30, 0xE0, +0xB4, 0x0C, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x8E, +0x5A, 0xE4, 0xFD, 0x7F, 0x08, 0x80, 0x10, 0x90, +0x88, 0x30, 0xE0, 0xB4, 0x04, 0x0C, 0x90, 0x8A, +0xB9, 0x12, 0x8E, 0x5A, 0xE4, 0xFD, 0xFF, 0x12, +0x04, 0x7E, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x12, 0x9F, 0xDA, 0xBF, 0x01, 0x04, +0x7F, 0x01, 0x80, 0x02, 0x7F, 0x02, 0x12, 0xAA, +0x78, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, +0x37, 0xE0, 0xB4, 0x01, 0x19, 0xE4, 0xF0, 0x90, +0x01, 0x5B, 0xF0, 0x90, 0x92, 0x20, 0xF0, 0x90, +0x88, 0x95, 0xE0, 0xC3, 0x13, 0x54, 0x7F, 0x90, +0x92, 0x21, 0xF0, 0xE4, 0xB1, 0xFC, 0x90, 0x88, +0x31, 0x12, 0xAB, 0x91, 0x30, 0xE0, 0x33, 0xEF, +0x54, 0xBF, 0xB1, 0x0B, 0x30, 0xE0, 0x06, 0xE0, +0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFE, +0xF0, 0xB1, 0x14, 0x74, 0x04, 0xF0, 0x90, 0x88, +0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, 0x30, +0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0x5A, +0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, 0x7E, 0x12, +0xAF, 0x06, 0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, +0x12, 0x8F, 0x8B, 0x30, 0xE0, 0x1F, 0xEF, 0x54, +0x7F, 0xB1, 0x0B, 0x30, 0xE1, 0x06, 0xE0, 0x44, +0x02, 0xF0, 0x80, 0x08, 0xE0, 0x54, 0xFD, 0xF0, +0xB1, 0x14, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, +0x60, 0x03, 0x12, 0xAF, 0x06, 0x90, 0x88, 0xA1, +0x12, 0xAB, 0x91, 0x30, 0xE0, 0x22, 0x90, 0x88, +0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, +0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, +0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, 0x44, +0x04, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, +0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x03, 0x12, +0xA3, 0xC5, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, +0x90, 0x88, 0x32, 0x22, 0x90, 0x01, 0xB9, 0x74, +0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xB1, 0xE7, +0x12, 0x8A, 0x4E, 0x12, 0x02, 0x06, 0xFF, 0x54, +0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0x12, 0x8F, +0x8B, 0xA3, 0xF0, 0x12, 0x8F, 0x98, 0xFD, 0x54, +0xF0, 0xC4, 0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, +0xE0, 0x54, 0xF0, 0x4F, 0x12, 0x87, 0x9E, 0xFC, +0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, +0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, +0xC3, 0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, +0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, +0xF0, 0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, 0xF0, +0x12, 0x87, 0xF1, 0x90, 0x88, 0x35, 0x12, 0x87, +0x6D, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x8E, 0x5A, +0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x8A, 0x4E, +0x12, 0x87, 0x67, 0xFF, 0x54, 0x01, 0xFE, 0x90, +0x88, 0x9B, 0xD1, 0x90, 0x4F, 0x12, 0x87, 0x65, +0xFE, 0x54, 0x04, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, +0xFF, 0x90, 0x88, 0x9B, 0xF0, 0xEE, 0x54, 0x08, +0xFE, 0xEF, 0x54, 0xF7, 0x12, 0x87, 0x64, 0xD1, +0x6D, 0x90, 0x88, 0x9B, 0xD1, 0x5A, 0x12, 0x87, +0x64, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, +0x90, 0x88, 0x9B, 0xF0, 0x12, 0x5C, 0x5F, 0x90, +0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, +0x33, 0xE0, 0x54, 0xFB, 0xF0, 0xB1, 0x14, 0xF0, +0x90, 0x88, 0x36, 0xD1, 0x83, 0x12, 0xAF, 0xC0, +0x90, 0x01, 0xBE, 0xF0, 0x22, 0x22, 0x22, 0x90, +0x95, 0x4E, 0x02, 0x86, 0x42, 0xE4, 0x75, 0xF0, +0x01, 0x02, 0x02, 0xE7, 0x90, 0x88, 0x31, 0xE0, +0x54, 0xF7, 0xF0, 0x22, 0xFB, 0xFD, 0x7F, 0x58, +0x7E, 0x01, 0x02, 0x66, 0x33, 0x90, 0x88, 0xA1, +0xE0, 0x13, 0x13, 0x54, 0x3F, 0x22, 0xEF, 0x64, +0x39, 0x70, 0x46, 0x90, 0x88, 0x9D, 0xE0, 0x30, +0xE0, 0x3F, 0xD1, 0x05, 0x30, 0xE0, 0x3A, 0x90, +0x88, 0xC2, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, +0xE0, 0x2F, 0x90, 0x95, 0x4A, 0xE0, 0x04, 0xF0, +0xD1, 0x63, 0x30, 0xE0, 0x1C, 0xEE, 0x13, 0x13, +0x13, 0x54, 0x1F, 0x30, 0xE0, 0x13, 0x90, 0x01, +0x63, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x10, +0xF0, 0xEF, 0x54, 0xEF, 0x90, 0x88, 0xC2, 0xF0, +0x22, 0x90, 0x88, 0xB0, 0xE0, 0x70, 0x02, 0x71, +0x83, 0x22, 0xF0, 0xEE, 0x54, 0x20, 0xFE, 0xEF, +0x54, 0xDF, 0x22, 0x90, 0x95, 0x44, 0xE0, 0xFE, +0x13, 0x13, 0x54, 0x3F, 0x22, 0xFE, 0x54, 0x10, +0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, 0x90, +0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xAF, 0x3A, +0x02, 0xA1, 0x0B, 0xE0, 0x90, 0x01, 0xBA, 0xF0, +0x90, 0x88, 0x38, 0xE0, 0x90, 0x01, 0xBB, 0x22, +0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, +0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x22, 0x90, 0x88, +0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, +0x4F, 0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, +0x93, 0x03, 0xE0, 0x30, 0xE0, 0x0F, 0x13, 0x13, +0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, 0x04, +0x1F, 0xE0, 0x44, 0x40, 0xF0, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0xF0, +0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, 0xF7, 0xE0, +0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, 0x01, 0x23, +0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, 0xE0, 0xFE, +0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, 0x12, 0xAD, +0xA8, 0x80, 0x10, 0x90, 0x88, 0xF7, 0xE0, 0xB4, +0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, 0x8A, 0xE7, +0x12, 0x88, 0xCD, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, +0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, +0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, +0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, +0x74, 0x08, 0xF0, 0x74, 0xBF, 0xA3, 0xF0, 0x12, +0x6C, 0xD6, 0xE5, 0x25, 0x30, 0xE7, 0x02, 0x51, +0x56, 0x74, 0x08, 0x04, 0x90, 0x01, 0xC4, 0xF0, +0x74, 0xBF, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, +0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, +0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, +0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x90, +0x00, 0x80, 0xE0, 0x44, 0x80, 0xF0, 0x12, 0xDB, +0xC4, 0x12, 0xE1, 0xF1, 0x12, 0x7B, 0x79, 0x51, +0x36, 0x12, 0xCF, 0x09, 0x7F, 0x01, 0x12, 0x84, +0x15, 0x90, 0x93, 0x57, 0x74, 0x02, 0xF0, 0xFF, +0x12, 0x84, 0x15, 0x90, 0x93, 0x57, 0xE0, 0x04, +0xF0, 0x12, 0xD9, 0x1B, 0x12, 0xCF, 0x4E, 0x90, +0x00, 0x80, 0xE0, 0x44, 0x40, 0xF0, 0x75, 0x20, +0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, 0xE0, +0xB4, 0xFD, 0x05, 0xE4, 0xFF, 0x12, 0xC9, 0xAB, +0x12, 0xC5, 0xDA, 0x90, 0x00, 0x81, 0xE0, 0x44, +0x04, 0xF0, 0x12, 0xD9, 0x9E, 0x12, 0xCE, 0x58, +0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, 0xF0, 0xA3, +0xE0, 0x44, 0x80, 0xF0, 0x90, 0x06, 0x0A, 0xE0, +0x44, 0x10, 0xF0, 0x90, 0x07, 0xDB, 0xE0, 0x44, +0x80, 0xF0, 0x90, 0x06, 0x0D, 0x74, 0xFF, 0xF0, +0xE4, 0xFF, 0x02, 0x84, 0x9E, 0x12, 0x02, 0x06, +0xFF, 0x90, 0x93, 0x3A, 0xF0, 0xBF, 0x01, 0x07, +0xF1, 0xF0, 0xE4, 0x90, 0x93, 0x3A, 0xF0, 0x22, +0x7B, 0x01, 0x7A, 0x95, 0x79, 0x4E, 0x7F, 0xEF, +0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x06, +0x90, 0x95, 0x4E, 0xE0, 0xA3, 0xF0, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x4E, 0x7F, 0xEE, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, +0x4E, 0xE0, 0x90, 0x95, 0x50, 0xF0, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x4E, 0x7F, 0xED, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, +0x4E, 0xE0, 0x90, 0x95, 0x51, 0xF0, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x4E, 0x7F, 0xEC, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, +0x4E, 0xE0, 0x90, 0x95, 0x52, 0xF0, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x4E, 0x7F, 0xEB, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, +0x4E, 0xE0, 0x90, 0x95, 0x53, 0xF0, 0x90, 0x95, +0x4F, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, +0xFB, 0xA3, 0xE0, 0x90, 0x95, 0x57, 0xF0, 0x90, +0x95, 0x53, 0xE0, 0x90, 0x95, 0x58, 0xF0, 0x90, +0x95, 0x59, 0x74, 0x12, 0xF0, 0x90, 0x95, 0x7B, +0x74, 0x05, 0xF0, 0x90, 0x95, 0x5B, 0x11, 0xAE, +0x90, 0x95, 0x57, 0xE0, 0x90, 0x95, 0x5E, 0xF0, +0x90, 0x95, 0x58, 0xE0, 0x90, 0x95, 0x5F, 0xF0, +0x7B, 0x01, 0x7A, 0x95, 0x79, 0x59, 0x12, 0x8E, +0x48, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xEF, 0xF0, +0xA3, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x12, +0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0xF2, +0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x02, +0x06, 0x90, 0x95, 0x71, 0xF0, 0x12, 0x8F, 0x98, +0x90, 0x95, 0x72, 0xF0, 0x60, 0x0E, 0x31, 0x16, +0x31, 0x1E, 0x90, 0x95, 0x72, 0x31, 0x16, 0x7B, +0x57, 0x12, 0xA4, 0xC7, 0x90, 0x95, 0x4E, 0x74, +0x20, 0xF0, 0x90, 0x95, 0x70, 0x74, 0x03, 0xF0, +0x90, 0x05, 0x22, 0xE0, 0x90, 0x95, 0x50, 0xF0, +0x90, 0x93, 0xF3, 0xE0, 0x90, 0x95, 0x51, 0xF0, +0x90, 0x93, 0xF4, 0xE0, 0x90, 0x95, 0x52, 0xF0, +0x7B, 0x01, 0x7A, 0x95, 0x79, 0x4E, 0x12, 0x8E, +0x48, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xE0, 0xFF, +0x90, 0x95, 0x71, 0xE0, 0xFD, 0x22, 0xEF, 0xB4, +0xFF, 0x06, 0x90, 0x93, 0xF3, 0xED, 0xF0, 0x22, +0xEF, 0xF4, 0xFE, 0x90, 0x93, 0xF3, 0xE0, 0x5E, +0xFE, 0xED, 0x5F, 0x4E, 0xF0, 0x22, 0xEF, 0xB4, +0xFF, 0x06, 0x90, 0x93, 0xF4, 0xED, 0xF0, 0x22, +0xEF, 0xF4, 0xFE, 0x90, 0x93, 0xF4, 0x80, 0xE6, +0x90, 0x97, 0x41, 0xED, 0xF0, 0x64, 0x01, 0x60, +0x26, 0xE0, 0xFE, 0x64, 0x02, 0x60, 0x20, 0xEE, +0x64, 0x29, 0x60, 0x1B, 0xEE, 0x64, 0x2A, 0x60, +0x16, 0xEE, 0x64, 0x36, 0x60, 0x11, 0xEE, 0xB4, +0x37, 0x02, 0x80, 0x0B, 0xAD, 0x07, 0x7F, 0xFF, +0x31, 0x36, 0x90, 0x93, 0xF4, 0xE0, 0xFF, 0x90, +0x93, 0xF3, 0xE0, 0x4F, 0x90, 0x05, 0x22, 0xF0, +0x90, 0x97, 0x41, 0xE0, 0x90, 0x93, 0x01, 0xF0, +0x22, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, +0x60, 0x39, 0xA3, 0xE0, 0x20, 0xE0, 0x34, 0x90, +0x8A, 0xB9, 0x12, 0x8E, 0x5A, 0xE4, 0xFD, 0x7F, +0x04, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9B, 0xE0, +0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x1D, 0xEF, 0x13, +0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x14, 0x90, +0x88, 0x9B, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, +0xE0, 0x04, 0x7F, 0x0D, 0x80, 0x02, 0x7F, 0x09, +0x12, 0x71, 0x9A, 0x22, 0x90, 0x93, 0x3F, 0xE0, +0x20, 0xE0, 0x02, 0x41, 0x92, 0xE4, 0x90, 0x95, +0x4E, 0xF0, 0x12, 0xE0, 0x55, 0x40, 0x02, 0x41, +0x92, 0x51, 0x9F, 0x80, 0x05, 0xC3, 0x33, 0xCE, +0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x40, +0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x41, 0x8A, +0x12, 0x02, 0x06, 0xFF, 0x30, 0xE0, 0x1A, 0x90, +0x93, 0x41, 0xE0, 0xFE, 0x90, 0x95, 0x4E, 0xE0, +0xFD, 0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, 0x02, +0xC3, 0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x41, +0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x16, 0x90, +0x93, 0x42, 0xE0, 0xFF, 0x90, 0x95, 0x4E, 0x51, +0x98, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, +0x4F, 0x90, 0x93, 0x42, 0xF0, 0x12, 0x8F, 0x98, +0xFF, 0x90, 0x95, 0x4E, 0xE0, 0xFE, 0x24, 0x43, +0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, +0xF0, 0x12, 0x87, 0xF1, 0xFF, 0x74, 0x48, 0x2E, +0xF5, 0x82, 0xE4, 0x34, 0x93, 0x12, 0x87, 0x9B, +0xFF, 0x74, 0x4D, 0x2E, 0xF5, 0x82, 0xE4, 0x34, +0x93, 0xF5, 0x83, 0xEF, 0x12, 0x87, 0x6D, 0xFF, +0x74, 0x52, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x40, 0xE0, +0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, 0x02, +0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x40, +0xF0, 0x22, 0x90, 0x95, 0x4E, 0xE0, 0x04, 0xF0, +0x21, 0xDA, 0x22, 0xE0, 0xFF, 0x90, 0x96, 0xF8, +0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x22, 0x74, +0x01, 0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0xE4, +0x90, 0x95, 0xA9, 0xF0, 0x12, 0xE2, 0x99, 0xF1, +0xCC, 0xE4, 0xFF, 0x91, 0xF5, 0x90, 0x93, 0x3F, +0xE0, 0x20, 0xE0, 0x02, 0x61, 0xA7, 0x90, 0x00, +0x02, 0xE0, 0x44, 0x02, 0xF0, 0xE4, 0x90, 0x95, +0xAA, 0xF0, 0x90, 0x95, 0xAA, 0xE0, 0xFF, 0xC3, +0x94, 0x05, 0x50, 0x35, 0x51, 0x9F, 0x80, 0x05, +0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, +0x90, 0x93, 0x42, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, +0x18, 0x90, 0x95, 0xAA, 0xB1, 0x9D, 0x90, 0x01, +0xB1, 0xF0, 0x90, 0x95, 0xAA, 0xB1, 0x81, 0x90, +0x01, 0xB3, 0xF0, 0xE0, 0x44, 0x40, 0xF0, 0xB1, +0x4B, 0x90, 0x95, 0xAA, 0xE0, 0x04, 0xF0, 0x80, +0xC1, 0x90, 0x07, 0xC7, 0xE4, 0xF0, 0x90, 0x07, +0xC6, 0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, +0x90, 0x07, 0xC4, 0xE4, 0xF0, 0x90, 0x07, 0xC0, +0x74, 0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, +0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x02, +0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x95, +0xAB, 0xF0, 0x90, 0x95, 0xAB, 0xE0, 0x30, 0xE0, +0x18, 0x90, 0x95, 0xA9, 0xE0, 0x04, 0xF1, 0xC4, +0x90, 0x02, 0x26, 0xE0, 0x90, 0x95, 0xAB, 0xF0, +0x90, 0x95, 0xA9, 0xE0, 0xD3, 0x94, 0xFA, 0x40, +0xE1, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, 0x90, +0x04, 0x24, 0xE0, 0x90, 0x95, 0xAC, 0xF0, 0x90, +0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x02, +0x00, 0xE0, 0x90, 0x95, 0xAB, 0xF0, 0x90, 0x02, +0x01, 0x71, 0xB7, 0x90, 0x02, 0x02, 0x71, 0xB7, +0x90, 0x02, 0x14, 0x71, 0xB7, 0xE0, 0x04, 0xF0, +0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, +0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x95, 0xAC, 0xE0, +0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, +0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0xB1, +0x52, 0xF0, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, +0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, +0xFF, 0x90, 0x95, 0xAB, 0xE0, 0x2F, 0xF0, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, +0xD0, 0x51, 0xA7, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0x75, 0x66, 0x14, 0x90, 0x88, 0x32, 0xE0, 0x44, +0x10, 0xF0, 0xB1, 0x52, 0xF0, 0x7D, 0x01, 0x12, +0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0x90, 0x00, +0x93, 0xF0, 0x90, 0x88, 0x37, 0xE0, 0x60, 0x12, +0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x05, 0x74, +0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, +0x90, 0xF0, 0x90, 0x93, 0x3F, 0xE0, 0x30, 0xE0, +0x68, 0x90, 0xFD, 0x09, 0xE4, 0xF0, 0x90, 0xFD, +0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, 0x54, 0xFC, +0xF0, 0xE4, 0x90, 0x95, 0xA9, 0xF0, 0x90, 0x95, +0xA9, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x35, +0x51, 0x9F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, +0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x41, 0xE0, +0xFD, 0xEF, 0x5D, 0x60, 0x18, 0x90, 0x95, 0xA9, +0xB1, 0x9D, 0x90, 0x01, 0xB1, 0xF0, 0x90, 0x95, +0xA9, 0xB1, 0x81, 0x90, 0x01, 0xB3, 0xF0, 0xE0, +0x44, 0x20, 0xF0, 0xB1, 0x4B, 0x90, 0x95, 0xA9, +0xE0, 0x04, 0xF0, 0x80, 0xC1, 0x90, 0x00, 0x92, +0xE0, 0x54, 0xFE, 0xF0, 0xE0, 0x44, 0x08, 0xF0, +0x90, 0x00, 0x02, 0xE0, 0x54, 0xFD, 0xF0, 0x80, +0x07, 0x90, 0x00, 0x92, 0xE0, 0x44, 0x01, 0xF0, +0x90, 0x00, 0x08, 0xE0, 0x44, 0x10, 0xF0, 0x7F, +0x01, 0x91, 0xF5, 0x90, 0x00, 0x90, 0xE0, 0x44, +0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, +0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, 0x97, 0x36, +0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, +0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, +0x7F, 0x01, 0x90, 0x97, 0x36, 0xE0, 0x6F, 0x60, +0x32, 0xC3, 0x90, 0x97, 0x38, 0xE0, 0x94, 0x88, +0x90, 0x97, 0x37, 0xE0, 0x94, 0x13, 0x40, 0x08, +0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, +0x90, 0x97, 0x37, 0xB1, 0x44, 0xD3, 0x90, 0x97, +0x38, 0xE0, 0x94, 0x32, 0x90, 0x97, 0x37, 0xE0, +0x94, 0x00, 0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, +0x30, 0xE0, 0xBC, 0x22, 0xE4, 0x75, 0xF0, 0x01, +0x12, 0x02, 0xE7, 0x7F, 0x14, 0x7E, 0x00, 0x02, +0x7C, 0x6A, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x13, +0x13, 0x54, 0x01, 0xFF, 0x90, 0x88, 0xE0, 0xE0, +0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, 0x90, +0x22, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x60, 0x03, +0xB4, 0x08, 0x0D, 0xD1, 0x29, 0xBF, 0x01, 0x08, +0x71, 0xC0, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, +0x22, 0xE0, 0xFF, 0x24, 0x43, 0xF5, 0x82, 0xE4, +0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, 0x01, 0xB2, +0xF0, 0x74, 0x48, 0x2F, 0xF5, 0x82, 0xE4, 0x34, +0x93, 0xF5, 0x83, 0xE0, 0x22, 0xE0, 0xFF, 0x24, +0x4D, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, +0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x52, 0x2F, +0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, +0x22, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x19, +0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, 0xE0, 0x0F, +0xC3, 0x13, 0x30, 0xE0, 0x08, 0x12, 0xE6, 0x6A, +0xBF, 0x01, 0x06, 0x80, 0x02, 0x80, 0x00, 0xB1, +0x69, 0x22, 0xE4, 0x90, 0x95, 0x4E, 0xF0, 0xA3, +0xF0, 0x12, 0xE2, 0x17, 0xEF, 0x64, 0x01, 0x60, +0x39, 0xC3, 0x90, 0x95, 0x4F, 0xE0, 0x94, 0x88, +0x90, 0x95, 0x4E, 0xE0, 0x94, 0x13, 0x40, 0x0F, +0x90, 0x01, 0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, +0x01, 0xC7, 0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, +0x95, 0x4E, 0xB1, 0x44, 0xD3, 0x90, 0x95, 0x4F, +0xE0, 0x94, 0x32, 0x90, 0x95, 0x4E, 0xE0, 0x94, +0x00, 0x40, 0xC6, 0x90, 0x01, 0xC6, 0xE0, 0x30, +0xE3, 0xBF, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, +0x22, 0x90, 0x93, 0x3B, 0xE0, 0xC3, 0x13, 0x20, +0xE0, 0x35, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, +0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, +0x60, 0x05, 0x75, 0x66, 0x01, 0x80, 0x2E, 0x90, +0x02, 0x96, 0xE0, 0x60, 0x05, 0x75, 0x66, 0x10, +0x80, 0x23, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, +0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, +0xE3, 0x05, 0x75, 0x66, 0x04, 0x80, 0x0E, 0x90, +0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x66, +0x20, 0x80, 0x02, 0xE1, 0xBC, 0x90, 0x01, 0xB9, +0x74, 0x08, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x66, +0xF0, 0x7F, 0x00, 0x22, 0xE4, 0x90, 0x95, 0xE8, +0xF0, 0x12, 0xE6, 0x56, 0xF1, 0x40, 0xF1, 0x8F, +0xF1, 0x5B, 0x90, 0x07, 0xE3, 0xE0, 0x90, 0x95, +0xE7, 0xF0, 0xE0, 0x60, 0x59, 0xE4, 0x90, 0x95, +0xE9, 0xF0, 0x90, 0x96, 0x0B, 0x74, 0x08, 0xF0, +0x90, 0x05, 0x68, 0xE0, 0x90, 0x95, 0xEB, 0xF0, +0x90, 0x05, 0x69, 0xE0, 0x90, 0x95, 0xEC, 0xF0, +0x90, 0x05, 0x6A, 0xE0, 0x90, 0x95, 0xED, 0xF0, +0x90, 0x05, 0x6B, 0xE0, 0x90, 0x95, 0xEE, 0xF0, +0x90, 0x05, 0x78, 0xE0, 0x90, 0x95, 0xEF, 0xF0, +0x90, 0x05, 0x79, 0xE0, 0x90, 0x95, 0xF0, 0xF0, +0x90, 0x05, 0x7A, 0xE0, 0x90, 0x95, 0xF1, 0xF0, +0x90, 0x05, 0x7B, 0xE0, 0x90, 0x95, 0xF2, 0xF0, +0x7B, 0x01, 0x7A, 0x95, 0x79, 0xE9, 0x12, 0x8E, +0x48, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x95, +0xE7, 0xE0, 0xFD, 0x60, 0x42, 0xA3, 0xE0, 0xFF, +0x51, 0x9F, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, +0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, 0x60, 0xE6, +0x90, 0x95, 0xE8, 0xE0, 0xFB, 0x74, 0x01, 0xA8, +0x03, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, +0xFE, 0xF4, 0xFD, 0x90, 0x95, 0xE7, 0xE0, 0x5D, +0xF0, 0x90, 0x07, 0xE3, 0xE0, 0x4E, 0xF0, 0xAF, +0x03, 0x12, 0xD2, 0x82, 0x12, 0xD1, 0x3F, 0x90, +0x95, 0xE8, 0xE0, 0x04, 0xF0, 0x80, 0xB7, 0x22, +0xE4, 0xFF, 0x74, 0x80, 0xF1, 0x84, 0x74, 0x2D, +0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF1, 0x54, +0xB4, 0x08, 0xEF, 0x22, 0xF5, 0x83, 0xEE, 0xF0, +0x0F, 0xEF, 0x22, 0xE4, 0xFF, 0x74, 0x94, 0xF1, +0x84, 0x74, 0x13, 0x2F, 0xF5, 0x82, 0xE4, 0x34, +0x93, 0xF1, 0x54, 0xB4, 0x08, 0xEF, 0xE4, 0xFF, +0x74, 0x9C, 0xF1, 0x84, 0x74, 0x1C, 0x2F, 0xF5, +0x82, 0xE4, 0x34, 0x93, 0xF1, 0x54, 0xB4, 0x04, +0xEF, 0x22, 0x74, 0x90, 0x2F, 0xF5, 0x82, 0xE4, +0x34, 0x24, 0xF5, 0x83, 0xE0, 0xFE, 0x22, 0xE4, +0xFF, 0x74, 0x88, 0xF1, 0x84, 0x74, 0x06, 0x2F, +0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF1, 0x54, 0xB4, +0x08, 0xEF, 0x90, 0x05, 0xDC, 0xE0, 0x90, 0x93, +0x0E, 0xF0, 0xE4, 0xFF, 0xF1, 0x82, 0x74, 0x0F, +0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF1, 0x54, +0xB4, 0x04, 0xF1, 0x22, 0x90, 0x01, 0xB8, 0xE4, +0xF0, 0x7F, 0x01, 0x22, 0xF0, 0x7F, 0x0A, 0x7E, +0x00, 0x02, 0x7C, 0x6A, 0x90, 0x00, 0x08, 0xE0, +0x54, 0xEF, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x54, +0x01, 0xFF, 0x90, 0x93, 0x3F, 0xE0, 0x54, 0xFE, +0x4F, 0xF0, 0x30, 0xE0, 0x02, 0xF1, 0xE9, 0x22, +0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, +0x22, 0x90, 0x95, 0x56, 0x74, 0x27, 0xF0, 0x90, +0x95, 0x78, 0x74, 0x06, 0xF0, 0x90, 0x95, 0x58, +0x74, 0x08, 0x12, 0xC7, 0xE8, 0x90, 0x95, 0x4A, +0xE0, 0x90, 0x95, 0x5C, 0xF0, 0x90, 0x95, 0x4B, +0xE0, 0x90, 0x95, 0x5D, 0xF0, 0x7B, 0x01, 0x7A, +0x95, 0x79, 0x56, 0x31, 0x9E, 0x02, 0x04, 0x7E, +0x12, 0x02, 0x06, 0xFF, 0x12, 0x8F, 0x98, 0x90, +0x95, 0x50, 0xF0, 0x12, 0x87, 0xF1, 0x90, 0x95, +0x51, 0x12, 0x87, 0x9E, 0x90, 0x95, 0x52, 0x12, +0x87, 0x6D, 0x90, 0x95, 0x53, 0x12, 0x87, 0x66, +0x90, 0x95, 0x54, 0x12, 0x87, 0xF7, 0x90, 0x95, +0x55, 0xF0, 0xEF, 0x12, 0x86, 0x4B, 0xC8, 0x70, +0x00, 0xC8, 0x7C, 0x01, 0xC8, 0x83, 0x02, 0xC8, +0x8A, 0x03, 0xC8, 0x91, 0x04, 0xC8, 0x98, 0x05, +0xC8, 0xA1, 0x06, 0xC8, 0xCA, 0x07, 0xC9, 0x25, +0x08, 0xC9, 0x28, 0x09, 0x00, 0x00, 0xC9, 0x67, +0x90, 0x95, 0x4E, 0x74, 0x02, 0xF0, 0xA3, 0x74, +0x29, 0xF0, 0x21, 0x6C, 0x31, 0x96, 0x74, 0x2A, +0xF0, 0x21, 0x6C, 0x31, 0x87, 0x74, 0x31, 0xF0, +0x21, 0x6C, 0x31, 0x87, 0x74, 0x32, 0xF0, 0x21, +0x6C, 0x31, 0x96, 0x74, 0x33, 0xF0, 0x21, 0x6C, +0x31, 0x8F, 0x90, 0x8A, 0x83, 0x31, 0xA1, 0x21, +0x83, 0x90, 0x95, 0x50, 0xE0, 0x90, 0x88, 0xE1, +0xF0, 0x90, 0x95, 0x51, 0xE0, 0x90, 0x88, 0xE2, +0xF0, 0x90, 0x95, 0x52, 0xE0, 0x90, 0x88, 0xE3, +0xF0, 0x90, 0x95, 0x53, 0xE0, 0x90, 0x88, 0xE4, +0xF0, 0x90, 0x95, 0x54, 0xE0, 0x90, 0x88, 0xE5, +0xF0, 0x22, 0x90, 0x95, 0x50, 0xE0, 0x90, 0x95, +0x43, 0xF0, 0x90, 0x95, 0x53, 0x12, 0x8F, 0xEA, +0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, 0x04, 0xC0, +0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0x12, 0x8F, +0xEA, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, -0x20, 0x11, 0xFA, 0x90, 0x95, 0x5A, 0x12, 0x9C, -0x76, 0x12, 0x86, 0x20, 0x90, 0x95, 0x38, 0x02, -0x04, 0x31, 0x11, 0xE5, 0x74, 0xFF, 0xF0, 0x90, -0x95, 0x58, 0xE0, 0xFF, 0x90, 0x95, 0x57, 0xE0, -0xFD, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x59, 0x90, -0x8A, 0xCF, 0xE0, 0xF8, 0xA3, 0xE0, 0xF5, 0x82, -0x88, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x95, 0x57, -0x74, 0x01, 0xF0, 0xA3, 0x22, 0x90, 0x95, 0x57, -0x74, 0x06, 0xF0, 0xA3, 0x22, 0x78, 0x08, 0x12, -0x03, 0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, -0xAB, 0x07, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0xAD, 0x07, 0xEF, 0x54, 0xFC, 0xFF, -0xED, 0x54, 0x03, 0x60, 0x08, 0x74, 0xFF, 0xFF, -0xFE, 0xFD, 0xFC, 0x80, 0x6E, 0x71, 0x41, 0x90, -0x07, 0xC0, 0x74, 0x80, 0xF0, 0x90, 0x07, 0xC3, -0xE0, 0x30, 0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, -0x51, 0xBE, 0xFE, 0x74, 0xFB, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x96, 0x31, 0x90, 0xB4, 0x04, 0xEE, -0x90, 0x96, 0xFC, 0x12, 0x9C, 0x76, 0x11, 0xF5, -0x90, 0x96, 0xFB, 0x12, 0x9C, 0x76, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0x90, 0x96, 0xFD, 0x12, 0x9C, 0x76, 0x78, -0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -0x12, 0x9C, 0x76, 0x78, 0x18, 0x12, 0x03, 0xFE, +0x07, 0x90, 0x95, 0x52, 0x12, 0x8F, 0xEA, 0x78, +0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, +0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0xB1, +0xF7, 0x12, 0x8F, 0xE7, 0x12, 0x86, 0x20, 0x90, +0x95, 0x39, 0x02, 0x04, 0x31, 0x02, 0xC7, 0xF1, +0x90, 0x95, 0x45, 0xE0, 0x44, 0x01, 0xFF, 0xF0, +0x90, 0x95, 0x50, 0xE0, 0x54, 0x7F, 0x25, 0xE0, +0xFE, 0xEF, 0x54, 0x01, 0x4E, 0x90, 0x95, 0x45, +0xF0, 0xE0, 0xFF, 0xC3, 0x13, 0x54, 0x7F, 0xC3, +0x94, 0x1E, 0x50, 0x06, 0xEF, 0x54, 0x01, 0x44, +0x3C, 0xF0, 0x90, 0x95, 0x45, 0xE0, 0xFF, 0xC3, +0x13, 0x54, 0x7F, 0xD3, 0x94, 0x50, 0x40, 0x26, +0xEF, 0x54, 0x01, 0x44, 0xA0, 0xF0, 0x22, 0x31, +0x87, 0x74, 0xFF, 0xF0, 0x90, 0x95, 0x4F, 0xE0, +0xFF, 0x90, 0x95, 0x4E, 0xE0, 0xFD, 0x31, 0x8F, +0x90, 0x8A, 0xCF, 0xE0, 0xF8, 0xA3, 0xE0, 0xF5, +0x82, 0x88, 0x83, 0x12, 0x04, 0x7E, 0x22, 0x90, +0x95, 0x4E, 0x74, 0x01, 0xF0, 0xA3, 0x22, 0x7B, +0x01, 0x7A, 0x95, 0x79, 0x50, 0x22, 0x90, 0x95, +0x4E, 0x74, 0x06, 0xF0, 0xA3, 0x22, 0x90, 0x8A, +0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, +0x8E, 0x83, 0x22, 0x90, 0x95, 0x4E, 0xEF, 0xF0, +0x71, 0xF9, 0x7F, 0xF4, 0x7E, 0x01, 0x12, 0x5F, +0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x95, 0xE0, +0x90, 0x95, 0x97, 0xF0, 0x71, 0xF9, 0x7F, 0xF5, +0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, +0x90, 0x95, 0x95, 0xE0, 0x90, 0x95, 0x98, 0xF0, +0x71, 0xF9, 0x7F, 0xF6, 0x7E, 0x01, 0x12, 0x5F, +0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x95, 0xE0, +0x90, 0x95, 0x99, 0xF0, 0x71, 0xF9, 0x7F, 0xF7, +0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, +0x90, 0x95, 0x95, 0xE0, 0x90, 0x95, 0x9A, 0xF0, +0x71, 0xF9, 0x7F, 0xF8, 0x7E, 0x01, 0x12, 0x5F, +0xA6, 0xBF, 0x01, 0x08, 0x90, 0x95, 0x95, 0xE0, +0x90, 0x95, 0x9B, 0xF0, 0x71, 0xF9, 0xD1, 0xEE, +0xBF, 0x01, 0x08, 0x90, 0x95, 0x95, 0xE0, 0x90, +0x95, 0x9C, 0xF0, 0x71, 0xF9, 0x7F, 0xFB, 0x91, +0x00, 0x70, 0x52, 0x90, 0x95, 0x95, 0xE0, 0x90, +0x95, 0x9D, 0xF0, 0x54, 0x07, 0x60, 0x08, 0x90, +0x95, 0x95, 0xE0, 0x54, 0xE0, 0x70, 0x3E, 0x7B, +0x01, 0x7A, 0x95, 0x79, 0x96, 0x7F, 0xFA, 0x91, +0x00, 0x70, 0x32, 0x90, 0x95, 0x95, 0xE0, 0xFC, +0x54, 0x07, 0x70, 0x12, 0x90, 0x95, 0x9D, 0xE0, +0xFE, 0x90, 0x95, 0x96, 0xE0, 0x54, 0x07, 0xFD, +0xEE, 0x4D, 0x90, 0x95, 0x9D, 0xF0, 0xEC, 0x54, +0xE0, 0x70, 0x12, 0x90, 0x95, 0x9D, 0xE0, 0xFF, +0x90, 0x95, 0x96, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, +0x4E, 0x90, 0x95, 0x9D, 0xF0, 0x71, 0xF9, 0x7F, +0xFD, 0x91, 0x00, 0x70, 0x46, 0x90, 0x95, 0x95, +0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x95, 0x9E, 0xF0, +0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, 0x95, +0x95, 0xE0, 0x54, 0xC0, 0x70, 0x2D, 0xEF, 0x70, +0x11, 0x90, 0x95, 0x9E, 0xE0, 0xFF, 0x90, 0x95, +0x95, 0xE0, 0x54, 0x03, 0xD1, 0xF7, 0x90, 0x95, +0x9E, 0xF0, 0x90, 0x95, 0x95, 0xE0, 0xFF, 0x54, +0xC0, 0x70, 0x10, 0x90, 0x95, 0x9E, 0xE0, 0xFE, +0xEF, 0x54, 0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, +0xEE, 0x4F, 0xF0, 0x71, 0xF9, 0x7F, 0xF0, 0x7E, +0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, +0x95, 0x95, 0xE0, 0x90, 0x95, 0x9F, 0xF0, 0x71, +0xF9, 0x7F, 0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, +0xBF, 0x01, 0x08, 0x90, 0x95, 0x95, 0xE0, 0x90, +0x95, 0xA0, 0xF0, 0x71, 0xF9, 0x7F, 0xF2, 0x7E, +0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, +0x95, 0x95, 0xE0, 0x90, 0x95, 0xA1, 0xF0, 0x71, +0xF9, 0x7F, 0xF3, 0x7E, 0x01, 0x12, 0x5F, 0xA6, +0xBF, 0x01, 0x08, 0x90, 0x95, 0x95, 0xE0, 0x90, +0x95, 0xA2, 0xF0, 0x71, 0xF9, 0x7F, 0xFC, 0x7E, +0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, +0x95, 0x95, 0xE0, 0x90, 0x95, 0xA3, 0xF0, 0x90, +0x95, 0x4F, 0x74, 0x19, 0xF0, 0x90, 0x95, 0x71, +0x74, 0x08, 0xF0, 0x90, 0x95, 0x97, 0xE0, 0x90, +0x95, 0x51, 0xF0, 0x90, 0x95, 0x98, 0xE0, 0x90, +0x95, 0x52, 0xF0, 0x90, 0x95, 0x99, 0xE0, 0x90, +0x95, 0x53, 0xF0, 0x90, 0x95, 0x9A, 0xE0, 0x90, +0x95, 0x54, 0xF0, 0x90, 0x95, 0x9B, 0xE0, 0x90, +0x95, 0x55, 0xF0, 0x90, 0x95, 0x9C, 0xE0, 0x90, +0x95, 0x56, 0xF0, 0x90, 0x95, 0x9D, 0xE0, 0x90, +0x95, 0x57, 0xF0, 0x90, 0x95, 0x9E, 0xE0, 0x90, +0x95, 0x58, 0xF0, 0x90, 0x95, 0x72, 0x74, 0x1A, +0xF0, 0x90, 0x95, 0x94, 0x74, 0x05, 0xF0, 0x90, +0x95, 0x9F, 0xE0, 0x90, 0x95, 0x74, 0xF0, 0x90, +0x95, 0xA0, 0xE0, 0x90, 0x95, 0x75, 0xF0, 0x90, +0x95, 0xA1, 0xE0, 0x90, 0x95, 0x76, 0xF0, 0x90, +0x95, 0xA2, 0xE0, 0x90, 0x95, 0x77, 0xF0, 0x90, +0x95, 0xA3, 0xE0, 0x90, 0x95, 0x78, 0xF0, 0x90, +0x95, 0x4E, 0xE0, 0xB4, 0x01, 0x19, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x4F, 0x31, 0x9E, 0x12, 0x04, +0x7E, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x72, 0x12, +0x8E, 0x48, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, +0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x4F, +0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, +0xA0, 0x12, 0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, +0x46, 0x95, 0x75, 0x47, 0x74, 0x75, 0x48, 0x05, +0x7B, 0x01, 0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, +0xF5, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x95, 0x22, +0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x64, 0x01, +0x22, 0x12, 0x02, 0x06, 0x64, 0x01, 0x60, 0x02, +0x81, 0x9D, 0x90, 0x95, 0x95, 0xF0, 0x90, 0x95, +0x95, 0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x50, 0x27, +0xEF, 0xD1, 0xFF, 0x7A, 0x95, 0x79, 0x94, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x12, 0x90, 0x95, 0x94, +0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0x96, 0xF5, 0x82, +0xE4, 0x34, 0x95, 0xF5, 0x83, 0xEF, 0xF0, 0x90, +0x95, 0x95, 0xE0, 0x04, 0xF0, 0x80, 0xCF, 0x75, +0x45, 0x01, 0x75, 0x46, 0x95, 0x75, 0x47, 0x96, +0x75, 0x48, 0x08, 0x31, 0x8F, 0x12, 0x69, 0xF5, +0x90, 0x95, 0x4E, 0x74, 0x24, 0xF0, 0x90, 0x95, +0x70, 0x74, 0x08, 0xF0, 0x75, 0x45, 0x01, 0x75, +0x46, 0x95, 0x75, 0x47, 0x9E, 0xF5, 0x48, 0x7B, +0x01, 0x7A, 0x95, 0x79, 0x73, 0x12, 0x69, 0xF5, +0x90, 0x95, 0x71, 0x74, 0x25, 0xF0, 0x90, 0x95, +0x93, 0x74, 0x08, 0xF0, 0x7B, 0x01, 0x7A, 0x95, +0x79, 0x4E, 0x31, 0x9E, 0x12, 0x04, 0x7E, 0x7B, +0x01, 0x7A, 0x95, 0x79, 0x71, 0x12, 0x8E, 0x48, +0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x96, +0x1B, 0xF0, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x96, +0x1F, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x96, +0x1E, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x96, +0x1D, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x96, +0x1C, 0xB1, 0xEA, 0x90, 0x96, 0x1C, 0x12, 0x8F, +0xEA, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, +0xC0, 0x06, 0xC0, 0x07, 0x90, 0x96, 0x1E, 0x12, +0x8F, 0xEA, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, +0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, +0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, +0xC0, 0x07, 0xA3, 0x12, 0x8F, 0xEA, 0x78, 0x18, +0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, 0x96, +0x24, 0x12, 0x04, 0x31, 0x90, 0x96, 0x24, 0x12, +0x86, 0x2D, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, +0xC0, 0x03, 0x90, 0x95, 0x4D, 0xE0, 0x24, 0x01, +0xFF, 0xE4, 0x33, 0xFE, 0xE4, 0xFC, 0xFD, 0xFB, +0x7A, 0x90, 0x79, 0x01, 0xF8, 0x12, 0x85, 0xC4, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x86, 0x20, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0x22, 0xE4, -0xFF, 0x74, 0x94, 0x31, 0xC0, 0x74, 0x13, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0x93, 0x31, 0x90, 0xB4, -0x08, 0xEF, 0xE4, 0xFF, 0x74, 0x9C, 0x31, 0xC0, -0x74, 0x1C, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, -0x31, 0x90, 0xB4, 0x04, 0xEF, 0x22, 0x74, 0x90, -0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x24, 0xF5, 0x83, -0xE0, 0xFE, 0x22, 0xE4, 0xFF, 0x74, 0x88, 0x31, -0xC0, 0x74, 0x06, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0x31, 0x90, 0xB4, 0x08, 0xEF, 0x90, 0x05, -0xDC, 0xE0, 0x90, 0x93, 0x0E, 0xF0, 0xE4, 0xFF, -0x31, 0xBE, 0x74, 0x0F, 0x2F, 0xF5, 0x82, 0xE4, -0x34, 0x93, 0x31, 0x90, 0xB4, 0x04, 0xF1, 0x22, -0xEF, 0x70, 0x05, 0x90, 0x93, 0x05, 0x80, 0x03, -0x90, 0x93, 0x04, 0xE0, 0xFF, 0x12, 0x7B, 0x07, -0x90, 0x95, 0xEF, 0xEF, 0xF0, 0x90, 0x95, 0xEF, -0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0x51, -0xB7, 0xE4, 0xFF, 0x74, 0x08, 0x51, 0xBE, 0xFE, -0x90, 0x95, 0xF0, 0x12, 0x86, 0x39, 0x8F, 0x82, -0x75, 0x83, 0x00, 0x51, 0xB0, 0xB4, 0x06, 0xEB, -0x90, 0x95, 0xEF, 0xE0, 0x24, 0x52, 0xF9, 0xE4, -0x34, 0xFC, 0x51, 0xB7, 0x12, 0x02, 0x06, 0x70, -0x60, 0x90, 0x95, 0xF0, 0x12, 0x86, 0x39, 0x12, -0x87, 0xA6, 0x64, 0x02, 0x70, 0x53, 0x90, 0x24, -0x87, 0xE0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x5E, -0x90, 0x24, 0x86, 0xE0, 0x90, 0x00, 0x04, 0x12, -0x02, 0x5E, 0x90, 0x95, 0xF0, 0x12, 0x86, 0x39, -0x12, 0x87, 0x62, 0x64, 0x01, 0x70, 0x32, 0x12, -0x87, 0x69, 0x64, 0x0D, 0x70, 0x2B, 0xFF, 0x74, -0x88, 0x31, 0xC0, 0xEF, 0x24, 0x08, 0x51, 0xA2, -0xB4, 0x08, 0xF4, 0x90, 0x05, 0xDC, 0xE0, 0xFF, -0x90, 0x95, 0xF0, 0x12, 0x86, 0x39, 0x90, 0x00, -0x10, 0xEF, 0x12, 0x02, 0x5E, 0xE4, 0xFF, 0x31, -0xBE, 0xEF, 0x24, 0x11, 0x51, 0xA2, 0xB4, 0x04, -0xF6, 0x22, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x95, -0xF0, 0x12, 0x86, 0x39, 0x8D, 0x82, 0x8C, 0x83, -0xEE, 0x12, 0x02, 0x5E, 0x0F, 0xEF, 0x22, 0xFA, -0x7B, 0x01, 0xA3, 0x02, 0x86, 0x42, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0xE0, 0x22, -0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x1E, 0xE4, -0xFF, 0x71, 0x4A, 0xE4, 0xFF, 0x31, 0xF8, 0x7F, -0x01, 0x31, 0xF8, 0x90, 0x93, 0x03, 0xE0, 0x13, -0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, 0x04, -0x1F, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0xE4, 0xFF, -0x74, 0x80, 0x31, 0xC0, 0x74, 0x2D, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0x31, 0x90, 0xB4, 0x08, -0xEF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, 0x54, 0xFC, -0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, 0xFF, 0x7F, -0xFF, 0x80, 0x21, 0x71, 0x41, 0x90, 0x07, 0xC0, -0x74, 0x80, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, -0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, 0x24, 0xC9, -0x51, 0xBF, 0xFE, 0x74, 0xC8, 0x2D, 0x51, 0xBF, -0x12, 0xCF, 0xBB, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x90, 0x07, 0xC0, 0xEF, 0xF0, 0xEE, 0xA3, -0xF0, 0x22, 0x90, 0x95, 0xF1, 0xEF, 0xF0, 0x90, -0x95, 0xEF, 0x74, 0x18, 0xF0, 0x90, 0x96, 0x11, -0x74, 0x01, 0xF0, 0xFB, 0x7A, 0x95, 0x79, 0xEF, -0x12, 0x8E, 0xB7, 0x7F, 0x04, 0x02, 0x04, 0x7E, -0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, -0x01, 0x71, 0x4A, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, -0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, -0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, -0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0x90, 0x01, 0xC4, 0x74, 0x74, 0xF0, 0x74, -0xD3, 0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, -0x30, 0xE1, 0x03, 0x12, 0xBC, 0xDA, 0xE5, 0x2D, -0x30, 0xE1, 0x03, 0x12, 0xCF, 0x38, 0xE5, 0x2D, -0x30, 0xE4, 0x02, 0xD1, 0x4D, 0xE5, 0x2D, 0x30, -0xE5, 0x03, 0x12, 0xE6, 0xAA, 0xE5, 0x2D, 0x30, -0xE6, 0x02, 0xD1, 0x40, 0xE5, 0x2F, 0x30, 0xE0, -0x03, 0x12, 0xBE, 0x8F, 0xE5, 0x2F, 0x30, 0xE1, -0x03, 0x12, 0xC5, 0x7B, 0xE5, 0x2F, 0x30, 0xE2, -0x02, 0xF1, 0x2A, 0xE5, 0x2F, 0x30, 0xE3, 0x02, -0xF1, 0x0F, 0xE5, 0x2F, 0x30, 0xE4, 0x03, 0x12, -0xAF, 0x7A, 0xE5, 0x2F, 0x30, 0xE5, 0x03, 0x12, -0xBF, 0x0E, 0xE5, 0x2F, 0x30, 0xE6, 0x02, 0xD1, -0xF6, 0xE5, 0x30, 0x30, 0xE4, 0x02, 0x91, 0x52, -0xE5, 0x30, 0x30, 0xE5, 0x03, 0x12, 0xBF, 0xB9, -0xE5, 0x36, 0x30, 0xE0, 0x03, 0x12, 0xB5, 0x76, -0xE5, 0x36, 0x30, 0xE6, 0x02, 0x51, 0xC8, 0xE5, -0x36, 0x30, 0xE7, 0x02, 0x71, 0x68, 0xE5, 0x37, -0x30, 0xE2, 0x02, 0xB1, 0xC0, 0xE5, 0x37, 0x30, -0xE3, 0x02, 0xB1, 0xCC, 0x74, 0x74, 0x04, 0x90, -0x01, 0xC4, 0xF0, 0x74, 0xD3, 0xA3, 0xF0, 0xD0, -0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, -0xE0, 0x32, 0xE4, 0xFF, 0x90, 0x95, 0xEF, 0xEF, -0xF0, 0x90, 0x88, 0x2B, 0xE0, 0x90, 0x96, 0x01, -0xF0, 0xE4, 0x90, 0x95, 0xF0, 0xF0, 0x90, 0x96, -0x01, 0xE0, 0xFE, 0x90, 0x95, 0xF0, 0xE0, 0xFF, -0xC3, 0x9E, 0x50, 0x33, 0xE0, 0xFE, 0x24, 0xF1, -0xB1, 0x99, 0xE4, 0xF0, 0xEE, 0xD1, 0xE9, 0xE0, -0x30, 0xE7, 0x0E, 0x75, 0xF0, 0x12, 0xEF, 0x90, -0x89, 0x56, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0x80, -0x0E, 0x12, 0x7C, 0x8F, 0x90, 0x95, 0xF0, 0xE0, -0x24, 0xF1, 0xB1, 0x99, 0x74, 0x01, 0xF0, 0x90, -0x95, 0xF0, 0xE0, 0x04, 0xF0, 0x80, 0xBF, 0x7F, -0x0C, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0xE4, 0x90, -0x95, 0xF0, 0xF0, 0x90, 0x96, 0x01, 0xE0, 0xFF, -0x90, 0x95, 0xF0, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, -0x02, 0xA1, 0x98, 0x74, 0xF1, 0x2E, 0xB1, 0x99, -0xE0, 0x70, 0x02, 0xA1, 0x90, 0xEE, 0xC4, 0x54, -0xF0, 0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x81, -0xF5, 0x83, 0xE0, 0xFD, 0xEE, 0xC4, 0x54, 0xF0, -0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xB1, -0xB5, 0xFC, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x53, -0x12, 0x04, 0x6E, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -0xEC, 0xC4, 0x54, 0xF0, 0x24, 0x0A, 0xF5, 0x82, -0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0xFD, 0xEC, -0xB1, 0xAA, 0xB1, 0xB5, 0x75, 0xF0, 0x12, 0x90, -0x89, 0x57, 0x12, 0x04, 0x6E, 0xEE, 0x8F, 0xF0, -0x12, 0x02, 0xE7, 0x7F, 0x01, 0x90, 0x95, 0xF0, -0xE0, 0xFE, 0xB1, 0xAA, 0xF5, 0x83, 0xE5, 0x82, -0x2F, 0x12, 0xCF, 0x3C, 0xE0, 0xFD, 0x75, 0xF0, +0x12, 0x85, 0xA9, 0x90, 0x96, 0x24, 0x12, 0x04, +0x31, 0xB1, 0xDE, 0x90, 0x05, 0x2C, 0xEF, 0xF0, +0xB1, 0xDE, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, +0x05, 0x2D, 0xEF, 0xF0, 0xB1, 0xDE, 0x78, 0x10, +0x12, 0x03, 0xEB, 0x90, 0x05, 0x2E, 0xEF, 0xF0, +0xB1, 0xDE, 0x78, 0x18, 0x12, 0x03, 0xEB, 0x90, +0x05, 0x2F, 0xEF, 0xD1, 0x3E, 0x90, 0x96, 0x20, +0x12, 0x04, 0x31, 0xB1, 0xE4, 0xE4, 0xFF, 0xFE, +0xED, 0x54, 0x03, 0xFD, 0xE4, 0xFC, 0xFB, 0xFA, +0xF9, 0xF8, 0xC3, 0x12, 0x03, 0xDA, 0x70, 0x49, +0xB1, 0xE4, 0xE4, 0xFF, 0xEE, 0x54, 0xFC, 0xFE, +0xE4, 0xFD, 0xFC, 0x78, 0x0A, 0x12, 0x03, 0xEB, +0x90, 0x96, 0x1B, 0xEF, 0xF0, 0x90, 0x95, 0x4C, +0xE0, 0xFE, 0xEF, 0xD3, 0x9E, 0x50, 0x07, 0x90, +0x96, 0x1B, 0xE0, 0xB5, 0x06, 0x1F, 0x90, 0x96, +0x28, 0x74, 0x28, 0xF0, 0x90, 0x96, 0x4A, 0x74, +0x04, 0xF0, 0x90, 0x96, 0x1B, 0xE0, 0x90, 0x96, +0x2A, 0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x28, +0x31, 0x9E, 0x12, 0x04, 0x7E, 0xB1, 0xE4, 0xD1, +0x46, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x96, +0x24, 0x02, 0x04, 0xB8, 0x90, 0x96, 0x20, 0x02, +0x04, 0xB8, 0xF0, 0xA3, 0xE0, 0xFF, 0xE4, 0xFC, +0xFD, 0xFE, 0x78, 0x08, 0x12, 0x03, 0xFE, 0xA8, +0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, +0x12, 0x02, 0x06, 0x64, 0x01, 0x70, 0x28, 0x12, +0x8F, 0x98, 0x90, 0x95, 0x4C, 0xF0, 0x12, 0x87, +0xF1, 0x90, 0x95, 0x4D, 0xD1, 0x3E, 0xD1, 0x46, +0x90, 0x01, 0x25, 0x74, 0x08, 0xF0, 0xFD, 0x7F, +0x01, 0x12, 0x7B, 0xF7, 0x90, 0x05, 0x1F, 0xE0, +0x54, 0xFC, 0x44, 0x08, 0xF0, 0x81, 0x9E, 0x7D, +0x08, 0x7F, 0x01, 0x12, 0x7C, 0x2E, 0x90, 0x05, +0x1F, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0xF0, 0x7D, +0x42, 0xE4, 0xFF, 0x02, 0x7B, 0xBD, 0xED, 0x44, +0x03, 0xFD, 0xEC, 0x90, 0x8B, 0x9F, 0x12, 0x04, +0x31, 0x7D, 0x42, 0xE4, 0xFF, 0x02, 0x79, 0x53, +0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, +0x7A, 0x93, 0x79, 0xE7, 0x12, 0x04, 0x80, 0x7B, +0x01, 0x7A, 0x95, 0x79, 0x4E, 0xD1, 0xEE, 0xBF, +0x01, 0x1C, 0x90, 0x95, 0x4E, 0xE0, 0xFE, 0x54, +0x01, 0x90, 0x93, 0xE7, 0xF0, 0xEE, 0x54, 0x04, +0x90, 0x93, 0xE9, 0xF0, 0x90, 0x95, 0x4E, 0xE0, +0x54, 0x08, 0x90, 0x93, 0xE8, 0xF0, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x4E, 0x7F, 0xFB, 0x91, 0x00, +0x70, 0x35, 0x90, 0x95, 0x4E, 0xE0, 0x54, 0x07, +0x70, 0x15, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x4F, +0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, +0x01, 0x0F, 0x90, 0x95, 0x4F, 0x80, 0x03, 0x90, +0x95, 0x4E, 0xE0, 0x54, 0x07, 0x90, 0x93, 0xEB, +0xF0, 0x90, 0x95, 0x4E, 0xE0, 0x54, 0xE0, 0xC4, +0x13, 0x54, 0x07, 0x90, 0x93, 0xEA, 0xF0, 0x7B, +0x01, 0x7A, 0x95, 0x79, 0x4E, 0x7F, 0xFD, 0x7E, +0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, +0x95, 0x4E, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, +0x3F, 0x90, 0x93, 0xEC, 0xF0, 0x22, 0x7F, 0xF9, +0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x81, 0x9E, 0x25, +0xE0, 0x25, 0xE0, 0xFE, 0xEF, 0x4E, 0x22, 0x24, +0xA8, 0xFF, 0xE4, 0x34, 0x01, 0xFE, 0x7B, 0x01, +0x22, 0xE4, 0x90, 0x86, 0xAF, 0xF0, 0x12, 0xC7, +0xEA, 0x90, 0x93, 0x01, 0xF0, 0x90, 0x93, 0xF3, +0xF0, 0xA3, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, +0x90, 0x93, 0xE6, 0xF0, 0xBF, 0x01, 0x09, 0x7F, +0x01, 0x31, 0xAB, 0xE4, 0x90, 0x93, 0xE6, 0xF0, +0x22, 0x7E, 0x00, 0x7F, 0x01, 0x7D, 0x00, 0x7B, +0x01, 0x7A, 0x88, 0x79, 0x2C, 0x12, 0x04, 0x80, +0x90, 0x88, 0x2C, 0xE0, 0x54, 0xFD, 0x12, 0xC7, +0xE8, 0xA3, 0x74, 0x0C, 0xF0, 0x22, 0xF1, 0x8C, +0x12, 0x7B, 0xDB, 0x90, 0x8A, 0xC5, 0x12, 0x88, +0xCD, 0x12, 0xDF, 0xD2, 0xF1, 0x31, 0x12, 0xE7, +0x98, 0xF1, 0x87, 0xF1, 0x9F, 0x90, 0x8A, 0x73, +0x12, 0x88, 0xCD, 0x90, 0x00, 0x6A, 0xE0, 0x30, +0xE2, 0x14, 0x90, 0x92, 0x20, 0x74, 0x01, 0xF0, +0xA3, 0x74, 0xF4, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, +0x68, 0x7E, 0x01, 0x12, 0x66, 0x33, 0x22, 0xF1, +0x92, 0x02, 0x04, 0x80, 0xE4, 0xFD, 0xFF, 0x02, +0x6E, 0x71, 0x7E, 0x00, 0x7F, 0x04, 0x7D, 0x00, +0x7B, 0x01, 0x7A, 0x93, 0x79, 0x3B, 0x22, 0x7E, +0x00, 0x7F, 0x8E, 0x7D, 0x00, 0x7B, 0x01, 0x7A, +0x93, 0x79, 0x58, 0x02, 0x04, 0x80, 0xE4, 0xFD, +0x02, 0x8F, 0xF3, 0x90, 0x95, 0xE7, 0xEF, 0xF0, +0x90, 0x04, 0x7E, 0xE0, 0xFF, 0xA3, 0xE0, 0x90, +0x96, 0x0B, 0xF0, 0xE0, 0xFE, 0x6F, 0x60, 0x72, +0x90, 0x95, 0xE8, 0x74, 0x03, 0xF0, 0x90, 0x96, +0x0A, 0x74, 0x08, 0xF0, 0xEE, 0x04, 0x54, 0x0F, +0xFF, 0xE4, 0xFE, 0xEF, 0x75, 0xF0, 0x08, 0xA4, +0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0x80, 0xF5, +0x83, 0xE5, 0x82, 0x2E, 0x12, 0x9D, 0xD9, 0xE0, +0xFD, 0x74, 0xEA, 0x2E, 0xF5, 0x82, 0xE4, 0x34, +0x95, 0xF5, 0x83, 0xED, 0xF0, 0x0E, 0xEE, 0xB4, +0x08, 0xD9, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0xE8, +0x12, 0xC9, 0x9E, 0x12, 0x04, 0x7E, 0x90, 0x96, +0x0B, 0xE0, 0x04, 0x54, 0x0F, 0xFF, 0xF0, 0xBF, +0x0F, 0x02, 0xE4, 0xF0, 0x90, 0x96, 0x0B, 0xE0, +0x90, 0x04, 0x7F, 0xF0, 0x90, 0x95, 0xE7, 0xE0, +0x70, 0x05, 0x90, 0x8A, 0xE5, 0x80, 0x03, 0x90, +0x8A, 0x79, 0x12, 0x8E, 0x5A, 0x7F, 0x04, 0x12, +0x04, 0x7E, 0x22, 0x71, 0xE6, 0x64, 0x01, 0x60, +0x02, 0x01, 0xC6, 0xEF, 0x24, 0x39, 0x60, 0x12, +0x14, 0x60, 0x19, 0x24, 0x02, 0x70, 0x1F, 0xE4, +0x90, 0x95, 0x54, 0xF0, 0xA3, 0x74, 0x06, 0xF0, +0x80, 0x14, 0x90, 0x95, 0x54, 0x74, 0x06, 0xF0, +0xA3, 0xF0, 0x80, 0x0A, 0x90, 0x95, 0x54, 0x74, +0x0C, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x11, 0xDA, +0xF0, 0x11, 0xC7, 0x40, 0x1C, 0x90, 0x95, 0x52, +0xE0, 0x12, 0xCE, 0xFF, 0x7A, 0x95, 0x79, 0x51, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x07, 0x90, 0x95, +0x51, 0xE0, 0xF4, 0x70, 0x39, 0x11, 0xCF, 0x80, +0xE0, 0x11, 0xDA, 0xF0, 0x11, 0xC7, 0x40, 0x2E, +0x90, 0x95, 0x52, 0xE0, 0xFD, 0x7C, 0x00, 0x24, +0xA8, 0xFF, 0xEC, 0x34, 0x01, 0xFE, 0xED, 0x24, +0x01, 0xFD, 0xEC, 0x33, 0xFC, 0x90, 0x95, 0x54, +0xE0, 0xFB, 0xC3, 0xED, 0x9B, 0xFD, 0xEC, 0x94, +0x00, 0xFC, 0x90, 0x95, 0x4E, 0x11, 0xF7, 0xFD, +0x91, 0xDA, 0x11, 0xCF, 0x80, 0xCE, 0x22, 0x90, +0x95, 0x53, 0xE0, 0xD3, 0x94, 0x00, 0x22, 0x90, +0x95, 0x52, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0x14, +0xF0, 0x22, 0x90, 0x95, 0x54, 0xE0, 0x90, 0x95, +0x52, 0xF0, 0x90, 0x95, 0x55, 0xE0, 0x90, 0x95, +0x53, 0x22, 0x7E, 0x00, 0xC3, 0x74, 0x07, 0x9F, +0xFD, 0xE4, 0x9E, 0xFC, 0x90, 0x96, 0x10, 0x12, +0x86, 0x39, 0x8D, 0x82, 0x8C, 0x83, 0x02, 0x02, +0x1F, 0x71, 0x9E, 0x90, 0x96, 0x13, 0xF0, 0x90, +0x96, 0x13, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, +0x2B, 0x11, 0xEA, 0xFD, 0xC3, 0x74, 0x07, 0x51, +0x70, 0xC3, 0x9D, 0x50, 0x03, 0x7F, 0x00, 0x22, +0x90, 0x96, 0x13, 0xE0, 0xFF, 0x11, 0xEA, 0xFD, +0xC3, 0x74, 0x07, 0x51, 0x70, 0xD3, 0x9D, 0x40, +0x03, 0x7F, 0x01, 0x22, 0x90, 0x96, 0x13, 0xE0, +0x04, 0xF0, 0x80, 0xCB, 0x7F, 0x00, 0x22, 0xE4, +0x90, 0x96, 0x0C, 0xF0, 0x90, 0x93, 0x03, 0xE0, +0xFF, 0xC3, 0x13, 0x20, 0xE0, 0x70, 0x31, 0xF8, +0x31, 0x01, 0xEF, 0x60, 0x0D, 0x7B, 0x01, 0x7A, +0x93, 0x79, 0x13, 0x31, 0xFE, 0x51, 0x09, 0xEF, +0x60, 0x54, 0x31, 0xF8, 0x31, 0x01, 0xEF, 0x60, +0x17, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x13, 0x31, +0xFE, 0x51, 0x09, 0xEF, 0x60, 0x0A, 0x7B, 0x01, +0x7A, 0x93, 0x79, 0x1C, 0x71, 0x90, 0x70, 0x36, +0x7B, 0x01, 0x7A, 0x93, 0x79, 0x20, 0x90, 0x96, +0x10, 0x12, 0x86, 0x42, 0x7A, 0x93, 0x79, 0x06, +0x31, 0x01, 0xEF, 0x60, 0x10, 0x51, 0x1C, 0x31, +0xFE, 0x31, 0x01, 0xEF, 0x60, 0x07, 0x31, 0xF8, +0x71, 0xA6, 0xEF, 0x70, 0x11, 0x31, 0xF8, 0x51, +0x09, 0xEF, 0x60, 0x29, 0x7B, 0x01, 0x7A, 0x93, +0x79, 0x0F, 0x71, 0x90, 0x60, 0x1F, 0x90, 0x96, +0x0C, 0x74, 0x01, 0xF0, 0x80, 0x17, 0x51, 0x1C, +0x31, 0xFE, 0x31, 0x01, 0xEF, 0x60, 0x0E, 0x51, +0x1C, 0x31, 0xFE, 0x71, 0xA6, 0xEF, 0x70, 0x05, +0x90, 0x96, 0x0C, 0x04, 0xF0, 0x90, 0x96, 0x0C, +0xE0, 0xFF, 0x90, 0x05, 0x18, 0xE4, 0xF0, 0xA3, +0xF0, 0xEF, 0x90, 0x05, 0xB3, 0x60, 0x0C, 0xE0, +0x44, 0x80, 0xF0, 0x90, 0x24, 0xA0, 0xE0, 0x44, +0x01, 0xF0, 0x22, 0xE0, 0x44, 0x20, 0xF0, 0x22, +0x7B, 0x01, 0x7A, 0x93, 0x79, 0x06, 0x90, 0x96, +0x10, 0x12, 0x86, 0x42, 0x7A, 0x93, 0x79, 0x20, +0x22, 0x71, 0x9E, 0xFF, 0x71, 0xB9, 0x6E, 0x60, +0x03, 0x7F, 0x00, 0x22, 0x0F, 0xEF, 0xB4, 0x08, +0xF3, 0x7F, 0x01, 0x22, 0x7B, 0x01, 0x7A, 0x93, +0x79, 0x2D, 0x22, 0x71, 0x9E, 0x90, 0x96, 0x13, +0xF0, 0x90, 0x96, 0x13, 0xE0, 0xFF, 0xC3, 0x94, +0x04, 0x50, 0x1F, 0x51, 0x55, 0xC3, 0x9D, 0x50, +0x03, 0x7F, 0x00, 0x22, 0x90, 0x96, 0x13, 0xE0, +0xFF, 0x51, 0x55, 0xD3, 0x9D, 0x40, 0x03, 0x7F, +0x01, 0x22, 0x90, 0x96, 0x13, 0xE0, 0x04, 0xF0, +0x80, 0xD7, 0x7F, 0x00, 0x22, 0x7E, 0x00, 0xC3, +0x74, 0x03, 0x9F, 0xFD, 0xE4, 0x9E, 0xFC, 0x90, +0x96, 0x10, 0x12, 0x86, 0x39, 0x8D, 0x82, 0x8C, +0x83, 0x12, 0x02, 0x1F, 0xFD, 0xC3, 0x74, 0x03, +0x9F, 0xFF, 0xE4, 0x9E, 0xFE, 0x90, 0x96, 0x0D, +0x12, 0x86, 0x39, 0x8F, 0x82, 0x8E, 0x83, 0x02, +0x02, 0x1F, 0xE4, 0x90, 0x96, 0x10, 0xF0, 0xEF, +0x75, 0xF0, 0x40, 0xA4, 0x24, 0x80, 0xF9, 0x74, +0x82, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x90, 0x96, +0x0C, 0x71, 0xE9, 0x90, 0x96, 0x0F, 0xF0, 0xA3, +0x74, 0x1C, 0xF0, 0x90, 0x96, 0x0F, 0xE0, 0xFF, +0xA3, 0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0x61, +0x84, 0x90, 0x96, 0x0C, 0x12, 0x86, 0x39, 0x8E, +0x82, 0x71, 0xD0, 0x90, 0x96, 0x11, 0xF0, 0xEE, +0xFD, 0x7C, 0x00, 0xF5, 0x82, 0x8C, 0x83, 0xA3, +0xA3, 0x12, 0x02, 0x1F, 0xFE, 0x8D, 0x82, 0x8C, +0x83, 0xA3, 0x12, 0x02, 0x1F, 0xFD, 0xED, 0xFF, +0x90, 0x96, 0x12, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, +0x90, 0x96, 0x11, 0xE0, 0x64, 0x01, 0x60, 0x0E, +0xA3, 0xA3, 0xE0, 0x24, 0x03, 0xFF, 0x90, 0x96, +0x10, 0xE0, 0x2F, 0xF0, 0x80, 0xAD, 0xE4, 0x90, +0x96, 0x14, 0xF0, 0x90, 0x96, 0x14, 0xE0, 0xFF, +0xC3, 0x94, 0x08, 0x50, 0x1A, 0x90, 0x96, 0x10, +0xE0, 0x24, 0x03, 0x71, 0xD6, 0x51, 0x78, 0xFF, +0x90, 0x96, 0x14, 0xE0, 0x24, 0x20, 0xF5, 0x82, +0xE4, 0x34, 0x93, 0x71, 0x85, 0x80, 0xDC, 0x90, +0x96, 0x10, 0xE0, 0x24, 0x0B, 0xFF, 0xE4, 0x33, +0xFE, 0x90, 0x96, 0x0C, 0x51, 0x78, 0x90, 0x93, +0x28, 0xF0, 0x70, 0x27, 0x90, 0x96, 0x14, 0xF0, +0x90, 0x96, 0x14, 0xE0, 0xFF, 0x24, 0x10, 0xFD, +0xE4, 0x33, 0xFC, 0x90, 0x96, 0x0C, 0x11, 0xF7, +0xFE, 0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, +0x93, 0xF5, 0x83, 0xEE, 0x71, 0x88, 0xE0, 0xB4, +0x04, 0xDE, 0x22, 0xE4, 0x90, 0x96, 0x14, 0xF0, +0x90, 0x96, 0x14, 0xE0, 0xFF, 0xC3, 0x94, 0x04, +0x50, 0x1A, 0x90, 0x96, 0x10, 0xE0, 0x24, 0x0C, +0x71, 0xD6, 0x51, 0x78, 0xFF, 0x90, 0x96, 0x14, +0xE0, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0x71, 0x85, 0x80, 0xDC, 0x22, 0xF5, 0x83, 0xEF, +0xF0, 0x90, 0x96, 0x14, 0xE0, 0x04, 0xF0, 0x22, +0x90, 0x96, 0x10, 0x12, 0x86, 0x42, 0x7A, 0x93, +0x79, 0x29, 0x51, 0x23, 0xEF, 0x22, 0x90, 0x96, +0x0D, 0x12, 0x86, 0x42, 0xE4, 0x22, 0x71, 0x9E, +0xFF, 0x71, 0xB9, 0x6E, 0x60, 0x03, 0x7F, 0x00, +0x22, 0x0F, 0xEF, 0xB4, 0x06, 0xF3, 0x7F, 0x01, +0x22, 0x90, 0x96, 0x10, 0x12, 0x86, 0x39, 0x8F, +0x82, 0x75, 0x83, 0x00, 0x12, 0x02, 0x1F, 0xFE, +0x90, 0x96, 0x0D, 0x12, 0x86, 0x39, 0x8F, 0x82, +0x75, 0x83, 0x00, 0x02, 0x02, 0x1F, 0xFD, 0xE4, +0x33, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, +0x3C, 0xFE, 0x90, 0x96, 0x0C, 0x22, 0x90, 0x95, +0x4E, 0x12, 0x86, 0x42, 0x02, 0x02, 0x06, 0xEF, +0x70, 0x05, 0x90, 0x93, 0x05, 0x80, 0x03, 0x90, +0x93, 0x04, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, +0x95, 0xE7, 0xEF, 0xF0, 0x90, 0x95, 0xE7, 0xE0, +0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, +0x01, 0xA3, 0x12, 0x86, 0x42, 0xE4, 0xFF, 0x74, +0x08, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, +0x83, 0xE0, 0xFE, 0x91, 0x99, 0x8F, 0x82, 0x75, +0x83, 0x00, 0x91, 0xAD, 0xB4, 0x06, 0xE8, 0x90, +0x95, 0xE7, 0xE0, 0x24, 0x52, 0xF9, 0xE4, 0x34, +0xFC, 0xFA, 0x7B, 0x01, 0xA3, 0x71, 0xE9, 0x70, +0x57, 0x90, 0x95, 0xE8, 0x12, 0x8F, 0x95, 0x64, +0x02, 0x70, 0x4D, 0x90, 0x24, 0x87, 0xE0, 0x90, +0x00, 0x03, 0x12, 0x02, 0x5E, 0x90, 0x24, 0x86, +0xE0, 0x90, 0x00, 0x04, 0x12, 0x02, 0x5E, 0x91, +0x99, 0x12, 0x87, 0x67, 0x64, 0x01, 0x70, 0x30, +0x12, 0x87, 0xF8, 0x64, 0x0D, 0x70, 0x29, 0xFF, +0x74, 0x88, 0x12, 0xC7, 0x84, 0xEF, 0x24, 0x08, +0x91, 0x9F, 0xB4, 0x08, 0xF3, 0x90, 0x05, 0xDC, +0xE0, 0xFF, 0x91, 0x99, 0x90, 0x00, 0x10, 0xEF, +0x12, 0x02, 0x5E, 0xE4, 0xFF, 0x12, 0xC7, 0x82, +0xEF, 0x24, 0x11, 0x91, 0x9F, 0xB4, 0x04, 0xF5, +0x22, 0x90, 0x95, 0xE8, 0x02, 0x86, 0x39, 0xFD, +0xE4, 0x33, 0xFC, 0x90, 0x95, 0xE8, 0x12, 0x86, +0x39, 0x8D, 0x82, 0x8C, 0x83, 0xEE, 0x12, 0x02, +0x5E, 0x0F, 0xEF, 0x22, 0x90, 0x93, 0x03, 0xE0, +0x30, 0xE0, 0x1E, 0xE4, 0xFF, 0xB1, 0x34, 0xE4, +0xFF, 0x71, 0xEF, 0x7F, 0x01, 0x71, 0xEF, 0x90, +0x93, 0x03, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, +0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, 0x80, +0xF0, 0x22, 0xE4, 0x90, 0x95, 0x56, 0xF0, 0x90, +0x00, 0x37, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, +0xCF, 0x74, 0x69, 0xF0, 0xEF, 0x90, 0x00, 0x31, +0xF0, 0xEE, 0x54, 0x03, 0xFF, 0xA3, 0xE0, 0x54, +0xFC, 0x4F, 0xF0, 0x90, 0x00, 0x30, 0xED, 0xF0, +0x90, 0x00, 0x33, 0xE0, 0x44, 0x80, 0xF0, 0x90, +0x00, 0x33, 0xE0, 0x30, 0xE7, 0x09, 0xB1, 0x2C, +0x50, 0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, 0x90, +0x00, 0xCF, 0xE4, 0xF0, 0x90, 0x00, 0x37, 0xE0, +0x54, 0x7F, 0xF0, 0xB1, 0x2C, 0x7F, 0x00, 0x50, +0x02, 0x7F, 0x01, 0x22, 0x90, 0x95, 0x56, 0xE0, +0xC3, 0x94, 0x64, 0x22, 0x90, 0x95, 0xE9, 0xEF, +0xF0, 0x90, 0x95, 0xE7, 0x74, 0x18, 0xF0, 0x90, +0x96, 0x09, 0x74, 0x01, 0xF0, 0xFB, 0x7A, 0x95, +0x79, 0xE7, 0x12, 0x8E, 0x48, 0x7F, 0x04, 0x02, +0x04, 0x7E, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, +0x04, 0x7F, 0x01, 0xB1, 0x34, 0x22, 0xC0, 0xE0, +0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, +0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, +0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, +0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0x5E, +0xF0, 0x74, 0xD5, 0xA3, 0xF0, 0x12, 0x64, 0x7F, +0xE5, 0x30, 0x30, 0xE1, 0x03, 0x12, 0xDF, 0x91, +0xE5, 0x2D, 0x30, 0xE1, 0x02, 0xF1, 0xB2, 0xE5, +0x2D, 0x30, 0xE4, 0x03, 0x12, 0xE2, 0x23, 0xE5, +0x2D, 0x30, 0xE5, 0x03, 0x12, 0xE2, 0x34, 0xE5, +0x2D, 0x30, 0xE6, 0x03, 0x12, 0xDD, 0xEE, 0xE5, +0x2F, 0x30, 0xE0, 0x03, 0x12, 0xB6, 0x44, 0xE5, +0x2F, 0x30, 0xE1, 0x03, 0x12, 0xDD, 0xFB, 0xE5, +0x2F, 0x30, 0xE2, 0x03, 0x12, 0xDF, 0x13, 0xE5, +0x2F, 0x30, 0xE3, 0x03, 0x12, 0xDF, 0x36, 0xE5, +0x2F, 0x30, 0xE4, 0x03, 0x12, 0xB5, 0xAC, 0xE5, +0x2F, 0x30, 0xE5, 0x03, 0x12, 0xDF, 0x4F, 0xE5, +0x2F, 0x30, 0xE6, 0x03, 0x12, 0xDF, 0x71, 0xE5, +0x30, 0x30, 0xE4, 0x02, 0xD1, 0x47, 0xE5, 0x30, +0x30, 0xE5, 0x02, 0xF1, 0xB7, 0xE5, 0x36, 0x30, +0xE3, 0x03, 0x12, 0xCE, 0xF5, 0xE5, 0x36, 0x30, +0xE0, 0x03, 0x12, 0xC6, 0x84, 0xE5, 0x36, 0x30, +0xE6, 0x02, 0x91, 0xB4, 0xE5, 0x36, 0x30, 0xE7, +0x02, 0xB1, 0x52, 0xE5, 0x37, 0x30, 0xE2, 0x02, +0xF1, 0x8D, 0xE5, 0x37, 0x30, 0xE3, 0x02, 0xF1, +0x99, 0x74, 0x5E, 0x04, 0x90, 0x01, 0xC4, 0xF0, +0x74, 0xD5, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, +0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, +0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, +0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xE4, +0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x96, 0xBB, 0xEF, 0xF0, 0x90, 0x88, 0x2B, +0xE0, 0x90, 0x96, 0xCD, 0xF0, 0xE4, 0x90, 0x96, +0xBC, 0xF0, 0x90, 0x96, 0xCD, 0xE0, 0xFE, 0x90, +0x96, 0xBC, 0xE0, 0xFF, 0xC3, 0x9E, 0x50, 0x2C, +0xE0, 0xFE, 0xF1, 0x6B, 0xE4, 0xF0, 0xEE, 0x12, +0xEA, 0xDD, 0xE0, 0x30, 0xE7, 0x0A, 0x75, 0xF0, +0x12, 0xEF, 0xF1, 0x75, 0xE4, 0xF0, 0x80, 0x0C, +0x12, 0x7C, 0x8F, 0x90, 0x96, 0xBC, 0xE0, 0xF1, +0x6B, 0x74, 0x01, 0xF0, 0x90, 0x96, 0xBC, 0xE0, +0x04, 0xF0, 0x80, 0xC6, 0x7F, 0x0C, 0x7E, 0x00, +0x12, 0x7C, 0x6A, 0xE4, 0x90, 0x96, 0xBC, 0xF0, +0x90, 0x96, 0xCD, 0xE0, 0xFF, 0x90, 0x96, 0xBC, +0xE0, 0xFE, 0xC3, 0x9F, 0x40, 0x02, 0xE1, 0x66, +0x74, 0xBD, 0x2E, 0xF1, 0x6D, 0xE0, 0x70, 0x02, +0xE1, 0x5E, 0xEE, 0xC4, 0x54, 0xF0, 0x24, 0x06, +0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, +0xFD, 0xEE, 0xC4, 0x54, 0xF0, 0x24, 0x07, 0xF5, +0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xF1, 0x7B, +0xFC, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x53, 0xF1, +0x84, 0xEC, 0xC4, 0x54, 0xF0, 0x24, 0x0A, 0xF5, +0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0xFD, +0xEC, 0xF1, 0xA5, 0xF1, 0x7B, 0x75, 0xF0, 0x12, +0x90, 0x89, 0x57, 0xF1, 0x84, 0x7F, 0x01, 0x90, +0x96, 0xBC, 0xE0, 0xFE, 0xF1, 0xA5, 0xE5, 0x82, +0x2F, 0x12, 0x9D, 0xD9, 0xE0, 0xFD, 0x75, 0xF0, 0x12, 0xEE, 0x90, 0x89, 0x57, 0x12, 0x04, 0x6E, -0x75, 0xF0, 0x02, 0xEF, 0x12, 0x04, 0x6E, 0xE4, -0x8D, 0xF0, 0x12, 0x02, 0xE7, 0x0F, 0xEF, 0xB4, -0x05, 0xD3, 0xB1, 0xA1, 0x24, 0x09, 0xF5, 0x82, -0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0xFE, 0x75, -0xF0, 0x12, 0xEF, 0x90, 0x89, 0x55, 0x12, 0x04, -0x6E, 0xEE, 0xF0, 0xB1, 0xA1, 0x24, 0x04, 0xF5, -0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0xFE, -0xD1, 0x66, 0xEE, 0xF0, 0x90, 0x95, 0xF0, 0xE0, -0xFF, 0x90, 0x95, 0xEF, 0xE0, 0xFD, 0xD1, 0x75, -0x90, 0x95, 0xF0, 0xE0, 0x75, 0xF0, 0x12, 0x90, -0x89, 0x56, 0x12, 0x04, 0x6E, 0x74, 0x01, 0xF0, -0x90, 0x95, 0xF0, 0xE0, 0x04, 0xF0, 0x81, 0xB3, -0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -0x22, 0x90, 0x95, 0xF0, 0xE0, 0xFF, 0xC4, 0x54, -0xF0, 0x22, 0xC4, 0x54, 0xF0, 0x24, 0x0B, 0xF5, -0x82, 0xE4, 0x34, 0x81, 0x22, 0xF5, 0x83, 0xE0, -0xFE, 0xED, 0xFF, 0x90, 0x95, 0xF0, 0xE0, 0x22, -0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, 0x7F, -0x02, 0x71, 0x4A, 0x22, 0x90, 0x93, 0x03, 0xE0, -0x30, 0xE0, 0x04, 0x7F, 0x03, 0x71, 0x4A, 0x22, -0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, 0x85, -0x4E, 0x90, 0x95, 0xD9, 0xEF, 0xF0, 0x60, 0xF0, -0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, 0xA3, -0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, 0xE0, -0x0E, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, 0xF0, -0xE4, 0xFF, 0x91, 0x54, 0x12, 0x90, 0xF1, 0xD1, -0x38, 0xE0, 0x30, 0xE1, 0x09, 0x54, 0xFD, 0xF0, -0x90, 0x86, 0x08, 0x12, 0x8D, 0x33, 0xD1, 0x38, -0xE0, 0x30, 0xE2, 0x09, 0x54, 0xFB, 0xF0, 0x90, -0x86, 0x0A, 0x12, 0x8D, 0x33, 0xD1, 0x38, 0xE0, -0x30, 0xE6, 0x09, 0x54, 0xBF, 0xF0, 0x90, 0x8A, -0x7D, 0x12, 0x8D, 0x33, 0xD2, 0xAF, 0x80, 0xB0, -0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, 0x22, -0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x05, 0xE4, -0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x8A, 0x75, -0x12, 0x8D, 0x33, 0x90, 0x8A, 0xE5, 0x12, 0x8E, -0xC9, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x89, -0x55, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0x74, 0x43, -0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -0x22, 0x7D, 0x01, 0xAF, 0x67, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0xED, 0x60, 0x10, 0xD1, -0x98, 0x90, 0x89, 0x5F, 0xD1, 0xC9, 0x90, 0x89, -0x53, 0xD1, 0xC9, 0xD1, 0x5E, 0xE4, 0xF0, 0xD1, -0xD5, 0xEE, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, 0x57, 0x12, -0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, -0x12, 0xEF, 0x90, 0x89, 0x59, 0x12, 0x04, 0x6E, -0xE4, 0xF0, 0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, -0x90, 0x89, 0x5B, 0x12, 0x04, 0x6E, 0xE4, 0xF0, -0xA3, 0xF0, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, -0x5D, 0x12, 0x04, 0x6E, 0xE4, 0xF0, 0xA3, 0xF0, -0x75, 0xF0, 0x12, 0xEF, 0x22, 0xEF, 0xC4, 0x54, -0xF0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, -0xF5, 0x83, 0xE0, 0x54, 0xBF, 0x44, 0x80, 0xFE, -0xEF, 0xC4, 0x54, 0xF0, 0x24, 0x03, 0xF5, 0x82, -0xE4, 0x34, 0x81, 0xF5, 0x83, 0x22, 0xE4, 0xFF, -0x12, 0x78, 0x4A, 0xBF, 0x01, 0x10, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x0A, 0x12, 0xBD, 0x93, 0x54, -0x07, 0x70, 0x03, 0x12, 0xAF, 0x95, 0x22, 0x12, -0xAF, 0x54, 0x64, 0x01, 0x70, 0x13, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x0D, 0x90, 0x01, 0x57, 0xE4, -0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x12, 0xBB, -0x68, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, -0xE0, 0x05, 0x12, 0xBA, 0x78, 0x60, 0x15, 0x90, -0x88, 0x36, 0xE0, 0x70, 0x04, 0xEF, 0x30, 0xE0, -0x0B, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, 0x60, -0x03, 0x12, 0xA9, 0xFC, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, -0xEF, 0xF1, 0x7A, 0x90, 0x07, 0xC0, 0x74, 0x80, -0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -0xED, 0x54, 0x03, 0x24, 0xC8, 0x51, 0xBF, 0xFF, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x54, 0xFC, 0x90, 0x07, 0xC0, 0xF0, -0xEE, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x97, 0x0E, 0xF1, 0x75, -0x7A, 0x00, 0x90, 0x97, 0x0F, 0xE0, 0x54, 0x03, -0xFB, 0x70, 0x0A, 0x90, 0x07, 0xC4, 0xF1, 0xC5, -0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, 0x02, -0x4A, 0x70, 0x15, 0x90, 0x07, 0xC6, 0xF1, 0xC5, -0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, -0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, 0xEC, -0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0xE4, 0xFD, -0x02, 0x8F, 0xF0, 0xEF, 0xB4, 0xFF, 0x06, 0x90, -0x93, 0xF3, 0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, -0x90, 0x93, 0xF3, 0x02, 0xA7, 0xC9, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0x12, -0x7B, 0x41, 0xEF, 0x20, 0xE6, 0x03, 0x02, 0xD9, -0x0B, 0x90, 0x00, 0x8C, 0xE0, 0x90, 0x97, 0x02, -0xF0, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0x90, 0x97, -0x03, 0xEF, 0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, -0x97, 0x04, 0xF0, 0x90, 0x97, 0x03, 0xE0, 0x24, -0xFC, 0x60, 0x0F, 0x24, 0x03, 0x60, 0x02, 0x21, -0x00, 0x90, 0x97, 0x02, 0xE0, 0xFF, 0x31, 0x4F, -0x21, 0x00, 0x90, 0x97, 0x02, 0xE0, 0x24, 0xD6, -0x12, 0x97, 0xBA, 0xFB, 0xE4, 0xFD, 0xFF, 0x31, -0x3D, 0x75, 0xF0, 0x12, 0x12, 0x96, 0xA4, 0x13, -0x13, 0x54, 0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x31, -0x3D, 0x75, 0xF0, 0x12, 0x12, 0x96, 0xA4, 0x12, -0x8F, 0xE1, 0xFB, 0x0D, 0xE4, 0xFF, 0x31, 0x3D, -0x75, 0xF0, 0x12, 0x12, 0x96, 0xA4, 0xC4, 0x54, -0x03, 0xFB, 0x0D, 0xE4, 0xFF, 0x31, 0x3D, 0x75, -0xF0, 0x12, 0x12, 0x97, 0xFC, 0xFB, 0xE4, 0xFD, -0x0F, 0x31, 0x3D, 0x75, 0xF0, 0x12, 0x90, 0x89, -0x50, 0x12, 0x04, 0x6E, 0x31, 0x3A, 0x31, 0x44, -0xC4, 0x13, 0x54, 0x01, 0xFB, 0x0D, 0x7F, 0x01, -0x31, 0x3D, 0x31, 0x44, 0x54, 0x1F, 0x31, 0x3B, -0x71, 0x32, 0xE0, 0xFB, 0xE4, 0xFD, 0x0F, 0x31, -0x3D, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x01, 0xF5, -0x82, 0xE4, 0x34, 0x82, 0x31, 0x38, 0x75, 0xF0, -0x08, 0xA4, 0x24, 0x02, 0xF5, 0x82, 0xE4, 0x34, -0x82, 0x31, 0x38, 0x75, 0xF0, 0x08, 0xA4, 0x24, -0x03, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x31, 0x38, -0x75, 0xF0, 0x08, 0xA4, 0x24, 0x04, 0xF5, 0x82, -0xE4, 0x34, 0x82, 0xF5, 0x83, 0xE0, 0xFB, 0xE4, -0xFD, 0x0F, 0x31, 0x3D, 0x75, 0xF0, 0x08, 0xA4, -0x24, 0x05, 0xF5, 0x82, 0xE4, 0x34, 0x82, 0x31, -0x38, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x06, 0xF5, -0x82, 0xE4, 0x34, 0x82, 0x31, 0x38, 0x75, 0xF0, -0x08, 0xA4, 0x24, 0x07, 0xF5, 0x82, 0xE4, 0x34, -0x82, 0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x31, 0x10, -0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, -0x02, 0x71, 0x23, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, -0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, -0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, -0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, -0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, -0xF5, 0x83, 0xE0, 0xFB, 0x0D, 0x31, 0x10, 0x90, -0x97, 0x02, 0xE0, 0x22, 0x75, 0xF0, 0x12, 0x90, -0x89, 0x51, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x97, -0x0A, 0xEF, 0xF0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, -0xEF, 0x30, 0xE6, 0x3D, 0x7F, 0x8D, 0x12, 0x7B, -0x41, 0xEF, 0x64, 0x01, 0x70, 0x33, 0x90, 0x97, -0x0B, 0xF0, 0x90, 0x97, 0x0B, 0xE0, 0xFD, 0x90, -0x97, 0x0A, 0xE0, 0x12, 0x90, 0xE4, 0xE5, 0x82, -0x2D, 0x12, 0xCF, 0x3C, 0xE0, 0xFB, 0xE4, 0xFF, -0x31, 0x10, 0x90, 0x97, 0x0B, 0xE0, 0x04, 0xF0, -0xE0, 0xC3, 0x94, 0x10, 0x40, 0xDC, 0x7F, 0x8F, -0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0x71, -0x23, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x95, -0x53, 0x12, 0x86, 0x42, 0x90, 0x95, 0x53, 0x12, -0x86, 0x39, 0x12, 0x02, 0x06, 0x54, 0x7F, 0xFD, -0x12, 0x87, 0xA6, 0xFE, 0x54, 0x1F, 0x90, 0x95, -0x57, 0x12, 0x8F, 0xDD, 0x90, 0x95, 0x56, 0x12, -0x87, 0x72, 0xFE, 0x54, 0x03, 0xFC, 0xEE, 0x54, -0x30, 0xC4, 0x54, 0x0F, 0x12, 0x87, 0x6F, 0xFE, -0x54, 0x40, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x90, -0x95, 0x58, 0x12, 0x8F, 0xDD, 0xFF, 0x12, 0x87, -0x73, 0xFB, 0x54, 0x08, 0x13, 0x13, 0x13, 0x54, -0x1F, 0x90, 0x95, 0x5B, 0xF0, 0xFA, 0xEB, 0x54, -0x04, 0x13, 0x13, 0x54, 0x3F, 0xA3, 0xF0, 0xEF, -0x54, 0x01, 0xC4, 0x33, 0x33, 0x33, 0x54, 0x80, -0x12, 0x96, 0x9F, 0x54, 0x7F, 0x4F, 0xF0, 0x90, -0x95, 0x58, 0xE0, 0x71, 0x2A, 0x12, 0x96, 0x9F, -0x54, 0xBF, 0x4F, 0xF0, 0xEA, 0x60, 0x02, 0x61, -0x16, 0x90, 0x95, 0x57, 0xE0, 0x54, 0x1F, 0xFF, -0x75, 0xF0, 0x12, 0xED, 0x31, 0x47, 0x54, 0xE0, -0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x12, 0x96, 0x9F, -0x54, 0xFC, 0x4F, 0xF0, 0xEC, 0x54, 0x03, 0x25, -0xE0, 0x25, 0xE0, 0x12, 0x96, 0x9F, 0x54, 0xF3, -0x4F, 0xF0, 0x90, 0x95, 0x56, 0xE0, 0x54, 0x01, -0xC4, 0x33, 0x54, 0xE0, 0xFF, 0x75, 0xF0, 0x12, -0xED, 0x31, 0x47, 0x54, 0xDF, 0x4F, 0xF0, 0x90, -0x95, 0x59, 0xE0, 0x54, 0x03, 0xC4, 0x54, 0xF0, -0x12, 0x96, 0x9F, 0x54, 0xCF, 0x4F, 0x71, 0x17, -0xE0, 0x54, 0xFB, 0x71, 0x17, 0xC0, 0x83, 0xC0, -0x82, 0xE0, 0xFF, 0x90, 0x95, 0x5C, 0xE0, 0x12, -0xCE, 0x7C, 0xD0, 0x82, 0xD0, 0x83, 0xF0, 0x90, -0x93, 0xED, 0xE0, 0x60, 0x3E, 0x90, 0x95, 0x53, -0x12, 0x86, 0x39, 0xE9, 0x24, 0x03, 0xF9, 0xE4, -0x3A, 0xFA, 0x12, 0x02, 0x06, 0x54, 0x1F, 0x12, -0x02, 0x4C, 0x90, 0x95, 0x5A, 0x74, 0x01, 0xF0, -0x90, 0x95, 0x5A, 0xE0, 0xFF, 0xC3, 0x94, 0x04, -0x50, 0x19, 0xEF, 0x24, 0x03, 0xFF, 0xE4, 0x33, -0xFE, 0x90, 0x95, 0x53, 0x12, 0xB4, 0x00, 0xE4, -0x12, 0x02, 0x5E, 0x90, 0x95, 0x5A, 0xE0, 0x04, -0xF0, 0x80, 0xDD, 0x90, 0x93, 0xEB, 0xE0, 0x54, -0x07, 0xFF, 0xBF, 0x05, 0x0A, 0xEC, 0xB4, 0x01, -0x06, 0x90, 0x93, 0xF0, 0x74, 0x01, 0xF0, 0xE4, -0x90, 0x95, 0x5A, 0xF0, 0x90, 0x95, 0x5A, 0xE0, -0xFC, 0x24, 0x03, 0xFF, 0xE4, 0x33, 0xFE, 0x90, -0x95, 0x53, 0x12, 0xB4, 0x00, 0x12, 0x02, 0x1F, -0xFF, 0xED, 0x71, 0x32, 0xE5, 0x82, 0x2C, 0x12, -0xCF, 0x3C, 0xEF, 0xF0, 0x90, 0x95, 0x5A, 0xE0, -0x04, 0xF0, 0xE0, 0xB4, 0x04, 0xD6, 0xAF, 0x05, -0x90, 0x8A, 0xFF, 0x12, 0xA7, 0x07, 0x22, 0xF0, -0x74, 0xC6, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -0xF5, 0x83, 0x22, 0xE4, 0xFD, 0x7F, 0x8D, 0x02, -0x7B, 0x2E, 0x54, 0x01, 0xC4, 0x33, 0x33, 0x54, -0xC0, 0x22, 0x75, 0xF0, 0x08, 0xA4, 0x24, 0x00, -0xF5, 0x82, 0xE4, 0x34, 0x82, 0xF5, 0x83, 0x22, -0x7E, 0x00, 0x7F, 0x33, 0x7D, 0x00, 0x7B, 0x01, -0x7A, 0x88, 0x79, 0x9D, 0x12, 0x04, 0x80, 0x90, -0x88, 0x9E, 0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, -0xF0, 0x7E, 0x00, 0x7F, 0x0C, 0x7D, 0x00, 0x7B, -0x01, 0x7A, 0x95, 0x79, 0x37, 0x12, 0x04, 0x80, -0x90, 0x86, 0xB3, 0xE0, 0xFC, 0x64, 0x02, 0x70, -0x18, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x30, -0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x71, 0x2A, 0xFE, -0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4E, 0xF0, -0x22, 0xEC, 0x64, 0x01, 0x70, 0x0D, 0x90, 0xFD, -0x70, 0xE0, 0x7F, 0x00, 0x30, 0xE2, 0x02, 0x7F, -0x01, 0x80, 0x13, 0x90, 0x86, 0xB3, 0xE0, 0x64, -0x03, 0x70, 0x17, 0x90, 0xFD, 0x78, 0xE0, 0x7F, -0x00, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0xEF, 0x71, -0x2A, 0xFF, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, -0x4F, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFE, 0x12, -0x87, 0x73, 0xFF, 0x74, 0xD6, 0x2E, 0xF5, 0x82, -0xE4, 0x34, 0x8D, 0x12, 0x8F, 0xD3, 0xFF, 0x74, -0xC6, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0x12, -0x87, 0xF8, 0xFF, 0x74, 0x5A, 0x2E, 0x91, 0x04, -0xEF, 0xF0, 0x74, 0xC6, 0x2E, 0x71, 0x1B, 0xE0, -0x30, 0xE5, 0x18, 0x75, 0xF0, 0x12, 0xEE, 0x12, -0x96, 0xA4, 0x13, 0x13, 0x54, 0x03, 0xFB, 0xAF, -0x06, 0x74, 0xD6, 0x2E, 0x12, 0x97, 0xBA, 0xFD, -0x12, 0x6B, 0xFD, 0x22, 0xF5, 0x82, 0xE4, 0x34, -0x96, 0xF5, 0x83, 0x22, 0xE4, 0x90, 0x95, 0xAF, -0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0xAF, +0x75, 0xF0, 0x02, 0xEF, 0x12, 0x93, 0x99, 0xED, +0xF0, 0x0F, 0xEF, 0xB4, 0x05, 0xD9, 0x90, 0x96, +0xBC, 0xE0, 0xFF, 0xC4, 0x54, 0xF0, 0x24, 0x09, +0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, +0xFE, 0xF1, 0xC7, 0xEE, 0xF0, 0x90, 0x96, 0xBC, +0xE0, 0xFF, 0x90, 0x96, 0xBB, 0xE0, 0xFD, 0x12, +0x61, 0xF7, 0x90, 0x96, 0xBC, 0xE0, 0x75, 0xF0, +0x12, 0xF1, 0x75, 0x74, 0x01, 0xF0, 0x90, 0x96, +0xBC, 0xE0, 0x04, 0xF0, 0xC1, 0xA8, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0x24, 0xBD, 0xF5, 0x82, 0xE4, +0x34, 0x96, 0xF5, 0x83, 0x22, 0x90, 0x89, 0x56, +0x02, 0x04, 0x6E, 0xE0, 0xFE, 0xED, 0xFF, 0x90, +0x96, 0xBC, 0xE0, 0x22, 0x12, 0x04, 0x6E, 0xEE, +0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x93, 0x03, +0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x02, 0xB1, 0x34, +0x22, 0x90, 0x93, 0x03, 0xE0, 0x30, 0xE0, 0x04, +0x7F, 0x03, 0xB1, 0x34, 0x22, 0xC4, 0x54, 0xF0, +0x24, 0x0B, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, +0x83, 0x22, 0xE4, 0xFF, 0x02, 0xCF, 0xB3, 0x90, +0x8A, 0xDF, 0xF1, 0xBF, 0x02, 0x04, 0x7A, 0xE0, +0xFE, 0xA3, 0xE0, 0xAA, 0x06, 0xF9, 0x22, 0x75, +0xF0, 0x12, 0xEF, 0x90, 0x89, 0x55, 0x02, 0x04, +0x6E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0xFD, 0xED, +0x70, 0x03, 0x02, 0xD8, 0xCA, 0x90, 0x87, 0x0B, +0xE0, 0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, +0x60, 0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x87, 0x0C, +0xE0, 0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, +0x7F, 0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, +0xE0, 0x44, 0x01, 0xF0, 0x01, 0xCA, 0x90, 0x97, +0x40, 0xE0, 0xFF, 0x12, 0xC2, 0x9F, 0x80, 0x05, +0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, +0xED, 0xFB, 0xEF, 0x5B, 0x70, 0x02, 0x01, 0xAD, +0xE4, 0xFC, 0x11, 0xD0, 0xA4, 0xFF, 0xEC, 0x7A, +0x00, 0x2F, 0xFF, 0xEA, 0x35, 0xF0, 0xFE, 0x74, +0xD0, 0x11, 0xE3, 0x90, 0x87, 0x0C, 0xE0, 0xF9, +0x75, 0xF0, 0x08, 0x90, 0x86, 0xBB, 0x12, 0x04, +0x6E, 0x12, 0x9D, 0xD6, 0xEF, 0x11, 0xCF, 0xA4, +0xFF, 0xEC, 0x2F, 0xFF, 0xEA, 0x35, 0xF0, 0xFE, +0x74, 0xF0, 0x11, 0xE3, 0x75, 0xF0, 0x08, 0xE9, +0x90, 0x86, 0xBF, 0x12, 0x04, 0x6E, 0x12, 0x9D, +0xD6, 0xEF, 0xF0, 0x0C, 0xEC, 0xB4, 0x04, 0xBA, +0x11, 0xD8, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, +0xF4, 0x5D, 0xFD, 0x11, 0xD8, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, 0xF0, 0x90, +0x97, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0x54, 0x03, +0xF0, 0x90, 0x87, 0x0C, 0xE0, 0x04, 0xF0, 0xE0, +0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, 0x01, 0xEF, +0x70, 0x03, 0x02, 0xD7, 0xDF, 0xE4, 0x90, 0x87, +0x0C, 0xF0, 0x02, 0xD7, 0xDF, 0x90, 0x01, 0xC0, +0xE0, 0x44, 0x02, 0xF0, 0x90, 0x97, 0x40, 0xE0, +0x44, 0x80, 0x90, 0x00, 0x8A, 0x11, 0xCF, 0x90, +0x01, 0xD0, 0x12, 0x04, 0x6E, 0xE0, 0x90, 0x01, +0xC3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, +0x90, 0x97, 0x40, 0xE0, 0x75, 0xF0, 0x04, 0x22, +0x90, 0x97, 0x40, 0xE0, 0xFF, 0x74, 0x01, 0xA8, +0x07, 0x08, 0x22, 0x2F, 0xF5, 0x82, 0x74, 0x01, +0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x22, 0x75, 0x21, +0x80, 0xE4, 0xF5, 0x22, 0xF5, 0x23, 0x75, 0x24, +0x80, 0x90, 0x00, 0x50, 0xE5, 0x21, 0xF0, 0xA3, +0xE5, 0x22, 0xF0, 0xA3, 0xE5, 0x23, 0xF0, 0xA3, +0xE5, 0x24, 0xF0, 0x22, 0x12, 0xC7, 0xCC, 0x12, +0x76, 0x6D, 0x12, 0x75, 0xE0, 0x31, 0x63, 0x31, +0x35, 0x80, 0xD3, 0x12, 0x7B, 0x1B, 0x90, 0x86, +0xB3, 0xEF, 0xF0, 0x31, 0x0C, 0x90, 0x01, 0x64, +0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, +0x80, 0xF0, 0x02, 0x67, 0xD2, 0x75, 0x39, 0x07, +0x43, 0x39, 0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, +0x08, 0x43, 0x3A, 0x10, 0x75, 0x3B, 0x03, 0x75, +0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, +0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, +0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, +0x3C, 0xF0, 0x22, 0x75, 0x29, 0x12, 0xE4, 0xF5, +0x2A, 0x75, 0x2B, 0x07, 0x75, 0x2C, 0x32, 0xF5, +0x31, 0x75, 0x32, 0xC1, 0x75, 0x33, 0x0C, 0xF5, +0x34, 0x90, 0x01, 0x30, 0xE5, 0x29, 0xF0, 0xA3, +0xE5, 0x2A, 0xF0, 0xA3, 0xE5, 0x2B, 0xF0, 0xA3, +0xE5, 0x2C, 0xF0, 0x90, 0x01, 0x20, 0xE5, 0x31, +0xF0, 0xA3, 0xE5, 0x32, 0xF0, 0xA3, 0xE5, 0x33, +0xF0, 0xA3, 0xE5, 0x34, 0xF0, 0x22, 0x90, 0x01, +0xE4, 0x74, 0x27, 0xF0, 0xA3, 0xE4, 0xF0, 0x22, +0x7D, 0x02, 0x90, 0x01, 0xC4, 0x74, 0xA8, 0xF0, +0x74, 0xD9, 0xA3, 0xF0, 0x90, 0x93, 0x57, 0xE0, +0xFF, 0xED, 0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, +0xE0, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, +0x90, 0x01, 0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, +0x7F, 0x00, 0x22, 0x0D, 0x80, 0xDE, 0x74, 0xA8, +0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD9, 0xA3, +0xF0, 0x7F, 0x01, 0x22, 0xE4, 0x90, 0x95, 0xA6, +0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0xA6, 0xE0, 0x64, 0x01, 0xF0, 0x90, 0x93, 0xF0, 0xE0, 0x70, 0x18, 0x90, 0x93, 0xED, 0xE0, 0x70, 0x12, -0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x95, 0xAF, 0xE0, -0x24, 0x0C, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xDC, +0xA3, 0xE0, 0x70, 0x0E, 0x90, 0x95, 0xA6, 0xE0, +0x24, 0xE4, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD9, 0xA3, 0xF0, 0x12, 0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xFF, 0x90, 0x88, -0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0xAF, 0x95, -0xC2, 0xAF, 0x91, 0x6E, 0xBF, 0x01, 0x03, 0x12, -0xC2, 0xBA, 0xD2, 0xAF, 0xB1, 0xE8, 0x12, 0xD7, -0xE6, 0x12, 0x83, 0x4D, 0x80, 0xA7, 0x7D, 0x02, -0x90, 0x01, 0xC4, 0x74, 0x6E, 0xF0, 0x74, 0xDC, -0xA3, 0xF0, 0x90, 0x93, 0x57, 0xE0, 0xFF, 0xED, -0xC3, 0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, -0x81, 0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, -0xB8, 0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, -0x22, 0x0D, 0x80, 0xDE, 0x74, 0x6E, 0x04, 0x90, -0x01, 0xC4, 0xF0, 0x74, 0xDC, 0xA3, 0xF0, 0x7F, -0x01, 0x22, 0xE4, 0xF5, 0x7A, 0xEF, 0x14, 0xF5, -0x79, 0xED, 0xFF, 0xE5, 0x79, 0xF5, 0x82, 0x33, -0x95, 0xE0, 0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, -0x74, 0x80, 0xF8, 0x65, 0x83, 0x98, 0x40, 0x51, -0xE5, 0x79, 0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, -0xFB, 0xFF, 0x33, 0x95, 0xE0, 0xFE, 0xEB, 0x71, -0x32, 0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, -0x3E, 0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, -0x00, 0xE5, 0x79, 0x12, 0xB7, 0xDA, 0x80, 0x05, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, 0x82, 0x4E, -0x60, 0x13, 0x85, 0x79, 0x7B, 0x05, 0x7A, 0x90, -0x95, 0xE7, 0xE0, 0x65, 0x7A, 0x60, 0x0A, 0xE5, -0x7B, 0xD3, 0x9D, 0x40, 0x04, 0x15, 0x79, 0x80, -0x98, 0xAF, 0x7B, 0x22, 0xAA, 0x07, 0xA9, 0x05, -0xEA, 0x12, 0x90, 0xE4, 0xE0, 0xF5, 0x75, 0x54, -0x7F, 0xF5, 0x77, 0x75, 0xF0, 0x12, 0xEA, 0x12, -0xB7, 0xD2, 0x90, 0x95, 0xE3, 0xF0, 0x75, 0xF0, -0x12, 0xEA, 0x12, 0x97, 0xFC, 0xFF, 0xEA, 0x12, -0x90, 0x36, 0xE0, 0x54, 0x03, 0xF5, 0x76, 0xE5, -0x77, 0x90, 0x81, 0x9D, 0x93, 0xFD, 0xEA, 0x25, -0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xED, 0xF0, 0x75, -0xF0, 0x12, 0xEA, 0x12, 0x96, 0xA4, 0xFE, 0xC4, -0x54, 0x03, 0x90, 0x95, 0xE2, 0xF0, 0x74, 0xC6, -0x2A, 0xB1, 0xD8, 0xE5, 0x77, 0xF0, 0x74, 0x46, -0x2A, 0xB1, 0xE0, 0xE5, 0x76, 0xF0, 0xE5, 0x77, -0xD3, 0x9F, 0x40, 0x04, 0x8F, 0x77, 0x8F, 0x75, -0x89, 0x78, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, 0x78, -0x50, 0x33, 0xE5, 0x75, 0x30, 0xE7, 0x09, 0x85, -0x77, 0x75, 0x19, 0xE9, 0x70, 0x24, 0x80, 0x25, -0x90, 0x95, 0xE3, 0xE0, 0xFD, 0xE5, 0x77, 0xD3, -0x9D, 0x40, 0x0F, 0xAB, 0x02, 0x90, 0x95, 0xE7, -0xE9, 0xF0, 0xAF, 0x77, 0x91, 0xAA, 0x8F, 0x75, -0x80, 0x0B, 0x90, 0x95, 0xE3, 0xE0, 0xF5, 0x75, -0x80, 0x03, 0x0F, 0x80, 0xC7, 0xAF, 0x02, 0x90, -0x92, 0x80, 0xE5, 0x76, 0xF0, 0xE4, 0xFB, 0xAD, -0x75, 0x02, 0x75, 0x80, 0x74, 0xC6, 0x25, 0x75, -0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, -0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x93, 0xED, 0xE0, 0x60, 0x39, 0x7F, 0x54, 0x7E, -0x09, 0x12, 0x70, 0x70, 0x90, 0x95, 0xB2, 0x12, -0x04, 0x31, 0x90, 0x95, 0xB2, 0x12, 0x04, 0xB8, -0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, -0xED, 0x44, 0x04, 0xFD, 0xEC, 0x90, 0x95, 0xB2, -0x12, 0x04, 0x31, 0x90, 0x95, 0xB2, 0x12, 0x04, -0xB8, 0x90, 0x92, 0x18, 0x12, 0x04, 0x31, 0x7F, -0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x93, -0xE8, 0xE0, 0x70, 0x29, 0x90, 0x07, 0xCC, 0xE0, -0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x95, 0xB6, -0x74, 0x22, 0xF0, 0x90, 0x95, 0xD8, 0x74, 0x01, -0xF0, 0x90, 0x95, 0xB8, 0x74, 0x03, 0xF0, 0x7B, -0x01, 0x7A, 0x95, 0x79, 0xB6, 0x12, 0x8E, 0xB7, -0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, 0xF0, -0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x93, 0xED, 0xE0, -0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, -0x1F, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x01, 0xC5, -0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, -0x74, 0xFD, 0xF0, 0xEF, 0x60, 0x06, 0x90, 0x01, -0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0xED, 0xE0, -0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x01, 0xF0, -0x90, 0x93, 0xEE, 0xE0, 0x60, 0x06, 0x90, 0x01, -0xC4, 0x74, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x8E, 0x61, 0x8F, 0x62, 0x8D, 0x63, 0xE4, -0x90, 0x95, 0x5F, 0xF0, 0x90, 0x00, 0x37, 0xE0, -0x44, 0x80, 0xFD, 0x7F, 0x37, 0x12, 0x7B, 0x2E, -0x7D, 0x69, 0x7F, 0xCF, 0x12, 0x7B, 0x2E, 0xE5, -0x62, 0xFD, 0x7F, 0x31, 0x12, 0x7B, 0x2E, 0xE5, -0x61, 0x54, 0x03, 0xFF, 0x90, 0x00, 0x32, 0xE0, -0x54, 0xFC, 0x4F, 0xFD, 0x7F, 0x32, 0x12, 0x7B, -0x2E, 0xAD, 0x63, 0x7F, 0x30, 0x12, 0x7B, 0x2E, -0x90, 0x00, 0x33, 0xE0, 0x44, 0x80, 0xFD, 0x7F, -0x33, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x33, 0xE0, -0x30, 0xE7, 0x09, 0xF1, 0x20, 0x50, 0x05, 0xE0, -0x04, 0xF0, 0x80, 0xF0, 0xE4, 0xFD, 0x7F, 0xCF, -0x12, 0x7B, 0x2E, 0x90, 0x00, 0x37, 0xE0, 0x54, -0x7F, 0xFD, 0x7F, 0x37, 0x12, 0x7B, 0x2E, 0xF1, -0x20, 0x7F, 0x00, 0x50, 0x02, 0x7F, 0x01, 0x22, -0x90, 0x95, 0x5F, 0xE0, 0xC3, 0x94, 0x64, 0x22, -0x75, 0x29, 0x12, 0xE4, 0xF5, 0x2A, 0x75, 0x2B, -0x07, 0x75, 0x2C, 0x32, 0xF5, 0x31, 0x75, 0x32, -0xC1, 0x75, 0x33, 0x0C, 0xF5, 0x34, 0x90, 0x01, -0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, -0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, 0xF0, -0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, -0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, 0xE5, -0x34, 0xF0, 0x22, 0x75, 0x39, 0x06, 0x43, 0x39, -0x10, 0x75, 0x3A, 0x01, 0x43, 0x3A, 0x08, 0x43, -0x3A, 0x10, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, -0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, 0x90, 0x01, -0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, 0xF0, -0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, 0xF0, -0x22, 0x90, 0x8A, 0x79, 0x74, 0x86, 0xF0, 0xA3, -0x74, 0xFF, 0xF0, 0x90, 0x8A, 0xE5, 0x74, 0xE0, -0xF0, 0xA3, 0x74, 0xA0, 0xF0, 0x90, 0x8B, 0x03, -0x74, 0x88, 0xF0, 0xA3, 0x74, 0xCB, 0xF0, 0x90, -0x8A, 0xB9, 0x74, 0x8D, 0xF0, 0xA3, 0x74, 0x3D, -0xF0, 0x90, 0x8A, 0xD5, 0x74, 0xB6, 0xF0, 0xA3, -0x74, 0x32, 0xF0, 0x90, 0x8A, 0xFB, 0x74, 0x90, -0xF0, 0xA3, 0x74, 0x43, 0xF0, 0x90, 0x8A, 0xA5, -0x74, 0xD9, 0xF0, 0xA3, 0x74, 0xA6, 0xF0, 0x90, -0x8A, 0xB5, 0x74, 0xDB, 0xF0, 0xA3, 0x74, 0xBB, -0xF0, 0x90, 0x8A, 0xC3, 0x74, 0xE7, 0xF0, 0xA3, -0x74, 0x2D, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xE7, -0xF0, 0xA3, 0x74, 0x5E, 0xF0, 0x90, 0x8A, 0x85, -0x74, 0xAD, 0xF0, 0xA3, 0x74, 0x87, 0xF0, 0x90, -0x86, 0x04, 0x74, 0xE7, 0xF0, 0xA3, 0x74, 0xA7, -0xF0, 0x90, 0x8A, 0xA9, 0x74, 0xE7, 0xF0, 0xA3, -0x74, 0x6A, 0xF0, 0x90, 0x8B, 0x07, 0x74, 0xA5, -0xF0, 0xA3, 0x74, 0x7F, 0xF0, 0x90, 0x8A, 0xAD, -0x74, 0xDB, 0xF0, 0xA3, 0x74, 0x40, 0xF0, 0x90, -0x86, 0x0C, 0x74, 0xC0, 0xF0, 0xA3, 0x74, 0x27, -0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xC0, 0xF0, 0xA3, -0x74, 0xB6, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xE8, -0xF0, 0xA3, 0x74, 0xA5, 0xF0, 0x90, 0x86, 0x02, -0x74, 0xE9, 0xF0, 0xA3, 0x74, 0x04, 0xF0, 0x90, -0x8A, 0xFD, 0x74, 0xA2, 0xF0, 0xA3, 0x74, 0x51, -0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xE6, 0xF0, 0xA3, -0x74, 0x2D, 0xF0, 0x90, 0x8A, 0xDB, 0x74, 0xE6, -0xF0, 0xA3, 0x74, 0x77, 0xF0, 0x90, 0x8A, 0xAF, -0x74, 0xA6, 0xF0, 0xA3, 0x74, 0x60, 0xF0, 0x90, -0x8A, 0xD3, 0x74, 0xC6, 0xF0, 0xA3, 0x74, 0x99, -0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xE9, 0xF0, 0xA3, -0x74, 0xC1, 0xF0, 0x90, 0x8A, 0xA3, 0x74, 0xEA, -0xF0, 0xA3, 0x74, 0x07, 0xF0, 0x90, 0x86, 0x06, -0x74, 0xE5, 0xF0, 0xA3, 0x74, 0x56, 0xF0, 0x22, +0x38, 0xE0, 0x6F, 0x60, 0x03, 0x12, 0xAF, 0x06, +0xC2, 0xAF, 0x31, 0xA8, 0xBF, 0x01, 0x03, 0x12, +0xC5, 0xB9, 0xD2, 0xAF, 0x51, 0x46, 0x12, 0x9F, +0xF2, 0x12, 0x83, 0x4D, 0x80, 0xA7, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0xED, +0xE0, 0x60, 0x24, 0x7F, 0x54, 0x7E, 0x09, 0x12, +0x70, 0x70, 0x51, 0xF2, 0x12, 0x04, 0xB8, 0xEF, +0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, +0x44, 0x04, 0xFD, 0xEC, 0x51, 0xF2, 0x51, 0xFC, +0x7F, 0x54, 0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, +0x93, 0xE8, 0xE0, 0x70, 0x29, 0x90, 0x07, 0xCC, +0xE0, 0x30, 0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x95, +0xAD, 0x74, 0x22, 0xF0, 0x90, 0x95, 0xCF, 0x74, +0x01, 0xF0, 0x90, 0x95, 0xAF, 0x74, 0x03, 0xF0, +0x7B, 0x01, 0x7A, 0x95, 0x79, 0xAD, 0x12, 0x8E, +0x48, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0x90, 0x93, +0xF0, 0xE0, 0xFF, 0x70, 0x0A, 0x90, 0x93, 0xED, +0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, +0x00, 0x1F, 0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x01, +0xC5, 0x74, 0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, +0xA3, 0x74, 0xFD, 0xF0, 0xEF, 0x60, 0x06, 0x90, +0x01, 0xC4, 0x74, 0x07, 0xF0, 0x90, 0x93, 0xED, +0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x01, +0xF0, 0x90, 0x93, 0xEE, 0xE0, 0x60, 0x06, 0x90, +0x01, 0xC4, 0x74, 0x02, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x90, 0x95, 0xA9, 0x12, 0x04, 0x31, +0x90, 0x95, 0xA9, 0x22, 0x12, 0x04, 0xB8, 0x90, +0x92, 0x18, 0x02, 0x04, 0x31, 0xD3, 0x10, 0xAF, +0x01, 0xC3, 0xC0, 0xD0, 0x71, 0x41, 0x90, 0x97, +0x1D, 0x12, 0x04, 0x31, 0x90, 0x97, 0x1D, 0x51, +0xFC, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, +0x90, 0x01, 0x01, 0xE0, 0x44, 0x02, 0xF0, 0x90, +0x01, 0x00, 0x74, 0xFF, 0xF0, 0x90, 0x06, 0xB7, +0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, +0xF0, 0x12, 0xAF, 0xD6, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, +0xED, 0x44, 0x80, 0xFD, 0xEC, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x71, 0x41, 0x90, +0x97, 0x21, 0x12, 0x04, 0x31, 0x90, 0x97, 0x21, +0x51, 0xFC, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, +0xAD, 0x12, 0x88, 0xCA, 0x90, 0x06, 0xB7, 0x74, +0x11, 0xF0, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, +0x6A, 0x90, 0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, +0xF1, 0x90, 0x07, 0xD5, 0xE0, 0x44, 0x80, 0xF0, +0x7F, 0x0A, 0x80, 0x09, 0x90, 0x06, 0x62, 0xE0, +0x30, 0xE0, 0x09, 0x7F, 0x01, 0x7E, 0x00, 0x12, +0x7C, 0x6A, 0x80, 0xF0, 0x71, 0xBC, 0x90, 0x01, +0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, +0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, +0x90, 0x07, 0xD5, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x90, 0x00, 0x02, 0xE0, +0x54, 0xFE, 0xF0, 0x22, 0x90, 0x8A, 0x79, 0x74, +0x87, 0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x90, 0x8A, +0xE5, 0x74, 0xDD, 0xF0, 0xA3, 0x74, 0x58, 0xF0, +0x90, 0x8B, 0x03, 0x74, 0x8C, 0xF0, 0xA3, 0x74, +0xC2, 0xF0, 0x90, 0x8A, 0xB9, 0x74, 0x88, 0xF0, +0xA3, 0x74, 0xD7, 0xF0, 0x90, 0x8A, 0xD5, 0x74, +0x91, 0xF0, 0xA3, 0x74, 0xE6, 0xF0, 0x90, 0x8A, +0xFB, 0x74, 0x90, 0xF0, 0xA3, 0x74, 0x49, 0xF0, +0x90, 0x8A, 0xA5, 0x74, 0x9B, 0xF0, 0xA3, 0x74, +0xF3, 0xF0, 0x90, 0x8A, 0xB5, 0x74, 0x87, 0xF0, +0xA3, 0x74, 0xA5, 0xF0, 0x90, 0x8A, 0x75, 0x74, +0xD7, 0xF0, 0xA3, 0x74, 0xD1, 0xF0, 0x90, 0x8A, +0xC1, 0x74, 0x8E, 0xF0, 0xA3, 0x74, 0x63, 0xF0, +0x90, 0x8A, 0xC3, 0x74, 0xE2, 0xF0, 0xA3, 0x74, +0xB8, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xE2, 0xF0, +0xA3, 0x74, 0xF8, 0xF0, 0x90, 0x8A, 0x85, 0x74, +0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0x90, 0x86, +0x04, 0x74, 0xBE, 0xF0, 0xA3, 0x74, 0x0E, 0xF0, +0x90, 0x8A, 0xA9, 0x74, 0xE3, 0xF0, 0xA3, 0x74, +0x04, 0xF0, 0x90, 0x8B, 0x07, 0x74, 0xE3, 0xF0, +0xA3, 0x74, 0x33, 0xF0, 0x90, 0x8A, 0xAD, 0x74, +0xE3, 0xF0, 0xA3, 0x74, 0xE1, 0xF0, 0x90, 0x8A, +0xBB, 0x74, 0xE4, 0xF0, 0xA3, 0x74, 0xB6, 0xF0, +0x90, 0x86, 0x0C, 0x74, 0xDB, 0xF0, 0xA3, 0x74, +0x05, 0xF0, 0x90, 0x8A, 0xEF, 0x74, 0xDB, 0xF0, +0xA3, 0x74, 0x4E, 0xF0, 0x90, 0x86, 0x00, 0x74, +0xE8, 0xF0, 0xA3, 0x74, 0x93, 0xF0, 0x90, 0x86, +0x02, 0x74, 0xE8, 0xF0, 0xA3, 0x74, 0xF2, 0xF0, +0x90, 0x8A, 0xFD, 0x74, 0xA5, 0xF0, 0xA3, 0x74, +0xAF, 0xF0, 0x90, 0x8A, 0xF9, 0x74, 0xC1, 0xF0, +0xA3, 0x74, 0x48, 0xF0, 0x90, 0x8A, 0xDB, 0x74, +0xE1, 0xF0, 0xA3, 0x74, 0xBE, 0xF0, 0x90, 0x8A, +0xAF, 0x74, 0xAC, 0xF0, 0xA3, 0x74, 0xD1, 0xF0, +0x90, 0x8A, 0xD3, 0x74, 0x9D, 0xF0, 0xA3, 0x74, +0xE1, 0xF0, 0x90, 0x8A, 0xF5, 0x74, 0xE9, 0xF0, +0xA3, 0x74, 0xC5, 0xF0, 0x90, 0x8A, 0xA3, 0x74, +0xB5, 0xF0, 0xA3, 0x74, 0xDB, 0xF0, 0x90, 0x86, +0x06, 0x74, 0xAD, 0xF0, 0xA3, 0x74, 0xF5, 0xF0, +0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, +0x85, 0x4E, 0x90, 0x95, 0xD0, 0xEF, 0xF0, 0x60, +0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, +0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, +0xE0, 0x0F, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFE, +0xF0, 0xE4, 0xFF, 0x12, 0xD6, 0x49, 0x12, 0x93, +0xBA, 0xB1, 0x4F, 0x30, 0xE1, 0x09, 0x54, 0xFD, +0xF0, 0x90, 0x86, 0x08, 0x12, 0x88, 0xCD, 0xB1, +0x4F, 0x30, 0xE2, 0x09, 0x54, 0xFB, 0xF0, 0x90, +0x86, 0x0A, 0x12, 0x88, 0xCD, 0xB1, 0x4F, 0x30, +0xE6, 0x09, 0x54, 0xBF, 0xF0, 0x90, 0x8A, 0x7D, +0x12, 0x88, 0xCD, 0xD2, 0xAF, 0x80, 0xB2, 0xD2, +0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, 0xE0, 0x22, 0x8F, 0x0D, 0x7F, 0x02, 0x12, 0x85, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x0D, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, -0xAF, 0xF0, 0x74, 0xE0, 0xA3, 0xF0, 0x12, 0x6C, -0xD6, 0xE5, 0x25, 0x30, 0xE7, 0x03, 0x12, 0xCF, -0xA0, 0x74, 0xAF, 0x04, 0x90, 0x01, 0xC4, 0xF0, -0x74, 0xE0, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, -0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, -0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, -0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, -0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, -0x07, 0xF0, 0x74, 0xE1, 0xA3, 0xF0, 0x12, 0x75, -0x50, 0xE5, 0x3D, 0x30, 0xE0, 0x02, 0x31, 0xE2, -0xE5, 0x3D, 0x30, 0xE1, 0x02, 0x71, 0xB0, 0xE5, -0x3D, 0x30, 0xE2, 0x02, 0x31, 0xF4, 0xE5, 0x3D, -0x30, 0xE4, 0x02, 0x71, 0xA5, 0xE5, 0x3D, 0x30, -0xE5, 0x03, 0x12, 0xA7, 0xD1, 0xE5, 0x3E, 0x30, -0xE0, 0x02, 0x51, 0x55, 0xE5, 0x3E, 0x30, 0xE3, -0x03, 0x12, 0xCF, 0x9E, 0xE5, 0x3E, 0x30, 0xE4, -0x02, 0x71, 0xBC, 0xE5, 0x3F, 0x30, 0xE1, 0x02, -0x91, 0x7A, 0xE5, 0x3F, 0x30, 0xE0, 0x03, 0x12, -0xBF, 0x5E, 0xE5, 0x3F, 0x30, 0xE4, 0x02, 0x71, -0xA4, 0xE5, 0x3F, 0x30, 0xE2, 0x09, 0x71, 0xF3, -0x90, 0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, -0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, -0x8E, 0xC9, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, -0x40, 0x30, 0xE4, 0x03, 0x12, 0xBE, 0x34, 0xE5, -0x40, 0x30, 0xE5, 0x02, 0x51, 0x19, 0xE5, 0x40, -0x30, 0xE6, 0x02, 0x51, 0x9C, 0xE5, 0x40, 0x30, -0xE7, 0x02, 0x71, 0xD3, 0x74, 0x07, 0x04, 0x90, -0x01, 0xC4, 0xF0, 0x74, 0xE1, 0xA3, 0xF0, 0xD0, -0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, -0xE0, 0x32, 0x90, 0x93, 0x58, 0xE0, 0x30, 0xE0, -0x0A, 0x90, 0x93, 0xD8, 0xE0, 0x60, 0x04, 0x7F, -0x07, 0x71, 0x0F, 0x22, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x14, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, -0x08, 0x90, 0x8B, 0x01, 0x12, 0x8D, 0x33, 0x80, -0x05, 0x71, 0xA8, 0x12, 0xAF, 0x95, 0x90, 0x93, -0x5A, 0xE0, 0xB4, 0x01, 0x03, 0x12, 0x98, 0x39, -0x22, 0x90, 0x88, 0x31, 0x12, 0xBA, 0x92, 0x30, -0xE0, 0x32, 0xEF, 0x54, 0xBF, 0x51, 0xFB, 0x30, -0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, 0x08, -0xE0, 0x54, 0xFE, 0x71, 0x04, 0x74, 0x04, 0xF0, -0x90, 0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, -0x07, 0x30, 0xE0, 0x0D, 0x90, 0x8A, 0xB9, 0x12, -0x8E, 0xC9, 0x7D, 0x01, 0x7F, 0x0C, 0x02, 0x04, -0x7E, 0x12, 0xAF, 0x95, 0x22, 0x91, 0x35, 0x90, -0x96, 0x21, 0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, -0xE0, 0x13, 0x12, 0x8E, 0xC9, 0x7D, 0x01, 0xE4, -0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, -0x44, 0x04, 0xF0, 0x80, 0x06, 0x12, 0x8E, 0xC9, -0x12, 0xBC, 0x83, 0x90, 0x96, 0x21, 0xE0, 0x30, -0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, -0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, -0x74, 0x80, 0xF0, 0x12, 0xC7, 0xAE, 0x74, 0x02, -0xF0, 0x02, 0x6E, 0x2F, 0x90, 0x88, 0x31, 0xE0, -0xFF, 0x12, 0x8F, 0xE1, 0x30, 0xE0, 0x1E, 0xEF, -0x54, 0x7F, 0x51, 0xFB, 0x30, 0xE1, 0x06, 0xE0, -0x44, 0x02, 0xF0, 0x80, 0x07, 0xE0, 0x54, 0xFD, -0x71, 0x04, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x03, 0x12, 0xAF, 0x95, 0x90, 0x88, 0xA1, -0x12, 0xBA, 0x92, 0x30, 0xE0, 0x22, 0x90, 0x88, -0xA4, 0xE0, 0xFF, 0xC3, 0x13, 0x30, 0xE0, 0x18, -0xEF, 0x54, 0xFD, 0xF0, 0x90, 0x04, 0xE0, 0xE0, -0x90, 0x88, 0xA4, 0x30, 0xE1, 0x06, 0xE0, 0x44, -0x04, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xFB, 0xF0, -0x90, 0x04, 0xE0, 0xE0, 0x30, 0xE1, 0x03, 0x12, -0xA2, 0xCB, 0x22, 0xF0, 0x90, 0x04, 0xE0, 0xE0, -0x90, 0x88, 0x32, 0x22, 0xF0, 0x90, 0x01, 0xB9, -0x74, 0x01, 0xF0, 0x90, 0x01, 0xB8, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, 0x07, -0x90, 0x05, 0x63, 0xE0, 0xFE, 0x90, 0x05, 0x62, -0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, 0x3E, -0x90, 0x96, 0x56, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -0x05, 0x61, 0xE0, 0xFE, 0x90, 0x05, 0x60, 0xE0, -0x24, 0x00, 0xFF, 0xEA, 0x3E, 0xFE, 0xED, 0xB4, -0x08, 0x0A, 0x90, 0x05, 0x58, 0xE0, 0xFC, 0x2F, -0xFF, 0xEA, 0x3E, 0xFE, 0x90, 0x96, 0x33, 0x74, -0x17, 0xF0, 0x90, 0x96, 0x55, 0x74, 0x06, 0xF0, -0x90, 0x96, 0x35, 0xED, 0xF0, 0x90, 0x93, 0x58, -0xE0, 0xFD, 0xC3, 0x13, 0x54, 0x07, 0x71, 0x96, -0xE0, 0x90, 0x96, 0x36, 0xF0, 0xA3, 0xEF, 0xF0, -0xEE, 0xA3, 0xF0, 0x90, 0x96, 0x56, 0xE0, 0xFE, -0xA3, 0xE0, 0x90, 0x96, 0x39, 0xF0, 0xEE, 0xA3, -0xF0, 0x7B, 0x01, 0x7A, 0x96, 0x79, 0x33, 0x12, -0x8E, 0xB7, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xE5, 0x7D, 0x75, 0xF0, -0x1B, 0xA4, 0x24, 0x5B, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0x22, 0x22, 0x02, 0x34, 0x78, -0x90, 0x88, 0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0xAE, -0xD3, 0x02, 0x98, 0x39, 0x90, 0x93, 0x03, 0xE0, -0x30, 0xE0, 0x0F, 0x13, 0x13, 0x13, 0x54, 0x1F, -0x30, 0xE0, 0x07, 0x90, 0x04, 0x1F, 0xE0, 0x44, -0x40, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, -0xE0, 0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, -0x8A, 0x99, 0x12, 0x8D, 0x33, 0x90, 0x88, 0xF0, -0xE0, 0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, -0x8D, 0x33, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0x90, 0x88, 0xF0, 0xE0, 0x30, 0xE0, -0x2F, 0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x01, 0x18, -0xA3, 0xE0, 0xB4, 0x01, 0x23, 0x74, 0x02, 0xF0, -0x90, 0x88, 0xFE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x90, 0x8A, 0x7F, 0x12, 0xA7, 0x07, 0x80, 0x10, -0x90, 0x88, 0xF7, 0xE0, 0xB4, 0x02, 0x09, 0x74, -0x03, 0xF0, 0x90, 0x8A, 0xE7, 0x12, 0x8D, 0x33, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, 0x96, -0x23, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, 0x7B, -0x41, 0x90, 0x96, 0x22, 0xEF, 0xF0, 0x7F, 0x83, -0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, 0x96, 0x22, -0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, 0x90, -0x96, 0x24, 0xE0, 0x94, 0x64, 0x90, 0x96, 0x23, -0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, 0xC0, -0xE0, 0x44, 0x40, 0xF0, 0x90, 0x96, 0x22, 0xE0, -0xFF, 0x22, 0x90, 0x96, 0x23, 0x12, 0xA7, 0xD9, -0x80, 0xC2, 0x90, 0x88, 0x2C, 0xE0, 0xFF, 0x30, -0xE0, 0x4C, 0x90, 0x88, 0x30, 0xE0, 0x7E, 0x00, -0xB4, 0x02, 0x02, 0x7E, 0x01, 0x90, 0x88, 0x2F, -0xE0, 0x7D, 0x00, 0xB4, 0x04, 0x02, 0x7D, 0x01, -0xED, 0x4E, 0x70, 0x32, 0xEF, 0xC3, 0x13, 0x30, -0xE0, 0x03, 0x02, 0xBE, 0x76, 0x12, 0xAF, 0x36, -0x90, 0x88, 0x30, 0xE0, 0xB4, 0x0C, 0x0C, 0x90, -0x8A, 0xB9, 0x12, 0x8E, 0xC9, 0xE4, 0xFD, 0x7F, -0x08, 0x80, 0x10, 0x90, 0x88, 0x30, 0xE0, 0xB4, -0x04, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0xC9, -0xE4, 0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0xC0, -0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, -0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, -0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, -0xCF, 0xF0, 0x74, 0xE4, 0xA3, 0xF0, 0x90, 0x8A, -0x9D, 0x12, 0x8D, 0x33, 0x53, 0x91, 0xBF, 0x74, -0xCF, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xE4, +0x67, 0xF0, 0x74, 0xDD, 0xA3, 0xF0, 0x90, 0x8A, +0x9D, 0x12, 0x88, 0xCD, 0x53, 0x91, 0xBF, 0x74, +0x67, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xDD, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x25, 0x90, 0x01, -0xC4, 0xED, 0xF0, 0x74, 0xE5, 0xFF, 0xA3, 0xF0, +0xC0, 0x05, 0xC0, 0x07, 0x7D, 0xBD, 0x90, 0x01, +0xC4, 0xED, 0xF0, 0x74, 0xDD, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, 0xD0, -0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0x54, -0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x95, 0x53, -0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xC7, 0x9E, -0x90, 0x95, 0x56, 0xF0, 0x12, 0x7B, 0x07, 0x7C, -0x00, 0xAD, 0x07, 0x90, 0x95, 0x53, 0xE0, 0x90, -0x04, 0x25, 0xF0, 0x90, 0x95, 0x54, 0xE0, 0x60, -0x05, 0xD1, 0x21, 0x44, 0x80, 0xF0, 0xAF, 0x05, -0x74, 0x20, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -0xF5, 0x83, 0xE0, 0x54, 0xC0, 0xF0, 0xD1, 0x21, -0x54, 0xC0, 0xF0, 0x90, 0x95, 0x56, 0xE0, 0xFF, -0xAE, 0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, -0x8B, 0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, -0x04, 0xF0, 0xAF, 0x05, 0xD1, 0x16, 0xE0, 0x54, -0x01, 0xFE, 0x90, 0x95, 0x55, 0xE0, 0x25, 0xE0, -0x25, 0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0xFE, -0xD1, 0x16, 0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, -0xF0, 0x74, 0x29, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0xFC, 0xF5, 0x83, 0xE0, 0x54, 0xF7, 0xF0, 0x74, -0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, -0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, -0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x95, 0x53, -0xED, 0xF0, 0x64, 0x01, 0x60, 0x27, 0xE0, 0xFE, -0x64, 0x02, 0x60, 0x21, 0xEE, 0x64, 0x29, 0x60, -0x1C, 0xEE, 0x64, 0x2A, 0x60, 0x17, 0xEE, 0x64, -0x36, 0x60, 0x12, 0xEE, 0xB4, 0x37, 0x02, 0x80, -0x0C, 0xAD, 0x07, 0x7F, 0xFF, 0x12, 0xA7, 0xB9, -0x90, 0x93, 0xF4, 0xE0, 0xFF, 0x90, 0x93, 0xF3, -0xE0, 0x4F, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x95, -0x53, 0xE0, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x12, -0x02, 0x06, 0x90, 0x96, 0x59, 0xF0, 0x22, 0xEF, -0x64, 0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, -0x90, 0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, -0x60, 0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0x88, -0xE4, 0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, -0xEF, 0xB4, 0x09, 0x05, 0x90, 0x88, 0xE5, 0x80, -0x03, 0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x61, 0xAF, -0x61, 0x22, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x95, -0xEF, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, -0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, -0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, -0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, -0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, -0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, -0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, -0xEF, 0xB4, 0x01, 0x0D, 0xEB, 0xB4, 0x02, 0x03, -0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, -0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4D, -0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, -0xC4, 0x74, 0x0E, 0xF0, 0x74, 0xE7, 0xA3, 0xF0, -0x7F, 0x90, 0x12, 0x7B, 0x41, 0xEF, 0x20, 0xE0, -0xF7, 0x74, 0x0E, 0x04, 0x90, 0x01, 0xC4, 0xF0, -0x74, 0xE7, 0xA3, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xC7, 0x9E, 0x90, -0x97, 0x13, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, -0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0x67, -0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, -0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, 0x7F, -0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, 0xFE, -0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, 0xBD, 0xE0, -0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xBE, 0xE0, -0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x12, -0xA6, 0x54, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x16, -0x90, 0x93, 0x3B, 0xE0, 0x20, 0xE0, 0x0F, 0x90, -0x86, 0x0C, 0x12, 0x8D, 0x33, 0x90, 0x8A, 0xF9, -0x12, 0x8E, 0xC9, 0x12, 0xBC, 0x83, 0x22, 0x90, -0x95, 0x53, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0xEF, 0x54, 0xFC, 0xFF, -0x12, 0xD7, 0x7C, 0xE4, 0xFB, 0x90, 0x96, 0xE9, -0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, 0x08, 0xA4, -0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, 0xC4, 0x2B, -0xF5, 0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0xEF, -0xF0, 0x0B, 0xEB, 0xB4, 0x04, 0xDF, 0x90, 0x07, -0xC2, 0x12, 0xC7, 0x71, 0x90, 0x07, 0xC3, 0xE0, -0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x97, 0x10, 0x12, 0xD7, 0x75, 0x12, 0xE8, 0x5A, -0xFF, 0x70, 0x0D, 0x90, 0x07, 0xC4, 0xED, 0xF0, -0x90, 0x07, 0xC2, 0x74, 0x01, 0xF0, 0x80, 0x38, -0xEF, 0x64, 0x01, 0x4E, 0x70, 0x0D, 0x90, 0x07, -0xC5, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x02, -0xF0, 0x80, 0x25, 0x11, 0x5A, 0xFF, 0x64, 0x02, -0x70, 0x0D, 0x90, 0x07, 0xC6, 0xED, 0xF0, 0x90, -0x07, 0xC2, 0x74, 0x04, 0xF0, 0x80, 0x11, 0xEF, -0x64, 0x03, 0x4E, 0x70, 0x0B, 0x90, 0x07, 0xC7, -0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x08, 0xF0, -0x90, 0x07, 0xC3, 0x74, 0xC0, 0xF0, 0x90, 0x07, -0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x7E, 0x00, 0x90, 0x97, 0x11, 0xE0, -0x54, 0x03, 0x22, 0x90, 0x24, 0xA0, 0xE0, 0x90, -0x93, 0x03, 0x30, 0xE7, 0x05, 0xE0, 0x44, 0x02, -0xF0, 0x22, 0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, -0x8A, 0xEF, 0x12, 0x8D, 0x33, 0x90, 0x88, 0x2F, -0x74, 0x02, 0xF0, 0x22, 0xAE, 0x07, 0x12, 0xBA, -0xB7, 0xBF, 0x01, 0x16, 0x90, 0x88, 0x2C, 0x12, -0xA7, 0x00, 0x20, 0xE0, 0x0D, 0xAF, 0x06, 0x12, -0xAF, 0xBE, 0x7D, 0x01, 0x12, 0x04, 0x7E, 0x7F, -0x01, 0x22, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, -0x30, 0xE0, 0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, -0x13, 0x54, 0x07, 0x30, 0xE0, 0x12, 0x75, 0x0F, -0x10, 0x80, 0x2E, 0x12, 0x7A, 0x65, 0xEF, 0x64, -0x01, 0x60, 0x05, 0x75, 0x0F, 0x01, 0x80, 0x21, -0x90, 0x88, 0x31, 0x12, 0xBB, 0x56, 0x30, 0xE0, -0x05, 0x75, 0x0F, 0x02, 0x80, 0x13, 0x90, 0x88, -0x38, 0xE0, 0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, -0x0F, 0x08, 0x80, 0x05, 0x12, 0xC6, 0x81, 0x80, -0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, -0x01, 0xB8, 0xE5, 0x0F, 0xF0, 0x7F, 0x00, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, -0xE0, 0x1E, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, -0x75, 0x10, 0x40, 0x21, 0xAE, 0x90, 0x88, 0x38, -0xE0, 0xD3, 0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, -0x90, 0x88, 0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, -0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, -0x75, 0x10, 0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, -0xE0, 0xFF, 0x54, 0x03, 0x60, 0x05, 0x75, 0x10, -0x02, 0x80, 0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, -0xE4, 0xC3, 0x9E, 0x50, 0x05, 0x75, 0x10, 0x04, -0x80, 0x54, 0xEF, 0x30, 0xE2, 0x05, 0x75, 0x10, -0x08, 0x80, 0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, -0xE4, 0x05, 0x75, 0x10, 0x10, 0x80, 0x3F, 0x90, -0x88, 0x32, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, -0xE0, 0x05, 0x75, 0x10, 0x20, 0x80, 0x2F, 0x90, -0x88, 0x9C, 0xE0, 0x60, 0x05, 0x75, 0x10, 0x80, -0x80, 0x24, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, -0x05, 0x75, 0x10, 0x11, 0x80, 0x18, 0x90, 0x06, -0x62, 0xE0, 0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, -0xFF, 0xBF, 0x80, 0x05, 0x75, 0x10, 0x12, 0x80, -0x05, 0x12, 0xC6, 0x81, 0x80, 0x0E, 0x90, 0x01, -0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, -0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x12, 0xAF, 0xD7, 0x40, 0x40, 0x90, 0x88, -0x50, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, -0xFF, 0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, -0x2D, 0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, -0x88, 0x3F, 0x12, 0xBB, 0x5D, 0x33, 0x33, 0x33, -0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, -0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, -0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, -0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0xE4, -0xFE, 0x74, 0xF5, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -0x93, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x95, 0x2E, -0x12, 0xAD, 0x65, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, -0xB4, 0xA0, 0xE6, 0xE4, 0x90, 0x88, 0x4D, 0xF0, -0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, -0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, -0xE4, 0xA3, 0xF0, 0x22, 0xEF, 0x24, 0x01, 0xFF, -0xE4, 0x3E, 0xFE, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, -0xFC, 0x22, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, -0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x22, -0xFD, 0xEE, 0x13, 0x13, 0x54, 0x07, 0xFB, 0x90, -0x93, 0x58, 0xE0, 0xFE, 0xC4, 0x54, 0x0F, 0x90, -0x96, 0xFA, 0xF0, 0x22, 0x12, 0x04, 0xB8, 0x90, -0x05, 0x84, 0xEF, 0xF0, 0x7D, 0x20, 0xE4, 0xFF, -0x02, 0x7C, 0x05, 0x12, 0x04, 0xB8, 0x78, 0x08, -0x12, 0x03, 0xEB, 0x90, 0x05, 0x85, 0x22, 0x12, -0x04, 0xB8, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, -0x05, 0x86, 0x22, 0x90, 0x93, 0xD7, 0xE0, 0xFF, +0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, 0x88, +0x2C, 0xE0, 0x30, 0xE0, 0x05, 0xE4, 0xA3, 0xF0, +0xA3, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, +0xE0, 0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, +0x8A, 0x87, 0x12, 0x88, 0xCD, 0x90, 0x88, 0xE6, +0xE0, 0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, +0x90, 0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x21, +0x90, 0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x15, 0x12, +0xC5, 0x52, 0xF0, 0xE4, 0xFD, 0x12, 0x76, 0xF7, +0x90, 0x88, 0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, +0xA3, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, +0xF0, 0x12, 0xAC, 0xC7, 0x30, 0xE0, 0x13, 0x90, +0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, 0x14, +0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, 0x88, +0xE8, 0xF0, 0x90, 0x88, 0x2C, 0xE0, 0x30, 0xE0, +0x06, 0x90, 0x88, 0x2E, 0x74, 0x01, 0xF0, 0x90, +0x88, 0x36, 0xE0, 0x70, 0x02, 0xC1, 0xEE, 0x90, +0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x90, 0x05, 0x61, +0x12, 0xCD, 0xEC, 0x90, 0x05, 0x60, 0x12, 0x8F, +0xEA, 0x12, 0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, +0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, 0x12, +0x8F, 0xEA, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, +0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, +0x86, 0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, +0xC0, 0x07, 0xA3, 0x12, 0x8F, 0xEA, 0x78, 0x18, +0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0x86, 0x20, 0x90, 0x88, +0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, 0xE0, +0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, 0x0B, +0x12, 0xBE, 0x9E, 0x74, 0x05, 0xF0, 0x12, 0x6E, +0x2F, 0xF1, 0x0B, 0x90, 0x88, 0x32, 0x12, 0x9E, +0xC7, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, 0xE0, +0x30, 0xE4, 0x03, 0x12, 0xB5, 0x33, 0x90, 0x8A, +0xE5, 0x12, 0x8E, 0x5A, 0x7F, 0x01, 0x12, 0x04, +0x7E, 0x90, 0x93, 0x3B, 0xE0, 0x30, 0xE0, 0x0A, +0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x03, 0x12, +0xB5, 0x33, 0x22, 0x90, 0x88, 0x33, 0xE0, 0x54, +0xFE, 0xF0, 0x22, 0x90, 0x88, 0x2C, 0xE0, 0xFF, +0x30, 0xE0, 0x05, 0x12, 0xAB, 0x83, 0x60, 0x15, +0x90, 0x88, 0x36, 0xE0, 0x70, 0x04, 0xEF, 0x30, +0xE0, 0x0B, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x02, +0x60, 0x03, 0x12, 0xB1, 0x71, 0x22, 0x12, 0x9F, +0xD1, 0x70, 0x13, 0x90, 0x88, 0x36, 0xE0, 0x60, +0x0D, 0x90, 0x88, 0x3A, 0xE0, 0x20, 0xE4, 0x06, +0x12, 0xB5, 0xA1, 0x12, 0x9F, 0x4A, 0x22, 0xE4, +0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x19, 0x90, +0x88, 0x36, 0xE0, 0x60, 0x13, 0x12, 0xAF, 0xC1, +0x64, 0x02, 0x60, 0x09, 0x90, 0x8A, 0xE1, 0x12, +0xD7, 0xBF, 0x02, 0x04, 0x7A, 0x12, 0x73, 0x8F, +0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, +0x0F, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x09, 0xF1, +0x89, 0x54, 0x07, 0x70, 0x03, 0x12, 0xAF, 0x06, +0x22, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFE, 0xF0, +0x22, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x07, 0x90, +0x88, 0x2C, 0xE0, 0x30, 0xE0, 0x13, 0x90, 0x88, +0x2C, 0xE0, 0x30, 0xE0, 0x09, 0x12, 0x9F, 0xDA, +0xBF, 0x01, 0x06, 0x02, 0xAF, 0xA0, 0x12, 0xAE, +0xF2, 0x22, 0x12, 0x02, 0x06, 0x90, 0x96, 0x4C, +0xF0, 0x22, 0xE6, 0xFD, 0xAF, 0x67, 0xEF, 0x12, +0x93, 0x34, 0xE0, 0x54, 0xF8, 0xF5, 0x75, 0xED, +0x42, 0x75, 0xEF, 0x12, 0x93, 0x34, 0xE5, 0x75, +0xF0, 0x22, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, +0x90, 0x89, 0x2E, 0x12, 0x86, 0x42, 0x7B, 0xFF, +0x7A, 0x80, 0x79, 0x80, 0x90, 0x89, 0x31, 0x12, +0x86, 0x42, 0x7A, 0x80, 0x79, 0xBF, 0x90, 0x89, +0x34, 0x12, 0x86, 0x42, 0x7A, 0x81, 0x79, 0x61, +0x90, 0x89, 0x3A, 0x12, 0x86, 0x42, 0x7A, 0x81, +0x79, 0x75, 0x90, 0x89, 0x3D, 0x12, 0x86, 0x42, +0x7A, 0x81, 0x79, 0x9D, 0x90, 0x89, 0x40, 0x12, +0x86, 0x42, 0x11, 0x5E, 0x7A, 0x81, 0x79, 0xD9, +0x90, 0x89, 0x49, 0x12, 0x86, 0x42, 0x7A, 0x82, +0x79, 0x01, 0x90, 0x89, 0x4C, 0x12, 0x86, 0x42, +0xE4, 0x90, 0x96, 0x5D, 0xF0, 0x90, 0x96, 0x4C, +0xF0, 0x90, 0x95, 0x4E, 0xF0, 0x11, 0x55, 0x50, +0x0F, 0x74, 0x6E, 0x2F, 0x11, 0x4D, 0xE4, 0xF0, +0x90, 0x95, 0x4E, 0xE0, 0x04, 0xF0, 0x80, 0xED, +0x22, 0x74, 0x6E, 0x25, 0x67, 0xF5, 0x82, 0xE4, +0x34, 0x96, 0xF5, 0x83, 0x22, 0x90, 0x95, 0x4E, +0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x22, 0x7A, 0x81, +0x79, 0xB1, 0x90, 0x89, 0x46, 0x02, 0x86, 0x42, +0xE4, 0xF5, 0x7A, 0xEF, 0x14, 0xF5, 0x79, 0xED, +0xFF, 0xE5, 0x79, 0xF5, 0x82, 0x33, 0x95, 0xE0, +0xF5, 0x83, 0xC3, 0xE5, 0x82, 0x9F, 0x74, 0x80, +0xF8, 0x65, 0x83, 0x98, 0x40, 0x55, 0xE5, 0x79, +0x78, 0x03, 0xA2, 0xE7, 0x13, 0xD8, 0xFB, 0xFF, +0x33, 0x95, 0xE0, 0xFE, 0xEB, 0x12, 0x9F, 0xFA, +0xE5, 0x82, 0x2F, 0xF5, 0x82, 0xE5, 0x83, 0x3E, +0xF5, 0x83, 0xE0, 0xF5, 0x82, 0x75, 0x83, 0x00, +0xE5, 0x79, 0x54, 0x07, 0xFF, 0x12, 0xC2, 0x9F, +0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, +0xF9, 0xFF, 0xEE, 0x55, 0x83, 0xFE, 0xEF, 0x55, +0x82, 0x4E, 0x60, 0x13, 0x85, 0x79, 0x7B, 0x05, +0x7A, 0x90, 0x95, 0xE4, 0xE0, 0x65, 0x7A, 0x60, +0x0A, 0xE5, 0x7B, 0xD3, 0x9D, 0x40, 0x04, 0x15, +0x79, 0x80, 0x94, 0xAF, 0x7B, 0x22, 0xAA, 0x07, +0xA9, 0x05, 0xEA, 0x12, 0x90, 0xD4, 0xE0, 0xF5, +0x75, 0x54, 0x7F, 0xF5, 0x77, 0x75, 0xF0, 0x12, +0xEA, 0x31, 0xAC, 0xE0, 0x90, 0x95, 0xE0, 0xF0, +0x75, 0xF0, 0x12, 0xEA, 0x31, 0xB6, 0xFF, 0xEA, +0x12, 0x90, 0x3C, 0xE0, 0x54, 0x03, 0xF5, 0x76, +0xE5, 0x77, 0x90, 0x81, 0x9D, 0x93, 0xFD, 0xEA, +0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, +0x8D, 0xF5, 0x83, 0xE4, 0xF0, 0xA3, 0xED, 0xF0, +0x75, 0xF0, 0x12, 0xEA, 0x12, 0x9B, 0xEB, 0xFE, +0xC4, 0x54, 0x03, 0x90, 0x95, 0xDF, 0xF0, 0x74, +0xC6, 0x2A, 0x31, 0x99, 0xE5, 0x77, 0xF0, 0x74, +0x46, 0x2A, 0x31, 0xA1, 0xE5, 0x76, 0xF0, 0xE5, +0x77, 0xD3, 0x9F, 0x40, 0x04, 0x8F, 0x77, 0x8F, +0x75, 0x89, 0x78, 0xE4, 0xFF, 0xEF, 0xC3, 0x95, +0x78, 0x50, 0x33, 0xE5, 0x75, 0x30, 0xE7, 0x09, +0x85, 0x77, 0x75, 0x19, 0xE9, 0x70, 0x24, 0x80, +0x25, 0x90, 0x95, 0xE0, 0xE0, 0xFD, 0xE5, 0x77, +0xD3, 0x9D, 0x40, 0x0F, 0xAB, 0x02, 0x90, 0x95, +0xE4, 0xE9, 0xF0, 0xAF, 0x77, 0x11, 0x68, 0x8F, +0x75, 0x80, 0x0B, 0x90, 0x95, 0xE0, 0xE0, 0xF5, +0x75, 0x80, 0x03, 0x0F, 0x80, 0xC7, 0xAF, 0x02, +0x90, 0x92, 0x80, 0xE5, 0x76, 0xF0, 0xE4, 0xFB, +0xAD, 0x75, 0x02, 0x75, 0x80, 0x74, 0xC6, 0x25, +0x75, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, +0x22, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, +0x22, 0x75, 0xF0, 0x12, 0x90, 0x89, 0x50, 0x02, +0x04, 0x6E, 0x75, 0xF0, 0x12, 0xEF, 0x90, 0x89, +0x4F, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xEF, 0x64, +0x13, 0x60, 0x04, 0xEF, 0xB4, 0x0B, 0x05, 0x90, +0x88, 0xE3, 0x80, 0x1F, 0xEF, 0x64, 0x12, 0x60, +0x04, 0xEF, 0xB4, 0x0A, 0x05, 0x90, 0x88, 0xE4, +0x80, 0x11, 0xEF, 0x64, 0x11, 0x60, 0x04, 0xEF, +0xB4, 0x09, 0x05, 0x90, 0x88, 0xE5, 0x80, 0x03, +0x90, 0x88, 0xE2, 0xE0, 0xF5, 0x0F, 0xAF, 0x0F, +0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, 0x01, 0xF0, +0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, 0x90, 0x01, +0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, 0x12, 0xC7, +0xC4, 0x90, 0x01, 0x98, 0xE0, 0x54, 0xC0, 0x7F, +0x00, 0xB4, 0x40, 0x02, 0x7F, 0x01, 0x22, 0x90, +0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, 0xE4, 0x02, +0x7F, 0x01, 0x22, 0x90, 0x8A, 0x75, 0x12, 0x88, +0xCD, 0x90, 0x8A, 0xE5, 0x12, 0x8E, 0x5A, 0x7F, +0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, 0xCF, 0xE0, +0x90, 0x95, 0xE7, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, +0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, +0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, +0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, +0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, +0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, +0x7F, 0x03, 0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0xE4, 0xFE, 0xFD, 0xEF, 0xB4, 0x01, 0x0D, 0xEB, +0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, +0x01, 0x02, 0x7D, 0x02, 0xAF, 0x06, 0xEF, 0xC4, +0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0x90, 0x01, 0xC4, 0x74, 0x99, 0xF0, 0x74, +0xE2, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, 0x41, +0xEF, 0x20, 0xE0, 0xF7, 0x74, 0x99, 0x04, 0x90, +0x01, 0xC4, 0xF0, 0x74, 0xE2, 0xA3, 0xF0, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, +0xE8, 0x90, 0x97, 0x42, 0xF0, 0xED, 0x90, 0x00, +0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, 0x90, +0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, 0x0B, +0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, 0xE0, +0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, +0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, +0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, 0x90, 0x88, +0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, 0x90, 0x88, +0x36, 0xE0, 0x70, 0x16, 0x90, 0x93, 0x3B, 0xE0, +0x20, 0xE0, 0x0F, 0x90, 0x86, 0x0C, 0x12, 0x88, +0xCD, 0x90, 0x8A, 0xF9, 0x12, 0x8E, 0x5A, 0x12, +0xAC, 0x6E, 0x22, 0x90, 0x88, 0x9D, 0xE0, 0x30, +0xE0, 0x64, 0x90, 0x95, 0x38, 0xE0, 0x30, 0xE0, +0x43, 0x90, 0x95, 0x43, 0xE0, 0xFF, 0x90, 0x95, +0x42, 0xE0, 0xC3, 0x9F, 0x40, 0x2A, 0x71, 0x9F, +0x90, 0x06, 0xC4, 0xEF, 0xF0, 0x71, 0x9F, 0x78, +0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, +0xF0, 0x71, 0x9F, 0x78, 0x10, 0x12, 0x03, 0xEB, +0x90, 0x06, 0xC6, 0xEF, 0xF0, 0x71, 0x9F, 0x71, +0xA5, 0xE4, 0x90, 0x95, 0x42, 0xF0, 0x80, 0x1B, +0x71, 0xB0, 0x71, 0xA5, 0x90, 0x95, 0x42, 0xE0, +0x04, 0xF0, 0x80, 0x0F, 0x90, 0x95, 0x41, 0xE0, +0x60, 0x09, 0x71, 0xB0, 0x71, 0xA5, 0xE4, 0x90, +0x95, 0x41, 0xF0, 0x90, 0x8A, 0xBB, 0x12, 0x8E, +0x5A, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, +0x95, 0x39, 0x02, 0x04, 0xB8, 0x78, 0x18, 0x12, +0x03, 0xEB, 0x90, 0x06, 0xC7, 0xEF, 0xF0, 0x22, +0x90, 0x95, 0x3D, 0x12, 0x04, 0xB8, 0x90, 0x06, +0xC4, 0xEF, 0xF0, 0x90, 0x95, 0x3D, 0x12, 0x04, +0xB8, 0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, +0xC5, 0xEF, 0xF0, 0x90, 0x95, 0x3D, 0x12, 0x04, +0xB8, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, 0x06, +0xC6, 0xEF, 0xF0, 0x90, 0x95, 0x3D, 0x02, 0x04, +0xB8, 0x7E, 0x00, 0x7F, 0x33, 0x7D, 0x00, 0x7B, +0x01, 0x7A, 0x88, 0x79, 0x9D, 0x12, 0x04, 0x80, +0x90, 0x88, 0x9E, 0x74, 0x0B, 0xF0, 0xA3, 0x74, +0x08, 0xF0, 0x7E, 0x00, 0x7F, 0x14, 0x7D, 0x00, +0x7B, 0x01, 0x7A, 0x95, 0x79, 0x38, 0x12, 0x04, +0x80, 0x90, 0x86, 0xB3, 0xE0, 0xFC, 0x64, 0x02, +0x70, 0x18, 0x90, 0xFD, 0x80, 0xE0, 0x7E, 0x00, +0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0x91, 0x5C, +0xFE, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, 0x4E, +0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x0D, 0x90, +0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x30, 0xE2, 0x02, +0x7F, 0x01, 0x80, 0x13, 0x90, 0x86, 0xB3, 0xE0, +0x64, 0x03, 0x70, 0x17, 0x90, 0xFD, 0x78, 0xE0, +0x7F, 0x00, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0xEF, +0x91, 0x5C, 0xFF, 0x90, 0x88, 0xA0, 0xE0, 0x54, +0xBF, 0x4F, 0xF0, 0x22, 0x54, 0x01, 0xC4, 0x33, +0x33, 0x54, 0xC0, 0x22, 0x90, 0x97, 0x43, 0xEF, +0xF0, 0x90, 0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, +0x90, 0x8A, 0xF9, 0x12, 0x8E, 0x5A, 0x7D, 0x11, +0x12, 0xAC, 0xB5, 0x12, 0x88, 0xCD, 0x90, 0x07, +0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x97, +0x43, 0xE0, 0xFD, 0x70, 0x02, 0x80, 0x1C, 0xED, +0xB4, 0x01, 0x06, 0x91, 0xAF, 0x44, 0x20, 0xF0, +0x22, 0x90, 0x97, 0x43, 0xE0, 0xFD, 0xB4, 0x02, +0x06, 0x91, 0xAF, 0x44, 0x60, 0xF0, 0x22, 0xED, +0xB4, 0x03, 0x03, 0x91, 0xAF, 0xF0, 0x22, 0x90, +0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x95, 0x4E, +0x74, 0x02, 0xF0, 0x90, 0x88, 0xC2, 0xE0, 0x44, +0x10, 0xF0, 0x90, 0x88, 0xAF, 0xE0, 0x60, 0x02, +0xC1, 0x38, 0x90, 0x8A, 0xD9, 0x12, 0x8E, 0x5A, +0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xA1, +0xE0, 0x30, 0xE0, 0x04, 0x7F, 0x01, 0x80, 0x37, +0x90, 0x88, 0x9D, 0x12, 0xAC, 0xCA, 0x30, 0xE0, +0x04, 0x7F, 0x0D, 0x80, 0x2A, 0x90, 0x88, 0xA0, +0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x10, +0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x04, +0x7F, 0x09, 0x80, 0x13, 0x7F, 0x03, 0x80, 0x0F, +0x90, 0x88, 0xA0, 0xE0, 0xC3, 0x13, 0x30, 0xE0, +0x04, 0x7F, 0x03, 0x80, 0x02, 0x7F, 0x09, 0x12, +0x71, 0x9A, 0x90, 0x88, 0xAF, 0x74, 0x01, 0xD1, +0x4C, 0x30, 0xE0, 0x05, 0x12, 0xA4, 0xC2, 0x80, +0x2E, 0xD1, 0x44, 0x30, 0xE0, 0x29, 0x90, 0x88, +0xA3, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x88, 0x9C, +0xE0, 0x60, 0x0C, 0x90, 0x8A, 0xB9, 0x12, 0x8E, +0x5A, 0x7D, 0x01, 0x7F, 0x04, 0x80, 0x0D, 0x12, +0xA4, 0xC2, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0x5A, +0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, +0x88, 0x9C, 0xE0, 0x60, 0x06, 0x7B, 0x04, 0x7D, +0x6F, 0x80, 0x03, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, +0x12, 0xA4, 0xC7, 0x12, 0x8F, 0x87, 0x30, 0xE0, +0x0B, 0x90, 0x8A, 0x97, 0x12, 0x8E, 0x5A, 0x7F, +0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, 0xA1, 0xE0, +0xC3, 0x13, 0x30, 0xE0, 0x0E, 0x90, 0x06, 0xCD, +0xE0, 0x44, 0x10, 0xF0, 0x90, 0x06, 0xCF, 0xE0, +0x44, 0x10, 0xF0, 0x90, 0x05, 0x63, 0xE0, 0x90, +0x95, 0x52, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, +0x95, 0x51, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, +0x95, 0x50, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, +0x95, 0x4F, 0x12, 0xCD, 0xEA, 0x90, 0x95, 0x4F, +0x12, 0x8F, 0xEA, 0x12, 0x86, 0x20, 0xC0, 0x04, +0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, 0x8F, +0xE7, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xD0, 0x03, +0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x86, +0x20, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, +0x07, 0xA3, 0x12, 0x8F, 0xEA, 0x78, 0x18, 0x12, +0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, +0xD0, 0x00, 0x12, 0x86, 0x20, 0xA3, 0x12, 0x04, +0x31, 0x90, 0x88, 0xA1, 0x12, 0xB5, 0x2C, 0x30, +0xE0, 0x2E, 0x90, 0x95, 0x46, 0x12, 0x04, 0xB8, +0x90, 0x95, 0x53, 0xD1, 0x3D, 0x40, 0x21, 0x90, +0x95, 0x46, 0x12, 0x86, 0x2D, 0x90, 0x95, 0x53, +0x12, 0x04, 0xB8, 0x12, 0x85, 0xB6, 0xE4, 0xFB, +0x7A, 0x78, 0xF9, 0xF8, 0xC3, 0x12, 0x03, 0xDA, +0x50, 0x06, 0x90, 0x95, 0x4B, 0xE0, 0x04, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x86, 0x2D, +0xD3, 0x02, 0x03, 0xDA, 0x90, 0x88, 0x9D, 0xE0, +0xC4, 0x54, 0x0F, 0x22, 0xF0, 0x90, 0x88, 0x9D, +0xE0, 0xC4, 0x13, 0x54, 0x07, 0x22, 0x90, 0x24, +0xA0, 0xE0, 0x90, 0x93, 0x03, 0x30, 0xE7, 0x05, +0xE0, 0x44, 0x02, 0xF0, 0x22, 0xE0, 0x54, 0xFD, +0xF0, 0x22, 0x90, 0x88, 0x2F, 0xE0, 0x64, 0x02, +0x7F, 0x01, 0x60, 0x02, 0x7F, 0x00, 0x22, 0x90, +0x06, 0xA9, 0xE0, 0x90, 0x95, 0xE8, 0xF0, 0xE0, +0xFD, 0x54, 0xC0, 0x70, 0x05, 0x12, 0xDF, 0x89, +0x80, 0x64, 0xED, 0x30, 0xE6, 0x47, 0x90, 0x88, +0x36, 0xE0, 0x64, 0x02, 0x70, 0x29, 0x90, 0x88, +0x31, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x05, 0xD1, +0xF2, 0xF0, 0x80, 0x24, 0x12, 0xAF, 0xC1, 0x64, +0x01, 0x70, 0x2D, 0x90, 0x88, 0x3A, 0xE0, 0x44, +0x04, 0xF0, 0x90, 0x8A, 0x71, 0x12, 0x8E, 0x5A, +0x7F, 0x01, 0x12, 0x04, 0x7E, 0x80, 0x19, 0xD1, +0xF2, 0x12, 0xAF, 0xC0, 0x64, 0x02, 0x60, 0x08, +0x90, 0x8A, 0xE1, 0x12, 0x88, 0xCD, 0x80, 0x08, +0x12, 0x73, 0x8F, 0x80, 0x03, 0x12, 0xDF, 0x89, +0x90, 0x95, 0xE8, 0xE0, 0x90, 0x88, 0x3A, 0x30, +0xE7, 0x0B, 0x12, 0x9F, 0x47, 0x90, 0x88, 0x31, +0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0x54, 0xFD, +0xF0, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, +0x22, 0xE4, 0xF5, 0x7C, 0x90, 0x06, 0xA9, 0xE0, +0xF5, 0x7C, 0x54, 0xC0, 0x70, 0x12, 0x12, 0xDF, +0x89, 0x54, 0xFD, 0xF0, 0x12, 0xAF, 0x06, 0x90, +0x88, 0x39, 0xE0, 0x60, 0x3F, 0x02, 0xAF, 0xD6, +0xE5, 0x7C, 0x30, 0xE6, 0x1D, 0x90, 0x88, 0x36, +0xE0, 0x64, 0x01, 0x70, 0x18, 0xD1, 0xF2, 0x12, +0xAF, 0xC0, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, +0xE1, 0x12, 0x88, 0xCD, 0x80, 0x07, 0xF1, 0x55, +0x80, 0x03, 0x12, 0xDF, 0x89, 0xE5, 0x7C, 0x90, +0x88, 0x3A, 0x30, 0xE7, 0x0B, 0x12, 0x9F, 0x47, +0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, +0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x95, 0x37, +0x74, 0x01, 0xF0, 0x90, 0x06, 0x92, 0x04, 0xF0, +0x90, 0x01, 0x3C, 0x74, 0x04, 0xF0, 0x90, 0x88, +0x31, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x88, 0x39, +0xE0, 0x64, 0x0C, 0x60, 0x16, 0x90, 0x8A, 0xB9, +0x12, 0x8E, 0x5A, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, +0x04, 0x7E, 0x90, 0x8A, 0xF9, 0x12, 0x8E, 0x5A, +0x12, 0xAC, 0x6E, 0x90, 0x8A, 0xAF, 0x12, 0x8E, +0x5A, 0x7D, 0x08, 0xE4, 0xFF, 0x02, 0x04, 0x7E, +0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, +0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, 0x80, 0x12, +0xCF, 0x92, 0x12, 0x04, 0x80, 0xE4, 0x90, 0x95, +0x37, 0xF0, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, +0x90, 0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, +0x74, 0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, +0xA3, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x4E, 0x74, +0x10, 0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x12, 0xE9, +0xAF, 0x90, 0x8A, 0x89, 0x12, 0x8E, 0x5A, 0x12, +0xAC, 0x6E, 0x90, 0x8A, 0x89, 0x12, 0x8E, 0x5A, +0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, +0x8A, 0x89, 0x12, 0x8E, 0x5A, 0x7D, 0x0C, 0x7F, +0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, +0xFF, 0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, +0xDD, 0xF0, 0x80, 0x18, 0xEF, 0xB4, 0x03, 0x0F, +0x90, 0x88, 0x41, 0x74, 0xF4, 0xF0, 0x90, 0x00, +0x92, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x05, 0xE4, +0x90, 0x88, 0x41, 0xF0, 0x90, 0x00, 0x79, 0xE0, +0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0D, 0x90, 0x00, +0x28, 0xE0, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x53, +0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, 0x02, +0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, 0x54, +0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, 0xF0, +0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, +0x7A, 0x93, 0x79, 0x3F, 0x12, 0x04, 0x80, 0x90, +0x8A, 0xA3, 0x12, 0x8E, 0x5A, 0x7F, 0x01, 0x12, +0x04, 0x7E, 0x12, 0xAF, 0xC8, 0x7E, 0x00, 0xFF, +0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, 0x79, 0x9A, +0x12, 0x04, 0x80, 0x90, 0x06, 0x04, 0xE0, 0x54, +0x7F, 0xF0, 0x90, 0x06, 0x0A, 0xE0, 0x54, 0xF8, +0xF0, 0x90, 0x05, 0x22, 0xE4, 0xF0, 0x90, 0x88, +0x9C, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, +0x10, 0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, +0x07, 0x30, 0xE0, 0x12, 0x75, 0x11, 0x10, 0x80, +0x2E, 0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, +0x05, 0x75, 0x11, 0x01, 0x80, 0x21, 0x90, 0x88, +0x31, 0x12, 0x9E, 0xC7, 0x30, 0xE0, 0x05, 0x75, +0x11, 0x02, 0x80, 0x13, 0x90, 0x88, 0x38, 0xE0, +0xD3, 0x94, 0x04, 0x40, 0x05, 0x75, 0x11, 0x08, +0x80, 0x05, 0x12, 0xC7, 0xBC, 0x80, 0x0E, 0x90, +0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, +0xE5, 0x11, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x1E, +0x90, 0x88, 0xAF, 0xE0, 0x60, 0x05, 0x75, 0x12, +0x40, 0x21, 0x9C, 0x90, 0x88, 0x38, 0xE0, 0xD3, +0x94, 0x00, 0x40, 0x02, 0x80, 0x2D, 0x90, 0x88, +0x9C, 0xE0, 0x60, 0x7B, 0x80, 0x55, 0x12, 0x7A, +0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, 0x12, +0x01, 0x80, 0x71, 0x90, 0x88, 0x3A, 0xE0, 0xFF, +0x54, 0x03, 0x60, 0x05, 0x75, 0x12, 0x02, 0x80, +0x63, 0x90, 0x88, 0x38, 0xE0, 0xFE, 0xE4, 0xC3, +0x9E, 0x50, 0x05, 0x75, 0x12, 0x04, 0x80, 0x54, +0xEF, 0x30, 0xE2, 0x05, 0x75, 0x12, 0x08, 0x80, +0x4B, 0x90, 0x88, 0x3A, 0xE0, 0x30, 0xE4, 0x05, +0x75, 0x12, 0x10, 0x80, 0x3F, 0x90, 0x88, 0x32, +0xE0, 0x13, 0x13, 0x54, 0x3F, 0x20, 0xE0, 0x05, +0x75, 0x12, 0x20, 0x80, 0x2F, 0x90, 0x88, 0x9C, +0xE0, 0x60, 0x05, 0x75, 0x12, 0x80, 0x80, 0x24, +0x90, 0x06, 0x62, 0xE0, 0x30, 0xE1, 0x05, 0x75, +0x12, 0x11, 0x80, 0x18, 0x90, 0x06, 0x62, 0xE0, +0x30, 0xE0, 0x0C, 0xE0, 0x54, 0xFC, 0xFF, 0xBF, +0x80, 0x05, 0x75, 0x12, 0x12, 0x80, 0x05, 0x12, +0xC7, 0xBC, 0x80, 0x0E, 0x90, 0x01, 0xB9, 0x74, +0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x12, 0xF0, +0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, +0x88, 0x8D, 0x74, 0x18, 0xF0, 0xA3, 0xF0, 0xA3, +0xE4, 0xF0, 0xA3, 0x74, 0x64, 0xF0, 0xA3, 0x74, +0x05, 0xF0, 0xA3, 0xF0, 0x22, 0x51, 0x1A, 0xD3, +0x9F, 0x40, 0x41, 0x90, 0x88, 0x50, 0xE0, 0x04, +0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, 0x88, +0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2E, 0x90, 0x88, +0x48, 0xE0, 0x24, 0x08, 0xF0, 0x90, 0x88, 0x3F, +0x12, 0x9F, 0x3F, 0x33, 0x33, 0x33, 0x54, 0xF8, +0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, +0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, +0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, +0xF0, 0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x3F, +0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, +0xEF, 0xF0, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, +0x88, 0x3F, 0xE0, 0x22, 0x90, 0x88, 0x36, 0xE0, +0x64, 0x01, 0x70, 0x2A, 0x12, 0xAF, 0xC1, 0x60, +0x16, 0x90, 0x8A, 0xB9, 0x12, 0x8E, 0x5A, 0xE4, +0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, 0x8B, +0x01, 0x12, 0xD7, 0xBF, 0x02, 0x04, 0x7A, 0x90, +0x88, 0x39, 0xE0, 0x70, 0x09, 0x90, 0x8A, 0xB9, +0x12, 0x8E, 0x5A, 0x12, 0x9F, 0xBB, 0x22, 0x90, +0x97, 0x09, 0xA3, 0xE0, 0xFF, 0x90, 0x92, 0x13, +0x74, 0x03, 0xF0, 0x7B, 0x06, 0x7D, 0x01, 0x12, +0x66, 0xDB, 0x90, 0x97, 0x0D, 0xEE, 0xF0, 0xFC, +0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x97, 0x0C, 0xE0, +0xFF, 0x74, 0x10, 0x2D, 0xF5, 0x82, 0xE4, 0x34, +0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x97, 0x0B, +0x22, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, +0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, +0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, +0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, +0xF0, 0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, +0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x74, +0xFF, 0x9F, 0xFF, 0x74, 0xFF, 0x9E, 0xFE, 0xE5, +0x67, 0x22, 0xF5, 0x83, 0xE0, 0xFC, 0xA3, 0xE0, +0xFD, 0xD3, 0x9F, 0xEC, 0x9E, 0x22, 0xE5, 0x69, +0x25, 0xE0, 0x24, 0x75, 0xF5, 0x82, 0xE4, 0x34, +0x81, 0xF5, 0x83, 0x22, 0xEF, 0xC4, 0x54, 0xF0, +0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0x81, 0xF5, +0x83, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xED, +0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0x22, 0x90, 0x96, +0xD5, 0x12, 0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, +0xE4, 0xFF, 0x12, 0xA7, 0x7B, 0x90, 0x96, 0xD1, +0x22, 0x90, 0x95, 0xD1, 0x12, 0x86, 0x39, 0x90, +0x00, 0x08, 0x02, 0x03, 0x3E, 0xE4, 0x90, 0x92, +0x20, 0xF0, 0x90, 0x95, 0xF3, 0xE0, 0xFF, 0x90, +0x93, 0xD6, 0xE0, 0x2F, 0x22, 0x35, 0xF0, 0xFE, +0x90, 0x00, 0x06, 0x02, 0x03, 0x3E, 0xE0, 0x54, +0x03, 0x90, 0x92, 0x80, 0xF0, 0x7B, 0x01, 0xAF, +0x0E, 0x02, 0x75, 0x80, 0x12, 0x86, 0x2D, 0x02, +0x86, 0x13, 0x75, 0xF0, 0x02, 0xA4, 0xF5, 0x82, +0x85, 0xF0, 0x83, 0x02, 0x03, 0x3E, 0x90, 0x01, +0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x97, 0x2F, +0xE0, 0xFD, 0x22, 0x90, 0x93, 0xD7, 0xE0, 0xFF, 0x90, 0x93, 0xDA, 0xE0, 0xD3, 0x9F, 0x22, 0x74, 0xA6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0xF5, 0x83, 0x22, 0x74, 0x5F, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x74, 0xE6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, -0xF5, 0x83, 0x22, 0x74, 0xB6, 0x25, 0x67, 0xF5, -0x82, 0xE4, 0x34, 0x8D, 0xF5, 0x83, 0x22, 0x78, -0x10, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x8A, 0x22, -0x78, 0x08, 0x12, 0x03, 0xEB, 0x90, 0x05, 0x89, -0x22, 0xE0, 0x90, 0x92, 0x5E, 0xF0, 0xA3, 0x74, -0x02, 0x22, 0xE0, 0x90, 0x01, 0xBA, 0xF0, 0x90, -0x88, 0x38, 0x22, 0x90, 0x05, 0x22, 0xE0, 0x90, -0x96, 0x2F, 0xF0, 0x22, 0x90, 0x00, 0x06, 0x12, -0x03, 0x3E, 0x2F, 0xFF, 0x22, 0x12, 0x02, 0x06, -0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0xF0, 0xEE, -0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x22, 0xFE, -0x54, 0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0x22, -0x90, 0x93, 0x58, 0xE0, 0xFE, 0xC3, 0x13, 0x22, -0x93, 0xFD, 0x7C, 0x00, 0x02, 0x02, 0x80, 0xE5, -0x69, 0x90, 0x81, 0x9D, 0x93, 0xFF, 0x22, 0x90, -0x00, 0x04, 0x12, 0x03, 0x3E, 0x2F, 0x22, 0x90, -0x05, 0x00, 0x74, 0x1C, 0xF0, 0xA3, 0x22, 0xF5, -0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x22, 0x00, -0x88, 0xA9 +0xF5, 0x83, 0x22, 0xE5, 0x67, 0x25, 0xE0, 0x24, +0x86, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, 0x74, +0xB6, 0x25, 0x67, 0xF5, 0x82, 0xE4, 0x34, 0x8D, +0xF5, 0x83, 0x22, 0x90, 0x93, 0xF4, 0xE0, 0xFF, +0x90, 0x93, 0xF3, 0xE0, 0x4F, 0x22, 0x25, 0xE0, +0x24, 0x06, 0xF5, 0x82, 0xE4, 0x34, 0x8E, 0x22, +0x25, 0xE0, 0x24, 0x26, 0xF5, 0x82, 0xE4, 0x34, +0x8E, 0x22, 0x25, 0xE0, 0x24, 0x56, 0xF5, 0x82, +0xE4, 0x34, 0x8E, 0x22, 0x90, 0x92, 0x21, 0xF0, +0xE4, 0x90, 0x92, 0x20, 0xF0, 0x22, 0x90, 0x00, +0x02, 0x02, 0x03, 0x3E, 0x90, 0x00, 0x04, 0x02, +0x03, 0x3E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, +0x7F, 0x01, 0x22, 0x90, 0x88, 0xA1, 0xE0, 0xC4, +0x13, 0x54, 0x07, 0x22, 0x90, 0x88, 0x3C, 0xE0, +0x90, 0x05, 0x73, 0x22, 0x7D, 0x01, 0xAF, 0x67, +0x02, 0x61, 0xF7, 0xE5, 0x69, 0x90, 0x81, 0x9D, +0x93, 0xFF, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x96, +0xF5, 0x83, 0x22, 0x90, 0x95, 0xD8, 0xE0, 0xFE, +0xA3, 0xE0, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, +0xF0, 0xA3, 0x22, 0xF0, 0x24, 0x0A, 0x90, 0x88, +0xCF, 0xF0, 0x22, 0x00, 0xCE, 0x6A }; -u32 array_length_mp_8723d_fw_nic = 27506; +u32 array_length_mp_8723d_fw_nic = 27726; + +#ifdef CONFIG_WOWLAN u8 array_mp_8723d_fw_wowlan[] = { -0xD1, 0x23, 0x30, 0x00, 0x1B, 0x00, 0x00, 0x00, -0x12, 0x07, 0x14, 0x07, 0x2E, 0x7E, 0x02, 0x00, +0xD1, 0x23, 0x30, 0x00, 0x27, 0x00, 0x00, 0x00, +0x09, 0x15, 0x17, 0x39, 0xC0, 0x75, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x02, 0x88, 0xE9, 0x00, +0x00, 0x00, 0x00, 0x00, 0x02, 0x86, 0xA9, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xD3, 0xF2, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xB3, 0xA5, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xE2, 0x01, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xC6, 0x56, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xE0, 0xCA, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xD6, 0xD1, 0x00, 0x00, -0x00, 0x00, 0x00, 0x02, 0xE1, 0xAB, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xC5, 0xAF, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xBE, 0x78, 0x00, 0x00, +0x00, 0x00, 0x00, 0x02, 0xC6, 0x55, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, @@ -6491,78 +6534,6 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xEF, 0x2B, 0xFF, 0xEE, 0x3A, 0xFE, 0xED, 0x39, 0xFD, 0xEC, 0x38, 0xFC, 0x22, 0xC3, 0xEF, 0x9B, 0xFF, 0xEE, 0x9A, 0xFE, 0xED, 0x99, 0xFD, 0xEC, @@ -6628,11 +6599,11 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x09, 0xE0, 0xA3, 0xB5, 0xF0, 0x14, 0xDF, 0xF5, 0x80, 0x10, 0x88, 0x82, 0x8C, 0x83, 0xE3, 0xF5, 0xF0, 0x09, 0xE4, 0x93, 0xA3, 0xB5, 0xF0, 0x02, -0xDF, 0xF4, 0x02, 0x85, 0xC5, 0x80, 0x87, 0x80, +0xDF, 0xF4, 0x02, 0x83, 0x85, 0x80, 0x87, 0x80, 0xE9, 0x80, 0x90, 0x80, 0xD4, 0x80, 0x3E, 0x80, 0x15, 0x80, 0x6E, 0x80, 0x7E, 0x80, 0x9D, 0x80, 0xB7, 0x80, 0x8D, 0x80, 0xA3, 0x80, 0x51, 0x80, -0x74, 0x80, 0x3C, 0x02, 0x85, 0xD1, 0x89, 0x82, +0x74, 0x80, 0x3C, 0x02, 0x83, 0x91, 0x89, 0x82, 0x8A, 0x83, 0xEC, 0xFA, 0xE4, 0x93, 0xF5, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCC, 0xC5, 0x83, 0xCC, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, @@ -6666,8 +6637,8 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x01, 0x0E, 0x4E, 0x60, 0xAB, 0xED, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x98, 0xF5, 0x82, 0xEB, 0x24, 0x02, 0xB4, 0x04, 0x00, 0x50, 0x8E, 0x23, -0x23, 0x45, 0x82, 0x23, 0x90, 0x85, 0x0D, 0x73, -0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x86, 0x44, +0x23, 0x45, 0x82, 0x23, 0x90, 0x82, 0xCD, 0x73, +0xC2, 0xAF, 0x80, 0xFE, 0x32, 0x12, 0x84, 0x04, 0x85, 0xD0, 0x0B, 0x75, 0xD0, 0x08, 0xAA, 0xE0, 0xC2, 0x8C, 0xE5, 0x8A, 0x24, 0x67, 0xF5, 0x8A, 0xE5, 0x8C, 0x34, 0x79, 0xF5, 0x8C, 0xD2, 0x8C, @@ -6698,7 +6669,7 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x81, 0x74, 0x02, 0x60, 0x06, 0xFF, 0x08, 0x76, 0xFF, 0xDF, 0xFB, 0x7F, 0x03, 0xE4, 0x78, 0x80, 0xF6, 0x08, 0xF6, 0x08, 0xDF, 0xFA, 0x78, 0x81, -0x76, 0x30, 0x90, 0x89, 0x80, 0x74, 0x01, 0x93, +0x76, 0x30, 0x90, 0x87, 0x44, 0x74, 0x01, 0x93, 0xC0, 0xE0, 0xE4, 0x93, 0xC0, 0xE0, 0x43, 0x89, 0x01, 0x75, 0x8A, 0x60, 0x75, 0x8C, 0x79, 0xD2, 0x8C, 0xD2, 0xAF, 0x22, 0x02, 0xEF, 0xD3, 0x94, @@ -6717,13 +6688,13 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x69, 0x60, 0x09, 0x19, 0x19, 0xE7, 0x09, 0x09, 0xF7, 0x19, 0x80, 0xF3, 0x1E, 0x80, 0xD9, 0xEF, 0x24, 0x86, 0xF8, 0xE6, 0x04, 0xF8, 0xEF, 0x2F, -0x04, 0x90, 0x89, 0x80, 0x93, 0xF6, 0x08, 0xEF, +0x04, 0x90, 0x87, 0x44, 0x93, 0xF6, 0x08, 0xEF, 0x2F, 0x93, 0xF6, 0x7F, 0x00, 0x22, 0xEF, 0xD3, 0x94, 0x02, 0x40, 0x03, 0x7F, 0xFF, 0x22, 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xE6, 0x30, 0xE5, 0xF4, 0xC2, 0xAF, 0xE6, 0x54, 0x8C, 0xF6, 0xD2, 0xAF, 0xE5, 0x0C, 0xB5, 0x07, 0x0A, 0x74, 0x86, 0x2F, -0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x86, 0x8D, 0x50, +0xF8, 0xE6, 0xF5, 0x81, 0x02, 0x84, 0x4D, 0x50, 0x2E, 0x74, 0x87, 0x2F, 0xF8, 0xE6, 0xBF, 0x02, 0x02, 0x74, 0xFF, 0xFD, 0x18, 0xE6, 0xF9, 0x74, 0x86, 0x2F, 0xF8, 0xFB, 0xE6, 0xFC, 0xE9, 0x6C, @@ -6740,7 +6711,7 @@ u8 array_mp_8723d_fw_wowlan[] = { 0xEF, 0x23, 0x24, 0x81, 0xF8, 0xC2, 0xAF, 0xE6, 0x30, 0xE5, 0x05, 0x30, 0xE0, 0x02, 0xD2, 0xE4, 0xD2, 0xE2, 0xC6, 0xD2, 0xAF, 0x7F, 0x00, 0x30, -0xE2, 0x01, 0x0F, 0x02, 0x86, 0x8C, 0x8F, 0xF0, +0xE2, 0x01, 0x0F, 0x02, 0x84, 0x4C, 0x8F, 0xF0, 0xE4, 0xFF, 0xFE, 0xE5, 0x0C, 0x23, 0x24, 0x80, 0xF8, 0xC2, 0xA9, 0x30, 0xF7, 0x0D, 0x7F, 0x08, 0xE6, 0x60, 0x0B, 0x2D, 0xF6, 0x60, 0x30, 0x50, @@ -6749,10 +6720,10 @@ u8 array_mp_8723d_fw_wowlan[] = { 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x23, 0x0E, 0x30, 0xE2, 0x0C, 0xD2, 0xAF, 0x7F, 0x04, 0x80, 0x12, 0xC2, 0xAF, 0xE6, 0x10, 0xE7, 0x13, 0x54, 0xEC, -0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x86, 0x8D, 0x7F, +0x4E, 0xF6, 0xD2, 0xAF, 0x02, 0x84, 0x4D, 0x7F, 0x08, 0x08, 0xEF, 0x44, 0x83, 0xF4, 0xC2, 0xAF, 0x56, 0xC6, 0xD2, 0xAF, 0x54, 0x80, 0x4F, 0xFF, -0x22, 0x02, 0x89, 0x27, 0x02, 0x87, 0x1D, 0xE4, +0x22, 0x02, 0x86, 0xE7, 0x02, 0x84, 0xDD, 0xE4, 0x93, 0xA3, 0xF8, 0xE4, 0x93, 0xA3, 0x40, 0x03, 0xF6, 0x80, 0x01, 0xF2, 0x08, 0xDF, 0xF4, 0x80, 0x29, 0xE4, 0x93, 0xA3, 0xF8, 0x54, 0x07, 0x24, @@ -6760,7 +6731,7 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x20, 0xC8, 0x83, 0x40, 0x04, 0xF4, 0x56, 0x80, 0x01, 0x46, 0xF6, 0xDF, 0xE4, 0x80, 0x0B, 0x01, 0x02, 0x04, 0x08, 0x10, 0x20, 0x40, 0x80, 0x90, -0x89, 0x6C, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, +0x87, 0x2C, 0xE4, 0x7E, 0x01, 0x93, 0x60, 0xBC, 0xA3, 0xFF, 0x54, 0x3F, 0x30, 0xE5, 0x09, 0x54, 0x1F, 0xFE, 0xE4, 0x93, 0xA3, 0x60, 0x01, 0x0E, 0xCF, 0x54, 0xC0, 0x25, 0xE0, 0x60, 0xA8, 0x40, @@ -6768,1975 +6739,1901 @@ u8 array_mp_8723d_fw_wowlan[] = { 0xF8, 0xE4, 0x93, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xF0, 0xA3, 0xC8, 0xC5, 0x82, 0xC8, 0xCA, 0xC5, 0x83, 0xCA, 0xDF, 0xE9, -0xDE, 0xE7, 0x80, 0xBE, 0x41, 0x9C, 0xAB, 0x00, -0x41, 0x9B, 0x66, 0x00, 0x41, 0x9A, 0xE5, 0x00, -0x44, 0x9C, 0x8C, 0x00, 0x50, 0xF2, 0x01, 0x00, -0xC3, 0x1D, 0xD9, 0x71, 0x8F, 0x5B, 0x90, 0x9C, -0xA7, 0xEF, 0xF0, 0x7F, 0x02, 0x11, 0x67, 0x90, -0x86, 0xAF, 0xE0, 0xFF, 0x90, 0x9C, 0xA7, 0xE0, -0xFE, 0xEF, 0x4E, 0x90, 0x86, 0xAF, 0xF0, 0x22, -0x12, 0xF6, 0x9D, 0x90, 0x86, 0xB4, 0xD1, 0xE7, -0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB5, 0xF1, 0xC7, -0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB6, 0x12, 0xBF, -0x9B, 0xED, 0x2F, 0x90, 0x86, 0xB7, 0x12, 0xA2, -0x20, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB8, 0x12, -0xA1, 0x20, 0xFF, 0xED, 0x2F, 0x90, 0x86, 0xB9, -0x12, 0xF6, 0x58, 0x90, 0x86, 0xBA, 0xF0, 0x22, -0x90, 0x99, 0x89, 0x12, 0x84, 0x67, 0x90, 0x99, -0x88, 0xEF, 0xF0, 0x12, 0x84, 0x70, 0x8A, 0x62, -0x00, 0x8A, 0x66, 0x01, 0x8A, 0x6A, 0x03, 0x8A, -0x6F, 0x04, 0x8A, 0x74, 0x06, 0x8A, 0x85, 0x12, -0x8A, 0x8A, 0x14, 0x8A, 0x8F, 0x1E, 0x8A, 0x94, -0x20, 0x8A, 0x99, 0x25, 0x8A, 0x9E, 0x27, 0x8A, -0xA2, 0x29, 0x8A, 0xA7, 0x2A, 0x8A, 0xAC, 0x60, -0x8A, 0xB0, 0x61, 0x8A, 0xB5, 0x62, 0x8A, 0xBA, -0x63, 0x8A, 0xBF, 0x64, 0x8A, 0xC4, 0x65, 0x8A, -0xC9, 0x66, 0x8A, 0xCE, 0x67, 0x8A, 0xD3, 0x68, -0x8A, 0xD8, 0x69, 0x8A, 0xDD, 0x6B, 0x8A, 0xE2, -0x6C, 0x8A, 0xE7, 0x6D, 0x8A, 0xEC, 0x6E, 0x8A, -0xF1, 0x6F, 0x8A, 0xF6, 0x70, 0x8B, 0x00, 0x80, -0x8A, 0xFB, 0x81, 0x8B, 0x05, 0x82, 0x8B, 0x0A, -0x83, 0x8B, 0x0F, 0x84, 0x8B, 0x19, 0x86, 0x8B, -0x14, 0x88, 0x8B, 0x1E, 0xC3, 0x8A, 0x79, 0xC6, -0x8A, 0x79, 0xC7, 0x8A, 0x79, 0xC8, 0x00, 0x00, -0x8B, 0x23, 0x71, 0x33, 0x21, 0xA0, 0x71, 0x33, -0x61, 0x39, 0x71, 0x33, 0x02, 0xF3, 0x9E, 0x71, -0x33, 0x02, 0xF7, 0x27, 0x71, 0x33, 0x02, 0xD0, -0x66, 0x90, 0x99, 0x88, 0xE0, 0xFF, 0xA3, 0x12, -0x84, 0x5E, 0x02, 0xD1, 0x02, 0x71, 0x33, 0x02, -0x98, 0x01, 0x71, 0x33, 0x02, 0x9F, 0xFF, 0x71, -0x33, 0x02, 0x98, 0xC8, 0x71, 0x33, 0x02, 0xA0, -0x0E, 0x71, 0x33, 0x02, 0xA7, 0xF9, 0x71, 0x33, -0xE1, 0xD6, 0x71, 0x33, 0x02, 0xBF, 0xED, 0x71, -0x33, 0x02, 0xB7, 0xF1, 0x71, 0x33, 0x81, 0x0A, -0x71, 0x33, 0x02, 0x77, 0x4F, 0x71, 0x33, 0x02, -0x7C, 0x60, 0x71, 0x33, 0x02, 0x7A, 0xC6, 0x71, -0x33, 0x02, 0x5D, 0x36, 0x71, 0x33, 0x02, 0x7B, -0xE9, 0x71, 0x33, 0x02, 0x70, 0x33, 0x71, 0x33, -0x02, 0x48, 0xC9, 0x71, 0x33, 0x02, 0x79, 0xF3, -0x71, 0x33, 0x02, 0xA2, 0xB4, 0x71, 0x33, 0x02, -0x51, 0x7B, 0x71, 0x33, 0x02, 0x79, 0x30, 0x71, -0x33, 0x02, 0x57, 0xF2, 0x71, 0x33, 0x02, 0x74, -0x8D, 0x71, 0x33, 0x02, 0x78, 0x9A, 0x71, 0x33, -0x02, 0x5E, 0x0B, 0x71, 0x33, 0x02, 0xBB, 0x2F, -0x71, 0x33, 0x02, 0xBA, 0x2D, 0x71, 0x33, 0x02, -0xF6, 0x12, 0x71, 0x33, 0x02, 0xF6, 0x20, 0x71, -0x33, 0x02, 0xF6, 0x65, 0x71, 0x33, 0x02, 0xF6, -0xAB, 0x71, 0x33, 0x02, 0xBC, 0x4D, 0x71, 0x33, -0x02, 0xC0, 0x03, 0x90, 0x01, 0xC0, 0xE0, 0x44, -0x01, 0xF0, 0x90, 0x99, 0x88, 0xE0, 0x90, 0x01, -0xC2, 0xF0, 0x22, 0x90, 0x99, 0x89, 0x02, 0x84, -0x5E, 0x12, 0xA7, 0xDE, 0x90, 0x98, 0x25, 0xE0, -0x70, 0x12, 0x91, 0x04, 0x12, 0x02, 0x06, 0x13, -0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, 0x98, -0x2B, 0x74, 0x01, 0xF0, 0x90, 0x98, 0x27, 0xE0, -0x70, 0x12, 0x91, 0x04, 0x12, 0x02, 0x06, 0xC4, -0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x98, -0x2C, 0x74, 0x01, 0xF0, 0x91, 0x04, 0xD1, 0xE8, -0xFF, 0x90, 0x99, 0x90, 0xF0, 0x12, 0x02, 0x06, -0xC3, 0x13, 0x30, 0xE0, 0x0A, 0x91, 0x04, 0xF1, -0xC8, 0x90, 0x99, 0x91, 0xF0, 0x80, 0x05, 0x90, -0x99, 0x91, 0xEF, 0xF0, 0x90, 0x99, 0x90, 0xE0, -0x90, 0x99, 0x8F, 0xF0, 0x90, 0x99, 0x91, 0xE0, -0xFE, 0x90, 0x99, 0x8F, 0xE0, 0xFF, 0xD3, 0x9E, -0x50, 0x3B, 0x91, 0x04, 0x12, 0x02, 0x06, 0x54, -0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, 0x99, 0x8F, -0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x90, 0x99, -0x8F, 0x70, 0x07, 0xE0, 0xFF, 0x12, 0xCF, 0xF6, -0x80, 0x05, 0xE0, 0xFF, 0x12, 0xCF, 0xE9, 0x90, -0x98, 0x2C, 0xE0, 0x60, 0x08, 0x90, 0x99, 0x8F, -0xE0, 0xFF, 0x12, 0xCF, 0xF6, 0x90, 0x99, 0x8F, -0xE0, 0x04, 0xF0, 0x80, 0xB7, 0x90, 0x05, 0x5E, -0xE4, 0xF0, 0x90, 0x99, 0x90, 0xE0, 0x70, 0x1A, -0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, 0x90, -0x86, 0x0C, 0xD1, 0xDC, 0x90, 0x8A, 0xED, 0xD1, -0xDC, 0x12, 0xD7, 0xA5, 0x54, 0xBF, 0xF0, 0x54, -0x7F, 0xF0, 0x22, 0xF0, 0x90, 0x99, 0x8C, 0x02, -0x84, 0x5E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x12, 0xA7, 0xDE, 0x12, 0xBC, 0x45, 0x90, -0x88, 0x9D, 0x12, 0xBD, 0x18, 0x4F, 0xF0, 0xFC, -0x12, 0x02, 0x06, 0xFD, 0x54, 0x04, 0x13, 0x13, -0x54, 0x3F, 0xFF, 0x90, 0x99, 0x7C, 0xE0, 0x54, -0xFE, 0x4F, 0xF0, 0xED, 0x54, 0x08, 0xFF, 0xEC, -0x54, 0xF7, 0x4F, 0xFF, 0x90, 0x88, 0x9D, 0xF0, -0x12, 0x02, 0x06, 0x12, 0xBF, 0xE3, 0x90, 0x88, -0x9D, 0x12, 0xBB, 0x1F, 0x12, 0xBF, 0xAD, 0x90, -0x88, 0x9D, 0x12, 0xBF, 0xB6, 0x4E, 0x91, 0x03, -0xE9, 0x24, 0x01, 0xF9, 0xE4, 0x3A, 0x8B, 0x45, -0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x7B, -0x01, 0x7A, 0x88, 0x79, 0x9E, 0x12, 0x69, 0xF5, -0x91, 0x04, 0x12, 0x02, 0x06, 0x20, 0xE0, 0x02, -0xC1, 0x1C, 0x90, 0x05, 0x54, 0xE0, 0x90, 0x88, -0xAE, 0xF0, 0xE0, 0xC3, 0x13, 0x90, 0x88, 0xAD, -0xF0, 0x90, 0x88, 0xA0, 0xE0, 0xC4, 0x54, 0x0F, -0x30, 0xE0, 0x13, 0xD1, 0xE8, 0x90, 0x88, 0x9E, -0xF0, 0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF1, 0xC7, -0x90, 0x88, 0x9F, 0xF0, 0x80, 0x48, 0xD1, 0xE8, -0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x14, 0xEF, 0xC3, -0x94, 0x03, 0x50, 0x07, 0x90, 0x88, 0x9E, 0x74, -0x03, 0x80, 0x0C, 0xD1, 0xE8, 0x90, 0x88, 0x9E, -0x80, 0x05, 0x90, 0x88, 0x9E, 0x74, 0x2A, 0xF0, -0x24, 0x0A, 0x90, 0x88, 0xCF, 0xF0, 0xF1, 0xC8, -0xFF, 0xC3, 0x94, 0x2A, 0x50, 0x12, 0xEF, 0xC3, -0x94, 0x03, 0x90, 0x88, 0x9F, 0x50, 0x05, 0x74, -0x03, 0xF0, 0x80, 0x0A, 0xEF, 0xF0, 0x80, 0x06, -0x90, 0x88, 0x9F, 0x74, 0x2A, 0xF0, 0x12, 0xAE, -0xCF, 0x30, 0xE0, 0x3D, 0x90, 0x88, 0x9E, 0xE0, -0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA6, 0xF0, -0xE0, 0xC3, 0x13, 0xA3, 0xF0, 0x90, 0x88, 0x9F, -0xE0, 0x75, 0xF0, 0x03, 0x84, 0x90, 0x88, 0xA8, -0xF0, 0x90, 0x88, 0x9E, 0xE0, 0xC3, 0x13, 0x90, -0x88, 0xA9, 0xF0, 0x90, 0x88, 0x9F, 0xE0, 0xC3, -0x13, 0x90, 0x88, 0xAA, 0xF0, 0x90, 0x01, 0x3E, -0x74, 0x08, 0xF0, 0xFD, 0x7F, 0x02, 0x12, 0x7C, -0x05, 0xE4, 0x90, 0x88, 0xDD, 0x91, 0x03, 0x12, -0xFC, 0xED, 0x20, 0xE0, 0x37, 0x90, 0x88, 0x9D, -0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x06, 0x12, 0xE8, -0xB5, 0x30, 0xE0, 0x28, 0x12, 0xFD, 0xCB, 0x30, -0xE0, 0x08, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x08, -0x80, 0x0B, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x05, -0x75, 0x0D, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x0D, -0x90, 0x8A, 0xF3, 0xF1, 0x00, 0x7D, 0x02, 0xAF, -0x0D, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x9D, 0xE0, -0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x1D, 0x90, 0x88, -0xA1, 0xE0, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -0x0C, 0x90, 0x8A, 0x89, 0xF1, 0x00, 0x7D, 0x04, -0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0xFE, 0x23, -0x74, 0x11, 0xF0, 0x90, 0x99, 0x7C, 0xE0, 0x30, -0xE0, 0x33, 0x90, 0x99, 0x85, 0x74, 0x01, 0xF0, -0xE4, 0xA3, 0xF0, 0x90, 0x06, 0xC7, 0xE0, 0xFE, -0x90, 0x06, 0xC6, 0x12, 0xBE, 0x88, 0xFE, 0xE4, -0xFD, 0x78, 0x10, 0x12, 0xA7, 0xC4, 0x90, 0x06, -0xC5, 0xE0, 0xFE, 0x90, 0x06, 0xC4, 0x12, 0xBE, -0x88, 0xFE, 0xE4, 0xFD, 0x12, 0x84, 0x45, 0x90, -0x99, 0x81, 0x12, 0x04, 0x31, 0x90, 0x05, 0x58, -0x74, 0x02, 0xF0, 0x90, 0x88, 0xA5, 0xE0, 0xB4, -0x01, 0x08, 0x90, 0x88, 0xB0, 0x74, 0x01, 0xF0, -0x80, 0x2B, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x04, -0x08, 0x90, 0x88, 0xB0, 0x74, 0x04, 0xF0, 0x80, -0x1C, 0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x06, 0x08, -0x90, 0x88, 0xB0, 0x74, 0x02, 0xF0, 0x80, 0x0D, -0x90, 0x88, 0xA5, 0xE0, 0xB4, 0x07, 0x06, 0x90, -0x88, 0xB0, 0x74, 0x05, 0xF0, 0xE4, 0x90, 0x88, -0xA5, 0xF0, 0x80, 0x6A, 0x91, 0x04, 0x12, 0xFC, -0xED, 0x30, 0xE0, 0x05, 0x75, 0x0E, 0x02, 0x80, -0x0E, 0x12, 0xFD, 0xCB, 0x30, 0xE0, 0x05, 0x75, -0x0E, 0x01, 0x80, 0x03, 0xE4, 0xF5, 0x0E, 0x90, -0x8A, 0xF1, 0xD1, 0xDC, 0x90, 0x89, 0x04, 0xE0, -0x90, 0x00, 0x40, 0x30, 0xE0, 0x07, 0xE0, 0x54, -0x0F, 0x44, 0xA0, 0x80, 0x05, 0xE0, 0x54, 0x0F, -0x44, 0x20, 0xFD, 0x7F, 0x40, 0x12, 0x7B, 0x2E, -0x91, 0x04, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, -0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x04, -0x7F, 0x03, 0x80, 0x02, 0x7F, 0x01, 0x12, 0x71, -0x9A, 0x90, 0x8A, 0xF3, 0xF1, 0x00, 0xAD, 0x0E, -0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x99, 0x1A, -0x12, 0xFE, 0x23, 0x74, 0x43, 0xF0, 0x90, 0x88, -0xA3, 0xE0, 0x54, 0xDF, 0xF0, 0xE4, 0x90, 0x88, -0xAF, 0xF0, 0x90, 0x88, 0xA0, 0x12, 0xE8, 0xB5, -0x30, 0xE0, 0x09, 0x90, 0x88, 0xD0, 0xE0, 0x44, -0x02, 0xF0, 0x80, 0x11, 0x90, 0x8A, 0x97, 0xF1, -0x00, 0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x88, -0xD0, 0xE0, 0x54, 0xFD, 0xF0, 0x90, 0x8A, 0xD9, -0xF1, 0x00, 0x7F, 0x03, 0x12, 0x04, 0x7E, 0x90, -0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x07, 0x90, 0x88, -0xA1, 0xE0, 0x54, 0xBF, 0xF0, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, 0x99, -0x1F, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, 0xE0, -0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0x4E, 0xF0, -0x90, 0x00, 0x01, 0x02, 0x02, 0x1F, 0x90, 0x8A, -0x77, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, -0x8E, 0x83, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, -0xE0, 0xFE, 0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, -0x22, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x08, -0x12, 0xC7, 0x55, 0x44, 0x01, 0x12, 0xEF, 0x90, -0x90, 0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x3B, 0x90, -0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x33, 0x90, -0x8A, 0xD7, 0xD1, 0xDC, 0x12, 0xA7, 0xE4, 0x60, -0x1B, 0x90, 0x8A, 0xB9, 0xF1, 0x00, 0xE4, 0xFD, -0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xF9, -0xF1, 0x00, 0x12, 0xC8, 0x3E, 0x12, 0xD5, 0xD3, -0xF9, 0x02, 0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, -0x70, 0x08, 0x90, 0x8A, 0xB9, 0xF1, 0x00, 0x12, -0xD3, 0x98, 0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, -0x01, 0x11, 0x8E, 0x90, 0x9A, 0x0E, 0xEF, 0xF0, -0x60, 0xF1, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, -0x04, 0xA3, 0xE0, 0x60, 0xE6, 0xC2, 0xAF, 0xEF, -0x30, 0xE1, 0x0C, 0x90, 0x86, 0xAF, 0xE0, 0x54, -0xFD, 0xF0, 0x90, 0x86, 0x08, 0xD1, 0xDC, 0xF1, -0xCE, 0xE0, 0x30, 0xE2, 0x08, 0x54, 0xFB, 0xF0, -0x90, 0x86, 0x0A, 0xD1, 0xDC, 0xF1, 0xCE, 0xE0, -0xFF, 0x30, 0xE4, 0x0C, 0x54, 0xEF, 0xF0, 0x12, -0xC4, 0x76, 0xBF, 0x01, 0x03, 0x12, 0xA9, 0xCD, -0xF1, 0xCE, 0xE0, 0x30, 0xE6, 0x08, 0x54, 0xBF, -0xF0, 0x90, 0x8A, 0x7D, 0xD1, 0xDC, 0xF1, 0xCE, -0xE0, 0xFF, 0x30, 0xE7, 0x06, 0x54, 0x7F, 0xF0, -0x12, 0xCD, 0xF1, 0xD2, 0xAF, 0x80, 0xA3, 0xF0, -0x90, 0x00, 0x02, 0x02, 0x02, 0x1F, 0xD2, 0xAF, -0xC2, 0xAF, 0x90, 0x86, 0xAF, 0x22, 0x12, 0xBC, -0x45, 0x90, 0x93, 0x08, 0x12, 0xBD, 0x18, 0x4F, -0xD1, 0xE7, 0x90, 0x93, 0x09, 0xF1, 0xC7, 0x90, -0x93, 0x0A, 0xF0, 0x12, 0xD7, 0xB6, 0xF0, 0x90, -0x93, 0x08, 0xE0, 0x54, 0x01, 0xFF, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xE0, -0xEF, 0xF0, 0x90, 0x93, 0x04, 0x31, 0xE0, 0x30, -0xE0, 0x3C, 0x90, 0x95, 0xC1, 0x12, 0xCC, 0xC4, -0x60, 0x10, 0x12, 0xFD, 0x0D, 0x40, 0x0B, 0xE4, -0x7F, 0x0A, 0xFE, 0xFD, 0xFC, 0x90, 0x95, 0xC5, -0x80, 0x09, 0xE4, 0x7F, 0x0A, 0xFE, 0xFD, 0xFC, -0x90, 0x95, 0xBD, 0x12, 0x84, 0x52, 0x12, 0x83, -0x1B, 0xC0, 0x07, 0x90, 0x93, 0x0A, 0xE0, 0xFB, -0xE4, 0xFA, 0xF9, 0xF8, 0xD0, 0x07, 0x12, 0x83, -0xA6, 0x90, 0x93, 0x0B, 0xEF, 0xF0, 0x90, 0x9A, -0xE0, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0x11, 0x90, -0x60, 0x0A, 0x11, 0x89, 0x12, 0x7C, 0x05, 0x12, -0xD7, 0xAD, 0x80, 0x08, 0x11, 0x89, 0x12, 0x7C, -0x3B, 0x12, 0xE3, 0x93, 0x12, 0x79, 0xD4, 0x80, -0x17, 0x11, 0x90, 0x60, 0x07, 0x11, 0x89, 0x12, -0x7C, 0x05, 0x80, 0x05, 0x11, 0x89, 0x12, 0x7C, -0x3B, 0xF1, 0xCB, 0xF1, 0xD9, 0x12, 0x7B, 0xCC, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, -0x3F, 0x74, 0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, -0x90, 0x93, 0x0A, 0xE0, 0x90, 0x01, 0x3F, 0x22, -0x12, 0xD3, 0xA7, 0x60, 0x02, 0x21, 0xCB, 0x90, -0x88, 0x36, 0xE0, 0x70, 0x02, 0x21, 0xCB, 0x90, -0x88, 0x9D, 0xE0, 0x20, 0xE0, 0x33, 0x90, 0x06, -0xA9, 0xE0, 0x54, 0xC0, 0x70, 0x2B, 0x90, 0x88, -0x9C, 0xE0, 0x70, 0x25, 0x90, 0x04, 0x1A, 0xE0, -0xF4, 0x70, 0x1E, 0xE0, 0x54, 0x07, 0x64, 0x07, -0x70, 0x17, 0x90, 0x06, 0x62, 0xE0, 0x54, 0x03, -0x70, 0x0F, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, -0x08, 0x12, 0xC7, 0x55, 0x54, 0xFE, 0x12, 0xEF, -0x90, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, +0xDE, 0xE7, 0x80, 0xBE, 0x41, 0x9C, 0x98, 0x00, +0x41, 0x9C, 0x9D, 0x00, 0x41, 0x9B, 0x5D, 0x00, +0x41, 0x9A, 0xDC, 0x00, 0x44, 0x9C, 0x7D, 0x00, +0x50, 0xF2, 0x01, 0x00, 0xC0, 0xBB, 0xB9, 0xE0, +0xC4, 0x89, 0x90, 0x9C, 0x97, 0xEF, 0xF0, 0x7F, +0x02, 0xD1, 0x27, 0x90, 0x86, 0xAF, 0xE0, 0xFF, +0x90, 0x9C, 0x97, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, +0x86, 0xAF, 0xF0, 0x22, 0xF1, 0xC3, 0x90, 0x86, +0xB4, 0xF1, 0x9C, 0xFF, 0xED, 0x2F, 0x90, 0x86, +0xB5, 0xF1, 0xA3, 0xFF, 0xED, 0x2F, 0x90, 0x86, +0xB6, 0x12, 0x97, 0xCC, 0xFF, 0xED, 0x2F, 0x90, +0x86, 0xB7, 0x12, 0x95, 0xF4, 0xFF, 0xED, 0x2F, +0x90, 0x86, 0xB8, 0x12, 0xE7, 0xE3, 0xFF, 0xED, +0x2F, 0x90, 0x86, 0xB9, 0x12, 0xEF, 0x6B, 0x90, +0x86, 0xBA, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x01, +0x02, 0x02, 0x1F, 0xF0, 0x90, 0x00, 0x02, 0x02, +0x02, 0x1F, 0xF1, 0xC3, 0x90, 0x98, 0x19, 0xF1, +0x9C, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x1A, 0xF1, +0xA3, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x98, +0x1B, 0xF0, 0x22, 0x90, 0x02, 0x09, 0xE0, 0xFD, +0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, 0xED, 0x2E, +0x22, 0x12, 0xDA, 0x82, 0x90, 0x93, 0x08, 0xE0, +0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x02, +0xFF, 0xEE, 0x54, 0xFD, 0x4F, 0xF1, 0x9C, 0x90, +0x93, 0x09, 0xF1, 0xA3, 0x90, 0x93, 0x0A, 0xF0, +0x12, 0xF5, 0x4E, 0x90, 0x93, 0x08, 0xE0, 0x54, +0x01, 0xFF, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x9C, 0xA0, 0xEF, 0xF0, 0x90, 0x93, +0x04, 0x31, 0xF1, 0x30, 0xE0, 0x39, 0x12, 0xD7, +0x98, 0x60, 0x10, 0x12, 0xD7, 0x8E, 0x40, 0x0B, +0xE4, 0x7F, 0x0A, 0xFE, 0xFD, 0xFC, 0x90, 0x95, +0xC9, 0x80, 0x09, 0xE4, 0x7F, 0x0A, 0xFE, 0xFD, +0xFC, 0x90, 0x95, 0xC1, 0x12, 0x82, 0x12, 0x12, +0x80, 0xDB, 0xC0, 0x07, 0x90, 0x93, 0x0A, 0xE0, +0xFB, 0xE4, 0xFA, 0xF9, 0xF8, 0xD0, 0x07, 0x12, +0x81, 0x66, 0x90, 0x93, 0x0B, 0xEF, 0xF0, 0x90, +0x9C, 0xA0, 0xE0, 0x64, 0x01, 0x70, 0x1B, 0x11, +0x96, 0x60, 0x0A, 0x11, 0x8F, 0x12, 0x7C, 0x05, +0x12, 0xF5, 0x61, 0x80, 0x08, 0x11, 0x8F, 0x12, +0x7C, 0x3B, 0x12, 0xF4, 0xD2, 0x12, 0x79, 0xD4, +0x80, 0x1C, 0x11, 0x96, 0x60, 0x07, 0x11, 0x8F, +0x12, 0x7C, 0x05, 0x80, 0x05, 0x11, 0x8F, 0x12, +0x7C, 0x3B, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x7C, +0x74, 0xF1, 0xEE, 0x12, 0x7B, 0xCC, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, 0x3F, 0x74, +0x10, 0xF0, 0xFD, 0x7F, 0x03, 0x22, 0x90, 0x93, +0x0A, 0xE0, 0x90, 0x01, 0x3F, 0x22, 0xE4, 0x90, +0x9A, 0xCF, 0xF0, 0x12, 0xB3, 0x4B, 0x60, 0x02, +0x21, 0xDC, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, +0x21, 0xDC, 0x90, 0x06, 0xA9, 0xE0, 0x54, 0xC0, +0x70, 0x27, 0x90, 0x88, 0x9C, 0xE0, 0x70, 0x21, +0x90, 0x04, 0x1A, 0xE0, 0xF4, 0x70, 0x1A, 0xA3, +0xE0, 0x54, 0x07, 0xFF, 0xBF, 0x07, 0x12, 0x90, +0x06, 0x62, 0xE0, 0x54, 0x03, 0x70, 0x0A, 0x90, +0x88, 0x39, 0xE0, 0xB4, 0x04, 0x03, 0x12, 0xD0, +0x62, 0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x85, 0xF0, 0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x86, 0xF0, 0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x87, 0xF0, 0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x88, -0xF0, 0x90, 0x07, 0xF1, 0xE0, 0x90, 0x99, 0x79, -0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x99, 0x7A, -0xF0, 0x12, 0xD4, 0x94, 0xF0, 0x90, 0x88, 0x3A, -0xE0, 0x54, 0xEC, 0xF0, 0x31, 0xD4, 0x24, 0xFD, -0x50, 0x02, 0x80, 0x03, 0x12, 0xD4, 0xBE, 0x31, -0xD4, 0x64, 0x01, 0x70, 0x30, 0x90, 0x06, 0xAB, +0xF0, 0x90, 0x07, 0xF1, 0xE0, 0x90, 0x99, 0x81, +0xF0, 0x90, 0x07, 0xF0, 0xE0, 0x90, 0x99, 0x82, +0xF0, 0x12, 0xB7, 0xEE, 0xF0, 0x90, 0x88, 0x3A, +0xE0, 0x54, 0xEC, 0xF0, 0x31, 0xE5, 0x24, 0xFD, +0x50, 0x02, 0x80, 0x03, 0x12, 0xC6, 0xDC, 0x31, +0xE5, 0x64, 0x01, 0x70, 0x3A, 0x90, 0x06, 0xAB, 0xE0, 0x90, 0x88, 0x3D, 0xF0, 0x90, 0x06, 0xA9, -0xE0, 0x30, 0xE5, 0x05, 0xA3, 0xE0, 0xFF, 0x80, -0x05, 0x90, 0x88, 0x3C, 0xE0, 0xFF, 0x90, 0x88, -0x3C, 0xEF, 0xF0, 0xA3, 0xE0, 0xFF, 0x70, 0x08, -0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, 0x80, 0x00, -0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, 0xC9, 0x94, -0xE4, 0x90, 0x88, 0x3F, 0xF0, 0x31, 0xDD, 0x30, -0xE0, 0x5A, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x20, 0xE0, 0x25, 0x31, 0xCC, 0x6F, 0x70, 0x4C, -0xEF, 0x60, 0x49, 0x90, 0x88, 0x32, 0xE0, 0x44, -0x40, 0xF0, 0x12, 0xD7, 0x9D, 0x11, 0x85, 0x12, -0x7C, 0x05, 0x12, 0xE3, 0x9A, 0x12, 0xD7, 0x8E, -0x90, 0x88, 0x3D, 0xE0, 0x14, 0xF0, 0x80, 0x2C, -0x90, 0x88, 0x34, 0xE0, 0xC4, 0x54, 0x0F, 0x64, -0x01, 0x70, 0x21, 0x31, 0xCC, 0xFE, 0x6F, 0x60, -0x1B, 0x90, 0x05, 0x73, 0xE0, 0xFF, 0xEE, 0x6F, -0x60, 0x12, 0x12, 0xD6, 0x86, 0x30, 0xE0, 0x0C, -0xEF, 0x54, 0xBF, 0x11, 0x85, 0x12, 0x7C, 0x3B, -0xF1, 0xD9, 0xF1, 0xCB, 0x90, 0x88, 0x32, 0xE0, -0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, 0xE0, -0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, 0xE0, -0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, 0x32, -0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, -0x12, 0xAE, 0xFC, 0xA3, 0xED, 0xF0, 0x78, 0x12, +0xE0, 0x30, 0xE5, 0x06, 0xA3, 0xE0, 0x90, 0x9A, +0xCF, 0xF0, 0x90, 0x9A, 0xCF, 0xE0, 0xFF, 0x60, +0x02, 0x80, 0x05, 0x90, 0x88, 0x3C, 0xE0, 0xFF, +0x90, 0x88, 0x3C, 0xEF, 0xF0, 0xA3, 0xE0, 0xFF, +0x70, 0x08, 0x90, 0x88, 0x3C, 0xE0, 0xFE, 0xFF, +0x80, 0x00, 0x90, 0x88, 0x3D, 0xEF, 0xF0, 0x12, +0xC8, 0x46, 0xE4, 0x90, 0x88, 0x3F, 0xF0, 0xA3, +0xF0, 0x31, 0xEE, 0x30, 0xE0, 0x5F, 0xEF, 0xC4, +0x13, 0x13, 0x54, 0x03, 0x20, 0xE0, 0x25, 0x31, +0xDD, 0x6F, 0x70, 0x51, 0xEF, 0x60, 0x4E, 0x90, +0x88, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0x12, 0xF5, +0x97, 0x11, 0x8B, 0x12, 0x7C, 0x05, 0x12, 0xF4, +0xD9, 0x12, 0xBF, 0xD9, 0x90, 0x88, 0x3D, 0xE0, +0x14, 0xF0, 0x80, 0x31, 0x90, 0x88, 0x34, 0xE0, +0xC4, 0x54, 0x0F, 0x64, 0x01, 0x70, 0x26, 0x31, +0xDD, 0xFE, 0x6F, 0x60, 0x20, 0x90, 0x05, 0x73, +0xE0, 0xFF, 0xEE, 0x6F, 0x60, 0x17, 0x12, 0xBF, +0xB7, 0x30, 0xE0, 0x11, 0xEF, 0x54, 0xBF, 0x11, +0x8B, 0x12, 0x7C, 0x3B, 0xF1, 0xEE, 0x7D, 0x02, +0x7F, 0x02, 0x12, 0x7C, 0x74, 0x90, 0x88, 0x32, +0xE0, 0x44, 0x04, 0xF0, 0x22, 0x90, 0x88, 0x3C, +0xE0, 0xFF, 0xA3, 0xE0, 0x22, 0x90, 0x88, 0x34, +0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x22, 0x90, 0x88, +0x32, 0xE0, 0xFF, 0x13, 0x13, 0x13, 0x54, 0x1F, +0x22, 0xF1, 0xE5, 0xA3, 0xED, 0xF0, 0x78, 0x0B, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, -0x79, 0x94, 0xF1, 0xD2, 0x12, 0xFD, 0xA7, 0x7A, -0x80, 0x79, 0x9A, 0xF1, 0xE0, 0x78, 0x28, 0x7C, -0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, -0xAA, 0xF1, 0xE0, 0xE4, 0x90, 0x9A, 0x3B, 0xF0, -0x12, 0xA9, 0xC4, 0xA3, 0xE0, 0xFD, 0xF1, 0x97, -0xEF, 0x64, 0x01, 0x60, 0x02, 0x61, 0xAC, 0xB1, -0x80, 0xCF, 0x24, 0x0E, 0xCF, 0x34, 0x00, 0x71, -0xD1, 0xEF, 0x64, 0x3A, 0x60, 0x02, 0x61, 0xAC, -0xB1, 0x80, 0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, -0x71, 0xD1, 0xEF, 0x64, 0x87, 0x60, 0x02, 0x61, -0xAC, 0x90, 0x9A, 0x3B, 0x04, 0xF0, 0xE4, 0x90, -0x9A, 0x38, 0xF0, 0x12, 0xFD, 0x95, 0x50, 0x18, -0xD1, 0xD7, 0xB1, 0x8B, 0xCD, 0x24, 0x38, 0x71, -0xC6, 0x90, 0x9A, 0x38, 0xE0, 0x24, 0x28, 0xF5, -0x82, 0xE4, 0x34, 0x9A, 0xD1, 0xE3, 0x80, 0xE3, -0xE4, 0x90, 0x9A, 0x39, 0xF0, 0x90, 0x9A, 0x39, -0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0x61, -0xAC, 0x75, 0xF0, 0x38, 0xEF, 0xF1, 0xE7, 0x20, -0xE0, 0x02, 0x61, 0xAC, 0xE4, 0x90, 0x9A, 0x3A, -0xF0, 0x12, 0xFD, 0x8C, 0x90, 0x93, 0x5E, 0x12, -0x04, 0x6E, 0xE0, 0xFE, 0x90, 0x9A, 0x3A, 0xE0, -0xC3, 0x9E, 0x40, 0x02, 0x61, 0xA4, 0xEF, 0x75, -0xF0, 0x38, 0xA4, 0x24, 0x75, 0xF9, 0x74, 0x93, +0x79, 0x94, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x01, +0xE0, 0x12, 0xF5, 0x8E, 0x7A, 0x80, 0x79, 0x9A, +0x12, 0xF5, 0xAF, 0x78, 0x21, 0x7C, 0x9A, 0x7D, +0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0xAA, 0x12, +0xF5, 0xAF, 0xE4, 0x90, 0x9A, 0x34, 0xF1, 0x10, +0xA3, 0xE0, 0xFD, 0x12, 0xE7, 0xEA, 0xEF, 0x64, +0x01, 0x60, 0x02, 0x61, 0xC2, 0xB1, 0x7E, 0xCF, +0x24, 0x0E, 0xCF, 0x34, 0x00, 0x71, 0xE7, 0xEF, +0x64, 0x3A, 0x60, 0x02, 0x61, 0xC2, 0xB1, 0x7E, +0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, 0x71, 0xE7, +0xEF, 0x64, 0x87, 0x60, 0x02, 0x61, 0xC2, 0x90, +0x9A, 0x34, 0x04, 0xF0, 0xE4, 0x90, 0x9A, 0x31, +0xF0, 0xD1, 0xF7, 0x94, 0x10, 0x50, 0x18, 0xD1, +0xE4, 0xB1, 0x89, 0xCD, 0x24, 0x38, 0x71, 0xDC, +0x90, 0x9A, 0x31, 0xE0, 0x24, 0x21, 0xF5, 0x82, +0xE4, 0x34, 0x9A, 0xF1, 0xD2, 0x80, 0xE2, 0xE4, +0x90, 0x9A, 0x32, 0xF0, 0x90, 0x9A, 0x32, 0xE0, +0xFF, 0xC3, 0x94, 0x02, 0x40, 0x02, 0x61, 0xC2, +0x75, 0xF0, 0x38, 0xEF, 0x12, 0xF5, 0xA7, 0x20, +0xE0, 0x02, 0x61, 0xC2, 0xE4, 0x90, 0x9A, 0x33, +0xF0, 0x12, 0xF5, 0x7C, 0x90, 0x93, 0x62, 0x12, +0x04, 0x6E, 0xE0, 0xFE, 0x90, 0x9A, 0x33, 0xE0, +0xC3, 0x9E, 0x40, 0x02, 0x61, 0xBA, 0xEF, 0x75, +0xF0, 0x38, 0xA4, 0x24, 0x79, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0xE0, 0x75, 0xF0, 0x10, 0xA4, 0x29, 0xF9, 0xEA, 0x35, 0xF0, 0xFA, -0x78, 0x28, 0x7C, 0x9A, 0x12, 0xFD, 0x37, 0x60, -0x02, 0x61, 0x95, 0x90, 0x06, 0x33, 0xE0, 0x44, -0x01, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x9A, 0x38, -0xF0, 0x90, 0x9A, 0x38, 0xE0, 0xFF, 0xC3, 0x94, -0x06, 0x50, 0x13, 0xD1, 0xD7, 0xB1, 0x8B, 0xCD, -0x24, 0x4A, 0x71, 0xC6, 0x90, 0x9A, 0x38, 0x12, -0xFD, 0x9E, 0xD1, 0xE3, 0x80, 0xE3, 0xE4, 0x90, -0x9A, 0x38, 0xF0, 0x12, 0xFD, 0x95, 0x50, 0x0B, -0x71, 0xB2, 0x90, 0x9A, 0x38, 0xF1, 0xF8, 0xD1, -0xE3, 0x80, 0xF0, 0x12, 0xFD, 0x8C, 0xF1, 0xE7, -0xFE, 0xC3, 0x13, 0x30, 0xE0, 0x2B, 0xEF, 0x75, -0xF0, 0x38, 0xA4, 0x24, 0x65, 0xF9, 0x74, 0x93, -0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, 0x18, 0x7C, -0x9A, 0x12, 0xFD, 0x37, 0x70, 0x6E, 0x90, 0x98, -0x05, 0xE0, 0xB4, 0x02, 0x0A, 0x90, 0x93, 0x25, -0x31, 0xE0, 0x20, 0xE0, 0x1C, 0x80, 0x11, 0x80, -0x18, 0x90, 0x98, 0x05, 0xE0, 0xB4, 0x02, 0x11, -0x90, 0x93, 0x25, 0x31, 0xE0, 0x20, 0xE0, 0x09, -0x90, 0x01, 0xC7, 0x74, 0x0A, 0xF1, 0xEF, 0x80, -0x53, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x12, 0x90, -0x9A, 0x3F, 0x12, 0x84, 0x67, 0x7A, 0x9A, 0x79, -0x28, 0x90, 0x9A, 0x42, 0x12, 0x84, 0x67, 0x90, -0x9A, 0x39, 0xE0, 0x75, 0xF0, 0x38, 0xA4, 0x24, -0x5F, 0xF9, 0x74, 0x93, 0x35, 0xF0, 0xFA, 0x90, -0x9A, 0x45, 0x12, 0x84, 0x67, 0xE4, 0x90, 0x9A, -0x48, 0xF0, 0xA3, 0xF0, 0x7A, 0x9A, 0x79, 0x18, -0x12, 0x99, 0x42, 0x80, 0x07, 0x90, 0x06, 0x33, -0xE0, 0x44, 0x05, 0xF0, 0x90, 0x9A, 0x3A, 0xE0, -0x04, 0xF0, 0x41, 0x91, 0x90, 0x9A, 0x39, 0xE0, -0x04, 0xF0, 0x41, 0x75, 0x90, 0x9A, 0x3B, 0xE0, -0xFF, 0x22, 0x90, 0x9A, 0x11, 0xE0, 0xFD, 0x90, -0x9A, 0x10, 0xE0, 0x2D, 0xFD, 0x90, 0x9A, 0x0F, -0xE0, 0x34, 0x00, 0xCD, 0x24, 0x10, 0xCD, 0x34, -0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, -0x3C, 0xFE, 0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, -0xE0, 0xF5, 0x82, 0x8C, 0x83, 0xE4, 0xFD, 0x02, -0x04, 0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, -0x08, 0xF0, 0xED, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, -0x7C, 0x00, 0xEF, 0x24, 0x08, 0xFF, 0xEC, 0x3E, -0x90, 0x9A, 0x18, 0xF0, 0xA3, 0xEF, 0xF0, 0x7E, -0x00, 0x7F, 0xE3, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -0x94, 0x79, 0x35, 0x12, 0x04, 0x80, 0x90, 0x9A, -0x19, 0xE0, 0x24, 0x01, 0xFF, 0xB1, 0x6E, 0x71, -0xD1, 0x90, 0x94, 0x36, 0xEF, 0xF0, 0x90, 0x9A, -0x19, 0xE0, 0x24, 0x04, 0xFF, 0xB1, 0x6E, 0x71, -0xD1, 0x90, 0x94, 0x39, 0xEF, 0xF0, 0x90, 0x9A, -0x19, 0xE0, 0x24, 0x05, 0xFF, 0xB1, 0x6E, 0x71, -0xD1, 0x90, 0x94, 0x3A, 0xEF, 0xF0, 0x90, 0x9A, -0x19, 0xE0, 0x24, 0x06, 0xFF, 0xB1, 0x6E, 0x71, -0xD1, 0x90, 0x94, 0x3B, 0xEF, 0xF0, 0x90, 0x9A, -0x19, 0xE0, 0x24, 0x07, 0xFF, 0xB1, 0x6E, 0x71, -0xD1, 0x90, 0x94, 0x3C, 0xEF, 0xF0, 0x90, 0x9A, -0x19, 0xE0, 0x24, 0x08, 0xFF, 0xB1, 0x6E, 0x71, -0xD1, 0x90, 0x94, 0x3D, 0xEF, 0xF0, 0xE4, 0x90, -0x9A, 0x17, 0xF0, 0x90, 0x9A, 0x17, 0xE0, 0xFF, -0xC3, 0x94, 0x08, 0x50, 0x1C, 0x90, 0x9A, 0x19, -0xE0, 0x24, 0x09, 0xFD, 0x90, 0x9A, 0x18, 0xE0, -0x71, 0xC7, 0x90, 0x9A, 0x17, 0xE0, 0x24, 0x3E, -0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x75, 0x80, -0xDA, 0xE4, 0x90, 0x9A, 0x17, 0xF0, 0x90, 0x9A, -0x17, 0xE0, 0xFF, 0xC3, 0x94, 0x02, 0x50, 0x1C, -0x90, 0x9A, 0x19, 0xE0, 0x24, 0x61, 0xFD, 0x90, -0x9A, 0x18, 0xE0, 0x71, 0xC7, 0x90, 0x9A, 0x17, -0xE0, 0x24, 0x96, 0xF5, 0x82, 0xE4, 0x34, 0x94, -0xB1, 0x75, 0x80, 0xDA, 0xE4, 0x90, 0x9A, 0x17, -0xF0, 0x90, 0x9A, 0x17, 0xE0, 0xFF, 0xC3, 0x94, -0x10, 0x50, 0x1C, 0x90, 0x9A, 0x19, 0xE0, 0x24, -0x31, 0xFD, 0x90, 0x9A, 0x18, 0xE0, 0x71, 0xC7, -0x90, 0x9A, 0x17, 0xE0, 0x24, 0x66, 0xF5, 0x82, -0xE4, 0x34, 0x94, 0xB1, 0x75, 0x80, 0xDA, 0xE4, -0x90, 0x9A, 0x17, 0xF0, 0x90, 0x94, 0x97, 0xE0, -0xFF, 0x90, 0x9A, 0x17, 0xE0, 0xFE, 0xC3, 0x9F, -0x50, 0x1F, 0x90, 0x9A, 0x19, 0xE0, 0x24, 0x63, -0xFD, 0xB1, 0x6E, 0xFC, 0xEE, 0x7E, 0x00, 0x2D, -0x71, 0xCE, 0x90, 0x9A, 0x17, 0xE0, 0x24, 0x98, -0xF5, 0x82, 0xE4, 0x34, 0x94, 0xB1, 0x75, 0x80, -0xD3, 0x90, 0x94, 0x3A, 0x12, 0xFE, 0x13, 0x90, -0x9A, 0x15, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x30, -0xE3, 0x0D, 0x90, 0x01, 0xC7, 0x74, 0x03, 0xF0, -0x7F, 0x01, 0x12, 0xB2, 0xDD, 0x80, 0x20, 0x7E, -0x00, 0x90, 0x9A, 0x16, 0xE0, 0x54, 0x07, 0xFF, -0x64, 0x01, 0x60, 0x05, 0xEF, 0x64, 0x02, 0x70, -0x0E, 0xE4, 0xFD, 0x12, 0xF7, 0x70, 0x90, 0x06, -0x31, 0xE0, 0x54, 0xF7, 0x44, 0x10, 0xF0, 0x7F, -0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, -0x18, 0xE0, 0x34, 0x00, 0x22, 0xF5, 0x83, 0xEF, -0xF0, 0x90, 0x9A, 0x17, 0xE0, 0x04, 0xF0, 0x22, -0x90, 0x9A, 0x11, 0xE0, 0xFF, 0x90, 0x9A, 0x10, -0xE0, 0x2F, 0xFF, 0x90, 0x9A, 0x0F, 0xE0, 0x34, -0x00, 0x22, 0x12, 0xAE, 0xFC, 0xA3, 0xED, 0xF0, -0x12, 0xFD, 0xA7, 0x7A, 0x80, 0x79, 0x80, 0xF1, -0xD2, 0x78, 0x1E, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, -0xFF, 0x7A, 0x80, 0x79, 0x86, 0xF1, 0x77, 0x78, -0x22, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, -0x80, 0x79, 0x8A, 0xF1, 0x77, 0xE4, 0x90, 0x9A, -0x27, 0xF0, 0xB1, 0x80, 0xCF, 0x24, 0x06, 0xCF, -0x34, 0x00, 0x71, 0xD1, 0xEF, 0x64, 0x08, 0x60, -0x02, 0xC1, 0xC6, 0xB1, 0x80, 0xCF, 0x24, 0x07, -0xCF, 0x34, 0x00, 0x71, 0xD1, 0xEF, 0x64, 0x06, -0x60, 0x02, 0xC1, 0xC6, 0x90, 0x9A, 0x27, 0x04, -0xF0, 0xE4, 0x90, 0x9A, 0x26, 0xF0, 0x12, 0xFD, -0xB9, 0x50, 0x17, 0x90, 0x9A, 0x10, 0xE0, 0x24, -0x0A, 0xFD, 0x90, 0x9A, 0x0F, 0xE0, 0x71, 0xC7, -0x90, 0x9A, 0x26, 0x12, 0xFD, 0x9E, 0xD1, 0xCC, -0x80, 0xE4, 0x78, 0x12, 0x7C, 0x9A, 0x7D, 0x01, -0x7B, 0x01, 0x7A, 0x93, 0x79, 0x34, 0x12, 0xFD, -0xC2, 0x60, 0x02, 0xC1, 0xC6, 0x90, 0x9A, 0x26, -0xF0, 0x12, 0xFD, 0xB0, 0x50, 0x18, 0xD1, 0xD7, -0xB1, 0x8B, 0xCD, 0x24, 0x20, 0x71, 0xC6, 0x90, -0x9A, 0x26, 0xE0, 0x24, 0x22, 0xF5, 0x82, 0xE4, -0x34, 0x9A, 0xD1, 0xCC, 0x80, 0xE3, 0x78, 0x22, -0x7C, 0x9A, 0x12, 0xFC, 0xD0, 0xEF, 0x70, 0x75, -0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, 0x54, 0xDF, -0xF0, 0x90, 0x93, 0x26, 0xE0, 0x30, 0xE0, 0x02, -0x80, 0x0F, 0x90, 0x98, 0x05, 0xE0, 0xB4, 0x02, -0x11, 0x90, 0x93, 0x25, 0xF1, 0x90, 0x20, 0xE0, -0x09, 0x90, 0x01, 0xC7, 0x74, 0x09, 0xF1, 0xEF, -0x80, 0x54, 0xE4, 0x90, 0x9A, 0x26, 0xF0, 0x12, -0xFD, 0xB9, 0x50, 0x0B, 0x71, 0xB2, 0x90, 0x9A, -0x26, 0xF1, 0xF8, 0xD1, 0xCC, 0x80, 0xF0, 0xE4, -0x90, 0x9A, 0x26, 0xF0, 0x12, 0xFD, 0xB0, 0x50, -0x18, 0xD1, 0xD7, 0xB1, 0x8B, 0xCD, 0x24, 0x16, -0x71, 0xC6, 0x90, 0x9A, 0x26, 0xE0, 0x24, 0x1E, -0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xD1, 0xCC, 0x80, -0xE3, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x18, 0x12, -0xFD, 0x01, 0xA3, 0xF0, 0x7A, 0x9A, 0x79, 0x1E, -0x12, 0x9A, 0xEF, 0x80, 0x09, 0x90, 0x06, 0x30, -0xE0, 0x44, 0x21, 0x54, 0xEF, 0xF0, 0x90, 0x9A, -0x27, 0xE0, 0xFF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, -0x90, 0x9A, 0x26, 0xE0, 0x04, 0xF0, 0x22, 0x90, -0x9A, 0x11, 0xE0, 0xFD, 0x90, 0x9A, 0x10, 0xE0, -0x2D, 0xFD, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -0x9A, 0x38, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x9A, -0x16, 0x12, 0xFC, 0xAF, 0xED, 0xF0, 0x78, 0x1A, +0x78, 0x21, 0x7C, 0x9A, 0x12, 0xF5, 0x43, 0x60, +0x02, 0x61, 0xAB, 0x90, 0x06, 0x33, 0xE0, 0x44, +0x01, 0x54, 0xFB, 0xF0, 0xE4, 0x90, 0x9A, 0x31, +0xF0, 0xD1, 0xF7, 0x94, 0x06, 0x50, 0x13, 0xD1, +0xE4, 0xB1, 0x89, 0xCD, 0x24, 0x4A, 0x71, 0xDC, +0x90, 0x9A, 0x31, 0x12, 0xF5, 0x85, 0xF1, 0xD2, +0x80, 0xE7, 0xE4, 0x90, 0x9A, 0x31, 0xF0, 0xD1, +0xF7, 0x94, 0x10, 0x50, 0x0B, 0x71, 0xC8, 0x90, +0x9A, 0x31, 0xF1, 0xF5, 0xF1, 0xD2, 0x80, 0xEF, +0x12, 0xF5, 0x7C, 0x12, 0xF5, 0xA7, 0xFE, 0xC3, +0x13, 0x30, 0xE0, 0x2B, 0xEF, 0x75, 0xF0, 0x38, +0xA4, 0x24, 0x69, 0xF9, 0x74, 0x93, 0x35, 0xF0, +0xFA, 0x7B, 0x01, 0x78, 0x11, 0x7C, 0x9A, 0x12, +0xF5, 0x43, 0x70, 0x6E, 0x90, 0x98, 0x09, 0xE0, +0xB4, 0x02, 0x0A, 0x90, 0x93, 0x25, 0x31, 0xF1, +0x20, 0xE0, 0x1C, 0x80, 0x11, 0x80, 0x18, 0x90, +0x98, 0x09, 0xE0, 0xB4, 0x02, 0x11, 0x90, 0x93, +0x25, 0x31, 0xF1, 0x20, 0xE0, 0x09, 0x90, 0x01, +0xC7, 0x74, 0x0A, 0xF1, 0xC9, 0x80, 0x53, 0x7B, +0x01, 0x7A, 0x9A, 0x79, 0x0B, 0x90, 0x9A, 0x38, +0x12, 0x82, 0x27, 0x7A, 0x9A, 0x79, 0x21, 0x90, +0x9A, 0x3B, 0x12, 0x82, 0x27, 0x90, 0x9A, 0x32, +0xE0, 0x75, 0xF0, 0x38, 0xA4, 0x24, 0x63, 0xF9, +0x74, 0x93, 0x35, 0xF0, 0xFA, 0x90, 0x9A, 0x3E, +0x12, 0x82, 0x27, 0xE4, 0x90, 0x9A, 0x41, 0xF0, +0xA3, 0xF0, 0x7A, 0x9A, 0x79, 0x11, 0x12, 0x9C, +0x2F, 0x80, 0x07, 0x90, 0x06, 0x33, 0xE0, 0x44, +0x05, 0xF0, 0x90, 0x9A, 0x33, 0xE0, 0x04, 0xF0, +0x41, 0xA9, 0x90, 0x9A, 0x32, 0xE0, 0x04, 0xF0, +0x41, 0x8C, 0x90, 0x9A, 0x34, 0xE0, 0xFF, 0x22, +0x90, 0x9A, 0x0A, 0xE0, 0xFD, 0x90, 0x9A, 0x09, +0xE0, 0x2D, 0xFD, 0x90, 0x9A, 0x08, 0xE0, 0x34, +0x00, 0xCD, 0x24, 0x10, 0xCD, 0x34, 0x00, 0xFC, +0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, +0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, +0x82, 0x8C, 0x83, 0xE4, 0xFD, 0x02, 0x04, 0x7E, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, +0x06, 0x31, 0xE0, 0x54, 0xEF, 0x44, 0x08, 0xF0, +0xED, 0x2F, 0xFF, 0xE4, 0x3E, 0xFE, 0x7C, 0x00, +0xEF, 0x24, 0x08, 0x12, 0xF5, 0x38, 0x7E, 0x00, +0x7F, 0xE3, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x94, +0x79, 0x39, 0x12, 0x04, 0x80, 0x90, 0x9A, 0x12, +0xE0, 0x24, 0x01, 0xB1, 0x6B, 0x71, 0xE7, 0x90, +0x94, 0x3A, 0xEF, 0xF0, 0x90, 0x9A, 0x12, 0xE0, +0x24, 0x04, 0xB1, 0x6B, 0x71, 0xE7, 0x90, 0x94, +0x3D, 0xEF, 0xF0, 0x90, 0x9A, 0x12, 0xE0, 0x24, +0x05, 0xB1, 0x6B, 0x71, 0xE7, 0x90, 0x94, 0x3E, +0xEF, 0xF0, 0x90, 0x9A, 0x12, 0xE0, 0x24, 0x06, +0xB1, 0x6B, 0x71, 0xE7, 0x90, 0x94, 0x3F, 0xEF, +0xF0, 0x90, 0x9A, 0x12, 0xE0, 0x24, 0x07, 0xB1, +0x6B, 0x71, 0xE7, 0x90, 0x94, 0x40, 0xEF, 0xF0, +0x90, 0x9A, 0x12, 0xE0, 0x24, 0x08, 0xB1, 0x6B, +0x71, 0xE7, 0x90, 0x94, 0x41, 0xEF, 0xF0, 0xE4, +0x90, 0x9A, 0x10, 0xF0, 0xD1, 0xF0, 0x94, 0x08, +0x50, 0x1C, 0x90, 0x9A, 0x12, 0xE0, 0x24, 0x09, +0xFD, 0x90, 0x9A, 0x11, 0xE0, 0x71, 0xDD, 0x90, +0x9A, 0x10, 0xE0, 0x24, 0x42, 0xF5, 0x82, 0xE4, +0x34, 0x94, 0xB1, 0x73, 0x80, 0xDE, 0xE4, 0x90, +0x9A, 0x10, 0xF0, 0xD1, 0xF0, 0x94, 0x02, 0x50, +0x1C, 0x90, 0x9A, 0x12, 0xE0, 0x24, 0x61, 0xFD, +0x90, 0x9A, 0x11, 0xE0, 0x71, 0xDD, 0x90, 0x9A, +0x10, 0xE0, 0x24, 0x9A, 0xF5, 0x82, 0xE4, 0x34, +0x94, 0xB1, 0x73, 0x80, 0xDE, 0xE4, 0x90, 0x9A, +0x10, 0xF0, 0xD1, 0xF0, 0x94, 0x10, 0x50, 0x1C, +0x90, 0x9A, 0x12, 0xE0, 0x24, 0x31, 0xFD, 0x90, +0x9A, 0x11, 0xE0, 0x71, 0xDD, 0x90, 0x9A, 0x10, +0xE0, 0x24, 0x6A, 0xF5, 0x82, 0xE4, 0x34, 0x94, +0xB1, 0x73, 0x80, 0xDE, 0xE4, 0x90, 0x9A, 0x10, +0xF0, 0x90, 0x94, 0x9B, 0xE0, 0xFF, 0x90, 0x9A, +0x10, 0xE0, 0xFE, 0xC3, 0x9F, 0x50, 0x1F, 0x90, +0x9A, 0x12, 0xE0, 0x24, 0x63, 0xFD, 0xB1, 0x6C, +0xFC, 0xEE, 0x7E, 0x00, 0x2D, 0x71, 0xE4, 0x90, +0x9A, 0x10, 0xE0, 0x24, 0x9C, 0xF5, 0x82, 0xE4, +0x34, 0x94, 0xB1, 0x73, 0x80, 0xD3, 0x90, 0x94, +0x3E, 0x12, 0xEE, 0x5A, 0x90, 0x9A, 0x0E, 0xEE, +0xF0, 0xA3, 0xEF, 0xF0, 0x30, 0xE3, 0x0D, 0x90, +0x01, 0xC7, 0x74, 0x03, 0xF0, 0x7F, 0x01, 0x12, +0xBC, 0x2E, 0x80, 0x20, 0x7E, 0x00, 0x90, 0x9A, +0x0F, 0xE0, 0x54, 0x07, 0xFF, 0x64, 0x01, 0x60, +0x05, 0xEF, 0x64, 0x02, 0x70, 0x0E, 0xE4, 0xFD, +0x12, 0xEC, 0x94, 0x90, 0x06, 0x31, 0xE0, 0x54, +0xF7, 0x44, 0x10, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xFF, 0x90, 0x9A, 0x11, 0xE0, +0x34, 0x00, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, +0x9A, 0x10, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x9A, +0x0A, 0xE0, 0xFF, 0x90, 0x9A, 0x09, 0xE0, 0x2F, +0xFF, 0x90, 0x9A, 0x08, 0xE0, 0x34, 0x00, 0x22, +0xF1, 0xE5, 0xA3, 0xED, 0xF0, 0x12, 0xF5, 0x8E, +0x7A, 0x80, 0x79, 0x80, 0x7E, 0x00, 0x7F, 0x06, +0x12, 0x01, 0xE0, 0x78, 0x17, 0x7C, 0x9A, 0x7D, +0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x86, 0x7E, +0x00, 0x7F, 0x04, 0x12, 0x01, 0xE0, 0x78, 0x1B, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, -0x79, 0xBA, 0xF1, 0x77, 0x90, 0x9A, 0x18, 0xE0, -0xFF, 0x90, 0x9A, 0x17, 0xE0, 0x2F, 0x12, 0xFD, -0x83, 0x90, 0x9A, 0x1E, 0xF0, 0xA3, 0xEF, 0xF0, -0x24, 0x06, 0xFF, 0xE4, 0x3E, 0x71, 0xD1, 0xEF, -0x64, 0x08, 0x70, 0x52, 0x90, 0x9A, 0x1F, 0xE0, -0x24, 0x07, 0xFF, 0x90, 0x9A, 0x1E, 0xE0, 0x34, -0x00, 0x71, 0xD1, 0xEF, 0x70, 0x40, 0x90, 0x9A, -0x19, 0xF0, 0x90, 0x9A, 0x19, 0xE0, 0xFF, 0xC3, -0x94, 0x04, 0x50, 0x24, 0x90, 0x9A, 0x1F, 0xE0, -0x24, 0x18, 0xFD, 0x90, 0x9A, 0x1E, 0xE0, 0x71, -0xC7, 0x90, 0x9A, 0x19, 0xE0, 0x24, 0x1A, 0xF5, -0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, 0xF0, -0x90, 0x9A, 0x19, 0xE0, 0x04, 0xF0, 0x80, 0xD2, -0x78, 0x1A, 0x7C, 0x9A, 0x12, 0xFC, 0xD0, 0xEF, -0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0x7E, -0x00, 0x7F, 0x04, 0x02, 0x01, 0xE0, 0x2F, 0x90, -0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, -0x7E, 0x01, 0x12, 0x66, 0x33, 0x90, 0x88, 0x3E, -0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x22, 0x12, -0xFC, 0xAC, 0xED, 0xF0, 0x2F, 0xFF, 0xE4, 0x3E, -0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0x71, 0xD1, -0xEF, 0x64, 0x86, 0x70, 0x1B, 0x90, 0x9A, 0x3E, -0xE0, 0xFF, 0x90, 0x9A, 0x3D, 0xE0, 0x2F, 0x12, -0xB2, 0xC0, 0xCF, 0x24, 0x07, 0xCF, 0x34, 0x00, -0x71, 0xD1, 0xBF, 0xDD, 0x03, 0x7F, 0x01, 0x22, -0x7F, 0x00, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, -0x7C, 0x74, 0x7E, 0x00, 0x7F, 0x06, 0x02, 0x01, -0xE0, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x74, -0x7E, 0x00, 0x7F, 0x10, 0x02, 0x01, 0xE0, 0x90, -0x93, 0x5D, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0xF0, -0x90, 0x93, 0x2D, 0xE0, 0x44, 0x01, 0xF0, 0x22, -0xE0, 0x24, 0x18, 0xF5, 0x82, 0xE4, 0x34, 0x9A, -0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x93, 0x03, -0xF0, 0xBF, 0x01, 0x07, 0x11, 0x14, 0xE4, 0x90, -0x93, 0x03, 0xF0, 0x22, 0x11, 0xC1, 0x7F, 0xEF, -0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x06, -0x90, 0x99, 0x8C, 0xE0, 0xA3, 0xF0, 0x11, 0xC1, -0x7F, 0xEE, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x99, 0x8C, 0xE0, 0x90, 0x99, -0x8E, 0xF0, 0x11, 0xC1, 0x7F, 0xED, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, -0x8C, 0xE0, 0x90, 0x99, 0x8F, 0xF0, 0x11, 0xC1, -0x7F, 0xEC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x08, 0x90, 0x99, 0x8C, 0xE0, 0x90, 0x99, -0x90, 0xF0, 0x11, 0xC1, 0x7F, 0xEB, 0x7E, 0x01, -0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, -0x8C, 0xE0, 0x90, 0x99, 0x91, 0xF0, 0x90, 0x99, -0x8D, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0xA3, 0xE0, -0xFB, 0xA3, 0xE0, 0x90, 0x99, 0x95, 0xF0, 0x90, -0x99, 0x91, 0xE0, 0x90, 0x99, 0x96, 0xF0, 0x90, -0x99, 0x97, 0x74, 0x12, 0xF0, 0x90, 0x99, 0xB9, -0x74, 0x05, 0xF0, 0x90, 0x99, 0x99, 0xEF, 0x12, -0xE7, 0xD5, 0x90, 0x99, 0x95, 0xE0, 0x90, 0x99, -0x9C, 0xF0, 0x90, 0x99, 0x96, 0xE0, 0x90, 0x99, -0x9D, 0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0x97, -0x12, 0x8E, 0xEE, 0x7F, 0x04, 0x02, 0x04, 0x7E, -0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0x8C, 0x22, -0x12, 0x02, 0x06, 0x90, 0x99, 0xAF, 0x12, 0x8E, -0xE7, 0x90, 0x99, 0xB0, 0xF0, 0x60, 0x0E, 0x31, -0x12, 0x12, 0xCF, 0xFB, 0x90, 0x99, 0xB0, 0x31, -0x12, 0x7B, 0x57, 0x31, 0x1F, 0x90, 0x99, 0x8C, -0x74, 0x20, 0xF0, 0x90, 0x99, 0xAE, 0x74, 0x03, -0xF0, 0x90, 0x05, 0x22, 0xE0, 0x90, 0x99, 0x8E, -0xF0, 0x90, 0x98, 0x36, 0xE0, 0x90, 0x99, 0x8F, -0xF0, 0x90, 0x98, 0x37, 0xE0, 0x90, 0x99, 0x90, -0x11, 0xC0, 0x12, 0x8E, 0xEE, 0x7F, 0x04, 0x02, -0x04, 0x7E, 0xE0, 0xFF, 0x90, 0x99, 0xAF, 0xE0, -0xFD, 0x22, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, 0xEB, -0xB4, 0x57, 0x05, 0x12, 0xFD, 0x42, 0x80, 0x10, -0xEF, 0x70, 0x07, 0x90, 0x98, 0x36, 0xE0, 0x4D, -0x80, 0x06, 0x12, 0xD0, 0x13, 0x12, 0xFD, 0x42, -0x90, 0x05, 0x22, 0xF0, 0x90, 0x93, 0x01, 0xEB, -0xF0, 0x22, 0x90, 0x9A, 0x3C, 0x12, 0x84, 0x67, -0x90, 0x05, 0x22, 0xE0, 0x90, 0x9A, 0x4D, 0xF0, -0x90, 0x04, 0x1D, 0xE0, 0x60, 0x0C, 0x7B, 0x39, -0x12, 0x8E, 0xD2, 0xEF, 0x64, 0x01, 0x70, 0x1C, -0x80, 0x00, 0x90, 0x98, 0x09, 0xE0, 0xFF, 0x90, -0x92, 0x13, 0x74, 0x11, 0xF0, 0x7B, 0x18, 0x7D, -0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, 0x4A, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0x4A, 0x12, -0xE6, 0xD4, 0x90, 0x9A, 0x4C, 0xEF, 0xF0, 0x90, -0x9A, 0x4A, 0xF1, 0xF5, 0x7B, 0x01, 0x90, 0x9A, -0x48, 0xE0, 0xFD, 0x12, 0xA2, 0x27, 0x90, 0x9A, -0x49, 0xE0, 0x60, 0x02, 0x41, 0x26, 0xF1, 0xE8, -0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x9A, -0x3F, 0x91, 0x2F, 0x75, 0x48, 0x06, 0xD0, 0x01, -0xD0, 0x02, 0xD0, 0x03, 0x51, 0xE2, 0x12, 0xFC, -0xB6, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -0x9A, 0x3C, 0x91, 0x2F, 0x75, 0x48, 0x10, 0xD0, -0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0xE2, 0xF1, -0xEB, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, -0x9A, 0x42, 0x91, 0x2F, 0x75, 0x48, 0x10, 0xD0, -0x01, 0xD0, 0x02, 0xD0, 0x03, 0x51, 0xE2, 0x24, -0x60, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, -0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x9A, -0x42, 0x91, 0x2F, 0x75, 0x48, 0x10, 0xD0, 0x01, -0xD0, 0x02, 0xD0, 0x03, 0x51, 0xE2, 0x24, 0x72, -0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, -0x03, 0xC0, 0x02, 0xC0, 0x01, 0x90, 0x9A, 0x45, -0x91, 0x2F, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, -0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9A, -0x42, 0x12, 0x84, 0x5E, 0x90, 0x9A, 0x79, 0x12, -0x84, 0x67, 0x90, 0x9A, 0x7C, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x20, 0x90, 0x9A, 0x80, 0x74, -0x3A, 0xF0, 0x90, 0x9A, 0x3C, 0x12, 0x84, 0x5E, -0x12, 0xF5, 0x91, 0x51, 0xE5, 0x24, 0x30, 0xF9, -0xE4, 0x34, 0xFC, 0x12, 0xBD, 0xAC, 0x75, 0x48, -0x28, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x4E, 0x51, -0xE2, 0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, -0x7B, 0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, -0x93, 0x75, 0x47, 0xCD, 0x75, 0x48, 0x28, 0xD0, -0x03, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0x4C, 0xE0, -0xFF, 0x90, 0x9A, 0x4B, 0xE0, 0x2F, 0xFF, 0x90, -0x9A, 0x4A, 0xE0, 0x34, 0x00, 0xCF, 0x24, 0x30, -0xFD, 0xE4, 0x3F, 0xFC, 0x90, 0x98, 0x09, 0xE0, -0xFB, 0x7F, 0x3A, 0x12, 0xE4, 0xB5, 0x51, 0xE5, -0x24, 0x30, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, -0x01, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x9A, -0x75, 0x47, 0x4E, 0x75, 0x48, 0x28, 0xD0, 0x03, -0x12, 0x69, 0xF5, 0x90, 0x98, 0x05, 0xE0, 0xB4, -0x02, 0x0D, 0x90, 0x98, 0x09, 0xE0, 0xFF, 0x90, -0x9A, 0x4C, 0xE0, 0xFD, 0x12, 0xEA, 0xDC, 0x90, -0x06, 0x33, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x9A, -0x4D, 0xE0, 0xFD, 0x7B, 0x3A, 0x12, 0xFD, 0x2C, -0xF0, 0x22, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0x4A, -0xA3, 0xE0, 0xFF, 0xA3, 0xE0, 0x2F, 0x22, 0xD3, +0x79, 0x8A, 0x7E, 0x00, 0x7F, 0x04, 0x12, 0x01, +0xE0, 0xE4, 0x90, 0x9A, 0x20, 0xF0, 0xB1, 0x7E, +0xCF, 0x24, 0x06, 0xCF, 0x34, 0x00, 0x71, 0xE7, +0xEF, 0x64, 0x08, 0x60, 0x02, 0xC1, 0xD3, 0xB1, +0x7E, 0xCF, 0x24, 0x07, 0xCF, 0x34, 0x00, 0x71, +0xE7, 0xEF, 0x64, 0x06, 0x60, 0x02, 0xC1, 0xD3, +0x90, 0x9A, 0x20, 0x04, 0xF0, 0xE4, 0x90, 0x9A, +0x1F, 0xF0, 0xF1, 0x07, 0x50, 0x17, 0x90, 0x9A, +0x09, 0xE0, 0x24, 0x0A, 0xFD, 0x90, 0x9A, 0x08, +0xE0, 0x71, 0xDD, 0x90, 0x9A, 0x1F, 0x12, 0xF5, +0x85, 0xD1, 0xD9, 0x80, 0xE5, 0x78, 0x0B, 0x7C, +0x9A, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, +0x38, 0x12, 0xA7, 0xED, 0x60, 0x02, 0xC1, 0xD3, +0x90, 0x9A, 0x1F, 0xF0, 0xD1, 0xFE, 0x50, 0x18, +0xD1, 0xE4, 0xB1, 0x89, 0xCD, 0x24, 0x20, 0x71, +0xDC, 0x90, 0x9A, 0x1F, 0xE0, 0x24, 0x1B, 0xF5, +0x82, 0xE4, 0x34, 0x9A, 0xD1, 0xD9, 0x80, 0xE4, +0x78, 0x1B, 0x7C, 0x9A, 0x12, 0xEE, 0x62, 0xEF, +0x70, 0x78, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x01, +0x54, 0xDF, 0xF0, 0x90, 0x93, 0x26, 0xE0, 0x30, +0xE0, 0x02, 0x80, 0x10, 0x90, 0x98, 0x09, 0xE0, +0xB4, 0x02, 0x12, 0x90, 0x93, 0x25, 0x12, 0xB2, +0xDA, 0x20, 0xE0, 0x09, 0x90, 0x01, 0xC7, 0x74, +0x09, 0xF1, 0xC9, 0x80, 0x56, 0xE4, 0x90, 0x9A, +0x1F, 0xF0, 0xF1, 0x07, 0x50, 0x0B, 0x71, 0xC8, +0x90, 0x9A, 0x1F, 0xF1, 0xF5, 0xD1, 0xD9, 0x80, +0xF1, 0xE4, 0x90, 0x9A, 0x1F, 0xF0, 0xD1, 0xFE, +0x50, 0x18, 0xD1, 0xE4, 0xB1, 0x89, 0xCD, 0x24, +0x16, 0x71, 0xDC, 0x90, 0x9A, 0x1F, 0xE0, 0x24, +0x17, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xD1, 0xD9, +0x80, 0xE4, 0x12, 0xC7, 0x56, 0x7B, 0x01, 0x7A, +0x9A, 0x79, 0x11, 0x12, 0xDA, 0x04, 0xF0, 0xA3, +0xF0, 0x7A, 0x9A, 0x79, 0x17, 0x12, 0x9D, 0xCC, +0x80, 0x09, 0x90, 0x06, 0x30, 0xE0, 0x44, 0x21, +0x54, 0xEF, 0xF0, 0x90, 0x9A, 0x20, 0xE0, 0xFF, +0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, 0x1F, +0xE0, 0x04, 0xF0, 0x22, 0x90, 0x9A, 0x0A, 0xE0, +0xFD, 0x90, 0x9A, 0x09, 0xE0, 0x2D, 0xFD, 0x22, +0x90, 0x9A, 0x10, 0xE0, 0xFF, 0xC3, 0x22, 0x90, +0x9A, 0x31, 0xE0, 0xFF, 0xC3, 0x22, 0x90, 0x9A, +0x1F, 0xE0, 0xFF, 0xC3, 0x94, 0x04, 0x22, 0x90, +0x9A, 0x1F, 0xE0, 0xFF, 0xC3, 0x94, 0x06, 0x22, +0xF0, 0x90, 0x9A, 0x08, 0xE0, 0xFE, 0xA3, 0xE0, +0xFF, 0x22, 0xF1, 0xDD, 0xE4, 0x90, 0x9A, 0x0D, +0xF0, 0x71, 0xE8, 0xEF, 0x54, 0x0C, 0x64, 0x08, +0x70, 0x74, 0xF1, 0x11, 0xA3, 0xE0, 0x24, 0x06, +0xF1, 0xB9, 0xEF, 0x64, 0x88, 0x70, 0x67, 0xF1, +0x11, 0xA3, 0xE0, 0x24, 0x07, 0xF1, 0xB9, 0xEF, +0x64, 0x8E, 0x70, 0x5A, 0x90, 0x9A, 0x0D, 0xF1, +0xA4, 0xEF, 0x64, 0x03, 0x70, 0x50, 0xF1, 0x11, +0x12, 0xEE, 0xD6, 0x24, 0x06, 0xF1, 0xB9, 0xEF, +0x30, 0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x01, +0x80, 0x3A, 0x90, 0x93, 0x24, 0x12, 0xB2, 0xDA, +0x30, 0xE0, 0x23, 0x90, 0x98, 0x09, 0xE0, 0x64, +0x02, 0x70, 0x12, 0x90, 0x93, 0x25, 0x12, 0xB2, +0xDA, 0x30, 0xE0, 0x02, 0x80, 0x07, 0x90, 0x01, +0xC7, 0x74, 0x02, 0x80, 0x17, 0xF1, 0x11, 0xA3, +0xE0, 0xFD, 0x71, 0xF8, 0x80, 0x10, 0x90, 0x93, +0x29, 0x12, 0xA6, 0xEE, 0x30, 0xE0, 0x07, 0x90, +0x01, 0xC7, 0x74, 0x02, 0xF1, 0xC9, 0x90, 0x9A, +0x0D, 0xE0, 0xFF, 0x22, 0x04, 0xF0, 0x90, 0x9A, +0x08, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x9A, +0x0B, 0xE0, 0xFD, 0x90, 0x9A, 0x0A, 0xE0, 0x2D, +0x04, 0xFD, 0x90, 0x8A, 0xE9, 0xE0, 0xFA, 0xA3, +0xE0, 0xFB, 0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, +0x7E, 0xF0, 0x90, 0x93, 0x31, 0xE0, 0x44, 0x01, +0xF0, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, +0x31, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x9A, 0x0A, +0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x9A, 0x08, +0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x7D, 0x01, +0x7F, 0x02, 0x02, 0x7C, 0x74, 0xE0, 0x24, 0x11, +0xF5, 0x82, 0xE4, 0x34, 0x9A, 0x22, 0x90, 0x99, +0x85, 0x12, 0x82, 0x27, 0x90, 0x98, 0x2D, 0xE0, +0x70, 0x12, 0x31, 0xAD, 0x12, 0x02, 0x06, 0x13, +0x13, 0x54, 0x3F, 0x30, 0xE0, 0x06, 0x90, 0x98, +0x33, 0x74, 0x01, 0xF0, 0x90, 0x98, 0x2F, 0xE0, +0x70, 0x12, 0x31, 0xAD, 0x12, 0x02, 0x06, 0xC4, +0x54, 0x0F, 0xFF, 0xBF, 0x05, 0x06, 0x90, 0x98, +0x34, 0x74, 0x01, 0xF0, 0x31, 0xAD, 0x12, 0x87, +0x9D, 0xFF, 0x90, 0x99, 0x89, 0xF0, 0x12, 0x02, +0x06, 0xC3, 0x13, 0x30, 0xE0, 0x0B, 0x31, 0xAD, +0x12, 0x87, 0xA4, 0x90, 0x99, 0x8A, 0xF0, 0x80, +0x05, 0x90, 0x99, 0x8A, 0xEF, 0xF0, 0x90, 0x99, +0x89, 0xE0, 0x90, 0x99, 0x88, 0xF0, 0x90, 0x99, +0x8A, 0xE0, 0xFE, 0x90, 0x99, 0x88, 0xE0, 0xFF, +0xD3, 0x9E, 0x50, 0x38, 0x31, 0xAD, 0x12, 0x02, +0x06, 0x54, 0x01, 0xFD, 0x12, 0x6E, 0x71, 0x90, +0x99, 0x88, 0xE0, 0xFF, 0x12, 0x78, 0x4A, 0xEF, +0x90, 0x99, 0x88, 0x70, 0x06, 0xE0, 0xFF, 0xF1, +0xAA, 0x80, 0x04, 0xE0, 0xFF, 0xF1, 0xC8, 0x90, +0x98, 0x34, 0xE0, 0x60, 0x07, 0x90, 0x99, 0x88, +0xE0, 0xFF, 0xF1, 0xAA, 0x90, 0x99, 0x88, 0xE0, +0x04, 0xF0, 0x80, 0xBA, 0x90, 0x05, 0x5E, 0xE4, +0xF0, 0x90, 0x99, 0x89, 0xE0, 0x70, 0x1A, 0xFF, +0x12, 0x78, 0x4A, 0xEF, 0x70, 0x13, 0x90, 0x86, +0x0C, 0x31, 0xBD, 0x90, 0x8A, 0xED, 0x31, 0xBD, +0x12, 0xF5, 0xB6, 0x54, 0xBF, 0xF0, 0x54, 0x7F, +0xF0, 0x22, 0x90, 0x9C, 0x66, 0x12, 0x82, 0x27, +0x90, 0x9C, 0x65, 0xEF, 0xF0, 0x12, 0x82, 0x30, +0x91, 0x24, 0x00, 0x91, 0x29, 0x01, 0x91, 0x2E, +0x03, 0x91, 0x33, 0x04, 0x91, 0x38, 0x06, 0x91, +0x49, 0x12, 0x91, 0x4E, 0x14, 0x91, 0x53, 0x1E, +0x91, 0x58, 0x20, 0x91, 0x5C, 0x25, 0x91, 0x61, +0x27, 0x91, 0x66, 0x29, 0x91, 0x6B, 0x2A, 0x91, +0x75, 0x80, 0x91, 0x70, 0x81, 0x91, 0x79, 0x82, +0x91, 0x7E, 0x83, 0x91, 0x83, 0x84, 0x91, 0x8D, +0x86, 0x91, 0x88, 0x88, 0x91, 0x92, 0xC3, 0x91, +0x3D, 0xC6, 0x91, 0x3D, 0xC7, 0x91, 0x3D, 0xC8, +0x00, 0x00, 0x91, 0x97, 0x31, 0xA7, 0x02, 0x87, +0x64, 0x31, 0xA7, 0x02, 0x8F, 0xFE, 0x31, 0xA7, +0x02, 0xDA, 0x5E, 0x31, 0xA7, 0x02, 0xEF, 0xE5, +0x31, 0xA7, 0x02, 0xB0, 0x73, 0x90, 0x9C, 0x65, +0xE0, 0xFF, 0xA3, 0x12, 0x82, 0x1E, 0x02, 0xB1, +0x0C, 0x31, 0xA7, 0x02, 0x98, 0x04, 0x31, 0xA7, +0x02, 0x9F, 0xF7, 0x31, 0xA7, 0x02, 0x9B, 0xBC, +0x31, 0xA7, 0xC1, 0xBC, 0x31, 0xA7, 0x02, 0xA0, +0x06, 0x31, 0xA7, 0x02, 0x87, 0xD1, 0x31, 0xA7, +0x02, 0xA7, 0xF6, 0x31, 0xA7, 0x02, 0xA0, 0x0E, +0x31, 0xA7, 0x02, 0xDB, 0x4F, 0x31, 0xA7, 0x61, +0x38, 0x31, 0xA7, 0x02, 0xEF, 0x23, 0x31, 0xA7, +0x02, 0xEF, 0x31, 0x31, 0xA7, 0x02, 0xEF, 0x78, +0x31, 0xA7, 0x02, 0x87, 0xAA, 0x31, 0xA7, 0x02, +0xDA, 0x8A, 0x31, 0xA7, 0x02, 0xAF, 0xF2, 0x90, +0x01, 0xC0, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x9C, +0x65, 0xE0, 0x90, 0x01, 0xC2, 0xF0, 0x22, 0x90, +0x9C, 0x66, 0x02, 0x82, 0x1E, 0x90, 0x99, 0x85, +0x02, 0x82, 0x1E, 0x7D, 0xFF, 0xE4, 0xFF, 0x12, +0x9C, 0x0E, 0x90, 0x8A, 0xFD, 0xE0, 0xFE, 0xA3, +0xE0, 0xAA, 0x06, 0xF9, 0x02, 0x04, 0x7A, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, -0x15, 0x12, 0x84, 0x67, 0x78, 0x21, 0x7C, 0x9C, -0x7D, 0x01, 0x7B, 0xFF, 0x7A, 0x80, 0x79, 0x8E, -0x12, 0x97, 0xD2, 0x90, 0x05, 0x22, 0xE0, 0x90, -0x9C, 0x20, 0xF0, 0x90, 0x04, 0x1D, 0xE0, 0x60, -0x0C, 0x7B, 0x33, 0x12, 0x8E, 0xD2, 0xEF, 0x64, -0x01, 0x70, 0x1C, 0x80, 0x00, 0x90, 0x98, 0x08, -0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x10, 0xF0, -0x7B, 0x18, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, -0x9C, 0x1D, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -0x9C, 0x1D, 0x12, 0xE6, 0xD4, 0x90, 0x9C, 0x1F, -0xEF, 0xF0, 0x90, 0x9C, 0x1D, 0xF1, 0xF5, 0x7B, -0x01, 0x90, 0x9C, 0x1B, 0xE0, 0xFD, 0x12, 0xA2, -0x27, 0x90, 0x9C, 0x1C, 0xE0, 0x70, 0x50, 0xF1, -0xE8, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0x91, -0x2C, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, -0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9C, 0x1D, -0x51, 0xE8, 0x12, 0xFD, 0xE4, 0x7B, 0x01, 0xC0, -0x03, 0xC0, 0x02, 0xC0, 0x01, 0x91, 0x2C, 0x75, -0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, -0x12, 0x69, 0xF5, 0x90, 0x9C, 0x1D, 0x51, 0xE8, -0x12, 0xFC, 0xB6, 0xC0, 0x03, 0xC0, 0x02, 0xC0, -0x01, 0x90, 0x9C, 0x15, 0x91, 0x2F, 0x75, 0x48, -0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, 0x4D, 0x90, -0x9C, 0x1C, 0xE0, 0x64, 0x01, 0x70, 0x4A, 0xF1, -0xE8, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, -0x75, 0x47, 0x49, 0x75, 0x48, 0x06, 0xD0, 0x03, -0x12, 0x69, 0xF5, 0x90, 0x9C, 0x1D, 0x51, 0xE8, -0x12, 0xFD, 0xE4, 0x7B, 0x01, 0xC0, 0x03, 0x8B, -0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x53, 0x75, -0x48, 0x06, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, -0x9C, 0x1D, 0x51, 0xE8, 0x12, 0xFC, 0xB6, 0xC0, -0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, -0x59, 0x75, 0x48, 0x04, 0xD0, 0x03, 0x12, 0x69, -0xF5, 0x90, 0x98, 0x05, 0xE0, 0xB4, 0x02, 0x0D, -0x90, 0x98, 0x08, 0xE0, 0xFF, 0x90, 0x9C, 0x1F, -0xE0, 0xFD, 0x12, 0xEA, 0xDC, 0x90, 0x06, 0x30, -0xE0, 0x44, 0x10, 0xF0, 0x90, 0x9C, 0x20, 0xE0, -0xFD, 0x7B, 0x34, 0x12, 0xFD, 0x2C, 0xF0, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9C, 0x18, 0x12, -0x84, 0x5E, 0x8B, 0x45, 0x8A, 0x46, 0x89, 0x47, -0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x9A, 0x1D, 0x12, 0xFC, 0xAF, 0xED, 0xF0, -0x90, 0x9A, 0x35, 0x74, 0x18, 0xF0, 0x7E, 0x00, -0x7F, 0x80, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x9A, -0x79, 0x3D, 0x12, 0x04, 0x80, 0x90, 0x01, 0xC4, -0x74, 0x39, 0xF0, 0x74, 0x9C, 0xA3, 0xF0, 0x90, -0x98, 0x0A, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, -0x9A, 0x34, 0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, -0x29, 0x12, 0xEA, 0x7D, 0x74, 0x41, 0xF0, 0xEE, -0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, 0x90, 0x9A, -0x35, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, 0xEA, 0x3C, -0x90, 0x9A, 0x39, 0xF0, 0xA3, 0xCE, 0xF0, 0x74, -0x28, 0x29, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, -0x01, 0x90, 0x9A, 0x1F, 0xE0, 0xFD, 0x12, 0xA2, -0x27, 0x12, 0xFC, 0x6A, 0x90, 0x9A, 0x39, 0xE0, -0xFF, 0xA3, 0xE0, 0x90, 0x9A, 0x37, 0xCF, 0xF0, -0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0x3D, 0x74, 0x01, -0xF0, 0xA3, 0x74, 0x03, 0xF0, 0xE4, 0xA3, 0xF0, -0xA3, 0x74, 0x5F, 0xF0, 0x90, 0x9A, 0x39, 0xE4, -0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x94, -0x39, 0xE0, 0xFF, 0x7E, 0x02, 0xB4, 0xFE, 0x02, -0x7E, 0xFE, 0x90, 0x9A, 0x39, 0xA3, 0xE0, 0xFD, -0xF1, 0x71, 0xEE, 0xF0, 0x74, 0x00, 0x2D, 0xF1, -0x73, 0xE0, 0x90, 0x9A, 0x41, 0xF0, 0x90, 0x9A, -0x39, 0x12, 0xC4, 0x6F, 0x90, 0x95, 0x2E, 0xE0, -0x90, 0x9A, 0x1D, 0xB4, 0x01, 0x0B, 0xE0, 0x44, -0x03, 0xFC, 0xA3, 0xE0, 0x44, 0x10, 0xFD, 0x80, -0x09, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, -0x20, 0xFD, 0x90, 0x9A, 0x3B, 0xEC, 0xF0, 0xA3, -0xED, 0xF0, 0x90, 0x9A, 0x1D, 0xE0, 0x70, 0x04, -0xA3, 0xE0, 0x64, 0x01, 0x90, 0x9A, 0x39, 0x70, -0x17, 0xA3, 0xE0, 0xFE, 0xF1, 0x71, 0x12, 0xBE, -0x6B, 0x74, 0x01, 0xF0, 0x90, 0x9A, 0x42, 0x74, -0x03, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0x80, 0x13, -0xA3, 0xE0, 0xFE, 0xF1, 0x71, 0x12, 0xBE, 0x6B, -0x74, 0x02, 0xF0, 0x90, 0x9A, 0x42, 0x04, 0xF0, -0xA3, 0x14, 0xF0, 0x12, 0xFD, 0x22, 0xEF, 0x64, -0xFE, 0x90, 0x9A, 0x39, 0x70, 0x30, 0xA3, 0xE0, -0x24, 0x00, 0x12, 0xEC, 0x77, 0xC0, 0x03, 0x8B, -0x45, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3C, 0x75, -0x48, 0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x75, -0x45, 0x01, 0x75, 0x46, 0x94, 0x75, 0x47, 0x3C, -0x75, 0x48, 0x02, 0x7B, 0x01, 0x7A, 0x9A, 0x79, -0x44, 0x12, 0x69, 0xF5, 0x80, 0x22, 0xE0, 0xFE, -0xA3, 0xE0, 0xFF, 0x24, 0x00, 0xF5, 0x82, 0x74, -0xFC, 0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x74, 0x01, -0x2F, 0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, -0xE4, 0xF0, 0x90, 0x9A, 0x44, 0xF0, 0xA3, 0xF0, -0x12, 0xFD, 0x22, 0xE4, 0x90, 0x9A, 0x36, 0xF0, -0x12, 0xFC, 0xC0, 0xFE, 0x90, 0x9A, 0x39, 0xA3, -0xE0, 0xFD, 0xEF, 0x2D, 0xF1, 0x71, 0xEE, 0xF0, -0x12, 0xFC, 0xC0, 0xFE, 0x74, 0x46, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEE, 0x12, -0xFC, 0xF9, 0xE0, 0xB4, 0x08, 0xDA, 0x12, 0xFC, -0x74, 0x90, 0x9A, 0x39, 0x12, 0xA7, 0xF2, 0x90, -0x9A, 0x39, 0x12, 0xA7, 0xEB, 0x12, 0xFC, 0x6A, -0xE4, 0x90, 0x9A, 0xC0, 0xF0, 0xE4, 0x90, 0x9A, -0x36, 0xF0, 0x12, 0xFD, 0x68, 0x50, 0x13, 0x12, -0xFC, 0x9A, 0xA3, 0x12, 0xFC, 0x93, 0x12, 0xFD, -0x4D, 0xF0, 0xF1, 0x70, 0xE4, 0x12, 0xFC, 0xF9, -0x80, 0xE8, 0x12, 0xFE, 0x0C, 0x90, 0x06, 0x31, -0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x98, 0x0B, 0x12, -0xEA, 0xD3, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, -0x13, 0xD8, 0xF9, 0x12, 0xEC, 0x31, 0xED, 0xFF, -0x90, 0x98, 0x0A, 0x12, 0xEC, 0x3B, 0xC3, 0x33, -0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x9A, -0x35, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, 0x3E, -0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, 0x90, -0x92, 0x06, 0x74, 0x10, 0xF0, 0x7B, 0x63, 0xE4, -0xFD, 0x12, 0x71, 0xD4, 0x90, 0x9A, 0x1D, 0xE0, -0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x7B, 0x01, -0x7A, 0x9A, 0x79, 0x3D, 0x70, 0x17, 0x90, 0x91, -0xA0, 0x12, 0xFE, 0x04, 0x90, 0x91, 0xA3, 0x12, -0x84, 0x67, 0x90, 0x91, 0xA6, 0x12, 0xFD, 0xFC, -0x12, 0x6F, 0x34, 0x80, 0x15, 0x90, 0x91, 0x96, -0x12, 0xFE, 0x04, 0x90, 0x91, 0x99, 0x12, 0x84, -0x67, 0x90, 0x91, 0x9C, 0x12, 0xFD, 0xFC, 0x12, -0x6E, 0xF3, 0x90, 0x9A, 0xC0, 0xE0, 0x04, 0xF0, -0x90, 0x06, 0x31, 0xE0, 0x30, 0xE2, 0x07, 0x12, -0xFD, 0xF4, 0x50, 0x02, 0xA1, 0xFD, 0x12, 0xFD, -0xF4, 0x40, 0x0A, 0x90, 0x06, 0x35, 0xE0, 0x44, -0x20, 0x90, 0x06, 0x34, 0xF0, 0xE4, 0x90, 0x9A, -0x36, 0xF0, 0x12, 0xFD, 0x68, 0x50, 0x25, 0x12, -0xFC, 0x9A, 0xA3, 0x12, 0xFC, 0x93, 0x12, 0xFD, -0x4D, 0xF0, 0x90, 0x9A, 0x36, 0xE0, 0x24, 0x20, -0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, -0xFF, 0x90, 0x9A, 0x34, 0xF1, 0x70, 0xEF, 0x12, -0xFC, 0xF9, 0x80, 0xD6, 0x90, 0x9A, 0x1D, 0xE0, -0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x0F, -0x90, 0x98, 0x0A, 0xE0, 0xFF, 0x90, 0x9A, 0x35, -0xE0, 0x24, 0x08, 0xFD, 0x12, 0xEA, 0xDC, 0x90, -0x04, 0x1D, 0xE0, 0x60, 0x24, 0x90, 0x05, 0x22, -0xE0, 0x90, 0x9A, 0xBF, 0xF0, 0x7B, 0x1D, 0x12, -0x8E, 0xD2, 0xBF, 0x01, 0x07, 0x12, 0xFC, 0x7E, -0x90, 0x04, 0x25, 0xF0, 0x90, 0x9A, 0xBF, 0xE0, -0xFD, 0x7B, 0x1E, 0xE4, 0xFF, 0x31, 0x1F, 0x80, -0x07, 0x12, 0xFC, 0x7E, 0x90, 0x04, 0x25, 0xF0, -0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x88, +0x9E, 0xED, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, +0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, +0x61, 0x33, 0xEE, 0xF1, 0xB2, 0x30, 0xE0, 0x02, +0x61, 0x33, 0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, +0x70, 0x02, 0x61, 0x33, 0xEF, 0x70, 0x02, 0x41, +0x94, 0x24, 0xFE, 0x70, 0x02, 0x41, 0xD9, 0x24, +0xFE, 0x60, 0x4F, 0x24, 0xFC, 0x70, 0x02, 0x61, +0x1E, 0x24, 0xFC, 0x60, 0x02, 0x61, 0x2E, 0xEE, +0xB4, 0x0E, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, -0xC0, 0x74, 0x39, 0x04, 0x90, 0x01, 0xC4, 0xF0, -0x74, 0x9C, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x12, 0x83, 0x00, 0xA8, 0x04, 0xA9, 0x05, -0xAA, 0x06, 0xAB, 0x07, 0x90, 0x99, 0x8C, 0xA3, -0xE0, 0x24, 0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -0xF5, 0x83, 0x22, 0x12, 0xA7, 0xD2, 0x90, 0x99, -0x8C, 0x12, 0xE6, 0xD4, 0x90, 0x99, 0x8E, 0xEF, -0xF0, 0x90, 0x99, 0x8C, 0xA3, 0xE0, 0x24, 0x38, -0xF9, 0xE4, 0x34, 0xFC, 0x12, 0xBD, 0xAC, 0x75, -0x48, 0x06, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x49, -0x12, 0xA7, 0xAE, 0x51, 0xE8, 0x24, 0x3E, 0xF9, -0xE4, 0x34, 0xFC, 0x12, 0xBD, 0xAC, 0x75, 0x48, -0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, 0x12, -0xA7, 0xAE, 0x51, 0xE8, 0x24, 0x42, 0xF9, 0xE4, -0x34, 0xFC, 0x12, 0xBD, 0xAC, 0x75, 0x48, 0x06, -0x7B, 0x01, 0x7A, 0x93, 0x79, 0x53, 0x12, 0xA7, -0xAE, 0x51, 0xE8, 0x24, 0x48, 0xF9, 0xE4, 0x34, -0xFC, 0x12, 0xBD, 0xAC, 0x75, 0x48, 0x04, 0x7B, -0x01, 0x7A, 0x93, 0x79, 0x59, 0x02, 0x69, 0xF5, -0xA3, 0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, -0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xA3, 0xE0, 0x24, -0x28, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x22, 0x12, -0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x98, 0x35, -0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0xF1, 0xDE, -0x12, 0x02, 0x06, 0xFF, 0x54, 0x7F, 0x90, 0x88, -0x36, 0xF0, 0xEF, 0x12, 0xE8, 0xB6, 0xA3, 0x12, -0x8E, 0xE7, 0xFD, 0x54, 0xF0, 0xC4, 0x54, 0x0F, -0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, 0xF0, 0x4F, -0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0xFC, -0x54, 0x01, 0x25, 0xE0, 0xFF, 0x90, 0x88, 0x31, -0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0xEC, 0x54, 0x04, -0xC3, 0x13, 0xFF, 0x90, 0x88, 0x33, 0xE0, 0x54, -0xFD, 0x4F, 0xF0, 0xED, 0x54, 0x0F, 0xC4, 0x54, -0xF0, 0xFF, 0xA3, 0xE0, 0x54, 0x0F, 0x4F, 0x12, -0x8F, 0xC7, 0x90, 0x88, 0x35, 0x51, 0x20, 0xFD, -0x90, 0x8A, 0x89, 0x12, 0x8F, 0x00, 0x7F, 0x02, -0x12, 0x04, 0x7E, 0x90, 0x9B, 0x66, 0xE0, 0x60, -0x0D, 0x12, 0xDF, 0xB3, 0x12, 0x8F, 0x00, 0x7D, -0x02, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x8C, -0x04, 0x31, 0x21, 0xFF, 0x54, 0x01, 0xFE, 0x90, -0x88, 0x9B, 0x12, 0xBD, 0x18, 0x4F, 0x31, 0x1F, -0xFE, 0x12, 0xBF, 0xA4, 0x90, 0x88, 0x9B, 0xF0, -0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x31, -0x1E, 0x12, 0xBF, 0xE3, 0x90, 0x88, 0x9B, 0xF0, -0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x31, -0x1E, 0x54, 0x40, 0xFE, 0xEF, 0x54, 0xBF, 0x4E, -0x90, 0x88, 0x9B, 0xF0, 0x12, 0xD7, 0x95, 0x20, -0xE0, 0x2F, 0xEF, 0xC3, 0x13, 0x20, 0xE0, 0x0B, -0x75, 0x0E, 0x01, 0x90, 0x88, 0xDF, 0xE0, 0x60, -0x0B, 0x80, 0x0E, 0xE4, 0xF5, 0x0E, 0x90, 0x88, -0xDF, 0xE0, 0x60, 0x05, 0xE4, 0xF5, 0x0D, 0x80, -0x03, 0x75, 0x0D, 0x01, 0x90, 0x8A, 0xF3, 0x12, -0x8F, 0x00, 0xAD, 0x0E, 0xAF, 0x0D, 0x12, 0x04, -0x7E, 0x12, 0x8C, 0x04, 0x12, 0x5C, 0x5F, 0x90, -0x88, 0x36, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, -0x33, 0xE0, 0x54, 0xFB, 0xF0, 0x12, 0xD7, 0xD2, -0xF0, 0x90, 0x88, 0x36, 0x12, 0xEE, 0xD6, 0xF1, -0xE4, 0x90, 0x01, 0xBE, 0xF0, 0x22, 0x4E, 0xFF, -0xF0, 0x90, 0x00, 0x05, 0x02, 0x02, 0x1F, 0x90, -0x9C, 0x43, 0x12, 0x84, 0x67, 0x90, 0x9C, 0x47, -0xE0, 0xFE, 0x64, 0x04, 0x70, 0x0D, 0x51, 0x0F, -0x12, 0x02, 0x06, 0x90, 0x9C, 0x48, 0x12, 0x8E, -0xE7, 0x80, 0x11, 0xEE, 0x64, 0x02, 0x70, 0x2B, -0x51, 0x0F, 0x12, 0x8F, 0xC8, 0x90, 0x9C, 0x48, -0xF0, 0x12, 0x02, 0x06, 0x90, 0x9C, 0x49, 0x51, -0x20, 0x90, 0x9C, 0x4A, 0x31, 0x20, 0x90, 0x9C, -0x4B, 0xF1, 0xB5, 0x90, 0x9C, 0x4C, 0xF0, 0x90, -0x00, 0x07, 0x12, 0x02, 0x1F, 0x90, 0x9C, 0x4D, -0x12, 0xBF, 0x9B, 0xED, 0x70, 0x19, 0xFE, 0x51, -0x15, 0xE0, 0xB4, 0xFF, 0x06, 0x51, 0x15, 0xE4, -0xF0, 0x80, 0x07, 0x51, 0x15, 0xE0, 0x04, 0xF0, -0x80, 0x05, 0x0E, 0xEE, 0xB4, 0x06, 0xE8, 0x90, -0x9C, 0x47, 0xE0, 0xFE, 0xB4, 0x04, 0x18, 0xA3, -0xE0, 0xFD, 0x51, 0x0F, 0xED, 0xF1, 0x2B, 0xFD, -0x51, 0x0F, 0x90, 0x00, 0x01, 0xED, 0x12, 0x02, -0x5E, 0x90, 0x00, 0x02, 0xE4, 0x80, 0x20, 0xEE, -0xB4, 0x02, 0x1F, 0x90, 0x9C, 0x49, 0x51, 0x0D, -0xEE, 0xF1, 0x2B, 0x44, 0x20, 0x54, 0x7F, 0x51, -0x0E, 0x90, 0x00, 0x01, 0xEE, 0x12, 0x02, 0x5E, -0x90, 0x9C, 0x48, 0xE0, 0x90, 0x00, 0x02, 0x12, -0x02, 0x5E, 0x51, 0x0F, 0xE9, 0x24, 0x03, 0xF9, -0xE4, 0x3A, 0xFA, 0x12, 0x02, 0x06, 0x44, 0x20, -0x12, 0x02, 0x4C, 0x90, 0x9C, 0x4A, 0x51, 0x0D, -0x90, 0x00, 0x04, 0xEE, 0x12, 0x02, 0x5E, 0x90, -0x9C, 0x4B, 0xE0, 0x90, 0x00, 0x05, 0x12, 0x02, -0x5E, 0x90, 0x9C, 0x4C, 0xE0, 0x90, 0x00, 0x06, -0x12, 0x02, 0x5E, 0x90, 0x9C, 0x4D, 0xE0, 0x90, -0x00, 0x07, 0x02, 0x02, 0x5E, 0xE0, 0xFE, 0x90, -0x9C, 0x43, 0x02, 0x84, 0x5E, 0x74, 0x48, 0x2E, -0xF5, 0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x22, -0xF0, 0x90, 0x00, 0x04, 0x02, 0x02, 0x1F, 0x90, -0x9C, 0x73, 0xED, 0xF0, 0x90, 0x9C, 0x70, 0x12, -0x84, 0x67, 0xE4, 0x90, 0x9C, 0x74, 0xF0, 0xA3, -0xF0, 0x12, 0x02, 0x06, 0xFF, 0x12, 0x8E, 0xE8, -0xFD, 0x51, 0x21, 0xFB, 0x12, 0xE6, 0xFA, 0x90, -0x9C, 0x74, 0xEF, 0xF0, 0x90, 0x9C, 0x70, 0x12, -0x84, 0x5E, 0x51, 0x21, 0xFF, 0x12, 0xF5, 0x1C, -0x90, 0x9C, 0x75, 0xEF, 0xF0, 0x90, 0x95, 0x60, -0xE0, 0x24, 0xFE, 0x60, 0x14, 0x24, 0xFE, 0x60, -0x10, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, -0x05, 0x70, 0x40, 0xF1, 0x3B, 0xF1, 0x47, 0x80, -0x0C, 0xF1, 0x3B, 0x90, 0x95, 0x60, 0xE0, 0x90, -0x9C, 0x47, 0xF0, 0x31, 0x27, 0x90, 0x9C, 0x75, -0xE0, 0xFF, 0x90, 0x9C, 0x70, 0x12, 0x84, 0x5E, -0x90, 0x9C, 0x74, 0xE0, 0x7C, 0x00, 0x29, 0xF9, -0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, 0xF9, 0xEA, -0x94, 0x00, 0xFA, 0x75, 0x45, 0x01, 0x75, 0x46, -0x95, 0x75, 0x47, 0x2F, 0xA3, 0xE0, 0xF5, 0x48, -0x12, 0x69, 0xF5, 0x22, 0x12, 0x02, 0x06, 0xFF, -0x12, 0x8E, 0xE8, 0x90, 0x99, 0x8E, 0x12, 0x8F, -0xC7, 0x90, 0x99, 0x8F, 0xF0, 0x90, 0x00, 0x03, -0x12, 0x02, 0x1F, 0x90, 0x99, 0x90, 0x51, 0x20, -0x90, 0x99, 0x91, 0x31, 0x20, 0x90, 0x99, 0x92, -0xF1, 0xB5, 0x90, 0x99, 0x93, 0xF0, 0xEF, 0x12, -0x84, 0x70, 0xA2, 0xFE, 0x00, 0xA3, 0x0A, 0x01, -0xA3, 0x11, 0x02, 0xA3, 0x18, 0x03, 0xA3, 0x1F, -0x04, 0xA3, 0x26, 0x05, 0xA3, 0x34, 0x06, 0xA3, -0x5D, 0x07, 0x00, 0x00, 0xA3, 0xB7, 0x90, 0x99, -0x8C, 0x74, 0x02, 0xF0, 0xA3, 0x74, 0x29, 0xF0, -0x61, 0xBC, 0xF1, 0x33, 0x74, 0x2A, 0xF0, 0x61, -0xBC, 0xD1, 0x6B, 0x74, 0x31, 0xF0, 0x61, 0xBC, -0xD1, 0x6B, 0x74, 0x32, 0xF0, 0x61, 0xBC, 0xF1, -0x33, 0x74, 0x33, 0xF0, 0x61, 0xBC, 0x7B, 0x01, -0x7A, 0x99, 0x79, 0x8E, 0x90, 0x8A, 0x83, 0x12, -0xD2, 0x3D, 0x61, 0xD7, 0x90, 0x99, 0x8E, 0xE0, -0x90, 0x88, 0xE1, 0xF0, 0x90, 0x99, 0x8F, 0xE0, -0x90, 0x88, 0xE2, 0xF0, 0x90, 0x99, 0x90, 0xE0, -0x90, 0x88, 0xE3, 0xF0, 0x90, 0x99, 0x91, 0xE0, -0x90, 0x88, 0xE4, 0xF0, 0x90, 0x99, 0x92, 0xE0, -0x90, 0x88, 0xE5, 0xF0, 0x22, 0x90, 0x99, 0x8E, -0xE0, 0x90, 0x99, 0x87, 0xF0, 0x90, 0x99, 0x91, -0x71, 0xF5, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, -0x71, 0xF5, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x84, 0x45, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0x90, 0x99, 0x90, 0x71, 0xF5, 0x78, -0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x84, 0x45, 0xF1, -0xC7, 0x90, 0x99, 0x8F, 0x71, 0xF5, 0x12, 0x84, -0x45, 0x90, 0x99, 0x7D, 0x02, 0x04, 0x31, 0xD1, -0x6B, 0x74, 0xFF, 0xF0, 0x90, 0x99, 0x8D, 0xE0, -0xFF, 0x90, 0x99, 0x8C, 0xE0, 0xFD, 0x7B, 0x01, -0x7A, 0x99, 0x79, 0x8E, 0x90, 0x8A, 0xCF, 0xE0, -0xF8, 0xA3, 0xE0, 0xF5, 0x82, 0x88, 0x83, 0x02, -0x04, 0x7E, 0x12, 0x04, 0x31, 0x90, 0x99, 0x8C, -0xE4, 0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, -0x99, 0x8C, 0xA3, 0xE0, 0x24, 0x02, 0xF5, 0x82, -0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, -0xFC, 0xFD, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x99, 0x8C, 0xF0, -0xA3, 0xF0, 0x90, 0x99, 0x91, 0xF0, 0x90, 0x02, -0x09, 0xE0, 0x90, 0x99, 0x92, 0xF0, 0x90, 0x98, -0x15, 0x12, 0xED, 0x12, 0x90, 0x99, 0x8C, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9F, 0x71, 0xE0, -0x90, 0x95, 0xB9, 0xF0, 0x74, 0x01, 0x2F, 0x12, -0xBE, 0x71, 0xE0, 0x90, 0x95, 0xBA, 0xF0, 0xF1, -0xBC, 0x12, 0x02, 0xE7, 0x90, 0x99, 0x8C, 0xA3, -0xE0, 0x24, 0x02, 0x12, 0xBF, 0x6D, 0xFF, 0xE4, -0xFC, 0xFD, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xD1, -0x8B, 0x71, 0xF3, 0x78, 0x18, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x83, 0x00, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0xD1, 0x7E, 0x71, 0xF3, 0x78, -0x08, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x9F, 0x61, 0x71, -0xF5, 0x12, 0x83, 0x00, 0x90, 0x95, 0xBD, 0x71, -0xDA, 0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, 0x04, -0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xD1, 0x8B, -0x71, 0xF3, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, -0x83, 0x00, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, -0xC0, 0x07, 0xD1, 0x7E, 0x71, 0xF3, 0x78, 0x08, -0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -0x01, 0xD0, 0x00, 0x12, 0x9F, 0x61, 0x71, 0xF5, -0x12, 0x83, 0x00, 0x90, 0x95, 0xC1, 0x71, 0xDA, -0x78, 0x10, 0x12, 0x03, 0xFE, 0xC0, 0x04, 0xC0, -0x05, 0xC0, 0x06, 0xC0, 0x07, 0xD1, 0x8B, 0x71, -0xF3, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x83, -0x00, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0xD1, 0x7E, 0x71, 0xF3, 0x78, 0x08, 0x12, -0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, -0xD0, 0x00, 0x12, 0x9F, 0x61, 0x71, 0xF5, 0x12, -0x83, 0x00, 0x90, 0x95, 0xC5, 0x12, 0x04, 0x31, -0xF1, 0xBC, 0xD1, 0x62, 0xD1, 0x73, 0x12, 0x9F, -0x71, 0xE0, 0xFF, 0x12, 0xFD, 0x56, 0xD1, 0x50, -0xE0, 0xB4, 0x10, 0xF0, 0xD1, 0x5B, 0xD1, 0x73, -0x12, 0x9F, 0x71, 0xE0, 0xFF, 0x74, 0xD9, 0x2E, -0xF5, 0x82, 0xE4, 0x34, 0x95, 0xD1, 0x50, 0xE0, -0xB4, 0x10, 0xEB, 0xD1, 0x5B, 0xD1, 0x73, 0x12, -0x9F, 0x71, 0xE0, 0xFF, 0x74, 0xE9, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x95, 0xD1, 0x50, 0xE0, 0xB4, -0x10, 0xEB, 0x90, 0x99, 0x8C, 0xF1, 0xEB, 0x90, -0x98, 0x15, 0xF1, 0xD0, 0x90, 0x99, 0x8C, 0xE4, -0x75, 0xF0, 0x40, 0xD1, 0x62, 0x90, 0x99, 0x8E, -0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x50, 0x20, 0x90, -0x99, 0x8C, 0xA3, 0xE0, 0xFE, 0xEF, 0x2E, 0x12, -0x9F, 0x71, 0xE0, 0xFE, 0x90, 0x99, 0x92, 0xE0, -0xFD, 0xEE, 0x2D, 0xFE, 0x74, 0xF9, 0x2F, 0x12, -0xCF, 0xC7, 0xEE, 0xD1, 0x53, 0x80, 0xD6, 0x90, -0x98, 0x15, 0xE0, 0x04, 0x90, 0x99, 0x90, 0xF0, -0xE4, 0x90, 0x99, 0x8F, 0xF0, 0x90, 0x95, 0xB9, -0xE0, 0x13, 0x13, 0x54, 0x3F, 0x24, 0x01, 0xFF, -0xE4, 0x33, 0xFE, 0x90, 0x99, 0x8F, 0xE0, 0xC3, -0x9F, 0xEE, 0x12, 0xE9, 0x9A, 0x50, 0x72, 0xA3, -0xF1, 0xD0, 0xE4, 0xA3, 0xF0, 0x90, 0x99, 0x8E, -0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x54, 0xA3, -0xE0, 0x75, 0xF0, 0x04, 0xA4, 0x7C, 0x00, 0x2D, -0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x90, 0x95, 0xB9, -0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0x74, 0x80, 0xF8, -0x6E, 0x98, 0x50, 0x37, 0xEF, 0x78, 0x05, 0xC3, -0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x01, -0xF9, 0x74, 0x96, 0x3E, 0xFA, 0x7B, 0x01, 0xC0, -0x03, 0xC0, 0x01, 0x90, 0x99, 0x8C, 0xA3, 0xE0, -0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x8B, 0x45, -0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x20, 0xD0, -0x01, 0xD0, 0x03, 0xF1, 0xAE, 0xF1, 0xF2, 0xD1, -0x54, 0x80, 0xA2, 0x90, 0x99, 0x90, 0xE0, 0x04, -0xF0, 0x90, 0x99, 0x8F, 0xE0, 0x04, 0xF0, 0xA1, -0xAD, 0xE4, 0x90, 0x99, 0x8E, 0xF0, 0xE4, 0xFF, -0x0F, 0xEF, 0xB4, 0x20, 0xFB, 0xD1, 0x54, 0xE0, -0xB4, 0x10, 0xF3, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x99, 0x8E, 0xE0, -0x04, 0xF0, 0x22, 0x90, 0x99, 0x8C, 0xE4, 0x75, -0xF0, 0x10, 0x12, 0x02, 0xE7, 0xE4, 0x90, 0x99, -0x8E, 0xF0, 0x22, 0x90, 0x99, 0x8C, 0x74, 0x01, -0xF0, 0xA3, 0x22, 0x90, 0x99, 0x8C, 0xA3, 0xE0, -0xFF, 0xA3, 0xE0, 0xFE, 0x2F, 0x22, 0x90, 0x99, -0x8C, 0xA3, 0xE0, 0x24, 0x01, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0x22, 0x90, 0x99, 0x8C, 0xA3, 0xE0, -0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, -0x07, 0xEF, 0x54, 0xFC, 0xFF, 0xED, 0x54, 0x03, -0x60, 0x08, 0x74, 0xFF, 0xFF, 0xFE, 0xFD, 0xFC, -0x80, 0x74, 0x12, 0xF2, 0x47, 0x90, 0x07, 0xC0, -0x74, 0x80, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, -0xE5, 0xF9, 0xE4, 0xFF, 0x74, 0xC8, 0x2F, 0x12, -0xF2, 0x3F, 0xE0, 0xFE, 0x74, 0x84, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x9C, 0xF5, 0x83, 0xEE, 0xF0, -0x0F, 0xEF, 0xB4, 0x04, 0xE7, 0x90, 0x9C, 0x85, -0x71, 0xF5, 0x78, 0x08, 0xF1, 0xC4, 0x90, 0x9C, -0x84, 0x71, 0xF5, 0x12, 0x84, 0x45, 0xC0, 0x04, -0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9C, -0x86, 0x71, 0xF5, 0x78, 0x10, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x84, 0x45, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0xA3, 0x71, 0xF5, 0x78, 0x18, -0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, -0x01, 0xD0, 0x00, 0x12, 0x84, 0x45, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x12, 0x02, 0x4C, 0x90, 0x9C, -0x49, 0xE0, 0x22, 0x90, 0x99, 0x8C, 0x74, 0x06, -0xF0, 0xA3, 0x22, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0x2F, 0x90, 0x9C, 0x73, 0xE0, 0xFD, 0x22, 0x90, -0x9C, 0x53, 0xED, 0xF0, 0x90, 0x9C, 0x50, 0x12, -0x84, 0x67, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, -0x90, 0x9C, 0x57, 0xF0, 0x90, 0x9C, 0x50, 0x12, -0x9C, 0x2F, 0x75, 0x48, 0x03, 0x7B, 0x01, 0x7A, -0x9C, 0x79, 0x54, 0x12, 0x69, 0xF5, 0x90, 0x9C, -0x53, 0xE0, 0x70, 0x2E, 0xFF, 0xF1, 0xA3, 0xE0, -0xB4, 0xFF, 0x06, 0xF1, 0xA3, 0xE4, 0xF0, 0x80, -0x07, 0xF1, 0xA3, 0xE0, 0x04, 0xF0, 0x80, 0x05, -0x0F, 0xEF, 0xB4, 0x03, 0xE8, 0x75, 0x45, 0x01, -0x75, 0x46, 0x9C, 0x75, 0x47, 0x54, 0x75, 0x48, -0x03, 0x90, 0x9C, 0x50, 0x12, 0x84, 0x5E, 0x12, -0x69, 0xF5, 0x22, 0x74, 0x54, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x22, 0x12, 0x69, -0xF5, 0x90, 0x99, 0x8C, 0x22, 0xF0, 0x90, 0x00, -0x06, 0x02, 0x02, 0x1F, 0x90, 0x99, 0x8C, 0xE4, -0x75, 0xF0, 0x04, 0x22, 0x12, 0x03, 0xFE, 0xA8, -0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, 0x07, 0x22, -0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x99, 0x8C, -0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x99, -0x8C, 0x02, 0x84, 0x67, 0x90, 0x88, 0x34, 0xE0, -0x54, 0x0F, 0x22, 0xE4, 0x75, 0xF0, 0x10, 0x02, -0x02, 0xE7, 0xE4, 0x75, 0xF0, 0x20, 0x02, 0x02, -0xE7, 0x12, 0x02, 0x06, 0x90, 0x88, 0x9C, 0xF0, -0x60, 0x34, 0xA3, 0xE0, 0x20, 0xE0, 0x2F, 0x90, -0x8A, 0xB9, 0x12, 0x8F, 0x00, 0xE4, 0xFD, 0x7F, -0x04, 0x12, 0x04, 0x7E, 0x11, 0x37, 0x30, 0xE0, -0x1D, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, -0xE0, 0x14, 0x90, 0x88, 0x9B, 0xE0, 0x13, 0x13, -0x54, 0x3F, 0x30, 0xE0, 0x04, 0x7F, 0x0D, 0x80, -0x02, 0x7F, 0x09, 0x12, 0x71, 0x9A, 0x22, 0x90, -0x88, 0x9B, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xEF, -0x9F, 0xEC, 0x90, 0x9C, 0x5A, 0x12, 0x04, 0x31, -0x90, 0x9C, 0x5A, 0x12, 0xDA, 0xA0, 0x7F, 0x30, -0x7E, 0x08, 0x12, 0x70, 0xAD, 0x90, 0x01, 0x01, -0xE0, 0x44, 0x02, 0xF0, 0x90, 0x01, 0x00, 0x74, -0xFF, 0xF0, 0x90, 0x06, 0xB7, 0x74, 0x09, 0xF0, -0x90, 0x06, 0xB4, 0x74, 0x86, 0xF0, 0x12, 0xEF, -0xAB, 0xF0, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, -0x88, 0x9B, 0x12, 0x97, 0x90, 0x30, 0xE0, 0x05, -0x7F, 0x03, 0x12, 0x71, 0x9A, 0x90, 0x88, 0xB8, -0xE0, 0x20, 0xE0, 0x33, 0x11, 0x37, 0x30, 0xE0, -0x2E, 0x90, 0x88, 0xDF, 0xE0, 0x60, 0x07, 0xE4, -0x90, 0x9C, 0x58, 0xF0, 0x80, 0x06, 0x90, 0x9C, -0x58, 0x74, 0x01, 0xF0, 0xEF, 0xC4, 0x13, 0x54, -0x07, 0x90, 0x9C, 0x59, 0x30, 0xE0, 0x05, 0x74, -0x01, 0xF0, 0x80, 0x03, 0x74, 0x02, 0xF0, 0x90, -0x9C, 0x58, 0x12, 0xEF, 0x96, 0x11, 0xFB, 0x12, -0xC7, 0x55, 0x44, 0x01, 0x12, 0xEF, 0x90, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xB6, 0xE0, -0xFF, 0x90, 0x9C, 0x7C, 0xE0, 0xFB, 0x90, 0x92, -0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, 0x66, -0xDB, 0x90, 0x9C, 0x7D, 0xEE, 0xF0, 0xFC, 0xA3, -0xEF, 0xF0, 0xFD, 0x90, 0x9C, 0x7B, 0xE0, 0xFF, -0x90, 0x8A, 0x95, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, -0xF5, 0x82, 0x8A, 0x83, 0x02, 0x04, 0x7E, 0x90, -0x9A, 0x11, 0xED, 0xF0, 0xA3, 0xEB, 0xD1, 0xFB, -0xE4, 0x90, 0x9A, 0x14, 0xF0, 0x12, 0x93, 0xD2, -0xEF, 0x54, 0x0C, 0x64, 0x08, 0x60, 0x02, 0x21, -0xBE, 0x31, 0xC4, 0xA3, 0xE0, 0x24, 0x06, 0xFD, -0x90, 0x8A, 0xE9, 0x11, 0xFB, 0xEF, 0x64, 0x88, -0x60, 0x02, 0x21, 0xBE, 0x31, 0xC4, 0xA3, 0xE0, -0x24, 0x07, 0xFD, 0x90, 0x8A, 0xE9, 0x11, 0xFB, -0xEF, 0x64, 0x8E, 0x70, 0x79, 0x90, 0x9A, 0x14, -0x04, 0xF0, 0x31, 0xC4, 0x90, 0x9A, 0x12, 0xE0, -0xFD, 0x90, 0x9A, 0x11, 0xE0, 0x2D, 0x04, 0xFD, -0x90, 0x8A, 0xE9, 0x11, 0xFB, 0xEF, 0x64, 0x03, -0x70, 0x5C, 0x31, 0xC4, 0x90, 0x9A, 0x12, 0xE0, -0xFD, 0x90, 0x9A, 0x11, 0xE0, 0x2D, 0x24, 0x06, -0xFD, 0x90, 0x8A, 0xE9, 0x11, 0xFB, 0xEF, 0x30, -0xE3, 0x07, 0x90, 0x01, 0xC7, 0x74, 0x01, 0x80, -0x3A, 0x90, 0x93, 0x24, 0x12, 0x97, 0x90, 0x30, -0xE0, 0x24, 0x90, 0x98, 0x05, 0xE0, 0x64, 0x02, -0x70, 0x12, 0x90, 0x93, 0x25, 0x12, 0x97, 0x90, -0x30, 0xE0, 0x02, 0x80, 0x07, 0x90, 0x01, 0xC7, -0x74, 0x02, 0x80, 0x17, 0x31, 0xC4, 0xA3, 0xE0, -0xFD, 0x12, 0x93, 0xE2, 0x80, 0x10, 0x90, 0x93, -0x27, 0xD1, 0xD2, 0x30, 0xE0, 0x08, 0x90, 0x01, -0xC7, 0x74, 0x02, 0x12, 0x97, 0xEF, 0x90, 0x9A, -0x14, 0xE0, 0xFF, 0x22, 0x90, 0x9A, 0x0F, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x9B, 0xE5, -0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, -0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x9B, -0xED, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x90, 0x01, -0xC4, 0x74, 0xCD, 0xF0, 0x74, 0xA9, 0xA3, 0x12, -0xDF, 0x93, 0x12, 0xBE, 0x88, 0x90, 0x9B, 0xDA, -0x12, 0xF4, 0x8A, 0x90, 0x9B, 0xE4, 0xF0, 0x90, -0x93, 0x24, 0xE0, 0x20, 0xE0, 0x02, 0x81, 0xFF, -0xE4, 0x90, 0x9B, 0xE3, 0xF0, 0x90, 0x9B, 0xE4, -0xE0, 0xFF, 0x90, 0x9B, 0xE3, 0xE0, 0xC3, 0x9F, -0x40, 0x02, 0x81, 0xFF, 0x12, 0xFD, 0x71, 0xEC, -0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, 0x9B, 0xED, -0xEF, 0xF0, 0x12, 0xDF, 0xBF, 0x54, 0x3F, 0xFE, -0x90, 0x9B, 0xDC, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -0x9B, 0xE9, 0xEE, 0x12, 0xF4, 0xC1, 0x30, 0xE0, -0x0A, 0xC3, 0x13, 0x20, 0xE0, 0x05, 0x12, 0xF4, -0xA2, 0x80, 0x02, 0x7E, 0x00, 0xEF, 0x24, 0x18, -0x2E, 0xFF, 0x90, 0x9B, 0xEE, 0xF0, 0x90, 0x9B, -0xDB, 0xE0, 0x2F, 0xFF, 0x90, 0x9B, 0xDA, 0xE0, -0x34, 0x00, 0xFE, 0x90, 0x9B, 0xDE, 0xF0, 0xA3, -0xEF, 0xF0, 0x12, 0x93, 0xD2, 0xC0, 0x07, 0x90, -0x9B, 0xDE, 0xB1, 0x1C, 0x7D, 0x01, 0x12, 0x04, -0x7E, 0xC0, 0x07, 0x90, 0x9B, 0xDE, 0xB1, 0x1C, -0x7D, 0x04, 0x12, 0x04, 0x7E, 0xAB, 0x07, 0xD0, -0x05, 0xD0, 0x07, 0x12, 0xE6, 0xFA, 0x90, 0x9B, -0xE5, 0xEF, 0xB1, 0x0F, 0x12, 0x93, 0xD2, 0xEF, -0x54, 0xFC, 0x90, 0x9B, 0xE0, 0xF0, 0x90, 0x9B, -0xEE, 0xE0, 0xFF, 0x90, 0x9B, 0xDC, 0xE4, 0x8F, -0xF0, 0x12, 0x02, 0xE7, 0x12, 0xFD, 0x7A, 0x12, -0xF4, 0x67, 0x90, 0x9B, 0xDC, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x9B, 0xDA, 0xB1, 0x1C, 0x7D, -0x0F, 0x12, 0x04, 0x7E, 0x90, 0x9B, 0xE2, 0xEF, -0xF0, 0x12, 0xFD, 0x7A, 0x90, 0x9B, 0xDA, 0x12, -0xF4, 0x93, 0x12, 0xFD, 0x71, 0xD3, 0x9F, 0xEC, -0x9E, 0x40, 0x0F, 0x12, 0xF4, 0xB1, 0xED, 0x9F, -0xFF, 0xEC, 0x9E, 0x90, 0x9B, 0xDA, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x9B, 0x66, 0xE0, 0x60, 0x40, -0x90, 0x9B, 0xE0, 0xE0, 0x24, 0xB0, 0x60, 0x19, -0x24, 0xD0, 0x60, 0x02, 0x81, 0x78, 0x12, 0xBD, -0x10, 0x20, 0xE0, 0x1E, 0xEF, 0x13, 0x13, 0x13, -0x54, 0x1F, 0x20, 0xE0, 0x02, 0x81, 0x78, 0x80, -0x11, 0x12, 0xBD, 0x10, 0x20, 0xE0, 0x0B, 0xEF, -0x13, 0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, -0x81, 0x78, 0xB1, 0x10, 0x90, 0x9B, 0xE9, 0xE0, -0xFC, 0xA3, 0xE0, 0xFD, 0xF1, 0x9A, 0x81, 0x78, -0x90, 0x9B, 0xE0, 0xE0, 0x24, 0xF8, 0x60, 0x37, -0x24, 0x80, 0x60, 0x33, 0x24, 0xC8, 0x60, 0x06, -0x24, 0x20, 0x60, 0x02, 0x81, 0x78, 0x90, 0x93, -0x27, 0x12, 0xE8, 0xB5, 0x20, 0xE0, 0x02, 0x81, -0x78, 0x90, 0x93, 0x3A, 0xE0, 0x04, 0xB1, 0x0F, -0xB1, 0xDF, 0xEF, 0x70, 0x02, 0x81, 0x78, 0x90, -0x9B, 0xE0, 0xE0, 0xFF, 0x12, 0xF5, 0x0A, 0x90, -0x93, 0x3B, 0xE0, 0x04, 0xF0, 0x81, 0x78, 0x90, -0x93, 0x24, 0xD1, 0xD2, 0x30, 0xE0, 0x5D, 0x90, -0x9B, 0xE5, 0xE0, 0xFF, 0x90, 0x9B, 0xDF, 0xE0, -0x2F, 0xFF, 0x90, 0x9B, 0xDE, 0xE0, 0x34, 0x00, -0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, 0xFE, 0x90, -0x9B, 0xEB, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x93, -0xD2, 0xEF, 0x64, 0x45, 0x70, 0x36, 0xB1, 0xD6, -0x12, 0xFA, 0x04, 0xEF, 0x64, 0x01, 0x70, 0x2C, -0xB1, 0xD6, 0x12, 0xFA, 0x43, 0xEF, 0x64, 0x01, -0x70, 0x22, 0x90, 0x9B, 0xEF, 0x04, 0xB1, 0xD5, -0xA3, 0xE0, 0xFD, 0xF1, 0x4A, 0xEF, 0x70, 0x0C, -0x90, 0x9B, 0xED, 0xE0, 0xFD, 0x90, 0xFD, 0x11, -0xB1, 0xD5, 0xF1, 0x05, 0x90, 0x9B, 0xED, 0xE0, -0x90, 0xFD, 0x11, 0xF0, 0xB1, 0x10, 0xB1, 0xDF, -0xEF, 0x60, 0x1F, 0xB1, 0x10, 0x90, 0x9B, 0xE5, -0xE0, 0xFD, 0x90, 0x9B, 0xE8, 0xE0, 0xFB, 0x90, -0x9B, 0xED, 0xE0, 0x90, 0x9A, 0x13, 0xF0, 0x31, -0x07, 0xEF, 0x60, 0x06, 0x90, 0x9B, 0xEF, 0x74, -0x01, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, -0x30, 0xE0, 0x13, 0xB1, 0x10, 0x90, 0x9B, 0xE5, -0xE0, 0xFD, 0x12, 0x95, 0x92, 0xEF, 0x60, 0x06, -0x90, 0x9B, 0xEF, 0x74, 0x01, 0xF0, 0x90, 0x93, -0x24, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, -0x13, 0xB1, 0x10, 0x90, 0x9B, 0xE5, 0xE0, 0xFD, -0x12, 0x91, 0xE8, 0xEF, 0x60, 0x06, 0x90, 0x9B, -0xEF, 0x74, 0x01, 0xF0, 0x90, 0x93, 0x24, 0x12, -0xE8, 0xB5, 0x30, 0xE0, 0x1B, 0x90, 0x9B, 0xEF, -0xE0, 0x70, 0x15, 0xB1, 0x10, 0x90, 0x9B, 0xE5, -0xE0, 0xFD, 0xD1, 0x2C, 0xEF, 0x60, 0x09, 0x12, -0x97, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, -0xB1, 0x10, 0x90, 0x9B, 0xE5, 0xE0, 0xFD, 0xB1, -0x2D, 0xEF, 0x60, 0x0C, 0x90, 0x93, 0x2D, 0xE0, -0x54, 0xFE, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, -0x90, 0x9B, 0xE2, 0xE0, 0xFF, 0x7D, 0x01, 0x12, -0xF5, 0xD0, 0xEF, 0x60, 0x12, 0x12, 0x97, 0xF0, -0x90, 0x9B, 0xDA, 0xB1, 0x1C, 0x7D, 0x10, 0x12, -0x04, 0x7E, 0x90, 0x95, 0x61, 0xEF, 0xF0, 0x90, -0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x05, 0x7F, 0x01, -0x12, 0xB2, 0xDD, 0x12, 0xF4, 0xF3, 0xEF, 0x64, -0x01, 0x70, 0x38, 0x90, 0x93, 0x3C, 0xE0, 0x04, -0xF0, 0x12, 0xF4, 0xDD, 0xAD, 0x07, 0xEF, 0x64, -0x01, 0x60, 0x20, 0x12, 0x97, 0xF0, 0xED, 0xB4, -0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x42, 0xF0, -0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, -0xC7, 0x74, 0x43, 0xF0, 0x7F, 0x01, 0x12, 0xB2, -0xDD, 0x80, 0x24, 0x90, 0x9B, 0xDA, 0x12, 0xF3, -0xC3, 0x80, 0x14, 0x90, 0x93, 0x26, 0xE0, 0xC4, -0x13, 0x54, 0x07, 0x20, 0xE0, 0x11, 0x90, 0x93, -0x24, 0xE0, 0x54, 0xFE, 0xF0, 0x80, 0x08, 0x90, -0x9B, 0xE3, 0xE0, 0x04, 0xF0, 0x41, 0x15, 0x74, -0xCD, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xA9, -0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -0x90, 0x9B, 0xDE, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x22, 0x90, 0x9A, 0x14, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0x90, 0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, -0xF5, 0x82, 0x8C, 0x83, 0x22, 0xD1, 0xF7, 0xB1, -0xDF, 0xEF, 0x70, 0x02, 0xA1, 0xD2, 0x31, 0xC4, -0x12, 0xFD, 0xD4, 0x70, 0x02, 0xA1, 0xD2, 0x12, -0x95, 0x80, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, -0x90, 0x9A, 0x14, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, -0x93, 0x25, 0xE0, 0xC4, 0x54, 0x0F, 0x30, 0xE0, -0x33, 0xB1, 0x19, 0x7D, 0x09, 0x12, 0x04, 0x7E, -0xEF, 0x64, 0x06, 0x70, 0x27, 0xB1, 0x19, 0x7D, -0x14, 0x12, 0x04, 0x7E, 0xEF, 0x70, 0x1D, 0xB1, -0x19, 0x7D, 0x15, 0x12, 0x04, 0x7E, 0xEF, 0x64, -0x50, 0x70, 0x11, 0xB1, 0x19, 0x7D, 0x21, 0x12, -0x04, 0x7E, 0xEF, 0x20, 0xE0, 0x03, 0x30, 0xE2, -0x03, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x25, 0xE0, -0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x3B, 0xB1, -0x19, 0x7D, 0x09, 0x12, 0x04, 0x7E, 0xEF, 0x64, -0x11, 0x70, 0x2F, 0x90, 0x9A, 0x15, 0xE0, 0x24, -0x14, 0xFF, 0x90, 0x9A, 0x14, 0xE0, 0x34, 0x00, -0xFE, 0x90, 0x9A, 0x12, 0xF0, 0xA3, 0xEF, 0xF0, -0xB1, 0x21, 0x7D, 0x02, 0x12, 0x04, 0x7E, 0xEF, -0x70, 0x10, 0x90, 0x9A, 0x12, 0xB1, 0x1C, 0x7D, -0x03, 0x12, 0x04, 0x7E, 0xBF, 0x89, 0x03, 0x7F, -0x01, 0x22, 0x7F, 0x00, 0x22, 0xF0, 0x90, 0x9B, -0xEB, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, -0x9A, 0x16, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, -0x90, 0x9A, 0x1E, 0xF0, 0x90, 0x9A, 0x1E, 0xE0, -0xFD, 0xC3, 0x94, 0x06, 0x50, 0x20, 0x90, 0x9A, -0x17, 0xE0, 0x24, 0x04, 0x12, 0xFD, 0x83, 0x90, -0x8A, 0xE9, 0x11, 0xFB, 0x90, 0x9A, 0x1E, 0x12, -0x97, 0xF8, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x9A, -0x1E, 0xE0, 0x04, 0xF0, 0x80, 0xD6, 0x78, 0x2E, -0x7C, 0x93, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x9A, -0x79, 0x18, 0x12, 0xFD, 0xC2, 0x7F, 0x00, 0x70, -0x02, 0x7F, 0x01, 0x22, 0xD1, 0xF7, 0xB1, 0xDF, -0xEF, 0x60, 0x09, 0x31, 0xC4, 0x12, 0xFD, 0xD4, -0x60, 0x02, 0x7F, 0x01, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x7B, 0xEF, -0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x86, 0xB1, 0xE0, -0x04, 0xF0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, -0x07, 0x90, 0x05, 0x10, 0xE4, 0xF0, 0xA3, 0xF0, -0x90, 0x04, 0x1D, 0xE0, 0x60, 0x32, 0x90, 0x05, -0x22, 0xE0, 0x90, 0x9C, 0x7F, 0xF0, 0x7B, 0x26, -0x12, 0x8E, 0xD2, 0xEF, 0x64, 0x01, 0x70, 0x02, -0x80, 0x05, 0xD1, 0xCF, 0x30, 0xE0, 0x09, 0x11, -0xD4, 0xD1, 0xE5, 0x90, 0x8A, 0x9B, 0xD1, 0xD9, -0x90, 0x9C, 0x7F, 0xE0, 0xFD, 0x7B, 0x27, 0xE4, -0xFF, 0x12, 0x99, 0x1F, 0xD1, 0xEE, 0x80, 0x0B, -0xD1, 0xEE, 0xD1, 0xD9, 0x11, 0xD4, 0xD1, 0xE5, -0x90, 0x8A, 0x9B, 0xD1, 0xD9, 0x90, 0x88, 0x9D, -0xE0, 0x30, 0xE0, 0x16, 0xD1, 0xCF, 0x30, 0xE0, -0x11, 0x90, 0x05, 0x22, 0xE0, 0x54, 0x6F, 0xFF, -0x90, 0x8A, 0xF9, 0xB1, 0x24, 0x7D, 0x28, 0x12, -0x04, 0x7E, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, -0x88, 0xA1, 0xE0, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x22, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xF5, 0x82, -0x8C, 0x83, 0x02, 0x04, 0x7E, 0x90, 0x9C, 0x7D, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x9C, -0x7B, 0xE0, 0xFF, 0x90, 0x8A, 0xC7, 0x22, 0x90, -0x9A, 0x11, 0xED, 0xF0, 0x90, 0x9A, 0x0F, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xD1, 0xFC, 0xA3, -0xED, 0xF0, 0xE4, 0xA3, 0xF0, 0x12, 0xFD, 0x5F, -0x50, 0x20, 0x31, 0xC4, 0x12, 0xFD, 0xDC, 0x11, -0xFB, 0x90, 0x9A, 0x12, 0xE0, 0x24, 0x97, 0xF5, -0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0xB5, -0x07, 0x1D, 0x90, 0x9A, 0x12, 0xE0, 0x04, 0xF0, -0x80, 0xDB, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x80, -0xF0, 0x90, 0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, -0x01, 0x12, 0xB2, 0xDD, 0x7F, 0x01, 0x22, 0x7F, -0x00, 0x22, 0xD1, 0xFC, 0xA3, 0xED, 0xF0, 0x90, -0x95, 0x69, 0xE0, 0x70, 0x02, 0xA3, 0xE0, 0x60, -0x2D, 0xE4, 0x90, 0x9A, 0x12, 0xF0, 0x12, 0xFD, -0x5F, 0x50, 0x26, 0x31, 0xC4, 0x12, 0xFD, 0xDC, -0x11, 0xFB, 0x90, 0x9A, 0x12, 0xE0, 0x24, 0x77, -0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, -0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x90, 0x9A, -0x12, 0xE0, 0x04, 0xF0, 0x80, 0xD8, 0x7F, 0x00, -0x22, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, -0xE4, 0x90, 0x95, 0x75, 0xF0, 0xA3, 0xF0, 0x7F, -0x01, 0x22, 0xD1, 0xFC, 0x90, 0x9A, 0xE5, 0xE0, -0x64, 0x01, 0xF0, 0xE0, 0x24, 0x9A, 0x90, 0x01, -0xC4, 0xF0, 0x74, 0xAF, 0xA3, 0xF0, 0x31, 0xC4, -0x90, 0x9A, 0x13, 0xEC, 0xF0, 0xA3, 0xED, 0xF0, -0x90, 0x9A, 0x11, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -0xE4, 0x90, 0x9A, 0x37, 0xF0, 0xEF, 0x24, 0x24, -0xFF, 0xE4, 0x3E, 0xFE, 0xC0, 0x06, 0x12, 0xB2, -0xAB, 0xD0, 0x06, 0xE4, 0xFB, 0xFA, 0x12, 0xB2, -0x8D, 0x4E, 0x60, 0x3F, 0xE0, 0x24, 0x01, 0x12, -0xB1, 0xD2, 0x12, 0x93, 0xD1, 0x90, 0x9A, 0x16, -0x12, 0xB2, 0x99, 0x90, 0x9A, 0x16, 0x12, 0xB2, -0xA4, 0xFE, 0xC3, 0x9F, 0x50, 0x25, 0x90, 0x9A, -0x39, 0xE0, 0x24, 0x02, 0xFD, 0x12, 0xB1, 0xD3, -0xFC, 0xEE, 0x7E, 0x00, 0x2D, 0x12, 0x93, 0xCE, -0x90, 0x9A, 0x15, 0xE0, 0x24, 0x17, 0xF5, 0x82, -0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEF, 0xF0, 0x31, -0xE4, 0x80, 0xD0, 0x31, 0xEB, 0xC0, 0x06, 0x51, -0xAB, 0xD0, 0x06, 0x7B, 0x03, 0x51, 0x8A, 0x90, -0x9A, 0x12, 0xE0, 0x24, 0x22, 0x31, 0xF1, 0x90, -0x9A, 0x38, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x93, -0xD2, 0xEF, 0x20, 0xE4, 0x02, 0x01, 0xE9, 0x90, -0x9A, 0x37, 0xE0, 0x04, 0xF0, 0x31, 0xEB, 0xC0, -0x06, 0x51, 0xAB, 0xD0, 0x06, 0x7B, 0x30, 0x51, -0x8A, 0x4E, 0x60, 0x41, 0xE0, 0x24, 0x08, 0x31, -0xD2, 0x12, 0x93, 0xD1, 0x90, 0x9A, 0x3B, 0x51, -0x99, 0x51, 0xA1, 0xC3, 0x9F, 0x50, 0x2E, 0x90, -0x9A, 0x39, 0xE0, 0x24, 0x0D, 0x31, 0xD2, 0x12, -0x93, 0xD1, 0x90, 0x9A, 0x3A, 0xEF, 0xF0, 0xBF, -0x02, 0x09, 0x90, 0x9A, 0x37, 0xE0, 0x24, 0x20, -0xF0, 0x80, 0x0E, 0x90, 0x9A, 0x3A, 0xE0, 0xB4, -0x04, 0x07, 0x90, 0x9A, 0x37, 0xE0, 0x24, 0x40, -0xF0, 0x31, 0xDA, 0x80, 0xCC, 0x31, 0xEB, 0xC0, -0x06, 0x51, 0xAB, 0xD0, 0x06, 0x7B, 0xDD, 0x7A, -0x00, 0x7D, 0x01, 0x51, 0x8E, 0x4E, 0x60, 0x46, -0xE0, 0x24, 0x0C, 0x31, 0xD2, 0x12, 0x93, 0xD1, -0x90, 0x9A, 0x3B, 0x51, 0x99, 0x51, 0xA1, 0xC3, -0x9F, 0x50, 0x33, 0x90, 0x9A, 0x39, 0xE0, 0x24, -0x11, 0x31, 0xD2, 0x12, 0x93, 0xD1, 0x90, 0x9A, -0x3A, 0xEF, 0xF0, 0xBF, 0x02, 0x09, 0x90, 0x9A, -0x37, 0xE0, 0x24, 0x02, 0xF0, 0x80, 0x0E, 0x90, -0x9A, 0x3A, 0xE0, 0xB4, 0x04, 0x07, 0x90, 0x9A, -0x37, 0xE0, 0x24, 0x04, 0xF0, 0x31, 0xDA, 0x80, -0xCC, 0xE4, 0x90, 0x9A, 0x37, 0xF0, 0x90, 0x95, -0xB9, 0xE0, 0x90, 0x04, 0xFD, 0x51, 0x9A, 0x90, -0x95, 0xB9, 0x51, 0xA4, 0xFE, 0xC3, 0x9F, 0x50, -0x61, 0x12, 0xFD, 0x56, 0xF5, 0x83, 0xE0, 0xFF, -0x90, 0x9A, 0x16, 0xE0, 0xFE, 0x6F, 0x70, 0x4E, -0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, 0x90, 0x9A, -0x15, 0xE0, 0x24, 0xD9, 0xF5, 0x82, 0xE4, 0x34, -0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x9A, 0x37, -0xE0, 0xFD, 0x4F, 0x60, 0x04, 0xED, 0x5F, 0x60, -0x2D, 0xEE, 0xFF, 0x7E, 0x00, 0xC0, 0x06, 0xC0, -0x07, 0x90, 0x9A, 0x15, 0xE0, 0x75, 0xF0, 0x20, -0xA4, 0x24, 0x01, 0xF9, 0x74, 0x96, 0x51, 0xD1, -0xD0, 0x07, 0xD0, 0x06, 0x12, 0x86, 0x1C, 0xEF, -0x70, 0x0C, 0x90, 0x01, 0xC7, 0x74, 0x55, 0xF0, -0x7F, 0x01, 0x51, 0xDD, 0xB1, 0xDD, 0x31, 0xE4, -0x80, 0x95, 0xE4, 0x90, 0x9A, 0x15, 0xF0, 0x90, -0x9A, 0x15, 0xE0, 0xFF, 0xC3, 0x94, 0x03, 0x50, -0x60, 0xA3, 0xE0, 0xFE, 0x60, 0x57, 0xEF, 0x75, -0xF0, 0x21, 0xA4, 0x24, 0x03, 0xF5, 0x82, 0xE4, -0x34, 0x9B, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, 0x6F, -0x70, 0x43, 0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, -0x90, 0x9A, 0x16, 0xE0, 0xFF, 0x7E, 0x00, 0xC0, -0x06, 0xC0, 0x07, 0x90, 0x9A, 0x15, 0xE0, 0x75, -0xF0, 0x21, 0xA4, 0x24, 0x04, 0xF9, 0x74, 0x9B, -0x51, 0xD1, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x86, -0x1C, 0xEF, 0x70, 0x19, 0x90, 0x01, 0xC7, 0x74, -0x24, 0xF0, 0x7F, 0x01, 0x51, 0xDD, 0x12, 0xBD, -0x10, 0x30, 0xE0, 0x02, 0xB1, 0xED, 0xF1, 0xAD, -0xE4, 0xFF, 0x12, 0x8F, 0xF6, 0x31, 0xE4, 0x80, -0x96, 0x22, 0xFF, 0x90, 0x9A, 0x38, 0xE0, 0x34, -0x00, 0x22, 0x90, 0x9A, 0x38, 0xE4, 0x75, 0xF0, -0x04, 0x12, 0x02, 0xE7, 0x90, 0x9A, 0x15, 0xE0, -0x04, 0xF0, 0x22, 0x90, 0x9A, 0x12, 0xE0, 0x24, -0x24, 0xFF, 0x90, 0x9A, 0x11, 0xE0, 0x34, 0x00, -0xFE, 0x22, 0x12, 0xFC, 0xAC, 0xED, 0xF0, 0xA3, -0xEA, 0xF0, 0xA3, 0xEB, 0xF0, 0xC3, 0x90, 0x9A, -0x42, 0xE0, 0x94, 0x01, 0x90, 0x9A, 0x41, 0xE0, -0x94, 0x00, 0x50, 0x02, 0x80, 0x70, 0xE4, 0x90, -0x9A, 0x45, 0xF0, 0xA3, 0xF0, 0x51, 0xC8, 0x12, -0x93, 0xD2, 0x90, 0x9A, 0x3F, 0xE0, 0x70, 0x03, -0xA3, 0xE0, 0x6F, 0x70, 0x18, 0x90, 0x9A, 0x3D, -0xE0, 0x24, 0x02, 0x51, 0xC0, 0xFE, 0x90, 0x9A, -0x3E, 0xE0, 0xFD, 0x12, 0xF9, 0xCD, 0xBF, 0x01, -0x02, 0x41, 0xC8, 0x80, 0x00, 0x90, 0x9A, 0x3D, -0xE0, 0x24, 0x01, 0x51, 0xC0, 0x12, 0x93, 0xD1, -0x7E, 0x00, 0x90, 0x9A, 0x43, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x24, 0x02, 0xFF, 0xEE, 0x33, 0xFE, -0x90, 0x9A, 0x3C, 0x8F, 0xF0, 0x12, 0x02, 0xE7, -0x90, 0x9A, 0x45, 0xEE, 0x8F, 0xF0, 0x12, 0x02, -0xE7, 0x90, 0x9A, 0x41, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0xC3, 0x90, 0x9A, 0x46, 0xE0, 0x9F, 0x90, -0x9A, 0x45, 0xE0, 0x9E, 0x40, 0x97, 0xE4, 0xFE, -0xFF, 0x22, 0x7A, 0x00, 0xE4, 0xFD, 0x31, 0xFA, -0x90, 0x9A, 0x38, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, -0x22, 0xEF, 0xF0, 0xE4, 0x90, 0x9A, 0x15, 0xF0, -0x22, 0x90, 0x9A, 0x3B, 0xE0, 0xFF, 0x90, 0x9A, -0x15, 0xE0, 0x22, 0x90, 0x9A, 0x14, 0xE0, 0x24, -0xDC, 0xFE, 0x90, 0x9A, 0x13, 0xE0, 0x34, 0xFF, -0x90, 0x9A, 0x41, 0xF0, 0xA3, 0xCE, 0xF0, 0x22, -0xFF, 0x90, 0x9A, 0x3C, 0xE0, 0x34, 0x00, 0x22, -0x90, 0x9A, 0x3C, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x22, 0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, 0x17, -0x7C, 0x9A, 0x7D, 0x01, 0x22, 0x90, 0x9C, 0xAA, -0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x02, -0x70, 0x1F, 0x90, 0x9C, 0xAA, 0xE0, 0xFD, 0x64, -0x01, 0x70, 0x68, 0x12, 0x97, 0xF0, 0x12, 0xE8, -0xB2, 0x30, 0xE0, 0x09, 0x90, 0x01, 0x4D, 0xE0, -0x64, 0x80, 0xF0, 0x80, 0x56, 0xAF, 0x05, 0x80, -0x4F, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, -0x32, 0x90, 0x99, 0x7B, 0xE0, 0xFF, 0x30, 0xE0, -0x2A, 0x90, 0x00, 0xD4, 0xE0, 0x54, 0xEF, 0xF0, -0x90, 0x00, 0xC6, 0xE0, 0x54, 0xFD, 0xF0, 0x90, -0x00, 0x01, 0xE0, 0x44, 0x30, 0xF0, 0x90, 0x00, -0x23, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0xCC, -0xE0, 0x54, 0xFB, 0xF0, 0xEF, 0x54, 0xFE, 0x90, -0x99, 0x7B, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, -0xF0, 0x12, 0xFE, 0x0C, 0x90, 0x06, 0x90, 0xE0, -0x44, 0x01, 0xF0, 0x90, 0x9C, 0xAA, 0xE0, 0xFF, -0x12, 0xF0, 0x4D, 0xF1, 0x4D, 0xF0, 0x90, 0x93, -0x24, 0xE0, 0x54, 0xBF, 0xF0, 0x22, 0x71, 0x5E, -0xE4, 0x90, 0x98, 0x11, 0x71, 0x87, 0x90, 0x95, -0x63, 0x71, 0x87, 0xA3, 0x71, 0x87, 0xA3, 0xF0, -0xA3, 0xF0, 0x90, 0x95, 0x75, 0xF0, 0xA3, 0xF0, -0x90, 0x95, 0xB7, 0xF0, 0xA3, 0xF0, 0x22, 0xF0, -0xA3, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, -0x9A, 0xCC, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0xA3, -0x12, 0x84, 0x67, 0x91, 0x6C, 0x8B, 0x45, 0x8A, -0x46, 0x91, 0x15, 0x24, 0x02, 0x91, 0x5F, 0xE9, -0x24, 0x04, 0x91, 0x0E, 0x24, 0x03, 0x91, 0x5F, -0xE9, 0x24, 0x08, 0x91, 0x0E, 0x24, 0x04, 0x91, -0x5F, 0xE9, 0x24, 0x0C, 0x91, 0x0E, 0x24, 0x05, -0x91, 0x72, 0x79, 0xD2, 0x91, 0x2C, 0x90, 0x9A, -0xCD, 0xE0, 0xFD, 0xB4, 0x02, 0x08, 0x90, 0x9A, -0xCC, 0xE0, 0x44, 0x48, 0x80, 0x0A, 0xED, 0xB4, -0x04, 0x0A, 0x90, 0x9A, 0xCC, 0xE0, 0x44, 0x50, -0x90, 0x9A, 0xD2, 0xF0, 0x90, 0x9A, 0xD3, 0x74, -0x80, 0xF0, 0xA3, 0x74, 0xFF, 0xF0, 0xA3, 0xF0, -0x91, 0x23, 0x91, 0x72, 0x79, 0xD2, 0x91, 0x2C, -0x90, 0x9A, 0xD2, 0x74, 0xFF, 0x71, 0x87, 0x91, -0x23, 0x04, 0x91, 0x72, 0x79, 0xD2, 0x91, 0x2C, -0x90, 0x06, 0x72, 0xE4, 0xF0, 0x22, 0xF9, 0xE4, -0x3A, 0x8B, 0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, -0x48, 0x04, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0xD2, -0x12, 0x69, 0xF5, 0x90, 0x9A, 0xCC, 0xE0, 0x75, -0xF0, 0x08, 0xA4, 0x22, 0x12, 0x02, 0x06, 0x90, -0x06, 0x74, 0x12, 0x8E, 0xE7, 0x90, 0x06, 0x75, -0x12, 0x8F, 0xC7, 0x90, 0x06, 0x76, 0xF0, 0x90, -0x00, 0x03, 0x12, 0x02, 0x1F, 0x90, 0x06, 0x77, -0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, 0xE4, -0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, 0xF0, -0x7F, 0x01, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0xFF, -0x90, 0x9A, 0xD1, 0xF0, 0x7B, 0x01, 0x7A, 0x9A, -0x79, 0xD2, 0x91, 0x2C, 0x90, 0x9A, 0xCE, 0x02, -0x84, 0x5E, 0xFF, 0x90, 0x9A, 0xD1, 0xF0, 0x7B, -0x01, 0x7A, 0x9A, 0x22, 0x7E, 0x00, 0x7F, 0x25, -0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x24, -0x12, 0x04, 0x80, 0x90, 0x06, 0x90, 0xE0, 0x44, -0x20, 0xF0, 0x12, 0xED, 0x1A, 0x71, 0x66, 0x90, -0x86, 0xB3, 0xE0, 0xFF, 0x64, 0x02, 0x70, 0x2A, -0xB1, 0x5F, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, -0x93, 0x43, 0xB1, 0x5D, 0x30, 0xE1, 0x02, 0x7E, -0x01, 0x90, 0x93, 0x41, 0xB1, 0x5D, 0x30, 0xE2, -0x02, 0x7E, 0x01, 0x90, 0x93, 0x42, 0xEE, 0xF0, -0x90, 0xFD, 0x80, 0xE0, 0x90, 0x02, 0xFB, 0xF0, -0x80, 0x4A, 0xEF, 0x64, 0x01, 0x70, 0x1D, 0xB1, -0x56, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, -0x43, 0xB1, 0x54, 0x30, 0xE1, 0x02, 0x7F, 0x01, -0x90, 0x93, 0x41, 0xB1, 0x54, 0x30, 0xE2, 0x02, -0x7F, 0x01, 0x80, 0x23, 0x90, 0x86, 0xB3, 0xE0, -0x64, 0x03, 0x70, 0x20, 0xB1, 0x4D, 0x30, 0xE0, -0x02, 0x7F, 0x01, 0x90, 0x93, 0x43, 0xB1, 0x4B, -0x30, 0xE1, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x41, -0xB1, 0x4B, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, -0x93, 0x42, 0xEF, 0xF0, 0x90, 0x93, 0x24, 0xE0, -0x54, 0xEF, 0xF0, 0xE4, 0x90, 0x95, 0xB9, 0xF0, -0xA3, 0xF0, 0x90, 0x95, 0xC1, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x00, 0x90, 0x95, 0xC5, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x90, 0x95, -0xBD, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, -0x90, 0x98, 0x01, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, 0x78, -0xE0, 0x7F, 0x00, 0x22, 0xEF, 0xF0, 0x90, 0xFD, -0x70, 0xE0, 0x7F, 0x00, 0x22, 0xEE, 0xF0, 0x90, -0xFD, 0x80, 0xE0, 0x7E, 0x00, 0x22, 0x7E, 0x00, -0x7F, 0x33, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, -0x79, 0x9D, 0x12, 0x04, 0x80, 0x90, 0x88, 0x9E, -0x74, 0x0B, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0x7E, -0x00, 0x7F, 0x0C, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -0x99, 0x79, 0x7C, 0x12, 0x04, 0x80, 0x90, 0x86, -0xB3, 0xE0, 0xFC, 0x64, 0x02, 0x70, 0x14, 0xB1, -0x5F, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0xEE, 0xB1, -0xD5, 0xFE, 0x90, 0x88, 0xA0, 0xE0, 0x54, 0xBF, -0x4E, 0xF0, 0x22, 0xEC, 0x64, 0x01, 0x70, 0x09, -0xB1, 0x56, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, -0x0F, 0x90, 0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, -0x13, 0xB1, 0x4D, 0x30, 0xE2, 0x02, 0x7F, 0x01, -0xEF, 0xB1, 0xD5, 0xFF, 0x90, 0x88, 0xA0, 0xE0, -0x54, 0xBF, 0x4F, 0xF0, 0x22, 0x54, 0x01, 0xC4, -0x33, 0x33, 0x54, 0xC0, 0x22, 0x90, 0x93, 0x24, -0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x04, -0xB1, 0xED, 0xB1, 0x14, 0x22, 0x90, 0x01, 0x53, -0xE4, 0xF0, 0xFF, 0xEF, 0x12, 0xCF, 0x95, 0xE4, -0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF5, 0x22, 0xD1, -0x03, 0x80, 0xDA, 0x90, 0x93, 0x24, 0x12, 0xD7, -0x95, 0x30, 0xE0, 0x02, 0x71, 0x66, 0x22, 0xEF, -0x70, 0x02, 0xC1, 0xC7, 0x90, 0x06, 0x0F, 0xE0, -0x20, 0xE6, 0x1D, 0x90, 0x98, 0x38, 0xE0, 0x54, -0xFE, 0xF0, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, -0x07, 0x90, 0x01, 0x0C, 0xE0, 0x30, 0xE1, 0x45, -0x90, 0x01, 0xC7, 0x74, 0x44, 0xF0, 0x80, 0xFE, -0x90, 0x98, 0x38, 0xE0, 0x44, 0x01, 0xF0, 0x90, -0x06, 0x0F, 0xE0, 0x30, 0xE5, 0x10, 0x90, 0x01, -0x0C, 0xE0, 0x20, 0xE1, 0x09, 0x90, 0x98, 0x38, -0xE0, 0x54, 0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x06, -0x0F, 0xE0, 0x20, 0xE5, 0x10, 0x90, 0x01, 0x0C, -0xE0, 0x30, 0xE1, 0x09, 0x90, 0x98, 0x38, 0xE0, -0x44, 0x02, 0xF0, 0x80, 0x08, 0x90, 0x01, 0xC7, -0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x98, 0x07, -0xE0, 0xFF, 0x60, 0x03, 0x12, 0xF5, 0x5B, 0x90, -0x01, 0xC7, 0xE4, 0xF0, 0x90, 0x01, 0x17, 0xE0, -0xFE, 0x90, 0x01, 0x16, 0x12, 0xBE, 0x88, 0x12, -0xFD, 0xEC, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, -0xF0, 0x7B, 0x35, 0x7D, 0xFF, 0x7F, 0xFF, 0x12, -0x99, 0x1F, 0x90, 0x8A, 0xEF, 0x12, 0x8E, 0xDC, -0x12, 0xDF, 0x82, 0xD1, 0xDF, 0xF1, 0x2C, 0x90, -0x86, 0x0C, 0x12, 0x8E, 0xDC, 0x12, 0x99, 0x1A, -0x12, 0xF6, 0xBD, 0x90, 0x01, 0x34, 0x74, 0x08, -0xF0, 0xFD, 0xE4, 0xFF, 0x02, 0x7C, 0x74, 0x7D, -0x08, 0xE4, 0xFF, 0x12, 0x7C, 0x7E, 0x90, 0x06, -0x90, 0xE0, 0x54, 0xF0, 0xF0, 0x12, 0xDE, 0xE0, -0x12, 0xEC, 0xE8, 0xB1, 0xFF, 0x81, 0x7C, 0x12, -0xF4, 0xDD, 0xAD, 0x07, 0x90, 0x01, 0xC4, 0x74, -0xDF, 0xF0, 0x74, 0xB6, 0xA3, 0xF0, 0xED, 0x64, -0x01, 0x60, 0x1D, 0x12, 0x97, 0xF0, 0xED, 0xB4, -0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x40, 0xF0, -0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, 0x90, 0x01, -0xC7, 0x74, 0x41, 0xF0, 0x7F, 0x01, 0x41, 0xDD, -0x12, 0xF3, 0xD6, 0x90, 0x02, 0x87, 0xE0, 0x70, -0xF7, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x02, 0xF0, -0x74, 0xDF, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, -0xB6, 0xA3, 0xF0, 0x22, 0xF1, 0xEA, 0x12, 0xCF, -0xBF, 0x30, 0xE0, 0x18, 0x90, 0x93, 0x04, 0xE0, -0xFF, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x0D, 0x90, -0x9C, 0x65, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -0x14, 0x12, 0xCD, 0x76, 0x22, 0x90, 0x98, 0x1C, -0xE0, 0x54, 0xFE, 0x22, 0x90, 0x98, 0x1C, 0xE0, -0xFD, 0x30, 0xE0, 0x50, 0x90, 0x98, 0x21, 0xE0, -0xFC, 0x60, 0x49, 0x12, 0xC7, 0x63, 0x80, 0x05, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0x90, 0x04, 0xE0, 0xE0, 0xFB, 0xEF, 0x5B, 0x60, -0x0B, 0xE4, 0x90, 0x98, 0x21, 0xF0, 0x90, 0x98, -0x23, 0x04, 0xF0, 0x22, 0x90, 0x98, 0x1E, 0xE0, -0xD3, 0x9C, 0x50, 0x17, 0xED, 0x13, 0x13, 0x13, -0x54, 0x1F, 0x30, 0xE0, 0x05, 0x12, 0xCF, 0xEE, -0x80, 0x05, 0x12, 0xE7, 0xDD, 0x51, 0xDD, 0xF1, -0x4D, 0xF0, 0x22, 0x90, 0x8A, 0xAF, 0x12, 0x8F, -0x00, 0x12, 0xFC, 0xDF, 0x22, 0x12, 0xFD, 0x17, -0x79, 0x08, 0x02, 0x04, 0x80, 0xF1, 0xEB, 0x12, -0x7B, 0xDB, 0x12, 0xC8, 0x8A, 0xF1, 0xAD, 0x91, -0x7C, 0x12, 0xF3, 0x87, 0x12, 0xF7, 0x0A, 0x90, -0x8A, 0x73, 0x12, 0x8E, 0xDC, 0x90, 0x98, 0x30, -0xE0, 0x54, 0x7F, 0xF0, 0x54, 0xBF, 0xF0, 0x54, -0xDF, 0xF0, 0x54, 0xF0, 0xF0, 0xE4, 0x90, 0x98, -0x32, 0xF0, 0x90, 0x98, 0x30, 0xE0, 0x54, 0xEF, -0xF0, 0x22, 0x22, 0xE4, 0xFD, 0xFF, 0x02, 0x6E, -0x71, 0x90, 0x93, 0x0C, 0xE0, 0x20, 0xE0, 0x03, -0x02, 0xB8, 0xBD, 0xE4, 0x90, 0x99, 0x8C, 0xF0, -0x90, 0x99, 0x8C, 0xE0, 0xFF, 0xC3, 0x94, 0x05, -0x40, 0x02, 0x01, 0xBD, 0x12, 0xC7, 0x63, 0x80, -0x05, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, -0xFF, 0x90, 0x93, 0x0D, 0xE0, 0xFD, 0xEF, 0x5D, -0x60, 0x02, 0x01, 0xB5, 0x12, 0x02, 0x06, 0xFF, -0x30, 0xE0, 0x1A, 0x90, 0x93, 0x0E, 0xE0, 0xFE, -0x90, 0x99, 0x8C, 0xE0, 0xFD, 0x74, 0x01, 0xA8, -0x05, 0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -0x4E, 0x90, 0x93, 0x0E, 0xF0, 0xEF, 0xC3, 0x13, -0x30, 0xE0, 0x15, 0x90, 0x93, 0x0F, 0xE0, 0xFF, -0x90, 0x99, 0x8C, 0x11, 0xC6, 0x80, 0x02, 0xC3, -0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, 0x0F, 0xF0, -0x12, 0x8E, 0xE8, 0xFF, 0x90, 0x99, 0x8C, 0xE0, -0xFE, 0x24, 0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, -0xF5, 0x83, 0xEF, 0x12, 0x8F, 0xC7, 0xFF, 0x74, -0x15, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, -0x83, 0xEF, 0xF1, 0x9B, 0x74, 0x1A, 0x2E, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, -0xA2, 0x20, 0xFF, 0x74, 0x1F, 0x2E, 0xF5, 0x82, -0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, -0x93, 0x0D, 0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, -0x08, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, -0x90, 0x93, 0x0D, 0xF0, 0x22, 0x90, 0x99, 0x8C, -0xE0, 0x04, 0xF0, 0x01, 0x00, 0x22, 0x7F, 0x61, -0x12, 0x7B, 0x41, 0x90, 0x9C, 0x9D, 0xE0, 0xFE, -0x74, 0x01, 0xA8, 0x06, 0x08, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x9E, -0xED, 0xF0, 0x90, 0x9C, 0x9D, 0xEF, 0xF0, 0xD3, -0x94, 0x07, 0x50, 0x42, 0x7F, 0x47, 0x11, 0xC0, +0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, +0x12, 0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, +0x04, 0x11, 0x90, 0x9C, 0x9E, 0xE0, 0xFF, 0x60, +0x05, 0x12, 0x67, 0x80, 0x80, 0x05, 0x90, 0x8A, +0xED, 0x31, 0xBD, 0x90, 0x88, 0x39, 0xE0, 0x64, +0x08, 0x60, 0x02, 0x61, 0x2E, 0x12, 0x7B, 0xCC, +0x61, 0x2E, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, +0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, +0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, +0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, 0x90, 0x86, +0x00, 0x31, 0xBD, 0xBF, 0x01, 0x03, 0x12, 0x71, +0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, +0x02, 0x61, 0x2E, 0x90, 0x86, 0x00, 0x31, 0xBD, +0xEF, 0x64, 0x01, 0x60, 0x02, 0x61, 0x2E, 0x12, +0x68, 0xC2, 0x61, 0x2E, 0x90, 0x88, 0x39, 0xE0, +0xB4, 0x0E, 0x0B, 0x90, 0x86, 0x00, 0x31, 0xBD, +0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, +0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, +0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, 0x0B, 0x90, +0x86, 0x00, 0x31, 0xBD, 0xBF, 0x01, 0x03, 0x12, +0x68, 0xC2, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x04, +0x70, 0x64, 0x90, 0x86, 0x02, 0x31, 0xBD, 0xEF, +0x64, 0x01, 0x70, 0x5A, 0x12, 0x73, 0x5A, 0x80, +0x55, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0E, 0x0B, +0x90, 0x86, 0x00, 0x31, 0xBD, 0xBF, 0x01, 0x03, +0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, 0xB4, +0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, 0x39, +0xE0, 0xB4, 0x0C, 0x0B, 0x90, 0x86, 0x00, 0x31, +0xBD, 0xBF, 0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, +0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, +0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, +0x15, 0x12, 0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, +0x39, 0xE0, 0xB4, 0x0C, 0x09, 0x12, 0xBF, 0xB7, +0x30, 0xE0, 0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, +0x39, 0xF1, 0xF6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xF1, +0xE3, 0x20, 0xE0, 0x0C, 0x90, 0x00, 0x04, 0xE0, +0x54, 0xF7, 0xF0, 0x12, 0xE1, 0x6C, 0x81, 0x84, +0x31, 0xAD, 0x12, 0xDA, 0x82, 0x90, 0x93, 0x29, +0x12, 0xDC, 0x94, 0xFD, 0xEF, 0x54, 0xFB, 0x4D, +0xFF, 0x90, 0x93, 0x29, 0x12, 0xDB, 0x41, 0x12, +0xDF, 0x76, 0x90, 0x93, 0x29, 0x12, 0xDF, 0x6D, +0x12, 0xDB, 0x49, 0x12, 0xDC, 0x83, 0x4D, 0xFF, +0x90, 0x93, 0x29, 0x12, 0xDF, 0x80, 0x12, 0x87, +0x9C, 0x54, 0x80, 0xFF, 0x90, 0x93, 0x2A, 0xE0, +0x54, 0x7F, 0xB1, 0xF3, 0xFF, 0x54, 0x02, 0xFE, +0x90, 0x93, 0x2D, 0xE0, 0x54, 0xFD, 0x4E, 0xFE, +0xF0, 0xEF, 0x54, 0x08, 0xFF, 0xEE, 0x54, 0xF7, +0x4F, 0x12, 0xE7, 0xE3, 0x90, 0x93, 0x2E, 0xB1, +0xF4, 0x54, 0x10, 0xFF, 0x90, 0x93, 0x2D, 0xE0, +0x54, 0xEF, 0x4F, 0xF0, 0x12, 0x02, 0x06, 0xFF, +0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, 0x07, 0x90, +0x06, 0x90, 0xE0, 0x44, 0x04, 0xF0, 0xEF, 0x13, +0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x07, 0x90, +0x06, 0x90, 0xE0, 0x44, 0x08, 0xF0, 0x90, 0x93, +0x2E, 0xE0, 0x70, 0x02, 0x04, 0xF0, 0x31, 0xAD, +0xB1, 0xF5, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x0E, +0x7F, 0x05, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0x7F, +0xFD, 0x7F, 0x05, 0x12, 0x7B, 0x2E, 0x90, 0x86, +0xB3, 0xE0, 0xB4, 0x02, 0x05, 0xF1, 0xAE, 0x20, +0xE0, 0x64, 0x31, 0xAD, 0x12, 0x87, 0x9D, 0x54, +0x7F, 0xFF, 0x90, 0x93, 0x2A, 0xE0, 0x54, 0x80, +0x4F, 0x12, 0x87, 0xA3, 0x54, 0x7F, 0xFF, 0x90, +0x93, 0x2B, 0xE0, 0x54, 0x80, 0x4F, 0xF1, 0xCC, +0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x2C, 0xE0, +0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0xFE, +0xFF, 0xEE, 0x54, 0x01, 0xB1, 0xF3, 0xFF, 0x54, +0x04, 0xFE, 0x90, 0x93, 0x2D, 0xE0, 0x54, 0xFB, +0x4E, 0xFE, 0xF0, 0xEF, 0x54, 0x01, 0xFF, 0xEE, +0x54, 0xFE, 0x4F, 0xF0, 0xB1, 0xE4, 0x54, 0x07, +0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x91, +0x89, 0x90, 0x93, 0x2D, 0xE0, 0xFF, 0xC3, 0x13, +0x30, 0xE0, 0x03, 0x12, 0xE2, 0x08, 0x90, 0x86, +0xB3, 0xE0, 0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, +0xE0, 0x44, 0x04, 0xF0, 0x90, 0x95, 0x63, 0x74, +0x05, 0xF0, 0x12, 0xF5, 0x73, 0x7A, 0x94, 0x79, +0x42, 0x12, 0x04, 0x80, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x9C, 0x92, 0xED, 0xF0, 0x90, 0x9C, 0x91, +0xEF, 0xF0, 0xD3, 0x94, 0x07, 0x50, 0x42, 0x7F, +0x47, 0xB1, 0x33, 0x80, 0x02, 0xC3, 0x33, 0xD8, +0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x47, 0x12, 0x7B, +0x2E, 0x7F, 0x46, 0xB1, 0x33, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x46, 0xF1, +0xDB, 0x60, 0x0D, 0x7F, 0x45, 0xB1, 0x33, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x80, 0x0C, +0x7F, 0x45, 0xB1, 0x33, 0x80, 0x02, 0xC3, 0x33, +0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x45, 0x80, +0x4A, 0x90, 0x9C, 0x91, 0xE0, 0x24, 0xF8, 0xF0, +0x7F, 0x63, 0xB1, 0x33, 0x80, 0x02, 0xC3, 0x33, +0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x63, 0x12, +0x7B, 0x2E, 0x7F, 0x62, 0xB1, 0x33, 0x80, 0x02, +0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, 0x62, +0xF1, 0xDB, 0x60, 0x10, 0x7F, 0x61, 0xB1, 0x33, +0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, +0x7F, 0x61, 0x80, 0x0F, 0x7F, 0x61, 0xB1, 0x33, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, -0xFD, 0x7F, 0x47, 0x12, 0x7B, 0x2E, 0x7F, 0x46, -0x11, 0xC0, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, -0x4F, 0xFD, 0x7F, 0x46, 0x91, 0x3D, 0x60, 0x0D, -0x7F, 0x45, 0x11, 0xC0, 0x80, 0x02, 0xC3, 0x33, -0xD8, 0xFC, 0x4F, 0x80, 0x0C, 0x7F, 0x45, 0x11, -0xC0, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, -0x5F, 0xFD, 0x7F, 0x45, 0x80, 0x46, 0x90, 0x9C, -0x9D, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, 0x63, 0x11, -0xC0, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, -0x5F, 0xFD, 0x7F, 0x63, 0x12, 0x7B, 0x2E, 0x7F, -0x62, 0x11, 0xC0, 0x80, 0x02, 0xC3, 0x33, 0xD8, -0xFC, 0x4F, 0xFD, 0x7F, 0x62, 0x91, 0x3D, 0x60, -0x0E, 0x11, 0xBE, 0x80, 0x02, 0xC3, 0x33, 0xD8, -0xFC, 0x4F, 0xFD, 0x7F, 0x61, 0x80, 0x0D, 0x11, -0xBE, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, -0x5F, 0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, 0xE0, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0xE3, 0xEB, -0xF0, 0x90, 0x9A, 0xE2, 0xED, 0xF0, 0x70, 0x15, -0x90, 0x9A, 0xE0, 0xE0, 0x70, 0x02, 0xA3, 0xE0, -0x60, 0x0B, 0x90, 0x9A, 0xE0, 0x74, 0xFF, 0x75, -0xF0, 0xD0, 0x12, 0x02, 0xE7, 0x31, 0xFF, 0x54, -0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, -0x11, 0xCE, 0x31, 0xFF, 0x54, 0x01, 0xFD, 0x11, -0xCE, 0x90, 0x93, 0x2A, 0xE0, 0x30, 0xE0, 0x39, -0x31, 0xF2, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, -0x02, 0x7D, 0x01, 0x11, 0xCE, 0xE4, 0x90, 0x9A, -0xE4, 0xF0, 0x90, 0x9A, 0xE3, 0xE0, 0xFF, 0xA3, -0xE0, 0xC3, 0x9F, 0x50, 0x1C, 0x31, 0xF2, 0x54, -0x01, 0xFD, 0x11, 0xCE, 0x31, 0xF2, 0x54, 0x07, -0x7D, 0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x11, -0xCE, 0x90, 0x9A, 0xE4, 0xE0, 0x04, 0xF0, 0x80, -0xD9, 0x22, 0x90, 0x9A, 0xE0, 0xE0, 0xFE, 0xA3, -0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x51, 0x0E, 0x90, -0x93, 0x28, 0xE0, 0x54, 0x7F, 0xFF, 0x90, 0x93, -0x27, 0xE0, 0xFE, 0xC4, 0x13, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x8E, 0x12, 0x8F, -0x13, 0xBD, 0x01, 0x05, 0x12, 0x7A, 0xAE, 0x80, -0x07, 0xAF, 0x13, 0xAE, 0x12, 0x12, 0x7C, 0x6A, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xA7, 0xDE, 0x12, -0x02, 0x06, 0x20, 0xE0, 0x05, 0x12, 0xEC, 0xE8, -0x61, 0x1A, 0x12, 0x8C, 0x04, 0x91, 0x45, 0x90, -0x93, 0x27, 0xB1, 0x18, 0x4F, 0x71, 0x28, 0xF1, -0xA4, 0x90, 0x93, 0x27, 0xF0, 0xEE, 0x54, 0x08, -0xFE, 0xEF, 0x54, 0xF7, 0x71, 0x27, 0xF1, 0xE4, -0x90, 0x93, 0x27, 0x71, 0x1F, 0xF1, 0xAD, 0x90, -0x93, 0x27, 0xF1, 0xB6, 0x12, 0x8E, 0xE6, 0x54, -0x80, 0xFF, 0x90, 0x93, 0x28, 0xE0, 0x54, 0x7F, -0x4F, 0x12, 0xA2, 0x20, 0xFF, 0x54, 0x02, 0xFE, -0x90, 0x93, 0x2B, 0xE0, 0x54, 0xFD, 0x4E, 0xF0, -0x12, 0x02, 0x06, 0xFE, 0x13, 0x13, 0x54, 0x3F, -0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, -0x04, 0xF0, 0xEE, 0x13, 0x13, 0x13, 0x54, 0x1F, -0x30, 0xE0, 0x07, 0x90, 0x06, 0x90, 0xE0, 0x44, -0x08, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xB4, 0x02, -0x06, 0x12, 0xE8, 0xB2, 0x20, 0xE0, 0x45, 0x12, -0x8C, 0x04, 0x12, 0x8E, 0xE8, 0x54, 0x7F, 0xFE, -0x90, 0x93, 0x28, 0xE0, 0x54, 0x80, 0x4E, 0x12, -0x8F, 0xC7, 0x90, 0x93, 0x29, 0xF0, 0x90, 0x00, -0x03, 0x12, 0x02, 0x1F, 0xFE, 0x54, 0x01, 0xFD, -0x90, 0x93, 0x2A, 0xF1, 0x93, 0x54, 0xFE, 0xFE, -0xED, 0x54, 0x01, 0x4E, 0xF0, 0xEF, 0x54, 0x04, -0xFF, 0xA3, 0xE0, 0x54, 0xFB, 0x4F, 0xF0, 0x31, -0xFF, 0x54, 0x07, 0x7D, 0x00, 0x20, 0xE0, 0x02, -0x7D, 0x01, 0x11, 0xCE, 0x90, 0x86, 0xB3, 0xE0, -0xB4, 0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x44, -0x04, 0xF0, 0x90, 0x95, 0x5F, 0x74, 0x05, 0xF0, -0x12, 0xF7, 0x1E, 0x7A, 0x94, 0x79, 0x3E, 0x12, -0x04, 0x80, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF0, -0xEE, 0x54, 0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x4E, -0xFF, 0xF0, 0x12, 0x02, 0x06, 0xFE, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x91, 0x45, -0x90, 0x93, 0x24, 0xB1, 0x18, 0x4F, 0x71, 0x28, -0xF1, 0xA4, 0x90, 0x93, 0x24, 0xF0, 0xEE, 0x54, -0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x71, 0x27, 0xF1, -0xE4, 0x90, 0x93, 0x24, 0x71, 0x1F, 0xF1, 0xAD, -0x90, 0x93, 0x24, 0xF1, 0xB6, 0x4E, 0x12, 0x8F, -0xC7, 0xFF, 0x54, 0x01, 0xFE, 0x90, 0x93, 0x26, -0xE0, 0x54, 0xFE, 0x12, 0x8E, 0xE6, 0xFE, 0x54, -0x01, 0xFD, 0x90, 0x93, 0x25, 0xF1, 0x93, 0x54, -0x04, 0xFE, 0xED, 0x54, 0xFB, 0x4E, 0xFE, 0x12, -0x8E, 0xE7, 0xFD, 0x54, 0x08, 0xFC, 0xEE, 0x54, -0xF7, 0x4C, 0xFE, 0x90, 0x93, 0x25, 0xF0, 0xED, -0x54, 0x10, 0xFD, 0xEE, 0x54, 0xEF, 0x4D, 0xF0, -0xEF, 0x54, 0x10, 0xFF, 0xA3, 0xE0, 0x54, 0xEF, -0x4F, 0xFF, 0x12, 0x8F, 0xC7, 0x54, 0x20, 0xFE, -0xEF, 0x54, 0xDF, 0x4E, 0x90, 0x93, 0x26, 0x12, -0x8E, 0xE7, 0x54, 0x02, 0xFF, 0x90, 0x93, 0x25, -0xE0, 0x54, 0xFD, 0x4F, 0xF0, 0x90, 0x01, 0x17, -0xE0, 0xFE, 0x90, 0x01, 0x16, 0xD1, 0x88, 0x12, -0xFD, 0xEC, 0x90, 0x93, 0x24, 0xE0, 0xC3, 0x13, -0x54, 0x01, 0xFF, 0x12, 0xF6, 0xF0, 0x90, 0x93, -0x24, 0xE0, 0x13, 0x13, 0x54, 0x01, 0xFF, 0x12, -0xF5, 0x86, 0x90, 0x93, 0x25, 0x12, 0x97, 0x90, -0x30, 0xE0, 0x1F, 0x90, 0x93, 0x24, 0x12, 0x91, -0xE0, 0x20, 0xE0, 0x0E, 0xEF, 0xC3, 0x13, 0x20, -0xE0, 0x08, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, -0xE0, 0x04, 0x7F, 0x01, 0x80, 0x0E, 0x7F, 0x00, -0x80, 0x0A, 0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, -0x13, 0x54, 0x01, 0xFF, 0x12, 0xEA, 0x8F, 0x90, -0x93, 0x24, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0x12, -0xF6, 0xFC, 0x90, 0x93, 0x24, 0xE0, 0xC4, 0x13, -0x13, 0x54, 0x01, 0xFF, 0xD1, 0x79, 0x90, 0x93, -0x24, 0xE0, 0x54, 0x01, 0xFF, 0x12, 0xB6, 0x0F, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x7B, 0x2E, -0x90, 0x9C, 0x9E, 0xE0, 0x22, 0x12, 0x02, 0x06, -0xFF, 0x54, 0x01, 0xFE, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x02, 0x09, 0xE0, -0xFD, 0x91, 0x45, 0x90, 0x93, 0x04, 0xB1, 0x18, -0x4F, 0x71, 0x28, 0x54, 0x04, 0xFC, 0xEF, 0x54, -0xFB, 0x4C, 0xFF, 0x90, 0x93, 0x04, 0xF0, 0xEE, -0x54, 0x08, 0xFE, 0xEF, 0x54, 0xF7, 0x4E, 0xFF, -0xF0, 0x12, 0x02, 0x06, 0x54, 0x10, 0xFE, 0xEF, -0x54, 0xEF, 0x4E, 0x90, 0x93, 0x04, 0x12, 0x8E, -0xE7, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0x05, 0x12, -0x8F, 0xC7, 0xFF, 0xED, 0x2F, 0x90, 0x93, 0x06, -0xF1, 0x9B, 0xAE, 0x05, 0xED, 0x2F, 0x90, 0x93, -0x07, 0xF0, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, -0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, -0xE0, 0x09, 0x90, 0x06, 0x31, 0xE0, 0x44, 0x40, -0xF0, 0xD1, 0x91, 0x90, 0x93, 0x04, 0xE0, 0xFF, -0x30, 0xE0, 0x3A, 0x90, 0x06, 0x32, 0xE0, 0x44, -0x01, 0xF0, 0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, -0x12, 0xDF, 0x8A, 0xEF, 0x13, 0x13, 0x54, 0x3F, -0x30, 0xE0, 0x09, 0x12, 0xDF, 0x82, 0x90, 0x9B, -0x02, 0x74, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, -0x12, 0x7C, 0x74, 0xB1, 0x10, 0x20, 0xE0, 0x0D, -0x90, 0x9C, 0x65, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x27, 0x10, 0x12, 0xCD, 0x76, 0xB1, 0x10, 0x30, -0xE0, 0x09, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x02, -0xF0, 0xB1, 0x26, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x90, 0x93, 0x04, 0xE0, 0xFF, 0xC3, 0x13, 0x22, -0xE0, 0x54, 0xFE, 0x4E, 0xFE, 0xF0, 0xEF, 0x54, -0x02, 0xFF, 0xEE, 0x54, 0xFD, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x07, -0xF1, 0xDA, 0x12, 0x9F, 0x73, 0xE0, 0x90, 0x9B, -0x03, 0xF0, 0x74, 0x01, 0x2F, 0xD1, 0x71, 0xE0, -0x90, 0x9B, 0x24, 0xF1, 0x69, 0x90, 0x9B, 0x45, -0xF0, 0xEF, 0x24, 0x20, 0x90, 0x99, 0x8C, 0xF0, -0xB1, 0xA6, 0x90, 0x9B, 0x03, 0xE0, 0xF5, 0x48, -0x7B, 0x01, 0x7A, 0x9B, 0x79, 0x04, 0x12, 0x69, -0xF5, 0x90, 0x9B, 0x03, 0xB1, 0x9D, 0x90, 0x9B, -0x24, 0xE0, 0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x9B, -0x79, 0x25, 0x12, 0x69, 0xF5, 0x90, 0x9B, 0x24, -0xB1, 0x9D, 0x90, 0x9B, 0x45, 0xE0, 0xF5, 0x48, -0x7B, 0x01, 0x7A, 0x9B, 0x79, 0x46, 0x12, 0x69, -0xF5, 0xE4, 0xFF, 0x90, 0x9B, 0x03, 0xE0, 0xFE, -0xEF, 0xC3, 0x9E, 0x50, 0x03, 0x0F, 0x80, 0xF3, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x90, -0x99, 0x8C, 0xE0, 0x2F, 0xF0, 0xE0, 0x24, 0x00, -0xF9, 0xE4, 0x34, 0xFC, 0x75, 0x45, 0x01, 0xF5, -0x46, 0x89, 0x47, 0x22, 0x90, 0x98, 0x12, 0xD1, -0x60, 0xE0, 0xFE, 0x24, 0x28, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0x74, 0x29, -0x2E, 0x12, 0xEA, 0x7D, 0xE0, 0xFD, 0x90, 0x99, -0x8C, 0xE0, 0x24, 0x2C, 0x12, 0xE6, 0xF1, 0x90, -0x99, 0x8C, 0xE0, 0x2F, 0x24, 0x30, 0xA3, 0xF0, -0xE0, 0xFD, 0x24, 0x04, 0xF1, 0x7A, 0xFE, 0x74, -0x05, 0x2D, 0xD1, 0x81, 0x90, 0x95, 0x6D, 0xF0, -0xA3, 0xEF, 0xF0, 0x90, 0x99, 0x8D, 0xE0, 0x24, -0x0C, 0xF9, 0xE4, 0x34, 0xFC, 0xB1, 0xAC, 0x75, -0x48, 0x04, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x6F, -0x12, 0x69, 0xF5, 0x90, 0x99, 0x8D, 0xE0, 0x24, -0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0xD1, 0x71, -0xE0, 0xFE, 0x74, 0x00, 0x2D, 0x12, 0x9F, 0x73, -0xD1, 0x88, 0x90, 0x95, 0x73, 0xF0, 0xA3, 0xEF, -0xF0, 0x90, 0x98, 0x13, 0xD1, 0x60, 0x90, 0x95, -0x69, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x4E, 0x60, -0x10, 0x90, 0x99, 0x8C, 0xB1, 0xA5, 0x8F, 0x48, -0x7B, 0x01, 0x7A, 0x95, 0x79, 0x77, 0x12, 0x69, -0xF5, 0x90, 0x98, 0x14, 0xD1, 0x60, 0xB1, 0xA6, -0x90, 0x95, 0x6B, 0xA3, 0xE0, 0xF5, 0x48, 0x7B, -0x01, 0x7A, 0x95, 0x79, 0x97, 0x02, 0x69, 0xF5, -0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x99, 0x8C, -0xEF, 0xF0, 0x22, 0x74, 0x03, 0xF0, 0x74, 0x01, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0x22, 0xEF, 0x60, 0x04, 0xD1, 0xE2, 0xB1, 0xB4, -0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0xE0, 0x7C, 0x00, 0x24, 0x00, 0xFF, 0xEC, 0x3E, -0x22, 0x90, 0x93, 0x06, 0xF1, 0xDA, 0x12, 0x9F, -0x73, 0xE0, 0x90, 0x9A, 0xEA, 0xF0, 0x74, 0x01, -0x2F, 0xD1, 0x71, 0xE0, 0x90, 0x9A, 0xEB, 0xF1, -0x69, 0x90, 0x9A, 0xEC, 0xF0, 0x74, 0x03, 0x2F, -0xF1, 0x8B, 0xE0, 0x90, 0x9A, 0xED, 0xF1, 0x76, -0x90, 0x9A, 0xEE, 0xF0, 0x74, 0x05, 0x2F, 0xF1, -0x83, 0xE0, 0x90, 0x9A, 0xEF, 0xF0, 0x74, 0x06, -0x2F, 0xF1, 0xC8, 0x90, 0x9A, 0xF0, 0xF0, 0x74, -0x07, 0x2F, 0xF1, 0xD1, 0x90, 0x9A, 0xF1, 0xF0, -0x74, 0x08, 0x2F, 0xF1, 0xBF, 0x90, 0x9A, 0xF2, -0xF0, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x98, 0x11, -0x12, 0xEA, 0x85, 0xAB, 0x05, 0x74, 0x01, 0x2B, -0xD1, 0x71, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, -0x9F, 0x73, 0x12, 0xDF, 0xD5, 0x90, 0x95, 0x63, -0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, 0xF1, -0x8B, 0xE0, 0xFE, 0x74, 0x02, 0x2B, 0xF1, 0x6D, -0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x65, -0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x05, 0x2B, 0xF1, -0x83, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0xF1, 0x7A, -0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x67, -0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, 0x2B, 0xF1, -0xD1, 0xFE, 0x74, 0x06, 0x2B, 0xF1, 0xC8, 0x24, -0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x69, 0xF0, -0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, 0xF5, 0x82, -0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFE, 0x74, -0x08, 0x2B, 0xF1, 0xBF, 0x24, 0x00, 0xFF, 0xEC, -0x3E, 0x90, 0x95, 0x6B, 0xF0, 0xA3, 0xEF, 0xF0, -0x22, 0xF0, 0x74, 0x02, 0x2F, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF0, 0x74, -0x04, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -0xF5, 0x83, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, -0xF5, 0x83, 0x22, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, -0xF0, 0xEE, 0x22, 0xF0, 0x90, 0x00, 0x03, 0x12, -0x02, 0x1F, 0xFF, 0x22, 0x54, 0x04, 0xFD, 0xEF, -0x54, 0xFB, 0x4D, 0xFF, 0x22, 0x54, 0x40, 0xFD, -0xEF, 0x54, 0xBF, 0x4D, 0xFF, 0x22, 0xF0, 0xEE, -0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, 0x22, 0xF5, -0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0xE0, 0x22, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x74, -0x00, 0x2F, 0x22, 0xFE, 0x54, 0x10, 0xFD, 0xEF, -0x54, 0xEF, 0x4D, 0xFF, 0x22, 0x12, 0x02, 0x06, -0x54, 0x01, 0xFF, 0x90, 0x93, 0x0C, 0xE0, 0x54, -0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x04, 0xE4, 0x12, -0xB3, 0x88, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, -0x98, 0x24, 0xF0, 0xBF, 0x01, 0x09, 0x7F, 0x01, -0x11, 0x18, 0xE4, 0x90, 0x98, 0x24, 0xF0, 0x22, -0x90, 0x99, 0x8C, 0xEF, 0xF0, 0x51, 0x70, 0x7F, -0xF4, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x08, 0x90, 0x99, 0xD3, 0xE0, 0x90, 0x99, 0xD5, -0xF0, 0x51, 0x70, 0x7F, 0xF5, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xD3, -0xE0, 0x90, 0x99, 0xD6, 0xF0, 0x51, 0x70, 0x7F, -0xF6, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x08, 0x90, 0x99, 0xD3, 0xE0, 0x90, 0x99, 0xD7, -0xF0, 0x51, 0x70, 0x7F, 0xF7, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xD3, -0xE0, 0x90, 0x99, 0xD8, 0xF0, 0x51, 0x70, 0x7F, -0xF8, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x08, 0x90, 0x99, 0xD3, 0xE0, 0x90, 0x99, 0xD9, -0xF0, 0x51, 0x70, 0x71, 0x16, 0xBF, 0x01, 0x08, -0x90, 0x99, 0xD3, 0xE0, 0x90, 0x99, 0xDA, 0xF0, -0x51, 0x70, 0x51, 0x77, 0x64, 0x01, 0x70, 0x54, -0x90, 0x99, 0xD3, 0xE0, 0x90, 0x99, 0xDB, 0xF0, -0x54, 0x07, 0x60, 0x08, 0x90, 0x99, 0xD3, 0xE0, -0x54, 0xE0, 0x70, 0x40, 0x7B, 0x01, 0x7A, 0x99, -0x79, 0xD4, 0x7F, 0xFA, 0x51, 0x79, 0x64, 0x01, -0x70, 0x32, 0x90, 0x99, 0xD3, 0xE0, 0xFC, 0x54, -0x07, 0x70, 0x12, 0x90, 0x99, 0xDB, 0xE0, 0xFE, -0x90, 0x99, 0xD4, 0xE0, 0x54, 0x07, 0xFD, 0xEE, -0x4D, 0x90, 0x99, 0xDB, 0xF0, 0xEC, 0x54, 0xE0, -0x70, 0x12, 0x90, 0x99, 0xDB, 0xE0, 0xFF, 0x90, -0x99, 0xD4, 0xE0, 0x54, 0xE0, 0xFE, 0xEF, 0x4E, -0x90, 0x99, 0xDB, 0xF0, 0x51, 0x70, 0x7F, 0xFD, -0x51, 0x79, 0x64, 0x01, 0x70, 0x4B, 0x90, 0x99, -0xD3, 0xE0, 0xFE, 0x54, 0xCC, 0x90, 0x99, 0xDC, -0xF0, 0xEE, 0x54, 0x0C, 0xFF, 0x60, 0x08, 0x90, -0x99, 0xD3, 0xE0, 0x54, 0xC0, 0x70, 0x32, 0xEF, -0x70, 0x16, 0x90, 0x99, 0xDC, 0xE0, 0xFF, 0x90, -0x99, 0xD3, 0xE0, 0x54, 0x03, 0x25, 0xE0, 0x25, -0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x99, 0xDC, 0xF0, -0x90, 0x99, 0xD3, 0xE0, 0xFF, 0x54, 0xC0, 0x70, -0x10, 0x90, 0x99, 0xDC, 0xE0, 0xFE, 0xEF, 0x54, -0x30, 0x25, 0xE0, 0x25, 0xE0, 0xFF, 0xEE, 0x4F, -0xF0, 0x51, 0x70, 0x7F, 0xF0, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xD3, -0xE0, 0x90, 0x99, 0xDD, 0xF0, 0x51, 0x70, 0x7F, -0xF1, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x08, 0x90, 0x99, 0xD3, 0xE0, 0x90, 0x99, 0xDE, -0xF0, 0x51, 0x70, 0x7F, 0xF2, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xD3, -0xE0, 0x90, 0x99, 0xDF, 0xF0, 0x51, 0x70, 0x7F, -0xF3, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, -0x08, 0x90, 0x99, 0xD3, 0xE0, 0x90, 0x99, 0xE0, -0xF0, 0x51, 0x70, 0x7F, 0xFC, 0x7E, 0x01, 0x12, -0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xD3, -0xE0, 0x90, 0x99, 0xE1, 0xF0, 0x90, 0x99, 0x8D, -0x74, 0x19, 0xF0, 0x90, 0x99, 0xAF, 0x74, 0x08, -0xF0, 0x90, 0x99, 0xD5, 0xE0, 0x90, 0x99, 0x8F, -0xF0, 0x90, 0x99, 0xD6, 0xE0, 0x90, 0x99, 0x90, -0xF0, 0x90, 0x99, 0xD7, 0xE0, 0x90, 0x99, 0x91, -0xF0, 0x90, 0x99, 0xD8, 0xE0, 0x90, 0x99, 0x92, -0xF0, 0x90, 0x99, 0xD9, 0xE0, 0x90, 0x99, 0x93, -0xF0, 0x90, 0x99, 0xDA, 0xE0, 0x90, 0x99, 0x94, -0xF0, 0x90, 0x99, 0xDB, 0xE0, 0x90, 0x99, 0x95, -0xF0, 0x90, 0x99, 0xDC, 0xE0, 0x90, 0x99, 0x96, -0xF0, 0x90, 0x99, 0xB0, 0x74, 0x1A, 0xF0, 0x90, -0x99, 0xD2, 0x74, 0x05, 0xF0, 0x90, 0x99, 0xDD, -0xE0, 0x90, 0x99, 0xB2, 0xF0, 0x90, 0x99, 0xDE, -0xE0, 0x90, 0x99, 0xB3, 0xF0, 0x90, 0x99, 0xDF, -0xE0, 0x90, 0x99, 0xB4, 0xF0, 0x90, 0x99, 0xE0, -0xE0, 0x90, 0x99, 0xB5, 0xF0, 0x90, 0x99, 0xE1, -0xE0, 0x90, 0x99, 0xB6, 0xF0, 0x90, 0x99, 0x8C, -0xE0, 0xB4, 0x01, 0x1A, 0x7B, 0x01, 0x7A, 0x99, -0x79, 0x8D, 0x12, 0xD2, 0x3A, 0x12, 0x04, 0x7E, -0x7B, 0x01, 0x7A, 0x99, 0x79, 0xB0, 0x12, 0x8E, -0xEE, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x75, 0x45, -0x01, 0x75, 0x46, 0x99, 0x75, 0x47, 0x8D, 0x75, -0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, 0x79, 0xA0, -0x12, 0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, 0x46, -0x99, 0x75, 0x47, 0xB2, 0x75, 0x48, 0x05, 0x7B, -0x01, 0x7A, 0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, -0x7B, 0x01, 0x7A, 0x99, 0x79, 0xD3, 0x22, 0x7F, -0xFB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xEF, 0x22, -0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, 0x7B, 0x01, -0x7A, 0x98, 0x79, 0x25, 0x12, 0x04, 0x80, 0x7B, -0x01, 0x7A, 0x99, 0x79, 0x88, 0x71, 0x16, 0xBF, -0x01, 0x1C, 0x90, 0x99, 0x88, 0xE0, 0xFE, 0x54, -0x01, 0x90, 0x98, 0x25, 0xF0, 0xEE, 0x54, 0x04, -0x90, 0x98, 0x27, 0xF0, 0x90, 0x99, 0x88, 0xE0, -0x54, 0x08, 0x90, 0x98, 0x26, 0xF0, 0x7B, 0x01, -0x7A, 0x99, 0x79, 0x88, 0x51, 0x77, 0x64, 0x01, -0x70, 0x35, 0x90, 0x99, 0x88, 0xE0, 0x54, 0x07, -0x70, 0x15, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0x89, -0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x0F, 0x90, 0x99, 0x89, 0x80, 0x03, 0x90, -0x99, 0x88, 0xE0, 0x54, 0x07, 0x90, 0x98, 0x29, -0xF0, 0x90, 0x99, 0x88, 0xE0, 0x54, 0xE0, 0xC4, -0x13, 0x54, 0x07, 0x90, 0x98, 0x28, 0xF0, 0x7B, -0x01, 0x7A, 0x99, 0x79, 0x88, 0x7F, 0xFD, 0x7E, -0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, -0x99, 0x88, 0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, -0x3F, 0x90, 0x98, 0x2A, 0xF0, 0x22, 0x7F, 0xF9, -0x7E, 0x01, 0x02, 0x5F, 0xA6, 0x90, 0x00, 0x80, -0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x80, 0x12, 0x7B, -0x2E, 0x12, 0xDF, 0xDE, 0x12, 0xF0, 0x93, 0x12, -0x7B, 0x79, 0x12, 0xE1, 0x8B, 0x12, 0xD8, 0xB8, -0x7F, 0x01, 0x12, 0x87, 0x55, 0x90, 0x98, 0x17, -0x74, 0x02, 0xF0, 0xFF, 0x12, 0x87, 0x55, 0x90, -0x98, 0x17, 0xE0, 0x04, 0xF0, 0x71, 0xB5, 0x12, -0xB7, 0xB5, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, -0xFD, 0x7F, 0x80, 0x12, 0x7B, 0x2E, 0x75, 0x20, -0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, 0xA0, 0xE0, -0xB4, 0xFD, 0x04, 0xE4, 0xFF, 0x11, 0x18, 0x91, -0x1E, 0x71, 0x9C, 0x90, 0x00, 0x81, 0xE0, 0x44, -0x04, 0xFD, 0x7F, 0x81, 0x12, 0x7B, 0x2E, 0x12, -0xD9, 0x2B, 0x51, 0x80, 0x90, 0x00, 0xAA, 0xE0, -0x44, 0x02, 0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, -0x90, 0x99, 0x7B, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, -0xFF, 0x02, 0x87, 0xDE, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0xEF, 0x12, 0xCF, -0x95, 0xE4, 0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF5, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x7B, 0x1B, -0x90, 0x86, 0xB3, 0xEF, 0xF0, 0x71, 0xCF, 0x90, -0x01, 0x64, 0x74, 0x01, 0xF0, 0x90, 0x04, 0x23, -0xE0, 0x44, 0x80, 0xF0, 0x02, 0x67, 0xD2, 0x12, -0x76, 0x6D, 0x12, 0x75, 0xE0, 0x12, 0xD8, 0xCA, -0x12, 0xD9, 0x03, 0x75, 0x21, 0x80, 0x90, 0x86, -0xB3, 0xE0, 0xFF, 0xB4, 0x03, 0x05, 0x75, 0x22, -0x08, 0x80, 0x03, 0xE4, 0xF5, 0x22, 0xEF, 0xB4, -0x01, 0x0A, 0x90, 0x00, 0x75, 0xE0, 0x54, 0xFB, -0xF0, 0x75, 0x22, 0x04, 0xE4, 0xF5, 0x23, 0x75, -0x24, 0x80, 0xAD, 0x21, 0x7F, 0x50, 0x12, 0x7B, -0x2E, 0xAD, 0x22, 0x7F, 0x51, 0x12, 0x7B, 0x2E, -0xAD, 0x23, 0x7F, 0x52, 0x12, 0x7B, 0x2E, 0xAD, -0x24, 0x7F, 0x53, 0x02, 0x7B, 0x2E, 0xE4, 0x90, -0x99, 0x88, 0xF0, 0xA3, 0xF0, 0x12, 0xF0, 0xBA, -0xEF, 0x64, 0x01, 0x60, 0x3B, 0xC3, 0x90, 0x99, -0x89, 0xE0, 0x94, 0x88, 0x90, 0x99, 0x88, 0xE0, -0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, 0xC1, 0xE0, -0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, 0x74, 0xFD, -0xF0, 0x80, 0x1D, 0x90, 0x99, 0x88, 0x91, 0x6F, -0xD1, 0x12, 0xD3, 0x90, 0x99, 0x89, 0xE0, 0x94, -0x32, 0x90, 0x99, 0x88, 0xE0, 0x94, 0x00, 0x40, -0xC4, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xBD, +0xFD, 0x7F, 0x61, 0x12, 0x7B, 0x2E, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0x12, 0x7B, 0x41, 0x90, 0x9C, +0x91, 0xE0, 0xFE, 0x74, 0x01, 0xA8, 0x06, 0x08, +0x22, 0x90, 0x9C, 0x4E, 0xEE, 0xF0, 0xA3, 0xEF, +0xF0, 0x90, 0x9C, 0x51, 0xEB, 0xF0, 0x90, 0x9C, +0x50, 0xED, 0xF0, 0x60, 0x13, 0xF1, 0xD3, 0x78, +0x03, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, +0xF0, 0xEE, 0x90, 0x9C, 0x4E, 0xF0, 0x80, 0x19, +0xF1, 0xD3, 0x78, 0x06, 0xC3, 0x33, 0xCE, 0x33, +0xCE, 0xD8, 0xF9, 0xF0, 0xEE, 0x90, 0x9C, 0x4E, +0xF0, 0x74, 0xFF, 0x75, 0xF0, 0xD0, 0x12, 0x02, +0xE7, 0xB1, 0xE4, 0x54, 0x07, 0x7D, 0x00, 0x20, +0xE0, 0x02, 0x7D, 0x01, 0x91, 0x89, 0xB1, 0xE4, +0x54, 0x01, 0xFD, 0x91, 0x89, 0x90, 0x9C, 0x52, +0xE0, 0x60, 0x3B, 0xB1, 0xD7, 0x54, 0x07, 0x7D, +0x00, 0x20, 0xE0, 0x02, 0x7D, 0x01, 0x91, 0x89, +0xE4, 0x90, 0x9C, 0x53, 0xF0, 0x90, 0x9C, 0x51, +0xE0, 0xFF, 0x90, 0x9C, 0x53, 0xE0, 0xC3, 0x9F, +0x50, 0x1C, 0xB1, 0xD7, 0x54, 0x01, 0xFD, 0x91, +0x89, 0xB1, 0xD7, 0x54, 0x07, 0x7D, 0x00, 0x20, +0xE0, 0x02, 0x7D, 0x01, 0x91, 0x89, 0x90, 0x9C, +0x53, 0xE0, 0x04, 0xF0, 0x80, 0xD7, 0x22, 0x90, +0x9C, 0x4E, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, +0xE0, 0xFD, 0xB1, 0xFB, 0x90, 0x93, 0x2A, 0xE0, +0x54, 0x7F, 0xFF, 0x90, 0x93, 0x29, 0xE0, 0xFE, +0xC4, 0x13, 0x22, 0x4F, 0xF0, 0x90, 0x00, 0x04, +0x02, 0x02, 0x1F, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x8E, 0x10, 0x8F, 0x11, 0xBD, 0x01, +0x05, 0x12, 0x7A, 0xAE, 0x80, 0x07, 0xAF, 0x11, +0xAE, 0x10, 0x12, 0x7C, 0x6A, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x9C, 0x8B, 0xED, 0xF0, 0xA3, 0xEB, +0xF0, 0x90, 0x9C, 0x8A, 0xEF, 0xF0, 0xC3, 0x94, +0x08, 0x40, 0x04, 0xE0, 0x24, 0xF8, 0xF0, 0x7F, +0x62, 0xD1, 0xB5, 0xB1, 0x39, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, 0x62, +0x12, 0x7B, 0x2E, 0x90, 0x9C, 0x8B, 0xE0, 0x60, +0x3F, 0x7F, 0x63, 0xD1, 0xB5, 0xB1, 0x39, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0xFD, 0x7F, +0x63, 0x12, 0x7B, 0x2E, 0x90, 0x9C, 0x8C, 0xE0, +0x60, 0x12, 0xF1, 0xEC, 0x08, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0xF4, 0xFF, 0x90, 0x00, 0x49, +0xE0, 0x5F, 0x80, 0x0F, 0xF1, 0xEC, 0x08, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xFF, 0x90, 0x00, +0x49, 0xE0, 0x4F, 0xFD, 0x7F, 0x49, 0x80, 0x11, +0x7F, 0x63, 0xD1, 0xB5, 0xB1, 0x39, 0x80, 0x02, +0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5F, 0xFD, 0x7F, +0x63, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x4A, 0xE0, +0x54, 0xF0, 0xFD, 0x7F, 0x4A, 0x12, 0x7B, 0x2E, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x7B, 0x41, +0x90, 0x9C, 0x8A, 0x22, 0xF1, 0xE3, 0xFF, 0x54, +0x7F, 0x90, 0x88, 0x36, 0xF0, 0xEF, 0xF1, 0xB2, +0xA3, 0x12, 0x87, 0x9C, 0xFD, 0x54, 0xF0, 0xC4, +0x54, 0x0F, 0xFF, 0x90, 0x88, 0x34, 0xE0, 0x54, +0xF0, 0x4F, 0xF1, 0xCC, 0xFC, 0x54, 0x01, 0x25, +0xE0, 0xFF, 0x90, 0x88, 0x31, 0xE0, 0x54, 0xFD, +0x4F, 0xF0, 0xEC, 0x54, 0x04, 0xC3, 0x13, 0xFF, +0x90, 0x88, 0x33, 0xE0, 0x54, 0xFD, 0x4F, 0xF0, +0xED, 0x54, 0x0F, 0xC4, 0x54, 0xF0, 0xFF, 0xA3, +0xE0, 0x54, 0x0F, 0x4F, 0x12, 0x87, 0xA3, 0x90, +0x88, 0x35, 0xB1, 0xF4, 0xFD, 0x90, 0x8A, 0x89, +0xF1, 0x5E, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, +0x9B, 0x5D, 0xE0, 0x60, 0x0B, 0x12, 0xF5, 0x6A, +0x90, 0x8A, 0x89, 0xF1, 0x5E, 0x12, 0xAF, 0xE3, +0x31, 0xAD, 0x12, 0x5C, 0x5F, 0x90, 0x88, 0x36, +0xE0, 0xB4, 0x01, 0x07, 0x90, 0x88, 0x33, 0xE0, +0x54, 0xFB, 0xF0, 0x12, 0xBF, 0xC1, 0xF0, 0x90, +0x88, 0x36, 0xF1, 0xF6, 0x12, 0xBF, 0xCB, 0x90, +0x01, 0xBE, 0xF0, 0x22, 0x90, 0x8A, 0x77, 0xE0, +0xFE, 0xA3, 0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, +0x12, 0x04, 0x7E, 0x90, 0x8A, 0x79, 0xE0, 0xFE, +0xA3, 0xE0, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, +0x8D, 0xEF, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, +0xF9, 0xF1, 0x5E, 0x7D, 0x44, 0x7F, 0x6F, 0x12, +0x04, 0x7E, 0x31, 0xBA, 0x90, 0x9C, 0x8E, 0xE0, +0x90, 0x9C, 0x8D, 0xB4, 0x01, 0x07, 0xF1, 0xB9, +0x44, 0x04, 0xF0, 0x80, 0x05, 0xF1, 0xB9, 0x54, +0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0xF1, 0x5E, 0xE4, +0xFD, 0xFF, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x7D, 0x01, 0x80, 0xB9, 0x90, 0x93, +0x2A, 0xE0, 0xC4, 0x13, 0x13, 0x13, 0x54, 0x01, +0x22, 0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, +0x82, 0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE0, 0x22, +0xE4, 0xFD, 0x80, 0x9B, 0xF0, 0x90, 0x00, 0x03, +0x02, 0x02, 0x1F, 0x90, 0x9C, 0x4E, 0xE0, 0xFE, +0xA3, 0xE0, 0x22, 0x12, 0x7B, 0x2E, 0x90, 0x9C, +0x92, 0xE0, 0x22, 0x90, 0x99, 0x85, 0x12, 0x82, +0x27, 0x02, 0x02, 0x06, 0x90, 0x9C, 0x8A, 0xE0, +0xFF, 0x74, 0x01, 0xA8, 0x07, 0x22, 0xE0, 0x90, +0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x90, +0x01, 0xBB, 0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, +0x90, 0x93, 0x03, 0xF0, 0xBF, 0x01, 0x07, 0x11, +0x17, 0xE4, 0x90, 0x93, 0x03, 0xF0, 0x22, 0x11, +0xC3, 0x7F, 0xEF, 0x7E, 0x01, 0x12, 0x5F, 0xA6, +0xBF, 0x01, 0x06, 0x90, 0x99, 0x85, 0xE0, 0xA3, +0xF0, 0x11, 0xC3, 0x7F, 0xEE, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0x85, +0xE0, 0x90, 0x99, 0x87, 0xF0, 0x11, 0xC3, 0x7F, +0xED, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, +0x08, 0x90, 0x99, 0x85, 0xE0, 0x90, 0x99, 0x88, +0xF0, 0x11, 0xC3, 0x7F, 0xEC, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, 0x85, +0xE0, 0x90, 0x99, 0x89, 0xF0, 0x11, 0xC3, 0x7F, +0xEB, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, 0x01, +0x08, 0x90, 0x99, 0x85, 0xE0, 0x90, 0x99, 0x8A, +0xF0, 0x90, 0x99, 0x86, 0xE0, 0xFF, 0xA3, 0xE0, +0xFD, 0xA3, 0xE0, 0xFB, 0xA3, 0xE0, 0x90, 0x99, +0x8E, 0xF0, 0x90, 0x99, 0x8A, 0xE0, 0x90, 0x99, +0x8F, 0xF0, 0x90, 0x99, 0x90, 0x74, 0x12, 0xF0, +0x90, 0x99, 0xB2, 0x74, 0x05, 0xF0, 0x90, 0x99, +0x92, 0xEF, 0xF1, 0xE6, 0x90, 0x99, 0x8E, 0xE0, +0x90, 0x99, 0x95, 0xF0, 0x90, 0x99, 0x8F, 0xE0, +0x90, 0x99, 0x96, 0xF0, 0x7B, 0x01, 0x7A, 0x99, +0x79, 0x90, 0x12, 0x97, 0x4C, 0x7F, 0x04, 0x02, +0x04, 0x7E, 0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, +0x85, 0x22, 0x7E, 0x00, 0x7F, 0x0B, 0x7D, 0x00, +0x7B, 0x01, 0x7A, 0x98, 0x79, 0x2D, 0x12, 0x04, +0x80, 0x11, 0xC3, 0x71, 0xB5, 0xBF, 0x01, 0x1C, +0x90, 0x99, 0x85, 0xE0, 0xFE, 0x54, 0x01, 0x90, +0x98, 0x2D, 0xF0, 0xEE, 0x54, 0x04, 0x90, 0x98, +0x2F, 0xF0, 0x90, 0x99, 0x85, 0xE0, 0x54, 0x08, +0x90, 0x98, 0x2E, 0xF0, 0x11, 0xC3, 0x31, 0x54, +0x64, 0x01, 0x70, 0x35, 0x90, 0x99, 0x85, 0xE0, +0x54, 0x07, 0x70, 0x15, 0x7B, 0x01, 0x7A, 0x99, +0x79, 0x86, 0x7F, 0xFA, 0x7E, 0x01, 0x12, 0x5F, +0xA6, 0xBF, 0x01, 0x0F, 0x90, 0x99, 0x86, 0x80, +0x03, 0x90, 0x99, 0x85, 0xE0, 0x54, 0x07, 0x90, +0x98, 0x31, 0xF0, 0x90, 0x99, 0x85, 0xE0, 0x54, +0xE0, 0xC4, 0x13, 0x54, 0x07, 0x90, 0x98, 0x30, +0xF0, 0x11, 0xC3, 0x7F, 0xFD, 0x7E, 0x01, 0x12, +0x5F, 0xA6, 0xBF, 0x01, 0x0E, 0x90, 0x99, 0x85, +0xE0, 0x54, 0x0C, 0x13, 0x13, 0x54, 0x3F, 0x90, +0x98, 0x32, 0xF0, 0x22, 0x7F, 0xFB, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xEF, 0x22, 0x90, 0x99, 0x85, +0xEF, 0xF0, 0x71, 0xAE, 0x7F, 0xF4, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, +0xCC, 0xE0, 0x90, 0x99, 0xCE, 0xF0, 0x71, 0xAE, +0x7F, 0xF5, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, +0x01, 0x08, 0x90, 0x99, 0xCC, 0xE0, 0x90, 0x99, +0xCF, 0xF0, 0x71, 0xAE, 0x7F, 0xF6, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, +0xCC, 0xE0, 0x90, 0x99, 0xD0, 0xF0, 0x71, 0xAE, +0x7F, 0xF7, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, +0x01, 0x08, 0x90, 0x99, 0xCC, 0xE0, 0x90, 0x99, +0xD1, 0xF0, 0x71, 0xAE, 0x7F, 0xF8, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, +0xCC, 0xE0, 0x90, 0x99, 0xD2, 0xF0, 0x71, 0xAE, +0x71, 0xB5, 0xBF, 0x01, 0x08, 0x90, 0x99, 0xCC, +0xE0, 0x90, 0x99, 0xD3, 0xF0, 0x71, 0xAE, 0x31, +0x54, 0x64, 0x01, 0x70, 0x54, 0x90, 0x99, 0xCC, +0xE0, 0x90, 0x99, 0xD4, 0xF0, 0x54, 0x07, 0x60, +0x08, 0x90, 0x99, 0xCC, 0xE0, 0x54, 0xE0, 0x70, +0x40, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0xCD, 0x7F, +0xFA, 0x31, 0x56, 0x64, 0x01, 0x70, 0x32, 0x90, +0x99, 0xCC, 0xE0, 0xFC, 0x54, 0x07, 0x70, 0x12, +0x90, 0x99, 0xD4, 0xE0, 0xFE, 0x90, 0x99, 0xCD, +0xE0, 0x54, 0x07, 0xFD, 0xEE, 0x4D, 0x90, 0x99, +0xD4, 0xF0, 0xEC, 0x54, 0xE0, 0x70, 0x12, 0x90, +0x99, 0xD4, 0xE0, 0xFF, 0x90, 0x99, 0xCD, 0xE0, +0x54, 0xE0, 0xFE, 0xEF, 0x4E, 0x90, 0x99, 0xD4, +0xF0, 0x71, 0xAE, 0x7F, 0xFD, 0x31, 0x56, 0x64, +0x01, 0x70, 0x4B, 0x90, 0x99, 0xCC, 0xE0, 0xFE, +0x54, 0xCC, 0x90, 0x99, 0xD5, 0xF0, 0xEE, 0x54, +0x0C, 0xFF, 0x60, 0x08, 0x90, 0x99, 0xCC, 0xE0, +0x54, 0xC0, 0x70, 0x32, 0xEF, 0x70, 0x16, 0x90, +0x99, 0xD5, 0xE0, 0xFF, 0x90, 0x99, 0xCC, 0xE0, +0x54, 0x03, 0x25, 0xE0, 0x25, 0xE0, 0xFE, 0xEF, +0x4E, 0x90, 0x99, 0xD5, 0xF0, 0x90, 0x99, 0xCC, +0xE0, 0xFF, 0x54, 0xC0, 0x70, 0x10, 0x90, 0x99, +0xD5, 0xE0, 0xFE, 0xEF, 0x54, 0x30, 0x25, 0xE0, +0x25, 0xE0, 0xFF, 0xEE, 0x4F, 0xF0, 0x71, 0xAE, +0x7F, 0xF0, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, +0x01, 0x08, 0x90, 0x99, 0xCC, 0xE0, 0x90, 0x99, +0xD6, 0xF0, 0x71, 0xAE, 0x7F, 0xF1, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, +0xCC, 0xE0, 0x90, 0x99, 0xD7, 0xF0, 0x71, 0xAE, +0x7F, 0xF2, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, +0x01, 0x08, 0x90, 0x99, 0xCC, 0xE0, 0x90, 0x99, +0xD8, 0xF0, 0x71, 0xAE, 0x7F, 0xF3, 0x7E, 0x01, +0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x08, 0x90, 0x99, +0xCC, 0xE0, 0x90, 0x99, 0xD9, 0xF0, 0x71, 0xAE, +0x7F, 0xFC, 0x7E, 0x01, 0x12, 0x5F, 0xA6, 0xBF, +0x01, 0x08, 0x90, 0x99, 0xCC, 0xE0, 0x90, 0x99, +0xDA, 0xF0, 0x90, 0x99, 0x86, 0x74, 0x19, 0xF0, +0x90, 0x99, 0xA8, 0x74, 0x08, 0xF0, 0x90, 0x99, +0xCE, 0xE0, 0x90, 0x99, 0x88, 0xF0, 0x90, 0x99, +0xCF, 0xE0, 0x90, 0x99, 0x89, 0xF0, 0x90, 0x99, +0xD0, 0xE0, 0x90, 0x99, 0x8A, 0xF0, 0x90, 0x99, +0xD1, 0xE0, 0x90, 0x99, 0x8B, 0xF0, 0x90, 0x99, +0xD2, 0xE0, 0x90, 0x99, 0x8C, 0xF0, 0x90, 0x99, +0xD3, 0xE0, 0x90, 0x99, 0x8D, 0xF0, 0x90, 0x99, +0xD4, 0xE0, 0x90, 0x99, 0x8E, 0xF0, 0x90, 0x99, +0xD5, 0xE0, 0x90, 0x99, 0x8F, 0xF0, 0x90, 0x99, +0xA9, 0x74, 0x1A, 0xF0, 0x90, 0x99, 0xCB, 0x74, +0x05, 0xF0, 0x90, 0x99, 0xD6, 0xE0, 0x90, 0x99, +0xAB, 0xF0, 0x90, 0x99, 0xD7, 0xE0, 0x90, 0x99, +0xAC, 0xF0, 0x90, 0x99, 0xD8, 0xE0, 0x90, 0x99, +0xAD, 0xF0, 0x90, 0x99, 0xD9, 0xE0, 0x90, 0x99, +0xAE, 0xF0, 0x90, 0x99, 0xDA, 0xE0, 0x90, 0x99, +0xAF, 0xF0, 0x90, 0x99, 0x85, 0xE0, 0xB4, 0x01, +0x17, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0x86, 0x12, +0xB2, 0x1A, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0xA9, +0x12, 0x97, 0x4C, 0x7F, 0x04, 0x02, 0x04, 0x7E, +0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, +0x86, 0x75, 0x48, 0x0A, 0x7B, 0x01, 0x7A, 0x01, +0x79, 0xA0, 0xF1, 0xDF, 0x75, 0x46, 0x99, 0x75, +0x47, 0xAB, 0x75, 0x48, 0x05, 0x7B, 0x01, 0x7A, +0x01, 0x79, 0xAA, 0x02, 0x69, 0xF5, 0x7B, 0x01, +0x7A, 0x99, 0x79, 0xCC, 0x22, 0x7F, 0xF9, 0x7E, +0x01, 0x02, 0x5F, 0xA6, 0x12, 0x02, 0x06, 0x90, +0x99, 0xA8, 0x12, 0x87, 0x9C, 0x90, 0x99, 0xA9, +0xF0, 0x60, 0x0E, 0x91, 0x06, 0x12, 0xB0, 0x08, +0x90, 0x99, 0xA9, 0x91, 0x06, 0x7B, 0x57, 0x91, +0x0E, 0x90, 0x99, 0x85, 0x74, 0x20, 0xF0, 0x90, +0x99, 0xA7, 0x74, 0x03, 0xF0, 0x90, 0x05, 0x22, +0xE0, 0x90, 0x99, 0x87, 0xF0, 0x90, 0x98, 0x3E, +0xE0, 0x90, 0x99, 0x88, 0xF0, 0x90, 0x98, 0x3F, +0xE0, 0x90, 0x99, 0x89, 0x11, 0xC2, 0x12, 0x97, +0x4C, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0xE0, 0xFF, +0x90, 0x99, 0xA8, 0xE0, 0xFD, 0x22, 0xEB, 0xB4, +0x57, 0x04, 0xF1, 0xAF, 0x80, 0x0F, 0xEF, 0x70, +0x07, 0x90, 0x98, 0x3E, 0xE0, 0x4D, 0x80, 0x05, +0x12, 0xB0, 0x20, 0xF1, 0xAF, 0x90, 0x05, 0x22, +0xF0, 0x90, 0x93, 0x01, 0xEB, 0xF0, 0x22, 0x90, +0x9A, 0x35, 0x12, 0x82, 0x27, 0x90, 0x05, 0x22, +0xE0, 0x90, 0x9A, 0x46, 0xF0, 0x90, 0x04, 0x1D, +0xE0, 0x60, 0x0C, 0x7B, 0x39, 0x12, 0x91, 0xB3, +0xEF, 0x64, 0x01, 0x70, 0x16, 0x80, 0x00, 0x90, +0x98, 0x0D, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, +0x11, 0xF1, 0xBA, 0x90, 0x9A, 0x43, 0xEE, 0xF0, +0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0x43, 0x12, 0xE4, +0xFD, 0x90, 0x9A, 0x45, 0xEF, 0xF0, 0x90, 0x9A, +0x43, 0xF1, 0xC2, 0x90, 0x9A, 0x41, 0xE0, 0xFD, +0x12, 0xE2, 0xF7, 0x90, 0x9A, 0x42, 0xE0, 0x60, +0x02, 0xA1, 0x0A, 0xF1, 0x0E, 0xC0, 0x03, 0xC0, +0x02, 0xC0, 0x01, 0x90, 0x9A, 0x38, 0xF1, 0x04, +0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, +0x03, 0xB1, 0xBF, 0xF1, 0xA5, 0xC0, 0x03, 0xC0, +0x02, 0xC0, 0x01, 0x90, 0x9A, 0x35, 0xF1, 0x04, +0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, +0x03, 0xB1, 0xBF, 0xF1, 0x11, 0xC0, 0x03, 0xC0, +0x02, 0xC0, 0x01, 0x90, 0x9A, 0x3B, 0xF1, 0x04, +0x75, 0x48, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, +0x03, 0xB1, 0xBF, 0x24, 0x60, 0xF9, 0xE4, 0x34, +0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, +0xC0, 0x01, 0x90, 0x9A, 0x3B, 0xF1, 0x04, 0x75, +0x48, 0x10, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, +0xB1, 0xBF, 0x24, 0x72, 0xF9, 0xE4, 0x34, 0xFC, +0xFA, 0x7B, 0x01, 0xC0, 0x03, 0xC0, 0x02, 0xC0, +0x01, 0x90, 0x9A, 0x3E, 0xF1, 0x04, 0x75, 0x48, +0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, 0x03, 0x12, +0x69, 0xF5, 0x90, 0x9A, 0x3B, 0x12, 0x82, 0x1E, +0x90, 0x9A, 0x72, 0x12, 0x82, 0x27, 0x90, 0x9A, +0x75, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x20, +0x90, 0x9A, 0x79, 0x74, 0x3A, 0xF0, 0x90, 0x9A, +0x35, 0x12, 0x82, 0x1E, 0x12, 0xE8, 0x25, 0xB1, +0xC2, 0xF1, 0x9E, 0xF1, 0x88, 0x75, 0x48, 0x28, +0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x47, 0xB1, 0xBF, +0xF1, 0x9E, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, +0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0xD1, 0x75, +0x48, 0x28, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, +0x9A, 0x45, 0xE0, 0xFF, 0x90, 0x9A, 0x44, 0xE0, +0x2F, 0xFF, 0x90, 0x9A, 0x43, 0xE0, 0x34, 0x00, +0xCF, 0x24, 0x30, 0xFD, 0xE4, 0x3F, 0xFC, 0x90, +0x98, 0x0D, 0xE0, 0xFB, 0x7F, 0x3A, 0x12, 0xE5, +0xD6, 0xB1, 0xC2, 0xF1, 0x9E, 0xFA, 0x7B, 0x01, +0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x9A, 0x75, +0x47, 0x47, 0x75, 0x48, 0x28, 0xD0, 0x03, 0x12, +0x69, 0xF5, 0x90, 0x98, 0x09, 0xE0, 0xB4, 0x02, +0x0D, 0x90, 0x98, 0x0D, 0xE0, 0xFF, 0x90, 0x9A, +0x45, 0xE0, 0xFD, 0x12, 0xCD, 0xE9, 0x90, 0x06, +0x33, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x9A, 0x46, +0xE0, 0xFD, 0x7B, 0x3A, 0xE4, 0xFF, 0x91, 0x0E, +0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x22, 0x12, +0x69, 0xF5, 0x90, 0x9A, 0x43, 0xA3, 0xE0, 0xFF, +0xA3, 0xE0, 0x2F, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x0B, 0x12, 0x82, +0x27, 0x78, 0x17, 0x7C, 0x9C, 0x7D, 0x01, 0x7B, +0xFF, 0x7A, 0x80, 0x79, 0x8E, 0x7E, 0x00, 0x7F, +0x06, 0x12, 0x01, 0xE0, 0x90, 0x05, 0x22, 0xE0, +0x90, 0x9C, 0x16, 0xF0, 0x90, 0x04, 0x1D, 0xE0, +0x60, 0x0C, 0x7B, 0x33, 0x12, 0x91, 0xB3, 0xEF, +0x64, 0x01, 0x70, 0x16, 0x80, 0x00, 0x90, 0x98, +0x0C, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x10, +0xF1, 0xBA, 0x90, 0x9C, 0x13, 0xEE, 0xF0, 0xA3, +0xEF, 0xF0, 0x90, 0x9C, 0x13, 0x12, 0xE4, 0xFD, +0x90, 0x9C, 0x15, 0xEF, 0xF0, 0x90, 0x9C, 0x13, +0xF1, 0xC2, 0x90, 0x9C, 0x11, 0xE0, 0xFD, 0x12, +0xE2, 0xF7, 0x90, 0x9C, 0x12, 0xE0, 0x70, 0x4F, +0xF1, 0x0E, 0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, +0xF1, 0x01, 0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, +0x02, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, 0x9C, +0x13, 0xB1, 0xC5, 0xF1, 0x97, 0xFA, 0x7B, 0x01, +0xC0, 0x03, 0xC0, 0x02, 0xC0, 0x01, 0xF1, 0x01, +0x75, 0x48, 0x06, 0xD0, 0x01, 0xD0, 0x02, 0xD0, +0x03, 0x12, 0x69, 0xF5, 0x90, 0x9C, 0x13, 0xB1, +0xC5, 0xF1, 0xA5, 0xC0, 0x03, 0xC0, 0x02, 0xC0, +0x01, 0x90, 0x9C, 0x0B, 0xF1, 0x04, 0x75, 0x48, +0x04, 0xD0, 0x01, 0xD0, 0x02, 0x80, 0x4C, 0x90, +0x9C, 0x12, 0xE0, 0x64, 0x01, 0x70, 0x49, 0xF1, +0x0E, 0xC0, 0x03, 0x8B, 0x45, 0x75, 0x46, 0x93, +0x75, 0x47, 0x4D, 0x75, 0x48, 0x06, 0xD0, 0x03, +0x12, 0x69, 0xF5, 0x90, 0x9C, 0x13, 0xB1, 0xC5, +0xF1, 0x97, 0xFA, 0x7B, 0x01, 0xC0, 0x03, 0x8B, +0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x57, 0x75, +0x48, 0x06, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x90, +0x9C, 0x13, 0xB1, 0xC5, 0xF1, 0xA5, 0xC0, 0x03, +0x8B, 0x45, 0x75, 0x46, 0x93, 0x75, 0x47, 0x5D, +0x75, 0x48, 0x04, 0xD0, 0x03, 0x12, 0x69, 0xF5, +0x90, 0x98, 0x09, 0xE0, 0xB4, 0x02, 0x0D, 0x90, +0x98, 0x0C, 0xE0, 0xFF, 0x90, 0x9C, 0x15, 0xE0, +0xFD, 0x12, 0xCD, 0xE9, 0x90, 0x06, 0x30, 0xE0, +0x44, 0x10, 0xF0, 0x90, 0x9C, 0x16, 0xE0, 0xFD, +0x7B, 0x34, 0xB1, 0xB4, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0x90, 0x9C, 0x0E, 0x12, 0x82, 0x1E, 0x8B, +0x45, 0x8A, 0x46, 0x89, 0x47, 0x22, 0xA3, 0xA3, +0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, 0xFA, +0x7B, 0x01, 0x22, 0xF1, 0xF0, 0xE4, 0xF0, 0xA3, +0xEF, 0xF0, 0x90, 0x99, 0x85, 0x12, 0xE4, 0xFD, +0x90, 0x99, 0x87, 0xEF, 0xF0, 0x90, 0x99, 0x85, +0xA3, 0xE0, 0x24, 0x38, 0xF9, 0xE4, 0x34, 0xFC, +0xF1, 0x88, 0x75, 0x48, 0x06, 0x7B, 0x01, 0x7A, +0x93, 0x79, 0x4D, 0xF1, 0x90, 0xB1, 0xC5, 0x24, +0x3E, 0xF9, 0xE4, 0x34, 0xFC, 0xF1, 0x88, 0x75, +0x48, 0x04, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x53, +0xF1, 0x90, 0xB1, 0xC5, 0xF1, 0x97, 0xF1, 0x88, +0x75, 0x48, 0x06, 0x7B, 0x01, 0x7A, 0x93, 0x79, +0x57, 0xF1, 0x90, 0xB1, 0xC5, 0x24, 0x48, 0xF9, +0xE4, 0x34, 0xFC, 0xF1, 0x88, 0x75, 0x48, 0x04, +0x7B, 0x01, 0x7A, 0x93, 0x79, 0x5D, 0x02, 0x69, +0xF5, 0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, +0x75, 0x45, 0x01, 0xF5, 0x46, 0x89, 0x47, 0x22, +0x12, 0x69, 0xF5, 0x90, 0x99, 0x85, 0x22, 0x24, +0x42, 0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x24, 0x30, +0xF9, 0xE4, 0x34, 0xFC, 0x22, 0x24, 0x48, 0xF9, +0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, +0x98, 0x3F, 0xE0, 0xFF, 0x90, 0x98, 0x3E, 0xE0, +0x4F, 0x22, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x02, +0x66, 0xDB, 0xA3, 0xE0, 0x24, 0x28, 0xF9, 0xE4, +0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x12, 0xDF, +0xCC, 0xF1, 0x84, 0x75, 0x48, 0x70, 0x7B, 0x01, +0x7A, 0x93, 0x79, 0x61, 0x02, 0x69, 0xF5, 0x12, +0x69, 0xF5, 0x75, 0x45, 0x01, 0x22, 0xF0, 0xA3, +0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0xE0, 0xFF, +0x12, 0x7B, 0x07, 0x90, 0x99, 0x85, 0x22, 0x12, +0x02, 0x06, 0x54, 0x01, 0xFF, 0x90, 0x98, 0x3D, +0xE0, 0x54, 0xFE, 0x4F, 0xF0, 0x22, 0x12, 0x02, +0x06, 0x90, 0x88, 0x9C, 0xF0, 0x22, 0x90, 0x93, +0x0C, 0xE0, 0x20, 0xE0, 0x02, 0x01, 0xDB, 0xE4, +0x90, 0x99, 0x85, 0xF0, 0x90, 0x99, 0x85, 0xE0, +0xFF, 0xC3, 0x94, 0x05, 0x40, 0x02, 0x01, 0xDB, +0x11, 0xDE, 0x80, 0x05, 0xC3, 0x33, 0xCE, 0x33, +0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0D, 0xE0, +0xFD, 0xEF, 0x5D, 0x60, 0x02, 0x01, 0xD3, 0x12, +0x02, 0x06, 0xFF, 0x30, 0xE0, 0x1A, 0x90, 0x93, +0x0E, 0xE0, 0xFE, 0x90, 0x99, 0x85, 0xE0, 0xFD, +0x74, 0x01, 0xA8, 0x05, 0x08, 0x80, 0x02, 0xC3, +0x33, 0xD8, 0xFC, 0x4E, 0x90, 0x93, 0x0E, 0xF0, +0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x16, 0x90, 0x93, +0x0F, 0xE0, 0xFF, 0x90, 0x99, 0x85, 0x12, 0x95, +0x39, 0x80, 0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, +0x90, 0x93, 0x0F, 0xF0, 0x12, 0x87, 0x9D, 0xFF, +0x90, 0x99, 0x85, 0xE0, 0xFE, 0x24, 0x10, 0xF5, +0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, +0x87, 0xA3, 0xFF, 0x74, 0x15, 0x2E, 0xF5, 0x82, +0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x97, +0xCC, 0xFF, 0x74, 0x1A, 0x2E, 0xF5, 0x82, 0xE4, +0x34, 0x93, 0xF5, 0x83, 0xEF, 0x12, 0x95, 0xF4, +0xFF, 0x74, 0x1F, 0x2E, 0xF5, 0x82, 0xE4, 0x34, +0x93, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x93, 0x0D, +0xE0, 0xFF, 0x74, 0x01, 0xA8, 0x06, 0x08, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x4F, 0x90, 0x93, +0x0D, 0xF0, 0x22, 0x90, 0x99, 0x85, 0xE0, 0x04, +0xF0, 0x01, 0x1C, 0x22, 0xE0, 0xFF, 0x74, 0x01, +0x7E, 0x00, 0xA8, 0x07, 0x08, 0x22, 0x12, 0x8F, +0xE5, 0xA3, 0xED, 0xF0, 0x90, 0x98, 0x1B, 0xE0, +0xFF, 0x12, 0x7B, 0x07, 0x90, 0x9A, 0x0B, 0xE4, +0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0xFD, 0x10, 0xE0, +0x90, 0x9A, 0x0B, 0x75, 0xF0, 0x00, 0x12, 0x02, +0xE7, 0xE4, 0x90, 0x9A, 0x15, 0xF0, 0x90, 0x93, +0x27, 0xE0, 0x54, 0x07, 0xFF, 0x90, 0x9A, 0x15, +0xE0, 0xC3, 0x9F, 0x40, 0x02, 0x41, 0x81, 0x90, +0x9A, 0x09, 0xE0, 0x24, 0x04, 0xFE, 0x12, 0x8D, +0x89, 0x90, 0x9A, 0x0D, 0xF0, 0xA3, 0xCE, 0xF0, +0x90, 0x9A, 0x0C, 0xE0, 0x24, 0x01, 0xFF, 0x90, +0x9A, 0x0B, 0xD1, 0xE5, 0x7F, 0x00, 0xFE, 0xC0, +0x06, 0xC0, 0x07, 0x90, 0x9A, 0x0B, 0xE0, 0xFE, +0xA3, 0xE0, 0xFF, 0x12, 0x7A, 0x7E, 0xEF, 0xFD, +0xD0, 0xE0, 0x2D, 0xFF, 0xD0, 0xE0, 0x34, 0x00, +0xFE, 0x90, 0x9A, 0x0F, 0xF0, 0xA3, 0xEF, 0xF0, +0x90, 0x9A, 0x0C, 0xE0, 0x24, 0x02, 0xFD, 0x90, +0x9A, 0x0B, 0xE0, 0x34, 0x00, 0xFC, 0x90, 0x9A, +0x13, 0xF0, 0xA3, 0xED, 0xF0, 0x2F, 0x12, 0xF5, +0x38, 0x90, 0x9A, 0x18, 0x74, 0x01, 0xF0, 0xE4, +0x90, 0x9A, 0x17, 0xF0, 0x90, 0x9A, 0x17, 0xE0, +0xFF, 0xFD, 0xD3, 0x90, 0x9A, 0x10, 0xE0, 0x9D, +0x90, 0x9A, 0x0F, 0xE0, 0x94, 0x00, 0x50, 0x02, +0x41, 0x4F, 0xEF, 0xB4, 0x12, 0x08, 0x12, 0x8D, +0x7E, 0xCF, 0x24, 0x06, 0xF1, 0x90, 0x90, 0x9A, +0x17, 0xE0, 0x75, 0xF0, 0x02, 0xA4, 0xFD, 0xAC, +0xF0, 0xAE, 0x04, 0x78, 0x03, 0xCE, 0xA2, 0xE7, +0x13, 0xCE, 0x13, 0xD8, 0xF8, 0xFF, 0xED, 0x54, +0x07, 0x90, 0x9A, 0x16, 0xF0, 0x90, 0x9A, 0x12, +0xE0, 0x2F, 0x12, 0x8D, 0x6B, 0xFE, 0x12, 0x7A, +0x7E, 0x90, 0x9A, 0x19, 0xEF, 0xF0, 0xFD, 0x90, +0x9A, 0x16, 0x11, 0xDC, 0x80, 0x05, 0xC3, 0x33, +0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xEF, 0x5D, +0x6F, 0x70, 0x01, 0xEE, 0x70, 0x16, 0xD1, 0xD7, +0x54, 0x0F, 0xFF, 0xC0, 0x07, 0xD1, 0xF5, 0x12, +0x8B, 0xE8, 0xEF, 0x54, 0x0F, 0xD0, 0x07, 0x6F, +0x60, 0x02, 0x80, 0x32, 0x90, 0x9A, 0x16, 0xE0, +0x04, 0x11, 0xDD, 0x80, 0x05, 0xC3, 0x33, 0xCE, +0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x9A, 0x19, +0xE0, 0xFD, 0xEF, 0x5D, 0x6F, 0x70, 0x01, 0xEE, +0x70, 0x1B, 0xD1, 0xD7, 0x54, 0xF0, 0xFF, 0xC0, +0x07, 0xD1, 0xF5, 0x12, 0x8B, 0xE8, 0xEF, 0x54, +0xF0, 0xD0, 0x07, 0x6F, 0x60, 0x07, 0xE4, 0x90, +0x9A, 0x18, 0xF0, 0x80, 0x12, 0x90, 0x9A, 0x0D, +0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, 0xE7, 0x90, +0x9A, 0x17, 0xE0, 0x04, 0xF0, 0x21, 0x84, 0x90, +0x9A, 0x18, 0xE0, 0xB4, 0x01, 0x03, 0x7F, 0x01, +0x22, 0x90, 0x9A, 0x10, 0xE0, 0x24, 0x03, 0xF1, +0x75, 0xEF, 0x78, 0x02, 0xCE, 0xC3, 0x13, 0xCE, +0x13, 0xD8, 0xF9, 0xFF, 0x90, 0x9A, 0x12, 0xE0, +0x2F, 0xFF, 0x90, 0x9A, 0x11, 0xE0, 0x3E, 0xF1, +0x6D, 0x90, 0x9A, 0x15, 0xE0, 0x04, 0xF0, 0x21, +0x0E, 0x7F, 0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0xE4, 0x90, 0x9B, 0xDB, 0xF0, +0xA3, 0xF0, 0xA3, 0x74, 0x08, 0xF0, 0xA3, 0xF1, +0xDE, 0x90, 0x9B, 0xE3, 0xF0, 0xA3, 0xF0, 0xA3, +0xF0, 0x90, 0x01, 0xC4, 0x74, 0x84, 0xF0, 0x74, +0xA2, 0xA3, 0x12, 0xD7, 0x84, 0x12, 0xCF, 0x24, +0x90, 0x9B, 0xD1, 0x12, 0xE0, 0xF0, 0x90, 0x9B, +0xDA, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x20, 0xE0, +0x02, 0xA1, 0xF1, 0xE4, 0x90, 0x9B, 0xD9, 0xF0, +0x90, 0x9B, 0xDA, 0xE0, 0xFF, 0x90, 0x9B, 0xD9, +0xE0, 0xC3, 0x9F, 0x40, 0x02, 0xA1, 0xF1, 0xF1, +0x7E, 0xEC, 0xFF, 0x90, 0xFD, 0x11, 0xF0, 0x90, +0x9B, 0xE3, 0xEF, 0xF0, 0x12, 0xD7, 0xA3, 0x3E, +0x54, 0x3F, 0xFE, 0x90, 0x9B, 0xD3, 0xF0, 0xA3, +0xEF, 0xF0, 0x90, 0x9B, 0xDF, 0xEE, 0x12, 0xE1, +0x3D, 0x30, 0xE0, 0x0A, 0xC3, 0x13, 0x20, 0xE0, +0x05, 0x12, 0xE1, 0x08, 0x80, 0x02, 0x7E, 0x00, +0xEF, 0x24, 0x18, 0x2E, 0xFF, 0x90, 0x9B, 0xE4, +0xF0, 0x90, 0x9B, 0xD2, 0xE0, 0x2F, 0xFF, 0x90, +0x9B, 0xD1, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x9B, +0xD5, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x8B, 0xE8, +0xC0, 0x07, 0x90, 0x9B, 0xD5, 0xD1, 0x12, 0x7D, +0x01, 0x12, 0x04, 0x7E, 0xC0, 0x07, 0x90, 0x9B, +0xD5, 0xD1, 0x12, 0x7D, 0x04, 0x12, 0x04, 0x7E, +0xAB, 0x07, 0xD0, 0x05, 0xD0, 0x07, 0x12, 0xE5, +0x23, 0x90, 0x9B, 0xDB, 0xEF, 0xD1, 0xC3, 0x12, +0x8B, 0xE8, 0xEF, 0x54, 0xFC, 0x90, 0x9B, 0xD7, +0xF0, 0x90, 0x9B, 0xE4, 0xE0, 0xFF, 0x90, 0x9B, +0xD3, 0xE4, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0xF1, +0x87, 0x12, 0xDF, 0xE8, 0x90, 0x9B, 0xD3, 0xEE, +0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9B, 0xD1, 0xD1, +0x12, 0x7D, 0x0F, 0x12, 0x04, 0x7E, 0x90, 0x9B, +0xD8, 0xEF, 0xF0, 0x90, 0x9B, 0x5D, 0xE0, 0x60, +0x3F, 0x90, 0x9B, 0xD7, 0xE0, 0x24, 0xB0, 0x60, +0x18, 0x24, 0xD0, 0x60, 0x02, 0xA1, 0x0F, 0xF1, +0x47, 0x20, 0xE0, 0x1D, 0xEF, 0x13, 0x13, 0x13, +0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, 0x0F, 0x80, +0x10, 0xF1, 0x47, 0x20, 0xE0, 0x0B, 0xEF, 0x13, +0x13, 0x13, 0x54, 0x1F, 0x20, 0xE0, 0x02, 0xA1, +0x0F, 0xD1, 0xC4, 0x90, 0x9B, 0xDF, 0xE0, 0xFC, +0xA3, 0xE0, 0xFD, 0x12, 0xF0, 0x8F, 0xA1, 0x0F, +0x90, 0x9B, 0xD7, 0xE0, 0x24, 0xF8, 0x60, 0x41, +0x24, 0x80, 0x60, 0x3D, 0x24, 0xC8, 0x60, 0x06, +0x24, 0x20, 0x60, 0x02, 0xA1, 0x0F, 0x90, 0x93, +0x29, 0x12, 0x97, 0xB1, 0x20, 0xE0, 0x02, 0xA1, +0x0F, 0x90, 0x93, 0x3E, 0xE0, 0x04, 0xD1, 0xC3, +0xD1, 0xFE, 0xEF, 0x70, 0x02, 0xA1, 0x0F, 0xD1, +0xC4, 0x12, 0xE2, 0x73, 0xEF, 0x70, 0x02, 0xA1, +0x0F, 0x90, 0x9B, 0xD7, 0xE0, 0xFF, 0x12, 0xE2, +0x61, 0x90, 0x93, 0x3F, 0xE0, 0x04, 0xF0, 0xA1, +0x0F, 0x90, 0x93, 0x24, 0xD1, 0xEE, 0x30, 0xE0, +0x5E, 0x90, 0x9B, 0xDB, 0xE0, 0xFF, 0x90, 0x9B, +0xD6, 0xE0, 0x2F, 0xFF, 0x90, 0x9B, 0xD5, 0xE0, +0x34, 0x00, 0xCF, 0x24, 0x08, 0xCF, 0x34, 0x00, +0xFE, 0x90, 0x9B, 0xE1, 0xF0, 0xA3, 0xEF, 0xF0, +0x12, 0x8B, 0xE8, 0xEF, 0x64, 0x45, 0x70, 0x37, +0xD1, 0xCE, 0x12, 0xF1, 0x82, 0xEF, 0x64, 0x01, +0x70, 0x2D, 0xD1, 0xCE, 0xF1, 0xA8, 0xEF, 0x64, +0x01, 0x70, 0x24, 0x90, 0x9B, 0xE5, 0x04, 0xD1, +0xCD, 0xA3, 0xE0, 0xFD, 0x12, 0xF0, 0xB6, 0xEF, +0x70, 0x0D, 0x90, 0x9B, 0xE3, 0xE0, 0xFD, 0x90, +0xFD, 0x11, 0xD1, 0xCD, 0x12, 0xF1, 0x11, 0x90, +0x9B, 0xE3, 0xE0, 0x90, 0xFD, 0x11, 0xF0, 0xD1, +0xC4, 0xD1, 0xFE, 0xEF, 0x60, 0x39, 0xD1, 0x01, +0x90, 0x9B, 0xDE, 0xE0, 0xFB, 0x90, 0x9B, 0xE3, +0xE0, 0x90, 0x9A, 0x0C, 0xF0, 0x12, 0x8F, 0x1A, +0xEF, 0x60, 0x06, 0x90, 0x9B, 0xE5, 0x74, 0x01, +0xF0, 0x90, 0x93, 0x25, 0xE0, 0xC4, 0x13, 0x54, +0x07, 0x30, 0xE0, 0x13, 0xD1, 0x01, 0x90, 0x9B, +0xDE, 0xE0, 0xFB, 0x12, 0xEE, 0x71, 0xEF, 0x60, +0x06, 0x90, 0x9B, 0xE5, 0x74, 0x01, 0xF0, 0x90, +0x93, 0x24, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x0E, +0xD1, 0x01, 0x12, 0x8D, 0x90, 0xEF, 0x60, 0x06, +0x90, 0x9B, 0xE5, 0x74, 0x01, 0xF0, 0x90, 0x93, +0x24, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, +0x0E, 0xD1, 0x01, 0x12, 0x89, 0xF9, 0xEF, 0x60, +0x06, 0x90, 0x9B, 0xE5, 0x74, 0x01, 0xF0, 0x90, +0x93, 0x24, 0x12, 0x97, 0xB1, 0x30, 0xE0, 0x16, +0x90, 0x9B, 0xE5, 0xE0, 0x70, 0x10, 0xD1, 0x01, +0xF1, 0x57, 0xEF, 0x60, 0x09, 0x12, 0x8F, 0xCA, +0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0xD1, 0x01, +0xD1, 0x23, 0xEF, 0x60, 0x02, 0xF1, 0x9B, 0x90, +0x9B, 0xD8, 0xE0, 0xFF, 0x7D, 0x01, 0x12, 0xEE, +0xE1, 0xEF, 0x60, 0x12, 0x12, 0x8F, 0xCA, 0x90, +0x9B, 0xD1, 0xD1, 0x12, 0x7D, 0x10, 0x12, 0x04, +0x7E, 0x90, 0x95, 0x65, 0xEF, 0xF0, 0x90, 0x9B, +0xE5, 0xE0, 0x70, 0x1E, 0x90, 0x93, 0x26, 0xD1, +0xEE, 0x30, 0xE0, 0x16, 0x90, 0x9B, 0xD7, 0xE0, +0xFF, 0x64, 0x08, 0x60, 0x04, 0xEF, 0xB4, 0x88, +0x09, 0x12, 0x8F, 0xCA, 0x90, 0x01, 0xC7, 0x74, +0x25, 0xF0, 0x90, 0x93, 0x31, 0xE0, 0x30, 0xE0, +0x11, 0x90, 0x93, 0x25, 0xD1, 0xEE, 0x30, 0xE0, +0x09, 0xD1, 0x01, 0x11, 0xE6, 0xBF, 0x01, 0x02, +0xF1, 0x9B, 0xF1, 0x87, 0x90, 0x9B, 0xD1, 0x12, +0xE0, 0xF9, 0xF1, 0x7E, 0xD3, 0x9F, 0xEC, 0x9E, +0x40, 0x0F, 0x12, 0xE1, 0x17, 0xED, 0x9F, 0xFF, +0xEC, 0x9E, 0x90, 0x9B, 0xD1, 0xF0, 0xA3, 0xEF, +0xF0, 0x90, 0x93, 0x31, 0xE0, 0x30, 0xE0, 0x05, +0x7F, 0x01, 0x12, 0xBC, 0x2E, 0x12, 0xE2, 0x4A, +0xEF, 0x64, 0x01, 0x70, 0x38, 0x90, 0x93, 0x40, +0xE0, 0x04, 0xF0, 0x12, 0xE1, 0x27, 0xAD, 0x07, +0xEF, 0x64, 0x01, 0x60, 0x20, 0x12, 0x8F, 0xCA, +0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, 0xC7, 0x74, +0x42, 0xF0, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x06, +0x90, 0x01, 0xC7, 0x74, 0x43, 0xF0, 0x7F, 0x01, +0x12, 0xBC, 0x2E, 0x80, 0x24, 0x90, 0x9B, 0xD1, +0x12, 0xDF, 0xD5, 0x80, 0x14, 0x90, 0x93, 0x26, +0xE0, 0xC4, 0x13, 0x54, 0x07, 0x20, 0xE0, 0x11, +0x90, 0x93, 0x24, 0xE0, 0x54, 0xFE, 0xF0, 0x80, +0x08, 0x90, 0x9B, 0xD9, 0xE0, 0x04, 0xF0, 0x41, +0xC8, 0x74, 0x84, 0x04, 0x90, 0x01, 0xC4, 0xF0, +0x74, 0xA2, 0xA3, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0x90, 0x9B, 0xD5, 0xE0, 0xFE, 0xA3, 0xE0, +0xFF, 0x90, 0x9B, 0xDB, 0xE0, 0xFD, 0x22, 0x90, +0x9A, 0x0D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, +0x8A, 0xE9, 0xE0, 0xFC, 0xA3, 0xE0, 0xF5, 0x82, +0x8C, 0x83, 0x22, 0x90, 0x9A, 0x0A, 0xED, 0x12, +0x8F, 0xE4, 0xD1, 0xFE, 0xEF, 0x70, 0x02, 0xC1, +0xC0, 0x12, 0x8F, 0x11, 0xF1, 0x4F, 0x70, 0x02, +0xC1, 0xC0, 0x12, 0x8D, 0x7E, 0xCF, 0x24, 0x08, +0xF1, 0x90, 0x90, 0x93, 0x25, 0xE0, 0xC4, 0x54, +0x0F, 0x30, 0xE0, 0x33, 0xD1, 0x0F, 0x7D, 0x09, +0x12, 0x04, 0x7E, 0xEF, 0x64, 0x06, 0x70, 0x27, +0xD1, 0x0F, 0x7D, 0x14, 0x12, 0x04, 0x7E, 0xEF, +0x70, 0x1D, 0xD1, 0x0F, 0x7D, 0x15, 0x12, 0x04, +0x7E, 0xEF, 0x64, 0x50, 0x70, 0x11, 0xD1, 0x0F, +0x7D, 0x21, 0x12, 0x04, 0x7E, 0xEF, 0x20, 0xE0, +0x03, 0x30, 0xE2, 0x03, 0x7F, 0x01, 0x22, 0x90, +0x93, 0x25, 0xE0, 0x13, 0x13, 0x54, 0x3F, 0x30, +0xE0, 0x36, 0xD1, 0x0F, 0x7D, 0x09, 0x12, 0x04, +0x7E, 0xEF, 0x64, 0x11, 0x70, 0x2A, 0x90, 0x9A, +0x0E, 0xE0, 0x24, 0x14, 0xFF, 0x90, 0x9A, 0x0D, +0xE0, 0x34, 0x00, 0xFE, 0xF1, 0x6D, 0xD1, 0x17, +0x7D, 0x02, 0x12, 0x04, 0x7E, 0xEF, 0x70, 0x10, +0x90, 0x9A, 0x0B, 0xD1, 0x12, 0x7D, 0x03, 0x12, +0x04, 0x7E, 0xBF, 0x89, 0x03, 0x7F, 0x01, 0x22, +0x7F, 0x00, 0x22, 0xF0, 0x90, 0x9B, 0xD5, 0xE0, +0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0xF0, 0x90, 0x9B, +0xE1, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, +0x9A, 0x17, 0xE0, 0xFF, 0x90, 0x9A, 0x14, 0xE0, +0x2F, 0xFF, 0x90, 0x9A, 0x13, 0xE0, 0x34, 0x00, +0xFE, 0x12, 0x7A, 0x7E, 0xEF, 0x22, 0xE0, 0xC4, +0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x9A, 0x0D, +0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x9A, +0x0F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, +0x9A, 0x17, 0xF0, 0x90, 0x9A, 0x17, 0xE0, 0xFD, +0xC3, 0x94, 0x06, 0x50, 0x1D, 0x90, 0x9A, 0x10, +0xE0, 0x24, 0x04, 0xF1, 0x75, 0x12, 0x8F, 0xBA, +0x90, 0x9A, 0x17, 0x12, 0x8F, 0xF5, 0xF5, 0x83, +0xEF, 0xF0, 0x90, 0x9A, 0x17, 0xE0, 0x04, 0xF0, +0x80, 0xD9, 0x78, 0x32, 0x7C, 0x93, 0x7D, 0x01, +0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x11, 0xF1, 0xED, +0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, 0x90, +0x93, 0x04, 0xE0, 0xFF, 0xC3, 0x13, 0x22, 0xA3, +0xE0, 0xFD, 0x12, 0xE8, 0x64, 0xEF, 0x22, 0x90, +0x9A, 0x0A, 0xED, 0x12, 0x8F, 0xE4, 0xD1, 0xFE, +0xEF, 0x60, 0x09, 0x12, 0x8F, 0x11, 0xF1, 0x4F, +0x60, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x9A, 0x0B, +0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xFF, 0x90, 0x9A, +0x0F, 0xE0, 0x34, 0x00, 0xFE, 0x22, 0x90, 0x9B, +0xD1, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, 0x90, +0x9B, 0xD3, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, +0xCF, 0x34, 0x00, 0x90, 0x9A, 0x0D, 0xF0, 0xA3, +0xEF, 0xF0, 0x22, 0x90, 0x93, 0x31, 0xE0, 0x54, +0xFE, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, +0x12, 0x8F, 0xE5, 0x24, 0x16, 0xFF, 0xE4, 0x3E, +0x12, 0x8B, 0xE7, 0x90, 0x95, 0x77, 0xA3, 0xE0, +0xB5, 0x07, 0x1D, 0x90, 0x9A, 0x09, 0xE0, 0x24, +0x16, 0x12, 0x8D, 0x88, 0xFE, 0xD1, 0x17, 0x7D, +0x01, 0x12, 0x04, 0x7E, 0xEF, 0xFD, 0x90, 0x95, +0x77, 0xE0, 0x6D, 0x70, 0x01, 0xE4, 0x60, 0x03, +0x7F, 0x00, 0x22, 0x7F, 0x01, 0x22, 0xF0, 0xE4, +0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x90, 0x01, 0x94, +0xE0, 0x44, 0x01, 0x80, 0xB4, 0x7E, 0x00, 0x7F, +0x06, 0x12, 0x83, 0xDC, 0xEF, 0x22, 0x12, 0x02, +0x06, 0x54, 0x01, 0xFF, 0x90, 0x93, 0x0C, 0xE0, +0x54, 0xFE, 0x4F, 0xF0, 0x30, 0xE0, 0x03, 0xE4, +0x11, 0x0E, 0x22, 0xF0, 0xA3, 0xF0, 0xA3, 0xF0, +0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0xBC, 0xBD, +0xE4, 0x90, 0x98, 0x15, 0x11, 0x0D, 0x90, 0x95, +0x67, 0x11, 0x0B, 0xA3, 0x11, 0x0B, 0x90, 0x95, +0x79, 0xF0, 0xA3, 0xF0, 0x90, 0x95, 0xBB, 0xF0, +0xA3, 0xF0, 0x22, 0x90, 0x9A, 0xC5, 0xEF, 0xF0, +0xA3, 0xED, 0xF0, 0xA3, 0x12, 0x82, 0x27, 0x90, +0x9A, 0xC7, 0x12, 0x82, 0x1E, 0x8B, 0x45, 0x8A, +0x46, 0x11, 0xBA, 0x24, 0x02, 0x31, 0x00, 0x24, +0x04, 0x11, 0xB3, 0x24, 0x03, 0x31, 0x00, 0x24, +0x08, 0x11, 0xB3, 0x24, 0x04, 0x31, 0x00, 0x24, +0x0C, 0x11, 0xB3, 0x24, 0x05, 0x31, 0x15, 0x79, +0xCB, 0x11, 0xD1, 0x90, 0x9A, 0xC6, 0xE0, 0xFD, +0xB4, 0x02, 0x08, 0x90, 0x9A, 0xC5, 0xE0, 0x44, +0x48, 0x80, 0x0A, 0xED, 0xB4, 0x04, 0x0A, 0x90, +0x9A, 0xC5, 0xE0, 0x44, 0x50, 0x90, 0x9A, 0xCB, +0xF0, 0x90, 0x9A, 0xCC, 0x74, 0x80, 0xF0, 0xA3, +0x74, 0xFF, 0xF0, 0xA3, 0xF0, 0x11, 0xC8, 0x31, +0x15, 0x79, 0xCB, 0x11, 0xD1, 0x90, 0x9A, 0xCB, +0x74, 0xFF, 0x11, 0x0D, 0x11, 0xC8, 0x04, 0x31, +0x15, 0x79, 0xCB, 0x11, 0xD1, 0x90, 0x06, 0x72, +0xE4, 0xF0, 0x22, 0xF9, 0xE4, 0x3A, 0x8B, 0x45, +0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x04, 0x7B, +0x01, 0x7A, 0x9A, 0x79, 0xCB, 0x12, 0x69, 0xF5, +0x90, 0x9A, 0xC5, 0xE0, 0x75, 0xF0, 0x08, 0xA4, +0x22, 0x12, 0x02, 0x06, 0x90, 0x06, 0x74, 0x12, +0x87, 0x9C, 0x90, 0x06, 0x75, 0x12, 0x87, 0xA3, +0x90, 0x06, 0x76, 0x12, 0x97, 0xCC, 0x90, 0x06, +0x77, 0xF0, 0x90, 0x06, 0x70, 0xEF, 0xF0, 0xA3, +0xE4, 0xF0, 0xA3, 0x04, 0xF0, 0xA3, 0x74, 0x80, +0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x02, 0x7C, 0x6A, +0xFF, 0x90, 0x9A, 0xCA, 0xF0, 0x7B, 0x01, 0x7A, +0x9A, 0x79, 0xCB, 0x11, 0xD1, 0x90, 0x9A, 0xC7, +0x12, 0x82, 0x1E, 0xE9, 0x22, 0xFF, 0x90, 0x9A, +0xCA, 0xF0, 0x7B, 0x01, 0x7A, 0x9A, 0x22, 0x7E, +0x00, 0x7F, 0x29, 0x7D, 0x00, 0x7B, 0x01, 0x7A, +0x93, 0x79, 0x24, 0x12, 0x04, 0x80, 0x90, 0x06, +0x90, 0xE0, 0x54, 0xDF, 0xF0, 0x12, 0xE1, 0x59, +0x11, 0x15, 0x90, 0x86, 0xB3, 0xE0, 0xFF, 0x64, +0x02, 0x70, 0x2E, 0x90, 0xFD, 0x80, 0xE0, 0x7E, +0x00, 0x30, 0xE0, 0x02, 0x7E, 0x01, 0x90, 0x93, +0x47, 0x51, 0x08, 0x7E, 0x00, 0x30, 0xE1, 0x02, +0x7E, 0x01, 0x90, 0x93, 0x45, 0x51, 0x08, 0x7E, +0x00, 0x30, 0xE2, 0x02, 0x7E, 0x01, 0x90, 0x93, +0x46, 0x51, 0x08, 0x90, 0x02, 0xFB, 0xF0, 0x80, +0x52, 0xEF, 0x64, 0x01, 0x70, 0x21, 0x51, 0x01, +0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, 0x47, +0xEF, 0xF0, 0x51, 0x01, 0x30, 0xE1, 0x02, 0x7F, +0x01, 0x90, 0x93, 0x45, 0xEF, 0xF0, 0x51, 0x01, +0x30, 0xE2, 0x02, 0x7F, 0x01, 0x80, 0x27, 0x90, +0x86, 0xB3, 0xE0, 0x64, 0x03, 0x70, 0x24, 0x31, +0xFA, 0x30, 0xE0, 0x02, 0x7F, 0x01, 0x90, 0x93, +0x47, 0xEF, 0xF0, 0x31, 0xFA, 0x30, 0xE1, 0x02, +0x7F, 0x01, 0x90, 0x93, 0x45, 0xEF, 0xF0, 0x31, +0xFA, 0x30, 0xE2, 0x02, 0x7F, 0x01, 0x90, 0x93, +0x46, 0xEF, 0xF0, 0x90, 0x93, 0x24, 0xE0, 0x54, +0xEF, 0xF0, 0xE4, 0x90, 0x95, 0xBD, 0xF0, 0xA3, +0xF0, 0x90, 0x95, 0xC5, 0x12, 0x04, 0x3D, 0x00, +0x00, 0x00, 0x00, 0x90, 0x95, 0xC9, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x00, 0x90, 0x95, 0xC1, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0x90, +0x98, 0x05, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0x00, 0x22, 0x90, 0xFD, 0x78, 0xE0, 0x7F, 0x00, +0x22, 0x90, 0xFD, 0x70, 0xE0, 0x7F, 0x00, 0x22, +0xEE, 0xF0, 0x90, 0xFD, 0x80, 0xE0, 0x22, 0x90, +0x93, 0x24, 0x12, 0xF5, 0x9F, 0x30, 0xE0, 0x02, +0x11, 0x15, 0x22, 0x51, 0x0F, 0x90, 0x93, 0x24, +0xE0, 0xFF, 0xC4, 0x54, 0x0F, 0x30, 0xE0, 0x04, +0xB1, 0x52, 0x31, 0xC3, 0x22, 0x90, 0x9A, 0x0C, +0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x9A, 0x0A, +0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xE4, 0x90, 0x9A, +0x30, 0xF0, 0xEF, 0x24, 0x24, 0xFF, 0xE4, 0x3E, +0xFE, 0xC0, 0x06, 0xB1, 0x2A, 0xD0, 0x06, 0xE4, +0xFB, 0xFA, 0x91, 0xFA, 0x4E, 0x60, 0x3B, 0xE0, +0x24, 0x01, 0x91, 0x43, 0x12, 0x8B, 0xE7, 0x90, +0x9A, 0x0F, 0xB1, 0x13, 0x90, 0x9A, 0x0F, 0xB1, +0x09, 0xFE, 0xC3, 0x9F, 0x50, 0x24, 0x90, 0x9A, +0x32, 0xE0, 0x24, 0x02, 0xFD, 0x91, 0x44, 0xFC, +0xEE, 0x7E, 0x00, 0x2D, 0x12, 0x8B, 0xE4, 0x90, +0x9A, 0x0E, 0xE0, 0x24, 0x10, 0xF5, 0x82, 0xE4, +0x34, 0x9A, 0xF5, 0x83, 0xEF, 0xF0, 0x91, 0x55, +0x80, 0xD2, 0xB1, 0x1B, 0xC0, 0x06, 0xB1, 0x2A, +0xD0, 0x06, 0x7B, 0x03, 0x91, 0xF7, 0x90, 0x9A, +0x0B, 0xE0, 0x24, 0x22, 0xB1, 0x21, 0x90, 0x9A, +0x31, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x8B, 0xE8, +0xEF, 0x20, 0xE4, 0x02, 0x61, 0x5A, 0x90, 0x9A, +0x30, 0xE0, 0x04, 0xF0, 0xB1, 0x1B, 0xC0, 0x06, +0xB1, 0x2A, 0xD0, 0x06, 0x7B, 0x30, 0x91, 0xF7, +0x4E, 0x60, 0x3E, 0xE0, 0x24, 0x08, 0x91, 0x43, +0x12, 0x8B, 0xE7, 0xB1, 0x10, 0xB1, 0x06, 0xC3, +0x9F, 0x50, 0x2E, 0x90, 0x9A, 0x32, 0xE0, 0x24, +0x0D, 0x91, 0x43, 0x12, 0x8B, 0xE7, 0x90, 0x9A, +0x33, 0xEF, 0xF0, 0xBF, 0x02, 0x09, 0x90, 0x9A, +0x30, 0xE0, 0x24, 0x20, 0xF0, 0x80, 0x0E, 0x90, +0x9A, 0x33, 0xE0, 0xB4, 0x04, 0x07, 0x90, 0x9A, +0x30, 0xE0, 0x24, 0x40, 0xF0, 0x91, 0x4B, 0x80, +0xCC, 0xB1, 0x1B, 0xC0, 0x06, 0xB1, 0x2A, 0xD0, +0x06, 0x7B, 0xDD, 0x7A, 0x00, 0x7D, 0x01, 0x91, +0xFB, 0x4E, 0x60, 0x43, 0xE0, 0x24, 0x0C, 0x91, +0x43, 0x12, 0x8B, 0xE7, 0xB1, 0x10, 0xB1, 0x06, +0xC3, 0x9F, 0x50, 0x33, 0x90, 0x9A, 0x32, 0xE0, +0x24, 0x11, 0x91, 0x43, 0x12, 0x8B, 0xE7, 0x90, +0x9A, 0x33, 0xEF, 0xF0, 0xBF, 0x02, 0x09, 0x90, +0x9A, 0x30, 0xE0, 0x24, 0x02, 0xF0, 0x80, 0x0E, +0x90, 0x9A, 0x33, 0xE0, 0xB4, 0x04, 0x07, 0x90, +0x9A, 0x30, 0xE0, 0x24, 0x04, 0xF0, 0x91, 0x4B, +0x80, 0xCC, 0xE4, 0x90, 0x9A, 0x30, 0xF0, 0x90, +0x95, 0xBD, 0xE0, 0x90, 0x04, 0xFD, 0xB1, 0x14, +0x90, 0x95, 0xBD, 0xB1, 0x09, 0xFE, 0xC3, 0x9F, +0x50, 0x61, 0x12, 0xF5, 0x58, 0xF5, 0x83, 0xE0, +0xFF, 0x90, 0x9A, 0x0F, 0xE0, 0xFE, 0x6F, 0x70, +0x4E, 0x90, 0x04, 0xFC, 0xE0, 0x04, 0xF0, 0x90, +0x9A, 0x0E, 0xE0, 0x24, 0xDD, 0xF5, 0x82, 0xE4, +0x34, 0x95, 0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x9A, +0x30, 0xE0, 0xFD, 0x4F, 0x60, 0x04, 0xED, 0x5F, +0x60, 0x2D, 0xEE, 0xFF, 0x7E, 0x00, 0xC0, 0x06, +0xC0, 0x07, 0x90, 0x9A, 0x0E, 0xE0, 0x75, 0xF0, +0x20, 0xA4, 0x24, 0x05, 0xF9, 0x74, 0x96, 0xB1, +0x48, 0x7D, 0x01, 0xD0, 0x07, 0xD0, 0x06, 0x12, +0x83, 0xDC, 0xEF, 0x70, 0x0A, 0x90, 0x01, 0xC7, +0x74, 0x55, 0x12, 0x8F, 0xC9, 0x51, 0x1D, 0x91, +0x55, 0x80, 0x95, 0xE4, 0x90, 0x9A, 0x0E, 0xF0, +0x90, 0x9A, 0x0E, 0xE0, 0xFF, 0xC3, 0x94, 0x03, +0x50, 0x60, 0xA3, 0xE0, 0xFE, 0x60, 0x57, 0xEF, +0x75, 0xF0, 0x21, 0xA4, 0x24, 0xFA, 0xF5, 0x82, +0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFF, 0xEE, +0x6F, 0x70, 0x43, 0x90, 0x04, 0xFC, 0xE0, 0x04, +0xF0, 0x90, 0x9A, 0x0F, 0xE0, 0xFF, 0x7E, 0x00, +0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9A, 0x0E, 0xE0, +0x75, 0xF0, 0x21, 0xA4, 0x24, 0xFB, 0xF9, 0x74, +0x9A, 0xB1, 0x48, 0x7D, 0x01, 0xD0, 0x07, 0xD0, +0x06, 0x12, 0x83, 0xDC, 0xEF, 0x70, 0x17, 0x90, +0x01, 0xC7, 0x74, 0x24, 0x12, 0x8F, 0xC9, 0x12, +0xA7, 0x47, 0x30, 0xE0, 0x02, 0xB1, 0x52, 0xD1, +0x87, 0xE4, 0xFF, 0x12, 0x87, 0xFA, 0x91, 0x55, +0x80, 0x96, 0x22, 0xFF, 0x90, 0x9A, 0x31, 0xE0, +0x34, 0x00, 0x22, 0x90, 0x9A, 0x31, 0xE4, 0x75, +0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x9A, 0x0E, +0xE0, 0x04, 0xF0, 0x22, 0x90, 0x9A, 0x35, 0x12, +0xE8, 0xF1, 0xA3, 0xEA, 0xF0, 0xA3, 0xEB, 0xF0, +0xC3, 0x90, 0x9A, 0x3B, 0xE0, 0x94, 0x01, 0x90, +0x9A, 0x3A, 0xE0, 0x94, 0x00, 0x50, 0x02, 0x80, +0x7A, 0xE4, 0x90, 0x9A, 0x3E, 0xF0, 0xA3, 0xF0, +0xB1, 0x3F, 0x12, 0x8B, 0xE8, 0x90, 0x9A, 0x38, +0xE0, 0x70, 0x03, 0xA3, 0xE0, 0x6F, 0x70, 0x1D, +0x90, 0x9A, 0x36, 0xE0, 0x24, 0x02, 0xFF, 0x90, +0x9A, 0x35, 0xE0, 0x34, 0x00, 0xFE, 0x90, 0x9A, +0x37, 0xE0, 0xFD, 0x12, 0xF0, 0xA9, 0xBF, 0x01, +0x02, 0xA1, 0x3F, 0x80, 0x00, 0x90, 0x9A, 0x36, +0xE0, 0x24, 0x01, 0xFF, 0x90, 0x9A, 0x35, 0xE0, +0x34, 0x00, 0x12, 0x8B, 0xE7, 0x7E, 0x00, 0x90, +0x9A, 0x3C, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x24, +0x02, 0xFF, 0xEE, 0x33, 0xFE, 0x90, 0x9A, 0x35, +0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x9A, 0x3E, +0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, 0x9A, +0x3A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0x90, +0x9A, 0x3F, 0xE0, 0x9F, 0x90, 0x9A, 0x3E, 0xE0, +0x9E, 0x40, 0x8D, 0xE4, 0xFE, 0xFF, 0x22, 0x7A, +0x00, 0xE4, 0xFD, 0x91, 0x5C, 0x90, 0x9A, 0x31, +0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x9A, +0x34, 0xE0, 0xFF, 0x90, 0x9A, 0x0E, 0xE0, 0x22, +0x90, 0x9A, 0x34, 0xEF, 0xF0, 0xE4, 0x90, 0x9A, +0x0E, 0xF0, 0x22, 0x90, 0x9A, 0x0B, 0xE0, 0x24, +0x24, 0xFF, 0x90, 0x9A, 0x0A, 0xE0, 0x34, 0x00, +0xFE, 0x22, 0x90, 0x9A, 0x0D, 0xE0, 0x24, 0xDC, +0xFE, 0x90, 0x9A, 0x0C, 0xE0, 0x34, 0xFF, 0x90, +0x9A, 0x3A, 0xF0, 0xA3, 0xCE, 0xF0, 0x22, 0x90, +0x9A, 0x35, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, +0x35, 0xF0, 0xFA, 0x7B, 0x01, 0x78, 0x10, 0x7C, +0x9A, 0x22, 0x90, 0x01, 0x53, 0xE4, 0xF0, 0xFF, +0xEF, 0xD1, 0x79, 0xE4, 0xF0, 0x0F, 0xEF, 0xB4, +0x08, 0xF6, 0x22, 0xE4, 0x90, 0x9C, 0x59, 0xF0, +0x7F, 0x03, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x9C, 0x54, 0xEF, 0xF0, 0xB1, 0x52, +0x90, 0x9C, 0x54, 0xE0, 0xFF, 0xD1, 0x79, 0x74, +0x01, 0xF0, 0x90, 0x9C, 0x59, 0xE0, 0xFE, 0xEF, +0xD1, 0xBD, 0xEE, 0xF0, 0x90, 0x9C, 0x54, 0xE0, +0xB1, 0xCE, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0x01, 0xB1, 0xC3, 0x78, 0x10, 0x12, 0x03, 0xEB, +0xAB, 0x07, 0xB1, 0xC3, 0x78, 0x08, 0x12, 0x03, +0xEB, 0x90, 0x92, 0x20, 0xEF, 0xF0, 0xB1, 0xC3, +0x90, 0x92, 0x21, 0xEF, 0xF0, 0x7D, 0x01, 0x7F, +0x50, 0x7E, 0x01, 0x12, 0x66, 0x33, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0x90, 0x9C, 0x55, 0x02, 0x04, +0xB8, 0x90, 0x9A, 0x08, 0xE0, 0xFB, 0x75, 0xF0, +0x0A, 0xA4, 0x24, 0x5E, 0xF5, 0x82, 0xE4, 0x34, +0x9B, 0xF5, 0x83, 0x22, 0xE4, 0x90, 0x9A, 0x08, +0xF0, 0x90, 0x9A, 0x08, 0xE0, 0xFF, 0xC3, 0x94, +0x08, 0x40, 0x02, 0xC1, 0x71, 0xEF, 0xD1, 0x79, +0xE0, 0x64, 0x01, 0x70, 0x74, 0x90, 0x9A, 0x08, +0xE0, 0xB1, 0xCE, 0x12, 0x04, 0xB8, 0xE4, 0x7B, +0x01, 0xD1, 0x72, 0x70, 0x3A, 0x90, 0x9A, 0x08, +0xE0, 0xFB, 0xD1, 0xBD, 0xE0, 0x60, 0x21, 0x14, +0x70, 0x57, 0xEB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, +0x62, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, +0x12, 0x04, 0xB8, 0xEB, 0xB1, 0xCE, 0x12, 0x04, +0x31, 0x90, 0x9A, 0x08, 0xE0, 0xFF, 0x80, 0x0B, +0xB1, 0xC9, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0x00, 0xAF, 0x03, 0xD1, 0xCB, 0x80, 0x2A, 0x90, +0x9A, 0x08, 0xE0, 0xB1, 0xCE, 0x12, 0x04, 0xB8, +0xE4, 0xFB, 0xD1, 0x72, 0x50, 0x1B, 0xB1, 0xC9, +0x12, 0x04, 0xB8, 0xEF, 0x24, 0xFF, 0xFF, 0xEE, +0x34, 0xFF, 0xFE, 0xED, 0x34, 0xFF, 0xFD, 0xEC, +0x34, 0xFF, 0xFC, 0xEB, 0xB1, 0xCE, 0x12, 0x04, +0x31, 0x90, 0x9A, 0x08, 0xE0, 0x04, 0xF0, 0xA1, +0xE1, 0x22, 0xFA, 0xF9, 0xF8, 0xC3, 0x02, 0x03, +0xDA, 0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x67, 0xF5, +0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x22, 0x12, +0xF2, 0xBF, 0x79, 0x08, 0x02, 0x04, 0x80, 0xF1, +0xD8, 0x12, 0x7B, 0xDB, 0x12, 0xF1, 0xBE, 0xD1, +0x87, 0x31, 0x1F, 0x12, 0xDA, 0x4B, 0xF1, 0x66, +0x90, 0x98, 0x38, 0xE0, 0x54, 0x7F, 0xF0, 0x54, +0xBF, 0xF0, 0x54, 0xDF, 0xF0, 0x54, 0xF0, 0xF0, +0xE4, 0x90, 0x98, 0x3A, 0xF0, 0x90, 0x98, 0x38, +0xE0, 0x54, 0xEF, 0xF0, 0x22, 0x75, 0xF0, 0x0A, +0xA4, 0x24, 0x66, 0xF5, 0x82, 0xE4, 0x34, 0x9B, +0xF5, 0x83, 0x22, 0xEF, 0x24, 0xFC, 0x60, 0x05, +0x04, 0x70, 0x05, 0x80, 0x04, 0x12, 0xD4, 0x2C, +0x22, 0xE4, 0x90, 0x9A, 0x09, 0xF0, 0x90, 0x9B, +0x5D, 0x04, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, +0x04, 0xF0, 0x90, 0x98, 0x05, 0x12, 0x04, 0xB8, +0xEF, 0x24, 0x01, 0x12, 0xCA, 0xAD, 0x90, 0x98, +0x05, 0x12, 0x04, 0x31, 0x12, 0xD3, 0x3E, 0xE4, +0x90, 0x9A, 0xDE, 0xF0, 0xFF, 0x12, 0xF0, 0x2E, +0x12, 0xB3, 0x4A, 0x70, 0x4A, 0x90, 0x8A, 0xB9, +0x12, 0x97, 0x5E, 0x7D, 0x01, 0x7F, 0x02, 0x12, +0x04, 0x7E, 0x7F, 0x05, 0x7E, 0x00, 0x12, 0x7A, +0xAE, 0x12, 0xF5, 0x6A, 0x90, 0x8A, 0x89, 0x12, +0x97, 0x5E, 0xF1, 0xE3, 0x90, 0x88, 0x39, 0xE0, +0x64, 0x02, 0x60, 0x23, 0x90, 0x9A, 0x09, 0xE0, +0x04, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x7A, +0xAE, 0x90, 0x8A, 0xB9, 0x12, 0x97, 0x5E, 0x7D, +0x01, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x9A, +0x09, 0xE0, 0xD3, 0x94, 0x0A, 0x40, 0xD5, 0x90, +0x9C, 0x55, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0x0A, 0x12, 0xD7, 0x73, 0xA1, 0x6A, 0x12, 0xF5, +0x73, 0x7A, 0x98, 0x79, 0x24, 0x12, 0x04, 0x80, +0x90, 0x98, 0x25, 0x74, 0x08, 0xF0, 0xA3, 0x74, +0x03, 0xF0, 0x22, 0xF1, 0xEA, 0x30, 0xE0, 0x17, +0x90, 0x93, 0x04, 0xE0, 0xFF, 0xC4, 0x54, 0x0F, +0x20, 0xE0, 0x0C, 0x90, 0x9C, 0x55, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x14, 0xB1, 0x63, 0x22, +0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x38, 0x12, +0xF5, 0x61, 0x90, 0x93, 0x0B, 0xE0, 0x60, 0x0B, +0x14, 0xF0, 0x90, 0x9B, 0x5D, 0xE0, 0x70, 0x27, +0x02, 0x79, 0xD4, 0x12, 0xF5, 0x4E, 0xE4, 0xFF, +0x12, 0x87, 0xFA, 0x90, 0x93, 0x04, 0xE0, 0xFF, +0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, +0x30, 0xE0, 0x0C, 0x90, 0x9C, 0x55, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x01, 0xB1, 0x63, 0x22, +0xE4, 0xFD, 0xFF, 0x02, 0x6E, 0x71, 0xF1, 0xE2, +0x80, 0x99, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, +0x04, 0x7E, 0x90, 0x93, 0x24, 0xE0, 0xC4, 0x54, +0x0F, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x90, 0x98, +0x2C, 0xF0, 0xBF, 0x01, 0x0A, 0x7F, 0x01, 0x12, +0x99, 0x5D, 0xE4, 0x90, 0x98, 0x2C, 0xF0, 0x22, +0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x98, 0x3E, 0xED, +0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x98, 0x3E, +0xE0, 0x5E, 0xFE, 0xED, 0x5F, 0x4E, 0xF0, 0x22, +0xEF, 0xB4, 0xFF, 0x06, 0x90, 0x98, 0x3F, 0xED, +0xF0, 0x22, 0xEF, 0xF4, 0xFE, 0x90, 0x98, 0x3F, +0x80, 0xE6, 0x90, 0x9C, 0x99, 0xED, 0xF0, 0x64, +0x01, 0x60, 0x26, 0xE0, 0xFE, 0x64, 0x02, 0x60, +0x20, 0xEE, 0x64, 0x29, 0x60, 0x1B, 0xEE, 0x64, +0x2A, 0x60, 0x16, 0xEE, 0x64, 0x36, 0x60, 0x11, +0xEE, 0xB4, 0x37, 0x02, 0x80, 0x0B, 0xAD, 0x07, +0x7F, 0xFF, 0x11, 0x20, 0x90, 0x98, 0x3F, 0xE0, +0xFF, 0x90, 0x98, 0x3E, 0xE0, 0x4F, 0x90, 0x05, +0x22, 0xF0, 0x90, 0x9C, 0x99, 0xE0, 0x90, 0x93, +0x01, 0xF0, 0x22, 0x12, 0x02, 0x06, 0x64, 0x01, +0x60, 0x02, 0x21, 0x01, 0x90, 0x99, 0xCC, 0xF0, +0x90, 0x99, 0xCC, 0xE0, 0xFF, 0xC3, 0x94, 0x10, +0x50, 0x27, 0xEF, 0x31, 0x02, 0x7A, 0x99, 0x79, +0xCB, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x12, 0x90, +0x99, 0xCB, 0xE0, 0xFF, 0xA3, 0xE0, 0x24, 0xCD, +0xF5, 0x82, 0xE4, 0x34, 0x99, 0xF5, 0x83, 0xEF, +0xF0, 0x90, 0x99, 0xCC, 0xE0, 0x04, 0xF0, 0x80, +0xCF, 0x75, 0x45, 0x01, 0x75, 0x46, 0x99, 0x75, +0x47, 0xCD, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, +0x99, 0x79, 0x87, 0x12, 0x9F, 0x90, 0x74, 0x24, +0xF0, 0x90, 0x99, 0xA7, 0x74, 0x08, 0xF0, 0x75, +0x45, 0x01, 0x75, 0x46, 0x99, 0x75, 0x47, 0xD5, +0xF5, 0x48, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0xAA, +0x12, 0x69, 0xF5, 0x90, 0x99, 0xA8, 0x74, 0x25, +0xF0, 0x90, 0x99, 0xCA, 0x74, 0x08, 0x12, 0x98, +0xC2, 0x51, 0x1A, 0x7B, 0x01, 0x7A, 0x99, 0x79, +0xA8, 0x12, 0x97, 0x4C, 0x7F, 0x04, 0x12, 0x04, +0x7E, 0x22, 0x24, 0xA8, 0xFF, 0xE4, 0x34, 0x01, +0xFE, 0x7B, 0x01, 0x22, 0x12, 0x97, 0xE3, 0x64, +0x01, 0x60, 0x02, 0x21, 0x9C, 0xEF, 0x24, 0x39, +0x60, 0x12, 0x14, 0x60, 0x19, 0x24, 0x02, 0x70, +0x1F, 0xE4, 0x90, 0x99, 0x8B, 0xF0, 0xA3, 0x74, +0x06, 0xF0, 0x80, 0x14, 0x90, 0x99, 0x8B, 0x74, +0x06, 0xF0, 0xA3, 0xF0, 0x80, 0x0A, 0x90, 0x99, +0x8B, 0x74, 0x0C, 0xF0, 0xA3, 0x74, 0x04, 0xF0, +0x31, 0xB0, 0xF0, 0x31, 0x9D, 0x40, 0x1B, 0x90, +0x99, 0x89, 0xE0, 0x31, 0x02, 0x7A, 0x99, 0x79, +0x88, 0x12, 0x5F, 0xA6, 0xBF, 0x01, 0x07, 0x90, +0x99, 0x88, 0xE0, 0xF4, 0x70, 0x3E, 0x31, 0xA5, +0x80, 0xE1, 0x31, 0xB0, 0xF0, 0x31, 0x9D, 0x40, +0x33, 0x90, 0x99, 0x89, 0xE0, 0xFD, 0x7C, 0x00, +0x24, 0xA8, 0xFF, 0xEC, 0x34, 0x01, 0xFE, 0xED, +0x24, 0x01, 0xFD, 0xEC, 0x33, 0xFC, 0x90, 0x99, +0x8B, 0xE0, 0xFB, 0xC3, 0xED, 0x9B, 0xFD, 0xEC, +0x94, 0x00, 0xFC, 0x12, 0x91, 0xAD, 0x8D, 0x82, +0x8C, 0x83, 0x12, 0x02, 0x1F, 0xFD, 0x31, 0xC0, +0x31, 0xA5, 0x80, 0xC9, 0x22, 0x90, 0x99, 0x8A, +0xE0, 0xD3, 0x94, 0x00, 0x22, 0x90, 0x99, 0x89, +0xE0, 0x04, 0xF0, 0xA3, 0xE0, 0x14, 0xF0, 0x22, +0x90, 0x99, 0x8B, 0xE0, 0x90, 0x99, 0x89, 0xF0, +0x90, 0x99, 0x8C, 0xE0, 0x90, 0x99, 0x8A, 0x22, +0xE4, 0x90, 0x99, 0x8D, 0xF0, 0x90, 0x00, 0x37, +0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0xCF, 0x74, +0x69, 0xF0, 0xEF, 0x90, 0x00, 0x31, 0xF0, 0xEE, +0x54, 0x03, 0xFF, 0xA3, 0xE0, 0x54, 0xFC, 0x4F, +0xF0, 0x90, 0x00, 0x30, 0xED, 0xF0, 0x90, 0x00, +0x33, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x00, 0x33, +0xE0, 0x30, 0xE7, 0x09, 0x51, 0x12, 0x50, 0x05, +0xE0, 0x04, 0xF0, 0x80, 0xF0, 0x90, 0x00, 0xCF, +0xE4, 0xF0, 0x90, 0x00, 0x37, 0xE0, 0x54, 0x7F, +0xF0, 0x51, 0x12, 0x7F, 0x00, 0x50, 0x02, 0x7F, +0x01, 0x22, 0x90, 0x99, 0x8D, 0xE0, 0xC3, 0x94, +0x64, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, +0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x02, 0x04, +0x7E, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x88, 0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, +0x24, 0x90, 0x9B, 0xAE, 0x74, 0x1E, 0xF0, 0x90, +0x9B, 0xD0, 0x74, 0x01, 0xF0, 0x90, 0x9B, 0xB0, +0xEF, 0xF0, 0x7B, 0x01, 0x7A, 0x9B, 0x79, 0xAE, +0x51, 0x1A, 0x90, 0x8A, 0xE5, 0x12, 0x97, 0x5E, +0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x51, 0x68, 0xE4, 0xFF, 0x80, 0xC1, +0xE4, 0xF5, 0x0F, 0x90, 0x88, 0x36, 0xE0, 0x60, +0x56, 0x71, 0x4A, 0x70, 0x52, 0x12, 0xF4, 0xE0, +0x75, 0x0F, 0x01, 0xE5, 0x0F, 0x60, 0x48, 0x90, +0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, +0xB9, 0x12, 0x97, 0x5E, 0x7D, 0x01, 0x7F, 0x04, +0x12, 0x04, 0x7E, 0x71, 0x42, 0x90, 0x88, 0x3F, +0xE0, 0x60, 0x04, 0x64, 0x01, 0x70, 0x11, 0xE4, +0x90, 0x92, 0x20, 0xF0, 0x51, 0xD7, 0xFF, 0xA3, +0xE0, 0x51, 0xC8, 0xFF, 0xA3, 0xE0, 0x80, 0x0D, +0xE4, 0x90, 0x92, 0x20, 0xF0, 0x51, 0xD7, 0x51, +0xE1, 0x51, 0xC8, 0x51, 0xE1, 0x2F, 0x33, 0x33, +0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x22, +0x2F, 0x90, 0x92, 0x21, 0xF0, 0xE4, 0xFB, 0xFD, +0x7F, 0x54, 0x7E, 0x01, 0x12, 0x66, 0x33, 0x90, +0x88, 0x3E, 0xE0, 0x13, 0x13, 0x13, 0x54, 0x1F, +0x22, 0xFF, 0xA3, 0xE0, 0x75, 0xF0, 0x03, 0xA4, +0x24, 0xFE, 0x22, 0x51, 0xFB, 0x7D, 0x02, 0x7F, +0x02, 0x12, 0x7C, 0x74, 0x7F, 0x01, 0x51, 0x29, +0x02, 0xAF, 0x98, 0xE4, 0x90, 0x9A, 0xD8, 0xF0, +0x90, 0x88, 0x36, 0xE0, 0x60, 0x3B, 0x71, 0x4A, +0x70, 0x37, 0x12, 0xF5, 0x97, 0xF0, 0x12, 0xF4, +0xE0, 0x90, 0x9A, 0xD8, 0x74, 0x01, 0xF0, 0xE4, +0x90, 0x88, 0x3D, 0xF0, 0x04, 0x60, 0x22, 0x90, +0x88, 0x39, 0xE0, 0x20, 0xE2, 0x0D, 0x90, 0x8A, +0xB9, 0x12, 0x97, 0x5E, 0x7D, 0x01, 0x7F, 0x04, +0x12, 0x04, 0x7E, 0x71, 0x42, 0xE4, 0x90, 0x92, +0x20, 0xF0, 0x51, 0xD7, 0x71, 0x76, 0x12, 0x66, +0x33, 0x22, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x10, +0xF0, 0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xEF, +0x64, 0x01, 0x22, 0x71, 0x4A, 0x70, 0x14, 0x90, +0x88, 0x36, 0xE0, 0x60, 0x0E, 0x90, 0x88, 0x3A, +0xE0, 0x20, 0xE4, 0x07, 0xF1, 0xEE, 0x71, 0x6C, +0x12, 0x66, 0x33, 0x22, 0xF0, 0xE4, 0x90, 0x92, +0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, +0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x7E, +0x01, 0x22, 0x71, 0x4A, 0x70, 0x1E, 0x90, 0x88, +0x36, 0xE0, 0x60, 0x18, 0x90, 0x88, 0x3A, 0xE0, +0x20, 0xE4, 0x11, 0xF1, 0xEE, 0xF0, 0x90, 0x88, +0x31, 0xE0, 0x12, 0xF5, 0x2D, 0x54, 0x07, 0x70, +0x03, 0x12, 0xBE, 0x1B, 0x22, 0xC0, 0xE0, 0xC0, +0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, +0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, +0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, +0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, 0xA5, 0xF0, +0x74, 0xB3, 0xA3, 0xF0, 0x12, 0x64, 0x7F, 0xE5, +0x30, 0x30, 0xE1, 0x03, 0x12, 0xC7, 0x8E, 0xE5, +0x2D, 0x30, 0xE3, 0x03, 0x12, 0xD1, 0x12, 0xE5, +0x2D, 0x30, 0xE4, 0x03, 0x12, 0xD1, 0x25, 0xE5, +0x2D, 0x30, 0xE5, 0x03, 0x12, 0xD1, 0x36, 0xE5, +0x2F, 0x30, 0xE0, 0x02, 0x51, 0x62, 0xE5, 0x2F, +0x30, 0xE1, 0x02, 0x91, 0x49, 0xE5, 0x2F, 0x30, +0xE2, 0x03, 0x12, 0xC6, 0x87, 0xE5, 0x2F, 0x30, +0xE3, 0x02, 0x71, 0x53, 0xE5, 0x2F, 0x30, 0xE4, +0x02, 0x71, 0x82, 0xE5, 0x2F, 0x30, 0xE5, 0x03, +0x12, 0xC6, 0x99, 0xE5, 0x2F, 0x30, 0xE6, 0x03, +0x12, 0xC6, 0xBC, 0x74, 0xA5, 0x04, 0x90, 0x01, +0xC4, 0xF0, 0x74, 0xB3, 0xA3, 0xF0, 0xD0, 0x07, +0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, +0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, +0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, +0x32, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x02, 0x81, +0xD7, 0x90, 0x88, 0x4D, 0xE0, 0x04, 0xF0, 0x90, +0x05, 0x61, 0xB1, 0x5C, 0x78, 0x08, 0x12, 0x03, +0xFE, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, 0xAB, +0x07, 0x90, 0x05, 0x60, 0xB1, 0x5C, 0x12, 0x82, +0x05, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, +0x07, 0x90, 0x05, 0x62, 0xB1, 0x5C, 0x78, 0x10, +0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0x82, 0x05, 0xC0, 0x04, +0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0xA3, 0xB1, +0x5C, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, +0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x82, +0x05, 0x90, 0x88, 0x81, 0x12, 0x04, 0x31, 0x90, +0x88, 0x32, 0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, +0x30, 0xE0, 0x0C, 0x12, 0xC8, 0x35, 0x74, 0x05, +0xF0, 0x12, 0x6E, 0x2F, 0x12, 0xD9, 0x77, 0x12, +0x89, 0xEE, 0x30, 0xE0, 0x0A, 0x90, 0x01, 0x3B, +0xE0, 0x30, 0xE4, 0x03, 0x12, 0xF4, 0xD2, 0x12, +0xBC, 0xF8, 0x12, 0xDA, 0x0F, 0xE4, 0x90, 0x98, +0x23, 0xF0, 0x12, 0xF4, 0xC1, 0x90, 0x93, 0x24, +0x12, 0xA6, 0xEE, 0x30, 0xE0, 0x52, 0x90, 0x95, +0x67, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x7C, 0x00, +0x7D, 0x64, 0x12, 0x02, 0x92, 0x90, 0x95, 0xBB, +0xE0, 0x6E, 0x70, 0x03, 0xA3, 0xE0, 0x6F, 0x60, +0x0A, 0x90, 0x95, 0xBB, 0xE4, 0x75, 0xF0, 0x01, +0x02, 0x02, 0xE7, 0x90, 0x95, 0x6B, 0xE0, 0xFE, +0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x79, 0xE0, 0xB5, +0x06, 0x14, 0xA3, 0xE0, 0xB5, 0x07, 0x0F, 0xEF, +0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, 0x74, 0x31, +0xF0, 0x7F, 0x01, 0x02, 0xBC, 0x2E, 0x12, 0xE5, +0x43, 0xE4, 0x90, 0x95, 0xBB, 0xF0, 0xA3, 0xF0, +0x22, 0x12, 0x04, 0x31, 0x90, 0x99, 0x85, 0xE4, +0x75, 0xF0, 0x04, 0x12, 0x02, 0xE7, 0x90, 0x99, +0x85, 0xA3, 0xE0, 0x24, 0x02, 0xF5, 0x82, 0xE4, +0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFF, 0xE4, 0xFC, +0xFD, 0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, +0xC0, 0xD0, 0x12, 0xC1, 0x87, 0x90, 0x99, 0x8A, +0xF0, 0x90, 0x02, 0x09, 0xE0, 0x90, 0x99, 0x8B, +0xF0, 0x90, 0x98, 0x19, 0x12, 0xE2, 0x00, 0x90, +0x99, 0x85, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, +0xCD, 0xDF, 0xE0, 0x90, 0x95, 0xBD, 0xF0, 0x74, +0x01, 0x2F, 0x12, 0xCF, 0x6A, 0xE0, 0x90, 0x95, +0xBE, 0xF0, 0xF1, 0xE6, 0x12, 0x02, 0xE7, 0x90, +0x99, 0x85, 0xA3, 0xE0, 0x24, 0x02, 0x12, 0xDD, +0xC9, 0xFF, 0xE4, 0xFC, 0xFD, 0x78, 0x10, 0x12, +0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, +0xC0, 0x07, 0x12, 0xF5, 0x15, 0xB1, 0x5A, 0x78, +0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, +0xD0, 0x01, 0xD0, 0x00, 0x12, 0x80, 0xC0, 0xC0, +0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x12, +0xF5, 0x08, 0xB1, 0x5A, 0x78, 0x08, 0x12, 0x03, +0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, +0x00, 0x12, 0xCD, 0xCF, 0xB1, 0x5C, 0x12, 0x80, +0xC0, 0x90, 0x95, 0xC1, 0xB1, 0x41, 0x78, 0x10, +0x12, 0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, 0xC0, +0x06, 0xC0, 0x07, 0x12, 0xF5, 0x15, 0xB1, 0x5A, +0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, +0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x80, 0xC0, +0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, +0x12, 0xF5, 0x08, 0xB1, 0x5A, 0x78, 0x08, 0x12, +0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, +0xD0, 0x00, 0x12, 0xCD, 0xCF, 0xB1, 0x5C, 0x12, +0x80, 0xC0, 0x90, 0x95, 0xC5, 0xB1, 0x41, 0x78, +0x10, 0x12, 0x03, 0xFE, 0xC0, 0x04, 0xC0, 0x05, +0xC0, 0x06, 0xC0, 0x07, 0x12, 0xF5, 0x15, 0xB1, +0x5A, 0x78, 0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, +0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x80, +0xC0, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, +0x07, 0x12, 0xF5, 0x08, 0xB1, 0x5A, 0x78, 0x08, +0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, 0xD0, +0x01, 0xD0, 0x00, 0x12, 0xCD, 0xCF, 0xB1, 0x5C, +0x12, 0x80, 0xC0, 0x90, 0x95, 0xC9, 0x12, 0x04, +0x31, 0xF1, 0xE6, 0xF1, 0xDD, 0x12, 0xF5, 0x22, +0x12, 0xCD, 0xDF, 0xE0, 0xFF, 0x12, 0xF5, 0x58, +0xF1, 0xCB, 0xE0, 0xB4, 0x10, 0xEF, 0xF1, 0xD6, +0x12, 0xF5, 0x22, 0x12, 0xCD, 0xDF, 0xE0, 0xFF, +0x74, 0xDD, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, +0xF1, 0xCB, 0xE0, 0xB4, 0x10, 0xEA, 0xF1, 0xD6, +0x12, 0xF5, 0x22, 0x12, 0xCD, 0xDF, 0xE0, 0xFF, +0x74, 0xED, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, +0xF1, 0xCB, 0xE0, 0xB4, 0x10, 0xEA, 0x90, 0x99, +0x85, 0x12, 0xEE, 0x4C, 0x90, 0x98, 0x19, 0x12, +0x9F, 0xEE, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, +0x99, 0x85, 0xE4, 0x75, 0xF0, 0x40, 0xF1, 0xDD, +0x90, 0x99, 0x87, 0xE0, 0xFF, 0xC3, 0x94, 0x08, +0x50, 0x20, 0x90, 0x99, 0x85, 0xA3, 0xE0, 0xFE, +0xEF, 0x2E, 0x12, 0xCD, 0xDF, 0xE0, 0xFE, 0x90, +0x99, 0x8B, 0xE0, 0xFD, 0xEE, 0x2D, 0xFE, 0x74, +0xFD, 0x2F, 0x12, 0xD7, 0x6B, 0xEE, 0xF1, 0xCE, +0x80, 0xD6, 0x90, 0x98, 0x19, 0xE0, 0x04, 0x90, +0x99, 0x89, 0xF0, 0xE4, 0x90, 0x99, 0x88, 0xF0, +0x90, 0x95, 0xBD, 0xE0, 0x13, 0x13, 0x54, 0x3F, +0x24, 0x01, 0xFF, 0xE4, 0x33, 0xFE, 0x90, 0x99, +0x88, 0xE0, 0xC3, 0x9F, 0xEE, 0x12, 0xD9, 0x70, +0x50, 0x7A, 0xA3, 0x12, 0x9F, 0xEE, 0xE4, 0xF0, +0xA3, 0xEF, 0xF0, 0xE4, 0xA3, 0xF0, 0x90, 0x99, +0x87, 0xE0, 0xFD, 0xC3, 0x94, 0x04, 0x50, 0x56, +0xA3, 0xE0, 0x75, 0xF0, 0x04, 0xA4, 0x7C, 0x00, +0x2D, 0xFF, 0xEC, 0x35, 0xF0, 0xFE, 0x90, 0x95, +0xBD, 0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0x74, 0x80, +0xF8, 0x6E, 0x98, 0x50, 0x39, 0xEF, 0x78, 0x05, +0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, +0x05, 0xF9, 0x74, 0x96, 0x3E, 0xFA, 0x7B, 0x01, +0xC0, 0x03, 0xC0, 0x01, 0x90, 0x99, 0x85, 0xA3, +0xE0, 0x24, 0x00, 0xF9, 0xE4, 0x34, 0xFC, 0x8B, +0x45, 0xF5, 0x46, 0x89, 0x47, 0x75, 0x48, 0x20, +0xD0, 0x01, 0xD0, 0x03, 0x12, 0x9F, 0x90, 0x12, +0xEE, 0x53, 0xF1, 0xCF, 0x80, 0xA0, 0x90, 0x99, +0x89, 0xE0, 0x04, 0xF0, 0x90, 0x99, 0x88, 0xE0, +0x04, 0xF0, 0xE1, 0x20, 0xE4, 0x90, 0x99, 0x87, +0xF0, 0xE4, 0xFF, 0x0F, 0xEF, 0xB4, 0x20, 0xFB, +0xF1, 0xCF, 0xE0, 0xB4, 0x10, 0xF3, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xF5, 0x83, 0xEF, 0xF0, 0x90, +0x99, 0x87, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x99, +0x85, 0xE4, 0x75, 0xF0, 0x10, 0x12, 0x02, 0xE7, +0xE4, 0x90, 0x99, 0x87, 0xF0, 0x22, 0x90, 0x99, +0x85, 0xE4, 0x75, 0xF0, 0x04, 0x22, 0x90, 0x01, +0x57, 0xE4, 0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x01, 0xCC, 0xE0, 0x54, 0x0F, 0xFD, 0xED, +0x70, 0x02, 0x01, 0xF0, 0x90, 0x87, 0x0B, 0xE0, +0xFF, 0x70, 0x06, 0xA3, 0xE0, 0x64, 0x09, 0x60, +0x0A, 0xEF, 0x14, 0xFF, 0x90, 0x87, 0x0C, 0xE0, +0xB5, 0x07, 0x04, 0x7F, 0x01, 0x80, 0x02, 0x7F, +0x00, 0xEF, 0x60, 0x09, 0x90, 0x01, 0xC1, 0xE0, +0x44, 0x01, 0xF0, 0x01, 0xF0, 0x90, 0x9C, 0x98, +0x12, 0xA0, 0xDC, 0x80, 0x05, 0xC3, 0x33, 0xCE, +0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xED, 0xFB, 0xEF, +0x5B, 0x70, 0x02, 0x01, 0xCD, 0xE4, 0xFC, 0x31, +0x00, 0x7A, 0x00, 0x2F, 0xFF, 0xEA, 0x35, 0xF0, +0xFE, 0x74, 0xD0, 0x11, 0xF5, 0x90, 0x87, 0x0C, +0xE0, 0xF9, 0x75, 0xF0, 0x08, 0x90, 0x86, 0xBB, +0x31, 0x0B, 0xEF, 0xF0, 0x31, 0x00, 0x2F, 0xFF, +0xEA, 0x35, 0xF0, 0xFE, 0x74, 0xF0, 0x11, 0xF5, +0x75, 0xF0, 0x08, 0xE9, 0x90, 0x86, 0xBF, 0x31, +0x0B, 0xEF, 0xF0, 0x0C, 0xEC, 0xB4, 0x04, 0xC7, +0x90, 0x9C, 0x98, 0x12, 0x97, 0xEF, 0x08, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0xF4, 0x5D, 0xFD, +0x90, 0x9C, 0x98, 0x12, 0x97, 0xEF, 0x08, 0x80, +0x02, 0xC3, 0x33, 0xD8, 0xFC, 0x90, 0x01, 0xCC, +0xF0, 0x90, 0x9C, 0x98, 0xE0, 0x04, 0xF0, 0xE0, +0x54, 0x03, 0xF0, 0x90, 0x87, 0x0C, 0xE0, 0x04, +0xF0, 0xE0, 0x7F, 0x00, 0xB4, 0x0A, 0x02, 0x7F, +0x01, 0xEF, 0x70, 0x02, 0x01, 0x07, 0xE4, 0x90, +0x87, 0x0C, 0xF0, 0x01, 0x07, 0x90, 0x01, 0xC0, +0xE0, 0x44, 0x02, 0xF0, 0x90, 0x9C, 0x98, 0xE0, +0x44, 0x80, 0x90, 0x00, 0x8A, 0xF0, 0x90, 0x9C, +0x98, 0xE0, 0x75, 0xF0, 0x04, 0x90, 0x01, 0xD0, +0x12, 0x04, 0x6E, 0xE0, 0x90, 0x01, 0xC3, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x2F, 0xF5, 0x82, +0x74, 0x01, 0x3E, 0xF5, 0x83, 0xE0, 0xFF, 0x22, +0x90, 0x9C, 0x98, 0xE0, 0x75, 0xF0, 0x04, 0xA4, +0xFF, 0xEC, 0x22, 0x12, 0x04, 0x6E, 0xE5, 0x82, +0x2C, 0xF5, 0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x9C, 0x8F, 0xEF, 0xF0, 0x90, 0x00, 0x8F, +0xE0, 0x30, 0xE6, 0x44, 0x90, 0x00, 0x8D, 0xE0, +0x64, 0x01, 0x70, 0x3C, 0x90, 0x9C, 0x90, 0xF0, +0x90, 0x9C, 0x90, 0xE0, 0xFD, 0x90, 0x9C, 0x8F, +0xE0, 0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, +0xE4, 0x34, 0x81, 0xF5, 0x83, 0xE5, 0x82, 0x2D, +0x31, 0x11, 0xE0, 0xFB, 0xE4, 0xFF, 0x31, 0x75, +0x90, 0x9C, 0x90, 0xE0, 0x04, 0xF0, 0xE0, 0xC3, +0x94, 0x10, 0x40, 0xD4, 0x90, 0x00, 0x8F, 0xE0, +0x30, 0xE0, 0x05, 0x90, 0x00, 0x8D, 0xE4, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xEF, 0x70, 0x04, +0x74, 0xF0, 0x80, 0x16, 0xEF, 0xB4, 0x01, 0x04, +0x74, 0xF4, 0x80, 0x0E, 0xEF, 0xB4, 0x02, 0x04, +0x74, 0xF8, 0x80, 0x06, 0xEF, 0xB4, 0x03, 0x0C, +0x74, 0xFC, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x02, +0xF5, 0x83, 0xEB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, +0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, 0x12, 0x7B, +0x41, 0xEF, 0x30, 0xE6, 0x2E, 0x90, 0x00, 0x8C, +0xE0, 0x90, 0x9C, 0x84, 0xF0, 0x7F, 0x8D, 0x12, +0x7B, 0x41, 0x90, 0x9C, 0x85, 0xEF, 0xF0, 0x90, +0x00, 0x8E, 0xE0, 0x90, 0x9C, 0x86, 0xF0, 0x90, +0x9C, 0x85, 0xE0, 0x7F, 0x8F, 0x12, 0x7B, 0x41, +0xEF, 0x30, 0xE0, 0x07, 0xE4, 0xFD, 0x7F, 0x8D, +0x12, 0x7B, 0x2E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0xE4, 0x90, 0x99, 0xDD, 0xF0, 0xA3, 0xF0, 0xA3, +0xF0, 0x90, 0x99, 0xDD, 0xE0, 0x64, 0x01, 0xF0, +0x90, 0x98, 0x36, 0xE0, 0x70, 0x18, 0x90, 0x98, +0x33, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, 0x0E, +0x90, 0x99, 0xDD, 0xE0, 0x24, 0xE0, 0x90, 0x01, +0xC4, 0xF0, 0x74, 0xB9, 0xA3, 0xF0, 0x12, 0x7C, +0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, 0x90, +0x88, 0x36, 0xE0, 0x60, 0x0E, 0x90, 0x88, 0x39, +0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, 0x60, +0x02, 0xD1, 0x1B, 0xC2, 0xAF, 0x12, 0xC4, 0x4D, +0xBF, 0x01, 0x16, 0x90, 0x86, 0xB3, 0xE0, 0xFF, +0xB4, 0x03, 0x07, 0x90, 0x99, 0x84, 0xE0, 0x20, +0xE0, 0x05, 0xEF, 0x64, 0x03, 0x60, 0x02, 0x51, +0x55, 0xD2, 0xAF, 0x12, 0xCA, 0xB8, 0x31, 0x9D, +0x12, 0x84, 0x4D, 0x80, 0x94, 0x90, 0x88, 0x31, +0xE0, 0x30, 0xE0, 0x02, 0x51, 0x5F, 0x22, 0x90, +0x88, 0x39, 0xE0, 0xFF, 0x60, 0x03, 0xB4, 0x08, +0x0E, 0x12, 0xF3, 0xC8, 0xBF, 0x01, 0x08, 0x51, +0x78, 0x90, 0x01, 0xE5, 0xE0, 0x04, 0xF0, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, +0xC1, 0xB3, 0x51, 0x89, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0xE4, 0x90, 0x99, 0xE0, 0xF0, 0x12, 0xD8, +0x32, 0x12, 0xC0, 0x41, 0xE4, 0xFF, 0x12, 0xC2, +0xC8, 0x90, 0x93, 0x0C, 0xE0, 0x20, 0xE0, 0x02, +0x61, 0x87, 0x90, 0x00, 0x02, 0xE0, 0x44, 0x02, +0xF0, 0xE4, 0x90, 0x99, 0xE1, 0xF0, 0x90, 0x99, +0xE1, 0xE0, 0xFF, 0xC3, 0x94, 0x05, 0x50, 0x30, +0x12, 0xA0, 0xDE, 0x80, 0x05, 0xC3, 0x33, 0xCE, +0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, 0x0F, +0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x12, 0x90, 0x99, +0xE1, 0x12, 0xC3, 0x4D, 0x90, 0x99, 0xE1, 0x12, +0xC3, 0x6D, 0x44, 0x40, 0xF0, 0x12, 0xC1, 0xAC, +0x90, 0x99, 0xE1, 0xE0, 0x04, 0xF0, 0x80, 0xC6, +0x90, 0x07, 0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, +0xF0, 0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, +0x07, 0xC4, 0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, +0x38, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x0F, +0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x90, 0x02, 0x26, +0xE0, 0x44, 0x01, 0xF0, 0xE0, 0x90, 0x99, 0xE2, +0xF0, 0x90, 0x99, 0xE2, 0xE0, 0x30, 0xE0, 0x19, +0x90, 0x99, 0xE0, 0xE0, 0x04, 0xF0, 0x71, 0x98, +0x90, 0x02, 0x26, 0xE0, 0x90, 0x99, 0xE2, 0xF0, +0x90, 0x99, 0xE0, 0xE0, 0xD3, 0x94, 0xFA, 0x40, +0xE0, 0x90, 0x02, 0x03, 0x74, 0x80, 0xF0, 0x90, +0x04, 0x24, 0xE0, 0x90, 0x99, 0xE3, 0xF0, 0x90, +0x04, 0x22, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x02, +0x00, 0xE0, 0x90, 0x99, 0xE2, 0xF0, 0x90, 0x02, +0x01, 0x71, 0x8F, 0x90, 0x02, 0x02, 0x71, 0x8F, +0x90, 0x02, 0x14, 0x71, 0x8F, 0xE0, 0x04, 0xF0, +0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, 0x04, 0x22, +0xE0, 0x54, 0xEF, 0xF0, 0x90, 0x99, 0xE3, 0xE0, +0x90, 0x04, 0x24, 0xF0, 0x90, 0xFD, 0x09, 0x74, +0xFF, 0xF0, 0x90, 0xFD, 0x08, 0xE4, 0xF0, 0x90, +0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, 0x22, 0xE0, +0xFF, 0x90, 0x99, 0xE2, 0xE0, 0x2F, 0xF0, 0x22, +0x7F, 0x0A, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x90, +0x93, 0x2D, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x32, +0x12, 0xC5, 0x4B, 0x90, 0x98, 0x1E, 0xF0, 0x70, +0x22, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, 0x10, +0x71, 0xF9, 0x91, 0x18, 0x90, 0x93, 0x2D, 0xE0, +0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x02, 0x71, 0x98, +0x90, 0x98, 0x1C, 0xE0, 0xFF, 0x7B, 0x01, 0x7D, +0x01, 0x80, 0x04, 0xB1, 0xD0, 0xFB, 0xFD, 0x02, +0x96, 0x1A, 0x90, 0x93, 0x2D, 0xE0, 0x30, 0xE0, +0x17, 0x71, 0xF9, 0x91, 0x18, 0x90, 0x93, 0x2D, +0xE0, 0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x02, 0x71, +0x98, 0x90, 0x93, 0x2D, 0xE0, 0x54, 0xFE, 0xF0, +0x22, 0x90, 0x00, 0xCC, 0xE0, 0x44, 0x04, 0xF0, +0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFB, +0x22, 0x90, 0x00, 0xCC, 0xE0, 0x44, 0x04, 0xF0, +0x7F, 0x02, 0x12, 0x7B, 0x41, 0xEF, 0x44, 0x04, +0xFD, 0x7F, 0x02, 0x12, 0x7B, 0x2E, 0x90, 0x00, +0xCC, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x01, +0xC7, 0x74, 0x10, 0xF0, 0x7F, 0x01, 0x90, 0x9C, +0x9C, 0xEF, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0x64, +0x02, 0x70, 0x21, 0x90, 0x9C, 0x9C, 0xE0, 0xFD, +0x64, 0x01, 0x70, 0x76, 0x12, 0x8F, 0xCA, 0x12, +0x97, 0xAE, 0x30, 0xE0, 0x09, 0x90, 0x01, 0x4D, +0xE0, 0x64, 0x80, 0xF0, 0x80, 0x64, 0xAF, 0x05, +0x91, 0xC5, 0x80, 0x5E, 0x90, 0x86, 0xB3, 0xE0, +0x64, 0x03, 0x70, 0x2D, 0x90, 0x99, 0x84, 0xE0, +0xFF, 0x30, 0xE0, 0x25, 0x90, 0x00, 0xD4, 0xE0, +0x54, 0xEF, 0xF0, 0x90, 0x00, 0xC6, 0xE0, 0x54, +0xFD, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x44, 0x30, +0xF0, 0x90, 0x00, 0x23, 0xE0, 0x44, 0x80, 0xF0, +0x91, 0x1E, 0xEF, 0x54, 0xFE, 0x90, 0x99, 0x84, +0xF0, 0x90, 0x06, 0x90, 0xE0, 0x44, 0x20, 0x12, +0xC7, 0xDA, 0xF1, 0xE0, 0x90, 0x06, 0x90, 0xE0, +0x44, 0x01, 0xF0, 0x90, 0x9C, 0x9C, 0xE0, 0xFF, +0x91, 0xC5, 0xB1, 0xD0, 0xFB, 0xFD, 0x12, 0x96, +0x1A, 0x91, 0x09, 0x90, 0x00, 0x04, 0xE0, 0x44, +0x08, 0xF0, 0x91, 0xF1, 0xF0, 0x90, 0x93, 0x24, +0xE0, 0x54, 0xBF, 0xF0, 0x22, 0xEF, 0x64, 0x01, +0x70, 0x26, 0x90, 0x93, 0x2B, 0xE0, 0x54, 0x7F, +0xFF, 0x7E, 0x00, 0x90, 0x93, 0x2D, 0xE0, 0x13, +0x13, 0x54, 0x01, 0xFD, 0x90, 0x93, 0x2C, 0xE0, +0xFC, 0xC3, 0x13, 0x54, 0x7F, 0xFB, 0xEC, 0x54, +0x01, 0x90, 0x9C, 0x52, 0xF0, 0x12, 0x95, 0x41, +0x22, 0x90, 0x98, 0x24, 0xE0, 0x54, 0xFE, 0x22, +0x90, 0x98, 0x24, 0xE0, 0x30, 0xE0, 0x79, 0x90, +0x98, 0x28, 0xE0, 0x04, 0xF0, 0x90, 0x98, 0x2B, +0xE0, 0x64, 0x01, 0x70, 0x32, 0x90, 0x98, 0x24, +0xF1, 0xBA, 0x30, 0xE0, 0x2A, 0x90, 0x98, 0x2A, +0xE0, 0x70, 0x24, 0x90, 0x98, 0x27, 0xE0, 0xFE, +0xA3, 0xE0, 0xC3, 0x9E, 0x40, 0x19, 0xEF, 0x13, +0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x0A, 0xB1, +0xD7, 0x12, 0x97, 0xAA, 0x91, 0xF1, 0xF0, 0x80, +0x06, 0x91, 0x26, 0x91, 0xF1, 0xF0, 0x22, 0x90, +0x98, 0x28, 0xE0, 0xFF, 0x90, 0x98, 0x25, 0xE0, +0xD3, 0x9F, 0x50, 0x2C, 0x90, 0x06, 0x92, 0xE0, +0x20, 0xE2, 0x16, 0x90, 0x98, 0x2A, 0xE0, 0x70, +0x10, 0x90, 0x8A, 0xAF, 0x12, 0x97, 0x5E, 0xB1, +0xE0, 0x90, 0x98, 0x23, 0xE0, 0x04, 0xF0, 0x80, +0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, +0x90, 0x98, 0x28, 0xF0, 0x90, 0x98, 0x2A, 0xF0, +0x22, 0x90, 0x98, 0x24, 0xE0, 0xFD, 0x30, 0xE0, +0x4E, 0x90, 0x98, 0x29, 0xE0, 0xFC, 0x60, 0x47, +0x12, 0xA0, 0xDE, 0x80, 0x05, 0xC3, 0x33, 0xCE, +0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x04, 0xE0, +0xE0, 0xFB, 0xEF, 0x5B, 0x60, 0x0B, 0xE4, 0x90, +0x98, 0x29, 0xF0, 0x90, 0x98, 0x2B, 0x04, 0xF0, +0x22, 0x90, 0x98, 0x26, 0xE0, 0xD3, 0x9C, 0x50, +0x16, 0xED, 0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, +0xE0, 0x07, 0xB1, 0xD7, 0x12, 0x97, 0xAA, 0x80, +0x02, 0x91, 0x26, 0x91, 0xF1, 0xF0, 0x22, 0x90, +0x8A, 0xAF, 0x12, 0x97, 0x5E, 0xB1, 0xE0, 0x22, +0x90, 0x98, 0x1C, 0xE0, 0xFF, 0xE4, 0x22, 0xE4, +0xFD, 0xFF, 0x12, 0x6E, 0x71, 0xE4, 0xFF, 0x22, +0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, +0x98, 0x29, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x88, +0x31, 0xE0, 0xFF, 0x12, 0x97, 0xB2, 0x30, 0xE0, +0x1E, 0xEF, 0x54, 0x7F, 0xF1, 0x2F, 0x30, 0xE1, +0x06, 0xE0, 0x44, 0x02, 0xF0, 0x80, 0x08, 0xE0, +0x54, 0xFD, 0xF0, 0xF1, 0xC1, 0x04, 0xF0, 0x90, +0x88, 0x36, 0xE0, 0x60, 0x02, 0xD1, 0x1B, 0x7F, +0x01, 0xA1, 0x79, 0x90, 0x88, 0x38, 0xE0, 0xFF, +0x90, 0x8A, 0xB9, 0x12, 0xA6, 0x1A, 0x7D, 0x01, +0x02, 0x04, 0x7E, 0x90, 0x99, 0x83, 0xE0, 0xB4, +0x01, 0x20, 0xE4, 0xF0, 0x90, 0x01, 0x5B, 0xF0, +0x90, 0x92, 0x20, 0xF0, 0x90, 0x88, 0x95, 0xE0, +0xC3, 0x13, 0x54, 0x7F, 0x90, 0x92, 0x21, 0xF0, +0xE4, 0xFB, 0xFD, 0x7F, 0x58, 0x7E, 0x01, 0x12, +0x66, 0x33, 0x90, 0x88, 0x31, 0x12, 0xF5, 0x9F, +0x30, 0xE0, 0x19, 0xEF, 0x54, 0xBF, 0xF1, 0x2F, +0x30, 0xE0, 0x06, 0xE0, 0x44, 0x01, 0xF0, 0x80, +0x09, 0xE0, 0x54, 0xFE, 0xF0, 0xF1, 0xC1, 0x74, +0x04, 0xF0, 0xD1, 0x1B, 0xE4, 0xFF, 0xA1, 0x79, +0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, +0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, +0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, +0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, +0x74, 0x78, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, 0x12, +0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE0, 0x03, 0x12, +0xD1, 0x72, 0xE5, 0x3D, 0x30, 0xE1, 0x02, 0xF1, +0x38, 0xE5, 0x3D, 0x30, 0xE2, 0x02, 0xF1, 0x13, +0xE5, 0x3D, 0x30, 0xE3, 0x02, 0x71, 0x9F, 0xE5, +0x3E, 0x30, 0xE0, 0x03, 0x12, 0xC7, 0xEB, 0xE5, +0x40, 0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, +0x97, 0x5E, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, +0x40, 0x30, 0xE4, 0x03, 0x12, 0xB2, 0xEB, 0xE5, +0x40, 0x30, 0xE5, 0x02, 0xD1, 0x2B, 0xE5, 0x40, +0x30, 0xE6, 0x02, 0xB1, 0xEE, 0x74, 0x78, 0x04, +0x90, 0x01, 0xC4, 0xF0, 0x74, 0xBE, 0xA3, 0xF0, +0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, +0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, +0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, +0xD0, 0xE0, 0x32, 0x90, 0x88, 0x36, 0xE0, 0x60, +0x15, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x09, +0x90, 0x8B, 0x01, 0xF1, 0xD2, 0xF9, 0x02, 0x04, +0x7A, 0x12, 0xF5, 0xB6, 0xD1, 0x1B, 0x22, 0xF0, +0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, +0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, 0xF1, 0x41, +0x22, 0x12, 0x89, 0xEE, 0x30, 0xE0, 0x0B, 0xEF, +0xC4, 0x13, 0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, +0xF1, 0xD9, 0x90, 0x88, 0x31, 0xF1, 0xBA, 0x30, +0xE0, 0x0A, 0xEF, 0x12, 0xF5, 0x2D, 0x54, 0x07, +0x70, 0x4C, 0x80, 0x48, 0x90, 0x88, 0x3F, 0xE0, +0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, 0xEF, +0xF0, 0x12, 0xF4, 0xB6, 0x9F, 0x40, 0x35, 0x12, +0xB3, 0x4A, 0x70, 0x32, 0xF1, 0xCB, 0x70, 0x08, +0x90, 0x8A, 0xF5, 0x12, 0x91, 0xBD, 0x80, 0x27, +0x90, 0x8A, 0xF5, 0x12, 0x91, 0xBD, 0x90, 0x88, +0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, 0x02, +0x40, 0x09, 0xF1, 0xAF, 0xE4, 0x90, 0x88, 0x40, +0xF0, 0x80, 0x03, 0x12, 0xF4, 0x29, 0xE4, 0x90, +0x88, 0x3F, 0xF0, 0x22, 0xD1, 0x1B, 0x22, 0x90, +0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, +0x88, 0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, +0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, 0x90, +0x01, 0xB8, 0x22, 0x90, 0x88, 0x34, 0xE0, 0x54, +0x0F, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xAA, 0x06, +0x22, 0x7D, 0x02, 0x7F, 0x02, 0x02, 0x7C, 0x7E, +0x7F, 0x64, 0x7E, 0x00, 0x02, 0x7C, 0x6A, 0xE4, +0x90, 0x86, 0xAF, 0x12, 0xA8, 0x0D, 0x90, 0x93, +0x01, 0xF0, 0x90, 0x98, 0x3E, 0xF0, 0xA3, 0xF0, +0x22, 0xE4, 0xF5, 0x21, 0x90, 0x86, 0xB3, 0xE0, +0xFF, 0xB4, 0x03, 0x05, 0x75, 0x22, 0x08, 0x80, +0x03, 0xE4, 0xF5, 0x22, 0xEF, 0xB4, 0x01, 0x0A, +0x90, 0x00, 0x75, 0xE0, 0x54, 0xFB, 0xF0, 0x75, +0x22, 0x04, 0x75, 0x23, 0x10, 0x75, 0x24, 0x80, +0x90, 0x00, 0x50, 0xE5, 0x21, 0xF0, 0xA3, 0xE5, +0x22, 0xF0, 0xA3, 0xE5, 0x23, 0xF0, 0xA3, 0xE5, +0x24, 0xF0, 0x22, 0x11, 0x41, 0x12, 0x76, 0x6D, +0x12, 0x75, 0xE0, 0x11, 0x82, 0x11, 0x63, 0x80, +0xB8, 0x90, 0x00, 0x08, 0xE0, 0x54, 0xEF, 0xF0, +0x22, 0x12, 0x7B, 0x1B, 0x90, 0x86, 0xB3, 0xEF, +0xF0, 0x11, 0x33, 0x90, 0x01, 0x64, 0x74, 0x01, +0xF0, 0x90, 0x04, 0x23, 0xE0, 0x44, 0x80, 0xF0, +0x02, 0x67, 0xD2, 0x75, 0x39, 0x0F, 0x75, 0x3A, +0x01, 0x75, 0x3B, 0x03, 0x75, 0x3C, 0x62, 0x90, +0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, 0x3A, +0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, 0x3C, +0xF0, 0x22, 0x75, 0x29, 0x10, 0xE4, 0xF5, 0x2A, +0x75, 0x2B, 0x07, 0x75, 0x2C, 0x02, 0xF5, 0x31, +0xF5, 0x32, 0xF5, 0x33, 0xF5, 0x34, 0x90, 0x01, +0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, +0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, 0xF0, +0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, +0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, 0xE5, +0x34, 0xF0, 0x22, 0x90, 0x00, 0x80, 0xE0, 0x44, +0x80, 0xF0, 0x71, 0x8E, 0x12, 0xA7, 0xE5, 0x12, +0x7B, 0x79, 0x71, 0x2D, 0x12, 0xBF, 0xE7, 0x7F, +0x01, 0x12, 0x85, 0x15, 0x90, 0x98, 0x1F, 0x74, +0x02, 0xF0, 0xFF, 0x12, 0x85, 0x15, 0x90, 0x98, +0x1F, 0xE0, 0x04, 0xF0, 0x11, 0x49, 0x12, 0xAE, +0x8F, 0x90, 0x00, 0x80, 0xE0, 0x44, 0x40, 0xF0, +0x75, 0x20, 0xFF, 0x12, 0x7C, 0x97, 0x90, 0x01, +0xA0, 0xE0, 0xB4, 0xFD, 0x05, 0xE4, 0xFF, 0x12, +0x99, 0x5D, 0x31, 0x3E, 0x71, 0x14, 0x90, 0x00, +0x81, 0xE0, 0x44, 0x04, 0xF0, 0x31, 0x8F, 0x12, +0x98, 0xCA, 0x90, 0x00, 0xAA, 0xE0, 0x44, 0x02, +0xF0, 0xA3, 0xE0, 0x44, 0x80, 0xF0, 0x90, 0x99, +0x84, 0xE0, 0x54, 0xFE, 0xF0, 0x90, 0x06, 0x0A, +0xE0, 0x44, 0x10, 0xF0, 0x90, 0x07, 0xDB, 0xE0, +0x44, 0x80, 0xF0, 0x90, 0x06, 0x0D, 0x74, 0xFF, +0xF0, 0xE4, 0xFF, 0x02, 0x85, 0x9E, 0x31, 0x87, +0x31, 0x99, 0xEF, 0x64, 0x01, 0x60, 0x39, 0xC3, +0x90, 0x99, 0x86, 0xE0, 0x94, 0x88, 0x90, 0x99, +0x85, 0xE0, 0x94, 0x13, 0x40, 0x0F, 0x90, 0x01, +0xC1, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x01, 0xC7, +0x74, 0xFD, 0xF0, 0x80, 0x1B, 0x90, 0x99, 0x85, +0x31, 0xA5, 0xD3, 0x90, 0x99, 0x86, 0xE0, 0x94, +0x32, 0x90, 0x99, 0x85, 0xE0, 0x94, 0x00, 0x40, +0xC7, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE3, 0xC0, 0x90, 0x01, 0xC7, 0x74, 0xFE, 0xF0, 0x22, 0xE4, -0x75, 0xF0, 0x01, 0x02, 0x02, 0xE7, 0xE4, 0x90, -0x9C, 0xA5, 0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, -0xE0, 0x20, 0xE1, 0x22, 0xC3, 0x90, 0x9C, 0xA6, -0xE0, 0x94, 0xD0, 0x90, 0x9C, 0xA5, 0xE0, 0x94, -0x07, 0x40, 0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, -0x04, 0xF0, 0x7F, 0x00, 0x22, 0x90, 0x9C, 0xA5, -0x91, 0x6F, 0xF1, 0x5C, 0x80, 0xD7, 0x7F, 0x01, -0x22, 0x90, 0x9C, 0x96, 0xEF, 0xF0, 0xE4, 0xA3, -0xF0, 0xA3, 0xF0, 0x90, 0x01, 0x09, 0xE0, 0x7F, -0x00, 0x30, 0xE7, 0x02, 0x7F, 0x01, 0x90, 0x9C, -0x96, 0xE0, 0x6F, 0x60, 0x34, 0xC3, 0x90, 0x9C, -0x98, 0xE0, 0x94, 0x88, 0x90, 0x9C, 0x97, 0xE0, -0x94, 0x13, 0x40, 0x08, 0x90, 0x01, 0xC0, 0xE0, -0x44, 0x10, 0xF0, 0x22, 0x90, 0x9C, 0x97, 0x91, -0x6F, 0xD1, 0x12, 0xD3, 0x90, 0x9C, 0x98, 0xE0, -0x94, 0x32, 0x90, 0x9C, 0x97, 0xE0, 0x94, 0x00, -0x40, 0xC1, 0x90, 0x01, 0xC6, 0xE0, 0x30, 0xE0, -0xBA, 0x22, 0xE4, 0x90, 0x99, 0xE7, 0xF0, 0x12, -0xF1, 0x93, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, -0x54, 0xEF, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, -0xE4, 0xFF, 0x91, 0xA9, 0x90, 0x93, 0x0C, 0xE0, -0x20, 0xE0, 0x02, 0xA1, 0xFA, 0xF1, 0x55, 0x44, -0x02, 0x12, 0xEF, 0x90, 0xE4, 0x90, 0x99, 0xE8, -0xF0, 0x90, 0x99, 0xE8, 0xE0, 0xFF, 0xC3, 0x94, -0x05, 0x50, 0x2C, 0xF1, 0x63, 0x80, 0x05, 0xC3, -0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, -0x93, 0x0F, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x0F, -0x90, 0x99, 0xE8, 0xF1, 0xAC, 0x90, 0x99, 0xE8, -0xF1, 0xCC, 0x44, 0x40, 0xF0, 0xD1, 0x12, 0x90, -0x99, 0xE8, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x90, -0x07, 0xC7, 0xE4, 0xF0, 0x90, 0x07, 0xC6, 0xF0, -0x90, 0x07, 0xC5, 0x74, 0x77, 0xF0, 0x90, 0x07, -0xC4, 0xE4, 0xF0, 0x90, 0x07, 0xC0, 0x74, 0x38, -0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x12, 0xF3, 0x7F, -0x90, 0x02, 0x26, 0xE0, 0x44, 0x01, 0xF0, 0xE0, -0x90, 0x99, 0xE9, 0xF0, 0x90, 0x99, 0xE9, 0xE0, -0x30, 0xE0, 0x19, 0x90, 0x99, 0xE7, 0xE0, 0x04, -0xF0, 0xF1, 0x5C, 0x90, 0x02, 0x26, 0xE0, 0x90, -0x99, 0xE9, 0xF0, 0x90, 0x99, 0xE7, 0xE0, 0xD3, -0x94, 0xFA, 0x40, 0xE0, 0x90, 0x02, 0x03, 0x74, -0x80, 0xF0, 0x90, 0x04, 0x24, 0xE0, 0x90, 0x99, -0xEA, 0xF0, 0x90, 0x04, 0x22, 0xE0, 0x44, 0x10, -0xF0, 0x90, 0x02, 0x00, 0xE0, 0x90, 0x99, 0xE9, -0xF0, 0x90, 0x02, 0x01, 0xD1, 0x09, 0x90, 0x02, -0x02, 0xD1, 0x09, 0x90, 0x02, 0x14, 0xD1, 0x09, -0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x04, 0x24, 0xF0, -0x90, 0x04, 0x22, 0xE0, 0x54, 0xEF, 0xF0, 0x90, -0x99, 0xEA, 0xE0, 0x90, 0x04, 0x24, 0xF0, 0x90, -0xFD, 0x09, 0x74, 0xFF, 0xF0, 0x90, 0xFD, 0x08, -0xE4, 0xF0, 0xF1, 0x7B, 0xE4, 0xFD, 0x12, 0x76, -0xF7, 0x90, 0x88, 0x32, 0xE0, 0x54, 0xEF, 0xF0, -0x22, 0xE0, 0xFF, 0x90, 0x99, 0xE9, 0xE0, 0x2F, -0xF0, 0x22, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, -0x6A, 0x75, 0x10, 0x14, 0x90, 0x88, 0x32, 0xE0, -0x44, 0x10, 0xF0, 0xF1, 0x7B, 0x7D, 0x01, 0x12, -0x76, 0xF7, 0x90, 0x88, 0x41, 0xE0, 0xFD, 0x7F, -0x93, 0x12, 0x7B, 0x2E, 0x90, 0x88, 0x37, 0xE0, -0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, -0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, 0x01, -0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x0C, 0xE0, -0x30, 0xE0, 0x70, 0x90, 0xFD, 0x09, 0xE4, 0xF0, -0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, 0xE0, -0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x99, 0xE7, 0xF0, -0x90, 0x99, 0xE7, 0xE0, 0xFF, 0xC3, 0x94, 0x05, -0x50, 0x2C, 0xF1, 0x63, 0x80, 0x05, 0xC3, 0x33, -0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, 0x93, -0x0E, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, 0x0F, 0x90, -0x99, 0xE7, 0xF1, 0xAC, 0x90, 0x99, 0xE7, 0xF1, -0xCC, 0x44, 0x20, 0xF0, 0xD1, 0x12, 0x90, 0x99, -0xE7, 0xE0, 0x04, 0xF0, 0x80, 0xCA, 0x7F, 0x92, -0x12, 0x7B, 0x41, 0xEF, 0x54, 0xFE, 0xFD, 0x7F, -0x92, 0x12, 0x7B, 0x2E, 0x7F, 0x92, 0x12, 0x7B, -0x41, 0xEF, 0x44, 0x08, 0xFD, 0x7F, 0x92, 0x12, -0x7B, 0x2E, 0xF1, 0x55, 0x54, 0xFD, 0xFD, 0x7F, -0x02, 0x80, 0x0B, 0x7F, 0x92, 0x12, 0x7B, 0x41, -0xEF, 0x44, 0x01, 0xFD, 0x7F, 0x92, 0x12, 0x7B, -0x2E, 0x7F, 0x08, 0x12, 0x7B, 0x41, 0xEF, 0x44, -0x10, 0xFD, 0x7F, 0x08, 0x12, 0x7B, 0x2E, 0x7F, -0x01, 0x91, 0xA9, 0x90, 0x00, 0x90, 0xE0, 0x44, -0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x90, 0x99, 0x85, 0xF0, 0xA3, 0xF0, 0x22, 0x90, +0x01, 0xE4, 0x74, 0x27, 0xF0, 0xA3, 0xE4, 0xF0, +0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, 0x30, +0xE4, 0x02, 0x7F, 0x01, 0x22, 0xE4, 0x75, 0xF0, +0x01, 0x12, 0x02, 0xE7, 0x7F, 0x14, 0x7E, 0x00, +0x02, 0x7C, 0x6A, 0x75, 0x0D, 0x14, 0x90, 0x88, +0x32, 0xE0, 0x44, 0x10, 0xF0, 0x90, 0x88, 0x41, +0xE0, 0x90, 0x00, 0x93, 0xF0, 0x90, 0x88, 0x37, +0xE0, 0x60, 0x12, 0x90, 0x01, 0x2F, 0xE0, 0x30, +0xE7, 0x05, 0x74, 0x10, 0xF0, 0x80, 0x06, 0x90, +0x01, 0x2F, 0x74, 0x90, 0xF0, 0x90, 0x93, 0x0C, +0xE0, 0x30, 0xE0, 0x60, 0x90, 0xFD, 0x09, 0xE4, +0xF0, 0x90, 0xFD, 0x08, 0xF0, 0x90, 0x0E, 0x4B, +0xE0, 0x54, 0xFC, 0xF0, 0xE4, 0x90, 0x99, 0xE0, +0xF0, 0x90, 0x99, 0xE0, 0xE0, 0xFF, 0xC3, 0x94, +0x05, 0x50, 0x2D, 0x12, 0xA0, 0xDE, 0x80, 0x05, +0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, +0x90, 0x93, 0x0E, 0xE0, 0xFD, 0xEF, 0x5D, 0x60, +0x0F, 0x90, 0x99, 0xE0, 0x71, 0x4D, 0x90, 0x99, +0xE0, 0x71, 0x6D, 0x44, 0x20, 0xF0, 0x31, 0xAC, +0x90, 0x99, 0xE0, 0xE0, 0x04, 0xF0, 0x80, 0xC9, +0x90, 0x00, 0x92, 0xE0, 0x54, 0xFE, 0xF0, 0xE0, +0x44, 0x08, 0xF0, 0x90, 0x00, 0x02, 0xE0, 0x54, +0xFD, 0xF0, 0x80, 0x07, 0x90, 0x00, 0x92, 0xE0, +0x44, 0x01, 0xF0, 0x90, 0x00, 0x08, 0xE0, 0x44, +0x10, 0xF0, 0x7F, 0x01, 0x51, 0xC8, 0x90, 0x00, +0x90, 0xE0, 0x44, 0x01, 0xF0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, @@ -8748,129 +8645,233 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x14, -0x7E, 0x00, 0x02, 0x7C, 0x6A, 0x7F, 0x02, 0x12, -0x7B, 0x41, 0xEF, 0x22, 0x7F, 0x0A, 0x7E, 0x00, -0x02, 0x7C, 0x6A, 0x74, 0x01, 0x7E, 0x00, 0xA8, -0x07, 0x08, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, -0xC0, 0xD0, 0xD1, 0x19, 0x91, 0xFA, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x90, 0x88, 0xA0, 0xE0, 0xC4, -0x13, 0x13, 0x54, 0x01, 0xFF, 0x90, 0x88, 0xE0, -0xE0, 0xFB, 0x90, 0x88, 0xDF, 0xE0, 0x90, 0x92, -0x90, 0xF0, 0x22, 0x90, 0x88, 0x39, 0xE0, 0xFF, -0x60, 0x03, 0xB4, 0x08, 0x0E, 0x12, 0xFA, 0xE0, -0xBF, 0x01, 0x08, 0xF1, 0x6B, 0x90, 0x01, 0xE5, -0xE0, 0x04, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x1A, +0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, +0x00, 0x7F, 0x14, 0x7E, 0x00, 0x02, 0x7C, 0x6A, +0x90, 0x9C, 0x87, 0xEF, 0x12, 0xA7, 0xDE, 0x90, +0x01, 0x09, 0xE0, 0x7F, 0x00, 0x30, 0xE7, 0x02, +0x7F, 0x01, 0x90, 0x9C, 0x87, 0xE0, 0x6F, 0x60, +0x32, 0xC3, 0x90, 0x9C, 0x89, 0xE0, 0x94, 0x88, +0x90, 0x9C, 0x88, 0xE0, 0x94, 0x13, 0x40, 0x08, +0x90, 0x01, 0xC0, 0xE0, 0x44, 0x10, 0xF0, 0x22, +0x90, 0x9C, 0x88, 0x31, 0xA5, 0xD3, 0x90, 0x9C, +0x89, 0xE0, 0x94, 0x32, 0x90, 0x9C, 0x88, 0xE0, +0x94, 0x00, 0x40, 0xC3, 0x90, 0x01, 0xC6, 0xE0, +0x30, 0xE0, 0xBC, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0xE4, 0xFF, 0xEF, 0x12, 0xAE, +0x79, 0xE4, 0xF0, 0x0F, 0xEF, 0xB4, 0x08, 0xF5, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x01, 0x8C, +0xE4, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, +0xA3, 0x74, 0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, +0x54, 0xF0, 0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, +0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, 0xFF, 0x24, +0x1A, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, +0xE0, 0x90, 0x01, 0xB0, 0xF0, 0x74, 0x1F, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -0x90, 0x01, 0xB0, 0xF0, 0x74, 0x1F, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -0x01, 0xB1, 0xF0, 0x22, 0xE0, 0xFF, 0x24, 0x10, +0x90, 0x01, 0xB1, 0xF0, 0x22, 0xE0, 0xFF, 0x24, +0x10, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, +0xE0, 0x90, 0x01, 0xB2, 0xF0, 0x74, 0x15, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, -0x90, 0x01, 0xB2, 0xF0, 0x74, 0x15, 0x2F, 0xF5, -0x82, 0xE4, 0x34, 0x93, 0xF5, 0x83, 0xE0, 0x90, -0x01, 0xB3, 0xF0, 0xE0, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x99, 0xEF, -0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x8A, 0xF9, 0x12, -0x8F, 0x00, 0x7D, 0x44, 0x7F, 0x6F, 0x12, 0x04, -0x7E, 0x12, 0x8E, 0xD9, 0x90, 0x9C, 0x9A, 0xE0, -0x90, 0x9C, 0x99, 0xB4, 0x01, 0x07, 0x11, 0x2F, -0x44, 0x04, 0xF0, 0x80, 0x05, 0x11, 0x2F, 0x54, -0xFB, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8F, 0x00, -0x11, 0x3E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, -0xC4, 0x54, 0xF0, 0x24, 0x05, 0xF5, 0x82, 0xE4, -0x34, 0x81, 0xF5, 0x83, 0xE0, 0x22, 0xE4, 0xFD, -0xFF, 0x02, 0x04, 0x7E, 0x12, 0xF1, 0x4E, 0x90, -0x9A, 0xE0, 0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, -0xE0, 0x13, 0x12, 0x8F, 0x00, 0x7D, 0x01, 0xE4, -0xFF, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, -0x44, 0x04, 0xF0, 0x80, 0x05, 0x12, 0x8F, 0x00, -0x11, 0x3E, 0x90, 0x9A, 0xE0, 0xE0, 0x30, 0xE6, -0x11, 0x90, 0x01, 0x2F, 0xE0, 0x30, 0xE7, 0x04, -0xE4, 0xF0, 0x80, 0x06, 0x90, 0x01, 0x2F, 0x74, -0x80, 0xF0, 0x91, 0xE5, 0x74, 0x02, 0xF0, 0x02, -0x6E, 0x2F, 0x7E, 0x00, 0x7F, 0x62, 0x7D, 0x00, -0x7B, 0x01, 0x7A, 0x88, 0x79, 0x31, 0x12, 0x04, -0x80, 0x12, 0xFD, 0x17, 0x79, 0x08, 0x12, 0x04, -0x80, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, -0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, -0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, -0x74, 0x02, 0x31, 0x7E, 0xFF, 0x31, 0x86, 0x12, -0xFC, 0x03, 0x90, 0x8A, 0x89, 0x12, 0x8F, 0x00, -0x11, 0x3E, 0x90, 0x8A, 0x89, 0x12, 0x8F, 0x00, -0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, -0x8A, 0x89, 0x12, 0x8F, 0x00, 0x7D, 0x0C, 0x7F, -0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, 0xE0, -0xFF, 0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, 0x74, -0xD4, 0xF0, 0x80, 0x11, 0xEF, 0xB4, 0x03, 0x08, -0x90, 0x88, 0x41, 0x74, 0x14, 0xF0, 0x80, 0x05, -0xE4, 0x90, 0x88, 0x41, 0xF0, 0x7F, 0x79, 0x12, -0x7B, 0x41, 0xEF, 0x54, 0x03, 0xFF, 0xBF, 0x02, -0x0F, 0x7F, 0x28, 0x12, 0x7B, 0x41, 0xEF, 0x30, -0xE2, 0x06, 0x90, 0x88, 0x53, 0x74, 0x02, 0xF0, -0x90, 0x88, 0x93, 0x74, 0x03, 0xF0, 0xA3, 0x74, -0x0F, 0xF0, 0xA3, 0xE0, 0x54, 0x01, 0x44, 0x28, -0xF0, 0xA3, 0x74, 0x07, 0x31, 0x7E, 0x31, 0x86, -0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, 0x01, -0x7A, 0x93, 0x79, 0x0C, 0x12, 0x04, 0x80, 0x90, -0x8A, 0xA3, 0x12, 0x8F, 0x00, 0x7F, 0x01, 0x12, -0x04, 0x7E, 0x90, 0x05, 0x58, 0x74, 0x02, 0xF0, -0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, 0x06, -0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, 0x0A, -0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, 0xE4, -0xF0, 0x90, 0x88, 0x9C, 0xF0, 0x22, 0xF0, 0x90, -0x88, 0x53, 0xE0, 0x24, 0x04, 0x22, 0x33, 0x33, -0x33, 0x54, 0xF8, 0x90, 0x88, 0x4E, 0xF0, 0xA3, -0x74, 0x50, 0xF0, 0x22, 0x90, 0x88, 0x85, 0x12, -0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x99, -0x7A, 0xE0, 0x24, 0x46, 0xFF, 0x90, 0x99, 0x79, -0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, 0xE4, 0xF9, -0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, 0x83, 0x0D, -0x90, 0x88, 0x85, 0x12, 0x04, 0x31, 0x90, 0x88, -0x89, 0x12, 0x04, 0xB8, 0xEF, 0x24, 0x46, 0x12, -0xDF, 0xA8, 0x90, 0x88, 0x89, 0x12, 0x04, 0x31, -0x90, 0x88, 0x89, 0x12, 0x04, 0xB8, 0x90, 0x88, -0x85, 0x71, 0xBB, 0x50, 0x02, 0x41, 0x91, 0x90, -0x88, 0x89, 0x12, 0x84, 0x52, 0x90, 0x88, 0x85, -0x12, 0x04, 0xB8, 0x12, 0x83, 0x0D, 0x90, 0x9A, -0xDC, 0x12, 0x04, 0x31, 0x90, 0x88, 0x31, 0xE0, -0x30, 0xE0, 0x2B, 0x31, 0x7F, 0xFF, 0xE4, 0x33, -0xFE, 0xEF, 0x78, 0x03, 0xC3, 0x33, 0xCE, 0x33, -0xCE, 0xD8, 0xF9, 0x24, 0x50, 0xFF, 0xE4, 0x3E, -0xFE, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0xEF, -0x9D, 0xFB, 0xEE, 0x94, 0x00, 0xFA, 0x71, 0xA9, -0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x1E, 0x90, 0x88, -0x33, 0x12, 0xD6, 0x89, 0x30, 0xE0, 0x02, 0x61, -0x8E, 0x71, 0xA9, 0x90, 0x88, 0x4E, 0xE0, 0xFD, -0xC3, 0x74, 0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, -0xCD, 0x2F, 0xFF, 0xED, 0x3E, 0x90, 0x9A, 0xD8, -0xF0, 0xA3, 0xEF, 0xF0, 0xC3, 0x90, 0x9A, 0xD9, -0xE0, 0x94, 0xA0, 0x90, 0x9A, 0xD8, 0xE0, 0x94, -0x00, 0x50, 0x36, 0xA3, 0xE0, 0xFB, 0x24, 0x39, -0x71, 0xA1, 0xE0, 0x04, 0xF0, 0x90, 0x9A, 0xDC, -0x12, 0x04, 0xB8, 0xEF, 0x54, 0x7F, 0xFF, 0x74, -0xD9, 0x2B, 0x71, 0x96, 0xE0, 0xFE, 0xEF, 0xC3, -0x9E, 0x50, 0x09, 0x90, 0x9A, 0xD8, 0xA3, 0xE0, -0x71, 0x94, 0xEF, 0xF0, 0x90, 0x88, 0x4C, 0xE0, -0x04, 0xF0, 0xE0, 0xFD, 0x7F, 0xFE, 0x12, 0x7B, -0x2E, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, +0x90, 0x01, 0xB3, 0xF0, 0xE0, 0x22, 0x90, 0x8A, +0x79, 0x74, 0x87, 0xF0, 0xA3, 0x74, 0x4A, 0xF0, +0x90, 0x8A, 0xE5, 0x74, 0xC5, 0xF0, 0xA3, 0x74, +0x8D, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x90, 0xF0, +0xA3, 0x74, 0xCA, 0xF0, 0x90, 0x8A, 0xB9, 0x74, +0x91, 0xF0, 0xA3, 0x74, 0xC7, 0xF0, 0x90, 0x8A, +0x75, 0x74, 0xB7, 0xF0, 0xA3, 0x74, 0xF9, 0xF0, +0x90, 0x8A, 0xC3, 0x74, 0xD8, 0xF0, 0xA3, 0x74, +0x51, 0xF0, 0x90, 0x8A, 0xF3, 0x74, 0xD9, 0xF0, +0xA3, 0x74, 0x7F, 0xF0, 0x90, 0x8A, 0x85, 0x74, +0xD9, 0xF0, 0xA3, 0x74, 0x8B, 0xF0, 0x90, 0x86, +0x0C, 0x74, 0xC7, 0xF0, 0xA3, 0x74, 0x97, 0xF0, +0x90, 0x8A, 0xEF, 0x74, 0xCF, 0xF0, 0xA3, 0x74, +0xE8, 0xF0, 0x90, 0x86, 0x00, 0x74, 0xF2, 0xF0, +0xA3, 0x74, 0xE0, 0xF0, 0x90, 0x86, 0x02, 0x74, +0xF3, 0xF0, 0xA3, 0x74, 0x2C, 0xF0, 0x90, 0x8A, +0xFD, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0x87, 0xF0, +0x90, 0x8A, 0xF9, 0x74, 0xB0, 0xF0, 0xA3, 0x74, +0x32, 0xF0, 0x90, 0x8A, 0xAF, 0x74, 0xCC, 0xF0, +0xA3, 0x74, 0x72, 0xF0, 0x90, 0x8A, 0xD3, 0x74, +0xD8, 0xF0, 0xA3, 0x74, 0x91, 0xF0, 0x90, 0x8A, +0xF5, 0x74, 0xF4, 0xF0, 0xA3, 0x74, 0x6F, 0xF0, +0x90, 0x8A, 0xA3, 0x74, 0xCA, 0xF0, 0xA3, 0x74, +0x81, 0xF0, 0x90, 0x86, 0x06, 0x74, 0xCB, 0xF0, +0xA3, 0x74, 0x6F, 0xF0, 0x22, 0x7D, 0x02, 0x90, +0x01, 0xC4, 0x74, 0x4D, 0xF0, 0x74, 0xC4, 0xA3, +0xF0, 0x90, 0x98, 0x1F, 0xE0, 0xFF, 0xED, 0xC3, +0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, +0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, +0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, +0x0D, 0x80, 0xDE, 0x74, 0x4D, 0x04, 0x90, 0x01, +0xC4, 0xF0, 0x74, 0xC4, 0xA3, 0xF0, 0x7F, 0x01, +0x22, 0xE4, 0xFB, 0xFA, 0xFD, 0x7F, 0x01, 0x12, +0x86, 0x4E, 0x90, 0x9A, 0x07, 0xEF, 0xF0, 0x60, +0xF0, 0x90, 0x86, 0xAF, 0xE0, 0xFF, 0x70, 0x04, +0xA3, 0xE0, 0x60, 0xE5, 0xC2, 0xAF, 0xEF, 0x30, +0xE1, 0x0D, 0x90, 0x86, 0xAF, 0xE0, 0x54, 0xFD, +0xF0, 0x90, 0x86, 0x08, 0x12, 0x91, 0xBD, 0x91, +0xF7, 0x30, 0xE2, 0x09, 0x54, 0xFB, 0xF0, 0x90, +0x86, 0x0A, 0x12, 0x91, 0xBD, 0x91, 0xF7, 0xFF, +0x30, 0xE4, 0x0B, 0x54, 0xEF, 0xF0, 0xB1, 0x54, +0xBF, 0x01, 0x03, 0x12, 0xA2, 0x84, 0x91, 0xF7, +0xFF, 0x30, 0xE7, 0x06, 0x54, 0x7F, 0xF0, 0x12, +0xAD, 0xDC, 0xD2, 0xAF, 0xC2, 0xAF, 0x90, 0x86, +0xB0, 0xE0, 0xFF, 0x30, 0xE2, 0x05, 0x54, 0xFB, +0xF0, 0xB1, 0x00, 0xD2, 0xAF, 0x80, 0xA2, 0xD2, +0xAF, 0xC2, 0xAF, 0x90, 0x86, 0xAF, 0xE0, 0x22, +0x90, 0x93, 0x2D, 0xE0, 0xC3, 0x13, 0x30, 0xE0, +0x41, 0xB1, 0x4B, 0x90, 0x98, 0x1E, 0xF0, 0x60, +0x0E, 0x12, 0xBC, 0x09, 0xE4, 0x90, 0x92, 0x20, +0xF0, 0xA3, 0x04, 0xF0, 0xE4, 0x80, 0x22, 0x90, +0x93, 0x2D, 0x12, 0xB2, 0xDA, 0x30, 0xE0, 0x0B, +0xA3, 0xE0, 0x90, 0x92, 0x20, 0xF0, 0xE4, 0xA3, +0xF0, 0x80, 0x0E, 0xE4, 0x90, 0x92, 0x20, 0xF0, +0x90, 0x93, 0x2E, 0xE0, 0x90, 0x92, 0x21, 0xF0, +0xE4, 0xFB, 0xFD, 0x7F, 0x5C, 0x7E, 0x01, 0x12, +0x66, 0x33, 0x22, 0x7F, 0x60, 0x12, 0x7B, 0x41, +0xEF, 0x54, 0x01, 0x22, 0xE4, 0x90, 0x9C, 0x95, +0xF0, 0xA3, 0xF0, 0x90, 0x02, 0x86, 0xE0, 0x20, +0xE1, 0x28, 0xC3, 0x90, 0x9C, 0x96, 0xE0, 0x94, +0xD0, 0x90, 0x9C, 0x95, 0xE0, 0x94, 0x07, 0x40, +0x0A, 0x90, 0x01, 0xC1, 0xE0, 0x44, 0x04, 0xF0, +0x7F, 0x00, 0x22, 0x90, 0x9C, 0x95, 0xE4, 0x75, +0xF0, 0x01, 0x12, 0x02, 0xE7, 0x12, 0xBB, 0x98, +0x80, 0xD1, 0x7F, 0x01, 0x22, 0x8F, 0x12, 0x7F, +0x02, 0x12, 0x86, 0x27, 0x90, 0x86, 0xAF, 0xE0, +0x45, 0x12, 0xF0, 0x22, 0x8F, 0x0E, 0x7F, 0x02, +0x12, 0x86, 0x27, 0x90, 0x86, 0xB0, 0xE0, 0x45, +0x0E, 0xF0, 0x22, 0x7F, 0x04, 0x80, 0xED, 0xC0, +0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, +0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, 0xC0, 0x01, +0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, 0xC0, 0x05, +0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, 0xC4, 0x74, +0xAF, 0xF0, 0x74, 0xC5, 0xA3, 0xF0, 0x12, 0x6C, +0xD6, 0xE5, 0x27, 0x30, 0xE4, 0x02, 0xB1, 0xAB, +0x90, 0x86, 0xB3, 0xE0, 0xFC, 0x64, 0x03, 0x70, +0x37, 0x90, 0x99, 0x84, 0xE0, 0xFE, 0x20, 0xE0, +0x2F, 0xE5, 0x26, 0x30, 0xE3, 0x2A, 0x90, 0x00, +0xCC, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0xD4, +0xE0, 0x44, 0x10, 0xF0, 0x90, 0x00, 0xC6, 0xE0, +0x44, 0x02, 0xF0, 0x90, 0x00, 0x01, 0xE0, 0x54, +0xCF, 0xF0, 0x90, 0x00, 0x23, 0xE0, 0x54, 0x7F, +0xF0, 0xEE, 0x44, 0x01, 0x90, 0x99, 0x84, 0xF0, +0xEC, 0xB4, 0x01, 0x0B, 0xE5, 0x26, 0x30, 0xE2, +0x06, 0x90, 0x88, 0x41, 0x74, 0xDD, 0xF0, 0x74, +0xAF, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xC5, +0xA3, 0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, +0xD0, 0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, +0xD0, 0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, +0xD0, 0xF0, 0xD0, 0xE0, 0x32, 0x32, 0xC0, 0xE0, +0xC0, 0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, +0x00, 0xC0, 0x05, 0xC0, 0x07, 0x7D, 0x56, 0x90, +0x01, 0xC4, 0xED, 0xF0, 0x74, 0xC6, 0xFF, 0xA3, +0xF0, 0xED, 0x04, 0x90, 0x01, 0xC4, 0xF0, 0xA3, +0xEF, 0xF0, 0xD0, 0x07, 0xD0, 0x05, 0xD0, 0xD0, +0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xE0, 0x32, 0x90, +0x98, 0x2A, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x39, +0xE0, 0x64, 0x02, 0x60, 0x03, 0x12, 0x88, 0x9E, +0x22, 0xE4, 0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, +0x1A, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x14, 0x12, +0xBF, 0xCB, 0x64, 0x02, 0x60, 0x0A, 0x90, 0x8A, +0xE1, 0x12, 0xBF, 0xD2, 0xF9, 0x02, 0x04, 0x7A, +0x12, 0x73, 0x8F, 0x22, 0xE4, 0xFF, 0x12, 0x78, +0x4A, 0xBF, 0x01, 0x10, 0x90, 0x88, 0x36, 0xE0, +0x60, 0x0A, 0xD1, 0xD5, 0xF0, 0x54, 0x07, 0x70, +0x03, 0x12, 0xBE, 0x1B, 0x22, 0x90, 0x88, 0x3A, +0xE0, 0x54, 0xFE, 0x22, 0xE4, 0xF5, 0x0F, 0x90, +0x06, 0xA9, 0xE0, 0xF5, 0x0F, 0x54, 0xC0, 0x70, +0x13, 0xD1, 0xD5, 0xF0, 0x54, 0xFD, 0xF0, 0x12, +0xBE, 0x1B, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x4C, +0xF1, 0x45, 0xF0, 0x22, 0xE5, 0x0F, 0x30, 0xE6, +0x23, 0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, +0x1E, 0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, +0x12, 0xBF, 0xCB, 0x64, 0x02, 0x60, 0x08, 0x90, +0x8A, 0xE1, 0x12, 0x91, 0xBD, 0x80, 0x08, 0x12, +0xF4, 0x29, 0x80, 0x03, 0xD1, 0xD5, 0xF0, 0xE5, +0x0F, 0x90, 0x88, 0x3A, 0x30, 0xE7, 0x11, 0xE0, +0x44, 0x02, 0x12, 0xB3, 0x6C, 0x12, 0x66, 0x33, +0x90, 0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, +0xE0, 0x54, 0xFD, 0xF0, 0x22, 0x90, 0x00, 0x02, +0xE0, 0x44, 0x01, 0x22, 0x90, 0x88, 0x39, 0xE0, +0xB4, 0x04, 0x03, 0xF1, 0x45, 0xF0, 0x90, 0x88, +0x36, 0xE0, 0x64, 0x01, 0x70, 0x2F, 0x12, 0xBF, +0xCB, 0x60, 0x17, 0x90, 0x8A, 0xB9, 0x12, 0x97, +0x5E, 0xE4, 0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, +0x90, 0x8B, 0x01, 0x12, 0xBF, 0xD2, 0xF9, 0x02, +0x04, 0x7A, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x0D, +0x90, 0x8A, 0xB9, 0x12, 0x97, 0x5E, 0x7D, 0x01, +0x7F, 0x04, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x88, +0x36, 0xE0, 0x60, 0x02, 0xF1, 0x4C, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, 0xD0, +0x6A, 0xFD, 0xEC, 0x90, 0x9C, 0x6D, 0x12, 0x04, +0x31, 0x90, 0x9C, 0x6D, 0xF1, 0xE2, 0x7F, 0x30, +0x7E, 0x08, 0x12, 0x70, 0xAD, 0x90, 0x01, 0x01, +0xE0, 0x44, 0x02, 0xF1, 0xDA, 0x90, 0x06, 0xB7, +0x74, 0x09, 0xF0, 0x90, 0x06, 0xB4, 0x74, 0x86, +0xF0, 0x12, 0xD0, 0x75, 0xF0, 0xE4, 0xFD, 0x12, +0x76, 0xF7, 0xF1, 0x45, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xF0, 0x90, 0x01, 0x00, 0x74, 0xFF, +0xF0, 0x22, 0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, +0x02, 0x04, 0x31, 0x12, 0xD7, 0xE9, 0x90, 0x9A, +0xD8, 0xEF, 0xF0, 0x90, 0x8A, 0x89, 0x30, 0xE0, +0x13, 0x12, 0x97, 0x5E, 0x7D, 0x01, 0xE4, 0xFF, +0x12, 0x04, 0x7E, 0x90, 0x88, 0x33, 0xE0, 0x44, +0x04, 0xF0, 0x80, 0x09, 0x12, 0x97, 0x5E, 0xE4, +0xFD, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x9A, 0xD8, +0xE0, 0x30, 0xE6, 0x11, 0x90, 0x01, 0x2F, 0xE0, +0x30, 0xE7, 0x04, 0xE4, 0xF0, 0x80, 0x06, 0x90, +0x01, 0x2F, 0x74, 0x80, 0xF0, 0x11, 0x35, 0x74, +0x02, 0xF0, 0x02, 0x6E, 0x2F, 0x90, 0x88, 0x48, +0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, +0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0x90, 0x88, +0x85, 0x12, 0x04, 0xB8, 0xC0, 0x06, 0xC0, 0x07, +0x90, 0x99, 0x82, 0xE0, 0x24, 0x46, 0xFF, 0x90, +0x99, 0x81, 0xE0, 0x34, 0x00, 0xAB, 0x07, 0xFA, +0xE4, 0xF9, 0xF8, 0xD0, 0x07, 0xD0, 0x06, 0x12, +0x80, 0xCD, 0x90, 0x88, 0x85, 0x51, 0x5F, 0xEF, +0x24, 0x46, 0x51, 0xAD, 0x90, 0x88, 0x89, 0x51, +0x5F, 0x90, 0x88, 0x85, 0x12, 0x82, 0x12, 0xC3, +0x12, 0x03, 0xDA, 0x50, 0x02, 0x21, 0x41, 0x90, +0x88, 0x89, 0x12, 0x82, 0x12, 0x90, 0x88, 0x85, +0x12, 0x04, 0xB8, 0x12, 0x80, 0xCD, 0x90, 0x9A, +0xD4, 0x12, 0x04, 0x31, 0x90, 0x88, 0x31, 0xE0, +0x30, 0xE0, 0x34, 0x90, 0x88, 0x53, 0xE0, 0x24, +0x04, 0xFF, 0xE4, 0x33, 0xFE, 0xEF, 0x78, 0x03, +0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0x24, +0x50, 0xFF, 0xE4, 0x3E, 0xFE, 0x90, 0x88, 0x4E, +0xE0, 0xFD, 0xC3, 0xEF, 0x9D, 0xFB, 0xEE, 0x94, +0x00, 0xFA, 0x51, 0x4E, 0x78, 0x07, 0x12, 0x03, +0xEB, 0xEB, 0x2F, 0xFF, 0xEA, 0x80, 0x23, 0x90, +0x88, 0x33, 0x12, 0xBF, 0xBA, 0x30, 0xE0, 0x02, +0x41, 0x3E, 0x51, 0x4E, 0x78, 0x07, 0x12, 0x03, +0xEB, 0x90, 0x88, 0x4E, 0xE0, 0xFD, 0xC3, 0x74, +0x60, 0x9D, 0xCD, 0xE4, 0x94, 0x00, 0xCD, 0x2F, +0xFF, 0xED, 0x3E, 0x90, 0x9A, 0xD0, 0xF0, 0xA3, +0xEF, 0xF0, 0xC3, 0x90, 0x9A, 0xD1, 0xE0, 0x94, +0xA0, 0x90, 0x9A, 0xD0, 0xE0, 0x94, 0x00, 0x50, +0x30, 0xA3, 0xE0, 0xFB, 0x24, 0x41, 0x51, 0x57, +0xE0, 0x04, 0xF0, 0x51, 0x4E, 0xEF, 0x54, 0x7F, +0xFF, 0x74, 0xE1, 0x2B, 0x51, 0x46, 0xE0, 0xFE, +0xEF, 0xC3, 0x9E, 0x50, 0x09, 0x90, 0x9A, 0xD0, +0xA3, 0xE0, 0x51, 0x44, 0xEF, 0xF0, 0x90, 0x88, +0x4C, 0xE0, 0x04, 0xF0, 0xE0, 0x90, 0x00, 0xFE, +0xF0, 0x90, 0x88, 0x4C, 0xE0, 0xFF, 0xD3, 0x90, 0x88, 0x90, 0xE0, 0x9F, 0x90, 0x88, 0x8F, 0xE0, -0x94, 0x00, 0x40, 0x02, 0x61, 0x8E, 0xE4, 0xFF, -0xFE, 0x71, 0x9E, 0xE0, 0x2F, 0xFF, 0x90, 0x88, +0x94, 0x00, 0x40, 0x02, 0x41, 0x3E, 0xE4, 0xFF, +0xFE, 0x51, 0x54, 0xE0, 0x2F, 0xFF, 0x90, 0x88, 0x91, 0xE0, 0xFD, 0xEF, 0xD3, 0x9D, 0x40, 0x07, -0x90, 0x9A, 0xDA, 0xEE, 0xF0, 0x80, 0x05, 0x0E, -0xEE, 0xB4, 0xA0, 0xE5, 0x91, 0xCC, 0x40, 0x02, -0x80, 0x15, 0x90, 0x9A, 0xDA, 0xE0, 0x04, 0xFE, -0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, 0x71, 0x9E, -0xE0, 0x2F, 0xFF, 0x91, 0xCC, 0x40, 0x07, 0x90, -0x9A, 0xDB, 0xEE, 0xF0, 0x80, 0x03, 0x0E, 0x80, -0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x71, 0x8F, +0x90, 0x9A, 0xD2, 0xEE, 0xF0, 0x80, 0x05, 0x0E, +0xEE, 0xB4, 0xA0, 0xE5, 0x51, 0x68, 0x40, 0x02, +0x80, 0x15, 0x90, 0x9A, 0xD2, 0xE0, 0x04, 0xFE, +0xEE, 0xC3, 0x94, 0xA0, 0x50, 0x13, 0x51, 0x54, +0xE0, 0x2F, 0xFF, 0x51, 0x68, 0x40, 0x07, 0x90, +0x9A, 0xD3, 0xEE, 0xF0, 0x80, 0x03, 0x0E, 0x80, +0xE7, 0x90, 0x05, 0x5E, 0xE0, 0xFF, 0x51, 0x3F, 0xE0, 0xFD, 0xEF, 0xC3, 0x9D, 0x40, 0x11, 0xEF, 0x9D, 0x90, 0x05, 0x5E, 0xF0, 0x90, 0x88, 0x51, -0xEE, 0xF0, 0x90, 0x9A, 0xDB, 0xE0, 0x80, 0x18, -0x71, 0x8F, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, +0xEE, 0xF0, 0x90, 0x9A, 0xD3, 0xE0, 0x80, 0x18, +0x51, 0x3F, 0xE0, 0xFD, 0xC3, 0x74, 0x80, 0x9D, 0x2F, 0x90, 0x05, 0x5E, 0xF0, 0xEE, 0x04, 0x90, -0x88, 0x51, 0xF0, 0x90, 0x9A, 0xDB, 0xE0, 0x04, +0x88, 0x51, 0xF0, 0x90, 0x9A, 0xD3, 0xE0, 0x04, 0x90, 0x88, 0x52, 0xF0, 0x90, 0x88, 0x51, 0xE0, 0xFF, 0xC3, 0x94, 0x50, 0x40, 0x0A, 0xEF, 0x24, 0xB0, 0x90, 0x88, 0x49, 0xF0, 0xE4, 0x80, 0x0E, @@ -8882,1632 +8883,1406 @@ u8 array_mp_8723d_fw_wowlan[] = { 0x08, 0xFF, 0x90, 0x88, 0x4F, 0xE0, 0x2F, 0xF0, 0x90, 0x88, 0x4F, 0xE0, 0xC3, 0x94, 0x50, 0x50, 0x03, 0x74, 0x50, 0xF0, 0x90, 0x88, 0x4F, 0xE0, -0x24, 0x10, 0xF0, 0x91, 0xE5, 0x74, 0x03, 0xF0, -0x12, 0x6E, 0x2F, 0x90, 0x8A, 0xA3, 0x12, 0x8F, -0x00, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, -0x9A, 0xDA, 0xE0, 0xFE, 0x24, 0xD9, 0xF5, 0x82, -0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0x74, 0x39, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, -0x22, 0x90, 0x9A, 0xDC, 0x12, 0x04, 0xB8, 0x78, -0x07, 0x02, 0x03, 0xEB, 0x7E, 0x02, 0xFD, 0xFC, -0x90, 0x9C, 0x77, 0x12, 0x84, 0x52, 0xC3, 0x02, -0x03, 0xDA, 0x90, 0x9C, 0x76, 0xEF, 0xF0, 0x90, -0x88, 0xE0, 0xE0, 0x70, 0x51, 0x7F, 0x48, 0x7E, -0x09, 0x12, 0x70, 0x70, 0xEE, 0x54, 0x0F, 0xFE, -0xE4, 0xFD, 0xFC, 0x90, 0x9C, 0x77, 0x12, 0x04, -0x31, 0xE4, 0x7F, 0x80, 0x71, 0xB4, 0x70, 0x05, -0x90, 0x88, 0xBE, 0x80, 0x1B, 0xE4, 0xFF, 0xFE, -0x71, 0xB6, 0x70, 0x0A, 0x90, 0x88, 0xBE, 0x04, -0xF0, 0xE4, 0xA3, 0xF0, 0x80, 0x56, 0xE4, 0xFF, -0x71, 0xB4, 0x70, 0x09, 0x90, 0x88, 0xBE, 0x04, -0xF0, 0xA3, 0xF0, 0x80, 0x47, 0xE4, 0x7F, 0x80, -0xFE, 0x71, 0xB6, 0x70, 0x3F, 0x90, 0x88, 0xBE, -0xF0, 0xA3, 0x04, 0xF0, 0x80, 0x36, 0x7F, 0x2C, -0x7E, 0x09, 0x12, 0x70, 0x70, 0xEF, 0x54, 0x02, -0x91, 0xB6, 0x60, 0x08, 0x90, 0x88, 0xBE, 0x74, -0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x88, 0xBE, -0xF0, 0x7F, 0x30, 0x7E, 0x09, 0x12, 0x70, 0x70, -0xEF, 0x54, 0x01, 0x91, 0xB6, 0x60, 0x07, 0xE4, -0x90, 0x88, 0xBF, 0xF0, 0x80, 0x06, 0x90, 0x88, -0xBF, 0x74, 0x01, 0xF0, 0x90, 0x88, 0xB8, 0xE0, -0x44, 0x01, 0xF0, 0x90, 0x8A, 0xF9, 0x12, 0x8F, -0x00, 0x7D, 0x11, 0x7F, 0xFF, 0x12, 0x04, 0x7E, -0x90, 0x8A, 0xEF, 0x12, 0x8E, 0xDC, 0x90, 0x07, -0x78, 0xE0, 0x90, 0x88, 0xBD, 0xF0, 0x90, 0x88, -0xDF, 0xE0, 0xFF, 0x90, 0x8A, 0xF3, 0x12, 0x93, -0xD5, 0x90, 0x9C, 0x76, 0xE0, 0xFD, 0x70, 0x02, -0x80, 0x24, 0xED, 0xB4, 0x01, 0x0A, 0x90, 0x88, -0xB8, 0xE0, 0x54, 0x1F, 0x44, 0x20, 0xF0, 0x22, -0x90, 0x9C, 0x76, 0xE0, 0xFD, 0xB4, 0x02, 0x0A, -0x90, 0x88, 0xB8, 0xE0, 0x54, 0x1F, 0x44, 0x60, -0xF0, 0x22, 0xED, 0xB4, 0x03, 0x07, 0x90, 0x88, -0xB8, 0xE0, 0x54, 0x1F, 0xF0, 0x22, 0xFF, 0xE4, -0xFE, 0xFD, 0xFC, 0x90, 0x9C, 0x77, 0x12, 0x04, -0x31, 0x90, 0x9C, 0x77, 0x12, 0x04, 0xB8, 0xEC, -0x4D, 0x4E, 0x4F, 0x22, 0x90, 0x88, 0x91, 0xE0, -0xFD, 0xC3, 0x90, 0x88, 0x90, 0xE0, 0x9D, 0xFD, -0x90, 0x88, 0x8F, 0xE0, 0x94, 0x00, 0xFC, 0xEF, -0xD3, 0x9D, 0xE4, 0x9C, 0x22, 0x90, 0x88, 0x48, -0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x88, 0x4F, -0xE0, 0xFB, 0x90, 0x92, 0x98, 0x22, 0xE4, 0xFE, -0x71, 0x9E, 0xE4, 0xF0, 0x74, 0xD9, 0x2E, 0x71, -0x96, 0x74, 0xFF, 0xF0, 0x0E, 0xEE, 0xB4, 0xA0, -0xEF, 0xE4, 0x90, 0x88, 0x4D, 0xF0, 0x90, 0x88, -0x4C, 0xF0, 0x90, 0x88, 0x50, 0xF0, 0xEF, 0xB4, -0x01, 0x07, 0xA3, 0x74, 0xA0, 0xF0, 0xE4, 0xA3, -0xF0, 0x22, 0x90, 0x93, 0x04, 0x12, 0x91, 0xE0, -0x30, 0xE0, 0x34, 0xEF, 0xC4, 0x54, 0x0F, 0x20, -0xE0, 0x28, 0x90, 0x95, 0xC1, 0x91, 0xC4, 0x60, -0x0C, 0x12, 0xFD, 0x0D, 0x40, 0x07, 0xB1, 0x6E, -0x90, 0x95, 0xC5, 0x80, 0x05, 0xB1, 0x6E, 0x90, -0x95, 0xBD, 0x12, 0x84, 0x52, 0x12, 0x83, 0x1B, -0x90, 0x9C, 0x65, 0x12, 0x04, 0x31, 0xB1, 0x76, -0x80, 0x05, 0x7F, 0x01, 0x12, 0x8F, 0xF6, 0x90, -0x93, 0x04, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x05, -0x7F, 0x01, 0x12, 0x8F, 0xF6, 0x22, 0xE4, 0x7F, -0xE8, 0x7E, 0x03, 0xFD, 0xFC, 0x22, 0xE4, 0x90, -0x9C, 0x69, 0xF0, 0x7F, 0x03, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x64, 0xEF, -0xF0, 0x12, 0xB5, 0xED, 0x90, 0x9C, 0x64, 0xE0, -0xFF, 0xF1, 0x95, 0x74, 0x01, 0xF0, 0x90, 0x9C, -0x69, 0xE0, 0xFE, 0xEF, 0xF1, 0xA3, 0xEE, 0xF0, -0x90, 0x9C, 0x64, 0xE0, 0xB1, 0xE3, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, 0x65, -0x12, 0xE6, 0xB5, 0xAB, 0x07, 0x90, 0x9C, 0x65, -0x12, 0x04, 0xB8, 0x78, 0x08, 0x12, 0x03, 0xEB, -0x90, 0x92, 0x20, 0xEF, 0xF0, 0x90, 0x9C, 0x65, -0x12, 0x04, 0xB8, 0x90, 0x92, 0x21, 0xEF, 0xF0, -0x7D, 0x01, 0x7F, 0x50, 0x7E, 0x01, 0x12, 0x66, -0x33, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, -0x0F, 0xE0, 0xFB, 0x75, 0xF0, 0x0A, 0xA4, 0x24, -0x67, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, -0x22, 0xE4, 0x90, 0x9A, 0x0F, 0xF0, 0x90, 0x9A, -0x0F, 0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x40, 0x02, -0xC1, 0x86, 0xEF, 0xF1, 0x95, 0xE0, 0x64, 0x01, -0x70, 0x74, 0x90, 0x9A, 0x0F, 0xE0, 0xB1, 0xE3, -0x12, 0x04, 0xB8, 0xE4, 0x7B, 0x01, 0xD1, 0x87, -0x70, 0x3A, 0x90, 0x9A, 0x0F, 0xE0, 0xFB, 0xF1, -0xA3, 0xE0, 0x60, 0x21, 0x14, 0x70, 0x57, 0xEB, -0x75, 0xF0, 0x0A, 0xA4, 0x24, 0x6B, 0xF5, 0x82, -0xE4, 0x34, 0x9B, 0xF5, 0x83, 0x12, 0x04, 0xB8, -0xEB, 0xB1, 0xE3, 0x12, 0x04, 0x31, 0x90, 0x9A, -0x0F, 0xE0, 0xFF, 0x80, 0x0B, 0xB1, 0xDE, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0xAF, 0x03, -0xF1, 0xB1, 0x80, 0x2A, 0x90, 0x9A, 0x0F, 0xE0, -0xB1, 0xE3, 0x12, 0x04, 0xB8, 0xE4, 0xFB, 0xD1, -0x87, 0x50, 0x1B, 0xB1, 0xDE, 0x12, 0x04, 0xB8, -0xEF, 0x24, 0xFF, 0xFF, 0xEE, 0x34, 0xFF, 0xFE, -0xED, 0x34, 0xFF, 0xFD, 0xEC, 0x34, 0xFF, 0xFC, -0xEB, 0xB1, 0xE3, 0x12, 0x04, 0x31, 0x90, 0x9A, -0x0F, 0xE0, 0x04, 0xF0, 0xA1, 0xF6, 0x22, 0xFA, -0xF9, 0xF8, 0xC3, 0x02, 0x03, 0xDA, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xFA, -0xE0, 0xFF, 0x12, 0xF9, 0x64, 0xEF, 0x70, 0x02, -0xE1, 0x48, 0x90, 0x9A, 0xFB, 0xE0, 0xFB, 0xD3, -0x94, 0x00, 0x40, 0x19, 0x90, 0x9C, 0x05, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x0F, 0xAF, 0x03, -0xE4, 0xFC, 0xFD, 0xFE, 0xF1, 0xDA, 0x7F, 0x08, -0x7E, 0x0E, 0x12, 0xDA, 0xAD, 0x90, 0x9A, 0xFA, -0xE0, 0xFF, 0x90, 0x06, 0x33, 0xF0, 0xF1, 0xE0, -0xE4, 0xFB, 0xFD, 0x12, 0xDD, 0x54, 0x90, 0x9A, -0xFD, 0xE0, 0x60, 0x08, 0x90, 0x93, 0x05, 0xE0, -0xFF, 0x12, 0xF9, 0x8F, 0xF1, 0xBF, 0x30, 0xE0, -0x3A, 0x90, 0x95, 0xBA, 0xE0, 0x60, 0x34, 0xE4, -0x90, 0x9A, 0x11, 0xF0, 0x90, 0x95, 0xBA, 0xE0, -0xFF, 0x90, 0x9A, 0x11, 0xE0, 0xC3, 0x9F, 0x50, -0x22, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7A, 0xAE, -0x90, 0x9A, 0x11, 0xE0, 0x24, 0xF9, 0xF1, 0xC7, -0xE0, 0xFF, 0x12, 0xF9, 0x8F, 0x90, 0x01, 0xA6, -0xE0, 0x04, 0xF0, 0x90, 0x9A, 0x11, 0xE0, 0x04, -0xF0, 0x80, 0xD1, 0x90, 0x9A, 0xFC, 0xE0, 0x90, -0x9A, 0x10, 0xF0, 0x90, 0x9A, 0xE7, 0xE0, 0x04, -0xF0, 0xE0, 0xFF, 0x12, 0xF9, 0x2E, 0x90, 0x9A, -0x10, 0x12, 0xA3, 0xF5, 0x90, 0x9C, 0x65, 0x12, -0x04, 0x31, 0xF1, 0xCF, 0xB1, 0x7D, 0x80, 0x48, -0xE4, 0x90, 0x9A, 0xE7, 0xF0, 0x90, 0x9B, 0x66, -0xF0, 0x90, 0x06, 0x32, 0xE0, 0x54, 0xFB, 0xF0, -0x12, 0xDC, 0xDC, 0xE4, 0xFF, 0x12, 0x78, 0x4A, -0xBF, 0x01, 0x13, 0x90, 0x9A, 0xFF, 0xE0, 0xFD, -0x90, 0x8A, 0x89, 0x12, 0x8F, 0x00, 0x7F, 0x02, -0x12, 0x04, 0x7E, 0x12, 0x7B, 0xAD, 0x90, 0x9A, -0x12, 0x74, 0x07, 0xF0, 0x90, 0x9A, 0x34, 0xF0, -0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x12, 0x12, 0x8E, -0xEE, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xB1, 0x22, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x75, 0xF0, 0x0A, -0xA4, 0x24, 0x70, 0xF5, 0x82, 0xE4, 0x34, 0x9B, -0xF5, 0x83, 0x22, 0x75, 0xF0, 0x0A, 0xA4, 0x24, -0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x9B, 0xF5, 0x83, -0x22, 0xEF, 0x24, 0xFC, 0x60, 0x06, 0x04, 0x70, -0x05, 0x02, 0xDE, 0x53, 0xD1, 0x8E, 0x22, 0x90, -0x93, 0x24, 0xE0, 0xC4, 0x54, 0x0F, 0x22, 0xF5, -0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0x22, 0xE4, -0x90, 0x9C, 0x69, 0xF0, 0x7F, 0x04, 0x22, 0x12, -0x03, 0xFE, 0x90, 0x9C, 0x09, 0x02, 0x04, 0x31, -0x90, 0x9A, 0xF2, 0xE0, 0x90, 0x9C, 0x83, 0xF0, -0x22, 0xE4, 0xFD, 0x02, 0xC7, 0xED, 0xE4, 0xFD, -0xFF, 0x12, 0x6E, 0x71, 0xE4, 0xFF, 0x7D, 0x01, -0x02, 0xC7, 0xED, 0xEF, 0xB4, 0xFF, 0x06, 0x90, -0x98, 0x36, 0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, -0x90, 0x98, 0x36, 0xE0, 0x5E, 0xFE, 0xED, 0x5F, -0x4E, 0xF0, 0x22, 0xEF, 0xB4, 0xFF, 0x06, 0x90, -0x98, 0x37, 0xED, 0xF0, 0x22, 0xEF, 0xF4, 0xFE, -0x90, 0x98, 0x37, 0x80, 0xE6, 0x90, 0x99, 0x88, -0xED, 0xF0, 0x64, 0x01, 0x60, 0x26, 0xE0, 0xFE, -0x64, 0x02, 0x60, 0x20, 0xEE, 0x64, 0x29, 0x60, -0x1B, 0xEE, 0x64, 0x2A, 0x60, 0x16, 0xEE, 0x64, -0x36, 0x60, 0x11, 0xEE, 0xB4, 0x37, 0x02, 0x80, -0x0B, 0xAD, 0x07, 0x7F, 0xFF, 0x11, 0x13, 0x90, -0x98, 0x37, 0xE0, 0xFF, 0x90, 0x98, 0x36, 0xE0, -0x4F, 0x90, 0x05, 0x22, 0xF0, 0x90, 0x99, 0x88, -0xE0, 0x90, 0x93, 0x01, 0xF0, 0x22, 0x12, 0x02, -0x06, 0x64, 0x01, 0x60, 0x02, 0x01, 0xF9, 0x90, -0x99, 0xD3, 0xF0, 0x90, 0x99, 0xD3, 0xE0, 0xFF, -0xC3, 0x94, 0x10, 0x50, 0x29, 0xEF, 0x11, 0xFA, -0x7B, 0x01, 0x7A, 0x99, 0x79, 0xD2, 0x12, 0x5F, -0xA6, 0xBF, 0x01, 0x12, 0x90, 0x99, 0xD2, 0xE0, -0xFF, 0xA3, 0xE0, 0x24, 0xD4, 0xF5, 0x82, 0xE4, -0x34, 0x99, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x99, -0xD3, 0xE0, 0x04, 0xF0, 0x80, 0xCD, 0x75, 0x45, -0x01, 0x75, 0x46, 0x99, 0x75, 0x47, 0xD4, 0x75, -0x48, 0x08, 0x7B, 0x01, 0x7A, 0x99, 0x79, 0x8E, -0x12, 0xA7, 0xAE, 0x74, 0x24, 0xF0, 0x90, 0x99, -0xAE, 0x74, 0x08, 0xF0, 0x75, 0x45, 0x01, 0x75, -0x46, 0x99, 0x75, 0x47, 0xDC, 0xF5, 0x48, 0x7B, -0x01, 0x7A, 0x99, 0x79, 0xB1, 0x12, 0x69, 0xF5, -0x90, 0x99, 0xAF, 0x74, 0x25, 0xF0, 0x90, 0x99, -0xD1, 0x74, 0x08, 0x12, 0x98, 0xC0, 0x51, 0x3A, -0x12, 0x04, 0x7E, 0x7B, 0x01, 0x7A, 0x99, 0x79, -0xAF, 0x12, 0x8E, 0xEE, 0x7F, 0x04, 0x12, 0x04, -0x7E, 0x22, 0x24, 0xA8, 0xFF, 0xE4, 0x34, 0x01, -0xFE, 0x22, 0x12, 0xA7, 0xDE, 0x12, 0x02, 0x06, -0x64, 0x01, 0x60, 0x02, 0x21, 0x97, 0xEF, 0x24, -0x39, 0x60, 0x12, 0x14, 0x60, 0x19, 0x24, 0x02, -0x70, 0x1F, 0xE4, 0x90, 0x99, 0x92, 0xF0, 0xA3, -0x74, 0x06, 0xF0, 0x80, 0x14, 0x90, 0x99, 0x92, -0x74, 0x06, 0xF0, 0xA3, 0xF0, 0x80, 0x0A, 0x90, -0x99, 0x92, 0x74, 0x0C, 0xF0, 0xA3, 0x74, 0x04, -0xF0, 0x31, 0xAB, 0xF0, 0x31, 0x98, 0x40, 0x1D, -0x90, 0x99, 0x90, 0xE0, 0x11, 0xFA, 0x7B, 0x01, -0x7A, 0x99, 0x79, 0x8F, 0x12, 0x5F, 0xA6, 0xBF, -0x01, 0x07, 0x90, 0x99, 0x8F, 0xE0, 0xF4, 0x70, -0x3E, 0x31, 0xA0, 0x80, 0xDF, 0x31, 0xAB, 0xF0, -0x31, 0x98, 0x40, 0x33, 0x90, 0x99, 0x90, 0xE0, -0xFD, 0x7C, 0x00, 0x24, 0xA8, 0xFF, 0xEC, 0x34, -0x01, 0xFE, 0xED, 0x24, 0x01, 0xFD, 0xEC, 0x33, -0xFC, 0x90, 0x99, 0x92, 0xE0, 0xFB, 0xC3, 0xED, -0x9B, 0xFD, 0xEC, 0x94, 0x00, 0xFC, 0x12, 0x8C, -0x04, 0x8D, 0x82, 0x8C, 0x83, 0x12, 0x02, 0x1F, -0xFD, 0x31, 0xBB, 0x31, 0xA0, 0x80, 0xC9, 0x22, -0x90, 0x99, 0x91, 0xE0, 0xD3, 0x94, 0x00, 0x22, -0x90, 0x99, 0x90, 0xE0, 0x04, 0xF0, 0xA3, 0xE0, -0x14, 0xF0, 0x22, 0x90, 0x99, 0x92, 0xE0, 0x90, -0x99, 0x90, 0xF0, 0x90, 0x99, 0x93, 0xE0, 0x90, -0x99, 0x91, 0x22, 0x8E, 0x0D, 0x8F, 0x0E, 0x8D, -0x0F, 0xE4, 0x90, 0x99, 0x94, 0xF0, 0x90, 0x00, -0x37, 0xE0, 0x44, 0x80, 0xFD, 0x7F, 0x37, 0x12, -0x7B, 0x2E, 0x7D, 0x69, 0x7F, 0xCF, 0x12, 0x7B, -0x2E, 0xE5, 0x0E, 0xFD, 0x7F, 0x31, 0x12, 0x7B, -0x2E, 0xE5, 0x0D, 0x54, 0x03, 0xFF, 0x90, 0x00, -0x32, 0xE0, 0x54, 0xFC, 0x4F, 0xFD, 0x7F, 0x32, -0x12, 0x7B, 0x2E, 0xAD, 0x0F, 0x7F, 0x30, 0x12, -0x7B, 0x2E, 0x90, 0x00, 0x33, 0xE0, 0x44, 0x80, -0xFD, 0x7F, 0x33, 0x12, 0x7B, 0x2E, 0x90, 0x00, -0x33, 0xE0, 0x30, 0xE7, 0x09, 0x51, 0x32, 0x50, -0x05, 0xE0, 0x04, 0xF0, 0x80, 0xF0, 0xE4, 0xFD, -0x7F, 0xCF, 0x12, 0x7B, 0x2E, 0x90, 0x00, 0x37, -0xE0, 0x54, 0x7F, 0xFD, 0x7F, 0x37, 0x12, 0x7B, -0x2E, 0x51, 0x32, 0x7F, 0x00, 0x50, 0x02, 0x7F, -0x01, 0x22, 0x90, 0x99, 0x94, 0xE0, 0xC3, 0x94, -0x64, 0x22, 0x90, 0x8A, 0x77, 0xE0, 0xFE, 0xA3, -0xE0, 0xFF, 0xF5, 0x82, 0x8E, 0x83, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, -0x33, 0xE0, 0xC3, 0x13, 0x30, 0xE0, 0x27, 0x90, -0x9B, 0xB7, 0x74, 0x1E, 0xF0, 0x90, 0x9B, 0xD9, -0x74, 0x01, 0xF0, 0x90, 0x9B, 0xB9, 0xEF, 0xF0, -0x7B, 0x01, 0x7A, 0x9B, 0x79, 0xB7, 0x51, 0x3A, -0x12, 0x04, 0x7E, 0x90, 0x8A, 0xE5, 0x12, 0x8F, -0x00, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x71, 0x2A, 0xE4, 0xFF, 0x51, -0x47, 0x90, 0x8B, 0x07, 0xB1, 0xD6, 0xF9, 0x02, -0x04, 0x7A, 0x51, 0xE1, 0x12, 0x97, 0xCB, 0x7F, -0x01, 0x51, 0x47, 0x90, 0x8B, 0x07, 0x12, 0x8E, -0xDC, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x38, -0xF1, 0xAD, 0x90, 0x93, 0x0B, 0xE0, 0x60, 0x0B, -0x14, 0xF0, 0x90, 0x9B, 0x66, 0xE0, 0x70, 0x28, -0x02, 0x79, 0xD4, 0xF1, 0xB6, 0xF0, 0xE4, 0xFF, -0x12, 0x8F, 0xF6, 0x90, 0x93, 0x04, 0xE0, 0xFF, -0x20, 0xE0, 0x08, 0x13, 0x13, 0x13, 0x54, 0x1F, -0x30, 0xE0, 0x0D, 0x90, 0x9C, 0x65, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x01, 0x12, 0xCD, 0x76, -0x22, 0xE4, 0x90, 0x9A, 0xE0, 0xF0, 0x90, 0x88, -0x36, 0xE0, 0x60, 0x3D, 0x71, 0xA7, 0x70, 0x39, -0xF1, 0x9D, 0xF0, 0xB1, 0xFF, 0x90, 0x9A, 0xE0, -0x74, 0x01, 0xF0, 0xE4, 0x90, 0x88, 0x3D, 0xF0, -0x04, 0x60, 0x26, 0x90, 0x88, 0x39, 0xE0, 0x20, -0xE2, 0x08, 0x90, 0x8A, 0xB9, 0x12, 0x8F, 0x00, -0x71, 0x98, 0x71, 0x9F, 0xE4, 0x90, 0x92, 0x20, -0xF0, 0x12, 0x97, 0x8D, 0x71, 0xCE, 0x7E, 0x01, -0x12, 0x66, 0x33, 0x90, 0x8A, 0xD7, 0x12, 0x8E, -0xDC, 0x22, 0xE4, 0xF5, 0x11, 0x90, 0x88, 0x36, -0xE0, 0x60, 0x5A, 0x71, 0xA7, 0x70, 0x56, 0xB1, -0xFF, 0x75, 0x11, 0x01, 0xE5, 0x11, 0x60, 0x4D, -0x90, 0x88, 0x39, 0xE0, 0x20, 0xE2, 0x08, 0x90, -0x8A, 0xB9, 0x12, 0x8F, 0x00, 0x71, 0x98, 0x71, -0x9F, 0x90, 0x88, 0x3F, 0xE0, 0x60, 0x04, 0x64, -0x01, 0x70, 0x13, 0xE4, 0x90, 0x92, 0x20, 0xF0, -0x12, 0x97, 0x8D, 0xFF, 0xA3, 0xE0, 0x12, 0x97, -0x7E, 0xFF, 0xA3, 0xE0, 0x80, 0x0F, 0xE4, 0x90, -0x92, 0x20, 0xF0, 0x12, 0x97, 0x8D, 0x71, 0x8E, -0x12, 0x97, 0x7E, 0x71, 0x8E, 0x2F, 0x33, 0x33, -0x33, 0x54, 0xF8, 0x90, 0x88, 0x4F, 0xF0, 0x90, -0x8A, 0xD7, 0x12, 0x8E, 0xDC, 0x22, 0xFF, 0xA3, -0xE0, 0x75, 0xF0, 0x03, 0xA4, 0x24, 0xFE, 0x22, -0x7D, 0x01, 0x7F, 0x04, 0x02, 0x04, 0x7E, 0x90, -0x88, 0x3A, 0xE0, 0x44, 0x10, 0xF0, 0x22, 0xE4, -0xFF, 0x12, 0x78, 0x4A, 0xEF, 0x64, 0x01, 0x22, -0x71, 0xA7, 0x70, 0x0F, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x09, 0x91, 0x94, 0x71, 0xC4, 0x7E, 0x01, -0x12, 0x66, 0x33, 0x22, 0xF0, 0xE4, 0x90, 0x92, -0x20, 0xF0, 0x90, 0x88, 0x94, 0xE0, 0x90, 0x92, -0x21, 0xF0, 0xE4, 0xFB, 0xFD, 0x7F, 0x54, 0x22, -0x71, 0xA7, 0x70, 0x15, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x0F, 0x91, 0x94, 0xF0, 0x90, 0x88, 0x31, -0xE0, 0xB1, 0xB0, 0x54, 0x07, 0x70, 0x02, 0xB1, -0x2C, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x01, 0xC4, 0x74, 0xF2, 0xF0, 0x74, 0xD3, 0xA3, -0xF0, 0x12, 0x64, 0x7F, 0xE5, 0x30, 0x30, 0xE1, -0x02, 0xF1, 0xC8, 0xE5, 0x2D, 0x30, 0xE3, 0x03, -0x12, 0xF0, 0xC6, 0xE5, 0x2D, 0x30, 0xE4, 0x03, -0x12, 0xF0, 0xD9, 0xE5, 0x2D, 0x30, 0xE5, 0x03, -0x12, 0xF0, 0xEA, 0xE5, 0x2F, 0x30, 0xE0, 0x02, -0x51, 0x83, 0xE5, 0x2F, 0x30, 0xE1, 0x03, 0x12, -0xE2, 0x32, 0xE5, 0x2F, 0x30, 0xE2, 0x03, 0x12, -0xE7, 0xE6, 0xE5, 0x2F, 0x30, 0xE3, 0x02, 0x71, -0xB0, 0xE5, 0x2F, 0x30, 0xE4, 0x02, 0x71, 0xD8, -0xE5, 0x2F, 0x30, 0xE5, 0x02, 0xB1, 0xDD, 0xE5, -0x2F, 0x30, 0xE6, 0x02, 0x91, 0x9F, 0x74, 0xF2, -0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD3, 0xA3, -0xF0, 0xD0, 0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, -0x04, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -0xF0, 0xD0, 0xE0, 0x32, 0x90, 0x01, 0x57, 0xE4, -0xF0, 0x90, 0x01, 0x3C, 0x74, 0x02, 0x22, 0xE4, -0xFF, 0x12, 0x78, 0x4A, 0xBF, 0x01, 0x0E, 0x90, -0x88, 0x36, 0xE0, 0x60, 0x08, 0x91, 0xB6, 0x54, -0x07, 0x70, 0x02, 0xB1, 0x2C, 0x22, 0x90, 0x88, -0x3A, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xE4, 0xF5, -0x11, 0x90, 0x06, 0xA9, 0xE0, 0xF5, 0x11, 0x54, -0xC0, 0x70, 0x18, 0x91, 0xB6, 0x54, 0xFD, 0xF0, -0xB1, 0x2C, 0x90, 0x88, 0x39, 0xE0, 0x60, 0x53, -0x12, 0xC7, 0x55, 0x44, 0x01, 0xFD, 0x7F, 0x02, -0x02, 0x7B, 0x2E, 0xE5, 0x11, 0x30, 0xE6, 0x23, -0x90, 0x88, 0x36, 0xE0, 0x64, 0x01, 0x70, 0x1D, -0x90, 0x88, 0x3A, 0xE0, 0x44, 0x01, 0xF0, 0x12, -0xA7, 0xE4, 0x64, 0x02, 0x60, 0x08, 0x90, 0x8A, -0xE1, 0x12, 0x8E, 0xDC, 0x80, 0x07, 0x12, 0x73, -0x8F, 0x80, 0x02, 0x91, 0xB6, 0xE5, 0x11, 0x90, -0x88, 0x3A, 0x30, 0xE7, 0x12, 0xE0, 0x44, 0x02, -0x71, 0xC4, 0x7E, 0x01, 0x12, 0x66, 0x33, 0x90, -0x88, 0x31, 0xE0, 0x44, 0x04, 0xF0, 0x22, 0xE0, -0x54, 0xFD, 0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, -0xFF, 0x90, 0x8A, 0xB9, 0x12, 0xAD, 0x24, 0x7D, -0x01, 0x02, 0x04, 0x7E, 0x12, 0x91, 0xDD, 0x30, -0xE0, 0x0B, 0xEF, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x30, 0xE0, 0x02, 0xF1, 0x8E, 0x90, 0x88, 0x31, -0xD1, 0x89, 0x30, 0xE0, 0x09, 0xEF, 0xB1, 0xB0, -0x54, 0x07, 0x70, 0x4B, 0x80, 0x47, 0x90, 0x88, -0x3F, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x3A, 0xE0, -0x54, 0xEF, 0xF0, 0x12, 0xFC, 0x5E, 0x40, 0x35, -0x71, 0xA7, 0x70, 0x33, 0x12, 0xA7, 0xE4, 0x70, -0x08, 0x90, 0x8A, 0xF5, 0x12, 0x8E, 0xDC, 0x80, -0x27, 0x90, 0x8A, 0xF5, 0x12, 0x8E, 0xDC, 0x90, -0x88, 0x40, 0xE0, 0x04, 0xF0, 0xE0, 0xD3, 0x94, -0x02, 0x40, 0x09, 0xB1, 0xA8, 0xE4, 0x90, 0x88, -0x40, 0xF0, 0x80, 0x03, 0x12, 0x73, 0x8F, 0xE4, -0x90, 0x88, 0x3F, 0xF0, 0x22, 0xB1, 0x2C, 0x22, -0x90, 0x88, 0x32, 0xE0, 0x54, 0xFB, 0xF0, 0x22, -0x54, 0xFB, 0xF0, 0x90, 0x88, 0x3A, 0xE0, 0x54, -0xFD, 0xF0, 0x22, 0x90, 0x88, 0x36, 0xE0, 0x60, -0x11, 0x90, 0x06, 0x92, 0xE0, 0x30, 0xE1, 0x06, -0xB1, 0xD3, 0xF9, 0x02, 0x04, 0x7A, 0xF1, 0xA5, -0xB1, 0x2C, 0x22, 0x90, 0x8B, 0x01, 0xE0, 0xFE, -0xA3, 0xE0, 0xAA, 0x06, 0x22, 0xE4, 0xFF, 0x12, -0x78, 0x4A, 0xBF, 0x01, 0x19, 0x90, 0x88, 0x36, -0xE0, 0x60, 0x13, 0x12, 0xA7, 0xE4, 0x64, 0x02, -0x60, 0x09, 0x90, 0x8A, 0xE1, 0xB1, 0xD6, 0xF9, -0x02, 0x04, 0x7A, 0x12, 0x73, 0x8F, 0x22, 0x90, -0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, 0x90, -0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, 0x90, -0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, 0x90, -0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, 0x90, -0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, 0x90, -0x98, 0x18, 0xE0, 0x30, 0xE0, 0x33, 0x71, 0xA7, -0x70, 0x2F, 0x90, 0x9C, 0xAB, 0xE0, 0x04, 0xF0, -0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x98, 0x1A, 0xE0, -0x04, 0xF0, 0xE4, 0x90, 0x9C, 0xAB, 0xF0, 0x90, -0x98, 0x1A, 0xE0, 0xFF, 0x90, 0x98, 0x19, 0xE0, -0xD3, 0x9F, 0x50, 0x0D, 0x90, 0x98, 0x1B, 0xE0, -0x70, 0x07, 0xE4, 0x90, 0x98, 0x1A, 0xF0, 0xD1, -0x62, 0x22, 0x90, 0x98, 0x18, 0xD1, 0x89, 0x30, -0xE0, 0x0F, 0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, -0x12, 0xFD, 0x01, 0xA3, 0x04, 0xF0, 0x02, 0x9A, -0xEF, 0x90, 0x8A, 0xAF, 0x12, 0x8F, 0x00, 0x7D, -0x08, 0xE4, 0xFF, 0x02, 0x04, 0x7E, 0x90, 0x88, -0x32, 0xE0, 0xFF, 0x13, 0x13, 0x54, 0x3F, 0x22, -0x90, 0x88, 0x31, 0xF1, 0x95, 0x30, 0xE0, 0x34, -0xEF, 0x54, 0xBF, 0xF1, 0xBF, 0x30, 0xE0, 0x06, -0xE0, 0x44, 0x01, 0xF0, 0x80, 0x09, 0xE0, 0x54, -0xFE, 0xF0, 0xF1, 0xD2, 0x74, 0x04, 0xF0, 0x90, -0x88, 0xA3, 0xE0, 0xFF, 0xC4, 0x13, 0x54, 0x07, -0x30, 0xE0, 0x0F, 0x90, 0x8A, 0xB9, 0x12, 0x8F, -0x00, 0x7D, 0x01, 0x7F, 0x0C, 0x12, 0x04, 0x7E, -0x80, 0x02, 0xB1, 0x2C, 0xE4, 0xFF, 0x02, 0xB7, -0x54, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, 0xC0, -0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x00, -0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, 0x04, -0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x01, -0xC4, 0x74, 0xD1, 0xF0, 0x74, 0xD6, 0xA3, 0xF0, -0x12, 0x75, 0x50, 0xE5, 0x3D, 0x30, 0xE0, 0x02, -0xF1, 0xDC, 0xE5, 0x3D, 0x30, 0xE1, 0x02, 0xF1, -0x82, 0xE5, 0x3D, 0x30, 0xE2, 0x02, 0xB1, 0xBB, -0xE5, 0x3D, 0x30, 0xE4, 0x02, 0xF1, 0x8B, 0xE5, -0x3E, 0x30, 0xE0, 0x03, 0x12, 0xC8, 0x44, 0xE5, -0x3F, 0x30, 0xE2, 0x0A, 0x12, 0xE7, 0xF8, 0x90, -0x07, 0x8F, 0xE0, 0x44, 0x10, 0xF0, 0xE5, 0x40, -0x30, 0xE1, 0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x8F, -0x00, 0x7F, 0x04, 0x12, 0x04, 0x7E, 0xE5, 0x40, -0x30, 0xE4, 0x02, 0x51, 0x92, 0xE5, 0x40, 0x30, -0xE5, 0x02, 0xD1, 0x90, 0xE5, 0x40, 0x30, 0xE6, -0x03, 0x12, 0xE8, 0x5A, 0xE5, 0x40, 0x30, 0xE7, -0x03, 0x12, 0xE8, 0x3A, 0x74, 0xD1, 0x04, 0x90, -0x01, 0xC4, 0xF0, 0x74, 0xD6, 0xA3, 0xF0, 0xD0, -0x07, 0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, -0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, -0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, -0xE0, 0x32, 0x90, 0x88, 0x36, 0xE0, 0x60, 0x02, -0xB1, 0x3C, 0x22, 0x02, 0x34, 0x78, 0x7D, 0x02, -0x7F, 0x02, 0x02, 0x7C, 0x7E, 0xE0, 0xFF, 0xC4, -0x13, 0x13, 0x54, 0x03, 0x22, 0x90, 0x88, 0x3C, -0xE0, 0x90, 0x05, 0x73, 0x22, 0x90, 0x88, 0x31, -0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x90, 0x93, 0x0A, -0xE0, 0x90, 0x05, 0x73, 0xF0, 0x22, 0x90, 0x93, -0x09, 0xE0, 0x14, 0x90, 0x93, 0x0B, 0x22, 0xF0, -0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0x32, 0x22, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x03, 0x12, 0x8F, -0x09, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x01, 0xF0, -0x90, 0x01, 0xB8, 0x22, 0x90, 0x8A, 0xE5, 0x12, -0x8F, 0x00, 0x7F, 0x80, 0x02, 0x04, 0x7E, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x7F, 0x8F, -0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, 0x29, 0x90, -0x00, 0x8C, 0xE0, 0x90, 0x9C, 0x93, 0xF0, 0x7F, -0x8D, 0x12, 0x7B, 0x41, 0x90, 0x9C, 0x94, 0xEF, -0xF0, 0x90, 0x00, 0x8E, 0xE0, 0x90, 0x9C, 0x95, -0xF0, 0x90, 0x9C, 0x94, 0xE0, 0x7F, 0x8F, 0x12, -0x7B, 0x41, 0xEF, 0x30, 0xE0, 0x02, 0x11, 0x25, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFD, 0x7F, -0x8D, 0x02, 0x7B, 0x2E, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x9B, 0xEF, 0xF0, -0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE6, -0x4A, 0x7F, 0x8D, 0x12, 0x7B, 0x41, 0xEF, 0x64, -0x01, 0x70, 0x40, 0x90, 0x9C, 0x9C, 0xF0, 0x90, -0x9C, 0x9C, 0xE0, 0xFD, 0x90, 0x9C, 0x9B, 0xE0, -0xC4, 0x54, 0xF0, 0x24, 0x00, 0xF5, 0x82, 0xE4, -0x34, 0x81, 0xF5, 0x83, 0xE5, 0x82, 0x2D, 0xF5, -0x82, 0xE4, 0x35, 0x83, 0xF5, 0x83, 0xE0, 0xFB, -0xE4, 0xFF, 0x11, 0x90, 0x90, 0x9C, 0x9C, 0xE0, -0x04, 0xF0, 0xE0, 0xC3, 0x94, 0x10, 0x40, 0xCF, -0x7F, 0x8F, 0x12, 0x7B, 0x41, 0xEF, 0x30, 0xE0, -0x02, 0x11, 0x25, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xEF, 0x70, 0x04, 0x74, 0xF0, 0x80, 0x16, 0xEF, -0xB4, 0x01, 0x04, 0x74, 0xF4, 0x80, 0x0E, 0xEF, -0xB4, 0x02, 0x04, 0x74, 0xF8, 0x80, 0x06, 0xEF, -0xB4, 0x03, 0x0C, 0x74, 0xFC, 0x2D, 0xF5, 0x82, -0xE4, 0x34, 0x02, 0xF5, 0x83, 0xEB, 0xF0, 0x22, -0xE4, 0x90, 0x86, 0xAF, 0x12, 0xB3, 0x87, 0x90, -0x93, 0x01, 0xF0, 0x90, 0x98, 0x36, 0xF0, 0xA3, -0xF0, 0x22, 0x75, 0x29, 0x10, 0xE4, 0xF5, 0x2A, -0x75, 0x2B, 0x07, 0x75, 0x2C, 0x02, 0xF5, 0x31, -0xF5, 0x32, 0xF5, 0x33, 0xF5, 0x34, 0x90, 0x01, -0x30, 0xE5, 0x29, 0xF0, 0xA3, 0xE5, 0x2A, 0xF0, -0xA3, 0xE5, 0x2B, 0xF0, 0xA3, 0xE5, 0x2C, 0xF0, -0x90, 0x01, 0x20, 0xE5, 0x31, 0xF0, 0xA3, 0xE5, -0x32, 0xF0, 0xA3, 0xE5, 0x33, 0xF0, 0xA3, 0xE5, -0x34, 0xF0, 0x22, 0x75, 0x39, 0x07, 0x43, 0x39, -0x10, 0x75, 0x3A, 0x01, 0x75, 0x3B, 0x03, 0x75, -0x3C, 0x62, 0x43, 0x3C, 0x80, 0x43, 0x3B, 0x04, -0x90, 0x01, 0x38, 0xE5, 0x39, 0xF0, 0xA3, 0xE5, -0x3A, 0xF0, 0xA3, 0xE5, 0x3B, 0xF0, 0xA3, 0xE5, -0x3C, 0xF0, 0x22, 0x90, 0x01, 0xE4, 0x74, 0x1B, -0xF0, 0xA3, 0xE4, 0xF0, 0x22, 0x7D, 0x02, 0x90, -0x01, 0xC4, 0x74, 0x35, 0xF0, 0x74, 0xD9, 0xA3, -0xF0, 0x90, 0x98, 0x17, 0xE0, 0xFF, 0xED, 0xC3, -0x9F, 0x50, 0x18, 0xED, 0x25, 0xE0, 0x24, 0x81, -0xF8, 0xE6, 0x30, 0xE4, 0x0B, 0x90, 0x01, 0xB8, -0x74, 0x08, 0xF0, 0xA3, 0xF0, 0x7F, 0x00, 0x22, -0x0D, 0x80, 0xDE, 0x74, 0x35, 0x04, 0x90, 0x01, -0xC4, 0xF0, 0x74, 0xD9, 0xA3, 0xF0, 0x7F, 0x01, -0x22, 0xE4, 0x90, 0x99, 0xE4, 0xF0, 0xA3, 0xF0, -0xA3, 0xF0, 0x90, 0x99, 0xE4, 0xE0, 0x64, 0x01, -0xF0, 0x90, 0x98, 0x2E, 0xE0, 0x70, 0x18, 0x90, -0x98, 0x2B, 0xE0, 0x70, 0x12, 0xA3, 0xE0, 0x70, -0x0E, 0x90, 0x99, 0xE4, 0xE0, 0x24, 0x71, 0x90, -0x01, 0xC4, 0xF0, 0x74, 0xD9, 0xA3, 0xF0, 0x12, -0x7C, 0x54, 0xBF, 0x01, 0x03, 0x12, 0x54, 0x9F, -0x90, 0x88, 0x36, 0xE0, 0x60, 0x0F, 0x90, 0x88, -0x39, 0xE0, 0xFF, 0x90, 0x88, 0x38, 0xE0, 0x6F, -0x60, 0x03, 0x12, 0xD5, 0x2C, 0xC2, 0xAF, 0x31, -0x35, 0xBF, 0x01, 0x16, 0x90, 0x86, 0xB3, 0xE0, -0xFF, 0xB4, 0x03, 0x07, 0x90, 0x99, 0x7B, 0xE0, -0x20, 0xE0, 0x05, 0xEF, 0x64, 0x03, 0x60, 0x02, -0xF1, 0x9D, 0xD2, 0xAF, 0x31, 0xE6, 0x12, 0xD7, -0xE7, 0x12, 0x86, 0x8D, 0x80, 0x94, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x98, 0x2B, -0xE0, 0x60, 0x32, 0x7F, 0x54, 0x7E, 0x09, 0x12, -0x70, 0x70, 0x90, 0x99, 0xE7, 0x12, 0x04, 0x31, -0x90, 0x99, 0xE7, 0x12, 0x04, 0xB8, 0xEF, 0x44, -0xFE, 0xFF, 0xEE, 0x44, 0x03, 0xFE, 0xED, 0x44, -0x04, 0xFD, 0xEC, 0x90, 0x99, 0xE7, 0x12, 0x04, -0x31, 0x90, 0x99, 0xE7, 0x51, 0xA0, 0x7F, 0x54, -0x7E, 0x09, 0x12, 0x70, 0xAD, 0x90, 0x98, 0x26, -0xE0, 0x70, 0x29, 0x90, 0x07, 0xCC, 0xE0, 0x30, -0xE0, 0x22, 0xE4, 0xF0, 0x90, 0x99, 0xEB, 0x74, -0x22, 0xF0, 0x90, 0x9A, 0x0D, 0x74, 0x01, 0xF0, -0x90, 0x99, 0xED, 0x74, 0x03, 0xF0, 0x7B, 0x01, -0x7A, 0x99, 0x79, 0xEB, 0x12, 0x8E, 0xEE, 0x7F, -0x04, 0x12, 0x04, 0x7E, 0x90, 0x98, 0x2E, 0xE0, -0xFF, 0x70, 0x0A, 0x90, 0x98, 0x2B, 0xE0, 0x70, -0x04, 0xA3, 0xE0, 0x60, 0x15, 0x90, 0x00, 0x1F, -0xE0, 0x54, 0xF0, 0xF0, 0x90, 0x01, 0xC5, 0x74, -0xEA, 0xF0, 0xA3, 0x74, 0xEF, 0xF0, 0xA3, 0x74, -0xFD, 0xF0, 0xEF, 0x60, 0x06, 0x90, 0x01, 0xC4, -0x74, 0x07, 0xF0, 0x90, 0x98, 0x2B, 0xE0, 0x60, -0x06, 0x90, 0x01, 0xC4, 0x74, 0x01, 0xF0, 0x90, -0x98, 0x2C, 0xE0, 0x60, 0x06, 0x90, 0x01, 0xC4, -0x74, 0x02, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x12, 0x04, 0xB8, 0x90, 0x92, 0x18, 0x02, 0x04, -0x31, 0x7F, 0x58, 0x7E, 0x0C, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x03, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x70, 0x70, 0x90, -0x9C, 0x0D, 0x12, 0x04, 0x31, 0x90, 0x9C, 0x05, -0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, 0x90, 0x9C, -0x0D, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x9C, 0x05, 0x12, 0x04, 0xB8, 0x90, 0x9C, 0x09, -0x12, 0x84, 0x52, 0x12, 0x84, 0x38, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0x12, 0x84, -0x45, 0x90, 0x9C, 0x11, 0x12, 0x04, 0x31, 0x90, -0x9C, 0x11, 0x51, 0xA0, 0x90, 0x9C, 0x03, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x12, 0x70, 0xAD, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x9F, 0xED, 0xF0, -0xE4, 0xA3, 0xF0, 0xEF, 0x14, 0x60, 0x02, 0x61, -0xFE, 0x90, 0x06, 0x03, 0xE0, 0x54, 0xFB, 0xF0, -0x90, 0x9C, 0x9F, 0xE0, 0xFB, 0xC4, 0x33, 0x54, -0xE0, 0xFE, 0x90, 0x04, 0x42, 0xE0, 0x54, 0x9F, -0x4E, 0xFE, 0xF0, 0xE4, 0xFD, 0x12, 0xF1, 0x26, -0x90, 0x9C, 0xA0, 0xEF, 0xF0, 0x90, 0x04, 0x83, -0xF0, 0x90, 0x9C, 0x05, 0x12, 0x04, 0x3D, 0x00, -0x00, 0x00, 0x01, 0x90, 0x9C, 0x09, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x01, 0x91, 0x63, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, 0x9C, -0x09, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, -0x7F, 0x00, 0x7E, 0x09, 0x91, 0x67, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0x10, 0x90, 0x9C, 0x9F, -0x12, 0xA3, 0xF5, 0xEF, 0x54, 0x03, 0xFF, 0xE4, -0x78, 0x01, 0x12, 0x03, 0xEB, 0x78, 0x04, 0x12, -0xCF, 0xD7, 0x7F, 0x00, 0x7E, 0x0A, 0x91, 0x67, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, -0x9C, 0x9F, 0x12, 0xA3, 0xF5, 0xEF, 0x54, 0x03, -0xFF, 0xE4, 0x78, 0x0A, 0x12, 0xCF, 0xD7, 0x7F, -0x00, 0x7E, 0x0D, 0x91, 0x67, 0x12, 0x04, 0x3D, -0x0C, 0x00, 0x00, 0x00, 0x90, 0x9C, 0xA0, 0x12, -0xA3, 0xF5, 0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, -0x1A, 0x12, 0xCF, 0xD7, 0x7F, 0x18, 0x91, 0x65, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, -0x9C, 0x09, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -0x00, 0xB1, 0x4A, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x0C, 0x00, 0x90, 0x9B, 0xF7, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x04, 0x00, 0x80, 0x58, 0x90, 0x06, -0x03, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x9C, 0x05, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, -0x9C, 0x09, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -0x00, 0x91, 0x63, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0x01, 0x90, 0x9C, 0x09, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, 0x09, -0x91, 0x67, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, -0x00, 0x90, 0x9C, 0x09, 0x12, 0x04, 0x3D, 0x00, -0x00, 0x0C, 0x00, 0xB1, 0x4A, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x0C, 0x00, 0x90, 0x9B, 0xF7, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x7D, 0x18, -0x7C, 0x00, 0xE4, 0xFF, 0xB1, 0xBE, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x7F, 0x00, 0x7E, 0x08, 0x51, -0xAD, 0x90, 0x9C, 0x05, 0x22, 0x7F, 0x50, 0x7E, -0x0C, 0x12, 0x70, 0x70, 0x90, 0x9A, 0xE8, 0xEF, -0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x70, 0x70, -0x90, 0x9A, 0xE9, 0xEF, 0xF0, 0x90, 0x9C, 0x05, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, -0x9C, 0x09, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, -0x17, 0x7F, 0x50, 0x7E, 0x0C, 0x91, 0x67, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x9C, -0x09, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x17, -0x51, 0xA9, 0x90, 0x06, 0x08, 0xE0, 0x90, 0x9A, -0xFE, 0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, 0x90, -0x06, 0xA0, 0x12, 0xBE, 0x88, 0x90, 0x9B, 0x00, -0xF0, 0xA3, 0xEF, 0xF1, 0x8A, 0x90, 0x06, 0xA0, -0x74, 0x20, 0xF0, 0xA3, 0x74, 0x01, 0xF0, 0xE4, -0xFD, 0xFF, 0x61, 0x14, 0x90, 0x93, 0x04, 0x12, -0xD6, 0x89, 0x30, 0xE0, 0x07, 0xD1, 0xE0, 0xE4, -0x90, 0x9B, 0x02, 0xF0, 0x90, 0x9C, 0x05, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x9A, -0xE8, 0x12, 0xA3, 0xF5, 0x12, 0xCF, 0xDA, 0x7F, -0x50, 0x7E, 0x0C, 0x91, 0x67, 0x12, 0x04, 0x3D, -0x00, 0x00, 0x00, 0x7F, 0x90, 0x9A, 0xE9, 0x12, -0xA3, 0xF5, 0x12, 0xCF, 0xDA, 0x51, 0xA9, 0x90, -0x9A, 0xFE, 0xE0, 0x90, 0x06, 0x08, 0xF0, 0x90, -0x9B, 0x00, 0xA3, 0xE0, 0x90, 0x06, 0xA0, 0xF0, -0xA3, 0xE4, 0xF0, 0x90, 0x9A, 0xEC, 0xE0, 0xFF, -0x60, 0x05, 0xA3, 0xE0, 0xFD, 0x71, 0x14, 0x90, -0x9A, 0xEB, 0xE0, 0xFF, 0x60, 0x0B, 0xA3, 0xE0, -0xFD, 0xA3, 0xE0, 0xFB, 0x12, 0xCF, 0xE0, 0xB1, -0x54, 0x22, 0x7F, 0x84, 0x7E, 0x08, 0x51, 0xAD, -0x90, 0x9B, 0xF3, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x80, 0xEF, 0xF0, -0xED, 0x64, 0x01, 0x70, 0x2E, 0xEB, 0xB4, 0x01, -0x07, 0xE0, 0x24, 0x02, 0xF5, 0x15, 0x80, 0x08, -0x90, 0x9C, 0x80, 0xE0, 0x24, 0xFE, 0xF5, 0x15, -0x90, 0x9B, 0xF3, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0xFF, 0xAF, 0x15, 0xD1, 0x44, 0xD1, 0x3C, -0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, -0x15, 0x80, 0x20, 0x90, 0x9B, 0xF3, 0x12, 0x04, -0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9C, 0x80, -0x12, 0xA3, 0xF5, 0xD1, 0x48, 0xD1, 0x3C, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0x90, 0x9C, -0x80, 0xE0, 0xFF, 0xD1, 0x44, 0x7F, 0x01, 0xB1, -0xBE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9B, 0xF1, -0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x9B, 0xF0, -0xEF, 0xF0, 0xA3, 0xA3, 0xE0, 0xFD, 0x12, 0x7B, -0xBD, 0x90, 0x9B, 0xFB, 0x12, 0x04, 0x31, 0x90, -0x9B, 0xF3, 0x12, 0x04, 0xB8, 0x12, 0x03, 0xCD, -0x90, 0x9B, 0xFB, 0x12, 0x84, 0x52, 0x12, 0x84, -0x38, 0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, -0x07, 0x90, 0x9B, 0xF3, 0x12, 0x04, 0xB8, 0x90, -0x9B, 0xF7, 0x12, 0x84, 0x52, 0x12, 0x84, 0x38, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x84, 0x45, 0x90, 0x9B, 0xFF, 0x12, 0x04, -0x31, 0x90, 0x9B, 0xF1, 0xA3, 0xE0, 0xFD, 0xC0, -0x05, 0x90, 0x9B, 0xFF, 0x12, 0x04, 0xB8, 0x90, -0x8B, 0x9F, 0x12, 0x04, 0x31, 0x90, 0x9B, 0xF0, -0xE0, 0xFF, 0xD0, 0x05, 0x12, 0x79, 0x53, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xE4, 0xFF, 0xB1, 0xBE, -0x90, 0x9B, 0xF3, 0x22, 0xE4, 0xFC, 0xFD, 0xFE, -0x90, 0x9B, 0xF7, 0x12, 0x04, 0x31, 0x7D, 0x18, -0x7C, 0x00, 0x22, 0xE4, 0x90, 0x9A, 0x10, 0xF0, -0x90, 0x9B, 0x66, 0x04, 0xF0, 0x90, 0x06, 0x32, -0xE0, 0x44, 0x04, 0xF0, 0x90, 0x98, 0x01, 0x12, -0x04, 0xB8, 0xEF, 0x24, 0x01, 0xF1, 0xA8, 0x90, -0x98, 0x01, 0x12, 0x04, 0x31, 0x91, 0x6D, 0xE4, -0x90, 0x9A, 0xE7, 0xF0, 0xFF, 0x12, 0xF9, 0x2E, -0x12, 0xD3, 0xA7, 0x70, 0x4B, 0x90, 0x8A, 0xB9, -0x12, 0x8F, 0x00, 0x7D, 0x01, 0x7F, 0x02, 0x12, -0x04, 0x7E, 0x7F, 0x05, 0x7E, 0x00, 0x12, 0x7A, -0xAE, 0xF1, 0xB3, 0x12, 0x8F, 0x00, 0x7D, 0x02, -0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, 0x88, 0x39, -0xE0, 0x64, 0x02, 0x60, 0x23, 0x90, 0x9A, 0x10, -0xE0, 0x04, 0xF0, 0x7F, 0x01, 0x7E, 0x00, 0x12, -0x7A, 0xAE, 0x90, 0x8A, 0xB9, 0x12, 0x8F, 0x00, -0x7D, 0x01, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x90, -0x9A, 0x10, 0xE0, 0xD3, 0x94, 0x0A, 0x40, 0xD5, -0x90, 0x9C, 0x65, 0x12, 0x04, 0x3D, 0x00, 0x00, -0x00, 0x0A, 0x12, 0xCF, 0xCF, 0x02, 0xCD, 0x7D, -0x90, 0x02, 0x86, 0xE0, 0x54, 0xFB, 0xF0, 0x22, -0xE4, 0xFD, 0xFC, 0x90, 0x01, 0x1D, 0xE0, 0xFE, -0x90, 0x01, 0x1C, 0xF1, 0xD5, 0x90, 0x9C, 0x88, -0xF0, 0xA3, 0xEF, 0xF1, 0x93, 0xE0, 0x24, 0x00, -0xFF, 0xEA, 0x3E, 0x90, 0x9C, 0x8A, 0xF0, 0xA3, -0xEF, 0xF0, 0xF1, 0x79, 0x90, 0x9C, 0x88, 0xE0, -0xFA, 0xA3, 0xE0, 0xFB, 0xB5, 0x07, 0x06, 0xEA, -0xB5, 0x06, 0x02, 0x80, 0x40, 0xF1, 0x79, 0xD3, -0xEB, 0x9F, 0xEA, 0x9E, 0x40, 0x0E, 0x90, 0x9C, -0x89, 0xE0, 0x9F, 0xFD, 0x90, 0x9C, 0x88, 0xE0, -0x9E, 0xFC, 0x80, 0x29, 0xF1, 0x79, 0xC3, 0x90, -0x9C, 0x89, 0xE0, 0x9F, 0x90, 0x9C, 0x88, 0xE0, -0x9E, 0x50, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0xC3, 0x90, 0x9C, 0x8B, 0xE0, 0x9F, 0xFF, 0x90, -0x9C, 0x8A, 0xE0, 0x9E, 0xFE, 0xC3, 0xE4, 0x9F, -0xFD, 0x74, 0x40, 0x9E, 0xFC, 0xD3, 0xED, 0x94, -0x00, 0xEC, 0x94, 0x38, 0x40, 0x02, 0xC1, 0xE0, -0xC3, 0xEC, 0x94, 0x08, 0x50, 0x0A, 0xED, 0x94, -0x00, 0xEC, 0x94, 0x00, 0x40, 0x02, 0xF1, 0x82, -0x22, 0x90, 0x9C, 0x8A, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0x22, 0x90, 0x02, 0x86, 0xE0, 0x44, 0x04, -0xF0, 0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, 0x54, -0x7F, 0xF0, 0x22, 0xF0, 0x90, 0x01, 0x1F, 0xE0, -0xFE, 0x90, 0x01, 0x1E, 0x22, 0x90, 0x88, 0x31, -0xE0, 0x30, 0xE0, 0x03, 0x12, 0xC7, 0x93, 0x22, -0xFF, 0xE4, 0x3E, 0xFE, 0xE4, 0x3D, 0xFD, 0xE4, -0x3C, 0xFC, 0x22, 0x90, 0x88, 0x38, 0xE0, 0x90, -0x9A, 0xFF, 0xF0, 0x90, 0x8A, 0x89, 0x22, 0x74, -0x01, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, -0x83, 0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xF5, 0x82, -0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x7A, 0x00, -0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x22, 0x90, 0x8A, -0x79, 0x74, 0x89, 0xF0, 0xA3, 0x74, 0x86, 0xF0, -0x90, 0x8A, 0xE5, 0x74, 0xE0, 0xF0, 0xA3, 0x74, -0xBB, 0xF0, 0x90, 0x8B, 0x03, 0x74, 0x89, 0xF0, -0xA3, 0x74, 0xD8, 0xF0, 0x90, 0x8A, 0xB9, 0x74, -0xED, 0xF0, 0xA3, 0x74, 0x5D, 0xF0, 0x90, 0x8A, -0xC3, 0x74, 0xED, 0xF0, 0xA3, 0x74, 0x2D, 0xF0, -0x90, 0x8A, 0xF3, 0x74, 0xF1, 0xF0, 0xA3, 0x74, -0xB2, 0xF0, 0x90, 0x8A, 0x85, 0x74, 0xCB, 0xF0, -0xA3, 0x74, 0xC2, 0xF0, 0x90, 0x86, 0x04, 0x74, -0xF1, 0xF0, 0xA3, 0x74, 0xF6, 0xF0, 0x90, 0x8A, -0xA9, 0x74, 0xF1, 0xF0, 0xA3, 0x74, 0xBE, 0xF0, -0x90, 0x8B, 0x07, 0x74, 0xE7, 0xF0, 0xA3, 0x74, -0x1B, 0xF0, 0x90, 0x8A, 0xAD, 0x74, 0xB5, 0xF0, -0xA3, 0x74, 0x66, 0xF0, 0x90, 0x86, 0x0C, 0x74, -0xA8, 0xF0, 0xA3, 0x74, 0x3F, 0xF0, 0x90, 0x8A, -0xEF, 0x74, 0xEE, 0xF0, 0xA3, 0x74, 0xE4, 0xF0, -0x90, 0x86, 0x00, 0x74, 0xFA, 0xF0, 0xA3, 0x74, -0x7A, 0xF0, 0x90, 0x86, 0x02, 0x74, 0xFB, 0xF0, -0xA3, 0x74, 0x47, 0xF0, 0x90, 0x8A, 0xFD, 0x74, -0xEF, 0xF0, 0xA3, 0x74, 0xBD, 0xF0, 0x90, 0x8A, -0xF9, 0x74, 0xD0, 0xF0, 0xA3, 0x74, 0x25, 0xF0, -0x90, 0x8A, 0xAF, 0x74, 0xAE, 0xF0, 0xA3, 0x74, -0x3D, 0xF0, 0x90, 0x8A, 0xD3, 0x74, 0xE8, 0xF0, -0xA3, 0x74, 0xBD, 0xF0, 0x90, 0x8A, 0xF5, 0x74, -0xFC, 0xF0, 0xA3, 0x74, 0x19, 0xF0, 0x90, 0x8A, -0xA3, 0x74, 0xCC, 0xF0, 0xA3, 0x74, 0xF6, 0xF0, -0x90, 0x86, 0x06, 0x74, 0xE9, 0xF0, 0xA3, 0x74, -0xB1, 0xF0, 0x22, 0x8F, 0x14, 0x7F, 0x02, 0x12, -0x88, 0x67, 0x90, 0x86, 0xAF, 0xE0, 0x45, 0x14, -0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, 0x83, -0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, 0xC0, -0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, 0xC0, -0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, -0x01, 0xC4, 0x74, 0xCA, 0xF0, 0x74, 0xE0, 0xA3, -0xF0, 0x12, 0x6C, 0xD6, 0xE5, 0x25, 0x30, 0xE7, -0x02, 0x31, 0x70, 0x90, 0x86, 0xB3, 0xE0, 0xFC, -0x64, 0x03, 0x70, 0x37, 0x90, 0x99, 0x7B, 0xE0, -0xFE, 0x20, 0xE0, 0x2F, 0xE5, 0x26, 0x30, 0xE3, -0x2A, 0x90, 0x00, 0xCC, 0xE0, 0x44, 0x04, 0xF0, -0x90, 0x00, 0xD4, 0xE0, 0x44, 0x10, 0xF0, 0x90, -0x00, 0xC6, 0xE0, 0x44, 0x02, 0xF0, 0x90, 0x00, -0x01, 0xE0, 0x54, 0xCF, 0xF0, 0x90, 0x00, 0x23, -0xE0, 0x54, 0x7F, 0xF0, 0xEE, 0x44, 0x01, 0x90, -0x99, 0x7B, 0xF0, 0xEC, 0xB4, 0x01, 0x0B, 0xE5, -0x26, 0x30, 0xE2, 0x06, 0x90, 0x88, 0x41, 0x74, -0xDD, 0xF0, 0x74, 0xCA, 0x04, 0x90, 0x01, 0xC4, -0xF0, 0x74, 0xE0, 0xA3, 0xF0, 0xD0, 0x07, 0xD0, -0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, 0xD0, -0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, 0xD0, -0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, 0x32, -0x90, 0x00, 0xAB, 0xE0, 0xFE, 0x90, 0x00, 0xAA, -0x12, 0xBE, 0x88, 0x54, 0x7F, 0x90, 0x9A, 0xD6, -0xF0, 0xA3, 0xEF, 0xF0, 0xE0, 0x30, 0xE1, 0x02, -0x31, 0x8B, 0x22, 0x90, 0x01, 0x8C, 0xE4, 0xF0, -0xA3, 0xF0, 0xA3, 0x74, 0x71, 0xF0, 0xA3, 0x74, -0x02, 0xF0, 0x90, 0x01, 0x95, 0xE0, 0x54, 0xF0, -0x44, 0x07, 0xF0, 0x90, 0x01, 0x01, 0xE0, 0x44, -0x04, 0xF0, 0x22, 0xC0, 0xE0, 0xC0, 0xF0, 0xC0, -0x83, 0xC0, 0x82, 0xC0, 0xD0, 0x75, 0xD0, 0x00, -0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, -0xC0, 0x04, 0xC0, 0x05, 0xC0, 0x06, 0xC0, 0x07, -0x90, 0x01, 0xC4, 0x74, 0xAB, 0xF0, 0x74, 0xE1, -0xA3, 0xF0, 0x90, 0x8A, 0x9D, 0x12, 0x8E, 0xDC, -0x53, 0x91, 0xBF, 0x74, 0xAB, 0x04, 0x90, 0x01, -0xC4, 0xF0, 0x74, 0xE1, 0xA3, 0xF0, 0xD0, 0x07, -0xD0, 0x06, 0xD0, 0x05, 0xD0, 0x04, 0xD0, 0x03, -0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, 0xD0, 0xD0, -0xD0, 0x82, 0xD0, 0x83, 0xD0, 0xF0, 0xD0, 0xE0, -0x32, 0xC0, 0xE0, 0xC0, 0x83, 0xC0, 0x82, 0xC0, -0xD0, 0x75, 0xD0, 0x00, 0xC0, 0x05, 0xC0, 0x07, -0x7D, 0x01, 0x90, 0x01, 0xC4, 0xED, 0xF0, 0x74, -0xE2, 0xFF, 0xA3, 0xF0, 0xED, 0x04, 0x90, 0x01, -0xC4, 0xF0, 0xA3, 0xEF, 0xF0, 0xD0, 0x07, 0xD0, -0x05, 0xD0, 0xD0, 0xD0, 0x82, 0xD0, 0x83, 0xD0, -0xE0, 0x32, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, -0x05, 0x90, 0x8A, 0x8F, 0x80, 0x03, 0x90, 0x8A, -0x87, 0x12, 0x8E, 0xDC, 0x90, 0x88, 0xE6, 0xE0, -0x30, 0xE0, 0x04, 0xA3, 0xE0, 0x04, 0xF0, 0x90, -0x88, 0xE7, 0xE0, 0x64, 0x08, 0x70, 0x20, 0x90, -0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x14, 0x12, 0xC7, -0x7B, 0xE4, 0xFD, 0x12, 0x76, 0xF7, 0x90, 0x88, -0xE6, 0xE0, 0x54, 0xFE, 0xF0, 0xE4, 0xA3, 0xF0, -0x80, 0x05, 0xE4, 0x90, 0x88, 0xE7, 0xF0, 0x90, -0x88, 0xA1, 0x12, 0xD7, 0x95, 0x30, 0xE0, 0x13, -0x90, 0x88, 0xE8, 0xE0, 0x04, 0xF0, 0xE0, 0xB4, -0x14, 0x09, 0x90, 0x04, 0x9C, 0xE4, 0xF0, 0x90, -0x88, 0xE8, 0xF0, 0x90, 0x88, 0x36, 0xE0, 0x70, -0x02, 0x61, 0x1B, 0x90, 0x88, 0x4D, 0xE0, 0x04, -0xF0, 0x90, 0x05, 0x61, 0x12, 0xA3, 0xF5, 0x78, -0x08, 0x12, 0xA7, 0xC4, 0x90, 0x05, 0x60, 0x12, -0xA3, 0xF5, 0x12, 0x84, 0x45, 0xC0, 0x04, 0xC0, -0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x05, 0x62, -0x12, 0xA3, 0xF5, 0x78, 0x10, 0x12, 0x03, 0xFE, -0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, 0x00, -0x12, 0x84, 0x45, 0xC0, 0x04, 0xC0, 0x05, 0xC0, -0x06, 0xC0, 0x07, 0xA3, 0x12, 0xA3, 0xF5, 0x78, -0x18, 0x12, 0x03, 0xFE, 0xD0, 0x03, 0xD0, 0x02, -0xD0, 0x01, 0xD0, 0x00, 0x12, 0x84, 0x45, 0x90, -0x88, 0x81, 0x12, 0x04, 0x31, 0x90, 0x88, 0x32, -0xE0, 0x54, 0x7F, 0xF0, 0xA3, 0xE0, 0x30, 0xE0, -0x0B, 0x12, 0xCC, 0xE5, 0x74, 0x05, 0xF0, 0x12, -0x6E, 0x2F, 0xF1, 0xCD, 0x12, 0x91, 0xDD, 0x30, -0xE0, 0x09, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, -0x02, 0x71, 0x93, 0x71, 0xA1, 0x12, 0xD6, 0x27, -0xE4, 0x90, 0x98, 0x1B, 0xF0, 0x71, 0x82, 0x90, -0x93, 0x24, 0x12, 0xAE, 0xD2, 0x30, 0xE0, 0x51, -0x90, 0x95, 0x63, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x7C, 0x00, 0x7D, 0x64, 0x12, 0x02, 0x92, 0x90, -0x95, 0xB7, 0xE0, 0x6E, 0x70, 0x03, 0xA3, 0xE0, -0x6F, 0x60, 0x0A, 0x90, 0x95, 0xB7, 0xE4, 0x75, -0xF0, 0x01, 0x02, 0x02, 0xE7, 0x90, 0x95, 0x67, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x95, 0x75, -0xE0, 0xB5, 0x06, 0x14, 0xA3, 0xE0, 0xB5, 0x07, -0x0F, 0xEF, 0x4E, 0x60, 0x0B, 0x90, 0x01, 0xC7, -0x74, 0x31, 0xF0, 0x7F, 0x01, 0x02, 0xB2, 0xDD, -0x91, 0x29, 0xE4, 0x90, 0x95, 0xB7, 0xF0, 0xA3, -0xF0, 0x22, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, -0x09, 0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x02, -0x71, 0x93, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, -0x7C, 0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, -0x7E, 0x90, 0x98, 0x1C, 0xE0, 0x20, 0xE0, 0x02, -0x81, 0x28, 0x90, 0x98, 0x20, 0xE0, 0x04, 0xF0, -0x90, 0x98, 0x23, 0xE0, 0x64, 0x01, 0x70, 0x36, -0x90, 0x98, 0x1C, 0x12, 0xD6, 0x89, 0x30, 0xE0, -0x2D, 0x90, 0x98, 0x22, 0xE0, 0x70, 0x27, 0x90, -0x98, 0x1F, 0xE0, 0xFE, 0xA3, 0xE0, 0xC3, 0x9E, -0x40, 0x1C, 0xEF, 0x13, 0x13, 0x13, 0x54, 0x1F, -0x30, 0xE0, 0x09, 0x12, 0xCF, 0xEE, 0x12, 0xB7, -0x4D, 0xF0, 0x80, 0x0A, 0xF1, 0xDD, 0x12, 0xB2, -0xDD, 0x12, 0xB7, 0x4D, 0xF0, 0x22, 0x90, 0x98, -0x20, 0xE0, 0xFF, 0x90, 0x98, 0x1D, 0xE0, 0xD3, -0x9F, 0x50, 0x2D, 0x90, 0x06, 0x92, 0xE0, 0x20, -0xE2, 0x17, 0x90, 0x98, 0x22, 0xE0, 0x70, 0x11, -0x90, 0x8A, 0xAF, 0x12, 0x8F, 0x00, 0x12, 0xFC, -0xDF, 0x90, 0x98, 0x1B, 0xE0, 0x04, 0xF0, 0x80, -0x06, 0x90, 0x06, 0x92, 0x74, 0x04, 0xF0, 0xE4, -0x90, 0x98, 0x20, 0xF0, 0x90, 0x98, 0x22, 0xF0, -0x22, 0xE4, 0x90, 0x9A, 0xDB, 0xF0, 0xA3, 0xF0, -0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, 0xF0, 0x12, -0x76, 0x9B, 0xEF, 0x64, 0x01, 0x70, 0x75, 0x90, -0x98, 0x12, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, -0x0D, 0xF0, 0x7B, 0x08, 0x7D, 0x01, 0x12, 0x66, -0xDB, 0x90, 0x9A, 0xD8, 0xEE, 0xF0, 0xA3, 0xEF, -0xF0, 0x90, 0x9A, 0xD8, 0xD1, 0xD4, 0x90, 0x9A, -0xDA, 0xEF, 0xF0, 0x90, 0x9A, 0xD8, 0x12, 0x9F, -0xF5, 0x7B, 0x01, 0xE4, 0xFD, 0x12, 0xA2, 0x27, -0x90, 0x9A, 0xDA, 0xE0, 0xFF, 0x90, 0x9A, 0xD9, -0xE0, 0x2F, 0xFF, 0x90, 0x9A, 0xD8, 0xE0, 0x34, -0x00, 0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, 0xFE, -0x90, 0x9A, 0xDB, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, -0xF9, 0xDA, 0xD1, 0xA0, 0x90, 0x98, 0x12, 0xE0, -0xFB, 0xE4, 0xFF, 0x91, 0xB5, 0xD1, 0xA0, 0x90, -0x98, 0x0E, 0xE0, 0xFB, 0x7F, 0x11, 0x91, 0xB5, -0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, 0x90, 0x95, -0x75, 0x12, 0xC4, 0x6F, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x36, 0xEC, -0xF1, 0xD5, 0xAA, 0x07, 0x90, 0x9C, 0x3D, 0x12, -0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, 0xD1, 0xBD, -0xEA, 0x24, 0xEF, 0x60, 0x3F, 0x24, 0xD7, 0x70, -0x02, 0xC1, 0x17, 0x24, 0x3A, 0x60, 0x02, 0xC1, -0x5B, 0x90, 0x9C, 0x36, 0xA3, 0xE0, 0xFF, 0x24, -0x0A, 0xD1, 0xC8, 0x12, 0x9F, 0x71, 0xE4, 0x12, -0xBE, 0x6D, 0xE4, 0xF0, 0xFE, 0x74, 0x00, 0x2F, -0xD1, 0x98, 0x7D, 0x14, 0xD1, 0x79, 0x7B, 0x00, -0x7A, 0x00, 0x79, 0x00, 0xD1, 0x8C, 0x90, 0x90, -0xBE, 0x12, 0x04, 0x31, 0x7D, 0x14, 0x7C, 0x00, -0xE4, 0xFF, 0xC1, 0x12, 0x90, 0x9C, 0x36, 0xE4, -0x75, 0xF0, 0x14, 0xD1, 0xA9, 0xFB, 0xFF, 0x24, -0x06, 0xFC, 0xE4, 0x33, 0x90, 0x9C, 0x41, 0xF0, -0xA3, 0xCC, 0xF0, 0x90, 0x9C, 0x41, 0xA3, 0xE0, -0xFE, 0x12, 0x9F, 0x71, 0xE4, 0x12, 0xBE, 0x6D, -0xE4, 0x12, 0xBF, 0x76, 0xFE, 0xA9, 0x03, 0x74, -0x05, 0x29, 0x12, 0xBE, 0x81, 0xFE, 0x90, 0x9C, -0x3B, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x9C, 0x36, -0xE0, 0xFC, 0xA3, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, -0xFE, 0xD3, 0xEF, 0x94, 0x00, 0xEE, 0x94, 0x01, -0x90, 0x9C, 0x36, 0x40, 0x6D, 0xE0, 0xFE, 0xA3, -0xE0, 0xFF, 0xE9, 0x7C, 0x00, 0x24, 0x00, 0xF9, -0xEC, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC3, 0xE4, -0x9F, 0xFD, 0x74, 0x01, 0x9E, 0xFC, 0xD1, 0x7B, -0x90, 0x9C, 0x38, 0xE0, 0x24, 0x01, 0xFF, 0xE4, -0x33, 0xA2, 0xE7, 0x13, 0xEF, 0x13, 0x90, 0xFD, -0x10, 0xF0, 0x90, 0x9C, 0x3D, 0x12, 0x84, 0x52, -0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, 0xC0, 0x03, -0x7B, 0x01, 0x7A, 0xFC, 0x79, 0x00, 0x90, 0x9C, -0x36, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, 0xE4, -0x9F, 0xFF, 0x74, 0x01, 0x9E, 0xFE, 0xD1, 0x84, -0xC3, 0x9F, 0xFD, 0xEC, 0x9E, 0xFC, 0x12, 0x45, -0xC2, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, 0xD0, -0x00, 0x12, 0x83, 0x00, 0xD1, 0x7E, 0xD1, 0xBD, -0x80, 0x0D, 0xA3, 0xE0, 0x7E, 0x00, 0x24, 0x00, -0xD1, 0x98, 0xD1, 0x84, 0xFD, 0xD1, 0x7B, 0x90, -0x9C, 0x36, 0x74, 0xFF, 0x75, 0xF0, 0xEC, 0xD1, -0xA9, 0xFF, 0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, -0x34, 0xFC, 0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, -0x01, 0x74, 0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, -0xFA, 0xD1, 0x8C, 0x90, 0x90, 0xBE, 0x12, 0x04, -0x31, 0xD1, 0x84, 0xFD, 0xD0, 0x01, 0xD0, 0x02, -0x7F, 0x11, 0x12, 0x3C, 0xD9, 0x80, 0x3C, 0x90, -0x9C, 0x36, 0xA3, 0xE0, 0xFF, 0x24, 0x2A, 0xD1, -0xC8, 0x12, 0x9F, 0x71, 0xE4, 0x12, 0xBE, 0x6D, -0xE4, 0xF0, 0x12, 0xEC, 0x74, 0x7D, 0x48, 0xD1, -0x79, 0xD1, 0xB2, 0x90, 0x9C, 0x3D, 0x12, 0x84, -0x52, 0x12, 0x83, 0x00, 0xE4, 0xFD, 0xFC, 0xD1, -0x7E, 0xD1, 0xB2, 0x90, 0x9C, 0x3D, 0x12, 0x84, -0x52, 0x12, 0x83, 0x00, 0xD1, 0x7E, 0xD1, 0x92, -0x12, 0x03, 0xCD, 0x90, 0x9C, 0x39, 0xEE, 0xF0, -0xA3, 0xEF, 0xF0, 0x90, 0x9C, 0x39, 0xE0, 0xFC, -0xA3, 0xE0, 0xFD, 0xEC, 0xFF, 0x90, 0x9C, 0x41, -0xA3, 0xE0, 0xFE, 0x12, 0x9F, 0x71, 0xEF, 0x12, -0xBE, 0x6D, 0xED, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x7C, 0x00, 0x12, 0x45, 0xC2, 0x90, 0x9C, -0x3D, 0x02, 0x04, 0x31, 0x90, 0x9C, 0x3B, 0xE0, -0xFC, 0xA3, 0xE0, 0x22, 0x90, 0x90, 0xBB, 0x12, -0x84, 0x67, 0x90, 0x9C, 0x3D, 0x02, 0x04, 0xB8, -0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, -0x90, 0x9A, 0xDB, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, -0x22, 0x12, 0x02, 0xE7, 0x90, 0x9C, 0x36, 0xA3, -0xE0, 0x22, 0x90, 0x9C, 0x3D, 0x12, 0x04, 0xB8, -0x78, 0x10, 0x02, 0x03, 0xEB, 0x90, 0x9C, 0x38, -0xE0, 0xC3, 0x13, 0x90, 0xFD, 0x10, 0xF0, 0x22, -0xFD, 0xE4, 0x33, 0x90, 0x9C, 0x41, 0xF0, 0xA3, -0xED, 0xF0, 0xFE, 0x22, 0xA3, 0xE0, 0xFE, 0x24, -0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFD, 0x74, 0x2C, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0xE0, 0xFB, 0xE4, 0xFE, 0xEF, 0x30, 0xE7, 0x04, -0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, 0xED, 0x30, -0xE6, 0x09, 0xAF, 0x03, 0x12, 0xF5, 0x1C, 0xAE, -0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, -0x2E, 0xFF, 0x22, 0x90, 0x88, 0x9D, 0xE0, 0x30, -0xE0, 0x6E, 0x90, 0x99, 0x7C, 0xE0, 0x30, 0xE0, -0x4D, 0x90, 0x99, 0x87, 0xE0, 0xFF, 0x90, 0x99, -0x86, 0xE0, 0xC3, 0x9F, 0x40, 0x34, 0x90, 0x99, -0x7D, 0x12, 0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, -0xF0, 0x90, 0x99, 0x7D, 0x12, 0x04, 0xB8, 0x78, -0x08, 0x12, 0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, -0xF0, 0x90, 0x99, 0x7D, 0xD1, 0xB5, 0x90, 0x06, -0xC6, 0xEF, 0xF0, 0x90, 0x99, 0x7D, 0x12, 0x04, -0xB8, 0xF1, 0x91, 0xE4, 0x90, 0x99, 0x86, 0xF0, -0x80, 0x1B, 0xF1, 0x9C, 0xF1, 0x91, 0x90, 0x99, -0x86, 0xE0, 0x04, 0xF0, 0x80, 0x0F, 0x90, 0x99, -0x85, 0xE0, 0x60, 0x09, 0xF1, 0x9C, 0xF1, 0x91, -0xE4, 0x90, 0x99, 0x85, 0xF0, 0x90, 0x8A, 0xBB, -0x12, 0x8F, 0x00, 0xE4, 0xFF, 0x12, 0x04, 0x7E, -0x22, 0x78, 0x18, 0x12, 0x03, 0xEB, 0x90, 0x06, -0xC7, 0xEF, 0xF0, 0x22, 0x90, 0x99, 0x81, 0x12, -0x04, 0xB8, 0x90, 0x06, 0xC4, 0xEF, 0xF0, 0x90, -0x99, 0x81, 0x12, 0x04, 0xB8, 0x78, 0x08, 0x12, -0x03, 0xEB, 0x90, 0x06, 0xC5, 0xEF, 0xF0, 0x90, -0x99, 0x81, 0x12, 0x04, 0xB8, 0x78, 0x10, 0x12, -0x03, 0xEB, 0x90, 0x06, 0xC6, 0xEF, 0xF0, 0x90, -0x99, 0x81, 0x02, 0x04, 0xB8, 0x90, 0x88, 0x33, -0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xF0, 0xA3, 0xED, -0xF0, 0xA3, 0xEB, 0xF0, 0x22, 0x90, 0x01, 0xC7, -0x74, 0x10, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x98, -0x22, 0xE0, 0x04, 0xF0, 0x90, 0x88, 0x39, 0xE0, -0x64, 0x02, 0x60, 0x03, 0x12, 0x90, 0x98, 0x22, +0x24, 0x10, 0xF0, 0x11, 0x35, 0x74, 0x03, 0xF0, +0x12, 0x6E, 0x2F, 0x90, 0x8A, 0xA3, 0x12, 0x97, +0x5E, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x22, 0x90, +0x9A, 0xD2, 0xE0, 0xFE, 0x24, 0xE1, 0xF5, 0x82, +0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0x90, 0x9A, +0xD4, 0x02, 0x04, 0xB8, 0x74, 0x41, 0x2E, 0xF5, +0x82, 0xE4, 0x34, 0x98, 0xF5, 0x83, 0x22, 0x12, +0x04, 0x31, 0x90, 0x88, 0x89, 0x02, 0x04, 0xB8, +0x90, 0x88, 0x91, 0xE0, 0xFD, 0xC3, 0x90, 0x88, +0x90, 0xE0, 0x9D, 0xFD, 0x90, 0x88, 0x8F, 0xE0, +0x94, 0x00, 0xFC, 0xEF, 0xD3, 0x9D, 0xE4, 0x9C, +0x22, 0xE4, 0xFE, 0x51, 0x54, 0xE4, 0xF0, 0x74, +0xE1, 0x2E, 0x51, 0x46, 0x74, 0xFF, 0xF0, 0x0E, +0xEE, 0xB4, 0xA0, 0xEF, 0xE4, 0x90, 0x88, 0x4D, +0xF0, 0x90, 0x88, 0x4C, 0xF0, 0x90, 0x88, 0x50, +0xF0, 0xEF, 0xB4, 0x01, 0x07, 0xA3, 0x74, 0xA0, +0xF0, 0xE4, 0xA3, 0xF0, 0x22, 0xFF, 0xE4, 0x3E, +0xFE, 0xE4, 0x3D, 0xFD, 0xE4, 0x3C, 0xFC, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, -0x88, 0xF0, 0xE0, 0x30, 0xE0, 0x2F, 0x90, 0x88, -0xF7, 0xE0, 0xB4, 0x01, 0x18, 0xA3, 0xE0, 0xB4, -0x01, 0x23, 0x74, 0x02, 0xF0, 0x90, 0x88, 0xFE, -0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x90, 0x8A, 0x7F, -0x12, 0xAE, 0xD9, 0x80, 0x10, 0x90, 0x88, 0xF7, -0xE0, 0xB4, 0x02, 0x09, 0x74, 0x03, 0xF0, 0x90, -0x8A, 0xE7, 0x12, 0x8E, 0xDC, 0xD0, 0xD0, 0x92, -0xAF, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x30, 0xE0, -0x05, 0x90, 0x8A, 0xEB, 0x80, 0x03, 0x90, 0x8A, -0x99, 0x12, 0x8E, 0xDC, 0x90, 0x88, 0xF0, 0xE0, -0x30, 0xE0, 0x06, 0x90, 0x8A, 0xE7, 0x12, 0x8E, -0xDC, 0x22, 0x90, 0x88, 0x31, 0xE0, 0xFF, 0x11, -0xB6, 0x30, 0xE0, 0x21, 0xEF, 0x54, 0x7F, 0x12, -0xD7, 0xBF, 0x30, 0xE1, 0x06, 0xE0, 0x44, 0x02, -0xF0, 0x80, 0x09, 0xE0, 0x54, 0xFD, 0xF0, 0x12, -0xD7, 0xD2, 0x04, 0xF0, 0x90, 0x88, 0x36, 0xE0, -0x60, 0x03, 0x12, 0xD5, 0x2C, 0x12, 0xAE, 0xCF, -0x30, 0xE0, 0x22, 0x90, 0x88, 0xA4, 0xE0, 0xFF, -0xC3, 0x13, 0x30, 0xE0, 0x18, 0xEF, 0x54, 0xFD, -0xF0, 0x90, 0x04, 0xE0, 0xE0, 0x90, 0x88, 0xA4, -0x30, 0xE1, 0x06, 0xE0, 0x44, 0x04, 0xF0, 0x80, -0x04, 0xE0, 0x54, 0xFB, 0xF0, 0x7F, 0x01, 0x02, -0xB7, 0x54, 0x90, 0x93, 0x28, 0xE0, 0xC4, 0x13, -0x13, 0x13, 0x54, 0x01, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xA1, 0x90, 0x99, -0x88, 0xF0, 0x90, 0x88, 0x32, 0x11, 0xB5, 0x30, -0xE0, 0x02, 0x21, 0x81, 0x90, 0x88, 0x31, 0xE0, -0x30, 0xE0, 0x1D, 0x12, 0xC9, 0x7F, 0x33, 0x33, -0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, -0x88, 0x53, 0xE0, 0x24, 0x03, 0x33, 0x33, 0x33, -0x54, 0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, -0x90, 0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, -0x4A, 0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, -0x90, 0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, -0xE0, 0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, -0xEB, 0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, -0x2F, 0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, -0x88, 0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, -0xA3, 0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, -0x90, 0x88, 0x4B, 0x31, 0x8D, 0x90, 0x88, 0x4E, -0x31, 0x96, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, -0x90, 0x88, 0x4E, 0x31, 0x8D, 0x90, 0x88, 0x3E, -0x31, 0x96, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, -0x90, 0x88, 0x4E, 0x12, 0x97, 0x90, 0xFF, 0x7E, -0x00, 0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, 0xEF, -0xF0, 0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, -0xE0, 0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, 0xE0, -0x54, 0xF8, 0x4F, 0xF0, 0x12, 0xE7, 0xCD, 0x80, -0x07, 0x90, 0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, -0x50, 0xFD, 0xE4, 0x33, 0xFC, 0x22, 0xE0, 0xD3, -0x9D, 0xEC, 0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, +0x98, 0x33, 0xE0, 0x60, 0x25, 0x7F, 0x54, 0x7E, +0x09, 0x12, 0x70, 0x70, 0x71, 0x65, 0x12, 0x04, +0xB8, 0xEF, 0x44, 0xFE, 0xFF, 0xEE, 0x44, 0x03, +0xFE, 0xED, 0x44, 0x04, 0xFD, 0xEC, 0x71, 0x65, +0x12, 0xC7, 0xE2, 0x7F, 0x54, 0x7E, 0x09, 0x12, +0x70, 0xAD, 0x90, 0x98, 0x2E, 0xE0, 0x70, 0x29, +0x90, 0x07, 0xCC, 0xE0, 0x30, 0xE0, 0x22, 0xE4, +0xF0, 0x90, 0x99, 0xE4, 0x74, 0x22, 0xF0, 0x90, +0x9A, 0x06, 0x74, 0x01, 0xF0, 0x90, 0x99, 0xE6, +0x74, 0x03, 0xF0, 0x7B, 0x01, 0x7A, 0x99, 0x79, +0xE4, 0x12, 0x97, 0x4C, 0x7F, 0x04, 0x12, 0x04, +0x7E, 0x90, 0x98, 0x36, 0xE0, 0xFF, 0x70, 0x0A, +0x90, 0x98, 0x33, 0xE0, 0x70, 0x04, 0xA3, 0xE0, +0x60, 0x15, 0x90, 0x00, 0x1F, 0xE0, 0x54, 0xF0, +0xF0, 0x90, 0x01, 0xC5, 0x74, 0xEA, 0xF0, 0xA3, +0x74, 0xEF, 0xF0, 0xA3, 0x74, 0xFD, 0xF0, 0xEF, +0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x07, 0xF0, +0x90, 0x98, 0x33, 0xE0, 0x60, 0x06, 0x90, 0x01, +0xC4, 0x74, 0x01, 0xF0, 0x90, 0x98, 0x34, 0xE0, +0x60, 0x06, 0x90, 0x01, 0xC4, 0x74, 0x02, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x99, 0xE0, +0x12, 0x04, 0x31, 0x90, 0x99, 0xE0, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, +0x6A, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, 0x90, 0x9C, +0x69, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, 0x12, 0xD8, +0x81, 0x90, 0x9C, 0x6C, 0xF0, 0x12, 0xDE, 0x81, +0x90, 0x9C, 0x69, 0xE0, 0x90, 0x04, 0x25, 0xF0, +0x90, 0x9C, 0x6A, 0xE0, 0x60, 0x06, 0x91, 0x26, +0xE0, 0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, +0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, +0xE0, 0x54, 0xC0, 0xF0, 0x91, 0x26, 0xE0, 0x54, +0xC0, 0xF0, 0x90, 0x9C, 0x6C, 0xE0, 0xFF, 0xAE, +0x05, 0x74, 0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, +0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, +0xE0, 0xD3, 0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, +0xF0, 0xAF, 0x05, 0x91, 0x67, 0xE0, 0x54, 0x01, +0xFE, 0x90, 0x9C, 0x6B, 0xE0, 0x25, 0xE0, 0x25, +0xE0, 0xFB, 0xEE, 0x44, 0x02, 0x4B, 0x91, 0x66, +0xEE, 0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, +0x34, 0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, +0x29, 0x2F, 0xB1, 0x0D, 0x54, 0xF7, 0xF0, 0x74, +0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, +0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x21, +0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, +0x22, 0x90, 0x9C, 0x62, 0xE0, 0xFE, 0xA3, 0xE0, +0xFF, 0x90, 0x8A, 0x9B, 0xE0, 0xFC, 0xA3, 0xE0, +0xFD, 0xF5, 0x82, 0x8C, 0x83, 0x12, 0x04, 0x7E, +0x90, 0x9C, 0x62, 0xA3, 0xE0, 0xFF, 0x24, 0x12, +0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, +0x54, 0x01, 0xFE, 0x90, 0x9C, 0x61, 0xE0, 0x25, +0xE0, 0x25, 0xE0, 0x44, 0x02, 0x4E, 0xFE, 0x74, +0x12, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x9C, 0x60, 0xEF, 0xF0, 0xA3, 0xED, +0xF0, 0x90, 0x86, 0xB1, 0xE0, 0x04, 0xF0, 0x90, +0x04, 0x1D, 0xE0, 0x60, 0x2E, 0x90, 0x05, 0x22, +0xE0, 0x90, 0x9C, 0x64, 0xF0, 0x7B, 0x26, 0x12, +0x91, 0xB3, 0xEF, 0x64, 0x01, 0x70, 0x09, 0x91, +0xE5, 0x12, 0x8F, 0xBD, 0x91, 0x31, 0xEE, 0xF0, +0x90, 0x9C, 0x64, 0xE0, 0xFD, 0x7B, 0x27, 0xE4, +0xFF, 0x12, 0x9C, 0x0E, 0x91, 0xD3, 0x12, 0x04, +0x7E, 0x80, 0x0E, 0x91, 0xD3, 0x12, 0x04, 0x7E, +0x91, 0xE5, 0x12, 0x8F, 0xBD, 0x91, 0x31, 0xEE, +0xF0, 0x12, 0x9D, 0xB8, 0x7F, 0x01, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0x90, 0x9C, 0x60, 0xE0, 0xFF, +0x90, 0x8A, 0xC7, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, +0xF5, 0x82, 0x8C, 0x83, 0x22, 0x90, 0x86, 0xB6, +0xE0, 0xFF, 0x90, 0x9C, 0x61, 0xE0, 0xFB, 0x90, +0x92, 0x13, 0x74, 0x0A, 0xF0, 0x7D, 0x01, 0x12, +0x66, 0xDB, 0x90, 0x9C, 0x62, 0xEE, 0xF0, 0xFC, +0xA3, 0xEF, 0xF0, 0xFD, 0x90, 0x9C, 0x60, 0xE0, +0xFF, 0x90, 0x8A, 0x95, 0x22, 0xF5, 0x82, 0xE4, +0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0x90, 0x98, +0x16, 0x12, 0x9F, 0xEE, 0xEF, 0xF0, 0xE0, 0xFE, +0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xB1, 0x0D, +0xFD, 0x90, 0x99, 0x85, 0xE0, 0x24, 0x2C, 0x12, +0xE5, 0x1A, 0x90, 0x99, 0x85, 0xE0, 0x2F, 0x24, +0x30, 0xA3, 0xF0, 0xE0, 0xFD, 0x24, 0x04, 0x12, +0xDE, 0x8D, 0xE0, 0xFE, 0x74, 0x05, 0x2D, 0xF1, +0xD7, 0xF1, 0x24, 0x90, 0x95, 0x71, 0xF0, 0xA3, +0xEF, 0xF0, 0x90, 0x99, 0x86, 0xE0, 0x24, 0x0C, +0xF9, 0xE4, 0x34, 0xFC, 0x12, 0x9F, 0x88, 0x75, +0x48, 0x04, 0x7B, 0x01, 0x7A, 0x95, 0x79, 0x73, +0x12, 0x69, 0xF5, 0x90, 0x99, 0x86, 0xE0, 0x24, +0x14, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0xF1, 0x6A, +0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xB1, 0xE1, 0xF1, +0x24, 0x90, 0x95, 0x77, 0xF0, 0xA3, 0xEF, 0xF0, +0x90, 0x98, 0x17, 0x12, 0x9F, 0xEE, 0xEF, 0xF0, +0x90, 0x95, 0x6D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, +0x4E, 0x60, 0x11, 0x90, 0x99, 0x85, 0x12, 0x9F, +0x81, 0x8F, 0x48, 0x7B, 0x01, 0x7A, 0x95, 0x79, +0x7B, 0x12, 0x69, 0xF5, 0x90, 0x98, 0x18, 0x12, +0x9F, 0xEE, 0xEF, 0xF0, 0x12, 0x9F, 0x82, 0x90, +0x95, 0x6F, 0xA3, 0xE0, 0xF5, 0x48, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x9B, 0x02, 0x69, 0xF5, 0x12, +0x80, 0xC0, 0xA8, 0x04, 0xA9, 0x05, 0xAA, 0x06, +0xAB, 0x07, 0x90, 0x99, 0x85, 0xA3, 0xE0, 0x24, +0x00, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x9C, 0x1E, 0xED, 0xF0, 0x90, 0x9C, 0x1D, +0xEF, 0xF0, 0x12, 0x7B, 0x07, 0x90, 0x9C, 0x2B, +0xEF, 0xF0, 0xE0, 0xFD, 0x24, 0x01, 0xF1, 0x6A, +0xE0, 0xFE, 0x74, 0x00, 0x2D, 0xB1, 0xE1, 0xF1, +0x24, 0x54, 0x3F, 0x90, 0x9C, 0x28, 0xF0, 0xA3, +0xEF, 0xF0, 0xE4, 0x90, 0x9C, 0x27, 0xF0, 0xF1, +0x45, 0x50, 0x09, 0xF1, 0xA2, 0xB1, 0xDE, 0xE4, +0xF1, 0x2D, 0x80, 0xF3, 0x90, 0x9C, 0x29, 0xE0, +0x24, 0xF8, 0xFB, 0x90, 0x9C, 0x28, 0xE0, 0x34, +0xFF, 0xFA, 0x90, 0x9C, 0x1E, 0xE0, 0xFF, 0x90, +0x91, 0xDC, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, +0x74, 0x01, 0xF0, 0x7D, 0x0A, 0x7C, 0x00, 0x7F, +0x10, 0x7E, 0x00, 0x12, 0x6D, 0xED, 0x90, 0x98, +0x0F, 0xE0, 0xFF, 0x90, 0x9C, 0x1D, 0xE0, 0xFD, +0xD3, 0x9F, 0x40, 0x36, 0x90, 0x98, 0x0F, 0xE0, +0xFC, 0xF1, 0x7D, 0xCE, 0xC3, 0x13, 0xCE, 0x13, +0xD8, 0xF9, 0xF1, 0x4E, 0xEC, 0xFF, 0xC3, 0xED, +0xF1, 0x5A, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, +0xF9, 0x24, 0x28, 0xFF, 0xE4, 0x3E, 0xFE, 0xF1, +0x3D, 0xFD, 0x90, 0x9C, 0x1E, 0xE0, 0xFC, 0xC3, +0xED, 0x9C, 0xF1, 0x35, 0x7D, 0x38, 0x7C, 0x00, +0x80, 0x35, 0x90, 0x9C, 0x1D, 0xE0, 0xFD, 0xF1, +0x7D, 0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, +0xF1, 0x4E, 0xED, 0xFF, 0x90, 0x98, 0x0F, 0xF1, +0x58, 0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, +0x24, 0x38, 0xFD, 0xE4, 0x3E, 0xFC, 0xF1, 0x3D, +0xFF, 0x90, 0x9C, 0x1E, 0xE0, 0xFE, 0xC3, 0xEF, +0x9E, 0xF1, 0x35, 0x7F, 0x28, 0x7E, 0x00, 0x12, +0x71, 0xD4, 0xF1, 0xD0, 0x90, 0x91, 0x45, 0x12, +0x82, 0x27, 0x0B, 0x7A, 0x9C, 0x79, 0x1F, 0x90, +0x91, 0x48, 0x12, 0x82, 0x27, 0x90, 0x91, 0x4B, +0x74, 0x08, 0xF0, 0x7A, 0x94, 0x79, 0x31, 0x12, +0x4E, 0xA5, 0xE4, 0x90, 0x9C, 0x27, 0xF0, 0xF1, +0x45, 0x50, 0x1B, 0xF1, 0xA2, 0x90, 0x9C, 0x27, +0xE0, 0x24, 0x1F, 0xF5, 0x82, 0xE4, 0x34, 0x9C, +0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x9C, 0x2A, 0xB1, +0xDE, 0xEF, 0xF1, 0x2D, 0x80, 0xE1, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xF0, 0x90, 0x01, 0x17, 0xE0, +0xFE, 0x90, 0x01, 0x16, 0xE0, 0x7C, 0x00, 0x24, +0x00, 0xFF, 0xEC, 0x3E, 0x22, 0xF0, 0x90, 0x9C, +0x27, 0xE0, 0x04, 0xF0, 0x22, 0xFB, 0x90, 0x92, +0x06, 0x74, 0x08, 0xF0, 0x22, 0x90, 0x9C, 0x28, +0xA3, 0xE0, 0x24, 0xF8, 0x22, 0x90, 0x9C, 0x27, +0xE0, 0xFF, 0xC3, 0x94, 0x08, 0x22, 0xFF, 0x90, +0x92, 0x07, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x22, +0xE0, 0xC3, 0x9F, 0xFF, 0xE4, 0x94, 0x00, 0xFE, +0xEF, 0x78, 0x07, 0x22, 0x74, 0x03, 0xF0, 0x74, +0x01, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0x22, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x54, +0x1E, 0x90, 0x98, 0x10, 0xE0, 0x75, 0xF0, 0x80, +0xA4, 0xAE, 0xF0, 0x78, 0x03, 0x22, 0xE4, 0xFD, +0x7F, 0x03, 0x12, 0x54, 0x1E, 0x90, 0x01, 0x85, +0xE0, 0x54, 0xFE, 0xF0, 0xF1, 0x72, 0xCE, 0xC3, +0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xF1, 0xDF, 0x02, +0x54, 0x1E, 0x90, 0x9C, 0x2B, 0xE0, 0xFD, 0x90, +0x9C, 0x29, 0xE0, 0x2D, 0xFD, 0x90, 0x9C, 0x28, +0xE0, 0x34, 0x00, 0xCD, 0x24, 0x20, 0xCD, 0x34, +0x00, 0xFC, 0x7E, 0x00, 0xED, 0x2F, 0xFF, 0xEE, +0x3C, 0xFE, 0x90, 0x9C, 0x1D, 0xE0, 0xFD, 0x12, +0x7B, 0x8B, 0x90, 0x9C, 0x2A, 0xEF, 0xF0, 0x22, +0x7B, 0x00, 0x7A, 0x00, 0x79, 0x00, 0x22, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x22, 0xFF, +0x12, 0x77, 0xA4, 0x7D, 0x01, 0x7F, 0x03, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, +0xD0, 0x6A, 0xFD, 0xEC, 0x90, 0x9C, 0x71, 0x12, +0x04, 0x31, 0x90, 0x9C, 0x71, 0x12, 0xC7, 0xE2, +0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, 0xAD, 0x11, +0x75, 0xF0, 0x7D, 0x01, 0x12, 0x76, 0xF7, 0x12, +0x91, 0xBA, 0x90, 0x06, 0xB7, 0x74, 0x11, 0xF0, +0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, 0x6A, 0x90, +0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, 0xF1, 0x90, +0x07, 0xD5, 0xE0, 0x44, 0x80, 0xF0, 0x7F, 0x0A, +0x80, 0x09, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, +0x09, 0x7F, 0x01, 0x7E, 0x00, 0x12, 0x7C, 0x6A, +0x80, 0xF0, 0x11, 0x62, 0x90, 0x01, 0x00, 0x74, +0x3F, 0xF0, 0xA3, 0xE0, 0x54, 0xFD, 0xF0, 0x90, +0x05, 0x53, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x07, +0xD5, 0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0x90, 0x00, 0x02, 0xE0, 0x54, 0xFE, +0xF0, 0x22, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, +0x70, 0xED, 0x44, 0x80, 0x22, 0x90, 0x93, 0x46, +0xE0, 0xFF, 0x90, 0x93, 0x45, 0xE0, 0xFB, 0x90, +0x93, 0x47, 0xE0, 0x90, 0x92, 0x90, 0x22, 0xE4, +0x90, 0x9C, 0x81, 0xF0, 0xA3, 0xF0, 0x90, 0x05, +0x22, 0xE0, 0x90, 0x9C, 0x83, 0xF0, 0x7B, 0x47, +0x7D, 0xFF, 0xE4, 0xFF, 0x12, 0x9C, 0x0E, 0x90, +0x05, 0xF8, 0xE0, 0x70, 0x1B, 0xA3, 0xE0, 0x70, +0x17, 0xA3, 0xE0, 0x70, 0x13, 0xA3, 0xE0, 0x70, +0x0F, 0x90, 0x9C, 0x83, 0xE0, 0xFD, 0x7B, 0x48, +0xE4, 0xFF, 0x12, 0x9C, 0x0E, 0x7F, 0x01, 0x22, +0xD3, 0x90, 0x9C, 0x82, 0xE0, 0x94, 0xE8, 0x90, +0x9C, 0x81, 0xE0, 0x94, 0x03, 0x40, 0x16, 0x90, +0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, 0x90, 0x9C, +0x83, 0xE0, 0xFD, 0x7B, 0x5B, 0xE4, 0xFF, 0x12, +0x9C, 0x0E, 0x7F, 0x00, 0x22, 0x7F, 0x32, 0x7E, +0x00, 0x12, 0x7C, 0x6A, 0x90, 0x9C, 0x81, 0xE4, +0x75, 0xF0, 0x01, 0x12, 0x02, 0xE7, 0x80, 0xA7, +0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, +0xF0, 0x12, 0xBB, 0x98, 0x90, 0x01, 0x98, 0xE0, +0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, +0x01, 0x22, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, +0x0B, 0x90, 0x8A, 0xE5, 0x12, 0x97, 0x5E, 0x7F, +0x10, 0x12, 0x04, 0x7E, 0x22, 0x90, 0x8A, 0x75, +0x12, 0x91, 0xBD, 0x90, 0x8A, 0xE5, 0x12, 0x97, +0x5E, 0x7F, 0x02, 0x02, 0x04, 0x7E, 0x90, 0x01, +0xCF, 0xE0, 0x90, 0x9A, 0xCF, 0xF0, 0xE0, 0xFF, +0x30, 0xE0, 0x07, 0x90, 0x01, 0xCF, 0xE0, 0x54, +0xFE, 0xF0, 0xEF, 0x30, 0xE5, 0x23, 0x90, 0x01, +0xCF, 0xE0, 0x54, 0xDF, 0xF0, 0x90, 0x01, 0x34, +0x74, 0x20, 0xF0, 0xE4, 0xF5, 0xA8, 0xF5, 0xE8, +0x12, 0x76, 0x6D, 0x90, 0x00, 0x03, 0xE0, 0x54, +0xFB, 0xFD, 0x7F, 0x03, 0x12, 0x7B, 0x2E, 0x80, +0xFE, 0x22, 0x90, 0x8A, 0xE5, 0x12, 0x97, 0x5E, +0x7F, 0x80, 0x02, 0x04, 0x7E, 0x7F, 0x58, 0x7E, +0x0C, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x9B, 0xF9, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, +0x12, 0x70, 0x70, 0x90, 0x9C, 0x03, 0x12, 0x04, +0x31, 0x90, 0x9B, 0xFB, 0x12, 0x04, 0xB8, 0x12, +0x03, 0xCD, 0x90, 0x9C, 0x03, 0x12, 0x82, 0x12, +0x12, 0x81, 0xF8, 0xC0, 0x04, 0xC0, 0x05, 0xC0, +0x06, 0xC0, 0x07, 0x90, 0x9B, 0xFB, 0x12, 0x04, +0xB8, 0x90, 0x9B, 0xFF, 0x12, 0x82, 0x12, 0x12, +0x81, 0xF8, 0xD0, 0x03, 0xD0, 0x02, 0xD0, 0x01, +0xD0, 0x00, 0x12, 0x82, 0x05, 0x90, 0x9C, 0x07, +0x12, 0x04, 0x31, 0x90, 0x9C, 0x07, 0x12, 0xC7, +0xE2, 0x90, 0x9B, 0xF9, 0xE0, 0xFE, 0xA3, 0xE0, +0xFF, 0x12, 0x70, 0xAD, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x90, 0x9C, 0x93, 0xED, 0xF0, 0xE4, 0xA3, 0xF0, +0xEF, 0x14, 0x60, 0x02, 0x41, 0xCF, 0x90, 0x06, +0x03, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x9C, 0x93, +0xE0, 0xFB, 0xC4, 0x33, 0x54, 0xE0, 0xFE, 0x90, +0x04, 0x42, 0xE0, 0x54, 0x9F, 0x4E, 0xFE, 0xF0, +0xE4, 0xFD, 0xF1, 0xC1, 0x90, 0x9C, 0x94, 0xEF, +0xF0, 0x90, 0x04, 0x83, 0xF0, 0x90, 0x9B, 0xFB, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, 0x90, +0x9B, 0xFF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0x01, 0x71, 0x34, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x00, 0x01, 0x90, 0x9B, 0xFF, 0x12, 0x04, 0x3D, +0x00, 0x00, 0x00, 0x01, 0x7F, 0x00, 0x7E, 0x09, +0x71, 0x38, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0x10, 0x90, 0x9C, 0x93, 0x12, 0xB5, 0x5C, 0xEF, +0x54, 0x03, 0xFF, 0xE4, 0x78, 0x01, 0x12, 0x03, +0xEB, 0x78, 0x04, 0x91, 0x19, 0x7F, 0x00, 0x7E, +0x0A, 0x71, 0x38, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x0C, 0x00, 0x90, 0x9C, 0x93, 0x12, 0xB5, 0x5C, +0xEF, 0x54, 0x03, 0xFF, 0xE4, 0x78, 0x0A, 0x91, +0x19, 0x7F, 0x00, 0x7E, 0x0D, 0x71, 0x38, 0x12, +0x04, 0x3D, 0x0C, 0x00, 0x00, 0x00, 0x90, 0x9C, +0x94, 0x12, 0xB5, 0x5C, 0xEF, 0x54, 0x03, 0xFF, +0xE4, 0x78, 0x1A, 0x91, 0x19, 0x7F, 0x18, 0x71, +0x36, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, +0x90, 0x9B, 0xFF, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x00, 0x00, 0x91, 0x22, 0x12, 0x04, 0x3D, 0x00, +0x00, 0x0C, 0x00, 0x90, 0x9B, 0xED, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x04, 0x00, 0x80, 0x58, 0x90, +0x06, 0x03, 0xE0, 0x44, 0x04, 0xF0, 0x90, 0x9B, +0xFB, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x01, +0x90, 0x9B, 0xFF, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x00, 0x00, 0x71, 0x34, 0x12, 0x04, 0x3D, 0x00, +0x00, 0x00, 0x01, 0x90, 0x9B, 0xFF, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x00, 0x7F, 0x00, 0x7E, +0x09, 0x71, 0x38, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x0C, 0x00, 0x90, 0x9B, 0xFF, 0x12, 0x04, 0x3D, +0x00, 0x00, 0x0C, 0x00, 0x91, 0x22, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x0C, 0x00, 0x90, 0x9B, 0xED, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x0C, 0x00, 0x7D, +0x18, 0x7C, 0x00, 0xE4, 0xFF, 0xB1, 0x9A, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x7F, 0x00, 0x7E, 0x08, +0x31, 0x81, 0x90, 0x9B, 0xFB, 0x22, 0x7F, 0x50, +0x7E, 0x0C, 0x12, 0x70, 0x70, 0x90, 0x9A, 0xDF, +0xEF, 0xF0, 0x7F, 0x58, 0x7E, 0x0C, 0x12, 0x70, +0x70, 0x90, 0x9A, 0xE0, 0xEF, 0xF0, 0x90, 0x9B, +0xFB, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, +0x90, 0x9B, 0xFF, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x00, 0x17, 0x7F, 0x50, 0x7E, 0x0C, 0x71, 0x38, +0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, +0x9B, 0xFF, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0x17, 0x31, 0x7D, 0x90, 0x06, 0x08, 0xE0, 0x90, +0x9A, 0xF5, 0xF0, 0x90, 0x06, 0xA1, 0xE0, 0xFE, +0x90, 0x06, 0xA0, 0x12, 0xCF, 0x24, 0x90, 0x9A, +0xF7, 0xF0, 0xA3, 0xEF, 0xF1, 0x7B, 0x90, 0x06, +0xA0, 0x74, 0x20, 0xF0, 0xA3, 0x74, 0x01, 0xF0, +0xE4, 0xFD, 0xFF, 0x21, 0xE9, 0x90, 0x93, 0x04, +0x12, 0xBF, 0xBA, 0x30, 0xE0, 0x08, 0xD1, 0xBF, +0xF0, 0xE4, 0x90, 0x9A, 0xF9, 0xF0, 0x90, 0x9B, +0xFB, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x7F, +0x90, 0x9A, 0xDF, 0x12, 0xB5, 0x5C, 0x91, 0x1C, +0x7F, 0x50, 0x7E, 0x0C, 0x71, 0x38, 0x12, 0x04, +0x3D, 0x00, 0x00, 0x00, 0x7F, 0x90, 0x9A, 0xE0, +0x12, 0xB5, 0x5C, 0x91, 0x1C, 0x31, 0x7D, 0x90, +0x9A, 0xF5, 0xE0, 0x90, 0x06, 0x08, 0xF0, 0x90, +0x9A, 0xF7, 0xA3, 0xE0, 0x90, 0x06, 0xA0, 0xF0, +0xA3, 0xE4, 0xF0, 0x90, 0x9A, 0xE3, 0xE0, 0xFF, +0x60, 0x05, 0xA3, 0xE0, 0xFD, 0x31, 0xE9, 0x90, +0x9A, 0xE2, 0xE0, 0xFF, 0x60, 0x0A, 0xA3, 0xE0, +0xFD, 0xA3, 0xE0, 0xFB, 0xD1, 0x65, 0xB1, 0x30, +0x22, 0x12, 0x03, 0xFE, 0x90, 0x9B, 0xFF, 0x02, +0x04, 0x31, 0x7F, 0x84, 0x7E, 0x08, 0x31, 0x81, +0x90, 0x9B, 0xE9, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xF1, 0xE0, 0xFF, +0x12, 0xF0, 0x64, 0xEF, 0x70, 0x02, 0x81, 0xE4, +0x90, 0x9A, 0xF2, 0xE0, 0xFB, 0xD3, 0x94, 0x00, +0x40, 0x18, 0x90, 0x9B, 0xFB, 0x12, 0x04, 0x3D, +0x00, 0x00, 0x00, 0x0F, 0xAF, 0x03, 0xE4, 0xFC, +0xFD, 0xFE, 0x91, 0x1C, 0x7F, 0x08, 0x7E, 0x0E, +0x31, 0x81, 0x90, 0x9A, 0xF1, 0xE0, 0xFF, 0x90, +0x06, 0x33, 0xF0, 0xD1, 0x65, 0xE4, 0xFB, 0xFD, +0xB1, 0x30, 0x90, 0x9A, 0xF4, 0xE0, 0x60, 0x07, +0x90, 0x93, 0x05, 0xE0, 0xFF, 0xD1, 0x2F, 0x12, +0xAF, 0xEA, 0x30, 0xE0, 0x39, 0x90, 0x95, 0xBE, +0xE0, 0x60, 0x33, 0xE4, 0x90, 0x9A, 0x0A, 0xF0, +0x90, 0x95, 0xBE, 0xE0, 0xFF, 0x90, 0x9A, 0x0A, +0xE0, 0xC3, 0x9F, 0x50, 0x21, 0x7F, 0x03, 0x7E, +0x00, 0x12, 0x7A, 0xAE, 0x90, 0x9A, 0x0A, 0xE0, +0x24, 0xFD, 0xF1, 0x6B, 0xE0, 0xFF, 0xD1, 0x2F, +0x90, 0x01, 0xA6, 0xE0, 0x04, 0xF0, 0x90, 0x9A, +0x0A, 0xE0, 0x04, 0xF0, 0x80, 0xD2, 0x90, 0x9A, +0xF3, 0xE0, 0x90, 0x9A, 0x09, 0xF0, 0x90, 0x9A, +0xDE, 0xE0, 0x04, 0xF0, 0xE0, 0xFF, 0x12, 0xF0, +0x2E, 0x90, 0x9A, 0x09, 0x12, 0xB5, 0x5C, 0x90, +0x9C, 0x55, 0x12, 0x04, 0x31, 0xF1, 0x73, 0x12, +0xAD, 0x6A, 0x80, 0x47, 0xE4, 0x90, 0x9A, 0xDE, +0xF0, 0x90, 0x9B, 0x5D, 0xF0, 0x90, 0x06, 0x32, +0xE0, 0x54, 0xFB, 0xF0, 0x71, 0xAD, 0xE4, 0xFF, +0x12, 0x78, 0x4A, 0xBF, 0x01, 0x13, 0x90, 0x9A, +0xF6, 0xE0, 0xFD, 0x90, 0x8A, 0x89, 0x12, 0x97, +0x5E, 0x7F, 0x02, 0x12, 0x04, 0x7E, 0x12, 0x7B, +0xAD, 0x90, 0x9A, 0x0B, 0x74, 0x07, 0xF0, 0x90, +0x9A, 0x2D, 0xF0, 0x7B, 0x01, 0x7A, 0x9A, 0x79, +0x0B, 0x12, 0x97, 0x4C, 0x7F, 0x04, 0x12, 0x04, +0x7E, 0xD1, 0x6E, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, +0x9C, 0x75, 0xEF, 0xF0, 0xED, 0x64, 0x01, 0x70, +0x2E, 0xEB, 0xB4, 0x01, 0x07, 0xE0, 0x24, 0x02, +0xF5, 0x13, 0x80, 0x08, 0x90, 0x9C, 0x75, 0xE0, +0x24, 0xFE, 0xF5, 0x13, 0x90, 0x9B, 0xE9, 0x12, +0x04, 0x3D, 0x00, 0x00, 0x00, 0xFF, 0xAF, 0x13, +0xD1, 0x20, 0xD1, 0x18, 0x12, 0x04, 0x3D, 0x00, +0x00, 0x00, 0xFF, 0xAF, 0x13, 0x80, 0x20, 0x90, +0x9B, 0xE9, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, +0xFF, 0x90, 0x9C, 0x75, 0x12, 0xB5, 0x5C, 0xD1, +0x24, 0xD1, 0x18, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x00, 0xFF, 0x90, 0x9C, 0x75, 0xE0, 0xFF, 0xD1, +0x20, 0x7F, 0x01, 0xB1, 0x9A, 0xD0, 0xD0, 0x92, +0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x9B, 0xE7, 0xEC, 0xF0, 0xA3, 0xED, +0xF0, 0x90, 0x9B, 0xE6, 0xEF, 0xF0, 0xA3, 0xA3, +0xE0, 0xFD, 0x12, 0x7B, 0xBD, 0x90, 0x9B, 0xF1, +0x12, 0x04, 0x31, 0x90, 0x9B, 0xE9, 0x12, 0x04, +0xB8, 0x12, 0x03, 0xCD, 0x90, 0x9B, 0xF1, 0x12, +0x82, 0x12, 0x12, 0x81, 0xF8, 0xC0, 0x04, 0xC0, +0x05, 0xC0, 0x06, 0xC0, 0x07, 0x90, 0x9B, 0xE9, +0x12, 0x04, 0xB8, 0x90, 0x9B, 0xED, 0x12, 0x82, +0x12, 0x12, 0x81, 0xF8, 0xD0, 0x03, 0xD0, 0x02, +0xD0, 0x01, 0xD0, 0x00, 0x12, 0x82, 0x05, 0x90, +0x9B, 0xF5, 0x12, 0x04, 0x31, 0x90, 0x9B, 0xE7, +0xA3, 0xE0, 0xFD, 0xC0, 0x05, 0x90, 0x9B, 0xF5, +0x12, 0x04, 0xB8, 0x90, 0x8B, 0x9F, 0x12, 0x04, +0x31, 0x90, 0x9B, 0xE6, 0xE0, 0xFF, 0xD0, 0x05, +0x12, 0x79, 0x53, 0xD0, 0xD0, 0x92, 0xAF, 0x22, +0xE4, 0xFF, 0xB1, 0x9A, 0x90, 0x9B, 0xE9, 0x22, +0xE4, 0xFC, 0xFD, 0xFE, 0x90, 0x9B, 0xED, 0x12, +0x04, 0x31, 0x7D, 0x18, 0x7C, 0x00, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, +0x2E, 0xEF, 0xF0, 0x12, 0x76, 0x9B, 0xBF, 0x01, +0x1F, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x08, 0xF0, +0x90, 0x9A, 0x2E, 0xE0, 0xFF, 0x90, 0x92, 0x13, +0x74, 0x07, 0x12, 0x9F, 0xBA, 0x90, 0x9A, 0x2F, +0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0x9D, 0xB8, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x9A, 0xE9, +0xE0, 0x90, 0x9C, 0x78, 0xF0, 0x22, 0x90, 0x93, +0x04, 0x12, 0x89, 0xF1, 0x30, 0xE0, 0x31, 0xEF, +0xC4, 0x54, 0x0F, 0x20, 0xE0, 0x25, 0xF1, 0x98, +0x60, 0x0B, 0xF1, 0x8E, 0x40, 0x07, 0xD1, 0xB7, +0x90, 0x95, 0xC9, 0x80, 0x05, 0xD1, 0xB7, 0x90, +0x95, 0xC1, 0x12, 0x82, 0x12, 0x12, 0x80, 0xDB, +0x90, 0x9C, 0x55, 0x12, 0x04, 0x31, 0x12, 0xAD, +0x63, 0x80, 0x05, 0x7F, 0x01, 0x12, 0x87, 0xFA, +0x90, 0x93, 0x04, 0xE0, 0xC3, 0x13, 0x30, 0xE0, +0x05, 0x7F, 0x01, 0x12, 0x87, 0xFA, 0x22, 0xE4, +0x7F, 0xE8, 0x7E, 0x03, 0xFD, 0xFC, 0x22, 0x90, +0x02, 0x86, 0xE0, 0x54, 0xFB, 0x22, 0xE4, 0xFD, +0xFC, 0x90, 0x01, 0x1D, 0xE0, 0xFE, 0x90, 0x01, +0x1C, 0xF1, 0xB9, 0x3E, 0x90, 0x9C, 0x79, 0xF0, +0xA3, 0xEF, 0xF1, 0x84, 0xE0, 0x24, 0x00, 0xFF, +0xEA, 0x3E, 0x90, 0x9C, 0x7B, 0xF0, 0xA3, 0xEF, +0xF0, 0xF1, 0x5B, 0x90, 0x9C, 0x79, 0xE0, 0xFA, +0xA3, 0xE0, 0xFB, 0xB5, 0x07, 0x06, 0xEA, 0xB5, +0x06, 0x02, 0x80, 0x40, 0xF1, 0x5B, 0xD3, 0xEB, +0x9F, 0xEA, 0x9E, 0x40, 0x0E, 0x90, 0x9C, 0x7A, +0xE0, 0x9F, 0xFD, 0x90, 0x9C, 0x79, 0xE0, 0x9E, +0xFC, 0x80, 0x29, 0xF1, 0x5B, 0xC3, 0x90, 0x9C, +0x7A, 0xE0, 0x9F, 0x90, 0x9C, 0x79, 0xE0, 0x9E, +0x50, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xC3, +0x90, 0x9C, 0x7C, 0xE0, 0x9F, 0xFF, 0x90, 0x9C, +0x7B, 0xE0, 0x9E, 0xFE, 0xC3, 0xE4, 0x9F, 0xFD, +0x74, 0x40, 0x9E, 0xFC, 0xD3, 0xED, 0x94, 0x00, +0xEC, 0x94, 0x38, 0x40, 0x04, 0xD1, 0xBF, 0xF0, +0x22, 0xC3, 0xEC, 0x94, 0x08, 0x50, 0x0B, 0xED, +0x94, 0x00, 0xEC, 0x94, 0x00, 0x40, 0x03, 0xF1, +0x64, 0xF0, 0x22, 0x90, 0x9C, 0x7B, 0xE0, 0xFE, +0xA3, 0xE0, 0xFF, 0x22, 0x90, 0x02, 0x86, 0xE0, +0x44, 0x04, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0x95, +0xF5, 0x83, 0x22, 0xE4, 0x90, 0x9C, 0x59, 0xF0, +0x7F, 0x04, 0x22, 0xF0, 0x90, 0x06, 0x08, 0xE0, +0x54, 0x7F, 0xF0, 0x22, 0xF0, 0x90, 0x01, 0x1F, +0xE0, 0xFE, 0x90, 0x01, 0x1E, 0x22, 0x90, 0x98, +0x05, 0x12, 0x82, 0x12, 0xD3, 0x02, 0x03, 0xDA, +0x90, 0x95, 0xC5, 0x12, 0x04, 0xB8, 0xEC, 0x4D, +0x4E, 0x4F, 0x22, 0x74, 0x01, 0x2D, 0xF5, 0x82, +0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, 0xFE, 0x74, +0x00, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, +0x83, 0xE0, 0x7A, 0x00, 0x24, 0x00, 0xFF, 0xEA, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0xE4, 0xFE, 0xFD, 0xEF, 0xB4, 0x01, 0x0D, 0xEB, +0xB4, 0x02, 0x03, 0x0D, 0x80, 0x06, 0xEB, 0xB4, +0x01, 0x02, 0x7D, 0x02, 0xAF, 0x06, 0xEF, 0xC4, +0x54, 0xF0, 0x4D, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0xE4, 0x90, 0x9A, 0xDA, 0xF0, 0xA3, 0xF0, +0x7F, 0x83, 0x12, 0x7B, 0x41, 0x90, 0x9A, 0xD9, +0xEF, 0xF0, 0x7F, 0x83, 0x12, 0x7B, 0x41, 0xAE, +0x07, 0x90, 0x9A, 0xD9, 0xE0, 0xFF, 0xB5, 0x06, +0x01, 0x22, 0xC3, 0x90, 0x9A, 0xDB, 0xE0, 0x94, +0x64, 0x90, 0x9A, 0xDA, 0xE0, 0x94, 0x00, 0x40, +0x0D, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x40, 0xF0, +0x90, 0x9A, 0xD9, 0xE0, 0xFF, 0x22, 0x90, 0x9A, +0xDA, 0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, 0xE7, +0x80, 0xBE, 0x90, 0x01, 0xC4, 0x74, 0x32, 0xF0, +0x74, 0xD8, 0xA3, 0xF0, 0x7F, 0x90, 0x12, 0x7B, +0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0x32, 0x04, +0x90, 0x01, 0xC4, 0xF0, 0x74, 0xD8, 0xA3, 0xF0, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0x11, 0x81, 0x90, 0x9C, 0x9A, 0xF0, 0xED, 0x90, +0x00, 0x73, 0x70, 0x0D, 0xE0, 0x44, 0x04, 0xF0, +0x90, 0x00, 0x67, 0xE0, 0x44, 0x80, 0xF0, 0x80, +0x0B, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x00, 0x67, +0xE0, 0x54, 0x7F, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x86, 0xAD, 0xA3, 0xE0, 0x24, 0x7F, 0xF5, 0x82, 0xE4, 0x34, 0x84, 0xF5, 0x83, 0xE0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, -0x90, 0x99, 0x89, 0xED, 0xF0, 0xA3, 0xEB, 0xF0, -0x90, 0x99, 0x88, 0xEF, 0xF0, 0xE4, 0xFD, 0xFC, -0x31, 0xA1, 0x90, 0x99, 0x8B, 0xF0, 0x51, 0x87, -0x90, 0x99, 0x88, 0xE0, 0x90, 0x04, 0x25, 0xF0, -0x90, 0x99, 0x89, 0xE0, 0x60, 0x05, 0x51, 0x71, -0x44, 0x80, 0xF0, 0xAF, 0x05, 0x74, 0x20, 0x2F, -0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, -0x54, 0xC0, 0xF0, 0x51, 0x71, 0x54, 0xC0, 0xF0, -0x90, 0x99, 0x8B, 0xE0, 0xFF, 0xAE, 0x05, 0x74, -0x18, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -0x83, 0xEF, 0xF0, 0x90, 0x00, 0x8B, 0xE0, 0xD3, -0x94, 0x03, 0x74, 0x10, 0x2E, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0x74, 0x04, 0xF0, 0xAF, -0x05, 0x51, 0x66, 0xE0, 0x54, 0x01, 0xFE, 0x90, -0x99, 0x8A, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0xFB, -0xEE, 0x44, 0x02, 0x4B, 0xFE, 0x51, 0x66, 0xEE, -0xF0, 0x74, 0x11, 0x2F, 0xF5, 0x82, 0xE4, 0x34, -0xFC, 0xF5, 0x83, 0x74, 0xFF, 0xF0, 0x74, 0x29, -0x2F, 0x51, 0x7D, 0xE0, 0x54, 0xF7, 0xF0, 0x74, -0x0D, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, -0x83, 0xE0, 0x44, 0x80, 0xF0, 0xAE, 0x04, 0xAF, -0x05, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x74, 0x12, +0x11, 0x81, 0x90, 0x9C, 0x9F, 0xF0, 0x90, 0x88, +0x32, 0x12, 0x97, 0xB1, 0x30, 0xE0, 0x02, 0x21, +0x57, 0x90, 0x88, 0x31, 0xE0, 0x30, 0xE0, 0x1F, +0x90, 0x88, 0x53, 0xE0, 0x24, 0x04, 0x33, 0x33, +0x33, 0x54, 0xF8, 0x90, 0x88, 0x4B, 0xF0, 0x90, +0x88, 0x53, 0xE0, 0x04, 0x33, 0x33, 0x33, 0x54, +0xF8, 0x90, 0x88, 0x4A, 0xF0, 0x80, 0x10, 0x90, +0x88, 0x4B, 0x74, 0x10, 0xF0, 0x90, 0x88, 0x4A, +0x74, 0x08, 0xF0, 0x74, 0x10, 0x2B, 0xFB, 0x90, +0x88, 0x4A, 0xE0, 0xFE, 0x90, 0x88, 0x49, 0xE0, +0xD3, 0x9E, 0x50, 0x0E, 0x90, 0x88, 0x3E, 0xEB, +0xF0, 0x90, 0x88, 0x4B, 0xE0, 0xC3, 0x9D, 0x2F, +0x80, 0x11, 0xC3, 0xED, 0x9E, 0x2B, 0x90, 0x88, +0x3E, 0xF0, 0x90, 0x88, 0x4A, 0xE0, 0xFF, 0xA3, +0xE0, 0xC3, 0x9F, 0x90, 0x88, 0x4E, 0xF0, 0x90, +0x88, 0x4B, 0x31, 0x63, 0x90, 0x88, 0x4E, 0x31, +0x6C, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, +0x88, 0x4E, 0x31, 0x63, 0x90, 0x88, 0x3E, 0x31, +0x6C, 0x40, 0x04, 0xEF, 0x24, 0x50, 0xF0, 0x90, +0x88, 0x4E, 0x12, 0xB2, 0xDA, 0xFF, 0x7E, 0x00, +0x90, 0x88, 0x42, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, +0x90, 0x05, 0x58, 0xF0, 0x90, 0x88, 0x4E, 0xE0, +0x54, 0x07, 0xFF, 0x90, 0x05, 0xB1, 0xE0, 0x54, +0xF8, 0x4F, 0xF0, 0x31, 0x77, 0x80, 0x07, 0x90, +0x88, 0x33, 0xE0, 0x44, 0x01, 0xF0, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x24, 0x50, 0xFD, +0xE4, 0x33, 0xFC, 0x22, 0xE0, 0xD3, 0x9D, 0xEC, +0x64, 0x80, 0xF8, 0x74, 0x80, 0x98, 0x22, 0x90, +0x88, 0x33, 0xE0, 0x54, 0xFE, 0xF0, 0x22, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0x90, 0x9C, 0x9B, 0xEF, 0xF0, +0x90, 0x88, 0xB8, 0xE0, 0x44, 0x01, 0xF0, 0x90, +0x8A, 0xF9, 0x12, 0x97, 0x5E, 0x7D, 0x11, 0x7F, +0xFF, 0x12, 0x04, 0x7E, 0x90, 0x8A, 0xEF, 0x12, +0x91, 0xBD, 0x90, 0x07, 0x78, 0xE0, 0x90, 0x88, +0xBD, 0xF0, 0x90, 0x9C, 0x9B, 0xE0, 0xFD, 0x70, +0x02, 0x80, 0x1C, 0xED, 0xB4, 0x01, 0x06, 0x31, +0xDB, 0x44, 0x20, 0xF0, 0x22, 0x90, 0x9C, 0x9B, +0xE0, 0xFD, 0xB4, 0x02, 0x06, 0x31, 0xDB, 0x44, +0x60, 0xF0, 0x22, 0xED, 0xB4, 0x03, 0x03, 0x31, +0xDB, 0xF0, 0x22, 0x90, 0x88, 0xB8, 0xE0, 0x54, +0x1F, 0x22, 0x90, 0x98, 0x20, 0x12, 0xBF, 0xBA, +0x30, 0xE0, 0x0C, 0x12, 0xCF, 0xD0, 0x51, 0x04, +0xF0, 0xA3, 0x04, 0xF0, 0x02, 0x9D, 0xCC, 0x90, +0x8A, 0xAF, 0x12, 0x97, 0x5E, 0x7D, 0x08, 0xE4, +0xFF, 0x02, 0x04, 0x7E, 0x90, 0x9C, 0x0E, 0x12, +0x82, 0x27, 0xE4, 0x90, 0x9C, 0x11, 0x22, 0x90, +0x98, 0x20, 0xE0, 0x30, 0xE0, 0x34, 0x12, 0xB3, +0x4A, 0x70, 0x2F, 0x90, 0x9C, 0x9D, 0xE0, 0x04, +0xF0, 0xE0, 0xB4, 0x0A, 0x0B, 0x90, 0x98, 0x22, +0xE0, 0x04, 0xF0, 0xE4, 0x90, 0x9C, 0x9D, 0xF0, +0x90, 0x98, 0x22, 0xE0, 0xFF, 0x90, 0x98, 0x21, +0xE0, 0xD3, 0x9F, 0x50, 0x0D, 0x90, 0x98, 0x23, +0xE0, 0x70, 0x07, 0xE4, 0x90, 0x98, 0x22, 0xF0, +0x31, 0xE2, 0x22, 0x90, 0x98, 0x20, 0xE0, 0x54, +0xFE, 0xF0, 0x54, 0x7F, 0xF0, 0x54, 0xFB, 0xF0, +0xA3, 0x74, 0x0A, 0x02, 0xA7, 0xDE, 0x51, 0x82, +0x90, 0x98, 0x20, 0xE0, 0x54, 0xFE, 0x4E, 0xFE, +0xF0, 0xEF, 0x54, 0x04, 0xFF, 0xEE, 0x54, 0xFB, +0x4F, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, 0x30, +0xE0, 0x07, 0x12, 0x87, 0x9D, 0x90, 0x98, 0x21, +0xF0, 0x22, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x01, +0xFE, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x02, 0x09, 0xE0, 0xFD, 0x51, 0x82, +0x90, 0x93, 0x04, 0x91, 0x94, 0xFC, 0xEF, 0x54, +0xFB, 0x4C, 0xFF, 0x90, 0x93, 0x04, 0x71, 0x41, +0x54, 0x10, 0xFE, 0xEF, 0x54, 0xEF, 0x4E, 0x90, +0x93, 0x04, 0x12, 0x87, 0x9C, 0xFF, 0xED, 0x2F, +0x90, 0x93, 0x05, 0x12, 0x87, 0xA3, 0xFF, 0xED, +0x2F, 0x90, 0x93, 0x06, 0x12, 0x97, 0xCC, 0xFF, +0xAE, 0x05, 0xED, 0x2F, 0x90, 0x93, 0x07, 0xF0, +0x90, 0x93, 0x04, 0xE0, 0xFF, 0x20, 0xE0, 0x08, +0x13, 0x13, 0x13, 0x54, 0x1F, 0x30, 0xE0, 0x09, +0x90, 0x06, 0x31, 0xE0, 0x44, 0x40, 0xF0, 0x91, +0xE1, 0x90, 0x93, 0x04, 0xE0, 0xFF, 0x30, 0xE0, +0x3C, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x01, 0xF0, +0x90, 0x06, 0x09, 0xE0, 0x54, 0xFE, 0x12, 0xD7, +0x7B, 0xEF, 0x13, 0x13, 0x54, 0x3F, 0x30, 0xE0, +0x0A, 0x12, 0xD7, 0x64, 0xF0, 0x90, 0x9A, 0xF9, +0x74, 0x01, 0xF0, 0x7D, 0x08, 0xE4, 0xFF, 0x12, +0x7C, 0x74, 0x12, 0xA7, 0x47, 0x20, 0xE0, 0x0D, +0x90, 0x9C, 0x55, 0x12, 0x04, 0x3D, 0x00, 0x00, +0x27, 0x10, 0x12, 0xAD, 0x63, 0x12, 0xA7, 0x47, +0x30, 0xE0, 0x09, 0x90, 0x06, 0x32, 0xE0, 0x44, +0x02, 0xF0, 0xB1, 0x34, 0xD0, 0xD0, 0x92, 0xAF, +0x22, 0xF0, 0xEE, 0x54, 0x08, 0xFE, 0xEF, 0x54, +0xF7, 0x4E, 0xFF, 0xF0, 0x02, 0x02, 0x06, 0xD3, +0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x51, 0x82, +0x90, 0x93, 0x24, 0x91, 0x94, 0xFD, 0xEF, 0x54, +0xFB, 0x4D, 0xFF, 0x90, 0x93, 0x24, 0x71, 0x41, +0xF1, 0x76, 0x90, 0x93, 0x24, 0xF1, 0x6D, 0x71, +0x49, 0x91, 0x83, 0x4D, 0xFF, 0x90, 0x93, 0x24, +0xF1, 0x80, 0x12, 0x87, 0xA3, 0xFF, 0x54, 0x01, +0xFE, 0x90, 0x93, 0x26, 0xE0, 0x54, 0xFE, 0x4E, +0x12, 0x87, 0x9C, 0xFE, 0x54, 0x01, 0xFD, 0x90, +0x93, 0x25, 0xE0, 0x54, 0xFE, 0x4D, 0xFD, 0xF0, +0xEE, 0x54, 0x04, 0xFE, 0xED, 0x54, 0xFB, 0x4E, +0xFE, 0x12, 0x87, 0x9C, 0xFD, 0x54, 0x08, 0xFC, +0xEE, 0x54, 0xF7, 0x4C, 0xFE, 0x90, 0x93, 0x25, +0xF0, 0xED, 0x54, 0x10, 0xFD, 0xEE, 0x54, 0xEF, +0x4D, 0xFE, 0x12, 0x87, 0x9C, 0xFD, 0x54, 0x20, +0xFC, 0xEE, 0x54, 0xDF, 0x4C, 0x90, 0x93, 0x25, +0xF0, 0xEF, 0x54, 0x10, 0xFF, 0xA3, 0xE0, 0x54, +0xEF, 0x4F, 0xFF, 0x12, 0x87, 0xA3, 0xFE, 0x54, +0x20, 0xFC, 0xEF, 0x54, 0xDF, 0x4C, 0x90, 0x93, +0x26, 0xF0, 0xED, 0x54, 0x02, 0xFF, 0x90, 0x93, +0x25, 0xE0, 0x54, 0xFD, 0x4F, 0xFF, 0x12, 0x87, +0x9C, 0x91, 0x84, 0x4D, 0x90, 0x93, 0x25, 0x12, +0x97, 0xCC, 0x54, 0x07, 0xFF, 0x90, 0x93, 0x27, +0xE0, 0x54, 0xF8, 0x4F, 0xF0, 0xEE, 0x54, 0x40, +0xFF, 0x90, 0x93, 0x26, 0xE0, 0x54, 0xBF, 0x4F, +0x12, 0xCF, 0x1B, 0xD1, 0x95, 0x90, 0x93, 0x24, +0xE0, 0xC3, 0x13, 0x54, 0x01, 0xFF, 0xF1, 0x95, +0x90, 0x93, 0x24, 0xE0, 0x13, 0x13, 0x54, 0x01, +0xFF, 0xF1, 0xA1, 0x90, 0x93, 0x25, 0x12, 0xB2, +0xDA, 0x30, 0xE0, 0x1F, 0x90, 0x93, 0x24, 0x12, +0x89, 0xF1, 0x20, 0xE0, 0x0E, 0xEF, 0xC3, 0x13, +0x20, 0xE0, 0x08, 0xE0, 0x13, 0x13, 0x54, 0x3F, +0x30, 0xE0, 0x04, 0x7F, 0x01, 0x80, 0x0E, 0x7F, +0x00, 0x80, 0x0A, 0x90, 0x93, 0x24, 0xE0, 0x13, +0x13, 0x13, 0x54, 0x01, 0xFF, 0x91, 0xAB, 0x90, +0x93, 0x24, 0xE0, 0xC4, 0x54, 0x01, 0xFF, 0xF1, +0xAD, 0x90, 0x93, 0x24, 0xE0, 0xC4, 0x13, 0x13, +0x54, 0x01, 0xFF, 0x91, 0x8B, 0x90, 0x93, 0x24, +0xE0, 0x54, 0x01, 0xFF, 0xD1, 0x9D, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xFE, 0x54, 0x40, 0xFD, 0xEF, +0x54, 0xBF, 0x22, 0xEF, 0x60, 0x05, 0xB1, 0xD2, +0x12, 0xCD, 0x16, 0x22, 0xE0, 0x54, 0xFE, 0x4E, +0xFE, 0xF0, 0xEF, 0x54, 0x02, 0xFF, 0xEE, 0x54, +0xFD, 0x4F, 0xFF, 0xF0, 0x12, 0x02, 0x06, 0xFE, +0x54, 0x04, 0x22, 0xE4, 0xFD, 0xFC, 0xEF, 0x60, +0x2F, 0x90, 0x98, 0x0F, 0xD1, 0x7F, 0xF1, 0x8A, +0x90, 0x99, 0x85, 0x12, 0x82, 0x27, 0x90, 0x99, +0x85, 0x12, 0x9F, 0x04, 0x75, 0x48, 0x40, 0x7B, +0x01, 0x7A, 0x93, 0x79, 0xF9, 0x12, 0x69, 0xF5, +0x12, 0xCF, 0x72, 0xCE, 0xC3, 0x13, 0xCE, 0x13, +0xD8, 0xF9, 0x12, 0xCF, 0xDF, 0x12, 0x54, 0x1E, +0x22, 0x90, 0x93, 0x06, 0xB1, 0xBC, 0x12, 0xCD, +0xE1, 0xE0, 0x90, 0x9A, 0xE1, 0xF0, 0x74, 0x01, +0x2F, 0x12, 0xCF, 0x6A, 0xE0, 0x90, 0x9A, 0xE2, +0xB1, 0xC5, 0x90, 0x9A, 0xE3, 0xF0, 0x74, 0x03, +0x2F, 0xD1, 0x5B, 0x90, 0x9A, 0xE4, 0xD1, 0x89, +0xE0, 0x90, 0x9A, 0xE5, 0xF0, 0x74, 0x05, 0x2F, +0x12, 0xCF, 0xD7, 0xE0, 0x90, 0x9A, 0xE6, 0xF0, +0x74, 0x06, 0x2F, 0xD1, 0x6D, 0x90, 0x9A, 0xE7, +0xF0, 0x74, 0x07, 0x2F, 0xD1, 0x76, 0x90, 0x9A, +0xE8, 0xF0, 0x74, 0x08, 0x2F, 0xD1, 0x64, 0x90, +0x9A, 0xE9, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0x90, 0x93, 0x07, 0xB1, 0xBC, +0x12, 0xCD, 0xE1, 0xE0, 0x90, 0x9A, 0xFA, 0xF0, +0x74, 0x01, 0x2F, 0x12, 0xCF, 0x6A, 0xE0, 0x90, +0x9B, 0x1B, 0xB1, 0xC5, 0x90, 0x9B, 0x3C, 0xF0, +0xEF, 0x24, 0x20, 0x90, 0x99, 0x85, 0xF0, 0x12, +0x9F, 0x82, 0x90, 0x9A, 0xFA, 0xE0, 0xF5, 0x48, +0x7B, 0x01, 0x7A, 0x9A, 0x79, 0xFB, 0x12, 0x69, +0xF5, 0x90, 0x9A, 0xFA, 0xB1, 0xB3, 0x12, 0x9F, +0x81, 0x90, 0x9B, 0x1B, 0xE0, 0xF5, 0x48, 0x7B, +0x01, 0x7A, 0x9B, 0x79, 0x1C, 0x12, 0x69, 0xF5, +0x90, 0x9B, 0x1B, 0xB1, 0xB3, 0x12, 0x9F, 0x81, +0x90, 0x9B, 0x3C, 0xE0, 0xF5, 0x48, 0x7B, 0x01, +0x7A, 0x9B, 0x79, 0x3D, 0x12, 0x69, 0xF5, 0xE4, +0xFF, 0x90, 0x9A, 0xFA, 0xE0, 0xFE, 0xEF, 0xC3, +0x9E, 0x50, 0x03, 0x0F, 0x80, 0xF3, 0xD0, 0xD0, +0x92, 0xAF, 0x22, 0xE0, 0xFF, 0x90, 0x99, 0x85, +0xE0, 0x2F, 0xF0, 0x22, 0xE0, 0xFF, 0x12, 0x7B, +0x07, 0x74, 0x00, 0x2F, 0x22, 0xF0, 0x74, 0x02, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, -0x22, 0x74, 0x21, 0x2F, 0xF5, 0x82, 0xE4, 0x34, +0xE0, 0x22, 0xE4, 0xFD, 0xFC, 0x90, 0x98, 0x15, +0xD1, 0x7F, 0xAB, 0x05, 0x74, 0x01, 0x2B, 0x12, +0xCF, 0x6A, 0xE0, 0xFE, 0x74, 0x00, 0x2B, 0x12, +0xCD, 0xE1, 0x12, 0xD7, 0xB9, 0x3E, 0x90, 0x95, +0x67, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x03, 0x2B, +0xD1, 0x5B, 0xFE, 0x74, 0x02, 0x2B, 0xB1, 0xC9, +0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, 0x69, +0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x05, 0x2B, 0x12, +0xCF, 0xD7, 0xE0, 0xFE, 0x74, 0x04, 0x2B, 0xD1, +0x8D, 0xE0, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, +0x95, 0x6B, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x07, +0x2B, 0xD1, 0x76, 0xFE, 0x74, 0x06, 0x2B, 0xD1, +0x6D, 0x24, 0x00, 0xFF, 0xEA, 0x3E, 0x90, 0x95, +0x6D, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x09, 0x2B, +0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, +0xFE, 0x74, 0x08, 0x2B, 0xD1, 0x64, 0x24, 0x00, +0xFF, 0xEC, 0x3E, 0x90, 0x95, 0x6F, 0xF0, 0xA3, +0xEF, 0xF0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, +0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, 0xE4, -0x34, 0xFC, 0xF5, 0x83, 0x22, 0xE0, 0xFF, 0x12, -0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, 0x22, 0xE4, -0xFD, 0xFC, 0xEF, 0x60, 0x3D, 0x90, 0x98, 0x0B, -0x51, 0x85, 0x91, 0x74, 0x12, 0xA7, 0xDE, 0x90, -0x99, 0x8C, 0x12, 0x9C, 0x2F, 0x75, 0x48, 0x40, -0x7B, 0x01, 0x7A, 0x93, 0x79, 0xF5, 0x12, 0x69, -0xF5, 0xE4, 0xFD, 0x7F, 0x03, 0x12, 0x54, 0x1E, -0x90, 0x98, 0x0C, 0xE0, 0x51, 0xD5, 0x78, 0x03, -0xCE, 0xC3, 0x13, 0xCE, 0x13, 0xD8, 0xF9, 0xFF, -0x12, 0x77, 0xA4, 0x7D, 0x01, 0x7F, 0x03, 0x12, -0x54, 0x1E, 0x22, 0xE0, 0xFD, 0x75, 0xF0, 0x80, -0xA4, 0xAE, 0xF0, 0x22, 0x90, 0x9C, 0x28, 0xED, -0xF0, 0x90, 0x9C, 0x27, 0xEF, 0xF0, 0x12, 0x7B, -0x07, 0x90, 0x9C, 0x35, 0xEF, 0xF0, 0xE0, 0xFD, -0x24, 0x01, 0x12, 0xBE, 0x71, 0xE0, 0xFE, 0x74, -0x00, 0x2D, 0x12, 0x9F, 0x73, 0x12, 0xBE, 0x88, -0x54, 0x3F, 0x90, 0x9C, 0x32, 0xF0, 0xA3, 0xEF, -0xF0, 0xE4, 0x90, 0x9C, 0x31, 0xF0, 0x91, 0x28, -0x50, 0x0B, 0x91, 0x47, 0xF0, 0x12, 0x9F, 0x70, -0xE4, 0x91, 0x10, 0x80, 0xF1, 0x90, 0x9C, 0x33, -0xE0, 0x24, 0xF8, 0xFB, 0x90, 0x9C, 0x32, 0xE0, -0x34, 0xFF, 0xFA, 0x90, 0x9C, 0x28, 0xE0, 0xFF, -0x90, 0x91, 0xDC, 0xE4, 0xF0, 0xA3, 0xEF, 0xF0, -0xA3, 0x74, 0x01, 0xF0, 0x7D, 0x0A, 0x7C, 0x00, -0x7F, 0x10, 0x7E, 0x00, 0x12, 0x6D, 0xED, 0x90, -0x98, 0x0B, 0xE0, 0xFF, 0x90, 0x9C, 0x27, 0xE0, -0xFD, 0xD3, 0x9F, 0x40, 0x38, 0x90, 0x98, 0x0B, -0xE0, 0xFC, 0x51, 0xD5, 0x78, 0x03, 0xCE, 0xC3, -0x13, 0xCE, 0x13, 0xD8, 0xF9, 0x91, 0x31, 0xEC, -0xFF, 0xC3, 0xED, 0x91, 0x3D, 0xC3, 0x33, 0xCE, -0x33, 0xCE, 0xD8, 0xF9, 0x24, 0x28, 0xFF, 0xE4, -0x3E, 0xFE, 0x91, 0x20, 0xFD, 0x90, 0x9C, 0x28, -0xE0, 0xFC, 0xC3, 0xED, 0x9C, 0x91, 0x18, 0x7D, -0x38, 0x7C, 0x00, 0x80, 0x35, 0x90, 0x9C, 0x27, -0x51, 0xD3, 0x78, 0x03, 0xCE, 0xC3, 0x13, 0xCE, -0x13, 0xD8, 0xF9, 0x91, 0x31, 0xED, 0xFF, 0x90, -0x98, 0x0B, 0x91, 0x3B, 0xC3, 0x33, 0xCE, 0x33, -0xCE, 0xD8, 0xF9, 0x24, 0x38, 0xFD, 0xE4, 0x3E, -0xFC, 0x91, 0x20, 0xFF, 0x90, 0x9C, 0x28, 0xE0, -0xFE, 0xC3, 0xEF, 0x9E, 0x91, 0x18, 0x7F, 0x28, -0x7E, 0x00, 0x12, 0x71, 0xD4, 0x7B, 0x00, 0x7A, -0x00, 0x79, 0x00, 0x90, 0x91, 0x45, 0x12, 0x84, -0x67, 0x0B, 0x7A, 0x9C, 0x79, 0x29, 0x90, 0x91, -0x48, 0x12, 0x84, 0x67, 0x90, 0x91, 0x4B, 0x74, -0x08, 0xF0, 0x7A, 0x94, 0x79, 0x2D, 0x12, 0x4E, -0xA5, 0xE4, 0x90, 0x9C, 0x31, 0xF0, 0x91, 0x28, -0x50, 0x1D, 0x91, 0x47, 0xF0, 0x90, 0x9C, 0x31, -0xE0, 0x24, 0x29, 0xF5, 0x82, 0xE4, 0x34, 0x9C, -0xF5, 0x83, 0xE0, 0xFF, 0x90, 0x9C, 0x34, 0x12, -0x9F, 0x70, 0xEF, 0x91, 0x10, 0x80, 0xDF, 0x22, -0xF0, 0x90, 0x9C, 0x31, 0xE0, 0x04, 0xF0, 0x22, -0xFB, 0x90, 0x92, 0x06, 0x74, 0x08, 0xF0, 0x22, -0x90, 0x9C, 0x32, 0xA3, 0xE0, 0x24, 0xF8, 0x22, -0x90, 0x9C, 0x31, 0xE0, 0xFF, 0xC3, 0x94, 0x08, -0x22, 0xFF, 0x90, 0x92, 0x07, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x22, 0xE0, 0xC3, 0x9F, 0xFF, 0xE4, -0x94, 0x00, 0xFE, 0xEF, 0x78, 0x07, 0x22, 0x90, -0x9C, 0x35, 0xE0, 0xFD, 0x90, 0x9C, 0x33, 0xE0, -0x2D, 0xFD, 0x90, 0x9C, 0x32, 0xE0, 0x34, 0x00, -0xCD, 0x24, 0x20, 0xCD, 0x34, 0x00, 0xFC, 0x7E, -0x00, 0xED, 0x2F, 0xFF, 0xEE, 0x3C, 0xFE, 0x90, -0x9C, 0x27, 0xE0, 0xFD, 0x12, 0x7B, 0x8B, 0x90, -0x9C, 0x34, 0xEF, 0x22, 0x74, 0x00, 0x2F, 0xF9, -0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, 0x90, -0x99, 0x8F, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0x2F, -0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, -0xE0, 0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, -0x34, 0x04, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, -0xB4, 0x08, 0xE3, 0x90, 0x95, 0x5F, 0xE0, 0x90, -0x04, 0x8C, 0xF0, 0x90, 0x95, 0x61, 0xE0, 0x90, -0x04, 0x8D, 0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, -0x94, 0x75, 0x47, 0x3E, 0x75, 0x48, 0x08, 0x7B, -0x01, 0x7A, 0x95, 0x79, 0x37, 0x12, 0x69, 0xF5, -0x90, 0x98, 0x16, 0xE0, 0x60, 0x19, 0x90, 0x99, -0x8F, 0xB1, 0x12, 0x91, 0x74, 0xC0, 0x03, 0x8B, -0x45, 0x75, 0x46, 0x95, 0x75, 0x47, 0x2F, 0x75, -0x48, 0x34, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x22, -0xB1, 0x1A, 0x90, 0x98, 0x16, 0xE0, 0xFF, 0x91, -0x7F, 0x90, 0x01, 0x3F, 0x74, 0x04, 0xF0, 0x90, -0x86, 0xB3, 0xE0, 0xFF, 0xB4, 0x01, 0x07, 0x90, -0xFD, 0x00, 0xE0, 0x54, 0xEF, 0xF0, 0xEF, 0xB4, -0x01, 0x07, 0x90, 0xFE, 0x10, 0xE0, 0x54, 0xFB, -0xF0, 0x22, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x7E, -0x00, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x7B, 0x2E, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x31, 0xA1, 0x90, 0x9C, -0xA9, 0xF0, 0xED, 0x90, 0x00, 0x73, 0x70, 0x0D, -0xE0, 0x44, 0x04, 0xF0, 0x90, 0x00, 0x67, 0xE0, -0x44, 0x80, 0xF0, 0x80, 0x0B, 0xE0, 0x54, 0xFB, -0xF0, 0x90, 0x00, 0x67, 0xE0, 0x54, 0x7F, 0xF0, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0xAC, 0xED, -0xF0, 0x90, 0x88, 0x31, 0xE0, 0xFE, 0xC4, 0x13, -0x13, 0x54, 0x03, 0x30, 0xE0, 0x02, 0xC1, 0xD1, -0xEE, 0x11, 0xB6, 0x30, 0xE0, 0x02, 0xC1, 0xD1, -0x90, 0x88, 0x39, 0xE0, 0xFE, 0x6F, 0x70, 0x02, -0xC1, 0xD1, 0xEF, 0x70, 0x02, 0xC1, 0x2D, 0x24, -0xFE, 0x70, 0x02, 0xC1, 0x75, 0x24, 0xFE, 0x60, -0x50, 0x24, 0xFC, 0x70, 0x02, 0xC1, 0xBC, 0x24, -0xFC, 0x60, 0x02, 0xC1, 0xCC, 0xEE, 0xB4, 0x0E, -0x03, 0x12, 0x71, 0x5F, 0x90, 0x88, 0x39, 0xE0, -0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, 0x90, -0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, 0x71, -0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x12, -0x90, 0x9C, 0xAC, 0xE0, 0xFF, 0x60, 0x05, 0x12, -0x67, 0x80, 0x80, 0x06, 0x90, 0x8A, 0xED, 0x12, -0x8E, 0xDC, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x08, -0x60, 0x02, 0xC1, 0xCC, 0x12, 0x7B, 0xCC, 0xC1, -0xCC, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, -0x01, 0x12, 0x78, 0xC0, 0x90, 0x88, 0x39, 0xE0, -0xB4, 0x06, 0x03, 0x12, 0x71, 0x24, 0x90, 0x88, -0x39, 0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, -0x12, 0x8E, 0xDC, 0xBF, 0x01, 0x03, 0x12, 0x71, -0x5F, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, -0x02, 0xC1, 0xCC, 0x90, 0x86, 0x00, 0x12, 0x8E, -0xDC, 0xEF, 0x64, 0x01, 0x60, 0x02, 0xC1, 0xCC, -0x12, 0x68, 0xC2, 0xC1, 0xCC, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, -0x8E, 0xDC, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, -0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, -0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0xDC, 0xBF, -0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, -0xE0, 0x64, 0x04, 0x70, 0x67, 0x90, 0x86, 0x02, -0x12, 0x8E, 0xDC, 0xEF, 0x64, 0x01, 0x70, 0x5C, -0x12, 0x73, 0x5A, 0x80, 0x57, 0x90, 0x88, 0x39, -0xE0, 0xB4, 0x0E, 0x0C, 0x90, 0x86, 0x00, 0x12, -0x8E, 0xDC, 0xBF, 0x01, 0x03, 0x12, 0x71, 0x5F, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x06, 0x03, 0x12, -0x71, 0x24, 0x90, 0x88, 0x39, 0xE0, 0xB4, 0x0C, -0x0C, 0x90, 0x86, 0x00, 0x12, 0x8E, 0xDC, 0xBF, -0x01, 0x03, 0x12, 0x68, 0xC2, 0x90, 0x88, 0x39, -0xE0, 0x70, 0x05, 0x7F, 0x01, 0x12, 0x78, 0xC0, -0x90, 0x88, 0x39, 0xE0, 0xB4, 0x04, 0x15, 0x12, -0x7A, 0x49, 0x80, 0x10, 0x90, 0x88, 0x39, 0xE0, -0xB4, 0x0C, 0x09, 0x12, 0xD6, 0x86, 0x30, 0xE0, -0x03, 0x12, 0x79, 0xD4, 0x90, 0x88, 0x39, 0xD1, -0xD6, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE0, 0x90, -0x01, 0xBA, 0xF0, 0x90, 0x88, 0x38, 0xE0, 0x90, -0x01, 0xBB, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xF1, 0x9F, 0xEC, 0x90, 0x9C, -0x60, 0x12, 0x04, 0x31, 0x90, 0x9C, 0x60, 0x12, -0xDA, 0xA0, 0x7F, 0x30, 0x7E, 0x08, 0x12, 0x70, -0xAD, 0xF1, 0xAB, 0xF0, 0x7D, 0x01, 0x12, 0x76, -0xF7, 0x12, 0x8E, 0xD9, 0x90, 0x06, 0xB7, 0x74, -0x11, 0xF0, 0x7F, 0x03, 0x7E, 0x00, 0x12, 0x7C, -0x6A, 0x90, 0x06, 0xB4, 0xE0, 0x54, 0x0F, 0x70, -0xF1, 0x12, 0xC7, 0x55, 0x54, 0xFE, 0xF1, 0x90, -0x90, 0x01, 0x00, 0x74, 0x3F, 0xF0, 0xA3, 0xE0, -0x54, 0xFD, 0xF0, 0x90, 0x05, 0x53, 0xE0, 0x44, -0x20, 0xF0, 0x90, 0x88, 0x9B, 0x12, 0x97, 0x90, -0x30, 0xE0, 0x05, 0x7F, 0x01, 0x12, 0x71, 0x9A, -0x12, 0xA8, 0x37, 0x30, 0xE0, 0x35, 0x90, 0x88, -0xDF, 0xE0, 0x60, 0x08, 0x90, 0x9C, 0x5E, 0x74, -0x01, 0xF0, 0x80, 0x05, 0xE4, 0x90, 0x9C, 0x5E, -0xF0, 0xEF, 0xC4, 0x13, 0x54, 0x07, 0x30, 0xE0, -0x07, 0xE4, 0x90, 0x9C, 0x5F, 0xF0, 0x80, 0x06, -0x90, 0x9C, 0x5F, 0x74, 0x02, 0xF0, 0x90, 0x9C, -0x5E, 0xF1, 0x96, 0x12, 0xA8, 0xFB, 0x7F, 0x01, -0x12, 0x71, 0x9A, 0x90, 0x88, 0x9A, 0xE0, 0x60, -0x02, 0xE4, 0xF0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0xFD, 0x7F, 0x02, 0x02, 0x7B, 0x2E, 0xE0, 0xFF, -0xA3, 0xE0, 0xFD, 0x90, 0x8A, 0xF3, 0x22, 0x7F, -0x30, 0x7E, 0x08, 0x12, 0x70, 0x70, 0xED, 0x44, -0x80, 0xFD, 0x22, 0x90, 0x93, 0x42, 0xE0, 0xFF, -0x90, 0x93, 0x41, 0xE0, 0xFB, 0x90, 0x93, 0x43, -0xE0, 0x90, 0x92, 0x90, 0x22, 0xE4, 0x90, 0x9C, -0x90, 0xF0, 0xA3, 0xF0, 0x90, 0x05, 0x22, 0xE0, -0x90, 0x9C, 0x92, 0xF0, 0x7B, 0x47, 0x7D, 0xFF, -0xE4, 0xFF, 0x12, 0x99, 0x1F, 0x90, 0x05, 0xF8, -0xE0, 0x70, 0x1B, 0xA3, 0xE0, 0x70, 0x17, 0xA3, -0xE0, 0x70, 0x13, 0xA3, 0xE0, 0x70, 0x0F, 0x90, -0x9C, 0x92, 0xE0, 0xFD, 0x7B, 0x48, 0xE4, 0xFF, -0x12, 0x99, 0x1F, 0x7F, 0x01, 0x22, 0x12, 0xAE, -0xCF, 0x30, 0xE0, 0x1A, 0xD3, 0x90, 0x9C, 0x91, -0xE0, 0x94, 0x03, 0x90, 0x9C, 0x90, 0xE0, 0x94, -0x00, 0x40, 0x07, 0x11, 0x41, 0xFD, 0x7B, 0x5A, -0x80, 0x18, 0x7F, 0x01, 0x80, 0x1E, 0xD3, 0x90, -0x9C, 0x91, 0xE0, 0x94, 0xE8, 0x90, 0x9C, 0x90, -0xE0, 0x94, 0x03, 0x40, 0x0D, 0x11, 0x41, 0xFD, -0x7B, 0x5B, 0xE4, 0xFF, 0x12, 0x99, 0x1F, 0x7F, -0x00, 0x22, 0x7F, 0x32, 0x7E, 0x00, 0x12, 0x7C, -0x6A, 0x90, 0x9C, 0x90, 0x12, 0xC4, 0x6F, 0x80, -0x94, 0x90, 0x01, 0xC0, 0xE0, 0x44, 0x20, 0xF0, -0x90, 0x9C, 0x92, 0xE0, 0x22, 0xAD, 0x07, 0x90, -0x93, 0x29, 0xE0, 0xFF, 0x7E, 0x00, 0xE4, 0x90, -0x9C, 0xA8, 0xF0, 0x90, 0x93, 0x2A, 0xE0, 0xC3, -0x13, 0x54, 0x7F, 0xF9, 0xA3, 0xE0, 0x13, 0x13, -0x54, 0x01, 0xFC, 0x60, 0x0D, 0xEF, 0x78, 0x03, -0xC3, 0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, -0x80, 0x0B, 0xEF, 0x78, 0x06, 0xC3, 0x33, 0xCE, -0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0xED, 0xB4, 0x01, -0x09, 0xAD, 0x04, 0xAC, 0x01, 0xAB, 0x04, 0x12, -0xB9, 0x74, 0x22, 0x90, 0x01, 0x94, 0xE0, 0x44, -0x01, 0xF0, 0x90, 0x01, 0xC7, 0xE4, 0xF0, 0x22, -0x90, 0x01, 0x9A, 0xE0, 0x54, 0xC0, 0x44, 0x0B, -0xF0, 0x12, 0xC7, 0x5C, 0x90, 0x01, 0x98, 0xE0, -0x54, 0xC0, 0x7F, 0x00, 0xB4, 0x40, 0x02, 0x7F, -0x01, 0x22, 0x90, 0x01, 0x95, 0xE0, 0x7F, 0x00, -0x30, 0xE4, 0x02, 0x7F, 0x01, 0x22, 0x90, 0x93, -0x24, 0xE0, 0x30, 0xE0, 0x0B, 0x90, 0x8A, 0xE5, -0x12, 0x8F, 0x00, 0x7F, 0x10, 0x12, 0x04, 0x7E, -0x22, 0x90, 0x8A, 0x75, 0x12, 0x8E, 0xDC, 0x90, -0x8A, 0xE5, 0x12, 0x8F, 0x00, 0x7F, 0x02, 0x02, -0x04, 0x7E, 0x90, 0x01, 0xCF, 0xE0, 0x90, 0x9A, -0xD8, 0xF0, 0xE0, 0xFF, 0x30, 0xE0, 0x07, 0x90, -0x01, 0xCF, 0xE0, 0x54, 0xFE, 0xF0, 0xEF, 0x30, -0xE5, 0x23, 0x90, 0x01, 0xCF, 0xE0, 0x54, 0xDF, -0xF0, 0x90, 0x01, 0x34, 0x74, 0x20, 0xF0, 0xE4, -0xF5, 0xA8, 0xF5, 0xE8, 0x12, 0x76, 0x6D, 0x90, -0x00, 0x03, 0xE0, 0x54, 0xFB, 0xFD, 0x7F, 0x03, -0x12, 0x7B, 0x2E, 0x80, 0xFE, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xE4, 0xFE, 0xFD, -0xEF, 0xB4, 0x01, 0x0D, 0xEB, 0xB4, 0x02, 0x03, -0x0D, 0x80, 0x06, 0xEB, 0xB4, 0x01, 0x02, 0x7D, -0x02, 0xAF, 0x06, 0xEF, 0xC4, 0x54, 0xF0, 0x4D, -0xFF, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xE4, 0x90, -0x9A, 0xE2, 0xF0, 0xA3, 0xF0, 0x7F, 0x83, 0x12, -0x7B, 0x41, 0x90, 0x9A, 0xE1, 0xEF, 0xF0, 0x7F, -0x83, 0x12, 0x7B, 0x41, 0xAE, 0x07, 0x90, 0x9A, -0xE1, 0xE0, 0xFF, 0xB5, 0x06, 0x01, 0x22, 0xC3, -0x90, 0x9A, 0xE3, 0xE0, 0x94, 0x64, 0x90, 0x9A, -0xE2, 0xE0, 0x94, 0x00, 0x40, 0x0D, 0x90, 0x01, -0xC0, 0xE0, 0x44, 0x40, 0xF0, 0x90, 0x9A, 0xE1, -0xE0, 0xFF, 0x22, 0x90, 0x9A, 0xE2, 0x12, 0xC4, -0x6F, 0x80, 0xC2, 0x90, 0x01, 0xC4, 0x74, 0x93, -0xF0, 0x74, 0xF1, 0xA3, 0xF0, 0x7F, 0x90, 0x12, -0x7B, 0x41, 0xEF, 0x20, 0xE0, 0xF7, 0x74, 0x93, -0x04, 0x90, 0x01, 0xC4, 0xF0, 0x74, 0xF1, 0xA3, -0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, 0x88, -0xB8, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0xE1, 0xF0, -0x90, 0x88, 0xBD, 0xE0, 0xFF, 0x12, 0x71, 0x9A, -0x90, 0x88, 0xBE, 0x12, 0xEF, 0x96, 0x12, 0xA8, -0xFB, 0x90, 0x88, 0x36, 0xE0, 0x70, 0x16, 0x90, -0x93, 0x08, 0xE0, 0x20, 0xE0, 0x0F, 0x90, 0x86, -0x0C, 0x12, 0x8E, 0xDC, 0x90, 0x8A, 0xF9, 0x12, -0x8F, 0x00, 0x12, 0xC8, 0x3E, 0x22, 0x90, 0x99, -0x88, 0xEF, 0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xAD, 0x07, 0xAC, 0x06, 0xEF, -0x54, 0xFC, 0xFF, 0xED, 0x30, 0xE0, 0x06, 0x7E, -0xFF, 0x7F, 0xFF, 0x80, 0x25, 0x51, 0x47, 0x90, -0x07, 0xC0, 0x74, 0x80, 0xF0, 0x90, 0x07, 0xC3, -0xE0, 0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0xFD, -0x24, 0xC9, 0x51, 0x3F, 0xE0, 0xFE, 0x74, 0xC8, -0x2D, 0xF5, 0x82, 0xE4, 0x34, 0x07, 0x12, 0xBE, -0x86, 0xFE, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xF5, -0x82, 0xE4, 0x34, 0x07, 0xF5, 0x83, 0x22, 0x90, -0x07, 0xC0, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xAD, -0x07, 0xAC, 0x06, 0xEF, 0x51, 0x7E, 0x90, 0x07, -0xC0, 0x74, 0x80, 0xF0, 0x90, 0x07, 0xC3, 0xE0, -0x30, 0xE5, 0xF9, 0xED, 0x54, 0x03, 0x24, 0xC8, -0x51, 0x3F, 0xE0, 0xFF, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x54, 0xFC, -0x90, 0x07, 0xC0, 0xF0, 0xEE, 0xA3, 0xF0, 0x22, -0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, -0x54, 0xFC, 0xFF, 0x51, 0x80, 0xE4, 0xFB, 0x90, -0x9C, 0x6C, 0x12, 0x04, 0xB8, 0xEB, 0x75, 0xF0, -0x08, 0xA4, 0xF9, 0xF8, 0x12, 0x03, 0xEB, 0x74, -0xC4, 0x2B, 0x51, 0x3F, 0xEF, 0xF0, 0x0B, 0xEB, -0xB4, 0x04, 0xE4, 0x90, 0x07, 0xC2, 0x71, 0x7F, -0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, 0xD0, -0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0xA1, 0x51, 0x79, -0x7A, 0x00, 0x90, 0x9C, 0xA2, 0xE0, 0x54, 0x03, -0xFB, 0x70, 0x0A, 0x90, 0x07, 0xC4, 0x71, 0x05, -0x74, 0x03, 0xF0, 0x80, 0x0E, 0xEB, 0x64, 0x02, -0x4A, 0x70, 0x15, 0x90, 0x07, 0xC6, 0x71, 0x05, -0x74, 0x0C, 0xF0, 0x90, 0x07, 0xC3, 0x74, 0xC0, -0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, 0xF9, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0xF0, 0xEC, -0xA3, 0xF0, 0x90, 0x07, 0xC2, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0xA3, -0x51, 0x79, 0x71, 0x76, 0xFF, 0x70, 0x0D, 0x90, -0x07, 0xC4, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, -0x01, 0xF0, 0x80, 0x38, 0xEF, 0x64, 0x01, 0x4E, -0x70, 0x0D, 0x90, 0x07, 0xC5, 0xED, 0xF0, 0x90, -0x07, 0xC2, 0x74, 0x02, 0xF0, 0x80, 0x25, 0x71, -0x76, 0xFF, 0x64, 0x02, 0x70, 0x0D, 0x90, 0x07, -0xC6, 0xED, 0xF0, 0x90, 0x07, 0xC2, 0x74, 0x04, -0xF0, 0x80, 0x11, 0xEF, 0x64, 0x03, 0x4E, 0x70, -0x0B, 0x90, 0x07, 0xC7, 0xED, 0xF0, 0x90, 0x07, -0xC2, 0x74, 0x08, 0xF0, 0x90, 0x07, 0xC3, 0x74, -0xC0, 0xF0, 0x90, 0x07, 0xC3, 0xE0, 0x30, 0xE5, -0xF9, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7E, 0x00, -0x90, 0x9C, 0xA4, 0xE0, 0x54, 0x03, 0x22, 0x74, -0x0F, 0xF0, 0xA3, 0x74, 0xC0, 0xF0, 0x22, 0x90, -0x98, 0x18, 0xE0, 0x54, 0xFE, 0xF0, 0x54, 0x7F, -0xF0, 0x54, 0xFB, 0xF0, 0xA3, 0x74, 0x0A, 0xF0, -0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0x22, 0x12, 0xBC, -0x45, 0x90, 0x98, 0x18, 0xE0, 0x54, 0xFE, 0x4E, -0xFE, 0xF0, 0xEF, 0x54, 0x04, 0xFF, 0xEE, 0x54, -0xFB, 0x4F, 0xF0, 0x12, 0x02, 0x06, 0xC3, 0x13, -0x30, 0xE0, 0x07, 0x12, 0x8E, 0xE8, 0x90, 0x98, -0x19, 0xF0, 0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, -0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, 0xA3, 0xF0, -0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, 0x12, 0xDF, -0x94, 0x12, 0xBE, 0x88, 0x90, 0x99, 0x8C, 0x91, -0x8A, 0xF9, 0x90, 0x93, 0x24, 0xE0, 0x30, 0xE0, -0x7D, 0xEC, 0xC3, 0x99, 0x50, 0x78, 0x90, 0x99, -0x8C, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, 0xEA, 0x90, -0xFD, 0x11, 0xF0, 0xAF, 0x03, 0xAD, 0x07, 0x12, -0xDF, 0xBF, 0x54, 0x3F, 0x90, 0x99, 0x8E, 0x91, -0xC1, 0x30, 0xE0, 0x09, 0xC3, 0x13, 0x20, 0xE0, -0x04, 0x91, 0xA2, 0x80, 0x02, 0x7E, 0x00, 0xEE, -0xFB, 0xEF, 0x24, 0x18, 0xFF, 0xE4, 0x33, 0xCF, -0x2B, 0xCF, 0x34, 0x00, 0x90, 0x99, 0x8E, 0x8F, -0xF0, 0x12, 0x02, 0xE7, 0x90, 0x99, 0x8E, 0xE0, -0xFE, 0xA3, 0xE0, 0xFF, 0x91, 0x67, 0x90, 0x99, -0x8E, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x99, -0x8C, 0x91, 0x93, 0xD3, 0x90, 0x99, 0x8D, 0xE0, -0x9F, 0x90, 0x99, 0x8C, 0xE0, 0x9E, 0x40, 0x0E, -0x91, 0xB1, 0x90, 0x99, 0x8D, 0xE0, 0x9F, 0xF0, -0x90, 0x99, 0x8C, 0xE0, 0x9E, 0xF0, 0x90, 0x99, -0x8C, 0x71, 0xC3, 0x0C, 0x80, 0x83, 0x22, 0x7D, -0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0B, 0x91, 0x7E, -0x5F, 0x24, 0x08, 0xFF, 0xE4, 0x3E, 0xFE, 0x80, -0x04, 0x91, 0x7E, 0x5F, 0xFF, 0x22, 0x74, 0xFF, -0x9D, 0xFD, 0x74, 0xFF, 0x94, 0x00, 0x5E, 0xFE, -0xED, 0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, -0x87, 0xE0, 0x22, 0xEE, 0x8F, 0xF0, 0x12, 0x02, -0xE7, 0x90, 0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, -0xFF, 0x22, 0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, -0x34, 0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x03, 0xFE, -0x22, 0x90, 0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, -0x90, 0x88, 0x27, 0xE0, 0x34, 0x00, 0xFE, 0xC3, -0x22, 0xF0, 0xA3, 0xEF, 0xF0, 0x74, 0x02, 0x2D, -0xF5, 0x82, 0xE4, 0x34, 0xFB, 0xF5, 0x83, 0xE0, -0x54, 0x0F, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, -0x90, 0x98, 0x38, 0xE0, 0x22, 0x90, 0x02, 0x86, -0xE0, 0x20, 0xE2, 0x03, 0x7F, 0x04, 0x22, 0x90, -0x02, 0x86, 0xE0, 0x7F, 0x01, 0x20, 0xE1, 0x02, -0x7F, 0x02, 0x22, 0x90, 0x93, 0x2D, 0xE0, 0x30, -0xE0, 0x0D, 0x90, 0x93, 0x27, 0xE0, 0xC4, 0x54, -0x0F, 0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, -0x01, 0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, -0x05, 0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, -0xF0, 0x02, 0x97, 0xF0, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0xEF, 0x20, 0xE0, 0x05, 0x90, -0x98, 0x05, 0x80, 0x03, 0x90, 0x98, 0x06, 0xE0, -0x90, 0x95, 0x60, 0xF0, 0x90, 0x95, 0x60, 0xE0, -0x14, 0x60, 0x13, 0x14, 0x60, 0x14, 0x24, 0xFE, -0x60, 0x10, 0x14, 0x60, 0x09, 0x14, 0x60, 0x06, -0x24, 0x06, 0xE4, 0xFE, 0x80, 0x06, 0x7E, 0x04, -0x80, 0x02, 0x7E, 0x08, 0xAF, 0x06, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0xB1, 0x6C, 0x12, 0xBD, 0xA8, +0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xF5, 0x82, +0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0x22, 0xE0, +0xFF, 0x12, 0x7B, 0x07, 0x7C, 0x00, 0xAD, 0x07, +0x22, 0xF0, 0x74, 0x04, 0x2F, 0xF5, 0x82, 0xE4, +0x34, 0xFC, 0xF5, 0x83, 0x22, 0x90, 0x88, 0x27, +0xF0, 0xA3, 0xEF, 0xF0, 0x22, 0xEF, 0x70, 0x02, +0xE1, 0x52, 0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE6, +0x1D, 0x90, 0x98, 0x40, 0xE0, 0x54, 0xFE, 0xF0, +0x90, 0x06, 0x0F, 0xE0, 0x20, 0xE5, 0x07, 0x90, +0x01, 0x0C, 0xE0, 0x30, 0xE1, 0x45, 0x90, 0x01, +0xC7, 0x74, 0x44, 0xF0, 0x80, 0xFE, 0x90, 0x98, +0x40, 0xE0, 0x44, 0x01, 0xF0, 0x90, 0x06, 0x0F, +0xE0, 0x30, 0xE5, 0x10, 0x90, 0x01, 0x0C, 0xE0, +0x20, 0xE1, 0x09, 0x90, 0x98, 0x40, 0xE0, 0x54, +0xFD, 0xF0, 0x80, 0x1F, 0x90, 0x06, 0x0F, 0xE0, +0x20, 0xE5, 0x10, 0x90, 0x01, 0x0C, 0xE0, 0x30, +0xE1, 0x09, 0x90, 0x98, 0x40, 0xE0, 0x44, 0x02, +0xF0, 0x80, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x44, +0xF0, 0x80, 0xFE, 0x90, 0x98, 0x0B, 0xE0, 0xFF, +0x60, 0x02, 0xF1, 0xBB, 0x90, 0x01, 0xC7, 0xE4, +0x12, 0xCF, 0x1B, 0xD1, 0x95, 0x90, 0x06, 0x09, +0xE0, 0x54, 0xFE, 0xF0, 0x7B, 0x35, 0x7D, 0xFF, +0x7F, 0xFF, 0x12, 0x9C, 0x0E, 0x90, 0x8A, 0xEF, +0x12, 0x91, 0xBD, 0x12, 0xD7, 0x64, 0xF0, 0x12, +0xE0, 0xA4, 0x12, 0xAF, 0xDE, 0x90, 0x86, 0x0C, +0x12, 0x91, 0xBD, 0xE4, 0xFB, 0xFD, 0x7F, 0xFF, +0x12, 0x9C, 0x0E, 0x12, 0xEF, 0xB2, 0x90, 0x01, +0x34, 0x74, 0x08, 0xF0, 0xFD, 0xE4, 0xFF, 0x02, +0x7C, 0x74, 0x7D, 0x08, 0xE4, 0xFF, 0x12, 0x7C, +0x7E, 0x90, 0x06, 0x90, 0xE0, 0x54, 0xF0, 0xF0, +0x12, 0xD6, 0xBF, 0xF0, 0x12, 0xE1, 0x6C, 0x12, +0xAA, 0x1B, 0x02, 0xA9, 0x1F, 0xF0, 0xEE, 0x54, +0x20, 0xFE, 0xEF, 0x54, 0xDF, 0x22, 0xFE, 0x54, +0x10, 0xFD, 0xEF, 0x54, 0xEF, 0x4D, 0xFF, 0x22, +0xF0, 0xEE, 0x54, 0x80, 0xFE, 0xEF, 0x54, 0x7F, +0x4E, 0x22, 0x74, 0x00, 0x2F, 0xF9, 0xE4, 0x34, +0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xEF, 0x60, 0x08, +0x90, 0x98, 0x0C, 0xE0, 0xFF, 0x12, 0x9F, 0x1B, +0x22, 0xEF, 0x60, 0x08, 0x90, 0x98, 0x11, 0xE0, +0xFF, 0x12, 0x9F, 0xCE, 0x22, 0xEF, 0x60, 0x0A, +0x90, 0x06, 0x31, 0xE0, 0x44, 0x80, 0xF0, 0x12, +0xB5, 0x63, 0x22, 0xF1, 0xCC, 0x12, 0x9F, 0x84, 0x75, 0x48, 0x08, 0x7B, 0x01, 0x7A, 0x95, 0x79, -0x2F, 0x02, 0x69, 0xF5, 0x12, 0x7B, 0x07, 0x7E, -0x00, 0x74, 0x00, 0x2F, 0x22, 0xB1, 0x6C, 0x12, -0xBD, 0xA8, 0x75, 0x48, 0x70, 0x7B, 0x01, 0x7A, -0x93, 0x79, 0x5D, 0x02, 0x69, 0xF5, 0xEF, 0x60, -0x07, 0x90, 0x98, 0x0D, 0xE0, 0xFF, 0xB1, 0x75, -0x22, 0x90, 0x9A, 0x76, 0x12, 0x84, 0x67, 0x90, -0x9A, 0x79, 0x12, 0x9C, 0x2F, 0x75, 0x48, 0x10, -0x7B, 0x01, 0x7A, 0x93, 0x79, 0xCD, 0x12, 0x69, -0xF5, 0x90, 0x9A, 0x76, 0x12, 0x9C, 0x2F, 0x75, -0x48, 0x10, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0xDD, -0x12, 0x69, 0xF5, 0x90, 0x9A, 0x7C, 0x12, 0x04, -0xB8, 0x90, 0x93, 0xED, 0x12, 0x04, 0x31, 0x90, -0x9A, 0x80, 0xE0, 0x90, 0x93, 0xF4, 0xF0, 0x22, -0xE4, 0xFE, 0xED, 0x30, 0xE1, 0x11, 0x90, 0x01, -0x3F, 0xE0, 0x30, 0xE2, 0x0A, 0x74, 0x04, 0xF0, -0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x0E, 0xED, -0x30, 0xE0, 0x24, 0xEF, 0x30, 0xE6, 0x08, 0x90, -0x01, 0xC7, 0x74, 0x22, 0xF0, 0x7E, 0x01, 0xEF, -0x30, 0xE7, 0x08, 0x90, 0x01, 0xC7, 0x74, 0x21, -0xF0, 0x7E, 0x01, 0xEF, 0x30, 0xE5, 0x08, 0x90, -0x01, 0xC7, 0x74, 0x23, 0xF0, 0x7E, 0x01, 0xAF, -0x06, 0x22, 0x12, 0x02, 0x06, 0x90, 0x98, 0x05, -0x12, 0x8E, 0xE7, 0x90, 0x98, 0x06, 0xF0, 0x22, -0xD1, 0x9D, 0x90, 0x98, 0x07, 0x12, 0x8E, 0xE7, -0xFF, 0xED, 0x2F, 0x90, 0x98, 0x08, 0x12, 0x8F, -0xC7, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x09, 0x12, -0xBF, 0x9B, 0xED, 0x2F, 0x90, 0x98, 0x0A, 0x12, -0xA2, 0x20, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x0B, -0x12, 0xA1, 0x20, 0xFF, 0xED, 0x2F, 0x90, 0x98, -0x0C, 0xD1, 0x58, 0x90, 0x98, 0x0D, 0xF0, 0x22, -0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, 0x1F, 0xFF, -0xAE, 0x05, 0xED, 0x2F, 0x22, 0xD1, 0x9D, 0x90, -0x98, 0x0E, 0x12, 0x8E, 0xE7, 0xFF, 0xED, 0x2F, -0x90, 0x98, 0x0F, 0x12, 0x8F, 0xC7, 0xFF, 0xED, -0x2F, 0x90, 0x98, 0x10, 0x12, 0xBF, 0x9B, 0xED, -0x2F, 0x90, 0x98, 0x11, 0x12, 0xA2, 0x20, 0xFF, -0xED, 0x2F, 0x90, 0x98, 0x12, 0x12, 0xA1, 0x20, -0xFF, 0xED, 0x2F, 0x90, 0x98, 0x13, 0xD1, 0x58, -0x90, 0x98, 0x14, 0xF0, 0x22, 0x90, 0x02, 0x09, -0xE0, 0xFD, 0x12, 0x02, 0x06, 0xFE, 0xAF, 0x05, -0xED, 0x2E, 0x22, 0xD1, 0x9D, 0x90, 0x98, 0x15, -0x12, 0x8E, 0xE7, 0xFF, 0xAE, 0x05, 0xED, 0x2F, -0x90, 0x98, 0x16, 0xF0, 0x22, 0xE4, 0xFF, 0x74, -0x18, 0xD1, 0xE5, 0x74, 0x34, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0xF0, 0x74, -0x10, 0xD1, 0xE5, 0x74, 0x2E, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x93, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, -0xEF, 0xB4, 0x06, 0xDB, 0x22, 0x2F, 0xF5, 0x82, -0xE4, 0x34, 0x06, 0xF5, 0x83, 0xE0, 0xFE, 0x22, -0xEF, 0x60, 0x08, 0x90, 0x98, 0x08, 0xE0, 0xFF, -0x12, 0x9F, 0x7B, 0x22, 0xEF, 0x60, 0x0A, 0x90, -0x06, 0x31, 0xE0, 0x44, 0x80, 0xF0, 0x12, 0xA3, -0xFC, 0x22, 0xF1, 0x1E, 0x7A, 0x98, 0x79, 0x1C, -0x12, 0x04, 0x80, 0x90, 0x98, 0x1D, 0x74, 0x08, -0xF0, 0xA3, 0x74, 0x03, 0xF0, 0x22, 0x7E, 0x00, -0x7F, 0x08, 0x7D, 0x00, 0x7B, 0x01, 0x22, 0x12, -0xA7, 0xDE, 0xF1, 0x0A, 0x12, 0x8C, 0x04, 0x12, -0xBC, 0x45, 0x12, 0xB7, 0x4D, 0x4E, 0xF0, 0xEF, -0xC3, 0x13, 0x30, 0xE0, 0x32, 0x12, 0x8E, 0xE8, -0x90, 0x98, 0x1D, 0x12, 0x8F, 0xC7, 0x90, 0x98, -0x1E, 0xF0, 0x12, 0x02, 0x06, 0xFF, 0x54, 0x04, -0xFE, 0x90, 0x98, 0x1C, 0xE0, 0x54, 0xFB, 0x4E, -0xF0, 0x90, 0x00, 0x03, 0x12, 0x02, 0x1F, 0x90, -0x98, 0x1F, 0xF0, 0xEF, 0x54, 0x08, 0xFF, 0x90, -0x98, 0x1C, 0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, -0x90, 0x9A, 0x1C, 0xED, 0xF0, 0x90, 0x9A, 0x1A, -0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xF1, 0x8D, 0x90, -0x9A, 0x1A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0xA3, -0xE0, 0xFD, 0x02, 0x9C, 0x39, 0xD3, 0x10, 0xAF, -0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x1D, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x98, 0x06, 0xE0, -0xFF, 0xB4, 0x02, 0x08, 0x12, 0xFE, 0x1B, 0x74, -0x08, 0xF0, 0x80, 0x0A, 0xEF, 0xB4, 0x04, 0x06, -0x12, 0xFE, 0x1B, 0x74, 0x10, 0xF0, 0x90, 0x9A, -0x1D, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x64, 0x02, -0x4E, 0x60, 0x09, 0xEF, 0x64, 0x01, 0x4E, 0x60, -0x03, 0x02, 0xF9, 0x04, 0x90, 0x94, 0x36, 0xE0, -0xFF, 0x64, 0xFE, 0x70, 0x03, 0x02, 0xF9, 0x04, -0xEF, 0x64, 0x02, 0x60, 0x08, 0xEF, 0x64, 0x03, -0x60, 0x03, 0x02, 0xF9, 0x04, 0x90, 0x94, 0x96, -0x12, 0xFE, 0x13, 0x90, 0x9A, 0xAA, 0xEE, 0xF0, -0xA3, 0xEF, 0xF0, 0x7E, 0x00, 0x7F, 0x28, 0x7D, -0x00, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x40, 0x12, -0x04, 0x80, 0x7E, 0x00, 0x7F, 0x40, 0x7D, 0x00, -0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x68, 0x12, 0x04, -0x80, 0x90, 0x9A, 0x1D, 0xE0, 0x70, 0x04, 0xA3, -0xE0, 0x64, 0x01, 0x70, 0x57, 0x75, 0x45, 0x01, -0x75, 0x46, 0x94, 0x75, 0x47, 0x66, 0x75, 0x48, -0x10, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0xAC, 0x12, -0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, -0x75, 0x47, 0x05, 0x75, 0x48, 0x10, 0x7B, 0x01, -0x7A, 0x9A, 0x79, 0xBC, 0x12, 0x69, 0xF5, 0x90, -0x9A, 0xAA, 0xA3, 0xE0, 0xFB, 0x90, 0x92, 0x06, -0x74, 0x20, 0x31, 0x1A, 0x90, 0x8F, 0x3A, 0x31, -0x09, 0x90, 0x8F, 0x3D, 0x31, 0x11, 0x90, 0x8F, -0x40, 0xF0, 0x7A, 0x9A, 0x79, 0xAC, 0x12, 0x4C, -0x23, 0x75, 0x45, 0x01, 0x75, 0x46, 0x9A, 0x75, -0x47, 0x68, 0x80, 0x2B, 0x90, 0x9A, 0xAA, 0xA3, -0xE0, 0xFB, 0x90, 0x92, 0x06, 0x74, 0x10, 0x31, -0x1A, 0x90, 0x91, 0x8C, 0x31, 0x09, 0x90, 0x91, -0x8F, 0x31, 0x11, 0x90, 0x91, 0x92, 0xF0, 0x7A, -0x94, 0x79, 0x05, 0x12, 0x61, 0x34, 0x75, 0x45, -0x01, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x70, 0x75, -0x48, 0x28, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x40, -0x12, 0x69, 0xF5, 0x75, 0x45, 0x01, 0x75, 0x46, -0x9A, 0x75, 0x47, 0x48, 0x75, 0x48, 0x20, 0x7B, -0x01, 0x7A, 0x9A, 0x79, 0x1F, 0x12, 0x69, 0xF5, -0x90, 0x9A, 0x46, 0xE0, 0x54, 0x03, 0x90, 0x9A, -0x3F, 0xF0, 0xC3, 0x94, 0x04, 0x50, 0x1C, 0xE0, -0x90, 0x95, 0x5F, 0xF0, 0x75, 0x45, 0x01, 0x75, -0x46, 0x9A, 0x75, 0x47, 0x1F, 0x75, 0x48, 0x20, -0x7B, 0x01, 0x7A, 0x95, 0x79, 0x3F, 0x12, 0x69, -0xF5, 0x80, 0x06, 0x90, 0x95, 0x5F, 0x74, 0x05, -0xF0, 0x90, 0x9A, 0x3F, 0xE0, 0xFF, 0x90, 0x98, -0x06, 0xE0, 0xFD, 0x7B, 0x01, 0x7A, 0x9A, 0x79, -0x1F, 0x12, 0xB3, 0x8F, 0xD0, 0xD0, 0x92, 0xAF, -0x22, 0x12, 0x84, 0x67, 0x7A, 0x9A, 0x79, 0x68, -0x22, 0x12, 0x84, 0x67, 0x90, 0x9A, 0xAA, 0xA3, -0xE0, 0x22, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, -0xFD, 0xFC, 0xFF, 0xFE, 0x12, 0x71, 0xD4, 0x7B, -0x01, 0x7A, 0x94, 0x79, 0x98, 0x22, 0xD3, 0x10, -0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x35, +0x33, 0x02, 0x69, 0xF5, 0x12, 0x7B, 0x07, 0x7E, +0x00, 0x74, 0x00, 0x2F, 0x22, 0xE0, 0xFE, 0xA3, +0xE0, 0xFF, 0x90, 0x02, 0x84, 0xEF, 0xF0, 0xEE, +0xA3, 0xF0, 0xA3, 0xE0, 0x44, 0x01, 0xF0, 0x22, +0x7D, 0x07, 0xEF, 0x5D, 0xC3, 0x60, 0x0D, 0x12, +0xE0, 0x03, 0xED, 0x5F, 0x24, 0x08, 0xFF, 0xE4, +0x3E, 0xFE, 0x80, 0x06, 0x12, 0xE0, 0x03, 0xED, +0x5F, 0xFF, 0x22, 0x74, 0xFF, 0x9D, 0xFD, 0x74, +0xFF, 0x94, 0x00, 0x5E, 0xFE, 0x22, 0x12, 0xD7, +0x85, 0x12, 0xCF, 0x24, 0x90, 0x99, 0x85, 0x11, +0xF0, 0xF9, 0x90, 0x93, 0x24, 0xE0, 0x20, 0xE0, +0x02, 0x01, 0xA3, 0xEC, 0xC3, 0x99, 0x50, 0x7B, +0x90, 0x99, 0x85, 0xE0, 0xFA, 0xA3, 0xE0, 0xFB, +0xEA, 0x90, 0xFD, 0x11, 0xF0, 0xAF, 0x03, 0xAD, +0x07, 0x12, 0xD7, 0xA3, 0x3E, 0x54, 0x3F, 0x90, +0x99, 0x87, 0x31, 0x3D, 0x30, 0xE0, 0x09, 0xC3, +0x13, 0x20, 0xE0, 0x04, 0x31, 0x08, 0x80, 0x02, +0x7E, 0x00, 0xEE, 0xFB, 0xEF, 0x24, 0x18, 0xFF, +0xE4, 0x33, 0xCF, 0x2B, 0xCF, 0x34, 0x00, 0x90, +0x99, 0x87, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, +0x99, 0x87, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x12, +0xDF, 0xE8, 0x90, 0x99, 0x87, 0xEE, 0xF0, 0xA3, +0xEF, 0xF0, 0x90, 0x99, 0x85, 0x11, 0xF9, 0xD3, +0x90, 0x99, 0x86, 0xE0, 0x9F, 0x90, 0x99, 0x85, +0xE0, 0x9E, 0x40, 0x0E, 0x31, 0x17, 0x90, 0x99, +0x86, 0xE0, 0x9F, 0xF0, 0x90, 0x99, 0x85, 0xE0, +0x9E, 0xF0, 0x90, 0x99, 0x85, 0x12, 0xDF, 0xD5, +0x0C, 0x80, 0x80, 0x22, 0x31, 0x27, 0xAD, 0x07, +0x90, 0x01, 0xC4, 0x74, 0xA4, 0xF0, 0x74, 0xE0, +0xA3, 0xF0, 0xED, 0x64, 0x01, 0x60, 0x1E, 0x12, +0x8F, 0xCA, 0xED, 0xB4, 0x02, 0x08, 0x90, 0x01, +0xC7, 0x74, 0x40, 0xF0, 0x80, 0x0A, 0xED, 0xB4, +0x04, 0x06, 0x90, 0x01, 0xC7, 0x74, 0x41, 0xF0, +0x7F, 0x01, 0x02, 0xBC, 0x2E, 0x11, 0x0E, 0x90, +0x02, 0x87, 0xE0, 0x70, 0xF8, 0x90, 0x06, 0x90, +0xE0, 0x44, 0x02, 0xF0, 0x74, 0xA4, 0x04, 0x90, +0x01, 0xC4, 0xF0, 0x74, 0xE0, 0xA3, 0xF0, 0x22, +0xF0, 0xA3, 0xEF, 0xF0, 0x90, 0x02, 0x87, 0xE0, +0x22, 0xEE, 0x8F, 0xF0, 0x12, 0x02, 0xE7, 0x90, +0x88, 0x27, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, +0x74, 0x03, 0x2D, 0xF5, 0x82, 0xE4, 0x34, 0xFB, +0xF5, 0x83, 0xE0, 0x54, 0x03, 0xFE, 0x22, 0x90, +0x88, 0x28, 0xE0, 0x24, 0x01, 0xFF, 0x90, 0x88, +0x27, 0xE0, 0x34, 0x00, 0xFE, 0xC3, 0x22, 0x90, +0x02, 0x86, 0xE0, 0x20, 0xE2, 0x03, 0x7F, 0x04, +0x22, 0x90, 0x02, 0x86, 0xE0, 0x7F, 0x01, 0x20, +0xE1, 0x02, 0x7F, 0x02, 0x22, 0xF0, 0xA3, 0xEF, +0xF0, 0x74, 0x02, 0x2D, 0xF5, 0x82, 0xE4, 0x34, +0xFB, 0xF5, 0x83, 0xE0, 0x54, 0x0F, 0x33, 0x33, +0x33, 0x54, 0xF8, 0xFF, 0x90, 0x98, 0x40, 0xE0, +0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, +0xE4, 0xFD, 0x7F, 0x8F, 0x12, 0x7B, 0x2E, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x31, 0x59, 0x90, 0x98, +0x1A, 0xE0, 0xFF, 0x31, 0x96, 0x90, 0x01, 0x3F, +0x74, 0x04, 0xF0, 0x90, 0x86, 0xB3, 0xE0, 0xFF, +0xB4, 0x01, 0x07, 0x90, 0xFD, 0x00, 0xE0, 0x54, +0xEF, 0xF0, 0xEF, 0xB4, 0x01, 0x07, 0x90, 0xFE, +0x10, 0xE0, 0x54, 0xFB, 0xF0, 0x22, 0x90, 0x99, +0x88, 0xEF, 0xF0, 0xE4, 0xFF, 0x74, 0x33, 0x2F, +0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, +0xFE, 0x74, 0x84, 0x2F, 0xF5, 0x82, 0xE4, 0x34, +0x04, 0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, +0x08, 0xE3, 0x90, 0x95, 0x63, 0xE0, 0x90, 0x04, +0x8C, 0xF0, 0x90, 0x95, 0x65, 0xE0, 0x90, 0x04, +0x8D, 0xF0, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, +0x75, 0x47, 0x42, 0x75, 0x48, 0x08, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x3B, 0x12, 0x69, 0xF5, 0x90, +0x98, 0x1A, 0xE0, 0x60, 0x1A, 0x90, 0x99, 0x88, +0x51, 0x00, 0x12, 0xDF, 0x8A, 0xC0, 0x03, 0x8B, +0x45, 0x75, 0x46, 0x95, 0x75, 0x47, 0x33, 0x75, +0x48, 0x34, 0xD0, 0x03, 0x12, 0x69, 0xF5, 0x22, +0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x7E, 0x00, 0x22, +0x90, 0x98, 0x1D, 0x74, 0x06, 0xF0, 0x90, 0x98, +0x1C, 0x74, 0x08, 0xF0, 0x90, 0x00, 0x4A, 0xE0, +0x54, 0xFE, 0xF0, 0x90, 0x00, 0x4F, 0xE0, 0x44, +0x40, 0xF0, 0x90, 0x00, 0x40, 0xE0, 0x44, 0x08, +0xF0, 0x90, 0x93, 0x29, 0xE0, 0xC4, 0x13, 0x54, +0x07, 0x90, 0x00, 0x65, 0x30, 0xE0, 0x06, 0xE0, +0x44, 0x20, 0xF0, 0x80, 0x04, 0xE0, 0x54, 0xDF, +0xF0, 0x12, 0xBD, 0xD0, 0xFB, 0x7D, 0x01, 0x02, +0x96, 0x1A, 0x90, 0x93, 0x31, 0xE0, 0x30, 0xE0, +0x0D, 0x90, 0x93, 0x29, 0xE0, 0xC4, 0x54, 0x0F, +0x20, 0xE0, 0x03, 0x7F, 0x00, 0x22, 0x7F, 0x01, +0x22, 0xEF, 0x90, 0x01, 0xC7, 0xB4, 0xA0, 0x05, +0x74, 0x04, 0xF0, 0x80, 0x03, 0x74, 0x08, 0xF0, +0x02, 0x8F, 0xCA, 0x12, 0x8F, 0xE5, 0xE4, 0x90, +0x9A, 0x10, 0xF0, 0x90, 0x9A, 0x10, 0xE0, 0xFD, +0xC3, 0x94, 0x06, 0x50, 0x1D, 0x90, 0x9A, 0x09, +0xE0, 0x24, 0x10, 0x12, 0x8D, 0x88, 0xFE, 0x12, +0x8F, 0xBA, 0x90, 0x9A, 0x10, 0xE0, 0x24, 0x0A, +0xF5, 0x82, 0xE4, 0x34, 0x9A, 0x12, 0x8D, 0x73, +0x80, 0xD9, 0x78, 0x38, 0x7C, 0x93, 0x7D, 0x01, +0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x0A, 0x12, 0xA7, +0xED, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0xEF, +0x20, 0xE0, 0x05, 0x90, 0x98, 0x09, 0x80, 0x03, +0x90, 0x98, 0x0A, 0xE0, 0x90, 0x95, 0x64, 0xF0, +0x90, 0x95, 0x64, 0xE0, 0x14, 0x60, 0x13, 0x14, +0x60, 0x14, 0x24, 0xFE, 0x60, 0x10, 0x14, 0x60, +0x09, 0x14, 0x60, 0x06, 0x24, 0x06, 0xE4, 0xFE, +0x80, 0x06, 0x7E, 0x04, 0x80, 0x02, 0x7E, 0x08, +0xAF, 0x06, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x90, +0x9C, 0x5D, 0xED, 0xF0, 0x90, 0x9C, 0x5A, 0x12, +0x82, 0x27, 0xE4, 0x90, 0x9C, 0x5E, 0xF0, 0xA3, +0xF0, 0x12, 0x02, 0x06, 0xFF, 0x12, 0x87, 0x9D, +0xFD, 0x12, 0x95, 0xF5, 0xFB, 0xB1, 0x23, 0x90, +0x9C, 0x5E, 0xEF, 0xF0, 0x90, 0x9C, 0x5A, 0x12, +0x82, 0x1E, 0x12, 0x95, 0xF5, 0xFF, 0x51, 0xB8, +0x90, 0x9C, 0x5F, 0xEF, 0xF0, 0x90, 0x95, 0x64, +0xE0, 0x24, 0xFE, 0x60, 0x15, 0x24, 0xFE, 0x60, +0x11, 0x14, 0x60, 0x07, 0x14, 0x60, 0x04, 0x24, +0x05, 0x70, 0x42, 0x91, 0x8E, 0xFD, 0x91, 0x99, +0x80, 0x0D, 0x91, 0x8E, 0xFD, 0x90, 0x95, 0x64, +0xE0, 0x90, 0x9C, 0x3D, 0xF0, 0x71, 0x86, 0x90, +0x9C, 0x5F, 0xE0, 0xFF, 0x90, 0x9C, 0x5A, 0x12, +0x82, 0x1E, 0x90, 0x9C, 0x5E, 0xE0, 0x7C, 0x00, +0x29, 0xF9, 0xEC, 0x3A, 0xFA, 0xC3, 0xE9, 0x9F, +0xF9, 0xEA, 0x94, 0x00, 0xFA, 0x75, 0x45, 0x01, +0x75, 0x46, 0x95, 0x75, 0x47, 0x33, 0xA3, 0xE0, +0xF5, 0x48, 0x12, 0x69, 0xF5, 0x22, 0x90, 0x9C, +0x39, 0x12, 0x82, 0x27, 0x90, 0x9C, 0x3D, 0xE0, +0xFE, 0x64, 0x04, 0x70, 0x0D, 0x91, 0x75, 0x12, +0x02, 0x06, 0x90, 0x9C, 0x3E, 0x12, 0x87, 0x9C, +0x80, 0x11, 0xEE, 0x64, 0x02, 0x70, 0x32, 0x91, +0x75, 0x12, 0x87, 0xA4, 0x90, 0x9C, 0x3E, 0xF0, +0x12, 0x02, 0x06, 0x90, 0x9C, 0x3F, 0x12, 0x95, +0xF4, 0x90, 0x9C, 0x40, 0xF1, 0xE3, 0x90, 0x9C, +0x41, 0xF0, 0x90, 0x00, 0x06, 0x12, 0x02, 0x1F, +0x90, 0x9C, 0x42, 0xF0, 0x90, 0x00, 0x07, 0x12, +0x02, 0x1F, 0x90, 0x9C, 0x43, 0x12, 0x97, 0xCC, +0xFF, 0xED, 0x70, 0x19, 0xFE, 0x91, 0x7B, 0xE0, +0xB4, 0xFF, 0x06, 0x91, 0x7B, 0xE4, 0xF0, 0x80, +0x07, 0x91, 0x7B, 0xE0, 0x04, 0xF0, 0x80, 0x05, +0x0E, 0xEE, 0xB4, 0x06, 0xE8, 0x90, 0x9C, 0x3D, +0xE0, 0xFE, 0xB4, 0x04, 0x18, 0xA3, 0xE0, 0xFD, +0x91, 0x75, 0xED, 0x91, 0x86, 0xFD, 0x91, 0x75, +0x90, 0x00, 0x01, 0xED, 0x12, 0x02, 0x5E, 0x90, +0x00, 0x02, 0xE4, 0x80, 0x20, 0xEE, 0xB4, 0x02, +0x1F, 0x90, 0x9C, 0x3F, 0x91, 0x73, 0xEE, 0x91, +0x86, 0x44, 0x20, 0x54, 0x7F, 0x91, 0x74, 0x90, +0x00, 0x01, 0xEE, 0x12, 0x02, 0x5E, 0x90, 0x9C, +0x3E, 0xE0, 0x90, 0x00, 0x02, 0x12, 0x02, 0x5E, +0x91, 0x75, 0xE9, 0x24, 0x03, 0xF9, 0xE4, 0x3A, +0xFA, 0x12, 0x02, 0x06, 0x44, 0x20, 0x12, 0x02, +0x4C, 0x90, 0x9C, 0x40, 0x91, 0x73, 0x90, 0x00, +0x04, 0xEE, 0x12, 0x02, 0x5E, 0x90, 0x9C, 0x41, +0xE0, 0x90, 0x00, 0x05, 0x12, 0x02, 0x5E, 0x90, +0x9C, 0x42, 0xE0, 0x90, 0x00, 0x06, 0x12, 0x02, +0x5E, 0x90, 0x9C, 0x43, 0xE0, 0x90, 0x00, 0x07, +0x02, 0x02, 0x5E, 0xE0, 0xFE, 0x90, 0x9C, 0x39, +0x02, 0x82, 0x1E, 0x74, 0x3E, 0x2E, 0xF5, 0x82, +0xE4, 0x34, 0x9C, 0xF5, 0x83, 0x22, 0x12, 0x02, +0x4C, 0x90, 0x9C, 0x3F, 0xE0, 0x22, 0x7B, 0x01, +0x7A, 0x95, 0x79, 0x33, 0x90, 0x9C, 0x5D, 0xE0, +0x22, 0x90, 0x9C, 0x49, 0xED, 0xF0, 0x90, 0x9C, +0x46, 0x12, 0x82, 0x27, 0x12, 0x97, 0xCD, 0x90, +0x9C, 0x4D, 0xF0, 0x90, 0x9C, 0x46, 0x12, 0x9F, +0x04, 0x75, 0x48, 0x03, 0x7B, 0x01, 0x7A, 0x9C, +0x79, 0x4A, 0x12, 0x69, 0xF5, 0x90, 0x9C, 0x49, +0xE0, 0x70, 0x2E, 0xFF, 0x91, 0xF2, 0xE0, 0xB4, +0xFF, 0x06, 0x91, 0xF2, 0xE4, 0xF0, 0x80, 0x07, +0x91, 0xF2, 0xE0, 0x04, 0xF0, 0x80, 0x05, 0x0F, +0xEF, 0xB4, 0x03, 0xE8, 0x75, 0x45, 0x01, 0x75, +0x46, 0x9C, 0x75, 0x47, 0x4A, 0x75, 0x48, 0x03, +0x90, 0x9C, 0x46, 0x12, 0x82, 0x1E, 0x12, 0x69, +0xF5, 0x22, 0x74, 0x4A, 0x2F, 0xF5, 0x82, 0xE4, +0x34, 0x9C, 0xF5, 0x83, 0x22, 0xA3, 0xE0, 0xFE, +0x24, 0x28, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0xE0, 0xFF, 0x74, 0x29, 0x2E, 0xF5, 0x82, +0xE4, 0x34, 0xFC, 0xF5, 0x83, 0xE0, 0xFD, 0x74, +0x2C, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0xFC, 0xF5, +0x83, 0xE0, 0xFB, 0xE4, 0xFE, 0xEF, 0x30, 0xE7, +0x04, 0x7C, 0x02, 0x80, 0x02, 0xE4, 0xFC, 0xED, +0x30, 0xE6, 0x08, 0xAF, 0x03, 0x51, 0xB8, 0xAE, +0x07, 0x80, 0x02, 0xE4, 0xFE, 0xEC, 0x24, 0x18, +0x2E, 0xFF, 0x22, 0xE4, 0x90, 0x9A, 0xD2, 0xF0, +0xA3, 0xF0, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x20, +0xF0, 0x12, 0x76, 0x9B, 0xEF, 0x64, 0x01, 0x70, +0x73, 0x90, 0x98, 0x16, 0xE0, 0xFF, 0x90, 0x92, +0x13, 0x74, 0x0D, 0xF0, 0x7B, 0x08, 0x7D, 0x01, +0x12, 0x66, 0xDB, 0x90, 0x9A, 0xCF, 0xEE, 0xF0, +0xA3, 0xEF, 0xF0, 0x90, 0x9A, 0xCF, 0x91, 0xFD, +0x90, 0x9A, 0xD1, 0xEF, 0xF0, 0x90, 0x9A, 0xCF, +0x12, 0x9F, 0xC2, 0xE4, 0xFD, 0x51, 0xF7, 0x90, +0x9A, 0xD1, 0xE0, 0xFF, 0x90, 0x9A, 0xD0, 0xE0, +0x2F, 0xFF, 0x90, 0x9A, 0xCF, 0xE0, 0x34, 0x00, +0xCF, 0x24, 0x30, 0xCF, 0x34, 0x00, 0xFE, 0x90, +0x9A, 0xD2, 0xF0, 0xA3, 0xEF, 0xF0, 0x12, 0xF1, +0x58, 0xB1, 0xCD, 0x90, 0x98, 0x16, 0xE0, 0xFB, +0xE4, 0xFF, 0xB1, 0xD6, 0xB1, 0xCD, 0x90, 0x98, +0x12, 0xE0, 0xFB, 0x7F, 0x11, 0xB1, 0xD6, 0x12, +0x9D, 0xB8, 0x90, 0x95, 0x79, 0xE4, 0x75, 0xF0, +0x01, 0x12, 0x02, 0xE7, 0x22, 0x90, 0x9A, 0xD2, +0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9C, 0x2C, +0xEC, 0x12, 0x9F, 0xE6, 0xAA, 0x07, 0x90, 0x9C, +0x33, 0x12, 0x04, 0x3D, 0x00, 0x00, 0x00, 0x00, +0xF1, 0xD8, 0xEA, 0x24, 0xEF, 0x60, 0x39, 0x24, +0xD7, 0x70, 0x02, 0xE1, 0x3E, 0x24, 0x3A, 0x60, +0x02, 0xE1, 0x77, 0xF1, 0xAC, 0x24, 0x0A, 0xF1, +0xCD, 0xFE, 0x12, 0xCD, 0xDF, 0xE4, 0x12, 0xCF, +0x66, 0xE4, 0xF0, 0xFE, 0x74, 0x00, 0x2F, 0xF1, +0xC5, 0x7D, 0x14, 0xF1, 0x95, 0x12, 0xCF, 0xD0, +0xF1, 0xA0, 0x90, 0x90, 0xBE, 0x12, 0x04, 0x31, +0x7D, 0x14, 0x7C, 0x00, 0xE4, 0xFF, 0xE1, 0x39, +0x90, 0x9C, 0x2C, 0xE4, 0x75, 0xF0, 0x14, 0x12, +0x02, 0xE7, 0x90, 0x9C, 0x2C, 0xA3, 0xE0, 0xFB, +0xFF, 0x24, 0x06, 0xFC, 0xE4, 0x33, 0x90, 0x9C, +0x37, 0xF0, 0xA3, 0xCC, 0xF0, 0x90, 0x9C, 0x37, +0xA3, 0xE0, 0xFE, 0x12, 0xCD, 0xDF, 0xE4, 0x12, +0xCF, 0x66, 0xE4, 0x12, 0xDE, 0x89, 0xE0, 0xFE, +0xA9, 0x03, 0x74, 0x05, 0x29, 0x12, 0xCF, 0xD7, +0x12, 0xCF, 0x24, 0xFE, 0x90, 0x9C, 0x31, 0xF0, +0xA3, 0xEF, 0xF0, 0x90, 0x9C, 0x2C, 0xE0, 0xFC, +0xA3, 0xE0, 0x2F, 0xFF, 0xEC, 0x3E, 0xFE, 0xD3, +0xEF, 0x94, 0x00, 0xEE, 0x94, 0x01, 0x90, 0x9C, +0x2C, 0x40, 0x6A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, +0xE9, 0x7C, 0x00, 0x24, 0x00, 0xF9, 0xEC, 0x34, +0xFC, 0xFA, 0x7B, 0x01, 0xC3, 0xE4, 0x9F, 0xFD, +0x74, 0x01, 0x9E, 0xFC, 0xF1, 0x97, 0x90, 0x9C, +0x2E, 0xE0, 0x24, 0x01, 0xFF, 0xE4, 0x33, 0xA2, +0xE7, 0x13, 0xEF, 0x13, 0x90, 0xFD, 0x10, 0xF0, +0xF1, 0xBF, 0xC0, 0x00, 0xC0, 0x01, 0xC0, 0x02, +0xC0, 0x03, 0x7B, 0x01, 0x7A, 0xFC, 0x79, 0x00, +0x90, 0x9C, 0x2C, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, +0xC3, 0xE4, 0x9F, 0xFF, 0x74, 0x01, 0x9E, 0xFE, +0xF1, 0xB3, 0xE0, 0xC3, 0x9F, 0xFD, 0xEC, 0x9E, +0xFC, 0x12, 0x45, 0xC2, 0xD0, 0x03, 0xD0, 0x02, +0xD0, 0x01, 0xD0, 0x00, 0x12, 0x80, 0xC0, 0xF1, +0x9A, 0xF1, 0xD8, 0x80, 0x0E, 0xA3, 0xE0, 0x7E, +0x00, 0x24, 0x00, 0xF1, 0xC5, 0xF1, 0xB3, 0xE0, +0xFD, 0xF1, 0x97, 0x90, 0x9C, 0x2C, 0x74, 0xFF, +0x75, 0xF0, 0xEC, 0x12, 0x02, 0xE7, 0xF1, 0xAC, +0x7E, 0x00, 0x24, 0x0C, 0xF9, 0xEE, 0x34, 0xFC, +0xFA, 0x7B, 0x01, 0xC0, 0x02, 0xC0, 0x01, 0x74, +0x10, 0x2F, 0xF9, 0xEE, 0x34, 0xFC, 0xFA, 0xF1, +0xA0, 0x90, 0x90, 0xBE, 0x12, 0x04, 0x31, 0xF1, +0xB3, 0xE0, 0xFD, 0xD0, 0x01, 0xD0, 0x02, 0x7F, +0x11, 0x12, 0x3C, 0xD9, 0x80, 0x31, 0xF1, 0xAC, +0x24, 0x2A, 0xF1, 0xCD, 0xFE, 0x12, 0xCD, 0xDF, +0xE4, 0x12, 0xCF, 0x66, 0xE4, 0xF0, 0x12, 0xDF, +0x8A, 0x7D, 0x48, 0xF1, 0x95, 0xF1, 0xA6, 0xF1, +0xBA, 0x12, 0x80, 0xC0, 0xE4, 0xFD, 0xFC, 0xF1, +0x9A, 0xF1, 0xA6, 0xF1, 0xBA, 0x12, 0x80, 0xC0, +0xF1, 0x9A, 0xF1, 0xA6, 0x12, 0x03, 0xCD, 0x90, +0x9C, 0x2F, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, +0x9C, 0x2F, 0xE0, 0xFC, 0xA3, 0xE0, 0xFD, 0xEC, +0xFF, 0x90, 0x9C, 0x37, 0xA3, 0xE0, 0xFE, 0x12, +0xCD, 0xDF, 0xEF, 0x12, 0xCF, 0x66, 0xED, 0xF0, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x7C, 0x00, 0x12, +0x45, 0xC2, 0x90, 0x9C, 0x33, 0x02, 0x04, 0x31, +0x90, 0x90, 0xBB, 0x12, 0x82, 0x27, 0x90, 0x9C, +0x33, 0x02, 0x04, 0xB8, 0x90, 0x9C, 0x2C, 0xA3, +0xE0, 0xFF, 0x22, 0x90, 0x9C, 0x31, 0xE0, 0xFC, +0xA3, 0x22, 0x78, 0x10, 0x12, 0x03, 0xEB, 0x90, +0x9C, 0x33, 0x02, 0x82, 0x12, 0xF9, 0xEE, 0x34, +0xFC, 0xFA, 0x7B, 0x01, 0x22, 0xFD, 0xE4, 0x33, +0x90, 0x9C, 0x37, 0xF0, 0xA3, 0xED, 0xF0, 0x22, +0x90, 0x9C, 0x2E, 0xE0, 0xC3, 0x13, 0x90, 0xFD, +0x10, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x05, 0x02, +0x02, 0x1F, 0x90, 0x9A, 0x35, 0x12, 0xE8, 0xF1, +0x2F, 0xFF, 0xE4, 0x3E, 0xCF, 0x24, 0x06, 0xCF, +0x34, 0x00, 0x12, 0x8B, 0xE7, 0xEF, 0x64, 0x86, +0x70, 0x20, 0x90, 0x9A, 0x37, 0xE0, 0xFF, 0x90, +0x9A, 0x36, 0xE0, 0x2F, 0xFF, 0x90, 0x9A, 0x35, +0xE0, 0x34, 0x00, 0xCF, 0x24, 0x07, 0xCF, 0x34, +0x00, 0x12, 0x8B, 0xE7, 0xBF, 0xDD, 0x03, 0x7F, +0x01, 0x22, 0x7F, 0x00, 0x22, 0x90, 0x9A, 0x6F, +0x12, 0x82, 0x27, 0x90, 0x9A, 0x72, 0x12, 0x9F, +0x04, 0x75, 0x48, 0x10, 0x7B, 0x01, 0x7A, 0x93, +0x79, 0xD1, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0x6F, +0x12, 0x9F, 0x04, 0x75, 0x48, 0x10, 0x7B, 0x01, +0x7A, 0x93, 0x79, 0xE1, 0x12, 0x69, 0xF5, 0x90, +0x9A, 0x75, 0x12, 0x04, 0xB8, 0x90, 0x93, 0xF1, +0x12, 0x04, 0x31, 0x90, 0x9A, 0x79, 0xE0, 0x90, +0x93, 0xF8, 0xF0, 0x22, 0x90, 0x9A, 0x0F, 0x11, +0xF1, 0x78, 0x13, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, +0xFF, 0x7A, 0x80, 0x79, 0xBA, 0x7E, 0x00, 0x7F, +0x04, 0x12, 0x01, 0xE0, 0x90, 0x9A, 0x11, 0xE0, +0xFF, 0x90, 0x9A, 0x10, 0xE0, 0x2F, 0x12, 0xA7, +0x75, 0x90, 0x9A, 0x17, 0xF0, 0xA3, 0xEF, 0xF0, +0x24, 0x06, 0xFF, 0xE4, 0x3E, 0x12, 0x8B, 0xE7, +0xEF, 0x64, 0x08, 0x70, 0x53, 0x90, 0x9A, 0x18, +0xE0, 0x24, 0x07, 0xFF, 0x90, 0x9A, 0x17, 0xE0, +0x34, 0x00, 0x12, 0x8B, 0xE7, 0xEF, 0x70, 0x40, +0x90, 0x9A, 0x12, 0xF0, 0x90, 0x9A, 0x12, 0xE0, +0xFF, 0xC3, 0x94, 0x04, 0x50, 0x25, 0x90, 0x9A, +0x18, 0xE0, 0x24, 0x18, 0xFD, 0x90, 0x9A, 0x17, +0xE0, 0x12, 0x8B, 0xDD, 0x90, 0x9A, 0x12, 0xE0, +0x24, 0x13, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, +0x83, 0xEF, 0xF0, 0x90, 0x9A, 0x12, 0xE0, 0x04, +0xF0, 0x80, 0xD1, 0x78, 0x13, 0x7C, 0x9A, 0xD1, +0x62, 0xEF, 0x7F, 0x00, 0x70, 0x02, 0x7F, 0x01, +0x22, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0xED, +0xF0, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, +0xD0, 0x90, 0x9A, 0x16, 0x11, 0xF1, 0x90, 0x9A, +0x2E, 0x74, 0x18, 0xF0, 0x7E, 0x00, 0x7F, 0x80, +0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x9A, 0x79, 0x36, +0x12, 0x04, 0x80, 0x90, 0x01, 0xC4, 0x74, 0xFA, +0xF0, 0x74, 0xE8, 0xA3, 0xF0, 0x90, 0x98, 0x0E, +0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x90, 0x9A, 0x2D, +0xEF, 0xF0, 0xF9, 0xE0, 0xFE, 0x24, 0x29, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0xF5, 0x83, 0x74, 0x41, +0xF0, 0xEE, 0x24, 0x28, 0xFD, 0xE4, 0x33, 0xFC, +0x90, 0x9A, 0x2E, 0xE0, 0x7A, 0x00, 0x2D, 0xFE, +0xEA, 0x3C, 0x90, 0x9A, 0x32, 0xF0, 0xA3, 0xCE, +0xF0, 0x74, 0x28, 0x29, 0x12, 0x9F, 0xC6, 0x90, +0x9A, 0x18, 0xE0, 0xFD, 0x12, 0xE2, 0xF7, 0x91, +0x1F, 0x90, 0x9A, 0x32, 0xE0, 0xFF, 0xA3, 0xE0, +0x90, 0x9A, 0x30, 0xCF, 0xF0, 0xA3, 0xEF, 0xF0, +0x90, 0x9A, 0x36, 0x74, 0x01, 0xF0, 0xA3, 0x74, +0x03, 0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0x74, 0x5F, +0xF0, 0x90, 0x9A, 0x32, 0xE4, 0x75, 0xF0, 0x04, +0x12, 0x02, 0xE7, 0x90, 0x94, 0x3D, 0xE0, 0xFF, +0x7E, 0x02, 0xB4, 0xFE, 0x02, 0x7E, 0xFE, 0x90, +0x9A, 0x32, 0xA3, 0xE0, 0xFD, 0x12, 0xCD, 0xDF, +0xEE, 0xF0, 0x74, 0x00, 0x2D, 0x12, 0xCD, 0xE1, +0xE0, 0x90, 0x9A, 0x3A, 0xF0, 0x90, 0x9A, 0x32, +0xE4, 0x75, 0xF0, 0x01, 0x12, 0x02, 0xE7, 0x90, +0x95, 0x32, 0xE0, 0x90, 0x9A, 0x16, 0xB4, 0x01, +0x0B, 0xE0, 0x44, 0x03, 0xFC, 0xA3, 0xE0, 0x44, +0x10, 0xFD, 0x80, 0x09, 0xE0, 0x44, 0x03, 0xFC, +0xA3, 0xE0, 0x44, 0x20, 0xFD, 0x90, 0x9A, 0x34, +0xEC, 0xF0, 0xA3, 0xED, 0xF0, 0x90, 0x9A, 0x16, +0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x90, +0x9A, 0x32, 0x70, 0x18, 0xA3, 0xE0, 0xFE, 0x12, +0xCD, 0xDF, 0x12, 0xCF, 0x64, 0x74, 0x01, 0xF0, +0x90, 0x9A, 0x3B, 0x74, 0x03, 0xF0, 0xA3, 0x74, +0x01, 0xF0, 0x80, 0x14, 0xA3, 0xE0, 0xFE, 0x12, +0xCD, 0xDF, 0x12, 0xCF, 0x64, 0x74, 0x02, 0xF0, +0x90, 0x9A, 0x3B, 0x04, 0xF0, 0xA3, 0x14, 0xF0, +0x91, 0x54, 0xEF, 0x64, 0xFE, 0x90, 0x9A, 0x32, +0x70, 0x1F, 0xA3, 0xE0, 0x24, 0x00, 0x12, 0xDF, +0x8D, 0xC0, 0x03, 0x8B, 0x45, 0x91, 0x68, 0xD0, +0x03, 0x12, 0x9F, 0xDF, 0x91, 0x68, 0x7B, 0x01, +0x7A, 0x9A, 0x79, 0x3D, 0x12, 0x69, 0xF5, 0x80, +0x22, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x24, 0x00, +0xF5, 0x82, 0x74, 0xFC, 0x3E, 0xF5, 0x83, 0xE4, +0xF0, 0x74, 0x01, 0x2F, 0xF5, 0x82, 0x74, 0xFC, +0x3E, 0xF5, 0x83, 0xE4, 0xF0, 0x90, 0x9A, 0x3D, +0xF0, 0xA3, 0xF0, 0x91, 0x54, 0xE4, 0x90, 0x9A, +0x2F, 0xF0, 0x91, 0x72, 0xFE, 0x90, 0x9A, 0x32, +0xA3, 0xE0, 0xFD, 0xEF, 0x2D, 0x12, 0xCD, 0xDF, +0xEE, 0xF0, 0x91, 0x72, 0xFE, 0x74, 0x3F, 0x2F, +0xF5, 0x82, 0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xEE, +0x91, 0x18, 0xF0, 0xE0, 0xB4, 0x08, 0xDB, 0x91, +0x29, 0x90, 0x9A, 0x32, 0xD1, 0x53, 0x90, 0x9A, +0x32, 0xD1, 0x4C, 0x91, 0x1F, 0xE4, 0x90, 0x9A, +0xB9, 0xF0, 0xE4, 0x90, 0x9A, 0x2F, 0xF0, 0x91, +0x4B, 0x50, 0x10, 0x91, 0x82, 0xA3, 0x91, 0x11, +0x91, 0x5E, 0x12, 0xCD, 0xDE, 0xE4, 0x91, 0x18, +0xF0, 0x80, 0xEC, 0x12, 0xBF, 0xE0, 0x90, 0x06, +0x31, 0xE0, 0x54, 0xFB, 0xF0, 0x90, 0x98, 0x0F, +0xE0, 0xFD, 0x12, 0xCF, 0x7D, 0xCE, 0xC3, 0x13, +0xCE, 0x13, 0xD8, 0xF9, 0x12, 0xCF, 0x4E, 0xED, +0xFF, 0x90, 0x98, 0x0E, 0x12, 0xCF, 0x58, 0xC3, +0x33, 0xCE, 0x33, 0xCE, 0xD8, 0xF9, 0xFF, 0x90, +0x9A, 0x2E, 0xE0, 0x7C, 0x00, 0x2F, 0xFF, 0xEC, +0x3E, 0xCF, 0x24, 0x38, 0xCF, 0x34, 0x00, 0xFE, +0x90, 0x92, 0x06, 0x74, 0x10, 0xF0, 0x7B, 0x63, +0xE4, 0xFD, 0x12, 0x71, 0xD4, 0x90, 0x9A, 0x16, +0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, 0x7B, +0x01, 0x7A, 0x9A, 0x79, 0x36, 0x70, 0x15, 0x90, +0x91, 0xA0, 0x91, 0x43, 0x90, 0x91, 0xA3, 0x12, +0x82, 0x27, 0x90, 0x91, 0xA6, 0x91, 0x3B, 0x12, +0x6F, 0x34, 0x80, 0x13, 0x90, 0x91, 0x96, 0x91, +0x43, 0x90, 0x91, 0x99, 0x12, 0x82, 0x27, 0x90, +0x91, 0x9C, 0x91, 0x3B, 0x12, 0x6E, 0xF3, 0x90, +0x9A, 0xB9, 0xE0, 0x04, 0xF0, 0x90, 0x06, 0x31, +0xE0, 0x30, 0xE2, 0x06, 0x91, 0x33, 0x50, 0x02, +0x41, 0xAA, 0x91, 0x33, 0x40, 0x0A, 0x90, 0x06, +0x35, 0xE0, 0x44, 0x20, 0x90, 0x06, 0x34, 0xF0, +0xE4, 0x90, 0x9A, 0x2F, 0xF0, 0x91, 0x4B, 0x50, +0x22, 0x91, 0x82, 0xA3, 0x91, 0x11, 0x91, 0x5E, +0x90, 0x9A, 0x2F, 0xE0, 0x24, 0x19, 0xF5, 0x82, +0xE4, 0x34, 0x9A, 0xF5, 0x83, 0xE0, 0xFF, 0x90, +0x9A, 0x2D, 0x12, 0xCD, 0xDE, 0xEF, 0x91, 0x18, +0xF0, 0x80, 0xDA, 0x90, 0x9A, 0x16, 0xE0, 0x70, +0x04, 0xA3, 0xE0, 0x64, 0x01, 0x70, 0x0F, 0x90, +0x98, 0x0E, 0xE0, 0xFF, 0x90, 0x9A, 0x2E, 0xE0, +0x24, 0x08, 0xFD, 0x12, 0xCD, 0xE9, 0x90, 0x04, +0x1D, 0xE0, 0x60, 0x24, 0x90, 0x05, 0x22, 0xE0, +0x90, 0x9A, 0xB8, 0xF0, 0x7B, 0x1D, 0x12, 0x91, +0xB3, 0xBF, 0x01, 0x06, 0x71, 0xFC, 0x90, 0x04, +0x25, 0xF0, 0x90, 0x9A, 0xB8, 0xE0, 0xFD, 0x7B, +0x1E, 0xE4, 0xFF, 0x12, 0x9C, 0x0E, 0x80, 0x06, +0x71, 0xFC, 0x90, 0x04, 0x25, 0xF0, 0x12, 0x9D, +0xB8, 0x90, 0x88, 0x39, 0xE0, 0x70, 0x05, 0x7F, +0x01, 0x12, 0x78, 0xC0, 0x74, 0xFA, 0x04, 0x90, +0x01, 0xC4, 0xF0, 0x74, 0xE8, 0xA3, 0xF0, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0x90, 0x98, 0x0E, 0xE0, +0xFF, 0x90, 0x92, 0x13, 0x74, 0x08, 0xF0, 0x7B, +0x18, 0x7D, 0x01, 0x12, 0x66, 0xDB, 0x90, 0x9A, +0x2D, 0xEF, 0xF0, 0x90, 0x98, 0x0E, 0xE0, 0x22, +0xF0, 0x90, 0x9A, 0x2F, 0xE0, 0x04, 0x22, 0x90, +0x9A, 0x32, 0xE4, 0x75, 0xF0, 0x08, 0x12, 0x02, +0xE7, 0x90, 0x9A, 0x32, 0xE4, 0x75, 0xF0, 0x08, +0x02, 0x02, 0xE7, 0x90, 0x9A, 0xB9, 0xE0, 0xC3, +0x94, 0x0A, 0x22, 0x74, 0x10, 0xF0, 0x7A, 0x93, +0x79, 0xF9, 0x22, 0x12, 0x82, 0x27, 0x7A, 0x9A, +0x79, 0x19, 0x22, 0x90, 0x9A, 0x2F, 0xE0, 0xFF, +0xC3, 0x94, 0x10, 0x22, 0x90, 0x9A, 0x32, 0xE4, +0x75, 0xF0, 0x02, 0x02, 0x02, 0xE7, 0xFD, 0x12, +0x7B, 0x8B, 0x90, 0x9A, 0x2D, 0xEF, 0xF0, 0x22, +0x75, 0x46, 0x94, 0x75, 0x47, 0x40, 0x75, 0x48, +0x02, 0x22, 0x90, 0x9A, 0x2F, 0xE0, 0xFF, 0x24, +0x42, 0xF5, 0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, +0xE0, 0x22, 0x90, 0x9A, 0x33, 0xE0, 0x2F, 0xFF, +0x90, 0x9A, 0x32, 0xE0, 0x34, 0x00, 0xFE, 0x90, +0x9A, 0xB6, 0xF0, 0x22, 0x90, 0x9A, 0x13, 0x11, +0xF1, 0x12, 0xCF, 0x86, 0x91, 0xA7, 0x91, 0xB0, +0x91, 0xA7, 0xA3, 0xE0, 0xFD, 0x01, 0xFA, 0x90, +0x9A, 0x13, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, +0x9A, 0x16, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, 0x90, +0x98, 0x0A, 0xE0, 0xFF, 0xB4, 0x02, 0x07, 0xD1, +0x1D, 0x74, 0x08, 0xF0, 0x80, 0x09, 0xEF, 0xB4, +0x04, 0x05, 0xD1, 0x1D, 0x74, 0x10, 0xF0, 0x90, +0x9A, 0x16, 0xE0, 0xFE, 0xA3, 0xE0, 0xFF, 0x64, +0x02, 0x4E, 0x60, 0x08, 0xEF, 0x64, 0x01, 0x4E, +0x60, 0x02, 0xC1, 0x10, 0x90, 0x94, 0x3A, 0xE0, +0xFF, 0x64, 0xFE, 0x70, 0x02, 0xC1, 0x10, 0xEF, +0x64, 0x02, 0x60, 0x07, 0xEF, 0x64, 0x03, 0x60, +0x02, 0xC1, 0x10, 0x90, 0x94, 0x9A, 0xD1, 0x5A, +0x90, 0x9A, 0xA3, 0xEE, 0xF0, 0xA3, 0xEF, 0xF0, +0x7E, 0x00, 0x7F, 0x28, 0x7D, 0x00, 0x7B, 0x01, +0x7A, 0x9A, 0x79, 0x39, 0x12, 0x04, 0x80, 0x7E, +0x00, 0x7F, 0x40, 0x7D, 0x00, 0x7B, 0x01, 0x7A, +0x9A, 0x79, 0x61, 0x12, 0x04, 0x80, 0x90, 0x9A, +0x16, 0xE0, 0x70, 0x04, 0xA3, 0xE0, 0x64, 0x01, +0x70, 0x4D, 0x75, 0x45, 0x01, 0x75, 0x46, 0x94, +0x75, 0x47, 0x6A, 0x75, 0x48, 0x10, 0x7B, 0x01, +0x7A, 0x9A, 0x79, 0xA5, 0x12, 0x9F, 0xDF, 0x75, +0x46, 0x94, 0x75, 0x47, 0x09, 0x75, 0x48, 0x10, +0x7B, 0x01, 0x7A, 0x9A, 0x79, 0xB5, 0x12, 0x69, +0xF5, 0xD1, 0x2E, 0x74, 0x20, 0xD1, 0x38, 0x90, +0x8F, 0x3A, 0xD1, 0x15, 0x90, 0x8F, 0x3D, 0xD1, +0x25, 0x90, 0x8F, 0x40, 0xF0, 0x7A, 0x9A, 0x79, +0xA5, 0x12, 0x4C, 0x23, 0x75, 0x45, 0x01, 0x75, +0x46, 0x9A, 0x75, 0x47, 0x61, 0x80, 0x24, 0xD1, +0x2E, 0x74, 0x10, 0xD1, 0x38, 0x90, 0x91, 0x8C, +0xD1, 0x15, 0x90, 0x91, 0x8F, 0xD1, 0x25, 0x90, +0x91, 0x92, 0xF0, 0x7A, 0x94, 0x79, 0x09, 0x12, +0x61, 0x34, 0x75, 0x45, 0x01, 0x75, 0x46, 0x9A, +0x75, 0x47, 0x69, 0x75, 0x48, 0x28, 0x7B, 0x01, +0x7A, 0x9A, 0x79, 0x39, 0x12, 0x69, 0xF5, 0x75, +0x45, 0x01, 0x75, 0x46, 0x9A, 0x75, 0x47, 0x41, +0x75, 0x48, 0x20, 0x7B, 0x01, 0x7A, 0x9A, 0x79, +0x18, 0x12, 0x69, 0xF5, 0x90, 0x9A, 0x3F, 0xE0, +0x54, 0x03, 0x90, 0x9A, 0x38, 0xF0, 0xC3, 0x94, +0x04, 0x50, 0x1C, 0xE0, 0x90, 0x95, 0x63, 0xF0, +0x75, 0x45, 0x01, 0x75, 0x46, 0x9A, 0x75, 0x47, +0x18, 0x75, 0x48, 0x20, 0x7B, 0x01, 0x7A, 0x95, +0x79, 0x43, 0x12, 0x69, 0xF5, 0x80, 0x06, 0x90, +0x95, 0x63, 0x74, 0x05, 0xF0, 0x90, 0x9A, 0x38, +0xE0, 0xFF, 0x90, 0x98, 0x0A, 0xE0, 0xFD, 0x7B, +0x01, 0x7A, 0x9A, 0x79, 0x18, 0x12, 0xA8, 0x33, +0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, 0x82, 0x27, +0x7A, 0x9A, 0x79, 0x61, 0x22, 0x90, 0x9A, 0xA1, +0x74, 0x80, 0xF0, 0xA3, 0x22, 0x12, 0x82, 0x27, +0x90, 0x9A, 0xA3, 0xA3, 0xE0, 0x22, 0x90, 0x9A, +0xA3, 0xA3, 0xE0, 0xFB, 0x90, 0x92, 0x06, 0x22, +0xF0, 0xE4, 0xA3, 0xF0, 0xA3, 0xF0, 0xFD, 0xFC, +0xFF, 0xFE, 0x12, 0x71, 0xD4, 0x7B, 0x01, 0x7A, +0x94, 0x79, 0x9C, 0x22, 0xE4, 0x75, 0xF0, 0x10, +0x02, 0x02, 0xE7, 0xE4, 0x75, 0xF0, 0x20, 0x02, +0x02, 0xE7, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, 0xED, +0xFF, 0x22, 0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, +0x79, 0x53, 0x7E, 0x00, 0x7F, 0x04, 0x02, 0x83, +0xDC, 0x12, 0x8F, 0xDD, 0xE4, 0x90, 0x9A, 0x0C, +0xF0, 0xA3, 0xF0, 0x12, 0x8B, 0xE8, 0xEF, 0x54, +0x0C, 0x64, 0x08, 0x70, 0x4B, 0x12, 0x8F, 0x11, +0xA3, 0xE0, 0x24, 0x06, 0x12, 0x8F, 0xB9, 0xEF, +0x64, 0x88, 0x70, 0x3C, 0x12, 0x8F, 0x11, 0xA3, +0xE0, 0x24, 0x07, 0x12, 0x8F, 0xB9, 0xEF, 0x64, +0x8E, 0x70, 0x2D, 0x90, 0x9A, 0x0C, 0x12, 0x8F, +0xA4, 0xEF, 0x70, 0x24, 0x12, 0x8F, 0x11, 0xD1, +0xD6, 0x24, 0x04, 0x12, 0x8F, 0xB9, 0xEF, 0x64, +0x01, 0x70, 0x15, 0x12, 0x8F, 0x11, 0xD1, 0xD6, +0x24, 0x08, 0x12, 0x8F, 0xB9, 0xBF, 0x01, 0x08, +0x90, 0x01, 0xC7, 0x74, 0x0B, 0x12, 0x8F, 0xC9, +0x90, 0x9A, 0x0C, 0xE0, 0xFF, 0x22, 0x90, 0x9A, +0x0B, 0xE0, 0xFD, 0x90, 0x9A, 0x0A, 0xE0, 0x2D, +0x22, 0xE4, 0xFE, 0xED, 0x30, 0xE1, 0x11, 0x90, +0x01, 0x3F, 0xE0, 0x30, 0xE2, 0x0A, 0x74, 0x04, +0xF0, 0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x0E, +0xED, 0x30, 0xE0, 0x24, 0xEF, 0x30, 0xE6, 0x08, +0x90, 0x01, 0xC7, 0x74, 0x22, 0xF0, 0x7E, 0x01, +0xEF, 0x30, 0xE7, 0x08, 0x90, 0x01, 0xC7, 0x74, +0x21, 0xF0, 0x7E, 0x01, 0xEF, 0x30, 0xE5, 0x08, +0x90, 0x01, 0xC7, 0x74, 0x23, 0xF0, 0x7E, 0x01, +0xAF, 0x06, 0x22, 0x12, 0x02, 0x06, 0x90, 0x98, +0x09, 0x12, 0x87, 0x9C, 0x90, 0x98, 0x0A, 0xF0, +0x22, 0x12, 0x87, 0xC3, 0x90, 0x98, 0x0B, 0x12, +0x87, 0x9C, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x0C, +0x12, 0x87, 0xA3, 0xFF, 0xED, 0x2F, 0x90, 0x98, +0x0D, 0x12, 0x97, 0xCC, 0xFF, 0xED, 0x2F, 0x90, +0x98, 0x0E, 0x12, 0x95, 0xF4, 0xFF, 0xED, 0x2F, +0x90, 0x98, 0x0F, 0x12, 0xE7, 0xE3, 0xFF, 0xED, +0x2F, 0x90, 0x98, 0x10, 0xF1, 0x6B, 0x90, 0x98, +0x11, 0xF0, 0x22, 0xF0, 0x90, 0x00, 0x06, 0x12, +0x02, 0x1F, 0xFF, 0xAE, 0x05, 0xED, 0x2F, 0x22, +0x12, 0x87, 0xC3, 0x90, 0x98, 0x12, 0x12, 0x87, +0x9C, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x13, 0x12, +0x87, 0xA3, 0xFF, 0xED, 0x2F, 0x90, 0x98, 0x14, +0x12, 0x97, 0xCC, 0xFF, 0xED, 0x2F, 0x90, 0x98, +0x15, 0x12, 0x95, 0xF4, 0xFF, 0xED, 0x2F, 0x90, +0x98, 0x16, 0x12, 0xE7, 0xE3, 0xFF, 0xED, 0x2F, +0x90, 0x98, 0x17, 0xF1, 0x6B, 0x90, 0x98, 0x18, +0xF0, 0x22, 0xE4, 0xFF, 0x74, 0x18, 0xF1, 0xDA, +0x74, 0x38, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0xEE, 0xF0, 0x74, 0x10, 0xF1, 0xDA, +0x74, 0x32, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x93, +0xF5, 0x83, 0xEE, 0xF0, 0x0F, 0xEF, 0xB4, 0x06, +0xDB, 0x22, 0x2F, 0xF5, 0x82, 0xE4, 0x34, 0x06, +0xF5, 0x83, 0xE0, 0xFE, 0x22, 0x90, 0x99, 0x85, +0x12, 0x82, 0x27, 0x12, 0xAF, 0x66, 0x12, 0x91, +0xAD, 0x12, 0xDA, 0x82, 0x12, 0xBC, 0xF1, 0x4E, +0xF0, 0xEF, 0xC3, 0x13, 0x30, 0xE0, 0x2E, 0x12, +0x87, 0x9D, 0x90, 0x98, 0x25, 0x12, 0x87, 0xA3, +0x90, 0x98, 0x26, 0xF0, 0x12, 0x02, 0x06, 0xFF, +0x54, 0x04, 0xFE, 0x90, 0x98, 0x24, 0xE0, 0x54, +0xFB, 0x4E, 0x12, 0x97, 0xCC, 0x90, 0x98, 0x27, +0xF0, 0xEF, 0x54, 0x08, 0xFF, 0x90, 0x98, 0x24, +0xE0, 0x54, 0xF7, 0x4F, 0xF0, 0x22, 0xD3, 0x10, +0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0x2E, 0xEF, 0xF0, 0x90, 0x93, 0x06, 0xE0, 0xFF, 0x12, 0x7B, 0x07, 0x74, 0x10, 0x2F, 0xFF, 0x90, 0x9A, -0x35, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, -0x12, 0xBD, 0xA6, 0x75, 0x48, 0x04, 0x7B, 0x01, -0x7A, 0x9A, 0x79, 0xFA, 0x12, 0x69, 0xF5, 0xD0, +0x2E, 0xE0, 0x25, 0xE0, 0x25, 0xE0, 0x2F, 0xFF, +0x12, 0x9F, 0x82, 0x75, 0x48, 0x04, 0x7B, 0x01, +0x7A, 0x9A, 0x79, 0xF1, 0x12, 0x69, 0xF5, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, -0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xEA, 0xE0, 0xFE, -0x90, 0x9A, 0xE7, 0xE0, 0xC3, 0x9E, 0x40, 0x04, +0xC3, 0xC0, 0xD0, 0x90, 0x9A, 0xE1, 0xE0, 0xFE, +0x90, 0x9A, 0xDE, 0xE0, 0xC3, 0x9E, 0x40, 0x04, 0x7F, 0x00, 0x80, 0x0E, 0xEF, 0x60, 0x05, 0xD3, 0x94, 0x0E, 0x40, 0x04, 0x7F, 0x00, 0x80, 0x02, -0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x9A, -0x35, 0xEF, 0xF0, 0x12, 0x76, 0x9B, 0xBF, 0x01, -0x27, 0x90, 0x06, 0x32, 0xE0, 0x44, 0x08, 0xF0, -0x90, 0x9A, 0x35, 0xE0, 0xFF, 0x90, 0x92, 0x13, -0x74, 0x07, 0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, -0x66, 0xDB, 0x90, 0x9A, 0x36, 0xEE, 0xF0, 0xA3, -0xEF, 0xF0, 0x90, 0x04, 0x1F, 0x74, 0x20, 0xF0, -0xD0, 0xD0, 0x92, 0xAF, 0x22, 0xED, 0x14, 0x60, -0x06, 0x04, 0x70, 0x03, 0x7F, 0x01, 0x22, 0x7F, -0x01, 0x22, 0xAD, 0x07, 0x90, 0x95, 0x6D, 0x12, -0xC4, 0x6F, 0x90, 0x95, 0x6D, 0xE0, 0xFF, 0xAE, -0x05, 0x74, 0x04, 0x2E, 0xF5, 0x82, 0xE4, 0x34, -0xFC, 0xF5, 0x83, 0xEF, 0xF0, 0x90, 0x95, 0x6D, -0xA3, 0xE0, 0xFF, 0x74, 0x05, 0x2E, 0x12, 0xBF, -0x83, 0xEF, 0xF0, 0x22, 0x12, 0xAE, 0xFC, 0xE4, -0xA3, 0xF0, 0x90, 0x9A, 0x11, 0xE0, 0xFD, 0xC3, -0x94, 0x04, 0x50, 0x2C, 0x90, 0x9A, 0x10, 0xE0, -0x24, 0x10, 0x12, 0x95, 0x8A, 0xFE, 0x90, 0x8A, -0xE9, 0x12, 0xA8, 0xFB, 0x90, 0x9A, 0x11, 0xE0, -0x24, 0x6F, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0xF5, -0x83, 0xE0, 0x6F, 0x60, 0x03, 0x7F, 0x00, 0x22, -0x90, 0x9A, 0x11, 0xE0, 0x04, 0xF0, 0x80, 0xCA, -0x7F, 0x01, 0x22, 0x12, 0xAE, 0xFC, 0x24, 0x16, -0xFF, 0xE4, 0x3E, 0x12, 0x93, 0xD1, 0x90, 0x95, -0x73, 0xA3, 0xE0, 0xB5, 0x07, 0x1E, 0x90, 0x9A, -0x10, 0xE0, 0x24, 0x16, 0x12, 0x95, 0x8A, 0xFE, -0x12, 0xAD, 0x21, 0x7D, 0x01, 0x12, 0x04, 0x7E, -0xEF, 0xFD, 0x90, 0x95, 0x73, 0xE0, 0x6D, 0x70, -0x01, 0xE4, 0x60, 0x03, 0x7F, 0x00, 0x22, 0x7F, -0x01, 0x22, 0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, -0xD0, 0x90, 0x88, 0x9D, 0xE0, 0x30, 0xE0, 0x10, -0x90, 0x88, 0xA3, 0xE0, 0xC4, 0x13, 0x54, 0x07, -0x30, 0xE0, 0x12, 0x75, 0x16, 0x10, 0x80, 0x2D, -0x12, 0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, -0x75, 0x16, 0x01, 0x80, 0x20, 0x90, 0x88, 0x31, -0x12, 0x97, 0x90, 0x30, 0xE0, 0x05, 0x75, 0x16, -0x02, 0x80, 0x12, 0x90, 0x88, 0x38, 0xE0, 0xD3, -0x94, 0x04, 0x40, 0x05, 0x75, 0x16, 0x08, 0x80, -0x04, 0x51, 0xD8, 0x80, 0x0E, 0x90, 0x01, 0xB9, -0x74, 0x02, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x16, +0x7F, 0x01, 0xD0, 0xD0, 0x92, 0xAF, 0x22, 0x12, +0x8F, 0xE5, 0x90, 0x9A, 0xDC, 0xE0, 0x64, 0x01, +0xF0, 0xE0, 0x24, 0x8F, 0x90, 0x01, 0xC4, 0xF0, +0x74, 0xF0, 0xA3, 0x12, 0x8F, 0x10, 0x02, 0xAA, +0x2D, 0xED, 0x14, 0x60, 0x06, 0x04, 0x70, 0x03, +0x7F, 0x01, 0x22, 0x7F, 0x01, 0x22, 0x12, 0x8F, +0xE5, 0xA3, 0xED, 0xF0, 0x90, 0x95, 0x6D, 0xE0, +0x70, 0x02, 0xA3, 0xE0, 0x60, 0x2E, 0xE4, 0x90, +0x9A, 0x0B, 0xF0, 0x31, 0x08, 0x50, 0x28, 0x12, +0x8F, 0x11, 0xED, 0x24, 0x1C, 0x12, 0x8F, 0xB9, +0x90, 0x9A, 0x0B, 0xE0, 0x24, 0x7B, 0xF5, 0x82, +0xE4, 0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, +0x03, 0x7F, 0x00, 0x22, 0x90, 0x9A, 0x0B, 0xE0, +0x04, 0xF0, 0x80, 0xD7, 0x7F, 0x00, 0x22, 0x90, +0x06, 0x32, 0xE0, 0x44, 0x40, 0xF0, 0xE4, 0x90, +0x95, 0x79, 0xF0, 0xA3, 0xF0, 0x7F, 0x01, 0x22, +0x90, 0x9A, 0x0B, 0xE0, 0xFD, 0xC3, 0x94, 0x02, +0x22, 0x12, 0x8F, 0xE5, 0xA3, 0xED, 0xF0, 0xE4, +0xA3, 0xF0, 0x31, 0x08, 0x50, 0x22, 0x12, 0x8F, +0x11, 0xED, 0x24, 0x1C, 0x12, 0x8F, 0xB9, 0x90, +0x9A, 0x0B, 0xE0, 0x24, 0x9B, 0xF5, 0x82, 0xE4, +0x34, 0x95, 0xF5, 0x83, 0xE0, 0xB5, 0x07, 0x1D, +0x90, 0x9A, 0x0B, 0xE0, 0x04, 0xF0, 0x80, 0xDA, +0x90, 0x06, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x90, +0x01, 0xC7, 0x74, 0x30, 0xF0, 0x7F, 0x01, 0x12, +0xBC, 0x2E, 0x7F, 0x01, 0x22, 0x7F, 0x00, 0x22, +0xAD, 0x07, 0x90, 0x95, 0x71, 0xE4, 0x75, 0xF0, +0x01, 0x12, 0x02, 0xE7, 0x90, 0x95, 0x71, 0xE0, +0xFF, 0xAE, 0x05, 0x74, 0x04, 0x2E, 0x12, 0xDE, +0x8D, 0xEF, 0xF0, 0x90, 0x95, 0x71, 0xA3, 0xE0, +0xFF, 0x74, 0x05, 0x2E, 0x12, 0xCF, 0xD7, 0xEF, +0xF0, 0x22, 0x12, 0x8F, 0xE5, 0xE4, 0xA3, 0xF0, +0x90, 0x9A, 0x0A, 0xE0, 0xFD, 0xC3, 0x94, 0x04, +0x50, 0x29, 0x90, 0x9A, 0x09, 0xE0, 0x24, 0x10, +0x12, 0x8D, 0x88, 0xFE, 0x12, 0x8F, 0xBA, 0x90, +0x9A, 0x0A, 0xE0, 0x24, 0x73, 0xF5, 0x82, 0xE4, +0x34, 0x95, 0xF5, 0x83, 0xE0, 0x6F, 0x60, 0x03, +0x7F, 0x00, 0x22, 0x90, 0x9A, 0x0A, 0xE0, 0x04, +0xF0, 0x80, 0xCD, 0x7F, 0x01, 0x22, 0x7E, 0x00, +0x7F, 0x62, 0x7D, 0x00, 0x7B, 0x01, 0x7A, 0x88, +0x79, 0x31, 0x12, 0x04, 0x80, 0x51, 0xBF, 0x79, +0x08, 0x12, 0x04, 0x80, 0xE4, 0x90, 0x99, 0x83, +0xF0, 0x90, 0x88, 0x35, 0x74, 0x02, 0xF0, 0x90, +0x88, 0x3C, 0x14, 0xF0, 0xA3, 0xF0, 0xA3, 0x74, +0x50, 0xF0, 0x90, 0x88, 0x42, 0xE4, 0xF0, 0xA3, +0x74, 0x02, 0xF0, 0x90, 0x88, 0x4E, 0x74, 0x10, +0xF0, 0xA3, 0x74, 0x50, 0xF0, 0x51, 0xCA, 0x90, +0x8A, 0x89, 0x12, 0x97, 0x5E, 0xE4, 0xFD, 0xFF, +0x12, 0x04, 0x7E, 0x90, 0x8A, 0x89, 0x12, 0x97, +0x5E, 0x7D, 0x0C, 0x7F, 0x02, 0x12, 0x04, 0x7E, +0x90, 0x8A, 0x89, 0x12, 0x97, 0x5E, 0x7D, 0x0C, +0x7F, 0x01, 0x12, 0x04, 0x7E, 0x90, 0x86, 0xB3, +0xE0, 0xFF, 0xB4, 0x01, 0x08, 0x90, 0x88, 0x41, +0x74, 0xD4, 0xF0, 0x80, 0x18, 0xEF, 0xB4, 0x03, +0x0F, 0x90, 0x88, 0x41, 0x74, 0xF4, 0xF0, 0x90, +0x00, 0x92, 0xE0, 0x54, 0x7F, 0xF0, 0x80, 0x05, +0xE4, 0x90, 0x88, 0x41, 0xF0, 0x90, 0x00, 0x79, +0xE0, 0x54, 0x03, 0xFF, 0xBF, 0x02, 0x0D, 0x90, +0x00, 0x28, 0xE0, 0x30, 0xE2, 0x06, 0x90, 0x88, +0x53, 0x74, 0x02, 0xF0, 0x90, 0x88, 0x93, 0x74, +0x03, 0xF0, 0xA3, 0x74, 0x0F, 0xF0, 0xA3, 0xE0, +0x54, 0x01, 0x44, 0x28, 0xF0, 0xA3, 0x74, 0x07, +0xF0, 0x7E, 0x00, 0x7F, 0x18, 0x7D, 0x00, 0x7B, +0x01, 0x7A, 0x93, 0x79, 0x0C, 0x12, 0x04, 0x80, +0x90, 0x8A, 0xA3, 0x12, 0x97, 0x5E, 0x7F, 0x01, +0x12, 0x04, 0x7E, 0x90, 0x05, 0x58, 0x74, 0x02, +0xF0, 0x7E, 0x00, 0xFF, 0x7D, 0x00, 0x7B, 0x01, +0x7A, 0x88, 0x79, 0x9A, 0x12, 0x04, 0x80, 0x90, +0x06, 0x04, 0xE0, 0x54, 0x7F, 0xF0, 0x90, 0x06, +0x0A, 0xE0, 0x54, 0xF8, 0xF0, 0x90, 0x05, 0x22, +0xE4, 0xF0, 0x90, 0x88, 0x9C, 0xF0, 0x22, 0x7E, +0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, +0x93, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, 0xF0, +0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, 0x64, +0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, 0x22, +0xD3, 0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x12, +0x7A, 0x65, 0xEF, 0x64, 0x01, 0x60, 0x05, 0x75, +0x14, 0x01, 0x80, 0x25, 0x90, 0x88, 0x31, 0x12, +0xB2, 0xDA, 0x30, 0xE0, 0x05, 0x75, 0x14, 0x02, +0x80, 0x17, 0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, +0x04, 0x40, 0x05, 0x75, 0x14, 0x08, 0x80, 0x09, +0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x80, +0x0E, 0x90, 0x01, 0xB9, 0x74, 0x02, 0xF0, 0x90, +0x01, 0xB8, 0xE5, 0x14, 0xF0, 0x7F, 0x00, 0xD0, +0xD0, 0x92, 0xAF, 0x22, 0xD3, 0x10, 0xAF, 0x01, +0xC3, 0xC0, 0xD0, 0x12, 0x7A, 0x65, 0xEF, 0x64, +0x01, 0x60, 0x05, 0x75, 0x15, 0x01, 0x80, 0x75, +0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, +0x05, 0x75, 0x15, 0x02, 0x80, 0x67, 0x90, 0x88, +0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, +0x75, 0x15, 0x04, 0x80, 0x58, 0xEF, 0x30, 0xE2, +0x05, 0x75, 0x15, 0x08, 0x80, 0x4F, 0x90, 0x88, +0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x15, 0x10, +0x80, 0x43, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, +0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x15, 0x20, +0x80, 0x33, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, +0x75, 0x15, 0x80, 0x80, 0x28, 0x90, 0x06, 0x62, +0xE0, 0x30, 0xE1, 0x05, 0x75, 0x15, 0x11, 0x80, +0x1C, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, +0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, +0x15, 0x12, 0x80, 0x09, 0x90, 0x01, 0xB8, 0xE4, +0xF0, 0x7F, 0x01, 0x80, 0x0E, 0x90, 0x01, 0xB9, +0x74, 0x04, 0xF0, 0x90, 0x01, 0xB8, 0xE5, 0x15, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, 0x92, 0xAF, 0x22, -0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, 0x01, 0x22, 0x90, 0x93, 0x08, 0xE0, 0xC3, 0x13, 0x20, 0xE0, 0x36, 0x90, 0x02, 0x87, 0xE0, 0x60, 0x02, 0x80, 0x08, 0x90, 0x01, 0x00, 0xE0, 0x64, 0x3F, 0x60, -0x05, 0x75, 0x10, 0x01, 0x80, 0x3A, 0x90, 0x93, -0x2D, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x10, 0x08, -0x80, 0x2E, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, +0x05, 0x75, 0x0D, 0x01, 0x80, 0x34, 0x90, 0x93, +0x31, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x0D, 0x08, +0x80, 0x28, 0x90, 0x02, 0x86, 0xE0, 0x20, 0xE1, 0x02, 0x80, 0x07, 0x90, 0x02, 0x86, 0xE0, 0x30, -0xE3, 0x05, 0x75, 0x10, 0x04, 0x80, 0x19, 0x90, -0x88, 0xE6, 0xE0, 0x30, 0xE0, 0x05, 0x75, 0x10, -0x20, 0x80, 0x0D, 0x90, 0x04, 0x1D, 0xE0, 0x60, -0x05, 0x75, 0x10, 0x40, 0x80, 0x02, 0x80, 0xA0, -0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, 0x90, 0x01, -0xB8, 0xE5, 0x10, 0xF0, 0x7F, 0x00, 0x22, 0xD3, -0x10, 0xAF, 0x01, 0xC3, 0xC0, 0xD0, 0x90, 0x88, -0x9D, 0xE0, 0x30, 0xE0, 0x1E, 0x90, 0x88, 0xAF, -0xE0, 0x60, 0x05, 0x75, 0x17, 0x40, 0x61, 0xF0, -0x90, 0x88, 0x38, 0xE0, 0xD3, 0x94, 0x00, 0x40, -0x02, 0x80, 0x2D, 0x90, 0x88, 0x9C, 0xE0, 0x60, -0x7B, 0x80, 0x55, 0x12, 0x7A, 0x65, 0xEF, 0x64, -0x01, 0x60, 0x05, 0x75, 0x17, 0x01, 0x80, 0x70, -0x90, 0x88, 0x3A, 0xE0, 0xFF, 0x54, 0x03, 0x60, -0x05, 0x75, 0x17, 0x02, 0x80, 0x62, 0x90, 0x88, -0x38, 0xE0, 0xFE, 0xE4, 0xC3, 0x9E, 0x50, 0x05, -0x75, 0x17, 0x04, 0x80, 0x53, 0xEF, 0x30, 0xE2, -0x05, 0x75, 0x17, 0x08, 0x80, 0x4A, 0x90, 0x88, -0x3A, 0xE0, 0x30, 0xE4, 0x05, 0x75, 0x17, 0x10, -0x80, 0x3E, 0x90, 0x88, 0x32, 0xE0, 0x13, 0x13, -0x54, 0x3F, 0x20, 0xE0, 0x05, 0x75, 0x17, 0x20, -0x80, 0x2E, 0x90, 0x88, 0x9C, 0xE0, 0x60, 0x05, -0x75, 0x17, 0x80, 0x80, 0x23, 0x90, 0x06, 0x62, -0xE0, 0x30, 0xE1, 0x05, 0x75, 0x17, 0x11, 0x80, -0x17, 0x90, 0x06, 0x62, 0xE0, 0x30, 0xE0, 0x0C, -0xE0, 0x54, 0xFC, 0xFF, 0xBF, 0x80, 0x05, 0x75, -0x17, 0x12, 0x80, 0x04, 0x51, 0xD8, 0x80, 0x0E, -0x90, 0x01, 0xB9, 0x74, 0x04, 0xF0, 0x90, 0x01, -0xB8, 0xE5, 0x17, 0xF0, 0x7F, 0x00, 0xD0, 0xD0, -0x92, 0xAF, 0x22, 0x90, 0x88, 0x8D, 0x74, 0x18, -0xF0, 0xA3, 0xF0, 0xA3, 0xE4, 0xF0, 0xA3, 0x74, -0x64, 0xF0, 0xA3, 0x74, 0x05, 0xF0, 0xA3, 0xF0, -0x22, 0x91, 0x5E, 0x40, 0x40, 0x90, 0x88, 0x50, -0xE0, 0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, -0x90, 0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2D, -0x90, 0x88, 0x48, 0xE0, 0x04, 0xF0, 0x90, 0x88, -0x3F, 0x12, 0xD3, 0x90, 0x33, 0x33, 0x33, 0x54, +0xE3, 0x05, 0x75, 0x0D, 0x04, 0x80, 0x13, 0x90, +0x04, 0x1D, 0xE0, 0x60, 0x05, 0x75, 0x0D, 0x40, +0x80, 0x08, 0x90, 0x01, 0xB8, 0xE4, 0xF0, 0x7F, +0x01, 0x22, 0x90, 0x01, 0xB9, 0x74, 0x08, 0xF0, +0x90, 0x01, 0xB8, 0xE5, 0x0D, 0xF0, 0x7F, 0x00, +0x22, 0x90, 0x99, 0x83, 0x74, 0x01, 0xF0, 0x90, +0x06, 0x92, 0x04, 0xF0, 0x90, 0x01, 0x3C, 0x74, +0x04, 0xF0, 0x90, 0x88, 0x31, 0xE0, 0x44, 0x08, +0xF0, 0x90, 0x88, 0x39, 0xE0, 0x64, 0x0C, 0x60, +0x19, 0x90, 0x8A, 0xB9, 0x12, 0x97, 0x5E, 0xE4, +0xFD, 0x7F, 0x0C, 0x12, 0x04, 0x7E, 0x90, 0x8A, +0xF9, 0x12, 0x97, 0x5E, 0xE4, 0xFD, 0xFF, 0x12, +0x04, 0x7E, 0x90, 0x8A, 0xAF, 0x12, 0x97, 0x5E, +0x7D, 0x08, 0xE4, 0xFF, 0x02, 0x04, 0x7E, 0x91, +0xB6, 0x9F, 0x40, 0x41, 0x90, 0x88, 0x50, 0xE0, +0x04, 0xF0, 0x90, 0x88, 0x92, 0xE0, 0xFF, 0x90, +0x88, 0x50, 0xE0, 0xD3, 0x9F, 0x50, 0x2E, 0x90, +0x88, 0x48, 0xE0, 0x24, 0x08, 0xF0, 0x90, 0x88, +0x3F, 0x12, 0xB2, 0xE3, 0x33, 0x33, 0x33, 0x54, 0xF8, 0xFF, 0x90, 0x88, 0x3E, 0xE0, 0x2F, 0x90, 0x88, 0x4F, 0xF0, 0xFB, 0x90, 0x88, 0x48, 0xE0, 0xFF, 0xA3, 0xE0, 0xFD, 0x90, 0x92, 0x98, 0x74, 0x03, 0xF0, 0x12, 0x6E, 0x2F, 0x22, 0x90, 0x88, 0x93, 0xE0, 0xFF, 0x90, 0x88, 0x3F, 0xE0, 0xD3, -0x9F, 0x22, 0x90, 0x9A, 0x39, 0xE4, 0x75, 0xF0, -0x08, 0x12, 0x02, 0xE7, 0x90, 0x9A, 0x39, 0xE4, -0x75, 0xF0, 0x08, 0x02, 0x02, 0xE7, 0x90, 0x98, -0x0A, 0xE0, 0xFF, 0x90, 0x92, 0x13, 0x74, 0x08, -0xF0, 0x7B, 0x18, 0x7D, 0x01, 0x12, 0x66, 0xDB, -0x90, 0x9A, 0x34, 0xEF, 0xF0, 0x90, 0x98, 0x0A, -0xE0, 0x22, 0x90, 0x9A, 0x3A, 0xE0, 0x2F, 0xFF, -0x90, 0x9A, 0x39, 0xE0, 0x34, 0x00, 0xFE, 0x90, -0x9A, 0xBD, 0xF0, 0x22, 0x90, 0x9A, 0x3C, 0xEE, -0xF0, 0xA3, 0xEF, 0xF0, 0xA3, 0x22, 0x24, 0x48, -0xF9, 0xE4, 0x34, 0xFC, 0xFA, 0x7B, 0x01, 0x22, -0x90, 0x9A, 0x36, 0xE0, 0xFF, 0x24, 0x3E, 0xF5, -0x82, 0xE4, 0x34, 0x94, 0xF5, 0x83, 0xE0, 0x22, -0x7D, 0x01, 0x7B, 0x01, 0x7A, 0x93, 0x79, 0x4F, -0x7E, 0x00, 0x7F, 0x04, 0x02, 0x86, 0x1C, 0x7D, -0x08, 0xE4, 0xFF, 0x12, 0x04, 0x7E, 0x90, 0x98, -0x21, 0xE0, 0x04, 0xF0, 0x22, 0x90, 0x00, 0x03, -0x12, 0x02, 0x1F, 0xC4, 0x13, 0x13, 0x54, 0x03, -0x22, 0xF0, 0x90, 0x9A, 0x36, 0xE0, 0x04, 0xF0, -0x22, 0x90, 0x9C, 0x18, 0x12, 0x84, 0x67, 0xE4, -0x90, 0x9C, 0x1B, 0xF0, 0x22, 0x90, 0x98, 0x01, -0x12, 0x84, 0x52, 0xD3, 0x02, 0x03, 0xDA, 0x7E, -0x00, 0x7F, 0x04, 0x7D, 0x00, 0x7B, 0x01, 0x7A, -0x93, 0x22, 0x90, 0x9A, 0x39, 0xE4, 0x75, 0xF0, -0x02, 0x02, 0x02, 0xE7, 0xE4, 0xFF, 0x12, 0x99, -0x1F, 0x90, 0x04, 0x1F, 0x74, 0x20, 0x22, 0x7D, -0x01, 0x7E, 0x00, 0x7F, 0x10, 0x12, 0x86, 0x1C, -0xEF, 0x22, 0x90, 0x98, 0x37, 0xE0, 0xFF, 0x90, -0x98, 0x36, 0xE0, 0x4F, 0x22, 0xFD, 0x12, 0x7B, -0x8B, 0x90, 0x9A, 0x34, 0xEF, 0x22, 0x74, 0xC9, -0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, 0x22, 0x90, -0x9A, 0x12, 0xE0, 0xFD, 0xC3, 0x94, 0x02, 0x22, -0x90, 0x9A, 0x36, 0xE0, 0xFF, 0xC3, 0x94, 0x10, -0x22, 0x90, 0x9B, 0xDA, 0xE0, 0xFC, 0xA3, 0xE0, -0xFD, 0x22, 0x90, 0x9B, 0xDC, 0xE0, 0xFE, 0xA3, -0xE0, 0xFF, 0x22, 0xFF, 0x90, 0x9A, 0x16, 0xE0, -0x34, 0x00, 0xFE, 0x22, 0x90, 0x9A, 0x39, 0xE0, -0xFF, 0x75, 0xF0, 0x38, 0x22, 0x90, 0x9A, 0x38, -0xE0, 0xFF, 0xC3, 0x94, 0x10, 0x22, 0xE0, 0x24, -0x12, 0xF5, 0x82, 0xE4, 0x34, 0x9A, 0x22, 0x78, -0x18, 0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x22, -0x90, 0x9A, 0x26, 0xE0, 0xFF, 0xC3, 0x94, 0x04, -0x22, 0x90, 0x9A, 0x26, 0xE0, 0xFF, 0xC3, 0x94, -0x06, 0x22, 0x7E, 0x00, 0x7F, 0x06, 0x12, 0x86, -0x1C, 0xEF, 0x22, 0x12, 0x02, 0x06, 0x13, 0x13, -0x13, 0x54, 0x1F, 0x22, 0xA3, 0xE0, 0xFD, 0x12, -0x96, 0xEE, 0xEF, 0x22, 0xED, 0x24, 0x1C, 0xFD, -0x90, 0x8A, 0xE9, 0x22, 0x24, 0x42, 0xF9, 0xE4, -0x34, 0xFC, 0xFA, 0x22, 0x90, 0x88, 0x27, 0xF0, -0xA3, 0xEF, 0xF0, 0x22, 0x90, 0x9A, 0xC0, 0xE0, -0xC3, 0x94, 0x0A, 0x22, 0x74, 0x10, 0xF0, 0x7A, -0x93, 0x79, 0xF5, 0x22, 0x12, 0x84, 0x67, 0x7A, -0x9A, 0x79, 0x20, 0x22, 0x7F, 0x64, 0x7E, 0x00, -0x02, 0x7C, 0x6A, 0xE0, 0xFE, 0xA3, 0xE0, 0xFD, -0xED, 0xFF, 0x22, 0x90, 0x9A, 0xA8, 0x74, 0x80, -0xF0, 0xA3, 0x22, 0x90, 0x05, 0x00, 0x74, 0x1C, -0xF0, 0xA3, 0x22, 0x00, 0x1C, 0xDB +0x22, 0x90, 0x93, 0x08, 0xE0, 0x30, 0xE0, 0x09, +0x90, 0x01, 0x3B, 0xE0, 0x30, 0xE4, 0x02, 0x91, +0xD2, 0x22, 0x7D, 0x02, 0x7F, 0x02, 0x12, 0x7C, +0x7E, 0x7D, 0x01, 0x7F, 0x02, 0x02, 0x7C, 0x7E, +0x90, 0x05, 0x63, 0xE0, 0x90, 0x88, 0x89, 0xF0, +0x90, 0x05, 0x62, 0xE0, 0x90, 0x88, 0x8A, 0xF0, +0x90, 0x05, 0x61, 0xE0, 0x90, 0x88, 0x8B, 0xF0, +0x90, 0x05, 0x60, 0xE0, 0x90, 0x88, 0x8C, 0xF0, +0x90, 0x88, 0x32, 0xE0, 0x44, 0x80, 0xF0, 0x22, +0x90, 0x99, 0x85, 0xA3, 0xE0, 0x24, 0x01, 0xF5, +0x82, 0xE4, 0x34, 0xFC, 0x22, 0x90, 0x99, 0x85, +0xA3, 0xE0, 0x24, 0x03, 0xF5, 0x82, 0xE4, 0x34, +0xFC, 0x22, 0x90, 0x99, 0x85, 0xA3, 0xE0, 0xFF, +0xA3, 0xE0, 0xFE, 0x2F, 0x22, 0x54, 0xFB, 0xF0, +0x90, 0x88, 0x3A, 0xE0, 0x54, 0xFD, 0xF0, 0x22, +0xFF, 0xEC, 0x3E, 0x90, 0x9A, 0x11, 0xF0, 0xA3, +0xEF, 0xF0, 0x22, 0x7D, 0x01, 0x7E, 0x00, 0x7F, +0x10, 0x12, 0x83, 0xDC, 0xEF, 0x22, 0x90, 0x93, +0x09, 0xE0, 0x14, 0x90, 0x93, 0x0B, 0xF0, 0x22, +0x74, 0xCD, 0x2E, 0xF5, 0x82, 0xE4, 0x34, 0x95, +0x22, 0x90, 0x93, 0x0A, 0xE0, 0x90, 0x05, 0x73, +0xF0, 0x22, 0x90, 0x88, 0x38, 0xE0, 0x90, 0x9A, +0xF6, 0xF0, 0x22, 0x7E, 0x00, 0x7F, 0x08, 0x7D, +0x00, 0x7B, 0x01, 0x22, 0x90, 0x9A, 0x32, 0xE0, +0xFF, 0x75, 0xF0, 0x38, 0x22, 0xE0, 0x24, 0x0B, +0xF5, 0x82, 0xE4, 0x34, 0x9A, 0x22, 0x78, 0x11, +0x7C, 0x9A, 0x7D, 0x01, 0x7B, 0xFF, 0x22, 0x90, +0x88, 0x3C, 0xE0, 0x90, 0x05, 0x73, 0x22, 0xE0, +0xFF, 0xC4, 0x13, 0x13, 0x54, 0x03, 0x22, 0x90, +0x93, 0x61, 0x12, 0x04, 0x6E, 0xE0, 0x22, 0x7E, +0x00, 0x7F, 0x10, 0x02, 0x01, 0xE0, 0x90, 0x88, +0x31, 0xE0, 0x54, 0xF7, 0xF0, 0x22, 0x1A, 0x7F }; -u32 array_length_mp_8723d_fw_wowlan = 32334; +u32 array_length_mp_8723d_fw_wowlan = 30176; + +#endif /*CONFIG_WOWLAN*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.h index b87822ba745e..e890c251818f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/hal8723d_fw.h @@ -1,6 +1,6 @@ /****************************************************************************** * -* Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. +* Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,6 @@ * 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 -* -* ******************************************************************************/ #ifdef CONFIG_RTL8723D @@ -25,15 +20,17 @@ #ifdef LOAD_FW_HEADER_FROM_DRIVER #if (defined(CONFIG_AP_WOWLAN) || (DM_ODM_SUPPORT_TYPE & (ODM_AP))) -extern u8 array_mp_8723d_fw_ap[23862]; +extern u8 array_mp_8723d_fw_ap[24014]; extern u32 array_length_mp_8723d_fw_ap; #endif #if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) || (DM_ODM_SUPPORT_TYPE & (ODM_CE)) -extern u8 array_mp_8723d_fw_nic[27506]; +extern u8 array_mp_8723d_fw_nic[27726]; extern u32 array_length_mp_8723d_fw_nic; -extern u8 array_mp_8723d_fw_wowlan[32334]; +#ifdef CONFIG_WOWLAN +extern u8 array_mp_8723d_fw_wowlan[30176]; extern u32 array_length_mp_8723d_fw_wowlan; +#endif /*CONFIG_WOWLAN*/ #endif #endif /* end of LOAD_FW_HEADER_FROM_DRIVER */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_cmd.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_cmd.c index a3e82a9db491..56614a9bd583 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_cmd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_cmd.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTL8723D_CMD_C_ #include @@ -61,12 +56,13 @@ static u8 _is_fw_read_cmd_down(_adapter *padapter, u8 msgbox_num) s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) { u8 h2c_box_num; + u8 h2c[RTL8723D_MAX_CMD_LEN + 1] = {0}; u32 msgbox_addr; u32 msgbox_ex_addr = 0; - PHAL_DATA_TYPE pHalData; u32 h2c_cmd = 0; u32 h2c_cmd_ex = 0; s32 ret = _FAIL; + PHAL_DATA_TYPE pHalData; struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; @@ -92,6 +88,9 @@ s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) if (rtw_is_surprise_removed(padapter)) goto exit; + h2c[0] = ElementID; + _rtw_memcpy(h2c + 1, pCmdBuffer, CmdLen); + /* pay attention to if race condition happened in H2C cmd setting. */ do { h2c_box_num = pHalData->LastHMEBoxNum; @@ -107,28 +106,21 @@ s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer) goto exit; } - if (CmdLen <= 3) - _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, CmdLen); - else { - _rtw_memcpy((u8 *)(&h2c_cmd) + 1, pCmdBuffer, 3); - _rtw_memcpy((u8 *)(&h2c_cmd_ex), pCmdBuffer + 3, CmdLen - 3); - /* *(u8*)(&h2c_cmd) |= BIT(7); */ - } - - *(u8 *)(&h2c_cmd) |= ElementID; - - if (CmdLen > 3) { - msgbox_ex_addr = REG_HMEBOX_EXT0_8723D + (h2c_box_num * RTL8723D_EX_MESSAGE_BOX_SIZE); - h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); - rtw_write32(padapter, msgbox_ex_addr, h2c_cmd_ex); - } - msgbox_addr = REG_HMEBOX_0 + (h2c_box_num * MESSAGE_BOX_SIZE); + /* Write Ext command (byte 4~7) */ + msgbox_ex_addr = REG_HMEBOX_EXT0_8723D + (h2c_box_num * RTL8723D_EX_MESSAGE_BOX_SIZE); + _rtw_memcpy((u8 *)(&h2c_cmd_ex), h2c + 4, RTL8723D_EX_MESSAGE_BOX_SIZE); + h2c_cmd_ex = le32_to_cpu(h2c_cmd_ex); + rtw_write32(padapter, msgbox_ex_addr, h2c_cmd_ex); + /* Write command (byte 0~3) */ + msgbox_addr = REG_HMEBOX_0_8723D + (h2c_box_num * MESSAGE_BOX_SIZE); + _rtw_memcpy((u8 *)(&h2c_cmd), h2c, 4); h2c_cmd = le32_to_cpu(h2c_cmd); rtw_write32(padapter, msgbox_addr, h2c_cmd); /* RTW_INFO("MSG_BOX:%d, CmdLen(%d), CmdID(0x%x), reg:0x%x =>h2c_cmd:0x%.8x, reg:0x%x =>h2c_cmd_ex:0x%.8x\n" */ /* ,pHalData->LastHMEBoxNum , CmdLen, ElementID, msgbox_addr, h2c_cmd, msgbox_ex_addr, h2c_cmd_ex); */ + /* update last msg box number */ pHalData->LastHMEBoxNum = (h2c_box_num + 1) % MAX_H2C_BOX_NUMS; } while (0); @@ -167,7 +159,7 @@ static void ConstructBeacon(_adapter *padapter, u8 *pframe, u32 *pLength) SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); /* pmlmeext->mgnt_seq++; */ - SetFrameSubType(pframe, WIFI_BEACON); + set_frame_sub_type(pframe, WIFI_BEACON); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -256,10 +248,10 @@ static void ConstructPSPoll(_adapter *padapter, u8 *pframe, u32 *pLength) fctrl = &(pwlanhdr->frame_ctl); *(fctrl) = 0; SetPwrMgt(fctrl); - SetFrameSubType(pframe, WIFI_PSPOLL); + set_frame_sub_type(pframe, WIFI_PSPOLL); /* AID. */ - SetDuration(pframe, (pmlmeinfo->aid | 0xc000)); + set_duration(pframe, (pmlmeinfo->aid | 0xc000)); /* BSSID. */ _rtw_memcpy(pwlanhdr->addr1, get_my_bssid(&(pmlmeinfo->network)), ETH_ALEN); @@ -324,7 +316,7 @@ static void ConstructNullFunctionData( if (bQoS == _TRUE) { struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; - SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); + set_frame_sub_type(pframe, WIFI_QOS_DATA_NULL); pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; SetPriority(&pwlanqoshdr->qc, AC); @@ -332,7 +324,7 @@ static void ConstructNullFunctionData( pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); } else { - SetFrameSubType(pframe, WIFI_DATA_NULL); + set_frame_sub_type(pframe, WIFI_DATA_NULL); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); } @@ -340,25 +332,6 @@ static void ConstructNullFunctionData( *pLength = pktlen; } -/* To check if reserved page content is destroyed by beacon because beacon is too large. - * 2010.06.23. Added by tynli. */ -VOID -CheckFwRsvdPageContent( - IN PADAPTER Adapter -) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - u32 MaxBcnPageNum; - - if (pHalData->FwRsvdPageStartOffset != 0) { - /*MaxBcnPageNum = PageNum_128(pMgntInfo->MaxBeaconSize); - RT_ASSERT((MaxBcnPageNum <= pHalData->FwRsvdPageStartOffset), - ("CheckFwRsvdPageContent(): The reserved page content has been"\ - "destroyed by beacon!!! MaxBcnPageNum(%d) FwRsvdPageStartOffset(%d)\n!", - MaxBcnPageNum, pHalData->FwRsvdPageStartOffset));*/ - } -} - /* * Description: Get the reserved page number in Tx packet buffer. * Retrun value: the page number. @@ -387,11 +360,11 @@ static void rtl8723d_set_FwRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsvdpag rsvdpageloc->LocNullData, rsvdpageloc->LocQosNull, rsvdpageloc->LocBTQosNull); - SET_8723D_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); - SET_8723D_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); - SET_8723D_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); - SET_8723D_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); - SET_8723D_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); + SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1H2CRsvdPageParm, rsvdpageloc->LocProbeRsp); + SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1H2CRsvdPageParm, rsvdpageloc->LocPsPoll); + SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocNullData); + SET_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocQosNull); + SET_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(u1H2CRsvdPageParm, rsvdpageloc->LocBTQosNull); RTW_DBG_DUMP("u1H2CRsvdPageParm:", u1H2CRsvdPageParm, H2C_RSVDPAGE_LOC_LEN); @@ -440,120 +413,6 @@ static void rtl8723d_set_FwAoacRsvdPage_cmd(PADAPTER padapter, PRSVDPAGE_LOC rsv #endif /* CONFIG_WOWLAN */ } - -static void rtl8723d_set_FwKeepAlive_cmd(PADAPTER padapter, u8 benable, u8 pkt_type) -{ - u8 u1H2CKeepAliveParm[H2C_KEEP_ALIVE_CTRL_LEN] = {0}; - u8 adopt = 1; -#ifdef CONFIG_PLATFORM_INTEL_BYT - u8 check_period = 10; -#else - u8 check_period = 5; -#endif - - RTW_INFO("%s(): benable = %d\n", __func__, benable); - SET_8723D_H2CCMD_KEEPALIVE_PARM_ENABLE(u1H2CKeepAliveParm, benable); - SET_8723D_H2CCMD_KEEPALIVE_PARM_ADOPT(u1H2CKeepAliveParm, adopt); - SET_8723D_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(u1H2CKeepAliveParm, pkt_type); - SET_8723D_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(u1H2CKeepAliveParm, check_period); - - RTW_DBG_DUMP("u1H2CKeepAliveParm:", - u1H2CKeepAliveParm, H2C_KEEP_ALIVE_CTRL_LEN); - - FillH2CCmd8723D(padapter, H2C_8723D_KEEP_ALIVE, H2C_KEEP_ALIVE_CTRL_LEN, u1H2CKeepAliveParm); -} - -static void rtl8723d_set_FwDisconDecision_cmd(PADAPTER padapter, u8 benable) -{ - u8 u1H2CDisconDecisionParm[H2C_DISCON_DECISION_LEN] = {0}; - u8 adopt = 1, check_period = 10, trypkt_num = 0; - - RTW_INFO("%s(): benable = %d\n", __func__, benable); - SET_8723D_H2CCMD_DISCONDECISION_PARM_ENABLE(u1H2CDisconDecisionParm, benable); - SET_8723D_H2CCMD_DISCONDECISION_PARM_ADOPT(u1H2CDisconDecisionParm, adopt); - SET_8723D_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(u1H2CDisconDecisionParm, check_period); - SET_8723D_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(u1H2CDisconDecisionParm, trypkt_num); - - RTW_DBG_DUMP("u1H2CDisconDecisionParm:", - u1H2CDisconDecisionParm, H2C_DISCON_DECISION_LEN); - - FillH2CCmd8723D(padapter, H2C_8723D_DISCON_DECISION, H2C_DISCON_DECISION_LEN, u1H2CDisconDecisionParm); -} - -void rtl8723d_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask) -{ - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - u8 u1H2CMacIdConfigParm[H2C_MACID_CFG_LEN] = {0}; - - RTW_INFO("%s(): mac_id=%d raid=0x%x bw=%d mask=0x%x\n", __func__, mac_id, raid, bw, mask); - - - SET_8723D_H2CCMD_MACID_CFG_MACID(u1H2CMacIdConfigParm, mac_id); - SET_8723D_H2CCMD_MACID_CFG_RAID(u1H2CMacIdConfigParm, raid); - SET_8723D_H2CCMD_MACID_CFG_SGI_EN(u1H2CMacIdConfigParm, (sgi) ? 1 : 0); - SET_8723D_H2CCMD_MACID_CFG_BW(u1H2CMacIdConfigParm, bw); - - /* DisableTXPowerTraining */ - if (pHalData->bDisableTXPowerTraining) { - SET_8723D_H2CCMD_MACID_CFG_DISPT(u1H2CMacIdConfigParm, 1); - RTW_INFO("%s,Disable PWT by driver\n", __FUNCTION__); - } else { - PDM_ODM_T pDM_OutSrc = &pHalData->odmpriv; - - if (pDM_OutSrc->bDisablePowerTraining) { - SET_8723D_H2CCMD_MACID_CFG_DISPT(u1H2CMacIdConfigParm, 1); - RTW_INFO("%s,Disable PWT by DM\n", __FUNCTION__); - } - } - - SET_8723D_H2CCMD_MACID_CFG_RATE_MASK0(u1H2CMacIdConfigParm, (u8)(mask & 0x000000ff)); - SET_8723D_H2CCMD_MACID_CFG_RATE_MASK1(u1H2CMacIdConfigParm, (u8)((mask & 0x0000ff00) >> 8)); - SET_8723D_H2CCMD_MACID_CFG_RATE_MASK2(u1H2CMacIdConfigParm, (u8)((mask & 0x00ff0000) >> 16)); - SET_8723D_H2CCMD_MACID_CFG_RATE_MASK3(u1H2CMacIdConfigParm, (u8)((mask & 0xff000000) >> 24)); - - RTW_DBG_DUMP("u1H2CMacIdConfigParm:", - u1H2CMacIdConfigParm, H2C_MACID_CFG_LEN); - - FillH2CCmd8723D(padapter, H2C_8723D_MACID_CFG, H2C_MACID_CFG_LEN, u1H2CMacIdConfigParm); - -} - -void rtl8723d_set_FwRssiSetting_cmd(_adapter *padapter, u8 *param) -{ - u8 u1H2CRssiSettingParm[H2C_RSSI_SETTING_LEN] = {0}; - u8 mac_id = *param; - u8 rssi = *(param + 2); - u8 uldl_state = 0; - - /* RTW_INFO("%s(): param=%.2x-%.2x-%.2x\n", __func__, *param, *(param+1), *(param+2)); */ - /* RTW_INFO("%s(): mac_id=%d rssi=%d\n", __func__, mac_id, rssi); */ - - SET_8723D_H2CCMD_RSSI_SETTING_MACID(u1H2CRssiSettingParm, mac_id); - SET_8723D_H2CCMD_RSSI_SETTING_RSSI(u1H2CRssiSettingParm, rssi); - SET_8723D_H2CCMD_RSSI_SETTING_ULDL_STATE(u1H2CRssiSettingParm, uldl_state); - - RTW_DBG_DUMP("u1H2CRssiSettingParm:", - u1H2CRssiSettingParm, H2C_RSSI_SETTING_LEN); - FillH2CCmd8723D(padapter, H2C_8723D_RSSI_SETTING, H2C_RSSI_SETTING_LEN, u1H2CRssiSettingParm); - -} - -void rtl8723d_set_FwAPReqRPT_cmd(PADAPTER padapter, u32 need_ack) -{ - u8 u1H2CApReqRptParm[H2C_AP_REQ_TXRPT_LEN] = {0}; - u8 macid1 = 1, macid2 = 0; - - RTW_INFO("%s(): need_ack = %d\n", __func__, need_ack); - - SET_8723D_H2CCMD_APREQRPT_PARM_MACID1(u1H2CApReqRptParm, macid1); - SET_8723D_H2CCMD_APREQRPT_PARM_MACID2(u1H2CApReqRptParm, macid2); - - RTW_DBG_DUMP("u1H2CApReqRptParm:", - u1H2CApReqRptParm, H2C_AP_REQ_TXRPT_LEN); - - FillH2CCmd8723D(padapter, H2C_8723D_AP_REQ_TXRPT, H2C_AP_REQ_TXRPT_LEN, u1H2CApReqRptParm); -} - void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 psmode) { int i; @@ -565,7 +424,7 @@ void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 psmode) #ifdef CONFIG_P2P struct wifidirect_info *wdinfo = &(padapter->wdinfo); #endif /* CONFIG_P2P */ - + u8 allQueueUAPSD = 0; #ifdef CONFIG_PLATFORM_INTEL_BYT if (psmode == PS_MODE_DTIM) @@ -640,7 +499,7 @@ void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 psmode) SET_8723D_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CPwrModeParm, smart_ps); SET_8723D_H2CCMD_PWRMODE_PARM_RLBM(u1H2CPwrModeParm, rlbm); SET_8723D_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CPwrModeParm, awake_intvl); - SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CPwrModeParm, padapter->registrypriv.uapsd_enable); + SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CPwrModeParm, allQueueUAPSD); SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CPwrModeParm, PowerState); SET_8723D_H2CCMD_PWRMODE_PARM_BYTE5(u1H2CPwrModeParm, byte5); #ifdef CONFIG_LPS_LCLK @@ -712,6 +571,25 @@ void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 psmode) FillH2CCmd8723D(padapter, H2C_8723D_SET_PWR_MODE, H2C_PWRMODE_LEN, u1H2CPwrModeParm); } +#ifdef CONFIG_TDLS +#ifdef CONFIG_TDLS_CH_SW +void rtl8723d_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable) +{ + u8 u1H2CSetPwrMode[H2C_PWRMODE_LEN] = {0}; + + SET_8723D_H2CCMD_PWRMODE_PARM_MODE(u1H2CSetPwrMode, 1); + SET_8723D_H2CCMD_PWRMODE_PARM_RLBM(u1H2CSetPwrMode, 1); + SET_8723D_H2CCMD_PWRMODE_PARM_SMART_PS(u1H2CSetPwrMode, 0); + SET_8723D_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1H2CSetPwrMode, 0); + SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(u1H2CSetPwrMode, 0); + SET_8723D_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(u1H2CSetPwrMode, enable); + SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(u1H2CSetPwrMode, 0x0C); + SET_8723D_H2CCMD_PWRMODE_PARM_BYTE5(u1H2CSetPwrMode, 0); + FillH2CCmd8723D(padapter, H2C_8723D_SET_PWR_MODE, sizeof(u1H2CSetPwrMode), u1H2CSetPwrMode); +} +#endif +#endif + void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter) { struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); @@ -735,44 +613,6 @@ void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter) FillH2CCmd8723D(padapter, H2C_8723D_PS_TUNING_PARA, H2C_PSTUNEPARAM_LEN, u1H2CPsTuneParm); } -void rtl8723d_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param) -{ - u8 u1H2CBtMpOperParm[H2C_BTMP_OPER_LEN] = {0}; - - - RTW_INFO("%s: idx=%d ver=%d reqnum=%d param1=0x%02x param2=0x%02x\n", __FUNCTION__, idx, ver, reqnum, param[0], param[1]); - - SET_8723D_H2CCMD_BT_MPOPER_VER(u1H2CBtMpOperParm, ver); - SET_8723D_H2CCMD_BT_MPOPER_REQNUM(u1H2CBtMpOperParm, reqnum); - SET_8723D_H2CCMD_BT_MPOPER_IDX(u1H2CBtMpOperParm, idx); - SET_8723D_H2CCMD_BT_MPOPER_PARAM1(u1H2CBtMpOperParm, param[0]); - SET_8723D_H2CCMD_BT_MPOPER_PARAM2(u1H2CBtMpOperParm, param[1]); - SET_8723D_H2CCMD_BT_MPOPER_PARAM3(u1H2CBtMpOperParm, param[2]); - - RTW_DBG_DUMP("u1H2CBtMpOperParm:", - u1H2CBtMpOperParm, H2C_BTMP_OPER_LEN); - - FillH2CCmd8723D(padapter, H2C_8723D_BT_MP_OPER, H2C_BTMP_OPER_LEN, u1H2CBtMpOperParm); -} - -void rtl8723d_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 en) -{ - /* u8 cmd_param; //BIT0:enable, BIT1:Ignore PS Condition.*/ - - u8 parm[H2C_INACTIVE_PS_LEN] = {0}; - - SET_H2CCMD_INACTIVE_PS_EN(parm, en); - - FillH2CCmd8723D(padapter, H2C_INACTIVE_PS_, H2C_INACTIVE_PS_LEN, parm); -} - -static s32 rtl8723d_set_FwLowPwrLps_cmd(PADAPTER padapter, u8 enable) -{ - /* TODO */ - return _FALSE; -} - - void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -782,7 +622,7 @@ void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus) BOOLEAN bcn_valid = _FALSE; u8 DLBcnCount = 0; u32 poll = 0; - u8 val8; + u8 val8, RegFwHwTxQCtrl; RTW_INFO("+" FUNC_ADPT_FMT ": hw_port=%d mstatus(%x)\n", @@ -810,12 +650,13 @@ void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus) rtw_write8(padapter, REG_BCN_CTRL, val8); /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ - if (pHalData->RegFwHwTxQCtrl & BIT(6)) + RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2); + if (RegFwHwTxQCtrl & BIT(6)) bRecover = _TRUE; /* To tell Hw the packet is not a real beacon frame. */ - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl & ~BIT(6)); - pHalData->RegFwHwTxQCtrl &= ~BIT(6); + RegFwHwTxQCtrl &= ~BIT(6); + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); /* Clear beacon valid check bit. */ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); @@ -862,8 +703,8 @@ void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus) /* the beacon cannot be sent by HW. */ /* 2010.06.23. Added by tynli. */ if (bRecover) { - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl | BIT(6)); - pHalData->RegFwHwTxQCtrl |= BIT(6); + RegFwHwTxQCtrl |= BIT(6); + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); } /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ @@ -876,11 +717,6 @@ void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus) } -void rtl8723d_set_rssi_cmd(_adapter *padapter, u8 *param) -{ - rtl8723d_set_FwRssiSetting_cmd(padapter, param); -} - void rtl8723d_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus) { struct sta_info *psta = NULL; @@ -890,12 +726,6 @@ void rtl8723d_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus) if (mstatus == 1) rtl8723d_download_rsvd_page(padapter, RT_MEDIA_CONNECT); } -#if 0 -void rtl8723d_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack) -{ - rtl8723d_set_FwAPReqRPT_cmd(padapter, need_ack); -} -#endif #ifdef CONFIG_BT_COEXIST static void ConstructBtNullFunctionData( @@ -938,13 +768,13 @@ static void ConstructBtNullFunctionData( _rtw_memcpy(pwlanhdr->addr2, adapter_mac_addr(padapter), ETH_ALEN); _rtw_memcpy(pwlanhdr->addr3, adapter_mac_addr(padapter), ETH_ALEN); - SetDuration(pwlanhdr, 0); + set_duration(pwlanhdr, 0); SetSeqNum(pwlanhdr, 0); if (bQoS == _TRUE) { struct rtw_ieee80211_hdr_3addr_qos *pwlanqoshdr; - SetFrameSubType(pframe, WIFI_QOS_DATA_NULL); + set_frame_sub_type(pframe, WIFI_QOS_DATA_NULL); pwlanqoshdr = (struct rtw_ieee80211_hdr_3addr_qos *)pframe; SetPriority(&pwlanqoshdr->qc, AC); @@ -952,7 +782,7 @@ static void ConstructBtNullFunctionData( pktlen = sizeof(struct rtw_ieee80211_hdr_3addr_qos); } else { - SetFrameSubType(pframe, WIFI_DATA_NULL); + set_frame_sub_type(pframe, WIFI_DATA_NULL); pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); } @@ -1072,7 +902,7 @@ void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter) u8 bcn_valid = _FALSE; u8 DLBcnCount = 0; u32 poll = 0; - u8 val8; + u8 val8, RegFwHwTxQCtrl; RTW_INFO("+" FUNC_ADPT_FMT ": hw_port=%d fw_state=0x%08X\n", @@ -1107,12 +937,13 @@ void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter) rtw_write8(padapter, REG_BCN_CTRL, val8); /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ - if (pHalData->RegFwHwTxQCtrl & BIT(6)) + RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2); + if (RegFwHwTxQCtrl & BIT(6)) bRecover = _TRUE; /* To tell Hw the packet is not a real beacon frame. */ - pHalData->RegFwHwTxQCtrl &= ~BIT(6); - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); + RegFwHwTxQCtrl &= ~BIT(6); + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); /* Clear beacon valid check bit. */ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); @@ -1159,8 +990,8 @@ void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter) /* the beacon cannot be sent by HW. */ /* 2010.06.23. Added by tynli. */ if (bRecover) { - pHalData->RegFwHwTxQCtrl |= BIT(6); - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, pHalData->RegFwHwTxQCtrl); + RegFwHwTxQCtrl |= BIT(6); + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); } /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ @@ -1254,26 +1085,3 @@ void rtl8723d_set_p2p_ps_offload_cmd(_adapter *padapter, u8 p2p_ps_state) } #endif /* CONFIG_P2P */ - -#ifdef CONFIG_TSF_RESET_OFFLOAD -/* - ask FW to Reset sync register at Beacon early interrupt -*/ -u8 rtl8723d_reset_tsf(_adapter *padapter, u8 reset_port) -{ - u8 buf[2]; - u8 res = _SUCCESS; - - if (HW_PORT0 == reset_port) { - buf[0] = 0x1; - buf[1] = 0; - - } else { - buf[0] = 0x0; - buf[1] = 0x1; - } - FillH2CCmd8723D(padapter, H2C_8723D_RESET_TSF, 2, buf); - - return res; -} -#endif /* CONFIG_TSF_RESET_OFFLOAD */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_dm.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_dm.c index 8e332e505981..7db737029b4e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_dm.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_dm.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /* ************************************************************ * Description: * @@ -60,26 +55,6 @@ dm_CheckProtection( #endif } -static VOID -dm_CheckStatistics( - IN PADAPTER Adapter -) -{ -#if 0 - if (!Adapter->MgntInfo.bMediaConnect) - return; - - /* 2008.12.10 tynli Add for getting Current_Tx_Rate_Reg flexibly. */ - rtw_hal_get_hwreg(Adapter, HW_VAR_INIT_TX_RATE, (pu1Byte)(&Adapter->TxStats.CurrentInitTxRate)); - - /* Calculate current Tx Rate(Successful transmited!!) */ - - /* Calculate current Rx Rate(Successful received!!) */ - - /* for tx tx retry count */ - rtw_hal_get_hwreg(Adapter, HW_VAR_RETRY_COUNT, (pu1Byte)(&Adapter->TxStats.NumTxRetryCount)); -#endif -} #ifdef CONFIG_SUPPORT_HW_WPS_PBC static void dm_CheckPbcGPIO(_adapter *padapter) { @@ -232,85 +207,19 @@ dm_InitGPIOSetting( static void Init_ODM_ComInfo_8723d(PADAPTER Adapter) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); - u32 SupportAbility = 0; + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); u8 cut_ver, fab_ver; Init_ODM_ComInfo(Adapter); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_PACKAGE_TYPE, pHalData->PackageType); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_PACKAGE_TYPE, pHalData->PackageType); fab_ver = ODM_TSMC; - cut_ver = GET_CVID_CUT_VERSION(pHalData->VersionID); + cut_ver = GET_CVID_CUT_VERSION(pHalData->version_id); RTW_INFO("%s(): fab_ver=%d cut_ver=%d\n", __func__, fab_ver, cut_ver); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver); - -#ifdef CONFIG_DISABLE_ODM - SupportAbility = 0; -#else - SupportAbility = -#if 1 - ODM_RF_CALIBRATION | - ODM_RF_TX_PWR_TRACK -#else - 0 -#endif - ; - if (pHalData->AntDivCfg) - SupportAbility |= ODM_BB_ANT_DIV; -#endif - - ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); -} - -static void Update_ODM_ComInfo_8723d(PADAPTER Adapter) -{ - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); - u32 SupportAbility = 0; - - SupportAbility = 0 - | ODM_BB_DIG /* For BB */ - | ODM_BB_RA_MASK - | ODM_BB_FA_CNT - | ODM_BB_RSSI_MONITOR - | ODM_BB_CCK_PD - | ODM_BB_CFO_TRACKING - /* | ODM_BB_PWR_TRAIN */ - | ODM_BB_NHM_CNT - | ODM_RF_TX_PWR_TRACK /* For RF */ - | ODM_RF_CALIBRATION - | ODM_MAC_EDCA_TURBO /* For MAC */ - ; - - if (rtw_odm_adaptivity_needed(Adapter) == _TRUE) { - rtw_odm_adaptivity_config_msg(RTW_DBGDUMP, Adapter); - SupportAbility |= ODM_BB_ADAPTIVITY; - } - -#ifdef CONFIG_ANTENNA_DIVERSITY - if (pHalData->AntDivCfg) - SupportAbility |= ODM_BB_ANT_DIV; -#endif - -#if (MP_DRIVER == 1) - if (Adapter->registrypriv.mp_mode == 1) { - SupportAbility = 0 - | ODM_RF_CALIBRATION - | ODM_RF_TX_PWR_TRACK - ; - } -#endif/* (MP_DRIVER==1) */ - -#ifdef CONFIG_DISABLE_ODM - SupportAbility = 0; -#endif/* CONFIG_DISABLE_ODM */ - - ODM_CmnInfoUpdate(pDM_Odm, ODM_CMNINFO_ABILITY, SupportAbility); - ODM_CmnInfoInit(pDM_Odm, ODM_CMNINFO_RF_ANTENNA_TYPE, - pHalData->TRxAntDivType); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_FAB_VER, fab_ver); + odm_cmn_info_init(pDM_Odm, ODM_CMNINFO_CUT_VER, cut_ver); } void @@ -319,19 +228,12 @@ rtl8723d_InitHalDm( ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); - - u8 i; + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); #ifdef CONFIG_USB_HCI dm_InitGPIOSetting(Adapter); #endif - - pHalData->DM_Type = DM_Type_ByDriver; - - Update_ODM_ComInfo_8723d(Adapter); - - ODM_DMInit(pDM_Odm); + odm_dm_init(pDM_Odm); } @@ -341,7 +243,7 @@ rtl8723d_HalDmWatchDog( ) { BOOLEAN bFwCurrentInPSMode = _FALSE; - BOOLEAN bFwPSAwake = _TRUE; + u8 bFwPSAwake = _TRUE; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); #ifdef CONFIG_MP_INCLUDED @@ -356,7 +258,7 @@ rtl8723d_HalDmWatchDog( #ifdef CONFIG_LPS bFwCurrentInPSMode = adapter_to_pwrctl(Adapter)->bFwCurrentInPSMode; - rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, (u8 *)(&bFwPSAwake)); + rtw_hal_get_hwreg(Adapter, HW_VAR_FWLPS_RF_ON, &bFwPSAwake); #endif #ifdef CONFIG_P2P @@ -369,10 +271,7 @@ rtl8723d_HalDmWatchDog( if ((rtw_is_hw_init_completed(Adapter)) && ((!bFwCurrentInPSMode) && bFwPSAwake)) { - /* */ - /* Calculate Tx/Rx statistics. */ - /* */ - dm_CheckStatistics(Adapter); + rtw_hal_check_rxfifo_full(Adapter); /* */ /* Dynamically switch RTS/CTS protection. */ @@ -389,30 +288,10 @@ rtl8723d_HalDmWatchDog( #endif } - /* ODM */ - if (rtw_is_hw_init_completed(Adapter)) { - u8 bLinked = _FALSE; - u8 bsta_state = _FALSE; - u8 bBtDisabled = _TRUE; - - if (rtw_mi_check_status(Adapter, MI_ASSOC)) { - bLinked = _TRUE; - if (rtw_mi_check_status(Adapter, MI_STA_LINKED)) - bsta_state = _TRUE; - } - - ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_LINK, bLinked); - ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_STATION_STATE, bsta_state); - - /* ODM_CmnInfoUpdate(&pHalData->odmpriv ,ODM_CMNINFO_RSSI_MIN, pdmpriv->MinUndecoratedPWDBForDM); */ - -#ifdef CONFIG_BT_COEXIST - bBtDisabled = rtw_btcoex_IsBtDisabled(Adapter); -#endif /* CONFIG_BT_COEXIST */ - ODM_CmnInfoUpdate(&pHalData->odmpriv, ODM_CMNINFO_BT_ENABLED, ((bBtDisabled == _TRUE) ? _FALSE : _TRUE)); - - ODM_DMWatchdog(&pHalData->odmpriv); - } +#ifdef CONFIG_DISABLE_ODM + goto skip_dm; +#endif + rtw_phydm_watchdog(Adapter); skip_dm: @@ -429,108 +308,21 @@ rtl8723d_HalDmWatchDog( return; } -void rtl8723d_hal_dm_in_lps(PADAPTER padapter) -{ - u32 PWDB_rssi = 0; - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - struct sta_priv *pstapriv = &padapter->stapriv; - struct sta_info *psta = NULL; - - RTW_INFO("%s, RSSI_Min=%d\n", __func__, pDM_Odm->RSSI_Min); - - /* update IGI */ - ODM_Write_DIG(pDM_Odm, pDM_Odm->RSSI_Min); - - - /* set rssi to fw */ - psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); - if (psta && (psta->rssi_stat.UndecoratedSmoothedPWDB > 0)) { - PWDB_rssi = (psta->mac_id | (psta->rssi_stat.UndecoratedSmoothedPWDB << 16)); - - rtl8723d_set_rssi_cmd(padapter, (u8 *)&PWDB_rssi); - } - -} - -void rtl8723d_HalDmWatchDog_in_LPS(IN PADAPTER Adapter) -{ - u8 bLinked = _FALSE; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - struct mlme_priv *pmlmepriv = &Adapter->mlmepriv; - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - pDIG_T pDM_DigTable = &pDM_Odm->DM_DigTable; - struct sta_priv *pstapriv = &Adapter->stapriv; - struct sta_info *psta = NULL; - - if (!rtw_is_hw_init_completed(Adapter)) - goto skip_lps_dm; - - if (rtw_mi_check_status(Adapter, MI_ASSOC)) - bLinked = _TRUE; - - ODM_CmnInfoUpdate(&pHalData->odmpriv , ODM_CMNINFO_LINK, bLinked); - - if (bLinked == _FALSE) - goto skip_lps_dm; - - if (!(pDM_Odm->SupportAbility & ODM_BB_RSSI_MONITOR)) - goto skip_lps_dm; - - - /* ODM_DMWatchdog(&pHalData->odmpriv); */ - /* Do DIG by RSSI In LPS-32K */ - - /* .1 Find MIN-RSSI */ - psta = rtw_get_stainfo(pstapriv, get_bssid(pmlmepriv)); - if (psta == NULL) - goto skip_lps_dm; - - pHalData->EntryMinUndecoratedSmoothedPWDB = psta->rssi_stat.UndecoratedSmoothedPWDB; - - RTW_INFO("CurIGValue=%d, EntryMinUndecoratedSmoothedPWDB = %d\n", pDM_DigTable->CurIGValue, pHalData->EntryMinUndecoratedSmoothedPWDB); - - if (pHalData->EntryMinUndecoratedSmoothedPWDB <= 0) - goto skip_lps_dm; - - pHalData->MinUndecoratedPWDBForDM = pHalData->EntryMinUndecoratedSmoothedPWDB; - - pDM_Odm->RSSI_Min = pHalData->MinUndecoratedPWDBForDM; - - /* if(pDM_DigTable->CurIGValue != pDM_Odm->RSSI_Min) */ - if ((pDM_DigTable->CurIGValue > pDM_Odm->RSSI_Min + 5) || - (pDM_DigTable->CurIGValue < pDM_Odm->RSSI_Min - 5)) - - { -#ifdef CONFIG_LPS - rtw_dm_in_lps_wk_cmd(Adapter); -#endif /* CONFIG_LPS */ - } - - -skip_lps_dm: - - return; - -} - void rtl8723d_init_dm_priv(IN PADAPTER Adapter) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T podmpriv = &pHalData->odmpriv; + struct PHY_DM_STRUCT *podmpriv = &pHalData->odmpriv; Init_ODM_ComInfo_8723d(Adapter); - ODM_InitAllTimers(podmpriv); + odm_init_all_timers(podmpriv); } void rtl8723d_deinit_dm_priv(IN PADAPTER Adapter) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - PDM_ODM_T podmpriv = &pHalData->odmpriv; + struct PHY_DM_STRUCT *podmpriv = &pHalData->odmpriv; - ODM_CancelAllTimers(podmpriv); + odm_cancel_all_timers(podmpriv); } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_hal_init.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_hal_init.c index 17fef5f60cda..65f75f322d36 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_hal_init.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_hal_init.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,17 +11,12 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HAL_INIT_C_ #include -#include #include "hal_com_h2c.h" +#include #include "hal8723d_fw.h" #ifndef CONFIG_DLFW_TXPKT @@ -296,7 +291,7 @@ static s32 polling_fwdl_chksum(_adapter *adapter, u32 min_cnt, u32 timeout_ms) { s32 ret = _FAIL; u32 value32; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); u32 cnt = 0; /* polling CheckSum report */ @@ -305,7 +300,7 @@ static s32 polling_fwdl_chksum(_adapter *adapter, u32 min_cnt, u32 timeout_ms) value32 = rtw_read32(adapter, REG_MCUFWDL); if (value32 & FWDL_ChkSum_rpt || RTW_CANNOT_IO(adapter)) break; - rtw_mdelay_os(5); + rtw_yield_os(); } while (rtw_get_passing_time_ms(start) < timeout_ms || cnt < min_cnt); if (!(value32 & FWDL_ChkSum_rpt)) @@ -327,7 +322,7 @@ static s32 _FWFreeToGo(_adapter *adapter, u32 min_cnt, u32 timeout_ms) { s32 ret = _FAIL; u32 value32; - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); u32 cnt = 0; u32 value_to_check = 0; u32 value_expected = (MCUFWDL_RDY | FWDL_ChkSum_rpt | WINTINI_RDY | RAM_DL_SEL); @@ -373,9 +368,9 @@ void rtl8723d_FirmwareSelfReset(PADAPTER padapter) u8 Delay = 100; if (!(IS_FW_81xxC(padapter) && - ((pHalData->FirmwareVersion < 0x21) || - (pHalData->FirmwareVersion == 0x21 && - pHalData->FirmwareSubVersion < 0x01)))) { /* after 88C Fw v33.1 */ + ((pHalData->firmware_version < 0x21) || + (pHalData->firmware_version == 0x21 && + pHalData->firmware_sub_version < 0x01)))) { /* after 88C Fw v33.1 */ /* 0x1cf=0x20. Inform 8051 to reset. 2009.12.25. tynli_test */ rtw_write8(padapter, REG_HMETFR + 3, 0x20); @@ -418,7 +413,7 @@ int _WriteBTFWtoTxPktBuf8723D( pu1Byte FwbufferPtr = (pu1Byte)buffer; /* PRT_TCB pTcb, ptempTcb; */ /* PRT_TX_LOCAL_BUFFER pBuf; */ - BOOLEAN bRecover = _FALSE; + pu1Byte ReservedPagePacket = NULL; pu1Byte pGenBufReservedPagePacket = NULL; u4Byte TotalPktLen, txpktbuf_bndy; @@ -429,7 +424,7 @@ int _WriteBTFWtoTxPktBuf8723D( struct xmit_frame *pmgntframe; struct pkt_attrib *pattrib; u8 txdesc_offset = TXDESC_OFFSET; - u8 val8; + u8 val8, RegFwHwTxQCtrl; #if (DEV_BUS_TYPE == RT_PCI_INTERFACE) u8 u1bTmp; #endif @@ -471,8 +466,6 @@ int _WriteBTFWtoTxPktBuf8723D( #else /* Remove for temparaily because of the code on v2002 is not sync to MERGE_TMEP for USB/SDIO. */ /* De not remove this part on MERGE_TEMP. by tynli. */ - /* pHalData->RegCR_1 |= (BIT0); */ - /* PlatformEFIOWrite1Byte(Adapter, REG_CR+1, pHalData->RegCR_1); */ #endif /* Disable Hw protection for a time which revserd for Hw sending beacon. */ @@ -490,10 +483,10 @@ int _WriteBTFWtoTxPktBuf8723D( PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, tmpReg422 & (~BIT(6))); #else /* Set FWHW_TXQ_CTRL 0x422[6]=0 to tell Hw the packet is not a real beacon frame. */ - if (pHalData->RegFwHwTxQCtrl & BIT(6)) - bRecover = _TRUE; - PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl & (~BIT(6)))); - pHalData->RegFwHwTxQCtrl &= (~BIT(6)); + RegFwHwTxQCtrl = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2); + + RegFwHwTxQCtrl &= (~BIT(6)); + PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); #endif /* --------------------------------------------------------- */ @@ -664,7 +657,8 @@ SetFwBTPwrCmd( * */ int _CheckWLANFwPatchBTFwReady( - IN PADAPTER Adapter + PADAPTER Adapter, + BOOLEAN bRecover ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); @@ -708,13 +702,10 @@ _CheckWLANFwPatchBTFwReady( /* prevent from setting 0x422[6] to 0 after download reserved page, or it will cause */ /* the beacon cannot be sent by HW. */ /* 2010.06.23. Added by tynli. */ -#if 0/* (DEV_BUS_TYPE == RT_PCI_INTERFACE) */ - u1bTmp = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2); - PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (u1bTmp | BIT(6))); -#else - PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (pHalData->RegFwHwTxQCtrl | BIT(6))); - pHalData->RegFwHwTxQCtrl |= BIT(6); -#endif + if (bRecover) { + u1bTmp = PlatformEFIORead1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2); + PlatformEFIOWrite1Byte(Adapter, REG_FWHW_TXQ_CTRL + 2, (u1bTmp | BIT(6))); + } /* Clear CR[8] or beacon packet will not be send to TxBuf anymore. */ u1bTmp = PlatformEFIORead1Byte(Adapter, REG_CR + 1); @@ -825,7 +816,8 @@ s32 FirmwareDownloadBT(PADAPTER padapter, PRT_MP_FIRMWARE pFirmware) u32 BTFirmwareLen; u8 download_time; s8 i; - + BOOLEAN bRecover = _FALSE; + u8 RegFwHwTxQCtrl; rtStatus = _SUCCESS; pBTFirmwareBuf = NULL; @@ -835,7 +827,7 @@ s32 FirmwareDownloadBT(PADAPTER padapter, PRT_MP_FIRMWARE pFirmware) /* */ /* Patch BT Fw. Download BT RAM code to Tx packet buffer. */ /* */ - if (padapter->bBTFWReady) { + if (GET_HAL_DATA(padapter)->bBTFWReady) { RTW_INFO("%s: BT Firmware is ready!!\n", __FUNCTION__); return _FAIL; } @@ -863,10 +855,14 @@ s32 FirmwareDownloadBT(PADAPTER padapter, PRT_MP_FIRMWARE pFirmware) RTW_INFO("%s: MP BT Firmware size=%d\n", __FUNCTION__, BTFirmwareLen); /* for h2c cam here should be set to true */ - padapter->bFWReady = _TRUE; + GET_HAL_DATA(padapter)->bFWReady = _TRUE; download_time = (BTFirmwareLen + 4095) / 4096; RTW_INFO("%s: download_time is %d\n", __FUNCTION__, download_time); + RegFwHwTxQCtrl = rtw_read8(Adapter, REG_FWHW_TXQ_CTRL + 2); + + if (RegFwHwTxQCtrl & BIT(6)) + bRecover = _TRUE; /* Download BT patch Fw. */ for (i = (download_time - 1); i >= 0; i--) { @@ -880,16 +876,16 @@ s32 FirmwareDownloadBT(PADAPTER padapter, PRT_MP_FIRMWARE pFirmware) if (rtStatus != _SUCCESS) { RTW_INFO("%s: BT Firmware download to Tx packet buffer fail!\n", __FUNCTION__); - padapter->bBTFWReady = _FALSE; + GET_HAL_DATA(padapter)->bBTFWReady = _FALSE; return rtStatus; } } ReservedPage_Compare(padapter, pFirmware, BTFirmwareLen); - padapter->bBTFWReady = _TRUE; + GET_HAL_DATA(padapter)->bBTFWReady = _TRUE; SetFwBTFwPatchCmd(padapter, (u16)BTFirmwareLen); - rtStatus = _CheckWLANFwPatchBTFwReady(padapter); + rtStatus = _CheckWLANFwPatchBTFwReady(padapter, bRecover); RTW_INFO("<===%s: return %s!\n", __FUNCTION__, rtStatus == _SUCCESS ? "SUCCESS" : "FAIL"); #endif @@ -898,7 +894,7 @@ s32 FirmwareDownloadBT(PADAPTER padapter, PRT_MP_FIRMWARE pFirmware) } #endif /* CONFIG_MP_INCLUDED */ -#if defined(CONFIG_SDIO_HCI) && defined (FW_DOWNLOAD_SIZE_8723D) +#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_DLFW_TXPKT) u8 send_fw_packet(PADAPTER padapter, u8 *pRam_code, u32 length) { struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); @@ -997,7 +993,7 @@ s32 rtl8723d_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw) { s32 rtStatus = _SUCCESS; u8 write_fw = 0; - u32 fwdl_start_time; + systime fwdl_start_time; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); u8 *FwImage; u32 FwImageLen; @@ -1091,33 +1087,33 @@ s32 rtl8723d_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw) break; case FW_SOURCE_HEADER_FILE: - if (bUsedWoWLANFw) { -#ifdef CONFIG_WOWLAN - if (pwrpriv->wowlan_mode) { - pFirmware->szFwBuffer = array_mp_8723d_fw_wowlan; - pFirmware->ulFwLength = array_length_mp_8723d_fw_wowlan; - RTW_INFO(" ===> %s fw: %s, size: %d\n", - __func__, "WoWLAN", pFirmware->ulFwLength); - } -#endif /* CONFIG_WOWLAN */ - -#ifdef CONFIG_AP_WOWLAN - if (pwrpriv->wowlan_ap_mode) { - pFirmware->szFwBuffer = array_mp_8723d_fw_ap; - pFirmware->ulFwLength = array_length_mp_8723d_fw_ap; - RTW_INFO(" ===> %s fw: %s, size: %d\n", - __func__, "AP_WoWLAN", pFirmware->ulFwLength); - } -#endif /* CONFIG_AP_WOWLAN */ - } else { - pFirmware->szFwBuffer = array_mp_8723d_fw_nic; - pFirmware->ulFwLength = array_length_mp_8723d_fw_nic; - RTW_INFO("%s fw: %s, size: %d\n", __func__, "FW_NIC", pFirmware->ulFwLength); + if (bUsedWoWLANFw) { + #ifdef CONFIG_WOWLAN + if (pwrpriv->wowlan_mode) { + pFirmware->szFwBuffer = array_mp_8723d_fw_wowlan; + pFirmware->ulFwLength = array_length_mp_8723d_fw_wowlan; + RTW_INFO(" ===> %s fw: %s, size: %d\n", + __FUNCTION__, "WoWLAN", pFirmware->ulFwLength); } + #endif /* CONFIG_WOWLAN */ + + #ifdef CONFIG_AP_WOWLAN + if (pwrpriv->wowlan_ap_mode) { + pFirmware->szFwBuffer = array_mp_8723d_fw_ap; + pFirmware->ulFwLength = array_length_mp_8723d_fw_ap; + RTW_INFO(" ===> %s fw: %s, size: %d\n", + __FUNCTION__, "AP_WoWLAN", pFirmware->ulFwLength); + } + #endif /* CONFIG_AP_WOWLAN */ + } else { + pFirmware->szFwBuffer = array_mp_8723d_fw_nic; + pFirmware->ulFwLength = array_length_mp_8723d_fw_nic; + RTW_INFO("%s fw: %s, size: %d\n", __FUNCTION__, "FW_NIC", pFirmware->ulFwLength); + } break; } - if (pFirmware->ulFwLength > FW_8723D_SIZE) { + if ((pFirmware->ulFwLength - 32) > FW_8723D_SIZE) { rtStatus = _FAIL; RTW_ERR("Firmware size:%u exceed %u\n", pFirmware->ulFwLength, FW_8723D_SIZE); @@ -1130,13 +1126,13 @@ s32 rtl8723d_FirmwareDownload(PADAPTER padapter, BOOLEAN bUsedWoWLANFw) /* To Check Fw header. Added by tynli. 2009.12.04. */ pFwHdr = (PRT_8723D_FIRMWARE_HDR)pFirmwareBuf; - pHalData->FirmwareVersion = le16_to_cpu(pFwHdr->Version); - pHalData->FirmwareSubVersion = le16_to_cpu(pFwHdr->Subversion); + pHalData->firmware_version = le16_to_cpu(pFwHdr->Version); + pHalData->firmware_sub_version = le16_to_cpu(pFwHdr->Subversion); pHalData->FirmwareSignature = le16_to_cpu(pFwHdr->Signature); RTW_INFO("%s: fw_ver=%x fw_subver=%04x sig=0x%x, Month=%02x, Date=%02x, Hour=%02x, Minute=%02x\n", - __func__, pHalData->FirmwareVersion, - pHalData->FirmwareSubVersion, pHalData->FirmwareSignature + __func__, pHalData->firmware_version, + pHalData->firmware_sub_version, pHalData->FirmwareSignature , pFwHdr->Month, pFwHdr->Date, pFwHdr->Hour, pFwHdr->Minute); if (IS_FW_HEADER_EXIST_8723D(pFwHdr)) { @@ -2732,17 +2728,17 @@ static void read_chip_version_8723d(PADAPTER padapter) pHalData = GET_HAL_DATA(padapter); value32 = rtw_read32(padapter, REG_SYS_CFG); - pHalData->VersionID.ICType = CHIP_8723D; - pHalData->VersionID.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); - pHalData->VersionID.RFType = RF_TYPE_1T1R; - pHalData->VersionID.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); - pHalData->VersionID.CUTVersion = (value32 & CHIP_VER_RTL_MASK) >> CHIP_VER_RTL_SHIFT; /* IC version (CUT) */ + pHalData->version_id.ICType = CHIP_8723D; + pHalData->version_id.ChipType = ((value32 & RTL_ID) ? TEST_CHIP : NORMAL_CHIP); + pHalData->version_id.RFType = RF_TYPE_1T1R; + pHalData->version_id.VendorType = ((value32 & VENDOR_ID) ? CHIP_VENDOR_UMC : CHIP_VENDOR_TSMC); + pHalData->version_id.CUTVersion = (value32 & CHIP_VER_RTL_MASK) >> CHIP_VER_RTL_SHIFT; /* IC version (CUT) */ /* For regulator mode. by tynli. 2011.01.14 */ pHalData->RegulatorMode = ((value32 & SPS_SEL) ? RT_LDO_REGULATOR : RT_SWITCHING_REGULATOR); value32 = rtw_read32(padapter, REG_GPIO_OUTSTS); - pHalData->VersionID.ROMVer = ((value32 & RF_RL_ID) >> 20); /* ROM code version. */ + pHalData->version_id.ROMVer = ((value32 & RF_RL_ID) >> 20); /* ROM code version. */ /* For multi-function consideration. Added by Roger, 2010.10.06. */ pHalData->MultiFunc = RT_MULTI_FUNC_NONE; @@ -2755,18 +2751,18 @@ static void read_chip_version_8723d(PADAPTER padapter) rtw_hal_config_rftype(padapter); /* - if( IS_B_CUT(pHalData->VersionID) || IS_C_CUT(pHalData->VersionID)) + if( IS_B_CUT(pHalData->version_id) || IS_C_CUT(pHalData->version_id)) { RTW_INFO(" IS_B/C_CUT SWR up 1 level !!!!!!!!!!!!!!!!!\n"); - PHY_SetMacReg(padapter, 0x14, BIT(23)|BIT(22)|BIT(21)|BIT(20), 0x5); - }else if ( IS_D_CUT(pHalData->VersionID)) + phy_set_mac_reg(padapter, 0x14, BIT(23)|BIT(22)|BIT(21)|BIT(20), 0x5); + }else if ( IS_D_CUT(pHalData->version_id)) { RTW_INFO(" IS_D_CUT SKIP SWR !!!!!!!!!!!!!!!!!\n"); } */ #if 1 - dump_chip_info(pHalData->VersionID); + dump_chip_info(pHalData->version_id); #endif } @@ -2791,8 +2787,14 @@ void rtl8723d_InitBeaconParameters(PADAPTER padapter) #endif rtw_write16(padapter, REG_BCN_CTRL, val16); - /* TODO: Remove these magic number */ - rtw_write16(padapter, REG_TBTT_PROHIBIT, 0x6404);/* ms */ + /* TBTT setup time */ + rtw_write8(padapter, REG_TBTT_PROHIBIT, TBTT_PROHIBIT_SETUP_TIME); + + /* TBTT hold time: 0x540[19:8] */ + rtw_write8(padapter, REG_TBTT_PROHIBIT + 1, TBTT_PROHIBIT_HOLD_TIME_STOP_BCN & 0xFF); + rtw_write8(padapter, REG_TBTT_PROHIBIT + 2, + (rtw_read8(padapter, REG_TBTT_PROHIBIT + 2) & 0xF0) | (TBTT_PROHIBIT_HOLD_TIME_STOP_BCN >> 8)); + /* Firmware will control REG_DRVERLYINT when power saving is enable, */ /* so don't set this register on STA mode. */ if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE) == _FALSE) @@ -2803,11 +2805,6 @@ void rtl8723d_InitBeaconParameters(PADAPTER padapter) /* beacause test chip does not contension before sending beacon. by tynli. 2009.11.03 */ rtw_write16(padapter, REG_BCNTCFG, 0x660F); - pHalData->RegBcnCtrlVal = rtw_read8(padapter, REG_BCN_CTRL); - pHalData->RegTxPause = rtw_read8(padapter, REG_TXPAUSE); - pHalData->RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2); - pHalData->RegReg542 = rtw_read8(padapter, REG_TBTT_PROHIBIT + 2); - pHalData->RegCR_1 = rtw_read8(padapter, REG_CR + 1); } void rtl8723d_InitBeaconMaxError(PADAPTER padapter, u8 InfraMode) @@ -2823,18 +2820,18 @@ void _InitBurstPktLen_8723DS(PADAPTER Adapter) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); - //rtw_write8(Adapter, 0x4c7, rtw_read8(Adapter, 0x4c7) | BIT(7)); /* enable single pkt ampdu */ + rtw_write8(Adapter, 0x4c7, rtw_read8(Adapter, 0x4c7) | BIT(7)); /* enable single pkt ampdu */ rtw_write8(Adapter, REG_RX_PKT_LIMIT_8723D, 0x18); /* for VHT packet length 11K */ - rtw_write16(Adapter, REG_MAX_AGGR_NUM_8723D, 0x0A0A); + rtw_write8(Adapter, REG_MAX_AGGR_NUM_8723D, 0x1F); rtw_write8(Adapter, REG_PIFS_8723D, 0x00); rtw_write8(Adapter, REG_FWHW_TXQ_CTRL_8723D, rtw_read8(Adapter, REG_FWHW_TXQ_CTRL) & (~BIT(7))); if (pHalData->AMPDUBurstMode) rtw_write8(Adapter, REG_AMPDU_BURST_MODE_8723D, 0x5F); - rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x1C); + rtw_write8(Adapter, REG_AMPDU_MAX_TIME_8723D, 0x70); /* ARFB table 9 for 11ac 5G 2SS */ rtw_write32(Adapter, REG_ARFR0_8723D, 0x00000010); - if (IS_NORMAL_CHIP(pHalData->VersionID)) + if (IS_NORMAL_CHIP(pHalData->version_id)) rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0xfffff000); else rtw_write32(Adapter, REG_ARFR0_8723D + 4, 0x3e0ff000); @@ -2921,7 +2918,7 @@ static void rtl8723d_SetBeaconRelatedRegisters(PADAPTER padapter) rtw_write32(padapter, REG_TCR, value32); /* NOTE: Fix test chip's bug (about contention windows's randomness) */ - if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE) == _TRUE) { + if (check_fwstate(&padapter->mlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE | WIFI_AP_STATE | WIFI_MESH_STATE) == _TRUE) { rtw_write8(padapter, REG_RXTSF_OFFSET_CCK, 0x50); rtw_write8(padapter, REG_RXTSF_OFFSET_OFDM, 0x50); } @@ -2948,7 +2945,7 @@ void hal_notch_filter_8723d(_adapter *adapter, bool enable) u8 rtl8723d_MRateIdxToARFRId(PADAPTER padapter, u8 rate_idx) { u8 ret = 0; - RT_RF_TYPE_DEF_E rftype = (RT_RF_TYPE_DEF_E)GET_RF_TYPE(padapter); + enum rf_type rftype = (enum rf_type)GET_RF_TYPE(padapter); switch (rate_idx) { @@ -3007,68 +3004,6 @@ u8 rtl8723d_MRateIdxToARFRId(PADAPTER padapter, u8 rate_idx) return ret; } -void UpdateHalRAMask8723D(PADAPTER padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level) -{ - u32 mask, rate_bitmap = 0, ratr_bitmap_msb = 0; - u8 disable_cck_rate = FALSE, MimoPs_enable = FALSE; - u8 shortGIrate = _FALSE; - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - u8 bw; - - if (psta == NULL) { - RTW_PRINT(FUNC_ADPT_FMT" macid:%u, sta is NULL\n", - FUNC_ADPT_ARG(padapter), mac_id); - return; - } - - bw = rtw_get_tx_bw_mode(padapter, psta); - shortGIrate = query_ra_short_GI(psta, bw); - - mask = psta->ra_mask; - -#if 1 - phydm_UpdateHalRAMask(&pHalData->odmpriv, psta->wireless_mode, pHalData->rf_type, bw, MimoPs_enable, disable_cck_rate, &ratr_bitmap_msb, &mask, rssi_level); -#else - rate_bitmap = 0xffffffff; - rate_bitmap = ODM_Get_Rate_Bitmap(&pHalData->odmpriv, mac_id, mask, rssi_level); - mask &= rate_bitmap; -#endif - -#ifdef CONFIG_BT_COEXIST - rate_bitmap = rtw_btcoex_GetRaMask(padapter); - mask &= ~rate_bitmap; -#endif /* CONFIG_BT_COEXIST */ - -#ifdef CONFIG_CMCC_TEST -#ifdef CONFIG_BT_COEXIST - if (pmlmeext->cur_wireless_mode & WIRELESS_11G) { - if (mac_id == 0) { - RTW_INFO("CMCC_BT update raid entry, mask=0x%x\n", mask); - /* mask &=0xffffffc0; //disable CCK & <12M OFDM rate for 11G mode for CMCC */ - mask &= 0xffffff00; /* disable CCK & <24M OFDM rate for 11G mode for CMCC */ - RTW_INFO("CMCC_BT update raid entry, mask=0x%x\n", mask); - } - } -#endif -#endif - RTW_INFO("%s => mac_id:%d, networkType:0x%02x, mask:0x%08x\n\t ==> rssi_level:%d, rate_bitmap:0x%08x\n", - __FUNCTION__, mac_id, psta->wireless_mode, mask, rssi_level, rate_bitmap); - - if (pHalData->fw_ractrl == _TRUE) - rtl8723d_set_FwMacIdConfig_cmd(padapter, mac_id, psta->raid, bw, shortGIrate, mask); - - /* set correct initial date rate for each mac_id */ - pHalData->INIDATA_RATE[mac_id] = psta->init_rate; - RTW_INFO("%s(): mac_id=%d raid=0x%x bw=%d mask=0x%x init_rate=0x%x\n", __func__, mac_id, psta->raid, bw, mask, psta->init_rate); - - rtw_macid_ctl_set_bw(macid_ctl, mac_id, bw); - rtw_macid_ctl_set_rate_bmp0(macid_ctl, mac_id, mask); - rtw_update_tx_rate_bmp(adapter_to_dvobj(padapter)); -} /* * Description: In normal chip, we should send some packet to Hw which will be used by Fw * in FW LPS mode. The function is to fill the Tx descriptor of this packets, then @@ -3186,23 +3121,27 @@ void init_hal_spec_8723d(_adapter *adapter) struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); hal_spec->ic_name = "rtl8723d"; - hal_spec->macid_num = MACID_NUM_8723D; - hal_spec->sec_cam_ent_num = SEC_CAM_ENT_NUM_8723D; + hal_spec->macid_num = 16; + hal_spec->sec_cam_ent_num = 32; hal_spec->sec_cap = SEC_CAP_CHK_BMC; hal_spec->rfpath_num_2g = 2; hal_spec->rfpath_num_5g = 0; hal_spec->max_tx_cnt = 1; - hal_spec->nss_num = NSS_NUM_8723D; - hal_spec->band_cap = BAND_CAP_8723D; - hal_spec->bw_cap = BW_CAP_8723D; - hal_spec->port_num = HW_PORT_NUM_8723D; - hal_spec->proto_cap = PROTO_CAP_8723D; + hal_spec->tx_nss_num = 1; + hal_spec->rx_nss_num = 1; + hal_spec->band_cap = BAND_CAP_2G; + hal_spec->bw_cap = BW_CAP_20M | BW_CAP_40M; + hal_spec->port_num = 3; + hal_spec->proto_cap = PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N; hal_spec->wl_func = 0 | WL_FUNC_P2P | WL_FUNC_MIRACAST | WL_FUNC_TDLS ; + + rtw_macid_ctl_init_sleep_reg(adapter_to_macidctl(adapter) + , REG_MACID_SLEEP, 0, 0, 0); } void rtl8723d_init_default_value(PADAPTER padapter) @@ -3212,11 +3151,7 @@ void rtl8723d_init_default_value(PADAPTER padapter) pHalData = GET_HAL_DATA(padapter); -#ifdef CONFIG_80211N_HT padapter->registrypriv.wireless_mode = WIRELESS_11BG_24N; -#else - padapter->registrypriv.wireless_mode = WIRELESS_11BG; -#endif /* init default value */ pHalData->fw_ractrl = _FALSE; @@ -3225,10 +3160,10 @@ void rtl8723d_init_default_value(PADAPTER padapter) /* init phydm default value */ pHalData->bIQKInitialized = _FALSE; - pHalData->odmpriv.RFCalibrateInfo.TM_Trigger = 0;/* for IQK */ - pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP_index = 0; + pHalData->odmpriv.rf_calibrate_info.tm_trigger = 0;/* for IQK */ + pHalData->odmpriv.rf_calibrate_info.thermal_value_hp_index = 0; for (i = 0; i < HP_THERMAL_NUM; i++) - pHalData->odmpriv.RFCalibrateInfo.ThermalValue_HP[i] = 0; + pHalData->odmpriv.rf_calibrate_info.thermal_value_hp[i] = 0; /* init Efuse variables */ pHalData->EfuseUsedBytes = 0; @@ -3273,7 +3208,8 @@ u8 GetEEPROMSize8723D(PADAPTER padapter) * ------------------------------------------------------------------------- */ s32 rtl8723d_InitLLTTable(PADAPTER padapter) { - u32 start, passing_time; + systime start; + u32 passing_time; u32 val32; s32 ret; @@ -3352,11 +3288,11 @@ void _DisableRFAFEAndResetBB8723D(PADAPTER padapter) d. SYS_FUNC_EN 0x02[7:0] = 0x16 e. SYS_FUNC_EN 0x02[7:0] = 0x14 ***************************************/ - u8 eRFPath = 0, value8 = 0; + enum rf_path eRFPath = RF_PATH_A, value8 = 0; rtw_write8(padapter, REG_TXPAUSE, 0xFF); - PHY_SetRFReg(padapter, (RF_PATH)eRFPath, 0x0, bMaskByte0, 0x0); + phy_set_rf_reg(padapter, eRFPath, 0x0, bMaskByte0, 0x0); value8 |= APSDOFF; rtw_write8(padapter, REG_APSD_CTRL, value8);/* 0x40 */ @@ -3383,7 +3319,7 @@ void _ResetDigitalProcedure1_8723D(PADAPTER padapter, BOOLEAN bWithoutHWSM) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - if (IS_FW_81xxC(padapter) && (pHalData->FirmwareVersion <= 0x20)) { + if (IS_FW_81xxC(padapter) && (pHalData->firmware_version <= 0x20)) { #if 0 /***************************** f. SYS_FUNC_EN 0x03[7:0]=0x54 @@ -3425,7 +3361,7 @@ void _ResetDigitalProcedure1_8723D(PADAPTER padapter, BOOLEAN bWithoutHWSM) /* IF fw in RAM code, do reset */ - if (padapter->bFWReady) { + if (pHalData->bFWReady) { /* 2010/08/25 MH According to RD alfred's suggestion, we need to disable other */ /* HRCV INT to influence 8051 reset. */ rtw_write8(padapter, REG_FWIMR, 0x20); @@ -3762,13 +3698,13 @@ Hal_EfuseParseBTCoexistInfo_8723D( /* 0:Ant_x2, 1:Ant_x1 */ pHalData->EEPROMBluetoothAntNum = tempval & BIT(0); /* - * EFUSE_0xC3[6] == 0, Wi-Fi at BTGS1(Main, Ant2) - ODM_RF_PATH_A (default) - * EFUSE_0xC3[6] == 1, Wi-Fi at BTGS0( Aux, Ant1) - ODM_RF_PATH_B + * EFUSE_0xC3[6] == 0, Wi-Fi at BTGS1(Main, Ant2) - RF_PATH_A (default) + * EFUSE_0xC3[6] == 1, Wi-Fi at BTGS0( Aux, Ant1) - RF_PATH_B */ - pHalData->ant_path = (tempval & BIT(6)) ? ODM_RF_PATH_B : ODM_RF_PATH_A; + pHalData->ant_path = (tempval & BIT(6)) ? RF_PATH_B : RF_PATH_A; } else { pHalData->EEPROMBluetoothAntNum = Ant_x1; - pHalData->ant_path = ODM_RF_PATH_A; + pHalData->ant_path = RF_PATH_A; } } else { if (padapter->registrypriv.mp_mode == 1) @@ -3778,7 +3714,7 @@ Hal_EfuseParseBTCoexistInfo_8723D( pHalData->EEPROMBluetoothType = BT_RTL8723D; pHalData->EEPROMBluetoothAntNum = Ant_x1; - pHalData->ant_path = ODM_RF_PATH_A; + pHalData->ant_path = RF_PATH_A; } #ifdef CONFIG_BT_COEXIST @@ -3863,7 +3799,7 @@ Hal_EfuseParsePackageType_8723D( RTW_INFO("PackageType = 0x%X\n", pHalData->PackageType); -#if defined(CONFIG_SDIO_HCI) && defined(CONFIG_80211N_HT) +#ifdef CONFIG_SDIO_HCI /* RTL8703AS: 0x1FB[5:4] 2b'10 */ /* RTL8723DS: 0x1FB[5:4] 2b'11 */ if ((efuseContent & 0x30) == 0x20) { @@ -3895,15 +3831,15 @@ Hal_EfuseParseChnlPlan_8723D( IN BOOLEAN AutoLoadFail ) { - padapter->mlmepriv.ChannelPlan = hal_com_config_channel_plan( - padapter - , hwinfo ? &hwinfo[EEPROM_COUNTRY_CODE_8723D] : NULL - , hwinfo ? hwinfo[EEPROM_ChannelPlan_8723D] : 0xFF - , padapter->registrypriv.alpha2 - , padapter->registrypriv.channel_plan - , RTW_CHPLAN_WORLD_NULL - , AutoLoadFail - ); + hal_com_config_channel_plan( + padapter + , hwinfo ? &hwinfo[EEPROM_COUNTRY_CODE_8723D] : NULL + , hwinfo ? hwinfo[EEPROM_ChannelPlan_8723D] : 0xFF + , padapter->registrypriv.alpha2 + , padapter->registrypriv.channel_plan + , RTW_CHPLAN_WORLD_NULL + , AutoLoadFail + ); } VOID @@ -3931,14 +3867,13 @@ Hal_EfuseParseAntennaDiversity_8723D( #ifdef CONFIG_ANTENNA_DIVERSITY PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); struct registry_priv *registry_par = &pAdapter->registrypriv; - u8 get_efuse_div_type = 0; + u8 get_efuse_div_type; if (pHalData->EEPROMBluetoothAntNum == Ant_x1) pHalData->AntDivCfg = 0; else { if (registry_par->antdiv_cfg == 2) /* 0:OFF , 1:ON, 2:By EFUSE */ - pHalData->AntDivCfg = - ((hwinfo[EEPROM_RF_BOARD_OPTION_8723D] & BIT3) >> 3); + pHalData->AntDivCfg = 1; else pHalData->AntDivCfg = registry_par->antdiv_cfg; } @@ -3947,16 +3882,19 @@ Hal_EfuseParseAntennaDiversity_8723D( pHalData->with_extenal_ant_switch = ((hwinfo[EEPROM_RF_BT_SETTING_8723D] & BIT7) >> 7); if (pHalData->AntDivCfg != 0) { + get_efuse_div_type = hwinfo[EEPROM_RFE_OPTION_8723D]; - if (get_efuse_div_type == 0x11) + + if (get_efuse_div_type == 0x11) { pHalData->b_fix_tx_ant = NO_FIX_TX_ANT; - else if (get_efuse_div_type == 0x13) + } else if (get_efuse_div_type == 0x13) { pHalData->b_fix_tx_ant = FIX_TX_AT_MAIN;/* RX diversity only*/ - else + } else pHalData->AntDivCfg = FALSE; } + RTW_INFO("%s: AntDivCfg=%d, AntDivType=%d\n", - __func__, pHalData->AntDivCfg, pHalData->TRxAntDivType); + __FUNCTION__, pHalData->AntDivCfg, pHalData->TRxAntDivType); #endif } @@ -3970,11 +3908,11 @@ Hal_EfuseParseXtal_8723D( HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); if (!AutoLoadFail) { - pHalData->CrystalCap = hwinfo[EEPROM_XTAL_8723D]; - if (pHalData->CrystalCap == 0xFF) - pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723D; /* what value should 8812 set? */ + pHalData->crystal_cap = hwinfo[EEPROM_XTAL_8723D]; + if (pHalData->crystal_cap == 0xFF) + pHalData->crystal_cap = EEPROM_Default_CrystalCap_8723D; /* what value should 8812 set? */ } else - pHalData->CrystalCap = EEPROM_Default_CrystalCap_8723D; + pHalData->crystal_cap = EEPROM_Default_CrystalCap_8723D; } @@ -3991,13 +3929,13 @@ Hal_EfuseParseThermalMeter_8723D( /* ThermalMeter from EEPROM */ /* */ if (_FALSE == AutoLoadFail) - pHalData->EEPROMThermalMeter = PROMContent[EEPROM_THERMAL_METER_8723D]; + pHalData->eeprom_thermal_meter = PROMContent[EEPROM_THERMAL_METER_8723D]; else - pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723D; + pHalData->eeprom_thermal_meter = EEPROM_Default_ThermalMeter_8723D; - if ((pHalData->EEPROMThermalMeter == 0xff) || (_TRUE == AutoLoadFail)) { - pHalData->odmpriv.RFCalibrateInfo.bAPKThermalMeterIgnore = _TRUE; - pHalData->EEPROMThermalMeter = EEPROM_Default_ThermalMeter_8723D; + if ((pHalData->eeprom_thermal_meter == 0xff) || (_TRUE == AutoLoadFail)) { + pHalData->odmpriv.rf_calibrate_info.is_apk_thermal_meter_ignore = _TRUE; + pHalData->eeprom_thermal_meter = EEPROM_Default_ThermalMeter_8723D; } } @@ -4033,7 +3971,7 @@ void Hal_ReadRFGainOffset( } if (kfree_data->flag & KFREE_FLAG_THERMAL_K_ON) - pHalData->EEPROMThermalMeter += kfree_data->thermal; + pHalData->eeprom_thermal_meter += kfree_data->thermal; RTW_INFO("kfree Pwr Trim flag:%u\n", kfree_data->flag); if (kfree_data->flag & KFREE_FLAG_ON) { @@ -4054,16 +3992,16 @@ BWMapping_8723D( u8 BWSettingOfDesc = 0; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - /* RTW_INFO("BWMapping pHalData->CurrentChannelBW %d, pattrib->bwmode %d\n",pHalData->CurrentChannelBW,pattrib->bwmode); */ + /* RTW_INFO("BWMapping pHalData->current_channel_bw %d, pattrib->bwmode %d\n",pHalData->current_channel_bw,pattrib->bwmode); */ - if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { + if (pHalData->current_channel_bw == CHANNEL_WIDTH_80) { if (pattrib->bwmode == CHANNEL_WIDTH_80) BWSettingOfDesc = 2; else if (pattrib->bwmode == CHANNEL_WIDTH_40) BWSettingOfDesc = 1; else BWSettingOfDesc = 0; - } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { + } else if (pHalData->current_channel_bw == CHANNEL_WIDTH_40) { if ((pattrib->bwmode == CHANNEL_WIDTH_40) || (pattrib->bwmode == CHANNEL_WIDTH_80)) BWSettingOfDesc = 1; else @@ -4082,9 +4020,9 @@ u8 SCMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib) u8 SCSettingOfDesc = 0; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - /* RTW_INFO("SCMapping: pHalData->CurrentChannelBW %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->CurrentChannelBW,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); */ + /* RTW_INFO("SCMapping: pHalData->current_channel_bw %d, pHalData->nCur80MhzPrimeSC %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->current_channel_bw,pHalData->nCur80MhzPrimeSC,pHalData->nCur40MhzPrimeSC); */ - if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { + if (pHalData->current_channel_bw == CHANNEL_WIDTH_80) { if (pattrib->bwmode == CHANNEL_WIDTH_80) SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; else if (pattrib->bwmode == CHANNEL_WIDTH_40) { @@ -4106,8 +4044,8 @@ u8 SCMapping_8723D(PADAPTER Adapter, struct pkt_attrib *pattrib) else RTW_INFO("SCMapping: DONOT CARE Mode Setting\n"); } - } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { - /* RTW_INFO("SCMapping: HT Case: pHalData->CurrentChannelBW %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->CurrentChannelBW,pHalData->nCur40MhzPrimeSC); */ + } else if (pHalData->current_channel_bw == CHANNEL_WIDTH_40) { + /* RTW_INFO("SCMapping: HT Case: pHalData->current_channel_bw %d, pHalData->nCur40MhzPrimeSC %d\n",pHalData->current_channel_bw,pHalData->nCur40MhzPrimeSC); */ if (pattrib->bwmode == CHANNEL_WIDTH_40) SCSettingOfDesc = VHT_DATA_SC_DONOT_CARE; @@ -4136,6 +4074,12 @@ void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc) } } #endif +void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc) +{ + SET_TX_DESC_USE_RATE_8723D(ptxdesc, 1); + SET_TX_DESC_TX_RATE_8723D(ptxdesc, MRateToHwRate(pattrib->rate)); + SET_TX_DESC_DISABLE_FB_8723D(ptxdesc, 1); +} static u8 fill_txdesc_sectype(struct pkt_attrib *pattrib) { @@ -4249,8 +4193,12 @@ static void rtl8723d_fill_default_txdesc( #endif fill_txdesc_vcs_8723d(padapter, pattrib, pbuf); - if (pattrib->icmp_pkt == 1 && padapter->registrypriv.wifi_spec == 1) - drv_userate = 1; +#ifdef CONFIG_P2P + if (!rtw_p2p_chk_state(&padapter->wdinfo, P2P_STATE_NONE)) { + if (pattrib->icmp_pkt == 1 && padapter->registrypriv.wifi_spec == 1) + drv_userate = 1; + } +#endif if ((pattrib->ether_type != 0x888e) && (pattrib->ether_type != 0x0806) && @@ -4282,6 +4230,8 @@ static void rtl8723d_fill_default_txdesc( SET_TX_DESC_TX_RATE_8723D(pbuf, pHalData->INIDATA_RATE[pattrib->mac_id] & 0x7F); } + if (bmcst) + fill_txdesc_bmc_tx_rate(pattrib, pbuf); /* modify data rate by iwpriv */ if (padapter->fix_rate != 0xFF) { @@ -4411,6 +4361,11 @@ static void rtl8723d_fill_default_txdesc( /* 2010.06.23. Added by tynli. */ if (!pattrib->qos_en) SET_TX_DESC_HWSEQ_EN_8723D(pbuf, 1); + +#ifdef CONFIG_ANTENNA_DIVERSITY + if (!bmcst && pattrib->psta) + odm_set_tx_ant_by_tx_info(adapter_to_phydm(padapter), pbuf, pattrib->psta->cmn.mac_id); +#endif } /* @@ -4422,52 +4377,22 @@ static void rtl8723d_fill_default_txdesc( */ void rtl8723d_update_txdesc(struct xmit_frame *pxmitframe, u8 *pbuf) { - PADAPTER padapter = pxmitframe->padapter; - rtl8723d_fill_default_txdesc(pxmitframe, pbuf); -#ifdef CONFIG_ANTENNA_DIVERSITY - ODM_SetTxAntByTxInfo(&GET_HAL_DATA(padapter)->odmpriv, pbuf, pxmitframe->attrib.mac_id); -#endif /* CONFIG_ANTENNA_DIVERSITY */ - #if defined(CONFIG_USB_HCI) rtl8723d_cal_txdesc_chksum((struct tx_desc *)pbuf); #endif } -#ifdef CONFIG_TSF_RESET_OFFLOAD -int reset_tsf(PADAPTER Adapter, u8 reset_port) -{ - u8 reset_cnt_before = 0, reset_cnt_after = 0, loop_cnt = 0; - u32 reg_reset_tsf_cnt = (HW_PORT0 == reset_port) ? - REG_FW_RESET_TSF_CNT_0 : REG_FW_RESET_TSF_CNT_1; - - rtw_mi_buddy_scan_abort(Adapter, _FALSE); /* site survey will cause reset_tsf fail */ - reset_cnt_after = reset_cnt_before = rtw_read8(Adapter, reg_reset_tsf_cnt); - rtl8723d_reset_tsf(Adapter, reset_port); - - while ((reset_cnt_after == reset_cnt_before) && (loop_cnt < 10)) { - rtw_msleep_os(100); - loop_cnt++; - reset_cnt_after = rtw_read8(Adapter, reg_reset_tsf_cnt); - } - - return (loop_cnt >= 10) ? _FAIL : _TRUE; -} -#endif /* CONFIG_TSF_RESET_OFFLOAD */ - static void hw_var_set_monitor(PADAPTER Adapter, u8 variable, u8 *val) { - u32 value_rcr, rcr_bits; + u32 rcr_bits; u16 value_rxfltmap2; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); struct mlme_priv *pmlmepriv = &(Adapter->mlmepriv); if (*((u8 *)val) == _HW_STATE_MONITOR_) { - /* Leave IPS */ - rtw_pm_set_ips(Adapter, IPS_NONE); - LeaveAllPowerSaveMode(Adapter); /* Receive all type */ rcr_bits = RCR_AAP | RCR_APM | RCR_AM | RCR_AB | RCR_APWRMGT | RCR_ADF | RCR_ACF | RCR_AMF | RCR_APP_PHYST_RXFF; @@ -4483,12 +4408,11 @@ static void hw_var_set_monitor(PADAPTER Adapter, u8 variable, u8 *val) rcr_bits |= (RCR_ACRC32 | RCR_AICV); #endif + rtw_hal_get_hwreg(Adapter, HW_VAR_RCR, (u8 *)&pHalData->rcr_backup); + rtw_hal_set_hwreg(Adapter, HW_VAR_RCR, (u8 *)&rcr_bits); + /* Receive all data frames */ value_rxfltmap2 = 0xFFFF; - - value_rcr = rcr_bits; - rtw_write32(Adapter, REG_RCR, value_rcr); - rtw_write16(Adapter, REG_RXFLTMAP2, value_rxfltmap2); #if 0 @@ -4510,8 +4434,9 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); if (isMonitor == _TRUE) { - /* reset RCR */ - rtw_write32(padapter, REG_RCR, pHalData->ReceiveConfig); + /* reset RCR from backup */ + rtw_hal_set_hwreg(padapter, HW_VAR_RCR, (u8 *)&pHalData->rcr_backup); + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ACTION_NONE); isMonitor = _FALSE; } @@ -4540,7 +4465,7 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) __func__, __LINE__, padapter->hw_port, mode); if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { - if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { + if (!rtw_mi_get_ap_num(padapter) && !rtw_mi_get_mesh_num(padapter)) { StopTxBeacon(padapter); #ifdef CONFIG_PCI_HCI UpdateInterruptMask8723DE(padapter, 0, 0, RT_BCN_INT_MASKS, 0); @@ -4562,7 +4487,7 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) /* disable atim wnd */ rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_ATIM | EN_BCN_FUNCTION); - } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { + } else if (mode == _HW_STATE_ADHOC_) { ResumeTxBeacon(padapter); rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); } else if (mode == _HW_STATE_AP_) { @@ -4586,14 +4511,6 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) rtw_write8(padapter, REG_BCN_CTRL_1, DIS_TSF_UDT | DIS_BCNQ_SUB); - /* Set RCR */ - /* rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 */ - /* rtw_write32(padapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 */ - if (padapter->registrypriv.wifi_spec) - /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ - rtw_write32(padapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); - else - rtw_write32(padapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */ /* enable to rx data frame*/ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); /* enable to rx ps-poll */ @@ -4603,9 +4520,9 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) rtw_write8(padapter, REG_BCNDMATIM, 0x02); /* 2ms */ /* rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); */ - rtw_write8(padapter, REG_ATIMWND_1, 0x0a); /* 10ms for port1 */ + rtw_write8(padapter, REG_ATIMWND_1, 0x0c); /* 13ms for port1 */ rtw_write16(padapter, REG_BCNTCFG, 0x00); - rtw_write16(padapter, REG_TBTT_PROHIBIT, 0xff04); + rtw_write16(padapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ /* reset TSF2 */ @@ -4634,7 +4551,7 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) /* Reset TSF for STA+AP concurrent mode */ if (rtw_mi_buddy_check_fwstate(padapter, (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { - if (reset_tsf(padapter, HW_PORT1) == _FALSE) + if (rtw_hal_reset_tsf(padapter, HW_PORT1) == _FAIL) RTW_INFO("ERROR! %s()-%d: Reset port1 TSF fail\n", __FUNCTION__, __LINE__); } @@ -4658,7 +4575,7 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) if ((mode == _HW_STATE_STATION_) || (mode == _HW_STATE_NOLINK_)) { #ifdef CONFIG_CONCURRENT_MODE - if (!rtw_mi_check_status(padapter, MI_AP_MODE)) { + if (!rtw_mi_get_ap_num(padapter) && !rtw_mi_get_mesh_num(padapter)) { #else { #endif /* CONFIG_CONCURRENT_MODE */ @@ -4683,7 +4600,7 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) /* disable atim wnd */ rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_ATIM); /* rtw_write8(padapter,REG_BCN_CTRL, 0x18); */ - } else if ((mode == _HW_STATE_ADHOC_) /*|| (mode == _HW_STATE_AP_)*/) { + } else if (mode == _HW_STATE_ADHOC_) { ResumeTxBeacon(padapter); rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | EN_BCN_FUNCTION | DIS_BCNQ_SUB); } else if (mode == _HW_STATE_AP_) { @@ -4706,14 +4623,6 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) rtw_write8(padapter, REG_BCN_CTRL, DIS_TSF_UDT | DIS_BCNQ_SUB); - /* Set RCR */ - /* rtw_write32(padapter, REG_RCR, 0x70002a8e);//CBSSID_DATA must set to 0 */ - /* rtw_write32(padapter, REG_RCR, 0x7000228e);//CBSSID_DATA must set to 0 */ - if (padapter->registrypriv.wifi_spec) - /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ - rtw_write32(padapter, REG_RCR, (0x7000208e & ~(RCR_CBSSID_BCN))); - else - rtw_write32(padapter, REG_RCR, 0x7000208e);/* CBSSID_DATA must set to 0,reject ICV_ERR packet */ /* enable to rx data frame */ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); /* enable to rx ps-poll */ @@ -4723,9 +4632,9 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) rtw_write8(padapter, REG_BCNDMATIM, 0x02); /* 2ms */ /* rtw_write8(padapter, REG_BCN_MAX_ERR, 0xFF); */ - rtw_write8(padapter, REG_ATIMWND, 0x0a); /* 10ms */ + rtw_write8(padapter, REG_ATIMWND, 0x0c); /* 13ms */ rtw_write16(padapter, REG_BCNTCFG, 0x00); - rtw_write16(padapter, REG_TBTT_PROHIBIT, 0xff04); + rtw_write16(padapter, REG_TSFTR_SYN_OFFSET, 0x7fff);/* +32767 (~32ms) */ /* reset TSF */ @@ -4751,7 +4660,7 @@ static void hw_var_set_opmode(PADAPTER padapter, u8 variable, u8 *val) /* Reset TSF for STA+AP concurrent mode */ if (rtw_mi_buddy_check_fwstate(padapter, (WIFI_STATION_STATE | WIFI_ASOC_STATE))) { - if (reset_tsf(padapter, HW_PORT0) == _FALSE) + if (rtw_hal_reset_tsf(padapter, HW_PORT0) == _FAIL) RTW_INFO("ERROR! %s()-%d: Reset port0 TSF fail\n", __FUNCTION__, __LINE__); } @@ -4790,75 +4699,16 @@ static void hw_var_set_bcn_func(PADAPTER padapter, u8 variable, u8 *val) } } -static void hw_var_set_correct_tsf(PADAPTER padapter, u8 variable, u8 *val) -{ -#ifdef CONFIG_MI_WITH_MBSSID_CAM - /*do nothing*/ -#else - u8 val8; - u64 tsf; - struct mlme_ext_priv *pmlmeext; - struct mlme_ext_info *pmlmeinfo; - - - pmlmeext = &padapter->mlmeextpriv; - pmlmeinfo = &pmlmeext->mlmext_info; - - tsf = pmlmeext->TSFValue - rtw_modular64(pmlmeext->TSFValue, (pmlmeinfo->bcn_interval * 1024)) - 1024; /* us */ - - if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) || - ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) - StopTxBeacon(padapter); - - rtw_hal_correct_tsf(padapter, padapter->hw_port, tsf); -#ifdef CONFIG_CONCURRENT_MODE - /* Update buddy port's TSF if it is SoftAP for beacon TX issue!*/ - if ((pmlmeinfo->state & 0x03) == WIFI_FW_STATION_STATE - && rtw_mi_check_status(padapter, MI_AP_MODE)) { - - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - int i; - _adapter *iface; - - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if (!iface) - continue; - if (iface == padapter) - continue; - - if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE) == _TRUE - && check_fwstate(&iface->mlmepriv, WIFI_ASOC_STATE) == _TRUE) { - rtw_hal_correct_tsf(iface, iface->hw_port, tsf); -#ifdef CONFIG_TSF_RESET_OFFLOAD - if (reset_tsf(iface, iface->hw_port) == _FALSE) - RTW_INFO("%s-[ERROR] "ADPT_FMT" Reset port%d TSF fail\n", __func__, ADPT_ARG(iface), iface->hw_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD*/ - } - } - } -#endif /* CONFIG_CONCURRENT_MODE */ - - if (((pmlmeinfo->state & 0x03) == WIFI_FW_ADHOC_STATE) - || ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE)) - ResumeTxBeacon(padapter); -#endif /*CONFIG_MI_WITH_MBSSID_CAM*/ -} - static void hw_var_set_mlme_disconnect(PADAPTER padapter, u8 variable, u8 *val) { u8 val8; -#ifdef CONFIG_CONCURRENT_MODE - if (rtw_mi_check_status(padapter, MI_LINKED) == _FALSE) { -#else - { -#endif - /* Set RCR to not to receive data frame when NO LINK state */ - /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & ~RCR_ADF); */ /* reject all data frames */ +#ifdef CONFIG_CONCURRENT_MODE + if (rtw_mi_check_status(padapter, MI_LINKED) == _FALSE) +#endif rtw_write16(padapter, REG_RXFLTMAP2, 0); - } + #ifdef CONFIG_CONCURRENT_MODE if (padapter->hw_port == HW_PORT1) { /* reset TSF1 */ @@ -4881,139 +4731,6 @@ static void hw_var_set_mlme_disconnect(PADAPTER padapter, u8 variable, u8 *val) } } -static void hw_var_set_mlme_sitesurvey(PADAPTER padapter, u8 variable, u8 *val) -{ - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); - u32 value_rcr, rcr_clear_bit; - u16 value_rxfltmap2; - u8 val8; - PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - int i = 0; - _adapter *iface; -#ifdef DBG_IFACE_STATUS - DBG_IFACE_STATUS_DUMP(padapter); -#endif - -#ifdef CONFIG_FIND_BEST_CHANNEL - rcr_clear_bit = (RCR_CBSSID_BCN | RCR_CBSSID_DATA); - - /* Receive all data frames */ - value_rxfltmap2 = 0xFFFF; -#else /* CONFIG_FIND_BEST_CHANNEL */ - - rcr_clear_bit = RCR_CBSSID_BCN; - - /* config RCR to receive different BSSID & not to receive data frame */ - value_rxfltmap2 = 0; - -#endif /* CONFIG_FIND_BEST_CHANNEL */ - - if (rtw_mi_check_fwstate(padapter, WIFI_AP_STATE)) - rcr_clear_bit = RCR_CBSSID_BCN; - -#ifdef CONFIG_TDLS - /* TDLS will clear RCR_CBSSID_DATA bit for connection. */ - else if (padapter->tdlsinfo.link_established == _TRUE) - rcr_clear_bit = RCR_CBSSID_BCN; -#endif /* CONFIG_TDLS */ - - value_rcr = rtw_read32(padapter, REG_RCR); - - if (*((u8 *)val)) {/* under sitesurvey */ - /* - * 1. configure REG_RXFLTMAP2 - * 2. disable TSF update & buddy TSF update to avoid updating wrong TSF due to clear RCR_CBSSID_BCN - * 3. config RCR to receive different BSSID BCN or probe rsp - */ - - rtw_write16(padapter, REG_RXFLTMAP2, value_rxfltmap2); - -#ifdef CONFIG_MI_WITH_MBSSID_CAM - /*do nothing~~*/ -#else - - /* disable update TSF */ - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if (!iface) - continue; - - if (rtw_linked_check(iface) && - check_fwstate(&(iface->mlmepriv), WIFI_AP_STATE) != _TRUE) { - if (iface->hw_port == HW_PORT1) - rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1) | DIS_TSF_UDT); - else - rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL) | DIS_TSF_UDT); - - iface->mlmeextpriv.en_hw_update_tsf = _FALSE; - } - - } -#endif - - value_rcr &= ~(rcr_clear_bit); - rtw_write32(padapter, REG_RCR, value_rcr); - - /* Save orignal RRSR setting. */ - pHalData->RegRRSR = rtw_read16(padapter, REG_RRSR); - - if (rtw_mi_check_status(padapter, MI_AP_MODE)) - StopTxBeacon(padapter); - } else {/* sitesurvey done */ - /* - * 1. enable rx data frame - * 2. config RCR not to receive different BSSID BCN or probe rsp - * 3. doesn't enable TSF update & buddy TSF right now to avoid HW conflict - *so, we enable TSF update when rx first BCN after sitesurvey done - */ - if (rtw_mi_check_fwstate(padapter, _FW_LINKED | WIFI_AP_STATE)) { - /*enable to rx data frame*/ - rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); - } - -#ifdef CONFIG_MI_WITH_MBSSID_CAM - value_rcr &= ~(RCR_CBSSID_BCN | RCR_CBSSID_DATA); -#else - value_rcr |= rcr_clear_bit; -#endif - /* for 11n Logo 4.2.31/4.2.32, disable BSSID BCN check for AP mode */ - if (padapter->registrypriv.wifi_spec && MLME_IS_AP(padapter)) - value_rcr &= ~(RCR_CBSSID_BCN); - - rtw_write32(padapter, REG_RCR, value_rcr); - -#ifdef CONFIG_MI_WITH_MBSSID_CAM - /*if ((rtw_mi_get_assoced_sta_num(Adapter) == 1) && (!rtw_mi_check_status(Adapter, MI_AP_MODE))) - rtw_write8(Adapter, REG_BCN_CTRL, rtw_read8(Adapter, REG_BCN_CTRL)&(~DIS_TSF_UDT));*/ -#else - - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if (!iface) - continue; - if (rtw_linked_check(iface) && - check_fwstate(&(iface->mlmepriv), WIFI_AP_STATE) != _TRUE) { - /* enable HW TSF update when recive beacon*/ - /*if (iface->hw_port == HW_PORT1) - rtw_write8(iface, REG_BCN_CTRL_1, rtw_read8(iface, REG_BCN_CTRL_1)&(~(DIS_TSF_UDT))); - else - rtw_write8(iface, REG_BCN_CTRL, rtw_read8(iface, REG_BCN_CTRL)&(~(DIS_TSF_UDT))); - */ - iface->mlmeextpriv.en_hw_update_tsf = _TRUE; - } - } -#endif - - /*Restore orignal RRSR setting.*/ - rtw_write16(padapter, REG_RRSR, pHalData->RegRRSR); - - if (rtw_mi_check_status(padapter, MI_AP_MODE)) { - ResumeTxBeacon(padapter); - rtw_mi_tx_beacon_hdl(padapter); - } - } -} - static void hw_var_set_mlme_join(PADAPTER padapter, u8 variable, u8 *val) { u8 val8; @@ -5024,47 +4741,29 @@ static void hw_var_set_mlme_join(PADAPTER padapter, u8 variable, u8 *val) PHAL_DATA_TYPE pHalData; struct mlme_priv *pmlmepriv; - RetryLimit = 0x30; + RetryLimit = RL_VAL_STA; type = *(u8 *)val; pHalData = GET_HAL_DATA(padapter); pmlmepriv = &padapter->mlmepriv; #ifdef CONFIG_CONCURRENT_MODE if (type == 0) { /* prepare to join */ - if (rtw_mi_check_status(padapter, MI_AP_MODE)) + if (rtw_mi_get_ap_num(padapter) || rtw_mi_get_mesh_num(padapter)) StopTxBeacon(padapter); /* enable to rx data frame.Accept all data frame */ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); -#ifdef CONFIG_MI_WITH_MBSSID_CAM - /* - if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && (rtw_mi_get_assoced_sta_num(padapter) == 1)) - rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_CBSSID_DATA|RCR_CBSSID_BCN); - else if ((rtw_mi_get_ap_num(Adapter) == 1) && (rtw_mi_get_assoced_sta_num(Adapter) == 1)) - rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_CBSSID_BCN); - else*/ - rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & (~(RCR_CBSSID_DATA | RCR_CBSSID_BCN))); -#else - if (rtw_mi_check_status(padapter, MI_AP_MODE)) { - val32 = rtw_read32(padapter, REG_RCR); - val32 |= RCR_CBSSID_BCN; - rtw_write32(padapter, REG_RCR, val32); - } else { - val32 = rtw_read32(padapter, REG_RCR); - val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; - rtw_write32(padapter, REG_RCR, val32); - } -#endif + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) - RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; + RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; else /* Ad-hoc Mode */ - RetryLimit = 0x7; + RetryLimit = RL_VAL_AP; } else if (type == 1) { /* joinbss_event call back when join res < 0 */ if (rtw_mi_check_status(padapter, MI_LINKED) == _FALSE) rtw_write16(padapter, REG_RXFLTMAP2, 0x00); - if (rtw_mi_check_status(padapter, MI_AP_MODE)) { + if (rtw_mi_get_ap_num(padapter) || rtw_mi_get_mesh_num(padapter)) { ResumeTxBeacon(padapter); /* reset TSF 1/2 after ResumeTxBeacon */ rtw_write8(padapter, REG_DUAL_TSF_RST, BIT(1) | BIT(0)); @@ -5089,10 +4788,10 @@ static void hw_var_set_mlme_join(PADAPTER padapter, u8 variable, u8 *val) if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) { rtw_write8(padapter, 0x542 , 0x02); - RetryLimit = 0x7; + RetryLimit = RL_VAL_AP; } - if (rtw_mi_check_status(padapter, MI_AP_MODE)) { + if (rtw_mi_get_ap_num(padapter) || rtw_mi_get_mesh_num(padapter)) { ResumeTxBeacon(padapter); /* reset TSF 1/2 after ResumeTxBeacon */ @@ -5105,20 +4804,12 @@ static void hw_var_set_mlme_join(PADAPTER padapter, u8 variable, u8 *val) #else /* !CONFIG_CONCURRENT_MODE */ if (type == 0) { /* prepare to join */ /* enable to rx data frame.Accept all data frame */ - /* rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR)|RCR_ADF); */ rtw_write16(padapter, REG_RXFLTMAP2, 0xFFFF); - val32 = rtw_read32(padapter, REG_RCR); - if (padapter->in_cta_test) - val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN);/* | RCR_ADF */ - else - val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; - rtw_write32(padapter, REG_RCR, val32); - if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) == _TRUE) - RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? 7 : 48; + RetryLimit = (pHalData->CustomerID == RT_CID_CCX) ? RL_VAL_AP : RL_VAL_STA; else /* Ad-hoc Mode */ - RetryLimit = 0x7; + RetryLimit = RL_VAL_AP; } else if (type == 1) /* joinbss_event call back when join res < 0 */ rtw_write16(padapter, REG_RXFLTMAP2, 0x00); else if (type == 2) { /* sta add event call back */ @@ -5128,7 +4819,7 @@ static void hw_var_set_mlme_join(PADAPTER padapter, u8 variable, u8 *val) rtw_write8(padapter, REG_BCN_CTRL, val8); if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE)) - RetryLimit = 0x7; + RetryLimit = RL_VAL_AP; } val16 = (RetryLimit << RETRY_LIMIT_SHORT_SHIFT) | (RetryLimit << RETRY_LIMIT_LONG_SHIFT); @@ -5179,9 +4870,10 @@ s32 c2h_handler_8723d(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload) return ret; } -void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) +u8 SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); + u8 ret = _SUCCESS; u8 val8; u16 val16; u32 val32; @@ -5238,67 +4930,50 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) hw_var_set_bcn_func(padapter, variable, val); break; - case HW_VAR_CORRECT_TSF: - hw_var_set_correct_tsf(padapter, variable, val); - break; - - case HW_VAR_CHECK_BSSID: - { - u32 val32; - val32 = rtw_read32(padapter, REG_RCR); - if (*val) - val32 |= RCR_CBSSID_DATA | RCR_CBSSID_BCN; - else - val32 &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); - rtw_write32(padapter, REG_RCR, val32); - } - break; - case HW_VAR_MLME_DISCONNECT: hw_var_set_mlme_disconnect(padapter, variable, val); break; - case HW_VAR_MLME_SITESURVEY: - hw_var_set_mlme_sitesurvey(padapter, variable, val); - -#ifdef CONFIG_BT_COEXIST - rtw_btcoex_ScanNotify(padapter, *val ? _TRUE : _FALSE); -#endif /* CONFIG_BT_COEXIST */ - break; - case HW_VAR_MLME_JOIN: hw_var_set_mlme_join(padapter, variable, val); #ifdef CONFIG_BT_COEXIST switch (*val) { case 0: - /* prepare to join */ + /* Notify coex. mechanism before join */ rtw_btcoex_ConnectNotify(padapter, _TRUE); break; case 1: case 2: + /* Notify coex. mechanism after join, whether successful or failed */ rtw_btcoex_ConnectNotify(padapter, _FALSE); break; } #endif /* CONFIG_BT_COEXIST */ break; - case HW_VAR_ON_RCR_AM: - val32 = rtw_read32(padapter, REG_RCR); - val32 |= RCR_AM; - rtw_write32(padapter, REG_RCR, val32); - RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); - break; - - case HW_VAR_OFF_RCR_AM: - val32 = rtw_read32(padapter, REG_RCR); - val32 &= ~RCR_AM; - rtw_write32(padapter, REG_RCR, val32); - RTW_INFO("%s, %d, RCR= %x\n", __FUNCTION__, __LINE__, rtw_read32(padapter, REG_RCR)); - break; - case HW_VAR_BEACON_INTERVAL: - rtw_write16(padapter, REG_BCN_INTERVAL, *((u16 *)val)); + { + u16 bcn_interval = *((u16 *)val); + + #ifdef CONFIG_SWTIMER_BASED_TXBCN + bcn_interval = rtw_hal_bcn_interval_adjust(padapter, bcn_interval); + #endif + + rtw_write16(padapter, REG_BCN_INTERVAL, bcn_interval); + + #ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT + { + struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; + struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); + + if ((pmlmeinfo->state & 0x03) == WIFI_FW_AP_STATE) { + RTW_INFO("%s==> bcn_interval:%d, eraly_int:%d\n", __func__, bcn_interval, bcn_interval >> 1); + rtw_write8(padapter, REG_DRVERLYINT, bcn_interval >> 1); + } + } + #endif/* CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT */ + } break; case HW_VAR_SLOT_TIME: @@ -5380,7 +5055,7 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) break; case HW_VAR_AC_PARAM_BE: - pHalData->AcParam_BE = ((u32 *)(val))[0]; + pHalData->ac_param_be = ((u32 *)(val))[0]; rtw_write32(padapter, REG_EDCA_BE_PARAM, *((u32 *)val)); break; @@ -5411,7 +5086,6 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) break; case HW_VAR_AMPDU_FACTOR: { -#ifdef CONFIG_80211N_HT u32 AMPDULen = (*((u8 *)val)); if (AMPDULen < HT_AGG_SIZE_32K) @@ -5420,7 +5094,6 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) AMPDULen = 0x7fff; rtw_write32(padapter, REG_AMPDU_MAX_LENGTH_8723D, AMPDULen); -#endif /* CONFIG_80211N_HT */ } break; @@ -5433,11 +5106,6 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) case HW_VAR_H2C_FW_PWRMODE: { u8 psmode = *val; - /* Forece leave RF low power mode for 1T1R to prevent conficting setting in Fw power */ - /* saving sequence. 2010.06.07. Added by tynli. Suggested by SD3 yschang. */ - if (psmode != PS_MODE_ACTIVE) - ODM_RF_Saving(&pHalData->odmpriv, _TRUE); - /* if (psmode != PS_MODE_ACTIVE) { */ /*rtl8723d_set_lowpwr_lps_cmd(padapter, _TRUE); */ /* } else { */ @@ -5476,14 +5144,6 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) rtl8723d_lps_poff_h2c_ctrl(padapter, *val); break; #endif /*CONFIG_LPS_POFF*/ -#ifdef CONFIG_TDLS - case HW_VAR_TDLS_WRCR: - rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) & (~RCR_CBSSID_DATA)); - break; - case HW_VAR_TDLS_RS_RCR: - rtw_write32(padapter, REG_RCR, rtw_read32(padapter, REG_RCR) | (RCR_CBSSID_DATA)); - break; -#endif /* CONFIG_TDLS */ case HW_VAR_EFUSE_USAGE: pHalData->EfuseUsedPercentage = *val; @@ -5573,7 +5233,7 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) if (reg_200 != reg_204) RTW_INFO("packets in tx buffer - 0x204=%x, 0x200=%x\n", reg_204, reg_200); - RetryLimit = 0x30; + RetryLimit = RL_VAL_STA; val16 = RetryLimit << RETRY_LIMIT_SHORT_SHIFT | RetryLimit << RETRY_LIMIT_LONG_SHIFT; rtw_write16(padapter, REG_RL, val16); } @@ -5643,77 +5303,17 @@ void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) } break; - case HW_VAR_MACID_SLEEP: { - u32 reg_macid_sleep; - u8 bit_shift; - u8 id = *(u8 *)val; - - if (id < 32) { - reg_macid_sleep = REG_MACID_SLEEP; - bit_shift = id; - } else if (id < 64) { - reg_macid_sleep = REG_MACID_SLEEP_1; - bit_shift = id - 32; - } else if (id < 96) { - reg_macid_sleep = REG_MACID_SLEEP_2; - bit_shift = id - 64; - } else if (id < 128) { - reg_macid_sleep = REG_MACID_SLEEP_3; - bit_shift = id - 96; - } else { - rtw_warn_on(1); - break; - } - - val32 = rtw_read32(padapter, reg_macid_sleep); - RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_SLEEP] macid=%d, org reg_0x%03x=0x%08X\n", - FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); - - if (val32 & BIT(bit_shift)) - break; - - val32 |= BIT(bit_shift); - rtw_write32(padapter, reg_macid_sleep, val32); - } - break; - case HW_VAR_MACID_WAKEUP: { - u32 reg_macid_sleep; - u8 bit_shift; - u8 id = *(u8 *)val; - - if (id < 32) { - reg_macid_sleep = REG_MACID_SLEEP; - bit_shift = id; - } else if (id < 64) { - reg_macid_sleep = REG_MACID_SLEEP_1; - bit_shift = id - 32; - } else if (id < 96) { - reg_macid_sleep = REG_MACID_SLEEP_2; - bit_shift = id - 64; - } else if (id < 128) { - reg_macid_sleep = REG_MACID_SLEEP_3; - bit_shift = id - 96; - } else { - rtw_warn_on(1); - break; - } - - val32 = rtw_read32(padapter, reg_macid_sleep); - RTW_INFO(FUNC_ADPT_FMT ": [HW_VAR_MACID_WAKEUP] macid=%d, org reg_0x%03x=0x%08X\n", - FUNC_ADPT_ARG(padapter), id, reg_macid_sleep, val32); - - if (!(val32 & BIT(bit_shift))) - break; - - val32 &= ~BIT(bit_shift); - rtw_write32(padapter, reg_macid_sleep, val32); - } +#if defined(CONFIG_TDLS) && defined(CONFIG_TDLS_CH_SW) + case HW_VAR_TDLS_BCN_EARLY_C2H_RPT: + rtl8723d_set_BcnEarly_C2H_Rpt_cmd(padapter, *val); break; +#endif default: - SetHwReg(padapter, variable, val); + ret = SetHwReg(padapter, variable, val); break; } + return ret; } struct qinfo_8723d { @@ -5783,6 +5383,28 @@ void dump_mac_qinfo_8723d(void *sel, _adapter *adapter) dump_bcn_qinfo_8723d(sel, (struct bcn_qinfo_8723d *)&bcn_q_info, "BCN "); } +static void dump_mac_txfifo_8723d(void *sel, _adapter *adapter) +{ + u32 rqpn, rqpn_npq; + u32 hpq, lpq, npq, epq, pubq; + + rqpn = rtw_read32(adapter, REG_FIFOPAGE); + rqpn_npq = rtw_read32(adapter, REG_RQPN_NPQ); + + hpq = (rqpn & 0xFF); + lpq = ((rqpn & 0xFF00)>>8); + pubq = ((rqpn & 0xFF0000)>>16); + npq = ((rqpn_npq & 0xFF00)>>8); + epq = ((rqpn_npq & 0xFF000000)>>24); + + RTW_PRINT_SEL(sel, "Tx: available page num: "); + if ((hpq == 0xEA) && (hpq == lpq) && (hpq == pubq)) + RTW_PRINT_SEL(sel, "N/A (reg val = 0xea)\n"); + else + RTW_PRINT_SEL(sel, "HPQ: %d, LPQ: %d, NPQ: %d, EPQ: %d, PUBQ: %d\n" + , hpq, lpq, npq, epq, pubq); +} + void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); @@ -5809,26 +5431,6 @@ void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) } break; - case HW_VAR_FWLPS_RF_ON: { - /* When we halt NIC, we should check if FW LPS is leave. */ - u32 valRCR; - - if (rtw_is_surprise_removed(padapter) || - (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) { - /* If it is in HW/SW Radio OFF or IPS state, we do not check Fw LPS Leave, */ - /* because Fw is unload. */ - *val = _TRUE; - } else { - valRCR = rtw_read32(padapter, REG_RCR); - valRCR &= 0x00070000; - if (valRCR) - *val = _FALSE; - else - *val = _TRUE; - } - } - break; - case HW_VAR_EFUSE_USAGE: *val = pHalData->EfuseUsedPercentage; break; @@ -5855,6 +5457,10 @@ void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); *val = (val16 & BIT(10)) ? _TRUE : _FALSE; break; + case HW_VAR_CHK_MGQ_CPU_EMPTY: + val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); + *val = (val16 & BIT(8)) ? _TRUE : _FALSE; + break; #ifdef CONFIG_WOWLAN case HW_VAR_RPWM_TOG: *val = rtw_read8(padapter, SDIO_LOCAL_BASE | SDIO_REG_HRPWM1) & BIT(7); @@ -5871,6 +5477,9 @@ void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val) case HW_VAR_DUMP_MAC_QUEUE_INFO: dump_mac_qinfo_8723d(val, padapter); break; + case HW_VAR_DUMP_MAC_TXFIFO: + dump_mac_txfifo_8723d(val, padapter); + break; default: GetHwReg(padapter, variable, val); break; @@ -6040,9 +5649,6 @@ u8 GetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval) else *(u8 *)pval = WMM_NORMAL_TX_PAGE_BOUNDARY_8723D; break; - case HAL_DEF_MACID_SLEEP: - *(u8 *)pval = _TRUE; /* support macid sleep */ - break; case HAL_DEF_TX_PAGE_SIZE: *((u32 *)pval) = PAGE_SIZE_128; break; @@ -6078,8 +5684,10 @@ void rtl8723d_start_thread(_adapter *padapter) struct xmit_priv *xmitpriv = &padapter->xmitpriv; xmitpriv->SdioXmitThread = kthread_run(rtl8723ds_xmit_thread, padapter, "RTWHALXT"); - if (IS_ERR(xmitpriv->SdioXmitThread)) + if (IS_ERR(xmitpriv->SdioXmitThread)) { RTW_ERR("%s: start rtl8723ds_xmit_thread FAIL!!\n", __func__); + xmitpriv->SdioXmitThread = NULL; + } #endif #endif } @@ -6093,8 +5701,8 @@ void rtl8723d_stop_thread(_adapter *padapter) /* stop xmit_buf_thread */ if (xmitpriv->SdioXmitThread) { _rtw_up_sema(&xmitpriv->SdioXmitSema); - _rtw_down_sema(&xmitpriv->SdioXmitTerminateSema); - xmitpriv->SdioXmitThread = 0; + rtw_thread_stop(xmitpriv->SdioXmitThread); + xmitpriv->SdioXmitThread = NULL; } #endif #endif @@ -6139,15 +5747,11 @@ void rtl8723d_set_hal_ops(struct hal_ops *pHalFunc) pHalFunc->dm_init = &rtl8723d_init_dm_priv; pHalFunc->dm_deinit = &rtl8723d_deinit_dm_priv; pHalFunc->read_chip_version = read_chip_version_8723d; - pHalFunc->UpdateRAMaskHandler = &UpdateHalRAMask8723D; pHalFunc->set_chnl_bw_handler = &PHY_SetSwChnlBWMode8723D; pHalFunc->set_tx_power_level_handler = &PHY_SetTxPowerLevel8723D; pHalFunc->get_tx_power_level_handler = &PHY_GetTxPowerLevel8723D; pHalFunc->get_tx_power_index_handler = &PHY_GetTxPowerIndex_8723D; pHalFunc->hal_dm_watchdog = &rtl8723d_HalDmWatchDog; -#ifdef CONFIG_LPS_LCLK_WD_TIMER - pHalFunc->hal_dm_watchdog_in_lps = &rtl8723d_HalDmWatchDog_in_LPS; -#endif pHalFunc->SetBeaconRelatedRegistersHandler = &rtl8723d_SetBeaconRelatedRegisters; pHalFunc->run_thread = &rtl8723d_start_thread; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_lps_poff.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_lps_poff.c index d171f4c54cb9..ee574c8718e3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_lps_poff.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_lps_poff.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 #ifdef CONFIG_LPS_POFF @@ -248,7 +243,7 @@ static bool rtl8723d_lps_poff_tx_bndy_flow(PADAPTER padapter, bool enable) ATOMIC_SET(&plps_poff_info->bTxBoundInProgress, _TRUE); /* stop os layer TX*/ - rtw_mi_netif_stop_queue(padapter, _FALSE); + rtw_mi_netif_stop_queue(padapter); val16 = rtw_read16(padapter, REG_TXPKT_EMPTY); @@ -377,7 +372,7 @@ static void rtl8723d_lps_poff_send_config_file(PADAPTER padapter, bool bRecover = _FALSE, bcn_valid = _FALSE; u8 DLBcnCount = 0, val8 = 0, tx_bndy = 0; u32 poll = 0; - + u8 RegFwHwTxQCtrl; rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_BOUNDARY, (u8 *)&tx_bndy); @@ -387,13 +382,13 @@ static void rtl8723d_lps_poff_send_config_file(PADAPTER padapter, rtw_write8(padapter, REG_CR + 1, val8); /*set 0x422[6]=0 to disable beacon DMA pass to MACTx*/ - - if (pHalData->RegFwHwTxQCtrl & BIT(6)) + RegFwHwTxQCtrl = rtw_read8(padapter, REG_FWHW_TXQ_CTRL + 2); + if (RegFwHwTxQCtrl & BIT(6)) bRecover = _TRUE; - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, - pHalData->RegFwHwTxQCtrl & ~BIT(6)); - pHalData->RegFwHwTxQCtrl &= ~BIT(6); + RegFwHwTxQCtrl &= ~BIT(6); + + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); /* Clear beacon valid check bit. */ rtw_hal_set_hwreg(padapter, HW_VAR_BCN_VALID, NULL); @@ -430,9 +425,8 @@ static void rtl8723d_lps_poff_send_config_file(PADAPTER padapter, /*restore 0x422[6]=1 for normal bcn*/ if (bRecover) { - rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, - pHalData->RegFwHwTxQCtrl | BIT(6)); - pHalData->RegFwHwTxQCtrl |= BIT(6); + RegFwHwTxQCtrl |= BIT(6); + rtw_write8(padapter, REG_FWHW_TXQ_CTRL + 2, RegFwHwTxQCtrl); } /*restore 0x100[8]=0 for SW beacon*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_phycfg.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_phycfg.c index aed2494039f7..0bdb826b500c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_phycfg.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_phycfg.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTL8723D_PHYCFG_C_ #include @@ -181,7 +176,7 @@ PHY_SetBBReg_8723D( static u32 phy_FwRFSerialRead( IN PADAPTER Adapter, - IN RF_PATH eRFPath, + IN enum rf_path eRFPath, IN u32 Offset) { u32 retValue = 0; @@ -210,7 +205,7 @@ phy_FwRFSerialRead( static VOID phy_FwRFSerialWrite( IN PADAPTER Adapter, - IN RF_PATH eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u32 Data) { @@ -220,7 +215,7 @@ phy_FwRFSerialWrite( static u32 phy_RFSerialRead_8723D( IN PADAPTER Adapter, - IN RF_PATH eRFPath, + IN enum rf_path eRFPath, IN u32 Offset ) { @@ -242,18 +237,18 @@ phy_RFSerialRead_8723D( NewOffset = Offset; if (eRFPath == RF_PATH_A) { - tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); + tmplong2 = phy_query_bb_reg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset << 23) | bLSSIReadEdge; /* T65 RF */ - PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); + phy_set_bb_reg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); } else { - tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord); + tmplong2 = phy_query_bb_reg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord); tmplong2 = (tmplong2 & (~bLSSIReadAddress)) | (NewOffset << 23) | bLSSIReadEdge; /* T65 RF */ - PHY_SetBBReg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); + phy_set_bb_reg(Adapter, rFPGA0_XB_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); } - tmplong2 = PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); - PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); - PHY_SetBBReg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 | bLSSIReadEdge); + tmplong2 = phy_query_bb_reg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord); + phy_set_bb_reg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 & (~bLSSIReadEdge)); + phy_set_bb_reg(Adapter, rFPGA0_XA_HSSIParameter2 | MaskforPhySet, bMaskDWord, tmplong2 | bLSSIReadEdge); rtw_udelay_os(10); @@ -262,18 +257,18 @@ phy_RFSerialRead_8723D( rtw_udelay_os(10); if (eRFPath == RF_PATH_A) - RfPiEnable = (u1Byte)PHY_QueryBBReg(Adapter, rFPGA0_XA_HSSIParameter1 | MaskforPhySet, BIT(8)); + RfPiEnable = (u1Byte)phy_query_bb_reg(Adapter, rFPGA0_XA_HSSIParameter1 | MaskforPhySet, BIT(8)); else if (eRFPath == RF_PATH_B) - RfPiEnable = (u1Byte)PHY_QueryBBReg(Adapter, rFPGA0_XB_HSSIParameter1 | MaskforPhySet, BIT(8)); + RfPiEnable = (u1Byte)phy_query_bb_reg(Adapter, rFPGA0_XB_HSSIParameter1 | MaskforPhySet, BIT(8)); if (RfPiEnable) { /* Read from BBreg8b8, 12 bits for 8190, 20bits for T65 RF */ - retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBackPi | MaskforPhySet, bLSSIReadBackData); + retValue = phy_query_bb_reg(Adapter, pPhyReg->rfLSSIReadBackPi | MaskforPhySet, bLSSIReadBackData); /* RT_DISP(FINIT, INIT_RF, ("Readback from RF-PI : 0x%x\n", retValue)); */ } else { /* Read from BBreg8a0, 12 bits for 8190, 20 bits for T65 RF */ - retValue = PHY_QueryBBReg(Adapter, pPhyReg->rfLSSIReadBack | MaskforPhySet, bLSSIReadBackData); + retValue = phy_query_bb_reg(Adapter, pPhyReg->rfLSSIReadBack | MaskforPhySet, bLSSIReadBackData); /* RT_DISP(FINIT, INIT_RF,("Readback from RF-SI : 0x%x\n", retValue)); */ } @@ -289,7 +284,7 @@ phy_RFSerialRead_8723D( * * Input: * PADAPTER Adapter, -* RF_PATH eRFPath, + enum rf_path eRFPath, * u4Byte Offset, * u4Byte Data * @@ -328,7 +323,7 @@ phy_RFSerialRead_8723D( static VOID phy_RFSerialWrite_8723D( IN PADAPTER Adapter, - IN RF_PATH eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u32 Data ) @@ -359,7 +354,7 @@ phy_RFSerialWrite_8723D( /* */ /* Write Operation */ /* */ - PHY_SetBBReg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); + phy_set_bb_reg(Adapter, pPhyReg->rf3wireOffset, bMaskDWord, DataAndAddr); /* RTPRINT(FPHY, PHY_RFW, ("RFW-%d Addr[0x%lx]=0x%lx\n", eRFPath, pPhyReg->rf3wireOffset, DataAndAddr)); */ } @@ -372,7 +367,7 @@ phy_RFSerialWrite_8723D( * * Input: * PADAPTER Adapter, -* RF_PATH eRFPath, + enum rf_path eRFPath, * u4Byte RegAddr, * u4Byte BitMask * @@ -384,7 +379,7 @@ phy_RFSerialWrite_8723D( u32 PHY_QueryRFReg_8723D( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask ) @@ -424,7 +419,7 @@ PHY_QueryRFReg_8723D( VOID PHY_SetRFReg_8723D( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data @@ -482,7 +477,7 @@ s32 PHY_MACConfig8723D(PADAPTER Adapter) #endif { #ifdef CONFIG_EMBEDDED_FWIMG - ODM_ConfigMACWithHeaderFile(&pHalData->odmpriv); + odm_config_mac_with_header_file(&pHalData->odmpriv); rtStatus = _SUCCESS; #endif/* CONFIG_EMBEDDED_FWIMG */ } @@ -510,28 +505,28 @@ phy_InitBBRFRegisterDefinition( HAL_DATA_TYPE *pHalData = GET_HAL_DATA(Adapter); /* RF Interface Sowrtware Control */ - pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 LSBs if read 32-bit from 0x870 */ - pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) */ + pHalData->PHYRegDef[RF_PATH_A].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 LSBs if read 32-bit from 0x870 */ + pHalData->PHYRegDef[RF_PATH_B].rfintfs = rFPGA0_XAB_RFInterfaceSW; /* 16 MSBs if read 32-bit from 0x870 (16-bit for 0x872) */ /* RF Interface Output (and Enable) */ - pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x860 */ - pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x864 */ + pHalData->PHYRegDef[RF_PATH_A].rfintfo = rFPGA0_XA_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x860 */ + pHalData->PHYRegDef[RF_PATH_B].rfintfo = rFPGA0_XB_RFInterfaceOE; /* 16 LSBs if read 32-bit from 0x864 */ /* RF Interface (Output and) Enable */ - pHalData->PHYRegDef[ODM_RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) */ - pHalData->PHYRegDef[ODM_RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) */ + pHalData->PHYRegDef[RF_PATH_A].rfintfe = rFPGA0_XA_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x860 (16-bit for 0x862) */ + pHalData->PHYRegDef[RF_PATH_B].rfintfe = rFPGA0_XB_RFInterfaceOE; /* 16 MSBs if read 32-bit from 0x864 (16-bit for 0x866) */ - pHalData->PHYRegDef[ODM_RF_PATH_A].rf3wireOffset = rFPGA0_XA_LSSIParameter; /* LSSI Parameter */ - pHalData->PHYRegDef[ODM_RF_PATH_B].rf3wireOffset = rFPGA0_XB_LSSIParameter; + pHalData->PHYRegDef[RF_PATH_A].rf3wireOffset = rFPGA0_XA_LSSIParameter; /* LSSI Parameter */ + pHalData->PHYRegDef[RF_PATH_B].rf3wireOffset = rFPGA0_XB_LSSIParameter; - pHalData->PHYRegDef[ODM_RF_PATH_A].rfHSSIPara2 = rFPGA0_XA_HSSIParameter2; /* wire control parameter2 */ - pHalData->PHYRegDef[ODM_RF_PATH_B].rfHSSIPara2 = rFPGA0_XB_HSSIParameter2; /* wire control parameter2 */ + pHalData->PHYRegDef[RF_PATH_A].rfHSSIPara2 = rFPGA0_XA_HSSIParameter2; /* wire control parameter2 */ + pHalData->PHYRegDef[RF_PATH_B].rfHSSIPara2 = rFPGA0_XB_HSSIParameter2; /* wire control parameter2 */ /* Tranceiver Readback LSSI/HSPI mode */ - pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBack = rFPGA0_XA_LSSIReadBack; - pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBack = rFPGA0_XB_LSSIReadBack; - pHalData->PHYRegDef[ODM_RF_PATH_A].rfLSSIReadBackPi = TransceiverA_HSPI_Readback; - pHalData->PHYRegDef[ODM_RF_PATH_B].rfLSSIReadBackPi = TransceiverB_HSPI_Readback; + pHalData->PHYRegDef[RF_PATH_A].rfLSSIReadBack = rFPGA0_XA_LSSIReadBack; + pHalData->PHYRegDef[RF_PATH_B].rfLSSIReadBack = rFPGA0_XB_LSSIReadBack; + pHalData->PHYRegDef[RF_PATH_A].rfLSSIReadBackPi = TransceiverA_HSPI_Readback; + pHalData->PHYRegDef[RF_PATH_B].rfLSSIReadBackPi = TransceiverB_HSPI_Readback; } @@ -551,7 +546,7 @@ phy_BB8723d_Config_ParaFile( #endif { #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) + if (HAL_STATUS_SUCCESS != odm_config_bb_with_header_file(&pHalData->odmpriv, CONFIG_BB_PHY_REG)) rtStatus = _FAIL; #endif } @@ -564,8 +559,8 @@ phy_BB8723d_Config_ParaFile( #if MP_DRIVER == 1 if (Adapter->registrypriv.mp_mode == 1) { /*20160504, Suggested by jessica_wang. To Fix CCK ACPR issue*/ - PHY_SetBBReg(Adapter, 0xCE0, BIT1|BIT0, 0);/*RXHP=low corner*/ - PHY_SetBBReg(Adapter, 0xC3C, 0xFF, 0xCC);/*make sure low rate sensitivity*/ + phy_set_bb_reg(Adapter, 0xCE0, BIT1|BIT0, 0);/*RXHP=low corner*/ + phy_set_bb_reg(Adapter, 0xC3C, 0xFF, 0xCC);/*make sure low rate sensitivity*/ } #endif /* #if (MP_DRIVER == 1) */ @@ -577,7 +572,7 @@ phy_BB8723d_Config_ParaFile( #endif { #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_SUCCESS != ODM_ConfigBBWithHeaderFile(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) + if (HAL_STATUS_SUCCESS != odm_config_bb_with_header_file(&pHalData->odmpriv, CONFIG_BB_AGC_TAB)) rtStatus = _FAIL; #endif } @@ -631,7 +626,7 @@ PHY_BBConfig8723D( */ rtStatus = phy_BB8723d_Config_ParaFile(Adapter); - hal_set_crystal_cap(Adapter, pHalData->CrystalCap); + hal_set_crystal_cap(Adapter, pHalData->crystal_cap); return rtStatus; } @@ -653,20 +648,20 @@ PHY_BB8723D_Config_1T( ) { /* BB OFDM RX Path_A */ - PHY_SetBBReg(Adapter, rRxPath_Jaguar, bRxPath_Jaguar, 0x11); + phy_set_bb_reg(Adapter, rRxPath_Jaguar, bRxPath_Jaguar, 0x11); /* BB OFDM TX Path_A */ - PHY_SetBBReg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); + phy_set_bb_reg(Adapter, rTxPath_Jaguar, bMaskLWord, 0x1111); /* BB CCK R/Rx Path_A */ - PHY_SetBBReg(Adapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); + phy_set_bb_reg(Adapter, rCCK_RX_Jaguar, bCCK_RX_Jaguar, 0x0); /* MCS support */ - PHY_SetBBReg(Adapter, 0x8bc, 0xc0000060, 0x4); + phy_set_bb_reg(Adapter, 0x8bc, 0xc0000060, 0x4); /* RF Path_B HSSI OFF */ - PHY_SetBBReg(Adapter, 0xe00, 0xf, 0x4); + phy_set_bb_reg(Adapter, 0xe00, 0xf, 0x4); /* RF Path_B Power Down */ - PHY_SetBBReg(Adapter, 0xe90, bMaskDWord, 0); + phy_set_bb_reg(Adapter, 0xe90, bMaskDWord, 0); /* ADDA Path_B OFF */ - PHY_SetBBReg(Adapter, 0xe60, bMaskDWord, 0); - PHY_SetBBReg(Adapter, 0xe64, bMaskDWord, 0); + phy_set_bb_reg(Adapter, 0xe60, bMaskDWord, 0); + phy_set_bb_reg(Adapter, 0xe64, bMaskDWord, 0); } #endif @@ -695,7 +690,7 @@ PHY_RFConfig8723D( * * Input: PADAPTER Adapter * ps1Byte pFileName - * RF_PATH eRFPath + * enum rf_path eRFPath * * Output: NONE * @@ -706,8 +701,8 @@ PHY_RFConfig8723D( int PHY_ConfigRFWithParaFile_8723D( IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + IN u8 *pFileName, + enum rf_path eRFPath ) { return _SUCCESS; @@ -724,75 +719,75 @@ VOID PHY_SetTxPowerIndex_8723D( IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ) { - if (RFPath == ODM_RF_PATH_A || RFPath == ODM_RF_PATH_B) { + if (RFPath == RF_PATH_A || RFPath == RF_PATH_B) { switch (Rate) { case MGN_1M: - PHY_SetBBReg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_CCK1_Mcs32, bMaskByte1, PowerIndex); break; case MGN_2M: - PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte1, PowerIndex); break; case MGN_5_5M: - PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte2, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte2, PowerIndex); break; case MGN_11M: - PHY_SetBBReg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte3, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_B_CCK11_A_CCK2_11, bMaskByte3, PowerIndex); break; case MGN_6M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte0, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate18_06, bMaskByte0, PowerIndex); break; case MGN_9M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte1, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate18_06, bMaskByte1, PowerIndex); break; case MGN_12M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte2, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate18_06, bMaskByte2, PowerIndex); break; case MGN_18M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate18_06, bMaskByte3, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate18_06, bMaskByte3, PowerIndex); break; case MGN_24M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte0, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate54_24, bMaskByte0, PowerIndex); break; case MGN_36M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte1, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate54_24, bMaskByte1, PowerIndex); break; case MGN_48M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte2, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate54_24, bMaskByte2, PowerIndex); break; case MGN_54M: - PHY_SetBBReg(Adapter, rTxAGC_A_Rate54_24, bMaskByte3, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Rate54_24, bMaskByte3, PowerIndex); break; case MGN_MCS0: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte0, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte0, PowerIndex); break; case MGN_MCS1: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte1, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte1, PowerIndex); break; case MGN_MCS2: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte2, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte2, PowerIndex); break; case MGN_MCS3: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte3, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs03_Mcs00, bMaskByte3, PowerIndex); break; case MGN_MCS4: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte0, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte0, PowerIndex); break; case MGN_MCS5: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte1, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte1, PowerIndex); break; case MGN_MCS6: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte2, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte2, PowerIndex); break; case MGN_MCS7: - PHY_SetBBReg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte3, PowerIndex); + phy_set_bb_reg(Adapter, rTxAGC_A_Mcs07_Mcs04, bMaskByte3, PowerIndex); break; default: @@ -802,18 +797,10 @@ PHY_SetTxPowerIndex_8723D( } } -u8 -phy_GetCurrentTxNum_8723D( - IN PADAPTER pAdapter -) -{ - return RF_TX_NUM_NONIMPLEMENT; -} - u8 PHY_GetTxPowerIndex_8723D( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -821,18 +808,20 @@ PHY_GetTxPowerIndex_8723D( ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(pAdapter); - u8 base_idx = 0, power_idx = 0; + s16 power_idx; + u8 base_idx = 0; s8 by_rate_diff = 0, limit = 0, tpt_offset = 0, extra_bias = 0; BOOLEAN bIn24G = _FALSE; - base_idx = PHY_GetTxPowerIndexBase(pAdapter, RFPath, Rate, BandWidth, Channel, &bIn24G); + base_idx = PHY_GetTxPowerIndexBase(pAdapter, RFPath, Rate, RF_1TX, BandWidth, Channel, &bIn24G); - by_rate_diff = PHY_GetTxPowerByRate(pAdapter, BAND_ON_2_4G, ODM_RF_PATH_A, RF_1TX, Rate); - limit = PHY_GetTxPowerLimit(pAdapter, pAdapter->registrypriv.RegPwrTblSel, (u8)(!bIn24G), pHalData->CurrentChannelBW, RFPath, Rate, pHalData->CurrentChannel); + by_rate_diff = PHY_GetTxPowerByRate(pAdapter, BAND_ON_2_4G, RF_PATH_A, Rate); + limit = PHY_GetTxPowerLimit(pAdapter, NULL, (u8)(!bIn24G), pHalData->current_channel_bw, RFPath, Rate, RF_1TX, pHalData->current_channel); tpt_offset = PHY_GetTxPowerTrackingOffset(pAdapter, RFPath, Rate); if (tic) { + tic->ntx_idx = RF_1TX; tic->base = base_idx; tic->by_rate = by_rate_diff; tic->limit = limit; @@ -843,7 +832,9 @@ PHY_GetTxPowerIndex_8723D( by_rate_diff = by_rate_diff > limit ? limit : by_rate_diff; power_idx = base_idx + by_rate_diff + tpt_offset + extra_bias; - if (power_idx > MAX_POWER_INDEX) + if (power_idx < 0) + power_idx = 0; + else if (power_idx > MAX_POWER_INDEX) power_idx = MAX_POWER_INDEX; return power_idx; @@ -857,20 +848,20 @@ PHY_SetTxPowerLevel8723D( { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); u8 cur_antenna; - u8 RFPath = ODM_RF_PATH_A; + enum rf_path RFPath = RF_PATH_A; #ifdef CONFIG_ANTENNA_DIVERSITY rtw_hal_get_odm_var(Adapter, HAL_ODM_ANTDIV_SELECT, &cur_antenna, NULL); if (pHalData->AntDivCfg) /* antenna diversity Enable */ - RFPath = ((cur_antenna == MAIN_ANT) ? ODM_RF_PATH_A : ODM_RF_PATH_B); + RFPath = ((cur_antenna == MAIN_ANT) ? RF_PATH_A : RF_PATH_B); else /* antenna diversity disable */ #endif RFPath = pHalData->ant_path; - PHY_SetTxPowerLevelByPath(Adapter, Channel, RFPath); + phy_set_tx_power_level_by_path(Adapter, Channel, RFPath); } @@ -908,13 +899,13 @@ phy_SpurCalibration_8723D( /* add for notch */ u4Byte wlan_channel, CurrentChannel; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - PDM_ODM_T pDM_Odm = &(pHalData->odmpriv); + struct PHY_DM_STRUCT *pDM_Odm = &(pHalData->odmpriv); /* check threshold */ if (threshold <= 0x0) threshold = 0x16; - RTW_INFO("===>phy_SpurCalibration_8723D: Channel = %d\n", ToChannel); + RTW_DBG("===>phy_SpurCalibration_8723D: Channel = %d\n", ToChannel); if (ToChannel == 13) idx = 0; @@ -923,68 +914,68 @@ phy_SpurCalibration_8723D( /* If current channel=13,14 */ if (idx < 0xFF) { - initial_gain = (u1Byte)(ODM_GetBBReg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0) & 0x7f); - odm_PauseDIG(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, 0x30); - PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccf000c0); /* disable 3-wire */ + initial_gain = (u1Byte)(odm_get_bb_reg(pDM_Odm, rOFDM0_XAAGCCore1, bMaskByte0) & 0x7f); + odm_pause_dig(pDM_Odm, PHYDM_PAUSE, PHYDM_PAUSE_LEVEL_1, 0x30); + phy_set_bb_reg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccf000c0); /* disable 3-wire */ - PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* Setup PSD */ - PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, 0x400000 | freq[idx]); /* Start PSD */ + phy_set_bb_reg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* Setup PSD */ + phy_set_bb_reg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, 0x400000 | freq[idx]); /* Start PSD */ rtw_msleep_os(30); - if (PHY_QueryBBReg(pAdapter, rFPGA0_PSDReport, bMaskDWord) >= threshold) + if (phy_query_bb_reg(pAdapter, rFPGA0_PSDReport, bMaskDWord) >= threshold) b_doNotch = TRUE; - PHY_SetBBReg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* turn off PSD */ - PHY_SetBBReg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccc000c0); /* enable 3-wire */ - odm_PauseDIG(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, NONE); + phy_set_bb_reg(pAdapter, rFPGA0_PSDFunction, bMaskDWord, freq[idx]); /* turn off PSD */ + phy_set_bb_reg(pAdapter, rFPGA0_AnalogParameter4, bMaskDWord, 0xccc000c0); /* enable 3-wire */ + odm_pause_dig(pDM_Odm, PHYDM_RESUME, PHYDM_PAUSE_LEVEL_1, NONE); } /* --- Notch Filter --- Asked by Rock */ if (b_doNotch) { - CurrentChannel = ODM_GetRFReg(pDM_Odm, ODM_RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); + CurrentChannel = odm_get_rf_reg(pDM_Odm, RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); wlan_channel = CurrentChannel & 0x0f; /* Get center frequency */ switch (wlan_channel) { /* Set notch filter */ case 13: - ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0xB); - ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ - ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x04000000); - ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ + odm_set_bb_reg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0xB); + odm_set_bb_reg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ + odm_set_bb_reg(pDM_Odm, 0xD40, bMaskDWord, 0x04000000); + odm_set_bb_reg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ break; case 14: - ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x5); - ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ - ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00080000); - ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ + odm_set_bb_reg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x5); + odm_set_bb_reg(pDM_Odm, 0xC40, BIT(9), 0x1); /* enable notch filter */ + odm_set_bb_reg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD4C, bMaskDWord, 0x00080000); + odm_set_bb_reg(pDM_Odm, 0xD2C, BIT(28), 0x1); /* enable CSI mask */ break; default: - ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ - ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask function */ + odm_set_bb_reg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ + odm_set_bb_reg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask function */ break; } /* switch(wlan_channel) */ return; } - ODM_SetBBReg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x1f); - ODM_SetBBReg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ - ODM_SetBBReg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); - ODM_SetBBReg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask */ + odm_set_bb_reg(pDM_Odm, 0xC40, BIT(28) | BIT(27) | BIT(26) | BIT(25) | BIT(24), 0x1f); + odm_set_bb_reg(pDM_Odm, 0xC40, BIT(9), 0x0); /* disable notch filter */ + odm_set_bb_reg(pDM_Odm, 0xD40, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD44, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD48, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD4C, bMaskDWord, 0x00000000); + odm_set_bb_reg(pDM_Odm, 0xD2C, BIT(28), 0x0); /* disable CSI mask */ } VOID phy_SetRegBW_8723D( IN PADAPTER Adapter, - CHANNEL_WIDTH CurrentBW + enum channel_width CurrentBW ) { u16 RegRfMod_BW, u2tmp = 0; @@ -1020,7 +1011,7 @@ phy_GetSecondaryChnl_8723D( u8 SCSettingOf40 = 0, SCSettingOf20 = 0; PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_80) { + if (pHalData->current_channel_bw == CHANNEL_WIDTH_80) { if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_LOWER) SCSettingOf40 = VHT_DATA_SC_40_LOWER_OF_80MHZ; else if (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) @@ -1036,7 +1027,7 @@ phy_GetSecondaryChnl_8723D( else if ((pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) && (pHalData->nCur80MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER)) SCSettingOf20 = VHT_DATA_SC_20_UPPERST_OF_80MHZ; - } else if (pHalData->CurrentChannelBW == CHANNEL_WIDTH_40) { + } else if (pHalData->current_channel_bw == CHANNEL_WIDTH_40) { if (pHalData->nCur40MhzPrimeSC == HAL_PRIME_CHNL_OFFSET_UPPER) SCSettingOf20 = VHT_DATA_SC_20_UPPER_OF_80MHZ; @@ -1057,13 +1048,13 @@ phy_PostSetBwMode8723D( HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); /* 2 Set Reg668 Reg440 BW */ - phy_SetRegBW_8723D(padapter, pHalData->CurrentChannelBW); + phy_SetRegBW_8723D(padapter, pHalData->current_channel_bw); /* 3 Set Reg483 */ SubChnlNum = phy_GetSecondaryChnl_8723D(padapter); rtw_write8(padapter, REG_DATA_SC_8723D, SubChnlNum); - switch (pHalData->CurrentChannelBW) { + switch (pHalData->current_channel_bw) { /* 20 MHz channel*/ case CHANNEL_WIDTH_20: /* @@ -1072,10 +1063,10 @@ phy_PostSetBwMode8723D( 0x954[19]=1'b1 0x954[27:24]= 10 */ - PHY_SetBBReg(padapter, rFPGA0_RFMOD, bRFMOD, 0x0); - PHY_SetBBReg(padapter, rFPGA1_RFMOD, bRFMOD, 0x0); - PHY_SetBBReg(padapter, rBBrx_DFIR, BIT(19), 1); - PHY_SetBBReg(padapter, rBBrx_DFIR, + phy_set_bb_reg(padapter, rFPGA0_RFMOD, bRFMOD, 0x0); + phy_set_bb_reg(padapter, rFPGA1_RFMOD, bRFMOD, 0x0); + phy_set_bb_reg(padapter, rBBrx_DFIR, BIT(19), 1); + phy_set_bb_reg(padapter, rBBrx_DFIR, (BIT(27) | BIT(26) | BIT(25) | BIT(24)), 0xa); break; /* 40 MHz channel*/ @@ -1087,10 +1078,10 @@ phy_PostSetBwMode8723D( 0x954[23:20]=2'b11(For ACPR) 0xa00[4]=1/0 */ - PHY_SetBBReg(padapter, rFPGA0_RFMOD, bRFMOD, 0x1); - PHY_SetBBReg(padapter, rFPGA1_RFMOD, bRFMOD, 0x1); - PHY_SetBBReg(padapter, rBBrx_DFIR, BIT(19), 0); - PHY_SetBBReg(padapter, rCCK0_System, bCCKSideBand, + phy_set_bb_reg(padapter, rFPGA0_RFMOD, bRFMOD, 0x1); + phy_set_bb_reg(padapter, rFPGA1_RFMOD, bRFMOD, 0x1); + phy_set_bb_reg(padapter, rBBrx_DFIR, BIT(19), 0); + phy_set_bb_reg(padapter, rCCK0_System, bCCKSideBand, (pHalData->nCur40MhzPrimeSC >> 1)); break; @@ -1099,7 +1090,7 @@ phy_PostSetBwMode8723D( } /*3<3>Set RF related register */ - PHY_RF6052SetBandwidth8723D(padapter, pHalData->CurrentChannelBW); + PHY_RF6052SetBandwidth8723D(padapter, pHalData->current_channel_bw); } VOID @@ -1108,19 +1099,19 @@ phy_SwChnl8723D( ) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(pAdapter); - u8 channelToSW = pHalData->CurrentChannel; + u8 channelToSW = pHalData->current_channel; u8 i = 0; if (pHalData->rf_chip == RF_PSEUDO_11N) { - RTW_INFO("phy_SwChnl8723D: return for PSEUDO\n"); + RTW_WARN("phy_SwChnl8723D: return for PSEUDO\n"); return; } pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff00) | channelToSW); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_A, RF_CHNLBW, + phy_set_rf_reg(pAdapter, RF_PATH_A, RF_CHNLBW, 0x3FF, pHalData->RfRegChnlVal[0]); - PHY_SetRFReg(pAdapter, ODM_RF_PATH_B, RF_CHNLBW, + phy_set_rf_reg(pAdapter, RF_PATH_B, RF_CHNLBW, 0x3FF, pHalData->RfRegChnlVal[0]); phy_SpurCalibration_8723D(pAdapter, channelToSW, 0x16); @@ -1130,7 +1121,7 @@ phy_SwChnl8723D( if (channelToSW >= 1 && channelToSW <= 13) { if (pHalData->need_restore == _TRUE) { for (i = 0 ; i < 3 ; i++) { - PHY_SetBBReg(pAdapter, + phy_set_bb_reg(pAdapter, pHalData->RegForRecover[i].offset, bMaskDWord, pHalData->RegForRecover[i].value); @@ -1139,12 +1130,12 @@ phy_SwChnl8723D( } } else if (channelToSW == 14) { pHalData->need_restore = _TRUE; - PHY_SetBBReg(pAdapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); - PHY_SetBBReg(pAdapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); - PHY_SetBBReg(pAdapter, 0xAAC, bMaskDWord, 0x00003667); + phy_set_bb_reg(pAdapter, rCCK0_TxFilter2, bMaskDWord, 0x0000B81C); + phy_set_bb_reg(pAdapter, rCCK0_DebugPort, bMaskDWord, 0x00000000); + phy_set_bb_reg(pAdapter, 0xAAC, bMaskDWord, 0x00003667); } - RTW_INFO("===>phy_SwChnl8723D: Channel = %d\n", channelToSW); + RTW_DBG("===>phy_SwChnl8723D: Channel = %d\n", channelToSW); } VOID @@ -1158,9 +1149,9 @@ phy_SwChnlAndSetBwMode8723D( RTW_INFO("[%s] bSwChnl=%d, ch=%d, bSetChnlBW=%d, bw=%d\n", __func__, pHalData->bSwChnl, - pHalData->CurrentChannel, + pHalData->current_channel, pHalData->bSetChnlBW, - pHalData->CurrentChannelBW); + pHalData->current_channel_bw); } if (RTW_CANNOT_RUN(Adapter)) @@ -1176,7 +1167,7 @@ phy_SwChnlAndSetBwMode8723D( pHalData->bSetChnlBW = _FALSE; } - PHY_SetTxPowerLevel8723D(Adapter, pHalData->CurrentChannel); + PHY_SetTxPowerLevel8723D(Adapter, pHalData->current_channel); } VOID @@ -1185,7 +1176,7 @@ PHY_HandleSwChnlAndSetBW8723D( IN BOOLEAN bSwitchChannel, IN BOOLEAN bSetBandWidth, IN u8 ChannelNum, - IN CHANNEL_WIDTH ChnlWidth, + IN enum channel_width ChnlWidth, IN EXTCHNL_OFFSET ExtChnlOffsetOf40MHz, IN EXTCHNL_OFFSET ExtChnlOffsetOf80MHz, IN u8 CenterFrequencyIndex1 @@ -1193,8 +1184,8 @@ PHY_HandleSwChnlAndSetBW8723D( { /* static BOOLEAN bInitialzed = _FALSE; */ PHAL_DATA_TYPE pHalData = GET_HAL_DATA(Adapter); - u8 tmpChannel = pHalData->CurrentChannel; - CHANNEL_WIDTH tmpBW = pHalData->CurrentChannelBW; + u8 tmpChannel = pHalData->current_channel; + enum channel_width tmpBW = pHalData->current_channel_bw; u8 tmpnCur40MhzPrimeSC = pHalData->nCur40MhzPrimeSC; u8 tmpnCur80MhzPrimeSC = pHalData->nCur80MhzPrimeSC; u8 tmpCenterFrequencyIndex1 = pHalData->CurrentCenterFrequencyIndex1; @@ -1210,7 +1201,7 @@ PHY_HandleSwChnlAndSetBW8723D( /* skip change for channel or bandwidth is the same */ if (bSwitchChannel) { - /* if(pHalData->CurrentChannel != ChannelNum) */ + /* if(pHalData->current_channel != ChannelNum) */ { if (HAL_IsLegalChannel(Adapter, ChannelNum)) pHalData->bSwChnl = _TRUE; @@ -1222,7 +1213,7 @@ PHY_HandleSwChnlAndSetBW8723D( if (bInitialzed == _FALSE) { bInitialzed = _TRUE; pHalData->bSetChnlBW = _TRUE; - } else if ((pHalData->CurrentChannelBW != ChnlWidth) || (pHalData->nCur40MhzPrimeSC != ExtChnlOffsetOf40MHz) || (pHalData->CurrentCenterFrequencyIndex1 != CenterFrequencyIndex1)) + } else if ((pHalData->current_channel_bw != ChnlWidth) || (pHalData->nCur40MhzPrimeSC != ExtChnlOffsetOf40MHz) || (pHalData->CurrentCenterFrequencyIndex1 != CenterFrequencyIndex1)) pHalData->bSetChnlBW = _TRUE; #else pHalData->bSetChnlBW = _TRUE; @@ -1236,13 +1227,13 @@ PHY_HandleSwChnlAndSetBW8723D( if (pHalData->bSwChnl) { - pHalData->CurrentChannel = ChannelNum; + pHalData->current_channel = ChannelNum; pHalData->CurrentCenterFrequencyIndex1 = ChannelNum; } if (pHalData->bSetChnlBW) { - pHalData->CurrentChannelBW = ChnlWidth; + pHalData->current_channel_bw = ChnlWidth; #if 0 if (ExtChnlOffsetOf40MHz == EXTCHNL_OFFSET_LOWER) pHalData->nCur40MhzPrimeSC = HAL_PRIME_CHNL_OFFSET_UPPER; @@ -1270,18 +1261,18 @@ PHY_HandleSwChnlAndSetBW8723D( phy_SwChnlAndSetBwMode8723D(Adapter); else { if (pHalData->bSwChnl) { - pHalData->CurrentChannel = tmpChannel; + pHalData->current_channel = tmpChannel; pHalData->CurrentCenterFrequencyIndex1 = tmpChannel; } if (pHalData->bSetChnlBW) { - pHalData->CurrentChannelBW = tmpBW; + pHalData->current_channel_bw = tmpBW; pHalData->nCur40MhzPrimeSC = tmpnCur40MhzPrimeSC; pHalData->nCur80MhzPrimeSC = tmpnCur80MhzPrimeSC; pHalData->CurrentCenterFrequencyIndex1 = tmpCenterFrequencyIndex1; } } - /* RTW_INFO("Channel %d ChannelBW %d ",pHalData->CurrentChannel, pHalData->CurrentChannelBW); */ + /* RTW_INFO("Channel %d ChannelBW %d ",pHalData->current_channel, pHalData->current_channel_bw); */ /* RTW_INFO("40MhzPrimeSC %d 80MhzPrimeSC %d ",pHalData->nCur40MhzPrimeSC, pHalData->nCur80MhzPrimeSC); */ /* RTW_INFO("CenterFrequencyIndex1 %d\n",pHalData->CurrentCenterFrequencyIndex1); */ @@ -1293,7 +1284,7 @@ VOID PHY_SetSwChnlBWMode8723D( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rf6052.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rf6052.c index 999a356795d2..9d5f46acb323 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rf6052.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rf6052.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /****************************************************************************** * * @@ -72,7 +67,7 @@ static RF_SHADOW_T RF_Shadow[RF6052_MAX_PATH][RF6052_MAX_REG]; VOID PHY_RF6052SetBandwidth8723D( IN PADAPTER padapter, - IN CHANNEL_WIDTH Bandwidth) /* 20M or 40M */ + IN enum channel_width Bandwidth) /* 20M or 40M */ { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); @@ -83,7 +78,7 @@ PHY_RF6052SetBandwidth8723D( RF_A_reg 0x18[9:0] */ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT(10) | BIT(11)); - PHY_SetRFReg(padapter, ODM_RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ + phy_set_rf_reg(padapter, RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ break; case CHANNEL_WIDTH_40: /* @@ -91,7 +86,7 @@ PHY_RF6052SetBandwidth8723D( RF_A_reg 0x18[9:0] */ pHalData->RfRegChnlVal[0] = ((pHalData->RfRegChnlVal[0] & 0xfffff3ff) | BIT(10)); - PHY_SetRFReg(padapter, ODM_RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ + phy_set_rf_reg(padapter, RF_PATH_A, 0x18, bRFRegOffsetMask, pHalData->RfRegChnlVal[0]); /* RF TRX_BW */ break; default: break; @@ -117,7 +112,7 @@ phy_RF6052_Config_ParaFile( ) { u32 u4RegValue = 0; - u8 eRFPath; + enum rf_path eRFPath; BB_REGISTER_DEFINITION_T *pPhyReg; int rtStatus = _SUCCESS; @@ -127,7 +122,7 @@ phy_RF6052_Config_ParaFile( /* 3// <2> Initialize RF */ /* 3//----------------------------------------------------------------- */ /* for(eRFPath = RF_PATH_A; eRFPath NumTotalRFPath; eRFPath++) */ - for (eRFPath = 0; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { + for (eRFPath = RF_PATH_A; eRFPath < pHalData->NumTotalRFPath; eRFPath++) { pPhyReg = &pHalData->PHYRegDef[eRFPath]; @@ -135,27 +130,30 @@ phy_RF6052_Config_ParaFile( switch (eRFPath) { case RF_PATH_A: case RF_PATH_C: - u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV); + u4RegValue = phy_query_bb_reg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV); break; case RF_PATH_B: case RF_PATH_D: - u4RegValue = PHY_QueryBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16); + u4RegValue = phy_query_bb_reg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16); + break; + default: + RTW_ERR("Invalid rf_path:%d\n", eRFPath); break; } /*----Set RF_ENV enable----*/ - PHY_SetBBReg(Adapter, pPhyReg->rfintfe, bRFSI_RFENV << 16, 0x1); + phy_set_bb_reg(Adapter, pPhyReg->rfintfe, bRFSI_RFENV << 16, 0x1); rtw_udelay_os(1);/* PlatformStallExecution(1); */ /*----Set RF_ENV output high----*/ - PHY_SetBBReg(Adapter, pPhyReg->rfintfo, bRFSI_RFENV, 0x1); + phy_set_bb_reg(Adapter, pPhyReg->rfintfo, bRFSI_RFENV, 0x1); rtw_udelay_os(1);/* PlatformStallExecution(1); */ /* Set bit number of Address and Data for RF register */ - PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireAddressLength, 0x0); /* Set 1 to 4 bits for 8255 */ + phy_set_bb_reg(Adapter, pPhyReg->rfHSSIPara2, b3WireAddressLength, 0x0); /* Set 1 to 4 bits for 8255 */ rtw_udelay_os(1);/* PlatformStallExecution(1); */ - PHY_SetBBReg(Adapter, pPhyReg->rfHSSIPara2, b3WireDataLength, 0x0); /* Set 0 to 12 bits for 8255 */ + phy_set_bb_reg(Adapter, pPhyReg->rfHSSIPara2, b3WireDataLength, 0x0); /* Set 0 to 12 bits for 8255 */ rtw_udelay_os(1);/* PlatformStallExecution(1); */ /*----Initialize RF fom connfiguration file----*/ @@ -166,7 +164,7 @@ phy_RF6052_Config_ParaFile( #endif { #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) + if (odm_config_rf_with_header_file(&pHalData->odmpriv, CONFIG_RF_RADIO, eRFPath) == HAL_STATUS_FAILURE) rtStatus = _FAIL; #endif } @@ -177,7 +175,7 @@ phy_RF6052_Config_ParaFile( #endif { #ifdef CONFIG_EMBEDDED_FWIMG - if (HAL_STATUS_FAILURE == ODM_ConfigRFWithHeaderFile(&pHalData->odmpriv, CONFIG_RF_RADIO, (ODM_RF_RADIO_PATH_E)eRFPath)) + if (odm_config_rf_with_header_file(&pHalData->odmpriv, CONFIG_RF_RADIO, eRFPath) == HAL_STATUS_FAILURE) rtStatus = _FAIL; #endif } @@ -186,17 +184,23 @@ phy_RF6052_Config_ParaFile( break; case RF_PATH_D: break; + default: + RTW_ERR("Invalid rf_path:%d\n", eRFPath); + break; } /*----Restore RFENV control type----*/; switch (eRFPath) { case RF_PATH_A: case RF_PATH_C: - PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV, u4RegValue); + phy_set_bb_reg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV, u4RegValue); break; case RF_PATH_B: case RF_PATH_D: - PHY_SetBBReg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16, u4RegValue); + phy_set_bb_reg(Adapter, pPhyReg->rfintfs, bRFSI_RFENV << 16, u4RegValue); + break; + default: + RTW_ERR("Invalid rf_path:%d\n", eRFPath); break; } @@ -215,7 +219,7 @@ phy_RF6052_Config_ParaFile( #endif { #ifdef CONFIG_EMBEDDED_FWIMG - ODM_ConfigRFWithTxPwrTrackHeaderFile(&pHalData->odmpriv); + odm_config_rf_with_tx_pwr_track_header_file(&pHalData->odmpriv); #endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rxdesc.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rxdesc.c index d5d826d15cc0..10eb324da203 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rxdesc.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_rxdesc.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTL8723D_REDESC_C_ #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_sreset.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_sreset.c index 6465e227fb53..db38541a4079 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_sreset.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/rtl8723d_sreset.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTL8723D_SRESET_C_ #include @@ -28,7 +23,7 @@ void rtl8723d_sreset_xmit_status_check(_adapter *padapter) HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct sreset_priv *psrtpriv = &pHalData->srestpriv; - unsigned long current_time; + systime current_time; struct xmit_priv *pxmitpriv = &padapter->xmitpriv; unsigned int diff_time; u32 txdma_status; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_led.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_led.c index 5a2674b42269..6a7fbc709069 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_led.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_led.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,13 +11,9 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTL8723DS_LED_C_ +#ifdef CONFIG_RTW_SW_LED #include "rtl8723d_hal.h" @@ -124,3 +120,4 @@ rtl8723ds_DeInitSwLeds( DeInitLed871x(&(ledpriv->SwLed1)); #endif } +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_recv.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_recv.c index 1c5e353e1ca8..1bed99eb9f65 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_recv.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_recv.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTL8723DS_RECV_C_ #include @@ -38,9 +33,8 @@ static void freerecvbuf(struct recv_buf *precvbuf) } #ifdef CONFIG_SDIO_RX_COPY -static void rtl8723ds_recv_tasklet(void *priv) +s32 rtl8723ds_recv_hdl(_adapter *padapter) { - PADAPTER padapter; PHAL_DATA_TYPE pHalData; struct recv_priv *precvpriv; struct recv_buf *precvbuf; @@ -51,8 +45,6 @@ static void rtl8723ds_recv_tasklet(void *priv) u32 pkt_len, pkt_offset; u8 rx_report_sz = 0; - - padapter = (PADAPTER)priv; pHalData = GET_HAL_DATA(padapter); precvpriv = &padapter->recvpriv; @@ -68,13 +60,7 @@ static void rtl8723ds_recv_tasklet(void *priv) if (precvframe == NULL) { RTW_INFO("%s: no enough recv frame!\n", __FUNCTION__); rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue); - - /* The case of can't allocate recvframe should be temporary, */ - /* schedule again and hope recvframe is available next time. */ -#ifdef PLATFORM_LINUX - tasklet_schedule(&precvpriv->recv_tasklet); -#endif - return; + return RTW_RFRAME_UNAVAIL; } /* rx desc parsing */ @@ -83,7 +69,7 @@ static void rtl8723ds_recv_tasklet(void *priv) pattrib = &precvframe->u.hdr.attrib; /* fix Hardware RX data error, drop whole recv_buffer */ - if ((!(pHalData->ReceiveConfig & RCR_ACRC32)) && pattrib->crc_err) { + if (!rtw_hal_rcr_check(padapter, RCR_ACRC32) && pattrib->crc_err) { #if !(MP_DRIVER == 1) RTW_INFO("%s()-%d: RX Warning! rx CRC ERROR !!\n", __FUNCTION__, __LINE__); #endif @@ -116,7 +102,7 @@ static void rtl8723ds_recv_tasklet(void *priv) } else { #ifdef CONFIG_RX_PACKET_APPEND_FCS if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE) - if ((pattrib->pkt_rpt_type == NORMAL_RX) && (pHalData->ReceiveConfig & RCR_APPFCS)) + if ((pattrib->pkt_rpt_type == NORMAL_RX) && rtw_hal_rcr_check(padapter, RCR_APPFCS)) pattrib->pkt_len -= IEEE80211_FCS_LEN; #endif @@ -131,7 +117,7 @@ static void rtl8723ds_recv_tasklet(void *priv) ptr += RXDESC_SIZE; /* update drv info */ - if (pHalData->ReceiveConfig & RCR_APP_BA_SSN) { + if (rtw_hal_rcr_check(padapter, RCR_APP_BA_SSN)) { /* rtl8723s_update_bassn(padapter, pdrvinfo); */ ptr += 4; } @@ -144,14 +130,8 @@ static void rtl8723ds_recv_tasklet(void *priv) break; } -#ifdef CONFIG_CONCURRENT_MODE - pre_recv_entry(precvframe, ptr); -#endif + pre_recv_entry(precvframe, pattrib->physt ? ptr : NULL); - if (pattrib->physt) - rx_query_phy_status(precvframe, ptr); - - rtw_recv_entry(precvframe); } else { #ifdef CONFIG_FW_C2H_PKT if (pattrib->pkt_rpt_type == C2H_PACKET) @@ -174,6 +154,41 @@ static void rtl8723ds_recv_tasklet(void *priv) rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); } while (1); +#ifdef CONFIG_RTW_NAPI +#ifdef CONFIG_RTW_NAPI_V2 + if (padapter->registrypriv.en_napi) { + struct dvobj_priv *d; + struct _ADAPTER *a; + u8 i; + + d = adapter_to_dvobj(padapter); + for (i = 0; i < d->iface_nums; i++) { + a = d->padapters[i]; + if (rtw_if_up(a) == _TRUE) + napi_schedule(&a->napi); + + } + } +#endif /* CONFIG_RTW_NAPI_V2 */ +#endif /* CONFIG_RTW_NAPI */ + + return _SUCCESS; +} + +static void rtl8723ds_recv_tasklet(void *priv) +{ + _adapter *adapter = (_adapter *)priv; + s32 ret; + + ret = rtl8723ds_recv_hdl(adapter); + if (ret == RTW_RFRAME_UNAVAIL + || ret == RTW_RFRAME_PKT_UNAVAIL + ) { + /* schedule again and hope recvframe/packet is available next time. */ + #ifdef PLATFORM_LINUX + tasklet_schedule(&adapter->recvpriv.recv_tasklet); + #endif + } } #else static void rtl8723ds_recv_tasklet(void *priv) @@ -246,7 +261,7 @@ static void rtl8723ds_recv_tasklet(void *priv) #endif /* fix Hardware RX data error, drop whole recv_buffer */ - if ((!(pHalData->ReceiveConfig & RCR_ACRC32)) && pattrib->crc_err) { + if (!rtw_hal_rcr_check(padapter, RCR_ACRC32) && pattrib->crc_err) { RTW_INFO("%s()-%d: RX Warning! rx CRC ERROR !!\n", __FUNCTION__, __LINE__); rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue); break; @@ -302,7 +317,7 @@ static void rtl8723ds_recv_tasklet(void *priv) #ifdef CONFIG_RX_PACKET_APPEND_FCS if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE) { - if ((pattrib->pkt_rpt_type == NORMAL_RX) && (pHalData->ReceiveConfig & RCR_APPFCS)) { + if ((pattrib->pkt_rpt_type == NORMAL_RX) && rtw_hal_rcr_check(padapter, RCR_APPFCS)) { recvframe_pull_tail(precvframe, IEEE80211_FCS_LEN); pattrib->pkt_len -= IEEE80211_FCS_LEN; ppkt->len = pattrib->pkt_len; @@ -314,21 +329,14 @@ static void rtl8723ds_recv_tasklet(void *priv) ptr += RXDESC_SIZE; /* update drv info */ - if (pHalData->ReceiveConfig & RCR_APP_BA_SSN) { + if (rtw_hal_rcr_check(padapter, RCR_APP_BA_SSN)) { /* rtl8723s_update_bassn(padapter, pdrvinfo); */ ptr += 4; } - if (pattrib->pkt_rpt_type == NORMAL_RX) { -#ifdef CONFIG_CONCURRENT_MODE - pre_recv_entry(precvframe, ptr); -#endif /*CONFIG_CONCURRENT_MODE*/ - - if (pattrib->physt) - rx_query_phy_status(precvframe, ptr); - - rtw_recv_entry(precvframe); - } else { + if (pattrib->pkt_rpt_type == NORMAL_RX) + pre_recv_entry(precvframe, pattrib->physt ? ptr : NULL); + else { #ifdef CONFIG_FW_C2H_PKT if (pattrib->pkt_rpt_type == C2H_PACKET) rtw_hal_c2h_pkt_pre_hdl(padapter, precvframe->u.hdr.rx_data, pattrib->pkt_len); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_xmit.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_xmit.c index 3e50b0019fb1..fe31d6f5ea1b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_xmit.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/rtl8723ds_xmit.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RTL8723DS_XMIT_C_ #include @@ -206,6 +201,10 @@ s32 rtl8723ds_xmit_buf_handler(PADAPTER padapter) } if (RTW_CANNOT_RUN(padapter)) { + RTW_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", + FUNC_ADPT_ARG(padapter), + rtw_is_drv_stopped(padapter) ? "True" : "False", + rtw_is_surprise_removed(padapter) ? "True" : "False"); return _FAIL; } @@ -364,7 +363,7 @@ static s32 xmit_xmitframes(PADAPTER padapter, struct xmit_priv *pxmitpriv) /* ok to send, remove frame from queue */ #ifdef CONFIG_AP_MODE - if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { if ((pxmitframe->attrib.psta->state & WIFI_SLEEP_STATE) && (pxmitframe->attrib.triggered == 0)) { RTW_INFO("%s: one not triggered pkt in queue when this STA sleep, break and goto next sta\n", __func__); @@ -474,6 +473,10 @@ s32 rtl8723ds_xmit_handler(PADAPTER padapter) next: if (RTW_CANNOT_RUN(padapter)) { + RTW_DBG(FUNC_ADPT_FMT "- bDriverStopped(%s) bSurpriseRemoved(%s)\n", + FUNC_ADPT_ARG(padapter), + rtw_is_drv_stopped(padapter) ? "True" : "False", + rtw_is_surprise_removed(padapter) ? "True" : "False"); return _FAIL; } @@ -530,20 +533,16 @@ thread_return rtl8723ds_xmit_thread(thread_context context) RTW_INFO("start "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); - /* For now, no one would down sema to check thread is running, */ - /* so mark this temporary, Lucas@20130820 - * _rtw_up_sema(&pxmitpriv->SdioXmitTerminateSema); */ - do { ret = rtl8723ds_xmit_handler(padapter); - if (signal_pending(current)) - flush_signals(current); + flush_signals_thread(); } while (_SUCCESS == ret); - _rtw_up_sema(&pxmitpriv->SdioXmitTerminateSema); + RTW_INFO(FUNC_ADPT_FMT " Exit\n", FUNC_ADPT_ARG(padapter)); + rtw_thread_wait_stop(); - thread_exit(); + return 0; } s32 rtl8723ds_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe) @@ -574,7 +573,7 @@ s32 rtl8723ds_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe) pxmitbuf->priv_data = NULL; - if (GetFrameSubType(pframe) == WIFI_BEACON || + if (get_frame_sub_type(pframe) == WIFI_BEACON || pxmitbuf->buf_tag == XMITBUF_CMD) { #ifdef CONFIG_LPS_POFF @@ -677,8 +676,6 @@ s32 rtl8723ds_init_xmit_priv(PADAPTER padapter) _rtw_spinlock_init(&phal->SdioTxFIFOFreePageLock); _rtw_init_sema(&xmitpriv->SdioXmitSema, 0); - _rtw_init_sema(&xmitpriv->SdioXmitTerminateSema, 0); - return _SUCCESS; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_halinit.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_halinit.c index 74cb7d793bbd..e1fb78b8794c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_halinit.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_halinit.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _SDIO_HALINIT_C_ #include @@ -149,31 +144,20 @@ u32 _InitPowerOn_8723DS(PADAPTER padapter) } RTW_INFO("Power on Fail! do it again\n"); goto _init_power_on; + } else { + /* MAC team suggest to keep ana clock at 12MHz 0x04[22] = 1 */ + value8 = rtw_read8(padapter, REG_APS_FSMCO + 2); + value8 |= BIT(6); + rtw_write8(padapter, REG_APS_FSMCO + 2, value8); } -#ifdef CONFIG_BT_COEXIST - rtw_btcoex_PowerOnSetting(padapter); + value8 = rtw_read8(padapter, REG_SYS_CFG1_8723D + 1); + RTW_INFO("%s: %s\n", __func__, + (value8 & BIT3) ? "Test Mode" : "Normal Mode"); - /* external switch to S1 */ - /* 0x38[11] = 0x1 */ - /* 0x4c[23] = 0x1 */ - /* 0x64[0] = 0 */ - value16 = rtw_read16(padapter, REG_PWR_DATA); - /* Switch the control of EESK, EECS to RFC for DPDT or Antenna switch */ - value16 |= BIT(11); /* BIT_EEPRPAD_RFE_CTRL_EN */ - rtw_write16(padapter, REG_PWR_DATA, value16); - /* RTW_INFO("%s: REG_PWR_DATA(0x%x)=0x%04X\n", __FUNCTION__, REG_PWR_DATA, rtw_read16(padapter, REG_PWR_DATA)); */ - - value32 = rtw_read32(padapter, REG_LEDCFG0); - value32 |= BIT(23); /* DPDT_SEL_EN, 1 for SW control */ - rtw_write32(padapter, REG_LEDCFG0, value32); - /* RTW_INFO("%s: REG_LEDCFG0(0x%x)=0x%08X\n", __FUNCTION__, REG_LEDCFG0, rtw_read32(padapter, REG_LEDCFG0)); */ - - value8 = rtw_read8(padapter, REG_PAD_CTRL1_8723D); - value8 &= ~BIT(0); /* BIT_SW_DPDT_SEL_DATA, DPDT_SEL default configuration */ - rtw_write8(padapter, REG_PAD_CTRL1_8723D, value8); - /* RTW_INFO("%s: REG_PAD_CTRL1(0x%x)=0x%02X\n", __FUNCTION__, REG_PAD_CTRL1_8723D, rtw_read8(padapter, REG_PAD_CTRL1_8723D)); */ -#endif /* CONFIG_BT_COEXIST */ + value8 = rtw_read8(padapter, REG_SYS_CFG1_8723D + 3); + RTW_INFO("%s: %s\n", __func__, + (value8 & BIT0) ? "LDO Mode" : "SPS Mode"); return _SUCCESS; } @@ -473,20 +457,21 @@ void _InitWMACSetting(PADAPTER padapter) { PHAL_DATA_TYPE pHalData; u16 value16; - + u32 rcr; pHalData = GET_HAL_DATA(padapter); - pHalData->ReceiveConfig = 0; - pHalData->ReceiveConfig |= RCR_APM | RCR_AM | RCR_AB; - pHalData->ReceiveConfig |= RCR_CBSSID_DATA | RCR_CBSSID_BCN | RCR_AMF; - pHalData->ReceiveConfig |= RCR_HTC_LOC_CTRL; - pHalData->ReceiveConfig |= RCR_APP_PHYST_RXFF | RCR_APP_ICV | RCR_APP_MIC; -#ifdef CONFIG_MAC_LOOPBACK_DRIVER - pHalData->ReceiveConfig |= RCR_AAP; - pHalData->ReceiveConfig |= RCR_ADD3 | RCR_APWRMGT | RCR_ACRC32 | RCR_ADF; -#endif - rtw_write32(padapter, REG_RCR, pHalData->ReceiveConfig); + rcr = 0 + | RCR_APM | RCR_AM | RCR_AB + | RCR_CBSSID_DATA | RCR_CBSSID_BCN | RCR_AMF + | RCR_HTC_LOC_CTRL + | RCR_APP_PHYST_RXFF | RCR_APP_ICV | RCR_APP_MIC + #ifdef CONFIG_MAC_LOOPBACK_DRIVER + | RCR_AAP + | RCR_ADD3 | RCR_APWRMGT | RCR_ACRC32 | RCR_ADF + #endif + ; + rtw_hal_set_hwreg(padapter, HW_VAR_RCR, (u8 *)&rcr); /* Accept all multicast address */ rtw_write32(padapter, REG_MAR, 0xFFFFFFFF); @@ -526,7 +511,7 @@ void _InitAdaptiveCtrl(PADAPTER padapter) rtw_write16(padapter, REG_SPEC_SIFS, value16); /* Retry Limit */ - value16 = _LRL(0x30) | _SRL(0x30); + value16 = _LRL(RL_VAL_STA) | _SRL(RL_VAL_STA); rtw_write16(padapter, REG_RL, value16); } @@ -549,16 +534,6 @@ void _InitEDCA(PADAPTER padapter) rtw_write32(padapter, REG_EDCA_VO_PARAM, 0x002FA226); } -void _InitRateFallback(PADAPTER padapter) -{ - /* Set Data Auto Rate Fallback Retry Count register. */ - rtw_write32(padapter, REG_DARFRC, 0x00000000); - rtw_write32(padapter, REG_DARFRC + 4, 0x10080404); - rtw_write32(padapter, REG_RARFRC, 0x04030201); - rtw_write32(padapter, REG_RARFRC + 4, 0x08070605); - -} - void _InitRetryFunction(PADAPTER padapter) { u8 value8; @@ -656,78 +631,6 @@ static void _RXAggrSwitch(PADAPTER padapter, u8 enable) rtw_write8(padapter, REG_RXDMA_MODE_CTRL_8723D, valueRxAggCtrl); } -void _InitOperationMode(PADAPTER padapter) -{ - PHAL_DATA_TYPE pHalData; - struct mlme_ext_priv *pmlmeext; - u8 regBwOpMode = 0; - u32 regRATR = 0, regRRSR = 0; - u8 MinSpaceCfg = 0; - - - pHalData = GET_HAL_DATA(padapter); - pmlmeext = &padapter->mlmeextpriv; - - /* 1 This part need to modified according to the rate set we filtered!! */ - /* */ - /* Set RRSR, RATR, and REG_BWOPMODE registers */ - /* */ - switch (pmlmeext->cur_wireless_mode) { - case WIRELESS_MODE_B: - regBwOpMode = BW_OPMODE_20MHZ; - regRATR = RATE_ALL_CCK; - regRRSR = RATE_ALL_CCK; - break; - case WIRELESS_MODE_A: - /* RT_ASSERT(FALSE,("Error wireless a mode\n")); */ -#if 0 - regBwOpMode = BW_OPMODE_5G | BW_OPMODE_20MHZ; - regRATR = RATE_ALL_OFDM_AG; - regRRSR = RATE_ALL_OFDM_AG; -#endif - break; - case WIRELESS_MODE_G: - regBwOpMode = BW_OPMODE_20MHZ; - regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - break; - case WIRELESS_MODE_AUTO: -#if 0 - if (padapter->bInHctTest) { - regBwOpMode = BW_OPMODE_20MHZ; - regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - } else -#endif - { - regBwOpMode = BW_OPMODE_20MHZ; - regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; - regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - } - break; - case WIRELESS_MODE_N_24G: - /* It support CCK rate by default. */ - /* CCK rate will be filtered out only when associated AP does not support it. */ - regBwOpMode = BW_OPMODE_20MHZ; - regRATR = RATE_ALL_CCK | RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; - regRRSR = RATE_ALL_CCK | RATE_ALL_OFDM_AG; - break; - case WIRELESS_MODE_N_5G: - /* RT_ASSERT(FALSE,("Error wireless mode")); */ -#if 0 - regBwOpMode = BW_OPMODE_5G; - regRATR = RATE_ALL_OFDM_AG | RATE_ALL_OFDM_1SS | RATE_ALL_OFDM_2SS; - regRRSR = RATE_ALL_OFDM_AG; -#endif - break; - - default: /* for MacOSX compiler warning. */ - break; - } - - rtw_write8(padapter, REG_BWOPMODE, regBwOpMode); - -} void _InitInterrupt(PADAPTER padapter) { @@ -776,8 +679,8 @@ static void _BBTurnOnBlock(PADAPTER padapter) return; #endif - PHY_SetBBReg(padapter, rFPGA0_RFMOD, bCCKEn, 0x1); - PHY_SetBBReg(padapter, rFPGA0_RFMOD, bOFDMEn, 0x1); + phy_set_bb_reg(padapter, rFPGA0_RFMOD, bCCKEn, 0x1); + phy_set_bb_reg(padapter, rFPGA0_RFMOD, bOFDMEn, 0x1); } static void _RfPowerSave(PADAPTER padapter) @@ -804,10 +707,10 @@ static void _InitPABias(PADAPTER padapter) if (!(pa_setting & BIT(0))) { - PHY_SetRFReg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0x0F406); - PHY_SetRFReg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0x4F406); - PHY_SetRFReg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0x8F406); - PHY_SetRFReg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0xCF406); + phy_set_rf_reg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0x0F406); + phy_set_rf_reg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0x4F406); + phy_set_rf_reg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0x8F406); + phy_set_rf_reg(padapter, RF_PATH_A, 0x15, 0x0FFFFF, 0xCF406); } if (!(pa_setting & BIT(4))) { @@ -826,28 +729,28 @@ VOID _InitBBRegBackup_8723DS(PADAPTER Adapter) /* For Channel 1~11 (Default Value)*/ pHalData->RegForRecover[0].offset = rCCK0_TxFilter2; pHalData->RegForRecover[0].value = - PHY_QueryBBReg(Adapter, + phy_query_bb_reg(Adapter, pHalData->RegForRecover[0].offset, bMaskDWord); pHalData->RegForRecover[1].offset = rCCK0_DebugPort; pHalData->RegForRecover[1].value = - PHY_QueryBBReg(Adapter, + phy_query_bb_reg(Adapter, pHalData->RegForRecover[1].offset, bMaskDWord); pHalData->RegForRecover[2].offset = 0xAAC; pHalData->RegForRecover[2].value = - PHY_QueryBBReg(Adapter, + phy_query_bb_reg(Adapter, pHalData->RegForRecover[2].offset, bMaskDWord); #if 0 /* For 20 MHz (Default Value)*/ pHalData->RegForRecover[2].offset = rBBrx_DFIR; - pHalData->RegForRecover[2].value = PHY_QueryBBReg(Adapter, pHalData->RegForRecover[2].offset, bMaskDWord); + pHalData->RegForRecover[2].value = phy_query_bb_reg(Adapter, pHalData->RegForRecover[2].offset, bMaskDWord); pHalData->RegForRecover[3].offset = rOFDM0_XATxAFE; - pHalData->RegForRecover[3].value = PHY_QueryBBReg(Adapter, pHalData->RegForRecover[3].offset, bMaskDWord); + pHalData->RegForRecover[3].value = phy_query_bb_reg(Adapter, pHalData->RegForRecover[3].offset, bMaskDWord); pHalData->RegForRecover[4].offset = 0x1E; - pHalData->RegForRecover[4].value = PHY_QueryRFReg(Adapter, ODM_RF_PATH_A, pHalData->RegForRecover[4].offset, bRFRegOffsetMask); + pHalData->RegForRecover[4].value = phy_query_rf_reg(Adapter, RF_PATH_A, pHalData->RegForRecover[4].offset, bRFRegOffsetMask); #endif } @@ -933,7 +836,7 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) #elif defined(CONFIG_FWLPS_IN_IPS) if (adapter_to_pwrctl(padapter)->bips_processing == _TRUE && psrtpriv->silent_reset_inprogress == _FALSE && adapter_to_pwrctl(padapter)->pre_ips_type == 0) { - u32 start_time; + systime start_time; u8 cpwm_orig, cpwm_now; u8 val8, bMacPwrCtrlOn = _TRUE; @@ -973,7 +876,7 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) } } while (1); - rtl8723d_set_FwPwrModeInIPS_cmd(padapter, _FALSE); + rtw_set_fw_in_ips_mode(padapter, 0); rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn); @@ -1020,20 +923,19 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) rtw_write8(padapter, REG_EARLY_MODE_CONTROL, 0); - if ((padapter->registrypriv.mp_mode == 0 && - psdpriv->processing_dev_remove == _FALSE) + if (padapter->registrypriv.mp_mode == 0 #if defined(CONFIG_MP_INCLUDED) && defined(CONFIG_RTW_CUSTOMER_STR) || padapter->registrypriv.mp_customer_str #endif ) { ret = rtl8723d_FirmwareDownload(padapter, _FALSE); if (ret != _SUCCESS) { - padapter->bFWReady = _FALSE; + pHalData->bFWReady = _FALSE; pHalData->fw_ractrl = _FALSE; return ret; } /*else*/ { - padapter->bFWReady = _TRUE; + pHalData->bFWReady = _TRUE; pHalData->fw_ractrl = _TRUE; } } @@ -1052,7 +954,7 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) /* Save target channel */ /* Current Channel will be updated again later. */ - pHalData->CurrentChannel = 6; + pHalData->current_channel = 6; #if (HAL_MAC_ENABLE == 1) ret = PHY_MACConfig8723D(padapter); @@ -1090,8 +992,8 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) /* */ /* Joseph Note: Keep RfRegChnlVal for later use. */ /* */ - pHalData->RfRegChnlVal[0] = PHY_QueryRFReg(padapter, (RF_PATH)0, RF_CHNLBW, bRFRegOffsetMask); - pHalData->RfRegChnlVal[1] = PHY_QueryRFReg(padapter, (RF_PATH)1, RF_CHNLBW, bRFRegOffsetMask); + pHalData->RfRegChnlVal[0] = phy_query_rf_reg(padapter, RF_PATH_A, RF_CHNLBW, bRFRegOffsetMask); + pHalData->RfRegChnlVal[1] = phy_query_rf_reg(padapter, RF_PATH_B, RF_CHNLBW, bRFRegOffsetMask); #ifdef CONFIG_DLFW_TXPKT /* Specially add for FWDL by Tx pkt write. @@ -1121,10 +1023,8 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) _InitWMACSetting(padapter); _InitAdaptiveCtrl(padapter); _InitEDCA(padapter); - /* _InitRateFallback(padapter); */ _InitRetryFunction(padapter); _initSdioAggregationSetting(padapter); - _InitOperationMode(padapter); rtl8723d_InitBeaconParameters(padapter); rtl8723d_InitBeaconMaxError(padapter, _TRUE); _InitInterrupt(padapter); @@ -1197,7 +1097,7 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) rtl8723d_InitHalDm(padapter); - /* DbgPrint("pHalData->DefaultTxPwrDbm = %d\n", pHalData->DefaultTxPwrDbm); */ + /* dbg_print("pHalData->DefaultTxPwrDbm = %d\n", pHalData->DefaultTxPwrDbm); */ #if 0 if (pHalData->SwBeaconType < HAL92CSDIO_DEFAULT_BEACON_TYPE) /* The lowest Beacon Type that HW can support */ @@ -1227,17 +1127,16 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) #if (MP_DRIVER == 1) if (padapter->registrypriv.mp_mode == 1) { - padapter->mppriv.channel = pHalData->CurrentChannel; + padapter->mppriv.channel = pHalData->current_channel; MPT_InitializeAdapter(padapter, padapter->mppriv.channel); } else #endif /* #if (MP_DRIVER == 1) */ { pwrctrlpriv->rf_pwrstate = rf_on; - if (pwrctrlpriv->rf_pwrstate == rf_on && - psdpriv->processing_dev_remove == _FALSE) { + if (pwrctrlpriv->rf_pwrstate == rf_on) { struct pwrctrl_priv *pwrpriv; - u32 start_time; + systime start_time; u8 h2cCmdBuf; pwrpriv = adapter_to_pwrctl(padapter); @@ -1257,10 +1156,8 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) #ifdef CONFIG_BT_COEXIST rtw_btcoex_IQKNotify(padapter, _TRUE); #endif - pHalData->odmpriv.nIQK_Cnt = 0; - pHalData->odmpriv.nIQK_OK_Cnt = 0; - pHalData->odmpriv.nIQK_Fail_Cnt = 0; - PHY_IQCalibrate_8723D(padapter, _FALSE); + /*phy_iq_calibrate_8723d(padapter, _FALSE);*/ + halrf_iqk_trigger(&pHalData->odmpriv, _FALSE); pHalData->bIQKInitialized = _TRUE; #ifdef CONFIG_BT_COEXIST rtw_btcoex_IQKNotify(padapter, _FALSE); @@ -1270,7 +1167,7 @@ static u32 rtl8723ds_hal_init(PADAPTER padapter) h2cCmdBuf = 0; FillH2CCmd8723D(padapter, H2C_8723D_BT_WLAN_CALIBRATION, 1, &h2cCmdBuf); - ODM_TXPowerTrackingCheck(&pHalData->odmpriv); + odm_txpowertracking_check(&pHalData->odmpriv); } } @@ -1302,7 +1199,7 @@ static void CardDisableRTL8723DSdio(PADAPTER padapter) /* ==== Reset digital sequence ====== */ u1bTmp = rtw_read8(padapter, REG_MCUFWDL); - if ((u1bTmp & RAM_DL_SEL) && padapter->bFWReady) /* 8051 RAM code */ + if ((u1bTmp & RAM_DL_SEL) && GET_HAL_DATA(padapter)->bFWReady) /* 8051 RAM code */ rtl8723d_FirmwareSelfReset(padapter); /* Reset MCU 0x2[10]=0. Suggested by Filen. 2011.01.26. by tynli. */ @@ -1331,7 +1228,7 @@ static void CardDisableRTL8723DSdio(PADAPTER padapter) if (ret == _FALSE) RTW_INFO(KERN_ERR "%s: run CARD DISABLE flow fail!\n", __func__); - padapter->bFWReady = _FALSE; + GET_HAL_DATA(padapter)->bFWReady = _FALSE; } static u32 rtl8723ds_hal_deinit(PADAPTER padapter) @@ -1376,7 +1273,7 @@ static u32 rtl8723ds_hal_deinit(PADAPTER padapter) RTW_INFO("%s: issue H2C to FW when entering IPS\n", __FUNCTION__); - rtl8723d_set_FwPwrModeInIPS_cmd(padapter, _TRUE); + rtw_set_fw_in_ips_mode(padapter, 0x1); /* poll 0x1cc to make sure H2C command already finished by FW; MAC_0x1cc=0 means H2C done by FW. */ do { val8 = rtw_read8(padapter, REG_HMETFR); @@ -1533,14 +1430,14 @@ _ReadRFType( pHalData->BandSet = BAND_ON_2_4G; } -static VOID +static u8 _ReadEfuseInfo8723DS( IN PADAPTER padapter ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); - u8 *hwinfo = NULL; - + u8 *hwinfo = NULL; + u8 ret = _FAIL; /* */ /* This part read and parse the eeprom/efuse content */ @@ -1579,17 +1476,27 @@ _ReadEfuseInfo8723DS( Hal_ReadRFGainOffset(padapter, hwinfo, pHalData->bautoload_fail_flag); #endif /* CONFIG_RF_GAIN_OFFSET */ + /* set coex. ant info once efuse parsing is done */ + rtw_btcoex_set_ant_info(padapter); + #ifdef CONFIG_RTW_MAC_HIDDEN_RPT - hal_read_mac_hidden_rpt(padapter); + if (hal_read_mac_hidden_rpt(padapter) != _SUCCESS) + goto exit; #endif + + ret = _SUCCESS; + +exit: + return ret; } -static void _ReadPROMContent( +static u8 _ReadPROMContent( IN PADAPTER padapter ) { PHAL_DATA_TYPE pHalData = GET_HAL_DATA(padapter); u8 eeValue; + u8 ret = _FAIL; eeValue = rtw_read8(padapter, REG_9346CR); /* To check system boot selection. */ @@ -1599,7 +1506,13 @@ static void _ReadPROMContent( /* pHalData->EEType = IS_BOOT_FROM_EEPROM(Adapter) ? EEPROM_93C46 : EEPROM_BOOT_EFUSE; */ - _ReadEfuseInfo8723DS(padapter); + if (_ReadEfuseInfo8723DS(padapter) != _SUCCESS) + goto exit; + + ret = _SUCCESS; + +exit: + return ret; } static VOID @@ -1629,9 +1542,10 @@ _InitOtherVariable( * PASSIVE_LEVEL (SDIO interface) * * */ -static void ReadAdapterInfo8723DS(PADAPTER padapter) +static u8 ReadAdapterInfo8723DS(PADAPTER padapter) { u8 val8; + u8 ret = _FAIL; val8 = rtw_read8(padapter, 0x4e); RTW_INFO("%s, 0x4e=0x%x\n", __func__, val8); @@ -1643,7 +1557,9 @@ static void ReadAdapterInfo8723DS(PADAPTER padapter) _EfuseCellSel(padapter); _ReadRFType(padapter); - _ReadPROMContent(padapter); + if (_ReadPROMContent(padapter) != _SUCCESS) + goto exit; + _InitOtherVariable(padapter); #ifdef CONFIG_PLATFORM_INTEL_BYT @@ -1659,17 +1575,20 @@ static void ReadAdapterInfo8723DS(PADAPTER padapter) } #endif /* CONFIG_PLATFORM_INTEL_BYT */ - if (!rtw_is_hw_init_completed(padapter)) - rtw_write8(padapter, 0x67, 0x00); /* for BT, Switch Ant control to BT */ + ret = _SUCCESS; + +exit: + return ret; } /* * If variable not handled here, * some variables will be processed in SetHwReg8723D() */ -void SetHwReg8723DS(PADAPTER padapter, u8 variable, u8 *val) +u8 SetHwReg8723DS(PADAPTER padapter, u8 variable, u8 *val) { PHAL_DATA_TYPE pHalData; + u8 ret = _SUCCESS; u8 val8; @@ -1710,9 +1629,6 @@ void SetHwReg8723DS(PADAPTER padapter, u8 variable, u8 *val) /* _RXAggrSwitch(padapter, _FALSE); */ } break; - case HW_VAR_DM_IN_LPS: - rtl8723d_hal_dm_in_lps(padapter); - break; #ifdef CONFIG_GPIO_WAKEUP case HW_SET_GPIO_WL_CTRL: { u8 enable = *val; @@ -1753,10 +1669,11 @@ void SetHwReg8723DS(PADAPTER padapter, u8 variable, u8 *val) break; #endif default: - SetHwReg8723D(padapter, variable, val); + ret = SetHwReg8723D(padapter, variable, val); break; } + return ret; } /* @@ -1817,6 +1734,8 @@ GetHalDefVar8723DSDIO( else *(HT_CAP_AMPDU_FACTOR *)pValue = MAX_AMPDU_FACTOR_16K; break; + *(HT_CAP_AMPDU_FACTOR *)pValue = MAX_AMPDU_FACTOR_16K; + break; default: bResult = GetHalDefVar8723D(Adapter, eVariable, pValue); break; @@ -1850,7 +1769,7 @@ SetHalDefVar8723DSDIO( void rtl8723ds_set_hal_ops(PADAPTER padapter) { - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; rtl8723d_set_hal_ops(pHalFunc); @@ -1867,10 +1786,13 @@ void rtl8723ds_set_hal_ops(PADAPTER padapter) pHalFunc->init_recv_priv = &rtl8723ds_init_recv_priv; pHalFunc->free_recv_priv = &rtl8723ds_free_recv_priv; - +#ifdef CONFIG_RECV_THREAD_MODE + pHalFunc->recv_hdl = rtl8723ds_recv_hdl; +#endif /* CONFIG_RECV_THREAD_MODE */ +#ifdef CONFIG_RTW_SW_LED pHalFunc->InitSwLeds = &rtl8723ds_InitSwLeds; pHalFunc->DeInitSwLeds = &rtl8723ds_DeInitSwLeds; - +#endif pHalFunc->init_default_value = &rtl8723ds_init_default_value; pHalFunc->intf_chip_configure = &rtl8723ds_interface_configure; pHalFunc->read_adapter_info = &ReadAdapterInfo8723DS; @@ -1881,9 +1803,9 @@ void rtl8723ds_set_hal_ops(PADAPTER padapter) #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) pHalFunc->clear_interrupt = &ClearInterrupt8723DSdio; #endif - pHalFunc->SetHwRegHandler = &SetHwReg8723DS; + pHalFunc->set_hw_reg_handler = &SetHwReg8723DS; pHalFunc->GetHwRegHandler = &GetHwReg8723DS; - pHalFunc->GetHalDefVarHandler = &GetHalDefVar8723DSDIO; + pHalFunc->get_hal_def_var_handler = &GetHalDefVar8723DSDIO; pHalFunc->SetHalDefVarHandler = &SetHalDefVar8723DSDIO; pHalFunc->hal_xmit = &rtl8723ds_hal_xmit; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_ops.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_ops.c index 8a400504e386..96aef43424b7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_ops.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/hal/rtl8723d/sdio/sdio_ops.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #define _SDIO_OPS_C_ #include @@ -1085,7 +1081,7 @@ void InitSysInterrupt8723DSdio(PADAPTER padapter) 0); } -#ifdef CONFIG_WOWLAN +#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) /* * Description: * Clear corresponding SDIO Host ISR interrupt service. @@ -1313,13 +1309,15 @@ static void sd_recv_loopback(PADAPTER padapter, u32 size) #endif /* CONFIG_MAC_LOOPBACK_DRIVER */ #ifdef CONFIG_SDIO_RX_COPY -static struct recv_buf *sd_recv_rxfifo(PADAPTER padapter, u32 size) +static u32 sd_recv_rxfifo(PADAPTER padapter, u32 size, + struct recv_buf **recvbuf_ret) { u32 readsize, ret; u8 *preadbuf; struct recv_priv *precvpriv; struct recv_buf *precvbuf; + *recvbuf_ret = NULL; #if 0 readsize = size; @@ -1333,8 +1331,9 @@ static struct recv_buf *sd_recv_rxfifo(PADAPTER padapter, u32 size) precvpriv = &padapter->recvpriv; precvbuf = rtw_dequeue_recvbuf(&precvpriv->free_recv_buf_queue); if (precvbuf == NULL) { - RTW_ERR("%s: alloc recvbuf FAIL!\n", __func__); - return NULL; + RTW_INFO("%s: recvbuf unavailable\n", __func__); + ret = RTW_RBUF_UNAVAIL; + goto exit; } /* 3 2. alloc skb */ @@ -1346,7 +1345,8 @@ static struct recv_buf *sd_recv_rxfifo(PADAPTER padapter, u32 size) if (precvbuf->pskb == NULL) { RTW_INFO("%s: alloc_skb fail! read=%d\n", __func__, readsize); rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); - return NULL; + ret = RTW_RBUF_PKT_UNAVAIL; + goto exit; } precvbuf->pskb->dev = padapter->pnetdev; @@ -1362,7 +1362,7 @@ static struct recv_buf *sd_recv_rxfifo(PADAPTER padapter, u32 size) ret = sdio_read_port(&padapter->iopriv.intf, WLAN_RX0FF_DEVICE_ID, readsize, preadbuf); if (ret == _FAIL) { rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue); - return NULL; + goto exit; } /* 3 4. init recvbuf */ @@ -1373,7 +1373,9 @@ static struct recv_buf *sd_recv_rxfifo(PADAPTER padapter, u32 size) precvbuf->ptail = skb_tail_pointer(precvbuf->pskb); precvbuf->pend = skb_end_pointer(precvbuf->pskb); - return precvbuf; + *recvbuf_ret = precvbuf; +exit: + return ret; } #else /* !CONFIG_SDIO_RX_COPY */ static struct recv_buf *sd_recv_rxfifo(PADAPTER padapter, u32 size) @@ -1451,10 +1453,14 @@ static void sd_rxhandler(PADAPTER padapter, struct recv_buf *precvbuf) /* 3 1. enqueue recvbuf */ rtw_enqueue_recvbuf(precvbuf, ppending_queue); - /* 3 2. schedule tasklet */ -#ifdef PLATFORM_LINUX + /* 3 2. trigger recv hdl */ +#ifdef CONFIG_RECV_THREAD_MODE + _rtw_up_sema(&precvpriv->recv_sema); +#else + #ifdef PLATFORM_LINUX tasklet_schedule(&precvpriv->recv_tasklet); -#endif + #endif /* PLATFORM_LINUX */ +#endif /* CONFIG_RECV_THREAD_MODE */ } void sd_int_dpc(PADAPTER padapter) @@ -1490,9 +1496,7 @@ void sd_int_dpc(PADAPTER padapter) struct reportpwrstate_parm report; #ifdef CONFIG_LPS_RPWM_TIMER - u8 bcancelled; - - _cancel_timer(&(pwrctl->pwr_rpwm_timer), &bcancelled); + _cancel_timer_ex(&(pwrctl->pwr_rpwm_timer)); #endif /* CONFIG_LPS_RPWM_TIMER */ report.state = SdioLocalCmd52Read1Byte(padapter, SDIO_REG_HCPWM1_8723D); @@ -1540,7 +1544,7 @@ void sd_int_dpc(PADAPTER padapter) if (phal->sdio_hisr & SDIO_HISR_RX_REQUEST) { struct recv_buf *precvbuf; int alloc_fail_time = 0; - u32 hisr; + u32 hisr = 0, rx_cnt = 0, ret = 0; phal->sdio_hisr ^= SDIO_HISR_RX_REQUEST; do { @@ -1549,16 +1553,22 @@ void sd_int_dpc(PADAPTER padapter) #ifdef CONFIG_MAC_LOOPBACK_DRIVER sd_recv_loopback(padapter, phal->SdioRxFIFOSize); #else - precvbuf = sd_recv_rxfifo(padapter, phal->SdioRxFIFOSize); - if (precvbuf) + ret = sd_recv_rxfifo(padapter, phal->SdioRxFIFOSize, &precvbuf); + if (precvbuf) { sd_rxhandler(padapter, precvbuf); - else { + phal->SdioRxFIFOSize = 0; + rx_cnt++; + } else { alloc_fail_time++; - RTW_INFO("%s: recv fail!(time=%d)\n", __func__, alloc_fail_time); - if (alloc_fail_time >= 10) + if (ret == RTW_RBUF_UNAVAIL || ret == RTW_RBUF_PKT_UNAVAIL) + rtw_msleep_os(10); + else { + RTW_INFO("%s: recv fail!(time=%d)\n", __func__, alloc_fail_time); + phal->SdioRxFIFOSize = 0; + } + if (alloc_fail_time >= 10 && rx_cnt != 0) break; } - phal->SdioRxFIFOSize = 0; #endif } else break; @@ -1643,19 +1653,18 @@ u8 HalQueryTxOQTBufferStatus8723DSdio(PADAPTER padapter) } #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -u8 RecvOnePkt(PADAPTER padapter, u32 size) +u8 RecvOnePkt(PADAPTER padapter) { struct recv_buf *precvbuf; struct dvobj_priv *psddev; PSDIO_DATA psdio_data; struct sdio_func *func; - + u32 tmp = 0; + u16 len = 0; u8 res = _FALSE; - RTW_INFO("+%s: size: %d+\n", __func__, size); - if (padapter == NULL) { - RTW_INFO(KERN_ERR "%s: padapter is NULL!\n", __func__); + RTW_ERR("%s: padapter is NULL!\n", __func__); return _FALSE; } @@ -1663,9 +1672,15 @@ u8 RecvOnePkt(PADAPTER padapter, u32 size) psdio_data = &psddev->intf_data; func = psdio_data->func; - if (size) { + /* If RX_DMA is not idle, receive one pkt from DMA */ + res = sdio_local_read(padapter, + SDIO_REG_RX0_REQ_LEN, 4, (u8 *)&tmp); + len = le16_to_cpu(tmp); + RTW_INFO("+%s: size: %d+\n", __func__, len); + + if (len) { sdio_claim_host(func); - precvbuf = sd_recv_rxfifo(padapter, size); + res = sd_recv_rxfifo(padapter, len, &precvbuf); if (precvbuf) { /* printk("Completed Recv One Pkt.\n"); */ @@ -1679,3 +1694,4 @@ u8 RecvOnePkt(PADAPTER padapter, u32 size) return res; } #endif /* CONFIG_WOWLAN */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyCfg.h index 08bd8d6c1162..98f6f4f90af5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8188EPHYCFG_H__ #define __INC_HAL8188EPHYCFG_H__ @@ -68,11 +63,11 @@ void PHY_SetBBReg8188E(IN PADAPTER Adapter, IN u32 BitMask, IN u32 Data); u32 PHY_QueryRFReg8188E(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask); void PHY_SetRFReg8188E(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data); @@ -86,7 +81,7 @@ int PHY_BBConfig8188E(IN PADAPTER Adapter); int PHY_RFConfig8188E(IN PADAPTER Adapter); /* RF config */ -int rtl8188e_PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN u8 *pFileName, u8 eRFPath); +int rtl8188e_PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN u8 *pFileName, enum rf_path eRFPath); /* * RF Power setting @@ -108,14 +103,14 @@ VOID PHY_SetTxPowerIndex_8188E( IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); u8 PHY_GetTxPowerIndex_8188E( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -127,7 +122,7 @@ PHY_GetTxPowerIndex_8188E( */ /* extern void PHY_SetBWModeCallback8192C( IN PRT_TIMER pTimer ); */ void PHY_SetBWMode8188E(IN PADAPTER pAdapter, - IN CHANNEL_WIDTH ChnlWidth, + IN enum channel_width ChnlWidth, IN unsigned char Offset); /* @@ -155,7 +150,7 @@ VOID PHY_SetSwChnlBWMode8188E( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); @@ -167,7 +162,7 @@ PHY_SetRFEReg_8188E( /* * BB/MAC/RF other monitor API * */ -VOID PHY_SetRFPathSwitch_8188E(IN PADAPTER pAdapter, IN BOOLEAN bMain); +VOID phy_set_rf_path_switch_8188e(IN PADAPTER pAdapter, IN bool bMain); extern VOID PHY_SwitchEphyParameter( diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyReg.h index 783ea64123d6..2eab8313aa5d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPhyReg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8188EPHYREG_H__ #define __INC_HAL8188EPHYREG_H__ /*--------------------------Define Parameters-------------------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPwrSeq.h index 385722a551b6..46c61abacb92 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188EPwrSeq.h @@ -1,7 +1,6 @@ - /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -12,12 +11,8 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ + #ifndef __HAL8188EPWRSEQ_H__ #define __HAL8188EPWRSEQ_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyCfg.h index d0a5ed8c3c24..cca0b63a70b2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8188FPHYCFG_H__ #define __INC_HAL8188FPHYCFG_H__ @@ -60,7 +55,7 @@ PHY_SetBBReg_8188F( u32 PHY_QueryRFReg_8188F( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask ); @@ -68,7 +63,7 @@ PHY_QueryRFReg_8188F( VOID PHY_SetRFReg_8188F( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data @@ -84,22 +79,22 @@ s32 PHY_MACConfig8188F(PADAPTER padapter); int PHY_ConfigRFWithParaFile_8188F( IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + IN u8 *pFileName, + enum rf_path eRFPath ); VOID PHY_SetTxPowerIndex_8188F( IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); u8 PHY_GetTxPowerIndex_8188F( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -122,15 +117,18 @@ VOID PHY_SetSwChnlBWMode8188F( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); -VOID PHY_SetRFPathSwitch_8188F( +VOID phy_set_rf_path_switch_8188f( IN PADAPTER pAdapter, - IN BOOLEAN bMain + IN bool bMain ); + +void BBTurnOnBlock_8188F(_adapter *adapter); + /*--------------------------Exported Function prototype End---------------------*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyReg.h index 8d38c0fbbdbc..a831faade96d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPhyReg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8188FPHYREG_H__ #define __INC_HAL8188FPHYREG_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPwrSeq.h index 81e613227bdb..5cad428fdd0b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8188FPwrSeq.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef REALTEK_POWER_SEQUENCE_8188F #define REALTEK_POWER_SEQUENCE_8188F diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyCfg.h index 2efda85fdb2e..b7822d5121f9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8192EPHYCFG_H__ #define __INC_HAL8192EPHYCFG_H__ @@ -64,11 +59,11 @@ void PHY_SetBBReg8192E(IN PADAPTER Adapter, IN u32 BitMask, IN u32 Data); u32 PHY_QueryRFReg8192E(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask); void PHY_SetRFReg8192E(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data); @@ -95,14 +90,14 @@ VOID PHY_SetTxPowerIndex_8192E( IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); u8 PHY_GetTxPowerIndex_8192E( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -116,7 +111,7 @@ VOID PHY_SetSwChnlBWMode8192E( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); @@ -129,7 +124,7 @@ PHY_SetRFEReg_8192E( void phy_SpurCalibration_8192E( IN PADAPTER Adapter, - IN SPUR_CAL_METHOD Method + IN enum spur_cal_method method ); void PHY_SpurCalibration_8192E(IN PADAPTER Adapter); @@ -144,9 +139,9 @@ phy_SpurCalibration_8192E_NBI( * */ VOID -PHY_SetRFPathSwitch_8192E( +phy_set_rf_path_switch_8192e( IN PADAPTER pAdapter, - IN BOOLEAN bMain + IN bool bMain ); /*--------------------------Exported Function prototype---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyReg.h index cd13c22bc398..30b771111164 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPhyReg.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2012 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ /***************************************************************************** * Copyright(c) 2008, RealTEK Technology Inc. All Right Reserved. * diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPwrSeq.h index 12bb2fb6be05..1f2ba8722572 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8192EPwrSeq.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2012 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef REALTEK_POWER_SEQUENCE_8192E #define REALTEK_POWER_SEQUENCE_8192E diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyCfg.h index e9d422f678fa..7ef2a8cd88ea 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8703BPHYCFG_H__ #define __INC_HAL8703BPHYCFG_H__ @@ -59,16 +54,16 @@ PHY_SetBBReg_8703B( u32 PHY_QueryRFReg_8703B( - IN PADAPTER Adapter, - IN u8 eRFPath, + IN PADAPTER Adapter, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask ); VOID PHY_SetRFReg_8703B( - IN PADAPTER Adapter, - IN u8 eRFPath, + IN PADAPTER Adapter, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data @@ -84,22 +79,22 @@ s32 PHY_MACConfig8703B(PADAPTER padapter); int PHY_ConfigRFWithParaFile_8703B( IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + IN u8 *pFileName, + enum rf_path eRFPath ); VOID PHY_SetTxPowerIndex_8703B( IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); u8 PHY_GetTxPowerIndex_8703B( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -122,14 +117,14 @@ VOID PHY_SetSwChnlBWMode8703B( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); -VOID PHY_SetRFPathSwitch_8703B( +VOID phy_set_rf_path_switch_8703b( IN PADAPTER pAdapter, - IN BOOLEAN bMain + IN bool bMain ); /*--------------------------Exported Function prototype End---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyReg.h index e8eb66497037..881a13cfac87 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPhyReg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8703BPHYREG_H__ #define __INC_HAL8703BPHYREG_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPwrSeq.h index a53ca9a0767a..0dac13ee34a9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8703BPwrSeq.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef REALTEK_POWER_SEQUENCE_8703B #define REALTEK_POWER_SEQUENCE_8703B diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyCfg.h index bbcc38bd2671..594cf3fa20f1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8723BPHYCFG_H__ #define __INC_HAL8723BPHYCFG_H__ @@ -60,7 +55,7 @@ PHY_SetBBReg_8723B( u32 PHY_QueryRFReg_8723B( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask ); @@ -68,7 +63,7 @@ PHY_QueryRFReg_8723B( VOID PHY_SetRFReg_8723B( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data @@ -84,22 +79,22 @@ s32 PHY_MACConfig8723B(PADAPTER padapter); int PHY_ConfigRFWithParaFile_8723B( IN PADAPTER Adapter, - IN u8 *pFileName, - RF_PATH eRFPath + IN u8 *pFileName, + enum rf_path eRFPath ); VOID PHY_SetTxPowerIndex_8723B( IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); u8 PHY_GetTxPowerIndex_8723B( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -122,15 +117,16 @@ VOID PHY_SetSwChnlBWMode8723B( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); -VOID PHY_SetRFPathSwitch_8723B( +VOID phy_set_rf_path_switch_8723b( IN PADAPTER pAdapter, - IN BOOLEAN bMain + IN bool bMain ); + /*--------------------------Exported Function prototype End---------------------*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyReg.h index 551c0a5e3b9f..ce485c2ab4be 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPhyReg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8723BPHYREG_H__ #define __INC_HAL8723BPHYREG_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPwrSeq.h index 6b895621e1c5..1aec885cbb1d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723BPwrSeq.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef REALTEK_POWER_SEQUENCE_8723B #define REALTEK_POWER_SEQUENCE_8723B diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyCfg.h index 09afeb198e53..e447407270f5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8723DPHYCFG_H__ #define __INC_HAL8723DPHYCFG_H__ @@ -59,16 +54,16 @@ PHY_SetBBReg_8723D( u32 PHY_QueryRFReg_8723D( - IN PADAPTER Adapter, - IN u8 eRFPath, + IN PADAPTER Adapter, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask ); VOID PHY_SetRFReg_8723D( - IN PADAPTER Adapter, - IN u8 eRFPath, + IN PADAPTER Adapter, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data @@ -85,21 +80,21 @@ int PHY_ConfigRFWithParaFile_8723D( IN PADAPTER Adapter, IN u8 *pFileName, - RF_PATH eRFPath + enum rf_path eRFPath ); VOID PHY_SetTxPowerIndex_8723D( IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); u8 PHY_GetTxPowerIndex_8723D( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -122,14 +117,14 @@ VOID PHY_SetSwChnlBWMode8723D( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); -VOID PHY_SetRFPathSwitch_8723D( +VOID phy_set_rf_path_switch_8723d( IN PADAPTER pAdapter, - IN BOOLEAN bMain + IN bool bMain ); /*--------------------------Exported Function prototype End---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyReg.h index 9fb0cc1c795b..036144a388bb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPhyReg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8723DPHYREG_H__ #define __INC_HAL8723DPHYREG_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPwrSeq.h index 5032e7cafebf..70afbdbf4ace 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723DPwrSeq.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef REALTEK_POWER_SEQUENCE_8723D #define REALTEK_POWER_SEQUENCE_8723D diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723PwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723PwrSeq.h index 6669641e8767..22de83375e66 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723PwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8723PwrSeq.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef __HAL8723PWRSEQ_H__ #define __HAL8723PWRSEQ_H__ /* diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyCfg.h index 442c563d4d57..bdd1e3443810 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8812PHYCFG_H__ #define __INC_HAL8812PHYCFG_H__ @@ -66,11 +61,11 @@ void PHY_SetBBReg8812(IN PADAPTER Adapter, IN u32 BitMask, IN u32 Data); u32 PHY_QueryRFReg8812(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask); void PHY_SetRFReg8812(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data); @@ -101,25 +96,25 @@ void PHY_SetTxPowerLevel8812(IN PADAPTER Adapter, IN u8 Channel); BOOLEAN PHY_UpdateTxPowerDbm8812(IN PADAPTER Adapter, IN int powerInDbm); u8 PHY_GetTxPowerIndex_8812A( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, struct txpwr_idx_comp *tic ); -u32 PHY_GetTxBBSwing_8812A( +u32 phy_get_tx_bb_swing_8812a( IN PADAPTER Adapter, IN BAND_TYPE Band, - IN u8 RFPath + IN enum rf_path RFPath ); VOID PHY_SetTxPowerIndex_8812A( - IN PADAPTER Adapter, - IN u4Byte PowerIndex, - IN u1Byte RFPath, - IN u1Byte Rate + IN PADAPTER Adapter, + IN u32 PowerIndex, + IN enum rf_path RFPath, + IN u8 Rate ); /* @@ -129,7 +124,7 @@ VOID PHY_SetSwChnlBWMode8812( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); @@ -139,9 +134,9 @@ PHY_SetSwChnlBWMode8812( * */ VOID -PHY_SetRFPathSwitch_8812A( +phy_set_rf_path_switch_8812a( IN PADAPTER pAdapter, - IN BOOLEAN bMain + IN bool bMain ); /*--------------------------Exported Function prototype---------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyReg.h index 50097500b379..ef4abb299b6e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PhyReg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8812PHYREG_H__ #define __INC_HAL8812PHYREG_H__ /*--------------------------Define Parameters-------------------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PwrSeq.h index e089c1a9d4c0..498faf8114ae 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8812PwrSeq.h @@ -1,7 +1,6 @@ - /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -12,12 +11,8 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ + #ifndef __HAL8812PWRSEQ_H__ #define __HAL8812PWRSEQ_H__ @@ -64,7 +59,9 @@ /*{0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT7, 0}, disable HWPDN 0x04[15]=0*/ \ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0},/* disable WL suspend*/ \ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT0, BIT0},/* polling until return 0*/ \ - {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ + {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_POLLING, BIT0, 0},/**/ \ + {0x0024, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, 0}, /* 0x24[1] Choose the type of buffer after xosc: nand*/ \ + {0x0028, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, 0}, /* 0x28[33] Choose the type of buffer after xosc: nand*/ #define RTL8812_TRANS_ACT_TO_CARDEMU \ /* format */ \ @@ -143,7 +140,9 @@ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, 0}, /*0x04[10] = 0, enable SW LPS PCIE only*/ \ {0x0005, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT3, 0}, /*0x04[11] = 2b'01enable WL suspend*/ \ {0x0003, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, BIT2, BIT2}, /*0x03[2] = 1, enable 8051*/ \ - {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ + {0x0301, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_PCI_MSK, PWR_BASEADDR_MAC, PWR_CMD_WRITE, 0xFF, 0},/*PCIe DMA start*/ \ + {0x0024, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT1, BIT1}, /* 0x24[1] Choose the type of buffer after xosc: schmitt trigger*/ \ + {0x0028, PWR_CUT_ALL_MSK, PWR_FAB_ALL_MSK, PWR_INTF_ALL_MSK,PWR_BASEADDR_MAC,PWR_CMD_WRITE, BIT3, BIT3}, /* 0x28[33] Choose the type of buffer after xosc: schmitt trigger*/ #define RTL8812_TRANS_CARDEMU_TO_PDN \ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyCfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyCfg.h index 27a51d3ee152..ffa67ee9f16c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyCfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyCfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8814PHYCFG_H__ #define __INC_HAL8814PHYCFG_H__ @@ -74,14 +69,14 @@ PHY_SetBBReg8814A(IN PADAPTER Adapter, extern u32 PHY_QueryRFReg8814A(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask); void PHY_SetRFReg8814A(IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 RegAddr, IN u32 BitMask, IN u32 Data); @@ -128,18 +123,18 @@ PHY_SetTxPowerLevel8814( ); u8 -PHY_GetTxPowerIndex_8814A( - IN PADAPTER Adapter, - IN u8 RFPath, +phy_get_tx_power_index_8814a( + IN PADAPTER Adapter, + IN enum rf_path RFPath, IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, + IN enum channel_width BandWidth, IN u8 Channel ); u8 PHY_GetTxPowerIndex8814A( - IN PADAPTER Adapter, - IN u8 RFPath, + IN PADAPTER Adapter, + IN enum rf_path RFPath, IN u8 Rate, IN u8 BandWidth, IN u8 Channel, @@ -148,9 +143,9 @@ PHY_GetTxPowerIndex8814A( VOID PHY_SetTxPowerIndex_8814A( - IN PADAPTER Adapter, + IN PADAPTER Adapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); @@ -166,7 +161,7 @@ u32 PHY_GetTxBBSwing_8814A( IN PADAPTER Adapter, IN BAND_TYPE Band, - IN u8 RFPath + IN enum rf_path RFPath ); @@ -175,7 +170,7 @@ PHY_GetTxBBSwing_8814A( VOID PHY_SwChnlTimerCallback8814A( - IN PRT_TIMER pTimer + IN struct timer_list *p_timer ); VOID @@ -204,7 +199,7 @@ PHY_HandleSwChnlAndSetBW8814A( IN BOOLEAN bSwitchChannel, IN BOOLEAN bSetBandWidth, IN u8 ChannelNum, - IN CHANNEL_WIDTH ChnlWidth, + IN enum channel_width ChnlWidth, IN u8 ChnlOffsetOf40MHz, IN u8 ChnlOffsetOf80MHz, IN u8 CenterFrequencyIndex1 @@ -252,7 +247,7 @@ VOID PHY_SetSwChnlBWMode8814( IN PADAPTER Adapter, IN u8 channel, - IN CHANNEL_WIDTH Bandwidth, + IN enum channel_width Bandwidth, IN u8 Offset40, IN u8 Offset80 ); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyReg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyReg.h index 0aec99452019..2fa46dd165f9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyReg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PhyReg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __INC_HAL8814PHYREG_H__ #define __INC_HAL8814PHYREG_H__ /*--------------------------Define Parameters-------------------------------*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PwrSeq.h index 696959b6ef64..5f4097d0f739 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8814PwrSeq.h @@ -1,7 +1,6 @@ - /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -12,12 +11,8 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ + #ifndef __HAL8814PWRSEQ_H__ #define __HAL8814PWRSEQ_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8821APwrSeq.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8821APwrSeq.h index 393068b3f3cf..568b8e5fc1e9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8821APwrSeq.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/Hal8821APwrSeq.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef REALTEK_POWER_SEQUENCE_8821 #define REALTEK_POWER_SEQUENCE_8821 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalPwrSeqCmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalPwrSeqCmd.h index b511436f7938..f67ed22d1fc9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalPwrSeqCmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalPwrSeqCmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HALPWRSEQCMD_H__ #define __HALPWRSEQCMD_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalVerDef.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalVerDef.h index 3d818801a603..1909da7a0094 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalVerDef.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/HalVerDef.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_VERSION_DEF_H__ #define __HAL_VERSION_DEF_H__ @@ -178,24 +173,22 @@ typedef struct tag_HAL_VERSION { #define IS_8723A_A_CUT(version) ((IS_8723_SERIES(version)) ? (IS_A_CUT(version) ? TRUE : FALSE) : FALSE) #define IS_8723A_B_CUT(version) ((IS_8723_SERIES(version)) ? (IS_B_CUT(version) ? TRUE : FALSE) : FALSE) #endif +#define IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ((IS_8188E(GET_HAL_DATA(_Adapter)->version_id)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->version_id) >= I_CUT_VERSION) ? TRUE : FALSE) : FALSE) +#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) +#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) +#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->version_id) == C_CUT_VERSION) ? TRUE : FALSE) : FALSE) -#define IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ((IS_8188E(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) >= I_CUT_VERSION) ? TRUE : FALSE) : FALSE) +#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) +#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) -#define IS_VENDOR_8812A_TEST_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -#define IS_VENDOR_8812A_MP_CHIP(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -#define IS_VENDOR_8812A_C_CUT(_Adapter) ((IS_8812_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == C_CUT_VERSION) ? TRUE : FALSE) : FALSE) +#define IS_VENDOR_8192E_B_CUT(_Adapter) ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->version_id) == B_CUT_VERSION) ? TRUE : FALSE) -#define IS_VENDOR_8821A_TEST_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -#define IS_VENDOR_8821A_MP_CHIP(_Adapter) ((IS_8821_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) +#define IS_VENDOR_8723B_TEST_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) +#define IS_VENDOR_8723B_MP_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) -#define IS_VENDOR_8192E_B_CUT(_Adapter) ((GET_CVID_CUT_VERSION(GET_HAL_DATA(_Adapter)->VersionID) == B_CUT_VERSION) ? TRUE : FALSE) - -#define IS_VENDOR_8723B_TEST_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -#define IS_VENDOR_8723B_MP_CHIP(_Adapter) ((IS_8723B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) - -#define IS_VENDOR_8703B_TEST_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -#define IS_VENDOR_8703B_MP_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) -#define IS_VENDOR_8814A_TEST_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? FALSE : TRUE) : FALSE) -#define IS_VENDOR_8814A_MP_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->VersionID)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->VersionID)) ? TRUE : FALSE) : FALSE) +#define IS_VENDOR_8703B_TEST_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) +#define IS_VENDOR_8703B_MP_CHIP(_Adapter) ((IS_8703B_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) +#define IS_VENDOR_8814A_TEST_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? FALSE : TRUE) : FALSE) +#define IS_VENDOR_8814A_MP_CHIP(_Adapter) ((IS_8814A_SERIES(GET_HAL_DATA(_Adapter)->version_id)) ? ((IS_NORMAL_CHIP(GET_HAL_DATA(_Adapter)->version_id)) ? TRUE : FALSE) : FALSE) #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/autoconf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/autoconf.h index 4f98e8366550..27f3147c2ae6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/autoconf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/autoconf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /* * Public General Config */ @@ -53,7 +48,6 @@ #endif /* !CONFIG_PLATFORM_INTEL_BYT */ /* #define CONFIG_DEBUG_CFG80211 */ #define CONFIG_SET_SCAN_DENY_TIMER - /*#define SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42*/ /* wpa_supplicant realtek version <= jb42 will be defined this */ #endif #define CONFIG_AP_MODE @@ -99,7 +93,6 @@ #define CONFIG_TSF_RESET_OFFLOAD /* For 2 PORT TSF SYNC. */ #endif /* #define DBG_RUNTIME_PORT_SWITCH */ - #define CONFIG_SCAN_BACKOP #endif /* CONFIG_CONCURRENT_MODE */ #define CONFIG_LAYER2_ROAMING @@ -115,7 +108,10 @@ /* #define CONFIG_ANTENNA_DIVERSITY */ /* Set from Makefile */ /* #define SUPPORT_HW_RFOFF_DETECTED */ -/* #define CONFIG_SW_LED */ +/*#define CONFIG_RTW_LED*/ +#ifdef CONFIG_RTW_LED + /*#define CONFIG_RTW_SW_LED*/ +#endif /* CONFIG_RTW_LED */ #define CONFIG_XMIT_ACK #ifdef CONFIG_XMIT_ACK @@ -136,7 +132,7 @@ #define CONFIG_SDIO_RX_COPY #define CONFIG_XMIT_THREAD_MODE /* #define CONFIG_SDIO_TX_ENABLE_AVAL_INT */ - +/* #define CONFIG_RECV_THREAD_MODE */ /* * Others @@ -148,6 +144,7 @@ #define CONFIG_NEW_SIGNAL_STAT_PROCESS #define CONFIG_EMBEDDED_FWIMG + #ifdef CONFIG_EMBEDDED_FWIMG #define LOAD_FW_HEADER_FROM_DRIVER #endif @@ -226,10 +223,7 @@ #ifdef CONFIG_WOWLAN #define CONFIG_GTK_OL - #define CONFIG_ARP_KEEP_ALIVE - #ifndef CONFIG_DEFAULT_PATTERNS_EN - #define CONFIG_DEFAULT_PATTERNS_EN 1 - #endif + /* #define CONFIG_ARP_KEEP_ALIVE */ #endif /* CONFIG_WOWLAN */ #ifdef CONFIG_GPIO_WAKEUP @@ -242,6 +236,15 @@ #define CONFIG_HW_ANTENNA_DIVERSITY #endif +#if (CONFIG_RTW_ADAPTIVITY_EN == 1) + #define CONFIG_RTW_ADAPTIVITY_TH_L2H_INI 0xf3 +#endif + +#ifdef CONFIG_RTW_NAPI +/*#define CONFIG_RTW_NAPI_DYNAMIC*/ +#define CONFIG_RTW_NAPI_V2 +#endif + /* * Platform dependent */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/basic_types.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/basic_types.h index 245286da1f10..c0737f5bf235 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/basic_types.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/basic_types.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __BASIC_TYPES_H__ #define __BASIC_TYPES_H__ @@ -100,9 +95,14 @@ #define UINT u32 #define ULONG u32 - #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) - typedef _Bool bool; - #endif +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 19)) +typedef _Bool bool; + +enum { + false = 0, + true = 1 +}; +#endif typedef void (*proc_t)(void *); @@ -110,6 +110,36 @@ typedef __kernel_ssize_t SSIZE_T; #define FIELD_OFFSET(s, field) ((SSIZE_T)&((s *)(0))->field) +#define u1Byte u8 +#define pu1Byte u8* + +#define u2Byte u16 +#define pu2Byte u16* + +#define u4Byte u32 +#define pu4Byte u32* + +#define u8Byte u64 +#define pu8Byte u64* + +#define s1Byte s8 +#define ps1Byte s8* + +#define s2Byte s16 +#define ps2Byte s16* + +#define s4Byte s32 +#define ps4Byte s32* + +#define s8Byte s64 +#define ps8Byte s64* + +#define UCHAR u8 +#define USHORT u16 +#define UINT u32 +#define ULONG u32 +#define PULONG u32* + #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/big_endian.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/big_endian.h index 345e9d8e0e73..6b1dc449e578 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/big_endian.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/big_endian.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_BYTEORDER_BIG_ENDIAN_H #define _LINUX_BYTEORDER_BIG_ENDIAN_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/generic.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/generic.h index 02cf675ae366..f85114bf796c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/generic.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/generic.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_BYTEORDER_GENERIC_H #define _LINUX_BYTEORDER_GENERIC_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/little_endian.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/little_endian.h index 0b773366ca2f..c4b64512f296 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/little_endian.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/little_endian.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_BYTEORDER_LITTLE_ENDIAN_H #define _LINUX_BYTEORDER_LITTLE_ENDIAN_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swab.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swab.h index d6d81b5c140c..a8dd46bd3a60 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swab.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swab.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_BYTEORDER_SWAB_H #define _LINUX_BYTEORDER_SWAB_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swabb.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swabb.h index ce3342470c10..634519a0b826 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swabb.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/byteorder/swabb.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_BYTEORDER_SWABB_H #define _LINUX_BYTEORDER_SWABB_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/circ_buf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/circ_buf.h index 23523164cd36..7a5b8ef1a202 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/circ_buf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/circ_buf.h @@ -1,7 +1,7 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. - * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * * 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. @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __CIRC_BUF_H_ #define __CIRC_BUF_H_ 1 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmd_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmd_osdep.h index 9c63a1c28227..e4ba2b6d3b62 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmd_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmd_osdep.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __CMD_OSDEP_H_ #define __CMD_OSDEP_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmn_info/rtw_sta_info.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmn_info/rtw_sta_info.h new file mode 100644 index 000000000000..4ad7b6c08774 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/cmn_info/rtw_sta_info.h @@ -0,0 +1,239 @@ +/****************************************************************************** + * + * 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 + * + * + ******************************************************************************/ + + /*This header file is for all driver teams to use the same station info. +If you want to change this file please make sure notify all driver teams maintainers.*/ + +/*Created by YuChen 20170301*/ + +#ifndef __INC_RTW_STA_INFO_H +#define __INC_RTW_STA_INFO_H + +/*--------------------Define ---------------------------------------*/ + +#define STA_DM_CTRL_ACTIVE BIT(0) +#define STA_DM_CTRL_CFO_TRACKING BIT(1) + +#ifdef CONFIG_BEAMFORMING +#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT(0) /*Declare sta support beamformer*/ +#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT(1) /*Declare sta support beamformee*/ +#define BEAMFORMING_HT_BEAMFORMER_TEST BIT(2) /*Transmiting Beamforming no matter the target supports it or not*/ +#define BEAMFORMING_HT_BEAMFORMER_STEER_NUM (BIT(4)|BIT(5)) /*Sta Bfer's capability*/ +#define BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP (BIT(6)|BIT(7)) /*Sta BFee's capability*/ + +#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT(0) /*Declare sta support beamformer*/ +#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT(1) /*Declare sta support beamformee*/ +#define BEAMFORMING_VHT_MU_MIMO_AP_ENABLE BIT(2) /*Declare sta support MU beamformer*/ +#define BEAMFORMING_VHT_MU_MIMO_STA_ENABLE BIT(3) /*Declare sta support MU beamformer*/ +#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT(4) /*Transmiting Beamforming no matter the target supports it or not*/ +#define BEAMFORMING_VHT_BEAMFORMER_STS_CAP (BIT(8)|BIT(9)|BIT(10)) /*Sta BFee's capability*/ +#define BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM (BIT(12)|BIT(13)|BIT(14)) /*Sta Bfer's capability*/ +#endif + +#define HT_STBC_EN BIT(0) +#define VHT_STBC_EN BIT(1) + +#define HT_LDPC_EN BIT(0) +#define VHT_LDPC_EN BIT(1) + +#define SM_PS_STATIC 0 +#define SM_PS_DYNAMIC 1 +#define SM_PS_INVALID 2 +#define SM_PS_DISABLE 3 + + +/*cmn_sta_info.ra_sta_info.txrx_state*/ +#define TX_STATE 0 +#define RX_STATE 1 +#define BI_DIRECTION_STATE 2 + +/*--------------------Define Enum-----------------------------------*/ +enum channel_width { + CHANNEL_WIDTH_20 = 0, + CHANNEL_WIDTH_40 = 1, + CHANNEL_WIDTH_80 = 2, + CHANNEL_WIDTH_160 = 3, + CHANNEL_WIDTH_80_80 = 4, + CHANNEL_WIDTH_5 = 5, + CHANNEL_WIDTH_10 = 6, + CHANNEL_WIDTH_MAX = 7, +}; + +enum rf_type { + RF_1T1R = 0, + RF_1T2R = 1, + RF_2T2R = 2, + RF_2T3R = 3, + RF_2T4R = 4, + RF_3T3R = 5, + RF_3T4R = 6, + RF_4T4R = 7, + RF_TYPE_MAX = 0x0F, +}; + +enum bb_path { + BB_PATH_A = 0x00000001, + BB_PATH_B = 0x00000002, + BB_PATH_C = 0x00000004, + BB_PATH_D = 0x00000008, + + BB_PATH_AB = (BB_PATH_A | BB_PATH_B), + BB_PATH_AC = (BB_PATH_A | BB_PATH_C), + BB_PATH_AD = (BB_PATH_A | BB_PATH_D), + BB_PATH_BC = (BB_PATH_B | BB_PATH_C), + BB_PATH_BD = (BB_PATH_B | BB_PATH_D), + BB_PATH_CD = (BB_PATH_C | BB_PATH_D), + + BB_PATH_ABC = (BB_PATH_A | BB_PATH_B | BB_PATH_C), + BB_PATH_ABD = (BB_PATH_A | BB_PATH_B | BB_PATH_D), + BB_PATH_ACD = (BB_PATH_A | BB_PATH_C | BB_PATH_D), + BB_PATH_BCD = (BB_PATH_B | BB_PATH_C | BB_PATH_D), + + BB_PATH_ABCD = (BB_PATH_A | BB_PATH_B | BB_PATH_D | BB_PATH_D), +}; + +enum rf_path { + RF_PATH_A = 0, + RF_PATH_B = 1, + RF_PATH_C = 2, + RF_PATH_D = 3, + RF_PATH_AB, + RF_PATH_AC, + RF_PATH_AD, + RF_PATH_BC, + RF_PATH_BD, + RF_PATH_CD, + RF_PATH_ABC, + RF_PATH_ACD, + RF_PATH_BCD, + RF_PATH_ABCD, +}; + +enum wireless_set { + WIRELESS_CCK = 0x00000001, + WIRELESS_OFDM = 0x00000002, + WIRELESS_HT = 0x00000004, + WIRELESS_VHT = 0x00000008, +}; + +/*--------------------Define MACRO---------------------------------*/ + +/*--------------------Define Struct-----------------------------------*/ + +#ifdef CONFIG_BEAMFORMING +struct bf_cmn_info { + u8 ht_beamform_cap; /*Sta capablity*/ + u16 vht_beamform_cap; /*Sta capablity*/ + u16 p_aid; + u8 g_id; +}; +#endif +struct rssi_info { + s8 rssi; + s8 rssi_cck; + s8 rssi_ofdm; + u8 packet_map; + u8 ofdm_pkt_cnt; + u8 cck_pkt_cnt; + u16 cck_sum_power; + u8 is_send_rssi; + u8 valid_bit; +}; + +struct ra_sta_info { + u8 rate_id; /*ratr_idx*/ + u8 rssi_level; + + /*New*/ + u8 is_first_connect:1; /*CE: ra_rpt_linked, AP: H2C_rssi_rpt*/ + u8 is_support_sgi:1; /*driver*/ + u8 is_vht_enable:2; /*driver*/ + u8 disable_ra:1; /*driver*/ + u8 disable_pt:1; /*driver*/ /*remove is_disable_power_training*/ + u8 txrx_state:2; /*0: Tx, 1:Rx, 2:bi-direction*/ + u8 is_noisy:1; + + u8 curr_tx_rate; /*FW->Driver*/ + enum channel_width ra_bw_mode; /*max bandwidth, for RA only*/ + enum channel_width curr_tx_bw; /*FW->Driver*/ + u8 curr_retry_ratio; /*FW->Driver*/ + + u64 ramask; +}; + +struct cmn_sta_info { + u16 dm_ctrl; + enum channel_width bw_mode; /*max bandwidth*/ + u8 mac_id; + u8 mac_addr[6]; + u16 aid; + enum rf_type mimo_type; /*sta XTXR*/ + struct rssi_info rssi_stat; + struct ra_sta_info ra_info; + u16 tx_moving_average_tp; /*tx average MBps*/ + u16 rx_moving_average_tp; /*rx average MBps*/ + u8 stbc_en:2; /*Driver : really use stbc!!*/ + u8 ldpc_en:2; + enum wireless_set support_wireless_set; +#ifdef CONFIG_BEAMFORMING + struct bf_cmn_info bf_info; +#endif + u8 sm_ps:2; +}; + +struct phydm_phyinfo_struct { + u8 rx_pwdb_all; + u8 signal_quality; /* OFDM: signal_quality=rx_mimo_signal_quality[0], CCK: signal qualityin 0-100 index. */ + u8 rx_mimo_signal_strength[4]; /* RSSI in 0~100 index */ + s8 rx_mimo_signal_quality[4]; /* OFDM: per-path's EVM translate to 0~100% , no used for CCK*/ + u8 rx_mimo_evm_dbm[4]; /* per-path's original EVM (dbm) */ + s16 cfo_short[4]; /* per-path's cfo_short */ + s16 cfo_tail[4]; /* per-path's cfo_tail */ + s8 rx_power; /* in dBm Translate from PWdB */ + s8 recv_signal_power; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ + u8 bt_rx_rssi_percentage; + u8 signal_strength; /* in 0-100 index. */ + s8 rx_pwr[4]; /* per-path's pwdb */ + s8 rx_snr[4]; /* per-path's SNR */ +/*ODM_PHY_STATUS_NEW_TYPE_SUPPORT*/ + u8 rx_count:2; /* RX path counter---*/ + u8 band_width:2; + u8 rxsc:4; /* sub-channel---*/ + u8 channel; /* channel number---*/ + u8 is_mu_packet:1; /* is MU packet or not---boolean*/ + u8 is_beamformed:1; /* BF packet---boolean*/ +/*ODM_PHY_STATUS_NEW_TYPE_SUPPORT*/ +}; + +struct phydm_perpkt_info_struct { + u8 data_rate; + u8 station_id; + u8 is_packet_match_bssid:1; /*boolean*/ + u8 is_packet_to_self:1; /*boolean*/ + u8 is_packet_beacon:1; /*boolean*/ + u8 is_to_self:1; /*boolean*/ + u8 ppdu_cnt; +}; + +/*--------------------Export global variable----------------------------*/ + +/*--------------------Function declaration-----------------------------*/ + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/custom_gpio.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/custom_gpio.h index 5691d9a1c6cc..49411b662efb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/custom_gpio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/custom_gpio.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef __CUSTOM_GPIO_H__ #define __CUSTOM_GPIO_H___ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_conf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_conf.h index 28bbdec661d6..dab2936bfd7b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_conf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_conf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __DRV_CONF_H__ #define __DRV_CONF_H__ #include "autoconf.h" @@ -28,6 +23,26 @@ #endif +#ifdef CONFIG_RTW_REPEATER_SON + #ifndef CONFIG_AP + #define CONFIG_AP + #endif + #ifndef CONFIG_CONCURRENT_MODE + #define CONFIG_CONCURRENT_MODE + #endif + #ifndef CONFIG_BR_EXT + #define CONFIG_BR_EXT + #endif + #ifndef CONFIG_RTW_REPEATER_SON_ID + #define CONFIG_RTW_REPEATER_SON_ID 0x02040608 + #endif + //#define CONFIG_RTW_REPEATER_SON_ROOT + #ifndef CONFIG_RTW_REPEATER_SON_ROOT + #define CONFIG_LAYER2_ROAMING_ACTIVE + #endif + #undef CONFIG_POWER_SAVING +#endif + #if defined(CONFIG_MCC_MODE) && (!defined(CONFIG_CONCURRENT_MODE)) #error "Enable CONCURRENT_MODE before enable MCC MODE\n" @@ -105,6 +120,10 @@ #undef CONFIG_DFS_MASTER #endif +#if !defined(CONFIG_SCAN_BACKOP) && defined(CONFIG_AP_MODE) +#define CONFIG_SCAN_BACKOP +#endif + #define RTW_SCAN_SPARSE_MIRACAST 1 #define RTW_SCAN_SPARSE_BG 0 #define RTW_SCAN_SPARSE_ROAMING_ACTIVE 1 @@ -113,10 +132,6 @@ #define CONFIG_RTW_HIQ_FILTER 1 #endif -#ifndef CONFIG_RTW_FORCE_IGI_LB - #define CONFIG_RTW_FORCE_IGI_LB 0 -#endif - #ifndef CONFIG_RTW_ADAPTIVITY_EN #define CONFIG_RTW_ADAPTIVITY_EN 0 #endif @@ -156,6 +171,10 @@ #define CONFIG_TXPWR_LIMIT_EN 2 /* by efuse */ #endif +#ifndef CONFIG_RTW_CHPLAN +#define CONFIG_RTW_CHPLAN 0xFF /* RTW_CHPLAN_UNSPECIFIED */ +#endif + /* compatible with old fashion configuration */ #if defined(CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY) #undef CONFIG_TXPWR_BY_RATE_EN @@ -181,6 +200,32 @@ #define CONFIG_TXPWR_LIMIT_EN 1 #endif +#if !defined(CONFIG_TXPWR_LIMIT) && CONFIG_TXPWR_LIMIT_EN + #define CONFIG_TXPWR_LIMIT +#endif + +#ifdef CONFIG_RTW_IPCAM_APPLICATION + #undef CONFIG_TXPWR_BY_RATE_EN + #define CONFIG_TXPWR_BY_RATE_EN 1 + #define CONFIG_RTW_CUSTOMIZE_BEEDCA 0x0000431C + #define CONFIG_RTW_CUSTOMIZE_BWMODE 0x00 + #define CONFIG_RTW_CUSTOMIZE_RLSTA 0x7 +#endif + + +#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_1SS + #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_1SS {0xFF, 0xFF, 0xFF, 0xFF} +#endif +#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_2SS + #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_2SS {0xFF, 0xFF, 0xFF, 0xFF} +#endif +#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_3SS + #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_3SS {0xFF, 0xFF, 0xFF, 0xFF} +#endif +#ifndef CONFIG_RTW_RX_AMPDU_SZ_LIMIT_4SS + #define CONFIG_RTW_RX_AMPDU_SZ_LIMIT_4SS {0xFF, 0xFF, 0xFF, 0xFF} +#endif + #ifndef CONFIG_RTW_TARGET_TX_PWR_2G_A #define CONFIG_RTW_TARGET_TX_PWR_2G_A {-1, -1, -1, -1, -1, -1, -1, -1, -1, -1} #endif @@ -282,15 +327,8 @@ #define CONFIG_IEEE80211_BAND_5GHZ #endif -#ifndef RTW_DEF_MODULE_REGULATORY_CERT - #define RTW_DEF_MODULE_REGULATORY_CERT 0 -#endif - -#if RTW_DEF_MODULE_REGULATORY_CERT - /* force enable TX power by rate and TX power limit */ - #ifndef CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY - #define CONFIG_CALIBRATE_TX_POWER_BY_REGULATORY - #endif +#if defined(CONFIG_WOWLAN) && (defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C)) + #define CONFIG_WOW_PATTERN_HW_CAM #endif /* @@ -307,9 +345,7 @@ /*#define CONFIG_DOSCAN_IN_BUSYTRAFFIC */ /*Don't release SDIO irq in suspend/resume procedure*/ -#ifdef CONFIG_SDIO_HCI -#define CONFIG_RTW_SDIO_KEEP_IRQ -#endif +#define CONFIG_RTW_SDIO_KEEP_IRQ 0 /* * Add by Lucas@2016/02/15 @@ -319,4 +355,33 @@ #define RTW_RX_AGGREGATION #endif /* CONFIG_SDIO_HCI || CONFIG_USB_RX_AGGREGATION */ +#ifdef CONFIG_RTW_HOSTAPD_ACS + #if defined(CONFIG_RTL8812A) || defined(CONFIG_RTL8821A) || defined(CONFIG_RTL8814A) + #ifndef CONFIG_FIND_BEST_CHANNEL + #define CONFIG_FIND_BEST_CHANNEL + #endif + #else + #ifdef CONFIG_FIND_BEST_CHANNEL + #undef CONFIG_FIND_BEST_CHANNEL + #endif + #ifndef CONFIG_RTW_ACS + #define CONFIG_RTW_ACS + #endif + #ifndef CONFIG_BACKGROUND_NOISE_MONITOR + #define CONFIG_BACKGROUND_NOISE_MONITOR + #endif + #endif +#endif + +#ifdef CONFIG_RTW_80211K + #ifndef CONFIG_RTW_ACS + #define CONFIG_RTW_ACS + #endif +#endif /*CONFIG_RTW_80211K*/ + +#ifdef DBG_CONFIG_ERROR_RESET +#ifndef CONFIG_IPS +#define CONFIG_IPS +#endif +#endif #endif /* __DRV_CONF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types.h index 3938756a1664..265e511eee32 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /*------------------------------------------------------------------------------- For type defines and data structure defines @@ -63,6 +58,7 @@ enum _NIC_VERSION { typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include +#include #include #ifdef CONFIG_80211N_HT @@ -83,6 +79,7 @@ typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include #include #include +#include #ifdef CONFIG_BEAMFORMING #include @@ -130,10 +127,6 @@ typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include #endif /* CONFIG_WAPI_SUPPORT */ -#ifdef CONFIG_DRVEXT_MODULE - #include -#endif /* CONFIG_DRVEXT_MODULE */ - #ifdef CONFIG_MP_INCLUDED #include #endif /* CONFIG_MP_INCLUDED */ @@ -153,14 +146,17 @@ typedef struct _ADAPTER _adapter, ADAPTER, *PADAPTER; #include -#ifdef CONFIG_BT_COEXIST - #include -#endif /* CONFIG_BT_COEXIST */ +#include +#include #ifdef CONFIG_MCC_MODE #include #endif /*CONFIG_MCC_MODE */ +#ifdef CONFIG_RTW_REPEATER_SON + #include +#endif /*CONFIG_RTW_REPEATER_SON */ + #define SPEC_DEV_ID_NONE BIT(0) #define SPEC_DEV_ID_DISABLE_HT BIT(1) #define SPEC_DEV_ID_ENABLE_PS BIT(2) @@ -197,8 +193,13 @@ struct registry_priv { u8 soft_ap; u8 power_mgnt; u8 ips_mode; + u8 lps_level; u8 smart_ps; +#ifdef CONFIG_WMMPS_STA + u8 wmm_smart_ps; +#endif /* CONFIG_WMMPS_STA */ u8 usb_rxagg_mode; + u8 dynamic_agg_enable; u8 long_retry_lmt; u8 short_retry_lmt; u16 busy_thresh; @@ -214,19 +215,21 @@ struct registry_priv { u8 early_mode; #endif u8 acm_method; - /* UAPSD */ + /* WMM */ u8 wmm_enable; - u8 uapsd_enable; - u8 uapsd_max_sp; - u8 uapsd_acbk_en; - u8 uapsd_acbe_en; - u8 uapsd_acvi_en; - u8 uapsd_acvo_en; +#ifdef CONFIG_WMMPS_STA + /* uapsd (unscheduled automatic power-save delivery) = a kind of wmmps */ + u8 uapsd_max_sp_len; + /* BIT0: AC_VO UAPSD, BIT1: AC_VI UAPSD, BIT2: AC_BK UAPSD, BIT3: AC_BE UAPSD */ + u8 uapsd_ac_enable; +#endif /* CONFIG_WMMPS_STA */ WLAN_BSSID_EX dev_network; u8 tx_bw_mode; - +#ifdef CONFIG_AP_MODE + u8 bmc_tx_rate; +#endif #ifdef CONFIG_80211N_HT u8 ht_enable; /* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz */ @@ -235,7 +238,9 @@ struct registry_priv { u8 bw_mode; u8 ampdu_enable;/* for tx */ u8 rx_stbc; - u8 ampdu_amsdu;/* A-MPDU Supports A-MSDU is permitted */ + u8 rx_ampdu_amsdu;/* Rx A-MPDU Supports A-MSDU is permitted */ + u8 tx_ampdu_amsdu;/* Tx A-MPDU Supports A-MSDU is permitted */ + u8 rx_ampdu_sz_limit_by_nss_bw[4][4]; /* 1~4SS, BW20~BW160 */ /* Short GI support Bit Map */ /* BIT0 - 20MHz, 1: support, 0: non-support */ /* BIT1 - 40MHz, 1: support, 0: non-support */ @@ -262,7 +267,7 @@ struct registry_priv { #ifdef CONFIG_80211AC_VHT u8 vht_enable; /* 0:disable, 1:enable, 2:auto */ u8 ampdu_factor; - u8 vht_rate_sel; + u8 vht_rx_mcs_map[2]; #endif /* CONFIG_80211AC_VHT */ u8 lowrate_two_xmit; @@ -283,6 +288,7 @@ struct registry_priv { u8 bt_sco; u8 bt_ampdu; u8 ant_num; + u8 single_ant_path; #endif BOOLEAN bAcceptAddbaReq; @@ -319,21 +325,14 @@ struct registry_priv { u8 notch_filter; -#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV - u8 force_ant;/* 0 normal,1 main,2 aux */ - u8 force_igi;/* 0 normal */ -#endif - - u8 force_igi_lb; - /* for pll reference clock selction */ u8 pll_ref_clk_sel; /* define for tx power adjust */ +#ifdef CONFIG_TXPWR_LIMIT u8 RegEnableTxPowerLimit; +#endif u8 RegEnableTxPowerByRate; - u8 RegPowerBase; - u8 RegPwrTblSel; u8 target_tx_pwr_valid; s8 target_tx_pwr_2g[RF_PATH_MAX][RATE_SECTION_NUM]; @@ -371,9 +370,13 @@ struct registry_priv { u8 boffefusemask; BOOLEAN bFileMaskEfuse; -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - u8 acs_mode; +#ifdef CONFIG_RTW_ACS u8 acs_auto_scan; + u8 acs_mode; +#endif + +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + u8 nm_mode; #endif u32 reg_rxgain_offset_2g; u32 reg_rxgain_offset_5gl; @@ -393,20 +396,49 @@ struct registry_priv { u32 rtw_mcc_sta_bw20_target_tx_tp; u32 rtw_mcc_sta_bw40_target_tx_tp; u32 rtw_mcc_sta_bw80_target_tx_tp; + s8 rtw_mcc_policy_table_idx; + u8 rtw_mcc_duration; + u8 rtw_mcc_tsf_sync_offset; + u8 rtw_mcc_start_time_offset; + u8 rtw_mcc_interval; + s8 rtw_mcc_guard_offset0; + s8 rtw_mcc_guard_offset1; #endif /* CONFIG_MCC_MODE */ #ifdef CONFIG_RTW_NAPI u8 en_napi; +#ifdef CONFIG_RTW_NAPI_DYNAMIC + u32 napi_threshold; /* unit: Mbps */ +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ #ifdef CONFIG_RTW_GRO u8 en_gro; #endif /* CONFIG_RTW_GRO */ #endif /* CONFIG_RTW_NAPI */ - bool default_patterns_en; +#ifdef CONFIG_WOWLAN + u8 wakeup_event; +#endif + #ifdef CONFIG_SUPPORT_TRX_SHARED u8 trx_share_mode; #endif u8 check_hw_status; + + u32 pci_aspm_config; + + u8 iqk_fw_offload; + +#ifdef CONFIG_TDLS + u8 en_tdls; +#endif + +#ifdef CONFIG_ADVANCE_OTA + u8 adv_ota; +#endif + +#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT + u8 fw_param_init; +#endif }; /* For registry parameters */ @@ -427,24 +459,20 @@ struct registry_priv { #define BSSID_OFT(field) ((ULONG)FIELD_OFFSET(WLAN_BSSID_EX, field)) #define BSSID_SZ(field) sizeof(((PWLAN_BSSID_EX) 0)->field) -#ifdef CONFIG_80211N_HT #define BW_MODE_2G(bw_mode) ((bw_mode) & 0x0F) #define BW_MODE_5G(bw_mode) ((bw_mode) >> 4) #define REGSTY_BW_2G(regsty) BW_MODE_2G((regsty)->bw_mode) #define REGSTY_BW_5G(regsty) BW_MODE_5G((regsty)->bw_mode) #define REGSTY_IS_BW_2G_SUPPORT(regsty, bw) (REGSTY_BW_2G((regsty)) >= (bw)) #define REGSTY_IS_BW_5G_SUPPORT(regsty, bw) (REGSTY_BW_5G((regsty)) >= (bw)) -#endif -#ifdef CONFIG_80211AC_VHT #define REGSTY_IS_11AC_ENABLE(regsty) ((regsty)->vht_enable != 0) #define REGSTY_IS_11AC_AUTO(regsty) ((regsty)->vht_enable == 2) -#endif typedef struct rtw_if_operations { - int __must_check(*read)(struct dvobj_priv *d, int addr, void *buf, + int __must_check (*read)(struct dvobj_priv *d, unsigned int addr, void *buf, size_t len, bool fixed); - int __must_check(*write)(struct dvobj_priv *d, int addr, void *buf, + int __must_check (*write)(struct dvobj_priv *d, unsigned int addr, void *buf, size_t len, bool fixed); } RTW_IF_OPS, *PRTW_IF_OPS; @@ -461,7 +489,7 @@ typedef struct rtw_if_operations { #ifdef CONFIG_CONCURRENT_MODE #define is_primary_adapter(adapter) (adapter->adapter_type == PRIMARY_ADAPTER) - #define is_vir_adapter(adapter) (adapter->adapter_type == MAX_ADAPTER) + #define is_vir_adapter(adapter) (adapter->adapter_type == VIRTUAL_ADAPTER) #define get_hw_port(adapter) (adapter->hw_port) #else #define is_primary_adapter(adapter) (1) @@ -643,15 +671,10 @@ struct debug_priv { u32 dbg_rpwm_toogle_cnt; u32 dbg_rpwm_timeout_fail_cnt; u32 dbg_sreset_cnt; + u32 dbg_fw_mem_dl_error_cnt; u64 dbg_rx_fifo_last_overflow; u64 dbg_rx_fifo_curr_overflow; u64 dbg_rx_fifo_diff_overflow; - u64 dbg_rx_ampdu_drop_count; - u64 dbg_rx_ampdu_forced_indicate_count; - u64 dbg_rx_ampdu_loss_count; - u64 dbg_rx_dup_mgt_frame_drop_count; - u64 dbg_rx_ampdu_window_shift_cnt; - u64 dbg_rx_conflic_mac_addr_cnt; }; struct rtw_traffic_statistics { @@ -712,6 +735,8 @@ struct sec_cam_ent { ((u8 *)(x))[6], ((u8 *)(x))[7], ((u8 *)(x))[8], ((u8 *)(x))[9], ((u8 *)(x))[10], ((u8 *)(x))[11], \ ((u8 *)(x))[12], ((u8 *)(x))[13], ((u8 *)(x))[14], ((u8 *)(x))[15] +#define RTW_DEFAULT_MGMT_MACID 1 + struct macid_bmp { u32 m0; #if (MACID_NUM_SW_LIMIT > 32) @@ -731,14 +756,29 @@ struct macid_ctl_t { struct macid_bmp used; struct macid_bmp bmc; struct macid_bmp if_g[CONFIG_IFACE_NUMBER]; - u8 iface_bmc[CONFIG_IFACE_NUMBER];/*for bc-sta of AP or Adhoc mode*/ struct macid_bmp ch_g[2]; /* 2 ch concurrency */ + + u8 iface_bmc[CONFIG_IFACE_NUMBER]; /* bmc TX macid for each iface*/ + u8 h2c_msr[MACID_NUM_SW_LIMIT]; u8 bw[MACID_NUM_SW_LIMIT]; u8 vht_en[MACID_NUM_SW_LIMIT]; u32 rate_bmp0[MACID_NUM_SW_LIMIT]; u32 rate_bmp1[MACID_NUM_SW_LIMIT]; - struct sta_info *sta[MACID_NUM_SW_LIMIT]; + + struct sta_info *sta[MACID_NUM_SW_LIMIT]; /* corresponding stainfo when macid is not shared */ + + /* macid sleep registers */ + u16 reg_sleep_m0; +#if (MACID_NUM_SW_LIMIT > 32) + u16 reg_sleep_m1; +#endif +#if (MACID_NUM_SW_LIMIT > 64) + u16 reg_sleep_m2; +#endif +#if (MACID_NUM_SW_LIMIT > 96) + u16 reg_sleep_m3; +#endif }; /* used for rf_ctl_t.rate_bmp_cck_ofdm */ @@ -774,7 +814,25 @@ struct macid_ctl_t { #define RATE_BMP_GET_VHT_2SS(_bmp_vht) ((_bmp_vht & RATE_BMP_VHT_2SS) >> 10) #define RATE_BMP_GET_VHT_3SS(_bmp_vht) ((_bmp_vht & RATE_BMP_VHT_3SS) >> 20) +#define TXPWR_LMT_REF_VHT_FROM_HT BIT0 +#define TXPWR_LMT_REF_HT_FROM_VHT BIT1 + +#define TXPWR_LMT_HAS_CCK_1T BIT0 +#define TXPWR_LMT_HAS_CCK_2T BIT1 +#define TXPWR_LMT_HAS_CCK_3T BIT2 +#define TXPWR_LMT_HAS_CCK_4T BIT3 +#define TXPWR_LMT_HAS_OFDM_1T BIT4 +#define TXPWR_LMT_HAS_OFDM_2T BIT5 +#define TXPWR_LMT_HAS_OFDM_3T BIT6 +#define TXPWR_LMT_HAS_OFDM_4T BIT7 + struct rf_ctl_t { + const struct country_chplan *country_ent; + u8 ChannelPlan; + u8 max_chan_nums; + RT_CHANNEL_INFO channel_set[MAX_CHANNEL_NUM]; + struct p2p_channels channel_list; + /* used for debug or by tx power limit */ u16 rate_bmp_cck_ofdm; /* 20MHz */ u32 rate_bmp_ht_by_bw[2]; /* 20MHz, 40MHz. 4SS supported */ @@ -784,6 +842,21 @@ struct rf_ctl_t { u8 highest_ht_rate_bw_bmp; u8 highest_vht_rate_bw_bmp; +#ifdef CONFIG_TXPWR_LIMIT + _mutex txpwr_lmt_mutex; + _list reg_exc_list; + u8 regd_exc_num; + _list txpwr_lmt_list; + u8 txpwr_regd_num; + const char *regd_name; + + u8 txpwr_lmt_2g_cck_ofdm_state; + #ifdef CONFIG_IEEE80211_BAND_5GHZ + u8 txpwr_lmt_5g_cck_ofdm_state; + u8 txpwr_lmt_5g_20_40_ref; + #endif +#endif + #ifdef CONFIG_DFS_MASTER bool radar_detect_by_others; u8 dfs_master_enabled; @@ -793,8 +866,8 @@ struct rf_ctl_t { u8 radar_detect_bw; u8 radar_detect_offset; - u32 cac_start_time; - u32 cac_end_time; + systime cac_start_time; + systime cac_end_time; u8 dfs_ch_sel_d_flags; @@ -806,8 +879,8 @@ struct rf_ctl_t { #define RTW_CAC_STOPPED 0 #define IS_CAC_STOPPED(rfctl) ((rfctl)->cac_end_time == RTW_CAC_STOPPED) -#define IS_CH_WAITING(rfctl) (!IS_CAC_STOPPED(rfctl) && time_after((unsigned long)(rfctl)->cac_end_time, (unsigned long)rtw_get_current_time())) -#define IS_UNDER_CAC(rfctl) (IS_CH_WAITING(rfctl) && time_after((unsigned long)rtw_get_current_time(), (unsigned long)(rfctl)->cac_start_time)) +#define IS_CH_WAITING(rfctl) (!IS_CAC_STOPPED(rfctl) && time_after((rfctl)->cac_end_time, rtw_get_current_time())) +#define IS_UNDER_CAC(rfctl) (IS_CH_WAITING(rfctl) && time_after(rtw_get_current_time(), (rfctl)->cac_start_time)) #ifdef CONFIG_MBSSID_CAM #define TOTAL_MBID_CAM_NUM 8 @@ -835,16 +908,11 @@ struct halmac_indicator { struct halmacpriv { /* flags */ - /* - * send_general_info - * 0: no need to call halmac_send_general_info() - * 1: need to call halmac_send_general_info() - */ - u8 send_general_info; /* For asynchronous functions */ struct halmac_indicator *indicator; + /* Hardware parameters */ #ifdef CONFIG_SDIO_HCI /* Store hardware tx queue page number setting */ u16 txpage[HW_QUEUE_ENTRY]; @@ -884,7 +952,7 @@ struct dvobj_priv { unsigned char oper_channel; /* saved channel info when call set_channel_bw */ unsigned char oper_bwmode; unsigned char oper_ch_offset;/* PRIME_CHNL_OFFSET */ - u32 on_oper_ch_time; + systime on_oper_ch_time; _adapter *padapters[CONFIG_IFACE_NUMBER];/*IFACE_ID_MAX*/ u8 iface_nums; /* total number of ifaces used runtime */ @@ -892,8 +960,12 @@ struct dvobj_priv { #ifdef CONFIG_AP_MODE u8 nr_ap_if; /* total interface s number of ap/go mode. */ - u32 inter_bcn_space; /* unit:ms */ + u16 inter_bcn_space; /* unit:ms */ _queue ap_if_q; +#ifdef CONFIG_RTW_REPEATER_SON + struct rtw_rson_struct rson_data; +#endif + #endif struct macid_ctl_t macid_ctl; @@ -922,24 +994,38 @@ struct dvobj_priv { ATOMIC_T disable_func; + u8 xmit_block; + _lock xmit_block_lock; + struct pwrctrl_priv pwrctl_priv; struct rtw_traffic_statistics traffic_stat; -#if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) +#ifdef PLATFORM_LINUX + _thread_hdl_ rtnl_lock_holder; + + #if defined(CONFIG_IOCTL_CFG80211) && defined(RTW_SINGLE_WIPHY) struct wiphy *wiphy; -#endif + #endif +#endif /* PLATFORM_LINUX */ #ifdef CONFIG_SWTIMER_BASED_TXBCN _timer txbcn_timer; #endif _timer dynamic_chk_timer; /* dynamic/periodic check timer */ + +#ifdef CONFIG_RTW_NAPI_DYNAMIC + u8 en_napi_dynamic; +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ #ifdef RTW_HALMAC void *halmac; struct halmacpriv hmpriv; #endif /* RTW_HALMAC */ +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + u8 default_port_id; +#endif /*-------- below is for SDIO INTERFACE --------*/ #ifdef INTF_DATA @@ -1024,6 +1110,7 @@ struct dvobj_priv { unsigned long pci_base_addr; /* device I/O address */ #ifdef RTK_129X_PLATFORM + unsigned long ctrl_start; /* PCI MASK addr */ unsigned long mask_addr; @@ -1066,10 +1153,14 @@ struct dvobj_priv { #define DEV_STA_NUM(_dvobj) MSTATE_STA_NUM(&((_dvobj)->iface_state)) #define DEV_STA_LD_NUM(_dvobj) MSTATE_STA_LD_NUM(&((_dvobj)->iface_state)) #define DEV_STA_LG_NUM(_dvobj) MSTATE_STA_LG_NUM(&((_dvobj)->iface_state)) +#define DEV_TDLS_LD_NUM(_dvobj) MSTATE_TDLS_LD_NUM(&((_dvobj)->iface_state)) #define DEV_AP_NUM(_dvobj) MSTATE_AP_NUM(&((_dvobj)->iface_state)) #define DEV_AP_LD_NUM(_dvobj) MSTATE_AP_LD_NUM(&((_dvobj)->iface_state)) #define DEV_ADHOC_NUM(_dvobj) MSTATE_ADHOC_NUM(&((_dvobj)->iface_state)) #define DEV_ADHOC_LD_NUM(_dvobj) MSTATE_ADHOC_LD_NUM(&((_dvobj)->iface_state)) +#define DEV_MESH_NUM(_dvobj) MSTATE_MESH_NUM(&((_dvobj)->iface_state)) +#define DEV_MESH_LD_NUM(_dvobj) MSTATE_MESH_LD_NUM(&((_dvobj)->iface_state)) +#define DEV_SCAN_NUM(_dvobj) MSTATE_SCAN_NUM(&((_dvobj)->iface_state)) #define DEV_WPS_NUM(_dvobj) MSTATE_WPS_NUM(&((_dvobj)->iface_state)) #define DEV_ROCH_NUM(_dvobj) MSTATE_ROCH_NUM(&((_dvobj)->iface_state)) #define DEV_MGMT_TX_NUM(_dvobj) MSTATE_MGMT_TX_NUM(&((_dvobj)->iface_state)) @@ -1190,13 +1281,13 @@ typedef struct loopbackdata { } LOOPBACKDATA, *PLOOPBACKDATA; #endif -#ifdef CONFIG_80211N_HT +struct tsf_info { + u8 sync_port;/*tsf sync from portx*/ + u8 offset; /*tsf timer offset*/ +}; + #define ADAPTER_TX_BW_2G(adapter) BW_MODE_2G((adapter)->driver_tx_bw_mode) #define ADAPTER_TX_BW_5G(adapter) BW_MODE_5G((adapter)->driver_tx_bw_mode) -#else -#define ADAPTER_TX_BW_2G(adapter) 0x0 -#define ADAPTER_TX_BW_5G(adapter) 0x0 -#endif /* CONFIG_80211N_HT */ struct _ADAPTER { int DriverState;/* for disable driver using module, use dongle to replace module. */ @@ -1210,6 +1301,10 @@ struct _ADAPTER { struct mlme_ext_priv mlmeextpriv; struct cmd_priv cmdpriv; struct evt_priv evtpriv; + +#ifdef CONFIG_RTW_80211K + struct rm_priv rmpriv; +#endif /* struct io_queue *pio_queue; */ struct io_priv iopriv; struct xmit_priv xmitpriv; @@ -1218,8 +1313,10 @@ struct _ADAPTER { struct security_priv securitypriv; _lock security_key_mutex; /* add for CONFIG_IEEE80211W, none 11w also can use */ struct registry_priv registrypriv; - +#ifdef CONFIG_RTW_LED struct led_priv ledpriv; +#endif + #ifdef CONFIG_RTW_NAPI struct napi_struct napi; @@ -1230,10 +1327,6 @@ struct _ADAPTER { struct mp_priv mppriv; #endif -#ifdef CONFIG_DRVEXT_MODULE - struct drvext_priv drvextpriv; -#endif - #ifdef CONFIG_AP_MODE struct hostapd_priv *phostapdpriv; #endif @@ -1259,6 +1352,9 @@ struct _ADAPTER { RT_WAPI_T wapiInfo; #endif +#ifdef CONFIG_RTW_REPEATER_SON + u8 rtw_rson_scanstage; +#endif #ifdef CONFIG_WFD struct wifi_display_info wfd_info; @@ -1272,7 +1368,7 @@ struct _ADAPTER { PVOID HalData; u32 hal_data_sz; - struct hal_ops HalFunc; + struct hal_ops hal_func; u32 IsrContent; u32 ImrContent; @@ -1290,22 +1386,21 @@ struct _ADAPTER { } gpiointpriv; #endif _thread_hdl_ cmdThread; +#ifdef CONFIG_EVENT_THREAD_MODE _thread_hdl_ evtThread; +#endif +#ifdef CONFIG_XMIT_THREAD_MODE _thread_hdl_ xmitThread; +#endif +#ifdef CONFIG_RECV_THREAD_MODE _thread_hdl_ recvThread; - +#endif u8 registered; #ifndef PLATFORM_LINUX NDIS_STATUS(*dvobj_init)(struct dvobj_priv *dvobj); void (*dvobj_deinit)(struct dvobj_priv *dvobj); #endif - u32(*intf_init)(struct dvobj_priv *dvobj); - void (*intf_deinit)(struct dvobj_priv *dvobj); - int (*intf_alloc_irq)(struct dvobj_priv *dvobj); - void (*intf_free_irq)(struct dvobj_priv *dvobj); - - void (*intf_start)(_adapter *adapter); void (*intf_stop)(_adapter *adapter); @@ -1365,13 +1460,11 @@ struct _ADAPTER { u8 netif_up; - u8 bFWReady; - u8 bBTFWReady; u8 bLinkInfoDump; - u8 bRxRSSIDisplay; /* Added by Albert 2012/10/26 */ /* The driver will show up the desired channel number when this flag is 1. */ u8 bNotifyChannelChange; + u8 bsta_tp_dump; #ifdef CONFIG_P2P /* Added by Albert 2012/12/06 */ /* The driver will show the current P2P status when the upper application reads it. */ @@ -1388,6 +1481,7 @@ struct _ADAPTER { ** refer to iface_id if iface_nums>2 and isprimary is false and the adapter_type value is 0xff.*/ u8 adapter_type;/*be used in Multi-interface to recognize whether is PRIMARY_ADAPTER or not(PRIMARY_ADAPTER/VIRTUAL_ADAPTER) .*/ u8 hw_port; /*interface port type, it depends on HW port */ + struct tsf_info tsf; /*extend to support multi interface*/ @@ -1420,13 +1514,23 @@ struct _ADAPTER { #ifdef CONFIG_MAC_LOOPBACK_DRIVER PLOOPBACKDATA ploopback; #endif +#ifdef CONFIG_AP_MODE + u8 bmc_tx_rate; +#endif /* for debug purpose */ u8 fix_rate; u8 fix_bw; u8 data_fb; /* data rate fallback, valid only when fix_rate is not 0xff */ - + u8 power_offset; u8 driver_tx_bw_mode; + u8 rsvd_page_offset; + u8 rsvd_page_num; +#ifdef CONFIG_SUPPORT_FIFO_DUMP + u8 fifo_sel; + u32 fifo_addr; + u32 fifo_size; +#endif u8 driver_vcs_en; /* Enable=1, Disable=0 driver control vrtl_carrier_sense for tx */ u8 driver_vcs_type;/* force 0:disable VCS, 1:RTS-CTS, 2:CTS-to-self when vcs_en=1. */ @@ -1435,7 +1539,11 @@ struct _ADAPTER { u8 driver_rx_ampdu_spacing; /* driver control Rx AMPDU Density */ u8 fix_rx_ampdu_accept; u8 fix_rx_ampdu_size; /* 0~127, TODO:consider each sta and each TID */ - unsigned char in_cta_test; +#ifdef CONFIG_TX_AMSDU + u8 tx_amsdu; + u16 tx_amsdu_rate; +#endif + u8 driver_tx_max_agg_num; /*fix tx desc max agg num , 0xff: disable drv ctrl*/ #ifdef DBG_RX_COUNTER_DUMP u8 dump_rx_cnt_mode;/*BIT0:drv,BIT1:mac,BIT2:phy*/ u32 drv_rx_cnt_ok; @@ -1465,8 +1573,10 @@ struct _ADAPTER { #endif #define adapter_to_rfctl(adapter) dvobj_to_rfctl(adapter_to_dvobj((adapter))) +#define adapter_to_macidctl(adapter) dvobj_to_macidctl(adapter_to_dvobj((adapter))) #define adapter_mac_addr(adapter) (adapter->mac_addr) +#define adapter_to_chset(adapter) (adapter_to_rfctl((adapter))->channel_set) #define mlme_to_adapter(mlme) container_of((mlme), struct _ADAPTER, mlmepriv) #define tdls_info_to_adapter(tdls) container_of((tdls), struct _ADAPTER, tdlsinfo) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_ce.h index fc2638920131..c00dea8e6b35 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_ce.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __DRV_TYPES_CE_H__ #define __DRV_TYPES_CE_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_gspi.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_gspi.h index f0efc8c99c60..c22c4972232d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_gspi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_gspi.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __DRV_TYPES_GSPI_H__ #define __DRV_TYPES_GSPI_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_linux.h index 812b7440d4b0..91ca68b39c26 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_linux.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __DRV_TYPES_LINUX_H__ #define __DRV_TYPES_LINUX_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_pci.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_pci.h index c03657fdcb9b..a3a492708860 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_pci.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_pci.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __DRV_TYPES_PCI_H__ #define __DRV_TYPES_PCI_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_sdio.h index b3e8b47c5cd6..9feca1216820 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_sdio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_sdio.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __DRV_TYPES_SDIO_H__ #define __DRV_TYPES_SDIO_H__ @@ -42,6 +37,10 @@ #include #endif +#define RTW_SDIO_CLK_33M 33000000 +#define RTW_SDIO_CLK_40M 40000000 +#define RTW_SDIO_CLK_80M 80000000 +#define RTW_SDIO_CLK_160M 160000000 typedef struct sdio_data { u8 func_number; @@ -54,6 +53,8 @@ typedef struct sdio_data { struct sdio_func *func; _thread_hdl_ sys_sdio_irq_thd; unsigned int clock; + unsigned int timing; + u8 sd3_bus_mode; #endif #ifdef PLATFORM_OS_XP @@ -86,6 +87,4 @@ typedef struct sdio_data { #define RTW_SDIO_ADDR_F0_CLR(a) (a&~RTW_SDIO_ADDR_F0_BIT) #define RTW_SDIO_ADDR_F0_CHK(a) (a&RTW_SDIO_ADDR_F0_BIT ? 1 : 0) -#define RTW_SDIO_CLK_40M 40000000 - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_xp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_xp.h index 93766bebedc3..81c45047ae11 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_xp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/drv_types_xp.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __DRV_TYPES_XP_H__ #define __DRV_TYPES_XP_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ethernet.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ethernet.h index e1276050abb8..2bafa4d98edc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ethernet.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ethernet.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /*! \file */ #ifndef __INC_ETHERNET_H #define __INC_ETHERNET_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_hal.h index 98fec090a7f3..6da0f071d499 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __GSPI_HAL_H__ #define __GSPI_HAL_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops.h index 681291531a21..bcfaad2e0bba 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __GSPI_OPS_H__ #define __GSPI_OPS_H__ @@ -179,7 +174,7 @@ extern u8 HalQueryTxBufferStatus8723ASdio(PADAPTER padapter); extern u8 CheckIPSStatus(PADAPTER padapter); #endif /* CONFIG_RTL8188E */ #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) - extern u8 RecvOnePkt(PADAPTER padapter, u32 size); + extern u8 RecvOnePkt(PADAPTER padapter); #endif /* CONFIG_WOWLAN */ #endif /* __GSPI_OPS_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops_linux.h index 9bd18da14662..0ba263de8fd7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_ops_linux.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_OPS_LINUX_H__ #define __SDIO_OPS_LINUX_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_osintf.h index e51d2e4f4784..6393f779dcf8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/gspi_osintf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_OSINTF_H__ #define __SDIO_OSINTF_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/h2clbk.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/h2clbk.h index e7f0df55e74d..4e22afcd8652 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/h2clbk.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/h2clbk.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _H2CLBK_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex.h index 5ba84edfafe9..03021fee323a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_BTCOEX_H__ #define __HAL_BTCOEX_H__ @@ -42,6 +37,8 @@ void hal_btcoex_SetPgAntNum(PADAPTER padapter, u8 antNum); u8 hal_btcoex_Initialize(PADAPTER padapter); void hal_btcoex_PowerOnSetting(PADAPTER padapter); +void hal_btcoex_AntInfoSetting(PADAPTER padapter); +void hal_btcoex_PowerOffSetting(PADAPTER padapter); void hal_btcoex_PreLoadFirmware(PADAPTER padapter); void hal_btcoex_InitHwConfig(PADAPTER padapter, u8 bWifiOnly); @@ -80,7 +77,7 @@ void hal_btcoex_SetBtPatchVersion(PADAPTER, u16 btHciVer, u16 btPatchVer); void hal_btcoex_SetHciVersion(PADAPTER, u16 hciVersion); void hal_btcoex_SendScanNotify(PADAPTER, u8 type); void hal_btcoex_StackUpdateProfileInfo(void); -void hal_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON); +void hal_btcoex_pta_off_on_notify(PADAPTER padapter, u8 bBTON); void hal_btcoex_SetAntIsolationType(PADAPTER padapter, u8 anttype); #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE int hal_btcoex_AntIsolationConfig_ParaFile(IN PADAPTER Adapter, IN char *pFileName); @@ -90,4 +87,11 @@ u16 hal_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data); u16 hal_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val); void hal_btcoex_set_rfe_type(u8 type); void hal_btcoex_switchband_notify(u8 under_scan, u8 band_type); +void hal_btcoex_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length); +void hal_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id); + +#ifdef CONFIG_RF4CE_COEXIST +void hal_btcoex_set_rf4ce_link_state(u8 state); +u8 hal_btcoex_get_rf4ce_link_state(void); +#endif #endif /* !__HAL_BTCOEX_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex_wifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex_wifionly.h new file mode 100644 index 000000000000..8dc76ea6cc8a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_btcoex_wifionly.h @@ -0,0 +1,62 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __HALBTC_WIFIONLY_H__ +#define __HALBTC_WIFIONLY_H__ + +#include +#include + +typedef enum _WIFIONLY_CHIP_INTERFACE { + WIFIONLY_INTF_UNKNOWN = 0, + WIFIONLY_INTF_PCI = 1, + WIFIONLY_INTF_USB = 2, + WIFIONLY_INTF_SDIO = 3, + WIFIONLY_INTF_MAX +} WIFIONLY_CHIP_INTERFACE, *PWIFIONLY_CHIP_INTERFACE; + +typedef enum _WIFIONLY_CUSTOMER_ID { + CUSTOMER_NORMAL = 0, + CUSTOMER_HP_1 = 1 +} WIFIONLY_CUSTOMER_ID, *PWIFIONLY_CUSTOMER_ID; + +struct wifi_only_haldata { + u16 customer_id; + u8 efuse_pg_antnum; + u8 efuse_pg_antpath; + u8 rfe_type; + u8 ant_div_cfg; +}; + +struct wifi_only_cfg { + PVOID Adapter; + struct wifi_only_haldata haldata_info; + WIFIONLY_CHIP_INTERFACE chip_interface; +}; + +void halwifionly_write1byte(PVOID pwifionlyContext, u32 RegAddr, u8 Data); +void halwifionly_write2byte(PVOID pwifionlyContext, u32 RegAddr, u16 Data); +void halwifionly_write4byte(PVOID pwifionlyContext, u32 RegAddr, u32 Data); +u8 halwifionly_read1byte(PVOID pwifionlyContext, u32 RegAddr); +u16 halwifionly_read2byte(PVOID pwifionlyContext, u32 RegAddr); +u32 halwifionly_read4byte(PVOID pwifionlyContext, u32 RegAddr); +void halwifionly_bitmaskwrite1byte(PVOID pwifionlyContext, u32 regAddr, u8 bitMask, u8 data); +void halwifionly_phy_set_rf_reg(PVOID pwifionlyContext, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data); +void halwifionly_phy_set_bb_reg(PVOID pwifionlyContext, u32 RegAddr, u32 BitMask, u32 Data); +void hal_btcoex_wifionly_switchband_notify(PADAPTER padapter); +void hal_btcoex_wifionly_scan_notify(PADAPTER padapter); +void hal_btcoex_wifionly_hw_config(PADAPTER padapter); +void hal_btcoex_wifionly_initlizevariables(PADAPTER padapter); +void hal_btcoex_wifionly_AntInfoSetting(PADAPTER padapter); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com.h index 4c78f6697097..7ba3815ec362 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_COMMON_H__ #define __HAL_COMMON_H__ @@ -286,6 +281,9 @@ struct dbg_rx_counter { #ifdef CONFIG_MI_WITH_MBSSID_CAM void rtw_hal_set_macaddr_mbid(_adapter *adapter, u8 *mac_addr); void rtw_hal_change_macaddr_mbid(_adapter *adapter, u8 *mac_addr); + #ifdef CONFIG_SWTIMER_BASED_TXBCN + u16 rtw_hal_bcn_interval_adjust(_adapter *adapter, u16 bcn_interval); + #endif #endif void rtw_dump_mac_rx_counters(_adapter *padapter, struct dbg_rx_counter *rx_counter); @@ -332,6 +330,10 @@ void rtw_hal_config_rftype(PADAPTER padapter); #define WL_FUNC_FTM BIT3 #define WL_FUNC_BIT_NUM 4 +#define TBTT_PROHIBIT_SETUP_TIME 0x04 /* 128us, unit is 32us */ +#define TBTT_PROHIBIT_HOLD_TIME 0x80 /* 4ms, unit is 32us*/ +#define TBTT_PROHIBIT_HOLD_TIME_STOP_BCN 0x64 /* 3.2ms unit is 32us*/ + int hal_spec_init(_adapter *adapter); void dump_hal_spec(void *sel, _adapter *adapter); @@ -345,7 +347,7 @@ u8 hal_largest_bw(_adapter *adapter, u8 in_bw); bool hal_chk_wl_func(_adapter *adapter, u8 func); -u8 hal_com_config_channel_plan( +void hal_com_config_channel_plan( IN PADAPTER padapter, IN char *hw_alpha2, IN u8 hw_chplan, @@ -365,7 +367,7 @@ HAL_IsLegalChannel( u8 MRateToHwRate(u8 rate); -u8 HwRateToMRate(u8 rate); +u8 hw_rate_to_m_rate(u8 rate); void HalSetBrateCfg( IN PADAPTER Adapter, @@ -378,7 +380,8 @@ Hal_MappingOutPipe( IN u8 NumOutPipe ); - +void rtw_dump_fw_info(void *sel, _adapter *adapter); +void rtw_restore_hw_port_cfg(_adapter *adapter); void rtw_restore_mac_addr(_adapter *adapter);/*set mac addr when hal_init for all iface*/ void rtw_hal_dump_macaddr(void *sel, _adapter *adapter); @@ -394,9 +397,12 @@ void rtw_hal_c2h_pkt_pre_hdl(_adapter *adapter, u8 *buf, u16 len); void rtw_hal_c2h_pkt_hdl(_adapter *adapter, u8 *buf, u16 len); #endif -u8 rtw_hal_networktype_to_raid(_adapter *adapter, struct sta_info *psta); u8 rtw_get_mgntframe_raid(_adapter *adapter, unsigned char network_type); -void rtw_hal_update_sta_rate_mask(PADAPTER padapter, struct sta_info *psta); + +void rtw_hal_update_sta_wset(_adapter *adapter, struct sta_info *psta); +s8 rtw_get_sta_rx_nss(_adapter *adapter, struct sta_info *psta); +s8 rtw_get_sta_tx_nss(_adapter *adapter, struct sta_info *psta); +void rtw_hal_update_sta_ra_info(PADAPTER padapter, struct sta_info *psta); /* access HW only */ u32 rtw_sec_read_cam(_adapter *adapter, u8 addr); @@ -406,17 +412,18 @@ void rtw_sec_write_cam_ent(_adapter *adapter, u8 id, u16 ctrl, u8 *mac, u8 *key) void rtw_sec_clr_cam_ent(_adapter *adapter, u8 id); bool rtw_sec_read_cam_is_gk(_adapter *adapter, u8 id); -void rtw_hal_set_msr(_adapter *adapter, u8 net_type); -void rtw_hal_set_macaddr_port(_adapter *adapter, u8 *val); -void rtw_hal_get_macaddr_port(_adapter *adapter, u8 *mac_addr); +u8 rtw_hal_rcr_check(_adapter *adapter, u32 check_bit); -void rtw_hal_set_bssid(_adapter *adapter, u8 *val); +u8 rtw_hal_rcr_add(_adapter *adapter, u32 add); +u8 rtw_hal_rcr_clear(_adapter *adapter, u32 clear); +void rtw_hal_rcr_set_chk_bssid(_adapter *adapter, u8 self_action); void hw_var_port_switch(_adapter *adapter); -void SetHwReg(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHwReg(PADAPTER padapter, u8 variable, u8 *val); void GetHwReg(PADAPTER padapter, u8 variable, u8 *val); void rtw_hal_check_rxfifo_full(_adapter *adapter); +void rtw_hal_reqtxrpt(_adapter *padapter, u8 macid); u8 SetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); u8 GetHalDefVar(_adapter *adapter, HAL_DEF_VARIABLE variable, void *value); @@ -502,38 +509,26 @@ void rtw_dump_cur_efuse(PADAPTER padapter); void dm_DynamicUsbTxAgg(_adapter *padapter, u8 from_timer); u8 rtw_hal_busagg_qsel_check(_adapter *padapter, u8 pre_qsel, u8 next_qsel); -void GetHalODMVar( - PADAPTER Adapter, - HAL_ODM_VARIABLE eVariable, - PVOID pValue1, - PVOID pValue2); -void SetHalODMVar( - PADAPTER Adapter, - HAL_ODM_VARIABLE eVariable, - PVOID pValue1, - BOOLEAN bSet); -#ifdef CONFIG_BACKGROUND_NOISE_MONITOR -struct noise_info { - u8 bPauseDIG; - u8 IGIValue; - u32 max_time;/* ms */ - u8 chan; -}; -#endif - -void rtw_get_noise(_adapter *padapter); -u8 rtw_get_current_tx_rate(_adapter *padapter, u8 macid); -u8 rtw_get_current_tx_sgi(_adapter *padapter, u8 macid); +u8 rtw_get_current_tx_rate(_adapter *padapter, struct sta_info *psta); +u8 rtw_get_current_tx_sgi(_adapter *padapter, struct sta_info *psta); void rtw_hal_construct_NullFunctionData(PADAPTER, u8 *pframe, u32 *pLength, u8 *StaAddr, u8 bQoS, u8 AC, u8 bEosp, u8 bForcePowerSave); void rtw_hal_set_fw_rsvd_page(_adapter *adapter, bool finished); +u8 rtw_hal_get_rsvd_page_num(struct _ADAPTER *adapter); + +#ifdef CONFIG_TSF_RESET_OFFLOAD +int rtw_hal_reset_tsf(_adapter *adapter, u8 reset_port); +#endif #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW s32 rtw_hal_ch_sw_oper_offload(_adapter *padapter, u8 channel, u8 channel_offset, u16 bwmode); #endif #endif +#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) +s32 rtw_hal_set_wifi_port_id_cmd(_adapter *adapter); +#endif #ifdef CONFIG_GPIO_API u8 rtw_hal_get_gpio(_adapter *adapter, u8 gpio_num); @@ -550,52 +545,9 @@ void rtw_hal_ch_sw_iqk_info_restore(_adapter *padapter, u8 ch_sw_use_case); #ifdef CONFIG_GPIO_WAKEUP void rtw_hal_switch_gpio_wl_ctrl(_adapter *padapter, u8 index, u8 enable); void rtw_hal_set_output_gpio(_adapter *padapter, u8 index, u8 outputval); + void rtw_hal_set_input_gpio(_adapter *padapter, u8 index); #endif -typedef enum _HAL_PHYDM_OPS { - HAL_PHYDM_DIS_ALL_FUNC, - HAL_PHYDM_FUNC_SET, - HAL_PHYDM_FUNC_CLR, - HAL_PHYDM_ABILITY_BK, - HAL_PHYDM_ABILITY_RESTORE, - HAL_PHYDM_ABILITY_SET, - HAL_PHYDM_ABILITY_GET, -} HAL_PHYDM_OPS; - - -#define DYNAMIC_FUNC_DISABLE (0x0) -u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability); - -#define rtw_phydm_func_disable_all(adapter) \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0) - -#define rtw_phydm_func_for_offchannel(adapter) \ - do { \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0); \ - if (rtw_odm_adaptivity_needed(adapter)) \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ADAPTIVITY); \ - } while (0) - -#define rtw_phydm_func_set(adapter, ability) \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ability) - -#define rtw_phydm_func_clr(adapter, ability) \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_CLR, ability) - -#define rtw_phydm_ability_backup(adapter) \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_BK, 0) - -#define rtw_phydm_ability_restore(adapter) \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_RESTORE, 0) - -#define rtw_phydm_ability_set(adapter, ability) \ - rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_SET, ability) - -static inline u32 rtw_phydm_ability_get(_adapter *adapter) -{ - return rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_GET, 0); -} - #ifdef CONFIG_LOAD_PHY_PARA_FROM_FILE extern char *rtw_phy_file_path; extern char rtw_phy_para_file_path[PATH_LENGTH_MAX]; @@ -604,10 +556,6 @@ static inline u32 rtw_phydm_ability_get(_adapter *adapter) void update_IOT_info(_adapter *padapter); -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - void rtw_acs_start(_adapter *padapter, bool bStart); -#endif - void hal_set_crystal_cap(_adapter *adapter, u8 crystal_cap); void rtw_hal_correct_tsf(_adapter *padapter, u8 hw_port, u64 tsf); @@ -629,7 +577,80 @@ void StopTxBeacon(_adapter *padapter); #endif #ifdef CONFIG_LPS_PG +#define LPSPG_RSVD_PAGE_SET_MACID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 0, 8, _value)/*used macid*/ +#define LPSPG_RSVD_PAGE_SET_MBSSCAMID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 8, 8, _value)/*used BSSID CAM entry*/ +#define LPSPG_RSVD_PAGE_SET_PMC_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 16, 8, _value)/*Max used Pattern Match CAM entry*/ +#define LPSPG_RSVD_PAGE_SET_MU_RAID_GID(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x00, 24, 8, _value)/*Max MU rate table Group ID*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x04, 0, 8, _value)/*used Security CAM entry number*/ +#define LPSPG_RSVD_PAGE_SET_DRV_RSVDPAGE_NUM(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x04, 8, 8, _value)/*Txbuf used page number for fw offload*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID1(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 0, 8, _value)/*used Security CAM entry -1*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID2(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 8, 8, _value)/*used Security CAM entry -2*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID3(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 16, 8, _value)/*used Security CAM entry -3*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID4(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x08, 24, 8, _value)/*used Security CAM entry -4*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID5(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 0, 8, _value)/*used Security CAM entry -5*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID6(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 8, 8, _value)/*used Security CAM entry -6*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID7(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 16, 8, _value)/*used Security CAM entry -7*/ +#define LPSPG_RSVD_PAGE_SET_SEC_CAM_ID8(_rsvd_pag, _value) SET_BITS_TO_LE_4BYTE(_rsvd_pag+0x0C, 24, 8, _value)/*used Security CAM entry -8*/ +enum lps_pg_hdl_id { + LPS_PG_INFO_CFG = 0, + LPS_PG_REDLEMEM, + LPS_PG_RESEND_H2C, +}; + u8 rtw_hal_set_lps_pg_info(_adapter *adapter); #endif +int rtw_hal_get_rsvd_page(_adapter *adapter, u32 page_offset, u32 page_num, u8 *buffer, u32 buffer_size); + +#ifdef CONFIG_WOWLAN +struct rtl_wow_pattern { + u16 crc; + u8 type; + u32 mask[4]; +}; +void rtw_wow_pattern_cam_dump(_adapter *adapter); + +#ifdef CONFIG_WOW_PATTERN_HW_CAM +void rtw_wow_pattern_read_cam_ent(_adapter *adapter, u8 id, struct rtl_wow_pattern *context); +void rtw_dump_wow_pattern(void *sel, struct rtl_wow_pattern *pwow_pattern, u8 idx); +#endif + +struct rtw_ndp_info { + u8 enable:1; + u8 check_remote_ip:1; /* Need to Check Sender IP or not */ + u8 rsvd:6; + u8 num_of_target_ip; /* Number of Check IP which NA query IP */ + u8 target_link_addr[6]; /* DUT's MAC address */ + u8 remote_ipv6_addr[16]; /* Just respond IP */ + u8 target_ipv6_addr[16]; /* target IP */ +}; +#endif +void rtw_dump_phy_cap(void *sel, _adapter *adapter); +void rtw_dump_rsvd_page(void *sel, _adapter *adapter, u8 page_offset, u8 page_num); +#ifdef CONFIG_SUPPORT_FIFO_DUMP +void rtw_dump_fifo(void *sel, _adapter *adapter, u8 fifo_sel, u32 fifo_addr, u32 fifo_size); +#endif + +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT +s32 rtw_hal_set_default_port_id_cmd(_adapter *adapter, u8 mac_id); +s32 rtw_set_default_port_id(_adapter *adapter); +s32 rtw_set_ps_rsvd_page(_adapter *adapter); +#endif + +#ifdef CONFIG_P2P_PS +#ifdef RTW_HALMAC +void rtw_set_p2p_ps_offload_cmd(_adapter *adapter, u8 p2p_ps_state); +#endif +#endif +s16 translate_dbm_to_percentage(s16 signal); + +#ifdef CONFIG_SWTIMER_BASED_TXBCN +#ifdef CONFIG_BCN_RECOVERY +u8 rtw_ap_bcn_recovery(_adapter *padapter); +#endif +#ifdef CONFIG_BCN_XMIT_PROTECT +u8 rtw_ap_bcn_queue_empty_check(_adapter *padapter, u32 txbcn_timer_ms); +#endif +#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ + #endif /* __HAL_COMMON_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_h2c.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_h2c.h index 70ebc46e44a0..d1b26c8b9ae5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_h2c.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_h2c.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __COMMON_H2C_H__ #define __COMMON_H2C_H__ @@ -43,7 +38,7 @@ enum h2c_cmd { H2C_MCC_UPDATE_PARAM = 0x15, H2C_MCC_MACID_BITMAP = 0x16, H2C_MCC_LOCATION = 0x10, - H2C_MCC_INFO = 0x18, + H2C_MCC_CTRL = 0x18, H2C_MCC_NOA_PARAM = 0x19, H2C_MCC_IQK_PARAM = 0x1A, #endif /* CONFIG_MCC_MODE */ @@ -66,6 +61,10 @@ enum h2c_cmd { #ifdef CONFIG_LPS_PG H2C_LPS_PG_INFO = 0x2B, #endif + +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT + H2C_DEFAULT_PORT_ID = 0x2C, +#endif /* Dynamic Mechanism Class: 010 */ H2C_MACID_CFG = 0x40, H2C_TXBF = 0x41, @@ -92,7 +91,9 @@ enum h2c_cmd { H2C_BT_CONTROL = 0x68, H2C_BT_WIFI_CTRL = 0x69, H2C_BT_FW_PATCH = 0x6A, - +#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) + H2C_BTC_WL_PORT_ID = 0x71, +#endif /* WOWLAN Class: 100 */ H2C_WOWLAN = 0x80, H2C_REMOTE_WAKE_CTRL = 0x81, @@ -114,8 +115,14 @@ enum h2c_cmd { H2C_MAXID, }; +#define H2C_INACTIVE_PS_LEN 3 #define H2C_RSVDPAGE_LOC_LEN 5 +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT +#define H2C_DEFAULT_PORT_ID_LEN 2 +#define H2C_MEDIA_STATUS_RPT_LEN 4 +#else #define H2C_MEDIA_STATUS_RPT_LEN 3 +#endif #define H2C_KEEP_ALIVE_CTRL_LEN 2 #define H2C_DISCON_DECISION_LEN 3 #define H2C_AP_OFFLOAD_LEN 3 @@ -125,22 +132,21 @@ enum h2c_cmd { #define H2C_PSTUNEPARAM_LEN 4 #define H2C_MACID_CFG_LEN 7 #define H2C_BTMP_OPER_LEN 5 -#define H2C_WOWLAN_LEN 5 +#define H2C_WOWLAN_LEN 6 #define H2C_REMOTE_WAKE_CTRL_LEN 3 #define H2C_AOAC_GLOBAL_INFO_LEN 2 #define H2C_AOAC_RSVDPAGE_LOC_LEN 7 #define H2C_SCAN_OFFLOAD_CTRL_LEN 4 #define H2C_BT_FW_PATCH_LEN 6 #define H2C_RSSI_SETTING_LEN 4 -#define H2C_AP_REQ_TXRPT_LEN 2 +#define H2C_AP_REQ_TXRPT_LEN 3 #define H2C_FORCE_BT_TXPWR_LEN 3 #define H2C_BCN_RSVDPAGE_LEN 5 #define H2C_PROBERSP_RSVDPAGE_LEN 5 #define H2C_P2PRSVDPAGE_LOC_LEN 5 #define H2C_P2P_OFFLOAD_LEN 3 -#define H2C_INACTIVE_PS_LEN 4 #ifdef CONFIG_MCC_MODE - #define H2C_MCC_INFO_LEN 7 + #define H2C_MCC_CTRL_LEN 7 #define H2C_MCC_LOCATION_LEN 3 #define H2C_MCC_MACID_BITMAP_LEN 6 #define H2C_MCC_UPDATE_INFO_LEN 4 @@ -155,9 +161,15 @@ enum h2c_cmd { #define H2C_LPS_POFF_CTRL_LEN 1 #define H2C_LPS_POFF_PARAM_LEN 5 #endif -#define eqMacAddr(a, b) (((a)[0] == (b)[0] && (a)[1] == (b)[1] && (a)[2] == (b)[2] && (a)[3] == (b)[3] && (a)[4] == (b)[4] && (a)[5] == (b)[5]) ? 1 : 0) -#define cpMacAddr(des, src) ((des)[0] = (src)[0], (des)[1] = (src)[1], (des)[2] = (src)[2], (des)[3] = (src)[3], (des)[4] = (src)[4], (des)[5] = (src)[5]) + +#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) +#define H2C_BTC_WL_PORT_ID_LEN 1 +#endif +#define eq_mac_addr(a, b) (((a)[0] == (b)[0] && (a)[1] == (b)[1] && (a)[2] == (b)[2] && (a)[3] == (b)[3] && (a)[4] == (b)[4] && (a)[5] == (b)[5]) ? 1 : 0) +#define cp_mac_addr(des, src) ((des)[0] = (src)[0], (des)[1] = (src)[1], (des)[2] = (src)[2], (des)[3] = (src)[3], (des)[4] = (src)[4], (des)[5] = (src)[5]) #define cpIpAddr(des, src) ((des)[0] = (src)[0], (des)[1] = (src)[1], (des)[2] = (src)[2], (des)[3] = (src)[3]) + + #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) /* * ARP packet @@ -167,9 +179,9 @@ enum h2c_cmd { /* ARP element */ #define GET_ARP_PKT_OPERATION(__pHeader) ReadLE2Byte(((u8 *)(__pHeader)) + 6) -#define GET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+8) +#define GET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cp_mac_addr((u8 *)(_val), ((u8 *)(__pHeader))+8) #define GET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+14) -#define GET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr((u8 *)(_val), ((u8 *)(__pHeader))+18) +#define GET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cp_mac_addr((u8 *)(_val), ((u8 *)(__pHeader))+18) #define GET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr((u8 *)(_val), ((u8 *)(__pHeader))+24) #define SET_ARP_PKT_HW(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 0, __Value) @@ -177,9 +189,9 @@ enum h2c_cmd { #define SET_ARP_PKT_HW_ADDR_LEN(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 4, __Value) #define SET_ARP_PKT_PROTOCOL_ADDR_LEN(__pHeader, __Value) WriteLE1Byte(((u8 *)(__pHeader)) + 5, __Value) #define SET_ARP_PKT_OPERATION(__pHeader, __Value) WriteLE2Byte(((u8 *)(__pHeader)) + 6, __Value) -#define SET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+8, (u8 *)(_val)) +#define SET_ARP_PKT_SENDER_MAC_ADDR(__pHeader, _val) cp_mac_addr(((u8 *)(__pHeader))+8, (u8 *)(_val)) #define SET_ARP_PKT_SENDER_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+14, (u8 *)(_val)) -#define SET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cpMacAddr(((u8 *)(__pHeader))+18, (u8 *)(_val)) +#define SET_ARP_PKT_TARGET_MAC_ADDR(__pHeader, _val) cp_mac_addr(((u8 *)(__pHeader))+18, (u8 *)(_val)) #define SET_ARP_PKT_TARGET_IP_ADDR(__pHeader, _val) cpIpAddr(((u8 *)(__pHeader))+24, (u8 *)(_val)) #define FW_WOWLAN_FUN_EN BIT(0) @@ -223,6 +235,7 @@ enum h2c_cmd { #define SET_H2CCMD_MSRRPT_PARM_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 4, 4, (__Value)) #define SET_H2CCMD_MSRRPT_PARM_MACID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 1, 0, 8, (__Value)) #define SET_H2CCMD_MSRRPT_PARM_MACID_END(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 2, 0, 8, (__Value)) +#define SET_H2CCMD_MSRRPT_PARM_PORT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 3, 0, 3, (__Value)) #define GET_H2CCMD_MSRRPT_PARM_OPMODE(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 0, 1) #define GET_H2CCMD_MSRRPT_PARM_MIRACAST(__pH2CCmd) LE_BITS_TO_1BYTE(((u8 *)(__pH2CCmd)), 2, 1) @@ -236,7 +249,8 @@ enum h2c_cmd { #define H2C_MSR_ROLE_GO 4 #define H2C_MSR_ROLE_TDLS 5 #define H2C_MSR_ROLE_ADHOC 6 -#define H2C_MSR_ROLE_MAX 7 +#define H2C_MSR_ROLE_MESH 7 +#define H2C_MSR_ROLE_MAX 8 extern const char *const _h2c_msr_role_str[]; #define h2c_msr_role_str(role) (((role) >= H2C_MSR_ROLE_MAX) ? _h2c_msr_role_str[H2C_MSR_ROLE_MAX] : _h2c_msr_role_str[(role)]) @@ -255,11 +269,13 @@ s32 rtw_hal_set_FwMediaStatusRpt_range_cmd(_adapter *adapter, bool opmode, bool #define SET_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) #define SET_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) #define SET_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) +#define SET_H2CCMD_KEEPALIVE_PARM_PORT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 3, 3, __Value) #define SET_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) /* _DISCONNECT_DECISION_CMD_0x04 */ #define SET_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) #define SET_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) +#define SET_H2CCMD_DISCONDECISION_PORT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 3, __Value) #define SET_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) #define SET_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) @@ -314,20 +330,6 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #define SET_H2CCMD_AP_WOW_PS_RF(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) #define SET_H2CCMD_AP_WOW_PS_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -/* INACTIVE_PS 0x27, duration unit is TBTT */ -#define SET_H2CCMD_INACTIVE_PS_EN(__pH2CCmd, __Value) \ - SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -#define SET_H2CCMD_INACTIVE_PS_IGNORE_PS(__pH2CCmd, __Value) \ - SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -#define SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_EN(__pH2CCmd, __Value) \ - SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -#define SET_H2CCMD_INACTIVE_PS_FREQ(__pH2CCmd, __Value) \ - SET_BITS_TO_LE_1BYTE(__pH2CCmd + 1, 0, 8, __Value) -#define SET_H2CCMD_INACTIVE_PS_DURATION(__pH2CCmd, __Value) \ - SET_BITS_TO_LE_1BYTE(__pH2CCmd + 2, 0, 8, __Value) -#define SET_H2CCMD_INACTIVE_PS_PERIOD_SCAN_TIME(__pH2CCmd, __Value) \ - SET_BITS_TO_LE_1BYTE(__pH2CCmd + 3, 0, 8, __Value) - #ifdef CONFIG_LPS_POFF /*PARTIAL OFF Control 0x29*/ #define SET_H2CCMD_LPS_POFF_CTRL_EN(__pH2CCmd, __Value) \ @@ -347,6 +349,12 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); SET_BITS_TO_LE_1BYTE(__pH2CCmd+4, 0, 8, __Value) #endif +#ifdef CONFIG_FW_MULTI_PORT_SUPPORT +/* DEFAULT PORT ID 0x2C*/ +#define SET_H2CCMD_DFTPID_PORT_ID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)), 0, 8, (__Value)) +#define SET_H2CCMD_DFTPID_MAC_ID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(((u8 *)(__pH2CCmd)) + 1, 0, 8, (__Value)) +#endif + #ifdef CONFIG_MCC_MODE /* MCC LOC CMD 0x10 */ #define SET_H2CCMD_MCC_RSVDPAGE_LOC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) @@ -356,21 +364,21 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #define SET_H2CCMD_MCC_MACID_BITMAP_H(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) /* MCC INFO CMD 0x18 */ -#define SET_H2CCMD_MCC_INFO_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) -#define SET_H2CCMD_MCC_INFO_TOTALNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) -#define SET_H2CCMD_MCC_INFO_CHIDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) -#define SET_H2CCMD_MCC_INFO_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) -#define SET_H2CCMD_MCC_INFO_BW40SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 3, __Value) -#define SET_H2CCMD_MCC_INFO_BW80SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 5, 3, __Value) -#define SET_H2CCMD_MCC_INFO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) -#define SET_H2CCMD_MCC_INFO_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 3, __Value) -#define SET_H2CCMD_MCC_INFO_INCURCH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) -#define SET_H2CCMD_MCC_INFO_RSVD0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 4, __Value) -#define SET_H2CCMD_MCC_INFO_RSVD1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) -#define SET_H2CCMD_MCC_INFO_RFETYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 4, __Value) -#define SET_H2CCMD_MCC_INFO_DISTXNULL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 4, 1, __Value) -#define SET_H2CCMD_MCC_INFO_C2HRPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 5, 2, __Value) -#define SET_H2CCMD_MCC_INFO_CHSCAN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 7, 1, __Value) +#define SET_H2CCMD_MCC_CTRL_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_TOTALNUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 4, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_CHIDX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) +#define SET_H2CCMD_MCC_CTRL_BW(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) +#define SET_H2CCMD_MCC_CTRL_BW40SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 3, __Value) +#define SET_H2CCMD_MCC_CTRL_BW80SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 5, 3, __Value) +#define SET_H2CCMD_MCC_CTRL_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_H2CCMD_MCC_CTRL_ROLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 3, __Value) +#define SET_H2CCMD_MCC_CTRL_INCURCH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) +#define SET_H2CCMD_MCC_CTRL_RSVD0(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_RSVD1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) +#define SET_H2CCMD_MCC_CTRL_RFETYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 4, __Value) +#define SET_H2CCMD_MCC_CTRL_DISTXNULL(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 4, 1, __Value) +#define SET_H2CCMD_MCC_CTRL_C2HRPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 5, 2, __Value) +#define SET_H2CCMD_MCC_CTRL_CHSCAN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 7, 1, __Value) /* MCC NoA CMD 0x19 */ #define SET_H2CCMD_MCC_NOA_FW_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) @@ -381,7 +389,8 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); /* MCC IQK CMD 0x1A */ #define SET_H2CCMD_MCC_IQK_READY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -#define SET_H2CCMD_MCC_IQK_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 2, __Value) +#define SET_H2CCMD_MCC_IQK_ORDER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 4, __Value) +#define SET_H2CCMD_MCC_IQK_PATH(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 5, 2, __Value) #define SET_H2CCMD_MCC_IQK_RX_L(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) #define SET_H2CCMD_MCC_IQK_RX_M1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) #define SET_H2CCMD_MCC_IQK_RX_M2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 2, 6, __Value) @@ -399,6 +408,10 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #define SET_H2CCMD_CH_SW_OPER_OFFLOAD_BW_80M_SC(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 1, 5, 3, __Value) #define SET_H2CCMD_CH_SW_OPER_OFFLOAD_RFE_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd) + 2, 0, 4, __Value) +#if defined(CONFIG_BT_COEXIST) && defined(CONFIG_FW_MULTI_PORT_SUPPORT) +#define SET_H2CCMD_BTC_WL_PORT_ID(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 4, __Value) +#endif + /* _WoWLAN PARAM_CMD_0x80 */ #define SET_H2CCMD_WOWLAN_FUNC_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) #define SET_H2CCMD_WOWLAN_PATTERN_MATCH_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) @@ -413,8 +426,14 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #define SET_H2CCMD_WOWLAN_GPIO_DURATION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) #define SET_H2CCMD_WOWLAN_GPIO_PULSE_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 1, __Value) #define SET_H2CCMD_WOWLAN_GPIO_PULSE_COUNT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 1, 7, __Value) -#define SET_H2CCMD_WOWLAN_LOWPR_RX(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 1, __Value) +#define SET_H2CCMD_WOWLAN_DISABLE_UPHY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 1, __Value) +#define SET_H2CCMD_WOWLAN_HST2DEV_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 1, 1, __Value) +#define SET_H2CCMD_WOWLAN_GPIO_DURATION_MS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 2, 1, __Value) #define SET_H2CCMD_WOWLAN_CHANGE_UNIT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 2, 1, __Value) +#define SET_H2CCMD_WOWLAN_UNIT_FOR_UPHY_DISABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 3, 1, __Value) +#define SET_H2CCMD_WOWLAN_TAKE_PDN_UPHY_DIS_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 4, 1, __Value) +#define SET_H2CCMD_WOWLAN_GPIO_INPUT_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 5, 1, __Value) + /* _REMOTE_WAKEUP_CMD_0x81 */ #define SET_H2CCMD_REMOTE_WAKECTRL_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) #define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) @@ -424,7 +443,9 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_UNICAST_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 7, 1, __Value) #define SET_H2CCMD_REMOTE_WAKE_CTRL_P2P_OFFLAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 1, __Value) #define SET_H2CCMD_REMOTE_WAKE_CTRL_NBNS_FILTER_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 2, 1, __Value) -#define SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 3, 1, __Value) +#define SET_H2CCMD_REMOTE_WAKE_CTRL_TKIP_OFFLOAD_EN(__pH2CCmd, __Value) \ + SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 3, 1, __Value) + #define SET_H2CCMD_REMOTE_WAKE_CTRL_ARP_ACTION(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 1, __Value) #define SET_H2CCMD_REMOTE_WAKE_CTRL_FW_PARSING_UNTIL_WAKEUP(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 4, 1, __Value) @@ -441,6 +462,12 @@ s32 rtw_hal_customer_str_write(_adapter *adapter, const u8 *cs); #ifdef CONFIG_GTK_OL #define SET_H2CCMD_AOAC_RSVDPAGE_LOC_GTK_EXT_MEM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) #endif /* CONFIG_GTK_OL */ +#define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NDP_INFO(__pH2CCmd, __Value) \ + SET_BITS_TO_LE_1BYTE((__pH2CCmd)+6, 0, 8, __Value) + +/* AOAC_RSVDPAGE_2_0x84 */ + +/* AOAC_RSVDPAGE_3_0x88 */ #ifdef CONFIG_PNO_SUPPORT #define SET_H2CCMD_AOAC_RSVDPAGE_LOC_NLO_INFO(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 8, __Value) #endif @@ -495,6 +522,7 @@ typedef struct _RSVDPAGE_LOC { #ifdef CONFIG_GTK_OL u8 LocGTKEXTMEM; #endif /* CONFIG_GTK_OL */ + u8 LocNDPInfo; u8 LocAOACReport; #ifdef CONFIG_PNO_SUPPORT u8 LocPNOInfo; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_led.h index 01dbb9c54138..8d4419141670 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,16 +11,14 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_COMMON_LED_H_ #define __HAL_COMMON_LED_H_ +#define NO_LED 0 +#define HW_LED 1 +#ifdef CONFIG_RTW_LED #define MSECS(t) (HZ * ((t) / 1000) + (HZ * ((t) % 1000)) / 1000) /* ******************************************************************************** @@ -159,7 +157,8 @@ typedef enum _LED_PIN { * ******************************************************************************** */ #ifdef CONFIG_PCI_HCI typedef enum _LED_STRATEGY_PCIE { - SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ + /* start from 2 */ + SW_LED_MODE0 = 2, /* SW control 1 LED via GPIO0. It is default option. */ SW_LED_MODE1, /* SW control for PCI Express */ SW_LED_MODE2, /* SW control for Cameo. */ SW_LED_MODE3, /* SW contorl for RunTop. */ @@ -172,7 +171,6 @@ typedef enum _LED_STRATEGY_PCIE { SW_LED_MODE10, /* added by chiyokolin, for Edimax-ASUS */ SW_LED_MODE11, /* added by hpfan, for Xavi */ SW_LED_MODE12, /* added by chiyokolin, for Azurewave */ - HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes) */ } LED_STRATEGY_PCIE, *PLED_STRATEGY_PCIE; typedef struct _LED_PCIE { @@ -220,7 +218,8 @@ gen_RefreshLedState( typedef enum _LED_STRATEGY_USB { - SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ + /* start from 2 */ + SW_LED_MODE0 = 2, /* SW control 1 LED via GPIO0. It is default option. */ SW_LED_MODE1, /* 2 LEDs, through LED0 and LED1. For ALPHA. */ SW_LED_MODE2, /* SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. */ SW_LED_MODE3, /* SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. */ @@ -236,7 +235,6 @@ typedef enum _LED_STRATEGY_USB { SW_LED_MODE13, /* for Netgear A6100, 8811Au */ SW_LED_MODE14, /* for Buffalo, DNI, 8811Au */ SW_LED_MODE15, /* for DLINK, 8811Au/8812AU */ - HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) */ } LED_STRATEGY_USB, *PLED_STRATEGY_USB; @@ -269,12 +267,13 @@ typedef struct _LED_USB { typedef struct _LED_USB LED_DATA, *PLED_DATA; typedef enum _LED_STRATEGY_USB LED_STRATEGY, *PLED_STRATEGY; - +#ifdef CONFIG_RTW_SW_LED VOID LedControlUSB( IN PADAPTER Adapter, IN LED_CTL_MODE LedAction ); +#endif /* ******************************************************************************** @@ -291,14 +290,14 @@ LedControlUSB( typedef enum _LED_STRATEGY_SDIO { - SW_LED_MODE0, /* SW control 1 LED via GPIO0. It is default option. */ + /* start from 2 */ + SW_LED_MODE0 = 2, /* SW control 1 LED via GPIO0. It is default option. */ SW_LED_MODE1, /* 2 LEDs, through LED0 and LED1. For ALPHA. */ SW_LED_MODE2, /* SW control 1 LED via GPIO0, customized for AzWave 8187 minicard. */ SW_LED_MODE3, /* SW control 1 LED via GPIO0, customized for Sercomm Printer Server case. */ SW_LED_MODE4, /* for Edimax / Belkin */ SW_LED_MODE5, /* for Sercomm / Belkin */ SW_LED_MODE6, /* for 88CU minicard, porting from ce SW_LED_MODE7 */ - HW_LED, /* HW control 2 LEDs, LED0 and LED1 (there are 4 different control modes, see MAC.CONFIG1 for details.) */ } LED_STRATEGY_SDIO, *PLED_STRATEGY_SDIO; typedef struct _LED_SDIO { @@ -339,28 +338,20 @@ LedControlSDIO( #endif struct led_priv { + LED_STRATEGY LedStrategy; +#ifdef CONFIG_RTW_SW_LED /* add for led controll */ LED_DATA SwLed0; LED_DATA SwLed1; LED_DATA SwLed2; - LED_STRATEGY LedStrategy; u8 bRegUseLed; void (*LedControlHandler)(_adapter *padapter, LED_CTL_MODE LedAction); void (*SwLedOn)(_adapter *padapter, PLED_DATA pLed); void (*SwLedOff)(_adapter *padapter, PLED_DATA pLed); /* add for led controll */ +#endif }; -#ifdef CONFIG_SW_LED -#define rtw_led_control(adapter, LedAction) \ - do { \ - if ((adapter)->ledpriv.LedControlHandler) \ - (adapter)->ledpriv.LedControlHandler((adapter), (LedAction)); \ - } while (0) -#else /* CONFIG_SW_LED */ -#define rtw_led_control(adapter, LedAction) -#endif /* CONFIG_SW_LED */ - #define SwLedOn(adapter, pLed) \ do { \ if ((adapter)->ledpriv.SwLedOn) \ @@ -392,5 +383,27 @@ DeInitLed( /* hal... */ extern void BlinkHandler(PLED_DATA pLed); +#endif /* CONFIG_RTW_LED */ + +#if defined(CONFIG_RTW_LED) && defined(CONFIG_RTW_SW_LED) +#define rtw_led_control(adapter, LedAction) \ + do { \ + if ((adapter)->ledpriv.LedControlHandler) \ + (adapter)->ledpriv.LedControlHandler((adapter), (LedAction)); \ + } while (0) +#else +#define rtw_led_control(adapter, LedAction) do {} while (0) +#endif + +#if defined(CONFIG_RTW_LED) +#define rtw_led_get_strategy(adapter) ((adapter)->ledpriv.LedStrategy) +#else +#define rtw_led_get_strategy(adapter) NO_LED +#endif + +#define IS_NO_LED_STRATEGY(s) ((s) == NO_LED) +#define IS_HW_LED_STRATEGY(s) ((s) == HW_LED) +#define IS_SW_LED_STRATEGY(s) ((s) != NO_LED && (s) != HW_LED) + +#endif /*__HAL_COMMON_LED_H_*/ -#endif /* __RTW_LED_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_phycfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_phycfg.h index 6602a235cd20..978e556d2b64 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_phycfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_phycfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_COM_PHYCFG_H__ #define __HAL_COM_PHYCFG_H__ @@ -36,18 +31,6 @@ typedef enum _RF_TX_NUM { #define MAX_POWER_INDEX 0x3F -typedef enum _REGULATION_TXPWR_LMT { - TXPWR_LMT_FCC = 0, - TXPWR_LMT_MKK = 1, - TXPWR_LMT_ETSI = 2, - TXPWR_LMT_WW = 3, - - TXPWR_LMT_MAX_REGULATION_NUM = 4 -} REGULATION_TXPWR_LMT; - -#define TX_PWR_LMT_REF_VHT_FROM_HT BIT0 -#define TX_PWR_LMT_REF_HT_FROM_VHT BIT1 - /*------------------------------Define structure----------------------------*/ typedef struct _BB_REGISTER_DEFINITION { u32 rfintfs; /* set software control: */ @@ -79,7 +62,6 @@ PHY_GetTxPowerByRateBase( IN PADAPTER Adapter, IN u8 Band, IN u8 RfPath, - IN u8 TxNum, IN RATE_SECTION RateSection ); @@ -100,9 +82,9 @@ PHY_GetRateIndexOfTxPowerByRate( ); VOID -PHY_SetTxPowerIndexByRateSection( +phy_set_tx_power_index_by_rate_section( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Channel, IN u8 RateSection ); @@ -111,8 +93,7 @@ s8 _PHY_GetTxPowerByRate( IN PADAPTER pAdapter, IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, + IN enum rf_path RFPath, IN u8 RateIndex ); @@ -120,34 +101,21 @@ s8 PHY_GetTxPowerByRate( IN PADAPTER pAdapter, IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, + IN enum rf_path RFPath, IN u8 RateIndex ); -#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -s8 -PHY_GetTxPowerByRateOriginal( - IN PADAPTER pAdapter, - IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, - IN u8 Rate -); -#endif - VOID PHY_SetTxPowerByRate( IN PADAPTER pAdapter, IN u8 Band, - IN u8 RFPath, - IN u8 TxNum, + IN enum rf_path RFPath, IN u8 Rate, IN s8 Value ); VOID -PHY_SetTxPowerLevelByPath( +phy_set_tx_power_level_by_path( IN PADAPTER Adapter, IN u8 channel, IN u8 path @@ -156,8 +124,8 @@ PHY_SetTxPowerLevelByPath( VOID PHY_SetTxPowerIndexByRateArray( IN PADAPTER pAdapter, - IN u8 RFPath, - IN CHANNEL_WIDTH BandWidth, + IN enum rf_path RFPath, + IN enum channel_width BandWidth, IN u8 Channel, IN u8 *Rates, IN u8 RateArraySize @@ -169,7 +137,7 @@ PHY_InitTxPowerByRate( ); VOID -PHY_StoreTxPowerByRate( +phy_store_tx_power_by_rate( IN PADAPTER pAdapter, IN u32 Band, IN u32 RfPath, @@ -187,66 +155,47 @@ PHY_TxPowerByRateConfiguration( u8 PHY_GetTxPowerIndexBase( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, + u8 ntx_idx, + IN enum channel_width BandWidth, IN u8 Channel, OUT PBOOLEAN bIn24G ); -s8 -PHY_GetTxPowerLimit( - IN PADAPTER Adapter, - IN u32 RegPwrTblSel, - IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel +#ifdef CONFIG_TXPWR_LIMIT +s8 phy_get_txpwr_lmt_abs(_adapter *adapter + , const char *regd_name + , BAND_TYPE band, enum channel_width bw + , u8 tlrs, u8 ntx_idx, u8 cch, u8 lock ); -s8 -PHY_GetTxPowerLimit_no_sc( - IN PADAPTER Adapter, - IN u32 RegPwrTblSel, - IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel +s8 phy_get_txpwr_lmt(_adapter *adapter + , const char *regd_name + , BAND_TYPE band, enum channel_width bw + , u8 rfpath, u8 rs, u8 ntx_idx, u8 cch, u8 lock ); -#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI -s8 -PHY_GetTxPowerLimitOriginal( - IN PADAPTER Adapter, - IN u32 RegPwrTblSel, - IN BAND_TYPE Band, - IN CHANNEL_WIDTH Bandwidth, - IN u8 RfPath, - IN u8 DataRate, - IN u8 Channel -); -#endif - -VOID -PHY_ConvertTxPowerLimitToPowerIndex( - IN PADAPTER Adapter -); - -VOID -PHY_InitTxPowerLimit( - IN PADAPTER Adapter +s8 PHY_GetTxPowerLimit(_adapter *adapter + , const char *regd_name + , BAND_TYPE band, enum channel_width bw + , u8 rfpath, u8 rate, u8 ntx_idx, u8 cch ); +#else +#define phy_get_txpwr_lmt_abs(adapter, regd_name, band, bw, tlrs, ntx_idx, cch, lock) MAX_POWER_INDEX +#define phy_get_txpwr_lmt(adapter, regd_name, band, bw, rfpath, rs, ntx_idx, cch, lock) MAX_POWER_INDEX +#define PHY_GetTxPowerLimit(adapter, regd_name, band, bw, rfpath, rate, ntx_idx, cch) MAX_POWER_INDEX +#endif /* CONFIG_TXPWR_LIMIT */ s8 PHY_GetTxPowerTrackingOffset( PADAPTER pAdapter, - u8 Rate, - u8 RFPath + enum rf_path RFPath, + u8 Rate ); struct txpwr_idx_comp { + u8 ntx_idx; u8 base; s8 by_rate; s8 limit; @@ -255,11 +204,11 @@ struct txpwr_idx_comp { }; u8 -PHY_GetTxPowerIndex( +phy_get_tx_power_index( IN PADAPTER pAdapter, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate, - IN CHANNEL_WIDTH BandWidth, + IN enum channel_width BandWidth, IN u8 Channel ); @@ -267,7 +216,7 @@ VOID PHY_SetTxPowerIndex( IN PADAPTER pAdapter, IN u32 PowerIndex, - IN u8 RFPath, + IN enum rf_path RFPath, IN u8 Rate ); @@ -278,16 +227,15 @@ void dump_tx_power_idx(void *sel, _adapter *adapter); bool phy_is_tx_power_limit_needed(_adapter *adapter); bool phy_is_tx_power_by_rate_needed(_adapter *adapter); int phy_load_tx_power_by_rate(_adapter *adapter, u8 chk_file); +#ifdef CONFIG_TXPWR_LIMIT int phy_load_tx_power_limit(_adapter *adapter, u8 chk_file); +#endif void phy_load_tx_power_ext_info(_adapter *adapter, u8 chk_file); void phy_reload_tx_power_ext_info(_adapter *adapter); void phy_reload_default_tx_power_ext_info(_adapter *adapter); const struct map_t *hal_pg_txpwr_def_info(_adapter *adapter); -void dump_pg_txpwr_info_2g(void *sel, TxPowerInfo24G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt); -void dump_pg_txpwr_info_5g(void *sel, TxPowerInfo5G *txpwr_info, u8 rfpath_num, u8 max_tx_cnt); - void dump_hal_txpwr_info_2g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt); void dump_hal_txpwr_info_5g(void *sel, _adapter *adapter, u8 rfpath_num, u8 max_tx_cnt); @@ -301,7 +249,6 @@ void hal_load_txpwr_info( void dump_tx_power_ext_info(void *sel, _adapter *adapter); void dump_target_tx_power(void *sel, _adapter *adapter); void dump_tx_power_by_rate(void *sel, _adapter *adapter); -void dump_tx_power_limit(void *sel, _adapter *adapter); int rtw_get_phy_file_path(_adapter *adapter, const char *file_name); @@ -338,9 +285,11 @@ int phy_ConfigMACWithParaFile(IN PADAPTER Adapter, IN char *pFileName); int phy_ConfigBBWithParaFile(IN PADAPTER Adapter, IN char *pFileName, IN u32 ConfigType); int phy_ConfigBBWithPgParaFile(IN PADAPTER Adapter, IN const char *pFileName); int phy_ConfigBBWithMpParaFile(IN PADAPTER Adapter, IN char *pFileName); -int PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN char *pFileName, IN u8 eRFPath); +int PHY_ConfigRFWithParaFile(IN PADAPTER Adapter, IN char *pFileName, IN enum rf_path eRFPath); int PHY_ConfigRFWithTxPwrTrackParaFile(IN PADAPTER Adapter, IN char *pFileName); +#ifdef CONFIG_TXPWR_LIMIT int PHY_ConfigRFWithPowerLimitTableParaFile(IN PADAPTER Adapter, IN const char *pFileName); +#endif void phy_free_filebuf_mask(_adapter *padapter, u8 mask); void phy_free_filebuf(_adapter *padapter); #endif /* CONFIG_LOAD_PHY_PARA_FROM_FILE */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_reg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_reg.h index 50ef1794b6ab..7caa55b207c2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_reg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_com_reg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_COMMON_REG_H__ #define __HAL_COMMON_REG_H__ @@ -126,7 +121,8 @@ #define REG_TRXFF_STATUS 0x0118 #define REG_RXFF_PTR 0x011C #define REG_HIMR 0x0120 -#define REG_HISR 0x0124 +#define REG_FE1IMR 0x0120 +#define REG_HISR 0x0124 #define REG_HIMRE 0x0128 #define REG_HISRE 0x012C #define REG_CPWM 0x012F @@ -213,8 +209,6 @@ #define REG_DBI_FLAG 0x0352 /* Backdoor REG for Access Configuration */ #define REG_MDIO 0x0354 /* MDIO for Access PCIE PHY */ #define REG_DBG_SEL 0x0360 /* Debug Selection Register */ -#define REG_PCIE_HRPWM 0x0361 /* PCIe RPWM */ -#define REG_PCIE_HCPWM 0x0363 /* PCIe CPWM */ #define REG_WATCH_DOG 0x0368 #define REG_RX_RXBD_NUM 0x0382 @@ -480,7 +474,7 @@ /* Power */ #define REG_WOW_CTRL 0x0690 #define REG_PS_RX_INFO 0x0692 -#define REG_UAPSD_TID 0x0693 +#define REG_WMMPS_UAPSD_TID 0x0693 #define REG_WKFMCAM_CMD 0x0698 #define REG_WKFMCAM_NUM REG_WKFMCAM_CMD #define REG_WKFMCAM_RWD 0x069C @@ -597,15 +591,15 @@ /* ---------------------------------------------------------------------------- * 8192C Cmd9346CR bits (Offset 0xA, 16bit) * ---------------------------------------------------------------------------- */ -#define CmdEEPROM_En BIT5 /* EEPROM enable when set 1 */ -#define CmdEERPOMSEL BIT4 /* System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 */ -#define Cmd9346CR_9356SEL BIT4 +#define CmdEEPROM_En BIT(5) /* EEPROM enable when set 1 */ +#define CmdEERPOMSEL BIT(4) /* System EEPROM select, 0: boot from E-FUSE, 1: The EEPROM used is 9346 */ +#define Cmd9346CR_9356SEL BIT(4) /* ---------------------------------------------------------------------------- * 8192C GPIO MUX Configuration Register (offset 0x40, 4 byte) * ---------------------------------------------------------------------------- */ #define GPIOSEL_GPIO 0 -#define GPIOSEL_ENBT BIT5 +#define GPIOSEL_ENBT BIT(5) /* ---------------------------------------------------------------------------- * 8192C GPIO PIN Control Register (offset 0x44, 4 byte) @@ -626,20 +620,20 @@ /* ---------------------------------------------------------------------------- * 8723/8188E Host System Interrupt Mask Register (offset 0x58, 32 byte) * ---------------------------------------------------------------------------- */ -#define HSIMR_GPIO12_0_INT_EN BIT0 -#define HSIMR_SPS_OCP_INT_EN BIT5 -#define HSIMR_RON_INT_EN BIT6 -#define HSIMR_PDN_INT_EN BIT7 -#define HSIMR_GPIO9_INT_EN BIT25 +#define HSIMR_GPIO12_0_INT_EN BIT(0) +#define HSIMR_SPS_OCP_INT_EN BIT(5) +#define HSIMR_RON_INT_EN BIT(6) +#define HSIMR_PDN_INT_EN BIT(7) +#define HSIMR_GPIO9_INT_EN BIT(25) /* ---------------------------------------------------------------------------- * 8723/8188E Host System Interrupt Status Register (offset 0x5C, 32 byte) * ---------------------------------------------------------------------------- */ -#define HSISR_GPIO12_0_INT BIT0 -#define HSISR_SPS_OCP_INT BIT5 -#define HSISR_RON_INT BIT6 -#define HSISR_PDNINT BIT7 -#define HSISR_GPIO9_INT BIT25 +#define HSISR_GPIO12_0_INT BIT(0) +#define HSISR_SPS_OCP_INT BIT(5) +#define HSISR_RON_INT BIT(6) +#define HSISR_PDNINT BIT(7) +#define HSISR_GPIO9_INT BIT(25) /* ---------------------------------------------------------------------------- * 8192C (MSR) Media Status Register (Offset 0x4C, 8 bits) @@ -674,42 +668,43 @@ Default: 00b. /* ---------------------------------------------------------------------------- * Response Rate Set Register (offset 0x440, 24bits) * ---------------------------------------------------------------------------- */ -#define RRSR_1M BIT0 -#define RRSR_2M BIT1 -#define RRSR_5_5M BIT2 -#define RRSR_11M BIT3 -#define RRSR_6M BIT4 -#define RRSR_9M BIT5 -#define RRSR_12M BIT6 -#define RRSR_18M BIT7 -#define RRSR_24M BIT8 -#define RRSR_36M BIT9 -#define RRSR_48M BIT10 -#define RRSR_54M BIT11 -#define RRSR_MCS0 BIT12 -#define RRSR_MCS1 BIT13 -#define RRSR_MCS2 BIT14 -#define RRSR_MCS3 BIT15 -#define RRSR_MCS4 BIT16 -#define RRSR_MCS5 BIT17 -#define RRSR_MCS6 BIT18 -#define RRSR_MCS7 BIT19 +#define RRSR_1M BIT(0) +#define RRSR_2M BIT(1) +#define RRSR_5_5M BIT(2) +#define RRSR_11M BIT(3) +#define RRSR_6M BIT(4) +#define RRSR_9M BIT(5) +#define RRSR_12M BIT(6) +#define RRSR_18M BIT(7) +#define RRSR_24M BIT(8) +#define RRSR_36M BIT(9) +#define RRSR_48M BIT(10) +#define RRSR_54M BIT(11) +#define RRSR_MCS0 BIT(12) +#define RRSR_MCS1 BIT(13) +#define RRSR_MCS2 BIT(14) +#define RRSR_MCS3 BIT(15) +#define RRSR_MCS4 BIT(16) +#define RRSR_MCS5 BIT(17) +#define RRSR_MCS6 BIT(18) +#define RRSR_MCS7 BIT(19) #define RRSR_CCK_RATES (RRSR_11M | RRSR_5_5M | RRSR_2M | RRSR_1M) #define RRSR_OFDM_RATES (RRSR_54M | RRSR_48M | RRSR_36M | RRSR_24M | RRSR_18M | RRSR_12M | RRSR_9M | RRSR_6M) /* WOL bit information */ -#define HAL92C_WOL_PTK_UPDATE_EVENT BIT0 -#define HAL92C_WOL_GTK_UPDATE_EVENT BIT1 -#define HAL92C_WOL_DISASSOC_EVENT BIT2 -#define HAL92C_WOL_DEAUTH_EVENT BIT3 -#define HAL92C_WOL_FW_DISCONNECT_EVENT BIT4 +#define HAL92C_WOL_PTK_UPDATE_EVENT BIT(0) +#define HAL92C_WOL_GTK_UPDATE_EVENT BIT(1) +#define HAL92C_WOL_DISASSOC_EVENT BIT(2) +#define HAL92C_WOL_DEAUTH_EVENT BIT(3) +#define HAL92C_WOL_FW_DISCONNECT_EVENT BIT(4) /*---------------------------------------------------------------------------- ** REG_CCK_CHECK (offset 0x454) ------------------------------------------------------------------------------*/ -#define BIT_BCN_PORT_SEL BIT5 +#define BIT_BCN_PORT_SEL BIT(5) +#define BIT_EN_BCN_PKT_REL BIT(6) #endif /* RTW_HALMAC */ @@ -801,15 +796,15 @@ Default: 00b. /* ---------------------------------------------------------------------------- * BW_OPMODE bits (Offset 0x603, 8bit) * ---------------------------------------------------------------------------- */ -#define BW_OPMODE_20MHZ BIT2 -#define BW_OPMODE_5G BIT1 +#define BW_OPMODE_20MHZ BIT(2) +#define BW_OPMODE_5G BIT(1) /* ---------------------------------------------------------------------------- * CAM Config Setting (offset 0x680, 1 byte) * ---------------------------------------------------------------------------- */ -#define CAM_VALID BIT15 +#define CAM_VALID BIT(15) #define CAM_NOTVALID 0x0000 -#define CAM_USEDK BIT5 +#define CAM_USEDK BIT(5) #define CAM_CONTENT_COUNT 8 @@ -826,17 +821,17 @@ Default: 00b. #define CAM_CONFIG_USEDK _TRUE #define CAM_CONFIG_NO_USEDK _FALSE -#define CAM_WRITE BIT16 +#define CAM_WRITE BIT(16) #define CAM_READ 0x00000000 -#define CAM_POLLINIG BIT31 +#define CAM_POLLINIG BIT(31) /* * 10. Power Save Control Registers * */ -#define WOW_PMEN BIT0 /* Power management Enable. */ -#define WOW_WOMEN BIT1 /* WoW function on or off. */ -#define WOW_MAGIC BIT2 /* Magic packet */ -#define WOW_UWF BIT3 /* Unicast Wakeup frame. */ +#define WOW_PMEN BIT(0) /* Power management Enable. */ +#define WOW_WOMEN BIT(1) /* WoW function on or off. */ +#define WOW_MAGIC BIT(2) /* Magic packet */ +#define WOW_UWF BIT(3) /* Unicast Wakeup frame. */ /* * 12. Host Interrupt Status Registers @@ -847,156 +842,156 @@ Default: 00b. #define IMR8190_DISABLED 0x0 #define IMR_DISABLED 0x0 /* IMR DW0 Bit 0-31 */ -#define IMR_BCNDMAINT6 BIT31 /* Beacon DMA Interrupt 6 */ -#define IMR_BCNDMAINT5 BIT30 /* Beacon DMA Interrupt 5 */ -#define IMR_BCNDMAINT4 BIT29 /* Beacon DMA Interrupt 4 */ -#define IMR_BCNDMAINT3 BIT28 /* Beacon DMA Interrupt 3 */ -#define IMR_BCNDMAINT2 BIT27 /* Beacon DMA Interrupt 2 */ -#define IMR_BCNDMAINT1 BIT26 /* Beacon DMA Interrupt 1 */ -#define IMR_BCNDOK8 BIT25 /* Beacon Queue DMA OK Interrup 8 */ -#define IMR_BCNDOK7 BIT24 /* Beacon Queue DMA OK Interrup 7 */ -#define IMR_BCNDOK6 BIT23 /* Beacon Queue DMA OK Interrup 6 */ -#define IMR_BCNDOK5 BIT22 /* Beacon Queue DMA OK Interrup 5 */ -#define IMR_BCNDOK4 BIT21 /* Beacon Queue DMA OK Interrup 4 */ -#define IMR_BCNDOK3 BIT20 /* Beacon Queue DMA OK Interrup 3 */ -#define IMR_BCNDOK2 BIT19 /* Beacon Queue DMA OK Interrup 2 */ -#define IMR_BCNDOK1 BIT18 /* Beacon Queue DMA OK Interrup 1 */ -#define IMR_TIMEOUT2 BIT17 /* Timeout interrupt 2 */ -#define IMR_TIMEOUT1 BIT16 /* Timeout interrupt 1 */ -#define IMR_TXFOVW BIT15 /* Transmit FIFO Overflow */ -#define IMR_PSTIMEOUT BIT14 /* Power save time out interrupt */ -#define IMR_BcnInt BIT13 /* Beacon DMA Interrupt 0 */ -#define IMR_RXFOVW BIT12 /* Receive FIFO Overflow */ -#define IMR_RDU BIT11 /* Receive Descriptor Unavailable */ -#define IMR_ATIMEND BIT10 /* For 92C, ATIM Window End Interrupt. For 8723 and later ICs, it also means P2P CTWin End interrupt. */ -#define IMR_BDOK BIT9 /* Beacon Queue DMA OK Interrup */ -#define IMR_HIGHDOK BIT8 /* High Queue DMA OK Interrupt */ -#define IMR_TBDOK BIT7 /* Transmit Beacon OK interrup */ -#define IMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -#define IMR_TBDER BIT5 /* For 92C, Transmit Beacon Error Interrupt */ -#define IMR_BKDOK BIT4 /* AC_BK DMA OK Interrupt */ -#define IMR_BEDOK BIT3 /* AC_BE DMA OK Interrupt */ -#define IMR_VIDOK BIT2 /* AC_VI DMA OK Interrupt */ -#define IMR_VODOK BIT1 /* AC_VO DMA Interrupt */ -#define IMR_ROK BIT0 /* Receive DMA OK Interrupt */ +#define IMR_BCNDMAINT6 BIT(31) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5 BIT(30) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4 BIT(29) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3 BIT(28) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2 BIT(27) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1 BIT(26) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK8 BIT(25) /* Beacon Queue DMA OK Interrupt 8 */ +#define IMR_BCNDOK7 BIT(24) /* Beacon Queue DMA OK Interrupt 7 */ +#define IMR_BCNDOK6 BIT(23) /* Beacon Queue DMA OK Interrupt 6 */ +#define IMR_BCNDOK5 BIT(22) /* Beacon Queue DMA OK Interrupt 5 */ +#define IMR_BCNDOK4 BIT(21) /* Beacon Queue DMA OK Interrupt 4 */ +#define IMR_BCNDOK3 BIT(20) /* Beacon Queue DMA OK Interrupt 3 */ +#define IMR_BCNDOK2 BIT(19) /* Beacon Queue DMA OK Interrupt 2 */ +#define IMR_BCNDOK1 BIT(18) /* Beacon Queue DMA OK Interrupt 1 */ +#define IMR_TIMEOUT2 BIT(17) /* Timeout interrupt 2 */ +#define IMR_TIMEOUT1 BIT(16) /* Timeout interrupt 1 */ +#define IMR_TXFOVW BIT(15) /* Transmit FIFO Overflow */ +#define IMR_PSTIMEOUT BIT(14) /* Power save time out interrupt */ +#define IMR_BcnInt BIT(13) /* Beacon DMA Interrupt 0 */ +#define IMR_RXFOVW BIT(12) /* Receive FIFO Overflow */ +#define IMR_RDU BIT(11) /* Receive Descriptor Unavailable */ +#define IMR_ATIMEND BIT(10) /* For 92C, ATIM Window End Interrupt. For 8723 and later ICs, it also means P2P CTWin End interrupt. */ +#define IMR_BDOK BIT(9) /* Beacon Queue DMA OK Interrupt */ +#define IMR_HIGHDOK BIT(8) /* High Queue DMA OK Interrupt */ +#define IMR_TBDOK BIT(7) /* Transmit Beacon OK interrupt */ +#define IMR_MGNTDOK BIT(6) /* Management Queue DMA OK Interrupt */ +#define IMR_TBDER BIT(5) /* For 92C, Transmit Beacon Error Interrupt */ +#define IMR_BKDOK BIT(4) /* AC_BK DMA OK Interrupt */ +#define IMR_BEDOK BIT(3) /* AC_BE DMA OK Interrupt */ +#define IMR_VIDOK BIT(2) /* AC_VI DMA OK Interrupt */ +#define IMR_VODOK BIT(1) /* AC_VO DMA Interrupt */ +#define IMR_ROK BIT(0) /* Receive DMA OK Interrupt */ /* 13. Host Interrupt Status Extension Register (Offset: 0x012C-012Eh) */ -#define IMR_TSF_BIT32_TOGGLE BIT15 -#define IMR_BcnInt_E BIT12 -#define IMR_TXERR BIT11 -#define IMR_RXERR BIT10 -#define IMR_C2HCMD BIT9 -#define IMR_CPWM BIT8 +#define IMR_TSF_BIT32_TOGGLE BIT(15) +#define IMR_BcnInt_E BIT(12) +#define IMR_TXERR BIT(11) +#define IMR_RXERR BIT(10) +#define IMR_C2HCMD BIT(9) +#define IMR_CPWM BIT(8) /* RSVD [2-7] */ -#define IMR_OCPINT BIT1 -#define IMR_WLANOFF BIT0 +#define IMR_OCPINT BIT(1) +#define IMR_WLANOFF BIT(0) /* ---------------------------------------------------------------------------- * 8723E series PCIE Host IMR/ISR bit * ---------------------------------------------------------------------------- */ /* IMR DW0 Bit 0-31 */ -#define PHIMR_TIMEOUT2 BIT31 -#define PHIMR_TIMEOUT1 BIT30 -#define PHIMR_PSTIMEOUT BIT29 -#define PHIMR_GTINT4 BIT28 -#define PHIMR_GTINT3 BIT27 -#define PHIMR_TXBCNERR BIT26 -#define PHIMR_TXBCNOK BIT25 -#define PHIMR_TSF_BIT32_TOGGLE BIT24 -#define PHIMR_BCNDMAINT3 BIT23 -#define PHIMR_BCNDMAINT2 BIT22 -#define PHIMR_BCNDMAINT1 BIT21 -#define PHIMR_BCNDMAINT0 BIT20 -#define PHIMR_BCNDOK3 BIT19 -#define PHIMR_BCNDOK2 BIT18 -#define PHIMR_BCNDOK1 BIT17 -#define PHIMR_BCNDOK0 BIT16 -#define PHIMR_HSISR_IND_ON BIT15 -#define PHIMR_BCNDMAINT_E BIT14 -#define PHIMR_ATIMEND_E BIT13 -#define PHIMR_ATIM_CTW_END BIT12 -#define PHIMR_HISRE_IND BIT11 /* RO. HISRE Indicator (HISRE & HIMRE is true, this bit is set to 1) */ -#define PHIMR_C2HCMD BIT10 -#define PHIMR_CPWM2 BIT9 -#define PHIMR_CPWM BIT8 -#define PHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ -#define PHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -#define PHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ -#define PHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ -#define PHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ -#define PHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ -#define PHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ -#define PHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ +#define PHIMR_TIMEOUT2 BIT(31) +#define PHIMR_TIMEOUT1 BIT(30) +#define PHIMR_PSTIMEOUT BIT(29) +#define PHIMR_GTINT4 BIT(28) +#define PHIMR_GTINT3 BIT(27) +#define PHIMR_TXBCNERR BIT(26) +#define PHIMR_TXBCNOK BIT(25) +#define PHIMR_TSF_BIT32_TOGGLE BIT(24) +#define PHIMR_BCNDMAINT3 BIT(23) +#define PHIMR_BCNDMAINT2 BIT(22) +#define PHIMR_BCNDMAINT1 BIT(21) +#define PHIMR_BCNDMAINT0 BIT(20) +#define PHIMR_BCNDOK3 BIT(19) +#define PHIMR_BCNDOK2 BIT(18) +#define PHIMR_BCNDOK1 BIT(17) +#define PHIMR_BCNDOK0 BIT(16) +#define PHIMR_HSISR_IND_ON BIT(15) +#define PHIMR_BCNDMAINT_E BIT(14) +#define PHIMR_ATIMEND_E BIT(13) +#define PHIMR_ATIM_CTW_END BIT(12) +#define PHIMR_HISRE_IND BIT(11) /* RO. HISRE Indicator (HISRE & HIMRE is true, this bit is set to 1) */ +#define PHIMR_C2HCMD BIT(10) +#define PHIMR_CPWM2 BIT(9) +#define PHIMR_CPWM BIT(8) +#define PHIMR_HIGHDOK BIT(7) /* High Queue DMA OK Interrupt */ +#define PHIMR_MGNTDOK BIT(6) /* Management Queue DMA OK Interrupt */ +#define PHIMR_BKDOK BIT(5) /* AC_BK DMA OK Interrupt */ +#define PHIMR_BEDOK BIT(4) /* AC_BE DMA OK Interrupt */ +#define PHIMR_VIDOK BIT(3) /* AC_VI DMA OK Interrupt */ +#define PHIMR_VODOK BIT(2) /* AC_VO DMA Interrupt */ +#define PHIMR_RDU BIT(1) /* Receive Descriptor Unavailable */ +#define PHIMR_ROK BIT(0) /* Receive DMA OK Interrupt */ /* PCIE Host Interrupt Status Extension bit */ -#define PHIMR_BCNDMAINT7 BIT23 -#define PHIMR_BCNDMAINT6 BIT22 -#define PHIMR_BCNDMAINT5 BIT21 -#define PHIMR_BCNDMAINT4 BIT20 -#define PHIMR_BCNDOK7 BIT19 -#define PHIMR_BCNDOK6 BIT18 -#define PHIMR_BCNDOK5 BIT17 -#define PHIMR_BCNDOK4 BIT16 +#define PHIMR_BCNDMAINT7 BIT(23) +#define PHIMR_BCNDMAINT6 BIT(22) +#define PHIMR_BCNDMAINT5 BIT(21) +#define PHIMR_BCNDMAINT4 BIT(20) +#define PHIMR_BCNDOK7 BIT(19) +#define PHIMR_BCNDOK6 BIT(18) +#define PHIMR_BCNDOK5 BIT(17) +#define PHIMR_BCNDOK4 BIT(16) /* bit12 15: RSVD */ -#define PHIMR_TXERR BIT11 -#define PHIMR_RXERR BIT10 -#define PHIMR_TXFOVW BIT9 -#define PHIMR_RXFOVW BIT8 +#define PHIMR_TXERR BIT(11) +#define PHIMR_RXERR BIT(10) +#define PHIMR_TXFOVW BIT(9) +#define PHIMR_RXFOVW BIT(8) /* bit2-7: RSVD */ -#define PHIMR_OCPINT BIT1 +#define PHIMR_OCPINT BIT(1) /* bit0: RSVD */ -#define UHIMR_TIMEOUT2 BIT31 -#define UHIMR_TIMEOUT1 BIT30 -#define UHIMR_PSTIMEOUT BIT29 -#define UHIMR_GTINT4 BIT28 -#define UHIMR_GTINT3 BIT27 -#define UHIMR_TXBCNERR BIT26 -#define UHIMR_TXBCNOK BIT25 -#define UHIMR_TSF_BIT32_TOGGLE BIT24 -#define UHIMR_BCNDMAINT3 BIT23 -#define UHIMR_BCNDMAINT2 BIT22 -#define UHIMR_BCNDMAINT1 BIT21 -#define UHIMR_BCNDMAINT0 BIT20 -#define UHIMR_BCNDOK3 BIT19 -#define UHIMR_BCNDOK2 BIT18 -#define UHIMR_BCNDOK1 BIT17 -#define UHIMR_BCNDOK0 BIT16 -#define UHIMR_HSISR_IND BIT15 -#define UHIMR_BCNDMAINT_E BIT14 -/* RSVD BIT13 */ -#define UHIMR_CTW_END BIT12 -/* RSVD BIT11 */ -#define UHIMR_C2HCMD BIT10 -#define UHIMR_CPWM2 BIT9 -#define UHIMR_CPWM BIT8 -#define UHIMR_HIGHDOK BIT7 /* High Queue DMA OK Interrupt */ -#define UHIMR_MGNTDOK BIT6 /* Management Queue DMA OK Interrupt */ -#define UHIMR_BKDOK BIT5 /* AC_BK DMA OK Interrupt */ -#define UHIMR_BEDOK BIT4 /* AC_BE DMA OK Interrupt */ -#define UHIMR_VIDOK BIT3 /* AC_VI DMA OK Interrupt */ -#define UHIMR_VODOK BIT2 /* AC_VO DMA Interrupt */ -#define UHIMR_RDU BIT1 /* Receive Descriptor Unavailable */ -#define UHIMR_ROK BIT0 /* Receive DMA OK Interrupt */ +#define UHIMR_TIMEOUT2 BIT(31) +#define UHIMR_TIMEOUT1 BIT(30) +#define UHIMR_PSTIMEOUT BIT(29) +#define UHIMR_GTINT4 BIT(28) +#define UHIMR_GTINT3 BIT(27) +#define UHIMR_TXBCNERR BIT(26) +#define UHIMR_TXBCNOK BIT(25) +#define UHIMR_TSF_BIT32_TOGGLE BIT(24) +#define UHIMR_BCNDMAINT3 BIT(23) +#define UHIMR_BCNDMAINT2 BIT(22) +#define UHIMR_BCNDMAINT1 BIT(21) +#define UHIMR_BCNDMAINT0 BIT(20) +#define UHIMR_BCNDOK3 BIT(19) +#define UHIMR_BCNDOK2 BIT(18) +#define UHIMR_BCNDOK1 BIT(17) +#define UHIMR_BCNDOK0 BIT(16) +#define UHIMR_HSISR_IND BIT(15) +#define UHIMR_BCNDMAINT_E BIT(14) +/* RSVD BIT(13) */ +#define UHIMR_CTW_END BIT(12) +/* RSVD BIT(11) */ +#define UHIMR_C2HCMD BIT(10) +#define UHIMR_CPWM2 BIT(9) +#define UHIMR_CPWM BIT(8) +#define UHIMR_HIGHDOK BIT(7) /* High Queue DMA OK Interrupt */ +#define UHIMR_MGNTDOK BIT(6) /* Management Queue DMA OK Interrupt */ +#define UHIMR_BKDOK BIT(5) /* AC_BK DMA OK Interrupt */ +#define UHIMR_BEDOK BIT(4) /* AC_BE DMA OK Interrupt */ +#define UHIMR_VIDOK BIT(3) /* AC_VI DMA OK Interrupt */ +#define UHIMR_VODOK BIT(2) /* AC_VO DMA Interrupt */ +#define UHIMR_RDU BIT(1) /* Receive Descriptor Unavailable */ +#define UHIMR_ROK BIT(0) /* Receive DMA OK Interrupt */ /* USB Host Interrupt Status Extension bit */ -#define UHIMR_BCNDMAINT7 BIT23 -#define UHIMR_BCNDMAINT6 BIT22 -#define UHIMR_BCNDMAINT5 BIT21 -#define UHIMR_BCNDMAINT4 BIT20 -#define UHIMR_BCNDOK7 BIT19 -#define UHIMR_BCNDOK6 BIT18 -#define UHIMR_BCNDOK5 BIT17 -#define UHIMR_BCNDOK4 BIT16 +#define UHIMR_BCNDMAINT7 BIT(23) +#define UHIMR_BCNDMAINT6 BIT(22) +#define UHIMR_BCNDMAINT5 BIT(21) +#define UHIMR_BCNDMAINT4 BIT(20) +#define UHIMR_BCNDOK7 BIT(19) +#define UHIMR_BCNDOK6 BIT(18) +#define UHIMR_BCNDOK5 BIT(17) +#define UHIMR_BCNDOK4 BIT(16) /* bit14-15: RSVD */ -#define UHIMR_ATIMEND_E BIT13 -#define UHIMR_ATIMEND BIT12 -#define UHIMR_TXERR BIT11 -#define UHIMR_RXERR BIT10 -#define UHIMR_TXFOVW BIT9 -#define UHIMR_RXFOVW BIT8 +#define UHIMR_ATIMEND_E BIT(13) +#define UHIMR_ATIMEND BIT(12) +#define UHIMR_TXERR BIT(11) +#define UHIMR_RXERR BIT(10) +#define UHIMR_TXFOVW BIT(9) +#define UHIMR_RXFOVW BIT(8) /* bit2-7: RSVD */ -#define UHIMR_OCPINT BIT1 +#define UHIMR_OCPINT BIT(1) /* bit0: RSVD */ @@ -1008,51 +1003,51 @@ Default: 00b. * ---------------------------------------------------------------------------- */ #define IMR_DISABLED_88E 0x0 /* IMR DW0(0x0060-0063) Bit 0-31 */ -#define IMR_TXCCK_88E BIT30 /* TXRPT interrupt when CCX bit of the packet is set */ -#define IMR_PSTIMEOUT_88E BIT29 /* Power Save Time Out Interrupt */ -#define IMR_GTINT4_88E BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -#define IMR_GTINT3_88E BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -#define IMR_TBDER_88E BIT26 /* Transmit Beacon0 Error */ -#define IMR_TBDOK_88E BIT25 /* Transmit Beacon0 OK */ -#define IMR_TSF_BIT32_TOGGLE_88E BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -#define IMR_BCNDMAINT0_88E BIT20 /* Beacon DMA Interrupt 0 */ -#define IMR_BCNDERR0_88E BIT16 /* Beacon Queue DMA Error 0 */ -#define IMR_HSISR_IND_ON_INT_88E BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -#define IMR_BCNDMAINT_E_88E BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -#define IMR_ATIMEND_88E BIT12 /* CTWidnow End or ATIM Window End */ -#define IMR_HISR1_IND_INT_88E BIT11 /* HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) */ -#define IMR_C2HCMD_88E BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -#define IMR_CPWM2_88E BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_CPWM_88E BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_HIGHDOK_88E BIT7 /* High Queue DMA OK */ -#define IMR_MGNTDOK_88E BIT6 /* Management Queue DMA OK */ -#define IMR_BKDOK_88E BIT5 /* AC_BK DMA OK */ -#define IMR_BEDOK_88E BIT4 /* AC_BE DMA OK */ -#define IMR_VIDOK_88E BIT3 /* AC_VI DMA OK */ -#define IMR_VODOK_88E BIT2 /* AC_VO DMA OK */ -#define IMR_RDU_88E BIT1 /* Rx Descriptor Unavailable */ -#define IMR_ROK_88E BIT0 /* Receive DMA OK */ +#define IMR_TXCCK_88E BIT(30) /* TXRPT interrupt when CCX bit of the packet is set */ +#define IMR_PSTIMEOUT_88E BIT(29) /* Power Save Time Out Interrupt */ +#define IMR_GTINT4_88E BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ +#define IMR_GTINT3_88E BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ +#define IMR_TBDER_88E BIT(26) /* Transmit Beacon0 Error */ +#define IMR_TBDOK_88E BIT(25) /* Transmit Beacon0 OK */ +#define IMR_TSF_BIT32_TOGGLE_88E BIT(24) /* TSF Timer BIT32 toggle indication interrupt */ +#define IMR_BCNDMAINT0_88E BIT(20) /* Beacon DMA Interrupt 0 */ +#define IMR_BCNDERR0_88E BIT(16) /* Beacon Queue DMA Error 0 */ +#define IMR_HSISR_IND_ON_INT_88E BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ +#define IMR_BCNDMAINT_E_88E BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ +#define IMR_ATIMEND_88E BIT(12) /* CTWidnow End or ATIM Window End */ +#define IMR_HISR1_IND_INT_88E BIT(11) /* HISR1 Indicator (HISR1 & HIMR1 is true, this bit is set to 1) */ +#define IMR_C2HCMD_88E BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ +#define IMR_CPWM2_88E BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_CPWM_88E BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_HIGHDOK_88E BIT(7) /* High Queue DMA OK */ +#define IMR_MGNTDOK_88E BIT(6) /* Management Queue DMA OK */ +#define IMR_BKDOK_88E BIT(5) /* AC_BK DMA OK */ +#define IMR_BEDOK_88E BIT(4) /* AC_BE DMA OK */ +#define IMR_VIDOK_88E BIT(3) /* AC_VI DMA OK */ +#define IMR_VODOK_88E BIT(2) /* AC_VO DMA OK */ +#define IMR_RDU_88E BIT(1) /* Rx Descriptor Unavailable */ +#define IMR_ROK_88E BIT(0) /* Receive DMA OK */ /* IMR DW1(0x00B4-00B7) Bit 0-31 */ -#define IMR_BCNDMAINT7_88E BIT27 /* Beacon DMA Interrupt 7 */ -#define IMR_BCNDMAINT6_88E BIT26 /* Beacon DMA Interrupt 6 */ -#define IMR_BCNDMAINT5_88E BIT25 /* Beacon DMA Interrupt 5 */ -#define IMR_BCNDMAINT4_88E BIT24 /* Beacon DMA Interrupt 4 */ -#define IMR_BCNDMAINT3_88E BIT23 /* Beacon DMA Interrupt 3 */ -#define IMR_BCNDMAINT2_88E BIT22 /* Beacon DMA Interrupt 2 */ -#define IMR_BCNDMAINT1_88E BIT21 /* Beacon DMA Interrupt 1 */ -#define IMR_BCNDOK7_88E BIT20 /* Beacon Queue DMA OK Interrup 7 */ -#define IMR_BCNDOK6_88E BIT19 /* Beacon Queue DMA OK Interrup 6 */ -#define IMR_BCNDOK5_88E BIT18 /* Beacon Queue DMA OK Interrup 5 */ -#define IMR_BCNDOK4_88E BIT17 /* Beacon Queue DMA OK Interrup 4 */ -#define IMR_BCNDOK3_88E BIT16 /* Beacon Queue DMA OK Interrup 3 */ -#define IMR_BCNDOK2_88E BIT15 /* Beacon Queue DMA OK Interrup 2 */ -#define IMR_BCNDOK1_88E BIT14 /* Beacon Queue DMA OK Interrup 1 */ -#define IMR_ATIMEND_E_88E BIT13 /* ATIM Window End Extension for Win7 */ -#define IMR_TXERR_88E BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -#define IMR_RXERR_88E BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -#define IMR_TXFOVW_88E BIT9 /* Transmit FIFO Overflow */ -#define IMR_RXFOVW_88E BIT8 /* Receive FIFO Overflow */ +#define IMR_BCNDMAINT7_88E BIT(27) /* Beacon DMA Interrupt 7 */ +#define IMR_BCNDMAINT6_88E BIT(26) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5_88E BIT(25) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4_88E BIT(24) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3_88E BIT(23) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2_88E BIT(22) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1_88E BIT(21) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK7_88E BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ +#define IMR_BCNDOK6_88E BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ +#define IMR_BCNDOK5_88E BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ +#define IMR_BCNDOK4_88E BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ +#define IMR_BCNDOK3_88E BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ +#define IMR_BCNDOK2_88E BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ +#define IMR_BCNDOK1_88E BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ +#define IMR_ATIMEND_E_88E BIT(13) /* ATIM Window End Extension for Win7 */ +#define IMR_TXERR_88E BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ +#define IMR_RXERR_88E BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ +#define IMR_TXFOVW_88E BIT(9) /* Transmit FIFO Overflow */ +#define IMR_RXFOVW_88E BIT(8) /* Receive FIFO Overflow */ /*=================================================================== ===================================================================== @@ -1083,49 +1078,49 @@ Current IOREG MAP * the correct arragement is VO - Bit0, VI - Bit1, BE - Bit2, and BK - Bit3. * 8723 and 88E may be not correct either in the eralier version. Confirmed with DD Tim. * By Bruce, 2011-09-22. */ -#define StopBecon BIT6 -#define StopHigh BIT5 -#define StopMgt BIT4 -#define StopBK BIT3 -#define StopBE BIT2 -#define StopVI BIT1 -#define StopVO BIT0 +#define StopBecon BIT(6) +#define StopHigh BIT(5) +#define StopMgt BIT(4) +#define StopBK BIT(3) +#define StopBE BIT(2) +#define StopVI BIT(1) +#define StopVO BIT(0) /* ---------------------------------------------------------------------------- * 8192C (RCR) Receive Configuration Register (Offset 0x608, 32 bits) * ---------------------------------------------------------------------------- */ -#define RCR_APPFCS BIT31 /* WMAC append FCS after pauload */ -#define RCR_APP_MIC BIT30 /* MACRX will retain the MIC at the bottom of the packet. */ -#define RCR_APP_ICV BIT29 /* MACRX will retain the ICV at the bottom of the packet. */ -#define RCR_APP_PHYST_RXFF BIT28 /* PHY Status is appended before RX packet in RXFF */ -#define RCR_APP_BA_SSN BIT27 /* SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. */ -#define RCR_VHT_DACK BIT26 /* This bit to control response type for vht single mpdu data packet. 1. ACK as response 0. BA as response */ -#define RCR_TCPOFLD_EN BIT25 /* Enable TCP checksum offload */ -#define RCR_ENMBID BIT24 /* Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. */ -#define RCR_LSIGEN BIT23 /* Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. */ -#define RCR_MFBEN BIT22 /* Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. */ -#define RCR_DISCHKPPDLLEN BIT21 /* Do not check PPDU while the PPDU length is smaller than 14 byte. */ -#define RCR_PKTCTL_DLEN BIT20 /* While rx path dead lock occurs, reset rx path */ -#define RCR_DISGCLK BIT19 /* Disable macrx clock gating control (no used) */ -#define RCR_TIM_PARSER_EN BIT18 /* RX Beacon TIM Parser. */ -#define RCR_BC_MD_EN BIT17 /* Broadcast data packet more data bit check interrupt enable.*/ -#define RCR_UC_MD_EN BIT16 /* Unicast data packet more data bit check interrupt enable. */ -#define RCR_RXSK_PERPKT BIT15 /* Executing key search per MPDU */ -#define RCR_HTC_LOC_CTRL BIT14 /* MFC<--HTC = 1 MFC-->HTC = 0 */ -#define RCR_AMF BIT13 /* Accept management type frame */ -#define RCR_ACF BIT12 /* Accept control type frame. Control frames BA, BAR, and PS-Poll (when in AP mode) are not controlled by this bit. They are controlled by ADF. */ -#define RCR_ADF BIT11 /* Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). */ -#define RCR_DISDECMYPKT BIT10 /* This bit determines whether hw need to do decryption.1: If A1 match, do decryption.0: Do decryption. */ -#define RCR_AICV BIT9 /* Accept ICV error packet */ -#define RCR_ACRC32 BIT8 /* Accept CRC32 error packet */ -#define RCR_CBSSID_BCN BIT7 /* Accept BSSID match packet (Rx beacon, probe rsp) */ -#define RCR_CBSSID_DATA BIT6 /* Accept BSSID match packet (Data) */ -#define RCR_APWRMGT BIT5 /* Accept power management packet */ -#define RCR_ADD3 BIT4 /* Accept address 3 match packet */ -#define RCR_AB BIT3 /* Accept broadcast packet */ -#define RCR_AM BIT2 /* Accept multicast packet */ -#define RCR_APM BIT1 /* Accept physical match packet */ -#define RCR_AAP BIT0 /* Accept all unicast packet */ +#define RCR_APPFCS BIT(31) /* WMAC append FCS after pauload */ +#define RCR_APP_MIC BIT(30) /* MACRX will retain the MIC at the bottom of the packet. */ +#define RCR_APP_ICV BIT(29) /* MACRX will retain the ICV at the bottom of the packet. */ +#define RCR_APP_PHYST_RXFF BIT(28) /* PHY Status is appended before RX packet in RXFF */ +#define RCR_APP_BA_SSN BIT(27) /* SSN of previous TXBA is appended as after original RXDESC as the 4-th DW of RXDESC. */ +#define RCR_VHT_DACK BIT(26) /* This bit to control response type for vht single mpdu data packet. 1. ACK as response 0. BA as response */ +#define RCR_TCPOFLD_EN BIT(25) /* Enable TCP checksum offload */ +#define RCR_ENMBID BIT(24) /* Enable Multiple BssId. Only response ACK to the packets whose DID(A1) matching to the addresses in the MBSSID CAM Entries. */ +#define RCR_LSIGEN BIT(23) /* Enable LSIG TXOP Protection function. Search KEYCAM for each rx packet to check if LSIGEN bit is set. */ +#define RCR_MFBEN BIT(22) /* Enable immediate MCS Feedback function. When Rx packet with MRQ = 1'b1, then search KEYCAM to find sender's MCS Feedback function and send response. */ +#define RCR_DISCHKPPDLLEN BIT(21) /* Do not check PPDU while the PPDU length is smaller than 14 byte. */ +#define RCR_PKTCTL_DLEN BIT(20) /* While rx path dead lock occurs, reset rx path */ +#define RCR_DISGCLK BIT(19) /* Disable macrx clock gating control (no used) */ +#define RCR_TIM_PARSER_EN BIT(18) /* RX Beacon TIM Parser. */ +#define RCR_BC_MD_EN BIT(17) /* Broadcast data packet more data bit check interrupt enable.*/ +#define RCR_UC_MD_EN BIT(16) /* Unicast data packet more data bit check interrupt enable. */ +#define RCR_RXSK_PERPKT BIT(15) /* Executing key search per MPDU */ +#define RCR_HTC_LOC_CTRL BIT(14) /* MFC<--HTC = 1 MFC-->HTC = 0 */ +#define RCR_AMF BIT(13) /* Accept management type frame */ +#define RCR_ACF BIT(12) /* Accept control type frame. Control frames BA, BAR, and PS-Poll (when in AP mode) are not controlled by this bit. They are controlled by ADF. */ +#define RCR_ADF BIT(11) /* Accept data type frame. This bit also regulates BA, BAR, and PS-Poll (AP mode only). */ +#define RCR_DISDECMYPKT BIT(10) /* This bit determines whether hw need to do decryption.1: If A1 match, do decryption.0: Do decryption. */ +#define RCR_AICV BIT(9) /* Accept ICV error packet */ +#define RCR_ACRC32 BIT(8) /* Accept CRC32 error packet */ +#define RCR_CBSSID_BCN BIT(7) /* Accept BSSID match packet (Rx beacon, probe rsp) */ +#define RCR_CBSSID_DATA BIT(6) /* Accept BSSID match packet (Data) */ +#define RCR_APWRMGT BIT(5) /* Accept power management packet */ +#define RCR_ADD3 BIT(4) /* Accept address 3 match packet */ +#define RCR_AB BIT(3) /* Accept broadcast packet */ +#define RCR_AM BIT(2) /* Accept multicast packet */ +#define RCR_APM BIT(1) /* Accept physical match packet */ +#define RCR_AAP BIT(0) /* Accept all unicast packet */ /* ----------------------------------------------------- @@ -1433,6 +1428,17 @@ Current IOREG MAP #define BIT_Tx_OQT_free_space(x) (((x) & BIT_MASK_Tx_OQT_free_space) << BIT_SHIFT_Tx_OQT_free_space) +/* ----------------------------------------------------- + * + * 0x0120h ~ 0x0123h RX DMA Configuration + * + * ----------------------------------------------------- */ +#define BIT_FS_RXDONE_INT_EN BIT(16) + + +/* REG_RXPKT_NUM (Offset 0x0284) */ +#define BIT_RW_RELEASE_EN BIT(18) + /* ----------------------------------------------------- * * 0x0280h ~ 0x028Bh RX DMA Configuration @@ -1472,6 +1478,12 @@ Current IOREG MAP #define RETRY_LIMIT_SHORT_SHIFT 8 #define RETRY_LIMIT_LONG_SHIFT 0 +#define RL_VAL_AP 7 +#ifdef CONFIG_RTW_CUSTOMIZE_RLSTA +#define RL_VAL_STA CONFIG_RTW_CUSTOMIZE_RLSTA +#else +#define RL_VAL_STA 0x30 +#endif /* ----------------------------------------------------- * * 0x0500h ~ 0x05FFh EDCA Configuration @@ -1653,56 +1665,56 @@ Current IOREG MAP #define SDIO_HIMR_DISABLED 0 /* RTL8723/RTL8188E SDIO Host Interrupt Mask Register */ -#define SDIO_HIMR_RX_REQUEST_MSK BIT0 -#define SDIO_HIMR_AVAL_MSK BIT1 -#define SDIO_HIMR_TXERR_MSK BIT2 -#define SDIO_HIMR_RXERR_MSK BIT3 -#define SDIO_HIMR_TXFOVW_MSK BIT4 -#define SDIO_HIMR_RXFOVW_MSK BIT5 -#define SDIO_HIMR_TXBCNOK_MSK BIT6 -#define SDIO_HIMR_TXBCNERR_MSK BIT7 -#define SDIO_HIMR_BCNERLY_INT_MSK BIT16 -#define SDIO_HIMR_C2HCMD_MSK BIT17 -#define SDIO_HIMR_CPWM1_MSK BIT18 -#define SDIO_HIMR_CPWM2_MSK BIT19 -#define SDIO_HIMR_HSISR_IND_MSK BIT20 -#define SDIO_HIMR_GTINT3_IND_MSK BIT21 -#define SDIO_HIMR_GTINT4_IND_MSK BIT22 -#define SDIO_HIMR_PSTIMEOUT_MSK BIT23 -#define SDIO_HIMR_OCPINT_MSK BIT24 -#define SDIO_HIMR_ATIMEND_MSK BIT25 -#define SDIO_HIMR_ATIMEND_E_MSK BIT26 -#define SDIO_HIMR_CTWEND_MSK BIT27 +#define SDIO_HIMR_RX_REQUEST_MSK BIT(0) +#define SDIO_HIMR_AVAL_MSK BIT(1) +#define SDIO_HIMR_TXERR_MSK BIT(2) +#define SDIO_HIMR_RXERR_MSK BIT(3) +#define SDIO_HIMR_TXFOVW_MSK BIT(4) +#define SDIO_HIMR_RXFOVW_MSK BIT(5) +#define SDIO_HIMR_TXBCNOK_MSK BIT(6) +#define SDIO_HIMR_TXBCNERR_MSK BIT(7) +#define SDIO_HIMR_BCNERLY_INT_MSK BIT(16) +#define SDIO_HIMR_C2HCMD_MSK BIT(17) +#define SDIO_HIMR_CPWM1_MSK BIT(18) +#define SDIO_HIMR_CPWM2_MSK BIT(19) +#define SDIO_HIMR_HSISR_IND_MSK BIT(20) +#define SDIO_HIMR_GTINT3_IND_MSK BIT(21) +#define SDIO_HIMR_GTINT4_IND_MSK BIT(22) +#define SDIO_HIMR_PSTIMEOUT_MSK BIT(23) +#define SDIO_HIMR_OCPINT_MSK BIT(24) +#define SDIO_HIMR_ATIMEND_MSK BIT(25) +#define SDIO_HIMR_ATIMEND_E_MSK BIT(26) +#define SDIO_HIMR_CTWEND_MSK BIT(27) /* RTL8188E SDIO Specific */ -#define SDIO_HIMR_MCU_ERR_MSK BIT28 -#define SDIO_HIMR_TSF_BIT32_TOGGLE_MSK BIT29 +#define SDIO_HIMR_MCU_ERR_MSK BIT(28) +#define SDIO_HIMR_TSF_BIT32_TOGGLE_MSK BIT(29) /* SDIO Host Interrupt Service Routine */ -#define SDIO_HISR_RX_REQUEST BIT0 -#define SDIO_HISR_AVAL BIT1 -#define SDIO_HISR_TXERR BIT2 -#define SDIO_HISR_RXERR BIT3 -#define SDIO_HISR_TXFOVW BIT4 -#define SDIO_HISR_RXFOVW BIT5 -#define SDIO_HISR_TXBCNOK BIT6 -#define SDIO_HISR_TXBCNERR BIT7 -#define SDIO_HISR_BCNERLY_INT BIT16 -#define SDIO_HISR_C2HCMD BIT17 -#define SDIO_HISR_CPWM1 BIT18 -#define SDIO_HISR_CPWM2 BIT19 -#define SDIO_HISR_HSISR_IND BIT20 -#define SDIO_HISR_GTINT3_IND BIT21 -#define SDIO_HISR_GTINT4_IND BIT22 -#define SDIO_HISR_PSTIMEOUT BIT23 -#define SDIO_HISR_OCPINT BIT24 -#define SDIO_HISR_ATIMEND BIT25 -#define SDIO_HISR_ATIMEND_E BIT26 -#define SDIO_HISR_CTWEND BIT27 +#define SDIO_HISR_RX_REQUEST BIT(0) +#define SDIO_HISR_AVAL BIT(1) +#define SDIO_HISR_TXERR BIT(2) +#define SDIO_HISR_RXERR BIT(3) +#define SDIO_HISR_TXFOVW BIT(4) +#define SDIO_HISR_RXFOVW BIT(5) +#define SDIO_HISR_TXBCNOK BIT(6) +#define SDIO_HISR_TXBCNERR BIT(7) +#define SDIO_HISR_BCNERLY_INT BIT(16) +#define SDIO_HISR_C2HCMD BIT(17) +#define SDIO_HISR_CPWM1 BIT(18) +#define SDIO_HISR_CPWM2 BIT(19) +#define SDIO_HISR_HSISR_IND BIT(20) +#define SDIO_HISR_GTINT3_IND BIT(21) +#define SDIO_HISR_GTINT4_IND BIT(22) +#define SDIO_HISR_PSTIMEOUT BIT(23) +#define SDIO_HISR_OCPINT BIT(24) +#define SDIO_HISR_ATIMEND BIT(25) +#define SDIO_HISR_ATIMEND_E BIT(26) +#define SDIO_HISR_CTWEND BIT(27) /* RTL8188E SDIO Specific */ -#define SDIO_HISR_MCU_ERR BIT28 -#define SDIO_HISR_TSF_BIT32_TOGGLE BIT29 +#define SDIO_HISR_MCU_ERR BIT(28) +#define SDIO_HISR_TSF_BIT32_TOGGLE BIT(29) #define MASK_SDIO_HISR_CLEAR (SDIO_HISR_TXERR |\ SDIO_HISR_RXERR |\ @@ -1720,8 +1732,8 @@ Current IOREG MAP SDIO_HISR_OCPINT) /* SDIO HCI Suspend Control Register */ -#define HCI_RESUME_PWR_RDY BIT1 -#define HCI_SUS_CTRL BIT0 +#define HCI_RESUME_PWR_RDY BIT(1) +#define HCI_SUS_CTRL BIT(0) /* SDIO Tx FIFO related */ #define SDIO_TX_FREE_PG_QUEUE 4 /* The number of Tx FIFO free page */ @@ -1761,31 +1773,31 @@ Current IOREG MAP /* 2REG_MULTI_FUNC_CTRL(For RTL8723 Only) */ -#define WL_HWPDN_EN BIT0 /* Enable GPIO[9] as WiFi HW PDn source */ -#define WL_HWPDN_SL BIT1 /* WiFi HW PDn polarity control */ -#define WL_FUNC_EN BIT2 /* WiFi function enable */ -#define WL_HWROF_EN BIT3 /* Enable GPIO[9] as WiFi RF HW PDn source */ -#define BT_HWPDN_EN BIT16 /* Enable GPIO[11] as BT HW PDn source */ -#define BT_HWPDN_SL BIT17 /* BT HW PDn polarity control */ -#define BT_FUNC_EN BIT18 /* BT function enable */ -#define BT_HWROF_EN BIT19 /* Enable GPIO[11] as BT/GPS RF HW PDn source */ -#define GPS_HWPDN_EN BIT20 /* Enable GPIO[10] as GPS HW PDn source */ -#define GPS_HWPDN_SL BIT21 /* GPS HW PDn polarity control */ -#define GPS_FUNC_EN BIT22 /* GPS function enable */ +#define WL_HWPDN_EN BIT(0) /* Enable GPIO[9] as WiFi HW PDn source */ +#define WL_HWPDN_SL BIT(1) /* WiFi HW PDn polarity control */ +#define WL_FUNC_EN BIT(2) /* WiFi function enable */ +#define WL_HWROF_EN BIT(3) /* Enable GPIO[9] as WiFi RF HW PDn source */ +#define BT_HWPDN_EN BIT(16) /* Enable GPIO[11] as BT HW PDn source */ +#define BT_HWPDN_SL BIT(17) /* BT HW PDn polarity control */ +#define BT_FUNC_EN BIT(18) /* BT function enable */ +#define BT_HWROF_EN BIT(19) /* Enable GPIO[11] as BT/GPS RF HW PDn source */ +#define GPS_HWPDN_EN BIT(20) /* Enable GPIO[10] as GPS HW PDn source */ +#define GPS_HWPDN_SL BIT(21) /* GPS HW PDn polarity control */ +#define GPS_FUNC_EN BIT(22) /* GPS function enable */ /* 3 REG_LIFECTRL_CTRL */ -#define HAL92C_EN_PKT_LIFE_TIME_BK BIT3 -#define HAL92C_EN_PKT_LIFE_TIME_BE BIT2 -#define HAL92C_EN_PKT_LIFE_TIME_VI BIT1 -#define HAL92C_EN_PKT_LIFE_TIME_VO BIT0 +#define HAL92C_EN_PKT_LIFE_TIME_BK BIT(3) +#define HAL92C_EN_PKT_LIFE_TIME_BE BIT(2) +#define HAL92C_EN_PKT_LIFE_TIME_VI BIT(1) +#define HAL92C_EN_PKT_LIFE_TIME_VO BIT(0) #define HAL92C_MSDU_LIFE_TIME_UNIT 128 /* in us, said by Tim. */ /* 2 8192D PartNo. */ #define PARTNO_92D_NIC (BIT7 | BIT6) #define PARTNO_92D_NIC_REMARK (BIT5 | BIT4) -#define PARTNO_SINGLE_BAND_VS BIT3 -#define PARTNO_SINGLE_BAND_VS_REMARK BIT1 +#define PARTNO_SINGLE_BAND_VS BIT(3) +#define PARTNO_SINGLE_BAND_VS_REMARK BIT(1) #define PARTNO_CONCURRENT_BAND_VC (BIT3 | BIT2) #define PARTNO_CONCURRENT_BAND_VC_REMARK (BIT1 | BIT0) @@ -1793,7 +1805,11 @@ Current IOREG MAP * General definitions * ******************************************************** */ -#define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) (IS_VENDOR_8188E_I_CUT_SERIES(__Adapter) ? 255 : 175) +#ifdef CONFIG_USB_HCI + #define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) (175) +#else + #define LAST_ENTRY_OF_TX_PKT_BUFFER_8188E(__Adapter) (IS_VENDOR_8188E_I_CUT_SERIES(__Adapter) ? 255 : 175) +#endif #define LAST_ENTRY_OF_TX_PKT_BUFFER_8812 255 #define LAST_ENTRY_OF_TX_PKT_BUFFER_8723B 255 #define LAST_ENTRY_OF_TX_PKT_BUFFER_8192C 255 @@ -1811,9 +1827,9 @@ Current IOREG MAP /* GPIO BIT */ -#define HAL_8812A_HW_GPIO_WPS_BIT BIT2 -#define HAL_8192C_HW_GPIO_WPS_BIT BIT2 -#define HAL_8192EU_HW_GPIO_WPS_BIT BIT7 -#define HAL_8188E_HW_GPIO_WPS_BIT BIT7 +#define HAL_8812A_HW_GPIO_WPS_BIT BIT(2) +#define HAL_8192C_HW_GPIO_WPS_BIT BIT(2) +#define HAL_8192EU_HW_GPIO_WPS_BIT BIT(7) +#define HAL_8188E_HW_GPIO_WPS_BIT BIT(7) #endif /* __HAL_COMMON_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_data.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_data.h index 25d931770775..33f216ff7671 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_data.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_data.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_DATA_H__ #define __HAL_DATA_H__ @@ -33,6 +28,11 @@ #ifdef CONFIG_GSPI_HCI #include #endif + +#if defined(CONFIG_RTW_ACS) || defined(CONFIG_BACKGROUND_NOISE_MONITOR) +#include "../hal/hal_dm_acs.h" +#endif + /* * For RTL8723 WiFi/BT/GPS multi-function configuration. 2010.10.06. * */ @@ -199,24 +199,6 @@ typedef struct _BB_INIT_REGISTER { #define HCI_SUS_ENTERING 3 #define HCI_SUS_ERR 4 -#ifdef CONFIG_AUTO_CHNL_SEL_NHM -typedef enum _ACS_OP { - ACS_INIT, /*ACS - Variable init*/ - ACS_RESET, /*ACS - NHM Counter reset*/ - ACS_SELECT, /*ACS - NHM Counter Statistics */ -} ACS_OP; - -typedef enum _ACS_STATE { - ACS_DISABLE, - ACS_ENABLE, -} ACS_STATE; - -struct auto_chan_sel { - ATOMIC_T state; - u8 ch; /* previous channel*/ -}; -#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ - #define EFUSE_FILE_UNUSED 0 #define EFUSE_FILE_FAILED 1 #define EFUSE_FILE_LOADED 2 @@ -225,8 +207,8 @@ struct auto_chan_sel { #define MACADDR_FILE_FAILED 1 #define MACADDR_FILE_LOADED 2 -#define KFREE_FLAG_ON BIT0 -#define KFREE_FLAG_THERMAL_K_ON BIT1 +#define KFREE_FLAG_ON BIT(0) +#define KFREE_FLAG_THERMAL_K_ON BIT(1) #define MAX_IQK_INFO_BACKUP_CHNL_NUM 5 #define MAX_IQK_INFO_BACKUP_REG_NUM 10 @@ -255,12 +237,14 @@ struct hal_spec_t { u8 rfpath_num_5g:4; /* used for tx power index path */ u8 max_tx_cnt; - u8 nss_num; + u8 tx_nss_num:4; + u8 rx_nss_num:4; u8 band_cap; /* value of BAND_CAP_XXX */ u8 bw_cap; /* value of BW_CAP_XXX */ u8 port_num; u8 proto_cap; /* value of PROTO_CAP_XXX */ u8 wl_func; /* value of WL_FUNC_XXX */ + u8 hci_type; /* value of HCI Type */ }; #define HAL_SPEC_CHK_RF_PATH_2G(_spec, _path) ((_spec)->rfpath_num_2g > (_path)) @@ -271,34 +255,111 @@ struct hal_spec_t { #define HAL_SPEC_CHK_TX_CNT(_spec, _cnt_idx) ((_spec)->max_tx_cnt > (_cnt_idx)) +#ifdef CONFIG_PHY_CAPABILITY_QUERY +struct phy_spec_t { + u32 trx_cap; + u32 stbc_cap; + u32 ldpc_cap; + u32 txbf_param; + u32 txbf_cap; +}; +#endif struct hal_iqk_reg_backup { u8 central_chnl; u8 bw_mode; u32 reg_backup[MAX_RF_PATH][MAX_IQK_INFO_BACKUP_REG_NUM]; }; + +typedef struct hal_p2p_ps_para { + /*DW0*/ + u8 offload_en:1; + u8 role:1; + u8 ctwindow_en:1; + u8 noa_en:1; + u8 noa_sel:1; + u8 all_sta_sleep:1; + u8 discovery:1; + u8 rsvd2:1; + u8 p2p_port_id; + u8 p2p_group; + u8 p2p_macid; + + /*DW1*/ + u8 ctwindow_length; + u8 rsvd3; + u8 rsvd4; + u8 rsvd5; + + /*DW2*/ + u32 noa_duration_para; + + /*DW3*/ + u32 noa_interval_para; + + /*DW4*/ + u32 noa_start_time_para; + + /*DW5*/ + u32 noa_count_para; +} HAL_P2P_PS_PARA, *PHAL_P2P_PS_PARA; + +#define TXPWR_LMT_RS_CCK 0 +#define TXPWR_LMT_RS_OFDM 1 +#define TXPWR_LMT_RS_HT 2 +#define TXPWR_LMT_RS_VHT 3 +#define TXPWR_LMT_RS_NUM 4 + +#define TXPWR_LMT_RS_NUM_2G 4 /* CCK, OFDM, HT, VHT */ +#define TXPWR_LMT_RS_NUM_5G 3 /* OFDM, HT, VHT */ + +#ifdef CONFIG_TXPWR_LIMIT +extern const char *const _txpwr_lmt_rs_str[]; +#define txpwr_lmt_rs_str(rs) (((rs) >= TXPWR_LMT_RS_NUM) ? _txpwr_lmt_rs_str[TXPWR_LMT_RS_NUM] : _txpwr_lmt_rs_str[(rs)]) + +struct txpwr_lmt_ent { + _list list; + + s8 lmt_2g[MAX_2_4G_BANDWIDTH_NUM] + [TXPWR_LMT_RS_NUM_2G] + [CENTER_CH_2G_NUM] + [MAX_TX_COUNT]; + +#ifdef CONFIG_IEEE80211_BAND_5GHZ + s8 lmt_5g[MAX_5G_BANDWIDTH_NUM] + [TXPWR_LMT_RS_NUM_5G] + [CENTER_CH_5G_ALL_NUM] + [MAX_TX_COUNT]; +#endif + + char regd_name[0]; +}; +#endif /* CONFIG_TXPWR_LIMIT */ + typedef struct hal_com_data { - HAL_VERSION VersionID; + HAL_VERSION version_id; RT_MULTI_FUNC MultiFunc; /* For multi-function consideration. */ RT_POLARITY_CTL PolarityCtl; /* For Wifi PDn Polarity control. */ RT_REGULATOR_MODE RegulatorMode; /* switching regulator or LDO */ u8 hw_init_completed; /****** FW related ******/ - u16 FirmwareVersion; + u32 firmware_size; + u16 firmware_version; u16 FirmwareVersionRev; - u16 FirmwareSubVersion; + u16 firmware_sub_version; u16 FirmwareSignature; u8 RegFWOffload; + u8 bFWReady; + u8 bBTFWReady; u8 fw_ractrl; - u8 FwRsvdPageStartOffset; /* 2010.06.23. Added by tynli. Reserve page start offset except beacon in TxQ.*/ u8 LastHMEBoxNum; /* H2C - for host message to fw */ /****** current WIFI_PHY values ******/ WIRELESS_MODE CurrentWirelessMode; - CHANNEL_WIDTH CurrentChannelBW; - BAND_TYPE CurrentBandType; /* 0:2.4G, 1:5G */ + enum channel_width current_channel_bw; + BAND_TYPE current_band_type; /* 0:2.4G, 1:5G */ BAND_TYPE BandSet; - u8 CurrentChannel; + u8 current_channel; u8 cch_20; u8 cch_40; u8 cch_80; @@ -309,6 +370,7 @@ typedef struct hal_com_data { u8 bDisableSWChannelPlan; /* flag of disable software change channel plan */ u16 BasicRateSet; u32 ReceiveConfig; + u32 rcr_backup; /* used for switching back from monitor mode */ u8 rx_tsf_addr_filter_config; /* for 8822B/8821C USE */ BOOLEAN bSwChnl; BOOLEAN bSetChnlBW; @@ -316,21 +378,27 @@ typedef struct hal_com_data { BOOLEAN bSWToBW80M; BOOLEAN bChnlBWInitialized; u32 BackUp_BB_REG_4_2nd_CCA[3]; -#ifdef CONFIG_AUTO_CHNL_SEL_NHM + +#ifdef CONFIG_RTW_ACS struct auto_chan_sel acs; #endif +#ifdef CONFIG_BCN_RECOVERY + u8 issue_bcn_fail; +#endif /*CONFIG_BCN_RECOVERY*/ + /****** rf_ctrl *****/ u8 rf_chip; - u8 rf_type; + u8 rf_type; /*enum rf_type*/ u8 PackageType; u8 NumTotalRFPath; + u8 antenna_test; /****** Debug ******/ u16 ForcedDataRate; /* Force Data Rate. 0: Auto, 0x02: 1M ~ 0x6C: 54M. */ - u8 u1ForcedIgiLb; /* forced IGI lower bound */ u8 bDumpRxPkt; u8 bDumpTxPkt; u8 bDisableTXPowerTraining; + u8 dis_turboedca; /****** EEPROM setting.******/ @@ -358,13 +426,17 @@ typedef struct hal_com_data { u8 EEPROMSubCustomerID; u8 EEPROMVersion; u8 EEPROMRegulatory; - u8 EEPROMThermalMeter; + u8 eeprom_thermal_meter; u8 EEPROMBluetoothCoexist; u8 EEPROMBluetoothType; u8 EEPROMBluetoothAntNum; u8 EEPROMBluetoothAntIsolation; u8 EEPROMBluetoothRadioShared; u8 EEPROMMACAddr[ETH_ALEN]; + u8 tx_bbswing_24G; + u8 tx_bbswing_5G; + u8 efuse0x3d7; /* efuse[0x3D7] */ + u8 efuse0x3d8; /* efuse[0x3D8] */ #ifdef CONFIG_RF_POWER_TRIM u8 EEPROMRFGainOffset; @@ -401,84 +473,27 @@ typedef struct hal_com_data { s8 BW80_5G_Diff[MAX_RF_PATH][MAX_TX_COUNT]; #endif - u8 Regulation2_4G; - u8 Regulation5G; - - /******************************** - * TX power by rate table at most 4RF path. - * The register is - * - * VHT TX power by rate off setArray = - * Band:-2G&5G = 0 / 1 - * RF: at most 4*4 = ABCD=0/1/2/3 - * CCK=0 OFDM=1/2 HT-MCS 0-15=3/4/56 VHT=7/8/9/10/11 - **********************************/ - u8 txpwr_by_rate_undefined_band_path[TX_PWR_BY_RATE_NUM_BAND] [TX_PWR_BY_RATE_NUM_RF]; s8 TxPwrByRateOffset[TX_PWR_BY_RATE_NUM_BAND] - [TX_PWR_BY_RATE_NUM_RF] [TX_PWR_BY_RATE_NUM_RF] [TX_PWR_BY_RATE_NUM_RATE]; -#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI - s8 TxPwrByRate[TX_PWR_BY_RATE_NUM_BAND] - [TX_PWR_BY_RATE_NUM_RF] - [TX_PWR_BY_RATE_NUM_RF] - [TX_PWR_BY_RATE_NUM_RATE]; -#endif - /* --------------------------------------------------------------------------------- */ - - u8 tx_pwr_lmt_5g_20_40_ref; - - /* Power Limit Table for 2.4G */ - s8 TxPwrLimit_2_4G[MAX_REGULATION_NUM] - [MAX_2_4G_BANDWIDTH_NUM] - [MAX_RATE_SECTION_NUM] - [CENTER_CH_2G_NUM] - [MAX_RF_PATH]; - - /* Power Limit Table for 5G */ - s8 TxPwrLimit_5G[MAX_REGULATION_NUM] - [MAX_5G_BANDWIDTH_NUM] - [MAX_RATE_SECTION_NUM] - [CENTER_CH_5G_ALL_NUM] - [MAX_RF_PATH]; - - -#ifdef CONFIG_PHYDM_POWERTRACK_BY_TSSI - s8 TxPwrLimit_2_4G_Original[MAX_REGULATION_NUM] - [MAX_2_4G_BANDWIDTH_NUM] - [MAX_RATE_SECTION_NUM] - [CENTER_CH_2G_NUM] - [MAX_RF_PATH]; - - - s8 TxPwrLimit_5G_Original[MAX_REGULATION_NUM] - [MAX_5G_BANDWIDTH_NUM] - [MAX_RATE_SECTION_NUM] - [CENTER_CH_5G_ALL_NUM] - [MAX_RF_PATH]; - -#endif - - /* Store the original power by rate value of the base of each rate section of rf path A & B */ + /* Store the original power by rate value of the base rate for each rate section and rf path */ u8 TxPwrByRateBase2_4G[TX_PWR_BY_RATE_NUM_RF] - [TX_PWR_BY_RATE_NUM_RF] [MAX_BASE_NUM_IN_PHY_REG_PG_2_4G]; u8 TxPwrByRateBase5G[TX_PWR_BY_RATE_NUM_RF] - [TX_PWR_BY_RATE_NUM_RF] [MAX_BASE_NUM_IN_PHY_REG_PG_5G]; u8 txpwr_by_rate_loaded:1; u8 txpwr_by_rate_from_file:1; u8 txpwr_limit_loaded:1; u8 txpwr_limit_from_file:1; - u8 RfPowerTrackingType; + u8 rf_power_tracking_type; /* Read/write are allow for following hardware information variables */ - u8 CrystalCap; + u8 crystal_cap; u8 PAType_2G; u8 PAType_5G; @@ -486,17 +501,18 @@ typedef struct hal_com_data { u8 LNAType_5G; u8 ExternalPA_2G; u8 ExternalLNA_2G; - u8 ExternalPA_5G; - u8 ExternalLNA_5G; + u8 external_pa_5g; + u8 external_lna_5g; u16 TypeGLNA; u16 TypeGPA; u16 TypeALNA; u16 TypeAPA; - u16 RFEType; + u16 rfe_type; u8 bLedOpenDrain; /* Support Open-drain arrangement for controlling the LED. Added by Roger, 2009.10.16. */ - u32 AcParam_BE; /* Original parameter for BE, use for EDCA turbo. */ - + u32 ac_param_be; /* Original parameter for BE, use for EDCA turbo. */ + u8 is_turbo_edca; + u8 prv_traffic_idx; BB_REGISTER_DEFINITION_T PHYRegDef[MAX_RF_PATH]; /* Radio A/B/C/D */ u32 RfRegChnlVal[MAX_RF_PATH]; @@ -504,15 +520,7 @@ typedef struct hal_com_data { /* RDG enable */ BOOLEAN bRDGEnable; - u8 RegTxPause; - /* Beacon function related global variable. */ - u8 RegBcnCtrlVal; - u8 RegFwHwTxQCtrl; - u8 RegReg542; - u8 RegCR_1; - u8 Reg837; - u16 RegRRSR; - + u16 RegRRSR; /****** antenna diversity ******/ u8 AntDivCfg; u8 with_extenal_ant_switch; @@ -520,22 +528,20 @@ typedef struct hal_com_data { u8 AntDetection; u8 TRxAntDivType; u8 ant_path; /* for 8723B s0/s1 selection */ - u32 AntennaTxPath; /* Antenna path Tx */ + u32 antenna_tx_path; /* Antenna path Tx */ u32 AntennaRxPath; /* Antenna path Rx */ u8 sw_antdiv_bl_state; /******** PHY DM & DM Section **********/ - u8 DM_Type; _lock IQKSpinLock; u8 INIDATA_RATE[MACID_NUM_SW_LIMIT]; - /* Upper and Lower Signal threshold for Rate Adaptive*/ - int EntryMinUndecoratedSmoothedPWDB; - int EntryMaxUndecoratedSmoothedPWDB; - int MinUndecoratedPWDBForDM; - DM_ODM_T odmpriv; + + struct PHY_DM_STRUCT odmpriv; + u64 bk_rf_ability; u8 bIQKInitialized; u8 bNeedIQK; - u8 IQK_MP_Switch; + u8 IQK_MP_Switch; + u8 bScanInProcess; /******** PHY DM & DM Section **********/ @@ -610,10 +616,18 @@ typedef struct hal_com_data { u16 tx_normal_page; u16 tx_extra_page; u16 tx_pub_page; - u16 max_oqt_page; + u8 max_oqt_size; + #ifdef XMIT_BUF_SIZE u32 max_xmit_size_vovi; u32 max_xmit_size_bebk; -#endif + #endif /*XMIT_BUF_SIZE*/ + u16 max_xmit_page; + u16 max_xmit_page_vo; + u16 max_xmit_page_vi; + u16 max_xmit_page_be; + u16 max_xmit_page_bk; + +#endif /*#ifdef CONFIG_RTL8821C*/ #endif /* !RTW_HALMAC */ #endif /* CONFIG_SDIO_HCI */ @@ -659,6 +673,7 @@ typedef struct hal_com_data { BOOLEAN bL1OffSupport; BOOLEAN bSupportBackDoor; + u32 pci_backdoor_ctrl; u8 bDefaultAntenna; @@ -666,6 +681,9 @@ typedef struct hal_com_data { u8 bDisableTxInt; u16 RxTag; +#ifdef CONFIG_PCI_DYNAMIC_ASPM + BOOLEAN bAspmL1LastIdle; +#endif #endif /* CONFIG_PCI_HCI */ @@ -710,11 +728,13 @@ typedef struct hal_com_data { #endif #ifdef CONFIG_BACKGROUND_NOISE_MONITOR - s16 noise[ODM_MAX_CHANNEL_NUM]; + struct noise_monitor nm; #endif struct hal_spec_t hal_spec; - +#ifdef CONFIG_PHY_CAPABILITY_QUERY + struct phy_spec_t phy_spec; +#endif u8 RfKFreeEnable; u8 RfKFree_ch_group; BOOLEAN bCCKinCH14; @@ -728,11 +748,21 @@ typedef struct hal_com_data { struct hal_iqk_reg_backup iqk_reg_backup[MAX_IQK_INFO_BACKUP_CHNL_NUM]; +#ifdef RTW_HALMAC + u8 drv_rsvd_page_number; +#endif + #ifdef CONFIG_BEAMFORMING + u8 backup_snd_ptcl_ctrl; #ifdef RTW_BEAMFORMING_VERSION_2 struct beamforming_info beamforming_info; #endif /* RTW_BEAMFORMING_VERSION_2 */ #endif /* CONFIG_BEAMFORMING */ + + u8 not_xmitframe_fw_dl; /*not use xmitframe to download fw*/ + u8 phydm_op_mode; + + u8 in_cta_test; } HAL_DATA_COMMON, *PHAL_DATA_COMMON; @@ -740,7 +770,6 @@ typedef struct hal_com_data { typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; #define GET_HAL_DATA(__pAdapter) ((HAL_DATA_TYPE *)((__pAdapter)->HalData)) #define GET_HAL_SPEC(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->hal_spec)) -#define GET_ODM(__pAdapter) (&(GET_HAL_DATA((__pAdapter))->odmpriv)) #define GET_HAL_RFPATH_NUM(__pAdapter) (((HAL_DATA_TYPE *)((__pAdapter)->HalData))->NumTotalRFPath) #define RT_GetInterfaceSelection(_Adapter) (GET_HAL_DATA(_Adapter)->InterfaceSel) @@ -757,15 +786,264 @@ typedef struct hal_com_data HAL_DATA_TYPE, *PHAL_DATA_TYPE; #define rtw_is_hw_init_completed(adapter) (GET_HAL_DATA(adapter)->hw_init_completed == _TRUE) #endif -#ifdef CONFIG_AUTO_CHNL_SEL_NHM -#define GET_ACS_STATE(padapter) (ATOMIC_READ(&GET_HAL_DATA(padapter)->acs.state)) -#define SET_ACS_STATE(padapter, set_state) (ATOMIC_SET(&GET_HAL_DATA(padapter)->acs.state, set_state)) -#define rtw_get_acs_channel(padapter) (GET_HAL_DATA(padapter)->acs.ch) -#define rtw_set_acs_channel(padapter, survey_ch) (GET_HAL_DATA(padapter)->acs.ch = survey_ch) -#endif /*CONFIG_AUTO_CHNL_SEL_NHM*/ - #ifdef RTW_HALMAC int rtw_halmac_deinit_adapter(struct dvobj_priv *); #endif /* RTW_HALMAC */ +/* alias for phydm coding style */ +#define REG_OFDM_0_XA_TX_IQ_IMBALANCE rOFDM0_XATxIQImbalance +#define REG_OFDM_0_ECCA_THRESHOLD rOFDM0_ECCAThreshold +#define REG_FPGA0_XB_LSSI_READ_BACK rFPGA0_XB_LSSIReadBack +#define REG_FPGA0_TX_GAIN_STAGE rFPGA0_TxGainStage +#define REG_OFDM_0_XA_AGC_CORE1 rOFDM0_XAAGCCore1 +#define REG_OFDM_0_XB_AGC_CORE1 rOFDM0_XBAGCCore1 +#define REG_A_TX_SCALE_JAGUAR rA_TxScale_Jaguar +#define REG_B_TX_SCALE_JAGUAR rB_TxScale_Jaguar + +#define REG_FPGA0_XAB_RF_INTERFACE_SW rFPGA0_XAB_RFInterfaceSW +#define REG_FPGA0_XAB_RF_PARAMETER rFPGA0_XAB_RFParameter +#define REG_FPGA0_XA_HSSI_PARAMETER1 rFPGA0_XA_HSSIParameter1 +#define REG_FPGA0_XA_LSSI_PARAMETER rFPGA0_XA_LSSIParameter +#define REG_FPGA0_XA_RF_INTERFACE_OE rFPGA0_XA_RFInterfaceOE +#define REG_FPGA0_XB_HSSI_PARAMETER1 rFPGA0_XB_HSSIParameter1 +#define REG_FPGA0_XB_LSSI_PARAMETER rFPGA0_XB_LSSIParameter +#define REG_FPGA0_XB_LSSI_READ_BACK rFPGA0_XB_LSSIReadBack +#define REG_FPGA0_XB_RF_INTERFACE_OE rFPGA0_XB_RFInterfaceOE +#define REG_FPGA0_XCD_RF_INTERFACE_SW rFPGA0_XCD_RFInterfaceSW +#define REG_FPGA0_XCD_SWITCH_CONTROL rFPGA0_XCD_SwitchControl +#define REG_FPGA1_TX_BLOCK rFPGA1_TxBlock +#define REG_FPGA1_TX_INFO rFPGA1_TxInfo +#define REG_IQK_AGC_CONT rIQK_AGC_Cont +#define REG_IQK_AGC_PTS rIQK_AGC_Pts +#define REG_IQK_AGC_RSP rIQK_AGC_Rsp +#define REG_OFDM_0_AGC_RSSI_TABLE rOFDM0_AGCRSSITable +#define REG_OFDM_0_ECCA_THRESHOLD rOFDM0_ECCAThreshold +#define REG_OFDM_0_RX_IQ_EXT_ANTA rOFDM0_RxIQExtAnta +#define REG_OFDM_0_TR_MUX_PAR rOFDM0_TRMuxPar +#define REG_OFDM_0_TRX_PATH_ENABLE rOFDM0_TRxPathEnable +#define REG_OFDM_0_XA_AGC_CORE1 rOFDM0_XAAGCCore1 +#define REG_OFDM_0_XA_RX_IQ_IMBALANCE rOFDM0_XARxIQImbalance +#define REG_OFDM_0_XA_TX_IQ_IMBALANCE rOFDM0_XATxIQImbalance +#define REG_OFDM_0_XB_AGC_CORE1 rOFDM0_XBAGCCore1 +#define REG_OFDM_0_XB_RX_IQ_IMBALANCE rOFDM0_XBRxIQImbalance +#define REG_OFDM_0_XB_TX_IQ_IMBALANCE rOFDM0_XBTxIQImbalance +#define REG_OFDM_0_XC_TX_AFE rOFDM0_XCTxAFE +#define REG_OFDM_0_XD_TX_AFE rOFDM0_XDTxAFE + +/*#define REG_A_CFO_LONG_DUMP_92E rA_CfoLongDump_92E*/ +#define REG_A_CFO_LONG_DUMP_JAGUAR rA_CfoLongDump_Jaguar +/*#define REG_A_CFO_SHORT_DUMP_92E rA_CfoShortDump_92E*/ +#define REG_A_CFO_SHORT_DUMP_JAGUAR rA_CfoShortDump_Jaguar +#define REG_A_RFE_PINMUX_JAGUAR rA_RFE_Pinmux_Jaguar +/*#define REG_A_RSSI_DUMP_92E rA_RSSIDump_92E*/ +#define REG_A_RSSI_DUMP_JAGUAR rA_RSSIDump_Jaguar +/*#define REG_A_RX_SNR_DUMP_92E rA_RXsnrDump_92E*/ +#define REG_A_RX_SNR_DUMP_JAGUAR rA_RXsnrDump_Jaguar +/*#define REG_A_TX_AGC rA_TXAGC*/ +#define REG_A_TX_SCALE_JAGUAR rA_TxScale_Jaguar +#define REG_BW_INDICATION_JAGUAR rBWIndication_Jaguar +/*#define REG_B_BBSWING rB_BBSWING*/ +/*#define REG_B_CFO_LONG_DUMP_92E rB_CfoLongDump_92E*/ +#define REG_B_CFO_LONG_DUMP_JAGUAR rB_CfoLongDump_Jaguar +/*#define REG_B_CFO_SHORT_DUMP_92E rB_CfoShortDump_92E*/ +#define REG_B_CFO_SHORT_DUMP_JAGUAR rB_CfoShortDump_Jaguar +/*#define REG_B_RSSI_DUMP_92E rB_RSSIDump_92E*/ +#define REG_B_RSSI_DUMP_JAGUAR rB_RSSIDump_Jaguar +/*#define REG_B_RX_SNR_DUMP_92E rB_RXsnrDump_92E*/ +#define REG_B_RX_SNR_DUMP_JAGUAR rB_RXsnrDump_Jaguar +/*#define REG_B_TX_AGC rB_TXAGC*/ +#define REG_B_TX_SCALE_JAGUAR rB_TxScale_Jaguar +#define REG_BLUE_TOOTH rBlue_Tooth +#define REG_CCK_0_AFE_SETTING rCCK0_AFESetting +/*#define REG_C_BBSWING rC_BBSWING*/ +/*#define REG_C_TX_AGC rC_TXAGC*/ +#define REG_C_TX_SCALE_JAGUAR2 rC_TxScale_Jaguar2 +#define REG_CONFIG_ANT_A rConfig_AntA +#define REG_CONFIG_ANT_B rConfig_AntB +#define REG_CONFIG_PMPD_ANT_A rConfig_Pmpd_AntA +#define REG_CONFIG_PMPD_ANT_B rConfig_Pmpd_AntB +#define REG_DPDT_CONTROL rDPDT_control +/*#define REG_D_BBSWING rD_BBSWING*/ +/*#define REG_D_TX_AGC rD_TXAGC*/ +#define REG_D_TX_SCALE_JAGUAR2 rD_TxScale_Jaguar2 +#define REG_FPGA0_ANALOG_PARAMETER4 rFPGA0_AnalogParameter4 +#define REG_FPGA0_IQK rFPGA0_IQK +#define REG_FPGA0_PSD_FUNCTION rFPGA0_PSDFunction +#define REG_FPGA0_PSD_REPORT rFPGA0_PSDReport +#define REG_FPGA0_RFMOD rFPGA0_RFMOD +#define REG_FPGA0_TX_GAIN_STAGE rFPGA0_TxGainStage +#define REG_FPGA0_XAB_RF_INTERFACE_SW rFPGA0_XAB_RFInterfaceSW +#define REG_FPGA0_XAB_RF_PARAMETER rFPGA0_XAB_RFParameter +#define REG_FPGA0_XA_HSSI_PARAMETER1 rFPGA0_XA_HSSIParameter1 +#define REG_FPGA0_XA_LSSI_PARAMETER rFPGA0_XA_LSSIParameter +#define REG_FPGA0_XA_RF_INTERFACE_OE rFPGA0_XA_RFInterfaceOE +#define REG_FPGA0_XB_HSSI_PARAMETER1 rFPGA0_XB_HSSIParameter1 +#define REG_FPGA0_XB_LSSI_PARAMETER rFPGA0_XB_LSSIParameter +#define REG_FPGA0_XB_LSSI_READ_BACK rFPGA0_XB_LSSIReadBack +#define REG_FPGA0_XB_RF_INTERFACE_OE rFPGA0_XB_RFInterfaceOE +#define REG_FPGA0_XCD_RF_INTERFACE_SW rFPGA0_XCD_RFInterfaceSW +#define REG_FPGA0_XCD_SWITCH_CONTROL rFPGA0_XCD_SwitchControl +#define REG_FPGA1_TX_BLOCK rFPGA1_TxBlock +#define REG_FPGA1_TX_INFO rFPGA1_TxInfo +#define REG_IQK_AGC_CONT rIQK_AGC_Cont +#define REG_IQK_AGC_PTS rIQK_AGC_Pts +#define REG_IQK_AGC_RSP rIQK_AGC_Rsp +#define REG_OFDM_0_AGC_RSSI_TABLE rOFDM0_AGCRSSITable +#define REG_OFDM_0_ECCA_THRESHOLD rOFDM0_ECCAThreshold +#define REG_OFDM_0_RX_IQ_EXT_ANTA rOFDM0_RxIQExtAnta +#define REG_OFDM_0_TR_MUX_PAR rOFDM0_TRMuxPar +#define REG_OFDM_0_TRX_PATH_ENABLE rOFDM0_TRxPathEnable +#define REG_OFDM_0_XA_AGC_CORE1 rOFDM0_XAAGCCore1 +#define REG_OFDM_0_XA_RX_IQ_IMBALANCE rOFDM0_XARxIQImbalance +#define REG_OFDM_0_XA_TX_IQ_IMBALANCE rOFDM0_XATxIQImbalance +#define REG_OFDM_0_XB_AGC_CORE1 rOFDM0_XBAGCCore1 +#define REG_OFDM_0_XB_RX_IQ_IMBALANCE rOFDM0_XBRxIQImbalance +#define REG_OFDM_0_XB_TX_IQ_IMBALANCE rOFDM0_XBTxIQImbalance +#define REG_OFDM_0_XC_TX_AFE rOFDM0_XCTxAFE +#define REG_OFDM_0_XD_TX_AFE rOFDM0_XDTxAFE +#define REG_PMPD_ANAEN rPMPD_ANAEN +#define REG_PDP_ANT_A rPdp_AntA +#define REG_PDP_ANT_A_4 rPdp_AntA_4 +#define REG_PDP_ANT_B rPdp_AntB +#define REG_PDP_ANT_B_4 rPdp_AntB_4 +#define REG_PWED_TH_JAGUAR rPwed_TH_Jaguar +#define REG_RX_CCK rRx_CCK +#define REG_RX_IQK rRx_IQK +#define REG_RX_IQK_PI_A rRx_IQK_PI_A +#define REG_RX_IQK_PI_B rRx_IQK_PI_B +#define REG_RX_IQK_TONE_A rRx_IQK_Tone_A +#define REG_RX_IQK_TONE_B rRx_IQK_Tone_B +#define REG_RX_OFDM rRx_OFDM +#define REG_RX_POWER_AFTER_IQK_A_2 rRx_Power_After_IQK_A_2 +#define REG_RX_POWER_AFTER_IQK_B_2 rRx_Power_After_IQK_B_2 +#define REG_RX_POWER_BEFORE_IQK_A_2 rRx_Power_Before_IQK_A_2 +#define REG_RX_POWER_BEFORE_IQK_B_2 rRx_Power_Before_IQK_B_2 +#define REG_RX_TO_RX rRx_TO_Rx +#define REG_RX_WAIT_CCA rRx_Wait_CCA +#define REG_RX_WAIT_RIFS rRx_Wait_RIFS +#define REG_S0_S1_PATH_SWITCH rS0S1_PathSwitch +/*#define REG_S1_RXEVM_DUMP_92E rS1_RXevmDump_92E*/ +#define REG_S1_RXEVM_DUMP_JAGUAR rS1_RXevmDump_Jaguar +/*#define REG_S2_RXEVM_DUMP_92E rS2_RXevmDump_92E*/ +#define REG_S2_RXEVM_DUMP_JAGUAR rS2_RXevmDump_Jaguar +#define REG_SYM_WLBT_PAPE_SEL rSYM_WLBT_PAPE_SEL +#define REG_SINGLE_TONE_CONT_TX_JAGUAR rSingleTone_ContTx_Jaguar +#define REG_SLEEP rSleep +#define REG_STANDBY rStandby +#define REG_TX_AGC_A_CCK_11_CCK_1_JAGUAR rTxAGC_A_CCK11_CCK1_JAguar +#define REG_TX_AGC_A_CCK_1_MCS32 rTxAGC_A_CCK1_Mcs32 +#define REG_TX_AGC_A_MCS11_MCS8_JAGUAR rTxAGC_A_MCS11_MCS8_JAguar +#define REG_TX_AGC_A_MCS15_MCS12_JAGUAR rTxAGC_A_MCS15_MCS12_JAguar +#define REG_TX_AGC_A_MCS19_MCS16_JAGUAR rTxAGC_A_MCS19_MCS16_JAguar +#define REG_TX_AGC_A_MCS23_MCS20_JAGUAR rTxAGC_A_MCS23_MCS20_JAguar +#define REG_TX_AGC_A_MCS3_MCS0_JAGUAR rTxAGC_A_MCS3_MCS0_JAguar +#define REG_TX_AGC_A_MCS7_MCS4_JAGUAR rTxAGC_A_MCS7_MCS4_JAguar +#define REG_TX_AGC_A_MCS03_MCS00 rTxAGC_A_Mcs03_Mcs00 +#define REG_TX_AGC_A_MCS07_MCS04 rTxAGC_A_Mcs07_Mcs04 +#define REG_TX_AGC_A_MCS11_MCS08 rTxAGC_A_Mcs11_Mcs08 +#define REG_TX_AGC_A_MCS15_MCS12 rTxAGC_A_Mcs15_Mcs12 +#define REG_TX_AGC_A_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_A_Nss1Index3_Nss1Index0_JAguar +#define REG_TX_AGC_A_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_A_Nss1Index7_Nss1Index4_JAguar +#define REG_TX_AGC_A_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_A_Nss2Index1_Nss1Index8_JAguar +#define REG_TX_AGC_A_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_A_Nss2Index5_Nss2Index2_JAguar +#define REG_TX_AGC_A_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_A_Nss2Index9_Nss2Index6_JAguar +#define REG_TX_AGC_A_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_A_Nss3Index3_Nss3Index0_JAguar +#define REG_TX_AGC_A_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_A_Nss3Index7_Nss3Index4_JAguar +#define REG_TX_AGC_A_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_A_Nss3Index9_Nss3Index8_JAguar +#define REG_TX_AGC_A_OFDM18_OFDM6_JAGUAR rTxAGC_A_Ofdm18_Ofdm6_JAguar +#define REG_TX_AGC_A_OFDM54_OFDM24_JAGUAR rTxAGC_A_Ofdm54_Ofdm24_JAguar +#define REG_TX_AGC_A_RATE18_06 rTxAGC_A_Rate18_06 +#define REG_TX_AGC_A_RATE54_24 rTxAGC_A_Rate54_24 +#define REG_TX_AGC_B_CCK_11_A_CCK_2_11 rTxAGC_B_CCK11_A_CCK2_11 +#define REG_TX_AGC_B_CCK_11_CCK_1_JAGUAR rTxAGC_B_CCK11_CCK1_JAguar +#define REG_TX_AGC_B_CCK_1_55_MCS32 rTxAGC_B_CCK1_55_Mcs32 +#define REG_TX_AGC_B_MCS11_MCS8_JAGUAR rTxAGC_B_MCS11_MCS8_JAguar +#define REG_TX_AGC_B_MCS15_MCS12_JAGUAR rTxAGC_B_MCS15_MCS12_JAguar +#define REG_TX_AGC_B_MCS19_MCS16_JAGUAR rTxAGC_B_MCS19_MCS16_JAguar +#define REG_TX_AGC_B_MCS23_MCS20_JAGUAR rTxAGC_B_MCS23_MCS20_JAguar +#define REG_TX_AGC_B_MCS3_MCS0_JAGUAR rTxAGC_B_MCS3_MCS0_JAguar +#define REG_TX_AGC_B_MCS7_MCS4_JAGUAR rTxAGC_B_MCS7_MCS4_JAguar +#define REG_TX_AGC_B_MCS03_MCS00 rTxAGC_B_Mcs03_Mcs00 +#define REG_TX_AGC_B_MCS07_MCS04 rTxAGC_B_Mcs07_Mcs04 +#define REG_TX_AGC_B_MCS11_MCS08 rTxAGC_B_Mcs11_Mcs08 +#define REG_TX_AGC_B_MCS15_MCS12 rTxAGC_B_Mcs15_Mcs12 +#define REG_TX_AGC_B_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_B_Nss1Index3_Nss1Index0_JAguar +#define REG_TX_AGC_B_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_B_Nss1Index7_Nss1Index4_JAguar +#define REG_TX_AGC_B_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_B_Nss2Index1_Nss1Index8_JAguar +#define REG_TX_AGC_B_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_B_Nss2Index5_Nss2Index2_JAguar +#define REG_TX_AGC_B_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_B_Nss2Index9_Nss2Index6_JAguar +#define REG_TX_AGC_B_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_B_Nss3Index3_Nss3Index0_JAguar +#define REG_TX_AGC_B_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_B_Nss3Index7_Nss3Index4_JAguar +#define REG_TX_AGC_B_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_B_Nss3Index9_Nss3Index8_JAguar +#define REG_TX_AGC_B_OFDM18_OFDM6_JAGUAR rTxAGC_B_Ofdm18_Ofdm6_JAguar +#define REG_TX_AGC_B_OFDM54_OFDM24_JAGUAR rTxAGC_B_Ofdm54_Ofdm24_JAguar +#define REG_TX_AGC_B_RATE18_06 rTxAGC_B_Rate18_06 +#define REG_TX_AGC_B_RATE54_24 rTxAGC_B_Rate54_24 +#define REG_TX_AGC_C_CCK_11_CCK_1_JAGUAR rTxAGC_C_CCK11_CCK1_JAguar +#define REG_TX_AGC_C_MCS11_MCS8_JAGUAR rTxAGC_C_MCS11_MCS8_JAguar +#define REG_TX_AGC_C_MCS15_MCS12_JAGUAR rTxAGC_C_MCS15_MCS12_JAguar +#define REG_TX_AGC_C_MCS19_MCS16_JAGUAR rTxAGC_C_MCS19_MCS16_JAguar +#define REG_TX_AGC_C_MCS23_MCS20_JAGUAR rTxAGC_C_MCS23_MCS20_JAguar +#define REG_TX_AGC_C_MCS3_MCS0_JAGUAR rTxAGC_C_MCS3_MCS0_JAguar +#define REG_TX_AGC_C_MCS7_MCS4_JAGUAR rTxAGC_C_MCS7_MCS4_JAguar +#define REG_TX_AGC_C_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_C_Nss1Index3_Nss1Index0_JAguar +#define REG_TX_AGC_C_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_C_Nss1Index7_Nss1Index4_JAguar +#define REG_TX_AGC_C_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_C_Nss2Index1_Nss1Index8_JAguar +#define REG_TX_AGC_C_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_C_Nss2Index5_Nss2Index2_JAguar +#define REG_TX_AGC_C_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_C_Nss2Index9_Nss2Index6_JAguar +#define REG_TX_AGC_C_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_C_Nss3Index3_Nss3Index0_JAguar +#define REG_TX_AGC_C_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_C_Nss3Index7_Nss3Index4_JAguar +#define REG_TX_AGC_C_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_C_Nss3Index9_Nss3Index8_JAguar +#define REG_TX_AGC_C_OFDM18_OFDM6_JAGUAR rTxAGC_C_Ofdm18_Ofdm6_JAguar +#define REG_TX_AGC_C_OFDM54_OFDM24_JAGUAR rTxAGC_C_Ofdm54_Ofdm24_JAguar +#define REG_TX_AGC_D_CCK_11_CCK_1_JAGUAR rTxAGC_D_CCK11_CCK1_JAguar +#define REG_TX_AGC_D_MCS11_MCS8_JAGUAR rTxAGC_D_MCS11_MCS8_JAguar +#define REG_TX_AGC_D_MCS15_MCS12_JAGUAR rTxAGC_D_MCS15_MCS12_JAguar +#define REG_TX_AGC_D_MCS19_MCS16_JAGUAR rTxAGC_D_MCS19_MCS16_JAguar +#define REG_TX_AGC_D_MCS23_MCS20_JAGUAR rTxAGC_D_MCS23_MCS20_JAguar +#define REG_TX_AGC_D_MCS3_MCS0_JAGUAR rTxAGC_D_MCS3_MCS0_JAguar +#define REG_TX_AGC_D_MCS7_MCS4_JAGUAR rTxAGC_D_MCS7_MCS4_JAguar +#define REG_TX_AGC_D_NSS1_INDEX3_NSS1_INDEX0_JAGUAR rTxAGC_D_Nss1Index3_Nss1Index0_JAguar +#define REG_TX_AGC_D_NSS1_INDEX7_NSS1_INDEX4_JAGUAR rTxAGC_D_Nss1Index7_Nss1Index4_JAguar +#define REG_TX_AGC_D_NSS2_INDEX1_NSS1_INDEX8_JAGUAR rTxAGC_D_Nss2Index1_Nss1Index8_JAguar +#define REG_TX_AGC_D_NSS2_INDEX5_NSS2_INDEX2_JAGUAR rTxAGC_D_Nss2Index5_Nss2Index2_JAguar +#define REG_TX_AGC_D_NSS2_INDEX9_NSS2_INDEX6_JAGUAR rTxAGC_D_Nss2Index9_Nss2Index6_JAguar +#define REG_TX_AGC_D_NSS3_INDEX3_NSS3_INDEX0_JAGUAR rTxAGC_D_Nss3Index3_Nss3Index0_JAguar +#define REG_TX_AGC_D_NSS3_INDEX7_NSS3_INDEX4_JAGUAR rTxAGC_D_Nss3Index7_Nss3Index4_JAguar +#define REG_TX_AGC_D_NSS3_INDEX9_NSS3_INDEX8_JAGUAR rTxAGC_D_Nss3Index9_Nss3Index8_JAguar +#define REG_TX_AGC_D_OFDM18_OFDM6_JAGUAR rTxAGC_D_Ofdm18_Ofdm6_JAguar +#define REG_TX_AGC_D_OFDM54_OFDM24_JAGUAR rTxAGC_D_Ofdm54_Ofdm24_JAguar +#define REG_TX_PATH_JAGUAR rTxPath_Jaguar +#define REG_TX_CCK_BBON rTx_CCK_BBON +#define REG_TX_CCK_RFON rTx_CCK_RFON +#define REG_TX_IQK rTx_IQK +#define REG_TX_IQK_PI_A rTx_IQK_PI_A +#define REG_TX_IQK_PI_B rTx_IQK_PI_B +#define REG_TX_IQK_TONE_A rTx_IQK_Tone_A +#define REG_TX_IQK_TONE_B rTx_IQK_Tone_B +#define REG_TX_OFDM_BBON rTx_OFDM_BBON +#define REG_TX_OFDM_RFON rTx_OFDM_RFON +#define REG_TX_POWER_AFTER_IQK_A rTx_Power_After_IQK_A +#define REG_TX_POWER_AFTER_IQK_B rTx_Power_After_IQK_B +#define REG_TX_POWER_BEFORE_IQK_A rTx_Power_Before_IQK_A +#define REG_TX_POWER_BEFORE_IQK_B rTx_Power_Before_IQK_B +#define REG_TX_TO_RX rTx_To_Rx +#define REG_TX_TO_TX rTx_To_Tx +#define REG_APK rAPK +#define REG_ANTSEL_SW_JAGUAR r_ANTSEL_SW_Jaguar + + + +#define rf_welut_jaguar RF_WeLut_Jaguar +#define rf_mode_table_addr RF_ModeTableAddr +#define rf_mode_table_data0 RF_ModeTableData0 +#define rf_mode_table_data1 RF_ModeTableData1 + + + + + + +#define RX_SMOOTH_FACTOR Rx_Smooth_Factor + #endif /* __HAL_DATA_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_gspi.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_gspi.h index 68119c51255e..51d491cdb505 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_gspi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_gspi.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_GSPI_H_ #define __HAL_GSPI_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_ic_cfg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_ic_cfg.h index aece8cd8ee55..08a2a9f1c43c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_ic_cfg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_ic_cfg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_IC_CFG_H__ #define __HAL_IC_CFG_H__ @@ -34,6 +29,10 @@ #define RTL8822B_SUPPORT 0 #define RTL8821B_SUPPORT 0 #define RTL8821C_SUPPORT 0 +#define RTL8710B_SUPPORT 0 +#define RTL8814B_SUPPORT 0 +#define RTL8824B_SUPPORT 0 + /*#if (RTL8188E_SUPPORT==1)*/ #define RATE_ADAPTIVE_SUPPORT 0 @@ -50,7 +49,6 @@ #define RTL8188E_SUPPORT 1 #define RATE_ADAPTIVE_SUPPORT 1 #define POWER_TRAINING_ACTIVE 1 - #define CONFIG_GET_RAID_BY_DRV #endif #ifdef CONFIG_RTL8812A @@ -127,6 +125,9 @@ #ifndef CONFIG_RTW_MAC_HIDDEN_RPT #define CONFIG_RTW_MAC_HIDDEN_RPT #endif + #ifndef CONFIG_RTW_CUSTOMER_STR + #define CONFIG_RTW_CUSTOMER_STR + #endif #endif #ifdef CONFIG_RTL8822B @@ -134,8 +135,53 @@ #define RTL8822B_SUPPORT 1 #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT - #endif -#endif + #endif /* CONFIG_FW_C2H_PKT */ + #define RTW_TX_PA_BIAS /* Adjust TX PA Bias from eFuse */ + #define CONFIG_DFS /* Enable 5G band 2&3 channel */ + + #ifdef CONFIG_WOWLAN + #define CONFIG_GTK_OL + #define CONFIG_ARP_KEEP_ALIVE + + #ifdef CONFIG_GPIO_WAKEUP + #ifndef WAKEUP_GPIO_IDX + #define WAKEUP_GPIO_IDX 6 /* WIFI Chip Side */ + #endif /* !WAKEUP_GPIO_IDX */ + #endif /* CONFIG_GPIO_WAKEUP */ + #endif /* CONFIG_WOWLAN */ + + #ifdef CONFIG_CONCURRENT_MODE + #define CONFIG_AP_PORT_SWAP + #define CONFIG_FW_MULTI_PORT_SUPPORT + #endif /* CONFIG_CONCURRENT_MODE */ + + /* + * Beamforming related definition + */ + #if defined(CONFIG_CONCURRENT_MODE) && defined(CONFIG_BEAMFORMING) + #undef CONFIG_BEAMFORMING + #warning "Not support Beamforming in concurrent mode yet!!" + #endif /* CONFIG_CONCURRENT_MODE && CONFIG_BEAMFORMING */ + /* Beamforming mechanism is on driver not phydm, always disable it */ + #define BEAMFORMING_SUPPORT 0 + /* Only support new beamforming mechanism */ + #ifdef CONFIG_BEAMFORMING + #define RTW_BEAMFORMING_VERSION_2 + #endif /* CONFIG_BEAMFORMING */ + + #ifndef CONFIG_RTW_MAC_HIDDEN_RPT + #define CONFIG_RTW_MAC_HIDDEN_RPT + #endif /* CONFIG_RTW_MAC_HIDDEN_RPT */ + + #ifndef DBG_RX_DFRAME_RAW_DATA + #define DBG_RX_DFRAME_RAW_DATA + #endif /* DBG_RX_DFRAME_RAW_DATA */ + + /*#ifndef RTW_IQK_FW_OFFLOAD + #define RTW_IQK_FW_OFFLOAD + #endif*/ /* RTW_IQK_FW_OFFLOAD */ + #define CONFIG_ADVANCE_OTA +#endif /* CONFIG_RTL8822B */ #ifdef CONFIG_RTL8821C #undef RTL8821C_SUPPORT @@ -143,14 +189,25 @@ #ifndef CONFIG_FW_C2H_PKT #define CONFIG_FW_C2H_PKT #endif - #ifndef CONFIG_RTW_MAC_HIDDEN_RPT - #define CONFIG_RTW_MAC_HIDDEN_RPT + #ifdef CONFIG_NO_FW + #ifdef CONFIG_RTW_MAC_HIDDEN_RPT + #undef CONFIG_RTW_MAC_HIDDEN_RPT + #endif + #else + #ifndef CONFIG_RTW_MAC_HIDDEN_RPT + #define CONFIG_RTW_MAC_HIDDEN_RPT + #endif #endif #define LOAD_FW_HEADER_FROM_DRIVER #define CONFIG_PHY_CAPABILITY_QUERY #ifdef CONFIG_CONCURRENT_MODE - #define CONFIG_SUPPORT_FW_MULTI_PORT + #define CONFIG_AP_PORT_SWAP + #define CONFIG_FW_MULTI_PORT_SUPPORT #endif + #define CONFIG_SUPPORT_FIFO_DUMP + /*#ifndef RTW_IQK_FW_OFFLOAD + #define RTW_IQK_FW_OFFLOAD + #endif*/ /* RTW_IQK_FW_OFFLOAD */ #endif #endif /*__HAL_IC_CFG_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_intf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_intf.h index a05b680154b2..c4a08cb7274f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_intf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_intf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_INTF_H__ #define __HAL_INTF_H__ @@ -45,6 +40,14 @@ enum _CHIP_TYPE { MAX_CHIP_TYPE }; +#ifdef RTW_HALMAC +enum fw_mem { + FW_EMEM, + FW_IMEM, + FW_DMEM, +}; +#endif + extern const u32 _chip_type_to_odm_ic_type[]; #define chip_type_to_odm_ic_type(chip_type) (((chip_type) >= MAX_CHIP_TYPE) ? _chip_type_to_odm_ic_type[MAX_CHIP_TYPE] : _chip_type_to_odm_ic_type[(chip_type)]) @@ -65,7 +68,7 @@ typedef enum _HW_VARIABLES { HW_VAR_TXPAUSE, HW_VAR_BCN_FUNC, HW_VAR_CORRECT_TSF, - HW_VAR_CHECK_BSSID, + HW_VAR_RCR, HW_VAR_MLME_DISCONNECT, HW_VAR_MLME_SITESURVEY, HW_VAR_MLME_JOIN, @@ -79,6 +82,9 @@ typedef enum _HW_VARIABLES { HW_VAR_SEC_DK_CFG, HW_VAR_BCN_VALID, HW_VAR_RF_TYPE, + HW_VAR_TSF, + HW_VAR_FREECNT, + /* PHYDM odm->SupportAbility */ HW_VAR_CAM_EMPTY_ENTRY, HW_VAR_CAM_INVALID_ALL, @@ -87,6 +93,9 @@ typedef enum _HW_VARIABLES { HW_VAR_AC_PARAM_BE, HW_VAR_AC_PARAM_BK, HW_VAR_ACM_CTRL, +#ifdef CONFIG_WMMPS_STA + HW_VAR_UAPSD_TID, +#endif /* CONFIG_WMMPS_STA */ HW_VAR_AMPDU_MIN_SPACE, HW_VAR_AMPDU_FACTOR, HW_VAR_RXDMA_AGG_PG_TH, @@ -102,6 +111,9 @@ typedef enum _HW_VARIABLES { HW_VAR_LPS_POFF_DEINIT, HW_VAR_LPS_POFF_SET_MODE, HW_VAR_LPS_POFF_WOW_EN, +#endif +#ifdef CONFIG_LPS_PG + HW_VAR_LPS_PG_HANDLE, #endif HW_VAR_TRIGGER_GPIO_0, HW_VAR_BT_SET_COEXIST, @@ -122,8 +134,8 @@ typedef enum _HW_VARIABLES { #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) HW_VAR_WOWLAN, HW_VAR_WAKEUP_REASON, - HW_VAR_RPWM_TOG, #endif + HW_VAR_RPWM_TOG, #ifdef CONFIG_GPIO_WAKEUP HW_SET_GPIO_WL_CTRL, #endif @@ -132,13 +144,15 @@ typedef enum _HW_VARIABLES { HW_VAR_RPT_TIMER_SETTING, HW_VAR_TX_RPT_MAX_MACID, HW_VAR_CHK_HI_QUEUE_EMPTY, + HW_VAR_CHK_MGQ_CPU_EMPTY, HW_VAR_DL_BCN_SEL, HW_VAR_AMPDU_MAX_TIME, HW_VAR_WIRELESS_MODE, HW_VAR_USB_MODE, HW_VAR_PORT_SWITCH, + HW_VAR_PORT_CFG, HW_VAR_DO_IQK, - HW_VAR_DM_IN_LPS, + HW_VAR_DM_IN_LPS_LCLK,/*flag CONFIG_LPS_LCLK_WD_TIMER*/ HW_VAR_SET_REQ_FW_PS, HW_VAR_FW_PS_STATE, HW_VAR_SOUNDING_ENTER, @@ -148,6 +162,7 @@ typedef enum _HW_VARIABLES { HW_VAR_SOUNDING_FW_NDPA, HW_VAR_SOUNDING_CLK, HW_VAR_SOUNDING_SET_GID_TABLE, + HW_VAR_SOUNDING_CSI_REPORT, /*Add by YuChen for TXBF HW timer*/ HW_VAR_HW_REG_TIMER_INIT, HW_VAR_HW_REG_TIMER_RESTART, @@ -157,8 +172,6 @@ typedef enum _HW_VARIABLES { HW_VAR_DL_RSVD_PAGE, HW_VAR_MACID_LINK, HW_VAR_MACID_NOLINK, - HW_VAR_MACID_SLEEP, - HW_VAR_MACID_WAKEUP, HW_VAR_DUMP_MAC_QUEUE_INFO, HW_VAR_ASIX_IOT, #ifdef CONFIG_MBSSID_CAM @@ -170,13 +183,18 @@ typedef enum _HW_VARIABLES { HW_VAR_CH_SW_NEED_TO_TAKE_CARE_IQK_INFO, HW_VAR_CH_SW_IQK_INFO_BACKUP, HW_VAR_CH_SW_IQK_INFO_RESTORE, + + HW_VAR_DBI, + HW_VAR_MDIO, + HW_VAR_L1OFF_CAPABILITY, + HW_VAR_L1OFF_NIC_SUPPORT, #ifdef CONFIG_TDLS - HW_VAR_TDLS_WRCR, - HW_VAR_TDLS_RS_RCR, #ifdef CONFIG_TDLS_CH_SW - HW_VAR_TDLS_BCN_EARLY_C2H_RPT + HW_VAR_TDLS_BCN_EARLY_C2H_RPT, #endif #endif + HW_VAR_DUMP_MAC_TXFIFO, + HW_VAR_PWR_CMD, } HW_VARIABLES; typedef enum _HAL_DEF_VARIABLE { @@ -213,7 +231,6 @@ typedef enum _HAL_DEF_VARIABLE { HAL_DEF_PCI_SUUPORT_L1_BACKDOOR, /* Determine if the L1 Backdoor setting is turned on. */ HAL_DEF_PCI_AMD_L1_SUPPORT, HAL_DEF_PCI_ASPM_OSC, /* Support for ASPM OSC, added by Roger, 2013.03.27. */ - HAL_DEF_MACID_SLEEP, /* Support for MACID sleep */ HAL_DEF_DBG_DIS_PWT, /* disable Tx power training or not. */ HAL_DEF_EFUSE_USAGE, /* Get current EFUSE utilization. 2008.12.19. Added by Roger. */ HAL_DEF_EFUSE_BYTES, @@ -224,17 +241,10 @@ typedef enum _HAL_ODM_VARIABLE { HAL_ODM_STA_INFO, HAL_ODM_P2P_STATE, HAL_ODM_WIFI_DISPLAY_STATE, - HAL_ODM_NOISE_MONITOR, HAL_ODM_REGULATION, HAL_ODM_INITIAL_GAIN, - HAL_ODM_FA_CNT_DUMP, - HAL_ODM_DBG_FLAG, - HAL_ODM_DBG_LEVEL, HAL_ODM_RX_INFO_DUMP, HAL_ODM_RX_Dframe_INFO, -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - HAL_ODM_AUTO_CHNL_SEL, -#endif #ifdef CONFIG_ANTENNA_DIVERSITY HAL_ODM_ANTDIV_SELECT #endif @@ -254,7 +264,7 @@ struct hal_ops { void (*read_chip_version)(_adapter *padapter); void (*init_default_value)(_adapter *padapter); void (*intf_chip_configure)(_adapter *padapter); - void (*read_adapter_info)(_adapter *padapter); + u8 (*read_adapter_info)(_adapter *padapter); u32(*hal_power_on)(_adapter *padapter); void (*hal_power_off)(_adapter *padapter); u32(*hal_init)(_adapter *padapter); @@ -280,6 +290,9 @@ struct hal_ops { /*** recv section ***/ s32(*init_recv_priv)(_adapter *padapter); void (*free_recv_priv)(_adapter *padapter); +#ifdef CONFIG_RECV_THREAD_MODE + s32 (*recv_hdl)(_adapter *adapter); +#endif #if defined(CONFIG_USB_HCI) || defined(CONFIG_PCI_HCI) u32(*inirp_init)(_adapter *padapter); u32(*inirp_deinit)(_adapter *padapter); @@ -301,41 +314,41 @@ struct hal_ops { #endif /*** DM section ***/ - +#ifdef CONFIG_RTW_SW_LED void (*InitSwLeds)(_adapter *padapter); void (*DeInitSwLeds)(_adapter *padapter); - - void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); +#endif + void (*set_chnl_bw_handler)(_adapter *padapter, u8 channel, enum channel_width Bandwidth, u8 Offset40, u8 Offset80); void (*set_tx_power_level_handler)(_adapter *padapter, u8 channel); void (*get_tx_power_level_handler)(_adapter *padapter, s32 *powerlevel); - void (*set_tx_power_index_handler)(_adapter *padapter, u32 powerindex, u8 rfpath, u8 rate); - u8(*get_tx_power_index_handler)(_adapter *padapter, u8 rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic); + void (*set_tx_power_index_handler)(_adapter *padapter, u32 powerindex, enum rf_path rfpath, u8 rate); + u8 (*get_tx_power_index_handler)(_adapter *padapter, enum rf_path rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic); void (*hal_dm_watchdog)(_adapter *padapter); -#ifdef CONFIG_LPS_LCLK_WD_TIMER - void (*hal_dm_watchdog_in_lps)(_adapter *padapter); -#endif - void (*SetHwRegHandler)(_adapter *padapter, u8 variable, u8 *val); + u8 (*set_hw_reg_handler)(_adapter *padapter, u8 variable, u8 *val); + void (*GetHwRegHandler)(_adapter *padapter, u8 variable, u8 *val); - u8(*GetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); + + + u8 (*get_hal_def_var_handler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); + u8(*SetHalDefVarHandler)(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); void (*GetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, PVOID pValue2); void (*SetHalODMVarHandler)(_adapter *padapter, HAL_ODM_VARIABLE eVariable, PVOID pValue1, BOOLEAN bSet); - void (*UpdateRAMaskHandler)(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level); void (*SetBeaconRelatedRegistersHandler)(_adapter *padapter); u8(*interface_ps_func)(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); u32(*read_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask); void (*write_bbreg)(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); - u32(*read_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask); - void (*write_rfreg)(_adapter *padapter, u8 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); + u32 (*read_rfreg)(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask); + void (*write_rfreg)(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data); #ifdef CONFIG_HOSTAPD_MLME s32(*hostap_mgnt_xmit_entry)(_adapter *padapter, _pkt *pkt); @@ -371,10 +384,14 @@ struct hal_ops { #else s32(*c2h_handler)(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); #endif + void (*reqtxrpt)(_adapter *padapter, u8 macid); s32(*fill_h2c_cmd)(PADAPTER, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); void (*fill_fake_txdesc)(PADAPTER, u8 *pDesc, u32 BufferLen, u8 IsPsPoll, u8 IsBTQosNull, u8 bDataFrame); s32(*fw_dl)(_adapter *adapter, u8 wowlan); +#ifdef RTW_HALMAC + s32 (*fw_mem_dl)(_adapter *adapter, enum fw_mem mem); +#endif #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) || defined(CONFIG_PCI_HCI) void (*clear_interrupt)(_adapter *padapter); @@ -391,6 +408,15 @@ struct hal_ops { u8(*init_mac_register)(PADAPTER); u8(*init_phy)(PADAPTER); #endif /* RTW_HALMAC */ + +#ifdef CONFIG_PCI_HCI + void (*hal_set_l1ssbackdoor_handler)(_adapter *padapter, u8 enable); +#endif + +#ifdef CONFIG_RFKILL_POLL + bool (*hal_radio_onoff_check)(_adapter *adapter, u8 *valid); +#endif + }; typedef enum _RT_EEPROM_TYPE { @@ -575,20 +601,21 @@ void rtw_hal_free_data(_adapter *padapter); void rtw_hal_dm_init(_adapter *padapter); void rtw_hal_dm_deinit(_adapter *padapter); +#ifdef CONFIG_RTW_SW_LED void rtw_hal_sw_led_init(_adapter *padapter); void rtw_hal_sw_led_deinit(_adapter *padapter); - +#endif u32 rtw_hal_power_on(_adapter *padapter); void rtw_hal_power_off(_adapter *padapter); uint rtw_hal_init(_adapter *padapter); uint rtw_hal_deinit(_adapter *padapter); void rtw_hal_stop(_adapter *padapter); -void rtw_hal_set_hwreg(PADAPTER padapter, u8 variable, u8 *val); +u8 rtw_hal_set_hwreg(PADAPTER padapter, u8 variable, u8 *val); void rtw_hal_get_hwreg(PADAPTER padapter, u8 variable, u8 *val); void rtw_hal_chip_configure(_adapter *padapter); -void rtw_hal_read_chip_info(_adapter *padapter); +u8 rtw_hal_read_chip_info(_adapter *padapter); void rtw_hal_read_chip_version(_adapter *padapter); u8 rtw_hal_set_def_var(_adapter *padapter, HAL_DEF_VARIABLE eVariable, PVOID pValue); @@ -609,6 +636,12 @@ u8 rtw_hal_check_ips_status(_adapter *padapter); #if defined(CONFIG_PCI_HCI) void rtw_hal_irp_reset(_adapter *padapter); +void rtw_hal_pci_dbi_write(_adapter *padapter, u16 addr, u8 data); +u8 rtw_hal_pci_dbi_read(_adapter *padapter, u16 addr); +void rtw_hal_pci_mdio_write(_adapter *padapter, u8 addr, u16 data); +u16 rtw_hal_pci_mdio_read(_adapter *padapter, u8 addr); +u8 rtw_hal_pci_l1off_nic_support(_adapter *padapter); +u8 rtw_hal_pci_l1off_capability(_adapter *padapter); #endif u8 rtw_hal_intf_ps_func(_adapter *padapter, HAL_INTF_PS_FUNC efunc_id, u8 *val); @@ -623,8 +656,7 @@ void rtw_hal_free_xmit_priv(_adapter *padapter); s32 rtw_hal_init_recv_priv(_adapter *padapter); void rtw_hal_free_recv_priv(_adapter *padapter); -void rtw_hal_update_ra_mask(struct sta_info *psta, u8 rssi_level); -void rtw_update_ramask(_adapter *padapter, struct sta_info *psta, u32 mac_id, u8 rssi_level); +void rtw_hal_update_ra_mask(struct sta_info *psta); void rtw_hal_start_thread(_adapter *padapter); void rtw_hal_stop_thread(_adapter *padapter); @@ -633,16 +665,18 @@ void rtw_hal_bcn_related_reg_setting(_adapter *padapter); u32 rtw_hal_read_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask); void rtw_hal_write_bbreg(_adapter *padapter, u32 RegAddr, u32 BitMask, u32 Data); -u32 rtw_hal_read_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask); -void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMask, u32 Data); +u32 rtw_hal_read_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask); +void rtw_hal_write_rfreg(_adapter *padapter, enum rf_path eRFPath, u32 RegAddr, u32 BitMask, u32 Data); -#define PHY_QueryBBReg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) -#define PHY_SetBBReg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_bbreg((Adapter), (RegAddr), (BitMask), (Data)) -#define PHY_QueryRFReg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) -#define PHY_SetRFReg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) -#define PHY_SetMacReg PHY_SetBBReg -#define PHY_QueryMacReg PHY_QueryBBReg +#define phy_query_bb_reg(Adapter, RegAddr, BitMask) rtw_hal_read_bbreg((Adapter), (RegAddr), (BitMask)) +#define phy_set_bb_reg(Adapter, RegAddr, BitMask, Data) rtw_hal_write_bbreg((Adapter), (RegAddr), (BitMask), (Data)) +#define phy_query_rf_reg(Adapter, eRFPath, RegAddr, BitMask) rtw_hal_read_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask)) +#define phy_set_rf_reg(Adapter, eRFPath, RegAddr, BitMask, Data) rtw_hal_write_rfreg((Adapter), (eRFPath), (RegAddr), (BitMask), (Data)) + +#define phy_set_mac_reg phy_set_bb_reg +#define phy_query_mac_reg phy_query_bb_reg + #if defined(CONFIG_PCI_HCI) s32 rtw_hal_interrupt_handler(_adapter *padapter); @@ -651,7 +685,7 @@ void rtw_hal_write_rfreg(_adapter *padapter, u32 eRFPath, u32 RegAddr, u32 BitMa void rtw_hal_interrupt_handler(_adapter *padapter, u16 pkt_len, u8 *pbuf); #endif -void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, CHANNEL_WIDTH Bandwidth, u8 Offset40, u8 Offset80); +void rtw_hal_set_chnl_bw(_adapter *padapter, u8 channel, enum channel_width Bandwidth, u8 Offset40, u8 Offset80); void rtw_hal_dm_watchdog(_adapter *padapter); void rtw_hal_dm_watchdog_in_lps(_adapter *padapter); @@ -680,6 +714,10 @@ int rtw_hal_iol_cmd(ADAPTER *adapter, struct xmit_frame *xmit_frame, u32 max_wat s32 rtw_hal_xmit_thread_handler(_adapter *padapter); #endif +#ifdef CONFIG_RECV_THREAD_MODE +s32 rtw_hal_recv_hdl(_adapter *adapter); +#endif + void rtw_hal_notch_filter(_adapter *adapter, bool enable); #ifdef CONFIG_FW_C2H_REG @@ -700,8 +738,10 @@ s32 rtw_hal_c2h_id_handle_directly(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 s32 rtw_hal_is_disable_sw_channel_plan(PADAPTER padapter); -s32 rtw_hal_macid_sleep(PADAPTER padapter, u8 macid); -s32 rtw_hal_macid_wakeup(PADAPTER padapter, u8 macid); +s32 rtw_hal_macid_sleep(_adapter *adapter, u8 macid); +s32 rtw_hal_macid_wakeup(_adapter *adapter, u8 macid); +s32 rtw_hal_macid_sleep_all_used(_adapter *adapter); +s32 rtw_hal_macid_wakeup_all_used(_adapter *adapter); s32 rtw_hal_fill_h2c_cmd(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); void rtw_hal_fill_fake_txdesc(_adapter *padapter, u8 *pDesc, u32 BufferLen, @@ -721,14 +761,20 @@ s32 rtw_hal_fw_dl(_adapter *padapter, u8 wowlan); void rtw_hal_clear_interrupt(_adapter *padapter); #endif -void rtw_hal_set_tx_power_index(PADAPTER, u32 powerindex, u8 rfpath, u8 rate); -u8 rtw_hal_get_tx_power_index(PADAPTER, u8 rfpath, u8 rate, u8 bandwidth, u8 channel,struct txpwr_idx_comp *tic); +void rtw_hal_set_tx_power_index(PADAPTER adapter, u32 powerindex, enum rf_path rfpath, u8 rate); +u8 rtw_hal_get_tx_power_index(PADAPTER adapter, enum rf_path + rfpath, u8 rate, u8 bandwidth, u8 channel, struct txpwr_idx_comp *tic); u8 rtw_hal_ops_check(_adapter *padapter); #ifdef RTW_HALMAC u8 rtw_hal_init_mac_register(PADAPTER); u8 rtw_hal_init_phy(PADAPTER); +s32 rtw_hal_fw_mem_dl(_adapter *padapter, enum fw_mem mem); #endif /* RTW_HALMAC */ +#ifdef CONFIG_RFKILL_POLL +bool rtw_hal_rfkill_poll(_adapter *adapter, u8 *valid); +#endif + #endif /* __HAL_INTF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_pg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_pg.h index f96d88b0be9f..c60f7fce3b7a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_pg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_pg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_PG_H__ #define __HAL_PG_H__ @@ -429,12 +424,6 @@ * EEPROM/Efuse PG Offset for 8822B * ==================================================== */ -#define GET_PG_KFREE_ON_8822B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -#define GET_PG_KFREE_THERMAL_K_ON_8822B(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) - -#define PPG_BB_GAIN_2G_TXA_OFFSET_8822B 0xEE -#define PPG_THERMAL_OFFSET_8822B 0xEF - #define EEPROM_TX_PWR_INX_8822B 0x10 #define EEPROM_ChannelPlan_8822B 0xB8 @@ -479,15 +468,9 @@ * EEPROM/Efuse PG Offset for 8821C * ==================================================== */ -#define GET_PG_KFREE_ON_8821C(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC1, 4, 1) -#define GET_PG_KFREE_THERMAL_K_ON_8821C(_pg_m) LE_BITS_TO_1BYTE(((u8 *)(_pg_m)) + 0xC8, 5, 1) - -#define PPG_BB_GAIN_2G_TXA_OFFSET_8821C 0xEE -#define PPG_THERMAL_OFFSET_8821C 0xEF - #define EEPROM_TX_PWR_INX_8821C 0x10 -#define EEPROM_ChannelPlan_8821C 0xB8 +#define EEPROM_CHANNEL_PLAN_8821C 0xB8 #define EEPROM_XTAL_8821C 0xB9 #define EEPROM_THERMAL_METER_8821C 0xBA #define EEPROM_IQK_LCK_8821C 0xBB @@ -505,8 +488,9 @@ #define EEPROM_FEATURE_OPTION_8821C 0xC2 #define EEPROM_RF_BT_SETTING_8821C 0xC3 #define EEPROM_VERSION_8821C 0xC4 -#define EEPROM_CustomID_8821C 0xC5 +#define EEPROM_CUSTOMER_ID_8821C 0xC5 #define EEPROM_TX_BBSWING_2G_8821C 0xC6 +#define EEPROM_TX_BBSWING_5G_8821C 0xC7 #define EEPROM_TX_PWR_CALIBRATE_RATE_8821C 0xC8 #define EEPROM_RF_ANTENNA_OPT_8821C 0xC9 #define EEPROM_RFE_OPTION_8821C 0xCA diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy.h index af1dcad79942..a90b2664e40e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_PHY_H__ #define __HAL_PHY_H__ @@ -56,20 +51,15 @@ /*--------------------------Define Parameters-------------------------------*/ -typedef enum _RF_TYPE { - RF_TYPE_MIN = 0, /* 0 */ +typedef enum _RF_CHIP { + RF_CHIP_MIN = 0, /* 0 */ RF_8225 = 1, /* 1 11b/g RF for verification only */ RF_8256 = 2, /* 2 11b/g/n */ RF_8258 = 3, /* 3 11a/b/g/n RF */ RF_6052 = 4, /* 4 11b/g/n RF */ RF_PSEUDO_11N = 5, /* 5, It is a temporality RF. */ - RF_TYPE_MAX -} RF_TYPE_E, *PRF_TYPE_E; - -#define TX_1S 0 -#define TX_2S 1 -#define TX_3S 2 -#define TX_4S 3 + RF_CHIP_MAX +} RF_CHIP_E, *PRF_CHIP_E; typedef enum _ANTENNA_PATH { ANTENNA_NONE = 0, @@ -184,26 +174,26 @@ PHY_CalculateBitShift( u32 PHY_RFShadowRead( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset); VOID PHY_RFShadowWrite( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u32 Data); BOOLEAN PHY_RFShadowCompare( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset); VOID PHY_RFShadowRecorver( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset); VOID @@ -217,14 +207,14 @@ PHY_RFShadowRecorverAll( VOID PHY_RFShadowCompareFlagSet( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u8 Type); VOID PHY_RFShadowRecorverFlagSet( IN PADAPTER Adapter, - IN u8 eRFPath, + IN enum rf_path eRFPath, IN u32 Offset, IN u8 Type); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy_reg.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy_reg.h index 9a92e405f445..6e6a99e61272 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy_reg.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_phy_reg.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_PHY_REG_H__ #define __HAL_PHY_REG_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_sdio.h index 0a83372dc547..3c22eb9b9993 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_sdio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/hal_sdio.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __HAL_SDIO_H_ #define __HAL_SDIO_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211.h index a3f08be91abe..c07f2d3f655a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __IEEE80211_H #define __IEEE80211_H @@ -206,7 +201,7 @@ enum NETWORK_TYPE { WIRELESS_11A_5N = (WIRELESS_11A | WIRELESS_11_5N), /* tx: ofdm & MCS, rx: ofdm & MCS, hw: ofdm only */ WIRELESS_11B_24N = (WIRELESS_11B | WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ WIRELESS_11BG_24N = (WIRELESS_11B | WIRELESS_11G | WIRELESS_11_24N), /* tx: ofdm & cck & MCS, rx: ofdm & cck & MCS, hw: ofdm & cck */ - WIRELESS_11_24AC = (WIRELESS_11G | WIRELESS_11AC), + WIRELESS_11_24AC = (WIRELESS_11B | WIRELESS_11G | WIRELESS_11AC), WIRELESS_11_5AC = (WIRELESS_11A | WIRELESS_11AC), @@ -224,7 +219,7 @@ enum NETWORK_TYPE { #define IsLegacyOnly(NetType) ((NetType) == ((NetType) & (WIRELESS_11BG | WIRELESS_11A))) #define IsSupported24G(NetType) ((NetType) & SUPPORTED_24G_NETTYPE_MSK ? _TRUE : _FALSE) -#define IsSupported5G(NetType) ((NetType) & SUPPORTED_5G_NETTYPE_MSK ? _TRUE : _FALSE) +#define is_supported_5g(NetType) ((NetType) & SUPPORTED_5G_NETTYPE_MSK ? _TRUE : _FALSE) #define IsEnableHWCCK(NetType) IsSupported24G(NetType) #define IsEnableHWOFDM(NetType) ((NetType) & (WIRELESS_11G | WIRELESS_11_24N | SUPPORTED_5G_NETTYPE_MSK) ? _TRUE : _FALSE) @@ -235,9 +230,12 @@ enum NETWORK_TYPE { #define IsSupportedTxCCK(NetType) ((NetType) & (WIRELESS_11B) ? _TRUE : _FALSE) #define IsSupportedTxOFDM(NetType) ((NetType) & (WIRELESS_11G | WIRELESS_11A) ? _TRUE : _FALSE) -#define IsSupportedHT(NetType) ((NetType) & (WIRELESS_11_24N | WIRELESS_11_5N) ? _TRUE : _FALSE) +#define is_supported_ht(NetType) ((NetType) & (WIRELESS_11_24N | WIRELESS_11_5N) ? _TRUE : _FALSE) + +#define is_supported_vht(NetType) ((NetType) & (WIRELESS_11AC) ? _TRUE : _FALSE) + + -#define IsSupportedVHT(NetType) ((NetType) & (WIRELESS_11AC) ? _TRUE : _FALSE) typedef struct ieee_param { @@ -1347,7 +1345,6 @@ struct ieee80211_txb { #define MAX_RATES_LENGTH ((u8)12) #define MAX_RATES_EX_LENGTH ((u8)16) #define MAX_NETWORK_COUNT 128 -#define MAX_CHANNEL_NUMBER 161 #define IEEE80211_SOFTMAC_SCAN_TIME 400 /* (HZ / 2) */ #define IEEE80211_SOFTMAC_ASSOC_RETRY_TIME (HZ * 2) @@ -1540,7 +1537,7 @@ enum rtw_ieee80211_category { RTW_WLAN_CATEGORY_DLS = 2, RTW_WLAN_CATEGORY_BACK = 3, RTW_WLAN_CATEGORY_PUBLIC = 4, /* IEEE 802.11 public action frames */ - RTW_WLAN_CATEGORY_RADIO_MEASUREMENT = 5, + RTW_WLAN_CATEGORY_RADIO_MEAS = 5, RTW_WLAN_CATEGORY_FT = 6, RTW_WLAN_CATEGORY_HT = 7, RTW_WLAN_CATEGORY_SA_QUERY = 8, @@ -1804,6 +1801,8 @@ struct rtw_ieee802_11_elems { u8 vht_operation_len; u8 *vht_op_mode_notify; u8 vht_op_mode_notify_len; + u8 *rm_en_cap; + u8 rm_en_cap_len; }; typedef enum { ParseOK = 0, ParseUnknown = 1, ParseFailed = -1 } ParseRes; @@ -1843,7 +1842,7 @@ int rtw_parse_wpa2_ie(u8 *wpa_ie, int wpa_ie_len, int *group_cipher, int *pairwi int rtw_get_sec_ie(u8 *in_ie, uint in_len, u8 *rsn_ie, u16 *rsn_len, u8 *wpa_ie, u16 *wpa_len); u8 rtw_is_wps_ie(u8 *ie_ptr, uint *wps_ielen); -u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, u8 frame_type); +u8 *rtw_get_wps_ie_from_scan_queue(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen, enum bss_type frame_type); u8 *rtw_get_wps_ie(u8 *in_ie, uint in_len, u8 *wps_ie, uint *wps_ielen); u8 *rtw_get_wps_attr(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_attr, u32 *len_attr); u8 *rtw_get_wps_attr_content(u8 *wps_ie, uint wps_ielen, u16 target_attr_id , u8 *buf_content, uint *len_content); @@ -1917,6 +1916,7 @@ void rtw_macaddr_cfg(u8 *out, const u8 *hw_mac_addr); u16 rtw_mcs_rate(u8 rf_type, u8 bw_40MHz, u8 short_GI, unsigned char *MCS_rate); u8 rtw_ht_mcsset_to_nss(u8 *supp_mcs_set); +u32 rtw_ht_mcs_set_to_bitmap(u8 *mcs_set, u8 nss); int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category, u8 *action); const char *action_public_str(u8 action); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211_ext.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211_ext.h index 03cc33058e8a..94a8e582d151 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211_ext.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ieee80211_ext.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __IEEE80211_EXT_H #define __IEEE80211_EXT_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/if_ether.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/if_ether.h index 9d08f560d98b..a3007c4ab22d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/if_ether.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/if_ether.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_IF_ETHER_H #define _LINUX_IF_ETHER_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ip.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ip.h index c78034df92ad..4feb98fb072a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ip.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/ip.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_IP_H #define _LINUX_IP_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/linux/wireless.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/linux/wireless.h index b4bb716115ab..c7f4a6c9b66a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/linux/wireless.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/linux/wireless.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _LINUX_WIRELESS_H #define _LINUX_WIRELESS_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mlme_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mlme_osdep.h index 8dcc589101eb..7669fb319c38 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mlme_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mlme_osdep.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,21 +11,15 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __MLME_OSDEP_H_ #define __MLME_OSDEP_H_ #if defined(PLATFORM_WINDOWS) || defined(PLATFORM_MPIXEL) - extern int time_after(u32 now, u32 old); + extern int time_after(systime now, systime old); #endif -extern void rtw_init_mlme_timer(_adapter *padapter); extern void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_generated); extern void rtw_os_indicate_connect(_adapter *adapter); void rtw_os_indicate_scan_done(_adapter *padapter, bool aborted); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mp_custom_oid.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mp_custom_oid.h index 7ca76ad2e65f..8ed14413c62d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mp_custom_oid.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/mp_custom_oid.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __CUSTOM_OID_H #define __CUSTOM_OID_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/nic_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/nic_spec.h index c0a952fd5065..913ef9ba801a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/nic_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/nic_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __NIC_SPEC_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_intf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_intf.h index b1e18d47e100..7be08808d34f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_intf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_intf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __OSDEP_INTF_H_ #define __OSDEP_INTF_H_ @@ -127,6 +122,8 @@ u16 rtw_recv_select_queue(struct sk_buff *skb); int rtw_ndev_notifier_register(void); void rtw_ndev_notifier_unregister(void); +void rtw_inetaddr_notifier_register(void); +void rtw_inetaddr_notifier_unregister(void); #include "../os_dep/linux/rtw_proc.h" @@ -134,6 +131,9 @@ void rtw_ndev_notifier_unregister(void); #include "../os_dep/linux/ioctl_cfg80211.h" #endif /* CONFIG_IOCTL_CFG80211 */ +u8 rtw_rtnl_lock_needed(struct dvobj_priv *dvobj); +void rtw_set_rtnl_lock_holder(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl); + #endif /* PLATFORM_LINUX */ @@ -157,9 +157,8 @@ void rtw_drv_free_vir_ifaces(struct dvobj_priv *dvobj); #endif void rtw_ndev_destructor(_nic_hdl ndev); - #ifdef CONFIG_ARP_KEEP_ALIVE -int rtw_gw_addr_query(_adapter *padapter); +int rtw_gw_addr_query(_adapter *padapter); #endif int rtw_suspend_common(_adapter *padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service.h index eabf4046afcf..6cea063d72ad 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,19 +11,20 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __OSDEP_SERVICE_H_ #define __OSDEP_SERVICE_H_ -#define _FAIL 0 -#define _SUCCESS 1 -#define RTW_RX_HANDLED 2 +#define _FAIL 0 +#define _SUCCESS 1 +#define RTW_RX_HANDLED 2 +#define RTW_RFRAME_UNAVAIL 3 +#define RTW_RFRAME_PKT_UNAVAIL 4 +#define RTW_RBUF_UNAVAIL 5 +#define RTW_RBUF_PKT_UNAVAIL 6 +#define RTW_SDIO_READ_PORT_FAIL 7 + /* #define RTW_STATUS_TIMEDOUT -110 */ #undef _TRUE @@ -38,6 +39,11 @@ #endif #ifdef PLATFORM_LINUX + #include +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 11, 0)) + #include + #include +#endif #include #endif @@ -49,9 +55,6 @@ #include #endif -#define RTW_TIMER_HDL_NAME(name) rtw_##name##_timer_hdl -#define RTW_DECLARE_TIMER_HDL(name) void RTW_TIMER_HDL_NAME(name)(RTW_TIMER_HDL_ARGS) - /* #include */ #ifndef BIT @@ -280,6 +283,10 @@ void _rtw_usb_buffer_free(struct usb_device *dev, size_t size, void *addr, dma_a extern void *rtw_malloc2d(int h, int w, size_t size); extern void rtw_mfree2d(void *pbuf, int h, int w, int size); +void rtw_os_pkt_free(_pkt *pkt); +void *rtw_os_pkt_data(_pkt *pkt); +u32 rtw_os_pkt_len(_pkt *pkt); + extern void _rtw_memcpy(void *dec, const void *sour, u32 sz); extern void _rtw_memmove(void *dst, const void *src, u32 sz); extern int _rtw_memcmp(const void *dst, const void *src, u32 sz); @@ -313,11 +320,25 @@ extern void _rtw_deinit_queue(_queue *pqueue); extern u32 _rtw_queue_empty(_queue *pqueue); extern u32 rtw_end_of_queue_search(_list *queue, _list *pelement); -extern u32 rtw_get_current_time(void); -extern u32 rtw_systime_to_ms(u32 systime); -extern u32 rtw_ms_to_systime(u32 ms); -extern s32 rtw_get_passing_time_ms(u32 start); -extern s32 rtw_get_time_interval_ms(u32 start, u32 end); +extern systime _rtw_get_current_time(void); +extern u32 _rtw_systime_to_ms(systime stime); +extern systime _rtw_ms_to_systime(u32 ms); +extern s32 _rtw_get_passing_time_ms(systime start); +extern s32 _rtw_get_time_interval_ms(systime start, systime end); + +#ifdef DBG_SYSTIME +#define rtw_get_current_time() ({systime __stime = _rtw_get_current_time(); __stime;}) +#define rtw_systime_to_ms(stime) ({u32 __ms = _rtw_systime_to_ms(stime); typecheck(systime, stime); __ms;}) +#define rtw_ms_to_systime(ms) ({systime __stime = _rtw_ms_to_systime(ms); __stime;}) +#define rtw_get_passing_time_ms(start) ({u32 __ms = _rtw_get_passing_time_ms(start); typecheck(systime, start); __ms;}) +#define rtw_get_time_interval_ms(start, end) ({u32 __ms = _rtw_get_time_interval_ms(start, end); typecheck(systime, start); typecheck(systime, end); __ms;}) +#else +#define rtw_get_current_time() _rtw_get_current_time() +#define rtw_systime_to_ms(stime) _rtw_systime_to_ms(stime) +#define rtw_ms_to_systime(ms) _rtw_ms_to_systime(ms) +#define rtw_get_passing_time_ms(start) _rtw_get_passing_time_ms(start) +#define rtw_get_time_interval_ms(start, end) _rtw_get_time_interval_ms(start, end) +#endif extern void rtw_sleep_schedulable(int ms); @@ -339,39 +360,54 @@ extern void rtw_udelay_os(int us); extern void rtw_yield_os(void); -extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc); +extern void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc, void *ctx); __inline static unsigned char _cancel_timer_ex(_timer *ptimer) { -#ifdef PLATFORM_LINUX - return del_timer_sync(ptimer); -#endif -#ifdef PLATFORM_FREEBSD - _cancel_timer(ptimer, 0); - return 0; -#endif -#ifdef PLATFORM_WINDOWS u8 bcancelled; _cancel_timer(ptimer, &bcancelled); return bcancelled; -#endif } static __inline void thread_enter(char *name) { #ifdef PLATFORM_LINUX -#if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 8, 0)) - daemonize("%s", name); -#endif allow_signal(SIGTERM); #endif #ifdef PLATFORM_FREEBSD printf("%s", "RTKTHREAD_enter"); #endif } +void thread_exit(_completion *comp); +void _rtw_init_completion(_completion *comp); +void _rtw_wait_for_comp_timeout(_completion *comp); +void _rtw_wait_for_comp(_completion *comp); + +static inline bool rtw_thread_stop(_thread_hdl_ th) +{ +#ifdef PLATFORM_LINUX + return kthread_stop(th); +#endif +} +static inline void rtw_thread_wait_stop(void) +{ +#ifdef PLATFORM_LINUX + #if 0 + while (!kthread_should_stop()) + rtw_msleep_os(10); + #else + set_current_state(TASK_INTERRUPTIBLE); + while (!kthread_should_stop()) { + schedule(); + set_current_state(TASK_INTERRUPTIBLE); + } + __set_current_state(TASK_RUNNING); + #endif +#endif +} __inline static void flush_signals_thread(void) { @@ -429,6 +465,11 @@ __inline static int rtw_bug_check(void *parg1, void *parg2, void *parg3, void *p return ret; } +#ifdef PLATFORM_LINUX +#define RTW_DIV_ROUND_UP(n, d) DIV_ROUND_UP(n, d) +#else /* !PLATFORM_LINUX */ +#define RTW_DIV_ROUND_UP(n, d) (((n) + (d - 1)) / d) +#endif /* !PLATFORM_LINUX */ #define _RND(sz, r) ((((sz)+((r)-1))/(r))*(r)) #define RND4(x) (((x >> 2) + (((x & 3) == 0) ? 0 : 1)) << 2) @@ -676,6 +717,7 @@ u8 map_read8(const struct map_t *map, u16 offset); /* String handler */ BOOLEAN is_null(char c); +BOOLEAN is_all_null(char *c, int len); BOOLEAN is_eol(char c); BOOLEAN is_space(char c); BOOLEAN IsHexDigit(char chTmp); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_bsd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_bsd.h index b56ccbb2b0f1..20c14d77a2b9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_bsd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_bsd.h @@ -1,22 +1,17 @@ -/****************************************************************************** - * - * Copyright(c) 2007 - 2013 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 - * - * - ******************************************************************************/ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef __OSDEP_BSD_SERVICE_H_ #define __OSDEP_BSD_SERVICE_H_ @@ -91,8 +86,7 @@ _lock lock; }; - //typedef struct sk_buff _pkt; - typedef struct mbuf _pkt; + typedef struct mbuf _pkt; typedef struct mbuf _buffer; typedef struct __queue _queue; @@ -107,10 +101,6 @@ typedef void thread_return; typedef void* thread_context; - //#define thread_exit() complete_and_exit(NULL, 0) - - #define thread_exit() do{printf("%s", "RTKTHREAD_exit");}while(0) - typedef void timer_hdl_return; typedef void* timer_hdl_context; typedef struct work_struct _workitem; @@ -139,16 +129,11 @@ * */ struct timer_list { + struct callout callout; + void (*function)(void *); + void *arg; +}; - /* FreeBSD callout related fields */ - struct callout callout; - - //timeout function - void (*function)(void*); - //argument - void *arg; - -}; struct workqueue_struct; struct work_struct; typedef void (*work_func_t)(struct work_struct *work); @@ -674,30 +659,52 @@ __inline static void rtw_list_delete(_list *plist) INIT_LIST_HEAD(plist); } -__inline static void _init_timer(_timer *ptimer,_nic_hdl padapter,void *pfunc,void* cntx) -{ - ptimer->function = pfunc; - ptimer->arg = cntx; - callout_init(&ptimer->callout, CALLOUT_MPSAFE); -} - +static inline void timer_hdl(void *ctx) +{ + _timer *timer = (_timer *)ctx; + + rtw_mtx_lock(NULL); + if (callout_pending(&timer->callout)) { + /* callout was reset */ + rtw_mtx_unlock(NULL); + return; + } + + if (!callout_active(&timer->callout)) { + /* callout was stopped */ + rtw_mtx_unlock(NULL); + return; + } + + callout_deactivate(&timer->callout); + + timer->function(timer->arg); + + rtw_mtx_unlock(NULL); +} + +static inline void _init_timer(_timer *ptimer, _nic_hdl padapter, void *pfunc, void *cntx) +{ + ptimer->function = pfunc; + ptimer->arg = cntx; + callout_init(&ptimer->callout, CALLOUT_MPSAFE); +} + __inline static void _set_timer(_timer *ptimer,u32 delay_time) { - // mod_timer(ptimer , (jiffies+(delay_time*HZ/1000))); - if(ptimer->function && ptimer->arg){ + if (ptimer->function && ptimer->arg) { rtw_mtx_lock(NULL); - callout_reset(&ptimer->callout, delay_time,ptimer->function, ptimer->arg); + callout_reset(&ptimer->callout, delay_time, timer_hdl, ptimer); rtw_mtx_unlock(NULL); } } __inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) { - // del_timer_sync(ptimer); - // *bcancelled= _TRUE;//TRUE ==1; FALSE==0 rtw_mtx_lock(NULL); callout_drain(&ptimer->callout); rtw_mtx_unlock(NULL); + *bcancelled = 1; /* assume an pending timer to be canceled */ } __inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_ce.h index 04c5b188e647..bc920c08e942 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_ce.h @@ -1,7 +1,7 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. - * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * * 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. @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __OSDEP_CE_SERVICE_H_ #define __OSDEP_CE_SERVICE_H_ @@ -45,8 +40,11 @@ typedef u32 _irqL; typedef NDIS_HANDLE _nic_hdl; - -typedef NDIS_MINIPORT_TIMER _timer; +struct timer_list { + NDIS_MINIPORT_TIMER ndis_timer; + void (*function)(void *); + void *arg; +}; struct __queue { LIST_ENTRY queue; @@ -62,8 +60,7 @@ typedef DWORD thread_return; typedef void* thread_context; typedef NDIS_WORK_ITEM _workitem; -#define thread_exit() ExitThread(STATUS_SUCCESS); return 0; - + #define SEMA_UPBND (0x7FFFFFFF) //8192 @@ -122,22 +119,33 @@ __inline static void rtw_list_delete(_list *plist) InitializeListHead(plist); } -#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 - -__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) -{ - NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); -} - -__inline static void _set_timer(_timer *ptimer,u32 delay_time) -{ - NdisMSetTimer(ptimer,delay_time); -} - -__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -{ - NdisMCancelTimer(ptimer,bcancelled); -} +static inline void timer_hdl( + IN PVOID SystemSpecific1, + IN PVOID FunctionContext, + IN PVOID SystemSpecific2, + IN PVOID SystemSpecific3) +{ + _timer *timer = (_timer *)FunctionContext; + + timer->function(timer->arg); +} + +static inline void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) +{ + ptimer->function = pfunc; + ptimer->arg = cntx; + NdisMInitializeTimer(&ptimer->ndis_timer, nic_hdl, timer_hdl, ptimer); +} + +static inline void _set_timer(_timer *ptimer, u32 delay_time) +{ + NdisMSetTimer(ptimer, delay_time); +} + +static inline void _cancel_timer(_timer *ptimer, u8 *bcancelled) +{ + NdisMCancelTimer(ptimer, bcancelled); +} __inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_linux.h index 43fa41f54c2e..f52dd4255455 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_linux.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __OSDEP_LINUX_SERVICE_H_ #define __OSDEP_LINUX_SERVICE_H_ @@ -33,6 +28,7 @@ #endif /* #include */ #include +#include #include #include #include @@ -49,6 +45,7 @@ #include #include #include +#include #include #include #include @@ -86,6 +83,11 @@ #include #endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 25) && \ + LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 29)) + #define CONFIG_IEEE80211_HT_ADDT_INFO +#endif + #ifdef CONFIG_IOCTL_CFG80211 /* #include */ #include @@ -134,12 +136,22 @@ #error "Enable NAPI before enable GRO\n" -#elif (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,29) && defined(CONFIG_RTW_NAPI)) +#endif - #error "Linux Kernel version too old (should newer than 2.6.29)\n" + +#if (KERNEL_VERSION(2, 6, 29) > LINUX_VERSION_CODE && defined(CONFIG_RTW_NAPI)) + + #undef CONFIG_RTW_NAPI + /*#warning "Linux Kernel version too old to support NAPI (should newer than 2.6.29)\n"*/ #endif +#if (KERNEL_VERSION(2, 6, 33) > LINUX_VERSION_CODE && defined(CONFIG_RTW_GRO)) + + #undef CONFIG_RTW_GRO + /*#warning "Linux Kernel version too old to support GRO(should newer than 2.6.33)\n"*/ + +#endif typedef struct semaphore _sema; typedef spinlock_t _lock; @@ -149,6 +161,7 @@ typedef spinlock_t _lock; typedef struct semaphore _mutex; #endif typedef struct timer_list _timer; +typedef struct completion _completion; struct __queue { struct list_head queue; @@ -169,8 +182,6 @@ typedef void *_thread_hdl_; typedef int thread_return; typedef void *thread_context; -#define thread_exit() complete_and_exit(NULL, 0) - typedef void timer_hdl_return; typedef void *timer_hdl_context; @@ -184,6 +195,8 @@ typedef void *timer_hdl_context; #define DMA_BIT_MASK(n) (((n) == 64) ? ~0ULL : ((1ULL<<(n))-1)) #endif +typedef unsigned long systime; + #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 22)) /* Porting from linux kernel, for compatible with old kernel. */ static inline unsigned char *skb_tail_pointer(const struct sk_buff *skb) @@ -279,8 +292,6 @@ __inline static void rtw_list_delete(_list *plist) list_del_init(plist); } -#define RTW_TIMER_HDL_ARGS void *FunctionContext - __inline static void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) { /* setup_timer(ptimer, pfunc,(u32)cntx); */ @@ -296,11 +307,9 @@ __inline static void _set_timer(_timer *ptimer, u32 delay_time) __inline static void _cancel_timer(_timer *ptimer, u8 *bcancelled) { - del_timer_sync(ptimer); - *bcancelled = 1; + *bcancelled = del_timer_sync(ptimer) == 1 ? 1 : 0; } - static inline void _init_workitem(_workitem *pwork, void *pfunc, void *cntx) { #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 20)) @@ -386,11 +395,23 @@ static inline void rtw_netif_stop_queue(struct net_device *pnetdev) netif_stop_queue(pnetdev); #endif } -static inline void rtw_netif_carrier_on(struct net_device *pnetdev) +static inline void rtw_netif_device_attach(struct net_device *pnetdev) { netif_device_attach(pnetdev); +} +static inline void rtw_netif_device_detach(struct net_device *pnetdev) +{ + netif_device_detach(pnetdev); +} +static inline void rtw_netif_carrier_on(struct net_device *pnetdev) +{ netif_carrier_on(pnetdev); } +static inline void rtw_netif_carrier_off(struct net_device *pnetdev) +{ + netif_carrier_off(pnetdev); +} + static inline int rtw_merge_string(char *dst, int dst_len, const char *src1, const char *src2) { int len = 0; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_xp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_xp.h index 45d54af1f3be..fdbdb5095fce 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_xp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/osdep_service_xp.h @@ -1,22 +1,17 @@ -/****************************************************************************** - * - * Copyright(c) 2007 - 2013 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 - * - * - ******************************************************************************/ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef __OSDEP_LINUX_SERVICE_H_ #define __OSDEP_LINUX_SERVICE_H_ @@ -45,8 +40,11 @@ // USB_PIPE for WINCE , but handle can be use just integer under windows typedef NDIS_HANDLE _nic_hdl; - - typedef NDIS_MINIPORT_TIMER _timer; + struct timer_list { + NDIS_MINIPORT_TIMER ndis_timer; + void (*function)(void *); + void *arg; + }; struct __queue { LIST_ENTRY queue; @@ -63,7 +61,6 @@ typedef NDIS_WORK_ITEM _workitem; - #define thread_exit() PsTerminateSystemThread(STATUS_SUCCESS); #define HZ 10000000 #define SEMA_UPBND (0x7FFFFFFF) //8192 @@ -131,22 +128,33 @@ __inline static void rtw_list_delete(_list *plist) InitializeListHead(plist); } -#define RTW_TIMER_HDL_ARGS IN PVOID SystemSpecific1, IN PVOID FunctionContext, IN PVOID SystemSpecific2, IN PVOID SystemSpecific3 - -__inline static void _init_timer(_timer *ptimer,_nic_hdl nic_hdl,void *pfunc,PVOID cntx) -{ - NdisMInitializeTimer(ptimer, nic_hdl, pfunc, cntx); -} - -__inline static void _set_timer(_timer *ptimer,u32 delay_time) -{ - NdisMSetTimer(ptimer,delay_time); -} - -__inline static void _cancel_timer(_timer *ptimer,u8 *bcancelled) -{ - NdisMCancelTimer(ptimer,bcancelled); -} +static inline void timer_hdl( + IN PVOID SystemSpecific1, + IN PVOID FunctionContext, + IN PVOID SystemSpecific2, + IN PVOID SystemSpecific3) +{ + _timer *timer = (_timer *)FunctionContext; + + timer->function(timer->arg); +} + +static inline void _init_timer(_timer *ptimer, _nic_hdl nic_hdl, void *pfunc, void *cntx) +{ + ptimer->function = pfunc; + ptimer->arg = cntx; + NdisMInitializeTimer(&ptimer->ndis_timer, nic_hdl, timer_hdl, ptimer); +} + +static inline void _set_timer(_timer *ptimer, u32 delay_time) +{ + NdisMSetTimer(ptimer, delay_time); +} + +static inline void _cancel_timer(_timer *ptimer, u8 *bcancelled) +{ + NdisMCancelTimer(ptimer, bcancelled); +} __inline static void _init_workitem(_workitem *pwork, void *pfunc, PVOID cntx) { diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_hal.h index 8aa1a569f16e..16eac21f02a7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __PCI_HAL_H__ #define __PCI_HAL_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_ops.h index bef8237464eb..f195f5b4fafd 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_ops.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __PCI_OPS_H_ #define __PCI_OPS_H_ @@ -89,4 +84,8 @@ void rtl8822be_set_intf_ops(struct _io_ops *pops); #endif +#ifdef CONFIG_RTL8821C + void rtl8821ce_set_intf_ops(struct _io_ops *pops); +#endif + #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_osintf.h index 286bcddaf014..c6a0fddf651a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/pci_osintf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,30 +11,38 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __PCI_OSINTF_H #define __PCI_OSINTF_H #ifdef RTK_129X_PLATFORM #define PCIE_SLOT1_MEM_START 0x9804F000 #define PCIE_SLOT1_MEM_LEN 0x1000 -#define PCIE_SLOT1_MASK 0x9804ED00 +#define PCIE_SLOT1_CTRL_START 0x9804EC00 #define PCIE_SLOT2_MEM_START 0x9803C000 #define PCIE_SLOT2_MEM_LEN 0x1000 -#define PCIE_SLOT2_MASK 0x9803BD00 +#define PCIE_SLOT2_CTRL_START 0x9803BC00 -#define PCIE_TRANSLATE_OFFSET 4 /* offset from MASK reg */ +#define PCIE_MASK_OFFSET 0x100 /* mask offset from CTRL_START */ +#define PCIE_TRANSLATE_OFFSET 0x104 /* translate offset from CTRL_START */ #endif +#define PCI_BC_CLK_REQ BIT0 +#define PCI_BC_ASPM_L0s BIT1 +#define PCI_BC_ASPM_L1 BIT2 +#define PCI_BC_ASPM_L1Off BIT3 +//#define PCI_BC_ASPM_LTR BIT4 +//#define PCI_BC_ASPM_OBFF BIT5 + void rtw_pci_disable_aspm(_adapter *padapter); void rtw_pci_enable_aspm(_adapter *padapter); void PlatformClearPciPMEStatus(PADAPTER Adapter); +void rtw_pci_aspm_config(_adapter *padapter); +void rtw_pci_aspm_config_l1off_general(_adapter *padapter, u8 eanble); +#ifdef CONFIG_PCI_DYNAMIC_ASPM +void rtw_pci_aspm_config_dynamic_l1_ilde_time(_adapter *padapter); +#endif #ifdef CONFIG_64BIT_DMA u8 PlatformEnableDMA64(PADAPTER Adapter); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/recv_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/recv_osdep.h index 6cb918404c18..58038e58afa5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/recv_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/recv_osdep.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RECV_OSDEP_H_ #define __RECV_OSDEP_H_ @@ -31,7 +26,9 @@ extern void rtw_recv_returnpacket(IN _nic_hdl cnxt, IN _pkt *preturnedpkt); extern int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame); +#ifdef CONFIG_HOSTAPD_MLME extern void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame); +#endif struct sta_info; extern void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup); @@ -51,12 +48,10 @@ int rtw_os_recvbuf_resource_alloc(_adapter *padapter, struct recv_buf *precvbuf) int rtw_os_recvbuf_resource_free(_adapter *padapter, struct recv_buf *precvbuf); _pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 *pdata); -void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib); +void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, union recv_frame *rframe); void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf); -void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl); - #ifdef PLATFORM_LINUX #ifdef CONFIG_RTW_NAPI #include /* struct napi_struct */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_cmd.h index a3d6e01742ff..99a9cba972b7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_CMD_H__ #define __RTL8188E_CMD_H__ @@ -141,7 +136,6 @@ typedef struct _RSVDPAGE_LOC_88E { void rtl8188e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); void rtl8188e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); u8 rtl8188e_set_rssi_cmd(PADAPTER padapter, u8 *param); -u8 rtl8188e_set_raid_cmd(_adapter *padapter, u32 bitmap, u8 *arg, u8 bw); s32 FillH2CCmd_88E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); /* u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); */ u8 GetTxBufferRsvdPageNum8188E(_adapter *padapter, bool wowlan); @@ -151,13 +145,6 @@ u8 GetTxBufferRsvdPageNum8188E(_adapter *padapter, bool wowlan); void rtl8188e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); #endif /* CONFIG_P2P */ -void CheckFwRsvdPageContent(PADAPTER padapter); - -#ifdef CONFIG_TSF_RESET_OFFLOAD - /* u8 rtl8188e_reset_tsf(_adapter *padapter, u8 reset_port); */ - int reset_tsf(PADAPTER Adapter, u8 reset_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD */ - /* #define H2C_8188E_RSVDPAGE_LOC_LEN 5 */ /* #define H2C_8188E_AOAC_RSVDPAGE_LOC_LEN 7 */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_dm.h index a4c2527587aa..501d3a9c6e2b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_DM_H__ #define __RTL8188E_DM_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_hal.h index 911595ef30d4..23c435e8d090 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_HAL_H__ #define __RTL8188E_HAL_H__ @@ -116,13 +111,13 @@ typedef struct _RT_8188E_FIRMWARE_HDR { /* #define MAX_RX_DMA_BUFFER_SIZE_88E 0x2400 */ /* 9k for 88E nornal chip , */ /* MaxRxBuff=10k-max(TxReportSize(64*8), WOLPattern(16*24)) */ #ifdef CONFIG_USB_HCI - #define RX_DMA_SIZE_88E(__Adapter) 0x2800 /* no cut difference */ + #define RX_DMA_SIZE_88E(__Adapter) 0x2800 #else - #define RX_DMA_SIZE_88E(__Adapter) ((!IS_VENDOR_8188E_I_CUT_SERIES(__Adapter)) ? 0x2800 : 0x4000) + #define RX_DMA_SIZE_88E(__Adapter) ((!IS_VENDOR_8188E_I_CUT_SERIES(__Adapter))?0x2800:0x4000) #endif #ifdef CONFIG_WOWLAN - #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ #else #define RESV_FMWF 0 #endif @@ -138,7 +133,7 @@ typedef struct _RT_8188E_FIRMWARE_HDR { * must reserved about 7 pages for LPS => 176-7 = 169 (0xA9) * 2*BCN / 1*ps-poll / 1*null-data /1*prob_rsp /1*QOS null-data /1*BT QOS null-data */ -#define BCNQ_PAGE_NUM_88E 0x08 +#define BCNQ_PAGE_NUM_88E 0x09 /* For WoWLan , more reserved page */ #ifdef CONFIG_WOWLAN @@ -153,9 +148,9 @@ Tx page Size : 128B Total page numbers : 176(0xB0) / 256(0x100) */ #ifdef CONFIG_USB_HCI - #define TOTAL_PAGE_NUMBER_88E(_Adapter) (0xB0 - 1) /* no cut difference */ + #define TOTAL_PAGE_NUMBER_88E(_Adapter) (0xB0 - 1) #else - #define TOTAL_PAGE_NUMBER_88E(_Adapter) ((IS_VENDOR_8188E_I_CUT_SERIES(_Adapter) ? 0x100 : 0xB0) - 1)/* must reserved 1 page for dma issue */ + #define TOTAL_PAGE_NUMBER_88E(_Adapter) ((IS_VENDOR_8188E_I_CUT_SERIES(_Adapter)?0x100:0xB0) - 1)/* must reserved 1 page for dma issue */ #endif #define TX_TOTAL_PAGE_NUMBER_88E(_Adapter) (TOTAL_PAGE_NUMBER_88E(_Adapter) - BCNQ_PAGE_NUM_88E - WOWLAN_PAGE_NUM_88E) #define TX_PAGE_BOUNDARY_88E(_Adapter) (TX_TOTAL_PAGE_NUMBER_88E(_Adapter) + 1) /* beacon header start address */ @@ -290,6 +285,9 @@ BOOLEAN HalDetectPwrDownMode88E(PADAPTER Adapter); void rtl8188e_init_default_value(_adapter *adapter); +void InitBeaconParameters_8188e(_adapter *adapter); +void SetBeaconRelatedRegisters8188E(PADAPTER padapter); + void rtl8188e_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8188e(_adapter *adapter); @@ -305,7 +303,7 @@ void rtw_IOL_cmd_tx_pkt_buf_dump(ADAPTER *Adapter, int data_len); #endif/* CONFIG_IOL_EFUSE_PATCH */ void _InitTransferPageSize(PADAPTER padapter); -void SetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); void GetHwReg8188E(PADAPTER padapter, u8 variable, u8 *val); u8 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_led.h index 8d0feee21d6f..ef054675024a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,15 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_LED_H__ #define __RTL8188E_LED_H__ +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. @@ -38,3 +34,4 @@ #endif #endif +#endif /*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_recv.h index 2f574a8ce129..92425a859f5b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_RECV_H__ #define __RTL8188E_RECV_H__ @@ -34,11 +29,7 @@ /* #define MAX_RECVBUF_SZ (32768) */ /* 32k */ /* #define MAX_RECVBUF_SZ (16384) */ /* 16K */ /* #define MAX_RECVBUF_SZ (10240) */ /* 10K */ - #ifdef CONFIG_PLATFORM_MSTAR - #define MAX_RECVBUF_SZ (8192) /* 8K */ - #else - #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ - #endif + #define MAX_RECVBUF_SZ (15360) /* 15k < 16k */ /* #define MAX_RECVBUF_SZ (8192+1024) */ /* 8K+1k */ #else #define MAX_RECVBUF_SZ (4000) /* about 4K */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_rf.h index 658812641787..f5c5fbdfd19f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_RF_H__ #define __RTL8188E_RF_H__ @@ -27,6 +22,6 @@ void rtl8188e_RF_ChangeTxPath(IN PADAPTER Adapter, IN u16 DataRate); void rtl8188e_PHY_RF6052SetBandwidth( IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + IN enum channel_width Bandwidth); #endif/* __RTL8188E_RF_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_spec.h index c7698a605e9e..802659a5fd07 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_SPEC_H__ #define __RTL8188E_SPEC_H__ @@ -47,6 +43,15 @@ #define REG_HISR_88E 0x00B4 /* RTL8188E */ #define REG_HIMRE_88E 0x00B8 /* RTL8188E */ #define REG_HISRE_88E 0x00BC /* RTL8188E */ + +#define REG_DBI_WDATA_8188E 0x0348 /* DBI Write data */ +#define REG_DBI_RDATA_8188E 0x034C /* DBI Read data */ +#define REG_DBI_ADDR_8188E 0x0350 /* DBI Address */ +#define REG_DBI_FLAG_8188E 0x0352 /* DBI Read/Write Flag */ +#define REG_MDIO_WDATA_8188E 0x0354 /* MDIO for Write PCIE PHY */ +#define REG_MDIO_RDATA_8188E 0x0356 /* MDIO for Reads PCIE PHY */ +#define REG_MDIO_CTL_8188E 0x0358 /* MDIO for Control */ + #define REG_MACID_NO_LINK_0 0x0484 #define REG_MACID_NO_LINK_1 0x0488 #define REG_MACID_PAUSE_0 0x048c @@ -79,6 +84,8 @@ * 0x0300h ~ 0x03FFh PCIe * * ----------------------------------------------------- */ +#define REG_PCIE_HRPWM_8188E 0x0361 /* PCIe RPWM */ +#define REG_PCIE_HCPWM_8188E 0x0363 /* PCIe CPWM */ /* ----------------------------------------------------- * @@ -142,19 +149,6 @@ #define RT_AC_INT_MASKS (IMR_VIDOK_88E | IMR_VODOK_88E | IMR_BEDOK_88E | IMR_BKDOK_88E) #endif - -/* ******************************************************** - * General definitions - * ******************************************************** */ - -#define MACID_NUM_88E 64 -#define SEC_CAM_ENT_NUM_88E 32 -#define HW_PORT_NUM_88E 2 -#define NSS_NUM_88E 1 -#define BAND_CAP_88E (BAND_CAP_2G) -#define BW_CAP_88E (BW_CAP_20M | BW_CAP_40M) -#define PROTO_CAP_88E (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) - /* ---------------------------------------------------------------------------- * 8192C EEPROM/EFUSE share register definition. * ---------------------------------------------------------------------------- */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_sreset.h index d0214ac0d036..f4ec2d88c327 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8188E_SRESET_H_ #define _RTL8188E_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_xmit.h index c04a66cdf96c..f625576608cb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188e_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188E_XMIT_H__ #define __RTL8188E_XMIT_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_cmd.h index 65365035dc4a..a198e33523d4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_CMD_H__ #define __RTL8188F_CMD_H__ @@ -187,7 +182,6 @@ void rtl8188f_set_rssi_cmd(PADAPTER padapter, u8 *param); void rtl8188f_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); /* s32 rtl8188f_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ void rtl8188f_set_FwPsTuneParam_cmd(PADAPTER padapter); -void rtl8188f_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); void rtl8188f_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); void rtl8188f_download_rsvd_page(PADAPTER padapter, u8 mstatus); #ifdef CONFIG_BT_COEXIST @@ -197,8 +191,6 @@ void rtl8188f_download_rsvd_page(PADAPTER padapter, u8 mstatus); void rtl8188f_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); #endif /* CONFIG_P2P */ -void CheckFwRsvdPageContent(PADAPTER padapter); - #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW void rtl8188f_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); @@ -211,9 +203,6 @@ void rtl8188f_set_p2p_wowlan_offload_cmd(PADAPTER padapter); void rtl8188f_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -#ifdef CONFIG_TSF_RESET_OFFLOAD -u8 rtl8188f_reset_tsf(_adapter *padapter, u8 reset_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD */ s32 FillH2CCmd8188F(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); u8 GetTxBufferRsvdPageNum8188F(_adapter *padapter, bool wowlan); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_dm.h index 78aeab0eb57d..342ade9a515c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_DM_H__ #define __RTL8188F_DM_H__ /* ************************************************************ @@ -40,8 +35,5 @@ void rtl8188f_deinit_dm_priv(PADAPTER padapter); void rtl8188f_InitHalDm(PADAPTER padapter); void rtl8188f_HalDmWatchDog(PADAPTER padapter); -void rtl8188f_HalDmWatchDog_in_LPS(PADAPTER padapter); -void rtl8188f_hal_dm_in_lps(PADAPTER padapter); - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_hal.h index d7dfce534042..7aaead7ca35e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_HAL_H__ #define __RTL8188F_HAL_H__ @@ -99,7 +94,7 @@ typedef struct _RT_8188F_FIRMWARE_HDR { #endif #ifdef CONFIG_WOWLAN - #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ #else #define RESV_FMWF 0 #endif @@ -123,9 +118,11 @@ typedef struct _RT_8188F_FIRMWARE_HDR { #endif /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ + * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt:1 ,PNO: 6 + * NS offload:2 NDP info: 1 + */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_8188F 0x07 + #define WOWLAN_PAGE_NUM_8188F 0x0b #else #define WOWLAN_PAGE_NUM_8188F 0x00 #endif @@ -160,14 +157,14 @@ typedef struct _RT_8188F_FIRMWARE_HDR { #include "HalVerDef.h" #include "hal_com.h" -#define EFUSE_OOB_PROTECT_BYTES 15 +#define EFUSE_OOB_PROTECT_BYTES (34 + 1) #define HAL_EFUSE_MEMORY #define HWSET_MAX_SIZE_8188F 512 -#define EFUSE_REAL_CONTENT_LEN_8188F 512 +#define EFUSE_REAL_CONTENT_LEN_8188F 256 #define EFUSE_MAP_LEN_8188F 512 -#define EFUSE_MAX_SECTION_8188F 64 +#define EFUSE_MAX_SECTION_8188F (EFUSE_MAP_LEN_8188F / 8) #define EFUSE_IC_ID_OFFSET 506 /* For some inferiority IC purpose. added by Roger, 2009.09.02. */ #define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_REAL_CONTENT_LEN_8188F) @@ -226,7 +223,7 @@ void rtl8188f_set_pll_ref_clk_sel(_adapter *adapter, u8 sel); void rtl8188f_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8188f(_adapter *adapter); -void SetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); void GetHwReg8188F(PADAPTER padapter, u8 variable, u8 *val); u8 SetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); u8 GetHalDefVar8188F(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_led.h index 232ede5a9ada..ef5d1a7761a8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,14 +11,10 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_LED_H__ #define __RTL8188F_LED_H__ +#ifdef CONFIG_RTW_SW_LED #include #include @@ -46,3 +42,4 @@ void rtl8188fe_DeInitSwLeds(PADAPTER padapter); #endif #endif +#endif/*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_recv.h index a5bfb54ed59b..6366b8105274 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_RECV_H__ #define __RTL8188F_RECV_H__ @@ -54,6 +49,7 @@ #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) s32 rtl8188fs_init_recv_priv(PADAPTER padapter); void rtl8188fs_free_recv_priv(PADAPTER padapter); +s32 rtl8188fs_recv_hdl(_adapter *padapter); #endif #ifdef CONFIG_USB_HCI diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_rf.h index 185d2d0322fc..bf4f5911751e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_RF_H__ #define __RTL8188F_RF_H__ @@ -25,6 +20,6 @@ int PHY_RF6052_Config8188F(IN PADAPTER Adapter); VOID PHY_RF6052SetBandwidth8188F( IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + IN enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_spec.h index 23de47ed601d..6e99acf24772 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_SPEC_H__ #define __RTL8188F_SPEC_H__ @@ -214,7 +210,7 @@ /* ---------------------------------------------------------------------------- * 8188F REG_CCK_CHECK (offset 0x454) * ---------------------------------------------------------------------------- */ -#define BIT_BCN_PORT_SEL BIT5 +#define BIT_BCN_PORT_SEL BIT(5) /* ----------------------------------------------------- * @@ -233,51 +229,51 @@ * ---------------------------------------------------------------------------- */ #define IMR_DISABLED_8188F 0 /* IMR DW0(0x00B0-00B3) Bit 0-31 */ -#define IMR_TIMER2_8188F BIT31 /* Timeout interrupt 2 */ -#define IMR_TIMER1_8188F BIT30 /* Timeout interrupt 1 */ -#define IMR_PSTIMEOUT_8188F BIT29 /* Power Save Time Out Interrupt */ -#define IMR_GTINT4_8188F BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -#define IMR_GTINT3_8188F BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -#define IMR_TXBCN0ERR_8188F BIT26 /* Transmit Beacon0 Error */ -#define IMR_TXBCN0OK_8188F BIT25 /* Transmit Beacon0 OK */ -#define IMR_TSF_BIT32_TOGGLE_8188F BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -#define IMR_BCNDMAINT0_8188F BIT20 /* Beacon DMA Interrupt 0 */ -#define IMR_BCNDERR0_8188F BIT16 /* Beacon Queue DMA OK0 */ -#define IMR_HSISR_IND_ON_INT_8188F BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -#define IMR_BCNDMAINT_E_8188F BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -#define IMR_ATIMEND_8188F BIT12 /* CTWidnow End or ATIM Window End */ -#define IMR_C2HCMD_8188F BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -#define IMR_CPWM2_8188F BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_CPWM_8188F BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_HIGHDOK_8188F BIT7 /* High Queue DMA OK */ -#define IMR_MGNTDOK_8188F BIT6 /* Management Queue DMA OK */ -#define IMR_BKDOK_8188F BIT5 /* AC_BK DMA OK */ -#define IMR_BEDOK_8188F BIT4 /* AC_BE DMA OK */ -#define IMR_VIDOK_8188F BIT3 /* AC_VI DMA OK */ -#define IMR_VODOK_8188F BIT2 /* AC_VO DMA OK */ -#define IMR_RDU_8188F BIT1 /* Rx Descriptor Unavailable */ -#define IMR_ROK_8188F BIT0 /* Receive DMA OK */ +#define IMR_TIMER2_8188F BIT(31) /* Timeout interrupt 2 */ +#define IMR_TIMER1_8188F BIT(30) /* Timeout interrupt 1 */ +#define IMR_PSTIMEOUT_8188F BIT(29) /* Power Save Time Out Interrupt */ +#define IMR_GTINT4_8188F BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ +#define IMR_GTINT3_8188F BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ +#define IMR_TXBCN0ERR_8188F BIT(26) /* Transmit Beacon0 Error */ +#define IMR_TXBCN0OK_8188F BIT(25) /* Transmit Beacon0 OK */ +#define IMR_TSF_BIT32_TOGGLE_8188F BIT(24) /* TSF Timer BIT(32) toggle indication interrupt */ +#define IMR_BCNDMAINT0_8188F BIT(20) /* Beacon DMA Interrupt 0 */ +#define IMR_BCNDERR0_8188F BIT(16) /* Beacon Queue DMA OK0 */ +#define IMR_HSISR_IND_ON_INT_8188F BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ +#define IMR_BCNDMAINT_E_8188F BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ +#define IMR_ATIMEND_8188F BIT(12) /* CTWidnow End or ATIM Window End */ +#define IMR_C2HCMD_8188F BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ +#define IMR_CPWM2_8188F BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_CPWM_8188F BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_HIGHDOK_8188F BIT(7) /* High Queue DMA OK */ +#define IMR_MGNTDOK_8188F BIT(6) /* Management Queue DMA OK */ +#define IMR_BKDOK_8188F BIT(5) /* AC_BK DMA OK */ +#define IMR_BEDOK_8188F BIT(4) /* AC_BE DMA OK */ +#define IMR_VIDOK_8188F BIT(3) /* AC_VI DMA OK */ +#define IMR_VODOK_8188F BIT(2) /* AC_VO DMA OK */ +#define IMR_RDU_8188F BIT(1) /* Rx Descriptor Unavailable */ +#define IMR_ROK_8188F BIT(0) /* Receive DMA OK */ /* IMR DW1(0x00B4-00B7) Bit 0-31 */ -#define IMR_BCNDMAINT7_8188F BIT27 /* Beacon DMA Interrupt 7 */ -#define IMR_BCNDMAINT6_8188F BIT26 /* Beacon DMA Interrupt 6 */ -#define IMR_BCNDMAINT5_8188F BIT25 /* Beacon DMA Interrupt 5 */ -#define IMR_BCNDMAINT4_8188F BIT24 /* Beacon DMA Interrupt 4 */ -#define IMR_BCNDMAINT3_8188F BIT23 /* Beacon DMA Interrupt 3 */ -#define IMR_BCNDMAINT2_8188F BIT22 /* Beacon DMA Interrupt 2 */ -#define IMR_BCNDMAINT1_8188F BIT21 /* Beacon DMA Interrupt 1 */ -#define IMR_BCNDOK7_8188F BIT20 /* Beacon Queue DMA OK Interrup 7 */ -#define IMR_BCNDOK6_8188F BIT19 /* Beacon Queue DMA OK Interrup 6 */ -#define IMR_BCNDOK5_8188F BIT18 /* Beacon Queue DMA OK Interrup 5 */ -#define IMR_BCNDOK4_8188F BIT17 /* Beacon Queue DMA OK Interrup 4 */ -#define IMR_BCNDOK3_8188F BIT16 /* Beacon Queue DMA OK Interrup 3 */ -#define IMR_BCNDOK2_8188F BIT15 /* Beacon Queue DMA OK Interrup 2 */ -#define IMR_BCNDOK1_8188F BIT14 /* Beacon Queue DMA OK Interrup 1 */ -#define IMR_ATIMEND_E_8188F BIT13 /* ATIM Window End Extension for Win7 */ -#define IMR_TXERR_8188F BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -#define IMR_RXERR_8188F BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -#define IMR_TXFOVW_8188F BIT9 /* Transmit FIFO Overflow */ -#define IMR_RXFOVW_8188F BIT8 /* Receive FIFO Overflow */ +#define IMR_BCNDMAINT7_8188F BIT(27) /* Beacon DMA Interrupt 7 */ +#define IMR_BCNDMAINT6_8188F BIT(26) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5_8188F BIT(25) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4_8188F BIT(24) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3_8188F BIT(23) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2_8188F BIT(22) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1_8188F BIT(21) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK7_8188F BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ +#define IMR_BCNDOK6_8188F BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ +#define IMR_BCNDOK5_8188F BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ +#define IMR_BCNDOK4_8188F BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ +#define IMR_BCNDOK3_8188F BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ +#define IMR_BCNDOK2_8188F BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ +#define IMR_BCNDOK1_8188F BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ +#define IMR_ATIMEND_E_8188F BIT(13) /* ATIM Window End Extension for Win7 */ +#define IMR_TXERR_8188F BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ +#define IMR_RXERR_8188F BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ +#define IMR_TXFOVW_8188F BIT(9) /* Transmit FIFO Overflow */ +#define IMR_RXFOVW_8188F BIT(8) /* Receive FIFO Overflow */ #ifdef CONFIG_PCI_HCI /* #define IMR_RX_MASK (IMR_ROK_8188F|IMR_RDU_8188F|IMR_RXFOVW_8188F) */ @@ -288,16 +284,4 @@ #define RT_AC_INT_MASKS (IMR_VIDOK_8188F | IMR_VODOK_8188F | IMR_BEDOK_8188F | IMR_BKDOK_8188F) #endif -/* ******************************************************** - * General definitions - * ******************************************************** */ - -#define MACID_NUM_8188F 16 -#define SEC_CAM_ENT_NUM_8188F 16 -#define HW_PORT_NUM_8188F 2 -#define NSS_NUM_8188F 1 -#define BAND_CAP_8188F (BAND_CAP_2G) -#define BW_CAP_8188F (BW_CAP_20M | BW_CAP_40M) -#define PROTO_CAP_8188F (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) - #endif /* __RTL8188F_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_sreset.h index ef5b0ff7c5b5..fe56567e7396 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8188F_SRESET_H_ #define _RTL8188F_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_xmit.h index be88ca43aa22..069183d27459 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8188f_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8188F_XMIT_H__ #define __RTL8188F_XMIT_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_cmd.h index 78d476bb137d..6aff7ea36771 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_CMD_H__ #define __RTL8192E_CMD_H__ @@ -122,7 +117,6 @@ typedef struct _RSVDPAGE_LOC_92E { void rtl8192e_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); void rtl8192e_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); u8 rtl8192e_set_rssi_cmd(PADAPTER padapter, u8 *param); -void rtl8192e_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8 *arg, u8 bw); s32 FillH2CCmd_8192E(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); u8 GetTxBufferRsvdPageNum8192E(_adapter *padapter, bool wowlan); /* u8 rtl8192c_set_FwSelectSuspend_cmd(PADAPTER padapter, u8 bfwpoll, u16 period); */ @@ -134,18 +128,12 @@ s32 c2h_handler_8192e(_adapter *adapter, u8 id, u8 seq, u8 plen, u8 *payload); void rtl8192e_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); #endif /* CONFIG_P2P */ -void CheckFwRsvdPageContent(PADAPTER padapter); - #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW void rtl8192e_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); #endif #endif -#ifdef CONFIG_TSF_RESET_OFFLOAD - int reset_tsf(PADAPTER Adapter, u8 reset_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD */ - /* / TX Feedback Content */ #define USEC_UNIT_FOR_8192E_C2H_TX_RPT_QUEUE_TIME 256 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_dm.h index ff1b341bb811..5f6ee4b0e61a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_DM_H__ #define __RTL8192E_DM_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_hal.h index aff83a9dc01c..edd4040053a5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_HAL_H__ #define __RTL8192E_HAL_H__ @@ -114,7 +109,7 @@ typedef struct _RT_FIRMWARE_8192E { #define RX_DMA_SIZE_8192E 0x4000 /* 16K*/ #ifdef CONFIG_WOWLAN - #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ #else #define RESV_FMWF 0 #endif @@ -131,9 +126,11 @@ typedef struct _RT_FIRMWARE_8192E { * Beacon:2, PS-Poll:1, Null Data:1,Prob Rsp:1,Qos Null Data:1 */ #define RSVD_PAGE_NUM_8192E 0x08 /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ + * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1,PNO: 6 + * NS offload: 2 NDP info: 1 + */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_8192E 0x07 + #define WOWLAN_PAGE_NUM_8192E 0x0b #else #define WOWLAN_PAGE_NUM_8192E 0x00 #endif @@ -276,7 +273,6 @@ void _InitID_8192E(IN PADAPTER Adapter); VOID _InitNetworkType_8192E(IN PADAPTER Adapter); VOID _InitWMACSetting_8192E(IN PADAPTER Adapter); VOID _InitAdaptiveCtrl_8192E(IN PADAPTER Adapter); -VOID _InitRateFallback_8192E(IN PADAPTER Adapter); VOID _InitEDCA_8192E(IN PADAPTER Adapter); VOID _InitRetryFunction_8192E(IN PADAPTER Adapter); VOID _BBTurnOnBlock_8192E(IN PADAPTER Adapter); @@ -290,7 +286,7 @@ VOID hal_ReadRFType_8192E(PADAPTER Adapter); /* RTL8192E-MAC Setting ***********************************************************/ -void SetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); +u8 SetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); void GetHwReg8192E(PADAPTER Adapter, u8 variable, u8 *val); u8 SetHalDefVar8192E( @@ -316,7 +312,7 @@ void rtl8192e_stop_thread(_adapter *padapter); #ifdef CONFIG_PCI_HCI BOOLEAN InterruptRecognized8192EE(PADAPTER Adapter); - u16 get_txdesc_buf_addr(u16 ff_hwaddr); + u16 get_txbd_rw_reg(u16 ff_hwaddr); #endif #ifdef CONFIG_SDIO_HCI diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_led.h index d79bd910e3b1..3d795c4055a8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,16 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_LED_H__ #define __RTL8192E_LED_H__ - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -38,3 +33,4 @@ #endif #endif +#endif/*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_recv.h index 34f081cc415b..3faf16c7fb28 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_RECV_H__ #define __RTL8192E_RECV_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_rf.h index cd344a4ea8e2..f15e07041ba8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,19 +11,14 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_RF_H__ #define __RTL8192E_RF_H__ VOID PHY_RF6052SetBandwidth8192E( IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + IN enum channel_width Bandwidth); int diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_spec.h index 7b3c83a3dee7..c9b2b41e6e48 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_SPEC_H__ #define __RTL8192E_SPEC_H__ @@ -232,51 +228,51 @@ * ---------------------------------------------------------------------------- */ #define IMR_DISABLED_8192E 0 /* IMR DW0(0x00B0-00B3) Bit 0-31 */ -#define IMR_TIMER2_8192E BIT31 /* Timeout interrupt 2 */ -#define IMR_TIMER1_8192E BIT30 /* Timeout interrupt 1 */ -#define IMR_PSTIMEOUT_8192E BIT29 /* Power Save Time Out Interrupt */ -#define IMR_GTINT4_8192E BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -#define IMR_GTINT3_8192E BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -#define IMR_TXBCN0ERR_8192E BIT26 /* Transmit Beacon0 Error */ -#define IMR_TXBCN0OK_8192E BIT25 /* Transmit Beacon0 OK */ -#define IMR_TSF_BIT32_TOGGLE_8192E BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -#define IMR_BCNDMAINT0_8192E BIT20 /* Beacon DMA Interrupt 0 */ -#define IMR_BCNDERR0_8192E BIT16 /* Beacon Queue DMA OK0 */ -#define IMR_HSISR_IND_ON_INT_8192E BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -#define IMR_BCNDMAINT_E_8192E BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -#define IMR_ATIMEND_8192E BIT12 /* CTWidnow End or ATIM Window End */ -#define IMR_C2HCMD_8192E BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -#define IMR_CPWM2_8192E BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_CPWM_8192E BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_HIGHDOK_8192E BIT7 /* High Queue DMA OK */ -#define IMR_MGNTDOK_8192E BIT6 /* Management Queue DMA OK */ -#define IMR_BKDOK_8192E BIT5 /* AC_BK DMA OK */ -#define IMR_BEDOK_8192E BIT4 /* AC_BE DMA OK */ -#define IMR_VIDOK_8192E BIT3 /* AC_VI DMA OK */ -#define IMR_VODOK_8192E BIT2 /* AC_VO DMA OK */ -#define IMR_RDU_8192E BIT1 /* Rx Descriptor Unavailable */ -#define IMR_ROK_8192E BIT0 /* Receive DMA OK */ +#define IMR_TIMER2_8192E BIT(31) /* Timeout interrupt 2 */ +#define IMR_TIMER1_8192E BIT(30) /* Timeout interrupt 1 */ +#define IMR_PSTIMEOUT_8192E BIT(29) /* Power Save Time Out Interrupt */ +#define IMR_GTINT4_8192E BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ +#define IMR_GTINT3_8192E BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ +#define IMR_TXBCN0ERR_8192E BIT(26) /* Transmit Beacon0 Error */ +#define IMR_TXBCN0OK_8192E BIT(25) /* Transmit Beacon0 OK */ +#define IMR_TSF_BIT32_TOGGLE_8192E BIT(24) /* TSF Timer BIT(32) toggle indication interrupt */ +#define IMR_BCNDMAINT0_8192E BIT(20) /* Beacon DMA Interrupt 0 */ +#define IMR_BCNDERR0_8192E BIT(16) /* Beacon Queue DMA OK0 */ +#define IMR_HSISR_IND_ON_INT_8192E BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ +#define IMR_BCNDMAINT_E_8192E BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ +#define IMR_ATIMEND_8192E BIT(12) /* CTWidnow End or ATIM Window End */ +#define IMR_C2HCMD_8192E BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ +#define IMR_CPWM2_8192E BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_CPWM_8192E BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_HIGHDOK_8192E BIT(7) /* High Queue DMA OK */ +#define IMR_MGNTDOK_8192E BIT(6) /* Management Queue DMA OK */ +#define IMR_BKDOK_8192E BIT(5) /* AC_BK DMA OK */ +#define IMR_BEDOK_8192E BIT(4) /* AC_BE DMA OK */ +#define IMR_VIDOK_8192E BIT(3) /* AC_VI DMA OK */ +#define IMR_VODOK_8192E BIT(2) /* AC_VO DMA OK */ +#define IMR_RDU_8192E BIT(1) /* Rx Descriptor Unavailable */ +#define IMR_ROK_8192E BIT(0) /* Receive DMA OK */ /* IMR DW1(0x00B4-00B7) Bit 0-31 */ -#define IMR_BCNDMAINT7_8192E BIT27 /* Beacon DMA Interrupt 7 */ -#define IMR_BCNDMAINT6_8192E BIT26 /* Beacon DMA Interrupt 6 */ -#define IMR_BCNDMAINT5_8192E BIT25 /* Beacon DMA Interrupt 5 */ -#define IMR_BCNDMAINT4_8192E BIT24 /* Beacon DMA Interrupt 4 */ -#define IMR_BCNDMAINT3_8192E BIT23 /* Beacon DMA Interrupt 3 */ -#define IMR_BCNDMAINT2_8192E BIT22 /* Beacon DMA Interrupt 2 */ -#define IMR_BCNDMAINT1_8192E BIT21 /* Beacon DMA Interrupt 1 */ -#define IMR_BCNDOK7_8192E BIT20 /* Beacon Queue DMA OK Interrup 7 */ -#define IMR_BCNDOK6_8192E BIT19 /* Beacon Queue DMA OK Interrup 6 */ -#define IMR_BCNDOK5_8192E BIT18 /* Beacon Queue DMA OK Interrup 5 */ -#define IMR_BCNDOK4_8192E BIT17 /* Beacon Queue DMA OK Interrup 4 */ -#define IMR_BCNDOK3_8192E BIT16 /* Beacon Queue DMA OK Interrup 3 */ -#define IMR_BCNDOK2_8192E BIT15 /* Beacon Queue DMA OK Interrup 2 */ -#define IMR_BCNDOK1_8192E BIT14 /* Beacon Queue DMA OK Interrup 1 */ -#define IMR_ATIMEND_E_8192E BIT13 /* ATIM Window End Extension for Win7 */ -#define IMR_TXERR_8192E BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -#define IMR_RXERR_8192E BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -#define IMR_TXFOVW_8192E BIT9 /* Transmit FIFO Overflow */ -#define IMR_RXFOVW_8192E BIT8 /* Receive FIFO Overflow */ +#define IMR_BCNDMAINT7_8192E BIT(27) /* Beacon DMA Interrupt 7 */ +#define IMR_BCNDMAINT6_8192E BIT(26) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5_8192E BIT(25) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4_8192E BIT(24) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3_8192E BIT(23) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2_8192E BIT(22) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1_8192E BIT(21) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK7_8192E BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ +#define IMR_BCNDOK6_8192E BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ +#define IMR_BCNDOK5_8192E BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ +#define IMR_BCNDOK4_8192E BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ +#define IMR_BCNDOK3_8192E BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ +#define IMR_BCNDOK2_8192E BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ +#define IMR_BCNDOK1_8192E BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ +#define IMR_ATIMEND_E_8192E BIT(13) /* ATIM Window End Extension for Win7 */ +#define IMR_TXERR_8192E BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ +#define IMR_RXERR_8192E BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ +#define IMR_TXFOVW_8192E BIT(9) /* Transmit FIFO Overflow */ +#define IMR_RXFOVW_8192E BIT(8) /* Receive FIFO Overflow */ /* ---------------------------------------------------------------------------- * 8192E Auto LLT bits (offset 0x224, 8bits) @@ -287,19 +283,19 @@ /* ---------------------------------------------------------------------------- * 8192E Auto LLT bits (offset 0x290, 32bits) * ---------------------------------------------------------------------------- */ -#define BIT_DMA_MODE BIT1 -#define BIT_USB_RXDMA_AGG_EN BIT31 +#define BIT_DMA_MODE BIT(1) +#define BIT_USB_RXDMA_AGG_EN BIT(31) /* ---------------------------------------------------------------------------- * 8192E REG_SYS_CFG1 (offset 0xF0, 32bits) * ---------------------------------------------------------------------------- */ -#define BIT_SPSLDO_SEL BIT24 +#define BIT_SPSLDO_SEL BIT(24) /* ---------------------------------------------------------------------------- * 8192E REG_CCK_CHECK (offset 0x454, 8bits) * ---------------------------------------------------------------------------- */ -#define BIT_BCN_PORT_SEL BIT5 +#define BIT_BCN_PORT_SEL BIT(5) /* **************************************************************************** * Regsiter Bit and Content definition @@ -314,16 +310,4 @@ #define AcmHw_ViqStatus_8192E BIT(6) #define AcmHw_BeqStatus_8192E BIT(7) -/* ******************************************************** - * General definitions - * ******************************************************** */ - -#define MACID_NUM_8192E 128 -#define SEC_CAM_ENT_NUM_8192E 64 -#define HW_PORT_NUM_8192E 2 -#define NSS_NUM_8192E 2 -#define BAND_CAP_8192E (BAND_CAP_2G) -#define BW_CAP_8192E (BW_CAP_20M | BW_CAP_40M) -#define PROTO_CAP_8192E (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) - #endif /* __RTL8192E_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_sreset.h index 7430d9abf6a4..78109aea468f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL88812A_SRESET_H_ #define _RTL8812A_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_xmit.h index 23deb8dc4752..0202302c8392 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8192e_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2012 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8192E_XMIT_H__ #define __RTL8192E_XMIT_H__ @@ -445,6 +440,8 @@ void fill_txdesc_vcs(struct pkt_attrib *pattrib, u8 *ptxdesc); #if defined(CONFIG_CONCURRENT_MODE) void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); #endif +void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); + void fill_txdesc_sectype(struct pkt_attrib *pattrib, u8 *ptxdesc); void rtl8192e_fixed_rate(_adapter *padapter, u8 *ptxdesc); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_cmd.h index cdf51c70fcf2..43f7a8805cb5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_CMD_H__ #define __RTL8703B_CMD_H__ @@ -186,7 +181,6 @@ void rtl8703b_set_rssi_cmd(PADAPTER padapter, u8 *param); void rtl8703b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); /* s32 rtl8703b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ void rtl8703b_set_FwPsTuneParam_cmd(PADAPTER padapter); -void rtl8703b_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); void rtl8703b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); void rtl8703b_download_rsvd_page(PADAPTER padapter, u8 mstatus); #ifdef CONFIG_BT_COEXIST @@ -196,8 +190,6 @@ void rtl8703b_download_rsvd_page(PADAPTER padapter, u8 mstatus); void rtl8703b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); #endif /* CONFIG_P2P */ -void CheckFwRsvdPageContent(PADAPTER padapter); - #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW void rtl8703b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); @@ -210,9 +202,6 @@ void CheckFwRsvdPageContent(PADAPTER padapter); void rtl8703b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -#ifdef CONFIG_TSF_RESET_OFFLOAD - u8 rtl8703b_reset_tsf(_adapter *padapter, u8 reset_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD */ s32 FillH2CCmd8703B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); u8 GetTxBufferRsvdPageNum8703B(_adapter *padapter, bool wowlan); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_dm.h index 4ee834d70713..912c7da079ea 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_DM_H__ #define __RTL8703B_DM_H__ /* ************************************************************ @@ -40,8 +35,5 @@ void rtl8703b_deinit_dm_priv(PADAPTER padapter); void rtl8703b_InitHalDm(PADAPTER padapter); void rtl8703b_HalDmWatchDog(PADAPTER padapter); -void rtl8703b_HalDmWatchDog_in_LPS(PADAPTER padapter); -void rtl8703b_hal_dm_in_lps(PADAPTER padapter); - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_hal.h index c1a9f2fb5b6c..dfc9b6d70abf 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_HAL_H__ #define __RTL8703B_HAL_H__ @@ -95,7 +90,7 @@ typedef struct _RT_8703B_FIRMWARE_HDR { #define RX_DMA_SIZE_8703B 0x4000 /* 16K(RX) */ #ifdef CONFIG_WOWLAN - #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ #else #define RESV_FMWF 0 #endif @@ -125,9 +120,11 @@ typedef struct _RT_8703B_FIRMWARE_HDR { #endif /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ + * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1 PNO: 6 + * NS offload: 2NDP info: 1 + */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_8703B 0x07 + #define WOWLAN_PAGE_NUM_8703B 0x0b #else #define WOWLAN_PAGE_NUM_8703B 0x00 #endif @@ -230,7 +227,7 @@ VOID Hal_EfuseParseBoardType_8703B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN Au void rtl8703b_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8703b(_adapter *adapter); -void SetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); void GetHwReg8703B(PADAPTER padapter, u8 variable, u8 *val); u8 SetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); u8 GetHalDefVar8703B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_led.h index fb11fdd8ca16..99e590d31bc5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_LED_H__ #define __RTL8703B_LED_H__ @@ -24,7 +19,7 @@ #include #include - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -45,4 +40,5 @@ void rtl8703be_DeInitSwLeds(PADAPTER padapter); #endif -#endif +#endif/*CONFIG_RTW_SW_LED*/ +#endif /*__RTL8703B_LED_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_recv.h index 4c826527e98e..e796e6e603de 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_RECV_H__ #define __RTL8703B_RECV_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_rf.h index 0d3d0aa54a3c..8d980a88fa67 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_RF_H__ #define __RTL8703B_RF_H__ @@ -25,6 +20,6 @@ int PHY_RF6052_Config8703B(IN PADAPTER Adapter); VOID PHY_RF6052SetBandwidth8703B( IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + IN enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_spec.h index 9f9491e512cf..633b23b1bf10 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_SPEC_H__ #define __RTL8703B_SPEC_H__ @@ -393,7 +389,7 @@ /* ---------------------------------------------------------------------------- * 8703B REG_CCK_CHECK (offset 0x454) * ---------------------------------------------------------------------------- */ -#define BIT_BCN_PORT_SEL BIT5 +#define BIT_BCN_PORT_SEL BIT(5) #ifdef CONFIG_RF_POWER_TRIM @@ -410,51 +406,51 @@ * ---------------------------------------------------------------------------- */ #define IMR_DISABLED_8703B 0 /* IMR DW0(0x00B0-00B3) Bit 0-31 */ -#define IMR_TIMER2_8703B BIT31 /* Timeout interrupt 2 */ -#define IMR_TIMER1_8703B BIT30 /* Timeout interrupt 1 */ -#define IMR_PSTIMEOUT_8703B BIT29 /* Power Save Time Out Interrupt */ -#define IMR_GTINT4_8703B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -#define IMR_GTINT3_8703B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -#define IMR_TXBCN0ERR_8703B BIT26 /* Transmit Beacon0 Error */ -#define IMR_TXBCN0OK_8703B BIT25 /* Transmit Beacon0 OK */ -#define IMR_TSF_BIT32_TOGGLE_8703B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -#define IMR_BCNDMAINT0_8703B BIT20 /* Beacon DMA Interrupt 0 */ -#define IMR_BCNDERR0_8703B BIT16 /* Beacon Queue DMA OK0 */ -#define IMR_HSISR_IND_ON_INT_8703B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -#define IMR_BCNDMAINT_E_8703B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -#define IMR_ATIMEND_8703B BIT12 /* CTWidnow End or ATIM Window End */ -#define IMR_C2HCMD_8703B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -#define IMR_CPWM2_8703B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_CPWM_8703B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_HIGHDOK_8703B BIT7 /* High Queue DMA OK */ -#define IMR_MGNTDOK_8703B BIT6 /* Management Queue DMA OK */ -#define IMR_BKDOK_8703B BIT5 /* AC_BK DMA OK */ -#define IMR_BEDOK_8703B BIT4 /* AC_BE DMA OK */ -#define IMR_VIDOK_8703B BIT3 /* AC_VI DMA OK */ -#define IMR_VODOK_8703B BIT2 /* AC_VO DMA OK */ -#define IMR_RDU_8703B BIT1 /* Rx Descriptor Unavailable */ -#define IMR_ROK_8703B BIT0 /* Receive DMA OK */ +#define IMR_TIMER2_8703B BIT(31) /* Timeout interrupt 2 */ +#define IMR_TIMER1_8703B BIT(30) /* Timeout interrupt 1 */ +#define IMR_PSTIMEOUT_8703B BIT(29) /* Power Save Time Out Interrupt */ +#define IMR_GTINT4_8703B BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ +#define IMR_GTINT3_8703B BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ +#define IMR_TXBCN0ERR_8703B BIT(26) /* Transmit Beacon0 Error */ +#define IMR_TXBCN0OK_8703B BIT(25) /* Transmit Beacon0 OK */ +#define IMR_TSF_BIT32_TOGGLE_8703B BIT(24) /* TSF Timer BIT32 toggle indication interrupt */ +#define IMR_BCNDMAINT0_8703B BIT(20) /* Beacon DMA Interrupt 0 */ +#define IMR_BCNDERR0_8703B BIT(16) /* Beacon Queue DMA OK0 */ +#define IMR_HSISR_IND_ON_INT_8703B BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ +#define IMR_BCNDMAINT_E_8703B BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ +#define IMR_ATIMEND_8703B BIT(12) /* CTWidnow End or ATIM Window End */ +#define IMR_C2HCMD_8703B BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ +#define IMR_CPWM2_8703B BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_CPWM_8703B BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_HIGHDOK_8703B BIT(7) /* High Queue DMA OK */ +#define IMR_MGNTDOK_8703B BIT(6) /* Management Queue DMA OK */ +#define IMR_BKDOK_8703B BIT(5) /* AC_BK DMA OK */ +#define IMR_BEDOK_8703B BIT(4) /* AC_BE DMA OK */ +#define IMR_VIDOK_8703B BIT(3) /* AC_VI DMA OK */ +#define IMR_VODOK_8703B BIT(2) /* AC_VO DMA OK */ +#define IMR_RDU_8703B BIT(1) /* Rx Descriptor Unavailable */ +#define IMR_ROK_8703B BIT(0) /* Receive DMA OK */ /* IMR DW1(0x00B4-00B7) Bit 0-31 */ -#define IMR_BCNDMAINT7_8703B BIT27 /* Beacon DMA Interrupt 7 */ -#define IMR_BCNDMAINT6_8703B BIT26 /* Beacon DMA Interrupt 6 */ -#define IMR_BCNDMAINT5_8703B BIT25 /* Beacon DMA Interrupt 5 */ -#define IMR_BCNDMAINT4_8703B BIT24 /* Beacon DMA Interrupt 4 */ -#define IMR_BCNDMAINT3_8703B BIT23 /* Beacon DMA Interrupt 3 */ -#define IMR_BCNDMAINT2_8703B BIT22 /* Beacon DMA Interrupt 2 */ -#define IMR_BCNDMAINT1_8703B BIT21 /* Beacon DMA Interrupt 1 */ -#define IMR_BCNDOK7_8703B BIT20 /* Beacon Queue DMA OK Interrup 7 */ -#define IMR_BCNDOK6_8703B BIT19 /* Beacon Queue DMA OK Interrup 6 */ -#define IMR_BCNDOK5_8703B BIT18 /* Beacon Queue DMA OK Interrup 5 */ -#define IMR_BCNDOK4_8703B BIT17 /* Beacon Queue DMA OK Interrup 4 */ -#define IMR_BCNDOK3_8703B BIT16 /* Beacon Queue DMA OK Interrup 3 */ -#define IMR_BCNDOK2_8703B BIT15 /* Beacon Queue DMA OK Interrup 2 */ -#define IMR_BCNDOK1_8703B BIT14 /* Beacon Queue DMA OK Interrup 1 */ -#define IMR_ATIMEND_E_8703B BIT13 /* ATIM Window End Extension for Win7 */ -#define IMR_TXERR_8703B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -#define IMR_RXERR_8703B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -#define IMR_TXFOVW_8703B BIT9 /* Transmit FIFO Overflow */ -#define IMR_RXFOVW_8703B BIT8 /* Receive FIFO Overflow */ +#define IMR_BCNDMAINT7_8703B BIT(27) /* Beacon DMA Interrupt 7 */ +#define IMR_BCNDMAINT6_8703B BIT(26) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5_8703B BIT(25) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4_8703B BIT(24) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3_8703B BIT(23) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2_8703B BIT(22) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1_8703B BIT(21) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK7_8703B BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ +#define IMR_BCNDOK6_8703B BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ +#define IMR_BCNDOK5_8703B BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ +#define IMR_BCNDOK4_8703B BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ +#define IMR_BCNDOK3_8703B BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ +#define IMR_BCNDOK2_8703B BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ +#define IMR_BCNDOK1_8703B BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ +#define IMR_ATIMEND_E_8703B BIT(13) /* ATIM Window End Extension for Win7 */ +#define IMR_TXERR_8703B BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ +#define IMR_RXERR_8703B BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ +#define IMR_TXFOVW_8703B BIT(9) /* Transmit FIFO Overflow */ +#define IMR_RXFOVW_8703B BIT(8) /* Receive FIFO Overflow */ #ifdef CONFIG_PCI_HCI /* #define IMR_RX_MASK (IMR_ROK_8703B|IMR_RDU_8703B|IMR_RXFOVW_8703B) */ @@ -465,16 +461,4 @@ #define RT_AC_INT_MASKS (IMR_VIDOK_8703B | IMR_VODOK_8703B | IMR_BEDOK_8703B | IMR_BKDOK_8703B) #endif -/* ******************************************************** - * General definitions - * ******************************************************** */ - -#define MACID_NUM_8703B 16 -#define SEC_CAM_ENT_NUM_8703B 16 -#define HW_PORT_NUM_8703B 2 -#define NSS_NUM_8703B 1 -#define BAND_CAP_8703B (BAND_CAP_2G) -#define BW_CAP_8703B (BW_CAP_20M | BW_CAP_40M) -#define PROTO_CAP_8703B (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) - #endif /* __RTL8703B_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_sreset.h index fbed1fb263ce..5fe53cf414a1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8703B_SRESET_H_ #define _RTL8703B_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_xmit.h index c44609cbcb69..2bcd5a7b85c5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8703b_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8703B_XMIT_H__ #define __RTL8703B_XMIT_H__ @@ -293,6 +288,7 @@ void rtl8703b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 I #if defined(CONFIG_CONCURRENT_MODE) void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); #endif +void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) s32 rtl8703bs_init_xmit_priv(PADAPTER padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_cmd.h index dadb82c9010d..f284a05425fc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_CMD_H__ #define __RTL8723B_CMD_H__ @@ -186,7 +181,6 @@ void rtl8723b_set_rssi_cmd(PADAPTER padapter, u8 *param); void rtl8723b_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); /* s32 rtl8723b_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ void rtl8723b_set_FwPsTuneParam_cmd(PADAPTER padapter); -void rtl8723b_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); void rtl8723b_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); void rtl8723b_download_rsvd_page(PADAPTER padapter, u8 mstatus); #ifdef CONFIG_BT_COEXIST @@ -196,8 +190,6 @@ void rtl8723b_download_rsvd_page(PADAPTER padapter, u8 mstatus); void rtl8723b_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); #endif /* CONFIG_P2P */ -void CheckFwRsvdPageContent(PADAPTER padapter); - #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW void rtl8723b_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); @@ -210,9 +202,6 @@ void CheckFwRsvdPageContent(PADAPTER padapter); void rtl8723b_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); -#ifdef CONFIG_TSF_RESET_OFFLOAD - u8 rtl8723b_reset_tsf(_adapter *padapter, u8 reset_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD */ s32 FillH2CCmd8723B(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); u8 GetTxBufferRsvdPageNum8723B(_adapter *padapter, bool wowlan); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_dm.h index a3bb7df89c09..ea517175f0bd 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_DM_H__ #define __RTL8723B_DM_H__ /* ************************************************************ @@ -40,8 +35,4 @@ void rtl8723b_deinit_dm_priv(PADAPTER padapter); void rtl8723b_InitHalDm(PADAPTER padapter); void rtl8723b_HalDmWatchDog(PADAPTER padapter); -void rtl8723b_HalDmWatchDog_in_LPS(PADAPTER padapter); -void rtl8723b_hal_dm_in_lps(PADAPTER padapter); - - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_hal.h index 59f2b84c725f..6e9ac57dd089 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_HAL_H__ #define __RTL8723B_HAL_H__ @@ -95,7 +90,7 @@ typedef struct _RT_8723B_FIRMWARE_HDR { #define RX_DMA_SIZE_8723B 0x4000 /* 16K(RX) */ #ifdef CONFIG_WOWLAN - #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ #else #define RESV_FMWF 0 #endif @@ -125,9 +120,11 @@ typedef struct _RT_8723B_FIRMWARE_HDR { #endif /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ + * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt: 1,PNO: 6 + * NS offload: 2 NDP info: 1 + */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_8723B 0x07 + #define WOWLAN_PAGE_NUM_8723B 0x0b #else #define WOWLAN_PAGE_NUM_8723B 0x00 #endif @@ -152,11 +149,13 @@ typedef struct _RT_8723B_FIRMWARE_HDR { #define NORMAL_PAGE_NUM_HPQ_8723B 0x0C #define NORMAL_PAGE_NUM_LPQ_8723B 0x02 #define NORMAL_PAGE_NUM_NPQ_8723B 0x02 +#define NORMAL_PAGE_NUM_EPQ_8723B 0x04 /* Note: For Normal Chip Setting, modify later */ #define WMM_NORMAL_PAGE_NUM_HPQ_8723B 0x30 #define WMM_NORMAL_PAGE_NUM_LPQ_8723B 0x20 #define WMM_NORMAL_PAGE_NUM_NPQ_8723B 0x20 +#define WMM_NORMAL_PAGE_NUM_EPQ_8723B 0x00 #include "HalVerDef.h" @@ -231,7 +230,7 @@ VOID Hal_EfuseParseBoardType_8723B(PADAPTER Adapter, u8 *PROMContent, BOOLEAN Au void rtl8723b_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8723b(_adapter *adapter); -void SetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); void GetHwReg8723B(PADAPTER padapter, u8 variable, u8 *val); u8 SetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); u8 GetHalDefVar8723B(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_led.h index 0a7b2c9ea188..6b772cceb7ec 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_LED_H__ #define __RTL8723B_LED_H__ @@ -24,7 +19,7 @@ #include #include - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -46,3 +41,4 @@ #endif #endif +#endif/*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_recv.h index fd9faef9d6b5..cf5e18b66613 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_RECV_H__ #define __RTL8723B_RECV_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_rf.h index bf56dde01684..6325ad5b8358 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_RF_H__ #define __RTL8723B_RF_H__ @@ -25,6 +20,6 @@ int PHY_RF6052_Config8723B(IN PADAPTER Adapter); VOID PHY_RF6052SetBandwidth8723B( IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + IN enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_spec.h index 85b9d1ec07e4..b0fb4aa41d17 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_SPEC_H__ #define __RTL8723B_SPEC_H__ @@ -198,7 +194,7 @@ /* ---------------------------------------------------------------------------- * 8723B REG_CCK_CHECK (offset 0x454) * ---------------------------------------------------------------------------- */ -#define BIT_BCN_PORT_SEL BIT5 +#define BIT_BCN_PORT_SEL BIT(5) /* ----------------------------------------------------- * @@ -226,51 +222,51 @@ * ---------------------------------------------------------------------------- */ #define IMR_DISABLED_8723B 0 /* IMR DW0(0x00B0-00B3) Bit 0-31 */ -#define IMR_TIMER2_8723B BIT31 /* Timeout interrupt 2 */ -#define IMR_TIMER1_8723B BIT30 /* Timeout interrupt 1 */ -#define IMR_PSTIMEOUT_8723B BIT29 /* Power Save Time Out Interrupt */ -#define IMR_GTINT4_8723B BIT28 /* When GTIMER4 expires, this bit is set to 1 */ -#define IMR_GTINT3_8723B BIT27 /* When GTIMER3 expires, this bit is set to 1 */ -#define IMR_TXBCN0ERR_8723B BIT26 /* Transmit Beacon0 Error */ -#define IMR_TXBCN0OK_8723B BIT25 /* Transmit Beacon0 OK */ -#define IMR_TSF_BIT32_TOGGLE_8723B BIT24 /* TSF Timer BIT32 toggle indication interrupt */ -#define IMR_BCNDMAINT0_8723B BIT20 /* Beacon DMA Interrupt 0 */ -#define IMR_BCNDERR0_8723B BIT16 /* Beacon Queue DMA OK0 */ -#define IMR_HSISR_IND_ON_INT_8723B BIT15 /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ -#define IMR_BCNDMAINT_E_8723B BIT14 /* Beacon DMA Interrupt Extension for Win7 */ -#define IMR_ATIMEND_8723B BIT12 /* CTWidnow End or ATIM Window End */ -#define IMR_C2HCMD_8723B BIT10 /* CPU to Host Command INT Status, Write 1 clear */ -#define IMR_CPWM2_8723B BIT9 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_CPWM_8723B BIT8 /* CPU power Mode exchange INT Status, Write 1 clear */ -#define IMR_HIGHDOK_8723B BIT7 /* High Queue DMA OK */ -#define IMR_MGNTDOK_8723B BIT6 /* Management Queue DMA OK */ -#define IMR_BKDOK_8723B BIT5 /* AC_BK DMA OK */ -#define IMR_BEDOK_8723B BIT4 /* AC_BE DMA OK */ -#define IMR_VIDOK_8723B BIT3 /* AC_VI DMA OK */ -#define IMR_VODOK_8723B BIT2 /* AC_VO DMA OK */ -#define IMR_RDU_8723B BIT1 /* Rx Descriptor Unavailable */ -#define IMR_ROK_8723B BIT0 /* Receive DMA OK */ +#define IMR_TIMER2_8723B BIT(31) /* Timeout interrupt 2 */ +#define IMR_TIMER1_8723B BIT(30) /* Timeout interrupt 1 */ +#define IMR_PSTIMEOUT_8723B BIT(29) /* Power Save Time Out Interrupt */ +#define IMR_GTINT4_8723B BIT(28) /* When GTIMER4 expires, this bit is set to 1 */ +#define IMR_GTINT3_8723B BIT(27) /* When GTIMER3 expires, this bit is set to 1 */ +#define IMR_TXBCN0ERR_8723B BIT(26) /* Transmit Beacon0 Error */ +#define IMR_TXBCN0OK_8723B BIT(25) /* Transmit Beacon0 OK */ +#define IMR_TSF_BIT32_TOGGLE_8723B BIT(24) /* TSF Timer BIT(32) toggle indication interrupt */ +#define IMR_BCNDMAINT0_8723B BIT(20) /* Beacon DMA Interrupt 0 */ +#define IMR_BCNDERR0_8723B BIT(16) /* Beacon Queue DMA OK0 */ +#define IMR_HSISR_IND_ON_INT_8723B BIT(15) /* HSISR Indicator (HSIMR & HSISR is true, this bit is set to 1) */ +#define IMR_BCNDMAINT_E_8723B BIT(14) /* Beacon DMA Interrupt Extension for Win7 */ +#define IMR_ATIMEND_8723B BIT(12) /* CTWidnow End or ATIM Window End */ +#define IMR_C2HCMD_8723B BIT(10) /* CPU to Host Command INT Status, Write 1 clear */ +#define IMR_CPWM2_8723B BIT(9) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_CPWM_8723B BIT(8) /* CPU power Mode exchange INT Status, Write 1 clear */ +#define IMR_HIGHDOK_8723B BIT(7) /* High Queue DMA OK */ +#define IMR_MGNTDOK_8723B BIT(6) /* Management Queue DMA OK */ +#define IMR_BKDOK_8723B BIT(5) /* AC_BK DMA OK */ +#define IMR_BEDOK_8723B BIT(4) /* AC_BE DMA OK */ +#define IMR_VIDOK_8723B BIT(3) /* AC_VI DMA OK */ +#define IMR_VODOK_8723B BIT(2) /* AC_VO DMA OK */ +#define IMR_RDU_8723B BIT(1) /* Rx Descriptor Unavailable */ +#define IMR_ROK_8723B BIT(0) /* Receive DMA OK */ /* IMR DW1(0x00B4-00B7) Bit 0-31 */ -#define IMR_BCNDMAINT7_8723B BIT27 /* Beacon DMA Interrupt 7 */ -#define IMR_BCNDMAINT6_8723B BIT26 /* Beacon DMA Interrupt 6 */ -#define IMR_BCNDMAINT5_8723B BIT25 /* Beacon DMA Interrupt 5 */ -#define IMR_BCNDMAINT4_8723B BIT24 /* Beacon DMA Interrupt 4 */ -#define IMR_BCNDMAINT3_8723B BIT23 /* Beacon DMA Interrupt 3 */ -#define IMR_BCNDMAINT2_8723B BIT22 /* Beacon DMA Interrupt 2 */ -#define IMR_BCNDMAINT1_8723B BIT21 /* Beacon DMA Interrupt 1 */ -#define IMR_BCNDOK7_8723B BIT20 /* Beacon Queue DMA OK Interrup 7 */ -#define IMR_BCNDOK6_8723B BIT19 /* Beacon Queue DMA OK Interrup 6 */ -#define IMR_BCNDOK5_8723B BIT18 /* Beacon Queue DMA OK Interrup 5 */ -#define IMR_BCNDOK4_8723B BIT17 /* Beacon Queue DMA OK Interrup 4 */ -#define IMR_BCNDOK3_8723B BIT16 /* Beacon Queue DMA OK Interrup 3 */ -#define IMR_BCNDOK2_8723B BIT15 /* Beacon Queue DMA OK Interrup 2 */ -#define IMR_BCNDOK1_8723B BIT14 /* Beacon Queue DMA OK Interrup 1 */ -#define IMR_ATIMEND_E_8723B BIT13 /* ATIM Window End Extension for Win7 */ -#define IMR_TXERR_8723B BIT11 /* Tx Error Flag Interrupt Status, write 1 clear. */ -#define IMR_RXERR_8723B BIT10 /* Rx Error Flag INT Status, Write 1 clear */ -#define IMR_TXFOVW_8723B BIT9 /* Transmit FIFO Overflow */ -#define IMR_RXFOVW_8723B BIT8 /* Receive FIFO Overflow */ +#define IMR_BCNDMAINT7_8723B BIT(27) /* Beacon DMA Interrupt 7 */ +#define IMR_BCNDMAINT6_8723B BIT(26) /* Beacon DMA Interrupt 6 */ +#define IMR_BCNDMAINT5_8723B BIT(25) /* Beacon DMA Interrupt 5 */ +#define IMR_BCNDMAINT4_8723B BIT(24) /* Beacon DMA Interrupt 4 */ +#define IMR_BCNDMAINT3_8723B BIT(23) /* Beacon DMA Interrupt 3 */ +#define IMR_BCNDMAINT2_8723B BIT(22) /* Beacon DMA Interrupt 2 */ +#define IMR_BCNDMAINT1_8723B BIT(21) /* Beacon DMA Interrupt 1 */ +#define IMR_BCNDOK7_8723B BIT(20) /* Beacon Queue DMA OK Interrupt 7 */ +#define IMR_BCNDOK6_8723B BIT(19) /* Beacon Queue DMA OK Interrupt 6 */ +#define IMR_BCNDOK5_8723B BIT(18) /* Beacon Queue DMA OK Interrupt 5 */ +#define IMR_BCNDOK4_8723B BIT(17) /* Beacon Queue DMA OK Interrupt 4 */ +#define IMR_BCNDOK3_8723B BIT(16) /* Beacon Queue DMA OK Interrupt 3 */ +#define IMR_BCNDOK2_8723B BIT(15) /* Beacon Queue DMA OK Interrupt 2 */ +#define IMR_BCNDOK1_8723B BIT(14) /* Beacon Queue DMA OK Interrupt 1 */ +#define IMR_ATIMEND_E_8723B BIT(13) /* ATIM Window End Extension for Win7 */ +#define IMR_TXERR_8723B BIT(11) /* Tx Error Flag Interrupt Status, write 1 clear. */ +#define IMR_RXERR_8723B BIT(10) /* Rx Error Flag INT Status, Write 1 clear */ +#define IMR_TXFOVW_8723B BIT(9) /* Transmit FIFO Overflow */ +#define IMR_RXFOVW_8723B BIT(8) /* Receive FIFO Overflow */ #ifdef CONFIG_PCI_HCI /* #define IMR_RX_MASK (IMR_ROK_8723B|IMR_RDU_8723B|IMR_RXFOVW_8723B) */ @@ -281,16 +277,4 @@ #define RT_AC_INT_MASKS (IMR_VIDOK_8723B | IMR_VODOK_8723B | IMR_BEDOK_8723B | IMR_BKDOK_8723B) #endif -/* ******************************************************** - * General definitions - * ******************************************************** */ - -#define MACID_NUM_8723B 128 -#define SEC_CAM_ENT_NUM_8723B 64 -#define HW_PORT_NUM_8723B 2 -#define NSS_NUM_8723B 1 -#define BAND_CAP_8723B (BAND_CAP_2G) -#define BW_CAP_8723B (BW_CAP_20M | BW_CAP_40M) -#define PROTO_CAP_8723B (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) - #endif /* __RTL8723B_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_sreset.h index 8067359da761..c97f2648ac60 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8723B_SRESET_H_ #define _RTL8723B_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_xmit.h index 7cc33e179162..1364951d9db0 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723b_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723B_XMIT_H__ #define __RTL8723B_XMIT_H__ @@ -293,6 +288,7 @@ void rtl8723b_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 I #if defined(CONFIG_CONCURRENT_MODE) void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); #endif +void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) s32 rtl8723bs_init_xmit_priv(PADAPTER padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_cmd.h index 49deb465e0cd..c90b8ea8042c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_CMD_H__ #define __RTL8723D_CMD_H__ @@ -98,24 +93,13 @@ enum h2c_cmd_8723D { #define SET_8723D_H2CCMD_RSVDPAGE_LOC_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_8723D_H2CCMD_RSVDPAGE_LOC_BT_QOS_NULL_DATA(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) -/* _KEEP_ALIVE_CMD_0x03 */ -#define SET_8723D_H2CCMD_KEEPALIVE_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -#define SET_8723D_H2CCMD_KEEPALIVE_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -#define SET_8723D_H2CCMD_KEEPALIVE_PARM_PKT_TYPE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 2, 1, __Value) -#define SET_8723D_H2CCMD_KEEPALIVE_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) - -/* _DISCONNECT_DECISION_CMD_0x04 */ -#define SET_8723D_H2CCMD_DISCONDECISION_PARM_ENABLE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 1, __Value) -#define SET_8723D_H2CCMD_DISCONDECISION_PARM_ADOPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 1, 1, __Value) -#define SET_8723D_H2CCMD_DISCONDECISION_PARM_CHECK_PERIOD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+1, 0, 8, __Value) -#define SET_8723D_H2CCMD_DISCONDECISION_PARM_TRY_PKT_NUM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd+2, 0, 8, __Value) - /* _PWR_MOD_CMD_0x20 */ #define SET_8723D_H2CCMD_PWRMODE_PARM_MODE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) #define SET_8723D_H2CCMD_PWRMODE_PARM_RLBM(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 4, __Value) #define SET_8723D_H2CCMD_PWRMODE_PARM_SMART_PS(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 4, 4, __Value) #define SET_8723D_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 8, __Value) #define SET_8723D_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) +#define SET_8723D_H2CCMD_PWRMODE_PARM_BCN_EARLY_C2H_RPT(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 2, 1, __Value) #define SET_8723D_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) #define SET_8723D_H2CCMD_PWRMODE_PARM_BYTE5(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+5, 0, 8, __Value) @@ -181,12 +165,8 @@ enum h2c_cmd_8723D { /* host message to firmware cmd */ void rtl8723d_set_FwPwrMode_cmd(PADAPTER padapter, u8 Mode); void rtl8723d_set_FwJoinBssRpt_cmd(PADAPTER padapter, u8 mstatus); -void rtl8723d_set_rssi_cmd(PADAPTER padapter, u8 *param); -void rtl8723d_fw_try_ap_cmd(PADAPTER padapter, u32 need_ack); /* s32 rtl8723d_set_lowpwr_lps_cmd(PADAPTER padapter, u8 enable); */ void rtl8723d_set_FwPsTuneParam_cmd(PADAPTER padapter); -void rtl8723d_set_FwMacIdConfig_cmd(_adapter *padapter, u8 mac_id, u8 raid, u8 bw, u8 sgi, u32 mask); -void rtl8723d_set_FwBtMpOper_cmd(PADAPTER padapter, u8 idx, u8 ver, u8 reqnum, u8 *param); void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus); #ifdef CONFIG_BT_COEXIST void rtl8723d_download_BTCoex_AP_mode_rsvd_page(PADAPTER padapter); @@ -195,17 +175,16 @@ void rtl8723d_download_rsvd_page(PADAPTER padapter, u8 mstatus); void rtl8723d_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); #endif /* CONFIG_P2P */ -void CheckFwRsvdPageContent(PADAPTER padapter); +#ifdef CONFIG_TDLS +#ifdef CONFIG_TDLS_CH_SW +void rtl8723d_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); +#endif +#endif #ifdef CONFIG_P2P_WOWLAN void rtl8723d_set_p2p_wowlan_offload_cmd(PADAPTER padapter); #endif -void rtl8723d_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 en); - -#ifdef CONFIG_TSF_RESET_OFFLOAD - u8 rtl8723d_reset_tsf(_adapter *padapter, u8 reset_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD */ s32 FillH2CCmd8723D(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); u8 GetTxBufferRsvdPageNum8723D(_adapter *padapter, bool wowlan); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_dm.h index bae086d0f010..0612f0620e79 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_DM_H__ #define __RTL8723D_DM_H__ /* ************************************************************ @@ -40,8 +35,5 @@ void rtl8723d_deinit_dm_priv(PADAPTER padapter); void rtl8723d_InitHalDm(PADAPTER padapter); void rtl8723d_HalDmWatchDog(PADAPTER padapter); -void rtl8723d_HalDmWatchDog_in_LPS(PADAPTER padapter); -void rtl8723d_hal_dm_in_lps(PADAPTER padapter); - #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_hal.h index 1426bc6a1d2a..fc57eba26245 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_HAL_H__ #define __RTL8723D_HAL_H__ @@ -99,7 +94,7 @@ typedef struct _RT_8723D_FIRMWARE_HDR { #define RX_DMA_SIZE_8723D 0x4000 /* 16K(RX) */ #ifdef CONFIG_WOWLAN - #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ #else #define RESV_FMWF 0 #endif @@ -130,9 +125,11 @@ typedef struct _RT_8723D_FIRMWARE_HDR { #endif /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, PNO: 6 */ + * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:2,GTK EXT MEM:2, AOAC rpt 1, PNO: 6 + * NS offload: 2 NDP info: 1 + */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_8723D 0x07 + #define WOWLAN_PAGE_NUM_8723D 0x0b #else #define WOWLAN_PAGE_NUM_8723D 0x00 #endif @@ -159,11 +156,13 @@ typedef struct _RT_8723D_FIRMWARE_HDR { #define NORMAL_PAGE_NUM_HPQ_8723D 0x0C #define NORMAL_PAGE_NUM_LPQ_8723D 0x02 #define NORMAL_PAGE_NUM_NPQ_8723D 0x02 +#define NORMAL_PAGE_NUM_EPQ_8723D 0x04 /* Note: For Normal Chip Setting, modify later */ #define WMM_NORMAL_PAGE_NUM_HPQ_8723D 0x30 #define WMM_NORMAL_PAGE_NUM_LPQ_8723D 0x20 #define WMM_NORMAL_PAGE_NUM_NPQ_8723D 0x20 +#define WMM_NORMAL_PAGE_NUM_EPQ_8723D 0x00 #include "HalVerDef.h" @@ -260,7 +259,7 @@ VOID Hal_EfuseParseBoardType_8723D(PADAPTER Adapter, void rtl8723d_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8723d(_adapter *adapter); -void SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val); +u8 SetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val); void GetHwReg8723D(PADAPTER padapter, u8 variable, u8 *val); u8 SetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); u8 GetHalDefVar8723D(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); @@ -310,7 +309,7 @@ void Hal_ReadRFGainOffset(PADAPTER pAdapter, u8 *hwinfo, BOOLEAN AutoLoadFail); #ifdef CONFIG_PCI_HCI BOOLEAN InterruptRecognized8723DE(PADAPTER Adapter); VOID UpdateInterruptMask8723DE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); - u16 get_txbufdesc_idx_hwaddr(u16 ff_hwaddr); + u16 get_txbd_rw_reg(u16 ff_hwaddr); #endif #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_led.h index 439ee82d7a94..1905e8bed02c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_LED_H__ #define __RTL8723D_LED_H__ @@ -24,7 +19,7 @@ #include #include - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -45,4 +40,5 @@ void rtl8723de_DeInitSwLeds(PADAPTER padapter); #endif +#endif /*#ifdef CONFIG_RTW_SW_LED*/ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_lps_poff.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_lps_poff.h index c466d40f8771..138a0ca66732 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_lps_poff.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_lps_poff.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /******************************************** CONST ************************/ #define NUM_OF_REGISTER_BANK 13 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_recv.h index 6343ec8d5a05..03539a8b0a39 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_RECV_H__ #define __RTL8723D_RECV_H__ @@ -102,6 +97,7 @@ #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) s32 rtl8723ds_init_recv_priv(PADAPTER padapter); void rtl8723ds_free_recv_priv(PADAPTER padapter); + s32 rtl8723ds_recv_hdl(_adapter *padapter); #endif #ifdef CONFIG_USB_HCI diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_rf.h index 0aa5813a6451..733eb0a46518 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,16 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_RF_H__ #define __RTL8723D_RF_H__ int PHY_RF6052_Config8723D(IN PADAPTER pdapter); -void PHY_RF6052SetBandwidth8723D(IN PADAPTER Adapter, IN CHANNEL_WIDTH Bandwidth); +void PHY_RF6052SetBandwidth8723D(IN PADAPTER Adapter, IN enum channel_width Bandwidth); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_spec.h index 1d4105610c9c..5106b23b7722 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_SPEC_H__ #define __RTL8723D_SPEC_H__ @@ -83,6 +79,7 @@ #define REG_PMC_DBG_CTRL2_8723D 0x00CC #define REG_EFUSE_BURN_GNT_8723D 0x00CF #define REG_HPON_FSM_8723D 0x00EC +#define REG_SYS_CFG1_8723D 0x00F0 #define REG_SYS_CFG_8723D 0x00FC #define REG_ROM_VERSION 0x00FD @@ -380,6 +377,11 @@ #define REG_BFMEE_SEL_8723D 0x0714 #define REG_SND_PTCL_CTRL_8723D 0x0718 +/* LTR */ +#define REG_LTR_CTRL_BASIC_8723D 0x07A4 +#define REG_LTR_IDLE_LATENCY_V1_8723D 0x0798 +#define REG_LTR_ACTIVE_LATENCY_V1_8723D 0x079C + /* LTE_COEX */ #define REG_LTECOEX_CTRL 0x07C0 #define REG_LTECOEX_WRITE_DATA 0x07C4 @@ -442,16 +444,4 @@ #define RT_AC_INT_MASKS (IMR_VIDOK_8723D | IMR_VODOK_8723D | IMR_BEDOK_8723D | IMR_BKDOK_8723D) #endif -/* ******************************************************** - * General definitions - * ******************************************************** */ - -#define MACID_NUM_8723D 16 -#define SEC_CAM_ENT_NUM_8723D 32 -#define HW_PORT_NUM_8723D 3 /*port0, port1, port2*/ -#define NSS_NUM_8723D 1 -#define BAND_CAP_8723D (BAND_CAP_2G) -#define BW_CAP_8723D (BW_CAP_20M | BW_CAP_40M) -#define PROTO_CAP_8723D (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N) - #endif /* __RTL8723D_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_sreset.h index aafe7c86aede..db75dba73e32 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8723D_SRESET_H_ #define _RTL8723D_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_xmit.h index 20f98b0c7c8c..a7360566cdeb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8723d_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8723D_XMIT_H__ #define __RTL8723D_XMIT_H__ @@ -480,6 +475,7 @@ void rtl8723d_fill_fake_txdesc(PADAPTER padapter, u8 *pDesc, u32 BufferLen, u8 I #if defined(CONFIG_CONCURRENT_MODE) void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); #endif +void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) s32 rtl8723ds_init_xmit_priv(PADAPTER padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_cmd.h index fc09d1646c9f..17dd2dd939af 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_CMD_H__ #define __RTL8812A_CMD_H__ @@ -103,16 +98,14 @@ struct H2C_SS_RFOFF_PARAM { #define SET_8812_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) -void Set_RA_LDPC_8812(struct sta_info *psta, BOOLEAN bLDPC); +void set_ra_ldpc_8812(struct cmn_sta_info *cmn_sta_info, BOOLEAN bLDPC); /* host message to firmware cmd */ -s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); +s32 fill_h2c_cmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); void rtl8812_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); void rtl8812_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); u8 rtl8812_set_rssi_cmd(PADAPTER padapter, u8 *param); -void rtl8812_set_raid_cmd(PADAPTER padapter, u32 bitmap, u8 *arg, u8 bw); void rtl8812_set_wowlan_cmd(_adapter *padapter, u8 enable); -s32 FillH2CCmd_8812(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); u8 GetTxBufferRsvdPageNum8812(_adapter *padapter, bool wowlan); #ifdef CONFIG_BT_COEXIST @@ -126,18 +119,12 @@ void rtl8812_set_p2p_ps_offload_cmd(PADAPTER padapter, u8 p2p_ps_state); void rtl8812_set_FwPwrModeInIPS_cmd(PADAPTER padapter, u8 cmd_param); #endif -void CheckFwRsvdPageContent(PADAPTER padapter); - #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW void rtl8812_set_BcnEarly_C2H_Rpt_cmd(PADAPTER padapter, u8 enable); #endif #endif -#ifdef CONFIG_TSF_RESET_OFFLOAD -int reset_tsf(PADAPTER Adapter, u8 reset_port); -#endif /* CONFIG_TSF_RESET_OFFLOAD */ - /* ------------------------------------ * C2H format * ------------------------------------ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_dm.h index fef58248ef1e..584f6d342deb 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_DM_H__ #define __RTL8812A_DM_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_hal.h index 4b46ea8ef388..e3fe2659617f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_HAL_H__ #define __RTL8812A_HAL_H__ @@ -128,7 +123,7 @@ typedef struct _RT_FIRMWARE_8812 { #define MAX_RX_DMA_BUFFER_SIZE_8812 0x3E80 /* RX 16K */ #ifdef CONFIG_WOWLAN - #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_NUM) /* 16 entries, for each is 24 bytes*/ + #define RESV_FMWF (WKFMCAM_SIZE * MAX_WKFM_CAM_NUM) /* 16 entries, for each is 24 bytes*/ #else #define RESV_FMWF 0 #endif @@ -143,9 +138,11 @@ typedef struct _RT_FIRMWARE_8812 { #define BCNQ_PAGE_NUM_8812 0x07 /* For WoWLan , more reserved page - * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, PNO: 6 */ + * ARP Rsp:1, RWC:1, GTK Info:1,GTK RSP:1,GTK EXT MEM:1, AOAC rpt: 1,PNO: 6 + * NS offload: 1 NDP info: 1 + */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_8812 0x05 + #define WOWLAN_PAGE_NUM_8812 0x08 #else #define WOWLAN_PAGE_NUM_8812 0x00 #endif @@ -217,10 +214,12 @@ typedef struct _RT_FIRMWARE_8812 { #define NORMAL_PAGE_NUM_LPQ_8821 0x08/* 0x10 */ #define NORMAL_PAGE_NUM_HPQ_8821 0x08/* 0x10 */ #define NORMAL_PAGE_NUM_NPQ_8821 0x00 +#define NORMAL_PAGE_NUM_EPQ_8821 0x04 #define WMM_NORMAL_PAGE_NUM_HPQ_8821 0x30 #define WMM_NORMAL_PAGE_NUM_LPQ_8821 0x20 #define WMM_NORMAL_PAGE_NUM_NPQ_8821 0x20 +#define WMM_NORMAL_PAGE_NUM_EPQ_8821 0x00 #define MCC_NORMAL_PAGE_NUM_HPQ_8821 0x10 #define MCC_NORMAL_PAGE_NUM_LPQ_8821 0x10 @@ -258,7 +257,20 @@ typedef struct _RT_FIRMWARE_8812 { /* #define IS_MULTI_FUNC_CHIP(_Adapter) (((((PHAL_DATA_TYPE)(_Adapter->HalData))->MultiFunc) & (RT_MULTI_FUNC_BT|RT_MULTI_FUNC_GPS)) ? _TRUE : _FALSE) */ /* #define RT_IS_FUNC_DISABLED(__pAdapter, __FuncBits) ( (__pAdapter)->DisabledFunctions & (__FuncBits) ) */ +#define HAL_EFUSE_MEMORY +/* ******************************************************** + * EFUSE for BT definition + * ******************************************************** */ +#define BANK_NUM 2 +#define EFUSE_BT_REAL_BANK_CONTENT_LEN 512 +#define EFUSE_BT_REAL_CONTENT_LEN \ + (EFUSE_BT_REAL_BANK_CONTENT_LEN * BANK_NUM) +#define EFUSE_BT_MAP_LEN 1024 /* 1k bytes */ +#define EFUSE_BT_MAX_SECTION (EFUSE_BT_MAP_LEN / 8) +#define EFUSE_PROTECT_BYTES_BANK 16 + +#define AVAILABLE_EFUSE_ADDR(addr) (addr < EFUSE_BT_REAL_CONTENT_LEN) #ifdef CONFIG_FILE_FWIMG extern char *rtw_fw_file_path; @@ -316,7 +328,7 @@ void SetBeaconRelatedRegisters8812A(PADAPTER padapter); void ReadRFType8812A(PADAPTER padapter); void InitDefaultValue8821A(PADAPTER padapter); -void SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); +u8 SetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); void GetHwReg8812A(PADAPTER padapter, u8 variable, u8 *pval); u8 SetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); u8 GetHalDefVar8812A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); @@ -324,6 +336,8 @@ void rtl8812_set_hal_ops(struct hal_ops *pHalFunc); void init_hal_spec_8812a(_adapter *adapter); void init_hal_spec_8821a(_adapter *adapter); +u32 upload_txpktbuf_8812au(_adapter *adapter, u8 *buf, u32 buflen); + /* register */ void SetBcnCtrlReg(PADAPTER padapter, u8 SetBits, u8 ClearBits); @@ -333,6 +347,7 @@ void rtl8812_stop_thread(PADAPTER padapter); #ifdef CONFIG_PCI_HCI BOOLEAN InterruptRecognized8812AE(PADAPTER Adapter); VOID UpdateInterruptMask8812AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); +VOID InitTRXDescHwAddress8812AE(PADAPTER Adapter); #endif #ifdef CONFIG_BT_COEXIST diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_led.h index 28840be0bb9d..30c676e526f3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,16 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_LED_H__ #define __RTL8812A_LED_H__ - - +#ifdef CONFIG_RTW_LED +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -33,9 +28,14 @@ void rtl8812ae_InitSwLeds(PADAPTER padapter); void rtl8812ae_DeInitSwLeds(PADAPTER padapter); #endif #ifdef CONFIG_SDIO_HCI -void rtl8821as_hw_led_config(PADAPTER adapter); void rtl8821as_InitSwLeds(PADAPTER padapter); void rtl8821as_DeInitSwLeds(PADAPTER padapter); #endif +#endif/*CONFIG_RTW_SW_LED*/ +#endif/*#ifdef CONFIG_RTW_LED*/ +#ifdef CONFIG_SDIO_HCI +void rtl8821as_init_led_circuit(PADAPTER adapter); #endif + +#endif /*__RTL8812A_LED_H__*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_recv.h index 4e7b4eddc571..bf1d4b651ea1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_RECV_H__ #define __RTL8812A_RECV_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_rf.h index 9a7175d2dd97..9a7b60e6138c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,19 +11,14 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_RF_H__ #define __RTL8812A_RF_H__ VOID PHY_RF6052SetBandwidth8812( IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + IN enum channel_width Bandwidth); int diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_spec.h index dc7bd3d8d132..37ba2472296c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_SPEC_H__ #define __RTL8812A_SPEC_H__ @@ -102,14 +98,17 @@ * 0x0300h ~ 0x03FFh PCIe * * ----------------------------------------------------- */ -#define REG_PCIE_CTRL_REG_8812A 0x0300 +#define REG_PCIE_CTRL_REG_8812A 0x0300 #define REG_DBI_WDATA_8812 0x0348 /* DBI Write Data */ #define REG_DBI_RDATA_8812 0x034C /* DBI Read Data */ -#define REG_DBI_ADDR_8812 0x0350 /* DBI Address */ -#define REG_DBI_FLAG_8812 0x0352 /* DBI Read/Write Flag */ +#define REG_DBI_ADDR_8812 0x0350 /* DBI Address */ +#define REG_DBI_FLAG_8812 0x0352 /* DBI Read/Write Flag */ #define REG_MDIO_WDATA_8812 0x0354 /* MDIO for Write PCIE PHY */ #define REG_MDIO_RDATA_8812 0x0356 /* MDIO for Reads PCIE PHY */ -#define REG_MDIO_CTL_8812 0x0358 /* MDIO for Control */ +#define REG_MDIO_CTL_8812 0x0358 /* MDIO for Control */ +#define REG_PCIE_HRPWM_8812A 0x0361 /* PCIe RPWM */ +#define REG_PCIE_HCPWM_8812A 0x0363 /* PCIe CPWM */ + #define REG_PCIE_MULTIFET_CTRL_8812 0x036A /* PCIE Multi-Fethc Control */ /* ----------------------------------------------------- @@ -257,18 +256,6 @@ #define AcmHw_ViqStatus_8812 BIT(6) #define AcmHw_BeqStatus_8812 BIT(7) -/* ******************************************************** -* General definitions -* ******************************************************** */ - -#define MACID_NUM_8812A 128 -#define SEC_CAM_ENT_NUM_8812A 64 -#define HW_PORT_NUM_8812A 2 -#define NSS_NUM_8812A 2 -#define BAND_CAP_8812A (BAND_CAP_2G | BAND_CAP_5G) -#define BW_CAP_8812A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) -#define PROTO_CAP_8812A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) - #endif /* __RTL8812A_SPEC_H__ */ #ifdef CONFIG_RTL8821A diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_sreset.h index 1d166dcb95ad..d4bbd5867b24 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL88812A_SRESET_H_ #define _RTL8812A_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_xmit.h index 9d0df793ef4a..6105a8e4192d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8812a_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8812A_XMIT_H__ #define __RTL8812A_XMIT_H__ @@ -326,6 +321,7 @@ void rtl8812a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 #if defined(CONFIG_CONCURRENT_MODE) void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); #endif +void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); #ifdef CONFIG_USB_HCI s32 rtl8812au_init_xmit_priv(PADAPTER padapter); @@ -347,6 +343,11 @@ s32 rtl8812ae_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe); s32 rtl8812ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); s32 rtl8812ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); void rtl8812ae_xmit_tasklet(void *priv); + +#ifdef CONFIG_XMIT_THREAD_MODE +s32 rtl8812ae_xmit_buf_handler(_adapter *padapter); +#endif + #endif #ifdef CONFIG_TX_EARLY_MODE diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_cmd.h index a42504d897ab..53c2828ae5e5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_CMD_H__ #define __RTL8814A_CMD_H__ #include "hal_com_h2c.h" @@ -80,6 +75,30 @@ #define SET_88E_H2CCMD_PWRMODE_PARM_ALL_QUEUE_UAPSD(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+3, 0, 8, __Value) #define SET_88E_H2CCMD_PWRMODE_PARM_PWR_STATE(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+4, 0, 8, __Value) +/* AP_REQ_TXREP_CMD 0x43 */ +#define SET_8814A_H2CCMD_TXREP_PARM_STA1(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 0, 8, __Value) +#define SET_8814A_H2CCMD_TXREP_PARM_STA2(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+1, 0, 8, __Value) +#define SET_8814A_H2CCMD_TXREP_PARM_RTY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd)+2, 0, 2, __Value) + +/* C2H_AP_REQ_TXRPT */ +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_MACID1(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 8) +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXOK1(_Header) LE_BITS_TO_2BYTE((_Header + 1), 0, 16) +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXFAIL1(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_INIRATE1(_Header) LE_BITS_TO_1BYTE((_Header + 5), 0, 8) +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_MACID2(_Header) LE_BITS_TO_1BYTE((_Header + 6), 0, 8) +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXOK2(_Header) LE_BITS_TO_2BYTE((_Header + 7), 0, 16) +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_TXFAIL2(_Header) LE_BITS_TO_2BYTE((_Header + 9), 0, 16) +#define GET_8814A_C2H_TC2H_APREQ_TXRPT_INIRATE2(_Header) LE_BITS_TO_1BYTE((_Header + 11), 0, 8) + +/* C2H_SPC_STAT */ +#define GET_8814A_C2H_SPC_STAT_IDX(_Header) LE_BITS_TO_1BYTE((_Header + 0), 0, 8) + /* Tip :TYPE_A data3 is msb and data0 is lsb */ +#define GET_8814A_C2H_SPC_STAT_TYPEA_RETRY(_Header) LE_BITS_TO_4BYTE((_Header + 1), 0, 32) +#define GET_8814A_C2H_SPC_STAT_TYPEB_PKT1(_Header) LE_BITS_TO_2BYTE((_Header + 1), 0, 16) +#define GET_8814A_C2H_SPC_STAT_TYPEB_RETRY1(_Header) LE_BITS_TO_2BYTE((_Header + 3), 0, 16) +#define GET_8814A_C2H_SPC_STAT_TYPEB_PKT2(_Header) LE_BITS_TO_2BYTE((_Header + 5), 0, 16) +#define GET_8814A_C2H_SPC_STAT_TYPEB_RETRY2(_Header) LE_BITS_TO_2BYTE((_Header + 7), 0, 16) + /*BCNHWSEQ*/ #define SET_8814A_H2CCMD_BCNHWSEQ_EN(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 0, 1, __Value) #define SET_8814A_H2CCMD_BCNHWSEQ_BCN_NUMBER(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE((__pH2CCmd), 1, 3, __Value) @@ -117,12 +136,12 @@ void rtl8814_fw_update_beacon_cmd(_adapter *padapter); #define SET_8814A_H2CCMD_P2P_PS_OFFLOAD_DISCOVERY(__pH2CCmd, __Value) SET_BITS_TO_LE_1BYTE(__pH2CCmd, 6, 1, __Value) s32 FillH2CCmd_8814(PADAPTER padapter, u8 ElementID, u32 CmdLen, u8 *pCmdBuffer); -void rtl8814_set_raid_cmd(PADAPTER padapter, u64 bitmap, u8 *arg, u8 bw); void rtl8814_set_wowlan_cmd(_adapter *padapter, u8 enable); void rtl8814_set_FwJoinBssReport_cmd(PADAPTER padapter, u8 mstatus); void rtl8814_set_FwPwrMode_cmd(PADAPTER padapter, u8 PSMode); u8 GetTxBufferRsvdPageNum8814(_adapter *padapter, bool wowlan); u8 rtl8814_set_rssi_cmd(_adapter *padapter, u8 *param); +void rtl8814_req_txrpt_cmd(PADAPTER padapter, u8 macid); #ifdef CONFIG_TDLS #ifdef CONFIG_TDLS_CH_SW diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_dm.h index bb925e4e398d..afbc8be2565c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_dm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_dm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_DM_H__ #define __RTL8814A_DM_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_hal.h index c5a3f882bd99..b7631df6169d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_HAL_H__ #define __RTL8814A_HAL_H__ @@ -148,7 +143,7 @@ typedef struct _RT_FIRMWARE_8814 { #endif /* #if defined(CONFIG_SDIO_HCI) || defined(CONFIG_USB_HCI) */ #ifdef CONFIG_WOWLAN - #define WOWLAN_PAGE_NUM_8814 0x00 + #define WOWLAN_PAGE_NUM_8814 0x06 #else #define WOWLAN_PAGE_NUM_8814 0x00 #endif @@ -222,6 +217,16 @@ Chip specific * */ #define EFUSE_OOB_PROTECT_BYTES 15 /* PG data exclude header, dummy 6 bytes frome CP test and reserved 1byte. */ +#ifdef CONFIG_FILE_FWIMG +extern char *rtw_fw_file_path; +#ifdef CONFIG_WOWLAN +extern char *rtw_fw_wow_file_path; +#endif +#ifdef CONFIG_MP_INCLUDED +extern char *rtw_fw_mp_bt_file_path; +#endif /* CONFIG_MP_INCLUDED */ +#endif /* CONFIG_FILE_FWIMG */ + /* rtl8814_hal_init.c */ s32 FirmwareDownload8814A(PADAPTER Adapter, BOOLEAN bUsedWoWLANFw); void InitializeFirmwareVars8814(PADAPTER padapter); @@ -297,7 +302,7 @@ void SetBeaconRelatedRegisters8814A(PADAPTER padapter); void ReadRFType8814A(PADAPTER padapter); void InitDefaultValue8814A(PADAPTER padapter); -void SetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); +u8 SetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); void GetHwReg8814A(PADAPTER padapter, u8 variable, u8 *pval); u8 SetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); u8 GetHalDefVar8814A(PADAPTER padapter, HAL_DEF_VARIABLE variable, void *pval); @@ -314,7 +319,8 @@ void rtl8814_stop_thread(PADAPTER padapter); #ifdef CONFIG_PCI_HCI BOOLEAN InterruptRecognized8814AE(PADAPTER Adapter); VOID UpdateInterruptMask8814AE(PADAPTER Adapter, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); - u16 get_txbd_idx_addr(u16 ff_hwaddr); + VOID InitMAC_TRXBD_8814AE(PADAPTER Adapter); + u16 get_txbd_rw_reg(u16 ff_hwaddr); #endif #ifdef CONFIG_BT_COEXIST diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_led.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_led.h index 1137a9b46046..cc457921efa1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_led.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_led.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,16 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_LED_H__ #define __RTL8814A_LED_H__ - +#ifdef CONFIG_RTW_SW_LED /* ******************************************************************************** * Interface to manipulate LED objects. * ******************************************************************************** */ @@ -38,3 +33,4 @@ #endif /* CONFIG_SDIO_HCI */ #endif /* __RTL8814A_LED_H__ */ +#endif /*CONFIG_RTW_SW_LED*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_recv.h index e9626f3742f8..c6792d8a5194 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_RECV_H__ #define __RTL8814A_RECV_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_rf.h index 7b11d99f5c32..e374439caaf2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,19 +11,14 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_RF_H__ #define __RTL8814A_RF_H__ VOID PHY_RF6052SetBandwidth8814A( IN PADAPTER Adapter, - IN CHANNEL_WIDTH Bandwidth); + IN enum channel_width Bandwidth); int diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_spec.h index 43a638103837..917b96178d66 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_SPEC_H__ #define __RTL8814A_SPEC_H__ @@ -450,6 +446,8 @@ #define REG_SND_PTCL_CTRL_8814A 0x0718 #define REG_IQ_DUMP_8814A 0x07C0 +#define REG_CPU_DMEM_CON_8814A 0x1080 + /**** page 19 ****/ /* TX BeamForming */ #define REG_BB_TXBF_ANT_SET_BF1 0x19ac @@ -481,6 +479,13 @@ #define REG_DDMA_CHKSUM 0x12F0 #define REG_DDMA_MONITER 0x12FC +#define REG_Q0_Q1_INFO_8814A 0x1400 +#define REG_Q2_Q3_INFO_8814A 0x1404 +#define REG_Q4_Q5_INFO_8814A 0x1408 +#define REG_Q6_Q7_INFO_8814A 0x140C +#define REG_MGQ_HIQ_INFO_8814A 0x1410 +#define REG_CMDQ_BCNQ_INFO_8814A 0x1414 + #define DDMA_LEN_MASK 0x0001FFFF #define FW_CHKSUM_DUMMY_SZ 8 #define DDMA_CH_CHKSUM_CNT BIT(24) @@ -640,12 +645,4 @@ So the following defines for 92C is not entire!!!!!! #define LAST_ENTRY_OF_TX_PKT_BUFFER_8814A (2048-1) /* 20130415 KaiYuan add for 8814 */ -#define MACID_NUM_8814A 128 -#define SEC_CAM_ENT_NUM_8814A 64 -#define HW_PORT_NUM_8814A 5 -#define NSS_NUM_8814A 3 -#define BAND_CAP_8814A (BAND_CAP_2G | BAND_CAP_5G) -#define BW_CAP_8814A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) -#define PROTO_CAP_8814A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) - #endif /* __RTL8814A_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_sreset.h index 5d95e1fac009..d65cb98a530e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL88814A_SRESET_H_ #define _RTL8814A_SRESET_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_xmit.h index 099760d9cbc0..5b1e9660cddc 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8814a_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8814A_XMIT_H__ #define __RTL8814A_XMIT_H__ @@ -270,6 +265,7 @@ void rtl8814a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 #if defined(CONFIG_CONCURRENT_MODE) void fill_txdesc_force_bmc_camid(struct pkt_attrib *pattrib, u8 *ptxdesc); #endif +void fill_txdesc_bmc_tx_rate(struct pkt_attrib *pattrib, u8 *ptxdesc); #ifdef CONFIG_USB_HCI s32 rtl8814au_init_xmit_priv(PADAPTER padapter); @@ -291,6 +287,9 @@ void rtl8814a_fill_txdesc_phy(PADAPTER padapter, struct pkt_attrib *pattrib, u8 s32 rtl8814ae_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe); s32 rtl8814ae_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe); void rtl8814ae_xmit_tasklet(void *priv); +#ifdef CONFIG_XMIT_THREAD_MODE + s32 rtl8814ae_xmit_buf_handler(_adapter *padapter); +#endif #endif void _dbg_dump_tx_info(_adapter *padapter, int frame_tag, u8 *ptxdesc); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_spec.h index b4dfe3f3f70f..1379ffc3cf9d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_spec.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_spec.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8821A_SPEC_H__ #define __RTL8821A_SPEC_H__ @@ -84,25 +80,11 @@ /* ----------------------------------------------------- * SDIO register * ----------------------------------------------------- */ -#undef SDIO_REG_HCPWM1 #define SDIO_REG_FREE_TXPG2 0x024 -#define SDIO_REG_HCPWM1 0x025 - +#define SDIO_REG_HCPWM1_8821A 0x025 /* ************************************************************ * Regsiter Bit and Content definition * ************************************************************ */ -/* ******************************************************** - * General definitions - * ******************************************************** */ - -#define MACID_NUM_8821A 128 -#define SEC_CAM_ENT_NUM_8821A 64 -#define HW_PORT_NUM_8821A 2 -#define NSS_NUM_8821A 1 -#define BAND_CAP_8821A (BAND_CAP_2G | BAND_CAP_5G) -#define BW_CAP_8821A (BW_CAP_20M | BW_CAP_40M | BW_CAP_80M) -#define PROTO_CAP_8821A (PROTO_CAP_11B | PROTO_CAP_11G | PROTO_CAP_11N | PROTO_CAP_11AC) - #endif /* __RTL8821A_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_xmit.h index d7a97e3f1de4..5d973cdc7926 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821a_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTL8821A_XMIT_H__ #define __RTL8821A_XMIT_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_dm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_dm.h new file mode 100644 index 000000000000..b1e4fe608b2a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_dm.h @@ -0,0 +1,23 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __RTL8812C_DM_H__ +#define __RTL8812C_DM_H__ + +void rtl8821c_phy_init_dm_priv(PADAPTER); +void rtl8821c_phy_deinit_dm_priv(PADAPTER); +void rtl8821c_phy_init_haldm(PADAPTER); +void rtl8821c_phy_haldm_watchdog(PADAPTER); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_hal.h index d99d9d3140da..75d87505a265 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2016 - 2017 Realtek Corporation. * * 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 @@ -11,36 +11,50 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8821C_HAL_H_ #define _RTL8821C_HAL_H_ #include /* BIT(x) */ #include "../hal/halmac/halmac_api.h" /* MAC REG definition */ #include "hal_data.h" +#include "rtl8821c_spec.h" +#include "../hal/rtl8821c/hal8821c_fw.h" + +#ifdef CONFIG_USB_HCI +#include +#endif +#ifdef CONFIG_SDIO_HCI +#include +#endif +#ifdef CONFIG_PCI_HCI +#include +#endif + +#ifdef CONFIG_SUPPORT_TRX_SHARED +#define FIFO_BLOCK_SIZE 32768 /*@Block size = 32K*/ +#define RX_FIFO_EXPANDING (1 * FIFO_BLOCK_SIZE) +#else +#define RX_FIFO_EXPANDING 0 +#endif + #if defined(CONFIG_USB_HCI) #ifndef MAX_RECVBUF_SZ #ifndef CONFIG_MINIMAL_MEMORY_USAGE - #ifdef CONFIG_PLATFORM_MSTAR - #define MAX_RECVBUF_SZ (8192) /* 8K */ - #else - /* 8821C - RX FIFO :16K ,for RX agg DMA mode = 16K, Rx agg USB mode could large than 16k*/ - #define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8821C - #endif + /* 8821C - RX FIFO :16K ,for RX agg DMA mode = 16K, Rx agg USB mode could large than 16k*/ + /* #define MAX_RECVBUF_SZ (16384 + RX_FIFO_EXPANDING)*/ + /* For Max throughput issue , need to use USB AGG mode to replace DMA AGG mode*/ + #define MAX_RECVBUF_SZ (32768) + /*#define MAX_RECVBUF_SZ_8821C (24576)*/ /* 24k*/ /*#define MAX_RECVBUF_SZ_8821C (20480)*/ /*20K*/ /*#define MAX_RECVBUF_SZ_8821C (10240) */ /*10K*/ /*#define MAX_RECVBUF_SZ_8821C (15360)*/ /*15k < 16k*/ /*#define MAX_RECVBUF_SZ_8821C (8192+1024)*/ /* 8K+1k*/ #else - #define MAX_RECVBUF_SZ (4096) /* about 4K */ + #define MAX_RECVBUF_SZ (4096 + RX_FIFO_EXPANDING) /* about 4K */ #endif #endif/* !MAX_RECVBUF_SZ*/ @@ -48,21 +62,22 @@ /*#ifndef CONFIG_MINIMAL_MEMORY_USAGE #define MAX_RECVBUF_SZ (9100) #else*/ - #define MAX_RECVBUF_SZ (4096) /* about 4K */ + #define MAX_RECVBUF_SZ (4096 + RX_FIFO_EXPANDING) /* about 4K */ /*#endif*/ #elif defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - - #define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8821C - + #define MAX_RECVBUF_SZ (16384 + RX_FIFO_EXPANDING) #endif void init_hal_spec_rtl8821c(PADAPTER); /* MP Functions */ #ifdef CONFIG_MP_INCLUDED -void rtl8821c_phy_init_haldm(PADAPTER); /* rtw_mp.c */ void rtl8821c_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ void rtl8821c_mp_config_rfpath(PADAPTER); /* hal_mp.c */ #endif +#ifdef CONFIG_PCI_HCI +u16 get_txbd_rw_reg(u16 q_idx); +#endif + #endif /* _RTL8821C_HAL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_spec.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_spec.h new file mode 100644 index 000000000000..61843322fad9 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821c_spec.h @@ -0,0 +1,191 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __RTL8821C_SPEC_H__ +#define __RTL8821C_SPEC_H__ + +#define EFUSE_MAP_SIZE HALMAC_EFUSE_SIZE_8821C + +/* + * MAC Register definition + */ +#define REG_AFE_XTAL_CTRL REG_AFE_CTRL1_8821C /* hal_com.c & phydm */ +#define REG_AFE_PLL_CTRL REG_AFE_CTRL2_8821C /* hal_com.c & phydm */ +#define REG_MAC_PHY_CTRL REG_AFE_CTRL3_8821C /* phydm only */ +#define REG_LEDCFG0 REG_LED_CFG_8821C /* rtw_mp.c */ +#define MSR (REG_CR_8821C + 2) /* rtw_mp.c */ +#define MSR1 REG_CR_EXT_8821C /* rtw_mp.c & hal_com.c */ +#define REG_C2HEVT_MSG_NORMAL 0x1A0 /* hal_com.c */ +#define REG_C2HEVT_CLEAR 0x1AF /* hal_com.c */ +#define REG_BCN_CTRL_1 REG_BCN_CTRL_CLINT0_8821C/* hal_com.c */ +#define REG_TSFTR1 REG_FREERUN_CNT_8821C /* hal_com.c */ +#define REG_WOWLAN_WAKE_REASON 0x01C7 +#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8821C + +/* RXERR_RPT, for rtw_mp.c */ +#define RXERR_TYPE_OFDM_PPDU 0 +#define RXERR_TYPE_OFDM_FALSE_ALARM 2 +#define RXERR_TYPE_OFDM_MPDU_OK 0 +#define RXERR_TYPE_OFDM_MPDU_FAIL 1 +#define RXERR_TYPE_CCK_PPDU 3 +#define RXERR_TYPE_CCK_FALSE_ALARM 5 +#define RXERR_TYPE_CCK_MPDU_OK 3 +#define RXERR_TYPE_CCK_MPDU_FAIL 4 +#define RXERR_TYPE_HT_PPDU 8 +#define RXERR_TYPE_HT_FALSE_ALARM 9 +#define RXERR_TYPE_HT_MPDU_TOTAL 6 +#define RXERR_TYPE_HT_MPDU_OK 6 +#define RXERR_TYPE_HT_MPDU_FAIL 7 +#define RXERR_TYPE_RX_FULL_DROP 10 + +#define RXERR_COUNTER_MASK BIT_MASK_RPT_COUNTER_8821C +#define RXERR_RPT_RST BIT_RXERR_RPT_RST_8821C +#define _RXERR_RPT_SEL(type) (BIT_RXERR_RPT_SEL_V1_3_0_8821C(type) \ + | ((type & 0x10) ? BIT_RXERR_RPT_SEL_V1_4_8821C : 0)) + +/* + * BB Register definition + */ +#define rPMAC_Reset 0x100 /* hal_mp.c */ + +#define rFPGA0_RFMOD 0x800 +#define rFPGA0_TxInfo 0x804 +#define rOFDMCCKEN_Jaguar 0x808 /* hal_mp.c */ +#define rFPGA0_TxGainStage 0x80C /* phydm only */ +#define rFPGA0_XA_HSSIParameter1 0x820 /* hal_mp.c */ +#define rFPGA0_XA_HSSIParameter2 0x824 /* hal_mp.c */ +#define rFPGA0_XB_HSSIParameter1 0x828 /* hal_mp.c */ +#define rFPGA0_XB_HSSIParameter2 0x82C /* hal_mp.c */ +#define rTxAGC_B_Rate18_06 0x830 +#define rTxAGC_B_Rate54_24 0x834 +#define rTxAGC_B_CCK1_55_Mcs32 0x838 +#define rCCAonSec_Jaguar 0x838 /* hal_mp.c */ +#define rTxAGC_B_Mcs03_Mcs00 0x83C +#define rTxAGC_B_Mcs07_Mcs04 0x848 +#define rTxAGC_B_Mcs11_Mcs08 0x84C +#define rFPGA0_XA_RFInterfaceOE 0x860 +#define rFPGA0_XB_RFInterfaceOE 0x864 +#define rTxAGC_B_Mcs15_Mcs12 0x868 +#define rTxAGC_B_CCK11_A_CCK2_11 0x86C +#define rFPGA0_XAB_RFInterfaceSW 0x870 +#define rFPGA0_XAB_RFParameter 0x878 +#define rFPGA0_AnalogParameter4 0x88C /* hal_mp.c & phydm */ +#define rFPGA0_XB_LSSIReadBack 0x8A4 /* phydm */ +#define rHSSIRead_Jaguar 0x8B0 /* RF read addr (rtl8821c_phy.c) */ + +#define rC_TxScale_Jaguar2 0x181C /* Pah_C TX scaling factor (hal_mp.c) */ +#define rC_IGI_Jaguar2 0x1850 /* Initial Gain for path-C (hal_mp.c) */ + +#define rFPGA1_TxInfo 0x90C /* hal_mp.c */ +#define rSingleTone_ContTx_Jaguar 0x914 /* hal_mp.c */ + +#define rCCK0_System 0xA00 +#define rCCK0_AFESetting 0xA04 + +#define rCCK0_DSPParameter2 0xA1C +#define rCCK0_TxFilter1 0xA20 +#define rCCK0_TxFilter2 0xA24 +#define rCCK0_DebugPort 0xA28 +#define rCCK0_FalseAlarmReport 0xA2C + +#define rD_TxScale_Jaguar2 0x1A1C /* Path_D TX scaling factor (hal_mp.c) */ +#define rD_IGI_Jaguar2 0x1A50 /* Initial Gain for path-D (hal_mp.c) */ + +#define rOFDM0_TRxPathEnable 0xC04 +#define rOFDM0_TRMuxPar 0xC08 +#define rA_TxScale_Jaguar 0xC1C /* Pah_A TX scaling factor (hal_mp.c) */ +#define rOFDM0_RxDetector1 0xC30 /* rtw_mp.c */ +#define rOFDM0_ECCAThreshold 0xC4C /* phydm only */ +#define rOFDM0_XAAGCCore1 0xC50 /* phydm only */ +#define rA_IGI_Jaguar 0xC50 /* Initial Gain for path-A (hal_mp.c) */ +#define rOFDM0_XBAGCCore1 0xC58 /* phydm only */ +#define rOFDM0_XATxIQImbalance 0xC80 /* phydm only */ +#define rA_LSSIWrite_Jaguar 0xC90 /* RF write addr, LSSI Parameter (rtl8821c_phy.c) */ +#define rA_RFE_Pinmux_Jaguar 0xCB0 /* hal_mp.c */ + +#define rOFDM1_LSTF 0xD00 +#define rOFDM1_TRxPathEnable 0xD04 /* hal_mp.c */ +#define rA_PIRead_Jaguar 0xD04 /* RF readback with PI (rtl8821c_phy.c) */ +#define rA_SIRead_Jaguar 0xD08 /* RF readback with SI (rtl8821c_phy.c) */ +#define rB_PIRead_Jaguar 0xD44 /* RF readback with PI (rtl8821c_phy.c) */ +#define rB_SIRead_Jaguar 0xD48 /* RF readback with SI (rtl8821c_phy.c) */ + +#define rTxAGC_A_Rate18_06 0xE00 +#define rTxAGC_A_Rate54_24 0xE04 +#define rTxAGC_A_CCK1_Mcs32 0xE08 +#define rTxAGC_A_Mcs03_Mcs00 0xE10 +#define rTxAGC_A_Mcs07_Mcs04 0xE14 +#define rTxAGC_A_Mcs11_Mcs08 0xE18 +#define rTxAGC_A_Mcs15_Mcs12 0xE1C +#define rB_TxScale_Jaguar 0xE1C /* Path_B TX scaling factor (hal_mp.c) */ +#define rB_IGI_Jaguar 0xE50 /* Initial Gain for path-B (hal_mp.c) */ +#define rB_LSSIWrite_Jaguar 0xE90 /* RF write addr, LSSI Parameter (rtl8821c_phy.c) */ +#define rB_RFE_Pinmux_Jaguar 0xEB0 /* hal_mp.c */ + +/* Page1(0x100) */ +#define bBBResetB 0x100 + +/* Page8(0x800) */ +#define bCCKEn 0x1000000 +#define bOFDMEn 0x2000000 +/* Reg 0x80C rFPGA0_TxGainStage */ +#define bXBTxAGC 0xF00 +#define bXCTxAGC 0xF000 +#define bXDTxAGC 0xF0000 + +/* PageA(0xA00) */ +#define bCCKBBMode 0x3 + +#define bCCKScramble 0x8 +#define bCCKTxRate 0x3000 + +/* General */ +#define bMaskByte0 0xFF /* mp, rtw_odm.c & phydm */ +#define bMaskByte1 0xFF00 /* hal_mp.c & phydm */ +#define bMaskByte2 0xFF0000 /* hal_mp.c & phydm */ +#define bMaskByte3 0xFF000000 /* hal_mp.c & phydm */ +#define bMaskHWord 0xFFFF0000 /* hal_com.c, rtw_mp.c */ +#define bMaskLWord 0x0000FFFF /* mp, hal_com.c & phydm */ +#define bMaskDWord 0xFFFFFFFF /* mp, hal, rtw_odm.c & phydm */ + +#define bEnable 0x1 /* hal_mp.c, rtw_mp.c */ +#define bDisable 0x0 /* rtw_mp.c */ + +#define MAX_STALL_TIME 50 /* unit: us, hal_com_phycfg.c */ + +#define Rx_Smooth_Factor 20 /* phydm only */ + +/* + * RF Register definition + */ +#define RF_AC 0x00 +#define RF_AC_Jaguar 0x00 /* hal_mp.c */ +#define RF_CHNLBW 0x18 /* rtl8821c_phy.c */ +#define RF_0x52 0x52 + +struct hw_port_reg { + u32 net_type; /*reg_offset*/ + u8 net_type_shift; + u32 macaddr; /*reg_offset*/ + u32 bssid; /*reg_offset*/ + u32 bcn_ctl; /*reg_offset*/ + u32 tsf_rst; /*reg_offset*/ + u8 tsf_rst_bit; + u32 bcn_space; /*reg_offset*/ + u8 bcn_space_shift; + u16 bcn_space_mask; + u32 ps_aid; /*reg_offset*/ +}; + +#endif /* __RTL8192E_SPEC_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821ce_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821ce_hal.h new file mode 100644 index 000000000000..426002a30c9a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821ce_hal.h @@ -0,0 +1,23 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef _RTL8821CE_HAL_H_ +#define _RTL8821CE_HAL_H_ + +#include /* PADAPTER */ + +/* rtl8821ce_ops.c */ +void rtl8821ce_set_hal_ops(PADAPTER); + +#endif /* _RTL8821CE_HAL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cs_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cs_hal.h index 97df6e966154..ceecc15f966d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cs_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cs_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2016 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8821CS_HAL_H_ #define _RTL8821CS_HAL_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cu_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cu_hal.h index 63c25a821578..aec437224c73 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cu_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8821cu_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2016 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8821CU_HAL_H_ #define _RTL8821CU_HAL_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822b_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822b_hal.h index 089f97d4d947..8c4093b44372 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822b_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822b_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8822B_HAL_H_ #define _RTL8822B_HAL_H_ @@ -25,7 +20,11 @@ #include "../hal/halmac/halmac_api.h" /* MAC REG definition */ -#define MAX_RECVBUF_SZ HALMAC_RX_FIFO_SIZE_8822B +#ifdef CONFIG_SUPPORT_TRX_SHARED +#define MAX_RECVBUF_SZ 46080 /* 45KB, TX: (256-64)KB */ +#else /* !CONFIG_SUPPORT_TRX_SHARED */ +#define MAX_RECVBUF_SZ 24576 /* 24KB, TX: 256KB */ +#endif /* !CONFIG_SUPPORT_TRX_SHARED */ /* * MAC Register definition @@ -40,7 +39,8 @@ #define REG_C2HEVT_CLEAR 0x1AF /* hal_com.c */ #define REG_BCN_CTRL_1 REG_BCN_CTRL_CLINT0_8822B /* hal_com.c */ #define REG_TSFTR1 REG_FREERUN_CNT_8822B /* hal_com.c */ -#define REG_RXFLTMAP2 REG_RXFLTMAP_8822B /* rtw_mp.c */ +#define REG_WOWLAN_WAKE_REASON 0x01C7 /* hal_com.c */ +#define REG_GPIO_PIN_CTRL_2 REG_GPIO_EXT_CTRL_8822B /* hal_com.c */ /* RXERR_RPT, for rtw_mp.c */ #define RXERR_TYPE_OFDM_PPDU 0 @@ -200,7 +200,6 @@ void rtl8822b_init_hal_spec(PADAPTER); /* hal/hal_com.c */ #ifdef CONFIG_MP_INCLUDED /* MP Functions */ #include /* struct mp_priv */ -void rtl8822b_phy_init_haldm(PADAPTER); /* rtw_mp.c */ void rtl8822b_prepare_mp_txdesc(PADAPTER, struct mp_priv *); /* rtw_mp.c */ void rtl8822b_mp_config_rfpath(PADAPTER); /* hal_mp.c */ #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822be_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822be_hal.h index 8379fabc8a45..a81445fa166f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822be_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822be_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8822BE_HAL_H_ #define _RTL8822BE_HAL_H_ @@ -26,5 +21,7 @@ /* rtl8822be_ops.c */ void UpdateInterruptMask8822BE(PADAPTER, u32 AddMSR, u32 AddMSR1, u32 RemoveMSR, u32 RemoveMSR1); +u16 get_txbd_rw_reg(u16 q_idx); + #endif /* _RTL8822BE_HAL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bs_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bs_hal.h index 313036df3a24..ffaddee09832 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bs_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bs_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8822BS_HAL_H_ #define _RTL8822BS_HAL_H_ @@ -25,6 +20,10 @@ /* rtl8822bs_ops.c */ void rtl8822bs_set_hal_ops(PADAPTER); +#if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) +void rtl8822bs_disable_interrupt_but_cpwm2(PADAPTER adapter); +#endif + /* rtl8822bs_xmit.c */ s32 rtl8822bs_dequeue_writeport(PADAPTER); #define _dequeue_writeport(a) rtl8822bs_dequeue_writeport(a) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bu_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bu_hal.h index 495b391efea3..39618c9ea42d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bu_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtl8822bu_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL8822BU_HAL_H_ #define _RTL8822BU_HAL_H_ @@ -32,13 +27,25 @@ #define TXDESC_OFFSET (TXDESC_SIZE + PACKET_OFFSET_SZ) #endif + /* undefine MAX_RECVBUF_SZ from rtl8822b_hal.h */ + #ifdef MAX_RECVBUF_SZ + #undef MAX_RECVBUF_SZ + #endif + /* recv_buffer must be large than usb agg size */ #ifndef MAX_RECVBUF_SZ #ifdef PLATFORM_OS_CE #define MAX_RECVBUF_SZ (8192+1024) #else /* !PLATFORM_OS_CE */ #ifndef CONFIG_MINIMAL_MEMORY_USAGE + #ifdef CONFIG_PLATFORM_NOVATEK_NT72668 + #define MAX_RECVBUF_SZ (15360) /* 15k */ + #elif defined(CONFIG_PLATFORM_HISILICON) + /* use 16k to workaround for HISILICON platform */ + #define MAX_RECVBUF_SZ (16384) + #else #define MAX_RECVBUF_SZ (32768) + #endif #else #define MAX_RECVBUF_SZ (4000) #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_android.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_android.h index 984782ffc31b..16ae9c87f1b6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_android.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_android.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_ANDROID_H__ #define __RTW_ANDROID_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ap.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ap.h index 53de58c48aa8..8c73cd0b73e8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ap.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ap.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_AP_H_ #define __RTW_AP_H_ @@ -35,7 +30,9 @@ void rtw_add_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index, u8 *d void rtw_remove_bcn_ie(_adapter *padapter, WLAN_BSSID_EX *pnetwork, u8 index); void _update_beacon(_adapter *padapter, u8 ie_id, u8 *oui, u8 tx, const char *tag); #define update_beacon(adapter, ie_id, oui, tx) _update_beacon((adapter), (ie_id), (oui), (tx), __func__) -void add_RATid(_adapter *padapter, struct sta_info *psta, u8 rssi_level); + +void rtw_ap_update_sta_ra_info(_adapter *padapter, struct sta_info *psta); + void expire_timeout_chk(_adapter *padapter); void update_sta_info_apmode(_adapter *padapter, struct sta_info *psta); void rtw_start_bss_hdl_after_chbw_decided(_adapter *adapter); @@ -70,21 +67,32 @@ void rtw_ap_update_bss_chbw(_adapter *adapter, WLAN_BSSID_EX *bss, u8 ch, u8 bw, bool rtw_ap_chbw_decision(_adapter *adapter, s16 req_ch, s8 req_bw, s8 req_offset, u8 *ch, u8 *bw, u8 *offset, u8 *chbw_allow); #ifdef CONFIG_AUTO_AP_MODE +void rtw_auto_ap_rx_msg_dump(_adapter *padapter, union recv_frame *precv_frame, u8 *ehdr_pos); extern void rtw_start_auto_ap(_adapter *adapter); #endif /* CONFIG_AUTO_AP_MODE */ -#endif /* end of CONFIG_AP_MODE */ +void rtw_ap_parse_sta_capability(_adapter *adapter, struct sta_info *sta, u8 *cap); +u16 rtw_ap_parse_sta_supported_rates(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len); +u16 rtw_ap_parse_sta_security_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems); +void rtw_ap_parse_sta_wmm_ie(_adapter *adapter, struct sta_info *sta, u8 *tlv_ies, u16 tlv_ies_len); +void rtw_ap_parse_sta_ht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems); +void rtw_ap_parse_sta_vht_ie(_adapter *adapter, struct sta_info *sta, struct rtw_ieee802_11_elems *elems); -#endif void update_bmc_sta(_adapter *padapter); -void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len); -#ifdef CONFIG_80211N_HT -void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field); -int rtw_ht_operation_update(_adapter *padapter); +#ifdef CONFIG_BMC_TX_RATE_SELECT +void rtw_update_bmc_sta_tx_rate(_adapter *adapter); #endif +void rtw_process_ht_action_smps(_adapter *padapter, u8 *ta, u8 ctrl_field); +void rtw_process_public_act_bsscoex(_adapter *padapter, u8 *pframe, uint frame_len); +int rtw_ht_operation_update(_adapter *padapter); +u8 rtw_ap_sta_linking_state_check(_adapter *adapter); + #ifdef CONFIG_SWTIMER_BASED_TXBCN void tx_beacon_handlder(struct dvobj_priv *pdvobj); -void tx_beacon_timer_handlder(struct dvobj_priv *pdvobj); -#endif +void tx_beacon_timer_handlder(void *ctx); +#endif /*CONFIG_SWTIMER_BASED_TXBCN*/ + +#endif /* end of CONFIG_AP_MODE */ +#endif /*__RTW_AP_H_*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_beamforming.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_beamforming.h index 1d46f4bfe731..c0d6e0dccda2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_beamforming.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_beamforming.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,18 +11,12 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_BEAMFORMING_H_ #define __RTW_BEAMFORMING_H_ #ifdef CONFIG_BEAMFORMING -#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ #ifdef RTW_BEAMFORMING_VERSION_2 #define MAX_NUM_BEAMFORMEE_SU 2 #define MAX_NUM_BEAMFORMER_SU 2 @@ -32,13 +26,243 @@ #define MAX_BEAMFORMEE_ENTRY_NUM (MAX_NUM_BEAMFORMEE_SU + MAX_NUM_BEAMFORMEE_MU) #define MAX_BEAMFORMER_ENTRY_NUM (MAX_NUM_BEAMFORMER_SU + MAX_NUM_BEAMFORMER_MU) -#define GetInitSoundCnt(_SoundPeriod, _MinSoundPeriod) ((_SoundPeriod)/(_MinSoundPeriod)) +/* Need to be defined by IC */ +#define SU_SOUNDING_TIMEOUT 5 /* unit: ms */ +#define MU_SOUNDING_TIMEOUT 8 /* unit: ms */ #define GET_BEAMFORM_INFO(adapter) (&GET_HAL_DATA(adapter)->beamforming_info) +#define GetInitSoundCnt(_SoundPeriod, _MinSoundPeriod) ((_SoundPeriod)/(_MinSoundPeriod)) + +enum BEAMFORMING_CTRL_TYPE { + BEAMFORMING_CTRL_ENTER = 0, + BEAMFORMING_CTRL_LEAVE = 1, + BEAMFORMING_CTRL_START_PERIOD = 2, + BEAMFORMING_CTRL_END_PERIOD = 3, + BEAMFORMING_CTRL_SOUNDING_FAIL = 4, + BEAMFORMING_CTRL_SOUNDING_CLK = 5, + BEAMFORMING_CTRL_SET_GID_TABLE = 6, + BEAMFORMING_CTRL_SET_CSI_REPORT = 7, +}; + +enum _BEAMFORMING_STATE { + BEAMFORMING_STATE_IDLE, + BEAMFORMING_STATE_START, + BEAMFORMING_STATE_END, +}; + +/* + * typedef BEAMFORMING_CAP for phydm + */ +typedef enum beamforming_cap { + BEAMFORMING_CAP_NONE = 0x0, + BEAMFORMER_CAP_HT_EXPLICIT = 0x1, + BEAMFORMEE_CAP_HT_EXPLICIT = 0x2, + BEAMFORMER_CAP_VHT_SU = 0x4, /* Self has er Cap, because Reg er & peer ee */ + BEAMFORMEE_CAP_VHT_SU = 0x8, /* Self has ee Cap, because Reg ee & peer er */ + BEAMFORMER_CAP_VHT_MU = 0x10, /* Self has er Cap, because Reg er & peer ee */ + BEAMFORMEE_CAP_VHT_MU = 0x20, /* Self has ee Cap, because Reg ee & peer er */ + BEAMFORMER_CAP = 0x40, + BEAMFORMEE_CAP = 0x80, +} BEAMFORMING_CAP; + +enum _BEAMFORM_ENTRY_HW_STATE { + BEAMFORM_ENTRY_HW_STATE_NONE, + BEAMFORM_ENTRY_HW_STATE_ADD_INIT, + BEAMFORM_ENTRY_HW_STATE_ADDING, + BEAMFORM_ENTRY_HW_STATE_ADDED, + BEAMFORM_ENTRY_HW_STATE_DELETE_INIT, + BEAMFORM_ENTRY_HW_STATE_DELETING, + BEAMFORM_ENTRY_HW_STATE_MAX +}; + +/* The sounding state is recorded by BFer. */ +enum _SOUNDING_STATE { + SOUNDING_STATE_NONE = 0, + SOUNDING_STATE_INIT = 1, + SOUNDING_STATE_SU_START = 2, + SOUNDING_STATE_SU_SOUNDDOWN = 3, + SOUNDING_STATE_MU_START = 4, + SOUNDING_STATE_MU_SOUNDDOWN = 5, + SOUNDING_STATE_SOUNDING_TIMEOUT = 6, + SOUNDING_STATE_MAX +}; + +struct beamformee_entry { + u8 used; /* _TRUE/_FALSE */ + u8 txbf; + u8 sounding; + /* Used to construct AID field of NDPA packet */ + u16 aid; + /* Used to Set Reg42C in IBSS mode */ + u16 mac_id; + /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC */ + u16 p_aid; + u8 g_id; + /* Used to fill Reg6E4 to fill Mac address of CSI report frame */ + u8 mac_addr[ETH_ALEN]; + /* Sounding BandWidth */ + enum channel_width sound_bw; + u16 sound_period; + + enum beamforming_cap cap; + enum _BEAMFORM_ENTRY_HW_STATE state; + + /* The BFee need to be sounded when count to zero */ + u8 SoundCnt; + u8 bCandidateSoundingPeer; + u8 bSoundingTimeout; + u8 bDeleteSounding; + /* Get the result through throughput and Tx rate from BB API */ + u8 bApplySounding; + + /* information for sounding judgement */ + systime tx_timestamp; + u64 tx_bytes; + + u16 LogStatusFailCnt:5; /* 0~21 */ + u16 DefaultCSICnt:5; /* 0~21 */ + u8 CSIMatrix[327]; + u16 CSIMatrixLen; + + u8 NumofSoundingDim; + + u8 comp_steering_num_of_bfer; + + + /* SU-MIMO */ + u8 su_reg_index; + + /* MU-MIMO */ + u8 mu_reg_index; + u8 gid_valid[8]; + u8 user_position[16]; + + /* For 8822B C-cut workaround */ + /* If the flag set to _TRUE, do not sound this STA */ + u8 bSuspendSUCap; +}; + +struct beamformer_entry { + u8 used; + /* p_aid of BFer entry is probably not used */ + /* Used to fill Reg42C & Reg714 to compare with p_aid of Tx DESC */ + u16 p_aid; + u8 g_id; + u8 mac_addr[ETH_ALEN]; + + enum beamforming_cap cap; + enum _BEAMFORM_ENTRY_HW_STATE state; + + u8 NumofSoundingDim; + + /* SU-MIMO */ + u8 su_reg_index; + + /* MU-MIMO */ + u8 gid_valid[8]; + u8 user_position[16]; + u16 aid; +}; + +struct sounding_info { + u8 su_sounding_list[MAX_NUM_BEAMFORMEE_SU]; + u8 mu_sounding_list[MAX_NUM_BEAMFORMEE_MU]; + + enum _SOUNDING_STATE state; + /* + * su_bfee_curidx is index for beamforming_info.bfee_entry[] + * range: 0~MAX_BEAMFORMEE_ENTRY_NUM + */ + u8 su_bfee_curidx; + u8 candidate_mu_bfee_cnt; + + /* For sounding schedule maintenance */ + u16 min_sounding_period; + /* Get from sounding list */ + /* Ex: SU STA1, SU STA2, MU STA(1~n) => the value will be 2+1=3 */ + u8 sound_remain_cnt_per_period; +}; + +struct _RT_CSI_INFO{ + u8 Nc; + u8 Nr; + u8 Ng; + u8 CodeBook; + u8 ChnlWidth; + u8 bVHT; +}; + +struct beamforming_info { + enum beamforming_cap beamforming_cap; + enum _BEAMFORMING_STATE beamforming_state; + struct beamformee_entry bfee_entry[MAX_BEAMFORMEE_ENTRY_NUM]; + struct beamformer_entry bfer_entry[MAX_BEAMFORMER_ENTRY_NUM]; + u8 sounding_sequence; + u8 beamformee_su_cnt; + u8 beamformer_su_cnt; + u32 beamformee_su_reg_maping; + u32 beamformer_su_reg_maping; + /* For MU-MINO */ + u8 beamformee_mu_cnt; + u8 beamformer_mu_cnt; + u32 beamformee_mu_reg_maping; + u8 first_mu_bfee_index; + u8 mu_bfer_curidx; + + struct sounding_info sounding_info; + /* schedule regular timer for sounding */ + _timer sounding_timer; + /* moniter if soudning too long */ + _timer sounding_timeout_timer; + + /* For HW configuration */ + u8 SetHalBFEnterOnDemandCnt; + u8 SetHalBFLeaveOnDemandCnt; + u8 SetHalSoundownOnDemandCnt; + u8 bSetBFHwConfigInProgess; + + /* + * Target CSI report info. + * Keep the first SU CSI report info for 8822B HW bug workaround. + */ + u8 bEnableSUTxBFWorkAround; + struct _RT_CSI_INFO TargetCSIInfo; + /* Only peform sounding to the first SU BFee */ + struct beamformee_entry *TargetSUBFee; + + /* For debug */ + s8 sounding_running; +}; + +enum beamforming_cap rtw_bf_bfee_get_entry_cap_by_macid(void *mlmepriv, u8 mac_id); +struct beamformer_entry *rtw_bf_bfer_get_entry_by_addr(PADAPTER, u8 *ra); +struct beamformee_entry *rtw_bf_bfee_get_entry_by_addr(PADAPTER, u8 *ra); +void rtw_bf_get_ndpa_packet(PADAPTER, union recv_frame *); +u32 rtw_bf_get_report_packet(PADAPTER, union recv_frame *); +u8 rtw_bf_send_vht_gid_mgnt_packet(PADAPTER, u8 *ra, u8 *gid, u8 *position); +void rtw_bf_get_vht_gid_mgnt_packet(PADAPTER, union recv_frame *); +void rtw_bf_init(PADAPTER); +void rtw_bf_cmd_hdl(PADAPTER, u8 type, u8 *pbuf); +u8 rtw_bf_cmd(PADAPTER, s32 type, u8 *pbuf, s32 size, u8 enqueue); +void rtw_bf_update_attrib(PADAPTER, struct pkt_attrib *, struct sta_info *); +void rtw_bf_c2h_handler(PADAPTER, u8 id, u8 *buf, u8 buf_len); +void rtw_bf_update_traffic(PADAPTER); + +/* Compatible with old function name, only for using outside rtw_beamforming.c */ +#define beamforming_get_entry_beam_cap_by_mac_id rtw_bf_bfee_get_entry_cap_by_macid +#define rtw_beamforming_get_ndpa_frame rtw_bf_get_ndpa_packet +#define rtw_beamforming_get_report_frame rtw_bf_get_report_packet +#define rtw_beamforming_get_vht_gid_mgnt_frame rtw_bf_get_vht_gid_mgnt_packet +#define beamforming_wk_hdl rtw_bf_cmd_hdl +#define beamforming_wk_cmd rtw_bf_cmd +#define update_attrib_txbf_info rtw_bf_update_attrib + #else /* !RTW_BEAMFORMING_VERSION_2 */ + +#if (BEAMFORMING_SUPPORT == 0) /*for diver defined beamforming*/ #define BEAMFORMING_ENTRY_NUM 2 #define GET_BEAMFORM_INFO(_pmlmepriv) ((struct beamforming_info *)(&(_pmlmepriv)->beamforming_info)) -#endif /* !RTW_BEAMFORMING_VERSION_2 */ + typedef enum _BEAMFORMING_ENTRY_STATE { BEAMFORMING_ENTRY_STATE_UNINITIALIZE, @@ -62,10 +286,8 @@ typedef enum _BEAMFORMING_CAP { BEAMFORMEE_CAP_HT_EXPLICIT = 0x2, BEAMFORMER_CAP_VHT_SU = 0x4, /* Self has er Cap, because Reg er & peer ee */ BEAMFORMEE_CAP_VHT_SU = 0x8, /* Self has ee Cap, because Reg ee & peer er */ - BEAMFORMER_CAP_VHT_MU = 0x10, /* Self has er Cap, because Reg er & peer ee */ - BEAMFORMEE_CAP_VHT_MU = 0x20, /* Self has ee Cap, because Reg ee & peer er */ - BEAMFORMER_CAP = 0x40, - BEAMFORMEE_CAP = 0x80, + BEAMFORMER_CAP = 0x10, + BEAMFORMEE_CAP = 0x20, } BEAMFORMING_CAP, *PBEAMFORMING_CAP; @@ -82,140 +304,6 @@ typedef enum _SOUNDING_MODE { SOUNDING_FW_HT_TIMER = 0x9, } SOUNDING_MODE, *PSOUNDING_MODE; -#ifdef RTW_BEAMFORMING_VERSION_2 -enum _BEAMFORM_ENTRY_HW_STATE { - BEAMFORM_ENTRY_HW_STATE_NONE, - BEAMFORM_ENTRY_HW_STATE_ADD_INIT, - BEAMFORM_ENTRY_HW_STATE_ADDING, - BEAMFORM_ENTRY_HW_STATE_ADDED, - BEAMFORM_ENTRY_HW_STATE_DELETE_INIT, - BEAMFORM_ENTRY_HW_STATE_DELETING, - BEAMFORM_ENTRY_HW_STATE_MAX -}; - -struct beamformee_entry { - u8 used; /* _TRUE/_FALSE */ - u8 txbf; - u8 sounding; - /* Used to construct AID field of NDPA packet */ - u16 aid; - /* Used to Set Reg42C in IBSS mode */ - u16 mac_id; - /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC */ - u16 p_aid; - u16 g_id; - /* Used to fill Reg6E4 to fill Mac address of CSI report frame */ - u8 mac_addr[ETH_ALEN]; - /* Sounding BandWidth */ - CHANNEL_WIDTH sound_bw; - u16 sound_period; - - BEAMFORMING_CAP cap; - enum _BEAMFORM_ENTRY_HW_STATE state; - - /* The BFee need to be sounded when count to zero */ - u8 SoundCnt; - u8 bCandidateSoundingPeer; - u8 bSoundingTimeout; - u8 bDeleteSounding; - - u16 LogStatusFailCnt:5; /* 0~21 */ - u16 DefaultCSICnt:5; /* 0~21 */ - u8 CSIMatrix[327]; - u16 CSIMatrixLen; - - u8 NumofSoundingDim; - u8 CompSteeringNumofBFer; - - u8 su_reg_index; - - /* MU-MIMO */ - u8 mu_reg_index; - u8 gid_valid[8]; - u8 user_position[16]; -}; - -struct beamformer_entry { - u8 used; - /* p_aid of BFer entry is probably not used */ - /* Used to fill Reg42C & Reg714 to compare with p_aid of Tx DESC */ - u16 p_aid; - u16 g_id; - u8 mac_addr[ETH_ALEN]; - - BEAMFORMING_CAP cap; - enum _BEAMFORM_ENTRY_HW_STATE state; - - u8 NumofSoundingDim; - u8 su_reg_index; - - /* MU-MIMO */ - u8 gid_valid[8]; - u8 user_position[16]; - u16 aid; -}; - -/* The sounding state is recorded by BFer. */ -enum _SOUNDING_STATE { - SOUNDING_STATE_NONE = 0, - SOUNDING_STATE_INIT = 1, - SOUNDING_STATE_SU_START = 2, - SOUNDING_STATE_SU_SOUNDDOWN = 3, - SOUNDING_STATE_MU_START = 4, - SOUNDING_STATE_MU_SOUNDDOWN = 5, - SOUNDING_STATE_SOUNDING_TIMEOUT = 6, - SOUNDING_STATE_MAX -}; - -struct sounding_info { - u8 su_sounding_list[MAX_NUM_BEAMFORMEE_SU]; - u8 mu_sounding_list[MAX_NUM_BEAMFORMEE_MU]; - - enum _SOUNDING_STATE state; - u8 su_bfee_curidx; - u8 candidate_mu_bfee_cnt; - - /* For sounding schedule maintenance */ - u16 min_sounding_period; - /* Get from sounding list */ - /* Ex: SU STA1, SU STA2, MU STA(1~n) => the value will be 2+1=3 */ - u8 sound_remain_cnt_per_period; - /* Real number of SU sound per period */ - u8 su_sound_num_per_period; - /* Real number of MU sound per period */ - u8 mu_sound_num_per_period; -}; - -struct beamforming_info { - BEAMFORMING_CAP beamforming_cap; - BEAMFORMING_STATE beamforming_state; - struct beamformee_entry bfee_entry[MAX_BEAMFORMEE_ENTRY_NUM]; - struct beamformer_entry bfer_entry[MAX_BEAMFORMER_ENTRY_NUM]; - u8 sounding_sequence; - u8 beamformee_su_cnt; - u8 beamformer_su_cnt; - u32 beamformee_su_reg_maping; - u32 beamformer_su_reg_maping; - /* For MU-MINO */ - u8 beamformee_mu_cnt; - u8 beamformer_mu_cnt; - u32 beamformee_mu_reg_maping; - u8 first_mu_bfee_index; - u8 mu_bfer_curidx; - - struct sounding_info sounding_info; - - /* For HW configuration */ - u8 SetHalBFEnterOnDemandCnt; - u8 SetHalBFLeaveOnDemandCnt; - u8 SetHalSoundownOnDemandCnt; -}; - -struct beamformee_entry *beamforming_get_bfee_entry_by_addr(PADAPTER, u8 *ra); -struct beamformer_entry *beamforming_get_bfer_entry_by_addr(PADAPTER, u8 *ra); -u8 beamforming_send_vht_gid_mgnt_packet(PADAPTER, struct beamformee_entry*); - -#else /* !RTW_BEAMFORMING_VERSION_2 */ struct beamforming_entry { BOOLEAN bUsed; BOOLEAN bSound; @@ -224,7 +312,7 @@ struct beamforming_entry { u16 p_aid; /* Used to fill Reg42C & Reg714 to compare with P_AID of Tx DESC. */ u16 g_id; u8 mac_addr[6];/* Used to fill Reg6E4 to fill Mac address of CSI report frame. */ - CHANNEL_WIDTH sound_bw; /* Sounding BandWidth */ + enum channel_width sound_bw; /* Sounding BandWidth */ u16 sound_period; BEAMFORMING_CAP beamforming_entry_cap; BEAMFORMING_ENTRY_STATE beamforming_entry_state; @@ -242,7 +330,7 @@ struct beamforming_entry { struct sounding_info { u8 sound_idx; - CHANNEL_WIDTH sound_bw; + enum channel_width sound_bw; SOUNDING_MODE sound_mode; u16 sound_period; }; @@ -263,14 +351,12 @@ struct rtw_ndpa_sta_info { u16 nc_index:3; }; +BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(PVOID pmlmepriv , u8 mac_id); void beamforming_notify(PADAPTER adapter); BEAMFORMING_CAP beamforming_get_beamform_cap(struct beamforming_info *pBeamInfo); -#endif /* !RTW_BEAMFORMING_VERSION_2 */ -BEAMFORMING_CAP beamforming_get_entry_beam_cap_by_mac_id(void *mlmepriv, u8 mac_id); - -BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, CHANNEL_WIDTH bw, u8 qidx); -BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, CHANNEL_WIDTH bw, u8 qidx); +BOOLEAN beamforming_send_ht_ndpa_packet(PADAPTER Adapter, u8 *ra, enum channel_width bw, u8 qidx); +BOOLEAN beamforming_send_vht_ndpa_packet(PADAPTER Adapter, u8 *ra, u16 aid, enum channel_width bw, u8 qidx); void beamforming_check_sounding_success(PADAPTER Adapter, BOOLEAN status); @@ -284,16 +370,16 @@ enum BEAMFORMING_CTRL_TYPE { BEAMFORMING_CTRL_END_PERIOD = 3, BEAMFORMING_CTRL_SOUNDING_FAIL = 4, BEAMFORMING_CTRL_SOUNDING_CLK = 5, - BEAMFORMING_CTRL_SET_GID_TABLE = 6, }; -u32 beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame); -void beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame); -u32 beamforming_get_vht_gid_mgnt_frame(PADAPTER, union recv_frame *); +u32 rtw_beamforming_get_report_frame(PADAPTER Adapter, union recv_frame *precv_frame); +void rtw_beamforming_get_ndpa_frame(PADAPTER Adapter, union recv_frame *precv_frame); void beamforming_wk_hdl(_adapter *padapter, u8 type, u8 *pbuf); u8 beamforming_wk_cmd(_adapter *padapter, s32 type, u8 *pbuf, s32 size, u8 enqueue); void update_attrib_txbf_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); +#endif /* !RTW_BEAMFORMING_VERSION_2 */ + #endif /*#ifdef CONFIG_BEAMFORMING */ #endif /*__RTW_BEAMFORMING_H_*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_br_ext.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_br_ext.h index 1df8dc66f6f3..54ba75ea1df5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_br_ext.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_br_ext.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_BR_EXT_H_ #define _RTW_BR_EXT_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_bt_mp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_bt_mp.h index cd6ed0aa14e6..a152d18e9765 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_bt_mp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_bt_mp.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_BT_MP_H #define __RTW_BT_MP_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex.h index d6f640d78a38..fd422489acde 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,9 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ +#ifdef CONFIG_BT_COEXIST + #ifndef __RTW_BTCOEX_H__ #define __RTW_BTCOEX_H__ @@ -369,6 +366,8 @@ struct bt_coex_info { void rtw_btcoex_Initialize(PADAPTER); void rtw_btcoex_PowerOnSetting(PADAPTER padapter); +void rtw_btcoex_AntInfoSetting(PADAPTER padapter); +void rtw_btcoex_PowerOffSetting(PADAPTER padapter); void rtw_btcoex_PreLoadFirmware(PADAPTER padapter); void rtw_btcoex_HAL_Initialize(PADAPTER padapter, u8 bWifiOnly); void rtw_btcoex_IpsNotify(PADAPTER, u8 type); @@ -383,6 +382,8 @@ void rtw_btcoex_BtMpRptNotify(PADAPTER, u8 length, u8 *tmpBuf); void rtw_btcoex_SuspendNotify(PADAPTER, u8 state); void rtw_btcoex_HaltNotify(PADAPTER); void rtw_btcoex_switchband_notify(u8 under_scan, u8 band_type); +void rtw_btcoex_WlFwDbgInfoNotify(PADAPTER padapter, u8* tmpBuf, u8 length); +void rtw_btcoex_rx_rate_change_notify(PADAPTER padapter, u8 is_data_frame, u8 rate_id); void rtw_btcoex_SwitchBtTRxMask(PADAPTER); void rtw_btcoex_Switch(PADAPTER, u8 enable); u8 rtw_btcoex_IsBtDisabled(PADAPTER); @@ -403,7 +404,13 @@ void rtw_btcoex_SetDBG(PADAPTER, u32 *pDbgModule); u32 rtw_btcoex_GetDBG(PADAPTER, u8 *pStrBuf, u32 bufSize); u8 rtw_btcoex_IncreaseScanDeviceNum(PADAPTER); u8 rtw_btcoex_IsBtLinkExist(PADAPTER); -void rtw_btcoex_BTOffOnNotify(PADAPTER padapter, u8 bBTON); +void rtw_btcoex_pta_off_on_notify(PADAPTER padapter, u8 bBTON); + +#ifdef CONFIG_RF4CE_COEXIST +void rtw_btcoex_SetRf4ceLinkState(PADAPTER padapter, u8 state); +u8 rtw_btcoex_GetRf4ceLinkState(PADAPTER padapter); +#endif + #ifdef CONFIG_BT_COEXIST_SOCKET_TRX void rtw_btcoex_SetBtPatchVersion(PADAPTER padapter, u16 btHciVer, u16 btPatchVer); void rtw_btcoex_SetHciVersion(PADAPTER padapter, u16 hciVersion); @@ -426,7 +433,6 @@ void rtw_btcoex_SendScanNotify(PADAPTER padapter, u8 scanType); #endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ u16 rtw_btcoex_btreg_read(PADAPTER padapter, u8 type, u16 addr, u32 *data); u16 rtw_btcoex_btreg_write(PADAPTER padapter, u8 type, u16 addr, u16 val); -u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter); u8 rtw_btcoex_get_bt_coexist(PADAPTER padapter); u8 rtw_btcoex_get_chip_type(PADAPTER padapter); u8 rtw_btcoex_get_pg_ant_num(PADAPTER padapter); @@ -438,8 +444,12 @@ u8 rtw_btcoex_get_ant_div_cfg(PADAPTER padapter); /* ================================================== * Below Functions are called by BT-Coex * ================================================== */ -void rtw_btcoex_rx_ampdu_apply(PADAPTER); -void rtw_btcoex_LPS_Enter(PADAPTER); -void rtw_btcoex_LPS_Leave(PADAPTER); +void rtw_btcoex_rx_ampdu_apply(PADAPTER padapter); +void rtw_btcoex_LPS_Enter(PADAPTER padapter); +u8 rtw_btcoex_LPS_Leave(PADAPTER padapter); #endif /* __RTW_BTCOEX_H__ */ +#endif /* CONFIG_BT_COEXIST */ + +void rtw_btcoex_set_ant_info(PADAPTER padapter); + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex_wifionly.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex_wifionly.h new file mode 100644 index 000000000000..c5a074092c5c --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_btcoex_wifionly.h @@ -0,0 +1,23 @@ +/****************************************************************************** + * + * Copyright(c) 2013 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ +#ifndef __RTW_BTCOEX_WIFIONLY_H__ +#define __RTW_BTCOEX_WIFIONLY_H__ + +void rtw_btcoex_wifionly_switchband_notify(PADAPTER padapter); +void rtw_btcoex_wifionly_scan_notify(PADAPTER padapter); +void rtw_btcoex_wifionly_hw_config(PADAPTER padapter); +void rtw_btcoex_wifionly_initialize(PADAPTER padapter); +void rtw_btcoex_wifionly_AntInfoSetting(PADAPTER padapter); +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_byteorder.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_byteorder.h index 70482d26bd23..8e6bb7a6df01 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_byteorder.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_byteorder.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTL871X_BYTEORDER_H_ #define _RTL871X_BYTEORDER_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_cmd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_cmd.h index 12015dbabb04..1e5147ada979 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_cmd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_cmd.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_CMD_H_ #define __RTW_CMD_H_ @@ -60,7 +55,8 @@ enum { struct cmd_priv { _sema cmd_queue_sema; /* _sema cmd_done_sema; */ - _sema terminate_cmdthread_sema; + _sema start_cmdthread_sema; + _queue cmd_queue; u8 cmd_seq; u8 *cmd_buf; /* shall be non-paged, and 4 bytes aligned */ @@ -72,7 +68,7 @@ struct cmd_priv { u32 rsp_cnt; ATOMIC_T cmdthd_running; /* u8 cmdthd_running; */ - u8 stop_req; + _adapter *padapter; _mutex sctx_mutex; }; @@ -90,7 +86,7 @@ struct evt_obj { struct evt_priv { #ifdef CONFIG_EVENT_THREAD_MODE _sema evt_notify; - _sema terminate_evtthread_sema; + _queue evt_queue; #endif @@ -209,6 +205,15 @@ u8 p2p_roch_cmd(_adapter *adapter , u8 flags ); u8 p2p_cancel_roch_cmd(_adapter *adapter, u64 cookie, struct wireless_dev *wdev, u8 flags); + +struct mgnt_tx_parm { + u8 tx_ch; + u8 no_cck; + const u8 *buf; + size_t len; + int wait_ack; +}; +u8 rtw_mgnt_tx_cmd(_adapter *adapter, u8 tx_ch, u8 no_cck, const u8 *buf, size_t len, int wait_ack, u8 flags); #endif /* CONFIG_IOCTL_CFG80211 */ #endif /* CONFIG_P2P */ @@ -242,7 +247,12 @@ enum rtw_drvextra_cmd_id { SESSION_TRACKER_WK_CID, EN_HW_UPDATE_TSF_WK_CID, TEST_H2C_CID, + MP_CMD_WK_CID, CUSTOMER_STR_WK_CID, +#ifdef CONFIG_RTW_REPEATER_SON + RSON_SCAN_WK_CID, +#endif + MGNT_TX_WK_CID, MAX_WK_CID }; @@ -371,6 +381,11 @@ struct sitesurvey_parm { u8 ch_num; NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; + + u32 token; /* 80211k use it to identify caller */ + u16 duration; /* 0: use default, otherwise: channel scan time */ + u8 igi; /* 0: use defalut */ + u8 bw; /* 0: use default */ }; /* @@ -533,35 +548,6 @@ struct getdatarate_rsp { u8 datarates[NumRates]; }; - -/* -Caller Mode: Any -AP: AP can use the info for the contents of beacon frame -Infra: STA can use the info when sitesurveying -Ad-HoC(M): Like AP -Ad-HoC(C): Like STA - - -Notes: To set the phy capability of the NIC - -Command Mode - -*/ - -struct setphyinfo_parm { - struct regulatory_class class_sets[NUM_REGULATORYS]; - u8 status; -}; - -struct getphyinfo_parm { - u32 rsvd; -}; - -struct getphyinfo_rsp { - struct regulatory_class class_sets[NUM_REGULATORYS]; - u8 status; -}; - /* Caller Mode: Any @@ -1012,11 +998,12 @@ struct RunInThread_param { #define H2C_RESERVED 0x07 #define H2C_ENQ_HEAD 0x08 #define H2C_ENQ_HEAD_FAIL 0x09 +#define H2C_CMD_FAIL 0x0A extern u8 rtw_setassocsta_cmd(_adapter *padapter, u8 *mac_addr); extern u8 rtw_setstandby_cmd(_adapter *padapter, uint action); -u8 rtw_sitesurvey_cmd(_adapter *padapter, NDIS_802_11_SSID *ssid, int ssid_num, struct rtw_ieee80211_channel *ch, int ch_num); - +void rtw_init_sitesurvey_parm(_adapter *padapter, struct sitesurvey_parm *pparm); +u8 rtw_sitesurvey_cmd(_adapter *padapter, struct sitesurvey_parm *pparm); u8 rtw_create_ibss_cmd(_adapter *adapter, int flags); u8 rtw_startbss_cmd(_adapter *adapter, int flags); u8 rtw_change_bss_chbw_cmd(_adapter *adapter, int flags, s16 req_ch, s8 req_bw, s8 req_offset); @@ -1028,7 +1015,7 @@ extern u8 rtw_setstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 key_ty extern u8 rtw_clearstakey_cmd(_adapter *padapter, struct sta_info *sta, u8 enqueue); extern u8 rtw_joinbss_cmd(_adapter *padapter, struct wlan_network *pnetwork); -u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, bool enqueue); +u8 rtw_disassoc_cmd(_adapter *padapter, u32 deauth_timeout_ms, int flags); extern u8 rtw_setopmode_cmd(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype, bool enqueue); extern u8 rtw_setdatarate_cmd(_adapter *padapter, u8 *rateset); extern u8 rtw_setbasicrate_cmd(_adapter *padapter, u8 *rateset); @@ -1073,16 +1060,9 @@ extern u8 rtw_ps_cmd(_adapter *padapter); u8 rtw_chk_hi_queue_cmd(_adapter *padapter); #ifdef CONFIG_DFS_MASTER u8 rtw_dfs_master_cmd(_adapter *adapter, bool enqueue); -void rtw_dfs_master_timer_hdl(RTW_TIMER_HDL_ARGS); +void rtw_dfs_master_timer_hdl(void *ctx); void rtw_dfs_master_enable(_adapter *adapter, u8 ch, u8 bw, u8 offset); void rtw_dfs_master_disable(_adapter *adapter, u8 ch, u8 bw, u8 offset, bool by_others); -enum { - MLME_STA_CONNECTING, - MLME_STA_CONNECTED, - MLME_STA_DISCONNECTED, - MLME_AP_STARTED, - MLME_AP_STOPPED, -}; void rtw_dfs_master_status_apply(_adapter *adapter, u8 self_action); #endif /* CONFIG_DFS_MASTER */ #endif /* CONFIG_AP_MODE */ @@ -1095,7 +1075,7 @@ u8 rtw_test_h2c_cmd(_adapter *adapter, u8 *buf, u8 len); u8 rtw_enable_hw_update_tsf_cmd(_adapter *padapter); -u8 rtw_set_ch_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 enqueue); +u8 rtw_set_chbw_cmd(_adapter *padapter, u8 ch, u8 bw, u8 ch_offset, u8 flags); u8 rtw_set_chplan_cmd(_adapter *adapter, int flags, u8 chplan, u8 swconfig); u8 rtw_set_country_cmd(_adapter *adapter, int flags, const char *country_code, u8 swconfig); @@ -1104,6 +1084,8 @@ extern u8 rtw_led_blink_cmd(_adapter *padapter, PVOID pLed); extern u8 rtw_set_csa_cmd(_adapter *padapter, u8 new_ch_no); extern u8 rtw_tdls_cmd(_adapter *padapter, u8 *addr, u8 option); +u8 rtw_mp_cmd(_adapter *adapter, u8 mp_cmd_id, u8 flags); + #ifdef CONFIG_RTW_CUSTOMER_STR u8 rtw_customer_str_req_cmd(_adapter *adapter); u8 rtw_customer_str_write_cmd(_adapter *adapter, const u8 *cstr); @@ -1116,6 +1098,12 @@ u8 rtw_c2h_reg_wk_cmd(_adapter *adapter, u8 *c2h_evt); u8 rtw_c2h_packet_wk_cmd(_adapter *adapter, u8 *c2h_evt, u16 length); #endif +#ifdef CONFIG_RTW_REPEATER_SON +#define RSON_SCAN_PROCESS 10 +#define RSON_SCAN_DISABLE 11 +u8 rtw_rson_scan_wk_cmd(_adapter *adapter, int op); +#endif + u8 rtw_run_in_thread_cmd(PADAPTER padapter, void (*func)(void *), void *context); u8 session_tracker_chk_cmd(_adapter *adapter, struct sta_info *sta); @@ -1218,6 +1206,7 @@ enum rtw_h2c_cmd { GEN_CMD_CODE(_RunInThreadCMD), /*64*/ GEN_CMD_CODE(_AddBARsp) , /*65*/ + GEN_CMD_CODE(_RM_POST_EVENT), /*66*/ MAX_H2CCMD }; @@ -1305,6 +1294,7 @@ struct _cmd_callback rtw_cmd_callback[] = { {GEN_CMD_CODE(_RunInThreadCMD), NULL},/*64*/ {GEN_CMD_CODE(_AddBARsp), NULL}, /*65*/ + {GEN_CMD_CODE(_RM_POST_EVENT), NULL}, /*66*/ }; #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_debug.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_debug.h index b23fdfb65d08..42c3c864824e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_debug.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_debug.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_DEBUG_H__ #define __RTW_DEBUG_H__ @@ -68,8 +63,6 @@ extern void rtl871x_cedbg(const char *fmt, ...); #define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) #define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) #define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) -#define _RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) -#define _RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) do {} while (0) #define RTW_DBG_EXPR(EXPR) do {} while (0) @@ -84,18 +77,29 @@ extern void rtl871x_cedbg(const char *fmt, ...); #if defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_XP) #define _dbgdump DbgPrint + #define KERN_CONT #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) #elif defined(PLATFORM_WINDOWS) && defined(PLATFORM_OS_CE) #define _dbgdump rtl871x_cedbg + #define KERN_CONT #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) #elif defined PLATFORM_LINUX #define _dbgdump printk + #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) + #define KERN_CONT + #endif #define _seqdump seq_printf #elif defined PLATFORM_FREEBSD #define _dbgdump printf + #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 24)) + #define KERN_CONT + #endif #define _seqdump(sel, fmt, arg...) _dbgdump(fmt, ##arg) #endif +void RTW_BUF_DUMP_SEL(uint _loglevel, void *sel, u8 *_titlestring, + bool _idx_show, const u8 *_hexdata, int _hexdatalen); + #ifdef CONFIG_RTW_DEBUG #ifndef _OS_INTFS_C_ @@ -147,65 +151,25 @@ extern uint rtw_drv_log_level; } \ } while (0) - #undef RTW_INFO_DUMP -#define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ - do {\ - if (_DRV_INFO_ <= rtw_drv_log_level) { \ - int __i; \ - u8 *ptr = (u8 *)_HexData; \ - _dbgdump("%s", DRIVER_PREFIX); \ - _dbgdump(_TitleString); \ - for (__i = 0; __i < (int)_HexDataLen; __i++) { \ - _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ - if (((__i + 1) % 16) == 0) \ - _dbgdump("\n"); \ - } \ - _dbgdump("\n"); \ - } \ - } while (0) +#define RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ + RTW_BUF_DUMP_SEL(_DRV_INFO_, RTW_DBGDUMP, _TitleString, _FALSE, _HexData, _HexDataLen) #undef RTW_DBG_DUMP -#define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ - do {\ - if (_DRV_DEBUG_ <= rtw_drv_log_level) { \ - int __i; \ - u8 *ptr = (u8 *)_HexData; \ - _dbgdump("%s", DRIVER_PREFIX); \ - _dbgdump(_TitleString); \ - for (__i = 0; __i < (int)_HexDataLen; __i++) { \ - _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ - if (((__i + 1) % 16) == 0) \ - _dbgdump("\n"); \ - } \ - _dbgdump("\n"); \ - } \ - } while (0) +#define RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ + RTW_BUF_DUMP_SEL(_DRV_DEBUG_, RTW_DBGDUMP, _TitleString, _FALSE, _HexData, _HexDataLen) #undef RTW_PRINT_DUMP -#define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) \ - do {\ - if (_DRV_ALWAYS_ <= rtw_drv_log_level) { \ - int __i; \ - u8 *ptr = (u8 *)_HexData; \ - _dbgdump("%s", DRIVER_PREFIX); \ - _dbgdump(_TitleString); \ - for (__i = 0; __i < (int)_HexDataLen; __i++) { \ - _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ - if (((__i + 1) % 16) == 0) \ - _dbgdump("\n"); \ - } \ - _dbgdump("\n"); \ - } \ - } while (0) +#define RTW_PRINT_DUMP(_TitleString, _HexData, _HexDataLen) \ + RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, RTW_DBGDUMP, _TitleString, _FALSE, _HexData, _HexDataLen) /* without driver-defined prefix */ #undef _RTW_PRINT #define _RTW_PRINT(fmt, arg...) \ do {\ if (_DRV_ALWAYS_ <= rtw_drv_log_level) {\ - _dbgdump(fmt, ##arg);\ + _dbgdump(KERN_CONT fmt, ##arg);\ } \ } while (0) @@ -213,7 +177,7 @@ extern uint rtw_drv_log_level; #define _RTW_ERR(fmt, arg...) \ do {\ if (_DRV_ERR_ <= rtw_drv_log_level) {\ - _dbgdump(fmt, ##arg);\ + _dbgdump(KERN_CONT fmt, ##arg);\ } \ } while (0) @@ -222,7 +186,7 @@ extern uint rtw_drv_log_level; #define _RTW_WARN(fmt, arg...) \ do {\ if (_DRV_WARNING_ <= rtw_drv_log_level) {\ - _dbgdump(fmt, ##arg);\ + _dbgdump(KERN_CONT fmt, ##arg);\ } \ } while (0) @@ -230,7 +194,7 @@ extern uint rtw_drv_log_level; #define _RTW_INFO(fmt, arg...) \ do {\ if (_DRV_INFO_ <= rtw_drv_log_level) {\ - _dbgdump(fmt, ##arg);\ + _dbgdump(KERN_CONT fmt, ##arg);\ } \ } while (0) @@ -238,39 +202,11 @@ extern uint rtw_drv_log_level; #define _RTW_DBG(fmt, arg...) \ do {\ if (_DRV_DEBUG_ <= rtw_drv_log_level) {\ - _dbgdump(fmt, ##arg);\ + _dbgdump(KERN_CONT fmt, ##arg);\ } \ } while (0) -#undef _RTW_INFO_DUMP -#define _RTW_INFO_DUMP(_TitleString, _HexData, _HexDataLen) \ - if (_DRV_INFO_ <= rtw_drv_log_level) { \ - int __i; \ - u8 *ptr = (u8 *)_HexData; \ - _dbgdump(_TitleString); \ - for (__i = 0; __i<(int)_HexDataLen; __i++) \ - { \ - _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ - if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ - } \ - _dbgdump("\n"); \ - } - -#undef _RTW_DBG_DUMP -#define _RTW_DBG_DUMP(_TitleString, _HexData, _HexDataLen) \ - if (_DRV_DEBUG_ <= rtw_drv_log_level) { \ - int __i; \ - u8 *ptr = (u8 *)_HexData; \ - _dbgdump(_TitleString); \ - for (__i = 0; __i<(int)_HexDataLen; __i++) \ - { \ - _dbgdump("%02X%s", ptr[__i], (((__i + 1) % 4) == 0) ? " " : " "); \ - if (((__i + 1) % 16) == 0) _dbgdump("\n"); \ - } \ - _dbgdump("\n"); \ - } - /* other debug APIs */ #undef RTW_DBG_EXPR #define RTW_DBG_EXPR(EXPR) do { if (_DRV_DEBUG_ <= rtw_drv_log_level) EXPR; } while (0) @@ -302,6 +238,13 @@ extern uint rtw_drv_log_level; } \ } while (0) +/* dump message to selected 'stream' */ +#undef RTW_DUMP_SEL +#define RTW_DUMP_SEL(sel, _HexData, _HexDataLen) \ + RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, sel, NULL, _FALSE, _HexData, _HexDataLen) + +#define RTW_MAP_DUMP_SEL(sel, _TitleString, _HexData, _HexDataLen) \ + RTW_BUF_DUMP_SEL(_DRV_ALWAYS_, sel, _TitleString, _TRUE, _HexData, _HexDataLen) #endif /* defined(_seqdump) */ @@ -322,14 +265,10 @@ void sdio_local_reg_dump(void *sel, _adapter *adapter); void mac_reg_dump(void *sel, _adapter *adapter); void bb_reg_dump(void *sel, _adapter *adapter); +void bb_reg_dump_ex(void *sel, _adapter *adapter); void rf_reg_dump(void *sel, _adapter *adapter); -bool rtw_fwdl_test_trigger_chksum_fail(void); -bool rtw_fwdl_test_trigger_wintint_rdy_fail(void); -bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void); - -u32 rtw_get_wait_hiq_empty_ms(void); -void rtw_sink_rtp_seq_dbg(_adapter *adapter, _pkt *pkt); +void rtw_sink_rtp_seq_dbg(_adapter *adapter, u8 *ehdr_pos); struct sta_info; void sta_rx_reorder_ctl_dump(void *sel, struct sta_info *sta); @@ -375,11 +314,17 @@ ssize_t proc_set_backop_flags_sta(struct file *file, const char __user *buffer, int proc_get_backop_flags_ap(struct seq_file *m, void *v); ssize_t proc_set_backop_flags_ap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); #endif /* CONFIG_SCAN_BACKOP */ +#ifdef CONFIG_RTW_REPEATER_SON +int proc_get_rson_data(struct seq_file *m, void *v); +ssize_t proc_set_rson_data(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif int proc_get_survey_info(struct seq_file *m, void *v); ssize_t proc_set_survey_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); int proc_get_ap_info(struct seq_file *m, void *v); ssize_t proc_reset_trx_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); int proc_get_trx_info(struct seq_file *m, void *v); +ssize_t proc_set_tx_power_offset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_tx_power_offset(struct seq_file *m, void *v); int proc_get_rate_ctl(struct seq_file *m, void *v); int proc_get_wifi_spec(struct seq_file *m, void *v); ssize_t proc_set_rate_ctl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); @@ -389,19 +334,36 @@ ssize_t proc_set_bw_ctl(struct file *file, const char __user *buffer, size_t cou int proc_get_rx_cnt_dump(struct seq_file *m, void *v); ssize_t proc_set_rx_cnt_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); #endif + +#ifdef CONFIG_AP_MODE +int proc_get_bmc_tx_rate(struct seq_file *m, void *v); +ssize_t proc_set_bmc_tx_rate(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif /*CONFIG_AP_MODE*/ + int proc_get_dis_pwt(struct seq_file *m, void *v); ssize_t proc_set_dis_pwt(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -int proc_get_suspend_resume_info(struct seq_file *m, void *v); +int proc_get_ps_dbg_info(struct seq_file *m, void *v); +ssize_t proc_set_ps_dbg_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +bool rtw_fwdl_test_trigger_chksum_fail(void); +bool rtw_fwdl_test_trigger_wintint_rdy_fail(void); ssize_t proc_set_fwdl_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +bool rtw_del_rx_ampdu_test_trigger_no_tx_fail(void); ssize_t proc_set_del_rx_ampdu_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); #ifdef CONFIG_DFS_MASTER int proc_get_dfs_master_test_case(struct seq_file *m, void *v); ssize_t proc_set_dfs_master_test_case(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); #endif /* CONFIG_DFS_MASTER */ +u32 rtw_get_wait_hiq_empty_ms(void); ssize_t proc_set_wait_hiq_empty(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +void rtw_sta_linking_test_set_start(void); +bool rtw_sta_linking_test_wait_done(void); +bool rtw_sta_linking_test_force_fail(void); +ssize_t proc_set_sta_linking_test(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_rx_stat(struct seq_file *m, void *v); +int proc_get_tx_stat(struct seq_file *m, void *v); #ifdef CONFIG_AP_MODE int proc_get_all_sta_info(struct seq_file *m, void *v); #endif /* CONFIG_AP_MODE */ @@ -432,23 +394,46 @@ ssize_t proc_set_bw_mode(struct file *file, const char __user *buffer, size_t co int proc_get_ampdu_enable(struct seq_file *m, void *v); ssize_t proc_set_ampdu_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_mac_rptbuf(struct seq_file *m, void *v); + +void dump_regsty_rx_ampdu_size_limit(void *sel, _adapter *adapter); int proc_get_rx_ampdu(struct seq_file *m, void *v); ssize_t proc_set_rx_ampdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +void rtw_dump_dft_phy_cap(void *sel, _adapter *adapter); +void rtw_get_dft_phy_cap(void *sel, _adapter *adapter); +void rtw_dump_drv_phy_cap(void *sel, _adapter *adapter); + int proc_get_rx_stbc(struct seq_file *m, void *v); ssize_t proc_set_rx_stbc(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); - +int proc_get_stbc_cap(struct seq_file *m, void *v); +ssize_t proc_set_stbc_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_ldpc_cap(struct seq_file *m, void *v); +ssize_t proc_set_ldpc_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#ifdef CONFIG_BEAMFORMING +int proc_get_txbf_cap(struct seq_file *m, void *v); +ssize_t proc_set_txbf_cap(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif int proc_get_rx_ampdu_factor(struct seq_file *m, void *v); ssize_t proc_set_rx_ampdu_factor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_tx_max_agg_num(struct seq_file *m, void *v); +ssize_t proc_set_tx_max_agg_num(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + int proc_get_rx_ampdu_density(struct seq_file *m, void *v); ssize_t proc_set_rx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); int proc_get_tx_ampdu_density(struct seq_file *m, void *v); ssize_t proc_set_tx_ampdu_density(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + +#ifdef CONFIG_TX_AMSDU +int proc_get_tx_amsdu(struct seq_file *m, void *v); +ssize_t proc_set_tx_amsdu(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_tx_amsdu_rate(struct seq_file *m, void *v); +ssize_t proc_set_tx_amsdu_rate(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif #endif /* CONFIG_80211N_HT */ -int proc_get_mac_rptbuf(struct seq_file *m, void *v); int proc_get_en_fwps(struct seq_file *m, void *v); ssize_t proc_set_en_fwps(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); @@ -462,6 +447,10 @@ ssize_t proc_set_rssi_disp(struct file *file, const char __user *buffer, size_t int proc_get_btcoex_dbg(struct seq_file *m, void *v); ssize_t proc_set_btcoex_dbg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); int proc_get_btcoex_info(struct seq_file *m, void *v); +#ifdef CONFIG_RF4CE_COEXIST +int proc_get_rf4ce_state(struct seq_file *m, void *v); +ssize_t proc_set_rf4ce_state(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif #endif /* CONFIG_BT_COEXIST */ #if defined(DBG_CONFIG_ERROR_DETECT) @@ -469,11 +458,6 @@ int proc_get_sreset(struct seq_file *m, void *v); ssize_t proc_set_sreset(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); #endif /* DBG_CONFIG_ERROR_DETECT */ -int proc_get_odm_dbg_comp(struct seq_file *m, void *v); -ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); -int proc_get_odm_dbg_level(struct seq_file *m, void *v); -ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); - int proc_get_odm_adaptivity(struct seq_file *m, void *v); ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); @@ -486,12 +470,20 @@ int proc_get_int_logs(struct seq_file *m, void *v); #ifdef CONFIG_PCI_HCI int proc_get_rx_ring(struct seq_file *m, void *v); int proc_get_tx_ring(struct seq_file *m, void *v); +int proc_get_pci_aspm(struct seq_file *m, void *v); +#ifdef DBG_TXBD_DESC_DUMP +int proc_get_tx_ring_ext(struct seq_file *m, void *v); +ssize_t proc_set_tx_ring_ext(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif #endif #ifdef CONFIG_WOWLAN int proc_get_pattern_info(struct seq_file *m, void *v); ssize_t proc_set_pattern_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_wakeup_event(struct seq_file *m, void *v); +ssize_t proc_set_wakeup_event(struct file *file, const char __user *buffer, + size_t count, loff_t *pos, void *data); int proc_get_wakeup_reason(struct seq_file *m, void *v); #endif @@ -510,15 +502,25 @@ ssize_t proc_set_new_bcn_max(struct file *file, const char __user *buffer, size_ #ifdef CONFIG_POWER_SAVING int proc_get_ps_info(struct seq_file *m, void *v); +#ifdef CONFIG_WMMPS_STA +int proc_get_wmmps_info(struct seq_file *m, void *v); +ssize_t proc_set_wmmps_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif /* CONFIG_WMMPS_STA */ #endif /* CONFIG_POWER_SAVING */ #ifdef CONFIG_TDLS +int proc_get_tdls_enable(struct seq_file *m, void *v); +ssize_t proc_set_tdls_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); int proc_get_tdls_info(struct seq_file *m, void *v); #endif int proc_get_monitor(struct seq_file *m, void *v); ssize_t proc_set_monitor(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#ifdef DBG_XMIT_BLOCK +int proc_get_xmit_block(struct seq_file *m, void *v); +ssize_t proc_set_xmit_block(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER int proc_get_rtkm_info(struct seq_file *m, void *v); @@ -548,8 +550,22 @@ ssize_t proc_set_mcc_ap_bw80_target_tp(struct file *file, const char __user *buf ssize_t proc_set_mcc_sta_bw20_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ssize_t proc_set_mcc_sta_bw40_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); ssize_t proc_set_mcc_sta_bw80_target_tp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_mcc_policy_table(struct seq_file *m, void *v); +ssize_t proc_set_mcc_policy_table(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); #endif /* CONFIG_MCC_MODE */ +int proc_get_ack_timeout(struct seq_file *m, void *v); +ssize_t proc_set_ack_timeout(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + +int proc_get_iqk_fw_offload(struct seq_file *m, void *v); +ssize_t proc_set_iqk_fw_offload(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); + +#ifdef CONFIG_DBG_RF_CAL +int proc_get_iqk_info(struct seq_file *m, void *v); +ssize_t proc_set_iqk(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +int proc_get_lck_info(struct seq_file *m, void *v); +ssize_t proc_set_lck(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data); +#endif /*CONFIG_DBG_RF_CAL*/ #define _drv_always_ 1 #define _drv_emerg_ 2 diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_eeprom.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_eeprom.h index 9d9103ffca7c..62304d577f38 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_eeprom.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_eeprom.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_EEPROM_H__ #define __RTW_EEPROM_H__ @@ -73,13 +68,13 @@ typedef enum _RT_CUSTOMER_ID { RT_CID_819x_ALPHA = 16, RT_CID_819x_Sitecom = 17, RT_CID_CCX = 18, /* It's set under CCX logo test and isn't demanded for CCX functions, but for test behavior like retry limit and tx report. By Bruce, 2009-02-17. */ - RT_CID_819x_Lenovo = 19, + RT_CID_819X_LENOVO = 19, RT_CID_819x_QMI = 20, RT_CID_819x_Edimax_Belkin = 21, RT_CID_819x_Sercomm_Belkin = 22, RT_CID_819x_CAMEO1 = 23, RT_CID_819x_MSI = 24, - RT_CID_819x_Acer = 25, + RT_CID_819X_ACER = 25, RT_CID_819x_AzWave_ASUS = 26, RT_CID_819x_AzWave = 27, /* For AzWave in PCIe, The ID is AzWave use and not only Asus */ RT_CID_819x_HP = 28, diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_efuse.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_efuse.h index 09025f23ed06..2e7334287f9a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_efuse.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_efuse.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_EFUSE_H__ #define __RTW_EFUSE_H__ @@ -52,6 +47,8 @@ enum _EFUSE_DEF_TYPE { #define EFUSE_MAX_HW_SIZE 1024 #define EFUSE_MAX_SECTION_BASE 16 +#define EFUSE_MAX_SECTION_NUM 128 +#define EFUSE_MAX_BANK_SIZE 512 /*RTL8822B 8821C BT EFUSE Define 1 BANK 128 size logical map 1024*/ #ifdef RTW_HALMAC @@ -178,8 +175,22 @@ extern u8 fakeBTEfuseContent[EFUSE_MAX_BT_BANK][EFUSE_MAX_HW_SIZE]; extern u8 fakeBTEfuseInitMap[]; extern u8 fakeBTEfuseModifiedMap[]; /*------------------------Export global variable----------------------------*/ +#define MAX_SEGMENT_SIZE 200 +#define MAX_SEGMENT_NUM 200 +#define MAX_BUF_SIZE (MAX_SEGMENT_SIZE*MAX_SEGMENT_NUM) +#define TMP_BUF_SIZE 100 + +static u8 dcmd_Return_Buffer[MAX_BUF_SIZE] = {0}; +static u32 dcmd_Buf_Idx = 0; +static u32 dcmd_Finifh_Flag = 0; + +static char dcmd_Buf[TMP_BUF_SIZE]; + +#define rtprintf dcmd_Store_Return_Buf + u8 efuse_bt_GetCurrentSize(PADAPTER padapter, u16 *size); u16 efuse_bt_GetMaxSize(PADAPTER padapter); +u16 efuse_GetavailableSize(PADAPTER adapter); u8 efuse_GetCurrentSize(PADAPTER padapter, u16 *size); u16 efuse_GetMaxSize(PADAPTER padapter); @@ -197,6 +208,8 @@ u8 Efuse_CalculateWordCnts(u8 word_en); void ReadEFuseByte(PADAPTER Adapter, u16 _offset, u8 *pbuf, BOOLEAN bPseudoTest) ; void EFUSE_GetEfuseDefinition(PADAPTER pAdapter, u8 efuseType, u8 type, void *pOut, BOOLEAN bPseudoTest); u8 efuse_OneByteRead(PADAPTER pAdapter, u16 addr, u8 *data, BOOLEAN bPseudoTest); +#define efuse_onebyte_read(adapter, addr, data, pseudo_test) efuse_OneByteRead((adapter), (addr), (data), (pseudo_test)) + u8 efuse_OneByteWrite(PADAPTER pAdapter, u16 addr, u8 data, BOOLEAN bPseudoTest); void BTEfuse_PowerSwitch(PADAPTER pAdapter, u8 bWrite, u8 PwrState); @@ -207,6 +220,7 @@ void efuse_WordEnableDataRead(u8 word_en, u8 *sourdata, u8 *targetdata); u8 Efuse_WordEnableDataWrite(PADAPTER pAdapter, u16 efuse_addr, u8 word_en, u8 *data, BOOLEAN bPseudoTest); void EFUSE_ShadowMapUpdate(PADAPTER pAdapter, u8 efuseType, BOOLEAN bPseudoTest); void EFUSE_ShadowRead(PADAPTER pAdapter, u8 Type, u16 Offset, u32 *Value); +#define efuse_logical_map_read(adapter, type, offset, value) EFUSE_ShadowRead((adapter), (type), (offset), (value)) VOID hal_ReadEFuse_BT_logic_map( PADAPTER padapter, @@ -222,6 +236,7 @@ u8 EfusePgPacketWrite_BT( u8 bPseudoTest); u16 rtw_get_efuse_mask_arraylen(PADAPTER pAdapter); void rtw_efuse_mask_array(PADAPTER pAdapter, u8 *pArray); +void rtw_efuse_analyze(PADAPTER padapter, u8 Type, u8 Fake); #define MAC_HIDDEN_MAX_BW_NUM 8 extern const u8 _mac_hidden_max_bw_to_hal_bw_cap[]; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_event.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_event.h index 4516e5c81579..8e4d5d6f5c5c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_event.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_event.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_EVENT_H_ #define _RTW_EVENT_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ht.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ht.h index 8ae15edc59fa..e6a22ab63da2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ht.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ht.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_HT_H_ #define _RTW_HT_H_ @@ -89,12 +84,6 @@ typedef enum _RT_HT_INF1_CAP { #define STBC_HT_TEST_TX_ENABLE BIT2 #define STBC_HT_CAP_TX BIT3 -#define BEAMFORMING_HT_BEAMFORMER_ENABLE BIT0 /* Declare our NIC supports beamformer */ -#define BEAMFORMING_HT_BEAMFORMEE_ENABLE BIT1 /* Declare our NIC supports beamformee */ -#define BEAMFORMING_HT_BEAMFORMER_TEST BIT2 /* Transmiting Beamforming no matter the target supports it or not */ -#define BEAMFORMING_HT_BEAMFORMER_STEER_NUM (BIT4 | BIT5) -#define BEAMFORMING_HT_BEAMFORMEE_CHNL_EST_CAP (BIT6 | BIT7) - /* ------------------------------------------------------------ * The HT Control field * ------------------------------------------------------------ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_io.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_io.h index 44a17491af5d..28430d8b7fa1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_io.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_io.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_IO_H_ #define _RTW_IO_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl.h index b981bf076a8f..4924751c2456 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_IOCTL_H_ #define _RTW_IOCTL_H_ @@ -314,4 +309,11 @@ extern NDIS_STATUS drv_set_info( OUT u32 *BytesNeeded ); +#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE +extern int rtw_vendor_ie_get_raw_data(struct net_device *, u32, char *, u32); +extern int rtw_vendor_ie_get_data(struct net_device*, int , char*); +extern int rtw_vendor_ie_get(struct net_device *, struct iw_request_info *, union iwreq_data *, char *); +extern int rtw_vendor_ie_set(struct net_device*, struct iw_request_info*, union iwreq_data*, char*); +#endif + #endif /* #ifndef __INC_CEINFO_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_query.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_query.h index a74d13de2547..cc7b557ee346 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_query.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_query.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_IOCTL_QUERY_H_ #define _RTW_IOCTL_QUERY_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_rtl.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_rtl.h index ddf798f18574..2df8713ad500 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_rtl.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_rtl.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_IOCTL_RTL_H_ #define _RTW_IOCTL_RTL_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_set.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_set.h index 1f87214ca738..5d811f79aecd 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_set.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_ioctl_set.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_IOCTL_SET_H_ #define __RTW_IOCTL_SET_H_ @@ -56,7 +51,7 @@ u8 rtw_set_802_11_authentication_mode(_adapter *pdapter, NDIS_802_11_AUTHENTICAT u8 rtw_set_802_11_bssid(_adapter *padapter, u8 *bssid); u8 rtw_set_802_11_add_wep(_adapter *padapter, NDIS_802_11_WEP *wep); u8 rtw_set_802_11_disassociate(_adapter *padapter); -u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, NDIS_802_11_SSID *pssid, int ssid_max_num, struct rtw_ieee80211_channel *ch, int ch_num); +u8 rtw_set_802_11_bssid_list_scan(_adapter *padapter, struct sitesurvey_parm *pparm); u8 rtw_set_802_11_infrastructure_mode(_adapter *padapter, NDIS_802_11_NETWORK_INFRASTRUCTURE networktype); u8 rtw_set_802_11_remove_wep(_adapter *padapter, u32 keyindex); u8 rtw_set_802_11_ssid(_adapter *padapter, NDIS_802_11_SSID *ssid); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_iol.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_iol.h index b68a525329b4..fa35a59c75c7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_iol.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_iol.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_IOL_H_ #define __RTW_IOL_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mcc.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mcc.h index 177dae38c075..b08054785231 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mcc.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mcc.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - ******************************************************************************/ + *****************************************************************************/ #ifdef CONFIG_MCC_MODE #ifndef _RTW_MCC_H_ @@ -29,7 +25,6 @@ #define MCC_STATUS_DOING_MCC BIT3 -#define MCC_DURATION 35 /* ms */ #define MCC_SWCH_FW_EARLY_TIME 10 /* ms */ #define MCC_EXPIRE_TIME 50 /* ms */ #define MCC_TOLERANCE_TIME 2 /* 2*2 = 4s */ @@ -88,6 +83,7 @@ enum mcc_status_rpt { MCC_RPT_STOPMCC = 2, MCC_RPT_READY = 3, MCC_RPT_SWICH_CHANNEL_NOTIFY = 7, + MCC_RPT_UPDATE_NOA_START_TIME = 8, MCC_RPT_MAX, }; @@ -115,7 +111,7 @@ struct mcc_adapter_priv { /* flow control */ u8 mcc_tx_stop; /* check if tp stop or not */ u8 mcc_tp_limit; /* check if tp limit or not */ - u32 mcc_target_tx_bytes_to_port; /* customer require */ + u32 mcc_target_tx_bytes_to_port; /* customer require */ u32 mcc_tx_bytes_to_port; /* already tx to tx fifo (write port) */ /* data from kernel to check if enqueue data or netif stop queue */ @@ -132,6 +128,12 @@ struct mcc_adapter_priv { /* set macid bitmap to let fw know which macid should be tx pause */ /* all interface share total 16 macid */ u16 mcc_macid_bitmap; + + /* use for NoA start time (unit: mircoseconds) */ + u32 noa_start_time; + + u8 p2p_go_noa_ie[MAX_P2P_IE_LEN]; + u32 p2p_go_noa_ie_len; }; struct mcc_obj_priv { @@ -142,7 +144,8 @@ struct mcc_obj_priv { u8 mcc_tolerance_time; /* used for detect mcc switch channel success */ u8 mcc_loc_rsvd_paga[MAX_MCC_NUM]; /* mcc rsvd page */ u8 mcc_status; /* mcc status stop or start .... */ - u32 mcc_launch_time; /* mcc launch time, used for starting detect mcc switch channel success */ + u8 policy_index; + systime mcc_launch_time; /* mcc launch time, used for starting detect mcc switch channel success */ _mutex mcc_mutex; _lock mcc_lock; PADAPTER iface[MAX_MCC_NUM]; /* by order, use for mcc parameter cmd */ @@ -150,7 +153,7 @@ struct mcc_obj_priv { }; /* backup IQK val */ -void rtw_hal_mcc_backup_IQK_val(PADAPTER padapter); +void rtw_hal_mcc_restore_iqk_val(PADAPTER padapter); /* check mcc status */ u8 rtw_hal_check_mcc_status(PADAPTER padapter, u8 mcc_status); @@ -174,13 +177,13 @@ void rtw_hal_mcc_sw_status_check(PADAPTER padapter); /* change some scan flags under site survey */ u8 rtw_hal_mcc_change_scan_flag(PADAPTER padapter, u8 *ch, u8 *bw, u8 *offset); -/* record data kernel TX to driver to check MCC concurrent TX */ +/* record data kernel TX to driver to check MCC concurrent TX */ void rtw_hal_mcc_calc_tx_bytes_from_kernel(PADAPTER padapter, u32 len); -/* record data to port to let driver do flow ctrl */ +/* record data to port to let driver do flow ctrl */ void rtw_hal_mcc_calc_tx_bytes_to_port(PADAPTER padapter, u32 len); -/* check stop write port or not */ +/* check stop write port or not */ u8 rtw_hal_mcc_stop_tx_bytes_to_port(PADAPTER padapter); u8 rtw_hal_set_mcc_setting_scan_start(PADAPTER padapter); @@ -203,5 +206,11 @@ u8 rtw_hal_mcc_link_status_chk(_adapter *padapter, const char *msg); void rtw_hal_mcc_issue_null_data(_adapter *padapter, u8 chbw_allow, u8 ps_mode); +u8 *rtw_hal_mcc_append_go_p2p_ie(PADAPTER padapter, u8 *pframe, u32 *len); + +void rtw_hal_mcc_update_switch_channel_policy_table(PADAPTER padapter); + +void rtw_hal_dump_mcc_policy_table(void *sel); + #endif /* _RTW_MCC_H_ */ #endif /* CONFIG_MCC_MODE */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mem.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mem.h index ae6049f1025e..229028c35fa7 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mem.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mem.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_MEM_H__ #define __RTW_MEM_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mi.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mi.h index 84bcc8c929bc..76d4e9ea6bf9 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mi.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,29 +11,36 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_MI_H_ #define __RTW_MI_H_ void rtw_mi_update_union_chan_inf(_adapter *adapter, u8 ch, u8 offset , u8 bw); +u8 rtw_mi_stayin_union_ch_chk(_adapter *adapter); +u8 rtw_mi_stayin_union_band_chk(_adapter *adapter); int rtw_mi_get_ch_setting_union(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); int rtw_mi_get_ch_setting_union_no_self(_adapter *adapter, u8 *ch, u8 *bw, u8 *offset); struct mi_state { - u8 sta_num; /*WIFI_FW_STATION_STATE*/ - u8 ld_sta_num; /*WIFI_FW_STATION_STATE |_FW_LINKED*/ - u8 lg_sta_num; /*WIFI_FW_STATION_STATE |_FW_UNDER_LINKING*/ - u8 ap_num; /*WIFI_FW_AP_STATE|_FW_LINKED*/ - u8 ld_ap_num; /*WIFI_FW_AP_STATE|_FW_LINKED && asoc_sta_count > 2*/ - u8 adhoc_num; /* WIFI_FW_ADHOC_STATE */ - u8 ld_adhoc_num; /* WIFI_FW_ADHOC_STATE && asoc_sta_count > 2 */ - u8 uwps_num; /*WIFI_UNDER_WPS*/ - + u8 sta_num; /* WIFI_STATION_STATE */ + u8 ld_sta_num; /* WIFI_STATION_STATE && _FW_LINKED */ + u8 lg_sta_num; /* WIFI_STATION_STATE && _FW_UNDER_LINKING */ +#ifdef CONFIG_TDLS + u8 ld_tdls_num; /* adapter.tdlsinfo.link_established */ +#endif +#ifdef CONFIG_AP_MODE + u8 ap_num; /* WIFI_AP_STATE && _FW_LINKED */ + u8 ld_ap_num; /* WIFI_AP_STATE && _FW_LINKED && asoc_sta_count > 2 */ +#endif + u8 adhoc_num; /* (WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) && _FW_LINKED */ + u8 ld_adhoc_num; /* (WIFI_ADHOC_STATE | WIFI_ADHOC_MASTER_STATE) && _FW_LINKED && asoc_sta_count > 2 */ +#ifdef CONFIG_RTW_MESH + u8 mesh_num; /* WIFI_MESH_STATE && _FW_LINKED */ + u8 ld_mesh_num; /* WIFI_MESH_STATE && _FW_LINKED && asoc_sta_count > 2 */ +#endif + u8 scan_num; /* WIFI_SITE_MONITOR */ + u8 scan_enter_num; /* WIFI_SITE_MONITOR && !SCAN_DISABLE && !SCAN_BACK_OP */ + u8 uwps_num; /* WIFI_UNDER_WPS */ #ifdef CONFIG_IOCTL_CFG80211 #ifdef CONFIG_P2P u8 roch_num; @@ -49,10 +56,34 @@ struct mi_state { #define MSTATE_STA_NUM(_mstate) ((_mstate)->sta_num) #define MSTATE_STA_LD_NUM(_mstate) ((_mstate)->ld_sta_num) #define MSTATE_STA_LG_NUM(_mstate) ((_mstate)->lg_sta_num) + +#ifdef CONFIG_TDLS +#define MSTATE_TDLS_LD_NUM(_mstate) ((_mstate)->ld_tdls_num) +#else +#define MSTATE_TDLS_LD_NUM(_mstate) 0 +#endif + +#ifdef CONFIG_AP_MODE #define MSTATE_AP_NUM(_mstate) ((_mstate)->ap_num) #define MSTATE_AP_LD_NUM(_mstate) ((_mstate)->ld_ap_num) +#else +#define MSTATE_AP_NUM(_mstate) 0 +#define MSTATE_AP_LD_NUM(_mstate) 0 +#endif + #define MSTATE_ADHOC_NUM(_mstate) ((_mstate)->adhoc_num) #define MSTATE_ADHOC_LD_NUM(_mstate) ((_mstate)->ld_adhoc_num) + +#ifdef CONFIG_RTW_MESH +#define MSTATE_MESH_NUM(_mstate) ((_mstate)->mesh_num) +#define MSTATE_MESH_LD_NUM(_mstate) ((_mstate)->ld_mesh_num) +#else +#define MSTATE_MESH_NUM(_mstate) 0 +#define MSTATE_MESH_LD_NUM(_mstate) 0 +#endif + +#define MSTATE_SCAN_NUM(_mstate) ((_mstate)->scan_num) +#define MSTATE_SCAN_ENTER_NUM(_mstate) ((_mstate)->scan_enter_num) #define MSTATE_WPS_NUM(_mstate) ((_mstate)->uwps_num) #if defined(CONFIG_IOCTL_CFG80211) && defined(CONFIG_P2P) @@ -77,23 +108,33 @@ struct mi_state { #define rtw_mi_get_assoced_sta_num(adapter) DEV_STA_LD_NUM(adapter_to_dvobj(adapter)) #define rtw_mi_get_ap_num(adapter) DEV_AP_NUM(adapter_to_dvobj(adapter)) +#define rtw_mi_get_mesh_num(adapter) DEV_MESH_NUM(adapter_to_dvobj(adapter)) /* For now, not return union_ch/bw/offset */ void rtw_mi_status(_adapter *adapter, struct mi_state *mstate); void rtw_mi_status_no_self(_adapter *adapter, struct mi_state *mstate); +void rtw_mi_status_no_others(_adapter *adapter, struct mi_state *mstate); + +/* For now, not handle union_ch/bw/offset */ +void rtw_mi_status_merge(struct mi_state *d, struct mi_state *a); void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state); -u8 rtw_mi_mp_mode_check(_adapter *padapter); - -u8 rtw_mi_netif_stop_queue(_adapter *padapter, bool carrier_off); -u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter, bool carrier_off); +u8 rtw_mi_netif_stop_queue(_adapter *padapter); +u8 rtw_mi_buddy_netif_stop_queue(_adapter *padapter); u8 rtw_mi_netif_wake_queue(_adapter *padapter); u8 rtw_mi_buddy_netif_wake_queue(_adapter *padapter); u8 rtw_mi_netif_carrier_on(_adapter *padapter); u8 rtw_mi_buddy_netif_carrier_on(_adapter *padapter); +u8 rtw_mi_netif_carrier_off(_adapter *padapter); +u8 rtw_mi_buddy_netif_carrier_off(_adapter *padapter); + +u8 rtw_mi_netif_caroff_qstop(_adapter *padapter); +u8 rtw_mi_buddy_netif_caroff_qstop(_adapter *padapter); +u8 rtw_mi_netif_caron_qstart(_adapter *padapter); +u8 rtw_mi_buddy_netif_caron_qstart(_adapter *padapter); void rtw_mi_scan_abort(_adapter *adapter, bool bwait); void rtw_mi_buddy_scan_abort(_adapter *adapter, bool bwait); @@ -127,9 +168,6 @@ void rtw_mi_buddy_set_scan_deny(_adapter *adapter, u32 ms); u8 rtw_mi_is_scan_deny(_adapter *adapter); u8 rtw_mi_buddy_is_scan_deny(_adapter *adapter); -u8 rtw_mi_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -u8 rtw_mi_buddy_issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); - void rtw_mi_beacon_update(_adapter *padapter); void rtw_mi_buddy_beacon_update(_adapter *padapter); @@ -157,6 +195,8 @@ enum { MI_AP_ASSOC, MI_ADHOC, MI_ADHOC_ASSOC, + MI_MESH, + MI_MESH_ASSOC, MI_STA_NOLINK, /* this is misleading, but not used now */ MI_STA_LINKED, MI_STA_LINKING, diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme.h index 6fc7e809d04a..3ad89a000524 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_MLME_H_ #define __RTW_MLME_H_ @@ -29,11 +24,6 @@ /* Commented by Albert 20101105 * Increase the scanning timeout because of increasing the SURVEY_TO value. */ -#define SCANNING_TIMEOUT 8000 -#ifdef CONFIG_SCAN_BACKOP -#define CONC_SCANNING_TIMEOUT_SINGLE_BAND 10000 -#define CONC_SCANNING_TIMEOUT_DUAL_BAND 15000 -#endif #ifdef PALTFORM_OS_WINCE #define SCANQUEUE_LIFETIME 12000000 /* unit:us */ @@ -51,7 +41,7 @@ #define WIFI_ADHOC_MASTER_STATE 0x00000040 #define WIFI_UNDER_LINKING 0x00000080 #define WIFI_UNDER_WPS 0x00000100 -/*#define WIFI_UNDEFINED_STATE 0x00000200*/ +#define WIFI_MESH_STATE 0x00000200 #define WIFI_STA_ALIVE_CHK_STATE 0x00000400 #define WIFI_SITE_MONITOR 0x00000800 /* under site surveying */ #define WIFI_WDS 0x00001000 @@ -89,10 +79,12 @@ void rtw_wfd_st_switch(struct sta_info *sta, bool on); #define MLME_STATE(adapter) get_fwstate(&((adapter)->mlmepriv)) +#define MLME_IS_NULL(adapter) (check_fwstate(&((adapter)->mlmepriv), WIFI_NULL_STATE)) #define MLME_IS_STA(adapter) (MLME_STATE((adapter)) & WIFI_STATION_STATE) #define MLME_IS_AP(adapter) (MLME_STATE((adapter)) & WIFI_AP_STATE) #define MLME_IS_ADHOC(adapter) (MLME_STATE((adapter)) & WIFI_ADHOC_STATE) #define MLME_IS_ADHOC_MASTER(adapter) (MLME_STATE((adapter)) & WIFI_ADHOC_MASTER_STATE) +#define MLME_IS_MESH(adapter) (MLME_STATE((adapter)) & WIFI_MESH_STATE) #define MLME_IS_MONITOR(adapter) (MLME_STATE((adapter)) & WIFI_MONITOR_STATE) #define MLME_IS_MP(adapter) (MLME_STATE((adapter)) & WIFI_MP_STATE) #ifdef CONFIG_P2P @@ -126,6 +118,7 @@ void rtw_wfd_st_switch(struct sta_info *sta, bool on); MLME_IS_AP((adapter)) ? (MLME_IS_GO((adapter)) ? " GO" : " AP") : \ MLME_IS_ADHOC((adapter)) ? " ADHOC" : \ MLME_IS_ADHOC_MASTER((adapter)) ? " ADHOC_M" : \ + MLME_IS_MESH((adapter)) ? " MESH" : \ MLME_IS_MONITOR((adapter)) ? " MONITOR" : \ MLME_IS_MP((adapter)) ? " MP" : "", \ MLME_IS_PD((adapter)) ? " PD" : "", \ @@ -140,6 +133,26 @@ void rtw_wfd_st_switch(struct sta_info *sta, bool on); MLME_IS_MGMT_TX((adapter)) ? " MGMT_TX" : "", \ (MLME_STATE((adapter)) & WIFI_SLEEP_STATE) ? " SLEEP" : "" +enum { + MLME_ACTION_UNKNOWN, + MLME_ACTION_NONE, + MLME_SCAN_ENABLE, /* WIFI_SITE_MONITOR */ + MLME_SCAN_ENTER, /* WIFI_SITE_MONITOR && !SCAN_DISABLE && !SCAN_BACK_OP */ + MLME_SCAN_DONE, /* WIFI_SITE_MONITOR && (SCAN_DISABLE || SCAN_BACK_OP) */ + MLME_SCAN_DISABLE, /* WIFI_SITE_MONITOR is going to be cleared */ + MLME_STA_CONNECTING, + MLME_STA_CONNECTED, + MLME_STA_DISCONNECTED, + MLME_TDLS_LINKED, + MLME_TDLS_NOLINK, + MLME_AP_STARTED, + MLME_AP_STOPPED, + MLME_ADHOC_STARTED, + MLME_ADHOC_STOPPED, + MLME_MESH_STARTED, + MLME_MESH_STOPPED, +}; + #define _FW_UNDER_LINKING WIFI_UNDER_LINKING #define _FW_LINKED WIFI_ASOC_STATE #define _FW_UNDER_SURVEY WIFI_SITE_MONITOR @@ -198,13 +211,6 @@ SHALL not lock up more than one locks at a time! #define traffic_threshold 10 #define traffic_scan_period 500 -struct sitesurvey_ctrl { - u64 last_tx_pkts; - uint last_rx_pkts; - sint traffic_busy; - _timer sitesurvey_ctrl_timer; -}; - typedef struct _RT_LINK_DETECT_T { u32 NumTxOkInPeriod; u32 NumRxOkInPeriod; @@ -316,7 +322,7 @@ struct cfg80211_wifidirect_info { u64 remain_on_ch_cookie; bool is_ro_ch; struct wireless_dev *ro_ch_wdev; - u32 last_ro_ch_time; /* this will be updated at the beginning and end of ro_ch */ + systime last_ro_ch_time; /* this will be updated at the beginning and end of ro_ch */ }; #endif /* CONFIG_IOCTL_CFG80211 */ @@ -386,7 +392,7 @@ struct wifidirect_info { u8 p2p_peer_device_addr[ETH_ALEN]; u8 peer_intent; /* Included the intent value and tie breaker value. */ u8 device_name[WPS_MAX_DEVICE_NAME_LEN]; /* Device name for displaying on searching device screen */ - u8 device_name_len; + u16 device_name_len; u8 profileindex; /* Used to point to the index of profileinfo array */ u8 peer_operating_ch; u8 find_phase_state_exchange_cnt; @@ -486,13 +492,14 @@ struct tdls_info { _lock hdl_lock; u8 watchdog_count; u8 dev_discovered; /* WFD_TDLS: for sigma test */ - u8 tdls_enable; /* Let wpa_supplicant to setup*/ u8 driver_setup; #ifdef CONFIG_WFD struct wifi_display_info *wfd_info; #endif + + struct submit_ctx *tdls_sctx; }; struct tdls_txmgmt { @@ -586,7 +593,6 @@ struct mlme_priv { _lock lock; sint fw_state; /* shall we protect this variable? maybe not necessarily... */ - u8 bScanInProcess; u8 to_join; /* flag */ #ifdef CONFIG_LAYER2_ROAMING u8 to_roam; /* roaming trying times */ @@ -602,9 +608,6 @@ struct mlme_priv { u8 *nic_hdl; -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - u8 not_indic_disco; -#endif _list *pscanned; _queue free_bss_pool; _queue scanned_queue; @@ -640,7 +643,7 @@ struct mlme_priv { uint assoc_by_rssi; _timer scan_to_timer; /* driver itself handles scan_timeout status. */ - u32 scan_start_time; /* used to evaluate the time spent in scanning */ + systime scan_start_time; /* used to evaluate the time spent in scanning */ #ifdef CONFIG_SET_SCAN_DENY_TIMER _timer set_scan_deny_timer; @@ -668,11 +671,11 @@ struct mlme_priv { struct vht_priv vhtpriv; #endif #ifdef CONFIG_BEAMFORMING -#if (BEAMFORMING_SUPPORT == 0)/*for driver beamforming*/ #ifndef RTW_BEAMFORMING_VERSION_2 +#if (BEAMFORMING_SUPPORT == 0)/*for driver beamforming*/ struct beamforming_info beamforming_info; -#endif /* !RTW_BEAMFORMING_VERSION_2 */ #endif +#endif /* !RTW_BEAMFORMING_VERSION_2 */ #endif #ifdef CONFIG_DFS @@ -689,8 +692,6 @@ struct mlme_priv { RT_LINK_DETECT_T LinkDetectInfo; u8 acm_mask; /* for wmm acm mask */ - const struct country_chplan *country_ent; - u8 ChannelPlan; RT_SCAN_TYPE scan_mode; /* active: 1, passive: 0 */ u8 *wps_probe_req_ie; @@ -834,7 +835,7 @@ struct mlme_priv { u8 p2p_reject_disable; /* When starting NL80211 wpa_supplicant/hostapd, it will call netdev_close */ /* such that it will cause p2p disabled. Use this flag to reject. */ #endif /* CONFIG_INTEL_WIDI */ - u32 lastscantime; + systime lastscantime; #ifdef CONFIG_CONCURRENT_MODE u8 scanning_via_buddy_intf; #endif @@ -892,6 +893,7 @@ extern void rtw_surveydone_event_callback(_adapter *adapter, u8 *pbuf); extern void rtw_joinbss_event_callback(_adapter *adapter, u8 *pbuf); extern void rtw_stassoc_event_callback(_adapter *adapter, u8 *pbuf); extern void rtw_stadel_event_callback(_adapter *adapter, u8 *pbuf); +void rtw_sta_mstatus_disc_rpt(_adapter *adapter, u8 mac_id); void rtw_sta_mstatus_report(_adapter *adapter); extern void rtw_atimdone_event_callback(_adapter *adapter, u8 *pbuf); extern void rtw_cpwm_event_callback(_adapter *adapter, u8 *pbuf); @@ -903,8 +905,6 @@ void rtw_sta_timeout_event_callback(_adapter *adapter, u8 *pbuf); void rtw_update_ft_stainfo(_adapter *padapter, WLAN_BSSID_EX *pnetwork); void rtw_ft_reassoc_event_callback(_adapter *padapter, u8 *pbuf); #endif -extern void rtw_join_timeout_handler(RTW_TIMER_HDL_ARGS); -extern void _rtw_scan_timeout_handler(RTW_TIMER_HDL_ARGS); thread_return event_thread(thread_context context); @@ -954,32 +954,17 @@ extern void rtw_mi_update_iface_status(struct mlme_priv *pmlmepriv, sint state); static inline void set_fwstate(struct mlme_priv *pmlmepriv, sint state) { pmlmepriv->fw_state |= state; - - /*bScanInProcess hook in phydm*/ - if (_FW_UNDER_SURVEY == state) - pmlmepriv->bScanInProcess = _TRUE; - rtw_mi_update_iface_status(pmlmepriv, state); } static inline void init_fwstate(struct mlme_priv *pmlmepriv, sint state) { pmlmepriv->fw_state = state; - - /*bScanInProcess hook in phydm*/ - if (_FW_UNDER_SURVEY == state) - pmlmepriv->bScanInProcess = _TRUE; - rtw_mi_update_iface_status(pmlmepriv, state); } static inline void _clr_fwstate_(struct mlme_priv *pmlmepriv, sint state) { pmlmepriv->fw_state &= ~state; - - /*bScanInProcess hook in phydm*/ - if (_FW_UNDER_SURVEY == state) - pmlmepriv->bScanInProcess = _FALSE; - rtw_mi_update_iface_status(pmlmepriv, state); } @@ -1045,6 +1030,10 @@ void rtw_scan_abort_no_wait(_adapter *adapter); void rtw_scan_abort(_adapter *adapter); extern int rtw_restruct_sec_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len); +#ifdef CONFIG_WMMPS_STA +void rtw_uapsd_use_default_setting(_adapter *padapter); +bool rtw_is_wmmps_mode(_adapter *padapter); +#endif /* CONFIG_WMMPS_STA */ extern int rtw_restruct_wmm_ie(_adapter *adapter, u8 *in_ie, u8 *out_ie, uint in_len, uint initial_out_len); extern void rtw_init_registrypriv_dev_network(_adapter *adapter); @@ -1052,22 +1041,20 @@ extern void rtw_update_registrypriv_dev_network(_adapter *adapter); extern void rtw_get_encrypt_decrypt_from_registrypriv(_adapter *adapter); -extern void _rtw_join_timeout_handler(_adapter *adapter); -extern void rtw_scan_timeout_handler(_adapter *adapter); +extern void rtw_join_timeout_handler(void *ctx); +extern void rtw_scan_timeout_handler(void *ctx); -extern void _dynamic_check_timer_handlder(void *FunctionContext); -extern void rtw_dynamic_check_timer_handlder(_adapter *adapter); +extern void rtw_dynamic_check_timer_handlder(void *ctx); extern void rtw_iface_dynamic_check_timer_handlder(_adapter *adapter); #ifdef CONFIG_SET_SCAN_DENY_TIMER bool rtw_is_scan_deny(_adapter *adapter); void rtw_clear_scan_deny(_adapter *adapter); -void rtw_set_scan_deny_timer_hdl(_adapter *adapter); +void rtw_set_scan_deny_timer_hdl(void *ctx); void rtw_set_scan_deny(_adapter *adapter, u32 ms); #else #define rtw_is_scan_deny(adapter) _FALSE #define rtw_clear_scan_deny(adapter) do {} while (0) -#define rtw_set_scan_deny_timer_hdl(adapter) do {} while (0) #define rtw_set_scan_deny(adapter, ms) do {} while (0) #endif @@ -1159,9 +1146,7 @@ int rtw_select_roaming_candidate(struct mlme_priv *pmlmepriv); #define rtw_select_roaming_candidate(mlme) _FAIL #endif /* CONFIG_LAYER2_ROAMING */ -#ifdef CONFIG_80211N_HT bool rtw_adjust_chbw(_adapter *adapter, u8 req_ch, u8 *req_bw, u8 *req_offset); -#endif struct sta_media_status_rpt_cmd_parm { struct sta_info *sta; @@ -1171,6 +1156,7 @@ struct sta_media_status_rpt_cmd_parm { void rtw_sta_media_status_rpt(_adapter *adapter, struct sta_info *sta, bool connected); u8 rtw_sta_media_status_rpt_cmd(_adapter *adapter, struct sta_info *sta, bool connected); void rtw_sta_media_status_rpt_cmd_hdl(_adapter *adapter, struct sta_media_status_rpt_cmd_parm *parm); +void rtw_sta_traffic_info(void *sel, _adapter *adapter); #ifdef CONFIG_INTEL_PROXIM void rtw_proxim_enable(_adapter *padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme_ext.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme_ext.h index 9bc7c32d84dc..50d05de07f73 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme_ext.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mlme_ext.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_MLME_EXT_H_ #define __RTW_MLME_EXT_H_ @@ -26,8 +21,8 @@ * The Realtek 8188CE SoftAP will spend around 100ms to send the probe response after receiving the probe request. * So, this driver tried to extend the dwell time for each scanning channel. * This will increase the chance to receive the probe response from SoftAP. */ - #define SURVEY_TO (100) + #define REAUTH_TO (300) /* (50) */ #define REASSOC_TO (300) /* (50) */ /* #define DISCONNECT_TO (3000) */ @@ -129,6 +124,7 @@ typedef enum _RT_CHANNEL_DOMAIN { RTW_CHPLAN_WORLD_KCC1 = 0x28, RTW_CHPLAN_WORLD_FCC2 = 0x29, RTW_CHPLAN_FCC2_NULL = 0x2A, + RTW_CHPLAN_IC1_IC2 = 0x2B, RTW_CHPLAN_WORLD_FCC3 = 0x30, RTW_CHPLAN_WORLD_FCC4 = 0x31, RTW_CHPLAN_WORLD_FCC5 = 0x32, @@ -162,9 +158,33 @@ typedef enum _RT_CHANNEL_DOMAIN { RTW_CHPLAN_FCC1_FCC5 = 0x60, RTW_CHPLAN_FCC2_FCC7 = 0x61, RTW_CHPLAN_FCC2_FCC1 = 0x62, + RTW_CHPLAN_WORLD_ETSI15 = 0x63, + RTW_CHPLAN_MKK2_MKK5 = 0x64, + RTW_CHPLAN_ETSI1_ETSI16 = 0x65, + RTW_CHPLAN_FCC1_FCC14 = 0x66, + RTW_CHPLAN_FCC1_FCC12 = 0x67, + RTW_CHPLAN_FCC2_FCC14 = 0x68, + RTW_CHPLAN_FCC2_FCC12 = 0x69, + RTW_CHPLAN_ETSI1_ETSI17 = 0x6A, + RTW_CHPLAN_WORLD_FCC16 = 0x6B, + RTW_CHPLAN_WORLD_FCC13 = 0x6C, + RTW_CHPLAN_FCC2_FCC15 = 0x6D, + RTW_CHPLAN_WORLD_FCC12 = 0x6E, + RTW_CHPLAN_NULL_ETSI8 = 0x6F, + RTW_CHPLAN_NULL_ETSI18 = 0x70, + RTW_CHPLAN_NULL_ETSI17 = 0x71, + RTW_CHPLAN_NULL_ETSI19 = 0x72, + RTW_CHPLAN_WORLD_FCC7 = 0x73, + RTW_CHPLAN_FCC2_FCC17 = 0x74, + RTW_CHPLAN_WORLD_ETSI20 = 0x75, + RTW_CHPLAN_FCC2_FCC11 = 0x76, + RTW_CHPLAN_WORLD_ETSI21 = 0x77, + RTW_CHPLAN_FCC1_FCC18 = 0x78, + RTW_CHPLAN_MKK2_MKK1 = 0x79, RTW_CHPLAN_MAX, RTW_CHPLAN_REALTEK_DEFINE = 0x7F, + RTW_CHPLAN_UNSPECIFIED = 0xFF, } RT_CHANNEL_DOMAIN, *PRT_CHANNEL_DOMAIN; typedef enum _RT_CHANNEL_DOMAIN_2G { @@ -177,6 +197,7 @@ typedef enum _RT_CHANNEL_DOMAIN_2G { RTW_RD_2G_GLOBAL = 6, /* Global domain */ RTW_RD_2G_MKK2 = 7, /* Japan */ RTW_RD_2G_FCC2 = 8, /* US */ + RTW_RD_2G_IC1 = 9, /* Canada */ RTW_RD_2G_MAX, } RT_CHANNEL_DOMAIN_2G, *PRT_CHANNEL_DOMAIN_2G; @@ -192,31 +213,49 @@ typedef enum _RT_CHANNEL_DOMAIN_5G { RTW_RD_5G_FCC4 = 7, /* Venezuela */ RTW_RD_5G_FCC5 = 8, /* China */ RTW_RD_5G_FCC6 = 9, /* */ - RTW_RD_5G_FCC7 = 10, /* US Canada(w/o Weather radar) */ - RTW_RD_5G_KCC1 = 11, /* Korea */ - RTW_RD_5G_MKK1 = 12, /* Japan */ - RTW_RD_5G_MKK2 = 13, /* Japan (W52, W53) */ - RTW_RD_5G_MKK3 = 14, /* Japan (W56) */ - RTW_RD_5G_NCC1 = 15, /* Taiwan, (w/o Weather radar) */ - RTW_RD_5G_NCC2 = 16, /* Taiwan, Band2, Band4 */ - RTW_RD_5G_NCC3 = 17, /* Taiwan w/o DFS, Band4 only */ - RTW_RD_5G_ETSI4 = 18, /* Europe w/o DFS, Band1 only */ - RTW_RD_5G_ETSI5 = 19, /* Australia, New Zealand(w/o Weather radar) */ - RTW_RD_5G_FCC8 = 20, /* Latin America */ - RTW_RD_5G_ETSI6 = 21, /* Israel, Bahrain, Egypt, India, China, Malaysia */ - RTW_RD_5G_ETSI7 = 22, /* China */ - RTW_RD_5G_ETSI8 = 23, /* Jordan */ - RTW_RD_5G_ETSI9 = 24, /* Lebanon */ - RTW_RD_5G_ETSI10 = 25, /* Qatar */ - RTW_RD_5G_ETSI11 = 26, /* Russia */ - RTW_RD_5G_NCC4 = 27, /* Taiwan, (w/o Weather radar) */ - RTW_RD_5G_ETSI12 = 28, /* Indonesia */ - RTW_RD_5G_FCC9 = 29, /* (w/o Weather radar) */ - RTW_RD_5G_ETSI13 = 30, /* (w/o Weather radar) */ - RTW_RD_5G_FCC10 = 31, /* Argentina(w/o Weather radar) */ - RTW_RD_5G_MKK4 = 32, /* Japan (W52) */ - RTW_RD_5G_ETSI14 = 33, /* Russia */ - RTW_RD_5G_FCC11 = 34, /* US(include CH144) */ + RTW_RD_5G_FCC7 = 10, /* US(w/o Weather radar) */ + RTW_RD_5G_IC1 = 11, /* Canada(w/o Weather radar) */ + RTW_RD_5G_KCC1 = 12, /* Korea */ + RTW_RD_5G_MKK1 = 13, /* Japan */ + RTW_RD_5G_MKK2 = 14, /* Japan (W52, W53) */ + RTW_RD_5G_MKK3 = 15, /* Japan (W56) */ + RTW_RD_5G_NCC1 = 16, /* Taiwan, (w/o Weather radar) */ + RTW_RD_5G_NCC2 = 17, /* Taiwan, Band2, Band4 */ + RTW_RD_5G_NCC3 = 18, /* Taiwan w/o DFS, Band4 only */ + RTW_RD_5G_ETSI4 = 19, /* Europe w/o DFS, Band1 only */ + RTW_RD_5G_ETSI5 = 20, /* Australia, New Zealand(w/o Weather radar) */ + RTW_RD_5G_FCC8 = 21, /* Latin America */ + RTW_RD_5G_ETSI6 = 22, /* Israel, Bahrain, Egypt, India, China, Malaysia */ + RTW_RD_5G_ETSI7 = 23, /* China */ + RTW_RD_5G_ETSI8 = 24, /* Jordan */ + RTW_RD_5G_ETSI9 = 25, /* Lebanon */ + RTW_RD_5G_ETSI10 = 26, /* Qatar */ + RTW_RD_5G_ETSI11 = 27, /* Russia */ + RTW_RD_5G_NCC4 = 28, /* Taiwan, (w/o Weather radar) */ + RTW_RD_5G_ETSI12 = 29, /* Indonesia */ + RTW_RD_5G_FCC9 = 30, /* (w/o Weather radar) */ + RTW_RD_5G_ETSI13 = 31, /* (w/o Weather radar) */ + RTW_RD_5G_FCC10 = 32, /* Argentina(w/o Weather radar) */ + RTW_RD_5G_MKK4 = 33, /* Japan (W52) */ + RTW_RD_5G_ETSI14 = 34, /* Russia */ + RTW_RD_5G_FCC11 = 35, /* US(include CH144) */ + RTW_RD_5G_ETSI15 = 36, /* Malaysia */ + RTW_RD_5G_MKK5 = 37, /* Japan */ + RTW_RD_5G_ETSI16 = 38, /* Europe */ + RTW_RD_5G_ETSI17 = 39, /* Europe */ + RTW_RD_5G_FCC12 = 40, /* FCC */ + RTW_RD_5G_FCC13 = 41, /* FCC */ + RTW_RD_5G_FCC14 = 42, /* FCC w/o Weather radar(w/o 5600~5650MHz) */ + RTW_RD_5G_FCC15 = 43, /* FCC w/o Band3 */ + RTW_RD_5G_FCC16 = 44, /* FCC w/o Band3 */ + RTW_RD_5G_ETSI18 = 45, /* ETSI w/o DFS Band2&3 */ + RTW_RD_5G_ETSI19 = 46, /* Europe */ + RTW_RD_5G_FCC17 = 47, /* FCC w/o Weather radar(w/o 5600~5650MHz) */ + RTW_RD_5G_ETSI20 = 48, /* Europe */ + RTW_RD_5G_IC2 = 49, /* Canada(w/o Weather radar), include ch144 */ + RTW_RD_5G_ETSI21 = 50, /* Australia, New Zealand(w/o Weather radar) */ + RTW_RD_5G_FCC18 = 51, /* */ + RTW_RD_5G_WORLD = 52, /* Worldwide */ /* === Below are driver defined for legacy channel plan compatible, DON'T assign index ==== */ RTW_RD_5G_OLD_FCC1, @@ -344,8 +383,12 @@ struct ss_res { u8 next_state; /* will set to state on next cmd hdl */ int bss_cnt; int channel_idx; +#ifdef CONFIG_DFS + u8 dfs_ch_ssid_scan; +#endif int scan_mode; u16 scan_ch_ms; + u32 scan_timeout_ms; u8 rx_ampdu_accept; u8 rx_ampdu_size; u8 igi_scan; @@ -356,7 +399,7 @@ struct ss_res { u8 backop_flags; /* per backop runtime decision */ u8 scan_cnt; u8 scan_cnt_max; - u32 backop_time; /* the start time of backop */ + systime backop_time; /* the start time of backop */ u16 backop_ms; #endif #if defined(CONFIG_ANTENNA_DIVERSITY) || defined(DBG_SCAN_SW_ANTDIV_BL) @@ -366,6 +409,11 @@ struct ss_res { u8 ch_num; NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; + + u32 token; /* 0: use to identify caller */ + u16 duration; /* 0: use default */ + u8 igi; /* 0: use defalut */ + u8 bw; /* 0: use default */ }; /* #define AP_MODE 0x0C */ @@ -378,6 +426,7 @@ struct ss_res { #define WIFI_FW_AP_STATE _HW_STATE_AP_ #define WIFI_FW_ADHOC_STATE _HW_STATE_ADHOC_ +#define WIFI_FW_PRE_LINK 0x00000800 #define WIFI_FW_AUTH_NULL 0x00000100 #define WIFI_FW_AUTH_STATE 0x00000200 #define WIFI_FW_AUTH_SUCCESS 0x00000400 @@ -433,6 +482,9 @@ enum TDLS_option { #define RTW_BACK_OP_CH_MS 400 #endif +#define RTW_IP_ADDR_LEN 4 +#define RTW_IPv6_ADDR_LEN 16 + struct mlme_ext_info { u32 state; #ifdef CONFIG_MI_WITH_MBSSID_CAM @@ -474,6 +526,9 @@ struct mlme_ext_info { u8 hidden_ssid_mode; u8 VHT_enable; + u8 ip_addr[RTW_IP_ADDR_LEN]; + u8 ip6_addr[RTW_IPv6_ADDR_LEN]; + struct ADDBA_request ADDBA_req; struct WMM_para_element WMM_param; struct HT_caps_element HT_caps; @@ -491,8 +546,11 @@ typedef struct _RT_CHANNEL_INFO { #ifdef CONFIG_FIND_BEST_CHANNEL u32 rx_count; #endif -#ifdef CONFIG_DFS_MASTER - u32 non_ocp_end_time; +#ifdef CONFIG_DFS + #ifdef CONFIG_DFS_MASTER + systime non_ocp_end_time; + #endif + u8 hidden_bss_cnt; /* per scan count */ #endif } RT_CHANNEL_INFO, *PRT_CHANNEL_INFO; @@ -501,11 +559,15 @@ typedef struct _RT_CHANNEL_INFO { #define CAC_TIME_CE_MS (10*60*1000) #define NON_OCP_TIME_MS (30*60*1000) +#ifdef CONFIG_TXPWR_LIMIT +void rtw_txpwr_init_regd(struct rf_ctl_t *rfctl); +#endif void rtw_rfctl_init(_adapter *adapter); +void rtw_rfctl_deinit(_adapter *adapter); #ifdef CONFIG_DFS_MASTER struct rf_ctl_t; -#define CH_IS_NON_OCP(rt_ch_info) (time_after((unsigned long)(rt_ch_info)->non_ocp_end_time, (unsigned long)rtw_get_current_time())) +#define CH_IS_NON_OCP(rt_ch_info) (time_after((rt_ch_info)->non_ocp_end_time, rtw_get_current_time())) bool rtw_is_cac_reset_needed(_adapter *adapter, u8 ch, u8 bw, u8 offset); bool _rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl, u8 ch, u8 bw, u8 offset); bool rtw_rfctl_overlap_radar_detect_ch(struct rf_ctl_t *rfctl); @@ -515,7 +577,6 @@ void rtw_chset_update_non_ocp(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); void rtw_chset_update_non_ocp_ms(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset, int ms); u32 rtw_get_ch_waiting_ms(_adapter *adapter, u8 ch, u8 bw, u8 offset, u32 *r_non_ocp_ms, u32 *r_cac_ms); void rtw_reset_cac(_adapter *adapter, u8 ch, u8 bw, u8 offset); -bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags); #else #define CH_IS_NON_OCP(rt_ch_info) 0 #define rtw_chset_is_ch_non_ocp(ch_set, ch, bw, offset) _FALSE @@ -531,6 +592,9 @@ enum { RTW_CHF_NON_LONG_CAC = BIT5, RTW_CHF_NON_OCP = BIT6, }; + +bool rtw_choose_shortest_waiting_ch(_adapter *adapter, u8 req_bw, u8 *dec_ch, u8 *dec_bw, u8 *dec_offset, u8 d_flags); + void dump_country_chplan(void *sel, const struct country_chplan *ent); void dump_country_chplan_map(void *sel); void dump_chplan_id_list(void *sel); @@ -538,7 +602,7 @@ void dump_chplan_test(void *sel); void dump_chset(void *sel, RT_CHANNEL_INFO *ch_set); void dump_cur_chset(void *sel, _adapter *adapter); -int rtw_ch_set_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch); +int rtw_chset_search_ch(RT_CHANNEL_INFO *ch_set, const u32 ch); u8 rtw_chset_is_chbw_valid(RT_CHANNEL_INFO *ch_set, u8 ch, u8 bw, u8 offset); bool rtw_mlme_band_check(_adapter *adapter, const u32 ch); @@ -604,9 +668,6 @@ struct mlme_ext_priv { unsigned char cur_ch_offset;/* PRIME_CHNL_OFFSET */ unsigned char cur_wireless_mode; /* NETWORK_TYPE */ - unsigned char max_chan_nums; - RT_CHANNEL_INFO channel_set[MAX_CHANNEL_NUM]; - struct p2p_channels channel_list; unsigned char basicrate[NumRates]; unsigned char datarate[NumRates]; #ifdef CONFIG_80211N_HT @@ -618,13 +679,16 @@ struct mlme_ext_priv { * for ap mode, network includes ap's cap_info */ _timer survey_timer; _timer link_timer; + +#ifdef CONFIG_RTW_REPEATER_SON + _timer rson_scan_timer; +#endif #ifdef CONFIG_RTW_80211R _timer ft_link_timer; _timer ft_roam_timer; #endif - /* _timer ADDBA_timer; */ - u32 last_scan_time; + systime last_scan_time; u8 scan_abort; u8 tx_rate; /* TXRATE when USERATE is set. */ @@ -677,6 +741,7 @@ static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) do { \ ((mlmeext)->sitesurvey_res.state = (_state)); \ ((mlmeext)->sitesurvey_res.next_state = (_state)); \ + rtw_mi_update_iface_status(&((container_of(mlmeext, _adapter, mlmeextpriv)->mlmepriv)), 0); \ /* RTW_INFO("set_scan_state:%s\n", scan_state_str(_state)); */ \ } while (0) @@ -722,21 +787,16 @@ static inline u8 check_mlmeinfo_state(struct mlme_ext_priv *plmeext, sint state) #define mlmeext_chk_scan_backop_flags_ap(mlmeext, flags) (0) #define mlmeext_assign_scan_backop_flags_ap(mlmeext, flags) do {} while (0) #endif +u32 rtw_scan_timeout_decision(_adapter *padapter); void init_mlme_default_rate_set(_adapter *padapter); int init_mlme_ext_priv(_adapter *padapter); int init_hw_mlme_ext(_adapter *padapter); void free_mlme_ext_priv(struct mlme_ext_priv *pmlmeext); -extern void init_mlme_ext_timer(_adapter *padapter); -extern void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta); extern struct xmit_frame *alloc_mgtxmitframe(struct xmit_priv *pxmitpriv); struct xmit_frame *alloc_mgtxmitframe_once(struct xmit_priv *pxmitpriv); /* void fill_fwpriv(_adapter * padapter, struct fw_priv *pfwpriv); */ -#ifdef CONFIG_GET_RAID_BY_DRV -unsigned char networktype_to_raid(_adapter *adapter, struct sta_info *psta); -unsigned char networktype_to_raid_ex(_adapter *adapter, struct sta_info *psta); -#endif u8 judge_network_type(_adapter *padapter, unsigned char *rate, int ratelen); void get_rate_set(_adapter *padapter, unsigned char *pbssrate, int *bssrate_len); void set_mcs_rate_by_mask(u8 *mcs_set, u32 mask); @@ -753,8 +813,8 @@ void rtw_set_oper_bw(_adapter *adapter, u8 bw); u8 rtw_get_oper_choffset(_adapter *adapter); void rtw_set_oper_choffset(_adapter *adapter, u8 offset); u8 rtw_get_center_ch(u8 channel, u8 chnl_bw, u8 chnl_offset); -u32 rtw_get_on_oper_ch_time(_adapter *adapter); -u32 rtw_get_on_cur_ch_time(_adapter *adapter); +systime rtw_get_on_oper_ch_time(_adapter *adapter); +systime rtw_get_on_cur_ch_time(_adapter *adapter); u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset); u8 rtw_get_offset_by_ch(u8 channel); @@ -815,6 +875,7 @@ void update_ldpc_stbc_cap(struct sta_info *psta); int rtw_get_bcn_keys(ADAPTER *Adapter, u8 *pframe, u32 packet_len, struct beacon_keys *recv_beacon); +int validate_beacon_len(u8 *pframe, uint len); void rtw_dump_bcn_keys(struct beacon_keys *recv_beacon); int rtw_check_bcn_info(ADAPTER *Adapter, u8 *pframe, u32 packet_len); void update_beacon_info(_adapter *padapter, u8 *pframe, uint len, struct sta_info *psta); @@ -831,13 +892,15 @@ int rtw_ies_get_supported_rate(u8 *ies, uint ies_len, u8 *rate_set, u8 *rate_num void update_sta_info(_adapter *padapter, struct sta_info *psta); unsigned int update_basic_rate(unsigned char *ptn, unsigned int ptn_sz); unsigned int update_supported_rate(unsigned char *ptn, unsigned int ptn_sz); -unsigned int update_MCS_rate(struct HT_caps_element *pHT_caps); void Update_RA_Entry(_adapter *padapter, struct sta_info *psta); void set_sta_rate(_adapter *padapter, struct sta_info *psta); unsigned int receive_disconnect(_adapter *padapter, unsigned char *MacAddr, unsigned short reason, u8 locally_generated); -unsigned char get_highest_rate_idx(u32 mask); +unsigned char get_highest_rate_idx(u64 mask); +unsigned char get_lowest_rate_idx_ex(u64 mask, int start_bit); +#define get_lowest_rate_idx(mask) get_lowest_rate_idx_ex(mask, 0) + int support_short_GI(_adapter *padapter, struct HT_caps_element *pHT_caps, u8 bwmode); unsigned int is_ap_in_tkip(_adapter *padapter); unsigned int is_ap_in_wep(_adapter *padapter); @@ -867,7 +930,9 @@ void dump_macid_map(void *sel, struct macid_bmp *map, u8 max_num); bool rtw_macid_is_set(struct macid_bmp *map, u8 id); bool rtw_macid_is_used(struct macid_ctl_t *macid_ctl, u8 id); bool rtw_macid_is_bmc(struct macid_ctl_t *macid_ctl, u8 id); -s8 rtw_macid_get_if_g(struct macid_ctl_t *macid_ctl, u8 id); +u8 rtw_macid_get_iface_bmp(struct macid_ctl_t *macid_ctl, u8 id); +bool rtw_macid_is_iface_shared(struct macid_ctl_t *macid_ctl, u8 id); +bool rtw_macid_is_iface_specific(struct macid_ctl_t *macid_ctl, u8 id, _adapter *adapter); s8 rtw_macid_get_ch_g(struct macid_ctl_t *macid_ctl, u8 id); void rtw_alloc_macid(_adapter *padapter, struct sta_info *psta); void rtw_release_macid(_adapter *padapter, struct sta_info *psta); @@ -877,9 +942,11 @@ void rtw_macid_ctl_set_bw(struct macid_ctl_t *macid_ctl, u8 id, u8 bw); void rtw_macid_ctl_set_vht_en(struct macid_ctl_t *macid_ctl, u8 id, u8 en); void rtw_macid_ctl_set_rate_bmp0(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp); void rtw_macid_ctl_set_rate_bmp1(struct macid_ctl_t *macid_ctl, u8 id, u32 bmp); +void rtw_macid_ctl_init_sleep_reg(struct macid_ctl_t *macid_ctl, u16 m0, u16 m1, u16 m2, u16 m3); void rtw_macid_ctl_init(struct macid_ctl_t *macid_ctl); void rtw_macid_ctl_deinit(struct macid_ctl_t *macid_ctl); u8 rtw_iface_bcmc_id_get(_adapter *padapter); +void rtw_iface_bcmc_id_set(_adapter *padapter, u8 mac_id); u32 report_join_res(_adapter *padapter, int res); void report_survey_event(_adapter *padapter, union recv_frame *precv_frame); @@ -903,6 +970,7 @@ s32 dump_mgntframe_and_wait_ack(_adapter *padapter, struct xmit_frame *pmgntfram s32 dump_mgntframe_and_wait_ack_timeout(_adapter *padapter, struct xmit_frame *pmgntframe, int timeout_ms); #ifdef CONFIG_P2P +int get_reg_classes_full_count(struct p2p_channels *channel_list); void issue_probersp_p2p(_adapter *padapter, unsigned char *da); void issue_p2p_provision_request(_adapter *padapter, u8 *pssid, u8 ussidlen, u8 *pdev_raddr); void issue_p2p_GO_request(_adapter *padapter, u8 *raddr); @@ -921,7 +989,6 @@ void issue_auth(_adapter *padapter, struct sta_info *psta, unsigned short status void issue_probereq(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da); s32 issue_probereq_ex(_adapter *padapter, NDIS_802_11_SSID *pssid, u8 *da, u8 ch, bool append_wps, int try_cnt, int wait_ms); int issue_nulldata(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); -s32 issue_nulldata_in_interrupt(PADAPTER padapter, u8 *da, unsigned int power_mode); int issue_qos_nulldata(_adapter *padapter, unsigned char *da, u16 tid, int try_cnt, int wait_ms); int issue_deauth(_adapter *padapter, unsigned char *da, unsigned short reason); int issue_deauth_ex(_adapter *padapter, u8 *da, unsigned short reason, int try_cnt, int wait_ms); @@ -931,11 +998,11 @@ void issue_addba_rsp(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u u8 issue_addba_rsp_wait_ack(_adapter *adapter, unsigned char *ra, u8 tid, u16 status, u8 size, int try_cnt, int wait_ms); void issue_del_ba(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator); int issue_del_ba_ex(_adapter *adapter, unsigned char *ra, u8 tid, u16 reason, u8 initiator, int try_cnt, int wait_ms); +void issue_action_BSSCoexistPacket(_adapter *padapter); #ifdef CONFIG_IEEE80211W void issue_action_SA_Query(_adapter *padapter, unsigned char *raddr, unsigned char action, unsigned short tid, u8 key_type); int issue_deauth_11w(_adapter *padapter, unsigned char *da, unsigned short reason, u8 key_type); -extern void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta); #endif /* CONFIG_IEEE80211W */ int issue_action_SM_PS(_adapter *padapter , unsigned char *raddr , u8 NewMimoPsMode); int issue_action_SM_PS_wait_ack(_adapter *padapter, unsigned char *raddr, u8 NewMimoPsMode, int try_cnt, int wait_ms); @@ -984,6 +1051,7 @@ bool rtw_rx_ampdu_is_accept(_adapter *adapter); bool rtw_rx_ampdu_set_size(_adapter *adapter, u8 size, u8 reason); bool rtw_rx_ampdu_set_accept(_adapter *adapter, u8 accept, u8 reason); u8 rx_ampdu_apply_sta_tid(_adapter *adapter, struct sta_info *sta, u8 tid, u8 accept, u8 size); +u8 rx_ampdu_size_sta_limit(_adapter *adapter, struct sta_info *sta); u8 rx_ampdu_apply_sta(_adapter *adapter, struct sta_info *sta, u8 accept, u8 size); u16 rtw_rx_ampdu_apply(_adapter *adapter); @@ -994,6 +1062,7 @@ unsigned int OnAction_ht(_adapter *padapter, union recv_frame *precv_frame); #ifdef CONFIG_IEEE80211W unsigned int OnAction_sa_query(_adapter *padapter, union recv_frame *precv_frame); #endif /* CONFIG_IEEE80211W */ +unsigned int on_action_rm(_adapter *padapter, union recv_frame *precv_frame); unsigned int OnAction_wmm(_adapter *padapter, union recv_frame *precv_frame); unsigned int OnAction_vht(_adapter *padapter, union recv_frame *precv_frame); unsigned int OnAction_p2p(_adapter *padapter, union recv_frame *precv_frame); @@ -1003,8 +1072,8 @@ void start_clnt_ft_action(_adapter *padapter, u8 *pTargetAddr); void issue_action_ft_request(_adapter *padapter, u8 *pTargetAddr); void report_ft_event(_adapter *padapter); void report_ft_reassoc_event(_adapter *padapter, u8 *pMacAddr); -void ft_link_timer_hdl(_adapter *padapter); -void ft_roam_timer_hdl(_adapter *padapter); +void ft_link_timer_hdl(void *ctx); +void ft_roam_timer_hdl(void *ctx); #endif void mlmeext_joinbss_event_callback(_adapter *padapter, int join_res); void mlmeext_sta_del_event_callback(_adapter *padapter); @@ -1014,11 +1083,14 @@ void linked_status_chk(_adapter *padapter, u8 from_timer); void _linked_info_dump(_adapter *padapter); -void survey_timer_hdl(_adapter *padapter); -void link_timer_hdl(_adapter *padapter); -void addba_timer_hdl(struct sta_info *psta); +void survey_timer_hdl(void *ctx); +#ifdef CONFIG_RTW_REPEATER_SON +void rson_timer_hdl(void *ctx); +#endif +void link_timer_hdl(void *ctx); +void addba_timer_hdl(void *ctx); #ifdef CONFIG_IEEE80211W -void sa_query_timer_hdl(struct sta_info *psta); +void sa_query_timer_hdl(void *ctx); #endif /* CONFIG_IEEE80211W */ #if 0 void reauth_timer_hdl(_adapter *padapter); @@ -1063,6 +1135,8 @@ struct cmd_hdl { u8(*h2cfuns)(struct _ADAPTER *padapter, u8 *pbuf); }; +void rtw_leave_opch(_adapter *adapter); +void rtw_back_opch(_adapter *adapter); u8 read_macreg_hdl(_adapter *padapter, u8 *pbuf); u8 write_macreg_hdl(_adapter *padapter, u8 *pbuf); @@ -1092,7 +1166,7 @@ u8 mlme_evt_hdl(_adapter *padapter, unsigned char *pbuf); u8 h2c_msg_hdl(_adapter *padapter, unsigned char *pbuf); u8 chk_bmc_sleepq_hdl(_adapter *padapter, unsigned char *pbuf); u8 tx_beacon_hdl(_adapter *padapter, unsigned char *pbuf); -u8 set_ch_hdl(_adapter *padapter, u8 *pbuf); +u8 rtw_set_chbw_hdl(_adapter *padapter, u8 *pbuf); u8 set_chplan_hdl(_adapter *padapter, unsigned char *pbuf); u8 led_blink_hdl(_adapter *padapter, unsigned char *pbuf); u8 set_csa_hdl(_adapter *padapter, unsigned char *pbuf); /* Kurt: Handling DFS channel switch announcement ie. */ @@ -1135,8 +1209,8 @@ struct cmd_hdl wlancmds[] = { GEN_MLME_EXT_HANDLER(sizeof(struct getbasicrate_parm), NULL) GEN_MLME_EXT_HANDLER(sizeof(struct setdatarate_parm), NULL) GEN_MLME_EXT_HANDLER(sizeof(struct getdatarate_parm), NULL) - GEN_MLME_EXT_HANDLER(sizeof(struct setphyinfo_parm), NULL) - GEN_MLME_EXT_HANDLER(sizeof(struct getphyinfo_parm), NULL) /*30*/ + GEN_MLME_EXT_HANDLER(0, NULL) + GEN_MLME_EXT_HANDLER(0, NULL) /*30*/ GEN_MLME_EXT_HANDLER(sizeof(struct setphy_parm), NULL) GEN_MLME_EXT_HANDLER(sizeof(struct getphy_parm), NULL) GEN_MLME_EXT_HANDLER(0, NULL) @@ -1152,7 +1226,7 @@ struct cmd_hdl wlancmds[] = { GEN_MLME_EXT_HANDLER(0, NULL) GEN_MLME_EXT_HANDLER(0, NULL) GEN_MLME_EXT_HANDLER(sizeof(struct addBaReq_parm), add_ba_hdl) - GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), set_ch_hdl) /* 46 */ + GEN_MLME_EXT_HANDLER(sizeof(struct set_ch_parm), rtw_set_chbw_hdl) /* 46 */ GEN_MLME_EXT_HANDLER(0, NULL) GEN_MLME_EXT_HANDLER(0, NULL) GEN_MLME_EXT_HANDLER(0, NULL) @@ -1175,6 +1249,7 @@ struct cmd_hdl wlancmds[] = { GEN_MLME_EXT_HANDLER(0, chk_bmc_sleepq_hdl) /*63*/ GEN_MLME_EXT_HANDLER(sizeof(struct RunInThread_param), run_in_thread_hdl) /*64*/ GEN_MLME_EXT_HANDLER(sizeof(struct addBaRsp_parm), add_ba_rsp_hdl) /* 65 */ + GEN_MLME_EXT_HANDLER(sizeof(struct rm_event), rm_post_event_hdl) /* 66 */ }; #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp.h index 7c0f6276fbd9..d3805e905b78 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_MP_H_ #define _RTW_MP_H_ @@ -102,39 +97,7 @@ struct mp_tx { #define MP_MAX_LINES 1000 #define MP_MAX_LINES_BYTES 256 -#define u1Byte u8 -#define s1Byte s8 -#define u4Byte u32 -#define s4Byte s32 -#define u1Byte u8 -#define pu1Byte u8* -#define u2Byte u16 -#define pu2Byte u16* - -#define u4Byte u32 -#define pu4Byte u32* - -#define u8Byte u64 -#define pu8Byte u64* - -#define s1Byte s8 -#define ps1Byte s8* - -#define s2Byte s16 -#define ps2Byte s16* - -#define s4Byte s32 -#define ps4Byte s32* - -#define s8Byte s64 -#define ps8Byte s64* - -#define UCHAR u8 -#define USHORT u16 -#define UINT u32 -#define ULONG u32 -#define PULONG u32* typedef struct _RT_PMAC_PKT_INFO { UCHAR MCS; @@ -217,14 +180,18 @@ typedef struct _MPT_CONTEXT { /* The Value of IO operation is depend of MptActType. */ ULONG MptIoValue; /* The RfPath of IO operation is depend of MptActType. */ - ULONG MptRfPath; + + ULONG mpt_rf_path; + WIRELESS_MODE MptWirelessModeToSw; /* Wireless mode to switch. */ u8 MptChannelToSw; /* Channel to switch. */ u8 MptInitGainToSet; /* Initial gain to set. */ /* ULONG bMptAntennaA; */ /* TRUE if we want to use antenna A. */ ULONG MptBandWidth; /* bandwidth to switch. */ - ULONG MptRateIndex; /* rate index. */ + + ULONG mpt_rate_index;/* rate index. */ + /* Register value kept for Single Carrier Tx test. */ u8 btMpCckTxPower; /* Register value kept for Single Carrier Tx test. */ @@ -243,13 +210,19 @@ typedef struct _MPT_CONTEXT { BOOLEAN bCckContTx; /* TRUE if we are in CCK Continuous Tx test. */ BOOLEAN bOfdmContTx; /* TRUE if we are in OFDM Continuous Tx test. */ - BOOLEAN bStartContTx; /* TRUE if we have start Continuous Tx test. */ + /* TRUE if we have start Continuous Tx test. */ + BOOLEAN is_start_cont_tx; + /* TRUE if we are in Single Carrier Tx test. */ BOOLEAN bSingleCarrier; /* TRUE if we are in Carrier Suppression Tx Test. */ - BOOLEAN bCarrierSuppression; + + BOOLEAN is_carrier_suppression; + /* TRUE if we are in Single Tone Tx test. */ - BOOLEAN bSingleTone; + + BOOLEAN is_single_tone; + /* ACK counter asked by K.Y.. */ BOOLEAN bMptEnableAckCounter; @@ -330,8 +303,11 @@ enum { MP_HW_TX_MODE, MP_GET_TXPOWER_INX, MP_CUSTOMER_STR, - MP_NULL, + MP_PWRLMT, + MP_PWRBYRATE, + BT_EFUSE_FILE, MP_SetBT, + MP_NULL, #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE VENDOR_IE_SET , VENDOR_IE_GET , @@ -434,8 +410,11 @@ struct mp_priv { BOOLEAN bTxBufCkFail; BOOLEAN bRTWSmbCfg; BOOLEAN bloopback; - MPT_CONTEXT MptCtx; BOOLEAN bloadefusemap; + BOOLEAN bloadBTefusemap; + + MPT_CONTEXT mpt_ctx; + u8 *TXradomBuffer; }; @@ -720,7 +699,9 @@ extern u32 read_bbreg(_adapter *padapter, u32 addr, u32 bitmask); extern void write_bbreg(_adapter *padapter, u32 addr, u32 bitmask, u32 val); extern u32 read_rfreg(PADAPTER padapter, u8 rfpath, u32 addr); extern void write_rfreg(PADAPTER padapter, u8 rfpath, u32 addr, u32 val); - +#ifdef CONFIG_ANTENNA_DIVERSITY +u8 rtw_mp_set_antdiv(PADAPTER padapter, BOOLEAN bMain); +#endif void SetChannel(PADAPTER pAdapter); void SetBandwidth(PADAPTER pAdapter); int SetTxPower(PADAPTER pAdapter); @@ -745,7 +726,7 @@ void GetPowerTracking(PADAPTER padapter, u8 *enable); u32 mp_query_psd(PADAPTER pAdapter, u8 *data); void rtw_mp_trigger_iqk(PADAPTER padapter); void rtw_mp_trigger_lck(PADAPTER padapter); - +u8 rtw_mp_mode_check(PADAPTER padapter); void hal_mpt_SwitchRfSetting(PADAPTER pAdapter); @@ -765,14 +746,12 @@ void hal_mpt_SetContinuousTx(PADAPTER pAdapter, u8 bStart); void hal_mpt_SetSingleCarrierTx(PADAPTER pAdapter, u8 bStart); void hal_mpt_SetSingleToneTx(PADAPTER pAdapter, u8 bStart); void hal_mpt_SetCarrierSuppressionTx(PADAPTER pAdapter, u8 bStart); -void hal_mpt_SetCCKContinuousTx(PADAPTER pAdapter, u8 bStart); -void hal_mpt_SetOFDMContinuousTx(PADAPTER pAdapter, u8 bStart); void mpt_ProSetPMacTx(PADAPTER Adapter); - void MP_PHY_SetRFPathSwitch(PADAPTER pAdapter , BOOLEAN bMain); +u8 MP_PHY_QueryRFPathSwitch(PADAPTER pAdapter); ULONG mpt_ProQueryCalTxPower(PADAPTER pAdapter, u8 RfPath); void MPT_PwrCtlDM(PADAPTER padapter, u32 bstart); -u8 MptToMgntRate(u32 MptRateIdx); +u8 mpt_to_mgnt_rate(u32 MptRateIdx); u8 rtw_mpRateParseFunc(PADAPTER pAdapter, u8 *targetStr); u32 mp_join(PADAPTER padapter, u8 mode); u32 hal_mpt_query_phytxok(PADAPTER pAdapter); @@ -907,12 +886,21 @@ int rtw_mp_getver(struct net_device *dev, int rtw_mp_mon(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra); +int rtw_mp_pwrlmt(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra); +int rtw_mp_pwrbyrate(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra); int rtw_efuse_mask_file(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra); int rtw_efuse_file_map(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra); +int rtw_bt_efuse_file_map(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra); int rtw_mp_SetBT(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_ioctl.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_ioctl.h index e6a9a2360ead..a9dabfcefddf 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_ioctl.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_ioctl.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_MP_IOCTL_H_ #define _RTW_MP_IOCTL_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_phy_regdef.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_phy_regdef.h index 5f79e46432c1..be627800e522 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_phy_regdef.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_mp_phy_regdef.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /***************************************************************************** * * Module: __RTW_MP_PHY_REGDEF_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_odm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_odm.h index 735c0a6323ec..4ce6fe1407a4 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_odm.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_odm.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_ODM_H__ #define __RTW_ODM_H__ @@ -25,31 +20,71 @@ /* * This file provides utilities/wrappers for rtw driver to use ODM */ +typedef enum _HAL_PHYDM_OPS { + HAL_PHYDM_DIS_ALL_FUNC, + HAL_PHYDM_FUNC_SET, + HAL_PHYDM_FUNC_CLR, + HAL_PHYDM_ABILITY_BK, + HAL_PHYDM_ABILITY_RESTORE, + HAL_PHYDM_ABILITY_SET, + HAL_PHYDM_ABILITY_GET, +} HAL_PHYDM_OPS; -void rtw_odm_dbg_comp_msg(void *sel, _adapter *adapter); -void rtw_odm_dbg_comp_set(_adapter *adapter, u64 comps); -void rtw_odm_dbg_level_msg(void *sel, _adapter *adapter); -void rtw_odm_dbg_level_set(_adapter *adapter, u32 level); -void rtw_odm_ability_msg(void *sel, _adapter *adapter); -void rtw_odm_ability_set(_adapter *adapter, u32 ability); +#define DYNAMIC_FUNC_DISABLE (0x0) + u32 rtw_phydm_ability_ops(_adapter *adapter, HAL_PHYDM_OPS ops, u32 ability); + +#define rtw_phydm_func_disable_all(adapter) \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0) + +#ifdef CONFIG_RTW_ACS +#define rtw_phydm_func_for_offchannel(adapter) \ + do { \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0); \ + if (rtw_odm_adaptivity_needed(adapter)) \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ADAPTIVITY); \ + if (IS_ACS_ENABLE(adapter))\ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ENV_MONITOR); \ + } while (0) +#else +#define rtw_phydm_func_for_offchannel(adapter) \ + do { \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_DIS_ALL_FUNC, 0); \ + if (rtw_odm_adaptivity_needed(adapter)) \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_SET, ODM_BB_ADAPTIVITY); \ + } while (0) +#endif + +#define rtw_phydm_func_clr(adapter, ability) \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_FUNC_CLR, ability) + +#define rtw_phydm_ability_backup(adapter) \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_BK, 0) + +#define rtw_phydm_ability_restore(adapter) \ + rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_RESTORE, 0) + + +static inline u32 rtw_phydm_ability_get(_adapter *adapter) +{ + return rtw_phydm_ability_ops(adapter, HAL_PHYDM_ABILITY_GET, 0); +} + void rtw_odm_init_ic_type(_adapter *adapter); -void rtw_odm_set_force_igi_lb(_adapter *adapter, u8 lb); -u8 rtw_odm_get_force_igi_lb(_adapter *adapter); - void rtw_odm_adaptivity_config_msg(void *sel, _adapter *adapter); bool rtw_odm_adaptivity_needed(_adapter *adapter); void rtw_odm_adaptivity_parm_msg(void *sel, _adapter *adapter); -void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 TH_L2H_ini, s8 TH_EDCCA_HL_diff, s8 TH_L2H_ini_mode2, s8 TH_EDCCA_HL_diff_mode2, u8 EDCCA_enable); +void rtw_odm_adaptivity_parm_set(_adapter *adapter, s8 th_l2h_ini, s8 th_edcca_hl_diff, s8 th_l2h_ini_mode2, s8 th_edcca_hl_diff_mode2, u8 edcca_enable); void rtw_odm_get_perpkt_rssi(void *sel, _adapter *adapter); -void rtw_odm_acquirespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); -void rtw_odm_releasespinlock(_adapter *adapter, RT_SPINLOCK_TYPE type); +void rtw_odm_acquirespinlock(_adapter *adapter, enum rt_spinlock_type type); +void rtw_odm_releasespinlock(_adapter *adapter, enum rt_spinlock_type type); -#ifdef CONFIG_DFS_MASTER u8 rtw_odm_get_dfs_domain(_adapter *adapter); +u8 rtw_odm_dfs_domain_unknown(_adapter *adapter); +#ifdef CONFIG_DFS_MASTER VOID rtw_odm_radar_detect_reset(_adapter *adapter); VOID rtw_odm_radar_detect_disable(_adapter *adapter); VOID rtw_odm_radar_detect_enable(_adapter *adapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_p2p.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_p2p.h index 844f7ec8a021..f5fe3c157e85 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_p2p.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_p2p.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_P2P_H_ #define __RTW_P2P_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_pwrctrl.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_pwrctrl.h index 5511c2aa3632..c3c81232d8ec 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_pwrctrl.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_pwrctrl.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_PWRCTRL_H_ #define __RTW_PWRCTRL_H_ @@ -45,19 +40,20 @@ #endif /* CONFIG_BT_COEXIST */ #ifdef CONFIG_WOWLAN -#ifdef CONFIG_DEFAULT_PATTERNS_EN #ifdef CONFIG_PLATFORM_ANDROID_INTEL_X86 /* TCP/ICMP/UDP multicast with specific IP addr */ - #define DEFAULT_PATTERN_NUM 3 + #define DEFAULT_PATTERN_NUM 4 #else /* TCP/ICMP */ - #define DEFAULT_PATTERN_NUM 2 + #define DEFAULT_PATTERN_NUM 3 #endif -#else - #define DEFAULT_PATTERN_NUM 0 -#endif /*CONFIG_DEFAULT_PATTERNS_EN*/ -#define MAX_WKFM_NUM 16 /* Frame Mask Cam number for pattern match */ +#ifdef CONFIG_WOW_PATTERN_HW_CAM /* Frame Mask Cam number for pattern match */ +#define MAX_WKFM_CAM_NUM 12 +#else +#define MAX_WKFM_CAM_NUM 16 +#endif + #define MAX_WKFM_SIZE 16 /* (16 bytes for WKFM bit mask, 16*8 = 128 bits) */ #define MAX_WKFM_PATTERN_SIZE 128 #define WKFMCAM_ADDR_NUM 6 @@ -76,19 +72,6 @@ typedef struct rtl_priv_pattern { char mask[MAX_WKFM_SIZE]; } rtl_priv_pattern_t; -struct rtl_wow_pattern { - u16 crc; - u8 type; - u32 mask[4]; -}; - -struct aoac_report { - u8 iv[8]; - u8 replay_counter_eapol_key[8]; - u8 group_key[32]; - u8 key_index; - u8 scurity_type; -}; #endif /* CONFIG_WOWLAN */ enum Power_Mgnt { @@ -106,6 +89,13 @@ enum Power_Mgnt { PS_MODE_NUM, }; +enum lps_level { + LPS_NORMAL = 0, + LPS_LCLK, + LPS_PG, + LPS_LEVEL_MAX, +}; + #ifdef CONFIG_PNO_SUPPORT #define MAX_PNO_LIST_COUNT 16 #define MAX_SCAN_LIST_COUNT 14 /* 2.4G only */ @@ -181,7 +171,7 @@ __inline static void _exit_pwrlock(_pwrlock *plock) _rtw_up_sema(plock); } -#define LPS_DELAY_TIME 1*HZ /* 1 sec */ +#define LPS_DELAY_MS 1000 /* 1 sec */ #define EXE_PWR_NONE 0x01 #define EXE_PWR_IPS 0x02 @@ -241,6 +231,8 @@ typedef enum _PS_DENY_REASON { PS_DENY_SUSPEND, PS_DENY_IOCTL, PS_DENY_MGNT_TX, + PS_DENY_MONITOR_MODE, + PS_DENY_BEAMFORMING, /* Beamforming */ PS_DENY_DRV_REMOVE = 30, PS_DENY_OTHERS = 31 } PS_DENY_REASON; @@ -305,6 +297,14 @@ typedef struct lps_poff_info { } lps_poff_info_t; #endif /*CONFIG_LPS_POFF*/ +struct aoac_report { + u8 iv[8]; + u8 replay_counter_eapol_key[8]; + u8 group_key[32]; + u8 key_index; + u8 security_type; +}; + struct pwrctrl_priv { _pwrlock lock; _pwrlock check_32k_lock; @@ -318,8 +318,13 @@ struct pwrctrl_priv { u8 bcn_ant_mode; u8 dtim; +#ifdef CONFIG_WMMPS_STA + u8 wmm_smart_ps; +#endif /* CONFIG_WMMPS_STA */ + u32 alives; _workitem cpwm_event; + _workitem dma_event; /*for handle un-synchronized tx dma*/ #ifdef CONFIG_LPS_RPWM_TIMER u8 brpwmtimeout; _workitem rpwmtimeoutwi; @@ -345,7 +350,7 @@ struct pwrctrl_priv { u8 ips_org_mode; u8 ips_mode_req; /* used to accept the mode setting request, will update to ipsmode later */ uint bips_processing; - u32 ips_deny_time; /* will deny IPS when system time is smaller than this */ + systime ips_deny_time; /* will deny IPS when system time is smaller than this */ u8 pre_ips_type;/* 0: default flow, 1: carddisbale flow */ /* ps_deny: if 0, power save is free to go; otherwise deny all kinds of power save. */ @@ -362,12 +367,14 @@ struct pwrctrl_priv { u8 power_mgnt; u8 org_power_mgnt; u8 bFwCurrentInPSMode; - u32 DelayLPSLastTimeStamp; + systime DelayLPSLastTimeStamp; s32 pnp_current_pwr_state; u8 pnp_bstop_trx; - + #ifdef CONFIG_AUTOSUSPEND + int ps_flag; /* used by autosuspend */ u8 bInternalAutoSuspend; + #endif u8 bInSuspend; #ifdef CONFIG_BT_COEXIST u8 bAutoResume; @@ -380,29 +387,37 @@ struct pwrctrl_priv { u8 wowlan_mode; u8 wowlan_p2p_mode; u8 wowlan_pno_enable; + u8 wowlan_in_resume; + #ifdef CONFIG_GPIO_WAKEUP u8 is_high_active; #endif /* CONFIG_GPIO_WAKEUP */ #ifdef CONFIG_WOWLAN + bool default_patterns_en; +#ifdef CONFIG_IPV6 + u8 wowlan_ns_offload_en; +#endif /*CONFIG_IPV6*/ u8 wowlan_txpause_status; u8 wowlan_pattern_idx; - u8 wowlan_in_resume; u64 wowlan_fw_iv; - struct rtl_priv_pattern patterns[MAX_WKFM_NUM]; - struct aoac_report wowlan_aoac_rpt; - u8 wowlan_aoac_rpt_loc; + struct rtl_priv_pattern patterns[MAX_WKFM_CAM_NUM]; #ifdef CONFIG_PNO_SUPPORT u8 pno_inited; pno_nlo_info_t *pnlo_info; pno_scan_info_t *pscan_info; pno_ssid_list_t *pno_ssid_list; #endif /* CONFIG_PNO_SUPPORT */ +#ifdef CONFIG_WOW_PATTERN_HW_CAM + _mutex wowlan_pattern_cam_mutex; +#endif + u8 wowlan_aoac_rpt_loc; + struct aoac_report wowlan_aoac_rpt; + u8 wowlan_dis_lps;/*for debug purpose*/ #endif /* CONFIG_WOWLAN */ _timer pwr_state_check_timer; int pwr_state_check_interval; u8 pwr_state_check_cnts; - int ps_flag; /* used by autosuspend */ rt_rf_power_state rf_pwrstate;/* cur power state, only for IPS */ /* rt_rf_power_state current_rfpwrstate; */ @@ -436,11 +451,13 @@ struct pwrctrl_priv { #ifdef CONFIG_LPS_POFF lps_poff_info_t *plps_poff_info; #endif - + u8 lps_level_bk; + u8 lps_level; /*LPS_NORMAL,LPA_CG,LPS_PG*/ #ifdef CONFIG_LPS_PG u8 lpspg_rsvd_page_locate; u8 blpspg_info_up; #endif + u8 current_lps_hw_port_id; }; #define rtw_get_ips_mode_req(pwrctl) \ @@ -507,6 +524,7 @@ void traffic_check_for_leave_lps(PADAPTER padapter, u8 tx, u32 tx_packets); void rtw_set_ps_mode(PADAPTER padapter, u8 ps_mode, u8 smart_ps, u8 bcn_ant_mode, const char *msg); void rtw_set_fw_in_ips_mode(PADAPTER padapter, u8 enable); void rtw_set_rpwm(_adapter *padapter, u8 val8); +void rtw_wow_lps_level_decide(_adapter *adapter, u8 wow_en); #endif #ifdef CONFIG_RESUME_IN_WORKQUEUE @@ -534,6 +552,7 @@ int _rtw_pwr_wakeup(_adapter *padapter, u32 ips_deffer_ms, const char *caller); #define rtw_pwr_wakeup_ex(adapter, ips_deffer_ms) _rtw_pwr_wakeup(adapter, ips_deffer_ms, __FUNCTION__) int rtw_pm_set_ips(_adapter *padapter, u8 mode); int rtw_pm_set_lps(_adapter *padapter, u8 mode); +int rtw_pm_set_lps_level(_adapter *padapter, u8 level); void rtw_ps_deny(PADAPTER padapter, PS_DENY_REASON reason); void rtw_ps_deny_cancel(PADAPTER padapter, PS_DENY_REASON reason); @@ -543,14 +562,10 @@ u32 rtw_ps_deny_get(PADAPTER padapter); void rtw_get_current_ip_address(PADAPTER padapter, u8 *pcurrentip); void rtw_get_sec_iv(PADAPTER padapter, u8 *pcur_dot11txpn, u8 *StaAddr); bool rtw_check_pattern_valid(u8 *input, u8 len); -bool rtw_write_to_frame_mask(_adapter *adapter, u8 idx, - struct rtl_wow_pattern *content); - -bool rtw_read_from_frame_mask(_adapter *adapter, u8 idx); bool rtw_wowlan_parser_pattern_cmd(u8 *input, char *pattern, int *pattern_len, char *bit_mask); +void rtw_wow_pattern_sw_reset(_adapter *adapter); u8 rtw_set_default_pattern(_adapter *adapter); -void rtw_dump_priv_pattern(_adapter *adapter, u8 idx); -void rtw_clean_pattern(_adapter *adapter); +void rtw_wow_pattern_sw_dump(_adapter *adapter); #endif /* CONFIG_WOWLAN */ #endif /* __RTL871X_PWRCTRL_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_qos.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_qos.h index 57555e12d73d..8e1d013e128f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_qos.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_qos.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,24 +11,56 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_QOS_H_ #define _RTW_QOS_H_ +#define DRV_CFG_UAPSD_VO BIT0 +#define DRV_CFG_UAPSD_VI BIT1 +#define DRV_CFG_UAPSD_BK BIT2 +#define DRV_CFG_UAPSD_BE BIT3 +#define WMM_IE_UAPSD_VO BIT0 +#define WMM_IE_UAPSD_VI BIT1 +#define WMM_IE_UAPSD_BK BIT2 +#define WMM_IE_UAPSD_BE BIT3 + +#define WMM_TID0 BIT0 +#define WMM_TID1 BIT1 +#define WMM_TID2 BIT2 +#define WMM_TID3 BIT3 +#define WMM_TID4 BIT4 +#define WMM_TID5 BIT5 +#define WMM_TID6 BIT6 +#define WMM_TID7 BIT7 + +#define AP_SUPPORTED_UAPSD BIT7 +/* TC = Traffic Category, TID0~7 represents TC */ +#define BIT_MASK_TID_TC 0xff +/* TS = Traffic Stream, TID8~15 represents TS */ +#define BIT_MASK_TID_TS 0xff00 +#define ALL_TID_TC_SUPPORTED_UAPSD 0xff struct qos_priv { unsigned int qos_option; /* bit mask option: u-apsd, s-apsd, ts, block ack... */ +#ifdef CONFIG_WMMPS_STA + /* uapsd (unscheduled automatic power-save delivery) = a kind of wmmps */ + u8 uapsd_max_sp_len; + /* declare uapsd_tid as a bitmap for the uapsd setting of TID 0~15 */ + u16 uapsd_tid; + /* declare uapsd_tid_delivery_enabled as a bitmap for the delivery-enabled setting of TID 0~7 */ + u8 uapsd_tid_delivery_enabled; + /* declare uapsd_tid_trigger_enabled as a bitmap for the trigger-enabled setting of TID 0~7 */ + u8 uapsd_tid_trigger_enabled; + /* declare uapsd_ap_supported to record whether the connected ap supports uapsd or not */ + u8 uapsd_ap_supported; +#endif /* CONFIG_WMMPS_STA */ + }; -#endif /* _RTL871X_QOS_H_ */ +#endif /* _RTL871X_QOS_H_ */ \ No newline at end of file diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_recv.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_recv.h index bb8149483f6f..3db4876e236a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_recv.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_recv.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_RECV_H_ #define _RTW_RECV_H_ @@ -56,6 +51,13 @@ #endif #endif +#if defined(CONFIG_RTL8821C) && defined(CONFIG_SDIO_HCI) && defined(CONFIG_RECV_THREAD_MODE) + #ifdef NR_RECVBUFF + #undef NR_RECVBUFF + #define NR_RECVBUFF (32) + #endif +#endif + #define NR_RECVFRAME 256 #define RXFRAME_ALIGN 8 @@ -96,6 +98,7 @@ static u8 rtw_bridge_tunnel_header[] = { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; /* for Rx reordering buffer control */ struct recv_reorder_ctrl { _adapter *padapter; + u8 tid; u8 enable; u16 indicate_seq;/* =wstart_b, init_value=0xffff */ u16 wend_b; @@ -108,6 +111,7 @@ struct recv_reorder_ctrl { struct stainfo_rxcache { u16 tid_rxseq[16]; + u8 iv[16][8]; #if 0 unsigned short tid0_rxseq; unsigned short tid1_rxseq; @@ -142,69 +146,6 @@ struct signal_stat { u32 total_num; /* num of valid elements */ u32 total_val; /* sum of valid elements */ }; -#if 0 -typedef struct _ODM_Phy_Status_Info_ { - /* */ - /* Be care, if you want to add any element please insert between */ - /* RxPWDBAll & SignalStrength. */ - /* */ -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN)) - u4Byte RxPWDBAll; -#else - u1Byte RxPWDBAll; -#endif - - u1Byte SignalQuality; /* in 0-100 index. */ - s1Byte RxMIMOSignalQuality[4]; /* per-path's EVM */ - u1Byte RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ - - u1Byte RxMIMOSignalStrength[4];/* in 0~100 index */ - - u2Byte Cfo_short[4]; /* per-path's Cfo_short */ - u2Byte Cfo_tail[4]; /* per-path's Cfo_tail */ - -#if (DM_ODM_SUPPORT_TYPE & (ODM_WIN|ODM_CE)) - s1Byte RxPower; /* in dBm Translate from PWdB */ - s1Byte RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ - u1Byte BTRxRSSIPercentage; - u1Byte SignalStrength; /* in 0-100 index. */ - - u1Byte RxPwr[4]; /* per-path's pwdb */ -#endif - u1Byte RxSNR[4]; /* per-path's SNR */ - u1Byte BandWidth; - u1Byte btCoexPwrAdjust; -} ODM_PHY_INFO_T, *PODM_PHY_INFO_T; -#endif - -struct phy_info { - u8 RxPWDBAll; - u8 SignalQuality; /* in 0-100 index. */ - s8 RxMIMOSignalQuality[4]; /* per-path's EVM */ - u8 RxMIMOEVMdbm[4]; /* per-path's EVM dbm */ - u8 RxMIMOSignalStrength[4]; /* in 0~100 index */ - s16 Cfo_short[4]; /* per-path's Cfo_short */ - s16 Cfo_tail[4]; /* per-path's Cfo_tail */ - s8 RxPower; /* in dBm Translate from PWdB */ - s8 RecvSignalPower; /* Real power in dBm for this packet, no beautification and aggregation. Keep this raw info to be used for the other procedures. */ - u8 BTRxRSSIPercentage; - u8 SignalStrength; /* in 0-100 index. */ - s8 RxPwr[4]; /* per-path's pwdb */ - s8 RxSNR[4]; -#if ((RTL8822B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) - u8 RxCount:2; - u8 BandWidth:2; - u8 rxsc:4; -#else - u8 BandWidth; -#endif - u8 btCoexPwrAdjust; -#if ((RTL8822B_SUPPORT == 1) || (RTL8723D_SUPPORT == 1) || (RTL8821C_SUPPORT == 1)) - u8 channel; /* channel number---*/ - BOOLEAN bMuPacket; /* is MU packet or not---*/ - BOOLEAN bBeamformed; -#endif -}; struct rx_raw_rssi { u8 data_rate; @@ -219,6 +160,8 @@ struct rx_raw_rssi { }; +#include "cmn_info/rtw_sta_info.h" + struct rx_pkt_attrib { u16 pkt_len; u8 physt; @@ -253,11 +196,6 @@ struct rx_pkt_attrib { u8 ack_policy; -/* #ifdef CONFIG_TCP_CSUM_OFFLOAD_RX */ - u8 tcpchk_valid; /* 0: invalid, 1: valid */ - u8 ip_chkrpt; /* 0: incorrect, 1: correct */ - u8 tcp_chkrpt; /* 0: incorrect, 1: correct */ -/* #endif */ u8 key_index; u8 data_rate; @@ -269,15 +207,9 @@ struct rx_pkt_attrib { u8 pkt_rpt_type; u32 tsfl; u32 MacIDValidEntry[2]; /* 64 bits present 64 entry. */ - -#if 0 - u8 signal_qual; - s8 rx_mimo_signal_qual[2]; - u8 signal_strength; - u32 RxPWDBAll; - s32 RecvSignalPower; -#endif - struct phy_info phy_info; + u8 ppdu_cnt; + u32 free_cnt; /* free run counter */ + struct phydm_phyinfo_struct phy_info; }; @@ -367,12 +299,17 @@ accesser of recv_priv: rtw_recv_entry(dispatch / passive level); recv_thread(pas using enter_critical section to protect */ + +#ifndef DBG_RX_BH_TRACKING +#define DBG_RX_BH_TRACKING 0 +#endif + struct recv_priv { _lock lock; #ifdef CONFIG_RECV_THREAD_MODE _sema recv_sema; - _sema terminate_recvthread_sema; + #endif /* _queue blk_strms[MAX_RX_NUMBLKS]; */ /* keeping the block ack frame until return ack */ @@ -386,6 +323,17 @@ struct recv_priv { uint free_recvframe_cnt; + #if DBG_RX_BH_TRACKING + u32 rx_bh_stage; + u32 rx_bh_buf_dq_cnt; + void *rx_bh_lbuf; + void *rx_bh_cbuf; + void *rx_bh_cbuf_data; + u32 rx_bh_cbuf_dlen; + u32 rx_bh_cbuf_pos; + void *rx_bh_cframe; + #endif + _adapter *adapter; #ifdef PLATFORM_WINDOWS @@ -399,11 +347,21 @@ struct recv_priv { NDIS_EVENT recv_resource_evt ; #endif - u32 bIsAnyNonBEPkts; + + u32 is_any_non_be_pkts; + u64 rx_bytes; u64 rx_pkts; u64 rx_drop; + u64 dbg_rx_drop_count; + u64 dbg_rx_ampdu_drop_count; + u64 dbg_rx_ampdu_forced_indicate_count; + u64 dbg_rx_ampdu_loss_count; + u64 dbg_rx_dup_mgt_frame_drop_count; + u64 dbg_rx_ampdu_window_shift_cnt; + u64 dbg_rx_conflic_mac_addr_cnt; + uint rx_icv_err; uint rx_largepacket_crcerr; uint rx_smallpacket_crcerr; @@ -435,7 +393,7 @@ struct recv_priv { struct sk_buff_head free_recv_skb_queue; struct sk_buff_head rx_skb_queue; #ifdef CONFIG_RTW_NAPI - struct sk_buff_head rx_napi_skb_queue; + struct sk_buff_head rx_napi_skb_queue; #endif #ifdef CONFIG_RX_INDICATE_QUEUE struct task rx_indicate_tasklet; @@ -469,7 +427,6 @@ struct recv_priv { s8 rssi; /* translate_percentage_to_dbm(ptarget_wlan->network.PhyInfo.SignalStrength); */ struct rx_raw_rssi raw_rssi_info; /* s8 rxpwdb; */ - s16 noise; /* int RxSNRdB[2]; */ /* s8 RxRssi[2]; */ /* int FalseAlmCnt_all; */ @@ -490,6 +447,30 @@ struct recv_priv { BOOLEAN store_law_data_flag; }; +#define RX_BH_STG_UNKNOWN 0 +#define RX_BH_STG_HDL_ENTER 1 +#define RX_BH_STG_HDL_EXIT 2 +#define RX_BH_STG_NEW_BUF 3 +#define RX_BH_STG_NEW_FRAME 4 +#define RX_BH_STG_NORMAL_RX 5 +#define RX_BH_STG_NORMAL_RX_END 6 +#define RX_BH_STG_C2H 7 +#define RX_BH_STG_C2H_END 8 + +#if DBG_RX_BH_TRACKING +void rx_bh_tk_set_stage(struct recv_priv *recv, u32 s); +void rx_bh_tk_set_buf(struct recv_priv *recv, void *buf, void *data, u32 dlen); +void rx_bh_tk_set_buf_pos(struct recv_priv *recv, void *pos); +void rx_bh_tk_set_frame(struct recv_priv *recv, void *frame); +void dump_rx_bh_tk(void *sel, struct recv_priv *recv); +#else +#define rx_bh_tk_set_stage(recv, s) do {} while (0) +#define rx_bh_tk_set_buf(recv, buf, data, dlen) do {} while (0) +#define rx_bh_tk_set_buf_pos(recv, pos) do {} while (0) +#define rx_bh_tk_set_frame(recv, frame) do {} while (0) +#define dump_rx_bh_tk(sel, recv) do {} while (0) +#endif + #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS #define rtw_set_signal_stat_timer(recvpriv) _set_timer(&(recvpriv)->signal_stat_timer, (recvpriv)->signal_stat_sampling_interval) #endif /* CONFIG_NEW_SIGNAL_STAT_PROCESS */ @@ -550,12 +531,11 @@ struct recv_buf { #endif -#ifdef PLATFORM_LINUX - _pkt *pskb; -#endif -#ifdef PLATFORM_FREEBSD /* skb solution */ +#if defined(PLATFORM_LINUX) + _pkt *pskb; +#elif defined(PLATFORM_FREEBSD) /* skb solution */ struct sk_buff *pskb; -#endif /* PLATFORM_FREEBSD */ /* skb solution */ +#endif }; @@ -576,13 +556,7 @@ struct recv_buf { */ struct recv_frame_hdr { _list list; -#ifndef CONFIG_BSD_RX_USE_MBUF - struct sk_buff *pkt; - struct sk_buff *pkt_newalloc; -#else /* CONFIG_BSD_RX_USE_MBUF */ - _pkt *pkt; - _pkt *pkt_newalloc; -#endif /* CONFIG_BSD_RX_USE_MBUF */ + _pkt *pkt; _adapter *adapter; @@ -656,12 +630,18 @@ sint rtw_enqueue_recvbuf_to_head(struct recv_buf *precvbuf, _queue *queue); sint rtw_enqueue_recvbuf(struct recv_buf *precvbuf, _queue *queue); struct recv_buf *rtw_dequeue_recvbuf(_queue *queue); +#if defined(CONFIG_80211N_HT) && defined(CONFIG_RECV_REORDERING_CTRL) void rtw_reordering_ctrl_timeout_handler(void *pcontext); +#endif void rx_query_phy_status(union recv_frame *rframe, u8 *phy_stat); int rtw_inc_and_chk_continual_no_rx_packet(struct sta_info *sta, int tid_index); void rtw_reset_continual_no_rx_packet(struct sta_info *sta, int tid_index); +#ifdef CONFIG_RECV_THREAD_MODE +thread_return rtw_recv_thread(thread_context context); +#endif + __inline static u8 *get_rxmem(union recv_frame *precvframe) { /* always return rx_head... */ @@ -879,13 +859,13 @@ __inline static s32 translate_percentage_to_dbm(u32 SignalStrengthIndex) return SignalPower; } - struct sta_info; extern void _rtw_init_sta_recv_priv(struct sta_recv_priv *psta_recvpriv); extern void mgt_dispatcher(_adapter *padapter, union recv_frame *precv_frame); +u8 adapter_allow_bmc_data_rx(_adapter *adapter); s32 pre_recv_entry(union recv_frame *precvframe, u8 *pphy_status); #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rf.h index 77d3260a3a0b..ab0d5d77c442 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,42 +11,16 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_RF_H_ #define __RTW_RF_H_ - -#define OFDM_PHY 1 -#define MIXED_PHY 2 -#define CCK_PHY 3 - -#define b_mode_rate_num 4 -#define g_mode_rate_num 8 #define NumRates (13) /* slot time for 11g */ #define SHORT_SLOT_TIME 9 #define NON_SHORT_SLOT_TIME 20 -#define RTL8711_RF_MAX_SENS 6 -#define RTL8711_RF_DEF_SENS 4 - -/* - * We now define the following channels as the max channels in each channel plan. - * 2G, total 14 chnls - * {1,2,3,4,5,6,7,8,9,10,11,12,13,14} - * 5G, total 25 chnls - * {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,144,149,153,157,161,165} - */ -#define MAX_CHANNEL_NUM_2G 14 -#define MAX_CHANNEL_NUM_5G 25 -#define MAX_CHANNEL_NUM (MAX_CHANNEL_NUM_2G + MAX_CHANNEL_NUM_5G) - #define CENTER_CH_2G_40M_NUM 9 #define CENTER_CH_2G_NUM 14 #define CENTER_CH_5G_20M_NUM 28 /* 20M center channels */ @@ -55,6 +29,10 @@ #define CENTER_CH_5G_160M_NUM 3 /* 160M center channels */ #define CENTER_CH_5G_ALL_NUM (CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM + CENTER_CH_5G_80M_NUM) +#define MAX_CHANNEL_NUM_2G CENTER_CH_2G_NUM +#define MAX_CHANNEL_NUM_5G CENTER_CH_5G_20M_NUM +#define MAX_CHANNEL_NUM (MAX_CHANNEL_NUM_2G + MAX_CHANNEL_NUM_5G) + extern u8 center_ch_2g[CENTER_CH_2G_NUM]; extern u8 center_ch_2g_40m[CENTER_CH_2G_40M_NUM]; @@ -76,24 +54,6 @@ u8 rtw_get_op_chs_by_cch_bw(u8 cch, u8 bw, u8 **op_chs, u8 *op_ch_num); u8 rtw_get_ch_group(u8 ch, u8 *group, u8 *cck_group); -/* #define NUM_REGULATORYS 21 */ -#define NUM_REGULATORYS 1 - -/* Country codes */ -#define USA 0x555320 -#define EUROPE 0x1 /* temp, should be provided later */ -#define JAPAN 0x2 /* temp, should be provided later */ - -struct regulatory_class { - u32 starting_freq; /* MHz, */ - u8 channel_set[MAX_CHANNEL_NUM]; - u8 channel_cck_power[MAX_CHANNEL_NUM];/* dbm */ - u8 channel_ofdm_power[MAX_CHANNEL_NUM];/* dbm */ - u8 txpower_limit; /* dbm */ - u8 channel_spacing; /* MHz */ - u8 modem; -}; - typedef enum _CAPABILITY { cESS = 0x0001, cIBSS = 0x0002, @@ -119,25 +79,6 @@ enum _REG_PREAMBLE_MODE { PREAMBLE_SHORT = 3, }; - -enum _RTL8712_RF_MIMO_CONFIG_ { - RTL8712_RFCONFIG_1T = 0x10, - RTL8712_RFCONFIG_2T = 0x20, - RTL8712_RFCONFIG_1R = 0x01, - RTL8712_RFCONFIG_2R = 0x02, - RTL8712_RFCONFIG_1T1R = 0x11, - RTL8712_RFCONFIG_1T2R = 0x12, - RTL8712_RFCONFIG_TURBO = 0x92, - RTL8712_RFCONFIG_2T2R = 0x22 -}; - -typedef enum _RF_PATH { - RF_PATH_A = 0, - RF_PATH_B = 1, - RF_PATH_C = 2, - RF_PATH_D = 3, -} RF_PATH, *PRF_PATH; - #define rf_path_char(path) (((path) >= RF_PATH_MAX) ? 'X' : 'A' + (path)) /* Bandwidth Offset */ @@ -158,16 +99,6 @@ extern const char *const _band_str[]; extern const u8 _band_to_band_cap[]; #define band_to_band_cap(band) (((band) >= BAND_MAX) ? _band_to_band_cap[BAND_MAX] : _band_to_band_cap[(band)]) -/* Represent Channel Width in HT Capabilities - * */ -typedef enum _CHANNEL_WIDTH { - CHANNEL_WIDTH_20 = 0, - CHANNEL_WIDTH_40 = 1, - CHANNEL_WIDTH_80 = 2, - CHANNEL_WIDTH_160 = 3, - CHANNEL_WIDTH_80_80 = 4, - CHANNEL_WIDTH_MAX = 5, -} CHANNEL_WIDTH, *PCHANNEL_WIDTH; extern const char *const _ch_width_str[]; #define ch_width_str(bw) (((bw) >= CHANNEL_WIDTH_MAX) ? _ch_width_str[CHANNEL_WIDTH_MAX] : _ch_width_str[(bw)]) @@ -206,19 +137,13 @@ typedef enum _PROTECTION_MODE { PROTECTION_MODE_FORCE_DISABLE = 2, } PROTECTION_MODE, *PPROTECTION_MODE; -typedef enum _RT_RF_TYPE_DEFINITION { - RF_1T2R = 0, - RF_2T4R = 1, - RF_2T2R = 2, - RF_1T1R = 3, - RF_2T2R_GREEN = 4, - RF_2T3R = 5, - RF_3T3R = 6, - RF_3T4R = 7, - RF_4T4R = 8, +#define RF_TYPE_VALID(rf_type) (rf_type < RF_TYPE_MAX) - RF_MAX_TYPE = 0xF, /* u1Byte */ -} RT_RF_TYPE_DEF_E; +extern const u8 _rf_type_to_rf_tx_cnt[]; +#define rf_type_to_rf_tx_cnt(rf_type) (RF_TYPE_VALID(rf_type) ? _rf_type_to_rf_tx_cnt[rf_type] : 0) + +extern const u8 _rf_type_to_rf_rx_cnt[]; +#define rf_type_to_rf_rx_cnt(rf_type) (RF_TYPE_VALID(rf_type) ? _rf_type_to_rf_rx_cnt[rf_type] : 0) int rtw_ch2freq(int chan); int rtw_freq2ch(int freq); @@ -232,6 +157,8 @@ bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo); #define RTW_MODULE_RTL8723BE_HMC_M2 BIT5 /* RTL8723BE(HMC + M.2) */ #define RTW_MODULE_RTL8723BS_NGFF1216 BIT6 /* RTL8723BS(NGFF1216) */ #define RTW_MODULE_RTL8192EEBT_HMC_M2 BIT7 /* RTL8192EEBT(8192EE+8761AU)_(HMC + M.2) */ +#define RTW_MODULE_RTL8723DE_NGFF1630 BIT8 /* RTL8723DE(NGFF1630) */ +#define RTW_MODULE_RTL8822BE BIT9 /* RTL8822BE */ #define IS_ALPHA2_NO_SPECIFIED(_alpha2) ((*((u16 *)(_alpha2))) == 0xFFFF) @@ -242,7 +169,7 @@ struct country_chplan { u8 en_11ac; #endif #if RTW_DEF_MODULE_REGULATORY_CERT - u8 def_module_flags; /* RTW_MODULE_RTLXXX */ + u16 def_module_flags; /* RTW_MODULE_RTLXXX */ #endif }; @@ -260,6 +187,46 @@ struct country_chplan { const struct country_chplan *rtw_get_chplan_from_country(const char *country_code); +struct rf_ctl_t; + +typedef enum _REGULATION_TXPWR_LMT { + TXPWR_LMT_NONE = 0, /* no limit */ + TXPWR_LMT_FCC = 1, + TXPWR_LMT_MKK = 2, + TXPWR_LMT_ETSI = 3, + TXPWR_LMT_IC = 4, + TXPWR_LMT_KCC = 5, + TXPWR_LMT_WW = 6, /* smallest of all available limit, keep last */ +} REGULATION_TXPWR_LMT; + +extern const char *const _regd_str[]; +#define regd_str(regd) (((regd) > TXPWR_LMT_WW) ? _regd_str[TXPWR_LMT_WW] : _regd_str[(regd)]) + +#ifdef CONFIG_TXPWR_LIMIT +struct regd_exc_ent { + _list list; + char country[2]; + u8 domain; + char regd_name[0]; +}; + +void dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl); +void rtw_regd_exc_add_with_nlen(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *regd_name, u32 nlen); +void rtw_regd_exc_add(struct rf_ctl_t *rfctl, const char *country, u8 domain, const char *regd_name); +struct regd_exc_ent *_rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain); +struct regd_exc_ent *rtw_regd_exc_search(struct rf_ctl_t *rfctl, const char *country, u8 domain); +void rtw_regd_exc_list_free(struct rf_ctl_t *rfctl); + +void dump_txpwr_lmt(void *sel, _adapter *adapter); +void rtw_txpwr_lmt_add_with_nlen(struct rf_ctl_t *rfctl, const char *regd_name, u32 nlen + , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt); +void rtw_txpwr_lmt_add(struct rf_ctl_t *rfctl, const char *regd_name + , u8 band, u8 bw, u8 tlrs, u8 ntx_idx, u8 ch_idx, s8 lmt); +struct txpwr_lmt_ent *_rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *regd_name); +struct txpwr_lmt_ent *rtw_txpwr_lmt_get_by_name(struct rf_ctl_t *rfctl, const char *regd_name); +void rtw_txpwr_lmt_list_free(struct rf_ctl_t *rfctl); +#endif /* CONFIG_TXPWR_LIMIT */ + #define BB_GAIN_2G 0 #ifdef CONFIG_IEEE80211_BAND_5GHZ #define BB_GAIN_5GLB1 1 @@ -279,8 +246,14 @@ int rtw_ch_to_bb_gain_sel(int ch); void rtw_rf_set_tx_gain_offset(_adapter *adapter, u8 path, s8 offset); void rtw_rf_apply_tx_gain_offset(_adapter *adapter, u8 ch); -bool rtw_is_dfs_range(u32 hi, u32 lo); -bool rtw_is_dfs_ch(u8 ch, u8 bw, u8 offset); +u8 rtw_is_5g_band1(u8 ch); +u8 rtw_is_5g_band2(u8 ch); +u8 rtw_is_5g_band3(u8 ch); +u8 rtw_is_5g_band4(u8 ch); + +u8 rtw_is_dfs_range(u32 hi, u32 lo); +u8 rtw_is_dfs_ch(u8 ch); +u8 rtw_is_dfs_chbw(u8 ch, u8 bw, u8 offset); bool rtw_is_long_cac_range(u32 hi, u32 lo, u8 dfs_region); bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset, u8 dfs_region); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm.h new file mode 100644 index 000000000000..1752101ab654 --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm.h @@ -0,0 +1,86 @@ +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __RTW_RM_H_ +#define __RTW_RM_H_ + +u8 rm_post_event_hdl(_adapter *padapter, u8 *pbuf); + +#define RM_TIMER_NUM 32 +#define RM_ALL_MEAS BIT(1) +#define RM_ID_FOR_ALL(aid) ((aid<<16)|RM_ALL_MEAS) + +#define RM_CAP_ARG(x) ((u8 *)(x))[4], ((u8 *)(x))[3], ((u8 *)(x))[2], ((u8 *)(x))[1], ((u8 *)(x))[0] +#define RM_CAP_FMT "%02x %02x%02x %02x%02x" + +/* remember to modify rm_event_name() when adding new event */ +enum RM_EV_ID { + RM_EV_state_in, + RM_EV_busy_timer_expire, + RM_EV_delay_timer_expire, + RM_EV_meas_timer_expire, + RM_EV_retry_timer_expire, + RM_EV_repeat_delay_expire, + RM_EV_request_timer_expire, + RM_EV_wait_report, + RM_EV_start_meas, + RM_EV_survey_done, + RM_EV_recv_rep, + RM_EV_cancel, + RM_EV_state_out, + RM_EV_max +}; + +struct rm_event { + u32 rmid; + enum RM_EV_ID evid; + _list list; +}; + +#ifdef CONFIG_RTW_80211K + +struct rm_clock { + struct rm_obj *prm; + ATOMIC_T counter; + enum RM_EV_ID evid; +}; + +struct rm_priv { + u8 enable; + _queue ev_queue; + _queue rm_queue; + _timer rm_timer; + + struct rm_clock clock[RM_TIMER_NUM]; + u8 rm_en_cap_def[5]; + u8 rm_en_cap_assoc[5]; + + /* rm debug */ + void *prm_sel; +}; + +int rtw_init_rm(_adapter *padapter); +int rtw_free_rm_priv(_adapter *padapter); + +unsigned int rm_on_action(_adapter *padapter, union recv_frame *precv_frame); +void RM_IE_handler(_adapter *padapter, PNDIS_802_11_VARIABLE_IEs pIE); +void rtw_ap_parse_sta_rm_en_cap(_adapter *padapter, + struct sta_info *psta, struct rtw_ieee802_11_elems *elems); + +int rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid); +void rm_handler(_adapter *padapter, struct rm_event *pev); + +#endif /*CONFIG_RTW_80211K */ +#endif /* __RTW_RM_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm_fsm.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm_fsm.h new file mode 100644 index 000000000000..ba903a9c46bb --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rm_fsm.h @@ -0,0 +1,389 @@ + +/****************************************************************************** + * + * Copyright(c) 2007 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ + +#ifndef __RTW_RM_FSM_H_ +#define __RTW_RM_FSM_H_ + +#ifdef CONFIG_RTW_80211K + +#define RM_SUPPORT_IWPRIV_DBG 1 +#define RM_MORE_DBG_MSG 0 + +#define DBG_BCN_REQ_DETAIL 0 +#define DBG_BCN_REQ_WILDCARD 0 +#define DBG_BCN_REQ_SSID 0 +#define DBG_BCN_REQ_SSID_NAME "RealKungFu" + +#define RM_REQ_TIMEOUT 10000 /* 10 seconds */ +#define RM_MEAS_TIMEOUT 10000 /* 10 seconds */ +#define RM_REPT_SCAN_INTVL 5000 /* 5 seconds */ +#define RM_REPT_POLL_INTVL 2000 /* 2 seconds */ +#define RM_COND_INTVL 2000 /* 2 seconds */ +#define RM_SCAN_DENY_TIMES 10 +#define RM_BUSY_TRAFFIC_TIMES 10 +#define RM_WAIT_BUSY_TIMEOUT 1000 /* 1 seconds */ + +#define MEAS_REQ_MOD_PARALLEL BIT(0) +#define MEAS_REQ_MOD_ENABLE BIT(1) +#define MEAS_REQ_MOD_REQUEST BIT(2) +#define MEAS_REQ_MOD_REPORT BIT(3) +#define MEAS_REQ_MOD_DUR_MAND BIT(4) + +#define MEAS_REP_MOD_LATE BIT(0) +#define MEAS_REP_MOD_INCAP BIT(1) +#define MEAS_REP_MOD_REFUSE BIT(2) + +#define RM_MASTER BIT(0) /* STA who issue meas_req */ +#define RM_SLAVE 0 /* STA who do measurement */ + +#define CLOCK_UNIT 10 /* ms */ +#define RTW_MAX_NB_RPT_IE_NUM 16 + +#define RM_GET_AID(rmid) ((rmid&0xffff0000)>>16) +#define RM_IS_ID_FOR_ALL(rmid) (rmid&RM_ALL_MEAS) + +/* + * define the following channels as the max channels in each channel plan. + * 2G, total 14 chnls + * {1,2,3,4,5,6,7,8,9,10,11,12,13,14} + * 5G, total 25 chnls + * {36,40,44,48,52,56,60,64,100,104,108,112,116,120,124,128,132,136,140,144,149,153,157,161,165} + */ +#define MAX_OP_CHANNEL_SET_NUM 11 +typedef struct _RT_OPERATING_CLASS { + int global_op_class; + int Len; + u16 Channel[MAX_OP_CHANNEL_SET_NUM]; +} RT_OPERATING_CLASS, *PRT_OPERATING_CLASS; + +/* IEEE 802.11-2012 Table 8-59 Measurement Type definitions +* for measurement request +* modify rm_meas_type_req_name() when adding new type +*/ +enum meas_type_of_req { + basic_req, /* spectrum measurement */ + cca_req, + rpi_histo_req, + ch_load_req, + noise_histo_req, + bcn_req, + frame_req, + sta_statis_req, + lci_req, + meas_type_req_max, +}; + +/* IEEE 802.11-2012 Table 8-81 Measurement Type definitions +* for measurement report +* modify rm_type_rep_name() when adding new type +*/ +enum meas_type_of_rep { + basic_rep, /* spectrum measurement */ + cca_rep, + rpi_histo_rep, + ch_load_rep, /* radio measurement */ + noise_histo_rep, + bcn_rep, + frame_rep, + sta_statis_rep, /* Radio measurement and WNM */ + lci_rep, + meas_type_rep_max +}; + +/* +* Beacon request +*/ +/* IEEE 802.11-2012 Table 8-64 Measurement mode for Beacon Request element */ +enum bcn_req_meas_mode { + bcn_req_passive, + bcn_req_active, + bcn_req_bcn_table +}; + +/* IEEE 802.11-2012 Table 8-65 optional subelement IDs for Beacon Request */ +enum bcn_req_opt_sub_id{ + bcn_req_ssid = 0, /* len 0-32 */ + bcn_req_rep_info = 1, /* len 2 */ + bcn_req_rep_detail = 2, /* len 1 */ + bcn_req_req = 10, /* len 0-237 */ + bcn_req_ac_ch_rep = 51 /* len 1-237 */ +}; + +/* IEEE 802.11-2012 Table 8-66 Reporting condition of Beacon Report */ +enum bcn_rep_cound_id{ + bcn_rep_cond_immediately, /* default */ + bcn_req_cond_rcpi_greater, + bcn_req_cond_rcpi_less, + bcn_req_cond_rsni_greater, + bcn_req_cond_rsni_less, + bcn_req_cond_max +}; + +struct opt_rep_info { + u8 cond; + u8 threshold; +}; + +#define BCN_REQ_OPT_MAX_NUM 16 +struct bcn_req_opt { + /* all req cmd id */ + u8 opt_id[BCN_REQ_OPT_MAX_NUM]; + u8 opt_id_num; + u8 rep_detail; + NDIS_802_11_SSID ssid; + + /* bcn report condition */ + struct opt_rep_info rep_cond; + + /* 0:default(Report to be issued after each measurement) */ + u8 *req_start; /*id : 10 request;start */ + u8 req_len; /*id : 10 request;length */ +}; + +/* +* channel load +*/ +/* IEEE 802.11-2012 Table 8-60 optional subelement IDs for channel load request */ +enum ch_load_opt_sub_id{ + ch_load_rsvd, + ch_load_rep_info +}; + +/* IEEE 802.11-2012 Table 8-61 Reporting condition for channel load Report */ +enum ch_load_cound_id{ + ch_load_cond_immediately, /* default */ + ch_load_cond_anpi_equal_greater, + ch_load_cond_anpi_equal_less, + ch_load_cond_max +}; + +/* +* Noise histogram +*/ +/* IEEE 802.11-2012 Table 8-62 optional subelement IDs for noise histogram */ +enum noise_histo_opt_sub_id{ + noise_histo_rsvd, + noise_histo_rep_info +}; + +/* IEEE 802.11-2012 Table 8-63 Reporting condition for noise historgarm Report */ +enum noise_histo_cound_id{ + noise_histo_cond_immediately, /* default */ + noise_histo_cond_anpi_equal_greater, + noise_histo_cond_anpi_equal_less, + noise_histo_cond_max +}; + +struct meas_req_opt { + /* report condition */ + struct opt_rep_info rep_cond; +}; + +/* +* State machine +*/ + +enum RM_STATE { + RM_ST_IDLE, + RM_ST_DO_MEAS, + RM_ST_WAIT_MEAS, + RM_ST_SEND_REPORT, + RM_ST_RECV_REPORT, + RM_ST_END, + RM_ST_MAX +}; + +struct rm_meas_req { + u8 category; + u8 action_code; /* T8-206 */ + u8 diag_token; + u16 rpt; + + u8 e_id; + u8 len; + u8 m_token; + u8 m_mode; /* req:F8-105, rep:F8-141 */ + u8 m_type; /* T8-59 */ + u8 op_class; + u8 ch_num; + u16 rand_intvl; /* units of TU */ + u16 meas_dur; /* units of TU */ + + u8 bssid[6]; /* for bcn_req */ + + u8 *pssid; + u8 *opt_s_elem_start; + int opt_s_elem_len; + + union { + struct bcn_req_opt bcn; + struct meas_req_opt clm; + struct meas_req_opt nhm; + }opt; + + struct rtw_ieee80211_channel ch_set[MAX_OP_CHANNEL_SET_NUM]; + u8 ch_set_ch_amount; +}; + +struct rm_meas_rep { + u8 category; + u8 action_code; /* T8-206 */ + u8 diag_token; + + u8 e_id; /* T8-54, 38 request; 39 report */ + u8 len; + u8 m_token; + u8 m_mode; /* req:F8-105, rep:F8-141 */ + u8 m_type; /* T8-59 */ + u8 op_class; + u8 ch_num; + + u8 ch_load; + u8 anpi; + u8 ipi[11]; + + u16 rpt; + u8 bssid[6]; /* for bcn_req */ +}; + +#define MAX_BUF_NUM 128 +struct data_buf { + u8 *pbuf; + u16 len; +}; + +struct rm_obj { + + /* aid << 16 + |diag_token << 8 + |B(1) 1/0:All_AID/UNIC + |B(0) 1/0:RM_MASTER/RM_SLAVE */ + u32 rmid; + + enum RM_STATE state; + struct rm_meas_req q; + struct rm_meas_rep p; + struct sta_info *psta; + struct rm_clock *pclock; + + /* meas report */ + u64 meas_start_time; + u64 meas_end_time; + int wait_busy; + u8 poll_mode; + + struct data_buf buf[MAX_BUF_NUM]; + + _list list; +}; + +/* +* Measurement +*/ +struct opt_subelement { + u8 id; + u8 length; + u8 *data; +}; + +/* 802.11-2012 Table 8-206 Radio Measurment Action field */ +enum rm_action_code { + RM_ACT_RADIO_MEAS_REQ, + RM_ACT_RADIO_MEAS_REP, + RM_ACT_LINK_MEAS_REQ, + RM_ACT_LINK_MEAS_REP, + RM_ACT_NB_REP_REQ, /* 4 */ + RM_ACT_NB_REP_RESP, + RM_ACT_RESV, + RM_ACT_MAX +}; + +/* 802.11-2012 Table 8-119 RM Enabled Capabilities definition */ +enum rm_cap_en { + RM_LINK_MEAS_CAP_EN, + RM_NB_REP_CAP_EN, /* neighbor report */ + RM_PARAL_MEAS_CAP_EN, /* parallel report */ + RM_REPEAT_MEAS_CAP_EN, + RM_BCN_PASSIVE_MEAS_CAP_EN, + RM_BCN_ACTIVE_MEAS_CAP_EN, + RM_BCN_TABLE_MEAS_CAP_EN, + RM_BCN_MEAS_REP_COND_CAP_EN, /* conditions */ + + RM_FRAME_MEAS_CAP_EN, + RM_CH_LOAD_CAP_EN, + RM_NOISE_HISTO_CAP_EN, /* noise historgram */ + RM_STATIS_MEAS_CAP_EN, /* statistics */ + RM_LCI_MEAS_CAP_EN, /* 12 */ + RM_LCI_AMIMUTH_CAP_EN, + RM_TRANS_STREAM_CAT_MEAS_CAP_EN, + RM_TRIG_TRANS_STREAM_CAT_MEAS_CAP_EN, + + RM_AP_CH_REP_CAP_EN, + RM_RM_MIB_CAP_EN, + RM_OP_CH_MAX_MEAS_DUR0, /* 18-20 */ + RM_OP_CH_MAX_MEAS_DUR1, + RM_OP_CH_MAX_MEAS_DUR2, + RM_NONOP_CH_MAX_MEAS_DUR0, /* 21-23 */ + RM_NONOP_CH_MAX_MEAS_DUR1, + RM_NONOP_CH_MAX_MEAS_DUR2, + + RM_MEAS_PILOT_CAP0, /* 24-26 */ + RM_MEAS_PILOT_CAP1, + RM_MEAS_PILOT_CAP2, + RM_MEAS_PILOT_TRANS_INFO_CAP_EN, + RM_NB_REP_TSF_OFFSET_CAP_EN, + RM_RCPI_MEAS_CAP_EN, /* 29 */ + RM_RSNI_MEAS_CAP_EN, + RM_BSS_AVG_ACCESS_DELAY_CAP_EN, + + RM_AVALB_ADMIS_CAPACITY_CAP_EN, + RM_ANT_CAP_EN, + RM_RSVD, /* 34-39 */ + RM_MAX +}; + +char *rm_state_name(enum RM_STATE state); +char *rm_event_name(enum RM_EV_ID evid); +char *rm_type_req_name(u8 meas_type); +int _rm_post_event(_adapter *padapter, u32 rmid, enum RM_EV_ID evid); +int rm_enqueue_rmobj(_adapter *padapter, struct rm_obj *obj, bool to_head); + +void rm_free_rmobj(struct rm_obj *prm); +struct rm_obj *rm_alloc_rmobj(_adapter *padapter); +struct rm_obj *rm_get_rmobj(_adapter *padapter, u32 rmid); +struct sta_info *rm_get_psta(_adapter *padapter, u32 rmid); + +int retrieve_radio_meas_result(struct rm_obj *prm); +int rm_radio_meas_report_cond(struct rm_obj *prm); +int rm_recv_radio_mens_req(_adapter *padapter, + union recv_frame *precv_frame,struct sta_info *psta); +int rm_recv_radio_mens_rep(_adapter *padapter, + union recv_frame *precv_frame, struct sta_info *psta); +int rm_radio_mens_nb_rep(_adapter *padapter, + union recv_frame *precv_frame, struct sta_info *psta); +int issue_null_reply(struct rm_obj *prm); +int issue_beacon_rep(struct rm_obj *prm); +int issue_nb_req(struct rm_obj *prm); +int issue_radio_meas_req(struct rm_obj *prm); +int issue_radio_meas_rep(struct rm_obj *prm); + +void rm_set_rep_mode(struct rm_obj *prm, u8 mode); + +int ready_for_scan(struct rm_obj *prm); +int rm_sitesurvey(struct rm_obj *prm); + +#endif /*CONFIG_RTW_80211K*/ +#endif /*__RTW_RM_FSM_H_*/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rson.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rson.h new file mode 100644 index 000000000000..6996738b071a --- /dev/null +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_rson.h @@ -0,0 +1,61 @@ +/****************************************************************************** + * + * 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 + * + * + ******************************************************************************/ +#ifndef __RTW_RSON_H_ +#define __RTW_RSON_H_ + + +#define RTW_RSON_VER 1 + +#define RTW_RSON_SCORE_NOTSUP 0x0 +#define RTW_RSON_SCORE_NOTCNNT 0x1 +#define RTW_RSON_SCORE_MAX 0xFF +#define RTW_RSON_HC_NOTREADY 0xFF +#define RTW_RSON_HC_ROOT 0x0 +#define RTW_RSON_ALLOWCONNECT 0x1 +#define RTW_RSON_DENYCONNECT 0x0 + + + +/* for rtw self-origanization spec 1 */ +struct rtw_rson_struct { + u8 ver; + u32 id; + u8 hopcnt; + u8 connectible; + u8 loading; + u8 res[16]; +} __attribute__((__packed__)); + +void init_rtw_rson_data(struct dvobj_priv *dvobj); +void rtw_rson_get_property_str(_adapter *padapter, char *rson_data_str); +int rtw_rson_set_property(_adapter *padapter, char *field, char *value); +int rtw_rson_choose(struct wlan_network **candidate, struct wlan_network *competitor); +int rtw_get_rson_struct(WLAN_BSSID_EX *bssid, struct rtw_rson_struct *rson_data); +u8 rtw_cal_rson_score(struct rtw_rson_struct *cand_rson_data, NDIS_802_11_RSSI Rssi); +void rtw_rson_handle_ie(WLAN_BSSID_EX *bssid, u8 ie_offset); +u32 rtw_rson_append_ie(_adapter *padapter, unsigned char *pframe, u32 *len); +void rtw_rson_do_disconnect(_adapter *padapter); +void rtw_rson_join_done(_adapter *padapter); +int rtw_rson_isupdate_roamcan(struct mlme_priv *mlme, struct wlan_network **candidate, struct wlan_network *competitor); +void rtw_rson_show_survey_info(struct seq_file *m, _list *plist, _list *phead); +u8 rtw_rson_ap_check_sta(_adapter *padapter, u8 *pframe, uint pkt_len, unsigned short ie_offset); +u8 rtw_rson_scan_wk_cmd(_adapter *padapter, int op); +void rtw_rson_scan_cmd_hdl(_adapter *padapter, int op); +#endif /* __RTW_RSON_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sdio.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sdio.h index da86a3a408d5..7490b5481328 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sdio.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sdio.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2015 - 2016 Realtek Corporation. All rights reserved. + * Copyright(c) 2015 - 2017 Realtek Corporation. * * 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 @@ -11,11 +11,7 @@ * 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 - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_SDIO_H_ #define _RTW_SDIO_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_security.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_security.h index df1a97397ffe..ad96a545f705 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_security.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_security.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_SECURITY_H_ #define __RTW_SECURITY_H_ @@ -141,6 +136,7 @@ struct security_priv { union Keytype dot118021XGrprxmickey[4]; union pn48 dot11Grptxpn; /* PN48 used for Grp Key xmit. */ union pn48 dot11Grprxpn; /* PN48 used for Grp Key recv. */ + u8 iv_seq[4][8]; #ifdef CONFIG_IEEE80211W u32 dot11wBIPKeyid; /* key id used for BIP Key ( tx key index) */ union Keytype dot11wBIPKey[6]; /* BIP Key, for index4 and index5 */ @@ -174,7 +170,6 @@ struct security_priv { u8 binstallBIPkey; #endif /* CONFIG_IEEE80211W */ u8 busetkipkey; - /* _timer tkip_timer; */ u8 bcheck_grpkey; u8 bgrpkey_handshake; @@ -203,10 +198,10 @@ struct security_priv { /* for tkip countermeasure */ - u32 last_mic_err_time; + systime last_mic_err_time; u8 btkip_countermeasure; u8 btkip_wait_report; - u32 btkip_countermeasure_time; + systime btkip_countermeasure_time; /* --------------------------------------------------------------------------- */ /* For WPA2 Pre-Authentication. */ @@ -406,11 +401,6 @@ static inline u32 rotr(u32 val, int bits) (a)[7] = (u8) (((u64) (val)) & 0xff); \ } while (0) -/* ===== start - public domain SHA256 implementation ===== */ - -/* This is based on SHA256 implementation in LibTomCrypt that was released into - * public domain by Tom St Denis. */ - /* the K array */ static const unsigned long K[64] = { 0x428a2f98UL, 0x71374491UL, 0xb5c0fbcfUL, 0xe9b5dba5UL, 0x3956c25bUL, @@ -481,8 +471,6 @@ int tdls_verify_mic(u8 *kck, u8 trans_seq, u8 *lnkid, u8 *rsnie, u8 *timeoutie, u8 *ftie); #endif /* CONFIG_TDLS */ -void rtw_use_tkipkey_handler(RTW_TIMER_HDL_ARGS); - void rtw_sec_restore_wep_key(_adapter *adapter); u8 rtw_handle_tkip_countermeasure(_adapter *adapter, const char *caller); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sreset.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sreset.h index 0ecdfc7eb64f..f02cfb6e18c8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sreset.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_sreset.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_SRESET_H_ #define _RTW_SRESET_H_ @@ -32,10 +27,23 @@ struct sreset_priv { _mutex silentreset_mutex; u8 silent_reset_inprogress; u8 Wifi_Error_Status; - unsigned long last_tx_time; - unsigned long last_tx_complete_time; + systime last_tx_time; + systime last_tx_complete_time; s32 dbg_trigger_point; + u64 self_dect_tx_cnt; + u64 self_dect_rx_cnt; + u64 self_dect_fw_cnt; + u64 self_dect_scan_cnt; + u64 txbuf_empty_cnt; + u64 tx_dma_status_cnt; + u64 rx_dma_status_cnt; + u8 rx_cnt; + u8 self_dect_fw; + u8 self_dect_scan; + u8 is_txbuf_empty; + u8 self_dect_case; + u8 dbg_sreset_ctrl; }; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_tdls.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_tdls.h index ad16d6660a80..9e3e811259ae 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_tdls.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_tdls.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_TDLS_H_ #define __RTW_TDLS_H_ @@ -63,13 +58,23 @@ enum TDLS_CH_SW_CHNL { TDLS_CH_SW_OFF_CHNL }; +#define TDLS_MIC_CTRL_LEN 2 +#define TDLS_FTIE_DATA_LEN (TDLS_MIC_CTRL_LEN + TDLS_MIC_LEN + \ + WPA_NONCE_LEN + WPA_NONCE_LEN) struct wpa_tdls_ftie { u8 ie_type; /* FTIE */ u8 ie_len; - u8 mic_ctrl[2]; - u8 mic[TDLS_MIC_LEN]; - u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ - u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ + union { + struct { + u8 mic_ctrl[TDLS_MIC_CTRL_LEN]; + u8 mic[TDLS_MIC_LEN]; + u8 Anonce[WPA_NONCE_LEN]; /* Responder Nonce in TDLS */ + u8 Snonce[WPA_NONCE_LEN]; /* Initiator Nonce in TDLS */ + }; + struct { + u8 data[TDLS_FTIE_DATA_LEN]; + }; + }; /* followed by optional elements */ } ; @@ -103,14 +108,21 @@ static u8 TDLS_SRC[] = { 0x01, 0x01, 0x02, 0x03, 0x04, 0x0c, 0x16, 0x17, 0x18, 0 int check_ap_tdls_prohibited(u8 *pframe, u8 pkt_len); int check_ap_tdls_ch_switching_prohibited(u8 *pframe, u8 pkt_len); +void rtw_set_tdls_enable(_adapter *padapter, u8 enable); +u8 rtw_is_tdls_enabled(_adapter *padapter); +u8 rtw_is_tdls_sta_existed(_adapter *padapter); u8 rtw_tdls_is_setup_allowed(_adapter *padapter); #ifdef CONFIG_TDLS_CH_SW u8 rtw_tdls_is_chsw_allowed(_adapter *padapter); #endif +void rtw_tdls_set_link_established(_adapter *adapter, bool en); void rtw_reset_tdls_info(_adapter *padapter); int rtw_init_tdls_info(_adapter *padapter); void rtw_free_tdls_info(struct tdls_info *ptdlsinfo); +void rtw_free_all_tdls_sta(_adapter *padapter, u8 from_cmd_thread); +void rtw_enable_tdls_func(_adapter *padapter); +void rtw_disable_tdls_func(_adapter *padapter, u8 from_cmd_thread); int issue_nulldata_to_TDLS_peer_STA(_adapter *padapter, unsigned char *da, unsigned int power_mode, int try_cnt, int wait_ms); void rtw_init_tdls_timer(_adapter *padapter, struct sta_info *psta); void rtw_free_tdls_timer(struct sta_info *psta); @@ -140,31 +152,30 @@ int issue_tdls_ch_switch_req(_adapter *padapter, struct sta_info *ptdls_sta); int issue_tdls_ch_switch_rsp(_adapter *padapter, struct tdls_txmgmt *ptxmgmt, int wait_ack); #endif sint On_TDLS_Dis_Rsp(_adapter *adapter, union recv_frame *precv_frame); -sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame); -int On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame); -int On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame); +sint On_TDLS_Setup_Req(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); +int On_TDLS_Setup_Rsp(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); +int On_TDLS_Setup_Cfm(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); int On_TDLS_Dis_Req(_adapter *adapter, union recv_frame *precv_frame); -int On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame); -int On_TDLS_Peer_Traffic_Indication(_adapter *adapter, union recv_frame *precv_frame); -int On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame); +int On_TDLS_Teardown(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); +int On_TDLS_Peer_Traffic_Indication(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); +int On_TDLS_Peer_Traffic_Rsp(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); #ifdef CONFIG_TDLS_CH_SW -sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame); -sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame); -void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); +sint On_TDLS_Ch_Switch_Req(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); +sint On_TDLS_Ch_Switch_Rsp(_adapter *adapter, union recv_frame *precv_frame, struct sta_info *ptdls_sta); +void rtw_build_tdls_ch_switch_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); +void rtw_build_tdls_ch_switch_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); #endif -void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); +void rtw_build_tdls_setup_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); +void rtw_build_tdls_setup_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); +void rtw_build_tdls_setup_cfm_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); +void rtw_build_tdls_teardown_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); void rtw_build_tdls_dis_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); void rtw_build_tdls_dis_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, u8 privacy); -void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); -void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt); +void rtw_build_tdls_peer_traffic_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); +void rtw_build_tdls_peer_traffic_indication_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe, struct tdls_txmgmt *ptxmgmt, struct sta_info *ptdls_sta); void rtw_build_tunneled_probe_req_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe); void rtw_build_tunneled_probe_rsp_ies(_adapter *padapter, struct xmit_frame *pxmitframe, u8 *pframe); -u32 update_mask_tdls(_adapter *padapter, struct sta_info *psta); int rtw_tdls_is_driver_setup(_adapter *padapter); void rtw_tdls_set_key(_adapter *padapter, struct sta_info *ptdls_sta); const char *rtw_tdls_action_txt(enum TDLS_ACTION_FIELD action); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_version.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_version.h index e5a588ef2a2e..4467cb239648 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_version.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_version.h @@ -1,2 +1,2 @@ -#define DRIVERVERSION "v5.1.1.5_20523.20161209_BTCOEX20161208-1212" -#define BTCOEXVERSION "BTCOEX20161208-1212" +#define DRIVERVERSION "v5.2.15.1_25011.20171107_COEX20171025-2020" +#define BTCOEXVERSION "COEX20171025-2020" diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_vht.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_vht.h index 1d886bbd5d51..31988955d80e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_vht.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_vht.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_VHT_H_ #define _RTW_VHT_H_ @@ -30,15 +25,6 @@ #define STBC_VHT_TEST_TX_ENABLE BIT2 #define STBC_VHT_CAP_TX BIT3 -#define BEAMFORMING_VHT_BEAMFORMER_ENABLE BIT0 /* Declare our NIC supports beamformer */ -#define BEAMFORMING_VHT_BEAMFORMEE_ENABLE BIT1 /* Declare our NIC supports beamformee */ -#define BEAMFORMING_VHT_MU_MIMO_AP_ENABLE BIT2 /*Declare our NIC support MU-MIMO AP mode*/ -#define BEAMFORMING_VHT_MU_MIMO_STA_ENABLE BIT3 /*Declare our NIC support MU-MIMO STA mode*/ -#define BEAMFORMING_VHT_BEAMFORMER_TEST BIT4 /*Transmiting Beamforming no matter the target supports it or not*/ -#define BEAMFORMING_VHT_BEAMFORMER_STS_CAP (BIT8 | BIT9 | BIT10) /*Asoc rsp cap*/ -#define BEAMFORMING_VHT_BEAMFORMEE_SOUND_DIM (BIT12 | BIT13 | BIT14) /*Asoc rsp cap*/ - - /* VHT capability info */ #define SET_VHT_CAPABILITY_ELE_MAX_MPDU_LENGTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 0, 2, _val) #define SET_VHT_CAPABILITY_ELE_CHL_WIDTH(_pEleStart, _val) SET_BITS_TO_LE_1BYTE(_pEleStart, 2, 2, _val) @@ -126,7 +112,7 @@ struct vht_priv { u8 rtw_get_vht_highest_rate(u8 *pvht_mcs_map); u16 rtw_vht_mcs_to_data_rate(u8 bw, u8 short_GI, u8 vht_mcs_rate); -u64 rtw_vht_rate_to_bitmap(u8 *pVHTRate); +u64 rtw_vht_mcs_map_to_bitmap(u8 *mcs_map, u8 nss); void rtw_vht_use_default_setting(_adapter *padapter); u32 rtw_build_vht_operation_ie(_adapter *padapter, u8 *pbuf, u8 channel); u32 rtw_build_vht_op_mode_notify_ie(_adapter *padapter, u8 *pbuf, u8 bw); @@ -139,5 +125,7 @@ void rtw_process_vht_op_mode_notify(_adapter *padapter, u8 *pframe, PVOID sta); u32 rtw_restructure_vht_ie(_adapter *padapter, u8 *in_ie, u8 *out_ie, uint in_len, uint *pout_len); void VHTOnAssocRsp(_adapter *padapter); u8 rtw_vht_mcsmap_to_nss(u8 *pvht_mcs_map); - +void rtw_vht_nss_to_mcsmap(u8 nss, u8 *target_mcs_map, u8 *cur_mcs_map); +void rtw_vht_ies_attach(_adapter *padapter, WLAN_BSSID_EX *pcur_network); +void rtw_vht_ies_detach(_adapter *padapter, WLAN_BSSID_EX *pcur_network); #endif /* _RTW_VHT_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wapi.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wapi.h index 635aec0db4ee..26f2855d8717 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wapi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wapi.h @@ -1,3 +1,17 @@ +/****************************************************************************** + * + * Copyright(c) 2016 - 2017 Realtek Corporation. + * + * 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. + * + *****************************************************************************/ #ifndef __INC_WAPI_H #define __INC_WAPI_H @@ -179,7 +193,7 @@ u8 rtw_wapi_is_wai_packet(_adapter *padapter, u8 *pkt_data); void rtw_wapi_update_info(_adapter *padapter, union recv_frame *precv_frame); -u8 rtw_wapi_check_for_drop(_adapter *padapter, union recv_frame *precv_frame); +u8 rtw_wapi_check_for_drop(_adapter *padapter, union recv_frame *precv_frame, u8 *ehdr_ops); void rtw_build_probe_resp_wapi_ie(_adapter *padapter, unsigned char *pframe, struct pkt_attrib *pattrib); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wifi_regd.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wifi_regd.h index 2182712648bd..f56008cf7c4b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wifi_regd.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_wifi_regd.h @@ -1,6 +1,15 @@ /****************************************************************************** * - * Copyright(c) 2009-2010 Realtek Corporation. + * Copyright(c) 2009-2010 - 2017 Realtek Corporation. + * + * 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. * *****************************************************************************/ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_xmit.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_xmit.h index 7ae57e1f9e78..0ee90199df3a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_xmit.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/rtw_xmit.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_XMIT_H_ #define _RTW_XMIT_H_ @@ -57,7 +52,11 @@ #define NR_XMITBUFF (4) #endif /* CONFIG_SINGLE_XMIT_BUF */ #elif defined (CONFIG_PCI_HCI) +#ifdef CONFIG_TX_AMSDU + #define MAX_XMITBUF_SZ (3500) +#else #define MAX_XMITBUF_SZ (1664) +#endif #define NR_XMITBUFF (128) #endif @@ -85,7 +84,7 @@ #endif #ifdef CONFIG_RTL8812A - #define MAX_CMDBUF_SZ (512*14) + #define MAX_CMDBUF_SZ (512 * 17) #elif defined(CONFIG_RTL8723D) && defined(CONFIG_LPS_POFF) #define MAX_CMDBUF_SZ (128*70) /*(8960)*/ #else @@ -114,11 +113,7 @@ #ifdef CONFIG_TRX_BD_ARCH #define TX_BD_NUM (128+1) /* +1 result from ring buffer */ #else - /* #define TXDESC_NUM 64 */ - #define TXDESC_NUM 128 - #define TXBD_NUM TXDESC_NUM - #define TXDESC_NUM_BE_QUEUE 128 - #define TXBD_NUM_RSVD 2 + #define TXDESC_NUM 128 #endif #endif @@ -158,6 +153,18 @@ dot11txpn.val = dot11txpn.val == 0xffffffffffffULL ? 0 : (dot11txpn.val+1);\ } while (0) +/* Check if AMPDU Tx is supported or not. If it is supported, +* it need to check "amsdu in ampdu" is supported or not. +* (ampdu_en, amsdu_ampdu_en) = +* (0, x) : AMPDU is not enable, but AMSDU is valid to send. +* (1, 0) : AMPDU is enable, AMSDU in AMPDU is not enable. So, AMSDU is not valid to send. +* (1, 1) : AMPDU and AMSDU in AMPDU are enable. So, AMSDU is valid to send. +*/ +#define IS_AMSDU_AMPDU_NOT_VALID(pattrib)\ + ((pattrib->ampdu_en == _TRUE) && (pattrib->amsdu_ampdu_en == _FALSE)) + +#define IS_AMSDU_AMPDU_VALID(pattrib)\ + !((pattrib->ampdu_en == _TRUE) && (pattrib->amsdu_ampdu_en == _FALSE)) #define HWXMIT_ENTRY 4 @@ -312,6 +319,21 @@ struct rtw_tx_ring { u16 hw_rp_cache; #endif }; + +#ifdef DBG_TXBD_DESC_DUMP + +#define TX_BAK_FRMAE_CNT 10 +#define TX_BAK_DESC_LEN 48 /* byte */ +#define TX_BAK_DATA_LEN 30 /* byte */ + +struct rtw_tx_desc_backup { + int tx_bak_rp; + int tx_bak_wp; + u8 tx_bak_desc[TX_BAK_DESC_LEN]; + u8 tx_bak_data_hdr[TX_BAK_DATA_LEN]; + u8 tx_desc_size; +}; +#endif #endif struct hw_xmit { @@ -412,6 +434,8 @@ struct pkt_attrib { u8 sgi;/* short GI */ u8 ampdu_en;/* tx ampdu enable */ u8 ampdu_spacing; /* ampdu_min_spacing for peer sta's rx */ + u8 amsdu; + u8 amsdu_ampdu_en;/* tx amsdu in ampdu enable */ u8 mdata;/* more data bit */ u8 pctrl;/* per packet txdesc control enable */ u8 triggered;/* for ap mode handling Power Saving sta */ @@ -424,6 +448,10 @@ struct pkt_attrib { u8 mbssid; u8 ldpc; u8 stbc; +#ifdef CONFIG_WMMPS_STA + u8 trigger_frame; +#endif /* CONFIG_WMMPS_STA */ + struct sta_info *psta; #ifdef CONFIG_TCP_CSUM_OFFLOAD_TX u8 hw_tcp_csum; @@ -446,11 +474,27 @@ struct pkt_attrib { #ifdef CONFIG_BEAMFORMING u16 txbf_p_aid;/*beamforming Partial_AID*/ u16 txbf_g_id;/*beamforming Group ID*/ + + /* + * 2'b00: Unicast NDPA + * 2'b01: Broadcast NDPA + * 2'b10: Beamforming Report Poll + * 2'b11: Final Beamforming Report Poll + */ + u8 bf_pkt_type; #endif }; #endif +#ifdef CONFIG_TX_AMSDU +enum { + RTW_AMSDU_TIMER_UNSET = 0, + RTW_AMSDU_TIMER_SETTING, + RTW_AMSDU_TIMER_TIMEOUT, +}; +#endif + #define WLANHDR_OFFSET 64 #define NULL_FRAMETAG (0x0) @@ -475,7 +519,7 @@ enum { bool rtw_xmit_ac_blocked(_adapter *adapter); struct submit_ctx { - u32 submit_time; /* */ + systime submit_time; /* */ u32 timeout_ms; /* <0: not synchronous, 0: wait forever, >0: up to ms waiting */ int status; /* status for operation */ #ifdef PLATFORM_LINUX @@ -497,6 +541,7 @@ enum { RTW_SCTX_DONE_DRV_STOP, RTW_SCTX_DONE_DEV_REMOVE, RTW_SCTX_DONE_CMD_ERROR, + RTW_SCTX_DONE_CMD_DROP, RTX_SCTX_CSTR_WAIT_RPT2, }; @@ -678,7 +723,6 @@ struct xmit_priv { _lock lock; _sema xmit_sema; - _sema terminate_xmitthread_sema; /* _queue blk_strms[MAX_NUMBLKS]; */ _queue be_pending; @@ -768,7 +812,6 @@ struct xmit_priv { #else _thread_hdl_ SdioXmitThread; _sema SdioXmitSema; - _sema SdioXmitTerminateSema; #endif /* CONFIG_SDIO_TX_TASKLET */ #endif /* CONFIG_SDIO_HCI */ @@ -803,7 +846,31 @@ struct xmit_priv { struct submit_ctx ack_tx_ops; u8 seq_no; #endif + +#ifdef CONFIG_TX_AMSDU + _timer amsdu_vo_timer; + u8 amsdu_vo_timeout; + + _timer amsdu_vi_timer; + u8 amsdu_vi_timeout; + + _timer amsdu_be_timer; + u8 amsdu_be_timeout; + + _timer amsdu_bk_timer; + u8 amsdu_bk_timeout; + + u32 amsdu_debug_set_timer; + u32 amsdu_debug_timeout; + u32 amsdu_debug_coalesce_one; + u32 amsdu_debug_coalesce_two; + +#endif +#ifdef DBG_TXBD_DESC_DUMP + BOOLEAN dump_txbd_desc; +#endif _lock lock_sctx; + }; extern struct xmit_frame *__rtw_alloc_cmdxmitframe(struct xmit_priv *pxmitpriv, @@ -835,6 +902,11 @@ void rtw_count_tx_stats(_adapter *padapter, struct xmit_frame *pxmitframe, int s extern void rtw_update_protection(_adapter *padapter, u8 *ie, uint ie_len); static s32 update_attrib_sec_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); static void update_attrib_phy_info(_adapter *padapter, struct pkt_attrib *pattrib, struct sta_info *psta); + +#ifdef CONFIG_WMMPS_STA +static void update_attrib_trigger_frame_info(_adapter *padapter, struct pkt_attrib *pattrib); +#endif /* CONFIG_WMMPS_STA */ + extern s32 rtw_make_wlanhdr(_adapter *padapter, u8 *hdr, struct pkt_attrib *pattrib); extern s32 rtw_put_snap(u8 *data, u16 h_proto); @@ -896,13 +968,6 @@ u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw); u8 rtw_get_tx_bw_bmp_of_ht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw); u8 rtw_get_tx_bw_bmp_of_vht_rate(struct dvobj_priv *dvobj, u8 rate, u8 max_bw); - -void rtw_get_adapter_tx_rate_bmp_by_bw(_adapter *adapter, u8 bw, u16 *r_bmp_cck_ofdm, u32 *r_bmp_ht, u32 *r_bmp_vht); -void rtw_update_tx_rate_bmp(struct dvobj_priv *dvobj); -u16 rtw_get_tx_rate_bmp_cck_ofdm(struct dvobj_priv *dvobj); -u32 rtw_get_tx_rate_bmp_ht_by_bw(struct dvobj_priv *dvobj, u8 bw); -u32 rtw_get_tx_rate_bmp_vht_by_bw(struct dvobj_priv *dvobj, u8 bw); - u8 query_ra_short_GI(struct sta_info *psta, u8 bw); u8 qos_acm(u8 acm_mask, u8 priority); @@ -916,6 +981,29 @@ sint check_pending_xmitbuf(struct xmit_priv *pxmitpriv); thread_return rtw_xmit_thread(thread_context context); #endif +#ifdef CONFIG_TX_AMSDU +extern void rtw_amsdu_vo_timeout_handler(void *FunctionContext); +extern void rtw_amsdu_vi_timeout_handler(void *FunctionContext); +extern void rtw_amsdu_be_timeout_handler(void *FunctionContext); +extern void rtw_amsdu_bk_timeout_handler(void *FunctionContext); + +extern u8 rtw_amsdu_get_timer_status(_adapter *padapter, u8 priority); +extern void rtw_amsdu_set_timer_status(_adapter *padapter, u8 priority, u8 status); +extern void rtw_amsdu_set_timer(_adapter *padapter, u8 priority); +extern void rtw_amsdu_cancel_timer(_adapter *padapter, u8 priority); + +extern s32 rtw_xmitframe_coalesce_amsdu(_adapter *padapter, struct xmit_frame *pxmitframe, struct xmit_frame *pxmitframe_queue); +extern s32 check_amsdu(struct xmit_frame *pxmitframe); +extern s32 check_amsdu_tx_support(_adapter *padapter); +extern struct xmit_frame *rtw_get_xframe(struct xmit_priv *pxmitpriv, int *num_frame); +#endif + +#ifdef DBG_TXBD_DESC_DUMP +void rtw_tx_desc_backup(_adapter *padapter, struct xmit_frame *pxmitframe, u8 desc_size, u8 hwq); +void rtw_tx_desc_backup_reset(void); +u8 rtw_get_tx_desc_backup(_adapter *padapter, u8 hwq, struct rtw_tx_desc_backup **pbak); +#endif + static void do_queue_select(_adapter *padapter, struct pkt_attrib *pattrib); u32 rtw_get_ff_hwaddr(struct xmit_frame *pxmitframe); @@ -924,6 +1012,21 @@ int rtw_ack_tx_wait(struct xmit_priv *pxmitpriv, u32 timeout_ms); void rtw_ack_tx_done(struct xmit_priv *pxmitpriv, int status); #endif /* CONFIG_XMIT_ACK */ +enum XMIT_BLOCK_REASON { + XMIT_BLOCK_NONE = 0, + XMIT_BLOCK_REDLMEM = BIT0, /*LPS-PG*/ + XMIT_BLOCK_SUSPEND = BIT1, /*WOW*/ + XMIT_BLOCK_MAX = 0xFF, +}; +void rtw_init_xmit_block(_adapter *padapter); +void rtw_deinit_xmit_block(_adapter *padapter); + +#ifdef DBG_XMIT_BLOCK +void dump_xmit_block(void *sel, _adapter *padapter); +#endif +void rtw_set_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason); +void rtw_clr_xmit_block(_adapter *padapter, enum XMIT_BLOCK_REASON reason); +bool rtw_is_xmit_blocked(_adapter *padapter); /* include after declaring struct xmit_buf, in order to avoid warning */ #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_hal.h index c8f554d676d6..62e7f79d9506 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_HAL_H__ #define __SDIO_HAL_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops.h index 827c7252505f..95d34d6f06b2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_OPS_H__ #define __SDIO_OPS_H__ @@ -50,6 +45,12 @@ struct async_context { extern void sdio_set_intf_ops(_adapter *padapter, struct _io_ops *pops); +void dump_sdio_card_info(void *sel, struct dvobj_priv *dvobj); + +u32 sdio_init(struct dvobj_priv *dvobj); +void sdio_deinit(struct dvobj_priv *dvobj); +int sdio_alloc_irq(struct dvobj_priv *dvobj); +void sdio_free_irq(struct dvobj_priv *dvobj); #if 0 extern void sdio_func1cmd52_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *rmem); @@ -90,10 +91,10 @@ void ClearInterrupt8821AS(PADAPTER padapter); #endif /* CONFIG_RTL8821A */ #if defined(CONFIG_WOWLAN) || defined(CONFIG_AP_WOWLAN) -#ifdef CONFIG_RTL8821C +#if defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822B) u8 rtw_hal_enable_cpwm2(_adapter *adapter); #endif -extern u8 RecvOnePkt(PADAPTER padapter, u32 size); +extern u8 RecvOnePkt(PADAPTER padapter); #endif /* CONFIG_WOWLAN */ #ifdef CONFIG_RTL8723B extern void InitInterrupt8723BSdio(PADAPTER padapter); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_ce.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_ce.h index 59ca38127cb3..d542cb7ea206 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_ce.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_ce.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _SDIO_OPS_WINCE_H_ #define _SDIO_OPS_WINCE_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_linux.h index 46c3ddceee2d..4bbd8fe7ff68 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_linux.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_OPS_LINUX_H__ #define __SDIO_OPS_LINUX_H__ @@ -40,14 +35,24 @@ void _sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); void sd_write32(struct intf_hdl *pintfhdl, u32 addr, u32 v, s32 *err); #endif /* RTW_HALMAC */ +bool rtw_is_sdio30(_adapter *adapter); + +/* The unit of return value is Hz */ +static inline u32 rtw_sdio_get_clock(struct dvobj_priv *d) +{ + return d->intf_data.clock; +} + s32 _sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); s32 sd_read(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); s32 _sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata); void rtw_sdio_set_irq_thd(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl); -int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, int addr, +int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, unsigned int addr, void *buf, size_t len, bool fixed); -int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, int addr, +int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, unsigned int addr, void *buf, size_t len, bool fixed); -#endif + +#endif /* __SDIO_OPS_LINUX_H__ */ + diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_xp.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_xp.h index 5020365c3589..d3d8764d3878 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_xp.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_ops_xp.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _SDIO_OPS_XP_H_ #define _SDIO_OPS_XP_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_osintf.h index d2906bd1d8a6..7c2abd14d2af 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sdio_osintf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __SDIO_OSINTF_H__ #define __SDIO_OSINTF_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sta_info.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sta_info.h index b8d60c943d93..468f0f85aa68 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sta_info.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/sta_info.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,15 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __STA_INFO_H_ #define __STA_INFO_H_ +#include #define IBSS_START_MAC_ID 2 #define NUM_STA MACID_NUM_SW_LIMIT @@ -27,6 +23,11 @@ #ifndef CONFIG_RTW_MACADDR_ACL #define CONFIG_RTW_MACADDR_ACL 1 #endif + +#ifndef CONFIG_RTW_PRE_LINK_STA + #define CONFIG_RTW_PRE_LINK_STA 0 +#endif + #define NUM_ACL 16 #define RTW_ACL_MODE_DISABLED 0 #define RTW_ACL_MODE_ACCEPT_UNLESS_LISTED 1 @@ -38,6 +39,21 @@ extern const char *const _acl_mode_str[]; #define acl_mode_str(mode) (((mode) >= RTW_ACL_MODE_MAX) ? _acl_mode_str[RTW_ACL_MODE_DISABLED] : _acl_mode_str[(mode)]) #endif +#ifndef RTW_PRE_LINK_STA_NUM + #define RTW_PRE_LINK_STA_NUM 8 +#endif + +struct pre_link_sta_node_t { + u8 valid; + u8 addr[ETH_ALEN]; +}; + +struct pre_link_sta_ctl_t { + _lock lock; + u8 num; + struct pre_link_sta_node_t node[RTW_PRE_LINK_STA_NUM]; +}; + #ifdef CONFIG_TDLS #define MAX_ALLOWED_TDLS_STA_NUM 4 #endif @@ -72,48 +88,61 @@ struct wlan_acl_pool { _queue acl_node_q; }; -typedef struct _RSSI_STA { - s32 UndecoratedSmoothedPWDB; - s32 UndecoratedSmoothedCCK; - s32 UndecoratedSmoothedOFDM; - u8 OFDM_pkt; - u8 CCK_pkt; - u16 CCK_sum_power; - u8 bsend_rssi; - u64 PacketMap; - u8 ValidBit; -} RSSI_STA, *PRSSI_STA; - struct stainfo_stats { u64 rx_mgnt_pkts; u64 rx_beacon_pkts; u64 rx_probereq_pkts; - u64 rx_probersp_pkts; + u64 rx_probersp_pkts; /* unicast to self */ u64 rx_probersp_bm_pkts; - u64 rx_probersp_uo_pkts; + u64 rx_probersp_uo_pkts; /* unicast to others */ u64 rx_ctrl_pkts; u64 rx_data_pkts; - u64 rx_data_qos_pkts[TID_NUM]; + u64 rx_data_bc_pkts; + u64 rx_data_mc_pkts; + u64 rx_data_qos_pkts[TID_NUM]; /* unicast only */ + u64 last_rx_mgnt_pkts; u64 last_rx_beacon_pkts; u64 last_rx_probereq_pkts; - u64 last_rx_probersp_pkts; + u64 last_rx_probersp_pkts; /* unicast to self */ u64 last_rx_probersp_bm_pkts; - u64 last_rx_probersp_uo_pkts; + u64 last_rx_probersp_uo_pkts; /* unicast to others */ u64 last_rx_ctrl_pkts; u64 last_rx_data_pkts; - u64 last_rx_data_qos_pkts[TID_NUM]; + u64 last_rx_data_bc_pkts; + u64 last_rx_data_mc_pkts; + u64 last_rx_data_qos_pkts[TID_NUM]; /* unicast only */ + #ifdef CONFIG_TDLS u64 rx_tdls_disc_rsp_pkts; u64 last_rx_tdls_disc_rsp_pkts; #endif + u64 rx_bytes; - u64 rx_drops; + u64 rx_bc_bytes; + u64 rx_mc_bytes; + u64 last_rx_bytes; + u64 last_rx_bc_bytes; + u64 last_rx_mc_bytes; + u64 rx_drops; /* TBD */ + u16 rx_tp_mbytes; u64 tx_pkts; + u64 last_tx_pkts; + u64 tx_bytes; - u64 tx_drops; + u64 last_tx_bytes; + u64 tx_drops; /* TBD */ + u16 tx_tp_mbytes; + + /* unicast only */ + u64 last_rx_data_uc_pkts; /* For Read & Clear requirement in proc_get_rx_stat() */ + u32 duplicate_cnt; /* Read & Clear, in proc_get_rx_stat() */ + u32 rxratecnt[128]; /* Read & Clear, in proc_get_rx_stat() */ + u32 tx_ok_cnt; /* Read & Clear, in proc_get_tx_stat() */ + u32 tx_fail_cnt; /* Read & Clear, in proc_get_tx_stat() */ + u32 tx_retry_cnt; /* Read & Clear, in proc_get_tx_stat() */ }; #ifndef DBG_SESSION_TRACKER @@ -134,7 +163,7 @@ struct session_tracker { u16 local_port; u32 remote_naddr; u16 remote_port; - u32 set_time; + systime set_time; u8 status; }; @@ -173,6 +202,7 @@ void rtw_st_ctl_register(struct st_ctl_t *st_ctl, u8 st_reg_id, struct st_regist void rtw_st_ctl_unregister(struct st_ctl_t *st_ctl, u8 st_reg_id); bool rtw_st_ctl_chk_reg_s_proto(struct st_ctl_t *st_ctl, u8 s_proto); bool rtw_st_ctl_chk_reg_rule(struct st_ctl_t *st_ctl, _adapter *adapter, u8 *local_naddr, u8 *local_port, u8 *remote_naddr, u8 *remote_port); +void rtw_st_ctl_rx(struct sta_info *sta, u8 *ehdr_pos); void dump_st_ctl(void *sel, struct st_ctl_t *st_ctl); #ifdef CONFIG_TDLS @@ -203,23 +233,26 @@ struct sta_info { /* _list sleep_list; */ /* sleep_q */ /* _list wakeup_list; */ /* wakeup_q */ _adapter *padapter; + struct cmn_sta_info cmn; struct sta_xmit_priv sta_xmitpriv; struct sta_recv_priv sta_recvpriv; #ifdef DBG_RX_DFRAME_RAW_DATA struct sta_recv_dframe_info sta_dframe_info; + struct sta_recv_dframe_info sta_dframe_info_bmc; #endif _queue sleep_q; unsigned int sleepq_len; uint state; - uint aid; - uint mac_id; uint qos_option; - u8 hwaddr[ETH_ALEN]; u16 hwseq; - u8 ra_rpt_linked; + +#ifdef CONFIG_RTW_80211K + u8 rm_en_cap[5]; + u8 rm_diag_token; +#endif /* CONFIG_RTW_80211K */ uint ieee8021x_blocked; /* 0: allowed, 1:blocked */ uint dot118021XPrivacy; /* aes, tkip... */ @@ -241,25 +274,12 @@ struct sta_info { u8 bssrateset[16]; u32 bssratelen; - s32 rssi; - s32 signal_quality; u8 cts2self; u8 rtsen; - u8 raid; u8 init_rate; - u64 ra_mask; u8 wireless_mode; /* NETWORK_TYPE */ - u8 bw_mode; - - u8 ldpc; - u8 stbc; - -#ifdef CONFIG_BEAMFORMING - u16 txbf_paid; - u16 txbf_gid; -#endif struct stainfo_stats sta_stats; @@ -406,41 +426,26 @@ struct sta_info { u32 assoc_req_len; #endif - /* for DM */ - RSSI_STA rssi_stat; - - /* ODM_STA_INFO_T */ - /* ================ODM Relative Info======================= */ - /* Please be care, dont declare too much structure here. It will cost memory * STA support num. */ - /* */ - /* */ - /* 2011/10/20 MH Add for ODM STA info. */ - /* */ - /* Driver Write */ - u8 bValid; /* record the sta status link or not? */ - /* u8 WirelessMode; */ /* */ u8 IOTPeer; /* Enum value. HT_IOT_PEER_E */ - /* ODM Write */ - /* 1 PHY_STATUS_INFO */ - u8 RSSI_Path[4]; /* */ - u8 RSSI_Ave; - u8 RXEVM[4]; - u8 RXSNR[4]; - - u8 rssi_level; /* for Refresh RA mask */ - /* ODM Write */ - /* 1 TX_INFO (may changed by IC) */ - /* TX_INFO_T pTxInfo; */ /* Define in IC folder. Move lower layer. */ - /* */ - /* ================ODM Relative Info======================= */ - /* */ +#ifdef CONFIG_LPS_PG + u8 lps_pg_rssi_lv; +#endif /* To store the sequence number of received management frame */ u16 RxMgmtFrameSeqNum; struct st_ctl_t st_ctl; + u8 max_agg_num_minimal_record; /*keep minimal tx desc max_agg_num setting*/ + u8 curr_rx_rate; + u8 curr_rx_rate_bmc; }; +#define sta_tx_pkts(sta) \ + (sta->sta_stats.tx_pkts) + +#define sta_last_tx_pkts(sta) \ + (sta->sta_stats.last_tx_pkts) + #define sta_rx_pkts(sta) \ (sta->sta_stats.rx_mgnt_pkts \ + sta->sta_stats.rx_ctrl_pkts \ @@ -451,15 +456,15 @@ struct sta_info { + sta->sta_stats.last_rx_ctrl_pkts \ + sta->sta_stats.last_rx_data_pkts) -#define sta_rx_data_pkts(sta) \ - (sta->sta_stats.rx_data_pkts) +#define sta_rx_data_pkts(sta) (sta->sta_stats.rx_data_pkts) +#define sta_last_rx_data_pkts(sta) (sta->sta_stats.last_rx_data_pkts) + +#define sta_rx_data_uc_pkts(sta) (sta->sta_stats.rx_data_pkts - sta->sta_stats.rx_data_bc_pkts - sta->sta_stats.rx_data_mc_pkts) +#define sta_last_rx_data_uc_pkts(sta) (sta->sta_stats.last_rx_data_pkts - sta->sta_stats.last_rx_data_bc_pkts - sta->sta_stats.last_rx_data_mc_pkts) #define sta_rx_data_qos_pkts(sta, i) \ (sta->sta_stats.rx_data_qos_pkts[i]) -#define sta_last_rx_data_pkts(sta) \ - (sta->sta_stats.last_rx_data_pkts) - #define sta_last_rx_data_qos_pkts(sta, i) \ (sta->sta_stats.last_rx_data_qos_pkts[i]) @@ -501,6 +506,8 @@ struct sta_info { #define sta_update_last_rx_pkts(sta) \ do { \ + int __i; \ + \ sta->sta_stats.last_rx_mgnt_pkts = sta->sta_stats.rx_mgnt_pkts; \ sta->sta_stats.last_rx_beacon_pkts = sta->sta_stats.rx_beacon_pkts; \ sta->sta_stats.last_rx_probereq_pkts = sta->sta_stats.rx_probereq_pkts; \ @@ -508,7 +515,12 @@ struct sta_info { sta->sta_stats.last_rx_probersp_bm_pkts = sta->sta_stats.rx_probersp_bm_pkts; \ sta->sta_stats.last_rx_probersp_uo_pkts = sta->sta_stats.rx_probersp_uo_pkts; \ sta->sta_stats.last_rx_ctrl_pkts = sta->sta_stats.rx_ctrl_pkts; \ + \ sta->sta_stats.last_rx_data_pkts = sta->sta_stats.rx_data_pkts; \ + sta->sta_stats.last_rx_data_bc_pkts = sta->sta_stats.rx_data_bc_pkts; \ + sta->sta_stats.last_rx_data_mc_pkts = sta->sta_stats.rx_data_mc_pkts; \ + for (__i = 0; __i < TID_NUM; __i++) \ + sta->sta_stats.last_rx_data_qos_pkts[__i] = sta->sta_stats.rx_data_qos_pkts[__i]; \ } while (0) #define STA_RX_PKTS_ARG(sta) \ @@ -528,6 +540,9 @@ struct sta_info { #define STA_PKTS_FMT "(m:%llu, c:%llu, d:%llu)" +#define sta_rx_uc_bytes(sta) (sta->sta_stats.rx_bytes - sta->sta_stats.rx_bc_bytes - sta->sta_stats.rx_mc_bytes) +#define sta_last_rx_uc_bytes(sta) (sta->sta_stats.last_rx_bytes - sta->sta_stats.last_rx_bc_bytes - sta->sta_stats.last_rx_mc_bytes) + #ifdef CONFIG_WFD #define STA_OP_WFD_MODE(sta) (sta)->op_wfd_mode #define STA_SET_OP_WFD_MODE(sta, mode) (sta)->op_wfd_mode = (mode) @@ -579,12 +594,17 @@ struct sta_priv { struct wlan_acl_pool acl_list; #endif -#endif + #if CONFIG_RTW_PRE_LINK_STA + struct pre_link_sta_ctl_t pre_link_sta_ctl; + #endif + +#endif /* CONFIG_AP_MODE */ #ifdef CONFIG_ATMEL_RC_PATCH u8 atmel_rc_pattern[6]; #endif - + struct sta_info *c2h_sta; + struct submit_ctx *gotc2h; }; @@ -625,4 +645,14 @@ extern u8 rtw_access_ctrl(_adapter *adapter, u8 *mac_addr); void dump_macaddr_acl(void *sel, _adapter *adapter); #endif +bool rtw_is_pre_link_sta(struct sta_priv *stapriv, u8 *addr); +#if CONFIG_RTW_PRE_LINK_STA +struct sta_info *rtw_pre_link_sta_add(struct sta_priv *stapriv, u8 *hwaddr); +void rtw_pre_link_sta_del(struct sta_priv *stapriv, u8 *hwaddr); +void rtw_pre_link_sta_ctl_reset(struct sta_priv *stapriv); +void rtw_pre_link_sta_ctl_init(struct sta_priv *stapriv); +void rtw_pre_link_sta_ctl_deinit(struct sta_priv *stapriv); +void dump_pre_link_sta_ctl(void *sel, struct sta_priv *stapriv); +#endif /* CONFIG_RTW_PRE_LINK_STA */ + #endif /* _STA_INFO_H_ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_hal.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_hal.h index 7e556e4421d5..a5af048b4198 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_hal.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_hal.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __USB_HAL_H__ #define __USB_HAL_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops.h index 350a675b421f..a0238f142dd8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __USB_OPS_H_ #define __USB_OPS_H_ @@ -122,7 +117,7 @@ static inline u8 rtw_usb_bulk_size_boundary(_adapter *padapter, int buf_len) if (IS_SUPER_SPEED_USB(padapter)) rst = (0 == (buf_len) % USB_SUPER_SPEED_BULK_SIZE) ? _TRUE : _FALSE; - if (IS_HIGH_SPEED_USB(padapter)) + else if (IS_HIGH_SPEED_USB(padapter)) rst = (0 == (buf_len) % USB_HIGH_SPEED_BULK_SIZE) ? _TRUE : _FALSE; else rst = (0 == (buf_len) % USB_FULL_SPEED_BULK_SIZE) ? _TRUE : _FALSE; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops_linux.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops_linux.h index adf075021c5b..bf59ca0fa51a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops_linux.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_ops_linux.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __USB_OPS_LINUX_H__ #define __USB_OPS_LINUX_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_osintf.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_osintf.h index 9c395204978a..7e5feed174de 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_osintf.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_osintf.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __USB_OSINTF_H #define __USB_OSINTF_H diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_vendor_req.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_vendor_req.h index 2281d36112a8..a003bfb8cd2a 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_vendor_req.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/usb_vendor_req.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _USB_VENDOR_REQUEST_H_ #define _USB_VENDOR_REQUEST_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wifi.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wifi.h index d4720a21019d..561eadbada6f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wifi.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wifi.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _WIFI_H_ #define _WIFI_H_ @@ -24,11 +19,9 @@ #ifndef BIT /* #error "BIT define occurred earlier elsewhere!\n" */ /* #undef BIT */ -#define BIT(x) (1 << (x)) +#define BIT(x) (1 << (x)) #endif - - #define WLAN_ETHHDR_LEN 14 #define WLAN_ETHADDR_LEN 6 #define WLAN_IEEE_OUI_LEN 3 @@ -96,6 +89,7 @@ enum WIFI_FRAME_SUBTYPE { WIFI_ACTION_NOACK = (BIT(7) | BIT(6) | BIT(5) | WIFI_MGT_TYPE), /* below is for control frame */ + WIFI_BF_REPORT_POLL = (BIT(6) | WIFI_CTRL_TYPE), WIFI_NDPA = (BIT(6) | BIT(4) | WIFI_CTRL_TYPE), WIFI_PSPOLL = (BIT(7) | BIT(5) | WIFI_CTRL_TYPE), WIFI_RTS = (BIT(7) | BIT(5) | BIT(4) | WIFI_CTRL_TYPE), @@ -369,14 +363,16 @@ enum WIFI_REG_DOMAIN { *(unsigned short *)(pbuf) |= __constant_cpu_to_le16(type); \ } while (0) -#define GetFrameSubType(pbuf) (cpu_to_le16(*(unsigned short *)(pbuf)) & (BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) +#define get_frame_sub_type(pbuf) (cpu_to_le16(*(unsigned short *)(pbuf)) & (BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))) -#define SetFrameSubType(pbuf, type) \ + +#define set_frame_sub_type(pbuf, type) \ do { \ *(unsigned short *)(pbuf) &= cpu_to_le16(~(BIT(7) | BIT(6) | BIT(5) | BIT(4) | BIT(3) | BIT(2))); \ *(unsigned short *)(pbuf) |= cpu_to_le16(type); \ } while (0) + #define GetSequence(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) >> 4) #define GetFragNum(pbuf) (cpu_to_le16(*(unsigned short *)((SIZE_PTR)(pbuf) + 22)) & 0x0f) @@ -397,7 +393,7 @@ enum WIFI_REG_DOMAIN { le16_to_cpu((unsigned short)(0xfff0 & (num << 4))); \ } while (0) -#define SetDuration(pbuf, dur) \ +#define set_duration(pbuf, dur) \ do { \ *(unsigned short *)((SIZE_PTR)(pbuf) + 2) = cpu_to_le16(0xffff & (dur)); \ } while (0) @@ -435,12 +431,13 @@ enum WIFI_REG_DOMAIN { #define GetAddr1Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 4)) -#define GetAddr2Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 10)) +#define get_addr2_ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 10)) #define GetAddr3Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 16)) #define GetAddr4Ptr(pbuf) ((unsigned char *)((SIZE_PTR)(pbuf) + 24)) + #define MacAddr_isBcst(addr) \ (\ ((addr[0] == 0xff) && (addr[1] == 0xff) && \ @@ -465,10 +462,11 @@ __inline static unsigned char *get_ra(unsigned char *pframe) __inline static unsigned char *get_ta(unsigned char *pframe) { unsigned char *ta; - ta = GetAddr2Ptr(pframe); + ta = get_addr2_ptr(pframe); return ta; } +/* can't apply to mesh mode */ __inline static unsigned char *get_da(unsigned char *pframe) { unsigned char *da; @@ -492,7 +490,7 @@ __inline static unsigned char *get_da(unsigned char *pframe) return da; } - +/* can't apply to mesh mode */ __inline static unsigned char *get_sa(unsigned char *pframe) { unsigned char *sa; @@ -500,13 +498,13 @@ __inline static unsigned char *get_sa(unsigned char *pframe) switch (to_fr_ds) { case 0x00: /* ToDs=0, FromDs=0 */ - sa = GetAddr2Ptr(pframe); + sa = get_addr2_ptr(pframe); break; case 0x01: /* ToDs=0, FromDs=1 */ sa = GetAddr3Ptr(pframe); break; case 0x02: /* ToDs=1, FromDs=0 */ - sa = GetAddr2Ptr(pframe); + sa = get_addr2_ptr(pframe); break; default: /* ToDs=1, FromDs=1 */ sa = GetAddr4Ptr(pframe); @@ -516,6 +514,7 @@ __inline static unsigned char *get_sa(unsigned char *pframe) return sa; } +/* can't apply to mesh mode */ __inline static unsigned char *get_hdr_bssid(unsigned char *pframe) { unsigned char *sa = NULL; @@ -526,7 +525,7 @@ __inline static unsigned char *get_hdr_bssid(unsigned char *pframe) sa = GetAddr3Ptr(pframe); break; case 0x01: /* ToDs=0, FromDs=1 */ - sa = GetAddr2Ptr(pframe); + sa = get_addr2_ptr(pframe); break; case 0x02: /* ToDs=1, FromDs=0 */ sa = GetAddr1Ptr(pframe); @@ -547,6 +546,22 @@ __inline static int IsFrameTypeCtrl(unsigned char *pframe) else return _FALSE; } +static inline int IsFrameTypeMgnt(unsigned char *pframe) +{ + if (GetFrameType(pframe) == WIFI_MGT_TYPE) + return _TRUE; + else + return _FALSE; +} +static inline int IsFrameTypeData(unsigned char *pframe) +{ + if (GetFrameType(pframe) == WIFI_DATA_TYPE) + return _TRUE; + else + return _FALSE; +} + + /*----------------------------------------------------------------------------- Below is for the security related definition ------------------------------------------------------------------------------*/ @@ -584,19 +599,22 @@ __inline static int IsFrameTypeCtrl(unsigned char *pframe) #define _CHLGETXT_IE_ 16 #define _SUPPORTED_CH_IE_ 36 #define _CH_SWTICH_ANNOUNCE_ 37 /* Secondary Channel Offset */ +#define _MEAS_REQ_IE_ 38 +#define _MEAS_RSP_IE_ 39 #define _RSN_IE_2_ 48 #define _SSN_IE_1_ 221 #define _ERPINFO_IE_ 42 #define _EXT_SUPPORTEDRATES_IE_ 50 #define _HT_CAPABILITY_IE_ 45 -#define _MDIE_ 54 -#define _FTIE_ 55 +#define _MDIE_ 54 +#define _FTIE_ 55 #define _TIMEOUT_ITVL_IE_ 56 #define _SRC_IE_ 59 #define _HT_EXTRA_INFO_IE_ 61 #define _HT_ADD_INFO_IE_ 61 /* _HT_EXTRA_INFO_IE_ */ -#define _WAPI_IE_ 68 +#define _WAPI_IE_ 68 +#define _EID_RRM_EN_CAP_IE_ 70 /* #define EID_BSSCoexistence 72 */ /* 20/40 BSS Coexistence @@ -755,11 +773,13 @@ typedef enum _ELEMENT_ID { /* #ifdef CONFIG_80211N_HT */ -#define SetOrderBit(pbuf) \ +#define set_order_bit(pbuf) \ do { \ *(unsigned short *)(pbuf) |= cpu_to_le16(_ORDER_); \ } while (0) + + #define GetOrderBit(pbuf) (((*(unsigned short *)(pbuf)) & le16_to_cpu(_ORDER_)) != 0) #define ACT_CAT_VENDOR 0x7F/* 127 */ @@ -812,6 +832,7 @@ struct rtw_ieee80211_ht_cap { * This structure refers to "HT information element" as * described in 802.11n draft section 7.3.2.53 */ +#ifndef CONFIG_IEEE80211_HT_ADDT_INFO struct ieee80211_ht_addt_info { unsigned char control_chan; unsigned char ht_param; @@ -819,7 +840,7 @@ struct ieee80211_ht_addt_info { unsigned short stbc_param; unsigned char basic_set[16]; } __attribute__((packed)); - +#endif struct HT_caps_element { union { @@ -938,6 +959,13 @@ typedef enum _HT_CAP_AMPDU_FACTOR { MAX_AMPDU_FACTOR_64K = 3, } HT_CAP_AMPDU_FACTOR; +typedef enum _VHT_CAP_AMPDU_FACTOR { + MAX_AMPDU_FACTOR_128K = 4, + MAX_AMPDU_FACTOR_256K = 5, + MAX_AMPDU_FACTOR_512K = 6, + MAX_AMPDU_FACTOR_1M = 7, +} VHT_CAP_AMPDU_FACTOR; + typedef enum _HT_CAP_AMPDU_DENSITY { AMPDU_DENSITY_VALUE_0 = 0 , /* For no restriction */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wlan_bssdef.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wlan_bssdef.h index dd39e0c0a959..76408d1adf69 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wlan_bssdef.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/wlan_bssdef.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __WLAN_BSSDEF_H__ #define __WLAN_BSSDEF_H__ @@ -526,7 +521,12 @@ typedef struct _WLAN_PHY_INFO { u8 SignalStrength;/* (in percentage) */ u8 SignalQuality;/* (in percentage) */ u8 Optimum_antenna; /* for Antenna diversity */ - u8 Reserved_0; + u8 is_cck_rate; /* 1:cck_rate */ + s8 rx_snr[4]; +#ifdef CONFIG_RTW_80211K + u32 free_cnt; /* freerun counter */ + u8 rm_en_cap[5]; +#endif } WLAN_PHY_INFO, *PWLAN_PHY_INFO; typedef struct _WLAN_BCN_INFO { @@ -542,6 +542,13 @@ typedef struct _WLAN_BCN_INFO { unsigned char ht_info_infos_0; } WLAN_BCN_INFO, *PWLAN_BCN_INFO; +enum bss_type { + BSS_TYPE_UNDEF, + BSS_TYPE_BCN = 1, + BSS_TYPE_PROB_REQ = 2, + BSS_TYPE_PROB_RSP = 3, +}; + /* temporally add #pragma pack for structure alignment issue of * WLAN_BSSID_EX and get_WLAN_BSSID_EX_sz() */ @@ -552,7 +559,7 @@ typedef struct _WLAN_BCN_INFO { typedef struct _WLAN_BSSID_EX { ULONG Length; NDIS_802_11_MAC_ADDRESS MacAddress; - UCHAR Reserved[2];/* [0]: IS beacon frame */ + UCHAR Reserved[2];/* [0]: IS beacon frame , bss_type*/ NDIS_802_11_SSID Ssid; ULONG Privacy; NDIS_802_11_RSSI Rssi;/* (in dBM,raw data ,get from PHY) */ @@ -574,7 +581,7 @@ WLAN_BSSID_EX, *PWLAN_BSSID_EX; #define BSS_EX_IES(bss_ex) ((bss_ex)->IEs) #define BSS_EX_IES_LEN(bss_ex) ((bss_ex)->IELength) -#define BSS_EX_FIXED_IE_OFFSET(bss_ex) ((bss_ex)->Reserved[0] == 2 ? 0 : 12) +#define BSS_EX_FIXED_IE_OFFSET(bss_ex) ((bss_ex)->Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12) #define BSS_EX_TLV_IES(bss_ex) (BSS_EX_IES((bss_ex)) + BSS_EX_FIXED_IE_OFFSET((bss_ex))) #define BSS_EX_TLV_IES_LEN(bss_ex) (BSS_EX_IES_LEN((bss_ex)) - BSS_EX_FIXED_IE_OFFSET((bss_ex))) @@ -608,7 +615,7 @@ struct wlan_network { _list list; int network_type; /* refer to ieee80211.h for WIRELESS_11A/B/G */ int fixed; /* set to fixed when not to be removed as site-surveying */ - unsigned long last_scanned; /* timestamp for the network */ + systime last_scanned; /* timestamp for the network */ int aid; /* will only be valid when a BSS is joinned. */ int join_res; WLAN_BSSID_EX network; /* must be the last item */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/xmit_osdep.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/xmit_osdep.h index ea5725d8244f..70070a890fa1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/xmit_osdep.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/include/xmit_osdep.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __XMIT_OSDEP_H_ #define __XMIT_OSDEP_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/custom_gpio_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/custom_gpio_linux.c index 4f10bbed436b..23401b7d6b7c 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/custom_gpio_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/custom_gpio_linux.c @@ -1,7 +1,6 @@ /****************************************************************************** - * Customer code to add GPIO control during WLAN start/stop * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -12,12 +11,7 @@ * 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 "drv_types.h" #ifdef CONFIG_PLATFORM_SPRD diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.c index e0ec15c0a164..66c716ae3dd1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,15 +11,11 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _IOCTL_CFG80211_C_ #include +#include #ifdef CONFIG_IOCTL_CFG80211 @@ -28,6 +24,7 @@ #define STATION_INFO_TX_BITRATE BIT(NL80211_STA_INFO_TX_BITRATE) #define STATION_INFO_RX_PACKETS BIT(NL80211_STA_INFO_RX_PACKETS) #define STATION_INFO_TX_PACKETS BIT(NL80211_STA_INFO_TX_PACKETS) +#define STATION_INFO_TX_FAILED BIT(NL80211_STA_INFO_TX_FAILED) #define STATION_INFO_ASSOC_REQ_IES 0 #endif /* Linux kernel >= 4.0.0 */ @@ -88,7 +85,7 @@ static const u32 rtw_cipher_suites[] = { } #define CHAN2G(_channel, _freq, _flags) { \ - .band = IEEE80211_BAND_2GHZ, \ + .band = NL80211_BAND_2GHZ, \ .center_freq = (_freq), \ .hw_value = (_channel), \ .flags = (_flags), \ @@ -97,7 +94,7 @@ static const u32 rtw_cipher_suites[] = { } #define CHAN5G(_channel, _flags) { \ - .band = IEEE80211_BAND_5GHZ, \ + .band = NL80211_BAND_5GHZ, \ .center_freq = 5000 + (5 * (_channel)), \ .hw_value = (_channel), \ .flags = (_flags), \ @@ -142,10 +139,8 @@ static struct ieee80211_rate rtw_rates[] = { #define rtw_g_rates (rtw_rates + 0) #define RTW_G_RATES_NUM 12 -#define RTW_2G_CHANNELS_NUM 14 -#define RTW_5G_CHANNELS_NUM 37 - -static struct ieee80211_channel rtw_2ghz_channels[] = { +/* from center_ch_2g */ +static struct ieee80211_channel rtw_2ghz_channels[MAX_CHANNEL_NUM_2G] = { CHAN2G(1, 2412, 0), CHAN2G(2, 2417, 0), CHAN2G(3, 2422, 0), @@ -162,41 +157,270 @@ static struct ieee80211_channel rtw_2ghz_channels[] = { CHAN2G(14, 2484, 0), }; -static struct ieee80211_channel rtw_5ghz_a_channels[] = { - CHAN5G(34, 0), CHAN5G(36, 0), - CHAN5G(38, 0), CHAN5G(40, 0), - CHAN5G(42, 0), CHAN5G(44, 0), - CHAN5G(46, 0), CHAN5G(48, 0), - CHAN5G(52, 0), CHAN5G(56, 0), - CHAN5G(60, 0), CHAN5G(64, 0), - CHAN5G(100, 0), CHAN5G(104, 0), - CHAN5G(108, 0), CHAN5G(112, 0), - CHAN5G(116, 0), CHAN5G(120, 0), - CHAN5G(124, 0), CHAN5G(128, 0), - CHAN5G(132, 0), CHAN5G(136, 0), - CHAN5G(140, 0), CHAN5G(149, 0), - CHAN5G(153, 0), CHAN5G(157, 0), - CHAN5G(161, 0), CHAN5G(165, 0), - CHAN5G(184, 0), CHAN5G(188, 0), - CHAN5G(192, 0), CHAN5G(196, 0), - CHAN5G(200, 0), CHAN5G(204, 0), - CHAN5G(208, 0), CHAN5G(212, 0), - CHAN5G(216, 0), +/* from center_ch_5g_20m */ +static struct ieee80211_channel rtw_5ghz_a_channels[MAX_CHANNEL_NUM_5G] = { + CHAN5G(36, 0), CHAN5G(40, 0), CHAN5G(44, 0), CHAN5G(48, 0), + + CHAN5G(52, 0), CHAN5G(56, 0), CHAN5G(60, 0), CHAN5G(64, 0), + + CHAN5G(100, 0), CHAN5G(104, 0), CHAN5G(108, 0), CHAN5G(112, 0), + CHAN5G(116, 0), CHAN5G(120, 0), CHAN5G(124, 0), CHAN5G(128, 0), + CHAN5G(132, 0), CHAN5G(136, 0), CHAN5G(140, 0), CHAN5G(144, 0), + + CHAN5G(149, 0), CHAN5G(153, 0), CHAN5G(157, 0), CHAN5G(161, 0), + CHAN5G(165, 0), CHAN5G(169, 0), CHAN5G(173, 0), CHAN5G(177, 0), }; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) +static const char *nl80211_channel_type_str(enum nl80211_channel_type ctype) +{ + switch (ctype) { + case NL80211_CHAN_NO_HT: + return "NO_HT"; + case NL80211_CHAN_HT20: + return "HT20"; + case NL80211_CHAN_HT40MINUS: + return "HT40-"; + case NL80211_CHAN_HT40PLUS: + return "HT40+"; + default: + return "INVALID"; + }; +} + +static enum nl80211_channel_type rtw_chbw_to_nl80211_channel_type(u8 ch, u8 bw, u8 offset, u8 ht) +{ + rtw_warn_on(!ht && (bw >= CHANNEL_WIDTH_40 || offset != HAL_PRIME_CHNL_OFFSET_DONT_CARE)); + + if (!ht) + return NL80211_CHAN_NO_HT; + if (bw >= CHANNEL_WIDTH_40) { + if (offset == HAL_PRIME_CHNL_OFFSET_UPPER) + return NL80211_CHAN_HT40MINUS; + else if (offset == HAL_PRIME_CHNL_OFFSET_LOWER) + return NL80211_CHAN_HT40PLUS; + else + rtw_warn_on(1); + } + return NL80211_CHAN_HT20; +} + +static void rtw_get_chbw_from_nl80211_channel_type(struct ieee80211_channel *chan, enum nl80211_channel_type ctype, u8 *ht, u8 *ch, u8 *bw, u8 *offset) +{ + int pri_freq; + + pri_freq = rtw_ch2freq(chan->hw_value); + if (!pri_freq) { + RTW_INFO("invalid channel:%d\n", chan->hw_value); + rtw_warn_on(1); + *ch = 0; + return; + } + *ch = chan->hw_value; + + switch (ctype) { + case NL80211_CHAN_NO_HT: + *ht = 0; + *bw = CHANNEL_WIDTH_20; + *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + break; + case NL80211_CHAN_HT20: + *ht = 1; + *bw = CHANNEL_WIDTH_20; + *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + break; + case NL80211_CHAN_HT40MINUS: + *ht = 1; + *bw = CHANNEL_WIDTH_40; + *offset = HAL_PRIME_CHNL_OFFSET_UPPER; + break; + case NL80211_CHAN_HT40PLUS: + *ht = 1; + *bw = CHANNEL_WIDTH_40; + *offset = HAL_PRIME_CHNL_OFFSET_LOWER; + break; + default: + *ht = 0; + *bw = CHANNEL_WIDTH_20; + *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + RTW_INFO("unsupported ctype:%s\n", nl80211_channel_type_str(ctype)); + rtw_warn_on(1); + }; +} +#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) */ + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) +static const char *nl80211_chan_width_str(enum nl80211_chan_width cwidth) +{ + switch (cwidth) { + case NL80211_CHAN_WIDTH_20_NOHT: + return "20_NOHT"; + case NL80211_CHAN_WIDTH_20: + return "20"; + case NL80211_CHAN_WIDTH_40: + return "40"; + case NL80211_CHAN_WIDTH_80: + return "80"; + case NL80211_CHAN_WIDTH_80P80: + return "80+80"; + case NL80211_CHAN_WIDTH_160: + return "160"; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + case NL80211_CHAN_WIDTH_5: + return "5"; + case NL80211_CHAN_WIDTH_10: + return "10"; +#endif + default: + return "INVALID"; + }; +} + +static u8 rtw_chbw_to_cfg80211_chan_def(struct wiphy *wiphy, struct cfg80211_chan_def *chdef, u8 ch, u8 bw, u8 offset, u8 ht) +{ + int freq, cfreq; + struct ieee80211_channel *chan; + u8 ret = _FAIL; + + freq = rtw_ch2freq(ch); + if (!freq) + goto exit; + + cfreq = rtw_get_center_ch(ch, bw, offset); + if (!cfreq) + goto exit; + cfreq = rtw_ch2freq(cfreq); + if (!cfreq) + goto exit; + + chan = ieee80211_get_channel(wiphy, freq); + if (!chan) + goto exit; + + if (bw == CHANNEL_WIDTH_20) + chdef->width = ht ? NL80211_CHAN_WIDTH_20 : NL80211_CHAN_WIDTH_20_NOHT; + else if (bw == CHANNEL_WIDTH_40) + chdef->width = NL80211_CHAN_WIDTH_40; + else if (bw == CHANNEL_WIDTH_80) + chdef->width = NL80211_CHAN_WIDTH_80; + else if (bw == CHANNEL_WIDTH_160) + chdef->width = NL80211_CHAN_WIDTH_160; + else { + rtw_warn_on(1); + goto exit; + } + + chdef->chan = chan; + chdef->center_freq1 = cfreq; + chdef->center_freq2 = 0; + + ret = _SUCCESS; + +exit: + return ret; +} + +static void rtw_get_chbw_from_cfg80211_chan_def(struct cfg80211_chan_def *chdef, u8 *ht, u8 *ch, u8 *bw, u8 *offset) +{ + int pri_freq; + struct ieee80211_channel *chan = chdef->chan; + + pri_freq = rtw_ch2freq(chan->hw_value); + if (!pri_freq) { + RTW_INFO("invalid channel:%d\n", chan->hw_value); + rtw_warn_on(1); + *ch = 0; + return; + } + + switch (chdef->width) { + case NL80211_CHAN_WIDTH_20_NOHT: + *ht = 0; + *bw = CHANNEL_WIDTH_20; + *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + *ch = chan->hw_value; + break; + case NL80211_CHAN_WIDTH_20: + *ht = 1; + *bw = CHANNEL_WIDTH_20; + *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + *ch = chan->hw_value; + break; + case NL80211_CHAN_WIDTH_40: + *ht = 1; + *bw = CHANNEL_WIDTH_40; + *offset = pri_freq > chdef->center_freq1 ? HAL_PRIME_CHNL_OFFSET_UPPER : HAL_PRIME_CHNL_OFFSET_LOWER; + if (rtw_get_offset_by_chbw(chan->hw_value, *bw, offset)) + *ch = chan->hw_value; + break; + case NL80211_CHAN_WIDTH_80: + *ht = 1; + *bw = CHANNEL_WIDTH_80; + if (rtw_get_offset_by_chbw(chan->hw_value, *bw, offset)) + *ch = chan->hw_value; + break; + case NL80211_CHAN_WIDTH_160: + *ht = 1; + *bw = CHANNEL_WIDTH_160; + if (rtw_get_offset_by_chbw(chan->hw_value, *bw, offset)) + *ch = chan->hw_value; + break; + case NL80211_CHAN_WIDTH_80P80: + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + case NL80211_CHAN_WIDTH_5: + case NL80211_CHAN_WIDTH_10: + #endif + default: + *ht = 0; + *bw = CHANNEL_WIDTH_20; + *offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; + RTW_INFO("unsupported cwidth:%s\n", nl80211_chan_width_str(chdef->width)); + rtw_warn_on(1); + }; +} +#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) */ + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) +u8 rtw_cfg80211_ch_switch_notify(_adapter *adapter, u8 ch, u8 bw, u8 offset, u8 ht) +{ + struct wiphy *wiphy = adapter_to_wiphy(adapter); + u8 ret = _SUCCESS; + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0)) + struct cfg80211_chan_def chdef; + + ret = rtw_chbw_to_cfg80211_chan_def(wiphy, &chdef, ch, bw, offset, ht); + if (ret != _SUCCESS) + goto exit; + + cfg80211_ch_switch_notify(adapter->pnetdev, &chdef); + +#else + int freq = rtw_ch2freq(ch); + enum nl80211_channel_type ctype; + + if (!freq) { + ret = _FAIL; + goto exit; + } + + ctype = rtw_chbw_to_nl80211_channel_type(ch, bw, offset, ht); + cfg80211_ch_switch_notify(adapter->pnetdev, freq, ctype); +#endif + +exit: + return ret; +} +#endif /* (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) */ void rtw_2g_channels_init(struct ieee80211_channel *channels) { - _rtw_memcpy((void *)channels, (void *)rtw_2ghz_channels, - sizeof(struct ieee80211_channel) * RTW_2G_CHANNELS_NUM - ); + _rtw_memcpy((void *)channels, (void *)rtw_2ghz_channels, sizeof(rtw_2ghz_channels)); } void rtw_5g_channels_init(struct ieee80211_channel *channels) { - _rtw_memcpy((void *)channels, (void *)rtw_5ghz_a_channels, - sizeof(struct ieee80211_channel) * RTW_5G_CHANNELS_NUM - ); + _rtw_memcpy((void *)channels, (void *)rtw_5ghz_a_channels, sizeof(rtw_5ghz_a_channels)); } void rtw_2g_rates_init(struct ieee80211_rate *rates) @@ -213,18 +437,16 @@ void rtw_5g_rates_init(struct ieee80211_rate *rates) ); } -struct ieee80211_supported_band *rtw_spt_band_alloc( - enum ieee80211_band band -) +struct ieee80211_supported_band *rtw_spt_band_alloc(BAND_TYPE band) { struct ieee80211_supported_band *spt_band = NULL; int n_channels, n_bitrates; - if (band == IEEE80211_BAND_2GHZ) { - n_channels = RTW_2G_CHANNELS_NUM; + if (band == BAND_ON_2_4G) { + n_channels = MAX_CHANNEL_NUM_2G; n_bitrates = RTW_G_RATES_NUM; - } else if (band == IEEE80211_BAND_5GHZ) { - n_channels = RTW_5G_CHANNELS_NUM; + } else if (band == BAND_ON_5G) { + n_channels = MAX_CHANNEL_NUM_5G; n_bitrates = RTW_A_RATES_NUM; } else goto exit; @@ -239,14 +461,14 @@ struct ieee80211_supported_band *rtw_spt_band_alloc( spt_band->channels = (struct ieee80211_channel *)(((u8 *)spt_band) + sizeof(struct ieee80211_supported_band)); spt_band->bitrates = (struct ieee80211_rate *)(((u8 *)spt_band->channels) + sizeof(struct ieee80211_channel) * n_channels); - spt_band->band = band; + spt_band->band = rtw_band_to_nl80211_band(band); spt_band->n_channels = n_channels; spt_band->n_bitrates = n_bitrates; - if (band == IEEE80211_BAND_2GHZ) { + if (band == BAND_ON_2_4G) { rtw_2g_channels_init(spt_band->channels); rtw_2g_rates_init(spt_band->bitrates); - } else if (band == IEEE80211_BAND_5GHZ) { + } else if (band == BAND_ON_5G) { rtw_5g_channels_init(spt_band->channels); rtw_5g_rates_init(spt_band->bitrates); } @@ -265,13 +487,13 @@ void rtw_spt_band_free(struct ieee80211_supported_band *spt_band) if (!spt_band) return; - if (spt_band->band == IEEE80211_BAND_2GHZ) { + if (spt_band->band == NL80211_BAND_2GHZ) { size = sizeof(struct ieee80211_supported_band) - + sizeof(struct ieee80211_channel) * RTW_2G_CHANNELS_NUM + + sizeof(struct ieee80211_channel) * MAX_CHANNEL_NUM_2G + sizeof(struct ieee80211_rate) * RTW_G_RATES_NUM; - } else if (spt_band->band == IEEE80211_BAND_5GHZ) { + } else if (spt_band->band == NL80211_BAND_5GHZ) { size = sizeof(struct ieee80211_supported_band) - + sizeof(struct ieee80211_channel) * RTW_5G_CHANNELS_NUM + + sizeof(struct ieee80211_channel) * MAX_CHANNEL_NUM_5G + sizeof(struct ieee80211_rate) * RTW_A_RATES_NUM; } else { @@ -476,12 +698,12 @@ struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_net SetSeqNum(pwlanhdr, 0/*pmlmeext->mgnt_seq*/); /* pmlmeext->mgnt_seq++; */ - if (pnetwork->network.Reserved[0] == 1) { /* WIFI_BEACON */ + if (pnetwork->network.Reserved[0] == BSS_TYPE_BCN) { /* WIFI_BEACON */ _rtw_memcpy(pwlanhdr->addr1, bc_addr, ETH_ALEN); - SetFrameSubType(pbuf, WIFI_BEACON); + set_frame_sub_type(pbuf, WIFI_BEACON); } else { _rtw_memcpy(pwlanhdr->addr1, adapter_mac_addr(padapter), ETH_ALEN); - SetFrameSubType(pbuf, WIFI_PROBERSP); + set_frame_sub_type(pbuf, WIFI_PROBERSP); } _rtw_memcpy(pwlanhdr->addr2, pnetwork->network.MacAddress, ETH_ALEN); @@ -518,7 +740,7 @@ struct cfg80211_bss *rtw_cfg80211_inform_bss(_adapter *padapter, struct wlan_net #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 38)) #ifndef COMPAT_KERNEL_RELEASE /* patch for cfg80211, update beacon ies to information_elements */ - if (pnetwork->network.Reserved[0] == 1) { /* WIFI_BEACON */ + if (pnetwork->network.Reserved[0] == BSS_TYPE_BCN) { /* WIFI_BEACON */ if (bss->len_information_elements != bss->len_beacon_ies) { bss->information_elements = bss->beacon_ies; @@ -664,11 +886,17 @@ void rtw_cfg80211_indicate_connect(_adapter *padapter) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct wlan_network *cur_network = &(pmlmepriv->cur_network); struct wireless_dev *pwdev = padapter->rtw_wdev; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + _irqL irqL; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #endif struct cfg80211_bss *bss = NULL; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + struct cfg80211_roam_info roam_info ={}; +#endif + RTW_INFO(FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); if (pwdev->iftype != NL80211_IFTYPE_STATION #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) @@ -677,7 +905,7 @@ void rtw_cfg80211_indicate_connect(_adapter *padapter) ) return; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (!MLME_IS_STA(padapter)) return; #ifdef CONFIG_P2P @@ -725,6 +953,8 @@ void rtw_cfg80211_indicate_connect(_adapter *padapter) if (!rtw_cfg80211_check_bss(padapter)) RTW_PRINT(FUNC_ADPT_FMT" BSS not found !!\n", FUNC_ADPT_ARG(padapter)); + _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); + if (rtw_to_roam(padapter) > 0) { #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) struct wiphy *wiphy = pwdev->wiphy; @@ -736,7 +966,15 @@ void rtw_cfg80211_indicate_connect(_adapter *padapter) notify_channel = ieee80211_get_channel(wiphy, freq); #endif - RTW_INFO(FUNC_ADPT_FMT" call cfg80211_roamed\n", FUNC_ADPT_ARG(padapter)); + #if LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0) + roam_info.bssid = cur_network->network.MacAddress; + roam_info.req_ie = pmlmepriv->assoc_req + sizeof(struct rtw_ieee80211_hdr_3addr) + 2; + roam_info.req_ie_len = pmlmepriv->assoc_req_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 2; + roam_info.resp_ie = pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6; + roam_info.resp_ie_len = pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6; + + cfg80211_roamed(padapter->pnetdev, &roam_info, GFP_ATOMIC); + #else cfg80211_roamed(padapter->pnetdev #if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 39) || defined(COMPAT_KERNEL_RELEASE) , notify_channel @@ -747,6 +985,10 @@ void rtw_cfg80211_indicate_connect(_adapter *padapter) , pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6 , pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6 , GFP_ATOMIC); + #endif /*LINUX_VERSION_CODE >= KERNEL_VERSION(4, 12, 0)*/ + + RTW_INFO(FUNC_ADPT_FMT" call cfg80211_roamed\n", FUNC_ADPT_ARG(padapter)); + #ifdef CONFIG_RTW_80211R if ((rtw_to_roam(padapter) > 0) && rtw_chk_ft_flags(padapter, RTW_FT_SUPPORTED)) rtw_set_ft_status(padapter, RTW_FT_ASSOCIATED_STA); @@ -755,22 +997,30 @@ void rtw_cfg80211_indicate_connect(_adapter *padapter) #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) RTW_INFO("pwdev->sme_state(b)=%d\n", pwdev->sme_state); #endif - cfg80211_connect_result(padapter->pnetdev, cur_network->network.MacAddress - , pmlmepriv->assoc_req + sizeof(struct rtw_ieee80211_hdr_3addr) + 2 - , pmlmepriv->assoc_req_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 2 - , pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6 - , pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6 - , WLAN_STATUS_SUCCESS, GFP_ATOMIC); + + if (check_fwstate(pmlmepriv, WIFI_MONITOR_STATE) != _TRUE) + rtw_cfg80211_connect_result(pwdev, cur_network->network.MacAddress + , pmlmepriv->assoc_req + sizeof(struct rtw_ieee80211_hdr_3addr) + 2 + , pmlmepriv->assoc_req_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 2 + , pmlmepriv->assoc_rsp + sizeof(struct rtw_ieee80211_hdr_3addr) + 6 + , pmlmepriv->assoc_rsp_len - sizeof(struct rtw_ieee80211_hdr_3addr) - 6 + , WLAN_STATUS_SUCCESS, GFP_ATOMIC); #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) RTW_INFO("pwdev->sme_state(a)=%d\n", pwdev->sme_state); #endif } + + rtw_wdev_free_connect_req(pwdev_priv); + + _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); } void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally_generated) { struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct wireless_dev *pwdev = padapter->rtw_wdev; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + _irqL irqL; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); #endif @@ -788,7 +1038,7 @@ void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally ) return; - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) + if (!MLME_IS_STA(padapter)) return; #ifdef CONFIG_P2P @@ -796,8 +1046,10 @@ void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally if (!rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) { rtw_p2p_set_state(pwdinfo, rtw_p2p_pre_state(pwdinfo)); + #if RTW_P2P_GROUP_INTERFACE #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) if (pwdev->iftype != NL80211_IFTYPE_P2P_CLIENT) + #endif #endif rtw_p2p_set_role(pwdinfo, P2P_ROLE_DEVICE); @@ -806,47 +1058,37 @@ void rtw_cfg80211_indicate_disconnect(_adapter *padapter, u16 reason, u8 locally } #endif /* CONFIG_P2P */ - #ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - if (!padapter->mlmepriv.not_indic_disco || padapter->ndev_unregistering) { - #else - { - #endif + _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); + + if (padapter->ndev_unregistering || !rtw_wdev_not_indic_disco(pwdev_priv)) { #if LINUX_VERSION_CODE < KERNEL_VERSION(3, 11, 0) || defined(COMPAT_KERNEL_RELEASE) RTW_INFO("pwdev->sme_state(b)=%d\n", pwdev->sme_state); - if (pwdev->sme_state == CFG80211_SME_CONNECTING) - cfg80211_connect_result(padapter->pnetdev, NULL, NULL, 0, NULL, 0, - WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC/*GFP_KERNEL*/); - else if (pwdev->sme_state == CFG80211_SME_CONNECTED) { - #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) - cfg80211_disconnected(padapter->pnetdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); - #else - cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); - #endif + if (pwdev->sme_state == CFG80211_SME_CONNECTING) { + RTW_INFO(FUNC_ADPT_FMT" call cfg80211_connect_result\n", FUNC_ADPT_ARG(padapter)); + rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, + WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); + } else if (pwdev->sme_state == CFG80211_SME_CONNECTED) { + RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); + rtw_cfg80211_disconnected(pwdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); } - #if 0 - else - RTW_INFO("pwdev->sme_state=%d\n", pwdev->sme_state); - #endif RTW_INFO("pwdev->sme_state(a)=%d\n", pwdev->sme_state); #else - - if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { - #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) - RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); - cfg80211_disconnected(padapter->pnetdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); - #else - RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); - cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); - #endif - } else { + if (pwdev_priv->connect_req) { RTW_INFO(FUNC_ADPT_FMT" call cfg80211_connect_result\n", FUNC_ADPT_ARG(padapter)); - cfg80211_connect_result(padapter->pnetdev, NULL, NULL, 0, NULL, 0, + rtw_cfg80211_connect_result(pwdev, NULL, NULL, 0, NULL, 0, WLAN_STATUS_UNSPECIFIED_FAILURE, GFP_ATOMIC); + } else { + RTW_INFO(FUNC_ADPT_FMT" call cfg80211_disconnected\n", FUNC_ADPT_ARG(padapter)); + rtw_cfg80211_disconnected(pwdev, reason, NULL, 0, locally_generated, GFP_ATOMIC); } #endif } + + rtw_wdev_free_connect_req(pwdev_priv); + + _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); } @@ -1231,7 +1473,6 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); padapter->securitypriv.busetkipkey = _FALSE; - /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ } psta->bpairwise_key_installed = _TRUE; #ifdef CONFIG_RTW_80211R @@ -1248,6 +1489,9 @@ static int rtw_cfg80211_set_encryption(struct net_device *dev, struct ieee_param _rtw_memcpy(padapter->securitypriv.dot118021XGrptxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[16]), 8); _rtw_memcpy(padapter->securitypriv.dot118021XGrprxmickey[param->u.crypt.idx].skey, &(param->u.crypt.key[24]), 8); padapter->securitypriv.binstallGrpkey = _TRUE; + if (param->u.crypt.idx < 4) + _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); + /* DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ RTW_INFO(" ~~~~set sta key:groupkey\n"); @@ -1692,6 +1936,9 @@ static int cfg80211_rtw_get_station(struct wiphy *wiphy, sinfo->filled |= STATION_INFO_TX_PACKETS; sinfo->tx_packets = psta->sta_stats.tx_pkts; + sinfo->filled |= STATION_INFO_TX_FAILED; + sinfo->tx_failed = psta->sta_stats.tx_fail_cnt; + } /* for Ad-Hoc/AP mode */ @@ -1728,7 +1975,10 @@ enum nl80211_iftype { #endif static int cfg80211_rtw_change_iface(struct wiphy *wiphy, struct net_device *ndev, - enum nl80211_iftype type, u32 *flags, + enum nl80211_iftype type, +#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0)) + u32 *flags, +#endif struct vif_params *params) { enum nl80211_iftype old_type; @@ -1743,7 +1993,7 @@ static int cfg80211_rtw_change_iface(struct wiphy *wiphy, int ret = 0; u8 change = _FALSE; - RTW_INFO(FUNC_NDEV_FMT" type=%d\n", FUNC_NDEV_ARG(ndev), type); + RTW_INFO(FUNC_NDEV_FMT" type=%d, hw_port:%d\n", FUNC_NDEV_ARG(ndev), type, padapter->hw_port); if (adapter_to_dvobj(padapter)->processing_dev_remove == _TRUE) { ret = -EPERM; @@ -1778,6 +2028,18 @@ static int cfg80211_rtw_change_iface(struct wiphy *wiphy, /* initial default type */ ndev->type = ARPHRD_ETHER; + /* + * Disable Power Save in moniter mode, + * and enable it after leaving moniter mode. + */ + if (type == NL80211_IFTYPE_MONITOR) { + rtw_ps_deny(padapter, PS_DENY_MONITOR_MODE); + LeaveAllPowerSaveMode(padapter); + } else if (old_type == NL80211_IFTYPE_MONITOR) { + /* driver in moniter mode in last time */ + rtw_ps_deny_cancel(padapter, PS_DENY_MONITOR_MODE); + } + switch (type) { case NL80211_IFTYPE_ADHOC: networkType = Ndis802_11IBSS; @@ -1862,6 +2124,13 @@ void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted) struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(adapter); _irqL irqL; +#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) + struct cfg80211_scan_info info; + + memset(&info, 0, sizeof(info)); + info.aborted = aborted; +#endif + _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); if (pwdev_priv->scan_request != NULL) { #ifdef CONFIG_DEBUG_CFG80211 @@ -1872,7 +2141,11 @@ void rtw_cfg80211_indicate_scan_done(_adapter *adapter, bool aborted) if (pwdev_priv->scan_request->wiphy != pwdev_priv->rtw_wdev->wiphy) RTW_INFO("error wiphy compare\n"); else +#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) + cfg80211_scan_done(pwdev_priv->scan_request, &info); +#else cfg80211_scan_done(pwdev_priv->scan_request, aborted); +#endif pwdev_priv->scan_request = NULL; } else { @@ -1887,7 +2160,7 @@ u32 rtw_cfg80211_wait_scan_req_empty(_adapter *adapter, u32 timeout_ms) { struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); u8 empty = _FALSE; - u32 start; + systime start; u32 pass_ms; start = rtw_get_current_time(); @@ -1934,7 +2207,7 @@ void rtw_cfg80211_unlink_bss(_adapter *padapter, struct wlan_network *pnetwork) if (bss) { cfg80211_unlink_bss(wiphy, bss); - RTW_INFO("%s(): cfg80211_unlink %s!! () ", __func__, select_network.Ssid.Ssid); + RTW_INFO("%s(): cfg80211_unlink %s!!\n", __func__, select_network.Ssid.Ssid); #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 9, 0) cfg80211_put_bss(padapter->rtw_wdev->wiphy, bss); #else @@ -2002,7 +2275,7 @@ static void _rtw_cfg80211_surveydone_event_callback(_adapter *padapter, struct c pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); /* report network only if the current channel set contains the channel to which this network belongs */ - if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 + if (rtw_chset_search_ch(adapter_to_chset(padapter), pnetwork->network.Configuration.DSConfig) >= 0 && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) ) { @@ -2231,9 +2504,7 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy int i, chan_num = 0; u8 _status = _FALSE; int ret = 0; - NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; - struct rtw_ieee80211_channel ch[RTW_CHANNEL_SCAN_AMOUNT]; - struct rtw_ieee80211_channel *pch; + struct sitesurvey_parm parm; _irqL irqL; u8 *wps_ie = NULL; uint wps_ielen = 0; @@ -2286,13 +2557,21 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy , wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : ""); #ifdef CONFIG_MP_INCLUDED - if (rtw_mi_mp_mode_check(padapter)) { + if (rtw_mp_mode_check(padapter)) { RTW_INFO("MP mode block Scan request\n"); ret = -EPERM; goto exit; } #endif +#ifdef CONFIG_RTW_REPEATER_SON + if (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) { + RTW_INFO(FUNC_ADPT_FMT" blocking scan for under rson scanning process\n", FUNC_ADPT_ARG(padapter)); + need_indicate_scan_done = _TRUE; + goto check_need_indicate_scan_done; + } +#endif + if (adapter_wdev_data(padapter)->block_scan == _TRUE) { RTW_INFO(FUNC_ADPT_FMT" wdev_priv.block_scan is set\n", FUNC_ADPT_ARG(padapter)); need_indicate_scan_done = _TRUE; @@ -2403,46 +2682,42 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy } #endif /* CONFIG_P2P */ + rtw_init_sitesurvey_parm(padapter, &parm); - _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID) * RTW_SSID_SCAN_AMOUNT); /* parsing request ssids, n_ssids */ for (i = 0; i < request->n_ssids && i < RTW_SSID_SCAN_AMOUNT; i++) { #ifdef CONFIG_DEBUG_CFG80211 RTW_INFO("ssid=%s, len=%d\n", ssids[i].ssid, ssids[i].ssid_len); #endif - _rtw_memcpy(ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); - ssid[i].SsidLength = ssids[i].ssid_len; + _rtw_memcpy(&parm.ssid[i].Ssid, ssids[i].ssid, ssids[i].ssid_len); + parm.ssid[i].SsidLength = ssids[i].ssid_len; } + parm.ssid_num = i; /* parsing channels, n_channels */ - _rtw_memset(ch, 0, sizeof(struct rtw_ieee80211_channel) * RTW_CHANNEL_SCAN_AMOUNT); for (i = 0; i < request->n_channels && i < RTW_CHANNEL_SCAN_AMOUNT; i++) { #ifdef CONFIG_DEBUG_CFG80211 RTW_INFO(FUNC_ADPT_FMT CHAN_FMT"\n", FUNC_ADPT_ARG(padapter), CHAN_ARG(request->channels[i])); #endif - ch[i].hw_value = request->channels[i]->hw_value; - ch[i].flags = request->channels[i]->flags; + parm.ch[i].hw_value = request->channels[i]->hw_value; + parm.ch[i].flags = request->channels[i]->flags; } + parm.ch_num = i; if (request->n_channels == 1) { for (i = 1; i < survey_times_for_one_ch; i++) - _rtw_memcpy(&ch[i], &ch[0], sizeof(struct rtw_ieee80211_channel)); - pch = ch; - chan_num = survey_times_for_one_ch; + _rtw_memcpy(&parm.ch[i], &parm.ch[0], sizeof(struct rtw_ieee80211_channel)); + parm.ch_num = survey_times_for_one_ch; } else if (request->n_channels <= 4) { for (j = request->n_channels - 1; j >= 0; j--) for (i = 0; i < survey_times; i++) - _rtw_memcpy(&ch[j * survey_times + i], &ch[j], sizeof(struct rtw_ieee80211_channel)); - pch = ch; - chan_num = survey_times * request->n_channels; - } else { - pch = ch; - chan_num = request->n_channels; + _rtw_memcpy(&parm.ch[j * survey_times + i], &parm.ch[j], sizeof(struct rtw_ieee80211_channel)); + parm.ch_num = survey_times * request->n_channels; } _enter_critical_bh(&pwdev_priv->scan_req_lock, &irqL); _enter_critical_bh(&pmlmepriv->lock, &irqL); - _status = rtw_sitesurvey_cmd(padapter, ssid, RTW_SSID_SCAN_AMOUNT, pch, chan_num); + _status = rtw_sitesurvey_cmd(padapter, &parm); if (_status == _SUCCESS) pwdev_priv->scan_request = request; else @@ -2452,8 +2727,19 @@ static int cfg80211_rtw_scan(struct wiphy *wiphy check_need_indicate_scan_done: if (_TRUE == need_indicate_scan_done) { +#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) + struct cfg80211_scan_info info; + + memset(&info, 0, sizeof(info)); + info.aborted = 0; +#endif + _rtw_cfg80211_surveydone_event_callback(padapter, request); +#if (KERNEL_VERSION(4, 7, 0) <= LINUX_VERSION_CODE) + cfg80211_scan_done(request, &info); +#else cfg80211_scan_done(request, 0); +#endif } cancel_ps_deny: @@ -2898,11 +3184,6 @@ static int cfg80211_rtw_join_ibss(struct wiphy *wiphy, struct net_device *ndev, goto exit; } - if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { - ret = -EPERM; - goto exit; - } - rtw_ps_deny(padapter, PS_DENY_JOIN); if (_FAIL == rtw_pwr_wakeup(padapter)) { ret = -EPERM; @@ -2952,14 +3233,13 @@ static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) { _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); struct wireless_dev *rtw_wdev = padapter->rtw_wdev; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); enum nl80211_iftype old_type; int ret = 0; RTW_INFO(FUNC_NDEV_FMT"\n", FUNC_NDEV_ARG(ndev)); - #ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _TRUE; - #endif + rtw_wdev_set_not_indic_disco(pwdev_priv, 1); old_type = rtw_wdev->iftype; @@ -2980,9 +3260,7 @@ static int cfg80211_rtw_leave_ibss(struct wiphy *wiphy, struct net_device *ndev) } leave_ibss: - #ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _FALSE; - #endif + rtw_wdev_set_not_indic_disco(pwdev_priv, 0); return 0; } @@ -2991,8 +3269,6 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, struct cfg80211_connect_params *sme) { int ret = 0; - _irqL irqL; - _list *phead; struct wlan_network *pnetwork = NULL; NDIS_802_11_AUTHENTICATION_MODE authmode; NDIS_802_11_SSID ndis_ssid; @@ -3005,17 +3281,18 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; _queue *queue = &pmlmepriv->scanned_queue; + struct wireless_dev *pwdev = padapter->rtw_wdev; + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + _irqL irqL; -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _TRUE; -#endif + rtw_wdev_set_not_indic_disco(pwdev_priv, 1); RTW_INFO("=>"FUNC_NDEV_FMT" - Start to Connection\n", FUNC_NDEV_ARG(ndev)); RTW_INFO("privacy=%d, key=%p, key_len=%d, key_idx=%d, auth_type=%d\n", sme->privacy, sme->key, sme->key_len, sme->key_idx, sme->auth_type); - if (adapter_wdev_data(padapter)->block == _TRUE) { + if (pwdev_priv->block == _TRUE) { ret = -EBUSY; RTW_INFO("%s wdev_priv.block is set\n", __FUNCTION__); goto exit; @@ -3023,7 +3300,7 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, #ifdef CONFIG_PLATFORM_MSTAR_SCAN_BEFORE_CONNECT printk("MStar Android!\n"); - if (adapter_wdev_data(padapter)->bandroid_scan == _FALSE) { + if (pwdev_priv->bandroid_scan == _FALSE) { #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); if (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE)) @@ -3052,11 +3329,6 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, goto cancel_ps_deny; } - if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { - ret = -EPERM; - goto cancel_ps_deny; - } - if (check_fwstate(pmlmepriv, _FW_UNDER_LINKING) == _TRUE) { ret = -EBUSY; RTW_INFO("%s, fw_state=0x%x, goto exit\n", __func__, pmlmepriv->fw_state); @@ -3214,6 +3486,22 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, goto cancel_ps_deny; } + + _enter_critical_bh(&pwdev_priv->connect_req_lock, &irqL); + + if (pwdev_priv->connect_req) { + rtw_wdev_free_connect_req(pwdev_priv); + RTW_INFO(FUNC_NDEV_FMT" free existing connect_req\n", FUNC_NDEV_ARG(ndev)); + } + + pwdev_priv->connect_req = (struct cfg80211_connect_params *)rtw_malloc(sizeof(*pwdev_priv->connect_req)); + if (pwdev_priv->connect_req) + _rtw_memcpy(pwdev_priv->connect_req, sme, sizeof(*pwdev_priv->connect_req)); + else + RTW_WARN(FUNC_NDEV_FMT" alloc connect_req fail\n", FUNC_NDEV_ARG(ndev)); + + _exit_critical_bh(&pwdev_priv->connect_req_lock, &irqL); + RTW_INFO("set ssid:dot11AuthAlgrthm=%d, dot11PrivacyAlgrthm=%d, dot118021XGrpPrivacy=%d\n", psecuritypriv->dot11AuthAlgrthm, psecuritypriv->dot11PrivacyAlgrthm, psecuritypriv->dot118021XGrpPrivacy); @@ -3223,9 +3511,7 @@ static int cfg80211_rtw_connect(struct wiphy *wiphy, struct net_device *ndev, exit: RTW_INFO("<=%s, ret %d\n", __FUNCTION__, ret); -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _FALSE; -#endif + rtw_wdev_set_not_indic_disco(pwdev_priv, 0); return ret; } @@ -3234,12 +3520,14 @@ static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, u16 reason_code) { _adapter *padapter = (_adapter *)rtw_netdev_priv(ndev); + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); RTW_INFO(FUNC_NDEV_FMT" - Start to Disconnect\n", FUNC_NDEV_ARG(ndev)); -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _TRUE; +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) + if (!wiphy->dev.power.is_prepared) #endif + rtw_wdev_set_not_indic_disco(pwdev_priv, 1); rtw_set_to_roam(padapter, 0); @@ -3247,20 +3535,19 @@ static int cfg80211_rtw_disconnect(struct wiphy *wiphy, struct net_device *ndev, { rtw_scan_abort(padapter); LeaveAllPowerSaveMode(padapter); - rtw_disassoc_cmd(padapter, 500, _FALSE); - rtw_sta_mstatus_report(padapter); - + rtw_disassoc_cmd(padapter, 500, RTW_CMDF_WAIT_ACK); +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_do_disconnect(padapter); +#endif RTW_INFO("%s...call rtw_indicate_disconnect\n", __func__); rtw_free_assoc_resources(padapter, 1); - rtw_indicate_disconnect(padapter, 0, _TRUE); + rtw_indicate_disconnect(padapter, 0, wiphy->dev.power.is_prepared ? _FALSE : _TRUE); rtw_pwr_wakeup(padapter); } -#ifdef SUPPLICANT_RTK_VERSION_LOWER_THAN_JB42 - padapter->mlmepriv.not_indic_disco = _FALSE; -#endif + rtw_wdev_set_not_indic_disco(pwdev_priv, 0); RTW_INFO(FUNC_NDEV_FMT" return 0\n", FUNC_NDEV_ARG(ndev)); return 0; @@ -3460,7 +3747,7 @@ void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint f { struct station_info sinfo; u8 ie_offset; - if (GetFrameSubType(pmgmt_frame) == WIFI_ASSOCREQ) + if (get_frame_sub_type(pmgmt_frame) == WIFI_ASSOCREQ) ie_offset = _ASOCREQ_IE_OFFSET_; else /* WIFI_REASSOCREQ */ ie_offset = _REASOCREQ_IE_OFFSET_; @@ -3469,7 +3756,7 @@ void rtw_cfg80211_indicate_sta_assoc(_adapter *padapter, u8 *pmgmt_frame, uint f sinfo.filled = STATION_INFO_ASSOC_REQ_IES; sinfo.assoc_req_ies = pmgmt_frame + WLAN_HDR_A3_LEN + ie_offset; sinfo.assoc_req_ies_len = frame_len - WLAN_HDR_A3_LEN - ie_offset; - cfg80211_new_sta(ndev, GetAddr2Ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); + cfg80211_new_sta(ndev, get_addr2_ptr(pmgmt_frame), &sinfo, GFP_ATOMIC); } #else /* defined(RTW_USE_CFG80211_STA_EVENT) */ channel = pmlmeext->cur_channel; @@ -3530,7 +3817,7 @@ void rtw_cfg80211_indicate_sta_disassoc(_adapter *padapter, unsigned char *da, u SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pmgmt_frame, WIFI_DEAUTH); + set_frame_sub_type(pmgmt_frame, WIFI_DEAUTH); pmgmt_frame += sizeof(struct rtw_ieee80211_hdr_3addr); frame_len = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -3774,7 +4061,11 @@ static int rtw_cfg80211_add_monitor_if(_adapter *padapter, char *name, struct ne mon_ndev->type = ARPHRD_IEEE80211_RADIOTAP; strncpy(mon_ndev->name, name, IFNAMSIZ); mon_ndev->name[IFNAMSIZ - 1] = 0; +#if (LINUX_VERSION_CODE > KERNEL_VERSION(4, 11, 8)) + mon_ndev->priv_destructor = rtw_ndev_destructor; +#else mon_ndev->destructor = rtw_ndev_destructor; +#endif #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) mon_ndev->netdev_ops = &rtw_cfg80211_monitor_if_ops; @@ -3840,7 +4131,11 @@ static int #if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 1, 0)) unsigned char name_assign_type, #endif - enum nl80211_iftype type, u32 *flags, struct vif_params *params) + enum nl80211_iftype type, + #if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0)) + u32 *flags, + #endif + struct vif_params *params) { int ret = 0; struct wireless_dev *wdev = NULL; @@ -3848,6 +4143,8 @@ static int _adapter *padapter; struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); + rtw_set_rtnl_lock_holder(dvobj, current); + RTW_INFO(FUNC_WIPHY_FMT" name:%s, type:%d\n", FUNC_WIPHY_ARG(wiphy), name, type); switch (type) { @@ -3904,6 +4201,8 @@ static int else RTW_INFO(FUNC_WIPHY_FMT" wdev:%p, ret:%d\n", FUNC_WIPHY_ARG(wiphy), wdev, ret); + rtw_set_rtnl_lock_holder(dvobj, NULL); + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) return wdev ? wdev : ERR_PTR(ret); #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38)) || defined(COMPAT_KERNEL_RELEASE) @@ -3925,9 +4224,12 @@ static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, struct net_device *ndev = wdev_to_ndev(wdev); #endif int ret = 0; + struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); _adapter *adapter; struct rtw_wdev_priv *pwdev_priv; + rtw_set_rtnl_lock_holder(dvobj, current); + if (ndev) { adapter = (_adapter *)rtw_netdev_priv(ndev); pwdev_priv = adapter_wdev_data(adapter); @@ -3958,6 +4260,7 @@ static int cfg80211_rtw_del_virtual_intf(struct wiphy *wiphy, } exit: + rtw_set_rtnl_lock_holder(dvobj, NULL); return ret; } @@ -4248,8 +4551,8 @@ static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev target_mac = params->mac; #endif - if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE)) != _TRUE) { - RTW_INFO("%s, fw_state != FW_LINKED|WIFI_AP_STATE\n", __func__); + if (check_fwstate(pmlmepriv, (_FW_LINKED | WIFI_AP_STATE | WIFI_MESH_STATE)) != _TRUE) { + RTW_INFO("%s, fw_state != FW_LINKED|WIFI_AP_STATE|WIFI_MESH_STATE\n", __func__); return -EINVAL; } @@ -4259,8 +4562,9 @@ static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev flush_all_cam_entry(padapter); /* clear CAM */ +#ifdef CONFIG_AP_MODE ret = rtw_sta_flush(padapter, _TRUE); - +#endif return ret; } @@ -4284,17 +4588,17 @@ static int cfg80211_rtw_del_station(struct wiphy *wiphy, struct net_device *ndev plist = get_next(plist); - if (_rtw_memcmp((u8 *)target_mac, psta->hwaddr, ETH_ALEN)) { + if (_rtw_memcmp((u8 *)target_mac, psta->cmn.mac_addr, ETH_ALEN)) { if (psta->dot8021xalg == 1 && psta->bpairwise_key_installed == _FALSE) RTW_INFO("%s, sta's dot8021xalg = 1 and key_installed = _FALSE\n", __func__); else { - RTW_INFO("free psta=%p, aid=%d\n", psta, psta->aid); + RTW_INFO("free psta=%p, aid=%d\n", psta, psta->cmn.aid); rtw_list_delete(&psta->asoc_list); pstapriv->asoc_list_cnt--; /* _exit_critical_bh(&pstapriv->asoc_list_lock, &irqL); */ - if (check_fwstate(pmlmepriv, (WIFI_AP_STATE)) == _TRUE) + if (MLME_IS_AP(padapter)) updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_PREV_AUTH_NOT_VALID, _TRUE); else updated = ap_free_sta(padapter, psta, _TRUE, WLAN_REASON_DEAUTH_LEAVING, _TRUE); @@ -4372,10 +4676,10 @@ static int cfg80211_rtw_dump_station(struct wiphy *wiphy, struct net_device *nde ret = -ENOENT; goto exit; } - _rtw_memcpy(mac, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(mac, psta->cmn.mac_addr, ETH_ALEN); sinfo->filled = 0; sinfo->filled |= STATION_INFO_SIGNAL; - sinfo->signal = psta->rssi; + sinfo->signal = translate_percentage_to_dbm(psta->cmn.rssi_stat.rssi); exit: return ret; @@ -4440,7 +4744,10 @@ static int cfg80211_rtw_set_channel(struct wiphy *wiphy break; } - set_channel_bwmode(padapter, chan_target, chan_offset, chan_width); + RTW_INFO(FUNC_ADPT_FMT" ch:%d bw:%d, offset:%d\n" + , FUNC_ADPT_ARG(padapter), chan_target, chan_width, chan_offset); + + rtw_set_chbw_cmd(padapter, chan_target, chan_width, chan_offset, RTW_CMDF_WAIT_ACK); return 0; } @@ -4536,8 +4843,10 @@ static int cfg80211_rtw_set_monitor_channel(struct wiphy *wiphy break; } #endif + RTW_INFO(FUNC_ADPT_FMT" ch:%d bw:%d, offset:%d\n" + , FUNC_ADPT_ARG(padapter), target_channal, target_width, target_offset); - set_channel_bwmode(padapter, target_channal, target_offset, target_width); + rtw_set_chbw_cmd(padapter, target_channal, target_width, target_offset, RTW_CMDF_WAIT_ACK); return 0; } @@ -4572,10 +4881,15 @@ void rtw_cfg80211_rx_probe_request(_adapter *adapter, union recv_frame *rframe) freq = rtw_ch2freq(ch); #ifdef CONFIG_DEBUG_CFG80211 - RTW_INFO("RTW_Rx: probe request, ch=%d(%d)\n", ch, sch); + RTW_INFO("RTW_Rx: probe request, ch=%d(%d), ta="MAC_FMT"\n" + , ch, sch, MAC_ARG(get_addr2_ptr(frame))); #endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2,6,37)) || defined(COMPAT_KERNEL_RELEASE) rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); +#else + cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); +#endif } void rtw_cfg80211_rx_action_p2p(_adapter *adapter, union recv_frame *rframe) @@ -4591,7 +4905,8 @@ void rtw_cfg80211_rx_action_p2p(_adapter *adapter, union recv_frame *rframe) ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; freq = rtw_ch2freq(ch); - RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); + RTW_INFO("RTW_Rx:ch=%d(%d), ta="MAC_FMT"\n" + , ch, sch, MAC_ARG(get_addr2_ptr(frame))); #ifdef CONFIG_P2P type = rtw_p2p_check_frames(adapter, frame, frame_len, _FALSE); if (type >= 0) @@ -4624,7 +4939,8 @@ void rtw_cfg80211_rx_p2p_action_public(_adapter *adapter, union recv_frame *rfra ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; freq = rtw_ch2freq(ch); - RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); + RTW_INFO("RTW_Rx:ch=%d(%d, ta="MAC_FMT")\n" + , ch, sch, MAC_ARG(get_addr2_ptr(frame))); #ifdef CONFIG_P2P type = rtw_p2p_check_frames(adapter, frame, frame_len, _FALSE); if (type >= 0) { @@ -4690,11 +5006,15 @@ void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const c ch = rframe->u.hdr.attrib.ch ? rframe->u.hdr.attrib.ch : sch; freq = rtw_ch2freq(ch); - rtw_action_frame_parse(frame, frame_len, &category, &action); + RTW_INFO("RTW_Rx:ch=%d(%d), ta="MAC_FMT"\n" + , ch, sch, MAC_ARG(get_addr2_ptr(frame))); - if (action == ACT_PUBLIC_GAS_INITIAL_REQ) { - rtw_mi_set_scan_deny(adapter, 200); - rtw_mi_scan_abort(adapter, _FALSE); /*rtw_scan_abort_no_wait*/ + rtw_action_frame_parse(frame, frame_len, &category, &action); + if (category == RTW_WLAN_CATEGORY_PUBLIC) { + if (action == ACT_PUBLIC_GAS_INITIAL_REQ) { + rtw_mi_set_scan_deny(adapter, 200); + rtw_mi_scan_abort(adapter, _FALSE); /*rtw_scan_abort_no_wait*/ + } } #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) @@ -4703,13 +5023,33 @@ void rtw_cfg80211_rx_action(_adapter *adapter, union recv_frame *rframe, const c cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); #endif - RTW_INFO("RTW_Rx:ch=%d(%d)\n", ch, sch); if (msg) RTW_INFO("RTW_Rx:%s\n", msg); else RTW_INFO("RTW_Rx:category(%u), action(%u)\n", category, action); } +#ifdef CONFIG_RTW_80211K +void rtw_cfg80211_rx_rrm_action(_adapter *adapter, union recv_frame *rframe) +{ + struct wireless_dev *wdev = adapter->rtw_wdev; + u8 *frame = get_recvframe_data(rframe); + uint frame_len = rframe->u.hdr.len; + s32 ch, freq; + + + ch = rtw_get_oper_ch(adapter); + freq = rtw_ch2freq(ch); + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) || defined(COMPAT_KERNEL_RELEASE) + rtw_cfg80211_rx_mgmt(wdev, freq, 0, frame, frame_len, GFP_ATOMIC); +#else + cfg80211_rx_action(adapter->pnetdev, freq, frame, frame_len, GFP_ATOMIC); +#endif + RTW_INFO("RTW_Rx:ch=%d, freq=%d\n", ch, freq); +} +#endif /* CONFIG_RTW_80211K */ + #ifdef CONFIG_P2P void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len) { @@ -4817,7 +5157,7 @@ void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, SetSeqNum(pwlanhdr, pmlmeext->mgnt_seq); pmlmeext->mgnt_seq++; - SetFrameSubType(pframe, WIFI_ACTION); + set_frame_sub_type(pframe, WIFI_ACTION); pframe += sizeof(struct rtw_ieee80211_hdr_3addr); pattrib->pktlen = sizeof(struct rtw_ieee80211_hdr_3addr); @@ -5004,21 +5344,12 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, u8 remain_ch = (u8) ieee80211_frequency_to_channel(channel->center_freq); u8 union_ch = 0, union_bw = 0, union_offset = 0; u8 i; - u8 ready_on_channel = _FALSE; _adapter *padapter = NULL; - _adapter *iface; - struct dvobj_priv *dvobj; struct rtw_wdev_priv *pwdev_priv; - struct mlme_ext_priv *pmlmeext; struct wifidirect_info *pwdinfo; struct cfg80211_wifidirect_info *pcfg80211_wdinfo; u8 is_p2p_find = _FALSE; -#ifndef CONFIG_RADIO_WORK -#define RTW_ROCH_DURATION_ENLARGE -#define RTW_ROCH_BACK_OP -#endif - #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) #if defined(RTW_DEDICATED_P2P_DEVICE) if (wdev == wiphy_to_pd_wdev(wiphy)) @@ -5042,9 +5373,7 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, wdev = ndev_to_wdev(ndev); #endif - dvobj = adapter_to_dvobj(padapter); pwdev_priv = adapter_wdev_data(padapter); - pmlmeext = &padapter->mlmeextpriv; pwdinfo = &padapter->wdinfo; pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; #ifdef CONFIG_CONCURRENT_MODE @@ -5057,14 +5386,14 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, , FUNC_ADPT_ARG(padapter), wdev == wiphy_to_pd_wdev(wiphy) ? " PD" : "" , remain_ch, duration, *cookie); - if (rtw_ch_set_search_ch(pmlmeext->channel_set, remain_ch) < 0) { + if (rtw_chset_search_ch(adapter_to_chset(padapter), remain_ch) < 0) { RTW_WARN(FUNC_ADPT_FMT" invalid ch:%u\n", FUNC_ADPT_ARG(padapter), remain_ch); err = -EFAULT; goto exit; } #ifdef CONFIG_MP_INCLUDED - if (rtw_mi_mp_mode_check(padapter)) { + if (rtw_mp_mode_check(padapter)) { RTW_INFO("MP mode block remain_on_channel request\n"); err = -EFAULT; goto exit; @@ -5095,7 +5424,7 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, RTW_INFO(FUNC_ADPT_FMT" init listen_channel %u\n" , FUNC_ADPT_ARG(padapter), padapter->wdinfo.listen_channel); } else if (rtw_p2p_chk_state(pwdinfo , P2P_STATE_LISTEN) - && (time_after_eq((unsigned long)rtw_get_current_time(), (unsigned long)pwdev_priv->probe_resp_ie_update_time) + && (time_after_eq(rtw_get_current_time(), pwdev_priv->probe_resp_ie_update_time) && rtw_get_passing_time_ms(pwdev_priv->probe_resp_ie_update_time) < 50) ) { if (padapter->wdinfo.listen_channel != remain_ch) { @@ -5105,17 +5434,9 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, } } else { rtw_p2p_set_pre_state(pwdinfo, rtw_p2p_state(pwdinfo)); - #ifdef CONFIG_DEBUG_CFG80211 +#ifdef CONFIG_DEBUG_CFG80211 RTW_INFO("%s, role=%d, p2p_state=%d\n", __func__, rtw_p2p_role(pwdinfo), rtw_p2p_state(pwdinfo)); - #endif - } - - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if (check_fwstate(&iface->mlmepriv, _FW_UNDER_LINKING | WIFI_UNDER_WPS) == _TRUE) { - RTW_INFO(ADPT_FMT"- _FW_UNDER_LINKING |WIFI_UNDER_WPS (mlme state:0x%x)\n", ADPT_ARG(iface), get_fwstate(&iface->mlmepriv)); - remain_ch = iface->mlmeextpriv.cur_channel; - } +#endif } rtw_p2p_set_state(pwdinfo, P2P_STATE_LISTEN); @@ -5144,53 +5465,10 @@ static s32 cfg80211_rtw_remain_on_channel(struct wiphy *wiphy, #endif pcfg80211_wdinfo->restore_channel = rtw_get_oper_ch(padapter); -#ifdef CONFIG_CONCURRENT_MODE - if (rtw_mi_check_status(padapter, MI_LINKED) && (0 != rtw_mi_get_union_chan(padapter))) { - if ((remain_ch != rtw_mi_get_union_chan(padapter)) && !check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { - if (ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1 || - (remain_ch != pmlmeext->cur_channel)) { - - rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); - ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); - - #ifdef RTW_ROCH_BACK_OP - RTW_INFO("%s, set switch ch timer, duration=%d\n", __func__, duration - pwdinfo->ext_listen_interval); - _set_timer(&pwdinfo->ap_p2p_switch_timer, duration - pwdinfo->ext_listen_interval); - #endif - } - } - ready_on_channel = _TRUE; - } else -#endif /* CONFIG_CONCURRENT_MODE */ - { - if (remain_ch != rtw_get_oper_ch(padapter)) - ready_on_channel = _TRUE; - } - - if (ready_on_channel == _TRUE) { - #ifndef RTW_SINGLE_WIPHY - if (!check_fwstate(&padapter->mlmepriv, _FW_LINKED)) - #endif - { - #ifdef CONFIG_CONCURRENT_MODE - if (rtw_get_oper_ch(padapter) != remain_ch) - #endif - { - /* if (!padapter->mlmepriv.LinkDetectInfo.bBusyTraffic) */ - set_channel_bwmode(padapter, remain_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); - } - } - } - -#ifdef CONFIG_BT_COEXIST - rtw_btcoex_ScanNotify(padapter, _TRUE); -#endif - - RTW_INFO("%s, set ro ch timer, duration=%d\n", __func__, duration); - _set_timer(&pcfg80211_wdinfo->remain_on_ch_timer, duration); + p2p_roch_cmd(padapter, *cookie, wdev, channel, pcfg80211_wdinfo->remain_on_ch_type, + duration, RTW_CMDF_WAIT_ACK); rtw_cfg80211_ready_on_channel(wdev, *cookie, channel, channel_type, duration, GFP_KERNEL); - exit: return err; } @@ -5347,8 +5625,9 @@ int rtw_pd_iface_alloc(struct wiphy *wiphy, const char *name, struct wireless_de void rtw_pd_iface_free(struct wiphy *wiphy) { + struct dvobj_priv *dvobj = wiphy_to_dvobj(wiphy); struct rtw_wiphy_data *wiphy_data = rtw_wiphy_priv(wiphy); - int rtnl_locked; + u8 rtnl_lock_needed; if (!wiphy_data->pd_wdev) goto exit; @@ -5357,11 +5636,11 @@ void rtw_pd_iface_free(struct wiphy *wiphy) , FUNC_WIPHY_ARG(wiphy), wiphy_data->pd_wdev , MAC_ARG(wdev_address(wiphy_data->pd_wdev))); - rtnl_locked = rtnl_is_locked(); - if (!rtnl_locked) + rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); + if (rtnl_lock_needed) rtnl_lock(); cfg80211_unregister_wdev(wiphy_data->pd_wdev); - if (!rtnl_locked) + if (rtnl_lock_needed) rtnl_unlock(); rtw_mfree((u8 *)wiphy_data->pd_wdev, sizeof(struct wireless_dev)); @@ -5459,9 +5738,6 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const #endif /* CONFIG_P2P */ /* struct cfg80211_wifidirect_info *pcfg80211_wdinfo = &padapter->cfg80211_wdinfo; */ - rtw_mi_set_scan_deny(padapter, 1000); - rtw_mi_scan_abort(padapter, _TRUE); - rtw_cfg80211_set_is_mgmt_tx(padapter, 1); #ifdef CONFIG_BT_COEXIST @@ -5478,6 +5754,15 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const #endif /* CONFIG_CONCURRENT_MODE */ } #endif /* CONFIG_P2P */ + +#ifdef CONFIG_MCC_MODE + if (MCC_EN(padapter)) { + if (rtw_hal_check_mcc_status(padapter, MCC_STATUS_DOING_MCC)) + /* don't set channel, issue frame directly */ + goto issue_mgmt_frame; + } +#endif /* CONFIG_MCC_MODE */ + #ifdef CONFIG_CONCURRENT_MODE if (rtw_mi_check_status(padapter, MI_LINKED)) { u8 union_ch = rtw_mi_get_union_chan(padapter); @@ -5488,7 +5773,8 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const u16 ext_listen_period; if (ATOMIC_READ(&pwdev_priv->switch_ch_to) == 1) { - rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); + rtw_leave_opch(padapter); + ATOMIC_SET(&pwdev_priv->switch_ch_to, 0); /* RTW_INFO("%s, set switch ch timer, period=%d\n", __func__, pwdinfo->ext_listen_period); */ /* _set_timer(&pwdinfo->ap_p2p_switch_timer, pwdinfo->ext_listen_period); */ @@ -5519,6 +5805,7 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const set_channel_bwmode(padapter, tx_ch, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); } +issue_mgmt_frame: /* starting alloc mgmt frame to dump it */ pmgntframe = alloc_mgtxmitframe(pxmitpriv); if (pmgntframe == NULL) { @@ -5595,6 +5882,18 @@ static int _cfg80211_rtw_mgmt_tx(_adapter *padapter, u8 tx_ch, u8 no_cck, const } +u8 rtw_mgnt_tx_handler(_adapter *adapter, u8 *buf) +{ + u8 rst = H2C_CMD_FAIL; + struct mgnt_tx_parm *mgnt_parm = (struct mgnt_tx_parm *)buf; + + if (_cfg80211_rtw_mgmt_tx(adapter, mgnt_parm->tx_ch, mgnt_parm->no_cck, + mgnt_parm->buf, mgnt_parm->len, mgnt_parm->wait_ack) == _SUCCESS) + rst = H2C_SUCCESS; + + return rst; +} + static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) struct wireless_dev *wdev, @@ -5640,16 +5939,21 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, bool no_cck = 0; #endif int ret = 0; - int tx_ret; + u8 tx_ret; int wait_ack = 1; u32 dump_limit = RTW_MAX_MGMT_TX_CNT; u32 dump_cnt = 0; + u32 sleep_ms = 0; + u32 retry_guarantee_ms = 0; bool ack = _TRUE; u8 tx_ch; u8 category, action; u8 frame_styp; +#ifdef CONFIG_P2P + u8 is_p2p = 0; +#endif int type = (-1); - u32 start = rtw_get_current_time(); + systime start = rtw_get_current_time(); _adapter *padapter; struct dvobj_priv *dvobj; struct rtw_wdev_priv *pwdev_priv; @@ -5726,7 +6030,7 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, } if (rtw_action_frame_parse(buf, len, &category, &action) == _FALSE) { - RTW_INFO(FUNC_ADPT_FMT" frame_control:0x%x\n", FUNC_ADPT_ARG(padapter), + RTW_INFO(FUNC_ADPT_FMT" frame_control:0x%02x\n", FUNC_ADPT_ARG(padapter), le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)buf)->frame_ctl)); goto exit; } @@ -5735,12 +6039,25 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, #ifdef CONFIG_P2P type = rtw_p2p_check_frames(padapter, buf, len, _TRUE); if (type >= 0) { + is_p2p = 1; no_cck = 1; /* force no CCK for P2P frames */ goto dump; } #endif - if (category == RTW_WLAN_CATEGORY_PUBLIC) + if (category == RTW_WLAN_CATEGORY_PUBLIC) { RTW_INFO("RTW_Tx:%s\n", action_public_str(action)); + switch (action) { + case ACT_PUBLIC_GAS_INITIAL_REQ: + case ACT_PUBLIC_GAS_INITIAL_RSP: + sleep_ms = 50; + retry_guarantee_ms = RTW_MAX_MGMT_TX_MS_GAS; + break; + } + } +#ifdef CONFIG_RTW_80211K + else if (category == RTW_WLAN_CATEGORY_RADIO_MEAS) + RTW_INFO("RTW_Tx: RRM Action\n"); +#endif else RTW_INFO("RTW_Tx:category(%u), action(%u)\n", category, action); @@ -5753,19 +6070,11 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, } while (1) { - u32 sleep_ms = 0; - u32 retry_guarantee_ms = 0; - dump_cnt++; - tx_ret = _cfg80211_rtw_mgmt_tx(padapter, tx_ch, no_cck, buf, len, wait_ack); - - switch (action) { - case ACT_PUBLIC_GAS_INITIAL_REQ: - case ACT_PUBLIC_GAS_INITIAL_RSP: - sleep_ms = 50; - retry_guarantee_ms = RTW_MAX_MGMT_TX_MS_GAS; - } + rtw_mi_set_scan_deny(padapter, 1000); + rtw_mi_scan_abort(padapter, _TRUE); + tx_ret = rtw_mgnt_tx_cmd(padapter, tx_ch, no_cck, buf, len, wait_ack, RTW_CMDF_WAIT_ACK); if (tx_ret == _SUCCESS || (dump_cnt >= dump_limit && rtw_get_passing_time_ms(start) >= retry_guarantee_ms)) break; @@ -5779,41 +6088,45 @@ static int cfg80211_rtw_mgmt_tx(struct wiphy *wiphy, tx_ret == _SUCCESS ? "OK" : "FAIL", dump_cnt, dump_limit, rtw_get_passing_time_ms(start)); } - switch (type) { - case P2P_GO_NEGO_CONF: - if (0) { - RTW_INFO(FUNC_ADPT_FMT" Nego confirm. state=%u, status=%u, iaddr="MAC_FMT"\n" - , FUNC_ADPT_ARG(padapter), pwdev_priv->nego_info.state, pwdev_priv->nego_info.status - , MAC_ARG(pwdev_priv->nego_info.iface_addr)); - } - if (pwdev_priv->nego_info.state == 2 - && pwdev_priv->nego_info.status == 0 - && rtw_check_invalid_mac_address(pwdev_priv->nego_info.iface_addr, _FALSE) == _FALSE - ) { - _adapter *intended_iface = dvobj_get_adapter_by_addr(dvobj, pwdev_priv->nego_info.iface_addr); - - if (intended_iface) { - RTW_INFO(FUNC_ADPT_FMT" Nego confirm. Allow only "ADPT_FMT" to scan for 2000 ms\n" - , FUNC_ADPT_ARG(padapter), ADPT_ARG(intended_iface)); - /* allow only intended_iface to do scan for 2000 ms */ - rtw_mi_set_scan_deny(padapter, 2000); - rtw_clear_scan_deny(intended_iface); +#ifdef CONFIG_P2P + if (is_p2p) { + switch (type) { + case P2P_GO_NEGO_CONF: + if (0) { + RTW_INFO(FUNC_ADPT_FMT" Nego confirm. state=%u, status=%u, iaddr="MAC_FMT"\n" + , FUNC_ADPT_ARG(padapter), pwdev_priv->nego_info.state, pwdev_priv->nego_info.status + , MAC_ARG(pwdev_priv->nego_info.iface_addr)); } + if (pwdev_priv->nego_info.state == 2 + && pwdev_priv->nego_info.status == 0 + && rtw_check_invalid_mac_address(pwdev_priv->nego_info.iface_addr, _FALSE) == _FALSE + ) { + _adapter *intended_iface = dvobj_get_adapter_by_addr(dvobj, pwdev_priv->nego_info.iface_addr); + + if (intended_iface) { + RTW_INFO(FUNC_ADPT_FMT" Nego confirm. Allow only "ADPT_FMT" to scan for 2000 ms\n" + , FUNC_ADPT_ARG(padapter), ADPT_ARG(intended_iface)); + /* allow only intended_iface to do scan for 2000 ms */ + rtw_mi_set_scan_deny(padapter, 2000); + rtw_clear_scan_deny(intended_iface); + } + } + break; + case P2P_INVIT_RESP: + if (pwdev_priv->invit_info.flags & BIT(0) + && pwdev_priv->invit_info.status == 0 + ) { + RTW_INFO(FUNC_ADPT_FMT" agree with invitation of persistent group\n", + FUNC_ADPT_ARG(padapter)); + #if !RTW_P2P_GROUP_INTERFACE + rtw_mi_buddy_set_scan_deny(padapter, 5000); + #endif + rtw_pwr_wakeup_ex(padapter, 5000); + } + break; } - break; - case P2P_INVIT_RESP: - if (pwdev_priv->invit_info.flags & BIT(0) - && pwdev_priv->invit_info.status == 0 - ) { - RTW_INFO(FUNC_ADPT_FMT" agree with invitation of persistent group\n", - FUNC_ADPT_ARG(padapter)); - #if !RTW_P2P_GROUP_INTERFACE - rtw_mi_buddy_set_scan_deny(padapter, 5000); - #endif - rtw_pwr_wakeup_ex(padapter, 5000); - } - break; } +#endif /* CONFIG_P2P */ cancel_ps_deny: rtw_ps_deny_cancel(padapter, PS_DENY_MGNT_TX); @@ -5896,6 +6209,11 @@ static int cfg80211_rtw_tdls_mgmt(struct wiphy *wiphy, goto discard; } + if (rtw_is_tdls_enabled(padapter) == _FALSE) { + RTW_INFO("TDLS is not enabled\n"); + goto discard; + } + if (rtw_tdls_is_driver_setup(padapter)) { RTW_INFO("Discard tdls action:%d, let driver to set up direct link\n", action_code); goto discard; @@ -5978,6 +6296,11 @@ static int cfg80211_rtw_tdls_oper(struct wiphy *wiphy, return 0; } + if (rtw_is_tdls_enabled(padapter) == _FALSE) { + RTW_INFO("TDLS is not enabled\n"); + return 0; + } + #ifdef CONFIG_LPS rtw_lps_ctrl_wk_cmd(padapter, LPS_CTRL_LEAVE, 1); #endif /* CONFIG_LPS */ @@ -6021,7 +6344,7 @@ static int cfg80211_rtw_tdls_oper(struct wiphy *wiphy, RTW_INFO(FUNC_NDEV_FMT", NL80211_TDLS_ENABLE_LINK;mac:"MAC_FMT"\n", FUNC_NDEV_ARG(ndev), MAC_ARG(peer)); ptdls_sta = rtw_get_stainfo(&(padapter->stapriv), (u8 *)peer); if (ptdls_sta != NULL) { - ptdlsinfo->link_established = _TRUE; + rtw_tdls_set_link_established(padapter, _TRUE); ptdls_sta->tdls_sta_state |= TDLS_LINKED_STATE; ptdls_sta->state |= _FW_LINKED; rtw_tdls_cmd(padapter, txmgmt.peer, TDLS_ESTABLISHED); @@ -6046,6 +6369,10 @@ static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + struct cfg80211_ssid *ssids; + int n_ssids = 0; + int interval = 0; + int i = 0; u8 ret; if (padapter->bup == _FALSE) { @@ -6064,10 +6391,26 @@ static int cfg80211_rtw_sched_scan_start(struct wiphy *wiphy, RTW_INFO("%s: invalid cfg80211_requests parameters.\n", __func__); return -EINVAL; } - - ret = rtw_android_cfg80211_pno_setup(dev, request->ssids, - request->n_ssids, request->interval); - +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) + interval = request->interval; + n_ssids = request->n_match_sets; + ssids = (struct cfg80211_ssid *)rtw_zmalloc(n_ssids * sizeof(struct cfg80211_ssid)); + if(ssids == NULL) { + RTW_ERR("Fail to allocate ssids for PNO\n"); + return -ENOMEM; + } + for (i=0;in_match_sets;i++) { + ssids[i].ssid_len = request->match_sets[i].ssid.ssid_len; + memcpy(ssids[i].ssid, request->match_sets[i].ssid.ssid, + request->match_sets[i].ssid.ssid_len); + } +#else + interval = request->interval; + n_ssids = request->n_ssids; + ssids = request->ssids; +#endif +ret = rtw_android_cfg80211_pno_setup(dev, ssids, + n_ssids, interval); if (ret < 0) { RTW_INFO("%s ret: %d\n", __func__, ret); goto exit; @@ -6087,6 +6430,65 @@ static int cfg80211_rtw_sched_scan_stop(struct wiphy *wiphy, { return rtw_android_pno_enable(dev, _FALSE); } + +int cfg80211_rtw_suspend(struct wiphy *wiphy, struct cfg80211_wowlan *wow) { + RTW_DBG("==> %s\n",__func__); + RTW_DBG("<== %s\n",__func__); + return 0; +} + +int cfg80211_rtw_resume(struct wiphy *wiphy) { + + _adapter *padapter; + struct pwrctrl_priv *pwrpriv; + struct mlme_priv *pmlmepriv; + padapter = wiphy_to_adapter(wiphy); + pwrpriv = adapter_to_pwrctl(padapter); + pmlmepriv = &padapter->mlmepriv; + struct sitesurvey_parm parm; + int i, len; + + + RTW_DBG("==> %s\n",__func__); + if (pwrpriv->wowlan_last_wake_reason == RX_PNO) { + + struct rtw_wdev_priv *pwdev_priv = adapter_wdev_data(padapter); + _irqL irqL; + int PNOWakeupScanWaitCnt = 0; + + rtw_cfg80211_disconnected(padapter->rtw_wdev, 0, NULL, 0, 1, GFP_ATOMIC); + + rtw_init_sitesurvey_parm(padapter, &parm); + for (i=0;ipnlo_info->ssid_num && i < RTW_SSID_SCAN_AMOUNT; i++) { + len = pwrpriv->pno_ssid_list->node[i].SSID_len; + _rtw_memcpy(&parm.ssid[i].Ssid, pwrpriv->pno_ssid_list->node[i].SSID, len); + parm->ssid[i].SsidLength = len; + } + prm->ssid_num = pwrpriv->pnlo_info->ssid_num; + + rtw_lock_ext_suspend_timeout(10000); + + _enter_critical_bh(&pmlmepriv->lock, &irqL); + //This modification fix PNO wakeup reconnect issue with hidden SSID AP. + //rtw_sitesurvey_cmd(padapter, NULL); + rtw_sitesurvey_cmd(padapter, &parm); + _exit_critical_bh(&pmlmepriv->lock, &irqL); + + for (PNOWakeupScanWaitCnt = 0; PNOWakeupScanWaitCnt < 10; PNOWakeupScanWaitCnt++) { + if(check_fwstate(pmlmepriv, _FW_UNDER_SURVEY) == _FALSE) + break; + rtw_msleep_os(1000); + } + + _enter_critical_bh(&pmlmepriv->lock, &irqL); + cfg80211_sched_scan_results(padapter->rtw_wdev->wiphy); + _exit_critical_bh(&pmlmepriv->lock, &irqL); + + } + RTW_DBG("<== %s\n",__func__); + return 0; + +} #endif /* CONFIG_PNO_SUPPORT */ static int rtw_cfg80211_set_beacon_wpsp2pie(struct net_device *ndev, char *buf, int len) @@ -6445,8 +6847,9 @@ int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, return ret; } -#ifdef CONFIG_80211N_HT -static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum ieee80211_band band, u8 rf_type) + +static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter + , struct ieee80211_sta_ht_cap *ht_cap, BAND_TYPE band, u8 rf_type) { struct registry_priv *pregistrypriv = &padapter->registrypriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -6466,9 +6869,9 @@ static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter, struct ieee80211_s /* RX STBC */ if (TEST_FLAG(phtpriv->stbc_cap, STBC_HT_ENABLE_RX)) { /*rtw_rx_stbc 0: disable, bit(0):enable 2.4g, bit(1):enable 5g*/ - if (IEEE80211_BAND_2GHZ == band) + if (band == BAND_ON_2_4G) stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(0)) ? _TRUE : _FALSE; - if (IEEE80211_BAND_5GHZ == band) + if (band == BAND_ON_5G) stbc_rx_enable = (pregistrypriv->rx_stbc & BIT(1)) ? _TRUE : _FALSE; if (stbc_rx_enable) { @@ -6494,11 +6897,11 @@ static void rtw_cfg80211_init_ht_capab_ex(_adapter *padapter, struct ieee80211_s } } -static void rtw_cfg80211_init_ht_capab(_adapter *padapter, struct ieee80211_sta_ht_cap *ht_cap, enum ieee80211_band band, u8 rf_type) +static void rtw_cfg80211_init_ht_capab(_adapter *padapter + , struct ieee80211_sta_ht_cap *ht_cap, BAND_TYPE band, u8 rf_type) { -#define MAX_BIT_RATE_40MHZ_MCS23 450 /* Mbps */ -#define MAX_BIT_RATE_40MHZ_MCS15 300 /* Mbps */ -#define MAX_BIT_RATE_40MHZ_MCS7 150 /* Mbps */ + struct hal_spec_t *hal_spec = GET_HAL_SPEC(padapter); + u8 rx_nss = 0; ht_cap->ht_supported = _TRUE; @@ -6518,38 +6921,37 @@ static void rtw_cfg80211_init_ht_capab(_adapter *padapter, struct ieee80211_sta_ ht_cap->mcs.tx_params = IEEE80211_HT_MCS_TX_DEFINED; - /* - *hw->wiphy->bands[IEEE80211_BAND_2GHZ] - *base on ant_num - *rx_mask: RX mask - *if rx_ant =1 rx_mask[0]=0xff;==>MCS0-MCS7 - *if rx_ant =2 rx_mask[1]=0xff;==>MCS8-MCS15 - *if rx_ant >=3 rx_mask[2]=0xff; - *if BW_40 rx_mask[4]=0x01; - *highest supported RX rate - */ - if (rf_type == RF_1T1R) { + rx_nss = rtw_min(rf_type_to_rf_rx_cnt(rf_type), hal_spec->rx_nss_num); + switch (rx_nss) { + case 1: ht_cap->mcs.rx_mask[0] = 0xFF; - - ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS7; - } else if ((rf_type == RF_1T2R) || (rf_type == RF_2T2R) || (rf_type == RF_2T2R_GREEN)) { + break; + case 2: ht_cap->mcs.rx_mask[0] = 0xFF; ht_cap->mcs.rx_mask[1] = 0xFF; - - ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS15; - } else if ((rf_type == RF_2T3R) || (rf_type == RF_3T3R)) { + break; + case 3: ht_cap->mcs.rx_mask[0] = 0xFF; ht_cap->mcs.rx_mask[1] = 0xFF; ht_cap->mcs.rx_mask[2] = 0xFF; - - ht_cap->mcs.rx_highest = MAX_BIT_RATE_40MHZ_MCS23; - } else { + break; + case 4: + ht_cap->mcs.rx_mask[0] = 0xFF; + ht_cap->mcs.rx_mask[1] = 0xFF; + ht_cap->mcs.rx_mask[2] = 0xFF; + ht_cap->mcs.rx_mask[3] = 0xFF; + break; + default: rtw_warn_on(1); RTW_INFO("%s, error rf_type=%d\n", __func__, rf_type); - } + }; + ht_cap->mcs.rx_highest = cpu_to_le16( + rtw_mcs_rate(rf_type + , hal_is_bw_support(padapter, CHANNEL_WIDTH_40) + , hal_is_bw_support(padapter, CHANNEL_WIDTH_40) ? ht_cap->cap & IEEE80211_HT_CAP_SGI_40 : ht_cap->cap & IEEE80211_HT_CAP_SGI_20 + , ht_cap->mcs.rx_mask) / 10); } -#endif /* CONFIG_80211N_HT */ void rtw_cfg80211_init_wdev_data(_adapter *padapter) { @@ -6563,7 +6965,7 @@ void rtw_cfg80211_init_wdev_data(_adapter *padapter) void rtw_cfg80211_init_wiphy(_adapter *padapter) { u8 rf_type; - struct ieee80211_supported_band *bands; + struct ieee80211_supported_band *band; struct wireless_dev *pwdev = padapter->rtw_wdev; struct wiphy *wiphy = pwdev->wiphy; @@ -6571,19 +6973,16 @@ void rtw_cfg80211_init_wiphy(_adapter *padapter) RTW_INFO("%s:rf_type=%d\n", __func__, rf_type); -#ifdef CONFIG_80211N_HT if (IsSupported24G(padapter->registrypriv.wireless_mode)) { - bands = wiphy->bands[IEEE80211_BAND_2GHZ]; - if (bands) - rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, IEEE80211_BAND_2GHZ, rf_type); + band = wiphy->bands[NL80211_BAND_2GHZ]; + if (band) + rtw_cfg80211_init_ht_capab(padapter, &band->ht_cap, BAND_ON_2_4G, rf_type); } -#endif /* CONFIG_80211N_HT */ - #ifdef CONFIG_IEEE80211_BAND_5GHZ - if (IsSupported5G(padapter->registrypriv.wireless_mode)) { - bands = wiphy->bands[IEEE80211_BAND_5GHZ]; - if (bands) - rtw_cfg80211_init_ht_capab(padapter, &bands->ht_cap, IEEE80211_BAND_5GHZ, rf_type); + if (is_supported_5g(padapter->registrypriv.wireless_mode)) { + band = wiphy->bands[NL80211_BAND_5GHZ]; + if (band) + rtw_cfg80211_init_ht_capab(padapter, &band->ht_cap, BAND_ON_5G, rf_type); } #endif /* init regulary domain */ @@ -6691,11 +7090,11 @@ static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) wiphy->n_cipher_suites = ARRAY_SIZE(rtw_cipher_suites); if (IsSupported24G(adapter->registrypriv.wireless_mode)) - wiphy->bands[IEEE80211_BAND_2GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_2GHZ); + wiphy->bands[NL80211_BAND_2GHZ] = rtw_spt_band_alloc(BAND_ON_2_4G); #ifdef CONFIG_IEEE80211_BAND_5GHZ - if (IsSupported5G(adapter->registrypriv.wireless_mode)) - wiphy->bands[IEEE80211_BAND_5GHZ] = rtw_spt_band_alloc(IEEE80211_BAND_5GHZ); + if (is_supported_5g(adapter->registrypriv.wireless_mode)) + wiphy->bands[NL80211_BAND_5GHZ] = rtw_spt_band_alloc(BAND_ON_5G); #endif #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 38) && LINUX_VERSION_CODE < KERNEL_VERSION(3, 0, 0)) @@ -6709,10 +7108,14 @@ static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) /* wiphy->flags |= WIPHY_FLAG_OFFCHAN_TX | WIPHY_FLAG_HAVE_AP_SME; */ #endif -#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) +#if defined(CONFIG_PM) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0) && \ + LINUX_VERSION_CODE < KERNEL_VERSION(4, 12, 0)) wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN; #ifdef CONFIG_PNO_SUPPORT wiphy->max_sched_scan_ssids = MAX_PNO_LIST_COUNT; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) + wiphy->max_match_sets = MAX_PNO_LIST_COUNT; +#endif #endif #endif @@ -6742,6 +7145,177 @@ static void rtw_cfg80211_preinit_wiphy(_adapter *adapter, struct wiphy *wiphy) #endif } +#ifdef CONFIG_RFKILL_POLL +void rtw_cfg80211_init_rfkill(struct wiphy *wiphy) +{ + wiphy_rfkill_set_hw_state(wiphy, 0); + wiphy_rfkill_start_polling(wiphy); +} + +void rtw_cfg80211_deinit_rfkill(struct wiphy *wiphy) +{ + wiphy_rfkill_stop_polling(wiphy); +} + +static void cfg80211_rtw_rfkill_poll(struct wiphy *wiphy) +{ + _adapter *padapter = NULL; + bool blocked = _FALSE; + u8 valid = 0; + + padapter = wiphy_to_adapter(wiphy); + + if (adapter_to_dvobj(padapter)->processing_dev_remove == _TRUE) { + /*RTW_INFO("cfg80211_rtw_rfkill_poll: device is removed!\n");*/ + return; + } + + blocked = rtw_hal_rfkill_poll(padapter, &valid); + /*RTW_INFO("cfg80211_rtw_rfkill_poll: valid=%d, blocked=%d\n", + valid, blocked);*/ + + if (valid) + wiphy_rfkill_set_hw_state(wiphy, blocked); +} +#endif + +#if defined(CONFIG_RTW_HOSTAPD_ACS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) && (LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0)) +#define SURVEY_INFO_TIME SURVEY_INFO_CHANNEL_TIME +#define SURVEY_INFO_TIME_BUSY SURVEY_INFO_CHANNEL_TIME_BUSY +#define SURVEY_INFO_TIME_EXT_BUSY SURVEY_INFO_CHANNEL_TIME_EXT_BUSY +#define SURVEY_INFO_TIME_RX SURVEY_INFO_CHANNEL_TIME_RX +#define SURVEY_INFO_TIME_TX SURVEY_INFO_CHANNEL_TIME_TX +#endif + +#ifdef CONFIG_FIND_BEST_CHANNEL +static void rtw_cfg80211_set_survey_info_with_find_best_channel(struct wiphy *wiphy + , struct net_device *netdev, int idx, struct survey_info *info) +{ + _adapter *adapter = (_adapter *)rtw_netdev_priv(netdev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); + RT_CHANNEL_INFO *ch_set = rfctl->channel_set; + u8 ch_num = rfctl->max_chan_nums; + u32 total_rx_cnt = 0; + int i; + + s8 noise = -50; /*channel noise in dBm. This and all following fields are optional */ + u64 time = 100; /*amount of time in ms the radio was turn on (on the channel)*/ + u64 time_busy = 0; /*amount of time the primary channel was sensed busy*/ + + info->filled = SURVEY_INFO_NOISE_DBM + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) + | SURVEY_INFO_TIME | SURVEY_INFO_TIME_BUSY + #endif + ; + + for (i = 0; i < ch_num; i++) + total_rx_cnt += ch_set[i].rx_count; + + time_busy = ch_set[idx].rx_count * time / total_rx_cnt; + noise += ch_set[idx].rx_count * 50 / total_rx_cnt; + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) + #if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0)) + info->channel_time = time; + info->channel_time_busy = time_busy; + #else + info->time = time; + info->time_busy = time_busy; + #endif +#endif + info->noise = noise; + + /* reset if final channel is got */ + if (idx == ch_num - 1) { + for (i = 0; i < ch_num; i++) + ch_set[i].rx_count = 0; + } +} +#endif /* CONFIG_FIND_BEST_CHANNEL */ + +#if defined(CONFIG_RTW_ACS) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) +static void rtw_cfg80211_set_survey_info_with_clm(PADAPTER padapter, int idx, struct survey_info *pinfo) +{ + s8 noise = -50; /*channel noise in dBm. This and all following fields are optional */ + u64 time = SURVEY_TO; /*amount of time in ms the radio was turn on (on the channel)*/ + u64 time_busy = 0; /*amount of time the primary channel was sensed busy*/ + u8 chan = (u8)idx; + + if ((idx < 0) || (pinfo == NULL)) + return; + + pinfo->filled = SURVEY_INFO_NOISE_DBM + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) + | SURVEY_INFO_TIME | SURVEY_INFO_TIME_BUSY + #endif + ; + + time_busy = rtw_acs_get_clm_ratio_by_ch_idx(padapter, chan); + noise = rtw_noise_query_by_chan_idx(padapter, chan); + /* RTW_INFO("%s: ch-idx:%d time=%llu(ms), time_busy=%llu(ms), noise=%d(dbm)\n", __func__, idx, time, time_busy, noise); */ + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 37)) + #if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 0, 0)) + pinfo->channel_time = time; + pinfo->channel_time_busy = time_busy; + #else + pinfo->time = time; + pinfo->time_busy = time_busy; + #endif +#endif + pinfo->noise = noise; +} +#endif + +int rtw_hostapd_acs_dump_survey(struct wiphy *wiphy, struct net_device *netdev, int idx, struct survey_info *info) +{ + PADAPTER padapter = (_adapter *)rtw_netdev_priv(netdev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + RT_CHANNEL_INFO *pch_set = rfctl->channel_set; + u8 max_chan_nums = rfctl->max_chan_nums; + u32 freq = 0; + u8 ret = 0; + u16 channel = 0; + + if (!netdev || !info) { + RTW_INFO("%s: invial parameters.\n", __func__); + return -EINVAL; + } + + _rtw_memset(info, 0, sizeof(struct survey_info)); + if (padapter->bup == _FALSE) { + RTW_INFO("%s: net device is down.\n", __func__); + return -EIO; + } + + if (idx >= max_chan_nums) + return -ENOENT; + + channel = pch_set[idx].ChannelNum; + freq = rtw_ch2freq(channel); + info->channel = ieee80211_get_channel(wiphy, freq); + /* RTW_INFO("%s: channel %d, freq %d\n", __func__, channel, freq); */ + + if (!info->channel) + return -EINVAL; + + if (info->channel->flags == IEEE80211_CHAN_DISABLED) + return ret; + +#ifdef CONFIG_FIND_BEST_CHANNEL + rtw_cfg80211_set_survey_info_with_find_best_channel(wiphy, netdev, idx, info); +#elif defined(CONFIG_RTW_ACS) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) + rtw_cfg80211_set_survey_info_with_clm(padapter, idx, info); +#else + RTW_ERR("%s: unknown acs operation!\n", __func__); +#endif + + return ret; +} +#endif /* defined(CONFIG_RTW_HOSTAPD_ACS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) */ + static struct cfg80211_ops rtw_cfg80211_ops = { .change_virtual_intf = cfg80211_rtw_change_iface, .add_key = cfg80211_rtw_add_key, @@ -6827,7 +7401,15 @@ static struct cfg80211_ops rtw_cfg80211_ops = { #if defined(CONFIG_PNO_SUPPORT) && (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0)) .sched_scan_start = cfg80211_rtw_sched_scan_start, .sched_scan_stop = cfg80211_rtw_sched_scan_stop, + .suspend = cfg80211_rtw_suspend, + .resume = cfg80211_rtw_resume, #endif /* CONFIG_PNO_SUPPORT */ +#ifdef CONFIG_RFKILL_POLL + .rfkill_poll = cfg80211_rtw_rfkill_poll, +#endif +#if defined(CONFIG_RTW_HOSTAPD_ACS) && (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 33)) + .dump_survey = rtw_hostapd_acs_dump_survey, +#endif }; struct wiphy *rtw_wiphy_alloc(_adapter *padapter, struct device *dev) @@ -6865,13 +7447,13 @@ void rtw_wiphy_free(struct wiphy *wiphy) RTW_INFO(FUNC_WIPHY_FMT"\n", FUNC_WIPHY_ARG(wiphy)); - if (wiphy->bands[IEEE80211_BAND_2GHZ]) { - rtw_spt_band_free(wiphy->bands[IEEE80211_BAND_2GHZ]); - wiphy->bands[IEEE80211_BAND_2GHZ] = NULL; + if (wiphy->bands[NL80211_BAND_2GHZ]) { + rtw_spt_band_free(wiphy->bands[NL80211_BAND_2GHZ]); + wiphy->bands[NL80211_BAND_2GHZ] = NULL; } - if (wiphy->bands[IEEE80211_BAND_5GHZ]) { - rtw_spt_band_free(wiphy->bands[IEEE80211_BAND_5GHZ]); - wiphy->bands[IEEE80211_BAND_5GHZ] = NULL; + if (wiphy->bands[NL80211_BAND_5GHZ]) { + rtw_spt_band_free(wiphy->bands[NL80211_BAND_5GHZ]); + wiphy->bands[NL80211_BAND_5GHZ] = NULL; } wiphy_free(wiphy); @@ -6937,6 +7519,8 @@ int rtw_wdev_alloc(_adapter *padapter, struct wiphy *wiphy) pwdev_priv->padapter = padapter; pwdev_priv->scan_request = NULL; _rtw_spinlock_init(&pwdev_priv->scan_req_lock); + pwdev_priv->connect_req = NULL; + _rtw_spinlock_init(&pwdev_priv->connect_req_lock); pwdev_priv->p2p_enabled = _FALSE; pwdev_priv->probe_resp_ie_update_time = rtw_get_current_time(); @@ -6971,8 +7555,15 @@ void rtw_wdev_free(struct wireless_dev *wdev) if (wdev_to_ndev(wdev)) { _adapter *adapter = (_adapter *)rtw_netdev_priv(wdev_to_ndev(wdev)); struct rtw_wdev_priv *wdev_priv = adapter_wdev_data(adapter); + _irqL irqL; _rtw_spinlock_free(&wdev_priv->scan_req_lock); + + _enter_critical_bh(&wdev_priv->connect_req_lock, &irqL); + rtw_wdev_free_connect_req(wdev_priv); + _exit_critical_bh(&wdev_priv->connect_req_lock, &irqL); + _rtw_spinlock_free(&wdev_priv->connect_req_lock); + _rtw_mutex_free(&wdev_priv->roch_mutex); } @@ -6999,18 +7590,12 @@ void rtw_wdev_unregister(struct wireless_dev *wdev) rtw_cfg80211_indicate_scan_done(adapter, _TRUE); -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) - if (wdev->current_bss) { - u8 locally_generated = 1; - RTW_INFO(FUNC_ADPT_FMT" clear current_bss by cfg80211_disconnected\n", FUNC_ADPT_ARG(adapter)); - cfg80211_disconnected(adapter->pnetdev, 0, NULL, 0, locally_generated, GFP_ATOMIC); - } -#elif ((LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) && (LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0))) || defined(COMPAT_KERNEL_RELEASE) + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) || defined(COMPAT_KERNEL_RELEASE) if (wdev->current_bss) { RTW_INFO(FUNC_ADPT_FMT" clear current_bss by cfg80211_disconnected\n", FUNC_ADPT_ARG(adapter)); - cfg80211_disconnected(adapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); + rtw_cfg80211_indicate_disconnect(adapter, 0, 1); } -#endif + #endif if (pwdev_priv->pmon_ndev) { RTW_INFO("%s, unregister monitor interface\n", __func__); @@ -7050,6 +7635,7 @@ int rtw_cfg80211_ndev_res_alloc(_adapter *adapter) void rtw_cfg80211_ndev_res_free(_adapter *adapter) { rtw_wdev_free(adapter->rtw_wdev); + adapter->rtw_wdev = NULL; #if !defined(RTW_SINGLE_WIPHY) rtw_wiphy_free(adapter_to_wiphy(adapter)); adapter->wiphy = NULL; @@ -7065,6 +7651,10 @@ int rtw_cfg80211_ndev_res_register(_adapter *adapter) RTW_INFO("%s rtw_wiphy_register fail for if%d\n", __func__, (adapter->iface_id + 1)); goto exit; } + +#ifdef CONFIG_RFKILL_POLL + rtw_cfg80211_init_rfkill(adapter_to_wiphy(adapter)); +#endif #endif ret = _SUCCESS; @@ -7086,7 +7676,7 @@ int rtw_cfg80211_dev_res_alloc(struct dvobj_priv *dvobj) struct wiphy *wiphy; struct device *dev = dvobj_to_dev(dvobj); - wiphy = rtw_wiphy_alloc(dvobj->padapters[IFACE_ID0], dev); + wiphy = rtw_wiphy_alloc(dvobj_get_primary_adapter(dvobj), dev); if (wiphy == NULL) goto exit; @@ -7114,6 +7704,10 @@ int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj) #if defined(RTW_SINGLE_WIPHY) if (rtw_wiphy_register(dvobj_to_wiphy(dvobj)) != 0) goto exit; + +#ifdef CONFIG_RFKILL_POLL + rtw_cfg80211_init_rfkill(dvobj_to_wiphy(dvobj)); +#endif #endif ret = _SUCCESS; @@ -7125,6 +7719,9 @@ int rtw_cfg80211_dev_res_register(struct dvobj_priv *dvobj) void rtw_cfg80211_dev_res_unregister(struct dvobj_priv *dvobj) { #if defined(RTW_SINGLE_WIPHY) +#ifdef CONFIG_RFKILL_POLL + rtw_cfg80211_deinit_rfkill(dvobj_to_wiphy(dvobj)); +#endif rtw_wiphy_unregister(dvobj_to_wiphy(dvobj)); #endif } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.h index a52490961854..046dbaa0a584 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_cfg80211.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,16 +11,15 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __IOCTL_CFG80211_H__ #define __IOCTL_CFG80211_H__ +#ifndef RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT + #define RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT 0 +#endif + #if defined(RTW_USE_CFG80211_STA_EVENT) #undef CONFIG_CFG80211_FORCE_COMPATIBLE_2_6_37_UNDER #endif @@ -51,6 +50,11 @@ #endif #endif +#ifndef CONFIG_RADIO_WORK +#define RTW_ROCH_DURATION_ENLARGE +#define RTW_ROCH_BACK_OP +#endif + #if !defined(CONFIG_P2P) && RTW_P2P_GROUP_INTERFACE #error "RTW_P2P_GROUP_INTERFACE can't be enabled when CONFIG_P2P is disabled\n" #endif @@ -126,14 +130,21 @@ struct rtw_wdev_priv { _adapter *padapter; + #if !RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT + u8 not_indic_disco; + #endif + struct cfg80211_scan_request *scan_request; _lock scan_req_lock; + struct cfg80211_connect_params *connect_req; + _lock connect_req_lock; + struct net_device *pmon_ndev;/* for monitor interface */ char ifname_mon[IFNAMSIZ + 1]; /* interface name for monitor interface */ u8 p2p_enabled; - u32 probe_resp_ie_update_time; + systime probe_resp_ie_update_time; u8 provdisc_req_issued; @@ -158,6 +169,22 @@ struct rtw_wdev_priv { }; +#if RTW_CFG80211_ALWAYS_INFORM_STA_DISCONNECT_EVENT +#define rtw_wdev_not_indic_disco(rtw_wdev_data) 0 +#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do {} while (0) +#else +#define rtw_wdev_not_indic_disco(rtw_wdev_data) ((rtw_wdev_data)->not_indic_disco) +#define rtw_wdev_set_not_indic_disco(rtw_wdev_data, val) do { (rtw_wdev_data)->not_indic_disco = (val); } while (0) +#endif + +#define rtw_wdev_free_connect_req(rtw_wdev_data) \ + do { \ + if ((rtw_wdev_data)->connect_req) { \ + rtw_mfree((u8 *)(rtw_wdev_data)->connect_req, sizeof(*(rtw_wdev_data)->connect_req)); \ + (rtw_wdev_data)->connect_req = NULL; \ + } \ + } while (0) + #define wdev_to_ndev(w) ((w)->netdev) #define wdev_to_wiphy(w) ((w)->wiphy) #define ndev_to_wdev(n) ((n)->ieee80211_ptr) @@ -254,6 +281,7 @@ void rtw_pd_iface_free(struct wiphy *wiphy); void rtw_cfg80211_set_is_mgmt_tx(_adapter *adapter, u8 val); u8 rtw_cfg80211_get_is_mgmt_tx(_adapter *adapter); +u8 rtw_mgnt_tx_handler(_adapter *adapter, u8 *buf); void rtw_cfg80211_issue_p2p_provision_request(_adapter *padapter, const u8 *buf, size_t len); @@ -265,6 +293,14 @@ void rtw_cfg80211_rx_probe_request(_adapter *padapter, union recv_frame *rframe) int rtw_cfg80211_set_mgnt_wpsp2pie(struct net_device *net, char *buf, int len, int type); bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); +#ifdef CONFIG_RTW_80211K +void rtw_cfg80211_rx_rrm_action(_adapter *adapter, union recv_frame *rframe); +#endif + +#ifdef CONFIG_RFKILL_POLL +void rtw_cfg80211_init_rfkill(struct wiphy *wiphy); +void rtw_cfg80211_deinit_rfkill(struct wiphy *wiphy); +#endif #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 4, 0)) && !defined(COMPAT_KERNEL_RELEASE) #define rtw_cfg80211_rx_mgmt(wdev, freq, sig_dbm, buf, len, gfp) cfg80211_rx_mgmt(wdev_to_ndev(wdev), freq, buf, len, gfp) @@ -301,6 +337,14 @@ bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); #define rtw_cfg80211_remain_on_channel_expired(wdev, cookie, chan, chan_type, gfp) cfg80211_remain_on_channel_expired(wdev, cookie, chan, gfp) #endif +#define rtw_cfg80211_connect_result(wdev, bssid, req_ie, req_ie_len, resp_ie, resp_ie_len, status, gfp) cfg80211_connect_result(wdev_to_ndev(wdev), bssid, req_ie, req_ie_len, resp_ie, resp_ie_len, status, gfp) + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(4, 2, 0)) && !defined(CONFIG_PLATFORM_INTEL_CHT_ANDROID60) +#define rtw_cfg80211_disconnected(wdev, reason, ie, ie_len, locally_generated, gfp) cfg80211_disconnected(wdev_to_ndev(wdev), reason, ie, ie_len, gfp) +#else +#define rtw_cfg80211_disconnected(wdev, reason, ie, ie_len, locally_generated, gfp) cfg80211_disconnected(wdev_to_ndev(wdev), reason, ie, ie_len, locally_generated, gfp) +#endif + #ifdef CONFIG_RTW_80211R #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 10, 0)) #define rtw_cfg80211_ft_event(adapter, parm) cfg80211_ft_event((adapter)->pnetdev, parm) @@ -309,6 +353,23 @@ bool rtw_cfg80211_pwr_mgmt(_adapter *adapter); #endif #endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 5, 0)) +u8 rtw_cfg80211_ch_switch_notify(_adapter *adapter, u8 ch, u8 bw, u8 offset, u8 ht); +#endif + +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) && (LINUX_VERSION_CODE < KERNEL_VERSION(4, 7, 0)) +#define NL80211_BAND_2GHZ IEEE80211_BAND_2GHZ +#define NL80211_BAND_5GHZ IEEE80211_BAND_5GHZ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 6, 0)) +#define NL80211_BAND_60GHZ IEEE80211_BAND_60GHZ +#endif +#define NUM_NL80211_BANDS IEEE80211_NUM_BANDS +#endif + +#define rtw_band_to_nl80211_band(band) \ + (band == BAND_ON_2_4G) ? NL80211_BAND_2GHZ : \ + (band == BAND_ON_5G) ? NL80211_BAND_5GHZ : NUM_NL80211_BANDS + #include "rtw_cfgvendor.h" #endif /* __IOCTL_CFG80211_H__ */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_linux.c index 87568490e90f..53233854829f 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_linux.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,18 +11,16 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _IOCTL_LINUX_C_ #include #include #include #include "../../hal/phydm/phydm_precomp.h" +#ifdef RTW_HALMAC +#include "../../hal/hal_halmac.h" +#endif #if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 27)) #define iwe_stream_add_event(a, b, c, d, e) iwe_stream_add_event(b, c, d, e) @@ -443,7 +441,7 @@ static inline char *iwe_stream_protocol_process(_adapter *padapter, u16 ht_cap = _FALSE, vht_cap = _FALSE; u32 ht_ielen = 0, vht_ielen = 0; char *p; - u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); /* Probe Request */ + u8 ie_offset = (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12); /* Probe Request */ /* parsing HT_CAP_IE */ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); @@ -503,7 +501,7 @@ static inline char *iwe_stream_rate_process(_adapter *padapter, u8 bw_40MHz = 0, short_GI = 0, bw_160MHz = 0, vht_highest_rate = 0; u16 mcs_rate = 0, vht_data_rate = 0; char custom[MAX_CUSTOM_LEN] = {0}; - u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); /* Probe Request */ + u8 ie_offset = (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12); /* Probe Request */ /* parsing HT_CAP_IE */ p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - ie_offset); @@ -591,7 +589,7 @@ static inline char *iwe_stream_wpa_wpa2_process(_adapter *padapter, p = pbuf; /* parsing WPA/WPA2 IE */ - if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ + if (pnetwork->network.Reserved[0] != BSS_TYPE_PROB_REQ) { /* Probe Request */ out_len = rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie, &rsn_len, wpa_ie, &wpa_len); if (wpa_len > 0) { @@ -650,12 +648,12 @@ static inline char *iwe_stream_wps_process(_adapter *padapter, uint cnt = 0, total_ielen; u8 *wpsie_ptr = NULL; uint wps_ielen = 0; - u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); + u8 ie_offset = (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ ? 0 : 12); u8 *ie_ptr = pnetwork->network.IEs + ie_offset; total_ielen = pnetwork->network.IELength - ie_offset; - if (pnetwork->network.Reserved[0] == 2) { /* Probe Request */ + if (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ) { /* Probe Request */ ie_ptr = pnetwork->network.IEs; total_ielen = pnetwork->network.IELength; } else { /* Beacon or Probe Respones */ @@ -681,7 +679,7 @@ static inline char *iwe_stream_wapi_process(_adapter *padapter, #ifdef CONFIG_WAPI_SUPPORT char *p; - if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ + if (pnetwork->network.Reserved[0] != BSS_TYPE_PROB_REQ) { /* Probe Request */ sint out_len_wapi = 0; /* here use static for stack size */ static u8 buf_wapi[MAX_WAPI_IE_LEN * 2] = {0}; @@ -722,12 +720,13 @@ static inline char *iwe_stream_rssi_process(_adapter *padapter, char *start, char *stop, struct iw_event *iwe) { u8 ss, sq; + s16 noise = 0; struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); /* Add quality statistics */ iwe->cmd = IWEVQUAL; iwe->u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR | IW_QUAL_NOISE_UPDATED #else | IW_QUAL_NOISE_INVALID @@ -758,7 +757,7 @@ static inline char *iwe_stream_rssi_process(_adapter *padapter, HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); - iwe->u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); + iwe->u.qual.level = (u8)phydm_signal_scale_mapping(&pHal->odmpriv, ss); } #endif #endif @@ -768,11 +767,13 @@ static inline char *iwe_stream_rssi_process(_adapter *padapter, #ifdef CONFIG_PLATFORM_ROCKCHIPS iwe->u.qual.noise = -100; /* noise level suggest by zhf@rockchips */ #else -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - { - s16 tmp_noise = 0; - rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); - iwe->u.qual.noise = tmp_noise ; +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + if (IS_NM_ENABLE(padapter)) { + noise = rtw_noise_query_by_chan_num(padapter, pnetwork->network.Configuration.DSConfig); + #ifndef CONFIG_SIGNAL_DISPLAY_DBM + noise = translate_dbm_to_percentage(noise);/*percentage*/ + #endif + iwe->u.qual.noise = noise; } #else iwe->u.qual.noise = 0; /* noise level */ @@ -803,7 +804,6 @@ static inline char *iwe_stream_net_rsv_process(_adapter *padapter, return start; } -#if 1 static char *translate_scan(_adapter *padapter, struct iw_request_info *info, struct wlan_network *pnetwork, char *start, char *stop) @@ -818,7 +818,7 @@ static char *translate_scan(_adapter *padapter, start = iwe_stream_mac_addr_proess(padapter, info, pnetwork, start, stop, &iwe); start = iwe_stream_essid_proess(padapter, info, pnetwork, start, stop, &iwe); start = iwe_stream_protocol_process(padapter, info, pnetwork, start, stop, &iwe); - if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ + if (pnetwork->network.Reserved[0] == BSS_TYPE_PROB_REQ) /* Probe Request */ cap = 0; else { _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); @@ -837,374 +837,6 @@ static char *translate_scan(_adapter *padapter, return start; } -#else -static char *translate_scan(_adapter *padapter, - struct iw_request_info *info, struct wlan_network *pnetwork, - char *start, char *stop) -{ - struct iw_event iwe; - u16 cap; - u32 ht_ielen = 0, vht_ielen = 0; - char custom[MAX_CUSTOM_LEN]; - char *p; - u16 max_rate = 0, rate, ht_cap = _FALSE, vht_cap = _FALSE; - u32 i = 0; - char *current_val; - long rssi; - u8 bw_40MHz = 0, short_GI = 0, bw_160MHz = 0, vht_highest_rate = 0; - u16 mcs_rate = 0, vht_data_rate = 0; - u8 ie_offset = (pnetwork->network.Reserved[0] == 2 ? 0 : 12); - struct registry_priv *pregpriv = &padapter->registrypriv; - - if (_FALSE == search_p2p_wfd_ie(padapter, info, pnetwork, start, stop)) - return start; - - /* AP MAC address */ - iwe.cmd = SIOCGIWAP; - iwe.u.ap_addr.sa_family = ARPHRD_ETHER; - - _rtw_memcpy(iwe.u.ap_addr.sa_data, pnetwork->network.MacAddress, ETH_ALEN); - start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_ADDR_LEN); - - /* Add the ESSID */ - iwe.cmd = SIOCGIWESSID; - iwe.u.data.flags = 1; - iwe.u.data.length = min((u16)pnetwork->network.Ssid.SsidLength, (u16)32); - start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); - - /* parsing HT_CAP_IE */ - if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ - p = rtw_get_ie(&pnetwork->network.IEs[0], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength); - else - p = rtw_get_ie(&pnetwork->network.IEs[12], _HT_CAPABILITY_IE_, &ht_ielen, pnetwork->network.IELength - 12); - if (p && ht_ielen > 0) { - struct rtw_ieee80211_ht_cap *pht_capie; - ht_cap = _TRUE; - pht_capie = (struct rtw_ieee80211_ht_cap *)(p + 2); - _rtw_memcpy(&mcs_rate , pht_capie->supp_mcs_set, 2); - bw_40MHz = (pht_capie->cap_info & IEEE80211_HT_CAP_SUP_WIDTH) ? 1 : 0; - short_GI = (pht_capie->cap_info & (IEEE80211_HT_CAP_SGI_20 | IEEE80211_HT_CAP_SGI_40)) ? 1 : 0; - } - -#ifdef CONFIG_80211AC_VHT - /* parsing VHT_CAP_IE */ - p = rtw_get_ie(&pnetwork->network.IEs[ie_offset], EID_VHTCapability, &vht_ielen, pnetwork->network.IELength - ie_offset); - if (p && vht_ielen > 0) { - u8 mcs_map[2]; - - vht_cap = _TRUE; - bw_160MHz = GET_VHT_CAPABILITY_ELE_CHL_WIDTH(p + 2); - if (bw_160MHz) - short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI160M(p + 2); - else - short_GI = GET_VHT_CAPABILITY_ELE_SHORT_GI80M(p + 2); - - _rtw_memcpy(mcs_map, GET_VHT_CAPABILITY_ELE_TX_MCS(p + 2), 2); - - vht_highest_rate = rtw_get_vht_highest_rate(mcs_map); - vht_data_rate = rtw_vht_mcs_to_data_rate(CHANNEL_WIDTH_80, short_GI, vht_highest_rate); - } -#endif - - /* Add the protocol name */ - iwe.cmd = SIOCGIWNAME; - if ((rtw_is_cckratesonly_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { - if (ht_cap == _TRUE) - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bn"); - else - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11b"); - } else if ((rtw_is_cckrates_included((u8 *)&pnetwork->network.SupportedRates)) == _TRUE) { - if (ht_cap == _TRUE) - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bgn"); - else - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11bg"); - } else { - if (pnetwork->network.Configuration.DSConfig > 14) { - if (vht_cap == _TRUE) - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11AC"); - else if (ht_cap == _TRUE) - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11an"); - else - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11a"); - } else { - if (ht_cap == _TRUE) - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11gn"); - else - snprintf(iwe.u.name, IFNAMSIZ, "IEEE 802.11g"); - } - } - - start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_CHAR_LEN); - - /* Add mode */ - if (pnetwork->network.Reserved[0] == 2) /* Probe Request */ - cap = 0; - else { - iwe.cmd = SIOCGIWMODE; - _rtw_memcpy((u8 *)&cap, rtw_get_capability_from_ie(pnetwork->network.IEs), 2); - cap = le16_to_cpu(cap); - } - - if (cap & (WLAN_CAPABILITY_IBSS | WLAN_CAPABILITY_BSS)) { - if (cap & WLAN_CAPABILITY_BSS) - iwe.u.mode = IW_MODE_MASTER; - else - iwe.u.mode = IW_MODE_ADHOC; - - start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_UINT_LEN); - } - - if (pnetwork->network.Configuration.DSConfig < 1 /*|| pnetwork->network.Configuration.DSConfig>14*/) - pnetwork->network.Configuration.DSConfig = 1; - - /* Add frequency/channel */ - iwe.cmd = SIOCGIWFREQ; - iwe.u.freq.m = rtw_ch2freq(pnetwork->network.Configuration.DSConfig) * 100000; - iwe.u.freq.e = 1; - iwe.u.freq.i = pnetwork->network.Configuration.DSConfig; - start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_FREQ_LEN); - - /* Add encryption capability */ - iwe.cmd = SIOCGIWENCODE; - if (cap & WLAN_CAPABILITY_PRIVACY) - iwe.u.data.flags = IW_ENCODE_ENABLED | IW_ENCODE_NOKEY; - else - iwe.u.data.flags = IW_ENCODE_DISABLED; - iwe.u.data.length = 0; - start = iwe_stream_add_point(info, start, stop, &iwe, pnetwork->network.Ssid.Ssid); - - /*Add basic and extended rates */ - max_rate = 0; - p = custom; - p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), " Rates (Mb/s): "); - while (pnetwork->network.SupportedRates[i] != 0) { - rate = pnetwork->network.SupportedRates[i] & 0x7F; - if (rate > max_rate) - max_rate = rate; - p += snprintf(p, MAX_CUSTOM_LEN - (p - custom), - "%d%s ", rate >> 1, (rate & 1) ? ".5" : ""); - i++; - } - - if (vht_cap == _TRUE) - max_rate = vht_data_rate; - else if (ht_cap == _TRUE) { - if (mcs_rate & 0x8000) /* MCS15 */ - max_rate = (bw_40MHz) ? ((short_GI) ? 300 : 270) : ((short_GI) ? 144 : 130); - - else if (mcs_rate & 0x0080) /* MCS7 */ - max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); - else { /* default MCS7 */ - /* RTW_INFO("wx_get_scan, mcs_rate_bitmap=0x%x\n", mcs_rate); */ - max_rate = (bw_40MHz) ? ((short_GI) ? 150 : 135) : ((short_GI) ? 72 : 65); - } - - max_rate = max_rate * 2; /* Mbps/2; */ - } - - iwe.cmd = SIOCGIWRATE; - iwe.u.bitrate.fixed = iwe.u.bitrate.disabled = 0; - iwe.u.bitrate.value = max_rate * 500000; - start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_PARAM_LEN); - - /* parsing WPA/WPA2 IE */ - if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ - u8 buf[MAX_WPA_IE_LEN * 2]; - u8 wpa_ie[255], rsn_ie[255]; - u16 wpa_len = 0, rsn_len = 0; - u8 *p; - sint out_len = 0; - out_len = rtw_get_sec_ie(pnetwork->network.IEs , pnetwork->network.IELength, rsn_ie, &rsn_len, wpa_ie, &wpa_len); - - if (wpa_len > 0) { - p = buf; - _rtw_memset(buf, 0, MAX_WPA_IE_LEN * 2); - p += sprintf(p, "wpa_ie="); - for (i = 0; i < wpa_len; i++) - p += sprintf(p, "%02x", wpa_ie[i]); - - if (wpa_len > 100) { - printk("-----------------Len %d----------------\n", wpa_len); - for (i = 0; i < wpa_len; i++) - printk("%02x ", wpa_ie[i]); - printk("\n"); - printk("-----------------Len %d----------------\n", wpa_len); - } - - _rtw_memset(&iwe, 0, sizeof(iwe)); - iwe.cmd = IWEVCUSTOM; - iwe.u.data.length = strlen(buf); - start = iwe_stream_add_point(info, start, stop, &iwe, buf); - - _rtw_memset(&iwe, 0, sizeof(iwe)); - iwe.cmd = IWEVGENIE; - iwe.u.data.length = wpa_len; - start = iwe_stream_add_point(info, start, stop, &iwe, wpa_ie); - } - if (rsn_len > 0) { - p = buf; - _rtw_memset(buf, 0, MAX_WPA_IE_LEN * 2); - p += sprintf(p, "rsn_ie="); - for (i = 0; i < rsn_len; i++) - p += sprintf(p, "%02x", rsn_ie[i]); - _rtw_memset(&iwe, 0, sizeof(iwe)); - iwe.cmd = IWEVCUSTOM; - iwe.u.data.length = strlen(buf); - start = iwe_stream_add_point(info, start, stop, &iwe, buf); - - _rtw_memset(&iwe, 0, sizeof(iwe)); - iwe.cmd = IWEVGENIE; - iwe.u.data.length = rsn_len; - start = iwe_stream_add_point(info, start, stop, &iwe, rsn_ie); - } - } - - { /* parsing WPS IE */ - uint cnt = 0, total_ielen; - u8 *wpsie_ptr = NULL; - uint wps_ielen = 0; - - u8 *ie_ptr = pnetwork->network.IEs + ie_offset; - total_ielen = pnetwork->network.IELength - ie_offset; - - if (pnetwork->network.Reserved[0] == 2) { /* Probe Request */ - ie_ptr = pnetwork->network.IEs; - total_ielen = pnetwork->network.IELength; - } else { /* Beacon or Probe Respones */ - ie_ptr = pnetwork->network.IEs + _FIXED_IE_LENGTH_; - total_ielen = pnetwork->network.IELength - _FIXED_IE_LENGTH_; - } - - while (cnt < total_ielen) { - if (rtw_is_wps_ie(&ie_ptr[cnt], &wps_ielen) && (wps_ielen > 2)) { - wpsie_ptr = &ie_ptr[cnt]; - iwe.cmd = IWEVGENIE; - iwe.u.data.length = (u16)wps_ielen; - start = iwe_stream_add_point(info, start, stop, &iwe, wpsie_ptr); - } - cnt += ie_ptr[cnt + 1] + 2; /* goto next */ - } - } - -#ifdef CONFIG_WAPI_SUPPORT - if (pnetwork->network.Reserved[0] != 2) { /* Probe Request */ - sint out_len_wapi = 0; - /* here use static for stack size */ - static u8 buf_wapi[MAX_WAPI_IE_LEN * 2]; - static u8 wapi_ie[MAX_WAPI_IE_LEN]; - u16 wapi_len = 0; - u16 i; - - _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN); - _rtw_memset(wapi_ie, 0, MAX_WAPI_IE_LEN); - - out_len_wapi = rtw_get_wapi_ie(pnetwork->network.IEs , pnetwork->network.IELength, wapi_ie, &wapi_len); - - RTW_INFO("rtw_wx_get_scan: %s ", pnetwork->network.Ssid.Ssid); - RTW_INFO("rtw_wx_get_scan: ssid = %d ", wapi_len); - - - if (wapi_len > 0) { - p = buf_wapi; - _rtw_memset(buf_wapi, 0, MAX_WAPI_IE_LEN * 2); - p += sprintf(p, "wapi_ie="); - for (i = 0; i < wapi_len; i++) - p += sprintf(p, "%02x", wapi_ie[i]); - - _rtw_memset(&iwe, 0, sizeof(iwe)); - iwe.cmd = IWEVCUSTOM; - iwe.u.data.length = strlen(buf_wapi); - start = iwe_stream_add_point(info, start, stop, &iwe, buf_wapi); - - _rtw_memset(&iwe, 0, sizeof(iwe)); - iwe.cmd = IWEVGENIE; - iwe.u.data.length = wapi_len; - start = iwe_stream_add_point(info, start, stop, &iwe, wapi_ie); - } - } -#endif - - { - struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - u8 ss, sq; - - /* Add quality statistics */ - iwe.cmd = IWEVQUAL; - iwe.u.qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_LEVEL_UPDATED -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - | IW_QUAL_NOISE_UPDATED -#else - | IW_QUAL_NOISE_INVALID -#endif -#ifdef CONFIG_SIGNAL_DISPLAY_DBM - | IW_QUAL_DBM -#endif - ; - - if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE && - is_same_network(&pmlmepriv->cur_network.network, &pnetwork->network, 0)) { - ss = padapter->recvpriv.signal_strength; - sq = padapter->recvpriv.signal_qual; - } else { - ss = pnetwork->network.PhyInfo.SignalStrength; - sq = pnetwork->network.PhyInfo.SignalQuality; - } - - -#ifdef CONFIG_SIGNAL_DISPLAY_DBM - iwe.u.qual.level = (u8) translate_percentage_to_dbm(ss); /* dbm */ -#else -#ifdef CONFIG_SIGNAL_SCALE_MAPPING - iwe.u.qual.level = (u8)ss; /* % */ -#else - { - /* Do signal scale mapping when using percentage as the unit of signal strength, since the scale mapping is skipped in odm */ - - HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); - - iwe.u.qual.level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, ss); - } -#endif -#endif - - iwe.u.qual.qual = (u8)sq; /* signal quality */ - -#ifdef CONFIG_PLATFORM_ROCKCHIPS - iwe.u.qual.noise = -100; /* noise level suggest by zhf@rockchips */ -#else -#if defined(CONFIG_SIGNAL_DISPLAY_DBM) && defined(CONFIG_BACKGROUND_NOISE_MONITOR) - { - s16 tmp_noise = 0; - rtw_hal_get_odm_var(padapter, HAL_ODM_NOISE_MONITOR, &(pnetwork->network.Configuration.DSConfig), &(tmp_noise)); - iwe.u.qual.noise = tmp_noise ; - } -#else - iwe.u.qual.noise = 0; /* noise level */ -#endif -#endif /* CONFIG_PLATFORM_ROCKCHIPS */ - - /* RTW_INFO("iqual=%d, ilevel=%d, inoise=%d, iupdated=%d\n", iwe.u.qual.qual, iwe.u.qual.level , iwe.u.qual.noise, iwe.u.qual.updated); */ - - start = iwe_stream_add_event(info, start, stop, &iwe, IW_EV_QUAL_LEN); - } - - { - u8 buf[MAX_WPA_IE_LEN]; - u8 *p, *pos; - int len; - p = buf; - pos = pnetwork->network.Reserved; - _rtw_memset(buf, 0, MAX_WPA_IE_LEN); - p += sprintf(p, "fm=%02X%02X", pos[1], pos[0]); - _rtw_memset(&iwe, 0, sizeof(iwe)); - iwe.cmd = IWEVCUSTOM; - iwe.u.data.length = strlen(buf); - start = iwe_stream_add_point(info, start, stop, &iwe, buf); - } - - return start; -} -#endif static int wpa_set_auth_algs(struct net_device *dev, u32 value) { @@ -1356,7 +988,6 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, _rtw_memcpy(psta->dot11tkiprxmickey.skey, &(param->u.crypt.key[24]), 8); padapter->securitypriv.busetkipkey = _FALSE; - /* _set_timer(&padapter->securitypriv.tkip_timer, 50); */ } /* DEBUG_ERR((" param->u.crypt.key_len=%d\n",param->u.crypt.key_len)); */ @@ -1377,6 +1008,8 @@ static int wpa_set_encryption(struct net_device *dev, struct ieee_param *param, } padapter->securitypriv.binstallGrpkey = _TRUE; /* DEBUG_ERR((" param->u.crypt.key_len=%d\n", param->u.crypt.key_len)); */ + if (param->u.crypt.idx < 4) + _rtw_memcpy(padapter->securitypriv.iv_seq[param->u.crypt.idx], param->u.crypt.seq, 8); RTW_INFO(" ~~~~set sta key:groupkey\n"); padapter->securitypriv.dot118021XGrpKeyid = param->u.crypt.idx; @@ -1734,10 +1367,12 @@ static int rtw_wx_set_freq(struct net_device *dev, int exp = 1, freq = 0, div = 0; - + rtw_ps_deny(padapter, PS_DENY_IOCTL); + if (rtw_pwr_wakeup(padapter) == _FALSE) + goto exit; if (wrqu->freq.m <= 1000) { if (wrqu->freq.flags == IW_FREQ_AUTO) { - if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, wrqu->freq.m) > 0) { + if (rtw_chset_search_ch(adapter_to_chset(padapter), wrqu->freq.m) > 0) { padapter->mlmeextpriv.cur_channel = wrqu->freq.m; RTW_INFO("%s: channel is auto, set to channel %d\n", __func__, wrqu->freq.m); } else { @@ -1775,9 +1410,9 @@ static int rtw_wx_set_freq(struct net_device *dev, padapter->mlmeextpriv.cur_channel = rtw_freq2ch(freq); RTW_INFO("%s: set to channel %d\n", __func__, padapter->mlmeextpriv.cur_channel); } - set_channel_bwmode(padapter, padapter->mlmeextpriv.cur_channel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); - +exit: + rtw_ps_deny_cancel(padapter, PS_DENY_IOCTL); return 0; } @@ -1827,6 +1462,13 @@ static int rtw_wx_set_mode(struct net_device *dev, struct iw_request_info *a, /* initial default type */ dev->type = ARPHRD_ETHER; + if (wrqu->mode == IW_MODE_MONITOR) { + rtw_ps_deny(padapter, PS_DENY_MONITOR_MODE); + LeaveAllPowerSaveMode(padapter); + } else { + rtw_ps_deny_cancel(padapter, PS_DENY_MONITOR_MODE); + } + switch (wrqu->mode) { case IW_MODE_MONITOR: networkType = Ndis802_11Monitor; @@ -2037,6 +1679,7 @@ static int rtw_wx_get_range(struct net_device *dev, { struct iw_range *range = (struct iw_range *)extra; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; u16 val; @@ -2138,12 +1781,12 @@ static int rtw_wx_get_range(struct net_device *dev, * range->min_r_time; Minimal retry lifetime * range->max_r_time; Maximal retry lifetime */ - for (i = 0, val = 0; i < MAX_CHANNEL_NUM; i++) { + for (i = 0, val = 0; i < rfctl->max_chan_nums; i++) { /* Include only legal frequencies for some countries */ - if (pmlmeext->channel_set[i].ChannelNum != 0) { - range->freq[val].i = pmlmeext->channel_set[i].ChannelNum; - range->freq[val].m = rtw_ch2freq(pmlmeext->channel_set[i].ChannelNum) * 100000; + if (rfctl->channel_set[i].ChannelNum != 0) { + range->freq[val].i = rfctl->channel_set[i].ChannelNum; + range->freq[val].m = rtw_ch2freq(rfctl->channel_set[i].ChannelNum) * 100000; range->freq[val].e = 1; val++; } @@ -2377,7 +2020,9 @@ static int rtw_wx_set_mlme(struct net_device *dev, default: return -EOPNOTSUPP; } - +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_do_disconnect(padapter); +#endif return ret; } @@ -2388,7 +2033,7 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - NDIS_802_11_SSID ssid[RTW_SSID_SCAN_AMOUNT]; + struct sitesurvey_parm parm; #ifdef CONFIG_P2P struct wifidirect_info *pwdinfo = &(padapter->wdinfo); @@ -2400,7 +2045,7 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, #endif #ifdef CONFIG_MP_INCLUDED - if (rtw_mi_mp_mode_check(padapter)) { + if (rtw_mp_mode_check(padapter)) { RTW_INFO("MP mode block Scan request\n"); ret = -EPERM; goto exit; @@ -2431,7 +2076,13 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, goto cancel_ps_deny; } #endif - +#ifdef CONFIG_RTW_REPEATER_SON + if (padapter->rtw_rson_scanstage == RSON_SCAN_PROCESS) { + RTW_INFO(FUNC_ADPT_FMT" blocking scan for under rson scanning process\n", FUNC_ADPT_ARG(padapter)); + indicate_wx_scan_complete_event(padapter); + goto cancel_ps_deny; + } +#endif if (check_fwstate(pmlmepriv, WIFI_AP_STATE) && check_fwstate(pmlmepriv, WIFI_UNDER_WPS)) { RTW_INFO("AP mode process WPS\n"); indicate_wx_scan_complete_event(padapter); @@ -2461,8 +2112,6 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, } #endif /* CONFIG_P2P */ - _rtw_memset(ssid, 0, sizeof(NDIS_802_11_SSID) * RTW_SSID_SCAN_AMOUNT); - #if WIRELESS_EXT >= 17 if (wrqu->data.length == sizeof(struct iw_scan_req)) { struct iw_scan_req *req = (struct iw_scan_req *)extra; @@ -2470,12 +2119,14 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, if (wrqu->data.flags & IW_SCAN_THIS_ESSID) { int len = min((int)req->essid_len, IW_ESSID_MAX_SIZE); - _rtw_memcpy(ssid[0].Ssid, req->essid, len); - ssid[0].SsidLength = len; + rtw_init_sitesurvey_parm(padapter, &parm); + _rtw_memcpy(&parm.ssid[0].Ssid, &req->essid, len); + parm.ssid[0].SsidLength = len; + parm.ssid_num = 1; RTW_INFO("IW_SCAN_THIS_ESSID, ssid=%s, len=%d\n", req->essid, req->essid_len); - _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, 1, NULL, 0); + _status = rtw_set_802_11_bssid_list_scan(padapter, &parm); } else if (req->scan_type == IW_SCAN_TYPE_PASSIVE) RTW_INFO("rtw_wx_set_scan, req->scan_type == IW_SCAN_TYPE_PASSIVE\n"); @@ -2493,6 +2144,7 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, int ssid_index = 0; /* RTW_INFO("%s COMBO_SCAN header is recognized\n", __FUNCTION__); */ + rtw_init_sitesurvey_parm(padapter, &parm); while (len >= 1) { section = *(pos++); @@ -2510,10 +2162,12 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, len -= 1; if (sec_len > 0 && sec_len <= len) { - ssid[ssid_index].SsidLength = sec_len; - _rtw_memcpy(ssid[ssid_index].Ssid, pos, ssid[ssid_index].SsidLength); - /* RTW_INFO("%s COMBO_SCAN with specific ssid:%s, %d\n", __FUNCTION__ */ - /* , ssid[ssid_index].Ssid, ssid[ssid_index].SsidLength); */ + + parm.ssid[ssid_index].SsidLength = sec_len; + _rtw_memcpy(&parm.ssid[ssid_index].Ssid, pos, sec_len); + + /* RTW_INFO("%s COMBO_SCAN with specific parm.ssid:%s, %d\n", __FUNCTION__ */ + /* , parm.ssid[ssid_index].Ssid, parm.ssid[ssid_index].SsidLength); */ ssid_index++; } @@ -2560,13 +2214,14 @@ static int rtw_wx_set_scan(struct net_device *dev, struct iw_request_info *a, /* RTW_INFO("len:%d\n", len); */ } + parm.ssid_num = ssid_index; /* jeff: it has still some scan paramater to parse, we only do this now... */ - _status = rtw_set_802_11_bssid_list_scan(padapter, ssid, RTW_SSID_SCAN_AMOUNT, NULL, 0); + _status = rtw_set_802_11_bssid_list_scan(padapter, &parm); } else - _status = rtw_set_802_11_bssid_list_scan(padapter, NULL, 0, NULL, 0); + _status = rtw_set_802_11_bssid_list_scan(padapter, NULL); if (_status == _FALSE) ret = -1; @@ -2665,7 +2320,7 @@ static int rtw_wx_get_scan(struct net_device *dev, struct iw_request_info *a, pnetwork = LIST_CONTAINOR(plist, struct wlan_network, list); /* report network only if the current channel set contains the channel to which this network belongs */ - if (rtw_ch_set_search_ch(padapter->mlmeextpriv.channel_set, pnetwork->network.Configuration.DSConfig) >= 0 + if (rtw_chset_search_ch(adapter_to_chset(padapter), pnetwork->network.Configuration.DSConfig) >= 0 && rtw_mlme_band_check(padapter, pnetwork->network.Configuration.DSConfig) == _TRUE && _TRUE == rtw_validate_ssid(&(pnetwork->network.Ssid)) ) @@ -3440,7 +3095,7 @@ static int rtw_wx_set_auth(struct net_device *dev, */ if (check_fwstate(&padapter->mlmepriv, _FW_LINKED)) { LeaveAllPowerSaveMode(padapter); - rtw_disassoc_cmd(padapter, 500, _FALSE); + rtw_disassoc_cmd(padapter, 500, RTW_CMDF_DIRECTLY); RTW_INFO("%s...call rtw_indicate_disconnect\n ", __FUNCTION__); rtw_indicate_disconnect(padapter, 0, _FALSE); rtw_free_assoc_resources(padapter, 1); @@ -3815,6 +3470,22 @@ static int rtw_wx_priv_null(struct net_device *dev, struct iw_request_info *a, return -1; } +#ifdef CONFIG_RTW_80211K +extern void rm_dbg_cmd(_adapter *padapter, char *s); +static int rtw_wx_priv_rrm(struct net_device *dev, struct iw_request_info *a, + union iwreq_data *wrqu, char *b) +{ + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + u32 path, addr, data32; + + + rm_dbg_cmd(padapter, b); + wrqu->data.length = strlen(b); + + return 0; +} +#endif + static int dummy(struct net_device *dev, struct iw_request_info *a, union iwreq_data *wrqu, char *b) { @@ -3881,111 +3552,6 @@ static int rtw_wx_set_mtk_wps_ie(struct net_device *dev, #endif } -/* -typedef int (*iw_handler)(struct net_device *dev, struct iw_request_info *info, - union iwreq_data *wrqu, char *extra); -*/ -/* - * For all data larger than 16 octets, we need to use a - * pointer to memory allocated in user space. - */ -static int rtw_drvext_hdl(struct net_device *dev, struct iw_request_info *info, - union iwreq_data *wrqu, char *extra) -{ - -#if 0 - struct iw_point { - void __user *pointer; /* Pointer to the data (in user space) */ - __u16 length; /* number of fields or size in bytes */ - __u16 flags; /* Optional params */ - }; -#endif - -#ifdef CONFIG_DRVEXT_MODULE - u8 res; - struct drvext_handler *phandler; - struct drvext_oidparam *poidparam; - int ret; - u16 len; - u8 *pparmbuf, bset; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct iw_point *p = &wrqu->data; - - if ((!p->length) || (!p->pointer)) { - ret = -EINVAL; - goto _rtw_drvext_hdl_exit; - } - - - bset = (u8)(p->flags & 0xFFFF); - len = p->length; - pparmbuf = (u8 *)rtw_malloc(len); - if (pparmbuf == NULL) { - ret = -ENOMEM; - goto _rtw_drvext_hdl_exit; - } - - if (bset) { /* set info */ - if (copy_from_user(pparmbuf, p->pointer, len)) { - rtw_mfree(pparmbuf, len); - ret = -EFAULT; - goto _rtw_drvext_hdl_exit; - } - } else { /* query info */ - - } - - - /* */ - poidparam = (struct drvext_oidparam *)pparmbuf; - - - - /* check subcode */ - if (poidparam->subcode >= MAX_DRVEXT_HANDLERS) { - ret = -EINVAL; - goto _rtw_drvext_hdl_exit; - } - - - if (poidparam->subcode >= MAX_DRVEXT_OID_SUBCODES) { - ret = -EINVAL; - goto _rtw_drvext_hdl_exit; - } - - - phandler = drvextoidhandlers + poidparam->subcode; - - if (poidparam->len != phandler->parmsize) { - ret = -EINVAL; - goto _rtw_drvext_hdl_exit; - } - - - res = phandler->handler(&padapter->drvextpriv, bset, poidparam->data); - - if (res == 0) { - ret = 0; - - if (bset == 0x00) {/* query info */ - /* _rtw_memcpy(p->pointer, pparmbuf, len); */ - if (copy_to_user(p->pointer, pparmbuf, len)) - ret = -EFAULT; - } - } else - ret = -EFAULT; - - -_rtw_drvext_hdl_exit: - - return ret; - -#endif - - return 0; - -} - static void rtw_dbg_mode_hdl(_adapter *padapter, u32 id, u8 *pdata, u32 len) { pRW_Reg RegRWStruct; @@ -5322,10 +4888,9 @@ static int rtw_p2p_connect(struct net_device *dev, u8 union_ch = rtw_mi_get_union_chan(padapter); u8 union_bw = rtw_mi_get_union_bw(padapter); u8 union_offset = rtw_mi_get_union_offset(padapter); - /* Have to enter the power saving with the AP */ - set_channel_bwmode(padapter, union_ch, union_offset, union_bw); - rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); + set_channel_bwmode(padapter, union_ch, union_offset, union_bw); + rtw_leave_opch(padapter); } #endif /* CONFIG_CONCURRENT_MODE */ @@ -5352,7 +4917,7 @@ static int rtw_p2p_connect(struct net_device *dev, * driver will do scanning itself */ _enter_critical_bh(&pmlmepriv->lock, &irqL); - rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); + rtw_sitesurvey_cmd(padapter, NULL); _exit_critical_bh(&pmlmepriv->lock, &irqL); #endif /* CONFIG_INTEL_WIDI */ ret = -1; @@ -5514,15 +5079,15 @@ static int rtw_p2p_invite_req(struct net_device *dev, u8 union_ch = rtw_mi_get_union_chan(padapter); u8 union_bw = rtw_mi_get_union_bw(padapter); u8 union_offset = rtw_mi_get_union_offset(padapter); - /* Have to enter the power saving with the AP */ - set_channel_bwmode(padapter, union_ch, union_offset, union_bw); - rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); + set_channel_bwmode(padapter, union_ch, union_offset, union_bw); + rtw_leave_opch(padapter); + } else set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); #else set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); -#endif +#endif/*CONFIG_CONCURRENT_MODE*/ _set_timer(&pwdinfo->pre_tx_scan_timer, P2P_TX_PRESCAN_TIMEOUT); @@ -6077,10 +5642,9 @@ static int rtw_p2p_prov_disc(struct net_device *dev, u8 union_bw = rtw_mi_get_union_bw(padapter); u8 union_offset = rtw_mi_get_union_offset(padapter); - /* Have to enter the power saving with the AP */ set_channel_bwmode(padapter, union_ch, union_offset, union_bw); + rtw_leave_opch(padapter); - rtw_mi_buddy_issue_nulldata(padapter, NULL, 1, 3, 500); } else set_channel_bwmode(padapter, uintPeerChannel, HAL_PRIME_CHNL_OFFSET_DONT_CARE, CHANNEL_WIDTH_20); #else @@ -6106,7 +5670,7 @@ static int rtw_p2p_prov_disc(struct net_device *dev, rtw_p2p_findphase_ex_set(pwdinfo, P2P_FINDPHASE_EX_NONE); rtw_free_network_queue(padapter, _TRUE); _enter_critical_bh(&pmlmepriv->lock, &irqL); - rtw_sitesurvey_cmd(padapter, NULL, 0, NULL, 0); + rtw_sitesurvey_cmd(padapter, NULL); _exit_critical_bh(&pmlmepriv->lock, &irqL); #endif /* CONFIG_INTEL_WIDI */ } @@ -6357,27 +5921,19 @@ static int rtw_cta_test_start(struct net_device *dev, { int ret = 0; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); + RTW_INFO("%s %s\n", __func__, extra); if (!strcmp(extra, "1")) - padapter->in_cta_test = 1; + hal_data->in_cta_test = 1; else - padapter->in_cta_test = 0; + hal_data->in_cta_test = 0; + + rtw_hal_rcr_set_chk_bssid(padapter, MLME_ACTION_NONE); - if (padapter->in_cta_test) { - u32 v = rtw_read32(padapter, REG_RCR); - v &= ~(RCR_CBSSID_DATA | RCR_CBSSID_BCN); /* | RCR_ADF */ - rtw_write32(padapter, REG_RCR, v); - RTW_INFO("enable RCR_ADF\n"); - } else { - u32 v = rtw_read32(padapter, REG_RCR); - v |= RCR_CBSSID_DATA | RCR_CBSSID_BCN ;/* | RCR_ADF */ - rtw_write32(padapter, REG_RCR, v); - RTW_INFO("disable RCR_ADF\n"); - } return ret; } - extern int rtw_change_ifname(_adapter *padapter, const char *ifname); static int rtw_rereg_nd_name(struct net_device *dev, struct iw_request_info *info, @@ -6385,6 +5941,7 @@ static int rtw_rereg_nd_name(struct net_device *dev, { int ret = 0; _adapter *padapter = rtw_netdev_priv(dev); + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct rereg_nd_name_data *rereg_priv = &padapter->rereg_nd_name_priv; char new_ifname[IFNAMSIZ]; @@ -6412,13 +5969,17 @@ static int rtw_rereg_nd_name(struct net_device *dev, return ret; RTW_INFO("%s new_ifname:%s\n", __FUNCTION__, new_ifname); + rtw_set_rtnl_lock_holder(dvobj, current); ret = rtw_change_ifname(padapter, new_ifname); + rtw_set_rtnl_lock_holder(dvobj, NULL); if (0 != ret) goto exit; if (_rtw_memcmp(rereg_priv->old_ifname, "disable%d", 9) == _TRUE) { + #ifdef CONFIG_RTW_SW_LED padapter->ledpriv.bRegUseLed = rereg_priv->old_bRegUseLed; rtw_hal_sw_led_init(padapter); + #endif /* rtw_ips_mode_req(&padapter->pwrctrlpriv, rereg_priv->old_ips_mode); */ } @@ -6433,10 +5994,11 @@ static int rtw_rereg_nd_name(struct net_device *dev, /* close led */ rtw_led_control(padapter, LED_CTL_POWER_OFF); + #ifdef CONFIG_RTW_SW_LED rereg_priv->old_bRegUseLed = padapter->ledpriv.bRegUseLed; padapter->ledpriv.bRegUseLed = _FALSE; rtw_hal_sw_led_deinit(padapter); - + #endif /* the interface is being "disabled", we can do deeper IPS */ /* rereg_priv->old_ips_mode = rtw_get_ips_mode_req(&padapter->pwrctrlpriv); */ /* rtw_ips_mode_req(&padapter->pwrctrlpriv, IPS_NORMAL); */ @@ -6449,10 +6011,17 @@ static int rtw_rereg_nd_name(struct net_device *dev, #ifdef CONFIG_IOL #include #endif - +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR +#include "../../hal/hal_dm_acs.h" +#endif #ifdef DBG_CMD_QUEUE u8 dump_cmd_id = 0; #endif +/* +#ifdef DBG_DUMP_TSF_BY_PORT +extern void get_tsf_by_port(_adapter *adapter, u8 *tsftr, u8 hw_port); +#endif +*/ static int rtw_dbg_port(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) @@ -6761,13 +6330,15 @@ static int rtw_dbg_port(struct net_device *dev, psta = rtw_get_stainfo(pstapriv, cur_network->network.MacAddress); if (psta) { RTW_INFO("SSID=%s\n", cur_network->network.Ssid.Ssid); - RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); + RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); RTW_INFO("cur_channel=%d, cur_bwmode=%d, cur_ch_offset=%d\n", pmlmeext->cur_channel, pmlmeext->cur_bwmode, pmlmeext->cur_ch_offset); RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); - RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); + RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", + psta->state, psta->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); #ifdef CONFIG_80211N_HT RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); - RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); + RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n" + , psta->cmn.bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); #endif /* CONFIG_80211N_HT */ @@ -6777,6 +6348,12 @@ static int rtw_dbg_port(struct net_device *dev, RTW_INFO("can't get sta's macaddr, cur_network's macaddr:" MAC_FMT "\n", MAC_ARG(cur_network->network.MacAddress)); break; case 0x06: { + #ifdef DBG_DUMP_TSF_BY_PORT + u64 tsf = 0; + + get_tsf_by_port(padapter, (u8 *)&tsf, extra_arg); + RTW_INFO(" PORT-%d TSF :%lld\n", extra_arg, tsf); + #endif } break; case 0x07: @@ -6817,13 +6394,15 @@ static int rtw_dbg_port(struct net_device *dev, plist = get_next(plist); - if (extra_arg == psta->aid) { - RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->hwaddr)); + if (extra_arg == psta->cmn.aid) { + RTW_INFO("sta's macaddr:" MAC_FMT "\n", MAC_ARG(psta->cmn.mac_addr)); RTW_INFO("rtsen=%d, cts2slef=%d\n", psta->rtsen, psta->cts2self); - RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", psta->state, psta->aid, psta->mac_id, psta->raid); + RTW_INFO("state=0x%x, aid=%d, macid=%d, raid=%d\n", + psta->state, psta->cmn.aid, psta->cmn.mac_id, psta->cmn.ra_info.rate_id); #ifdef CONFIG_80211N_HT RTW_INFO("qos_en=%d, ht_en=%d, init_rate=%d\n", psta->qos_option, psta->htpriv.ht_option, psta->init_rate); - RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", psta->bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, + RTW_INFO("bwmode=%d, ch_offset=%d, sgi_20m=%d,sgi_40m=%d\n", + psta->cmn.bw_mode, psta->htpriv.ch_offset, psta->htpriv.sgi_20m, psta->htpriv.sgi_40m); RTW_INFO("ampdu_enable = %d\n", psta->htpriv.ampdu_enable); RTW_INFO("agg_enable_bitmap=%x, candidate_tid_bitmap=%x\n", psta->htpriv.agg_enable_bitmap, psta->htpriv.candidate_tid_bitmap); @@ -6965,15 +6544,7 @@ static int rtw_dbg_port(struct net_device *dev, } break; - case 0x16: { - if (arg == 0xff) - rtw_odm_dbg_comp_msg(RTW_DBGDUMP, padapter); - else { - u64 dbg_comp = (u64)extra_arg; - rtw_odm_dbg_comp_set(padapter, dbg_comp); - } - } - break; + #ifdef DBG_FIXED_CHAN case 0x17: { struct mlme_ext_priv *pmlmeext = &(padapter->mlmeextpriv); @@ -7071,17 +6642,9 @@ static int rtw_dbg_port(struct net_device *dev, break; #ifdef CONFIG_BACKGROUND_NOISE_MONITOR case 0x1e: { - HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - PDM_ODM_T pDM_Odm = &pHalData->odmpriv; - u8 chan = rtw_get_oper_ch(padapter); RTW_INFO("===========================================\n"); - ODM_InbandNoise_Monitor(pDM_Odm, _TRUE, 0x1e, 100); - RTW_INFO("channel(%d),noise_a = %d, noise_b = %d , noise_all:%d\n", - chan, pDM_Odm->noise_level.noise[ODM_RF_PATH_A], - pDM_Odm->noise_level.noise[ODM_RF_PATH_B], - pDM_Odm->noise_level.noise_all); + rtw_noise_measure_curchan(padapter); RTW_INFO("===========================================\n"); - } break; #endif @@ -7142,6 +6705,31 @@ static int rtw_dbg_port(struct net_device *dev, } break; #endif + case 0x20: + { + if (arg == 0xAA) { + u8 page_offset, page_num; + u32 page_size = 0; + u8 *buffer = NULL; + u32 buf_size = 0; + + page_offset = (u8)(extra_arg >> 16); + page_num = (u8)(extra_arg & 0xFF); + rtw_dump_rsvd_page(RTW_DBGDUMP, padapter, page_offset, page_num); + } +#ifdef CONFIG_SUPPORT_FIFO_DUMP + else { + u8 fifo_sel; + u32 addr, size; + + fifo_sel = (u8)(arg & 0x0F); + addr = (extra_arg >> 16) & 0xFFFF; + size = extra_arg & 0xFFFF; + rtw_dump_fifo(RTW_DBGDUMP, padapter, fifo_sel, addr, size); + } +#endif + } + break; case 0x23: { RTW_INFO("turn %s the bNotifyChannelChange Variable\n", (extra_arg == 1) ? "on" : "off"); @@ -7213,6 +6801,8 @@ static int rtw_dbg_port(struct net_device *dev, bb_reg_dump(RTW_DBGDUMP, padapter); else if (extra_arg == 2) rf_reg_dump(RTW_DBGDUMP, padapter); + else if (extra_arg == 11) + bb_reg_dump_ex(RTW_DBGDUMP, padapter); } break; @@ -7407,7 +6997,9 @@ static int wpa_mlme(struct net_device *dev, u32 command, u32 reason) ret = -EOPNOTSUPP; break; } - +#ifdef CONFIG_RTW_REPEATER_SON + rtw_rson_do_disconnect(padapter); +#endif return ret; } @@ -7818,9 +7410,9 @@ static int rtw_hostapd_sta_flush(struct net_device *dev) RTW_INFO("%s\n", __FUNCTION__); flush_all_cam_entry(padapter); /* clear CAM */ - +#ifdef CONFIG_AP_MODE ret = rtw_sta_flush(padapter, _TRUE); - +#endif return ret; } @@ -7862,7 +7454,7 @@ static int rtw_add_sta(struct net_device *dev, struct ieee_param *param) /* RTW_INFO("rtw_add_sta(), init sta's variables, psta=%p\n", psta); */ - psta->aid = param->u.add_sta.aid;/* aid=1~2007 */ + psta->cmn.aid = param->u.add_sta.aid;/* aid=1~2007 */ _rtw_memcpy(psta->bssrateset, param->u.add_sta.tx_supp_rates, 16); @@ -7924,7 +7516,7 @@ static int rtw_del_sta(struct net_device *dev, struct ieee_param *param) if (psta) { u8 updated = _FALSE; - /* RTW_INFO("free psta=%p, aid=%d\n", psta, psta->aid); */ + /* RTW_INFO("free psta=%p, aid=%d\n", psta, psta->cmn.aid); */ _enter_critical_bh(&pstapriv->asoc_list_lock, &irqL); if (rtw_is_list_empty(&psta->asoc_list) == _FALSE) { @@ -7989,7 +7581,7 @@ static int rtw_ioctl_get_sta_data(struct net_device *dev, struct ieee_param *par u64 tx_drops; } get_sta; #endif - psta_data->aid = (u16)psta->aid; + psta_data->aid = (u16)psta->cmn.aid; psta_data->capability = psta->capability; psta_data->flags = psta->flags; @@ -8613,7 +8205,7 @@ static int rtw_wowlan_ctrl(struct net_device *dev, struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct sta_info *psta = NULL; int ret = 0; - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); poidparam.subcode = 0; RTW_INFO("+rtw_wowlan_ctrl: %s\n", extra); @@ -8684,7 +8276,7 @@ static int rtw_wowlan_set_pattern(struct net_device *dev, struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct wowlan_ioctl_param poidparam; int ret = 0, len = 0, i = 0; - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); u8 input[wrqu->data.length]; u8 index = 0; @@ -8710,7 +8302,7 @@ static int rtw_wowlan_set_pattern(struct net_device *dev, rtw_ps_deny(padapter, PS_DENY_IOCTL); LeaveAllPowerSaveModeDirect(padapter); if (strncmp(input, "pattern=", 8) == 0) { - if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_NUM) { + if (pwrpriv->wowlan_pattern_idx >= MAX_WKFM_CAM_NUM) { RTW_INFO("WARNING: priv-pattern is full(idx: %d)\n", pwrpriv->wowlan_pattern_idx); RTW_INFO("WARNING: please clean priv-pattern first\n"); @@ -8731,14 +8323,8 @@ static int rtw_wowlan_set_pattern(struct net_device *dev, rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); } else if (strncmp(input, "show", 4) == 0) { - for (i = 0 ; i < MAX_WKFM_NUM ; i++) { - RTW_INFO("=======[%d]=======\n", i); - rtw_read_from_frame_mask(padapter, i); - } - - RTW_INFO("********[RTK priv-patterns]*********\n"); - for (i = 0 ; i < MAX_WKFM_NUM ; i++) - rtw_dump_priv_pattern(padapter, i); + rtw_wow_pattern_cam_dump(padapter); + rtw_wow_pattern_sw_dump(padapter); } else { RTW_INFO("ERROR: incorrect parameter!\n"); ret = -EINVAL; @@ -8761,7 +8347,7 @@ static int rtw_ap_wowlan_ctrl(struct net_device *dev, struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct sta_info *psta = NULL; int ret = 0; - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); poidparam.subcode = 0; RTW_INFO("+rtw_ap_wowlan_ctrl: %s\n", extra); @@ -8812,6 +8398,9 @@ static int rtw_pm_set(struct net_device *dev, } else if (_rtw_memcmp(extra, "ips=", 4)) { sscanf(extra + 4, "%u", &mode); ret = rtw_pm_set_ips(padapter, mode); + } else if (_rtw_memcmp(extra, "lps_level=", 10)) { + if (sscanf(extra + 10, "%u", &mode) > 0) + ret = rtw_pm_set_lps_level(padapter, mode); } else ret = -EINVAL; @@ -8819,34 +8408,54 @@ static int rtw_pm_set(struct net_device *dev, } #ifdef CONFIG_APPEND_VENDOR_IE_ENABLE -int rtw_vendor_ie_get(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) +int rtw_vendor_ie_get_raw_data(struct net_device *dev, u32 vendor_ie_num, + char *extra, u32 length) { - int ret = 0, vendor_ie_num = 0 , j , len = 0 , cmdlen; + int j; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); + u32 vendor_ie_mask = 0; + char *pstring; + + if (vendor_ie_num >= WLAN_MAX_VENDOR_IE_NUM) { + RTW_INFO("[%s] only support %d vendor ie\n", __func__ , + WLAN_MAX_VENDOR_IE_NUM); + return -EFAULT; + } + + if (pmlmepriv->vendor_ielen[vendor_ie_num] == 0) { + RTW_INFO("[%s] Fail, vendor_ie_num: %d is not set\n", __func__, + vendor_ie_num); + return -EFAULT; + } + + if (length < 2 * pmlmepriv->vendor_ielen[vendor_ie_num] + 5) { + RTW_INFO("[%s] Fail, buffer size is too small\n", __func__); + return -EFAULT; + } + + vendor_ie_mask = pmlmepriv->vendor_ie_mask[vendor_ie_num]; + _rtw_memset(extra, 0, length); + + pstring = extra; + pstring += sprintf(pstring, "%d,%x,", vendor_ie_num, vendor_ie_mask); + + for (j = 0; j < pmlmepriv->vendor_ielen[vendor_ie_num]; j++) + pstring += sprintf(pstring, "%02x", pmlmepriv->vendor_ie[vendor_ie_num][j]); + + length = pstring - extra; + return length; +} + +int rtw_vendor_ie_get_data(struct net_device *dev, int vendor_ie_num, char *extra) +{ + int j; char *pstring; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *pmlmepriv = &(padapter->mlmepriv); - struct iw_point *p; - u8 *ptmp; u32 vendor_ie_mask = 0; + __u16 length = 0; - p = &wrqu->data; - cmdlen = p->length; - if (0 == cmdlen) - return -EINVAL; - - ptmp = (u8 *)rtw_malloc(cmdlen); - if (NULL == ptmp) - return -ENOMEM; - - if (copy_from_user(ptmp, p->pointer, cmdlen)) { - ret = -EFAULT; - goto exit; - } - ret = sscanf(ptmp , "%d", &vendor_ie_num); - if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) { - ret = -EFAULT; - goto exit; - } vendor_ie_mask = pmlmepriv->vendor_ie_mask[vendor_ie_num]; pstring = extra; pstring += sprintf(pstring , "\nVendor IE num %d , Mask:%x " , vendor_ie_num , vendor_ie_mask); @@ -8866,7 +8475,37 @@ int rtw_vendor_ie_get(struct net_device *dev, struct iw_request_info *info, unio for (j = 0 ; j < pmlmepriv->vendor_ielen[vendor_ie_num] ; j++) pstring += sprintf(pstring , "%02x" , pmlmepriv->vendor_ie[vendor_ie_num][j]); - wrqu->data.length = pstring - extra; + length = pstring - extra; + return length; + +} + +int rtw_vendor_ie_get(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) +{ + int ret = 0, vendor_ie_num = 0, cmdlen; + struct iw_point *p; + u8 *ptmp; + + p = &wrqu->data; + cmdlen = p->length; + if (0 == cmdlen) + return -EINVAL; + + ptmp = (u8 *)rtw_malloc(cmdlen); + if (NULL == ptmp) + return -ENOMEM; + + if (copy_from_user(ptmp, p->pointer, cmdlen)) { + ret = -EFAULT; + goto exit; + } + ret = sscanf(ptmp , "%d", &vendor_ie_num); + if (vendor_ie_num > WLAN_MAX_VENDOR_IE_NUM - 1) { + ret = -EFAULT; + goto exit; + } + + wrqu->data.length = rtw_vendor_ie_get_data(dev, vendor_ie_num, extra); exit: rtw_mfree(ptmp, cmdlen); @@ -8982,6 +8621,7 @@ static int rtw_mp_efuse_get(struct net_device *dev, u16 mask_len; u8 mask_buf[64] = ""; int err; + char *pextra = NULL; #ifdef CONFIG_IOL u8 org_fw_iol = padapter->registrypriv.fw_iol;/* 0:Disable, 1:enable, 2:by usb speed */ #endif @@ -9006,6 +8646,9 @@ static int rtw_mp_efuse_get(struct net_device *dev, err = -EFAULT; goto exit; } + + *(extra + wrqu->length) = '\0'; + #ifdef CONFIG_LPS lps_mode = pwrctrlpriv->power_mgnt;/* keep org value */ rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); @@ -9058,16 +8701,17 @@ static int rtw_mp_efuse_get(struct net_device *dev, sprintf(extra, "\n"); for (i = 0; i < cnt; i += 16) { - sprintf(extra, "%s0x%02x\t", extra, shift + i); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%02x\t", shift + i); for (j = 0; j < 8; j++) - sprintf(extra, "%s%02X ", extra, efuse[i + j]); - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "%02X ", efuse[i + j]); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) - sprintf(extra, "%s%02X ", extra, efuse[i + j]); - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "%02X ", efuse[i + j]); + pextra += sprintf(pextra, "\n"); } if ((shift + cnt) < mapLen) - sprintf(extra, "%s\t...more (left:%d/%d)\n", extra, mapLen-(shift + cnt), mapLen); + pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen); } else if (strcmp(tmp[0], "realmap") == 0) { static u8 order = 0; @@ -9108,16 +8752,17 @@ static int rtw_mp_efuse_get(struct net_device *dev, sprintf(extra, "\n"); for (i = 0; i < cnt; i += 16) { - sprintf(extra, "%s0x%02x\t", extra, shift + i); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%02x\t", shift + i); for (j = 0; j < 8; j++) - sprintf(extra, "%s%02X ", extra, efuse[i + j]); - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "%02X ", efuse[i + j]); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) - sprintf(extra, "%s%02X ", extra, efuse[i + j]); - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "%02X ", efuse[i + j]); + pextra += sprintf(pextra, "\n"); } if ((shift + cnt) < mapLen) - sprintf(extra, "%s\t...more\n", extra); + pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen); } else if (strcmp(tmp[0], "rmap") == 0) { if ((tmp[1] == NULL) || (tmp[2] == NULL)) { RTW_INFO("%s: rmap Fail!! Parameters error!\n", __FUNCTION__); @@ -9152,15 +8797,20 @@ static int rtw_mp_efuse_get(struct net_device *dev, /* RTW_INFO("%s: data={", __FUNCTION__); */ *extra = 0; + pextra = extra; for (i = 0; i < cnts; i++) { /* RTW_INFO("0x%02x ", data[i]); */ - sprintf(extra, "%s0x%02X ", extra, data[i]); + pextra += sprintf(pextra, "0x%02X ", data[i]); } /* RTW_INFO("}\n"); */ } else if (strcmp(tmp[0], "realraw") == 0) { + static u8 raw_order = 0; + u32 shift, cnt; + u32 blksz = 0x200; /* The size of one time show, default 512 */ + addr = 0; EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_REAL_CONTENT_LEN , (PVOID)&mapLen, _FALSE); - RTW_INFO("EFUSE_MAX_SIZE = %d\n", EFUSE_MAX_SIZE); + RTW_INFO("Real content len = %d\n",mapLen ); if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); @@ -9168,52 +8818,79 @@ static int rtw_mp_efuse_get(struct net_device *dev, goto exit; } - if (mapLen >= 512) - mapLen = 512; - _rtw_memset(extra, '\0', strlen(extra)); - sprintf(extra, "\n0x00\t"); + shift = blksz * raw_order; + rawdata += shift; + cnt = mapLen - shift; + if (cnt > blksz) { + cnt = blksz; + raw_order++; + } else + raw_order = 0; - for (i = 0; i < mapLen ; i++) { - sprintf(extra, "%s%02X", extra, rawdata[i]); - if ((i & 0xF) == 0xF) { - sprintf(extra, "%s\n", extra); - sprintf(extra, "%s0x%02x\t", extra, i + 1); - } else if ((i & 0x7) == 0x7) - sprintf(extra, "%s \t", extra); - else - sprintf(extra, "%s ", extra); + sprintf(extra, "\n"); + for (i = 0; i < cnt; i += 16) { + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%02x\t", shift + i); + for (j = 0; j < 8; j++) + pextra += sprintf(pextra, "%02X ", rawdata[i + j]); + pextra += sprintf(pextra, "\t"); + for (; j < 16; j++) + pextra += sprintf(pextra, "%02X ", rawdata[i + j]); + pextra += sprintf(pextra, "\n"); } + if ((shift + cnt) < mapLen) + pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen); + + } else if (strcmp(tmp[0], "btrealraw") == 0) { + static u8 bt_raw_order = 0; + u32 shift, cnt; + u32 blksz = 0x200; /* The size of one time show, default 512 */ - } else if (strcmp(tmp[0], "realrawb") == 0) { addr = 0; - mapLen = EFUSE_MAX_SIZE; - RTW_INFO("EFUSE_MAX_SIZE =%d\n", EFUSE_MAX_SIZE); - if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { - RTW_INFO("%s: rtw_efuse_access Fail!!\n", __FUNCTION__); + EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_REAL_CONTENT_LEN, (PVOID)&mapLen, _FALSE); + RTW_INFO("Real content len = %d\n", mapLen); +#ifdef RTW_HALMAC + if (rtw_efuse_bt_access(padapter, _FALSE, 0, mapLen, rawdata) == _FAIL) { + RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); err = -EFAULT; goto exit; } - _rtw_memset(extra, '\0', strlen(extra)); - /* RTW_INFO("%s: realraw={\n", __FUNCTION__); */ - sprintf(extra, "\n0x00\t"); - for (i = 512; i < mapLen; i++) { - /* RTW_INFO("%02X", rawdata[i]); */ - sprintf(extra, "%s%02X", extra, rawdata[i]); - if ((i & 0xF) == 0xF) { - /* RTW_INFO("\n"); */ - sprintf(extra, "%s\n", extra); - sprintf(extra, "%s0x%02x\t", extra, i + 1); - } else if ((i & 0x7) == 0x7) { - /* RTW_INFO("\t"); */ - sprintf(extra, "%s \t", extra); - } else { - /* RTW_INFO(" "); */ - sprintf(extra, "%s ", extra); - } +#else + rtw_write8(padapter, 0x35, 0x1); + + if (rtw_efuse_access(padapter, _FALSE, addr, mapLen, rawdata) == _FAIL) { + RTW_INFO("%s: rtw_efuse_access Fail!!\n", __func__); + err = -EFAULT; + goto exit; } - /* RTW_INFO("}\n"); */ +#endif + _rtw_memset(extra, '\0', strlen(extra)); + + shift = blksz * bt_raw_order; + rawdata += shift; + cnt = mapLen - shift; + if (cnt > blksz) { + cnt = blksz; + bt_raw_order++; + } else + bt_raw_order = 0; + + sprintf(extra, "\n"); + for (i = 0; i < cnt; i += 16) { + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%02x\t", shift + i); + for (j = 0; j < 8; j++) + pextra += sprintf(pextra, "%02X ", rawdata[i + j]); + pextra += sprintf(pextra, "\t"); + for (; j < 16; j++) + pextra += sprintf(pextra, "%02X ", rawdata[i + j]); + pextra += sprintf(pextra, "\n"); + } + if ((shift + cnt) < mapLen) + pextra += sprintf(pextra, "\t...more (left:%d/%d)\n", mapLen-(shift + cnt), mapLen); + } else if (strcmp(tmp[0], "mac") == 0) { if (hal_efuse_macaddr_offset(padapter) == -1) { err = -EFAULT; @@ -9238,12 +8915,13 @@ static int rtw_mp_efuse_get(struct net_device *dev, /* RTW_INFO("%s: MAC address={", __FUNCTION__); */ *extra = 0; + pextra = extra; for (i = 0; i < cnts; i++) { /* RTW_INFO("%02X", data[i]); */ - sprintf(extra, "%s%02X", extra, data[i]); + pextra += sprintf(pextra, "%02X", data[i]); if (i != (cnts - 1)) { /* RTW_INFO(":"); */ - sprintf(extra, "%s:", extra); + pextra += sprintf(pextra, ":"); } } /* RTW_INFO("}\n"); */ @@ -9301,18 +8979,23 @@ static int rtw_mp_efuse_get(struct net_device *dev, /* RTW_INFO("%s: {VID,PID}={", __FUNCTION__); */ *extra = 0; + pextra = extra; for (i = 0; i < cnts; i++) { /* RTW_INFO("0x%02x", data[i]); */ - sprintf(extra, "%s0x%02X", extra, data[i]); + pextra += sprintf(pextra, "0x%02X", data[i]); if (i != (cnts - 1)) { /* RTW_INFO(","); */ - sprintf(extra, "%s,", extra); + pextra += sprintf(pextra, ","); } } /* RTW_INFO("}\n"); */ } else if (strcmp(tmp[0], "ableraw") == 0) { +#ifdef RTW_HALMAC + raw_maxsize = efuse_GetavailableSize(padapter); +#else efuse_GetCurrentSize(padapter, &raw_cursize); raw_maxsize = efuse_GetMaxSize(padapter); +#endif sprintf(extra, "[available raw size]= %d bytes\n", raw_maxsize - raw_cursize); } else if (strcmp(tmp[0], "btableraw") == 0) { efuse_bt_GetCurrentSize(padapter, &raw_cursize); @@ -9333,19 +9016,20 @@ static int rtw_mp_efuse_get(struct net_device *dev, sprintf(extra, "\n"); for (i = 0; i < 512; i += 16) { /* set 512 because the iwpriv's extra size have limit 0x7FF */ /* RTW_INFO("0x%03x\t", i); */ - sprintf(extra, "%s0x%03x\t", extra, i); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%03x\t", i); for (j = 0; j < 8; j++) { /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); } /* RTW_INFO("\t"); */ - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) { /* RTW_INFO("%02X ", pEfuseHal->BTEfuseInitMap[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); } /* RTW_INFO("\n"); */ - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "\n"); } /* RTW_INFO("\n"); */ } else if (strcmp(tmp[0], "btbmap") == 0) { @@ -9362,22 +9046,34 @@ static int rtw_mp_efuse_get(struct net_device *dev, sprintf(extra, "\n"); for (i = 512; i < 1024 ; i += 16) { /* RTW_INFO("0x%03x\t", i); */ - sprintf(extra, "%s0x%03x\t", extra, i); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%03x\t", i); for (j = 0; j < 8; j++) { /* RTW_INFO("%02X ", data[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); } /* RTW_INFO("\t"); */ - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) { /* RTW_INFO("%02X ", data[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->BTEfuseInitMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->BTEfuseInitMap[i+j]); } /* RTW_INFO("\n"); */ - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "\n"); } /* RTW_INFO("\n"); */ } else if (strcmp(tmp[0], "btrmap") == 0) { + u8 BTStatus; + + rtw_write8(padapter, 0xa3, 0x05); /* For 8723AB ,8821S ? */ + BTStatus = rtw_read8(padapter, 0xa0); + + RTW_INFO("%s: Check 0xa0 BT Status =0x%x\n", __FUNCTION__, BTStatus); + if (BTStatus != 0x04) { + sprintf(extra, "BT Status not Active ,can't to read BT eFuse\n"); + goto exit; + } + if ((tmp[1] == NULL) || (tmp[2] == NULL)) { err = -EINVAL; goto exit; @@ -9396,14 +9092,14 @@ static int rtw_mp_efuse_get(struct net_device *dev, goto exit; } RTW_INFO("%s: cnts=%d\n", __FUNCTION__, cnts); - +#ifndef RTW_HALMAC EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); if ((addr + cnts) > max_available_len) { RTW_INFO("%s: addr(0x%X)+cnts(%d) parameter error!\n", __FUNCTION__, addr, cnts); err = -EFAULT; goto exit; } - +#endif if (rtw_BT_efuse_map_read(padapter, addr, cnts, data) == _FAIL) { RTW_INFO("%s: rtw_BT_efuse_map_read error!!\n", __FUNCTION__); err = -EFAULT; @@ -9411,10 +9107,11 @@ static int rtw_mp_efuse_get(struct net_device *dev, } *extra = 0; + pextra = extra; /* RTW_INFO("%s: bt efuse data={", __FUNCTION__); */ for (i = 0; i < cnts; i++) { /* RTW_INFO("0x%02x ", data[i]); */ - sprintf(extra, "%s 0x%02X ", extra, data[i]); + pextra += sprintf(pextra, " 0x%02X ", data[i]); } /* RTW_INFO("}\n"); */ RTW_INFO(FUNC_ADPT_FMT ": BT MAC=[%s]\n", FUNC_ADPT_ARG(padapter), extra); @@ -9423,19 +9120,20 @@ static int rtw_mp_efuse_get(struct net_device *dev, sprintf(extra, "\n"); for (i = 0; i < 512; i += 16) { /* RTW_INFO("0x%03x\t", i); */ - sprintf(extra, "%s0x%03x\t", extra, i); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%03x\t", i); for (j = 0; j < 8; j++) { /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); } /* RTW_INFO("\t"); */ - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) { /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); } /* RTW_INFO("\n"); */ - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "\n"); } /* RTW_INFO("\n"); */ } else if (strcmp(tmp[0], "btbfake") == 0) { @@ -9443,19 +9141,20 @@ static int rtw_mp_efuse_get(struct net_device *dev, sprintf(extra, "\n"); for (i = 512; i < 1024; i += 16) { /* RTW_INFO("0x%03x\t", i); */ - sprintf(extra, "%s0x%03x\t", extra, i); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%03x\t", i); for (j = 0; j < 8; j++) { /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); } /* RTW_INFO("\t"); */ - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) { /* RTW_INFO("%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); */ - sprintf(extra, "%s%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[i + j]); + pextra += sprintf(pextra, "%02X ", pEfuseHal->fakeBTEfuseModifiedMap[i+j]); } /* RTW_INFO("\n"); */ - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "\n"); } /* RTW_INFO("\n"); */ } else if (strcmp(tmp[0], "wlrfkmap") == 0) { @@ -9478,16 +9177,17 @@ static int rtw_mp_efuse_get(struct net_device *dev, sprintf(extra, "\n"); for (i = 0; i < cnt; i += 16) { - sprintf(extra, "%s0x%02x\t", extra, shift + i); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "0x%02x\t", shift + i); for (j = 0; j < 8; j++) - sprintf(extra, "%s%02X ", extra, efuse[i + j]); - sprintf(extra, "%s\t", extra); + pextra += sprintf(pextra, "%02X ", efuse[i + j]); + pextra += sprintf(pextra, "\t"); for (; j < 16; j++) - sprintf(extra, "%s%02X ", extra, efuse[i + j]); - sprintf(extra, "%s\n", extra); + pextra += sprintf(pextra, "%02X ", efuse[i + j]); + pextra += sprintf(pextra, "\n"); } if ((shift + cnt) < mapLen) - sprintf(extra, "%s\t...more\n", extra); + pextra += sprintf(pextra, "\t...more\n"); } else if (strcmp(tmp[0], "wlrfkrmap") == 0) { if ((tmp[1] == NULL) || (tmp[2] == NULL)) { @@ -9509,9 +9209,10 @@ static int rtw_mp_efuse_get(struct net_device *dev, /* RTW_INFO("%s: data={", __FUNCTION__); */ *extra = 0; + pextra = extra; for (i = 0; i < cnts; i++) { RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeEfuseModifiedMap[addr + i]); - sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeEfuseModifiedMap[addr + i]); + pextra += sprintf(pextra, "0x%02X ", pEfuseHal->fakeEfuseModifiedMap[addr+i]); } } else if (strcmp(tmp[0], "btrfkrmap") == 0) { if ((tmp[1] == NULL) || (tmp[2] == NULL)) { @@ -9533,9 +9234,10 @@ static int rtw_mp_efuse_get(struct net_device *dev, /* RTW_INFO("%s: data={", __FUNCTION__); */ *extra = 0; + pextra = extra; for (i = 0; i < cnts; i++) { RTW_INFO("wlrfkrmap = 0x%02x\n", pEfuseHal->fakeBTEfuseModifiedMap[addr + i]); - sprintf(extra, "%s0x%02X ", extra, pEfuseHal->fakeBTEfuseModifiedMap[addr + i]); + pextra += sprintf(pextra, "0x%02X ", pEfuseHal->fakeBTEfuseModifiedMap[addr+i]); } } else if (strcmp(tmp[0], "mask") == 0) { *extra = 0; @@ -9546,8 +9248,9 @@ static int rtw_mp_efuse_get(struct net_device *dev, _rtw_memcpy(mask_buf, maskfileBuffer, mask_len); sprintf(extra, "\n"); + pextra = extra + strlen(extra); for (i = 0; i < mask_len; i++) - sprintf(extra, "%s0x%02X\n", extra, mask_buf[i]); + pextra += sprintf(pextra, "0x%02X\n", mask_buf[i]); } else sprintf(extra, "Command not found!"); @@ -9576,6 +9279,8 @@ static int rtw_mp_efuse_get(struct net_device *dev, return err; } + +#ifdef CONFIG_MP_INCLUDED static int rtw_mp_efuse_set(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wdata, char *extra) @@ -9605,7 +9310,7 @@ static int rtw_mp_efuse_set(struct net_device *dev, pwrctrlpriv = adapter_to_pwrctl(padapter); pHalData = GET_HAL_DATA(padapter); pEfuseHal = &pHalData->EfuseHal; - pHalFunc = &padapter->HalFunc; + pHalFunc = &padapter->hal_func; pmp_priv = &padapter->mppriv; err = 0; @@ -9613,6 +9318,8 @@ static int rtw_mp_efuse_set(struct net_device *dev, if (copy_from_user(extra, wrqu->pointer, wrqu->length)) return -EFAULT; + *(extra + wrqu->length) = '\0'; + EFUSE_GetEfuseDefinition(padapter, EFUSE_WIFI, TYPE_EFUSE_MAP_LEN , (void *)&wifimaplen, _FALSE); setdata = rtw_zmalloc(1024); @@ -9983,21 +9690,6 @@ static int rtw_mp_efuse_set(struct net_device *dev, for (jj = 0, kk = 0; jj < cnts; jj++, kk += 2) setdata[jj] = key_2char2num(tmp[2][kk], tmp[2][kk + 1]); -#ifdef CONFIG_RTL8703B - if (cnts == 1 && addr == 0x189) { - setdata[1] = setdata[0]; - setdata[0] = 0x00; - cnts += 1; - addr = 0x188; - RTW_INFO("addr 0x%x ,setdata=0x%X 0x%X\n", addr, setdata[0], setdata[1]); - } else if (cnts == 1 && addr == 0x161) { - setdata[1] = setdata[0]; - setdata[0] = 0xFE; - cnts += 1; - addr = 0x160; - RTW_INFO("addr 0x%x ,setdata=0x%X 0x%X\n", addr, setdata[0], setdata[1]); - } -#endif #ifndef RTW_HALMAC EFUSE_GetEfuseDefinition(padapter, EFUSE_BT, TYPE_EFUSE_MAP_LEN, (PVOID)&max_available_len, _FALSE); if ((addr + cnts) > max_available_len) { @@ -10256,8 +9948,12 @@ static int rtw_mp_efuse_set(struct net_device *dev, } _rtw_memset(extra, '\0', strlen(extra)); sprintf(extra, "eFuse Update OK\n"); - } + } else if (strcmp(tmp[0], "analyze") == 0) { + rtw_efuse_analyze(padapter, EFUSE_WIFI, 0); + _rtw_memset(extra, '\0', strlen(extra)); + sprintf(extra, "eFuse Analyze OK,please to check kernel log\n"); + } exit: if (setdata) rtw_mfree(setdata, 1024); @@ -10283,8 +9979,6 @@ static int rtw_mp_efuse_set(struct net_device *dev, return err; } -#ifdef CONFIG_MP_INCLUDED - #ifdef CONFIG_RTW_CUSTOMER_STR static int rtw_mp_customer_str( struct net_device *dev, @@ -10391,6 +10085,12 @@ static int rtw_priv_mp_set(struct net_device *dev, struct iw_point *wrqu = (struct iw_point *)wdata; u32 subcmd = wrqu->flags; + PADAPTER padapter = rtw_netdev_priv(dev); + + if (!is_primary_adapter(padapter)) { + RTW_INFO("MP mode only primary Adapter support\n"); + return -EIO; + } switch (subcmd) { case CTA_TEST: @@ -10424,6 +10124,12 @@ static int rtw_priv_mp_get(struct net_device *dev, struct iw_point *wrqu = (struct iw_point *)wdata; u32 subcmd = wrqu->flags; + PADAPTER padapter = rtw_netdev_priv(dev); + + if (!is_primary_adapter(padapter)) { + RTW_INFO("MP mode only primary Adapter support\n"); + return -EIO; + } switch (subcmd) { case MP_START: @@ -10519,10 +10225,12 @@ static int rtw_priv_mp_get(struct net_device *dev, RTW_INFO("set case MP_PWRTRK\n"); rtw_mp_pwrtrk(dev, info, wrqu, extra); break; +#ifdef CONFIG_MP_INCLUDED case EFUSE_SET: RTW_INFO("set case efuse set\n"); rtw_mp_efuse_set(dev, info, wdata, extra); break; +#endif case EFUSE_GET: RTW_INFO("efuse get EFUSE_GET\n"); rtw_mp_efuse_get(dev, info, wdata, extra); @@ -10565,6 +10273,18 @@ static int rtw_priv_mp_get(struct net_device *dev, rtw_mp_customer_str(dev, info, wdata, extra); break; #endif + case MP_PWRLMT: + RTW_INFO("mp_get MP_SETPWRLMT\n"); + rtw_mp_pwrlmt(dev, info, wdata, extra); + break; + case MP_PWRBYRATE: + RTW_INFO("mp_get MP_SETPWRBYRATE\n"); + rtw_mp_pwrbyrate(dev, info, wdata, extra); + break; + case BT_EFUSE_FILE: + RTW_INFO("mp_get BT EFUSE_FILE\n"); + rtw_bt_efuse_file_map(dev, info, wdata, extra); + break; default: return -EIO; } @@ -10893,57 +10613,14 @@ static int rtw_tdls_enable(struct net_device *dev, int ret = 0; #ifdef CONFIG_TDLS - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - struct tdls_info *ptdlsinfo = &padapter->tdlsinfo; - _irqL irqL; - _list *plist, *phead; - s32 index; - struct sta_info *psta = NULL; - struct sta_priv *pstapriv = &padapter->stapriv; - u8 tdls_sta[NUM_STA][ETH_ALEN]; - u8 empty_hwaddr[ETH_ALEN] = { 0x00 }; - struct tdls_txmgmt txmgmt; RTW_INFO("[%s] %s %d\n", __FUNCTION__, extra, wrqu->data.length - 1); - _rtw_memset(tdls_sta, 0x00, sizeof(tdls_sta)); - _rtw_memset(&txmgmt, 0x00, sizeof(struct tdls_txmgmt)); - - if (extra[0] == '0') { - ptdlsinfo->tdls_enable = 0; - - if (pstapriv->asoc_sta_count == 1) - return ret; - - _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); - for (index = 0; index < NUM_STA; index++) { - phead = &(pstapriv->sta_hash[index]); - plist = get_next(phead); - - while (rtw_end_of_queue_search(phead, plist) == _FALSE) { - psta = LIST_CONTAINOR(plist, struct sta_info , hash_list); - - plist = get_next(plist); - - if (psta->tdls_sta_state != TDLS_STATE_NONE) - _rtw_memcpy(tdls_sta[index], psta->hwaddr, ETH_ALEN); - } - } - _exit_critical_bh(&pstapriv->sta_hash_lock, &irqL); - - for (index = 0; index < NUM_STA; index++) { - if (!_rtw_memcmp(tdls_sta[index], empty_hwaddr, ETH_ALEN)) { - RTW_INFO("issue tear down to "MAC_FMT"\n", MAC_ARG(tdls_sta[index])); - txmgmt.status_code = _RSON_TDLS_TEAR_UN_RSN_; - _rtw_memcpy(txmgmt.peer, tdls_sta[index], ETH_ALEN); - issue_tdls_teardown(padapter, &txmgmt, _TRUE); - } - } - rtw_tdls_cmd(padapter, NULL, TDLS_RS_RCR); - rtw_reset_tdls_info(padapter); - } else if (extra[0] == '1') - ptdlsinfo->tdls_enable = 1; + if (extra[0] == '0') + rtw_disable_tdls_func(padapter, _FALSE); + else if (extra[0] == '1') + rtw_enable_tdls_func(padapter); #endif /* CONFIG_TDLS */ return ret; @@ -11103,11 +10780,11 @@ static int rtw_tdls_ch_switch(struct net_device *dev, bw_mode = (pchsw_info->ch_offset) ? CHANNEL_WIDTH_40 : CHANNEL_WIDTH_20; central_chnl = rtw_get_center_ch(pchsw_info->off_ch_num, bw_mode, pchsw_info->ch_offset); if (rtw_hal_ch_sw_iqk_info_search(padapter, central_chnl, bw_mode) >= 0) - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_START); else - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_PREPARE); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_PREPARE); } else - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_START); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_START); /* issue_tdls_ch_switch_req(padapter, ptdls_sta); */ /* RTW_INFO("issue tdls ch switch req\n"); */ @@ -11151,7 +10828,7 @@ static int rtw_tdls_ch_switch_off(struct net_device *dev, if (ptdls_sta == NULL) return ret; - rtw_tdls_cmd(padapter, ptdls_sta->hwaddr, TDLS_CH_SW_END_TO_BASE_CHNL); + rtw_tdls_cmd(padapter, ptdls_sta->cmn.mac_addr, TDLS_CH_SW_END_TO_BASE_CHNL); pchsw_info->ch_sw_state &= ~(TDLS_CH_SW_INITIATOR_STATE | TDLS_CH_SWITCH_ON_STATE | @@ -11275,7 +10952,7 @@ static int rtw_tdls_pson(struct net_device *dev, ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); - issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 1, 3, 500); + issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 1, 3, 500); #endif /* CONFIG_TDLS */ @@ -11302,7 +10979,7 @@ static int rtw_tdls_psoff(struct net_device *dev, ptdls_sta = rtw_get_stainfo(&padapter->stapriv, mac_addr); if (ptdls_sta) - issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->hwaddr, 0, 3, 500); + issue_nulldata_to_TDLS_peer_STA(padapter, ptdls_sta->cmn.mac_addr, 0, 3, 500); #endif /* CONFIG_TDLS */ @@ -11475,7 +11152,7 @@ static int rtw_wfd_tdls_status(struct net_device *dev, , ptdlsinfo->link_established, ptdlsinfo->sta_cnt, ptdlsinfo->sta_maximum, ptdlsinfo->cur_channel, - ptdlsinfo->tdls_enable + rtw_is_tdls_enabled(padapter) #ifdef CONFIG_TDLS_CH_SW , ptdlsinfo->chsw_info.ch_sw_state, @@ -11544,49 +11221,50 @@ static int rtw_tdls_get_best_ch(struct net_device *dev, { #ifdef CONFIG_FIND_BEST_CHANNEL _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; u32 i, best_channel_24G = 1, best_channel_5G = 36, index_24G = 0, index_5G = 0; - for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { - if (pmlmeext->channel_set[i].ChannelNum == 1) + for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { + if (rfctl->channel_set[i].ChannelNum == 1) index_24G = i; - if (pmlmeext->channel_set[i].ChannelNum == 36) + if (rfctl->channel_set[i].ChannelNum == 36) index_5G = i; } - for (i = 0; pmlmeext->channel_set[i].ChannelNum != 0; i++) { + for (i = 0; i < rfctl->max_chan_nums && rfctl->channel_set[i].ChannelNum != 0; i++) { /* 2.4G */ - if (pmlmeext->channel_set[i].ChannelNum == 6 || pmlmeext->channel_set[i].ChannelNum == 11) { - if (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_24G].rx_count) { + if (rfctl->channel_set[i].ChannelNum == 6 || rfctl->channel_set[i].ChannelNum == 11) { + if (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_24G].rx_count) { index_24G = i; - best_channel_24G = pmlmeext->channel_set[i].ChannelNum; + best_channel_24G = rfctl->channel_set[i].ChannelNum; } } /* 5G */ - if (pmlmeext->channel_set[i].ChannelNum >= 36 - && pmlmeext->channel_set[i].ChannelNum < 140) { + if (rfctl->channel_set[i].ChannelNum >= 36 + && rfctl->channel_set[i].ChannelNum < 140) { /* Find primary channel */ - if (((pmlmeext->channel_set[i].ChannelNum - 36) % 8 == 0) - && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { + if (((rfctl->channel_set[i].ChannelNum - 36) % 8 == 0) + && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { index_5G = i; - best_channel_5G = pmlmeext->channel_set[i].ChannelNum; + best_channel_5G = rfctl->channel_set[i].ChannelNum; } } - if (pmlmeext->channel_set[i].ChannelNum >= 149 - && pmlmeext->channel_set[i].ChannelNum < 165) { + if (rfctl->channel_set[i].ChannelNum >= 149 + && rfctl->channel_set[i].ChannelNum < 165) { /* Find primary channel */ - if (((pmlmeext->channel_set[i].ChannelNum - 149) % 8 == 0) - && (pmlmeext->channel_set[i].rx_count < pmlmeext->channel_set[index_5G].rx_count)) { + if (((rfctl->channel_set[i].ChannelNum - 149) % 8 == 0) + && (rfctl->channel_set[i].rx_count < rfctl->channel_set[index_5G].rx_count)) { index_5G = i; - best_channel_5G = pmlmeext->channel_set[i].ChannelNum; + best_channel_5G = rfctl->channel_set[i].ChannelNum; } } #if 1 /* debug */ RTW_INFO("The rx cnt of channel %3d = %d\n", - pmlmeext->channel_set[i].ChannelNum, - pmlmeext->channel_set[i].rx_count); + rfctl->channel_set[i].ChannelNum, + rfctl->channel_set[i].rx_count); #endif } @@ -11623,8 +11301,8 @@ static int rtw_tdls(struct net_device *dev, return 0; } - if (padapter->tdlsinfo.tdls_enable == 0) { - RTW_INFO("tdls haven't enabled\n"); + if (rtw_is_tdls_enabled(padapter) == _FALSE) { + RTW_INFO("TDLS is not enabled\n"); return 0; } @@ -11916,7 +11594,7 @@ static s32 createpseudoadhoc(PADAPTER padapter) /* 3 join psudo AdHoc */ pcur_network->join_res = 1; - pcur_network->aid = psta->aid = 1; + pcur_network->aid = psta->cmn.aid = 1; _rtw_memcpy(&pcur_network->network, pdev_network, get_WLAN_BSSID_EX_sz(pdev_network)); /* set msr to WIFI_FW_ADHOC_STATE */ @@ -11994,14 +11672,12 @@ static struct xmit_frame *createloopbackpkt(PADAPTER padapter, u32 size) pattrib->qos_en = _FALSE; bmcast = IS_MCAST(pattrib->ra); - if (bmcast) { - pattrib->mac_id = 1; + if (bmcast) pattrib->psta = rtw_get_bcmc_stainfo(padapter); - } else { - pattrib->mac_id = 0; + else pattrib->psta = rtw_get_stainfo(&padapter->stapriv, get_bssid(&padapter->mlmepriv)); - } + pattrib->mac_id = pattrib->psta->cmn.mac_id; pattrib->pktlen = size; pattrib->last_txcmdsz = pattrib->hdrlen + pattrib->pktlen; @@ -12045,7 +11721,7 @@ static struct xmit_frame *createloopbackpkt(PADAPTER padapter, u32 size) /* 3 5.1. make wlan header, make_wlanhdr() */ hdr = (struct rtw_ieee80211_hdr *)pkt_start; - SetFrameSubType(&hdr->frame_ctl, pattrib->subtype); + set_frame_sub_type(&hdr->frame_ctl, pattrib->subtype); _rtw_memcpy(hdr->addr1, pattrib->dst, ETH_ALEN); /* DA */ _rtw_memcpy(hdr->addr2, pattrib->src, ETH_ALEN); /* SA */ _rtw_memcpy(hdr->addr3, get_bssid(&padapter->mlmepriv), ETH_ALEN); /* RA, BSSID */ @@ -12134,7 +11810,7 @@ static u8 pktcmp(PADAPTER padapter, u8 *txbuf, u32 txsz, u8 *rxbuf, u32 rxsz) rxpktsize = prxreport->pktlen; phal = GET_HAL_DATA(padapter); - if (phal->ReceiveConfig & RCR_APPFCS) + if (rtw_hal_rcr_check(padapter, RCR_APPFCS)) fcssize = IEEE80211_FCS_LEN; else fcssize = 0; @@ -12237,8 +11913,7 @@ thread_return lbk_thread(thread_context context) freeloopbackpkt(padapter, pxmitframe); pxmitframe = NULL; - if (signal_pending(current)) - flush_signals(current); + flush_signals_thread(); if ((ploopback->bstop == _TRUE) || ((ploopback->cnt != 0) && (ploopback->cnt == cnt))) { @@ -12255,7 +11930,8 @@ thread_return lbk_thread(thread_context context) ploopback->bstop = _TRUE; - thread_exit(); + thread_exit(NULL); + return 0; } static void loopbackTest(PADAPTER padapter, u32 cnt, u32 size, u8 *pmsg) @@ -12316,6 +11992,7 @@ static void loopbackTest(PADAPTER padapter, u32 cnt, u32 size, u8 *pmsg) ploopback->lbkthread = kthread_run(lbk_thread, padapter, "RTW_LBK_THREAD"); if (IS_ERR(padapter->lbkthread)) { freeLoopback(padapter); + ploopback->lbkthread = NULL; sprintf(pmsg, "loopback start FAIL! cnt=%d", cnt); return; } @@ -12339,17 +12016,20 @@ static int rtw_test( RTW_INFO("+%s\n", __func__); len = wrqu->data.length; - pbuf = (u8 *)rtw_zmalloc(len); + pbuf = (u8 *)rtw_zmalloc(len + 1); if (pbuf == NULL) { RTW_INFO("%s: no memory!\n", __func__); return -ENOMEM; } if (copy_from_user(pbuf, wrqu->data.pointer, len)) { - rtw_mfree(pbuf, len); + rtw_mfree(pbuf, len + 1); RTW_INFO("%s: copy from user fail!\n", __func__); return -EFAULT; } + + pbuf[len] = '\0'; + RTW_INFO("%s: string=\"%s\"\n", __func__, pbuf); ptmp = (char *)pbuf; @@ -12597,13 +12277,18 @@ static const struct iw_priv_args rtw_private_args[] = { SIOCIWFIRSTPRIV + 0x16, IW_PRIV_TYPE_CHAR | 64, 0, "pm_set" }, - +#ifdef CONFIG_RTW_80211K + { + SIOCIWFIRSTPRIV + 0x17, + IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | 1024 , "rrm" + }, +#endif {SIOCIWFIRSTPRIV + 0x18, IW_PRIV_TYPE_CHAR | IFNAMSIZ , 0 , "rereg_nd_name"}, #ifdef CONFIG_MP_INCLUDED {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "NULL"}, {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "NULL"}, #else - {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "efuse_set"}, + {SIOCIWFIRSTPRIV + 0x1A, IW_PRIV_TYPE_CHAR | 1024, 0, "NULL"}, {SIOCIWFIRSTPRIV + 0x1B, IW_PRIV_TYPE_CHAR | 128, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "efuse_get"}, #endif { @@ -12687,9 +12372,12 @@ static const struct iw_priv_args rtw_mp_private_args[] = { { MP_TX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_tx" }, { MP_RX, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_rx" }, { MP_HW_TX_MODE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_hxtx" }, + { MP_PWRLMT, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrlmt" }, + { MP_PWRBYRATE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "mp_pwrbyrate" }, { CTA_TEST, IW_PRIV_TYPE_CHAR | 1024, 0, "cta_test"}, { MP_IQK, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_iqk"}, { MP_LCK, IW_PRIV_TYPE_CHAR | 1024, 0, "mp_lck"}, + { BT_EFUSE_FILE, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "bt_efuse_file" }, #ifdef CONFIG_RTW_CUSTOMER_STR { MP_CUSTOMER_STR, IW_PRIV_TYPE_CHAR | 1024, IW_PRIV_TYPE_CHAR | IW_PRIV_SIZE_MASK, "customer_str" }, #endif @@ -12700,7 +12388,7 @@ static const struct iw_priv_args rtw_mp_private_args[] = { static iw_handler rtw_private_handler[] = { rtw_wx_write32, /* 0x00 */ rtw_wx_read32, /* 0x01 */ - rtw_drvext_hdl, /* 0x02 */ + NULL, /* 0x02 */ #ifdef MP_IOCTL_HDL rtw_mp_ioctl_hdl, /* 0x03 */ #else @@ -12737,14 +12425,18 @@ static iw_handler rtw_private_handler[] = { rtw_tdls_get, /* 0x15 */ rtw_pm_set, /* 0x16 */ +#ifdef CONFIG_RTW_80211K + rtw_wx_priv_rrm, /* 0x17 */ +#else rtw_wx_priv_null, /* 0x17 */ +#endif rtw_rereg_nd_name, /* 0x18 */ rtw_wx_priv_null, /* 0x19 */ #ifdef CONFIG_MP_INCLUDED rtw_wx_priv_null, /* 0x1A */ - rtw_wx_priv_null, /* 0x1B */ + rtw_wx_priv_null, /* 0x1B */ #else - rtw_mp_efuse_set, /* 0x1A */ + rtw_wx_priv_null, /* 0x1A */ rtw_mp_efuse_get, /* 0x1B */ #endif NULL, /* 0x1C is reserved for hostapd */ @@ -12781,14 +12473,20 @@ static struct iw_statistics *rtw_get_wireless_stats(struct net_device *dev) HAL_DATA_TYPE *pHal = GET_HAL_DATA(padapter); - tmp_level = (u8)odm_SignalScaleMapping(&pHal->odmpriv, padapter->recvpriv.signal_strength); + tmp_level = (u8)phydm_signal_scale_mapping(&pHal->odmpriv, padapter->recvpriv.signal_strength); } #endif #endif tmp_qual = padapter->recvpriv.signal_qual; - rtw_get_noise(padapter); - tmp_noise = padapter->recvpriv.noise; + #ifdef CONFIG_BACKGROUND_NOISE_MONITOR + if (IS_NM_ENABLE(padapter)) { + tmp_noise = rtw_noise_measure_curchan(padapter); + #ifndef CONFIG_SIGNAL_DISPLAY_DBM + tmp_noise = translate_dbm_to_percentage(tmp_noise);/*percentage*/ + #endif + } + #endif /* RTW_INFO("level:%d, qual:%d, noise:%d, rssi (%d)\n", tmp_level, tmp_qual, tmp_noise,padapter->recvpriv.rssi); */ piwstats->qual.level = tmp_level; @@ -12988,6 +12686,11 @@ static int _rtw_ioctl_wext_private(struct net_device *dev, union iwreq_data *wrq goto exit; } + if (k >= num_priv_args) { + err = -EINVAL; + goto exit; + } + /* If we have to set some data */ if ((priv_args[k].set_args & IW_PRIV_TYPE_MASK) && (priv_args[k].set_args & IW_PRIV_SIZE_MASK)) { @@ -13251,7 +12954,11 @@ static int rtw_ioctl_standard_wext_private(struct net_device *dev, struct ifreq static int rtw_ioctl_wext_private(struct net_device *dev, struct ifreq *rq) { #ifdef CONFIG_COMPAT +#if (KERNEL_VERSION(4, 6, 0) > LINUX_VERSION_CODE) if (is_compat_task()) +#else + if (in_compat_syscall()) +#endif return rtw_ioctl_compat_wext_private(dev, rq); else #endif /* CONFIG_COMPAT */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_mp.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_mp.c index bcdbd1e03f9b..eacd685857f2 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_mp.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/ioctl_mp.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #if defined(CONFIG_MP_INCLUDED) #include @@ -48,11 +43,15 @@ int rtw_mp_write_reg(struct net_device *dev, u32 addr, data; int ret; PADAPTER padapter = rtw_netdev_priv(dev); - char input[wrqu->length]; + char input[wrqu->length + 1]; + + _rtw_memset(input, 0, sizeof(input)); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + input[wrqu->length] = '\0'; + _rtw_memset(extra, 0, wrqu->length); pch = input; @@ -130,7 +129,7 @@ int rtw_mp_read_reg(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { - char input[wrqu->length]; + char input[wrqu->length + 1]; char *pch, *pnext, *ptmp; char *width_str; char width; @@ -138,14 +137,16 @@ int rtw_mp_read_reg(struct net_device *dev, u32 addr = 0, strtout = 0; u32 i = 0, j = 0, ret = 0, data32 = 0; PADAPTER padapter = rtw_netdev_priv(dev); - + char *pextra = extra; if (wrqu->length > 128) return -EFAULT; + _rtw_memset(input, 0, sizeof(input)); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + input[wrqu->length] = '\0'; _rtw_memset(extra, 0, wrqu->length); _rtw_memset(data, '\0', sizeof(data)); _rtw_memset(tmp, '\0', sizeof(tmp)); @@ -198,7 +199,7 @@ int rtw_mp_read_reg(struct net_device *dev, if (*pnext != '\0') { /*strtout = simple_strtoul(pnext , &ptmp, 16);*/ ret = sscanf(pnext, "%x", &strtout); - sprintf(extra, "%s %d" , extra , strtout); + pextra += sprintf(pextra, " %d", strtout); } else break; pch = pnext; @@ -230,7 +231,7 @@ int rtw_mp_read_reg(struct net_device *dev, pnext++; if (*pnext != '\0') { ret = sscanf(pnext, "%x", &strtout); - sprintf(extra, "%s %d" , extra , strtout); + pextra += sprintf(pextra, " %d", strtout); } else break; pch = pnext; @@ -310,6 +311,7 @@ int rtw_mp_read_rf(struct net_device *dev, u32 path, addr, strtou; u32 ret, i = 0 , j = 0; PADAPTER padapter = rtw_netdev_priv(dev); + char *pextra = extra; if (wrqu->length > 128) return -EFAULT; @@ -349,7 +351,7 @@ int rtw_mp_read_rf(struct net_device *dev, if (*pnext != '\0') { /*strtou =simple_strtoul(pnext , &ptmp, 16);*/ ret = sscanf(pnext, "%x", &strtou); - sprintf(extra, "%s %d" , extra , strtou); + pextra += sprintf(pextra, " %d", strtou); } else break; pch = pnext; @@ -364,10 +366,11 @@ int rtw_mp_start(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { + int ret = 0; u8 val8; PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; rtw_pm_set_ips(padapter, IPS_NONE); LeaveAllPowerSaveMode(padapter); @@ -375,50 +378,14 @@ int rtw_mp_start(struct net_device *dev, if (rtw_mi_check_fwstate(padapter, _FW_UNDER_SURVEY)) rtw_mi_scan_abort(padapter, _FALSE); - if (padapter->registrypriv.mp_mode == 0) { - rtw_hal_deinit(padapter); - padapter->registrypriv.mp_mode = 1; -#ifdef CONFIG_RF_POWER_TRIM - if (!IS_HARDWARE_TYPE_8814A(padapter) && !IS_HARDWARE_TYPE_8822B(padapter)) { - padapter->registrypriv.RegPwrTrimEnable = 1; - rtw_hal_read_chip_info(padapter); - } -#endif /*CONFIG_RF_POWER_TRIM*/ - rtw_hal_init(padapter); - } - - if (padapter->registrypriv.mp_mode == 0) - return -EPERM; - - if (padapter->mppriv.mode == MP_OFF) { - if (mp_start_test(padapter) == _FAIL) - return -EPERM; - padapter->mppriv.mode = MP_ON; - MPT_PwrCtlDM(padapter, 0); - } - padapter->mppriv.bmac_filter = _FALSE; -#ifdef CONFIG_RTL8723B -#ifdef CONFIG_USB_HCI - rtw_write32(padapter, 0x765, 0x0000); - rtw_write32(padapter, 0x948, 0x0280); -#else - rtw_write32(padapter, 0x765, 0x0000); - rtw_write32(padapter, 0x948, 0x0000); -#endif -#ifdef CONFIG_FOR_RTL8723BS_VQ0 - rtw_write32(padapter, 0x765, 0x0000); - rtw_write32(padapter, 0x948, 0x0280); -#endif - rtw_write8(padapter, 0x66, 0x27); /*Open BT uart Log*/ - rtw_write8(padapter, 0xc50, 0x20); /*for RX init Gain*/ -#endif - ODM_Write_DIG(&pHalData->odmpriv, 0x20); + if (rtw_mp_cmd(padapter, MP_START, RTW_CMDF_WAIT_ACK) != _SUCCESS) + ret = -EPERM; _rtw_memset(extra, 0, wrqu->length); - sprintf(extra, "mp_start ok\n"); + sprintf(extra, "mp_start %s\n", ret == 0 ? "ok" : "fail"); wrqu->length = strlen(extra); - return 0; + return ret; } @@ -427,26 +394,18 @@ int rtw_mp_stop(struct net_device *dev, struct iw_request_info *info, struct iw_point *wrqu, char *extra) { + int ret = 0; PADAPTER padapter = rtw_netdev_priv(dev); - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; - if (padapter->registrypriv.mp_mode == 1) { + if (rtw_mp_cmd(padapter, MP_STOP, RTW_CMDF_WAIT_ACK) != _SUCCESS) + ret = -EPERM; - MPT_DeInitAdapter(padapter); - pHalFunc->hal_deinit(padapter); - padapter->registrypriv.mp_mode = 0; - pHalFunc->hal_init(padapter); - } - - if (padapter->mppriv.mode != MP_OFF) { - mp_stop_test(padapter); - padapter->mppriv.mode = MP_OFF; - } _rtw_memset(extra, 0, wrqu->length); - sprintf(extra, "mp_stop ok\n"); + sprintf(extra, "mp_stop %s\n", ret == 0 ? "ok" : "fail"); wrqu->length = strlen(extra); - return 0; + return ret; } @@ -455,13 +414,15 @@ int rtw_mp_rate(struct net_device *dev, struct iw_point *wrqu, char *extra) { u32 rate = MPT_RATE_1M; - u8 input[wrqu->length]; + u8 input[wrqu->length + 1]; PADAPTER padapter = rtw_netdev_priv(dev); - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); + _rtw_memset(input, 0, sizeof(input)); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + input[wrqu->length] = '\0'; rate = rtw_mpRateParseFunc(padapter, input); padapter->mppriv.rateidx = rate; @@ -488,7 +449,7 @@ int rtw_mp_rate(struct net_device *dev, if (padapter->mppriv.rateidx >= DESC_RATEVHTSS4MCS9) return -EINVAL; - pMptCtx->MptRateIndex = HwRateToMPTRate(padapter->mppriv.rateidx); + pMptCtx->mpt_rate_index = HwRateToMPTRate(padapter->mppriv.rateidx); SetDataRate(padapter); wrqu->length = strlen(extra); @@ -503,20 +464,22 @@ int rtw_mp_channel(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - u8 input[wrqu->length]; + u8 input[wrqu->length + 1]; u32 channel = 1; int cur_ch_offset; + _rtw_memset(input, 0, sizeof(input)); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + input[wrqu->length] = '\0'; channel = rtw_atoi(input); /*RTW_INFO("%s: channel=%d\n", __func__, channel);*/ _rtw_memset(extra, 0, wrqu->length); sprintf(extra, "Change channel %d to channel %d", padapter->mppriv.channel , channel); padapter->mppriv.channel = channel; SetChannel(padapter); - pHalData->CurrentChannel = channel; + pHalData->current_channel = channel; wrqu->length = strlen(extra); return 0; @@ -547,10 +510,10 @@ int rtw_mp_bandwidth(struct net_device *dev, padapter->mppriv.bandwidth = (u8)bandwidth; padapter->mppriv.preamble = sg; _rtw_memset(extra, 0, wrqu->length); - sprintf(extra, "Change BW %d to BW %d\n", pHalData->CurrentChannelBW , bandwidth); + sprintf(extra, "Change BW %d to BW %d\n", pHalData->current_channel_bw , bandwidth); SetBandwidth(padapter); - pHalData->CurrentChannelBW = bandwidth; + pHalData->current_channel_bw = bandwidth; /*cur_ch_offset = rtw_get_offset_by_ch(padapter->mppriv.channel);*/ /*set_channel_bwmode(padapter, padapter->mppriv.channel, cur_ch_offset, bandwidth);*/ wrqu->length = strlen(extra); @@ -564,16 +527,20 @@ int rtw_mp_txpower_index(struct net_device *dev, struct iw_point *wrqu, char *extra) { PADAPTER padapter = rtw_netdev_priv(dev); - char input[wrqu->length]; + char input[wrqu->length + 1]; u32 rfpath; u32 txpower_inx; if (wrqu->length > 128) return -EFAULT; + _rtw_memset(input, 0, sizeof(input)); + if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + input[wrqu->length] = '\0'; + rfpath = rtw_atoi(input); txpower_inx = mpt_ProQueryCalTxPower(padapter, rfpath); sprintf(extra, " %d", txpower_inx); @@ -592,7 +559,7 @@ int rtw_mp_txpower(struct net_device *dev, u8 input[wrqu->length]; PADAPTER padapter = rtw_netdev_priv(dev); - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; @@ -608,10 +575,10 @@ int rtw_mp_txpower(struct net_device *dev, sprintf(extra, "Set power level path_A:%d path_B:%d path_C:%d path_D:%d", idx_a , idx_b , idx_c , idx_d); padapter->mppriv.txpoweridx = (u8)idx_a; - pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)idx_a; - pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)idx_b; - pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)idx_c; - pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)idx_d; + pMptCtx->TxPwrLevel[RF_PATH_A] = (u8)idx_a; + pMptCtx->TxPwrLevel[RF_PATH_B] = (u8)idx_b; + pMptCtx->TxPwrLevel[RF_PATH_C] = (u8)idx_c; + pMptCtx->TxPwrLevel[RF_PATH_D] = (u8)idx_d; padapter->mppriv.bSetTxPower = 1; SetTxPower(padapter); @@ -627,14 +594,16 @@ int rtw_mp_ant_tx(struct net_device *dev, struct iw_point *wrqu, char *extra) { u8 i; - u8 input[wrqu->length]; + u8 input[wrqu->length + 1]; u16 antenna = 0; PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + _rtw_memset(input, 0, sizeof(input)); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + input[wrqu->length] = '\0'; sprintf(extra, "switch Tx antenna to %s", input); for (i = 0; i < strlen(input); i++) { @@ -658,7 +627,7 @@ int rtw_mp_ant_tx(struct net_device *dev, padapter->mppriv.antenna_tx = antenna; padapter->mppriv.antenna_rx = antenna; /*RTW_INFO("%s:mppriv.antenna_rx=%d\n", __func__, padapter->mppriv.antenna_tx);*/ - pHalData->AntennaTxPath = antenna; + pHalData->antenna_tx_path = antenna; SetAntenna(padapter); @@ -673,12 +642,15 @@ int rtw_mp_ant_rx(struct net_device *dev, { u8 i; u16 antenna = 0; - u8 input[wrqu->length]; + u8 input[wrqu->length + 1]; PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + _rtw_memset(input, 0, sizeof(input)); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + + input[wrqu->length] = '\0'; /*RTW_INFO("%s: input=%s\n", __func__, input);*/ _rtw_memset(extra, 0, wrqu->length); @@ -759,6 +731,7 @@ int rtw_mp_ctx(struct net_device *dev, if (copy_from_user(extra, wrqu->pointer, wrqu->length)) return -EFAULT; + *(extra + wrqu->length) = '\0'; RTW_INFO("%s: in=%s\n", __func__, extra); #ifdef CONFIG_CONCURRENT_MODE if (!is_primary_adapter(padapter)) { @@ -808,10 +781,10 @@ int rtw_mp_ctx(struct net_device *dev, bStartTest = 0; /* To set Stop*/ pmp_priv->tx.stop = 1; sprintf(extra, "Stop continuous Tx"); - ODM_Write_DIG(&pHalData->odmpriv, 0x20); + odm_write_dig(&pHalData->odmpriv, 0x20); } else { bStartTest = 1; - ODM_Write_DIG(&pHalData->odmpriv, 0x7f); + odm_write_dig(&pHalData->odmpriv, 0x7f); if (pmp_priv->mode != MP_ON) { if (pmp_priv->tx.stop != 1) { RTW_INFO("%s: MP_MODE != ON %d\n", __func__, pmp_priv->mode); @@ -847,14 +820,18 @@ int rtw_mp_disable_bt_coexist(struct net_device *dev, { PADAPTER padapter = (PADAPTER)rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; - u8 input[wrqu->data.length]; + u8 input[wrqu->data.length + 1]; u32 bt_coexist; + _rtw_memset(input, 0, sizeof(input)); + if (copy_from_user(input, wrqu->data.pointer, wrqu->data.length)) return -EFAULT; + input[wrqu->data.length] = '\0'; + bt_coexist = rtw_atoi(input); if (bt_coexist == 0) { @@ -1030,7 +1007,7 @@ int rtw_mp_trx_query(struct net_device *dev, { u32 txok, txfail, rxok, rxfail, rxfilterout; PADAPTER padapter = rtw_netdev_priv(dev); - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); RT_PMAC_TX_INFO PMacTxInfo = pMptCtx->PMacTxInfo; if (PMacTxInfo.bEnPMacTx == TRUE) @@ -1100,11 +1077,13 @@ int rtw_mp_psd(struct net_device *dev, struct iw_point *wrqu, char *extra) { PADAPTER padapter = rtw_netdev_priv(dev); - u8 input[wrqu->length]; + u8 input[wrqu->length + 1]; + _rtw_memset(input, 0, sizeof(input)); if (copy_from_user(input, wrqu->pointer, wrqu->length)) return -EFAULT; + input[wrqu->length] = '\0'; strcpy(extra, input); wrqu->length = mp_query_psd(padapter, extra); @@ -1249,7 +1228,7 @@ int rtw_mp_phypara(struct net_device *dev, ret = sscanf(input, "xcap=%d", &valxcap); - pHalData->CrystalCap = (u8)valxcap; + pHalData->crystal_cap = (u8)valxcap; hal_set_crystal_cap(padapter , valxcap); sprintf(extra, "Set xcap=%d", valxcap); @@ -1267,6 +1246,7 @@ int rtw_mp_SetRFPath(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); char input[wrqu->length]; int bMain = 1, bTurnoff = 1; + u8 ret = _TRUE; RTW_INFO("%s:iwpriv in=%s\n", __func__, input); @@ -1277,6 +1257,14 @@ int rtw_mp_SetRFPath(struct net_device *dev, bTurnoff = strncmp(input, "0", 3); /* strncmp TRUE is 0*/ _rtw_memset(extra, 0, wrqu->length); +#ifdef CONFIG_ANTENNA_DIVERSITY + if (bMain == 0) + ret = rtw_mp_set_antdiv(padapter, _TRUE); + else + ret = rtw_mp_set_antdiv(padapter, _FALSE); + if (ret == _FALSE) + RTW_INFO("%s:ANTENNA_DIVERSITY FAIL\n", __func__); +#endif if (bMain == 0) { MP_PHY_SetRFPathSwitch(padapter, _TRUE); @@ -1287,6 +1275,10 @@ int rtw_mp_SetRFPath(struct net_device *dev, MP_PHY_SetRFPathSwitch(padapter, _FALSE); RTW_INFO("%s:PHY_SetRFPathSwitch=FALSE\n", __func__); sprintf(extra, "mp_setrfpath Aux\n"); + } else { + bMain = MP_PHY_QueryRFPathSwitch(padapter); + RTW_INFO("%s:PHY_SetRFPathSwitch = %s\n", __func__, (bMain ? "Main":"Aux")); + sprintf(extra, "mp_setrfpath %s\n" , (bMain ? "Main":"Aux")); } wrqu->length = strlen(extra); @@ -1395,7 +1387,7 @@ int rtw_mp_mon(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); struct mp_priv *pmp_priv = &padapter->mppriv; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; NDIS_802_11_NETWORK_INFRASTRUCTURE networkType; int bstart = 1, bstop = 1; @@ -1403,6 +1395,7 @@ int rtw_mp_mon(struct net_device *dev, if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) return -EFAULT; + *(extra + wrqu->data.length) = '\0'; rtw_pm_set_ips(padapter, IPS_NONE); LeaveAllPowerSaveMode(padapter); @@ -1428,9 +1421,9 @@ int rtw_mp_mon(struct net_device *dev, pHalFunc->hal_deinit(padapter); padapter->registrypriv.mp_mode = 0; pHalFunc->hal_init(padapter); - /*rtw_disassoc_cmd(padapter, 0, _TRUE);*/ + /*rtw_disassoc_cmd(padapter, 0, 0);*/ if (check_fwstate(pmlmepriv, _FW_LINKED) == _TRUE) { - rtw_disassoc_cmd(padapter, 500, _TRUE); + rtw_disassoc_cmd(padapter, 500, 0); rtw_indicate_disconnect(padapter, 0, _FALSE); /*rtw_free_assoc_resources(padapter, 1);*/ } @@ -1446,7 +1439,8 @@ int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) { HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct mp_priv *pmp_priv = &padapter->mppriv; - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); + char *pextra = extra; switch (pmp_priv->mode) { @@ -1456,7 +1450,8 @@ int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) pmp_priv->mode = MP_ON; sprintf(extra, "Stop continuous Tx"); } else if (pmp_priv->tx.stop == 1) { - sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500 count=%u\n", extra, pmp_priv->tx.count); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "\nStart continuous DA=ffffffffffff len=1500 count=%u\n", pmp_priv->tx.count); pmp_priv->tx.stop = 0; SetPacketTx(padapter); } else @@ -1464,26 +1459,26 @@ int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) return 0; case MP_SINGLE_TONE_TX: if (bStartTest != 0) - sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); + strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); SetSingleToneTx(padapter, (u8)bStartTest); break; case MP_CONTINUOUS_TX: if (bStartTest != 0) - sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); + strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); SetContinuousTx(padapter, (u8)bStartTest); break; case MP_CARRIER_SUPPRISSION_TX: if (bStartTest != 0) { if (HwRateToMPTRate(pmp_priv->rateidx) <= MPT_RATE_11M) - sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); + strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); else - sprintf(extra, "%s\nSpecify carrier suppression but not CCK rate", extra); + strcat(extra, "\nSpecify carrier suppression but not CCK rate"); } SetCarrierSuppressionTx(padapter, (u8)bStartTest); break; case MP_SINGLE_CARRIER_TX: if (bStartTest != 0) - sprintf(extra, "%s\nStart continuous DA=ffffffffffff len=1500\n infinite=yes.", extra); + strcat(extra, "\nStart continuous DA=ffffffffffff len=1500\n infinite=yes."); SetSingleCarrierTx(padapter, (u8)bStartTest); break; @@ -1512,9 +1507,9 @@ int rtw_mp_pretx_proc(PADAPTER padapter, u8 bStartTest, char *extra) if (IS_HARDWARE_TYPE_8812AU(padapter)) { /* <20130425, Kordan> Turn off OFDM Rx to prevent from CCA causing Tx hang.*/ if (pmp_priv->mode == MP_PACKET_TX) - PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 1); + phy_set_bb_reg(padapter, rCCAonSec_Jaguar, BIT3, 1); else - PHY_SetBBReg(padapter, rCCAonSec_Jaguar, BIT3, 0); + phy_set_bb_reg(padapter, rCCAonSec_Jaguar, BIT3, 0); } #endif @@ -1529,9 +1524,9 @@ int rtw_mp_tx(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct mp_priv *pmp_priv = &padapter->mppriv; - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); struct registry_priv *pregistrypriv = &padapter->registrypriv; - + char *pextra = extra; u32 bandwidth = 0, sg = 0, channel = 6, txpower = 40, rate = 108, ant = 0, txmode = 1, count = 0; u8 i = 0, j = 0, bStartTest = 1, status = 0, Idx = 0, tmpU1B = 0; u16 antenna = 0; @@ -1561,13 +1556,13 @@ int rtw_mp_tx(struct net_device *dev, return 0; } else if (strncmp(extra, "setting", 7) == 0) { _rtw_memset(extra, 0, wrqu->data.length); - sprintf(extra, "Current Setting :\n Channel:%d", pmp_priv->channel); - sprintf(extra, "%s\n Bandwidth:%d", extra, pmp_priv->bandwidth); - sprintf(extra, "%s\n Rate index:%d", extra, pmp_priv->rateidx); - sprintf(extra, "%s\n TxPower index:%d", extra, pmp_priv->txpoweridx); - sprintf(extra, "%s\n Antenna TxPath:%d", extra, pmp_priv->antenna_tx); - sprintf(extra, "%s\n Antenna RxPath:%d", extra, pmp_priv->antenna_rx); - sprintf(extra, "%s\n MP Mode:%d", extra, pmp_priv->mode); + pextra += sprintf(pextra, "Current Setting :\n Channel:%d", pmp_priv->channel); + pextra += sprintf(pextra, "\n Bandwidth:%d", pmp_priv->bandwidth); + pextra += sprintf(pextra, "\n Rate index:%d", pmp_priv->rateidx); + pextra += sprintf(pextra, "\n TxPower index:%d", pmp_priv->txpoweridx); + pextra += sprintf(pextra, "\n Antenna TxPath:%d", pmp_priv->antenna_tx); + pextra += sprintf(pextra, "\n Antenna RxPath:%d", pmp_priv->antenna_rx); + pextra += sprintf(pextra, "\n MP Mode:%d", pmp_priv->mode); wrqu->data.length = strlen(extra); return 0; #ifdef CONFIG_MP_VHT_HW_TX_MODE @@ -1705,45 +1700,48 @@ int rtw_mp_tx(struct net_device *dev, if (sscanf(extra, "ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d", &channel, &bandwidth, &rate, &txpower, &ant, &txmode) < 6) { RTW_INFO("Invalid format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); _rtw_memset(extra, 0, wrqu->data.length); - sprintf(extra, "\n Please input correct format as bleow:\n"); - sprintf(extra, "%s\t ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d\n", extra, channel, bandwidth, rate, txpower, ant, txmode); - sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); - sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); - sprintf(extra, "%s\n [ rate : CCK: 1 2 5.5 11M X 2 = < 2 4 11 22 >]", extra); - sprintf(extra, "%s\n [ OFDM: 6 9 12 18 24 36 48 54M X 2 = < 12 18 24 36 48 72 96 108>", extra); - sprintf(extra, "%s\n [ HT 1S2SS MCS0 ~ MCS15 : < [MCS0]=128 ~ [MCS7]=135 ~ [MCS15]=143 >", extra); - sprintf(extra, "%s\n [ HT 3SS MCS16 ~ MCS32 : < [MCS16]=144 ~ [MCS23]=151 ~ [MCS32]=159 >", extra); - sprintf(extra, "%s\n [ VHT 1SS MCS0 ~ MCS9 : < [MCS0]=160 ~ [MCS9]=169 >", extra); - sprintf(extra, "%s\n [ txpower : 1~63 power index", extra); - sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); - sprintf(extra, "%s\n [ txmode : < 0 = CONTINUOUS_TX, 1 = PACKET_TX, 2 = SINGLE_TONE_TX, 3 = CARRIER_SUPPRISSION_TX, 4 = SINGLE_CARRIER_TX>\n", extra); + pextra += sprintf(pextra, "\n Please input correct format as bleow:\n"); + pextra += sprintf(pextra, "\t ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d\n", channel, bandwidth, rate, txpower, ant, txmode); + pextra += sprintf(pextra, "\n [ ch : BGN = <1~14> , A or AC = <36~165> ]"); + pextra += sprintf(pextra, "\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]"); + pextra += sprintf(pextra, "\n [ rate : CCK: 1 2 5.5 11M X 2 = < 2 4 11 22 >]"); + pextra += sprintf(pextra, "\n [ OFDM: 6 9 12 18 24 36 48 54M X 2 = < 12 18 24 36 48 72 96 108>"); + pextra += sprintf(pextra, "\n [ HT 1S2SS MCS0 ~ MCS15 : < [MCS0]=128 ~ [MCS7]=135 ~ [MCS15]=143 >"); + pextra += sprintf(pextra, "\n [ HT 3SS MCS16 ~ MCS32 : < [MCS16]=144 ~ [MCS23]=151 ~ [MCS32]=159 >"); + pextra += sprintf(pextra, "\n [ VHT 1SS MCS0 ~ MCS9 : < [MCS0]=160 ~ [MCS9]=169 >"); + pextra += sprintf(pextra, "\n [ txpower : 1~63 power index"); + pextra += sprintf(pextra, "\n [ ant : ,2T ex: AB=3 BC=6 CD=12"); + pextra += sprintf(pextra, "\n [ txmode : < 0 = CONTINUOUS_TX, 1 = PACKET_TX, 2 = SINGLE_TONE_TX, 3 = CARRIER_SUPPRISSION_TX, 4 = SINGLE_CARRIER_TX>\n"); wrqu->data.length = strlen(extra); return status; } else { + char *pextra = extra; RTW_INFO("Got format [ch=%d,bw=%d,rate=%d,pwr=%d,ant=%d,tx=%d]\n", channel, bandwidth, rate, txpower, ant, txmode); _rtw_memset(extra, 0, wrqu->data.length); sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); padapter->mppriv.channel = channel; SetChannel(padapter); - pHalData->CurrentChannel = channel; + pHalData->current_channel = channel; if (bandwidth == 1) bandwidth = CHANNEL_WIDTH_40; else if (bandwidth == 2) bandwidth = CHANNEL_WIDTH_80; - sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); + pextra = extra + strlen(pextra); + pextra += sprintf(pextra, "\nChange Current Bandwidth %d to Bandwidth %d", padapter->mppriv.bandwidth, bandwidth); padapter->mppriv.bandwidth = (u8)bandwidth; padapter->mppriv.preamble = sg; SetBandwidth(padapter); - pHalData->CurrentChannelBW = bandwidth; + pHalData->current_channel_bw = bandwidth; - sprintf(extra, "%s\nSet power level :%d", extra, txpower); + pextra += sprintf(pextra, "\nSet power level :%d", txpower); padapter->mppriv.txpoweridx = (u8)txpower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_A] = (u8)txpower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_B] = (u8)txpower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_C] = (u8)txpower; - pMptCtx->TxPwrLevel[ODM_RF_PATH_D] = (u8)txpower; + pMptCtx->TxPwrLevel[RF_PATH_A] = (u8)txpower; + pMptCtx->TxPwrLevel[RF_PATH_B] = (u8)txpower; + pMptCtx->TxPwrLevel[RF_PATH_C] = (u8)txpower; + pMptCtx->TxPwrLevel[RF_PATH_D] = (u8)txpower; + SetTxPower(padapter); RTW_INFO("%s: bw=%d sg=%d\n", __func__, bandwidth, sg); @@ -1761,13 +1759,13 @@ int rtw_mp_tx(struct net_device *dev, RTW_INFO("%s: rate index=%d\n", __func__, rate); if (rate >= MPT_RATE_LAST) return -EINVAL; - sprintf(extra, "%s\nSet data rate to %d index %d", extra, padapter->mppriv.rateidx, rate); + pextra += sprintf(pextra, "\nSet data rate to %d index %d", padapter->mppriv.rateidx, rate); padapter->mppriv.rateidx = rate; - pMptCtx->MptRateIndex = rate; + pMptCtx->mpt_rate_index = rate; SetDataRate(padapter); - sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); + pextra += sprintf(pextra, "\nSet Antenna Path :%d", ant); switch (ant) { case 1: antenna = ANTENNA_A; @@ -1815,7 +1813,7 @@ int rtw_mp_tx(struct net_device *dev, RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); padapter->mppriv.antenna_tx = antenna; padapter->mppriv.antenna_rx = antenna; - pHalData->AntennaTxPath = antenna; + pHalData->antenna_tx_path = antenna; SetAntenna(padapter); if (txmode == 0) @@ -1847,8 +1845,8 @@ int rtw_mp_rx(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct mp_priv *pmp_priv = &padapter->mppriv; - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); - + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); + char *pextra = extra; u32 bandwidth = 0, sg = 0, channel = 6, ant = 0; u16 antenna = 0; u8 bStartRx = 0; @@ -1875,34 +1873,36 @@ int rtw_mp_rx(struct net_device *dev, } else if (sscanf(extra, "ch=%d,bw=%d,ant=%d", &channel, &bandwidth, &ant) < 3) { RTW_INFO("Invalid format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); _rtw_memset(extra, 0, wrqu->data.length); - sprintf(extra, "\n Please input correct format as bleow:\n"); - sprintf(extra, "%s\t ch=%d,bw=%d,ant=%d\n", extra, channel, bandwidth, ant); - sprintf(extra, "%s\n [ ch : BGN = <1~14> , A or AC = <36~165> ]", extra); - sprintf(extra, "%s\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]", extra); - sprintf(extra, "%s\n [ ant : ,2T ex: AB=3 BC=6 CD=12", extra); + pextra += sprintf(pextra, "\n Please input correct format as bleow:\n"); + pextra += sprintf(pextra, "\t ch=%d,bw=%d,ant=%d\n", channel, bandwidth, ant); + pextra += sprintf(pextra, "\n [ ch : BGN = <1~14> , A or AC = <36~165> ]"); + pextra += sprintf(pextra, "\n [ bw : Bandwidth: 0 = 20M, 1 = 40M, 2 = 80M ]"); + pextra += sprintf(pextra, "\n [ ant : ,2T ex: AB=3 BC=6 CD=12"); wrqu->data.length = strlen(extra); return 0; } else { + char *pextra = extra; bStartRx = 1; RTW_INFO("Got format [ch=%d,bw=%d,ant=%d]\n", channel, bandwidth, ant); _rtw_memset(extra, 0, wrqu->data.length); sprintf(extra, "Change Current channel %d to channel %d", padapter->mppriv.channel , channel); padapter->mppriv.channel = channel; SetChannel(padapter); - pHalData->CurrentChannel = channel; + pHalData->current_channel = channel; if (bandwidth == 1) bandwidth = CHANNEL_WIDTH_40; else if (bandwidth == 2) bandwidth = CHANNEL_WIDTH_80; - sprintf(extra, "%s\nChange Current Bandwidth %d to Bandwidth %d", extra, padapter->mppriv.bandwidth , bandwidth); + pextra = extra + strlen(extra); + pextra += sprintf(pextra, "\nChange Current Bandwidth %d to Bandwidth %d", padapter->mppriv.bandwidth, bandwidth); padapter->mppriv.bandwidth = (u8)bandwidth; padapter->mppriv.preamble = sg; SetBandwidth(padapter); - pHalData->CurrentChannelBW = bandwidth; + pHalData->current_channel_bw = bandwidth; - sprintf(extra, "%s\nSet Antenna Path :%d", extra, ant); + pextra += sprintf(pextra, "\nSet Antenna Path :%d", ant); switch (ant) { case 1: antenna = ANTENNA_A; @@ -1950,10 +1950,10 @@ int rtw_mp_rx(struct net_device *dev, RTW_INFO("%s: antenna=0x%x\n", __func__, antenna); padapter->mppriv.antenna_tx = antenna; padapter->mppriv.antenna_rx = antenna; - pHalData->AntennaTxPath = antenna; + pHalData->antenna_tx_path = antenna; SetAntenna(padapter); - sprintf(extra, "%s\nstart Rx", extra); + strcat(extra, "\nstart Rx"); SetPacketRx(padapter, bStartRx, _FALSE); } wrqu->data.length = strlen(extra); @@ -1968,7 +1968,7 @@ int rtw_mp_hwtx(struct net_device *dev, PADAPTER padapter = rtw_netdev_priv(dev); HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); struct mp_priv *pmp_priv = &padapter->mppriv; - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); #if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8821B) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) u8 input[wrqu->data.length]; @@ -1988,6 +1988,60 @@ int rtw_mp_hwtx(struct net_device *dev, } +int rtw_mp_pwrlmt(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + PADAPTER padapter = rtw_netdev_priv(dev); + struct registry_priv *registry_par = &padapter->registrypriv; + u8 pwrlimtstat = 0; + + if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) + return -EFAULT; +#ifdef CONFIG_TXPWR_LIMIT + pwrlimtstat = registry_par->RegEnableTxPowerLimit; + if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { + padapter->registrypriv.RegEnableTxPowerLimit = 0; + sprintf(extra, "Turn off Power Limit\n"); + + } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { + padapter->registrypriv.RegEnableTxPowerLimit = 1; + sprintf(extra, "Turn on Power Limit\n"); + + } else +#endif + sprintf(extra, "Get Power Limit Status:%s\n", (pwrlimtstat == 1) ? "ON" : "OFF"); + + + wrqu->data.length = strlen(extra); + return 0; +} + +int rtw_mp_pwrbyrate(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + PADAPTER padapter = rtw_netdev_priv(dev); + + if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) + return -EFAULT; + + if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { + padapter->registrypriv.RegEnableTxPowerByRate = 0; + sprintf(extra, "Turn off Tx Power by Rate\n"); + + } else if (strncmp(extra, "on", 2) == 0 && strlen(extra) < 3) { + padapter->registrypriv.RegEnableTxPowerByRate = 1; + sprintf(extra, "Turn On Tx Power by Rate\n"); + + } else { + sprintf(extra, "Get Power by Rate Status:%s\n", (padapter->registrypriv.RegEnableTxPowerByRate == 1) ? "ON" : "OFF"); + } + + wrqu->data.length = strlen(extra); + return 0; +} + int rtw_efuse_mask_file(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) @@ -2001,6 +2055,7 @@ int rtw_efuse_mask_file(struct net_device *dev, if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) return -EFAULT; + *(extra + wrqu->data.length) = '\0'; if (strncmp(extra, "off", 3) == 0 && strlen(extra) < 4) { padapter->registrypriv.boffefusemask = 1; sprintf(extra, "Turn off Efuse Mask\n"); @@ -2013,6 +2068,46 @@ int rtw_efuse_mask_file(struct net_device *dev, wrqu->data.length = strlen(extra); return 0; } + if (strncmp(extra, "data,", 5) == 0) { + u8 *pch, *pdata; + char *ptmp, tmp; + u8 count = 0; + u8 i = 0; + u32 datalen = 0; + + ptmp = extra; + pch = strsep(&ptmp, ","); + + if ((pch == NULL) || (strlen(pch) == 0)) { + RTW_INFO("%s: parameter error(no cmd)!\n", __func__); + return -EFAULT; + } + + do { + pch = strsep(&ptmp, ":"); + if ((pch == NULL) || (strlen(pch) == 0)) + break; + if (strlen(pch) != 2 + || IsHexDigit(*pch) == _FALSE + || IsHexDigit(*(pch + 1)) == _FALSE + || sscanf(pch, "%hhx", &tmp) != 1 + ) { + RTW_INFO("%s: invalid 8-bit hex! input format: data,01:23:45:67:89:ab:cd:ef...\n", __func__); + return -EFAULT; + } + maskfileBuffer[count++] = tmp; + + } while (count < 64); + + for (i = 0; i < count; i++) + sprintf(extra, "%s:%02x", extra, maskfileBuffer[i]); + + padapter->registrypriv.bFileMaskEfuse = _TRUE; + + sprintf(extra, "%s\nLoad Efuse Mask data %d hex ok\n", extra, count); + wrqu->data.length = strlen(extra); + return 0; + } rtw_efuse_mask_file_path = extra; if (rtw_is_file_readable(rtw_efuse_mask_file_path) == _TRUE) { @@ -2068,17 +2163,54 @@ int rtw_efuse_file_map(struct net_device *dev, return 0; } +int rtw_bt_efuse_file_map(struct net_device *dev, + struct iw_request_info *info, + union iwreq_data *wrqu, char *extra) +{ + char *rtw_efuse_file_map_path; + u8 Status; + PEFUSE_HAL pEfuseHal; + PADAPTER padapter = rtw_netdev_priv(dev); + HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); + struct mp_priv *pmp_priv = &padapter->mppriv; + + pEfuseHal = &pHalData->EfuseHal; + if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) + return -EFAULT; + + rtw_efuse_file_map_path = extra; + + _rtw_memset(pEfuseHal->fakeBTEfuseModifiedMap, 0xFF, EFUSE_BT_MAX_MAP_LEN); + + if (rtw_is_file_readable(rtw_efuse_file_map_path) == _TRUE) { + RTW_INFO("%s do rtw_efuse_mask_file_read = %s!\n", __func__, rtw_efuse_file_map_path); + Status = rtw_efuse_file_read(padapter, rtw_efuse_file_map_path, pEfuseHal->fakeBTEfuseModifiedMap, sizeof(pEfuseHal->fakeBTEfuseModifiedMap)); + if (Status == _TRUE) { + pmp_priv->bloadBTefusemap = _TRUE; + sprintf(extra, "BT efuse file file_read OK\n"); + } else { + pmp_priv->bloadBTefusemap = _FALSE; + sprintf(extra, "BT efuse file file_read FAIL\n"); + } + } else { + sprintf(extra, "BT efuse file readable FAIL\n"); + RTW_INFO("%s rtw_is_file_readable fail!\n", __func__); + } + wrqu->data.length = strlen(extra); + return 0; +} + #if defined(CONFIG_RTL8723B) int rtw_mp_SetBT(struct net_device *dev, struct iw_request_info *info, union iwreq_data *wrqu, char *extra) { PADAPTER padapter = rtw_netdev_priv(dev); - struct hal_ops *pHalFunc = &padapter->HalFunc; + struct hal_ops *pHalFunc = &padapter->hal_func; HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); BT_REQ_CMD BtReq; - PMPT_CONTEXT pMptCtx = &(padapter->mppriv.MptCtx); + PMPT_CONTEXT pMptCtx = &(padapter->mppriv.mpt_ctx); PBT_RSP_CMD pBtRsp = (PBT_RSP_CMD)&pMptCtx->mptOutBuf[0]; char input[128]; char *pch, *ptmp, *token, *tmp[2] = {0x00, 0x00}; @@ -2093,6 +2225,9 @@ int rtw_mp_SetBT(struct net_device *dev, if (copy_from_user(extra, wrqu->data.pointer, wrqu->data.length)) return -EFAULT; + + *(extra + wrqu->data.length) = '\0'; + if (strlen(extra) < 1) return -EFAULT; @@ -2109,7 +2244,7 @@ int rtw_mp_SetBT(struct net_device *dev, if (strncmp(extra, "dlbt", 4) == 0) { pHalData->LastHMEBoxNum = 0; - padapter->bBTFWReady = _FALSE; + pHalData->bBTFWReady = _FALSE; rtw_write8(padapter, 0xa3, 0x05); BTStatus = rtw_read8(padapter, 0xa0); RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); @@ -2141,7 +2276,7 @@ int rtw_mp_SetBT(struct net_device *dev, pBTFirmware = (PRT_MP_FIRMWARE)rtw_zmalloc(sizeof(RT_MP_FIRMWARE)); if (pBTFirmware == NULL) goto exit; - padapter->bBTFWReady = _FALSE; + pHalData->bBTFWReady = _FALSE; FirmwareDownloadBT(padapter, pBTFirmware); if (pBTFirmware) rtw_mfree((u8 *)pBTFirmware, sizeof(RT_MP_FIRMWARE)); @@ -2170,7 +2305,7 @@ int rtw_mp_SetBT(struct net_device *dev, } if (strncmp(extra, "dlfw", 4) == 0) { pHalData->LastHMEBoxNum = 0; - padapter->bBTFWReady = _FALSE; + pHalData->bBTFWReady = _FALSE; rtw_write8(padapter, 0xa3, 0x05); BTStatus = rtw_read8(padapter, 0xa0); RTW_INFO("%s: btwmap before read 0xa0 BT Status =0x%x\n", __func__, BTStatus); @@ -2278,13 +2413,13 @@ int rtw_mp_SetBT(struct net_device *dev, } if (strncmp(extra, "h2c", 3) == 0) { RTW_INFO("SetBT h2c !\n"); - padapter->bBTFWReady = _TRUE; + pHalData->bBTFWReady = _TRUE; rtw_hal_fill_h2c_cmd(padapter, 0x63, 1, u1H2CBtMpOperParm); goto exit; } if (strncmp(extra, "2ant", 4) == 0) { RTW_INFO("Set BT 2ant use!\n"); - PHY_SetMacReg(padapter, 0x67, BIT5, 0x1); + phy_set_mac_reg(padapter, 0x67, BIT5, 0x1); rtw_write32(padapter, 0x948, 0000); goto exit; @@ -2379,7 +2514,7 @@ int rtw_mp_SetBT(struct net_device *dev, todo: _rtw_memset(extra, '\0', wrqu->data.length); - if (padapter->bBTFWReady == _FALSE) { + if (pHalData->bBTFWReady == _FALSE) { sprintf(extra, "BTFWReady = FALSE.\n"); goto exit; } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/mlme_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/mlme_linux.c index eef8f5f241f0..67255452de65 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/mlme_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/mlme_linux.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _MLME_OSDEP_C_ @@ -56,82 +51,6 @@ void Linkdown_workitem_callback(struct work_struct *work) } #endif - -/* -void sitesurvey_ctrl_handler(void *FunctionContext) -{ - _adapter *adapter = (_adapter *)FunctionContext; - - _sitesurvey_ctrl_handler(adapter); - - _set_timer(&adapter->mlmepriv.sitesurveyctrl.sitesurvey_ctrl_timer, 3000); -} -*/ - -void rtw_join_timeout_handler(void *FunctionContext) -{ - _adapter *adapter = (_adapter *)FunctionContext; - _rtw_join_timeout_handler(adapter); -} - - -void _rtw_scan_timeout_handler(void *FunctionContext) -{ - _adapter *adapter = (_adapter *)FunctionContext; - rtw_scan_timeout_handler(adapter); -} - - -void _dynamic_check_timer_handlder(void *FunctionContext) -{ - struct dvobj_priv *pdvobj = (struct dvobj_priv *)FunctionContext; - _adapter *adapter = dvobj_get_primary_adapter(pdvobj); - -#if (MP_DRIVER == 1) - if (adapter->registrypriv.mp_mode == 1 && adapter->mppriv.mp_dm == 0) { /* for MP ODM dynamic Tx power tracking */ - /* RTW_INFO("_dynamic_check_timer_handlder mp_dm =0 return\n"); */ - _set_timer(&pdvobj->dynamic_chk_timer, 2000); - return; - } -#endif - - rtw_dynamic_check_timer_handlder(adapter); - - _set_timer(&pdvobj->dynamic_chk_timer, 2000); -} - -#ifdef CONFIG_SET_SCAN_DENY_TIMER -void _rtw_set_scan_deny_timer_hdl(void *FunctionContext) -{ - _adapter *adapter = (_adapter *)FunctionContext; - rtw_set_scan_deny_timer_hdl(adapter); -} -#endif - - -void rtw_init_mlme_timer(_adapter *padapter) -{ - struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - - _init_timer(&(pmlmepriv->assoc_timer), padapter->pnetdev, rtw_join_timeout_handler, padapter); - /* _init_timer(&(pmlmepriv->sitesurveyctrl.sitesurvey_ctrl_timer), padapter->pnetdev, sitesurvey_ctrl_handler, padapter); */ - _init_timer(&(pmlmepriv->scan_to_timer), padapter->pnetdev, _rtw_scan_timeout_handler, padapter); - -#ifdef CONFIG_DFS_MASTER - _init_timer(&(pmlmepriv->dfs_master_timer), padapter->pnetdev, rtw_dfs_master_timer_hdl, padapter); -#endif - -#ifdef CONFIG_SET_SCAN_DENY_TIMER - _init_timer(&(pmlmepriv->set_scan_deny_timer), padapter->pnetdev, _rtw_set_scan_deny_timer_hdl, padapter); -#endif - -#ifdef RTK_DMP_PLATFORM - _init_workitem(&(pmlmepriv->Linkup_workitem), Linkup_workitem_callback, padapter); - _init_workitem(&(pmlmepriv->Linkdown_workitem), Linkdown_workitem_callback, padapter); -#endif - -} - extern void rtw_indicate_wx_assoc_event(_adapter *padapter); extern void rtw_indicate_wx_disassoc_event(_adapter *padapter); @@ -148,7 +67,7 @@ void rtw_os_indicate_connect(_adapter *adapter) #endif /* CONFIG_IOCTL_CFG80211 */ rtw_indicate_wx_assoc_event(adapter); - netif_carrier_on(adapter->pnetdev); + rtw_netif_carrier_on(adapter->pnetdev); if (adapter->pid[2] != 0) rtw_signal_process(adapter->pid[2], SIGALRM); @@ -199,7 +118,6 @@ void rtw_reset_securitypriv(_adapter *adapter) pmlmeext->mgnt_80211w_IPN_rx = 0; #endif /* CONFIG_IEEE80211W */ _rtw_memset((unsigned char *)&adapter->securitypriv, 0, sizeof(struct security_priv)); - /* _init_timer(&(adapter->securitypriv.tkip_timer),adapter->pnetdev, rtw_use_tkipkey_handler, adapter); */ /* Added by Albert 2009/02/18 */ /* Restore the PMK information to securitypriv structure for the following connection. */ @@ -238,7 +156,7 @@ void rtw_os_indicate_disconnect(_adapter *adapter, u16 reason, u8 locally_gener /* RT_PMKID_LIST backupPMKIDList[NUM_PMKID_CACHE]; */ - netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */ + rtw_netif_carrier_off(adapter->pnetdev); /* Do it first for tx broadcast pkt after disconnection issue! */ #ifdef CONFIG_IOCTL_CFG80211 rtw_cfg80211_indicate_disconnect(adapter, reason, locally_generated); @@ -300,94 +218,6 @@ void rtw_report_sec_ie(_adapter *adapter, u8 authmode, u8 *sec_ie) } -void _survey_timer_hdl(void *FunctionContext) -{ - _adapter *padapter = (_adapter *)FunctionContext; - - survey_timer_hdl(padapter); -} - -void _link_timer_hdl(void *FunctionContext) -{ - _adapter *padapter = (_adapter *)FunctionContext; - link_timer_hdl(padapter); -} - -#ifdef CONFIG_RTW_80211R -void _ft_link_timer_hdl(void *FunctionContext) -{ - _adapter *padapter = (_adapter *)FunctionContext; - - ft_link_timer_hdl(padapter); -} - -void _ft_roam_timer_hdl(void *FunctionContext) -{ - _adapter *padapter = (_adapter *)FunctionContext; - - ft_roam_timer_hdl(padapter); -} -#endif - -void _addba_timer_hdl(void *FunctionContext) -{ - struct sta_info *psta = (struct sta_info *)FunctionContext; - addba_timer_hdl(psta); -} - -#ifdef CONFIG_IEEE80211W - -void _sa_query_timer_hdl(void *FunctionContext) -{ - struct sta_info *psta = (struct sta_info *)FunctionContext; - - sa_query_timer_hdl(psta); -} - -void init_dot11w_expire_timer(_adapter *padapter, struct sta_info *psta) -{ - _init_timer(&psta->dot11w_expire_timer, padapter->pnetdev, _sa_query_timer_hdl, psta); -} - -#endif /* CONFIG_IEEE80211W */ - -void init_addba_retry_timer(_adapter *padapter, struct sta_info *psta) -{ - - _init_timer(&psta->addba_retry_timer, padapter->pnetdev, _addba_timer_hdl, psta); -} - -/* -void _reauth_timer_hdl(void *FunctionContext) -{ - _adapter *padapter = (_adapter *)FunctionContext; - reauth_timer_hdl(padapter); -} - -void _reassoc_timer_hdl(void *FunctionContext) -{ - _adapter *padapter = (_adapter *)FunctionContext; - reassoc_timer_hdl(padapter); -} -*/ - -void init_mlme_ext_timer(_adapter *padapter) -{ - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - - _init_timer(&pmlmeext->survey_timer, padapter->pnetdev, _survey_timer_hdl, padapter); - _init_timer(&pmlmeext->link_timer, padapter->pnetdev, _link_timer_hdl, padapter); -#ifdef CONFIG_RTW_80211R - _init_timer(&pmlmeext->ft_link_timer, padapter->pnetdev, _ft_link_timer_hdl, padapter); - _init_timer(&pmlmeext->ft_roam_timer, padapter->pnetdev, _ft_roam_timer_hdl, padapter); -#endif - - /* _init_timer(&pmlmeext->ADDBA_timer, padapter->pnetdev, _addba_timer_hdl, padapter); */ - - /* _init_timer(&pmlmeext->reauth_timer, padapter->pnetdev, _reauth_timer_hdl, padapter); */ - /* _init_timer(&pmlmeext->reassoc_timer, padapter->pnetdev, _reassoc_timer_hdl, padapter); */ -} - #ifdef CONFIG_AP_MODE void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta) @@ -398,16 +228,16 @@ void rtw_indicate_sta_assoc_event(_adapter *padapter, struct sta_info *psta) if (psta == NULL) return; - if (psta->aid > NUM_STA) + if (psta->cmn.aid > NUM_STA) return; - if (pstapriv->sta_aid[psta->aid - 1] != psta) + if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta) return; wrqu.addr.sa_family = ARPHRD_ETHER; - _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN); RTW_INFO("+rtw_indicate_sta_assoc_event\n"); @@ -425,16 +255,16 @@ void rtw_indicate_sta_disassoc_event(_adapter *padapter, struct sta_info *psta) if (psta == NULL) return; - if (psta->aid > NUM_STA) + if (psta->cmn.aid > NUM_STA) return; - if (pstapriv->sta_aid[psta->aid - 1] != psta) + if (pstapriv->sta_aid[psta->cmn.aid - 1] != psta) return; wrqu.addr.sa_family = ARPHRD_ETHER; - _rtw_memcpy(wrqu.addr.sa_data, psta->hwaddr, ETH_ALEN); + _rtw_memcpy(wrqu.addr.sa_data, psta->cmn.mac_addr, ETH_ALEN); RTW_INFO("+rtw_indicate_sta_disassoc_event\n"); @@ -468,7 +298,7 @@ static int mgnt_netdev_open(struct net_device *pnetdev) rtw_netif_wake_queue(pnetdev); - netif_carrier_on(pnetdev); + rtw_netif_carrier_on(pnetdev); /* rtw_write16(phostapdpriv->padapter, 0x0116, 0x0100); */ /* only excluding beacon */ @@ -482,7 +312,7 @@ static int mgnt_netdev_close(struct net_device *pnetdev) usb_kill_anchored_urbs(&phostapdpriv->anchored); - netif_carrier_off(pnetdev); + rtw_netif_carrier_off(pnetdev); rtw_netif_stop_queue(pnetdev); @@ -575,7 +405,7 @@ int hostapd_mode_init(_adapter *padapter) _rtw_memcpy(pnetdev->dev_addr, mac, ETH_ALEN); - netif_carrier_off(pnetdev); + rtw_netif_carrier_off(pnetdev); /* Tell the network stack we exist */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/os_intfs.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/os_intfs.c index 46f2dec0029b..ea63df125c63 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/os_intfs.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/os_intfs.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _OS_INTFS_C_ #include @@ -43,11 +38,7 @@ int rtw_lbkmode = 0;/* RTL8712_AIR_TRX; */ int rtw_network_mode = Ndis802_11IBSS;/* Ndis802_11Infrastructure; */ /* infra, ad-hoc, auto */ /* NDIS_802_11_SSID ssid; */ int rtw_channel = 1;/* ad-hoc support requirement */ -#ifdef CONFIG_80211N_HT -int rtw_wireless_mode = WIRELESS_11BG_24N; -#else -int rtw_wireless_mode = WIRELESS_11BG; -#endif +int rtw_wireless_mode = WIRELESS_MODE_MAX; int rtw_vrtl_carrier_sense = AUTO_VCS; int rtw_vcs_type = RTS_CTS; int rtw_rts_thresh = 2347; @@ -63,16 +54,49 @@ int rtw_soft_ap = 0; int rtw_ips_mode = IPS_LEVEL_2; #else int rtw_ips_mode = IPS_NORMAL; - #endif -#else + #endif /*CONFIG_IPS_LEVEL_2*/ + + #ifdef CONFIG_USB_HCI + int rtw_lps_level = LPS_NORMAL; /*USB default LPS level*/ + #else /*SDIO,PCIE*/ + #if defined(CONFIG_LPS_PG) + /*int rtw_lps_level = LPS_PG;*//*FW not support yet*/ + int rtw_lps_level = LPS_LCLK; + #elif defined(CONFIG_LPS_LCLK) + int rtw_lps_level = LPS_LCLK; + #else + int rtw_lps_level = LPS_NORMAL; + #endif + #endif/*CONFIG_USB_HCI*/ +#else /* !CONFIG_POWER_SAVING */ int rtw_power_mgnt = PS_MODE_ACTIVE; int rtw_ips_mode = IPS_NONE; -#endif + int rtw_lps_level = LPS_NORMAL; +#endif /* CONFIG_POWER_SAVING */ + + module_param(rtw_ips_mode, int, 0644); MODULE_PARM_DESC(rtw_ips_mode, "The default IPS mode"); +module_param(rtw_lps_level, int, 0644); +MODULE_PARM_DESC(rtw_lps_level, "The default LPS level"); + +/* LPS: + * rtw_smart_ps = 0 => TX: pwr bit = 1, RX: PS_Poll + * rtw_smart_ps = 1 => TX: pwr bit = 0, RX: PS_Poll + * rtw_smart_ps = 2 => TX: pwr bit = 0, RX: NullData with pwr bit = 0 +*/ int rtw_smart_ps = 2; +#ifdef CONFIG_WMMPS_STA +/* WMMPS: + * rtw_smart_ps = 0 => Only for fw test + * rtw_smart_ps = 1 => Refer to Beacon's TIM Bitmap + * rtw_smart_ps = 2 => Don't refer to Beacon's TIM Bitmap +*/ +int rtw_wmm_smart_ps = 2; +#endif /* CONFIG_WMMPS_STA */ + int rtw_check_fw_ps = 1; #ifdef CONFIG_TX_EARLY_MODE @@ -82,6 +106,9 @@ int rtw_early_mode = 1; int rtw_usb_rxagg_mode = 2;/* RX_AGG_DMA=1, RX_AGG_USB=2 */ module_param(rtw_usb_rxagg_mode, int, 0644); +int rtw_dynamic_agg_enable = 1; +module_param(rtw_dynamic_agg_enable, int, 0644); + /* set log level when inserting driver module, default log level is _DRV_INFO_ = 4, * please refer to "How_to_set_driver_debug_log_level.doc" to set the available level. */ @@ -114,14 +141,20 @@ int rtw_software_decrypt = 0; int rtw_acm_method = 0;/* 0:By SW 1:By HW. */ int rtw_wmm_enable = 1;/* default is set to enable the wmm. */ -int rtw_uapsd_enable = 0; + +#ifdef CONFIG_WMMPS_STA +/* uapsd (unscheduled automatic power-save delivery) = a kind of wmmps */ +/* 0: NO_LIMIT, 1: TWO_MSDU, 2: FOUR_MSDU, 3: SIX_MSDU */ int rtw_uapsd_max_sp = NO_LIMIT; -int rtw_uapsd_acbk_en = 0; -int rtw_uapsd_acbe_en = 0; -int rtw_uapsd_acvi_en = 0; -int rtw_uapsd_acvo_en = 0; -#if defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B) || defined(CONFIG_RTL8821C) +/* BIT0: AC_VO UAPSD, BIT1: AC_VI UAPSD, BIT2: AC_BK UAPSD, BIT3: AC_BE UAPSD */ +int rtw_uapsd_ac_enable = 0x0; +#endif /* CONFIG_WMMPS_STA */ + +#if defined(CONFIG_RTL8814A) int rtw_pwrtrim_enable = 2; /* disable kfree , rename to power trim disable */ +#elif defined(CONFIG_RTL8821C) || defined(CONFIG_RTL8822B) + /*PHYDM API, must enable by default*/ + int rtw_pwrtrim_enable = 1; #else int rtw_pwrtrim_enable = 0; /* Default Enalbe power trim by efuse config */ #endif @@ -135,10 +168,45 @@ int rtw_ht_enable = 1; /* 0: 20 MHz, 1: 40 MHz, 2: 80 MHz, 3: 160MHz, 4: 80+80MHz * 2.4G use bit 0 ~ 3, 5G use bit 4 ~ 7 * 0x21 means enable 2.4G 40MHz & 5G 80MHz */ +#ifdef CONFIG_RTW_CUSTOMIZE_BWMODE +int rtw_bw_mode = CONFIG_RTW_CUSTOMIZE_BWMODE; +#else int rtw_bw_mode = 0x21; +#endif int rtw_ampdu_enable = 1;/* for enable tx_ampdu , */ /* 0: disable, 0x1:enable */ int rtw_rx_stbc = 1;/* 0: disable, bit(0):enable 2.4g, bit(1):enable 5g, default is set to enable 2.4GHZ for IOT issue with bufflao's AP at 5GHZ */ -int rtw_ampdu_amsdu = 0;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ +#if (defined(CONFIG_RTL8814A) || defined(CONFIG_RTL8822B)) && defined(CONFIG_PCI_HCI) +int rtw_rx_ampdu_amsdu = 2;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ +#else +int rtw_rx_ampdu_amsdu;/* 0: disabled, 1:enabled, 2:auto . There is an IOT issu with DLINK DIR-629 when the flag turn on */ +#endif +/* +* 2: Follow the AMSDU filed in ADDBA Resp. (Deault) +* 0: Force the AMSDU filed in ADDBA Resp. to be disabled. +* 1: Force the AMSDU filed in ADDBA Resp. to be enabled. +*/ +int rtw_tx_ampdu_amsdu = 2; + +static uint rtw_rx_ampdu_sz_limit_1ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_1SS; +static uint rtw_rx_ampdu_sz_limit_1ss_num = 0; +module_param_array(rtw_rx_ampdu_sz_limit_1ss, uint, &rtw_rx_ampdu_sz_limit_1ss_num, 0644); +MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_1ss, "RX AMPDU size limit for 1SS link of each BW, 0xFF: no limitation"); + +static uint rtw_rx_ampdu_sz_limit_2ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_2SS; +static uint rtw_rx_ampdu_sz_limit_2ss_num = 0; +module_param_array(rtw_rx_ampdu_sz_limit_2ss, uint, &rtw_rx_ampdu_sz_limit_2ss_num, 0644); +MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_2ss, "RX AMPDU size limit for 2SS link of each BW, 0xFF: no limitation"); + +static uint rtw_rx_ampdu_sz_limit_3ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_3SS; +static uint rtw_rx_ampdu_sz_limit_3ss_num = 0; +module_param_array(rtw_rx_ampdu_sz_limit_3ss, uint, &rtw_rx_ampdu_sz_limit_3ss_num, 0644); +MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_3ss, "RX AMPDU size limit for 3SS link of each BW, 0xFF: no limitation"); + +static uint rtw_rx_ampdu_sz_limit_4ss[4] = CONFIG_RTW_RX_AMPDU_SZ_LIMIT_4SS; +static uint rtw_rx_ampdu_sz_limit_4ss_num = 0; +module_param_array(rtw_rx_ampdu_sz_limit_4ss, uint, &rtw_rx_ampdu_sz_limit_4ss_num, 0644); +MODULE_PARM_DESC(rtw_rx_ampdu_sz_limit_4ss, "RX AMPDU size limit for 4SS link of each BW, 0xFF: no limitation"); + /* Short GI support Bit Map * BIT0 - 20MHz, 0: non-support, 1: support * BIT1 - 40MHz, 0: non-support, 1: support @@ -165,14 +233,19 @@ int rtw_bfee_rf_number = 0; /*BeamformeeCapRfNum Rf path number, 0 for auto, ot #ifdef CONFIG_80211AC_VHT int rtw_vht_enable = 1; /* 0:disable, 1:enable, 2:force auto enable */ +module_param(rtw_vht_enable, int, 0644); + int rtw_ampdu_factor = 7; -int rtw_vht_rate_sel = 0; + +uint rtw_vht_rx_mcs_map = 0xaaaa; +module_param(rtw_vht_rx_mcs_map, uint, 0644); +MODULE_PARM_DESC(rtw_vht_rx_mcs_map, "VHT RX MCS map"); #endif /* CONFIG_80211AC_VHT */ int rtw_lowrate_two_xmit = 1;/* Use 2 path Tx to transmit MCS0~7 and legacy mode */ -/* int rf_config = RF_1T2R; */ /* 1T2R */ -int rtw_rf_config = RF_MAX_TYPE; /* auto */ +int rtw_rf_config = RF_TYPE_MAX; +module_param(rtw_rf_config, int, 0644); /* 0: not check in watch dog, 1: check in watch dog */ int rtw_check_hw_status = 0; @@ -184,12 +257,6 @@ int rtw_low_power = 0; int rtw_wifi_spec = 0; #endif -#ifdef CONFIG_DEFAULT_PATTERNS_EN - bool rtw_support_default_patterns = _TRUE; -#else - bool rtw_support_default_patterns = _FALSE; -#endif - int rtw_special_rf_path = 0; /* 0: 2T2R ,1: only turn on path A 1T1R */ char rtw_country_unspecified[] = {0xFF, 0xFF, 0x00}; @@ -197,7 +264,7 @@ char *rtw_country_code = rtw_country_unspecified; module_param(rtw_country_code, charp, 0644); MODULE_PARM_DESC(rtw_country_code, "The default country code (in alpha2)"); -int rtw_channel_plan = RTW_CHPLAN_MAX; +int rtw_channel_plan = CONFIG_RTW_CHPLAN; module_param(rtw_channel_plan, int, 0644); MODULE_PARM_DESC(rtw_channel_plan, "The default chplan ID when rtw_alpha2 is not specified or valid"); @@ -236,6 +303,8 @@ int rtw_antdiv_type = 0 int rtw_drv_ant_band_switch = 1; /* 0:OFF , 1:ON, Driver control antenna band switch*/ +int rtw_single_ant_path; /*0:main ant , 1:aux ant , Fixed single antenna path, default main ant*/ + /* 0: doesn't switch, 1: switch from usb2.0 to usb 3.0 2: switch from usb3.0 to usb 2.0 */ int rtw_switch_usb_mode = 0; @@ -267,17 +336,13 @@ int rtw_mc2u_disable = 0; int rtw_80211d = 0; #endif -#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV -int rtw_force_ant = 2;/* 0 :normal, 1:Main ant, 2:Aux ant */ -int rtw_force_igi = 0; /* 0 :normal */ -module_param(rtw_force_ant, int, 0644); -module_param(rtw_force_igi, int, 0644); +#ifdef CONFIG_PCI_ASPM +/* CLK_REQ:BIT0 L0s:BIT1 ASPM_L1:BIT2 L1Off:BIT3*/ +int rtw_pci_aspm_enable = 0x5; +#else +int rtw_pci_aspm_enable; #endif -int rtw_force_igi_lb = CONFIG_RTW_FORCE_IGI_LB; -module_param(rtw_force_igi_lb, int, 0644); -MODULE_PARM_DESC(rtw_force_igi_lb, "force IGI low-bound, 0:no specified"); - #ifdef CONFIG_QOS_OPTIMIZATION int rtw_qos_opt_enable = 1; /* 0: disable,1:enable */ #else @@ -285,13 +350,17 @@ int rtw_qos_opt_enable = 0; /* 0: disable,1:enable */ #endif module_param(rtw_qos_opt_enable, int, 0644); -#ifdef CONFIG_AUTO_CHNL_SEL_NHM -int rtw_acs_mode = 1; /*0:disable, 1:enable*/ -module_param(rtw_acs_mode, int, 0644); - +#ifdef CONFIG_RTW_ACS int rtw_acs_auto_scan = 0; /*0:disable, 1:enable*/ module_param(rtw_acs_auto_scan, int, 0644); +int rtw_acs = 1; +module_param(rtw_acs, int, 0644); +#endif + +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR +int rtw_nm = 1;/*noise monitor*/ +module_param(rtw_nm, int, 0644); #endif char *ifname = "wlan%d"; @@ -318,7 +387,9 @@ char *rtw_initmac = 0; /* temp mac address if users want to use instead of the #endif #endif - +#ifdef CONFIG_AP_MODE +u8 rtw_bmc_tx_rate = MGN_UNKNOWN; +#endif module_param(rtw_pwrtrim_enable, int, 0644); module_param(rtw_initmac, charp, 0644); module_param(rtw_special_rf_path, int, 0644); @@ -329,6 +400,11 @@ module_param(rtw_network_mode, int, 0644); module_param(rtw_channel, int, 0644); module_param(rtw_mp_mode, int, 0644); module_param(rtw_wmm_enable, int, 0644); +#ifdef CONFIG_WMMPS_STA +module_param(rtw_uapsd_max_sp, int, 0644); +module_param(rtw_uapsd_ac_enable, int, 0644); +module_param(rtw_wmm_smart_ps, int, 0644); +#endif /* CONFIG_WMMPS_STA */ module_param(rtw_vrtl_carrier_sense, int, 0644); module_param(rtw_vcs_type, int, 0644); module_param(rtw_busy_thresh, int, 0644); @@ -338,17 +414,15 @@ module_param(rtw_ht_enable, int, 0644); module_param(rtw_bw_mode, int, 0644); module_param(rtw_ampdu_enable, int, 0644); module_param(rtw_rx_stbc, int, 0644); -module_param(rtw_ampdu_amsdu, int, 0644); +module_param(rtw_rx_ampdu_amsdu, int, 0644); +module_param(rtw_tx_ampdu_amsdu, int, 0644); #endif /* CONFIG_80211N_HT */ -#ifdef CONFIG_80211AC_VHT -module_param(rtw_vht_enable, int, 0644); -#endif /* CONFIG_80211AC_VHT */ + #ifdef CONFIG_BEAMFORMING module_param(rtw_beamform_cap, int, 0644); #endif module_param(rtw_lowrate_two_xmit, int, 0644); -module_param(rtw_rf_config, int, 0644); module_param(rtw_power_mgnt, int, 0644); module_param(rtw_smart_ps, int, 0644); module_param(rtw_low_power, int, 0644); @@ -359,6 +433,7 @@ module_param(rtw_antdiv_cfg, int, 0644); module_param(rtw_antdiv_type, int, 0644); module_param(rtw_drv_ant_band_switch, int, 0644); +module_param(rtw_single_ant_path, int, 0644); module_param(rtw_switch_usb_mode, int, 0644); @@ -369,6 +444,10 @@ module_param(rtw_hwpwrp_detect, int, 0644); module_param(rtw_hw_wps_pbc, int, 0644); module_param(rtw_check_hw_status, int, 0644); +#ifdef CONFIG_PCI_HCI +module_param(rtw_pci_aspm_enable, int, 0644); +#endif + #ifdef CONFIG_TX_EARLY_MODE module_param(rtw_early_mode, int, 0644); #endif @@ -415,6 +494,14 @@ module_param(rtw_80211d, int, 0644); MODULE_PARM_DESC(rtw_80211d, "Enable 802.11d mechanism"); #endif +#ifdef CONFIG_ADVANCE_OTA +/* BIT(0): OTA continuous rotated test within low RSSI,1R CCA in path B + BIT(1) & BIT(2): OTA continuous rotated test with low high RSSI */ +/* Experimental environment: shielding room with half of absorber and 2~3 rotation per minute */ +int rtw_advnace_ota; +module_param(rtw_advnace_ota, int, 0644); +#endif + uint rtw_notch_filter = RTW_NOTCH_FILTER; module_param(rtw_notch_filter, uint, 0644); MODULE_PARM_DESC(rtw_notch_filter, "0:Disable, 1:Enable, 2:Enable only for P2P"); @@ -441,16 +528,16 @@ MODULE_PARM_DESC(rtw_adaptivity_dc_backoff, "DC backoff for Adaptivity"); int rtw_adaptivity_th_l2h_ini = CONFIG_RTW_ADAPTIVITY_TH_L2H_INI; module_param(rtw_adaptivity_th_l2h_ini, int, 0644); -MODULE_PARM_DESC(rtw_adaptivity_th_l2h_ini, "TH_L2H_ini for Adaptivity"); +MODULE_PARM_DESC(rtw_adaptivity_th_l2h_ini, "th_l2h_ini for Adaptivity"); int rtw_adaptivity_th_edcca_hl_diff = CONFIG_RTW_ADAPTIVITY_TH_EDCCA_HL_DIFF; module_param(rtw_adaptivity_th_edcca_hl_diff, int, 0644); -MODULE_PARM_DESC(rtw_adaptivity_th_edcca_hl_diff, "TH_EDCCA_HL_diff for Adaptivity"); +MODULE_PARM_DESC(rtw_adaptivity_th_edcca_hl_diff, "th_edcca_hl_diff for Adaptivity"); #ifdef CONFIG_DFS_MASTER uint rtw_dfs_region_domain = CONFIG_RTW_DFS_REGION_DOMAIN; module_param(rtw_dfs_region_domain, uint, 0644); -MODULE_PARM_DESC(rtw_dfs_region_domain, "1:FCC, 2:MKK, 3:ETSI"); +MODULE_PARM_DESC(rtw_dfs_region_domain, "0:UNKNOWN, 1:FCC, 2:MKK, 3:ETSI"); #endif uint rtw_amplifier_type_2g = CONFIG_RTW_AMPLIFIER_TYPE_2G; @@ -505,7 +592,6 @@ uint rtw_rxgain_offset_5gh = 0; module_param(rtw_rxgain_offset_5gh, uint, 0644); MODULE_PARM_DESC(rtw_rxgain_offset_5gm, "default RF Gain 5GL Offset value:0"); - uint rtw_pll_ref_clk_sel = CONFIG_RTW_PLL_REF_CLK_SEL; module_param(rtw_pll_ref_clk_sel, uint, 0644); MODULE_PARM_DESC(rtw_pll_ref_clk_sel, "force pll_ref_clk_sel, 0xF:use autoload value"); @@ -514,9 +600,11 @@ int rtw_tx_pwr_by_rate = CONFIG_TXPWR_BY_RATE_EN; module_param(rtw_tx_pwr_by_rate, int, 0644); MODULE_PARM_DESC(rtw_tx_pwr_by_rate, "0:Disable, 1:Enable, 2: Depend on efuse"); +#ifdef CONFIG_TXPWR_LIMIT int rtw_tx_pwr_lmt_enable = CONFIG_TXPWR_LIMIT_EN; module_param(rtw_tx_pwr_lmt_enable, int, 0644); MODULE_PARM_DESC(rtw_tx_pwr_lmt_enable, "0:Disable, 1:Enable, 2: Depend on efuse"); +#endif static int rtw_target_tx_pwr_2g_a[RATE_SECTION_NUM] = CONFIG_RTW_TARGET_TX_PWR_2G_A; static int rtw_target_tx_pwr_2g_a_num = 0; @@ -593,8 +681,8 @@ MODULE_PARM_DESC(rtw_trx_share_mode, "TRx FIFO Shared"); int _netdev_open(struct net_device *pnetdev); int netdev_open(struct net_device *pnetdev); static int netdev_close(struct net_device *pnetdev); -#ifdef CONFIG_PLATFORM_INTEL_BYT -extern int rtw_sdio_set_power(int on); +#if defined(CONFIG_PLATFORM_INTEL_BYT) && defined(CONFIG_SDIO_HCI) +extern int rtw_sdio_set_power(struct sdio_func *func, int on); #endif /* CONFIG_PLATFORM_INTEL_BYT */ #ifdef CONFIG_MCC_MODE @@ -608,6 +696,13 @@ int rtw_mcc_sta_bw20_target_tx_tp = MCC_STA_BW20_TARGET_TX_TP; int rtw_mcc_sta_bw40_target_tx_tp = MCC_STA_BW40_TARGET_TX_TP; int rtw_mcc_sta_bw80_target_tx_tp = MCC_STA_BW80_TARGET_TX_TP; int rtw_mcc_single_tx_cri = MCC_SINGLE_TX_CRITERIA; +int rtw_mcc_policy_table_idx = 0; +int rtw_mcc_duration = 0; +int rtw_mcc_tsf_sync_offset = 0; +int rtw_mcc_start_time_offset = 0; +int rtw_mcc_interval = 0; +int rtw_mcc_guard_offset0 = -1; +int rtw_mcc_guard_offset1 = -1; module_param(rtw_en_mcc, int, 0644); module_param(rtw_mcc_single_tx_cri, int, 0644); module_param(rtw_mcc_ap_bw20_target_tx_tp, int, 0644); @@ -616,6 +711,13 @@ module_param(rtw_mcc_ap_bw80_target_tx_tp, int, 0644); module_param(rtw_mcc_sta_bw20_target_tx_tp, int, 0644); module_param(rtw_mcc_sta_bw40_target_tx_tp, int, 0644); module_param(rtw_mcc_sta_bw80_target_tx_tp, int, 0644); +module_param(rtw_mcc_policy_table_idx, int, 0644); +module_param(rtw_mcc_duration, int, 0644); +module_param(rtw_mcc_tsf_sync_offset, int, 0644); +module_param(rtw_mcc_start_time_offset, int, 0644); +module_param(rtw_mcc_interval, int, 0644); +module_param(rtw_mcc_guard_offset0, int, 0644); +module_param(rtw_mcc_guard_offset1, int, 0644); #endif /*CONFIG_MCC_MODE */ #ifdef CONFIG_RTW_NAPI @@ -623,6 +725,10 @@ module_param(rtw_mcc_sta_bw80_target_tx_tp, int, 0644); enable napi only = 1, disable napi = 0*/ int rtw_en_napi = 1; module_param(rtw_en_napi, int, 0644); +#ifdef CONFIG_RTW_NAPI_DYNAMIC +int rtw_napi_threshold = 100; /* unit: Mbps */ +module_param(rtw_napi_threshold, int, 0644); +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ #ifdef CONFIG_RTW_GRO /*following setting should define GRO in Makefile enable gro = 1, disable gro = 0*/ @@ -631,6 +737,33 @@ module_param(rtw_en_gro, int, 0644); #endif /* CONFIG_RTW_GRO */ #endif /* CONFIG_RTW_NAPI */ +#ifdef RTW_IQK_FW_OFFLOAD +int rtw_iqk_fw_offload = 1; +#else +int rtw_iqk_fw_offload; +#endif /* RTW_IQK_FW_OFFLOAD */ +module_param(rtw_iqk_fw_offload, int, 0644); + +#ifdef CONFIG_TDLS +int rtw_en_tdls = 1; +module_param(rtw_en_tdls, int, 0644); +#endif + +#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT +int rtw_fw_param_init = 1; +module_param(rtw_fw_param_init, int, 0644); +#endif + +#ifdef CONFIG_WOWLAN +/* + * bit[0]: magic packet wake up + * bit[1]: unucast packet(HW/FW unuicast) + * bit[2]: deauth wake up + */ +uint rtw_wakeup_event = RTW_WAKEUP_EVENT; +module_param(rtw_wakeup_event, uint, 0644); +#endif + void rtw_regsty_load_target_tx_power(struct registry_priv *regsty) { int path, rs; @@ -680,6 +813,28 @@ inline void rtw_regsty_load_excl_chs(struct registry_priv *regsty) regsty->excl_chs[ch_num] = 0; } +#ifdef CONFIG_80211N_HT +inline void rtw_regsty_init_rx_ampdu_sz_limit(struct registry_priv *regsty) +{ + int i, j; + uint *sz_limit; + + for (i = 0; i < 4; i++) { + if (i == 0) + sz_limit = rtw_rx_ampdu_sz_limit_1ss; + else if (i == 1) + sz_limit = rtw_rx_ampdu_sz_limit_2ss; + else if (i == 2) + sz_limit = rtw_rx_ampdu_sz_limit_3ss; + else if (i == 3) + sz_limit = rtw_rx_ampdu_sz_limit_4ss; + + for (j = 0; j < 4; j++) + regsty->rx_ampdu_sz_limit_by_nss_bw[i][j] = sz_limit[j]; + } +} +#endif /* CONFIG_80211N_HT */ + uint loadparam(_adapter *padapter) { uint status = _SUCCESS; @@ -703,10 +858,10 @@ uint loadparam(_adapter *padapter) registry_par->channel = (u8)rtw_channel; registry_par->wireless_mode = (u8)rtw_wireless_mode; - if (IsSupported24G(registry_par->wireless_mode) && (!IsSupported5G(registry_par->wireless_mode)) + if (IsSupported24G(registry_par->wireless_mode) && (!is_supported_5g(registry_par->wireless_mode)) && (registry_par->channel > 14)) registry_par->channel = 1; - else if (IsSupported5G(registry_par->wireless_mode) && (!IsSupported24G(registry_par->wireless_mode)) + else if (is_supported_5g(registry_par->wireless_mode) && (!IsSupported24G(registry_par->wireless_mode)) && (registry_par->channel <= 14)) registry_par->channel = 36; @@ -722,6 +877,7 @@ uint loadparam(_adapter *padapter) registry_par->check_fw_ps = (u8)rtw_check_fw_ps; registry_par->power_mgnt = (u8)rtw_power_mgnt; registry_par->ips_mode = (u8)rtw_ips_mode; + registry_par->lps_level = (u8)rtw_lps_level; registry_par->radio_enable = (u8)rtw_radio_enable; registry_par->long_retry_lmt = (u8)rtw_long_retry_lmt; registry_par->short_retry_lmt = (u8)rtw_short_retry_lmt; @@ -737,15 +893,17 @@ uint loadparam(_adapter *padapter) registry_par->acm_method = (u8)rtw_acm_method; registry_par->usb_rxagg_mode = (u8)rtw_usb_rxagg_mode; + registry_par->dynamic_agg_enable = (u8)rtw_dynamic_agg_enable; - /* UAPSD */ + /* WMM */ registry_par->wmm_enable = (u8)rtw_wmm_enable; - registry_par->uapsd_enable = (u8)rtw_uapsd_enable; - registry_par->uapsd_max_sp = (u8)rtw_uapsd_max_sp; - registry_par->uapsd_acbk_en = (u8)rtw_uapsd_acbk_en; - registry_par->uapsd_acbe_en = (u8)rtw_uapsd_acbe_en; - registry_par->uapsd_acvi_en = (u8)rtw_uapsd_acvi_en; - registry_par->uapsd_acvo_en = (u8)rtw_uapsd_acvo_en; + +#ifdef CONFIG_WMMPS_STA + /* UAPSD */ + registry_par->uapsd_max_sp_len= (u8)rtw_uapsd_max_sp; + registry_par->uapsd_ac_enable = (u8)rtw_uapsd_ac_enable; + registry_par->wmm_smart_ps = (u8)rtw_wmm_smart_ps; +#endif /* CONFIG_WMMPS_STA */ registry_par->RegPwrTrimEnable = (u8)rtw_pwrtrim_enable; @@ -756,19 +914,22 @@ uint loadparam(_adapter *padapter) registry_par->bw_mode = (u8)rtw_bw_mode; registry_par->ampdu_enable = (u8)rtw_ampdu_enable; registry_par->rx_stbc = (u8)rtw_rx_stbc; - registry_par->ampdu_amsdu = (u8)rtw_ampdu_amsdu; + registry_par->rx_ampdu_amsdu = (u8)rtw_rx_ampdu_amsdu; + registry_par->tx_ampdu_amsdu = (u8)rtw_tx_ampdu_amsdu; registry_par->short_gi = (u8)rtw_short_gi; registry_par->ldpc_cap = (u8)rtw_ldpc_cap; registry_par->stbc_cap = (u8)rtw_stbc_cap; registry_par->beamform_cap = (u8)rtw_beamform_cap; registry_par->beamformer_rf_num = (u8)rtw_bfer_rf_number; registry_par->beamformee_rf_num = (u8)rtw_bfee_rf_number; + rtw_regsty_init_rx_ampdu_sz_limit(registry_par); #endif #ifdef CONFIG_80211AC_VHT registry_par->vht_enable = (u8)rtw_vht_enable; registry_par->ampdu_factor = (u8)rtw_ampdu_factor; - registry_par->vht_rate_sel = (u8)rtw_vht_rate_sel; + registry_par->vht_rx_mcs_map[0] = (u8)(rtw_vht_rx_mcs_map & 0xFF); + registry_par->vht_rx_mcs_map[1] = (u8)((rtw_vht_rx_mcs_map & 0xFF00) >> 8); #endif #ifdef CONFIG_TX_EARLY_MODE @@ -804,6 +965,7 @@ uint loadparam(_adapter *padapter) registry_par->bt_sco = (u8)rtw_bt_sco; registry_par->bt_ampdu = (u8)rtw_bt_ampdu; registry_par->ant_num = (u8)rtw_ant_num; + registry_par->single_ant_path = (u8) rtw_single_ant_path; #endif registry_par->bAcceptAddbaReq = (u8)rtw_AcceptAddbaReq; @@ -850,25 +1012,18 @@ uint loadparam(_adapter *padapter) registry_par->notch_filter = (u8)rtw_notch_filter; -#ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV - registry_par->force_ant = (u8)rtw_force_ant; - registry_par->force_igi = (u8)rtw_force_igi; -#endif - #ifdef CONFIG_CONCURRENT_MODE registry_par->virtual_iface_num = (u8)rtw_virtual_iface_num; #endif - - registry_par->force_igi_lb = (u8)rtw_force_igi_lb; - registry_par->pll_ref_clk_sel = (u8)rtw_pll_ref_clk_sel; +#ifdef CONFIG_TXPWR_LIMIT registry_par->RegEnableTxPowerLimit = (u8)rtw_tx_pwr_lmt_enable; +#endif registry_par->RegEnableTxPowerByRate = (u8)rtw_tx_pwr_by_rate; rtw_regsty_load_target_tx_power(registry_par); - registry_par->RegPowerBase = 14; registry_par->TxBBSwing_2G = (s8)rtw_TxBBSwing_2G; registry_par->TxBBSwing_5G = (s8)rtw_TxBBSwing_5G; registry_par->bEn_RFE = 1; @@ -894,9 +1049,13 @@ uint loadparam(_adapter *padapter) registry_par->boffefusemask = (u8)rtw_OffEfuseMask; registry_par->bFileMaskEfuse = (u8)rtw_FileMaskEfuse; -#ifdef CONFIG_AUTO_CHNL_SEL_NHM - registry_par->acs_mode = (u8)rtw_acs_mode; + +#ifdef CONFIG_RTW_ACS + registry_par->acs_mode = (u8)rtw_acs; registry_par->acs_auto_scan = (u8)rtw_acs_auto_scan; +#endif +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + registry_par->nm_mode = (u8)rtw_nm; #endif registry_par->reg_rxgain_offset_2g = (u32) rtw_rxgain_offset_2g; registry_par->reg_rxgain_offset_5gl = (u32) rtw_rxgain_offset_5gl; @@ -916,17 +1075,32 @@ uint loadparam(_adapter *padapter) registry_par->rtw_mcc_sta_bw40_target_tx_tp = (u32)rtw_mcc_sta_bw40_target_tx_tp; registry_par->rtw_mcc_sta_bw80_target_tx_tp = (u32)rtw_mcc_sta_bw80_target_tx_tp; registry_par->rtw_mcc_single_tx_cri = (u32)rtw_mcc_single_tx_cri; + registry_par->rtw_mcc_policy_table_idx = rtw_mcc_policy_table_idx; + registry_par->rtw_mcc_duration = (u8)rtw_mcc_duration; + registry_par->rtw_mcc_tsf_sync_offset = (u8)rtw_mcc_tsf_sync_offset; + registry_par->rtw_mcc_start_time_offset = (u8)rtw_mcc_start_time_offset; + registry_par->rtw_mcc_interval = (u8)rtw_mcc_interval; + registry_par->rtw_mcc_guard_offset0 = rtw_mcc_guard_offset0; + registry_par->rtw_mcc_guard_offset1 = rtw_mcc_guard_offset1; #endif /*CONFIG_MCC_MODE */ -#ifdef CONFIG_DEFAULT_PATTERNS_EN - registry_par->default_patterns_en = rtw_support_default_patterns; + +#ifdef CONFIG_WOWLAN + registry_par->wakeup_event = rtw_wakeup_event; #endif #ifdef CONFIG_SUPPORT_TRX_SHARED registry_par->trx_share_mode = rtw_trx_share_mode; #endif +#ifdef CONFIG_PCI_HCI + registry_par->pci_aspm_config = rtw_pci_aspm_enable; +#endif + #ifdef CONFIG_RTW_NAPI registry_par->en_napi = (u8)rtw_en_napi; +#ifdef CONFIG_RTW_NAPI_DYNAMIC + registry_par->napi_threshold = (u32)rtw_napi_threshold; +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ #ifdef CONFIG_RTW_GRO registry_par->en_gro = (u8)rtw_en_gro; if (!registry_par->en_napi && registry_par->en_gro) { @@ -936,6 +1110,21 @@ uint loadparam(_adapter *padapter) #endif /* CONFIG_RTW_GRO */ #endif /* CONFIG_RTW_NAPI */ + registry_par->iqk_fw_offload = (u8)rtw_iqk_fw_offload; + +#ifdef CONFIG_TDLS + registry_par->en_tdls = rtw_en_tdls; +#endif + +#ifdef CONFIG_ADVANCE_OTA + registry_par->adv_ota = rtw_advnace_ota; +#endif +#ifdef CONFIG_FW_OFFLOAD_PARAM_INIT + registry_par->fw_param_init = rtw_fw_param_init; +#endif +#ifdef CONFIG_AP_MODE + registry_par->bmc_tx_rate = rtw_bmc_tx_rate; +#endif return status; } @@ -1124,38 +1313,43 @@ u16 rtw_recv_select_queue(struct sk_buff *skb) } #endif + +static u8 is_rtw_ndev(struct net_device *ndev) +{ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) + return ndev->netdev_ops + && ndev->netdev_ops->ndo_do_ioctl + && ndev->netdev_ops->ndo_do_ioctl == rtw_ioctl; +#else + return ndev->do_ioctl + && ndev->do_ioctl == rtw_ioctl; +#endif +} + static int rtw_ndev_notifier_call(struct notifier_block *nb, unsigned long state, void *ptr) { + struct net_device *ndev; + + if (ptr == NULL) + return NOTIFY_DONE; + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 11, 0)) - struct net_device *dev = netdev_notifier_info_to_dev(ptr); + ndev = netdev_notifier_info_to_dev(ptr); #else - struct net_device *dev = ptr; + ndev = ptr; #endif - if (dev == NULL) + if (ndev == NULL) return NOTIFY_DONE; -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) - if (dev->netdev_ops == NULL) + if (!is_rtw_ndev(ndev)) return NOTIFY_DONE; - if (dev->netdev_ops->ndo_do_ioctl == NULL) - return NOTIFY_DONE; - - if (dev->netdev_ops->ndo_do_ioctl != rtw_ioctl) -#else - if (dev->do_ioctl == NULL) - return NOTIFY_DONE; - - if (dev->do_ioctl != rtw_ioctl) -#endif - return NOTIFY_DONE; - - RTW_INFO(FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(dev), state); + RTW_INFO(FUNC_NDEV_FMT" state:%lu\n", FUNC_NDEV_ARG(ndev), state); switch (state) { case NETDEV_CHANGENAME: - rtw_adapter_proc_replace(dev); + rtw_adapter_proc_replace(ndev); break; } @@ -1176,7 +1370,6 @@ void rtw_ndev_notifier_unregister(void) unregister_netdevice_notifier(&rtw_ndev_notifier); } - int rtw_ndev_init(struct net_device *dev) { _adapter *adapter = rtw_netdev_priv(dev); @@ -1255,7 +1448,7 @@ int rtw_init_netdev_name(struct net_device *pnetdev, const char *ifname) if (dev_alloc_name(pnetdev, ifname) < 0) RTW_ERR("dev_alloc_name, fail!\n"); - netif_carrier_off(pnetdev); + rtw_netif_carrier_off(pnetdev); /* rtw_netif_stop_queue(pnetdev); */ return 0; @@ -1376,9 +1569,10 @@ void rtw_os_ndev_free(_adapter *adapter) int rtw_os_ndev_register(_adapter *adapter, const char *name) { + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); int ret = _SUCCESS; struct net_device *ndev = adapter->pnetdev; - + u8 rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); #ifdef CONFIG_RTW_NAPI netif_napi_add(ndev, &adapter->napi, rtw_recv_napi_poll, RTL_NAPI_WEIGHT); @@ -1399,11 +1593,9 @@ int rtw_os_ndev_register(_adapter *adapter, const char *name) /* Tell the network stack we exist */ - #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) - if (!rtnl_is_locked()) + if (rtnl_lock_needed) ret = (register_netdev(ndev) == 0) ? _SUCCESS : _FAIL; else - #endif ret = (register_netdevice(ndev) == 0) ? _SUCCESS : _FAIL; if (ret == _SUCCESS) @@ -1445,15 +1637,19 @@ void rtw_os_ndev_unregister(_adapter *adapter) #endif if ((adapter->DriverState != DRIVER_DISAPPEAR) && netdev) { - #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) - if (!rtnl_is_locked()) + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + u8 rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); + + if (rtnl_lock_needed) unregister_netdev(netdev); else - #endif unregister_netdevice(netdev); } #if defined(CONFIG_IOCTL_CFG80211) && !defined(RTW_SINGLE_WIPHY) +#ifdef CONFIG_RFKILL_POLL + rtw_cfg80211_deinit_rfkill(adapter_to_wiphy(adapter)); +#endif rtw_wiphy_unregister(adapter_to_wiphy(adapter)); #endif @@ -1596,30 +1792,40 @@ u32 rtw_start_drv_threads(_adapter *padapter) #endif { padapter->xmitThread = kthread_run(rtw_xmit_thread, padapter, "RTW_XMIT_THREAD"); - if (IS_ERR(padapter->xmitThread)) + if (IS_ERR(padapter->xmitThread)) { + padapter->xmitThread = NULL; _status = _FAIL; + } } #endif /* #ifdef CONFIG_XMIT_THREAD_MODE */ #ifdef CONFIG_RECV_THREAD_MODE - padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); - if (IS_ERR(padapter->recvThread)) - _status = _FAIL; + if (is_primary_adapter(padapter)) { + padapter->recvThread = kthread_run(rtw_recv_thread, padapter, "RTW_RECV_THREAD"); + if (IS_ERR(padapter->recvThread)) { + padapter->recvThread = NULL; + _status = _FAIL; + } + } #endif if (is_primary_adapter(padapter)) { padapter->cmdThread = kthread_run(rtw_cmd_thread, padapter, "RTW_CMD_THREAD"); - if (IS_ERR(padapter->cmdThread)) + if (IS_ERR(padapter->cmdThread)) { + padapter->cmdThread = NULL; _status = _FAIL; + } else - _rtw_down_sema(&padapter->cmdpriv.terminate_cmdthread_sema); /* wait for cmd_thread to run */ + _rtw_down_sema(&padapter->cmdpriv.start_cmdthread_sema); /* wait for cmd_thread to run */ } #ifdef CONFIG_EVENT_THREAD_MODE padapter->evtThread = kthread_run(event_thread, padapter, "RTW_EVENT_THREAD"); - if (IS_ERR(padapter->evtThread)) + if (IS_ERR(padapter->evtThread)) { + padapter->evtThread = NULL; _status = _FAIL; + } #endif rtw_hal_start_thread(padapter); @@ -1634,9 +1840,11 @@ void rtw_stop_drv_threads(_adapter *padapter) rtw_stop_cmd_thread(padapter); #ifdef CONFIG_EVENT_THREAD_MODE - _rtw_up_sema(&padapter->evtpriv.evt_notify); - if (padapter->evtThread) - _rtw_down_sema(&padapter->evtpriv.terminate_evtthread_sema); + if (padapter->evtThread) { + _rtw_up_sema(&padapter->evtpriv.evt_notify); + rtw_thread_stop(padapter->evtThread); + padapter->evtThread = NULL; + } #endif #ifdef CONFIG_XMIT_THREAD_MODE @@ -1646,15 +1854,21 @@ void rtw_stop_drv_threads(_adapter *padapter) if (is_primary_adapter(padapter)) #endif /*SDIO_HCI */ { - _rtw_up_sema(&padapter->xmitpriv.xmit_sema); - _rtw_down_sema(&padapter->xmitpriv.terminate_xmitthread_sema); + if (padapter->xmitThread) { + _rtw_up_sema(&padapter->xmitpriv.xmit_sema); + rtw_thread_stop(padapter->xmitThread); + padapter->xmitThread = NULL; + } } #endif #ifdef CONFIG_RECV_THREAD_MODE - /* Below is to termindate rx_thread... */ - _rtw_up_sema(&padapter->recvpriv.recv_sema); - _rtw_down_sema(&padapter->recvpriv.terminate_recvthread_sema); + if (is_primary_adapter(padapter) && padapter->recvThread) { + /* Below is to termindate rx_thread... */ + _rtw_up_sema(&padapter->recvpriv.recv_sema); + rtw_thread_stop(padapter->recvThread); + padapter->recvThread = NULL; + } #endif rtw_hal_stop_thread(padapter); @@ -1724,7 +1938,12 @@ u8 rtw_init_default_value(_adapter *padapter) padapter->fix_rate = 0xFF; padapter->data_fb = 0; padapter->fix_bw = 0xFF; - + padapter->power_offset = 0; + padapter->rsvd_page_offset = 0; + padapter->rsvd_page_num = 0; +#ifdef CONFIG_AP_MODE + padapter->bmc_tx_rate = pregistrypriv->bmc_tx_rate; +#endif padapter->driver_tx_bw_mode = pregistrypriv->tx_bw_mode; padapter->driver_ampdu_spacing = 0xFF; @@ -1732,6 +1951,11 @@ u8 rtw_init_default_value(_adapter *padapter) padapter->driver_rx_ampdu_spacing = 0xFF; padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; +#ifdef CONFIG_TX_AMSDU + padapter->tx_amsdu = 2; + padapter->tx_amsdu_rate = 400; +#endif + padapter->driver_tx_max_agg_num = 0xFF; #ifdef DBG_RX_COUNTER_DUMP padapter->dump_rx_cnt_mode = 0; padapter->drv_rx_cnt_ok = 0; @@ -1740,19 +1964,25 @@ u8 rtw_init_default_value(_adapter *padapter) #endif #ifdef CONFIG_RTW_NAPI padapter->napi_state = NAPI_DISABLE; +#endif + padapter->tsf.sync_port = MAX_HW_PORT; + padapter->tsf.offset = 0; + +#ifdef CONFIG_RTW_ACS + if (pregistrypriv->acs_mode) + rtw_acs_start(padapter); + else + rtw_acs_stop(padapter); +#endif +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + if (pregistrypriv->nm_mode) + rtw_nm_enable(padapter); + else + rtw_nm_disable(padapter); #endif return ret; } -#ifdef CONFIG_SWTIMER_BASED_TXBCN -void _tx_beacon_timer_handlder(void *FunctionContext) -{ - struct dvobj_priv *pdvobj = (struct dvobj_priv *)FunctionContext; - - tx_beacon_timer_handlder(pdvobj); -} -#endif - struct dvobj_priv *devobj_init(void) { struct dvobj_priv *pdvobj = NULL; @@ -1794,17 +2024,22 @@ struct dvobj_priv *devobj_init(void) pdvobj->inter_bcn_space = DEFAULT_BCN_INTERVAL; /* default value is equal to the default beacon_interval (100ms) */ _rtw_init_queue(&pdvobj->ap_if_q); #ifdef CONFIG_SWTIMER_BASED_TXBCN - _init_timer(&(pdvobj->txbcn_timer), NULL, _tx_beacon_timer_handlder, pdvobj); + rtw_init_timer(&(pdvobj->txbcn_timer), NULL, tx_beacon_timer_handlder, pdvobj); #endif #endif - _init_timer(&(pdvobj->dynamic_chk_timer), NULL, _dynamic_check_timer_handlder, pdvobj); + rtw_init_timer(&(pdvobj->dynamic_chk_timer), NULL, rtw_dynamic_check_timer_handlder, pdvobj); #ifdef CONFIG_MCC_MODE _rtw_mutex_init(&(pdvobj->mcc_objpriv.mcc_mutex)); _rtw_spinlock_init(&pdvobj->mcc_objpriv.mcc_lock); #endif /* CONFIG_MCC_MODE */ +#ifdef CONFIG_RTW_NAPI_DYNAMIC + pdvobj->en_napi_dynamic = 0; +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ + + return pdvobj; } @@ -1854,6 +2089,40 @@ void devobj_deinit(struct dvobj_priv *pdvobj) rtw_mfree((u8 *)pdvobj, sizeof(*pdvobj)); } +inline u8 rtw_rtnl_lock_needed(struct dvobj_priv *dvobj) +{ + if (dvobj->rtnl_lock_holder && dvobj->rtnl_lock_holder == current) + return 0; + return 1; +} + +#if (LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26)) +static inline int rtnl_is_locked(void) +{ +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 17)) + if (unlikely(rtnl_trylock())) { + rtnl_unlock(); +#else + if (unlikely(down_trylock(&rtnl_sem) == 0)) { + up(&rtnl_sem); +#endif + return 0; + } + return 1; +} +#endif + +inline void rtw_set_rtnl_lock_holder(struct dvobj_priv *dvobj, _thread_hdl_ thd_hdl) +{ + rtw_warn_on(!rtnl_is_locked()); + + if (!thd_hdl || rtnl_is_locked()) + dvobj->rtnl_lock_holder = thd_hdl; + + if (dvobj->rtnl_lock_holder && 0) + RTW_INFO("rtnl_lock_holder: %s:%d\n", current->comm, current->pid); +} + u8 rtw_reset_drv_sw(_adapter *padapter) { u8 ret8 = _SUCCESS; @@ -1866,6 +2135,10 @@ u8 rtw_reset_drv_sw(_adapter *padapter) RTW_ENABLE_FUNC(padapter, DF_RX_BIT); RTW_ENABLE_FUNC(padapter, DF_TX_BIT); + + padapter->tsf.sync_port = MAX_HW_PORT; + padapter->tsf.offset = 0; + padapter->bLinkInfoDump = 0; padapter->xmitpriv.tx_pkts = 0; @@ -1925,7 +2198,8 @@ u8 rtw_init_drv_sw(_adapter *padapter) goto exit; } - rtw_rfctl_init(padapter); + if (is_primary_adapter(padapter)) + rtw_rfctl_init(padapter); if (rtw_init_mlme_priv(padapter) == _FAIL) { ret8 = _FAIL; @@ -1975,8 +2249,6 @@ u8 rtw_init_drv_sw(_adapter *padapter) /* We don't need to memset padapter->XXX to zero, because adapter is allocated by rtw_zvmalloc(). */ /* _rtw_memset((unsigned char *)&padapter->securitypriv, 0, sizeof (struct security_priv)); */ - /* _init_timer(&(padapter->securitypriv.tkip_timer), padapter->pifp, rtw_use_tkipkey_handler, padapter); */ - if (_rtw_init_sta_priv(&padapter->stapriv) == _FAIL) { RTW_INFO("Can't _rtw_init_sta_priv\n"); ret8 = _FAIL; @@ -1986,6 +2258,10 @@ u8 rtw_init_drv_sw(_adapter *padapter) padapter->stapriv.padapter = padapter; padapter->setband = WIFI_FREQUENCY_BAND_AUTO; padapter->fix_rate = 0xFF; + padapter->power_offset = 0; + padapter->rsvd_page_offset = 0; + padapter->rsvd_page_num = 0; + padapter->data_fb = 0; padapter->fix_rx_ampdu_accept = RX_AMPDU_ACCEPT_INVALID; padapter->fix_rx_ampdu_size = RX_AMPDU_SIZE_INVALID; @@ -2007,7 +2283,7 @@ u8 rtw_init_drv_sw(_adapter *padapter) #endif rtw_hal_dm_init(padapter); -#ifdef CONFIG_SW_LED +#ifdef CONFIG_RTW_SW_LED rtw_hal_sw_led_init(padapter); #endif #ifdef DBG_CONFIG_ERROR_DETECT @@ -2031,6 +2307,20 @@ u8 rtw_init_drv_sw(_adapter *padapter) _rtw_spinlock_init(&padapter->br_ext_lock); #endif /* CONFIG_BR_EXT */ +#ifdef CONFIG_BEAMFORMING +#ifdef RTW_BEAMFORMING_VERSION_2 + rtw_bf_init(padapter); +#endif /* RTW_BEAMFORMING_VERSION_2 */ +#endif /* CONFIG_BEAMFORMING */ + +#ifdef CONFIG_RTW_REPEATER_SON + init_rtw_rson_data(adapter_to_dvobj(padapter)); +#endif + +#ifdef CONFIG_RTW_80211K + rtw_init_rm(padapter); +#endif + exit: @@ -2051,10 +2341,6 @@ void rtw_cancel_all_timer(_adapter *padapter) _cancel_timer_ex(&padapter->mlmepriv.assoc_timer); -#if 0 - _cancel_timer_ex(&padapter->securitypriv.tkip_timer); -#endif - _cancel_timer_ex(&padapter->mlmepriv.scan_to_timer); #ifdef CONFIG_DFS_MASTER @@ -2062,12 +2348,19 @@ void rtw_cancel_all_timer(_adapter *padapter) #endif _cancel_timer_ex(&adapter_to_dvobj(padapter)->dynamic_chk_timer); - +#ifdef CONFIG_RTW_SW_LED /* cancel sw led timer */ rtw_hal_sw_led_deinit(padapter); - +#endif _cancel_timer_ex(&(adapter_to_pwrctl(padapter)->pwr_state_check_timer)); +#ifdef CONFIG_TX_AMSDU + _cancel_timer_ex(&padapter->xmitpriv.amsdu_bk_timer); + _cancel_timer_ex(&padapter->xmitpriv.amsdu_be_timer); + _cancel_timer_ex(&padapter->xmitpriv.amsdu_vo_timer); + _cancel_timer_ex(&padapter->xmitpriv.amsdu_vi_timer); +#endif + #ifdef CONFIG_IOCTL_CFG80211 #ifdef CONFIG_P2P _cancel_timer_ex(&padapter->cfg80211_wdinfo.remain_on_ch_timer); @@ -2082,6 +2375,11 @@ void rtw_cancel_all_timer(_adapter *padapter) #ifdef CONFIG_NEW_SIGNAL_STAT_PROCESS _cancel_timer_ex(&padapter->recvpriv.signal_stat_timer); #endif + +#ifdef CONFIG_LPS_RPWM_TIMER + _cancel_timer_ex(&(adapter_to_pwrctl(padapter)->pwr_rpwm_timer)); +#endif /* CONFIG_LPS_RPWM_TIMER */ + /* cancel dm timer */ rtw_hal_dm_deinit(padapter); @@ -2131,12 +2429,19 @@ u8 rtw_free_drv_sw(_adapter *padapter) /* rtw_free_tdls_info(&padapter->tdlsinfo); */ #endif /* CONFIG_TDLS */ +#ifdef CONFIG_RTW_80211K + rtw_free_rm_priv(padapter); +#endif + rtw_free_cmd_priv(&padapter->cmdpriv); rtw_free_evt_priv(&padapter->evtpriv); rtw_free_mlme_priv(&padapter->mlmepriv); + if (is_primary_adapter(padapter)) + rtw_rfctl_deinit(padapter); + /* free_io_queue(padapter); */ _rtw_free_xmit_priv(&padapter->xmitpriv); @@ -2149,10 +2454,6 @@ u8 rtw_free_drv_sw(_adapter *padapter) /* rtw_mfree((void *)padapter, sizeof (padapter)); */ -#ifdef CONFIG_DRVEXT_MODULE - free_drvext(&padapter->drvextpriv); -#endif - rtw_hal_free_data(padapter); @@ -2218,7 +2519,6 @@ int _netdev_vir_if_open(struct net_device *pnetdev) if (padapter->bup == _FALSE && primary_padapter->bup == _TRUE && rtw_is_hw_init_completed(primary_padapter)) { - padapter->bFWReady = primary_padapter->bFWReady; #if 0 /*#ifdef CONFIG_MI_WITH_MBSSID_CAM*/ rtw_hal_set_hwreg(padapter, HW_VAR_MAC_ADDR, adapter_mac_addr(padapter)); /* set mac addr to mac register */ #endif @@ -2263,7 +2563,7 @@ int _netdev_vir_if_open(struct net_device *pnetdev) } #endif - netif_carrier_off(pnetdev); + rtw_netif_carrier_off(pnetdev); rtw_netif_stop_queue(pnetdev); return -1; @@ -2439,10 +2739,10 @@ void rtw_drv_stop_vir_if(_adapter *padapter) pnetdev = padapter->pnetdev; if (check_fwstate(pmlmepriv, _FW_LINKED)) - rtw_disassoc_cmd(padapter, 0, _FALSE); + rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); #ifdef CONFIG_AP_MODE - if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { free_mlme_ap_info(padapter); #ifdef CONFIG_HOSTAPD_MLME hostapd_mode_unload(padapter); @@ -2515,6 +2815,137 @@ void rtw_drv_del_vir_ifaces(_adapter *primary_padapter) #endif /*end of CONFIG_CONCURRENT_MODE*/ +/* IPv4, IPv6 IP addr notifier */ +static int rtw_inetaddr_notifier_call(struct notifier_block *nb, + unsigned long action, void *data) +{ + struct in_ifaddr *ifa = (struct in_ifaddr *)data; + struct net_device *ndev; + struct mlme_ext_priv *pmlmeext = NULL; + struct mlme_ext_info *pmlmeinfo = NULL; + _adapter *adapter = NULL; + + if (!ifa || !ifa->ifa_dev || !ifa->ifa_dev->dev) + return NOTIFY_DONE; + + ndev = ifa->ifa_dev->dev; + + if (!is_rtw_ndev(ndev)) + return NOTIFY_DONE; + + adapter = (_adapter *)rtw_netdev_priv(ifa->ifa_dev->dev); + + if (adapter == NULL) + return NOTIFY_DONE; + + pmlmeext = &adapter->mlmeextpriv; + pmlmeinfo = &pmlmeext->mlmext_info; + + switch (action) { + case NETDEV_UP: + _rtw_memcpy(pmlmeinfo->ip_addr, &ifa->ifa_address, + RTW_IP_ADDR_LEN); + RTW_DBG("%s[%s]: up IP: %pI4\n", __func__, + ifa->ifa_label, pmlmeinfo->ip_addr); + break; + case NETDEV_DOWN: + _rtw_memset(pmlmeinfo->ip_addr, 0, RTW_IP_ADDR_LEN); + RTW_DBG("%s[%s]: down IP: %pI4\n", __func__, + ifa->ifa_label, pmlmeinfo->ip_addr); + break; + default: + RTW_DBG("%s: default action\n", __func__); + break; + } + return NOTIFY_DONE; +} + +#ifdef CONFIG_IPV6 +static int rtw_inet6addr_notifier_call(struct notifier_block *nb, + unsigned long action, void *data) +{ + struct inet6_ifaddr *inet6_ifa = data; + struct net_device *ndev; + struct ipv6_addr *_ipv6_addr = NULL; + struct pwrctrl_priv *pwrctl = NULL; + struct mlme_ext_priv *pmlmeext = NULL; + struct mlme_ext_info *pmlmeinfo = NULL; + _adapter *adapter = NULL; + + if (!inet6_ifa || !inet6_ifa->idev || !inet6_ifa->idev->dev) + return NOTIFY_DONE; + + ndev = inet6_ifa->idev->dev; + + if (!is_rtw_ndev(ndev)) + return NOTIFY_DONE; + + adapter = (_adapter *)rtw_netdev_priv(inet6_ifa->idev->dev); + + if (adapter == NULL) + return NOTIFY_DONE; + + pmlmeext = &adapter->mlmeextpriv; + pmlmeinfo = &pmlmeext->mlmext_info; + pwrctl = adapter_to_pwrctl(adapter); + + pmlmeext = &adapter->mlmeextpriv; + pmlmeinfo = &pmlmeext->mlmext_info; + + switch (action) { + case NETDEV_UP: +#ifdef CONFIG_WOWLAN + pwrctl->wowlan_ns_offload_en = _TRUE; +#endif + _rtw_memcpy(pmlmeinfo->ip6_addr, &inet6_ifa->addr, + RTW_IPv6_ADDR_LEN); + RTW_DBG("%s: up IPv6 addrs: %pI6\n", __func__, + pmlmeinfo->ip6_addr); + break; + case NETDEV_DOWN: +#ifdef CONFIG_WOWLAN + pwrctl->wowlan_ns_offload_en = _FALSE; +#endif + _rtw_memset(pmlmeinfo->ip6_addr, 0, RTW_IPv6_ADDR_LEN); + RTW_DBG("%s: down IPv6 addrs: %pI6\n", __func__, + pmlmeinfo->ip6_addr); + break; + default: + RTW_DBG("%s: default action\n", __func__); + break; + } + return NOTIFY_DONE; +} +#endif + +static struct notifier_block rtw_inetaddr_notifier = { + .notifier_call = rtw_inetaddr_notifier_call +}; + +#ifdef CONFIG_IPV6 +static struct notifier_block rtw_inet6addr_notifier = { + .notifier_call = rtw_inet6addr_notifier_call +}; +#endif + +void rtw_inetaddr_notifier_register(void) +{ + RTW_INFO("%s\n", __func__); + register_inetaddr_notifier(&rtw_inetaddr_notifier); +#ifdef CONFIG_IPV6 + register_inet6addr_notifier(&rtw_inet6addr_notifier); +#endif +} + +void rtw_inetaddr_notifier_unregister(void) +{ + RTW_INFO("%s\n", __func__); + unregister_inetaddr_notifier(&rtw_inetaddr_notifier); +#ifdef CONFIG_IPV6 + unregister_inet6addr_notifier(&rtw_inet6addr_notifier); +#endif +} + int rtw_os_ndevs_register(struct dvobj_priv *dvobj) { int i, status = _SUCCESS; @@ -2687,6 +3118,9 @@ int _netdev_open(struct net_device *pnetdev) uint status; _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); struct pwrctrl_priv *pwrctrlpriv = adapter_to_pwrctl(padapter); +#if defined(CONFIG_PLATFORM_INTEL_BYT) && defined(CONFIG_SDIO_HCI) + struct sdio_func *func = padapter->dvobj->intf_data.func; +#endif /* CONFIG_PLATFORM_INTEL_BYT */ #ifdef CONFIG_BT_COEXIST_SOCKET_TRX HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); #endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ @@ -2696,14 +3130,12 @@ int _netdev_open(struct net_device *pnetdev) padapter->netif_up = _TRUE; -#ifdef CONFIG_PLATFORM_INTEL_BYT - rtw_sdio_set_power(1); -#endif /* CONFIG_PLATFORM_INTEL_BYT */ - + #ifdef CONFIG_AUTOSUSPEND if (pwrctrlpriv->ps_flag == _TRUE) { padapter->net_closed = _FALSE; goto netdev_open_normal_process; } + #endif if (padapter->bup == _FALSE) { #ifdef CONFIG_PLATFORM_INTEL_BYT @@ -2713,6 +3145,9 @@ int _netdev_open(struct net_device *pnetdev) #endif rtw_init_wifidirect_addrs(padapter, adapter_mac_addr(padapter), adapter_mac_addr(padapter)); _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); +#if defined(CONFIG_SDIO_HCI) + rtw_sdio_set_power(func,1); +#endif #endif /* CONFIG_PLATFORM_INTEL_BYT */ rtw_clr_surprise_removed(padapter); @@ -2728,11 +3163,13 @@ int _netdev_open(struct net_device *pnetdev) RTW_INFO("MAC Address = "MAC_FMT"\n", MAC_ARG(pnetdev->dev_addr)); +#ifndef RTW_HALMAC status = rtw_start_drv_threads(padapter); if (status == _FAIL) { RTW_INFO("Initialize driver software resource Failed!\n"); goto netdev_open_error; } +#endif /* !RTW_HALMAC */ #ifdef CONFIG_RTW_NAPI if(padapter->napi_state == NAPI_DISABLE) { @@ -2741,10 +3178,9 @@ int _netdev_open(struct net_device *pnetdev) } #endif -#ifdef CONFIG_DRVEXT_MODULE - init_drvext(padapter); -#endif +#ifndef RTW_HALMAC rtw_intf_start(padapter); +#endif /* !RTW_HALMAC */ #ifdef CONFIG_IOCTL_CFG80211 rtw_cfg80211_init_wiphy(padapter); @@ -2770,7 +3206,7 @@ int _netdev_open(struct net_device *pnetdev) rtw_set_pwr_state_check_timer(pwrctrlpriv); #endif - /* netif_carrier_on(pnetdev); */ /* call this func when rtw_joinbss_event_callback return success */ + /* rtw_netif_carrier_on(pnetdev); */ /* call this func when rtw_joinbss_event_callback return success */ rtw_netif_wake_queue(pnetdev); #ifdef CONFIG_BR_EXT @@ -2815,7 +3251,7 @@ int _netdev_open(struct net_device *pnetdev) } #endif - netif_carrier_off(pnetdev); + rtw_netif_carrier_off(pnetdev); rtw_netif_stop_queue(pnetdev); RTW_INFO("-871x_drv - drv_open fail, bup=%d\n", padapter->bup); @@ -2874,7 +3310,9 @@ int ips_netdrv_open(_adapter *padapter) #if 0 rtw_restore_mac_addr(padapter); #endif +#ifndef RTW_HALMAC rtw_intf_start(padapter); +#endif /* !RTW_HALMAC */ #ifndef CONFIG_IPS_CHECK_IN_WD rtw_set_pwr_state_check_timer(adapter_to_pwrctl(padapter)); @@ -2890,7 +3328,6 @@ int ips_netdrv_open(_adapter *padapter) return _FAIL; } - int rtw_ips_pwr_up(_adapter *padapter) { int result; @@ -2898,7 +3335,7 @@ int rtw_ips_pwr_up(_adapter *padapter) #ifdef DBG_CONFIG_ERROR_DETECT struct sreset_priv *psrtpriv = &pHalData->srestpriv; #endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); RTW_INFO("===> rtw_ips_pwr_up..............\n"); #if defined(CONFIG_SWLPS_IN_IPS) || defined(CONFIG_FWLPS_IN_IPS) @@ -2919,7 +3356,7 @@ int rtw_ips_pwr_up(_adapter *padapter) void rtw_ips_pwr_down(_adapter *padapter) { - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); RTW_INFO("===> rtw_ips_pwr_down...................\n"); padapter->net_closed = _TRUE; @@ -2954,7 +3391,6 @@ void rtw_ips_dev_unload(_adapter *padapter) } - int pm_netdev_open(struct net_device *pnetdev, u8 bnormal) { int status = 0; @@ -2982,17 +3418,22 @@ static int netdev_close(struct net_device *pnetdev) _adapter *padapter = (_adapter *)rtw_netdev_priv(pnetdev); struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; +#if defined(CONFIG_PLATFORM_INTEL_BYT) && defined(CONFIG_SDIO_HCI) + struct sdio_func *func = padapter->dvobj->intf_data.func; +#endif /* CONFIG_PLATFORM_INTEL_BYT */ #ifdef CONFIG_BT_COEXIST_SOCKET_TRX HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter); #endif /* CONFIG_BT_COEXIST_SOCKET_TRX */ RTW_INFO(FUNC_NDEV_FMT" , bup=%d\n", FUNC_NDEV_ARG(pnetdev), padapter->bup); #ifndef CONFIG_PLATFORM_INTEL_BYT + #ifdef CONFIG_AUTOSUSPEND if (pwrctl->bInternalAutoSuspend == _TRUE) { /* rtw_pwr_wakeup(padapter); */ if (pwrctl->rf_pwrstate == rf_off) pwrctl->ps_flag = _TRUE; } + #endif padapter->net_closed = _TRUE; padapter->netif_up = _FALSE; pmlmepriv->LinkDetectInfo.bBusyTraffic = _FALSE; @@ -3015,7 +3456,7 @@ static int netdev_close(struct net_device *pnetdev) #ifndef CONFIG_ANDROID /* s2. */ LeaveAllPowerSaveMode(padapter); - rtw_disassoc_cmd(padapter, 500, _FALSE); + rtw_disassoc_cmd(padapter, 500, RTW_CMDF_DIRECTLY); /* s2-2. indicate disconnect to os */ rtw_indicate_disconnect(padapter, 0, _FALSE); /* s2-3. */ @@ -3073,8 +3514,9 @@ static int netdev_close(struct net_device *pnetdev) rtw_msleep_os(1); rtw_dev_unload(padapter); - rtw_sdio_set_power(0); - +#if defined(CONFIG_SDIO_HCI) + rtw_sdio_set_power(func,0); +#endif #endif /* !CONFIG_PLATFORM_INTEL_BYT */ RTW_INFO("-871x_drv - drv_close, bup=%d\n", padapter->bup); @@ -3405,7 +3847,15 @@ void rtw_dev_unload(PADAPTER padapter) if (padapter->bup == _TRUE) { - RTW_INFO("===> %s\n", __FUNCTION__); + RTW_INFO("==> "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); + +#ifdef CONFIG_WOWLAN +#ifdef CONFIG_GPIO_WAKEUP + /*default wake up pin change to BT*/ + RTW_INFO("%s:default wake up pin change to BT\n", __FUNCTION__); + rtw_hal_switch_gpio_wl_ctrl(padapter, WAKEUP_GPIO_IDX, _FALSE); +#endif /* CONFIG_GPIO_WAKEUP */ +#endif /* CONFIG_WOWLAN */ rtw_set_drv_stopped(padapter); #ifdef CONFIG_XMIT_ACK @@ -3415,22 +3865,17 @@ void rtw_dev_unload(PADAPTER padapter) rtw_intf_stop(padapter); - + #ifdef CONFIG_AUTOSUSPEND if (!pwrctl->bInternalAutoSuspend) + #endif + { rtw_stop_drv_threads(padapter); - while (ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _TRUE) { - if (cnt > 5) { - RTW_INFO("stop cmdthd timeout\n"); - break; - } else { - cnt++; - RTW_INFO("cmdthd is running(%d)\n", cnt); - rtw_msleep_os(10); + if (ATOMIC_READ(&(pcmdpriv->cmdthd_running)) == _TRUE) { + RTW_ERR("cmd_thread not stop !!\n"); + rtw_warn_on(1); } } - - /* check the status of IPS */ if (rtw_hal_check_ips_status(padapter) == _TRUE || pwrctl->rf_pwrstate == rf_off) { /* check HW status and SW state */ RTW_PRINT("%s: driver in IPS-FWLPS\n", __func__); @@ -3457,7 +3902,7 @@ void rtw_dev_unload(PADAPTER padapter) padapter->bup = _FALSE; - RTW_INFO("<=== %s\n", __FUNCTION__); + RTW_INFO("<== "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter)); } else { RTW_INFO("%s: bup==_FALSE\n", __FUNCTION__); } @@ -3476,27 +3921,31 @@ int rtw_suspend_free_assoc_resource(_adapter *padapter) if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) { if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) - && check_fwstate(pmlmepriv, _FW_LINKED) -#ifdef CONFIG_P2P - && rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) -#endif /* CONFIG_P2P */ - ) { + && check_fwstate(pmlmepriv, _FW_LINKED) + #ifdef CONFIG_P2P + && (rtw_p2p_chk_state(pwdinfo, P2P_STATE_NONE) + #if defined(CONFIG_IOCTL_CFG80211) && RTW_P2P_GROUP_INTERFACE + || rtw_p2p_chk_role(pwdinfo, P2P_ROLE_DEVICE) + #endif + ) + #endif /* CONFIG_P2P */ + ) { RTW_INFO("%s %s(" MAC_FMT "), length:%d assoc_ssid.length:%d\n", __FUNCTION__, - pmlmepriv->cur_network.network.Ssid.Ssid, + pmlmepriv->cur_network.network.Ssid.Ssid, MAC_ARG(pmlmepriv->cur_network.network.MacAddress), - pmlmepriv->cur_network.network.Ssid.SsidLength, - pmlmepriv->assoc_ssid.SsidLength); + pmlmepriv->cur_network.network.Ssid.SsidLength, + pmlmepriv->assoc_ssid.SsidLength); rtw_set_to_roam(padapter, 1); } } if (check_fwstate(pmlmepriv, WIFI_STATION_STATE) && check_fwstate(pmlmepriv, _FW_LINKED)) { - rtw_disassoc_cmd(padapter, 0, _FALSE); + rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); /* s2-2. indicate disconnect to os */ rtw_indicate_disconnect(padapter, 0, _FALSE); } #ifdef CONFIG_AP_MODE - else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) + else if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) rtw_sta_flush(padapter, _TRUE); #endif @@ -3529,14 +3978,8 @@ int rtw_suspend_wow(_adapter *padapter) { u8 ch, bw, offset; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct net_device *pnetdev = padapter->pnetdev; - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct wowlan_ioctl_param poidparam; - int i; - _adapter *iface = NULL; u8 ps_mode; int ret = _SUCCESS; @@ -3550,43 +3993,38 @@ int rtw_suspend_wow(_adapter *padapter) #endif if (pwrpriv->wowlan_mode == _TRUE) { -#ifdef CONFIG_BT_COEXIST - rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); -#endif - - if (pnetdev) - rtw_netif_stop_queue(pnetdev); - rtw_mi_buddy_netif_stop_queue(padapter, _TRUE); + rtw_mi_netif_stop_queue(padapter); + #ifdef CONFIG_CONCURRENT_MODE + rtw_mi_buddy_netif_carrier_off(padapter); + #endif /* 0. Power off LED */ rtw_led_control(padapter, LED_CTL_POWER_OFF); + +#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) + /* 2.only for SDIO disable interrupt */ + rtw_intf_stop(padapter); + + /* 2.1 clean interrupt */ + rtw_hal_clear_interrupt(padapter); +#endif /* CONFIG_SDIO_HCI */ + /* 1. stop thread */ rtw_set_drv_stopped(padapter); /*for stop thread*/ - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if ((iface) && (iface->bup == _TRUE)) - rtw_stop_drv_threads(iface); - } + rtw_mi_stop_drv_threads(padapter); + rtw_clr_drv_stopped(padapter); /*for 32k command*/ /* #ifdef CONFIG_LPS */ /* rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); */ /* #endif */ -#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_GSPI_HCI) - /* 2. disable interrupt */ - rtw_mi_intf_stop(padapter); - - /* 2.1 clean interupt */ - rtw_hal_clear_interrupt(padapter); -#endif /* CONFIG_SDIO_HCI */ - + #ifdef CONFIG_SDIO_HCI /* 2.2 free irq */ - /* sdio_free_irq(adapter_to_dvobj(padapter)); */ -#ifndef CONFIG_RTW_SDIO_KEEP_IRQ - if (padapter->intf_free_irq) - padapter->intf_free_irq(adapter_to_dvobj(padapter)); -#endif + #if !(CONFIG_RTW_SDIO_KEEP_IRQ) + sdio_free_irq(adapter_to_dvobj(padapter)); + #endif + #endif/*CONFIG_SDIO_HCI*/ #ifdef CONFIG_RUNTIME_PORT_SWITCH if (rtw_port_switch_chk(padapter)) { @@ -3635,11 +4073,14 @@ int rtw_suspend_wow(_adapter *padapter) rtw_mi_update_union_chan_inf(padapter, ch, offset, bw); } #endif - #ifdef CONFIG_CONCURRENT_MODE rtw_mi_buddy_suspend_free_assoc_resource(padapter); #endif +#ifdef CONFIG_BT_COEXIST + rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); +#endif + if (pwrpriv->wowlan_pno_enable) { RTW_PRINT("%s: pno: %d\n", __func__, pwrpriv->wowlan_pno_enable); @@ -3648,8 +4089,12 @@ int rtw_suspend_wow(_adapter *padapter) #endif } #ifdef CONFIG_LPS - else - rtw_set_ps_mode(padapter, PS_MODE_MAX, 0, 0, "WOWLAN"); + else { + if (!(pwrpriv->wowlan_dis_lps)) { + rtw_wow_lps_level_decide(padapter, _TRUE); + rtw_set_ps_mode(padapter, PS_MODE_MAX, 0, 0, "WOWLAN"); + } + } #endif /* #ifdef CONFIG_LPS */ } else @@ -3664,13 +4109,8 @@ int rtw_suspend_ap_wow(_adapter *padapter) { u8 ch, bw, offset; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); - struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); struct wowlan_ioctl_param poidparam; - int i; - _adapter *iface = NULL; u8 ps_mode; int ret = _SUCCESS; @@ -3680,34 +4120,29 @@ int rtw_suspend_ap_wow(_adapter *padapter) RTW_INFO("wowlan_ap_mode: %d\n", pwrpriv->wowlan_ap_mode); -#ifdef CONFIG_BT_COEXIST - rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); -#endif - - rtw_mi_netif_stop_queue(padapter, _FALSE); + rtw_mi_netif_stop_queue(padapter); /* 0. Power off LED */ rtw_led_control(padapter, LED_CTL_POWER_OFF); - /* 1. stop thread */ - rtw_set_drv_stopped(padapter); /*for stop thread*/ - for (i = 0; i < dvobj->iface_nums; i++) { - iface = dvobj->padapters[i]; - if ((iface) && (iface->bup == _TRUE)) - rtw_stop_drv_threads(iface); - } - rtw_clr_drv_stopped(padapter); /*for 32k command*/ - #ifdef CONFIG_SDIO_HCI - /* 2. disable interrupt*/ - rtw_mi_intf_stop(padapter); + /* 2.only for SDIO disable interrupt*/ + rtw_intf_stop(padapter); - /* 2.1 clean interupt */ + /* 2.1 clean interrupt */ rtw_hal_clear_interrupt(padapter); #endif /* CONFIG_SDIO_HCI */ + /* 1. stop thread */ + rtw_set_drv_stopped(padapter); /*for stop thread*/ + rtw_mi_stop_drv_threads(padapter); + rtw_clr_drv_stopped(padapter); /*for 32k command*/ + + #ifdef CONFIG_SDIO_HCI /* 2.2 free irq */ - if (padapter->intf_free_irq) - padapter->intf_free_irq(adapter_to_dvobj(padapter)); + #if !(CONFIG_RTW_SDIO_KEEP_IRQ) + sdio_free_irq(adapter_to_dvobj(padapter)); + #endif + #endif/*CONFIG_SDIO_HCI*/ #ifdef CONFIG_RUNTIME_PORT_SWITCH if (rtw_port_switch_chk(padapter)) { @@ -3745,15 +4180,22 @@ int rtw_suspend_ap_wow(_adapter *padapter) for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if ((iface) && rtw_is_adapter_up(iface)) { - if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | _FW_LINKED)) - rtw_mi_buddy_suspend_free_assoc_resource(iface); + if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | WIFI_MESH_STATE) == _FALSE) + rtw_suspend_free_assoc_resource(iface); } } } +#ifdef CONFIG_BT_COEXIST + rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND_KEEP_ANT); +#endif + #ifdef CONFIG_LPS - rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN"); + if (!(pwrpriv->wowlan_dis_lps)) { + rtw_wow_lps_level_decide(padapter, _TRUE); + rtw_set_ps_mode(padapter, PS_MODE_MIN, 0, 0, "AP-WOWLAN"); + } #endif RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); @@ -3767,52 +4209,37 @@ int rtw_suspend_normal(_adapter *padapter) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); int ret = _SUCCESS; -#ifdef CONFIG_RTW_SDIO_KEEP_IRQ - struct dvobj_priv *pdvobj = adapter_to_dvobj(padapter); - struct sdio_func *func = pdvobj->intf_data.func; -#endif RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); #ifdef CONFIG_BT_COEXIST rtw_btcoex_SuspendNotify(padapter, BTCOEX_SUSPEND_STATE_SUSPEND); #endif - - rtw_mi_netif_stop_queue(padapter, _TRUE); + rtw_mi_netif_caroff_qstop(padapter); rtw_mi_suspend_free_assoc_resource(padapter); rtw_led_control(padapter, LED_CTL_POWER_OFF); -#if defined(CONFIG_FWLPS_IN_IPS) || defined(CONFIG_SWLPS_IN_IPS) if ((rtw_hal_check_ips_status(padapter) == _TRUE) || (adapter_to_pwrctl(padapter)->rf_pwrstate == rf_off)) RTW_PRINT("%s: ### ERROR #### driver in IPS ####ERROR###!!!\n", __FUNCTION__); -#endif + #ifdef CONFIG_CONCURRENT_MODE - rtw_mi_buddy_dev_unload(padapter); + rtw_set_drv_stopped(padapter); /*for stop thread*/ + rtw_stop_cmd_thread(padapter); + rtw_drv_stop_vir_ifaces(adapter_to_dvobj(padapter)); #endif rtw_dev_unload(padapter); - /* sdio_deinit(adapter_to_dvobj(padapter)); */ -#ifdef CONFIG_RTW_SDIO_KEEP_IRQ - if (func) { - int err; + #ifdef CONFIG_SDIO_HCI + sdio_deinit(adapter_to_dvobj(padapter)); - sdio_claim_host(func); - err = sdio_disable_func(func); - if (err) { - pdvobj->drv_dbg.dbg_sdio_deinit_error_cnt++; - RTW_INFO("%s: sdio_disable_func(%d)\n", __func__, err); - } - - sdio_release_host(func); - } -#else - if (padapter->intf_deinit) - padapter->intf_deinit(adapter_to_dvobj(padapter)); -#endif + #if !(CONFIG_RTW_SDIO_KEEP_IRQ) + sdio_free_irq(adapter_to_dvobj(padapter)); + #endif + #endif /*CONFIG_SDIO_HCI*/ RTW_INFO("<== "FUNC_ADPT_FMT" exit....\n", FUNC_ADPT_ARG(padapter)); return ret; @@ -3820,13 +4247,13 @@ int rtw_suspend_normal(_adapter *padapter) int rtw_suspend_common(_adapter *padapter) { - struct dvobj_priv *psdpriv = padapter->dvobj; - struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; - struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); + struct dvobj_priv *dvobj = padapter->dvobj; + struct debug_priv *pdbgpriv = &dvobj->drv_dbg; + struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(dvobj); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; int ret = 0; - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); RTW_PRINT(" suspend start\n"); RTW_INFO("==> %s (%s:%d)\n", __FUNCTION__, current->comm, current->pid); @@ -3859,7 +4286,6 @@ int rtw_suspend_common(_adapter *padapter) rtw_mi_cancel_all_timer(padapter); LeaveAllPowerSaveModeDirect(padapter); - rtw_stop_cmd_thread(padapter); rtw_ps_deny_cancel(padapter, PS_DENY_SUSPEND); @@ -3907,7 +4333,6 @@ int rtw_resume_process_wow(_adapter *padapter) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; struct mlme_ext_info *pmlmeinfo = &(pmlmeext->mlmext_info); - struct net_device *pnetdev = padapter->pnetdev; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; @@ -3918,7 +4343,6 @@ int rtw_resume_process_wow(_adapter *padapter) RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); if (padapter) { - pnetdev = padapter->pnetdev; pwrpriv = adapter_to_pwrctl(padapter); } else { pdbgpriv->dbg_resume_error_cnt++; @@ -3944,23 +4368,27 @@ int rtw_resume_process_wow(_adapter *padapter) if (pwrpriv->wowlan_mode == _TRUE) { #ifdef CONFIG_LPS - rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); + if (!(pwrpriv->wowlan_dis_lps)) { + rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "WOWLAN"); + rtw_wow_lps_level_decide(padapter, _FALSE); + } #endif /* CONFIG_LPS */ pwrpriv->bFwCurrentInPSMode = _FALSE; -#ifdef CONFIG_SDIO_HCI +#if defined(CONFIG_SDIO_HCI) || defined(CONFIG_PCI_HCI) rtw_mi_intf_stop(padapter); rtw_hal_clear_interrupt(padapter); -#endif /* CONFIG_SDIO_HCI */ +#endif -#ifndef CONFIG_RTW_SDIO_KEEP_IRQ - /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ - if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { + #ifdef CONFIG_SDIO_HCI + #if !(CONFIG_RTW_SDIO_KEEP_IRQ) + if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { ret = -1; goto exit; } -#endif + #endif + #endif/*CONFIG_SDIO_HCI*/ /* Disable WOW, set H2C command */ poidparam.subcode = WOWLAN_DISABLE; @@ -3987,8 +4415,8 @@ int rtw_resume_process_wow(_adapter *padapter) #endif /* start netif queue */ - if (pnetdev) - rtw_netif_wake_queue(pnetdev); + rtw_mi_netif_wake_queue(padapter); + } else RTW_PRINT("%s: ### ERROR ### wowlan_mode=%d\n", __FUNCTION__, pwrpriv->wowlan_mode); @@ -4028,19 +4456,6 @@ int rtw_resume_process_wow(_adapter *padapter) pwrpriv->wowlan_wake_reason == RX_DEAUTH) rtw_lock_ext_suspend_timeout(8000); - if (pwrpriv->wowlan_wake_reason == RX_PNO) { -#ifdef CONFIG_IOCTL_CFG80211 -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 2, 0)) - u8 locally_generated = 1; - - cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, locally_generated, GFP_ATOMIC); -#else - cfg80211_disconnected(padapter->pnetdev, 0, NULL, 0, GFP_ATOMIC); -#endif -#endif /* CONFIG_IOCTL_CFG80211 */ - rtw_lock_ext_suspend_timeout(10000); - } - if (pwrpriv->wowlan_mode == _TRUE) { pwrpriv->bips_processing = _FALSE; _set_timer(&adapter_to_dvobj(padapter)->dynamic_chk_timer, 2000); @@ -4053,7 +4468,7 @@ int rtw_resume_process_wow(_adapter *padapter) pwrpriv->wowlan_mode = _FALSE; /* Power On LED */ -#ifdef CONFIG_SW_LED +#ifdef CONFIG_RTW_SW_LED if (pwrpriv->wowlan_wake_reason == RX_DISASSOC|| pwrpriv->wowlan_wake_reason == RX_DEAUTH|| @@ -4080,7 +4495,6 @@ int rtw_resume_process_wow(_adapter *padapter) int rtw_resume_process_ap_wow(_adapter *padapter) { struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct net_device *pnetdev = padapter->pnetdev; struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct dvobj_priv *psdpriv = padapter->dvobj; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; @@ -4092,7 +4506,6 @@ int rtw_resume_process_ap_wow(_adapter *padapter) RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); if (padapter) { - pnetdev = padapter->pnetdev; pwrpriv = adapter_to_pwrctl(padapter); } else { pdbgpriv->dbg_resume_error_cnt++; @@ -4102,7 +4515,10 @@ int rtw_resume_process_ap_wow(_adapter *padapter) #ifdef CONFIG_LPS - rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN"); + if (!(pwrpriv->wowlan_dis_lps)) { + rtw_set_ps_mode(padapter, PS_MODE_ACTIVE, 0, 0, "AP-WOWLAN"); + rtw_wow_lps_level_decide(padapter, _FALSE); + } #endif /* CONFIG_LPS */ pwrpriv->bFwCurrentInPSMode = _FALSE; @@ -4111,12 +4527,14 @@ int rtw_resume_process_ap_wow(_adapter *padapter) rtw_hal_clear_interrupt(padapter); - /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { */ - if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { + #ifdef CONFIG_SDIO_HCI + #if !(CONFIG_RTW_SDIO_KEEP_IRQ) + if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { ret = -1; goto exit; } - + #endif + #endif/*CONFIG_SDIO_HCI*/ /* Disable WOW, set H2C command */ poidparam.subcode = WOWLAN_AP_DISABLE; rtw_hal_set_hwreg(padapter, HW_VAR_WOWLAN, (u8 *)&poidparam); @@ -4152,13 +4570,15 @@ int rtw_resume_process_ap_wow(_adapter *padapter) for (i = 0; i < dvobj->iface_nums; i++) { iface = dvobj->padapters[i]; if ((iface) && rtw_is_adapter_up(iface)) { - if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | _FW_LINKED)) - rtw_mi_buddy_reset_drv_sw(iface); + if (check_fwstate(&iface->mlmepriv, WIFI_AP_STATE | WIFI_MESH_STATE | _FW_LINKED)) + rtw_reset_drv_sw(iface); } } } rtw_mi_intf_start(padapter); + + /* start netif queue */ rtw_mi_netif_wake_queue(padapter); if (padapter->pid[1] != 0) { @@ -4186,7 +4606,7 @@ int rtw_resume_process_ap_wow(_adapter *padapter) #endif /* CONFIG_BT_COEXIST */ /* Power On LED */ -#ifdef CONFIG_SW_LED +#ifdef CONFIG_RTW_SW_LED rtw_led_control(padapter, LED_CTL_LINK); #endif @@ -4209,18 +4629,18 @@ void rtw_mi_resume_process_normal(_adapter *padapter) pmlmepriv = &iface->mlmepriv; if (check_fwstate(pmlmepriv, WIFI_STATION_STATE)) { - RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); + RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_STATION_STATE\n", FUNC_ADPT_ARG(iface), get_fwstate(pmlmepriv)); - if (rtw_chk_roam_flags(padapter, RTW_ROAM_ON_RESUME)) - rtw_roaming(padapter, NULL); + if (rtw_chk_roam_flags(iface, RTW_ROAM_ON_RESUME)) + rtw_roaming(iface, NULL); - } else if (check_fwstate(pmlmepriv, WIFI_AP_STATE)) { - RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_AP_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); - rtw_ap_restore_network(padapter); + } else if (MLME_IS_AP(iface) || MLME_IS_MESH(iface)) { + RTW_INFO(FUNC_ADPT_FMT" %s\n", FUNC_ADPT_ARG(iface), MLME_IS_AP(iface) ? "AP" : "MESH"); + rtw_ap_restore_network(iface); } else if (check_fwstate(pmlmepriv, WIFI_ADHOC_STATE)) - RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); + RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - WIFI_ADHOC_STATE\n", FUNC_ADPT_ARG(iface), get_fwstate(pmlmepriv)); else - RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(padapter), get_fwstate(pmlmepriv)); + RTW_INFO(FUNC_ADPT_FMT" fwstate:0x%08x - ???\n", FUNC_ADPT_ARG(iface), get_fwstate(pmlmepriv)); } } } @@ -4245,20 +4665,26 @@ int rtw_resume_process_normal(_adapter *padapter) pdbgpriv = &psdpriv->drv_dbg; RTW_INFO("==> "FUNC_ADPT_FMT" entry....\n", FUNC_ADPT_ARG(padapter)); + + #ifdef CONFIG_SDIO_HCI /* interface init */ - /* if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) */ - if ((padapter->intf_init) && (padapter->intf_init(adapter_to_dvobj(padapter)) != _SUCCESS)) { + if (sdio_init(adapter_to_dvobj(padapter)) != _SUCCESS) { ret = -1; goto exit; } + #endif/*CONFIG_SDIO_HCI*/ + + rtw_clr_surprise_removed(padapter); rtw_hal_disable_interrupt(padapter); -#ifndef CONFIG_RTW_SDIO_KEEP_IRQ - /* if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) */ - if ((padapter->intf_alloc_irq) && (padapter->intf_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS)) { + + #ifdef CONFIG_SDIO_HCI + #if !(CONFIG_RTW_SDIO_KEEP_IRQ) + if (sdio_alloc_irq(adapter_to_dvobj(padapter)) != _SUCCESS) { ret = -1; goto exit; } -#endif + #endif + #endif/*CONFIG_SDIO_HCI*/ rtw_mi_reset_drv_sw(padapter); @@ -4271,7 +4697,7 @@ int rtw_resume_process_normal(_adapter *padapter) goto exit; } - rtw_mi_netif_carrier_on(padapter); + rtw_mi_netif_caron_qstart(padapter); if (padapter->pid[1] != 0) { RTW_INFO("pid[1]:%d\n", padapter->pid[1]); @@ -4296,7 +4722,7 @@ int rtw_resume_process_normal(_adapter *padapter) int rtw_resume_common(_adapter *padapter) { int ret = 0; - u32 start_time = rtw_get_current_time(); + systime start_time = rtw_get_current_time(); struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); struct mlme_priv *pmlmepriv = &padapter->mlmepriv; @@ -4325,9 +4751,7 @@ int rtw_resume_common(_adapter *padapter) if (pwrpriv) { pwrpriv->bInSuspend = _FALSE; -#ifdef CONFIG_WOWLAN pwrpriv->wowlan_in_resume = _FALSE; -#endif } RTW_PRINT("%s:%d in %d ms\n", __FUNCTION__ , ret, rtw_get_passing_time_ms(start_time)); @@ -4374,3 +4798,23 @@ int rtw_disable_gpio_interrupt(struct net_device *netdev, int gpio_num) EXPORT_SYMBOL(rtw_disable_gpio_interrupt); #endif /* #ifdef CONFIG_GPIO_API */ + +#ifdef CONFIG_APPEND_VENDOR_IE_ENABLE + +int rtw_vendor_ie_get_api(struct net_device *dev, int ie_num, char *extra, + u16 extra_len) +{ + int ret = 0; + + ret = rtw_vendor_ie_get_raw_data(dev, ie_num, extra, extra_len); + return ret; +} +EXPORT_SYMBOL(rtw_vendor_ie_get_api); + +int rtw_vendor_ie_set_api(struct net_device *dev, char *extra) +{ + return rtw_vendor_ie_set(dev, NULL, NULL, extra); +} +EXPORT_SYMBOL(rtw_vendor_ie_set_api); + +#endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/recv_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/recv_linux.c index 3f2c0703511d..9f4dbead9a39 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/recv_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/recv_linux.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _RECV_OSDEP_C_ #include @@ -166,8 +161,7 @@ int rtw_os_alloc_recvframe(_adapter *padapter, union recv_frame *precvframe, u8 void rtw_os_free_recvframe(union recv_frame *precvframe) { if (precvframe->u.hdr.pkt) { - rtw_skb_free(precvframe->u.hdr.pkt);/* free skb by driver */ - + rtw_os_pkt_free(precvframe->u.hdr.pkt); precvframe->u.hdr.pkt = NULL; } } @@ -190,7 +184,7 @@ int rtw_os_recv_resource_alloc(_adapter *padapter, union recv_frame *precvframe) { int res = _SUCCESS; - precvframe->u.hdr.pkt_newalloc = precvframe->u.hdr.pkt = NULL; + precvframe->u.hdr.pkt = NULL; return res; } @@ -210,10 +204,7 @@ void rtw_os_recv_resource_free(struct recv_priv *precvpriv) #endif /* CONFIG_RTW_NAPI */ for (i = 0; i < NR_RECVFRAME; i++) { - if (precvframe->u.hdr.pkt) { - rtw_skb_free(precvframe->u.hdr.pkt);/* free skb by driver */ - precvframe->u.hdr.pkt = NULL; - } + rtw_os_free_recvframe(precvframe); precvframe++; } } @@ -300,9 +291,9 @@ _pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 pattrib = &prframe->u.hdr.attrib; #ifdef CONFIG_SKB_COPY - sub_skb = rtw_skb_alloc(nSubframe_Length + 12); + sub_skb = rtw_skb_alloc(nSubframe_Length + 14); if (sub_skb) { - skb_reserve(sub_skb, 12); + skb_reserve(sub_skb, 14); data_ptr = (u8 *)skb_put(sub_skb, nSubframe_Length); _rtw_memcpy(data_ptr, (pdata + ETH_HLEN), nSubframe_Length); } else @@ -327,15 +318,15 @@ _pkt *rtw_os_alloc_msdu_pkt(union recv_frame *prframe, u16 nSubframe_Length, u8 _rtw_memcmp(sub_skb->data, rtw_bridge_tunnel_header, SNAP_SIZE))) { /* remove RFC1042 or Bridge-Tunnel encapsulation and replace EtherType */ skb_pull(sub_skb, SNAP_SIZE); - _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); - _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pdata + 6, ETH_ALEN); + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pdata, ETH_ALEN); } else { u16 len; /* Leave Ethernet header part of hdr and full payload */ len = htons(sub_skb->len); _rtw_memcpy(skb_push(sub_skb, 2), &len, 2); - _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->src, ETH_ALEN); - _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pattrib->dst, ETH_ALEN); + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pdata + 6, ETH_ALEN); + _rtw_memcpy(skb_push(sub_skb, ETH_ALEN), pdata, ETH_ALEN); } return sub_skb; @@ -400,11 +391,7 @@ int rtw_recv_napi_poll(struct napi_struct *napi, int budget) } #endif /* CONFIG_RTW_NAPI */ -#ifdef DBG_UDP_PKT_LOSE_11AC - #define PAYLOAD_LEN_LOC_OF_IP_HDR 0x10 /*ethernet payload length location of ip header (DA + SA+eth_type+(version&hdr_len)) */ -#endif - -void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attrib *pattrib) +void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, union recv_frame *rframe) { struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct recv_priv *precvpriv = &(padapter->recvpriv); @@ -416,22 +403,26 @@ void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attri /* Indicat the packets to upper layer */ if (pkt) { - if (check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE) { + struct ethhdr *ehdr = (struct ethhdr *)pkt->data; + + DBG_COUNTER(padapter->rx_logs.os_indicate); + + if (MLME_IS_AP(padapter)) { _pkt *pskb2 = NULL; struct sta_info *psta = NULL; struct sta_priv *pstapriv = &padapter->stapriv; - int bmcast = IS_MCAST(pattrib->dst); + int bmcast = IS_MCAST(ehdr->h_dest); /* RTW_INFO("bmcast=%d\n", bmcast); */ - if (_rtw_memcmp(pattrib->dst, adapter_mac_addr(padapter), ETH_ALEN) == _FALSE) { - /* RTW_INFO("not ap psta=%p, addr=%pM\n", psta, pattrib->dst); */ + if (_rtw_memcmp(ehdr->h_dest, adapter_mac_addr(padapter), ETH_ALEN) == _FALSE) { + /* RTW_INFO("not ap psta=%p, addr=%pM\n", psta, ehdr->h_dest); */ if (bmcast) { psta = rtw_get_bcmc_stainfo(padapter); pskb2 = rtw_skb_clone(pkt); } else - psta = rtw_get_stainfo(pstapriv, pattrib->dst); + psta = rtw_get_stainfo(pstapriv, ehdr->h_dest); if (psta) { struct net_device *pnetdev = (struct net_device *)padapter->pnetdev; @@ -440,9 +431,9 @@ void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attri /* skb->ip_summed = CHECKSUM_NONE; */ pkt->dev = pnetdev; -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) + #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35)) skb_set_queue_mapping(pkt, rtw_recv_select_queue(pkt)); -#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) */ + #endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) */ _rtw_xmit_entry(pkt, pnetdev); @@ -461,67 +452,50 @@ void rtw_os_recv_indicate_pkt(_adapter *padapter, _pkt *pkt, struct rx_pkt_attri } #ifdef CONFIG_BR_EXT - /* Insert NAT2.5 RX here! */ -#if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) - br_port = padapter->pnetdev->br_port; -#else /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ - rcu_read_lock(); - br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); - rcu_read_unlock(); -#endif /* (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) */ + if (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE) { + /* Insert NAT2.5 RX here! */ + #if (LINUX_VERSION_CODE <= KERNEL_VERSION(2, 6, 35)) + br_port = padapter->pnetdev->br_port; + #else + rcu_read_lock(); + br_port = rcu_dereference(padapter->pnetdev->rx_handler_data); + rcu_read_unlock(); + #endif + if (br_port) { + int nat25_handle_frame(_adapter *priv, struct sk_buff *skb); - if (br_port && (check_fwstate(pmlmepriv, WIFI_STATION_STATE | WIFI_ADHOC_STATE) == _TRUE)) { - int nat25_handle_frame(_adapter *priv, struct sk_buff *skb); - if (nat25_handle_frame(padapter, pkt) == -1) { - /* priv->ext_stats.rx_data_drops++; */ - /* DEBUG_ERR("RX DROP: nat25_handle_frame fail!\n"); */ - /* return FAIL; */ + if (nat25_handle_frame(padapter, pkt) == -1) { + /* priv->ext_stats.rx_data_drops++; */ + /* DEBUG_ERR("RX DROP: nat25_handle_frame fail!\n"); */ + /* return FAIL; */ -#if 1 - /* bypass this frame to upper layer!! */ -#else - rtw_skb_free(sub_skb); - continue; -#endif + #if 1 + /* bypass this frame to upper layer!! */ + #else + rtw_skb_free(sub_skb); + continue; + #endif + } } } #endif /* CONFIG_BR_EXT */ - if (precvpriv->sink_udpport > 0) - rtw_sink_rtp_seq_dbg(padapter, pkt); -#ifdef DBG_UDP_PKT_LOSE_11AC - /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header , - * we have to check ethernet type , so this debug must be print before eth_type_trans - */ - if (*((unsigned short *)(pkt->data + ETH_ALEN * 2)) == htons(ETH_P_ARP)) { - /* ARP Payload length will be 42bytes or 42+18(tailer)=60bytes*/ - if (pkt->len != 42 && pkt->len != 60) - RTW_INFO("Error !!%s,ARP Payload length %u not correct\n" , __func__ , pkt->len); - } else if (*((unsigned short *)(pkt->data + ETH_ALEN * 2)) == htons(ETH_P_IP)) { - if (be16_to_cpu(*((u16 *)(pkt->data + PAYLOAD_LEN_LOC_OF_IP_HDR))) != (pkt->len) - ETH_HLEN) { - RTW_INFO("Error !!%s,Payload length not correct\n" , __func__); - RTW_INFO("%s, IP header describe Total length=%u\n" , __func__ , be16_to_cpu(*((u16 *)(pkt->data + PAYLOAD_LEN_LOC_OF_IP_HDR)))); - RTW_INFO("%s, Pkt real length=%u\n" , __func__ , (pkt->len) - ETH_HLEN); - } - } -#endif + /* After eth_type_trans process , pkt->data pointer will move from ethrnet header to ip header */ pkt->protocol = eth_type_trans(pkt, padapter->pnetdev); pkt->dev = padapter->pnetdev; - -#ifdef CONFIG_TCP_CSUM_OFFLOAD_RX - if ((pattrib->tcpchk_valid == 1) && (pattrib->tcp_chkrpt == 1)) - pkt->ip_summed = CHECKSUM_UNNECESSARY; - else - pkt->ip_summed = CHECKSUM_NONE; -#else /* !CONFIG_TCP_CSUM_OFFLOAD_RX */ - pkt->ip_summed = CHECKSUM_NONE; -#endif /* CONFIG_TCP_CSUM_OFFLOAD_RX */ + pkt->ip_summed = CHECKSUM_NONE; /* CONFIG_TCP_CSUM_OFFLOAD_RX */ #ifdef CONFIG_RTW_NAPI - if (pregistrypriv->en_napi) { + if (pregistrypriv->en_napi + #ifdef CONFIG_RTW_NAPI_DYNAMIC + && adapter_to_dvobj(padapter)->en_napi_dynamic + #endif + ) { skb_queue_tail(&precvpriv->rx_napi_skb_queue, pkt); + #ifndef CONFIG_RTW_NAPI_V2 napi_schedule(&padapter->napi); + #endif return; } #endif /* CONFIG_RTW_NAPI */ @@ -543,7 +517,7 @@ void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup struct iw_michaelmicfailure ev; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; struct security_priv *psecuritypriv = &padapter->securitypriv; - u32 cur_time = 0; + systime cur_time = 0; if (psecuritypriv->last_mic_err_time == 0) psecuritypriv->last_mic_err_time = rtw_get_current_time(); @@ -564,7 +538,7 @@ void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup else key_type |= NL80211_KEYTYPE_PAIRWISE; - cfg80211_michael_mic_failure(padapter->pnetdev, sta->hwaddr, key_type, -1, NULL, GFP_ATOMIC); + cfg80211_michael_mic_failure(padapter->pnetdev, sta->cmn.mac_addr, key_type, -1, NULL, GFP_ATOMIC); #endif _rtw_memset(&ev, 0x00, sizeof(ev)); @@ -574,7 +548,7 @@ void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup ev.flags |= IW_MICFAILURE_PAIRWISE; ev.src_addr.sa_family = ARPHRD_ETHER; - _rtw_memcpy(ev.src_addr.sa_data, sta->hwaddr, ETH_ALEN); + _rtw_memcpy(ev.src_addr.sa_data, sta->cmn.mac_addr, ETH_ALEN); _rtw_memset(&wrqu, 0x00, sizeof(wrqu)); wrqu.data.length = sizeof(ev); @@ -584,9 +558,9 @@ void rtw_handle_tkip_mic_err(_adapter *padapter, struct sta_info *sta, u8 bgroup #endif } +#ifdef CONFIG_HOSTAPD_MLME void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame) { -#ifdef CONFIG_HOSTAPD_MLME _pkt *skb; struct hostapd_priv *phostapdpriv = padapter->phostapdpriv; struct net_device *pmgnt_netdev = phostapdpriv->pmgnt_netdev; @@ -621,52 +595,8 @@ void rtw_hostapd_mlme_rx(_adapter *padapter, union recv_frame *precv_frame) rtw_netif_rx(pmgnt_netdev, skb); precv_frame->u.hdr.pkt = NULL; /* set pointer to NULL before rtw_free_recvframe() if call rtw_netif_rx() */ -#endif } - -#ifdef CONFIG_AUTO_AP_MODE -static void rtw_os_ksocket_send(_adapter *padapter, union recv_frame *precv_frame) -{ - _pkt *skb = precv_frame->u.hdr.pkt; - struct rx_pkt_attrib *pattrib = &precv_frame->u.hdr.attrib; - struct sta_info *psta = precv_frame->u.hdr.psta; - - RTW_INFO("eth rx: got eth_type=0x%x\n", pattrib->eth_type); - - if (psta && psta->isrc && psta->pid > 0) { - u16 rx_pid; - - rx_pid = *(u16 *)(skb->data + ETH_HLEN); - - RTW_INFO("eth rx(pid=0x%x): sta("MAC_FMT") pid=0x%x\n", - rx_pid, MAC_ARG(psta->hwaddr), psta->pid); - - if (rx_pid == psta->pid) { - int i; - u16 len = *(u16 *)(skb->data + ETH_HLEN + 2); - /* u16 ctrl_type = *(u16*)(skb->data+ETH_HLEN+4); */ - - /* RTW_INFO("eth, RC: len=0x%x, ctrl_type=0x%x\n", len, ctrl_type); */ - RTW_INFO("eth, RC: len=0x%x\n", len); - - for (i = 0; i < len; i++) - RTW_INFO("0x%x\n", *(skb->data + ETH_HLEN + 4 + i)); - /* RTW_INFO("0x%x\n", *(skb->data+ETH_HLEN+6+i)); */ - - RTW_INFO("eth, RC-end\n"); - -#if 0 - /* send_sz = ksocket_send(padapter->ksock_send, &padapter->kaddr_send, (skb->data+ETH_HLEN+2), len); */ - rtw_recv_ksocket_send_cmd(padapter, (skb->data + ETH_HLEN + 2), len); - - /* RTW_INFO("ksocket_send size=%d\n", send_sz); */ -#endif - } - - } - -} -#endif /* CONFIG_AUTO_AP_MODE */ +#endif /* CONFIG_HOSTAPD_MLME */ int rtw_recv_monitor(_adapter *padapter, union recv_frame *precv_frame) { @@ -720,130 +650,29 @@ int rtw_recv_indicatepkt(_adapter *padapter, union recv_frame *precv_frame) _queue *pfree_recv_queue; _pkt *skb; struct mlme_priv *pmlmepriv = &padapter->mlmepriv; - struct rx_pkt_attrib *pattrib; - if (NULL == precv_frame) - goto _recv_indicatepkt_drop; - - DBG_COUNTER(padapter->rx_logs.os_indicate); - pattrib = &precv_frame->u.hdr.attrib; precvpriv = &(padapter->recvpriv); pfree_recv_queue = &(precvpriv->free_recv_queue); -#ifdef CONFIG_DRVEXT_MODULE - if (drvext_rx_handler(padapter, precv_frame->u.hdr.rx_data, precv_frame->u.hdr.len) == _SUCCESS) - goto _recv_indicatepkt_drop; -#endif - -#ifdef CONFIG_WAPI_SUPPORT - if (rtw_wapi_check_for_drop(padapter, precv_frame)) { - WAPI_TRACE(WAPI_ERR, "%s(): Rx Reorder Drop case!!\n", __FUNCTION__); - goto _recv_indicatepkt_drop; - } -#endif - skb = precv_frame->u.hdr.pkt; - if (skb == NULL) { + if (skb == NULL) goto _recv_indicatepkt_drop; - } - skb->data = precv_frame->u.hdr.rx_data; - skb_set_tail_pointer(skb, precv_frame->u.hdr.len); - skb->len = precv_frame->u.hdr.len; - - if (pattrib->eth_type == 0x888e) - RTW_PRINT("recv eapol packet\n"); - -#ifdef CONFIG_AUTO_AP_MODE -#if 1 /* for testing */ -#if 1 - if (0x8899 == pattrib->eth_type) { - rtw_os_ksocket_send(padapter, precv_frame); - - /* goto _recv_indicatepkt_drop; */ - } -#else - if (0x8899 == pattrib->eth_type) { - rtw_auto_ap_mode_rx(padapter, precv_frame); - - goto _recv_indicatepkt_end; - } -#endif -#endif -#endif /* CONFIG_AUTO_AP_MODE */ - - /* TODO: move to core */ - { - _pkt *pkt = skb; - struct ethhdr *etherhdr = (struct ethhdr *)pkt->data; - struct sta_info *sta = precv_frame->u.hdr.psta; - - if (!sta) - goto bypass_session_tracker; - - if (ntohs(etherhdr->h_proto) == ETH_P_IP) { - u8 *ip = pkt->data + 14; - - if (GET_IPV4_PROTOCOL(ip) == 0x06 /* TCP */ - && rtw_st_ctl_chk_reg_s_proto(&sta->st_ctl, 0x06) == _TRUE - ) { - u8 *tcp = ip + GET_IPV4_IHL(ip) * 4; - - if (rtw_st_ctl_chk_reg_rule(&sta->st_ctl, padapter, IPV4_DST(ip), TCP_DST(tcp), IPV4_SRC(ip), TCP_SRC(tcp)) == _TRUE) { - if (GET_TCP_SYN(tcp) && GET_TCP_ACK(tcp)) { - session_tracker_add_cmd(padapter, sta - , IPV4_DST(ip), TCP_DST(tcp) - , IPV4_SRC(ip), TCP_SRC(tcp)); - if (DBG_SESSION_TRACKER) - RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" SYN-ACK\n" - , FUNC_ADPT_ARG(padapter) - , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) - , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); - } - if (GET_TCP_FIN(tcp)) { - session_tracker_del_cmd(padapter, sta - , IPV4_DST(ip), TCP_DST(tcp) - , IPV4_SRC(ip), TCP_SRC(tcp)); - if (DBG_SESSION_TRACKER) - RTW_INFO(FUNC_ADPT_FMT" local:"IP_FMT":"PORT_FMT", remote:"IP_FMT":"PORT_FMT" FIN\n" - , FUNC_ADPT_ARG(padapter) - , IP_ARG(IPV4_DST(ip)), PORT_ARG(TCP_DST(tcp)) - , IP_ARG(IPV4_SRC(ip)), PORT_ARG(TCP_SRC(tcp))); - } - } - - } - } -bypass_session_tracker: - ; - } - - rtw_os_recv_indicate_pkt(padapter, skb, pattrib); + rtw_os_recv_indicate_pkt(padapter, skb, precv_frame); _recv_indicatepkt_end: - - precv_frame->u.hdr.pkt = NULL; /* pointers to NULL before rtw_free_recvframe() */ - + precv_frame->u.hdr.pkt = NULL; rtw_free_recvframe(precv_frame, pfree_recv_queue); - - - return _SUCCESS; _recv_indicatepkt_drop: - - /* enqueue back to free_recv_queue */ - if (precv_frame) - rtw_free_recvframe(precv_frame, pfree_recv_queue); - + rtw_free_recvframe(precv_frame, pfree_recv_queue); DBG_COUNTER(padapter->rx_logs.os_indicate_err); - return _FAIL; - } void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf) @@ -869,17 +698,4 @@ void rtw_os_read_port(_adapter *padapter, struct recv_buf *precvbuf) #endif } -void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext); -void _rtw_reordering_ctrl_timeout_handler(void *FunctionContext) -{ - struct recv_reorder_ctrl *preorder_ctrl = (struct recv_reorder_ctrl *)FunctionContext; - rtw_reordering_ctrl_timeout_handler(preorder_ctrl); -} -void rtw_init_recv_timer(struct recv_reorder_ctrl *preorder_ctrl) -{ - _adapter *padapter = preorder_ctrl->padapter; - - _init_timer(&(preorder_ctrl->reordering_ctrl_timer), padapter->pnetdev, _rtw_reordering_ctrl_timeout_handler, preorder_ctrl); - -} diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_android.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_android.c index ef42e500282d..ec939344b05e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_android.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_android.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifdef CONFIG_GPIO_WAKEUP #include @@ -310,7 +305,10 @@ int rtw_android_cfg80211_pno_setup(struct net_device *net, memcpy(pno_ssids_local[index].SSID, ssids[index].ssid, ssids[index].ssid_len); } - +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 2, 0) + if(ssids) + rtw_mfree((u8 *)ssids, (n_ssids * sizeof(struct cfg80211_ssid))); +#endif pno_time = (interval / 1000); RTW_INFO("%s: nssids: %d, pno_time=%d\n", __func__, nssid, pno_time); @@ -593,7 +591,11 @@ int rtw_android_priv_cmd(struct net_device *net, struct ifreq *ifr, int cmd) goto exit; } #ifdef CONFIG_COMPAT +#if (KERNEL_VERSION(4, 6, 0) > LINUX_VERSION_CODE) if (is_compat_task()) { +#else + if (in_compat_syscall()) { +#endif /* User space is 32-bit, use compat ioctl */ compat_android_wifi_priv_cmd compat_priv_cmd; @@ -1052,8 +1054,8 @@ static int wifi_probe(struct platform_device *pdev) wifi_wake_gpio = wifi_irqres->start; #ifdef CONFIG_GPIO_WAKEUP - printk("%s: gpio:%d wifi_wake_gpio:%d\n", __func__, - wifi_irqres->start, wifi_wake_gpio); + RTW_INFO("%s: gpio:%d wifi_wake_gpio:%d\n", __func__, + (int)wifi_irqres->start, wifi_wake_gpio); if (wifi_wake_gpio > 0) { #ifdef CONFIG_PLATFORM_INTEL_BYT @@ -1063,91 +1065,21 @@ static int wifi_probe(struct platform_device *pdev) gpio_direction_input(wifi_wake_gpio); oob_irq = gpio_to_irq(wifi_wake_gpio); #endif /* CONFIG_PLATFORM_INTEL_BYT */ - printk("%s oob_irq:%d\n", __func__, oob_irq); + RTW_INFO("%s oob_irq:%d\n", __func__, oob_irq); } else if (wifi_irqres) { oob_irq = wifi_irqres->start; - printk("%s oob_irq:%d\n", __func__, oob_irq); + RTW_INFO("%s oob_irq:%d\n", __func__, oob_irq); } #endif wifi_control_data = wifi_ctrl; wifi_set_power(1, 0); /* Power On */ wifi_set_carddetect(1); /* CardDetect (0->1) */ - - if (oob_irq != 0) - enable_irq_wake(oob_irq); up(&wifi_control_sem); return 0; } -#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -extern PADAPTER g_test_adapter; - -static void shutdown_card(void) -{ - u32 addr; - u8 tmp8, cnt = 0; - - if (NULL == g_test_adapter) { - RTW_INFO("%s: padapter==NULL\n", __FUNCTION__); - return; - } - -#ifdef CONFIG_FWLPS_IN_IPS - LeaveAllPowerSaveMode(g_test_adapter); -#endif /* CONFIG_FWLPS_IN_IPS */ - - /* Leave SDIO HCI Suspend */ - addr = 0x10250086; - rtw_write8(g_test_adapter, addr, 0); - do { - tmp8 = rtw_read8(g_test_adapter, addr); - cnt++; - RTW_INFO(FUNC_ADPT_FMT ": polling SDIO_HSUS_CTRL(0x%x)=0x%x, cnt=%d\n", - FUNC_ADPT_ARG(g_test_adapter), addr, tmp8, cnt); - - if (tmp8 & BIT(1)) - break; - - if (cnt >= 100) { - RTW_INFO(FUNC_ADPT_FMT ": polling 0x%x[1]==1 FAIL!!\n", - FUNC_ADPT_ARG(g_test_adapter), addr); - break; - } - - rtw_mdelay_os(10); - } while (1); - - /* unlock register I/O */ - rtw_write8(g_test_adapter, 0x1C, 0); - - /* enable power down function */ - /* 0x04[4] = 1 */ - /* 0x05[7] = 1 */ - addr = 0x04; - tmp8 = rtw_read8(g_test_adapter, addr); - tmp8 |= BIT(4); - rtw_write8(g_test_adapter, addr, tmp8); - RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", - FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); - - addr = 0x05; - tmp8 = rtw_read8(g_test_adapter, addr); - tmp8 |= BIT(7); - rtw_write8(g_test_adapter, addr, tmp8); - RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", - FUNC_ADPT_ARG(g_test_adapter), addr, rtw_read8(g_test_adapter, addr)); - - /* lock register page0 0x0~0xB read/write */ - rtw_write8(g_test_adapter, 0x1C, 0x0E); - - rtw_set_surprise_removed(g_test_adapter); - RTW_INFO(FUNC_ADPT_FMT ": bSurpriseRemoved=%s\n", - FUNC_ADPT_ARG(g_test_adapter), rtw_is_surprise_removed(g_test_adapter) ? "True" : "False"); -} -#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ - static int wifi_remove(struct platform_device *pdev) { struct wifi_platform_data *wifi_ctrl = @@ -1156,9 +1088,6 @@ static int wifi_remove(struct platform_device *pdev) RTW_INFO("## %s\n", __FUNCTION__); wifi_control_data = wifi_ctrl; - if (oob_irq != 0) - disable_irq_wake(oob_irq); - wifi_set_power(0, 0); /* Power Off */ wifi_set_carddetect(0); /* CardDetect (1->0) */ @@ -1166,23 +1095,6 @@ static int wifi_remove(struct platform_device *pdev) return 0; } -#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -static void wifi_shutdown(struct platform_device *pdev) -{ - struct wifi_platform_data *wifi_ctrl = - (struct wifi_platform_data *)(pdev->dev.platform_data); - - - RTW_INFO("## %s\n", __FUNCTION__); - - wifi_control_data = wifi_ctrl; - - shutdown_card(); - wifi_set_power(0, 0); /* Power Off */ - wifi_set_carddetect(0); /* CardDetect (1->0) */ -} -#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ - static int wifi_suspend(struct platform_device *pdev, pm_message_t state) { RTW_INFO("##> %s\n", __FUNCTION__); @@ -1208,9 +1120,6 @@ static struct platform_driver wifi_device = { .remove = wifi_remove, .suspend = wifi_suspend, .resume = wifi_resume, -#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN - .shutdown = wifi_shutdown, -#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ .driver = { .name = "bcmdhd_wlan", } diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.c index eab1306c23cb..79e3f9874a29 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 @@ -238,7 +233,7 @@ int rtw_dev_get_feature_set(struct net_device *dev) { _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); HAL_DATA_TYPE *HalData = GET_HAL_DATA(adapter); - HAL_VERSION *hal_ver = &HalData->VersionID; + HAL_VERSION *hal_ver = &HalData->version_id; int feature_set = 0; diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.h index 2ed3a9e623f9..9f36e9fd472e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_cfgvendor.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2014 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef _RTW_CFGVENDOR_H_ #define _RTW_CFGVENDOR_H_ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.c index 01cbc1852179..4fa6ef4d4994 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,20 +11,13 @@ * 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 /* tolower() */ #include #include #include "rtw_proc.h" -#ifdef CONFIG_BT_COEXIST #include -#endif #ifdef CONFIG_PROC_DEBUG @@ -166,6 +159,21 @@ static int proc_get_chplan_test(struct seq_file *m, void *v) return 0; } +#ifdef RTW_HALMAC +extern void rtw_halmac_get_version(char *str, u32 len); + +static int proc_get_halmac_info(struct seq_file *m, void *v) +{ + char ver[30] = {0}; + + + rtw_halmac_get_version(ver, 30); + RTW_PRINT_SEL(m, "version: %s\n", ver); + + return 0; +} +#endif + /* * rtw_drv_proc: * init/deinit when register/unregister driver @@ -180,6 +188,9 @@ const struct rtw_proc_hdl drv_proc_hdls[] = { RTW_PROC_HDL_SSEQ("country_chplan_map", proc_get_country_chplan_map, NULL), RTW_PROC_HDL_SSEQ("chplan_id_list", proc_get_chplan_id_list, NULL), RTW_PROC_HDL_SSEQ("chplan_test", proc_get_chplan_test, NULL), +#ifdef RTW_HALMAC + RTW_PROC_HDL_SSEQ("halmac_info", proc_get_halmac_info, NULL), +#endif /* RTW_HALMAC */ }; const int drv_proc_hdls_num = sizeof(drv_proc_hdls) / sizeof(struct rtw_proc_hdl); @@ -371,8 +382,25 @@ static int proc_get_sdio_local_reg_dump(struct seq_file *m, void *v) return 0; } +static int proc_get_sdio_card_info(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + dump_sdio_card_info(m, adapter_to_dvobj(adapter)); + + return 0; +} #endif /* CONFIG_SDIO_HCI */ +static int proc_get_fw_info(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + rtw_dump_fw_info(m, adapter); + return 0; +} static int proc_get_mac_reg_dump(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -393,6 +421,16 @@ static int proc_get_bb_reg_dump(struct seq_file *m, void *v) return 0; } +static int proc_get_bb_reg_dump_ex(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + bb_reg_dump_ex(m, adapter); + + return 0; +} + static int proc_get_rf_reg_dump(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -430,12 +468,17 @@ static int proc_get_customer_str(struct seq_file *m, void *v) _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); u8 cstr[RTW_CUSTOMER_STR_LEN]; + rtw_ps_deny(adapter, PS_DENY_IOCTL); + if (rtw_pwr_wakeup(adapter) == _FAIL) + goto exit; + if (rtw_hal_customer_str_read(adapter, cstr) != _SUCCESS) goto exit; RTW_PRINT_SEL(m, RTW_CUSTOMER_STR_FMT"\n", RTW_CUSTOMER_STR_ARG(cstr)); exit: + rtw_ps_deny_cancel(adapter, PS_DENY_IOCTL); return 0; } #endif /* CONFIG_RTW_CUSTOMER_STR */ @@ -531,6 +574,7 @@ static ssize_t proc_set_gpio(struct file *file, const char __user *buffer, size_ return count; } #endif + static ssize_t proc_set_rx_info_msg(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { @@ -590,10 +634,12 @@ static int proc_get_tx_info_msg(struct seq_file *m, void *v) _enter_critical_bh(&pstapriv->sta_hash_lock, &irqL); - if (check_fwstate(&padapter->mlmepriv, WIFI_STATION_STATE)) + if (MLME_IS_STA(padapter)) status = "station mode"; - else if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE)) + else if (MLME_IS_AP(padapter)) status = "AP mode"; + else if (MLME_IS_MESH(padapter)) + status = "mesh mode"; else status = " "; _RTW_PRINT_SEL(m, "status=%s\n", status); @@ -607,11 +653,11 @@ static int proc_get_tx_info_msg(struct seq_file *m, void *v) plist = get_next(plist); - if ((_rtw_memcmp(psta->hwaddr, bc_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, null_addr, 6) != _TRUE) - && (_rtw_memcmp(psta->hwaddr, adapter_mac_addr(padapter), 6) != _TRUE)) { + if ((_rtw_memcmp(psta->cmn.mac_addr, bc_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, null_addr, 6) != _TRUE) + && (_rtw_memcmp(psta->cmn.mac_addr, adapter_mac_addr(padapter), 6) != _TRUE)) { - switch (psta->bw_mode) { + switch (psta->cmn.bw_mode) { case CHANNEL_WIDTH_20: BW = "20M"; @@ -633,11 +679,11 @@ static int proc_get_tx_info_msg(struct seq_file *m, void *v) BW = ""; break; } - current_rate_id = rtw_get_current_tx_rate(adapter, psta->mac_id); - current_sgi = rtw_get_current_tx_sgi(adapter, psta->mac_id); + current_rate_id = rtw_get_current_tx_rate(adapter, psta); + current_sgi = rtw_get_current_tx_sgi(adapter, psta); RTW_PRINT_SEL(m, "==============================\n"); - _RTW_PRINT_SEL(m, "macaddr=" MAC_FMT"\n", MAC_ARG(psta->hwaddr)); + _RTW_PRINT_SEL(m, "macaddr=" MAC_FMT"\n", MAC_ARG(psta->cmn.mac_addr)); _RTW_PRINT_SEL(m, "Tx_Data_Rate=%s\n", HDATA_RATE(current_rate_id)); _RTW_PRINT_SEL(m, "BW=%s,sgi=%u\n", BW, current_sgi); @@ -704,6 +750,142 @@ static ssize_t proc_set_linked_info_dump(struct file *file, const char __user *b return count; } + +static int proc_get_sta_tp_dump(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + if (padapter) + RTW_PRINT_SEL(m, "sta_tp_dump :%s\n", (padapter->bsta_tp_dump) ? "enable" : "disable"); + + return 0; +} + +static ssize_t proc_set_sta_tp_dump(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + char tmp[32] = {0}; + int mode = 0; + int num = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + num = sscanf(tmp, "%d ", &mode); + + if (num != 1) { + RTW_INFO("argument number is wrong\n"); + return -EFAULT; + } + if (padapter) + padapter->bsta_tp_dump = mode; + } + return count; +} + +static int proc_get_sta_tp_info(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + + if (padapter) + rtw_sta_traffic_info(m, padapter); + + return 0; +} + +static int proc_get_turboedca_ctrl(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); + + if (hal_data) + RTW_PRINT_SEL(m, "Turbo-EDCA :%s\n", (hal_data->dis_turboedca) ? "Disable" : "Enable"); + + return 0; +} + +static ssize_t proc_set_turboedca_ctrl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + HAL_DATA_TYPE *hal_data = GET_HAL_DATA(padapter); + + char tmp[32] = {0}; + int mode = 0, num = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) + return -EFAULT; + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + num = sscanf(tmp, "%d ", &mode); + + if (num != 1) { + RTW_INFO("argument number is wrong\n"); + return -EFAULT; + } + hal_data->dis_turboedca = mode; + } + return count; +} +#ifdef CONFIG_WOWLAN +static int proc_get_wow_lps_ctrl(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); + + if (pwrctl) + RTW_PRINT_SEL(m, "WOW lps :%s\n", (pwrctl->wowlan_dis_lps) ? "Disable" : "Enable"); + + return 0; +} + +static ssize_t proc_set_wow_lps_ctrl(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter); + + char tmp[32] = {0}; + int mode = 0, num = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) + return -EFAULT; + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + num = sscanf(tmp, "%d ", &mode); + + if (num != 1) { + RTW_INFO("argument number is wrong\n"); + return -EFAULT; + } + pwrctl->wowlan_dis_lps = mode; + RTW_INFO("WOW lps :%s\n", (pwrctl->wowlan_dis_lps) ? "Disable" : "Enable"); + } + return count; +} +#endif + static int proc_get_mac_qinfo(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -739,7 +921,7 @@ static ssize_t proc_set_chan_plan(struct file *file, const char __user *buffer, struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; - u8 chan_plan = RTW_CHPLAN_MAX; + u8 chan_plan = RTW_CHPLAN_UNSPECIFIED; if (!padapter) return -EFAULT; @@ -769,9 +951,10 @@ static int proc_get_country_code(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); - if (adapter->mlmepriv.country_ent) - dump_country_chplan(m, adapter->mlmepriv.country_ent); + if (rfctl->country_ent) + dump_country_chplan(m, rfctl->country_ent); else RTW_PRINT_SEL(m, "unspecified\n"); @@ -873,13 +1056,100 @@ ssize_t proc_set_macaddr_acl(struct file *file, const char __user *buffer, size_ } #endif /* CONFIG_RTW_MACADDR_ACL */ -#ifdef CONFIG_DFS_MASTER -ssize_t proc_set_update_non_ocp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +#if CONFIG_RTW_PRE_LINK_STA +static int proc_get_pre_link_sta(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + dump_pre_link_sta_ctl(m, &adapter->stapriv); + return 0; +} + +ssize_t proc_set_pre_link_sta(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); struct mlme_priv *mlme = &adapter->mlmepriv; struct mlme_ext_priv *mlmeext = &adapter->mlmeextpriv; + char tmp[17 * RTW_PRE_LINK_STA_NUM + 32] = {0}; + char arg0[16] = {0}; + u8 addr[ETH_ALEN]; + +#define PRE_LINK_STA_CMD_RESET 0 +#define PRE_LINK_STA_CMD_ADD 1 +#define PRE_LINK_STA_CMD_DEL 2 +#define PRE_LINK_STA_CMD_NUM 3 + + static const char * const pre_link_sta_cmd_str[] = { + "reset", + "add", + "del" + }; + u8 cmd_id = PRE_LINK_STA_CMD_NUM; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + /* cmd [] */ + char *c, *next; + int i; + + next = tmp; + c = strsep(&next, " \t"); + + if (sscanf(c, "%s", arg0) != 1) + goto exit; + + for (i = 0; i < PRE_LINK_STA_CMD_NUM; i++) + if (strcmp(pre_link_sta_cmd_str[i], arg0) == 0) + cmd_id = i; + + switch (cmd_id) { + case PRE_LINK_STA_CMD_RESET: + rtw_pre_link_sta_ctl_reset(&adapter->stapriv); + goto exit; + case PRE_LINK_STA_CMD_ADD: + case PRE_LINK_STA_CMD_DEL: + break; + default: + goto exit; + } + + /* macaddr list */ + c = strsep(&next, " \t"); + while (c != NULL) { + if (sscanf(c, MAC_SFMT, MAC_SARG(addr)) != 6) + break; + + if (rtw_check_invalid_mac_address(addr, 0) == _FALSE) { + if (cmd_id == PRE_LINK_STA_CMD_ADD) + rtw_pre_link_sta_add(&adapter->stapriv, addr); + else + rtw_pre_link_sta_del(&adapter->stapriv, addr); + } + + c = strsep(&next, " \t"); + } + } + +exit: + return count; +} +#endif /* CONFIG_RTW_PRE_LINK_STA */ + +#ifdef CONFIG_DFS_MASTER +ssize_t proc_set_update_non_ocp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter); char tmp[32]; u8 ch, bw = CHANNEL_WIDTH_20, offset = HAL_PRIME_CHNL_OFFSET_DONT_CARE; int ms = -1; @@ -900,10 +1170,10 @@ ssize_t proc_set_update_non_ocp(struct file *file, const char __user *buffer, si goto exit; if (bw == CHANNEL_WIDTH_20) - rtw_chset_update_non_ocp_ms(mlmeext->channel_set + rtw_chset_update_non_ocp_ms(rfctl->channel_set , ch, bw, HAL_PRIME_CHNL_OFFSET_DONT_CARE, ms); else - rtw_chset_update_non_ocp_ms(mlmeext->channel_set + rtw_chset_update_non_ocp_ms(rfctl->channel_set , ch, bw, offset, ms); } @@ -983,6 +1253,55 @@ static ssize_t proc_set_dfs_ch_sel_d_flags(struct file *file, const char __user } #endif /* CONFIG_DFS_MASTER */ +#ifdef CONFIG_80211N_HT +int proc_get_rx_ampdu_size_limit(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + dump_regsty_rx_ampdu_size_limit(m, adapter); + + return 0; +} + +ssize_t proc_set_rx_ampdu_size_limit(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *regsty = adapter_to_regsty(adapter); + char tmp[32]; + u8 nss; + u8 limit_by_bw[4] = {0xFF}; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + int i; + int num = sscanf(tmp, "%hhu %hhu %hhu %hhu %hhu" + , &nss, &limit_by_bw[0], &limit_by_bw[1], &limit_by_bw[2], &limit_by_bw[3]); + + if (num < 2) + goto exit; + if (nss == 0 || nss > 4) + goto exit; + + for (i = 0; i < num - 1; i++) + regsty->rx_ampdu_sz_limit_by_nss_bw[nss - 1][i] = limit_by_bw[i]; + + rtw_rx_ampdu_apply(adapter); + } + +exit: + return count; +} +#endif /* CONFIG_80211N_HT */ + static int proc_get_udpport(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -1049,7 +1368,7 @@ static int proc_get_macid_info(struct seq_file *m, void *v) _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); struct macid_ctl_t *macid_ctl = dvobj_to_macidctl(dvobj); - u8 chip_type = rtw_get_chip_type(adapter); + struct hal_spec_t *hal_spec = GET_HAL_SPEC(adapter); u8 i; u8 null_addr[ETH_ALEN] = {0}; u8 *macaddr; @@ -1061,10 +1380,10 @@ static int proc_get_macid_info(struct seq_file *m, void *v) dump_macid_map(m, &macid_ctl->used, macid_ctl->num); RTW_PRINT_SEL(m, "\n"); - RTW_PRINT_SEL(m, "%-3s %-3s %-4s %-4s %-17s %-6s %-3s" - , "id", "bmc", "if_g", "ch_g", "macaddr", "bw", "vht"); + RTW_PRINT_SEL(m, "%-3s %-3s %-5s %-4s %-17s %-6s %-3s" + , "id", "bmc", "ifbmp", "ch_g", "macaddr", "bw", "vht"); - if (chip_type == RTL8814A) + if (hal_spec->tx_nss_num > 2) _RTW_PRINT_SEL(m, " %-10s", "rate_bmp1"); _RTW_PRINT_SEL(m, " %-10s %s\n", "rate_bmp0", "status"); @@ -1074,21 +1393,21 @@ static int proc_get_macid_info(struct seq_file *m, void *v) || macid_ctl->h2c_msr[i] ) { if (macid_ctl->sta[i]) - macaddr = macid_ctl->sta[i]->hwaddr; + macaddr = macid_ctl->sta[i]->cmn.mac_addr; else macaddr = null_addr; - RTW_PRINT_SEL(m, "%3u %3u %4d %4d "MAC_FMT" %6s %3u" + RTW_PRINT_SEL(m, "%3u %3u 0x%02x %4d "MAC_FMT" %6s %3u" , i , rtw_macid_is_bmc(macid_ctl, i) - , rtw_macid_get_if_g(macid_ctl, i) + , rtw_macid_get_iface_bmp(macid_ctl, i) , rtw_macid_get_ch_g(macid_ctl, i) , MAC_ARG(macaddr) , ch_width_str(macid_ctl->bw[i]) , macid_ctl->vht_en[i] ); - if (chip_type == RTL8814A) + if (hal_spec->tx_nss_num > 2) _RTW_PRINT_SEL(m, " 0x%08X", macid_ctl->rate_bmp1[i]); _RTW_PRINT_SEL(m, " 0x%08X "H2C_MSR_FMT" %s\n" @@ -1211,7 +1530,8 @@ static ssize_t proc_set_change_bss_chbw(struct file *file, const char __user *bu if (num < 1 || (bw != CHANNEL_WIDTH_20 && num < 3)) goto exit; - if (check_fwstate(mlme, WIFI_AP_STATE) && check_fwstate(mlme, WIFI_ASOC_STATE)) + if ((MLME_IS_AP(adapter) || MLME_IS_MESH(adapter)) + && check_fwstate(mlme, WIFI_ASOC_STATE)) rtw_change_bss_chbw_cmd(adapter, RTW_CMDF_WAIT_ACK, ch, bw, offset); } @@ -1219,7 +1539,6 @@ static ssize_t proc_set_change_bss_chbw(struct file *file, const char __user *bu return count; } -#ifdef CONFIG_80211N_HT static int proc_get_tx_bw_mode(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -1273,7 +1592,7 @@ static ssize_t proc_set_tx_bw_mode(struct file *file, const char __user *buffer, for (i = 0; i < MACID_NUM_SW_LIMIT; i++) { sta = macid_ctl->sta[i]; - if (sta && !is_broadcast_mac_addr(sta->hwaddr)) + if (sta && !is_broadcast_mac_addr(sta->cmn.mac_addr)) rtw_dm_ra_mask_wk_cmd(adapter, (u8 *)sta); } } @@ -1282,7 +1601,6 @@ static ssize_t proc_set_tx_bw_mode(struct file *file, const char __user *buffer, exit: return count; } -#endif /* CONFIG_80211N_HT */ static int proc_get_hal_txpwr_info(struct seq_file *m, void *v) { @@ -1321,15 +1639,17 @@ static int proc_get_tx_power_by_rate(struct seq_file *m, void *v) return 0; } +#ifdef CONFIG_TXPWR_LIMIT static int proc_get_tx_power_limit(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - dump_tx_power_limit(m, adapter); + dump_txpwr_lmt(m, adapter); return 0; } +#endif /* CONFIG_TXPWR_LIMIT */ static int proc_get_tx_power_ext_info(struct seq_file *m, void *v) { @@ -1995,26 +2315,31 @@ static ssize_t proc_set_skip_band(struct file *file, const char __user *buffer, } -#ifdef CONFIG_AUTO_CHNL_SEL_NHM +#ifdef CONFIG_RTW_ACS +static int proc_get_chan_info(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + rtw_acs_chan_info_dump(m, adapter); + return 0; +} + static int proc_get_best_chan(struct seq_file *m, void *v) { struct net_device *dev = m->private; _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - u8 best_24g_ch = 0, best_5g_ch = 0; - rtw_hal_get_odm_var(adapter, HAL_ODM_AUTO_CHNL_SEL, &(best_24g_ch), &(best_5g_ch)); - - RTW_PRINT_SEL(m, "Best 2.4G CH:%u\n", best_24g_ch); - RTW_PRINT_SEL(m, "Best 5G CH:%u\n", best_5g_ch); + rtw_acs_info_dump(m, adapter); return 0; } -static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) { struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; - u8 acs_satae = 0; + u8 acs_state = 0; if (count < 1) return -EFAULT; @@ -2025,20 +2350,61 @@ static ssize_t proc_set_acs(struct file *file, const char __user *buffer, size_ } if (buffer && !copy_from_user(tmp, buffer, count)) { - int num = sscanf(tmp, "%hhu", &acs_satae); + int num = sscanf(tmp, "%hhu", &acs_state); if (num < 1) return -EINVAL; - if (1 == acs_satae) - rtw_acs_start(padapter, _TRUE); + if (acs_state) + rtw_acs_start(padapter); else - rtw_acs_start(padapter, _FALSE); + rtw_acs_stop(padapter); } return count; } -#endif +#endif /*CONFIG_RTW_ACS*/ + +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR +static int proc_get_nm(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + rtw_noise_info_dump(m, adapter); + return 0; +} + +static ssize_t proc_set_nm(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u8 nm_state = 0; + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhu", &nm_state); + + if (num < 1) + return -EINVAL; + + if (nm_state) + rtw_nm_enable(padapter); + else + rtw_nm_disable(padapter); + + } + return count; +} +#endif /*CONFIG_RTW_ACS*/ static int proc_get_hal_spec(struct seq_file *m, void *v) { @@ -2049,6 +2415,17 @@ static int proc_get_hal_spec(struct seq_file *m, void *v) return 0; } +static int proc_get_phy_cap(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + rtw_dump_phy_cap(m, adapter); + rtw_dump_drv_phy_cap(m, adapter); + rtw_get_dft_phy_cap(m, adapter); + return 0; +} + #ifdef CONFIG_SUPPORT_TRX_SHARED #include "../../hal/hal_halmac.h" static int proc_get_trx_share_mode(struct seq_file *m, void *v) @@ -2061,6 +2438,98 @@ static int proc_get_trx_share_mode(struct seq_file *m, void *v) } #endif +static int proc_dump_rsvd_page(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + rtw_dump_rsvd_page(m, adapter, adapter->rsvd_page_offset, adapter->rsvd_page_num); + return 0; +} +static ssize_t proc_set_rsvd_page_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u8 page_offset, page_num; + + if (count < 2) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhu %hhu", &page_offset, &page_num); + + if (num < 2) + return -EINVAL; + padapter->rsvd_page_offset = page_offset; + padapter->rsvd_page_num = page_num; + } + return count; +} + +#ifdef CONFIG_SUPPORT_FIFO_DUMP +static int proc_dump_fifo(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + + rtw_dump_fifo(m, adapter, adapter->fifo_sel, adapter->fifo_addr, adapter->fifo_size); + return 0; +} +static ssize_t proc_set_fifo_info(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + u8 fifo_sel = 0; + u32 fifo_addr = 0; + u32 fifo_size = 0; + + if (count < 3) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + if (buffer && !copy_from_user(tmp, buffer, count)) { + + int num = sscanf(tmp, "%hhu %x %d", &fifo_sel, &fifo_addr, &fifo_size); + + if (num < 3) + return -EINVAL; + + padapter->fifo_sel = fifo_sel; + padapter->fifo_addr = fifo_addr; + padapter->fifo_size = fifo_size; + } + return count; +} +#endif + +#ifdef CONFIG_WOW_PATTERN_HW_CAM +int proc_dump_pattern_cam(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + struct pwrctrl_priv *pwrpriv = adapter_to_pwrctl(padapter); + int i; + struct rtl_wow_pattern context; + + for (i = 0 ; i < pwrpriv->wowlan_pattern_idx; i++) { + rtw_wow_pattern_read_cam_ent(padapter, i, &context); + rtw_dump_wow_pattern(m, &context, i); + } + + return 0; +} +#endif + static int proc_get_napi_info(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2068,6 +2537,8 @@ static int proc_get_napi_info(struct seq_file *m, void *v) struct registry_priv *pregistrypriv = &adapter->registrypriv; u8 napi = 0, gro = 0; u32 weight = 0; + struct dvobj_priv *d; + d = adapter_to_dvobj(adapter); #ifdef CONFIG_RTW_NAPI @@ -2082,12 +2553,108 @@ static int proc_get_napi_info(struct seq_file *m, void *v) #endif /* CONFIG_RTW_GRO */ #endif /* CONFIG_RTW_NAPI */ - if (napi) + if (napi) { RTW_PRINT_SEL(m, "NAPI enable, weight=%d\n", weight); - else +#ifdef CONFIG_RTW_NAPI_DYNAMIC + RTW_PRINT_SEL(m, "Dynamaic NAPI mechanism is on, current NAPI %s\n", + d->en_napi_dynamic ? "enable" : "disable"); + RTW_PRINT_SEL(m, "Dynamaic NAPI info:\n" + "\ttcp_rx_threshold = %d Mbps\n" + "\tcur_rx_tp = %d Mbps\n", + pregistrypriv->napi_threshold, + d->traffic_stat.cur_rx_tp); +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ + } else { RTW_PRINT_SEL(m, "NAPI disable\n"); + } RTW_PRINT_SEL(m, "GRO %s\n", gro?"enable":"disable"); + return 0; + +} + +#ifdef CONFIG_RTW_NAPI_DYNAMIC +static ssize_t proc_set_napi_th(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + struct _ADAPTER *adapter = (struct _ADAPTER *)rtw_netdev_priv(dev); + struct registry_priv *registry = &adapter->registrypriv; + char tmp[32] = {0}; + int thrshld = 0; + int num = 0; + + + if (count < 1) + return -EFAULT; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + RTW_INFO("%s: Last threshold = %d Mbps\n", __FUNCTION__, registry->napi_threshold); + + if (buffer && !copy_from_user(tmp, buffer, count)) { + num = sscanf(tmp, "%d", &thrshld); + if (num > 0) { + if (thrshld > 0) + registry->napi_threshold = thrshld; + } + } + RTW_INFO("%s: New threshold = %d Mbps\n", __FUNCTION__, registry->napi_threshold); + RTW_INFO("%s: Current RX throughput = %d Mbps\n", + __FUNCTION__, adapter_to_dvobj(adapter)->traffic_stat.cur_rx_tp); + + return count; +} +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ + + +ssize_t proc_set_dynamic_agg_enable(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) +{ + struct net_device *dev = data; + _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); + char tmp[32]; + int enable = 0, i = 0; + + if (count > sizeof(tmp)) { + rtw_warn_on(1); + return -EFAULT; + } + + if (buffer && !copy_from_user(tmp, buffer, count)) { + + struct dvobj_priv *dvobj = adapter_to_dvobj(padapter); + PADAPTER iface = NULL; + int num = sscanf(tmp, "%d", &enable); + + if (num != 1) { + RTW_INFO("invalid parameter!\n"); + return count; + } + + RTW_INFO("dynamic_agg_enable:%d\n", enable); + + for (i = 0; i < dvobj->iface_nums; i++) { + iface = dvobj->padapters[i]; + if (iface) + iface->registrypriv.dynamic_agg_enable = enable; + } + + } + + return count; + +} + +static int proc_get_dynamic_agg_enable(struct seq_file *m, void *v) +{ + struct net_device *dev = m->private; + _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); + struct registry_priv *pregistrypriv = &adapter->registrypriv; + + RTW_PRINT_SEL(m, "dynamic_agg_enable:%d\n", pregistrypriv->dynamic_agg_enable); + return 0; } @@ -2117,10 +2684,14 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #ifdef CONFIG_SCAN_BACKOP RTW_PROC_HDL_SSEQ("backop_flags_sta", proc_get_backop_flags_sta, proc_set_backop_flags_sta), RTW_PROC_HDL_SSEQ("backop_flags_ap", proc_get_backop_flags_ap, proc_set_backop_flags_ap), +#endif +#ifdef CONFIG_RTW_REPEATER_SON + RTW_PROC_HDL_SSEQ("rson_data", proc_get_rson_data, proc_set_rson_data), #endif RTW_PROC_HDL_SSEQ("survey_info", proc_get_survey_info, proc_set_survey_info), RTW_PROC_HDL_SSEQ("ap_info", proc_get_ap_info, NULL), RTW_PROC_HDL_SSEQ("trx_info", proc_get_trx_info, proc_reset_trx_info), + RTW_PROC_HDL_SSEQ("tx_power_offset", proc_get_tx_power_offset, proc_set_tx_power_offset), RTW_PROC_HDL_SSEQ("rate_ctl", proc_get_rate_ctl, proc_set_rate_ctl), RTW_PROC_HDL_SSEQ("bw_ctl", proc_get_bw_ctl, proc_set_bw_ctl), RTW_PROC_HDL_SSEQ("dis_pwt_ctl", proc_get_dis_pwt, proc_set_dis_pwt), @@ -2129,7 +2700,7 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("bcmc_info", proc_get_mi_ap_bc_info, NULL), RTW_PROC_HDL_SSEQ("sec_cam", proc_get_sec_cam, proc_set_sec_cam), RTW_PROC_HDL_SSEQ("sec_cam_cache", proc_get_sec_cam_cache, NULL), - RTW_PROC_HDL_SSEQ("suspend_info", proc_get_suspend_resume_info, NULL), + RTW_PROC_HDL_SSEQ("ps_dbg_info", proc_get_ps_dbg_info, proc_set_ps_dbg_info), RTW_PROC_HDL_SSEQ("wifi_spec", proc_get_wifi_spec, NULL), #ifdef CONFIG_LAYER2_ROAMING RTW_PROC_HDL_SSEQ("roam_flags", proc_get_roam_flags, proc_set_roam_flags), @@ -2144,18 +2715,22 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #ifdef CONFIG_SDIO_HCI RTW_PROC_HDL_SSEQ("sd_f0_reg_dump", proc_get_sd_f0_reg_dump, NULL), RTW_PROC_HDL_SSEQ("sdio_local_reg_dump", proc_get_sdio_local_reg_dump, NULL), + RTW_PROC_HDL_SSEQ("sdio_card_info", proc_get_sdio_card_info, NULL), #endif /* CONFIG_SDIO_HCI */ RTW_PROC_HDL_SSEQ("fwdl_test_case", NULL, proc_set_fwdl_test_case), RTW_PROC_HDL_SSEQ("del_rx_ampdu_test_case", NULL, proc_set_del_rx_ampdu_test_case), RTW_PROC_HDL_SSEQ("wait_hiq_empty", NULL, proc_set_wait_hiq_empty), + RTW_PROC_HDL_SSEQ("sta_linking_test", NULL, proc_set_sta_linking_test), RTW_PROC_HDL_SSEQ("mac_reg_dump", proc_get_mac_reg_dump, NULL), RTW_PROC_HDL_SSEQ("bb_reg_dump", proc_get_bb_reg_dump, NULL), + RTW_PROC_HDL_SSEQ("bb_reg_dump_ex", proc_get_bb_reg_dump_ex, NULL), RTW_PROC_HDL_SSEQ("rf_reg_dump", proc_get_rf_reg_dump, NULL), #ifdef CONFIG_AP_MODE RTW_PROC_HDL_SSEQ("all_sta_info", proc_get_all_sta_info, NULL), + RTW_PROC_HDL_SSEQ("bmc_tx_rate", proc_get_bmc_tx_rate, proc_set_bmc_tx_rate), #endif /* CONFIG_AP_MODE */ #ifdef DBG_MEMORY_LEAK @@ -2173,12 +2748,17 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("ht_enable", proc_get_ht_enable, proc_set_ht_enable), RTW_PROC_HDL_SSEQ("bw_mode", proc_get_bw_mode, proc_set_bw_mode), RTW_PROC_HDL_SSEQ("ampdu_enable", proc_get_ampdu_enable, proc_set_ampdu_enable), - RTW_PROC_HDL_SSEQ("rx_stbc", proc_get_rx_stbc, proc_set_rx_stbc), RTW_PROC_HDL_SSEQ("rx_ampdu", proc_get_rx_ampdu, proc_set_rx_ampdu), + RTW_PROC_HDL_SSEQ("rx_ampdu_size_limit", proc_get_rx_ampdu_size_limit, proc_set_rx_ampdu_size_limit), RTW_PROC_HDL_SSEQ("rx_ampdu_factor", proc_get_rx_ampdu_factor, proc_set_rx_ampdu_factor), RTW_PROC_HDL_SSEQ("rx_ampdu_density", proc_get_rx_ampdu_density, proc_set_rx_ampdu_density), RTW_PROC_HDL_SSEQ("tx_ampdu_density", proc_get_tx_ampdu_density, proc_set_tx_ampdu_density), +#ifdef CONFIG_TX_AMSDU + RTW_PROC_HDL_SSEQ("tx_amsdu", proc_get_tx_amsdu, proc_set_tx_amsdu), + RTW_PROC_HDL_SSEQ("tx_amsdu_rate", proc_get_tx_amsdu_rate, proc_set_tx_amsdu_rate), +#endif #endif /* CONFIG_80211N_HT */ + RTW_PROC_HDL_SSEQ("tx_max_agg_num", proc_get_tx_max_agg_num, proc_set_tx_max_agg_num), RTW_PROC_HDL_SSEQ("en_fwps", proc_get_en_fwps, proc_set_en_fwps), RTW_PROC_HDL_SSEQ("mac_rptbuf", proc_get_mac_rptbuf, NULL), @@ -2192,6 +2772,9 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("btinfo_evt", NULL, proc_set_btinfo_evt), RTW_PROC_HDL_SSEQ("btreg_read", proc_get_btreg_read, proc_set_btreg_read), RTW_PROC_HDL_SSEQ("btreg_write", proc_get_btreg_write, proc_set_btreg_write), +#ifdef CONFIG_RF4CE_COEXIST + RTW_PROC_HDL_SSEQ("rf4ce_state", proc_get_rf4ce_state, proc_set_rf4ce_state), +#endif #endif /* CONFIG_BT_COEXIST */ #if defined(DBG_CONFIG_ERROR_DETECT) @@ -2199,8 +2782,12 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #endif /* DBG_CONFIG_ERROR_DETECT */ RTW_PROC_HDL_SSEQ("trx_info_debug", proc_get_trx_info_debug, NULL), RTW_PROC_HDL_SSEQ("linked_info_dump", proc_get_linked_info_dump, proc_set_linked_info_dump), + RTW_PROC_HDL_SSEQ("sta_tp_dump", proc_get_sta_tp_dump, proc_set_sta_tp_dump), + RTW_PROC_HDL_SSEQ("sta_tp_info", proc_get_sta_tp_info, NULL), + RTW_PROC_HDL_SSEQ("dis_turboedca", proc_get_turboedca_ctrl, proc_set_turboedca_ctrl), RTW_PROC_HDL_SSEQ("tx_info_msg", proc_get_tx_info_msg, NULL), RTW_PROC_HDL_SSEQ("rx_info_msg", proc_get_rx_info_msg, proc_set_rx_info_msg), + #ifdef CONFIG_GPIO_API RTW_PROC_HDL_SSEQ("gpio_info", proc_get_gpio, proc_set_gpio), RTW_PROC_HDL_SSEQ("gpio_set_output_value", NULL, proc_set_gpio_output_value), @@ -2213,14 +2800,29 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("int_logs", proc_get_int_logs, NULL), #endif +#ifdef CONFIG_DBG_RF_CAL + RTW_PROC_HDL_SSEQ("iqk", proc_get_iqk_info, proc_set_iqk), + RTW_PROC_HDL_SSEQ("lck", proc_get_lck_info, proc_set_lck), +#endif + #ifdef CONFIG_PCI_HCI RTW_PROC_HDL_SSEQ("rx_ring", proc_get_rx_ring, NULL), RTW_PROC_HDL_SSEQ("tx_ring", proc_get_tx_ring, NULL), +#ifdef DBG_TXBD_DESC_DUMP + RTW_PROC_HDL_SSEQ("tx_ring_ext", proc_get_tx_ring_ext, proc_set_tx_ring_ext), +#endif + RTW_PROC_HDL_SSEQ("pci_aspm", proc_get_pci_aspm, NULL), #endif #ifdef CONFIG_WOWLAN RTW_PROC_HDL_SSEQ("wow_pattern_info", proc_get_pattern_info, proc_set_pattern_info), + RTW_PROC_HDL_SSEQ("wow_wakeup_event", proc_get_wakeup_event, + proc_set_wakeup_event), RTW_PROC_HDL_SSEQ("wowlan_last_wake_reason", proc_get_wakeup_reason, NULL), +#ifdef CONFIG_WOW_PATTERN_HW_CAM + RTW_PROC_HDL_SSEQ("wow_pattern_cam", proc_dump_pattern_cam, NULL), +#endif + RTW_PROC_HDL_SSEQ("dis_wow_lps", proc_get_wow_lps_ctrl, proc_set_wow_lps_ctrl), #endif #ifdef CONFIG_GPIO_WAKEUP @@ -2234,6 +2836,9 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #if CONFIG_RTW_MACADDR_ACL RTW_PROC_HDL_SSEQ("macaddr_acl", proc_get_macaddr_acl, proc_set_macaddr_acl), #endif +#if CONFIG_RTW_PRE_LINK_STA + RTW_PROC_HDL_SSEQ("pre_link_sta", proc_get_pre_link_sta, proc_set_pre_link_sta), +#endif #ifdef CONFIG_DFS_MASTER RTW_PROC_HDL_SSEQ("dfs_master_test_case", proc_get_dfs_master_test_case, proc_set_dfs_master_test_case), RTW_PROC_HDL_SSEQ("update_non_ocp", NULL, proc_set_update_non_ocp), @@ -2246,13 +2851,13 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("dump_rx_cnt_mode", proc_get_rx_cnt_dump, proc_set_rx_cnt_dump), #endif RTW_PROC_HDL_SSEQ("change_bss_chbw", NULL, proc_set_change_bss_chbw), -#ifdef CONFIG_80211N_HT RTW_PROC_HDL_SSEQ("tx_bw_mode", proc_get_tx_bw_mode, proc_set_tx_bw_mode), -#endif /* CONFIG_80211N_HT */ RTW_PROC_HDL_SSEQ("hal_txpwr_info", proc_get_hal_txpwr_info, NULL), RTW_PROC_HDL_SSEQ("target_tx_power", proc_get_target_tx_power, NULL), RTW_PROC_HDL_SSEQ("tx_power_by_rate", proc_get_tx_power_by_rate, NULL), +#ifdef CONFIG_TXPWR_LIMIT RTW_PROC_HDL_SSEQ("tx_power_limit", proc_get_tx_power_limit, NULL), +#endif RTW_PROC_HDL_SSEQ("tx_power_ext_info", proc_get_tx_power_ext_info, proc_set_tx_power_ext_info), RTW_PROC_HDL_SEQ("tx_power_idx", &seq_ops_tx_power_idx, NULL), #ifdef CONFIG_RF_POWER_TRIM @@ -2263,15 +2868,25 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { #endif #ifdef CONFIG_POWER_SAVING RTW_PROC_HDL_SSEQ("ps_info", proc_get_ps_info, NULL), +#ifdef CONFIG_WMMPS_STA + RTW_PROC_HDL_SSEQ("wmmps_info", proc_get_wmmps_info, proc_set_wmmps_info), +#endif /* CONFIG_WMMPS_STA */ #endif #ifdef CONFIG_TDLS RTW_PROC_HDL_SSEQ("tdls_info", proc_get_tdls_info, NULL), + RTW_PROC_HDL_SSEQ("tdls_enable", proc_get_tdls_enable, proc_set_tdls_enable), #endif RTW_PROC_HDL_SSEQ("monitor", proc_get_monitor, proc_set_monitor), -#ifdef CONFIG_AUTO_CHNL_SEL_NHM +#ifdef CONFIG_RTW_ACS RTW_PROC_HDL_SSEQ("acs", proc_get_best_chan, proc_set_acs), + RTW_PROC_HDL_SSEQ("chan_info", proc_get_chan_info, NULL), #endif + +#ifdef CONFIG_BACKGROUND_NOISE_MONITOR + RTW_PROC_HDL_SSEQ("noise_monitor", proc_get_nm, proc_set_nm), +#endif + #ifdef CONFIG_PREALLOC_RX_SKB_BUFFER RTW_PROC_HDL_SSEQ("rtkm_info", proc_get_rtkm_info, NULL), #endif @@ -2288,10 +2903,44 @@ const struct rtw_proc_hdl adapter_proc_hdls[] = { RTW_PROC_HDL_SSEQ("mac_addr", proc_get_mac_addr, NULL), RTW_PROC_HDL_SSEQ("skip_band", proc_get_skip_band, proc_set_skip_band), RTW_PROC_HDL_SSEQ("hal_spec", proc_get_hal_spec, NULL), + + RTW_PROC_HDL_SSEQ("rx_stat", proc_get_rx_stat, NULL), + + RTW_PROC_HDL_SSEQ("tx_stat", proc_get_tx_stat, NULL), + /**** PHY Capability ****/ + RTW_PROC_HDL_SSEQ("phy_cap", proc_get_phy_cap, NULL), + + RTW_PROC_HDL_SSEQ("rx_stbc", proc_get_rx_stbc, proc_set_rx_stbc), + RTW_PROC_HDL_SSEQ("stbc_cap", proc_get_stbc_cap, proc_set_stbc_cap), + RTW_PROC_HDL_SSEQ("ldpc_cap", proc_get_ldpc_cap, proc_set_ldpc_cap), +#ifdef CONFIG_BEAMFORMING + RTW_PROC_HDL_SSEQ("txbf_cap", proc_get_txbf_cap, proc_set_txbf_cap), +#endif + #ifdef CONFIG_SUPPORT_TRX_SHARED RTW_PROC_HDL_SSEQ("trx_share_mode", proc_get_trx_share_mode, NULL), #endif RTW_PROC_HDL_SSEQ("napi_info", proc_get_napi_info, NULL), +#ifdef CONFIG_RTW_NAPI_DYNAMIC + RTW_PROC_HDL_SSEQ("napi_th", proc_get_napi_info, proc_set_napi_th), +#endif /* CONFIG_RTW_NAPI_DYNAMIC */ + + RTW_PROC_HDL_SSEQ("rsvd_page", proc_dump_rsvd_page, proc_set_rsvd_page_info), + +#ifdef CONFIG_SUPPORT_FIFO_DUMP + RTW_PROC_HDL_SSEQ("fifo_dump", proc_dump_fifo, proc_set_fifo_info), +#endif + RTW_PROC_HDL_SSEQ("fw_info", proc_get_fw_info, NULL), + +#ifdef DBG_XMIT_BLOCK + RTW_PROC_HDL_SSEQ("xmit_block", proc_get_xmit_block, proc_set_xmit_block), +#endif + + RTW_PROC_HDL_SSEQ("ack_timeout", proc_get_ack_timeout, proc_set_ack_timeout), + + RTW_PROC_HDL_SSEQ("dynamic_agg_enable", proc_get_dynamic_agg_enable, proc_set_dynamic_agg_enable), + RTW_PROC_HDL_SSEQ("iqk_fw_offload", proc_get_iqk_fw_offload, proc_set_iqk_fw_offload), + }; const int adapter_proc_hdls_num = sizeof(adapter_proc_hdls) / sizeof(struct rtw_proc_hdl); @@ -2348,161 +2997,6 @@ static const struct file_operations rtw_adapter_proc_sseq_fops = { .write = rtw_adapter_proc_write, }; -int proc_get_odm_dbg_comp(struct seq_file *m, void *v) -{ - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - - rtw_odm_dbg_comp_msg(m, adapter); - - return 0; -} - -ssize_t proc_set_odm_dbg_comp(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -{ - struct net_device *dev = data; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - char tmp[32]; - - u64 dbg_comp; - - if (count < 1) - return -EFAULT; - - if (count > sizeof(tmp)) { - rtw_warn_on(1); - return -EFAULT; - } - - if (buffer && !copy_from_user(tmp, buffer, count)) { - - int num = sscanf(tmp, "%llx", &dbg_comp); - - if (num != 1) - return count; - - rtw_odm_dbg_comp_set(adapter, dbg_comp); - } - - return count; -} - -int proc_get_odm_dbg_level(struct seq_file *m, void *v) -{ - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - - rtw_odm_dbg_level_msg(m, adapter); - - return 0; -} - -ssize_t proc_set_odm_dbg_level(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -{ - struct net_device *dev = data; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - char tmp[32]; - - u32 dbg_level; - - if (count < 1) - return -EFAULT; - - if (count > sizeof(tmp)) { - rtw_warn_on(1); - return -EFAULT; - } - - if (buffer && !copy_from_user(tmp, buffer, count)) { - - int num = sscanf(tmp, "%u", &dbg_level); - - if (num != 1) - return count; - - rtw_odm_dbg_level_set(adapter, dbg_level); - } - - return count; -} - -int proc_get_odm_ability(struct seq_file *m, void *v) -{ - struct net_device *dev = m->private; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - - rtw_odm_ability_msg(m, adapter); - - return 0; -} - -ssize_t proc_set_odm_ability(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -{ - struct net_device *dev = data; - _adapter *adapter = (_adapter *)rtw_netdev_priv(dev); - char tmp[32]; - - u32 ability; - - if (count < 1) - return -EFAULT; - - if (count > sizeof(tmp)) { - rtw_warn_on(1); - return -EFAULT; - } - - if (buffer && !copy_from_user(tmp, buffer, count)) { - - int num = sscanf(tmp, "%x", &ability); - - if (num != 1) - return count; - - rtw_odm_ability_set(adapter, ability); - } - - return count; -} - -int proc_get_odm_force_igi_lb(struct seq_file *m, void *v) -{ - struct net_device *dev = m->private; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - - RTW_PRINT_SEL(m, "force_igi_lb:0x%02x\n", rtw_odm_get_force_igi_lb(padapter)); - - return 0; -} - -ssize_t proc_set_odm_force_igi_lb(struct file *file, const char __user *buffer, size_t count, loff_t *pos, void *data) -{ - struct net_device *dev = data; - _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); - char tmp[32]; - u8 force_igi_lb; - - if (count < 1) - return -EFAULT; - - if (count > sizeof(tmp)) { - rtw_warn_on(1); - return -EFAULT; - } - - if (buffer && !copy_from_user(tmp, buffer, count)) { - - int num = sscanf(tmp, "%hhx", &force_igi_lb); - - if (num != 1) - return count; - - rtw_odm_set_force_igi_lb(padapter, force_igi_lb); - } - - return count; -} - int proc_get_odm_adaptivity(struct seq_file *m, void *v) { struct net_device *dev = m->private; @@ -2518,11 +3012,11 @@ ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, si struct net_device *dev = data; _adapter *padapter = (_adapter *)rtw_netdev_priv(dev); char tmp[32]; - u32 TH_L2H_ini; - u32 TH_L2H_ini_mode2; - s8 TH_EDCCA_HL_diff; - s8 TH_EDCCA_HL_diff_mode2; - u8 EDCCA_enable; + u32 th_l2h_ini; + u32 th_l2h_ini_mode2; + s8 th_edcca_hl_diff; + s8 th_edcca_hl_diff_mode2; + u8 edcca_enable; if (count < 1) return -EFAULT; @@ -2534,12 +3028,12 @@ ssize_t proc_set_odm_adaptivity(struct file *file, const char __user *buffer, si if (buffer && !copy_from_user(tmp, buffer, count)) { - int num = sscanf(tmp, "%x %hhd %x %hhd %hhu", &TH_L2H_ini, &TH_EDCCA_HL_diff, &TH_L2H_ini_mode2, &TH_EDCCA_HL_diff_mode2, &EDCCA_enable); + int num = sscanf(tmp, "%x %hhd %x %hhd %hhu", &th_l2h_ini, &th_edcca_hl_diff, &th_l2h_ini_mode2, &th_edcca_hl_diff_mode2, &edcca_enable); if (num != 5) return count; - rtw_odm_adaptivity_parm_set(padapter, (s8)TH_L2H_ini, TH_EDCCA_HL_diff, (s8)TH_L2H_ini_mode2, TH_EDCCA_HL_diff_mode2, EDCCA_enable); + rtw_odm_adaptivity_parm_set(padapter, (s8)th_l2h_ini, th_edcca_hl_diff, (s8)th_l2h_ini_mode2, th_edcca_hl_diff_mode2, edcca_enable); } return count; @@ -2552,14 +3046,12 @@ int proc_get_phydm_cmd(struct seq_file *m, void *v) { struct net_device *netdev; PADAPTER padapter; - PHAL_DATA_TYPE pHalData; - PDM_ODM_T phydm; + struct PHY_DM_STRUCT *phydm; netdev = m->private; padapter = (PADAPTER)rtw_netdev_priv(netdev); - pHalData = GET_HAL_DATA(padapter); - phydm = &pHalData->odmpriv; + phydm = adapter_to_phydm(padapter); if (NULL == phydm_msg) { phydm_msg = rtw_zmalloc(PHYDM_MSG_LEN); @@ -2581,15 +3073,13 @@ ssize_t proc_set_phydm_cmd(struct file *file, const char __user *buffer, size_t { struct net_device *netdev; PADAPTER padapter; - PHAL_DATA_TYPE pHalData; - PDM_ODM_T phydm; + struct PHY_DM_STRUCT *phydm; char tmp[64] = {0}; netdev = (struct net_device *)data; padapter = (PADAPTER)rtw_netdev_priv(netdev); - pHalData = GET_HAL_DATA(padapter); - phydm = &pHalData->odmpriv; + phydm = adapter_to_phydm(padapter); if (count < 1) return -EFAULT; @@ -2621,11 +3111,7 @@ ssize_t proc_set_phydm_cmd(struct file *file, const char __user *buffer, size_t * init/deinit when register/unregister net_device, along with rtw_adapter_proc */ const struct rtw_proc_hdl odm_proc_hdls[] = { - RTW_PROC_HDL_SSEQ("dbg_comp", proc_get_odm_dbg_comp, proc_set_odm_dbg_comp), - RTW_PROC_HDL_SSEQ("dbg_level", proc_get_odm_dbg_level, proc_set_odm_dbg_level), - RTW_PROC_HDL_SSEQ("ability", proc_get_odm_ability, proc_set_odm_ability), RTW_PROC_HDL_SSEQ("adaptivity", proc_get_odm_adaptivity, proc_set_odm_adaptivity), - RTW_PROC_HDL_SSEQ("force_igi_lb", proc_get_odm_force_igi_lb, proc_set_odm_force_igi_lb), RTW_PROC_HDL_SSEQ("cmd", proc_get_phydm_cmd, proc_set_phydm_cmd), }; @@ -2766,6 +3252,7 @@ const struct rtw_proc_hdl mcc_proc_hdls[] = { RTW_PROC_HDL_SSEQ("mcc_sta_bw20_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw20_target_tp), RTW_PROC_HDL_SSEQ("mcc_sta_bw40_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw40_target_tp), RTW_PROC_HDL_SSEQ("mcc_sta_bw80_target_tp", proc_get_mcc_info, proc_set_mcc_sta_bw80_target_tp), + RTW_PROC_HDL_SSEQ("mcc_policy_table", proc_get_mcc_policy_table, proc_set_mcc_policy_table), }; const int mcc_proc_hdls_num = sizeof(mcc_proc_hdls) / sizeof(struct rtw_proc_hdl); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.h index 0ab929c51f25..c2c7c8ed8b8e 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/rtw_proc.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __RTW_PROC_H__ #define __RTW_PROC_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_intf.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_intf.c index 1949f18d91b8..5538983273a6 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_intf.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_intf.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _HCI_INTF_C_ #include @@ -31,14 +26,17 @@ #include /* rtl8822bs_set_hal_ops() */ #endif /* CONFIG_RTL8822B */ -#ifdef CONFIG_RTL8821C -#include /* rtl8821cs_set_hal_ops() */ -#endif /* CONFIG_RTL8821C */ - #ifdef CONFIG_PLATFORM_INTEL_BYT #ifdef CONFIG_ACPI #include +#ifdef CONFIG_GPIO_WAKEUP +#include +#endif +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,14,0)) +#include +#else #include +#endif #include "rtw_android.h" #endif static int wlan_en_gpio = -1; @@ -85,7 +83,8 @@ static const struct sdio_device_id sdio_ids[] = { #endif #ifdef CONFIG_RTL8821C - {SDIO_DEVICE(0x024c, 0xB821), .driver_data = RTL8821C}, + {SDIO_DEVICE(0x024C, 0xB821), .driver_data = RTL8821C}, + {SDIO_DEVICE(0x024C, 0xC821), .driver_data = RTL8821C}, #endif #if defined(RTW_ENABLE_WIFI_CONTROL_FUNC) /* temporarily add this to accept all sdio wlan id */ @@ -100,8 +99,11 @@ static int rtw_drv_init(struct sdio_func *func, const struct sdio_device_id *id) static void rtw_dev_remove(struct sdio_func *func); static int rtw_sdio_resume(struct device *dev); static int rtw_sdio_suspend(struct device *dev); +static void rtw_sdio_shutdown(struct device *dev); extern void rtw_dev_unload(PADAPTER padapter); - +#if defined(CONFIG_PLATFORM_INTEL_BYT) +int rtw_sdio_set_power(struct sdio_func *func, int on); +#endif /* CONFIG_PLATFORM_INTEL_BYT */ #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) static const struct dev_pm_ops rtw_sdio_pm_ops = { .suspend = rtw_sdio_suspend, @@ -121,6 +123,7 @@ static struct sdio_drv_priv sdio_drvpriv = { .r871xs_drv.id_table = sdio_ids, #if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)) .r871xs_drv.drv = { + .shutdown = rtw_sdio_shutdown, .pm = &rtw_sdio_pm_ops, } #endif @@ -137,13 +140,13 @@ static void sd_sync_int_hdl(struct sdio_func *func) psdpriv = sdio_get_drvdata(func); - if (!psdpriv->padapters[IFACE_ID0]) { + if (!dvobj_get_primary_adapter(psdpriv)) { RTW_INFO("%s primary adapter == NULL\n", __func__); return; } rtw_sdio_set_irq_thd(psdpriv, current); - sd_int_hdl(psdpriv->padapters[IFACE_ID0]); + sd_int_hdl(dvobj_get_primary_adapter(psdpriv)); rtw_sdio_set_irq_thd(psdpriv, NULL); } @@ -205,7 +208,6 @@ static irqreturn_t gpio_hostwakeup_irq_thread(int irq, void *data) RTW_PRINT("gpio_hostwakeup_irq_thread\n"); /* Disable interrupt before calling handler */ /* disable_irq_nosync(oob_irq); */ - rtw_lock_suspend_timeout(HZ / 2); #ifdef CONFIG_PLATFORM_ARM_SUN6I return 0; #else @@ -263,12 +265,82 @@ static void gpio_hostwakeup_free_irq(PADAPTER padapter) } #endif -static u32 sdio_init(struct dvobj_priv *dvobj) +void dump_sdio_card_info(void *sel, struct dvobj_priv *dvobj) +{ + PSDIO_DATA psdio_data = &dvobj->intf_data; + + RTW_PRINT_SEL(sel, "== SDIO Card Info ==\n"); + RTW_PRINT_SEL(sel, " clock: %d Hz\n", psdio_data->clock); + + RTW_PRINT_SEL(sel, " timing spec: "); + switch (psdio_data->timing) { + case MMC_TIMING_LEGACY: + _RTW_PRINT_SEL(sel, "legacy"); + break; + case MMC_TIMING_MMC_HS: + _RTW_PRINT_SEL(sel, "mmc high-speed"); + break; + case MMC_TIMING_SD_HS: + _RTW_PRINT_SEL(sel, "sd high-speed"); + break; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0) + #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0) + case MMC_TIMING_UHS_SDR12: + _RTW_PRINT_SEL(sel, "sd uhs SDR12"); + break; + case MMC_TIMING_UHS_SDR25: + _RTW_PRINT_SEL(sel, "sd uhs SDR25"); + break; + #endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0) */ + + case MMC_TIMING_UHS_SDR50: + _RTW_PRINT_SEL(sel, "sd uhs SDR50"); + break; + + #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0) + case MMC_TIMING_MMC_DDR52: + _RTW_PRINT_SEL(sel, "mmc DDR52"); + break; + #endif + + case MMC_TIMING_UHS_SDR104: + _RTW_PRINT_SEL(sel, "sd uhs SDR104"); + break; + case MMC_TIMING_UHS_DDR50: + _RTW_PRINT_SEL(sel, "sd uhs DDR50"); + break; + + #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 3, 0) + case MMC_TIMING_MMC_HS200: + _RTW_PRINT_SEL(sel, "mmc HS200"); + break; + #endif + + #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 16, 0) + case MMC_TIMING_MMC_HS400: + _RTW_PRINT_SEL(sel, "mmc HS400"); + break; + #endif +#endif /* LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0) */ + default: + _RTW_PRINT_SEL(sel, "unknown(%d)", psdio_data->timing); + break; + } + _RTW_PRINT_SEL(sel, "\n"); + + RTW_PRINT_SEL(sel, " sd3_bus_mode: %s\n", (psdio_data->sd3_bus_mode) ? "TRUE" : "FALSE"); + RTW_PRINT_SEL(sel, "================\n"); +} + +#define SDIO_CARD_INFO_DUMP(dvobj) dump_sdio_card_info(RTW_DBGDUMP, dvobj) + +u32 sdio_init(struct dvobj_priv *dvobj) { PSDIO_DATA psdio_data; struct sdio_func *func; int err; + psdio_data = &dvobj->intf_data; func = psdio_data->func; @@ -291,15 +363,23 @@ static u32 sdio_init(struct dvobj_priv *dvobj) psdio_data->block_transfer_len = 512; psdio_data->tx_block_mode = 1; psdio_data->rx_block_mode = 1; - psdio_data->clock = func->card->host->ios.clock; - RTW_PRINT("%s: sdio clk rate: %d\n", __func__, psdio_data->clock); - if (dvobj->irq_alloc == 0) { - if (sdio_alloc_irq(dvobj) != _SUCCESS) { - RTW_ERR("%s: sdio_alloc_irq fail\n", __func__); - goto release; - } - } + psdio_data->timing = func->card->host->ios.timing; + psdio_data->clock = func->card->host->ios.clock; + + psdio_data->sd3_bus_mode = _FALSE; +#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 0, 0) + if (psdio_data->timing <= MMC_TIMING_UHS_DDR50 + #if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 8, 0) + && psdio_data->timing >= MMC_TIMING_UHS_SDR12 + #else + && psdio_data->timing >= MMC_TIMING_UHS_SDR50 + #endif + ) + psdio_data->sd3_bus_mode = _TRUE; +#endif + SDIO_CARD_INFO_DUMP(dvobj); + release: sdio_release_host(func); @@ -311,11 +391,13 @@ static u32 sdio_init(struct dvobj_priv *dvobj) return _SUCCESS; } -static void sdio_deinit(struct dvobj_priv *dvobj) +void sdio_deinit(struct dvobj_priv *dvobj) { struct sdio_func *func; int err; + + func = dvobj->intf_data.func; if (func) { @@ -326,17 +408,6 @@ static void sdio_deinit(struct dvobj_priv *dvobj) RTW_ERR("%s: sdio_disable_func(%d)\n", __func__, err); } - if (dvobj->irq_alloc) { - err = sdio_release_irq(func); - if (err) { - dvobj->drv_dbg.dbg_sdio_free_irq_error_cnt++; - RTW_ERR("%s: sdio_release_irq(%d)\n", __func__, err); - } else { - dvobj->drv_dbg.dbg_sdio_free_irq_cnt++; - dvobj->irq_alloc = 0; - } - } - sdio_release_host(func); } } @@ -452,6 +523,7 @@ static void sdio_dvobj_deinit(struct sdio_func *func) sdio_set_drvdata(func, NULL); if (dvobj) { sdio_deinit(dvobj); + sdio_free_irq(dvobj); devobj_deinit(dvobj); } @@ -542,11 +614,6 @@ static void sd_intf_stop(PADAPTER padapter) rtw_hal_disable_interrupt(padapter); } - -#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN -PADAPTER g_test_adapter = NULL; -#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ - _adapter *rtw_sdio_primary_adapter_init(struct dvobj_priv *dvobj) { int status = _FAIL; @@ -559,9 +626,6 @@ _adapter *rtw_sdio_primary_adapter_init(struct dvobj_priv *dvobj) if (loadparam(padapter) != _SUCCESS) goto free_adapter; -#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN - g_test_adapter = padapter; -#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ padapter->dvobj = dvobj; rtw_set_drv_stopped(padapter);/*init*/ @@ -588,11 +652,6 @@ _adapter *rtw_sdio_primary_adapter_init(struct dvobj_priv *dvobj) padapter->intf_start = &sd_intf_start; padapter->intf_stop = &sd_intf_stop; - padapter->intf_init = &sdio_init; - padapter->intf_deinit = &sdio_deinit; - padapter->intf_alloc_irq = &sdio_alloc_irq; - padapter->intf_free_irq = &sdio_free_irq; - if (rtw_init_io_priv(padapter, sdio_set_intf_ops) == _FAIL) { goto free_hal_data; } @@ -601,19 +660,20 @@ _adapter *rtw_sdio_primary_adapter_init(struct dvobj_priv *dvobj) rtw_hal_chip_configure(padapter); - /* 3 6. read efuse/eeprom data */ - rtw_hal_read_chip_info(padapter); +#ifdef CONFIG_BT_COEXIST + rtw_btcoex_Initialize(padapter); +#endif + rtw_btcoex_wifionly_initialize(padapter); + /* 3 6. read efuse/eeprom data */ + if (rtw_hal_read_chip_info(padapter) == _FAIL) + goto free_hal_data; /* 3 7. init driver common data */ if (rtw_init_drv_sw(padapter) == _FAIL) { goto free_hal_data; } -#ifdef CONFIG_BT_COEXIST - rtw_btcoex_Initialize(padapter); -#endif /* CONFIG_BT_COEXIST */ - /* 3 8. get WLan MAC address */ /* set mac addr */ rtw_macaddr_cfg(adapter_mac_addr(padapter), get_hal_mac_addr(padapter)); @@ -654,10 +714,10 @@ static void rtw_sdio_primary_adapter_deinit(_adapter *padapter) struct mlme_priv *pmlmepriv = &padapter->mlmepriv; if (check_fwstate(pmlmepriv, _FW_LINKED)) - rtw_disassoc_cmd(padapter, 0, _FALSE); + rtw_disassoc_cmd(padapter, 0, RTW_CMDF_DIRECTLY); #ifdef CONFIG_AP_MODE - if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) { + if (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) { free_mlme_ap_info(padapter); #ifdef CONFIG_HOSTAPD_MLME hostapd_mode_unload(padapter); @@ -670,11 +730,9 @@ static void rtw_sdio_primary_adapter_deinit(_adapter *padapter) sw_gpio_eint_set_enable(gpio_eint_wlan, 0); sw_gpio_irq_free(eint_wlan_handle); #else -#ifndef RTW_ENABLE_WIFI_CONTROL_FUNC gpio_hostwakeup_free_irq(padapter); -#endif /* RTW_ENABLE_WIFI_CONTROL_FUNC */ -#endif /* CONFIG_PLATFORM_ARM_SUN6I */ -#endif /* CONFIG_GPIO_WAKEUP */ +#endif +#endif /*rtw_cancel_all_timer(if1);*/ @@ -702,9 +760,6 @@ static void rtw_sdio_primary_adapter_deinit(_adapter *padapter) rtd2885_wlan_netlink_sendMsg("linkdown", "8712"); #endif -#ifdef RTW_SUPPORT_PLATFORM_SHUTDOWN - g_test_adapter = NULL; -#endif /* RTW_SUPPORT_PLATFORM_SHUTDOWN */ } /* @@ -736,6 +791,38 @@ static int rtw_drv_init( handle = ACPI_HANDLE(&func->dev); if (handle) { +#if (LINUX_VERSION_CODE >= KERNEL_VERSION(3,14,0)) + struct gpio_desc *oob_gpio = NULL; + /* Dont try to do acpi pm for the wifi module */ + if (!handle || acpi_bus_get_device(handle, &adev)) + RTW_INFO("Could not get acpi pointer!\n"); + else { + adev->power.flags.ignore_parent = 1; + adev->flags.power_manageable = 0; + RTW_INFO("Disabling ACPI power management support!\n"); + } + //oob_irq = acpi_get_gpio_by_index(&func->dev, 0, NULL); + // KERNEL_VERSION >= 3.14 (change to how gpio index is found for irq, the + // acpi_get_gpio_by_index() is no longer an EXPORT_SYMBOL_GPL + oob_gpio = devm_gpiod_get_index(&func->dev, + "rtw_wifi_gpio_wakeup", 0); + if (IS_ERR_OR_NULL(oob_gpio)) { + pr_err("%s: failed to get GPIO descriptor\n", __func__); + goto exit; + } + + if (gpiod_direction_input(oob_gpio)) { + pr_err("## %s Cannot set GPIO direction input\n", __FUNCTION__); + goto exit; + } + + if ((oob_irq = gpiod_to_irq(oob_gpio)) < 0) { + pr_err("## %s Cannot convert GPIO to IRQ\n", __FUNCTION__); + goto exit; + } + + RTW_INFO("## %s OOB_IRQ=%d\n", __FUNCTION__, oob_irq); +#else /* Dont try to do acpi pm for the wifi module */ if (!handle || acpi_bus_get_device(handle, &adev)) RTW_INFO("Could not get acpi pointer!\n"); @@ -746,11 +833,12 @@ static int rtw_drv_init( oob_gpio = acpi_get_gpio_by_index(&func->dev, 0, NULL); RTW_INFO("rtw_drv_init: ACPI_HANDLE found oob_gpio %d!\n", oob_gpio); wifi_configure_gpio(); +#endif } else RTW_INFO("rtw_drv_init: ACPI_HANDLE NOT found!\n"); #endif -#if defined(CONFIG_ACPI) +#if defined(CONFIG_ACPI) && (LINUX_VERSION_CODE < KERNEL_VERSION(3,14,0)) if (&func->dev && ACPI_HANDLE(&func->dev)) { wlan_en_gpio = acpi_get_gpio_by_index(&func->dev, 1, NULL); RTW_INFO("rtw_drv_init: ACPI_HANDLE found wlan_en %d!\n", wlan_en_gpio); @@ -797,6 +885,9 @@ static int rtw_drv_init( rtd2885_wlan_netlink_sendMsg("linkup", "8712"); #endif + if (sdio_alloc_irq(dvobj) != _SUCCESS) + goto os_ndevs_deinit; + #ifdef CONFIG_GPIO_WAKEUP #ifdef CONFIG_PLATFORM_ARM_SUN6I eint_wlan_handle = sw_gpio_irq_request(gpio_eint_wlan, TRIG_EDGE_NEGATIVE, (peint_handle)gpio_hostwakeup_irq_thread, NULL); @@ -805,11 +896,9 @@ static int rtw_drv_init( return -1; } #else -#ifndef RTW_ENABLE_WIFI_CONTROL_FUNC gpio_hostwakeup_alloc_irq(padapter); -#endif /* RTW_ENABLE_WIFI_CONTROL_FUNC */ -#endif /* CONFIG_PLATFORM_ARM_SUN6I */ -#endif /* CONFIG_GPIO_WAKEUP */ +#endif +#endif #ifdef CONFIG_GLOBAL_UI_PID if (ui_pid[1] != 0) { @@ -839,6 +928,9 @@ static int rtw_drv_init( if (status != _SUCCESS) sdio_dvobj_deinit(func); exit: +#if defined(CONFIG_PLATFORM_INTEL_BYT) + rtw_sdio_set_power(func,0); +#endif /* CONFIG_PLATFORM_INTEL_BYT */ return status == _SUCCESS ? 0 : -ENODEV; } @@ -846,7 +938,7 @@ static void rtw_dev_remove(struct sdio_func *func) { struct dvobj_priv *dvobj = sdio_get_drvdata(func); struct pwrctrl_priv *pwrctl = dvobj_to_pwrctl(dvobj); - PADAPTER padapter = dvobj->padapters[IFACE_ID0]; + PADAPTER padapter = dvobj_get_primary_adapter(dvobj); @@ -872,11 +964,12 @@ static void rtw_dev_remove(struct sdio_func *func) rtw_unregister_early_suspend(pwrctl); #endif - rtw_ps_deny(padapter, PS_DENY_DRV_REMOVE); - rtw_pm_set_ips(padapter, IPS_NONE); - rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); - LeaveAllPowerSaveMode(padapter); - + if (GET_HAL_DATA(padapter)->bFWReady == _TRUE) { + rtw_ps_deny(padapter, PS_DENY_DRV_REMOVE); + rtw_pm_set_ips(padapter, IPS_NONE); + rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); + LeaveAllPowerSaveMode(padapter); + } rtw_set_drv_stopped(padapter); /*for stop thread*/ rtw_stop_cmd_thread(padapter); #ifdef CONFIG_CONCURRENT_MODE @@ -917,13 +1010,8 @@ static int rtw_sdio_suspend(struct device *dev) if (psdpriv == NULL) goto exit; - if (psdpriv->processing_dev_remove == _TRUE) { - RTW_ERR("%s processing_dev_remove is _TRUE\n", __func__); - goto exit; - } - pwrpriv = dvobj_to_pwrctl(psdpriv); - padapter = psdpriv->padapters[IFACE_ID0]; + padapter = dvobj_get_primary_adapter(psdpriv); pdbgpriv = &psdpriv->drv_dbg; if (rtw_is_drv_stopped(padapter)) { RTW_INFO("%s bDriverStopped == _TRUE\n", __func__); @@ -984,7 +1072,7 @@ static int rtw_sdio_resume(struct device *dev) struct sdio_func *func = dev_to_sdio_func(dev); struct dvobj_priv *psdpriv = sdio_get_drvdata(func); struct pwrctrl_priv *pwrpriv = dvobj_to_pwrctl(psdpriv); - _adapter *padapter = psdpriv->padapters[IFACE_ID0]; + _adapter *padapter = dvobj_get_primary_adapter(psdpriv); struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; int ret = 0; struct debug_priv *pdbgpriv = &psdpriv->drv_dbg; @@ -993,32 +1081,28 @@ static int rtw_sdio_resume(struct device *dev) pdbgpriv->dbg_resume_cnt++; - if (pwrpriv->bInternalAutoSuspend) - ret = rtw_resume_process(padapter); - else { #ifdef CONFIG_PLATFORM_INTEL_BYT - if (0) + if (0) #else - if (pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) + if (pwrpriv->wowlan_mode || pwrpriv->wowlan_ap_mode) #endif - { + { + rtw_resume_lock_suspend(); + ret = rtw_resume_process(padapter); + rtw_resume_unlock_suspend(); + } else { +#ifdef CONFIG_RESUME_IN_WORKQUEUE + rtw_resume_in_workqueue(pwrpriv); +#else + if (rtw_is_earlysuspend_registered(pwrpriv)) { + /* jeff: bypass resume here, do in late_resume */ + rtw_set_do_late_resume(pwrpriv, _TRUE); + } else { rtw_resume_lock_suspend(); ret = rtw_resume_process(padapter); rtw_resume_unlock_suspend(); - } else { -#ifdef CONFIG_RESUME_IN_WORKQUEUE - rtw_resume_in_workqueue(pwrpriv); -#else - if (rtw_is_earlysuspend_registered(pwrpriv)) { - /* jeff: bypass resume here, do in late_resume */ - rtw_set_do_late_resume(pwrpriv, _TRUE); - } else { - rtw_resume_lock_suspend(); - ret = rtw_resume_process(padapter); - rtw_resume_unlock_suspend(); - } -#endif } +#endif } pmlmeext->last_scan_time = rtw_get_current_time(); RTW_INFO("<======== %s return %d\n", __FUNCTION__, ret); @@ -1026,6 +1110,43 @@ static int rtw_sdio_resume(struct device *dev) } +static void rtw_sdio_shutdown(struct device *dev) +{ + struct sdio_func *func = dev_to_sdio_func(dev); + struct dvobj_priv *psdpriv = sdio_get_drvdata(func); + _adapter *padapter = psdpriv->padapters[IFACE_ID0]; + + u32 addr; + u8 tmp8, cnt = 0; + + RTW_INFO("%s: enter\n", __func__); + +#ifdef CONFIG_FWLPS_IN_IPS + rtw_ps_deny(padapter, PS_DENY_DRV_REMOVE); + rtw_pm_set_ips(padapter, IPS_NONE); + rtw_pm_set_lps(padapter, PS_MODE_ACTIVE); + LeaveAllPowerSaveMode(padapter); +#endif /* CONFIG_FWLPS_IN_IPS */ + + /* enable power down function */ + /* 0x04[4] = 1 */ + /* 0x05[7] = 1 */ + addr = 0x04; + tmp8 = rtw_read8(padapter, addr); + tmp8 |= BIT(4); + rtw_write8(padapter, addr, tmp8); + RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", + FUNC_ADPT_ARG(padapter), addr, rtw_read8(padapter, addr)); + + addr = 0x05; + tmp8 = rtw_read8(padapter, addr); + tmp8 |= BIT(7); + rtw_write8(padapter, addr, tmp8); + RTW_INFO(FUNC_ADPT_FMT ": read after write 0x%x=0x%x\n", + FUNC_ADPT_ARG(padapter), addr, rtw_read8(padapter, addr)); + +} + static int rtw_drv_entry(void) { int ret = 0; @@ -1036,6 +1157,10 @@ static int rtw_drv_entry(void) RTW_PRINT(DRV_NAME" BT-Coex version = %s\n", BTCOEXVERSION); #endif /* BTCOEXVERSION */ +#ifndef CONFIG_PLATFORM_INTEL_BYT + rtw_android_wifictrl_func_add(); +#endif /* !CONFIG_PLATFORM_INTEL_BYT */ + ret = platform_wifi_power_on(); if (ret) { RTW_INFO("%s: power on failed!!(%d)\n", __FUNCTION__, ret); @@ -1047,6 +1172,7 @@ static int rtw_drv_entry(void) rtw_suspend_lock_init(); rtw_drv_proc_init(); rtw_ndev_notifier_register(); + rtw_inetaddr_notifier_register(); ret = sdio_register_driver(&sdio_drvpriv.r871xs_drv); if (ret != 0) { @@ -1054,13 +1180,11 @@ static int rtw_drv_entry(void) rtw_suspend_lock_uninit(); rtw_drv_proc_deinit(); rtw_ndev_notifier_unregister(); + rtw_inetaddr_notifier_unregister(); RTW_INFO("%s: register driver failed!!(%d)\n", __FUNCTION__, ret); goto poweroff; } -#ifndef CONFIG_PLATFORM_INTEL_BYT - rtw_android_wifictrl_func_add(); -#endif /* !CONFIG_PLATFORM_INTEL_BYT */ goto exit; poweroff: @@ -1086,24 +1210,44 @@ static void rtw_drv_halt(void) rtw_suspend_lock_uninit(); rtw_drv_proc_deinit(); rtw_ndev_notifier_unregister(); + rtw_inetaddr_notifier_unregister(); RTW_PRINT("module exit success\n"); rtw_mstat_dump(RTW_DBGDUMP); } -#ifdef CONFIG_PLATFORM_INTEL_BYT -int rtw_sdio_set_power(int on) +#if defined(CONFIG_PLATFORM_INTEL_BYT) +int rtw_sdio_set_power(struct sdio_func *func, int on) { +#if defined(CONFIG_ACPI) + acpi_handle *handle; + struct acpi_device *adev = NULL; + int ret; - if (wlan_en_gpio >= 0) { - if (on) - gpio_set_value(wlan_en_gpio, 1); - else - gpio_set_value(wlan_en_gpio, 0); - } + handle = ACPI_HANDLE(&func->dev); + if (IS_ERR_OR_NULL(handle)) + return -ENOENT; + acpi_bus_get_device(handle, &adev); + if (!adev) + return -ENOENT; + + RTW_INFO("turn wifi %s\n", on ? "on" : "off"); + + adev->flags.power_manageable = 1; + + if (on) + ret = acpi_device_set_power(adev, ACPI_STATE_D0); + else + ret = acpi_device_set_power(adev, ACPI_STATE_D3_COLD); + + adev->flags.power_manageable = 0; + + return ret; +#else return 0; +#endif } #endif /* CONFIG_PLATFORM_INTEL_BYT */ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_ops_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_ops_linux.c index c2a2046edf2e..583641888ff1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_ops_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/sdio_ops_linux.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,15 +11,19 @@ * 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 - * - *******************************************************************************/ + *****************************************************************************/ #define _SDIO_OPS_LINUX_C_ #include +inline bool rtw_is_sdio30(_adapter *adapter) +{ + struct dvobj_priv *dvobj = adapter_to_dvobj(adapter); + PSDIO_DATA psdio_data = &dvobj->intf_data; + + return (psdio_data->sd3_bus_mode) ? _TRUE : _FALSE; +} + static bool rtw_sdio_claim_host_needed(struct sdio_func *func) { struct dvobj_priv *dvobj = sdio_get_drvdata(func); @@ -861,72 +865,104 @@ s32 sd_write(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, void *pdata) #if 1 /*#define RTW_SDIO_DUMP*/ -int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, int addr, +/** + * Returns driver error code, + * 0 no error + * -1 Level 1 error, critical error and can't be recovered + * -2 Level 2 error, normal error, retry to recover is possible + */ +static int linux_io_err_to_drv_err(int err) +{ + if (!err) + return 0; + + /* critical error */ + if ((err == -ESHUTDOWN) || + (err == -ENODEV) || + (err == -ENOMEDIUM)) + return -1; + + /* other error */ + return -2; +} + +/** + * rtw_sdio_raw_read - Read from SDIO device + * @d: driver object private data + * @addr: address to read + * @buf: buffer to store the data + * @len: number of bytes to read + * @fixed: + * + * Reads from the address space of a SDIO device. + * Return value indicates if the transfer succeeded or not. + */ +int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, unsigned int addr, void *buf, size_t len, bool fixed) { int error = -EPERM; bool f0, cmd52; struct sdio_func *func; bool claim_needed; + u32 offset, i; - if (rtw_is_surprise_removed(dvobj_get_primary_adapter(d))) { - /*RTW_ERR(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__);*/ - return error; - } func = dvobj_to_sdio_func(d); claim_needed = rtw_sdio_claim_host_needed(func); f0 = RTW_SDIO_ADDR_F0_CHK(addr); cmd52 = RTW_SDIO_ADDR_CMD52_CHK(addr); + /* + * Mask addr to remove driver defined bit and + * make sure addr is in valid range + */ + if (f0) + addr &= 0xFFF; + else + addr &= 0x1FFFF; + #ifdef RTW_SDIO_DUMP if (f0) dev_dbg(&func->dev, "rtw_sdio: READ F0\n"); - if (cmd52) + else if (cmd52) dev_dbg(&func->dev, "rtw_sdio: READ use CMD52\n"); else dev_dbg(&func->dev, "rtw_sdio: READ use CMD53\n"); dev_dbg(&func->dev, "rtw_sdio: READ from 0x%05x\n", addr); - print_hex_dump(KERN_DEBUG, "rtw_sdio: READ ", - DUMP_PREFIX_OFFSET, 16, 1, - buf, len, false); #endif /* RTW_SDIO_DUMP */ if (claim_needed) sdio_claim_host(func); if (f0) { - int i; - - addr &= 0xFF; - for (i = 0; i < len; i++, addr++) { - ((u8 *)buf)[i] = sdio_f0_readb(func, addr, &error); + offset = addr; + for (i = 0; i < len; i++, offset++) { + ((u8 *)buf)[i] = sdio_f0_readb(func, offset, &error); if (error) break; #if 0 dev_info(&func->dev, "%s: sdio f0 read 52 addr 0x%x, byte 0x%02x\n", - __func__, addr + i, ((u8 *)buf)[i]); + __func__, offset, ((u8 *)buf)[i]); #endif } } else { - addr &= 0x1FFFF; if (cmd52) { - int i; #ifdef RTW_SDIO_IO_DBG dev_info(&func->dev, "%s: sdio read 52 addr 0x%x, %zu bytes\n", __func__, addr, len); #endif + offset = addr; for (i = 0; i < len; i++) { - ((u8 *)buf)[i] = sdio_readb(func, addr, &error); + ((u8 *)buf)[i] = sdio_readb(func, offset, &error); if (error) break; #if 0 dev_info(&func->dev, "%s: sdio read 52 addr 0x%x, byte 0x%02x\n", - __func__, addr + i, ((u8 *)buf)[i]); + __func__, offset, ((u8 *)buf)[i]); #endif if (!fixed) - addr++; + offset++; } } else { #ifdef RTW_SDIO_IO_DBG @@ -943,6 +979,12 @@ int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, int addr, if (claim_needed) sdio_release_host(func); +#ifdef RTW_SDIO_DUMP + print_hex_dump(KERN_DEBUG, "rtw_sdio: READ ", + DUMP_PREFIX_OFFSET, 16, 1, + buf, len, false); +#endif /* RTW_SDIO_DUMP */ + if (WARN_ON(error)) { dev_err(&func->dev, "%s: sdio read failed (%d)\n", __func__, error); #ifndef RTW_SDIO_DUMP @@ -952,41 +994,55 @@ int __must_check rtw_sdio_raw_read(struct dvobj_priv *d, int addr, dev_err(&func->dev, "rtw_sdio: READ use CMD52\n"); else dev_err(&func->dev, "rtw_sdio: READ use CMD53\n"); - dev_err(&func->dev, "rtw_sdio: READ from 0x%04x\n", addr); + dev_err(&func->dev, "rtw_sdio: READ from 0x%05x, %zu bytes\n", addr, len); print_hex_dump(KERN_ERR, "rtw_sdio: READ ", DUMP_PREFIX_OFFSET, 16, 1, buf, len, false); #endif /* !RTW_SDIO_DUMP */ } - if (error == (-ESHUTDOWN) || error == (-ENODEV) || error == (-ENOMEDIUM) || error == (-ETIMEDOUT)) - rtw_set_surprise_removed(dvobj_get_primary_adapter(d)); - - return error; + return linux_io_err_to_drv_err(error); } -int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, int addr, +/** + * rtw_sdio_raw_write - Write to SDIO device + * @d: driver object private data + * @addr: address to write + * @buf: buffer that contains the data to write + * @len: number of bytes to write + * @fixed: address is fixed(FIFO) or incremented + * + * Writes to the address space of a SDIO device. + * Return value indicates if the transfer succeeded or not. + */ +int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, unsigned int addr, void *buf, size_t len, bool fixed) { int error = -EPERM; bool f0, cmd52; struct sdio_func *func; bool claim_needed; + u32 offset, i; - if (rtw_is_surprise_removed(dvobj_get_primary_adapter(d))) { - /*RTW_ERR(" %s (padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!!\n", __func__);*/ - return error; - } func = dvobj_to_sdio_func(d); claim_needed = rtw_sdio_claim_host_needed(func); f0 = RTW_SDIO_ADDR_F0_CHK(addr); cmd52 = RTW_SDIO_ADDR_CMD52_CHK(addr); + /* + * Mask addr to remove driver defined bit and + * make sure addr is in valid range + */ + if (f0) + addr &= 0xFFF; + else + addr &= 0x1FFFF; + #ifdef RTW_SDIO_DUMP if (f0) dev_dbg(&func->dev, "rtw_sdio: WRITE F0\n"); - if (cmd52) + else if (cmd52) dev_dbg(&func->dev, "rtw_sdio: WRITE use CMD52\n"); else dev_dbg(&func->dev, "rtw_sdio: WRITE use CMD53\n"); @@ -1000,36 +1056,33 @@ int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, int addr, sdio_claim_host(func); if (f0) { - int i; - - addr &= 0xFF; - for (i = 0; i < len; i++, addr++) { - sdio_f0_writeb(func, ((u8 *)buf)[i], addr, &error); + offset = addr; + for (i = 0; i < len; i++, offset++) { + sdio_f0_writeb(func, ((u8 *)buf)[i], offset, &error); if (error) break; #if 0 dev_info(&func->dev, "%s: sdio f0 write 52 addr 0x%x, byte 0x%02x\n", - __func__, addr, ((u8 *)buf)[i]); + __func__, offset, ((u8 *)buf)[i]); #endif } } else { - addr &= 0x1FFFF; if (cmd52) { - int i; #ifdef RTW_SDIO_IO_DBG dev_info(&func->dev, "%s: sdio write 52 addr 0x%x, %zu bytes\n", __func__, addr, len); #endif + offset = addr; for (i = 0; i < len; i++) { - sdio_writeb(func, ((u8 *)buf)[i], addr, &error); + sdio_writeb(func, ((u8 *)buf)[i], offset, &error); if (error) break; #if 0 dev_info(&func->dev, "%s: sdio write 52 addr 0x%x, byte 0x%02x\n", - __func__, addr + i, ((u8 *)buf)[i]); + __func__, offset, ((u8 *)buf)[i]); #endif if (!fixed) - addr++; + offset++; } } else { #ifdef RTW_SDIO_IO_DBG @@ -1055,16 +1108,13 @@ int __must_check rtw_sdio_raw_write(struct dvobj_priv *d, int addr, dev_err(&func->dev, "rtw_sdio: WRITE use CMD52\n"); else dev_err(&func->dev, "rtw_sdio: WRITE use CMD53\n"); - dev_err(&func->dev, "rtw_sdio: WRITE to 0x%05x\n", addr); + dev_err(&func->dev, "rtw_sdio: WRITE to 0x%05x, %zu bytes\n", addr, len); print_hex_dump(KERN_ERR, "rtw_sdio: WRITE ", DUMP_PREFIX_OFFSET, 16, 1, buf, len, false); #endif /* !RTW_SDIO_DUMP */ } - if (error == (-ESHUTDOWN) || error == (-ENODEV) || error == (-ENOMEDIUM) || error == (-ETIMEDOUT)) - rtw_set_surprise_removed(dvobj_get_primary_adapter(d)); - - return error; + return linux_io_err_to_drv_err(error); } #endif diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/wifi_regd.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/wifi_regd.c index fc58d760bca2..c710b25b0d83 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/wifi_regd.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/wifi_regd.c @@ -1,6 +1,15 @@ /****************************************************************************** * - * Copyright(c) 2009-2010 Realtek Corporation. + * Copyright(c) 2009-2010 - 2017 Realtek Corporation. + * + * 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. * *****************************************************************************/ @@ -134,16 +143,11 @@ static const struct ieee80211_regdomain rtw_regdom_14 = { static struct rtw_regulatory *rtw_regd; #endif -static bool _rtw_is_radar_freq(u16 center_freq) -{ - return center_freq >= 5260 && center_freq <= 5700; -} - #if 0 /* not_yet */ static void _rtw_reg_apply_beaconing_flags(struct wiphy *wiphy, enum nl80211_reg_initiator initiator) { - enum ieee80211_band band; + enum nl80211_band band; struct ieee80211_supported_band *sband; const struct ieee80211_reg_rule *reg_rule; struct ieee80211_channel *ch; @@ -151,7 +155,7 @@ static void _rtw_reg_apply_beaconing_flags(struct wiphy *wiphy, u32 bandwidth = 0; int r; - for (band = 0; band < IEEE80211_NUM_BANDS; band++) { + for (band = 0; band < NUM_NL80211_BANDS; band++) { if (!wiphy->bands[band]) continue; @@ -160,7 +164,7 @@ static void _rtw_reg_apply_beaconing_flags(struct wiphy *wiphy, for (i = 0; i < sband->n_channels; i++) { ch = &sband->channels[i]; - if (_rtw_is_radar_freq(ch->center_freq) || + if (rtw_is_dfs_ch(ch->hw_value) || (ch->flags & IEEE80211_CHAN_RADAR)) continue; if (initiator == NL80211_REGDOM_SET_BY_COUNTRY_IE) { @@ -205,9 +209,9 @@ static void _rtw_reg_apply_active_scan_flags(struct wiphy *wiphy, u32 bandwidth = 0; int r; - if (!wiphy->bands[IEEE80211_BAND_2GHZ]) + if (!wiphy->bands[NL80211_BAND_2GHZ]) return; - sband = wiphy->bands[IEEE80211_BAND_2GHZ]; + sband = wiphy->bands[NL80211_BAND_2GHZ]; /* * If no country IE has been received always enable active scan @@ -258,18 +262,21 @@ static void _rtw_reg_apply_radar_flags(struct wiphy *wiphy) struct ieee80211_channel *ch; unsigned int i; - if (!wiphy->bands[IEEE80211_BAND_5GHZ]) + if (!wiphy->bands[NL80211_BAND_5GHZ]) return; - sband = wiphy->bands[IEEE80211_BAND_5GHZ]; + sband = wiphy->bands[NL80211_BAND_5GHZ]; for (i = 0; i < sband->n_channels; i++) { ch = &sband->channels[i]; - if (!_rtw_is_radar_freq(ch->center_freq)) + if (!rtw_is_dfs_ch(ch->hw_value)) continue; #ifdef CONFIG_DFS - #if !defined(CONFIG_DFS_MASTER) - if (!(ch->flags & IEEE80211_CHAN_DISABLED)) { + if (!(ch->flags & IEEE80211_CHAN_DISABLED) + #if defined(CONFIG_DFS_MASTER) + && rtw_odm_dfs_domain_unknown(wiphy_to_adapter(wiphy)) + #endif + ) { ch->flags |= IEEE80211_CHAN_RADAR; #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) ch->flags |= (IEEE80211_CHAN_NO_IBSS | IEEE80211_CHAN_PASSIVE_SCAN); @@ -277,7 +284,6 @@ static void _rtw_reg_apply_radar_flags(struct wiphy *wiphy) ch->flags |= IEEE80211_CHAN_NO_IR; #endif } - #endif #endif /* CONFIG_DFS */ #if 0 @@ -304,10 +310,10 @@ static void _rtw_reg_apply_flags(struct wiphy *wiphy) { #if 1 /* by channel plan */ _adapter *padapter = wiphy_to_adapter(wiphy); - u8 channel_plan = padapter->mlmepriv.ChannelPlan; - struct mlme_ext_priv *pmlmeext = &padapter->mlmeextpriv; - RT_CHANNEL_INFO *channel_set = pmlmeext->channel_set; - u8 max_chan_nums = pmlmeext->max_chan_nums; + struct rf_ctl_t *rfctl = adapter_to_rfctl(padapter); + u8 channel_plan = rfctl->ChannelPlan; + RT_CHANNEL_INFO *channel_set = rfctl->channel_set; + u8 max_chan_nums = rfctl->max_chan_nums; struct ieee80211_supported_band *sband; struct ieee80211_channel *ch; @@ -316,7 +322,7 @@ static void _rtw_reg_apply_flags(struct wiphy *wiphy) u32 freq; /* all channels disable */ - for (i = 0; i < IEEE80211_NUM_BANDS; i++) { + for (i = 0; i < NUM_NL80211_BANDS; i++) { sband = wiphy->bands[i]; if (sband) { @@ -336,10 +342,12 @@ static void _rtw_reg_apply_flags(struct wiphy *wiphy) ch = ieee80211_get_channel(wiphy, freq); if (ch) { - if (channel_set[i].ScanType == SCAN_PASSIVE) { + if (channel_set[i].ScanType == SCAN_PASSIVE #if defined(CONFIG_DFS_MASTER) - ch->flags = 0; - #elif (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) + && rtw_odm_dfs_domain_unknown(wiphy_to_adapter(wiphy)) + #endif + ) { + #if (LINUX_VERSION_CODE < KERNEL_VERSION(3, 14, 0)) ch->flags = (IEEE80211_CHAN_NO_IBSS | IEEE80211_CHAN_PASSIVE_SCAN); #else ch->flags = IEEE80211_CHAN_NO_IR; @@ -362,7 +370,7 @@ static void _rtw_reg_apply_flags(struct wiphy *wiphy) u16 channel; u32 freq; - for (i = 0; i < IEEE80211_NUM_BANDS; i++) { + for (i = 0; i < NUM_NL80211_BANDS; i++) { sband = wiphy->bands[i]; if (sband) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/xmit_linux.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/xmit_linux.c index 5554ac263967..570249c4dce8 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/xmit_linux.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/linux/xmit_linux.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _XMIT_OSDEP_C_ #include @@ -200,6 +195,12 @@ static inline bool rtw_os_need_wake_queue(_adapter *padapter, u16 qidx) if (padapter->registrypriv.wifi_spec) { if (pxmitpriv->hwxmits[qidx].accnt < WMM_XMIT_THRESHOLD) return _TRUE; +#ifdef DBG_CONFIG_ERROR_DETECT +#ifdef DBG_CONFIG_ERROR_RESET + } else if (rtw_hal_sreset_inprogress(padapter) == _TRUE) { + return _FALSE; +#endif/* #ifdef DBG_CONFIG_ERROR_RESET */ +#endif/* #ifdef DBG_CONFIG_ERROR_DETECT */ } else { #ifdef CONFIG_MCC_MODE if (MCC_EN(padapter)) { @@ -299,6 +300,13 @@ void rtw_os_xmit_schedule(_adapter *padapter) tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); _exit_critical_bh(&pxmitpriv->lock, &irqL); + +#if defined(CONFIG_PCI_HCI) && defined(CONFIG_XMIT_THREAD_MODE) + if (_rtw_queue_empty(&padapter->xmitpriv.pending_xmitbuf_queue) == _FALSE) + _rtw_up_sema(&padapter->xmitpriv.xmit_sema); +#endif + + #endif } @@ -396,9 +404,9 @@ int rtw_mlcst2unicst(_adapter *padapter, struct sk_buff *skb) } /* avoid come from STA1 and send back STA1 */ - if (_rtw_memcmp(psta->hwaddr, &skb->data[6], 6) == _TRUE - || _rtw_memcmp(psta->hwaddr, null_addr, 6) == _TRUE - || _rtw_memcmp(psta->hwaddr, bc_addr, 6) == _TRUE + if (_rtw_memcmp(psta->cmn.mac_addr, &skb->data[6], 6) == _TRUE + || _rtw_memcmp(psta->cmn.mac_addr, null_addr, 6) == _TRUE + || _rtw_memcmp(psta->cmn.mac_addr, bc_addr, 6) == _TRUE ) { DBG_COUNTER(padapter->tx_logs.os_tx_m2u_ignore_self); continue; @@ -409,7 +417,7 @@ int rtw_mlcst2unicst(_adapter *padapter, struct sk_buff *skb) newskb = rtw_skb_copy(skb); if (newskb) { - _rtw_memcpy(newskb->data, psta->hwaddr, 6); + _rtw_memcpy(newskb->data, psta->cmn.mac_addr, 6); res = rtw_xmit(padapter, &newskb); if (res < 0) { DBG_COUNTER(padapter->tx_logs.os_tx_m2u_entry_err_xmit); @@ -464,7 +472,7 @@ int _rtw_xmit_entry(_pkt *pkt, _nic_hdl pnetdev) #ifdef CONFIG_TX_MCAST2UNI if (!rtw_mc2u_disable - && check_fwstate(pmlmepriv, WIFI_AP_STATE) == _TRUE + && (MLME_IS_AP(padapter) || MLME_IS_MESH(padapter)) && (IP_MCAST_MAC(pkt->data) || ICMPV6_MCAST_MAC(pkt->data) #ifdef CONFIG_TX_BCAST2UNI diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/osdep_service.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/osdep_service.c index 1fbea5d83474..cfa603b516ec 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/osdep_service.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/os_dep/osdep_service.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. + * Copyright(c) 2007 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #define _OSDEP_SERVICE_C_ @@ -483,7 +478,7 @@ void rtw_mstat_dump(void *sel) void rtw_mstat_update(const enum mstat_f flags, const MSTAT_STATUS status, u32 sz) { - static u32 update_time = 0; + static systime update_time = 0; int peak, alloc; int i; @@ -729,7 +724,7 @@ inline struct sk_buff *dbg_rtw_skb_copy(const struct sk_buff *skb, const enum ms rtw_mstat_update( flags , skb_cp ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL - , truesize + , cp_truesize ); return skb_cp; @@ -751,7 +746,7 @@ inline struct sk_buff *dbg_rtw_skb_clone(struct sk_buff *skb, const enum mstat_f rtw_mstat_update( flags , skb_cl ? MSTAT_ALLOC_SUCCESS : MSTAT_ALLOC_FAIL - , truesize + , cl_truesize ); return skb_cl; @@ -884,6 +879,39 @@ void rtw_mfree2d(void *pbuf, int h, int w, int size) rtw_mfree((u8 *)pbuf, h * sizeof(void *) + w * h * size); } +inline void rtw_os_pkt_free(_pkt *pkt) +{ +#if defined(PLATFORM_LINUX) + rtw_skb_free(pkt); +#elif defined(PLATFORM_FREEBSD) + m_freem(pkt); +#else + #error "TBD\n" +#endif +} + +inline void *rtw_os_pkt_data(_pkt *pkt) +{ +#if defined(PLATFORM_LINUX) + return pkt->data; +#elif defined(PLATFORM_FREEBSD) + return pkt->m_data; +#else + #error "TBD\n" +#endif +} + +inline u32 rtw_os_pkt_len(_pkt *pkt) +{ +#if defined(PLATFORM_LINUX) + return pkt->len; +#elif defined(PLATFORM_FREEBSD) + return pkt->m_pkthdr.len; +#else + #error "TBD\n" +#endif +} + void _rtw_memcpy(void *dst, const void *src, u32 sz) { @@ -1066,18 +1094,18 @@ void rtw_list_insert_tail(_list *plist, _list *phead) } -void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc) +void rtw_init_timer(_timer *ptimer, void *padapter, void *pfunc, void *ctx) { _adapter *adapter = (_adapter *)padapter; #ifdef PLATFORM_LINUX - _init_timer(ptimer, adapter->pnetdev, pfunc, adapter); + _init_timer(ptimer, adapter->pnetdev, pfunc, ctx); #endif #ifdef PLATFORM_FREEBSD - _init_timer(ptimer, adapter->pifp, pfunc, adapter->mlmepriv.nic_hdl); + _init_timer(ptimer, adapter->pifp, pfunc, ctx); #endif #ifdef PLATFORM_WINDOWS - _init_timer(ptimer, adapter->hndis_adapter, pfunc, adapter->mlmepriv.nic_hdl); + _init_timer(ptimer, adapter->hndis_adapter, pfunc, ctx); #endif } @@ -1176,7 +1204,43 @@ u32 _rtw_down_sema(_sema *sema) #endif } +inline void thread_exit(_completion *comp) +{ +#ifdef PLATFORM_LINUX + complete_and_exit(comp, 0); +#endif +#ifdef PLATFORM_FREEBSD + printf("%s", "RTKTHREAD_exit"); +#endif + +#ifdef PLATFORM_OS_CE + ExitThread(STATUS_SUCCESS); +#endif + +#ifdef PLATFORM_OS_XP + PsTerminateSystemThread(STATUS_SUCCESS); +#endif +} + +inline void _rtw_init_completion(_completion *comp) +{ +#ifdef PLATFORM_LINUX + init_completion(comp); +#endif +} +inline void _rtw_wait_for_comp_timeout(_completion *comp) +{ +#ifdef PLATFORM_LINUX + wait_for_completion_timeout(comp, msecs_to_jiffies(3000)); +#endif +} +inline void _rtw_wait_for_comp(_completion *comp) +{ +#ifdef PLATFORM_LINUX + wait_for_completion(comp); +#endif +} void _rtw_mutex_init(_mutex *pmutex) { @@ -1384,7 +1448,7 @@ u32 rtw_end_of_queue_search(_list *head, _list *plist) } -u32 rtw_get_current_time(void) +systime _rtw_get_current_time(void) { #ifdef PLATFORM_LINUX @@ -1398,27 +1462,27 @@ u32 rtw_get_current_time(void) #ifdef PLATFORM_WINDOWS LARGE_INTEGER SystemTime; NdisGetCurrentSystemTime(&SystemTime); - return (u32)(SystemTime.LowPart);/* count of 100-nanosecond intervals */ + return SystemTime.LowPart;/* count of 100-nanosecond intervals */ #endif } -inline u32 rtw_systime_to_ms(u32 systime) +inline u32 _rtw_systime_to_ms(systime stime) { #ifdef PLATFORM_LINUX - return systime * 1000 / HZ; + return jiffies_to_msecs(stime); #endif #ifdef PLATFORM_FREEBSD - return systime * 1000; + return stime * 1000; #endif #ifdef PLATFORM_WINDOWS - return systime / 10000 ; + return stime / 10000 ; #endif } -inline u32 rtw_ms_to_systime(u32 ms) +inline systime _rtw_ms_to_systime(u32 ms) { #ifdef PLATFORM_LINUX - return ms * HZ / 1000; + return msecs_to_jiffies(ms); #endif #ifdef PLATFORM_FREEBSD return ms / 1000; @@ -1429,35 +1493,16 @@ inline u32 rtw_ms_to_systime(u32 ms) } /* the input parameter start use the same unit as returned by rtw_get_current_time */ -inline s32 rtw_get_passing_time_ms(u32 start) +inline s32 _rtw_get_passing_time_ms(systime start) { -#ifdef PLATFORM_LINUX - return rtw_systime_to_ms(jiffies - start); -#endif -#ifdef PLATFORM_FREEBSD - return rtw_systime_to_ms(rtw_get_current_time()); -#endif -#ifdef PLATFORM_WINDOWS - LARGE_INTEGER SystemTime; - NdisGetCurrentSystemTime(&SystemTime); - return rtw_systime_to_ms((u32)(SystemTime.LowPart) - start) ; -#endif + return _rtw_systime_to_ms(_rtw_get_current_time() - start); } -inline s32 rtw_get_time_interval_ms(u32 start, u32 end) +inline s32 _rtw_get_time_interval_ms(systime start, systime end) { -#ifdef PLATFORM_LINUX - return rtw_systime_to_ms(end - start); -#endif -#ifdef PLATFORM_FREEBSD - return rtw_systime_to_ms(rtw_get_current_time()); -#endif -#ifdef PLATFORM_WINDOWS - return rtw_systime_to_ms(end - start); -#endif + return _rtw_systime_to_ms(end - start); } - void rtw_sleep_schedulable(int ms) { @@ -2273,20 +2318,19 @@ void rtw_free_netdev(struct net_device *netdev) return; } -/* -* Jeff: this function should be called under ioctl (rtnl_lock is accquired) while -* LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 26) -*/ int rtw_change_ifname(_adapter *padapter, const char *ifname) { + struct dvobj_priv *dvobj; struct net_device *pnetdev; struct net_device *cur_pnetdev; struct rereg_nd_name_data *rereg_priv; int ret; + u8 rtnl_lock_needed; if (!padapter) goto error; + dvobj = adapter_to_dvobj(padapter); cur_pnetdev = padapter->pnetdev; rereg_priv = &padapter->rereg_nd_name_priv; @@ -2296,11 +2340,11 @@ int rtw_change_ifname(_adapter *padapter, const char *ifname) rereg_priv->old_pnetdev = NULL; } -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) - if (!rtnl_is_locked()) + rtnl_lock_needed = rtw_rtnl_lock_needed(dvobj); + + if (rtnl_lock_needed) unregister_netdev(cur_pnetdev); else -#endif unregister_netdevice(cur_pnetdev); rereg_priv->old_pnetdev = cur_pnetdev; @@ -2317,11 +2361,9 @@ int rtw_change_ifname(_adapter *padapter, const char *ifname) _rtw_memcpy(pnetdev->dev_addr, adapter_mac_addr(padapter), ETH_ALEN); -#if (LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 26)) - if (!rtnl_is_locked()) + if (rtnl_lock_needed) ret = register_netdev(pnetdev); else -#endif ret = register_netdevice(pnetdev); if (ret != 0) { @@ -2703,6 +2745,15 @@ inline BOOLEAN is_null(char c) return _FALSE; } +inline BOOLEAN is_all_null(char *c, int len) +{ + for (; len > 0; len--) + if (c[len - 1] != '\0') + return _FALSE; + + return _TRUE; +} + /** * is_eol - * diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/custom_country_chplan.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/custom_country_chplan.h index 9d26bf41ccf1..f8cc13bf10c3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/custom_country_chplan.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/custom_country_chplan.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,18 +11,12 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #error "You have defined CONFIG_CUSTOMIZED_COUNTRY_CHPLAN_MAP to use a customized map of your own instead of the default one" #error "Before removing these error notifications, please make sure regulatory certification requirements of your target markets" static const struct country_chplan CUSTOMIZED_country_chplan_map[] = { - COUNTRY_CHPLAN_ENT("TW", 0x39, 1, 0xFF), /* Taiwan */ + COUNTRY_CHPLAN_ENT("TW", 0x76, 1, 0x3FF), /* Taiwan */ }; -static const u16 CUSTOMIZED_country_chplan_map_sz = sizeof(CUSTOMIZED_country_chplan_map) / sizeof(struct country_chplan); diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUN50IW1P1_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUN50IW1P1_sdio.c index 44bd7de1e0e3..2586455de8c3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUN50IW1P1_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUN50IW1P1_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /* * Description: * This file can be applied to following platforms: diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNnI_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNnI_sdio.c index 612dfbaa2b1e..8a52aa90cb0d 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNnI_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNnI_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /* * Description: * This file can be applied to following platforms: diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_sdio.c index 6eed7b137282..795b7e7f7998 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 #ifdef CONFIG_MMC_SUNXI_POWER_CONTROL diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_usb.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_usb.c index b2c8a283c158..9c2abc4f6f44 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_usb.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_SUNxI_usb.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /* * Description: * This file can be applied to following platforms: diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_WMT_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_WMT_sdio.c index 159a5acfee21..d85002c15fd3 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_WMT_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ARM_WMT_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 #include #include diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_RTK_DMP_usb.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_RTK_DMP_usb.c index af845f7bb331..cb740b2eebb5 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_RTK_DMP_usb.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_RTK_DMP_usb.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 int platform_wifi_power_on(void) diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_arm_act_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_arm_act_sdio.c index 539bb178c584..ad7b6cfed455 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_arm_act_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_arm_act_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ /* * Description: * This file can be applied to following platforms: diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.c index 95da669c38b9..10766aad8e3b 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef CONFIG_PLATFORM_OPS /* * Return: diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.h b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.h index b8314bb21411..12caf3c853a1 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.h +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_ops.h @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 - * - * - ******************************************************************************/ + *****************************************************************************/ #ifndef __PLATFORM_OPS_H__ #define __PLATFORM_OPS_H__ diff --git a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_sprd_sdio.c b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_sprd_sdio.c index c5ffd149fc5c..34061d05d428 100644 --- a/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_sprd_sdio.c +++ b/drivers/net/wireless/rockchip_wlan/rtl8723ds/platform/platform_sprd_sdio.c @@ -1,6 +1,6 @@ /****************************************************************************** * - * Copyright(c) 2013 Realtek Corporation. All rights reserved. + * Copyright(c) 2013 - 2017 Realtek Corporation. * * 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 @@ -11,12 +11,7 @@ * 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 extern void sdhci_bus_scan(void);